diff options
author | Jean-Francois Moine <moinejf@free.fr> | 2008-06-30 14:50:11 -0400 |
---|---|---|
committer | Mauro Carvalho Chehab <mchehab@infradead.org> | 2008-07-20 06:14:49 -0400 |
commit | 6a7eba24e4f0ff725d33159f6265e3a79d53a833 (patch) | |
tree | 3e50d669cb91affbcfad9333d74ddc452783094f /drivers/media/video/gspca/spca505.c | |
parent | d43fa32fec442571f10f5d0c3b553413288728de (diff) |
V4L/DVB (8157): gspca: all subdrivers
- remaning subdrivers added
- remove the decoding helper and some specific frame decodings
Signed-off-by: Jean-Francois Moine <moinejf@free.fr>
Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
Diffstat (limited to 'drivers/media/video/gspca/spca505.c')
-rw-r--r-- | drivers/media/video/gspca/spca505.c | 933 |
1 files changed, 933 insertions, 0 deletions
diff --git a/drivers/media/video/gspca/spca505.c b/drivers/media/video/gspca/spca505.c new file mode 100644 index 000000000000..5b23518d970d --- /dev/null +++ b/drivers/media/video/gspca/spca505.c | |||
@@ -0,0 +1,933 @@ | |||
1 | /* | ||
2 | * SPCA505 chip based cameras initialization data | ||
3 | * | ||
4 | * V4L2 by Jean-Francis Moine <http://moinejf.free.fr> | ||
5 | * | ||
6 | * This program is free software; you can redistribute it and/or modify | ||
7 | * it under the terms of the GNU General Public License as published by | ||
8 | * the Free Software Foundation; either version 2 of the License, or | ||
9 | * any later version. | ||
10 | * | ||
11 | * This program is distributed in the hope that it will be useful, | ||
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
14 | * GNU General Public License for more details. | ||
15 | * | ||
16 | * You should have received a copy of the GNU General Public License | ||
17 | * along with this program; if not, write to the Free Software | ||
18 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
19 | * | ||
20 | */ | ||
21 | |||
22 | #define MODULE_NAME "spca505" | ||
23 | |||
24 | #include "gspca.h" | ||
25 | |||
26 | #define DRIVER_VERSION_NUMBER KERNEL_VERSION(2, 1, 0) | ||
27 | static const char version[] = "2.1.0"; | ||
28 | |||
29 | MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>"); | ||
30 | MODULE_DESCRIPTION("GSPCA/SPCA505 USB Camera Driver"); | ||
31 | MODULE_LICENSE("GPL"); | ||
32 | |||
33 | /* specific webcam descriptor */ | ||
34 | struct sd { | ||
35 | struct gspca_dev gspca_dev; /* !! must be the first item */ | ||
36 | |||
37 | int buflen; | ||
38 | unsigned char tmpbuf[640 * 480 * 3 / 2]; /* YYUV per line */ | ||
39 | unsigned char tmpbuf2[640 * 480 * 2]; /* YUYV */ | ||
40 | |||
41 | unsigned char brightness; | ||
42 | |||
43 | char subtype; | ||
44 | #define IntelPCCameraPro 0 | ||
45 | #define Nxultra 1 | ||
46 | }; | ||
47 | |||
48 | /* V4L2 controls supported by the driver */ | ||
49 | static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val); | ||
50 | static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val); | ||
51 | |||
52 | static struct ctrl sd_ctrls[] = { | ||
53 | #define SD_BRIGHTNESS 0 | ||
54 | { | ||
55 | { | ||
56 | .id = V4L2_CID_BRIGHTNESS, | ||
57 | .type = V4L2_CTRL_TYPE_INTEGER, | ||
58 | .name = "Brightness", | ||
59 | .minimum = 0, | ||
60 | .maximum = 255, | ||
61 | .step = 1, | ||
62 | .default_value = 127, | ||
63 | }, | ||
64 | .set = sd_setbrightness, | ||
65 | .get = sd_getbrightness, | ||
66 | }, | ||
67 | }; | ||
68 | |||
69 | static struct cam_mode vga_mode[] = { | ||
70 | {V4L2_PIX_FMT_YUYV, 160, 120, 5}, | ||
71 | {V4L2_PIX_FMT_YUYV, 176, 144, 4}, | ||
72 | {V4L2_PIX_FMT_YUYV, 320, 240, 2}, | ||
73 | {V4L2_PIX_FMT_YUYV, 352, 288, 1}, | ||
74 | {V4L2_PIX_FMT_YUYV, 640, 480, 0}, | ||
75 | }; | ||
76 | |||
77 | #define SPCA50X_OFFSET_DATA 10 | ||
78 | |||
79 | #define SPCA50X_REG_USB 0x02 /* spca505 501 */ | ||
80 | |||
81 | #define SPCA50X_USB_CTRL 0x00 /* spca505 */ | ||
82 | #define SPCA50X_CUSB_ENABLE 0x01 /* spca505 */ | ||
83 | #define SPCA50X_REG_GLOBAL 0x03 /* spca505 */ | ||
84 | #define SPCA50X_GMISC0_IDSEL 0x01 /* Global control device ID select spca505 */ | ||
85 | #define SPCA50X_GLOBAL_MISC0 0x00 /* Global control miscellaneous 0 spca505 */ | ||
86 | |||
87 | #define SPCA50X_GLOBAL_MISC1 0x01 /* 505 */ | ||
88 | #define SPCA50X_GLOBAL_MISC3 0x03 /* 505 */ | ||
89 | #define SPCA50X_GMISC3_SAA7113RST 0x20 /* Not sure about this one spca505 */ | ||
90 | |||
91 | /* | ||
92 | * Data to initialize a SPCA505. Common to the CCD and external modes | ||
93 | */ | ||
94 | static __u16 spca505_init_data[][3] = { | ||
95 | /* line bmRequest,value,index */ | ||
96 | /* 1819 */ | ||
97 | {SPCA50X_REG_GLOBAL, SPCA50X_GMISC3_SAA7113RST, SPCA50X_GLOBAL_MISC3}, | ||
98 | /* Sensor reset */ | ||
99 | /* 1822 */ {SPCA50X_REG_GLOBAL, 0x00, SPCA50X_GLOBAL_MISC3}, | ||
100 | /* 1825 */ {SPCA50X_REG_GLOBAL, 0x00, SPCA50X_GLOBAL_MISC1}, | ||
101 | /* Block USB reset */ | ||
102 | /* 1828 */ {SPCA50X_REG_GLOBAL, SPCA50X_GMISC0_IDSEL, | ||
103 | SPCA50X_GLOBAL_MISC0}, | ||
104 | |||
105 | /* 1831 */ {0x5, 0x01, 0x10}, | ||
106 | /* Maybe power down some stuff */ | ||
107 | /* 1834 */ {0x5, 0x0f, 0x11}, | ||
108 | |||
109 | /* Setup internal CCD ? */ | ||
110 | /* 1837 */ {0x6, 0x10, 0x08}, | ||
111 | /* 1840 */ {0x6, 0x00, 0x09}, | ||
112 | /* 1843 */ {0x6, 0x00, 0x0a}, | ||
113 | /* 1846 */ {0x6, 0x00, 0x0b}, | ||
114 | /* 1849 */ {0x6, 0x10, 0x0c}, | ||
115 | /* 1852 */ {0x6, 0x00, 0x0d}, | ||
116 | /* 1855 */ {0x6, 0x00, 0x0e}, | ||
117 | /* 1858 */ {0x6, 0x00, 0x0f}, | ||
118 | /* 1861 */ {0x6, 0x10, 0x10}, | ||
119 | /* 1864 */ {0x6, 0x02, 0x11}, | ||
120 | /* 1867 */ {0x6, 0x00, 0x12}, | ||
121 | /* 1870 */ {0x6, 0x04, 0x13}, | ||
122 | /* 1873 */ {0x6, 0x02, 0x14}, | ||
123 | /* 1876 */ {0x6, 0x8a, 0x51}, | ||
124 | /* 1879 */ {0x6, 0x40, 0x52}, | ||
125 | /* 1882 */ {0x6, 0xb6, 0x53}, | ||
126 | /* 1885 */ {0x6, 0x3d, 0x54}, | ||
127 | {} | ||
128 | }; | ||
129 | |||
130 | /* | ||
131 | * Data to initialize the camera using the internal CCD | ||
132 | */ | ||
133 | static __u16 spca505_open_data_ccd[][3] = { | ||
134 | /* line bmRequest,value,index */ | ||
135 | /* Internal CCD data set */ | ||
136 | /* 1891 */ {0x3, 0x04, 0x01}, | ||
137 | /* This could be a reset */ | ||
138 | /* 1894 */ {0x3, 0x00, 0x01}, | ||
139 | |||
140 | /* Setup compression and image registers. 0x6 and 0x7 seem to be | ||
141 | related to H&V hold, and are resolution mode specific */ | ||
142 | /* 1897 */ {0x4, 0x10, 0x01}, | ||
143 | /* DIFF(0x50), was (0x10) */ | ||
144 | /* 1900 */ {0x4, 0x00, 0x04}, | ||
145 | /* 1903 */ {0x4, 0x00, 0x05}, | ||
146 | /* 1906 */ {0x4, 0x20, 0x06}, | ||
147 | /* 1909 */ {0x4, 0x20, 0x07}, | ||
148 | |||
149 | /* 1912 */ {0x8, 0x0a, 0x00}, | ||
150 | /* DIFF (0x4a), was (0xa) */ | ||
151 | |||
152 | /* 1915 */ {0x5, 0x00, 0x10}, | ||
153 | /* 1918 */ {0x5, 0x00, 0x11}, | ||
154 | /* 1921 */ {0x5, 0x00, 0x00}, | ||
155 | /* DIFF not written */ | ||
156 | /* 1924 */ {0x5, 0x00, 0x01}, | ||
157 | /* DIFF not written */ | ||
158 | /* 1927 */ {0x5, 0x00, 0x02}, | ||
159 | /* DIFF not written */ | ||
160 | /* 1930 */ {0x5, 0x00, 0x03}, | ||
161 | /* DIFF not written */ | ||
162 | /* 1933 */ {0x5, 0x00, 0x04}, | ||
163 | /* DIFF not written */ | ||
164 | /* 1936 */ {0x5, 0x80, 0x05}, | ||
165 | /* DIFF not written */ | ||
166 | /* 1939 */ {0x5, 0xe0, 0x06}, | ||
167 | /* DIFF not written */ | ||
168 | /* 1942 */ {0x5, 0x20, 0x07}, | ||
169 | /* DIFF not written */ | ||
170 | /* 1945 */ {0x5, 0xa0, 0x08}, | ||
171 | /* DIFF not written */ | ||
172 | /* 1948 */ {0x5, 0x0, 0x12}, | ||
173 | /* DIFF not written */ | ||
174 | /* 1951 */ {0x5, 0x02, 0x0f}, | ||
175 | /* DIFF not written */ | ||
176 | /* 1954 */ {0x5, 0x10, 0x46}, | ||
177 | /* DIFF not written */ | ||
178 | /* 1957 */ {0x5, 0x8, 0x4a}, | ||
179 | /* DIFF not written */ | ||
180 | |||
181 | /* 1960 */ {0x3, 0x08, 0x03}, | ||
182 | /* DIFF (0x3,0x28,0x3) */ | ||
183 | /* 1963 */ {0x3, 0x08, 0x01}, | ||
184 | /* 1966 */ {0x3, 0x0c, 0x03}, | ||
185 | /* DIFF not written */ | ||
186 | /* 1969 */ {0x3, 0x21, 0x00}, | ||
187 | /* DIFF (0x39) */ | ||
188 | |||
189 | /* Extra block copied from init to hopefully ensure CCD is in a sane state */ | ||
190 | /* 1837 */ {0x6, 0x10, 0x08}, | ||
191 | /* 1840 */ {0x6, 0x00, 0x09}, | ||
192 | /* 1843 */ {0x6, 0x00, 0x0a}, | ||
193 | /* 1846 */ {0x6, 0x00, 0x0b}, | ||
194 | /* 1849 */ {0x6, 0x10, 0x0c}, | ||
195 | /* 1852 */ {0x6, 0x00, 0x0d}, | ||
196 | /* 1855 */ {0x6, 0x00, 0x0e}, | ||
197 | /* 1858 */ {0x6, 0x00, 0x0f}, | ||
198 | /* 1861 */ {0x6, 0x10, 0x10}, | ||
199 | /* 1864 */ {0x6, 0x02, 0x11}, | ||
200 | /* 1867 */ {0x6, 0x00, 0x12}, | ||
201 | /* 1870 */ {0x6, 0x04, 0x13}, | ||
202 | /* 1873 */ {0x6, 0x02, 0x14}, | ||
203 | /* 1876 */ {0x6, 0x8a, 0x51}, | ||
204 | /* 1879 */ {0x6, 0x40, 0x52}, | ||
205 | /* 1882 */ {0x6, 0xb6, 0x53}, | ||
206 | /* 1885 */ {0x6, 0x3d, 0x54}, | ||
207 | /* End of extra block */ | ||
208 | |||
209 | /* 1972 */ {0x6, 0x3f, 0x1}, | ||
210 | /* Block skipped */ | ||
211 | /* 1975 */ {0x6, 0x10, 0x02}, | ||
212 | /* 1978 */ {0x6, 0x64, 0x07}, | ||
213 | /* 1981 */ {0x6, 0x10, 0x08}, | ||
214 | /* 1984 */ {0x6, 0x00, 0x09}, | ||
215 | /* 1987 */ {0x6, 0x00, 0x0a}, | ||
216 | /* 1990 */ {0x6, 0x00, 0x0b}, | ||
217 | /* 1993 */ {0x6, 0x10, 0x0c}, | ||
218 | /* 1996 */ {0x6, 0x00, 0x0d}, | ||
219 | /* 1999 */ {0x6, 0x00, 0x0e}, | ||
220 | /* 2002 */ {0x6, 0x00, 0x0f}, | ||
221 | /* 2005 */ {0x6, 0x10, 0x10}, | ||
222 | /* 2008 */ {0x6, 0x02, 0x11}, | ||
223 | /* 2011 */ {0x6, 0x00, 0x12}, | ||
224 | /* 2014 */ {0x6, 0x04, 0x13}, | ||
225 | /* 2017 */ {0x6, 0x02, 0x14}, | ||
226 | /* 2020 */ {0x6, 0x8a, 0x51}, | ||
227 | /* 2023 */ {0x6, 0x40, 0x52}, | ||
228 | /* 2026 */ {0x6, 0xb6, 0x53}, | ||
229 | /* 2029 */ {0x6, 0x3d, 0x54}, | ||
230 | /* 2032 */ {0x6, 0x60, 0x57}, | ||
231 | /* 2035 */ {0x6, 0x20, 0x58}, | ||
232 | /* 2038 */ {0x6, 0x15, 0x59}, | ||
233 | /* 2041 */ {0x6, 0x05, 0x5a}, | ||
234 | |||
235 | /* 2044 */ {0x5, 0x01, 0xc0}, | ||
236 | /* 2047 */ {0x5, 0x10, 0xcb}, | ||
237 | /* 2050 */ {0x5, 0x80, 0xc1}, | ||
238 | /* */ | ||
239 | /* 2053 */ {0x5, 0x0, 0xc2}, | ||
240 | /* 4 was 0 */ | ||
241 | /* 2056 */ {0x5, 0x00, 0xca}, | ||
242 | /* 2059 */ {0x5, 0x80, 0xc1}, | ||
243 | /* */ | ||
244 | /* 2062 */ {0x5, 0x04, 0xc2}, | ||
245 | /* 2065 */ {0x5, 0x00, 0xca}, | ||
246 | /* 2068 */ {0x5, 0x0, 0xc1}, | ||
247 | /* */ | ||
248 | /* 2071 */ {0x5, 0x00, 0xc2}, | ||
249 | /* 2074 */ {0x5, 0x00, 0xca}, | ||
250 | /* 2077 */ {0x5, 0x40, 0xc1}, | ||
251 | /* */ | ||
252 | /* 2080 */ {0x5, 0x17, 0xc2}, | ||
253 | /* 2083 */ {0x5, 0x00, 0xca}, | ||
254 | /* 2086 */ {0x5, 0x80, 0xc1}, | ||
255 | /* */ | ||
256 | /* 2089 */ {0x5, 0x06, 0xc2}, | ||
257 | /* 2092 */ {0x5, 0x00, 0xca}, | ||
258 | /* 2095 */ {0x5, 0x80, 0xc1}, | ||
259 | /* */ | ||
260 | /* 2098 */ {0x5, 0x04, 0xc2}, | ||
261 | /* 2101 */ {0x5, 0x00, 0xca}, | ||
262 | |||
263 | /* 2104 */ {0x3, 0x4c, 0x3}, | ||
264 | /* 2107 */ {0x3, 0x18, 0x1}, | ||
265 | |||
266 | /* 2110 */ {0x6, 0x70, 0x51}, | ||
267 | /* 2113 */ {0x6, 0xbe, 0x53}, | ||
268 | /* 2116 */ {0x6, 0x71, 0x57}, | ||
269 | /* 2119 */ {0x6, 0x20, 0x58}, | ||
270 | /* 2122 */ {0x6, 0x05, 0x59}, | ||
271 | /* 2125 */ {0x6, 0x15, 0x5a}, | ||
272 | |||
273 | /* 2128 */ {0x4, 0x00, 0x08}, | ||
274 | /* Compress = OFF (0x1 to turn on) */ | ||
275 | /* 2131 */ {0x4, 0x12, 0x09}, | ||
276 | /* 2134 */ {0x4, 0x21, 0x0a}, | ||
277 | /* 2137 */ {0x4, 0x10, 0x0b}, | ||
278 | /* 2140 */ {0x4, 0x21, 0x0c}, | ||
279 | /* 2143 */ {0x4, 0x05, 0x00}, | ||
280 | /* was 5 (Image Type ? ) */ | ||
281 | /* 2146 */ {0x4, 0x00, 0x01}, | ||
282 | |||
283 | /* 2149 */ {0x6, 0x3f, 0x01}, | ||
284 | |||
285 | /* 2152 */ {0x4, 0x00, 0x04}, | ||
286 | /* 2155 */ {0x4, 0x00, 0x05}, | ||
287 | /* 2158 */ {0x4, 0x40, 0x06}, | ||
288 | /* 2161 */ {0x4, 0x40, 0x07}, | ||
289 | |||
290 | /* 2164 */ {0x6, 0x1c, 0x17}, | ||
291 | /* 2167 */ {0x6, 0xe2, 0x19}, | ||
292 | /* 2170 */ {0x6, 0x1c, 0x1b}, | ||
293 | /* 2173 */ {0x6, 0xe2, 0x1d}, | ||
294 | /* 2176 */ {0x6, 0xaa, 0x1f}, | ||
295 | /* 2179 */ {0x6, 0x70, 0x20}, | ||
296 | |||
297 | /* 2182 */ {0x5, 0x01, 0x10}, | ||
298 | /* 2185 */ {0x5, 0x00, 0x11}, | ||
299 | /* 2188 */ {0x5, 0x01, 0x00}, | ||
300 | /* 2191 */ {0x5, 0x05, 0x01}, | ||
301 | /* 2194 */ {0x5, 0x00, 0xc1}, | ||
302 | /* */ | ||
303 | /* 2197 */ {0x5, 0x00, 0xc2}, | ||
304 | /* 2200 */ {0x5, 0x00, 0xca}, | ||
305 | |||
306 | /* 2203 */ {0x6, 0x70, 0x51}, | ||
307 | /* 2206 */ {0x6, 0xbe, 0x53}, | ||
308 | {} | ||
309 | }; | ||
310 | |||
311 | /* | ||
312 | Made by Tomasz Zablocki (skalamandra@poczta.onet.pl) | ||
313 | * SPCA505b chip based cameras initialization data | ||
314 | * | ||
315 | */ | ||
316 | /* jfm */ | ||
317 | #define initial_brightness 0x7f /* 0x0(white)-0xff(black) */ | ||
318 | /* #define initial_brightness 0x0 //0x0(white)-0xff(black) */ | ||
319 | /* | ||
320 | * Data to initialize a SPCA505. Common to the CCD and external modes | ||
321 | */ | ||
322 | static __u16 spca505b_init_data[][3] = { | ||
323 | /* start */ | ||
324 | {0x02, 0x00, 0x00}, /* init */ | ||
325 | {0x02, 0x00, 0x01}, | ||
326 | {0x02, 0x00, 0x02}, | ||
327 | {0x02, 0x00, 0x03}, | ||
328 | {0x02, 0x00, 0x04}, | ||
329 | {0x02, 0x00, 0x05}, | ||
330 | {0x02, 0x00, 0x06}, | ||
331 | {0x02, 0x00, 0x07}, | ||
332 | {0x02, 0x00, 0x08}, | ||
333 | {0x02, 0x00, 0x09}, | ||
334 | {0x03, 0x00, 0x00}, | ||
335 | {0x03, 0x00, 0x01}, | ||
336 | {0x03, 0x00, 0x02}, | ||
337 | {0x03, 0x00, 0x03}, | ||
338 | {0x03, 0x00, 0x04}, | ||
339 | {0x03, 0x00, 0x05}, | ||
340 | {0x03, 0x00, 0x06}, | ||
341 | {0x04, 0x00, 0x00}, | ||
342 | {0x04, 0x00, 0x02}, | ||
343 | {0x04, 0x00, 0x04}, | ||
344 | {0x04, 0x00, 0x05}, | ||
345 | {0x04, 0x00, 0x06}, | ||
346 | {0x04, 0x00, 0x07}, | ||
347 | {0x04, 0x00, 0x08}, | ||
348 | {0x04, 0x00, 0x09}, | ||
349 | {0x04, 0x00, 0x0a}, | ||
350 | {0x04, 0x00, 0x0b}, | ||
351 | {0x04, 0x00, 0x0c}, | ||
352 | {0x07, 0x00, 0x00}, | ||
353 | {0x07, 0x00, 0x03}, | ||
354 | {0x08, 0x00, 0x00}, | ||
355 | {0x08, 0x00, 0x01}, | ||
356 | {0x08, 0x00, 0x02}, | ||
357 | {0x00, 0x01, 0x00}, | ||
358 | {0x00, 0x01, 0x01}, | ||
359 | {0x00, 0x01, 0x34}, | ||
360 | {0x00, 0x01, 0x35}, | ||
361 | {0x06, 0x18, 0x08}, | ||
362 | {0x06, 0xfc, 0x09}, | ||
363 | {0x06, 0xfc, 0x0a}, | ||
364 | {0x06, 0xfc, 0x0b}, | ||
365 | {0x06, 0x18, 0x0c}, | ||
366 | {0x06, 0xfc, 0x0d}, | ||
367 | {0x06, 0xfc, 0x0e}, | ||
368 | {0x06, 0xfc, 0x0f}, | ||
369 | {0x06, 0x18, 0x10}, | ||
370 | {0x06, 0xfe, 0x12}, | ||
371 | {0x06, 0x00, 0x11}, | ||
372 | {0x06, 0x00, 0x14}, | ||
373 | {0x06, 0x00, 0x13}, | ||
374 | {0x06, 0x28, 0x51}, | ||
375 | {0x06, 0xff, 0x53}, | ||
376 | {0x02, 0x00, 0x08}, | ||
377 | |||
378 | {0x03, 0x00, 0x03}, | ||
379 | {0x03, 0x10, 0x03}, | ||
380 | {} | ||
381 | }; | ||
382 | |||
383 | /* | ||
384 | * Data to initialize the camera using the internal CCD | ||
385 | */ | ||
386 | static __u16 spca505b_open_data_ccd[][3] = { | ||
387 | |||
388 | /* {0x02,0x00,0x00}, */ | ||
389 | {0x03, 0x04, 0x01}, /* rst */ | ||
390 | {0x03, 0x00, 0x01}, | ||
391 | {0x03, 0x00, 0x00}, | ||
392 | {0x03, 0x21, 0x00}, | ||
393 | {0x03, 0x00, 0x04}, | ||
394 | {0x03, 0x00, 0x03}, | ||
395 | {0x03, 0x18, 0x03}, | ||
396 | {0x03, 0x08, 0x01}, | ||
397 | {0x03, 0x1c, 0x03}, | ||
398 | {0x03, 0x5c, 0x03}, | ||
399 | {0x03, 0x5c, 0x03}, | ||
400 | {0x03, 0x18, 0x01}, | ||
401 | |||
402 | /* same as 505 */ | ||
403 | {0x04, 0x10, 0x01}, | ||
404 | {0x04, 0x00, 0x04}, | ||
405 | {0x04, 0x00, 0x05}, | ||
406 | {0x04, 0x20, 0x06}, | ||
407 | {0x04, 0x20, 0x07}, | ||
408 | |||
409 | {0x08, 0x0a, 0x00}, | ||
410 | |||
411 | {0x05, 0x00, 0x10}, | ||
412 | {0x05, 0x00, 0x11}, | ||
413 | {0x05, 0x00, 0x12}, | ||
414 | {0x05, 0x6f, 0x00}, | ||
415 | {0x05, initial_brightness >> 6, 0x00}, | ||
416 | {0x05, initial_brightness << 2, 0x01}, | ||
417 | {0x05, 0x00, 0x02}, | ||
418 | {0x05, 0x01, 0x03}, | ||
419 | {0x05, 0x00, 0x04}, | ||
420 | {0x05, 0x03, 0x05}, | ||
421 | {0x05, 0xe0, 0x06}, | ||
422 | {0x05, 0x20, 0x07}, | ||
423 | {0x05, 0xa0, 0x08}, | ||
424 | {0x05, 0x00, 0x12}, | ||
425 | {0x05, 0x02, 0x0f}, | ||
426 | {0x05, 128, 0x14}, /* max exposure off (0=on) */ | ||
427 | {0x05, 0x01, 0xb0}, | ||
428 | {0x05, 0x01, 0xbf}, | ||
429 | {0x03, 0x02, 0x06}, | ||
430 | {0x05, 0x10, 0x46}, | ||
431 | {0x05, 0x08, 0x4a}, | ||
432 | |||
433 | {0x06, 0x00, 0x01}, | ||
434 | {0x06, 0x10, 0x02}, | ||
435 | {0x06, 0x64, 0x07}, | ||
436 | {0x06, 0x18, 0x08}, | ||
437 | {0x06, 0xfc, 0x09}, | ||
438 | {0x06, 0xfc, 0x0a}, | ||
439 | {0x06, 0xfc, 0x0b}, | ||
440 | {0x04, 0x00, 0x01}, | ||
441 | {0x06, 0x18, 0x0c}, | ||
442 | {0x06, 0xfc, 0x0d}, | ||
443 | {0x06, 0xfc, 0x0e}, | ||
444 | {0x06, 0xfc, 0x0f}, | ||
445 | {0x06, 0x11, 0x10}, /* contrast */ | ||
446 | {0x06, 0x00, 0x11}, | ||
447 | {0x06, 0xfe, 0x12}, | ||
448 | {0x06, 0x00, 0x13}, | ||
449 | {0x06, 0x00, 0x14}, | ||
450 | {0x06, 0x9d, 0x51}, | ||
451 | {0x06, 0x40, 0x52}, | ||
452 | {0x06, 0x7c, 0x53}, | ||
453 | {0x06, 0x40, 0x54}, | ||
454 | {0x06, 0x02, 0x57}, | ||
455 | {0x06, 0x03, 0x58}, | ||
456 | {0x06, 0x15, 0x59}, | ||
457 | {0x06, 0x05, 0x5a}, | ||
458 | {0x06, 0x03, 0x56}, | ||
459 | {0x06, 0x02, 0x3f}, | ||
460 | {0x06, 0x00, 0x40}, | ||
461 | {0x06, 0x39, 0x41}, | ||
462 | {0x06, 0x69, 0x42}, | ||
463 | {0x06, 0x87, 0x43}, | ||
464 | {0x06, 0x9e, 0x44}, | ||
465 | {0x06, 0xb1, 0x45}, | ||
466 | {0x06, 0xbf, 0x46}, | ||
467 | {0x06, 0xcc, 0x47}, | ||
468 | {0x06, 0xd5, 0x48}, | ||
469 | {0x06, 0xdd, 0x49}, | ||
470 | {0x06, 0xe3, 0x4a}, | ||
471 | {0x06, 0xe8, 0x4b}, | ||
472 | {0x06, 0xed, 0x4c}, | ||
473 | {0x06, 0xf2, 0x4d}, | ||
474 | {0x06, 0xf7, 0x4e}, | ||
475 | {0x06, 0xfc, 0x4f}, | ||
476 | {0x06, 0xff, 0x50}, | ||
477 | |||
478 | {0x05, 0x01, 0xc0}, | ||
479 | {0x05, 0x10, 0xcb}, | ||
480 | {0x05, 0x40, 0xc1}, | ||
481 | {0x05, 0x04, 0xc2}, | ||
482 | {0x05, 0x00, 0xca}, | ||
483 | {0x05, 0x40, 0xc1}, | ||
484 | {0x05, 0x09, 0xc2}, | ||
485 | {0x05, 0x00, 0xca}, | ||
486 | {0x05, 0xc0, 0xc1}, | ||
487 | {0x05, 0x09, 0xc2}, | ||
488 | {0x05, 0x00, 0xca}, | ||
489 | {0x05, 0x40, 0xc1}, | ||
490 | {0x05, 0x59, 0xc2}, | ||
491 | {0x05, 0x00, 0xca}, | ||
492 | {0x04, 0x00, 0x01}, | ||
493 | {0x05, 0x80, 0xc1}, | ||
494 | {0x05, 0xec, 0xc2}, | ||
495 | {0x05, 0x0, 0xca}, | ||
496 | |||
497 | {0x06, 0x02, 0x57}, | ||
498 | {0x06, 0x01, 0x58}, | ||
499 | {0x06, 0x15, 0x59}, | ||
500 | {0x06, 0x0a, 0x5a}, | ||
501 | {0x06, 0x01, 0x57}, | ||
502 | {0x06, 0x8a, 0x03}, | ||
503 | {0x06, 0x0a, 0x6c}, | ||
504 | {0x06, 0x30, 0x01}, | ||
505 | {0x06, 0x20, 0x02}, | ||
506 | {0x06, 0x00, 0x03}, | ||
507 | |||
508 | {0x05, 0x8c, 0x25}, | ||
509 | |||
510 | {0x06, 0x4d, 0x51}, /* maybe saturation (4d) */ | ||
511 | {0x06, 0x84, 0x53}, /* making green (84) */ | ||
512 | {0x06, 0x00, 0x57}, /* sharpness (1) */ | ||
513 | {0x06, 0x18, 0x08}, | ||
514 | {0x06, 0xfc, 0x09}, | ||
515 | {0x06, 0xfc, 0x0a}, | ||
516 | {0x06, 0xfc, 0x0b}, | ||
517 | {0x06, 0x18, 0x0c}, /* maybe hue (18) */ | ||
518 | {0x06, 0xfc, 0x0d}, | ||
519 | {0x06, 0xfc, 0x0e}, | ||
520 | {0x06, 0xfc, 0x0f}, | ||
521 | {0x06, 0x18, 0x10}, /* maybe contrast (18) */ | ||
522 | |||
523 | {0x05, 0x01, 0x02}, | ||
524 | |||
525 | {0x04, 0x00, 0x08}, /* compression */ | ||
526 | {0x04, 0x12, 0x09}, | ||
527 | {0x04, 0x21, 0x0a}, | ||
528 | {0x04, 0x10, 0x0b}, | ||
529 | {0x04, 0x21, 0x0c}, | ||
530 | {0x04, 0x1d, 0x00}, /* imagetype (1d) */ | ||
531 | {0x04, 0x41, 0x01}, /* hardware snapcontrol */ | ||
532 | |||
533 | {0x04, 0x00, 0x04}, | ||
534 | {0x04, 0x00, 0x05}, | ||
535 | {0x04, 0x10, 0x06}, | ||
536 | {0x04, 0x10, 0x07}, | ||
537 | {0x04, 0x40, 0x06}, | ||
538 | {0x04, 0x40, 0x07}, | ||
539 | {0x04, 0x00, 0x04}, | ||
540 | {0x04, 0x00, 0x05}, | ||
541 | |||
542 | {0x06, 0x1c, 0x17}, | ||
543 | {0x06, 0xe2, 0x19}, | ||
544 | {0x06, 0x1c, 0x1b}, | ||
545 | {0x06, 0xe2, 0x1d}, | ||
546 | {0x06, 0x5f, 0x1f}, | ||
547 | {0x06, 0x32, 0x20}, | ||
548 | |||
549 | {0x05, initial_brightness >> 6, 0x00}, | ||
550 | {0x05, initial_brightness << 2, 0x01}, | ||
551 | {0x05, 0x06, 0xc1}, | ||
552 | {0x05, 0x58, 0xc2}, | ||
553 | {0x05, 0x0, 0xca}, | ||
554 | {0x05, 0x0, 0x11}, | ||
555 | {} | ||
556 | }; | ||
557 | |||
558 | static int reg_write(struct usb_device *dev, | ||
559 | __u16 reg, __u16 index, __u16 value) | ||
560 | { | ||
561 | int ret; | ||
562 | |||
563 | ret = usb_control_msg(dev, | ||
564 | usb_sndctrlpipe(dev, 0), | ||
565 | reg, | ||
566 | USB_TYPE_VENDOR | USB_RECIP_DEVICE, | ||
567 | value, index, NULL, 0, 500); | ||
568 | PDEBUG(D_PACK, "reg write: 0x%02x,0x%02x:0x%02x, 0x%x", | ||
569 | reg, index, value, ret); | ||
570 | if (ret < 0) | ||
571 | PDEBUG(D_ERR, "reg write: error %d", ret); | ||
572 | return ret; | ||
573 | } | ||
574 | |||
575 | /* returns: negative is error, pos or zero is data */ | ||
576 | static int reg_read(struct usb_device *dev, | ||
577 | __u16 reg, /* bRequest */ | ||
578 | __u16 index, /* wIndex */ | ||
579 | __u16 length) /* wLength (1 or 2 only) */ | ||
580 | { | ||
581 | int ret; | ||
582 | unsigned char buf[4]; | ||
583 | |||
584 | buf[1] = 0; | ||
585 | ret = usb_control_msg(dev, | ||
586 | usb_rcvctrlpipe(dev, 0), | ||
587 | reg, | ||
588 | USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, | ||
589 | (__u16) 0, /* value */ | ||
590 | (__u16) index, | ||
591 | buf, | ||
592 | length, | ||
593 | 500); /* timeout */ | ||
594 | if (ret < 0) { | ||
595 | PDEBUG(D_ERR, "reg_read err %d", ret); | ||
596 | return -1; | ||
597 | } | ||
598 | return (buf[1] << 8) + buf[0]; | ||
599 | } | ||
600 | |||
601 | static int write_vector(struct gspca_dev *gspca_dev, | ||
602 | __u16 data[][3]) | ||
603 | { | ||
604 | struct usb_device *dev = gspca_dev->dev; | ||
605 | int ret, i = 0; | ||
606 | |||
607 | while (data[i][0] != 0 || data[i][1] != 0 || data[i][2] != 0) { | ||
608 | ret = reg_write(dev, data[i][0], data[i][2], data[i][1]); | ||
609 | if (ret < 0) { | ||
610 | PDEBUG(D_ERR, | ||
611 | "Register write failed for 0x%x,0x%x,0x%x", | ||
612 | data[i][0], data[i][1], data[i][2]); | ||
613 | return ret; | ||
614 | } | ||
615 | i++; | ||
616 | } | ||
617 | return 0; | ||
618 | } | ||
619 | |||
620 | /* this function is called at probe time */ | ||
621 | static int sd_config(struct gspca_dev *gspca_dev, | ||
622 | const struct usb_device_id *id) | ||
623 | { | ||
624 | struct sd *sd = (struct sd *) gspca_dev; | ||
625 | struct cam *cam; | ||
626 | __u16 vendor; | ||
627 | __u16 product; | ||
628 | |||
629 | vendor = id->idVendor; | ||
630 | product = id->idProduct; | ||
631 | switch (vendor) { | ||
632 | case 0x041e: /* Creative cameras */ | ||
633 | /* switch (product) { */ | ||
634 | /* case 0x401d: * here505b */ | ||
635 | sd->subtype = Nxultra; | ||
636 | /* break; */ | ||
637 | /* } */ | ||
638 | break; | ||
639 | case 0x0733: /* Rebadged ViewQuest (Intel) and ViewQuest cameras */ | ||
640 | /* switch (product) { */ | ||
641 | /* case 0x0430: */ | ||
642 | /* fixme: may be UsbGrabberPV321 BRIDGE_SPCA506 SENSOR_SAA7113 */ | ||
643 | sd->subtype = IntelPCCameraPro; | ||
644 | /* break; */ | ||
645 | /* } */ | ||
646 | break; | ||
647 | } | ||
648 | |||
649 | cam = &gspca_dev->cam; | ||
650 | cam->dev_name = (char *) id->driver_info; | ||
651 | cam->epaddr = 0x01; | ||
652 | cam->cam_mode = vga_mode; | ||
653 | if (sd->subtype != IntelPCCameraPro) | ||
654 | cam->nmodes = sizeof vga_mode / sizeof vga_mode[0]; | ||
655 | else /* no 640x480 for IntelPCCameraPro */ | ||
656 | cam->nmodes = sizeof vga_mode / sizeof vga_mode[0] - 1; | ||
657 | sd->brightness = sd_ctrls[SD_BRIGHTNESS].qctrl.default_value; | ||
658 | |||
659 | if (sd->subtype == Nxultra) { | ||
660 | if (write_vector(gspca_dev, spca505b_init_data)) | ||
661 | return -EIO; | ||
662 | } else { | ||
663 | if (write_vector(gspca_dev, spca505_init_data)) | ||
664 | return -EIO; | ||
665 | } | ||
666 | return 0; | ||
667 | } | ||
668 | |||
669 | /* this function is called at open time */ | ||
670 | static int sd_open(struct gspca_dev *gspca_dev) | ||
671 | { | ||
672 | struct sd *sd = (struct sd *) gspca_dev; | ||
673 | int ret; | ||
674 | |||
675 | PDEBUG(D_STREAM, "Initializing SPCA505"); | ||
676 | if (sd->subtype == Nxultra) | ||
677 | write_vector(gspca_dev, spca505b_open_data_ccd); | ||
678 | else | ||
679 | write_vector(gspca_dev, spca505_open_data_ccd); | ||
680 | ret = reg_read(gspca_dev->dev, 6, 0x16, 2); | ||
681 | |||
682 | if (ret < 0) { | ||
683 | PDEBUG(D_ERR|D_STREAM, | ||
684 | "register read failed for after vector read err = %d", | ||
685 | ret); | ||
686 | return -EIO; | ||
687 | } | ||
688 | PDEBUG(D_STREAM, | ||
689 | "After vector read returns : 0x%x should be 0x0101", | ||
690 | ret & 0xffff); | ||
691 | |||
692 | ret = reg_write(gspca_dev->dev, 6, 0x16, 0x0a); | ||
693 | if (ret < 0) { | ||
694 | PDEBUG(D_ERR, "register write failed for (6,0xa,0x16) err=%d", | ||
695 | ret); | ||
696 | return -EIO; | ||
697 | } | ||
698 | reg_write(gspca_dev->dev, 5, 0xc2, 18); | ||
699 | return 0; | ||
700 | } | ||
701 | |||
702 | static void sd_start(struct gspca_dev *gspca_dev) | ||
703 | { | ||
704 | struct usb_device *dev = gspca_dev->dev; | ||
705 | int ret; | ||
706 | |||
707 | /* necessary because without it we can see stream | ||
708 | * only once after loading module */ | ||
709 | /* stopping usb registers Tomasz change */ | ||
710 | reg_write(dev, 0x02, 0x0, 0x0); | ||
711 | switch (gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].mode) { | ||
712 | case 0: | ||
713 | reg_write(dev, 0x04, 0x00, 0x00); | ||
714 | reg_write(dev, 0x04, 0x06, 0x10); | ||
715 | reg_write(dev, 0x04, 0x07, 0x10); | ||
716 | break; | ||
717 | case 1: | ||
718 | reg_write(dev, 0x04, 0x00, 0x01); | ||
719 | reg_write(dev, 0x04, 0x06, 0x1a); | ||
720 | reg_write(dev, 0x04, 0x07, 0x1a); | ||
721 | break; | ||
722 | case 2: | ||
723 | reg_write(dev, 0x04, 0x00, 0x02); | ||
724 | reg_write(dev, 0x04, 0x06, 0x1c); | ||
725 | reg_write(dev, 0x04, 0x07, 0x1d); | ||
726 | break; | ||
727 | case 4: | ||
728 | reg_write(dev, 0x04, 0x00, 0x04); | ||
729 | reg_write(dev, 0x04, 0x06, 0x34); | ||
730 | reg_write(dev, 0x04, 0x07, 0x34); | ||
731 | break; | ||
732 | default: | ||
733 | /* case 5: */ | ||
734 | reg_write(dev, 0x04, 0x00, 0x05); | ||
735 | reg_write(dev, 0x04, 0x06, 0x40); | ||
736 | reg_write(dev, 0x04, 0x07, 0x40); | ||
737 | break; | ||
738 | } | ||
739 | /* Enable ISO packet machine - should we do this here or in ISOC init ? */ | ||
740 | ret = reg_write(dev, SPCA50X_REG_USB, | ||
741 | SPCA50X_USB_CTRL, | ||
742 | SPCA50X_CUSB_ENABLE); | ||
743 | |||
744 | /* reg_write(dev, 0x5, 0x0, 0x0); */ | ||
745 | /* reg_write(dev, 0x5, 0x0, 0x1); */ | ||
746 | /* reg_write(dev, 0x5, 0x11, 0x2); */ | ||
747 | } | ||
748 | |||
749 | static void sd_stopN(struct gspca_dev *gspca_dev) | ||
750 | { | ||
751 | /* Disable ISO packet machine */ | ||
752 | reg_write(gspca_dev->dev, 0x02, 0x00, 0x00); | ||
753 | } | ||
754 | |||
755 | static void sd_stop0(struct gspca_dev *gspca_dev) | ||
756 | { | ||
757 | } | ||
758 | |||
759 | /* this function is called at close time */ | ||
760 | static void sd_close(struct gspca_dev *gspca_dev) | ||
761 | { | ||
762 | /* This maybe reset or power control */ | ||
763 | reg_write(gspca_dev->dev, 0x03, 0x03, 0x20); | ||
764 | reg_write(gspca_dev->dev, 0x03, 0x01, 0x0); | ||
765 | reg_write(gspca_dev->dev, 0x03, 0x00, 0x1); | ||
766 | reg_write(gspca_dev->dev, 0x05, 0x10, 0x1); | ||
767 | reg_write(gspca_dev->dev, 0x05, 0x11, 0xf); | ||
768 | } | ||
769 | |||
770 | /* convert YYUV per line to YUYV (YUV 4:2:2) */ | ||
771 | static void yyuv_decode(unsigned char *out, | ||
772 | unsigned char *in, | ||
773 | int width, | ||
774 | int height) | ||
775 | { | ||
776 | unsigned char *Ui, *Vi, *yi, *yi1; | ||
777 | unsigned char *out1; | ||
778 | int i, j; | ||
779 | |||
780 | yi = in; | ||
781 | for (i = height / 2; --i >= 0; ) { | ||
782 | out1 = out + width * 2; /* next line */ | ||
783 | yi1 = yi + width; | ||
784 | Ui = yi1 + width; | ||
785 | Vi = Ui + width / 2; | ||
786 | for (j = width / 2; --j >= 0; ) { | ||
787 | *out++ = 128 + *yi++; | ||
788 | *out++ = 128 + *Ui; | ||
789 | *out++ = 128 + *yi++; | ||
790 | *out++ = 128 + *Vi; | ||
791 | |||
792 | *out1++ = 128 + *yi1++; | ||
793 | *out1++ = 128 + *Ui++; | ||
794 | *out1++ = 128 + *yi1++; | ||
795 | *out1++ = 128 + *Vi++; | ||
796 | } | ||
797 | yi += width * 2; | ||
798 | out = out1; | ||
799 | } | ||
800 | } | ||
801 | |||
802 | static void sd_pkt_scan(struct gspca_dev *gspca_dev, | ||
803 | struct gspca_frame *frame, /* target */ | ||
804 | unsigned char *data, /* isoc packet */ | ||
805 | int len) /* iso packet length */ | ||
806 | { | ||
807 | struct sd *sd = (struct sd *) gspca_dev; | ||
808 | |||
809 | switch (data[0]) { | ||
810 | case 0: /* start of frame */ | ||
811 | if (gspca_dev->last_packet_type == FIRST_PACKET) { | ||
812 | yyuv_decode(sd->tmpbuf2, sd->tmpbuf, | ||
813 | gspca_dev->width, | ||
814 | gspca_dev->height); | ||
815 | frame = gspca_frame_add(gspca_dev, | ||
816 | LAST_PACKET, | ||
817 | frame, | ||
818 | sd->tmpbuf2, | ||
819 | gspca_dev->width | ||
820 | * gspca_dev->height | ||
821 | * 2); | ||
822 | } | ||
823 | gspca_frame_add(gspca_dev, FIRST_PACKET, frame, | ||
824 | data, 0); | ||
825 | data += SPCA50X_OFFSET_DATA; | ||
826 | len -= SPCA50X_OFFSET_DATA; | ||
827 | if (len > 0) | ||
828 | memcpy(sd->tmpbuf, data, len); | ||
829 | else | ||
830 | len = 0; | ||
831 | sd->buflen = len; | ||
832 | return; | ||
833 | case 0xff: /* drop */ | ||
834 | /* gspca_dev->last_packet_type = DISCARD_PACKET; */ | ||
835 | return; | ||
836 | } | ||
837 | data += 1; | ||
838 | len -= 1; | ||
839 | memcpy(&sd->tmpbuf[sd->buflen], data, len); | ||
840 | sd->buflen += len; | ||
841 | } | ||
842 | |||
843 | static void setbrightness(struct gspca_dev *gspca_dev) | ||
844 | { | ||
845 | struct sd *sd = (struct sd *) gspca_dev; | ||
846 | |||
847 | __u8 brightness = sd->brightness; | ||
848 | reg_write(gspca_dev->dev, 5, 0x00, (255 - brightness) >> 6); | ||
849 | reg_write(gspca_dev->dev, 5, 0x01, (255 - brightness) << 2); | ||
850 | |||
851 | } | ||
852 | static void getbrightness(struct gspca_dev *gspca_dev) | ||
853 | { | ||
854 | struct sd *sd = (struct sd *) gspca_dev; | ||
855 | |||
856 | sd->brightness = 255 | ||
857 | - ((reg_read(gspca_dev->dev, 5, 0x01, 1) >> 2) | ||
858 | + (reg_read(gspca_dev->dev, 5, 0x0, 1) << 6)); | ||
859 | } | ||
860 | |||
861 | static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val) | ||
862 | { | ||
863 | struct sd *sd = (struct sd *) gspca_dev; | ||
864 | |||
865 | sd->brightness = val; | ||
866 | if (gspca_dev->streaming) | ||
867 | setbrightness(gspca_dev); | ||
868 | return 0; | ||
869 | } | ||
870 | |||
871 | static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val) | ||
872 | { | ||
873 | struct sd *sd = (struct sd *) gspca_dev; | ||
874 | |||
875 | getbrightness(gspca_dev); | ||
876 | *val = sd->brightness; | ||
877 | return 0; | ||
878 | } | ||
879 | |||
880 | /* sub-driver description */ | ||
881 | static struct sd_desc sd_desc = { | ||
882 | .name = MODULE_NAME, | ||
883 | .ctrls = sd_ctrls, | ||
884 | .nctrls = ARRAY_SIZE(sd_ctrls), | ||
885 | .config = sd_config, | ||
886 | .open = sd_open, | ||
887 | .start = sd_start, | ||
888 | .stopN = sd_stopN, | ||
889 | .stop0 = sd_stop0, | ||
890 | .close = sd_close, | ||
891 | .pkt_scan = sd_pkt_scan, | ||
892 | }; | ||
893 | |||
894 | /* -- module initialisation -- */ | ||
895 | #define DVNM(name) .driver_info = (kernel_ulong_t) name | ||
896 | static __devinitdata struct usb_device_id device_table[] = { | ||
897 | {USB_DEVICE(0x041e, 0x401d), DVNM("Creative Webcam NX ULTRA")}, | ||
898 | {USB_DEVICE(0x0733, 0x0430), DVNM("Intel PC Camera Pro")}, | ||
899 | {} | ||
900 | }; | ||
901 | MODULE_DEVICE_TABLE(usb, device_table); | ||
902 | |||
903 | /* -- device connect -- */ | ||
904 | static int sd_probe(struct usb_interface *intf, | ||
905 | const struct usb_device_id *id) | ||
906 | { | ||
907 | return gspca_dev_probe(intf, id, &sd_desc, sizeof (struct sd), | ||
908 | THIS_MODULE); | ||
909 | } | ||
910 | |||
911 | static struct usb_driver sd_driver = { | ||
912 | .name = MODULE_NAME, | ||
913 | .id_table = device_table, | ||
914 | .probe = sd_probe, | ||
915 | .disconnect = gspca_disconnect, | ||
916 | }; | ||
917 | |||
918 | /* -- module insert / remove -- */ | ||
919 | static int __init sd_mod_init(void) | ||
920 | { | ||
921 | if (usb_register(&sd_driver) < 0) | ||
922 | return -1; | ||
923 | PDEBUG(D_PROBE, "v%s registered", version); | ||
924 | return 0; | ||
925 | } | ||
926 | static void __exit sd_mod_exit(void) | ||
927 | { | ||
928 | usb_deregister(&sd_driver); | ||
929 | PDEBUG(D_PROBE, "deregistered"); | ||
930 | } | ||
931 | |||
932 | module_init(sd_mod_init); | ||
933 | module_exit(sd_mod_exit); | ||