?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
V4L/DVB (11221): gspca - sonixj: Prefer sonixj instead of sn9c102 for 0471:0327.
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / media / video / gspca / sonixj.c
blobc72e19d3ac370bbb00e883f233c1b49378ff96fa
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 #define BRIDGE_SN9C325 4
66 u8 sensor; /* Type of image sensor chip */
67 #define SENSOR_HV7131R 0
68 #define SENSOR_MI0360 1
69 #define SENSOR_MO4000 2
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
75 #define SENSOR_SP80708 8
76 u8 i2c_base;
77
78 u8 *jpeg_hdr;
79 };
80
81 /* V4L2 controls supported by the driver */
82 static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val);
83 static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val);
84 static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val);
85 static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val);
86 static int sd_setcolors(struct gspca_dev *gspca_dev, __s32 val);
87 static int sd_getcolors(struct gspca_dev *gspca_dev, __s32 *val);
88 static int sd_setblue_balance(struct gspca_dev *gspca_dev, __s32 val);
89 static int sd_getblue_balance(struct gspca_dev *gspca_dev, __s32 *val);
90 static int sd_setred_balance(struct gspca_dev *gspca_dev, __s32 val);
91 static int sd_getred_balance(struct gspca_dev *gspca_dev, __s32 *val);
92 static int sd_setgamma(struct gspca_dev *gspca_dev, __s32 val);
93 static int sd_getgamma(struct gspca_dev *gspca_dev, __s32 *val);
94 static int sd_setautogain(struct gspca_dev *gspca_dev, __s32 val);
95 static int sd_getautogain(struct gspca_dev *gspca_dev, __s32 *val);
96 static int sd_setvflip(struct gspca_dev *gspca_dev, __s32 val);
97 static int sd_getvflip(struct gspca_dev *gspca_dev, __s32 *val);
98 static int sd_setinfrared(struct gspca_dev *gspca_dev, __s32 val);
99 static int sd_getinfrared(struct gspca_dev *gspca_dev, __s32 *val);
100
101 static struct ctrl sd_ctrls[] = {
102 {
103 {
104 .id = V4L2_CID_BRIGHTNESS,
105 .type = V4L2_CTRL_TYPE_INTEGER,
106 .name = "Brightness",
107 .minimum = 0,
108 #define BRIGHTNESS_MAX 0xffff
109 .maximum = BRIGHTNESS_MAX,
110 .step = 1,
111 #define BRIGHTNESS_DEF 0x8000
112 .default_value = BRIGHTNESS_DEF,
113 },
114 .set = sd_setbrightness,
115 .get = sd_getbrightness,
116 },
117 {
118 {
119 .id = V4L2_CID_CONTRAST,
120 .type = V4L2_CTRL_TYPE_INTEGER,
121 .name = "Contrast",
122 .minimum = 0,
123 #define CONTRAST_MAX 127
124 .maximum = CONTRAST_MAX,
125 .step = 1,
126 #define CONTRAST_DEF 63
127 .default_value = CONTRAST_DEF,
128 },
129 .set = sd_setcontrast,
130 .get = sd_getcontrast,
131 },
132 {
133 {
134 .id = V4L2_CID_SATURATION,
135 .type = V4L2_CTRL_TYPE_INTEGER,
136 .name = "Color",
137 .minimum = 0,
138 .maximum = 40,
139 .step = 1,
140 #define COLOR_DEF 32
141 .default_value = COLOR_DEF,
142 },
143 .set = sd_setcolors,
144 .get = sd_getcolors,
145 },
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 },
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 },
188 #define AUTOGAIN_IDX 5
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,
197 #define AUTOGAIN_DEF 1
198 .default_value = AUTOGAIN_DEF,
199 },
200 .set = sd_setautogain,
201 .get = sd_getautogain,
202 },
203 /* ov7630/ov7648 only */
204 #define VFLIP_IDX 6
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,
213 #define VFLIP_DEF 0 /* vflip def = 1 for ov7630 */
214 .default_value = VFLIP_DEF,
215 },
216 .set = sd_setvflip,
217 .get = sd_getvflip,
218 },
219 /* mt9v111 only */
220 #define INFRARED_IDX 7
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 },
235 };
236
237 /* table of the disabled controls */
238 static __u32 ctrl_dis[] = {
239 (1 << INFRARED_IDX) | (1 << VFLIP_IDX),
240 /* SENSOR_HV7131R 0 */
241 (1 << INFRARED_IDX) | (1 << VFLIP_IDX),
242 /* SENSOR_MI0360 1 */
243 (1 << INFRARED_IDX) | (1 << VFLIP_IDX),
244 /* SENSOR_MO4000 2 */
245 (1 << VFLIP_IDX),
246 /* SENSOR_MT9V111 3 */
247 (1 << INFRARED_IDX) | (1 << VFLIP_IDX),
248 /* SENSOR_OM6802 4 */
249 (1 << AUTOGAIN_IDX) | (1 << INFRARED_IDX),
250 /* SENSOR_OV7630 5 */
251 (1 << INFRARED_IDX),
252 /* SENSOR_OV7648 6 */
253 (1 << AUTOGAIN_IDX) | (1 << INFRARED_IDX) | (1 << VFLIP_IDX),
254 /* SENSOR_OV7660 7 */
255 (1 << AUTOGAIN_IDX) | (1 << INFRARED_IDX) | (1 << VFLIP_IDX),
256 /* SENSOR_SP80708 8 */
257 };
258
259 static const struct v4l2_pix_format vga_mode[] = {
260 {160, 120, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
261 .bytesperline = 160,
262 .sizeimage = 160 * 120 * 4 / 8 + 590,
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},
275 };
276
277 /*Data from sn9c102p+hv7131r */
278 static const u8 sn_hv7131[0x1c] = {
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,
285 /* reg18 reg19 reg1a reg1b */
286 0x0a, 0x00, 0x00, 0x00
287 };
288
289 static const u8 sn_mi0360[0x1c] = {
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,
296 /* reg18 reg19 reg1a reg1b */
297 0x06, 0x00, 0x00, 0x00
298 };
299
300 static const u8 sn_mo4000[0x1c] = {
301 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
302 0x00, 0x23, 0x60, 0x00, 0x1a, 0x00, 0x20, 0x18,
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,
307 /* reg18 reg19 reg1a reg1b */
308 0x08, 0x00, 0x00, 0x00
309 };
310
311 static 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
322 static const u8 sn_om6802[0x1c] = {
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,
329 /* reg18 reg19 reg1a reg1b */
330 0x05, 0x00, 0x00, 0x00
331 };
332
333 static const u8 sn_ov7630[0x1c] = {
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,
340 /* reg18 reg19 reg1a reg1b */
341 0x0b, 0x00, 0x00, 0x00
342 };
343
344 static const u8 sn_ov7648[0x1c] = {
345 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
346 0x00, 0x63, 0x40, 0x00, 0x1a, 0x20, 0x20, 0x20,
347 /* reg8 reg9 rega regb regc regd rege regf */
348 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10,
349 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
350 0x03, 0x00, 0x00, 0x01, 0x00, 0x28, 0x1e, 0x00,
351 /* reg18 reg19 reg1a reg1b */
352 0x0b, 0x00, 0x00, 0x00
353 };
354
355 static const u8 sn_ov7660[0x1c] = {
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,
362 /* reg18 reg19 reg1a reg1b */
363 0x07, 0x00, 0x00, 0x00
364 };
365
366 static 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
377 /* sequence specific to the sensors - !! index = SENSOR_xxx */
378 static const u8 *sn_tb[] = {
379 sn_hv7131,
380 sn_mi0360,
381 sn_mo4000,
382 sn_mt9v111,
383 sn_om6802,
384 sn_ov7630,
385 sn_ov7648,
386 sn_ov7660,
387 sn_sp80708
388 };
389
390 /* default gamma table */
391 static const u8 gamma_def[17] = {
392 0x00, 0x2d, 0x46, 0x5a, 0x6c, 0x7c, 0x8b, 0x99,
393 0xa6, 0xb2, 0xbf, 0xca, 0xd5, 0xe0, 0xeb, 0xf5, 0xff
394 };
395 /* gamma for sensors HV7131R and MT9V111 */
396 static 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 */
401 static 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 };
405
406 /* color matrix and offsets */
407 static const u8 reg84[] = {
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 */
412 };
413 static const u8 hv7131r_sensor_init[][8] = {
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},
442 {}
443 };
444 static const u8 mi0360_sensor_init[][8] = {
445 {0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10},
446 {0xb1, 0x5d, 0x0d, 0x00, 0x01, 0x00, 0x00, 0x10},
447 {0xb1, 0x5d, 0x0d, 0x00, 0x00, 0x00, 0x00, 0x10},
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},
467 {0xd1, 0x5d, 0x2f, 0xf7, 0xB0, 0x00, 0x04, 0x10},
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 */
496 {}
497 };
498 static const u8 mo4000_sensor_init[][8] = {
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},
519 {}
520 };
521 static 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 */
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},
532 {0xb1, 0x5c, 0x01, 0x00, 0x04, 0x00, 0x00, 0x10}, /* sensor select */
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},
538 {0xb1, 0x5c, 0x08, 0x00, 0x08, 0x00, 0x00, 0x10}, /* row start */
539 {0xb1, 0x5c, 0x0e, 0x00, 0x08, 0x00, 0x00, 0x10},
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},
553 {0xb1, 0x5c, 0x09, 0x01, 0x2c, 0x00, 0x00, 0x10},
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 };
563 static const u8 om6802_sensor_init[][8] = {
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 };
597 static const u8 ov7630_sensor_init[][8] = {
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},
605 /* win: i2c_r from 00 to 80 */
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*/
636 /* {0xa1, 0x21, 0x75, 0x82, 0x00, 0x00, 0x00, 0x10}, * COMN
637 * set by setvflip */
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},
641 /* */
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},
645 /* */
646 {0xa1, 0x21, 0x10, 0x83, 0x00, 0x00, 0x00, 0x10},
647 /* {0xb1, 0x21, 0x01, 0x88, 0x70, 0x00, 0x00, 0x10}, */
648 {}
649 };
650
651 static const u8 ov7648_sensor_init[][8] = {
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 */
680 /* {0xa1, 0x21, 0x75, 0x06, 0x00, 0x00, 0x00, 0x10}, * COMN
681 * set by setvflip */
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
698 static const u8 ov7660_sensor_init[][8] = {
699 {0xa1, 0x21, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10}, /* reset SCCB */
700 /* (delay 20ms) */
701 {0xa1, 0x21, 0x12, 0x05, 0x00, 0x00, 0x00, 0x10},
702 /* Outformat = rawRGB */
703 {0xa1, 0x21, 0x13, 0xb8, 0x00, 0x00, 0x00, 0x10}, /* init COM8 */
704 {0xd1, 0x21, 0x00, 0x01, 0x74, 0x74, 0x00, 0x10},
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 */
710 {0xd1, 0x21, 0x10, 0x7f, 0x40, 0x05, 0xff, 0x10},
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) */
719 /* {0xd1, 0x21, 0x24, 0x68, 0x58, 0xd4, 0x80, 0x10}, */
720 {0xd1, 0x21, 0x24, 0x78, 0x68, 0xd4, 0x80, 0x10},
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 */
747 {0xd1, 0x21, 0x67, 0x80, 0x7a, 0x90, 0x80, 0x10}, /* MANU */
748 {0xa1, 0x21, 0x6b, 0x0a, 0x00, 0x00, 0x00, 0x10},
749 /* band gap reference [0:3] DBLV */
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 */
759 {0xb1, 0x21, 0x92, 0x00, 0x00, 0x00, 0x00, 0x10}, /* DM_LNL/H */
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 {0x08, 0x40, 0x20, 0x10, 0x00, 0x04};
1069 static const u8 reg9a_sn9c325[] =
1070 {0x0a, 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->bridge) {
1081 case BRIDGE_SN9C325:
1082 reg9a = reg9a_sn9c325;
1083 break;
1084 default:
1085 reg9a = reg9a_def;
1086 break;
1087 }
1088 reg_w(gspca_dev, 0x9a, reg9a, 6);
1089
1090 reg_w(gspca_dev, 0xd4, regd4, sizeof regd4); /*fixme:jfm was 60 only*/
1091
1092 reg_w(gspca_dev, 0x03, &sn9c1xx[3], 0x0f);
1093
1094 switch (sd->sensor) {
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;
1101 case SENSOR_OM6802:
1102 reg_w1(gspca_dev, 0x02, 0x71);
1103 reg_w1(gspca_dev, 0x01, 0x42);
1104 reg_w1(gspca_dev, 0x17, 0x64);
1105 reg_w1(gspca_dev, 0x01, 0x42);
1106 break;
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;
1114 case SENSOR_OV7648:
1115 reg_w1(gspca_dev, 0x01, 0x63);
1116 reg_w1(gspca_dev, 0x17, 0x20);
1117 reg_w1(gspca_dev, 0x01, 0x42);
1118 break;
1119 /*jfm: from win trace */
1120 case SENSOR_OV7660:
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 */
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;
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
1284 sd->bridge = id->driver_info >> 16;
1285 sd->sensor = id->driver_info >> 8;
1286 sd->i2c_base = id->driver_info;
1287
1288 sd->brightness = BRIGHTNESS_DEF;
1289 sd->contrast = CONTRAST_DEF;
1290 sd->colors = COLOR_DEF;
1291 sd->blue = BLUE_BALANCE_DEF;
1292 sd->red = RED_BALANCE_DEF;
1293 sd->gamma = GAMMA_DEF;
1294 sd->autogain = AUTOGAIN_DEF;
1295 sd->ag_cnt = -1;
1296 if (sd->sensor != SENSOR_OV7630)
1297 sd->vflip = 0;
1298 else
1299 sd->vflip = 1;
1300 sd->infrared = INFRARED_DEF;
1301 sd->quality = QUALITY_DEF;
1302 sd->jpegqual = 80;
1303
1304 gspca_dev->ctrl_dis = ctrl_dis[sd->sensor];
1305 return 0;
1306 }
1307
1308 /* this function is called at probe and resume time */
1309 static int sd_init(struct gspca_dev *gspca_dev)
1310 {
1311 struct sd *sd = (struct sd *) gspca_dev;
1312 u8 regGpio[] = { 0x29, 0x74 };
1313 u8 regF1;
1314
1315 /* setup a selector by bridge */
1316 reg_w1(gspca_dev, 0xf1, 0x01);
1317 reg_r(gspca_dev, 0x00, 1);
1318 reg_w1(gspca_dev, 0xf1, gspca_dev->usb_buf[0]);
1319 reg_r(gspca_dev, 0x00, 1); /* get sonix chip id */
1320 regF1 = gspca_dev->usb_buf[0];
1321 PDEBUG(D_PROBE, "Sonix chip id: %02x", regF1);
1322 switch (sd->bridge) {
1323 case BRIDGE_SN9C102P:
1324 if (regF1 != 0x11)
1325 return -ENODEV;
1326 reg_w1(gspca_dev, 0x02, regGpio[1]);
1327 break;
1328 case BRIDGE_SN9C105:
1329 if (regF1 != 0x11)
1330 return -ENODEV;
1331 if (sd->sensor == SENSOR_MI0360)
1332 mi0360_probe(gspca_dev);
1333 reg_w(gspca_dev, 0x01, regGpio, 2);
1334 break;
1335 case BRIDGE_SN9C120:
1336 if (regF1 != 0x12)
1337 return -ENODEV;
1338 if (sd->sensor == SENSOR_MI0360)
1339 mi0360_probe(gspca_dev);
1340 regGpio[1] = 0x70;
1341 reg_w(gspca_dev, 0x01, regGpio, 2);
1342 break;
1343 default:
1344 /* case BRIDGE_SN9C110: */
1345 /* case BRIDGE_SN9C325: */
1346 if (regF1 != 0x12)
1347 return -ENODEV;
1348 reg_w1(gspca_dev, 0x02, 0x62);
1349 break;
1350 }
1351
1352 reg_w1(gspca_dev, 0xf1, 0x01);
1353
1354 return 0;
1355 }
1356
1357 static u32 setexposure(struct gspca_dev *gspca_dev,
1358 u32 expo)
1359 {
1360 struct sd *sd = (struct sd *) gspca_dev;
1361
1362 switch (sd->sensor) {
1363 case SENSOR_HV7131R: {
1364 u8 Expodoit[] =
1365 { 0xc1, 0x11, 0x25, 0x07, 0x27, 0xc0, 0x00, 0x16 };
1366
1367 Expodoit[3] = expo >> 16;
1368 Expodoit[4] = expo >> 8;
1369 Expodoit[5] = expo;
1370 i2c_w8(gspca_dev, Expodoit);
1371 break;
1372 }
1373 case SENSOR_MI0360: {
1374 u8 expoMi[] = /* exposure 0x0635 -> 4 fp/s 0x10 */
1375 { 0xb1, 0x5d, 0x09, 0x06, 0x35, 0x00, 0x00, 0x16 };
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 };
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;
1387 i2c_w8(gspca_dev, expoMi);
1388 i2c_w8(gspca_dev, doit);
1389 i2c_w8(gspca_dev, sensorgo);
1390 break;
1391 }
1392 case SENSOR_MO4000: {
1393 u8 expoMof[] =
1394 { 0xa1, 0x21, 0x0f, 0x20, 0x00, 0x00, 0x00, 0x10 };
1395 u8 expoMo10[] =
1396 { 0xa1, 0x21, 0x10, 0x20, 0x00, 0x00, 0x00, 0x10 };
1397 static const u8 gainMo[] =
1398 { 0xa1, 0x21, 0x00, 0x10, 0x00, 0x00, 0x00, 0x1d };
1399
1400 if (expo > 0x1fff)
1401 expo = 0x1fff;
1402 else if (expo < 0x0001)
1403 expo = 0x0001;
1404 expoMof[3] = (expo & 0x03fc) >> 2;
1405 i2c_w8(gspca_dev, expoMof);
1406 expoMo10[3] = ((expo & 0x1c00) >> 10)
1407 | ((expo & 0x0003) << 4);
1408 i2c_w8(gspca_dev, expoMo10);
1409 i2c_w8(gspca_dev, gainMo);
1410 PDEBUG(D_FRAM, "set exposure %d",
1411 ((expoMo10[3] & 0x07) << 10)
1412 | (expoMof[3] << 2)
1413 | ((expoMo10[3] & 0x30) >> 4));
1414 break;
1415 }
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 }
1429 case SENSOR_OM6802: {
1430 u8 gainOm[] =
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);
1439 reg_w1(gspca_dev, 0x96, (expo >> 5) & 0x1f);
1440 PDEBUG(D_FRAM, "set exposure %d", gainOm[3]);
1441 break;
1442 }
1443 }
1444 return expo;
1445 }
1446
1447 static void setbrightness(struct gspca_dev *gspca_dev)
1448 {
1449 struct sd *sd = (struct sd *) gspca_dev;
1450 unsigned int expo;
1451 u8 k2;
1452
1453 k2 = ((int) sd->brightness - 0x8000) >> 10;
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:
1464 case SENSOR_MO4000:
1465 expo = sd->brightness >> 4;
1466 sd->exposure = setexposure(gspca_dev, expo);
1467 break;
1468 case SENSOR_MT9V111:
1469 expo = sd->brightness >> 8;
1470 sd->exposure = setexposure(gspca_dev, expo);
1471 break;
1472 case SENSOR_OM6802:
1473 expo = sd->brightness >> 6;
1474 sd->exposure = setexposure(gspca_dev, expo);
1475 k2 = sd->brightness >> 11;
1476 break;
1477 }
1478
1479 if (sd->sensor != SENSOR_MT9V111)
1480 reg_w1(gspca_dev, 0x96, k2); /* color matrix Y offset */
1481 }
1482
1483 static void setcontrast(struct gspca_dev *gspca_dev)
1484 {
1485 struct sd *sd = (struct sd *) gspca_dev;
1486 u8 k2;
1487 u8 contrast[6];
1488
1489 k2 = sd->contrast * 0x30 / (CONTRAST_MAX + 1) + 0x10; /* 10..40 */
1490 contrast[0] = (k2 + 1) / 2; /* red */
1491 contrast[1] = 0;
1492 contrast[2] = k2; /* green */
1493 contrast[3] = 0;
1494 contrast[4] = (k2 + 1) / 5; /* blue */
1495 contrast[5] = 0;
1496 reg_w(gspca_dev, 0x84, contrast, sizeof contrast);
1497 }
1498
1499 static void setcolors(struct gspca_dev *gspca_dev)
1500 {
1501 struct sd *sd = (struct sd *) gspca_dev;
1502 int i, v;
1503 u8 reg8a[12]; /* U & V gains */
1504 static s16 uv[6] = { /* same as reg84 in signed decimal */
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;
1510 reg8a[i * 2] = v;
1511 reg8a[i * 2 + 1] = (v >> 8) & 0x0f;
1512 }
1513 reg_w(gspca_dev, 0x8a, reg8a, sizeof reg8a);
1514 }
1515
1516 static 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);
1521 /* reg_w1(gspca_dev, 0x07, 32); */
1522 reg_w1(gspca_dev, 0x06, sd->blue);
1523 }
1524
1525 static void setgamma(struct gspca_dev *gspca_dev)
1526 {
1527 struct sd *sd = (struct sd *) gspca_dev;
1528 int i;
1529 u8 gamma[17];
1530 const u8 *gamma_base;
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
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 }
1548
1549 for (i = 0; i < sizeof gamma; i++)
1550 gamma[i] = gamma_base[i]
1551 + delta[i] * (sd->gamma - GAMMA_DEF) / 32;
1552 reg_w(gspca_dev, 0x20, gamma, sizeof gamma);
1553 }
1554
1555 static void setautogain(struct gspca_dev *gspca_dev)
1556 {
1557 struct sd *sd = (struct sd *) gspca_dev;
1558
1559 if (gspca_dev->ctrl_dis & (1 << AUTOGAIN_IDX))
1560 return;
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 }
1576 if (sd->autogain)
1577 sd->ag_cnt = AG_CNT_START;
1578 else
1579 sd->ag_cnt = -1;
1580 }
1581
1582 /* ov7630/ov7648 only */
1583 static void setvflip(struct sd *sd)
1584 {
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);
1594 }
1595
1596 static 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
1604 static 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
1641 /* -- start the camera -- */
1642 static int sd_start(struct gspca_dev *gspca_dev)
1643 {
1644 struct sd *sd = (struct sd *) gspca_dev;
1645 int i;
1646 u8 reg1, reg17;
1647 const u8 *sn9c1xx;
1648 int mode;
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[] =
1653 { 0x32, 0xdd, 0x32, 0xdd };
1654
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
1661 sn9c1xx = sn_tb[(int) sd->sensor];
1662 configure_gpio(gspca_dev, sn9c1xx);
1663
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);
1675 reg_w1(gspca_dev, 0x18, sn9c1xx[0x18]);
1676 switch (sd->sensor) {
1677 case SENSOR_MT9V111:
1678 reg17 = 0xe0;
1679 break;
1680 case SENSOR_OV7630:
1681 reg17 = 0xe2;
1682 break;
1683 case SENSOR_OV7648:
1684 reg17 = 0x20;
1685 break;
1686 /*jfm: from win trace */
1687 case SENSOR_OV7660:
1688 if (sd->bridge == BRIDGE_SN9C120) {
1689 reg17 = 0xa0;
1690 break;
1691 }
1692 /* fall thru */
1693 default:
1694 reg17 = 0x60;
1695 break;
1696 }
1697 reg_w1(gspca_dev, 0x17, reg17);
1698 /* set reg1 was here */
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 */
1702 reg_w1(gspca_dev, 0x14, sn9c1xx[0x14]);
1703
1704 setgamma(gspca_dev);
1705
1706 for (i = 0; i < 8; i++)
1707 reg_w(gspca_dev, 0x84, reg84, sizeof reg84);
1708 switch (sd->sensor) {
1709 case SENSOR_MT9V111:
1710 reg_w1(gspca_dev, 0x9a, 0x07);
1711 reg_w1(gspca_dev, 0x99, 0x59);
1712 break;
1713 case SENSOR_OV7648:
1714 reg_w1(gspca_dev, 0x9a, 0x0a);
1715 reg_w1(gspca_dev, 0x99, 0x60);
1716 break;
1717 case SENSOR_SP80708:
1718 reg_w1(gspca_dev, 0x9a, 0x05);
1719 reg_w1(gspca_dev, 0x99, 0x59);
1720 break;
1721 case SENSOR_OV7660:
1722 if (sd->bridge == BRIDGE_SN9C120) {
1723 reg_w1(gspca_dev, 0x9a, 0x05);
1724 break;
1725 }
1726 /* fall thru */
1727 default:
1728 reg_w1(gspca_dev, 0x9a, 0x08);
1729 reg_w1(gspca_dev, 0x99, 0x59);
1730 break;
1731 }
1732
1733 mode = gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].priv;
1734 if (mode)
1735 reg1 = 0x46; /* 320x240: clk 48Mhz, video trf enable */
1736 else
1737 reg1 = 0x06; /* 640x480: clk 24Mhz, video trf enable */
1738 reg17 = 0x61; /* 0x:20: enable sensor clock */
1739 switch (sd->sensor) {
1740 case SENSOR_HV7131R:
1741 hv7131R_InitSensor(gspca_dev);
1742 break;
1743 case SENSOR_MI0360:
1744 mi0360_InitSensor(gspca_dev);
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 */
1753 /* reg1 = 0x06; * 640 clk 24Mz (done) */
1754 }
1755 break;
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) */
1762 reg17 = 0xc2;
1763 }
1764 break;
1765 case SENSOR_OM6802:
1766 om6802_InitSensor(gspca_dev);
1767 reg17 = 0x64; /* 640 MCKSIZE */
1768 break;
1769 case SENSOR_OV7630:
1770 ov7630_InitSensor(gspca_dev);
1771 setvflip(sd);
1772 reg17 = 0xe2;
1773 reg1 = 0x44;
1774 break;
1775 case SENSOR_OV7648:
1776 ov7648_InitSensor(gspca_dev);
1777 reg17 = 0x21;
1778 /* reg1 = 0x42; * 42 - 46? */
1779 break;
1780 case SENSOR_OV7660:
1781 ov7660_InitSensor(gspca_dev);
1782 if (sd->bridge == BRIDGE_SN9C120) {
1783 if (mode) { /* 320x240 - 160x120 */
1784 reg17 = 0xa2;
1785 reg1 = 0x44; /* 48 Mhz, video trf eneble */
1786 }
1787 } else {
1788 reg17 = 0x22;
1789 reg1 = 0x06; /* 24 Mhz, video trf eneble
1790 * inverse power down */
1791 }
1792 break;
1793 default:
1794 /* case SENSOR_SP80708: */
1795 sp80708_InitSensor(gspca_dev);
1796 if (mode) {
1797 /*?? reg1 = 0x04; * 320 clk 48Mhz */
1798 } else {
1799 reg1 = 0x46; /* 640 clk 48Mz */
1800 reg17 = 0xa2;
1801 }
1802 break;
1803 }
1804 reg_w(gspca_dev, 0xc0, C0, 6);
1805 reg_w(gspca_dev, 0xca, CA, 4);
1806 switch (sd->sensor) {
1807 case SENSOR_OV7630:
1808 case SENSOR_OV7648:
1809 case SENSOR_OV7660:
1810 reg_w(gspca_dev, 0xce, CE_ov76xx, 4);
1811 break;
1812 default:
1813 reg_w(gspca_dev, 0xce, CE, 4);
1814 /* ?? {0x1e, 0xdd, 0x2d, 0xe7} */
1815 break;
1816 }
1817
1818 /* here change size mode 0 -> VGA; 1 -> CIF */
1819 sd->reg18 = sn9c1xx[0x18] | (mode << 4) | 0x40;
1820 reg_w1(gspca_dev, 0x18, sd->reg18);
1821 setjpegqual(gspca_dev);
1822
1823 reg_w1(gspca_dev, 0x17, reg17);
1824 reg_w1(gspca_dev, 0x01, reg1);
1825 switch (sd->sensor) {
1826 case SENSOR_OV7630:
1827 setvflip(sd);
1828 break;
1829 }
1830 setbrightness(gspca_dev);
1831 setcontrast(gspca_dev);
1832 setautogain(gspca_dev);
1833 return 0;
1834 }
1835
1836 static void sd_stopN(struct gspca_dev *gspca_dev)
1837 {
1838 struct sd *sd = (struct sd *) gspca_dev;
1839 static const u8 stophv7131[] =
1840 { 0xa1, 0x11, 0x02, 0x09, 0x00, 0x00, 0x00, 0x10 };
1841 static const u8 stopmi0360[] =
1842 { 0xb1, 0x5d, 0x07, 0x00, 0x00, 0x00, 0x00, 0x10 };
1843 static const u8 stopov7648[] =
1844 { 0xa1, 0x21, 0x76, 0x20, 0x00, 0x00, 0x00, 0x10 };
1845 u8 data;
1846 const u8 *sn9c1xx;
1847
1848 data = 0x0b;
1849 switch (sd->sensor) {
1850 case SENSOR_HV7131R:
1851 i2c_w8(gspca_dev, stophv7131);
1852 data = 0x2b;
1853 break;
1854 case SENSOR_MI0360:
1855 i2c_w8(gspca_dev, stopmi0360);
1856 data = 0x29;
1857 break;
1858 case SENSOR_OV7648:
1859 i2c_w8(gspca_dev, stopov7648);
1860 /* fall thru */
1861 case SENSOR_MT9V111:
1862 case SENSOR_OV7630:
1863 data = 0x29;
1864 break;
1865 default:
1866 /* case SENSOR_MO4000: */
1867 /* case SENSOR_OV7660: */
1868 break;
1869 }
1870 sn9c1xx = sn_tb[(int) sd->sensor];
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);
1875 reg_w1(gspca_dev, 0xf1, 0x00);
1876 }
1877
1878 static 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
1885 static void do_autogain(struct gspca_dev *gspca_dev)
1886 {
1887 struct sd *sd = (struct sd *) gspca_dev;
1888 int delta;
1889 int expotimes;
1890 u8 luma_mean = 130;
1891 u8 luma_delta = 20;
1892
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);
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;
1913 default:
1914 /* case SENSOR_MO4000: */
1915 /* case SENSOR_MI0360: */
1916 /* case SENSOR_MT9V111: */
1917 /* case SENSOR_OM6802: */
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);
1924 setredblue(gspca_dev);
1925 break;
1926 }
1927 }
1928 }
1929
1930 /* scan the URB packets */
1931 /* This function is run at interrupt level. */
1932 static void sd_pkt_scan(struct gspca_dev *gspca_dev,
1933 struct gspca_frame *frame, /* target */
1934 u8 *data, /* isoc packet */
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;
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;
1962 atomic_set(&sd->avg_lum, avg_lum);
1963 return;
1964 }
1965 if (gspca_dev->last_packet_type == LAST_PACKET) {
1966
1967 /* put the JPEG 422 header */
1968 gspca_frame_add(gspca_dev, FIRST_PACKET, frame,
1969 sd->jpeg_hdr, JPEG_HDR_SZ);
1970 }
1971 gspca_frame_add(gspca_dev, INTER_PACKET, frame, data, len);
1972 }
1973
1974 static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val)
1975 {
1976 struct sd *sd = (struct sd *) gspca_dev;
1977
1978 sd->brightness = val;
1979 if (gspca_dev->streaming)
1980 setbrightness(gspca_dev);
1981 return 0;
1982 }
1983
1984 static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val)
1985 {
1986 struct sd *sd = (struct sd *) gspca_dev;
1987
1988 *val = sd->brightness;
1989 return 0;
1990 }
1991
1992 static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val)
1993 {
1994 struct sd *sd = (struct sd *) gspca_dev;
1995
1996 sd->contrast = val;
1997 if (gspca_dev->streaming)
1998 setcontrast(gspca_dev);
1999 return 0;
2000 }
2001
2002 static 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
2010 static 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
2020 static 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
2028 static 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
2038 static 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
2046 static 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
2056 static 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
2064 static 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
2074 static 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
2082 static int sd_setautogain(struct gspca_dev *gspca_dev, __s32 val)
2083 {
2084 struct sd *sd = (struct sd *) gspca_dev;
2085
2086 sd->autogain = val;
2087 if (gspca_dev->streaming)
2088 setautogain(gspca_dev);
2089 return 0;
2090 }
2091
2092 static 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
2100 static int sd_setvflip(struct gspca_dev *gspca_dev, __s32 val)
2101 {
2102 struct sd *sd = (struct sd *) gspca_dev;
2103
2104 sd->vflip = val;
2105 if (gspca_dev->streaming)
2106 setvflip(sd);
2107 return 0;
2108 }
2109
2110 static 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
2118 static 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
2128 static 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
2136 static 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
2152 static 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
2164 /* sub-driver description */
2165 static const struct sd_desc sd_desc = {
2166 .name = MODULE_NAME,
2167 .ctrls = sd_ctrls,
2168 .nctrls = ARRAY_SIZE(sd_ctrls),
2169 .config = sd_config,
2170 .init = sd_init,
2171 .start = sd_start,
2172 .stopN = sd_stopN,
2173 .stop0 = sd_stop0,
2174 .pkt_scan = sd_pkt_scan,
2175 .dq_callback = do_autogain,
2176 .get_jcomp = sd_get_jcomp,
2177 .set_jcomp = sd_set_jcomp,
2178 };
2179
2180 /* -- module initialisation -- */
2181 #define BSI(bridge, sensor, i2c_addr) \
2182 .driver_info = (BRIDGE_ ## bridge << 16) \
2183 | (SENSOR_ ## sensor << 8) \
2184 | (i2c_addr)
2185 static const __devinitdata struct usb_device_id device_table[] = {
2186 #if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
2187 {USB_DEVICE(0x0458, 0x7025), BSI(SN9C120, MI0360, 0x5d)},
2188 {USB_DEVICE(0x0458, 0x702e), BSI(SN9C120, OV7660, 0x21)},
2189 #endif
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)},
2193 {USB_DEVICE(0x0471, 0x0328), BSI(SN9C105, MI0360, 0x5d)},
2194 {USB_DEVICE(0x0471, 0x0330), BSI(SN9C105, MI0360, 0x5d)},
2195 {USB_DEVICE(0x06f8, 0x3004), BSI(SN9C105, OV7660, 0x21)},
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??)}, */
2203 {USB_DEVICE(0x0c45, 0x60c0), BSI(SN9C105, MI0360, 0x5d)},
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)},
2211 #if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
2212 {USB_DEVICE(0x0c45, 0x60fe), BSI(SN9C105, OV7630, 0x21)},
2213 #endif
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??)}, */
2217 {USB_DEVICE(0x0c45, 0x6128), BSI(SN9C110, OM6802, 0x21)}, /*sn9c325?*/
2218 /*bw600.inf:*/
2219 {USB_DEVICE(0x0c45, 0x612a), BSI(SN9C120, OV7648, 0x21)}, /*sn9c110?*/
2220 {USB_DEVICE(0x0c45, 0x612c), BSI(SN9C110, MO4000, 0x21)},
2221 {USB_DEVICE(0x0c45, 0x612e), BSI(SN9C110, OV7630, 0x21)},
2222 /* {USB_DEVICE(0x0c45, 0x612f), BSI(SN9C110, ICM105C, 0x??)}, */
2223 #if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
2224 {USB_DEVICE(0x0c45, 0x6130), BSI(SN9C120, MI0360, 0x5d)},
2225 #endif
2226 {USB_DEVICE(0x0c45, 0x6138), BSI(SN9C120, MO4000, 0x21)},
2227 {USB_DEVICE(0x0c45, 0x613a), BSI(SN9C120, OV7648, 0x21)},
2228 #if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
2229 {USB_DEVICE(0x0c45, 0x613b), BSI(SN9C120, OV7660, 0x21)},
2230 #endif
2231 {USB_DEVICE(0x0c45, 0x613c), BSI(SN9C120, HV7131R, 0x11)},
2232 /* {USB_DEVICE(0x0c45, 0x613e), BSI(SN9C120, OV7630, 0x??)}, */
2233 {USB_DEVICE(0x0c45, 0x6143), BSI(SN9C120, SP80708, 0x18)},
2234 {}
2235 };
2236 MODULE_DEVICE_TABLE(usb, device_table);
2237
2238 /* -- device connect -- */
2239 static 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
2246 static struct usb_driver sd_driver = {
2247 .name = MODULE_NAME,
2248 .id_table = device_table,
2249 .probe = sd_probe,
2250 .disconnect = gspca_disconnect,
2251 #ifdef CONFIG_PM
2252 .suspend = gspca_suspend,
2253 .resume = gspca_resume,
2254 #endif
2255 };
2256
2257 /* -- module insert / remove -- */
2258 static int __init sd_mod_init(void)
2259 {
2260 int ret;
2261 ret = usb_register(&sd_driver);
2262 if (ret < 0)
2263 return ret;
2264 info("registered");
2265 return 0;
2266 }
2267 static void __exit sd_mod_exit(void)
2268 {
2269 usb_deregister(&sd_driver);
2270 info("deregistered");
2271 }
2272
2273 module_init(sd_mod_init);
2274 module_exit(sd_mod_exit);
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree