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