|  | /*************************************************************************** | 
|  | * Plug-in for OV7630 image sensor connected to the SN9C10x PC Camera      * | 
|  | * Controllers                                                             * | 
|  | *                                                                         * | 
|  | * Copyright (C) 2005 by Luca Risolia <luca.risolia@studio.unibo.it>       * | 
|  | *                                                                         * | 
|  | * This program is free software; you can redistribute it and/or modify    * | 
|  | * it under the terms of the GNU General Public License as published by    * | 
|  | * the Free Software Foundation; either version 2 of the License, or       * | 
|  | * (at your option) any later version.                                     * | 
|  | *                                                                         * | 
|  | * This program is distributed in the hope that it will be useful,         * | 
|  | * but WITHOUT ANY WARRANTY; without even the implied warranty of          * | 
|  | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the           * | 
|  | * GNU General Public License for more details.                            * | 
|  | *                                                                         * | 
|  | * You should have received a copy of the GNU General Public License       * | 
|  | * along with this program; if not, write to the Free Software             * | 
|  | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.               * | 
|  | ***************************************************************************/ | 
|  |  | 
|  | #include "sn9c102_sensor.h" | 
|  |  | 
|  |  | 
|  | static struct sn9c102_sensor ov7630; | 
|  |  | 
|  |  | 
|  | static int ov7630_init(struct sn9c102_device* cam) | 
|  | { | 
|  | int err = 0; | 
|  |  | 
|  | err += sn9c102_write_reg(cam, 0x00, 0x14); | 
|  | err += sn9c102_write_reg(cam, 0x60, 0x17); | 
|  | err += sn9c102_write_reg(cam, 0x0f, 0x18); | 
|  | err += sn9c102_write_reg(cam, 0x50, 0x19); | 
|  |  | 
|  | err += sn9c102_i2c_write(cam, 0x12, 0x8d); | 
|  | err += sn9c102_i2c_write(cam, 0x11, 0x00); | 
|  | err += sn9c102_i2c_write(cam, 0x15, 0x34); | 
|  | err += sn9c102_i2c_write(cam, 0x16, 0x03); | 
|  | err += sn9c102_i2c_write(cam, 0x17, 0x1c); | 
|  | err += sn9c102_i2c_write(cam, 0x18, 0xbd); | 
|  | err += sn9c102_i2c_write(cam, 0x19, 0x06); | 
|  | err += sn9c102_i2c_write(cam, 0x1a, 0xf6); | 
|  | err += sn9c102_i2c_write(cam, 0x1b, 0x04); | 
|  | err += sn9c102_i2c_write(cam, 0x20, 0x44); | 
|  | err += sn9c102_i2c_write(cam, 0x23, 0xee); | 
|  | err += sn9c102_i2c_write(cam, 0x26, 0xa0); | 
|  | err += sn9c102_i2c_write(cam, 0x27, 0x9a); | 
|  | err += sn9c102_i2c_write(cam, 0x28, 0x20); | 
|  | err += sn9c102_i2c_write(cam, 0x29, 0x30); | 
|  | err += sn9c102_i2c_write(cam, 0x2f, 0x3d); | 
|  | err += sn9c102_i2c_write(cam, 0x30, 0x24); | 
|  | err += sn9c102_i2c_write(cam, 0x32, 0x86); | 
|  | err += sn9c102_i2c_write(cam, 0x60, 0xa9); | 
|  | err += sn9c102_i2c_write(cam, 0x61, 0x42); | 
|  | err += sn9c102_i2c_write(cam, 0x65, 0x00); | 
|  | err += sn9c102_i2c_write(cam, 0x69, 0x38); | 
|  | err += sn9c102_i2c_write(cam, 0x6f, 0x88); | 
|  | err += sn9c102_i2c_write(cam, 0x70, 0x0b); | 
|  | err += sn9c102_i2c_write(cam, 0x71, 0x00); | 
|  | err += sn9c102_i2c_write(cam, 0x74, 0x21); | 
|  | err += sn9c102_i2c_write(cam, 0x7d, 0xf7); | 
|  |  | 
|  | return err; | 
|  | } | 
|  |  | 
|  |  | 
|  | static int ov7630_set_ctrl(struct sn9c102_device* cam, | 
|  | const struct v4l2_control* ctrl) | 
|  | { | 
|  | int err = 0; | 
|  |  | 
|  | switch (ctrl->id) { | 
|  | case V4L2_CID_EXPOSURE: | 
|  | err += sn9c102_i2c_write(cam, 0x10, ctrl->value >> 2); | 
|  | err += sn9c102_i2c_write(cam, 0x76, ctrl->value & 0x03); | 
|  | break; | 
|  | case V4L2_CID_RED_BALANCE: | 
|  | err += sn9c102_i2c_write(cam, 0x02, ctrl->value); | 
|  | break; | 
|  | case V4L2_CID_BLUE_BALANCE: | 
|  | err += sn9c102_i2c_write(cam, 0x03, ctrl->value); | 
|  | break; | 
|  | case V4L2_CID_GAIN: | 
|  | err += sn9c102_i2c_write(cam, 0x00, ctrl->value); | 
|  | break; | 
|  | case V4L2_CID_CONTRAST: | 
|  | err += ctrl->value ? sn9c102_i2c_write(cam, 0x05, | 
|  | (ctrl->value-1) | 0x20) | 
|  | : sn9c102_i2c_write(cam, 0x05, 0x00); | 
|  | break; | 
|  | case V4L2_CID_BRIGHTNESS: | 
|  | err += sn9c102_i2c_write(cam, 0x06, ctrl->value); | 
|  | break; | 
|  | case V4L2_CID_SATURATION: | 
|  | err += sn9c102_i2c_write(cam, 0x03, ctrl->value << 4); | 
|  | break; | 
|  | case V4L2_CID_HUE: | 
|  | err += ctrl->value ? sn9c102_i2c_write(cam, 0x04, | 
|  | (ctrl->value-1) | 0x20) | 
|  | : sn9c102_i2c_write(cam, 0x04, 0x00); | 
|  | break; | 
|  | case V4L2_CID_DO_WHITE_BALANCE: | 
|  | err += sn9c102_i2c_write(cam, 0x0c, ctrl->value); | 
|  | break; | 
|  | case V4L2_CID_WHITENESS: | 
|  | err += sn9c102_i2c_write(cam, 0x0d, ctrl->value); | 
|  | break; | 
|  | case V4L2_CID_AUTO_WHITE_BALANCE: | 
|  | err += sn9c102_i2c_write(cam, 0x12, (ctrl->value << 2) | 0x09); | 
|  | break; | 
|  | case V4L2_CID_AUTOGAIN: | 
|  | err += sn9c102_i2c_write(cam, 0x13, ctrl->value); | 
|  | break; | 
|  | case V4L2_CID_VFLIP: | 
|  | err += sn9c102_i2c_write(cam, 0x75, 0x0e | (ctrl->value << 7)); | 
|  | break; | 
|  | case V4L2_CID_BLACK_LEVEL: | 
|  | err += sn9c102_i2c_write(cam, 0x25, ctrl->value); | 
|  | break; | 
|  | case SN9C102_V4L2_CID_BRIGHT_LEVEL: | 
|  | err += sn9c102_i2c_write(cam, 0x24, ctrl->value); | 
|  | break; | 
|  | case SN9C102_V4L2_CID_GAMMA: | 
|  | err += sn9c102_i2c_write(cam, 0x14, (ctrl->value << 2) | 0x80); | 
|  | break; | 
|  | case SN9C102_V4L2_CID_BAND_FILTER: | 
|  | err += sn9c102_i2c_write(cam, 0x2d, ctrl->value << 2); | 
|  | break; | 
|  | default: | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | return err ? -EIO : 0; | 
|  | } | 
|  |  | 
|  |  | 
|  | static int ov7630_set_crop(struct sn9c102_device* cam, | 
|  | const struct v4l2_rect* rect) | 
|  | { | 
|  | struct sn9c102_sensor* s = &ov7630; | 
|  | int err = 0; | 
|  | u8 v_start = (u8)(rect->top - s->cropcap.bounds.top) + 1; | 
|  |  | 
|  | err += sn9c102_write_reg(cam, v_start, 0x13); | 
|  |  | 
|  | return err; | 
|  | } | 
|  |  | 
|  |  | 
|  | static int ov7630_set_pix_format(struct sn9c102_device* cam, | 
|  | const struct v4l2_pix_format* pix) | 
|  | { | 
|  | int err = 0; | 
|  |  | 
|  | if (pix->pixelformat == V4L2_PIX_FMT_SN9C10X) | 
|  | err += sn9c102_write_reg(cam, 0x20, 0x19); | 
|  | else | 
|  | err += sn9c102_write_reg(cam, 0x50, 0x19); | 
|  |  | 
|  | return err; | 
|  | } | 
|  |  | 
|  |  | 
|  | static struct sn9c102_sensor ov7630 = { | 
|  | .name = "OV7630", | 
|  | .maintainer = "Luca Risolia <luca.risolia@studio.unibo.it>", | 
|  | .sysfs_ops = SN9C102_I2C_WRITE, | 
|  | .frequency = SN9C102_I2C_100KHZ, | 
|  | .interface = SN9C102_I2C_2WIRES, | 
|  | .i2c_slave_id = 0x21, | 
|  | .init = &ov7630_init, | 
|  | .qctrl = { | 
|  | { | 
|  | .id = V4L2_CID_GAIN, | 
|  | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | .name = "global gain", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0x3f, | 
|  | .step = 0x01, | 
|  | .default_value = 0x14, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = V4L2_CID_HUE, | 
|  | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | .name = "hue", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0x1f+1, | 
|  | .step = 0x01, | 
|  | .default_value = 0x00, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = V4L2_CID_SATURATION, | 
|  | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | .name = "saturation", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0x0f, | 
|  | .step = 0x01, | 
|  | .default_value = 0x08, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = V4L2_CID_CONTRAST, | 
|  | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | .name = "contrast", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0x1f+1, | 
|  | .step = 0x01, | 
|  | .default_value = 0x00, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = V4L2_CID_EXPOSURE, | 
|  | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | .name = "exposure", | 
|  | .minimum = 0x000, | 
|  | .maximum = 0x3ff, | 
|  | .step = 0x001, | 
|  | .default_value = 0x83<<2, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = V4L2_CID_RED_BALANCE, | 
|  | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | .name = "red balance", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0xff, | 
|  | .step = 0x01, | 
|  | .default_value = 0x3a, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = V4L2_CID_BLUE_BALANCE, | 
|  | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | .name = "blue balance", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0xff, | 
|  | .step = 0x01, | 
|  | .default_value = 0x77, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = V4L2_CID_BRIGHTNESS, | 
|  | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | .name = "brightness", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0xff, | 
|  | .step = 0x01, | 
|  | .default_value = 0xa0, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = V4L2_CID_DO_WHITE_BALANCE, | 
|  | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | .name = "white balance background: blue", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0x3f, | 
|  | .step = 0x01, | 
|  | .default_value = 0x20, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = V4L2_CID_WHITENESS, | 
|  | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | .name = "white balance background: red", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0x3f, | 
|  | .step = 0x01, | 
|  | .default_value = 0x20, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = V4L2_CID_AUTO_WHITE_BALANCE, | 
|  | .type = V4L2_CTRL_TYPE_BOOLEAN, | 
|  | .name = "auto white balance", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0x01, | 
|  | .step = 0x01, | 
|  | .default_value = 0x01, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = V4L2_CID_AUTOGAIN, | 
|  | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | .name = "gain & exposure mode", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0x03, | 
|  | .step = 0x01, | 
|  | .default_value = 0x00, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = V4L2_CID_VFLIP, | 
|  | .type = V4L2_CTRL_TYPE_BOOLEAN, | 
|  | .name = "vertical flip", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0x01, | 
|  | .step = 0x01, | 
|  | .default_value = 0x01, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = V4L2_CID_BLACK_LEVEL, | 
|  | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | .name = "black pixel ratio", | 
|  | .minimum = 0x01, | 
|  | .maximum = 0x9a, | 
|  | .step = 0x01, | 
|  | .default_value = 0x8a, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = SN9C102_V4L2_CID_BRIGHT_LEVEL, | 
|  | .type = V4L2_CTRL_TYPE_INTEGER, | 
|  | .name = "bright pixel ratio", | 
|  | .minimum = 0x01, | 
|  | .maximum = 0x9a, | 
|  | .step = 0x01, | 
|  | .default_value = 0x10, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = SN9C102_V4L2_CID_BAND_FILTER, | 
|  | .type = V4L2_CTRL_TYPE_BOOLEAN, | 
|  | .name = "band filter", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0x01, | 
|  | .step = 0x01, | 
|  | .default_value = 0x00, | 
|  | .flags = 0, | 
|  | }, | 
|  | { | 
|  | .id = SN9C102_V4L2_CID_GAMMA, | 
|  | .type = V4L2_CTRL_TYPE_BOOLEAN, | 
|  | .name = "rgb gamma", | 
|  | .minimum = 0x00, | 
|  | .maximum = 0x01, | 
|  | .step = 0x01, | 
|  | .default_value = 0x00, | 
|  | .flags = 0, | 
|  | }, | 
|  | }, | 
|  | .set_ctrl = &ov7630_set_ctrl, | 
|  | .cropcap = { | 
|  | .bounds = { | 
|  | .left = 0, | 
|  | .top = 0, | 
|  | .width = 640, | 
|  | .height = 480, | 
|  | }, | 
|  | .defrect = { | 
|  | .left = 0, | 
|  | .top = 0, | 
|  | .width = 640, | 
|  | .height = 480, | 
|  | }, | 
|  | }, | 
|  | .set_crop = &ov7630_set_crop, | 
|  | .pix_format = { | 
|  | .width = 640, | 
|  | .height = 480, | 
|  | .pixelformat = V4L2_PIX_FMT_SBGGR8, | 
|  | .priv = 8, | 
|  | }, | 
|  | .set_pix_format = &ov7630_set_pix_format | 
|  | }; | 
|  |  | 
|  |  | 
|  | int sn9c102_probe_ov7630(struct sn9c102_device* cam) | 
|  | { | 
|  | int err = 0; | 
|  |  | 
|  | sn9c102_attach_sensor(cam, &ov7630); | 
|  |  | 
|  | if (le16_to_cpu(ov7630.usbdev->descriptor.idProduct) != 0x608f && | 
|  | le16_to_cpu(ov7630.usbdev->descriptor.idProduct) != 0x602c) | 
|  | return -ENODEV; | 
|  |  | 
|  | err += sn9c102_write_reg(cam, 0x01, 0x01); | 
|  | err += sn9c102_write_reg(cam, 0x00, 0x01); | 
|  | err += sn9c102_write_reg(cam, 0x28, 0x17); | 
|  |  | 
|  | if (err) | 
|  | return -EIO; | 
|  |  | 
|  | err += sn9c102_i2c_write(cam, 0x0b, 0); | 
|  | if (err) | 
|  | return -ENODEV; | 
|  |  | 
|  | return 0; | 
|  | } |