drivers/media/video/zr364xx.c

   1 /*
   2  * Zoran 364xx based USB webcam module version 0.72
   3  *
   4  * Allows you to use your USB webcam with V4L2 applications
   5  * This is still in heavy developpement !
   6  *
   7  * Copyright (C) 2004  Antoine Jacquet <royale@zerezo.com>
   8  * http://royale.zerezo.com/zr364xx/
   9  *
  10  * Heavily inspired by usb-skeleton.c, vicam.c, cpia.c and spca50x.c drivers
  11  * V4L2 version inspired by meye.c driver
  12  *
  13  * This program is free software; you can redistribute it and/or modify
  14  * it under the terms of the GNU General Public License as published by
  15  * the Free Software Foundation; either version 2 of the License, or
  16  * (at your option) any later version.
  17  *
  18  * This program is distributed in the hope that it will be useful,
  19  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  20  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  21  * GNU General Public License for more details.
  22  *
  23  * You should have received a copy of the GNU General Public License
  24  * along with this program; if not, write to the Free Software
  25  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  26  */
  27
  28
  29 #include <linux/version.h>
  30 #include <linux/module.h>
  31 #include <linux/init.h>
  32 #include <linux/usb.h>
  33 #include <linux/vmalloc.h>
  34 #include <linux/slab.h>
  35 #include <linux/proc_fs.h>
  36 #include <linux/highmem.h>
  37 #include <media/v4l2-common.h>
  38
  39
  40 /* Version Information */
  41 #define DRIVER_VERSION "v0.72"
  42 #define DRIVER_AUTHOR "Antoine Jacquet, http://royale.zerezo.com/"
  43 #define DRIVER_DESC "Zoran 364xx"
  44
  45
  46 /* Camera */
  47 #define FRAMES 2
  48 #define MAX_FRAME_SIZE 100000
  49 #define BUFFER_SIZE 0x1000
  50 #define CTRL_TIMEOUT 500
  51
  52
  53 /* Debug macro */
  54 #define DBG(x...) if (debug) info(x)
  55
  56
  57 /* Init methods, need to find nicer names for these
  58  * the exact names of the chipsets would be the best if someone finds it */
  59 #define METHOD0 0
  60 #define METHOD1 1
  61 #define METHOD2 2
  62
  63
  64 /* Module parameters */
  65 static int debug;
  66 static int mode;
  67
  68
  69 /* Module parameters interface */
  70 module_param(debug, int, 0644);
  71 MODULE_PARM_DESC(debug, "Debug level");
  72 module_param(mode, int, 0644);
  73 MODULE_PARM_DESC(mode, "0 = 320x240, 1 = 160x120, 2 = 640x480");
  74
  75
  76 /* Devices supported by this driver
  77  * .driver_info contains the init method used by the camera */
  78 static struct usb_device_id device_table[] = {
  79         {USB_DEVICE(0x08ca, 0x0109), .driver_info = METHOD0 },
  80         {USB_DEVICE(0x041e, 0x4024), .driver_info = METHOD0 },
  81         {USB_DEVICE(0x0d64, 0x0108), .driver_info = METHOD0 },
  82         {USB_DEVICE(0x0546, 0x3187), .driver_info = METHOD0 },
  83         {USB_DEVICE(0x0d64, 0x3108), .driver_info = METHOD0 },
  84         {USB_DEVICE(0x0595, 0x4343), .driver_info = METHOD0 },
  85         {USB_DEVICE(0x0bb0, 0x500d), .driver_info = METHOD0 },
  86         {USB_DEVICE(0x0feb, 0x2004), .driver_info = METHOD0 },
  87         {USB_DEVICE(0x055f, 0xb500), .driver_info = METHOD0 },
  88         {USB_DEVICE(0x08ca, 0x2062), .driver_info = METHOD2 },
  89         {USB_DEVICE(0x052b, 0x1a18), .driver_info = METHOD1 },
  90         {USB_DEVICE(0x04c8, 0x0729), .driver_info = METHOD0 },
  91         {USB_DEVICE(0x04f2, 0xa208), .driver_info = METHOD0 },
  92         {USB_DEVICE(0x0784, 0x0040), .driver_info = METHOD1 },
  93         {USB_DEVICE(0x06d6, 0x0034), .driver_info = METHOD0 },
  94         {USB_DEVICE(0x0a17, 0x0062), .driver_info = METHOD2 },
  95         {USB_DEVICE(0x06d6, 0x003b), .driver_info = METHOD0 },
  96         {USB_DEVICE(0x0a17, 0x004e), .driver_info = METHOD2 },
  97         {USB_DEVICE(0x041e, 0x405d), .driver_info = METHOD2 },
  98         {}                      /* Terminating entry */
  99 };
 100
 101 MODULE_DEVICE_TABLE(usb, device_table);
 102
 103
 104 /* Camera stuff */
 105 struct zr364xx_camera {
 106         struct usb_device *udev;        /* save off the usb device pointer */
 107         struct usb_interface *interface;/* the interface for this device */
 108         struct video_device *vdev;      /* v4l video device */
 109         u8 *framebuf;
 110         int nb;
 111         unsigned char *buffer;
 112         int skip;
 113         int brightness;
 114         int width;
 115         int height;
 116         int method;
 117         struct mutex lock;
 118 };
 119
 120
 121 /* function used to send initialisation commands to the camera */
 122 static int send_control_msg(struct usb_device *udev, u8 request, u16 value,
 123                             u16 index, unsigned char *cp, u16 size)
 124 {
 125         int status;
 126
 127         unsigned char *transfer_buffer = kmalloc(size, GFP_KERNEL);
 128         if (!transfer_buffer) {
 129                 info("kmalloc(%d) failed", size);
 130                 return -ENOMEM;
 131         }
 132
 133         memcpy(transfer_buffer, cp, size);
 134
 135         status = usb_control_msg(udev,
 136                                  usb_sndctrlpipe(udev, 0),
 137                                  request,
 138                                  USB_DIR_OUT | USB_TYPE_VENDOR |
 139                                  USB_RECIP_DEVICE, value, index,
 140                                  transfer_buffer, size, CTRL_TIMEOUT);
 141
 142         kfree(transfer_buffer);
 143
 144         if (status < 0)
 145                 info("Failed sending control message, error %d.", status);
 146
 147         return status;
 148 }
 149
 150
 151 /* Control messages sent to the camera to initialize it
 152  * and launch the capture */
 153 typedef struct {
 154         unsigned int value;
 155         unsigned int size;
 156         unsigned char *bytes;
 157 } message;
 158
 159 /* method 0 */
 160 static unsigned char m0d1[] = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
 161 static unsigned char m0d2[] = { 0, 0, 0, 0, 0, 0 };
 162 static unsigned char m0d3[] = { 0, 0 };
 163 static message m0[] = {
 164         {0x1f30, 0, NULL},
 165         {0xd000, 0, NULL},
 166         {0x3370, sizeof(m0d1), m0d1},
 167         {0x2000, 0, NULL},
 168         {0x2f0f, 0, NULL},
 169         {0x2610, sizeof(m0d2), m0d2},
 170         {0xe107, 0, NULL},
 171         {0x2502, 0, NULL},
 172         {0x1f70, 0, NULL},
 173         {0xd000, 0, NULL},
 174         {0x9a01, sizeof(m0d3), m0d3},
 175         {-1, -1, NULL}
 176 };
 177
 178 /* method 1 */
 179 static unsigned char m1d1[] = { 0xff, 0xff };
 180 static unsigned char m1d2[] = { 0x00, 0x00 };
 181 static message m1[] = {
 182         {0x1f30, 0, NULL},
 183         {0xd000, 0, NULL},
 184         {0xf000, 0, NULL},
 185         {0x2000, 0, NULL},
 186         {0x2f0f, 0, NULL},
 187         {0x2650, 0, NULL},
 188         {0xe107, 0, NULL},
 189         {0x2502, sizeof(m1d1), m1d1},
 190         {0x1f70, 0, NULL},
 191         {0xd000, 0, NULL},
 192         {0xd000, 0, NULL},
 193         {0xd000, 0, NULL},
 194         {0x9a01, sizeof(m1d2), m1d2},
 195         {-1, -1, NULL}
 196 };
 197
 198 /* method 2 */
 199 static unsigned char m2d1[] = { 0xff, 0xff };
 200 static message m2[] = {
 201         {0x1f30, 0, NULL},
 202         {0xf000, 0, NULL},
 203         {0x2000, 0, NULL},
 204         {0x2f0f, 0, NULL},
 205         {0x2650, 0, NULL},
 206         {0xe107, 0, NULL},
 207         {0x2502, sizeof(m2d1), m2d1},
 208         {0x1f70, 0, NULL},
 209         {-1, -1, NULL}
 210 };
 211
 212 /* init table */
 213 static message *init[3] = { m0, m1, m2 };
 214
 215
 216 /* JPEG static data in header (Huffman table, etc) */
 217 static unsigned char header1[] = {
 218         0xFF, 0xD8,
 219         /*
 220         0xFF, 0xE0, 0x00, 0x10, 'J', 'F', 'I', 'F',
 221         0x00, 0x01, 0x01, 0x00, 0x33, 0x8A, 0x00, 0x00, 0x33, 0x88,
 222         */
 223         0xFF, 0xDB, 0x00, 0x84
 224 };
 225 static unsigned char header2[] = {
 226         0xFF, 0xC4, 0x00, 0x1F, 0x00, 0x00, 0x01, 0x05, 0x01, 0x01, 0x01,
 227         0x01, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 228         0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B,
 229         0xFF, 0xC4, 0x00, 0xB5, 0x10, 0x00, 0x02, 0x01, 0x03, 0x03, 0x02,
 230         0x04, 0x03, 0x05, 0x05, 0x04, 0x04, 0x00, 0x00, 0x01, 0x7D, 0x01,
 231         0x02, 0x03, 0x00, 0x04, 0x11, 0x05, 0x12, 0x21, 0x31, 0x41, 0x06,
 232         0x13, 0x51, 0x61, 0x07, 0x22, 0x71, 0x14, 0x32, 0x81, 0x91, 0xA1,
 233         0x08, 0x23, 0x42, 0xB1, 0xC1, 0x15, 0x52, 0xD1, 0xF0, 0x24, 0x33,
 234         0x62, 0x72, 0x82, 0x09, 0x0A, 0x16, 0x17, 0x18, 0x19, 0x1A, 0x25,
 235         0x26, 0x27, 0x28, 0x29, 0x2A, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39,
 236         0x3A, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48, 0x49, 0x4A, 0x53, 0x54,
 237         0x55, 0x56, 0x57, 0x58, 0x59, 0x5A, 0x63, 0x64, 0x65, 0x66, 0x67,
 238         0x68, 0x69, 0x6A, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79, 0x7A,
 239         0x83, 0x84, 0x85, 0x86, 0x87, 0x88, 0x89, 0x8A, 0x92, 0x93, 0x94,
 240         0x95, 0x96, 0x97, 0x98, 0x99, 0x9A, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6,
 241         0xA7, 0xA8, 0xA9, 0xAA, 0xB2, 0xB3, 0xB4, 0xB5, 0xB6, 0xB7, 0xB8,
 242         0xB9, 0xBA, 0xC2, 0xC3, 0xC4, 0xC5, 0xC6, 0xC7, 0xC8, 0xC9, 0xCA,
 243         0xD2, 0xD3, 0xD4, 0xD5, 0xD6, 0xD7, 0xD8, 0xD9, 0xDA, 0xE1, 0xE2,
 244         0xE3, 0xE4, 0xE5, 0xE6, 0xE7, 0xE8, 0xE9, 0xEA, 0xF1, 0xF2, 0xF3,
 245         0xF4, 0xF5, 0xF6, 0xF7, 0xF8, 0xF9, 0xFA, 0xFF, 0xC4, 0x00, 0x1F,
 246         0x01, 0x00, 0x03, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
 247         0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x02, 0x03, 0x04,
 248         0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0xFF, 0xC4, 0x00, 0xB5,
 249         0x11, 0x00, 0x02, 0x01, 0x02, 0x04, 0x04, 0x03, 0x04, 0x07, 0x05,
 250         0x04, 0x04, 0x00, 0x01, 0x02, 0x77, 0x00, 0x01, 0x02, 0x03, 0x11,
 251         0x04, 0x05, 0x21, 0x31, 0x06, 0x12, 0x41, 0x51, 0x07, 0x61, 0x71,
 252         0x13, 0x22, 0x32, 0x81, 0x08, 0x14, 0x42, 0x91, 0xA1, 0xB1, 0xC1,
 253         0x09, 0x23, 0x33, 0x52, 0xF0, 0x15, 0x62, 0x72, 0xD1, 0x0A, 0x16,
 254         0x24, 0x34, 0xE1, 0x25, 0xF1, 0x17, 0x18, 0x19, 0x1A, 0x26, 0x27,
 255         0x28, 0x29, 0x2A, 0x35, 0x36, 0x37, 0x38, 0x39, 0x3A, 0x43, 0x44,
 256         0x45, 0x46, 0x47, 0x48, 0x49, 0x4A, 0x53, 0x54, 0x55, 0x56, 0x57,
 257         0x58, 0x59, 0x5A, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68, 0x69, 0x6A,
 258         0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79, 0x7A, 0x82, 0x83, 0x84,
 259         0x85, 0x86, 0x87, 0x88, 0x89, 0x8A, 0x92, 0x93, 0x94, 0x95, 0x96,
 260         0x97, 0x98, 0x99, 0x9A, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6, 0xA7, 0xA8,
 261         0xA9, 0xAA, 0xB2, 0xB3, 0xB4, 0xB5, 0xB6, 0xB7, 0xB8, 0xB9, 0xBA,
 262         0xC2, 0xC3, 0xC4, 0xC5, 0xC6, 0xC7, 0xC8, 0xC9, 0xCA, 0xD2, 0xD3,
 263         0xD4, 0xD5, 0xD6, 0xD7, 0xD8, 0xD9, 0xDA, 0xE2, 0xE3, 0xE4, 0xE5,
 264         0xE6, 0xE7, 0xE8, 0xE9, 0xEA, 0xF2, 0xF3, 0xF4, 0xF5, 0xF6, 0xF7,
 265         0xF8, 0xF9, 0xFA, 0xFF, 0xC0, 0x00, 0x11, 0x08, 0x00, 0xF0, 0x01,
 266         0x40, 0x03, 0x01, 0x21, 0x00, 0x02, 0x11, 0x01, 0x03, 0x11, 0x01,
 267         0xFF, 0xDA, 0x00, 0x0C, 0x03, 0x01, 0x00, 0x02, 0x11, 0x03, 0x11,
 268         0x00, 0x3F, 0x00
 269 };
 270 static unsigned char header3;
 271
 272
 273
 274 /********************/
 275 /* V4L2 integration */
 276 /********************/
 277
 278 /* this function reads a full JPEG picture synchronously
 279  * TODO: do it asynchronously... */
 280 static int read_frame(struct zr364xx_camera *cam, int framenum)
 281 {
 282         int i, n, temp, head, size, actual_length;
 283         unsigned char *ptr = NULL, *jpeg;
 284
 285       redo:
 286         /* hardware brightness */
 287         n = send_control_msg(cam->udev, 1, 0x2001, 0, NULL, 0);
 288         temp = (0x60 << 8) + 127 - cam->brightness;
 289         n = send_control_msg(cam->udev, 1, temp, 0, NULL, 0);
 290
 291         /* during the first loop we are going to insert JPEG header */
 292         head = 0;
 293         /* this is the place in memory where we are going to build
 294          * the JPEG image */
 295         jpeg = cam->framebuf + framenum * MAX_FRAME_SIZE;
 296         /* read data... */
 297         do {
 298                 n = usb_bulk_msg(cam->udev,
 299                                  usb_rcvbulkpipe(cam->udev, 0x81),
 300                                  cam->buffer, BUFFER_SIZE, &actual_length,
 301                                  CTRL_TIMEOUT);
 302                 DBG("buffer : %d %d", cam->buffer[0], cam->buffer[1]);
 303                 DBG("bulk : n=%d size=%d", n, actual_length);
 304                 if (n < 0) {
 305                         info("error reading bulk msg");
 306                         return 0;
 307                 }
 308                 if (actual_length < 0 || actual_length > BUFFER_SIZE) {
 309                         info("wrong number of bytes");
 310                         return 0;
 311                 }
 312
 313                 /* swap bytes if camera needs it */
 314                 if (cam->method == METHOD0) {
 315                         u16 *buf = (u16*)cam->buffer;
 316                         for (i = 0; i < BUFFER_SIZE/2; i++)
 317                                 swab16s(buf + i);
 318                 }
 319
 320                 /* write the JPEG header */
 321                 if (!head) {
 322                         DBG("jpeg header");
 323                         ptr = jpeg;
 324                         memcpy(ptr, header1, sizeof(header1));
 325                         ptr += sizeof(header1);
 326                         header3 = 0;
 327                         memcpy(ptr, &header3, 1);
 328                         ptr++;
 329                         memcpy(ptr, cam->buffer, 64);
 330                         ptr += 64;
 331                         header3 = 1;
 332                         memcpy(ptr, &header3, 1);
 333                         ptr++;
 334                         memcpy(ptr, cam->buffer + 64, 64);
 335                         ptr += 64;
 336                         memcpy(ptr, header2, sizeof(header2));
 337                         ptr += sizeof(header2);
 338                         memcpy(ptr, cam->buffer + 128,
 339                                actual_length - 128);
 340                         ptr += actual_length - 128;
 341                         head = 1;
 342                         DBG("header : %d %d %d %d %d %d %d %d %d",
 343                             cam->buffer[0], cam->buffer[1], cam->buffer[2],
 344                             cam->buffer[3], cam->buffer[4], cam->buffer[5],
 345                             cam->buffer[6], cam->buffer[7], cam->buffer[8]);
 346                 } else {
 347                         memcpy(ptr, cam->buffer, actual_length);
 348                         ptr += actual_length;
 349                 }
 350         }
 351         /* ... until there is no more */
 352         while (actual_length == BUFFER_SIZE);
 353
 354         /* we skip the 2 first frames which are usually buggy */
 355         if (cam->skip) {
 356                 cam->skip--;
 357                 goto redo;
 358         }
 359
 360         /* go back to find the JPEG EOI marker */
 361         size = ptr - jpeg;
 362         ptr -= 2;
 363         while (ptr > jpeg) {
 364                 if (*ptr == 0xFF && *(ptr + 1) == 0xD9
 365                     && *(ptr + 2) == 0xFF)
 366                         break;
 367                 ptr--;
 368         }
 369         if (ptr == jpeg)
 370                 DBG("No EOI marker");
 371
 372         /* Sometimes there is junk data in the middle of the picture,
 373          * we want to skip this bogus frames */
 374         while (ptr > jpeg) {
 375                 if (*ptr == 0xFF && *(ptr + 1) == 0xFF
 376                     && *(ptr + 2) == 0xFF)
 377                         break;
 378                 ptr--;
 379         }
 380         if (ptr != jpeg) {
 381                 DBG("Bogus frame ? %d", cam->nb);
 382                 goto redo;
 383         }
 384
 385         DBG("jpeg : %d %d %d %d %d %d %d %d",
 386             jpeg[0], jpeg[1], jpeg[2], jpeg[3],
 387             jpeg[4], jpeg[5], jpeg[6], jpeg[7]);
 388
 389         return size;
 390 }
 391
 392
 393 static ssize_t zr364xx_read(struct file *file, char __user *buf, size_t cnt,
 394                             loff_t * ppos)
 395 {
 396         unsigned long count = cnt;
 397         struct video_device *vdev = video_devdata(file);
 398         struct zr364xx_camera *cam;
 399
 400         DBG("zr364xx_read: read %d bytes.", (int) count);
 401
 402         if (vdev == NULL)
 403                 return -ENODEV;
 404         cam = video_get_drvdata(vdev);
 405
 406         if (!buf)
 407                 return -EINVAL;
 408
 409         if (!count)
 410                 return -EINVAL;
 411
 412         /* NoMan Sux ! */
 413         count = read_frame(cam, 0);
 414
 415         if (copy_to_user(buf, cam->framebuf, count))
 416                 return -EFAULT;
 417
 418         return count;
 419 }
 420
 421
 422 static int zr364xx_vidioc_querycap(struct file *file, void *priv,
 423                                    struct v4l2_capability *cap)
 424 {
 425         memset(cap, 0, sizeof(*cap));
 426         strcpy(cap->driver, DRIVER_DESC);
 427         cap->capabilities = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_READWRITE;
 428         return 0;
 429 }
 430
 431 static int zr364xx_vidioc_enum_input(struct file *file, void *priv,
 432                                      struct v4l2_input *i)
 433 {
 434         if (i->index != 0)
 435                 return -EINVAL;
 436         memset(i, 0, sizeof(*i));
 437         i->index = 0;
 438         strcpy(i->name, DRIVER_DESC " Camera");
 439         i->type = V4L2_INPUT_TYPE_CAMERA;
 440         return 0;
 441 }
 442
 443 static int zr364xx_vidioc_g_input(struct file *file, void *priv,
 444                                   unsigned int *i)
 445 {
 446         *i = 0;
 447         return 0;
 448 }
 449
 450 static int zr364xx_vidioc_s_input(struct file *file, void *priv,
 451                                   unsigned int i)
 452 {
 453         if (i != 0)
 454                 return -EINVAL;
 455         return 0;
 456 }
 457
 458 static int zr364xx_vidioc_queryctrl(struct file *file, void *priv,
 459                                     struct v4l2_queryctrl *c)
 460 {
 461         struct video_device *vdev = video_devdata(file);
 462         struct zr364xx_camera *cam;
 463
 464         if (vdev == NULL)
 465                 return -ENODEV;
 466         cam = video_get_drvdata(vdev);
 467
 468         switch (c->id) {
 469         case V4L2_CID_BRIGHTNESS:
 470                 c->type = V4L2_CTRL_TYPE_INTEGER;
 471                 strcpy(c->name, "Brightness");
 472                 c->minimum = 0;
 473                 c->maximum = 127;
 474                 c->step = 1;
 475                 c->default_value = cam->brightness;
 476                 c->flags = 0;
 477                 break;
 478         default:
 479                 return -EINVAL;
 480         }
 481         return 0;
 482 }
 483
 484 static int zr364xx_vidioc_s_ctrl(struct file *file, void *priv,
 485                                  struct v4l2_control *c)
 486 {
 487         struct video_device *vdev = video_devdata(file);
 488         struct zr364xx_camera *cam;
 489
 490         if (vdev == NULL)
 491                 return -ENODEV;
 492         cam = video_get_drvdata(vdev);
 493
 494         switch (c->id) {
 495         case V4L2_CID_BRIGHTNESS:
 496                 cam->brightness = c->value;
 497                 break;
 498         default:
 499                 return -EINVAL;
 500         }
 501         return 0;
 502 }
 503
 504 static int zr364xx_vidioc_g_ctrl(struct file *file, void *priv,
 505                                  struct v4l2_control *c)
 506 {
 507         struct video_device *vdev = video_devdata(file);
 508         struct zr364xx_camera *cam;
 509
 510         if (vdev == NULL)
 511                 return -ENODEV;
 512         cam = video_get_drvdata(vdev);
 513
 514         switch (c->id) {
 515         case V4L2_CID_BRIGHTNESS:
 516                 c->value = cam->brightness;
 517                 break;
 518         default:
 519                 return -EINVAL;
 520         }
 521         return 0;
 522 }
 523
 524 static int zr364xx_vidioc_enum_fmt_vid_cap(struct file *file,
 525                                        void *priv, struct v4l2_fmtdesc *f)
 526 {
 527         if (f->index > 0)
 528                 return -EINVAL;
 529         if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
 530                 return -EINVAL;
 531         memset(f, 0, sizeof(*f));
 532         f->index = 0;
 533         f->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
 534         f->flags = V4L2_FMT_FLAG_COMPRESSED;
 535         strcpy(f->description, "JPEG");
 536         f->pixelformat = V4L2_PIX_FMT_JPEG;
 537         return 0;
 538 }
 539
 540 static int zr364xx_vidioc_try_fmt_vid_cap(struct file *file, void *priv,
 541                                       struct v4l2_format *f)
 542 {
 543         struct video_device *vdev = video_devdata(file);
 544         struct zr364xx_camera *cam;
 545
 546         if (vdev == NULL)
 547                 return -ENODEV;
 548         cam = video_get_drvdata(vdev);
 549
 550         if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
 551                 return -EINVAL;
 552         if (f->fmt.pix.pixelformat != V4L2_PIX_FMT_JPEG)
 553                 return -EINVAL;
 554         if (f->fmt.pix.field != V4L2_FIELD_ANY &&
 555             f->fmt.pix.field != V4L2_FIELD_NONE)
 556                 return -EINVAL;
 557         f->fmt.pix.field = V4L2_FIELD_NONE;
 558         f->fmt.pix.width = cam->width;
 559         f->fmt.pix.height = cam->height;
 560         f->fmt.pix.bytesperline = f->fmt.pix.width * 2;
 561         f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline;
 562         f->fmt.pix.colorspace = 0;
 563         f->fmt.pix.priv = 0;
 564         return 0;
 565 }
 566
 567 static int zr364xx_vidioc_g_fmt_vid_cap(struct file *file, void *priv,
 568                                     struct v4l2_format *f)
 569 {
 570         struct video_device *vdev = video_devdata(file);
 571         struct zr364xx_camera *cam;
 572
 573         if (vdev == NULL)
 574                 return -ENODEV;
 575         cam = video_get_drvdata(vdev);
 576
 577         if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
 578                 return -EINVAL;
 579         memset(&f->fmt.pix, 0, sizeof(struct v4l2_pix_format));
 580         f->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
 581         f->fmt.pix.pixelformat = V4L2_PIX_FMT_JPEG;
 582         f->fmt.pix.field = V4L2_FIELD_NONE;
 583         f->fmt.pix.width = cam->width;
 584         f->fmt.pix.height = cam->height;
 585         f->fmt.pix.bytesperline = f->fmt.pix.width * 2;
 586         f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline;
 587         f->fmt.pix.colorspace = 0;
 588         f->fmt.pix.priv = 0;
 589         return 0;
 590 }
 591
 592 static int zr364xx_vidioc_s_fmt_vid_cap(struct file *file, void *priv,
 593                                     struct v4l2_format *f)
 594 {
 595         struct video_device *vdev = video_devdata(file);
 596         struct zr364xx_camera *cam;
 597
 598         if (vdev == NULL)
 599                 return -ENODEV;
 600         cam = video_get_drvdata(vdev);
 601
 602         if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
 603                 return -EINVAL;
 604         if (f->fmt.pix.pixelformat != V4L2_PIX_FMT_JPEG)
 605                 return -EINVAL;
 606         if (f->fmt.pix.field != V4L2_FIELD_ANY &&
 607             f->fmt.pix.field != V4L2_FIELD_NONE)
 608                 return -EINVAL;
 609         f->fmt.pix.field = V4L2_FIELD_NONE;
 610         f->fmt.pix.width = cam->width;
 611         f->fmt.pix.height = cam->height;
 612         f->fmt.pix.bytesperline = f->fmt.pix.width * 2;
 613         f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline;
 614         f->fmt.pix.colorspace = 0;
 615         f->fmt.pix.priv = 0;
 616         DBG("ok!");
 617         return 0;
 618 }
 619
 620 static int zr364xx_vidioc_streamon(struct file *file, void *priv,
 621                                    enum v4l2_buf_type type)
 622 {
 623         return 0;
 624 }
 625
 626 static int zr364xx_vidioc_streamoff(struct file *file, void *priv,
 627                                     enum v4l2_buf_type type)
 628 {
 629         return 0;
 630 }
 631
 632
 633 /* open the camera */
 634 static int zr364xx_open(struct inode *inode, struct file *file)
 635 {
 636         struct video_device *vdev = video_devdata(file);
 637         struct zr364xx_camera *cam = video_get_drvdata(vdev);
 638         struct usb_device *udev = cam->udev;
 639         int i, err;
 640
 641         DBG("zr364xx_open");
 642
 643         cam->skip = 2;
 644
 645         err = video_exclusive_open(inode, file);
 646         if (err < 0)
 647                 return err;
 648
 649         if (!cam->framebuf) {
 650                 cam->framebuf = vmalloc_32(MAX_FRAME_SIZE * FRAMES);
 651                 if (!cam->framebuf) {
 652                         info("vmalloc_32 failed!");
 653                         return -ENOMEM;
 654                 }
 655         }
 656
 657         mutex_lock(&cam->lock);
 658         for (i = 0; init[cam->method][i].size != -1; i++) {
 659                 err =
 660                     send_control_msg(udev, 1, init[cam->method][i].value,
 661                                      0, init[cam->method][i].bytes,
 662                                      init[cam->method][i].size);
 663                 if (err < 0) {
 664                         info("error during open sequence: %d", i);
 665                         mutex_unlock(&cam->lock);
 666                         return err;
 667                 }
 668         }
 669
 670         file->private_data = vdev;
 671
 672         /* Added some delay here, since opening/closing the camera quickly,
 673          * like Ekiga does during its startup, can crash the webcam
 674          */
 675         mdelay(100);
 676
 677         mutex_unlock(&cam->lock);
 678         return 0;
 679 }
 680
 681
 682 /* release the camera */
 683 static int zr364xx_release(struct inode *inode, struct file *file)
 684 {
 685         struct video_device *vdev = video_devdata(file);
 686         struct zr364xx_camera *cam;
 687         struct usb_device *udev;
 688         int i, err;
 689
 690         DBG("zr364xx_release");
 691
 692         if (vdev == NULL)
 693                 return -ENODEV;
 694         cam = video_get_drvdata(vdev);
 695
 696         udev = cam->udev;
 697
 698         mutex_lock(&cam->lock);
 699         for (i = 0; i < 2; i++) {
 700                 err =
 701                     send_control_msg(udev, 1, init[cam->method][i].value,
 702                                      0, init[i][cam->method].bytes,
 703                                      init[cam->method][i].size);
 704                 if (err < 0) {
 705                         info("error during release sequence");
 706                         mutex_unlock(&cam->lock);
 707                         return err;
 708                 }
 709         }
 710
 711         file->private_data = NULL;
 712         video_exclusive_release(inode, file);
 713
 714         /* Added some delay here, since opening/closing the camera quickly,
 715          * like Ekiga does during its startup, can crash the webcam
 716          */
 717         mdelay(100);
 718
 719         mutex_unlock(&cam->lock);
 720         return 0;
 721 }
 722
 723
 724 static int zr364xx_mmap(struct file *file, struct vm_area_struct *vma)
 725 {
 726         void *pos;
 727         unsigned long start = vma->vm_start;
 728         unsigned long size = vma->vm_end - vma->vm_start;
 729         struct video_device *vdev = video_devdata(file);
 730         struct zr364xx_camera *cam;
 731
 732         DBG("zr364xx_mmap: %ld\n", size);
 733
 734         if (vdev == NULL)
 735                 return -ENODEV;
 736         cam = video_get_drvdata(vdev);
 737
 738         pos = cam->framebuf;
 739         while (size > 0) {
 740                 if (vm_insert_page(vma, start, vmalloc_to_page(pos)))
 741                         return -EAGAIN;
 742                 start += PAGE_SIZE;
 743                 pos += PAGE_SIZE;
 744                 if (size > PAGE_SIZE)
 745                         size -= PAGE_SIZE;
 746                 else
 747                         size = 0;
 748         }
 749
 750         return 0;
 751 }
 752
 753
 754 static const struct file_operations zr364xx_fops = {
 755         .owner = THIS_MODULE,
 756         .open = zr364xx_open,
 757         .release = zr364xx_release,
 758         .read = zr364xx_read,
 759         .mmap = zr364xx_mmap,
 760         .ioctl = video_ioctl2,
 761         .llseek = no_llseek,
 762 };
 763
 764 static struct video_device zr364xx_template = {
 765         .owner = THIS_MODULE,
 766         .name = DRIVER_DESC,
 767         .type = VID_TYPE_CAPTURE,
 768         .fops = &zr364xx_fops,
 769         .release = video_device_release,
 770         .minor = -1,
 771
 772         .vidioc_querycap        = zr364xx_vidioc_querycap,
 773         .vidioc_enum_fmt_vid_cap = zr364xx_vidioc_enum_fmt_vid_cap,
 774         .vidioc_try_fmt_vid_cap = zr364xx_vidioc_try_fmt_vid_cap,
 775         .vidioc_s_fmt_vid_cap   = zr364xx_vidioc_s_fmt_vid_cap,
 776         .vidioc_g_fmt_vid_cap   = zr364xx_vidioc_g_fmt_vid_cap,
 777         .vidioc_enum_input      = zr364xx_vidioc_enum_input,
 778         .vidioc_g_input         = zr364xx_vidioc_g_input,
 779         .vidioc_s_input         = zr364xx_vidioc_s_input,
 780         .vidioc_streamon        = zr364xx_vidioc_streamon,
 781         .vidioc_streamoff       = zr364xx_vidioc_streamoff,
 782         .vidioc_queryctrl       = zr364xx_vidioc_queryctrl,
 783         .vidioc_g_ctrl          = zr364xx_vidioc_g_ctrl,
 784         .vidioc_s_ctrl          = zr364xx_vidioc_s_ctrl,
 785 };
 786
 787
 788
 789 /*******************/
 790 /* USB integration */
 791 /*******************/
 792
 793 static int zr364xx_probe(struct usb_interface *intf,
 794                          const struct usb_device_id *id)
 795 {
 796         struct usb_device *udev = interface_to_usbdev(intf);
 797         struct zr364xx_camera *cam = NULL;
 798         int err;
 799
 800         DBG("probing...");
 801
 802         info(DRIVER_DESC " compatible webcam plugged");
 803         info("model %04x:%04x detected", udev->descriptor.idVendor,
 804              udev->descriptor.idProduct);
 805
 806         cam = kzalloc(sizeof(struct zr364xx_camera), GFP_KERNEL);
 807         if (cam == NULL) {
 808                 info("cam: out of memory !");
 809                 return -ENOMEM;
 810         }
 811         /* save the init method used by this camera */
 812         cam->method = id->driver_info;
 813
 814         cam->vdev = video_device_alloc();
 815         if (cam->vdev == NULL) {
 816                 info("cam->vdev: out of memory !");
 817                 kfree(cam);
 818                 return -ENOMEM;
 819         }
 820         memcpy(cam->vdev, &zr364xx_template, sizeof(zr364xx_template));
 821         video_set_drvdata(cam->vdev, cam);
 822         if (debug)
 823                 cam->vdev->debug = V4L2_DEBUG_IOCTL | V4L2_DEBUG_IOCTL_ARG;
 824
 825         cam->udev = udev;
 826
 827         if ((cam->buffer = kmalloc(BUFFER_SIZE, GFP_KERNEL)) == NULL) {
 828                 info("cam->buffer: out of memory !");
 829                 video_device_release(cam->vdev);
 830                 kfree(cam);
 831                 return -ENODEV;
 832         }
 833
 834         switch (mode) {
 835         case 1:
 836                 info("160x120 mode selected");
 837                 cam->width = 160;
 838                 cam->height = 120;
 839                 break;
 840         case 2:
 841                 info("640x480 mode selected");
 842                 cam->width = 640;
 843                 cam->height = 480;
 844                 break;
 845         default:
 846                 info("320x240 mode selected");
 847                 cam->width = 320;
 848                 cam->height = 240;
 849                 break;
 850         }
 851
 852         m0d1[0] = mode;
 853         m1[2].value = 0xf000 + mode;
 854         m2[1].value = 0xf000 + mode;
 855         header2[437] = cam->height / 256;
 856         header2[438] = cam->height % 256;
 857         header2[439] = cam->width / 256;
 858         header2[440] = cam->width % 256;
 859
 860         cam->nb = 0;
 861         cam->brightness = 64;
 862         mutex_init(&cam->lock);
 863
 864         err = video_register_device(cam->vdev, VFL_TYPE_GRABBER, -1);
 865         if (err) {
 866                 info("video_register_device failed");
 867                 video_device_release(cam->vdev);
 868                 kfree(cam->buffer);
 869                 kfree(cam);
 870                 return err;
 871         }
 872
 873         usb_set_intfdata(intf, cam);
 874
 875         info(DRIVER_DESC " controlling video device %d", cam->vdev->minor);
 876         return 0;
 877 }
 878
 879
 880 static void zr364xx_disconnect(struct usb_interface *intf)
 881 {
 882         struct zr364xx_camera *cam = usb_get_intfdata(intf);
 883         usb_set_intfdata(intf, NULL);
 884         dev_set_drvdata(&intf->dev, NULL);
 885         info(DRIVER_DESC " webcam unplugged");
 886         if (cam->vdev)
 887                 video_unregister_device(cam->vdev);
 888         cam->vdev = NULL;
 889         kfree(cam->buffer);
 890         if (cam->framebuf)
 891                 vfree(cam->framebuf);
 892         kfree(cam);
 893 }
 894
 895
 896
 897 /**********************/
 898 /* Module integration */
 899 /**********************/
 900
 901 static struct usb_driver zr364xx_driver = {
 902         .name = "zr364xx",
 903         .probe = zr364xx_probe,
 904         .disconnect = zr364xx_disconnect,
 905         .id_table = device_table
 906 };
 907
 908
 909 static int __init zr364xx_init(void)
 910 {
 911         int retval;
 912         retval = usb_register(&zr364xx_driver);
 913         if (retval)
 914                 info("usb_register failed!");
 915         else
 916                 info(DRIVER_DESC " module loaded");
 917         return retval;
 918 }
 919
 920
 921 static void __exit zr364xx_exit(void)
 922 {
 923         info(DRIVER_DESC " module unloaded");
 924         usb_deregister(&zr364xx_driver);
 925 }
 926
 927
 928 module_init(zr364xx_init);
 929 module_exit(zr364xx_exit);
 930
 931 MODULE_AUTHOR(DRIVER_AUTHOR);
 932 MODULE_DESCRIPTION(DRIVER_DESC);
 933 MODULE_LICENSE("GPL");