drivers/media/usb/gspca/m5602/m5602_core.c

   1  /*
   2  * USB Driver for ALi m5602 based webcams
   3  *
   4  * Copyright (C) 2008 Erik Andrén
   5  * Copyright (C) 2007 Ilyes Gouta. Based on the m5603x Linux Driver Project.
   6  * Copyright (C) 2005 m5603x Linux Driver Project <m5602@x3ng.com.br>
   7  *
   8  * Portions of code to USB interface and ALi driver software,
   9  * Copyright (c) 2006 Willem Duinker
  10  * v4l2 interface modeled after the V4L2 driver
  11  * for SN9C10x PC Camera Controllers
  12  *
  13  * This program is free software; you can redistribute it and/or
  14  * modify it under the terms of the GNU General Public License as
  15  * published by the Free Software Foundation, version 2.
  16  *
  17  */
  18
  19 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  20
  21 #include "m5602_ov9650.h"
  22 #include "m5602_ov7660.h"
  23 #include "m5602_mt9m111.h"
  24 #include "m5602_po1030.h"
  25 #include "m5602_s5k83a.h"
  26 #include "m5602_s5k4aa.h"
  27
  28 /* Kernel module parameters */
  29 int force_sensor;
  30 static bool dump_bridge;
  31 bool dump_sensor;
  32
  33 static const struct usb_device_id m5602_table[] = {
  34         {USB_DEVICE(0x0402, 0x5602)},
  35         {}
  36 };
  37
  38 MODULE_DEVICE_TABLE(usb, m5602_table);
  39
  40 /* A skeleton used for sending messages to the sensor */
  41 static const unsigned char sensor_urb_skeleton[] = {
  42         0x23, M5602_XB_GPIO_EN_H, 0x81, 0x06,
  43         0x23, M5602_XB_MISC_CTRL, 0x81, 0x80,
  44         0x13, M5602_XB_I2C_DEV_ADDR, 0x81, 0x00,
  45         0x13, M5602_XB_I2C_REG_ADDR, 0x81, 0x00,
  46         0x13, M5602_XB_I2C_DATA, 0x81, 0x00,
  47         0x13, M5602_XB_I2C_CTRL, 0x81, 0x11
  48 };
  49
  50 /* A skeleton used for sending messages to the m5602 bridge */
  51 static const unsigned char bridge_urb_skeleton[] = {
  52         0x13, 0x00, 0x81, 0x00
  53 };
  54
  55 /* Reads a byte from the m5602 */
  56 int m5602_read_bridge(struct sd *sd, const u8 address, u8 *i2c_data)
  57 {
  58         int err;
  59         struct gspca_dev *gspca_dev = (struct gspca_dev *) sd;
  60         struct usb_device *udev = sd->gspca_dev.dev;
  61         __u8 *buf = sd->gspca_dev.usb_buf;
  62
  63         err = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
  64                               0x04, 0xc0, 0x14,
  65                               0x8100 + address, buf,
  66                               1, M5602_URB_MSG_TIMEOUT);
  67         *i2c_data = buf[0];
  68
  69         gspca_dbg(gspca_dev, D_CONF, "Reading bridge register 0x%x containing 0x%x\n",
  70                   address, *i2c_data);
  71
  72         /* usb_control_msg(...) returns the number of bytes sent upon success,
  73         mask that and return zero instead*/
  74         return (err < 0) ? err : 0;
  75 }
  76
  77 /* Writes a byte to the m5602 */
  78 int m5602_write_bridge(struct sd *sd, const u8 address, const u8 i2c_data)
  79 {
  80         int err;
  81         struct gspca_dev *gspca_dev = (struct gspca_dev *) sd;
  82         struct usb_device *udev = sd->gspca_dev.dev;
  83         __u8 *buf = sd->gspca_dev.usb_buf;
  84
  85         gspca_dbg(gspca_dev, D_CONF, "Writing bridge register 0x%x with 0x%x\n",
  86                   address, i2c_data);
  87
  88         memcpy(buf, bridge_urb_skeleton,
  89                sizeof(bridge_urb_skeleton));
  90         buf[1] = address;
  91         buf[3] = i2c_data;
  92
  93         err = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
  94                                 0x04, 0x40, 0x19,
  95                                 0x0000, buf,
  96                                 4, M5602_URB_MSG_TIMEOUT);
  97
  98         /* usb_control_msg(...) returns the number of bytes sent upon success,
  99            mask that and return zero instead */
 100         return (err < 0) ? err : 0;
 101 }
 102
 103 static int m5602_wait_for_i2c(struct sd *sd)
 104 {
 105         int err;
 106         u8 data;
 107
 108         do {
 109                 err = m5602_read_bridge(sd, M5602_XB_I2C_STATUS, &data);
 110         } while ((data & I2C_BUSY) && !err);
 111         return err;
 112 }
 113
 114 int m5602_read_sensor(struct sd *sd, const u8 address,
 115                        u8 *i2c_data, const u8 len)
 116 {
 117         int err, i;
 118         struct gspca_dev *gspca_dev = (struct gspca_dev *) sd;
 119
 120         if (!len || len > sd->sensor->i2c_regW)
 121                 return -EINVAL;
 122
 123         err = m5602_wait_for_i2c(sd);
 124         if (err < 0)
 125                 return err;
 126
 127         err = m5602_write_bridge(sd, M5602_XB_I2C_DEV_ADDR,
 128                                  sd->sensor->i2c_slave_id);
 129         if (err < 0)
 130                 return err;
 131
 132         err = m5602_write_bridge(sd, M5602_XB_I2C_REG_ADDR, address);
 133         if (err < 0)
 134                 return err;
 135
 136         /* Sensors with registers that are of only
 137            one byte width are differently read */
 138
 139         /* FIXME: This works with the ov9650, but has issues with the po1030 */
 140         if (sd->sensor->i2c_regW == 1) {
 141                 err = m5602_write_bridge(sd, M5602_XB_I2C_CTRL, 1);
 142                 if (err < 0)
 143                         return err;
 144
 145                 err = m5602_write_bridge(sd, M5602_XB_I2C_CTRL, 0x08);
 146         } else {
 147                 err = m5602_write_bridge(sd, M5602_XB_I2C_CTRL, 0x18 + len);
 148         }
 149
 150         for (i = 0; (i < len) && !err; i++) {
 151                 err = m5602_wait_for_i2c(sd);
 152                 if (err < 0)
 153                         return err;
 154
 155                 err = m5602_read_bridge(sd, M5602_XB_I2C_DATA, &(i2c_data[i]));
 156
 157                 gspca_dbg(gspca_dev, D_CONF, "Reading sensor register 0x%x containing 0x%x\n",
 158                           address, *i2c_data);
 159         }
 160         return err;
 161 }
 162
 163 int m5602_write_sensor(struct sd *sd, const u8 address,
 164                         u8 *i2c_data, const u8 len)
 165 {
 166         int err, i;
 167         u8 *p;
 168         struct gspca_dev *gspca_dev = (struct gspca_dev *) sd;
 169         struct usb_device *udev = sd->gspca_dev.dev;
 170         __u8 *buf = sd->gspca_dev.usb_buf;
 171
 172         /* No sensor with a data width larger than 16 bits has yet been seen */
 173         if (len > sd->sensor->i2c_regW || !len)
 174                 return -EINVAL;
 175
 176         memcpy(buf, sensor_urb_skeleton,
 177                sizeof(sensor_urb_skeleton));
 178
 179         buf[11] = sd->sensor->i2c_slave_id;
 180         buf[15] = address;
 181
 182         /* Special case larger sensor writes */
 183         p = buf + 16;
 184
 185         /* Copy a four byte write sequence for each byte to be written to */
 186         for (i = 0; i < len; i++) {
 187                 memcpy(p, sensor_urb_skeleton + 16, 4);
 188                 p[3] = i2c_data[i];
 189                 p += 4;
 190                 gspca_dbg(gspca_dev, D_CONF, "Writing sensor register 0x%x with 0x%x\n",
 191                           address, i2c_data[i]);
 192         }
 193
 194         /* Copy the tailer */
 195         memcpy(p, sensor_urb_skeleton + 20, 4);
 196
 197         /* Set the total length */
 198         p[3] = 0x10 + len;
 199
 200         err = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
 201                               0x04, 0x40, 0x19,
 202                               0x0000, buf,
 203                               20 + len * 4, M5602_URB_MSG_TIMEOUT);
 204
 205         return (err < 0) ? err : 0;
 206 }
 207
 208 /* Dump all the registers of the m5602 bridge,
 209    unfortunately this breaks the camera until it's power cycled */
 210 static void m5602_dump_bridge(struct sd *sd)
 211 {
 212         int i;
 213         for (i = 0; i < 0x80; i++) {
 214                 unsigned char val = 0;
 215                 m5602_read_bridge(sd, i, &val);
 216                 pr_info("ALi m5602 address 0x%x contains 0x%x\n", i, val);
 217         }
 218         pr_info("Warning: The ALi m5602 webcam probably won't work until it's power cycled\n");
 219 }
 220
 221 static int m5602_probe_sensor(struct sd *sd)
 222 {
 223         /* Try the po1030 */
 224         sd->sensor = &po1030;
 225         if (!sd->sensor->probe(sd))
 226                 return 0;
 227
 228         /* Try the mt9m111 sensor */
 229         sd->sensor = &mt9m111;
 230         if (!sd->sensor->probe(sd))
 231                 return 0;
 232
 233         /* Try the s5k4aa */
 234         sd->sensor = &s5k4aa;
 235         if (!sd->sensor->probe(sd))
 236                 return 0;
 237
 238         /* Try the ov9650 */
 239         sd->sensor = &ov9650;
 240         if (!sd->sensor->probe(sd))
 241                 return 0;
 242
 243         /* Try the ov7660 */
 244         sd->sensor = &ov7660;
 245         if (!sd->sensor->probe(sd))
 246                 return 0;
 247
 248         /* Try the s5k83a */
 249         sd->sensor = &s5k83a;
 250         if (!sd->sensor->probe(sd))
 251                 return 0;
 252
 253         /* More sensor probe function goes here */
 254         pr_info("Failed to find a sensor\n");
 255         sd->sensor = NULL;
 256         return -ENODEV;
 257 }
 258
 259 static int m5602_configure(struct gspca_dev *gspca_dev,
 260                            const struct usb_device_id *id);
 261
 262 static int m5602_init(struct gspca_dev *gspca_dev)
 263 {
 264         struct sd *sd = (struct sd *) gspca_dev;
 265         int err;
 266
 267         gspca_dbg(gspca_dev, D_CONF, "Initializing ALi m5602 webcam\n");
 268         /* Run the init sequence */
 269         err = sd->sensor->init(sd);
 270
 271         return err;
 272 }
 273
 274 static int m5602_init_controls(struct gspca_dev *gspca_dev)
 275 {
 276         struct sd *sd = (struct sd *) gspca_dev;
 277
 278         if (!sd->sensor->init_controls)
 279                 return 0;
 280
 281         return sd->sensor->init_controls(sd);
 282 }
 283
 284 static int m5602_start_transfer(struct gspca_dev *gspca_dev)
 285 {
 286         struct sd *sd = (struct sd *) gspca_dev;
 287         __u8 *buf = sd->gspca_dev.usb_buf;
 288         int err;
 289
 290         /* Send start command to the camera */
 291         const u8 buffer[4] = {0x13, 0xf9, 0x0f, 0x01};
 292
 293         if (sd->sensor->start)
 294                 sd->sensor->start(sd);
 295
 296         memcpy(buf, buffer, sizeof(buffer));
 297         err = usb_control_msg(gspca_dev->dev,
 298                               usb_sndctrlpipe(gspca_dev->dev, 0),
 299                               0x04, 0x40, 0x19, 0x0000, buf,
 300                               sizeof(buffer), M5602_URB_MSG_TIMEOUT);
 301
 302         gspca_dbg(gspca_dev, D_STREAM, "Transfer started\n");
 303         return (err < 0) ? err : 0;
 304 }
 305
 306 static void m5602_urb_complete(struct gspca_dev *gspca_dev,
 307                                 u8 *data, int len)
 308 {
 309         struct sd *sd = (struct sd *) gspca_dev;
 310
 311         if (len < 6) {
 312                 gspca_dbg(gspca_dev, D_PACK, "Packet is less than 6 bytes\n");
 313                 return;
 314         }
 315
 316         /* Frame delimiter: ff xx xx xx ff ff */
 317         if (data[0] == 0xff && data[4] == 0xff && data[5] == 0xff &&
 318             data[2] != sd->frame_id) {
 319                 gspca_dbg(gspca_dev, D_FRAM, "Frame delimiter detected\n");
 320                 sd->frame_id = data[2];
 321
 322                 /* Remove the extra fluff appended on each header */
 323                 data += 6;
 324                 len -= 6;
 325
 326                 /* Complete the last frame (if any) */
 327                 gspca_frame_add(gspca_dev, LAST_PACKET,
 328                                 NULL, 0);
 329                 sd->frame_count++;
 330
 331                 /* Create a new frame */
 332                 gspca_frame_add(gspca_dev, FIRST_PACKET, data, len);
 333
 334                 gspca_dbg(gspca_dev, D_FRAM, "Starting new frame %d\n",
 335                           sd->frame_count);
 336
 337         } else {
 338                 int cur_frame_len;
 339
 340                 cur_frame_len = gspca_dev->image_len;
 341                 /* Remove urb header */
 342                 data += 4;
 343                 len -= 4;
 344
 345                 if (cur_frame_len + len <= gspca_dev->pixfmt.sizeimage) {
 346                         gspca_dbg(gspca_dev, D_FRAM, "Continuing frame %d copying %d bytes\n",
 347                                   sd->frame_count, len);
 348
 349                         gspca_frame_add(gspca_dev, INTER_PACKET,
 350                                         data, len);
 351                 } else {
 352                         /* Add the remaining data up to frame size */
 353                         gspca_frame_add(gspca_dev, INTER_PACKET, data,
 354                                 gspca_dev->pixfmt.sizeimage - cur_frame_len);
 355                 }
 356         }
 357 }
 358
 359 static void m5602_stop_transfer(struct gspca_dev *gspca_dev)
 360 {
 361         struct sd *sd = (struct sd *) gspca_dev;
 362
 363         /* Run the sensor specific end transfer sequence */
 364         if (sd->sensor->stop)
 365                 sd->sensor->stop(sd);
 366 }
 367
 368 /* sub-driver description */
 369 static const struct sd_desc sd_desc = {
 370         .name           = MODULE_NAME,
 371         .config         = m5602_configure,
 372         .init           = m5602_init,
 373         .init_controls  = m5602_init_controls,
 374         .start          = m5602_start_transfer,
 375         .stopN          = m5602_stop_transfer,
 376         .pkt_scan       = m5602_urb_complete
 377 };
 378
 379 /* this function is called at probe time */
 380 static int m5602_configure(struct gspca_dev *gspca_dev,
 381                            const struct usb_device_id *id)
 382 {
 383         struct sd *sd = (struct sd *) gspca_dev;
 384         struct cam *cam;
 385         int err;
 386
 387         cam = &gspca_dev->cam;
 388
 389         if (dump_bridge)
 390                 m5602_dump_bridge(sd);
 391
 392         /* Probe sensor */
 393         err = m5602_probe_sensor(sd);
 394         if (err)
 395                 goto fail;
 396
 397         return 0;
 398
 399 fail:
 400         gspca_err(gspca_dev, "ALi m5602 webcam failed\n");
 401         cam->cam_mode = NULL;
 402         cam->nmodes = 0;
 403
 404         return err;
 405 }
 406
 407 static int m5602_probe(struct usb_interface *intf,
 408                        const struct usb_device_id *id)
 409 {
 410         return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
 411                                THIS_MODULE);
 412 }
 413
 414 static void m5602_disconnect(struct usb_interface *intf)
 415 {
 416         struct gspca_dev *gspca_dev = usb_get_intfdata(intf);
 417         struct sd *sd = (struct sd *) gspca_dev;
 418
 419         if (sd->sensor->disconnect)
 420                 sd->sensor->disconnect(sd);
 421
 422         gspca_disconnect(intf);
 423 }
 424
 425 static struct usb_driver sd_driver = {
 426         .name = MODULE_NAME,
 427         .id_table = m5602_table,
 428         .probe = m5602_probe,
 429 #ifdef CONFIG_PM
 430         .suspend = gspca_suspend,
 431         .resume = gspca_resume,
 432         .reset_resume = gspca_resume,
 433 #endif
 434         .disconnect = m5602_disconnect
 435 };
 436
 437 module_usb_driver(sd_driver);
 438
 439 MODULE_AUTHOR(DRIVER_AUTHOR);
 440 MODULE_DESCRIPTION(DRIVER_DESC);
 441 MODULE_LICENSE("GPL");
 442 module_param(force_sensor, int, S_IRUGO | S_IWUSR);
 443 MODULE_PARM_DESC(force_sensor,
 444                 "forces detection of a sensor, 1 = OV9650, 2 = S5K83A, 3 = S5K4AA, 4 = MT9M111, 5 = PO1030, 6 = OV7660");
 445
 446 module_param(dump_bridge, bool, S_IRUGO | S_IWUSR);
 447 MODULE_PARM_DESC(dump_bridge, "Dumps all usb bridge registers at startup");
 448
 449 module_param(dump_sensor, bool, S_IRUGO | S_IWUSR);
 450 MODULE_PARM_DESC(dump_sensor, "Dumps all usb sensor registers at startup providing a sensor is found");