2 * Copyright (c) 2001 Jean-Fredric Clere, Nikolas Zimmermann, Georg Acher
3 * Mark Cave-Ayland, Carlo E Prelz, Dick Streefland
4 * Copyright (c) 2002, 2003 Tuukka Toivonen
5 * Copyright (c) 2008 Erik Andrén
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21 * P/N 861037: Sensor HDCS1000 ASIC STV0600
22 * P/N 861050-0010: Sensor HDCS1000 ASIC STV0600
23 * P/N 861050-0020: Sensor Photobit PB100 ASIC STV0600-1 - QuickCam Express
24 * P/N 861055: Sensor ST VV6410 ASIC STV0610 - LEGO cam
25 * P/N 861075-0040: Sensor HDCS1000 ASIC
26 * P/N 961179-0700: Sensor ST VV6410 ASIC STV0602 - Dexxa WebCam USB
27 * P/N 861040-0000: Sensor ST VV6410 ASIC STV0610 - QuickCam Web
31 * The spec file for the PB-0100 suggests the following for best quality
32 * images after the sensor has been reset :
34 * PB_ADCGAINL = R60 = 0x03 (3 dec) : sets low reference of ADC
35 to produce good black level
36 * PB_PREADCTRL = R32 = 0x1400 (5120 dec) : Enables global gain changes
38 * PB_ADCMINGAIN = R52 = 0x10 (16 dec) : Sets the minimum gain for
40 * PB_ADCGLOBALGAIN = R53 = 0x10 (16 dec) : Sets the global gain
41 * PB_EXPGAIN = R14 = 0x11 (17 dec) : Sets the auto-exposure value
42 * PB_UPDATEINT = R23 = 0x02 (2 dec) : Sets the speed on
44 * PB_CFILLIN = R5 = 0x0E (14 dec) : Sets the frame rate
47 #include "stv06xx_pb0100.h"
49 static const struct ctrl pb0100_ctrl
[] = {
54 .type
= V4L2_CTRL_TYPE_INTEGER
,
61 .set
= pb0100_set_gain
,
62 .get
= pb0100_get_gain
64 #define RED_BALANCE_IDX 1
67 .id
= V4L2_CID_RED_BALANCE
,
68 .type
= V4L2_CTRL_TYPE_INTEGER
,
69 .name
= "Red Balance",
75 .set
= pb0100_set_red_balance
,
76 .get
= pb0100_get_red_balance
78 #define BLUE_BALANCE_IDX 2
81 .id
= V4L2_CID_BLUE_BALANCE
,
82 .type
= V4L2_CTRL_TYPE_INTEGER
,
83 .name
= "Blue Balance",
89 .set
= pb0100_set_blue_balance
,
90 .get
= pb0100_get_blue_balance
92 #define EXPOSURE_IDX 3
95 .id
= V4L2_CID_EXPOSURE
,
96 .type
= V4L2_CTRL_TYPE_INTEGER
,
103 .set
= pb0100_set_exposure
,
104 .get
= pb0100_get_exposure
106 #define AUTOGAIN_IDX 4
109 .id
= V4L2_CID_AUTOGAIN
,
110 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
111 .name
= "Automatic Gain and Exposure",
117 .set
= pb0100_set_autogain
,
118 .get
= pb0100_get_autogain
120 #define AUTOGAIN_TARGET_IDX 5
123 .id
= V4L2_CTRL_CLASS_USER
+ 0x1000,
124 .type
= V4L2_CTRL_TYPE_INTEGER
,
125 .name
= "Automatic Gain Target",
131 .set
= pb0100_set_autogain_target
,
132 .get
= pb0100_get_autogain_target
134 #define NATURAL_IDX 6
137 .id
= V4L2_CTRL_CLASS_USER
+ 0x1001,
138 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
139 .name
= "Natural Light Source",
145 .set
= pb0100_set_natural
,
146 .get
= pb0100_get_natural
150 static struct v4l2_pix_format pb0100_mode
[] = {
151 /* low res / subsample modes disabled as they are only half res horizontal,
152 halving the vertical resolution does not seem to work */
158 .sizeimage
= 320 * 240,
160 .colorspace
= V4L2_COLORSPACE_SRGB
,
161 .priv
= PB0100_CROP_TO_VGA
168 .sizeimage
= 352 * 288,
170 .colorspace
= V4L2_COLORSPACE_SRGB
,
175 static int pb0100_probe(struct sd
*sd
)
179 s32
*sensor_settings
;
181 err
= stv06xx_read_sensor(sd
, PB_IDENT
, &sensor
);
186 if ((sensor
>> 8) == 0x64) {
187 sensor_settings
= kmalloc(
188 ARRAY_SIZE(pb0100_ctrl
) * sizeof(s32
),
190 if (!sensor_settings
)
193 info("Photobit pb0100 sensor detected");
195 sd
->gspca_dev
.cam
.cam_mode
= pb0100_mode
;
196 sd
->gspca_dev
.cam
.nmodes
= ARRAY_SIZE(pb0100_mode
);
197 sd
->desc
.ctrls
= pb0100_ctrl
;
198 sd
->desc
.nctrls
= ARRAY_SIZE(pb0100_ctrl
);
199 for (i
= 0; i
< sd
->desc
.nctrls
; i
++)
200 sensor_settings
[i
] = pb0100_ctrl
[i
].qctrl
.default_value
;
201 sd
->sensor_priv
= sensor_settings
;
209 static int pb0100_start(struct sd
*sd
)
212 struct cam
*cam
= &sd
->gspca_dev
.cam
;
213 s32
*sensor_settings
= sd
->sensor_priv
;
214 u32 mode
= cam
->cam_mode
[sd
->gspca_dev
.curr_mode
].priv
;
216 /* Setup sensor window */
217 if (mode
& PB0100_CROP_TO_VGA
) {
218 stv06xx_write_sensor(sd
, PB_RSTART
, 30);
219 stv06xx_write_sensor(sd
, PB_CSTART
, 20);
220 stv06xx_write_sensor(sd
, PB_RWSIZE
, 240 - 1);
221 stv06xx_write_sensor(sd
, PB_CWSIZE
, 320 - 1);
223 stv06xx_write_sensor(sd
, PB_RSTART
, 8);
224 stv06xx_write_sensor(sd
, PB_CSTART
, 4);
225 stv06xx_write_sensor(sd
, PB_RWSIZE
, 288 - 1);
226 stv06xx_write_sensor(sd
, PB_CWSIZE
, 352 - 1);
229 if (mode
& PB0100_SUBSAMPLE
) {
230 stv06xx_write_bridge(sd
, STV_Y_CTRL
, 0x02);
231 stv06xx_write_bridge(sd
, STV_X_CTRL
, 0x06);
233 stv06xx_write_bridge(sd
, STV_SCAN_RATE
, 0x10);
235 stv06xx_write_bridge(sd
, STV_Y_CTRL
, 0x01);
236 stv06xx_write_bridge(sd
, STV_X_CTRL
, 0x0a);
237 /* larger -> slower */
238 stv06xx_write_bridge(sd
, STV_SCAN_RATE
, 0x20);
241 /* set_gain also sets red and blue balance */
242 pb0100_set_gain(&sd
->gspca_dev
, sensor_settings
[GAIN_IDX
]);
243 pb0100_set_exposure(&sd
->gspca_dev
, sensor_settings
[EXPOSURE_IDX
]);
244 pb0100_set_autogain_target(&sd
->gspca_dev
,
245 sensor_settings
[AUTOGAIN_TARGET_IDX
]);
246 pb0100_set_autogain(&sd
->gspca_dev
, sensor_settings
[AUTOGAIN_IDX
]);
248 err
= stv06xx_write_sensor(sd
, PB_CONTROL
, BIT(5)|BIT(3)|BIT(1));
249 PDEBUG(D_STREAM
, "Started stream, status: %d", err
);
251 return (err
< 0) ? err
: 0;
254 static int pb0100_stop(struct sd
*sd
)
258 err
= stv06xx_write_sensor(sd
, PB_ABORTFRAME
, 1);
263 /* Set bit 1 to zero */
264 err
= stv06xx_write_sensor(sd
, PB_CONTROL
, BIT(5)|BIT(3));
266 PDEBUG(D_STREAM
, "Halting stream");
268 return (err
< 0) ? err
: 0;
271 static void pb0100_disconnect(struct sd
*sd
)
274 kfree(sd
->sensor_priv
);
277 static int pb0100_init(struct sd
*sd
)
279 stv06xx_write_bridge(sd
, STV_REG00
, 1);
280 stv06xx_write_bridge(sd
, STV_SCAN_RATE
, 0);
283 stv06xx_write_sensor(sd
, PB_RESET
, 1);
284 stv06xx_write_sensor(sd
, PB_RESET
, 0);
287 stv06xx_write_sensor(sd
, PB_CONTROL
, BIT(5)|BIT(3));
290 stv06xx_write_sensor(sd
, PB_PREADCTRL
, BIT(12)|BIT(10)|BIT(6));
291 stv06xx_write_sensor(sd
, PB_ADCGLOBALGAIN
, 12);
293 /* Set up auto-exposure */
294 /* ADC VREF_HI new setting for a transition
295 from the Expose1 to the Expose2 setting */
296 stv06xx_write_sensor(sd
, PB_R28
, 12);
297 /* gain max for autoexposure */
298 stv06xx_write_sensor(sd
, PB_ADCMAXGAIN
, 180);
299 /* gain min for autoexposure */
300 stv06xx_write_sensor(sd
, PB_ADCMINGAIN
, 12);
301 /* Maximum frame integration time (programmed into R8)
302 allowed for auto-exposure routine */
303 stv06xx_write_sensor(sd
, PB_R54
, 3);
304 /* Minimum frame integration time (programmed into R8)
305 allowed for auto-exposure routine */
306 stv06xx_write_sensor(sd
, PB_R55
, 0);
307 stv06xx_write_sensor(sd
, PB_UPDATEINT
, 1);
308 /* R15 Expose0 (maximum that auto-exposure may use) */
309 stv06xx_write_sensor(sd
, PB_R15
, 800);
310 /* R17 Expose2 (minimum that auto-exposure may use) */
311 stv06xx_write_sensor(sd
, PB_R17
, 10);
313 stv06xx_write_sensor(sd
, PB_EXPGAIN
, 0);
316 stv06xx_write_sensor(sd
, PB_VOFFSET
, 0);
318 stv06xx_write_sensor(sd
, PB_ADCGAINH
, 11);
319 /* Set black level (important!) */
320 stv06xx_write_sensor(sd
, PB_ADCGAINL
, 0);
323 stv06xx_write_bridge(sd
, STV_REG00
, 0x11);
324 stv06xx_write_bridge(sd
, STV_REG03
, 0x45);
325 stv06xx_write_bridge(sd
, STV_REG04
, 0x07);
327 /* ISO-Size (0x27b: 635... why? - HDCS uses 847) */
328 stv06xx_write_bridge(sd
, STV_ISO_SIZE_L
, 847);
330 /* Scan/timing for the sensor */
331 stv06xx_write_sensor(sd
, PB_ROWSPEED
, BIT(4)|BIT(3)|BIT(1));
332 stv06xx_write_sensor(sd
, PB_CFILLIN
, 14);
333 stv06xx_write_sensor(sd
, PB_VBL
, 0);
334 stv06xx_write_sensor(sd
, PB_FINTTIME
, 0);
335 stv06xx_write_sensor(sd
, PB_RINTTIME
, 123);
337 stv06xx_write_bridge(sd
, STV_REG01
, 0xc2);
338 stv06xx_write_bridge(sd
, STV_REG02
, 0xb0);
342 static int pb0100_dump(struct sd
*sd
)
347 static int pb0100_get_gain(struct gspca_dev
*gspca_dev
, __s32
*val
)
349 struct sd
*sd
= (struct sd
*) gspca_dev
;
350 s32
*sensor_settings
= sd
->sensor_priv
;
352 *val
= sensor_settings
[GAIN_IDX
];
357 static int pb0100_set_gain(struct gspca_dev
*gspca_dev
, __s32 val
)
360 struct sd
*sd
= (struct sd
*) gspca_dev
;
361 s32
*sensor_settings
= sd
->sensor_priv
;
363 if (sensor_settings
[AUTOGAIN_IDX
])
366 sensor_settings
[GAIN_IDX
] = val
;
367 err
= stv06xx_write_sensor(sd
, PB_G1GAIN
, val
);
369 err
= stv06xx_write_sensor(sd
, PB_G2GAIN
, val
);
370 PDEBUG(D_V4L2
, "Set green gain to %d, status: %d", val
, err
);
373 err
= pb0100_set_red_balance(gspca_dev
,
374 sensor_settings
[RED_BALANCE_IDX
]);
376 err
= pb0100_set_blue_balance(gspca_dev
,
377 sensor_settings
[BLUE_BALANCE_IDX
]);
382 static int pb0100_get_red_balance(struct gspca_dev
*gspca_dev
, __s32
*val
)
384 struct sd
*sd
= (struct sd
*) gspca_dev
;
385 s32
*sensor_settings
= sd
->sensor_priv
;
387 *val
= sensor_settings
[RED_BALANCE_IDX
];
392 static int pb0100_set_red_balance(struct gspca_dev
*gspca_dev
, __s32 val
)
395 struct sd
*sd
= (struct sd
*) gspca_dev
;
396 s32
*sensor_settings
= sd
->sensor_priv
;
398 if (sensor_settings
[AUTOGAIN_IDX
])
401 sensor_settings
[RED_BALANCE_IDX
] = val
;
402 val
+= sensor_settings
[GAIN_IDX
];
408 err
= stv06xx_write_sensor(sd
, PB_RGAIN
, val
);
409 PDEBUG(D_V4L2
, "Set red gain to %d, status: %d", val
, err
);
414 static int pb0100_get_blue_balance(struct gspca_dev
*gspca_dev
, __s32
*val
)
416 struct sd
*sd
= (struct sd
*) gspca_dev
;
417 s32
*sensor_settings
= sd
->sensor_priv
;
419 *val
= sensor_settings
[BLUE_BALANCE_IDX
];
424 static int pb0100_set_blue_balance(struct gspca_dev
*gspca_dev
, __s32 val
)
427 struct sd
*sd
= (struct sd
*) gspca_dev
;
428 s32
*sensor_settings
= sd
->sensor_priv
;
430 if (sensor_settings
[AUTOGAIN_IDX
])
433 sensor_settings
[BLUE_BALANCE_IDX
] = val
;
434 val
+= sensor_settings
[GAIN_IDX
];
440 err
= stv06xx_write_sensor(sd
, PB_BGAIN
, val
);
441 PDEBUG(D_V4L2
, "Set blue gain to %d, status: %d", val
, err
);
446 static int pb0100_get_exposure(struct gspca_dev
*gspca_dev
, __s32
*val
)
448 struct sd
*sd
= (struct sd
*) gspca_dev
;
449 s32
*sensor_settings
= sd
->sensor_priv
;
451 *val
= sensor_settings
[EXPOSURE_IDX
];
456 static int pb0100_set_exposure(struct gspca_dev
*gspca_dev
, __s32 val
)
459 struct sd
*sd
= (struct sd
*) gspca_dev
;
460 s32
*sensor_settings
= sd
->sensor_priv
;
462 if (sensor_settings
[AUTOGAIN_IDX
])
465 sensor_settings
[EXPOSURE_IDX
] = val
;
466 err
= stv06xx_write_sensor(sd
, PB_RINTTIME
, val
);
467 PDEBUG(D_V4L2
, "Set exposure to %d, status: %d", val
, err
);
472 static int pb0100_get_autogain(struct gspca_dev
*gspca_dev
, __s32
*val
)
474 struct sd
*sd
= (struct sd
*) gspca_dev
;
475 s32
*sensor_settings
= sd
->sensor_priv
;
477 *val
= sensor_settings
[AUTOGAIN_IDX
];
482 static int pb0100_set_autogain(struct gspca_dev
*gspca_dev
, __s32 val
)
485 struct sd
*sd
= (struct sd
*) gspca_dev
;
486 s32
*sensor_settings
= sd
->sensor_priv
;
488 sensor_settings
[AUTOGAIN_IDX
] = val
;
489 if (sensor_settings
[AUTOGAIN_IDX
]) {
490 if (sensor_settings
[NATURAL_IDX
])
491 val
= BIT(6)|BIT(4)|BIT(0);
497 err
= stv06xx_write_sensor(sd
, PB_EXPGAIN
, val
);
498 PDEBUG(D_V4L2
, "Set autogain to %d (natural: %d), status: %d",
499 sensor_settings
[AUTOGAIN_IDX
], sensor_settings
[NATURAL_IDX
],
505 static int pb0100_get_autogain_target(struct gspca_dev
*gspca_dev
, __s32
*val
)
507 struct sd
*sd
= (struct sd
*) gspca_dev
;
508 s32
*sensor_settings
= sd
->sensor_priv
;
510 *val
= sensor_settings
[AUTOGAIN_TARGET_IDX
];
515 static int pb0100_set_autogain_target(struct gspca_dev
*gspca_dev
, __s32 val
)
517 int err
, totalpixels
, brightpixels
, darkpixels
;
518 struct sd
*sd
= (struct sd
*) gspca_dev
;
519 s32
*sensor_settings
= sd
->sensor_priv
;
521 sensor_settings
[AUTOGAIN_TARGET_IDX
] = val
;
523 /* Number of pixels counted by the sensor when subsampling the pixels.
524 * Slightly larger than the real value to avoid oscillation */
525 totalpixels
= gspca_dev
->width
* gspca_dev
->height
;
526 totalpixels
= totalpixels
/(8*8) + totalpixels
/(64*64);
528 brightpixels
= (totalpixels
* val
) >> 8;
529 darkpixels
= totalpixels
- brightpixels
;
530 err
= stv06xx_write_sensor(sd
, PB_R21
, brightpixels
);
532 err
= stv06xx_write_sensor(sd
, PB_R22
, darkpixels
);
534 PDEBUG(D_V4L2
, "Set autogain target to %d, status: %d", val
, err
);
539 static int pb0100_get_natural(struct gspca_dev
*gspca_dev
, __s32
*val
)
541 struct sd
*sd
= (struct sd
*) gspca_dev
;
542 s32
*sensor_settings
= sd
->sensor_priv
;
544 *val
= sensor_settings
[NATURAL_IDX
];
549 static int pb0100_set_natural(struct gspca_dev
*gspca_dev
, __s32 val
)
551 struct sd
*sd
= (struct sd
*) gspca_dev
;
552 s32
*sensor_settings
= sd
->sensor_priv
;
554 sensor_settings
[NATURAL_IDX
] = val
;
556 return pb0100_set_autogain(gspca_dev
, sensor_settings
[AUTOGAIN_IDX
]);