1 /*
2 * Quickcam cameras initialization data
3 *
4 * V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19 *
20 */
21 #define MODULE_NAME "tv8532"
22
23 #include "gspca.h"
24
25 MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>");
26 MODULE_DESCRIPTION("TV8532 USB Camera Driver");
27 MODULE_LICENSE("GPL");
28
29 /* specific webcam descriptor */
30 struct sd {
31 struct gspca_dev gspca_dev; /* !! must be the first item */
32
33 __u16 brightness;
34 __u16 contrast;
35
36 __u8 packet;
37 };
38
39 /* V4L2 controls supported by the driver */
40 static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val);
41 static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val);
42 static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val);
43 static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val);
44
45 static struct ctrl sd_ctrls[] = {
46 #define SD_BRIGHTNESS 0
47 {
48 {
49 .id = V4L2_CID_BRIGHTNESS,
50 .type = V4L2_CTRL_TYPE_INTEGER,
51 .name = "Brightness",
52 .minimum = 1,
53 .maximum = 0x2ff,
54 .step = 1,
55 .default_value = 0x18f,
56 },
57 .set = sd_setbrightness,
58 .get = sd_getbrightness,
59 },
60 #define SD_CONTRAST 1
61 {
62 {
63 .id = V4L2_CID_CONTRAST,
64 .type = V4L2_CTRL_TYPE_INTEGER,
65 .name = "Contrast",
66 .minimum = 0,
67 .maximum = 0xffff,
68 .step = 1,
69 .default_value = 0x7fff,
70 },
71 .set = sd_setcontrast,
72 .get = sd_getcontrast,
73 },
74 };
75
76 static const struct v4l2_pix_format sif_mode[] = {
77 {176, 144, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
78 .bytesperline = 176,
79 .sizeimage = 176 * 144,
80 .colorspace = V4L2_COLORSPACE_SRGB,
81 .priv = 1},
82 {352, 288, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
83 .bytesperline = 352,
84 .sizeimage = 352 * 288,
85 .colorspace = V4L2_COLORSPACE_SRGB,
86 .priv = 0},
87 };
88
89 /*
90 * Initialization data: this is the first set-up data written to the
91 * device (before the open data).
92 */
93 #define TESTCLK 0x10 /* reg 0x2c -> 0x12 //10 */
94 #define TESTCOMP 0x90 /* reg 0x28 -> 0x80 */
95 #define TESTLINE 0x81 /* reg 0x29 -> 0x81 */
96 #define QCIFLINE 0x41 /* reg 0x29 -> 0x81 */
97 #define TESTPTL 0x14 /* reg 0x2D -> 0x14 */
98 #define TESTPTH 0x01 /* reg 0x2E -> 0x01 */
99 #define TESTPTBL 0x12 /* reg 0x2F -> 0x0a */
100 #define TESTPTBH 0x01 /* reg 0x30 -> 0x01 */
101 #define ADWIDTHL 0xe8 /* reg 0x0c -> 0xe8 */
102 #define ADWIDTHH 0x03 /* reg 0x0d -> 0x03 */
103 #define ADHEIGHL 0x90 /* reg 0x0e -> 0x91 //93 */
104 #define ADHEIGHH 0x01 /* reg 0x0f -> 0x01 */
105 #define EXPOL 0x8f /* reg 0x1c -> 0x8f */
106 #define EXPOH 0x01 /* reg 0x1d -> 0x01 */
107 #define ADCBEGINL 0x44 /* reg 0x10 -> 0x46 //47 */
108 #define ADCBEGINH 0x00 /* reg 0x11 -> 0x00 */
109 #define ADRBEGINL 0x0a /* reg 0x14 -> 0x0b //0x0c */
110 #define ADRBEGINH 0x00 /* reg 0x15 -> 0x00 */
111 #define TV8532_CMD_UPDATE 0x84
112
113 #define TV8532_EEprom_Add 0x03
114 #define TV8532_EEprom_DataL 0x04
115 #define TV8532_EEprom_DataM 0x05
116 #define TV8532_EEprom_DataH 0x06
117 #define TV8532_EEprom_TableLength 0x07
118 #define TV8532_EEprom_Write 0x08
119 #define TV8532_PART_CTRL 0x00
120 #define TV8532_CTRL 0x01
121 #define TV8532_CMD_EEprom_Open 0x30
122 #define TV8532_CMD_EEprom_Close 0x29
123 #define TV8532_UDP_UPDATE 0x31
124 #define TV8532_GPIO 0x39
125 #define TV8532_GPIO_OE 0x3B
126 #define TV8532_REQ_RegWrite 0x02
127 #define TV8532_REQ_RegRead 0x03
128
129 #define TV8532_ADWIDTH_L 0x0C
130 #define TV8532_ADWIDTH_H 0x0D
131 #define TV8532_ADHEIGHT_L 0x0E
132 #define TV8532_ADHEIGHT_H 0x0F
133 #define TV8532_EXPOSURE 0x1C
134 #define TV8532_QUANT_COMP 0x28
135 #define TV8532_MODE_PACKET 0x29
136 #define TV8532_SETCLK 0x2C
137 #define TV8532_POINT_L 0x2D
138 #define TV8532_POINT_H 0x2E
139 #define TV8532_POINTB_L 0x2F
140 #define TV8532_POINTB_H 0x30
141 #define TV8532_BUDGET_L 0x2A
142 #define TV8532_BUDGET_H 0x2B
143 #define TV8532_VID_L 0x34
144 #define TV8532_VID_H 0x35
145 #define TV8532_PID_L 0x36
146 #define TV8532_PID_H 0x37
147 #define TV8532_DeviceID 0x83
148 #define TV8532_AD_SLOPE 0x91
149 #define TV8532_AD_BITCTRL 0x94
150 #define TV8532_AD_COLBEGIN_L 0x10
151 #define TV8532_AD_COLBEGIN_H 0x11
152 #define TV8532_AD_ROWBEGIN_L 0x14
153 #define TV8532_AD_ROWBEGIN_H 0x15
154
155 static const __u32 tv_8532_eeprom_data[] = {
156 /* add dataL dataM dataH */
157 0x00010001, 0x01018011, 0x02050014, 0x0305001c,
158 0x040d001e, 0x0505001f, 0x06050519, 0x0705011b,
159 0x0805091e, 0x090d892e, 0x0a05892f, 0x0b050dd9,
160 0x0c0509f1, 0
161 };
162
reg_r(struct gspca_dev * gspca_dev,__u16 index)163 static int reg_r(struct gspca_dev *gspca_dev,
164 __u16 index)
165 {
166 usb_control_msg(gspca_dev->dev,
167 usb_rcvctrlpipe(gspca_dev->dev, 0),
168 TV8532_REQ_RegRead,
169 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
170 0, /* value */
171 index, gspca_dev->usb_buf, 1,
172 500);
173 return gspca_dev->usb_buf[0];
174 }
175
176 /* write 1 byte */
reg_w_1(struct gspca_dev * gspca_dev,__u16 index,__u8 value)177 static void reg_w_1(struct gspca_dev *gspca_dev,
178 __u16 index, __u8 value)
179 {
180 gspca_dev->usb_buf[0] = value;
181 usb_control_msg(gspca_dev->dev,
182 usb_sndctrlpipe(gspca_dev->dev, 0),
183 TV8532_REQ_RegWrite,
184 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
185 0, /* value */
186 index, gspca_dev->usb_buf, 1, 500);
187 }
188
189 /* write 2 bytes */
reg_w_2(struct gspca_dev * gspca_dev,__u16 index,__u8 val1,__u8 val2)190 static void reg_w_2(struct gspca_dev *gspca_dev,
191 __u16 index, __u8 val1, __u8 val2)
192 {
193 gspca_dev->usb_buf[0] = val1;
194 gspca_dev->usb_buf[1] = val2;
195 usb_control_msg(gspca_dev->dev,
196 usb_sndctrlpipe(gspca_dev->dev, 0),
197 TV8532_REQ_RegWrite,
198 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
199 0, /* value */
200 index, gspca_dev->usb_buf, 2, 500);
201 }
202
tv_8532WriteEEprom(struct gspca_dev * gspca_dev)203 static void tv_8532WriteEEprom(struct gspca_dev *gspca_dev)
204 {
205 int i = 0;
206 __u8 reg, data0, data1, data2;
207
208 reg_w_1(gspca_dev, TV8532_GPIO, 0xb0);
209 reg_w_1(gspca_dev, TV8532_CTRL, TV8532_CMD_EEprom_Open);
210 /* msleep(1); */
211 while (tv_8532_eeprom_data[i]) {
212 reg = (tv_8532_eeprom_data[i] & 0xff000000) >> 24;
213 reg_w_1(gspca_dev, TV8532_EEprom_Add, reg);
214 /* msleep(1); */
215 data0 = (tv_8532_eeprom_data[i] & 0x000000ff);
216 reg_w_1(gspca_dev, TV8532_EEprom_DataL, data0);
217 /* msleep(1); */
218 data1 = (tv_8532_eeprom_data[i] & 0x0000ff00) >> 8;
219 reg_w_1(gspca_dev, TV8532_EEprom_DataM, data1);
220 /* msleep(1); */
221 data2 = (tv_8532_eeprom_data[i] & 0x00ff0000) >> 16;
222 reg_w_1(gspca_dev, TV8532_EEprom_DataH, data2);
223 /* msleep(1); */
224 reg_w_1(gspca_dev, TV8532_EEprom_Write, 0);
225 /* msleep(10); */
226 i++;
227 }
228 reg_w_1(gspca_dev, TV8532_EEprom_TableLength, i);
229 /* msleep(1); */
230 reg_w_1(gspca_dev, TV8532_CTRL, TV8532_CMD_EEprom_Close);
231 msleep(10);
232 }
233
234 /* this function is called at probe time */
sd_config(struct gspca_dev * gspca_dev,const struct usb_device_id * id)235 static int sd_config(struct gspca_dev *gspca_dev,
236 const struct usb_device_id *id)
237 {
238 struct sd *sd = (struct sd *) gspca_dev;
239 struct cam *cam;
240
241 tv_8532WriteEEprom(gspca_dev);
242
243 cam = &gspca_dev->cam;
244 cam->epaddr = 1;
245 cam->cam_mode = sif_mode;
246 cam->nmodes = sizeof sif_mode / sizeof sif_mode[0];
247
248 sd->brightness = sd_ctrls[SD_BRIGHTNESS].qctrl.default_value;
249 sd->contrast = sd_ctrls[SD_CONTRAST].qctrl.default_value;
250 return 0;
251 }
252
tv_8532ReadRegisters(struct gspca_dev * gspca_dev)253 static void tv_8532ReadRegisters(struct gspca_dev *gspca_dev)
254 {
255 __u8 data;
256
257 data = reg_r(gspca_dev, 0x0001);
258 PDEBUG(D_USBI, "register 0x01-> %x", data);
259 data = reg_r(gspca_dev, 0x0002);
260 PDEBUG(D_USBI, "register 0x02-> %x", data);
261 reg_r(gspca_dev, TV8532_ADWIDTH_L);
262 reg_r(gspca_dev, TV8532_ADWIDTH_H);
263 reg_r(gspca_dev, TV8532_QUANT_COMP);
264 reg_r(gspca_dev, TV8532_MODE_PACKET);
265 reg_r(gspca_dev, TV8532_SETCLK);
266 reg_r(gspca_dev, TV8532_POINT_L);
267 reg_r(gspca_dev, TV8532_POINT_H);
268 reg_r(gspca_dev, TV8532_POINTB_L);
269 reg_r(gspca_dev, TV8532_POINTB_H);
270 reg_r(gspca_dev, TV8532_BUDGET_L);
271 reg_r(gspca_dev, TV8532_BUDGET_H);
272 reg_r(gspca_dev, TV8532_VID_L);
273 reg_r(gspca_dev, TV8532_VID_H);
274 reg_r(gspca_dev, TV8532_PID_L);
275 reg_r(gspca_dev, TV8532_PID_H);
276 reg_r(gspca_dev, TV8532_DeviceID);
277 reg_r(gspca_dev, TV8532_AD_COLBEGIN_L);
278 reg_r(gspca_dev, TV8532_AD_COLBEGIN_H);
279 reg_r(gspca_dev, TV8532_AD_ROWBEGIN_L);
280 reg_r(gspca_dev, TV8532_AD_ROWBEGIN_H);
281 }
282
tv_8532_setReg(struct gspca_dev * gspca_dev)283 static void tv_8532_setReg(struct gspca_dev *gspca_dev)
284 {
285 reg_w_1(gspca_dev, TV8532_AD_COLBEGIN_L,
286 ADCBEGINL); /* 0x10 */
287 reg_w_1(gspca_dev, TV8532_AD_COLBEGIN_H,
288 ADCBEGINH); /* also digital gain */
289 reg_w_1(gspca_dev, TV8532_PART_CTRL,
290 TV8532_CMD_UPDATE); /* 0x00<-0x84 */
291
292 reg_w_1(gspca_dev, TV8532_GPIO_OE, 0x0a);
293 /******************************************************/
294 reg_w_1(gspca_dev, TV8532_ADHEIGHT_L, ADHEIGHL); /* 0e */
295 reg_w_1(gspca_dev, TV8532_ADHEIGHT_H, ADHEIGHH); /* 0f */
296 reg_w_2(gspca_dev, TV8532_EXPOSURE,
297 EXPOL, EXPOH); /* 350d 0x014c; 1c */
298 reg_w_1(gspca_dev, TV8532_AD_COLBEGIN_L,
299 ADCBEGINL); /* 0x10 */
300 reg_w_1(gspca_dev, TV8532_AD_COLBEGIN_H,
301 ADCBEGINH); /* also digital gain */
302 reg_w_1(gspca_dev, TV8532_AD_ROWBEGIN_L,
303 ADRBEGINL); /* 0x14 */
304
305 reg_w_1(gspca_dev, TV8532_AD_SLOPE, 0x00); /* 0x91 */
306 reg_w_1(gspca_dev, TV8532_AD_BITCTRL, 0x02); /* 0x94 */
307
308 reg_w_1(gspca_dev, TV8532_CTRL,
309 TV8532_CMD_EEprom_Close); /* 0x01 */
310
311 reg_w_1(gspca_dev, TV8532_AD_SLOPE, 0x00); /* 0x91 */
312 reg_w_1(gspca_dev, TV8532_PART_CTRL,
313 TV8532_CMD_UPDATE); /* 0x00<-0x84 */
314 }
315
tv_8532_PollReg(struct gspca_dev * gspca_dev)316 static void tv_8532_PollReg(struct gspca_dev *gspca_dev)
317 {
318 int i;
319
320 /* strange polling from tgc */
321 for (i = 0; i < 10; i++) {
322 reg_w_1(gspca_dev, TV8532_SETCLK,
323 TESTCLK); /* 0x48; //0x08; 0x2c */
324 reg_w_1(gspca_dev, TV8532_PART_CTRL, TV8532_CMD_UPDATE);
325 reg_w_1(gspca_dev, TV8532_UDP_UPDATE, 0x01); /* 0x31 */
326 }
327 }
328
329 /* this function is called at probe and resume time */
sd_init(struct gspca_dev * gspca_dev)330 static int sd_init(struct gspca_dev *gspca_dev)
331 {
332 reg_w_1(gspca_dev, TV8532_AD_SLOPE, 0x32);
333 reg_w_1(gspca_dev, TV8532_AD_BITCTRL, 0x00);
334 tv_8532ReadRegisters(gspca_dev);
335 reg_w_1(gspca_dev, TV8532_GPIO_OE, 0x0b);
336 reg_w_2(gspca_dev, TV8532_ADHEIGHT_L, ADHEIGHL,
337 ADHEIGHH); /* 401d 0x0169; 0e */
338 reg_w_2(gspca_dev, TV8532_EXPOSURE, EXPOL,
339 EXPOH); /* 350d 0x014c; 1c */
340 reg_w_1(gspca_dev, TV8532_ADWIDTH_L, ADWIDTHL); /* 0x20; 0x0c */
341 reg_w_1(gspca_dev, TV8532_ADWIDTH_H, ADWIDTHH); /* 0x0d */
342
343 /*******************************************************************/
344 reg_w_1(gspca_dev, TV8532_QUANT_COMP,
345 TESTCOMP); /* 0x72 compressed mode 0x28 */
346 reg_w_1(gspca_dev, TV8532_MODE_PACKET,
347 TESTLINE); /* 0x84; // CIF | 4 packet 0x29 */
348
349 /************************************************/
350 reg_w_1(gspca_dev, TV8532_SETCLK,
351 TESTCLK); /* 0x48; //0x08; 0x2c */
352 reg_w_1(gspca_dev, TV8532_POINT_L,
353 TESTPTL); /* 0x38; 0x2d */
354 reg_w_1(gspca_dev, TV8532_POINT_H,
355 TESTPTH); /* 0x04; 0x2e */
356 reg_w_1(gspca_dev, TV8532_POINTB_L,
357 TESTPTBL); /* 0x04; 0x2f */
358 reg_w_1(gspca_dev, TV8532_POINTB_H,
359 TESTPTBH); /* 0x04; 0x30 */
360 reg_w_1(gspca_dev, TV8532_PART_CTRL,
361 TV8532_CMD_UPDATE); /* 0x00<-0x84 */
362 /*************************************************/
363 reg_w_1(gspca_dev, TV8532_UDP_UPDATE, 0x01); /* 0x31 */
364 msleep(200);
365 reg_w_1(gspca_dev, TV8532_UDP_UPDATE, 0x00); /* 0x31 */
366 /*************************************************/
367 tv_8532_setReg(gspca_dev);
368 /*************************************************/
369 reg_w_1(gspca_dev, TV8532_GPIO_OE, 0x0b);
370 /*************************************************/
371 tv_8532_setReg(gspca_dev);
372 /*************************************************/
373 tv_8532_PollReg(gspca_dev);
374 return 0;
375 }
376
setbrightness(struct gspca_dev * gspca_dev)377 static void setbrightness(struct gspca_dev *gspca_dev)
378 {
379 struct sd *sd = (struct sd *) gspca_dev;
380 int brightness = sd->brightness;
381
382 reg_w_2(gspca_dev, TV8532_EXPOSURE,
383 brightness >> 8, brightness); /* 1c */
384 reg_w_1(gspca_dev, TV8532_PART_CTRL, TV8532_CMD_UPDATE);
385 }
386
387 /* -- start the camera -- */
sd_start(struct gspca_dev * gspca_dev)388 static int sd_start(struct gspca_dev *gspca_dev)
389 {
390 struct sd *sd = (struct sd *) gspca_dev;
391
392 reg_w_1(gspca_dev, TV8532_AD_SLOPE, 0x32);
393 reg_w_1(gspca_dev, TV8532_AD_BITCTRL, 0x00);
394 tv_8532ReadRegisters(gspca_dev);
395 reg_w_1(gspca_dev, TV8532_GPIO_OE, 0x0b);
396 reg_w_2(gspca_dev, TV8532_ADHEIGHT_L,
397 ADHEIGHL, ADHEIGHH); /* 401d 0x0169; 0e */
398 /* reg_w_2(gspca_dev, TV8532_EXPOSURE,
399 EXPOL, EXPOH); * 350d 0x014c; 1c */
400 setbrightness(gspca_dev);
401
402 reg_w_1(gspca_dev, TV8532_ADWIDTH_L, ADWIDTHL); /* 0x20; 0x0c */
403 reg_w_1(gspca_dev, TV8532_ADWIDTH_H, ADWIDTHH); /* 0x0d */
404
405 /************************************************/
406 reg_w_1(gspca_dev, TV8532_QUANT_COMP,
407 TESTCOMP); /* 0x72 compressed mode 0x28 */
408 if (gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].priv) {
409 /* 176x144 */
410 reg_w_1(gspca_dev, TV8532_MODE_PACKET,
411 QCIFLINE); /* 0x84; // CIF | 4 packet 0x29 */
412 } else {
413 /* 352x288 */
414 reg_w_1(gspca_dev, TV8532_MODE_PACKET,
415 TESTLINE); /* 0x84; // CIF | 4 packet 0x29 */
416 }
417 /************************************************/
418 reg_w_1(gspca_dev, TV8532_SETCLK,
419 TESTCLK); /* 0x48; //0x08; 0x2c */
420 reg_w_1(gspca_dev, TV8532_POINT_L,
421 TESTPTL); /* 0x38; 0x2d */
422 reg_w_1(gspca_dev, TV8532_POINT_H,
423 TESTPTH); /* 0x04; 0x2e */
424 reg_w_1(gspca_dev, TV8532_POINTB_L,
425 TESTPTBL); /* 0x04; 0x2f */
426 reg_w_1(gspca_dev, TV8532_POINTB_H,
427 TESTPTBH); /* 0x04; 0x30 */
428 reg_w_1(gspca_dev, TV8532_PART_CTRL,
429 TV8532_CMD_UPDATE); /* 0x00<-0x84 */
430 /************************************************/
431 reg_w_1(gspca_dev, TV8532_UDP_UPDATE, 0x01); /* 0x31 */
432 msleep(200);
433 reg_w_1(gspca_dev, TV8532_UDP_UPDATE, 0x00); /* 0x31 */
434 /************************************************/
435 tv_8532_setReg(gspca_dev);
436 /************************************************/
437 reg_w_1(gspca_dev, TV8532_GPIO_OE, 0x0b);
438 /************************************************/
439 tv_8532_setReg(gspca_dev);
440 /************************************************/
441 tv_8532_PollReg(gspca_dev);
442 reg_w_1(gspca_dev, TV8532_UDP_UPDATE, 0x00); /* 0x31 */
443
444 gspca_dev->empty_packet = 0; /* check the empty packets */
445 sd->packet = 0; /* ignore the first packets */
446
447 return 0;
448 }
449
sd_stopN(struct gspca_dev * gspca_dev)450 static void sd_stopN(struct gspca_dev *gspca_dev)
451 {
452 reg_w_1(gspca_dev, TV8532_GPIO_OE, 0x0b);
453 }
454
sd_pkt_scan(struct gspca_dev * gspca_dev,struct gspca_frame * frame,__u8 * data,int len)455 static void sd_pkt_scan(struct gspca_dev *gspca_dev,
456 struct gspca_frame *frame, /* target */
457 __u8 *data, /* isoc packet */
458 int len) /* iso packet length */
459 {
460 struct sd *sd = (struct sd *) gspca_dev;
461 int packet_type0, packet_type1;
462
463 packet_type0 = packet_type1 = INTER_PACKET;
464 if (gspca_dev->empty_packet) {
465 gspca_dev->empty_packet = 0;
466 sd->packet = gspca_dev->height / 2;
467 packet_type0 = FIRST_PACKET;
468 } else if (sd->packet == 0)
469 return; /* 2 more lines in 352x288 ! */
470 sd->packet--;
471 if (sd->packet == 0)
472 packet_type1 = LAST_PACKET;
473
474 /* each packet contains:
475 * - header 2 bytes
476 * - RG line
477 * - 4 bytes
478 * - GB line
479 * - 4 bytes
480 */
481 gspca_frame_add(gspca_dev, packet_type0,
482 frame, data + 2, gspca_dev->width);
483 gspca_frame_add(gspca_dev, packet_type1,
484 frame, data + gspca_dev->width + 6, gspca_dev->width);
485 }
486
setcontrast(struct gspca_dev * gspca_dev)487 static void setcontrast(struct gspca_dev *gspca_dev)
488 {
489 }
490
sd_setbrightness(struct gspca_dev * gspca_dev,__s32 val)491 static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val)
492 {
493 struct sd *sd = (struct sd *) gspca_dev;
494
495 sd->brightness = val;
496 if (gspca_dev->streaming)
497 setbrightness(gspca_dev);
498 return 0;
499 }
500
sd_getbrightness(struct gspca_dev * gspca_dev,__s32 * val)501 static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val)
502 {
503 struct sd *sd = (struct sd *) gspca_dev;
504
505 *val = sd->brightness;
506 return 0;
507 }
508
sd_setcontrast(struct gspca_dev * gspca_dev,__s32 val)509 static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val)
510 {
511 struct sd *sd = (struct sd *) gspca_dev;
512
513 sd->contrast = val;
514 if (gspca_dev->streaming)
515 setcontrast(gspca_dev);
516 return 0;
517 }
518
sd_getcontrast(struct gspca_dev * gspca_dev,__s32 * val)519 static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val)
520 {
521 struct sd *sd = (struct sd *) gspca_dev;
522
523 *val = sd->contrast;
524 return 0;
525 }
526
527 /* sub-driver description */
528 static const struct sd_desc sd_desc = {
529 .name = MODULE_NAME,
530 .ctrls = sd_ctrls,
531 .nctrls = ARRAY_SIZE(sd_ctrls),
532 .config = sd_config,
533 .init = sd_init,
534 .start = sd_start,
535 .stopN = sd_stopN,
536 .pkt_scan = sd_pkt_scan,
537 };
538
539 /* -- module initialisation -- */
540 static const __devinitdata struct usb_device_id device_table[] = {
541 {USB_DEVICE(0x046d, 0x0920)},
542 {USB_DEVICE(0x046d, 0x0921)},
543 {USB_DEVICE(0x0545, 0x808b)},
544 {USB_DEVICE(0x0545, 0x8333)},
545 {USB_DEVICE(0x0923, 0x010f)},
546 {}
547 };
548
549 MODULE_DEVICE_TABLE(usb, device_table);
550
551 /* -- device connect -- */
sd_probe(struct usb_interface * intf,const struct usb_device_id * id)552 static int sd_probe(struct usb_interface *intf,
553 const struct usb_device_id *id)
554 {
555 return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
556 THIS_MODULE);
557 }
558
559 static struct usb_driver sd_driver = {
560 .name = MODULE_NAME,
561 .id_table = device_table,
562 .probe = sd_probe,
563 .disconnect = gspca_disconnect,
564 #ifdef CONFIG_PM
565 .suspend = gspca_suspend,
566 .resume = gspca_resume,
567 #endif
568 };
569
570 /* -- module insert / remove -- */
sd_mod_init(void)571 static int __init sd_mod_init(void)
572 {
573 if (usb_register(&sd_driver) < 0)
574 return -1;
575 PDEBUG(D_PROBE, "registered");
576 return 0;
577 }
578
sd_mod_exit(void)579 static void __exit sd_mod_exit(void)
580 {
581 usb_deregister(&sd_driver);
582 PDEBUG(D_PROBE, "deregistered");
583 }
584
585 module_init(sd_mod_init);
586 module_exit(sd_mod_exit);
587