Commit | Line | Data |
---|---|---|
4c98834a EA |
1 | /* |
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 | |
6 | * | |
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. | |
11 | * | |
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. | |
16 | * | |
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 | |
20 | * | |
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 | |
28 | */ | |
29 | ||
133a9fe9 JP |
30 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
31 | ||
4c98834a EA |
32 | #include "stv06xx_vv6410.h" |
33 | ||
766231ab EA |
34 | static struct v4l2_pix_format vv6410_mode[] = { |
35 | { | |
36 | 356, | |
37 | 292, | |
38 | V4L2_PIX_FMT_SGRBG8, | |
39 | V4L2_FIELD_NONE, | |
40 | .sizeimage = 356 * 292, | |
41 | .bytesperline = 356, | |
42 | .colorspace = V4L2_COLORSPACE_SRGB, | |
43 | .priv = 0 | |
44 | } | |
45 | }; | |
46 | ||
47 | static const struct ctrl vv6410_ctrl[] = { | |
5658ae90 | 48 | #define HFLIP_IDX 0 |
766231ab EA |
49 | { |
50 | { | |
51 | .id = V4L2_CID_HFLIP, | |
52 | .type = V4L2_CTRL_TYPE_BOOLEAN, | |
53 | .name = "horizontal flip", | |
54 | .minimum = 0, | |
55 | .maximum = 1, | |
56 | .step = 1, | |
57 | .default_value = 0 | |
58 | }, | |
59 | .set = vv6410_set_hflip, | |
60 | .get = vv6410_get_hflip | |
5658ae90 EA |
61 | }, |
62 | #define VFLIP_IDX 1 | |
63 | { | |
766231ab EA |
64 | { |
65 | .id = V4L2_CID_VFLIP, | |
66 | .type = V4L2_CTRL_TYPE_BOOLEAN, | |
67 | .name = "vertical flip", | |
68 | .minimum = 0, | |
69 | .maximum = 1, | |
70 | .step = 1, | |
780e3121 | 71 | .default_value = 0 |
766231ab EA |
72 | }, |
73 | .set = vv6410_set_vflip, | |
74 | .get = vv6410_get_vflip | |
5658ae90 EA |
75 | }, |
76 | #define GAIN_IDX 2 | |
77 | { | |
766231ab EA |
78 | { |
79 | .id = V4L2_CID_GAIN, | |
80 | .type = V4L2_CTRL_TYPE_INTEGER, | |
81 | .name = "analog gain", | |
82 | .minimum = 0, | |
83 | .maximum = 15, | |
84 | .step = 1, | |
17720e07 | 85 | .default_value = 10 |
766231ab EA |
86 | }, |
87 | .set = vv6410_set_analog_gain, | |
88 | .get = vv6410_get_analog_gain | |
1906d8d1 EA |
89 | }, |
90 | #define EXPOSURE_IDX 3 | |
91 | { | |
92 | { | |
93 | .id = V4L2_CID_EXPOSURE, | |
94 | .type = V4L2_CTRL_TYPE_INTEGER, | |
95 | .name = "exposure", | |
96 | .minimum = 0, | |
97 | .maximum = 32768, | |
98 | .step = 1, | |
99 | .default_value = 20000 | |
100 | }, | |
101 | .set = vv6410_set_exposure, | |
102 | .get = vv6410_get_exposure | |
766231ab | 103 | } |
1906d8d1 | 104 | }; |
766231ab | 105 | |
4c98834a EA |
106 | static int vv6410_probe(struct sd *sd) |
107 | { | |
108 | u16 data; | |
5658ae90 EA |
109 | int err, i; |
110 | s32 *sensor_settings; | |
4c98834a EA |
111 | |
112 | err = stv06xx_read_sensor(sd, VV6410_DEVICEH, &data); | |
4c98834a EA |
113 | if (err < 0) |
114 | return -ENODEV; | |
115 | ||
116 | if (data == 0x19) { | |
133a9fe9 | 117 | pr_info("vv6410 sensor detected\n"); |
4c98834a | 118 | |
5658ae90 EA |
119 | sensor_settings = kmalloc(ARRAY_SIZE(vv6410_ctrl) * sizeof(s32), |
120 | GFP_KERNEL); | |
121 | if (!sensor_settings) | |
122 | return -ENOMEM; | |
123 | ||
766231ab EA |
124 | sd->gspca_dev.cam.cam_mode = vv6410_mode; |
125 | sd->gspca_dev.cam.nmodes = ARRAY_SIZE(vv6410_mode); | |
126 | sd->desc.ctrls = vv6410_ctrl; | |
127 | sd->desc.nctrls = ARRAY_SIZE(vv6410_ctrl); | |
5658ae90 EA |
128 | |
129 | for (i = 0; i < sd->desc.nctrls; i++) | |
130 | sensor_settings[i] = vv6410_ctrl[i].qctrl.default_value; | |
131 | sd->sensor_priv = sensor_settings; | |
4c98834a EA |
132 | return 0; |
133 | } | |
4c98834a EA |
134 | return -ENODEV; |
135 | } | |
136 | ||
137 | static int vv6410_init(struct sd *sd) | |
138 | { | |
139 | int err = 0, i; | |
1906d8d1 | 140 | s32 *sensor_settings = sd->sensor_priv; |
4c98834a EA |
141 | |
142 | for (i = 0; i < ARRAY_SIZE(stv_bridge_init); i++) { | |
46fecfaf | 143 | stv06xx_write_bridge(sd, stv_bridge_init[i].addr, stv_bridge_init[i].data); |
4c98834a EA |
144 | } |
145 | ||
146 | if (err < 0) | |
147 | return err; | |
148 | ||
149 | err = stv06xx_write_sensor_bytes(sd, (u8 *) vv6410_sensor_init, | |
150 | ARRAY_SIZE(vv6410_sensor_init)); | |
1906d8d1 EA |
151 | if (err < 0) |
152 | return err; | |
153 | ||
154 | err = vv6410_set_exposure(&sd->gspca_dev, | |
155 | sensor_settings[EXPOSURE_IDX]); | |
17720e07 EA |
156 | if (err < 0) |
157 | return err; | |
158 | ||
159 | err = vv6410_set_analog_gain(&sd->gspca_dev, | |
160 | sensor_settings[GAIN_IDX]); | |
4c98834a EA |
161 | |
162 | return (err < 0) ? err : 0; | |
163 | } | |
164 | ||
5658ae90 EA |
165 | static void vv6410_disconnect(struct sd *sd) |
166 | { | |
167 | sd->sensor = NULL; | |
168 | kfree(sd->sensor_priv); | |
169 | } | |
170 | ||
4c98834a EA |
171 | static int vv6410_start(struct sd *sd) |
172 | { | |
173 | int err; | |
174 | struct cam *cam = &sd->gspca_dev.cam; | |
175 | u32 priv = cam->cam_mode[sd->gspca_dev.curr_mode].priv; | |
176 | ||
4c98834a EA |
177 | if (priv & VV6410_SUBSAMPLE) { |
178 | PDEBUG(D_CONF, "Enabling subsampling"); | |
179 | stv06xx_write_bridge(sd, STV_Y_CTRL, 0x02); | |
180 | stv06xx_write_bridge(sd, STV_X_CTRL, 0x06); | |
181 | ||
182 | stv06xx_write_bridge(sd, STV_SCAN_RATE, 0x10); | |
183 | } else { | |
184 | stv06xx_write_bridge(sd, STV_Y_CTRL, 0x01); | |
185 | stv06xx_write_bridge(sd, STV_X_CTRL, 0x0a); | |
eaceba65 | 186 | stv06xx_write_bridge(sd, STV_SCAN_RATE, 0x00); |
4c98834a | 187 | |
4c98834a EA |
188 | } |
189 | ||
190 | /* Turn on LED */ | |
191 | err = stv06xx_write_bridge(sd, STV_LED_CTRL, LED_ON); | |
192 | if (err < 0) | |
193 | return err; | |
194 | ||
195 | err = stv06xx_write_sensor(sd, VV6410_SETUP0, 0); | |
196 | if (err < 0) | |
197 | return err; | |
198 | ||
199 | PDEBUG(D_STREAM, "Starting stream"); | |
200 | ||
201 | return 0; | |
202 | } | |
203 | ||
204 | static int vv6410_stop(struct sd *sd) | |
205 | { | |
206 | int err; | |
207 | ||
208 | /* Turn off LED */ | |
209 | err = stv06xx_write_bridge(sd, STV_LED_CTRL, LED_OFF); | |
210 | if (err < 0) | |
211 | return err; | |
212 | ||
213 | err = stv06xx_write_sensor(sd, VV6410_SETUP0, VV6410_LOW_POWER_MODE); | |
214 | if (err < 0) | |
215 | return err; | |
216 | ||
217 | PDEBUG(D_STREAM, "Halting stream"); | |
218 | ||
219 | return (err < 0) ? err : 0; | |
220 | } | |
221 | ||
222 | static int vv6410_dump(struct sd *sd) | |
223 | { | |
224 | u8 i; | |
225 | int err = 0; | |
226 | ||
133a9fe9 | 227 | pr_info("Dumping all vv6410 sensor registers\n"); |
4c98834a EA |
228 | for (i = 0; i < 0xff && !err; i++) { |
229 | u16 data; | |
230 | err = stv06xx_read_sensor(sd, i, &data); | |
133a9fe9 | 231 | pr_info("Register 0x%x contained 0x%x\n", i, data); |
4c98834a EA |
232 | } |
233 | return (err < 0) ? err : 0; | |
234 | } | |
235 | ||
236 | static int vv6410_get_hflip(struct gspca_dev *gspca_dev, __s32 *val) | |
237 | { | |
4c98834a | 238 | struct sd *sd = (struct sd *) gspca_dev; |
5658ae90 | 239 | s32 *sensor_settings = sd->sensor_priv; |
4c98834a | 240 | |
5658ae90 | 241 | *val = sensor_settings[HFLIP_IDX]; |
4c98834a EA |
242 | PDEBUG(D_V4L2, "Read horizontal flip %d", *val); |
243 | ||
5658ae90 | 244 | return 0; |
4c98834a EA |
245 | } |
246 | ||
247 | static int vv6410_set_hflip(struct gspca_dev *gspca_dev, __s32 val) | |
248 | { | |
249 | int err; | |
250 | u16 i2c_data; | |
251 | struct sd *sd = (struct sd *) gspca_dev; | |
5658ae90 EA |
252 | s32 *sensor_settings = sd->sensor_priv; |
253 | ||
254 | sensor_settings[HFLIP_IDX] = val; | |
4c98834a EA |
255 | err = stv06xx_read_sensor(sd, VV6410_DATAFORMAT, &i2c_data); |
256 | if (err < 0) | |
257 | return err; | |
258 | ||
259 | if (val) | |
260 | i2c_data |= VV6410_HFLIP; | |
261 | else | |
262 | i2c_data &= ~VV6410_HFLIP; | |
263 | ||
264 | PDEBUG(D_V4L2, "Set horizontal flip to %d", val); | |
265 | err = stv06xx_write_sensor(sd, VV6410_DATAFORMAT, i2c_data); | |
266 | ||
267 | return (err < 0) ? err : 0; | |
268 | } | |
269 | ||
270 | static int vv6410_get_vflip(struct gspca_dev *gspca_dev, __s32 *val) | |
271 | { | |
4c98834a | 272 | struct sd *sd = (struct sd *) gspca_dev; |
5658ae90 | 273 | s32 *sensor_settings = sd->sensor_priv; |
4c98834a | 274 | |
5658ae90 | 275 | *val = sensor_settings[VFLIP_IDX]; |
4c98834a EA |
276 | PDEBUG(D_V4L2, "Read vertical flip %d", *val); |
277 | ||
5658ae90 | 278 | return 0; |
4c98834a EA |
279 | } |
280 | ||
281 | static int vv6410_set_vflip(struct gspca_dev *gspca_dev, __s32 val) | |
282 | { | |
283 | int err; | |
284 | u16 i2c_data; | |
285 | struct sd *sd = (struct sd *) gspca_dev; | |
5658ae90 EA |
286 | s32 *sensor_settings = sd->sensor_priv; |
287 | ||
288 | sensor_settings[VFLIP_IDX] = val; | |
4c98834a EA |
289 | err = stv06xx_read_sensor(sd, VV6410_DATAFORMAT, &i2c_data); |
290 | if (err < 0) | |
291 | return err; | |
292 | ||
293 | if (val) | |
294 | i2c_data |= VV6410_VFLIP; | |
295 | else | |
296 | i2c_data &= ~VV6410_VFLIP; | |
297 | ||
298 | PDEBUG(D_V4L2, "Set vertical flip to %d", val); | |
299 | err = stv06xx_write_sensor(sd, VV6410_DATAFORMAT, i2c_data); | |
300 | ||
301 | return (err < 0) ? err : 0; | |
302 | } | |
303 | ||
304 | static int vv6410_get_analog_gain(struct gspca_dev *gspca_dev, __s32 *val) | |
305 | { | |
4c98834a | 306 | struct sd *sd = (struct sd *) gspca_dev; |
5658ae90 | 307 | s32 *sensor_settings = sd->sensor_priv; |
4c98834a | 308 | |
5658ae90 | 309 | *val = sensor_settings[GAIN_IDX]; |
4c98834a EA |
310 | |
311 | PDEBUG(D_V4L2, "Read analog gain %d", *val); | |
312 | ||
5658ae90 | 313 | return 0; |
4c98834a EA |
314 | } |
315 | ||
316 | static int vv6410_set_analog_gain(struct gspca_dev *gspca_dev, __s32 val) | |
317 | { | |
318 | int err; | |
319 | struct sd *sd = (struct sd *) gspca_dev; | |
5658ae90 | 320 | s32 *sensor_settings = sd->sensor_priv; |
4c98834a | 321 | |
5658ae90 | 322 | sensor_settings[GAIN_IDX] = val; |
4c98834a EA |
323 | PDEBUG(D_V4L2, "Set analog gain to %d", val); |
324 | err = stv06xx_write_sensor(sd, VV6410_ANALOGGAIN, 0xf0 | (val & 0xf)); | |
325 | ||
326 | return (err < 0) ? err : 0; | |
327 | } | |
1906d8d1 EA |
328 | |
329 | static int vv6410_get_exposure(struct gspca_dev *gspca_dev, __s32 *val) | |
330 | { | |
331 | struct sd *sd = (struct sd *) gspca_dev; | |
332 | s32 *sensor_settings = sd->sensor_priv; | |
333 | ||
334 | *val = sensor_settings[EXPOSURE_IDX]; | |
335 | ||
336 | PDEBUG(D_V4L2, "Read exposure %d", *val); | |
337 | ||
338 | return 0; | |
339 | } | |
340 | ||
341 | static int vv6410_set_exposure(struct gspca_dev *gspca_dev, __s32 val) | |
342 | { | |
343 | int err; | |
344 | struct sd *sd = (struct sd *) gspca_dev; | |
345 | s32 *sensor_settings = sd->sensor_priv; | |
346 | unsigned int fine, coarse; | |
347 | ||
348 | sensor_settings[EXPOSURE_IDX] = val; | |
349 | ||
350 | val = (val * val >> 14) + val / 4; | |
351 | ||
352 | fine = val % VV6410_CIF_LINELENGTH; | |
353 | coarse = min(512, val / VV6410_CIF_LINELENGTH); | |
354 | ||
355 | PDEBUG(D_V4L2, "Set coarse exposure to %d, fine expsure to %d", | |
356 | coarse, fine); | |
357 | ||
358 | err = stv06xx_write_sensor(sd, VV6410_FINEH, fine >> 8); | |
359 | if (err < 0) | |
360 | goto out; | |
361 | ||
362 | err = stv06xx_write_sensor(sd, VV6410_FINEL, fine & 0xff); | |
363 | if (err < 0) | |
364 | goto out; | |
365 | ||
366 | err = stv06xx_write_sensor(sd, VV6410_COARSEH, coarse >> 8); | |
367 | if (err < 0) | |
368 | goto out; | |
369 | ||
370 | err = stv06xx_write_sensor(sd, VV6410_COARSEL, coarse & 0xff); | |
371 | ||
372 | out: | |
373 | return err; | |
374 | } |