1 /* 2 * Connexant Cx11646 library 3 * Copyright (C) 2004 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 "conex" 21 22 #include "gspca.h" 23 #define CONEX_CAM 1 /* special JPEG header */ 24 #include "jpeg.h" 25 26 MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>"); 27 MODULE_DESCRIPTION("GSPCA USB Conexant Camera Driver"); 28 MODULE_LICENSE("GPL"); 29 30 #define QUALITY 50 31 32 /* specific webcam descriptor */ 33 struct sd { 34 struct gspca_dev gspca_dev; /* !! must be the first item */ 35 struct v4l2_ctrl *brightness; 36 struct v4l2_ctrl *contrast; 37 struct v4l2_ctrl *sat; 38 39 u8 jpeg_hdr[JPEG_HDR_SZ]; 40 }; 41 42 static const struct v4l2_pix_format vga_mode[] = { 43 {176, 144, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 44 .bytesperline = 176, 45 .sizeimage = 176 * 144 * 3 / 8 + 590, 46 .colorspace = V4L2_COLORSPACE_JPEG, 47 .priv = 3}, 48 {320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 49 .bytesperline = 320, 50 .sizeimage = 320 * 240 * 3 / 8 + 590, 51 .colorspace = V4L2_COLORSPACE_JPEG, 52 .priv = 2}, 53 {352, 288, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 54 .bytesperline = 352, 55 .sizeimage = 352 * 288 * 3 / 8 + 590, 56 .colorspace = V4L2_COLORSPACE_JPEG, 57 .priv = 1}, 58 {640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, 59 .bytesperline = 640, 60 .sizeimage = 640 * 480 * 3 / 8 + 590, 61 .colorspace = V4L2_COLORSPACE_JPEG, 62 .priv = 0}, 63 }; 64 65 /* the read bytes are found in gspca_dev->usb_buf */ 66 static void reg_r(struct gspca_dev *gspca_dev, 67 __u16 index, 68 __u16 len) 69 { 70 struct usb_device *dev = gspca_dev->dev; 71 72 if (len > USB_BUF_SZ) { 73 gspca_err(gspca_dev, "reg_r: buffer overflow\n"); 74 return; 75 } 76 77 usb_control_msg(dev, 78 usb_rcvctrlpipe(dev, 0), 79 0, 80 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 81 0, 82 index, gspca_dev->usb_buf, len, 83 500); 84 PDEBUG(D_USBI, "reg read [%02x] -> %02x ..", 85 index, gspca_dev->usb_buf[0]); 86 } 87 88 /* the bytes to write are in gspca_dev->usb_buf */ 89 static void reg_w_val(struct gspca_dev *gspca_dev, 90 __u16 index, 91 __u8 val) 92 { 93 struct usb_device *dev = gspca_dev->dev; 94 95 gspca_dev->usb_buf[0] = val; 96 usb_control_msg(dev, 97 usb_sndctrlpipe(dev, 0), 98 0, 99 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 100 0, 101 index, gspca_dev->usb_buf, 1, 500); 102 } 103 104 static void reg_w(struct gspca_dev *gspca_dev, 105 __u16 index, 106 const __u8 *buffer, 107 __u16 len) 108 { 109 struct usb_device *dev = gspca_dev->dev; 110 111 if (len > USB_BUF_SZ) { 112 gspca_err(gspca_dev, "reg_w: buffer overflow\n"); 113 return; 114 } 115 PDEBUG(D_USBO, "reg write [%02x] = %02x..", index, *buffer); 116 117 memcpy(gspca_dev->usb_buf, buffer, len); 118 usb_control_msg(dev, 119 usb_sndctrlpipe(dev, 0), 120 0, 121 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 122 0, 123 index, gspca_dev->usb_buf, len, 500); 124 } 125 126 static const __u8 cx_sensor_init[][4] = { 127 {0x88, 0x11, 0x01, 0x01}, 128 {0x88, 0x12, 0x70, 0x01}, 129 {0x88, 0x0f, 0x00, 0x01}, 130 {0x88, 0x05, 0x01, 0x01}, 131 {} 132 }; 133 134 static const __u8 cx11646_fw1[][3] = { 135 {0x00, 0x02, 0x00}, 136 {0x01, 0x43, 0x00}, 137 {0x02, 0xA7, 0x00}, 138 {0x03, 0x8B, 0x01}, 139 {0x04, 0xE9, 0x02}, 140 {0x05, 0x08, 0x04}, 141 {0x06, 0x08, 0x05}, 142 {0x07, 0x07, 0x06}, 143 {0x08, 0xE7, 0x06}, 144 {0x09, 0xC6, 0x07}, 145 {0x0A, 0x86, 0x08}, 146 {0x0B, 0x46, 0x09}, 147 {0x0C, 0x05, 0x0A}, 148 {0x0D, 0xA5, 0x0A}, 149 {0x0E, 0x45, 0x0B}, 150 {0x0F, 0xE5, 0x0B}, 151 {0x10, 0x85, 0x0C}, 152 {0x11, 0x25, 0x0D}, 153 {0x12, 0xC4, 0x0D}, 154 {0x13, 0x45, 0x0E}, 155 {0x14, 0xE4, 0x0E}, 156 {0x15, 0x64, 0x0F}, 157 {0x16, 0xE4, 0x0F}, 158 {0x17, 0x64, 0x10}, 159 {0x18, 0xE4, 0x10}, 160 {0x19, 0x64, 0x11}, 161 {0x1A, 0xE4, 0x11}, 162 {0x1B, 0x64, 0x12}, 163 {0x1C, 0xE3, 0x12}, 164 {0x1D, 0x44, 0x13}, 165 {0x1E, 0xC3, 0x13}, 166 {0x1F, 0x24, 0x14}, 167 {0x20, 0xA3, 0x14}, 168 {0x21, 0x04, 0x15}, 169 {0x22, 0x83, 0x15}, 170 {0x23, 0xE3, 0x15}, 171 {0x24, 0x43, 0x16}, 172 {0x25, 0xA4, 0x16}, 173 {0x26, 0x23, 0x17}, 174 {0x27, 0x83, 0x17}, 175 {0x28, 0xE3, 0x17}, 176 {0x29, 0x43, 0x18}, 177 {0x2A, 0xA3, 0x18}, 178 {0x2B, 0x03, 0x19}, 179 {0x2C, 0x63, 0x19}, 180 {0x2D, 0xC3, 0x19}, 181 {0x2E, 0x22, 0x1A}, 182 {0x2F, 0x63, 0x1A}, 183 {0x30, 0xC3, 0x1A}, 184 {0x31, 0x23, 0x1B}, 185 {0x32, 0x83, 0x1B}, 186 {0x33, 0xE2, 0x1B}, 187 {0x34, 0x23, 0x1C}, 188 {0x35, 0x83, 0x1C}, 189 {0x36, 0xE2, 0x1C}, 190 {0x37, 0x23, 0x1D}, 191 {0x38, 0x83, 0x1D}, 192 {0x39, 0xE2, 0x1D}, 193 {0x3A, 0x23, 0x1E}, 194 {0x3B, 0x82, 0x1E}, 195 {0x3C, 0xC3, 0x1E}, 196 {0x3D, 0x22, 0x1F}, 197 {0x3E, 0x63, 0x1F}, 198 {0x3F, 0xC1, 0x1F}, 199 {} 200 }; 201 static void cx11646_fw(struct gspca_dev*gspca_dev) 202 { 203 int i = 0; 204 205 reg_w_val(gspca_dev, 0x006a, 0x02); 206 while (cx11646_fw1[i][1]) { 207 reg_w(gspca_dev, 0x006b, cx11646_fw1[i], 3); 208 i++; 209 } 210 reg_w_val(gspca_dev, 0x006a, 0x00); 211 } 212 213 static const __u8 cxsensor[] = { 214 0x88, 0x12, 0x70, 0x01, 215 0x88, 0x0d, 0x02, 0x01, 216 0x88, 0x0f, 0x00, 0x01, 217 0x88, 0x03, 0x71, 0x01, 0x88, 0x04, 0x00, 0x01, /* 3 */ 218 0x88, 0x02, 0x10, 0x01, 219 0x88, 0x00, 0xD4, 0x01, 0x88, 0x01, 0x01, 0x01, /* 5 */ 220 0x88, 0x0B, 0x00, 0x01, 221 0x88, 0x0A, 0x0A, 0x01, 222 0x88, 0x00, 0x08, 0x01, 0x88, 0x01, 0x00, 0x01, /* 8 */ 223 0x88, 0x05, 0x01, 0x01, 224 0xA1, 0x18, 0x00, 0x01, 225 0x00 226 }; 227 228 static const __u8 reg20[] = { 0x10, 0x42, 0x81, 0x19, 0xd3, 0xff, 0xa7, 0xff }; 229 static const __u8 reg28[] = { 0x87, 0x00, 0x87, 0x00, 0x8f, 0xff, 0xea, 0xff }; 230 static const __u8 reg10[] = { 0xb1, 0xb1 }; 231 static const __u8 reg71a[] = { 0x08, 0x18, 0x0a, 0x1e }; /* 640 */ 232 static const __u8 reg71b[] = { 0x04, 0x0c, 0x05, 0x0f }; 233 /* 352{0x04,0x0a,0x06,0x12}; //352{0x05,0x0e,0x06,0x11}; //352 */ 234 static const __u8 reg71c[] = { 0x02, 0x07, 0x03, 0x09 }; 235 /* 320{0x04,0x0c,0x05,0x0f}; //320 */ 236 static const __u8 reg71d[] = { 0x02, 0x07, 0x03, 0x09 }; /* 176 */ 237 static const __u8 reg7b[] = { 0x00, 0xff, 0x00, 0xff, 0x00, 0xff }; 238 239 static void cx_sensor(struct gspca_dev*gspca_dev) 240 { 241 int i = 0; 242 int length; 243 const __u8 *ptsensor = cxsensor; 244 245 reg_w(gspca_dev, 0x0020, reg20, 8); 246 reg_w(gspca_dev, 0x0028, reg28, 8); 247 reg_w(gspca_dev, 0x0010, reg10, 2); 248 reg_w_val(gspca_dev, 0x0092, 0x03); 249 250 switch (gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].priv) { 251 case 0: 252 reg_w(gspca_dev, 0x0071, reg71a, 4); 253 break; 254 case 1: 255 reg_w(gspca_dev, 0x0071, reg71b, 4); 256 break; 257 default: 258 /* case 2: */ 259 reg_w(gspca_dev, 0x0071, reg71c, 4); 260 break; 261 case 3: 262 reg_w(gspca_dev, 0x0071, reg71d, 4); 263 break; 264 } 265 reg_w(gspca_dev, 0x007b, reg7b, 6); 266 reg_w_val(gspca_dev, 0x00f8, 0x00); 267 reg_w(gspca_dev, 0x0010, reg10, 2); 268 reg_w_val(gspca_dev, 0x0098, 0x41); 269 for (i = 0; i < 11; i++) { 270 if (i == 3 || i == 5 || i == 8) 271 length = 8; 272 else 273 length = 4; 274 reg_w(gspca_dev, 0x00e5, ptsensor, length); 275 if (length == 4) 276 reg_r(gspca_dev, 0x00e8, 1); 277 else 278 reg_r(gspca_dev, 0x00e8, length); 279 ptsensor += length; 280 } 281 reg_r(gspca_dev, 0x00e7, 8); 282 } 283 284 static const __u8 cx_inits_176[] = { 285 0x33, 0x81, 0xB0, 0x00, 0x90, 0x00, 0x0A, 0x03, /* 176x144 */ 286 0x00, 0x03, 0x03, 0x03, 0x1B, 0x05, 0x30, 0x03, 287 0x65, 0x15, 0x18, 0x25, 0x03, 0x25, 0x08, 0x30, 288 0x3B, 0x25, 0x10, 0x00, 0x04, 0x00, 0x00, 0x00, 289 0xDC, 0xFF, 0xEE, 0xFF, 0xC5, 0xFF, 0xBF, 0xFF, 290 0xF7, 0xFF, 0x88, 0xFF, 0x66, 0x02, 0x28, 0x02, 291 0x1E, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 292 }; 293 static const __u8 cx_inits_320[] = { 294 0x7f, 0x7f, 0x40, 0x01, 0xf0, 0x00, 0x02, 0x01, 295 0x00, 0x01, 0x01, 0x01, 0x10, 0x00, 0x02, 0x01, 296 0x65, 0x45, 0xfa, 0x4c, 0x2c, 0xdf, 0xb9, 0x81, 297 0x30, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 298 0xe2, 0xff, 0xf1, 0xff, 0xc2, 0xff, 0xbc, 0xff, 299 0xf5, 0xff, 0x6d, 0xff, 0xf6, 0x01, 0x43, 0x02, 300 0xd3, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 301 }; 302 static const __u8 cx_inits_352[] = { 303 0x2e, 0x7c, 0x60, 0x01, 0x20, 0x01, 0x05, 0x03, 304 0x00, 0x06, 0x03, 0x06, 0x1b, 0x10, 0x05, 0x3b, 305 0x30, 0x25, 0x18, 0x25, 0x08, 0x30, 0x03, 0x25, 306 0x3b, 0x30, 0x25, 0x1b, 0x10, 0x05, 0x00, 0x00, 307 0xe3, 0xff, 0xf1, 0xff, 0xc2, 0xff, 0xbc, 0xff, 308 0xf5, 0xff, 0x6b, 0xff, 0xee, 0x01, 0x43, 0x02, 309 0xe4, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 310 }; 311 static const __u8 cx_inits_640[] = { 312 0x7e, 0x7e, 0x80, 0x02, 0xe0, 0x01, 0x01, 0x01, 313 0x00, 0x02, 0x01, 0x02, 0x10, 0x30, 0x01, 0x01, 314 0x65, 0x45, 0xf7, 0x52, 0x2c, 0xdf, 0xb9, 0x81, 315 0x30, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 316 0xe2, 0xff, 0xf1, 0xff, 0xc2, 0xff, 0xbc, 0xff, 317 0xf6, 0xff, 0x7b, 0xff, 0x01, 0x02, 0x43, 0x02, 318 0x77, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 319 }; 320 321 static void cx11646_initsize(struct gspca_dev *gspca_dev) 322 { 323 const __u8 *cxinit; 324 static const __u8 reg12[] = { 0x08, 0x05, 0x07, 0x04, 0x24 }; 325 static const __u8 reg17[] = 326 { 0x0a, 0x00, 0xf2, 0x01, 0x0f, 0x00, 0x97, 0x02 }; 327 328 switch (gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].priv) { 329 case 0: 330 cxinit = cx_inits_640; 331 break; 332 case 1: 333 cxinit = cx_inits_352; 334 break; 335 default: 336 /* case 2: */ 337 cxinit = cx_inits_320; 338 break; 339 case 3: 340 cxinit = cx_inits_176; 341 break; 342 } 343 reg_w_val(gspca_dev, 0x009a, 0x01); 344 reg_w_val(gspca_dev, 0x0010, 0x10); 345 reg_w(gspca_dev, 0x0012, reg12, 5); 346 reg_w(gspca_dev, 0x0017, reg17, 8); 347 reg_w_val(gspca_dev, 0x00c0, 0x00); 348 reg_w_val(gspca_dev, 0x00c1, 0x04); 349 reg_w_val(gspca_dev, 0x00c2, 0x04); 350 351 reg_w(gspca_dev, 0x0061, cxinit, 8); 352 cxinit += 8; 353 reg_w(gspca_dev, 0x00ca, cxinit, 8); 354 cxinit += 8; 355 reg_w(gspca_dev, 0x00d2, cxinit, 8); 356 cxinit += 8; 357 reg_w(gspca_dev, 0x00da, cxinit, 6); 358 cxinit += 8; 359 reg_w(gspca_dev, 0x0041, cxinit, 8); 360 cxinit += 8; 361 reg_w(gspca_dev, 0x0049, cxinit, 8); 362 cxinit += 8; 363 reg_w(gspca_dev, 0x0051, cxinit, 2); 364 365 reg_r(gspca_dev, 0x0010, 1); 366 } 367 368 static const __u8 cx_jpeg_init[][8] = { 369 {0xff, 0xd8, 0xff, 0xdb, 0x00, 0x84, 0x00, 0x15}, /* 1 */ 370 {0x0f, 0x10, 0x12, 0x10, 0x0d, 0x15, 0x12, 0x11}, 371 {0x12, 0x18, 0x16, 0x15, 0x19, 0x20, 0x35, 0x22}, 372 {0x20, 0x1d, 0x1d, 0x20, 0x41, 0x2e, 0x31, 0x26}, 373 {0x35, 0x4d, 0x43, 0x51, 0x4f, 0x4b, 0x43, 0x4a}, 374 {0x49, 0x55, 0x5F, 0x79, 0x67, 0x55, 0x5A, 0x73}, 375 {0x5B, 0x49, 0x4A, 0x6A, 0x90, 0x6B, 0x73, 0x7D}, 376 {0x81, 0x88, 0x89, 0x88, 0x52, 0x66, 0x95, 0xA0}, 377 {0x94, 0x84, 0x9E, 0x79, 0x85, 0x88, 0x83, 0x01}, 378 {0x15, 0x0F, 0x10, 0x12, 0x10, 0x0D, 0x15, 0x12}, 379 {0x11, 0x12, 0x18, 0x16, 0x15, 0x19, 0x20, 0x35}, 380 {0x22, 0x20, 0x1D, 0x1D, 0x20, 0x41, 0x2E, 0x31}, 381 {0x26, 0x35, 0x4D, 0x43, 0x51, 0x4F, 0x4B, 0x43}, 382 {0x4A, 0x49, 0x55, 0x5F, 0x79, 0x67, 0x55, 0x5A}, 383 {0x73, 0x5B, 0x49, 0x4A, 0x6A, 0x90, 0x6B, 0x73}, 384 {0x7D, 0x81, 0x88, 0x89, 0x88, 0x52, 0x66, 0x95}, 385 {0xA0, 0x94, 0x84, 0x9E, 0x79, 0x85, 0x88, 0x83}, 386 {0xFF, 0xC4, 0x01, 0xA2, 0x00, 0x00, 0x01, 0x05}, 387 {0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x00, 0x00}, 388 {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x02}, 389 {0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A}, 390 {0x0B, 0x01, 0x00, 0x03, 0x01, 0x01, 0x01, 0x01}, 391 {0x01, 0x01, 0x01, 0x01, 0x01, 0x00, 0x00, 0x00}, 392 {0x00, 0x00, 0x00, 0x01, 0x02, 0x03, 0x04, 0x05}, 393 {0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x10, 0x00}, 394 {0x02, 0x01, 0x03, 0x03, 0x02, 0x04, 0x03, 0x05}, 395 {0x05, 0x04, 0x04, 0x00, 0x00, 0x01, 0x7D, 0x01}, 396 {0x02, 0x03, 0x00, 0x04, 0x11, 0x05, 0x12, 0x21}, 397 {0x31, 0x41, 0x06, 0x13, 0x51, 0x61, 0x07, 0x22}, 398 {0x71, 0x14, 0x32, 0x81, 0x91, 0xA1, 0x08, 0x23}, 399 {0x42, 0xB1, 0xC1, 0x15, 0x52, 0xD1, 0xF0, 0x24}, 400 {0x33, 0x62, 0x72, 0x82, 0x09, 0x0A, 0x16, 0x17}, 401 {0x18, 0x19, 0x1A, 0x25, 0x26, 0x27, 0x28, 0x29}, 402 {0x2A, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x3A}, 403 {0x43, 0x44, 0x45, 0x46, 0x47, 0x48, 0x49, 0x4A}, 404 {0x53, 0x54, 0x55, 0x56, 0x57, 0x58, 0x59, 0x5A}, 405 {0x63, 0x64, 0x65, 0x66, 0x67, 0x68, 0x69, 0x6A}, 406 {0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79, 0x7A}, 407 {0x83, 0x84, 0x85, 0x86, 0x87, 0x88, 0x89, 0x8A}, 408 {0x92, 0x93, 0x94, 0x95, 0x96, 0x97, 0x98, 0x99}, 409 {0x9A, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6, 0xA7, 0xA8}, 410 {0xA9, 0xAA, 0xB2, 0xB3, 0xB4, 0xB5, 0xB6, 0xB7}, 411 {0xB8, 0xB9, 0xBA, 0xC2, 0xC3, 0xC4, 0xC5, 0xC6}, 412 {0xC7, 0xC8, 0xC9, 0xCA, 0xD2, 0xD3, 0xD4, 0xD5}, 413 {0xD6, 0xD7, 0xD8, 0xD9, 0xDA, 0xE1, 0xE2, 0xE3}, 414 {0xE4, 0xE5, 0xE6, 0xE7, 0xE8, 0xE9, 0xEA, 0xF1}, 415 {0xF2, 0xF3, 0xF4, 0xF5, 0xF6, 0xF7, 0xF8, 0xF9}, 416 {0xFA, 0x11, 0x00, 0x02, 0x01, 0x02, 0x04, 0x04}, 417 {0x03, 0x04, 0x07, 0x05, 0x04, 0x04, 0x00, 0x01}, 418 {0x02, 0x77, 0x00, 0x01, 0x02, 0x03, 0x11, 0x04}, 419 {0x05, 0x21, 0x31, 0x06, 0x12, 0x41, 0x51, 0x07}, 420 {0x61, 0x71, 0x13, 0x22, 0x32, 0x81, 0x08, 0x14}, 421 {0x42, 0x91, 0xA1, 0xB1, 0xC1, 0x09, 0x23, 0x33}, 422 {0x52, 0xF0, 0x15, 0x62, 0x72, 0xD1, 0x0A, 0x16}, 423 {0x24, 0x34, 0xE1, 0x25, 0xF1, 0x17, 0x18, 0x19}, 424 {0x1A, 0x26, 0x27, 0x28, 0x29, 0x2A, 0x35, 0x36}, 425 {0x37, 0x38, 0x39, 0x3A, 0x43, 0x44, 0x45, 0x46}, 426 {0x47, 0x48, 0x49, 0x4A, 0x53, 0x54, 0x55, 0x56}, 427 {0x57, 0x58, 0x59, 0x5A, 0x63, 0x64, 0x65, 0x66}, 428 {0x67, 0x68, 0x69, 0x6A, 0x73, 0x74, 0x75, 0x76}, 429 {0x77, 0x78, 0x79, 0x7A, 0x82, 0x83, 0x84, 0x85}, 430 {0x86, 0x87, 0x88, 0x89, 0x8A, 0x92, 0x93, 0x94}, 431 {0x95, 0x96, 0x97, 0x98, 0x99, 0x9A, 0xA2, 0xA3}, 432 {0xA4, 0xA5, 0xA6, 0xA7, 0xA8, 0xA9, 0xAA, 0xB2}, 433 {0xB3, 0xB4, 0xB5, 0xB6, 0xB7, 0xB8, 0xB9, 0xBA}, 434 {0xC2, 0xC3, 0xC4, 0xC5, 0xC6, 0xC7, 0xC8, 0xC9}, 435 {0xCA, 0xD2, 0xD3, 0xD4, 0xD5, 0xD6, 0xD7, 0xD8}, 436 {0xD9, 0xDA, 0xE2, 0xE3, 0xE4, 0xE5, 0xE6, 0xE7}, 437 {0xE8, 0xE9, 0xEA, 0xF2, 0xF3, 0xF4, 0xF5, 0xF6}, 438 {0xF7, 0xF8, 0xF9, 0xFA, 0xFF, 0x20, 0x00, 0x1F}, 439 {0x02, 0x0C, 0x00, 0x00, 0x0A, 0x00, 0x00, 0x00}, 440 {0x00, 0x00, 0x11, 0x00, 0x11, 0x22, 0x00, 0x22}, 441 {0x22, 0x11, 0x22, 0x22, 0x11, 0x33, 0x33, 0x11}, 442 {0x44, 0x66, 0x22, 0x55, 0x66, 0xFF, 0xDD, 0x00}, 443 {0x04, 0x00, 0x14, 0xFF, 0xC0, 0x00, 0x11, 0x08}, 444 {0x00, 0xF0, 0x01, 0x40, 0x03, 0x00, 0x21, 0x00}, 445 {0x01, 0x11, 0x01, 0x02, 0x11, 0x01, 0xFF, 0xDA}, 446 {0x00, 0x0C, 0x03, 0x00, 0x00, 0x01, 0x11, 0x02}, 447 {0x11, 0x00, 0x3F, 0x00, 0xFF, 0xD9, 0x00, 0x00} /* 79 */ 448 }; 449 450 451 static const __u8 cxjpeg_640[][8] = { 452 {0xff, 0xd8, 0xff, 0xdb, 0x00, 0x84, 0x00, 0x10}, /* 1 */ 453 {0x0b, 0x0c, 0x0e, 0x0c, 0x0a, 0x10, 0x0e, 0x0d}, 454 {0x0e, 0x12, 0x11, 0x10, 0x13, 0x18, 0x28, 0x1a}, 455 {0x18, 0x16, 0x16, 0x18, 0x31, 0x23, 0x25, 0x1d}, 456 {0x28, 0x3a, 0x33, 0x3D, 0x3C, 0x39, 0x33, 0x38}, 457 {0x37, 0x40, 0x48, 0x5C, 0x4E, 0x40, 0x44, 0x57}, 458 {0x45, 0x37, 0x38, 0x50, 0x6D, 0x51, 0x57, 0x5F}, 459 {0x62, 0x67, 0x68, 0x67, 0x3E, 0x4D, 0x71, 0x79}, 460 {0x70, 0x64, 0x78, 0x5C, 0x65, 0x67, 0x63, 0x01}, 461 {0x10, 0x0B, 0x0C, 0x0E, 0x0C, 0x0A, 0x10, 0x0E}, 462 {0x0D, 0x0E, 0x12, 0x11, 0x10, 0x13, 0x18, 0x28}, 463 {0x1A, 0x18, 0x16, 0x16, 0x18, 0x31, 0x23, 0x25}, 464 {0x1D, 0x28, 0x3A, 0x33, 0x3D, 0x3C, 0x39, 0x33}, 465 {0x38, 0x37, 0x40, 0x48, 0x5C, 0x4E, 0x40, 0x44}, 466 {0x57, 0x45, 0x37, 0x38, 0x50, 0x6D, 0x51, 0x57}, 467 {0x5F, 0x62, 0x67, 0x68, 0x67, 0x3E, 0x4D, 0x71}, 468 {0x79, 0x70, 0x64, 0x78, 0x5C, 0x65, 0x67, 0x63}, 469 {0xFF, 0x20, 0x00, 0x1F, 0x00, 0x83, 0x00, 0x00}, 470 {0x0A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x11, 0x00}, 471 {0x11, 0x22, 0x00, 0x22, 0x22, 0x11, 0x22, 0x22}, 472 {0x11, 0x33, 0x33, 0x11, 0x44, 0x66, 0x22, 0x55}, 473 {0x66, 0xFF, 0xDD, 0x00, 0x04, 0x00, 0x28, 0xFF}, 474 {0xC0, 0x00, 0x11, 0x08, 0x01, 0xE0, 0x02, 0x80}, 475 {0x03, 0x00, 0x21, 0x00, 0x01, 0x11, 0x01, 0x02}, 476 {0x11, 0x01, 0xFF, 0xDA, 0x00, 0x0C, 0x03, 0x00}, 477 {0x00, 0x01, 0x11, 0x02, 0x11, 0x00, 0x3F, 0x00}, 478 {0xFF, 0xD9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /* 27 */ 479 }; 480 static const __u8 cxjpeg_352[][8] = { 481 {0xff, 0xd8, 0xff, 0xdb, 0x00, 0x84, 0x00, 0x0d}, 482 {0x09, 0x09, 0x0b, 0x09, 0x08, 0x0D, 0x0b, 0x0a}, 483 {0x0b, 0x0e, 0x0d, 0x0d, 0x0f, 0x13, 0x1f, 0x14}, 484 {0x13, 0x11, 0x11, 0x13, 0x26, 0x1b, 0x1d, 0x17}, 485 {0x1F, 0x2D, 0x28, 0x30, 0x2F, 0x2D, 0x28, 0x2C}, 486 {0x2B, 0x32, 0x38, 0x48, 0x3D, 0x32, 0x35, 0x44}, 487 {0x36, 0x2B, 0x2C, 0x3F, 0x55, 0x3F, 0x44, 0x4A}, 488 {0x4D, 0x50, 0x51, 0x50, 0x30, 0x3C, 0x58, 0x5F}, 489 {0x58, 0x4E, 0x5E, 0x48, 0x4F, 0x50, 0x4D, 0x01}, 490 {0x0D, 0x09, 0x09, 0x0B, 0x09, 0x08, 0x0D, 0x0B}, 491 {0x0A, 0x0B, 0x0E, 0x0D, 0x0D, 0x0F, 0x13, 0x1F}, 492 {0x14, 0x13, 0x11, 0x11, 0x13, 0x26, 0x1B, 0x1D}, 493 {0x17, 0x1F, 0x2D, 0x28, 0x30, 0x2F, 0x2D, 0x28}, 494 {0x2C, 0x2B, 0x32, 0x38, 0x48, 0x3D, 0x32, 0x35}, 495 {0x44, 0x36, 0x2B, 0x2C, 0x3F, 0x55, 0x3F, 0x44}, 496 {0x4A, 0x4D, 0x50, 0x51, 0x50, 0x30, 0x3C, 0x58}, 497 {0x5F, 0x58, 0x4E, 0x5E, 0x48, 0x4F, 0x50, 0x4D}, 498 {0xFF, 0x20, 0x00, 0x1F, 0x01, 0x83, 0x00, 0x00}, 499 {0x0A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x11, 0x00}, 500 {0x11, 0x22, 0x00, 0x22, 0x22, 0x11, 0x22, 0x22}, 501 {0x11, 0x33, 0x33, 0x11, 0x44, 0x66, 0x22, 0x55}, 502 {0x66, 0xFF, 0xDD, 0x00, 0x04, 0x00, 0x16, 0xFF}, 503 {0xC0, 0x00, 0x11, 0x08, 0x01, 0x20, 0x01, 0x60}, 504 {0x03, 0x00, 0x21, 0x00, 0x01, 0x11, 0x01, 0x02}, 505 {0x11, 0x01, 0xFF, 0xDA, 0x00, 0x0C, 0x03, 0x00}, 506 {0x00, 0x01, 0x11, 0x02, 0x11, 0x00, 0x3F, 0x00}, 507 {0xFF, 0xD9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} 508 }; 509 static const __u8 cxjpeg_320[][8] = { 510 {0xff, 0xd8, 0xff, 0xdb, 0x00, 0x84, 0x00, 0x05}, 511 {0x03, 0x04, 0x04, 0x04, 0x03, 0x05, 0x04, 0x04}, 512 {0x04, 0x05, 0x05, 0x05, 0x06, 0x07, 0x0c, 0x08}, 513 {0x07, 0x07, 0x07, 0x07, 0x0f, 0x0b, 0x0b, 0x09}, 514 {0x0C, 0x11, 0x0F, 0x12, 0x12, 0x11, 0x0f, 0x11}, 515 {0x11, 0x13, 0x16, 0x1C, 0x17, 0x13, 0x14, 0x1A}, 516 {0x15, 0x11, 0x11, 0x18, 0x21, 0x18, 0x1A, 0x1D}, 517 {0x1D, 0x1F, 0x1F, 0x1F, 0x13, 0x17, 0x22, 0x24}, 518 {0x22, 0x1E, 0x24, 0x1C, 0x1E, 0x1F, 0x1E, 0x01}, 519 {0x05, 0x03, 0x04, 0x04, 0x04, 0x03, 0x05, 0x04}, 520 {0x04, 0x04, 0x05, 0x05, 0x05, 0x06, 0x07, 0x0C}, 521 {0x08, 0x07, 0x07, 0x07, 0x07, 0x0F, 0x0B, 0x0B}, 522 {0x09, 0x0C, 0x11, 0x0F, 0x12, 0x12, 0x11, 0x0F}, 523 {0x11, 0x11, 0x13, 0x16, 0x1C, 0x17, 0x13, 0x14}, 524 {0x1A, 0x15, 0x11, 0x11, 0x18, 0x21, 0x18, 0x1A}, 525 {0x1D, 0x1D, 0x1F, 0x1F, 0x1F, 0x13, 0x17, 0x22}, 526 {0x24, 0x22, 0x1E, 0x24, 0x1C, 0x1E, 0x1F, 0x1E}, 527 {0xFF, 0x20, 0x00, 0x1F, 0x02, 0x0C, 0x00, 0x00}, 528 {0x0A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x11, 0x00}, 529 {0x11, 0x22, 0x00, 0x22, 0x22, 0x11, 0x22, 0x22}, 530 {0x11, 0x33, 0x33, 0x11, 0x44, 0x66, 0x22, 0x55}, 531 {0x66, 0xFF, 0xDD, 0x00, 0x04, 0x00, 0x14, 0xFF}, 532 {0xC0, 0x00, 0x11, 0x08, 0x00, 0xF0, 0x01, 0x40}, 533 {0x03, 0x00, 0x21, 0x00, 0x01, 0x11, 0x01, 0x02}, 534 {0x11, 0x01, 0xFF, 0xDA, 0x00, 0x0C, 0x03, 0x00}, 535 {0x00, 0x01, 0x11, 0x02, 0x11, 0x00, 0x3F, 0x00}, 536 {0xFF, 0xD9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /* 27 */ 537 }; 538 static const __u8 cxjpeg_176[][8] = { 539 {0xff, 0xd8, 0xff, 0xdb, 0x00, 0x84, 0x00, 0x0d}, 540 {0x09, 0x09, 0x0B, 0x09, 0x08, 0x0D, 0x0B, 0x0A}, 541 {0x0B, 0x0E, 0x0D, 0x0D, 0x0F, 0x13, 0x1F, 0x14}, 542 {0x13, 0x11, 0x11, 0x13, 0x26, 0x1B, 0x1D, 0x17}, 543 {0x1F, 0x2D, 0x28, 0x30, 0x2F, 0x2D, 0x28, 0x2C}, 544 {0x2B, 0x32, 0x38, 0x48, 0x3D, 0x32, 0x35, 0x44}, 545 {0x36, 0x2B, 0x2C, 0x3F, 0x55, 0x3F, 0x44, 0x4A}, 546 {0x4D, 0x50, 0x51, 0x50, 0x30, 0x3C, 0x58, 0x5F}, 547 {0x58, 0x4E, 0x5E, 0x48, 0x4F, 0x50, 0x4D, 0x01}, 548 {0x0D, 0x09, 0x09, 0x0B, 0x09, 0x08, 0x0D, 0x0B}, 549 {0x0A, 0x0B, 0x0E, 0x0D, 0x0D, 0x0F, 0x13, 0x1F}, 550 {0x14, 0x13, 0x11, 0x11, 0x13, 0x26, 0x1B, 0x1D}, 551 {0x17, 0x1F, 0x2D, 0x28, 0x30, 0x2F, 0x2D, 0x28}, 552 {0x2C, 0x2B, 0x32, 0x38, 0x48, 0x3D, 0x32, 0x35}, 553 {0x44, 0x36, 0x2B, 0x2C, 0x3F, 0x55, 0x3F, 0x44}, 554 {0x4A, 0x4D, 0x50, 0x51, 0x50, 0x30, 0x3C, 0x58}, 555 {0x5F, 0x58, 0x4E, 0x5E, 0x48, 0x4F, 0x50, 0x4D}, 556 {0xFF, 0x20, 0x00, 0x1F, 0x03, 0xA1, 0x00, 0x00}, 557 {0x0A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x11, 0x00}, 558 {0x11, 0x22, 0x00, 0x22, 0x22, 0x11, 0x22, 0x22}, 559 {0x11, 0x33, 0x33, 0x11, 0x44, 0x66, 0x22, 0x55}, 560 {0x66, 0xFF, 0xDD, 0x00, 0x04, 0x00, 0x0B, 0xFF}, 561 {0xC0, 0x00, 0x11, 0x08, 0x00, 0x90, 0x00, 0xB0}, 562 {0x03, 0x00, 0x21, 0x00, 0x01, 0x11, 0x01, 0x02}, 563 {0x11, 0x01, 0xFF, 0xDA, 0x00, 0x0C, 0x03, 0x00}, 564 {0x00, 0x01, 0x11, 0x02, 0x11, 0x00, 0x3F, 0x00}, 565 {0xFF, 0xD9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} 566 }; 567 /* 640 take with the zcx30x part */ 568 static const __u8 cxjpeg_qtable[][8] = { 569 {0xff, 0xd8, 0xff, 0xdb, 0x00, 0x84, 0x00, 0x08}, 570 {0x06, 0x06, 0x07, 0x06, 0x05, 0x08, 0x07, 0x07}, 571 {0x07, 0x09, 0x09, 0x08, 0x0a, 0x0c, 0x14, 0x0a}, 572 {0x0c, 0x0b, 0x0b, 0x0c, 0x19, 0x12, 0x13, 0x0f}, 573 {0x14, 0x1d, 0x1a, 0x1f, 0x1e, 0x1d, 0x1a, 0x1c}, 574 {0x1c, 0x20, 0x24, 0x2e, 0x27, 0x20, 0x22, 0x2c}, 575 {0x23, 0x1c, 0x1c, 0x28, 0x37, 0x29, 0x2c, 0x30}, 576 {0x31, 0x34, 0x34, 0x34, 0x1f, 0x27, 0x39, 0x3d}, 577 {0x38, 0x32, 0x3c, 0x2e, 0x33, 0x34, 0x32, 0x01}, 578 {0x09, 0x09, 0x09, 0x0c, 0x0b, 0x0c, 0x18, 0x0a}, 579 {0x0a, 0x18, 0x32, 0x21, 0x1c, 0x21, 0x32, 0x32}, 580 {0x32, 0x32, 0x32, 0x32, 0x32, 0x32, 0x32, 0x32}, 581 {0x32, 0x32, 0x32, 0x32, 0x32, 0x32, 0x32, 0x32}, 582 {0x32, 0x32, 0x32, 0x32, 0x32, 0x32, 0x32, 0x32}, 583 {0x32, 0x32, 0x32, 0x32, 0x32, 0x32, 0x32, 0x32}, 584 {0x32, 0x32, 0x32, 0x32, 0x32, 0x32, 0x32, 0x32}, 585 {0x32, 0x32, 0x32, 0x32, 0x32, 0x32, 0x32, 0x32}, 586 {0xFF, 0xD9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /* 18 */ 587 }; 588 589 590 static void cx11646_jpegInit(struct gspca_dev*gspca_dev) 591 { 592 int i; 593 int length; 594 595 reg_w_val(gspca_dev, 0x00c0, 0x01); 596 reg_w_val(gspca_dev, 0x00c3, 0x00); 597 reg_w_val(gspca_dev, 0x00c0, 0x00); 598 reg_r(gspca_dev, 0x0001, 1); 599 length = 8; 600 for (i = 0; i < 79; i++) { 601 if (i == 78) 602 length = 6; 603 reg_w(gspca_dev, 0x0008, cx_jpeg_init[i], length); 604 } 605 reg_r(gspca_dev, 0x0002, 1); 606 reg_w_val(gspca_dev, 0x0055, 0x14); 607 } 608 609 static const __u8 reg12[] = { 0x0a, 0x05, 0x07, 0x04, 0x19 }; 610 static const __u8 regE5_8[] = 611 { 0x88, 0x00, 0xd4, 0x01, 0x88, 0x01, 0x01, 0x01 }; 612 static const __u8 regE5a[] = { 0x88, 0x0a, 0x0c, 0x01 }; 613 static const __u8 regE5b[] = { 0x88, 0x0b, 0x12, 0x01 }; 614 static const __u8 regE5c[] = { 0x88, 0x05, 0x01, 0x01 }; 615 static const __u8 reg51[] = { 0x77, 0x03 }; 616 #define reg70 0x03 617 618 static void cx11646_jpeg(struct gspca_dev*gspca_dev) 619 { 620 int i; 621 int length; 622 __u8 Reg55; 623 int retry; 624 625 reg_w_val(gspca_dev, 0x00c0, 0x01); 626 reg_w_val(gspca_dev, 0x00c3, 0x00); 627 reg_w_val(gspca_dev, 0x00c0, 0x00); 628 reg_r(gspca_dev, 0x0001, 1); 629 length = 8; 630 switch (gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv) { 631 case 0: 632 for (i = 0; i < 27; i++) { 633 if (i == 26) 634 length = 2; 635 reg_w(gspca_dev, 0x0008, cxjpeg_640[i], length); 636 } 637 Reg55 = 0x28; 638 break; 639 case 1: 640 for (i = 0; i < 27; i++) { 641 if (i == 26) 642 length = 2; 643 reg_w(gspca_dev, 0x0008, cxjpeg_352[i], length); 644 } 645 Reg55 = 0x16; 646 break; 647 default: 648 /* case 2: */ 649 for (i = 0; i < 27; i++) { 650 if (i == 26) 651 length = 2; 652 reg_w(gspca_dev, 0x0008, cxjpeg_320[i], length); 653 } 654 Reg55 = 0x14; 655 break; 656 case 3: 657 for (i = 0; i < 27; i++) { 658 if (i == 26) 659 length = 2; 660 reg_w(gspca_dev, 0x0008, cxjpeg_176[i], length); 661 } 662 Reg55 = 0x0B; 663 break; 664 } 665 666 reg_r(gspca_dev, 0x0002, 1); 667 reg_w_val(gspca_dev, 0x0055, Reg55); 668 reg_r(gspca_dev, 0x0002, 1); 669 reg_w(gspca_dev, 0x0010, reg10, 2); 670 reg_w_val(gspca_dev, 0x0054, 0x02); 671 reg_w_val(gspca_dev, 0x0054, 0x01); 672 reg_w_val(gspca_dev, 0x0000, 0x94); 673 reg_w_val(gspca_dev, 0x0053, 0xc0); 674 reg_w_val(gspca_dev, 0x00fc, 0xe1); 675 reg_w_val(gspca_dev, 0x0000, 0x00); 676 /* wait for completion */ 677 retry = 50; 678 do { 679 reg_r(gspca_dev, 0x0002, 1); 680 /* 0x07 until 0x00 */ 681 if (gspca_dev->usb_buf[0] == 0x00) 682 break; 683 reg_w_val(gspca_dev, 0x0053, 0x00); 684 } while (--retry); 685 if (retry == 0) 686 gspca_err(gspca_dev, "Damned Errors sending jpeg Table\n"); 687 /* send the qtable now */ 688 reg_r(gspca_dev, 0x0001, 1); /* -> 0x18 */ 689 length = 8; 690 for (i = 0; i < 18; i++) { 691 if (i == 17) 692 length = 2; 693 reg_w(gspca_dev, 0x0008, cxjpeg_qtable[i], length); 694 695 } 696 reg_r(gspca_dev, 0x0002, 1); /* 0x00 */ 697 reg_r(gspca_dev, 0x0053, 1); /* 0x00 */ 698 reg_w_val(gspca_dev, 0x0054, 0x02); 699 reg_w_val(gspca_dev, 0x0054, 0x01); 700 reg_w_val(gspca_dev, 0x0000, 0x94); 701 reg_w_val(gspca_dev, 0x0053, 0xc0); 702 703 reg_r(gspca_dev, 0x0038, 1); /* 0x40 */ 704 reg_r(gspca_dev, 0x0038, 1); /* 0x40 */ 705 reg_r(gspca_dev, 0x001f, 1); /* 0x38 */ 706 reg_w(gspca_dev, 0x0012, reg12, 5); 707 reg_w(gspca_dev, 0x00e5, regE5_8, 8); 708 reg_r(gspca_dev, 0x00e8, 8); 709 reg_w(gspca_dev, 0x00e5, regE5a, 4); 710 reg_r(gspca_dev, 0x00e8, 1); /* 0x00 */ 711 reg_w_val(gspca_dev, 0x009a, 0x01); 712 reg_w(gspca_dev, 0x00e5, regE5b, 4); 713 reg_r(gspca_dev, 0x00e8, 1); /* 0x00 */ 714 reg_w(gspca_dev, 0x00e5, regE5c, 4); 715 reg_r(gspca_dev, 0x00e8, 1); /* 0x00 */ 716 717 reg_w(gspca_dev, 0x0051, reg51, 2); 718 reg_w(gspca_dev, 0x0010, reg10, 2); 719 reg_w_val(gspca_dev, 0x0070, reg70); 720 } 721 722 static void cx11646_init1(struct gspca_dev *gspca_dev) 723 { 724 int i = 0; 725 726 reg_w_val(gspca_dev, 0x0010, 0x00); 727 reg_w_val(gspca_dev, 0x0053, 0x00); 728 reg_w_val(gspca_dev, 0x0052, 0x00); 729 reg_w_val(gspca_dev, 0x009b, 0x2f); 730 reg_w_val(gspca_dev, 0x009c, 0x10); 731 reg_r(gspca_dev, 0x0098, 1); 732 reg_w_val(gspca_dev, 0x0098, 0x40); 733 reg_r(gspca_dev, 0x0099, 1); 734 reg_w_val(gspca_dev, 0x0099, 0x07); 735 reg_w_val(gspca_dev, 0x0039, 0x40); 736 reg_w_val(gspca_dev, 0x003c, 0xff); 737 reg_w_val(gspca_dev, 0x003f, 0x1f); 738 reg_w_val(gspca_dev, 0x003d, 0x40); 739 /* reg_w_val(gspca_dev, 0x003d, 0x60); */ 740 reg_r(gspca_dev, 0x0099, 1); /* ->0x07 */ 741 742 while (cx_sensor_init[i][0]) { 743 reg_w_val(gspca_dev, 0x00e5, cx_sensor_init[i][0]); 744 reg_r(gspca_dev, 0x00e8, 1); /* -> 0x00 */ 745 if (i == 1) { 746 reg_w_val(gspca_dev, 0x00ed, 0x01); 747 reg_r(gspca_dev, 0x00ed, 1); /* -> 0x01 */ 748 } 749 i++; 750 } 751 reg_w_val(gspca_dev, 0x00c3, 0x00); 752 } 753 754 /* this function is called at probe time */ 755 static int sd_config(struct gspca_dev *gspca_dev, 756 const struct usb_device_id *id) 757 { 758 struct cam *cam; 759 760 cam = &gspca_dev->cam; 761 cam->cam_mode = vga_mode; 762 cam->nmodes = ARRAY_SIZE(vga_mode); 763 return 0; 764 } 765 766 /* this function is called at probe and resume time */ 767 static int sd_init(struct gspca_dev *gspca_dev) 768 { 769 cx11646_init1(gspca_dev); 770 cx11646_initsize(gspca_dev); 771 cx11646_fw(gspca_dev); 772 cx_sensor(gspca_dev); 773 cx11646_jpegInit(gspca_dev); 774 return 0; 775 } 776 777 static int sd_start(struct gspca_dev *gspca_dev) 778 { 779 struct sd *sd = (struct sd *) gspca_dev; 780 781 /* create the JPEG header */ 782 jpeg_define(sd->jpeg_hdr, gspca_dev->pixfmt.height, 783 gspca_dev->pixfmt.width, 784 0x22); /* JPEG 411 */ 785 jpeg_set_qual(sd->jpeg_hdr, QUALITY); 786 787 cx11646_initsize(gspca_dev); 788 cx11646_fw(gspca_dev); 789 cx_sensor(gspca_dev); 790 cx11646_jpeg(gspca_dev); 791 return 0; 792 } 793 794 /* called on streamoff with alt 0 and on disconnect */ 795 static void sd_stop0(struct gspca_dev *gspca_dev) 796 { 797 int retry = 50; 798 799 if (!gspca_dev->present) 800 return; 801 reg_w_val(gspca_dev, 0x0000, 0x00); 802 reg_r(gspca_dev, 0x0002, 1); 803 reg_w_val(gspca_dev, 0x0053, 0x00); 804 805 while (retry--) { 806 /* reg_r(gspca_dev, 0x0002, 1);*/ 807 reg_r(gspca_dev, 0x0053, 1); 808 if (gspca_dev->usb_buf[0] == 0) 809 break; 810 } 811 reg_w_val(gspca_dev, 0x0000, 0x00); 812 reg_r(gspca_dev, 0x0002, 1); 813 814 reg_w_val(gspca_dev, 0x0010, 0x00); 815 reg_r(gspca_dev, 0x0033, 1); 816 reg_w_val(gspca_dev, 0x00fc, 0xe0); 817 } 818 819 static void sd_pkt_scan(struct gspca_dev *gspca_dev, 820 u8 *data, /* isoc packet */ 821 int len) /* iso packet length */ 822 { 823 struct sd *sd = (struct sd *) gspca_dev; 824 825 if (data[0] == 0xff && data[1] == 0xd8) { 826 827 /* start of frame */ 828 gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0); 829 830 /* put the JPEG header in the new frame */ 831 gspca_frame_add(gspca_dev, FIRST_PACKET, 832 sd->jpeg_hdr, JPEG_HDR_SZ); 833 data += 2; 834 len -= 2; 835 } 836 gspca_frame_add(gspca_dev, INTER_PACKET, data, len); 837 } 838 839 static void setbrightness(struct gspca_dev *gspca_dev, s32 val, s32 sat) 840 { 841 __u8 regE5cbx[] = { 0x88, 0x00, 0xd4, 0x01, 0x88, 0x01, 0x01, 0x01 }; 842 __u8 reg51c[2]; 843 844 regE5cbx[2] = val; 845 reg_w(gspca_dev, 0x00e5, regE5cbx, 8); 846 reg_r(gspca_dev, 0x00e8, 8); 847 reg_w(gspca_dev, 0x00e5, regE5c, 4); 848 reg_r(gspca_dev, 0x00e8, 1); /* 0x00 */ 849 850 reg51c[0] = 0x77; 851 reg51c[1] = sat; 852 reg_w(gspca_dev, 0x0051, reg51c, 2); 853 reg_w(gspca_dev, 0x0010, reg10, 2); 854 reg_w_val(gspca_dev, 0x0070, reg70); 855 } 856 857 static void setcontrast(struct gspca_dev *gspca_dev, s32 val, s32 sat) 858 { 859 __u8 regE5acx[] = { 0x88, 0x0a, 0x0c, 0x01 }; /* seem MSB */ 860 /* __u8 regE5bcx[] = { 0x88, 0x0b, 0x12, 0x01}; * LSB */ 861 __u8 reg51c[2]; 862 863 regE5acx[2] = val; 864 reg_w(gspca_dev, 0x00e5, regE5acx, 4); 865 reg_r(gspca_dev, 0x00e8, 1); /* 0x00 */ 866 reg51c[0] = 0x77; 867 reg51c[1] = sat; 868 reg_w(gspca_dev, 0x0051, reg51c, 2); 869 reg_w(gspca_dev, 0x0010, reg10, 2); 870 reg_w_val(gspca_dev, 0x0070, reg70); 871 } 872 873 static int sd_s_ctrl(struct v4l2_ctrl *ctrl) 874 { 875 struct gspca_dev *gspca_dev = 876 container_of(ctrl->handler, struct gspca_dev, ctrl_handler); 877 struct sd *sd = (struct sd *)gspca_dev; 878 879 gspca_dev->usb_err = 0; 880 881 if (!gspca_dev->streaming) 882 return 0; 883 884 switch (ctrl->id) { 885 case V4L2_CID_BRIGHTNESS: 886 setbrightness(gspca_dev, ctrl->val, sd->sat->cur.val); 887 break; 888 case V4L2_CID_CONTRAST: 889 setcontrast(gspca_dev, ctrl->val, sd->sat->cur.val); 890 break; 891 case V4L2_CID_SATURATION: 892 setbrightness(gspca_dev, sd->brightness->cur.val, ctrl->val); 893 setcontrast(gspca_dev, sd->contrast->cur.val, ctrl->val); 894 break; 895 } 896 return gspca_dev->usb_err; 897 } 898 899 static const struct v4l2_ctrl_ops sd_ctrl_ops = { 900 .s_ctrl = sd_s_ctrl, 901 }; 902 903 static int sd_init_controls(struct gspca_dev *gspca_dev) 904 { 905 struct sd *sd = (struct sd *)gspca_dev; 906 struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler; 907 908 gspca_dev->vdev.ctrl_handler = hdl; 909 v4l2_ctrl_handler_init(hdl, 3); 910 sd->brightness = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops, 911 V4L2_CID_BRIGHTNESS, 0, 255, 1, 0xd4); 912 sd->contrast = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops, 913 V4L2_CID_CONTRAST, 0x0a, 0x1f, 1, 0x0c); 914 sd->sat = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops, 915 V4L2_CID_SATURATION, 0, 7, 1, 3); 916 if (hdl->error) { 917 pr_err("Could not initialize controls\n"); 918 return hdl->error; 919 } 920 return 0; 921 } 922 923 /* sub-driver description */ 924 static const struct sd_desc sd_desc = { 925 .name = MODULE_NAME, 926 .config = sd_config, 927 .init = sd_init, 928 .init_controls = sd_init_controls, 929 .start = sd_start, 930 .stop0 = sd_stop0, 931 .pkt_scan = sd_pkt_scan, 932 }; 933 934 /* -- module initialisation -- */ 935 static const struct usb_device_id device_table[] = { 936 {USB_DEVICE(0x0572, 0x0041)}, 937 {} 938 }; 939 MODULE_DEVICE_TABLE(usb, device_table); 940 941 /* -- device connect -- */ 942 static int sd_probe(struct usb_interface *intf, 943 const struct usb_device_id *id) 944 { 945 return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd), 946 THIS_MODULE); 947 } 948 949 static struct usb_driver sd_driver = { 950 .name = MODULE_NAME, 951 .id_table = device_table, 952 .probe = sd_probe, 953 .disconnect = gspca_disconnect, 954 #ifdef CONFIG_PM 955 .suspend = gspca_suspend, 956 .resume = gspca_resume, 957 .reset_resume = gspca_resume, 958 #endif 959 }; 960 961 module_usb_driver(sd_driver); 962