blob: 12b81ae526b7206c0e982e3a845e20c4d1386ca2 [file] [log] [blame]
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001/*
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
Hans de Goede93627732008-09-04 16:20:12 -030023/* 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
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -030043#define MODULE_NAME "sonixb"
44
45#include "gspca.h"
46
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -030047MODULE_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 */
Hans de Goededcef3232008-07-10 10:40:53 -030054 atomic_t avg_lum;
Hans de Goedebf2a2202008-09-04 16:22:56 -030055 int prev_avg_lum;
Hans de Goededcef3232008-07-10 10:40:53 -030056
Hans de Goedead5ef80d2008-07-14 10:11:42 -030057 unsigned char gain;
58 unsigned char exposure;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -030059 unsigned char brightness;
Hans de Goededcef3232008-07-10 10:40:53 -030060 unsigned char autogain;
61 unsigned char autogain_ignore_frames;
Hans de Goede6af492e2008-07-22 07:09:33 -030062 unsigned char frames_to_drop;
Hans de Goede66f35822008-07-16 10:16:28 -030063 unsigned char freq; /* light freq filter setting */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -030064
Hans de Goedef45f06b2008-09-03 17:12:21 -030065 __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 */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -030071#define SENSOR_HV7131R 0
72#define SENSOR_OV6650 1
73#define SENSOR_OV7630 2
Hans de Goede6af492e2008-07-22 07:09:33 -030074#define SENSOR_PAS106 3
75#define SENSOR_PAS202 4
76#define SENSOR_TAS5110 5
77#define SENSOR_TAS5130CXX 6
Hans de Goede6af492e2008-07-22 07:09:33 -030078 __u8 reg11;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -030079};
80
Hans de Goedef45f06b2008-09-03 17:12:21 -030081typedef 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 */
Jean-Francois Moine5da162e2008-07-26 14:17:23 -030096#define F_GAIN 0x01 /* has gain */
Hans de Goedee2ad2a52008-09-03 17:12:15 -030097#define F_SIF 0x02 /* sif or vga */
Hans de Goedec437d652008-09-03 17:12:22 -030098
99/* priv field of struct v4l2_pix_format flags (do not use low nibble!) */
100#define MODE_RAW 0x10 /* raw bayer mode */
Hans de Goede93627732008-09-04 16:20:12 -0300101#define MODE_REDUCED_SIF 0x20 /* vga mode (320x240 / 160x120) on sif cam */
Hans de Goedef45f06b2008-09-03 17:12:21 -0300102
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)
Jean-Francois Moine5da162e2008-07-26 14:17:23 -0300107
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300108#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
Hans de Goedef45f06b2008-09-03 17:12:21 -0300117#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
Hans de Goededcef3232008-07-10 10:40:53 -0300129/* 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
Hans de Goedead5ef80d2008-07-14 10:11:42 -0300135#define AUTOGAIN_DEADZONE 1000
Hans de Goededcef3232008-07-10 10:40:53 -0300136#define DESIRED_AVG_LUM 7000
137
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300138/* 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);
Hans de Goededcef3232008-07-10 10:40:53 -0300141static 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);
Hans de Goede66f35822008-07-16 10:16:28 -0300147static int sd_setfreq(struct gspca_dev *gspca_dev, __s32 val);
148static int sd_getfreq(struct gspca_dev *gspca_dev, __s32 *val);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300149
150static struct ctrl sd_ctrls[] = {
Hans de Goedee2ad2a52008-09-03 17:12:15 -0300151#define BRIGHTNESS_IDX 0
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300152 {
153 {
154 .id = V4L2_CID_BRIGHTNESS,
155 .type = V4L2_CTRL_TYPE_INTEGER,
156 .name = "Brightness",
157 .minimum = 0,
158 .maximum = 255,
159 .step = 1,
Hans de Goededcef3232008-07-10 10:40:53 -0300160#define BRIGHTNESS_DEF 127
161 .default_value = BRIGHTNESS_DEF,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300162 },
163 .set = sd_setbrightness,
164 .get = sd_getbrightness,
165 },
Hans de Goedee2ad2a52008-09-03 17:12:15 -0300166#define GAIN_IDX 1
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300167 {
168 {
Hans de Goededcef3232008-07-10 10:40:53 -0300169 .id = V4L2_CID_GAIN,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300170 .type = V4L2_CTRL_TYPE_INTEGER,
Hans de Goededcef3232008-07-10 10:40:53 -0300171 .name = "Gain",
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300172 .minimum = 0,
Hans de Goedead5ef80d2008-07-14 10:11:42 -0300173 .maximum = 255,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300174 .step = 1,
Hans de Goedead5ef80d2008-07-14 10:11:42 -0300175#define GAIN_DEF 127
176#define GAIN_KNEE 200
Hans de Goededcef3232008-07-10 10:40:53 -0300177 .default_value = GAIN_DEF,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300178 },
Hans de Goededcef3232008-07-10 10:40:53 -0300179 .set = sd_setgain,
180 .get = sd_getgain,
181 },
Hans de Goedee2ad2a52008-09-03 17:12:15 -0300182#define EXPOSURE_IDX 2
Hans de Goededcef3232008-07-10 10:40:53 -0300183 {
184 {
185 .id = V4L2_CID_EXPOSURE,
186 .type = V4L2_CTRL_TYPE_INTEGER,
187 .name = "Exposure",
Hans de Goedef4d52022008-07-15 09:36:42 -0300188#define EXPOSURE_DEF 16 /* 32 ms / 30 fps */
189#define EXPOSURE_KNEE 50 /* 100 ms / 10 fps */
Hans de Goededcef3232008-07-10 10:40:53 -0300190 .minimum = 0,
Hans de Goedead5ef80d2008-07-14 10:11:42 -0300191 .maximum = 255,
Hans de Goededcef3232008-07-10 10:40:53 -0300192 .step = 1,
193 .default_value = EXPOSURE_DEF,
194 .flags = 0,
195 },
196 .set = sd_setexposure,
197 .get = sd_getexposure,
198 },
Hans de Goedee2ad2a52008-09-03 17:12:15 -0300199#define AUTOGAIN_IDX 3
Hans de Goededcef3232008-07-10 10:40:53 -0300200 {
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,
Andoni Zubimendi51fc8e32008-07-10 11:12:24 -0300208#define AUTOGAIN_DEF 1
209 .default_value = AUTOGAIN_DEF,
Hans de Goededcef3232008-07-10 10:40:53 -0300210 .flags = 0,
211 },
212 .set = sd_setautogain,
213 .get = sd_getautogain,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300214 },
Hans de Goedee2ad2a52008-09-03 17:12:15 -0300215#define FREQ_IDX 4
Hans de Goede66f35822008-07-16 10:16:28 -0300216 {
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 },
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300230};
231
Jean-Francois Moinec2446b32008-07-05 11:49:20 -0300232static struct v4l2_pix_format vga_mode[] = {
Hans de Goedec437d652008-09-03 17:12:22 -0300233 {160, 120, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
234 .bytesperline = 160,
Mauro Carvalho Chehab2389b362008-08-06 20:13:46 -0300235 .sizeimage = 160 * 120,
Hans de Goedec437d652008-09-03 17:12:22 -0300236 .colorspace = V4L2_COLORSPACE_SRGB,
237 .priv = 2 | MODE_RAW},
Jean-Francois Moinec2446b32008-07-05 11:49:20 -0300238 {160, 120, V4L2_PIX_FMT_SN9C10X, V4L2_FIELD_NONE,
239 .bytesperline = 160,
Hans de Goede5c51518d2008-09-03 17:12:22 -0300240 .sizeimage = 160 * 120 * 5 / 4,
Jean-Francois Moinec2446b32008-07-05 11:49:20 -0300241 .colorspace = V4L2_COLORSPACE_SRGB,
242 .priv = 2},
243 {320, 240, V4L2_PIX_FMT_SN9C10X, V4L2_FIELD_NONE,
244 .bytesperline = 320,
Hans de Goede5c51518d2008-09-03 17:12:22 -0300245 .sizeimage = 320 * 240 * 5 / 4,
Jean-Francois Moinec2446b32008-07-05 11:49:20 -0300246 .colorspace = V4L2_COLORSPACE_SRGB,
247 .priv = 1},
248 {640, 480, V4L2_PIX_FMT_SN9C10X, V4L2_FIELD_NONE,
249 .bytesperline = 640,
Hans de Goede5c51518d2008-09-03 17:12:22 -0300250 .sizeimage = 640 * 480 * 5 / 4,
Jean-Francois Moinec2446b32008-07-05 11:49:20 -0300251 .colorspace = V4L2_COLORSPACE_SRGB,
252 .priv = 0},
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300253};
Jean-Francois Moinec2446b32008-07-05 11:49:20 -0300254static struct v4l2_pix_format sif_mode[] = {
Hans de Goede93627732008-09-04 16:20:12 -0300255 {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},
Hans de Goedec437d652008-09-03 17:12:22 -0300265 {176, 144, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
266 .bytesperline = 176,
Mauro Carvalho Chehab2389b362008-08-06 20:13:46 -0300267 .sizeimage = 176 * 144,
Hans de Goedec437d652008-09-03 17:12:22 -0300268 .colorspace = V4L2_COLORSPACE_SRGB,
269 .priv = 1 | MODE_RAW},
Jean-Francois Moinec2446b32008-07-05 11:49:20 -0300270 {176, 144, V4L2_PIX_FMT_SN9C10X, V4L2_FIELD_NONE,
271 .bytesperline = 176,
Hans de Goede5c51518d2008-09-03 17:12:22 -0300272 .sizeimage = 176 * 144 * 5 / 4,
Jean-Francois Moinec2446b32008-07-05 11:49:20 -0300273 .colorspace = V4L2_COLORSPACE_SRGB,
274 .priv = 1},
Hans de Goede93627732008-09-04 16:20:12 -0300275 {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},
Jean-Francois Moinec2446b32008-07-05 11:49:20 -0300280 {352, 288, V4L2_PIX_FMT_SN9C10X, V4L2_FIELD_NONE,
281 .bytesperline = 352,
Hans de Goede5c51518d2008-09-03 17:12:22 -0300282 .sizeimage = 352 * 288 * 5 / 4,
Jean-Francois Moinec2446b32008-07-05 11:49:20 -0300283 .colorspace = V4L2_COLORSPACE_SRGB,
284 .priv = 0},
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300285};
286
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300287static const __u8 initHv7131[] = {
288 0x46, 0x77, 0x00, 0x04, 0x00, 0x00, 0x00, 0x80, 0x11, 0x00, 0x00, 0x00,
289 0x00, 0x00,
Hans de Goedec437d652008-09-03 17:12:22 -0300290 0x00, 0x00, 0x00, 0x02, 0x01, 0x00,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300291 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,
Hans de Goedec437d652008-09-03 17:12:22 -0300304 0x00, 0x01, 0x01, 0x0a, 0x16, 0x12, 0x68, 0x8b,
Hans de Goede93627732008-09-04 16:20:12 -0300305 0x10, 0x1d, 0x10, 0x02, 0x02, 0x09, 0x07
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300306};
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 */
Hans de Goededcef3232008-07-10 10:40:53 -0300312
313 /* Reset sensor */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300314 {0xa0, 0x60, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10},
Hans de Goededcef3232008-07-10 10:40:53 -0300315 /* Set clock register 0x11 low nibble is clock divider */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300316 {0xd0, 0x60, 0x11, 0xc0, 0x1b, 0x18, 0xc1, 0x10},
Hans de Goededcef3232008-07-10 10:40:53 -0300317 /* Next some unknown stuff */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300318 {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},
Hans de Goede722103e2008-07-17 10:24:47 -0300326 /* 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}, */
Hans de Goededcef3232008-07-10 10:40:53 -0300335 /* Some more unknown stuff */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300336 {0xa0, 0x60, 0x68, 0x04, 0x68, 0xd8, 0xa4, 0x10},
337 {0xd0, 0x60, 0x17, 0x24, 0xd6, 0x04, 0x94, 0x10}, /* Clipreg */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300338};
Hans de Goededcef3232008-07-10 10:40:53 -0300339
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300340static 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 */
Hans de Goedec437d652008-09-03 17:12:22 -0300343 0x00, 0x01, 0x01, 0x0a, /* r11 .. r14 */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300344 0x28, 0x1e, /* H & V sizes r15 .. r16 */
Hans de Goedef45f06b2008-09-03 17:12:21 -0300345 0x68, COMP2, MCK_INIT1, /* r17 .. r19 */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300346 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 */
Hans de Goede4cce1652008-09-04 16:22:57 -0300351 0x00, 0x02, 0x01, 0x0a, /* r11 .. r14 */
Hans de Goede3647fea2008-07-15 05:36:30 -0300352 0x28, 0x1e, /* H & V sizes r15 .. r16 */
Andoni Zubimendi51fc8e32008-07-10 11:12:24 -0300353 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 */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300357};
Hans de Goede6af492e2008-07-22 07:09:33 -0300358static const __u8 ov7630_sensor_init[][8] = {
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300359 {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 */
Andoni Zubimendi794af522008-07-16 08:33:14 -0300362 {0xd0, 0x21, 0x12, 0x1c, 0x00, 0x80, 0x34, 0x10}, /* jfm */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300363 {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},
Andoni Zubimendi794af522008-07-16 08:33:14 -0300370 {0xb0, 0x21, 0x60, 0xa9, 0x4a, 0xa0, 0x30, 0x10},
371/* {0xb0, 0x21, 0x60, 0xa9, 0x42, 0xa0, 0x30, 0x10}, * jfm */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300372 {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};
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300379
Hans de Goedef45f06b2008-09-03 17:12:21 -0300380static const __u8 ov7630_sensor_init_3[][8] = {
381 {0xa0, 0x21, 0x13, 0x80, 0x00, 0x00, 0x00, 0x10},
382};
383
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300384static const __u8 initPas106[] = {
385 0x04, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x81, 0x40, 0x00, 0x00, 0x00,
386 0x00, 0x00,
Hans de Goedec437d652008-09-03 17:12:22 -0300387 0x00, 0x00, 0x00, 0x04, 0x01, 0x00,
Hans de Goedef45f06b2008-09-03 17:12:21 -0300388 0x16, 0x12, 0x24, COMP1, MCK_INIT1,
Hans de Goede93627732008-09-04 16:20:12 -0300389 0x18, 0x10, 0x02, 0x02, 0x09, 0x07
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300390};
391/* compression 0x86 mckinit1 0x2b */
Hans de Goedef45f06b2008-09-03 17:12:21 -0300392static 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 },
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300432};
Hans de Goedef45f06b2008-09-03 17:12:21 -0300433
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300434static const __u8 initPas202[] = {
435 0x44, 0x44, 0x21, 0x30, 0x00, 0x00, 0x00, 0x80, 0x40, 0x00, 0x00, 0x00,
436 0x00, 0x00,
Hans de Goedec437d652008-09-03 17:12:22 -0300437 0x00, 0x00, 0x00, 0x06, 0x03, 0x0a,
Hans de Goedef45f06b2008-09-03 17:12:21 -0300438 0x28, 0x1e, 0x28, 0x89, 0x20,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300439 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,
Hans de Goedec437d652008-09-03 17:12:22 -0300468 0x00, 0x01, 0x00, 0x45, 0x09, 0x0a,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300469 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,
Hans de Goedec437d652008-09-03 17:12:22 -0300481 0x00, 0x01, 0x00, 0x68, 0x0c, 0x0a,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300482 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
Hans de Goedef45f06b2008-09-03 17:12:21 -0300493struct sensor_data sensor_data[] = {
494SENS(initHv7131, NULL, hv7131_sensor_init, NULL, NULL, 0, NO_EXPO|NO_FREQ, 0),
Hans de Goede93627732008-09-04 16:20:12 -0300495SENS(initOv6650, NULL, ov6650_sensor_init, NULL, NULL, F_GAIN|F_SIF, 0, 0x60),
Hans de Goedef45f06b2008-09-03 17:12:21 -0300496SENS(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),
Hans de Goede93627732008-09-04 16:20:12 -0300500SENS(initPas202, initPas202, pas202_sensor_init, NULL, NULL, 0,
Hans de Goedef45f06b2008-09-03 17:12:21 -0300501 NO_EXPO|NO_FREQ, 0),
Hans de Goede93627732008-09-04 16:20:12 -0300502SENS(initTas5110, NULL, tas5110_sensor_init, NULL, NULL, F_GAIN|F_SIF,
Hans de Goedef45f06b2008-09-03 17:12:21 -0300503 NO_BRIGHTNESS|NO_FREQ, 0),
504SENS(initTas5130, NULL, tas5130_sensor_init, NULL, NULL, 0, NO_EXPO|NO_FREQ,
505 0),
506};
507
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300508/* get one byte in gspca_dev->usb_buf */
509static void reg_r(struct gspca_dev *gspca_dev,
510 __u16 value)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300511{
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300512 usb_control_msg(gspca_dev->dev,
513 usb_rcvctrlpipe(gspca_dev->dev, 0),
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300514 0, /* request */
515 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
516 value,
517 0, /* index */
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300518 gspca_dev->usb_buf, 1,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300519 500);
520}
521
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300522static void reg_w(struct gspca_dev *gspca_dev,
523 __u16 value,
524 const __u8 *buffer,
525 int len)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300526{
Jean-Francois Moine335b3f82008-07-30 04:53:02 -0300527#ifdef GSPCA_DEBUG
Jean-Francois Moine8295d992008-09-03 17:12:19 -0300528 if (len > USB_BUF_SZ) {
Hans de Goede0d2a7222008-07-03 08:15:22 -0300529 PDEBUG(D_ERR|D_PACK, "reg_w: buffer overflow");
530 return;
531 }
532#endif
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300533 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
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300544static int i2c_w(struct gspca_dev *gspca_dev, const __u8 *buffer)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300545{
546 int retry = 60;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300547
548 /* is i2c ready */
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300549 reg_w(gspca_dev, 0x08, buffer, 8);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300550 while (retry--) {
551 msleep(10);
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300552 reg_r(gspca_dev, 0x08);
Andoni Zubimendib7474cf92008-07-16 08:40:30 -0300553 if (gspca_dev->usb_buf[0] & 0x04) {
554 if (gspca_dev->usb_buf[0] & 0x08)
555 return -1;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300556 return 0;
Andoni Zubimendib7474cf92008-07-16 08:40:30 -0300557 }
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300558 }
559 return -1;
560}
561
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300562static void i2c_w_vector(struct gspca_dev *gspca_dev,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300563 const __u8 buffer[][8], int len)
564{
565 for (;;) {
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300566 reg_w(gspca_dev, 0x08, *buffer, 8);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300567 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) {
Hans de Goedea975a522008-07-16 15:29:11 -0300580 case SENSOR_OV6650:
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300581 case SENSOR_OV7630: {
582 __u8 i2cOV[] =
Hans de Goedea975a522008-07-16 15:29:11 -0300583 {0xa0, 0x00, 0x06, 0x00, 0x00, 0x00, 0x00, 0x10};
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300584
585 /* change reg 0x06 */
Hans de Goedef45f06b2008-09-03 17:12:21 -0300586 i2cOV[1] = sensor_data[sd->sensor].sensor_addr;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300587 i2cOV[3] = sd->brightness;
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300588 if (i2c_w(gspca_dev, i2cOV) < 0)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300589 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;
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300598 if (i2c_w(gspca_dev, i2c1) < 0)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300599 goto err;
600 i2c1[3] = 0x01;
601 i2c1[2] = 0x13;
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300602 if (i2c_w(gspca_dev, i2c1) < 0)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300603 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;
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300618/* if(i2c_w(gspca_dev,i2cpexpo1) < 0)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300619 goto err; */
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300620/* if(i2c_w(gspca_dev,i2cpdoit) < 0)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300621 goto err; */
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300622 if (i2c_w(gspca_dev, i2cpexpo) < 0)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300623 goto err;
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300624 if (i2c_w(gspca_dev, i2cpdoit) < 0)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300625 goto err;
626 i2cp202[3] = sd->brightness >> 3;
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300627 if (i2c_w(gspca_dev, i2cp202) < 0)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300628 goto err;
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300629 if (i2c_w(gspca_dev, i2cpdoit) < 0)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300630 goto err;
631 break;
632 }
Hans de Goededcef3232008-07-10 10:40:53 -0300633 case SENSOR_TAS5130CXX: {
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300634 __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]);
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300640 if (i2c_w(gspca_dev, i2c) < 0)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300641 goto err;
642 break;
643 }
644 }
645 return;
646err:
647 PDEBUG(D_ERR, "i2c error brightness");
648}
Hans de Goededcef3232008-07-10 10:40:53 -0300649
650static void setsensorgain(struct gspca_dev *gspca_dev)
651{
652 struct sd *sd = (struct sd *) gspca_dev;
Hans de Goedea975a522008-07-16 15:29:11 -0300653 unsigned char gain = sd->gain;
Hans de Goededcef3232008-07-10 10:40:53 -0300654
655 switch (sd->sensor) {
656
657 case SENSOR_TAS5110: {
658 __u8 i2c[] =
659 {0x30, 0x11, 0x02, 0x20, 0x70, 0x00, 0x00, 0x10};
660
Hans de Goedea975a522008-07-16 15:29:11 -0300661 i2c[4] = 255 - gain;
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300662 if (i2c_w(gspca_dev, i2c) < 0)
Hans de Goededcef3232008-07-10 10:40:53 -0300663 goto err;
Andoni Zubimendi51fc8e32008-07-10 11:12:24 -0300664 break;
665 }
Hans de Goedead5ef80d2008-07-14 10:11:42 -0300666
Hans de Goedea975a522008-07-16 15:29:11 -0300667 case SENSOR_OV6650:
668 gain >>= 1;
669 /* fall thru */
Hans de Goede6af492e2008-07-22 07:09:33 -0300670 case SENSOR_OV7630: {
Hans de Goedea975a522008-07-16 15:29:11 -0300671 __u8 i2c[] = {0xa0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10};
Andoni Zubimendi794af522008-07-16 08:33:14 -0300672
Hans de Goedef45f06b2008-09-03 17:12:21 -0300673 i2c[1] = sensor_data[sd->sensor].sensor_addr;
Hans de Goedea975a522008-07-16 15:29:11 -0300674 i2c[3] = gain >> 2;
Andoni Zubimendi794af522008-07-16 08:33:14 -0300675 if (i2c_w(gspca_dev, i2c) < 0)
676 goto err;
677 break;
678 }
Hans de Goededcef3232008-07-10 10:40:53 -0300679 }
680 return;
681err:
682 PDEBUG(D_ERR, "i2c error gain");
683}
684
685static void setgain(struct gspca_dev *gspca_dev)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300686{
687 struct sd *sd = (struct sd *) gspca_dev;
688 __u8 gain;
689 __u8 rgb_value;
690
Hans de Goedead5ef80d2008-07-14 10:11:42 -0300691 gain = sd->gain >> 4;
Hans de Goededcef3232008-07-10 10:40:53 -0300692
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300693 /* red and blue gain */
694 rgb_value = gain << 4 | gain;
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300695 reg_w(gspca_dev, 0x10, &rgb_value, 1);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300696 /* green gain */
697 rgb_value = gain;
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300698 reg_w(gspca_dev, 0x11, &rgb_value, 1);
Hans de Goededcef3232008-07-10 10:40:53 -0300699
Hans de Goedef45f06b2008-09-03 17:12:21 -0300700 if (sensor_data[sd->sensor].flags & F_GAIN)
Hans de Goededcef3232008-07-10 10:40:53 -0300701 setsensorgain(gspca_dev);
702}
703
704static void setexposure(struct gspca_dev *gspca_dev)
705{
706 struct sd *sd = (struct sd *) gspca_dev;
Hans de Goededcef3232008-07-10 10:40:53 -0300707
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 */
Hans de Goedef4d52022008-07-15 09:36:42 -0300715 reg = 120 * sd->exposure / 1000;
716 if (reg < 2)
717 reg = 2;
718 else if (reg > 15)
Hans de Goededcef3232008-07-10 10:40:53 -0300719 reg = 15;
720 reg = (reg << 4) | 0x0b;
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300721 reg_w(gspca_dev, 0x19, &reg, 1);
Andoni Zubimendi51fc8e32008-07-10 11:12:24 -0300722 break;
723 }
Hans de Goedea975a522008-07-16 15:29:11 -0300724 case SENSOR_OV6650:
Hans de Goede6af492e2008-07-22 07:09:33 -0300725 case SENSOR_OV7630: {
Hans de Goedea975a522008-07-16 15:29:11 -0300726 /* The ov6650 / ov7630 have 2 registers which both influence
727 exposure, register 11, whose low nibble sets the nr off fps
Hans de Goedef4d52022008-07-15 09:36:42 -0300728 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 */
Hans de Goede6af492e2008-07-22 07:09:33 -0300740 __u8 i2c[] = {0xb0, 0x00, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10};
741 int reg10, reg11, reg10_max;
742
Hans de Goede66f35822008-07-16 10:16:28 -0300743 /* 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
Hans de Goedea975a522008-07-16 15:29:11 -0300748 the ov6645. The ov7630 datasheet says the max is 0x41. */
Hans de Goede6af492e2008-07-22 07:09:33 -0300749 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;
Hans de Goedef4d52022008-07-15 09:36:42 -0300754
755 reg11 = (60 * sd->exposure + 999) / 1000;
756 if (reg11 < 1)
757 reg11 = 1;
758 else if (reg11 > 16)
759 reg11 = 16;
760
Hans de Goedee2ad2a52008-09-03 17:12:15 -0300761 /* 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
Hans de Goedef4d52022008-07-15 09:36:42 -0300766 /* 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);
Hans de Goedea975a522008-07-16 15:29:11 -0300769
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;
Hans de Goedef4d52022008-07-15 09:36:42 -0300776 else if (reg10 > reg10_max)
777 reg10 = reg10_max;
778
779 /* Write reg 10 and reg11 low nibble */
Hans de Goedef45f06b2008-09-03 17:12:21 -0300780 i2c[1] = sensor_data[sd->sensor].sensor_addr;
Andoni Zubimendi794af522008-07-16 08:33:14 -0300781 i2c[3] = reg10;
782 i2c[4] |= reg11 - 1;
Hans de Goede6af492e2008-07-22 07:09:33 -0300783
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
Andoni Zubimendi794af522008-07-16 08:33:14 -0300791 PDEBUG(D_ERR, "i2c error exposure");
792 break;
793 }
Hans de Goededcef3232008-07-10 10:40:53 -0300794 }
795}
796
Hans de Goede66f35822008-07-16 10:16:28 -0300797static void setfreq(struct gspca_dev *gspca_dev)
798{
799 struct sd *sd = (struct sd *) gspca_dev;
800
801 switch (sd->sensor) {
Andoni Zubimendid87616f2008-07-17 05:35:52 -0300802 case SENSOR_OV6650:
Hans de Goede6af492e2008-07-22 07:09:33 -0300803 case SENSOR_OV7630: {
Hans de Goede66f35822008-07-16 10:16:28 -0300804 /* Framerate adjust register for artificial light 50 hz flicker
Hans de Goede6af492e2008-07-22 07:09:33 -0300805 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 */
Andoni Zubimendid87616f2008-07-17 05:35:52 -0300808 __u8 i2c[] = {0xa0, 0x00, 0x2b, 0x00, 0x00, 0x00, 0x00, 0x10};
Hans de Goede66f35822008-07-16 10:16:28 -0300809 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 */
Hans de Goede722103e2008-07-17 10:24:47 -0300816 i2c[3] = (sd->sensor == SENSOR_OV6650)
817 ? 0x4f : 0x8a;
Hans de Goede66f35822008-07-16 10:16:28 -0300818 break;
819 }
Hans de Goedef45f06b2008-09-03 17:12:21 -0300820 i2c[1] = sensor_data[sd->sensor].sensor_addr;
Hans de Goede66f35822008-07-16 10:16:28 -0300821 if (i2c_w(gspca_dev, i2c) < 0)
822 PDEBUG(D_ERR, "i2c error setfreq");
823 break;
824 }
825 }
826}
827
Hans de Goededcef3232008-07-10 10:40:53 -0300828static 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,
Hans de Goedea975a522008-07-16 15:29:11 -0300840 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);
Hans de Goededcef3232008-07-10 10:40:53 -0300843 sd->autogain_ignore_frames = AUTOGAIN_IGNORE_FRAMES;
Hans de Goedea975a522008-07-16 15:29:11 -0300844 }
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300845}
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;
Hans de Goede65f33392008-09-03 17:12:15 -0300853
854 reg_r(gspca_dev, 0x00);
855 if (gspca_dev->usb_buf[0] != 0x10)
856 return -ENODEV;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300857
Jean-Francois Moine5da162e2008-07-26 14:17:23 -0300858 /* copy the webcam info from the device id */
Hans de Goedef45f06b2008-09-03 17:12:21 -0300859 sd->sensor = id->driver_info >> 8;
860 sd->bridge = id->driver_info & 0xff;
861 gspca_dev->ctrl_dis = sensor_data[sd->sensor].ctrl_dis;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300862
863 cam = &gspca_dev->cam;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300864 cam->epaddr = 0x01;
Hans de Goedef45f06b2008-09-03 17:12:21 -0300865 if (!(sensor_data[sd->sensor].flags & F_SIF)) {
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300866 cam->cam_mode = vga_mode;
Andoni Zubimendi51fc8e32008-07-10 11:12:24 -0300867 cam->nmodes = ARRAY_SIZE(vga_mode);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300868 } else {
869 cam->cam_mode = sif_mode;
Andoni Zubimendi51fc8e32008-07-10 11:12:24 -0300870 cam->nmodes = ARRAY_SIZE(sif_mode);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300871 }
Hans de Goededcef3232008-07-10 10:40:53 -0300872 sd->brightness = BRIGHTNESS_DEF;
873 sd->gain = GAIN_DEF;
874 sd->exposure = EXPOSURE_DEF;
Hans de Goedee2ad2a52008-09-03 17:12:15 -0300875 if (gspca_dev->ctrl_dis & (1 << AUTOGAIN_IDX))
876 sd->autogain = 0; /* Disable do_autogain callback */
877 else
878 sd->autogain = AUTOGAIN_DEF;
Hans de Goede12ff9122008-07-17 10:30:56 -0300879 sd->freq = FREQ_DEF;
Hans de Goede6af492e2008-07-22 07:09:33 -0300880
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300881 return 0;
882}
883
Jean-Francois Moine012d6b02008-09-03 17:12:16 -0300884/* this function is called at probe and resume time */
885static int sd_init(struct gspca_dev *gspca_dev)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300886{
Hans de Goede271315a2008-09-03 17:12:19 -0300887 const __u8 stop = 0x09; /* Disable stream turn of LED */
888
889 reg_w(gspca_dev, 0x01, &stop, 1);
890
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300891 return 0;
892}
893
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300894/* -- start the camera -- */
895static void sd_start(struct gspca_dev *gspca_dev)
896{
897 struct sd *sd = (struct sd *) gspca_dev;
Hans de Goede93627732008-09-04 16:20:12 -0300898 struct cam *cam = &gspca_dev->cam;
Hans de Goedef45f06b2008-09-03 17:12:21 -0300899 int mode, l;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300900 const __u8 *sn9c10x;
Hans de Goede93627732008-09-04 16:20:12 -0300901 __u8 reg12_19[8];
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300902
Hans de Goede93627732008-09-04 16:20:12 -0300903 mode = cam->cam_mode[gspca_dev->curr_mode].priv & 0x07;
Hans de Goedef45f06b2008-09-03 17:12:21 -0300904 sn9c10x = sensor_data[sd->sensor].bridge_init[sd->bridge];
905 l = sensor_data[sd->sensor].bridge_init_size[sd->bridge];
Hans de Goede93627732008-09-04 16:20:12 -0300906 memcpy(reg12_19, &sn9c10x[0x12 - 1], 8);
907 reg12_19[6] = sn9c10x[0x18 - 1] | (mode << 4);
Hans de Goedef45f06b2008-09-03 17:12:21 -0300908 /* Special cases where reg 17 and or 19 value depends on mode */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300909 switch (sd->sensor) {
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300910 case SENSOR_PAS202:
Hans de Goede93627732008-09-04 16:20:12 -0300911 reg12_19[5] = mode ? 0x24 : 0x20;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300912 break;
Hans de Goedef45f06b2008-09-03 17:12:21 -0300913 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. */
Hans de Goede93627732008-09-04 16:20:12 -0300917 reg12_19[7] = mode ? 0x23 : 0x43;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300918 break;
919 }
Hans de Goedec437d652008-09-03 17:12:22 -0300920 /* Disable compression when the raw bayer format has been selected */
Hans de Goede93627732008-09-04 16:20:12 -0300921 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 }
Hans de Goede6af492e2008-07-22 07:09:33 -0300931
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300932 /* reg 0x01 bit 2 video transfert on */
Hans de Goedefff42052008-07-23 07:04:39 -0300933 reg_w(gspca_dev, 0x01, &sn9c10x[0x01 - 1], 1);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300934 /* reg 0x17 SensorClk enable inv Clk 0x60 */
Hans de Goedefff42052008-07-23 07:04:39 -0300935 reg_w(gspca_dev, 0x17, &sn9c10x[0x17 - 1], 1);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300936 /* Set the registers from the template */
Jean-Francois Moine8295d992008-09-03 17:12:19 -0300937 reg_w(gspca_dev, 0x01, sn9c10x, l);
Hans de Goedef45f06b2008-09-03 17:12:21 -0300938
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
Hans de Goede3647fea2008-07-15 05:36:30 -0300948 /* H_size V_size 0x28, 0x1e -> 640x480. 0x16, 0x12 -> 352x288 */
Hans de Goede93627732008-09-04 16:20:12 -0300949 reg_w(gspca_dev, 0x15, &reg12_19[3], 2);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300950 /* compression register */
Hans de Goede93627732008-09-04 16:20:12 -0300951 reg_w(gspca_dev, 0x18, &reg12_19[6], 1);
Andoni Zubimendi794af522008-07-16 08:33:14 -0300952 /* H_start */
Hans de Goede93627732008-09-04 16:20:12 -0300953 reg_w(gspca_dev, 0x12, &reg12_19[0], 1);
Andoni Zubimendi794af522008-07-16 08:33:14 -0300954 /* V_START */
Hans de Goede93627732008-09-04 16:20:12 -0300955 reg_w(gspca_dev, 0x13, &reg12_19[1], 1);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300956 /* reset 0x17 SensorClk enable inv Clk 0x60 */
957 /*fixme: ov7630 [17]=68 8f (+20 if 102)*/
Hans de Goede93627732008-09-04 16:20:12 -0300958 reg_w(gspca_dev, 0x17, &reg12_19[5], 1);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300959 /*MCKSIZE ->3 */ /*fixme: not ov7630*/
Hans de Goede93627732008-09-04 16:20:12 -0300960 reg_w(gspca_dev, 0x19, &reg12_19[7], 1);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300961 /* AE_STRX AE_STRY AE_ENDX AE_ENDY */
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300962 reg_w(gspca_dev, 0x1c, &sn9c10x[0x1c - 1], 4);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300963 /* Enable video transfert */
Jean-Francois Moine739570b2008-07-14 09:38:29 -0300964 reg_w(gspca_dev, 0x01, &sn9c10x[0], 1);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300965 /* Compression */
Hans de Goede93627732008-09-04 16:20:12 -0300966 reg_w(gspca_dev, 0x18, &reg12_19[6], 2);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300967 msleep(20);
968
Hans de Goede6af492e2008-07-22 07:09:33 -0300969 sd->reg11 = -1;
970
Hans de Goededcef3232008-07-10 10:40:53 -0300971 setgain(gspca_dev);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300972 setbrightness(gspca_dev);
Hans de Goededcef3232008-07-10 10:40:53 -0300973 setexposure(gspca_dev);
Hans de Goede66f35822008-07-16 10:16:28 -0300974 setfreq(gspca_dev);
Hans de Goededcef3232008-07-10 10:40:53 -0300975
Hans de Goede6af492e2008-07-22 07:09:33 -0300976 sd->frames_to_drop = 0;
Hans de Goededcef3232008-07-10 10:40:53 -0300977 sd->autogain_ignore_frames = 0;
978 atomic_set(&sd->avg_lum, -1);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300979}
980
981static void sd_stopN(struct gspca_dev *gspca_dev)
982{
Hans de Goedef45f06b2008-09-03 17:12:21 -0300983 sd_init(gspca_dev);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300984}
985
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300986static 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{
Hans de Goede0d2a7222008-07-03 08:15:22 -0300991 int i;
Hans de Goededcef3232008-07-10 10:40:53 -0300992 struct sd *sd = (struct sd *) gspca_dev;
Hans de Goedec437d652008-09-03 17:12:22 -0300993 struct cam *cam = &gspca_dev->cam;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -0300994
Hans de Goedec36260ee2008-07-16 09:56:07 -0300995 /* 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 */
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001004 if (len > 6 && len < 24) {
Hans de Goede0d2a7222008-07-03 08:15:22 -03001005 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 */
Hans de Goede6af492e2008-07-22 07:09:33 -03001012 int lum = -1;
1013 int pkt_type = LAST_PACKET;
Hans de Goedef45f06b2008-09-03 17:12:21 -03001014 int fr_h_sz = (sd->bridge == BRIDGE_103) ?
1015 18 : 12;
Hans de Goede6af492e2008-07-22 07:09:33 -03001016
Hans de Goedef45f06b2008-09-03 17:12:21 -03001017 if (len - i < fr_h_sz) {
Hans de Goedec36260ee2008-07-16 09:56:07 -03001018 PDEBUG(D_STREAM, "packet too short to"
1019 " get avg brightness");
Hans de Goedef45f06b2008-09-03 17:12:21 -03001020 } else if (sd->bridge == BRIDGE_103) {
Hans de Goede6af492e2008-07-22 07:09:33 -03001021 lum = data[i + 9] +
1022 (data[i + 10] << 8);
Hans de Goedef45f06b2008-09-03 17:12:21 -03001023 } else {
1024 lum = data[i + 8] + (data[i + 9] << 8);
Hans de Goededcef3232008-07-10 10:40:53 -03001025 }
Hans de Goedebf2a2202008-09-04 16:22:56 -03001026 /* 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) {
Hans de Goede6af492e2008-07-22 07:09:33 -03001034 lum = -1;
1035 sd->frames_to_drop = 2;
Hans de Goedebf2a2202008-09-04 16:22:56 -03001036 sd->prev_avg_lum = 0;
1037 } else
1038 sd->prev_avg_lum = lum;
Hans de Goede6af492e2008-07-22 07:09:33 -03001039 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);
Hans de Goedef45f06b2008-09-03 17:12:21 -03001048 data += i + fr_h_sz;
1049 len -= i + fr_h_sz;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001050 gspca_frame_add(gspca_dev, FIRST_PACKET,
1051 frame, data, len);
1052 return;
1053 }
1054 }
1055 }
Hans de Goedec437d652008-09-03 17:12:22 -03001056
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
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001067 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
Hans de Goededcef3232008-07-10 10:40:53 -03001089static int sd_setgain(struct gspca_dev *gspca_dev, __s32 val)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001090{
1091 struct sd *sd = (struct sd *) gspca_dev;
1092
Hans de Goededcef3232008-07-10 10:40:53 -03001093 sd->gain = val;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001094 if (gspca_dev->streaming)
Hans de Goededcef3232008-07-10 10:40:53 -03001095 setgain(gspca_dev);
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001096 return 0;
1097}
1098
Hans de Goededcef3232008-07-10 10:40:53 -03001099static int sd_getgain(struct gspca_dev *gspca_dev, __s32 *val)
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001100{
1101 struct sd *sd = (struct sd *) gspca_dev;
1102
Hans de Goededcef3232008-07-10 10:40:53 -03001103 *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;
1112 if (gspca_dev->streaming)
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
1144 return 0;
1145}
1146
1147static int sd_getautogain(struct gspca_dev *gspca_dev, __s32 *val)
1148{
1149 struct sd *sd = (struct sd *) gspca_dev;
1150
1151 *val = sd->autogain;
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001152 return 0;
1153}
1154
Hans de Goede66f35822008-07-16 10:16:28 -03001155static 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
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001194/* sub-driver description */
Hans de Goededcef3232008-07-10 10:40:53 -03001195static const struct sd_desc sd_desc = {
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001196 .name = MODULE_NAME,
1197 .ctrls = sd_ctrls,
1198 .nctrls = ARRAY_SIZE(sd_ctrls),
1199 .config = sd_config,
Jean-Francois Moine012d6b02008-09-03 17:12:16 -03001200 .init = sd_init,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001201 .start = sd_start,
1202 .stopN = sd_stopN,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001203 .pkt_scan = sd_pkt_scan,
Hans de Goede66f35822008-07-16 10:16:28 -03001204 .querymenu = sd_querymenu,
Hans de Goedee2ad2a52008-09-03 17:12:15 -03001205 .dq_callback = do_autogain,
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001206};
1207
1208/* -- module initialisation -- */
Hans de Goedef45f06b2008-09-03 17:12:21 -03001209#define SB(sensor, bridge) \
1210 .driver_info = (SENSOR_ ## sensor << 8) | BRIDGE_ ## bridge
1211
Hans de Goedee2ad2a52008-09-03 17:12:15 -03001212
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001213static __devinitdata struct usb_device_id device_table[] = {
Hans de Goedea94a5082008-09-04 16:22:55 -03001214 {USB_DEVICE(0x0c45, 0x6001), SB(TAS5110, 102)}, /* TAS5110C1B */
1215 {USB_DEVICE(0x0c45, 0x6005), SB(TAS5110, 101)}, /* TAS5110C1B */
Hans de Goede222a07f2008-09-03 17:12:20 -03001216#if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
Hans de Goedea94a5082008-09-04 16:22:55 -03001217 {USB_DEVICE(0x0c45, 0x6007), SB(TAS5110, 101)}, /* TAS5110D */
Hans de Goedef45f06b2008-09-03 17:12:21 -03001218 {USB_DEVICE(0x0c45, 0x6009), SB(PAS106, 101)},
1219 {USB_DEVICE(0x0c45, 0x600d), SB(PAS106, 101)},
Hans de Goede5de39b22008-07-17 10:34:28 -03001220#endif
Hans de Goedef45f06b2008-09-03 17:12:21 -03001221 {USB_DEVICE(0x0c45, 0x6011), SB(OV6650, 101)},
Hans de Goede222a07f2008-09-03 17:12:20 -03001222#if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
Hans de Goedef45f06b2008-09-03 17:12:21 -03001223 {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)},
Hans de Goede222a07f2008-09-03 17:12:20 -03001229#endif
Hans de Goedef45f06b2008-09-03 17:12:21 -03001230 {USB_DEVICE(0x0c45, 0x602d), SB(HV7131R, 102)},
Hans de Goede222a07f2008-09-03 17:12:20 -03001231#if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
Hans de Goedef45f06b2008-09-03 17:12:21 -03001232 {USB_DEVICE(0x0c45, 0x602e), SB(OV7630, 102)},
Jean-Francois Moinec41492c2008-07-07 08:31:16 -03001233#endif
Hans de Goede4cce1652008-09-04 16:22:57 -03001234 {USB_DEVICE(0x0c45, 0x608f), SB(OV7630, 103)},
1235#if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
1236 {USB_DEVICE(0x0c45, 0x60af), SB(PAS202, 103)},
1237#endif
1238 {USB_DEVICE(0x0c45, 0x60b0), SB(OV7630, 103)},
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001239 {}
1240};
1241MODULE_DEVICE_TABLE(usb, device_table);
1242
1243/* -- device connect -- */
1244static int sd_probe(struct usb_interface *intf,
1245 const struct usb_device_id *id)
1246{
1247 return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
1248 THIS_MODULE);
1249}
1250
1251static struct usb_driver sd_driver = {
1252 .name = MODULE_NAME,
1253 .id_table = device_table,
1254 .probe = sd_probe,
1255 .disconnect = gspca_disconnect,
Jean-Francois Moine6a709742008-09-03 16:48:10 -03001256#ifdef CONFIG_PM
1257 .suspend = gspca_suspend,
1258 .resume = gspca_resume,
1259#endif
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001260};
1261
1262/* -- module insert / remove -- */
1263static int __init sd_mod_init(void)
1264{
1265 if (usb_register(&sd_driver) < 0)
1266 return -1;
Jean-Francois Moine10b0e962008-07-22 05:35:10 -03001267 PDEBUG(D_PROBE, "registered");
Jean-Francois Moine6a7eba22008-06-30 15:50:11 -03001268 return 0;
1269}
1270static void __exit sd_mod_exit(void)
1271{
1272 usb_deregister(&sd_driver);
1273 PDEBUG(D_PROBE, "deregistered");
1274}
1275
1276module_init(sd_mod_init);
1277module_exit(sd_mod_exit);