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