]> git.proxmox.com Git - mirror_ubuntu-jammy-kernel.git/blame - drivers/media/video/gspca/sonixj.c
projects / mirror_ubuntu-jammy-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
V4L/DVB (13300): gspca - pac7302/pac7311: Separate the two subdrivers.
[mirror_ubuntu-jammy-kernel.git] / drivers / media / video / gspca / sonixj.c
CommitLineData
6a7eba24
JFM		 1/*
2 * Sonix sn9c102p sn9c105 sn9c120 (jpeg) library
3 * Copyright (C) 2005 Michel Xhaard mxhaard@magic.fr
4 *
5 * V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 */
21
22#define MODULE_NAME "sonixj"
23
24#include "gspca.h"
25#include "jpeg.h"
26
0cae8964
JFM		 27#define V4L2_CID_INFRARED (V4L2_CID_PRIVATE_BASE + 0)
28
6a7eba24
JFM		 29MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>");
30MODULE_DESCRIPTION("GSPCA/SONIX JPEG USB Camera Driver");
31MODULE_LICENSE("GPL");
32
33/* specific webcam descriptor */
34struct sd {
35 struct gspca_dev gspca_dev; /* !! must be the first item */
36
cebf3b67 37 atomic_t avg_lum;
98819187
JFM		 38 u32 exposure;
39
40 u16 brightness;
41 u8 contrast;
42 u8 colors;
43 u8 autogain;
44 u8 blue;
45 u8 red;
592f4eb9 46 u8 gamma;
2797ba2a 47 u8 vflip; /* ov7630/ov7648 only */
3ef2c5be 48 u8 infrared; /* mt9v111 only */
37c6dbe2 49 u8 freq; /* ov76xx only */
71cb2764 50 u8 quality; /* image quality */
77ac0baf
JFM		 51#define QUALITY_MIN 60
52#define QUALITY_MAX 95
53#define QUALITY_DEF 80
71cb2764
JFM		 54 u8 jpegqual; /* webcam quality */
55
56 u8 reg18;
6a7eba24 57
98819187 58 s8 ag_cnt;
6a7eba24
JFM		 59#define AG_CNT_START 13
60
98819187 61 u8 bridge;
3647fea8
HG		 62#define BRIDGE_SN9C102P 0
63#define BRIDGE_SN9C105 1
64#define BRIDGE_SN9C110 2
65#define BRIDGE_SN9C120 3
98819187 66 u8 sensor; /* Type of image sensor chip */
6a7eba24
JFM		 67#define SENSOR_HV7131R 0
68#define SENSOR_MI0360 1
69#define SENSOR_MO4000 2
3ef2c5be
JFM		 70#define SENSOR_MT9V111 3
71#define SENSOR_OM6802 4
72#define SENSOR_OV7630 5
73#define SENSOR_OV7648 6
74#define SENSOR_OV7660 7
5e31dc8d 75#define SENSOR_SP80708 8
98819187 76 u8 i2c_base;
71cb2764
JFM		 77
78 u8 *jpeg_hdr;
6a7eba24
JFM		 79};
80
81/* V4L2 controls supported by the driver */
82static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val);
83static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val);
84static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val);
85static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val);
86static int sd_setcolors(struct gspca_dev *gspca_dev, __s32 val);
87static int sd_getcolors(struct gspca_dev *gspca_dev, __s32 *val);
403123d2
JFM		 88static int sd_setblue_balance(struct gspca_dev *gspca_dev, __s32 val);
89static int sd_getblue_balance(struct gspca_dev *gspca_dev, __s32 *val);
90static int sd_setred_balance(struct gspca_dev *gspca_dev, __s32 val);
91static int sd_getred_balance(struct gspca_dev *gspca_dev, __s32 *val);
592f4eb9
JFM		 92static int sd_setgamma(struct gspca_dev *gspca_dev, __s32 val);
93static int sd_getgamma(struct gspca_dev *gspca_dev, __s32 *val);
6a7eba24
JFM		 94static int sd_setautogain(struct gspca_dev *gspca_dev, __s32 val);
95static int sd_getautogain(struct gspca_dev *gspca_dev, __s32 *val);
6c86274f
JFM		 96static int sd_setvflip(struct gspca_dev *gspca_dev, __s32 val);
97static int sd_getvflip(struct gspca_dev *gspca_dev, __s32 *val);
0cae8964
JFM		 98static int sd_setinfrared(struct gspca_dev *gspca_dev, __s32 val);
99static int sd_getinfrared(struct gspca_dev *gspca_dev, __s32 *val);
37c6dbe2
HG		 100static int sd_setfreq(struct gspca_dev *gspca_dev, __s32 val);
101static int sd_getfreq(struct gspca_dev *gspca_dev, __s32 *val);
6a7eba24
JFM		 102
103static struct ctrl sd_ctrls[] = {
9764398b 104#define BRIGHTNESS_IDX 0
6a7eba24
JFM		 105 {
106 {
107 .id = V4L2_CID_BRIGHTNESS,
108 .type = V4L2_CTRL_TYPE_INTEGER,
109 .name = "Brightness",
110 .minimum = 0,
05b809c7
JFM		 111#define BRIGHTNESS_MAX 0xffff
112 .maximum = BRIGHTNESS_MAX,
6a7eba24 113 .step = 1,
b1b056a5 114#define BRIGHTNESS_DEF 0x8000
a5ae2062 115 .default_value = BRIGHTNESS_DEF,
6a7eba24
JFM		 116 },
117 .set = sd_setbrightness,
118 .get = sd_getbrightness,
119 },
9764398b 120#define CONTRAST_IDX 1
6a7eba24
JFM		 121 {
122 {
123 .id = V4L2_CID_CONTRAST,
124 .type = V4L2_CTRL_TYPE_INTEGER,
125 .name = "Contrast",
126 .minimum = 0,
05b809c7
JFM		 127#define CONTRAST_MAX 127
128 .maximum = CONTRAST_MAX,
6a7eba24 129 .step = 1,
a5ae2062
JFM		 130#define CONTRAST_DEF 63
131 .default_value = CONTRAST_DEF,
6a7eba24
JFM		 132 },
133 .set = sd_setcontrast,
134 .get = sd_getcontrast,
135 },
9764398b 136#define COLOR_IDX 2
6a7eba24
JFM		 137 {
138 {
139 .id = V4L2_CID_SATURATION,
140 .type = V4L2_CTRL_TYPE_INTEGER,
3fb4a57b 141 .name = "Saturation",
6a7eba24 142 .minimum = 0,
403123d2 143 .maximum = 40,
6a7eba24 144 .step = 1,
3fb4a57b 145#define COLOR_DEF 25
a5ae2062 146 .default_value = COLOR_DEF,
6a7eba24
JFM		 147 },
148 .set = sd_setcolors,
149 .get = sd_getcolors,
150 },
9764398b 151#define BLUE_BALANCE_IDX 3
403123d2
JFM		 152 {
153 {
154 .id = V4L2_CID_BLUE_BALANCE,
155 .type = V4L2_CTRL_TYPE_INTEGER,
156 .name = "Blue Balance",
157 .minimum = 24,
158 .maximum = 40,
159 .step = 1,
160#define BLUE_BALANCE_DEF 32
161 .default_value = BLUE_BALANCE_DEF,
162 },
163 .set = sd_setblue_balance,
164 .get = sd_getblue_balance,
165 },
9764398b 166#define RED_BALANCE_IDX 4
403123d2
JFM		 167 {
168 {
169 .id = V4L2_CID_RED_BALANCE,
170 .type = V4L2_CTRL_TYPE_INTEGER,
171 .name = "Red Balance",
172 .minimum = 24,
173 .maximum = 40,
174 .step = 1,
175#define RED_BALANCE_DEF 32
176 .default_value = RED_BALANCE_DEF,
177 },
178 .set = sd_setred_balance,
179 .get = sd_getred_balance,
180 },
9764398b 181#define GAMMA_IDX 5
592f4eb9
JFM		 182 {
183 {
184 .id = V4L2_CID_GAMMA,
185 .type = V4L2_CTRL_TYPE_INTEGER,
186 .name = "Gamma",
187 .minimum = 0,
188 .maximum = 40,
189 .step = 1,
190#define GAMMA_DEF 20
191 .default_value = GAMMA_DEF,
192 },
193 .set = sd_setgamma,
194 .get = sd_getgamma,
195 },
9764398b 196#define AUTOGAIN_IDX 6
6a7eba24
JFM		 197 {
198 {
199 .id = V4L2_CID_AUTOGAIN,
200 .type = V4L2_CTRL_TYPE_BOOLEAN,
201 .name = "Auto Gain",
202 .minimum = 0,
203 .maximum = 1,
204 .step = 1,
a5ae2062
JFM		 205#define AUTOGAIN_DEF 1
206 .default_value = AUTOGAIN_DEF,
6a7eba24
JFM		 207 },
208 .set = sd_setautogain,
209 .get = sd_getautogain,
210 },
2797ba2a 211/* ov7630/ov7648 only */
9764398b 212#define VFLIP_IDX 7
6c86274f
JFM		 213 {
214 {
215 .id = V4L2_CID_VFLIP,
216 .type = V4L2_CTRL_TYPE_BOOLEAN,
217 .name = "Vflip",
218 .minimum = 0,
219 .maximum = 1,
220 .step = 1,
f800952c 221#define VFLIP_DEF 0
6c86274f
JFM		 222 .default_value = VFLIP_DEF,
223 },
224 .set = sd_setvflip,
225 .get = sd_getvflip,
226 },
3ef2c5be 227/* mt9v111 only */
9764398b 228#define INFRARED_IDX 8
0cae8964
JFM		 229 {
230 {
231 .id = V4L2_CID_INFRARED,
232 .type = V4L2_CTRL_TYPE_BOOLEAN,
233 .name = "Infrared",
234 .minimum = 0,
235 .maximum = 1,
236 .step = 1,
237#define INFRARED_DEF 0
238 .default_value = INFRARED_DEF,
239 },
240 .set = sd_setinfrared,
241 .get = sd_getinfrared,
242 },
37c6dbe2
HG		 243/* ov7630/ov7648/ov7660 only */
244#define FREQ_IDX 9
245 {
246 {
247 .id = V4L2_CID_POWER_LINE_FREQUENCY,
248 .type = V4L2_CTRL_TYPE_MENU,
249 .name = "Light frequency filter",
250 .minimum = 0,
251 .maximum = 2, /* 0: 0, 1: 50Hz, 2:60Hz */
252 .step = 1,
253#define FREQ_DEF 2
254 .default_value = FREQ_DEF,
255 },
256 .set = sd_setfreq,
257 .get = sd_getfreq,
258 },
6a7eba24
JFM		 259};
260
577cbf49
JFM		 261/* table of the disabled controls */
262static __u32 ctrl_dis[] = {
37c6dbe2 263 (1 << INFRARED_IDX) | (1 << VFLIP_IDX) | (1 << FREQ_IDX),
577cbf49 264 /* SENSOR_HV7131R 0 */
37c6dbe2 265 (1 << INFRARED_IDX) | (1 << VFLIP_IDX) | (1 << FREQ_IDX),
577cbf49 266 /* SENSOR_MI0360 1 */
37c6dbe2 267 (1 << INFRARED_IDX) | (1 << VFLIP_IDX) | (1 << FREQ_IDX),
577cbf49 268 /* SENSOR_MO4000 2 */
37c6dbe2 269 (1 << VFLIP_IDX) | (1 << FREQ_IDX),
3ef2c5be 270 /* SENSOR_MT9V111 3 */
37c6dbe2 271 (1 << INFRARED_IDX) | (1 << VFLIP_IDX) | (1 << FREQ_IDX),
3ef2c5be 272 /* SENSOR_OM6802 4 */
1fec747c 273 (1 << INFRARED_IDX),
3ef2c5be 274 /* SENSOR_OV7630 5 */
2797ba2a 275 (1 << INFRARED_IDX),
3ef2c5be 276 /* SENSOR_OV7648 6 */
577cbf49 277 (1 << AUTOGAIN_IDX) | (1 << INFRARED_IDX) | (1 << VFLIP_IDX),
3ef2c5be 278 /* SENSOR_OV7660 7 */
37c6dbe2
HG		 279 (1 << AUTOGAIN_IDX) | (1 << INFRARED_IDX) | (1 << VFLIP_IDX) |
280 (1 << FREQ_IDX), /* SENSOR_SP80708 8 */
577cbf49
JFM		 281};
282
cc611b8a 283static const struct v4l2_pix_format vga_mode[] = {
c2446b3e
JFM		 284 {160, 120, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
285 .bytesperline = 160,
5d05294a 286 .sizeimage = 160 * 120 * 4 / 8 + 590,
c2446b3e
JFM		 287 .colorspace = V4L2_COLORSPACE_JPEG,
288 .priv = 2},
289 {320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
290 .bytesperline = 320,
291 .sizeimage = 320 * 240 * 3 / 8 + 590,
292 .colorspace = V4L2_COLORSPACE_JPEG,
293 .priv = 1},
294 {640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
295 .bytesperline = 640,
a5d1cc39
HG		 296 /* Note 3 / 8 is not large enough, not even 5 / 8 is ?! */
297 .sizeimage = 640 * 480 * 3 / 4 + 590,
c2446b3e
JFM		 298 .colorspace = V4L2_COLORSPACE_JPEG,
299 .priv = 0},
6a7eba24
JFM		 300};
301
8c2ba441
JFM		 302/*Data from sn9c102p+hv7131r */
303static const u8 sn_hv7131[0x1c] = {
8f47a3ce
JFM		 304/* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
305 0x00, 0x03, 0x64, 0x00, 0x1a, 0x20, 0x20, 0x20,
306/* reg8 reg9 rega regb regc regd rege regf */
307 0xa1, 0x11, 0x02, 0x09, 0x00, 0x00, 0x00, 0x10,
308/* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
309 0x03, 0x00, 0x00, 0x01, 0x03, 0x28, 0x1e, 0x41,
8c2ba441
JFM		 310/* reg18 reg19 reg1a reg1b */
311 0x0a, 0x00, 0x00, 0x00
6a7eba24
JFM		 312};
313
8c2ba441 314static const u8 sn_mi0360[0x1c] = {
8f47a3ce
JFM		 315/* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
316 0x00, 0x61, 0x44, 0x00, 0x1a, 0x20, 0x20, 0x20,
317/* reg8 reg9 rega regb regc regd rege regf */
318 0xb1, 0x5d, 0x07, 0x00, 0x00, 0x00, 0x00, 0x10,
319/* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
320 0x03, 0x00, 0x00, 0x02, 0x0a, 0x28, 0x1e, 0x61,
8c2ba441
JFM		 321/* reg18 reg19 reg1a reg1b */
322 0x06, 0x00, 0x00, 0x00
6a7eba24
JFM		 323};
324
8c2ba441 325static const u8 sn_mo4000[0x1c] = {
8f47a3ce 326/* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
8c2ba441 327 0x00, 0x23, 0x60, 0x00, 0x1a, 0x00, 0x20, 0x18,
8f47a3ce
JFM		 328/* reg8 reg9 rega regb regc regd rege regf */
329 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
330/* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
331 0x03, 0x00, 0x0b, 0x0f, 0x14, 0x28, 0x1e, 0x40,
8c2ba441
JFM		 332/* reg18 reg19 reg1a reg1b */
333 0x08, 0x00, 0x00, 0x00
6a7eba24
JFM		 334};
335
3ef2c5be
JFM		 336static const u8 sn_mt9v111[0x1c] = {
337/* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
338 0x00, 0x61, 0x40, 0x00, 0x1a, 0x20, 0x20, 0x20,
339/* reg8 reg9 rega regb regc regd rege regf */
340 0x81, 0x5c, 0x07, 0x00, 0x00, 0x00, 0x00, 0x00,
341/* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
342 0x03, 0x00, 0x00, 0x02, 0x1c, 0x28, 0x1e, 0x40,
343/* reg18 reg19 reg1a reg1b */
344 0x06, 0x00, 0x00, 0x00
345};
346
8c2ba441 347static const u8 sn_om6802[0x1c] = {
d2d16e90 348/* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
46b4f2ab 349 0x00, 0x23, 0x72, 0x00, 0x1a, 0x20, 0x20, 0x19,
d2d16e90
JFM		 350/* reg8 reg9 rega regb regc regd rege regf */
351 0x80, 0x34, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
352/* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
353 0x03, 0x00, 0x51, 0x01, 0x00, 0x28, 0x1e, 0x40,
8c2ba441
JFM		 354/* reg18 reg19 reg1a reg1b */
355 0x05, 0x00, 0x00, 0x00
d2d16e90
JFM		 356};
357
8c2ba441 358static const u8 sn_ov7630[0x1c] = {
6ab0b174
JFM		 359/* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
360 0x00, 0x21, 0x40, 0x00, 0x1a, 0x20, 0x1f, 0x20,
361/* reg8 reg9 rega regb regc regd rege regf */
362 0xa1, 0x21, 0x76, 0x21, 0x00, 0x00, 0x00, 0x10,
363/* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
364 0x03, 0x00, 0x04, 0x01, 0x0a, 0x28, 0x1e, 0xc2,
8c2ba441
JFM		 365/* reg18 reg19 reg1a reg1b */
366 0x0b, 0x00, 0x00, 0x00
6ab0b174
JFM		 367};
368
8c2ba441 369static const u8 sn_ov7648[0x1c] = {
8f47a3ce 370/* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
6270330a 371 0x00, 0x63, 0x40, 0x00, 0x1a, 0x20, 0x20, 0x20,
8f47a3ce 372/* reg8 reg9 rega regb regc regd rege regf */
6270330a 373 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10,
8f47a3ce 374/* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
6270330a 375 0x03, 0x00, 0x00, 0x01, 0x00, 0x28, 0x1e, 0x00,
8c2ba441
JFM		 376/* reg18 reg19 reg1a reg1b */
377 0x0b, 0x00, 0x00, 0x00
6a7eba24
JFM		 378};
379
8c2ba441 380static const u8 sn_ov7660[0x1c] = {
8f47a3ce 381/* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
c8b9b2ca 382 0x00, 0x61, 0x40, 0x00, 0x1a, 0x00, 0x00, 0x00,
8f47a3ce 383/* reg8 reg9 rega regb regc regd rege regf */
c8b9b2ca 384 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
8f47a3ce
JFM		 385/* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
386 0x03, 0x00, 0x01, 0x01, 0x08, 0x28, 0x1e, 0x20,
8c2ba441
JFM		 387/* reg18 reg19 reg1a reg1b */
388 0x07, 0x00, 0x00, 0x00
6a7eba24
JFM		 389};
390
5e31dc8d
JFM		 391static const u8 sn_sp80708[0x1c] = {
392/* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
393 0x00, 0x63, 0x60, 0x00, 0x1a, 0x20, 0x20, 0x20,
394/* reg8 reg9 rega regb regc regd rege regf */
395 0x81, 0x18, 0x07, 0x00, 0x00, 0x00, 0x00, 0x00,
396/* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
397 0x03, 0x00, 0x00, 0x03, 0x04, 0x28, 0x1e, 0x00,
398/* reg18 reg19 reg1a reg1b */
399 0x07, 0x00, 0x00, 0x00
400};
401
6a7eba24 402/* sequence specific to the sensors - !! index = SENSOR_xxx */
8c2ba441 403static const u8 *sn_tb[] = {
6a7eba24
JFM		 404 sn_hv7131,
405 sn_mi0360,
406 sn_mo4000,
3ef2c5be 407 sn_mt9v111,
d2d16e90 408 sn_om6802,
6ab0b174 409 sn_ov7630,
6a7eba24 410 sn_ov7648,
5e31dc8d
JFM		 411 sn_ov7660,
412 sn_sp80708
6a7eba24
JFM		 413};
414
b083b92f 415/* default gamma table */
98819187 416static const u8 gamma_def[17] = {
6a7eba24
JFM		 417 0x00, 0x2d, 0x46, 0x5a, 0x6c, 0x7c, 0x8b, 0x99,
418 0xa6, 0xb2, 0xbf, 0xca, 0xd5, 0xe0, 0xeb, 0xf5, 0xff
419};
b083b92f
JFM		 420/* gamma for sensors HV7131R and MT9V111 */
421static const u8 gamma_spec_1[17] = {
422 0x08, 0x3a, 0x52, 0x65, 0x75, 0x83, 0x91, 0x9d,
423 0xa9, 0xb4, 0xbe, 0xc8, 0xd2, 0xdb, 0xe4, 0xed, 0xf5
424};
425/* gamma for sensor SP80708 */
426static const u8 gamma_spec_2[17] = {
427 0x0a, 0x2d, 0x4e, 0x68, 0x7d, 0x8f, 0x9f, 0xab,
428 0xb7, 0xc2, 0xcc, 0xd3, 0xd8, 0xde, 0xe2, 0xe5, 0xe6
429};
592f4eb9 430
803f9ccf 431/* color matrix and offsets */
98819187 432static const u8 reg84[] = {
803f9ccf
JFM		 433 0x14, 0x00, 0x27, 0x00, 0x07, 0x00, /* YR YG YB gains */
434 0xe8, 0x0f, 0xda, 0x0f, 0x40, 0x00, /* UR UG UB */
435 0x3e, 0x00, 0xcd, 0x0f, 0xf7, 0x0f, /* VR VG VB */
436 0x00, 0x00, 0x00 /* YUV offsets */
6a7eba24 437};
98819187 438static const u8 hv7131r_sensor_init[][8] = {
8c2ba441
JFM		 439 {0xc1, 0x11, 0x01, 0x08, 0x01, 0x00, 0x00, 0x10},
440 {0xb1, 0x11, 0x34, 0x17, 0x7f, 0x00, 0x00, 0x10},
441 {0xd1, 0x11, 0x40, 0xff, 0x7f, 0x7f, 0x7f, 0x10},
442/* {0x91, 0x11, 0x44, 0x00, 0x00, 0x00, 0x00, 0x10}, */
443 {0xd1, 0x11, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
444 {0xd1, 0x11, 0x14, 0x01, 0xe2, 0x02, 0x82, 0x10},
445/* {0x91, 0x11, 0x18, 0x00, 0x00, 0x00, 0x00, 0x10}, */
446
447 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
448 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
449 {0xc1, 0x11, 0x25, 0x00, 0x61, 0xa8, 0x00, 0x10},
450 {0xa1, 0x11, 0x30, 0x22, 0x00, 0x00, 0x00, 0x10},
451 {0xc1, 0x11, 0x31, 0x20, 0x2e, 0x20, 0x00, 0x10},
452 {0xc1, 0x11, 0x25, 0x00, 0xc3, 0x50, 0x00, 0x10},
453 {0xa1, 0x11, 0x30, 0x07, 0x00, 0x00, 0x00, 0x10}, /* gain14 */
454 {0xc1, 0x11, 0x31, 0x10, 0x10, 0x10, 0x00, 0x10}, /* r g b 101a10 */
455
456 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
457 {0xa1, 0x11, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
7fb101ae 458 {0xa1, 0x11, 0x21, 0xd0, 0x00, 0x00, 0x00, 0x10},
8c2ba441
JFM		 459 {0xa1, 0x11, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
460 {0xa1, 0x11, 0x23, 0x09, 0x00, 0x00, 0x00, 0x10},
461
462 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
463 {0xa1, 0x11, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
464 {0xa1, 0x11, 0x21, 0xd0, 0x00, 0x00, 0x00, 0x10},
465 {0xa1, 0x11, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
466 {0xa1, 0x11, 0x23, 0x10, 0x00, 0x00, 0x00, 0x10},
a5ae2062 467 {}
6a7eba24 468};
98819187 469static const u8 mi0360_sensor_init[][8] = {
8c2ba441 470 {0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10},
98819187 471 {0xb1, 0x5d, 0x0d, 0x00, 0x01, 0x00, 0x00, 0x10},
3ef2c5be 472 {0xb1, 0x5d, 0x0d, 0x00, 0x00, 0x00, 0x00, 0x10},
8c2ba441
JFM		 473 {0xd1, 0x5d, 0x01, 0x00, 0x08, 0x00, 0x16, 0x10},
474 {0xd1, 0x5d, 0x03, 0x01, 0xe2, 0x02, 0x82, 0x10},
475 {0xd1, 0x5d, 0x05, 0x00, 0x09, 0x00, 0x53, 0x10},
476 {0xb1, 0x5d, 0x0d, 0x00, 0x02, 0x00, 0x00, 0x10},
477 {0xd1, 0x5d, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x10},
478 {0xd1, 0x5d, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x10},
479 {0xd1, 0x5d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x10},
480 {0xd1, 0x5d, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
481 {0xd1, 0x5d, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
482 {0xd1, 0x5d, 0x14, 0x00, 0x00, 0x00, 0x00, 0x10},
483 {0xd1, 0x5d, 0x16, 0x00, 0x00, 0x00, 0x00, 0x10},
484 {0xd1, 0x5d, 0x18, 0x00, 0x00, 0x00, 0x00, 0x10},
485 {0xd1, 0x5d, 0x1a, 0x00, 0x00, 0x00, 0x00, 0x10},
486 {0xd1, 0x5d, 0x1c, 0x00, 0x00, 0x00, 0x00, 0x10},
487 {0xb1, 0x5d, 0x32, 0x00, 0x00, 0x00, 0x00, 0x10},
488 {0xd1, 0x5d, 0x20, 0x91, 0x01, 0x00, 0x00, 0x10},
489 {0xd1, 0x5d, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
490 {0xd1, 0x5d, 0x24, 0x00, 0x00, 0x00, 0x00, 0x10},
491 {0xd1, 0x5d, 0x26, 0x00, 0x00, 0x00, 0x24, 0x10},
98819187 492 {0xd1, 0x5d, 0x2f, 0xf7, 0xB0, 0x00, 0x04, 0x10},
8c2ba441
JFM		 493 {0xd1, 0x5d, 0x31, 0x00, 0x00, 0x00, 0x00, 0x10},
494 {0xd1, 0x5d, 0x33, 0x00, 0x00, 0x01, 0x00, 0x10},
495 {0xb1, 0x5d, 0x3d, 0x06, 0x8f, 0x00, 0x00, 0x10},
496 {0xd1, 0x5d, 0x40, 0x01, 0xe0, 0x00, 0xd1, 0x10},
497 {0xb1, 0x5d, 0x44, 0x00, 0x82, 0x00, 0x00, 0x10},
498 {0xd1, 0x5d, 0x58, 0x00, 0x78, 0x00, 0x43, 0x10},
499 {0xd1, 0x5d, 0x5a, 0x00, 0x00, 0x00, 0x00, 0x10},
500 {0xd1, 0x5d, 0x5c, 0x00, 0x00, 0x00, 0x00, 0x10},
501 {0xd1, 0x5d, 0x5e, 0x00, 0x00, 0xa3, 0x1d, 0x10},
502 {0xb1, 0x5d, 0x62, 0x04, 0x11, 0x00, 0x00, 0x10},
503
504 {0xb1, 0x5d, 0x20, 0x91, 0x01, 0x00, 0x00, 0x10},
505 {0xb1, 0x5d, 0x20, 0x11, 0x01, 0x00, 0x00, 0x10},
506 {0xb1, 0x5d, 0x09, 0x00, 0x64, 0x00, 0x00, 0x10},
507 {0xd1, 0x5d, 0x2b, 0x00, 0xa0, 0x00, 0xb0, 0x10},
508 {0xd1, 0x5d, 0x2d, 0x00, 0xa0, 0x00, 0xa0, 0x10},
509
510 {0xb1, 0x5d, 0x0a, 0x00, 0x02, 0x00, 0x00, 0x10}, /* sensor clck ?2 */
511 {0xb1, 0x5d, 0x06, 0x00, 0x30, 0x00, 0x00, 0x10},
512 {0xb1, 0x5d, 0x05, 0x00, 0x0a, 0x00, 0x00, 0x10},
513 {0xb1, 0x5d, 0x09, 0x02, 0x35, 0x00, 0x00, 0x10}, /* exposure 2 */
514
515 {0xd1, 0x5d, 0x2b, 0x00, 0xb9, 0x00, 0xe3, 0x10},
516 {0xd1, 0x5d, 0x2d, 0x00, 0x5f, 0x00, 0xb9, 0x10}, /* 42 */
517/* {0xb1, 0x5d, 0x35, 0x00, 0x67, 0x00, 0x00, 0x10}, * gain orig */
518/* {0xb1, 0x5d, 0x35, 0x00, 0x20, 0x00, 0x00, 0x10}, * gain */
519 {0xb1, 0x5d, 0x07, 0x00, 0x03, 0x00, 0x00, 0x10}, /* update */
520 {0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10}, /* sensor on */
a5ae2062 521 {}
6a7eba24 522};
98819187 523static const u8 mo4000_sensor_init[][8] = {
6a7eba24
JFM		 524 {0xa1, 0x21, 0x01, 0x02, 0x00, 0x00, 0x00, 0x10},
525 {0xa1, 0x21, 0x02, 0x00, 0x00, 0x00, 0x00, 0x10},
526 {0xa1, 0x21, 0x03, 0x00, 0x00, 0x00, 0x00, 0x10},
527 {0xa1, 0x21, 0x04, 0x00, 0x00, 0x00, 0x00, 0x10},
528 {0xa1, 0x21, 0x05, 0x00, 0x00, 0x00, 0x00, 0x10},
529 {0xa1, 0x21, 0x05, 0x04, 0x00, 0x00, 0x00, 0x10},
530 {0xa1, 0x21, 0x06, 0x80, 0x00, 0x00, 0x00, 0x10},
531 {0xa1, 0x21, 0x06, 0x81, 0x00, 0x00, 0x00, 0x10},
532 {0xa1, 0x21, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x10},
533 {0xa1, 0x21, 0x11, 0x00, 0x00, 0x00, 0x00, 0x10},
534 {0xa1, 0x21, 0x11, 0x20, 0x00, 0x00, 0x00, 0x10},
535 {0xa1, 0x21, 0x11, 0x30, 0x00, 0x00, 0x00, 0x10},
536 {0xa1, 0x21, 0x11, 0x38, 0x00, 0x00, 0x00, 0x10},
537 {0xa1, 0x21, 0x11, 0x38, 0x00, 0x00, 0x00, 0x10},
538 {0xa1, 0x21, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
539 {0xa1, 0x21, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
540 {0xa1, 0x21, 0x0f, 0x20, 0x00, 0x00, 0x00, 0x10},
541 {0xa1, 0x21, 0x10, 0x20, 0x00, 0x00, 0x00, 0x10},
542 {0xa1, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
543 {0xa1, 0x21, 0x11, 0x38, 0x00, 0x00, 0x00, 0x10},
a5ae2062 544 {}
6a7eba24 545};
3ef2c5be
JFM		 546static const u8 mt9v111_sensor_init[][8] = {
547 {0xb1, 0x5c, 0x0d, 0x00, 0x01, 0x00, 0x00, 0x10}, /* reset? */
548 /* delay 20 ms */
549 {0xb1, 0x5c, 0x0d, 0x00, 0x00, 0x00, 0x00, 0x10},
550 {0xb1, 0x5c, 0x01, 0x00, 0x01, 0x00, 0x00, 0x10}, /* IFP select */
551 {0xb1, 0x5c, 0x08, 0x04, 0x80, 0x00, 0x00, 0x10}, /* output fmt ctrl */
552 {0xb1, 0x5c, 0x06, 0x00, 0x00, 0x00, 0x00, 0x10}, /* op mode ctrl */
2687a2fb
JFM		 553 {0xb1, 0x5c, 0x02, 0x00, 0x16, 0x00, 0x00, 0x10},
554 {0xb1, 0x5c, 0x03, 0x01, 0xe1, 0x00, 0x00, 0x10},
555 {0xb1, 0x5c, 0x04, 0x02, 0x81, 0x00, 0x00, 0x10},
556 {0xb1, 0x5c, 0x05, 0x00, 0x04, 0x00, 0x00, 0x10},
3ef2c5be 557 {0xb1, 0x5c, 0x01, 0x00, 0x04, 0x00, 0x00, 0x10}, /* sensor select */
2687a2fb
JFM		 558 {0xb1, 0x5c, 0x02, 0x00, 0x16, 0x00, 0x00, 0x10},
559 {0xb1, 0x5c, 0x03, 0x01, 0xe6, 0x00, 0x00, 0x10},
560 {0xb1, 0x5c, 0x04, 0x02, 0x86, 0x00, 0x00, 0x10},
561 {0xb1, 0x5c, 0x05, 0x00, 0x04, 0x00, 0x00, 0x10},
562 {0xb1, 0x5c, 0x06, 0x00, 0x00, 0x00, 0x00, 0x10},
3ef2c5be 563 {0xb1, 0x5c, 0x08, 0x00, 0x08, 0x00, 0x00, 0x10}, /* row start */
2687a2fb 564 {0xb1, 0x5c, 0x0e, 0x00, 0x08, 0x00, 0x00, 0x10},
3ef2c5be
JFM		 565 {0xb1, 0x5c, 0x02, 0x00, 0x16, 0x00, 0x00, 0x10}, /* col start */
566 {0xb1, 0x5c, 0x03, 0x01, 0xe7, 0x00, 0x00, 0x10}, /* window height */
567 {0xb1, 0x5c, 0x04, 0x02, 0x87, 0x00, 0x00, 0x10}, /* window width */
568 {0xb1, 0x5c, 0x07, 0x30, 0x02, 0x00, 0x00, 0x10}, /* output ctrl */
569 {0xb1, 0x5c, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x10}, /* shutter delay */
570 {0xb1, 0x5c, 0x12, 0x00, 0xb0, 0x00, 0x00, 0x10}, /* zoom col start */
571 {0xb1, 0x5c, 0x13, 0x00, 0x7c, 0x00, 0x00, 0x10}, /* zoom row start */
572 {0xb1, 0x5c, 0x1e, 0x00, 0x00, 0x00, 0x00, 0x10}, /* digital zoom */
573 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10}, /* read mode */
574 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
575 /*******/
576 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
577 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
2687a2fb 578 {0xb1, 0x5c, 0x09, 0x01, 0x2c, 0x00, 0x00, 0x10},
3ef2c5be
JFM		 579 {0xd1, 0x5c, 0x2b, 0x00, 0x33, 0x00, 0xa0, 0x10}, /* green1 gain */
580 {0xd1, 0x5c, 0x2d, 0x00, 0xa0, 0x00, 0x33, 0x10}, /* red gain */
581 /*******/
582 {0xb1, 0x5c, 0x06, 0x00, 0x1e, 0x00, 0x00, 0x10}, /* vert blanking */
583 {0xb1, 0x5c, 0x05, 0x00, 0x0a, 0x00, 0x00, 0x10}, /* horiz blanking */
584 {0xd1, 0x5c, 0x2c, 0x00, 0xad, 0x00, 0xad, 0x10}, /* blue gain */
585 {0xb1, 0x5c, 0x35, 0x01, 0xc0, 0x00, 0x00, 0x10}, /* global gain */
586 {}
587};
98819187 588static const u8 om6802_sensor_init[][8] = {
d2d16e90
JFM		 589 {0xa0, 0x34, 0x90, 0x05, 0x00, 0x00, 0x00, 0x10},
590 {0xa0, 0x34, 0x49, 0x85, 0x00, 0x00, 0x00, 0x10},
591 {0xa0, 0x34, 0x5a, 0xc0, 0x00, 0x00, 0x00, 0x10},
592 {0xa0, 0x34, 0xdd, 0x18, 0x00, 0x00, 0x00, 0x10},
593/* {0xa0, 0x34, 0xfb, 0x11, 0x00, 0x00, 0x00, 0x10}, */
594 {0xa0, 0x34, 0xf0, 0x04, 0x00, 0x00, 0x00, 0x10},
595 /* white balance & auto-exposure */
596/* {0xa0, 0x34, 0xf1, 0x02, 0x00, 0x00, 0x00, 0x10},
597 * set color mode */
598/* {0xa0, 0x34, 0xfe, 0x5b, 0x00, 0x00, 0x00, 0x10},
599 * max AGC value in AE */
600/* {0xa0, 0x34, 0xe5, 0x00, 0x00, 0x00, 0x00, 0x10},
601 * preset AGC */
602/* {0xa0, 0x34, 0xe6, 0x00, 0x00, 0x00, 0x00, 0x10},
603 * preset brightness */
604/* {0xa0, 0x34, 0xe7, 0x00, 0x00, 0x00, 0x00, 0x10},
605 * preset contrast */
606/* {0xa0, 0x34, 0xe8, 0x31, 0x00, 0x00, 0x00, 0x10},
607 * preset gamma */
608 {0xa0, 0x34, 0xe9, 0x0f, 0x00, 0x00, 0x00, 0x10},
609 /* luminance mode (0x4f = AE) */
610 {0xa0, 0x34, 0xe4, 0xff, 0x00, 0x00, 0x00, 0x10},
611 /* preset shutter */
612/* {0xa0, 0x34, 0xef, 0x00, 0x00, 0x00, 0x00, 0x10},
613 * auto frame rate */
614/* {0xa0, 0x34, 0xfb, 0xee, 0x00, 0x00, 0x00, 0x10}, */
615
616/* {0xa0, 0x34, 0x71, 0x84, 0x00, 0x00, 0x00, 0x10}, */
617/* {0xa0, 0x34, 0x72, 0x05, 0x00, 0x00, 0x00, 0x10}, */
618/* {0xa0, 0x34, 0x68, 0x80, 0x00, 0x00, 0x00, 0x10}, */
619/* {0xa0, 0x34, 0x69, 0x01, 0x00, 0x00, 0x00, 0x10}, */
620 {}
621};
98819187 622static const u8 ov7630_sensor_init[][8] = {
6ab0b174
JFM		 623 {0xa1, 0x21, 0x76, 0x01, 0x00, 0x00, 0x00, 0x10},
624 {0xa1, 0x21, 0x12, 0xc8, 0x00, 0x00, 0x00, 0x10},
625/* win: delay 20ms */
626 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
627 {0xa1, 0x21, 0x12, 0xc8, 0x00, 0x00, 0x00, 0x10},
628/* win: delay 20ms */
629 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
05b809c7 630/* win: i2c_r from 00 to 80 */
6ab0b174
JFM		 631 {0xd1, 0x21, 0x03, 0x80, 0x10, 0x20, 0x80, 0x10},
632 {0xb1, 0x21, 0x0c, 0x20, 0x20, 0x00, 0x00, 0x10},
cc7b5b57
HG		 633/* HDG: 0x11 was 0x00 change to 0x01 for better exposure (15 fps instead of 30)
634 0x13 was 0xc0 change to 0xc3 for auto gain and exposure */
635 {0xd1, 0x21, 0x11, 0x01, 0x48, 0xc3, 0x00, 0x10},
6ab0b174
JFM		 636 {0xb1, 0x21, 0x15, 0x80, 0x03, 0x00, 0x00, 0x10},
637 {0xd1, 0x21, 0x17, 0x1b, 0xbd, 0x05, 0xf6, 0x10},
638 {0xa1, 0x21, 0x1b, 0x04, 0x00, 0x00, 0x00, 0x10},
639 {0xd1, 0x21, 0x1f, 0x00, 0x80, 0x80, 0x80, 0x10},
640 {0xd1, 0x21, 0x23, 0xde, 0x10, 0x8a, 0xa0, 0x10},
641 {0xc1, 0x21, 0x27, 0xca, 0xa2, 0x74, 0x00, 0x10},
642 {0xd1, 0x21, 0x2a, 0x88, 0x00, 0x88, 0x01, 0x10},
643 {0xc1, 0x21, 0x2e, 0x80, 0x00, 0x18, 0x00, 0x10},
644 {0xa1, 0x21, 0x21, 0x08, 0x00, 0x00, 0x00, 0x10},
645 {0xa1, 0x21, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
646 {0xa1, 0x21, 0x2e, 0x00, 0x00, 0x00, 0x00, 0x10},
647 {0xb1, 0x21, 0x32, 0xc2, 0x08, 0x00, 0x00, 0x10},
648 {0xb1, 0x21, 0x4c, 0x00, 0x00, 0x00, 0x00, 0x10},
649 {0xd1, 0x21, 0x60, 0x05, 0x40, 0x12, 0x57, 0x10},
650 {0xa1, 0x21, 0x64, 0x73, 0x00, 0x00, 0x00, 0x10},
651 {0xd1, 0x21, 0x65, 0x00, 0x55, 0x01, 0xac, 0x10},
652 {0xa1, 0x21, 0x69, 0x38, 0x00, 0x00, 0x00, 0x10},
653 {0xd1, 0x21, 0x6f, 0x1f, 0x01, 0x00, 0x10, 0x10},
654 {0xd1, 0x21, 0x73, 0x50, 0x20, 0x02, 0x01, 0x10},
655 {0xd1, 0x21, 0x77, 0xf3, 0x90, 0x98, 0x98, 0x10},
656 {0xc1, 0x21, 0x7b, 0x00, 0x4c, 0xf7, 0x00, 0x10},
657 {0xd1, 0x21, 0x17, 0x1b, 0xbd, 0x05, 0xf6, 0x10},
658 {0xa1, 0x21, 0x1b, 0x04, 0x00, 0x00, 0x00, 0x10},
659/* */
660 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
661 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
662/*fixme: + 0x12, 0x04*/
6c86274f
JFM		 663/* {0xa1, 0x21, 0x75, 0x82, 0x00, 0x00, 0x00, 0x10}, * COMN
664 * set by setvflip */
6ab0b174
JFM		 665 {0xa1, 0x21, 0x10, 0x32, 0x00, 0x00, 0x00, 0x10},
666 {0xa1, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
667 {0xb1, 0x21, 0x01, 0x80, 0x80, 0x00, 0x00, 0x10},
05b809c7 668/* */
37c6dbe2
HG		 669/* {0xa1, 0x21, 0x2a, 0x88, 0x00, 0x00, 0x00, 0x10}, * set by setfreq */
670/* {0xa1, 0x21, 0x2b, 0x34, 0x00, 0x00, 0x00, 0x10}, * set by setfreq */
05b809c7 671/* */
6ab0b174 672 {0xa1, 0x21, 0x10, 0x83, 0x00, 0x00, 0x00, 0x10},
91de65ac 673/* {0xb1, 0x21, 0x01, 0x88, 0x70, 0x00, 0x00, 0x10}, */
6ab0b174
JFM		 674 {}
675};
6270330a 676
98819187 677static const u8 ov7648_sensor_init[][8] = {
6270330a
JFM		 678 {0xa1, 0x21, 0x76, 0x00, 0x00, 0x00, 0x00, 0x10},
679 {0xa1, 0x21, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10}, /* reset */
680 {0xa1, 0x21, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
681 {0xd1, 0x21, 0x03, 0xa4, 0x30, 0x88, 0x00, 0x10},
682 {0xb1, 0x21, 0x11, 0x80, 0x08, 0x00, 0x00, 0x10},
683 {0xc1, 0x21, 0x13, 0xa0, 0x04, 0x84, 0x00, 0x10},
684 {0xd1, 0x21, 0x17, 0x1a, 0x02, 0xba, 0xf4, 0x10},
685 {0xa1, 0x21, 0x1b, 0x04, 0x00, 0x00, 0x00, 0x10},
686 {0xd1, 0x21, 0x1f, 0x41, 0xc0, 0x80, 0x80, 0x10},
687 {0xd1, 0x21, 0x23, 0xde, 0xa0, 0x80, 0x32, 0x10},
688 {0xd1, 0x21, 0x27, 0xfe, 0xa0, 0x00, 0x91, 0x10},
689 {0xd1, 0x21, 0x2b, 0x00, 0x88, 0x85, 0x80, 0x10},
690 {0xc1, 0x21, 0x2f, 0x9c, 0x00, 0xc4, 0x00, 0x10},
691 {0xd1, 0x21, 0x60, 0xa6, 0x60, 0x88, 0x12, 0x10},
692 {0xd1, 0x21, 0x64, 0x88, 0x00, 0x00, 0x94, 0x10},
693 {0xd1, 0x21, 0x68, 0x7a, 0x0c, 0x00, 0x00, 0x10},
694 {0xd1, 0x21, 0x6c, 0x11, 0x33, 0x22, 0x00, 0x10},
695 {0xd1, 0x21, 0x70, 0x11, 0x00, 0x10, 0x50, 0x10},
696 {0xd1, 0x21, 0x74, 0x20, 0x06, 0x00, 0xb5, 0x10},
697 {0xd1, 0x21, 0x78, 0x8a, 0x00, 0x00, 0x00, 0x10},
698 {0xb1, 0x21, 0x7c, 0x00, 0x43, 0x00, 0x00, 0x10},
699
700 {0xd1, 0x21, 0x21, 0x86, 0x00, 0xde, 0xa0, 0x10},
701/* {0xd1, 0x21, 0x25, 0x80, 0x32, 0xfe, 0xa0, 0x10}, jfm done */
702/* {0xd1, 0x21, 0x29, 0x00, 0x91, 0x00, 0x88, 0x10}, jfm done */
37c6dbe2 703/* {0xb1, 0x21, 0x2d, 0x85, 0x00, 0x00, 0x00, 0x10}, set by setfreq */
6270330a
JFM		 704/*...*/
705/* {0xa1, 0x21, 0x12, 0x08, 0x00, 0x00, 0x00, 0x10}, jfm done */
2797ba2a
JFM		 706/* {0xa1, 0x21, 0x75, 0x06, 0x00, 0x00, 0x00, 0x10}, * COMN
707 * set by setvflip */
6270330a
JFM		 708 {0xa1, 0x21, 0x19, 0x02, 0x00, 0x00, 0x00, 0x10},
709 {0xa1, 0x21, 0x10, 0x32, 0x00, 0x00, 0x00, 0x10},
710/* {0xa1, 0x21, 0x16, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
711/* {0xa1, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10}, * GAIN - def */
712/* {0xb1, 0x21, 0x01, 0x6c, 0x6c, 0x00, 0x00, 0x10}, * B R - def: 80 */
713/*...*/
714 {0xa1, 0x21, 0x11, 0x81, 0x00, 0x00, 0x00, 0x10}, /* CLKRC */
715/* {0xa1, 0x21, 0x1e, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
716/* {0xa1, 0x21, 0x16, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
717/* {0xa1, 0x21, 0x2a, 0x91, 0x00, 0x00, 0x00, 0x10}, jfm done */
718/* {0xa1, 0x21, 0x2b, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
719/* {0xb1, 0x21, 0x01, 0x64, 0x84, 0x00, 0x00, 0x10}, * B R - def: 80 */
720
721 {}
722};
723
98819187 724static const u8 ov7660_sensor_init[][8] = {
6a7eba24 725 {0xa1, 0x21, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10}, /* reset SCCB */
60017617 726/* (delay 20ms) */
6a7eba24 727 {0xa1, 0x21, 0x12, 0x05, 0x00, 0x00, 0x00, 0x10},
738608ae 728 /* Outformat = rawRGB */
6a7eba24 729 {0xa1, 0x21, 0x13, 0xb8, 0x00, 0x00, 0x00, 0x10}, /* init COM8 */
d8f400ef 730 {0xd1, 0x21, 0x00, 0x01, 0x74, 0x92, 0x00, 0x10},
6a7eba24
JFM		 731 /* GAIN BLUE RED VREF */
732 {0xd1, 0x21, 0x04, 0x00, 0x7d, 0x62, 0x00, 0x10},
733 /* COM 1 BAVE GEAVE AECHH */
734 {0xb1, 0x21, 0x08, 0x83, 0x01, 0x00, 0x00, 0x10}, /* RAVE COM2 */
735 {0xd1, 0x21, 0x0c, 0x00, 0x08, 0x04, 0x4f, 0x10}, /* COM 3 4 5 6 */
47f7f6fb 736 {0xd1, 0x21, 0x10, 0x7f, 0x40, 0x05, 0xff, 0x10},
6a7eba24
JFM		 737 /* AECH CLKRC COM7 COM8 */
738 {0xc1, 0x21, 0x14, 0x2c, 0x00, 0x02, 0x00, 0x10}, /* COM9 COM10 */
739 {0xd1, 0x21, 0x17, 0x10, 0x60, 0x02, 0x7b, 0x10},
740 /* HSTART HSTOP VSTRT VSTOP */
741 {0xa1, 0x21, 0x1b, 0x02, 0x00, 0x00, 0x00, 0x10}, /* PSHFT */
742 {0xb1, 0x21, 0x1e, 0x01, 0x0e, 0x00, 0x00, 0x10}, /* MVFP LAEC */
743 {0xd1, 0x21, 0x20, 0x07, 0x07, 0x07, 0x07, 0x10},
744 /* BOS GBOS GROS ROS (BGGR offset) */
738608ae
JFM		 745/* {0xd1, 0x21, 0x24, 0x68, 0x58, 0xd4, 0x80, 0x10}, */
746 {0xd1, 0x21, 0x24, 0x78, 0x68, 0xd4, 0x80, 0x10},
6a7eba24
JFM		 747 /* AEW AEB VPT BBIAS */
748 {0xd1, 0x21, 0x28, 0x80, 0x30, 0x00, 0x00, 0x10},
749 /* GbBIAS RSVD EXHCH EXHCL */
750 {0xd1, 0x21, 0x2c, 0x80, 0x00, 0x00, 0x62, 0x10},
751 /* RBIAS ADVFL ASDVFH YAVE */
752 {0xc1, 0x21, 0x30, 0x08, 0x30, 0xb4, 0x00, 0x10},
753 /* HSYST HSYEN HREF */
754 {0xd1, 0x21, 0x33, 0x00, 0x07, 0x84, 0x00, 0x10}, /* reserved */
755 {0xd1, 0x21, 0x37, 0x0c, 0x02, 0x43, 0x00, 0x10},
756 /* ADC ACOM OFON TSLB */
757 {0xd1, 0x21, 0x3b, 0x02, 0x6c, 0x19, 0x0e, 0x10},
758 /* COM11 COM12 COM13 COM14 */
759 {0xd1, 0x21, 0x3f, 0x41, 0xc1, 0x22, 0x08, 0x10},
760 /* EDGE COM15 COM16 COM17 */
761 {0xd1, 0x21, 0x43, 0xf0, 0x10, 0x78, 0xa8, 0x10}, /* reserved */
762 {0xd1, 0x21, 0x47, 0x60, 0x80, 0x00, 0x00, 0x10}, /* reserved */
763 {0xd1, 0x21, 0x4b, 0x00, 0x00, 0x00, 0x00, 0x10}, /* reserved */
764 {0xd1, 0x21, 0x4f, 0x46, 0x36, 0x0f, 0x17, 0x10}, /* MTX 1 2 3 4 */
765 {0xd1, 0x21, 0x53, 0x7f, 0x96, 0x40, 0x40, 0x10}, /* MTX 5 6 7 8 */
766 {0xb1, 0x21, 0x57, 0x40, 0x0f, 0x00, 0x00, 0x10}, /* MTX9 MTXS */
767 {0xd1, 0x21, 0x59, 0xba, 0x9a, 0x22, 0xb9, 0x10}, /* reserved */
768 {0xd1, 0x21, 0x5d, 0x9b, 0x10, 0xf0, 0x05, 0x10}, /* reserved */
769 {0xa1, 0x21, 0x61, 0x60, 0x00, 0x00, 0x00, 0x10}, /* reserved */
770 {0xd1, 0x21, 0x62, 0x00, 0x00, 0x50, 0x30, 0x10},
771 /* LCC1 LCC2 LCC3 LCC4 */
772 {0xa1, 0x21, 0x66, 0x00, 0x00, 0x00, 0x00, 0x10}, /* LCC5 */
738608ae 773 {0xd1, 0x21, 0x67, 0x80, 0x7a, 0x90, 0x80, 0x10}, /* MANU */
6a7eba24 774 {0xa1, 0x21, 0x6b, 0x0a, 0x00, 0x00, 0x00, 0x10},
738608ae 775 /* band gap reference [0:3] DBLV */
6a7eba24
JFM		 776 {0xd1, 0x21, 0x6c, 0x30, 0x48, 0x80, 0x74, 0x10}, /* gamma curve */
777 {0xd1, 0x21, 0x70, 0x64, 0x60, 0x5c, 0x58, 0x10}, /* gamma curve */
778 {0xd1, 0x21, 0x74, 0x54, 0x4c, 0x40, 0x38, 0x10}, /* gamma curve */
779 {0xd1, 0x21, 0x78, 0x34, 0x30, 0x2f, 0x2b, 0x10}, /* gamma curve */
780 {0xd1, 0x21, 0x7c, 0x03, 0x07, 0x17, 0x34, 0x10}, /* gamma curve */
781 {0xd1, 0x21, 0x80, 0x41, 0x4d, 0x58, 0x63, 0x10}, /* gamma curve */
782 {0xd1, 0x21, 0x84, 0x6e, 0x77, 0x87, 0x95, 0x10}, /* gamma curve */
783 {0xc1, 0x21, 0x88, 0xaf, 0xc7, 0xdf, 0x00, 0x10}, /* gamma curve */
784 {0xc1, 0x21, 0x8b, 0x99, 0x99, 0xcf, 0x00, 0x10}, /* reserved */
738608ae 785 {0xb1, 0x21, 0x92, 0x00, 0x00, 0x00, 0x00, 0x10}, /* DM_LNL/H */
47f7f6fb 786 {0xa1, 0x21, 0xa1, 0x00, 0x00, 0x00, 0x00, 0x10},
6a7eba24 787/****** (some exchanges in the win trace) ******/
738608ae 788 {0xa1, 0x21, 0x1e, 0x01, 0x00, 0x00, 0x00, 0x10}, /* MVFP */
6a7eba24
JFM		 789 /* bits[3..0]reserved */
790 {0xa1, 0x21, 0x1e, 0x01, 0x00, 0x00, 0x00, 0x10},
791 {0xa1, 0x21, 0x03, 0x00, 0x00, 0x00, 0x00, 0x10},
792 /* VREF vertical frame ctrl */
793 {0xa1, 0x21, 0x03, 0x00, 0x00, 0x00, 0x00, 0x10},
738608ae
JFM		 794 {0xa1, 0x21, 0x10, 0x20, 0x00, 0x00, 0x00, 0x10}, /* AECH 0x20 */
795 {0xa1, 0x21, 0x2d, 0x00, 0x00, 0x00, 0x00, 0x10}, /* ADVFL */
796 {0xa1, 0x21, 0x2e, 0x00, 0x00, 0x00, 0x00, 0x10}, /* ADVFH */
797 {0xa1, 0x21, 0x00, 0x1f, 0x00, 0x00, 0x00, 0x10}, /* GAIN */
798/* {0xb1, 0x21, 0x01, 0x78, 0x78, 0x00, 0x00, 0x10}, * BLUE */
6a7eba24
JFM		 799/****** (some exchanges in the win trace) ******/
800 {0xa1, 0x21, 0x93, 0x00, 0x00, 0x00, 0x00, 0x10},/* dummy line hight */
738608ae
JFM		 801 {0xa1, 0x21, 0x92, 0x25, 0x00, 0x00, 0x00, 0x10}, /* dummy line low */
802 {0xa1, 0x21, 0x2a, 0x00, 0x00, 0x00, 0x00, 0x10}, /* EXHCH */
803 {0xa1, 0x21, 0x2b, 0x00, 0x00, 0x00, 0x00, 0x10}, /* EXHCL */
804/* {0xa1, 0x21, 0x02, 0x90, 0x00, 0x00, 0x00, 0x10}, * RED */
6a7eba24 805/****** (some exchanges in the win trace) ******/
738608ae 806/******!! startsensor KO if changed !!****/
6a7eba24
JFM		 807 {0xa1, 0x21, 0x93, 0x01, 0x00, 0x00, 0x00, 0x10},
808 {0xa1, 0x21, 0x92, 0xff, 0x00, 0x00, 0x00, 0x10},
809 {0xa1, 0x21, 0x2a, 0x00, 0x00, 0x00, 0x00, 0x10},
810 {0xa1, 0x21, 0x2b, 0xc3, 0x00, 0x00, 0x00, 0x10},
a5ae2062 811 {}
6a7eba24 812};
6a7eba24 813
5e31dc8d
JFM		 814static const u8 sp80708_sensor_init[][8] = {
815 {0xa1, 0x18, 0x06, 0xf9, 0x00, 0x00, 0x00, 0x10},
816 {0xa1, 0x18, 0x09, 0x1f, 0x00, 0x00, 0x00, 0x10},
817 {0xa1, 0x18, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x10},
818 {0xa1, 0x18, 0x0d, 0xc0, 0x00, 0x00, 0x00, 0x10},
819 {0xa1, 0x18, 0x0c, 0x04, 0x00, 0x00, 0x00, 0x10},
820 {0xa1, 0x18, 0x0f, 0x0f, 0x00, 0x00, 0x00, 0x10},
821 {0xa1, 0x18, 0x10, 0x40, 0x00, 0x00, 0x00, 0x10},
822 {0xa1, 0x18, 0x11, 0x4e, 0x00, 0x00, 0x00, 0x10},
823 {0xa1, 0x18, 0x12, 0x53, 0x00, 0x00, 0x00, 0x10},
824 {0xa1, 0x18, 0x15, 0x80, 0x00, 0x00, 0x00, 0x10},
825 {0xa1, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x10},
826 {0xa1, 0x18, 0x19, 0x18, 0x00, 0x00, 0x00, 0x10},
827 {0xa1, 0x18, 0x1a, 0x10, 0x00, 0x00, 0x00, 0x10},
828 {0xa1, 0x18, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x10},
829 {0xa1, 0x18, 0x1c, 0x28, 0x00, 0x00, 0x00, 0x10},
830 {0xa1, 0x18, 0x1d, 0x02, 0x00, 0x00, 0x00, 0x10},
831 {0xa1, 0x18, 0x1e, 0x10, 0x00, 0x00, 0x00, 0x10},
832 {0xa1, 0x18, 0x26, 0x04, 0x00, 0x00, 0x00, 0x10},
833 {0xa1, 0x18, 0x27, 0x1e, 0x00, 0x00, 0x00, 0x10},
834 {0xa1, 0x18, 0x28, 0x5a, 0x00, 0x00, 0x00, 0x10},
835 {0xa1, 0x18, 0x29, 0x28, 0x00, 0x00, 0x00, 0x10},
836 {0xa1, 0x18, 0x2a, 0x78, 0x00, 0x00, 0x00, 0x10},
837 {0xa1, 0x18, 0x2b, 0x01, 0x00, 0x00, 0x00, 0x10},
838 {0xa1, 0x18, 0x2c, 0xf7, 0x00, 0x00, 0x00, 0x10},
839 {0xa1, 0x18, 0x2d, 0x2d, 0x00, 0x00, 0x00, 0x10},
840 {0xa1, 0x18, 0x2e, 0xd5, 0x00, 0x00, 0x00, 0x10},
841 {0xa1, 0x18, 0x39, 0x42, 0x00, 0x00, 0x00, 0x10},
842 {0xa1, 0x18, 0x3a, 0x67, 0x00, 0x00, 0x00, 0x10},
843 {0xa1, 0x18, 0x3b, 0x87, 0x00, 0x00, 0x00, 0x10},
844 {0xa1, 0x18, 0x3c, 0xa3, 0x00, 0x00, 0x00, 0x10},
845 {0xa1, 0x18, 0x3d, 0xb0, 0x00, 0x00, 0x00, 0x10},
846 {0xa1, 0x18, 0x3e, 0xbc, 0x00, 0x00, 0x00, 0x10},
847 {0xa1, 0x18, 0x3f, 0xc8, 0x00, 0x00, 0x00, 0x10},
848 {0xa1, 0x18, 0x40, 0xd4, 0x00, 0x00, 0x00, 0x10},
849 {0xa1, 0x18, 0x41, 0xdf, 0x00, 0x00, 0x00, 0x10},
850 {0xa1, 0x18, 0x42, 0xea, 0x00, 0x00, 0x00, 0x10},
851 {0xa1, 0x18, 0x43, 0xf5, 0x00, 0x00, 0x00, 0x10},
852 {0xa1, 0x18, 0x45, 0x80, 0x00, 0x00, 0x00, 0x10},
853 {0xa1, 0x18, 0x46, 0x60, 0x00, 0x00, 0x00, 0x10},
854 {0xa1, 0x18, 0x47, 0x50, 0x00, 0x00, 0x00, 0x10},
855 {0xa1, 0x18, 0x48, 0x30, 0x00, 0x00, 0x00, 0x10},
856 {0xa1, 0x18, 0x49, 0x01, 0x00, 0x00, 0x00, 0x10},
857 {0xa1, 0x18, 0x4d, 0xae, 0x00, 0x00, 0x00, 0x10},
858 {0xa1, 0x18, 0x4e, 0x03, 0x00, 0x00, 0x00, 0x10},
859 {0xa1, 0x18, 0x4f, 0x66, 0x00, 0x00, 0x00, 0x10},
860 {0xa1, 0x18, 0x50, 0x1c, 0x00, 0x00, 0x00, 0x10},
861 {0xa1, 0x18, 0x44, 0x10, 0x00, 0x00, 0x00, 0x10},
862 {0xa1, 0x18, 0x4a, 0x30, 0x00, 0x00, 0x00, 0x10},
863 {0xa1, 0x18, 0x51, 0x80, 0x00, 0x00, 0x00, 0x10},
864 {0xa1, 0x18, 0x52, 0x80, 0x00, 0x00, 0x00, 0x10},
865 {0xa1, 0x18, 0x53, 0x80, 0x00, 0x00, 0x00, 0x10},
866 {0xa1, 0x18, 0x54, 0x80, 0x00, 0x00, 0x00, 0x10},
867 {0xa1, 0x18, 0x55, 0x80, 0x00, 0x00, 0x00, 0x10},
868 {0xa1, 0x18, 0x56, 0x80, 0x00, 0x00, 0x00, 0x10},
869 {0xa1, 0x18, 0x57, 0xe0, 0x00, 0x00, 0x00, 0x10},
870 {0xa1, 0x18, 0x58, 0xc0, 0x00, 0x00, 0x00, 0x10},
871 {0xa1, 0x18, 0x59, 0xab, 0x00, 0x00, 0x00, 0x10},
872 {0xa1, 0x18, 0x5a, 0xa0, 0x00, 0x00, 0x00, 0x10},
873 {0xa1, 0x18, 0x5b, 0x99, 0x00, 0x00, 0x00, 0x10},
874 {0xa1, 0x18, 0x5c, 0x90, 0x00, 0x00, 0x00, 0x10},
875 {0xa1, 0x18, 0x5e, 0x24, 0x00, 0x00, 0x00, 0x10},
876 {0xa1, 0x18, 0x5f, 0x00, 0x00, 0x00, 0x00, 0x10},
877 {0xa1, 0x18, 0x60, 0x00, 0x00, 0x00, 0x00, 0x10},
878 {0xa1, 0x18, 0x61, 0x73, 0x00, 0x00, 0x00, 0x10},
879 {0xa1, 0x18, 0x63, 0x42, 0x00, 0x00, 0x00, 0x10},
880 {0xa1, 0x18, 0x64, 0x42, 0x00, 0x00, 0x00, 0x10},
881 {0xa1, 0x18, 0x65, 0x42, 0x00, 0x00, 0x00, 0x10},
882 {0xa1, 0x18, 0x66, 0x24, 0x00, 0x00, 0x00, 0x10},
883 {0xa1, 0x18, 0x67, 0x24, 0x00, 0x00, 0x00, 0x10},
884 {0xa1, 0x18, 0x68, 0x08, 0x00, 0x00, 0x00, 0x10},
885 {0xa1, 0x18, 0x2f, 0xc9, 0x00, 0x00, 0x00, 0x10},
886 /********/
887 {0xa1, 0x18, 0x0c, 0x04, 0x00, 0x00, 0x00, 0x10},
888 {0xa1, 0x18, 0x0c, 0x04, 0x00, 0x00, 0x00, 0x10},
889 {0xa1, 0x18, 0x03, 0x01, 0x00, 0x00, 0x00, 0x10},
890 {0xa1, 0x18, 0x04, 0xa4, 0x00, 0x00, 0x00, 0x10},
891 {0xa1, 0x18, 0x14, 0x3f, 0x00, 0x00, 0x00, 0x10},
892 {0xa1, 0x18, 0x5d, 0x80, 0x00, 0x00, 0x00, 0x10},
893 {0xb1, 0x18, 0x11, 0x40, 0x40, 0x00, 0x00, 0x10},
894 {}
895};
896
8295d99e 897/* read <len> bytes to gspca_dev->usb_buf */
739570bb 898static void reg_r(struct gspca_dev *gspca_dev,
98819187 899 u16 value, int len)
6a7eba24 900{
8295d99e
JFM		 901#ifdef GSPCA_DEBUG
902 if (len > USB_BUF_SZ) {
903 err("reg_r: buffer overflow");
904 return;
905 }
906#endif
739570bb
JFM		 907 usb_control_msg(gspca_dev->dev,
908 usb_rcvctrlpipe(gspca_dev->dev, 0),
6a7eba24
JFM		 909 0,
910 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
911 value, 0,
739570bb 912 gspca_dev->usb_buf, len,
6a7eba24 913 500);
60017617 914 PDEBUG(D_USBI, "reg_r [%02x] -> %02x", value, gspca_dev->usb_buf[0]);
6a7eba24
JFM		 915}
916
60017617 917static void reg_w1(struct gspca_dev *gspca_dev,
98819187
JFM		 918 u16 value,
919 u8 data)
60017617 920{
3ef2c5be 921 PDEBUG(D_USBO, "reg_w1 [%04x] = %02x", value, data);
60017617
JFM		 922 gspca_dev->usb_buf[0] = data;
923 usb_control_msg(gspca_dev->dev,
924 usb_sndctrlpipe(gspca_dev->dev, 0),
925 0x08,
926 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
927 value,
928 0,
929 gspca_dev->usb_buf, 1,
930 500);
931}
739570bb 932static void reg_w(struct gspca_dev *gspca_dev,
98819187
JFM		 933 u16 value,
934 const u8 *buffer,
6a7eba24
JFM		 935 int len)
936{
3ef2c5be 937 PDEBUG(D_USBO, "reg_w [%04x] = %02x %02x ..",
60017617 938 value, buffer[0], buffer[1]);
8295d99e
JFM		 939#ifdef GSPCA_DEBUG
940 if (len > USB_BUF_SZ) {
941 err("reg_w: buffer overflow");
942 return;
bf7f0b98 943 }
8295d99e
JFM		 944#endif
945 memcpy(gspca_dev->usb_buf, buffer, len);
946 usb_control_msg(gspca_dev->dev,
947 usb_sndctrlpipe(gspca_dev->dev, 0),
948 0x08,
949 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
950 value, 0,
951 gspca_dev->usb_buf, len,
952 500);
6a7eba24
JFM		 953}
954
60017617 955/* I2C write 1 byte */
98819187 956static void i2c_w1(struct gspca_dev *gspca_dev, u8 reg, u8 val)
6a7eba24
JFM		 957{
958 struct sd *sd = (struct sd *) gspca_dev;
6a7eba24 959
60017617
JFM		 960 PDEBUG(D_USBO, "i2c_w2 [%02x] = %02x", reg, val);
961 gspca_dev->usb_buf[0] = 0x81 | (2 << 4); /* = a1 */
962 gspca_dev->usb_buf[1] = sd->i2c_base;
963 gspca_dev->usb_buf[2] = reg;
964 gspca_dev->usb_buf[3] = val;
965 gspca_dev->usb_buf[4] = 0;
966 gspca_dev->usb_buf[5] = 0;
967 gspca_dev->usb_buf[6] = 0;
968 gspca_dev->usb_buf[7] = 0x10;
969 usb_control_msg(gspca_dev->dev,
970 usb_sndctrlpipe(gspca_dev->dev, 0),
971 0x08,
972 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
973 0x08, /* value = i2c */
974 0,
975 gspca_dev->usb_buf, 8,
976 500);
6a7eba24
JFM		 977}
978
739570bb
JFM		 979/* I2C write 8 bytes */
980static void i2c_w8(struct gspca_dev *gspca_dev,
98819187 981 const u8 *buffer)
6a7eba24 982{
60017617
JFM		 983 memcpy(gspca_dev->usb_buf, buffer, 8);
984 usb_control_msg(gspca_dev->dev,
985 usb_sndctrlpipe(gspca_dev->dev, 0),
986 0x08,
987 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
988 0x08, 0, /* value, index */
989 gspca_dev->usb_buf, 8,
990 500);
8d768e14 991 msleep(2);
6a7eba24
JFM		 992}
993
739570bb 994/* read 5 bytes in gspca_dev->usb_buf */
98819187 995static void i2c_r5(struct gspca_dev *gspca_dev, u8 reg)
6a7eba24
JFM		 996{
997 struct sd *sd = (struct sd *) gspca_dev;
98819187 998 u8 mode[8];
6a7eba24 999
3647fea8 1000 mode[0] = 0x81 | 0x10;
6a7eba24
JFM		 1001 mode[1] = sd->i2c_base;
1002 mode[2] = reg;
1003 mode[3] = 0;
1004 mode[4] = 0;
1005 mode[5] = 0;
1006 mode[6] = 0;
1007 mode[7] = 0x10;
739570bb 1008 i2c_w8(gspca_dev, mode);
60017617 1009 msleep(2);
3647fea8 1010 mode[0] = 0x81 | (5 << 4) | 0x02;
6a7eba24 1011 mode[2] = 0;
739570bb 1012 i2c_w8(gspca_dev, mode);
60017617 1013 msleep(2);
739570bb 1014 reg_r(gspca_dev, 0x0a, 5);
6a7eba24
JFM		 1015}
1016
7fb101ae 1017static void hv7131r_probe(struct gspca_dev *gspca_dev)
6a7eba24 1018{
60017617 1019 i2c_w1(gspca_dev, 0x02, 0); /* sensor wakeup */
6a7eba24 1020 msleep(10);
60017617 1021 reg_w1(gspca_dev, 0x02, 0x66); /* Gpio on */
6a7eba24 1022 msleep(10);
739570bb
JFM		 1023 i2c_r5(gspca_dev, 0); /* read sensor id */
1024 if (gspca_dev->usb_buf[0] == 0x02
1025 && gspca_dev->usb_buf[1] == 0x09
1026 && gspca_dev->usb_buf[2] == 0x01
1027 && gspca_dev->usb_buf[3] == 0x00
1028 && gspca_dev->usb_buf[4] == 0x00) {
7fb101ae
JFM		 1029 PDEBUG(D_PROBE, "Sensor sn9c102P HV7131R found");
1030 return;
6a7eba24 1031 }
7fb101ae 1032 PDEBUG(D_PROBE, "Sensor 0x%02x 0x%02x 0x%02x - sn9c102P not found",
739570bb
JFM		 1033 gspca_dev->usb_buf[0], gspca_dev->usb_buf[1],
1034 gspca_dev->usb_buf[2]);
6a7eba24
JFM		 1035}
1036
65c5259c 1037static void mi0360_probe(struct gspca_dev *gspca_dev)
3ef2c5be 1038{
65c5259c 1039 struct sd *sd = (struct sd *) gspca_dev;
3ef2c5be 1040 int i, j;
92e8c91b 1041 u16 val = 0;
3ef2c5be 1042 static const u8 probe_tb[][4][8] = {
65c5259c 1043 { /* mi0360 */
3ef2c5be
JFM		 1044 {0xb0, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10},
1045 {0x90, 0x5d, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
1046 {0xa2, 0x5d, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
1047 {0xb0, 0x5d, 0x07, 0x00, 0x00, 0x00, 0x00, 0x10}
1048 },
65c5259c 1049 { /* mt9v111 */
3ef2c5be
JFM		 1050 {0xb0, 0x5c, 0x01, 0x00, 0x04, 0x00, 0x00, 0x10},
1051 {0x90, 0x5c, 0x36, 0x00, 0x00, 0x00, 0x00, 0x10},
1052 {0xa2, 0x5c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
1053 {}
1054 },
1055 };
1056
1057 for (i = 0; i < ARRAY_SIZE(probe_tb); i++) {
1058 reg_w1(gspca_dev, 0x17, 0x62);
1059 reg_w1(gspca_dev, 0x01, 0x08);
1060 for (j = 0; j < 3; j++)
1061 i2c_w8(gspca_dev, probe_tb[i][j]);
1062 msleep(2);
1063 reg_r(gspca_dev, 0x0a, 5);
1064 val = (gspca_dev->usb_buf[3] << 8) | gspca_dev->usb_buf[4];
1065 if (probe_tb[i][3][0] != 0)
1066 i2c_w8(gspca_dev, probe_tb[i][3]);
1067 reg_w1(gspca_dev, 0x01, 0x29);
1068 reg_w1(gspca_dev, 0x17, 0x42);
1069 if (val != 0xffff)
1070 break;
1071 }
1072 switch (val) {
1073 case 0x823a:
1074 PDEBUG(D_PROBE, "Sensor mt9v111");
65c5259c
JFM		 1075 sd->sensor = SENSOR_MT9V111;
1076 sd->i2c_base = 0x5c;
1077 break;
3ef2c5be
JFM		 1078 case 0x8243:
1079 PDEBUG(D_PROBE, "Sensor mi0360");
65c5259c
JFM		 1080 break;
1081 default:
1082 PDEBUG(D_PROBE, "Unknown sensor %04x - forced to mi0360", val);
1083 break;
3ef2c5be 1084 }
3ef2c5be
JFM		 1085}
1086
7fb101ae 1087static void configure_gpio(struct gspca_dev *gspca_dev,
98819187 1088 const u8 *sn9c1xx)
6a7eba24
JFM		 1089{
1090 struct sd *sd = (struct sd *) gspca_dev;
98819187
JFM		 1091 const u8 *reg9a;
1092 static const u8 reg9a_def[] =
c8b9b2ca
JFM		 1093 {0x00, 0x40, 0x20, 0x00, 0x00, 0x00};
1094 static const u8 reg9a_spec[] =
1095 {0x00, 0x40, 0x38, 0x30, 0x00, 0x20};
98819187 1096 static const u8 regd4[] = {0x60, 0x00, 0x00};
6a7eba24 1097
60017617 1098 reg_w1(gspca_dev, 0xf1, 0x00);
05b809c7 1099 reg_w1(gspca_dev, 0x01, sn9c1xx[1]);
6a7eba24
JFM		 1100
1101 /* configure gpio */
739570bb
JFM		 1102 reg_w(gspca_dev, 0x01, &sn9c1xx[1], 2);
1103 reg_w(gspca_dev, 0x08, &sn9c1xx[8], 2);
60017617 1104 reg_w(gspca_dev, 0x17, &sn9c1xx[0x17], 5); /* jfm len was 3 */
c8b9b2ca
JFM		 1105 switch (sd->sensor) {
1106 case SENSOR_OV7660:
1107 case SENSOR_SP80708:
1108 reg9a = reg9a_spec;
6a7eba24 1109 break;
6a7eba24
JFM		 1110 default:
1111 reg9a = reg9a_def;
1112 break;
1113 }
739570bb 1114 reg_w(gspca_dev, 0x9a, reg9a, 6);
6a7eba24 1115
8f47a3ce 1116 reg_w(gspca_dev, 0xd4, regd4, sizeof regd4); /*fixme:jfm was 60 only*/
6a7eba24 1117
739570bb 1118 reg_w(gspca_dev, 0x03, &sn9c1xx[3], 0x0f);
6a7eba24 1119
d2d16e90 1120 switch (sd->sensor) {
3ef2c5be
JFM		 1121 case SENSOR_MT9V111:
1122 reg_w1(gspca_dev, 0x01, 0x61);
1123 reg_w1(gspca_dev, 0x17, 0x61);
1124 reg_w1(gspca_dev, 0x01, 0x60);
1125 reg_w1(gspca_dev, 0x01, 0x40);
1126 break;
d2d16e90 1127 case SENSOR_OM6802:
4f30f6cf 1128 reg_w1(gspca_dev, 0x02, 0x71);
d2d16e90
JFM		 1129 reg_w1(gspca_dev, 0x01, 0x42);
1130 reg_w1(gspca_dev, 0x17, 0x64);
1131 reg_w1(gspca_dev, 0x01, 0x42);
1132 break;
05b809c7
JFM		 1133 case SENSOR_OV7630:
1134 reg_w1(gspca_dev, 0x01, 0x61);
1135 reg_w1(gspca_dev, 0x17, 0xe2);
1136 reg_w1(gspca_dev, 0x01, 0x60);
1137 reg_w1(gspca_dev, 0x01, 0x40);
1138 break;
d2d16e90 1139 case SENSOR_OV7648:
6270330a
JFM		 1140 reg_w1(gspca_dev, 0x01, 0x63);
1141 reg_w1(gspca_dev, 0x17, 0x20);
c8b9b2ca 1142 reg_w1(gspca_dev, 0x01, 0x62);
60017617 1143 reg_w1(gspca_dev, 0x01, 0x42);
6a7eba24 1144 break;
91de65ac 1145 case SENSOR_OV7660:
5e31dc8d
JFM		 1146 case SENSOR_SP80708:
1147 reg_w1(gspca_dev, 0x01, 0x63);
1148 reg_w1(gspca_dev, 0x17, 0x20);
1149 reg_w1(gspca_dev, 0x01, 0x62);
1150 reg_w1(gspca_dev, 0x01, 0x42);
1f78a976 1151 msleep(100);
5e31dc8d
JFM		 1152 reg_w1(gspca_dev, 0x02, 0x62);
1153 break;
c8b9b2ca
JFM		 1154/* case SENSOR_HV7131R: */
1155/* case SENSOR_MI0360: */
1156/* case SENSOR_MO4000: */
6a7eba24 1157 default:
60017617
JFM		 1158 reg_w1(gspca_dev, 0x01, 0x43);
1159 reg_w1(gspca_dev, 0x17, 0x61);
1160 reg_w1(gspca_dev, 0x01, 0x42);
7fb101ae
JFM		 1161 if (sd->sensor == SENSOR_HV7131R)
1162 hv7131r_probe(gspca_dev);
d2d16e90 1163 break;
6a7eba24 1164 }
6a7eba24
JFM		 1165}
1166
1167static void hv7131R_InitSensor(struct gspca_dev *gspca_dev)
1168{
1169 int i = 0;
98819187 1170 static const u8 SetSensorClk[] = /* 0x08 Mclk */
6a7eba24
JFM		 1171 { 0xa1, 0x11, 0x01, 0x18, 0x00, 0x00, 0x00, 0x10 };
1172
1173 while (hv7131r_sensor_init[i][0]) {
739570bb 1174 i2c_w8(gspca_dev, hv7131r_sensor_init[i]);
6a7eba24
JFM		 1175 i++;
1176 }
739570bb 1177 i2c_w8(gspca_dev, SetSensorClk);
6a7eba24
JFM		 1178}
1179
1180static void mi0360_InitSensor(struct gspca_dev *gspca_dev)
1181{
1182 int i = 0;
6a7eba24
JFM		 1183
1184 while (mi0360_sensor_init[i][0]) {
739570bb 1185 i2c_w8(gspca_dev, mi0360_sensor_init[i]);
6a7eba24
JFM		 1186 i++;
1187 }
1188}
1189
1190static void mo4000_InitSensor(struct gspca_dev *gspca_dev)
1191{
1192 int i = 0;
6a7eba24
JFM		 1193
1194 while (mo4000_sensor_init[i][0]) {
739570bb 1195 i2c_w8(gspca_dev, mo4000_sensor_init[i]);
6a7eba24
JFM		 1196 i++;
1197 }
1198}
1199
3ef2c5be
JFM		 1200static void mt9v111_InitSensor(struct gspca_dev *gspca_dev)
1201{
1202 int i = 0;
1203
1204 i2c_w8(gspca_dev, mt9v111_sensor_init[i]);
1205 i++;
1206 msleep(20);
1207 while (mt9v111_sensor_init[i][0]) {
1208 i2c_w8(gspca_dev, mt9v111_sensor_init[i]);
1209 i++;
1210 }
1211}
1212
d2d16e90
JFM		 1213static void om6802_InitSensor(struct gspca_dev *gspca_dev)
1214{
1215 int i = 0;
1216
1217 while (om6802_sensor_init[i][0]) {
1218 i2c_w8(gspca_dev, om6802_sensor_init[i]);
1219 i++;
1220 }
1221}
1222
6ab0b174
JFM		 1223static void ov7630_InitSensor(struct gspca_dev *gspca_dev)
1224{
1225 int i = 0;
1226
05b809c7
JFM		 1227 i2c_w8(gspca_dev, ov7630_sensor_init[i]); /* 76 01 */
1228 i++;
1229 i2c_w8(gspca_dev, ov7630_sensor_init[i]); /* 12 c8 (RGB+SRST) */
6ab0b174
JFM		 1230 i++;
1231 msleep(20);
05b809c7
JFM		 1232 i2c_w8(gspca_dev, ov7630_sensor_init[i]); /* 12 48 */
1233 i++;
1234 i2c_w8(gspca_dev, ov7630_sensor_init[i]); /* 12 c8 */
1235 i++;
1236 msleep(20);
1237 i2c_w8(gspca_dev, ov7630_sensor_init[i]); /* 12 48 */
1238 i++;
1239/*jfm:win i2c_r from 00 to 80*/
1240
6ab0b174
JFM		 1241 while (ov7630_sensor_init[i][0]) {
1242 i2c_w8(gspca_dev, ov7630_sensor_init[i]);
1243 i++;
1244 }
1245}
1246
6a7eba24
JFM		 1247static void ov7648_InitSensor(struct gspca_dev *gspca_dev)
1248{
6a7eba24
JFM		 1249 int i = 0;
1250
6270330a
JFM		 1251 i2c_w8(gspca_dev, ov7648_sensor_init[i]);
1252 i++;
1253/* win: dble reset */
1254 i2c_w8(gspca_dev, ov7648_sensor_init[i]); /* reset */
1255 i++;
1256 msleep(20);
1257/* win: i2c reg read 00..7f */
6a7eba24 1258 while (ov7648_sensor_init[i][0]) {
739570bb 1259 i2c_w8(gspca_dev, ov7648_sensor_init[i]);
6a7eba24
JFM		 1260 i++;
1261 }
1262}
1263
1264static void ov7660_InitSensor(struct gspca_dev *gspca_dev)
1265{
1266 int i = 0;
6a7eba24 1267
60017617
JFM		 1268 i2c_w8(gspca_dev, ov7660_sensor_init[i]); /* reset SCCB */
1269 i++;
1270 msleep(20);
6a7eba24 1271 while (ov7660_sensor_init[i][0]) {
739570bb 1272 i2c_w8(gspca_dev, ov7660_sensor_init[i]);
6a7eba24
JFM		 1273 i++;
1274 }
1275}
1276
5e31dc8d
JFM		 1277static void sp80708_InitSensor(struct gspca_dev *gspca_dev)
1278{
1279 int i = 0;
1280
1281 i2c_w8(gspca_dev, sp80708_sensor_init[i]); /* reset SCCB */
1282 i++;
1283 msleep(20);
1284 while (sp80708_sensor_init[i][0]) {
1285 i2c_w8(gspca_dev, sp80708_sensor_init[i]);
1286 i++;
1287 }
1288}
1289
6a7eba24
JFM		 1290/* this function is called at probe time */
1291static int sd_config(struct gspca_dev *gspca_dev,
1292 const struct usb_device_id *id)
1293{
1294 struct sd *sd = (struct sd *) gspca_dev;
1295 struct cam *cam;
6a7eba24
JFM		 1296
1297 cam = &gspca_dev->cam;
6a7eba24
JFM		 1298 cam->cam_mode = vga_mode;
1299 cam->nmodes = ARRAY_SIZE(vga_mode);
49cb6b04 1300 cam->npkt = 24; /* 24 packets per ISOC message */
a5ae2062 1301
9d64fdb1
JFM		 1302 sd->bridge = id->driver_info >> 16;
1303 sd->sensor = id->driver_info >> 8;
1304 sd->i2c_base = id->driver_info;
1305
a5ae2062
JFM		 1306 sd->brightness = BRIGHTNESS_DEF;
1307 sd->contrast = CONTRAST_DEF;
1308 sd->colors = COLOR_DEF;
403123d2
JFM		 1309 sd->blue = BLUE_BALANCE_DEF;
1310 sd->red = RED_BALANCE_DEF;
592f4eb9 1311 sd->gamma = GAMMA_DEF;
a5ae2062 1312 sd->autogain = AUTOGAIN_DEF;
cebf3b67 1313 sd->ag_cnt = -1;
f800952c 1314 sd->vflip = VFLIP_DEF;
0cae8964 1315 sd->infrared = INFRARED_DEF;
37c6dbe2 1316 sd->freq = FREQ_DEF;
77ac0baf 1317 sd->quality = QUALITY_DEF;
71cb2764 1318 sd->jpegqual = 80;
cebf3b67 1319
577cbf49 1320 gspca_dev->ctrl_dis = ctrl_dis[sd->sensor];
6a7eba24
JFM		 1321 return 0;
1322}
1323
012d6b02
JFM		 1324/* this function is called at probe and resume time */
1325static int sd_init(struct gspca_dev *gspca_dev)
6a7eba24
JFM		 1326{
1327 struct sd *sd = (struct sd *) gspca_dev;
98819187
JFM		 1328 u8 regGpio[] = { 0x29, 0x74 };
1329 u8 regF1;
6a7eba24 1330
3647fea8 1331 /* setup a selector by bridge */
60017617 1332 reg_w1(gspca_dev, 0xf1, 0x01);
739570bb 1333 reg_r(gspca_dev, 0x00, 1);
8f47a3ce
JFM		 1334 reg_w1(gspca_dev, 0xf1, gspca_dev->usb_buf[0]);
1335 reg_r(gspca_dev, 0x00, 1); /* get sonix chip id */
739570bb 1336 regF1 = gspca_dev->usb_buf[0];
8f47a3ce 1337 PDEBUG(D_PROBE, "Sonix chip id: %02x", regF1);
3647fea8
HG		 1338 switch (sd->bridge) {
1339 case BRIDGE_SN9C102P:
6a7eba24
JFM		 1340 if (regF1 != 0x11)
1341 return -ENODEV;
60017617 1342 reg_w1(gspca_dev, 0x02, regGpio[1]);
6a7eba24 1343 break;
3647fea8 1344 case BRIDGE_SN9C105:
6a7eba24
JFM		 1345 if (regF1 != 0x11)
1346 return -ENODEV;
65c5259c
JFM		 1347 if (sd->sensor == SENSOR_MI0360)
1348 mi0360_probe(gspca_dev);
674cbc69 1349 reg_w(gspca_dev, 0x01, regGpio, 2);
6a7eba24 1350 break;
3647fea8 1351 case BRIDGE_SN9C120:
6a7eba24
JFM		 1352 if (regF1 != 0x12)
1353 return -ENODEV;
65c5259c
JFM		 1354 if (sd->sensor == SENSOR_MI0360)
1355 mi0360_probe(gspca_dev);
6a7eba24 1356 regGpio[1] = 0x70;
674cbc69 1357 reg_w(gspca_dev, 0x01, regGpio, 2);
6a7eba24
JFM		 1358 break;
1359 default:
60017617 1360/* case BRIDGE_SN9C110: */
3647fea8 1361/* case BRIDGE_SN9C325: */
6a7eba24
JFM		 1362 if (regF1 != 0x12)
1363 return -ENODEV;
60017617 1364 reg_w1(gspca_dev, 0x02, 0x62);
6a7eba24
JFM		 1365 break;
1366 }
1367
759aa3c2 1368 reg_w1(gspca_dev, 0xf1, 0x01);
6a7eba24
JFM		 1369
1370 return 0;
1371}
1372
98819187
JFM		 1373static u32 setexposure(struct gspca_dev *gspca_dev,
1374 u32 expo)
6a7eba24
JFM		 1375{
1376 struct sd *sd = (struct sd *) gspca_dev;
6a7eba24
JFM		 1377
1378 switch (sd->sensor) {
1379 case SENSOR_HV7131R: {
98819187 1380 u8 Expodoit[] =
6a7eba24
JFM		 1381 { 0xc1, 0x11, 0x25, 0x07, 0x27, 0xc0, 0x00, 0x16 };
1382
1383 Expodoit[3] = expo >> 16;
1384 Expodoit[4] = expo >> 8;
1385 Expodoit[5] = expo;
739570bb 1386 i2c_w8(gspca_dev, Expodoit);
6a7eba24
JFM		 1387 break;
1388 }
1389 case SENSOR_MI0360: {
3ef2c5be 1390 u8 expoMi[] = /* exposure 0x0635 -> 4 fp/s 0x10 */
6a7eba24 1391 { 0xb1, 0x5d, 0x09, 0x06, 0x35, 0x00, 0x00, 0x16 };
98819187
JFM		 1392 static const u8 doit[] = /* update sensor */
1393 { 0xb1, 0x5d, 0x07, 0x00, 0x03, 0x00, 0x00, 0x10 };
1394 static const u8 sensorgo[] = /* sensor on */
1395 { 0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10 };
6a7eba24
JFM		 1396
1397 if (expo > 0x0635)
1398 expo = 0x0635;
1399 else if (expo < 0x0001)
1400 expo = 0x0001;
1401 expoMi[3] = expo >> 8;
1402 expoMi[4] = expo;
739570bb
JFM		 1403 i2c_w8(gspca_dev, expoMi);
1404 i2c_w8(gspca_dev, doit);
1405 i2c_w8(gspca_dev, sensorgo);
6a7eba24
JFM		 1406 break;
1407 }
1408 case SENSOR_MO4000: {
98819187 1409 u8 expoMof[] =
6a7eba24 1410 { 0xa1, 0x21, 0x0f, 0x20, 0x00, 0x00, 0x00, 0x10 };
98819187 1411 u8 expoMo10[] =
6a7eba24 1412 { 0xa1, 0x21, 0x10, 0x20, 0x00, 0x00, 0x00, 0x10 };
98819187
JFM		 1413 static const u8 gainMo[] =
1414 { 0xa1, 0x21, 0x00, 0x10, 0x00, 0x00, 0x00, 0x1d };
6a7eba24
JFM		 1415
1416 if (expo > 0x1fff)
1417 expo = 0x1fff;
1418 else if (expo < 0x0001)
1419 expo = 0x0001;
1420 expoMof[3] = (expo & 0x03fc) >> 2;
739570bb 1421 i2c_w8(gspca_dev, expoMof);
6a7eba24
JFM		 1422 expoMo10[3] = ((expo & 0x1c00) >> 10)
1423 | ((expo & 0x0003) << 4);
739570bb
JFM		 1424 i2c_w8(gspca_dev, expoMo10);
1425 i2c_w8(gspca_dev, gainMo);
3ef2c5be 1426 PDEBUG(D_FRAM, "set exposure %d",
6a7eba24
JFM		 1427 ((expoMo10[3] & 0x07) << 10)
1428 | (expoMof[3] << 2)
1429 | ((expoMo10[3] & 0x30) >> 4));
1430 break;
1431 }
3ef2c5be
JFM		 1432 case SENSOR_MT9V111: {
1433 u8 expo_c1[] =
1434 { 0xb1, 0x5c, 0x09, 0x00, 0x00, 0x00, 0x00, 0x10 };
1435
1436 if (expo > 0x0280)
1437 expo = 0x0280;
1438 else if (expo < 0x0040)
1439 expo = 0x0040;
1440 expo_c1[3] = expo >> 8;
1441 expo_c1[4] = expo;
1442 i2c_w8(gspca_dev, expo_c1);
1443 break;
1444 }
d2d16e90 1445 case SENSOR_OM6802: {
98819187 1446 u8 gainOm[] =
d2d16e90
JFM		 1447 { 0xa0, 0x34, 0xe5, 0x00, 0x00, 0x00, 0x00, 0x10 };
1448
1449 if (expo > 0x03ff)
1450 expo = 0x03ff;
1451 if (expo < 0x0001)
1452 expo = 0x0001;
1453 gainOm[3] = expo >> 2;
1454 i2c_w8(gspca_dev, gainOm);
d55b83d3 1455 reg_w1(gspca_dev, 0x96, (expo >> 5) & 0x1f);
3ef2c5be 1456 PDEBUG(D_FRAM, "set exposure %d", gainOm[3]);
d2d16e90
JFM		 1457 break;
1458 }
6a7eba24
JFM		 1459 }
1460 return expo;
1461}
1462
1463static void setbrightness(struct gspca_dev *gspca_dev)
1464{
1465 struct sd *sd = (struct sd *) gspca_dev;
1466 unsigned int expo;
98819187 1467 u8 k2;
6a7eba24 1468
b1b056a5 1469 k2 = ((int) sd->brightness - 0x8000) >> 10;
6a7eba24
JFM		 1470 switch (sd->sensor) {
1471 case SENSOR_HV7131R:
1472 expo = sd->brightness << 4;
1473 if (expo > 0x002dc6c0)
1474 expo = 0x002dc6c0;
1475 else if (expo < 0x02a0)
1476 expo = 0x02a0;
1477 sd->exposure = setexposure(gspca_dev, expo);
1478 break;
1479 case SENSOR_MI0360:
6a7eba24
JFM		 1480 case SENSOR_MO4000:
1481 expo = sd->brightness >> 4;
1482 sd->exposure = setexposure(gspca_dev, expo);
1483 break;
3ef2c5be
JFM		 1484 case SENSOR_MT9V111:
1485 expo = sd->brightness >> 8;
1486 sd->exposure = setexposure(gspca_dev, expo);
1487 break;
d2d16e90
JFM		 1488 case SENSOR_OM6802:
1489 expo = sd->brightness >> 6;
1490 sd->exposure = setexposure(gspca_dev, expo);
b1b056a5 1491 k2 = sd->brightness >> 11;
d2d16e90 1492 break;
6a7eba24
JFM		 1493 }
1494
3ef2c5be
JFM		 1495 if (sd->sensor != SENSOR_MT9V111)
1496 reg_w1(gspca_dev, 0x96, k2); /* color matrix Y offset */
6a7eba24
JFM		 1497}
1498
1499static void setcontrast(struct gspca_dev *gspca_dev)
1500{
1501 struct sd *sd = (struct sd *) gspca_dev;
98819187
JFM		 1502 u8 k2;
1503 u8 contrast[6];
6a7eba24 1504
91bd3412
JFM		 1505 k2 = sd->contrast * 0x30 / (CONTRAST_MAX + 1) + 0x10; /* 10..40 */
1506 contrast[0] = (k2 + 1) / 2; /* red */
577cbf49 1507 contrast[1] = 0;
91bd3412 1508 contrast[2] = k2; /* green */
577cbf49 1509 contrast[3] = 0;
91bd3412 1510 contrast[4] = (k2 + 1) / 5; /* blue */
577cbf49
JFM		 1511 contrast[5] = 0;
1512 reg_w(gspca_dev, 0x84, contrast, sizeof contrast);
6a7eba24
JFM		 1513}
1514
1515static void setcolors(struct gspca_dev *gspca_dev)
1516{
1517 struct sd *sd = (struct sd *) gspca_dev;
403123d2 1518 int i, v;
98819187
JFM		 1519 u8 reg8a[12]; /* U & V gains */
1520 static s16 uv[6] = { /* same as reg84 in signed decimal */
403123d2
JFM		 1521 -24, -38, 64, /* UR UG UB */
1522 62, -51, -9 /* VR VG VB */
1523 };
1524 for (i = 0; i < 6; i++) {
1525 v = uv[i] * sd->colors / COLOR_DEF;
bd088835
JFM		 1526 reg8a[i * 2] = v;
1527 reg8a[i * 2 + 1] = (v >> 8) & 0x0f;
d55b83d3 1528 }
bd088835 1529 reg_w(gspca_dev, 0x8a, reg8a, sizeof reg8a);
403123d2
JFM		 1530}
1531
1532static void setredblue(struct gspca_dev *gspca_dev)
1533{
1534 struct sd *sd = (struct sd *) gspca_dev;
1535
1536 reg_w1(gspca_dev, 0x05, sd->red);
9c5f70f2 1537/* reg_w1(gspca_dev, 0x07, 32); */
403123d2 1538 reg_w1(gspca_dev, 0x06, sd->blue);
6a7eba24
JFM		 1539}
1540
592f4eb9
JFM		 1541static void setgamma(struct gspca_dev *gspca_dev)
1542{
1543 struct sd *sd = (struct sd *) gspca_dev;
1544 int i;
1545 u8 gamma[17];
b083b92f 1546 const u8 *gamma_base;
592f4eb9
JFM		 1547 static const u8 delta[17] = {
1548 0x00, 0x14, 0x1c, 0x1c, 0x1c, 0x1c, 0x1b, 0x1a,
1549 0x18, 0x13, 0x10, 0x0e, 0x08, 0x07, 0x04, 0x02, 0x00
1550 };
1551
b083b92f
JFM		 1552 switch (sd->sensor) {
1553 case SENSOR_HV7131R:
1554 case SENSOR_MT9V111:
1555 gamma_base = gamma_spec_1;
1556 break;
1557 case SENSOR_SP80708:
1558 gamma_base = gamma_spec_2;
1559 break;
1560 default:
1561 gamma_base = gamma_def;
1562 break;
1563 }
5e31dc8d 1564
592f4eb9 1565 for (i = 0; i < sizeof gamma; i++)
b083b92f 1566 gamma[i] = gamma_base[i]
592f4eb9
JFM		 1567 + delta[i] * (sd->gamma - GAMMA_DEF) / 32;
1568 reg_w(gspca_dev, 0x20, gamma, sizeof gamma);
1569}
1570
cebf3b67
JFM		 1571static void setautogain(struct gspca_dev *gspca_dev)
1572{
1573 struct sd *sd = (struct sd *) gspca_dev;
1574
f50ba1be
JFM		 1575 if (gspca_dev->ctrl_dis & (1 << AUTOGAIN_IDX))
1576 return;
2797ba2a
JFM		 1577 switch (sd->sensor) {
1578 case SENSOR_OV7630:
1579 case SENSOR_OV7648: {
1580 u8 comb;
1581
1582 if (sd->sensor == SENSOR_OV7630)
1583 comb = 0xc0;
1584 else
1585 comb = 0xa0;
1586 if (sd->autogain)
1fec747c 1587 comb |= 0x03;
2797ba2a
JFM		 1588 i2c_w1(&sd->gspca_dev, 0x13, comb);
1589 return;
1590 }
1591 }
f50ba1be
JFM		 1592 if (sd->autogain)
1593 sd->ag_cnt = AG_CNT_START;
1594 else
1595 sd->ag_cnt = -1;
cebf3b67
JFM		 1596}
1597
2797ba2a 1598/* ov7630/ov7648 only */
6c86274f
JFM		 1599static void setvflip(struct sd *sd)
1600{
2797ba2a
JFM		 1601 u8 comn;
1602
f800952c 1603 if (sd->sensor == SENSOR_OV7630) {
2797ba2a 1604 comn = 0x02;
f800952c
HG		 1605 if (!sd->vflip)
1606 comn |= 0x80;
1607 } else {
2797ba2a 1608 comn = 0x06;
f800952c
HG		 1609 if (sd->vflip)
1610 comn |= 0x80;
1611 }
2797ba2a 1612 i2c_w1(&sd->gspca_dev, 0x75, comn);
6c86274f
JFM		 1613}
1614
0cae8964
JFM		 1615static void setinfrared(struct sd *sd)
1616{
47f7f6fb
JFM		 1617 if (sd->gspca_dev.ctrl_dis & (1 << INFRARED_IDX))
1618 return;
0cae8964
JFM		 1619/*fixme: different sequence for StarCam Clip and StarCam 370i */
1620/* Clip */
1621 i2c_w1(&sd->gspca_dev, 0x02, /* gpio */
1622 sd->infrared ? 0x66 : 0x64);
1623}
1624
37c6dbe2
HG		 1625static void setfreq(struct gspca_dev *gspca_dev)
1626{
1627 struct sd *sd = (struct sd *) gspca_dev;
1628
27954930
JFM		 1629 if (gspca_dev->ctrl_dis & (1 << FREQ_IDX))
1630 return;
37c6dbe2 1631 if (sd->sensor == SENSOR_OV7660) {
d8f400ef
JFM		 1632 u8 com8;
1633
47f7f6fb 1634 com8 = 0xdf; /* auto gain/wb/expo */
37c6dbe2
HG		 1635 switch (sd->freq) {
1636 case 0: /* Banding filter disabled */
47f7f6fb 1637 i2c_w1(gspca_dev, 0x13, com8 | 0x20);
37c6dbe2
HG		 1638 break;
1639 case 1: /* 50 hz */
d8f400ef 1640 i2c_w1(gspca_dev, 0x13, com8);
37c6dbe2
HG		 1641 i2c_w1(gspca_dev, 0x3b, 0x0a);
1642 break;
1643 case 2: /* 60 hz */
d8f400ef 1644 i2c_w1(gspca_dev, 0x13, com8);
37c6dbe2
HG		 1645 i2c_w1(gspca_dev, 0x3b, 0x02);
1646 break;
1647 }
1648 } else {
1649 u8 reg2a = 0, reg2b = 0, reg2d = 0;
1650
1651 /* Get reg2a / reg2d base values */
1652 switch (sd->sensor) {
1653 case SENSOR_OV7630:
1654 reg2a = 0x08;
1655 reg2d = 0x01;
1656 break;
1657 case SENSOR_OV7648:
1658 reg2a = 0x11;
1659 reg2d = 0x81;
1660 break;
1661 }
1662
1663 switch (sd->freq) {
1664 case 0: /* Banding filter disabled */
1665 break;
1666 case 1: /* 50 hz (filter on and framerate adj) */
1667 reg2a |= 0x80;
1668 reg2b = 0xac;
1669 reg2d |= 0x04;
1670 break;
1671 case 2: /* 60 hz (filter on, no framerate adj) */
1672 reg2a |= 0x80;
1673 reg2d |= 0x04;
1674 break;
1675 }
1676 i2c_w1(gspca_dev, 0x2a, reg2a);
1677 i2c_w1(gspca_dev, 0x2b, reg2b);
1678 i2c_w1(gspca_dev, 0x2d, reg2d);
1679 }
1680}
1681
71cb2764
JFM		 1682static void setjpegqual(struct gspca_dev *gspca_dev)
1683{
1684 struct sd *sd = (struct sd *) gspca_dev;
1685 int i, sc;
1686
1687 if (sd->jpegqual < 50)
1688 sc = 5000 / sd->jpegqual;
1689 else
1690 sc = 200 - sd->jpegqual * 2;
1691#if USB_BUF_SZ < 64
1692#error "No room enough in usb_buf for quantization table"
1693#endif
1694 for (i = 0; i < 64; i++)
1695 gspca_dev->usb_buf[i] =
1696 (jpeg_head[JPEG_QT0_OFFSET + i] * sc + 50) / 100;
1697 usb_control_msg(gspca_dev->dev,
1698 usb_sndctrlpipe(gspca_dev->dev, 0),
1699 0x08,
1700 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
1701 0x0100, 0,
1702 gspca_dev->usb_buf, 64,
1703 500);
1704 for (i = 0; i < 64; i++)
1705 gspca_dev->usb_buf[i] =
1706 (jpeg_head[JPEG_QT1_OFFSET + i] * sc + 50) / 100;
1707 usb_control_msg(gspca_dev->dev,
1708 usb_sndctrlpipe(gspca_dev->dev, 0),
1709 0x08,
1710 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
1711 0x0140, 0,
1712 gspca_dev->usb_buf, 64,
1713 500);
1714
1715 sd->reg18 ^= 0x40;
1716 reg_w1(gspca_dev, 0x18, sd->reg18);
1717}
1718
6a7eba24 1719/* -- start the camera -- */
72ab97ce 1720static int sd_start(struct gspca_dev *gspca_dev)
6a7eba24
JFM		 1721{
1722 struct sd *sd = (struct sd *) gspca_dev;
6a7eba24 1723 int i;
71cb2764 1724 u8 reg1, reg17;
98819187 1725 const u8 *sn9c1xx;
6a7eba24 1726 int mode;
98819187
JFM		 1727 static const u8 C0[] = { 0x2d, 0x2d, 0x3a, 0x05, 0x04, 0x3f };
1728 static const u8 CA[] = { 0x28, 0xd8, 0x14, 0xec };
1729 static const u8 CE[] = { 0x32, 0xdd, 0x2d, 0xdd }; /* MI0360 */
1730 static const u8 CE_ov76xx[] =
674cbc69 1731 { 0x32, 0xdd, 0x32, 0xdd };
6a7eba24 1732
71cb2764
JFM		 1733 /* create the JPEG header */
1734 sd->jpeg_hdr = kmalloc(JPEG_HDR_SZ, GFP_KERNEL);
3eb0237d
JL		 1735 if (!sd->jpeg_hdr)
1736 return -ENOMEM;
71cb2764
JFM		 1737 jpeg_define(sd->jpeg_hdr, gspca_dev->height, gspca_dev->width,
1738 0x21); /* JPEG 422 */
1739 jpeg_set_qual(sd->jpeg_hdr, sd->quality);
1740
6a7eba24
JFM		 1741 sn9c1xx = sn_tb[(int) sd->sensor];
1742 configure_gpio(gspca_dev, sn9c1xx);
1743
60017617
JFM		 1744 reg_w1(gspca_dev, 0x15, sn9c1xx[0x15]);
1745 reg_w1(gspca_dev, 0x16, sn9c1xx[0x16]);
1746 reg_w1(gspca_dev, 0x12, sn9c1xx[0x12]);
1747 reg_w1(gspca_dev, 0x13, sn9c1xx[0x13]);
1748 reg_w1(gspca_dev, 0x18, sn9c1xx[0x18]);
1749 reg_w1(gspca_dev, 0xd2, 0x6a); /* DC29 */
1750 reg_w1(gspca_dev, 0xd3, 0x50);
1751 reg_w1(gspca_dev, 0xc6, 0x00);
1752 reg_w1(gspca_dev, 0xc7, 0x00);
1753 reg_w1(gspca_dev, 0xc8, 0x50);
1754 reg_w1(gspca_dev, 0xc9, 0x3c);
60017617 1755 reg_w1(gspca_dev, 0x18, sn9c1xx[0x18]);
6ab0b174 1756 switch (sd->sensor) {
3ef2c5be
JFM		 1757 case SENSOR_MT9V111:
1758 reg17 = 0xe0;
1759 break;
6ab0b174
JFM		 1760 case SENSOR_OV7630:
1761 reg17 = 0xe2;
1762 break;
1763 case SENSOR_OV7648:
6270330a 1764 reg17 = 0x20;
568788a7 1765 break;
6ab0b174 1766 case SENSOR_OV7660:
c8b9b2ca
JFM		 1767 reg17 = 0xa0;
1768 break;
568788a7 1769 default:
8f47a3ce 1770 reg17 = 0x60;
568788a7
JFM		 1771 break;
1772 }
8f47a3ce 1773 reg_w1(gspca_dev, 0x17, reg17);
1432f306 1774/* set reg1 was here */
403123d2
JFM		 1775 reg_w1(gspca_dev, 0x05, sn9c1xx[5]); /* red */
1776 reg_w1(gspca_dev, 0x07, sn9c1xx[7]); /* green */
1777 reg_w1(gspca_dev, 0x06, sn9c1xx[6]); /* blue */
60017617 1778 reg_w1(gspca_dev, 0x14, sn9c1xx[0x14]);
b083b92f 1779
5e31dc8d
JFM		 1780 setgamma(gspca_dev);
1781
05b809c7
JFM		 1782 for (i = 0; i < 8; i++)
1783 reg_w(gspca_dev, 0x84, reg84, sizeof reg84);
674cbc69 1784 switch (sd->sensor) {
3ef2c5be
JFM		 1785 case SENSOR_MT9V111:
1786 reg_w1(gspca_dev, 0x9a, 0x07);
1787 reg_w1(gspca_dev, 0x99, 0x59);
1788 break;
6270330a
JFM		 1789 case SENSOR_OV7648:
1790 reg_w1(gspca_dev, 0x9a, 0x0a);
1791 reg_w1(gspca_dev, 0x99, 0x60);
1792 break;
c8b9b2ca 1793 case SENSOR_OV7660:
5e31dc8d
JFM		 1794 case SENSOR_SP80708:
1795 reg_w1(gspca_dev, 0x9a, 0x05);
1796 reg_w1(gspca_dev, 0x99, 0x59);
1797 break;
674cbc69 1798 default:
60017617
JFM		 1799 reg_w1(gspca_dev, 0x9a, 0x08);
1800 reg_w1(gspca_dev, 0x99, 0x59);
674cbc69
JFM		 1801 break;
1802 }
6a7eba24 1803
c2446b3e 1804 mode = gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].priv;
60017617 1805 if (mode)
1432f306 1806 reg1 = 0x46; /* 320x240: clk 48Mhz, video trf enable */
60017617 1807 else
1432f306
JFM		 1808 reg1 = 0x06; /* 640x480: clk 24Mhz, video trf enable */
1809 reg17 = 0x61; /* 0x:20: enable sensor clock */
6a7eba24
JFM		 1810 switch (sd->sensor) {
1811 case SENSOR_HV7131R:
1812 hv7131R_InitSensor(gspca_dev);
6a7eba24
JFM		 1813 break;
1814 case SENSOR_MI0360:
1815 mi0360_InitSensor(gspca_dev);
6a7eba24
JFM		 1816 break;
1817 case SENSOR_MO4000:
1818 mo4000_InitSensor(gspca_dev);
1819 if (mode) {
1820/* reg1 = 0x46; * 320 clk 48Mhz 60fp/s */
1821 reg1 = 0x06; /* clk 24Mz */
1822 } else {
1823 reg17 = 0x22; /* 640 MCKSIZE */
60017617 1824/* reg1 = 0x06; * 640 clk 24Mz (done) */
6a7eba24
JFM		 1825 }
1826 break;
3ef2c5be
JFM		 1827 case SENSOR_MT9V111:
1828 mt9v111_InitSensor(gspca_dev);
1829 if (mode) {
1830 reg1 = 0x04; /* 320 clk 48Mhz */
1831 } else {
1832/* reg1 = 0x06; * 640 clk 24Mz (done) */
2687a2fb 1833 reg17 = 0xc2;
3ef2c5be 1834 }
0fbe0574 1835 break;
d2d16e90
JFM		 1836 case SENSOR_OM6802:
1837 om6802_InitSensor(gspca_dev);
d2d16e90
JFM		 1838 reg17 = 0x64; /* 640 MCKSIZE */
1839 break;
6ab0b174
JFM		 1840 case SENSOR_OV7630:
1841 ov7630_InitSensor(gspca_dev);
6c86274f 1842 setvflip(sd);
6ab0b174 1843 reg17 = 0xe2;
5b064da8 1844 reg1 = 0x44;
6ab0b174 1845 break;
6a7eba24 1846 case SENSOR_OV7648:
60017617 1847 ov7648_InitSensor(gspca_dev);
6270330a
JFM		 1848 reg17 = 0x21;
1849/* reg1 = 0x42; * 42 - 46? */
6a7eba24 1850 break;
5e31dc8d 1851 case SENSOR_OV7660:
6a7eba24 1852 ov7660_InitSensor(gspca_dev);
daa5cb42
JFM		 1853 if (sd->bridge == BRIDGE_SN9C120) {
1854 if (mode) { /* 320x240 - 160x120 */
1432f306
JFM		 1855 reg17 = 0xa2;
1856 reg1 = 0x44; /* 48 Mhz, video trf eneble */
1432f306 1857 }
daa5cb42
JFM		 1858 } else {
1859 reg17 = 0x22;
1860 reg1 = 0x06; /* 24 Mhz, video trf eneble
1861 * inverse power down */
6a7eba24
JFM		 1862 }
1863 break;
5e31dc8d
JFM		 1864 default:
1865/* case SENSOR_SP80708: */
1866 sp80708_InitSensor(gspca_dev);
1867 if (mode) {
1868/*?? reg1 = 0x04; * 320 clk 48Mhz */
5e31dc8d
JFM		 1869 } else {
1870 reg1 = 0x46; /* 640 clk 48Mz */
1871 reg17 = 0xa2;
1872 }
1873 break;
6a7eba24 1874 }
739570bb 1875 reg_w(gspca_dev, 0xc0, C0, 6);
8f47a3ce 1876 reg_w(gspca_dev, 0xca, CA, 4);
6ab0b174
JFM		 1877 switch (sd->sensor) {
1878 case SENSOR_OV7630:
1879 case SENSOR_OV7648:
674cbc69 1880 case SENSOR_OV7660:
6ab0b174 1881 reg_w(gspca_dev, 0xce, CE_ov76xx, 4);
6a7eba24
JFM		 1882 break;
1883 default:
739570bb 1884 reg_w(gspca_dev, 0xce, CE, 4);
6a7eba24
JFM		 1885 /* ?? {0x1e, 0xdd, 0x2d, 0xe7} */
1886 break;
1887 }
1888
1889 /* here change size mode 0 -> VGA; 1 -> CIF */
71cb2764
JFM		 1890 sd->reg18 = sn9c1xx[0x18] | (mode << 4) | 0x40;
1891 reg_w1(gspca_dev, 0x18, sd->reg18);
1892 setjpegqual(gspca_dev);
6a7eba24 1893
60017617 1894 reg_w1(gspca_dev, 0x17, reg17);
1432f306 1895 reg_w1(gspca_dev, 0x01, reg1);
05b809c7 1896 switch (sd->sensor) {
79a9098a
JFM		 1897 case SENSOR_OV7630:
1898 setvflip(sd);
05b809c7
JFM		 1899 break;
1900 }
91bd3412
JFM		 1901 setbrightness(gspca_dev);
1902 setcontrast(gspca_dev);
cebf3b67 1903 setautogain(gspca_dev);
37c6dbe2 1904 setfreq(gspca_dev);
72ab97ce 1905 return 0;
6a7eba24
JFM		 1906}
1907
1908static void sd_stopN(struct gspca_dev *gspca_dev)
1909{
1910 struct sd *sd = (struct sd *) gspca_dev;
98819187 1911 static const u8 stophv7131[] =
6a7eba24 1912 { 0xa1, 0x11, 0x02, 0x09, 0x00, 0x00, 0x00, 0x10 };
98819187 1913 static const u8 stopmi0360[] =
6a7eba24 1914 { 0xb1, 0x5d, 0x07, 0x00, 0x00, 0x00, 0x00, 0x10 };
98819187 1915 static const u8 stopov7648[] =
6270330a 1916 { 0xa1, 0x21, 0x76, 0x20, 0x00, 0x00, 0x00, 0x10 };
98819187
JFM		 1917 u8 data;
1918 const u8 *sn9c1xx;
6a7eba24
JFM		 1919
1920 data = 0x0b;
1921 switch (sd->sensor) {
1922 case SENSOR_HV7131R:
739570bb 1923 i2c_w8(gspca_dev, stophv7131);
6a7eba24
JFM		 1924 data = 0x2b;
1925 break;
1926 case SENSOR_MI0360:
739570bb 1927 i2c_w8(gspca_dev, stopmi0360);
6a7eba24
JFM		 1928 data = 0x29;
1929 break;
6a7eba24 1930 case SENSOR_OV7648:
6270330a
JFM		 1931 i2c_w8(gspca_dev, stopov7648);
1932 /* fall thru */
3ef2c5be 1933 case SENSOR_MT9V111:
6270330a 1934 case SENSOR_OV7630:
6a7eba24
JFM		 1935 data = 0x29;
1936 break;
1937 default:
8f47a3ce 1938/* case SENSOR_MO4000: */
6a7eba24
JFM		 1939/* case SENSOR_OV7660: */
1940 break;
1941 }
1942 sn9c1xx = sn_tb[(int) sd->sensor];
60017617
JFM		 1943 reg_w1(gspca_dev, 0x01, sn9c1xx[1]);
1944 reg_w1(gspca_dev, 0x17, sn9c1xx[0x17]);
1945 reg_w1(gspca_dev, 0x01, sn9c1xx[1]);
1946 reg_w1(gspca_dev, 0x01, data);
759aa3c2 1947 reg_w1(gspca_dev, 0xf1, 0x00);
6a7eba24
JFM		 1948}
1949
71cb2764
JFM		 1950static void sd_stop0(struct gspca_dev *gspca_dev)
1951{
1952 struct sd *sd = (struct sd *) gspca_dev;
1953
1954 kfree(sd->jpeg_hdr);
1955}
1956
cebf3b67 1957static void do_autogain(struct gspca_dev *gspca_dev)
6a7eba24
JFM		 1958{
1959 struct sd *sd = (struct sd *) gspca_dev;
6a7eba24 1960 int delta;
cebf3b67 1961 int expotimes;
98819187
JFM		 1962 u8 luma_mean = 130;
1963 u8 luma_delta = 20;
6a7eba24 1964
cebf3b67
JFM		 1965 /* Thanks S., without your advice, autobright should not work :) */
1966 if (sd->ag_cnt < 0)
1967 return;
1968 if (--sd->ag_cnt >= 0)
1969 return;
1970 sd->ag_cnt = AG_CNT_START;
1971
1972 delta = atomic_read(&sd->avg_lum);
1973 PDEBUG(D_FRAM, "mean lum %d", delta);
6a7eba24
JFM		 1974 if (delta < luma_mean - luma_delta ||
1975 delta > luma_mean + luma_delta) {
1976 switch (sd->sensor) {
1977 case SENSOR_HV7131R:
1978 expotimes = sd->exposure >> 8;
1979 expotimes += (luma_mean - delta) >> 4;
1980 if (expotimes < 0)
1981 expotimes = 0;
1982 sd->exposure = setexposure(gspca_dev,
1983 (unsigned int) (expotimes << 8));
1984 break;
46b4f2ab
AM		 1985 case SENSOR_OM6802:
1986 expotimes = sd->exposure;
1987 expotimes += (luma_mean - delta) >> 2;
1988 if (expotimes < 0)
1989 expotimes = 0;
1990 sd->exposure = setexposure(gspca_dev,
1991 (unsigned int) expotimes);
1992 setredblue(gspca_dev);
1993 break;
cebf3b67
JFM		 1994 default:
1995/* case SENSOR_MO4000: */
1996/* case SENSOR_MI0360: */
3ef2c5be 1997/* case SENSOR_MT9V111: */
6a7eba24
JFM		 1998 expotimes = sd->exposure;
1999 expotimes += (luma_mean - delta) >> 6;
2000 if (expotimes < 0)
2001 expotimes = 0;
2002 sd->exposure = setexposure(gspca_dev,
2003 (unsigned int) expotimes);
403123d2 2004 setredblue(gspca_dev);
6a7eba24
JFM		 2005 break;
2006 }
2007 }
2008}
2009
cebf3b67
JFM		 2010/* scan the URB packets */
2011/* This function is run at interrupt level. */
6a7eba24
JFM		 2012static void sd_pkt_scan(struct gspca_dev *gspca_dev,
2013 struct gspca_frame *frame, /* target */
98819187 2014 u8 *data, /* isoc packet */
6a7eba24
JFM		 2015 int len) /* iso packet length */
2016{
2017 struct sd *sd = (struct sd *) gspca_dev;
2018 int sof, avg_lum;
2019
2020 sof = len - 64;
2021 if (sof >= 0 && data[sof] == 0xff && data[sof + 1] == 0xd9) {
2022
2023 /* end of frame */
2024 gspca_frame_add(gspca_dev, LAST_PACKET,
2025 frame, data, sof + 2);
2026 if (sd->ag_cnt < 0)
2027 return;
6a7eba24
JFM		 2028/* w1 w2 w3 */
2029/* w4 w5 w6 */
2030/* w7 w8 */
2031/* w4 */
2032 avg_lum = ((data[sof + 29] << 8) | data[sof + 30]) >> 6;
2033/* w6 */
2034 avg_lum += ((data[sof + 33] << 8) | data[sof + 34]) >> 6;
2035/* w2 */
2036 avg_lum += ((data[sof + 25] << 8) | data[sof + 26]) >> 6;
2037/* w8 */
2038 avg_lum += ((data[sof + 37] << 8) | data[sof + 38]) >> 6;
2039/* w5 */
2040 avg_lum += ((data[sof + 31] << 8) | data[sof + 32]) >> 4;
2041 avg_lum >>= 4;
cebf3b67 2042 atomic_set(&sd->avg_lum, avg_lum);
6a7eba24
JFM		 2043 return;
2044 }
2045 if (gspca_dev->last_packet_type == LAST_PACKET) {
2046
2047 /* put the JPEG 422 header */
71cb2764
JFM		 2048 gspca_frame_add(gspca_dev, FIRST_PACKET, frame,
2049 sd->jpeg_hdr, JPEG_HDR_SZ);
6a7eba24
JFM		 2050 }
2051 gspca_frame_add(gspca_dev, INTER_PACKET, frame, data, len);
2052}
2053
6a7eba24
JFM		 2054static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val)
2055{
2056 struct sd *sd = (struct sd *) gspca_dev;
2057
2058 sd->brightness = val;
91bd3412
JFM		 2059 if (gspca_dev->streaming)
2060 setbrightness(gspca_dev);
6a7eba24
JFM		 2061 return 0;
2062}
2063
2064static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val)
2065{
2066 struct sd *sd = (struct sd *) gspca_dev;
2067
6a7eba24
JFM		 2068 *val = sd->brightness;
2069 return 0;
2070}
2071
2072static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val)
2073{
2074 struct sd *sd = (struct sd *) gspca_dev;
2075
2076 sd->contrast = val;
91bd3412
JFM		 2077 if (gspca_dev->streaming)
2078 setcontrast(gspca_dev);
6a7eba24
JFM		 2079 return 0;
2080}
2081
2082static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val)
2083{
2084 struct sd *sd = (struct sd *) gspca_dev;
2085
2086 *val = sd->contrast;
2087 return 0;
2088}
2089
2090static int sd_setcolors(struct gspca_dev *gspca_dev, __s32 val)
2091{
2092 struct sd *sd = (struct sd *) gspca_dev;
2093
2094 sd->colors = val;
2095 if (gspca_dev->streaming)
2096 setcolors(gspca_dev);
2097 return 0;
2098}
2099
2100static int sd_getcolors(struct gspca_dev *gspca_dev, __s32 *val)
2101{
2102 struct sd *sd = (struct sd *) gspca_dev;
2103
2104 *val = sd->colors;
2105 return 0;
2106}
2107
403123d2
JFM		 2108static int sd_setblue_balance(struct gspca_dev *gspca_dev, __s32 val)
2109{
2110 struct sd *sd = (struct sd *) gspca_dev;
2111
2112 sd->blue = val;
2113 if (gspca_dev->streaming)
2114 setredblue(gspca_dev);
2115 return 0;
2116}
2117
2118static int sd_getblue_balance(struct gspca_dev *gspca_dev, __s32 *val)
2119{
2120 struct sd *sd = (struct sd *) gspca_dev;
2121
2122 *val = sd->blue;
2123 return 0;
2124}
2125
2126static int sd_setred_balance(struct gspca_dev *gspca_dev, __s32 val)
2127{
2128 struct sd *sd = (struct sd *) gspca_dev;
2129
2130 sd->red = val;
2131 if (gspca_dev->streaming)
2132 setredblue(gspca_dev);
2133 return 0;
2134}
2135
2136static int sd_getred_balance(struct gspca_dev *gspca_dev, __s32 *val)
2137{
2138 struct sd *sd = (struct sd *) gspca_dev;
2139
2140 *val = sd->red;
2141 return 0;
2142}
2143
592f4eb9
JFM		 2144static int sd_setgamma(struct gspca_dev *gspca_dev, __s32 val)
2145{
2146 struct sd *sd = (struct sd *) gspca_dev;
2147
2148 sd->gamma = val;
2149 if (gspca_dev->streaming)
2150 setgamma(gspca_dev);
2151 return 0;
2152}
2153
2154static int sd_getgamma(struct gspca_dev *gspca_dev, __s32 *val)
2155{
2156 struct sd *sd = (struct sd *) gspca_dev;
2157
2158 *val = sd->gamma;
2159 return 0;
2160}
2161
6a7eba24
JFM		 2162static int sd_setautogain(struct gspca_dev *gspca_dev, __s32 val)
2163{
2164 struct sd *sd = (struct sd *) gspca_dev;
2165
2166 sd->autogain = val;
cebf3b67
JFM		 2167 if (gspca_dev->streaming)
2168 setautogain(gspca_dev);
6a7eba24
JFM		 2169 return 0;
2170}
2171
2172static int sd_getautogain(struct gspca_dev *gspca_dev, __s32 *val)
2173{
2174 struct sd *sd = (struct sd *) gspca_dev;
2175
2176 *val = sd->autogain;
2177 return 0;
2178}
2179
6c86274f
JFM		 2180static int sd_setvflip(struct gspca_dev *gspca_dev, __s32 val)
2181{
2182 struct sd *sd = (struct sd *) gspca_dev;
2183
2184 sd->vflip = val;
79a9098a
JFM		 2185 if (gspca_dev->streaming)
2186 setvflip(sd);
6c86274f
JFM		 2187 return 0;
2188}
2189
2190static int sd_getvflip(struct gspca_dev *gspca_dev, __s32 *val)
2191{
2192 struct sd *sd = (struct sd *) gspca_dev;
2193
2194 *val = sd->vflip;
2195 return 0;
2196}
2197
0cae8964
JFM		 2198static int sd_setinfrared(struct gspca_dev *gspca_dev, __s32 val)
2199{
2200 struct sd *sd = (struct sd *) gspca_dev;
2201
2202 sd->infrared = val;
2203 if (gspca_dev->streaming)
2204 setinfrared(sd);
2205 return 0;
2206}
2207
2208static int sd_getinfrared(struct gspca_dev *gspca_dev, __s32 *val)
2209{
2210 struct sd *sd = (struct sd *) gspca_dev;
2211
2212 *val = sd->infrared;
2213 return 0;
2214}
2215
37c6dbe2
HG		 2216static int sd_setfreq(struct gspca_dev *gspca_dev, __s32 val)
2217{
2218 struct sd *sd = (struct sd *) gspca_dev;
2219
2220 sd->freq = val;
2221 if (gspca_dev->streaming)
2222 setfreq(gspca_dev);
2223 return 0;
2224}
2225
2226static int sd_getfreq(struct gspca_dev *gspca_dev, __s32 *val)
2227{
2228 struct sd *sd = (struct sd *) gspca_dev;
2229
2230 *val = sd->freq;
2231 return 0;
2232}
2233
77ac0baf
JFM		 2234static int sd_set_jcomp(struct gspca_dev *gspca_dev,
2235 struct v4l2_jpegcompression *jcomp)
2236{
2237 struct sd *sd = (struct sd *) gspca_dev;
2238
2239 if (jcomp->quality < QUALITY_MIN)
2240 sd->quality = QUALITY_MIN;
2241 else if (jcomp->quality > QUALITY_MAX)
2242 sd->quality = QUALITY_MAX;
2243 else
2244 sd->quality = jcomp->quality;
2245 if (gspca_dev->streaming)
2246 jpeg_set_qual(sd->jpeg_hdr, sd->quality);
2247 return 0;
2248}
2249
2250static int sd_get_jcomp(struct gspca_dev *gspca_dev,
2251 struct v4l2_jpegcompression *jcomp)
2252{
2253 struct sd *sd = (struct sd *) gspca_dev;
2254
2255 memset(jcomp, 0, sizeof *jcomp);
2256 jcomp->quality = sd->quality;
2257 jcomp->jpeg_markers = V4L2_JPEG_MARKER_DHT
2258 | V4L2_JPEG_MARKER_DQT;
2259 return 0;
2260}
2261
37c6dbe2
HG		 2262static int sd_querymenu(struct gspca_dev *gspca_dev,
2263 struct v4l2_querymenu *menu)
2264{
2265 switch (menu->id) {
2266 case V4L2_CID_POWER_LINE_FREQUENCY:
2267 switch (menu->index) {
2268 case 0: /* V4L2_CID_POWER_LINE_FREQUENCY_DISABLED */
2269 strcpy((char *) menu->name, "NoFliker");
2270 return 0;
2271 case 1: /* V4L2_CID_POWER_LINE_FREQUENCY_50HZ */
2272 strcpy((char *) menu->name, "50 Hz");
2273 return 0;
2274 case 2: /* V4L2_CID_POWER_LINE_FREQUENCY_60HZ */
2275 strcpy((char *) menu->name, "60 Hz");
2276 return 0;
2277 }
2278 break;
2279 }
2280 return -EINVAL;
2281}
2282
6a7eba24 2283/* sub-driver description */
a5ae2062 2284static const struct sd_desc sd_desc = {
6a7eba24
JFM		 2285 .name = MODULE_NAME,
2286 .ctrls = sd_ctrls,
2287 .nctrls = ARRAY_SIZE(sd_ctrls),
2288 .config = sd_config,
012d6b02 2289 .init = sd_init,
6a7eba24
JFM		 2290 .start = sd_start,
2291 .stopN = sd_stopN,
71cb2764 2292 .stop0 = sd_stop0,
6a7eba24 2293 .pkt_scan = sd_pkt_scan,
cebf3b67 2294 .dq_callback = do_autogain,
77ac0baf
JFM		 2295 .get_jcomp = sd_get_jcomp,
2296 .set_jcomp = sd_set_jcomp,
37c6dbe2 2297 .querymenu = sd_querymenu,
6a7eba24
JFM		 2298};
2299
2300/* -- module initialisation -- */
9d64fdb1
JFM		 2301#define BSI(bridge, sensor, i2c_addr) \
2302 .driver_info = (BRIDGE_ ## bridge << 16) \
2303 | (SENSOR_ ## sensor << 8) \
2304 | (i2c_addr)
a5ae2062 2305static const __devinitdata struct usb_device_id device_table[] = {
222a07ff 2306#if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
9d64fdb1 2307 {USB_DEVICE(0x0458, 0x7025), BSI(SN9C120, MI0360, 0x5d)},
7b537391 2308 {USB_DEVICE(0x0458, 0x702e), BSI(SN9C120, OV7660, 0x21)},
a08d81af 2309#endif
9d64fdb1
JFM		 2310 {USB_DEVICE(0x045e, 0x00f5), BSI(SN9C105, OV7660, 0x21)},
2311 {USB_DEVICE(0x045e, 0x00f7), BSI(SN9C105, OV7660, 0x21)},
2312 {USB_DEVICE(0x0471, 0x0327), BSI(SN9C105, MI0360, 0x5d)},
7e21fda1 2313 {USB_DEVICE(0x0471, 0x0328), BSI(SN9C105, MI0360, 0x5d)},
9d64fdb1 2314 {USB_DEVICE(0x0471, 0x0330), BSI(SN9C105, MI0360, 0x5d)},
3319dc98 2315 {USB_DEVICE(0x06f8, 0x3004), BSI(SN9C105, OV7660, 0x21)},
f8eaaf4f 2316 {USB_DEVICE(0x06f8, 0x3008), BSI(SN9C105, OV7660, 0x21)},
7fb101ae 2317/* {USB_DEVICE(0x0c45, 0x603a), BSI(SN9C102P, OV7648, 0x21)}, */
9d64fdb1 2318 {USB_DEVICE(0x0c45, 0x6040), BSI(SN9C102P, HV7131R, 0x11)},
7fb101ae
JFM		 2319/* {USB_DEVICE(0x0c45, 0x607a), BSI(SN9C102P, OV7648, 0x21)}, */
2320/* {USB_DEVICE(0x0c45, 0x607b), BSI(SN9C102P, OV7660, 0x21)}, */
9d64fdb1 2321 {USB_DEVICE(0x0c45, 0x607c), BSI(SN9C102P, HV7131R, 0x11)},
7fb101ae 2322/* {USB_DEVICE(0x0c45, 0x607e), BSI(SN9C102P, OV7630, 0x21)}, */
661ab25d 2323 {USB_DEVICE(0x0c45, 0x60c0), BSI(SN9C105, MI0360, 0x5d)},
7fb101ae
JFM		 2324/* {USB_DEVICE(0x0c45, 0x60c2), BSI(SN9C105, P1030xC, 0x??)}, */
2325/* {USB_DEVICE(0x0c45, 0x60c8), BSI(SN9C105, OM6802, 0x21)}, */
9d64fdb1
JFM		 2326/* {USB_DEVICE(0x0c45, 0x60cc), BSI(SN9C105, HV7131GP, 0x??)}, */
2327 {USB_DEVICE(0x0c45, 0x60ec), BSI(SN9C105, MO4000, 0x21)},
2328/* {USB_DEVICE(0x0c45, 0x60ef), BSI(SN9C105, ICM105C, 0x??)}, */
7fb101ae 2329/* {USB_DEVICE(0x0c45, 0x60fa), BSI(SN9C105, OV7648, 0x21)}, */
9d64fdb1 2330 {USB_DEVICE(0x0c45, 0x60fb), BSI(SN9C105, OV7660, 0x21)},
3c41cb77 2331#if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
f077b0a6 2332 {USB_DEVICE(0x0c45, 0x60fc), BSI(SN9C105, HV7131R, 0x11)},
3c41cb77
JFM		 2333 {USB_DEVICE(0x0c45, 0x60fe), BSI(SN9C105, OV7630, 0x21)},
2334#endif
ceec80e5 2335 {USB_DEVICE(0x0c45, 0x6100), BSI(SN9C120, MI0360, 0x5d)}, /*sn9c128*/
7fb101ae 2336/* {USB_DEVICE(0x0c45, 0x6102), BSI(SN9C120, P1030xC, ??)}, */
6baefab5 2337/* {USB_DEVICE(0x0c45, 0x6108), BSI(SN9C120, OM6802, 0x21)}, */
ceec80e5
JFM		 2338 {USB_DEVICE(0x0c45, 0x610a), BSI(SN9C120, OV7648, 0x21)}, /*sn9c128*/
2339 {USB_DEVICE(0x0c45, 0x610b), BSI(SN9C120, OV7660, 0x21)}, /*sn9c128*/
2340 {USB_DEVICE(0x0c45, 0x610c), BSI(SN9C120, HV7131R, 0x11)}, /*sn9c128*/
2341 {USB_DEVICE(0x0c45, 0x610e), BSI(SN9C120, OV7630, 0x21)}, /*sn9c128*/
7fb101ae 2342/* {USB_DEVICE(0x0c45, 0x610f), BSI(SN9C120, S5K53BEB, 0x??)}, */
9d64fdb1
JFM		 2343/* {USB_DEVICE(0x0c45, 0x6122), BSI(SN9C110, ICM105C, 0x??)}, */
2344/* {USB_DEVICE(0x0c45, 0x6123), BSI(SN9C110, SanyoCCD, 0x??)}, */
d2d16e90
JFM		 2345 {USB_DEVICE(0x0c45, 0x6128), BSI(SN9C110, OM6802, 0x21)}, /*sn9c325?*/
2346/*bw600.inf:*/
6270330a 2347 {USB_DEVICE(0x0c45, 0x612a), BSI(SN9C120, OV7648, 0x21)}, /*sn9c110?*/
9d64fdb1 2348 {USB_DEVICE(0x0c45, 0x612c), BSI(SN9C110, MO4000, 0x21)},
6ab0b174 2349 {USB_DEVICE(0x0c45, 0x612e), BSI(SN9C110, OV7630, 0x21)},
9d64fdb1 2350/* {USB_DEVICE(0x0c45, 0x612f), BSI(SN9C110, ICM105C, 0x??)}, */
222a07ff 2351#if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
9d64fdb1 2352 {USB_DEVICE(0x0c45, 0x6130), BSI(SN9C120, MI0360, 0x5d)},
222a07ff 2353#endif
6baefab5 2354/* {USB_DEVICE(0x0c45, 0x6132), BSI(SN9C120, OV7670, 0x21)}, */
9d64fdb1 2355 {USB_DEVICE(0x0c45, 0x6138), BSI(SN9C120, MO4000, 0x21)},
821ced29 2356 {USB_DEVICE(0x0c45, 0x613a), BSI(SN9C120, OV7648, 0x21)},
222a07ff 2357#if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
9d64fdb1 2358 {USB_DEVICE(0x0c45, 0x613b), BSI(SN9C120, OV7660, 0x21)},
8d97770a 2359#endif
9d64fdb1 2360 {USB_DEVICE(0x0c45, 0x613c), BSI(SN9C120, HV7131R, 0x11)},
cc7b5b57 2361 {USB_DEVICE(0x0c45, 0x613e), BSI(SN9C120, OV7630, 0x21)},
6baefab5
DL		 2362/* {USB_DEVICE(0x0c45, 0x6142), BSI(SN9C120, PO2030N, ??)}, *sn9c120b*/
2363 {USB_DEVICE(0x0c45, 0x6143), BSI(SN9C120, SP80708, 0x18)}, /*sn9c120b*/
2364 {USB_DEVICE(0x0c45, 0x6148), BSI(SN9C120, OM6802, 0x21)}, /*sn9c120b*/
6a7eba24
JFM		 2365 {}
2366};
2367MODULE_DEVICE_TABLE(usb, device_table);
2368
2369/* -- device connect -- */
2370static int sd_probe(struct usb_interface *intf,
2371 const struct usb_device_id *id)
2372{
2373 return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
2374 THIS_MODULE);
2375}
2376
2377static struct usb_driver sd_driver = {
2378 .name = MODULE_NAME,
2379 .id_table = device_table,
2380 .probe = sd_probe,
2381 .disconnect = gspca_disconnect,
6a709749
JFM		 2382#ifdef CONFIG_PM
2383 .suspend = gspca_suspend,
2384 .resume = gspca_resume,
2385#endif
6a7eba24
JFM		 2386};
2387
2388/* -- module insert / remove -- */
2389static int __init sd_mod_init(void)
2390{
f69e9529
AK		 2391 int ret;
2392 ret = usb_register(&sd_driver);
2393 if (ret < 0)
e6b14849 2394 return ret;
10b0e96e 2395 info("registered");
6a7eba24
JFM		 2396 return 0;
2397}
2398static void __exit sd_mod_exit(void)
2399{
2400 usb_deregister(&sd_driver);
2401 info("deregistered");
2402}
2403
2404module_init(sd_mod_init);
2405module_exit(sd_mod_exit);
Ubuntu Jammy Linux kernel mirror