Merge HEAD from ../scsi-iscsi-2.6
[linux-2.6] / drivers / usb / media / vicam.c
1 /*
2  * USB ViCam WebCam driver
3  * Copyright (c) 2002 Joe Burks (jburks@wavicle.org),
4  *                    Christopher L Cheney (ccheney@cheney.cx),
5  *                    Pavel Machek (pavel@suse.cz),
6  *                    John Tyner (jtyner@cs.ucr.edu),
7  *                    Monroe Williams (monroe@pobox.com)
8  *
9  * Supports 3COM HomeConnect PC Digital WebCam
10  *
11  * This program is free software; you can redistribute it and/or modify
12  * it under the terms of the GNU General Public License as published by
13  * the Free Software Foundation; either version 2 of the License, or
14  * (at your option) any later version.
15  *
16  * This program is distributed in the hope that it will be useful,
17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
19  * GNU General Public License for more details.
20  *
21  * You should have received a copy of the GNU General Public License
22  * along with this program; if not, write to the Free Software
23  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
24  *
25  * This source code is based heavily on the CPiA webcam driver which was
26  * written by Peter Pregler, Scott J. Bertin and Johannes Erdfelt
27  *
28  * Portions of this code were also copied from usbvideo.c
29  *
30  * Special thanks to the the whole team at Sourceforge for help making
31  * this driver become a reality.  Notably:
32  * Andy Armstrong who reverse engineered the color encoding and
33  * Pavel Machek and Chris Cheney who worked on reverse engineering the
34  *    camera controls and wrote the first generation driver.
35  */
36
37 #include <linux/kernel.h>
38 #include <linux/module.h>
39 #include <linux/init.h>
40 #include <linux/videodev.h>
41 #include <linux/usb.h>
42 #include <linux/vmalloc.h>
43 #include <linux/slab.h>
44 #include <linux/proc_fs.h>
45 #include "usbvideo.h"
46
47 // #define VICAM_DEBUG
48
49 #ifdef VICAM_DEBUG
50 #define ADBG(lineno,fmt,args...) printk(fmt, jiffies, __FUNCTION__, lineno, ##args)
51 #define DBG(fmt,args...) ADBG((__LINE__),KERN_DEBUG __FILE__"(%ld):%s (%d):"fmt,##args)
52 #else
53 #define DBG(fmn,args...) do {} while(0)
54 #endif
55
56 #define DRIVER_AUTHOR           "Joe Burks, jburks@wavicle.org"
57 #define DRIVER_DESC             "ViCam WebCam Driver"
58
59 /* Define these values to match your device */
60 #define USB_VICAM_VENDOR_ID     0x04c1
61 #define USB_VICAM_PRODUCT_ID    0x009d
62
63 #define VICAM_BYTES_PER_PIXEL   3
64 #define VICAM_MAX_READ_SIZE     (512*242+128)
65 #define VICAM_MAX_FRAME_SIZE    (VICAM_BYTES_PER_PIXEL*320*240)
66 #define VICAM_FRAMES            2
67
68 #define VICAM_HEADER_SIZE       64
69
70 #define clamp( x, l, h )        max_t( __typeof__( x ),         \
71                                        ( l ),                   \
72                                        min_t( __typeof__( x ),  \
73                                               ( h ),            \
74                                               ( x ) ) )
75
76 /* Not sure what all the bytes in these char
77  * arrays do, but they're necessary to make
78  * the camera work.
79  */
80
81 static unsigned char setup1[] = {
82         0xB6, 0xC3, 0x1F, 0x00, 0x02, 0x64, 0xE7, 0x67,
83         0xFD, 0xFF, 0x0E, 0xC0, 0xE7, 0x09, 0xDE, 0x00,
84         0x8E, 0x00, 0xC0, 0x09, 0x40, 0x03, 0xC0, 0x17,
85         0x44, 0x03, 0x4B, 0xAF, 0xC0, 0x07, 0x00, 0x00,
86         0x4B, 0xAF, 0x97, 0xCF, 0x00, 0x00
87 };
88
89 static unsigned char setup2[] = {
90         0xB6, 0xC3, 0x03, 0x00, 0x03, 0x64, 0x18, 0x00,
91         0x00, 0x00
92 };
93
94 static unsigned char setup3[] = {
95         0xB6, 0xC3, 0x01, 0x00, 0x06, 0x64, 0x00, 0x00
96 };
97
98 static unsigned char setup4[] = {
99         0xB6, 0xC3, 0x8F, 0x06, 0x02, 0x64, 0xE7, 0x07,
100         0x00, 0x00, 0x08, 0xC0, 0xE7, 0x07, 0x00, 0x00,
101         0x3E, 0xC0, 0xE7, 0x07, 0x54, 0x01, 0xAA, 0x00,
102         0xE7, 0x07, 0xC8, 0x05, 0xB6, 0x00, 0xE7, 0x07,
103         0x42, 0x01, 0xD2, 0x00, 0xE7, 0x07, 0x7C, 0x00,
104         0x16, 0x00, 0xE7, 0x07, 0x56, 0x00, 0x18, 0x00,
105         0xE7, 0x07, 0x06, 0x00, 0x92, 0xC0, 0xE7, 0x07,
106         0x00, 0x00, 0x1E, 0xC0, 0xE7, 0x07, 0xFF, 0xFF,
107         0x22, 0xC0, 0xE7, 0x07, 0x04, 0x00, 0x24, 0xC0,
108         0xE7, 0x07, 0xEC, 0x27, 0x28, 0xC0, 0xE7, 0x07,
109         0x16, 0x01, 0x8E, 0x00, 0xE7, 0x87, 0x01, 0x00,
110         0x0E, 0xC0, 0x97, 0xCF, 0xD7, 0x09, 0x00, 0xC0,
111         0xE7, 0x77, 0x01, 0x00, 0x92, 0xC0, 0x09, 0xC1,
112         0xE7, 0x09, 0xFE, 0x05, 0x24, 0x01, 0xE7, 0x09,
113         0x04, 0x06, 0x26, 0x01, 0xE7, 0x07, 0x07, 0x00,
114         0x92, 0xC0, 0xE7, 0x05, 0x00, 0xC0, 0xC0, 0xDF,
115         0x97, 0xCF, 0x17, 0x00, 0x57, 0x00, 0x17, 0x02,
116         0xD7, 0x09, 0x00, 0xC0, 0xE7, 0x77, 0x01, 0x00,
117         0x92, 0xC0, 0x0A, 0xC1, 0xE7, 0x57, 0xFF, 0xFF,
118         0xFA, 0x05, 0x0D, 0xC0, 0xE7, 0x57, 0x00, 0x00,
119         0xFA, 0x05, 0x0F, 0xC0, 0x9F, 0xAF, 0xC6, 0x00,
120         0xE7, 0x05, 0x00, 0xC0, 0xC8, 0x05, 0xC1, 0x05,
121         0xC0, 0x05, 0xC0, 0xDF, 0x97, 0xCF, 0x27, 0xDA,
122         0xFA, 0x05, 0xEF, 0x07, 0x01, 0x00, 0x0B, 0x06,
123         0x73, 0xCF, 0x9F, 0xAF, 0x78, 0x01, 0x9F, 0xAF,
124         0x1A, 0x03, 0x6E, 0xCF, 0xE7, 0x09, 0xFC, 0x05,
125         0x24, 0x01, 0xE7, 0x09, 0x02, 0x06, 0x26, 0x01,
126         0xE7, 0x07, 0x07, 0x00, 0x92, 0xC0, 0xE7, 0x09,
127         0xFC, 0x05, 0xFE, 0x05, 0xE7, 0x09, 0x02, 0x06,
128         0x04, 0x06, 0xE7, 0x09, 0x00, 0x06, 0xFC, 0x05,
129         0xE7, 0x09, 0xFE, 0x05, 0x00, 0x06, 0x27, 0xDA,
130         0xFA, 0x05, 0xE7, 0x57, 0x01, 0x00, 0xFA, 0x05,
131         0x02, 0xCA, 0x04, 0xC0, 0x97, 0xCF, 0x9F, 0xAF,
132         0x66, 0x05, 0x97, 0xCF, 0xE7, 0x07, 0x40, 0x00,
133         0x02, 0x06, 0xC8, 0x09, 0xFC, 0x05, 0x9F, 0xAF,
134         0xDA, 0x02, 0x97, 0xCF, 0xCF, 0x17, 0x02, 0x00,
135         0xEF, 0x57, 0x81, 0x00, 0x09, 0x06, 0x9F, 0xA0,
136         0xB6, 0x01, 0xEF, 0x57, 0x80, 0x00, 0x09, 0x06,
137         0x9F, 0xA0, 0x40, 0x02, 0xEF, 0x57, 0x01, 0x00,
138         0x0B, 0x06, 0x9F, 0xA0, 0x46, 0x03, 0xE7, 0x07,
139         0x01, 0x00, 0x0A, 0xC0, 0x46, 0xAF, 0x47, 0xAF,
140         0x9F, 0xAF, 0x40, 0x02, 0xE7, 0x07, 0x2E, 0x00,
141         0x0A, 0xC0, 0xEF, 0x87, 0x80, 0x00, 0x09, 0x06,
142         0x97, 0xCF, 0x00, 0x0E, 0x01, 0x00, 0xC0, 0x57,
143         0x51, 0x00, 0x9F, 0xC0, 0x9E, 0x02, 0xC0, 0x57,
144         0x50, 0x00, 0x20, 0xC0, 0xC0, 0x57, 0x55, 0x00,
145         0x12, 0xC0, 0xC0, 0x57, 0x56, 0x00, 0x9F, 0xC0,
146         0x72, 0x02, 0x9F, 0xCF, 0xD6, 0x02, 0xC1, 0x0B,
147         0x08, 0x06, 0x01, 0xD0, 0x6F, 0x90, 0x08, 0x06,
148         0xC0, 0x07, 0x08, 0x00, 0xC1, 0x0B, 0x08, 0x06,
149         0x9F, 0xAF, 0x28, 0x05, 0x97, 0xCF, 0x2F, 0x0E,
150         0x02, 0x00, 0x08, 0x06, 0xC0, 0x07, 0x08, 0x00,
151         0xC1, 0x0B, 0x08, 0x06, 0x9F, 0xAF, 0x28, 0x05,
152         0x9F, 0xCF, 0xD6, 0x02, 0x2F, 0x0E, 0x02, 0x00,
153         0x09, 0x06, 0xEF, 0x87, 0x80, 0x00, 0x09, 0x06,
154         0x9F, 0xCF, 0xD6, 0x02, 0xEF, 0x67, 0x7F, 0xFF,
155         0x09, 0x06, 0xE7, 0x67, 0xFF, 0xFD, 0x22, 0xC0,
156         0xE7, 0x67, 0xEF, 0xFF, 0x24, 0xC0, 0xE7, 0x87,
157         0x10, 0x00, 0x28, 0xC0, 0x9F, 0xAF, 0xB8, 0x05,
158         0xE7, 0x87, 0xE0, 0x21, 0x24, 0xC0, 0x9F, 0xAF,
159         0xA8, 0x05, 0xE7, 0x87, 0x08, 0x00, 0x24, 0xC0,
160         0xE7, 0x67, 0xDF, 0xFF, 0x24, 0xC0, 0xC8, 0x07,
161         0x0A, 0x00, 0xC0, 0x07, 0x00, 0x00, 0xC1, 0x07,
162         0x01, 0x00, 0x9F, 0xAF, 0x28, 0x05, 0x9F, 0xAF,
163         0xB8, 0x05, 0xC0, 0x07, 0x9E, 0x00, 0x9F, 0xAF,
164         0x44, 0x05, 0xE7, 0x67, 0xFF, 0xFE, 0x24, 0xC0,
165         0xC0, 0x09, 0x20, 0xC0, 0xE7, 0x87, 0x00, 0x01,
166         0x24, 0xC0, 0xC0, 0x77, 0x00, 0x02, 0x0F, 0xC1,
167         0xE7, 0x67, 0xF7, 0xFF, 0x24, 0xC0, 0xE7, 0x67,
168         0xF7, 0xFF, 0x24, 0xC0, 0xE7, 0x87, 0x08, 0x00,
169         0x24, 0xC0, 0x08, 0xDA, 0x5E, 0xC1, 0xEF, 0x07,
170         0x80, 0x00, 0x09, 0x06, 0x97, 0xCF, 0xEF, 0x07,
171         0x01, 0x00, 0x0A, 0x06, 0x97, 0xCF, 0xEF, 0x07,
172         0x00, 0x00, 0x0B, 0x06, 0xEF, 0x07, 0x00, 0x00,
173         0x0A, 0x06, 0xEF, 0x67, 0x7F, 0xFF, 0x09, 0x06,
174         0xEF, 0x07, 0x00, 0x00, 0x0D, 0x06, 0xE7, 0x67,
175         0xEF, 0xFF, 0x28, 0xC0, 0xE7, 0x67, 0x17, 0xD8,
176         0x24, 0xC0, 0xE7, 0x07, 0x00, 0x00, 0x1E, 0xC0,
177         0xE7, 0x07, 0xFF, 0xFF, 0x22, 0xC0, 0x97, 0xCF,
178         0xC8, 0x07, 0x0E, 0x06, 0x9F, 0xAF, 0xDA, 0x02,
179         0xE7, 0x07, 0x00, 0x00, 0xF2, 0x05, 0xE7, 0x07,
180         0x10, 0x00, 0xF6, 0x05, 0xE7, 0x07, 0x0E, 0x06,
181         0xF4, 0x05, 0xE7, 0x07, 0xD6, 0x02, 0xF8, 0x05,
182         0xC8, 0x07, 0xF2, 0x05, 0xC1, 0x07, 0x00, 0x80,
183         0x50, 0xAF, 0x97, 0xCF, 0x2F, 0x0C, 0x02, 0x00,
184         0x07, 0x06, 0x2F, 0x0C, 0x04, 0x00, 0x06, 0x06,
185         0xE7, 0x07, 0x00, 0x00, 0xF2, 0x05, 0xE7, 0x07,
186         0x10, 0x00, 0xF6, 0x05, 0xE7, 0x07, 0xE2, 0x05,
187         0xF4, 0x05, 0xE7, 0x07, 0xCE, 0x02, 0xF8, 0x05,
188         0xC8, 0x07, 0xF2, 0x05, 0xC1, 0x07, 0x00, 0x80,
189         0x51, 0xAF, 0x97, 0xCF, 0x9F, 0xAF, 0x66, 0x04,
190         0x9F, 0xAF, 0x1A, 0x03, 0x59, 0xAF, 0x97, 0xCF,
191         0xC0, 0x07, 0x0E, 0x00, 0xC1, 0x0B, 0x0C, 0x06,
192         0x41, 0xD1, 0x9F, 0xAF, 0x28, 0x05, 0xC0, 0x07,
193         0x3C, 0x00, 0x9F, 0xAF, 0x44, 0x05, 0x68, 0x00,
194         0xC0, 0x07, 0x3B, 0x00, 0x9F, 0xAF, 0x44, 0x05,
195         0x6F, 0x00, 0x0C, 0x06, 0x68, 0x00, 0xE0, 0x07,
196         0x04, 0x01, 0xE8, 0x0B, 0x0A, 0x06, 0xE8, 0x07,
197         0x00, 0x00, 0xE0, 0x07, 0x00, 0x02, 0xE0, 0x07,
198         0xEC, 0x01, 0xE0, 0x07, 0xFC, 0xFF, 0x97, 0xCF,
199         0xE7, 0x07, 0xFF, 0xFF, 0xFA, 0x05, 0xEF, 0x07,
200         0x00, 0x00, 0x0B, 0x06, 0xE7, 0x07, 0x0E, 0x06,
201         0x24, 0x01, 0xE7, 0x07, 0x0E, 0x06, 0xFE, 0x05,
202         0xE7, 0x07, 0x40, 0x00, 0x26, 0x01, 0xE7, 0x07,
203         0x40, 0x00, 0x04, 0x06, 0xE7, 0x07, 0x07, 0x00,
204         0x92, 0xC0, 0x97, 0xCF, 0xEF, 0x07, 0x02, 0x00,
205         0x0B, 0x06, 0x9F, 0xAF, 0x78, 0x01, 0xEF, 0x77,
206         0x80, 0x00, 0x07, 0x06, 0x9F, 0xC0, 0x14, 0x04,
207         0xEF, 0x77, 0x01, 0x00, 0x07, 0x06, 0x37, 0xC0,
208         0xEF, 0x77, 0x01, 0x00, 0x0D, 0x06, 0x0F, 0xC1,
209         0xEF, 0x07, 0x01, 0x00, 0x0D, 0x06, 0xC0, 0x07,
210         0x02, 0x00, 0xC1, 0x07, 0x30, 0x00, 0x9F, 0xAF,
211         0x28, 0x05, 0xC0, 0x07, 0x01, 0x00, 0xC1, 0x07,
212         0x02, 0x00, 0x9F, 0xAF, 0x28, 0x05, 0xC8, 0x07,
213         0xFF, 0x4F, 0x9F, 0xAF, 0xA8, 0x05, 0xC0, 0x07,
214         0x38, 0x00, 0x9F, 0xAF, 0x44, 0x05, 0xC1, 0x77,
215         0x03, 0x00, 0x02, 0xC1, 0x08, 0xDA, 0x75, 0xC1,
216         0xC1, 0x77, 0x01, 0x00, 0x0A, 0xC1, 0xC0, 0x07,
217         0x01, 0x00, 0xC1, 0x07, 0x02, 0x00, 0x9F, 0xAF,
218         0x28, 0x05, 0xEF, 0x07, 0x01, 0x00, 0x06, 0x06,
219         0x2C, 0xCF, 0xC0, 0x07, 0x01, 0x00, 0xC1, 0x07,
220         0x04, 0x00, 0x9F, 0xAF, 0x28, 0x05, 0xEF, 0x07,
221         0x00, 0x00, 0x06, 0x06, 0x22, 0xCF, 0xEF, 0x07,
222         0x00, 0x00, 0x0D, 0x06, 0xEF, 0x57, 0x01, 0x00,
223         0x06, 0x06, 0x1B, 0xC0, 0xC0, 0x07, 0x01, 0x00,
224         0xC1, 0x07, 0x01, 0x00, 0x9F, 0xAF, 0x28, 0x05,
225         0xC0, 0x07, 0x02, 0x00, 0xC1, 0x07, 0x30, 0x00,
226         0x9F, 0xAF, 0x28, 0x05, 0xC8, 0x07, 0xFF, 0x4F,
227         0x9F, 0xAF, 0xA8, 0x05, 0xC0, 0x07, 0x38, 0x00,
228         0x9F, 0xAF, 0x44, 0x05, 0xC1, 0x67, 0x03, 0x00,
229         0xC1, 0x57, 0x03, 0x00, 0x02, 0xC0, 0x08, 0xDA,
230         0x73, 0xC1, 0xC0, 0x07, 0x02, 0x00, 0xC1, 0x07,
231         0x12, 0x00, 0xEF, 0x57, 0x00, 0x00, 0x06, 0x06,
232         0x02, 0xC0, 0xC1, 0x07, 0x23, 0x00, 0x9F, 0xAF,
233         0x28, 0x05, 0xC0, 0x07, 0x14, 0x00, 0xC1, 0x0B,
234         0xEA, 0x05, 0x9F, 0xAF, 0x28, 0x05, 0xC0, 0x07,
235         0x3E, 0x00, 0x9F, 0xAF, 0x0A, 0x05, 0xE7, 0x09,
236         0xE4, 0x05, 0xFA, 0x05, 0x27, 0xD8, 0xFA, 0x05,
237         0xE7, 0x07, 0x0E, 0x06, 0xFC, 0x05, 0xE7, 0x07,
238         0x4E, 0x06, 0x00, 0x06, 0xE7, 0x07, 0x40, 0x00,
239         0x02, 0x06, 0x9F, 0xAF, 0x66, 0x05, 0x9F, 0xAF,
240         0xC6, 0x00, 0x97, 0xCF, 0xC1, 0x0B, 0xE2, 0x05,
241         0x41, 0xD0, 0x01, 0xD2, 0xC1, 0x17, 0x23, 0x00,
242         0x9F, 0xAF, 0xDC, 0x04, 0xC0, 0x07, 0x04, 0x00,
243         0xC1, 0x0B, 0xE3, 0x05, 0x9F, 0xAF, 0x28, 0x05,
244         0xC0, 0x07, 0x06, 0x00, 0xC1, 0x09, 0xE6, 0x05,
245         0x9F, 0xAF, 0x28, 0x05, 0xC0, 0x07, 0x07, 0x00,
246         0xC1, 0x09, 0xE6, 0x05, 0xC1, 0xD1, 0x9F, 0xAF,
247         0x28, 0x05, 0xC0, 0x07, 0x0B, 0x00, 0xC1, 0x09,
248         0xE8, 0x05, 0x9F, 0xAF, 0x28, 0x05, 0xC0, 0x07,
249         0x0C, 0x00, 0xC1, 0x09, 0xE8, 0x05, 0xC1, 0xD1,
250         0x9F, 0xAF, 0x28, 0x05, 0xC0, 0x07, 0x0D, 0x00,
251         0xC1, 0x07, 0x09, 0x00, 0x9F, 0xAF, 0x28, 0x05,
252         0xC0, 0x07, 0x03, 0x00, 0xC1, 0x07, 0x32, 0x00,
253         0x9F, 0xAF, 0x28, 0x05, 0xC0, 0x07, 0x0F, 0x00,
254         0xC1, 0x07, 0x00, 0x00, 0x9F, 0xAF, 0x28, 0x05,
255         0x97, 0xCF, 0xE7, 0x67, 0xFF, 0xD9, 0x24, 0xC0,
256         0xC8, 0x07, 0x0A, 0x00, 0x40, 0x00, 0xC0, 0x67,
257         0x00, 0x02, 0x27, 0x80, 0x24, 0xC0, 0xE7, 0x87,
258         0x00, 0x04, 0x24, 0xC0, 0xE7, 0x67, 0xFF, 0xF9,
259         0x24, 0xC0, 0x01, 0xD2, 0x08, 0xDA, 0x72, 0xC1,
260         0xE7, 0x87, 0x00, 0x20, 0x24, 0xC0, 0x97, 0xCF,
261         0x27, 0x00, 0x1E, 0xC0, 0xE7, 0x87, 0xFF, 0x00,
262         0x22, 0xC0, 0xE7, 0x67, 0x7F, 0xFF, 0x24, 0xC0,
263         0xE7, 0x87, 0x80, 0x00, 0x24, 0xC0, 0xE7, 0x87,
264         0x80, 0x00, 0x24, 0xC0, 0x97, 0xCF, 0x9F, 0xAF,
265         0x0A, 0x05, 0x67, 0x00, 0x1E, 0xC0, 0xE7, 0x67,
266         0xBF, 0xFF, 0x24, 0xC0, 0xE7, 0x87, 0x40, 0x00,
267         0x24, 0xC0, 0xE7, 0x87, 0x40, 0x00, 0x24, 0xC0,
268         0x97, 0xCF, 0x9F, 0xAF, 0x0A, 0x05, 0xE7, 0x67,
269         0x00, 0xFF, 0x22, 0xC0, 0xE7, 0x67, 0xFF, 0xFE,
270         0x24, 0xC0, 0xE7, 0x67, 0xFF, 0xFE, 0x24, 0xC0,
271         0xC1, 0x09, 0x20, 0xC0, 0xE7, 0x87, 0x00, 0x01,
272         0x24, 0xC0, 0x97, 0xCF, 0xC0, 0x07, 0x40, 0x00,
273         0xC8, 0x09, 0xFC, 0x05, 0xE7, 0x67, 0x00, 0xFF,
274         0x22, 0xC0, 0xE7, 0x67, 0xFF, 0xFE, 0x24, 0xC0,
275         0xE7, 0x67, 0xBF, 0xFF, 0x24, 0xC0, 0xE7, 0x67,
276         0xBF, 0xFF, 0x24, 0xC0, 0x00, 0xDA, 0xE8, 0x09,
277         0x20, 0xC0, 0xE7, 0x87, 0x40, 0x00, 0x24, 0xC0,
278         0xE7, 0x87, 0x40, 0x00, 0x24, 0xC0, 0x00, 0xDA,
279         0xE8, 0x09, 0x20, 0xC0, 0x6D, 0xC1, 0xE7, 0x87,
280         0x00, 0x01, 0x24, 0xC0, 0x97, 0xCF, 0xE7, 0x07,
281         0x32, 0x00, 0x12, 0xC0, 0xE7, 0x77, 0x00, 0x80,
282         0x12, 0xC0, 0x7C, 0xC0, 0x97, 0xCF, 0xE7, 0x07,
283         0x20, 0x4E, 0x12, 0xC0, 0xE7, 0x77, 0x00, 0x80,
284         0x12, 0xC0, 0x7C, 0xC0, 0x97, 0xCF, 0x09, 0x02,
285         0x19, 0x00, 0x01, 0x01, 0x00, 0x80, 0x96, 0x09,
286         0x04, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00,
287         0x07, 0x05, 0x81, 0x02, 0x40, 0x00, 0x00, 0x00,
288         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
289         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
290         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
291         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
292         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
293         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
294         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
295         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
296         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
297         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
298         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
299         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
300         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
301         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
302         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
303         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
304         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
305         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
306         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
307         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
308         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
309         0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
310 };
311
312 static unsigned char setup5[] = {
313         0xB6, 0xC3, 0x2F, 0x01, 0x03, 0x64, 0x0E, 0x00,
314         0x14, 0x00, 0x1A, 0x00, 0x20, 0x00, 0x26, 0x00,
315         0x4A, 0x00, 0x64, 0x00, 0x6A, 0x00, 0x92, 0x00,
316         0x9A, 0x00, 0xA0, 0x00, 0xB2, 0x00, 0xB8, 0x00,
317         0xBE, 0x00, 0xC2, 0x00, 0xC8, 0x00, 0xCE, 0x00,
318         0xDC, 0x00, 0xDA, 0x00, 0xE2, 0x00, 0xE0, 0x00,
319         0xE8, 0x00, 0xE6, 0x00, 0xEE, 0x00, 0xEC, 0x00,
320         0xF2, 0x00, 0xF8, 0x00, 0x02, 0x01, 0x0A, 0x01,
321         0x0E, 0x01, 0x12, 0x01, 0x1E, 0x01, 0x22, 0x01,
322         0x28, 0x01, 0x2C, 0x01, 0x32, 0x01, 0x36, 0x01,
323         0x44, 0x01, 0x50, 0x01, 0x5E, 0x01, 0x72, 0x01,
324         0x76, 0x01, 0x7A, 0x01, 0x80, 0x01, 0x88, 0x01,
325         0x8C, 0x01, 0x94, 0x01, 0x9C, 0x01, 0xA0, 0x01,
326         0xA4, 0x01, 0xAA, 0x01, 0xB0, 0x01, 0xB4, 0x01,
327         0xBA, 0x01, 0xD0, 0x01, 0xDA, 0x01, 0xF6, 0x01,
328         0xFA, 0x01, 0x02, 0x02, 0x34, 0x02, 0x3C, 0x02,
329         0x44, 0x02, 0x4A, 0x02, 0x50, 0x02, 0x56, 0x02,
330         0x74, 0x02, 0x78, 0x02, 0x7E, 0x02, 0x84, 0x02,
331         0x8A, 0x02, 0x88, 0x02, 0x90, 0x02, 0x8E, 0x02,
332         0x94, 0x02, 0xA2, 0x02, 0xA8, 0x02, 0xAE, 0x02,
333         0xB4, 0x02, 0xBA, 0x02, 0xB8, 0x02, 0xC0, 0x02,
334         0xBE, 0x02, 0xC4, 0x02, 0xD0, 0x02, 0xD4, 0x02,
335         0xE0, 0x02, 0xE6, 0x02, 0xEE, 0x02, 0xF8, 0x02,
336         0xFC, 0x02, 0x06, 0x03, 0x1E, 0x03, 0x24, 0x03,
337         0x28, 0x03, 0x30, 0x03, 0x2E, 0x03, 0x3C, 0x03,
338         0x4A, 0x03, 0x4E, 0x03, 0x54, 0x03, 0x58, 0x03,
339         0x5E, 0x03, 0x66, 0x03, 0x6E, 0x03, 0x7A, 0x03,
340         0x86, 0x03, 0x8E, 0x03, 0x96, 0x03, 0xB2, 0x03,
341         0xB8, 0x03, 0xC6, 0x03, 0xCC, 0x03, 0xD4, 0x03,
342         0xDA, 0x03, 0xE8, 0x03, 0xF4, 0x03, 0xFC, 0x03,
343         0x04, 0x04, 0x20, 0x04, 0x2A, 0x04, 0x32, 0x04,
344         0x36, 0x04, 0x3E, 0x04, 0x44, 0x04, 0x42, 0x04,
345         0x48, 0x04, 0x4E, 0x04, 0x4C, 0x04, 0x54, 0x04,
346         0x52, 0x04, 0x5A, 0x04, 0x5E, 0x04, 0x62, 0x04,
347         0x68, 0x04, 0x74, 0x04, 0x7C, 0x04, 0x80, 0x04,
348         0x88, 0x04, 0x8C, 0x04, 0x94, 0x04, 0x9A, 0x04,
349         0xA2, 0x04, 0xA6, 0x04, 0xAE, 0x04, 0xB4, 0x04,
350         0xC0, 0x04, 0xCC, 0x04, 0xD8, 0x04, 0x2A, 0x05,
351         0x46, 0x05, 0x6C, 0x05, 0x00, 0x00
352 };
353
354 /* rvmalloc / rvfree copied from usbvideo.c
355  *
356  * Not sure why these are not yet non-statics which I can reference through
357  * usbvideo.h the same as it is in 2.4.20.  I bet this will get fixed sometime
358  * in the future.
359  * 
360 */
361 static void *rvmalloc(unsigned long size)
362 {
363         void *mem;
364         unsigned long adr;
365
366         size = PAGE_ALIGN(size);
367         mem = vmalloc_32(size);
368         if (!mem)
369                 return NULL;
370
371         memset(mem, 0, size); /* Clear the ram out, no junk to the user */
372         adr = (unsigned long) mem;
373         while (size > 0) {
374                 SetPageReserved(vmalloc_to_page((void *)adr));
375                 adr += PAGE_SIZE;
376                 size -= PAGE_SIZE;
377         }
378
379         return mem;
380 }
381
382 static void rvfree(void *mem, unsigned long size)
383 {
384         unsigned long adr;
385
386         if (!mem)
387                 return;
388
389         adr = (unsigned long) mem;
390         while ((long) size > 0) {
391                 ClearPageReserved(vmalloc_to_page((void *)adr));
392                 adr += PAGE_SIZE;
393                 size -= PAGE_SIZE;
394         }
395         vfree(mem);
396 }
397
398 struct vicam_camera {
399         u16 shutter_speed;      // capture shutter speed
400         u16 gain;               // capture gain
401
402         u8 *raw_image;          // raw data captured from the camera
403         u8 *framebuf;           // processed data in RGB24 format
404         u8 *cntrlbuf;           // area used to send control msgs
405
406         struct video_device vdev;       // v4l video device
407         struct usb_device *udev;        // usb device
408
409         /* guard against simultaneous accesses to the camera */
410         struct semaphore cam_lock;
411
412         int is_initialized;
413         u8 open_count;
414         u8 bulkEndpoint;
415         int needsDummyRead;
416
417 #if defined(CONFIG_VIDEO_PROC_FS)
418         struct proc_dir_entry *proc_dir;
419 #endif
420
421 };
422
423 static int vicam_probe( struct usb_interface *intf, const struct usb_device_id *id);
424 static void vicam_disconnect(struct usb_interface *intf);
425 static void read_frame(struct vicam_camera *cam, int framenum);
426 static void vicam_decode_color(const u8 *, u8 *);
427
428 static int __send_control_msg(struct vicam_camera *cam,
429                               u8 request,
430                               u16 value,
431                               u16 index,
432                               unsigned char *cp,
433                               u16 size)
434 {
435         int status;
436
437         /* cp must be memory that has been allocated by kmalloc */
438
439         status = usb_control_msg(cam->udev,
440                                  usb_sndctrlpipe(cam->udev, 0),
441                                  request,
442                                  USB_DIR_OUT | USB_TYPE_VENDOR |
443                                  USB_RECIP_DEVICE, value, index,
444                                  cp, size, 1000);
445
446         status = min(status, 0);
447
448         if (status < 0) {
449                 printk(KERN_INFO "Failed sending control message, error %d.\n",
450                        status);
451         }
452
453         return status;
454 }
455
456 static int send_control_msg(struct vicam_camera *cam,
457                             u8 request,
458                             u16 value,
459                             u16 index,
460                             unsigned char *cp,
461                             u16 size)
462 {
463         int status = -ENODEV;
464         down(&cam->cam_lock);
465         if (cam->udev) {
466                 status = __send_control_msg(cam, request, value,
467                                             index, cp, size);
468         }
469         up(&cam->cam_lock);
470         return status;
471 }
472 static int
473 initialize_camera(struct vicam_camera *cam)
474 {
475         const struct {
476                 u8 *data;
477                 u32 size;
478         } firmware[] = {
479                 { .data = setup1, .size = sizeof(setup1) },
480                 { .data = setup2, .size = sizeof(setup2) },
481                 { .data = setup3, .size = sizeof(setup3) },
482                 { .data = setup4, .size = sizeof(setup4) },
483                 { .data = setup5, .size = sizeof(setup5) },
484                 { .data = setup3, .size = sizeof(setup3) },
485                 { .data = NULL, .size = 0 }
486         };
487
488         int err, i;
489
490         for (i = 0, err = 0; firmware[i].data && !err; i++) {
491                 memcpy(cam->cntrlbuf, firmware[i].data, firmware[i].size);
492
493                 err = send_control_msg(cam, 0xff, 0, 0,
494                                        cam->cntrlbuf, firmware[i].size);
495         }
496
497         return err;
498 }
499
500 static int
501 set_camera_power(struct vicam_camera *cam, int state)
502 {
503         int status;
504
505         if ((status = send_control_msg(cam, 0x50, state, 0, NULL, 0)) < 0)
506                 return status;
507
508         if (state) {
509                 send_control_msg(cam, 0x55, 1, 0, NULL, 0);
510         }
511
512         return 0;
513 }
514
515 static int
516 vicam_ioctl(struct inode *inode, struct file *file, unsigned int ioctlnr, unsigned long arg)
517 {
518         void __user *user_arg = (void __user *)arg;
519         struct vicam_camera *cam = file->private_data;
520         int retval = 0;
521
522         if (!cam)
523                 return -ENODEV;
524
525         switch (ioctlnr) {
526                 /* query capabilities */
527         case VIDIOCGCAP:
528                 {
529                         struct video_capability b;
530
531                         DBG("VIDIOCGCAP\n");
532                         memset(&b, 0, sizeof(b));
533                         strcpy(b.name, "ViCam-based Camera");
534                         b.type = VID_TYPE_CAPTURE;
535                         b.channels = 1;
536                         b.audios = 0;
537                         b.maxwidth = 320;       /* VIDEOSIZE_CIF */
538                         b.maxheight = 240;
539                         b.minwidth = 320;       /* VIDEOSIZE_48_48 */
540                         b.minheight = 240;
541
542                         if (copy_to_user(user_arg, &b, sizeof(b)))
543                                 retval = -EFAULT;
544
545                         break;
546                 }
547                 /* get/set video source - we are a camera and nothing else */
548         case VIDIOCGCHAN:
549                 {
550                         struct video_channel v;
551
552                         DBG("VIDIOCGCHAN\n");
553                         if (copy_from_user(&v, user_arg, sizeof(v))) {
554                                 retval = -EFAULT;
555                                 break;
556                         }
557                         if (v.channel != 0) {
558                                 retval = -EINVAL;
559                                 break;
560                         }
561
562                         v.channel = 0;
563                         strcpy(v.name, "Camera");
564                         v.tuners = 0;
565                         v.flags = 0;
566                         v.type = VIDEO_TYPE_CAMERA;
567                         v.norm = 0;
568
569                         if (copy_to_user(user_arg, &v, sizeof(v)))
570                                 retval = -EFAULT;
571                         break;
572                 }
573
574         case VIDIOCSCHAN:
575                 {
576                         int v;
577
578                         if (copy_from_user(&v, user_arg, sizeof(v)))
579                                 retval = -EFAULT;
580                         DBG("VIDIOCSCHAN %d\n", v);
581
582                         if (retval == 0 && v != 0)
583                                 retval = -EINVAL;
584
585                         break;
586                 }
587
588                 /* image properties */
589         case VIDIOCGPICT:
590                 {
591                         struct video_picture vp;
592                         DBG("VIDIOCGPICT\n");
593                         memset(&vp, 0, sizeof (struct video_picture));
594                         vp.brightness = cam->gain << 8;
595                         vp.depth = 24;
596                         vp.palette = VIDEO_PALETTE_RGB24;
597                         if (copy_to_user(user_arg, &vp, sizeof (struct video_picture)))
598                                 retval = -EFAULT;
599                         break;
600                 }
601
602         case VIDIOCSPICT:
603                 {
604                         struct video_picture vp;
605                         
606                         if (copy_from_user(&vp, user_arg, sizeof(vp))) {
607                                 retval = -EFAULT;
608                                 break;
609                         }
610                         
611                         DBG("VIDIOCSPICT depth = %d, pal = %d\n", vp.depth,
612                             vp.palette);
613
614                         cam->gain = vp.brightness >> 8;
615
616                         if (vp.depth != 24
617                             || vp.palette != VIDEO_PALETTE_RGB24)
618                                 retval = -EINVAL;
619
620                         break;
621                 }
622
623                 /* get/set capture window */
624         case VIDIOCGWIN:
625                 {
626                         struct video_window vw;
627                         vw.x = 0;
628                         vw.y = 0;
629                         vw.width = 320;
630                         vw.height = 240;
631                         vw.chromakey = 0;
632                         vw.flags = 0;
633                         vw.clips = NULL;
634                         vw.clipcount = 0;
635
636                         DBG("VIDIOCGWIN\n");
637
638                         if (copy_to_user(user_arg, (void *)&vw, sizeof(vw)))
639                                 retval = -EFAULT;
640
641                         // I'm not sure what the deal with a capture window is, it is very poorly described
642                         // in the doc.  So I won't support it now.
643                         break;
644                 }
645
646         case VIDIOCSWIN:
647                 {
648
649                         struct video_window vw;
650
651                         if (copy_from_user(&vw, user_arg, sizeof(vw))) {
652                                 retval = -EFAULT;
653                                 break;
654                         }
655
656                         DBG("VIDIOCSWIN %d x %d\n", vw.width, vw.height);
657                         
658                         if ( vw.width != 320 || vw.height != 240 )
659                                 retval = -EFAULT;
660
661                         break;
662                 }
663
664                 /* mmap interface */
665         case VIDIOCGMBUF:
666                 {
667                         struct video_mbuf vm;
668                         int i;
669
670                         DBG("VIDIOCGMBUF\n");
671                         memset(&vm, 0, sizeof (vm));
672                         vm.size =
673                             VICAM_MAX_FRAME_SIZE * VICAM_FRAMES;
674                         vm.frames = VICAM_FRAMES;
675                         for (i = 0; i < VICAM_FRAMES; i++)
676                                 vm.offsets[i] = VICAM_MAX_FRAME_SIZE * i;
677
678                         if (copy_to_user(user_arg, (void *)&vm, sizeof(vm)))
679                                 retval = -EFAULT;
680
681                         break;
682                 }
683
684         case VIDIOCMCAPTURE:
685                 {
686                         struct video_mmap vm;
687                         // int video_size;
688
689                         if (copy_from_user((void *)&vm, user_arg, sizeof(vm))) {
690                                 retval = -EFAULT;
691                                 break;
692                         }
693
694                         DBG("VIDIOCMCAPTURE frame=%d, height=%d, width=%d, format=%d.\n",vm.frame,vm.width,vm.height,vm.format);
695
696                         if ( vm.frame >= VICAM_FRAMES || vm.format != VIDEO_PALETTE_RGB24 )
697                                 retval = -EINVAL;
698
699                         // in theory right here we'd start the image capturing
700                         // (fill in a bulk urb and submit it asynchronously)
701                         //
702                         // Instead we're going to do a total hack job for now and
703                         // retrieve the frame in VIDIOCSYNC
704
705                         break;
706                 }
707
708         case VIDIOCSYNC:
709                 {
710                         int frame;
711
712                         if (copy_from_user((void *)&frame, user_arg, sizeof(int))) {
713                                 retval = -EFAULT;
714                                 break;
715                         }
716                         DBG("VIDIOCSYNC: %d\n", frame);
717
718                         read_frame(cam, frame);
719                         vicam_decode_color(cam->raw_image,
720                                            cam->framebuf +
721                                            frame * VICAM_MAX_FRAME_SIZE );
722
723                         break;
724                 }
725
726                 /* pointless to implement overlay with this camera */
727         case VIDIOCCAPTURE:
728         case VIDIOCGFBUF:
729         case VIDIOCSFBUF:
730         case VIDIOCKEY:
731                 retval = -EINVAL;
732                 break;
733
734                 /* tuner interface - we have none */
735         case VIDIOCGTUNER:
736         case VIDIOCSTUNER:
737         case VIDIOCGFREQ:
738         case VIDIOCSFREQ:
739                 retval = -EINVAL;
740                 break;
741
742                 /* audio interface - we have none */
743         case VIDIOCGAUDIO:
744         case VIDIOCSAUDIO:
745                 retval = -EINVAL;
746                 break;
747         default:
748                 retval = -ENOIOCTLCMD;
749                 break;
750         }
751
752         return retval;
753 }
754
755 static int
756 vicam_open(struct inode *inode, struct file *file)
757 {
758         struct video_device *dev = video_devdata(file);
759         struct vicam_camera *cam =
760             (struct vicam_camera *) dev->priv;
761         DBG("open\n");
762
763         if (!cam) {
764                 printk(KERN_ERR
765                        "vicam video_device improperly initialized");
766         }
767
768         /* the videodev_lock held above us protects us from
769          * simultaneous opens...for now. we probably shouldn't
770          * rely on this fact forever.
771          */
772
773         if (cam->open_count > 0) {
774                 printk(KERN_INFO
775                        "vicam_open called on already opened camera");
776                 return -EBUSY;
777         }
778
779         cam->raw_image = kmalloc(VICAM_MAX_READ_SIZE, GFP_KERNEL);
780         if (!cam->raw_image) {
781                 return -ENOMEM;
782         }
783
784         cam->framebuf = rvmalloc(VICAM_MAX_FRAME_SIZE * VICAM_FRAMES);
785         if (!cam->framebuf) {
786                 kfree(cam->raw_image);
787                 return -ENOMEM;
788         }
789
790         cam->cntrlbuf = kmalloc(PAGE_SIZE, GFP_KERNEL);
791         if (!cam->cntrlbuf) {
792                 kfree(cam->raw_image);
793                 rvfree(cam->framebuf, VICAM_MAX_FRAME_SIZE * VICAM_FRAMES);
794                 return -ENOMEM;
795         }
796
797         // First upload firmware, then turn the camera on
798
799         if (!cam->is_initialized) {
800                 initialize_camera(cam);
801
802                 cam->is_initialized = 1;
803         }
804
805         set_camera_power(cam, 1);
806
807         cam->needsDummyRead = 1;
808         cam->open_count++;
809
810         file->private_data = cam;       
811         
812         return 0;
813 }
814
815 static int 
816 vicam_close(struct inode *inode, struct file *file)
817 {
818         struct vicam_camera *cam = file->private_data;
819         int open_count;
820         struct usb_device *udev;
821
822         DBG("close\n");
823
824         /* it's not the end of the world if
825          * we fail to turn the camera off.
826          */
827
828         set_camera_power(cam, 0);
829
830         kfree(cam->raw_image);
831         rvfree(cam->framebuf, VICAM_MAX_FRAME_SIZE * VICAM_FRAMES);
832         kfree(cam->cntrlbuf);
833
834         down(&cam->cam_lock);
835
836         cam->open_count--;
837         open_count = cam->open_count;
838         udev = cam->udev;
839
840         up(&cam->cam_lock);
841
842         if (!open_count && !udev) {
843                 kfree(cam);
844         }
845
846         return 0;
847 }
848
849 static void vicam_decode_color(const u8 *data, u8 *rgb)
850 {
851         /* vicam_decode_color - Convert from Vicam Y-Cr-Cb to RGB
852          * Copyright (C) 2002 Monroe Williams (monroe@pobox.com)
853          */
854
855         int i, prevY, nextY;
856
857         prevY = 512;
858         nextY = 512;
859
860         data += VICAM_HEADER_SIZE;
861
862         for( i = 0; i < 240; i++, data += 512 ) {
863                 const int y = ( i * 242 ) / 240;
864
865                 int j, prevX, nextX;
866                 int Y, Cr, Cb;
867
868                 if ( y == 242 - 1 ) {
869                         nextY = -512;
870                 }
871
872                 prevX = 1;
873                 nextX = 1;
874
875                 for ( j = 0; j < 320; j++, rgb += 3 ) {
876                         const int x = ( j * 512 ) / 320;
877                         const u8 * const src = &data[x];
878
879                         if ( x == 512 - 1 ) {
880                                 nextX = -1;
881                         }
882
883                         Cr = ( src[prevX] - src[0] ) +
884                                 ( src[nextX] - src[0] );
885                         Cr /= 2;
886
887                         Cb = ( src[prevY] - src[prevX + prevY] ) +
888                                 ( src[prevY] - src[nextX + prevY] ) +
889                                 ( src[nextY] - src[prevX + nextY] ) +
890                                 ( src[nextY] - src[nextX + nextY] );
891                         Cb /= 4;
892
893                         Y = 1160 * ( src[0] + ( Cr / 2 ) - 16 );
894
895                         if ( i & 1 ) {
896                                 int Ct = Cr;
897                                 Cr = Cb;
898                                 Cb = Ct;
899                         }
900
901                         if ( ( x ^ i ) & 1 ) {
902                                 Cr = -Cr;
903                                 Cb = -Cb;
904                         }
905
906                         rgb[0] = clamp( ( ( Y + ( 2017 * Cb ) ) +
907                                         500 ) / 900, 0, 255 );
908                         rgb[1] = clamp( ( ( Y - ( 392 * Cb ) -
909                                           ( 813 * Cr ) ) +
910                                           500 ) / 1000, 0, 255 );
911                         rgb[2] = clamp( ( ( Y + ( 1594 * Cr ) ) +
912                                         500 ) / 1300, 0, 255 );
913
914                         prevX = -1;
915                 }
916
917                 prevY = -512;
918         }
919 }
920
921 static void
922 read_frame(struct vicam_camera *cam, int framenum)
923 {
924         unsigned char *request = cam->cntrlbuf;
925         int realShutter;
926         int n;
927         int actual_length;
928
929         if (cam->needsDummyRead) {
930                 cam->needsDummyRead = 0;
931                 read_frame(cam, framenum);
932         }
933
934         memset(request, 0, 16);
935         request[0] = cam->gain; // 0 = 0% gain, FF = 100% gain
936
937         request[1] = 0; // 512x242 capture
938
939         request[2] = 0x90;      // the function of these two bytes
940         request[3] = 0x07;      // is not yet understood
941
942         if (cam->shutter_speed > 60) {
943                 // Short exposure
944                 realShutter =
945                     ((-15631900 / cam->shutter_speed) + 260533) / 1000;
946                 request[4] = realShutter & 0xFF;
947                 request[5] = (realShutter >> 8) & 0xFF;
948                 request[6] = 0x03;
949                 request[7] = 0x01;
950         } else {
951                 // Long exposure
952                 realShutter = 15600 / cam->shutter_speed - 1;
953                 request[4] = 0;
954                 request[5] = 0;
955                 request[6] = realShutter & 0xFF;
956                 request[7] = realShutter >> 8;
957         }
958
959         // Per John Markus Bjørndalen, byte at index 8 causes problems if it isn't 0
960         request[8] = 0;
961         // bytes 9-15 do not seem to affect exposure or image quality
962
963         down(&cam->cam_lock);
964
965         if (!cam->udev) {
966                 goto done;
967         }
968
969         n = __send_control_msg(cam, 0x51, 0x80, 0, request, 16);
970
971         if (n < 0) {
972                 printk(KERN_ERR
973                        " Problem sending frame capture control message");
974                 goto done;
975         }
976
977         n = usb_bulk_msg(cam->udev,
978                          usb_rcvbulkpipe(cam->udev, cam->bulkEndpoint),
979                          cam->raw_image,
980                          512 * 242 + 128, &actual_length, 10000);
981
982         if (n < 0) {
983                 printk(KERN_ERR "Problem during bulk read of frame data: %d\n",
984                        n);
985         }
986
987  done:
988         up(&cam->cam_lock);
989 }
990
991 static ssize_t
992 vicam_read( struct file *file, char __user *buf, size_t count, loff_t *ppos )
993 {
994         struct vicam_camera *cam = file->private_data;
995
996         DBG("read %d bytes.\n", (int) count);
997
998         if (*ppos >= VICAM_MAX_FRAME_SIZE) {
999                 *ppos = 0;
1000                 return 0;
1001         }
1002
1003         if (*ppos == 0) {
1004                 read_frame(cam, 0);
1005                 vicam_decode_color(cam->raw_image,
1006                                    cam->framebuf +
1007                                    0 * VICAM_MAX_FRAME_SIZE);
1008         }
1009
1010         count = min_t(size_t, count, VICAM_MAX_FRAME_SIZE - *ppos);
1011
1012         if (copy_to_user(buf, &cam->framebuf[*ppos], count)) {
1013                 count = -EFAULT;
1014         } else {
1015                 *ppos += count;
1016         }
1017
1018         if (count == VICAM_MAX_FRAME_SIZE) {
1019                 *ppos = 0;
1020         }
1021
1022         return count;
1023 }
1024
1025
1026 static int
1027 vicam_mmap(struct file *file, struct vm_area_struct *vma)
1028 {
1029         // TODO: allocate the raw frame buffer if necessary
1030         unsigned long page, pos;
1031         unsigned long start = vma->vm_start;
1032         unsigned long size  = vma->vm_end-vma->vm_start;
1033         struct vicam_camera *cam = file->private_data;
1034
1035         if (!cam)
1036                 return -ENODEV;
1037
1038         DBG("vicam_mmap: %ld\n", size);
1039
1040         /* We let mmap allocate as much as it wants because Linux was adding 2048 bytes
1041          * to the size the application requested for mmap and it was screwing apps up.
1042          if (size > VICAM_FRAMES*VICAM_MAX_FRAME_SIZE)
1043          return -EINVAL;
1044          */
1045
1046         pos = (unsigned long)cam->framebuf;
1047         while (size > 0) {
1048                 page = vmalloc_to_pfn((void *)pos);
1049                 if (remap_pfn_range(vma, start, page, PAGE_SIZE, PAGE_SHARED))
1050                         return -EAGAIN;
1051
1052                 start += PAGE_SIZE;
1053                 pos += PAGE_SIZE;
1054                 if (size > PAGE_SIZE)
1055                         size -= PAGE_SIZE;
1056                 else
1057                         size = 0;
1058         }
1059
1060         return 0;
1061 }
1062
1063 #if defined(CONFIG_VIDEO_PROC_FS)
1064
1065 static struct proc_dir_entry *vicam_proc_root = NULL;
1066
1067 static int vicam_read_helper(char *page, char **start, off_t off,
1068                                 int count, int *eof, int value)
1069 {
1070         char *out = page;
1071         int len;
1072
1073         out += sprintf(out, "%d",value);
1074
1075         len = out - page;
1076         len -= off;
1077         if (len < count) {
1078                 *eof = 1;
1079                 if (len <= 0)
1080                         return 0;
1081         } else
1082                 len = count;
1083
1084         *start = page + off;
1085         return len;
1086 }
1087
1088 static int vicam_read_proc_shutter(char *page, char **start, off_t off,
1089                                 int count, int *eof, void *data)
1090 {
1091         return vicam_read_helper(page,start,off,count,eof,
1092                                 ((struct vicam_camera *)data)->shutter_speed);
1093 }
1094
1095 static int vicam_read_proc_gain(char *page, char **start, off_t off,
1096                                 int count, int *eof, void *data)
1097 {
1098         return vicam_read_helper(page,start,off,count,eof,
1099                                 ((struct vicam_camera *)data)->gain);
1100 }
1101
1102 static int
1103 vicam_write_proc_shutter(struct file *file, const char *buffer,
1104                          unsigned long count, void *data)
1105 {
1106         u16 stmp;
1107         char kbuf[8];
1108         struct vicam_camera *cam = (struct vicam_camera *) data;
1109
1110         if (count > 6)
1111                 return -EINVAL;
1112
1113         if (copy_from_user(kbuf, buffer, count))
1114                 return -EFAULT;
1115
1116         stmp = (u16) simple_strtoul(kbuf, NULL, 10);
1117         if (stmp < 4 || stmp > 32000)
1118                 return -EINVAL;
1119
1120         cam->shutter_speed = stmp;
1121
1122         return count;
1123 }
1124
1125 static int
1126 vicam_write_proc_gain(struct file *file, const char *buffer,
1127                       unsigned long count, void *data)
1128 {
1129         u16 gtmp;
1130         char kbuf[8];
1131
1132         struct vicam_camera *cam = (struct vicam_camera *) data;
1133
1134         if (count > 4)
1135                 return -EINVAL;
1136
1137         if (copy_from_user(kbuf, buffer, count))
1138                 return -EFAULT;
1139
1140         gtmp = (u16) simple_strtoul(kbuf, NULL, 10);
1141         if (gtmp > 255)
1142                 return -EINVAL;
1143         cam->gain = gtmp;
1144
1145         return count;
1146 }
1147
1148 static void
1149 vicam_create_proc_root(void)
1150 {
1151         vicam_proc_root = create_proc_entry("video/vicam", S_IFDIR, 0);
1152
1153         if (vicam_proc_root)
1154                 vicam_proc_root->owner = THIS_MODULE;
1155         else
1156                 printk(KERN_ERR
1157                        "could not create /proc entry for vicam!");
1158 }
1159
1160 static void
1161 vicam_destroy_proc_root(void)
1162 {
1163         if (vicam_proc_root)
1164                 remove_proc_entry("video/vicam", 0);
1165 }
1166
1167 static void
1168 vicam_create_proc_entry(struct vicam_camera *cam)
1169 {
1170         char name[64];
1171         struct proc_dir_entry *ent;
1172
1173         DBG(KERN_INFO "vicam: creating proc entry\n");
1174
1175         if (!vicam_proc_root || !cam) {
1176                 printk(KERN_INFO
1177                        "vicam: could not create proc entry, %s pointer is null.\n",
1178                        (!cam ? "camera" : "root"));
1179                 return;
1180         }
1181
1182         sprintf(name, "video%d", cam->vdev.minor);
1183
1184         cam->proc_dir = create_proc_entry(name, S_IFDIR, vicam_proc_root);
1185
1186         if ( !cam->proc_dir )
1187                 return; // FIXME: We should probably return an error here
1188         
1189         ent = create_proc_entry("shutter", S_IFREG | S_IRUGO | S_IWUSR,
1190                                 cam->proc_dir);
1191         if (ent) {
1192                 ent->data = cam;
1193                 ent->read_proc = vicam_read_proc_shutter;
1194                 ent->write_proc = vicam_write_proc_shutter;
1195                 ent->size = 64;
1196         }
1197
1198         ent = create_proc_entry("gain", S_IFREG | S_IRUGO | S_IWUSR,
1199                                 cam->proc_dir);
1200         if (ent) {
1201                 ent->data = cam;
1202                 ent->read_proc = vicam_read_proc_gain;
1203                 ent->write_proc = vicam_write_proc_gain;
1204                 ent->size = 64;
1205         }
1206 }
1207
1208 static void
1209 vicam_destroy_proc_entry(void *ptr)
1210 {
1211         struct vicam_camera *cam = (struct vicam_camera *) ptr;
1212         char name[16];
1213
1214         if ( !cam->proc_dir )
1215                 return;
1216
1217         sprintf(name, "video%d", cam->vdev.minor);
1218         remove_proc_entry("shutter", cam->proc_dir);
1219         remove_proc_entry("gain", cam->proc_dir);
1220         remove_proc_entry(name,vicam_proc_root);
1221         cam->proc_dir = NULL;
1222
1223 }
1224
1225 #else
1226 static inline void vicam_create_proc_root(void) { }
1227 static inline void vicam_destroy_proc_root(void) { }
1228 static inline void vicam_create_proc_entry(struct vicam_camera *cam) { }
1229 static inline void vicam_destroy_proc_entry(void *ptr) { }
1230 #endif
1231
1232 static struct file_operations vicam_fops = {
1233         .owner          = THIS_MODULE,
1234         .open           = vicam_open,
1235         .release        = vicam_close,
1236         .read           = vicam_read,
1237         .mmap           = vicam_mmap,
1238         .ioctl          = vicam_ioctl,
1239         .llseek         = no_llseek,
1240 };
1241
1242 static struct video_device vicam_template = {
1243         .owner          = THIS_MODULE,
1244         .name           = "ViCam-based USB Camera",
1245         .type           = VID_TYPE_CAPTURE,
1246         .hardware       = VID_HARDWARE_VICAM,
1247         .fops           = &vicam_fops,
1248         .minor          = -1,
1249 };
1250
1251 /* table of devices that work with this driver */
1252 static struct usb_device_id vicam_table[] = {
1253         {USB_DEVICE(USB_VICAM_VENDOR_ID, USB_VICAM_PRODUCT_ID)},
1254         {}                      /* Terminating entry */
1255 };
1256
1257 MODULE_DEVICE_TABLE(usb, vicam_table);
1258
1259 static struct usb_driver vicam_driver = {
1260         .owner          = THIS_MODULE,
1261         .name           = "vicam",
1262         .probe          = vicam_probe,
1263         .disconnect     = vicam_disconnect,
1264         .id_table       = vicam_table
1265 };
1266
1267 /**
1268  *      vicam_probe
1269  *      @intf: the interface
1270  *      @id: the device id
1271  *
1272  *      Called by the usb core when a new device is connected that it thinks
1273  *      this driver might be interested in.
1274  */
1275 static int
1276 vicam_probe( struct usb_interface *intf, const struct usb_device_id *id)
1277 {
1278         struct usb_device *dev = interface_to_usbdev(intf);
1279         int bulkEndpoint = 0;
1280         const struct usb_host_interface *interface;
1281         const struct usb_endpoint_descriptor *endpoint;
1282         struct vicam_camera *cam;
1283         
1284         printk(KERN_INFO "ViCam based webcam connected\n");
1285
1286         interface = intf->cur_altsetting;
1287
1288         DBG(KERN_DEBUG "Interface %d. has %u. endpoints!\n",
1289                interface->desc.bInterfaceNumber, (unsigned) (interface->desc.bNumEndpoints));
1290         endpoint = &interface->endpoint[0].desc;
1291
1292         if ((endpoint->bEndpointAddress & 0x80) &&
1293             ((endpoint->bmAttributes & 3) == 0x02)) {
1294                 /* we found a bulk in endpoint */
1295                 bulkEndpoint = endpoint->bEndpointAddress;
1296         } else {
1297                 printk(KERN_ERR
1298                        "No bulk in endpoint was found ?! (this is bad)\n");
1299         }
1300
1301         if ((cam =
1302              kmalloc(sizeof (struct vicam_camera), GFP_KERNEL)) == NULL) {
1303                 printk(KERN_WARNING
1304                        "could not allocate kernel memory for vicam_camera struct\n");
1305                 return -ENOMEM;
1306         }
1307
1308         memset(cam, 0, sizeof (struct vicam_camera));
1309
1310         cam->shutter_speed = 15;
1311
1312         init_MUTEX(&cam->cam_lock);
1313
1314         memcpy(&cam->vdev, &vicam_template,
1315                sizeof (vicam_template));
1316         cam->vdev.priv = cam;   // sort of a reverse mapping for those functions that get vdev only
1317
1318         cam->udev = dev;
1319         cam->bulkEndpoint = bulkEndpoint;
1320
1321         if (video_register_device(&cam->vdev, VFL_TYPE_GRABBER, -1) == -1) {
1322                 kfree(cam);
1323                 printk(KERN_WARNING "video_register_device failed\n");
1324                 return -EIO;
1325         }
1326
1327         vicam_create_proc_entry(cam);
1328
1329         printk(KERN_INFO "ViCam webcam driver now controlling video device %d\n",cam->vdev.minor);
1330
1331         usb_set_intfdata (intf, cam);
1332         
1333         return 0;
1334 }
1335
1336 static void
1337 vicam_disconnect(struct usb_interface *intf)
1338 {
1339         int open_count;
1340         struct vicam_camera *cam = usb_get_intfdata (intf);
1341         usb_set_intfdata (intf, NULL);
1342
1343         /* we must unregister the device before taking its
1344          * cam_lock. This is because the video open call
1345          * holds the same lock as video unregister. if we
1346          * unregister inside of the cam_lock and open also
1347          * uses the cam_lock, we get deadlock.
1348          */
1349
1350         video_unregister_device(&cam->vdev);
1351
1352         /* stop the camera from being used */
1353
1354         down(&cam->cam_lock);
1355
1356         /* mark the camera as gone */
1357
1358         cam->udev = NULL;
1359
1360         vicam_destroy_proc_entry(cam);
1361
1362         /* the only thing left to do is synchronize with
1363          * our close/release function on who should release
1364          * the camera memory. if there are any users using the
1365          * camera, it's their job. if there are no users,
1366          * it's ours.
1367          */
1368
1369         open_count = cam->open_count;
1370
1371         up(&cam->cam_lock);
1372
1373         if (!open_count) {
1374                 kfree(cam);
1375         }
1376
1377         printk(KERN_DEBUG "ViCam-based WebCam disconnected\n");
1378 }
1379
1380 /*
1381  */
1382 static int __init
1383 usb_vicam_init(void)
1384 {
1385         int retval;
1386         DBG(KERN_INFO "ViCam-based WebCam driver startup\n");
1387         vicam_create_proc_root();
1388         retval = usb_register(&vicam_driver);
1389         if (retval)
1390                 printk(KERN_WARNING "usb_register failed!\n");
1391         return retval;
1392 }
1393
1394 static void __exit
1395 usb_vicam_exit(void)
1396 {
1397         DBG(KERN_INFO
1398                "ViCam-based WebCam driver shutdown\n");
1399
1400         usb_deregister(&vicam_driver);
1401         vicam_destroy_proc_root();
1402 }
1403
1404 module_init(usb_vicam_init);
1405 module_exit(usb_vicam_exit);
1406
1407 MODULE_AUTHOR(DRIVER_AUTHOR);
1408 MODULE_DESCRIPTION(DRIVER_DESC);
1409 MODULE_LICENSE("GPL");