m5602_ov9650.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774
  1. /*
  2. * Driver for the ov9650 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. #include "m5602_ov9650.h"
  19. /* Vertically and horizontally flips the image if matched, needed for machines
  20. where the sensor is mounted upside down */
  21. static
  22. const
  23. struct dmi_system_id ov9650_flip_dmi_table[] = {
  24. {
  25. .ident = "ASUS A6VC",
  26. .matches = {
  27. DMI_MATCH(DMI_SYS_VENDOR, "ASUSTeK Computer Inc."),
  28. DMI_MATCH(DMI_PRODUCT_NAME, "A6VC")
  29. }
  30. },
  31. {
  32. .ident = "ASUS A6VM",
  33. .matches = {
  34. DMI_MATCH(DMI_SYS_VENDOR, "ASUSTeK Computer Inc."),
  35. DMI_MATCH(DMI_PRODUCT_NAME, "A6VM")
  36. }
  37. },
  38. {
  39. .ident = "ASUS A6JC",
  40. .matches = {
  41. DMI_MATCH(DMI_SYS_VENDOR, "ASUSTeK Computer Inc."),
  42. DMI_MATCH(DMI_PRODUCT_NAME, "A6JC")
  43. }
  44. },
  45. {
  46. .ident = "ASUS A6Ja",
  47. .matches = {
  48. DMI_MATCH(DMI_SYS_VENDOR, "ASUSTeK Computer Inc."),
  49. DMI_MATCH(DMI_PRODUCT_NAME, "A6J")
  50. }
  51. },
  52. {
  53. .ident = "ASUS A6Kt",
  54. .matches = {
  55. DMI_MATCH(DMI_SYS_VENDOR, "ASUSTeK Computer Inc."),
  56. DMI_MATCH(DMI_PRODUCT_NAME, "A6Kt")
  57. }
  58. },
  59. {
  60. .ident = "Alienware Aurora m9700",
  61. .matches = {
  62. DMI_MATCH(DMI_SYS_VENDOR, "alienware"),
  63. DMI_MATCH(DMI_PRODUCT_NAME, "Aurora m9700")
  64. }
  65. },
  66. { }
  67. };
  68. const static struct ctrl ov9650_ctrls[] = {
  69. {
  70. {
  71. .id = V4L2_CID_EXPOSURE,
  72. .type = V4L2_CTRL_TYPE_INTEGER,
  73. .name = "exposure",
  74. .minimum = 0x00,
  75. .maximum = 0x1ff,
  76. .step = 0x4,
  77. .default_value = EXPOSURE_DEFAULT,
  78. .flags = V4L2_CTRL_FLAG_SLIDER
  79. },
  80. .set = ov9650_set_exposure,
  81. .get = ov9650_get_exposure
  82. }, {
  83. {
  84. .id = V4L2_CID_GAIN,
  85. .type = V4L2_CTRL_TYPE_INTEGER,
  86. .name = "gain",
  87. .minimum = 0x00,
  88. .maximum = 0x3ff,
  89. .step = 0x1,
  90. .default_value = GAIN_DEFAULT,
  91. .flags = V4L2_CTRL_FLAG_SLIDER
  92. },
  93. .set = ov9650_set_gain,
  94. .get = ov9650_get_gain
  95. }, {
  96. {
  97. .type = V4L2_CTRL_TYPE_INTEGER,
  98. .name = "red balance",
  99. .minimum = 0x00,
  100. .maximum = 0xff,
  101. .step = 0x1,
  102. .default_value = RED_GAIN_DEFAULT,
  103. .flags = V4L2_CTRL_FLAG_SLIDER
  104. },
  105. .set = ov9650_set_red_balance,
  106. .get = ov9650_get_red_balance
  107. }, {
  108. {
  109. .type = V4L2_CTRL_TYPE_INTEGER,
  110. .name = "blue balance",
  111. .minimum = 0x00,
  112. .maximum = 0xff,
  113. .step = 0x1,
  114. .default_value = BLUE_GAIN_DEFAULT,
  115. .flags = V4L2_CTRL_FLAG_SLIDER
  116. },
  117. .set = ov9650_set_blue_balance,
  118. .get = ov9650_get_blue_balance
  119. }, {
  120. {
  121. .id = V4L2_CID_HFLIP,
  122. .type = V4L2_CTRL_TYPE_BOOLEAN,
  123. .name = "horizontal flip",
  124. .minimum = 0,
  125. .maximum = 1,
  126. .step = 1,
  127. .default_value = 0
  128. },
  129. .set = ov9650_set_hflip,
  130. .get = ov9650_get_hflip
  131. }, {
  132. {
  133. .id = V4L2_CID_VFLIP,
  134. .type = V4L2_CTRL_TYPE_BOOLEAN,
  135. .name = "vertical flip",
  136. .minimum = 0,
  137. .maximum = 1,
  138. .step = 1,
  139. .default_value = 0
  140. },
  141. .set = ov9650_set_vflip,
  142. .get = ov9650_get_vflip
  143. }, {
  144. {
  145. .id = V4L2_CID_AUTO_WHITE_BALANCE,
  146. .type = V4L2_CTRL_TYPE_BOOLEAN,
  147. .name = "auto white balance",
  148. .minimum = 0,
  149. .maximum = 1,
  150. .step = 1,
  151. .default_value = 1
  152. },
  153. .set = ov9650_set_auto_white_balance,
  154. .get = ov9650_get_auto_white_balance
  155. }, {
  156. {
  157. .id = V4L2_CID_AUTOGAIN,
  158. .type = V4L2_CTRL_TYPE_BOOLEAN,
  159. .name = "auto gain control",
  160. .minimum = 0,
  161. .maximum = 1,
  162. .step = 1,
  163. .default_value = 1
  164. },
  165. .set = ov9650_set_auto_gain,
  166. .get = ov9650_get_auto_gain
  167. }
  168. };
  169. static struct v4l2_pix_format ov9650_modes[] = {
  170. {
  171. 176,
  172. 144,
  173. V4L2_PIX_FMT_SBGGR8,
  174. V4L2_FIELD_NONE,
  175. .sizeimage =
  176. 176 * 144,
  177. .bytesperline = 176,
  178. .colorspace = V4L2_COLORSPACE_SRGB,
  179. .priv = 0
  180. }, {
  181. 320,
  182. 240,
  183. V4L2_PIX_FMT_SBGGR8,
  184. V4L2_FIELD_NONE,
  185. .sizeimage =
  186. 320 * 240,
  187. .bytesperline = 320,
  188. .colorspace = V4L2_COLORSPACE_SRGB,
  189. .priv = 0
  190. }, {
  191. 352,
  192. 288,
  193. V4L2_PIX_FMT_SBGGR8,
  194. V4L2_FIELD_NONE,
  195. .sizeimage =
  196. 352 * 288,
  197. .bytesperline = 352,
  198. .colorspace = V4L2_COLORSPACE_SRGB,
  199. .priv = 0
  200. }, {
  201. 640,
  202. 480,
  203. V4L2_PIX_FMT_SBGGR8,
  204. V4L2_FIELD_NONE,
  205. .sizeimage =
  206. 640 * 480,
  207. .bytesperline = 640,
  208. .colorspace = V4L2_COLORSPACE_SRGB,
  209. .priv = 0
  210. }
  211. };
  212. static void ov9650_dump_registers(struct sd *sd);
  213. int ov9650_probe(struct sd *sd)
  214. {
  215. int err = 0;
  216. u8 prod_id = 0, ver_id = 0, i;
  217. if (force_sensor) {
  218. if (force_sensor == OV9650_SENSOR) {
  219. info("Forcing an %s sensor", ov9650.name);
  220. goto sensor_found;
  221. }
  222. /* If we want to force another sensor,
  223. don't try to probe this one */
  224. return -ENODEV;
  225. }
  226. info("Probing for an ov9650 sensor");
  227. /* Run the pre-init to actually probe the unit */
  228. for (i = 0; i < ARRAY_SIZE(preinit_ov9650) && !err; i++) {
  229. u8 data = preinit_ov9650[i][2];
  230. if (preinit_ov9650[i][0] == SENSOR)
  231. err = m5602_write_sensor(sd,
  232. preinit_ov9650[i][1], &data, 1);
  233. else
  234. err = m5602_write_bridge(sd, preinit_ov9650[i][1], data);
  235. }
  236. if (err < 0)
  237. return err;
  238. if (m5602_read_sensor(sd, OV9650_PID, &prod_id, 1))
  239. return -ENODEV;
  240. if (m5602_read_sensor(sd, OV9650_VER, &ver_id, 1))
  241. return -ENODEV;
  242. if ((prod_id == 0x96) && (ver_id == 0x52)) {
  243. info("Detected an ov9650 sensor");
  244. goto sensor_found;
  245. }
  246. return -ENODEV;
  247. sensor_found:
  248. sd->gspca_dev.cam.cam_mode = ov9650_modes;
  249. sd->gspca_dev.cam.nmodes = ARRAY_SIZE(ov9650_modes);
  250. sd->desc->ctrls = ov9650_ctrls;
  251. sd->desc->nctrls = ARRAY_SIZE(ov9650_ctrls);
  252. return 0;
  253. }
  254. int ov9650_init(struct sd *sd)
  255. {
  256. int i, err = 0;
  257. u8 data;
  258. if (dump_sensor)
  259. ov9650_dump_registers(sd);
  260. for (i = 0; i < ARRAY_SIZE(init_ov9650) && !err; i++) {
  261. data = init_ov9650[i][2];
  262. if (init_ov9650[i][0] == SENSOR)
  263. err = m5602_write_sensor(sd, init_ov9650[i][1],
  264. &data, 1);
  265. else
  266. err = m5602_write_bridge(sd, init_ov9650[i][1], data);
  267. }
  268. if (dmi_check_system(ov9650_flip_dmi_table) && !err) {
  269. info("vflip quirk active");
  270. data = 0x30;
  271. err = m5602_write_sensor(sd, OV9650_MVFP, &data, 1);
  272. }
  273. return err;
  274. }
  275. int ov9650_start(struct sd *sd)
  276. {
  277. int i, err = 0;
  278. struct cam *cam = &sd->gspca_dev.cam;
  279. err = ov9650_init(sd);
  280. if (err < 0)
  281. return err;
  282. for (i = 0; i < ARRAY_SIZE(res_init_ov9650) && !err; i++) {
  283. if (res_init_ov9650[i][0] == BRIDGE)
  284. err = m5602_write_bridge(sd, res_init_ov9650[i][1],
  285. res_init_ov9650[i][2]);
  286. else if (res_init_ov9650[i][0] == SENSOR) {
  287. u8 data = res_init_ov9650[i][2];
  288. err = m5602_write_sensor(sd,
  289. res_init_ov9650[i][1], &data, 1);
  290. }
  291. }
  292. if (err < 0)
  293. return err;
  294. switch (cam->cam_mode[sd->gspca_dev.curr_mode].width) {
  295. case 640:
  296. PDEBUG(D_V4L2, "Configuring camera for VGA mode");
  297. for (i = 0; i < ARRAY_SIZE(VGA_ov9650) && !err; i++) {
  298. if (VGA_ov9650[i][0] == SENSOR) {
  299. u8 data = VGA_ov9650[i][2];
  300. err = m5602_write_sensor(sd,
  301. VGA_ov9650[i][1], &data, 1);
  302. } else {
  303. err = m5602_write_bridge(sd, VGA_ov9650[i][1],
  304. VGA_ov9650[i][2]);
  305. }
  306. }
  307. break;
  308. case 352:
  309. PDEBUG(D_V4L2, "Configuring camera for CIF mode");
  310. for (i = 0; i < ARRAY_SIZE(CIF_ov9650) && !err; i++) {
  311. if (CIF_ov9650[i][0] == SENSOR) {
  312. u8 data = CIF_ov9650[i][2];
  313. err = m5602_write_sensor(sd,
  314. CIF_ov9650[i][1], &data, 1);
  315. } else {
  316. err = m5602_write_bridge(sd, CIF_ov9650[i][1],
  317. CIF_ov9650[i][2]);
  318. }
  319. }
  320. break;
  321. case 320:
  322. PDEBUG(D_V4L2, "Configuring camera for QVGA mode");
  323. for (i = 0; i < ARRAY_SIZE(QVGA_ov9650) && !err; i++) {
  324. if (QVGA_ov9650[i][0] == SENSOR) {
  325. u8 data = QVGA_ov9650[i][2];
  326. err = m5602_write_sensor(sd,
  327. QVGA_ov9650[i][1], &data, 1);
  328. } else {
  329. err = m5602_write_bridge(sd, QVGA_ov9650[i][1],
  330. QVGA_ov9650[i][2]);
  331. }
  332. }
  333. break;
  334. case 176:
  335. PDEBUG(D_V4L2, "Configuring camera for QCIF mode");
  336. for (i = 0; i < ARRAY_SIZE(QCIF_ov9650) && !err; i++) {
  337. if (QCIF_ov9650[i][0] == SENSOR) {
  338. u8 data = QCIF_ov9650[i][2];
  339. err = m5602_write_sensor(sd,
  340. QCIF_ov9650[i][1], &data, 1);
  341. } else {
  342. err = m5602_write_bridge(sd, QCIF_ov9650[i][1],
  343. QCIF_ov9650[i][2]);
  344. }
  345. }
  346. break;
  347. }
  348. return err;
  349. }
  350. int ov9650_stop(struct sd *sd)
  351. {
  352. u8 data = OV9650_SOFT_SLEEP | OV9650_OUTPUT_DRIVE_2X;
  353. return m5602_write_sensor(sd, OV9650_COM2, &data, 1);
  354. }
  355. int ov9650_power_down(struct sd *sd)
  356. {
  357. int i, err = 0;
  358. for (i = 0; i < ARRAY_SIZE(power_down_ov9650) && !err; i++) {
  359. u8 data = power_down_ov9650[i][2];
  360. if (power_down_ov9650[i][0] == SENSOR)
  361. err = m5602_write_sensor(sd,
  362. power_down_ov9650[i][1], &data, 1);
  363. else
  364. err = m5602_write_bridge(sd, power_down_ov9650[i][1],
  365. data);
  366. }
  367. return err;
  368. }
  369. int ov9650_get_exposure(struct gspca_dev *gspca_dev, __s32 *val)
  370. {
  371. struct sd *sd = (struct sd *) gspca_dev;
  372. u8 i2c_data;
  373. int err;
  374. err = m5602_read_sensor(sd, OV9650_AECH, &i2c_data, 1);
  375. if (err < 0)
  376. return err;
  377. *val |= (i2c_data << 2);
  378. err = m5602_read_sensor(sd, OV9650_AECHM, &i2c_data, 1);
  379. if (err < 0)
  380. return err;
  381. *val |= (i2c_data & 0x3f) << 10;
  382. PDEBUG(D_V4L2, "Read exposure %d", *val);
  383. return err;
  384. }
  385. int ov9650_set_exposure(struct gspca_dev *gspca_dev, __s32 val)
  386. {
  387. struct sd *sd = (struct sd *) gspca_dev;
  388. u8 i2c_data;
  389. int err;
  390. PDEBUG(D_V4L2, "Set exposure to %d",
  391. val & 0xffff);
  392. /* The 6 MSBs */
  393. i2c_data = (val >> 10) & 0x3f;
  394. err = m5602_write_sensor(sd, OV9650_AECHM,
  395. &i2c_data, 1);
  396. if (err < 0)
  397. return err;
  398. /* The 8 middle bits */
  399. i2c_data = (val >> 2) & 0xff;
  400. err = m5602_write_sensor(sd, OV9650_AECH,
  401. &i2c_data, 1);
  402. if (err < 0)
  403. return err;
  404. /* The 2 LSBs */
  405. i2c_data = val & 0x03;
  406. err = m5602_write_sensor(sd, OV9650_COM1, &i2c_data, 1);
  407. return err;
  408. }
  409. int ov9650_get_gain(struct gspca_dev *gspca_dev, __s32 *val)
  410. {
  411. int err;
  412. u8 i2c_data;
  413. struct sd *sd = (struct sd *) gspca_dev;
  414. err = m5602_read_sensor(sd, OV9650_VREF, &i2c_data, 1);
  415. if (err < 0)
  416. return err;
  417. *val = (i2c_data & 0x03) << 8;
  418. err = m5602_read_sensor(sd, OV9650_GAIN, &i2c_data, 1);
  419. *val |= i2c_data;
  420. PDEBUG(D_V4L2, "Read gain %d", *val);
  421. return err;
  422. }
  423. int ov9650_set_gain(struct gspca_dev *gspca_dev, __s32 val)
  424. {
  425. int err;
  426. u8 i2c_data;
  427. struct sd *sd = (struct sd *) gspca_dev;
  428. /* The 2 MSB */
  429. /* Read the OV9650_VREF register first to avoid
  430. corrupting the VREF high and low bits */
  431. err = m5602_read_sensor(sd, OV9650_VREF, &i2c_data, 1);
  432. if (err < 0)
  433. return err;
  434. /* Mask away all uninteresting bits */
  435. i2c_data = ((val & 0x0300) >> 2) |
  436. (i2c_data & 0x3F);
  437. err = m5602_write_sensor(sd, OV9650_VREF, &i2c_data, 1);
  438. if (err < 0)
  439. return err;
  440. /* The 8 LSBs */
  441. i2c_data = val & 0xff;
  442. err = m5602_write_sensor(sd, OV9650_GAIN, &i2c_data, 1);
  443. return err;
  444. }
  445. int ov9650_get_red_balance(struct gspca_dev *gspca_dev, __s32 *val)
  446. {
  447. int err;
  448. u8 i2c_data;
  449. struct sd *sd = (struct sd *) gspca_dev;
  450. err = m5602_read_sensor(sd, OV9650_RED, &i2c_data, 1);
  451. *val = i2c_data;
  452. PDEBUG(D_V4L2, "Read red gain %d", *val);
  453. return err;
  454. }
  455. int ov9650_set_red_balance(struct gspca_dev *gspca_dev, __s32 val)
  456. {
  457. int err;
  458. u8 i2c_data;
  459. struct sd *sd = (struct sd *) gspca_dev;
  460. PDEBUG(D_V4L2, "Set red gain to %d",
  461. val & 0xff);
  462. i2c_data = val & 0xff;
  463. err = m5602_write_sensor(sd, OV9650_RED, &i2c_data, 1);
  464. return err;
  465. }
  466. int ov9650_get_blue_balance(struct gspca_dev *gspca_dev, __s32 *val)
  467. {
  468. int err;
  469. u8 i2c_data;
  470. struct sd *sd = (struct sd *) gspca_dev;
  471. err = m5602_read_sensor(sd, OV9650_BLUE, &i2c_data, 1);
  472. *val = i2c_data;
  473. PDEBUG(D_V4L2, "Read blue gain %d", *val);
  474. return err;
  475. }
  476. int ov9650_set_blue_balance(struct gspca_dev *gspca_dev, __s32 val)
  477. {
  478. int err;
  479. u8 i2c_data;
  480. struct sd *sd = (struct sd *) gspca_dev;
  481. PDEBUG(D_V4L2, "Set blue gain to %d",
  482. val & 0xff);
  483. i2c_data = val & 0xff;
  484. err = m5602_write_sensor(sd, OV9650_BLUE, &i2c_data, 1);
  485. return err;
  486. }
  487. int ov9650_get_hflip(struct gspca_dev *gspca_dev, __s32 *val)
  488. {
  489. int err;
  490. u8 i2c_data;
  491. struct sd *sd = (struct sd *) gspca_dev;
  492. err = m5602_read_sensor(sd, OV9650_MVFP, &i2c_data, 1);
  493. if (dmi_check_system(ov9650_flip_dmi_table))
  494. *val = ((i2c_data & OV9650_HFLIP) >> 5) ? 0 : 1;
  495. else
  496. *val = (i2c_data & OV9650_HFLIP) >> 5;
  497. PDEBUG(D_V4L2, "Read horizontal flip %d", *val);
  498. return err;
  499. }
  500. int ov9650_set_hflip(struct gspca_dev *gspca_dev, __s32 val)
  501. {
  502. int err;
  503. u8 i2c_data;
  504. struct sd *sd = (struct sd *) gspca_dev;
  505. PDEBUG(D_V4L2, "Set horizontal flip to %d", val);
  506. err = m5602_read_sensor(sd, OV9650_MVFP, &i2c_data, 1);
  507. if (err < 0)
  508. return err;
  509. if (dmi_check_system(ov9650_flip_dmi_table))
  510. i2c_data = ((i2c_data & 0xdf) |
  511. (((val ? 0 : 1) & 0x01) << 5));
  512. else
  513. i2c_data = ((i2c_data & 0xdf) |
  514. ((val & 0x01) << 5));
  515. err = m5602_write_sensor(sd, OV9650_MVFP, &i2c_data, 1);
  516. return err;
  517. }
  518. int ov9650_get_vflip(struct gspca_dev *gspca_dev, __s32 *val)
  519. {
  520. int err;
  521. u8 i2c_data;
  522. struct sd *sd = (struct sd *) gspca_dev;
  523. err = m5602_read_sensor(sd, OV9650_MVFP, &i2c_data, 1);
  524. if (dmi_check_system(ov9650_flip_dmi_table))
  525. *val = ((i2c_data & 0x10) >> 4) ? 0 : 1;
  526. else
  527. *val = (i2c_data & 0x10) >> 4;
  528. PDEBUG(D_V4L2, "Read vertical flip %d", *val);
  529. return err;
  530. }
  531. int ov9650_set_vflip(struct gspca_dev *gspca_dev, __s32 val)
  532. {
  533. int err;
  534. u8 i2c_data;
  535. struct sd *sd = (struct sd *) gspca_dev;
  536. PDEBUG(D_V4L2, "Set vertical flip to %d", val);
  537. err = m5602_read_sensor(sd, OV9650_MVFP, &i2c_data, 1);
  538. if (err < 0)
  539. return err;
  540. if (dmi_check_system(ov9650_flip_dmi_table))
  541. i2c_data = ((i2c_data & 0xef) |
  542. (((val ? 0 : 1) & 0x01) << 4));
  543. else
  544. i2c_data = ((i2c_data & 0xef) |
  545. ((val & 0x01) << 4));
  546. err = m5602_write_sensor(sd, OV9650_MVFP, &i2c_data, 1);
  547. return err;
  548. }
  549. int ov9650_get_brightness(struct gspca_dev *gspca_dev, __s32 *val)
  550. {
  551. int err;
  552. u8 i2c_data;
  553. struct sd *sd = (struct sd *) gspca_dev;
  554. err = m5602_read_sensor(sd, OV9650_VREF, &i2c_data, 1);
  555. if (err < 0)
  556. return err;
  557. *val = (i2c_data & 0x03) << 8;
  558. err = m5602_read_sensor(sd, OV9650_GAIN, &i2c_data, 1);
  559. *val |= i2c_data;
  560. PDEBUG(D_V4L2, "Read gain %d", *val);
  561. return err;
  562. }
  563. int ov9650_set_brightness(struct gspca_dev *gspca_dev, __s32 val)
  564. {
  565. int err;
  566. u8 i2c_data;
  567. struct sd *sd = (struct sd *) gspca_dev;
  568. PDEBUG(D_V4L2, "Set gain to %d", val & 0x3ff);
  569. /* Read the OV9650_VREF register first to avoid
  570. corrupting the VREF high and low bits */
  571. err = m5602_read_sensor(sd, OV9650_VREF, &i2c_data, 1);
  572. if (err < 0)
  573. return err;
  574. /* Mask away all uninteresting bits */
  575. i2c_data = ((val & 0x0300) >> 2) | (i2c_data & 0x3F);
  576. err = m5602_write_sensor(sd, OV9650_VREF, &i2c_data, 1);
  577. if (err < 0)
  578. return err;
  579. /* The 8 LSBs */
  580. i2c_data = val & 0xff;
  581. err = m5602_write_sensor(sd, OV9650_GAIN, &i2c_data, 1);
  582. return err;
  583. }
  584. int ov9650_get_auto_white_balance(struct gspca_dev *gspca_dev, __s32 *val)
  585. {
  586. int err;
  587. u8 i2c_data;
  588. struct sd *sd = (struct sd *) gspca_dev;
  589. err = m5602_read_sensor(sd, OV9650_COM8, &i2c_data, 1);
  590. *val = (i2c_data & OV9650_AWB_EN) >> 1;
  591. PDEBUG(D_V4L2, "Read auto white balance %d", *val);
  592. return err;
  593. }
  594. int ov9650_set_auto_white_balance(struct gspca_dev *gspca_dev, __s32 val)
  595. {
  596. int err;
  597. u8 i2c_data;
  598. struct sd *sd = (struct sd *) gspca_dev;
  599. PDEBUG(D_V4L2, "Set auto white balance to %d", val);
  600. err = m5602_read_sensor(sd, OV9650_COM8, &i2c_data, 1);
  601. if (err < 0)
  602. return err;
  603. i2c_data = ((i2c_data & 0xfd) | ((val & 0x01) << 1));
  604. err = m5602_write_sensor(sd, OV9650_COM8, &i2c_data, 1);
  605. return err;
  606. }
  607. int ov9650_get_auto_gain(struct gspca_dev *gspca_dev, __s32 *val)
  608. {
  609. int err;
  610. u8 i2c_data;
  611. struct sd *sd = (struct sd *) gspca_dev;
  612. err = m5602_read_sensor(sd, OV9650_COM8, &i2c_data, 1);
  613. *val = (i2c_data & OV9650_AGC_EN) >> 2;
  614. PDEBUG(D_V4L2, "Read auto gain control %d", *val);
  615. return err;
  616. }
  617. int ov9650_set_auto_gain(struct gspca_dev *gspca_dev, __s32 val)
  618. {
  619. int err;
  620. u8 i2c_data;
  621. struct sd *sd = (struct sd *) gspca_dev;
  622. PDEBUG(D_V4L2, "Set auto gain control to %d", val);
  623. err = m5602_read_sensor(sd, OV9650_COM8, &i2c_data, 1);
  624. if (err < 0)
  625. return err;
  626. i2c_data = ((i2c_data & 0xfb) | ((val & 0x01) << 2));
  627. err = m5602_write_sensor(sd, OV9650_COM8, &i2c_data, 1);
  628. return err;
  629. }
  630. static void ov9650_dump_registers(struct sd *sd)
  631. {
  632. int address;
  633. info("Dumping the ov9650 register state");
  634. for (address = 0; address < 0xa9; address++) {
  635. u8 value;
  636. m5602_read_sensor(sd, address, &value, 1);
  637. info("register 0x%x contains 0x%x",
  638. address, value);
  639. }
  640. info("ov9650 register state dump complete");
  641. info("Probing for which registers that are read/write");
  642. for (address = 0; address < 0xff; address++) {
  643. u8 old_value, ctrl_value;
  644. u8 test_value[2] = {0xff, 0xff};
  645. m5602_read_sensor(sd, address, &old_value, 1);
  646. m5602_write_sensor(sd, address, test_value, 1);
  647. m5602_read_sensor(sd, address, &ctrl_value, 1);
  648. if (ctrl_value == test_value[0])
  649. info("register 0x%x is writeable", address);
  650. else
  651. info("register 0x%x is read only", address);
  652. /* Restore original value */
  653. m5602_write_sensor(sd, address, &old_value, 1);
  654. }
  655. }