?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Avoid beyond bounds copy while caching ACL
[zen-stable.git] / drivers / media / video / gspca / spca561.c
blob4a5f209ce719aa878ae082d30ca82f9faa9586f3
1 /*
2 * Sunplus spca561 subdriver
3 *
4 * Copyright (C) 2004 Michel Xhaard mxhaard@magic.fr
5 *
6 * V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21 */
22
23 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
24
25 #define MODULE_NAME "spca561"
26
27 #include <linux/input.h>
28 #include "gspca.h"
29
30 MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>");
31 MODULE_DESCRIPTION("GSPCA/SPCA561 USB Camera Driver");
32 MODULE_LICENSE("GPL");
33
34 /* specific webcam descriptor */
35 struct sd {
36 struct gspca_dev gspca_dev; /* !! must be the first item */
37
38 __u16 exposure; /* rev12a only */
39 #define EXPOSURE_MIN 1
40 #define EXPOSURE_DEF 700 /* == 10 fps */
41 #define EXPOSURE_MAX (2047 + 325) /* see setexposure */
42
43 __u8 contrast; /* rev72a only */
44 #define CONTRAST_MIN 0x00
45 #define CONTRAST_DEF 0x20
46 #define CONTRAST_MAX 0x3f
47
48 __u8 brightness; /* rev72a only */
49 #define BRIGHTNESS_MIN 0
50 #define BRIGHTNESS_DEF 0x20
51 #define BRIGHTNESS_MAX 0x3f
52
53 __u8 white;
54 #define HUE_MIN 1
55 #define HUE_DEF 0x40
56 #define HUE_MAX 0x7f
57
58 __u8 autogain;
59 #define AUTOGAIN_MIN 0
60 #define AUTOGAIN_DEF 1
61 #define AUTOGAIN_MAX 1
62
63 __u8 gain; /* rev12a only */
64 #define GAIN_MIN 0
65 #define GAIN_DEF 63
66 #define GAIN_MAX 255
67
68 #define EXPO12A_DEF 3
69 __u8 expo12a; /* expo/gain? for rev 12a */
70
71 __u8 chip_revision;
72 #define Rev012A 0
73 #define Rev072A 1
74
75 signed char ag_cnt;
76 #define AG_CNT_START 13
77 };
78
79 static const struct v4l2_pix_format sif_012a_mode[] = {
80 {160, 120, V4L2_PIX_FMT_SGBRG8, V4L2_FIELD_NONE,
81 .bytesperline = 160,
82 .sizeimage = 160 * 120,
83 .colorspace = V4L2_COLORSPACE_SRGB,
84 .priv = 3},
85 {176, 144, V4L2_PIX_FMT_SGBRG8, V4L2_FIELD_NONE,
86 .bytesperline = 176,
87 .sizeimage = 176 * 144,
88 .colorspace = V4L2_COLORSPACE_SRGB,
89 .priv = 2},
90 {320, 240, V4L2_PIX_FMT_SPCA561, V4L2_FIELD_NONE,
91 .bytesperline = 320,
92 .sizeimage = 320 * 240 * 4 / 8,
93 .colorspace = V4L2_COLORSPACE_SRGB,
94 .priv = 1},
95 {352, 288, V4L2_PIX_FMT_SPCA561, V4L2_FIELD_NONE,
96 .bytesperline = 352,
97 .sizeimage = 352 * 288 * 4 / 8,
98 .colorspace = V4L2_COLORSPACE_SRGB,
99 .priv = 0},
100 };
101
102 static const struct v4l2_pix_format sif_072a_mode[] = {
103 {160, 120, V4L2_PIX_FMT_SGBRG8, V4L2_FIELD_NONE,
104 .bytesperline = 160,
105 .sizeimage = 160 * 120,
106 .colorspace = V4L2_COLORSPACE_SRGB,
107 .priv = 3},
108 {176, 144, V4L2_PIX_FMT_SGBRG8, V4L2_FIELD_NONE,
109 .bytesperline = 176,
110 .sizeimage = 176 * 144,
111 .colorspace = V4L2_COLORSPACE_SRGB,
112 .priv = 2},
113 {320, 240, V4L2_PIX_FMT_SGBRG8, V4L2_FIELD_NONE,
114 .bytesperline = 320,
115 .sizeimage = 320 * 240,
116 .colorspace = V4L2_COLORSPACE_SRGB,
117 .priv = 1},
118 {352, 288, V4L2_PIX_FMT_SGBRG8, V4L2_FIELD_NONE,
119 .bytesperline = 352,
120 .sizeimage = 352 * 288,
121 .colorspace = V4L2_COLORSPACE_SRGB,
122 .priv = 0},
123 };
124
125 /*
126 * Initialization data
127 * I'm not very sure how to split initialization from open data
128 * chunks. For now, we'll consider everything as initialization
129 */
130 /* Frame packet header offsets for the spca561 */
131 #define SPCA561_OFFSET_SNAP 1
132 #define SPCA561_OFFSET_TYPE 2
133 #define SPCA561_OFFSET_COMPRESS 3
134 #define SPCA561_OFFSET_FRAMSEQ 4
135 #define SPCA561_OFFSET_GPIO 5
136 #define SPCA561_OFFSET_USBBUFF 6
137 #define SPCA561_OFFSET_WIN2GRAVE 7
138 #define SPCA561_OFFSET_WIN2RAVE 8
139 #define SPCA561_OFFSET_WIN2BAVE 9
140 #define SPCA561_OFFSET_WIN2GBAVE 10
141 #define SPCA561_OFFSET_WIN1GRAVE 11
142 #define SPCA561_OFFSET_WIN1RAVE 12
143 #define SPCA561_OFFSET_WIN1BAVE 13
144 #define SPCA561_OFFSET_WIN1GBAVE 14
145 #define SPCA561_OFFSET_FREQ 15
146 #define SPCA561_OFFSET_VSYNC 16
147 #define SPCA561_INDEX_I2C_BASE 0x8800
148 #define SPCA561_SNAPBIT 0x20
149 #define SPCA561_SNAPCTRL 0x40
150
151 static const u16 rev72a_reset[][2] = {
152 {0x0000, 0x8114}, /* Software GPIO output data */
153 {0x0001, 0x8114}, /* Software GPIO output data */
154 {0x0000, 0x8112}, /* Some kind of reset */
155 {}
156 };
157 static const __u16 rev72a_init_data1[][2] = {
158 {0x0003, 0x8701}, /* PCLK clock delay adjustment */
159 {0x0001, 0x8703}, /* HSYNC from cmos inverted */
160 {0x0011, 0x8118}, /* Enable and conf sensor */
161 {0x0001, 0x8118}, /* Conf sensor */
162 {0x0092, 0x8804}, /* I know nothing about these */
163 {0x0010, 0x8802}, /* 0x88xx registers, so I won't */
164 {}
165 };
166 static const u16 rev72a_init_sensor1[][2] = {
167 {0x0001, 0x000d},
168 {0x0002, 0x0018},
169 {0x0004, 0x0165},
170 {0x0005, 0x0021},
171 {0x0007, 0x00aa},
172 {0x0020, 0x1504},
173 {0x0039, 0x0002},
174 {0x0035, 0x0010},
175 {0x0009, 0x1049},
176 {0x0028, 0x000b},
177 {0x003b, 0x000f},
178 {0x003c, 0x0000},
179 {}
180 };
181 static const __u16 rev72a_init_data2[][2] = {
182 {0x0018, 0x8601}, /* Pixel/line selection for color separation */
183 {0x0000, 0x8602}, /* Optical black level for user setting */
184 {0x0060, 0x8604}, /* Optical black horizontal offset */
185 {0x0002, 0x8605}, /* Optical black vertical offset */
186 {0x0000, 0x8603}, /* Non-automatic optical black level */
187 {0x0002, 0x865b}, /* Horizontal offset for valid pixels */
188 {0x0000, 0x865f}, /* Vertical valid pixels window (x2) */
189 {0x00b0, 0x865d}, /* Horizontal valid pixels window (x2) */
190 {0x0090, 0x865e}, /* Vertical valid lines window (x2) */
191 {0x00e0, 0x8406}, /* Memory buffer threshold */
192 {0x0000, 0x8660}, /* Compensation memory stuff */
193 {0x0002, 0x8201}, /* Output address for r/w serial EEPROM */
194 {0x0008, 0x8200}, /* Clear valid bit for serial EEPROM */
195 {0x0001, 0x8200}, /* OprMode to be executed by hardware */
196 /* from ms-win */
197 {0x0000, 0x8611}, /* R offset for white balance */
198 {0x00fd, 0x8612}, /* Gr offset for white balance */
199 {0x0003, 0x8613}, /* B offset for white balance */
200 {0x0000, 0x8614}, /* Gb offset for white balance */
201 /* from ms-win */
202 {0x0035, 0x8651}, /* R gain for white balance */
203 {0x0040, 0x8652}, /* Gr gain for white balance */
204 {0x005f, 0x8653}, /* B gain for white balance */
205 {0x0040, 0x8654}, /* Gb gain for white balance */
206 {0x0002, 0x8502}, /* Maximum average bit rate stuff */
207 {0x0011, 0x8802},
208
209 {0x0087, 0x8700}, /* Set master clock (96Mhz????) */
210 {0x0081, 0x8702}, /* Master clock output enable */
211
212 {0x0000, 0x8500}, /* Set image type (352x288 no compression) */
213 /* Originally was 0x0010 (352x288 compression) */
214
215 {0x0002, 0x865b}, /* Horizontal offset for valid pixels */
216 {0x0003, 0x865c}, /* Vertical offset for valid lines */
217 {}
218 };
219 static const u16 rev72a_init_sensor2[][2] = {
220 {0x0003, 0x0121},
221 {0x0004, 0x0165},
222 {0x0005, 0x002f}, /* blanking control column */
223 {0x0006, 0x0000}, /* blanking mode row*/
224 {0x000a, 0x0002},
225 {0x0009, 0x1061}, /* setexposure times && pixel clock
226 * 0001 0 | 000 0110 0001 */
227 {0x0035, 0x0014},
228 {}
229 };
230
231 /******************** QC Express etch2 stuff ********************/
232 static const __u16 Pb100_1map8300[][2] = {
233 /* reg, value */
234 {0x8320, 0x3304},
235
236 {0x8303, 0x0125}, /* image area */
237 {0x8304, 0x0169},
238 {0x8328, 0x000b},
239 {0x833c, 0x0001}, /*fixme: win:07*/
240
241 {0x832f, 0x1904}, /*fixme: was 0419*/
242 {0x8307, 0x00aa},
243 {0x8301, 0x0003},
244 {0x8302, 0x000e},
245 {}
246 };
247 static const __u16 Pb100_2map8300[][2] = {
248 /* reg, value */
249 {0x8339, 0x0000},
250 {0x8307, 0x00aa},
251 {}
252 };
253
254 static const __u16 spca561_161rev12A_data1[][2] = {
255 {0x29, 0x8118}, /* Control register (various enable bits) */
256 {0x08, 0x8114}, /* GPIO: Led off */
257 {0x0e, 0x8112}, /* 0x0e stream off 0x3e stream on */
258 {0x00, 0x8102}, /* white balance - new */
259 {0x92, 0x8804},
260 {0x04, 0x8802}, /* windows uses 08 */
261 {}
262 };
263 static const __u16 spca561_161rev12A_data2[][2] = {
264 {0x21, 0x8118},
265 {0x10, 0x8500},
266 {0x07, 0x8601},
267 {0x07, 0x8602},
268 {0x04, 0x8501},
269
270 {0x07, 0x8201}, /* windows uses 02 */
271 {0x08, 0x8200},
272 {0x01, 0x8200},
273
274 {0x90, 0x8604},
275 {0x00, 0x8605},
276 {0xb0, 0x8603},
277
278 /* sensor gains */
279 {0x07, 0x8601}, /* white balance - new */
280 {0x07, 0x8602}, /* white balance - new */
281 {0x00, 0x8610}, /* *red */
282 {0x00, 0x8611}, /* 3f *green */
283 {0x00, 0x8612}, /* green *blue */
284 {0x00, 0x8613}, /* blue *green */
285 {0x43, 0x8614}, /* green *red - white balance - was 0x35 */
286 {0x40, 0x8615}, /* 40 *green - white balance - was 0x35 */
287 {0x71, 0x8616}, /* 7a *blue - white balance - was 0x35 */
288 {0x40, 0x8617}, /* 40 *green - white balance - was 0x35 */
289
290 {0x0c, 0x8620}, /* 0c */
291 {0xc8, 0x8631}, /* c8 */
292 {0xc8, 0x8634}, /* c8 */
293 {0x23, 0x8635}, /* 23 */
294 {0x1f, 0x8636}, /* 1f */
295 {0xdd, 0x8637}, /* dd */
296 {0xe1, 0x8638}, /* e1 */
297 {0x1d, 0x8639}, /* 1d */
298 {0x21, 0x863a}, /* 21 */
299 {0xe3, 0x863b}, /* e3 */
300 {0xdf, 0x863c}, /* df */
301 {0xf0, 0x8505},
302 {0x32, 0x850a},
303 /* {0x99, 0x8700}, * - white balance - new (removed) */
304 /* HDG we used to do this in stop0, making the init state and the state
305 after a start / stop different, so do this here instead. */
306 {0x29, 0x8118},
307 {}
308 };
309
310 static void reg_w_val(struct usb_device *dev, __u16 index, __u8 value)
311 {
312 int ret;
313
314 ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
315 0, /* request */
316 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
317 value, index, NULL, 0, 500);
318 PDEBUG(D_USBO, "reg write: 0x%02x:0x%02x", index, value);
319 if (ret < 0)
320 pr_err("reg write: error %d\n", ret);
321 }
322
323 static void write_vector(struct gspca_dev *gspca_dev,
324 const __u16 data[][2])
325 {
326 struct usb_device *dev = gspca_dev->dev;
327 int i;
328
329 i = 0;
330 while (data[i][1] != 0) {
331 reg_w_val(dev, data[i][1], data[i][0]);
332 i++;
333 }
334 }
335
336 /* read 'len' bytes to gspca_dev->usb_buf */
337 static void reg_r(struct gspca_dev *gspca_dev,
338 __u16 index, __u16 length)
339 {
340 usb_control_msg(gspca_dev->dev,
341 usb_rcvctrlpipe(gspca_dev->dev, 0),
342 0, /* request */
343 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
344 0, /* value */
345 index, gspca_dev->usb_buf, length, 500);
346 }
347
348 /* write 'len' bytes from gspca_dev->usb_buf */
349 static void reg_w_buf(struct gspca_dev *gspca_dev,
350 __u16 index, __u16 len)
351 {
352 usb_control_msg(gspca_dev->dev,
353 usb_sndctrlpipe(gspca_dev->dev, 0),
354 0, /* request */
355 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
356 0, /* value */
357 index, gspca_dev->usb_buf, len, 500);
358 }
359
360 static void i2c_write(struct gspca_dev *gspca_dev, __u16 value, __u16 reg)
361 {
362 int retry = 60;
363
364 reg_w_val(gspca_dev->dev, 0x8801, reg);
365 reg_w_val(gspca_dev->dev, 0x8805, value);
366 reg_w_val(gspca_dev->dev, 0x8800, value >> 8);
367 do {
368 reg_r(gspca_dev, 0x8803, 1);
369 if (!gspca_dev->usb_buf[0])
370 return;
371 msleep(10);
372 } while (--retry);
373 }
374
375 static int i2c_read(struct gspca_dev *gspca_dev, __u16 reg, __u8 mode)
376 {
377 int retry = 60;
378 __u8 value;
379
380 reg_w_val(gspca_dev->dev, 0x8804, 0x92);
381 reg_w_val(gspca_dev->dev, 0x8801, reg);
382 reg_w_val(gspca_dev->dev, 0x8802, mode | 0x01);
383 do {
384 reg_r(gspca_dev, 0x8803, 1);
385 if (!gspca_dev->usb_buf[0]) {
386 reg_r(gspca_dev, 0x8800, 1);
387 value = gspca_dev->usb_buf[0];
388 reg_r(gspca_dev, 0x8805, 1);
389 return ((int) value << 8) | gspca_dev->usb_buf[0];
390 }
391 msleep(10);
392 } while (--retry);
393 return -1;
394 }
395
396 static void sensor_mapwrite(struct gspca_dev *gspca_dev,
397 const __u16 (*sensormap)[2])
398 {
399 while ((*sensormap)[0]) {
400 gspca_dev->usb_buf[0] = (*sensormap)[1];
401 gspca_dev->usb_buf[1] = (*sensormap)[1] >> 8;
402 reg_w_buf(gspca_dev, (*sensormap)[0], 2);
403 sensormap++;
404 }
405 }
406
407 static void write_sensor_72a(struct gspca_dev *gspca_dev,
408 const __u16 (*sensor)[2])
409 {
410 while ((*sensor)[0]) {
411 i2c_write(gspca_dev, (*sensor)[1], (*sensor)[0]);
412 sensor++;
413 }
414 }
415
416 static void init_161rev12A(struct gspca_dev *gspca_dev)
417 {
418 write_vector(gspca_dev, spca561_161rev12A_data1);
419 sensor_mapwrite(gspca_dev, Pb100_1map8300);
420 /*fixme: should be in sd_start*/
421 write_vector(gspca_dev, spca561_161rev12A_data2);
422 sensor_mapwrite(gspca_dev, Pb100_2map8300);
423 }
424
425 /* this function is called at probe time */
426 static int sd_config(struct gspca_dev *gspca_dev,
427 const struct usb_device_id *id)
428 {
429 struct sd *sd = (struct sd *) gspca_dev;
430 struct cam *cam;
431 __u16 vendor, product;
432 __u8 data1, data2;
433
434 /* Read frm global register the USB product and vendor IDs, just to
435 * prove that we can communicate with the device. This works, which
436 * confirms at we are communicating properly and that the device
437 * is a 561. */
438 reg_r(gspca_dev, 0x8104, 1);
439 data1 = gspca_dev->usb_buf[0];
440 reg_r(gspca_dev, 0x8105, 1);
441 data2 = gspca_dev->usb_buf[0];
442 vendor = (data2 << 8) | data1;
443 reg_r(gspca_dev, 0x8106, 1);
444 data1 = gspca_dev->usb_buf[0];
445 reg_r(gspca_dev, 0x8107, 1);
446 data2 = gspca_dev->usb_buf[0];
447 product = (data2 << 8) | data1;
448 if (vendor != id->idVendor || product != id->idProduct) {
449 PDEBUG(D_PROBE, "Bad vendor / product from device");
450 return -EINVAL;
451 }
452
453 cam = &gspca_dev->cam;
454 cam->needs_full_bandwidth = 1;
455
456 sd->chip_revision = id->driver_info;
457 if (sd->chip_revision == Rev012A) {
458 cam->cam_mode = sif_012a_mode;
459 cam->nmodes = ARRAY_SIZE(sif_012a_mode);
460 } else {
461 cam->cam_mode = sif_072a_mode;
462 cam->nmodes = ARRAY_SIZE(sif_072a_mode);
463 }
464 sd->brightness = BRIGHTNESS_DEF;
465 sd->contrast = CONTRAST_DEF;
466 sd->white = HUE_DEF;
467 sd->exposure = EXPOSURE_DEF;
468 sd->autogain = AUTOGAIN_DEF;
469 sd->gain = GAIN_DEF;
470 sd->expo12a = EXPO12A_DEF;
471 return 0;
472 }
473
474 /* this function is called at probe and resume time */
475 static int sd_init_12a(struct gspca_dev *gspca_dev)
476 {
477 PDEBUG(D_STREAM, "Chip revision: 012a");
478 init_161rev12A(gspca_dev);
479 return 0;
480 }
481 static int sd_init_72a(struct gspca_dev *gspca_dev)
482 {
483 PDEBUG(D_STREAM, "Chip revision: 072a");
484 write_vector(gspca_dev, rev72a_reset);
485 msleep(200);
486 write_vector(gspca_dev, rev72a_init_data1);
487 write_sensor_72a(gspca_dev, rev72a_init_sensor1);
488 write_vector(gspca_dev, rev72a_init_data2);
489 write_sensor_72a(gspca_dev, rev72a_init_sensor2);
490 reg_w_val(gspca_dev->dev, 0x8112, 0x30);
491 return 0;
492 }
493
494 /* rev 72a only */
495 static void setbrightness(struct gspca_dev *gspca_dev)
496 {
497 struct sd *sd = (struct sd *) gspca_dev;
498 struct usb_device *dev = gspca_dev->dev;
499 __u8 value;
500
501 value = sd->brightness;
502
503 /* offsets for white balance */
504 reg_w_val(dev, 0x8611, value); /* R */
505 reg_w_val(dev, 0x8612, value); /* Gr */
506 reg_w_val(dev, 0x8613, value); /* B */
507 reg_w_val(dev, 0x8614, value); /* Gb */
508 }
509
510 static void setwhite(struct gspca_dev *gspca_dev)
511 {
512 struct sd *sd = (struct sd *) gspca_dev;
513 __u16 white;
514 __u8 blue, red;
515 __u16 reg;
516
517 /* try to emulate MS-win as possible */
518 white = sd->white;
519 red = 0x20 + white * 3 / 8;
520 blue = 0x90 - white * 5 / 8;
521 if (sd->chip_revision == Rev012A) {
522 reg = 0x8614;
523 } else {
524 reg = 0x8651;
525 red += sd->contrast - 0x20;
526 blue += sd->contrast - 0x20;
527 }
528 reg_w_val(gspca_dev->dev, reg, red);
529 reg_w_val(gspca_dev->dev, reg + 2, blue);
530 }
531
532 static void setcontrast(struct gspca_dev *gspca_dev)
533 {
534 struct sd *sd = (struct sd *) gspca_dev;
535 struct usb_device *dev = gspca_dev->dev;
536 __u8 value;
537
538 if (sd->chip_revision != Rev072A)
539 return;
540 value = sd->contrast + 0x20;
541
542 /* gains for white balance */
543 setwhite(gspca_dev);
544 /* reg_w_val(dev, 0x8651, value); * R - done by setwhite */
545 reg_w_val(dev, 0x8652, value); /* Gr */
546 /* reg_w_val(dev, 0x8653, value); * B - done by setwhite */
547 reg_w_val(dev, 0x8654, value); /* Gb */
548 }
549
550 /* rev 12a only */
551 static void setexposure(struct gspca_dev *gspca_dev)
552 {
553 struct sd *sd = (struct sd *) gspca_dev;
554 int i, expo = 0;
555
556 /* Register 0x8309 controls exposure for the spca561,
557 the basic exposure setting goes from 1-2047, where 1 is completely
558 dark and 2047 is very bright. It not only influences exposure but
559 also the framerate (to allow for longer exposure) from 1 - 300 it
560 only raises the exposure time then from 300 - 600 it halves the
561 framerate to be able to further raise the exposure time and for every
562 300 more it halves the framerate again. This allows for a maximum
563 exposure time of circa 0.2 - 0.25 seconds (30 / (2000/3000) fps).
564 Sometimes this is not enough, the 1-2047 uses bits 0-10, bits 11-12
565 configure a divider for the base framerate which us used at the
566 exposure setting of 1-300. These bits configure the base framerate
567 according to the following formula: fps = 60 / (value + 2) */
568
569 /* We choose to use the high bits setting the fixed framerate divisor
570 asap, as setting high basic exposure setting without the fixed
571 divider in combination with high gains makes the cam stop */
572 int table[] = { 0, 450, 550, 625, EXPOSURE_MAX };
573
574 for (i = 0; i < ARRAY_SIZE(table) - 1; i++) {
575 if (sd->exposure <= table[i + 1]) {
576 expo = sd->exposure - table[i];
577 if (i)
578 expo += 300;
579 expo |= i << 11;
580 break;
581 }
582 }
583
584 gspca_dev->usb_buf[0] = expo;
585 gspca_dev->usb_buf[1] = expo >> 8;
586 reg_w_buf(gspca_dev, 0x8309, 2);
587 }
588
589 /* rev 12a only */
590 static void setgain(struct gspca_dev *gspca_dev)
591 {
592 struct sd *sd = (struct sd *) gspca_dev;
593
594 /* gain reg low 6 bits 0-63 gain, bit 6 and 7, both double the
595 sensitivity when set, so 31 + one of them set == 63, and 15
596 with both of them set == 63 */
597 if (sd->gain < 64)
598 gspca_dev->usb_buf[0] = sd->gain;
599 else if (sd->gain < 128)
600 gspca_dev->usb_buf[0] = (sd->gain / 2) | 0x40;
601 else
602 gspca_dev->usb_buf[0] = (sd->gain / 4) | 0xc0;
603
604 gspca_dev->usb_buf[1] = 0;
605 reg_w_buf(gspca_dev, 0x8335, 2);
606 }
607
608 static void setautogain(struct gspca_dev *gspca_dev)
609 {
610 struct sd *sd = (struct sd *) gspca_dev;
611
612 if (sd->autogain)
613 sd->ag_cnt = AG_CNT_START;
614 else
615 sd->ag_cnt = -1;
616 }
617
618 static int sd_start_12a(struct gspca_dev *gspca_dev)
619 {
620 struct usb_device *dev = gspca_dev->dev;
621 int mode;
622 static const __u8 Reg8391[8] =
623 {0x92, 0x30, 0x20, 0x00, 0x0c, 0x00, 0x00, 0x00};
624
625 mode = gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].priv;
626 if (mode <= 1) {
627 /* Use compression on 320x240 and above */
628 reg_w_val(dev, 0x8500, 0x10 | mode);
629 } else {
630 /* I couldn't get the compression to work below 320x240
631 * Fortunately at these resolutions the bandwidth
632 * is sufficient to push raw frames at ~20fps */
633 reg_w_val(dev, 0x8500, mode);
634 } /* -- qq@kuku.eu.org */
635
636 gspca_dev->usb_buf[0] = 0xaa;
637 gspca_dev->usb_buf[1] = 0x00;
638 reg_w_buf(gspca_dev, 0x8307, 2);
639 /* clock - lower 0x8X values lead to fps > 30 */
640 reg_w_val(gspca_dev->dev, 0x8700, 0x8a);
641 /* 0x8f 0x85 0x27 clock */
642 reg_w_val(gspca_dev->dev, 0x8112, 0x1e | 0x20);
643 reg_w_val(gspca_dev->dev, 0x850b, 0x03);
644 memcpy(gspca_dev->usb_buf, Reg8391, 8);
645 reg_w_buf(gspca_dev, 0x8391, 8);
646 reg_w_buf(gspca_dev, 0x8390, 8);
647 setwhite(gspca_dev);
648 setgain(gspca_dev);
649 setexposure(gspca_dev);
650
651 /* Led ON (bit 3 -> 0 */
652 reg_w_val(gspca_dev->dev, 0x8114, 0x00);
653 return 0;
654 }
655 static int sd_start_72a(struct gspca_dev *gspca_dev)
656 {
657 struct usb_device *dev = gspca_dev->dev;
658 int Clck;
659 int mode;
660
661 write_vector(gspca_dev, rev72a_reset);
662 msleep(200);
663 write_vector(gspca_dev, rev72a_init_data1);
664 write_sensor_72a(gspca_dev, rev72a_init_sensor1);
665
666 mode = gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].priv;
667 switch (mode) {
668 default:
669 case 0:
670 Clck = 0x27; /* ms-win 0x87 */
671 break;
672 case 1:
673 Clck = 0x25;
674 break;
675 case 2:
676 Clck = 0x22;
677 break;
678 case 3:
679 Clck = 0x21;
680 break;
681 }
682 reg_w_val(dev, 0x8700, Clck); /* 0x27 clock */
683 reg_w_val(dev, 0x8702, 0x81);
684 reg_w_val(dev, 0x8500, mode); /* mode */
685 write_sensor_72a(gspca_dev, rev72a_init_sensor2);
686 setcontrast(gspca_dev);
687 /* setbrightness(gspca_dev); * fixme: bad values */
688 setautogain(gspca_dev);
689 reg_w_val(dev, 0x8112, 0x10 | 0x20);
690 return 0;
691 }
692
693 static void sd_stopN(struct gspca_dev *gspca_dev)
694 {
695 struct sd *sd = (struct sd *) gspca_dev;
696
697 if (sd->chip_revision == Rev012A) {
698 reg_w_val(gspca_dev->dev, 0x8112, 0x0e);
699 /* Led Off (bit 3 -> 1 */
700 reg_w_val(gspca_dev->dev, 0x8114, 0x08);
701 } else {
702 reg_w_val(gspca_dev->dev, 0x8112, 0x20);
703 /* reg_w_val(gspca_dev->dev, 0x8102, 0x00); ?? */
704 }
705 }
706
707 static void do_autogain(struct gspca_dev *gspca_dev)
708 {
709 struct sd *sd = (struct sd *) gspca_dev;
710 int expotimes;
711 int pixelclk;
712 int gainG;
713 __u8 R, Gr, Gb, B;
714 int y;
715 __u8 luma_mean = 110;
716 __u8 luma_delta = 20;
717 __u8 spring = 4;
718
719 if (sd->ag_cnt < 0)
720 return;
721 if (--sd->ag_cnt >= 0)
722 return;
723 sd->ag_cnt = AG_CNT_START;
724
725 switch (sd->chip_revision) {
726 case Rev072A:
727 reg_r(gspca_dev, 0x8621, 1);
728 Gr = gspca_dev->usb_buf[0];
729 reg_r(gspca_dev, 0x8622, 1);
730 R = gspca_dev->usb_buf[0];
731 reg_r(gspca_dev, 0x8623, 1);
732 B = gspca_dev->usb_buf[0];
733 reg_r(gspca_dev, 0x8624, 1);
734 Gb = gspca_dev->usb_buf[0];
735 y = (77 * R + 75 * (Gr + Gb) + 29 * B) >> 8;
736 /* u= (128*B-(43*(Gr+Gb+R))) >> 8; */
737 /* v= (128*R-(53*(Gr+Gb))-21*B) >> 8; */
738 /* PDEBUG(D_CONF,"reading Y %d U %d V %d ",y,u,v); */
739
740 if (y < luma_mean - luma_delta ||
741 y > luma_mean + luma_delta) {
742 expotimes = i2c_read(gspca_dev, 0x09, 0x10);
743 pixelclk = 0x0800;
744 expotimes = expotimes & 0x07ff;
745 /* PDEBUG(D_PACK,
746 "Exposition Times 0x%03X Clock 0x%04X ",
747 expotimes,pixelclk); */
748 gainG = i2c_read(gspca_dev, 0x35, 0x10);
749 /* PDEBUG(D_PACK,
750 "reading Gain register %d", gainG); */
751
752 expotimes += (luma_mean - y) >> spring;
753 gainG += (luma_mean - y) / 50;
754 /* PDEBUG(D_PACK,
755 "compute expotimes %d gain %d",
756 expotimes,gainG); */
757
758 if (gainG > 0x3f)
759 gainG = 0x3f;
760 else if (gainG < 3)
761 gainG = 3;
762 i2c_write(gspca_dev, gainG, 0x35);
763
764 if (expotimes > 0x0256)
765 expotimes = 0x0256;
766 else if (expotimes < 3)
767 expotimes = 3;
768 i2c_write(gspca_dev, expotimes | pixelclk, 0x09);
769 }
770 break;
771 }
772 }
773
774 static void sd_pkt_scan(struct gspca_dev *gspca_dev,
775 u8 *data, /* isoc packet */
776 int len) /* iso packet length */
777 {
778 struct sd *sd = (struct sd *) gspca_dev;
779
780 len--;
781 switch (*data++) { /* sequence number */
782 case 0: /* start of frame */
783 gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0);
784
785 /* This should never happen */
786 if (len < 2) {
787 PDEBUG(D_ERR, "Short SOF packet, ignoring");
788 gspca_dev->last_packet_type = DISCARD_PACKET;
789 return;
790 }
791
792 #if defined(CONFIG_INPUT) || defined(CONFIG_INPUT_MODULE)
793 if (data[0] & 0x20) {
794 input_report_key(gspca_dev->input_dev, KEY_CAMERA, 1);
795 input_sync(gspca_dev->input_dev);
796 input_report_key(gspca_dev->input_dev, KEY_CAMERA, 0);
797 input_sync(gspca_dev->input_dev);
798 }
799 #endif
800
801 if (data[1] & 0x10) {
802 /* compressed bayer */
803 gspca_frame_add(gspca_dev, FIRST_PACKET, data, len);
804 } else {
805 /* raw bayer (with a header, which we skip) */
806 if (sd->chip_revision == Rev012A) {
807 data += 20;
808 len -= 20;
809 } else {
810 data += 16;
811 len -= 16;
812 }
813 gspca_frame_add(gspca_dev, FIRST_PACKET, data, len);
814 }
815 return;
816 case 0xff: /* drop (empty mpackets) */
817 return;
818 }
819 gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
820 }
821
822 /* rev 72a only */
823 static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val)
824 {
825 struct sd *sd = (struct sd *) gspca_dev;
826
827 sd->brightness = val;
828 if (gspca_dev->streaming)
829 setbrightness(gspca_dev);
830 return 0;
831 }
832
833 static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val)
834 {
835 struct sd *sd = (struct sd *) gspca_dev;
836
837 *val = sd->brightness;
838 return 0;
839 }
840
841 /* rev 72a only */
842 static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val)
843 {
844 struct sd *sd = (struct sd *) gspca_dev;
845
846 sd->contrast = val;
847 if (gspca_dev->streaming)
848 setcontrast(gspca_dev);
849 return 0;
850 }
851
852 static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val)
853 {
854 struct sd *sd = (struct sd *) gspca_dev;
855
856 *val = sd->contrast;
857 return 0;
858 }
859
860 static int sd_setautogain(struct gspca_dev *gspca_dev, __s32 val)
861 {
862 struct sd *sd = (struct sd *) gspca_dev;
863
864 sd->autogain = val;
865 if (gspca_dev->streaming)
866 setautogain(gspca_dev);
867 return 0;
868 }
869
870 static int sd_getautogain(struct gspca_dev *gspca_dev, __s32 *val)
871 {
872 struct sd *sd = (struct sd *) gspca_dev;
873
874 *val = sd->autogain;
875 return 0;
876 }
877
878 static int sd_setwhite(struct gspca_dev *gspca_dev, __s32 val)
879 {
880 struct sd *sd = (struct sd *) gspca_dev;
881
882 sd->white = val;
883 if (gspca_dev->streaming)
884 setwhite(gspca_dev);
885 return 0;
886 }
887
888 static int sd_getwhite(struct gspca_dev *gspca_dev, __s32 *val)
889 {
890 struct sd *sd = (struct sd *) gspca_dev;
891
892 *val = sd->white;
893 return 0;
894 }
895
896 /* rev12a only */
897 static int sd_setexposure(struct gspca_dev *gspca_dev, __s32 val)
898 {
899 struct sd *sd = (struct sd *) gspca_dev;
900
901 sd->exposure = val;
902 if (gspca_dev->streaming)
903 setexposure(gspca_dev);
904 return 0;
905 }
906
907 static int sd_getexposure(struct gspca_dev *gspca_dev, __s32 *val)
908 {
909 struct sd *sd = (struct sd *) gspca_dev;
910
911 *val = sd->exposure;
912 return 0;
913 }
914
915 /* rev12a only */
916 static int sd_setgain(struct gspca_dev *gspca_dev, __s32 val)
917 {
918 struct sd *sd = (struct sd *) gspca_dev;
919
920 sd->gain = val;
921 if (gspca_dev->streaming)
922 setgain(gspca_dev);
923 return 0;
924 }
925
926 static int sd_getgain(struct gspca_dev *gspca_dev, __s32 *val)
927 {
928 struct sd *sd = (struct sd *) gspca_dev;
929
930 *val = sd->gain;
931 return 0;
932 }
933
934 /* control tables */
935 static const struct ctrl sd_ctrls_12a[] = {
936 {
937 {
938 .id = V4L2_CID_HUE,
939 .type = V4L2_CTRL_TYPE_INTEGER,
940 .name = "Hue",
941 .minimum = HUE_MIN,
942 .maximum = HUE_MAX,
943 .step = 1,
944 .default_value = HUE_DEF,
945 },
946 .set = sd_setwhite,
947 .get = sd_getwhite,
948 },
949 {
950 {
951 .id = V4L2_CID_EXPOSURE,
952 .type = V4L2_CTRL_TYPE_INTEGER,
953 .name = "Exposure",
954 .minimum = EXPOSURE_MIN,
955 .maximum = EXPOSURE_MAX,
956 .step = 1,
957 .default_value = EXPOSURE_DEF,
958 },
959 .set = sd_setexposure,
960 .get = sd_getexposure,
961 },
962 {
963 {
964 .id = V4L2_CID_GAIN,
965 .type = V4L2_CTRL_TYPE_INTEGER,
966 .name = "Gain",
967 .minimum = GAIN_MIN,
968 .maximum = GAIN_MAX,
969 .step = 1,
970 .default_value = GAIN_DEF,
971 },
972 .set = sd_setgain,
973 .get = sd_getgain,
974 },
975 };
976
977 static const struct ctrl sd_ctrls_72a[] = {
978 {
979 {
980 .id = V4L2_CID_HUE,
981 .type = V4L2_CTRL_TYPE_INTEGER,
982 .name = "Hue",
983 .minimum = HUE_MIN,
984 .maximum = HUE_MAX,
985 .step = 1,
986 .default_value = HUE_DEF,
987 },
988 .set = sd_setwhite,
989 .get = sd_getwhite,
990 },
991 {
992 {
993 .id = V4L2_CID_BRIGHTNESS,
994 .type = V4L2_CTRL_TYPE_INTEGER,
995 .name = "Brightness",
996 .minimum = BRIGHTNESS_MIN,
997 .maximum = BRIGHTNESS_MAX,
998 .step = 1,
999 .default_value = BRIGHTNESS_DEF,
1000 },
1001 .set = sd_setbrightness,
1002 .get = sd_getbrightness,
1003 },
1004 {
1005 {
1006 .id = V4L2_CID_CONTRAST,
1007 .type = V4L2_CTRL_TYPE_INTEGER,
1008 .name = "Contrast",
1009 .minimum = CONTRAST_MIN,
1010 .maximum = CONTRAST_MAX,
1011 .step = 1,
1012 .default_value = CONTRAST_DEF,
1013 },
1014 .set = sd_setcontrast,
1015 .get = sd_getcontrast,
1016 },
1017 {
1018 {
1019 .id = V4L2_CID_AUTOGAIN,
1020 .type = V4L2_CTRL_TYPE_BOOLEAN,
1021 .name = "Auto Gain",
1022 .minimum = AUTOGAIN_MIN,
1023 .maximum = AUTOGAIN_MAX,
1024 .step = 1,
1025 .default_value = AUTOGAIN_DEF,
1026 },
1027 .set = sd_setautogain,
1028 .get = sd_getautogain,
1029 },
1030 };
1031
1032 /* sub-driver description */
1033 static const struct sd_desc sd_desc_12a = {
1034 .name = MODULE_NAME,
1035 .ctrls = sd_ctrls_12a,
1036 .nctrls = ARRAY_SIZE(sd_ctrls_12a),
1037 .config = sd_config,
1038 .init = sd_init_12a,
1039 .start = sd_start_12a,
1040 .stopN = sd_stopN,
1041 .pkt_scan = sd_pkt_scan,
1042 #if defined(CONFIG_INPUT) || defined(CONFIG_INPUT_MODULE)
1043 .other_input = 1,
1044 #endif
1045 };
1046 static const struct sd_desc sd_desc_72a = {
1047 .name = MODULE_NAME,
1048 .ctrls = sd_ctrls_72a,
1049 .nctrls = ARRAY_SIZE(sd_ctrls_72a),
1050 .config = sd_config,
1051 .init = sd_init_72a,
1052 .start = sd_start_72a,
1053 .stopN = sd_stopN,
1054 .pkt_scan = sd_pkt_scan,
1055 .dq_callback = do_autogain,
1056 #if defined(CONFIG_INPUT) || defined(CONFIG_INPUT_MODULE)
1057 .other_input = 1,
1058 #endif
1059 };
1060 static const struct sd_desc *sd_desc[2] = {
1061 &sd_desc_12a,
1062 &sd_desc_72a
1063 };
1064
1065 /* -- module initialisation -- */
1066 static const struct usb_device_id device_table[] = {
1067 {USB_DEVICE(0x041e, 0x401a), .driver_info = Rev072A},
1068 {USB_DEVICE(0x041e, 0x403b), .driver_info = Rev012A},
1069 {USB_DEVICE(0x0458, 0x7004), .driver_info = Rev072A},
1070 {USB_DEVICE(0x0461, 0x0815), .driver_info = Rev072A},
1071 {USB_DEVICE(0x046d, 0x0928), .driver_info = Rev012A},
1072 {USB_DEVICE(0x046d, 0x0929), .driver_info = Rev012A},
1073 {USB_DEVICE(0x046d, 0x092a), .driver_info = Rev012A},
1074 {USB_DEVICE(0x046d, 0x092b), .driver_info = Rev012A},
1075 {USB_DEVICE(0x046d, 0x092c), .driver_info = Rev012A},
1076 {USB_DEVICE(0x046d, 0x092d), .driver_info = Rev012A},
1077 {USB_DEVICE(0x046d, 0x092e), .driver_info = Rev012A},
1078 {USB_DEVICE(0x046d, 0x092f), .driver_info = Rev012A},
1079 {USB_DEVICE(0x04fc, 0x0561), .driver_info = Rev072A},
1080 {USB_DEVICE(0x060b, 0xa001), .driver_info = Rev072A},
1081 {USB_DEVICE(0x10fd, 0x7e50), .driver_info = Rev072A},
1082 {USB_DEVICE(0xabcd, 0xcdee), .driver_info = Rev072A},
1083 {}
1084 };
1085
1086 MODULE_DEVICE_TABLE(usb, device_table);
1087
1088 /* -- device connect -- */
1089 static int sd_probe(struct usb_interface *intf,
1090 const struct usb_device_id *id)
1091 {
1092 return gspca_dev_probe(intf, id,
1093 sd_desc[id->driver_info],
1094 sizeof(struct sd),
1095 THIS_MODULE);
1096 }
1097
1098 static struct usb_driver sd_driver = {
1099 .name = MODULE_NAME,
1100 .id_table = device_table,
1101 .probe = sd_probe,
1102 .disconnect = gspca_disconnect,
1103 #ifdef CONFIG_PM
1104 .suspend = gspca_suspend,
1105 .resume = gspca_resume,
1106 #endif
1107 };
1108
1109 module_usb_driver(sd_driver);