]> bbs.cooldavid.org Git - net-next-2.6.git/blame - drivers/media/video/gspca/sonixb.c
git://bbs.cooldavid.org / net-next-2.6.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
V4L/DVB (8873): gspca: Bad image offset with rev012a of spca561 and adjust exposure.
[net-next-2.6.git] / drivers / media / video / gspca / sonixb.c
CommitLineData
6a7eba24
JFM		 1/*
2 * sonix sn9c102 (bayer) library
3 * Copyright (C) 2003 2004 Michel Xhaard mxhaard@magic.fr
4 * Add Pas106 Stefano Mozzi (C) 2004
5 *
6 * V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21 */
22
93627736
HG		 23/* Some documentation on known sonixb registers:
24
25Reg Use
260x10 high nibble red gain low nibble blue gain
270x11 low nibble green gain
280x12 hstart
290x13 vstart
300x15 hsize (hsize = register-value * 16)
310x16 vsize (vsize = register-value * 16)
320x17 bit 0 toggle compression quality (according to sn9c102 driver)
330x18 bit 7 enables compression, bit 4-5 set image down scaling:
34 00 scale 1, 01 scale 1/2, 10, scale 1/4
350x19 high-nibble is sensor clock divider, changes exposure on sensors which
36 use a clock generated by the bridge. Some sensors have their own clock.
370x1c auto_exposure area (for avg_lum) startx (startx = register-value * 32)
380x1d auto_exposure area (for avg_lum) starty (starty = register-value * 32)
390x1e auto_exposure area (for avg_lum) stopx (hsize = (0x1e - 0x1c) * 32)
400x1f auto_exposure area (for avg_lum) stopy (vsize = (0x1f - 0x1d) * 32)
41*/
42
6a7eba24
JFM		 43#define MODULE_NAME "sonixb"
44
45#include "gspca.h"
46
6a7eba24
JFM		 47MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>");
48MODULE_DESCRIPTION("GSPCA/SN9C102 USB Camera Driver");
49MODULE_LICENSE("GPL");
50
51/* specific webcam descriptor */
52struct sd {
53 struct gspca_dev gspca_dev; /* !! must be the first item */
dcef3237 54 atomic_t avg_lum;
bf2a2202 55 int prev_avg_lum;
dcef3237 56
ad5ef80d
HG		 57 unsigned char gain;
58 unsigned char exposure;
6a7eba24 59 unsigned char brightness;
dcef3237
HG		 60 unsigned char autogain;
61 unsigned char autogain_ignore_frames;
6af492e5 62 unsigned char frames_to_drop;
66f35821 63 unsigned char freq; /* light freq filter setting */
6a7eba24 64
f45f06b6
HG		 65 __u8 bridge; /* Type of bridge */
66#define BRIDGE_101 0
67#define BRIDGE_102 0 /* We make no difference between 101 and 102 */
68#define BRIDGE_103 1
69
70 __u8 sensor; /* Type of image sensor chip */
6a7eba24
JFM		 71#define SENSOR_HV7131R 0
72#define SENSOR_OV6650 1
73#define SENSOR_OV7630 2
6af492e5
HG		 74#define SENSOR_PAS106 3
75#define SENSOR_PAS202 4
76#define SENSOR_TAS5110 5
77#define SENSOR_TAS5130CXX 6
6af492e5 78 __u8 reg11;
6a7eba24
JFM		 79};
80
f45f06b6
HG		 81typedef const __u8 sensor_init_t[8];
82
83struct sensor_data {
84 const __u8 *bridge_init[2];
85 int bridge_init_size[2];
86 sensor_init_t *sensor_init;
87 int sensor_init_size;
88 sensor_init_t *sensor_bridge_init[2];
89 int sensor_bridge_init_size[2];
90 int flags;
91 unsigned ctrl_dis;
92 __u8 sensor_addr;
93};
94
95/* sensor_data flags */
5da162e7 96#define F_GAIN 0x01 /* has gain */
e2ad2a54 97#define F_SIF 0x02 /* sif or vga */
c437d657
HG		 98
99/* priv field of struct v4l2_pix_format flags (do not use low nibble!) */
100#define MODE_RAW 0x10 /* raw bayer mode */
93627736 101#define MODE_REDUCED_SIF 0x20 /* vga mode (320x240 / 160x120) on sif cam */
f45f06b6
HG		 102
103/* ctrl_dis helper macros */
104#define NO_EXPO ((1 << EXPOSURE_IDX) | (1 << AUTOGAIN_IDX))
105#define NO_FREQ (1 << FREQ_IDX)
106#define NO_BRIGHTNESS (1 << BRIGHTNESS_IDX)
5da162e7 107
6a7eba24
JFM		 108#define COMP2 0x8f
109#define COMP 0xc7 /* 0x87 //0x07 */
110#define COMP1 0xc9 /* 0x89 //0x09 */
111
112#define MCK_INIT 0x63
113#define MCK_INIT1 0x20 /*fixme: Bayer - 0x50 for JPEG ??*/
114
115#define SYS_CLK 0x04
116
f45f06b6
HG		 117#define SENS(bridge_1, bridge_3, sensor, sensor_1, \
118 sensor_3, _flags, _ctrl_dis, _sensor_addr) \
119{ \
120 .bridge_init = { bridge_1, bridge_3 }, \
121 .bridge_init_size = { sizeof(bridge_1), sizeof(bridge_3) }, \
122 .sensor_init = sensor, \
123 .sensor_init_size = sizeof(sensor), \
124 .sensor_bridge_init = { sensor_1, sensor_3,}, \
125 .sensor_bridge_init_size = { sizeof(sensor_1), sizeof(sensor_3)}, \
126 .flags = _flags, .ctrl_dis = _ctrl_dis, .sensor_addr = _sensor_addr \
127}
128
dcef3237
HG		 129/* We calculate the autogain at the end of the transfer of a frame, at this
130 moment a frame with the old settings is being transmitted, and a frame is
131 being captured with the old settings. So if we adjust the autogain we must
132 ignore atleast the 2 next frames for the new settings to come into effect
133 before doing any other adjustments */
134#define AUTOGAIN_IGNORE_FRAMES 3
ad5ef80d 135#define AUTOGAIN_DEADZONE 1000
dcef3237
HG		 136#define DESIRED_AVG_LUM 7000
137
6a7eba24
JFM		 138/* V4L2 controls supported by the driver */
139static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val);
140static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val);
dcef3237
HG		 141static int sd_setgain(struct gspca_dev *gspca_dev, __s32 val);
142static int sd_getgain(struct gspca_dev *gspca_dev, __s32 *val);
143static int sd_setexposure(struct gspca_dev *gspca_dev, __s32 val);
144static int sd_getexposure(struct gspca_dev *gspca_dev, __s32 *val);
145static int sd_setautogain(struct gspca_dev *gspca_dev, __s32 val);
146static int sd_getautogain(struct gspca_dev *gspca_dev, __s32 *val);
66f35821
HG		 147static int sd_setfreq(struct gspca_dev *gspca_dev, __s32 val);
148static int sd_getfreq(struct gspca_dev *gspca_dev, __s32 *val);
6a7eba24
JFM		 149
150static struct ctrl sd_ctrls[] = {
e2ad2a54 151#define BRIGHTNESS_IDX 0
6a7eba24
JFM		 152 {
153 {
154 .id = V4L2_CID_BRIGHTNESS,
155 .type = V4L2_CTRL_TYPE_INTEGER,
156 .name = "Brightness",
157 .minimum = 0,
158 .maximum = 255,
159 .step = 1,
dcef3237
HG		 160#define BRIGHTNESS_DEF 127
161 .default_value = BRIGHTNESS_DEF,
6a7eba24
JFM		 162 },
163 .set = sd_setbrightness,
164 .get = sd_getbrightness,
165 },
e2ad2a54 166#define GAIN_IDX 1
6a7eba24
JFM		 167 {
168 {
dcef3237 169 .id = V4L2_CID_GAIN,
6a7eba24 170 .type = V4L2_CTRL_TYPE_INTEGER,
dcef3237 171 .name = "Gain",
6a7eba24 172 .minimum = 0,
ad5ef80d 173 .maximum = 255,
6a7eba24 174 .step = 1,
ad5ef80d
HG		 175#define GAIN_DEF 127
176#define GAIN_KNEE 200
dcef3237 177 .default_value = GAIN_DEF,
6a7eba24 178 },
dcef3237
HG		 179 .set = sd_setgain,
180 .get = sd_getgain,
181 },
e2ad2a54 182#define EXPOSURE_IDX 2
dcef3237
HG		 183 {
184 {
185 .id = V4L2_CID_EXPOSURE,
186 .type = V4L2_CTRL_TYPE_INTEGER,
187 .name = "Exposure",
f4d52025
HG		 188#define EXPOSURE_DEF 16 /* 32 ms / 30 fps */
189#define EXPOSURE_KNEE 50 /* 100 ms / 10 fps */
dcef3237 190 .minimum = 0,
ad5ef80d 191 .maximum = 255,
dcef3237
HG		 192 .step = 1,
193 .default_value = EXPOSURE_DEF,
194 .flags = 0,
195 },
196 .set = sd_setexposure,
197 .get = sd_getexposure,
198 },
e2ad2a54 199#define AUTOGAIN_IDX 3
dcef3237
HG		 200 {
201 {
202 .id = V4L2_CID_AUTOGAIN,
203 .type = V4L2_CTRL_TYPE_BOOLEAN,
204 .name = "Automatic Gain (and Exposure)",
205 .minimum = 0,
206 .maximum = 1,
207 .step = 1,
51fc8e3b
AZ		 208#define AUTOGAIN_DEF 1
209 .default_value = AUTOGAIN_DEF,
dcef3237
HG		 210 .flags = 0,
211 },
212 .set = sd_setautogain,
213 .get = sd_getautogain,
6a7eba24 214 },
e2ad2a54 215#define FREQ_IDX 4
66f35821
HG		 216 {
217 {
218 .id = V4L2_CID_POWER_LINE_FREQUENCY,
219 .type = V4L2_CTRL_TYPE_MENU,
220 .name = "Light frequency filter",
221 .minimum = 0,
222 .maximum = 2, /* 0: 0, 1: 50Hz, 2:60Hz */
223 .step = 1,
224#define FREQ_DEF 1
225 .default_value = FREQ_DEF,
226 },
227 .set = sd_setfreq,
228 .get = sd_getfreq,
229 },
6a7eba24
JFM		 230};
231
c2446b3e 232static struct v4l2_pix_format vga_mode[] = {
c437d657
HG		 233 {160, 120, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
234 .bytesperline = 160,
93627736 235 .sizeimage = 160 * 120 * 5 / 4,
c437d657
HG		 236 .colorspace = V4L2_COLORSPACE_SRGB,
237 .priv = 2 | MODE_RAW},
c2446b3e
JFM		 238 {160, 120, V4L2_PIX_FMT_SN9C10X, V4L2_FIELD_NONE,
239 .bytesperline = 160,
5c51518d 240 .sizeimage = 160 * 120 * 5 / 4,
c2446b3e
JFM		 241 .colorspace = V4L2_COLORSPACE_SRGB,
242 .priv = 2},
243 {320, 240, V4L2_PIX_FMT_SN9C10X, V4L2_FIELD_NONE,
244 .bytesperline = 320,
5c51518d 245 .sizeimage = 320 * 240 * 5 / 4,
c2446b3e
JFM		 246 .colorspace = V4L2_COLORSPACE_SRGB,
247 .priv = 1},
248 {640, 480, V4L2_PIX_FMT_SN9C10X, V4L2_FIELD_NONE,
249 .bytesperline = 640,
5c51518d 250 .sizeimage = 640 * 480 * 5 / 4,
c2446b3e
JFM		 251 .colorspace = V4L2_COLORSPACE_SRGB,
252 .priv = 0},
6a7eba24 253};
c2446b3e 254static struct v4l2_pix_format sif_mode[] = {
93627736
HG		 255 {160, 120, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
256 .bytesperline = 160,
257 .sizeimage = 160 * 120,
258 .colorspace = V4L2_COLORSPACE_SRGB,
259 .priv = 1 | MODE_RAW | MODE_REDUCED_SIF},
260 {160, 120, V4L2_PIX_FMT_SN9C10X, V4L2_FIELD_NONE,
261 .bytesperline = 160,
262 .sizeimage = 160 * 120 * 5 / 4,
263 .colorspace = V4L2_COLORSPACE_SRGB,
264 .priv = 1 | MODE_REDUCED_SIF},
c437d657
HG		 265 {176, 144, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
266 .bytesperline = 176,
93627736 267 .sizeimage = 176 * 144 * 5 / 4,
c437d657
HG		 268 .colorspace = V4L2_COLORSPACE_SRGB,
269 .priv = 1 | MODE_RAW},
c2446b3e
JFM		 270 {176, 144, V4L2_PIX_FMT_SN9C10X, V4L2_FIELD_NONE,
271 .bytesperline = 176,
5c51518d 272 .sizeimage = 176 * 144 * 5 / 4,
c2446b3e
JFM		 273 .colorspace = V4L2_COLORSPACE_SRGB,
274 .priv = 1},
93627736
HG		 275 {320, 240, V4L2_PIX_FMT_SN9C10X, V4L2_FIELD_NONE,
276 .bytesperline = 320,
277 .sizeimage = 320 * 240 * 5 / 4,
278 .colorspace = V4L2_COLORSPACE_SRGB,
279 .priv = 0 | MODE_REDUCED_SIF},
c2446b3e
JFM		 280 {352, 288, V4L2_PIX_FMT_SN9C10X, V4L2_FIELD_NONE,
281 .bytesperline = 352,
5c51518d 282 .sizeimage = 352 * 288 * 5 / 4,
c2446b3e
JFM		 283 .colorspace = V4L2_COLORSPACE_SRGB,
284 .priv = 0},
6a7eba24
JFM		 285};
286
6a7eba24
JFM		 287static const __u8 initHv7131[] = {
288 0x46, 0x77, 0x00, 0x04, 0x00, 0x00, 0x00, 0x80, 0x11, 0x00, 0x00, 0x00,
289 0x00, 0x00,
c437d657 290 0x00, 0x00, 0x00, 0x02, 0x01, 0x00,
6a7eba24
JFM		 291 0x28, 0x1e, 0x60, 0x8a, 0x20,
292 0x1d, 0x10, 0x02, 0x03, 0x0f, 0x0c
293};
294static const __u8 hv7131_sensor_init[][8] = {
295 {0xc0, 0x11, 0x31, 0x38, 0x2a, 0x2e, 0x00, 0x10},
296 {0xa0, 0x11, 0x01, 0x08, 0x2a, 0x2e, 0x00, 0x10},
297 {0xb0, 0x11, 0x20, 0x00, 0xd0, 0x2e, 0x00, 0x10},
298 {0xc0, 0x11, 0x25, 0x03, 0x0e, 0x28, 0x00, 0x16},
299 {0xa0, 0x11, 0x30, 0x10, 0x0e, 0x28, 0x00, 0x15},
300};
301static const __u8 initOv6650[] = {
302 0x44, 0x44, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80,
303 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
c437d657 304 0x00, 0x01, 0x01, 0x0a, 0x16, 0x12, 0x68, 0x8b,
93627736 305 0x10, 0x1d, 0x10, 0x02, 0x02, 0x09, 0x07
6a7eba24
JFM		 306};
307static const __u8 ov6650_sensor_init[][8] =
308{
309 /* Bright, contrast, etc are set througth SCBB interface.
310 * AVCAP on win2 do not send any data on this controls. */
311 /* Anyway, some registers appears to alter bright and constrat */
dcef3237
HG		 312
313 /* Reset sensor */
6a7eba24 314 {0xa0, 0x60, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10},
dcef3237 315 /* Set clock register 0x11 low nibble is clock divider */
6a7eba24 316 {0xd0, 0x60, 0x11, 0xc0, 0x1b, 0x18, 0xc1, 0x10},
dcef3237 317 /* Next some unknown stuff */
6a7eba24
JFM		 318 {0xb0, 0x60, 0x15, 0x00, 0x02, 0x18, 0xc1, 0x10},
319/* {0xa0, 0x60, 0x1b, 0x01, 0x02, 0x18, 0xc1, 0x10},
320 * THIS SET GREEN SCREEN
321 * (pixels could be innverted in decode kind of "brg",
322 * but blue wont be there. Avoid this data ... */
323 {0xd0, 0x60, 0x26, 0x01, 0x14, 0xd8, 0xa4, 0x10}, /* format out? */
324 {0xd0, 0x60, 0x26, 0x01, 0x14, 0xd8, 0xa4, 0x10},
325 {0xa0, 0x60, 0x30, 0x3d, 0x0A, 0xd8, 0xa4, 0x10},
722103e3
HG		 326 /* Enable rgb brightness control */
327 {0xa0, 0x60, 0x61, 0x08, 0x00, 0x00, 0x00, 0x10},
328 /* HDG: Note windows uses the line below, which sets both register 0x60
329 and 0x61 I believe these registers of the ov6650 are identical as
330 those of the ov7630, because if this is true the windows settings
331 add a bit additional red gain and a lot additional blue gain, which
332 matches my findings that the windows settings make blue much too
333 blue and red a little too red.
334 {0xb0, 0x60, 0x60, 0x66, 0x68, 0xd8, 0xa4, 0x10}, */
dcef3237 335 /* Some more unknown stuff */
6a7eba24
JFM		 336 {0xa0, 0x60, 0x68, 0x04, 0x68, 0xd8, 0xa4, 0x10},
337 {0xd0, 0x60, 0x17, 0x24, 0xd6, 0x04, 0x94, 0x10}, /* Clipreg */
6a7eba24 338};
dcef3237 339
6a7eba24
JFM		 340static const __u8 initOv7630[] = {
341 0x04, 0x44, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, /* r01 .. r08 */
342 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* r09 .. r10 */
c437d657 343 0x00, 0x01, 0x01, 0x0a, /* r11 .. r14 */
6a7eba24 344 0x28, 0x1e, /* H & V sizes r15 .. r16 */
f45f06b6 345 0x68, COMP2, MCK_INIT1, /* r17 .. r19 */
6a7eba24
JFM		 346 0x1d, 0x10, 0x02, 0x03, 0x0f, 0x0c /* r1a .. r1f */
347};
348static const __u8 initOv7630_3[] = {
349 0x44, 0x44, 0x00, 0x1a, 0x20, 0x20, 0x20, 0x80, /* r01 .. r08 */
350 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x04, /* r09 .. r10 */
51fc8e3b 351 0x00, 0x01, 0x01, 0x0a, /* r11 .. r14 */
3647fea8 352 0x28, 0x1e, /* H & V sizes r15 .. r16 */
51fc8e3b
AZ		 353 0x68, 0x8f, MCK_INIT1, /* r17 .. r19 */
354 0x1d, 0x10, 0x02, 0x03, 0x0f, 0x0c, 0x00, /* r1a .. r20 */
355 0x10, 0x20, 0x30, 0x40, 0x50, 0x60, 0x70, 0x80, /* r21 .. r28 */
356 0x90, 0xa0, 0xb0, 0xc0, 0xd0, 0xe0, 0xf0, 0xff /* r29 .. r30 */
6a7eba24 357};
6af492e5 358static const __u8 ov7630_sensor_init[][8] = {
6a7eba24
JFM		 359 {0xa0, 0x21, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10},
360 {0xb0, 0x21, 0x01, 0x77, 0x3a, 0x00, 0x00, 0x10},
361/* {0xd0, 0x21, 0x12, 0x7c, 0x01, 0x80, 0x34, 0x10}, jfm */
794af52a 362 {0xd0, 0x21, 0x12, 0x1c, 0x00, 0x80, 0x34, 0x10}, /* jfm */
6a7eba24
JFM		 363 {0xa0, 0x21, 0x1b, 0x04, 0x00, 0x80, 0x34, 0x10},
364 {0xa0, 0x21, 0x20, 0x44, 0x00, 0x80, 0x34, 0x10},
365 {0xa0, 0x21, 0x23, 0xee, 0x00, 0x80, 0x34, 0x10},
366 {0xd0, 0x21, 0x26, 0xa0, 0x9a, 0xa0, 0x30, 0x10},
367 {0xb0, 0x21, 0x2a, 0x80, 0x00, 0xa0, 0x30, 0x10},
368 {0xb0, 0x21, 0x2f, 0x3d, 0x24, 0xa0, 0x30, 0x10},
369 {0xa0, 0x21, 0x32, 0x86, 0x24, 0xa0, 0x30, 0x10},
794af52a
AZ		 370 {0xb0, 0x21, 0x60, 0xa9, 0x4a, 0xa0, 0x30, 0x10},
371/* {0xb0, 0x21, 0x60, 0xa9, 0x42, 0xa0, 0x30, 0x10}, * jfm */
6a7eba24
JFM		 372 {0xa0, 0x21, 0x65, 0x00, 0x42, 0xa0, 0x30, 0x10},
373 {0xa0, 0x21, 0x69, 0x38, 0x42, 0xa0, 0x30, 0x10},
374 {0xc0, 0x21, 0x6f, 0x88, 0x0b, 0x00, 0x30, 0x10},
375 {0xc0, 0x21, 0x74, 0x21, 0x8e, 0x00, 0x30, 0x10},
376 {0xa0, 0x21, 0x7d, 0xf7, 0x8e, 0x00, 0x30, 0x10},
377 {0xd0, 0x21, 0x17, 0x1c, 0xbd, 0x06, 0xf6, 0x10},
378};
6a7eba24 379
f45f06b6
HG		 380static const __u8 ov7630_sensor_init_3[][8] = {
381 {0xa0, 0x21, 0x13, 0x80, 0x00, 0x00, 0x00, 0x10},
382};
383
6a7eba24
JFM		 384static const __u8 initPas106[] = {
385 0x04, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x81, 0x40, 0x00, 0x00, 0x00,
386 0x00, 0x00,
c437d657 387 0x00, 0x00, 0x00, 0x04, 0x01, 0x00,
f45f06b6 388 0x16, 0x12, 0x24, COMP1, MCK_INIT1,
93627736 389 0x18, 0x10, 0x02, 0x02, 0x09, 0x07
6a7eba24
JFM		 390};
391/* compression 0x86 mckinit1 0x2b */
f45f06b6
HG		 392static const __u8 pas106_sensor_init[][8] = {
393 /* Pixel Clock Divider 6 */
394 { 0xa1, 0x40, 0x02, 0x04, 0x00, 0x00, 0x00, 0x14 },
395 /* Frame Time MSB (also seen as 0x12) */
396 { 0xa1, 0x40, 0x03, 0x13, 0x00, 0x00, 0x00, 0x14 },
397 /* Frame Time LSB (also seen as 0x05) */
398 { 0xa1, 0x40, 0x04, 0x06, 0x00, 0x00, 0x00, 0x14 },
399 /* Shutter Time Line Offset (also seen as 0x6d) */
400 { 0xa1, 0x40, 0x05, 0x65, 0x00, 0x00, 0x00, 0x14 },
401 /* Shutter Time Pixel Offset (also seen as 0xb1) */
402 { 0xa1, 0x40, 0x06, 0xcd, 0x00, 0x00, 0x00, 0x14 },
403 /* Black Level Subtract Sign (also seen 0x00) */
404 { 0xa1, 0x40, 0x07, 0xc1, 0x00, 0x00, 0x00, 0x14 },
405 /* Black Level Subtract Level (also seen 0x01) */
406 { 0xa1, 0x40, 0x08, 0x06, 0x00, 0x00, 0x00, 0x14 },
407 { 0xa1, 0x40, 0x08, 0x06, 0x00, 0x00, 0x00, 0x14 },
408 /* Color Gain B Pixel 5 a */
409 { 0xa1, 0x40, 0x09, 0x05, 0x00, 0x00, 0x00, 0x14 },
410 /* Color Gain G1 Pixel 1 5 */
411 { 0xa1, 0x40, 0x0a, 0x04, 0x00, 0x00, 0x00, 0x14 },
412 /* Color Gain G2 Pixel 1 0 5 */
413 { 0xa1, 0x40, 0x0b, 0x04, 0x00, 0x00, 0x00, 0x14 },
414 /* Color Gain R Pixel 3 1 */
415 { 0xa1, 0x40, 0x0c, 0x05, 0x00, 0x00, 0x00, 0x14 },
416 /* Color GainH Pixel */
417 { 0xa1, 0x40, 0x0d, 0x00, 0x00, 0x00, 0x00, 0x14 },
418 /* Global Gain */
419 { 0xa1, 0x40, 0x0e, 0x0e, 0x00, 0x00, 0x00, 0x14 },
420 /* Contrast */
421 { 0xa1, 0x40, 0x0f, 0x00, 0x00, 0x00, 0x00, 0x14 },
422 /* H&V synchro polarity */
423 { 0xa1, 0x40, 0x10, 0x06, 0x00, 0x00, 0x00, 0x14 },
424 /* ?default */
425 { 0xa1, 0x40, 0x11, 0x06, 0x00, 0x00, 0x00, 0x14 },
426 /* DAC scale */
427 { 0xa1, 0x40, 0x12, 0x06, 0x00, 0x00, 0x00, 0x14 },
428 /* ?default */
429 { 0xa1, 0x40, 0x14, 0x02, 0x00, 0x00, 0x00, 0x14 },
430 /* Validate Settings */
431 { 0xa1, 0x40, 0x13, 0x01, 0x00, 0x00, 0x00, 0x14 },
6a7eba24 432};
f45f06b6 433
6a7eba24
JFM		 434static const __u8 initPas202[] = {
435 0x44, 0x44, 0x21, 0x30, 0x00, 0x00, 0x00, 0x80, 0x40, 0x00, 0x00, 0x00,
436 0x00, 0x00,
c437d657 437 0x00, 0x00, 0x00, 0x06, 0x03, 0x0a,
f45f06b6 438 0x28, 0x1e, 0x28, 0x89, 0x20,
6a7eba24
JFM		 439 0x00, 0x00, 0x02, 0x03, 0x0f, 0x0c
440};
441static const __u8 pas202_sensor_init[][8] = {
442 {0xa0, 0x40, 0x02, 0x03, 0x00, 0x00, 0x00, 0x10},
443 {0xd0, 0x40, 0x04, 0x07, 0x34, 0x00, 0x09, 0x10},
444 {0xd0, 0x40, 0x08, 0x01, 0x00, 0x00, 0x01, 0x10},
445 {0xd0, 0x40, 0x0C, 0x00, 0x0C, 0x00, 0x32, 0x10},
446 {0xd0, 0x40, 0x10, 0x00, 0x01, 0x00, 0x63, 0x10},
447 {0xa0, 0x40, 0x15, 0x70, 0x01, 0x00, 0x63, 0x10},
448 {0xa0, 0x40, 0x18, 0x00, 0x01, 0x00, 0x63, 0x10},
449 {0xa0, 0x40, 0x11, 0x01, 0x01, 0x00, 0x63, 0x10},
450 {0xa0, 0x40, 0x03, 0x56, 0x01, 0x00, 0x63, 0x10},
451 {0xa0, 0x40, 0x11, 0x01, 0x01, 0x00, 0x63, 0x10},
452 {0xb0, 0x40, 0x04, 0x07, 0x2a, 0x00, 0x63, 0x10},
453 {0xb0, 0x40, 0x0e, 0x00, 0x3d, 0x00, 0x63, 0x10},
454
455 {0xa0, 0x40, 0x11, 0x01, 0x3d, 0x00, 0x63, 0x16},
456 {0xa0, 0x40, 0x10, 0x08, 0x3d, 0x00, 0x63, 0x15},
457 {0xa0, 0x40, 0x02, 0x04, 0x3d, 0x00, 0x63, 0x16},
458 {0xa0, 0x40, 0x11, 0x01, 0x3d, 0x00, 0x63, 0x16},
459 {0xb0, 0x40, 0x0e, 0x00, 0x31, 0x00, 0x63, 0x16},
460 {0xa0, 0x40, 0x11, 0x01, 0x31, 0x00, 0x63, 0x16},
461 {0xa0, 0x40, 0x10, 0x0e, 0x31, 0x00, 0x63, 0x15},
462 {0xa0, 0x40, 0x11, 0x01, 0x31, 0x00, 0x63, 0x16},
463};
464
465static const __u8 initTas5110[] = {
466 0x44, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x20, 0x11, 0x00, 0x00, 0x00,
467 0x00, 0x00,
c437d657 468 0x00, 0x01, 0x00, 0x45, 0x09, 0x0a,
6a7eba24
JFM		 469 0x16, 0x12, 0x60, 0x86, 0x2b,
470 0x14, 0x0a, 0x02, 0x02, 0x09, 0x07
471};
472static const __u8 tas5110_sensor_init[][8] = {
473 {0x30, 0x11, 0x00, 0x00, 0x0c, 0x00, 0x00, 0x10},
474 {0x30, 0x11, 0x02, 0x20, 0xa9, 0x00, 0x00, 0x10},
475 {0xa0, 0x61, 0x9a, 0xca, 0x00, 0x00, 0x00, 0x17},
476};
477
478static const __u8 initTas5130[] = {
479 0x04, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x20, 0x11, 0x00, 0x00, 0x00,
480 0x00, 0x00,
c437d657 481 0x00, 0x01, 0x00, 0x68, 0x0c, 0x0a,
6a7eba24
JFM		 482 0x28, 0x1e, 0x60, COMP, MCK_INIT,
483 0x18, 0x10, 0x04, 0x03, 0x11, 0x0c
484};
485static const __u8 tas5130_sensor_init[][8] = {
486/* {0x30, 0x11, 0x00, 0x40, 0x47, 0x00, 0x00, 0x10},
487 * shutter 0x47 short exposure? */
488 {0x30, 0x11, 0x00, 0x40, 0x01, 0x00, 0x00, 0x10},
489 /* shutter 0x01 long exposure */
490 {0x30, 0x11, 0x02, 0x20, 0x70, 0x00, 0x00, 0x10},
491};
492
f45f06b6
HG		 493struct sensor_data sensor_data[] = {
494SENS(initHv7131, NULL, hv7131_sensor_init, NULL, NULL, 0, NO_EXPO|NO_FREQ, 0),
93627736 495SENS(initOv6650, NULL, ov6650_sensor_init, NULL, NULL, F_GAIN|F_SIF, 0, 0x60),
f45f06b6
HG		 496SENS(initOv7630, initOv7630_3, ov7630_sensor_init, NULL, ov7630_sensor_init_3,
497 F_GAIN, 0, 0x21),
498SENS(initPas106, NULL, pas106_sensor_init, NULL, NULL, F_SIF, NO_EXPO|NO_FREQ,
499 0),
93627736 500SENS(initPas202, initPas202, pas202_sensor_init, NULL, NULL, 0,
f45f06b6 501 NO_EXPO|NO_FREQ, 0),
93627736 502SENS(initTas5110, NULL, tas5110_sensor_init, NULL, NULL, F_GAIN|F_SIF,
f45f06b6
HG		 503 NO_BRIGHTNESS|NO_FREQ, 0),
504SENS(initTas5130, NULL, tas5130_sensor_init, NULL, NULL, 0, NO_EXPO|NO_FREQ,
505 0),
506};
507
739570bb
JFM		 508/* get one byte in gspca_dev->usb_buf */
509static void reg_r(struct gspca_dev *gspca_dev,
510 __u16 value)
6a7eba24 511{
739570bb
JFM		 512 usb_control_msg(gspca_dev->dev,
513 usb_rcvctrlpipe(gspca_dev->dev, 0),
6a7eba24
JFM		 514 0, /* request */
515 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
516 value,
517 0, /* index */
739570bb 518 gspca_dev->usb_buf, 1,
6a7eba24
JFM		 519 500);
520}
521
739570bb
JFM		 522static void reg_w(struct gspca_dev *gspca_dev,
523 __u16 value,
524 const __u8 *buffer,
525 int len)
6a7eba24 526{
335b3f88 527#ifdef GSPCA_DEBUG
8295d99e 528 if (len > USB_BUF_SZ) {
0d2a722d
HG		 529 PDEBUG(D_ERR|D_PACK, "reg_w: buffer overflow");
530 return;
531 }
532#endif
739570bb
JFM		 533 memcpy(gspca_dev->usb_buf, buffer, len);
534 usb_control_msg(gspca_dev->dev,
535 usb_sndctrlpipe(gspca_dev->dev, 0),
536 0x08, /* request */
537 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
538 value,
539 0, /* index */
540 gspca_dev->usb_buf, len,
541 500);
542}
543
739570bb 544static int i2c_w(struct gspca_dev *gspca_dev, const __u8 *buffer)
6a7eba24
JFM		 545{
546 int retry = 60;
6a7eba24
JFM		 547
548 /* is i2c ready */
739570bb 549 reg_w(gspca_dev, 0x08, buffer, 8);
6a7eba24
JFM		 550 while (retry--) {
551 msleep(10);
739570bb 552 reg_r(gspca_dev, 0x08);
b7474cf9
AZ		 553 if (gspca_dev->usb_buf[0] & 0x04) {
554 if (gspca_dev->usb_buf[0] & 0x08)
555 return -1;
6a7eba24 556 return 0;
b7474cf9 557 }
6a7eba24
JFM		 558 }
559 return -1;
560}
561
739570bb 562static void i2c_w_vector(struct gspca_dev *gspca_dev,
6a7eba24
JFM		 563 const __u8 buffer[][8], int len)
564{
565 for (;;) {
739570bb 566 reg_w(gspca_dev, 0x08, *buffer, 8);
6a7eba24
JFM		 567 len -= 8;
568 if (len <= 0)
569 break;
570 buffer++;
571 }
572}
573
574static void setbrightness(struct gspca_dev *gspca_dev)
575{
576 struct sd *sd = (struct sd *) gspca_dev;
577 __u8 value;
578
579 switch (sd->sensor) {
a975a527 580 case SENSOR_OV6650:
6a7eba24
JFM		 581 case SENSOR_OV7630: {
582 __u8 i2cOV[] =
a975a527 583 {0xa0, 0x00, 0x06, 0x00, 0x00, 0x00, 0x00, 0x10};
6a7eba24
JFM		 584
585 /* change reg 0x06 */
f45f06b6 586 i2cOV[1] = sensor_data[sd->sensor].sensor_addr;
6a7eba24 587 i2cOV[3] = sd->brightness;
739570bb 588 if (i2c_w(gspca_dev, i2cOV) < 0)
6a7eba24
JFM		 589 goto err;
590 break;
591 }
592 case SENSOR_PAS106: {
593 __u8 i2c1[] =
594 {0xa1, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x14};
595
596 i2c1[3] = sd->brightness >> 3;
597 i2c1[2] = 0x0e;
739570bb 598 if (i2c_w(gspca_dev, i2c1) < 0)
6a7eba24
JFM		 599 goto err;
600 i2c1[3] = 0x01;
601 i2c1[2] = 0x13;
739570bb 602 if (i2c_w(gspca_dev, i2c1) < 0)
6a7eba24
JFM		 603 goto err;
604 break;
605 }
606 case SENSOR_PAS202: {
607 /* __u8 i2cpexpo1[] =
608 {0xb0, 0x40, 0x04, 0x07, 0x2a, 0x00, 0x63, 0x16}; */
609 __u8 i2cpexpo[] =
610 {0xb0, 0x40, 0x0e, 0x01, 0xab, 0x00, 0x63, 0x16};
611 __u8 i2cp202[] =
612 {0xa0, 0x40, 0x10, 0x0e, 0x31, 0x00, 0x63, 0x15};
613 static __u8 i2cpdoit[] =
614 {0xa0, 0x40, 0x11, 0x01, 0x31, 0x00, 0x63, 0x16};
615
616 /* change reg 0x10 */
617 i2cpexpo[4] = 0xff - sd->brightness;
739570bb 618/* if(i2c_w(gspca_dev,i2cpexpo1) < 0)
6a7eba24 619 goto err; */
739570bb 620/* if(i2c_w(gspca_dev,i2cpdoit) < 0)
6a7eba24 621 goto err; */
739570bb 622 if (i2c_w(gspca_dev, i2cpexpo) < 0)
6a7eba24 623 goto err;
739570bb 624 if (i2c_w(gspca_dev, i2cpdoit) < 0)
6a7eba24
JFM		 625 goto err;
626 i2cp202[3] = sd->brightness >> 3;
739570bb 627 if (i2c_w(gspca_dev, i2cp202) < 0)
6a7eba24 628 goto err;
739570bb 629 if (i2c_w(gspca_dev, i2cpdoit) < 0)
6a7eba24
JFM		 630 goto err;
631 break;
632 }
dcef3237 633 case SENSOR_TAS5130CXX: {
6a7eba24
JFM		 634 __u8 i2c[] =
635 {0x30, 0x11, 0x02, 0x20, 0x70, 0x00, 0x00, 0x10};
636
637 value = 0xff - sd->brightness;
638 i2c[4] = value;
639 PDEBUG(D_CONF, "brightness %d : %d", value, i2c[4]);
739570bb 640 if (i2c_w(gspca_dev, i2c) < 0)
6a7eba24
JFM		 641 goto err;
642 break;
643 }
644 }
645 return;
646err:
647 PDEBUG(D_ERR, "i2c error brightness");
648}
dcef3237
HG		 649
650static void setsensorgain(struct gspca_dev *gspca_dev)
651{
652 struct sd *sd = (struct sd *) gspca_dev;
a975a527 653 unsigned char gain = sd->gain;
dcef3237
HG		 654
655 switch (sd->sensor) {
656
657 case SENSOR_TAS5110: {
658 __u8 i2c[] =
659 {0x30, 0x11, 0x02, 0x20, 0x70, 0x00, 0x00, 0x10};
660
a975a527 661 i2c[4] = 255 - gain;
739570bb 662 if (i2c_w(gspca_dev, i2c) < 0)
dcef3237 663 goto err;
51fc8e3b
AZ		 664 break;
665 }
ad5ef80d 666
a975a527
HG		 667 case SENSOR_OV6650:
668 gain >>= 1;
669 /* fall thru */
6af492e5 670 case SENSOR_OV7630: {
a975a527 671 __u8 i2c[] = {0xa0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10};
794af52a 672
f45f06b6 673 i2c[1] = sensor_data[sd->sensor].sensor_addr;
a975a527 674 i2c[3] = gain >> 2;
794af52a
AZ		 675 if (i2c_w(gspca_dev, i2c) < 0)
676 goto err;
677 break;
678 }
dcef3237
HG		 679 }
680 return;
681err:
682 PDEBUG(D_ERR, "i2c error gain");
683}
684
685static void setgain(struct gspca_dev *gspca_dev)
6a7eba24
JFM		 686{
687 struct sd *sd = (struct sd *) gspca_dev;
688 __u8 gain;
689 __u8 rgb_value;
690
ad5ef80d 691 gain = sd->gain >> 4;
dcef3237 692
6a7eba24
JFM		 693 /* red and blue gain */
694 rgb_value = gain << 4 | gain;
739570bb 695 reg_w(gspca_dev, 0x10, &rgb_value, 1);
6a7eba24
JFM		 696 /* green gain */
697 rgb_value = gain;
739570bb 698 reg_w(gspca_dev, 0x11, &rgb_value, 1);
dcef3237 699
f45f06b6 700 if (sensor_data[sd->sensor].flags & F_GAIN)
dcef3237
HG		 701 setsensorgain(gspca_dev);
702}
703
704static void setexposure(struct gspca_dev *gspca_dev)
705{
706 struct sd *sd = (struct sd *) gspca_dev;
dcef3237
HG		 707
708 switch (sd->sensor) {
709 case SENSOR_TAS5110: {
710 __u8 reg;
711
712 /* register 19's high nibble contains the sn9c10x clock divider
713 The high nibble configures the no fps according to the
714 formula: 60 / high_nibble. With a maximum of 30 fps */
f4d52025
HG		 715 reg = 120 * sd->exposure / 1000;
716 if (reg < 2)
717 reg = 2;
718 else if (reg > 15)
dcef3237
HG		 719 reg = 15;
720 reg = (reg << 4) | 0x0b;
739570bb 721 reg_w(gspca_dev, 0x19, &reg, 1);
51fc8e3b
AZ		 722 break;
723 }
a975a527 724 case SENSOR_OV6650:
6af492e5 725 case SENSOR_OV7630: {
a975a527
HG		 726 /* The ov6650 / ov7630 have 2 registers which both influence
727 exposure, register 11, whose low nibble sets the nr off fps
f4d52025
HG		 728 according to: fps = 30 / (low_nibble + 1)
729
730 The fps configures the maximum exposure setting, but it is
731 possible to use less exposure then what the fps maximum
732 allows by setting register 10. register 10 configures the
733 actual exposure as quotient of the full exposure, with 0
734 being no exposure at all (not very usefull) and reg10_max
735 being max exposure possible at that framerate.
736
737 The code maps our 0 - 510 ms exposure ctrl to these 2
738 registers, trying to keep fps as high as possible.
739 */
6af492e5
HG		 740 __u8 i2c[] = {0xb0, 0x00, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10};
741 int reg10, reg11, reg10_max;
742
66f35821
HG		 743 /* ov6645 datasheet says reg10_max is 9a, but that uses
744 tline * 2 * reg10 as formula for calculating texpo, the
745 ov6650 probably uses the same formula as the 7730 which uses
746 tline * 4 * reg10, which explains why the reg10max we've
747 found experimentally for the ov6650 is exactly half that of
a975a527 748 the ov6645. The ov7630 datasheet says the max is 0x41. */
6af492e5
HG		 749 if (sd->sensor == SENSOR_OV6650) {
750 reg10_max = 0x4d;
751 i2c[4] = 0xc0; /* OV6650 needs non default vsync pol */
752 } else
753 reg10_max = 0x41;
f4d52025 754
794af52a
AZ		 755 reg11 = (60 * sd->exposure + 999) / 1000;
756 if (reg11 < 1)
757 reg11 = 1;
758 else if (reg11 > 16)
759 reg11 = 16;
760
e2ad2a54
HG		 761 /* In 640x480, if the reg11 has less than 3, the image is
762 unstable (not enough bandwidth). */
763 if (gspca_dev->width == 640 && reg11 < 3)
764 reg11 = 3;
765
794af52a
AZ		 766 /* frame exposure time in ms = 1000 * reg11 / 30 ->
767 reg10 = sd->exposure * 2 * reg10_max / (1000 * reg11 / 30) */
768 reg10 = (sd->exposure * 60 * reg10_max) / (1000 * reg11);
794af52a 769
a975a527
HG		 770 /* Don't allow this to get below 10 when using autogain, the
771 steps become very large (relatively) when below 10 causing
772 the image to oscilate from much too dark, to much too bright
773 and back again. */
774 if (sd->autogain && reg10 < 10)
775 reg10 = 10;
f4d52025
HG		 776 else if (reg10 > reg10_max)
777 reg10 = reg10_max;
778
779 /* Write reg 10 and reg11 low nibble */
f45f06b6 780 i2c[1] = sensor_data[sd->sensor].sensor_addr;
f4d52025
HG		 781 i2c[3] = reg10;
782 i2c[4] |= reg11 - 1;
6af492e5
HG		 783
784 /* If register 11 didn't change, don't change it */
785 if (sd->reg11 == reg11 )
786 i2c[0] = 0xa0;
787
788 if (i2c_w(gspca_dev, i2c) == 0)
789 sd->reg11 = reg11;
790 else
dcef3237 791 PDEBUG(D_ERR, "i2c error exposure");
51fc8e3b
AZ		 792 break;
793 }
dcef3237
HG		 794 }
795}
796
66f35821
HG		 797static void setfreq(struct gspca_dev *gspca_dev)
798{
799 struct sd *sd = (struct sd *) gspca_dev;
800
801 switch (sd->sensor) {
d87616f5 802 case SENSOR_OV6650:
6af492e5 803 case SENSOR_OV7630: {
66f35821 804 /* Framerate adjust register for artificial light 50 hz flicker
6af492e5
HG		 805 compensation, for the ov6650 this is identical to ov6630
806 0x2b register, see ov6630 datasheet.
807 0x4f / 0x8a -> (30 fps -> 25 fps), 0x00 -> no adjustment */
d87616f5 808 __u8 i2c[] = {0xa0, 0x00, 0x2b, 0x00, 0x00, 0x00, 0x00, 0x10};
66f35821
HG		 809 switch (sd->freq) {
810 default:
811/* case 0: * no filter*/
812/* case 2: * 60 hz */
813 i2c[3] = 0;
814 break;
815 case 1: /* 50 hz */
722103e3
HG		 816 i2c[3] = (sd->sensor == SENSOR_OV6650)
817 ? 0x4f : 0x8a;
66f35821
HG		 818 break;
819 }
f45f06b6 820 i2c[1] = sensor_data[sd->sensor].sensor_addr;
66f35821
HG		 821 if (i2c_w(gspca_dev, i2c) < 0)
822 PDEBUG(D_ERR, "i2c error setfreq");
823 break;
824 }
825 }
826}
827
dcef3237
HG		 828static void do_autogain(struct gspca_dev *gspca_dev)
829{
830 struct sd *sd = (struct sd *) gspca_dev;
831 int avg_lum = atomic_read(&sd->avg_lum);
832
833 if (avg_lum == -1)
834 return;
835
836 if (sd->autogain_ignore_frames > 0)
837 sd->autogain_ignore_frames--;
838 else if (gspca_auto_gain_n_exposure(gspca_dev, avg_lum,
839 sd->brightness * DESIRED_AVG_LUM / 127,
a975a527
HG		 840 AUTOGAIN_DEADZONE, GAIN_KNEE, EXPOSURE_KNEE)) {
841 PDEBUG(D_FRAM, "autogain: gain changed: gain: %d expo: %d\n",
842 (int)sd->gain, (int)sd->exposure);
dcef3237 843 sd->autogain_ignore_frames = AUTOGAIN_IGNORE_FRAMES;
a975a527 844 }
6a7eba24
JFM		 845}
846
847/* this function is called at probe time */
848static int sd_config(struct gspca_dev *gspca_dev,
849 const struct usb_device_id *id)
850{
851 struct sd *sd = (struct sd *) gspca_dev;
852 struct cam *cam;
65f33396
HG		 853
854 reg_r(gspca_dev, 0x00);
855 if (gspca_dev->usb_buf[0] != 0x10)
856 return -ENODEV;
6a7eba24 857
5da162e7 858 /* copy the webcam info from the device id */
f45f06b6
HG		 859 sd->sensor = id->driver_info >> 8;
860 sd->bridge = id->driver_info & 0xff;
861 gspca_dev->ctrl_dis = sensor_data[sd->sensor].ctrl_dis;
6a7eba24
JFM		 862
863 cam = &gspca_dev->cam;
6a7eba24 864 cam->epaddr = 0x01;
f45f06b6 865 if (!(sensor_data[sd->sensor].flags & F_SIF)) {
6a7eba24 866 cam->cam_mode = vga_mode;
51fc8e3b 867 cam->nmodes = ARRAY_SIZE(vga_mode);
6a7eba24
JFM		 868 } else {
869 cam->cam_mode = sif_mode;
51fc8e3b 870 cam->nmodes = ARRAY_SIZE(sif_mode);
6a7eba24 871 }
dcef3237
HG		 872 sd->brightness = BRIGHTNESS_DEF;
873 sd->gain = GAIN_DEF;
874 sd->exposure = EXPOSURE_DEF;
e2ad2a54
HG		 875 if (gspca_dev->ctrl_dis & (1 << AUTOGAIN_IDX))
876 sd->autogain = 0; /* Disable do_autogain callback */
877 else
878 sd->autogain = AUTOGAIN_DEF;
12ff9126 879 sd->freq = FREQ_DEF;
6af492e5 880
6a7eba24
JFM		 881 return 0;
882}
883
012d6b02
JFM		 884/* this function is called at probe and resume time */
885static int sd_init(struct gspca_dev *gspca_dev)
6a7eba24 886{
271315a9
HG		 887 const __u8 stop = 0x09; /* Disable stream turn of LED */
888
889 reg_w(gspca_dev, 0x01, &stop, 1);
890
6a7eba24
JFM		 891 return 0;
892}
893
6a7eba24
JFM		 894/* -- start the camera -- */
895static void sd_start(struct gspca_dev *gspca_dev)
896{
897 struct sd *sd = (struct sd *) gspca_dev;
93627736 898 struct cam *cam = &gspca_dev->cam;
f45f06b6 899 int mode, l;
6a7eba24 900 const __u8 *sn9c10x;
93627736 901 __u8 reg12_19[8];
6a7eba24 902
93627736 903 mode = cam->cam_mode[gspca_dev->curr_mode].priv & 0x07;
f45f06b6
HG		 904 sn9c10x = sensor_data[sd->sensor].bridge_init[sd->bridge];
905 l = sensor_data[sd->sensor].bridge_init_size[sd->bridge];
93627736
HG		 906 memcpy(reg12_19, &sn9c10x[0x12 - 1], 8);
907 reg12_19[6] = sn9c10x[0x18 - 1] | (mode << 4);
f45f06b6 908 /* Special cases where reg 17 and or 19 value depends on mode */
6a7eba24 909 switch (sd->sensor) {
6a7eba24 910 case SENSOR_PAS202:
93627736 911 reg12_19[5] = mode ? 0x24 : 0x20;
6a7eba24 912 break;
f45f06b6
HG		 913 case SENSOR_TAS5130CXX:
914 /* probably not mode specific at all most likely the upper
915 nibble of 0x19 is exposure (clock divider) just as with
916 the tas5110, we need someone to test this. */
93627736 917 reg12_19[7] = mode ? 0x23 : 0x43;
6a7eba24
JFM		 918 break;
919 }
c437d657 920 /* Disable compression when the raw bayer format has been selected */
93627736
HG		 921 if (cam->cam_mode[gspca_dev->curr_mode].priv & MODE_RAW)
922 reg12_19[6] &= ~0x80;
923
924 /* Vga mode emulation on SIF sensor? */
925 if (cam->cam_mode[gspca_dev->curr_mode].priv & MODE_REDUCED_SIF) {
926 reg12_19[0] += 16; /* 0x12: hstart adjust */
927 reg12_19[1] += 24; /* 0x13: vstart adjust */
928 reg12_19[3] = 320 / 16; /* 0x15: hsize */
929 reg12_19[4] = 240 / 16; /* 0x16: vsize */
930 }
6af492e5 931
6a7eba24 932 /* reg 0x01 bit 2 video transfert on */
fff4205f 933 reg_w(gspca_dev, 0x01, &sn9c10x[0x01 - 1], 1);
6a7eba24 934 /* reg 0x17 SensorClk enable inv Clk 0x60 */
fff4205f 935 reg_w(gspca_dev, 0x17, &sn9c10x[0x17 - 1], 1);
6a7eba24 936 /* Set the registers from the template */
8295d99e 937 reg_w(gspca_dev, 0x01, sn9c10x, l);
f45f06b6
HG		 938
939 /* Init the sensor */
940 i2c_w_vector(gspca_dev, sensor_data[sd->sensor].sensor_init,
941 sensor_data[sd->sensor].sensor_init_size);
942 if (sensor_data[sd->sensor].sensor_bridge_init[sd->bridge])
943 i2c_w_vector(gspca_dev,
944 sensor_data[sd->sensor].sensor_bridge_init[sd->bridge],
945 sensor_data[sd->sensor].sensor_bridge_init_size[
946 sd->bridge]);
947
3647fea8 948 /* H_size V_size 0x28, 0x1e -> 640x480. 0x16, 0x12 -> 352x288 */
93627736 949 reg_w(gspca_dev, 0x15, &reg12_19[3], 2);
6a7eba24 950 /* compression register */
93627736 951 reg_w(gspca_dev, 0x18, &reg12_19[6], 1);
794af52a 952 /* H_start */
93627736 953 reg_w(gspca_dev, 0x12, &reg12_19[0], 1);
794af52a 954 /* V_START */
93627736 955 reg_w(gspca_dev, 0x13, &reg12_19[1], 1);
6a7eba24
JFM		 956 /* reset 0x17 SensorClk enable inv Clk 0x60 */
957 /*fixme: ov7630 [17]=68 8f (+20 if 102)*/
93627736 958 reg_w(gspca_dev, 0x17, &reg12_19[5], 1);
6a7eba24 959 /*MCKSIZE ->3 */ /*fixme: not ov7630*/
93627736 960 reg_w(gspca_dev, 0x19, &reg12_19[7], 1);
6a7eba24 961 /* AE_STRX AE_STRY AE_ENDX AE_ENDY */
739570bb 962 reg_w(gspca_dev, 0x1c, &sn9c10x[0x1c - 1], 4);
6a7eba24 963 /* Enable video transfert */
739570bb 964 reg_w(gspca_dev, 0x01, &sn9c10x[0], 1);
6a7eba24 965 /* Compression */
93627736 966 reg_w(gspca_dev, 0x18, &reg12_19[6], 2);
6a7eba24
JFM		 967 msleep(20);
968
6af492e5
HG		 969 sd->reg11 = -1;
970
dcef3237 971 setgain(gspca_dev);
6a7eba24 972 setbrightness(gspca_dev);
dcef3237 973 setexposure(gspca_dev);
66f35821 974 setfreq(gspca_dev);
dcef3237 975
6af492e5 976 sd->frames_to_drop = 0;
dcef3237
HG		 977 sd->autogain_ignore_frames = 0;
978 atomic_set(&sd->avg_lum, -1);
6a7eba24
JFM		 979}
980
981static void sd_stopN(struct gspca_dev *gspca_dev)
982{
f45f06b6 983 sd_init(gspca_dev);
6a7eba24
JFM		 984}
985
6a7eba24
JFM		 986static void sd_pkt_scan(struct gspca_dev *gspca_dev,
987 struct gspca_frame *frame, /* target */
988 unsigned char *data, /* isoc packet */
989 int len) /* iso packet length */
990{
0d2a722d 991 int i;
dcef3237 992 struct sd *sd = (struct sd *) gspca_dev;
c437d657 993 struct cam *cam = &gspca_dev->cam;
6a7eba24 994
c36260ee
HG		 995 /* frames start with:
996 * ff ff 00 c4 c4 96 synchro
997 * 00 (unknown)
998 * xx (frame sequence / size / compression)
999 * (xx) (idem - extra byte for sn9c103)
1000 * ll mm brightness sum inside auto exposure
1001 * ll mm brightness sum outside auto exposure
1002 * (xx xx xx xx xx) audio values for snc103
1003 */
6a7eba24 1004 if (len > 6 && len < 24) {
0d2a722d
HG		 1005 for (i = 0; i < len - 6; i++) {
1006 if (data[0 + i] == 0xff
1007 && data[1 + i] == 0xff
1008 && data[2 + i] == 0x00
1009 && data[3 + i] == 0xc4
1010 && data[4 + i] == 0xc4
1011 && data[5 + i] == 0x96) { /* start of frame */
6af492e5
HG		 1012 int lum = -1;
1013 int pkt_type = LAST_PACKET;
f45f06b6
HG		 1014 int fr_h_sz = (sd->bridge == BRIDGE_103) ?
1015 18 : 12;
6af492e5 1016
f45f06b6 1017 if (len - i < fr_h_sz) {
c36260ee
HG		 1018 PDEBUG(D_STREAM, "packet too short to"
1019 " get avg brightness");
f45f06b6 1020 } else if (sd->bridge == BRIDGE_103) {
6af492e5
HG		 1021 lum = data[i + 9] +
1022 (data[i + 10] << 8);
f45f06b6
HG		 1023 } else {
1024 lum = data[i + 8] + (data[i + 9] << 8);
dcef3237 1025 }
bf2a2202
HG		 1026 /* When exposure changes midway a frame we
1027 get a lum of 0 in this case drop 2 frames
1028 as the frames directly after an exposure
1029 change have an unstable image. Sometimes lum
1030 *really* is 0 (cam used in low light with
1031 low exposure setting), so do not drop frames
1032 if the previous lum was 0 too. */
1033 if (lum == 0 && sd->prev_avg_lum != 0) {
6af492e5
HG		 1034 lum = -1;
1035 sd->frames_to_drop = 2;
bf2a2202
HG		 1036 sd->prev_avg_lum = 0;
1037 } else
1038 sd->prev_avg_lum = lum;
6af492e5
HG		 1039 atomic_set(&sd->avg_lum, lum);
1040
1041 if (sd->frames_to_drop) {
1042 sd->frames_to_drop--;
1043 pkt_type = DISCARD_PACKET;
1044 }
1045
1046 frame = gspca_frame_add(gspca_dev, pkt_type,
1047 frame, data, 0);
f45f06b6
HG		 1048 data += i + fr_h_sz;
1049 len -= i + fr_h_sz;
6a7eba24
JFM		 1050 gspca_frame_add(gspca_dev, FIRST_PACKET,
1051 frame, data, len);
1052 return;
1053 }
1054 }
1055 }
c437d657
HG		 1056
1057 if (cam->cam_mode[gspca_dev->curr_mode].priv & MODE_RAW) {
1058 /* In raw mode we sometimes get some garbage after the frame
1059 ignore this */
1060 int used = frame->data_end - frame->data;
1061 int size = cam->cam_mode[gspca_dev->curr_mode].sizeimage;
1062
1063 if (used + len > size)
1064 len = size - used;
1065 }
1066
6a7eba24
JFM		 1067 gspca_frame_add(gspca_dev, INTER_PACKET,
1068 frame, data, len);
1069}
1070
1071static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val)
1072{
1073 struct sd *sd = (struct sd *) gspca_dev;
1074
1075 sd->brightness = val;
1076 if (gspca_dev->streaming)
1077 setbrightness(gspca_dev);
1078 return 0;
1079}
1080
1081static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val)
1082{
1083 struct sd *sd = (struct sd *) gspca_dev;
1084
1085 *val = sd->brightness;
1086 return 0;
1087}
1088
dcef3237
HG		 1089static int sd_setgain(struct gspca_dev *gspca_dev, __s32 val)
1090{
1091 struct sd *sd = (struct sd *) gspca_dev;
1092
1093 sd->gain = val;
1094 if (gspca_dev->streaming)
1095 setgain(gspca_dev);
1096 return 0;
1097}
1098
1099static int sd_getgain(struct gspca_dev *gspca_dev, __s32 *val)
6a7eba24
JFM		 1100{
1101 struct sd *sd = (struct sd *) gspca_dev;
1102
dcef3237
HG		 1103 *val = sd->gain;
1104 return 0;
1105}
1106
1107static int sd_setexposure(struct gspca_dev *gspca_dev, __s32 val)
1108{
1109 struct sd *sd = (struct sd *) gspca_dev;
1110
1111 sd->exposure = val;
6a7eba24 1112 if (gspca_dev->streaming)
dcef3237
HG		 1113 setexposure(gspca_dev);
1114 return 0;
1115}
1116
1117static int sd_getexposure(struct gspca_dev *gspca_dev, __s32 *val)
1118{
1119 struct sd *sd = (struct sd *) gspca_dev;
1120
1121 *val = sd->exposure;
1122 return 0;
1123}
1124
1125static int sd_setautogain(struct gspca_dev *gspca_dev, __s32 val)
1126{
1127 struct sd *sd = (struct sd *) gspca_dev;
1128
1129 sd->autogain = val;
1130 /* when switching to autogain set defaults to make sure
1131 we are on a valid point of the autogain gain /
1132 exposure knee graph, and give this change time to
1133 take effect before doing autogain. */
1134 if (sd->autogain) {
1135 sd->exposure = EXPOSURE_DEF;
1136 sd->gain = GAIN_DEF;
1137 if (gspca_dev->streaming) {
1138 sd->autogain_ignore_frames = AUTOGAIN_IGNORE_FRAMES;
1139 setexposure(gspca_dev);
1140 setgain(gspca_dev);
1141 }
1142 }
1143
6a7eba24
JFM		 1144 return 0;
1145}
1146
dcef3237 1147static int sd_getautogain(struct gspca_dev *gspca_dev, __s32 *val)
6a7eba24
JFM		 1148{
1149 struct sd *sd = (struct sd *) gspca_dev;
1150
dcef3237 1151 *val = sd->autogain;
6a7eba24
JFM		 1152 return 0;
1153}
1154
66f35821
HG		 1155static int sd_setfreq(struct gspca_dev *gspca_dev, __s32 val)
1156{
1157 struct sd *sd = (struct sd *) gspca_dev;
1158
1159 sd->freq = val;
1160 if (gspca_dev->streaming)
1161 setfreq(gspca_dev);
1162 return 0;
1163}
1164
1165static int sd_getfreq(struct gspca_dev *gspca_dev, __s32 *val)
1166{
1167 struct sd *sd = (struct sd *) gspca_dev;
1168
1169 *val = sd->freq;
1170 return 0;
1171}
1172
1173static int sd_querymenu(struct gspca_dev *gspca_dev,
1174 struct v4l2_querymenu *menu)
1175{
1176 switch (menu->id) {
1177 case V4L2_CID_POWER_LINE_FREQUENCY:
1178 switch (menu->index) {
1179 case 0: /* V4L2_CID_POWER_LINE_FREQUENCY_DISABLED */
1180 strcpy((char *) menu->name, "NoFliker");
1181 return 0;
1182 case 1: /* V4L2_CID_POWER_LINE_FREQUENCY_50HZ */
1183 strcpy((char *) menu->name, "50 Hz");
1184 return 0;
1185 case 2: /* V4L2_CID_POWER_LINE_FREQUENCY_60HZ */
1186 strcpy((char *) menu->name, "60 Hz");
1187 return 0;
1188 }
1189 break;
1190 }
1191 return -EINVAL;
1192}
1193
6a7eba24 1194/* sub-driver description */
dcef3237 1195static const struct sd_desc sd_desc = {
6a7eba24
JFM		 1196 .name = MODULE_NAME,
1197 .ctrls = sd_ctrls,
1198 .nctrls = ARRAY_SIZE(sd_ctrls),
1199 .config = sd_config,
012d6b02 1200 .init = sd_init,
6a7eba24
JFM		 1201 .start = sd_start,
1202 .stopN = sd_stopN,
6a7eba24 1203 .pkt_scan = sd_pkt_scan,
66f35821 1204 .querymenu = sd_querymenu,
e2ad2a54 1205 .dq_callback = do_autogain,
6a7eba24
JFM		 1206};
1207
1208/* -- module initialisation -- */
f45f06b6
HG		 1209#define SB(sensor, bridge) \
1210 .driver_info = (SENSOR_ ## sensor << 8) | BRIDGE_ ## bridge
1211
e2ad2a54 1212
6a7eba24 1213static __devinitdata struct usb_device_id device_table[] = {
a94a5086
HG		 1214 {USB_DEVICE(0x0c45, 0x6001), SB(TAS5110, 102)}, /* TAS5110C1B */
1215 {USB_DEVICE(0x0c45, 0x6005), SB(TAS5110, 101)}, /* TAS5110C1B */
222a07ff 1216#if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
a94a5086 1217 {USB_DEVICE(0x0c45, 0x6007), SB(TAS5110, 101)}, /* TAS5110D */
f45f06b6
HG		 1218 {USB_DEVICE(0x0c45, 0x6009), SB(PAS106, 101)},
1219 {USB_DEVICE(0x0c45, 0x600d), SB(PAS106, 101)},
5de39b2b 1220#endif
f45f06b6 1221 {USB_DEVICE(0x0c45, 0x6011), SB(OV6650, 101)},
222a07ff 1222#if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
f45f06b6
HG		 1223 {USB_DEVICE(0x0c45, 0x6019), SB(OV7630, 101)},
1224 {USB_DEVICE(0x0c45, 0x6024), SB(TAS5130CXX, 102)},
1225 {USB_DEVICE(0x0c45, 0x6025), SB(TAS5130CXX, 102)},
1226 {USB_DEVICE(0x0c45, 0x6028), SB(PAS202, 102)},
1227 {USB_DEVICE(0x0c45, 0x6029), SB(PAS106, 102)},
1228 {USB_DEVICE(0x0c45, 0x602c), SB(OV7630, 102)},
222a07ff 1229#endif
f45f06b6 1230 {USB_DEVICE(0x0c45, 0x602d), SB(HV7131R, 102)},
222a07ff 1231#if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
f45f06b6
HG		 1232 {USB_DEVICE(0x0c45, 0x602e), SB(OV7630, 102)},
1233 {USB_DEVICE(0x0c45, 0x608f), SB(OV7630, 103)},
1234 {USB_DEVICE(0x0c45, 0x60af), SB(PAS202, 103)},
1235 {USB_DEVICE(0x0c45, 0x60b0), SB(OV7630, 103)},
c41492c8 1236#endif
6a7eba24
JFM		 1237 {}
1238};
1239MODULE_DEVICE_TABLE(usb, device_table);
1240
1241/* -- device connect -- */
1242static int sd_probe(struct usb_interface *intf,
1243 const struct usb_device_id *id)
1244{
1245 return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
1246 THIS_MODULE);
1247}
1248
1249static struct usb_driver sd_driver = {
1250 .name = MODULE_NAME,
1251 .id_table = device_table,
1252 .probe = sd_probe,
1253 .disconnect = gspca_disconnect,
6a709749
JFM		 1254#ifdef CONFIG_PM
1255 .suspend = gspca_suspend,
1256 .resume = gspca_resume,
1257#endif
6a7eba24
JFM		 1258};
1259
1260/* -- module insert / remove -- */
1261static int __init sd_mod_init(void)
1262{
1263 if (usb_register(&sd_driver) < 0)
1264 return -1;
10b0e96e 1265 PDEBUG(D_PROBE, "registered");
6a7eba24
JFM		 1266 return 0;
1267}
1268static void __exit sd_mod_exit(void)
1269{
1270 usb_deregister(&sd_driver);
1271 PDEBUG(D_PROBE, "deregistered");
1272}
1273
1274module_init(sd_mod_init);
1275module_exit(sd_mod_exit);
Clone of davem's net-next-2.6 tree