diff options
Diffstat (limited to 'drivers/media/usb/gspca/m5602/m5602_mt9m111.c')
-rw-r--r-- | drivers/media/usb/gspca/m5602/m5602_mt9m111.c | 647 |
1 files changed, 647 insertions, 0 deletions
diff --git a/drivers/media/usb/gspca/m5602/m5602_mt9m111.c b/drivers/media/usb/gspca/m5602/m5602_mt9m111.c new file mode 100644 index 000000000000..6268aa24ec5d --- /dev/null +++ b/drivers/media/usb/gspca/m5602/m5602_mt9m111.c | |||
@@ -0,0 +1,647 @@ | |||
1 | /* | ||
2 | * Driver for the mt9m111 sensor | ||
3 | * | ||
4 | * Copyright (C) 2008 Erik Andrén | ||
5 | * Copyright (C) 2007 Ilyes Gouta. Based on the m5603x Linux Driver Project. | ||
6 | * Copyright (C) 2005 m5603x Linux Driver Project <m5602@x3ng.com.br> | ||
7 | * | ||
8 | * Portions of code to USB interface and ALi driver software, | ||
9 | * Copyright (c) 2006 Willem Duinker | ||
10 | * v4l2 interface modeled after the V4L2 driver | ||
11 | * for SN9C10x PC Camera Controllers | ||
12 | * | ||
13 | * This program is free software; you can redistribute it and/or | ||
14 | * modify it under the terms of the GNU General Public License as | ||
15 | * published by the Free Software Foundation, version 2. | ||
16 | * | ||
17 | */ | ||
18 | |||
19 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | ||
20 | |||
21 | #include "m5602_mt9m111.h" | ||
22 | |||
23 | static int mt9m111_set_vflip(struct gspca_dev *gspca_dev, __s32 val); | ||
24 | static int mt9m111_get_vflip(struct gspca_dev *gspca_dev, __s32 *val); | ||
25 | static int mt9m111_get_hflip(struct gspca_dev *gspca_dev, __s32 *val); | ||
26 | static int mt9m111_set_hflip(struct gspca_dev *gspca_dev, __s32 val); | ||
27 | static int mt9m111_get_gain(struct gspca_dev *gspca_dev, __s32 *val); | ||
28 | static int mt9m111_set_gain(struct gspca_dev *gspca_dev, __s32 val); | ||
29 | static int mt9m111_set_auto_white_balance(struct gspca_dev *gspca_dev, | ||
30 | __s32 val); | ||
31 | static int mt9m111_get_auto_white_balance(struct gspca_dev *gspca_dev, | ||
32 | __s32 *val); | ||
33 | static int mt9m111_get_green_balance(struct gspca_dev *gspca_dev, __s32 *val); | ||
34 | static int mt9m111_set_green_balance(struct gspca_dev *gspca_dev, __s32 val); | ||
35 | static int mt9m111_get_blue_balance(struct gspca_dev *gspca_dev, __s32 *val); | ||
36 | static int mt9m111_set_blue_balance(struct gspca_dev *gspca_dev, __s32 val); | ||
37 | static int mt9m111_get_red_balance(struct gspca_dev *gspca_dev, __s32 *val); | ||
38 | static int mt9m111_set_red_balance(struct gspca_dev *gspca_dev, __s32 val); | ||
39 | |||
40 | static struct v4l2_pix_format mt9m111_modes[] = { | ||
41 | { | ||
42 | 640, | ||
43 | 480, | ||
44 | V4L2_PIX_FMT_SBGGR8, | ||
45 | V4L2_FIELD_NONE, | ||
46 | .sizeimage = 640 * 480, | ||
47 | .bytesperline = 640, | ||
48 | .colorspace = V4L2_COLORSPACE_SRGB, | ||
49 | .priv = 0 | ||
50 | } | ||
51 | }; | ||
52 | |||
53 | static const struct ctrl mt9m111_ctrls[] = { | ||
54 | #define VFLIP_IDX 0 | ||
55 | { | ||
56 | { | ||
57 | .id = V4L2_CID_VFLIP, | ||
58 | .type = V4L2_CTRL_TYPE_BOOLEAN, | ||
59 | .name = "vertical flip", | ||
60 | .minimum = 0, | ||
61 | .maximum = 1, | ||
62 | .step = 1, | ||
63 | .default_value = 0 | ||
64 | }, | ||
65 | .set = mt9m111_set_vflip, | ||
66 | .get = mt9m111_get_vflip | ||
67 | }, | ||
68 | #define HFLIP_IDX 1 | ||
69 | { | ||
70 | { | ||
71 | .id = V4L2_CID_HFLIP, | ||
72 | .type = V4L2_CTRL_TYPE_BOOLEAN, | ||
73 | .name = "horizontal flip", | ||
74 | .minimum = 0, | ||
75 | .maximum = 1, | ||
76 | .step = 1, | ||
77 | .default_value = 0 | ||
78 | }, | ||
79 | .set = mt9m111_set_hflip, | ||
80 | .get = mt9m111_get_hflip | ||
81 | }, | ||
82 | #define GAIN_IDX 2 | ||
83 | { | ||
84 | { | ||
85 | .id = V4L2_CID_GAIN, | ||
86 | .type = V4L2_CTRL_TYPE_INTEGER, | ||
87 | .name = "gain", | ||
88 | .minimum = 0, | ||
89 | .maximum = (INITIAL_MAX_GAIN - 1) * 2 * 2 * 2, | ||
90 | .step = 1, | ||
91 | .default_value = MT9M111_DEFAULT_GAIN, | ||
92 | .flags = V4L2_CTRL_FLAG_SLIDER | ||
93 | }, | ||
94 | .set = mt9m111_set_gain, | ||
95 | .get = mt9m111_get_gain | ||
96 | }, | ||
97 | #define AUTO_WHITE_BALANCE_IDX 3 | ||
98 | { | ||
99 | { | ||
100 | .id = V4L2_CID_AUTO_WHITE_BALANCE, | ||
101 | .type = V4L2_CTRL_TYPE_BOOLEAN, | ||
102 | .name = "auto white balance", | ||
103 | .minimum = 0, | ||
104 | .maximum = 1, | ||
105 | .step = 1, | ||
106 | .default_value = 0, | ||
107 | }, | ||
108 | .set = mt9m111_set_auto_white_balance, | ||
109 | .get = mt9m111_get_auto_white_balance | ||
110 | }, | ||
111 | #define GREEN_BALANCE_IDX 4 | ||
112 | { | ||
113 | { | ||
114 | .id = M5602_V4L2_CID_GREEN_BALANCE, | ||
115 | .type = V4L2_CTRL_TYPE_INTEGER, | ||
116 | .name = "green balance", | ||
117 | .minimum = 0x00, | ||
118 | .maximum = 0x7ff, | ||
119 | .step = 0x1, | ||
120 | .default_value = MT9M111_GREEN_GAIN_DEFAULT, | ||
121 | .flags = V4L2_CTRL_FLAG_SLIDER | ||
122 | }, | ||
123 | .set = mt9m111_set_green_balance, | ||
124 | .get = mt9m111_get_green_balance | ||
125 | }, | ||
126 | #define BLUE_BALANCE_IDX 5 | ||
127 | { | ||
128 | { | ||
129 | .id = V4L2_CID_BLUE_BALANCE, | ||
130 | .type = V4L2_CTRL_TYPE_INTEGER, | ||
131 | .name = "blue balance", | ||
132 | .minimum = 0x00, | ||
133 | .maximum = 0x7ff, | ||
134 | .step = 0x1, | ||
135 | .default_value = MT9M111_BLUE_GAIN_DEFAULT, | ||
136 | .flags = V4L2_CTRL_FLAG_SLIDER | ||
137 | }, | ||
138 | .set = mt9m111_set_blue_balance, | ||
139 | .get = mt9m111_get_blue_balance | ||
140 | }, | ||
141 | #define RED_BALANCE_IDX 5 | ||
142 | { | ||
143 | { | ||
144 | .id = V4L2_CID_RED_BALANCE, | ||
145 | .type = V4L2_CTRL_TYPE_INTEGER, | ||
146 | .name = "red balance", | ||
147 | .minimum = 0x00, | ||
148 | .maximum = 0x7ff, | ||
149 | .step = 0x1, | ||
150 | .default_value = MT9M111_RED_GAIN_DEFAULT, | ||
151 | .flags = V4L2_CTRL_FLAG_SLIDER | ||
152 | }, | ||
153 | .set = mt9m111_set_red_balance, | ||
154 | .get = mt9m111_get_red_balance | ||
155 | }, | ||
156 | }; | ||
157 | |||
158 | static void mt9m111_dump_registers(struct sd *sd); | ||
159 | |||
160 | int mt9m111_probe(struct sd *sd) | ||
161 | { | ||
162 | u8 data[2] = {0x00, 0x00}; | ||
163 | int i; | ||
164 | s32 *sensor_settings; | ||
165 | |||
166 | if (force_sensor) { | ||
167 | if (force_sensor == MT9M111_SENSOR) { | ||
168 | pr_info("Forcing a %s sensor\n", mt9m111.name); | ||
169 | goto sensor_found; | ||
170 | } | ||
171 | /* If we want to force another sensor, don't try to probe this | ||
172 | * one */ | ||
173 | return -ENODEV; | ||
174 | } | ||
175 | |||
176 | PDEBUG(D_PROBE, "Probing for a mt9m111 sensor"); | ||
177 | |||
178 | /* Do the preinit */ | ||
179 | for (i = 0; i < ARRAY_SIZE(preinit_mt9m111); i++) { | ||
180 | if (preinit_mt9m111[i][0] == BRIDGE) { | ||
181 | m5602_write_bridge(sd, | ||
182 | preinit_mt9m111[i][1], | ||
183 | preinit_mt9m111[i][2]); | ||
184 | } else { | ||
185 | data[0] = preinit_mt9m111[i][2]; | ||
186 | data[1] = preinit_mt9m111[i][3]; | ||
187 | m5602_write_sensor(sd, | ||
188 | preinit_mt9m111[i][1], data, 2); | ||
189 | } | ||
190 | } | ||
191 | |||
192 | if (m5602_read_sensor(sd, MT9M111_SC_CHIPVER, data, 2)) | ||
193 | return -ENODEV; | ||
194 | |||
195 | if ((data[0] == 0x14) && (data[1] == 0x3a)) { | ||
196 | pr_info("Detected a mt9m111 sensor\n"); | ||
197 | goto sensor_found; | ||
198 | } | ||
199 | |||
200 | return -ENODEV; | ||
201 | |||
202 | sensor_found: | ||
203 | sensor_settings = kmalloc(ARRAY_SIZE(mt9m111_ctrls) * sizeof(s32), | ||
204 | GFP_KERNEL); | ||
205 | if (!sensor_settings) | ||
206 | return -ENOMEM; | ||
207 | |||
208 | sd->gspca_dev.cam.cam_mode = mt9m111_modes; | ||
209 | sd->gspca_dev.cam.nmodes = ARRAY_SIZE(mt9m111_modes); | ||
210 | sd->desc->ctrls = mt9m111_ctrls; | ||
211 | sd->desc->nctrls = ARRAY_SIZE(mt9m111_ctrls); | ||
212 | |||
213 | for (i = 0; i < ARRAY_SIZE(mt9m111_ctrls); i++) | ||
214 | sensor_settings[i] = mt9m111_ctrls[i].qctrl.default_value; | ||
215 | sd->sensor_priv = sensor_settings; | ||
216 | |||
217 | return 0; | ||
218 | } | ||
219 | |||
220 | int mt9m111_init(struct sd *sd) | ||
221 | { | ||
222 | int i, err = 0; | ||
223 | s32 *sensor_settings = sd->sensor_priv; | ||
224 | |||
225 | /* Init the sensor */ | ||
226 | for (i = 0; i < ARRAY_SIZE(init_mt9m111) && !err; i++) { | ||
227 | u8 data[2]; | ||
228 | |||
229 | if (init_mt9m111[i][0] == BRIDGE) { | ||
230 | err = m5602_write_bridge(sd, | ||
231 | init_mt9m111[i][1], | ||
232 | init_mt9m111[i][2]); | ||
233 | } else { | ||
234 | data[0] = init_mt9m111[i][2]; | ||
235 | data[1] = init_mt9m111[i][3]; | ||
236 | err = m5602_write_sensor(sd, | ||
237 | init_mt9m111[i][1], data, 2); | ||
238 | } | ||
239 | } | ||
240 | |||
241 | if (dump_sensor) | ||
242 | mt9m111_dump_registers(sd); | ||
243 | |||
244 | err = mt9m111_set_vflip(&sd->gspca_dev, sensor_settings[VFLIP_IDX]); | ||
245 | if (err < 0) | ||
246 | return err; | ||
247 | |||
248 | err = mt9m111_set_hflip(&sd->gspca_dev, sensor_settings[HFLIP_IDX]); | ||
249 | if (err < 0) | ||
250 | return err; | ||
251 | |||
252 | err = mt9m111_set_green_balance(&sd->gspca_dev, | ||
253 | sensor_settings[GREEN_BALANCE_IDX]); | ||
254 | if (err < 0) | ||
255 | return err; | ||
256 | |||
257 | err = mt9m111_set_blue_balance(&sd->gspca_dev, | ||
258 | sensor_settings[BLUE_BALANCE_IDX]); | ||
259 | if (err < 0) | ||
260 | return err; | ||
261 | |||
262 | err = mt9m111_set_red_balance(&sd->gspca_dev, | ||
263 | sensor_settings[RED_BALANCE_IDX]); | ||
264 | if (err < 0) | ||
265 | return err; | ||
266 | |||
267 | return mt9m111_set_gain(&sd->gspca_dev, sensor_settings[GAIN_IDX]); | ||
268 | } | ||
269 | |||
270 | int mt9m111_start(struct sd *sd) | ||
271 | { | ||
272 | int i, err = 0; | ||
273 | u8 data[2]; | ||
274 | struct cam *cam = &sd->gspca_dev.cam; | ||
275 | s32 *sensor_settings = sd->sensor_priv; | ||
276 | |||
277 | int width = cam->cam_mode[sd->gspca_dev.curr_mode].width - 1; | ||
278 | int height = cam->cam_mode[sd->gspca_dev.curr_mode].height; | ||
279 | |||
280 | for (i = 0; i < ARRAY_SIZE(start_mt9m111) && !err; i++) { | ||
281 | if (start_mt9m111[i][0] == BRIDGE) { | ||
282 | err = m5602_write_bridge(sd, | ||
283 | start_mt9m111[i][1], | ||
284 | start_mt9m111[i][2]); | ||
285 | } else { | ||
286 | data[0] = start_mt9m111[i][2]; | ||
287 | data[1] = start_mt9m111[i][3]; | ||
288 | err = m5602_write_sensor(sd, | ||
289 | start_mt9m111[i][1], data, 2); | ||
290 | } | ||
291 | } | ||
292 | if (err < 0) | ||
293 | return err; | ||
294 | |||
295 | err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, (height >> 8) & 0xff); | ||
296 | if (err < 0) | ||
297 | return err; | ||
298 | |||
299 | err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, (height & 0xff)); | ||
300 | if (err < 0) | ||
301 | return err; | ||
302 | |||
303 | for (i = 0; i < 2 && !err; i++) | ||
304 | err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, 0); | ||
305 | if (err < 0) | ||
306 | return err; | ||
307 | |||
308 | err = m5602_write_bridge(sd, M5602_XB_SIG_INI, 0); | ||
309 | if (err < 0) | ||
310 | return err; | ||
311 | |||
312 | err = m5602_write_bridge(sd, M5602_XB_SIG_INI, 2); | ||
313 | if (err < 0) | ||
314 | return err; | ||
315 | |||
316 | for (i = 0; i < 2 && !err; i++) | ||
317 | err = m5602_write_bridge(sd, M5602_XB_HSYNC_PARA, 0); | ||
318 | if (err < 0) | ||
319 | return err; | ||
320 | |||
321 | err = m5602_write_bridge(sd, M5602_XB_HSYNC_PARA, | ||
322 | (width >> 8) & 0xff); | ||
323 | if (err < 0) | ||
324 | return err; | ||
325 | |||
326 | err = m5602_write_bridge(sd, M5602_XB_HSYNC_PARA, width & 0xff); | ||
327 | if (err < 0) | ||
328 | return err; | ||
329 | |||
330 | err = m5602_write_bridge(sd, M5602_XB_SIG_INI, 0); | ||
331 | if (err < 0) | ||
332 | return err; | ||
333 | |||
334 | switch (width) { | ||
335 | case 640: | ||
336 | PDEBUG(D_V4L2, "Configuring camera for VGA mode"); | ||
337 | data[0] = MT9M111_RMB_OVER_SIZED; | ||
338 | data[1] = MT9M111_RMB_ROW_SKIP_2X | | ||
339 | MT9M111_RMB_COLUMN_SKIP_2X | | ||
340 | (sensor_settings[VFLIP_IDX] << 0) | | ||
341 | (sensor_settings[HFLIP_IDX] << 1); | ||
342 | |||
343 | err = m5602_write_sensor(sd, | ||
344 | MT9M111_SC_R_MODE_CONTEXT_B, data, 2); | ||
345 | break; | ||
346 | |||
347 | case 320: | ||
348 | PDEBUG(D_V4L2, "Configuring camera for QVGA mode"); | ||
349 | data[0] = MT9M111_RMB_OVER_SIZED; | ||
350 | data[1] = MT9M111_RMB_ROW_SKIP_4X | | ||
351 | MT9M111_RMB_COLUMN_SKIP_4X | | ||
352 | (sensor_settings[VFLIP_IDX] << 0) | | ||
353 | (sensor_settings[HFLIP_IDX] << 1); | ||
354 | err = m5602_write_sensor(sd, | ||
355 | MT9M111_SC_R_MODE_CONTEXT_B, data, 2); | ||
356 | break; | ||
357 | } | ||
358 | return err; | ||
359 | } | ||
360 | |||
361 | void mt9m111_disconnect(struct sd *sd) | ||
362 | { | ||
363 | sd->sensor = NULL; | ||
364 | kfree(sd->sensor_priv); | ||
365 | } | ||
366 | |||
367 | static int mt9m111_get_vflip(struct gspca_dev *gspca_dev, __s32 *val) | ||
368 | { | ||
369 | struct sd *sd = (struct sd *) gspca_dev; | ||
370 | s32 *sensor_settings = sd->sensor_priv; | ||
371 | |||
372 | *val = sensor_settings[VFLIP_IDX]; | ||
373 | PDEBUG(D_V4L2, "Read vertical flip %d", *val); | ||
374 | |||
375 | return 0; | ||
376 | } | ||
377 | |||
378 | static int mt9m111_set_vflip(struct gspca_dev *gspca_dev, __s32 val) | ||
379 | { | ||
380 | int err; | ||
381 | u8 data[2] = {0x00, 0x00}; | ||
382 | struct sd *sd = (struct sd *) gspca_dev; | ||
383 | s32 *sensor_settings = sd->sensor_priv; | ||
384 | |||
385 | PDEBUG(D_V4L2, "Set vertical flip to %d", val); | ||
386 | |||
387 | sensor_settings[VFLIP_IDX] = val; | ||
388 | |||
389 | /* The mt9m111 is flipped by default */ | ||
390 | val = !val; | ||
391 | |||
392 | /* Set the correct page map */ | ||
393 | err = m5602_write_sensor(sd, MT9M111_PAGE_MAP, data, 2); | ||
394 | if (err < 0) | ||
395 | return err; | ||
396 | |||
397 | err = m5602_read_sensor(sd, MT9M111_SC_R_MODE_CONTEXT_B, data, 2); | ||
398 | if (err < 0) | ||
399 | return err; | ||
400 | |||
401 | data[1] = (data[1] & 0xfe) | val; | ||
402 | err = m5602_write_sensor(sd, MT9M111_SC_R_MODE_CONTEXT_B, | ||
403 | data, 2); | ||
404 | return err; | ||
405 | } | ||
406 | |||
407 | static int mt9m111_get_hflip(struct gspca_dev *gspca_dev, __s32 *val) | ||
408 | { | ||
409 | struct sd *sd = (struct sd *) gspca_dev; | ||
410 | s32 *sensor_settings = sd->sensor_priv; | ||
411 | |||
412 | *val = sensor_settings[HFLIP_IDX]; | ||
413 | PDEBUG(D_V4L2, "Read horizontal flip %d", *val); | ||
414 | |||
415 | return 0; | ||
416 | } | ||
417 | |||
418 | static int mt9m111_set_hflip(struct gspca_dev *gspca_dev, __s32 val) | ||
419 | { | ||
420 | int err; | ||
421 | u8 data[2] = {0x00, 0x00}; | ||
422 | struct sd *sd = (struct sd *) gspca_dev; | ||
423 | s32 *sensor_settings = sd->sensor_priv; | ||
424 | |||
425 | PDEBUG(D_V4L2, "Set horizontal flip to %d", val); | ||
426 | |||
427 | sensor_settings[HFLIP_IDX] = val; | ||
428 | |||
429 | /* The mt9m111 is flipped by default */ | ||
430 | val = !val; | ||
431 | |||
432 | /* Set the correct page map */ | ||
433 | err = m5602_write_sensor(sd, MT9M111_PAGE_MAP, data, 2); | ||
434 | if (err < 0) | ||
435 | return err; | ||
436 | |||
437 | err = m5602_read_sensor(sd, MT9M111_SC_R_MODE_CONTEXT_B, data, 2); | ||
438 | if (err < 0) | ||
439 | return err; | ||
440 | |||
441 | data[1] = (data[1] & 0xfd) | ((val << 1) & 0x02); | ||
442 | err = m5602_write_sensor(sd, MT9M111_SC_R_MODE_CONTEXT_B, | ||
443 | data, 2); | ||
444 | return err; | ||
445 | } | ||
446 | |||
447 | static int mt9m111_get_gain(struct gspca_dev *gspca_dev, __s32 *val) | ||
448 | { | ||
449 | struct sd *sd = (struct sd *) gspca_dev; | ||
450 | s32 *sensor_settings = sd->sensor_priv; | ||
451 | |||
452 | *val = sensor_settings[GAIN_IDX]; | ||
453 | PDEBUG(D_V4L2, "Read gain %d", *val); | ||
454 | |||
455 | return 0; | ||
456 | } | ||
457 | |||
458 | static int mt9m111_set_auto_white_balance(struct gspca_dev *gspca_dev, | ||
459 | __s32 val) | ||
460 | { | ||
461 | struct sd *sd = (struct sd *) gspca_dev; | ||
462 | s32 *sensor_settings = sd->sensor_priv; | ||
463 | int err; | ||
464 | u8 data[2]; | ||
465 | |||
466 | err = m5602_read_sensor(sd, MT9M111_CP_OPERATING_MODE_CTL, data, 2); | ||
467 | if (err < 0) | ||
468 | return err; | ||
469 | |||
470 | sensor_settings[AUTO_WHITE_BALANCE_IDX] = val & 0x01; | ||
471 | data[1] = ((data[1] & 0xfd) | ((val & 0x01) << 1)); | ||
472 | |||
473 | err = m5602_write_sensor(sd, MT9M111_CP_OPERATING_MODE_CTL, data, 2); | ||
474 | |||
475 | PDEBUG(D_V4L2, "Set auto white balance %d", val); | ||
476 | return err; | ||
477 | } | ||
478 | |||
479 | static int mt9m111_get_auto_white_balance(struct gspca_dev *gspca_dev, | ||
480 | __s32 *val) { | ||
481 | struct sd *sd = (struct sd *) gspca_dev; | ||
482 | s32 *sensor_settings = sd->sensor_priv; | ||
483 | |||
484 | *val = sensor_settings[AUTO_WHITE_BALANCE_IDX]; | ||
485 | PDEBUG(D_V4L2, "Read auto white balance %d", *val); | ||
486 | return 0; | ||
487 | } | ||
488 | |||
489 | static int mt9m111_set_gain(struct gspca_dev *gspca_dev, __s32 val) | ||
490 | { | ||
491 | int err, tmp; | ||
492 | u8 data[2] = {0x00, 0x00}; | ||
493 | struct sd *sd = (struct sd *) gspca_dev; | ||
494 | s32 *sensor_settings = sd->sensor_priv; | ||
495 | |||
496 | sensor_settings[GAIN_IDX] = val; | ||
497 | |||
498 | /* Set the correct page map */ | ||
499 | err = m5602_write_sensor(sd, MT9M111_PAGE_MAP, data, 2); | ||
500 | if (err < 0) | ||
501 | return err; | ||
502 | |||
503 | if (val >= INITIAL_MAX_GAIN * 2 * 2 * 2) | ||
504 | return -EINVAL; | ||
505 | |||
506 | if ((val >= INITIAL_MAX_GAIN * 2 * 2) && | ||
507 | (val < (INITIAL_MAX_GAIN - 1) * 2 * 2 * 2)) | ||
508 | tmp = (1 << 10) | (val << 9) | | ||
509 | (val << 8) | (val / 8); | ||
510 | else if ((val >= INITIAL_MAX_GAIN * 2) && | ||
511 | (val < INITIAL_MAX_GAIN * 2 * 2)) | ||
512 | tmp = (1 << 9) | (1 << 8) | (val / 4); | ||
513 | else if ((val >= INITIAL_MAX_GAIN) && | ||
514 | (val < INITIAL_MAX_GAIN * 2)) | ||
515 | tmp = (1 << 8) | (val / 2); | ||
516 | else | ||
517 | tmp = val; | ||
518 | |||
519 | data[1] = (tmp & 0xff); | ||
520 | data[0] = (tmp & 0xff00) >> 8; | ||
521 | PDEBUG(D_V4L2, "tmp=%d, data[1]=%d, data[0]=%d", tmp, | ||
522 | data[1], data[0]); | ||
523 | |||
524 | err = m5602_write_sensor(sd, MT9M111_SC_GLOBAL_GAIN, | ||
525 | data, 2); | ||
526 | |||
527 | return err; | ||
528 | } | ||
529 | |||
530 | static int mt9m111_set_green_balance(struct gspca_dev *gspca_dev, __s32 val) | ||
531 | { | ||
532 | int err; | ||
533 | u8 data[2]; | ||
534 | struct sd *sd = (struct sd *) gspca_dev; | ||
535 | s32 *sensor_settings = sd->sensor_priv; | ||
536 | |||
537 | sensor_settings[GREEN_BALANCE_IDX] = val; | ||
538 | data[1] = (val & 0xff); | ||
539 | data[0] = (val & 0xff00) >> 8; | ||
540 | |||
541 | PDEBUG(D_V4L2, "Set green balance %d", val); | ||
542 | err = m5602_write_sensor(sd, MT9M111_SC_GREEN_1_GAIN, | ||
543 | data, 2); | ||
544 | if (err < 0) | ||
545 | return err; | ||
546 | |||
547 | return m5602_write_sensor(sd, MT9M111_SC_GREEN_2_GAIN, | ||
548 | data, 2); | ||
549 | } | ||
550 | |||
551 | static int mt9m111_get_green_balance(struct gspca_dev *gspca_dev, __s32 *val) | ||
552 | { | ||
553 | struct sd *sd = (struct sd *) gspca_dev; | ||
554 | s32 *sensor_settings = sd->sensor_priv; | ||
555 | |||
556 | *val = sensor_settings[GREEN_BALANCE_IDX]; | ||
557 | PDEBUG(D_V4L2, "Read green balance %d", *val); | ||
558 | return 0; | ||
559 | } | ||
560 | |||
561 | static int mt9m111_set_blue_balance(struct gspca_dev *gspca_dev, __s32 val) | ||
562 | { | ||
563 | u8 data[2]; | ||
564 | struct sd *sd = (struct sd *) gspca_dev; | ||
565 | s32 *sensor_settings = sd->sensor_priv; | ||
566 | |||
567 | sensor_settings[BLUE_BALANCE_IDX] = val; | ||
568 | data[1] = (val & 0xff); | ||
569 | data[0] = (val & 0xff00) >> 8; | ||
570 | |||
571 | PDEBUG(D_V4L2, "Set blue balance %d", val); | ||
572 | |||
573 | return m5602_write_sensor(sd, MT9M111_SC_BLUE_GAIN, | ||
574 | data, 2); | ||
575 | } | ||
576 | |||
577 | static int mt9m111_get_blue_balance(struct gspca_dev *gspca_dev, __s32 *val) | ||
578 | { | ||
579 | struct sd *sd = (struct sd *) gspca_dev; | ||
580 | s32 *sensor_settings = sd->sensor_priv; | ||
581 | |||
582 | *val = sensor_settings[BLUE_BALANCE_IDX]; | ||
583 | PDEBUG(D_V4L2, "Read blue balance %d", *val); | ||
584 | return 0; | ||
585 | } | ||
586 | |||
587 | static int mt9m111_set_red_balance(struct gspca_dev *gspca_dev, __s32 val) | ||
588 | { | ||
589 | u8 data[2]; | ||
590 | struct sd *sd = (struct sd *) gspca_dev; | ||
591 | s32 *sensor_settings = sd->sensor_priv; | ||
592 | |||
593 | sensor_settings[RED_BALANCE_IDX] = val; | ||
594 | data[1] = (val & 0xff); | ||
595 | data[0] = (val & 0xff00) >> 8; | ||
596 | |||
597 | PDEBUG(D_V4L2, "Set red balance %d", val); | ||
598 | |||
599 | return m5602_write_sensor(sd, MT9M111_SC_RED_GAIN, | ||
600 | data, 2); | ||
601 | } | ||
602 | |||
603 | static int mt9m111_get_red_balance(struct gspca_dev *gspca_dev, __s32 *val) | ||
604 | { | ||
605 | struct sd *sd = (struct sd *) gspca_dev; | ||
606 | s32 *sensor_settings = sd->sensor_priv; | ||
607 | |||
608 | *val = sensor_settings[RED_BALANCE_IDX]; | ||
609 | PDEBUG(D_V4L2, "Read red balance %d", *val); | ||
610 | return 0; | ||
611 | } | ||
612 | |||
613 | static void mt9m111_dump_registers(struct sd *sd) | ||
614 | { | ||
615 | u8 address, value[2] = {0x00, 0x00}; | ||
616 | |||
617 | pr_info("Dumping the mt9m111 register state\n"); | ||
618 | |||
619 | pr_info("Dumping the mt9m111 sensor core registers\n"); | ||
620 | value[1] = MT9M111_SENSOR_CORE; | ||
621 | m5602_write_sensor(sd, MT9M111_PAGE_MAP, value, 2); | ||
622 | for (address = 0; address < 0xff; address++) { | ||
623 | m5602_read_sensor(sd, address, value, 2); | ||
624 | pr_info("register 0x%x contains 0x%x%x\n", | ||
625 | address, value[0], value[1]); | ||
626 | } | ||
627 | |||
628 | pr_info("Dumping the mt9m111 color pipeline registers\n"); | ||
629 | value[1] = MT9M111_COLORPIPE; | ||
630 | m5602_write_sensor(sd, MT9M111_PAGE_MAP, value, 2); | ||
631 | for (address = 0; address < 0xff; address++) { | ||
632 | m5602_read_sensor(sd, address, value, 2); | ||
633 | pr_info("register 0x%x contains 0x%x%x\n", | ||
634 | address, value[0], value[1]); | ||
635 | } | ||
636 | |||
637 | pr_info("Dumping the mt9m111 camera control registers\n"); | ||
638 | value[1] = MT9M111_CAMERA_CONTROL; | ||
639 | m5602_write_sensor(sd, MT9M111_PAGE_MAP, value, 2); | ||
640 | for (address = 0; address < 0xff; address++) { | ||
641 | m5602_read_sensor(sd, address, value, 2); | ||
642 | pr_info("register 0x%x contains 0x%x%x\n", | ||
643 | address, value[0], value[1]); | ||
644 | } | ||
645 | |||
646 | pr_info("mt9m111 register state dump complete\n"); | ||
647 | } | ||