2 * Mars-Semi MR97311A library
3 * Copyright (C) 2005 <bradlch@hotmail.com>
5 * V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
22 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
24 #define MODULE_NAME "mars"
29 MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>");
30 MODULE_DESCRIPTION("GSPCA/Mars USB Camera Driver");
31 MODULE_LICENSE("GPL");
41 NCTRLS /* number of controls */
44 /* specific webcam descriptor */
46 struct gspca_dev gspca_dev; /* !! must be the first item */
48 struct gspca_ctrl ctrls[NCTRLS];
51 #define QUALITY_MIN 40
52 #define QUALITY_MAX 70
53 #define QUALITY_DEF 50
55 u8 jpeg_hdr[JPEG_HDR_SZ];
58 /* V4L2 controls supported by the driver */
59 static void setbrightness(struct gspca_dev *gspca_dev);
60 static void setcolors(struct gspca_dev *gspca_dev);
61 static void setgamma(struct gspca_dev *gspca_dev);
62 static void setsharpness(struct gspca_dev *gspca_dev);
63 static int sd_setilluminator1(struct gspca_dev *gspca_dev, __s32 val);
64 static int sd_setilluminator2(struct gspca_dev *gspca_dev, __s32 val);
66 static const struct ctrl sd_ctrls[NCTRLS] = {
69 .id = V4L2_CID_BRIGHTNESS,
70 .type = V4L2_CTRL_TYPE_INTEGER,
77 .set_control = setbrightness
81 .id = V4L2_CID_SATURATION,
82 .type = V4L2_CTRL_TYPE_INTEGER,
89 .set_control = setcolors
94 .type = V4L2_CTRL_TYPE_INTEGER,
101 .set_control = setgamma
105 .id = V4L2_CID_SHARPNESS,
106 .type = V4L2_CTRL_TYPE_INTEGER,
113 .set_control = setsharpness
117 .id = V4L2_CID_ILLUMINATORS_1,
118 .type = V4L2_CTRL_TYPE_BOOLEAN,
119 .name = "Top illuminator",
124 .flags = V4L2_CTRL_FLAG_UPDATE,
126 .set = sd_setilluminator1
130 .id = V4L2_CID_ILLUMINATORS_2,
131 .type = V4L2_CTRL_TYPE_BOOLEAN,
132 .name = "Bottom illuminator",
137 .flags = V4L2_CTRL_FLAG_UPDATE,
139 .set = sd_setilluminator2
143 static const struct v4l2_pix_format vga_mode[] = {
144 {320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
146 .sizeimage = 320 * 240 * 3 / 8 + 590,
147 .colorspace = V4L2_COLORSPACE_JPEG,
149 {640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
151 .sizeimage = 640 * 480 * 3 / 8 + 590,
152 .colorspace = V4L2_COLORSPACE_JPEG,
156 static const __u8 mi_data[0x20] = {
157 /* 01 02 03 04 05 06 07 08 */
158 0x48, 0x22, 0x01, 0x47, 0x10, 0x00, 0x00, 0x00,
159 /* 09 0a 0b 0c 0d 0e 0f 10 */
160 0x00, 0x01, 0x30, 0x01, 0x30, 0x01, 0x30, 0x01,
161 /* 11 12 13 14 15 16 17 18 */
162 0x30, 0x00, 0x04, 0x00, 0x06, 0x01, 0xe2, 0x02,
163 /* 19 1a 1b 1c 1d 1e 1f 20 */
164 0x82, 0x00, 0x20, 0x17, 0x80, 0x08, 0x0c, 0x00
167 /* write <len> bytes from gspca_dev->usb_buf */
168 static void reg_w(struct gspca_dev *gspca_dev,
173 if (gspca_dev->usb_err < 0)
176 ret = usb_bulk_msg(gspca_dev->dev,
177 usb_sndbulkpipe(gspca_dev->dev, 4),
181 500); /* timeout in milliseconds */
183 pr_err("reg write [%02x] error %d\n",
184 gspca_dev->usb_buf[0], ret);
185 gspca_dev->usb_err = ret;
189 static void mi_w(struct gspca_dev *gspca_dev,
193 gspca_dev->usb_buf[0] = 0x1f;
194 gspca_dev->usb_buf[1] = 0; /* control byte */
195 gspca_dev->usb_buf[2] = addr;
196 gspca_dev->usb_buf[3] = value;
201 static void setbrightness(struct gspca_dev *gspca_dev)
203 struct sd *sd = (struct sd *) gspca_dev;
205 gspca_dev->usb_buf[0] = 0x61;
206 gspca_dev->usb_buf[1] = sd->ctrls[BRIGHTNESS].val;
210 static void setcolors(struct gspca_dev *gspca_dev)
212 struct sd *sd = (struct sd *) gspca_dev;
215 val = sd->ctrls[COLORS].val;
216 gspca_dev->usb_buf[0] = 0x5f;
217 gspca_dev->usb_buf[1] = val << 3;
218 gspca_dev->usb_buf[2] = ((val >> 2) & 0xf8) | 0x04;
222 static void setgamma(struct gspca_dev *gspca_dev)
224 struct sd *sd = (struct sd *) gspca_dev;
226 gspca_dev->usb_buf[0] = 0x06;
227 gspca_dev->usb_buf[1] = sd->ctrls[GAMMA].val * 0x40;
231 static void setsharpness(struct gspca_dev *gspca_dev)
233 struct sd *sd = (struct sd *) gspca_dev;
235 gspca_dev->usb_buf[0] = 0x67;
236 gspca_dev->usb_buf[1] = sd->ctrls[SHARPNESS].val * 4 + 3;
240 static void setilluminators(struct gspca_dev *gspca_dev)
242 struct sd *sd = (struct sd *) gspca_dev;
244 gspca_dev->usb_buf[0] = 0x22;
245 if (sd->ctrls[ILLUM_TOP].val)
246 gspca_dev->usb_buf[1] = 0x76;
247 else if (sd->ctrls[ILLUM_BOT].val)
248 gspca_dev->usb_buf[1] = 0x7a;
250 gspca_dev->usb_buf[1] = 0x7e;
254 /* this function is called at probe time */
255 static int sd_config(struct gspca_dev *gspca_dev,
256 const struct usb_device_id *id)
258 struct sd *sd = (struct sd *) gspca_dev;
261 cam = &gspca_dev->cam;
262 cam->cam_mode = vga_mode;
263 cam->nmodes = ARRAY_SIZE(vga_mode);
264 cam->ctrls = sd->ctrls;
265 sd->quality = QUALITY_DEF;
266 gspca_dev->nbalt = 9; /* use the altsetting 08 */
270 /* this function is called at probe and resume time */
271 static int sd_init(struct gspca_dev *gspca_dev)
273 gspca_dev->ctrl_inac = (1 << ILLUM_TOP) | (1 << ILLUM_BOT);
277 static int sd_start(struct gspca_dev *gspca_dev)
279 struct sd *sd = (struct sd *) gspca_dev;
283 /* create the JPEG header */
284 jpeg_define(sd->jpeg_hdr, gspca_dev->height, gspca_dev->width,
285 0x21); /* JPEG 422 */
286 jpeg_set_qual(sd->jpeg_hdr, sd->quality);
288 data = gspca_dev->usb_buf;
290 data[0] = 0x01; /* address */
295 Initialize the MR97113 chip register
297 data[0] = 0x00; /* address */
298 data[1] = 0x0c | 0x01; /* reg 0 */
299 data[2] = 0x01; /* reg 1 */
300 data[3] = gspca_dev->width / 8; /* h_size , reg 2 */
301 data[4] = gspca_dev->height / 8; /* v_size , reg 3 */
302 data[5] = 0x30; /* reg 4, MI, PAS5101 :
303 * 0x30 for 24mhz , 0x28 for 12mhz */
304 data[6] = 0x02; /* reg 5, H start - was 0x04 */
305 data[7] = sd->ctrls[GAMMA].val * 0x40; /* reg 0x06: gamma */
306 data[8] = 0x01; /* reg 7, V start - was 0x03 */
307 /* if (h_size == 320 ) */
308 /* data[9]= 0x56; * reg 8, 24MHz, 2:1 scale down */
310 data[9] = 0x52; /* reg 8, 24MHz, no scale down */
311 /*jfm: from win trace*/
314 reg_w(gspca_dev, 11);
316 data[0] = 0x23; /* address */
317 data[1] = 0x09; /* reg 35, append frame header */
321 data[0] = 0x3c; /* address */
322 /* if (gspca_dev->width == 1280) */
323 /* data[1] = 200; * reg 60, pc-cam frame size
324 * (unit: 4KB) 800KB */
326 data[1] = 50; /* 50 reg 60, pc-cam frame size
327 * (unit: 4KB) 200KB */
331 data[0] = 0x5e; /* address */
332 data[1] = 0; /* reg 94, Y Gain (auto) */
333 /*jfm: from win trace*/
334 /* reg 0x5f/0x60 (LE) = saturation */
336 * l (5f): xxxx x000 */
337 data[2] = sd->ctrls[COLORS].val << 3;
338 data[3] = ((sd->ctrls[COLORS].val >> 2) & 0xf8) | 0x04;
339 data[4] = sd->ctrls[BRIGHTNESS].val; /* reg 0x61 = brightness */
345 /*jfm: from win trace*/
346 data[1] = sd->ctrls[SHARPNESS].val * 4 + 3;
359 /*jfm: win trace - many writes here to reg 0x64*/
361 /* initialize the MI sensor */
362 for (i = 0; i < sizeof mi_data; i++)
363 mi_w(gspca_dev, i + 1, mi_data[i]);
366 data[1] = 0x4d; /* ISOC transferring enable... */
369 gspca_dev->ctrl_inac = 0; /* activate the illuminator controls */
370 return gspca_dev->usb_err;
373 static void sd_stopN(struct gspca_dev *gspca_dev)
375 struct sd *sd = (struct sd *) gspca_dev;
377 gspca_dev->ctrl_inac = (1 << ILLUM_TOP) | (1 << ILLUM_BOT);
378 if (sd->ctrls[ILLUM_TOP].val || sd->ctrls[ILLUM_BOT].val) {
379 sd->ctrls[ILLUM_TOP].val = 0;
380 sd->ctrls[ILLUM_BOT].val = 0;
381 setilluminators(gspca_dev);
385 gspca_dev->usb_buf[0] = 1;
386 gspca_dev->usb_buf[1] = 0;
390 static void sd_pkt_scan(struct gspca_dev *gspca_dev,
391 u8 *data, /* isoc packet */
392 int len) /* iso packet length */
394 struct sd *sd = (struct sd *) gspca_dev;
398 /* gspca_dev->last_packet_type = DISCARD_PACKET; */
401 for (p = 0; p < len - 6; p++) {
402 if (data[0 + p] == 0xff
403 && data[1 + p] == 0xff
404 && data[2 + p] == 0x00
405 && data[3 + p] == 0xff
406 && data[4 + p] == 0x96) {
407 if (data[5 + p] == 0x64
408 || data[5 + p] == 0x65
409 || data[5 + p] == 0x66
410 || data[5 + p] == 0x67) {
411 PDEBUG(D_PACK, "sof offset: %d len: %d",
413 gspca_frame_add(gspca_dev, LAST_PACKET,
416 /* put the JPEG header */
417 gspca_frame_add(gspca_dev, FIRST_PACKET,
418 sd->jpeg_hdr, JPEG_HDR_SZ);
425 gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
428 static int sd_setilluminator1(struct gspca_dev *gspca_dev, __s32 val)
430 struct sd *sd = (struct sd *) gspca_dev;
432 /* only one illuminator may be on */
433 sd->ctrls[ILLUM_TOP].val = val;
435 sd->ctrls[ILLUM_BOT].val = 0;
436 setilluminators(gspca_dev);
437 return gspca_dev->usb_err;
440 static int sd_setilluminator2(struct gspca_dev *gspca_dev, __s32 val)
442 struct sd *sd = (struct sd *) gspca_dev;
444 /* only one illuminator may be on */
445 sd->ctrls[ILLUM_BOT].val = val;
447 sd->ctrls[ILLUM_TOP].val = 0;
448 setilluminators(gspca_dev);
449 return gspca_dev->usb_err;
452 static int sd_set_jcomp(struct gspca_dev *gspca_dev,
453 struct v4l2_jpegcompression *jcomp)
455 struct sd *sd = (struct sd *) gspca_dev;
457 if (jcomp->quality < QUALITY_MIN)
458 sd->quality = QUALITY_MIN;
459 else if (jcomp->quality > QUALITY_MAX)
460 sd->quality = QUALITY_MAX;
462 sd->quality = jcomp->quality;
463 if (gspca_dev->streaming)
464 jpeg_set_qual(sd->jpeg_hdr, sd->quality);
468 static int sd_get_jcomp(struct gspca_dev *gspca_dev,
469 struct v4l2_jpegcompression *jcomp)
471 struct sd *sd = (struct sd *) gspca_dev;
473 memset(jcomp, 0, sizeof *jcomp);
474 jcomp->quality = sd->quality;
475 jcomp->jpeg_markers = V4L2_JPEG_MARKER_DHT
476 | V4L2_JPEG_MARKER_DQT;
480 /* sub-driver description */
481 static const struct sd_desc sd_desc = {
489 .pkt_scan = sd_pkt_scan,
490 .get_jcomp = sd_get_jcomp,
491 .set_jcomp = sd_set_jcomp,
494 /* -- module initialisation -- */
495 static const struct usb_device_id device_table[] = {
496 {USB_DEVICE(0x093a, 0x050f)},
499 MODULE_DEVICE_TABLE(usb, device_table);
501 /* -- device connect -- */
502 static int sd_probe(struct usb_interface *intf,
503 const struct usb_device_id *id)
505 return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
509 static struct usb_driver sd_driver = {
511 .id_table = device_table,
513 .disconnect = gspca_disconnect,
515 .suspend = gspca_suspend,
516 .resume = gspca_resume,
520 module_usb_driver(sd_driver);