drivers/media/video/se401.c

   1 /*
   2  * Endpoints (formerly known as AOX) se401 USB Camera Driver
   3  *
   4  * Copyright (c) 2000 Jeroen B. Vreeken (pe1rxq@amsat.org)
   5  *
   6  * Still somewhat based on the Linux ov511 driver.
   7  *
   8  * This program is free software; you can redistribute it and/or modify it
   9  * under the terms of the GNU General Public License as published by the
  10  * Free Software Foundation; either version 2 of the License, or (at your
  11  * option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful, but
  14  * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
  15  * or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  16  * for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software Foundation,
  20  * Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  21  *
  22  *
  23  * Thanks to Endpoints Inc. (www.endpoints.com) for making documentation on
  24  * their chipset available and supporting me while writing this driver.
  25  *      - Jeroen Vreeken
  26  */
  27
  28 static const char version[] = "0.24";
  29
  30 #include <linux/module.h>
  31 #include <linux/init.h>
  32 #include <linux/vmalloc.h>
  33 #include <linux/slab.h>
  34 #include <linux/smp_lock.h>
  35 #include <linux/pagemap.h>
  36 #include <linux/usb.h>
  37 #include "se401.h"
  38
  39 static int flickerless;
  40 static int video_nr = -1;
  41
  42 static struct usb_device_id device_table[] = {
  43         { USB_DEVICE(0x03e8, 0x0004) },/* Endpoints/Aox SE401 */
  44         { USB_DEVICE(0x0471, 0x030b) },/* Philips PCVC665K */
  45         { USB_DEVICE(0x047d, 0x5001) },/* Kensington 67014 */
  46         { USB_DEVICE(0x047d, 0x5002) },/* Kensington 6701(5/7) */
  47         { USB_DEVICE(0x047d, 0x5003) },/* Kensington 67016 */
  48         { }
  49 };
  50
  51 MODULE_DEVICE_TABLE(usb, device_table);
  52
  53 MODULE_AUTHOR("Jeroen Vreeken <pe1rxq@amsat.org>");
  54 MODULE_DESCRIPTION("SE401 USB Camera Driver");
  55 MODULE_LICENSE("GPL");
  56 module_param(flickerless, int, 0);
  57 MODULE_PARM_DESC(flickerless,
  58                 "Net frequency to adjust exposure time to (0/50/60)");
  59 module_param(video_nr, int, 0);
  60
  61 static struct usb_driver se401_driver;
  62
  63
  64 /**********************************************************************
  65  *
  66  * Memory management
  67  *
  68  **********************************************************************/
  69 static void *rvmalloc(unsigned long size)
  70 {
  71         void *mem;
  72         unsigned long adr;
  73
  74         size = PAGE_ALIGN(size);
  75         mem = vmalloc_32(size);
  76         if (!mem)
  77                 return NULL;
  78
  79         memset(mem, 0, size); /* Clear the ram out, no junk to the user */
  80         adr = (unsigned long) mem;
  81         while (size > 0) {
  82                 SetPageReserved(vmalloc_to_page((void *)adr));
  83                 adr +=  PAGE_SIZE;
  84                 size -=  PAGE_SIZE;
  85         }
  86
  87         return mem;
  88 }
  89
  90 static void rvfree(void *mem, unsigned long size)
  91 {
  92         unsigned long adr;
  93
  94         if (!mem)
  95                 return;
  96
  97         adr = (unsigned long) mem;
  98         while ((long) size > 0) {
  99                 ClearPageReserved(vmalloc_to_page((void *)adr));
 100                 adr +=  PAGE_SIZE;
 101                 size -=  PAGE_SIZE;
 102         }
 103         vfree(mem);
 104 }
 105
 106
 107
 108 /****************************************************************************
 109  *
 110  * se401 register read/write functions
 111  *
 112  ***************************************************************************/
 113
 114 static int se401_sndctrl(int set, struct usb_se401 *se401, unsigned short req,
 115                          unsigned short value, unsigned char *cp, int size)
 116 {
 117         return usb_control_msg(
 118                 se401->dev,
 119                 set ? usb_sndctrlpipe(se401->dev, 0) : usb_rcvctrlpipe(se401->dev, 0),
 120                 req,
 121                 (set ? USB_DIR_OUT : USB_DIR_IN) | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 122                 value,
 123                 0,
 124                 cp,
 125                 size,
 126                 1000
 127         );
 128 }
 129
 130 static int se401_set_feature(struct usb_se401 *se401, unsigned short selector,
 131                              unsigned short param)
 132 {
 133         /* specs say that the selector (address) should go in the value field
 134            and the param in index, but in the logs of the windows driver they do
 135            this the other way around...
 136          */
 137         return usb_control_msg(
 138                 se401->dev,
 139                 usb_sndctrlpipe(se401->dev, 0),
 140                 SE401_REQ_SET_EXT_FEATURE,
 141                 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 142                 param,
 143                 selector,
 144                 NULL,
 145                 0,
 146                 1000
 147         );
 148 }
 149
 150 static unsigned short se401_get_feature(struct usb_se401 *se401,
 151                                         unsigned short selector)
 152 {
 153         /* For 'set' the selecetor should be in index, not sure if the spec is
 154            wrong here to....
 155          */
 156         unsigned char cp[2];
 157         usb_control_msg(
 158                 se401->dev,
 159                 usb_rcvctrlpipe(se401->dev, 0),
 160                 SE401_REQ_GET_EXT_FEATURE,
 161                 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 162                 0,
 163                 selector,
 164                 cp,
 165                 2,
 166                 1000
 167         );
 168         return cp[0]+cp[1]*256;
 169 }
 170
 171 /****************************************************************************
 172  *
 173  * Camera control
 174  *
 175  ***************************************************************************/
 176
 177
 178 static int se401_send_pict(struct usb_se401 *se401)
 179 {
 180         /* integration time low */
 181         se401_set_feature(se401, HV7131_REG_TITL, se401->expose_l);
 182         /* integration time mid */
 183         se401_set_feature(se401, HV7131_REG_TITM, se401->expose_m);
 184         /* integration time mid */
 185         se401_set_feature(se401, HV7131_REG_TITU, se401->expose_h);
 186         /* reset level value */
 187         se401_set_feature(se401, HV7131_REG_ARLV, se401->resetlevel);
 188         /* red color gain */
 189         se401_set_feature(se401, HV7131_REG_ARCG, se401->rgain);
 190         /* green color gain */
 191         se401_set_feature(se401, HV7131_REG_AGCG, se401->ggain);
 192         /* blue color gain */
 193         se401_set_feature(se401, HV7131_REG_ABCG, se401->bgain);
 194
 195         return 0;
 196 }
 197
 198 static void se401_set_exposure(struct usb_se401 *se401, int brightness)
 199 {
 200         int integration = brightness << 5;
 201
 202         if (flickerless == 50)
 203                 integration = integration-integration % 106667;
 204         if (flickerless == 60)
 205                 integration = integration-integration % 88889;
 206         se401->brightness = integration >> 5;
 207         se401->expose_h = (integration >> 16) & 0xff;
 208         se401->expose_m = (integration >> 8) & 0xff;
 209         se401->expose_l = integration & 0xff;
 210 }
 211
 212 static int se401_get_pict(struct usb_se401 *se401, struct video_picture *p)
 213 {
 214         p->brightness = se401->brightness;
 215         if (se401->enhance)
 216                 p->whiteness = 32768;
 217         else
 218                 p->whiteness = 0;
 219
 220         p->colour = 65535;
 221         p->contrast = 65535;
 222         p->hue = se401->rgain << 10;
 223         p->palette = se401->palette;
 224         p->depth = 3; /* rgb24 */
 225         return 0;
 226 }
 227
 228
 229 static int se401_set_pict(struct usb_se401 *se401, struct video_picture *p)
 230 {
 231         if (p->palette != VIDEO_PALETTE_RGB24)
 232                 return 1;
 233         se401->palette = p->palette;
 234         if (p->hue != se401->hue) {
 235                 se401->rgain =  p->hue >> 10;
 236                 se401->bgain =  0x40-(p->hue >> 10);
 237                 se401->hue = p->hue;
 238         }
 239         if (p->brightness != se401->brightness)
 240                 se401_set_exposure(se401, p->brightness);
 241
 242         if (p->whiteness >= 32768)
 243                 se401->enhance = 1;
 244         else
 245                 se401->enhance = 0;
 246         se401_send_pict(se401);
 247         se401_send_pict(se401);
 248         return 0;
 249 }
 250
 251 /*
 252         Hyundai have some really nice docs about this and other sensor related
 253         stuff on their homepage: www.hei.co.kr
 254 */
 255 static void se401_auto_resetlevel(struct usb_se401 *se401)
 256 {
 257         unsigned int ahrc, alrc;
 258         int oldreset = se401->resetlevel;
 259
 260         /* For some reason this normally read-only register doesn't get reset
 261            to zero after reading them just once...
 262          */
 263         se401_get_feature(se401, HV7131_REG_HIREFNOH);
 264         se401_get_feature(se401, HV7131_REG_HIREFNOL);
 265         se401_get_feature(se401, HV7131_REG_LOREFNOH);
 266         se401_get_feature(se401, HV7131_REG_LOREFNOL);
 267         ahrc = 256*se401_get_feature(se401, HV7131_REG_HIREFNOH) +
 268             se401_get_feature(se401, HV7131_REG_HIREFNOL);
 269         alrc = 256*se401_get_feature(se401, HV7131_REG_LOREFNOH) +
 270             se401_get_feature(se401, HV7131_REG_LOREFNOL);
 271
 272         /* Not an exact science, but it seems to work pretty well... */
 273         if (alrc > 10) {
 274                 while (alrc >= 10 && se401->resetlevel < 63) {
 275                         se401->resetlevel++;
 276                         alrc /= 2;
 277                 }
 278         } else if (ahrc > 20) {
 279                 while (ahrc >= 20 && se401->resetlevel > 0) {
 280                         se401->resetlevel--;
 281                         ahrc /= 2;
 282                 }
 283         }
 284         if (se401->resetlevel != oldreset)
 285                 se401_set_feature(se401, HV7131_REG_ARLV, se401->resetlevel);
 286
 287         return;
 288 }
 289
 290 /* irq handler for snapshot button */
 291 static void se401_button_irq(struct urb *urb)
 292 {
 293         struct usb_se401 *se401 = urb->context;
 294         int status;
 295
 296         if (!se401->dev) {
 297                 dev_info(&urb->dev->dev, "device vapourished\n");
 298                 return;
 299         }
 300
 301         switch (urb->status) {
 302         case 0:
 303                 /* success */
 304                 break;
 305         case -ECONNRESET:
 306         case -ENOENT:
 307         case -ESHUTDOWN:
 308                 /* this urb is terminated, clean up */
 309                 dbg("%s - urb shutting down with status: %d",
 310                                                         __func__, urb->status);
 311                 return;
 312         default:
 313                 dbg("%s - nonzero urb status received: %d",
 314                                                         __func__, urb->status);
 315                 goto exit;
 316         }
 317
 318         if (urb->actual_length  >= 2)
 319                 if (se401->button)
 320                         se401->buttonpressed = 1;
 321 exit:
 322         status = usb_submit_urb(urb, GFP_ATOMIC);
 323         if (status)
 324                 err("%s - usb_submit_urb failed with result %d",
 325                      __func__, status);
 326 }
 327
 328 static void se401_video_irq(struct urb *urb)
 329 {
 330         struct usb_se401 *se401 = urb->context;
 331         int length = urb->actual_length;
 332
 333         /* ohoh... */
 334         if (!se401->streaming)
 335                 return;
 336
 337         if (!se401->dev) {
 338                 dev_info(&urb->dev->dev, "device vapourished\n");
 339                 return;
 340         }
 341
 342         /* 0 sized packets happen if we are to fast, but sometimes the camera
 343            keeps sending them forever...
 344          */
 345         if (length && !urb->status) {
 346                 se401->nullpackets = 0;
 347                 switch (se401->scratch[se401->scratch_next].state) {
 348                 case BUFFER_READY:
 349                 case BUFFER_BUSY:
 350                         se401->dropped++;
 351                         break;
 352                 case BUFFER_UNUSED:
 353                         memcpy(se401->scratch[se401->scratch_next].data,
 354                                 (unsigned char *)urb->transfer_buffer, length);
 355                         se401->scratch[se401->scratch_next].state
 356                                                         = BUFFER_READY;
 357                         se401->scratch[se401->scratch_next].offset
 358                                                         = se401->bayeroffset;
 359                         se401->scratch[se401->scratch_next].length = length;
 360                         if (waitqueue_active(&se401->wq))
 361                                 wake_up_interruptible(&se401->wq);
 362                         se401->scratch_overflow = 0;
 363                         se401->scratch_next++;
 364                         if (se401->scratch_next >= SE401_NUMSCRATCH)
 365                                 se401->scratch_next = 0;
 366                         break;
 367                 }
 368                 se401->bayeroffset += length;
 369                 if (se401->bayeroffset >= se401->cheight * se401->cwidth)
 370                         se401->bayeroffset = 0;
 371         } else {
 372                 se401->nullpackets++;
 373                 if (se401->nullpackets > SE401_MAX_NULLPACKETS)
 374                         if (waitqueue_active(&se401->wq))
 375                                 wake_up_interruptible(&se401->wq);
 376         }
 377
 378         /* Resubmit urb for new data */
 379         urb->status = 0;
 380         urb->dev = se401->dev;
 381         if (usb_submit_urb(urb, GFP_KERNEL))
 382                 dev_info(&urb->dev->dev, "urb burned down\n");
 383         return;
 384 }
 385
 386 static void se401_send_size(struct usb_se401 *se401, int width, int height)
 387 {
 388         int i = 0;
 389         int mode = 0x03; /* No compression */
 390         int sendheight = height;
 391         int sendwidth = width;
 392
 393         /* JangGu compression can only be used with the camera supported sizes,
 394            but bayer seems to work with any size that fits on the sensor.
 395            We check if we can use compression with the current size with either
 396            4 or 16 times subcapturing, if not we use uncompressed bayer data
 397            but this will result in cutouts of the maximum size....
 398          */
 399         while (i < se401->sizes && !(se401->width[i] == width &&
 400                                                 se401->height[i] == height))
 401                 i++;
 402         while (i < se401->sizes) {
 403                 if (se401->width[i] == width * 2 &&
 404                                 se401->height[i] == height * 2) {
 405                         sendheight = se401->height[i];
 406                         sendwidth = se401->width[i];
 407                         mode = 0x40;
 408                 }
 409                 if (se401->width[i] == width * 4 &&
 410                                 se401->height[i] == height * 4) {
 411                         sendheight = se401->height[i];
 412                         sendwidth = se401->width[i];
 413                         mode = 0x42;
 414                 }
 415                 i++;
 416         }
 417
 418         se401_sndctrl(1, se401, SE401_REQ_SET_WIDTH, sendwidth, NULL, 0);
 419         se401_sndctrl(1, se401, SE401_REQ_SET_HEIGHT, sendheight, NULL, 0);
 420         se401_set_feature(se401, SE401_OPERATINGMODE, mode);
 421
 422         if (mode == 0x03)
 423                 se401->format = FMT_BAYER;
 424         else
 425                 se401->format = FMT_JANGGU;
 426 }
 427
 428 /*
 429         In this function se401_send_pict is called several times,
 430         for some reason (depending on the state of the sensor and the phase of
 431         the moon :) doing this only in either place doesn't always work...
 432 */
 433 static int se401_start_stream(struct usb_se401 *se401)
 434 {
 435         struct urb *urb;
 436         int err = 0, i;
 437         se401->streaming = 1;
 438
 439         se401_sndctrl(1, se401, SE401_REQ_CAMERA_POWER, 1, NULL, 0);
 440         se401_sndctrl(1, se401, SE401_REQ_LED_CONTROL, 1, NULL, 0);
 441
 442         /* Set picture settings */
 443         /* windowed + pix intg */
 444         se401_set_feature(se401, HV7131_REG_MODE_B, 0x05);
 445         se401_send_pict(se401);
 446
 447         se401_send_size(se401, se401->cwidth, se401->cheight);
 448
 449         se401_sndctrl(1, se401, SE401_REQ_START_CONTINUOUS_CAPTURE,
 450                                                                 0, NULL, 0);
 451
 452         /* Do some memory allocation */
 453         for (i = 0; i < SE401_NUMFRAMES; i++) {
 454                 se401->frame[i].data = se401->fbuf + i * se401->maxframesize;
 455                 se401->frame[i].curpix = 0;
 456         }
 457         for (i = 0; i < SE401_NUMSBUF; i++) {
 458                 se401->sbuf[i].data = kmalloc(SE401_PACKETSIZE, GFP_KERNEL);
 459                 if (!se401->sbuf[i].data) {
 460                         for (i = i - 1; i >= 0; i--) {
 461                                 kfree(se401->sbuf[i].data);
 462                                 se401->sbuf[i].data = NULL;
 463                         }
 464                         return -ENOMEM;
 465                 }
 466         }
 467
 468         se401->bayeroffset = 0;
 469         se401->scratch_next = 0;
 470         se401->scratch_use = 0;
 471         se401->scratch_overflow = 0;
 472         for (i = 0; i < SE401_NUMSCRATCH; i++) {
 473                 se401->scratch[i].data = kmalloc(SE401_PACKETSIZE, GFP_KERNEL);
 474                 if (!se401->scratch[i].data) {
 475                         for (i = i - 1; i >= 0; i--) {
 476                                 kfree(se401->scratch[i].data);
 477                                 se401->scratch[i].data = NULL;
 478                         }
 479                         goto nomem_sbuf;
 480                 }
 481                 se401->scratch[i].state = BUFFER_UNUSED;
 482         }
 483
 484         for (i = 0; i < SE401_NUMSBUF; i++) {
 485                 urb = usb_alloc_urb(0, GFP_KERNEL);
 486                 if (!urb) {
 487                         for (i = i - 1; i >= 0; i--) {
 488                                 usb_kill_urb(se401->urb[i]);
 489                                 usb_free_urb(se401->urb[i]);
 490                                 se401->urb[i] = NULL;
 491                         }
 492                         goto nomem_scratch;
 493                 }
 494
 495                 usb_fill_bulk_urb(urb, se401->dev,
 496                         usb_rcvbulkpipe(se401->dev, SE401_VIDEO_ENDPOINT),
 497                         se401->sbuf[i].data, SE401_PACKETSIZE,
 498                         se401_video_irq,
 499                         se401);
 500
 501                 se401->urb[i] = urb;
 502
 503                 err = usb_submit_urb(se401->urb[i], GFP_KERNEL);
 504                 if (err)
 505                         err("urb burned down");
 506         }
 507
 508         se401->framecount = 0;
 509
 510         return 0;
 511
 512  nomem_scratch:
 513         for (i = 0; i < SE401_NUMSCRATCH; i++) {
 514                 kfree(se401->scratch[i].data);
 515                 se401->scratch[i].data = NULL;
 516         }
 517  nomem_sbuf:
 518         for (i = 0; i < SE401_NUMSBUF; i++) {
 519                 kfree(se401->sbuf[i].data);
 520                 se401->sbuf[i].data = NULL;
 521         }
 522         return -ENOMEM;
 523 }
 524
 525 static int se401_stop_stream(struct usb_se401 *se401)
 526 {
 527         int i;
 528
 529         if (!se401->streaming || !se401->dev)
 530                 return 1;
 531
 532         se401->streaming = 0;
 533
 534         se401_sndctrl(1, se401, SE401_REQ_STOP_CONTINUOUS_CAPTURE, 0, NULL, 0);
 535
 536         se401_sndctrl(1, se401, SE401_REQ_LED_CONTROL, 0, NULL, 0);
 537         se401_sndctrl(1, se401, SE401_REQ_CAMERA_POWER, 0, NULL, 0);
 538
 539         for (i = 0; i < SE401_NUMSBUF; i++)
 540                 if (se401->urb[i]) {
 541                         usb_kill_urb(se401->urb[i]);
 542                         usb_free_urb(se401->urb[i]);
 543                         se401->urb[i] = NULL;
 544                         kfree(se401->sbuf[i].data);
 545                 }
 546         for (i = 0; i < SE401_NUMSCRATCH; i++) {
 547                 kfree(se401->scratch[i].data);
 548                 se401->scratch[i].data = NULL;
 549         }
 550
 551         return 0;
 552 }
 553
 554 static int se401_set_size(struct usb_se401 *se401, int width, int height)
 555 {
 556         int wasstreaming = se401->streaming;
 557         /* Check to see if we need to change */
 558         if (se401->cwidth == width && se401->cheight == height)
 559                 return 0;
 560
 561         /* Check for a valid mode */
 562         if (!width || !height)
 563                 return 1;
 564         if ((width & 1) || (height & 1))
 565                 return 1;
 566         if (width > se401->width[se401->sizes-1])
 567                 return 1;
 568         if (height > se401->height[se401->sizes-1])
 569                 return 1;
 570
 571         /* Stop a current stream and start it again at the new size */
 572         if (wasstreaming)
 573                 se401_stop_stream(se401);
 574         se401->cwidth = width;
 575         se401->cheight = height;
 576         if (wasstreaming)
 577                 se401_start_stream(se401);
 578         return 0;
 579 }
 580
 581
 582 /****************************************************************************
 583  *
 584  * Video Decoding
 585  *
 586  ***************************************************************************/
 587
 588 /*
 589         This shouldn't really be done in a v4l driver....
 590         But it does make the image look a lot more usable.
 591         Basically it lifts the dark pixels more than the light pixels.
 592 */
 593 static inline void enhance_picture(unsigned char *frame, int len)
 594 {
 595         while (len--) {
 596                 *frame = (((*frame^255)*(*frame^255))/255)^255;
 597                 frame++;
 598         }
 599 }
 600
 601 static inline void decode_JangGu_integrate(struct usb_se401 *se401, int data)
 602 {
 603         struct se401_frame *frame = &se401->frame[se401->curframe];
 604         int linelength = se401->cwidth * 3;
 605
 606         if (frame->curlinepix >= linelength) {
 607                 frame->curlinepix = 0;
 608                 frame->curline += linelength;
 609         }
 610
 611         /* First three are absolute, all others relative.
 612          * Format is rgb from right to left (mirrorred image),
 613          * we flip it to get bgr from left to right. */
 614         if (frame->curlinepix < 3)
 615                 *(frame->curline-frame->curlinepix) = 1 + data * 4;
 616         else
 617                 *(frame->curline-frame->curlinepix) =
 618                     *(frame->curline-frame->curlinepix + 3) + data * 4;
 619         frame->curlinepix++;
 620 }
 621
 622 static inline void decode_JangGu_vlc(struct usb_se401 *se401,
 623                         unsigned char *data, int bit_exp, int packetlength)
 624 {
 625         int pos = 0;
 626         int vlc_cod = 0;
 627         int vlc_size = 0;
 628         int vlc_data = 0;
 629         int bit_cur;
 630         int bit;
 631         data += 4;
 632         while (pos < packetlength) {
 633                 bit_cur = 8;
 634                 while (bit_cur && bit_exp) {
 635                         bit = ((*data) >> (bit_cur-1))&1;
 636                         if (!vlc_cod) {
 637                                 if (bit) {
 638                                         vlc_size++;
 639                                 } else {
 640                                         if (!vlc_size)
 641                                                 decode_JangGu_integrate(se401, 0);
 642                                         else {
 643                                                 vlc_cod = 2;
 644                                                 vlc_data = 0;
 645                                         }
 646                                 }
 647                         } else {
 648                                 if (vlc_cod == 2) {
 649                                         if (!bit)
 650                                                 vlc_data =  -(1 << vlc_size) + 1;
 651                                         vlc_cod--;
 652                                 }
 653                                 vlc_size--;
 654                                 vlc_data += bit << vlc_size;
 655                                 if (!vlc_size) {
 656                                         decode_JangGu_integrate(se401, vlc_data);
 657                                         vlc_cod = 0;
 658                                 }
 659                         }
 660                         bit_cur--;
 661                         bit_exp--;
 662                 }
 663                 pos++;
 664                 data++;
 665         }
 666 }
 667
 668 static inline void decode_JangGu(struct usb_se401 *se401,
 669                                                 struct se401_scratch *buffer)
 670 {
 671         unsigned char *data = buffer->data;
 672         int len = buffer->length;
 673         int bit_exp = 0, pix_exp = 0, frameinfo = 0, packetlength = 0, size;
 674         int datapos = 0;
 675
 676         /* New image? */
 677         if (!se401->frame[se401->curframe].curpix) {
 678                 se401->frame[se401->curframe].curlinepix = 0;
 679                 se401->frame[se401->curframe].curline =
 680                     se401->frame[se401->curframe].data+
 681                     se401->cwidth * 3 - 1;
 682                 if (se401->frame[se401->curframe].grabstate == FRAME_READY)
 683                         se401->frame[se401->curframe].grabstate = FRAME_GRABBING;
 684                 se401->vlcdatapos = 0;
 685         }
 686         while (datapos < len) {
 687                 size = 1024 - se401->vlcdatapos;
 688                 if (size+datapos > len)
 689                         size = len-datapos;
 690                 memcpy(se401->vlcdata+se401->vlcdatapos, data+datapos, size);
 691                 se401->vlcdatapos += size;
 692                 packetlength = 0;
 693                 if (se401->vlcdatapos >= 4) {
 694                         bit_exp = se401->vlcdata[3] + (se401->vlcdata[2] << 8);
 695                         pix_exp = se401->vlcdata[1] +
 696                                         ((se401->vlcdata[0] & 0x3f) << 8);
 697                         frameinfo = se401->vlcdata[0] & 0xc0;
 698                         packetlength = ((bit_exp + 47) >> 4) << 1;
 699                         if (packetlength > 1024) {
 700                                 se401->vlcdatapos = 0;
 701                                 datapos = len;
 702                                 packetlength = 0;
 703                                 se401->error++;
 704                                 se401->frame[se401->curframe].curpix = 0;
 705                         }
 706                 }
 707                 if (packetlength && se401->vlcdatapos >= packetlength) {
 708                         decode_JangGu_vlc(se401, se401->vlcdata, bit_exp,
 709                                                                 packetlength);
 710                         se401->frame[se401->curframe].curpix += pix_exp * 3;
 711                         datapos += size-(se401->vlcdatapos-packetlength);
 712                         se401->vlcdatapos = 0;
 713                         if (se401->frame[se401->curframe].curpix >= se401->cwidth * se401->cheight * 3) {
 714                                 if (se401->frame[se401->curframe].curpix == se401->cwidth * se401->cheight * 3) {
 715                                         if (se401->frame[se401->curframe].grabstate == FRAME_GRABBING) {
 716                                                 se401->frame[se401->curframe].grabstate = FRAME_DONE;
 717                                                 se401->framecount++;
 718                                                 se401->readcount++;
 719                                         }
 720                                         if (se401->frame[(se401->curframe + 1) & (SE401_NUMFRAMES - 1)].grabstate == FRAME_READY)
 721                                                 se401->curframe = (se401->curframe + 1) & (SE401_NUMFRAMES - 1);
 722                                 } else
 723                                         se401->error++;
 724                                 se401->frame[se401->curframe].curpix = 0;
 725                                 datapos = len;
 726                         }
 727                 } else
 728                         datapos += size;
 729         }
 730 }
 731
 732 static inline void decode_bayer(struct usb_se401 *se401,
 733                                                 struct se401_scratch *buffer)
 734 {
 735         unsigned char *data = buffer->data;
 736         int len = buffer->length;
 737         int offset = buffer->offset;
 738         int datasize = se401->cwidth * se401->cheight;
 739         struct se401_frame *frame = &se401->frame[se401->curframe];
 740         unsigned char *framedata = frame->data, *curline, *nextline;
 741         int width = se401->cwidth;
 742         int blineoffset = 0, bline;
 743         int linelength = width * 3, i;
 744
 745
 746         if (frame->curpix == 0) {
 747                 if (frame->grabstate == FRAME_READY)
 748                         frame->grabstate = FRAME_GRABBING;
 749
 750                 frame->curline = framedata + linelength;
 751                 frame->curlinepix = 0;
 752         }
 753
 754         if (offset != frame->curpix) {
 755                 /* Regard frame as lost :( */
 756                 frame->curpix = 0;
 757                 se401->error++;
 758                 return;
 759         }
 760
 761         /* Check if we have to much data */
 762         if (frame->curpix + len > datasize)
 763                 len = datasize-frame->curpix;
 764
 765         if (se401->cheight % 4)
 766                 blineoffset = 1;
 767         bline = frame->curpix / se401->cwidth+blineoffset;
 768
 769         curline = frame->curline;
 770         nextline = curline + linelength;
 771         if (nextline >= framedata+datasize * 3)
 772                 nextline = curline;
 773         while (len) {
 774                 if (frame->curlinepix >= width) {
 775                         frame->curlinepix -= width;
 776                         bline = frame->curpix / width + blineoffset;
 777                         curline += linelength*2;
 778                         nextline += linelength*2;
 779                         if (curline >= framedata+datasize * 3) {
 780                                 frame->curlinepix++;
 781                                 curline -= 3;
 782                                 nextline -= 3;
 783                                 len--;
 784                                 data++;
 785                                 frame->curpix++;
 786                         }
 787                         if (nextline >= framedata+datasize*3)
 788                                 nextline = curline;
 789                 }
 790                 if (bline & 1) {
 791                         if (frame->curlinepix & 1) {
 792                                 *(curline + 2) = *data;
 793                                 *(curline - 1) = *data;
 794                                 *(nextline + 2) = *data;
 795                                 *(nextline - 1) = *data;
 796                         } else {
 797                                 *(curline + 1) =
 798                                         (*(curline + 1) + *data) / 2;
 799                                 *(curline-2) =
 800                                         (*(curline - 2) + *data) / 2;
 801                                 *(nextline + 1) = *data;
 802                                 *(nextline - 2) = *data;
 803                         }
 804                 } else {
 805                         if (frame->curlinepix & 1) {
 806                                 *(curline + 1) =
 807                                         (*(curline + 1) + *data) / 2;
 808                                 *(curline - 2) =
 809                                         (*(curline - 2) + *data) / 2;
 810                                 *(nextline + 1) = *data;
 811                                 *(nextline - 2) = *data;
 812                         } else {
 813                                 *curline = *data;
 814                                 *(curline - 3) = *data;
 815                                 *nextline = *data;
 816                                 *(nextline - 3) = *data;
 817                         }
 818                 }
 819                 frame->curlinepix++;
 820                 curline -= 3;
 821                 nextline -= 3;
 822                 len--;
 823                 data++;
 824                 frame->curpix++;
 825         }
 826         frame->curline = curline;
 827
 828         if (frame->curpix >= datasize) {
 829                 /* Fix the top line */
 830                 framedata += linelength;
 831                 for (i = 0; i < linelength; i++) {
 832                         framedata--;
 833                         *framedata = *(framedata + linelength);
 834                 }
 835                 /* Fix the left side (green is already present) */
 836                 for (i = 0; i < se401->cheight; i++) {
 837                         *framedata = *(framedata + 3);
 838                         *(framedata + 1) = *(framedata + 4);
 839                         *(framedata + 2) = *(framedata + 5);
 840                         framedata += linelength;
 841                 }
 842                 frame->curpix = 0;
 843                 frame->grabstate = FRAME_DONE;
 844                 se401->framecount++;
 845                 se401->readcount++;
 846                 if (se401->frame[(se401->curframe + 1) &
 847                     (SE401_NUMFRAMES - 1)].grabstate == FRAME_READY) {
 848                         se401->curframe = (se401->curframe+1) &
 849                                                         (SE401_NUMFRAMES-1);
 850                 }
 851         }
 852 }
 853
 854 static int se401_newframe(struct usb_se401 *se401, int framenr)
 855 {
 856         DECLARE_WAITQUEUE(wait, current);
 857         int errors = 0;
 858
 859         while (se401->streaming &&
 860             (se401->frame[framenr].grabstate == FRAME_READY ||
 861              se401->frame[framenr].grabstate == FRAME_GRABBING)) {
 862                 if (!se401->frame[framenr].curpix)
 863                         errors++;
 864
 865                 wait_interruptible(
 866                     se401->scratch[se401->scratch_use].state != BUFFER_READY,
 867                                                     &se401->wq, &wait);
 868                 if (se401->nullpackets > SE401_MAX_NULLPACKETS) {
 869                         se401->nullpackets = 0;
 870                         dev_info(&se401->dev->dev,
 871                          "too many null length packets, restarting capture\n");
 872                         se401_stop_stream(se401);
 873                         se401_start_stream(se401);
 874                 } else {
 875                         if (se401->scratch[se401->scratch_use].state !=
 876                                                                 BUFFER_READY) {
 877                                 se401->frame[framenr].grabstate = FRAME_ERROR;
 878                                 return -EIO;
 879                         }
 880                         se401->scratch[se401->scratch_use].state = BUFFER_BUSY;
 881                         if (se401->format == FMT_JANGGU)
 882                                 decode_JangGu(se401,
 883                                         &se401->scratch[se401->scratch_use]);
 884                         else
 885                                 decode_bayer(se401,
 886                                         &se401->scratch[se401->scratch_use]);
 887
 888                         se401->scratch[se401->scratch_use].state =
 889                                                         BUFFER_UNUSED;
 890                         se401->scratch_use++;
 891                         if (se401->scratch_use >= SE401_NUMSCRATCH)
 892                                 se401->scratch_use = 0;
 893                         if (errors > SE401_MAX_ERRORS) {
 894                                 errors = 0;
 895                                 dev_info(&se401->dev->dev,
 896                                       "too many errors, restarting capture\n");
 897                                 se401_stop_stream(se401);
 898                                 se401_start_stream(se401);
 899                         }
 900                 }
 901         }
 902
 903         if (se401->frame[framenr].grabstate == FRAME_DONE)
 904                 if (se401->enhance)
 905                         enhance_picture(se401->frame[framenr].data,
 906                                         se401->cheight * se401->cwidth * 3);
 907         return 0;
 908 }
 909
 910 static void usb_se401_remove_disconnected(struct usb_se401 *se401)
 911 {
 912         int i;
 913
 914         se401->dev = NULL;
 915
 916         for (i = 0; i < SE401_NUMSBUF; i++)
 917                 if (se401->urb[i]) {
 918                         usb_kill_urb(se401->urb[i]);
 919                         usb_free_urb(se401->urb[i]);
 920                         se401->urb[i] = NULL;
 921                         kfree(se401->sbuf[i].data);
 922                 }
 923
 924         for (i = 0; i < SE401_NUMSCRATCH; i++)
 925                 kfree(se401->scratch[i].data);
 926
 927         if (se401->inturb) {
 928                 usb_kill_urb(se401->inturb);
 929                 usb_free_urb(se401->inturb);
 930         }
 931         dev_info(&se401->dev->dev, "%s disconnected", se401->camera_name);
 932
 933         /* Free the memory */
 934         kfree(se401->width);
 935         kfree(se401->height);
 936         kfree(se401);
 937 }
 938
 939
 940
 941 /****************************************************************************
 942  *
 943  * Video4Linux
 944  *
 945  ***************************************************************************/
 946
 947
 948 static int se401_open(struct file *file)
 949 {
 950         struct video_device *dev = video_devdata(file);
 951         struct usb_se401 *se401 = (struct usb_se401 *)dev;
 952         int err = 0;
 953
 954         lock_kernel();
 955         if (se401->user) {
 956                 unlock_kernel();
 957                 return -EBUSY;
 958         }
 959         se401->fbuf = rvmalloc(se401->maxframesize * SE401_NUMFRAMES);
 960         if (se401->fbuf)
 961                 file->private_data = dev;
 962         else
 963                 err = -ENOMEM;
 964         se401->user = !err;
 965         unlock_kernel();
 966
 967         return err;
 968 }
 969
 970 static int se401_close(struct file *file)
 971 {
 972         struct video_device *dev = file->private_data;
 973         struct usb_se401 *se401 = (struct usb_se401 *)dev;
 974         int i;
 975
 976         rvfree(se401->fbuf, se401->maxframesize * SE401_NUMFRAMES);
 977         if (se401->removed) {
 978                 dev_info(&se401->dev->dev, "device unregistered\n");
 979                 usb_se401_remove_disconnected(se401);
 980         } else {
 981                 for (i = 0; i < SE401_NUMFRAMES; i++)
 982                         se401->frame[i].grabstate = FRAME_UNUSED;
 983                 if (se401->streaming)
 984                         se401_stop_stream(se401);
 985                 se401->user = 0;
 986         }
 987         file->private_data = NULL;
 988         return 0;
 989 }
 990
 991 static long se401_do_ioctl(struct file *file, unsigned int cmd, void *arg)
 992 {
 993         struct video_device *vdev = file->private_data;
 994         struct usb_se401 *se401 = (struct usb_se401 *)vdev;
 995
 996         if (!se401->dev)
 997                 return -EIO;
 998
 999         switch (cmd) {
1000         case VIDIOCGCAP:
1001         {
1002                 struct video_capability *b = arg;
1003                 strcpy(b->name, se401->camera_name);
1004                 b->type = VID_TYPE_CAPTURE;
1005                 b->channels = 1;
1006                 b->audios = 0;
1007                 b->maxwidth = se401->width[se401->sizes-1];
1008                 b->maxheight = se401->height[se401->sizes-1];
1009                 b->minwidth = se401->width[0];
1010                 b->minheight = se401->height[0];
1011                 return 0;
1012         }
1013         case VIDIOCGCHAN:
1014         {
1015                 struct video_channel *v = arg;
1016
1017                 if (v->channel != 0)
1018                         return -EINVAL;
1019                 v->flags = 0;
1020                 v->tuners = 0;
1021                 v->type = VIDEO_TYPE_CAMERA;
1022                 strcpy(v->name, "Camera");
1023                 return 0;
1024         }
1025         case VIDIOCSCHAN:
1026         {
1027                 struct video_channel *v = arg;
1028
1029                 if (v->channel != 0)
1030                         return -EINVAL;
1031                 return 0;
1032         }
1033         case VIDIOCGPICT:
1034         {
1035                 struct video_picture *p = arg;
1036
1037                 se401_get_pict(se401, p);
1038                 return 0;
1039         }
1040         case VIDIOCSPICT:
1041         {
1042                 struct video_picture *p = arg;
1043
1044                 if (se401_set_pict(se401, p))
1045                         return -EINVAL;
1046                 return 0;
1047         }
1048         case VIDIOCSWIN:
1049         {
1050                 struct video_window *vw = arg;
1051
1052                 if (vw->flags)
1053                         return -EINVAL;
1054                 if (vw->clipcount)
1055                         return -EINVAL;
1056                 if (se401_set_size(se401, vw->width, vw->height))
1057                         return -EINVAL;
1058                 return 0;
1059         }
1060         case VIDIOCGWIN:
1061         {
1062                 struct video_window *vw = arg;
1063
1064                 vw->x = 0;               /* FIXME */
1065                 vw->y = 0;
1066                 vw->chromakey = 0;
1067                 vw->flags = 0;
1068                 vw->clipcount = 0;
1069                 vw->width = se401->cwidth;
1070                 vw->height = se401->cheight;
1071                 return 0;
1072         }
1073         case VIDIOCGMBUF:
1074         {
1075                 struct video_mbuf *vm = arg;
1076                 int i;
1077
1078                 memset(vm, 0, sizeof(*vm));
1079                 vm->size = SE401_NUMFRAMES * se401->maxframesize;
1080                 vm->frames = SE401_NUMFRAMES;
1081                 for (i = 0; i < SE401_NUMFRAMES; i++)
1082                         vm->offsets[i] = se401->maxframesize * i;
1083                 return 0;
1084         }
1085         case VIDIOCMCAPTURE:
1086         {
1087                 struct video_mmap *vm = arg;
1088
1089                 if (vm->format != VIDEO_PALETTE_RGB24)
1090                         return -EINVAL;
1091                 if (vm->frame >= SE401_NUMFRAMES)
1092                         return -EINVAL;
1093                 if (se401->frame[vm->frame].grabstate != FRAME_UNUSED)
1094                         return -EBUSY;
1095
1096                 /* Is this according to the v4l spec??? */
1097                 if (se401_set_size(se401, vm->width, vm->height))
1098                         return -EINVAL;
1099                 se401->frame[vm->frame].grabstate = FRAME_READY;
1100
1101                 if (!se401->streaming)
1102                         se401_start_stream(se401);
1103
1104                 /* Set the picture properties */
1105                 if (se401->framecount == 0)
1106                         se401_send_pict(se401);
1107                 /* Calibrate the reset level after a few frames. */
1108                 if (se401->framecount % 20 == 1)
1109                         se401_auto_resetlevel(se401);
1110
1111                 return 0;
1112         }
1113         case VIDIOCSYNC:
1114         {
1115                 int *frame = arg;
1116                 int ret = 0;
1117
1118                 if (*frame < 0 || *frame >= SE401_NUMFRAMES)
1119                         return -EINVAL;
1120
1121                 ret = se401_newframe(se401, *frame);
1122                 se401->frame[*frame].grabstate = FRAME_UNUSED;
1123                 return ret;
1124         }
1125         case VIDIOCGFBUF:
1126         {
1127                 struct video_buffer *vb = arg;
1128
1129                 memset(vb, 0, sizeof(*vb));
1130                 return 0;
1131         }
1132         case VIDIOCKEY:
1133                 return 0;
1134         case VIDIOCCAPTURE:
1135                 return -EINVAL;
1136         case VIDIOCSFBUF:
1137                 return -EINVAL;
1138         case VIDIOCGTUNER:
1139         case VIDIOCSTUNER:
1140                 return -EINVAL;
1141         case VIDIOCGFREQ:
1142         case VIDIOCSFREQ:
1143                 return -EINVAL;
1144         case VIDIOCGAUDIO:
1145         case VIDIOCSAUDIO:
1146                 return -EINVAL;
1147         default:
1148                 return -ENOIOCTLCMD;
1149         } /* end switch */
1150
1151         return 0;
1152 }
1153
1154 static long se401_ioctl(struct file *file,
1155                        unsigned int cmd, unsigned long arg)
1156 {
1157         return video_usercopy(file, cmd, arg, se401_do_ioctl);
1158 }
1159
1160 static ssize_t se401_read(struct file *file, char __user *buf,
1161                      size_t count, loff_t *ppos)
1162 {
1163         int realcount = count, ret = 0;
1164         struct video_device *dev = file->private_data;
1165         struct usb_se401 *se401 = (struct usb_se401 *)dev;
1166
1167
1168         if (se401->dev ==  NULL)
1169                 return -EIO;
1170         if (realcount > se401->cwidth*se401->cheight*3)
1171                 realcount = se401->cwidth*se401->cheight*3;
1172
1173         /* Shouldn't happen: */
1174         if (se401->frame[0].grabstate == FRAME_GRABBING)
1175                 return -EBUSY;
1176         se401->frame[0].grabstate = FRAME_READY;
1177         se401->frame[1].grabstate = FRAME_UNUSED;
1178         se401->curframe = 0;
1179
1180         if (!se401->streaming)
1181                 se401_start_stream(se401);
1182
1183         /* Set the picture properties */
1184         if (se401->framecount == 0)
1185                 se401_send_pict(se401);
1186         /* Calibrate the reset level after a few frames. */
1187         if (se401->framecount%20 == 1)
1188                 se401_auto_resetlevel(se401);
1189
1190         ret = se401_newframe(se401, 0);
1191
1192         se401->frame[0].grabstate = FRAME_UNUSED;
1193         if (ret)
1194                 return ret;
1195         if (copy_to_user(buf, se401->frame[0].data, realcount))
1196                 return -EFAULT;
1197
1198         return realcount;
1199 }
1200
1201 static int se401_mmap(struct file *file, struct vm_area_struct *vma)
1202 {
1203         struct video_device *dev = file->private_data;
1204         struct usb_se401 *se401 = (struct usb_se401 *)dev;
1205         unsigned long start = vma->vm_start;
1206         unsigned long size  = vma->vm_end-vma->vm_start;
1207         unsigned long page, pos;
1208
1209         mutex_lock(&se401->lock);
1210
1211         if (se401->dev ==  NULL) {
1212                 mutex_unlock(&se401->lock);
1213                 return -EIO;
1214         }
1215         if (size > (((SE401_NUMFRAMES * se401->maxframesize) + PAGE_SIZE - 1)
1216                                                         & ~(PAGE_SIZE - 1))) {
1217                 mutex_unlock(&se401->lock);
1218                 return -EINVAL;
1219         }
1220         pos = (unsigned long)se401->fbuf;
1221         while (size > 0) {
1222                 page = vmalloc_to_pfn((void *)pos);
1223                 if (remap_pfn_range(vma, start, page, PAGE_SIZE, PAGE_SHARED)) {
1224                         mutex_unlock(&se401->lock);
1225                         return -EAGAIN;
1226                 }
1227                 start +=  PAGE_SIZE;
1228                 pos +=  PAGE_SIZE;
1229                 if (size > PAGE_SIZE)
1230                         size -=  PAGE_SIZE;
1231                 else
1232                         size = 0;
1233         }
1234         mutex_unlock(&se401->lock);
1235
1236         return 0;
1237 }
1238
1239 static const struct v4l2_file_operations se401_fops = {
1240         .owner  =       THIS_MODULE,
1241         .open =         se401_open,
1242         .release =      se401_close,
1243         .read =         se401_read,
1244         .mmap =         se401_mmap,
1245         .ioctl =        se401_ioctl,
1246 };
1247 static struct video_device se401_template = {
1248         .name =         "se401 USB camera",
1249         .fops =         &se401_fops,
1250         .release = video_device_release_empty,
1251 };
1252
1253
1254
1255 /***************************/
1256 static int se401_init(struct usb_se401 *se401, int button)
1257 {
1258         int i = 0, rc;
1259         unsigned char cp[0x40];
1260         char temp[200];
1261         int slen;
1262
1263         /* led on */
1264         se401_sndctrl(1, se401, SE401_REQ_LED_CONTROL, 1, NULL, 0);
1265
1266         /* get camera descriptor */
1267         rc = se401_sndctrl(0, se401, SE401_REQ_GET_CAMERA_DESCRIPTOR, 0,
1268                                                         cp, sizeof(cp));
1269         if (cp[1] != 0x41) {
1270                 err("Wrong descriptor type");
1271                 return 1;
1272         }
1273         slen = snprintf(temp, 200, "ExtraFeatures: %d", cp[3]);
1274
1275         se401->sizes = cp[4] + cp[5] * 256;
1276         se401->width = kmalloc(se401->sizes*sizeof(int), GFP_KERNEL);
1277         if (!se401->width)
1278                 return 1;
1279         se401->height = kmalloc(se401->sizes*sizeof(int), GFP_KERNEL);
1280         if (!se401->height) {
1281                 kfree(se401->width);
1282                 return 1;
1283         }
1284         for (i = 0; i < se401->sizes; i++) {
1285                 se401->width[i] = cp[6 + i * 4 + 0] + cp[6 + i*4 + 1] * 256;
1286                 se401->height[i] = cp[6 + i * 4 + 2] + cp[6 + i * 4 + 3] * 256;
1287         }
1288         slen += snprintf(temp + slen, 200 - slen, " Sizes:");
1289         for (i = 0; i < se401->sizes; i++) {
1290                 slen +=  snprintf(temp + slen, 200 - slen,
1291                         " %dx%d", se401->width[i], se401->height[i]);
1292         }
1293         dev_info(&se401->dev->dev, "%s\n", temp);
1294         se401->maxframesize = se401->width[se401->sizes-1] *
1295                                         se401->height[se401->sizes - 1] * 3;
1296
1297         rc = se401_sndctrl(0, se401, SE401_REQ_GET_WIDTH, 0, cp, sizeof(cp));
1298         se401->cwidth = cp[0]+cp[1]*256;
1299         rc = se401_sndctrl(0, se401, SE401_REQ_GET_HEIGHT, 0, cp, sizeof(cp));
1300         se401->cheight = cp[0]+cp[1]*256;
1301
1302         if (!(cp[2] & SE401_FORMAT_BAYER)) {
1303                 err("Bayer format not supported!");
1304                 return 1;
1305         }
1306         /* set output mode (BAYER) */
1307         se401_sndctrl(1, se401, SE401_REQ_SET_OUTPUT_MODE,
1308                                                 SE401_FORMAT_BAYER, NULL, 0);
1309
1310         rc = se401_sndctrl(0, se401, SE401_REQ_GET_BRT, 0, cp, sizeof(cp));
1311         se401->brightness = cp[0]+cp[1]*256;
1312         /* some default values */
1313         se401->resetlevel = 0x2d;
1314         se401->rgain = 0x20;
1315         se401->ggain = 0x20;
1316         se401->bgain = 0x20;
1317         se401_set_exposure(se401, 20000);
1318         se401->palette = VIDEO_PALETTE_RGB24;
1319         se401->enhance = 1;
1320         se401->dropped = 0;
1321         se401->error = 0;
1322         se401->framecount = 0;
1323         se401->readcount = 0;
1324
1325         /* Start interrupt transfers for snapshot button */
1326         if (button) {
1327                 se401->inturb = usb_alloc_urb(0, GFP_KERNEL);
1328                 if (!se401->inturb) {
1329                         dev_info(&se401->dev->dev,
1330                                  "Allocation of inturb failed\n");
1331                         return 1;
1332                 }
1333                 usb_fill_int_urb(se401->inturb, se401->dev,
1334                     usb_rcvintpipe(se401->dev, SE401_BUTTON_ENDPOINT),
1335                     &se401->button, sizeof(se401->button),
1336                     se401_button_irq,
1337                     se401,
1338                     8
1339                 );
1340                 if (usb_submit_urb(se401->inturb, GFP_KERNEL)) {
1341                         dev_info(&se401->dev->dev, "int urb burned down\n");
1342                         return 1;
1343                 }
1344         } else
1345                 se401->inturb = NULL;
1346
1347         /* Flash the led */
1348         se401_sndctrl(1, se401, SE401_REQ_CAMERA_POWER, 1, NULL, 0);
1349         se401_sndctrl(1, se401, SE401_REQ_LED_CONTROL, 1, NULL, 0);
1350         se401_sndctrl(1, se401, SE401_REQ_CAMERA_POWER, 0, NULL, 0);
1351         se401_sndctrl(1, se401, SE401_REQ_LED_CONTROL, 0, NULL, 0);
1352
1353         return 0;
1354 }
1355
1356 static int se401_probe(struct usb_interface *intf,
1357         const struct usb_device_id *id)
1358 {
1359         struct usb_device *dev = interface_to_usbdev(intf);
1360         struct usb_interface_descriptor *interface;
1361         struct usb_se401 *se401;
1362         char *camera_name = NULL;
1363         int button = 1;
1364
1365         /* We don't handle multi-config cameras */
1366         if (dev->descriptor.bNumConfigurations != 1)
1367                 return -ENODEV;
1368
1369         interface = &intf->cur_altsetting->desc;
1370
1371         /* Is it an se401? */
1372         if (le16_to_cpu(dev->descriptor.idVendor) ==  0x03e8 &&
1373             le16_to_cpu(dev->descriptor.idProduct) ==  0x0004) {
1374                 camera_name = "Endpoints/Aox SE401";
1375         } else if (le16_to_cpu(dev->descriptor.idVendor) ==  0x0471 &&
1376             le16_to_cpu(dev->descriptor.idProduct) ==  0x030b) {
1377                 camera_name = "Philips PCVC665K";
1378         } else if (le16_to_cpu(dev->descriptor.idVendor) ==  0x047d &&
1379             le16_to_cpu(dev->descriptor.idProduct) ==  0x5001) {
1380                 camera_name = "Kensington VideoCAM 67014";
1381         } else if (le16_to_cpu(dev->descriptor.idVendor) ==  0x047d &&
1382             le16_to_cpu(dev->descriptor.idProduct) ==  0x5002) {
1383                 camera_name = "Kensington VideoCAM 6701(5/7)";
1384         } else if (le16_to_cpu(dev->descriptor.idVendor) ==  0x047d &&
1385             le16_to_cpu(dev->descriptor.idProduct) ==  0x5003) {
1386                 camera_name = "Kensington VideoCAM 67016";
1387                 button = 0;
1388         } else
1389                 return -ENODEV;
1390
1391         /* Checking vendor/product should be enough, but what the hell */
1392         if (interface->bInterfaceClass != 0x00)
1393                 return -ENODEV;
1394         if (interface->bInterfaceSubClass != 0x00)
1395                 return -ENODEV;
1396
1397         /* We found one */
1398         dev_info(&intf->dev, "SE401 camera found: %s\n", camera_name);
1399
1400         se401 = kzalloc(sizeof(*se401), GFP_KERNEL);
1401         if (se401 ==  NULL) {
1402                 err("couldn't kmalloc se401 struct");
1403                 return -ENOMEM;
1404         }
1405
1406         se401->dev = dev;
1407         se401->iface = interface->bInterfaceNumber;
1408         se401->camera_name = camera_name;
1409
1410         dev_info(&intf->dev, "firmware version: %02x\n",
1411                  le16_to_cpu(dev->descriptor.bcdDevice) & 255);
1412
1413         if (se401_init(se401, button)) {
1414                 kfree(se401);
1415                 return -EIO;
1416         }
1417
1418         memcpy(&se401->vdev, &se401_template, sizeof(se401_template));
1419         memcpy(se401->vdev.name, se401->camera_name,
1420                                         strlen(se401->camera_name));
1421         init_waitqueue_head(&se401->wq);
1422         mutex_init(&se401->lock);
1423         wmb();
1424
1425         if (video_register_device(&se401->vdev,
1426                                         VFL_TYPE_GRABBER, video_nr) < 0) {
1427                 kfree(se401);
1428                 err("video_register_device failed");
1429                 return -EIO;
1430         }
1431         dev_info(&intf->dev, "registered new video device: video%d\n",
1432                  se401->vdev.num);
1433
1434         usb_set_intfdata(intf, se401);
1435         return 0;
1436 }
1437
1438 static void se401_disconnect(struct usb_interface *intf)
1439 {
1440         struct usb_se401 *se401 = usb_get_intfdata(intf);
1441
1442         usb_set_intfdata(intf, NULL);
1443         if (se401) {
1444                 video_unregister_device(&se401->vdev);
1445                 if (!se401->user)
1446                         usb_se401_remove_disconnected(se401);
1447                 else {
1448                         se401->frame[0].grabstate = FRAME_ERROR;
1449                         se401->frame[0].grabstate = FRAME_ERROR;
1450
1451                         se401->streaming = 0;
1452
1453                         wake_up_interruptible(&se401->wq);
1454                         se401->removed = 1;
1455                 }
1456         }
1457 }
1458
1459 static struct usb_driver se401_driver = {
1460         .name            =  "se401",
1461         .id_table        =  device_table,
1462         .probe           =  se401_probe,
1463         .disconnect      =  se401_disconnect,
1464 };
1465
1466
1467
1468 /****************************************************************************
1469  *
1470  *  Module routines
1471  *
1472  ***************************************************************************/
1473
1474 static int __init usb_se401_init(void)
1475 {
1476         printk(KERN_INFO "SE401 usb camera driver version %s registering\n",
1477                                                                 version);
1478         if (flickerless)
1479                 if (flickerless != 50 && flickerless != 60) {
1480                         printk(KERN_ERR "Invallid flickerless value, use 0, 50 or 60.\n");
1481                         return -1;
1482         }
1483         return usb_register(&se401_driver);
1484 }
1485
1486 static void __exit usb_se401_exit(void)
1487 {
1488         usb_deregister(&se401_driver);
1489         printk(KERN_INFO "SE401 driver deregistered\frame");
1490 }
1491
1492 module_init(usb_se401_init);
1493 module_exit(usb_se401_exit);