drivers/media/video/gspca/stv06xx/stv06xx_vv6410.c

   1 /*
   2  * Copyright (c) 2001 Jean-Fredric Clere, Nikolas Zimmermann, Georg Acher
   3  *                    Mark Cave-Ayland, Carlo E Prelz, Dick Streefland
   4  * Copyright (c) 2002, 2003 Tuukka Toivonen
   5  * Copyright (c) 2008 Erik Andrén
   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., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  20  *
  21  * P/N 861037:      Sensor HDCS1000        ASIC STV0600
  22  * P/N 861050-0010: Sensor HDCS1000        ASIC STV0600
  23  * P/N 861050-0020: Sensor Photobit PB100  ASIC STV0600-1 - QuickCam Express
  24  * P/N 861055:      Sensor ST VV6410       ASIC STV0610   - LEGO cam
  25  * P/N 861075-0040: Sensor HDCS1000        ASIC
  26  * P/N 961179-0700: Sensor ST VV6410       ASIC STV0602   - Dexxa WebCam USB
  27  * P/N 861040-0000: Sensor ST VV6410       ASIC STV0610   - QuickCam Web
  28  */
  29
  30 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  31
  32 #include "stv06xx_vv6410.h"
  33
  34 static struct v4l2_pix_format vv6410_mode[] = {
  35         {
  36                 356,
  37                 292,
  38                 V4L2_PIX_FMT_SGRBG8,
  39                 V4L2_FIELD_NONE,
  40                 .sizeimage = 356 * 292,
  41                 .bytesperline = 356,
  42                 .colorspace = V4L2_COLORSPACE_SRGB,
  43                 .priv = 0
  44         }
  45 };
  46
  47 static const struct ctrl vv6410_ctrl[] = {
  48 #define HFLIP_IDX 0
  49         {
  50                 {
  51                         .id             = V4L2_CID_HFLIP,
  52                         .type           = V4L2_CTRL_TYPE_BOOLEAN,
  53                         .name           = "horizontal flip",
  54                         .minimum        = 0,
  55                         .maximum        = 1,
  56                         .step           = 1,
  57                         .default_value  = 0
  58                 },
  59                 .set = vv6410_set_hflip,
  60                 .get = vv6410_get_hflip
  61         },
  62 #define VFLIP_IDX 1
  63         {
  64                 {
  65                         .id             = V4L2_CID_VFLIP,
  66                         .type           = V4L2_CTRL_TYPE_BOOLEAN,
  67                         .name           = "vertical flip",
  68                         .minimum        = 0,
  69                         .maximum        = 1,
  70                         .step           = 1,
  71                         .default_value  = 0
  72                 },
  73                 .set = vv6410_set_vflip,
  74                 .get = vv6410_get_vflip
  75         },
  76 #define GAIN_IDX 2
  77         {
  78                 {
  79                         .id             = V4L2_CID_GAIN,
  80                         .type           = V4L2_CTRL_TYPE_INTEGER,
  81                         .name           = "analog gain",
  82                         .minimum        = 0,
  83                         .maximum        = 15,
  84                         .step           = 1,
  85                         .default_value  = 10
  86                 },
  87                 .set = vv6410_set_analog_gain,
  88                 .get = vv6410_get_analog_gain
  89         },
  90 #define EXPOSURE_IDX 3
  91         {
  92                 {
  93                         .id             = V4L2_CID_EXPOSURE,
  94                         .type           = V4L2_CTRL_TYPE_INTEGER,
  95                         .name           = "exposure",
  96                         .minimum        = 0,
  97                         .maximum        = 32768,
  98                         .step           = 1,
  99                         .default_value  = 20000
 100                 },
 101                 .set = vv6410_set_exposure,
 102                 .get = vv6410_get_exposure
 103         }
 104         };
 105
 106 static int vv6410_probe(struct sd *sd)
 107 {
 108         u16 data;
 109         int err, i;
 110         s32 *sensor_settings;
 111
 112         err = stv06xx_read_sensor(sd, VV6410_DEVICEH, &data);
 113         if (err < 0)
 114                 return -ENODEV;
 115
 116         if (data == 0x19) {
 117                 pr_info("vv6410 sensor detected\n");
 118
 119                 sensor_settings = kmalloc(ARRAY_SIZE(vv6410_ctrl) * sizeof(s32),
 120                                           GFP_KERNEL);
 121                 if (!sensor_settings)
 122                         return -ENOMEM;
 123
 124                 sd->gspca_dev.cam.cam_mode = vv6410_mode;
 125                 sd->gspca_dev.cam.nmodes = ARRAY_SIZE(vv6410_mode);
 126                 sd->desc.ctrls = vv6410_ctrl;
 127                 sd->desc.nctrls = ARRAY_SIZE(vv6410_ctrl);
 128
 129                 for (i = 0; i < sd->desc.nctrls; i++)
 130                         sensor_settings[i] = vv6410_ctrl[i].qctrl.default_value;
 131                 sd->sensor_priv = sensor_settings;
 132                 return 0;
 133         }
 134         return -ENODEV;
 135 }
 136
 137 static int vv6410_init(struct sd *sd)
 138 {
 139         int err = 0, i;
 140         s32 *sensor_settings = sd->sensor_priv;
 141
 142         for (i = 0; i < ARRAY_SIZE(stv_bridge_init); i++) {
 143                 stv06xx_write_bridge(sd, stv_bridge_init[i].addr, stv_bridge_init[i].data);
 144         }
 145
 146         if (err < 0)
 147                 return err;
 148
 149         err = stv06xx_write_sensor_bytes(sd, (u8 *) vv6410_sensor_init,
 150                                          ARRAY_SIZE(vv6410_sensor_init));
 151         if (err < 0)
 152                 return err;
 153
 154         err = vv6410_set_exposure(&sd->gspca_dev,
 155                                    sensor_settings[EXPOSURE_IDX]);
 156         if (err < 0)
 157                 return err;
 158
 159         err = vv6410_set_analog_gain(&sd->gspca_dev,
 160                                       sensor_settings[GAIN_IDX]);
 161
 162         return (err < 0) ? err : 0;
 163 }
 164
 165 static void vv6410_disconnect(struct sd *sd)
 166 {
 167         sd->sensor = NULL;
 168         kfree(sd->sensor_priv);
 169 }
 170
 171 static int vv6410_start(struct sd *sd)
 172 {
 173         int err;
 174         struct cam *cam = &sd->gspca_dev.cam;
 175         u32 priv = cam->cam_mode[sd->gspca_dev.curr_mode].priv;
 176
 177         if (priv & VV6410_SUBSAMPLE) {
 178                 PDEBUG(D_CONF, "Enabling subsampling");
 179                 stv06xx_write_bridge(sd, STV_Y_CTRL, 0x02);
 180                 stv06xx_write_bridge(sd, STV_X_CTRL, 0x06);
 181
 182                 stv06xx_write_bridge(sd, STV_SCAN_RATE, 0x10);
 183         } else {
 184                 stv06xx_write_bridge(sd, STV_Y_CTRL, 0x01);
 185                 stv06xx_write_bridge(sd, STV_X_CTRL, 0x0a);
 186                 stv06xx_write_bridge(sd, STV_SCAN_RATE, 0x00);
 187
 188         }
 189
 190         /* Turn on LED */
 191         err = stv06xx_write_bridge(sd, STV_LED_CTRL, LED_ON);
 192         if (err < 0)
 193                 return err;
 194
 195         err = stv06xx_write_sensor(sd, VV6410_SETUP0, 0);
 196         if (err < 0)
 197                 return err;
 198
 199         PDEBUG(D_STREAM, "Starting stream");
 200
 201         return 0;
 202 }
 203
 204 static int vv6410_stop(struct sd *sd)
 205 {
 206         int err;
 207
 208         /* Turn off LED */
 209         err = stv06xx_write_bridge(sd, STV_LED_CTRL, LED_OFF);
 210         if (err < 0)
 211                 return err;
 212
 213         err = stv06xx_write_sensor(sd, VV6410_SETUP0, VV6410_LOW_POWER_MODE);
 214         if (err < 0)
 215                 return err;
 216
 217         PDEBUG(D_STREAM, "Halting stream");
 218
 219         return (err < 0) ? err : 0;
 220 }
 221
 222 static int vv6410_dump(struct sd *sd)
 223 {
 224         u8 i;
 225         int err = 0;
 226
 227         pr_info("Dumping all vv6410 sensor registers\n");
 228         for (i = 0; i < 0xff && !err; i++) {
 229                 u16 data;
 230                 err = stv06xx_read_sensor(sd, i, &data);
 231                 pr_info("Register 0x%x contained 0x%x\n", i, data);
 232         }
 233         return (err < 0) ? err : 0;
 234 }
 235
 236 static int vv6410_get_hflip(struct gspca_dev *gspca_dev, __s32 *val)
 237 {
 238         struct sd *sd = (struct sd *) gspca_dev;
 239         s32 *sensor_settings = sd->sensor_priv;
 240
 241         *val = sensor_settings[HFLIP_IDX];
 242         PDEBUG(D_V4L2, "Read horizontal flip %d", *val);
 243
 244         return 0;
 245 }
 246
 247 static int vv6410_set_hflip(struct gspca_dev *gspca_dev, __s32 val)
 248 {
 249         int err;
 250         u16 i2c_data;
 251         struct sd *sd = (struct sd *) gspca_dev;
 252         s32 *sensor_settings = sd->sensor_priv;
 253
 254         sensor_settings[HFLIP_IDX] = val;
 255         err = stv06xx_read_sensor(sd, VV6410_DATAFORMAT, &i2c_data);
 256         if (err < 0)
 257                 return err;
 258
 259         if (val)
 260                 i2c_data |= VV6410_HFLIP;
 261         else
 262                 i2c_data &= ~VV6410_HFLIP;
 263
 264         PDEBUG(D_V4L2, "Set horizontal flip to %d", val);
 265         err = stv06xx_write_sensor(sd, VV6410_DATAFORMAT, i2c_data);
 266
 267         return (err < 0) ? err : 0;
 268 }
 269
 270 static int vv6410_get_vflip(struct gspca_dev *gspca_dev, __s32 *val)
 271 {
 272         struct sd *sd = (struct sd *) gspca_dev;
 273         s32 *sensor_settings = sd->sensor_priv;
 274
 275         *val = sensor_settings[VFLIP_IDX];
 276         PDEBUG(D_V4L2, "Read vertical flip %d", *val);
 277
 278         return 0;
 279 }
 280
 281 static int vv6410_set_vflip(struct gspca_dev *gspca_dev, __s32 val)
 282 {
 283         int err;
 284         u16 i2c_data;
 285         struct sd *sd = (struct sd *) gspca_dev;
 286         s32 *sensor_settings = sd->sensor_priv;
 287
 288         sensor_settings[VFLIP_IDX] = val;
 289         err = stv06xx_read_sensor(sd, VV6410_DATAFORMAT, &i2c_data);
 290         if (err < 0)
 291                 return err;
 292
 293         if (val)
 294                 i2c_data |= VV6410_VFLIP;
 295         else
 296                 i2c_data &= ~VV6410_VFLIP;
 297
 298         PDEBUG(D_V4L2, "Set vertical flip to %d", val);
 299         err = stv06xx_write_sensor(sd, VV6410_DATAFORMAT, i2c_data);
 300
 301         return (err < 0) ? err : 0;
 302 }
 303
 304 static int vv6410_get_analog_gain(struct gspca_dev *gspca_dev, __s32 *val)
 305 {
 306         struct sd *sd = (struct sd *) gspca_dev;
 307         s32 *sensor_settings = sd->sensor_priv;
 308
 309         *val = sensor_settings[GAIN_IDX];
 310
 311         PDEBUG(D_V4L2, "Read analog gain %d", *val);
 312
 313         return 0;
 314 }
 315
 316 static int vv6410_set_analog_gain(struct gspca_dev *gspca_dev, __s32 val)
 317 {
 318         int err;
 319         struct sd *sd = (struct sd *) gspca_dev;
 320         s32 *sensor_settings = sd->sensor_priv;
 321
 322         sensor_settings[GAIN_IDX] = val;
 323         PDEBUG(D_V4L2, "Set analog gain to %d", val);
 324         err = stv06xx_write_sensor(sd, VV6410_ANALOGGAIN, 0xf0 | (val & 0xf));
 325
 326         return (err < 0) ? err : 0;
 327 }
 328
 329 static int vv6410_get_exposure(struct gspca_dev *gspca_dev, __s32 *val)
 330 {
 331         struct sd *sd = (struct sd *) gspca_dev;
 332         s32 *sensor_settings = sd->sensor_priv;
 333
 334         *val = sensor_settings[EXPOSURE_IDX];
 335
 336         PDEBUG(D_V4L2, "Read exposure %d", *val);
 337
 338         return 0;
 339 }
 340
 341 static int vv6410_set_exposure(struct gspca_dev *gspca_dev, __s32 val)
 342 {
 343         int err;
 344         struct sd *sd = (struct sd *) gspca_dev;
 345         s32 *sensor_settings = sd->sensor_priv;
 346         unsigned int fine, coarse;
 347
 348         sensor_settings[EXPOSURE_IDX] = val;
 349
 350         val = (val * val >> 14) + val / 4;
 351
 352         fine = val % VV6410_CIF_LINELENGTH;
 353         coarse = min(512, val / VV6410_CIF_LINELENGTH);
 354
 355         PDEBUG(D_V4L2, "Set coarse exposure to %d, fine expsure to %d",
 356                coarse, fine);
 357
 358         err = stv06xx_write_sensor(sd, VV6410_FINEH, fine >> 8);
 359         if (err < 0)
 360                 goto out;
 361
 362         err = stv06xx_write_sensor(sd, VV6410_FINEL, fine & 0xff);
 363         if (err < 0)
 364                 goto out;
 365
 366         err = stv06xx_write_sensor(sd, VV6410_COARSEH, coarse >> 8);
 367         if (err < 0)
 368                 goto out;
 369
 370         err = stv06xx_write_sensor(sd, VV6410_COARSEL, coarse & 0xff);
 371
 372 out:
 373         return err;
 374 }