1 /* 2 * SQ930x subdriver 3 * 4 * Copyright (C) 2010 Jean-François Moine <http://moinejf.free.fr> 5 * Copyright (C) 2006 -2008 Gerard Klaver <gerard at gkall dot hobby dot nl> 6 * Copyright (C) 2007 Sam Revitch <samr7@cs.washington.edu> 7 * 8 * This program is free software; you can redistribute it and/or modify 9 * it under the terms of the GNU General Public License as published by 10 * the Free Software Foundation; either version 2 of the License, or 11 * any later version. 12 * 13 * This program is distributed in the hope that it will be useful, 14 * but WITHOUT ANY WARRANTY; without even the implied warranty of 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16 * GNU General Public License for more details. 17 */ 18 19 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 20 21 #define MODULE_NAME "sq930x" 22 23 #include "gspca.h" 24 25 MODULE_AUTHOR("Jean-Francois Moine <http://moinejf.free.fr>\n" 26 "Gerard Klaver <gerard at gkall dot hobby dot nl\n" 27 "Sam Revitch <samr7@cs.washington.edu>"); 28 MODULE_DESCRIPTION("GSPCA/SQ930x USB Camera Driver"); 29 MODULE_LICENSE("GPL"); 30 31 /* Structure to hold all of our device specific stuff */ 32 struct sd { 33 struct gspca_dev gspca_dev; /* !! must be the first item */ 34 35 struct { /* exposure/gain control cluster */ 36 struct v4l2_ctrl *exposure; 37 struct v4l2_ctrl *gain; 38 }; 39 40 u8 do_ctrl; 41 u8 gpio[2]; 42 u8 sensor; 43 u8 type; 44 #define Generic 0 45 #define Creative_live_motion 1 46 }; 47 enum sensors { 48 SENSOR_ICX098BQ, 49 SENSOR_LZ24BP, 50 SENSOR_MI0360, 51 SENSOR_MT9V111, /* = MI360SOC */ 52 SENSOR_OV7660, 53 SENSOR_OV9630, 54 }; 55 56 static struct v4l2_pix_format vga_mode[] = { 57 {320, 240, V4L2_PIX_FMT_SRGGB8, V4L2_FIELD_NONE, 58 .bytesperline = 320, 59 .sizeimage = 320 * 240, 60 .colorspace = V4L2_COLORSPACE_SRGB, 61 .priv = 0}, 62 {640, 480, V4L2_PIX_FMT_SRGGB8, V4L2_FIELD_NONE, 63 .bytesperline = 640, 64 .sizeimage = 640 * 480, 65 .colorspace = V4L2_COLORSPACE_SRGB, 66 .priv = 1}, 67 }; 68 69 /* sq930x registers */ 70 #define SQ930_CTRL_UCBUS_IO 0x0001 71 #define SQ930_CTRL_I2C_IO 0x0002 72 #define SQ930_CTRL_GPIO 0x0005 73 #define SQ930_CTRL_CAP_START 0x0010 74 #define SQ930_CTRL_CAP_STOP 0x0011 75 #define SQ930_CTRL_SET_EXPOSURE 0x001d 76 #define SQ930_CTRL_RESET 0x001e 77 #define SQ930_CTRL_GET_DEV_INFO 0x001f 78 79 /* gpio 1 (8..15) */ 80 #define SQ930_GPIO_DFL_I2C_SDA 0x0001 81 #define SQ930_GPIO_DFL_I2C_SCL 0x0002 82 #define SQ930_GPIO_RSTBAR 0x0004 83 #define SQ930_GPIO_EXTRA1 0x0040 84 #define SQ930_GPIO_EXTRA2 0x0080 85 /* gpio 3 (24..31) */ 86 #define SQ930_GPIO_POWER 0x0200 87 #define SQ930_GPIO_DFL_LED 0x1000 88 89 struct ucbus_write_cmd { 90 u16 bw_addr; 91 u8 bw_data; 92 }; 93 struct i2c_write_cmd { 94 u8 reg; 95 u16 val; 96 }; 97 98 static const struct ucbus_write_cmd icx098bq_start_0[] = { 99 {0x0354, 0x00}, {0x03fa, 0x00}, {0xf800, 0x02}, {0xf801, 0xce}, 100 {0xf802, 0xc1}, {0xf804, 0x00}, {0xf808, 0x00}, {0xf809, 0x0e}, 101 {0xf80a, 0x01}, {0xf80b, 0xee}, {0xf807, 0x60}, {0xf80c, 0x02}, 102 {0xf80d, 0xf0}, {0xf80e, 0x03}, {0xf80f, 0x0a}, {0xf81c, 0x02}, 103 {0xf81d, 0xf0}, {0xf81e, 0x03}, {0xf81f, 0x0a}, {0xf83a, 0x00}, 104 {0xf83b, 0x10}, {0xf83c, 0x00}, {0xf83d, 0x4e}, {0xf810, 0x04}, 105 {0xf811, 0x00}, {0xf812, 0x02}, {0xf813, 0x10}, {0xf803, 0x00}, 106 {0xf814, 0x01}, {0xf815, 0x18}, {0xf816, 0x00}, {0xf817, 0x48}, 107 {0xf818, 0x00}, {0xf819, 0x25}, {0xf81a, 0x00}, {0xf81b, 0x3c}, 108 {0xf82f, 0x03}, {0xf820, 0xff}, {0xf821, 0x0d}, {0xf822, 0xff}, 109 {0xf823, 0x07}, {0xf824, 0xff}, {0xf825, 0x03}, {0xf826, 0xff}, 110 {0xf827, 0x06}, {0xf828, 0xff}, {0xf829, 0x03}, {0xf82a, 0xff}, 111 {0xf82b, 0x0c}, {0xf82c, 0xfd}, {0xf82d, 0x01}, {0xf82e, 0x00}, 112 {0xf830, 0x00}, {0xf831, 0x47}, {0xf832, 0x00}, {0xf833, 0x00}, 113 {0xf850, 0x00}, {0xf851, 0x00}, {0xf852, 0x00}, {0xf853, 0x24}, 114 {0xf854, 0x00}, {0xf855, 0x18}, {0xf856, 0x00}, {0xf857, 0x3c}, 115 {0xf858, 0x00}, {0xf859, 0x0c}, {0xf85a, 0x00}, {0xf85b, 0x30}, 116 {0xf85c, 0x00}, {0xf85d, 0x0c}, {0xf85e, 0x00}, {0xf85f, 0x30}, 117 {0xf860, 0x00}, {0xf861, 0x48}, {0xf862, 0x01}, {0xf863, 0xdc}, 118 {0xf864, 0xff}, {0xf865, 0x98}, {0xf866, 0xff}, {0xf867, 0xc0}, 119 {0xf868, 0xff}, {0xf869, 0x70}, {0xf86c, 0xff}, {0xf86d, 0x00}, 120 {0xf86a, 0xff}, {0xf86b, 0x48}, {0xf86e, 0xff}, {0xf86f, 0x00}, 121 {0xf870, 0x01}, {0xf871, 0xdb}, {0xf872, 0x01}, {0xf873, 0xfa}, 122 {0xf874, 0x01}, {0xf875, 0xdb}, {0xf876, 0x01}, {0xf877, 0xfa}, 123 {0xf878, 0x0f}, {0xf879, 0x0f}, {0xf87a, 0xff}, {0xf87b, 0xff}, 124 {0xf800, 0x03} 125 }; 126 static const struct ucbus_write_cmd icx098bq_start_1[] = { 127 {0xf5f0, 0x00}, {0xf5f1, 0xcd}, {0xf5f2, 0x80}, {0xf5f3, 0x80}, 128 {0xf5f4, 0xc0}, 129 {0xf5f0, 0x49}, {0xf5f1, 0xcd}, {0xf5f2, 0x80}, {0xf5f3, 0x80}, 130 {0xf5f4, 0xc0}, 131 {0xf5fa, 0x00}, {0xf5f6, 0x00}, {0xf5f7, 0x00}, {0xf5f8, 0x00}, 132 {0xf5f9, 0x00} 133 }; 134 135 static const struct ucbus_write_cmd icx098bq_start_2[] = { 136 {0xf800, 0x02}, {0xf807, 0xff}, {0xf805, 0x82}, {0xf806, 0x00}, 137 {0xf807, 0x7f}, {0xf800, 0x03}, 138 {0xf800, 0x02}, {0xf807, 0xff}, {0xf805, 0x40}, {0xf806, 0x00}, 139 {0xf807, 0x7f}, {0xf800, 0x03}, 140 {0xf800, 0x02}, {0xf807, 0xff}, {0xf805, 0xcf}, {0xf806, 0xd0}, 141 {0xf807, 0x7f}, {0xf800, 0x03}, 142 {0xf800, 0x02}, {0xf807, 0xff}, {0xf805, 0x00}, {0xf806, 0x00}, 143 {0xf807, 0x7f}, {0xf800, 0x03} 144 }; 145 146 static const struct ucbus_write_cmd lz24bp_start_0[] = { 147 {0x0354, 0x00}, {0x03fa, 0x00}, {0xf800, 0x02}, {0xf801, 0xbe}, 148 {0xf802, 0xc6}, {0xf804, 0x00}, {0xf808, 0x00}, {0xf809, 0x06}, 149 {0xf80a, 0x01}, {0xf80b, 0xfe}, {0xf807, 0x84}, {0xf80c, 0x02}, 150 {0xf80d, 0xf7}, {0xf80e, 0x03}, {0xf80f, 0x0b}, {0xf81c, 0x00}, 151 {0xf81d, 0x49}, {0xf81e, 0x03}, {0xf81f, 0x0b}, {0xf83a, 0x00}, 152 {0xf83b, 0x01}, {0xf83c, 0x00}, {0xf83d, 0x6b}, {0xf810, 0x03}, 153 {0xf811, 0x10}, {0xf812, 0x02}, {0xf813, 0x6f}, {0xf803, 0x00}, 154 {0xf814, 0x00}, {0xf815, 0x44}, {0xf816, 0x00}, {0xf817, 0x48}, 155 {0xf818, 0x00}, {0xf819, 0x25}, {0xf81a, 0x00}, {0xf81b, 0x3c}, 156 {0xf82f, 0x03}, {0xf820, 0xff}, {0xf821, 0x0d}, {0xf822, 0xff}, 157 {0xf823, 0x07}, {0xf824, 0xfd}, {0xf825, 0x07}, {0xf826, 0xf0}, 158 {0xf827, 0x0c}, {0xf828, 0xff}, {0xf829, 0x03}, {0xf82a, 0xff}, 159 {0xf82b, 0x0c}, {0xf82c, 0xfc}, {0xf82d, 0x01}, {0xf82e, 0x00}, 160 {0xf830, 0x00}, {0xf831, 0x47}, {0xf832, 0x00}, {0xf833, 0x00}, 161 {0xf850, 0x00}, {0xf851, 0x00}, {0xf852, 0x00}, {0xf853, 0x24}, 162 {0xf854, 0x00}, {0xf855, 0x0c}, {0xf856, 0x00}, {0xf857, 0x30}, 163 {0xf858, 0x00}, {0xf859, 0x18}, {0xf85a, 0x00}, {0xf85b, 0x3c}, 164 {0xf85c, 0x00}, {0xf85d, 0x18}, {0xf85e, 0x00}, {0xf85f, 0x3c}, 165 {0xf860, 0xff}, {0xf861, 0x37}, {0xf862, 0xff}, {0xf863, 0x1d}, 166 {0xf864, 0xff}, {0xf865, 0x98}, {0xf866, 0xff}, {0xf867, 0xc0}, 167 {0xf868, 0x00}, {0xf869, 0x37}, {0xf86c, 0x02}, {0xf86d, 0x1d}, 168 {0xf86a, 0x00}, {0xf86b, 0x37}, {0xf86e, 0x02}, {0xf86f, 0x1d}, 169 {0xf870, 0x01}, {0xf871, 0xc6}, {0xf872, 0x02}, {0xf873, 0x04}, 170 {0xf874, 0x01}, {0xf875, 0xc6}, {0xf876, 0x02}, {0xf877, 0x04}, 171 {0xf878, 0x0f}, {0xf879, 0x0f}, {0xf87a, 0xff}, {0xf87b, 0xff}, 172 {0xf800, 0x03} 173 }; 174 static const struct ucbus_write_cmd lz24bp_start_1_gen[] = { 175 {0xf5f0, 0x00}, {0xf5f1, 0xff}, {0xf5f2, 0x80}, {0xf5f3, 0x80}, 176 {0xf5f4, 0xb3}, 177 {0xf5f0, 0x40}, {0xf5f1, 0xff}, {0xf5f2, 0x80}, {0xf5f3, 0x80}, 178 {0xf5f4, 0xb3}, 179 {0xf5fa, 0x00}, {0xf5f6, 0x00}, {0xf5f7, 0x00}, {0xf5f8, 0x00}, 180 {0xf5f9, 0x00} 181 }; 182 183 static const struct ucbus_write_cmd lz24bp_start_1_clm[] = { 184 {0xf5f0, 0x00}, {0xf5f1, 0xff}, {0xf5f2, 0x88}, {0xf5f3, 0x88}, 185 {0xf5f4, 0xc0}, 186 {0xf5f0, 0x40}, {0xf5f1, 0xff}, {0xf5f2, 0x88}, {0xf5f3, 0x88}, 187 {0xf5f4, 0xc0}, 188 {0xf5fa, 0x00}, {0xf5f6, 0x00}, {0xf5f7, 0x00}, {0xf5f8, 0x00}, 189 {0xf5f9, 0x00} 190 }; 191 192 static const struct ucbus_write_cmd lz24bp_start_2[] = { 193 {0xf800, 0x02}, {0xf807, 0xff}, {0xf805, 0x80}, {0xf806, 0x00}, 194 {0xf807, 0x7f}, {0xf800, 0x03}, 195 {0xf800, 0x02}, {0xf807, 0xff}, {0xf805, 0x4e}, {0xf806, 0x00}, 196 {0xf807, 0x7f}, {0xf800, 0x03}, 197 {0xf800, 0x02}, {0xf807, 0xff}, {0xf805, 0xc0}, {0xf806, 0x48}, 198 {0xf807, 0x7f}, {0xf800, 0x03}, 199 {0xf800, 0x02}, {0xf807, 0xff}, {0xf805, 0x00}, {0xf806, 0x00}, 200 {0xf807, 0x7f}, {0xf800, 0x03} 201 }; 202 203 static const struct ucbus_write_cmd mi0360_start_0[] = { 204 {0x0354, 0x00}, {0x03fa, 0x00}, {0xf332, 0xcc}, {0xf333, 0xcc}, 205 {0xf334, 0xcc}, {0xf335, 0xcc}, {0xf33f, 0x00} 206 }; 207 static const struct i2c_write_cmd mi0360_init_23[] = { 208 {0x30, 0x0040}, /* reserved - def 0x0005 */ 209 {0x31, 0x0000}, /* reserved - def 0x002a */ 210 {0x34, 0x0100}, /* reserved - def 0x0100 */ 211 {0x3d, 0x068f}, /* reserved - def 0x068f */ 212 }; 213 static const struct i2c_write_cmd mi0360_init_24[] = { 214 {0x03, 0x01e5}, /* window height */ 215 {0x04, 0x0285}, /* window width */ 216 }; 217 static const struct i2c_write_cmd mi0360_init_25[] = { 218 {0x35, 0x0020}, /* global gain */ 219 {0x2b, 0x0020}, /* green1 gain */ 220 {0x2c, 0x002a}, /* blue gain */ 221 {0x2d, 0x0028}, /* red gain */ 222 {0x2e, 0x0020}, /* green2 gain */ 223 }; 224 static const struct ucbus_write_cmd mi0360_start_1[] = { 225 {0xf5f0, 0x11}, {0xf5f1, 0x99}, {0xf5f2, 0x80}, {0xf5f3, 0x80}, 226 {0xf5f4, 0xa6}, 227 {0xf5f0, 0x51}, {0xf5f1, 0x99}, {0xf5f2, 0x80}, {0xf5f3, 0x80}, 228 {0xf5f4, 0xa6}, 229 {0xf5fa, 0x00}, {0xf5f6, 0x00}, {0xf5f7, 0x00}, {0xf5f8, 0x00}, 230 {0xf5f9, 0x00} 231 }; 232 static const struct i2c_write_cmd mi0360_start_2[] = { 233 {0x62, 0x041d}, /* reserved - def 0x0418 */ 234 }; 235 static const struct i2c_write_cmd mi0360_start_3[] = { 236 {0x05, 0x007b}, /* horiz blanking */ 237 }; 238 static const struct i2c_write_cmd mi0360_start_4[] = { 239 {0x05, 0x03f5}, /* horiz blanking */ 240 }; 241 242 static const struct i2c_write_cmd mt9v111_init_0[] = { 243 {0x01, 0x0001}, /* select IFP/SOC registers */ 244 {0x06, 0x300c}, /* operating mode control */ 245 {0x08, 0xcc00}, /* output format control (RGB) */ 246 {0x01, 0x0004}, /* select sensor core registers */ 247 }; 248 static const struct i2c_write_cmd mt9v111_init_1[] = { 249 {0x03, 0x01e5}, /* window height */ 250 {0x04, 0x0285}, /* window width */ 251 }; 252 static const struct i2c_write_cmd mt9v111_init_2[] = { 253 {0x30, 0x7800}, 254 {0x31, 0x0000}, 255 {0x07, 0x3002}, /* output control */ 256 {0x35, 0x0020}, /* global gain */ 257 {0x2b, 0x0020}, /* green1 gain */ 258 {0x2c, 0x0020}, /* blue gain */ 259 {0x2d, 0x0020}, /* red gain */ 260 {0x2e, 0x0020}, /* green2 gain */ 261 }; 262 static const struct ucbus_write_cmd mt9v111_start_1[] = { 263 {0xf5f0, 0x11}, {0xf5f1, 0x96}, {0xf5f2, 0x80}, {0xf5f3, 0x80}, 264 {0xf5f4, 0xaa}, 265 {0xf5f0, 0x51}, {0xf5f1, 0x96}, {0xf5f2, 0x80}, {0xf5f3, 0x80}, 266 {0xf5f4, 0xaa}, 267 {0xf5fa, 0x00}, {0xf5f6, 0x0a}, {0xf5f7, 0x0a}, {0xf5f8, 0x0a}, 268 {0xf5f9, 0x0a} 269 }; 270 static const struct i2c_write_cmd mt9v111_init_3[] = { 271 {0x62, 0x0405}, 272 }; 273 static const struct i2c_write_cmd mt9v111_init_4[] = { 274 /* {0x05, 0x00ce}, */ 275 {0x05, 0x005d}, /* horizontal blanking */ 276 }; 277 278 static const struct ucbus_write_cmd ov7660_start_0[] = { 279 {0x0354, 0x00}, {0x03fa, 0x00}, {0xf332, 0x00}, {0xf333, 0xc0}, 280 {0xf334, 0x39}, {0xf335, 0xe7}, {0xf33f, 0x03} 281 }; 282 283 static const struct ucbus_write_cmd ov9630_start_0[] = { 284 {0x0354, 0x00}, {0x03fa, 0x00}, {0xf332, 0x00}, {0xf333, 0x00}, 285 {0xf334, 0x3e}, {0xf335, 0xf8}, {0xf33f, 0x03} 286 }; 287 288 /* start parameters indexed by [sensor][mode] */ 289 static const struct cap_s { 290 u8 cc_sizeid; 291 u8 cc_bytes[32]; 292 } capconfig[4][2] = { 293 [SENSOR_ICX098BQ] = { 294 {2, /* Bayer 320x240 */ 295 {0x05, 0x1f, 0x20, 0x0e, 0x00, 0x9f, 0x02, 0xee, 296 0x01, 0x01, 0x00, 0x08, 0x18, 0x12, 0x78, 0xc8, 297 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0, 298 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} }, 299 {4, /* Bayer 640x480 */ 300 {0x01, 0x1f, 0x20, 0x0e, 0x00, 0x9f, 0x02, 0xee, 301 0x01, 0x02, 0x00, 0x08, 0x18, 0x12, 0x78, 0xc8, 302 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 303 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} }, 304 }, 305 [SENSOR_LZ24BP] = { 306 {2, /* Bayer 320x240 */ 307 {0x05, 0x22, 0x20, 0x0e, 0x00, 0xa2, 0x02, 0xee, 308 0x01, 0x01, 0x00, 0x08, 0x18, 0x12, 0x78, 0xc8, 309 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 310 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} }, 311 {4, /* Bayer 640x480 */ 312 {0x01, 0x22, 0x20, 0x0e, 0x00, 0xa2, 0x02, 0xee, 313 0x01, 0x02, 0x00, 0x08, 0x18, 0x12, 0x78, 0xc8, 314 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 315 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} }, 316 }, 317 [SENSOR_MI0360] = { 318 {2, /* Bayer 320x240 */ 319 {0x05, 0x02, 0x20, 0x01, 0x20, 0x82, 0x02, 0xe1, 320 0x01, 0x01, 0x00, 0x08, 0x18, 0x12, 0x78, 0xc8, 321 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 322 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} }, 323 {4, /* Bayer 640x480 */ 324 {0x01, 0x02, 0x20, 0x01, 0x20, 0x82, 0x02, 0xe1, 325 0x01, 0x02, 0x00, 0x08, 0x18, 0x12, 0x78, 0xc8, 326 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 327 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} }, 328 }, 329 [SENSOR_MT9V111] = { 330 {2, /* Bayer 320x240 */ 331 {0x05, 0x02, 0x20, 0x01, 0x20, 0x82, 0x02, 0xe1, 332 0x01, 0x01, 0x00, 0x08, 0x18, 0x12, 0x78, 0xc8, 333 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 334 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} }, 335 {4, /* Bayer 640x480 */ 336 {0x01, 0x02, 0x20, 0x01, 0x20, 0x82, 0x02, 0xe1, 337 0x01, 0x02, 0x00, 0x08, 0x18, 0x12, 0x78, 0xc8, 338 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 339 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} }, 340 }, 341 }; 342 343 struct sensor_s { 344 const char *name; 345 u8 i2c_addr; 346 u8 i2c_dum; 347 u8 gpio[5]; 348 u8 cmd_len; 349 const struct ucbus_write_cmd *cmd; 350 }; 351 352 static const struct sensor_s sensor_tb[] = { 353 [SENSOR_ICX098BQ] = { 354 "icx098bp", 355 0x00, 0x00, 356 {0, 357 SQ930_GPIO_DFL_I2C_SDA | SQ930_GPIO_DFL_I2C_SCL, 358 SQ930_GPIO_DFL_I2C_SDA, 359 0, 360 SQ930_GPIO_RSTBAR 361 }, 362 8, icx098bq_start_0 363 }, 364 [SENSOR_LZ24BP] = { 365 "lz24bp", 366 0x00, 0x00, 367 {0, 368 SQ930_GPIO_DFL_I2C_SDA | SQ930_GPIO_DFL_I2C_SCL, 369 SQ930_GPIO_DFL_I2C_SDA, 370 0, 371 SQ930_GPIO_RSTBAR 372 }, 373 8, lz24bp_start_0 374 }, 375 [SENSOR_MI0360] = { 376 "mi0360", 377 0x5d, 0x80, 378 {SQ930_GPIO_RSTBAR, 379 SQ930_GPIO_DFL_I2C_SDA | SQ930_GPIO_DFL_I2C_SCL, 380 SQ930_GPIO_DFL_I2C_SDA, 381 0, 382 0 383 }, 384 7, mi0360_start_0 385 }, 386 [SENSOR_MT9V111] = { 387 "mt9v111", 388 0x5c, 0x7f, 389 {SQ930_GPIO_RSTBAR, 390 SQ930_GPIO_DFL_I2C_SDA | SQ930_GPIO_DFL_I2C_SCL, 391 SQ930_GPIO_DFL_I2C_SDA, 392 0, 393 0 394 }, 395 7, mi0360_start_0 396 }, 397 [SENSOR_OV7660] = { 398 "ov7660", 399 0x21, 0x00, 400 {0, 401 SQ930_GPIO_DFL_I2C_SDA | SQ930_GPIO_DFL_I2C_SCL, 402 SQ930_GPIO_DFL_I2C_SDA, 403 0, 404 SQ930_GPIO_RSTBAR 405 }, 406 7, ov7660_start_0 407 }, 408 [SENSOR_OV9630] = { 409 "ov9630", 410 0x30, 0x00, 411 {0, 412 SQ930_GPIO_DFL_I2C_SDA | SQ930_GPIO_DFL_I2C_SCL, 413 SQ930_GPIO_DFL_I2C_SDA, 414 0, 415 SQ930_GPIO_RSTBAR 416 }, 417 7, ov9630_start_0 418 }, 419 }; 420 421 static void reg_r(struct gspca_dev *gspca_dev, 422 u16 value, int len) 423 { 424 int ret; 425 426 if (gspca_dev->usb_err < 0) 427 return; 428 ret = usb_control_msg(gspca_dev->dev, 429 usb_rcvctrlpipe(gspca_dev->dev, 0), 430 0x0c, 431 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 432 value, 0, gspca_dev->usb_buf, len, 433 500); 434 if (ret < 0) { 435 pr_err("reg_r %04x failed %d\n", value, ret); 436 gspca_dev->usb_err = ret; 437 } 438 } 439 440 static void reg_w(struct gspca_dev *gspca_dev, u16 value, u16 index) 441 { 442 int ret; 443 444 if (gspca_dev->usb_err < 0) 445 return; 446 PDEBUG(D_USBO, "reg_w v: %04x i: %04x", value, index); 447 ret = usb_control_msg(gspca_dev->dev, 448 usb_sndctrlpipe(gspca_dev->dev, 0), 449 0x0c, /* request */ 450 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 451 value, index, NULL, 0, 452 500); 453 msleep(30); 454 if (ret < 0) { 455 pr_err("reg_w %04x %04x failed %d\n", value, index, ret); 456 gspca_dev->usb_err = ret; 457 } 458 } 459 460 static void reg_wb(struct gspca_dev *gspca_dev, u16 value, u16 index, 461 const u8 *data, int len) 462 { 463 int ret; 464 465 if (gspca_dev->usb_err < 0) 466 return; 467 PDEBUG(D_USBO, "reg_wb v: %04x i: %04x %02x...%02x", 468 value, index, *data, data[len - 1]); 469 memcpy(gspca_dev->usb_buf, data, len); 470 ret = usb_control_msg(gspca_dev->dev, 471 usb_sndctrlpipe(gspca_dev->dev, 0), 472 0x0c, /* request */ 473 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 474 value, index, gspca_dev->usb_buf, len, 475 1000); 476 msleep(30); 477 if (ret < 0) { 478 pr_err("reg_wb %04x %04x failed %d\n", value, index, ret); 479 gspca_dev->usb_err = ret; 480 } 481 } 482 483 static void i2c_write(struct sd *sd, 484 const struct i2c_write_cmd *cmd, 485 int ncmds) 486 { 487 struct gspca_dev *gspca_dev = &sd->gspca_dev; 488 const struct sensor_s *sensor; 489 u16 val, idx; 490 u8 *buf; 491 int ret; 492 493 if (gspca_dev->usb_err < 0) 494 return; 495 496 sensor = &sensor_tb[sd->sensor]; 497 498 val = (sensor->i2c_addr << 8) | SQ930_CTRL_I2C_IO; 499 idx = (cmd->val & 0xff00) | cmd->reg; 500 501 buf = gspca_dev->usb_buf; 502 *buf++ = sensor->i2c_dum; 503 *buf++ = cmd->val; 504 505 while (--ncmds > 0) { 506 cmd++; 507 *buf++ = cmd->reg; 508 *buf++ = cmd->val >> 8; 509 *buf++ = sensor->i2c_dum; 510 *buf++ = cmd->val; 511 } 512 513 PDEBUG(D_USBO, "i2c_w v: %04x i: %04x %02x...%02x", 514 val, idx, gspca_dev->usb_buf[0], buf[-1]); 515 ret = usb_control_msg(gspca_dev->dev, 516 usb_sndctrlpipe(gspca_dev->dev, 0), 517 0x0c, /* request */ 518 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 519 val, idx, 520 gspca_dev->usb_buf, buf - gspca_dev->usb_buf, 521 500); 522 if (ret < 0) { 523 pr_err("i2c_write failed %d\n", ret); 524 gspca_dev->usb_err = ret; 525 } 526 } 527 528 static void ucbus_write(struct gspca_dev *gspca_dev, 529 const struct ucbus_write_cmd *cmd, 530 int ncmds, 531 int batchsize) 532 { 533 u8 *buf; 534 u16 val, idx; 535 int len, ret; 536 537 if (gspca_dev->usb_err < 0) 538 return; 539 540 if ((batchsize - 1) * 3 > USB_BUF_SZ) { 541 PERR("Bug: usb_buf overflow\n"); 542 gspca_dev->usb_err = -ENOMEM; 543 return; 544 } 545 546 for (;;) { 547 len = ncmds; 548 if (len > batchsize) 549 len = batchsize; 550 ncmds -= len; 551 552 val = (cmd->bw_addr << 8) | SQ930_CTRL_UCBUS_IO; 553 idx = (cmd->bw_data << 8) | (cmd->bw_addr >> 8); 554 555 buf = gspca_dev->usb_buf; 556 while (--len > 0) { 557 cmd++; 558 *buf++ = cmd->bw_addr; 559 *buf++ = cmd->bw_addr >> 8; 560 *buf++ = cmd->bw_data; 561 } 562 if (buf != gspca_dev->usb_buf) 563 PDEBUG(D_USBO, "ucbus v: %04x i: %04x %02x...%02x", 564 val, idx, 565 gspca_dev->usb_buf[0], buf[-1]); 566 else 567 PDEBUG(D_USBO, "ucbus v: %04x i: %04x", 568 val, idx); 569 ret = usb_control_msg(gspca_dev->dev, 570 usb_sndctrlpipe(gspca_dev->dev, 0), 571 0x0c, /* request */ 572 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 573 val, idx, 574 gspca_dev->usb_buf, buf - gspca_dev->usb_buf, 575 500); 576 if (ret < 0) { 577 pr_err("ucbus_write failed %d\n", ret); 578 gspca_dev->usb_err = ret; 579 return; 580 } 581 msleep(30); 582 if (ncmds <= 0) 583 break; 584 cmd++; 585 } 586 } 587 588 static void gpio_set(struct sd *sd, u16 val, u16 mask) 589 { 590 struct gspca_dev *gspca_dev = &sd->gspca_dev; 591 592 if (mask & 0x00ff) { 593 sd->gpio[0] &= ~mask; 594 sd->gpio[0] |= val; 595 reg_w(gspca_dev, 0x0100 | SQ930_CTRL_GPIO, 596 ~sd->gpio[0] << 8); 597 } 598 mask >>= 8; 599 val >>= 8; 600 if (mask) { 601 sd->gpio[1] &= ~mask; 602 sd->gpio[1] |= val; 603 reg_w(gspca_dev, 0x0300 | SQ930_CTRL_GPIO, 604 ~sd->gpio[1] << 8); 605 } 606 } 607 608 static void gpio_init(struct sd *sd, 609 const u8 *gpio) 610 { 611 gpio_set(sd, *gpio++, 0x000f); 612 gpio_set(sd, *gpio++, 0x000f); 613 gpio_set(sd, *gpio++, 0x000f); 614 gpio_set(sd, *gpio++, 0x000f); 615 gpio_set(sd, *gpio, 0x000f); 616 } 617 618 static void bridge_init(struct sd *sd) 619 { 620 static const struct ucbus_write_cmd clkfreq_cmd = { 621 0xf031, 0 /* SQ930_CLKFREQ_60MHZ */ 622 }; 623 624 ucbus_write(&sd->gspca_dev, &clkfreq_cmd, 1, 1); 625 626 gpio_set(sd, SQ930_GPIO_POWER, 0xff00); 627 } 628 629 static void cmos_probe(struct gspca_dev *gspca_dev) 630 { 631 struct sd *sd = (struct sd *) gspca_dev; 632 int i; 633 const struct sensor_s *sensor; 634 static const u8 probe_order[] = { 635 /* SENSOR_LZ24BP, (tested as ccd) */ 636 SENSOR_OV9630, 637 SENSOR_MI0360, 638 SENSOR_OV7660, 639 SENSOR_MT9V111, 640 }; 641 642 for (i = 0; i < ARRAY_SIZE(probe_order); i++) { 643 sensor = &sensor_tb[probe_order[i]]; 644 ucbus_write(&sd->gspca_dev, sensor->cmd, sensor->cmd_len, 8); 645 gpio_init(sd, sensor->gpio); 646 msleep(100); 647 reg_r(gspca_dev, (sensor->i2c_addr << 8) | 0x001c, 1); 648 msleep(100); 649 if (gspca_dev->usb_buf[0] != 0) 650 break; 651 } 652 if (i >= ARRAY_SIZE(probe_order)) { 653 pr_err("Unknown sensor\n"); 654 gspca_dev->usb_err = -EINVAL; 655 return; 656 } 657 sd->sensor = probe_order[i]; 658 switch (sd->sensor) { 659 case SENSOR_OV7660: 660 case SENSOR_OV9630: 661 pr_err("Sensor %s not yet treated\n", 662 sensor_tb[sd->sensor].name); 663 gspca_dev->usb_err = -EINVAL; 664 break; 665 } 666 } 667 668 static void mt9v111_init(struct gspca_dev *gspca_dev) 669 { 670 int i, nwait; 671 static const u8 cmd_001b[] = { 672 0x00, 0x3b, 0xf6, 0x01, 0x03, 0x02, 0x00, 0x00, 673 0x00, 0x00, 0x00 674 }; 675 static const u8 cmd_011b[][7] = { 676 {0x10, 0x01, 0x66, 0x08, 0x00, 0x00, 0x00}, 677 {0x01, 0x00, 0x1a, 0x04, 0x00, 0x00, 0x00}, 678 {0x20, 0x00, 0x10, 0x04, 0x00, 0x00, 0x00}, 679 {0x02, 0x01, 0xae, 0x01, 0x00, 0x00, 0x00}, 680 }; 681 682 reg_wb(gspca_dev, 0x001b, 0x0000, cmd_001b, sizeof cmd_001b); 683 for (i = 0; i < ARRAY_SIZE(cmd_011b); i++) { 684 reg_wb(gspca_dev, 0x001b, 0x0000, cmd_011b[i], 685 ARRAY_SIZE(cmd_011b[0])); 686 msleep(400); 687 nwait = 20; 688 for (;;) { 689 reg_r(gspca_dev, 0x031b, 1); 690 if (gspca_dev->usb_buf[0] == 0 691 || gspca_dev->usb_err != 0) 692 break; 693 if (--nwait < 0) { 694 PDEBUG(D_PROBE, "mt9v111_init timeout"); 695 gspca_dev->usb_err = -ETIME; 696 return; 697 } 698 msleep(50); 699 } 700 } 701 } 702 703 static void global_init(struct sd *sd, int first_time) 704 { 705 switch (sd->sensor) { 706 case SENSOR_ICX098BQ: 707 if (first_time) 708 ucbus_write(&sd->gspca_dev, 709 icx098bq_start_0, 710 8, 8); 711 gpio_init(sd, sensor_tb[sd->sensor].gpio); 712 break; 713 case SENSOR_LZ24BP: 714 if (sd->type != Creative_live_motion) 715 gpio_set(sd, SQ930_GPIO_EXTRA1, 0x00ff); 716 else 717 gpio_set(sd, 0, 0x00ff); 718 msleep(50); 719 if (first_time) 720 ucbus_write(&sd->gspca_dev, 721 lz24bp_start_0, 722 8, 8); 723 gpio_init(sd, sensor_tb[sd->sensor].gpio); 724 break; 725 case SENSOR_MI0360: 726 if (first_time) 727 ucbus_write(&sd->gspca_dev, 728 mi0360_start_0, 729 ARRAY_SIZE(mi0360_start_0), 730 8); 731 gpio_init(sd, sensor_tb[sd->sensor].gpio); 732 gpio_set(sd, SQ930_GPIO_EXTRA2, SQ930_GPIO_EXTRA2); 733 break; 734 default: 735 /* case SENSOR_MT9V111: */ 736 if (first_time) 737 mt9v111_init(&sd->gspca_dev); 738 else 739 gpio_init(sd, sensor_tb[sd->sensor].gpio); 740 break; 741 } 742 } 743 744 static void lz24bp_ppl(struct sd *sd, u16 ppl) 745 { 746 struct ucbus_write_cmd cmds[2] = { 747 {0xf810, ppl >> 8}, 748 {0xf811, ppl} 749 }; 750 751 ucbus_write(&sd->gspca_dev, cmds, ARRAY_SIZE(cmds), 2); 752 } 753 754 static void setexposure(struct gspca_dev *gspca_dev, s32 expo, s32 gain) 755 { 756 struct sd *sd = (struct sd *) gspca_dev; 757 int i, integclks, intstartclk, frameclks, min_frclk; 758 const struct sensor_s *sensor; 759 u16 cmd; 760 u8 buf[15]; 761 762 integclks = expo; 763 i = 0; 764 cmd = SQ930_CTRL_SET_EXPOSURE; 765 766 switch (sd->sensor) { 767 case SENSOR_ICX098BQ: /* ccd */ 768 case SENSOR_LZ24BP: 769 min_frclk = sd->sensor == SENSOR_ICX098BQ ? 0x210 : 0x26f; 770 if (integclks >= min_frclk) { 771 intstartclk = 0; 772 frameclks = integclks; 773 } else { 774 intstartclk = min_frclk - integclks; 775 frameclks = min_frclk; 776 } 777 buf[i++] = intstartclk >> 8; 778 buf[i++] = intstartclk; 779 buf[i++] = frameclks >> 8; 780 buf[i++] = frameclks; 781 buf[i++] = gain; 782 break; 783 default: /* cmos */ 784 /* case SENSOR_MI0360: */ 785 /* case SENSOR_MT9V111: */ 786 cmd |= 0x0100; 787 sensor = &sensor_tb[sd->sensor]; 788 buf[i++] = sensor->i2c_addr; /* i2c_slave_addr */ 789 buf[i++] = 0x08; /* 2 * ni2c */ 790 buf[i++] = 0x09; /* reg = shutter width */ 791 buf[i++] = integclks >> 8; /* val H */ 792 buf[i++] = sensor->i2c_dum; 793 buf[i++] = integclks; /* val L */ 794 buf[i++] = 0x35; /* reg = global gain */ 795 buf[i++] = 0x00; /* val H */ 796 buf[i++] = sensor->i2c_dum; 797 buf[i++] = 0x80 + gain / 2; /* val L */ 798 buf[i++] = 0x00; 799 buf[i++] = 0x00; 800 buf[i++] = 0x00; 801 buf[i++] = 0x00; 802 buf[i++] = 0x83; 803 break; 804 } 805 reg_wb(gspca_dev, cmd, 0, buf, i); 806 } 807 808 /* This function is called at probe time just before sd_init */ 809 static int sd_config(struct gspca_dev *gspca_dev, 810 const struct usb_device_id *id) 811 { 812 struct sd *sd = (struct sd *) gspca_dev; 813 struct cam *cam = &gspca_dev->cam; 814 815 sd->sensor = id->driver_info >> 8; 816 sd->type = id->driver_info; 817 818 cam->cam_mode = vga_mode; 819 cam->nmodes = ARRAY_SIZE(vga_mode); 820 821 cam->bulk = 1; 822 823 return 0; 824 } 825 826 /* this function is called at probe and resume time */ 827 static int sd_init(struct gspca_dev *gspca_dev) 828 { 829 struct sd *sd = (struct sd *) gspca_dev; 830 831 sd->gpio[0] = sd->gpio[1] = 0xff; /* force gpio rewrite */ 832 833 /*fixme: is this needed for icx098bp and mi0360? 834 if (sd->sensor != SENSOR_LZ24BP) 835 reg_w(gspca_dev, SQ930_CTRL_RESET, 0x0000); 836 */ 837 838 reg_r(gspca_dev, SQ930_CTRL_GET_DEV_INFO, 8); 839 if (gspca_dev->usb_err < 0) 840 return gspca_dev->usb_err; 841 842 /* it returns: 843 * 03 00 12 93 0b f6 c9 00 live! ultra 844 * 03 00 07 93 0b f6 ca 00 live! ultra for notebook 845 * 03 00 12 93 0b fe c8 00 Trust WB-3500T 846 * 02 00 06 93 0b fe c8 00 Joy-IT 318S 847 * 03 00 12 93 0b f6 cf 00 icam tracer - sensor icx098bq 848 * 02 00 12 93 0b fe cf 00 ProQ Motion Webcam 849 * 850 * byte 851 * 0: 02 = usb 1.0 (12Mbit) / 03 = usb2.0 (480Mbit) 852 * 1: 00 853 * 2: 06 / 07 / 12 = mode webcam? firmware?? 854 * 3: 93 chip = 930b (930b or 930c) 855 * 4: 0b 856 * 5: f6 = cdd (icx098bq, lz24bp) / fe or de = cmos (i2c) (other sensors) 857 * 6: c8 / c9 / ca / cf = mode webcam?, sensor? webcam? 858 * 7: 00 859 */ 860 PDEBUG(D_PROBE, "info: %*ph", 8, gspca_dev->usb_buf); 861 862 bridge_init(sd); 863 864 if (sd->sensor == SENSOR_MI0360) { 865 866 /* no sensor probe for icam tracer */ 867 if (gspca_dev->usb_buf[5] == 0xf6) /* if ccd */ 868 sd->sensor = SENSOR_ICX098BQ; 869 else 870 cmos_probe(gspca_dev); 871 } 872 if (gspca_dev->usb_err >= 0) { 873 PDEBUG(D_PROBE, "Sensor %s", sensor_tb[sd->sensor].name); 874 global_init(sd, 1); 875 } 876 return gspca_dev->usb_err; 877 } 878 879 /* send the start/stop commands to the webcam */ 880 static void send_start(struct gspca_dev *gspca_dev) 881 { 882 struct sd *sd = (struct sd *) gspca_dev; 883 const struct cap_s *cap; 884 int mode; 885 886 mode = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv; 887 cap = &capconfig[sd->sensor][mode]; 888 reg_wb(gspca_dev, 0x0900 | SQ930_CTRL_CAP_START, 889 0x0a00 | cap->cc_sizeid, 890 cap->cc_bytes, 32); 891 } 892 893 static void send_stop(struct gspca_dev *gspca_dev) 894 { 895 reg_w(gspca_dev, SQ930_CTRL_CAP_STOP, 0); 896 } 897 898 /* function called at start time before URB creation */ 899 static int sd_isoc_init(struct gspca_dev *gspca_dev) 900 { 901 struct sd *sd = (struct sd *) gspca_dev; 902 903 gspca_dev->cam.bulk_nurbs = 1; /* there must be one URB only */ 904 sd->do_ctrl = 0; 905 gspca_dev->cam.bulk_size = gspca_dev->pixfmt.width * 906 gspca_dev->pixfmt.height + 8; 907 return 0; 908 } 909 910 /* start the capture */ 911 static int sd_start(struct gspca_dev *gspca_dev) 912 { 913 struct sd *sd = (struct sd *) gspca_dev; 914 int mode; 915 916 bridge_init(sd); 917 global_init(sd, 0); 918 msleep(100); 919 920 switch (sd->sensor) { 921 case SENSOR_ICX098BQ: 922 ucbus_write(gspca_dev, icx098bq_start_0, 923 ARRAY_SIZE(icx098bq_start_0), 924 8); 925 ucbus_write(gspca_dev, icx098bq_start_1, 926 ARRAY_SIZE(icx098bq_start_1), 927 5); 928 ucbus_write(gspca_dev, icx098bq_start_2, 929 ARRAY_SIZE(icx098bq_start_2), 930 6); 931 msleep(50); 932 933 /* 1st start */ 934 send_start(gspca_dev); 935 gpio_set(sd, SQ930_GPIO_EXTRA2 | SQ930_GPIO_RSTBAR, 0x00ff); 936 msleep(70); 937 reg_w(gspca_dev, SQ930_CTRL_CAP_STOP, 0x0000); 938 gpio_set(sd, 0x7f, 0x00ff); 939 940 /* 2nd start */ 941 send_start(gspca_dev); 942 gpio_set(sd, SQ930_GPIO_EXTRA2 | SQ930_GPIO_RSTBAR, 0x00ff); 943 goto out; 944 case SENSOR_LZ24BP: 945 ucbus_write(gspca_dev, lz24bp_start_0, 946 ARRAY_SIZE(lz24bp_start_0), 947 8); 948 if (sd->type != Creative_live_motion) 949 ucbus_write(gspca_dev, lz24bp_start_1_gen, 950 ARRAY_SIZE(lz24bp_start_1_gen), 951 5); 952 else 953 ucbus_write(gspca_dev, lz24bp_start_1_clm, 954 ARRAY_SIZE(lz24bp_start_1_clm), 955 5); 956 ucbus_write(gspca_dev, lz24bp_start_2, 957 ARRAY_SIZE(lz24bp_start_2), 958 6); 959 mode = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv; 960 lz24bp_ppl(sd, mode == 1 ? 0x0564 : 0x0310); 961 msleep(10); 962 break; 963 case SENSOR_MI0360: 964 ucbus_write(gspca_dev, mi0360_start_0, 965 ARRAY_SIZE(mi0360_start_0), 966 8); 967 i2c_write(sd, mi0360_init_23, 968 ARRAY_SIZE(mi0360_init_23)); 969 i2c_write(sd, mi0360_init_24, 970 ARRAY_SIZE(mi0360_init_24)); 971 i2c_write(sd, mi0360_init_25, 972 ARRAY_SIZE(mi0360_init_25)); 973 ucbus_write(gspca_dev, mi0360_start_1, 974 ARRAY_SIZE(mi0360_start_1), 975 5); 976 i2c_write(sd, mi0360_start_2, 977 ARRAY_SIZE(mi0360_start_2)); 978 i2c_write(sd, mi0360_start_3, 979 ARRAY_SIZE(mi0360_start_3)); 980 981 /* 1st start */ 982 send_start(gspca_dev); 983 msleep(60); 984 send_stop(gspca_dev); 985 986 i2c_write(sd, 987 mi0360_start_4, ARRAY_SIZE(mi0360_start_4)); 988 break; 989 default: 990 /* case SENSOR_MT9V111: */ 991 ucbus_write(gspca_dev, mi0360_start_0, 992 ARRAY_SIZE(mi0360_start_0), 993 8); 994 i2c_write(sd, mt9v111_init_0, 995 ARRAY_SIZE(mt9v111_init_0)); 996 i2c_write(sd, mt9v111_init_1, 997 ARRAY_SIZE(mt9v111_init_1)); 998 i2c_write(sd, mt9v111_init_2, 999 ARRAY_SIZE(mt9v111_init_2)); 1000 ucbus_write(gspca_dev, mt9v111_start_1, 1001 ARRAY_SIZE(mt9v111_start_1), 1002 5); 1003 i2c_write(sd, mt9v111_init_3, 1004 ARRAY_SIZE(mt9v111_init_3)); 1005 i2c_write(sd, mt9v111_init_4, 1006 ARRAY_SIZE(mt9v111_init_4)); 1007 break; 1008 } 1009 1010 send_start(gspca_dev); 1011 out: 1012 msleep(1000); 1013 1014 if (sd->sensor == SENSOR_MT9V111) 1015 gpio_set(sd, SQ930_GPIO_DFL_LED, SQ930_GPIO_DFL_LED); 1016 1017 sd->do_ctrl = 1; /* set the exposure */ 1018 1019 return gspca_dev->usb_err; 1020 } 1021 1022 static void sd_stopN(struct gspca_dev *gspca_dev) 1023 { 1024 struct sd *sd = (struct sd *) gspca_dev; 1025 1026 if (sd->sensor == SENSOR_MT9V111) 1027 gpio_set(sd, 0, SQ930_GPIO_DFL_LED); 1028 send_stop(gspca_dev); 1029 } 1030 1031 /* function called when the application gets a new frame */ 1032 /* It sets the exposure if required and restart the bulk transfer. */ 1033 static void sd_dq_callback(struct gspca_dev *gspca_dev) 1034 { 1035 struct sd *sd = (struct sd *) gspca_dev; 1036 int ret; 1037 1038 if (!sd->do_ctrl || gspca_dev->cam.bulk_nurbs != 0) 1039 return; 1040 sd->do_ctrl = 0; 1041 1042 setexposure(gspca_dev, v4l2_ctrl_g_ctrl(sd->exposure), 1043 v4l2_ctrl_g_ctrl(sd->gain)); 1044 1045 gspca_dev->cam.bulk_nurbs = 1; 1046 ret = usb_submit_urb(gspca_dev->urb[0], GFP_ATOMIC); 1047 if (ret < 0) 1048 pr_err("sd_dq_callback() err %d\n", ret); 1049 1050 /* wait a little time, otherwise the webcam crashes */ 1051 msleep(100); 1052 } 1053 1054 static void sd_pkt_scan(struct gspca_dev *gspca_dev, 1055 u8 *data, /* isoc packet */ 1056 int len) /* iso packet length */ 1057 { 1058 struct sd *sd = (struct sd *) gspca_dev; 1059 1060 if (sd->do_ctrl) 1061 gspca_dev->cam.bulk_nurbs = 0; 1062 gspca_frame_add(gspca_dev, FIRST_PACKET, NULL, 0); 1063 gspca_frame_add(gspca_dev, INTER_PACKET, data, len - 8); 1064 gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0); 1065 } 1066 1067 static int sd_s_ctrl(struct v4l2_ctrl *ctrl) 1068 { 1069 struct gspca_dev *gspca_dev = 1070 container_of(ctrl->handler, struct gspca_dev, ctrl_handler); 1071 struct sd *sd = (struct sd *) gspca_dev; 1072 1073 gspca_dev->usb_err = 0; 1074 1075 if (!gspca_dev->streaming) 1076 return 0; 1077 1078 switch (ctrl->id) { 1079 case V4L2_CID_EXPOSURE: 1080 setexposure(gspca_dev, ctrl->val, sd->gain->val); 1081 break; 1082 } 1083 return gspca_dev->usb_err; 1084 } 1085 1086 static const struct v4l2_ctrl_ops sd_ctrl_ops = { 1087 .s_ctrl = sd_s_ctrl, 1088 }; 1089 1090 static int sd_init_controls(struct gspca_dev *gspca_dev) 1091 { 1092 struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler; 1093 struct sd *sd = (struct sd *) gspca_dev; 1094 1095 gspca_dev->vdev.ctrl_handler = hdl; 1096 v4l2_ctrl_handler_init(hdl, 2); 1097 sd->exposure = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops, 1098 V4L2_CID_EXPOSURE, 1, 0xfff, 1, 0x356); 1099 sd->gain = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops, 1100 V4L2_CID_GAIN, 1, 255, 1, 0x8d); 1101 1102 if (hdl->error) { 1103 pr_err("Could not initialize controls\n"); 1104 return hdl->error; 1105 } 1106 v4l2_ctrl_cluster(2, &sd->exposure); 1107 return 0; 1108 } 1109 1110 /* sub-driver description */ 1111 static const struct sd_desc sd_desc = { 1112 .name = MODULE_NAME, 1113 .config = sd_config, 1114 .init = sd_init, 1115 .init_controls = sd_init_controls, 1116 .isoc_init = sd_isoc_init, 1117 .start = sd_start, 1118 .stopN = sd_stopN, 1119 .pkt_scan = sd_pkt_scan, 1120 .dq_callback = sd_dq_callback, 1121 }; 1122 1123 /* Table of supported USB devices */ 1124 #define ST(sensor, type) \ 1125 .driver_info = (SENSOR_ ## sensor << 8) \ 1126 | (type) 1127 static const struct usb_device_id device_table[] = { 1128 {USB_DEVICE(0x041e, 0x4038), ST(MI0360, 0)}, 1129 {USB_DEVICE(0x041e, 0x403c), ST(LZ24BP, 0)}, 1130 {USB_DEVICE(0x041e, 0x403d), ST(LZ24BP, 0)}, 1131 {USB_DEVICE(0x041e, 0x4041), ST(LZ24BP, Creative_live_motion)}, 1132 {USB_DEVICE(0x2770, 0x930b), ST(MI0360, 0)}, 1133 {USB_DEVICE(0x2770, 0x930c), ST(MI0360, 0)}, 1134 {} 1135 }; 1136 MODULE_DEVICE_TABLE(usb, device_table); 1137 1138 1139 /* -- device connect -- */ 1140 static int sd_probe(struct usb_interface *intf, 1141 const struct usb_device_id *id) 1142 { 1143 return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd), 1144 THIS_MODULE); 1145 } 1146 1147 static struct usb_driver sd_driver = { 1148 .name = MODULE_NAME, 1149 .id_table = device_table, 1150 .probe = sd_probe, 1151 .disconnect = gspca_disconnect, 1152 #ifdef CONFIG_PM 1153 .suspend = gspca_suspend, 1154 .resume = gspca_resume, 1155 .reset_resume = gspca_resume, 1156 #endif 1157 }; 1158 1159 module_usb_driver(sd_driver); 1160