1/* 2 * Mars-Semi MR97311A library 3 * Copyright (C) 2005 <bradlch@hotmail.com> 4 * 5 * V4L2 by Jean-Francois Moine <http://moinejf.free.fr> 6 * 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 10 * any later version. 11 * 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. 16 * 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 20 */ 21 22#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 23 24#define MODULE_NAME "mars" 25 26#include "gspca.h" 27#include "jpeg.h" 28 29MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>"); 30MODULE_DESCRIPTION("GSPCA/Mars USB Camera Driver"); 31MODULE_LICENSE("GPL"); 32 33/* controls */ 34enum e_ctrl { 35 BRIGHTNESS, 36 COLORS, 37 GAMMA, 38 SHARPNESS, 39 ILLUM_TOP, 40 ILLUM_BOT, 41 NCTRLS /* number of controls */ 42}; 43 44/* specific webcam descriptor */ 45struct sd { 46 struct gspca_dev gspca_dev; /* !! must be the first item */ 47 48 struct gspca_ctrl ctrls[NCTRLS]; 49 50 u8 quality; 51#define QUALITY_MIN 40 52#define QUALITY_MAX 70 53#define QUALITY_DEF 50 54 55 u8 jpeg_hdr[JPEG_HDR_SZ]; 56}; 57 58/* V4L2 controls supported by the driver */ 59static void setbrightness(struct gspca_dev *gspca_dev); 60static void setcolors(struct gspca_dev *gspca_dev); 61static void setgamma(struct gspca_dev *gspca_dev); 62static void setsharpness(struct gspca_dev *gspca_dev); 63static int sd_setilluminator1(struct gspca_dev *gspca_dev, __s32 val); 64static int sd_setilluminator2(struct gspca_dev *gspca_dev, __s32 val); 65 66static const struct ctrl sd_ctrls[NCTRLS] = { 67[BRIGHTNESS] = { 68 { 69 .id = V4L2_CID_BRIGHTNESS, 70 .type = V4L2_CTRL_TYPE_INTEGER, 71 .name = "Brightness", 72 .minimum = 0, 73 .maximum = 30, 74 .step = 1, 75 .default_value = 15, 76 }, 77 .set_control = setbrightness 78 }, 79[COLORS] = { 80 { 81 .id = V4L2_CID_SATURATION, 82 .type = V4L2_CTRL_TYPE_INTEGER, 83 .name = "Color", 84 .minimum = 1, 85 .maximum = 255, 86 .step = 1, 87 .default_value = 200, 88 }, 89 .set_control = setcolors 90 }, 91[GAMMA] = { 92 { 93 .id = V4L2_CID_GAMMA, 94 .type = V4L2_CTRL_TYPE_INTEGER, 95 .name = "Gamma", 96 .minimum = 0, 97 .maximum = 3, 98 .step = 1, 99 .default_value = 1, 100 }, 101 .set_control = setgamma 102 }, 103[SHARPNESS] = { 104 { 105 .id = V4L2_CID_SHARPNESS, 106 .type = V4L2_CTRL_TYPE_INTEGER, 107 .name = "Sharpness", 108 .minimum = 0, 109 .maximum = 2, 110 .step = 1, 111 .default_value = 1, 112 }, 113 .set_control = setsharpness 114 }, 115[ILLUM_TOP] = { 116 { 117 .id = V4L2_CID_ILLUMINATORS_1, 118 .type = V4L2_CTRL_TYPE_BOOLEAN, 119 .name = "Top illuminator", 120 .minimum = 0, 121 .maximum = 1, 122 .step = 1, 123 .default_value = 0, 124 .flags = V4L2_CTRL_FLAG_UPDATE, 125 }, 126 .set = sd_setilluminator1 127 }, 128[ILLUM_BOT] = { 129 { 130 .id = V4L2_CID_ILLUMINATORS_2, 131 .type = V4L2_CTRL_TYPE_BOOLEAN, 132 .name = "Bottom illuminator", 133 .minimum = 0, 134 .maximum = 1, 135 .step = 1, 136 .default_value = 0, 137 .flags = V4L2_CTRL_FLAG_UPDATE, 138 }, 139 .set = sd_setilluminator2 140 }, 141}; 142 143static const struct v4l2_pix_format vga_mode[] = { 144 {320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 145 .bytesperline = 320, 146 .sizeimage = 320 * 240 * 3 / 8 + 590, 147 .colorspace = V4L2_COLORSPACE_JPEG, 148 .priv = 2}, 149 {640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 150 .bytesperline = 640, 151 .sizeimage = 640 * 480 * 3 / 8 + 590, 152 .colorspace = V4L2_COLORSPACE_JPEG, 153 .priv = 1}, 154}; 155 156static 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 165}; 166 167/* write <len> bytes from gspca_dev->usb_buf */ 168static void reg_w(struct gspca_dev *gspca_dev, 169 int len) 170{ 171 int alen, ret; 172 173 if (gspca_dev->usb_err < 0) 174 return; 175 176 ret = usb_bulk_msg(gspca_dev->dev, 177 usb_sndbulkpipe(gspca_dev->dev, 4), 178 gspca_dev->usb_buf, 179 len, 180 &alen, 181 500); /* timeout in milliseconds */ 182 if (ret < 0) { 183 pr_err("reg write [%02x] error %d\n", 184 gspca_dev->usb_buf[0], ret); 185 gspca_dev->usb_err = ret; 186 } 187} 188 189static void mi_w(struct gspca_dev *gspca_dev, 190 u8 addr, 191 u8 value) 192{ 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; 197 198 reg_w(gspca_dev, 4); 199} 200 201static void setbrightness(struct gspca_dev *gspca_dev) 202{ 203 struct sd *sd = (struct sd *) gspca_dev; 204 205 gspca_dev->usb_buf[0] = 0x61; 206 gspca_dev->usb_buf[1] = sd->ctrls[BRIGHTNESS].val; 207 reg_w(gspca_dev, 2); 208} 209 210static void setcolors(struct gspca_dev *gspca_dev) 211{ 212 struct sd *sd = (struct sd *) gspca_dev; 213 s16 val; 214 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; 219 reg_w(gspca_dev, 3); 220} 221 222static void setgamma(struct gspca_dev *gspca_dev) 223{ 224 struct sd *sd = (struct sd *) gspca_dev; 225 226 gspca_dev->usb_buf[0] = 0x06; 227 gspca_dev->usb_buf[1] = sd->ctrls[GAMMA].val * 0x40; 228 reg_w(gspca_dev, 2); 229} 230 231static void setsharpness(struct gspca_dev *gspca_dev) 232{ 233 struct sd *sd = (struct sd *) gspca_dev; 234 235 gspca_dev->usb_buf[0] = 0x67; 236 gspca_dev->usb_buf[1] = sd->ctrls[SHARPNESS].val * 4 + 3; 237 reg_w(gspca_dev, 2); 238} 239 240static void setilluminators(struct gspca_dev *gspca_dev) 241{ 242 struct sd *sd = (struct sd *) gspca_dev; 243 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; 249 else 250 gspca_dev->usb_buf[1] = 0x7e; 251 reg_w(gspca_dev, 2); 252} 253 254/* this function is called at probe time */ 255static int sd_config(struct gspca_dev *gspca_dev, 256 const struct usb_device_id *id) 257{ 258 struct sd *sd = (struct sd *) gspca_dev; 259 struct cam *cam; 260 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 return 0; 267} 268 269/* this function is called at probe and resume time */ 270static int sd_init(struct gspca_dev *gspca_dev) 271{ 272 gspca_dev->ctrl_inac = (1 << ILLUM_TOP) | (1 << ILLUM_BOT); 273 return 0; 274} 275 276static int sd_start(struct gspca_dev *gspca_dev) 277{ 278 struct sd *sd = (struct sd *) gspca_dev; 279 u8 *data; 280 int i; 281 282 /* create the JPEG header */ 283 jpeg_define(sd->jpeg_hdr, gspca_dev->height, gspca_dev->width, 284 0x21); /* JPEG 422 */ 285 jpeg_set_qual(sd->jpeg_hdr, sd->quality); 286 287 data = gspca_dev->usb_buf; 288 289 data[0] = 0x01; /* address */ 290 data[1] = 0x01; 291 reg_w(gspca_dev, 2); 292 293 /* 294 Initialize the MR97113 chip register 295 */ 296 data[0] = 0x00; /* address */ 297 data[1] = 0x0c | 0x01; /* reg 0 */ 298 data[2] = 0x01; /* reg 1 */ 299 data[3] = gspca_dev->width / 8; /* h_size , reg 2 */ 300 data[4] = gspca_dev->height / 8; /* v_size , reg 3 */ 301 data[5] = 0x30; /* reg 4, MI, PAS5101 : 302 * 0x30 for 24mhz , 0x28 for 12mhz */ 303 data[6] = 0x02; /* reg 5, H start - was 0x04 */ 304 data[7] = sd->ctrls[GAMMA].val * 0x40; /* reg 0x06: gamma */ 305 data[8] = 0x01; /* reg 7, V start - was 0x03 */ 306/* if (h_size == 320 ) */ 307/* data[9]= 0x56; * reg 8, 24MHz, 2:1 scale down */ 308/* else */ 309 data[9] = 0x52; /* reg 8, 24MHz, no scale down */ 310/*jfm: from win trace*/ 311 data[10] = 0x18; 312 313 reg_w(gspca_dev, 11); 314 315 data[0] = 0x23; /* address */ 316 data[1] = 0x09; /* reg 35, append frame header */ 317 318 reg_w(gspca_dev, 2); 319 320 data[0] = 0x3c; /* address */ 321/* if (gspca_dev->width == 1280) */ 322/* data[1] = 200; * reg 60, pc-cam frame size 323 * (unit: 4KB) 800KB */ 324/* else */ 325 data[1] = 50; /* 50 reg 60, pc-cam frame size 326 * (unit: 4KB) 200KB */ 327 reg_w(gspca_dev, 2); 328 329 /* auto dark-gain */ 330 data[0] = 0x5e; /* address */ 331 data[1] = 0; /* reg 94, Y Gain (auto) */ 332/*jfm: from win trace*/ 333 /* reg 0x5f/0x60 (LE) = saturation */ 334 /* h (60): xxxx x100 335 * l (5f): xxxx x000 */ 336 data[2] = sd->ctrls[COLORS].val << 3; 337 data[3] = ((sd->ctrls[COLORS].val >> 2) & 0xf8) | 0x04; 338 data[4] = sd->ctrls[BRIGHTNESS].val; /* reg 0x61 = brightness */ 339 data[5] = 0x00; 340 341 reg_w(gspca_dev, 6); 342 343 data[0] = 0x67; 344/*jfm: from win trace*/ 345 data[1] = sd->ctrls[SHARPNESS].val * 4 + 3; 346 data[2] = 0x14; 347 reg_w(gspca_dev, 3); 348 349 data[0] = 0x69; 350 data[1] = 0x2f; 351 data[2] = 0x28; 352 data[3] = 0x42; 353 reg_w(gspca_dev, 4); 354 355 data[0] = 0x63; 356 data[1] = 0x07; 357 reg_w(gspca_dev, 2); 358/*jfm: win trace - many writes here to reg 0x64*/ 359 360 /* initialize the MI sensor */ 361 for (i = 0; i < sizeof mi_data; i++) 362 mi_w(gspca_dev, i + 1, mi_data[i]); 363 364 data[0] = 0x00; 365 data[1] = 0x4d; /* ISOC transferring enable... */ 366 reg_w(gspca_dev, 2); 367 368 gspca_dev->ctrl_inac = 0; /* activate the illuminator controls */ 369 return gspca_dev->usb_err; 370} 371 372static void sd_stopN(struct gspca_dev *gspca_dev) 373{ 374 struct sd *sd = (struct sd *) gspca_dev; 375 376 gspca_dev->ctrl_inac = (1 << ILLUM_TOP) | (1 << ILLUM_BOT); 377 if (sd->ctrls[ILLUM_TOP].val || sd->ctrls[ILLUM_BOT].val) { 378 sd->ctrls[ILLUM_TOP].val = 0; 379 sd->ctrls[ILLUM_BOT].val = 0; 380 setilluminators(gspca_dev); 381 msleep(20); 382 } 383 384 gspca_dev->usb_buf[0] = 1; 385 gspca_dev->usb_buf[1] = 0; 386 reg_w(gspca_dev, 2); 387} 388 389static void sd_pkt_scan(struct gspca_dev *gspca_dev, 390 u8 *data, /* isoc packet */ 391 int len) /* iso packet length */ 392{ 393 struct sd *sd = (struct sd *) gspca_dev; 394 int p; 395 396 if (len < 6) { 397/* gspca_dev->last_packet_type = DISCARD_PACKET; */ 398 return; 399 } 400 for (p = 0; p < len - 6; p++) { 401 if (data[0 + p] == 0xff 402 && data[1 + p] == 0xff 403 && data[2 + p] == 0x00 404 && data[3 + p] == 0xff 405 && data[4 + p] == 0x96) { 406 if (data[5 + p] == 0x64 407 || data[5 + p] == 0x65 408 || data[5 + p] == 0x66 409 || data[5 + p] == 0x67) { 410 PDEBUG(D_PACK, "sof offset: %d len: %d", 411 p, len); 412 gspca_frame_add(gspca_dev, LAST_PACKET, 413 data, p); 414 415 /* put the JPEG header */ 416 gspca_frame_add(gspca_dev, FIRST_PACKET, 417 sd->jpeg_hdr, JPEG_HDR_SZ); 418 data += p + 16; 419 len -= p + 16; 420 break; 421 } 422 } 423 } 424 gspca_frame_add(gspca_dev, INTER_PACKET, data, len); 425} 426 427static int sd_setilluminator1(struct gspca_dev *gspca_dev, __s32 val) 428{ 429 struct sd *sd = (struct sd *) gspca_dev; 430 431 /* only one illuminator may be on */ 432 sd->ctrls[ILLUM_TOP].val = val; 433 if (val) 434 sd->ctrls[ILLUM_BOT].val = 0; 435 setilluminators(gspca_dev); 436 return gspca_dev->usb_err; 437} 438 439static int sd_setilluminator2(struct gspca_dev *gspca_dev, __s32 val) 440{ 441 struct sd *sd = (struct sd *) gspca_dev; 442 443 /* only one illuminator may be on */ 444 sd->ctrls[ILLUM_BOT].val = val; 445 if (val) 446 sd->ctrls[ILLUM_TOP].val = 0; 447 setilluminators(gspca_dev); 448 return gspca_dev->usb_err; 449} 450 451static int sd_set_jcomp(struct gspca_dev *gspca_dev, 452 struct v4l2_jpegcompression *jcomp) 453{ 454 struct sd *sd = (struct sd *) gspca_dev; 455 456 if (jcomp->quality < QUALITY_MIN) 457 sd->quality = QUALITY_MIN; 458 else if (jcomp->quality > QUALITY_MAX) 459 sd->quality = QUALITY_MAX; 460 else 461 sd->quality = jcomp->quality; 462 if (gspca_dev->streaming) 463 jpeg_set_qual(sd->jpeg_hdr, sd->quality); 464 return 0; 465} 466 467static int sd_get_jcomp(struct gspca_dev *gspca_dev, 468 struct v4l2_jpegcompression *jcomp) 469{ 470 struct sd *sd = (struct sd *) gspca_dev; 471 472 memset(jcomp, 0, sizeof *jcomp); 473 jcomp->quality = sd->quality; 474 jcomp->jpeg_markers = V4L2_JPEG_MARKER_DHT 475 | V4L2_JPEG_MARKER_DQT; 476 return 0; 477} 478 479/* sub-driver description */ 480static const struct sd_desc sd_desc = { 481 .name = MODULE_NAME, 482 .ctrls = sd_ctrls, 483 .nctrls = NCTRLS, 484 .config = sd_config, 485 .init = sd_init, 486 .start = sd_start, 487 .stopN = sd_stopN, 488 .pkt_scan = sd_pkt_scan, 489 .get_jcomp = sd_get_jcomp, 490 .set_jcomp = sd_set_jcomp, 491}; 492 493/* -- module initialisation -- */ 494static const struct usb_device_id device_table[] = { 495 {USB_DEVICE(0x093a, 0x050f)}, 496 {} 497}; 498MODULE_DEVICE_TABLE(usb, device_table); 499 500/* -- device connect -- */ 501static int sd_probe(struct usb_interface *intf, 502 const struct usb_device_id *id) 503{ 504 return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd), 505 THIS_MODULE); 506} 507 508static struct usb_driver sd_driver = { 509 .name = MODULE_NAME, 510 .id_table = device_table, 511 .probe = sd_probe, 512 .disconnect = gspca_disconnect, 513#ifdef CONFIG_PM 514 .suspend = gspca_suspend, 515 .resume = gspca_resume, 516#endif 517}; 518 519module_usb_driver(sd_driver); 520