drivers/media/video/gspca/gl860/gl860-ov9655.c

   1 /* @file gl860-ov9655.c
   2  * @author Olivier LORIN, from logs done by Simon (Sur3) and Almighurt
   3  * on dsd's weblog
   4  * @date 2009-08-27
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 /* Sensor : OV9655 */
  21
  22 #include "gl860.h"
  23
  24 static struct validx tbl_init_at_startup[] = {
  25         {0x0000, 0x0000}, {0x0010, 0x0010}, {0x0008, 0x00c0}, {0x0001, 0x00c1},
  26         {0x0001, 0x00c2}, {0x0020, 0x0006}, {0x006a, 0x000d},
  27
  28         {0x0040, 0x0000},
  29 };
  30
  31 static struct validx tbl_commmon[] = {
  32         {0x0041, 0x0000}, {0x006a, 0x0007}, {0x0063, 0x0006}, {0x006a, 0x000d},
  33         {0x0000, 0x00c0}, {0x0010, 0x0010}, {0x0001, 0x00c1}, {0x0041, 0x00c2},
  34         {0x0004, 0x00d8}, {0x0012, 0x0004}, {0x0000, 0x0058}, {0x0040, 0x0000},
  35         {0x00f3, 0x0006}, {0x0058, 0x0000}, {0x0048, 0x0000}, {0x0061, 0x0000},
  36 };
  37
  38 static s32 tbl_length[] = {12, 56, 52, 54, 56, 42, 32, 12};
  39
  40 static u8 *tbl_640[] = {
  41         "\x00\x40\x07\x6a\x06\xf3\x0d\x6a" "\x10\x10\xc1\x01"
  42         ,
  43         "\x12\x80\x00\x00\x01\x98\x02\x80" "\x03\x12\x04\x03\x0b\x57\x0e\x61"
  44         "\x0f\x42\x11\x01\x12\x60\x13\x00" "\x14\x3a\x16\x24\x17\x14\x18\x00"
  45         "\x19\x01\x1a\x3d\x1e\x04\x24\x3c" "\x25\x36\x26\x72\x27\x08\x28\x08"
  46         "\x29\x15\x2a\x00\x2b\x00\x2c\x08"
  47         ,
  48         "\x32\xff\x33\x00\x34\x3d\x35\x00" "\x36\xfa\x38\x72\x39\x57\x3a\x00"
  49         "\x3b\x0c\x3d\x99\x3e\x0c\x3f\xc1" "\x40\xc0\x41\x00\x42\xc0\x43\x0a"
  50         "\x44\xf0\x45\x46\x46\x62\x47\x2a" "\x48\x3c\x4a\xee\x4b\xe7\x4c\xe7"
  51         "\x4d\xe7\x4e\xe7"
  52         ,
  53         "\x4f\x98\x50\x98\x51\x00\x52\x28" "\x53\x70\x54\x98\x58\x1a\x59\x85"
  54         "\x5a\xa9\x5b\x64\x5c\x84\x5d\x53" "\x5e\x0e\x5f\xf0\x60\xf0\x61\xf0"
  55         "\x62\x00\x63\x00\x64\x02\x65\x20" "\x66\x00\x69\x0a\x6b\x5a\x6c\x04"
  56         "\x6d\x55\x6e\x00\x6f\x9d"
  57         ,
  58         "\x70\x15\x71\x78\x72\x00\x73\x00" "\x74\x3a\x75\x35\x76\x01\x77\x02"
  59         "\x7a\x24\x7b\x04\x7c\x07\x7d\x10" "\x7e\x28\x7f\x36\x80\x44\x81\x52"
  60         "\x82\x60\x83\x6c\x84\x78\x85\x8c" "\x86\x9e\x87\xbb\x88\xd2\x89\xe5"
  61         "\x8a\x23\x8c\x8d\x90\x7c\x91\x7b"
  62         ,
  63         "\x9d\x02\x9e\x02\x9f\x74\xa0\x73" "\xa1\x40\xa4\x50\xa5\x68\xa6\x70"
  64         "\xa8\xc1\xa9\xef\xaa\x92\xab\x04" "\xac\x80\xad\x80\xae\x80\xaf\x80"
  65         "\xb2\xf2\xb3\x20\xb4\x20\xb5\x00" "\xb6\xaf"
  66         ,
  67         "\xbb\xae\xbc\x4f\xbd\x4e\xbe\x6a" "\xbf\x68\xc0\xaa\xc1\xc0\xc2\x01"
  68         "\xc3\x4e\xc6\x85\xc7\x81\xc9\xe0" "\xca\xe8\xcb\xf0\xcc\xd8\xcd\x93"
  69         ,
  70         "\xd0\x01\xd1\x08\xd2\xe0\xd3\x01" "\xd4\x10\xd5\x80"
  71 };
  72
  73 static u8 *tbl_800[] = {
  74         "\x00\x40\x07\x6a\x06\xf3\x0d\x6a" "\x10\x10\xc1\x01"
  75         ,
  76         "\x12\x80\x00\x00\x01\x98\x02\x80" "\x03\x12\x04\x01\x0b\x57\x0e\x61"
  77         "\x0f\x42\x11\x00\x12\x00\x13\x00" "\x14\x3a\x16\x24\x17\x1b\x18\xbb"
  78         "\x19\x01\x1a\x81\x1e\x04\x24\x3c" "\x25\x36\x26\x72\x27\x08\x28\x08"
  79         "\x29\x15\x2a\x00\x2b\x00\x2c\x08"
  80         ,
  81         "\x32\xa4\x33\x00\x34\x3d\x35\x00" "\x36\xf8\x38\x72\x39\x57\x3a\x00"
  82         "\x3b\x0c\x3d\x99\x3e\x0c\x3f\xc2" "\x40\xc0\x41\x00\x42\xc0\x43\x0a"
  83         "\x44\xf0\x45\x46\x46\x62\x47\x2a" "\x48\x3c\x4a\xec\x4b\xe8\x4c\xe8"
  84         "\x4d\xe8\x4e\xe8"
  85         ,
  86         "\x4f\x98\x50\x98\x51\x00\x52\x28" "\x53\x70\x54\x98\x58\x1a\x59\x85"
  87         "\x5a\xa9\x5b\x64\x5c\x84\x5d\x53" "\x5e\x0e\x5f\xf0\x60\xf0\x61\xf0"
  88         "\x62\x00\x63\x00\x64\x02\x65\x20" "\x66\x00\x69\x02\x6b\x5a\x6c\x04"
  89         "\x6d\x55\x6e\x00\x6f\x9d"
  90         ,
  91         "\x70\x08\x71\x78\x72\x00\x73\x01" "\x74\x3a\x75\x35\x76\x01\x77\x02"
  92         "\x7a\x24\x7b\x04\x7c\x07\x7d\x10" "\x7e\x28\x7f\x36\x80\x44\x81\x52"
  93         "\x82\x60\x83\x6c\x84\x78\x85\x8c" "\x86\x9e\x87\xbb\x88\xd2\x89\xe5"
  94         "\x8a\x23\x8c\x0d\x90\x90\x91\x90"
  95         ,
  96         "\x9d\x02\x9e\x02\x9f\x94\xa0\x94" "\xa1\x01\xa4\x50\xa5\x68\xa6\x70"
  97         "\xa8\xc1\xa9\xef\xaa\x92\xab\x04" "\xac\x80\xad\x80\xae\x80\xaf\x80"
  98         "\xb2\xf2\xb3\x20\xb4\x20\xb5\x00" "\xb6\xaf"
  99         ,
 100         "\xbb\xae\xbc\x38\xbd\x39\xbe\x01" "\xbf\x01\xc0\xe2\xc1\xc0\xc2\x01"
 101         "\xc3\x4e\xc6\x85\xc7\x81\xc9\xe0" "\xca\xe8\xcb\xf0\xcc\xd8\xcd\x93"
 102         ,
 103         "\xd0\x21\xd1\x18\xd2\xe0\xd3\x01" "\xd4\x28\xd5\x00"
 104 };
 105
 106 static u8 c04[] = {0x04};
 107 static u8 dat_post_1[] = "\x04\x00\x10\x20\xa1\x00\x00\x02";
 108 static u8 dat_post_2[] = "\x10\x10\xc1\x02";
 109 static u8 dat_post_3[] = "\x04\x00\x10\x7c\xa1\x00\x00\x04";
 110 static u8 dat_post_4[] = "\x10\x02\xc1\x06";
 111 static u8 dat_post_5[] = "\x04\x00\x10\x7b\xa1\x00\x00\x08";
 112 static u8 dat_post_6[] = "\x10\x10\xc1\x05";
 113 static u8 dat_post_7[] = "\x04\x00\x10\x7c\xa1\x00\x00\x08";
 114 static u8 dat_post_8[] = "\x04\x00\x10\x7c\xa1\x00\x00\x09";
 115
 116 static struct validx tbl_init_post_alt[] = {
 117         {0x6032, 0x00ff}, {0x6032, 0x00ff}, {0x6032, 0x00ff}, {0x603c, 0x00ff},
 118         {0x6003, 0x00ff}, {0x6032, 0x00ff}, {0x6032, 0x00ff}, {0x6001, 0x00ff},
 119         {0x6000, 0x801e},
 120         {0xffff, 0xffff},
 121         {0x6004, 0x001e}, {0x6000, 0x801e},
 122         {0xffff, 0xffff},
 123         {0x6004, 0x001e}, {0x6012, 0x0003}, {0x6000, 0x801e},
 124         {0xffff, 0xffff},
 125         {0x6004, 0x001e}, {0x6000, 0x801e},
 126         {0xffff, 0xffff},
 127         {0x6004, 0x001e}, {0x6012, 0x0003},
 128         {0xffff, 0xffff},
 129         {0x6000, 0x801e},
 130         {0xffff, 0xffff},
 131         {0x6004, 0x001e}, {0x6000, 0x801e},
 132         {0xffff, 0xffff},
 133         {0x6004, 0x001e}, {0x6012, 0x0003}, {0x6000, 0x801e},
 134         {0xffff, 0xffff},
 135         {0x6004, 0x001e}, {0x6000, 0x801e},
 136         {0xffff, 0xffff},
 137         {0x6004, 0x001e}, {0x6012, 0x0003},
 138         {0xffff, 0xffff},
 139         {0x6000, 0x801e},
 140         {0xffff, 0xffff},
 141         {0x6004, 0x001e}, {0x6000, 0x801e},
 142         {0xffff, 0xffff},
 143         {0x6004, 0x001e}, {0x6012, 0x0003},
 144 };
 145
 146 static int  ov9655_init_at_startup(struct gspca_dev *gspca_dev);
 147 static int  ov9655_configure_alt(struct gspca_dev *gspca_dev);
 148 static int  ov9655_init_pre_alt(struct gspca_dev *gspca_dev);
 149 static int  ov9655_init_post_alt(struct gspca_dev *gspca_dev);
 150 static void ov9655_post_unset_alt(struct gspca_dev *gspca_dev);
 151 static int  ov9655_camera_settings(struct gspca_dev *gspca_dev);
 152 /*==========================================================================*/
 153
 154 void ov9655_init_settings(struct gspca_dev *gspca_dev)
 155 {
 156         struct sd *sd = (struct sd *) gspca_dev;
 157
 158         sd->vcur.backlight  =   0;
 159         sd->vcur.brightness = 128;
 160         sd->vcur.sharpness  =   0;
 161         sd->vcur.contrast   =   0;
 162         sd->vcur.gamma      =   0;
 163         sd->vcur.hue        =   0;
 164         sd->vcur.saturation =   0;
 165         sd->vcur.whitebal   =   0;
 166
 167         sd->vmax.backlight  =   0;
 168         sd->vmax.brightness = 255;
 169         sd->vmax.sharpness  =   0;
 170         sd->vmax.contrast   =   0;
 171         sd->vmax.gamma      =   0;
 172         sd->vmax.hue        =   0 + 1;
 173         sd->vmax.saturation =   0;
 174         sd->vmax.whitebal   =   0;
 175         sd->vmax.mirror     = 0;
 176         sd->vmax.flip       = 0;
 177         sd->vmax.AC50Hz     = 0;
 178
 179         sd->dev_camera_settings = ov9655_camera_settings;
 180         sd->dev_init_at_startup = ov9655_init_at_startup;
 181         sd->dev_configure_alt   = ov9655_configure_alt;
 182         sd->dev_init_pre_alt    = ov9655_init_pre_alt;
 183         sd->dev_post_unset_alt  = ov9655_post_unset_alt;
 184 }
 185
 186 /*==========================================================================*/
 187
 188 static int ov9655_init_at_startup(struct gspca_dev *gspca_dev)
 189 {
 190         fetch_validx(gspca_dev, tbl_init_at_startup,
 191                         ARRAY_SIZE(tbl_init_at_startup));
 192         fetch_validx(gspca_dev, tbl_commmon, ARRAY_SIZE(tbl_commmon));
 193 /*      ctrl_out(gspca_dev, 0x40, 11, 0x0000, 0x0000, 0, NULL);*/
 194
 195         return 0;
 196 }
 197
 198 static int ov9655_init_pre_alt(struct gspca_dev *gspca_dev)
 199 {
 200         struct sd *sd = (struct sd *) gspca_dev;
 201
 202         sd->vold.brightness = -1;
 203         sd->vold.hue = -1;
 204
 205         fetch_validx(gspca_dev, tbl_commmon, ARRAY_SIZE(tbl_commmon));
 206
 207         ov9655_init_post_alt(gspca_dev);
 208
 209         return 0;
 210 }
 211
 212 static int ov9655_init_post_alt(struct gspca_dev *gspca_dev)
 213 {
 214         s32 reso = gspca_dev->cam.cam_mode[(s32) gspca_dev->curr_mode].priv;
 215         s32 n; /* reserved for FETCH macros */
 216         s32 i;
 217         u8 **tbl;
 218
 219         ctrl_out(gspca_dev, 0x40, 5, 0x0001, 0x0000, 0, NULL);
 220
 221         tbl = (reso == IMAGE_640) ? tbl_640 : tbl_800;
 222
 223         ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200,
 224                         tbl_length[0], tbl[0]);
 225         for (i = 1; i < 7; i++)
 226                 ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200,
 227                                 tbl_length[i], tbl[i]);
 228         ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200,
 229                         tbl_length[7], tbl[7]);
 230
 231         n = fetch_validx(gspca_dev, tbl_init_post_alt,
 232                         ARRAY_SIZE(tbl_init_post_alt));
 233
 234         ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);
 235         keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,
 236                                         ARRAY_SIZE(tbl_init_post_alt), n);
 237         ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);
 238         keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,
 239                                         ARRAY_SIZE(tbl_init_post_alt), n);
 240         ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);
 241         keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,
 242                                         ARRAY_SIZE(tbl_init_post_alt), n);
 243         ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);
 244         keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,
 245                                         ARRAY_SIZE(tbl_init_post_alt), n);
 246         ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post_1);
 247         keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,
 248                                         ARRAY_SIZE(tbl_init_post_alt), n);
 249
 250         ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);
 251         keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,
 252                                         ARRAY_SIZE(tbl_init_post_alt), n);
 253         ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);
 254         keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,
 255                                         ARRAY_SIZE(tbl_init_post_alt), n);
 256         ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);
 257         keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,
 258                                         ARRAY_SIZE(tbl_init_post_alt), n);
 259         ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);
 260         keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,
 261                                         ARRAY_SIZE(tbl_init_post_alt), n);
 262         ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post_1);
 263         keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,
 264                                         ARRAY_SIZE(tbl_init_post_alt), n);
 265
 266         ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);
 267         keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,
 268                                         ARRAY_SIZE(tbl_init_post_alt), n);
 269         ctrl_in(gspca_dev, 0xc0, 2, 0x6000, 0x801e, 1, c04);
 270         keep_on_fetching_validx(gspca_dev, tbl_init_post_alt,
 271                                         ARRAY_SIZE(tbl_init_post_alt), n);
 272
 273         ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post_1);
 274
 275         ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, 4, dat_post_2);
 276         ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post_3);
 277
 278         ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, 4, dat_post_4);
 279         ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post_5);
 280
 281         ctrl_out(gspca_dev, 0x40, 3, 0x0000, 0x0200, 4, dat_post_6);
 282         ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post_7);
 283
 284         ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_post_8);
 285
 286         ov9655_camera_settings(gspca_dev);
 287
 288         return 0;
 289 }
 290
 291 static int ov9655_configure_alt(struct gspca_dev *gspca_dev)
 292 {
 293         s32 reso = gspca_dev->cam.cam_mode[(s32) gspca_dev->curr_mode].priv;
 294
 295         switch (reso) {
 296         case IMAGE_640:
 297                 gspca_dev->alt = 1 + 1;
 298                 break;
 299
 300         default:
 301                 gspca_dev->alt = 1 + 1;
 302                 break;
 303         }
 304         return 0;
 305 }
 306
 307 static int ov9655_camera_settings(struct gspca_dev *gspca_dev)
 308 {
 309         struct sd *sd = (struct sd *) gspca_dev;
 310
 311         u8 dat_bright[] = "\x04\x00\x10\x7c\xa1\x00\x00\x70";
 312
 313         s32 bright = sd->vcur.brightness;
 314         s32 hue    = sd->vcur.hue;
 315
 316         if (bright != sd->vold.brightness) {
 317                 sd->vold.brightness = bright;
 318                 if (bright < 0 || bright > sd->vmax.brightness)
 319                         bright = 0;
 320
 321                 dat_bright[3] = bright;
 322                 ctrl_out(gspca_dev, 0x40, 3, 0x6000, 0x0200, 8, dat_bright);
 323         }
 324
 325         if (hue != sd->vold.hue) {
 326                 sd->vold.hue = hue;
 327                 sd->swapRB = (hue != 0);
 328         }
 329
 330         return 0;
 331 }
 332
 333 static void ov9655_post_unset_alt(struct gspca_dev *gspca_dev)
 334 {
 335         ctrl_out(gspca_dev, 0x40, 5, 0x0000, 0x0000, 0, NULL);
 336         ctrl_out(gspca_dev, 0x40, 1, 0x0061, 0x0000, 0, NULL);
 337 }