1 /* 2 * Sunplus spca504(abc) spca533 spca536 library 3 * Copyright (C) 2005 Michel Xhaard mxhaard@magic.fr 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 18 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 19 20 #define MODULE_NAME "sunplus" 21 22 #include "gspca.h" 23 #include "jpeg.h" 24 25 MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>"); 26 MODULE_DESCRIPTION("GSPCA/SPCA5xx USB Camera Driver"); 27 MODULE_LICENSE("GPL"); 28 29 #define QUALITY 85 30 31 /* specific webcam descriptor */ 32 struct sd { 33 struct gspca_dev gspca_dev; /* !! must be the first item */ 34 35 bool autogain; 36 37 u8 bridge; 38 #define BRIDGE_SPCA504 0 39 #define BRIDGE_SPCA504B 1 40 #define BRIDGE_SPCA504C 2 41 #define BRIDGE_SPCA533 3 42 #define BRIDGE_SPCA536 4 43 u8 subtype; 44 #define AiptekMiniPenCam13 1 45 #define LogitechClickSmart420 2 46 #define LogitechClickSmart820 3 47 #define MegapixV4 4 48 #define MegaImageVI 5 49 50 u8 jpeg_hdr[JPEG_HDR_SZ]; 51 }; 52 53 static const struct v4l2_pix_format vga_mode[] = { 54 {320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 55 .bytesperline = 320, 56 .sizeimage = 320 * 240 * 3 / 8 + 590, 57 .colorspace = V4L2_COLORSPACE_JPEG, 58 .priv = 2}, 59 {640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 60 .bytesperline = 640, 61 .sizeimage = 640 * 480 * 3 / 8 + 590, 62 .colorspace = V4L2_COLORSPACE_JPEG, 63 .priv = 1}, 64 }; 65 66 static const struct v4l2_pix_format custom_mode[] = { 67 {320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 68 .bytesperline = 320, 69 .sizeimage = 320 * 240 * 3 / 8 + 590, 70 .colorspace = V4L2_COLORSPACE_JPEG, 71 .priv = 2}, 72 {464, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 73 .bytesperline = 464, 74 .sizeimage = 464 * 480 * 3 / 8 + 590, 75 .colorspace = V4L2_COLORSPACE_JPEG, 76 .priv = 1}, 77 }; 78 79 static const struct v4l2_pix_format vga_mode2[] = { 80 {176, 144, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 81 .bytesperline = 176, 82 .sizeimage = 176 * 144 * 3 / 8 + 590, 83 .colorspace = V4L2_COLORSPACE_JPEG, 84 .priv = 4}, 85 {320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 86 .bytesperline = 320, 87 .sizeimage = 320 * 240 * 3 / 8 + 590, 88 .colorspace = V4L2_COLORSPACE_JPEG, 89 .priv = 3}, 90 {352, 288, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 91 .bytesperline = 352, 92 .sizeimage = 352 * 288 * 3 / 8 + 590, 93 .colorspace = V4L2_COLORSPACE_JPEG, 94 .priv = 2}, 95 {640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 96 .bytesperline = 640, 97 .sizeimage = 640 * 480 * 3 / 8 + 590, 98 .colorspace = V4L2_COLORSPACE_JPEG, 99 .priv = 1}, 100 }; 101 102 #define SPCA50X_OFFSET_DATA 10 103 #define SPCA504_PCCAM600_OFFSET_SNAPSHOT 3 104 #define SPCA504_PCCAM600_OFFSET_COMPRESS 4 105 #define SPCA504_PCCAM600_OFFSET_MODE 5 106 #define SPCA504_PCCAM600_OFFSET_DATA 14 107 /* Frame packet header offsets for the spca533 */ 108 #define SPCA533_OFFSET_DATA 16 109 #define SPCA533_OFFSET_FRAMSEQ 15 110 /* Frame packet header offsets for the spca536 */ 111 #define SPCA536_OFFSET_DATA 4 112 #define SPCA536_OFFSET_FRAMSEQ 1 113 114 struct cmd { 115 u8 req; 116 u16 val; 117 u16 idx; 118 }; 119 120 /* Initialisation data for the Creative PC-CAM 600 */ 121 static const struct cmd spca504_pccam600_init_data[] = { 122 /* {0xa0, 0x0000, 0x0503}, * capture mode */ 123 {0x00, 0x0000, 0x2000}, 124 {0x00, 0x0013, 0x2301}, 125 {0x00, 0x0003, 0x2000}, 126 {0x00, 0x0001, 0x21ac}, 127 {0x00, 0x0001, 0x21a6}, 128 {0x00, 0x0000, 0x21a7}, /* brightness */ 129 {0x00, 0x0020, 0x21a8}, /* contrast */ 130 {0x00, 0x0001, 0x21ac}, /* sat/hue */ 131 {0x00, 0x0000, 0x21ad}, /* hue */ 132 {0x00, 0x001a, 0x21ae}, /* saturation */ 133 {0x00, 0x0002, 0x21a3}, /* gamma */ 134 {0x30, 0x0154, 0x0008}, 135 {0x30, 0x0004, 0x0006}, 136 {0x30, 0x0258, 0x0009}, 137 {0x30, 0x0004, 0x0000}, 138 {0x30, 0x0093, 0x0004}, 139 {0x30, 0x0066, 0x0005}, 140 {0x00, 0x0000, 0x2000}, 141 {0x00, 0x0013, 0x2301}, 142 {0x00, 0x0003, 0x2000}, 143 {0x00, 0x0013, 0x2301}, 144 {0x00, 0x0003, 0x2000}, 145 }; 146 147 /* Creative PC-CAM 600 specific open data, sent before using the 148 * generic initialisation data from spca504_open_data. 149 */ 150 static const struct cmd spca504_pccam600_open_data[] = { 151 {0x00, 0x0001, 0x2501}, 152 {0x20, 0x0500, 0x0001}, /* snapshot mode */ 153 {0x00, 0x0003, 0x2880}, 154 {0x00, 0x0001, 0x2881}, 155 }; 156 157 /* Initialisation data for the logitech clicksmart 420 */ 158 static const struct cmd spca504A_clicksmart420_init_data[] = { 159 /* {0xa0, 0x0000, 0x0503}, * capture mode */ 160 {0x00, 0x0000, 0x2000}, 161 {0x00, 0x0013, 0x2301}, 162 {0x00, 0x0003, 0x2000}, 163 {0x00, 0x0001, 0x21ac}, 164 {0x00, 0x0001, 0x21a6}, 165 {0x00, 0x0000, 0x21a7}, /* brightness */ 166 {0x00, 0x0020, 0x21a8}, /* contrast */ 167 {0x00, 0x0001, 0x21ac}, /* sat/hue */ 168 {0x00, 0x0000, 0x21ad}, /* hue */ 169 {0x00, 0x001a, 0x21ae}, /* saturation */ 170 {0x00, 0x0002, 0x21a3}, /* gamma */ 171 {0x30, 0x0004, 0x000a}, 172 {0xb0, 0x0001, 0x0000}, 173 174 {0xa1, 0x0080, 0x0001}, 175 {0x30, 0x0049, 0x0000}, 176 {0x30, 0x0060, 0x0005}, 177 {0x0c, 0x0004, 0x0000}, 178 {0x00, 0x0000, 0x0000}, 179 {0x00, 0x0000, 0x2000}, 180 {0x00, 0x0013, 0x2301}, 181 {0x00, 0x0003, 0x2000}, 182 }; 183 184 /* clicksmart 420 open data ? */ 185 static const struct cmd spca504A_clicksmart420_open_data[] = { 186 {0x00, 0x0001, 0x2501}, 187 {0x20, 0x0502, 0x0000}, 188 {0x06, 0x0000, 0x0000}, 189 {0x00, 0x0004, 0x2880}, 190 {0x00, 0x0001, 0x2881}, 191 192 {0xa0, 0x0000, 0x0503}, 193 }; 194 195 static const u8 qtable_creative_pccam[2][64] = { 196 { /* Q-table Y-components */ 197 0x05, 0x03, 0x03, 0x05, 0x07, 0x0c, 0x0f, 0x12, 198 0x04, 0x04, 0x04, 0x06, 0x08, 0x11, 0x12, 0x11, 199 0x04, 0x04, 0x05, 0x07, 0x0c, 0x11, 0x15, 0x11, 200 0x04, 0x05, 0x07, 0x09, 0x0f, 0x1a, 0x18, 0x13, 201 0x05, 0x07, 0x0b, 0x11, 0x14, 0x21, 0x1f, 0x17, 202 0x07, 0x0b, 0x11, 0x13, 0x18, 0x1f, 0x22, 0x1c, 203 0x0f, 0x13, 0x17, 0x1a, 0x1f, 0x24, 0x24, 0x1e, 204 0x16, 0x1c, 0x1d, 0x1d, 0x22, 0x1e, 0x1f, 0x1e}, 205 { /* Q-table C-components */ 206 0x05, 0x05, 0x07, 0x0e, 0x1e, 0x1e, 0x1e, 0x1e, 207 0x05, 0x06, 0x08, 0x14, 0x1e, 0x1e, 0x1e, 0x1e, 208 0x07, 0x08, 0x11, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 209 0x0e, 0x14, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 210 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 211 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 212 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 213 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e} 214 }; 215 216 /* FIXME: This Q-table is identical to the Creative PC-CAM one, 217 * except for one byte. Possibly a typo? 218 * NWG: 18/05/2003. 219 */ 220 static const u8 qtable_spca504_default[2][64] = { 221 { /* Q-table Y-components */ 222 0x05, 0x03, 0x03, 0x05, 0x07, 0x0c, 0x0f, 0x12, 223 0x04, 0x04, 0x04, 0x06, 0x08, 0x11, 0x12, 0x11, 224 0x04, 0x04, 0x05, 0x07, 0x0c, 0x11, 0x15, 0x11, 225 0x04, 0x05, 0x07, 0x09, 0x0f, 0x1a, 0x18, 0x13, 226 0x05, 0x07, 0x0b, 0x11, 0x14, 0x21, 0x1f, 0x17, 227 0x07, 0x0b, 0x11, 0x13, 0x18, 0x1f, 0x22, 0x1c, 228 0x0f, 0x13, 0x17, 0x1a, 0x1f, 0x24, 0x24, 0x1e, 229 0x16, 0x1c, 0x1d, 0x1d, 0x1d /* 0x22 */ , 0x1e, 0x1f, 0x1e, 230 }, 231 { /* Q-table C-components */ 232 0x05, 0x05, 0x07, 0x0e, 0x1e, 0x1e, 0x1e, 0x1e, 233 0x05, 0x06, 0x08, 0x14, 0x1e, 0x1e, 0x1e, 0x1e, 234 0x07, 0x08, 0x11, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 235 0x0e, 0x14, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 236 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 237 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 238 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 239 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e} 240 }; 241 242 /* read <len> bytes to gspca_dev->usb_buf */ 243 static void reg_r(struct gspca_dev *gspca_dev, 244 u8 req, 245 u16 index, 246 u16 len) 247 { 248 int ret; 249 250 if (len > USB_BUF_SZ) { 251 gspca_err(gspca_dev, "reg_r: buffer overflow\n"); 252 return; 253 } 254 if (gspca_dev->usb_err < 0) 255 return; 256 ret = usb_control_msg(gspca_dev->dev, 257 usb_rcvctrlpipe(gspca_dev->dev, 0), 258 req, 259 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 260 0, /* value */ 261 index, 262 len ? gspca_dev->usb_buf : NULL, len, 263 500); 264 if (ret < 0) { 265 pr_err("reg_r err %d\n", ret); 266 gspca_dev->usb_err = ret; 267 } 268 } 269 270 /* write one byte */ 271 static void reg_w_1(struct gspca_dev *gspca_dev, 272 u8 req, 273 u16 value, 274 u16 index, 275 u16 byte) 276 { 277 int ret; 278 279 if (gspca_dev->usb_err < 0) 280 return; 281 gspca_dev->usb_buf[0] = byte; 282 ret = usb_control_msg(gspca_dev->dev, 283 usb_sndctrlpipe(gspca_dev->dev, 0), 284 req, 285 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 286 value, index, 287 gspca_dev->usb_buf, 1, 288 500); 289 if (ret < 0) { 290 pr_err("reg_w_1 err %d\n", ret); 291 gspca_dev->usb_err = ret; 292 } 293 } 294 295 /* write req / index / value */ 296 static void reg_w_riv(struct gspca_dev *gspca_dev, 297 u8 req, u16 index, u16 value) 298 { 299 struct usb_device *dev = gspca_dev->dev; 300 int ret; 301 302 if (gspca_dev->usb_err < 0) 303 return; 304 ret = usb_control_msg(dev, 305 usb_sndctrlpipe(dev, 0), 306 req, 307 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 308 value, index, NULL, 0, 500); 309 if (ret < 0) { 310 pr_err("reg_w_riv err %d\n", ret); 311 gspca_dev->usb_err = ret; 312 return; 313 } 314 gspca_dbg(gspca_dev, D_USBO, "reg_w_riv: 0x%02x,0x%04x:0x%04x\n", 315 req, index, value); 316 } 317 318 static void write_vector(struct gspca_dev *gspca_dev, 319 const struct cmd *data, int ncmds) 320 { 321 while (--ncmds >= 0) { 322 reg_w_riv(gspca_dev, data->req, data->idx, data->val); 323 data++; 324 } 325 } 326 327 static void setup_qtable(struct gspca_dev *gspca_dev, 328 const u8 qtable[2][64]) 329 { 330 int i; 331 332 /* loop over y components */ 333 for (i = 0; i < 64; i++) 334 reg_w_riv(gspca_dev, 0x00, 0x2800 + i, qtable[0][i]); 335 336 /* loop over c components */ 337 for (i = 0; i < 64; i++) 338 reg_w_riv(gspca_dev, 0x00, 0x2840 + i, qtable[1][i]); 339 } 340 341 static void spca504_acknowledged_command(struct gspca_dev *gspca_dev, 342 u8 req, u16 idx, u16 val) 343 { 344 reg_w_riv(gspca_dev, req, idx, val); 345 reg_r(gspca_dev, 0x01, 0x0001, 1); 346 gspca_dbg(gspca_dev, D_FRAM, "before wait 0x%04x\n", 347 gspca_dev->usb_buf[0]); 348 reg_w_riv(gspca_dev, req, idx, val); 349 350 msleep(200); 351 reg_r(gspca_dev, 0x01, 0x0001, 1); 352 gspca_dbg(gspca_dev, D_FRAM, "after wait 0x%04x\n", 353 gspca_dev->usb_buf[0]); 354 } 355 356 static void spca504_read_info(struct gspca_dev *gspca_dev) 357 { 358 int i; 359 u8 info[6]; 360 361 if (gspca_debug < D_STREAM) 362 return; 363 364 for (i = 0; i < 6; i++) { 365 reg_r(gspca_dev, 0, i, 1); 366 info[i] = gspca_dev->usb_buf[0]; 367 } 368 gspca_dbg(gspca_dev, D_STREAM, 369 "Read info: %d %d %d %d %d %d. Should be 1,0,2,2,0,0\n", 370 info[0], info[1], info[2], 371 info[3], info[4], info[5]); 372 } 373 374 static void spca504A_acknowledged_command(struct gspca_dev *gspca_dev, 375 u8 req, 376 u16 idx, u16 val, u8 endcode, u8 count) 377 { 378 u16 status; 379 380 reg_w_riv(gspca_dev, req, idx, val); 381 reg_r(gspca_dev, 0x01, 0x0001, 1); 382 if (gspca_dev->usb_err < 0) 383 return; 384 gspca_dbg(gspca_dev, D_FRAM, "Status 0x%02x Need 0x%02x\n", 385 gspca_dev->usb_buf[0], endcode); 386 if (!count) 387 return; 388 count = 200; 389 while (--count > 0) { 390 msleep(10); 391 /* gsmart mini2 write a each wait setting 1 ms is enough */ 392 /* reg_w_riv(gspca_dev, req, idx, val); */ 393 reg_r(gspca_dev, 0x01, 0x0001, 1); 394 status = gspca_dev->usb_buf[0]; 395 if (status == endcode) { 396 gspca_dbg(gspca_dev, D_FRAM, "status 0x%04x after wait %d\n", 397 status, 200 - count); 398 break; 399 } 400 } 401 } 402 403 static void spca504B_PollingDataReady(struct gspca_dev *gspca_dev) 404 { 405 int count = 10; 406 407 while (--count > 0) { 408 reg_r(gspca_dev, 0x21, 0, 1); 409 if ((gspca_dev->usb_buf[0] & 0x01) == 0) 410 break; 411 msleep(10); 412 } 413 } 414 415 static void spca504B_WaitCmdStatus(struct gspca_dev *gspca_dev) 416 { 417 int count = 50; 418 419 while (--count > 0) { 420 reg_r(gspca_dev, 0x21, 1, 1); 421 if (gspca_dev->usb_buf[0] != 0) { 422 reg_w_1(gspca_dev, 0x21, 0, 1, 0); 423 reg_r(gspca_dev, 0x21, 1, 1); 424 spca504B_PollingDataReady(gspca_dev); 425 break; 426 } 427 msleep(10); 428 } 429 } 430 431 static void spca50x_GetFirmware(struct gspca_dev *gspca_dev) 432 { 433 u8 *data; 434 435 if (gspca_debug < D_STREAM) 436 return; 437 438 data = gspca_dev->usb_buf; 439 reg_r(gspca_dev, 0x20, 0, 5); 440 gspca_dbg(gspca_dev, D_STREAM, "FirmWare: %d %d %d %d %d\n", 441 data[0], data[1], data[2], data[3], data[4]); 442 reg_r(gspca_dev, 0x23, 0, 64); 443 reg_r(gspca_dev, 0x23, 1, 64); 444 } 445 446 static void spca504B_SetSizeType(struct gspca_dev *gspca_dev) 447 { 448 struct sd *sd = (struct sd *) gspca_dev; 449 u8 Size; 450 451 Size = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv; 452 switch (sd->bridge) { 453 case BRIDGE_SPCA533: 454 reg_w_riv(gspca_dev, 0x31, 0, 0); 455 spca504B_WaitCmdStatus(gspca_dev); 456 spca504B_PollingDataReady(gspca_dev); 457 spca50x_GetFirmware(gspca_dev); 458 459 reg_w_1(gspca_dev, 0x24, 0, 8, 2); /* type */ 460 reg_r(gspca_dev, 0x24, 8, 1); 461 462 reg_w_1(gspca_dev, 0x25, 0, 4, Size); 463 reg_r(gspca_dev, 0x25, 4, 1); /* size */ 464 spca504B_PollingDataReady(gspca_dev); 465 466 /* Init the cam width height with some values get on init ? */ 467 reg_w_riv(gspca_dev, 0x31, 0x0004, 0x00); 468 spca504B_WaitCmdStatus(gspca_dev); 469 spca504B_PollingDataReady(gspca_dev); 470 break; 471 default: 472 /* case BRIDGE_SPCA504B: */ 473 /* case BRIDGE_SPCA536: */ 474 reg_w_1(gspca_dev, 0x25, 0, 4, Size); 475 reg_r(gspca_dev, 0x25, 4, 1); /* size */ 476 reg_w_1(gspca_dev, 0x27, 0, 0, 6); 477 reg_r(gspca_dev, 0x27, 0, 1); /* type */ 478 spca504B_PollingDataReady(gspca_dev); 479 break; 480 case BRIDGE_SPCA504: 481 Size += 3; 482 if (sd->subtype == AiptekMiniPenCam13) { 483 /* spca504a aiptek */ 484 spca504A_acknowledged_command(gspca_dev, 485 0x08, Size, 0, 486 0x80 | (Size & 0x0f), 1); 487 spca504A_acknowledged_command(gspca_dev, 488 1, 3, 0, 0x9f, 0); 489 } else { 490 spca504_acknowledged_command(gspca_dev, 0x08, Size, 0); 491 } 492 break; 493 case BRIDGE_SPCA504C: 494 /* capture mode */ 495 reg_w_riv(gspca_dev, 0xa0, (0x0500 | (Size & 0x0f)), 0x00); 496 reg_w_riv(gspca_dev, 0x20, 0x01, 0x0500 | (Size & 0x0f)); 497 break; 498 } 499 } 500 501 static void spca504_wait_status(struct gspca_dev *gspca_dev) 502 { 503 int cnt; 504 505 cnt = 256; 506 while (--cnt > 0) { 507 /* With this we get the status, when return 0 it's all ok */ 508 reg_r(gspca_dev, 0x06, 0x00, 1); 509 if (gspca_dev->usb_buf[0] == 0) 510 return; 511 msleep(10); 512 } 513 } 514 515 static void spca504B_setQtable(struct gspca_dev *gspca_dev) 516 { 517 reg_w_1(gspca_dev, 0x26, 0, 0, 3); 518 reg_r(gspca_dev, 0x26, 0, 1); 519 spca504B_PollingDataReady(gspca_dev); 520 } 521 522 static void setbrightness(struct gspca_dev *gspca_dev, s32 val) 523 { 524 struct sd *sd = (struct sd *) gspca_dev; 525 u16 reg; 526 527 reg = sd->bridge == BRIDGE_SPCA536 ? 0x20f0 : 0x21a7; 528 reg_w_riv(gspca_dev, 0x00, reg, val); 529 } 530 531 static void setcontrast(struct gspca_dev *gspca_dev, s32 val) 532 { 533 struct sd *sd = (struct sd *) gspca_dev; 534 u16 reg; 535 536 reg = sd->bridge == BRIDGE_SPCA536 ? 0x20f1 : 0x21a8; 537 reg_w_riv(gspca_dev, 0x00, reg, val); 538 } 539 540 static void setcolors(struct gspca_dev *gspca_dev, s32 val) 541 { 542 struct sd *sd = (struct sd *) gspca_dev; 543 u16 reg; 544 545 reg = sd->bridge == BRIDGE_SPCA536 ? 0x20f6 : 0x21ae; 546 reg_w_riv(gspca_dev, 0x00, reg, val); 547 } 548 549 static void init_ctl_reg(struct gspca_dev *gspca_dev) 550 { 551 struct sd *sd = (struct sd *) gspca_dev; 552 int pollreg = 1; 553 554 switch (sd->bridge) { 555 case BRIDGE_SPCA504: 556 case BRIDGE_SPCA504C: 557 pollreg = 0; 558 /* fall thru */ 559 default: 560 /* case BRIDGE_SPCA533: */ 561 /* case BRIDGE_SPCA504B: */ 562 reg_w_riv(gspca_dev, 0, 0x21ad, 0x00); /* hue */ 563 reg_w_riv(gspca_dev, 0, 0x21ac, 0x01); /* sat/hue */ 564 reg_w_riv(gspca_dev, 0, 0x21a3, 0x00); /* gamma */ 565 break; 566 case BRIDGE_SPCA536: 567 reg_w_riv(gspca_dev, 0, 0x20f5, 0x40); 568 reg_w_riv(gspca_dev, 0, 0x20f4, 0x01); 569 reg_w_riv(gspca_dev, 0, 0x2089, 0x00); 570 break; 571 } 572 if (pollreg) 573 spca504B_PollingDataReady(gspca_dev); 574 } 575 576 /* this function is called at probe time */ 577 static int sd_config(struct gspca_dev *gspca_dev, 578 const struct usb_device_id *id) 579 { 580 struct sd *sd = (struct sd *) gspca_dev; 581 struct cam *cam; 582 583 cam = &gspca_dev->cam; 584 585 sd->bridge = id->driver_info >> 8; 586 sd->subtype = id->driver_info; 587 588 if (sd->subtype == AiptekMiniPenCam13) { 589 590 /* try to get the firmware as some cam answer 2.0.1.2.2 591 * and should be a spca504b then overwrite that setting */ 592 reg_r(gspca_dev, 0x20, 0, 1); 593 switch (gspca_dev->usb_buf[0]) { 594 case 1: 595 break; /* (right bridge/subtype) */ 596 case 2: 597 sd->bridge = BRIDGE_SPCA504B; 598 sd->subtype = 0; 599 break; 600 default: 601 return -ENODEV; 602 } 603 } 604 605 switch (sd->bridge) { 606 default: 607 /* case BRIDGE_SPCA504B: */ 608 /* case BRIDGE_SPCA504: */ 609 /* case BRIDGE_SPCA536: */ 610 cam->cam_mode = vga_mode; 611 cam->nmodes = ARRAY_SIZE(vga_mode); 612 break; 613 case BRIDGE_SPCA533: 614 cam->cam_mode = custom_mode; 615 if (sd->subtype == MegaImageVI) /* 320x240 only */ 616 cam->nmodes = ARRAY_SIZE(custom_mode) - 1; 617 else 618 cam->nmodes = ARRAY_SIZE(custom_mode); 619 break; 620 case BRIDGE_SPCA504C: 621 cam->cam_mode = vga_mode2; 622 cam->nmodes = ARRAY_SIZE(vga_mode2); 623 break; 624 } 625 return 0; 626 } 627 628 /* this function is called at probe and resume time */ 629 static int sd_init(struct gspca_dev *gspca_dev) 630 { 631 struct sd *sd = (struct sd *) gspca_dev; 632 633 switch (sd->bridge) { 634 case BRIDGE_SPCA504B: 635 reg_w_riv(gspca_dev, 0x1d, 0x00, 0); 636 reg_w_riv(gspca_dev, 0x00, 0x2306, 0x01); 637 reg_w_riv(gspca_dev, 0x00, 0x0d04, 0x00); 638 reg_w_riv(gspca_dev, 0x00, 0x2000, 0x00); 639 reg_w_riv(gspca_dev, 0x00, 0x2301, 0x13); 640 reg_w_riv(gspca_dev, 0x00, 0x2306, 0x00); 641 /* fall thru */ 642 case BRIDGE_SPCA533: 643 spca504B_PollingDataReady(gspca_dev); 644 spca50x_GetFirmware(gspca_dev); 645 break; 646 case BRIDGE_SPCA536: 647 spca50x_GetFirmware(gspca_dev); 648 reg_r(gspca_dev, 0x00, 0x5002, 1); 649 reg_w_1(gspca_dev, 0x24, 0, 0, 0); 650 reg_r(gspca_dev, 0x24, 0, 1); 651 spca504B_PollingDataReady(gspca_dev); 652 reg_w_riv(gspca_dev, 0x34, 0, 0); 653 spca504B_WaitCmdStatus(gspca_dev); 654 break; 655 case BRIDGE_SPCA504C: /* pccam600 */ 656 gspca_dbg(gspca_dev, D_STREAM, "Opening SPCA504 (PC-CAM 600)\n"); 657 reg_w_riv(gspca_dev, 0xe0, 0x0000, 0x0000); 658 reg_w_riv(gspca_dev, 0xe0, 0x0000, 0x0001); /* reset */ 659 spca504_wait_status(gspca_dev); 660 if (sd->subtype == LogitechClickSmart420) 661 write_vector(gspca_dev, 662 spca504A_clicksmart420_open_data, 663 ARRAY_SIZE(spca504A_clicksmart420_open_data)); 664 else 665 write_vector(gspca_dev, spca504_pccam600_open_data, 666 ARRAY_SIZE(spca504_pccam600_open_data)); 667 setup_qtable(gspca_dev, qtable_creative_pccam); 668 break; 669 default: 670 /* case BRIDGE_SPCA504: */ 671 gspca_dbg(gspca_dev, D_STREAM, "Opening SPCA504\n"); 672 if (sd->subtype == AiptekMiniPenCam13) { 673 spca504_read_info(gspca_dev); 674 675 /* Set AE AWB Banding Type 3-> 50Hz 2-> 60Hz */ 676 spca504A_acknowledged_command(gspca_dev, 0x24, 677 8, 3, 0x9e, 1); 678 /* Twice sequential need status 0xff->0x9e->0x9d */ 679 spca504A_acknowledged_command(gspca_dev, 0x24, 680 8, 3, 0x9e, 0); 681 682 spca504A_acknowledged_command(gspca_dev, 0x24, 683 0, 0, 0x9d, 1); 684 /******************************/ 685 /* spca504a aiptek */ 686 spca504A_acknowledged_command(gspca_dev, 0x08, 687 6, 0, 0x86, 1); 688 /* reg_write (dev, 0, 0x2000, 0); */ 689 /* reg_write (dev, 0, 0x2883, 1); */ 690 /* spca504A_acknowledged_command (gspca_dev, 0x08, 691 6, 0, 0x86, 1); */ 692 /* spca504A_acknowledged_command (gspca_dev, 0x24, 693 0, 0, 0x9D, 1); */ 694 reg_w_riv(gspca_dev, 0x00, 0x270c, 0x05); 695 /* L92 sno1t.txt */ 696 reg_w_riv(gspca_dev, 0x00, 0x2310, 0x05); 697 spca504A_acknowledged_command(gspca_dev, 0x01, 698 0x0f, 0, 0xff, 0); 699 } 700 /* setup qtable */ 701 reg_w_riv(gspca_dev, 0, 0x2000, 0); 702 reg_w_riv(gspca_dev, 0, 0x2883, 1); 703 setup_qtable(gspca_dev, qtable_spca504_default); 704 break; 705 } 706 return gspca_dev->usb_err; 707 } 708 709 static int sd_start(struct gspca_dev *gspca_dev) 710 { 711 struct sd *sd = (struct sd *) gspca_dev; 712 int enable; 713 714 /* create the JPEG header */ 715 jpeg_define(sd->jpeg_hdr, gspca_dev->pixfmt.height, 716 gspca_dev->pixfmt.width, 717 0x22); /* JPEG 411 */ 718 jpeg_set_qual(sd->jpeg_hdr, QUALITY); 719 720 if (sd->bridge == BRIDGE_SPCA504B) 721 spca504B_setQtable(gspca_dev); 722 spca504B_SetSizeType(gspca_dev); 723 switch (sd->bridge) { 724 default: 725 /* case BRIDGE_SPCA504B: */ 726 /* case BRIDGE_SPCA533: */ 727 /* case BRIDGE_SPCA536: */ 728 switch (sd->subtype) { 729 case MegapixV4: 730 case LogitechClickSmart820: 731 case MegaImageVI: 732 reg_w_riv(gspca_dev, 0xf0, 0, 0); 733 spca504B_WaitCmdStatus(gspca_dev); 734 reg_r(gspca_dev, 0xf0, 4, 0); 735 spca504B_WaitCmdStatus(gspca_dev); 736 break; 737 default: 738 reg_w_riv(gspca_dev, 0x31, 0x0004, 0x00); 739 spca504B_WaitCmdStatus(gspca_dev); 740 spca504B_PollingDataReady(gspca_dev); 741 break; 742 } 743 break; 744 case BRIDGE_SPCA504: 745 if (sd->subtype == AiptekMiniPenCam13) { 746 spca504_read_info(gspca_dev); 747 748 /* Set AE AWB Banding Type 3-> 50Hz 2-> 60Hz */ 749 spca504A_acknowledged_command(gspca_dev, 0x24, 750 8, 3, 0x9e, 1); 751 /* Twice sequential need status 0xff->0x9e->0x9d */ 752 spca504A_acknowledged_command(gspca_dev, 0x24, 753 8, 3, 0x9e, 0); 754 spca504A_acknowledged_command(gspca_dev, 0x24, 755 0, 0, 0x9d, 1); 756 } else { 757 spca504_acknowledged_command(gspca_dev, 0x24, 8, 3); 758 spca504_read_info(gspca_dev); 759 spca504_acknowledged_command(gspca_dev, 0x24, 8, 3); 760 spca504_acknowledged_command(gspca_dev, 0x24, 0, 0); 761 } 762 spca504B_SetSizeType(gspca_dev); 763 reg_w_riv(gspca_dev, 0x00, 0x270c, 0x05); 764 /* L92 sno1t.txt */ 765 reg_w_riv(gspca_dev, 0x00, 0x2310, 0x05); 766 break; 767 case BRIDGE_SPCA504C: 768 if (sd->subtype == LogitechClickSmart420) { 769 write_vector(gspca_dev, 770 spca504A_clicksmart420_init_data, 771 ARRAY_SIZE(spca504A_clicksmart420_init_data)); 772 } else { 773 write_vector(gspca_dev, spca504_pccam600_init_data, 774 ARRAY_SIZE(spca504_pccam600_init_data)); 775 } 776 enable = (sd->autogain ? 0x04 : 0x01); 777 reg_w_riv(gspca_dev, 0x0c, 0x0000, enable); 778 /* auto exposure */ 779 reg_w_riv(gspca_dev, 0xb0, 0x0000, enable); 780 /* auto whiteness */ 781 782 /* set default exposure compensation and whiteness balance */ 783 reg_w_riv(gspca_dev, 0x30, 0x0001, 800); /* ~ 20 fps */ 784 reg_w_riv(gspca_dev, 0x30, 0x0002, 1600); 785 spca504B_SetSizeType(gspca_dev); 786 break; 787 } 788 init_ctl_reg(gspca_dev); 789 return gspca_dev->usb_err; 790 } 791 792 static void sd_stopN(struct gspca_dev *gspca_dev) 793 { 794 struct sd *sd = (struct sd *) gspca_dev; 795 796 switch (sd->bridge) { 797 default: 798 /* case BRIDGE_SPCA533: */ 799 /* case BRIDGE_SPCA536: */ 800 /* case BRIDGE_SPCA504B: */ 801 reg_w_riv(gspca_dev, 0x31, 0, 0); 802 spca504B_WaitCmdStatus(gspca_dev); 803 spca504B_PollingDataReady(gspca_dev); 804 break; 805 case BRIDGE_SPCA504: 806 case BRIDGE_SPCA504C: 807 reg_w_riv(gspca_dev, 0x00, 0x2000, 0x0000); 808 809 if (sd->subtype == AiptekMiniPenCam13) { 810 /* spca504a aiptek */ 811 /* spca504A_acknowledged_command(gspca_dev, 0x08, 812 6, 0, 0x86, 1); */ 813 spca504A_acknowledged_command(gspca_dev, 0x24, 814 0x00, 0x00, 0x9d, 1); 815 spca504A_acknowledged_command(gspca_dev, 0x01, 816 0x0f, 0x00, 0xff, 1); 817 } else { 818 spca504_acknowledged_command(gspca_dev, 0x24, 0, 0); 819 reg_w_riv(gspca_dev, 0x01, 0x000f, 0x0000); 820 } 821 break; 822 } 823 } 824 825 static void sd_pkt_scan(struct gspca_dev *gspca_dev, 826 u8 *data, /* isoc packet */ 827 int len) /* iso packet length */ 828 { 829 struct sd *sd = (struct sd *) gspca_dev; 830 int i, sof = 0; 831 static u8 ffd9[] = {0xff, 0xd9}; 832 833 /* frames are jpeg 4.1.1 without 0xff escape */ 834 switch (sd->bridge) { 835 case BRIDGE_SPCA533: 836 if (data[0] == 0xff) { 837 if (data[1] != 0x01) { /* drop packet */ 838 /* gspca_dev->last_packet_type = DISCARD_PACKET; */ 839 return; 840 } 841 sof = 1; 842 data += SPCA533_OFFSET_DATA; 843 len -= SPCA533_OFFSET_DATA; 844 } else { 845 data += 1; 846 len -= 1; 847 } 848 break; 849 case BRIDGE_SPCA536: 850 if (data[0] == 0xff) { 851 sof = 1; 852 data += SPCA536_OFFSET_DATA; 853 len -= SPCA536_OFFSET_DATA; 854 } else { 855 data += 2; 856 len -= 2; 857 } 858 break; 859 default: 860 /* case BRIDGE_SPCA504: */ 861 /* case BRIDGE_SPCA504B: */ 862 switch (data[0]) { 863 case 0xfe: /* start of frame */ 864 sof = 1; 865 data += SPCA50X_OFFSET_DATA; 866 len -= SPCA50X_OFFSET_DATA; 867 break; 868 case 0xff: /* drop packet */ 869 /* gspca_dev->last_packet_type = DISCARD_PACKET; */ 870 return; 871 default: 872 data += 1; 873 len -= 1; 874 break; 875 } 876 break; 877 case BRIDGE_SPCA504C: 878 switch (data[0]) { 879 case 0xfe: /* start of frame */ 880 sof = 1; 881 data += SPCA504_PCCAM600_OFFSET_DATA; 882 len -= SPCA504_PCCAM600_OFFSET_DATA; 883 break; 884 case 0xff: /* drop packet */ 885 /* gspca_dev->last_packet_type = DISCARD_PACKET; */ 886 return; 887 default: 888 data += 1; 889 len -= 1; 890 break; 891 } 892 break; 893 } 894 if (sof) { /* start of frame */ 895 gspca_frame_add(gspca_dev, LAST_PACKET, 896 ffd9, 2); 897 898 /* put the JPEG header in the new frame */ 899 gspca_frame_add(gspca_dev, FIRST_PACKET, 900 sd->jpeg_hdr, JPEG_HDR_SZ); 901 } 902 903 /* add 0x00 after 0xff */ 904 i = 0; 905 do { 906 if (data[i] == 0xff) { 907 gspca_frame_add(gspca_dev, INTER_PACKET, 908 data, i + 1); 909 len -= i; 910 data += i; 911 *data = 0x00; 912 i = 0; 913 } 914 i++; 915 } while (i < len); 916 gspca_frame_add(gspca_dev, INTER_PACKET, data, len); 917 } 918 919 static int sd_s_ctrl(struct v4l2_ctrl *ctrl) 920 { 921 struct gspca_dev *gspca_dev = 922 container_of(ctrl->handler, struct gspca_dev, ctrl_handler); 923 struct sd *sd = (struct sd *)gspca_dev; 924 925 gspca_dev->usb_err = 0; 926 927 if (!gspca_dev->streaming) 928 return 0; 929 930 switch (ctrl->id) { 931 case V4L2_CID_BRIGHTNESS: 932 setbrightness(gspca_dev, ctrl->val); 933 break; 934 case V4L2_CID_CONTRAST: 935 setcontrast(gspca_dev, ctrl->val); 936 break; 937 case V4L2_CID_SATURATION: 938 setcolors(gspca_dev, ctrl->val); 939 break; 940 case V4L2_CID_AUTOGAIN: 941 sd->autogain = ctrl->val; 942 break; 943 } 944 return gspca_dev->usb_err; 945 } 946 947 static const struct v4l2_ctrl_ops sd_ctrl_ops = { 948 .s_ctrl = sd_s_ctrl, 949 }; 950 951 static int sd_init_controls(struct gspca_dev *gspca_dev) 952 { 953 struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler; 954 955 gspca_dev->vdev.ctrl_handler = hdl; 956 v4l2_ctrl_handler_init(hdl, 4); 957 v4l2_ctrl_new_std(hdl, &sd_ctrl_ops, 958 V4L2_CID_BRIGHTNESS, -128, 127, 1, 0); 959 v4l2_ctrl_new_std(hdl, &sd_ctrl_ops, 960 V4L2_CID_CONTRAST, 0, 255, 1, 0x20); 961 v4l2_ctrl_new_std(hdl, &sd_ctrl_ops, 962 V4L2_CID_SATURATION, 0, 255, 1, 0x1a); 963 v4l2_ctrl_new_std(hdl, &sd_ctrl_ops, 964 V4L2_CID_AUTOGAIN, 0, 1, 1, 1); 965 966 if (hdl->error) { 967 pr_err("Could not initialize controls\n"); 968 return hdl->error; 969 } 970 return 0; 971 } 972 973 /* sub-driver description */ 974 static const struct sd_desc sd_desc = { 975 .name = MODULE_NAME, 976 .config = sd_config, 977 .init = sd_init, 978 .init_controls = sd_init_controls, 979 .start = sd_start, 980 .stopN = sd_stopN, 981 .pkt_scan = sd_pkt_scan, 982 }; 983 984 /* -- module initialisation -- */ 985 #define BS(bridge, subtype) \ 986 .driver_info = (BRIDGE_ ## bridge << 8) \ 987 | (subtype) 988 static const struct usb_device_id device_table[] = { 989 {USB_DEVICE(0x041e, 0x400b), BS(SPCA504C, 0)}, 990 {USB_DEVICE(0x041e, 0x4012), BS(SPCA504C, 0)}, 991 {USB_DEVICE(0x041e, 0x4013), BS(SPCA504C, 0)}, 992 {USB_DEVICE(0x0458, 0x7006), BS(SPCA504B, 0)}, 993 {USB_DEVICE(0x0461, 0x0821), BS(SPCA533, 0)}, 994 {USB_DEVICE(0x046d, 0x0905), BS(SPCA533, LogitechClickSmart820)}, 995 {USB_DEVICE(0x046d, 0x0960), BS(SPCA504C, LogitechClickSmart420)}, 996 {USB_DEVICE(0x0471, 0x0322), BS(SPCA504B, 0)}, 997 {USB_DEVICE(0x04a5, 0x3003), BS(SPCA504B, 0)}, 998 {USB_DEVICE(0x04a5, 0x3008), BS(SPCA533, 0)}, 999 {USB_DEVICE(0x04a5, 0x300a), BS(SPCA533, 0)}, 1000 {USB_DEVICE(0x04f1, 0x1001), BS(SPCA504B, 0)}, 1001 {USB_DEVICE(0x04fc, 0x500c), BS(SPCA504B, 0)}, 1002 {USB_DEVICE(0x04fc, 0x504a), BS(SPCA504, AiptekMiniPenCam13)}, 1003 {USB_DEVICE(0x04fc, 0x504b), BS(SPCA504B, 0)}, 1004 {USB_DEVICE(0x04fc, 0x5330), BS(SPCA533, 0)}, 1005 {USB_DEVICE(0x04fc, 0x5360), BS(SPCA536, 0)}, 1006 {USB_DEVICE(0x04fc, 0xffff), BS(SPCA504B, 0)}, 1007 {USB_DEVICE(0x052b, 0x1507), BS(SPCA533, MegapixV4)}, 1008 {USB_DEVICE(0x052b, 0x1513), BS(SPCA533, MegapixV4)}, 1009 {USB_DEVICE(0x052b, 0x1803), BS(SPCA533, MegaImageVI)}, 1010 {USB_DEVICE(0x0546, 0x3155), BS(SPCA533, 0)}, 1011 {USB_DEVICE(0x0546, 0x3191), BS(SPCA504B, 0)}, 1012 {USB_DEVICE(0x0546, 0x3273), BS(SPCA504B, 0)}, 1013 {USB_DEVICE(0x055f, 0xc211), BS(SPCA536, 0)}, 1014 {USB_DEVICE(0x055f, 0xc230), BS(SPCA533, 0)}, 1015 {USB_DEVICE(0x055f, 0xc232), BS(SPCA533, 0)}, 1016 {USB_DEVICE(0x055f, 0xc360), BS(SPCA536, 0)}, 1017 {USB_DEVICE(0x055f, 0xc420), BS(SPCA504, 0)}, 1018 {USB_DEVICE(0x055f, 0xc430), BS(SPCA533, 0)}, 1019 {USB_DEVICE(0x055f, 0xc440), BS(SPCA533, 0)}, 1020 {USB_DEVICE(0x055f, 0xc520), BS(SPCA504, 0)}, 1021 {USB_DEVICE(0x055f, 0xc530), BS(SPCA533, 0)}, 1022 {USB_DEVICE(0x055f, 0xc540), BS(SPCA533, 0)}, 1023 {USB_DEVICE(0x055f, 0xc630), BS(SPCA533, 0)}, 1024 {USB_DEVICE(0x055f, 0xc650), BS(SPCA533, 0)}, 1025 {USB_DEVICE(0x05da, 0x1018), BS(SPCA504B, 0)}, 1026 {USB_DEVICE(0x06d6, 0x0031), BS(SPCA533, 0)}, 1027 {USB_DEVICE(0x06d6, 0x0041), BS(SPCA504B, 0)}, 1028 {USB_DEVICE(0x0733, 0x1311), BS(SPCA533, 0)}, 1029 {USB_DEVICE(0x0733, 0x1314), BS(SPCA533, 0)}, 1030 {USB_DEVICE(0x0733, 0x2211), BS(SPCA533, 0)}, 1031 {USB_DEVICE(0x0733, 0x2221), BS(SPCA533, 0)}, 1032 {USB_DEVICE(0x0733, 0x3261), BS(SPCA536, 0)}, 1033 {USB_DEVICE(0x0733, 0x3281), BS(SPCA536, 0)}, 1034 {USB_DEVICE(0x08ca, 0x0104), BS(SPCA533, 0)}, 1035 {USB_DEVICE(0x08ca, 0x0106), BS(SPCA533, 0)}, 1036 {USB_DEVICE(0x08ca, 0x2008), BS(SPCA504B, 0)}, 1037 {USB_DEVICE(0x08ca, 0x2010), BS(SPCA533, 0)}, 1038 {USB_DEVICE(0x08ca, 0x2016), BS(SPCA504B, 0)}, 1039 {USB_DEVICE(0x08ca, 0x2018), BS(SPCA504B, 0)}, 1040 {USB_DEVICE(0x08ca, 0x2020), BS(SPCA533, 0)}, 1041 {USB_DEVICE(0x08ca, 0x2022), BS(SPCA533, 0)}, 1042 {USB_DEVICE(0x08ca, 0x2024), BS(SPCA536, 0)}, 1043 {USB_DEVICE(0x08ca, 0x2028), BS(SPCA533, 0)}, 1044 {USB_DEVICE(0x08ca, 0x2040), BS(SPCA536, 0)}, 1045 {USB_DEVICE(0x08ca, 0x2042), BS(SPCA536, 0)}, 1046 {USB_DEVICE(0x08ca, 0x2050), BS(SPCA536, 0)}, 1047 {USB_DEVICE(0x08ca, 0x2060), BS(SPCA536, 0)}, 1048 {USB_DEVICE(0x0d64, 0x0303), BS(SPCA536, 0)}, 1049 {} 1050 }; 1051 MODULE_DEVICE_TABLE(usb, device_table); 1052 1053 /* -- device connect -- */ 1054 static int sd_probe(struct usb_interface *intf, 1055 const struct usb_device_id *id) 1056 { 1057 return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd), 1058 THIS_MODULE); 1059 } 1060 1061 static struct usb_driver sd_driver = { 1062 .name = MODULE_NAME, 1063 .id_table = device_table, 1064 .probe = sd_probe, 1065 .disconnect = gspca_disconnect, 1066 #ifdef CONFIG_PM 1067 .suspend = gspca_suspend, 1068 .resume = gspca_resume, 1069 .reset_resume = gspca_resume, 1070 #endif 1071 }; 1072 1073 module_usb_driver(sd_driver); 1074