drivers/media/video/ovcamchip/ov7x10.c

   1 /* OmniVision OV7610/OV7110 Camera Chip Support Code
   2  *
   3  * Copyright (c) 1999-2004 Mark McClelland <mark@alpha.dyndns.org>
   4  * http://alpha.dyndns.org/ov511/
   5  *
   6  * Color fixes by by Orion Sky Lawlor <olawlor@acm.org> (2/26/2000)
   7  *
   8  * This program is free software; you can redistribute it and/or modify it
   9  * under the terms of the GNU General Public License as published by the
  10  * Free Software Foundation; either version 2 of the License, or (at your
  11  * option) any later version. NO WARRANTY OF ANY KIND is expressed or implied.
  12  */
  13
  14 #define DEBUG
  15
  16 #include <linux/slab.h>
  17 #include "ovcamchip_priv.h"
  18
  19 /* Registers */
  20 #define REG_GAIN                0x00    /* gain [5:0] */
  21 #define REG_BLUE                0x01    /* blue channel balance */
  22 #define REG_RED                 0x02    /* red channel balance */
  23 #define REG_SAT                 0x03    /* saturation */
  24 #define REG_CNT                 0x05    /* Y contrast */
  25 #define REG_BRT                 0x06    /* Y brightness */
  26 #define REG_BLUE_BIAS           0x0C    /* blue channel bias [5:0] */
  27 #define REG_RED_BIAS            0x0D    /* red channel bias [5:0] */
  28 #define REG_GAMMA_COEFF         0x0E    /* gamma settings */
  29 #define REG_WB_RANGE            0x0F    /* AEC/ALC/S-AWB settings */
  30 #define REG_EXP                 0x10    /* manual exposure setting */
  31 #define REG_CLOCK               0x11    /* polarity/clock prescaler */
  32 #define REG_FIELD_DIVIDE        0x16    /* field interval/mode settings */
  33 #define REG_HWIN_START          0x17    /* horizontal window start */
  34 #define REG_HWIN_END            0x18    /* horizontal window end */
  35 #define REG_VWIN_START          0x19    /* vertical window start */
  36 #define REG_VWIN_END            0x1A    /* vertical window end */
  37 #define REG_PIXEL_SHIFT         0x1B    /* pixel shift */
  38 #define REG_YOFFSET             0x21    /* Y channel offset */
  39 #define REG_UOFFSET             0x22    /* U channel offset */
  40 #define REG_ECW                 0x24    /* exposure white level for AEC */
  41 #define REG_ECB                 0x25    /* exposure black level for AEC */
  42 #define REG_FRAMERATE_H         0x2A    /* frame rate MSB + misc */
  43 #define REG_FRAMERATE_L         0x2B    /* frame rate LSB */
  44 #define REG_ALC                 0x2C    /* Auto Level Control settings */
  45 #define REG_VOFFSET             0x2E    /* V channel offset adjustment */
  46 #define REG_ARRAY_BIAS          0x2F    /* array bias -- don't change */
  47 #define REG_YGAMMA              0x33    /* misc gamma settings [7:6] */
  48 #define REG_BIAS_ADJUST         0x34    /* misc bias settings */
  49
  50 /* Window parameters */
  51 #define HWSBASE 0x38
  52 #define HWEBASE 0x3a
  53 #define VWSBASE 0x05
  54 #define VWEBASE 0x05
  55
  56 struct ov7x10 {
  57         int auto_brt;
  58         int auto_exp;
  59         int bandfilt;
  60         int mirror;
  61 };
  62
  63 /* Lawrence Glaister <lg@jfm.bc.ca> reports:
  64  *
  65  * Register 0x0f in the 7610 has the following effects:
  66  *
  67  * 0x85 (AEC method 1): Best overall, good contrast range
  68  * 0x45 (AEC method 2): Very overexposed
  69  * 0xa5 (spec sheet default): Ok, but the black level is
  70  *      shifted resulting in loss of contrast
  71  * 0x05 (old driver setting): very overexposed, too much
  72  *      contrast
  73  */
  74 static struct ovcamchip_regvals regvals_init_7x10[] = {
  75         { 0x10, 0xff },
  76         { 0x16, 0x03 },
  77         { 0x28, 0x24 },
  78         { 0x2b, 0xac },
  79         { 0x12, 0x00 },
  80         { 0x38, 0x81 },
  81         { 0x28, 0x24 }, /* 0c */
  82         { 0x0f, 0x85 }, /* lg's setting */
  83         { 0x15, 0x01 },
  84         { 0x20, 0x1c },
  85         { 0x23, 0x2a },
  86         { 0x24, 0x10 },
  87         { 0x25, 0x8a },
  88         { 0x26, 0xa2 },
  89         { 0x27, 0xc2 },
  90         { 0x2a, 0x04 },
  91         { 0x2c, 0xfe },
  92         { 0x2d, 0x93 },
  93         { 0x30, 0x71 },
  94         { 0x31, 0x60 },
  95         { 0x32, 0x26 },
  96         { 0x33, 0x20 },
  97         { 0x34, 0x48 },
  98         { 0x12, 0x24 },
  99         { 0x11, 0x01 },
 100         { 0x0c, 0x24 },
 101         { 0x0d, 0x24 },
 102         { 0xff, 0xff }, /* END MARKER */
 103 };
 104
 105 /* This initializes the OV7x10 camera chip and relevant variables. */
 106 static int ov7x10_init(struct i2c_client *c)
 107 {
 108         struct ovcamchip *ov = i2c_get_clientdata(c);
 109         struct ov7x10 *s;
 110         int rc;
 111
 112         DDEBUG(4, &c->dev, "entered");
 113
 114         rc = ov_write_regvals(c, regvals_init_7x10);
 115         if (rc < 0)
 116                 return rc;
 117
 118         ov->spriv = s = kzalloc(sizeof *s, GFP_KERNEL);
 119         if (!s)
 120                 return -ENOMEM;
 121
 122         s->auto_brt = 1;
 123         s->auto_exp = 1;
 124
 125         return rc;
 126 }
 127
 128 static int ov7x10_free(struct i2c_client *c)
 129 {
 130         struct ovcamchip *ov = i2c_get_clientdata(c);
 131
 132         kfree(ov->spriv);
 133         return 0;
 134 }
 135
 136 static int ov7x10_set_control(struct i2c_client *c,
 137                               struct ovcamchip_control *ctl)
 138 {
 139         struct ovcamchip *ov = i2c_get_clientdata(c);
 140         struct ov7x10 *s = ov->spriv;
 141         int rc;
 142         int v = ctl->value;
 143
 144         switch (ctl->id) {
 145         case OVCAMCHIP_CID_CONT:
 146                 rc = ov_write(c, REG_CNT, v >> 8);
 147                 break;
 148         case OVCAMCHIP_CID_BRIGHT:
 149                 rc = ov_write(c, REG_BRT, v >> 8);
 150                 break;
 151         case OVCAMCHIP_CID_SAT:
 152                 rc = ov_write(c, REG_SAT, v >> 8);
 153                 break;
 154         case OVCAMCHIP_CID_HUE:
 155                 rc = ov_write(c, REG_RED, 0xFF - (v >> 8));
 156                 if (rc < 0)
 157                         goto out;
 158
 159                 rc = ov_write(c, REG_BLUE, v >> 8);
 160                 break;
 161         case OVCAMCHIP_CID_EXP:
 162                 rc = ov_write(c, REG_EXP, v);
 163                 break;
 164         case OVCAMCHIP_CID_FREQ:
 165         {
 166                 int sixty = (v == 60);
 167
 168                 rc = ov_write_mask(c, 0x2a, sixty?0x00:0x80, 0x80);
 169                 if (rc < 0)
 170                         goto out;
 171
 172                 rc = ov_write(c, 0x2b, sixty?0x00:0xac);
 173                 if (rc < 0)
 174                         goto out;
 175
 176                 rc = ov_write_mask(c, 0x13, 0x10, 0x10);
 177                 if (rc < 0)
 178                         goto out;
 179
 180                 rc = ov_write_mask(c, 0x13, 0x00, 0x10);
 181                 break;
 182         }
 183         case OVCAMCHIP_CID_BANDFILT:
 184                 rc = ov_write_mask(c, 0x2d, v?0x04:0x00, 0x04);
 185                 s->bandfilt = v;
 186                 break;
 187         case OVCAMCHIP_CID_AUTOBRIGHT:
 188                 rc = ov_write_mask(c, 0x2d, v?0x10:0x00, 0x10);
 189                 s->auto_brt = v;
 190                 break;
 191         case OVCAMCHIP_CID_AUTOEXP:
 192                 rc = ov_write_mask(c, 0x29, v?0x00:0x80, 0x80);
 193                 s->auto_exp = v;
 194                 break;
 195         case OVCAMCHIP_CID_MIRROR:
 196                 rc = ov_write_mask(c, 0x12, v?0x40:0x00, 0x40);
 197                 s->mirror = v;
 198                 break;
 199         default:
 200                 DDEBUG(2, &c->dev, "control not supported: %d", ctl->id);
 201                 return -EPERM;
 202         }
 203
 204 out:
 205         DDEBUG(3, &c->dev, "id=%d, arg=%d, rc=%d", ctl->id, v, rc);
 206         return rc;
 207 }
 208
 209 static int ov7x10_get_control(struct i2c_client *c,
 210                               struct ovcamchip_control *ctl)
 211 {
 212         struct ovcamchip *ov = i2c_get_clientdata(c);
 213         struct ov7x10 *s = ov->spriv;
 214         int rc = 0;
 215         unsigned char val = 0;
 216
 217         switch (ctl->id) {
 218         case OVCAMCHIP_CID_CONT:
 219                 rc = ov_read(c, REG_CNT, &val);
 220                 ctl->value = val << 8;
 221                 break;
 222         case OVCAMCHIP_CID_BRIGHT:
 223                 rc = ov_read(c, REG_BRT, &val);
 224                 ctl->value = val << 8;
 225                 break;
 226         case OVCAMCHIP_CID_SAT:
 227                 rc = ov_read(c, REG_SAT, &val);
 228                 ctl->value = val << 8;
 229                 break;
 230         case OVCAMCHIP_CID_HUE:
 231                 rc = ov_read(c, REG_BLUE, &val);
 232                 ctl->value = val << 8;
 233                 break;
 234         case OVCAMCHIP_CID_EXP:
 235                 rc = ov_read(c, REG_EXP, &val);
 236                 ctl->value = val;
 237                 break;
 238         case OVCAMCHIP_CID_BANDFILT:
 239                 ctl->value = s->bandfilt;
 240                 break;
 241         case OVCAMCHIP_CID_AUTOBRIGHT:
 242                 ctl->value = s->auto_brt;
 243                 break;
 244         case OVCAMCHIP_CID_AUTOEXP:
 245                 ctl->value = s->auto_exp;
 246                 break;
 247         case OVCAMCHIP_CID_MIRROR:
 248                 ctl->value = s->mirror;
 249                 break;
 250         default:
 251                 DDEBUG(2, &c->dev, "control not supported: %d", ctl->id);
 252                 return -EPERM;
 253         }
 254
 255         DDEBUG(3, &c->dev, "id=%d, arg=%d, rc=%d", ctl->id, ctl->value, rc);
 256         return rc;
 257 }
 258
 259 static int ov7x10_mode_init(struct i2c_client *c, struct ovcamchip_window *win)
 260 {
 261         int qvga = win->quarter;
 262
 263         /******** QVGA-specific regs ********/
 264
 265         ov_write(c, 0x14, qvga?0x24:0x04);
 266
 267         /******** Palette-specific regs ********/
 268
 269         if (win->format == VIDEO_PALETTE_GREY) {
 270                 ov_write_mask(c, 0x0e, 0x40, 0x40);
 271                 ov_write_mask(c, 0x13, 0x20, 0x20);
 272         } else {
 273                 ov_write_mask(c, 0x0e, 0x00, 0x40);
 274                 ov_write_mask(c, 0x13, 0x00, 0x20);
 275         }
 276
 277         /******** Clock programming ********/
 278
 279         ov_write(c, 0x11, win->clockdiv);
 280
 281         /******** Resolution-specific ********/
 282
 283         if (win->width == 640 && win->height == 480)
 284                 ov_write(c, 0x35, 0x9e);
 285         else
 286                 ov_write(c, 0x35, 0x1e);
 287
 288         return 0;
 289 }
 290
 291 static int ov7x10_set_window(struct i2c_client *c, struct ovcamchip_window *win)
 292 {
 293         int ret, hwscale, vwscale;
 294
 295         ret = ov7x10_mode_init(c, win);
 296         if (ret < 0)
 297                 return ret;
 298
 299         if (win->quarter) {
 300                 hwscale = 1;
 301                 vwscale = 0;
 302         } else {
 303                 hwscale = 2;
 304                 vwscale = 1;
 305         }
 306
 307         ov_write(c, 0x17, HWSBASE + (win->x >> hwscale));
 308         ov_write(c, 0x18, HWEBASE + ((win->x + win->width) >> hwscale));
 309         ov_write(c, 0x19, VWSBASE + (win->y >> vwscale));
 310         ov_write(c, 0x1a, VWEBASE + ((win->y + win->height) >> vwscale));
 311
 312         return 0;
 313 }
 314
 315 static int ov7x10_command(struct i2c_client *c, unsigned int cmd, void *arg)
 316 {
 317         switch (cmd) {
 318         case OVCAMCHIP_CMD_S_CTRL:
 319                 return ov7x10_set_control(c, arg);
 320         case OVCAMCHIP_CMD_G_CTRL:
 321                 return ov7x10_get_control(c, arg);
 322         case OVCAMCHIP_CMD_S_MODE:
 323                 return ov7x10_set_window(c, arg);
 324         default:
 325                 DDEBUG(2, &c->dev, "command not supported: %d", cmd);
 326                 return -ENOIOCTLCMD;
 327         }
 328 }
 329
 330 struct ovcamchip_ops ov7x10_ops = {
 331         .init    =      ov7x10_init,
 332         .free    =      ov7x10_free,
 333         .command =      ov7x10_command,
 334 };