Merge git://git.kernel.org/pub/scm/linux/kernel/git/brodo/pcmcia-2.6
[linux-2.6] / drivers / media / video / gspca / ov519.c
1 /**
2  * OV519 driver
3  *
4  * Copyright (C) 2008 Jean-Francois Moine (http://moinejf.free.fr)
5  *
6  * (This module is adapted from the ov51x-jpeg package)
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License as published by
10  * the Free Software Foundation; either version 2 of the License, or
11  * any later version.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21  *
22  */
23 #define MODULE_NAME "ov519"
24
25 #include "gspca.h"
26
27 MODULE_AUTHOR("Jean-Francois Moine <http://moinejf.free.fr>");
28 MODULE_DESCRIPTION("OV519 USB Camera Driver");
29 MODULE_LICENSE("GPL");
30
31 /* global parameters */
32 static int frame_rate;
33
34 /* Number of times to retry a failed I2C transaction. Increase this if you
35  * are getting "Failed to read sensor ID..." */
36 static int i2c_detect_tries = 10;
37
38 /* ov519 device descriptor */
39 struct sd {
40         struct gspca_dev gspca_dev;             /* !! must be the first item */
41
42         /* Determined by sensor type */
43         char sif;
44
45         unsigned char primary_i2c_slave;        /* I2C write id of sensor */
46
47         unsigned char brightness;
48         unsigned char contrast;
49         unsigned char colors;
50         __u8 hflip;
51         __u8 vflip;
52
53         char compress;          /* Should the next frame be compressed? */
54         char compress_inited;   /* Are compression params uploaded? */
55         char stopped;           /* Streaming is temporarily paused */
56
57         char frame_rate;        /* current Framerate (OV519 only) */
58         char clockdiv;          /* clockdiv override for OV519 only */
59
60         char sensor;            /* Type of image sensor chip (SEN_*) */
61 #define SEN_UNKNOWN 0
62 #define SEN_OV6620 1
63 #define SEN_OV6630 2
64 #define SEN_OV7610 3
65 #define SEN_OV7620 4
66 #define SEN_OV7640 5
67 #define SEN_OV7670 6
68 #define SEN_OV76BE 7
69 #define SEN_OV8610 8
70
71 };
72
73 /* V4L2 controls supported by the driver */
74 static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val);
75 static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val);
76 static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val);
77 static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val);
78 static int sd_setcolors(struct gspca_dev *gspca_dev, __s32 val);
79 static int sd_getcolors(struct gspca_dev *gspca_dev, __s32 *val);
80 static int sd_sethflip(struct gspca_dev *gspca_dev, __s32 val);
81 static int sd_gethflip(struct gspca_dev *gspca_dev, __s32 *val);
82 static int sd_setvflip(struct gspca_dev *gspca_dev, __s32 val);
83 static int sd_getvflip(struct gspca_dev *gspca_dev, __s32 *val);
84
85 static struct ctrl sd_ctrls[] = {
86         {
87             {
88                 .id      = V4L2_CID_BRIGHTNESS,
89                 .type    = V4L2_CTRL_TYPE_INTEGER,
90                 .name    = "Brightness",
91                 .minimum = 0,
92                 .maximum = 255,
93                 .step    = 1,
94 #define BRIGHTNESS_DEF 127
95                 .default_value = BRIGHTNESS_DEF,
96             },
97             .set = sd_setbrightness,
98             .get = sd_getbrightness,
99         },
100         {
101             {
102                 .id      = V4L2_CID_CONTRAST,
103                 .type    = V4L2_CTRL_TYPE_INTEGER,
104                 .name    = "Contrast",
105                 .minimum = 0,
106                 .maximum = 255,
107                 .step    = 1,
108 #define CONTRAST_DEF 127
109                 .default_value = CONTRAST_DEF,
110             },
111             .set = sd_setcontrast,
112             .get = sd_getcontrast,
113         },
114         {
115             {
116                 .id      = V4L2_CID_SATURATION,
117                 .type    = V4L2_CTRL_TYPE_INTEGER,
118                 .name    = "Color",
119                 .minimum = 0,
120                 .maximum = 255,
121                 .step    = 1,
122 #define COLOR_DEF 127
123                 .default_value = COLOR_DEF,
124             },
125             .set = sd_setcolors,
126             .get = sd_getcolors,
127         },
128 /* next controls work with ov7670 only */
129 #define HFLIP_IDX 3
130         {
131             {
132                 .id      = V4L2_CID_HFLIP,
133                 .type    = V4L2_CTRL_TYPE_BOOLEAN,
134                 .name    = "Mirror",
135                 .minimum = 0,
136                 .maximum = 1,
137                 .step    = 1,
138 #define HFLIP_DEF 0
139                 .default_value = HFLIP_DEF,
140             },
141             .set = sd_sethflip,
142             .get = sd_gethflip,
143         },
144 #define VFLIP_IDX 4
145         {
146             {
147                 .id      = V4L2_CID_VFLIP,
148                 .type    = V4L2_CTRL_TYPE_BOOLEAN,
149                 .name    = "Vflip",
150                 .minimum = 0,
151                 .maximum = 1,
152                 .step    = 1,
153 #define VFLIP_DEF 0
154                 .default_value = VFLIP_DEF,
155             },
156             .set = sd_setvflip,
157             .get = sd_getvflip,
158         },
159 };
160
161 static struct v4l2_pix_format vga_mode[] = {
162         {320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
163                 .bytesperline = 320,
164                 .sizeimage = 320 * 240 * 3 / 8 + 590,
165                 .colorspace = V4L2_COLORSPACE_JPEG,
166                 .priv = 1},
167         {640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
168                 .bytesperline = 640,
169                 .sizeimage = 640 * 480 * 3 / 8 + 590,
170                 .colorspace = V4L2_COLORSPACE_JPEG,
171                 .priv = 0},
172 };
173 static struct v4l2_pix_format sif_mode[] = {
174         {176, 144, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
175                 .bytesperline = 176,
176                 .sizeimage = 176 * 144 * 3 / 8 + 590,
177                 .colorspace = V4L2_COLORSPACE_JPEG,
178                 .priv = 1},
179         {352, 288, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
180                 .bytesperline = 352,
181                 .sizeimage = 352 * 288 * 3 / 8 + 590,
182                 .colorspace = V4L2_COLORSPACE_JPEG,
183                 .priv = 0},
184 };
185
186 /* OV519 Camera interface register numbers */
187 #define OV519_CAM_H_SIZE                0x10
188 #define OV519_CAM_V_SIZE                0x11
189 #define OV519_CAM_X_OFFSETL             0x12
190 #define OV519_CAM_X_OFFSETH             0x13
191 #define OV519_CAM_Y_OFFSETL             0x14
192 #define OV519_CAM_Y_OFFSETH             0x15
193 #define OV519_CAM_DIVIDER               0x16
194 #define OV519_CAM_DFR                   0x20
195 #define OV519_CAM_FORMAT                0x25
196
197 /* OV519 System Controller register numbers */
198 #define OV519_SYS_RESET1 0x51
199 #define OV519_SYS_EN_CLK1 0x54
200
201 #define OV519_GPIO_DATA_OUT0            0x71
202 #define OV519_GPIO_IO_CTRL0             0x72
203
204 #define OV511_ENDPOINT_ADDRESS  1       /* Isoc endpoint number */
205
206 /* I2C registers */
207 #define R51x_I2C_W_SID          0x41
208 #define R51x_I2C_SADDR_3        0x42
209 #define R51x_I2C_SADDR_2        0x43
210 #define R51x_I2C_R_SID          0x44
211 #define R51x_I2C_DATA           0x45
212 #define R518_I2C_CTL            0x47    /* OV518(+) only */
213
214 /* I2C ADDRESSES */
215 #define OV7xx0_SID   0x42
216 #define OV8xx0_SID   0xa0
217 #define OV6xx0_SID   0xc0
218
219 /* OV7610 registers */
220 #define OV7610_REG_GAIN         0x00    /* gain setting (5:0) */
221 #define OV7610_REG_SAT          0x03    /* saturation */
222 #define OV8610_REG_HUE          0x04    /* 04 reserved */
223 #define OV7610_REG_CNT          0x05    /* Y contrast */
224 #define OV7610_REG_BRT          0x06    /* Y brightness */
225 #define OV7610_REG_COM_C        0x14    /* misc common regs */
226 #define OV7610_REG_ID_HIGH      0x1c    /* manufacturer ID MSB */
227 #define OV7610_REG_ID_LOW       0x1d    /* manufacturer ID LSB */
228 #define OV7610_REG_COM_I        0x29    /* misc settings */
229
230 /* OV7670 registers */
231 #define OV7670_REG_GAIN        0x00    /* Gain lower 8 bits (rest in vref) */
232 #define OV7670_REG_BLUE        0x01    /* blue gain */
233 #define OV7670_REG_RED         0x02    /* red gain */
234 #define OV7670_REG_VREF        0x03    /* Pieces of GAIN, VSTART, VSTOP */
235 #define OV7670_REG_COM1        0x04    /* Control 1 */
236 #define OV7670_REG_AECHH       0x07    /* AEC MS 5 bits */
237 #define OV7670_REG_COM3        0x0c    /* Control 3 */
238 #define OV7670_REG_COM4        0x0d    /* Control 4 */
239 #define OV7670_REG_COM5        0x0e    /* All "reserved" */
240 #define OV7670_REG_COM6        0x0f    /* Control 6 */
241 #define OV7670_REG_AECH        0x10    /* More bits of AEC value */
242 #define OV7670_REG_CLKRC       0x11    /* Clock control */
243 #define OV7670_REG_COM7        0x12    /* Control 7 */
244 #define   OV7670_COM7_FMT_VGA    0x00
245 #define   OV7670_COM7_YUV        0x00    /* YUV */
246 #define   OV7670_COM7_FMT_QVGA   0x10    /* QVGA format */
247 #define   OV7670_COM7_FMT_MASK   0x38
248 #define   OV7670_COM7_RESET      0x80    /* Register reset */
249 #define OV7670_REG_COM8        0x13    /* Control 8 */
250 #define   OV7670_COM8_AEC        0x01    /* Auto exposure enable */
251 #define   OV7670_COM8_AWB        0x02    /* White balance enable */
252 #define   OV7670_COM8_AGC        0x04    /* Auto gain enable */
253 #define   OV7670_COM8_BFILT      0x20    /* Band filter enable */
254 #define   OV7670_COM8_AECSTEP    0x40    /* Unlimited AEC step size */
255 #define   OV7670_COM8_FASTAEC    0x80    /* Enable fast AGC/AEC */
256 #define OV7670_REG_COM9        0x14    /* Control 9  - gain ceiling */
257 #define OV7670_REG_COM10       0x15    /* Control 10 */
258 #define OV7670_REG_HSTART      0x17    /* Horiz start high bits */
259 #define OV7670_REG_HSTOP       0x18    /* Horiz stop high bits */
260 #define OV7670_REG_VSTART      0x19    /* Vert start high bits */
261 #define OV7670_REG_VSTOP       0x1a    /* Vert stop high bits */
262 #define OV7670_REG_MVFP        0x1e    /* Mirror / vflip */
263 #define   OV7670_MVFP_VFLIP      0x10    /* vertical flip */
264 #define   OV7670_MVFP_MIRROR     0x20    /* Mirror image */
265 #define OV7670_REG_AEW         0x24    /* AGC upper limit */
266 #define OV7670_REG_AEB         0x25    /* AGC lower limit */
267 #define OV7670_REG_VPT         0x26    /* AGC/AEC fast mode op region */
268 #define OV7670_REG_HREF        0x32    /* HREF pieces */
269 #define OV7670_REG_TSLB        0x3a    /* lots of stuff */
270 #define OV7670_REG_COM11       0x3b    /* Control 11 */
271 #define   OV7670_COM11_EXP       0x02
272 #define   OV7670_COM11_HZAUTO    0x10    /* Auto detect 50/60 Hz */
273 #define OV7670_REG_COM12       0x3c    /* Control 12 */
274 #define OV7670_REG_COM13       0x3d    /* Control 13 */
275 #define   OV7670_COM13_GAMMA     0x80    /* Gamma enable */
276 #define   OV7670_COM13_UVSAT     0x40    /* UV saturation auto adjustment */
277 #define OV7670_REG_COM14       0x3e    /* Control 14 */
278 #define OV7670_REG_EDGE        0x3f    /* Edge enhancement factor */
279 #define OV7670_REG_COM15       0x40    /* Control 15 */
280 #define   OV7670_COM15_R00FF     0xc0    /*            00 to FF */
281 #define OV7670_REG_COM16       0x41    /* Control 16 */
282 #define   OV7670_COM16_AWBGAIN   0x08    /* AWB gain enable */
283 #define OV7670_REG_BRIGHT      0x55    /* Brightness */
284 #define OV7670_REG_CONTRAS     0x56    /* Contrast control */
285 #define OV7670_REG_GFIX        0x69    /* Fix gain control */
286 #define OV7670_REG_RGB444      0x8c    /* RGB 444 control */
287 #define OV7670_REG_HAECC1      0x9f    /* Hist AEC/AGC control 1 */
288 #define OV7670_REG_HAECC2      0xa0    /* Hist AEC/AGC control 2 */
289 #define OV7670_REG_BD50MAX     0xa5    /* 50hz banding step limit */
290 #define OV7670_REG_HAECC3      0xa6    /* Hist AEC/AGC control 3 */
291 #define OV7670_REG_HAECC4      0xa7    /* Hist AEC/AGC control 4 */
292 #define OV7670_REG_HAECC5      0xa8    /* Hist AEC/AGC control 5 */
293 #define OV7670_REG_HAECC6      0xa9    /* Hist AEC/AGC control 6 */
294 #define OV7670_REG_HAECC7      0xaa    /* Hist AEC/AGC control 7 */
295 #define OV7670_REG_BD60MAX     0xab    /* 60hz banding step limit */
296
297 struct ov_regvals {
298         __u8 reg;
299         __u8 val;
300 };
301 struct ov_i2c_regvals {
302         __u8 reg;
303         __u8 val;
304 };
305
306 static const struct ov_i2c_regvals norm_6x20[] = {
307         { 0x12, 0x80 }, /* reset */
308         { 0x11, 0x01 },
309         { 0x03, 0x60 },
310         { 0x05, 0x7f }, /* For when autoadjust is off */
311         { 0x07, 0xa8 },
312         /* The ratio of 0x0c and 0x0d  controls the white point */
313         { 0x0c, 0x24 },
314         { 0x0d, 0x24 },
315         { 0x0f, 0x15 }, /* COMS */
316         { 0x10, 0x75 }, /* AEC Exposure time */
317         { 0x12, 0x24 }, /* Enable AGC */
318         { 0x14, 0x04 },
319         /* 0x16: 0x06 helps frame stability with moving objects */
320         { 0x16, 0x06 },
321 /*      { 0x20, 0x30 },  * Aperture correction enable */
322         { 0x26, 0xb2 }, /* BLC enable */
323         /* 0x28: 0x05 Selects RGB format if RGB on */
324         { 0x28, 0x05 },
325         { 0x2a, 0x04 }, /* Disable framerate adjust */
326 /*      { 0x2b, 0xac },  * Framerate; Set 2a[7] first */
327         { 0x2d, 0x99 },
328         { 0x33, 0xa0 }, /* Color Processing Parameter */
329         { 0x34, 0xd2 }, /* Max A/D range */
330         { 0x38, 0x8b },
331         { 0x39, 0x40 },
332
333         { 0x3c, 0x39 }, /* Enable AEC mode changing */
334         { 0x3c, 0x3c }, /* Change AEC mode */
335         { 0x3c, 0x24 }, /* Disable AEC mode changing */
336
337         { 0x3d, 0x80 },
338         /* These next two registers (0x4a, 0x4b) are undocumented.
339          * They control the color balance */
340         { 0x4a, 0x80 },
341         { 0x4b, 0x80 },
342         { 0x4d, 0xd2 }, /* This reduces noise a bit */
343         { 0x4e, 0xc1 },
344         { 0x4f, 0x04 },
345 /* Do 50-53 have any effect? */
346 /* Toggle 0x12[2] off and on here? */
347 };
348
349 static const struct ov_i2c_regvals norm_6x30[] = {
350         { 0x12, 0x80 }, /* Reset */
351         { 0x00, 0x1f }, /* Gain */
352         { 0x01, 0x99 }, /* Blue gain */
353         { 0x02, 0x7c }, /* Red gain */
354         { 0x03, 0xc0 }, /* Saturation */
355         { 0x05, 0x0a }, /* Contrast */
356         { 0x06, 0x95 }, /* Brightness */
357         { 0x07, 0x2d }, /* Sharpness */
358         { 0x0c, 0x20 },
359         { 0x0d, 0x20 },
360         { 0x0e, 0x20 },
361         { 0x0f, 0x05 },
362         { 0x10, 0x9a },
363         { 0x11, 0x00 }, /* Pixel clock = fastest */
364         { 0x12, 0x24 }, /* Enable AGC and AWB */
365         { 0x13, 0x21 },
366         { 0x14, 0x80 },
367         { 0x15, 0x01 },
368         { 0x16, 0x03 },
369         { 0x17, 0x38 },
370         { 0x18, 0xea },
371         { 0x19, 0x04 },
372         { 0x1a, 0x93 },
373         { 0x1b, 0x00 },
374         { 0x1e, 0xc4 },
375         { 0x1f, 0x04 },
376         { 0x20, 0x20 },
377         { 0x21, 0x10 },
378         { 0x22, 0x88 },
379         { 0x23, 0xc0 }, /* Crystal circuit power level */
380         { 0x25, 0x9a }, /* Increase AEC black ratio */
381         { 0x26, 0xb2 }, /* BLC enable */
382         { 0x27, 0xa2 },
383         { 0x28, 0x00 },
384         { 0x29, 0x00 },
385         { 0x2a, 0x84 }, /* 60 Hz power */
386         { 0x2b, 0xa8 }, /* 60 Hz power */
387         { 0x2c, 0xa0 },
388         { 0x2d, 0x95 }, /* Enable auto-brightness */
389         { 0x2e, 0x88 },
390         { 0x33, 0x26 },
391         { 0x34, 0x03 },
392         { 0x36, 0x8f },
393         { 0x37, 0x80 },
394         { 0x38, 0x83 },
395         { 0x39, 0x80 },
396         { 0x3a, 0x0f },
397         { 0x3b, 0x3c },
398         { 0x3c, 0x1a },
399         { 0x3d, 0x80 },
400         { 0x3e, 0x80 },
401         { 0x3f, 0x0e },
402         { 0x40, 0x00 }, /* White bal */
403         { 0x41, 0x00 }, /* White bal */
404         { 0x42, 0x80 },
405         { 0x43, 0x3f }, /* White bal */
406         { 0x44, 0x80 },
407         { 0x45, 0x20 },
408         { 0x46, 0x20 },
409         { 0x47, 0x80 },
410         { 0x48, 0x7f },
411         { 0x49, 0x00 },
412         { 0x4a, 0x00 },
413         { 0x4b, 0x80 },
414         { 0x4c, 0xd0 },
415         { 0x4d, 0x10 }, /* U = 0.563u, V = 0.714v */
416         { 0x4e, 0x40 },
417         { 0x4f, 0x07 }, /* UV avg., col. killer: max */
418         { 0x50, 0xff },
419         { 0x54, 0x23 }, /* Max AGC gain: 18dB */
420         { 0x55, 0xff },
421         { 0x56, 0x12 },
422         { 0x57, 0x81 },
423         { 0x58, 0x75 },
424         { 0x59, 0x01 }, /* AGC dark current comp.: +1 */
425         { 0x5a, 0x2c },
426         { 0x5b, 0x0f }, /* AWB chrominance levels */
427         { 0x5c, 0x10 },
428         { 0x3d, 0x80 },
429         { 0x27, 0xa6 },
430         { 0x12, 0x20 }, /* Toggle AWB */
431         { 0x12, 0x24 },
432 };
433
434 /* Lawrence Glaister <lg@jfm.bc.ca> reports:
435  *
436  * Register 0x0f in the 7610 has the following effects:
437  *
438  * 0x85 (AEC method 1): Best overall, good contrast range
439  * 0x45 (AEC method 2): Very overexposed
440  * 0xa5 (spec sheet default): Ok, but the black level is
441  *      shifted resulting in loss of contrast
442  * 0x05 (old driver setting): very overexposed, too much
443  *      contrast
444  */
445 static const struct ov_i2c_regvals norm_7610[] = {
446         { 0x10, 0xff },
447         { 0x16, 0x06 },
448         { 0x28, 0x24 },
449         { 0x2b, 0xac },
450         { 0x12, 0x00 },
451         { 0x38, 0x81 },
452         { 0x28, 0x24 }, /* 0c */
453         { 0x0f, 0x85 }, /* lg's setting */
454         { 0x15, 0x01 },
455         { 0x20, 0x1c },
456         { 0x23, 0x2a },
457         { 0x24, 0x10 },
458         { 0x25, 0x8a },
459         { 0x26, 0xa2 },
460         { 0x27, 0xc2 },
461         { 0x2a, 0x04 },
462         { 0x2c, 0xfe },
463         { 0x2d, 0x93 },
464         { 0x30, 0x71 },
465         { 0x31, 0x60 },
466         { 0x32, 0x26 },
467         { 0x33, 0x20 },
468         { 0x34, 0x48 },
469         { 0x12, 0x24 },
470         { 0x11, 0x01 },
471         { 0x0c, 0x24 },
472         { 0x0d, 0x24 },
473 };
474
475 static const struct ov_i2c_regvals norm_7620[] = {
476         { 0x00, 0x00 },         /* gain */
477         { 0x01, 0x80 },         /* blue gain */
478         { 0x02, 0x80 },         /* red gain */
479         { 0x03, 0xc0 },         /* OV7670_REG_VREF */
480         { 0x06, 0x60 },
481         { 0x07, 0x00 },
482         { 0x0c, 0x24 },
483         { 0x0c, 0x24 },
484         { 0x0d, 0x24 },
485         { 0x11, 0x01 },
486         { 0x12, 0x24 },
487         { 0x13, 0x01 },
488         { 0x14, 0x84 },
489         { 0x15, 0x01 },
490         { 0x16, 0x03 },
491         { 0x17, 0x2f },
492         { 0x18, 0xcf },
493         { 0x19, 0x06 },
494         { 0x1a, 0xf5 },
495         { 0x1b, 0x00 },
496         { 0x20, 0x18 },
497         { 0x21, 0x80 },
498         { 0x22, 0x80 },
499         { 0x23, 0x00 },
500         { 0x26, 0xa2 },
501         { 0x27, 0xea },
502         { 0x28, 0x20 },
503         { 0x29, 0x00 },
504         { 0x2a, 0x10 },
505         { 0x2b, 0x00 },
506         { 0x2c, 0x88 },
507         { 0x2d, 0x91 },
508         { 0x2e, 0x80 },
509         { 0x2f, 0x44 },
510         { 0x60, 0x27 },
511         { 0x61, 0x02 },
512         { 0x62, 0x5f },
513         { 0x63, 0xd5 },
514         { 0x64, 0x57 },
515         { 0x65, 0x83 },
516         { 0x66, 0x55 },
517         { 0x67, 0x92 },
518         { 0x68, 0xcf },
519         { 0x69, 0x76 },
520         { 0x6a, 0x22 },
521         { 0x6b, 0x00 },
522         { 0x6c, 0x02 },
523         { 0x6d, 0x44 },
524         { 0x6e, 0x80 },
525         { 0x6f, 0x1d },
526         { 0x70, 0x8b },
527         { 0x71, 0x00 },
528         { 0x72, 0x14 },
529         { 0x73, 0x54 },
530         { 0x74, 0x00 },
531         { 0x75, 0x8e },
532         { 0x76, 0x00 },
533         { 0x77, 0xff },
534         { 0x78, 0x80 },
535         { 0x79, 0x80 },
536         { 0x7a, 0x80 },
537         { 0x7b, 0xe2 },
538         { 0x7c, 0x00 },
539 };
540
541 /* 7640 and 7648. The defaults should be OK for most registers. */
542 static const struct ov_i2c_regvals norm_7640[] = {
543         { 0x12, 0x80 },
544         { 0x12, 0x14 },
545 };
546
547 /* 7670. Defaults taken from OmniVision provided data,
548 *  as provided by Jonathan Corbet of OLPC               */
549 static const struct ov_i2c_regvals norm_7670[] = {
550         { OV7670_REG_COM7, OV7670_COM7_RESET },
551         { OV7670_REG_TSLB, 0x04 },              /* OV */
552         { OV7670_REG_COM7, OV7670_COM7_FMT_VGA }, /* VGA */
553         { OV7670_REG_CLKRC, 0x01 },
554 /*
555  * Set the hardware window.  These values from OV don't entirely
556  * make sense - hstop is less than hstart.  But they work...
557  */
558         { OV7670_REG_HSTART, 0x13 },
559         { OV7670_REG_HSTOP, 0x01 },
560         { OV7670_REG_HREF, 0xb6 },
561         { OV7670_REG_VSTART, 0x02 },
562         { OV7670_REG_VSTOP, 0x7a },
563         { OV7670_REG_VREF, 0x0a },
564
565         { OV7670_REG_COM3, 0 },
566         { OV7670_REG_COM14, 0 },
567 /* Mystery scaling numbers */
568         { 0x70, 0x3a },
569         { 0x71, 0x35 },
570         { 0x72, 0x11 },
571         { 0x73, 0xf0 },
572         { 0xa2, 0x02 },
573 /*      { OV7670_REG_COM10, 0x0 }, */
574
575 /* Gamma curve values */
576         { 0x7a, 0x20 },
577         { 0x7b, 0x10 },
578         { 0x7c, 0x1e },
579         { 0x7d, 0x35 },
580         { 0x7e, 0x5a },
581         { 0x7f, 0x69 },
582         { 0x80, 0x76 },
583         { 0x81, 0x80 },
584         { 0x82, 0x88 },
585         { 0x83, 0x8f },
586         { 0x84, 0x96 },
587         { 0x85, 0xa3 },
588         { 0x86, 0xaf },
589         { 0x87, 0xc4 },
590         { 0x88, 0xd7 },
591         { 0x89, 0xe8 },
592
593 /* AGC and AEC parameters.  Note we start by disabling those features,
594    then turn them only after tweaking the values. */
595         { OV7670_REG_COM8, OV7670_COM8_FASTAEC
596                          | OV7670_COM8_AECSTEP
597                          | OV7670_COM8_BFILT },
598         { OV7670_REG_GAIN, 0 },
599         { OV7670_REG_AECH, 0 },
600         { OV7670_REG_COM4, 0x40 }, /* magic reserved bit */
601         { OV7670_REG_COM9, 0x18 }, /* 4x gain + magic rsvd bit */
602         { OV7670_REG_BD50MAX, 0x05 },
603         { OV7670_REG_BD60MAX, 0x07 },
604         { OV7670_REG_AEW, 0x95 },
605         { OV7670_REG_AEB, 0x33 },
606         { OV7670_REG_VPT, 0xe3 },
607         { OV7670_REG_HAECC1, 0x78 },
608         { OV7670_REG_HAECC2, 0x68 },
609         { 0xa1, 0x03 }, /* magic */
610         { OV7670_REG_HAECC3, 0xd8 },
611         { OV7670_REG_HAECC4, 0xd8 },
612         { OV7670_REG_HAECC5, 0xf0 },
613         { OV7670_REG_HAECC6, 0x90 },
614         { OV7670_REG_HAECC7, 0x94 },
615         { OV7670_REG_COM8, OV7670_COM8_FASTAEC
616                         | OV7670_COM8_AECSTEP
617                         | OV7670_COM8_BFILT
618                         | OV7670_COM8_AGC
619                         | OV7670_COM8_AEC },
620
621 /* Almost all of these are magic "reserved" values.  */
622         { OV7670_REG_COM5, 0x61 },
623         { OV7670_REG_COM6, 0x4b },
624         { 0x16, 0x02 },
625         { OV7670_REG_MVFP, 0x07 },
626         { 0x21, 0x02 },
627         { 0x22, 0x91 },
628         { 0x29, 0x07 },
629         { 0x33, 0x0b },
630         { 0x35, 0x0b },
631         { 0x37, 0x1d },
632         { 0x38, 0x71 },
633         { 0x39, 0x2a },
634         { OV7670_REG_COM12, 0x78 },
635         { 0x4d, 0x40 },
636         { 0x4e, 0x20 },
637         { OV7670_REG_GFIX, 0 },
638         { 0x6b, 0x4a },
639         { 0x74, 0x10 },
640         { 0x8d, 0x4f },
641         { 0x8e, 0 },
642         { 0x8f, 0 },
643         { 0x90, 0 },
644         { 0x91, 0 },
645         { 0x96, 0 },
646         { 0x9a, 0 },
647         { 0xb0, 0x84 },
648         { 0xb1, 0x0c },
649         { 0xb2, 0x0e },
650         { 0xb3, 0x82 },
651         { 0xb8, 0x0a },
652
653 /* More reserved magic, some of which tweaks white balance */
654         { 0x43, 0x0a },
655         { 0x44, 0xf0 },
656         { 0x45, 0x34 },
657         { 0x46, 0x58 },
658         { 0x47, 0x28 },
659         { 0x48, 0x3a },
660         { 0x59, 0x88 },
661         { 0x5a, 0x88 },
662         { 0x5b, 0x44 },
663         { 0x5c, 0x67 },
664         { 0x5d, 0x49 },
665         { 0x5e, 0x0e },
666         { 0x6c, 0x0a },
667         { 0x6d, 0x55 },
668         { 0x6e, 0x11 },
669         { 0x6f, 0x9f },
670                                         /* "9e for advance AWB" */
671         { 0x6a, 0x40 },
672         { OV7670_REG_BLUE, 0x40 },
673         { OV7670_REG_RED, 0x60 },
674         { OV7670_REG_COM8, OV7670_COM8_FASTAEC
675                         | OV7670_COM8_AECSTEP
676                         | OV7670_COM8_BFILT
677                         | OV7670_COM8_AGC
678                         | OV7670_COM8_AEC
679                         | OV7670_COM8_AWB },
680
681 /* Matrix coefficients */
682         { 0x4f, 0x80 },
683         { 0x50, 0x80 },
684         { 0x51, 0 },
685         { 0x52, 0x22 },
686         { 0x53, 0x5e },
687         { 0x54, 0x80 },
688         { 0x58, 0x9e },
689
690         { OV7670_REG_COM16, OV7670_COM16_AWBGAIN },
691         { OV7670_REG_EDGE, 0 },
692         { 0x75, 0x05 },
693         { 0x76, 0xe1 },
694         { 0x4c, 0 },
695         { 0x77, 0x01 },
696         { OV7670_REG_COM13, OV7670_COM13_GAMMA
697                           | OV7670_COM13_UVSAT
698                           | 2},         /* was 3 */
699         { 0x4b, 0x09 },
700         { 0xc9, 0x60 },
701         { OV7670_REG_COM16, 0x38 },
702         { 0x56, 0x40 },
703
704         { 0x34, 0x11 },
705         { OV7670_REG_COM11, OV7670_COM11_EXP|OV7670_COM11_HZAUTO },
706         { 0xa4, 0x88 },
707         { 0x96, 0 },
708         { 0x97, 0x30 },
709         { 0x98, 0x20 },
710         { 0x99, 0x30 },
711         { 0x9a, 0x84 },
712         { 0x9b, 0x29 },
713         { 0x9c, 0x03 },
714         { 0x9d, 0x4c },
715         { 0x9e, 0x3f },
716         { 0x78, 0x04 },
717
718 /* Extra-weird stuff.  Some sort of multiplexor register */
719         { 0x79, 0x01 },
720         { 0xc8, 0xf0 },
721         { 0x79, 0x0f },
722         { 0xc8, 0x00 },
723         { 0x79, 0x10 },
724         { 0xc8, 0x7e },
725         { 0x79, 0x0a },
726         { 0xc8, 0x80 },
727         { 0x79, 0x0b },
728         { 0xc8, 0x01 },
729         { 0x79, 0x0c },
730         { 0xc8, 0x0f },
731         { 0x79, 0x0d },
732         { 0xc8, 0x20 },
733         { 0x79, 0x09 },
734         { 0xc8, 0x80 },
735         { 0x79, 0x02 },
736         { 0xc8, 0xc0 },
737         { 0x79, 0x03 },
738         { 0xc8, 0x40 },
739         { 0x79, 0x05 },
740         { 0xc8, 0x30 },
741         { 0x79, 0x26 },
742 };
743
744 static const struct ov_i2c_regvals norm_8610[] = {
745         { 0x12, 0x80 },
746         { 0x00, 0x00 },
747         { 0x01, 0x80 },
748         { 0x02, 0x80 },
749         { 0x03, 0xc0 },
750         { 0x04, 0x30 },
751         { 0x05, 0x30 }, /* was 0x10, new from windrv 090403 */
752         { 0x06, 0x70 }, /* was 0x80, new from windrv 090403 */
753         { 0x0a, 0x86 },
754         { 0x0b, 0xb0 },
755         { 0x0c, 0x20 },
756         { 0x0d, 0x20 },
757         { 0x11, 0x01 },
758         { 0x12, 0x25 },
759         { 0x13, 0x01 },
760         { 0x14, 0x04 },
761         { 0x15, 0x01 }, /* Lin and Win think different about UV order */
762         { 0x16, 0x03 },
763         { 0x17, 0x38 }, /* was 0x2f, new from windrv 090403 */
764         { 0x18, 0xea }, /* was 0xcf, new from windrv 090403 */
765         { 0x19, 0x02 }, /* was 0x06, new from windrv 090403 */
766         { 0x1a, 0xf5 },
767         { 0x1b, 0x00 },
768         { 0x20, 0xd0 }, /* was 0x90, new from windrv 090403 */
769         { 0x23, 0xc0 }, /* was 0x00, new from windrv 090403 */
770         { 0x24, 0x30 }, /* was 0x1d, new from windrv 090403 */
771         { 0x25, 0x50 }, /* was 0x57, new from windrv 090403 */
772         { 0x26, 0xa2 },
773         { 0x27, 0xea },
774         { 0x28, 0x00 },
775         { 0x29, 0x00 },
776         { 0x2a, 0x80 },
777         { 0x2b, 0xc8 }, /* was 0xcc, new from windrv 090403 */
778         { 0x2c, 0xac },
779         { 0x2d, 0x45 }, /* was 0xd5, new from windrv 090403 */
780         { 0x2e, 0x80 },
781         { 0x2f, 0x14 }, /* was 0x01, new from windrv 090403 */
782         { 0x4c, 0x00 },
783         { 0x4d, 0x30 }, /* was 0x10, new from windrv 090403 */
784         { 0x60, 0x02 }, /* was 0x01, new from windrv 090403 */
785         { 0x61, 0x00 }, /* was 0x09, new from windrv 090403 */
786         { 0x62, 0x5f }, /* was 0xd7, new from windrv 090403 */
787         { 0x63, 0xff },
788         { 0x64, 0x53 }, /* new windrv 090403 says 0x57,
789                          * maybe thats wrong */
790         { 0x65, 0x00 },
791         { 0x66, 0x55 },
792         { 0x67, 0xb0 },
793         { 0x68, 0xc0 }, /* was 0xaf, new from windrv 090403 */
794         { 0x69, 0x02 },
795         { 0x6a, 0x22 },
796         { 0x6b, 0x00 },
797         { 0x6c, 0x99 }, /* was 0x80, old windrv says 0x00, but
798                          * deleting bit7 colors the first images red */
799         { 0x6d, 0x11 }, /* was 0x00, new from windrv 090403 */
800         { 0x6e, 0x11 }, /* was 0x00, new from windrv 090403 */
801         { 0x6f, 0x01 },
802         { 0x70, 0x8b },
803         { 0x71, 0x00 },
804         { 0x72, 0x14 },
805         { 0x73, 0x54 },
806         { 0x74, 0x00 },/* 0x60? - was 0x00, new from windrv 090403 */
807         { 0x75, 0x0e },
808         { 0x76, 0x02 }, /* was 0x02, new from windrv 090403 */
809         { 0x77, 0xff },
810         { 0x78, 0x80 },
811         { 0x79, 0x80 },
812         { 0x7a, 0x80 },
813         { 0x7b, 0x10 }, /* was 0x13, new from windrv 090403 */
814         { 0x7c, 0x00 },
815         { 0x7d, 0x08 }, /* was 0x09, new from windrv 090403 */
816         { 0x7e, 0x08 }, /* was 0xc0, new from windrv 090403 */
817         { 0x7f, 0xfb },
818         { 0x80, 0x28 },
819         { 0x81, 0x00 },
820         { 0x82, 0x23 },
821         { 0x83, 0x0b },
822         { 0x84, 0x00 },
823         { 0x85, 0x62 }, /* was 0x61, new from windrv 090403 */
824         { 0x86, 0xc9 },
825         { 0x87, 0x00 },
826         { 0x88, 0x00 },
827         { 0x89, 0x01 },
828         { 0x12, 0x20 },
829         { 0x12, 0x25 }, /* was 0x24, new from windrv 090403 */
830 };
831
832 static unsigned char ov7670_abs_to_sm(unsigned char v)
833 {
834         if (v > 127)
835                 return v & 0x7f;
836         return (128 - v) | 0x80;
837 }
838
839 /* Write a OV519 register */
840 static int reg_w(struct sd *sd, __u16 index, __u8 value)
841 {
842         int ret;
843
844         sd->gspca_dev.usb_buf[0] = value;
845         ret = usb_control_msg(sd->gspca_dev.dev,
846                         usb_sndctrlpipe(sd->gspca_dev.dev, 0),
847                         1,                      /* REQ_IO (ov518/519) */
848                         USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
849                         0, index,
850                         sd->gspca_dev.usb_buf, 1, 500);
851         if (ret < 0)
852                 PDEBUG(D_ERR, "Write reg [%02x] %02x failed", index, value);
853         return ret;
854 }
855
856 /* Read from a OV519 register */
857 /* returns: negative is error, pos or zero is data */
858 static int reg_r(struct sd *sd, __u16 index)
859 {
860         int ret;
861
862         ret = usb_control_msg(sd->gspca_dev.dev,
863                         usb_rcvctrlpipe(sd->gspca_dev.dev, 0),
864                         1,                      /* REQ_IO */
865                         USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
866                         0, index, sd->gspca_dev.usb_buf, 1, 500);
867
868         if (ret >= 0)
869                 ret = sd->gspca_dev.usb_buf[0];
870         else
871                 PDEBUG(D_ERR, "Read reg [0x%02x] failed", index);
872         return ret;
873 }
874
875 /* Read 8 values from a OV519 register */
876 static int reg_r8(struct sd *sd,
877                   __u16 index)
878 {
879         int ret;
880
881         ret = usb_control_msg(sd->gspca_dev.dev,
882                         usb_rcvctrlpipe(sd->gspca_dev.dev, 0),
883                         1,                      /* REQ_IO */
884                         USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
885                         0, index, sd->gspca_dev.usb_buf, 8, 500);
886
887         if (ret >= 0)
888                 ret = sd->gspca_dev.usb_buf[0];
889         else
890                 PDEBUG(D_ERR, "Read reg 8 [0x%02x] failed", index);
891         return ret;
892 }
893
894 /*
895  * Writes bits at positions specified by mask to an OV51x reg. Bits that are in
896  * the same position as 1's in "mask" are cleared and set to "value". Bits
897  * that are in the same position as 0's in "mask" are preserved, regardless
898  * of their respective state in "value".
899  */
900 static int reg_w_mask(struct sd *sd,
901                         __u16 index,
902                         __u8 value,
903                         __u8 mask)
904 {
905         int ret;
906         __u8 oldval;
907
908         if (mask != 0xff) {
909                 value &= mask;                  /* Enforce mask on value */
910                 ret = reg_r(sd, index);
911                 if (ret < 0)
912                         return ret;
913
914                 oldval = ret & ~mask;           /* Clear the masked bits */
915                 value |= oldval;                /* Set the desired bits */
916         }
917         return reg_w(sd, index, value);
918 }
919
920 /*
921  * The OV518 I2C I/O procedure is different, hence, this function.
922  * This is normally only called from i2c_w(). Note that this function
923  * always succeeds regardless of whether the sensor is present and working.
924  */
925 static int i2c_w(struct sd *sd,
926                 __u8 reg,
927                 __u8 value)
928 {
929         int rc;
930
931         PDEBUG(D_USBO, "i2c 0x%02x -> [0x%02x]", value, reg);
932
933         /* Select camera register */
934         rc = reg_w(sd, R51x_I2C_SADDR_3, reg);
935         if (rc < 0)
936                 return rc;
937
938         /* Write "value" to I2C data port of OV511 */
939         rc = reg_w(sd, R51x_I2C_DATA, value);
940         if (rc < 0)
941                 return rc;
942
943         /* Initiate 3-byte write cycle */
944         rc = reg_w(sd, R518_I2C_CTL, 0x01);
945
946         /* wait for write complete */
947         msleep(4);
948         if (rc < 0)
949                 return rc;
950         return reg_r8(sd, R518_I2C_CTL);
951 }
952
953 /*
954  * returns: negative is error, pos or zero is data
955  *
956  * The OV518 I2C I/O procedure is different, hence, this function.
957  * This is normally only called from i2c_r(). Note that this function
958  * always succeeds regardless of whether the sensor is present and working.
959  */
960 static int i2c_r(struct sd *sd, __u8 reg)
961 {
962         int rc, value;
963
964         /* Select camera register */
965         rc = reg_w(sd, R51x_I2C_SADDR_2, reg);
966         if (rc < 0)
967                 return rc;
968
969         /* Initiate 2-byte write cycle */
970         rc = reg_w(sd, R518_I2C_CTL, 0x03);
971         if (rc < 0)
972                 return rc;
973
974         /* Initiate 2-byte read cycle */
975         rc = reg_w(sd, R518_I2C_CTL, 0x05);
976         if (rc < 0)
977                 return rc;
978         value = reg_r(sd, R51x_I2C_DATA);
979         PDEBUG(D_USBI, "i2c [0x%02X] -> 0x%02X", reg, value);
980         return value;
981 }
982
983 /* Writes bits at positions specified by mask to an I2C reg. Bits that are in
984  * the same position as 1's in "mask" are cleared and set to "value". Bits
985  * that are in the same position as 0's in "mask" are preserved, regardless
986  * of their respective state in "value".
987  */
988 static int i2c_w_mask(struct sd *sd,
989                    __u8 reg,
990                    __u8 value,
991                    __u8 mask)
992 {
993         int rc;
994         __u8 oldval;
995
996         value &= mask;                  /* Enforce mask on value */
997         rc = i2c_r(sd, reg);
998         if (rc < 0)
999                 return rc;
1000         oldval = rc & ~mask;            /* Clear the masked bits */
1001         value |= oldval;                /* Set the desired bits */
1002         return i2c_w(sd, reg, value);
1003 }
1004
1005 /* Temporarily stops OV511 from functioning. Must do this before changing
1006  * registers while the camera is streaming */
1007 static inline int ov51x_stop(struct sd *sd)
1008 {
1009         PDEBUG(D_STREAM, "stopping");
1010         sd->stopped = 1;
1011         return reg_w(sd, OV519_SYS_RESET1, 0x0f);
1012 }
1013
1014 /* Restarts OV511 after ov511_stop() is called. Has no effect if it is not
1015  * actually stopped (for performance). */
1016 static inline int ov51x_restart(struct sd *sd)
1017 {
1018         PDEBUG(D_STREAM, "restarting");
1019         if (!sd->stopped)
1020                 return 0;
1021         sd->stopped = 0;
1022
1023         /* Reinitialize the stream */
1024         return reg_w(sd, OV519_SYS_RESET1, 0x00);
1025 }
1026
1027 /* This does an initial reset of an OmniVision sensor and ensures that I2C
1028  * is synchronized. Returns <0 on failure.
1029  */
1030 static int init_ov_sensor(struct sd *sd)
1031 {
1032         int i, success;
1033
1034         /* Reset the sensor */
1035         if (i2c_w(sd, 0x12, 0x80) < 0)
1036                 return -EIO;
1037
1038         /* Wait for it to initialize */
1039         msleep(150);
1040
1041         for (i = 0, success = 0; i < i2c_detect_tries && !success; i++) {
1042                 if (i2c_r(sd, OV7610_REG_ID_HIGH) == 0x7f &&
1043                     i2c_r(sd, OV7610_REG_ID_LOW) == 0xa2) {
1044                         success = 1;
1045                         continue;
1046                 }
1047
1048                 /* Reset the sensor */
1049                 if (i2c_w(sd, 0x12, 0x80) < 0)
1050                         return -EIO;
1051                 /* Wait for it to initialize */
1052                 msleep(150);
1053                 /* Dummy read to sync I2C */
1054                 if (i2c_r(sd, 0x00) < 0)
1055                         return -EIO;
1056         }
1057         if (!success)
1058                 return -EIO;
1059         PDEBUG(D_PROBE, "I2C synced in %d attempt(s)", i);
1060         return 0;
1061 }
1062
1063 /* Set the read and write slave IDs. The "slave" argument is the write slave,
1064  * and the read slave will be set to (slave + 1).
1065  * This should not be called from outside the i2c I/O functions.
1066  * Sets I2C read and write slave IDs. Returns <0 for error
1067  */
1068 static int ov51x_set_slave_ids(struct sd *sd,
1069                                 __u8 slave)
1070 {
1071         int rc;
1072
1073         rc = reg_w(sd, R51x_I2C_W_SID, slave);
1074         if (rc < 0)
1075                 return rc;
1076         sd->primary_i2c_slave = slave;
1077         return reg_w(sd, R51x_I2C_R_SID, slave + 1);
1078 }
1079
1080 static int write_regvals(struct sd *sd,
1081                          const struct ov_regvals *regvals,
1082                          int n)
1083 {
1084         int rc;
1085
1086         while (--n >= 0) {
1087                 rc = reg_w(sd, regvals->reg, regvals->val);
1088                 if (rc < 0)
1089                         return rc;
1090                 regvals++;
1091         }
1092         return 0;
1093 }
1094
1095 static int write_i2c_regvals(struct sd *sd,
1096                              const struct ov_i2c_regvals *regvals,
1097                              int n)
1098 {
1099         int rc;
1100
1101         while (--n >= 0) {
1102                 rc = i2c_w(sd, regvals->reg, regvals->val);
1103                 if (rc < 0)
1104                         return rc;
1105                 regvals++;
1106         }
1107         return 0;
1108 }
1109
1110 /****************************************************************************
1111  *
1112  * OV511 and sensor configuration
1113  *
1114  ***************************************************************************/
1115
1116 /* This initializes the OV8110, OV8610 sensor. The OV8110 uses
1117  * the same register settings as the OV8610, since they are very similar.
1118  */
1119 static int ov8xx0_configure(struct sd *sd)
1120 {
1121         int rc;
1122
1123         PDEBUG(D_PROBE, "starting ov8xx0 configuration");
1124
1125         /* Detect sensor (sub)type */
1126         rc = i2c_r(sd, OV7610_REG_COM_I);
1127         if (rc < 0) {
1128                 PDEBUG(D_ERR, "Error detecting sensor type");
1129                 return -1;
1130         }
1131         if ((rc & 3) == 1) {
1132                 sd->sensor = SEN_OV8610;
1133         } else {
1134                 PDEBUG(D_ERR, "Unknown image sensor version: %d", rc & 3);
1135                 return -1;
1136         }
1137
1138         /* Set sensor-specific vars */
1139 /*      sd->sif = 0;            already done */
1140         return 0;
1141 }
1142
1143 /* This initializes the OV7610, OV7620, or OV76BE sensor. The OV76BE uses
1144  * the same register settings as the OV7610, since they are very similar.
1145  */
1146 static int ov7xx0_configure(struct sd *sd)
1147 {
1148         int rc, high, low;
1149
1150
1151         PDEBUG(D_PROBE, "starting OV7xx0 configuration");
1152
1153         /* Detect sensor (sub)type */
1154         rc = i2c_r(sd, OV7610_REG_COM_I);
1155
1156         /* add OV7670 here
1157          * it appears to be wrongly detected as a 7610 by default */
1158         if (rc < 0) {
1159                 PDEBUG(D_ERR, "Error detecting sensor type");
1160                 return -1;
1161         }
1162         if ((rc & 3) == 3) {
1163                 /* quick hack to make OV7670s work */
1164                 high = i2c_r(sd, 0x0a);
1165                 low = i2c_r(sd, 0x0b);
1166                 /* info("%x, %x", high, low); */
1167                 if (high == 0x76 && low == 0x73) {
1168                         PDEBUG(D_PROBE, "Sensor is an OV7670");
1169                         sd->sensor = SEN_OV7670;
1170                 } else {
1171                         PDEBUG(D_PROBE, "Sensor is an OV7610");
1172                         sd->sensor = SEN_OV7610;
1173                 }
1174         } else if ((rc & 3) == 1) {
1175                 /* I don't know what's different about the 76BE yet. */
1176                 if (i2c_r(sd, 0x15) & 1)
1177                         PDEBUG(D_PROBE, "Sensor is an OV7620AE");
1178                 else
1179                         PDEBUG(D_PROBE, "Sensor is an OV76BE");
1180
1181                 /* OV511+ will return all zero isoc data unless we
1182                  * configure the sensor as a 7620. Someone needs to
1183                  * find the exact reg. setting that causes this. */
1184                 sd->sensor = SEN_OV76BE;
1185         } else if ((rc & 3) == 0) {
1186                 /* try to read product id registers */
1187                 high = i2c_r(sd, 0x0a);
1188                 if (high < 0) {
1189                         PDEBUG(D_ERR, "Error detecting camera chip PID");
1190                         return high;
1191                 }
1192                 low = i2c_r(sd, 0x0b);
1193                 if (low < 0) {
1194                         PDEBUG(D_ERR, "Error detecting camera chip VER");
1195                         return low;
1196                 }
1197                 if (high == 0x76) {
1198                         switch (low) {
1199                         case 0x30:
1200                                 PDEBUG(D_PROBE, "Sensor is an OV7630/OV7635");
1201                                 PDEBUG(D_ERR,
1202                                       "7630 is not supported by this driver");
1203                                 return -1;
1204                         case 0x40:
1205                                 PDEBUG(D_PROBE, "Sensor is an OV7645");
1206                                 sd->sensor = SEN_OV7640; /* FIXME */
1207                                 break;
1208                         case 0x45:
1209                                 PDEBUG(D_PROBE, "Sensor is an OV7645B");
1210                                 sd->sensor = SEN_OV7640; /* FIXME */
1211                                 break;
1212                         case 0x48:
1213                                 PDEBUG(D_PROBE, "Sensor is an OV7648");
1214                                 sd->sensor = SEN_OV7640; /* FIXME */
1215                                 break;
1216                         default:
1217                                 PDEBUG(D_PROBE, "Unknown sensor: 0x76%x", low);
1218                                 return -1;
1219                         }
1220                 } else {
1221                         PDEBUG(D_PROBE, "Sensor is an OV7620");
1222                         sd->sensor = SEN_OV7620;
1223                 }
1224         } else {
1225                 PDEBUG(D_ERR, "Unknown image sensor version: %d", rc & 3);
1226                 return -1;
1227         }
1228
1229         /* Set sensor-specific vars */
1230 /*      sd->sif = 0;            already done */
1231         return 0;
1232 }
1233
1234 /* This initializes the OV6620, OV6630, OV6630AE, or OV6630AF sensor. */
1235 static int ov6xx0_configure(struct sd *sd)
1236 {
1237         int rc;
1238         PDEBUG(D_PROBE, "starting OV6xx0 configuration");
1239
1240         /* Detect sensor (sub)type */
1241         rc = i2c_r(sd, OV7610_REG_COM_I);
1242         if (rc < 0) {
1243                 PDEBUG(D_ERR, "Error detecting sensor type");
1244                 return -1;
1245         }
1246
1247         /* Ugh. The first two bits are the version bits, but
1248          * the entire register value must be used. I guess OVT
1249          * underestimated how many variants they would make. */
1250         switch (rc) {
1251         case 0x00:
1252                 sd->sensor = SEN_OV6630;
1253                 PDEBUG(D_ERR,
1254                         "WARNING: Sensor is an OV66308. Your camera may have");
1255                 PDEBUG(D_ERR, "been misdetected in previous driver versions.");
1256                 break;
1257         case 0x01:
1258                 sd->sensor = SEN_OV6620;
1259                 break;
1260         case 0x02:
1261                 sd->sensor = SEN_OV6630;
1262                 PDEBUG(D_PROBE, "Sensor is an OV66308AE");
1263                 break;
1264         case 0x03:
1265                 sd->sensor = SEN_OV6630;
1266                 PDEBUG(D_PROBE, "Sensor is an OV66308AF");
1267                 break;
1268         case 0x90:
1269                 sd->sensor = SEN_OV6630;
1270                 PDEBUG(D_ERR,
1271                         "WARNING: Sensor is an OV66307. Your camera may have");
1272                 PDEBUG(D_ERR, "been misdetected in previous driver versions.");
1273                 break;
1274         default:
1275                 PDEBUG(D_ERR, "FATAL: Unknown sensor version: 0x%02x", rc);
1276                 return -1;
1277         }
1278
1279         /* Set sensor-specific vars */
1280         sd->sif = 1;
1281
1282         return 0;
1283 }
1284
1285 /* Turns on or off the LED. Only has an effect with OV511+/OV518(+)/OV519 */
1286 static void ov51x_led_control(struct sd *sd, int on)
1287 {
1288 /*      PDEBUG(D_STREAM, "LED (%s)", on ? "on" : "off"); */
1289         reg_w_mask(sd, OV519_GPIO_DATA_OUT0, !on, 1);   /* 0 / 1 */
1290 }
1291
1292 /* this function is called at probe time */
1293 static int sd_config(struct gspca_dev *gspca_dev,
1294                         const struct usb_device_id *id)
1295 {
1296         struct sd *sd = (struct sd *) gspca_dev;
1297         struct cam *cam;
1298
1299         static const struct ov_regvals init_519[] = {
1300                 { 0x5a,  0x6d }, /* EnableSystem */
1301                 { 0x53,  0x9b },
1302                 { 0x54,  0xff }, /* set bit2 to enable jpeg */
1303                 { 0x5d,  0x03 },
1304                 { 0x49,  0x01 },
1305                 { 0x48,  0x00 },
1306                 /* Set LED pin to output mode. Bit 4 must be cleared or sensor
1307                  * detection will fail. This deserves further investigation. */
1308                 { OV519_GPIO_IO_CTRL0,   0xee },
1309                 { 0x51,  0x0f }, /* SetUsbInit */
1310                 { 0x51,  0x00 },
1311                 { 0x22,  0x00 },
1312                 /* windows reads 0x55 at this point*/
1313         };
1314
1315         if (write_regvals(sd, init_519, ARRAY_SIZE(init_519)))
1316                 goto error;
1317         ov51x_led_control(sd, 0);       /* turn LED off */
1318
1319         /* Test for 76xx */
1320         if (ov51x_set_slave_ids(sd, OV7xx0_SID) < 0)
1321                 goto error;
1322
1323         /* The OV519 must be more aggressive about sensor detection since
1324          * I2C write will never fail if the sensor is not present. We have
1325          * to try to initialize the sensor to detect its presence */
1326         if (init_ov_sensor(sd) >= 0) {
1327                 if (ov7xx0_configure(sd) < 0) {
1328                         PDEBUG(D_ERR, "Failed to configure OV7xx0");
1329                         goto error;
1330                 }
1331         } else {
1332
1333                 /* Test for 6xx0 */
1334                 if (ov51x_set_slave_ids(sd, OV6xx0_SID) < 0)
1335                         goto error;
1336
1337                 if (init_ov_sensor(sd) >= 0) {
1338                         if (ov6xx0_configure(sd) < 0) {
1339                                 PDEBUG(D_ERR, "Failed to configure OV6xx0");
1340                                 goto error;
1341                         }
1342                 } else {
1343
1344                         /* Test for 8xx0 */
1345                         if (ov51x_set_slave_ids(sd, OV8xx0_SID) < 0)
1346                                 goto error;
1347
1348                         if (init_ov_sensor(sd) < 0) {
1349                                 PDEBUG(D_ERR,
1350                                         "Can't determine sensor slave IDs");
1351                                 goto error;
1352                         }
1353                         if (ov8xx0_configure(sd) < 0) {
1354                                 PDEBUG(D_ERR,
1355                                    "Failed to configure OV8xx0 sensor");
1356                                 goto error;
1357                         }
1358                 }
1359         }
1360
1361         cam = &gspca_dev->cam;
1362         cam->epaddr = OV511_ENDPOINT_ADDRESS;
1363         if (!sd->sif) {
1364                 cam->cam_mode = vga_mode;
1365                 cam->nmodes = ARRAY_SIZE(vga_mode);
1366         } else {
1367                 cam->cam_mode = sif_mode;
1368                 cam->nmodes = ARRAY_SIZE(sif_mode);
1369         }
1370         sd->brightness = BRIGHTNESS_DEF;
1371         sd->contrast = CONTRAST_DEF;
1372         sd->colors = COLOR_DEF;
1373         sd->hflip = HFLIP_DEF;
1374         sd->vflip = VFLIP_DEF;
1375         if (sd->sensor != SEN_OV7670)
1376                 gspca_dev->ctrl_dis = (1 << HFLIP_IDX)
1377                                         | (1 << VFLIP_IDX);
1378         return 0;
1379 error:
1380         PDEBUG(D_ERR, "OV519 Config failed");
1381         return -EBUSY;
1382 }
1383
1384 /* this function is called at probe and resume time */
1385 static int sd_init(struct gspca_dev *gspca_dev)
1386 {
1387         struct sd *sd = (struct sd *) gspca_dev;
1388
1389         /* initialize the sensor */
1390         switch (sd->sensor) {
1391         case SEN_OV6620:
1392                 if (write_i2c_regvals(sd, norm_6x20, ARRAY_SIZE(norm_6x20)))
1393                         return -EIO;
1394                 break;
1395         case SEN_OV6630:
1396                 if (write_i2c_regvals(sd, norm_6x30, ARRAY_SIZE(norm_6x30)))
1397                         return -EIO;
1398                 break;
1399         default:
1400 /*      case SEN_OV7610: */
1401 /*      case SEN_OV76BE: */
1402                 if (write_i2c_regvals(sd, norm_7610, ARRAY_SIZE(norm_7610)))
1403                         return -EIO;
1404                 break;
1405         case SEN_OV7620:
1406                 if (write_i2c_regvals(sd, norm_7620, ARRAY_SIZE(norm_7620)))
1407                         return -EIO;
1408                 break;
1409         case SEN_OV7640:
1410                 if (write_i2c_regvals(sd, norm_7640, ARRAY_SIZE(norm_7640)))
1411                         return -EIO;
1412                 break;
1413         case SEN_OV7670:
1414                 if (write_i2c_regvals(sd, norm_7670, ARRAY_SIZE(norm_7670)))
1415                         return -EIO;
1416                 break;
1417         case SEN_OV8610:
1418                 if (write_i2c_regvals(sd, norm_8610, ARRAY_SIZE(norm_8610)))
1419                         return -EIO;
1420                 break;
1421         }
1422         return 0;
1423 }
1424
1425 /* Sets up the OV519 with the given image parameters
1426  *
1427  * OV519 needs a completely different approach, until we can figure out what
1428  * the individual registers do.
1429  *
1430  * Do not put any sensor-specific code in here (including I2C I/O functions)
1431  */
1432 static int ov519_mode_init_regs(struct sd *sd)
1433 {
1434         static const struct ov_regvals mode_init_519_ov7670[] = {
1435                 { 0x5d, 0x03 }, /* Turn off suspend mode */
1436                 { 0x53, 0x9f }, /* was 9b in 1.65-1.08 */
1437                 { 0x54, 0x0f }, /* bit2 (jpeg enable) */
1438                 { 0xa2, 0x20 }, /* a2-a5 are undocumented */
1439                 { 0xa3, 0x18 },
1440                 { 0xa4, 0x04 },
1441                 { 0xa5, 0x28 },
1442                 { 0x37, 0x00 }, /* SetUsbInit */
1443                 { 0x55, 0x02 }, /* 4.096 Mhz audio clock */
1444                 /* Enable both fields, YUV Input, disable defect comp (why?) */
1445                 { 0x20, 0x0c },
1446                 { 0x21, 0x38 },
1447                 { 0x22, 0x1d },
1448                 { 0x17, 0x50 }, /* undocumented */
1449                 { 0x37, 0x00 }, /* undocumented */
1450                 { 0x40, 0xff }, /* I2C timeout counter */
1451                 { 0x46, 0x00 }, /* I2C clock prescaler */
1452                 { 0x59, 0x04 }, /* new from windrv 090403 */
1453                 { 0xff, 0x00 }, /* undocumented */
1454                 /* windows reads 0x55 at this point, why? */
1455         };
1456
1457         static const struct ov_regvals mode_init_519[] = {
1458                 { 0x5d, 0x03 }, /* Turn off suspend mode */
1459                 { 0x53, 0x9f }, /* was 9b in 1.65-1.08 */
1460                 { 0x54, 0x0f }, /* bit2 (jpeg enable) */
1461                 { 0xa2, 0x20 }, /* a2-a5 are undocumented */
1462                 { 0xa3, 0x18 },
1463                 { 0xa4, 0x04 },
1464                 { 0xa5, 0x28 },
1465                 { 0x37, 0x00 }, /* SetUsbInit */
1466                 { 0x55, 0x02 }, /* 4.096 Mhz audio clock */
1467                 /* Enable both fields, YUV Input, disable defect comp (why?) */
1468                 { 0x22, 0x1d },
1469                 { 0x17, 0x50 }, /* undocumented */
1470                 { 0x37, 0x00 }, /* undocumented */
1471                 { 0x40, 0xff }, /* I2C timeout counter */
1472                 { 0x46, 0x00 }, /* I2C clock prescaler */
1473                 { 0x59, 0x04 }, /* new from windrv 090403 */
1474                 { 0xff, 0x00 }, /* undocumented */
1475                 /* windows reads 0x55 at this point, why? */
1476         };
1477
1478         /******** Set the mode ********/
1479         if (sd->sensor != SEN_OV7670) {
1480                 if (write_regvals(sd, mode_init_519,
1481                                   ARRAY_SIZE(mode_init_519)))
1482                         return -EIO;
1483                 if (sd->sensor == SEN_OV7640) {
1484                         /* Select 8-bit input mode */
1485                         reg_w_mask(sd, OV519_CAM_DFR, 0x10, 0x10);
1486                 }
1487         } else {
1488                 if (write_regvals(sd, mode_init_519_ov7670,
1489                                   ARRAY_SIZE(mode_init_519_ov7670)))
1490                         return -EIO;
1491         }
1492
1493         reg_w(sd, OV519_CAM_H_SIZE,     sd->gspca_dev.width >> 4);
1494         reg_w(sd, OV519_CAM_V_SIZE,     sd->gspca_dev.height >> 3);
1495         reg_w(sd, OV519_CAM_X_OFFSETL,  0x00);
1496         reg_w(sd, OV519_CAM_X_OFFSETH,  0x00);
1497         reg_w(sd, OV519_CAM_Y_OFFSETL,  0x00);
1498         reg_w(sd, OV519_CAM_Y_OFFSETH,  0x00);
1499         reg_w(sd, OV519_CAM_DIVIDER,    0x00);
1500         reg_w(sd, OV519_CAM_FORMAT,     0x03); /* YUV422 */
1501         reg_w(sd, 0x26,                 0x00); /* Undocumented */
1502
1503         /******** Set the framerate ********/
1504         if (frame_rate > 0)
1505                 sd->frame_rate = frame_rate;
1506
1507 /* FIXME: These are only valid at the max resolution. */
1508         sd->clockdiv = 0;
1509         switch (sd->sensor) {
1510         case SEN_OV7640:
1511                 switch (sd->frame_rate) {
1512 /*fixme: default was 30 fps */
1513                 case 30:
1514                         reg_w(sd, 0xa4, 0x0c);
1515                         reg_w(sd, 0x23, 0xff);
1516                         break;
1517                 case 25:
1518                         reg_w(sd, 0xa4, 0x0c);
1519                         reg_w(sd, 0x23, 0x1f);
1520                         break;
1521                 case 20:
1522                         reg_w(sd, 0xa4, 0x0c);
1523                         reg_w(sd, 0x23, 0x1b);
1524                         break;
1525                 default:
1526 /*              case 15: */
1527                         reg_w(sd, 0xa4, 0x04);
1528                         reg_w(sd, 0x23, 0xff);
1529                         sd->clockdiv = 1;
1530                         break;
1531                 case 10:
1532                         reg_w(sd, 0xa4, 0x04);
1533                         reg_w(sd, 0x23, 0x1f);
1534                         sd->clockdiv = 1;
1535                         break;
1536                 case 5:
1537                         reg_w(sd, 0xa4, 0x04);
1538                         reg_w(sd, 0x23, 0x1b);
1539                         sd->clockdiv = 1;
1540                         break;
1541                 }
1542                 break;
1543         case SEN_OV8610:
1544                 switch (sd->frame_rate) {
1545                 default:        /* 15 fps */
1546 /*              case 15: */
1547                         reg_w(sd, 0xa4, 0x06);
1548                         reg_w(sd, 0x23, 0xff);
1549                         break;
1550                 case 10:
1551                         reg_w(sd, 0xa4, 0x06);
1552                         reg_w(sd, 0x23, 0x1f);
1553                         break;
1554                 case 5:
1555                         reg_w(sd, 0xa4, 0x06);
1556                         reg_w(sd, 0x23, 0x1b);
1557                         break;
1558                 }
1559                 break;
1560         case SEN_OV7670:                /* guesses, based on 7640 */
1561                 PDEBUG(D_STREAM, "Setting framerate to %d fps",
1562                                  (sd->frame_rate == 0) ? 15 : sd->frame_rate);
1563                 reg_w(sd, 0xa4, 0x10);
1564                 switch (sd->frame_rate) {
1565                 case 30:
1566                         reg_w(sd, 0x23, 0xff);
1567                         break;
1568                 case 20:
1569                         reg_w(sd, 0x23, 0x1b);
1570                         break;
1571                 default:
1572 /*              case 15: */
1573                         reg_w(sd, 0x23, 0xff);
1574                         sd->clockdiv = 1;
1575                         break;
1576                 }
1577                 break;
1578         }
1579
1580         return 0;
1581 }
1582
1583 static int mode_init_ov_sensor_regs(struct sd *sd)
1584 {
1585         struct gspca_dev *gspca_dev;
1586         int qvga;
1587
1588         gspca_dev = &sd->gspca_dev;
1589         qvga = gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].priv;
1590
1591         /******** Mode (VGA/QVGA) and sensor specific regs ********/
1592         switch (sd->sensor) {
1593         case SEN_OV8610:
1594                 /* For OV8610 qvga means qsvga */
1595                 i2c_w_mask(sd, OV7610_REG_COM_C, qvga ? (1 << 5) : 0, 1 << 5);
1596                 break;
1597         case SEN_OV7610:
1598                 i2c_w_mask(sd, 0x14, qvga ? 0x20 : 0x00, 0x20);
1599                 break;
1600         case SEN_OV7620:
1601 /*              i2c_w(sd, 0x2b, 0x00); */
1602                 i2c_w_mask(sd, 0x14, qvga ? 0x20 : 0x00, 0x20);
1603                 i2c_w_mask(sd, 0x28, qvga ? 0x00 : 0x20, 0x20);
1604                 i2c_w(sd, 0x24, qvga ? 0x20 : 0x3a);
1605                 i2c_w(sd, 0x25, qvga ? 0x30 : 0x60);
1606                 i2c_w_mask(sd, 0x2d, qvga ? 0x40 : 0x00, 0x40);
1607                 i2c_w_mask(sd, 0x67, qvga ? 0xf0 : 0x90, 0xf0);
1608                 i2c_w_mask(sd, 0x74, qvga ? 0x20 : 0x00, 0x20);
1609                 break;
1610         case SEN_OV76BE:
1611 /*              i2c_w(sd, 0x2b, 0x00); */
1612                 i2c_w_mask(sd, 0x14, qvga ? 0x20 : 0x00, 0x20);
1613                 break;
1614         case SEN_OV7640:
1615 /*              i2c_w(sd, 0x2b, 0x00); */
1616                 i2c_w_mask(sd, 0x14, qvga ? 0x20 : 0x00, 0x20);
1617                 i2c_w_mask(sd, 0x28, qvga ? 0x00 : 0x20, 0x20);
1618 /*              i2c_w(sd, 0x24, qvga ? 0x20 : 0x3a); */
1619 /*              i2c_w(sd, 0x25, qvga ? 0x30 : 0x60); */
1620 /*              i2c_w_mask(sd, 0x2d, qvga ? 0x40 : 0x00, 0x40); */
1621 /*              i2c_w_mask(sd, 0x67, qvga ? 0xf0 : 0x90, 0xf0); */
1622 /*              i2c_w_mask(sd, 0x74, qvga ? 0x20 : 0x00, 0x20); */
1623                 break;
1624         case SEN_OV7670:
1625                 /* set COM7_FMT_VGA or COM7_FMT_QVGA
1626                  * do we need to set anything else?
1627                  *      HSTART etc are set in set_ov_sensor_window itself */
1628                 i2c_w_mask(sd, OV7670_REG_COM7,
1629                          qvga ? OV7670_COM7_FMT_QVGA : OV7670_COM7_FMT_VGA,
1630                          OV7670_COM7_FMT_MASK);
1631                 break;
1632         case SEN_OV6620:
1633         case SEN_OV6630:
1634                 i2c_w_mask(sd, 0x14, qvga ? 0x20 : 0x00, 0x20);
1635                 break;
1636         default:
1637                 return -EINVAL;
1638         }
1639
1640         /******** Palette-specific regs ********/
1641         if (sd->sensor == SEN_OV7610 || sd->sensor == SEN_OV76BE) {
1642                 /* not valid on the OV6620/OV7620/6630? */
1643                 i2c_w_mask(sd, 0x0e, 0x00, 0x40);
1644         }
1645
1646         /* The OV518 needs special treatment. Although both the OV518
1647          * and the OV6630 support a 16-bit video bus, only the 8 bit Y
1648          * bus is actually used. The UV bus is tied to ground.
1649          * Therefore, the OV6630 needs to be in 8-bit multiplexed
1650          * output mode */
1651
1652         /* OV7640 is 8-bit only */
1653
1654         if (sd->sensor != SEN_OV6630 && sd->sensor != SEN_OV7640)
1655                 i2c_w_mask(sd, 0x13, 0x00, 0x20);
1656
1657         /******** Clock programming ********/
1658         /* The OV6620 needs special handling. This prevents the
1659          * severe banding that normally occurs */
1660         if (sd->sensor == SEN_OV6620) {
1661
1662                 /* Clock down */
1663                 i2c_w(sd, 0x2a, 0x04);
1664                 i2c_w(sd, 0x11, sd->clockdiv);
1665                 i2c_w(sd, 0x2a, 0x84);
1666                 /* This next setting is critical. It seems to improve
1667                  * the gain or the contrast. The "reserved" bits seem
1668                  * to have some effect in this case. */
1669                 i2c_w(sd, 0x2d, 0x85);
1670         } else if (sd->clockdiv >= 0) {
1671                 i2c_w(sd, 0x11, sd->clockdiv);
1672         }
1673
1674         /******** Special Features ********/
1675 /* no evidence this is possible with OV7670, either */
1676         /* Test Pattern */
1677         if (sd->sensor != SEN_OV7640 && sd->sensor != SEN_OV7670)
1678                 i2c_w_mask(sd, 0x12, 0x00, 0x02);
1679
1680         /* Enable auto white balance */
1681         if (sd->sensor == SEN_OV7670)
1682                 i2c_w_mask(sd, OV7670_REG_COM8, OV7670_COM8_AWB,
1683                                 OV7670_COM8_AWB);
1684         else
1685                 i2c_w_mask(sd, 0x12, 0x04, 0x04);
1686
1687         /* This will go away as soon as ov51x_mode_init_sensor_regs() */
1688         /* is fully tested. */
1689         /* 7620/6620/6630? don't have register 0x35, so play it safe */
1690         if (sd->sensor == SEN_OV7610 || sd->sensor == SEN_OV76BE) {
1691                 if (!qvga)
1692                         i2c_w(sd, 0x35, 0x9e);
1693                 else
1694                         i2c_w(sd, 0x35, 0x1e);
1695         }
1696         return 0;
1697 }
1698
1699 static void sethvflip(struct sd *sd)
1700 {
1701         if (sd->sensor != SEN_OV7670)
1702                 return;
1703         if (sd->gspca_dev.streaming)
1704                 ov51x_stop(sd);
1705         i2c_w_mask(sd, OV7670_REG_MVFP,
1706                 OV7670_MVFP_MIRROR * sd->hflip
1707                         | OV7670_MVFP_VFLIP * sd->vflip,
1708                 OV7670_MVFP_MIRROR | OV7670_MVFP_VFLIP);
1709         if (sd->gspca_dev.streaming)
1710                 ov51x_restart(sd);
1711 }
1712
1713 static int set_ov_sensor_window(struct sd *sd)
1714 {
1715         struct gspca_dev *gspca_dev;
1716         int qvga;
1717         int hwsbase, hwebase, vwsbase, vwebase, hwscale, vwscale;
1718         int ret, hstart, hstop, vstop, vstart;
1719         __u8 v;
1720
1721         gspca_dev = &sd->gspca_dev;
1722         qvga = gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].priv;
1723
1724         /* The different sensor ICs handle setting up of window differently.
1725          * IF YOU SET IT WRONG, YOU WILL GET ALL ZERO ISOC DATA FROM OV51x!! */
1726         switch (sd->sensor) {
1727         case SEN_OV8610:
1728                 hwsbase = 0x1e;
1729                 hwebase = 0x1e;
1730                 vwsbase = 0x02;
1731                 vwebase = 0x02;
1732                 break;
1733         case SEN_OV7610:
1734         case SEN_OV76BE:
1735                 hwsbase = 0x38;
1736                 hwebase = 0x3a;
1737                 vwsbase = vwebase = 0x05;
1738                 break;
1739         case SEN_OV6620:
1740         case SEN_OV6630:
1741                 hwsbase = 0x38;
1742                 hwebase = 0x3a;
1743                 vwsbase = 0x05;
1744                 vwebase = 0x06;
1745                 break;
1746         case SEN_OV7620:
1747                 hwsbase = 0x2f;         /* From 7620.SET (spec is wrong) */
1748                 hwebase = 0x2f;
1749                 vwsbase = vwebase = 0x05;
1750                 break;
1751         case SEN_OV7640:
1752                 hwsbase = 0x1a;
1753                 hwebase = 0x1a;
1754                 vwsbase = vwebase = 0x03;
1755                 break;
1756         case SEN_OV7670:
1757                 /*handling of OV7670 hardware sensor start and stop values
1758                  * is very odd, compared to the other OV sensors */
1759                 vwsbase = vwebase = hwebase = hwsbase = 0x00;
1760                 break;
1761         default:
1762                 return -EINVAL;
1763         }
1764
1765         switch (sd->sensor) {
1766         case SEN_OV6620:
1767         case SEN_OV6630:
1768                 if (qvga) {             /* QCIF */
1769                         hwscale = 0;
1770                         vwscale = 0;
1771                 } else {                /* CIF */
1772                         hwscale = 1;
1773                         vwscale = 1;    /* The datasheet says 0;
1774                                          * it's wrong */
1775                 }
1776                 break;
1777         case SEN_OV8610:
1778                 if (qvga) {             /* QSVGA */
1779                         hwscale = 1;
1780                         vwscale = 1;
1781                 } else {                /* SVGA */
1782                         hwscale = 2;
1783                         vwscale = 2;
1784                 }
1785                 break;
1786         default:                        /* SEN_OV7xx0 */
1787                 if (qvga) {             /* QVGA */
1788                         hwscale = 1;
1789                         vwscale = 0;
1790                 } else {                /* VGA */
1791                         hwscale = 2;
1792                         vwscale = 1;
1793                 }
1794         }
1795
1796         ret = mode_init_ov_sensor_regs(sd);
1797         if (ret < 0)
1798                 return ret;
1799
1800         if (sd->sensor == SEN_OV8610) {
1801                 i2c_w_mask(sd, 0x2d, 0x05, 0x40);
1802                                 /* old 0x95, new 0x05 from windrv 090403 */
1803                                                 /* bits 5-7: reserved */
1804                 i2c_w_mask(sd, 0x28, 0x20, 0x20);
1805                                         /* bit 5: progressive mode on */
1806         }
1807
1808         /* The below is wrong for OV7670s because their window registers
1809          * only store the high bits in 0x17 to 0x1a */
1810
1811         /* SRH Use sd->max values instead of requested win values */
1812         /* SCS Since we're sticking with only the max hardware widths
1813          * for a given mode */
1814         /* I can hard code this for OV7670s */
1815         /* Yes, these numbers do look odd, but they're tested and work! */
1816         if (sd->sensor == SEN_OV7670) {
1817                 if (qvga) {             /* QVGA from ov7670.c by
1818                                          * Jonathan Corbet */
1819                         hstart = 164;
1820                         hstop = 20;
1821                         vstart = 14;
1822                         vstop = 494;
1823                 } else {                /* VGA */
1824                         hstart = 158;
1825                         hstop = 14;
1826                         vstart = 10;
1827                         vstop = 490;
1828                 }
1829                 /* OV7670 hardware window registers are split across
1830                  * multiple locations */
1831                 i2c_w(sd, OV7670_REG_HSTART, hstart >> 3);
1832                 i2c_w(sd, OV7670_REG_HSTOP, hstop >> 3);
1833                 v = i2c_r(sd, OV7670_REG_HREF);
1834                 v = (v & 0xc0) | ((hstop & 0x7) << 3) | (hstart & 0x07);
1835                 msleep(10);     /* need to sleep between read and write to
1836                                  * same reg! */
1837                 i2c_w(sd, OV7670_REG_HREF, v);
1838
1839                 i2c_w(sd, OV7670_REG_VSTART, vstart >> 2);
1840                 i2c_w(sd, OV7670_REG_VSTOP, vstop >> 2);
1841                 v = i2c_r(sd, OV7670_REG_VREF);
1842                 v = (v & 0xc0) | ((vstop & 0x3) << 2) | (vstart & 0x03);
1843                 msleep(10);     /* need to sleep between read and write to
1844                                  * same reg! */
1845                 i2c_w(sd, OV7670_REG_VREF, v);
1846                 sethvflip(sd);
1847         } else {
1848                 i2c_w(sd, 0x17, hwsbase);
1849                 i2c_w(sd, 0x18, hwebase + (sd->gspca_dev.width >> hwscale));
1850                 i2c_w(sd, 0x19, vwsbase);
1851                 i2c_w(sd, 0x1a, vwebase + (sd->gspca_dev.height >> vwscale));
1852         }
1853         return 0;
1854 }
1855
1856 /* -- start the camera -- */
1857 static int sd_start(struct gspca_dev *gspca_dev)
1858 {
1859         struct sd *sd = (struct sd *) gspca_dev;
1860         int ret;
1861
1862         ret = ov519_mode_init_regs(sd);
1863         if (ret < 0)
1864                 goto out;
1865         ret = set_ov_sensor_window(sd);
1866         if (ret < 0)
1867                 goto out;
1868
1869         ret = ov51x_restart(sd);
1870         if (ret < 0)
1871                 goto out;
1872         PDEBUG(D_STREAM, "camera started alt: 0x%02x", gspca_dev->alt);
1873         ov51x_led_control(sd, 1);
1874         return 0;
1875 out:
1876         PDEBUG(D_ERR, "camera start error:%d", ret);
1877         return ret;
1878 }
1879
1880 static void sd_stopN(struct gspca_dev *gspca_dev)
1881 {
1882         ov51x_stop((struct sd *) gspca_dev);
1883         ov51x_led_control((struct sd *) gspca_dev, 0);
1884 }
1885
1886 static void sd_pkt_scan(struct gspca_dev *gspca_dev,
1887                         struct gspca_frame *frame,      /* target */
1888                         __u8 *data,                     /* isoc packet */
1889                         int len)                        /* iso packet length */
1890 {
1891         /* Header of ov519 is 16 bytes:
1892          *     Byte     Value      Description
1893          *      0       0xff    magic
1894          *      1       0xff    magic
1895          *      2       0xff    magic
1896          *      3       0xXX    0x50 = SOF, 0x51 = EOF
1897          *      9       0xXX    0x01 initial frame without data,
1898          *                      0x00 standard frame with image
1899          *      14      Lo      in EOF: length of image data / 8
1900          *      15      Hi
1901          */
1902
1903         if (data[0] == 0xff && data[1] == 0xff && data[2] == 0xff) {
1904                 switch (data[3]) {
1905                 case 0x50:              /* start of frame */
1906 #define HDRSZ 16
1907                         data += HDRSZ;
1908                         len -= HDRSZ;
1909 #undef HDRSZ
1910                         if (data[0] == 0xff || data[1] == 0xd8)
1911                                 gspca_frame_add(gspca_dev, FIRST_PACKET, frame,
1912                                                 data, len);
1913                         else
1914                                 gspca_dev->last_packet_type = DISCARD_PACKET;
1915                         return;
1916                 case 0x51:              /* end of frame */
1917                         if (data[9] != 0)
1918                                 gspca_dev->last_packet_type = DISCARD_PACKET;
1919                         gspca_frame_add(gspca_dev, LAST_PACKET, frame,
1920                                         data, 0);
1921                         return;
1922                 }
1923         }
1924
1925         /* intermediate packet */
1926         gspca_frame_add(gspca_dev, INTER_PACKET, frame,
1927                         data, len);
1928 }
1929
1930 /* -- management routines -- */
1931
1932 static void setbrightness(struct gspca_dev *gspca_dev)
1933 {
1934         struct sd *sd = (struct sd *) gspca_dev;
1935         int val;
1936
1937         val = sd->brightness;
1938         PDEBUG(D_CONF, "brightness:%d", val);
1939 /*      if (gspca_dev->streaming)
1940  *              ov51x_stop(sd); */
1941         switch (sd->sensor) {
1942         case SEN_OV8610:
1943         case SEN_OV7610:
1944         case SEN_OV76BE:
1945         case SEN_OV6620:
1946         case SEN_OV6630:
1947         case SEN_OV7640:
1948                 i2c_w(sd, OV7610_REG_BRT, val);
1949                 break;
1950         case SEN_OV7620:
1951                 /* 7620 doesn't like manual changes when in auto mode */
1952 /*fixme
1953  *              if (!sd->auto_brt) */
1954                         i2c_w(sd, OV7610_REG_BRT, val);
1955                 break;
1956         case SEN_OV7670:
1957 /*win trace
1958  *              i2c_w_mask(sd, OV7670_REG_COM8, 0, OV7670_COM8_AEC); */
1959                 i2c_w(sd, OV7670_REG_BRIGHT, ov7670_abs_to_sm(val));
1960                 break;
1961         }
1962 /*      if (gspca_dev->streaming)
1963  *              ov51x_restart(sd); */
1964 }
1965
1966 static void setcontrast(struct gspca_dev *gspca_dev)
1967 {
1968         struct sd *sd = (struct sd *) gspca_dev;
1969         int val;
1970
1971         val = sd->contrast;
1972         PDEBUG(D_CONF, "contrast:%d", val);
1973 /*      if (gspca_dev->streaming)
1974                 ov51x_stop(sd); */
1975         switch (sd->sensor) {
1976         case SEN_OV7610:
1977         case SEN_OV6620:
1978                 i2c_w(sd, OV7610_REG_CNT, val);
1979                 break;
1980         case SEN_OV6630:
1981                 i2c_w_mask(sd, OV7610_REG_CNT, val >> 4, 0x0f);
1982         case SEN_OV8610: {
1983                 static const __u8 ctab[] = {
1984                         0x03, 0x09, 0x0b, 0x0f, 0x53, 0x6f, 0x35, 0x7f
1985                 };
1986
1987                 /* Use Y gamma control instead. Bit 0 enables it. */
1988                 i2c_w(sd, 0x64, ctab[val >> 5]);
1989                 break;
1990             }
1991         case SEN_OV7620: {
1992                 static const __u8 ctab[] = {
1993                         0x01, 0x05, 0x09, 0x11, 0x15, 0x35, 0x37, 0x57,
1994                         0x5b, 0xa5, 0xa7, 0xc7, 0xc9, 0xcf, 0xef, 0xff
1995                 };
1996
1997                 /* Use Y gamma control instead. Bit 0 enables it. */
1998                 i2c_w(sd, 0x64, ctab[val >> 4]);
1999                 break;
2000             }
2001         case SEN_OV7640:
2002                 /* Use gain control instead. */
2003                 i2c_w(sd, OV7610_REG_GAIN, val >> 2);
2004                 break;
2005         case SEN_OV7670:
2006                 /* check that this isn't just the same as ov7610 */
2007                 i2c_w(sd, OV7670_REG_CONTRAS, val >> 1);
2008                 break;
2009         }
2010 /*      if (gspca_dev->streaming)
2011                 ov51x_restart(sd); */
2012 }
2013
2014 static void setcolors(struct gspca_dev *gspca_dev)
2015 {
2016         struct sd *sd = (struct sd *) gspca_dev;
2017         int val;
2018
2019         val = sd->colors;
2020         PDEBUG(D_CONF, "saturation:%d", val);
2021 /*      if (gspca_dev->streaming)
2022                 ov51x_stop(sd); */
2023         switch (sd->sensor) {
2024         case SEN_OV8610:
2025         case SEN_OV7610:
2026         case SEN_OV76BE:
2027         case SEN_OV6620:
2028         case SEN_OV6630:
2029                 i2c_w(sd, OV7610_REG_SAT, val);
2030                 break;
2031         case SEN_OV7620:
2032                 /* Use UV gamma control instead. Bits 0 & 7 are reserved. */
2033 /*              rc = ov_i2c_write(sd->dev, 0x62, (val >> 9) & 0x7e);
2034                 if (rc < 0)
2035                         goto out; */
2036                 i2c_w(sd, OV7610_REG_SAT, val);
2037                 break;
2038         case SEN_OV7640:
2039                 i2c_w(sd, OV7610_REG_SAT, val & 0xf0);
2040                 break;
2041         case SEN_OV7670:
2042                 /* supported later once I work out how to do it
2043                  * transparently fail now! */
2044                 /* set REG_COM13 values for UV sat auto mode */
2045                 break;
2046         }
2047 /*      if (gspca_dev->streaming)
2048                 ov51x_restart(sd); */
2049 }
2050
2051 static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val)
2052 {
2053         struct sd *sd = (struct sd *) gspca_dev;
2054
2055         sd->brightness = val;
2056         setbrightness(gspca_dev);
2057         return 0;
2058 }
2059
2060 static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val)
2061 {
2062         struct sd *sd = (struct sd *) gspca_dev;
2063
2064         *val = sd->brightness;
2065         return 0;
2066 }
2067
2068 static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val)
2069 {
2070         struct sd *sd = (struct sd *) gspca_dev;
2071
2072         sd->contrast = val;
2073         setcontrast(gspca_dev);
2074         return 0;
2075 }
2076
2077 static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val)
2078 {
2079         struct sd *sd = (struct sd *) gspca_dev;
2080
2081         *val = sd->contrast;
2082         return 0;
2083 }
2084
2085 static int sd_setcolors(struct gspca_dev *gspca_dev, __s32 val)
2086 {
2087         struct sd *sd = (struct sd *) gspca_dev;
2088
2089         sd->colors = val;
2090         setcolors(gspca_dev);
2091         return 0;
2092 }
2093
2094 static int sd_getcolors(struct gspca_dev *gspca_dev, __s32 *val)
2095 {
2096         struct sd *sd = (struct sd *) gspca_dev;
2097
2098         *val = sd->colors;
2099         return 0;
2100 }
2101
2102 static int sd_sethflip(struct gspca_dev *gspca_dev, __s32 val)
2103 {
2104         struct sd *sd = (struct sd *) gspca_dev;
2105
2106         sd->hflip = val;
2107         sethvflip(sd);
2108         return 0;
2109 }
2110
2111 static int sd_gethflip(struct gspca_dev *gspca_dev, __s32 *val)
2112 {
2113         struct sd *sd = (struct sd *) gspca_dev;
2114
2115         *val = sd->hflip;
2116         return 0;
2117 }
2118
2119 static int sd_setvflip(struct gspca_dev *gspca_dev, __s32 val)
2120 {
2121         struct sd *sd = (struct sd *) gspca_dev;
2122
2123         sd->vflip = val;
2124         sethvflip(sd);
2125         return 0;
2126 }
2127
2128 static int sd_getvflip(struct gspca_dev *gspca_dev, __s32 *val)
2129 {
2130         struct sd *sd = (struct sd *) gspca_dev;
2131
2132         *val = sd->vflip;
2133         return 0;
2134 }
2135
2136 /* sub-driver description */
2137 static const struct sd_desc sd_desc = {
2138         .name = MODULE_NAME,
2139         .ctrls = sd_ctrls,
2140         .nctrls = ARRAY_SIZE(sd_ctrls),
2141         .config = sd_config,
2142         .init = sd_init,
2143         .start = sd_start,
2144         .stopN = sd_stopN,
2145         .pkt_scan = sd_pkt_scan,
2146 };
2147
2148 /* -- module initialisation -- */
2149 static const __devinitdata struct usb_device_id device_table[] = {
2150         {USB_DEVICE(0x041e, 0x4052)},
2151         {USB_DEVICE(0x041e, 0x405f)},
2152         {USB_DEVICE(0x041e, 0x4060)},
2153         {USB_DEVICE(0x041e, 0x4061)},
2154         {USB_DEVICE(0x041e, 0x4064)},
2155         {USB_DEVICE(0x041e, 0x4068)},
2156         {USB_DEVICE(0x045e, 0x028c)},
2157         {USB_DEVICE(0x054c, 0x0154)},
2158         {USB_DEVICE(0x054c, 0x0155)},
2159         {USB_DEVICE(0x05a9, 0x0519)},
2160         {USB_DEVICE(0x05a9, 0x0530)},
2161         {USB_DEVICE(0x05a9, 0x4519)},
2162         {USB_DEVICE(0x05a9, 0x8519)},
2163         {}
2164 };
2165 #undef DVNAME
2166 MODULE_DEVICE_TABLE(usb, device_table);
2167
2168 /* -- device connect -- */
2169 static int sd_probe(struct usb_interface *intf,
2170                         const struct usb_device_id *id)
2171 {
2172         return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
2173                                 THIS_MODULE);
2174 }
2175
2176 static struct usb_driver sd_driver = {
2177         .name = MODULE_NAME,
2178         .id_table = device_table,
2179         .probe = sd_probe,
2180         .disconnect = gspca_disconnect,
2181 #ifdef CONFIG_PM
2182         .suspend = gspca_suspend,
2183         .resume = gspca_resume,
2184 #endif
2185 };
2186
2187 /* -- module insert / remove -- */
2188 static int __init sd_mod_init(void)
2189 {
2190         if (usb_register(&sd_driver) < 0)
2191                 return -1;
2192         PDEBUG(D_PROBE, "registered");
2193         return 0;
2194 }
2195 static void __exit sd_mod_exit(void)
2196 {
2197         usb_deregister(&sd_driver);
2198         PDEBUG(D_PROBE, "deregistered");
2199 }
2200
2201 module_init(sd_mod_init);
2202 module_exit(sd_mod_exit);
2203
2204 module_param(frame_rate, int, 0644);
2205 MODULE_PARM_DESC(frame_rate, "Frame rate (5, 10, 15, 20 or 30 fps)");