blob: 17e7f89a1122c6d16ddca3ace08c55c69cb2fd7a [file] [log] [blame]
Hans de Goedec27cea02011-06-05 07:44:34 -03001/*
2 * GSPCA Endpoints (formerly known as AOX) se401 USB Camera sub Driver
3 *
4 * Copyright (C) 2011 Hans de Goede <hdegoede@redhat.com>
5 *
6 * Based on the v4l1 se401 driver which is:
7 *
8 * Copyright (c) 2000 Jeroen B. Vreeken (pe1rxq@amsat.org)
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
14 *
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
23 *
24 */
25
Joe Perches133a9fe2011-08-21 19:56:57 -030026#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
27
Hans de Goedec27cea02011-06-05 07:44:34 -030028#define MODULE_NAME "se401"
29
30#define BULK_SIZE 4096
31#define PACKET_SIZE 1024
32#define READ_REQ_SIZE 64
33#define MAX_MODES ((READ_REQ_SIZE - 6) / 4)
34/* The se401 compression algorithm uses a fixed quant factor, which
35 can be configured by setting the high nibble of the SE401_OPERATINGMODE
36 feature. This needs to exactly match what is in libv4l! */
37#define SE401_QUANT_FACT 8
38
39#include <linux/input.h>
40#include <linux/slab.h>
41#include "gspca.h"
42#include "se401.h"
43
44MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
45MODULE_DESCRIPTION("Endpoints se401");
46MODULE_LICENSE("GPL");
47
Hans de Goedec27cea02011-06-05 07:44:34 -030048/* exposure change state machine states */
49enum {
50 EXPO_CHANGED,
51 EXPO_DROP_FRAME,
52 EXPO_NO_CHANGE,
53};
54
55/* specific webcam descriptor */
56struct sd {
57 struct gspca_dev gspca_dev; /* !! must be the first item */
Hans Verkuil5262eee2012-05-16 07:14:14 -030058 struct { /* exposure/freq control cluster */
59 struct v4l2_ctrl *exposure;
60 struct v4l2_ctrl *freq;
61 };
62 bool has_brightness;
Hans de Goedec27cea02011-06-05 07:44:34 -030063 struct v4l2_pix_format fmts[MAX_MODES];
64 int pixels_read;
65 int packet_read;
66 u8 packet[PACKET_SIZE];
67 u8 restart_stream;
68 u8 button_state;
69 u8 resetlevel;
70 u8 resetlevel_frame_count;
71 int resetlevel_adjust_dir;
72 int expo_change_state;
73};
74
Hans de Goedec27cea02011-06-05 07:44:34 -030075
76static void se401_write_req(struct gspca_dev *gspca_dev, u16 req, u16 value,
77 int silent)
78{
79 int err;
80
81 if (gspca_dev->usb_err < 0)
82 return;
83
84 err = usb_control_msg(gspca_dev->dev,
85 usb_sndctrlpipe(gspca_dev->dev, 0), req,
86 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
87 value, 0, NULL, 0, 1000);
88 if (err < 0) {
89 if (!silent)
Joe Perches133a9fe2011-08-21 19:56:57 -030090 pr_err("write req failed req %#04x val %#04x error %d\n",
91 req, value, err);
Hans de Goedec27cea02011-06-05 07:44:34 -030092 gspca_dev->usb_err = err;
93 }
94}
95
96static void se401_read_req(struct gspca_dev *gspca_dev, u16 req, int silent)
97{
98 int err;
99
100 if (gspca_dev->usb_err < 0)
101 return;
102
103 if (USB_BUF_SZ < READ_REQ_SIZE) {
Joe Perches133a9fe2011-08-21 19:56:57 -0300104 pr_err("USB_BUF_SZ too small!!\n");
Hans de Goedec27cea02011-06-05 07:44:34 -0300105 gspca_dev->usb_err = -ENOBUFS;
106 return;
107 }
108
109 err = usb_control_msg(gspca_dev->dev,
110 usb_rcvctrlpipe(gspca_dev->dev, 0), req,
111 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
112 0, 0, gspca_dev->usb_buf, READ_REQ_SIZE, 1000);
113 if (err < 0) {
114 if (!silent)
Joe Perches133a9fe2011-08-21 19:56:57 -0300115 pr_err("read req failed req %#04x error %d\n",
116 req, err);
Hans de Goedec27cea02011-06-05 07:44:34 -0300117 gspca_dev->usb_err = err;
118 }
119}
120
121static void se401_set_feature(struct gspca_dev *gspca_dev,
122 u16 selector, u16 param)
123{
124 int err;
125
126 if (gspca_dev->usb_err < 0)
127 return;
128
129 err = usb_control_msg(gspca_dev->dev,
130 usb_sndctrlpipe(gspca_dev->dev, 0),
131 SE401_REQ_SET_EXT_FEATURE,
132 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
133 param, selector, NULL, 0, 1000);
134 if (err < 0) {
Joe Perches133a9fe2011-08-21 19:56:57 -0300135 pr_err("set feature failed sel %#04x param %#04x error %d\n",
136 selector, param, err);
Hans de Goedec27cea02011-06-05 07:44:34 -0300137 gspca_dev->usb_err = err;
138 }
139}
140
141static int se401_get_feature(struct gspca_dev *gspca_dev, u16 selector)
142{
143 int err;
144
145 if (gspca_dev->usb_err < 0)
146 return gspca_dev->usb_err;
147
148 if (USB_BUF_SZ < 2) {
Joe Perches133a9fe2011-08-21 19:56:57 -0300149 pr_err("USB_BUF_SZ too small!!\n");
Hans de Goedec27cea02011-06-05 07:44:34 -0300150 gspca_dev->usb_err = -ENOBUFS;
151 return gspca_dev->usb_err;
152 }
153
154 err = usb_control_msg(gspca_dev->dev,
155 usb_rcvctrlpipe(gspca_dev->dev, 0),
156 SE401_REQ_GET_EXT_FEATURE,
157 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
158 0, selector, gspca_dev->usb_buf, 2, 1000);
159 if (err < 0) {
Joe Perches133a9fe2011-08-21 19:56:57 -0300160 pr_err("get feature failed sel %#04x error %d\n",
161 selector, err);
Hans de Goedec27cea02011-06-05 07:44:34 -0300162 gspca_dev->usb_err = err;
163 return err;
164 }
165 return gspca_dev->usb_buf[0] | (gspca_dev->usb_buf[1] << 8);
166}
167
Hans Verkuil5262eee2012-05-16 07:14:14 -0300168static void setbrightness(struct gspca_dev *gspca_dev, s32 val)
Hans de Goedec27cea02011-06-05 07:44:34 -0300169{
Hans de Goedec27cea02011-06-05 07:44:34 -0300170 /* HDG: this does not seem to do anything on my cam */
Hans Verkuil5262eee2012-05-16 07:14:14 -0300171 se401_write_req(gspca_dev, SE401_REQ_SET_BRT, val, 0);
Hans de Goedec27cea02011-06-05 07:44:34 -0300172}
173
Hans Verkuil5262eee2012-05-16 07:14:14 -0300174static void setgain(struct gspca_dev *gspca_dev, s32 val)
Hans de Goedec27cea02011-06-05 07:44:34 -0300175{
Hans Verkuil5262eee2012-05-16 07:14:14 -0300176 u16 gain = 63 - val;
Hans de Goedec27cea02011-06-05 07:44:34 -0300177
178 /* red color gain */
179 se401_set_feature(gspca_dev, HV7131_REG_ARCG, gain);
180 /* green color gain */
181 se401_set_feature(gspca_dev, HV7131_REG_AGCG, gain);
182 /* blue color gain */
183 se401_set_feature(gspca_dev, HV7131_REG_ABCG, gain);
184}
185
Hans Verkuil5262eee2012-05-16 07:14:14 -0300186static void setexposure(struct gspca_dev *gspca_dev, s32 val, s32 freq)
Hans de Goedec27cea02011-06-05 07:44:34 -0300187{
188 struct sd *sd = (struct sd *) gspca_dev;
Hans Verkuil5262eee2012-05-16 07:14:14 -0300189 int integration = val << 6;
Hans de Goedec27cea02011-06-05 07:44:34 -0300190 u8 expose_h, expose_m, expose_l;
191
192 /* Do this before the set_feature calls, for proper timing wrt
193 the interrupt driven pkt_scan. Note we may still race but that
194 is not a big issue, the expo change state machine is merely for
195 avoiding underexposed frames getting send out, if one sneaks
196 through so be it */
197 sd->expo_change_state = EXPO_CHANGED;
198
Hans Verkuil5262eee2012-05-16 07:14:14 -0300199 if (freq == V4L2_CID_POWER_LINE_FREQUENCY_50HZ)
Hans de Goedec27cea02011-06-05 07:44:34 -0300200 integration = integration - integration % 106667;
Hans Verkuil5262eee2012-05-16 07:14:14 -0300201 if (freq == V4L2_CID_POWER_LINE_FREQUENCY_60HZ)
Hans de Goedec27cea02011-06-05 07:44:34 -0300202 integration = integration - integration % 88889;
203
204 expose_h = (integration >> 16);
205 expose_m = (integration >> 8);
206 expose_l = integration;
207
208 /* integration time low */
209 se401_set_feature(gspca_dev, HV7131_REG_TITL, expose_l);
210 /* integration time mid */
211 se401_set_feature(gspca_dev, HV7131_REG_TITM, expose_m);
212 /* integration time high */
213 se401_set_feature(gspca_dev, HV7131_REG_TITU, expose_h);
214}
215
216static int sd_config(struct gspca_dev *gspca_dev,
217 const struct usb_device_id *id)
218{
219 struct sd *sd = (struct sd *)gspca_dev;
220 struct cam *cam = &gspca_dev->cam;
221 u8 *cd = gspca_dev->usb_buf;
222 int i, j, n;
223 int widths[MAX_MODES], heights[MAX_MODES];
224
225 /* Read the camera descriptor */
226 se401_read_req(gspca_dev, SE401_REQ_GET_CAMERA_DESCRIPTOR, 1);
227 if (gspca_dev->usb_err) {
228 /* Sometimes after being idle for a while the se401 won't
229 respond and needs a good kicking */
230 usb_reset_device(gspca_dev->dev);
231 gspca_dev->usb_err = 0;
232 se401_read_req(gspca_dev, SE401_REQ_GET_CAMERA_DESCRIPTOR, 0);
233 }
234
235 /* Some cameras start with their LED on */
236 se401_write_req(gspca_dev, SE401_REQ_LED_CONTROL, 0, 0);
237 if (gspca_dev->usb_err)
238 return gspca_dev->usb_err;
239
240 if (cd[1] != 0x41) {
Joe Perches133a9fe2011-08-21 19:56:57 -0300241 pr_err("Wrong descriptor type\n");
Hans de Goedec27cea02011-06-05 07:44:34 -0300242 return -ENODEV;
243 }
244
245 if (!(cd[2] & SE401_FORMAT_BAYER)) {
Joe Perches133a9fe2011-08-21 19:56:57 -0300246 pr_err("Bayer format not supported!\n");
Hans de Goedec27cea02011-06-05 07:44:34 -0300247 return -ENODEV;
248 }
249
250 if (cd[3])
Joe Perches133a9fe2011-08-21 19:56:57 -0300251 pr_info("ExtraFeatures: %d\n", cd[3]);
Hans de Goedec27cea02011-06-05 07:44:34 -0300252
253 n = cd[4] | (cd[5] << 8);
254 if (n > MAX_MODES) {
Joe Perches133a9fe2011-08-21 19:56:57 -0300255 pr_err("Too many frame sizes\n");
Hans de Goedec27cea02011-06-05 07:44:34 -0300256 return -ENODEV;
257 }
258
259 for (i = 0; i < n ; i++) {
260 widths[i] = cd[6 + i * 4 + 0] | (cd[6 + i * 4 + 1] << 8);
261 heights[i] = cd[6 + i * 4 + 2] | (cd[6 + i * 4 + 3] << 8);
262 }
263
264 for (i = 0; i < n ; i++) {
265 sd->fmts[i].width = widths[i];
266 sd->fmts[i].height = heights[i];
267 sd->fmts[i].field = V4L2_FIELD_NONE;
268 sd->fmts[i].colorspace = V4L2_COLORSPACE_SRGB;
269 sd->fmts[i].priv = 1;
270
271 /* janggu compression only works for 1/4th or 1/16th res */
272 for (j = 0; j < n; j++) {
273 if (widths[j] / 2 == widths[i] &&
274 heights[j] / 2 == heights[i]) {
275 sd->fmts[i].priv = 2;
276 break;
277 }
278 }
279 /* 1/16th if available too is better then 1/4th, because
280 we then use a larger area of the sensor */
281 for (j = 0; j < n; j++) {
282 if (widths[j] / 4 == widths[i] &&
283 heights[j] / 4 == heights[i]) {
284 sd->fmts[i].priv = 4;
285 break;
286 }
287 }
288
289 if (sd->fmts[i].priv == 1) {
290 /* Not a 1/4th or 1/16th res, use bayer */
291 sd->fmts[i].pixelformat = V4L2_PIX_FMT_SBGGR8;
292 sd->fmts[i].bytesperline = widths[i];
293 sd->fmts[i].sizeimage = widths[i] * heights[i];
Joe Perches133a9fe2011-08-21 19:56:57 -0300294 pr_info("Frame size: %dx%d bayer\n",
295 widths[i], heights[i]);
Hans de Goedec27cea02011-06-05 07:44:34 -0300296 } else {
297 /* Found a match use janggu compression */
298 sd->fmts[i].pixelformat = V4L2_PIX_FMT_SE401;
299 sd->fmts[i].bytesperline = 0;
300 sd->fmts[i].sizeimage = widths[i] * heights[i] * 3;
Joe Perches133a9fe2011-08-21 19:56:57 -0300301 pr_info("Frame size: %dx%d 1/%dth janggu\n",
302 widths[i], heights[i],
303 sd->fmts[i].priv * sd->fmts[i].priv);
Hans de Goedec27cea02011-06-05 07:44:34 -0300304 }
305 }
306
307 cam->cam_mode = sd->fmts;
308 cam->nmodes = n;
309 cam->bulk = 1;
310 cam->bulk_size = BULK_SIZE;
311 cam->bulk_nurbs = 4;
Hans de Goedec27cea02011-06-05 07:44:34 -0300312 sd->resetlevel = 0x2d; /* Set initial resetlevel */
313
314 /* See if the camera supports brightness */
315 se401_read_req(gspca_dev, SE401_REQ_GET_BRT, 1);
Hans Verkuil5262eee2012-05-16 07:14:14 -0300316 sd->has_brightness = !!gspca_dev->usb_err;
317 gspca_dev->usb_err = 0;
Hans de Goedec27cea02011-06-05 07:44:34 -0300318
319 return 0;
320}
321
322/* this function is called at probe and resume time */
323static int sd_init(struct gspca_dev *gspca_dev)
324{
325 return 0;
326}
327
Jean-François Moine6121ca52011-11-30 05:54:16 -0300328/* function called at start time before URB creation */
329static int sd_isoc_init(struct gspca_dev *gspca_dev)
330{
331 gspca_dev->alt = 1; /* Ignore the bogus isoc alt settings */
332
333 return gspca_dev->usb_err;
334}
335
Hans de Goedec27cea02011-06-05 07:44:34 -0300336/* -- start the camera -- */
337static int sd_start(struct gspca_dev *gspca_dev)
338{
339 struct sd *sd = (struct sd *)gspca_dev;
340 int mult = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv;
341 int mode = 0;
342
343 se401_write_req(gspca_dev, SE401_REQ_CAMERA_POWER, 1, 1);
344 if (gspca_dev->usb_err) {
345 /* Sometimes after being idle for a while the se401 won't
346 respond and needs a good kicking */
347 usb_reset_device(gspca_dev->dev);
348 gspca_dev->usb_err = 0;
349 se401_write_req(gspca_dev, SE401_REQ_CAMERA_POWER, 1, 0);
350 }
351 se401_write_req(gspca_dev, SE401_REQ_LED_CONTROL, 1, 0);
352
353 se401_set_feature(gspca_dev, HV7131_REG_MODE_B, 0x05);
354
355 /* set size + mode */
356 se401_write_req(gspca_dev, SE401_REQ_SET_WIDTH,
357 gspca_dev->width * mult, 0);
358 se401_write_req(gspca_dev, SE401_REQ_SET_HEIGHT,
359 gspca_dev->height * mult, 0);
360 /*
361 * HDG: disabled this as it does not seem to do anything
362 * se401_write_req(gspca_dev, SE401_REQ_SET_OUTPUT_MODE,
363 * SE401_FORMAT_BAYER, 0);
364 */
365
366 switch (mult) {
367 case 1: /* Raw bayer */
368 mode = 0x03; break;
369 case 2: /* 1/4th janggu */
370 mode = SE401_QUANT_FACT << 4; break;
371 case 4: /* 1/16th janggu */
372 mode = (SE401_QUANT_FACT << 4) | 0x02; break;
373 }
374 se401_set_feature(gspca_dev, SE401_OPERATINGMODE, mode);
375
Hans Verkuil5262eee2012-05-16 07:14:14 -0300376 v4l2_ctrl_handler_setup(&gspca_dev->ctrl_handler);
Hans de Goedec27cea02011-06-05 07:44:34 -0300377 se401_set_feature(gspca_dev, HV7131_REG_ARLV, sd->resetlevel);
378
379 sd->packet_read = 0;
380 sd->pixels_read = 0;
381 sd->restart_stream = 0;
382 sd->resetlevel_frame_count = 0;
383 sd->resetlevel_adjust_dir = 0;
384 sd->expo_change_state = EXPO_NO_CHANGE;
385
386 se401_write_req(gspca_dev, SE401_REQ_START_CONTINUOUS_CAPTURE, 0, 0);
387
388 return gspca_dev->usb_err;
389}
390
391static void sd_stopN(struct gspca_dev *gspca_dev)
392{
393 se401_write_req(gspca_dev, SE401_REQ_STOP_CONTINUOUS_CAPTURE, 0, 0);
394 se401_write_req(gspca_dev, SE401_REQ_LED_CONTROL, 0, 0);
395 se401_write_req(gspca_dev, SE401_REQ_CAMERA_POWER, 0, 0);
396}
397
398static void sd_dq_callback(struct gspca_dev *gspca_dev)
399{
400 struct sd *sd = (struct sd *)gspca_dev;
401 unsigned int ahrc, alrc;
402 int oldreset, adjust_dir;
403
404 /* Restart the stream if requested do so by pkt_scan */
405 if (sd->restart_stream) {
406 sd_stopN(gspca_dev);
407 sd_start(gspca_dev);
408 sd->restart_stream = 0;
409 }
410
411 /* Automatically adjust sensor reset level
412 Hyundai have some really nice docs about this and other sensor
413 related stuff on their homepage: www.hei.co.kr */
414 sd->resetlevel_frame_count++;
415 if (sd->resetlevel_frame_count < 20)
416 return;
417
418 /* For some reason this normally read-only register doesn't get reset
419 to zero after reading them just once... */
420 se401_get_feature(gspca_dev, HV7131_REG_HIREFNOH);
421 se401_get_feature(gspca_dev, HV7131_REG_HIREFNOL);
422 se401_get_feature(gspca_dev, HV7131_REG_LOREFNOH);
423 se401_get_feature(gspca_dev, HV7131_REG_LOREFNOL);
424 ahrc = 256*se401_get_feature(gspca_dev, HV7131_REG_HIREFNOH) +
425 se401_get_feature(gspca_dev, HV7131_REG_HIREFNOL);
426 alrc = 256*se401_get_feature(gspca_dev, HV7131_REG_LOREFNOH) +
427 se401_get_feature(gspca_dev, HV7131_REG_LOREFNOL);
428
429 /* Not an exact science, but it seems to work pretty well... */
430 oldreset = sd->resetlevel;
431 if (alrc > 10) {
432 while (alrc >= 10 && sd->resetlevel < 63) {
433 sd->resetlevel++;
434 alrc /= 2;
435 }
436 } else if (ahrc > 20) {
437 while (ahrc >= 20 && sd->resetlevel > 0) {
438 sd->resetlevel--;
439 ahrc /= 2;
440 }
441 }
442 /* Detect ping-pong-ing and halve adjustment to avoid overshoot */
443 if (sd->resetlevel > oldreset)
444 adjust_dir = 1;
445 else
446 adjust_dir = -1;
447 if (sd->resetlevel_adjust_dir &&
448 sd->resetlevel_adjust_dir != adjust_dir)
449 sd->resetlevel = oldreset + (sd->resetlevel - oldreset) / 2;
450
451 if (sd->resetlevel != oldreset) {
452 sd->resetlevel_adjust_dir = adjust_dir;
453 se401_set_feature(gspca_dev, HV7131_REG_ARLV, sd->resetlevel);
454 }
455
456 sd->resetlevel_frame_count = 0;
457}
458
459static void sd_complete_frame(struct gspca_dev *gspca_dev, u8 *data, int len)
460{
461 struct sd *sd = (struct sd *)gspca_dev;
462
463 switch (sd->expo_change_state) {
464 case EXPO_CHANGED:
465 /* The exposure was changed while this frame
466 was being send, so this frame is ok */
467 sd->expo_change_state = EXPO_DROP_FRAME;
468 break;
469 case EXPO_DROP_FRAME:
470 /* The exposure was changed while this frame
471 was being captured, drop it! */
472 gspca_dev->last_packet_type = DISCARD_PACKET;
473 sd->expo_change_state = EXPO_NO_CHANGE;
474 break;
475 case EXPO_NO_CHANGE:
476 break;
477 }
478 gspca_frame_add(gspca_dev, LAST_PACKET, data, len);
479}
480
481static void sd_pkt_scan_janggu(struct gspca_dev *gspca_dev, u8 *data, int len)
482{
483 struct sd *sd = (struct sd *)gspca_dev;
484 int imagesize = gspca_dev->width * gspca_dev->height;
485 int i, plen, bits, pixels, info, count;
486
487 if (sd->restart_stream)
488 return;
489
490 /* Sometimes a 1024 bytes garbage bulk packet is send between frames */
491 if (gspca_dev->last_packet_type == LAST_PACKET && len == 1024) {
492 gspca_dev->last_packet_type = DISCARD_PACKET;
493 return;
494 }
495
496 i = 0;
497 while (i < len) {
498 /* Read header if not already be present from prev bulk pkt */
499 if (sd->packet_read < 4) {
500 count = 4 - sd->packet_read;
501 if (count > len - i)
502 count = len - i;
503 memcpy(&sd->packet[sd->packet_read], &data[i], count);
504 sd->packet_read += count;
505 i += count;
506 if (sd->packet_read < 4)
507 break;
508 }
509 bits = sd->packet[3] + (sd->packet[2] << 8);
510 pixels = sd->packet[1] + ((sd->packet[0] & 0x3f) << 8);
511 info = (sd->packet[0] & 0xc0) >> 6;
512 plen = ((bits + 47) >> 4) << 1;
513 /* Sanity checks */
514 if (plen > 1024) {
Joe Perches133a9fe2011-08-21 19:56:57 -0300515 pr_err("invalid packet len %d restarting stream\n",
516 plen);
Hans de Goedec27cea02011-06-05 07:44:34 -0300517 goto error;
518 }
519 if (info == 3) {
Joe Perches133a9fe2011-08-21 19:56:57 -0300520 pr_err("unknown frame info value restarting stream\n");
Hans de Goedec27cea02011-06-05 07:44:34 -0300521 goto error;
522 }
523
524 /* Read (remainder of) packet contents */
525 count = plen - sd->packet_read;
526 if (count > len - i)
527 count = len - i;
528 memcpy(&sd->packet[sd->packet_read], &data[i], count);
529 sd->packet_read += count;
530 i += count;
531 if (sd->packet_read < plen)
532 break;
533
534 sd->pixels_read += pixels;
535 sd->packet_read = 0;
536
537 switch (info) {
538 case 0: /* Frame data */
539 gspca_frame_add(gspca_dev, INTER_PACKET, sd->packet,
540 plen);
541 break;
542 case 1: /* EOF */
543 if (sd->pixels_read != imagesize) {
Joe Perches133a9fe2011-08-21 19:56:57 -0300544 pr_err("frame size %d expected %d\n",
545 sd->pixels_read, imagesize);
Hans de Goedec27cea02011-06-05 07:44:34 -0300546 goto error;
547 }
548 sd_complete_frame(gspca_dev, sd->packet, plen);
549 return; /* Discard the rest of the bulk packet !! */
550 case 2: /* SOF */
551 gspca_frame_add(gspca_dev, FIRST_PACKET, sd->packet,
552 plen);
553 sd->pixels_read = pixels;
554 break;
555 }
556 }
557 return;
558
559error:
560 sd->restart_stream = 1;
561 /* Give userspace a 0 bytes frame, so our dq callback gets
562 called and it can restart the stream */
563 gspca_frame_add(gspca_dev, FIRST_PACKET, NULL, 0);
564 gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0);
565}
566
567static void sd_pkt_scan_bayer(struct gspca_dev *gspca_dev, u8 *data, int len)
568{
569 struct cam *cam = &gspca_dev->cam;
570 int imagesize = cam->cam_mode[gspca_dev->curr_mode].sizeimage;
571
572 if (gspca_dev->image_len == 0) {
573 gspca_frame_add(gspca_dev, FIRST_PACKET, data, len);
574 return;
575 }
576
577 if (gspca_dev->image_len + len >= imagesize) {
578 sd_complete_frame(gspca_dev, data, len);
579 return;
580 }
581
582 gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
583}
584
585static void sd_pkt_scan(struct gspca_dev *gspca_dev, u8 *data, int len)
586{
587 int mult = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv;
588
589 if (len == 0)
590 return;
591
592 if (mult == 1) /* mult == 1 means raw bayer */
593 sd_pkt_scan_bayer(gspca_dev, data, len);
594 else
595 sd_pkt_scan_janggu(gspca_dev, data, len);
596}
597
Hans de Goedec27cea02011-06-05 07:44:34 -0300598#if defined(CONFIG_INPUT) || defined(CONFIG_INPUT_MODULE)
599static int sd_int_pkt_scan(struct gspca_dev *gspca_dev, u8 *data, int len)
600{
601 struct sd *sd = (struct sd *)gspca_dev;
602 u8 state;
603
604 if (len != 2)
605 return -EINVAL;
606
607 switch (data[0]) {
608 case 0:
609 case 1:
610 state = data[0];
611 break;
612 default:
613 return -EINVAL;
614 }
615 if (sd->button_state != state) {
616 input_report_key(gspca_dev->input_dev, KEY_CAMERA, state);
617 input_sync(gspca_dev->input_dev);
618 sd->button_state = state;
619 }
620
621 return 0;
622}
623#endif
624
Hans Verkuil5262eee2012-05-16 07:14:14 -0300625static int sd_s_ctrl(struct v4l2_ctrl *ctrl)
626{
627 struct gspca_dev *gspca_dev =
628 container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
629 struct sd *sd = (struct sd *)gspca_dev;
630
631 gspca_dev->usb_err = 0;
632
633 if (!gspca_dev->streaming)
634 return 0;
635
636 switch (ctrl->id) {
637 case V4L2_CID_BRIGHTNESS:
638 setbrightness(gspca_dev, ctrl->val);
639 break;
640 case V4L2_CID_GAIN:
641 setgain(gspca_dev, ctrl->val);
642 break;
643 case V4L2_CID_EXPOSURE:
644 setexposure(gspca_dev, ctrl->val, sd->freq->val);
645 break;
646 }
647 return gspca_dev->usb_err;
648}
649
650static const struct v4l2_ctrl_ops sd_ctrl_ops = {
651 .s_ctrl = sd_s_ctrl,
652};
653
654static int sd_init_controls(struct gspca_dev *gspca_dev)
655{
656 struct sd *sd = (struct sd *)gspca_dev;
657 struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler;
658
659 gspca_dev->vdev.ctrl_handler = hdl;
660 v4l2_ctrl_handler_init(hdl, 4);
661 if (sd->has_brightness)
662 v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
663 V4L2_CID_BRIGHTNESS, 0, 255, 1, 15);
664 /* max is really 63 but > 50 is not pretty */
665 v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
666 V4L2_CID_GAIN, 0, 50, 1, 25);
667 sd->exposure = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
668 V4L2_CID_EXPOSURE, 0, 32767, 1, 15000);
669 sd->freq = v4l2_ctrl_new_std_menu(hdl, &sd_ctrl_ops,
670 V4L2_CID_POWER_LINE_FREQUENCY,
671 V4L2_CID_POWER_LINE_FREQUENCY_60HZ, 0, 0);
672
673 if (hdl->error) {
674 pr_err("Could not initialize controls\n");
675 return hdl->error;
676 }
677 v4l2_ctrl_cluster(2, &sd->exposure);
678 return 0;
679}
680
Hans de Goedec27cea02011-06-05 07:44:34 -0300681/* sub-driver description */
682static const struct sd_desc sd_desc = {
683 .name = MODULE_NAME,
Hans de Goedec27cea02011-06-05 07:44:34 -0300684 .config = sd_config,
685 .init = sd_init,
Hans Verkuil5262eee2012-05-16 07:14:14 -0300686 .init_controls = sd_init_controls,
Jean-François Moine6121ca52011-11-30 05:54:16 -0300687 .isoc_init = sd_isoc_init,
Hans de Goedec27cea02011-06-05 07:44:34 -0300688 .start = sd_start,
689 .stopN = sd_stopN,
690 .dq_callback = sd_dq_callback,
691 .pkt_scan = sd_pkt_scan,
Hans de Goedec27cea02011-06-05 07:44:34 -0300692#if defined(CONFIG_INPUT) || defined(CONFIG_INPUT_MODULE)
693 .int_pkt_scan = sd_int_pkt_scan,
694#endif
695};
696
697/* -- module initialisation -- */
698static const struct usb_device_id device_table[] = {
699 {USB_DEVICE(0x03e8, 0x0004)}, /* Endpoints/Aox SE401 */
700 {USB_DEVICE(0x0471, 0x030b)}, /* Philips PCVC665K */
701 {USB_DEVICE(0x047d, 0x5001)}, /* Kensington 67014 */
702 {USB_DEVICE(0x047d, 0x5002)}, /* Kensington 6701(5/7) */
703 {USB_DEVICE(0x047d, 0x5003)}, /* Kensington 67016 */
704 {}
705};
706MODULE_DEVICE_TABLE(usb, device_table);
707
708/* -- device connect -- */
709static int sd_probe(struct usb_interface *intf,
710 const struct usb_device_id *id)
711{
712 return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
713 THIS_MODULE);
714}
715
716static int sd_pre_reset(struct usb_interface *intf)
717{
718 return 0;
719}
720
721static int sd_post_reset(struct usb_interface *intf)
722{
723 return 0;
724}
725
726static struct usb_driver sd_driver = {
727 .name = MODULE_NAME,
728 .id_table = device_table,
729 .probe = sd_probe,
730 .disconnect = gspca_disconnect,
731#ifdef CONFIG_PM
732 .suspend = gspca_suspend,
733 .resume = gspca_resume,
734#endif
735 .pre_reset = sd_pre_reset,
736 .post_reset = sd_post_reset,
737};
738
Greg Kroah-Hartmanecb3b2b2011-11-18 09:46:12 -0800739module_usb_driver(sd_driver);