| Luca Risolia | b9df978 | 2005-06-25 16:30:24 +0200 | [diff] [blame] | 1 | /*************************************************************************** | 
|  | 2 | * Plug-in for OV7630 image sensor connected to the SN9C10x PC Camera      * | 
|  | 3 | * Controllers                                                             * | 
|  | 4 | *                                                                         * | 
|  | 5 | * Copyright (C) 2005 by Luca Risolia <luca.risolia@studio.unibo.it>       * | 
|  | 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., 675 Mass Ave, Cambridge, MA 02139, USA.               * | 
|  | 20 | ***************************************************************************/ | 
|  | 21 |  | 
|  | 22 | #include "sn9c102_sensor.h" | 
|  | 23 |  | 
|  | 24 |  | 
|  | 25 | static struct sn9c102_sensor ov7630; | 
|  | 26 |  | 
|  | 27 |  | 
|  | 28 | static int ov7630_init(struct sn9c102_device* cam) | 
|  | 29 | { | 
|  | 30 | int err = 0; | 
|  | 31 |  | 
|  | 32 | err += sn9c102_write_reg(cam, 0x00, 0x14); | 
|  | 33 | err += sn9c102_write_reg(cam, 0x60, 0x17); | 
|  | 34 | err += sn9c102_write_reg(cam, 0x0f, 0x18); | 
|  | 35 | err += sn9c102_write_reg(cam, 0x50, 0x19); | 
|  | 36 |  | 
|  | 37 | err += sn9c102_i2c_write(cam, 0x12, 0x8d); | 
|  | 38 | err += sn9c102_i2c_write(cam, 0x11, 0x00); | 
|  | 39 | err += sn9c102_i2c_write(cam, 0x15, 0x34); | 
|  | 40 | err += sn9c102_i2c_write(cam, 0x16, 0x03); | 
|  | 41 | err += sn9c102_i2c_write(cam, 0x17, 0x1c); | 
|  | 42 | err += sn9c102_i2c_write(cam, 0x18, 0xbd); | 
|  | 43 | err += sn9c102_i2c_write(cam, 0x19, 0x06); | 
|  | 44 | err += sn9c102_i2c_write(cam, 0x1a, 0xf6); | 
|  | 45 | err += sn9c102_i2c_write(cam, 0x1b, 0x04); | 
|  | 46 | err += sn9c102_i2c_write(cam, 0x20, 0x44); | 
|  | 47 | err += sn9c102_i2c_write(cam, 0x23, 0xee); | 
|  | 48 | err += sn9c102_i2c_write(cam, 0x26, 0xa0); | 
|  | 49 | err += sn9c102_i2c_write(cam, 0x27, 0x9a); | 
|  | 50 | err += sn9c102_i2c_write(cam, 0x28, 0x20); | 
|  | 51 | err += sn9c102_i2c_write(cam, 0x29, 0x30); | 
|  | 52 | err += sn9c102_i2c_write(cam, 0x2f, 0x3d); | 
|  | 53 | err += sn9c102_i2c_write(cam, 0x30, 0x24); | 
|  | 54 | err += sn9c102_i2c_write(cam, 0x32, 0x86); | 
|  | 55 | err += sn9c102_i2c_write(cam, 0x60, 0xa9); | 
|  | 56 | err += sn9c102_i2c_write(cam, 0x61, 0x42); | 
|  | 57 | err += sn9c102_i2c_write(cam, 0x65, 0x00); | 
|  | 58 | err += sn9c102_i2c_write(cam, 0x69, 0x38); | 
|  | 59 | err += sn9c102_i2c_write(cam, 0x6f, 0x88); | 
|  | 60 | err += sn9c102_i2c_write(cam, 0x70, 0x0b); | 
|  | 61 | err += sn9c102_i2c_write(cam, 0x71, 0x00); | 
|  | 62 | err += sn9c102_i2c_write(cam, 0x74, 0x21); | 
|  | 63 | err += sn9c102_i2c_write(cam, 0x7d, 0xf7); | 
|  | 64 |  | 
|  | 65 | return err; | 
|  | 66 | } | 
|  | 67 |  | 
|  | 68 |  | 
|  | 69 | static int ov7630_set_ctrl(struct sn9c102_device* cam, | 
|  | 70 | const struct v4l2_control* ctrl) | 
|  | 71 | { | 
|  | 72 | int err = 0; | 
|  | 73 |  | 
|  | 74 | switch (ctrl->id) { | 
|  | 75 | case V4L2_CID_EXPOSURE: | 
|  | 76 | err += sn9c102_i2c_write(cam, 0x10, ctrl->value >> 2); | 
|  | 77 | err += sn9c102_i2c_write(cam, 0x76, ctrl->value & 0x03); | 
|  | 78 | break; | 
|  | 79 | case V4L2_CID_RED_BALANCE: | 
|  | 80 | err += sn9c102_i2c_write(cam, 0x02, ctrl->value); | 
|  | 81 | break; | 
|  | 82 | case V4L2_CID_BLUE_BALANCE: | 
|  | 83 | err += sn9c102_i2c_write(cam, 0x03, ctrl->value); | 
|  | 84 | break; | 
|  | 85 | case V4L2_CID_GAIN: | 
|  | 86 | err += sn9c102_i2c_write(cam, 0x00, ctrl->value); | 
|  | 87 | break; | 
|  | 88 | case V4L2_CID_CONTRAST: | 
|  | 89 | err += ctrl->value ? sn9c102_i2c_write(cam, 0x05, | 
|  | 90 | (ctrl->value-1) | 0x20) | 
|  | 91 | : sn9c102_i2c_write(cam, 0x05, 0x00); | 
|  | 92 | break; | 
|  | 93 | case V4L2_CID_BRIGHTNESS: | 
|  | 94 | err += sn9c102_i2c_write(cam, 0x06, ctrl->value); | 
|  | 95 | break; | 
|  | 96 | case V4L2_CID_SATURATION: | 
|  | 97 | err += sn9c102_i2c_write(cam, 0x03, ctrl->value << 4); | 
|  | 98 | break; | 
|  | 99 | case V4L2_CID_HUE: | 
|  | 100 | err += ctrl->value ? sn9c102_i2c_write(cam, 0x04, | 
|  | 101 | (ctrl->value-1) | 0x20) | 
|  | 102 | : sn9c102_i2c_write(cam, 0x04, 0x00); | 
|  | 103 | break; | 
|  | 104 | case V4L2_CID_DO_WHITE_BALANCE: | 
|  | 105 | err += sn9c102_i2c_write(cam, 0x0c, ctrl->value); | 
|  | 106 | break; | 
|  | 107 | case V4L2_CID_WHITENESS: | 
|  | 108 | err += sn9c102_i2c_write(cam, 0x0d, ctrl->value); | 
|  | 109 | break; | 
|  | 110 | case V4L2_CID_AUTO_WHITE_BALANCE: | 
|  | 111 | err += sn9c102_i2c_write(cam, 0x12, (ctrl->value << 2) | 0x09); | 
|  | 112 | break; | 
|  | 113 | case V4L2_CID_AUTOGAIN: | 
|  | 114 | err += sn9c102_i2c_write(cam, 0x13, ctrl->value); | 
|  | 115 | break; | 
|  | 116 | case V4L2_CID_VFLIP: | 
|  | 117 | err += sn9c102_i2c_write(cam, 0x75, 0x0e | (ctrl->value << 7)); | 
|  | 118 | break; | 
|  | 119 | case V4L2_CID_BLACK_LEVEL: | 
|  | 120 | err += sn9c102_i2c_write(cam, 0x25, ctrl->value); | 
|  | 121 | break; | 
|  | 122 | case SN9C102_V4L2_CID_BRIGHT_LEVEL: | 
|  | 123 | err += sn9c102_i2c_write(cam, 0x24, ctrl->value); | 
|  | 124 | break; | 
|  | 125 | case SN9C102_V4L2_CID_GAMMA: | 
|  | 126 | err += sn9c102_i2c_write(cam, 0x14, (ctrl->value << 2) | 0x80); | 
|  | 127 | break; | 
|  | 128 | case SN9C102_V4L2_CID_BAND_FILTER: | 
|  | 129 | err += sn9c102_i2c_write(cam, 0x2d, ctrl->value << 2); | 
|  | 130 | break; | 
|  | 131 | default: | 
|  | 132 | return -EINVAL; | 
|  | 133 | } | 
|  | 134 |  | 
|  | 135 | return err ? -EIO : 0; | 
|  | 136 | } | 
|  | 137 |  | 
|  | 138 |  | 
|  | 139 | static int ov7630_set_crop(struct sn9c102_device* cam, | 
|  | 140 | const struct v4l2_rect* rect) | 
|  | 141 | { | 
|  | 142 | struct sn9c102_sensor* s = &ov7630; | 
|  | 143 | int err = 0; | 
|  | 144 | u8 v_start = (u8)(rect->top - s->cropcap.bounds.top) + 1; | 
|  | 145 |  | 
|  | 146 | err += sn9c102_write_reg(cam, v_start, 0x13); | 
|  | 147 |  | 
|  | 148 | return err; | 
|  | 149 | } | 
|  | 150 |  | 
|  | 151 |  | 
|  | 152 | static int ov7630_set_pix_format(struct sn9c102_device* cam, | 
|  | 153 | const struct v4l2_pix_format* pix) | 
|  | 154 | { | 
|  | 155 | int err = 0; | 
|  | 156 |  | 
|  | 157 | if (pix->pixelformat == V4L2_PIX_FMT_SN9C10X) | 
|  | 158 | err += sn9c102_write_reg(cam, 0x20, 0x19); | 
|  | 159 | else | 
|  | 160 | err += sn9c102_write_reg(cam, 0x50, 0x19); | 
|  | 161 |  | 
|  | 162 | return err; | 
|  | 163 | } | 
|  | 164 |  | 
|  | 165 |  | 
|  | 166 | static struct sn9c102_sensor ov7630 = { | 
|  | 167 | .name = "OV7630", | 
|  | 168 | .maintainer = "Luca Risolia <luca.risolia@studio.unibo.it>", | 
|  | 169 | .sysfs_ops = SN9C102_I2C_WRITE, | 
|  | 170 | .frequency = SN9C102_I2C_100KHZ, | 
|  | 171 | .interface = SN9C102_I2C_2WIRES, | 
|  | 172 | .i2c_slave_id = 0x21, | 
|  | 173 | .init = &ov7630_init, | 
|  | 174 | .qctrl = { | 
|  | 175 | { | 
|  | 176 | .id = V4L2_CID_GAIN, | 
|  | 177 | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | 178 | .name = "global gain", | 
|  | 179 | .minimum = 0x00, | 
|  | 180 | .maximum = 0x3f, | 
|  | 181 | .step = 0x01, | 
|  | 182 | .default_value = 0x14, | 
|  | 183 | .flags = 0, | 
|  | 184 | }, | 
|  | 185 | { | 
|  | 186 | .id = V4L2_CID_HUE, | 
|  | 187 | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | 188 | .name = "hue", | 
|  | 189 | .minimum = 0x00, | 
|  | 190 | .maximum = 0x1f+1, | 
|  | 191 | .step = 0x01, | 
|  | 192 | .default_value = 0x00, | 
|  | 193 | .flags = 0, | 
|  | 194 | }, | 
|  | 195 | { | 
|  | 196 | .id = V4L2_CID_SATURATION, | 
|  | 197 | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | 198 | .name = "saturation", | 
|  | 199 | .minimum = 0x00, | 
|  | 200 | .maximum = 0x0f, | 
|  | 201 | .step = 0x01, | 
|  | 202 | .default_value = 0x08, | 
|  | 203 | .flags = 0, | 
|  | 204 | }, | 
|  | 205 | { | 
|  | 206 | .id = V4L2_CID_CONTRAST, | 
|  | 207 | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | 208 | .name = "contrast", | 
|  | 209 | .minimum = 0x00, | 
|  | 210 | .maximum = 0x1f+1, | 
|  | 211 | .step = 0x01, | 
|  | 212 | .default_value = 0x00, | 
|  | 213 | .flags = 0, | 
|  | 214 | }, | 
|  | 215 | { | 
|  | 216 | .id = V4L2_CID_EXPOSURE, | 
|  | 217 | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | 218 | .name = "exposure", | 
|  | 219 | .minimum = 0x000, | 
|  | 220 | .maximum = 0x3ff, | 
|  | 221 | .step = 0x001, | 
|  | 222 | .default_value = 0x83<<2, | 
|  | 223 | .flags = 0, | 
|  | 224 | }, | 
|  | 225 | { | 
|  | 226 | .id = V4L2_CID_RED_BALANCE, | 
|  | 227 | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | 228 | .name = "red balance", | 
|  | 229 | .minimum = 0x00, | 
|  | 230 | .maximum = 0xff, | 
|  | 231 | .step = 0x01, | 
|  | 232 | .default_value = 0x3a, | 
|  | 233 | .flags = 0, | 
|  | 234 | }, | 
|  | 235 | { | 
|  | 236 | .id = V4L2_CID_BLUE_BALANCE, | 
|  | 237 | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | 238 | .name = "blue balance", | 
|  | 239 | .minimum = 0x00, | 
|  | 240 | .maximum = 0xff, | 
|  | 241 | .step = 0x01, | 
|  | 242 | .default_value = 0x77, | 
|  | 243 | .flags = 0, | 
|  | 244 | }, | 
|  | 245 | { | 
|  | 246 | .id = V4L2_CID_BRIGHTNESS, | 
|  | 247 | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | 248 | .name = "brightness", | 
|  | 249 | .minimum = 0x00, | 
|  | 250 | .maximum = 0xff, | 
|  | 251 | .step = 0x01, | 
|  | 252 | .default_value = 0xa0, | 
|  | 253 | .flags = 0, | 
|  | 254 | }, | 
|  | 255 | { | 
|  | 256 | .id = V4L2_CID_DO_WHITE_BALANCE, | 
|  | 257 | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | 258 | .name = "white balance background: blue", | 
|  | 259 | .minimum = 0x00, | 
|  | 260 | .maximum = 0x3f, | 
|  | 261 | .step = 0x01, | 
|  | 262 | .default_value = 0x20, | 
|  | 263 | .flags = 0, | 
|  | 264 | }, | 
|  | 265 | { | 
|  | 266 | .id = V4L2_CID_WHITENESS, | 
|  | 267 | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | 268 | .name = "white balance background: red", | 
|  | 269 | .minimum = 0x00, | 
|  | 270 | .maximum = 0x3f, | 
|  | 271 | .step = 0x01, | 
|  | 272 | .default_value = 0x20, | 
|  | 273 | .flags = 0, | 
|  | 274 | }, | 
|  | 275 | { | 
|  | 276 | .id = V4L2_CID_AUTO_WHITE_BALANCE, | 
|  | 277 | .type = V4L2_CTRL_TYPE_BOOLEAN, | 
|  | 278 | .name = "auto white balance", | 
|  | 279 | .minimum = 0x00, | 
|  | 280 | .maximum = 0x01, | 
|  | 281 | .step = 0x01, | 
|  | 282 | .default_value = 0x01, | 
|  | 283 | .flags = 0, | 
|  | 284 | }, | 
|  | 285 | { | 
|  | 286 | .id = V4L2_CID_AUTOGAIN, | 
|  | 287 | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | 288 | .name = "gain & exposure mode", | 
|  | 289 | .minimum = 0x00, | 
|  | 290 | .maximum = 0x03, | 
|  | 291 | .step = 0x01, | 
|  | 292 | .default_value = 0x00, | 
|  | 293 | .flags = 0, | 
|  | 294 | }, | 
|  | 295 | { | 
|  | 296 | .id = V4L2_CID_VFLIP, | 
|  | 297 | .type = V4L2_CTRL_TYPE_BOOLEAN, | 
|  | 298 | .name = "vertical flip", | 
|  | 299 | .minimum = 0x00, | 
|  | 300 | .maximum = 0x01, | 
|  | 301 | .step = 0x01, | 
|  | 302 | .default_value = 0x01, | 
|  | 303 | .flags = 0, | 
|  | 304 | }, | 
|  | 305 | { | 
|  | 306 | .id = V4L2_CID_BLACK_LEVEL, | 
|  | 307 | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | 308 | .name = "black pixel ratio", | 
|  | 309 | .minimum = 0x01, | 
|  | 310 | .maximum = 0x9a, | 
|  | 311 | .step = 0x01, | 
|  | 312 | .default_value = 0x8a, | 
|  | 313 | .flags = 0, | 
|  | 314 | }, | 
|  | 315 | { | 
|  | 316 | .id = SN9C102_V4L2_CID_BRIGHT_LEVEL, | 
|  | 317 | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | 318 | .name = "bright pixel ratio", | 
|  | 319 | .minimum = 0x01, | 
|  | 320 | .maximum = 0x9a, | 
|  | 321 | .step = 0x01, | 
|  | 322 | .default_value = 0x10, | 
|  | 323 | .flags = 0, | 
|  | 324 | }, | 
|  | 325 | { | 
|  | 326 | .id = SN9C102_V4L2_CID_BAND_FILTER, | 
|  | 327 | .type = V4L2_CTRL_TYPE_BOOLEAN, | 
|  | 328 | .name = "band filter", | 
|  | 329 | .minimum = 0x00, | 
|  | 330 | .maximum = 0x01, | 
|  | 331 | .step = 0x01, | 
|  | 332 | .default_value = 0x00, | 
|  | 333 | .flags = 0, | 
|  | 334 | }, | 
|  | 335 | { | 
|  | 336 | .id = SN9C102_V4L2_CID_GAMMA, | 
|  | 337 | .type = V4L2_CTRL_TYPE_BOOLEAN, | 
|  | 338 | .name = "rgb gamma", | 
|  | 339 | .minimum = 0x00, | 
|  | 340 | .maximum = 0x01, | 
|  | 341 | .step = 0x01, | 
|  | 342 | .default_value = 0x00, | 
|  | 343 | .flags = 0, | 
|  | 344 | }, | 
|  | 345 | }, | 
|  | 346 | .set_ctrl = &ov7630_set_ctrl, | 
|  | 347 | .cropcap = { | 
|  | 348 | .bounds = { | 
|  | 349 | .left = 0, | 
|  | 350 | .top = 0, | 
|  | 351 | .width = 640, | 
|  | 352 | .height = 480, | 
|  | 353 | }, | 
|  | 354 | .defrect = { | 
|  | 355 | .left = 0, | 
|  | 356 | .top = 0, | 
|  | 357 | .width = 640, | 
|  | 358 | .height = 480, | 
|  | 359 | }, | 
|  | 360 | }, | 
|  | 361 | .set_crop = &ov7630_set_crop, | 
|  | 362 | .pix_format = { | 
|  | 363 | .width = 640, | 
|  | 364 | .height = 480, | 
|  | 365 | .pixelformat = V4L2_PIX_FMT_SBGGR8, | 
|  | 366 | .priv = 8, | 
|  | 367 | }, | 
|  | 368 | .set_pix_format = &ov7630_set_pix_format | 
|  | 369 | }; | 
|  | 370 |  | 
|  | 371 |  | 
|  | 372 | int sn9c102_probe_ov7630(struct sn9c102_device* cam) | 
|  | 373 | { | 
|  | 374 | int err = 0; | 
|  | 375 |  | 
|  | 376 | sn9c102_attach_sensor(cam, &ov7630); | 
|  | 377 |  | 
|  | 378 | if (le16_to_cpu(ov7630.usbdev->descriptor.idProduct) != 0x608f && | 
|  | 379 | le16_to_cpu(ov7630.usbdev->descriptor.idProduct) != 0x602c) | 
|  | 380 | return -ENODEV; | 
|  | 381 |  | 
|  | 382 | err += sn9c102_write_reg(cam, 0x01, 0x01); | 
|  | 383 | err += sn9c102_write_reg(cam, 0x00, 0x01); | 
|  | 384 | err += sn9c102_write_reg(cam, 0x28, 0x17); | 
|  | 385 |  | 
|  | 386 | if (err) | 
|  | 387 | return -EIO; | 
|  | 388 |  | 
|  | 389 | err += sn9c102_i2c_write(cam, 0x0b, 0); | 
|  | 390 | if (err) | 
|  | 391 | return -ENODEV; | 
|  | 392 |  | 
|  | 393 | return 0; | 
|  | 394 | } |