Loading...
1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * Copyright (c) 2001 Jean-Fredric Clere, Nikolas Zimmermann, Georg Acher
4 * Mark Cave-Ayland, Carlo E Prelz, Dick Streefland
5 * Copyright (c) 2002, 2003 Tuukka Toivonen
6 * Copyright (c) 2008 Erik Andrén
7 *
8 * P/N 861037: Sensor HDCS1000 ASIC STV0600
9 * P/N 861050-0010: Sensor HDCS1000 ASIC STV0600
10 * P/N 861050-0020: Sensor Photobit PB100 ASIC STV0600-1 - QuickCam Express
11 * P/N 861055: Sensor ST VV6410 ASIC STV0610 - LEGO cam
12 * P/N 861075-0040: Sensor HDCS1000 ASIC
13 * P/N 961179-0700: Sensor ST VV6410 ASIC STV0602 - Dexxa WebCam USB
14 * P/N 861040-0000: Sensor ST VV6410 ASIC STV0610 - QuickCam Web
15 */
16
17/*
18 * The spec file for the PB-0100 suggests the following for best quality
19 * images after the sensor has been reset :
20 *
21 * PB_ADCGAINL = R60 = 0x03 (3 dec) : sets low reference of ADC
22 to produce good black level
23 * PB_PREADCTRL = R32 = 0x1400 (5120 dec) : Enables global gain changes
24 through R53
25 * PB_ADCMINGAIN = R52 = 0x10 (16 dec) : Sets the minimum gain for
26 auto-exposure
27 * PB_ADCGLOBALGAIN = R53 = 0x10 (16 dec) : Sets the global gain
28 * PB_EXPGAIN = R14 = 0x11 (17 dec) : Sets the auto-exposure value
29 * PB_UPDATEINT = R23 = 0x02 (2 dec) : Sets the speed on
30 auto-exposure routine
31 * PB_CFILLIN = R5 = 0x0E (14 dec) : Sets the frame rate
32 */
33
34#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
35
36#include "stv06xx_pb0100.h"
37
38struct pb0100_ctrls {
39 struct { /* one big happy control cluster... */
40 struct v4l2_ctrl *autogain;
41 struct v4l2_ctrl *gain;
42 struct v4l2_ctrl *exposure;
43 struct v4l2_ctrl *red;
44 struct v4l2_ctrl *blue;
45 struct v4l2_ctrl *natural;
46 };
47 struct v4l2_ctrl *target;
48};
49
50static struct v4l2_pix_format pb0100_mode[] = {
51/* low res / subsample modes disabled as they are only half res horizontal,
52 halving the vertical resolution does not seem to work */
53 {
54 320,
55 240,
56 V4L2_PIX_FMT_SGRBG8,
57 V4L2_FIELD_NONE,
58 .sizeimage = 320 * 240,
59 .bytesperline = 320,
60 .colorspace = V4L2_COLORSPACE_SRGB,
61 .priv = PB0100_CROP_TO_VGA
62 },
63 {
64 352,
65 288,
66 V4L2_PIX_FMT_SGRBG8,
67 V4L2_FIELD_NONE,
68 .sizeimage = 352 * 288,
69 .bytesperline = 352,
70 .colorspace = V4L2_COLORSPACE_SRGB,
71 .priv = 0
72 }
73};
74
75static int pb0100_s_ctrl(struct v4l2_ctrl *ctrl)
76{
77 struct gspca_dev *gspca_dev =
78 container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
79 struct sd *sd = (struct sd *)gspca_dev;
80 struct pb0100_ctrls *ctrls = sd->sensor_priv;
81 int err = -EINVAL;
82
83 switch (ctrl->id) {
84 case V4L2_CID_AUTOGAIN:
85 err = pb0100_set_autogain(gspca_dev, ctrl->val);
86 if (err)
87 break;
88 if (ctrl->val)
89 break;
90 err = pb0100_set_gain(gspca_dev, ctrls->gain->val);
91 if (err)
92 break;
93 err = pb0100_set_exposure(gspca_dev, ctrls->exposure->val);
94 break;
95 case V4L2_CTRL_CLASS_USER + 0x1001:
96 err = pb0100_set_autogain_target(gspca_dev, ctrl->val);
97 break;
98 }
99 return err;
100}
101
102static const struct v4l2_ctrl_ops pb0100_ctrl_ops = {
103 .s_ctrl = pb0100_s_ctrl,
104};
105
106static int pb0100_init_controls(struct sd *sd)
107{
108 struct v4l2_ctrl_handler *hdl = &sd->gspca_dev.ctrl_handler;
109 struct pb0100_ctrls *ctrls;
110 static const struct v4l2_ctrl_config autogain_target = {
111 .ops = &pb0100_ctrl_ops,
112 .id = V4L2_CTRL_CLASS_USER + 0x1000,
113 .type = V4L2_CTRL_TYPE_INTEGER,
114 .name = "Automatic Gain Target",
115 .max = 255,
116 .step = 1,
117 .def = 128,
118 };
119 static const struct v4l2_ctrl_config natural_light = {
120 .ops = &pb0100_ctrl_ops,
121 .id = V4L2_CTRL_CLASS_USER + 0x1001,
122 .type = V4L2_CTRL_TYPE_BOOLEAN,
123 .name = "Natural Light Source",
124 .max = 1,
125 .step = 1,
126 .def = 1,
127 };
128
129 ctrls = kzalloc(sizeof(*ctrls), GFP_KERNEL);
130 if (!ctrls)
131 return -ENOMEM;
132
133 v4l2_ctrl_handler_init(hdl, 6);
134 ctrls->autogain = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,
135 V4L2_CID_AUTOGAIN, 0, 1, 1, 1);
136 ctrls->exposure = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,
137 V4L2_CID_EXPOSURE, 0, 511, 1, 12);
138 ctrls->gain = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,
139 V4L2_CID_GAIN, 0, 255, 1, 128);
140 ctrls->red = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,
141 V4L2_CID_RED_BALANCE, -255, 255, 1, 0);
142 ctrls->blue = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,
143 V4L2_CID_BLUE_BALANCE, -255, 255, 1, 0);
144 ctrls->natural = v4l2_ctrl_new_custom(hdl, &natural_light, NULL);
145 ctrls->target = v4l2_ctrl_new_custom(hdl, &autogain_target, NULL);
146 if (hdl->error) {
147 kfree(ctrls);
148 return hdl->error;
149 }
150 sd->sensor_priv = ctrls;
151 v4l2_ctrl_auto_cluster(5, &ctrls->autogain, 0, false);
152 return 0;
153}
154
155static int pb0100_probe(struct sd *sd)
156{
157 u16 sensor;
158 int err;
159
160 err = stv06xx_read_sensor(sd, PB_IDENT, &sensor);
161
162 if (err < 0)
163 return -ENODEV;
164 if ((sensor >> 8) != 0x64)
165 return -ENODEV;
166
167 pr_info("Photobit pb0100 sensor detected\n");
168
169 sd->gspca_dev.cam.cam_mode = pb0100_mode;
170 sd->gspca_dev.cam.nmodes = ARRAY_SIZE(pb0100_mode);
171
172 return 0;
173}
174
175static int pb0100_start(struct sd *sd)
176{
177 int err, packet_size, max_packet_size;
178 struct usb_host_interface *alt;
179 struct usb_interface *intf;
180 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
181 struct cam *cam = &sd->gspca_dev.cam;
182 u32 mode = cam->cam_mode[sd->gspca_dev.curr_mode].priv;
183
184 intf = usb_ifnum_to_if(sd->gspca_dev.dev, sd->gspca_dev.iface);
185 alt = usb_altnum_to_altsetting(intf, sd->gspca_dev.alt);
186 if (!alt)
187 return -ENODEV;
188
189 if (alt->desc.bNumEndpoints < 1)
190 return -ENODEV;
191
192 packet_size = le16_to_cpu(alt->endpoint[0].desc.wMaxPacketSize);
193
194 /* If we don't have enough bandwidth use a lower framerate */
195 max_packet_size = sd->sensor->max_packet_size[sd->gspca_dev.curr_mode];
196 if (packet_size < max_packet_size)
197 stv06xx_write_sensor(sd, PB_ROWSPEED, BIT(4)|BIT(3)|BIT(1));
198 else
199 stv06xx_write_sensor(sd, PB_ROWSPEED, BIT(5)|BIT(3)|BIT(1));
200
201 /* Setup sensor window */
202 if (mode & PB0100_CROP_TO_VGA) {
203 stv06xx_write_sensor(sd, PB_RSTART, 30);
204 stv06xx_write_sensor(sd, PB_CSTART, 20);
205 stv06xx_write_sensor(sd, PB_RWSIZE, 240 - 1);
206 stv06xx_write_sensor(sd, PB_CWSIZE, 320 - 1);
207 } else {
208 stv06xx_write_sensor(sd, PB_RSTART, 8);
209 stv06xx_write_sensor(sd, PB_CSTART, 4);
210 stv06xx_write_sensor(sd, PB_RWSIZE, 288 - 1);
211 stv06xx_write_sensor(sd, PB_CWSIZE, 352 - 1);
212 }
213
214 if (mode & PB0100_SUBSAMPLE) {
215 stv06xx_write_bridge(sd, STV_Y_CTRL, 0x02); /* Wrong, FIXME */
216 stv06xx_write_bridge(sd, STV_X_CTRL, 0x06);
217
218 stv06xx_write_bridge(sd, STV_SCAN_RATE, 0x10);
219 } else {
220 stv06xx_write_bridge(sd, STV_Y_CTRL, 0x01);
221 stv06xx_write_bridge(sd, STV_X_CTRL, 0x0a);
222 /* larger -> slower */
223 stv06xx_write_bridge(sd, STV_SCAN_RATE, 0x20);
224 }
225
226 err = stv06xx_write_sensor(sd, PB_CONTROL, BIT(5)|BIT(3)|BIT(1));
227 gspca_dbg(gspca_dev, D_STREAM, "Started stream, status: %d\n", err);
228
229 return (err < 0) ? err : 0;
230}
231
232static int pb0100_stop(struct sd *sd)
233{
234 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
235 int err;
236
237 err = stv06xx_write_sensor(sd, PB_ABORTFRAME, 1);
238
239 if (err < 0)
240 goto out;
241
242 /* Set bit 1 to zero */
243 err = stv06xx_write_sensor(sd, PB_CONTROL, BIT(5)|BIT(3));
244
245 gspca_dbg(gspca_dev, D_STREAM, "Halting stream\n");
246out:
247 return (err < 0) ? err : 0;
248}
249
250/* FIXME: Sort the init commands out and put them into tables,
251 this is only for getting the camera to work */
252/* FIXME: No error handling for now,
253 add this once the init has been converted to proper tables */
254static int pb0100_init(struct sd *sd)
255{
256 stv06xx_write_bridge(sd, STV_REG00, 1);
257 stv06xx_write_bridge(sd, STV_SCAN_RATE, 0);
258
259 /* Reset sensor */
260 stv06xx_write_sensor(sd, PB_RESET, 1);
261 stv06xx_write_sensor(sd, PB_RESET, 0);
262
263 /* Disable chip */
264 stv06xx_write_sensor(sd, PB_CONTROL, BIT(5)|BIT(3));
265
266 /* Gain stuff...*/
267 stv06xx_write_sensor(sd, PB_PREADCTRL, BIT(12)|BIT(10)|BIT(6));
268 stv06xx_write_sensor(sd, PB_ADCGLOBALGAIN, 12);
269
270 /* Set up auto-exposure */
271 /* ADC VREF_HI new setting for a transition
272 from the Expose1 to the Expose2 setting */
273 stv06xx_write_sensor(sd, PB_R28, 12);
274 /* gain max for autoexposure */
275 stv06xx_write_sensor(sd, PB_ADCMAXGAIN, 180);
276 /* gain min for autoexposure */
277 stv06xx_write_sensor(sd, PB_ADCMINGAIN, 12);
278 /* Maximum frame integration time (programmed into R8)
279 allowed for auto-exposure routine */
280 stv06xx_write_sensor(sd, PB_R54, 3);
281 /* Minimum frame integration time (programmed into R8)
282 allowed for auto-exposure routine */
283 stv06xx_write_sensor(sd, PB_R55, 0);
284 stv06xx_write_sensor(sd, PB_UPDATEINT, 1);
285 /* R15 Expose0 (maximum that auto-exposure may use) */
286 stv06xx_write_sensor(sd, PB_R15, 800);
287 /* R17 Expose2 (minimum that auto-exposure may use) */
288 stv06xx_write_sensor(sd, PB_R17, 10);
289
290 stv06xx_write_sensor(sd, PB_EXPGAIN, 0);
291
292 /* 0x14 */
293 stv06xx_write_sensor(sd, PB_VOFFSET, 0);
294 /* 0x0D */
295 stv06xx_write_sensor(sd, PB_ADCGAINH, 11);
296 /* Set black level (important!) */
297 stv06xx_write_sensor(sd, PB_ADCGAINL, 0);
298
299 /* ??? */
300 stv06xx_write_bridge(sd, STV_REG00, 0x11);
301 stv06xx_write_bridge(sd, STV_REG03, 0x45);
302 stv06xx_write_bridge(sd, STV_REG04, 0x07);
303
304 /* Scan/timing for the sensor */
305 stv06xx_write_sensor(sd, PB_ROWSPEED, BIT(4)|BIT(3)|BIT(1));
306 stv06xx_write_sensor(sd, PB_CFILLIN, 14);
307 stv06xx_write_sensor(sd, PB_VBL, 0);
308 stv06xx_write_sensor(sd, PB_FINTTIME, 0);
309 stv06xx_write_sensor(sd, PB_RINTTIME, 123);
310
311 stv06xx_write_bridge(sd, STV_REG01, 0xc2);
312 stv06xx_write_bridge(sd, STV_REG02, 0xb0);
313 return 0;
314}
315
316static int pb0100_dump(struct sd *sd)
317{
318 return 0;
319}
320
321static int pb0100_set_gain(struct gspca_dev *gspca_dev, __s32 val)
322{
323 int err;
324 struct sd *sd = (struct sd *) gspca_dev;
325 struct pb0100_ctrls *ctrls = sd->sensor_priv;
326
327 err = stv06xx_write_sensor(sd, PB_G1GAIN, val);
328 if (!err)
329 err = stv06xx_write_sensor(sd, PB_G2GAIN, val);
330 gspca_dbg(gspca_dev, D_CONF, "Set green gain to %d, status: %d\n",
331 val, err);
332
333 if (!err)
334 err = pb0100_set_red_balance(gspca_dev, ctrls->red->val);
335 if (!err)
336 err = pb0100_set_blue_balance(gspca_dev, ctrls->blue->val);
337
338 return err;
339}
340
341static int pb0100_set_red_balance(struct gspca_dev *gspca_dev, __s32 val)
342{
343 int err;
344 struct sd *sd = (struct sd *) gspca_dev;
345 struct pb0100_ctrls *ctrls = sd->sensor_priv;
346
347 val += ctrls->gain->val;
348 if (val < 0)
349 val = 0;
350 else if (val > 255)
351 val = 255;
352
353 err = stv06xx_write_sensor(sd, PB_RGAIN, val);
354 gspca_dbg(gspca_dev, D_CONF, "Set red gain to %d, status: %d\n",
355 val, err);
356
357 return err;
358}
359
360static int pb0100_set_blue_balance(struct gspca_dev *gspca_dev, __s32 val)
361{
362 int err;
363 struct sd *sd = (struct sd *) gspca_dev;
364 struct pb0100_ctrls *ctrls = sd->sensor_priv;
365
366 val += ctrls->gain->val;
367 if (val < 0)
368 val = 0;
369 else if (val > 255)
370 val = 255;
371
372 err = stv06xx_write_sensor(sd, PB_BGAIN, val);
373 gspca_dbg(gspca_dev, D_CONF, "Set blue gain to %d, status: %d\n",
374 val, err);
375
376 return err;
377}
378
379static int pb0100_set_exposure(struct gspca_dev *gspca_dev, __s32 val)
380{
381 struct sd *sd = (struct sd *) gspca_dev;
382 int err;
383
384 err = stv06xx_write_sensor(sd, PB_RINTTIME, val);
385 gspca_dbg(gspca_dev, D_CONF, "Set exposure to %d, status: %d\n",
386 val, err);
387
388 return err;
389}
390
391static int pb0100_set_autogain(struct gspca_dev *gspca_dev, __s32 val)
392{
393 int err;
394 struct sd *sd = (struct sd *) gspca_dev;
395 struct pb0100_ctrls *ctrls = sd->sensor_priv;
396
397 if (val) {
398 if (ctrls->natural->val)
399 val = BIT(6)|BIT(4)|BIT(0);
400 else
401 val = BIT(4)|BIT(0);
402 } else
403 val = 0;
404
405 err = stv06xx_write_sensor(sd, PB_EXPGAIN, val);
406 gspca_dbg(gspca_dev, D_CONF, "Set autogain to %d (natural: %d), status: %d\n",
407 val, ctrls->natural->val, err);
408
409 return err;
410}
411
412static int pb0100_set_autogain_target(struct gspca_dev *gspca_dev, __s32 val)
413{
414 int err, totalpixels, brightpixels, darkpixels;
415 struct sd *sd = (struct sd *) gspca_dev;
416
417 /* Number of pixels counted by the sensor when subsampling the pixels.
418 * Slightly larger than the real value to avoid oscillation */
419 totalpixels = gspca_dev->pixfmt.width * gspca_dev->pixfmt.height;
420 totalpixels = totalpixels/(8*8) + totalpixels/(64*64);
421
422 brightpixels = (totalpixels * val) >> 8;
423 darkpixels = totalpixels - brightpixels;
424 err = stv06xx_write_sensor(sd, PB_R21, brightpixels);
425 if (!err)
426 err = stv06xx_write_sensor(sd, PB_R22, darkpixels);
427
428 gspca_dbg(gspca_dev, D_CONF, "Set autogain target to %d, status: %d\n",
429 val, err);
430
431 return err;
432}
1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * Copyright (c) 2001 Jean-Fredric Clere, Nikolas Zimmermann, Georg Acher
4 * Mark Cave-Ayland, Carlo E Prelz, Dick Streefland
5 * Copyright (c) 2002, 2003 Tuukka Toivonen
6 * Copyright (c) 2008 Erik Andrén
7 *
8 * P/N 861037: Sensor HDCS1000 ASIC STV0600
9 * P/N 861050-0010: Sensor HDCS1000 ASIC STV0600
10 * P/N 861050-0020: Sensor Photobit PB100 ASIC STV0600-1 - QuickCam Express
11 * P/N 861055: Sensor ST VV6410 ASIC STV0610 - LEGO cam
12 * P/N 861075-0040: Sensor HDCS1000 ASIC
13 * P/N 961179-0700: Sensor ST VV6410 ASIC STV0602 - Dexxa WebCam USB
14 * P/N 861040-0000: Sensor ST VV6410 ASIC STV0610 - QuickCam Web
15 */
16
17/*
18 * The spec file for the PB-0100 suggests the following for best quality
19 * images after the sensor has been reset :
20 *
21 * PB_ADCGAINL = R60 = 0x03 (3 dec) : sets low reference of ADC
22 to produce good black level
23 * PB_PREADCTRL = R32 = 0x1400 (5120 dec) : Enables global gain changes
24 through R53
25 * PB_ADCMINGAIN = R52 = 0x10 (16 dec) : Sets the minimum gain for
26 auto-exposure
27 * PB_ADCGLOBALGAIN = R53 = 0x10 (16 dec) : Sets the global gain
28 * PB_EXPGAIN = R14 = 0x11 (17 dec) : Sets the auto-exposure value
29 * PB_UPDATEINT = R23 = 0x02 (2 dec) : Sets the speed on
30 auto-exposure routine
31 * PB_CFILLIN = R5 = 0x0E (14 dec) : Sets the frame rate
32 */
33
34#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
35
36#include "stv06xx_pb0100.h"
37
38struct pb0100_ctrls {
39 struct { /* one big happy control cluster... */
40 struct v4l2_ctrl *autogain;
41 struct v4l2_ctrl *gain;
42 struct v4l2_ctrl *exposure;
43 struct v4l2_ctrl *red;
44 struct v4l2_ctrl *blue;
45 struct v4l2_ctrl *natural;
46 };
47 struct v4l2_ctrl *target;
48};
49
50static struct v4l2_pix_format pb0100_mode[] = {
51/* low res / subsample modes disabled as they are only half res horizontal,
52 halving the vertical resolution does not seem to work */
53 {
54 320,
55 240,
56 V4L2_PIX_FMT_SGRBG8,
57 V4L2_FIELD_NONE,
58 .sizeimage = 320 * 240,
59 .bytesperline = 320,
60 .colorspace = V4L2_COLORSPACE_SRGB,
61 .priv = PB0100_CROP_TO_VGA
62 },
63 {
64 352,
65 288,
66 V4L2_PIX_FMT_SGRBG8,
67 V4L2_FIELD_NONE,
68 .sizeimage = 352 * 288,
69 .bytesperline = 352,
70 .colorspace = V4L2_COLORSPACE_SRGB,
71 .priv = 0
72 }
73};
74
75static int pb0100_s_ctrl(struct v4l2_ctrl *ctrl)
76{
77 struct gspca_dev *gspca_dev =
78 container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
79 struct sd *sd = (struct sd *)gspca_dev;
80 struct pb0100_ctrls *ctrls = sd->sensor_priv;
81 int err = -EINVAL;
82
83 switch (ctrl->id) {
84 case V4L2_CID_AUTOGAIN:
85 err = pb0100_set_autogain(gspca_dev, ctrl->val);
86 if (err)
87 break;
88 if (ctrl->val)
89 break;
90 err = pb0100_set_gain(gspca_dev, ctrls->gain->val);
91 if (err)
92 break;
93 err = pb0100_set_exposure(gspca_dev, ctrls->exposure->val);
94 break;
95 case V4L2_CTRL_CLASS_USER + 0x1001:
96 err = pb0100_set_autogain_target(gspca_dev, ctrl->val);
97 break;
98 }
99 return err;
100}
101
102static const struct v4l2_ctrl_ops pb0100_ctrl_ops = {
103 .s_ctrl = pb0100_s_ctrl,
104};
105
106static int pb0100_init_controls(struct sd *sd)
107{
108 struct v4l2_ctrl_handler *hdl = &sd->gspca_dev.ctrl_handler;
109 struct pb0100_ctrls *ctrls;
110 static const struct v4l2_ctrl_config autogain_target = {
111 .ops = &pb0100_ctrl_ops,
112 .id = V4L2_CTRL_CLASS_USER + 0x1000,
113 .type = V4L2_CTRL_TYPE_INTEGER,
114 .name = "Automatic Gain Target",
115 .max = 255,
116 .step = 1,
117 .def = 128,
118 };
119 static const struct v4l2_ctrl_config natural_light = {
120 .ops = &pb0100_ctrl_ops,
121 .id = V4L2_CTRL_CLASS_USER + 0x1001,
122 .type = V4L2_CTRL_TYPE_BOOLEAN,
123 .name = "Natural Light Source",
124 .max = 1,
125 .step = 1,
126 .def = 1,
127 };
128
129 ctrls = kzalloc(sizeof(*ctrls), GFP_KERNEL);
130 if (!ctrls)
131 return -ENOMEM;
132
133 v4l2_ctrl_handler_init(hdl, 6);
134 ctrls->autogain = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,
135 V4L2_CID_AUTOGAIN, 0, 1, 1, 1);
136 ctrls->exposure = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,
137 V4L2_CID_EXPOSURE, 0, 511, 1, 12);
138 ctrls->gain = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,
139 V4L2_CID_GAIN, 0, 255, 1, 128);
140 ctrls->red = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,
141 V4L2_CID_RED_BALANCE, -255, 255, 1, 0);
142 ctrls->blue = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,
143 V4L2_CID_BLUE_BALANCE, -255, 255, 1, 0);
144 ctrls->natural = v4l2_ctrl_new_custom(hdl, &natural_light, NULL);
145 ctrls->target = v4l2_ctrl_new_custom(hdl, &autogain_target, NULL);
146 if (hdl->error) {
147 kfree(ctrls);
148 return hdl->error;
149 }
150 sd->sensor_priv = ctrls;
151 v4l2_ctrl_auto_cluster(5, &ctrls->autogain, 0, false);
152 return 0;
153}
154
155static int pb0100_probe(struct sd *sd)
156{
157 u16 sensor;
158 int err;
159
160 err = stv06xx_read_sensor(sd, PB_IDENT, &sensor);
161
162 if (err < 0)
163 return -ENODEV;
164 if ((sensor >> 8) != 0x64)
165 return -ENODEV;
166
167 pr_info("Photobit pb0100 sensor detected\n");
168
169 sd->gspca_dev.cam.cam_mode = pb0100_mode;
170 sd->gspca_dev.cam.nmodes = ARRAY_SIZE(pb0100_mode);
171
172 return 0;
173}
174
175static int pb0100_start(struct sd *sd)
176{
177 int err, packet_size, max_packet_size;
178 struct usb_host_interface *alt;
179 struct usb_interface *intf;
180 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
181 struct cam *cam = &sd->gspca_dev.cam;
182 u32 mode = cam->cam_mode[sd->gspca_dev.curr_mode].priv;
183
184 intf = usb_ifnum_to_if(sd->gspca_dev.dev, sd->gspca_dev.iface);
185 alt = usb_altnum_to_altsetting(intf, sd->gspca_dev.alt);
186 if (!alt)
187 return -ENODEV;
188
189 if (alt->desc.bNumEndpoints < 1)
190 return -ENODEV;
191
192 packet_size = le16_to_cpu(alt->endpoint[0].desc.wMaxPacketSize);
193
194 /* If we don't have enough bandwidth use a lower framerate */
195 max_packet_size = sd->sensor->max_packet_size[sd->gspca_dev.curr_mode];
196 if (packet_size < max_packet_size)
197 stv06xx_write_sensor(sd, PB_ROWSPEED, BIT(4)|BIT(3)|BIT(1));
198 else
199 stv06xx_write_sensor(sd, PB_ROWSPEED, BIT(5)|BIT(3)|BIT(1));
200
201 /* Setup sensor window */
202 if (mode & PB0100_CROP_TO_VGA) {
203 stv06xx_write_sensor(sd, PB_RSTART, 30);
204 stv06xx_write_sensor(sd, PB_CSTART, 20);
205 stv06xx_write_sensor(sd, PB_RWSIZE, 240 - 1);
206 stv06xx_write_sensor(sd, PB_CWSIZE, 320 - 1);
207 } else {
208 stv06xx_write_sensor(sd, PB_RSTART, 8);
209 stv06xx_write_sensor(sd, PB_CSTART, 4);
210 stv06xx_write_sensor(sd, PB_RWSIZE, 288 - 1);
211 stv06xx_write_sensor(sd, PB_CWSIZE, 352 - 1);
212 }
213
214 if (mode & PB0100_SUBSAMPLE) {
215 stv06xx_write_bridge(sd, STV_Y_CTRL, 0x02); /* Wrong, FIXME */
216 stv06xx_write_bridge(sd, STV_X_CTRL, 0x06);
217
218 stv06xx_write_bridge(sd, STV_SCAN_RATE, 0x10);
219 } else {
220 stv06xx_write_bridge(sd, STV_Y_CTRL, 0x01);
221 stv06xx_write_bridge(sd, STV_X_CTRL, 0x0a);
222 /* larger -> slower */
223 stv06xx_write_bridge(sd, STV_SCAN_RATE, 0x20);
224 }
225
226 err = stv06xx_write_sensor(sd, PB_CONTROL, BIT(5)|BIT(3)|BIT(1));
227 gspca_dbg(gspca_dev, D_STREAM, "Started stream, status: %d\n", err);
228
229 return (err < 0) ? err : 0;
230}
231
232static int pb0100_stop(struct sd *sd)
233{
234 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
235 int err;
236
237 err = stv06xx_write_sensor(sd, PB_ABORTFRAME, 1);
238
239 if (err < 0)
240 goto out;
241
242 /* Set bit 1 to zero */
243 err = stv06xx_write_sensor(sd, PB_CONTROL, BIT(5)|BIT(3));
244
245 gspca_dbg(gspca_dev, D_STREAM, "Halting stream\n");
246out:
247 return (err < 0) ? err : 0;
248}
249
250/* FIXME: Sort the init commands out and put them into tables,
251 this is only for getting the camera to work */
252/* FIXME: No error handling for now,
253 add this once the init has been converted to proper tables */
254static int pb0100_init(struct sd *sd)
255{
256 stv06xx_write_bridge(sd, STV_REG00, 1);
257 stv06xx_write_bridge(sd, STV_SCAN_RATE, 0);
258
259 /* Reset sensor */
260 stv06xx_write_sensor(sd, PB_RESET, 1);
261 stv06xx_write_sensor(sd, PB_RESET, 0);
262
263 /* Disable chip */
264 stv06xx_write_sensor(sd, PB_CONTROL, BIT(5)|BIT(3));
265
266 /* Gain stuff...*/
267 stv06xx_write_sensor(sd, PB_PREADCTRL, BIT(12)|BIT(10)|BIT(6));
268 stv06xx_write_sensor(sd, PB_ADCGLOBALGAIN, 12);
269
270 /* Set up auto-exposure */
271 /* ADC VREF_HI new setting for a transition
272 from the Expose1 to the Expose2 setting */
273 stv06xx_write_sensor(sd, PB_R28, 12);
274 /* gain max for autoexposure */
275 stv06xx_write_sensor(sd, PB_ADCMAXGAIN, 180);
276 /* gain min for autoexposure */
277 stv06xx_write_sensor(sd, PB_ADCMINGAIN, 12);
278 /* Maximum frame integration time (programmed into R8)
279 allowed for auto-exposure routine */
280 stv06xx_write_sensor(sd, PB_R54, 3);
281 /* Minimum frame integration time (programmed into R8)
282 allowed for auto-exposure routine */
283 stv06xx_write_sensor(sd, PB_R55, 0);
284 stv06xx_write_sensor(sd, PB_UPDATEINT, 1);
285 /* R15 Expose0 (maximum that auto-exposure may use) */
286 stv06xx_write_sensor(sd, PB_R15, 800);
287 /* R17 Expose2 (minimum that auto-exposure may use) */
288 stv06xx_write_sensor(sd, PB_R17, 10);
289
290 stv06xx_write_sensor(sd, PB_EXPGAIN, 0);
291
292 /* 0x14 */
293 stv06xx_write_sensor(sd, PB_VOFFSET, 0);
294 /* 0x0D */
295 stv06xx_write_sensor(sd, PB_ADCGAINH, 11);
296 /* Set black level (important!) */
297 stv06xx_write_sensor(sd, PB_ADCGAINL, 0);
298
299 /* ??? */
300 stv06xx_write_bridge(sd, STV_REG00, 0x11);
301 stv06xx_write_bridge(sd, STV_REG03, 0x45);
302 stv06xx_write_bridge(sd, STV_REG04, 0x07);
303
304 /* Scan/timing for the sensor */
305 stv06xx_write_sensor(sd, PB_ROWSPEED, BIT(4)|BIT(3)|BIT(1));
306 stv06xx_write_sensor(sd, PB_CFILLIN, 14);
307 stv06xx_write_sensor(sd, PB_VBL, 0);
308 stv06xx_write_sensor(sd, PB_FINTTIME, 0);
309 stv06xx_write_sensor(sd, PB_RINTTIME, 123);
310
311 stv06xx_write_bridge(sd, STV_REG01, 0xc2);
312 stv06xx_write_bridge(sd, STV_REG02, 0xb0);
313 return 0;
314}
315
316static int pb0100_dump(struct sd *sd)
317{
318 return 0;
319}
320
321static int pb0100_set_gain(struct gspca_dev *gspca_dev, __s32 val)
322{
323 int err;
324 struct sd *sd = (struct sd *) gspca_dev;
325 struct pb0100_ctrls *ctrls = sd->sensor_priv;
326
327 err = stv06xx_write_sensor(sd, PB_G1GAIN, val);
328 if (!err)
329 err = stv06xx_write_sensor(sd, PB_G2GAIN, val);
330 gspca_dbg(gspca_dev, D_CONF, "Set green gain to %d, status: %d\n",
331 val, err);
332
333 if (!err)
334 err = pb0100_set_red_balance(gspca_dev, ctrls->red->val);
335 if (!err)
336 err = pb0100_set_blue_balance(gspca_dev, ctrls->blue->val);
337
338 return err;
339}
340
341static int pb0100_set_red_balance(struct gspca_dev *gspca_dev, __s32 val)
342{
343 int err;
344 struct sd *sd = (struct sd *) gspca_dev;
345 struct pb0100_ctrls *ctrls = sd->sensor_priv;
346
347 val += ctrls->gain->val;
348 if (val < 0)
349 val = 0;
350 else if (val > 255)
351 val = 255;
352
353 err = stv06xx_write_sensor(sd, PB_RGAIN, val);
354 gspca_dbg(gspca_dev, D_CONF, "Set red gain to %d, status: %d\n",
355 val, err);
356
357 return err;
358}
359
360static int pb0100_set_blue_balance(struct gspca_dev *gspca_dev, __s32 val)
361{
362 int err;
363 struct sd *sd = (struct sd *) gspca_dev;
364 struct pb0100_ctrls *ctrls = sd->sensor_priv;
365
366 val += ctrls->gain->val;
367 if (val < 0)
368 val = 0;
369 else if (val > 255)
370 val = 255;
371
372 err = stv06xx_write_sensor(sd, PB_BGAIN, val);
373 gspca_dbg(gspca_dev, D_CONF, "Set blue gain to %d, status: %d\n",
374 val, err);
375
376 return err;
377}
378
379static int pb0100_set_exposure(struct gspca_dev *gspca_dev, __s32 val)
380{
381 struct sd *sd = (struct sd *) gspca_dev;
382 int err;
383
384 err = stv06xx_write_sensor(sd, PB_RINTTIME, val);
385 gspca_dbg(gspca_dev, D_CONF, "Set exposure to %d, status: %d\n",
386 val, err);
387
388 return err;
389}
390
391static int pb0100_set_autogain(struct gspca_dev *gspca_dev, __s32 val)
392{
393 int err;
394 struct sd *sd = (struct sd *) gspca_dev;
395 struct pb0100_ctrls *ctrls = sd->sensor_priv;
396
397 if (val) {
398 if (ctrls->natural->val)
399 val = BIT(6)|BIT(4)|BIT(0);
400 else
401 val = BIT(4)|BIT(0);
402 } else
403 val = 0;
404
405 err = stv06xx_write_sensor(sd, PB_EXPGAIN, val);
406 gspca_dbg(gspca_dev, D_CONF, "Set autogain to %d (natural: %d), status: %d\n",
407 val, ctrls->natural->val, err);
408
409 return err;
410}
411
412static int pb0100_set_autogain_target(struct gspca_dev *gspca_dev, __s32 val)
413{
414 int err, totalpixels, brightpixels, darkpixels;
415 struct sd *sd = (struct sd *) gspca_dev;
416
417 /* Number of pixels counted by the sensor when subsampling the pixels.
418 * Slightly larger than the real value to avoid oscillation */
419 totalpixels = gspca_dev->pixfmt.width * gspca_dev->pixfmt.height;
420 totalpixels = totalpixels/(8*8) + totalpixels/(64*64);
421
422 brightpixels = (totalpixels * val) >> 8;
423 darkpixels = totalpixels - brightpixels;
424 err = stv06xx_write_sensor(sd, PB_R21, brightpixels);
425 if (!err)
426 err = stv06xx_write_sensor(sd, PB_R22, darkpixels);
427
428 gspca_dbg(gspca_dev, D_CONF, "Set autogain target to %d, status: %d\n",
429 val, err);
430
431 return err;
432}