hv7131r.c

   1 /**
   2  * @file hv7131r.c
   3  * @author GWater
   4  * @date 2008-12-17
   5  *
   6  * @brief Common control functions the HV7131R Image Sensor
   7  *
   8  * @note Copyright (C) GWater
   9  *
  10  * @par Licences
  11  *
  12  * This program is free software; you can redistribute it and/or modify
  13  * it under the terms of the GNU General Public License as published by
  14  * the Free Software Foundation; either version 2 of the License, or
  15  * any later version.
  16  *
  17  * This program is distributed in the hope that it will be useful,
  18  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  20  * GNU General Public License for more details.
  21  *
  22  * You should have received a copy of the GNU General Public License
  23  * along with this program; if not, write to the Free Software
  24  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  25  */
  26
  27 #include "sn9c20x.h"
  28 #include "sn9c20x-bridge.h"
  29
  30 struct sn9c20x_i2c_regs hv7131r_init[] = {
  31         {0x02, 0x08},
  32         {0x02, 0x00},
  33         {0x01, 0x08},
  34         {0x02, 0x00},
  35         {0x20, 0x00},
  36         {0x21, 0xd0},
  37         {0x22, 0x00},
  38         {0x23, 0x09},
  39         {0x01, 0x08},
  40         {0x01, 0x08},
  41         {0x01, 0x08},
  42         {0x25, 0x07},
  43         {0x26, 0xc3},
  44         {0x27, 0x50},
  45         {0x30, 0x62},
  46         {0x31, 0x10},
  47         {0x32, 0x06},
  48         {0x33, 0x10},
  49         {0x20, 0x00},
  50         {0x21, 0xd0},
  51         {0x22, 0x00},
  52         {0x23, 0x09},
  53         {0x01, 0x08},
  54 };
  55
  56
  57 int hv7131r_set_exposure(struct usb_sn9c20x *dev)
  58 {
  59         __u8 buf[3];
  60         int ret;
  61         __u32 val;
  62
  63         val = ((dev->vsettings.exposure << 8) * 0xffffff) / 0xffff;
  64
  65         buf[0] = (val >> 16) & 0xff;
  66         buf[1] = (val >> 8) & 0xff;
  67         buf[2] = val & 0xff;
  68
  69         ret = sn9c20x_write_i2c_data_ext(dev, 3, 0x25, buf, 0x1e);
  70
  71         return ret;
  72 }
  73
  74 int hv7131r_set_gain(struct usb_sn9c20x *dev)
  75 {
  76         __u8 buf;
  77         int ret;
  78
  79         buf = dev->vsettings.gain;
  80
  81         ret = sn9c20x_write_i2c_data_ext(dev, 1, 0x30, &buf, 0x1d);
  82
  83         return ret;
  84 }
  85
  86 int hv7131r_set_hvflip(struct usb_sn9c20x *dev)
  87 {
  88         __u8 buf;
  89         int ret;
  90
  91         ret = sn9c20x_read_i2c_data(dev, 1, 0x01, &buf);
  92         if (ret < 0)
  93                 return ret;
  94
  95         if (dev->vsettings.hflip)
  96                 buf |= 0x02;
  97         else
  98                 buf &= ~0x02;
  99
 100         if (dev->vsettings.vflip)
 101                 buf |= 0x01;
 102         else
 103                 buf &= ~0x01;
 104
 105         ret = sn9c20x_write_i2c_data(dev, 1, 0x01, &buf);
 106
 107         return ret;
 108 }