projects / linux-2.6-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
[media] b2c2: fix driver's build due to the lack of pci DMA code
[linux-2.6-block.git] / drivers / media / video / gspca / m5602 / m5602_po1030.c
CommitLineData
c109f816
EA		 1/*
2 * Driver for the po1030 sensor
3 *
0c505e68 4 * Copyright (c) 2008 Erik Andrén
c109f816
EA		 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
bdfe91f4
JP		 19#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
20
c109f816
EA		 21#include "m5602_po1030.h"
22
cf811d50
EA		 23static int po1030_get_exposure(struct gspca_dev *gspca_dev, __s32 *val);
24static int po1030_set_exposure(struct gspca_dev *gspca_dev, __s32 val);
25static int po1030_get_gain(struct gspca_dev *gspca_dev, __s32 *val);
26static int po1030_set_gain(struct gspca_dev *gspca_dev, __s32 val);
27static int po1030_get_red_balance(struct gspca_dev *gspca_dev, __s32 *val);
28static int po1030_set_red_balance(struct gspca_dev *gspca_dev, __s32 val);
29static int po1030_get_blue_balance(struct gspca_dev *gspca_dev, __s32 *val);
30static int po1030_set_blue_balance(struct gspca_dev *gspca_dev, __s32 val);
b933d585
EA		 31static int po1030_get_green_balance(struct gspca_dev *gspca_dev, __s32 *val);
32static int po1030_set_green_balance(struct gspca_dev *gspca_dev, __s32 val);
cf811d50
EA		 33static int po1030_get_hflip(struct gspca_dev *gspca_dev, __s32 *val);
34static int po1030_set_hflip(struct gspca_dev *gspca_dev, __s32 val);
35static int po1030_get_vflip(struct gspca_dev *gspca_dev, __s32 *val);
36static int po1030_set_vflip(struct gspca_dev *gspca_dev, __s32 val);
37static int po1030_set_auto_white_balance(struct gspca_dev *gspca_dev,
38 __s32 val);
39static int po1030_get_auto_white_balance(struct gspca_dev *gspca_dev,
40 __s32 *val);
dd9ce84a
EA		 41static int po1030_set_auto_exposure(struct gspca_dev *gspca_dev,
42 __s32 val);
43static int po1030_get_auto_exposure(struct gspca_dev *gspca_dev,
44 __s32 *val);
cf811d50 45
74cadfe1
EA		 46static struct v4l2_pix_format po1030_modes[] = {
47 {
48 640,
49 480,
50 V4L2_PIX_FMT_SBGGR8,
51 V4L2_FIELD_NONE,
52 .sizeimage = 640 * 480,
53 .bytesperline = 640,
54 .colorspace = V4L2_COLORSPACE_SRGB,
9536a57e 55 .priv = 2
74cadfe1
EA		 56 }
57};
58
2e03669d 59static const struct ctrl po1030_ctrls[] = {
05d7d9ce 60#define GAIN_IDX 0
e17cc08c
EA		 61 {
62 {
780e3121
JFM		 63 .id = V4L2_CID_GAIN,
64 .type = V4L2_CTRL_TYPE_INTEGER,
65 .name = "gain",
66 .minimum = 0x00,
67 .maximum = 0x4f,
68 .step = 0x1,
69 .default_value = PO1030_GLOBAL_GAIN_DEFAULT,
70 .flags = V4L2_CTRL_FLAG_SLIDER
e17cc08c
EA		 71 },
72 .set = po1030_set_gain,
73 .get = po1030_get_gain
05d7d9ce
EA		 74 },
75#define EXPOSURE_IDX 1
76 {
e17cc08c 77 {
780e3121
JFM		 78 .id = V4L2_CID_EXPOSURE,
79 .type = V4L2_CTRL_TYPE_INTEGER,
80 .name = "exposure",
81 .minimum = 0x00,
82 .maximum = 0x02ff,
83 .step = 0x1,
84 .default_value = PO1030_EXPOSURE_DEFAULT,
85 .flags = V4L2_CTRL_FLAG_SLIDER
e17cc08c
EA		 86 },
87 .set = po1030_set_exposure,
88 .get = po1030_get_exposure
05d7d9ce
EA		 89 },
90#define RED_BALANCE_IDX 2
91 {
e17cc08c 92 {
780e3121
JFM		 93 .id = V4L2_CID_RED_BALANCE,
94 .type = V4L2_CTRL_TYPE_INTEGER,
95 .name = "red balance",
96 .minimum = 0x00,
97 .maximum = 0xff,
98 .step = 0x1,
99 .default_value = PO1030_RED_GAIN_DEFAULT,
100 .flags = V4L2_CTRL_FLAG_SLIDER
e17cc08c
EA		 101 },
102 .set = po1030_set_red_balance,
103 .get = po1030_get_red_balance
05d7d9ce
EA		 104 },
105#define BLUE_BALANCE_IDX 3
106 {
e17cc08c 107 {
780e3121
JFM		 108 .id = V4L2_CID_BLUE_BALANCE,
109 .type = V4L2_CTRL_TYPE_INTEGER,
110 .name = "blue balance",
111 .minimum = 0x00,
112 .maximum = 0xff,
113 .step = 0x1,
114 .default_value = PO1030_BLUE_GAIN_DEFAULT,
115 .flags = V4L2_CTRL_FLAG_SLIDER
e17cc08c
EA		 116 },
117 .set = po1030_set_blue_balance,
118 .get = po1030_get_blue_balance
05d7d9ce
EA		 119 },
120#define HFLIP_IDX 4
121 {
e17cc08c 122 {
780e3121
JFM		 123 .id = V4L2_CID_HFLIP,
124 .type = V4L2_CTRL_TYPE_BOOLEAN,
125 .name = "horizontal flip",
126 .minimum = 0,
127 .maximum = 1,
128 .step = 1,
129 .default_value = 0,
e17cc08c
EA		 130 },
131 .set = po1030_set_hflip,
132 .get = po1030_get_hflip
05d7d9ce
EA		 133 },
134#define VFLIP_IDX 5
135 {
e17cc08c 136 {
780e3121
JFM		 137 .id = V4L2_CID_VFLIP,
138 .type = V4L2_CTRL_TYPE_BOOLEAN,
139 .name = "vertical flip",
140 .minimum = 0,
141 .maximum = 1,
142 .step = 1,
143 .default_value = 0,
e17cc08c
EA		 144 },
145 .set = po1030_set_vflip,
146 .get = po1030_get_vflip
3b9ae658
EA		 147 },
148#define AUTO_WHITE_BALANCE_IDX 6
149 {
150 {
780e3121
JFM		 151 .id = V4L2_CID_AUTO_WHITE_BALANCE,
152 .type = V4L2_CTRL_TYPE_BOOLEAN,
153 .name = "auto white balance",
154 .minimum = 0,
155 .maximum = 1,
156 .step = 1,
157 .default_value = 0,
3b9ae658
EA		 158 },
159 .set = po1030_set_auto_white_balance,
160 .get = po1030_get_auto_white_balance
dd9ce84a
EA		 161 },
162#define AUTO_EXPOSURE_IDX 7
163 {
164 {
780e3121
JFM		 165 .id = V4L2_CID_EXPOSURE_AUTO,
166 .type = V4L2_CTRL_TYPE_BOOLEAN,
167 .name = "auto exposure",
168 .minimum = 0,
169 .maximum = 1,
170 .step = 1,
171 .default_value = 0,
dd9ce84a
EA		 172 },
173 .set = po1030_set_auto_exposure,
174 .get = po1030_get_auto_exposure
175 },
b933d585
EA		 176#define GREEN_BALANCE_IDX 8
177 {
178 {
780e3121
JFM		 179 .id = M5602_V4L2_CID_GREEN_BALANCE,
180 .type = V4L2_CTRL_TYPE_INTEGER,
181 .name = "green balance",
182 .minimum = 0x00,
183 .maximum = 0xff,
184 .step = 0x1,
185 .default_value = PO1030_GREEN_GAIN_DEFAULT,
186 .flags = V4L2_CTRL_FLAG_SLIDER
b933d585
EA		 187 },
188 .set = po1030_set_green_balance,
189 .get = po1030_get_green_balance
190 },
e17cc08c
EA		 191};
192
658efb63
EA		 193static void po1030_dump_registers(struct sd *sd);
194
c109f816
EA		 195int po1030_probe(struct sd *sd)
196{
3e5cbad0 197 u8 dev_id_h = 0, i;
cb29e691 198 s32 *sensor_settings;
c109f816
EA		 199
200 if (force_sensor) {
201 if (force_sensor == PO1030_SENSOR) {
bdfe91f4 202 pr_info("Forcing a %s sensor\n", po1030.name);
c109f816
EA		 203 goto sensor_found;
204 }
205 /* If we want to force another sensor, don't try to probe this
206 * one */
207 return -ENODEV;
208 }
209
969cc926 210 PDEBUG(D_PROBE, "Probing for a po1030 sensor");
c109f816
EA		 211
212 /* Run the pre-init to actually probe the unit */
213 for (i = 0; i < ARRAY_SIZE(preinit_po1030); i++) {
214 u8 data = preinit_po1030[i][2];
215 if (preinit_po1030[i][0] == SENSOR)
6dc4cff0 216 m5602_write_sensor(sd,
c109f816
EA		 217 preinit_po1030[i][1], &data, 1);
218 else
219 m5602_write_bridge(sd, preinit_po1030[i][1], data);
220 }
221
fcb98108 222 if (m5602_read_sensor(sd, PO1030_DEVID_H, &dev_id_h, 1))
c109f816
EA		 223 return -ENODEV;
224
3e5cbad0 225 if (dev_id_h == 0x30) {
bdfe91f4 226 pr_info("Detected a po1030 sensor\n");
c109f816
EA		 227 goto sensor_found;
228 }
229 return -ENODEV;
230
231sensor_found:
05d7d9ce
EA		 232 sensor_settings = kmalloc(
233 ARRAY_SIZE(po1030_ctrls) * sizeof(s32), GFP_KERNEL);
234 if (!sensor_settings)
235 return -ENOMEM;
236
74cadfe1
EA		 237 sd->gspca_dev.cam.cam_mode = po1030_modes;
238 sd->gspca_dev.cam.nmodes = ARRAY_SIZE(po1030_modes);
e17cc08c 239 sd->desc->ctrls = po1030_ctrls;
e4cc4fcc 240 sd->desc->nctrls = ARRAY_SIZE(po1030_ctrls);
05d7d9ce
EA		 241
242 for (i = 0; i < ARRAY_SIZE(po1030_ctrls); i++)
243 sensor_settings[i] = po1030_ctrls[i].qctrl.default_value;
244 sd->sensor_priv = sensor_settings;
cb29e691 245
c109f816
EA		 246 return 0;
247}
248
c109f816
EA		 249int po1030_init(struct sd *sd)
250{
cb29e691 251 s32 *sensor_settings = sd->sensor_priv;
c109f816
EA		 252 int i, err = 0;
253
254 /* Init the sensor */
7b9f2467 255 for (i = 0; i < ARRAY_SIZE(init_po1030) && !err; i++) {
c109f816
EA		 256 u8 data[2] = {0x00, 0x00};
257
258 switch (init_po1030[i][0]) {
259 case BRIDGE:
260 err = m5602_write_bridge(sd,
261 init_po1030[i][1],
262 init_po1030[i][2]);
263 break;
264
265 case SENSOR:
266 data[0] = init_po1030[i][2];
6dc4cff0 267 err = m5602_write_sensor(sd,
c109f816
EA		 268 init_po1030[i][1], data, 1);
269 break;
270
c109f816 271 default:
bdfe91f4 272 pr_info("Invalid stream command, exiting init\n");
c109f816
EA		 273 return -EINVAL;
274 }
275 }
cb29e691
EA		 276 if (err < 0)
277 return err;
c109f816 278
36e756c5
EA		 279 if (dump_sensor)
280 po1030_dump_registers(sd);
281
cb29e691
EA		 282 err = po1030_set_exposure(&sd->gspca_dev,
283 sensor_settings[EXPOSURE_IDX]);
284 if (err < 0)
285 return err;
286
287 err = po1030_set_gain(&sd->gspca_dev, sensor_settings[GAIN_IDX]);
288 if (err < 0)
289 return err;
290
291 err = po1030_set_hflip(&sd->gspca_dev, sensor_settings[HFLIP_IDX]);
292 if (err < 0)
293 return err;
294
295 err = po1030_set_vflip(&sd->gspca_dev, sensor_settings[VFLIP_IDX]);
296 if (err < 0)
297 return err;
298
299 err = po1030_set_red_balance(&sd->gspca_dev,
300 sensor_settings[RED_BALANCE_IDX]);
301 if (err < 0)
302 return err;
c109f816 303
926d5038 304 err = po1030_set_blue_balance(&sd->gspca_dev,
cb29e691 305 sensor_settings[BLUE_BALANCE_IDX]);
3b9ae658
EA		 306 if (err < 0)
307 return err;
308
b933d585
EA		 309 err = po1030_set_green_balance(&sd->gspca_dev,
310 sensor_settings[GREEN_BALANCE_IDX]);
311 if (err < 0)
312 return err;
313
3b9ae658 314 err = po1030_set_auto_white_balance(&sd->gspca_dev,
dd9ce84a
EA		 315 sensor_settings[AUTO_WHITE_BALANCE_IDX]);
316 if (err < 0)
317 return err;
318
319 err = po1030_set_auto_exposure(&sd->gspca_dev,
320 sensor_settings[AUTO_EXPOSURE_IDX]);
7b9f2467 321 return err;
c109f816
EA		 322}
323
c996b368
EA		 324int po1030_start(struct sd *sd)
325{
e807f20d 326 struct cam *cam = &sd->gspca_dev.cam;
c996b368 327 int i, err = 0;
e807f20d
EA		 328 int width = cam->cam_mode[sd->gspca_dev.curr_mode].width;
329 int height = cam->cam_mode[sd->gspca_dev.curr_mode].height;
9536a57e 330 int ver_offs = cam->cam_mode[sd->gspca_dev.curr_mode].priv;
e807f20d
EA		 331 u8 data;
332
333 switch (width) {
931a1c8d
EA		 334 case 320:
335 data = PO1030_SUBSAMPLING;
336 err = m5602_write_sensor(sd, PO1030_CONTROL3, &data, 1);
337 if (err < 0)
338 return err;
339
340 data = ((width + 3) >> 8) & 0xff;
341 err = m5602_write_sensor(sd, PO1030_WINDOWWIDTH_H, &data, 1);
342 if (err < 0)
343 return err;
344
345 data = (width + 3) & 0xff;
346 err = m5602_write_sensor(sd, PO1030_WINDOWWIDTH_L, &data, 1);
347 if (err < 0)
348 return err;
349
350 data = ((height + 1) >> 8) & 0xff;
351 err = m5602_write_sensor(sd, PO1030_WINDOWHEIGHT_H, &data, 1);
352 if (err < 0)
353 return err;
354
355 data = (height + 1) & 0xff;
356 err = m5602_write_sensor(sd, PO1030_WINDOWHEIGHT_L, &data, 1);
357
358 height += 6;
359 width -= 1;
360 break;
361
e807f20d 362 case 640:
894e4087
EA		 363 data = 0;
364 err = m5602_write_sensor(sd, PO1030_CONTROL3, &data, 1);
365 if (err < 0)
366 return err;
367
e807f20d
EA		 368 data = ((width + 7) >> 8) & 0xff;
369 err = m5602_write_sensor(sd, PO1030_WINDOWWIDTH_H, &data, 1);
370 if (err < 0)
371 return err;
372
373 data = (width + 7) & 0xff;
374 err = m5602_write_sensor(sd, PO1030_WINDOWWIDTH_L, &data, 1);
375 if (err < 0)
376 return err;
377
378 data = ((height + 3) >> 8) & 0xff;
379 err = m5602_write_sensor(sd, PO1030_WINDOWHEIGHT_H, &data, 1);
380 if (err < 0)
381 return err;
382
383 data = (height + 3) & 0xff;
384 err = m5602_write_sensor(sd, PO1030_WINDOWHEIGHT_L, &data, 1);
9536a57e
EA		 385
386 height += 12;
387 width -= 2;
e807f20d
EA		 388 break;
389 }
98192670
EA		 390 err = m5602_write_bridge(sd, M5602_XB_SENSOR_TYPE, 0x0c);
391 if (err < 0)
392 return err;
e807f20d 393
9536a57e
EA		 394 err = m5602_write_bridge(sd, M5602_XB_LINE_OF_FRAME_H, 0x81);
395 if (err < 0)
396 return err;
397
398 err = m5602_write_bridge(sd, M5602_XB_PIX_OF_LINE_H, 0x82);
399 if (err < 0)
400 return err;
401
98192670
EA		 402 err = m5602_write_bridge(sd, M5602_XB_SIG_INI, 0x01);
403 if (err < 0)
404 return err;
405
9536a57e
EA		 406 err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA,
407 ((ver_offs >> 8) & 0xff));
408 if (err < 0)
409 return err;
410
411 err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, (ver_offs & 0xff));
412 if (err < 0)
413 return err;
414
98192670
EA		 415 for (i = 0; i < 2 && !err; i++)
416 err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, 0);
9536a57e
EA		 417 if (err < 0)
418 return err;
419
420 err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, (height >> 8) & 0xff);
421 if (err < 0)
422 return err;
423
424 err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, (height & 0xff));
425 if (err < 0)
426 return err;
427
428 for (i = 0; i < 2 && !err; i++)
429 err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, 0);
430
98192670
EA		 431 for (i = 0; i < 2 && !err; i++)
432 err = m5602_write_bridge(sd, M5602_XB_SIG_INI, 0);
433
9536a57e
EA		 434 for (i = 0; i < 2 && !err; i++)
435 err = m5602_write_bridge(sd, M5602_XB_HSYNC_PARA, 0);
436 if (err < 0)
437 return err;
438
439 err = m5602_write_bridge(sd, M5602_XB_HSYNC_PARA, (width >> 8) & 0xff);
440 if (err < 0)
441 return err;
442
443 err = m5602_write_bridge(sd, M5602_XB_HSYNC_PARA, (width & 0xff));
98192670
EA		 444 if (err < 0)
445 return err;
446
447 err = m5602_write_bridge(sd, M5602_XB_SIG_INI, 0);
c996b368
EA		 448 return err;
449}
450
cf811d50 451static int po1030_get_exposure(struct gspca_dev *gspca_dev, __s32 *val)
c109f816
EA		 452{
453 struct sd *sd = (struct sd *) gspca_dev;
05d7d9ce 454 s32 *sensor_settings = sd->sensor_priv;
c109f816 455
05d7d9ce 456 *val = sensor_settings[EXPOSURE_IDX];
17ea88ae 457 PDEBUG(D_V4L2, "Exposure read as %d", *val);
05d7d9ce 458 return 0;
c109f816
EA		 459}
460
cf811d50 461static int po1030_set_exposure(struct gspca_dev *gspca_dev, __s32 val)
c109f816
EA		 462{
463 struct sd *sd = (struct sd *) gspca_dev;
05d7d9ce 464 s32 *sensor_settings = sd->sensor_priv;
c109f816
EA		 465 u8 i2c_data;
466 int err;
467
05d7d9ce 468 sensor_settings[EXPOSURE_IDX] = val;
17ea88ae 469 PDEBUG(D_V4L2, "Set exposure to %d", val & 0xffff);
c109f816
EA		 470
471 i2c_data = ((val & 0xff00) >> 8);
17ea88ae 472 PDEBUG(D_V4L2, "Set exposure to high byte to 0x%x",
c109f816
EA		 473 i2c_data);
474
bb9460eb 475 err = m5602_write_sensor(sd, PO1030_INTEGLINES_H,
c109f816
EA		 476 &i2c_data, 1);
477 if (err < 0)
051781b3 478 return err;
c109f816
EA		 479
480 i2c_data = (val & 0xff);
17ea88ae 481 PDEBUG(D_V4L2, "Set exposure to low byte to 0x%x",
c109f816 482 i2c_data);
bb9460eb 483 err = m5602_write_sensor(sd, PO1030_INTEGLINES_M,
c109f816
EA		 484 &i2c_data, 1);
485
7b9f2467 486 return err;
c109f816
EA		 487}
488
cf811d50 489static int po1030_get_gain(struct gspca_dev *gspca_dev, __s32 *val)
c109f816
EA		 490{
491 struct sd *sd = (struct sd *) gspca_dev;
05d7d9ce 492 s32 *sensor_settings = sd->sensor_priv;
c109f816 493
05d7d9ce 494 *val = sensor_settings[GAIN_IDX];
17ea88ae 495 PDEBUG(D_V4L2, "Read global gain %d", *val);
05d7d9ce 496 return 0;
c109f816
EA		 497}
498
cf811d50 499static int po1030_set_gain(struct gspca_dev *gspca_dev, __s32 val)
e2c97491
EA		 500{
501 struct sd *sd = (struct sd *) gspca_dev;
05d7d9ce 502 s32 *sensor_settings = sd->sensor_priv;
e2c97491
EA		 503 u8 i2c_data;
504 int err;
505
05d7d9ce
EA		 506 sensor_settings[GAIN_IDX] = val;
507
508 i2c_data = val & 0xff;
509 PDEBUG(D_V4L2, "Set global gain to %d", i2c_data);
bb9460eb 510 err = m5602_write_sensor(sd, PO1030_GLOBALGAIN,
e2c97491 511 &i2c_data, 1);
05d7d9ce
EA		 512 return err;
513}
e2c97491 514
cf811d50 515static int po1030_get_hflip(struct gspca_dev *gspca_dev, __s32 *val)
05d7d9ce
EA		 516{
517 struct sd *sd = (struct sd *) gspca_dev;
518 s32 *sensor_settings = sd->sensor_priv;
e2c97491 519
05d7d9ce 520 *val = sensor_settings[HFLIP_IDX];
e2c97491
EA		 521 PDEBUG(D_V4L2, "Read hflip %d", *val);
522
05d7d9ce 523 return 0;
e2c97491
EA		 524}
525
cf811d50 526static int po1030_set_hflip(struct gspca_dev *gspca_dev, __s32 val)
e2c97491
EA		 527{
528 struct sd *sd = (struct sd *) gspca_dev;
05d7d9ce 529 s32 *sensor_settings = sd->sensor_priv;
e2c97491
EA		 530 u8 i2c_data;
531 int err;
532
05d7d9ce
EA		 533 sensor_settings[HFLIP_IDX] = val;
534
e2c97491 535 PDEBUG(D_V4L2, "Set hflip %d", val);
bb9460eb 536 err = m5602_read_sensor(sd, PO1030_CONTROL2, &i2c_data, 1);
1d07b6f1 537 if (err < 0)
051781b3 538 return err;
e2c97491 539
1d07b6f1 540 i2c_data = (0x7f & i2c_data) | ((val & 0x01) << 7);
e2c97491 541
bb9460eb 542 err = m5602_write_sensor(sd, PO1030_CONTROL2,
1d07b6f1 543 &i2c_data, 1);
e2c97491 544
7b9f2467 545 return err;
e2c97491
EA		 546}
547
cf811d50 548static int po1030_get_vflip(struct gspca_dev *gspca_dev, __s32 *val)
e2c97491
EA		 549{
550 struct sd *sd = (struct sd *) gspca_dev;
05d7d9ce 551 s32 *sensor_settings = sd->sensor_priv;
e2c97491 552
27429082 553 *val = sensor_settings[VFLIP_IDX];
e2c97491
EA		 554 PDEBUG(D_V4L2, "Read vflip %d", *val);
555
05d7d9ce 556 return 0;
e2c97491
EA		 557}
558
cf811d50 559static int po1030_set_vflip(struct gspca_dev *gspca_dev, __s32 val)
e2c97491
EA		 560{
561 struct sd *sd = (struct sd *) gspca_dev;
05d7d9ce 562 s32 *sensor_settings = sd->sensor_priv;
e2c97491
EA		 563 u8 i2c_data;
564 int err;
565
05d7d9ce
EA		 566 sensor_settings[VFLIP_IDX] = val;
567
e2c97491 568 PDEBUG(D_V4L2, "Set vflip %d", val);
bb9460eb 569 err = m5602_read_sensor(sd, PO1030_CONTROL2, &i2c_data, 1);
1d07b6f1 570 if (err < 0)
051781b3 571 return err;
e2c97491 572
1d07b6f1 573 i2c_data = (i2c_data & 0xbf) | ((val & 0x01) << 6);
e2c97491 574
bb9460eb 575 err = m5602_write_sensor(sd, PO1030_CONTROL2,
1d07b6f1 576 &i2c_data, 1);
e2c97491 577
7b9f2467 578 return err;
e2c97491
EA		 579}
580
cf811d50 581static int po1030_get_red_balance(struct gspca_dev *gspca_dev, __s32 *val)
c109f816
EA		 582{
583 struct sd *sd = (struct sd *) gspca_dev;
05d7d9ce 584 s32 *sensor_settings = sd->sensor_priv;
c109f816 585
05d7d9ce 586 *val = sensor_settings[RED_BALANCE_IDX];
17ea88ae 587 PDEBUG(D_V4L2, "Read red gain %d", *val);
05d7d9ce 588 return 0;
c109f816
EA		 589}
590
cf811d50 591static int po1030_set_red_balance(struct gspca_dev *gspca_dev, __s32 val)
c109f816
EA		 592{
593 struct sd *sd = (struct sd *) gspca_dev;
05d7d9ce 594 s32 *sensor_settings = sd->sensor_priv;
c109f816
EA		 595 u8 i2c_data;
596 int err;
597
05d7d9ce
EA		 598 sensor_settings[RED_BALANCE_IDX] = val;
599
c109f816 600 i2c_data = val & 0xff;
17ea88ae 601 PDEBUG(D_V4L2, "Set red gain to %d", i2c_data);
bb9460eb 602 err = m5602_write_sensor(sd, PO1030_RED_GAIN,
c109f816 603 &i2c_data, 1);
7b9f2467 604 return err;
c109f816
EA		 605}
606
cf811d50 607static int po1030_get_blue_balance(struct gspca_dev *gspca_dev, __s32 *val)
c109f816
EA		 608{
609 struct sd *sd = (struct sd *) gspca_dev;
05d7d9ce 610 s32 *sensor_settings = sd->sensor_priv;
c109f816 611
05d7d9ce 612 *val = sensor_settings[BLUE_BALANCE_IDX];
17ea88ae 613 PDEBUG(D_V4L2, "Read blue gain %d", *val);
c109f816 614
05d7d9ce 615 return 0;
c109f816
EA		 616}
617
cf811d50 618static int po1030_set_blue_balance(struct gspca_dev *gspca_dev, __s32 val)
c109f816
EA		 619{
620 struct sd *sd = (struct sd *) gspca_dev;
05d7d9ce 621 s32 *sensor_settings = sd->sensor_priv;
c109f816
EA		 622 u8 i2c_data;
623 int err;
05d7d9ce
EA		 624
625 sensor_settings[BLUE_BALANCE_IDX] = val;
626
c109f816 627 i2c_data = val & 0xff;
17ea88ae 628 PDEBUG(D_V4L2, "Set blue gain to %d", i2c_data);
bb9460eb 629 err = m5602_write_sensor(sd, PO1030_BLUE_GAIN,
c109f816
EA		 630 &i2c_data, 1);
631
7b9f2467 632 return err;
c109f816
EA		 633}
634
b933d585
EA		 635static int po1030_get_green_balance(struct gspca_dev *gspca_dev, __s32 *val)
636{
637 struct sd *sd = (struct sd *) gspca_dev;
638 s32 *sensor_settings = sd->sensor_priv;
639
640 *val = sensor_settings[GREEN_BALANCE_IDX];
641 PDEBUG(D_V4L2, "Read green gain %d", *val);
642
643 return 0;
644}
645
646static int po1030_set_green_balance(struct gspca_dev *gspca_dev, __s32 val)
647{
648 struct sd *sd = (struct sd *) gspca_dev;
649 s32 *sensor_settings = sd->sensor_priv;
650 u8 i2c_data;
651 int err;
652
653 sensor_settings[GREEN_BALANCE_IDX] = val;
654 i2c_data = val & 0xff;
655 PDEBUG(D_V4L2, "Set green gain to %d", i2c_data);
656
657 err = m5602_write_sensor(sd, PO1030_GREEN_1_GAIN,
658 &i2c_data, 1);
659 if (err < 0)
660 return err;
661
662 return m5602_write_sensor(sd, PO1030_GREEN_2_GAIN,
663 &i2c_data, 1);
664}
665
cf811d50
EA		 666static int po1030_get_auto_white_balance(struct gspca_dev *gspca_dev,
667 __s32 *val)
3b9ae658
EA		 668{
669 struct sd *sd = (struct sd *) gspca_dev;
670 s32 *sensor_settings = sd->sensor_priv;
671
672 *val = sensor_settings[AUTO_WHITE_BALANCE_IDX];
673 PDEBUG(D_V4L2, "Auto white balancing is %d", *val);
674
675 return 0;
676}
677
cf811d50
EA		 678static int po1030_set_auto_white_balance(struct gspca_dev *gspca_dev,
679 __s32 val)
3b9ae658
EA		 680{
681 struct sd *sd = (struct sd *) gspca_dev;
682 s32 *sensor_settings = sd->sensor_priv;
683 u8 i2c_data;
684 int err;
685
686 sensor_settings[AUTO_WHITE_BALANCE_IDX] = val;
687
688 err = m5602_read_sensor(sd, PO1030_AUTOCTRL1, &i2c_data, 1);
689 if (err < 0)
690 return err;
691
dd9ce84a 692 PDEBUG(D_V4L2, "Set auto white balance to %d", val);
3b9ae658
EA		 693 i2c_data = (i2c_data & 0xfe) | (val & 0x01);
694 err = m5602_write_sensor(sd, PO1030_AUTOCTRL1, &i2c_data, 1);
695 return err;
696}
697
dd9ce84a
EA		 698static int po1030_get_auto_exposure(struct gspca_dev *gspca_dev,
699 __s32 *val)
700{
701 struct sd *sd = (struct sd *) gspca_dev;
702 s32 *sensor_settings = sd->sensor_priv;
703
704 *val = sensor_settings[AUTO_EXPOSURE_IDX];
705 PDEBUG(D_V4L2, "Auto exposure is %d", *val);
706 return 0;
707}
708
709static int po1030_set_auto_exposure(struct gspca_dev *gspca_dev,
710 __s32 val)
711{
712 struct sd *sd = (struct sd *) gspca_dev;
713 s32 *sensor_settings = sd->sensor_priv;
714 u8 i2c_data;
715 int err;
716
717 sensor_settings[AUTO_EXPOSURE_IDX] = val;
718 err = m5602_read_sensor(sd, PO1030_AUTOCTRL1, &i2c_data, 1);
719 if (err < 0)
720 return err;
721
722 PDEBUG(D_V4L2, "Set auto exposure to %d", val);
723 i2c_data = (i2c_data & 0xfd) | ((val & 0x01) << 1);
724 return m5602_write_sensor(sd, PO1030_AUTOCTRL1, &i2c_data, 1);
725}
726
05d7d9ce
EA		 727void po1030_disconnect(struct sd *sd)
728{
729 sd->sensor = NULL;
730 kfree(sd->sensor_priv);
731}
732
658efb63 733static void po1030_dump_registers(struct sd *sd)
c109f816
EA		 734{
735 int address;
736 u8 value = 0;
737
bdfe91f4 738 pr_info("Dumping the po1030 sensor core registers\n");
c109f816 739 for (address = 0; address < 0x7f; address++) {
c061c97e 740 m5602_read_sensor(sd, address, &value, 1);
bdfe91f4 741 pr_info("register 0x%x contains 0x%x\n", address, value);
c109f816
EA		 742 }
743
bdfe91f4 744 pr_info("po1030 register state dump complete\n");
c109f816 745
bdfe91f4 746 pr_info("Probing for which registers that are read/write\n");
c109f816
EA		 747 for (address = 0; address < 0xff; address++) {
748 u8 old_value, ctrl_value;
749 u8 test_value[2] = {0xff, 0xff};
750
c061c97e 751 m5602_read_sensor(sd, address, &old_value, 1);
6dc4cff0 752 m5602_write_sensor(sd, address, test_value, 1);
c061c97e 753 m5602_read_sensor(sd, address, &ctrl_value, 1);
c109f816
EA		 754
755 if (ctrl_value == test_value[0])
bdfe91f4 756 pr_info("register 0x%x is writeable\n", address);
c109f816 757 else
bdfe91f4 758 pr_info("register 0x%x is read only\n", address);
c109f816
EA		 759
760 /* Restore original value */
6dc4cff0 761 m5602_write_sensor(sd, address, &old_value, 1);
c109f816
EA		 762 }
763}
Linux 6.x block layer and io_uring tree(s)