1 // SPDX-License-Identifier: GPL-2.0+ 2 // 3 // em28xx-camera.c - driver for Empia EM25xx/27xx/28xx USB video capture devices 4 // 5 // Copyright (C) 2009 Mauro Carvalho Chehab <mchehab@kernel.org> 6 // Copyright (C) 2013 Frank Schäfer <fschaefer.oss@googlemail.com> 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 // (at your option) 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 #include "em28xx.h" 19 20 #include <linux/i2c.h> 21 #include <linux/usb.h> 22 #include <media/i2c/mt9v011.h> 23 #include <media/v4l2-common.h> 24 25 /* Possible i2c addresses of Micron sensors */ 26 static unsigned short micron_sensor_addrs[] = { 27 0xb8 >> 1, /* MT9V111, MT9V403 */ 28 0xba >> 1, /* MT9M001/011/111/112, MT9V011/012/112, MT9D011 */ 29 0x90 >> 1, /* MT9V012/112, MT9D011 (alternative address) */ 30 I2C_CLIENT_END 31 }; 32 33 /* Possible i2c addresses of Omnivision sensors */ 34 static unsigned short omnivision_sensor_addrs[] = { 35 0x42 >> 1, /* OV7725, OV7670/60/48 */ 36 0x60 >> 1, /* OV2640, OV9650/53/55 */ 37 I2C_CLIENT_END 38 }; 39 40 /* FIXME: Should be replaced by a proper mt9m111 driver */ 41 static int em28xx_initialize_mt9m111(struct em28xx *dev) 42 { 43 int i; 44 unsigned char regs[][3] = { 45 { 0x0d, 0x00, 0x01, }, /* reset and use defaults */ 46 { 0x0d, 0x00, 0x00, }, 47 { 0x0a, 0x00, 0x21, }, 48 { 0x21, 0x04, 0x00, }, /* full readout spd, no row/col skip */ 49 }; 50 51 for (i = 0; i < ARRAY_SIZE(regs); i++) 52 i2c_master_send(&dev->i2c_client[dev->def_i2c_bus], 53 ®s[i][0], 3); 54 55 /* FIXME: This won't be creating a sensor at the media graph */ 56 57 return 0; 58 } 59 60 /* FIXME: Should be replaced by a proper mt9m001 driver */ 61 static int em28xx_initialize_mt9m001(struct em28xx *dev) 62 { 63 int i; 64 unsigned char regs[][3] = { 65 { 0x0d, 0x00, 0x01, }, 66 { 0x0d, 0x00, 0x00, }, 67 { 0x04, 0x05, 0x00, }, /* hres = 1280 */ 68 { 0x03, 0x04, 0x00, }, /* vres = 1024 */ 69 { 0x20, 0x11, 0x00, }, 70 { 0x06, 0x00, 0x10, }, 71 { 0x2b, 0x00, 0x24, }, 72 { 0x2e, 0x00, 0x24, }, 73 { 0x35, 0x00, 0x24, }, 74 { 0x2d, 0x00, 0x20, }, 75 { 0x2c, 0x00, 0x20, }, 76 { 0x09, 0x0a, 0xd4, }, 77 { 0x35, 0x00, 0x57, }, 78 }; 79 80 for (i = 0; i < ARRAY_SIZE(regs); i++) 81 i2c_master_send(&dev->i2c_client[dev->def_i2c_bus], 82 ®s[i][0], 3); 83 84 /* FIXME: This won't be creating a sensor at the media graph */ 85 86 return 0; 87 } 88 89 /* 90 * Probes Micron sensors with 8 bit address and 16 bit register width 91 */ 92 static int em28xx_probe_sensor_micron(struct em28xx *dev) 93 { 94 int ret, i; 95 char *name; 96 u16 id; 97 98 struct i2c_client *client = &dev->i2c_client[dev->def_i2c_bus]; 99 100 dev->em28xx_sensor = EM28XX_NOSENSOR; 101 for (i = 0; micron_sensor_addrs[i] != I2C_CLIENT_END; i++) { 102 client->addr = micron_sensor_addrs[i]; 103 /* Read chip ID from register 0x00 */ 104 ret = i2c_smbus_read_word_data(client, 0x00); /* assumes LE */ 105 if (ret < 0) { 106 if (ret != -ENXIO) 107 dev_err(&dev->intf->dev, 108 "couldn't read from i2c device 0x%02x: error %i\n", 109 client->addr << 1, ret); 110 continue; 111 } 112 id = swab16(ret); /* LE -> BE */ 113 /* Read chip ID from register 0xff */ 114 ret = i2c_smbus_read_word_data(client, 0xff); 115 if (ret < 0) { 116 dev_err(&dev->intf->dev, 117 "couldn't read from i2c device 0x%02x: error %i\n", 118 client->addr << 1, ret); 119 continue; 120 } 121 /* Validate chip ID to be sure we have a Micron device */ 122 if (id != swab16(ret)) 123 continue; 124 /* Check chip ID */ 125 switch (id) { 126 case 0x1222: 127 name = "MT9V012"; /* MI370 */ /* 640x480 */ 128 break; 129 case 0x1229: 130 name = "MT9V112"; /* 640x480 */ 131 break; 132 case 0x1433: 133 name = "MT9M011"; /* 1280x1024 */ 134 break; 135 case 0x143a: /* found in the ECS G200 */ 136 name = "MT9M111"; /* MI1310 */ /* 1280x1024 */ 137 dev->em28xx_sensor = EM28XX_MT9M111; 138 break; 139 case 0x148c: 140 name = "MT9M112"; /* MI1320 */ /* 1280x1024 */ 141 break; 142 case 0x1511: 143 name = "MT9D011"; /* MI2010 */ /* 1600x1200 */ 144 break; 145 case 0x8232: 146 case 0x8243: /* rev B */ 147 name = "MT9V011"; /* MI360 */ /* 640x480 */ 148 dev->em28xx_sensor = EM28XX_MT9V011; 149 break; 150 case 0x8431: 151 name = "MT9M001"; /* 1280x1024 */ 152 dev->em28xx_sensor = EM28XX_MT9M001; 153 break; 154 default: 155 dev_info(&dev->intf->dev, 156 "unknown Micron sensor detected: 0x%04x\n", 157 id); 158 return 0; 159 } 160 161 if (dev->em28xx_sensor == EM28XX_NOSENSOR) 162 dev_info(&dev->intf->dev, 163 "unsupported sensor detected: %s\n", name); 164 else 165 dev_info(&dev->intf->dev, 166 "sensor %s detected\n", name); 167 168 return 0; 169 } 170 171 return -ENODEV; 172 } 173 174 /* 175 * Probes Omnivision sensors with 8 bit address and register width 176 */ 177 static int em28xx_probe_sensor_omnivision(struct em28xx *dev) 178 { 179 int ret, i; 180 char *name; 181 u8 reg; 182 u16 id; 183 struct i2c_client *client = &dev->i2c_client[dev->def_i2c_bus]; 184 185 dev->em28xx_sensor = EM28XX_NOSENSOR; 186 /* 187 * NOTE: these devices have the register auto incrementation disabled 188 * by default, so we have to use single byte reads ! 189 */ 190 for (i = 0; omnivision_sensor_addrs[i] != I2C_CLIENT_END; i++) { 191 client->addr = omnivision_sensor_addrs[i]; 192 /* Read manufacturer ID from registers 0x1c-0x1d (BE) */ 193 reg = 0x1c; 194 ret = i2c_smbus_read_byte_data(client, reg); 195 if (ret < 0) { 196 if (ret != -ENXIO) 197 dev_err(&dev->intf->dev, 198 "couldn't read from i2c device 0x%02x: error %i\n", 199 client->addr << 1, ret); 200 continue; 201 } 202 id = ret << 8; 203 reg = 0x1d; 204 ret = i2c_smbus_read_byte_data(client, reg); 205 if (ret < 0) { 206 dev_err(&dev->intf->dev, 207 "couldn't read from i2c device 0x%02x: error %i\n", 208 client->addr << 1, ret); 209 continue; 210 } 211 id += ret; 212 /* Check manufacturer ID */ 213 if (id != 0x7fa2) 214 continue; 215 /* Read product ID from registers 0x0a-0x0b (BE) */ 216 reg = 0x0a; 217 ret = i2c_smbus_read_byte_data(client, reg); 218 if (ret < 0) { 219 dev_err(&dev->intf->dev, 220 "couldn't read from i2c device 0x%02x: error %i\n", 221 client->addr << 1, ret); 222 continue; 223 } 224 id = ret << 8; 225 reg = 0x0b; 226 ret = i2c_smbus_read_byte_data(client, reg); 227 if (ret < 0) { 228 dev_err(&dev->intf->dev, 229 "couldn't read from i2c device 0x%02x: error %i\n", 230 client->addr << 1, ret); 231 continue; 232 } 233 id += ret; 234 /* Check product ID */ 235 switch (id) { 236 case 0x2642: 237 name = "OV2640"; 238 dev->em28xx_sensor = EM28XX_OV2640; 239 break; 240 case 0x7648: 241 name = "OV7648"; 242 break; 243 case 0x7660: 244 name = "OV7660"; 245 break; 246 case 0x7673: 247 name = "OV7670"; 248 break; 249 case 0x7720: 250 name = "OV7720"; 251 break; 252 case 0x7721: 253 name = "OV7725"; 254 break; 255 case 0x9648: /* Rev 2 */ 256 case 0x9649: /* Rev 3 */ 257 name = "OV9640"; 258 break; 259 case 0x9650: 260 case 0x9652: /* OV9653 */ 261 name = "OV9650"; 262 break; 263 case 0x9656: /* Rev 4 */ 264 case 0x9657: /* Rev 5 */ 265 name = "OV9655"; 266 break; 267 default: 268 dev_info(&dev->intf->dev, 269 "unknown OmniVision sensor detected: 0x%04x\n", 270 id); 271 return 0; 272 } 273 274 if (dev->em28xx_sensor == EM28XX_NOSENSOR) 275 dev_info(&dev->intf->dev, 276 "unsupported sensor detected: %s\n", name); 277 else 278 dev_info(&dev->intf->dev, 279 "sensor %s detected\n", name); 280 281 return 0; 282 } 283 284 return -ENODEV; 285 } 286 287 int em28xx_detect_sensor(struct em28xx *dev) 288 { 289 int ret; 290 291 ret = em28xx_probe_sensor_micron(dev); 292 293 if (dev->em28xx_sensor == EM28XX_NOSENSOR && ret < 0) 294 ret = em28xx_probe_sensor_omnivision(dev); 295 296 /* 297 * NOTE: the Windows driver also probes i2c addresses 298 * 0x22 (Samsung ?) and 0x66 (Kodak ?) 299 */ 300 301 if (dev->em28xx_sensor == EM28XX_NOSENSOR && ret < 0) { 302 dev_info(&dev->intf->dev, 303 "No sensor detected\n"); 304 return -ENODEV; 305 } 306 307 return 0; 308 } 309 310 int em28xx_init_camera(struct em28xx *dev) 311 { 312 struct i2c_client *client = &dev->i2c_client[dev->def_i2c_bus]; 313 struct i2c_adapter *adap = &dev->i2c_adap[dev->def_i2c_bus]; 314 struct em28xx_v4l2 *v4l2 = dev->v4l2; 315 316 switch (dev->em28xx_sensor) { 317 case EM28XX_MT9V011: 318 { 319 struct mt9v011_platform_data pdata; 320 struct i2c_board_info mt9v011_info = { 321 .type = "mt9v011", 322 .addr = client->addr, 323 .platform_data = &pdata, 324 }; 325 326 v4l2->sensor_xres = 640; 327 v4l2->sensor_yres = 480; 328 329 /* 330 * FIXME: mt9v011 uses I2S speed as xtal clk - at least with 331 * the Silvercrest cam I have here for testing - for higher 332 * resolutions, a high clock cause horizontal artifacts, so we 333 * need to use a lower xclk frequency. 334 * Yet, it would be possible to adjust xclk depending on the 335 * desired resolution, since this affects directly the 336 * frame rate. 337 */ 338 dev->board.xclk = EM28XX_XCLK_FREQUENCY_4_3MHZ; 339 em28xx_write_reg(dev, EM28XX_R0F_XCLK, dev->board.xclk); 340 v4l2->sensor_xtal = 4300000; 341 pdata.xtal = v4l2->sensor_xtal; 342 if (NULL == 343 v4l2_i2c_new_subdev_board(&v4l2->v4l2_dev, adap, 344 &mt9v011_info, NULL)) 345 return -ENODEV; 346 v4l2->vinmode = EM28XX_VINMODE_RGB8_GRBG; 347 v4l2->vinctl = 0x00; 348 349 break; 350 } 351 case EM28XX_MT9M001: 352 v4l2->sensor_xres = 1280; 353 v4l2->sensor_yres = 1024; 354 355 em28xx_initialize_mt9m001(dev); 356 357 v4l2->vinmode = EM28XX_VINMODE_RGB8_BGGR; 358 v4l2->vinctl = 0x00; 359 360 break; 361 case EM28XX_MT9M111: 362 v4l2->sensor_xres = 640; 363 v4l2->sensor_yres = 512; 364 365 dev->board.xclk = EM28XX_XCLK_FREQUENCY_48MHZ; 366 em28xx_write_reg(dev, EM28XX_R0F_XCLK, dev->board.xclk); 367 em28xx_initialize_mt9m111(dev); 368 369 v4l2->vinmode = EM28XX_VINMODE_YUV422_UYVY; 370 v4l2->vinctl = 0x00; 371 372 break; 373 case EM28XX_OV2640: 374 { 375 struct v4l2_subdev *subdev; 376 struct i2c_board_info ov2640_info = { 377 .type = "ov2640", 378 .flags = I2C_CLIENT_SCCB, 379 .addr = client->addr, 380 }; 381 struct v4l2_subdev_format format = { 382 .which = V4L2_SUBDEV_FORMAT_ACTIVE, 383 }; 384 385 /* 386 * FIXME: sensor supports resolutions up to 1600x1200, but 387 * resolution setting/switching needs to be modified to 388 * - switch sensor output resolution (including further 389 * configuration changes) 390 * - adjust bridge xclk 391 * - disable 16 bit (12 bit) output formats on high resolutions 392 */ 393 v4l2->sensor_xres = 640; 394 v4l2->sensor_yres = 480; 395 396 subdev = 397 v4l2_i2c_new_subdev_board(&v4l2->v4l2_dev, adap, 398 &ov2640_info, NULL); 399 if (!subdev) 400 return -ENODEV; 401 402 format.format.code = MEDIA_BUS_FMT_YUYV8_2X8; 403 format.format.width = 640; 404 format.format.height = 480; 405 v4l2_subdev_call(subdev, pad, set_fmt, NULL, &format); 406 407 /* NOTE: for UXGA=1600x1200 switch to 12MHz */ 408 dev->board.xclk = EM28XX_XCLK_FREQUENCY_24MHZ; 409 em28xx_write_reg(dev, EM28XX_R0F_XCLK, dev->board.xclk); 410 v4l2->vinmode = EM28XX_VINMODE_YUV422_YUYV; 411 v4l2->vinctl = 0x00; 412 413 break; 414 } 415 case EM28XX_NOSENSOR: 416 default: 417 return -EINVAL; 418 } 419 420 return 0; 421 } 422 EXPORT_SYMBOL_GPL(em28xx_init_camera); 423