usb/gspca/spca506.c

21 	struct gspca_dev gspca_dev;	/* !! must be the first item */
63 /* read 'len' bytes to gspca_dev->usb_buf */
64 static void reg_r(struct gspca_dev *gspca_dev,
69 	usb_control_msg(gspca_dev->dev,
70 			usb_rcvctrlpipe(gspca_dev->dev, 0),
74 			index, gspca_dev->usb_buf, length,
91 static void spca506_Initi2c(struct gspca_dev *gspca_dev)
93 	reg_w(gspca_dev->dev, 0x07, SAA7113_I2C_BASE_WRITE, 0x0004);
96 static void spca506_WriteI2c(struct gspca_dev *gspca_dev, __u16 valeur,
101 	reg_w(gspca_dev->dev, 0x07, reg, 0x0001);
102 	reg_w(gspca_dev->dev, 0x07, valeur, 0x0000);
104 		reg_r(gspca_dev, 0x07, 0x0003, 2);
105 		if ((gspca_dev->usb_buf[0] | gspca_dev->usb_buf[1]) == 0x00)
110 static void spca506_SetNormeInput(struct gspca_dev *gspca_dev,
114 	struct sd *sd = (struct sd *) gspca_dev;
120 	gspca_dbg(gspca_dev, D_STREAM, "** Open Set Norme **\n");
121 	spca506_Initi2c(gspca_dev);
132 	reg_w(gspca_dev->dev, 0x08, videomask, 0x0000);
133 	spca506_WriteI2c(gspca_dev, (0xc0 | (channel & 0x0F)), 0x02);
136 		spca506_WriteI2c(gspca_dev, 0x33, 0x0e);
139 		spca506_WriteI2c(gspca_dev, 0x53, 0x0e);
142 		spca506_WriteI2c(gspca_dev, 0x03, 0x0e);
147 	gspca_dbg(gspca_dev, D_STREAM, "Set Video Byte to 0x%2x\n", videomask);
148 	gspca_dbg(gspca_dev, D_STREAM, "Set Norme: %08x Channel %d",
152 static void spca506_GetNormeInput(struct gspca_dev *gspca_dev,
155 	struct sd *sd = (struct sd *) gspca_dev;
161 	gspca_dbg(gspca_dev, D_STREAM, "Get Norme: %d Channel %d\n",
165 static void spca506_Setsize(struct gspca_dev *gspca_dev, __u16 code,
168 	struct usb_device *dev = gspca_dev->dev;
170 	gspca_dbg(gspca_dev, D_STREAM, "** SetSize **\n");
197 static int sd_config(struct gspca_dev *gspca_dev,
202 	cam = &gspca_dev->cam;
209 static int sd_init(struct gspca_dev *gspca_dev)
211 	struct usb_device *dev = gspca_dev->dev;
219 	spca506_SetNormeInput(gspca_dev, 0, 0);
245 	spca506_Initi2c(gspca_dev);
246 	spca506_WriteI2c(gspca_dev, 0x08, 0x01);
247 	spca506_WriteI2c(gspca_dev, 0xc0, 0x02);
249 	spca506_WriteI2c(gspca_dev, 0x33, 0x03);
250 	spca506_WriteI2c(gspca_dev, 0x00, 0x04);
251 	spca506_WriteI2c(gspca_dev, 0x00, 0x05);
252 	spca506_WriteI2c(gspca_dev, 0x0d, 0x06);
253 	spca506_WriteI2c(gspca_dev, 0xf0, 0x07);
254 	spca506_WriteI2c(gspca_dev, 0x98, 0x08);
255 	spca506_WriteI2c(gspca_dev, 0x03, 0x09);
256 	spca506_WriteI2c(gspca_dev, 0x80, 0x0a);
257 	spca506_WriteI2c(gspca_dev, 0x47, 0x0b);
258 	spca506_WriteI2c(gspca_dev, 0x48, 0x0c);
259 	spca506_WriteI2c(gspca_dev, 0x00, 0x0d);
260 	spca506_WriteI2c(gspca_dev, 0x03, 0x0e);	/* Chroma Pal adjust */
261 	spca506_WriteI2c(gspca_dev, 0x2a, 0x0f);
262 	spca506_WriteI2c(gspca_dev, 0x00, 0x10);
263 	spca506_WriteI2c(gspca_dev, 0x0c, 0x11);
264 	spca506_WriteI2c(gspca_dev, 0xb8, 0x12);
265 	spca506_WriteI2c(gspca_dev, 0x01, 0x13);
266 	spca506_WriteI2c(gspca_dev, 0x00, 0x14);
267 	spca506_WriteI2c(gspca_dev, 0x00, 0x15);
268 	spca506_WriteI2c(gspca_dev, 0x00, 0x16);
269 	spca506_WriteI2c(gspca_dev, 0x00, 0x17);
270 	spca506_WriteI2c(gspca_dev, 0x00, 0x18);
271 	spca506_WriteI2c(gspca_dev, 0x00, 0x19);
272 	spca506_WriteI2c(gspca_dev, 0x00, 0x1a);
273 	spca506_WriteI2c(gspca_dev, 0x00, 0x1b);
274 	spca506_WriteI2c(gspca_dev, 0x00, 0x1c);
275 	spca506_WriteI2c(gspca_dev, 0x00, 0x1d);
276 	spca506_WriteI2c(gspca_dev, 0x00, 0x1e);
277 	spca506_WriteI2c(gspca_dev, 0xa1, 0x1f);
278 	spca506_WriteI2c(gspca_dev, 0x02, 0x40);
279 	spca506_WriteI2c(gspca_dev, 0xff, 0x41);
280 	spca506_WriteI2c(gspca_dev, 0xff, 0x42);
281 	spca506_WriteI2c(gspca_dev, 0xff, 0x43);
282 	spca506_WriteI2c(gspca_dev, 0xff, 0x44);
283 	spca506_WriteI2c(gspca_dev, 0xff, 0x45);
284 	spca506_WriteI2c(gspca_dev, 0xff, 0x46);
285 	spca506_WriteI2c(gspca_dev, 0xff, 0x47);
286 	spca506_WriteI2c(gspca_dev, 0xff, 0x48);
287 	spca506_WriteI2c(gspca_dev, 0xff, 0x49);
288 	spca506_WriteI2c(gspca_dev, 0xff, 0x4a);
289 	spca506_WriteI2c(gspca_dev, 0xff, 0x4b);
290 	spca506_WriteI2c(gspca_dev, 0xff, 0x4c);
291 	spca506_WriteI2c(gspca_dev, 0xff, 0x4d);
292 	spca506_WriteI2c(gspca_dev, 0xff, 0x4e);
293 	spca506_WriteI2c(gspca_dev, 0xff, 0x4f);
294 	spca506_WriteI2c(gspca_dev, 0xff, 0x50);
295 	spca506_WriteI2c(gspca_dev, 0xff, 0x51);
296 	spca506_WriteI2c(gspca_dev, 0xff, 0x52);
297 	spca506_WriteI2c(gspca_dev, 0xff, 0x53);
298 	spca506_WriteI2c(gspca_dev, 0xff, 0x54);
299 	spca506_WriteI2c(gspca_dev, 0xff, 0x55);
300 	spca506_WriteI2c(gspca_dev, 0xff, 0x56);
301 	spca506_WriteI2c(gspca_dev, 0xff, 0x57);
302 	spca506_WriteI2c(gspca_dev, 0x00, 0x58);
303 	spca506_WriteI2c(gspca_dev, 0x54, 0x59);
304 	spca506_WriteI2c(gspca_dev, 0x07, 0x5a);
305 	spca506_WriteI2c(gspca_dev, 0x83, 0x5b);
306 	spca506_WriteI2c(gspca_dev, 0x00, 0x5c);
307 	spca506_WriteI2c(gspca_dev, 0x00, 0x5d);
308 	spca506_WriteI2c(gspca_dev, 0x00, 0x5e);
309 	spca506_WriteI2c(gspca_dev, 0x00, 0x5f);
310 	spca506_WriteI2c(gspca_dev, 0x00, 0x60);
311 	spca506_WriteI2c(gspca_dev, 0x05, 0x61);
312 	spca506_WriteI2c(gspca_dev, 0x9f, 0x62);
313 	gspca_dbg(gspca_dev, D_STREAM, "** Close Init *\n");
317 static int sd_start(struct gspca_dev *gspca_dev)
319 	struct usb_device *dev = gspca_dev->dev;
333 	spca506_Initi2c(gspca_dev);
334 	spca506_WriteI2c(gspca_dev, 0x08, 0x01);	/* Increment Delay */
335 /*	spca506_WriteI2c(gspca_dev, 0xc0, 0x02); * Analog Input Control 1 */
336 	spca506_WriteI2c(gspca_dev, 0x33, 0x03);
338 	spca506_WriteI2c(gspca_dev, 0x00, 0x04);
340 	spca506_WriteI2c(gspca_dev, 0x00, 0x05);
342 	spca506_WriteI2c(gspca_dev, 0x0d, 0x06);
344 	spca506_WriteI2c(gspca_dev, 0xf0, 0x07);
347 	spca506_WriteI2c(gspca_dev, 0x98, 0x08);	/* Sync Control */
349 	spca506_WriteI2c(gspca_dev, 0x03, 0x09);	/* Luminance Control */
350 	spca506_WriteI2c(gspca_dev, 0x80, 0x0a);
352 	spca506_WriteI2c(gspca_dev, 0x47, 0x0b);	/* Luminance Contrast */
353 	spca506_WriteI2c(gspca_dev, 0x48, 0x0c);
355 	spca506_WriteI2c(gspca_dev, 0x00, 0x0d);
357 	spca506_WriteI2c(gspca_dev, 0x2a, 0x0f);
360 	spca506_WriteI2c(gspca_dev, 0x00, 0x10);
362 	spca506_WriteI2c(gspca_dev, 0x0c, 0x11);	/* Output Control 1 */
363 	spca506_WriteI2c(gspca_dev, 0xb8, 0x12);	/* Output Control 2 */
364 	spca506_WriteI2c(gspca_dev, 0x01, 0x13);	/* Output Control 3 */
365 	spca506_WriteI2c(gspca_dev, 0x00, 0x14);	/* reserved */
366 	spca506_WriteI2c(gspca_dev, 0x00, 0x15);	/* VGATE START */
367 	spca506_WriteI2c(gspca_dev, 0x00, 0x16);	/* VGATE STOP */
368 	spca506_WriteI2c(gspca_dev, 0x00, 0x17);    /* VGATE Control (MSB) */
369 	spca506_WriteI2c(gspca_dev, 0x00, 0x18);
370 	spca506_WriteI2c(gspca_dev, 0x00, 0x19);
371 	spca506_WriteI2c(gspca_dev, 0x00, 0x1a);
372 	spca506_WriteI2c(gspca_dev, 0x00, 0x1b);
373 	spca506_WriteI2c(gspca_dev, 0x00, 0x1c);
374 	spca506_WriteI2c(gspca_dev, 0x00, 0x1d);
375 	spca506_WriteI2c(gspca_dev, 0x00, 0x1e);
376 	spca506_WriteI2c(gspca_dev, 0xa1, 0x1f);
377 	spca506_WriteI2c(gspca_dev, 0x02, 0x40);
378 	spca506_WriteI2c(gspca_dev, 0xff, 0x41);
379 	spca506_WriteI2c(gspca_dev, 0xff, 0x42);
380 	spca506_WriteI2c(gspca_dev, 0xff, 0x43);
381 	spca506_WriteI2c(gspca_dev, 0xff, 0x44);
382 	spca506_WriteI2c(gspca_dev, 0xff, 0x45);
383 	spca506_WriteI2c(gspca_dev, 0xff, 0x46);
384 	spca506_WriteI2c(gspca_dev, 0xff, 0x47);
385 	spca506_WriteI2c(gspca_dev, 0xff, 0x48);
386 	spca506_WriteI2c(gspca_dev, 0xff, 0x49);
387 	spca506_WriteI2c(gspca_dev, 0xff, 0x4a);
388 	spca506_WriteI2c(gspca_dev, 0xff, 0x4b);
389 	spca506_WriteI2c(gspca_dev, 0xff, 0x4c);
390 	spca506_WriteI2c(gspca_dev, 0xff, 0x4d);
391 	spca506_WriteI2c(gspca_dev, 0xff, 0x4e);
392 	spca506_WriteI2c(gspca_dev, 0xff, 0x4f);
393 	spca506_WriteI2c(gspca_dev, 0xff, 0x50);
394 	spca506_WriteI2c(gspca_dev, 0xff, 0x51);
395 	spca506_WriteI2c(gspca_dev, 0xff, 0x52);
396 	spca506_WriteI2c(gspca_dev, 0xff, 0x53);
397 	spca506_WriteI2c(gspca_dev, 0xff, 0x54);
398 	spca506_WriteI2c(gspca_dev, 0xff, 0x55);
399 	spca506_WriteI2c(gspca_dev, 0xff, 0x56);
400 	spca506_WriteI2c(gspca_dev, 0xff, 0x57);
401 	spca506_WriteI2c(gspca_dev, 0x00, 0x58);
402 	spca506_WriteI2c(gspca_dev, 0x54, 0x59);
403 	spca506_WriteI2c(gspca_dev, 0x07, 0x5a);
404 	spca506_WriteI2c(gspca_dev, 0x83, 0x5b);
405 	spca506_WriteI2c(gspca_dev, 0x00, 0x5c);
406 	spca506_WriteI2c(gspca_dev, 0x00, 0x5d);
407 	spca506_WriteI2c(gspca_dev, 0x00, 0x5e);
408 	spca506_WriteI2c(gspca_dev, 0x00, 0x5f);
409 	spca506_WriteI2c(gspca_dev, 0x00, 0x60);
410 	spca506_WriteI2c(gspca_dev, 0x05, 0x61);
411 	spca506_WriteI2c(gspca_dev, 0x9f, 0x62);
417 	switch (gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].priv) {
419 		spca506_Setsize(gspca_dev, 0, 0x10, 0x10);
422 		spca506_Setsize(gspca_dev, 1, 0x1a, 0x1a);
425 		spca506_Setsize(gspca_dev, 2, 0x1c, 0x1c);
428 		spca506_Setsize(gspca_dev, 4, 0x34, 0x34);
432 		spca506_Setsize(gspca_dev, 5, 0x40, 0x40);
440 	reg_r(gspca_dev, 0x04, 0x0001, 2);
441 	gspca_dbg(gspca_dev, D_STREAM, "webcam started\n");
442 	spca506_GetNormeInput(gspca_dev, &norme, &channel);
443 	spca506_SetNormeInput(gspca_dev, norme, channel);
447 static void sd_stopN(struct gspca_dev *gspca_dev)
449 	struct usb_device *dev = gspca_dev->dev;
456 static void sd_pkt_scan(struct gspca_dev *gspca_dev,
462 		gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0);
465 		gspca_frame_add(gspca_dev, FIRST_PACKET, data, len);
468 /*		gspca_dev->last_packet_type = DISCARD_PACKET; */
473 		gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
478 static void setbrightness(struct gspca_dev *gspca_dev, s32 val)
480 	spca506_Initi2c(gspca_dev);
481 	spca506_WriteI2c(gspca_dev, val, SAA7113_bright);
482 	spca506_WriteI2c(gspca_dev, 0x01, 0x09);
485 static void setcontrast(struct gspca_dev *gspca_dev, s32 val)
487 	spca506_Initi2c(gspca_dev);
488 	spca506_WriteI2c(gspca_dev, val, SAA7113_contrast);
489 	spca506_WriteI2c(gspca_dev, 0x01, 0x09);
492 static void setcolors(struct gspca_dev *gspca_dev, s32 val)
494 	spca506_Initi2c(gspca_dev);
495 	spca506_WriteI2c(gspca_dev, val, SAA7113_saturation);
496 	spca506_WriteI2c(gspca_dev, 0x01, 0x09);
499 static void sethue(struct gspca_dev *gspca_dev, s32 val)
501 	spca506_Initi2c(gspca_dev);
502 	spca506_WriteI2c(gspca_dev, val, SAA7113_hue);
503 	spca506_WriteI2c(gspca_dev, 0x01, 0x09);
508 	struct gspca_dev *gspca_dev =
509 		container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
511 	gspca_dev->usb_err = 0;
513 	if (!gspca_dev->streaming)
518 		setbrightness(gspca_dev, ctrl->val);
521 		setcontrast(gspca_dev, ctrl->val);
524 		setcolors(gspca_dev, ctrl->val);
527 		sethue(gspca_dev, ctrl->val);
530 	return gspca_dev->usb_err;
537 static int sd_init_controls(struct gspca_dev *gspca_dev)
539 	struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler;
541 	gspca_dev->vdev.ctrl_handler = hdl;