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