V4L/DVB (8152): Initial release of gspca with only one driver.
Jean-Francois Moine [Sat, 12 Apr 2008 12:58:09 +0000 (09:58 -0300)]
Signed-off-by: Jean-Francois Moine <moinejf@free.fr>
Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>

Documentation/video4linux/gspca.txt [new file with mode: 0644]
drivers/media/video/Kconfig
drivers/media/video/gspca/Kconfig [new file with mode: 0644]
drivers/media/video/gspca/Makefile [new file with mode: 0644]
drivers/media/video/gspca/gspca.c [new file with mode: 0644]
drivers/media/video/gspca/gspca.h [new file with mode: 0644]
drivers/media/video/gspca/jpeg.h [new file with mode: 0644]
drivers/media/video/gspca/stk014.c [new file with mode: 0644]

diff --git a/Documentation/video4linux/gspca.txt b/Documentation/video4linux/gspca.txt
new file mode 100644 (file)
index 0000000..9c404b5
--- /dev/null
@@ -0,0 +1,238 @@
+Here the list of the known working cameras with gspca.
+
+The modules are:
+       gspca_main      main driver
+       gspca_xxxx      subdriver module with xxxx as follows
+
+xxxx           vend:prod
+----
+conex          0572:0041       Creative Notebook cx11646
+etoms          102c:6151       Qcam Sangha CIF
+etoms          102c:6251       Qcam xxxxxx VGA
+mars           093a:050f       Mars-Semi Pc-Camera
+ov519          041e:4052       Creative Live! VISTA IM
+ov519          041e:405f       Creative Live! VISTA VF0330
+ov519          041e:4060       Creative Live! VISTA VF0350
+ov519          041e:4061       Creative Live! VISTA VF0400
+ov519          041e:4064       Creative Live! VISTA VF0420
+ov519          041e:4068       Creative Live! VISTA VF0470
+ov519          045e:028c       Micro$oft xbox cam
+ov519          054c:0154       Sonny toy4
+ov519          054c:0155       Sonny toy5
+ov519          05a9:0519       OmniVision
+ov519          05a9:4519       OmniVision
+ov519          05a9:8519       OmniVision
+ov519          05a9:0530       OmniVision
+pac207         041e:4028       Creative Webcam Vista Plus
+pac207         093a:2460       PAC207 Qtec Webcam 100
+pac207         093a:2463       Philips spc200nc pac207
+pac207         093a:2464       Labtec Webcam 1200
+pac207         093a:2468       PAC207
+pac207         093a:2470       Genius GF112
+pac207         093a:2471       PAC207 Genius VideoCam ge111
+pac207         093a:2472       PAC207 Genius VideoCam ge110
+pac7311                093a:2600       PAC7311 Typhoon
+pac7311                093a:2601       PAC7311 Phillips SPC610NC
+pac7311                093a:2603       PAC7312
+pac7311                093a:2608       PAC7311 Trust WB-3300p
+pac7311                093a:260e       PAC7311 Gigaware VGA PC Camera, Trust WB-3350p, SIGMA cam 2350
+pac7311                093a:260f       PAC7311 SnakeCam
+sonixb         0c45:6001       Genius VideoCAM NB
+sonixb         0c45:6005       Sweex Tas5110
+sonixb         0c45:6007       Sonix sn9c101 + Tas5110D
+sonixb         0c45:6009       spcaCam@120
+sonixb         0c45:600d       spcaCam@120
+sonixb         0c45:6011       MAX Webcam (Microdia - OV6650 - SN9C101G)
+sonixb         0c45:6019       Generic Sonix OV7630
+sonixb         0c45:6024       Generic Sonix Tas5130c
+sonixb         0c45:6025       Xcam Shanga
+sonixb         0c45:6028       Sonix Btc Pc380
+sonixb         0c45:6029       spcaCam@150
+sonixb         0c45:602c       Generic Sonix OV7630
+sonixb         0c45:602d       LIC-200 LG
+sonixb         0c45:602e       Genius VideoCam Messenger
+sonixj         0458:7025       Genius Eye 311Q
+sonixj         045e:00f5       MicroSoft VX3000
+sonixj         045e:00f7       MicroSoft VX1000
+sonixj         0471:0327       Philips SPC 600 NC
+sonixj         0471:0328       Philips SPC 700 NC
+sonixj         0471:0330       Philips SPC 710NC
+sonixj         0c45:6040       Speed NVC 350K
+sonixj         0c45:607c       Sonix sn9c102p Hv7131R
+sonixj         0c45:60c0       Sangha Sn535
+sonixj         0c45:60ec       SN9C105+MO4000
+sonixj         0c45:60fb       Surfer NoName
+sonixj         0c45:60fc       LG-LIC300
+sonixj         0c45:612a       Avant Camera
+sonixj         0c45:612c       Typhoon Rasy Cam 1.3MPix
+sonixj         0c45:6130       Sonix Pccam
+sonixj         0c45:6138       Sn9c120 Mo4000
+sonixj         0c45:613b       Surfer SN-206
+sonixj         0c45:613c       Sonix Pccam168
+spca500                040a:0300       Kodak EZ200
+spca500                041e:400a       Creative PC-CAM 300
+spca500                046d:0890       Logitech QuickCam traveler
+spca500                046d:0900       Logitech Inc. ClickSmart 310
+spca500                046d:0901       Logitech Inc. ClickSmart 510
+spca500                04a5:300c       Benq DC1016
+spca500                04fc:7333       PalmPixDC85
+spca500                055f:c200       Mustek Gsmart 300
+spca500                055f:c220       Gsmart Mini
+spca500                06bd:0404       Agfa CL20
+spca500                06be:0800       Optimedia
+spca500                084d:0003       D-Link DSC-350
+spca500                08ca:0103       Aiptek PocketDV
+spca500                2899:012c       Toptro Industrial
+spca500                8086:0630       Intel Pocket PC Camera
+spca501                040a:0002       Kodak DVC-325
+spca501                0497:c001       Smile International
+spca501                0506:00df       3Com HomeConnect Lite
+spca501                0733:0401       Intel Create and Share
+spca501                0733:0402       ViewQuest M318B
+spca501                1776:501c       Arowana 300K CMOS Camera
+spca501                0000:0000       MystFromOri Unknow Camera
+spca505                041e:401d       Creative Webcam NX ULTRA
+spca505                0733:0430       Intel PC Camera Pro
+spca506                06e1:a190       ADS Instant VCD
+spca506                0734:043b       3DeMon USB Capture aka
+spca506                99fa:8988       Grandtec V.cap
+spca506                99fa:8988       Grandtec V.cap
+spca508                041e:4018       Creative Webcam Vista (PD1100)
+spca508                0461:0815       Micro Innovation IC200
+spca508                0733:0110       ViewQuest VQ110
+spca508                0af9:0010       Hama USB Sightcam 100
+spca508                0af9:0011       Hama USB Sightcam 100
+spca508                8086:0110       Intel Easy PC Camera
+spca561                041e:401a       Creative Webcam Vista (PD1100)
+spca561                041e:403b       Creative Webcam Vista (VF0010)
+spca561                0458:7004       Genius VideoCAM Express V2
+spca561                046d:0928       Logitech QC Express Etch2
+spca561                046d:0929       Labtec Webcam Elch2
+spca561                046d:092a       Logitech QC for Notebook
+spca561                046d:092b       Labtec Webcam Plus
+spca561                046d:092c       Logitech QC chat Elch2
+spca561                046d:092d       Logitech QC Elch2
+spca561                046d:092e       Logitech QC Elch2
+spca561                046d:092f       Logitech QC Elch2
+spca561                04fc:0561       Flexcam 100
+spca561                060b:a001       Maxell Compact Pc PM3
+spca561                10fd:7e50       FlyCam Usb 100
+spca561                abcd:cdee       Petcam
+stk014         05e1:0893       Syntek DV4000
+sunplus                041e:400b       Creative PC-CAM 600
+sunplus                041e:4012       PC-Cam350
+sunplus                041e:4013       Creative Pccam750
+sunplus                0458:7006       Genius Dsc 1.3 Smart
+sunplus                046d:0905       Logitech ClickSmart 820
+sunplus                046d:0960       Logitech ClickSmart 420
+sunplus                0471:0322       Philips DMVC1300K
+sunplus                04a5:3003       Benq DC 1300
+sunplus                04a5:3008       Benq DC 1500
+sunplus                04a5:300a       Benq DC3410
+sunplus                04f1:1001       JVC GC A50
+sunplus                04fc:500c       Sunplus CA500C
+sunplus                04fc:504a       Aiptek Mini PenCam 1.3
+sunplus                04fc:504b       Maxell MaxPocket LE 1.3
+sunplus                04fc:5330       Digitrex 2110
+sunplus                04fc:5360       Sunplus Generic
+sunplus                04fc:ffff       Pure DigitalDakota
+sunplus                052b:1513       Megapix V4
+sunplus                0546:3155       Polaroid PDC3070
+sunplus                0546:3191       Polaroid Ion 80
+sunplus                0546:3273       Polaroid PDC2030
+sunplus                055f:c211       Kowa Bs888e Microcamera
+sunplus                055f:c230       Mustek Digicam 330K
+sunplus                055f:c232       Mustek MDC3500
+sunplus                055f:c360       Mustek DV4000 Mpeg4
+sunplus                055f:c420       Mustek gSmart Mini 2
+sunplus                055f:c430       Mustek Gsmart LCD 2
+sunplus                055f:c440       Mustek DV 3000
+sunplus                055f:c520       Mustek gSmart Mini 3
+sunplus                055f:c530       Mustek Gsmart LCD 3
+sunplus                055f:c540       Gsmart D30
+sunplus                055f:c630       Mustek MDC4000
+sunplus                055f:c650       Mustek MDC5500Z
+sunplus                05da:1018       Digital Dream Enigma 1.3
+sunplus                06d6:0031       Trust 610 LCD PowerC@m Zoom
+sunplus                0733:1311       Digital Dream Epsilon 1.3
+sunplus                0733:1314       Mercury 2.1MEG Deluxe Classic Cam
+sunplus                0733:2211       Jenoptik jdc 21 LCD
+sunplus                0733:2221       Mercury Digital Pro 3.1p
+sunplus                0733:3261       Concord 3045 spca536a
+sunplus                0733:3281       Cyberpix S550V
+sunplus                08ca:0104       Aiptek PocketDVII 1.3
+sunplus                08ca:0106       Aiptek Pocket DV3100+
+sunplus                08ca:2008       Aiptek Mini PenCam 2 M
+sunplus                08ca:2010       Aiptek PocketCam 3M
+sunplus                08ca:2016       Aiptek PocketCam 2 Mega
+sunplus                08ca:2018       Aiptek Pencam SD 2M
+sunplus                08ca:2020       Aiptek Slim 3000F
+sunplus                08ca:2022       Aiptek Slim 3200
+sunplus                08ca:2024       Aiptek DV3500 Mpeg4
+sunplus                08ca:2028       Aiptek PocketCam4M
+sunplus                08ca:2040       Aiptek PocketDV4100M
+sunplus                08ca:2042       Aiptek PocketDV5100
+sunplus                08ca:2060       Aiptek PocketDV5300
+sunplus                0d64:0303       Sunplus FashionCam DXG
+tv8532         046d:0920       QC Express
+tv8532         046d:0921       Labtec Webcam
+tv8532         0545:808b       Veo Stingray
+tv8532         0545:8333       Veo Stingray
+tv8532         0923:010f       ICM532 cams
+vc032x         046d:0892       Logitech Orbicam
+vc032x         046d:0896       Logitech Orbicam
+vc032x         0ac8:0321       Vimicro generic vc0321
+vc032x         0ac8:0323       Vimicro Vc0323
+vc032x         0ac8:0328       A4Tech PK-130MG
+vc032x         0ac8:c001       Sony embedded vimicro
+vc032x         0ac8:c002       Sony embedded vimicro
+vc032x         17ef:4802       Lenovo Vc0323+MI1310_SOC
+zc3xx          041e:041e       Creative WebCam Live!
+zc3xx          041e:4017       Creative Webcam Mobile PD1090
+zc3xx          041e:401c       Creative NX
+zc3xx          041e:401e       Creative Nx Pro
+zc3xx          041e:401f       Creative Webcam Notebook PD1171
+zc3xx          041e:4029       Creative WebCam Vista Pro
+zc3xx          041e:4034       Creative Instant P0620
+zc3xx          041e:4035       Creative Instant P0620D
+zc3xx          041e:4036       Creative Live !
+zc3xx          041e:403a       Creative Nx Pro 2
+zc3xx          041e:4051       Creative Live!Cam Notebook Pro (VF0250)
+zc3xx          041e:4053       Creative Live!Cam Video IM
+zc3xx          0458:7007       Genius VideoCam V2
+zc3xx          0458:700c       Genius VideoCam V3
+zc3xx          0458:700f       Genius VideoCam Web V2
+zc3xx          0461:0a00       MicroInnovation WebCam320
+zc3xx          046d:08a0       Logitech QC IM
+zc3xx          046d:08a1       Logitech QC IM 0x08A1 +sound
+zc3xx          046d:08a2       Labtec Webcam Pro
+zc3xx          046d:08a3       Logitech QC Chat
+zc3xx          046d:08a6       Logitech QCim
+zc3xx          046d:08a7       Logitech QuickCam Image
+zc3xx          046d:08a9       Logitech Notebook Deluxe
+zc3xx          046d:08aa       Labtec Webcam  Notebook
+zc3xx          046d:08ac       Logitech QuickCam Cool
+zc3xx          046d:08ad       Logitech QCCommunicate STX
+zc3xx          046d:08ae       Logitech QuickCam for Notebooks
+zc3xx          046d:08af       Logitech QuickCam Cool
+zc3xx          046d:08b9       Logitech QC IM ???
+zc3xx          046d:08d7       Logitech QCam STX
+zc3xx          046d:08d9       Logitech QuickCam IM/Connect
+zc3xx          046d:08d8       Logitech Notebook Deluxe
+zc3xx          046d:08da       Logitech QuickCam Messenger
+zc3xx          046d:08dd       Logitech QuickCam for Notebooks
+zc3xx          0471:0325       Philips SPC 200 NC
+zc3xx          0471:0326       Philips SPC 300 NC
+zc3xx          0471:032d       Philips spc210nc
+zc3xx          0471:032e       Philips spc315nc
+zc3xx          055f:c005       Mustek Wcam300A
+zc3xx          055f:d003       Mustek WCam300A
+zc3xx          055f:d004       Mustek WCam300 AN
+zc3xx          0698:2003       CTX M730V built in
+zc3xx          0ac8:0302       Z-star Vimicro zc0302
+zc3xx          0ac8:301b       Z-Star zc301b
+zc3xx          0ac8:303b       Vimicro 0x303b
+zc3xx          0ac8:305b       Z-star Vimicro zc0305b
+zc3xx          0ac8:307b       Ldlc VC302+Ov7620
+zc3xx          10fd:0128       Typhoon Webshot II USB 300k 0x0128
+zc3xx          10fd:8050       Typhoon Webshot II USB 300k
index 8fca90b..a6fbee4 100644 (file)
@@ -801,6 +801,8 @@ config USB_VIDEO_CLASS
 
          For more information see: <http://linux-uvc.berlios.de/>
 
+source "drivers/media/video/gspca/Kconfig"
+
 source "drivers/media/video/pvrusb2/Kconfig"
 
 source "drivers/media/video/em28xx/Kconfig"
diff --git a/drivers/media/video/gspca/Kconfig b/drivers/media/video/gspca/Kconfig
new file mode 100644 (file)
index 0000000..a04e413
--- /dev/null
@@ -0,0 +1,13 @@
+config USB_GSPCA
+       tristate "USB GSPCA driver"
+       depends on VIDEO_V4L2
+       ---help---
+         Say Y here if you want support for various USB cameras.
+
+         See <file:Documentation/video4linux/gspca.txt> for more info.
+
+         This driver uses the Video For Linux API. You must say Y or M to
+         "Video For Linux" to use this driver.
+
+         To compile this driver as modules, choose M here: the
+         modules will be called gspca_xxxx.
diff --git a/drivers/media/video/gspca/Makefile b/drivers/media/video/gspca/Makefile
new file mode 100644 (file)
index 0000000..885d445
--- /dev/null
@@ -0,0 +1,4 @@
+obj-$(CONFIG_GSPCA)    += gspca_main.o gspca_stk014.o
+
+gspca_main-objs := gspca.o
+gspca_stk014-objs := stk014.o
diff --git a/drivers/media/video/gspca/gspca.c b/drivers/media/video/gspca/gspca.c
new file mode 100644 (file)
index 0000000..4fe082f
--- /dev/null
@@ -0,0 +1,1750 @@
+/*
+ * Main USB camera driver
+ *
+ * V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation; either version 2 of the License, or (at your
+ * option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
+ * or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
+ * for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software Foundation,
+ * Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+ */
+
+#define MODULE_NAME "gspca"
+
+#include <linux/init.h>
+#include <linux/fs.h>
+#include <linux/vmalloc.h>
+#include <linux/sched.h>
+#include <linux/slab.h>
+#include <linux/mm.h>
+#include <linux/string.h>
+#include <linux/pagemap.h>
+#include <asm/io.h>
+#include <asm/page.h>
+#include <asm/uaccess.h>
+#include <linux/jiffies.h>
+
+#include "gspca.h"
+
+MODULE_AUTHOR("Jean-Francois Moine <http://moinejf.free.fr>");
+MODULE_DESCRIPTION("GSPCA USB Camera Driver");
+MODULE_LICENSE("GPL");
+
+#define DRIVER_VERSION_NUMBER  KERNEL_VERSION(0, 0, 26)
+static const char version[] = "0.0.26";
+
+static int video_nr = -1;
+
+static int comp_fac = 30;      /* Buffer size ratio when compressed in % */
+
+#ifdef GSPCA_DEBUG
+int gspca_debug = D_ERR | D_PROBE;
+EXPORT_SYMBOL(gspca_debug);
+
+static void PDEBUG_MODE(char *txt, __u32 pixfmt, int w, int h)
+{
+       if ((pixfmt >> 24) >= '0' && (pixfmt >> 24) <= 'z') {
+               PDEBUG(D_CONF|D_STREAM, "%s %c%c%c%c %dx%d",
+                       txt,
+                       pixfmt & 0xff,
+                       (pixfmt >> 8) & 0xff,
+                       (pixfmt >> 16) & 0xff,
+                       pixfmt >> 24,
+                       w, h);
+       } else {
+               PDEBUG(D_CONF|D_STREAM, "%s 0x%08x %dx%d",
+                       txt,
+                       pixfmt,
+                       w, h);
+       }
+}
+#else
+#define PDEBUG_MODE(txt, pixfmt, w, h)
+#endif
+
+/*
+ * VMA operations.
+ */
+static void gspca_vm_open(struct vm_area_struct *vma)
+{
+       struct gspca_frame *frame = vma->vm_private_data;
+
+       frame->vma_use_count++;
+       frame->v4l2_buf.flags |= V4L2_BUF_FLAG_MAPPED;
+}
+
+static void gspca_vm_close(struct vm_area_struct *vma)
+{
+       struct gspca_frame *frame = vma->vm_private_data;
+
+       if (--frame->vma_use_count <= 0)
+               frame->v4l2_buf.flags &= ~V4L2_BUF_FLAG_MAPPED;
+}
+
+static struct vm_operations_struct gspca_vm_ops = {
+       .open           = gspca_vm_open,
+       .close          = gspca_vm_close,
+};
+
+/*
+ * ISOC message interrupt from the USB device
+ *
+ * Analyse each packet and call the subdriver for doing the copy
+ * to the frame buffer.
+ */
+static void isoc_irq(struct urb *urb)
+{
+       struct gspca_dev *gspca_dev = (struct gspca_dev *) urb->context;
+       struct gspca_frame *frame;
+       unsigned char *data;    /* address of data in the iso message */
+       int i, j, len, st;
+       cam_pkt_op pkt_scan;
+
+       PDEBUG(D_PACK, "isoc irq");
+       if (!gspca_dev->streaming)
+               return;
+       pkt_scan = gspca_dev->sd_desc->pkt_scan;
+       for (i = 0; i < urb->number_of_packets; i++) {
+
+               /* check the availability of the frame buffer */
+               j = gspca_dev->fr_i;
+               j = gspca_dev->fr_queue[j];
+               frame = &gspca_dev->frame[j];
+               if ((frame->v4l2_buf.flags
+                               & (V4L2_BUF_FLAG_QUEUED | V4L2_BUF_FLAG_DONE))
+                                       != V4L2_BUF_FLAG_QUEUED) {
+                       gspca_dev->last_packet_type = DISCARD_PACKET;
+                       break;
+               }
+
+               /* check the packet status and length */
+               len = urb->iso_frame_desc[i].actual_length;
+               st = urb->iso_frame_desc[i].status;
+               if (st) {
+                       PDEBUG(D_ERR, "ISOC data error: [%d] len=%d, status=%d",
+                               i, len, st);
+                       gspca_dev->last_packet_type = DISCARD_PACKET;
+                       continue;
+               }
+               if (len == 0)
+                       continue;
+
+               /* let the packet be analyzed by the subdriver */
+               PDEBUG(D_PACK, "packet [%d] o:%d l:%d",
+                       i, urb->iso_frame_desc[i].offset, len);
+               data = (unsigned char *) urb->transfer_buffer
+                                       + urb->iso_frame_desc[i].offset;
+               pkt_scan(gspca_dev, frame, data, len);
+       }
+
+       /* resubmit the URB */
+       urb->status = 0;
+       st = usb_submit_urb(urb, GFP_ATOMIC);
+       if (st < 0)
+               PDEBUG(D_ERR|D_PACK, "usb_submit_urb() ret %d", st);
+}
+
+/*
+ * add data to the current frame
+ *
+ * This function is called by the subdrivers at interrupt level.
+ * To build a frame, these ones must add
+ *     - one FIRST_PACKET
+ *     - 0 or many INTER_PACKETs
+ *     - one LAST_PACKET
+ * DISCARD_PACKET invalidates the whole frame.
+ * On LAST_PACKET, a new frame is returned.
+ */
+struct gspca_frame *gspca_frame_add(struct gspca_dev *gspca_dev,
+                                   int packet_type,
+                                   struct gspca_frame *frame,
+                                   unsigned char *data,
+                                   int len)
+{
+       int i, j;
+
+       PDEBUG(D_PACK, "add t:%d l:%d %02x %02x %02x %02x...",
+               packet_type, len, data[0], data[1], data[2], data[3]);
+
+       /* when start of a new frame, if the current frame buffer
+        * is not queued, discard the whole frame */
+       if (packet_type == FIRST_PACKET) {
+               if ((frame->v4l2_buf.flags
+                               & (V4L2_BUF_FLAG_QUEUED | V4L2_BUF_FLAG_DONE))
+                                       != V4L2_BUF_FLAG_QUEUED) {
+                       gspca_dev->last_packet_type = DISCARD_PACKET;
+                       return frame;
+               }
+               frame->data_end = frame->data;
+               jiffies_to_timeval(get_jiffies_64(),
+                                  &frame->v4l2_buf.timestamp);
+               frame->v4l2_buf.sequence = ++gspca_dev->sequence;
+       } else if (gspca_dev->last_packet_type == DISCARD_PACKET)
+               return frame;
+
+       /* append the packet in the frame buffer */
+       if (len > 0) {
+               if (frame->data_end - frame->data + len
+                                                > frame->v4l2_buf.length) {
+                       PDEBUG(D_ERR|D_PACK, "frame overflow %d > %d",
+                               frame->data_end - frame->data + len,
+                               frame->v4l2_buf.length);
+                       packet_type = DISCARD_PACKET;
+               } else {
+                       if (frame->v4l2_buf.memory != V4L2_MEMORY_USERPTR)
+                               memcpy(frame->data_end, data, len);
+                       else
+                               copy_to_user(frame->data_end, data, len);
+                       frame->data_end += len;
+               }
+       }
+       gspca_dev->last_packet_type = packet_type;
+
+       /* if last packet, wake the application and advance in the queue */
+       if (packet_type == LAST_PACKET) {
+               frame->v4l2_buf.bytesused = frame->data_end - frame->data;
+               frame->v4l2_buf.flags &= ~V4L2_BUF_FLAG_QUEUED;
+               frame->v4l2_buf.flags |= V4L2_BUF_FLAG_DONE;
+               atomic_inc(&gspca_dev->nevent);
+               wake_up_interruptible(&gspca_dev->wq);  /* event = new frame */
+               i = gspca_dev->fr_i;
+               i = (i + 1) % gspca_dev->nframes;
+               PDEBUG(D_FRAM, "frame complete len:%d q:%d i:%d o:%d",
+                       frame->v4l2_buf.bytesused,
+                       gspca_dev->fr_q,
+                       i,
+                       gspca_dev->fr_o);
+               j = gspca_dev->fr_queue[i];
+               frame = &gspca_dev->frame[j];
+               gspca_dev->fr_i = i;
+       }
+       return frame;
+}
+EXPORT_SYMBOL(gspca_frame_add);
+
+static int gspca_is_compressed(__u32 format)
+{
+       switch (format) {
+       case V4L2_PIX_FMT_MJPEG:
+       case V4L2_PIX_FMT_JPEG:
+               return 1;
+       }
+       return 0;
+}
+
+static void *rvmalloc(unsigned long size)
+{
+       void *mem;
+       unsigned long adr;
+
+       size = PAGE_ALIGN(size);
+       mem = vmalloc_32(size);
+       if (mem != 0) {
+               memset(mem, 0, size);
+               adr = (unsigned long) mem;
+               while ((long) size > 0) {
+                       SetPageReserved(vmalloc_to_page((void *) adr));
+                       adr += PAGE_SIZE;
+                       size -= PAGE_SIZE;
+               }
+       }
+       return mem;
+}
+
+static void rvfree(void *mem, unsigned long size)
+{
+       unsigned long adr;
+
+       if (!mem)
+               return;
+       adr = (unsigned long) mem;
+       while ((long) size > 0) {
+               ClearPageReserved(vmalloc_to_page((void *) adr));
+               adr += PAGE_SIZE;
+               size -= PAGE_SIZE;
+       }
+       vfree(mem);
+}
+
+static int frame_alloc(struct gspca_dev *gspca_dev,
+                       unsigned int count,
+                       unsigned int frsz,
+                       enum v4l2_memory memory)
+{
+       int i, ret = 0;
+
+       PDEBUG(D_STREAM, "frame alloc frsz: %d", frsz);
+       if (gspca_dev->nframes != 0) {
+               PDEBUG(D_ERR|D_STREAM, "alloc frame already done");
+               return -EBUSY;
+       }
+       if (count > GSPCA_MAX_FRAMES)
+               count = GSPCA_MAX_FRAMES;
+       /* if compressed, reduce the buffer size */
+       if (gspca_is_compressed(gspca_dev->pixfmt))
+               frsz = (frsz * comp_fac) / 100;
+       frsz = PAGE_ALIGN(frsz);
+       PDEBUG(D_STREAM, "new fr_sz: %d", frsz);
+       gspca_dev->frsz = frsz;
+       if (memory == V4L2_MEMORY_MMAP) {
+               gspca_dev->frbuf = rvmalloc(frsz * count);
+               if (!gspca_dev->frbuf) {
+                       err("frame alloc failed");
+                       return -ENOMEM;
+               }
+       }
+       gspca_dev->nframes = count;
+       for (i = 0; i < count; i++) {
+               gspca_dev->frame[i].v4l2_buf.index = i;
+               gspca_dev->frame[i].v4l2_buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+               gspca_dev->frame[i].v4l2_buf.flags = 0;
+               gspca_dev->frame[i].v4l2_buf.field = V4L2_FIELD_NONE;
+               gspca_dev->frame[i].v4l2_buf.length = frsz;
+               gspca_dev->frame[i].v4l2_buf.memory = memory;
+               if (memory == V4L2_MEMORY_MMAP) {
+                       gspca_dev->frame[i].data
+                               = gspca_dev->frame[i].data_end
+                               = gspca_dev->frbuf + i * frsz;
+                       gspca_dev->frame[i].v4l2_buf.m.offset = i * frsz;
+               }
+               gspca_dev->frame[i].v4l2_buf.flags = 0; /* buf in app space */
+       }
+       gspca_dev->fr_i = gspca_dev->fr_o = gspca_dev->fr_q = 0;
+       gspca_dev->last_packet_type = DISCARD_PACKET;
+       gspca_dev->sequence = 0;
+       atomic_set(&gspca_dev->nevent, 0);
+       return ret;
+}
+
+static void frame_free(struct gspca_dev *gspca_dev)
+{
+       int i;
+
+       PDEBUG(D_STREAM, "frame free");
+       if (gspca_dev->frbuf != 0) {
+               rvfree(gspca_dev->frbuf,
+                       gspca_dev->nframes * gspca_dev->frsz);
+               gspca_dev->frbuf = NULL;
+               for (i = 0; i < gspca_dev->nframes; i++)
+                       gspca_dev->frame[i].data = NULL;
+       }
+       gspca_dev->nframes = 0;
+}
+
+static int gspca_kill_transfer(struct gspca_dev *gspca_dev)
+{
+       struct urb *urb;
+       unsigned int i;
+
+       PDEBUG(D_STREAM, "kill transfer");
+       gspca_dev->streaming = 0;
+       for (i = 0; i < NURBS; ++i) {
+               urb = gspca_dev->pktbuf[i].urb;
+               if (urb == NULL)
+                       continue;
+
+               gspca_dev->pktbuf[i].urb = NULL;
+               usb_kill_urb(urb);
+
+               /* urb->transfer_buffer_length is not touched by USB core,
+                * so we can use it here as the buffer length */
+               if (gspca_dev->pktbuf[i].data) {
+                       usb_buffer_free(gspca_dev->dev,
+                                       urb->transfer_buffer_length,
+                                       gspca_dev->pktbuf[i].data,
+                                       urb->transfer_dma);
+                       gspca_dev->pktbuf[i].data = NULL;
+               }
+               usb_free_urb(urb);
+       }
+       return 0;
+}
+
+/*
+ * search an input isochronous endpoint in an alternate setting
+ */
+static struct usb_host_endpoint *alt_isoc(struct usb_host_interface *alt,
+                                         __u8 epaddr)
+{
+       struct usb_host_endpoint *ep;
+       int i, attr;
+
+       epaddr |= USB_DIR_IN;
+       for (i = 0; i < alt->desc.bNumEndpoints; i++) {
+               ep = &alt->endpoint[i];
+               if (ep->desc.bEndpointAddress == epaddr) {
+                       attr = ep->desc.bmAttributes
+                                               & USB_ENDPOINT_XFERTYPE_MASK;
+                       if (attr == USB_ENDPOINT_XFER_ISOC)
+                               return ep;
+                       break;
+               }
+       }
+       return NULL;
+}
+
+/*
+ * search an input isochronous endpoint
+ *
+ * The endpoint is defined by the subdriver.
+ * Use only the first isoc (some Zoran - 0x0572:0x0001 - have two such ep).
+ * This routine may be called many times when the bandwidth is too small
+ * (the bandwidth is checked on urb submit).
+ */
+struct usb_host_endpoint *get_isoc_ep(struct gspca_dev *gspca_dev)
+{
+       struct usb_interface *intf;
+       struct usb_host_endpoint *ep;
+       int i, ret;
+
+       intf = usb_ifnum_to_if(gspca_dev->dev, gspca_dev->iface);
+       i = gspca_dev->alt;                     /* previous alt setting */
+       while (--i > 0) {                       /* alt 0 is unusable */
+               ep = alt_isoc(&intf->altsetting[i], gspca_dev->cam.epaddr);
+               if (ep)
+                       break;
+       }
+       if (i <= 0) {
+               err("no ISOC endpoint found");
+               return NULL;
+       }
+       PDEBUG(D_STREAM, "use ISOC alt %d ep 0x%02x",
+                       i, ep->desc.bEndpointAddress);
+       ret = usb_set_interface(gspca_dev->dev, gspca_dev->iface, i);
+       if (ret < 0) {
+               err("set interface err %d", ret);
+               return NULL;
+       }
+       gspca_dev->alt = i;
+       return ep;
+}
+
+/*
+ * create the isochronous URBs
+ */
+static int create_urbs(struct gspca_dev *gspca_dev,
+                       struct usb_host_endpoint *ep)
+{
+       struct urb *urb;
+       int n, i, psize, npkt, bsize;
+
+       /* calculate the packet size and the number of packets */
+       /* the URB buffer size must be a power of 2 */
+       psize = le16_to_cpu(ep->desc.wMaxPacketSize);
+       /* See paragraph 5.9 / table 5-11 of the usb 2.0 spec. */
+       psize = (psize & 0x07ff) * (1 + ((psize >> 11) & 3));
+       npkt = ISO_MAX_SIZE / psize;
+       if (npkt > ISO_MAX_PKT)
+               npkt = ISO_MAX_PKT;
+       bsize = psize * npkt;
+       for (n = ISO_MAX_SIZE; n > 0; n >>= 1) {
+               if (n & bsize)  /* !! assume ISO_MAX_SIZE is a power of 2 */
+                       break;
+       }
+       if (n != 0) {
+               npkt = n / psize;
+               bsize = psize * npkt;
+       }
+       PDEBUG(D_STREAM,
+               "isoc %d pkts size %d (bsize:%d)", npkt, psize, bsize);
+       for (n = 0; n < NURBS; n++) {
+               urb = usb_alloc_urb(npkt, GFP_KERNEL);
+               if (!urb) {
+                       err("usb_alloc_urb failed");
+                       return -ENOMEM;
+               }
+               gspca_dev->pktbuf[n].data = usb_buffer_alloc(gspca_dev->dev,
+                                               bsize,
+                                               GFP_KERNEL,
+                                               &urb->transfer_dma);
+
+               if (gspca_dev->pktbuf[n].data == NULL) {
+                       usb_free_urb(urb);
+                       gspca_kill_transfer(gspca_dev);
+                       err("usb_buffer_urb failed");
+                       return -ENOMEM;
+               }
+               gspca_dev->pktbuf[n].urb = urb;
+               urb->dev = gspca_dev->dev;
+               urb->context = gspca_dev;
+               urb->pipe = usb_rcvisocpipe(gspca_dev->dev,
+                                           ep->desc.bEndpointAddress);
+               urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP;
+               urb->interval = ep->desc.bInterval;
+               urb->transfer_buffer = gspca_dev->pktbuf[n].data;
+               urb->complete = isoc_irq;
+               urb->number_of_packets = npkt;
+               urb->transfer_buffer_length = bsize;
+               for (i = 0; i < npkt; i++) {
+                       urb->iso_frame_desc[i].length = psize;
+                       urb->iso_frame_desc[i].offset = psize * i;
+               }
+       }
+       return 0;
+}
+
+/*
+ * start the USB transfer
+ */
+static int gspca_init_transfer(struct gspca_dev *gspca_dev)
+{
+       struct usb_interface *intf;
+       struct usb_host_endpoint *ep;
+       int n, ret;
+
+       ret = mutex_lock_interruptible(&gspca_dev->usb_lock);
+       if (ret < 0)
+               return ret;
+
+       /* set the max alternate setting and loop until urb submit succeeds */
+       intf = usb_ifnum_to_if(gspca_dev->dev, gspca_dev->iface);
+       gspca_dev->alt = intf->num_altsetting;
+       for (;;) {
+               PDEBUG(D_STREAM, "init transfer nbalt %d", gspca_dev->alt);
+               ep = get_isoc_ep(gspca_dev);
+               if (ep == NULL) {
+                       ret = -EIO;
+                       goto out;
+               }
+               ret = create_urbs(gspca_dev, ep);
+               if (ret < 0)
+                       goto out;
+
+               /* start the cam */
+               gspca_dev->sd_desc->start(gspca_dev);
+               gspca_dev->streaming = 1;
+               atomic_set(&gspca_dev->nevent, 0);
+
+               /* submit the URBs */
+               for (n = 0; n < NURBS; n++) {
+                       ret = usb_submit_urb(gspca_dev->pktbuf[n].urb,
+                                                GFP_KERNEL);
+                       if (ret < 0) {
+                               PDEBUG(D_ERR|D_STREAM,
+                                       "usb_submit_urb [%d] err %d", n, ret);
+                               gspca_kill_transfer(gspca_dev);
+                               if (ret == -ENOSPC)
+                                       break;  /* try the previous alt */
+                               goto out;
+                       }
+               }
+               if (ret >= 0)
+                       break;
+       }
+out:
+       mutex_unlock(&gspca_dev->usb_lock);
+       return ret;
+}
+
+static int gspca_set_alt0(struct gspca_dev *gspca_dev)
+{
+       int ret;
+
+       ret = usb_set_interface(gspca_dev->dev, gspca_dev->iface, 0);
+       if (ret < 0)
+               PDEBUG(D_ERR|D_STREAM, "set interface 0 err %d", ret);
+       return ret;
+}
+
+static void gspca_stream_off(struct gspca_dev *gspca_dev)
+{
+       mutex_lock_interruptible(&gspca_dev->usb_lock);
+       gspca_dev->streaming = 0;
+       if (gspca_dev->present) {
+               gspca_dev->sd_desc->stopN(gspca_dev);
+               gspca_kill_transfer(gspca_dev);
+               gspca_set_alt0(gspca_dev);
+               gspca_dev->sd_desc->stop0(gspca_dev);
+               PDEBUG(D_STREAM, "stream off OK");
+       } else {
+               gspca_kill_transfer(gspca_dev);
+               atomic_inc(&gspca_dev->nevent);
+               wake_up_interruptible(&gspca_dev->wq);
+               PDEBUG(D_ERR|D_STREAM, "stream off no device ??");
+       }
+       mutex_unlock(&gspca_dev->usb_lock);
+}
+
+static int gspca_set_default_mode(struct gspca_dev *gspca_dev)
+{
+       int i;
+
+       i = gspca_dev->cam.nmodes - 1;  /* take the highest mode */
+       gspca_dev->curr_mode = i;
+       gspca_dev->width = gspca_dev->cam.cam_mode[i].width;
+       gspca_dev->height = gspca_dev->cam.cam_mode[i].height;
+       gspca_dev->pixfmt = gspca_dev->cam.cam_mode[i].pixfmt;
+       return 0;
+}
+
+static int wxh_to_mode(struct gspca_dev *gspca_dev,
+                       int width, int height)
+{
+       int i;
+
+       for (i = gspca_dev->cam.nmodes - 1; --i >= 0; ) {
+               if (width > gspca_dev->cam.cam_mode[i].width)
+                       break;
+       }
+       i++;
+       while (i < gspca_dev->cam.nmodes - 1
+              && width == gspca_dev->cam.cam_mode[i + 1].width
+              && height < gspca_dev->cam.cam_mode[i + 1].height)
+               i++;
+       return i;
+}
+
+static __u32 get_v4l2_depth(__u32 pixfmt)
+{
+       switch (pixfmt) {
+       case V4L2_PIX_FMT_BGR32:
+       case V4L2_PIX_FMT_RGB32:
+               return 32;
+       case V4L2_PIX_FMT_RGB24:
+       case V4L2_PIX_FMT_BGR24:
+               return 24;
+       case V4L2_PIX_FMT_RGB565:
+       case V4L2_PIX_FMT_YUYV:         /* packed 4.2.2 */
+       case V4L2_PIX_FMT_YYUV:
+               return 16;
+       case V4L2_PIX_FMT_YUV420:       /* planar 4.2.0 */
+               return 12;
+       case V4L2_PIX_FMT_MJPEG:
+       case V4L2_PIX_FMT_JPEG:
+       case V4L2_PIX_FMT_SBGGR8:       /* Bayer */
+               return 8;
+       }
+       PDEBUG(D_ERR|D_CONF, "Unknown pixel format %c%c%c%c",
+               pixfmt & 0xff,
+               (pixfmt >> 8) & 0xff,
+               (pixfmt >> 16) & 0xff,
+               pixfmt >> 24);
+       return -EINVAL;
+}
+
+/*
+ * search a mode with the right pixel format
+ */
+static int gspca_get_mode(struct gspca_dev *gspca_dev,
+                       int mode,
+                       int pixfmt)
+{
+       int modeU, modeD;
+
+       modeU = modeD = mode;
+       while ((modeU < gspca_dev->cam.nmodes) || modeD >= 0) {
+               if (--modeD >= 0) {
+                       if (gspca_dev->cam.cam_mode[modeD].pixfmt == pixfmt)
+                               return modeD;
+               }
+               if (++modeU < gspca_dev->cam.nmodes) {
+                       if (gspca_dev->cam.cam_mode[modeU].pixfmt == pixfmt)
+                               return modeU;
+               }
+       }
+       return -EINVAL;
+}
+
+static int vidioc_enum_fmt_cap(struct file *file, void  *priv,
+                               struct v4l2_fmtdesc *fmtdesc)
+{
+       struct gspca_dev *gspca_dev = priv;
+       int i, j, index;
+       __u32 fmt_tb[8];
+
+       PDEBUG(D_CONF, "enum fmt cap");
+
+       /* give an index to each format */
+       index = 0;
+       j = 0;
+       for (i = gspca_dev->cam.nmodes; --i >= 0; ) {
+               fmt_tb[index] = gspca_dev->cam.cam_mode[i].pixfmt;
+               j = 0;
+               for (;;) {
+                       if (fmt_tb[j] == fmt_tb[index])
+                               break;
+                       j++;
+               }
+               if (j == index) {
+                       if (fmtdesc->index == index)
+                               break;          /* new format */
+                       index++;
+                       if (index >= sizeof fmt_tb / sizeof fmt_tb[0])
+                               return -EINVAL;
+               }
+       }
+       if (i < 0)
+               return -EINVAL;         /* no more format */
+
+       fmtdesc->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+       fmtdesc->pixelformat = fmt_tb[index];
+       if (gspca_is_compressed(fmt_tb[index]))
+               fmtdesc->flags = V4L2_FMT_FLAG_COMPRESSED;
+       fmtdesc->description[0] = fmtdesc->pixelformat & 0xff;
+       fmtdesc->description[1] = (fmtdesc->pixelformat >> 8) & 0xff;
+       fmtdesc->description[2] = (fmtdesc->pixelformat >> 16) & 0xff;
+       fmtdesc->description[3] = fmtdesc->pixelformat >> 24;
+       fmtdesc->description[4] = '\0';
+       return 0;
+}
+
+static int gspca_get_buff_size(struct gspca_dev *gspca_dev)
+{
+       unsigned int size;
+
+       size = gspca_dev->width * gspca_dev->height
+                               * get_v4l2_depth(gspca_dev->pixfmt) / 8;
+       if (!size)
+               return -ENOMEM;
+       return size;
+}
+
+static int vidioc_g_fmt_cap(struct file *file, void *priv,
+                           struct v4l2_format *fmt)
+{
+       struct gspca_dev *gspca_dev = priv;
+
+       fmt->fmt.pix.width = gspca_dev->width;
+       fmt->fmt.pix.height = gspca_dev->height;
+       fmt->fmt.pix.pixelformat = gspca_dev->pixfmt;
+#ifdef GSPCA_DEBUG
+       if (gspca_debug & D_CONF) {
+               PDEBUG_MODE("get fmt cap",
+                       fmt->fmt.pix.pixelformat,
+                       fmt->fmt.pix.width,
+                       fmt->fmt.pix.height);
+       }
+#endif
+       fmt->fmt.pix.field = V4L2_FIELD_NONE;
+       fmt->fmt.pix.bytesperline = get_v4l2_depth(fmt->fmt.pix.pixelformat)
+                                       * fmt->fmt.pix.width / 8;
+       fmt->fmt.pix.sizeimage = fmt->fmt.pix.bytesperline
+                                       * fmt->fmt.pix.height;
+/* (should be in the subdriver) */
+       fmt->fmt.pix.colorspace = V4L2_COLORSPACE_SRGB;
+       fmt->fmt.pix.priv = 0;
+       return 0;
+}
+
+static int try_fmt_cap(struct file *file,
+                       void *priv,
+                       struct v4l2_format *fmt)
+{
+       struct gspca_dev *gspca_dev = priv;
+       int w, h, mode, mode2, frsz;
+
+       w = (int) fmt->fmt.pix.width;
+       h = (int) fmt->fmt.pix.height;
+#ifdef GSPCA_DEBUG
+       if (gspca_debug & D_CONF)
+               PDEBUG_MODE("try fmt cap", fmt->fmt.pix.pixelformat, w, h);
+#endif
+       /* search the closest mode for width and height */
+       mode = wxh_to_mode(gspca_dev, w, h);
+
+       /* OK if right palette */
+       if (gspca_dev->cam.cam_mode[mode].pixfmt != fmt->fmt.pix.pixelformat) {
+
+               /* else, search the closest mode with the same pixel format */
+               mode2 = gspca_get_mode(gspca_dev, mode,
+                                       fmt->fmt.pix.pixelformat);
+               if (mode2 >= 0)
+                       mode = mode2;
+               else {
+
+                       /* no chance, return this mode */
+                       fmt->fmt.pix.pixelformat
+                               = gspca_dev->cam.cam_mode[mode].pixfmt;
+#ifdef GSPCA_DEBUG
+                       if (gspca_debug & D_CONF) {
+                               PDEBUG_MODE("new format",
+                                       fmt->fmt.pix.pixelformat,
+                                       gspca_dev->cam.cam_mode[mode].width,
+                                       gspca_dev->cam.cam_mode[mode].height);
+                       }
+#endif
+               }
+       }
+       fmt->fmt.pix.width = gspca_dev->cam.cam_mode[mode].width;
+       fmt->fmt.pix.height = gspca_dev->cam.cam_mode[mode].height;
+       fmt->fmt.pix.bytesperline = get_v4l2_depth(fmt->fmt.pix.pixelformat)
+                                       * fmt->fmt.pix.width / 8;
+       frsz = fmt->fmt.pix.bytesperline * fmt->fmt.pix.height;
+       if (gspca_is_compressed(fmt->fmt.pix.pixelformat))
+               frsz = (frsz * comp_fac) / 100;
+       fmt->fmt.pix.sizeimage = frsz;
+       return mode;                    /* used when s_fmt */
+}
+
+static int vidioc_try_fmt_cap(struct file *file,
+                             void *priv,
+                             struct v4l2_format *fmt)
+{
+       int ret;
+
+/*     mutex_lock_interruptible(&gspca_dev->queue_lock); */
+       ret = try_fmt_cap(file, priv, fmt);
+/*     mutex_unlock(&gspca_dev->queue_lock); */
+       if (ret < 0)
+               return ret;
+       return 0;
+}
+
+static int vidioc_s_fmt_cap(struct file *file, void *priv,
+                           struct v4l2_format *fmt)
+{
+       struct gspca_dev *gspca_dev = priv;
+       int ret, was_streaming;
+
+#ifdef GSPCA_DEBUG
+       if (gspca_debug & D_CONF) {
+               PDEBUG_MODE("set fmt cap",
+                       fmt->fmt.pix.pixelformat,
+                       fmt->fmt.pix.width, fmt->fmt.pix.height);
+       }
+#endif
+       mutex_lock_interruptible(&gspca_dev->queue_lock);
+       ret = try_fmt_cap(file, priv, fmt);
+       if (ret < 0)
+               goto out;
+
+       if (ret == gspca_dev->curr_mode)
+               goto out;                       /* same mode */
+       was_streaming = gspca_dev->streaming;
+       if (was_streaming != 0)
+               gspca_stream_off(gspca_dev);
+       gspca_dev->width = (int) fmt->fmt.pix.width;
+       gspca_dev->height = (int) fmt->fmt.pix.height;
+       gspca_dev->pixfmt = fmt->fmt.pix.pixelformat;
+       gspca_dev->curr_mode = ret;
+       if (was_streaming)
+               ret = gspca_init_transfer(gspca_dev);
+out:
+       mutex_unlock(&gspca_dev->queue_lock);
+       return ret;
+}
+
+static int dev_open(struct inode *inode, struct file *file)
+{
+       struct gspca_dev *gspca_dev;
+       int ret;
+
+       PDEBUG(D_STREAM, "opening");
+       gspca_dev = (struct gspca_dev *) video_devdata(file);
+       ret = mutex_lock_interruptible(&gspca_dev->queue_lock);
+       if (ret < 0)
+               return ret;
+       if (!gspca_dev->present) {
+               ret = -ENODEV;
+               goto out;
+       }
+
+       /* if not done yet, initialize the sensor */
+       if (gspca_dev->users == 0) {
+               ret = mutex_lock_interruptible(&gspca_dev->usb_lock);
+               if (ret < 0)
+                       goto out;
+               ret = gspca_dev->sd_desc->open(gspca_dev);
+               mutex_unlock(&gspca_dev->usb_lock);
+               if (ret != 0) {
+                       PDEBUG(D_ERR|D_CONF, "init device failed %d", ret);
+                       goto out;
+               }
+       } else if (gspca_dev->users > 8) {      /* (arbitrary value) */
+               ret = -EBUSY;
+               goto out;
+       }
+       gspca_dev->users++;
+       file->private_data = gspca_dev;
+#ifdef GSPCA_DEBUG
+       /* activate the v4l2 debug */
+       if (gspca_debug & D_CONF)
+               gspca_dev->vdev.debug |= 3;
+       else
+               gspca_dev->vdev.debug &= ~3;
+#endif
+out:
+       mutex_unlock(&gspca_dev->queue_lock);
+       if (ret != 0)
+               PDEBUG(D_ERR|D_STREAM, "open failed err %d", ret);
+       else
+               PDEBUG(D_STREAM, "open OK");
+       return ret;
+}
+
+static int dev_close(struct inode *inode, struct file *file)
+{
+       struct gspca_dev *gspca_dev = file->private_data;
+
+       PDEBUG(D_STREAM, "closing");
+       if (gspca_dev->streaming) {
+               mutex_lock_interruptible(&gspca_dev->queue_lock);
+               gspca_stream_off(gspca_dev);
+               mutex_unlock(&gspca_dev->queue_lock);
+       }
+       mutex_lock_interruptible(&gspca_dev->usb_lock);
+       gspca_dev->sd_desc->close(gspca_dev);
+       mutex_unlock(&gspca_dev->usb_lock);
+       atomic_inc(&gspca_dev->nevent);
+       wake_up_interruptible(&gspca_dev->wq);  /* wake blocked processes */
+       schedule();
+       mutex_lock_interruptible(&gspca_dev->queue_lock);
+       frame_free(gspca_dev);
+       file->private_data = NULL;
+       gspca_dev->users--;
+       mutex_unlock(&gspca_dev->queue_lock);
+       PDEBUG(D_STREAM, "closed");
+       return 0;
+}
+
+static int vidioc_querycap(struct file *file, void  *priv,
+                          struct v4l2_capability *cap)
+{
+       struct gspca_dev *gspca_dev = priv;
+
+       PDEBUG(D_CONF, "querycap");
+       memset(cap, 0, sizeof *cap);
+       strncpy(cap->driver, gspca_dev->sd_desc->name, sizeof cap->driver);
+       strncpy(cap->card, gspca_dev->cam.dev_name, sizeof cap->card);
+       strncpy(cap->bus_info, gspca_dev->dev->bus->bus_name,
+               sizeof cap->bus_info);
+       cap->version = DRIVER_VERSION_NUMBER;
+       cap->capabilities = V4L2_CAP_VIDEO_CAPTURE
+                         | V4L2_CAP_STREAMING
+                         | V4L2_CAP_READWRITE;
+       return 0;
+}
+
+static int vidioc_queryctrl(struct file *file, void *priv,
+                          struct v4l2_queryctrl *q_ctrl)
+{
+       struct gspca_dev *gspca_dev = priv;
+       int i;
+
+       PDEBUG(D_CONF, "queryctrl");
+       for (i = 0; i < gspca_dev->sd_desc->nctrls; i++) {
+               if (q_ctrl->id == gspca_dev->sd_desc->ctrls[i].qctrl.id) {
+                       memcpy(q_ctrl,
+                               &gspca_dev->sd_desc->ctrls[i].qctrl,
+                               sizeof *q_ctrl);
+                       return 0;
+               }
+       }
+       if (q_ctrl->id >= V4L2_CID_BASE
+           && q_ctrl->id <= V4L2_CID_LASTP1) {
+               q_ctrl->flags |= V4L2_CTRL_FLAG_DISABLED;
+               return 0;
+       }
+       return -EINVAL;
+}
+
+static int vidioc_s_ctrl(struct file *file, void *priv,
+                        struct v4l2_control *ctrl)
+{
+       struct gspca_dev *gspca_dev = priv;
+       struct ctrl *ctrls;
+       int i, ret;
+
+       PDEBUG(D_CONF, "set ctrl");
+       for (i = 0, ctrls = gspca_dev->sd_desc->ctrls;
+            i < gspca_dev->sd_desc->nctrls;
+            i++, ctrls++) {
+               if (ctrl->id != ctrls->qctrl.id)
+                       continue;
+               if (ctrl->value < ctrls->qctrl.minimum
+                   && ctrl->value > ctrls->qctrl.maximum)
+                       return -ERANGE;
+               PDEBUG(D_CONF, "set ctrl [%08x] = %d", ctrl->id, ctrl->value);
+               mutex_lock_interruptible(&gspca_dev->usb_lock);
+               ret = ctrls->set(gspca_dev, ctrl->value);
+               mutex_unlock(&gspca_dev->usb_lock);
+               return ret;
+       }
+       return -EINVAL;
+}
+
+static int vidioc_g_ctrl(struct file *file, void *priv,
+                        struct v4l2_control *ctrl)
+{
+       struct gspca_dev *gspca_dev = priv;
+
+       struct ctrl *ctrls;
+       int i, ret;
+
+       for (i = 0, ctrls = gspca_dev->sd_desc->ctrls;
+            i < gspca_dev->sd_desc->nctrls;
+            i++, ctrls++) {
+               if (ctrl->id != ctrls->qctrl.id)
+                       continue;
+               mutex_lock_interruptible(&gspca_dev->usb_lock);
+               ret = ctrls->get(gspca_dev, &ctrl->value);
+               mutex_unlock(&gspca_dev->usb_lock);
+               return ret;
+       }
+       return -EINVAL;
+}
+
+static int vidioc_querymenu(struct file *file, void *priv,
+                           struct v4l2_querymenu *qmenu)
+{
+       struct gspca_dev *gspca_dev = priv;
+
+       if (!gspca_dev->sd_desc->querymenu)
+               return -EINVAL;
+       return gspca_dev->sd_desc->querymenu(gspca_dev, qmenu);
+}
+
+static int vidioc_enum_input(struct file *file, void *priv,
+                               struct v4l2_input *input)
+{
+       struct gspca_dev *gspca_dev = priv;
+
+       if (input->index != 0)
+               return -EINVAL;
+       memset(input, 0, sizeof *input);
+       input->type = V4L2_INPUT_TYPE_CAMERA;
+       strncpy(input->name, gspca_dev->sd_desc->name,
+               sizeof input->name);
+       return 0;
+}
+
+static int vidioc_g_input(struct file *file, void *priv, unsigned int *i)
+{
+       *i = 0;
+       return 0;
+}
+
+static int vidioc_s_input(struct file *file, void *priv, unsigned int i)
+{
+       if (i > 0)
+               return -EINVAL;
+       return (0);
+}
+
+static int vidioc_reqbufs(struct file *file, void *priv,
+                         struct v4l2_requestbuffers *rb)
+{
+       struct gspca_dev *gspca_dev = priv;
+       int frsz, ret;
+
+       PDEBUG(D_STREAM, "reqbufs %d", rb->count);
+       if (rb->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
+               return -EINVAL;
+       if (rb->memory != V4L2_MEMORY_MMAP
+           && rb->memory != V4L2_MEMORY_USERPTR)
+               return -EINVAL;
+       if (rb->count == 0)
+               return -EINVAL;
+       frsz = gspca_get_buff_size(gspca_dev);
+       if (frsz < 0)
+               return frsz;
+       ret = mutex_lock_interruptible(&gspca_dev->queue_lock);
+       if (ret < 0)
+               return ret;
+       ret = frame_alloc(gspca_dev,
+                               rb->count,
+                               (unsigned int) frsz,
+                               rb->memory);
+       if (ret == 0)
+               rb->count = gspca_dev->nframes;
+       mutex_unlock(&gspca_dev->queue_lock);
+       PDEBUG(D_STREAM, "reqbufs st:%d c:%d", ret, rb->count);
+       return ret;
+}
+
+static int vidioc_querybuf(struct file *file, void *priv,
+                          struct v4l2_buffer *v4l2_buf)
+{
+       struct gspca_dev *gspca_dev = priv;
+       struct gspca_frame *frame;
+
+       PDEBUG(D_STREAM, "querybuf");
+       if (v4l2_buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE
+           || v4l2_buf->index < 0
+           || v4l2_buf->index >= gspca_dev->nframes)
+               return -EINVAL;
+
+       frame = &gspca_dev->frame[v4l2_buf->index];
+       memcpy(v4l2_buf, &frame->v4l2_buf, sizeof *v4l2_buf);
+       return 0;
+}
+
+static int vidioc_streamon(struct file *file, void *priv,
+                          enum v4l2_buf_type buf_type)
+{
+       struct gspca_dev *gspca_dev = priv;
+       int ret;
+
+       PDEBUG(D_STREAM, "stream on");
+       if (buf_type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
+               return -EINVAL;
+       ret = mutex_lock_interruptible(&gspca_dev->queue_lock);
+       if (ret < 0)
+               return ret;
+       if (!gspca_dev->present) {
+               ret = -ENODEV;
+               goto out;
+       }
+       if (gspca_dev->nframes == 0) {
+               ret = -EINVAL;
+               goto out;
+       }
+       if (!gspca_dev->streaming) {
+               ret = gspca_init_transfer(gspca_dev);
+               if (ret < 0)
+                       goto out;
+       }
+#ifdef GSPCA_DEBUG
+       if (gspca_debug & D_STREAM) {
+               PDEBUG_MODE("stream on OK",
+                       gspca_dev->pixfmt,
+                       gspca_dev->width,
+                       gspca_dev->height);
+       }
+#endif
+out:
+       mutex_unlock(&gspca_dev->queue_lock);
+       return ret;
+}
+
+static int vidioc_streamoff(struct file *file, void *priv,
+                               enum v4l2_buf_type buf_type)
+{
+       struct gspca_dev *gspca_dev = priv;
+
+       PDEBUG(D_STREAM, "stream off");
+       if (buf_type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
+               return -EINVAL;
+       if (gspca_dev->streaming) {
+               mutex_lock_interruptible(&gspca_dev->queue_lock);
+               gspca_stream_off(gspca_dev);
+               mutex_unlock(&gspca_dev->queue_lock);
+       }
+       return 0;
+}
+
+static int vidioc_g_jpegcomp(struct file *file, void *priv,
+                       struct v4l2_jpegcompression *jpegcomp)
+{
+       struct gspca_dev *gspca_dev = priv;
+       int ret;
+
+       if (!gspca_dev->sd_desc->get_jcomp)
+               return -EINVAL;
+       mutex_lock_interruptible(&gspca_dev->usb_lock);
+       ret = gspca_dev->sd_desc->get_jcomp(gspca_dev, jpegcomp);
+       mutex_unlock(&gspca_dev->usb_lock);
+       return ret;
+}
+
+static int vidioc_s_jpegcomp(struct file *file, void *priv,
+                       struct v4l2_jpegcompression *jpegcomp)
+{
+       struct gspca_dev *gspca_dev = priv;
+       int ret;
+
+       mutex_lock_interruptible(&gspca_dev->usb_lock);
+       if (!gspca_dev->sd_desc->set_jcomp)
+               return -EINVAL;
+       ret = gspca_dev->sd_desc->set_jcomp(gspca_dev, jpegcomp);
+       mutex_unlock(&gspca_dev->usb_lock);
+       return ret;
+}
+
+static int vidioc_g_parm(struct file *filp, void *priv,
+                       struct v4l2_streamparm *parm)
+{
+       struct gspca_dev *gspca_dev = priv;
+
+       memset(parm, 0, sizeof parm);
+       parm->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+       parm->parm.capture.readbuffers = gspca_dev->nbufread;
+       return 0;
+}
+
+static int vidioc_s_parm(struct file *filp, void *priv,
+                       struct v4l2_streamparm *parm)
+{
+       struct gspca_dev *gspca_dev = priv;
+       int n;
+
+       mutex_lock_interruptible(&gspca_dev->usb_lock);
+       n = parm->parm.capture.readbuffers;
+       if (n == 0 || n > GSPCA_MAX_FRAMES)
+               parm->parm.capture.readbuffers = gspca_dev->nbufread;
+       else
+               gspca_dev->nbufread = n;
+       mutex_unlock(&gspca_dev->usb_lock);
+       return 0;
+}
+
+#ifdef CONFIG_VIDEO_V4L1_COMPAT
+static int vidiocgmbuf(struct file *file, void *priv,
+                       struct video_mbuf *mbuf)
+{
+       struct gspca_dev *gspca_dev = file->private_data;
+       int i;
+
+       PDEBUG(D_STREAM, "cgmbuf");
+       if (gspca_dev->nframes == 0) {
+               struct v4l2_requestbuffers rb;
+               int ret;
+
+               memset(&rb, 0, sizeof rb);
+               rb.count = 4;
+               rb.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+               rb.memory = V4L2_MEMORY_MMAP;
+               ret = vidioc_reqbufs(file, priv, &rb);
+               if (ret != 0)
+                       return ret;
+       }
+       mbuf->frames = gspca_dev->nframes;
+       mbuf->size = gspca_dev->frsz * gspca_dev->nframes;
+       for (i = 0; i < mbuf->frames; i++)
+               mbuf->offsets[i] = gspca_dev->frame[i].v4l2_buf.m.offset;
+       return 0;
+}
+#endif
+
+static int dev_mmap(struct file *file, struct vm_area_struct *vma)
+{
+       struct gspca_dev *gspca_dev = file->private_data;
+       struct gspca_frame *frame = 0;
+       struct page *page;
+       unsigned long addr, start, size;
+       int i, ret;
+#ifdef CONFIG_VIDEO_V4L1_COMPAT
+       int compat = 0;
+#endif
+
+       start = vma->vm_start;
+       size = vma->vm_end - vma->vm_start;
+       PDEBUG(D_STREAM, "mmap start:%08x size:%d", (int) start, (int) size);
+
+       ret = mutex_lock_interruptible(&gspca_dev->queue_lock);
+       if (ret < 0)
+               return ret;
+/* sanity check disconnect, in use, no memory available */
+       if (!gspca_dev->present) {
+               ret = -ENODEV;
+               goto done;
+       }
+
+       for (i = 0; i < gspca_dev->nframes; ++i) {
+               if (gspca_dev->frame[i].v4l2_buf.memory != V4L2_MEMORY_MMAP) {
+                       PDEBUG(D_STREAM, "mmap bad memory type");
+                       break;
+               }
+               if ((gspca_dev->frame[i].v4l2_buf.m.offset >> PAGE_SHIFT)
+                                               == vma->vm_pgoff) {
+                       frame = &gspca_dev->frame[i];
+                       break;
+               }
+       }
+       if (frame == 0) {
+               PDEBUG(D_STREAM, "mmap no frame buffer found");
+               ret = -EINVAL;
+               goto done;
+       }
+#ifdef CONFIG_VIDEO_V4L1_COMPAT
+       if (i == 0 && size == frame->v4l2_buf.length * gspca_dev->nframes)
+               compat = 1;
+       else
+#endif
+       if (size != frame->v4l2_buf.length) {
+               PDEBUG(D_STREAM, "mmap bad size");
+               ret = -EINVAL;
+               goto done;
+       }
+
+       /*
+        * - VM_IO marks the area as being a mmaped region for I/O to a
+        *   device. It also prevents the region from being core dumped.
+        */
+       vma->vm_flags |= VM_IO;
+
+       addr = (unsigned long) frame->data;
+       while (size > 0) {
+               page = vmalloc_to_page((void *) addr);
+               ret = vm_insert_page(vma, start, page);
+               if (ret < 0)
+                       goto done;
+               start += PAGE_SIZE;
+               addr += PAGE_SIZE;
+               size -= PAGE_SIZE;
+       }
+
+       vma->vm_ops = &gspca_vm_ops;
+       vma->vm_private_data = frame;
+       gspca_vm_open(vma);
+#ifdef CONFIG_VIDEO_V4L1_COMPAT
+       if (compat) {
+/*fixme: ugly*/
+               for (i = 1; i < gspca_dev->nframes; ++i)
+                       gspca_dev->frame[i].v4l2_buf.flags |=
+                                               V4L2_BUF_FLAG_MAPPED;
+       }
+#endif
+done:
+       mutex_unlock(&gspca_dev->queue_lock);
+       return ret;
+}
+
+static unsigned int dev_poll(struct file *file, poll_table * wait)
+{
+       struct gspca_dev *gspca_dev = file->private_data;
+       int i, ret;
+
+       PDEBUG(D_FRAM, "poll");
+
+       poll_wait(file, &gspca_dev->wq, wait);
+
+       if (mutex_lock_interruptible(&gspca_dev->queue_lock) != 0)
+               return POLLERR;
+       if (gspca_dev->dev == 0
+           || !gspca_dev->streaming)                   /* if not streaming */
+               ret = POLLERR;
+       else {
+               i = gspca_dev->fr_o;
+               i = gspca_dev->fr_queue[i];
+               if (gspca_dev->frame[i].v4l2_buf.flags & V4L2_BUF_FLAG_DONE)
+                       ret = POLLIN | POLLRDNORM;      /* something to read */
+               else
+                       ret = 0;
+       }
+       mutex_unlock(&gspca_dev->queue_lock);
+       return ret;
+}
+
+/*
+ * wait for a video frame
+ *
+ * If a frame is ready, its index is returned.
+ */
+static int gspca_frame_wait(struct gspca_dev *gspca_dev,
+                       int nonblock_ing)
+{
+       struct gspca_frame *frame;
+       int i, j, ret;
+
+       i = gspca_dev->fr_o;
+       j = gspca_dev->fr_queue[i];
+       frame = &gspca_dev->frame[j];
+       if (frame->v4l2_buf.flags & V4L2_BUF_FLAG_DONE)
+               goto ok;
+       if (nonblock_ing)                       /* no frame yet */
+               return -EAGAIN;
+
+       /* wait till a frame is ready */
+       for (;;) {
+               ret = wait_event_interruptible(gspca_dev->wq,
+                                       atomic_read(&gspca_dev->nevent) > 0);
+               if (ret != 0)
+                       return ret;
+               i = gspca_dev->fr_o;
+               j = gspca_dev->fr_queue[i];
+               frame = &gspca_dev->frame[j];
+               if (frame->v4l2_buf.flags & V4L2_BUF_FLAG_DONE)
+                       break;
+       }
+
+ok:
+       atomic_dec(&gspca_dev->nevent);
+       gspca_dev->fr_o = (i + 1) % gspca_dev->nframes;
+       PDEBUG(D_FRAM, "frame wait q:%d i:%d o:%d",
+               gspca_dev->fr_q,
+               gspca_dev->fr_i,
+               gspca_dev->fr_o);
+       return j;
+}
+
+/*
+ * dequeue a video buffer
+ *
+ * If nonblock_ing is false, block until a buffer is available.
+ */
+static int vidioc_dqbuf(struct file *file, void *priv,
+                       struct v4l2_buffer *v4l2_buf)
+{
+       struct gspca_dev *gspca_dev = priv;
+       struct gspca_frame *frame;
+       int i, ret;
+
+       PDEBUG(D_FRAM, "dqbuf");
+       if (v4l2_buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE
+           || (v4l2_buf->memory != V4L2_MEMORY_MMAP
+               && v4l2_buf->memory != V4L2_MEMORY_USERPTR))
+               return -EINVAL;
+       if (!gspca_dev->streaming)
+               return -EINVAL;
+
+       /* only one read */
+       if (mutex_lock_interruptible(&gspca_dev->read_lock))
+               return -ERESTARTSYS;
+
+       ret = gspca_frame_wait(gspca_dev, file->f_flags & O_NONBLOCK);
+       if (ret < 0)
+               goto done;
+       i = ret;                                /* frame index */
+       frame = &gspca_dev->frame[i];
+       frame->v4l2_buf.flags &= ~V4L2_BUF_FLAG_DONE;
+       memcpy(v4l2_buf, &frame->v4l2_buf, sizeof *v4l2_buf);
+       PDEBUG(D_FRAM, "dqbuf %d", i);
+       ret = 0;
+done:
+       mutex_unlock(&gspca_dev->read_lock);
+       return ret;
+}
+
+/*
+ * queue a video buffer
+ *
+ * Attempting to queue a buffer that has already been
+ * queued will return -EINVAL.
+ */
+static int vidioc_qbuf(struct file *file, void *priv,
+                       struct v4l2_buffer *v4l2_buf)
+{
+       struct gspca_dev *gspca_dev = priv;
+       struct gspca_frame *frame;
+       int i, index, ret;
+
+       PDEBUG(D_FRAM, "qbuf %d", v4l2_buf->index);
+       if (v4l2_buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
+               return -EINVAL;
+
+       index = v4l2_buf->index;
+       if ((unsigned) index >= gspca_dev->nframes) {
+               PDEBUG(D_STREAM,
+                       "qbuf idx %d >= %d", index, gspca_dev->nframes);
+               return -EINVAL;
+       }
+       frame = &gspca_dev->frame[index];
+
+       if (v4l2_buf->memory != frame->v4l2_buf.memory) {
+               PDEBUG(D_STREAM, "qbuf bad memory type");
+               return -EINVAL;
+       }
+
+       ret = mutex_lock_interruptible(&gspca_dev->queue_lock);
+       if (ret < 0)
+               return ret;
+       if (frame->v4l2_buf.flags
+                       & (V4L2_BUF_FLAG_QUEUED | V4L2_BUF_FLAG_DONE)) {
+               PDEBUG(D_STREAM, "qbuf bad state");
+               ret = -EINVAL;
+               goto out;
+       }
+
+       frame->v4l2_buf.flags |= V4L2_BUF_FLAG_QUEUED;
+       frame->v4l2_buf.flags &= ~V4L2_BUF_FLAG_DONE;
+
+       if (v4l2_buf->memory == V4L2_MEMORY_USERPTR) {
+               frame->data = frame->data_end =
+                               (unsigned char *) v4l2_buf->m.userptr;
+               frame->v4l2_buf.m.userptr = v4l2_buf->m.userptr;
+               frame->v4l2_buf.length = v4l2_buf->length;
+       }
+
+       /* put the buffer in the 'queued' queue */
+       i = gspca_dev->fr_q;
+       gspca_dev->fr_queue[i] = index;
+       gspca_dev->fr_q = (i + 1) % gspca_dev->nframes;
+       PDEBUG(D_FRAM, "qbuf q:%d i:%d o:%d",
+               gspca_dev->fr_q,
+               gspca_dev->fr_i,
+               gspca_dev->fr_o);
+
+       v4l2_buf->flags |= V4L2_BUF_FLAG_QUEUED;
+       v4l2_buf->flags &= ~V4L2_BUF_FLAG_DONE;
+       ret = 0;
+out:
+       mutex_unlock(&gspca_dev->queue_lock);
+       return ret;
+}
+
+static ssize_t dev_read(struct file *file, char __user *data,
+                   size_t count, loff_t *ppos)
+{
+       struct gspca_dev *gspca_dev = file->private_data;
+       struct gspca_frame *frame;
+       struct v4l2_buffer v4l2_buf;
+       struct timeval timestamp;
+       int i, ret, ret2;
+
+       PDEBUG(D_FRAM, "read (%p, %d)", data, count);
+       if (gspca_dev->nframes == 0) {
+               struct v4l2_requestbuffers rb;
+
+               memset(&rb, 0, sizeof rb);
+               rb.count = gspca_dev->nbufread;
+               rb.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+               rb.memory = V4L2_MEMORY_MMAP;
+               ret = vidioc_reqbufs(file, gspca_dev, &rb);
+               if (ret != 0) {
+                       PDEBUG(D_STREAM, "read reqbuf err: %d", ret);
+                       return ret;
+               }
+               memset(&v4l2_buf, 0, sizeof v4l2_buf);
+               v4l2_buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+               v4l2_buf.memory = V4L2_MEMORY_MMAP;
+               for (i = 0; i < gspca_dev->nbufread; i++) {
+                       v4l2_buf.index = i;
+/*fixme: ugly!*/
+                       gspca_dev->frame[i].v4l2_buf.flags |=
+                                                       V4L2_BUF_FLAG_MAPPED;
+                       ret = vidioc_qbuf(file, gspca_dev, &v4l2_buf);
+                       if (ret != 0) {
+                               PDEBUG(D_STREAM, "read qbuf err: %d", ret);
+                               return ret;
+                       }
+               }
+       }
+       if (!gspca_dev->streaming) {
+               ret = vidioc_streamon(file, gspca_dev,
+                                       V4L2_BUF_TYPE_VIDEO_CAPTURE);
+               if (ret != 0) {
+                       PDEBUG(D_STREAM, "read streamon err %d", ret);
+                       return ret;
+               }
+       }
+
+       /* get a frame */
+       jiffies_to_timeval(get_jiffies_64(), &timestamp);
+       timestamp.tv_sec--;
+       for (i = 0; i < 2; i++) {
+               memset(&v4l2_buf, 0, sizeof v4l2_buf);
+               v4l2_buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+               v4l2_buf.memory = V4L2_MEMORY_MMAP;
+               ret = vidioc_dqbuf(file, gspca_dev, &v4l2_buf);
+               if (ret != 0) {
+                       PDEBUG(D_STREAM, "read dqbuf err %d", ret);
+                       return ret;
+               }
+
+               /* if the process slept for more than 1 second,
+                * get a brand new frame */
+               frame = &gspca_dev->frame[v4l2_buf.index];
+               if (frame->v4l2_buf.timestamp.tv_sec >= timestamp.tv_sec)
+                       break;
+               ret = vidioc_qbuf(file, gspca_dev, &v4l2_buf);
+               if (ret != 0) {
+                       PDEBUG(D_STREAM, "read qbuf err %d", ret);
+                       return ret;
+               }
+       }
+
+       /* copy the frame */
+       if (count < frame->v4l2_buf.bytesused) {
+               PDEBUG(D_STREAM, "read bad count: %d < %d",
+                       count, frame->v4l2_buf.bytesused);
+/*fixme: special errno?*/
+               ret = -EINVAL;
+               goto out;
+       }
+       count = frame->v4l2_buf.bytesused;
+       ret = copy_to_user(data, frame->data, count);
+       if (ret != 0) {
+               PDEBUG(D_ERR|D_STREAM,
+                       "read cp to user lack %d / %d", ret, count);
+               ret = -EFAULT;
+               goto out;
+       }
+       ret = count;
+out:
+       /* in each case, requeue the buffer */
+       ret2 = vidioc_qbuf(file, gspca_dev, &v4l2_buf);
+       if (ret2 != 0)
+               return ret2;
+       return ret;
+}
+
+static void gspca_dev_release(struct video_device *vfd)
+{
+       /* nothing */
+}
+
+static struct file_operations dev_fops = {
+       .owner = THIS_MODULE,
+       .open = dev_open,
+       .release = dev_close,
+       .read = dev_read,
+       .mmap = dev_mmap,
+       .ioctl = video_ioctl2,
+       .llseek = no_llseek,
+       .poll   = dev_poll,
+};
+
+static struct video_device gspca_template = {
+       .name = "gspca main driver",
+       .type = VID_TYPE_CAPTURE,
+       .fops = &dev_fops,
+       .release = gspca_dev_release,   /* mandatory */
+       .minor = -1,
+       .vidioc_querycap        = vidioc_querycap,
+       .vidioc_dqbuf           = vidioc_dqbuf,
+       .vidioc_qbuf            = vidioc_qbuf,
+       .vidioc_enum_fmt_cap    = vidioc_enum_fmt_cap,
+       .vidioc_try_fmt_cap     = vidioc_try_fmt_cap,
+       .vidioc_g_fmt_cap       = vidioc_g_fmt_cap,
+       .vidioc_s_fmt_cap       = vidioc_s_fmt_cap,
+       .vidioc_streamon        = vidioc_streamon,
+       .vidioc_queryctrl       = vidioc_queryctrl,
+       .vidioc_g_ctrl          = vidioc_g_ctrl,
+       .vidioc_s_ctrl          = vidioc_s_ctrl,
+       .vidioc_querymenu       = vidioc_querymenu,
+       .vidioc_enum_input      = vidioc_enum_input,
+       .vidioc_g_input         = vidioc_g_input,
+       .vidioc_s_input         = vidioc_s_input,
+       .vidioc_reqbufs         = vidioc_reqbufs,
+       .vidioc_querybuf        = vidioc_querybuf,
+       .vidioc_streamoff       = vidioc_streamoff,
+       .vidioc_g_jpegcomp      = vidioc_g_jpegcomp,
+       .vidioc_s_jpegcomp      = vidioc_s_jpegcomp,
+       .vidioc_g_parm          = vidioc_g_parm,
+       .vidioc_s_parm          = vidioc_s_parm,
+#ifdef CONFIG_VIDEO_V4L1_COMPAT
+       .vidiocgmbuf          = vidiocgmbuf,
+#endif
+};
+
+/*
+ * probe and create a new gspca device
+ *
+ * This function must be called by the sub-driver when it is
+ * called for probing a new device.
+ */
+int gspca_dev_probe(struct usb_interface *intf,
+               const struct usb_device_id *id,
+               const struct sd_desc *sd_desc,
+               int dev_size)
+{
+       struct usb_interface_descriptor *interface;
+       struct gspca_dev *gspca_dev;
+       struct usb_device *dev = interface_to_usbdev(intf);
+       int ret;
+       __u16 vendor;
+       __u16 product;
+
+       vendor = le16_to_cpu(dev->descriptor.idVendor);
+       product = le16_to_cpu(dev->descriptor.idProduct);
+       PDEBUG(D_PROBE, "probing %04x:%04x", vendor, product);
+
+       /* we don't handle multi-config cameras */
+       if (dev->descriptor.bNumConfigurations != 1)
+               return -ENODEV;
+       interface = &intf->cur_altsetting->desc;
+       if (interface->bInterfaceNumber > 0)
+               return -ENODEV;
+
+       /* create the device */
+       if (dev_size < sizeof *gspca_dev)
+               dev_size = sizeof *gspca_dev;
+       gspca_dev = kzalloc(dev_size, GFP_KERNEL);
+       if (gspca_dev == NULL) {
+               err("couldn't kzalloc gspca struct");
+               return -EIO;
+       }
+       gspca_dev->dev = dev;
+       gspca_dev->iface = interface->bInterfaceNumber;
+       gspca_dev->sd_desc = sd_desc;
+/*     gspca_dev->users = 0;                   (done by kzalloc) */
+       gspca_dev->nbufread = 2;
+
+       /* configure the subdriver */
+       ret = gspca_dev->sd_desc->config(gspca_dev, id);
+       if (ret < 0)
+               goto out;
+       ret = gspca_set_alt0(gspca_dev);
+       if (ret < 0)
+               goto out;
+       gspca_set_default_mode(gspca_dev);
+
+       mutex_init(&gspca_dev->usb_lock);
+       mutex_init(&gspca_dev->read_lock);
+       mutex_init(&gspca_dev->queue_lock);
+       init_waitqueue_head(&gspca_dev->wq);
+
+       /* init video stuff */
+       memcpy(&gspca_dev->vdev, &gspca_template, sizeof gspca_template);
+       gspca_dev->vdev.dev = &dev->dev;
+       ret = video_register_device(&gspca_dev->vdev,
+                                 VFL_TYPE_GRABBER,
+                                 video_nr);
+       if (ret < 0) {
+               err("video_register_device err %d", ret);
+               goto out;
+       }
+
+       gspca_dev->present = 1;
+       usb_set_intfdata(intf, gspca_dev);
+       PDEBUG(D_PROBE, "probe ok");
+       return 0;
+out:
+       kfree(gspca_dev);
+       return ret;
+}
+EXPORT_SYMBOL(gspca_dev_probe);
+
+/*
+ * USB disconnection
+ *
+ * This function must be called by the sub-driver
+ * when the device disconnects, after the specific resources are freed.
+ */
+void gspca_disconnect(struct usb_interface *intf)
+{
+       struct gspca_dev *gspca_dev  = usb_get_intfdata(intf);
+
+       if (!gspca_dev)
+               return;
+       gspca_dev->present = 0;
+       mutex_lock_interruptible(&gspca_dev->queue_lock);
+       mutex_lock_interruptible(&gspca_dev->usb_lock);
+       gspca_kill_transfer(gspca_dev);
+       mutex_unlock(&gspca_dev->queue_lock);
+       mutex_unlock(&gspca_dev->usb_lock);
+       while (gspca_dev->users != 0) {         /* wait until fully closed */
+               atomic_inc(&gspca_dev->nevent);
+               wake_up_interruptible(&gspca_dev->wq);  /* wake processes */
+               schedule();
+       }
+/* We don't want people trying to open up the device */
+       video_unregister_device(&gspca_dev->vdev);
+/* Free the memory */
+       kfree(gspca_dev);
+       PDEBUG(D_PROBE, "disconnect complete");
+}
+EXPORT_SYMBOL(gspca_disconnect);
+
+/* -- module insert / remove -- */
+static int __init gspca_init(void)
+{
+       info("main v%s registered", version);
+       return 0;
+}
+static void __exit gspca_exit(void)
+{
+       info("main deregistered");
+}
+
+module_init(gspca_init);
+module_exit(gspca_exit);
+
+module_param_named(debug, gspca_debug, int, 0644);
+MODULE_PARM_DESC(debug,
+               "Debug (bit) 0x01:error 0x02:probe 0x04:config"
+               " 0x08:stream 0x10:frame 0x20:packet 0x40:USBin 0x80:USBout");
+
+module_param(comp_fac, int, 0644);
+MODULE_PARM_DESC(comp_fac,
+               "Buffer size ratio when compressed in percent");
diff --git a/drivers/media/video/gspca/gspca.h b/drivers/media/video/gspca/gspca.h
new file mode 100644 (file)
index 0000000..1394ab1
--- /dev/null
@@ -0,0 +1,178 @@
+#ifndef GSPCAV2_H
+#define GSPCAV2_H
+
+#include <linux/module.h>
+#include <linux/version.h>
+#include <linux/kernel.h>
+#include <linux/usb.h>
+#include <linux/videodev2.h>
+#include <media/v4l2-common.h>
+#include <linux/mutex.h>
+
+#ifdef GSPCA_DEBUG
+/* GSPCA our debug messages */
+extern int gspca_debug;
+#define PDEBUG(level, fmt, args...) \
+       do {\
+               if (gspca_debug & (level)) \
+                       printk(KERN_INFO MODULE_NAME ": " fmt "\n", ## args); \
+       } while (0)
+#define D_ERR  0x01
+#define D_PROBE 0x02
+#define D_CONF 0x04
+#define D_STREAM 0x08
+#define D_FRAM 0x10
+#define D_PACK 0x20
+#define D_USBI 0x40
+#define D_USBO 0x80
+#else
+#define PDEBUG(level, fmt, args...)
+#endif
+#undef err
+#define err(fmt, args...) \
+       do {\
+               printk(KERN_ERR MODULE_NAME ": " fmt "\n", ## args); \
+       } while (0)
+#undef info
+#define info(fmt, args...) \
+       do {\
+               printk(KERN_INFO MODULE_NAME ": " fmt "\n", ## args); \
+       } while (0)
+#undef warn
+#define warn(fmt, args...) \
+       do {\
+               printk(KERN_WARNING MODULE_NAME ": " fmt "\n", ## args); \
+       } while (0)
+
+#define GSPCA_MAX_FRAMES 16    /* maximum number of video frame buffers */
+/* ISOC transfers */
+#define NURBS 4                        /* number of URBs */
+#define ISO_MAX_PKT 32         /* max number of packets in an ISOC transfer */
+#define ISO_MAX_SIZE 0x10000   /* max size of one URB buffer (64 Kb) */
+
+/* device information - set at probe time */
+struct cam_mode {
+       __u32 pixfmt;
+       short width;
+       short height;
+       short mode;             /* subdriver value */
+       short reserved;         /* subdriver value */
+};
+struct cam {
+       char *dev_name;
+       struct cam_mode *cam_mode;      /* size nmodes */
+       char nmodes;
+       __u8 epaddr;
+};
+
+struct gspca_dev;
+struct gspca_frame;
+
+/* subdriver operations */
+typedef int (*cam_op) (struct gspca_dev *);
+typedef void (*cam_v_op) (struct gspca_dev *);
+typedef int (*cam_cf_op) (struct gspca_dev *, const struct usb_device_id *);
+typedef int (*cam_jpg_op) (struct gspca_dev *,
+                               struct v4l2_jpegcompression *);
+typedef int (*cam_qmnu_op) (struct gspca_dev *,
+                       struct v4l2_querymenu *);
+typedef void (*cam_pkt_op) (struct gspca_dev *gspca_dev,
+                               struct gspca_frame *frame,
+                               unsigned char *data,
+                               int len);
+
+struct ctrl {
+       struct v4l2_queryctrl qctrl;
+       int (*set)(struct gspca_dev *, __s32);
+       int (*get)(struct gspca_dev *, __s32 *);
+};
+
+/* subdriver description */
+struct sd_desc {
+/* information */
+       char *name;                     /* sub-driver name */
+/* controls */
+       struct ctrl *ctrls;
+       int nctrls;
+/* operations */
+       cam_cf_op config;               /* called on probe */
+       cam_op open;                    /* called on open */
+       cam_v_op start;                 /* called on stream on */
+       cam_v_op stopN;                 /* called on stream off - main alt */
+       cam_v_op stop0;                 /* called on stream off - alt 0 */
+       cam_v_op close;                 /* called on close */
+       cam_pkt_op pkt_scan;
+       cam_jpg_op get_jcomp;
+       cam_jpg_op set_jcomp;
+       cam_qmnu_op querymenu;
+};
+
+struct gspca_pktbuf {
+       char *data;
+       struct urb *urb;
+};
+
+/* packet types when moving from iso buf to frame buf */
+#define DISCARD_PACKET 0
+#define FIRST_PACKET   1
+#define INTER_PACKET   2
+#define LAST_PACKET    3
+
+struct gspca_frame {
+       unsigned char *data;            /* frame buffer */
+       unsigned char *data_end;        /* current end of frame while filling */
+       int vma_use_count;
+       struct v4l2_buffer v4l2_buf;
+};
+
+struct gspca_dev {
+       struct video_device vdev;               /* !! must be the first item */
+       struct usb_device *dev;
+
+       struct cam cam;                         /* device information */
+       const struct sd_desc *sd_desc;          /* subdriver description */
+
+       struct gspca_pktbuf pktbuf[NURBS];
+
+       __u8 *frbuf;                            /* buffer for nframes */
+       struct gspca_frame frame[GSPCA_MAX_FRAMES];
+       unsigned int frsz;                      /* frame size */
+       char nframes;                           /* number of frames */
+       char fr_i;                              /* frame being filled */
+       char fr_q;                              /* next frame to queue */
+       char fr_o;                              /* next frame to dequeue */
+       signed char fr_queue[GSPCA_MAX_FRAMES]; /* frame queue */
+       char last_packet_type;
+
+       __u8 iface;                     /* USB interface number */
+       __u8 alt;                       /* USB alternate setting */
+       char curr_mode;                 /* current camera mode */
+       __u32 pixfmt;                   /* current mode parameters */
+       short width;
+       short height;
+
+       atomic_t nevent;                /* number of frames done */
+       wait_queue_head_t wq;           /* wait queue */
+       struct mutex usb_lock;          /* usb exchange protection */
+       struct mutex read_lock;         /* read protection */
+       struct mutex queue_lock;        /* ISOC queue protection */
+       __u32 sequence;                 /* frame sequence number */
+       signed char streaming;
+       char users;                     /* # open */
+       char present;                   /* device connected */
+       char nbufread;                  /* number of buffers for read() */
+};
+
+int gspca_dev_probe(struct usb_interface *intf,
+               const struct usb_device_id *id,
+               const struct sd_desc *sd_desc,
+               int dev_size);
+int gspca_dev_init(struct gspca_dev *gspca_dev,
+                  struct usb_interface *intf);
+void gspca_disconnect(struct usb_interface *intf);
+struct gspca_frame *gspca_frame_add(struct gspca_dev *gspca_dev,
+                                   int packet_type,
+                                   struct gspca_frame *frame,
+                                   unsigned char *data,
+                                   int len);
+#endif /* GSPCAV2_H */
diff --git a/drivers/media/video/gspca/jpeg.h b/drivers/media/video/gspca/jpeg.h
new file mode 100644 (file)
index 0000000..c4087c0
--- /dev/null
@@ -0,0 +1,301 @@
+#ifndef JPEG_H
+#define JPEG_H 1
+/*
+ * Insert a JPEG header at start of frame
+ *
+ * This module is used by the gspca subdrivers.
+ * A special case is done for Conexant webcams.
+ *
+ * Copyright (C) Jean-Francois Moine (http://moinejf.free.fr)
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ *
+ */
+
+/* start of jpeg frame + quantization table */
+static const unsigned char quant[][0x88] = {
+/* index 0 - Q40*/
+    {
+       0xff, 0xd8,                     /* jpeg */
+       0xff, 0xdb, 0x00, 0x84,         /* DQT */
+0,                                     /* quantization table part 1 */
+     20, 14, 15, 18, 15, 13, 20, 18, 16, 18, 23, 21, 20, 24, 30, 50,
+     33, 30, 28, 28, 30, 61, 44, 46, 36, 50, 73, 64, 76, 75, 71, 64,
+     70, 69, 80, 90, 115, 98, 80, 85, 109, 86, 69, 70, 100, 136, 101,
+     109,
+     119, 123, 129, 130, 129, 78, 96, 141, 151, 140, 125, 150, 115,
+     126, 129, 124,
+1,                                     /* quantization table part 2 */
+     21, 23, 23, 30, 26, 30, 59, 33, 33, 59, 124, 83, 70, 83, 124, 124,
+     124, 124, 124, 124, 124, 124, 124, 124, 124, 124, 124, 124, 124,
+     124, 124, 124,
+     124, 124, 124, 124, 124, 124, 124, 124, 124, 124, 124, 124, 124,
+     124, 124, 124,
+     124, 124, 124, 124, 124, 124, 124, 124, 124, 124, 124, 124, 124,
+     124, 124, 124},
+/* index 1 - Q50 */
+    {
+       0xff, 0xd8,
+       0xff, 0xdb, 0x00, 0x84,         /* DQT */
+0,
+     16, 11, 12, 14, 12, 10, 16, 14, 13, 14, 18, 17, 16, 19, 24, 40,
+     26, 24, 22, 22, 24, 49, 35, 37, 29, 40, 58, 51, 61, 60, 57, 51,
+     56, 55, 64, 72, 92, 78, 64, 68, 87, 69, 55, 56, 80, 109, 81, 87,
+     95, 98, 103, 104, 103, 62, 77, 113, 121, 112, 100, 120, 92, 101,
+     103, 99,
+1,
+    17, 18, 18, 24, 21, 24, 47, 26, 26, 47, 99, 66, 56, 66, 99, 99,
+     99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99,
+     99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99,
+     99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99, 99},
+/* index 2 Q60 */
+    {
+       0xff, 0xd8,
+       0xff, 0xdb, 0x00, 0x84,         /* DQT */
+0,
+     13, 9, 10, 11, 10, 8, 13, 11, 10, 11, 14, 14, 13, 15, 19, 32,
+     21, 19, 18, 18, 19, 39, 28, 30, 23, 32, 46, 41, 49, 48, 46, 41,
+     45, 44, 51, 58, 74, 62, 51, 54, 70, 55, 44, 45, 64, 87, 65, 70,
+     76, 78, 82, 83, 82, 50, 62, 90, 97, 90, 80, 96, 74, 81, 82, 79,
+1,
+     14, 14, 14, 19, 17, 19, 38, 21, 21, 38, 79, 53, 45, 53, 79, 79,
+     79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79,
+     79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79,
+     79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79, 79},
+/* index 3 - Q70 */
+    {
+       0xff, 0xd8,
+       0xff, 0xdb, 0x00, 0x84,         /* DQT */
+0,
+     10, 7, 7, 8, 7, 6, 10, 8, 8, 8, 11, 10, 10, 11, 14, 24,
+     16, 14, 13, 13, 14, 29, 21, 22, 17, 24, 35, 31, 37, 36, 34, 31,
+     34, 33, 38, 43, 55, 47, 38, 41, 52, 41, 33, 34, 48, 65, 49, 52,
+     57, 59, 62, 62, 62, 37, 46, 68, 73, 67, 60, 72, 55, 61, 62, 59,
+1,
+     10, 11, 11, 14, 13, 14, 28, 16, 16, 28, 59, 40, 34, 40, 59, 59,
+     59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59,
+     59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59,
+     59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59, 59},
+/* index 4 - Q80 */
+    {
+       0xff, 0xd8,
+       0xff, 0xdb, 0x00, 0x84,         /* DQT */
+0,
+      6, 4, 5, 6, 5, 4, 6, 6, 5, 6, 7, 7, 6, 8, 10, 16,
+     10, 10, 9, 9, 10, 20, 14, 15, 12, 16, 23, 20, 24, 24, 23, 20,
+     22, 22, 26, 29, 37, 31, 26, 27, 35, 28, 22, 22, 32, 44, 32, 35,
+     38, 39, 41, 42, 41, 25, 31, 45, 48, 45, 40, 48, 37, 40, 41, 40,
+1,
+      7, 7, 7, 10, 8, 10, 19, 10, 10, 19, 40, 26, 22, 26, 40, 40,
+     40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40,
+     40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40,
+     40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40, 40},
+/* index 5 - Q85 */
+    {
+       0xff, 0xd8,
+       0xff, 0xdb, 0x00, 0x84,         /* DQT */
+0,
+     5, 3, 4, 4, 4, 3, 5, 4, 4, 4, 5, 5, 5, 6, 7, 12,
+     8, 7, 7, 7, 7, 15, 11, 11, 9, 12, 17, 15, 18, 18, 17, 15,
+     17, 17, 19, 22, 28, 23, 19, 20, 26, 21, 17, 17, 24, 33, 24, 26,
+     29, 29, 31, 31, 31, 19, 23, 34, 36, 34, 30, 36, 28, 30, 31, 30,
+1,
+     5, 5, 5, 7, 6, 7, 14, 8, 8, 14, 30, 20, 17, 20, 30, 30,
+     30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30,
+     30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30,
+     30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30, 30},
+/* index 6 - 86 */
+{
+       0xff, 0xd8,
+       0xff, 0xdb, 0x00, 0x84,         /* DQT */
+0,
+       0x04, 0x03, 0x03, 0x04, 0x03, 0x03, 0x04, 0x04,
+       0x04, 0x04, 0x05, 0x05, 0x04, 0x05, 0x07, 0x0B,
+       0x07, 0x07, 0x06, 0x06, 0x07, 0x0E, 0x0A, 0x0A,
+       0x08, 0x0B, 0x10, 0x0E, 0x11, 0x11, 0x10, 0x0E,
+       0x10, 0x0F, 0x12, 0x14, 0x1A, 0x16, 0x12, 0x13,
+       0x18, 0x13, 0x0F, 0x10, 0x16, 0x1F, 0x17, 0x18,
+       0x1B, 0x1B, 0x1D, 0x1D, 0x1D, 0x11, 0x16, 0x20,
+       0x22, 0x1F, 0x1C, 0x22, 0x1A, 0x1C, 0x1D, 0x1C,
+1,
+       0x05, 0x05, 0x05, 0x07, 0x06, 0x07, 0x0D, 0x07,
+       0x07, 0x0D, 0x1C, 0x12, 0x10, 0x12, 0x1C, 0x1C,
+       0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C,
+       0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C,
+       0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C,
+       0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C,
+       0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C,
+       0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C, 0x1C,
+ },
+/* index 7 - 88 */
+{
+       0xff, 0xd8,
+       0xff, 0xdb, 0x00, 0x84,         /* DQT */
+0,
+       0x04, 0x03, 0x03, 0x03, 0x03, 0x02, 0x04, 0x03,
+       0x03, 0x03, 0x04, 0x04, 0x04, 0x05, 0x06, 0x0A,
+       0x06, 0x06, 0x05, 0x05, 0x06, 0x0C, 0x08, 0x09,
+       0x07, 0x0A, 0x0E, 0x0C, 0x0F, 0x0E, 0x0E, 0x0C,
+       0x0D, 0x0D, 0x0F, 0x11, 0x16, 0x13, 0x0F, 0x10,
+       0x15, 0x11, 0x0D, 0x0D, 0x13, 0x1A, 0x13, 0x15,
+       0x17, 0x18, 0x19, 0x19, 0x19, 0x0F, 0x12, 0x1B,
+       0x1D, 0x1B, 0x18, 0x1D, 0x16, 0x18, 0x19, 0x18,
+1,
+       0x04, 0x04, 0x04, 0x06, 0x05, 0x06, 0x0B, 0x06,
+       0x06, 0x0B, 0x18, 0x10, 0x0D, 0x10, 0x18, 0x18,
+       0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18,
+       0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18,
+       0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18,
+       0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18,
+       0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18,
+       0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18,
+},
+/* index 8 - ?? */
+{
+       0xff, 0xd8,
+       0xff, 0xdb, 0x00, 0x84,         /* DQT */
+0,
+       0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02,
+       0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x03, 0x05,
+       0x03, 0x03, 0x03, 0x03, 0x03, 0x06, 0x04, 0x05,
+       0x04, 0x05, 0x07, 0x06, 0x08, 0x08, 0x07, 0x06,
+       0x07, 0x07, 0x08, 0x09, 0x0C, 0x0A, 0x08, 0x09,
+       0x0B, 0x09, 0x07, 0x07, 0x0A, 0x0E, 0x0A, 0x0B,
+       0x0C, 0x0C, 0x0D, 0x0D, 0x0D, 0x08, 0x0A, 0x0E,
+       0x0F, 0x0E, 0x0D, 0x0F, 0x0C, 0x0D, 0x0D, 0x0C,
+1,
+       0x02, 0x02, 0x02, 0x03, 0x03, 0x03, 0x06, 0x03,
+       0x03, 0x06, 0x0C, 0x08, 0x07, 0x08, 0x0C, 0x0C,
+       0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C,
+       0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C,
+       0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C,
+       0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C,
+       0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C,
+       0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C
+}
+};
+
+/* huffman table + start of SOF0 */
+static unsigned char huffman[] = {
+       0xff, 0xc4, 0x01, 0xa2,
+       0x00, 0x00, 0x01, 0x05, 0x01, 0x01, 0x01, 0x01,
+       0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+       0x00, 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06,
+       0x07, 0x08, 0x09, 0x0a, 0x0b, 0x01, 0x00, 0x03,
+       0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
+       0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01,
+       0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09,
+       0x0a, 0x0b, 0x10, 0x00, 0x02, 0x01, 0x03, 0x03,
+       0x02, 0x04, 0x03, 0x05, 0x05, 0x04, 0x04, 0x00,
+       0x00, 0x01, 0x7d, 0x01, 0x02, 0x03, 0x00, 0x04,
+       0x11, 0x05, 0x12, 0x21, 0x31, 0x41, 0x06, 0x13,
+       0x51, 0x61, 0x07, 0x22, 0x71, 0x14, 0x32, 0x81,
+       0x91, 0xa1, 0x08, 0x23, 0x42, 0xb1, 0xc1, 0x15,
+       0x52, 0xd1, 0xf0, 0x24, 0x33, 0x62, 0x72, 0x82,
+       0x09, 0x0a, 0x16, 0x17, 0x18, 0x19, 0x1a, 0x25,
+       0x26, 0x27, 0x28, 0x29, 0x2a, 0x34, 0x35, 0x36,
+       0x37, 0x38, 0x39, 0x3a, 0x43, 0x44, 0x45, 0x46,
+       0x47, 0x48, 0x49, 0x4a, 0x53, 0x54, 0x55, 0x56,
+       0x57, 0x58, 0x59, 0x5a, 0x63, 0x64, 0x65, 0x66,
+       0x67, 0x68, 0x69, 0x6a, 0x73, 0x74, 0x75, 0x76,
+       0x77, 0x78, 0x79, 0x7a, 0x83, 0x84, 0x85, 0x86,
+       0x87, 0x88, 0x89, 0x8a, 0x92, 0x93, 0x94, 0x95,
+       0x96, 0x97, 0x98, 0x99, 0x9a, 0xa2, 0xa3, 0xa4,
+       0xa5, 0xa6, 0xa7, 0xa8, 0xa9, 0xaa, 0xb2, 0xb3,
+       0xb4, 0xb5, 0xb6, 0xb7, 0xb8, 0xb9, 0xba, 0xc2,
+       0xc3, 0xc4, 0xc5, 0xc6, 0xc7, 0xc8, 0xc9, 0xca,
+       0xd2, 0xd3, 0xd4, 0xd5, 0xd6, 0xd7, 0xd8, 0xd9,
+       0xda, 0xe1, 0xe2, 0xe3, 0xe4, 0xe5, 0xe6, 0xe7,
+       0xe8, 0xe9, 0xea, 0xf1, 0xf2, 0xf3, 0xf4, 0xf5,
+       0xf6, 0xf7, 0xf8, 0xf9, 0xfa, 0x11, 0x00, 0x02,
+       0x01, 0x02, 0x04, 0x04, 0x03, 0x04, 0x07, 0x05,
+       0x04, 0x04, 0x00, 0x01, 0x02, 0x77, 0x00, 0x01,
+       0x02, 0x03, 0x11, 0x04, 0x05, 0x21, 0x31, 0x06,
+       0x12, 0x41, 0x51, 0x07, 0x61, 0x71, 0x13, 0x22,
+       0x32, 0x81, 0x08, 0x14, 0x42, 0x91, 0xa1, 0xb1,
+       0xc1, 0x09, 0x23, 0x33, 0x52, 0xf0, 0x15, 0x62,
+       0x72, 0xd1, 0x0a, 0x16, 0x24, 0x34, 0xe1, 0x25,
+       0xf1, 0x17, 0x18, 0x19, 0x1a, 0x26, 0x27, 0x28,
+       0x29, 0x2a, 0x35, 0x36, 0x37, 0x38, 0x39, 0x3a,
+       0x43, 0x44, 0x45, 0x46, 0x47, 0x48, 0x49, 0x4a,
+       0x53, 0x54, 0x55, 0x56, 0x57, 0x58, 0x59, 0x5a,
+       0x63, 0x64, 0x65, 0x66, 0x67, 0x68, 0x69, 0x6a,
+       0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79, 0x7a,
+       0x82, 0x83, 0x84, 0x85, 0x86, 0x87, 0x88, 0x89,
+       0x8a, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97, 0x98,
+       0x99, 0x9a, 0xa2, 0xa3, 0xa4, 0xa5, 0xa6, 0xa7,
+       0xa8, 0xa9, 0xaa, 0xb2, 0xb3, 0xb4, 0xb5, 0xb6,
+       0xb7, 0xb8, 0xb9, 0xba, 0xc2, 0xc3, 0xc4, 0xc5,
+       0xc6, 0xc7, 0xc8, 0xc9, 0xca, 0xd2, 0xd3, 0xd4,
+       0xd5, 0xd6, 0xd7, 0xd8, 0xd9, 0xda, 0xe2, 0xe3,
+       0xe4, 0xe5, 0xe6, 0xe7, 0xe8, 0xe9, 0xea, 0xf2,
+       0xf3, 0xf4, 0xf5, 0xf6, 0xf7, 0xf8, 0xf9, 0xfa,
+#ifdef CONEX_CAM
+/* the Conexant frames start with SOF0 */
+#else
+       0xff, 0xc0, 0x00, 0x11,         /* SOF0 (start of frame 0 */
+       0x08,                           /* data precision */
+#endif
+};
+
+#ifndef CONEX_CAM
+/* variable part:
+ *     0x01, 0xe0,                      height
+ *     0x02, 0x80,                      width
+ *     0x03,                            component number
+ *             0x01,
+ *                     0x21,                   samples Y
+ */
+
+/* end of header */
+static unsigned char eoh[] = {
+                       0x00,           /* quant Y */
+               0x02, 0x11, 0x01,       /* samples CbCr - quant CbCr */
+               0x03, 0x11, 0x01,
+
+       0xff, 0xda, 0x00, 0x0c,         /* SOS (start of scan */
+       0x03, 0x01, 0x00, 0x02, 0x11, 0x03, 0x11, 0x00, 0x3f, 0x00
+};
+#endif
+
+/* -- output the JPEG header -- */
+static void jpeg_put_header(struct gspca_dev *gspca_dev,
+                           struct gspca_frame *frame,
+                           int qindex,
+                           int samplesY)
+{
+#ifndef CONEX_CAM
+       unsigned char tmpbuf[8];
+#endif
+
+       gspca_frame_add(gspca_dev, FIRST_PACKET, frame,
+                       (unsigned char *) quant[qindex], sizeof quant[0]);
+       gspca_frame_add(gspca_dev, INTER_PACKET, frame,
+                       (unsigned char *) huffman, sizeof huffman);
+#ifndef CONEX_CAM
+       tmpbuf[0] = gspca_dev->height >> 8;
+       tmpbuf[1] = gspca_dev->height & 0xff;
+       tmpbuf[2] = gspca_dev->width >> 8;
+       tmpbuf[3] = gspca_dev->width & 0xff;
+       tmpbuf[4] = 0x03;               /* component number */
+       tmpbuf[5] = 0x01;               /* first component */
+       tmpbuf[6] = samplesY;
+       gspca_frame_add(gspca_dev, INTER_PACKET, frame,
+                       tmpbuf, 7);
+       gspca_frame_add(gspca_dev, INTER_PACKET, frame,
+                       eoh, sizeof eoh);
+#endif
+}
+#endif
diff --git a/drivers/media/video/gspca/stk014.c b/drivers/media/video/gspca/stk014.c
new file mode 100644 (file)
index 0000000..8fd4ff0
--- /dev/null
@@ -0,0 +1,562 @@
+/*
+ * Syntek DV4000 (STK014) subdriver
+ *
+ * Copyright (C) Jean-Francois Moine (http://moinejf.free.fr)
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ *
+ */
+
+#define MODULE_NAME "stk014"
+
+#include "gspca.h"
+#include "jpeg.h"
+
+#define DRIVER_VERSION_NUMBER  KERNEL_VERSION(0, 0, 22)
+static const char version[] = "0.0.22";
+
+MODULE_AUTHOR("Jean-Francois Moine <http://moinejf.free.fr>");
+MODULE_DESCRIPTION("Syntek DV4000 (STK014) USB Camera Driver");
+MODULE_LICENSE("GPL");
+
+/* specific webcam descriptor */
+struct sd {
+       struct gspca_dev gspca_dev;     /* !! must be the first item */
+
+       unsigned char brightness;
+       unsigned char contrast;
+       unsigned char colors;
+};
+
+/* global parameters */
+static int lightfreq = 50;
+static int sd_quant = 7;               /* <= 4 KO - 7: good (enough!) */
+
+/* V4L2 controls supported by the driver */
+static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val);
+static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val);
+static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val);
+static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val);
+static int sd_setcolors(struct gspca_dev *gspca_dev, __s32 val);
+static int sd_getcolors(struct gspca_dev *gspca_dev, __s32 *val);
+
+static struct ctrl sd_ctrls[] = {
+#define SD_BRIGHTNESS 0
+       {
+           {
+               .id      = V4L2_CID_BRIGHTNESS,
+               .type    = V4L2_CTRL_TYPE_INTEGER,
+               .name    = "Brightness",
+               .minimum = 0,
+               .maximum = 255,
+               .step    = 1,
+               .default_value = 127,
+           },
+           .set = sd_setbrightness,
+           .get = sd_getbrightness,
+       },
+#define SD_CONTRAST 1
+       {
+           {
+               .id      = V4L2_CID_CONTRAST,
+               .type    = V4L2_CTRL_TYPE_INTEGER,
+               .name    = "Contrast",
+               .minimum = 0,
+               .maximum = 255,
+               .step    = 1,
+               .default_value = 127,
+           },
+           .set = sd_setcontrast,
+           .get = sd_getcontrast,
+       },
+#define SD_COLOR 2
+       {
+           {
+               .id      = V4L2_CID_SATURATION,
+               .type    = V4L2_CTRL_TYPE_INTEGER,
+               .name    = "Saturation",
+               .minimum = 0,
+               .maximum = 255,
+               .step    = 1,
+               .default_value = 127,
+           },
+           .set = sd_setcolors,
+           .get = sd_getcolors,
+       },
+};
+
+static struct cam_mode vga_mode[] = {
+       {V4L2_PIX_FMT_JPEG, 320, 240},
+       {V4L2_PIX_FMT_JPEG, 640, 480},
+};
+
+/* -- read a register -- */
+static int reg_read(struct gspca_dev *gspca_dev,
+                       __u16 index, __u8 *buf)
+{
+       int ret;
+       struct usb_device *dev = gspca_dev->dev;
+
+       ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
+                       0x00,
+                       USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
+                       0x00,
+                       index,
+                       buf, 1,
+                       500);
+       if (ret < 0)
+               PDEBUG(D_ERR, "reg_read err %d", ret);
+       return ret;
+}
+
+/* -- write a register -- */
+static int reg_write(struct gspca_dev *gspca_dev,
+                       __u16 index, __u16 value)
+{
+       struct usb_device *dev = gspca_dev->dev;
+       int ret;
+
+       ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
+                       0x01,
+                       USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
+                       value,
+                       index,
+                       NULL,
+                       0,
+                       500);
+       if (ret < 0)
+               PDEBUG(D_ERR, "reg_write err %d", ret);
+       return ret;
+}
+
+/* -- get a value -- */
+static int rcv_val(struct gspca_dev *gspca_dev,
+                       int ads,
+                       int len)
+{
+       struct usb_device *dev = gspca_dev->dev;
+       int alen, ret;
+       unsigned char bulk_buf[4];
+
+       reg_write(gspca_dev, 0x634, (ads >> 16) & 0xff);
+       reg_write(gspca_dev, 0x635, (ads >> 8) & 0xff);
+       reg_write(gspca_dev, 0x636, ads & 0xff);
+       reg_write(gspca_dev, 0x637, 0);
+       reg_write(gspca_dev, 0x638, len & 0xff);
+       reg_write(gspca_dev, 0x639, len >> 8);
+       reg_write(gspca_dev, 0x63a, 0);
+       reg_write(gspca_dev, 0x63b, 0);
+       reg_write(gspca_dev, 0x630, 5);
+       if (len > sizeof bulk_buf)
+               return -1;
+       ret = usb_bulk_msg(dev,
+                       usb_rcvbulkpipe(dev, 5),
+                       bulk_buf,
+                       len,
+                       &alen,
+                       500);   /* timeout in milliseconds */
+       return ret;
+}
+
+/* -- send a value -- */
+static int snd_val(struct gspca_dev *gspca_dev,
+                       int ads,
+                       unsigned int val)
+{
+       struct usb_device *dev = gspca_dev->dev;
+       int alen, ret;
+       __u8 value, seq;
+       unsigned char bulk_buf[4];
+
+       if (ads == 0x003f08) {
+               ret = reg_read(gspca_dev, 0x0704, &value);
+               if (ret < 0)
+                       goto ko;
+               ret = reg_read(gspca_dev, 0x0705, &seq);
+               if (ret < 0)
+                       goto ko;
+               ret = reg_read(gspca_dev, 0x0650, &value);
+               if (ret < 0)
+                       goto ko;
+               reg_write(gspca_dev, 0x654, seq);
+       } else
+               reg_write(gspca_dev, 0x654, (ads >> 16) & 0xff);
+       reg_write(gspca_dev, 0x655, (ads >> 8) & 0xff);
+       reg_write(gspca_dev, 0x656, ads & 0xff);
+       reg_write(gspca_dev, 0x657, 0);
+       reg_write(gspca_dev, 0x658, 0x04);      /* size */
+       reg_write(gspca_dev, 0x659, 0);
+       reg_write(gspca_dev, 0x65a, 0);
+       reg_write(gspca_dev, 0x65b, 0);
+       reg_write(gspca_dev, 0x650, 5);
+       bulk_buf[0] = (val >> 24) & 0xff;
+       bulk_buf[1] = (val >> 16) & 0xff;
+       bulk_buf[2] = (val >> 8) & 0xff;
+       bulk_buf[3] = val & 0xff;
+       ret = usb_bulk_msg(dev,
+                       usb_sndbulkpipe(dev, 6),
+                       bulk_buf,
+                       4,
+                       &alen,
+                       500);   /* timeout in milliseconds */
+       if (ret < 0)
+               goto ko;
+       if (ads == 0x003f08) {
+               seq += 4;
+               seq &= 0x3f;
+               reg_write(gspca_dev, 0x705, seq);
+       }
+       return ret;
+ko:
+       PDEBUG(D_ERR, "snd_val err %d", ret);
+       return ret;
+}
+
+/* set a camera parameter */
+static int set_par(struct gspca_dev *gspca_dev,
+                  int parval)
+{
+       return snd_val(gspca_dev, 0x003f08, parval);
+}
+
+static void setbrightness(struct gspca_dev *gspca_dev)
+{
+       struct sd *sd = (struct sd *) gspca_dev;
+       int parval;
+
+       PDEBUG(D_CONF, "brightness: %d", sd->brightness);
+       parval = 0x06000000             /* whiteness */
+               + (sd->brightness << 16);
+       set_par(gspca_dev, parval);
+}
+
+static void setcontrast(struct gspca_dev *gspca_dev)
+{
+       struct sd *sd = (struct sd *) gspca_dev;
+       int parval;
+
+       PDEBUG(D_CONF, "contrast: %d", sd->contrast);
+       parval = 0x07000000             /* contrast */
+               + (sd->contrast << 16);
+       set_par(gspca_dev, parval);
+}
+
+static void setcolors(struct gspca_dev *gspca_dev)
+{
+       struct sd *sd = (struct sd *) gspca_dev;
+       int parval;
+
+       PDEBUG(D_CONF, "saturation: %d",
+               sd->colors);
+       parval = 0x08000000             /* saturation */
+               + (sd->colors << 16);
+       set_par(gspca_dev, parval);
+}
+
+/* this function is called at probe time */
+static int sd_config(struct gspca_dev *gspca_dev,
+                       const struct usb_device_id *id)
+{
+       struct sd *sd = (struct sd *) gspca_dev;
+       struct cam *cam = &gspca_dev->cam;
+
+       cam->dev_name = (char *) id->driver_info;
+       cam->epaddr = 0x02;
+       gspca_dev->cam.cam_mode = vga_mode;
+       gspca_dev->cam.nmodes = sizeof vga_mode / sizeof vga_mode[0];
+       sd->brightness = sd_ctrls[SD_BRIGHTNESS].qctrl.default_value;
+       sd->contrast = sd_ctrls[SD_CONTRAST].qctrl.default_value;
+       sd->colors = sd_ctrls[SD_COLOR].qctrl.default_value;
+       return 0;
+}
+
+/* this function is called at open time */
+static int sd_open(struct gspca_dev *gspca_dev)
+{
+       __u8 value;
+       int ret;
+
+       /* check if the device responds */
+       usb_set_interface(gspca_dev->dev, gspca_dev->iface, 1);
+       ret = reg_read(gspca_dev, 0x0740, &value);
+       if (ret < 0)
+               return ret;
+       if (value != 0xff) {
+               PDEBUG(D_ERR|D_STREAM, "init reg: 0x%02x", value);
+               return -1;
+       }
+       return 0;
+}
+
+/* -- start the camera -- */
+static void sd_start(struct gspca_dev *gspca_dev)
+{
+       __u8 dum;
+       int ret, value;
+
+       /* work on alternate 1 */
+       usb_set_interface(gspca_dev->dev, gspca_dev->iface, 1);
+
+       set_par(gspca_dev, 0x10000000);
+       set_par(gspca_dev, 0x00000000);
+       set_par(gspca_dev, 0x8002e001);
+       set_par(gspca_dev, 0x14000000);
+       if (gspca_dev->width > 320)
+               value = 0x8002e001;             /* 640x480 */
+       else
+               value = 0x4001f000;             /* 320x240 */
+       set_par(gspca_dev, value);
+       ret = usb_set_interface(gspca_dev->dev,
+                                       gspca_dev->iface,
+                                       gspca_dev->alt);
+       if (ret < 0)
+               goto out;
+       ret = reg_read(gspca_dev, 0x0630, &dum);
+       if (ret < 0)
+               goto out;
+       rcv_val(gspca_dev, 0x000020, 4);        /* << (value ff ff ff ff) */
+       ret = reg_read(gspca_dev, 0x0650, &dum);
+       if (ret < 0)
+               goto out;
+       snd_val(gspca_dev, 0x000020, 0xffffffff);
+       reg_write(gspca_dev, 0x0620, 0);
+       reg_write(gspca_dev, 0x0630, 0);
+       reg_write(gspca_dev, 0x0640, 0);
+       reg_write(gspca_dev, 0x0650, 0);
+       reg_write(gspca_dev, 0x0660, 0);
+       setbrightness(gspca_dev);               /* whiteness */
+       setcontrast(gspca_dev);                 /* contrast */
+       setcolors(gspca_dev);                   /* saturation */
+       set_par(gspca_dev, 0x09800000);         /* Red ? */
+       set_par(gspca_dev, 0x0a800000);         /* Green ? */
+       set_par(gspca_dev, 0x0b800000);         /* Blue ? */
+       set_par(gspca_dev, 0x0d030000);         /* Gamma ? */
+       set_par(gspca_dev, lightfreq == 60
+                       ? 0x33780000            /* 60 Hz */
+                       : 0x33640000);          /* 50 Hz */
+
+       /* start the video flow */
+       set_par(gspca_dev, 0x01000000);
+       set_par(gspca_dev, 0x01000000);
+       PDEBUG(D_STREAM, "camera started alt: 0x%02x", gspca_dev->alt);
+       return;
+out:
+       PDEBUG(D_ERR|D_STREAM, "camera start err %d", ret);
+}
+
+static void sd_stopN(struct gspca_dev *gspca_dev)
+{
+       struct usb_device *dev = gspca_dev->dev;
+       __u8 value;
+
+       set_par(gspca_dev, 0x02000000);
+       set_par(gspca_dev, 0x02000000);
+       usb_set_interface(dev, gspca_dev->iface, 1);
+       reg_read(gspca_dev, 0x0630, &value);
+       rcv_val(gspca_dev, 0x000020, 4);        /* << (value ff ff ff ff) */
+       reg_read(gspca_dev, 0x0650, &value);
+       snd_val(gspca_dev, 0x000020, 0xffffffff);
+       reg_write(gspca_dev, 0x0620, 0);
+       reg_write(gspca_dev, 0x0630, 0);
+       reg_write(gspca_dev, 0x0640, 0);
+       reg_write(gspca_dev, 0x0650, 0);
+       reg_write(gspca_dev, 0x0660, 0);
+       PDEBUG(D_STREAM, "camera stopped");
+}
+
+static void sd_stop0(struct gspca_dev *gspca_dev)
+{
+}
+
+static void sd_close(struct gspca_dev *gspca_dev)
+{
+}
+
+static void sd_pkt_scan(struct gspca_dev *gspca_dev,
+                       struct gspca_frame *frame,      /* target */
+                       unsigned char *data,            /* isoc packet */
+                       int len)                        /* iso packet length */
+{
+       int l;
+
+       /* a frame starts with:
+        *      - 0xff 0xfe
+        *      - 0x08 0x00     // length (little endian ?!)
+        *      - 4 bytes = size of whole frame (big endian - including header)
+        *      - 0x00 0x0c
+        *      - 0xff 0xd8
+        *      - ..    JPEG image with escape sequences (ff 00)
+        */
+       if (data[0] == 0xff && data[1] == 0xfe) {
+               if (gspca_dev->last_packet_type == INTER_PACKET) {
+                       PDEBUG(D_ERR|D_FRAM, "sof actual l: %d init l: %d",
+                               frame->data_end - frame->data,
+                               frame->v4l2_buf.bytesused);
+               }
+
+               /* put the JPEG headaer */
+               jpeg_put_header(gspca_dev, frame, sd_quant, 0x22);
+
+               /* beginning of the frame */
+#define STKHDRSZ 12
+               l = (data[4] << 24)             /* frame size */
+                       + (data[5] << 16)
+                       + (data[6] << 8)
+                       + data[7]
+                       - STKHDRSZ
+                       + (frame->data_end - frame->data)
+                       + 2;                    /* EOF (ff d9) */
+               gspca_frame_add(gspca_dev, INTER_PACKET, frame,
+                               data + STKHDRSZ, len - STKHDRSZ);
+#undef STKHDRSZ
+               frame->v4l2_buf.bytesused = l;
+               return;
+       }
+       if (gspca_dev->last_packet_type != INTER_PACKET) {
+               if (gspca_dev->last_packet_type == LAST_PACKET) {
+                       PDEBUG(D_ERR|D_PACK, "mof actual l: %d init l: %d",
+                               frame->data_end - frame->data,
+                               frame->v4l2_buf.bytesused);
+               }
+               return;
+       }
+
+       /* intermediate packet */
+       l = frame->data_end - frame->data;
+       if (len < frame->v4l2_buf.bytesused - 2 - l) {
+               gspca_frame_add(gspca_dev, INTER_PACKET, frame,
+                               data, len);
+               return;
+       }
+
+       /* last packet */
+       if (len > frame->v4l2_buf.bytesused - 2 - l)
+               len = frame->v4l2_buf.bytesused - 2 - l;
+       gspca_frame_add(gspca_dev, INTER_PACKET, frame, data, len);
+       gspca_frame_add(gspca_dev, LAST_PACKET, frame, "\xff\xd9", 2);
+}
+
+static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val)
+{
+       struct sd *sd = (struct sd *) gspca_dev;
+
+       sd->brightness = val;
+       if (gspca_dev->streaming)
+               setbrightness(gspca_dev);
+       return 0;
+}
+
+static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val)
+{
+       struct sd *sd = (struct sd *) gspca_dev;
+
+       *val = sd->brightness;
+       return 0;
+}
+
+static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val)
+{
+       struct sd *sd = (struct sd *) gspca_dev;
+
+       sd->contrast = val;
+       if (gspca_dev->streaming)
+               setcontrast(gspca_dev);
+       return 0;
+}
+
+static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val)
+{
+       struct sd *sd = (struct sd *) gspca_dev;
+
+       *val = sd->contrast;
+       return 0;
+}
+
+static int sd_setcolors(struct gspca_dev *gspca_dev, __s32 val)
+{
+       struct sd *sd = (struct sd *) gspca_dev;
+
+       sd->colors = val;
+       if (gspca_dev->streaming)
+               setcolors(gspca_dev);
+       return 0;
+}
+
+static int sd_getcolors(struct gspca_dev *gspca_dev, __s32 *val)
+{
+       struct sd *sd = (struct sd *) gspca_dev;
+
+       *val = sd->colors;
+       return 0;
+}
+
+/* sub-driver description */
+static struct sd_desc sd_desc = {
+       .name = MODULE_NAME,
+       .ctrls = sd_ctrls,
+       .nctrls = sizeof sd_ctrls / sizeof sd_ctrls[0],
+       .config = sd_config,
+       .open = sd_open,
+       .start = sd_start,
+       .stopN = sd_stopN,
+       .stop0 = sd_stop0,
+       .close = sd_close,
+       .pkt_scan = sd_pkt_scan,
+};
+
+/* -- module initialisation -- */
+#define DVNM(name) .driver_info = (kernel_ulong_t) name
+static __devinitdata struct usb_device_id device_table[] = {
+       {USB_DEVICE(0x05e1, 0x0893), DVNM("Syntek DV4000")},
+       {}
+};
+MODULE_DEVICE_TABLE(usb, device_table);
+
+/* -- device connect -- */
+static int sd_probe(struct usb_interface *intf,
+                       const struct usb_device_id *id)
+{
+       PDEBUG(D_PROBE, "camera probe");
+       return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd));
+}
+
+static struct usb_driver sd_driver = {
+       .name = MODULE_NAME,
+       .id_table = device_table,
+       .probe = sd_probe,
+       .disconnect = gspca_disconnect,
+};
+
+/* -- module insert / remove -- */
+static int __init sd_mod_init(void)
+{
+       if (usb_register(&sd_driver) < 0)
+               return -1;
+       info("v%s registered", version);
+       return 0;
+}
+static void __exit sd_mod_exit(void)
+{
+       usb_deregister(&sd_driver);
+       info("deregistered");
+}
+
+module_init(sd_mod_init);
+module_exit(sd_mod_exit);
+
+module_param(lightfreq, int, 0644);
+MODULE_PARM_DESC(lightfreq, "Light frequency 50 or 60 Hz");
+module_param_named(quant, sd_quant, int, 0644);
+MODULE_PARM_DESC(quant, "Quantization index (0..8)");