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