2 * Pixart PAC207BCA library
4 * Copyright (C) 2008 Hans de Goede <hdgoede@redhat.com>
5 * Copyright (C) 2005 Thomas Kaiser thomas@kaiser-linux.li
6 * Copyleft (C) 2005 Michel Xhaard mxhaard@magic.fr
8 * V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
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.
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.
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
26 #define MODULE_NAME "pac207"
30 MODULE_AUTHOR("Hans de Goede <hdgoede@redhat.com>");
31 MODULE_DESCRIPTION("Pixart PAC207");
32 MODULE_LICENSE("GPL");
34 #define PAC207_CTRL_TIMEOUT 100 /* ms */
36 #define PAC207_BRIGHTNESS_MIN 0
37 #define PAC207_BRIGHTNESS_MAX 255
38 #define PAC207_BRIGHTNESS_DEFAULT 4 /* power on default: 4 */
40 /* An exposure value of 4 also works (3 does not) but then we need to lower
41 the compression balance setting when in 352x288 mode, otherwise the usb
42 bandwidth is not enough and packets get dropped resulting in corrupt
43 frames. The problem with this is that when the compression balance gets
44 lowered below 0x80, the pac207 starts using a different compression
45 algorithm for some lines, these lines get prefixed with a 0x2dd2 prefix
46 and currently we do not know how to decompress these lines, so for now
47 we use a minimum exposure value of 5 */
48 #define PAC207_EXPOSURE_MIN 5
49 #define PAC207_EXPOSURE_MAX 26
50 #define PAC207_EXPOSURE_DEFAULT 5 /* power on default: 3 ?? */
51 #define PAC207_EXPOSURE_KNEE 11 /* 4 = 30 fps, 11 = 8, 15 = 6 */
53 #define PAC207_GAIN_MIN 0
54 #define PAC207_GAIN_MAX 31
55 #define PAC207_GAIN_DEFAULT 9 /* power on default: 9 */
56 #define PAC207_GAIN_KNEE 20
58 #define PAC207_AUTOGAIN_DEADZONE 30
60 /* specific webcam descriptor */
62 struct gspca_dev gspca_dev
; /* !! must be the first item */
73 u8 autogain_ignore_frames
;
78 /* V4L2 controls supported by the driver */
79 static int sd_setbrightness(struct gspca_dev
*gspca_dev
, __s32 val
);
80 static int sd_getbrightness(struct gspca_dev
*gspca_dev
, __s32
*val
);
81 static int sd_setexposure(struct gspca_dev
*gspca_dev
, __s32 val
);
82 static int sd_getexposure(struct gspca_dev
*gspca_dev
, __s32
*val
);
83 static int sd_setautogain(struct gspca_dev
*gspca_dev
, __s32 val
);
84 static int sd_getautogain(struct gspca_dev
*gspca_dev
, __s32
*val
);
85 static int sd_setgain(struct gspca_dev
*gspca_dev
, __s32 val
);
86 static int sd_getgain(struct gspca_dev
*gspca_dev
, __s32
*val
);
88 static struct ctrl sd_ctrls
[] = {
89 #define SD_BRIGHTNESS 0
92 .id
= V4L2_CID_BRIGHTNESS
,
93 .type
= V4L2_CTRL_TYPE_INTEGER
,
95 .minimum
= PAC207_BRIGHTNESS_MIN
,
96 .maximum
= PAC207_BRIGHTNESS_MAX
,
98 .default_value
= PAC207_BRIGHTNESS_DEFAULT
,
101 .set
= sd_setbrightness
,
102 .get
= sd_getbrightness
,
104 #define SD_EXPOSURE 1
107 .id
= V4L2_CID_EXPOSURE
,
108 .type
= V4L2_CTRL_TYPE_INTEGER
,
110 .minimum
= PAC207_EXPOSURE_MIN
,
111 .maximum
= PAC207_EXPOSURE_MAX
,
113 .default_value
= PAC207_EXPOSURE_DEFAULT
,
116 .set
= sd_setexposure
,
117 .get
= sd_getexposure
,
119 #define SD_AUTOGAIN 2
122 .id
= V4L2_CID_AUTOGAIN
,
123 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
128 #define AUTOGAIN_DEF 1
129 .default_value
= AUTOGAIN_DEF
,
132 .set
= sd_setautogain
,
133 .get
= sd_getautogain
,
139 .type
= V4L2_CTRL_TYPE_INTEGER
,
141 .minimum
= PAC207_GAIN_MIN
,
142 .maximum
= PAC207_GAIN_MAX
,
144 .default_value
= PAC207_GAIN_DEFAULT
,
152 static const struct v4l2_pix_format sif_mode
[] = {
153 {176, 144, V4L2_PIX_FMT_PAC207
, V4L2_FIELD_NONE
,
155 .sizeimage
= (176 + 2) * 144,
156 /* uncompressed, add 2 bytes / line for line header */
157 .colorspace
= V4L2_COLORSPACE_SRGB
,
159 {352, 288, V4L2_PIX_FMT_PAC207
, V4L2_FIELD_NONE
,
161 /* compressed, but only when needed (not compressed
162 when the framerate is low) */
163 .sizeimage
= (352 + 2) * 288,
164 .colorspace
= V4L2_COLORSPACE_SRGB
,
168 static const __u8 pac207_sensor_init
[][8] = {
169 {0x10, 0x12, 0x0d, 0x12, 0x0c, 0x01, 0x29, 0xf0},
170 {0x00, 0x64, 0x64, 0x64, 0x04, 0x10, 0xf0, 0x30},
171 {0x00, 0x00, 0x00, 0x70, 0xa0, 0xf8, 0x00, 0x00},
172 {0x32, 0x00, 0x96, 0x00, 0xA2, 0x02, 0xaf, 0x00},
175 static int pac207_write_regs(struct gspca_dev
*gspca_dev
, u16 index
,
176 const u8
*buffer
, u16 length
)
178 struct usb_device
*udev
= gspca_dev
->dev
;
181 memcpy(gspca_dev
->usb_buf
, buffer
, length
);
183 err
= usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0), 0x01,
184 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
186 gspca_dev
->usb_buf
, length
, PAC207_CTRL_TIMEOUT
);
189 "Failed to write registers to index 0x%04X, error %d)",
196 static int pac207_write_reg(struct gspca_dev
*gspca_dev
, u16 index
, u16 value
)
198 struct usb_device
*udev
= gspca_dev
->dev
;
201 err
= usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0), 0x00,
202 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
203 value
, index
, NULL
, 0, PAC207_CTRL_TIMEOUT
);
205 PDEBUG(D_ERR
, "Failed to write a register (index 0x%04X,"
206 " value 0x%02X, error %d)", index
, value
, err
);
211 static int pac207_read_reg(struct gspca_dev
*gspca_dev
, u16 index
)
213 struct usb_device
*udev
= gspca_dev
->dev
;
216 res
= usb_control_msg(udev
, usb_rcvctrlpipe(udev
, 0), 0x00,
217 USB_DIR_IN
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
219 gspca_dev
->usb_buf
, 1, PAC207_CTRL_TIMEOUT
);
222 "Failed to read a register (index 0x%04X, error %d)",
227 return gspca_dev
->usb_buf
[0];
230 /* this function is called at probe time */
231 static int sd_config(struct gspca_dev
*gspca_dev
,
232 const struct usb_device_id
*id
)
234 struct sd
*sd
= (struct sd
*) gspca_dev
;
238 idreg
[0] = pac207_read_reg(gspca_dev
, 0x0000);
239 idreg
[1] = pac207_read_reg(gspca_dev
, 0x0001);
240 idreg
[0] = ((idreg
[0] & 0x0F) << 4) | ((idreg
[1] & 0xf0) >> 4);
241 idreg
[1] = idreg
[1] & 0x0f;
242 PDEBUG(D_PROBE
, "Pixart Sensor ID 0x%02X Chips ID 0x%02X",
245 if (idreg
[0] != 0x27) {
246 PDEBUG(D_PROBE
, "Error invalid sensor ID!");
251 "Pixart PAC207BCA Image Processor and Control Chip detected"
252 " (vid/pid 0x%04X:0x%04X)", id
->idVendor
, id
->idProduct
);
254 cam
= &gspca_dev
->cam
;
255 cam
->cam_mode
= sif_mode
;
256 cam
->nmodes
= ARRAY_SIZE(sif_mode
);
257 sd
->brightness
= PAC207_BRIGHTNESS_DEFAULT
;
258 sd
->exposure
= PAC207_EXPOSURE_DEFAULT
;
259 sd
->gain
= PAC207_GAIN_DEFAULT
;
260 sd
->autogain
= AUTOGAIN_DEF
;
265 /* this function is called at probe and resume time */
266 static int sd_init(struct gspca_dev
*gspca_dev
)
268 pac207_write_reg(gspca_dev
, 0x41, 0x00);
269 /* Bit_0=Image Format,
271 * Bit_2=Compression test mode enable */
272 pac207_write_reg(gspca_dev
, 0x0f, 0x00); /* Power Control */
277 /* -- start the camera -- */
278 static int sd_start(struct gspca_dev
*gspca_dev
)
280 struct sd
*sd
= (struct sd
*) gspca_dev
;
283 pac207_write_reg(gspca_dev
, 0x0f, 0x10); /* Power control (Bit 6-0) */
284 pac207_write_regs(gspca_dev
, 0x0002, pac207_sensor_init
[0], 8);
285 pac207_write_regs(gspca_dev
, 0x000a, pac207_sensor_init
[1], 8);
286 pac207_write_regs(gspca_dev
, 0x0012, pac207_sensor_init
[2], 8);
287 pac207_write_regs(gspca_dev
, 0x0042, pac207_sensor_init
[3], 8);
289 /* Compression Balance */
290 if (gspca_dev
->width
== 176)
291 pac207_write_reg(gspca_dev
, 0x4a, 0xff);
293 pac207_write_reg(gspca_dev
, 0x4a, 0x88);
294 pac207_write_reg(gspca_dev
, 0x4b, 0x00); /* Sram test value */
295 pac207_write_reg(gspca_dev
, 0x08, sd
->brightness
);
297 /* PGA global gain (Bit 4-0) */
298 pac207_write_reg(gspca_dev
, 0x0e, sd
->gain
);
299 pac207_write_reg(gspca_dev
, 0x02, sd
->exposure
); /* PXCK = 12MHz /n */
301 mode
= 0x02; /* Image Format (Bit 0), LED (1), Compr. test mode (2) */
302 if (gspca_dev
->width
== 176) { /* 176x144 */
304 PDEBUG(D_STREAM
, "pac207_start mode 176x144");
305 } else { /* 352x288 */
306 PDEBUG(D_STREAM
, "pac207_start mode 352x288");
308 pac207_write_reg(gspca_dev
, 0x41, mode
);
310 pac207_write_reg(gspca_dev
, 0x13, 0x01); /* Bit 0, auto clear */
311 pac207_write_reg(gspca_dev
, 0x1c, 0x01); /* not documented */
313 pac207_write_reg(gspca_dev
, 0x40, 0x01); /* Start ISO pipe */
316 sd
->autogain_ignore_frames
= 0;
317 atomic_set(&sd
->avg_lum
, -1);
321 static void sd_stopN(struct gspca_dev
*gspca_dev
)
323 pac207_write_reg(gspca_dev
, 0x40, 0x00); /* Stop ISO pipe */
324 pac207_write_reg(gspca_dev
, 0x41, 0x00); /* Turn of LED */
325 pac207_write_reg(gspca_dev
, 0x0f, 0x00); /* Power Control */
328 /* Include pac common sof detection functions */
329 #include "pac_common.h"
331 static void pac207_do_auto_gain(struct gspca_dev
*gspca_dev
)
333 struct sd
*sd
= (struct sd
*) gspca_dev
;
334 int avg_lum
= atomic_read(&sd
->avg_lum
);
339 if (sd
->autogain_ignore_frames
> 0)
340 sd
->autogain_ignore_frames
--;
341 else if (gspca_auto_gain_n_exposure(gspca_dev
, avg_lum
,
342 100 + sd
->brightness
/ 2, PAC207_AUTOGAIN_DEADZONE
,
343 PAC207_GAIN_KNEE
, PAC207_EXPOSURE_KNEE
))
344 sd
->autogain_ignore_frames
= PAC_AUTOGAIN_IGNORE_FRAMES
;
347 static void sd_pkt_scan(struct gspca_dev
*gspca_dev
,
348 struct gspca_frame
*frame
,
352 struct sd
*sd
= (struct sd
*) gspca_dev
;
355 sof
= pac_find_sof(gspca_dev
, data
, len
);
359 /* finish decoding current frame */
361 if (n
> sizeof pac_sof_marker
)
362 n
-= sizeof pac_sof_marker
;
365 frame
= gspca_frame_add(gspca_dev
, LAST_PACKET
, frame
,
368 gspca_frame_add(gspca_dev
, FIRST_PACKET
, frame
, NULL
, 0);
372 if (sd
->header_read
< 11) {
375 /* get average lumination from frame header (byte 5) */
376 if (sd
->header_read
< 5) {
377 needed
= 5 - sd
->header_read
;
379 atomic_set(&sd
->avg_lum
, data
[needed
- 1]);
381 /* skip the rest of the header */
382 needed
= 11 - sd
->header_read
;
384 sd
->header_read
+= len
;
389 sd
->header_read
= 11;
392 gspca_frame_add(gspca_dev
, INTER_PACKET
, frame
, data
, len
);
395 static void setbrightness(struct gspca_dev
*gspca_dev
)
397 struct sd
*sd
= (struct sd
*) gspca_dev
;
399 pac207_write_reg(gspca_dev
, 0x08, sd
->brightness
);
400 pac207_write_reg(gspca_dev
, 0x13, 0x01); /* Bit 0, auto clear */
401 pac207_write_reg(gspca_dev
, 0x1c, 0x01); /* not documented */
404 static void setexposure(struct gspca_dev
*gspca_dev
)
406 struct sd
*sd
= (struct sd
*) gspca_dev
;
408 pac207_write_reg(gspca_dev
, 0x02, sd
->exposure
);
409 pac207_write_reg(gspca_dev
, 0x13, 0x01); /* Bit 0, auto clear */
410 pac207_write_reg(gspca_dev
, 0x1c, 0x01); /* not documented */
413 static void setgain(struct gspca_dev
*gspca_dev
)
415 struct sd
*sd
= (struct sd
*) gspca_dev
;
417 pac207_write_reg(gspca_dev
, 0x0e, sd
->gain
);
418 pac207_write_reg(gspca_dev
, 0x13, 0x01); /* Bit 0, auto clear */
419 pac207_write_reg(gspca_dev
, 0x1c, 0x01); /* not documented */
422 static int sd_setbrightness(struct gspca_dev
*gspca_dev
, __s32 val
)
424 struct sd
*sd
= (struct sd
*) gspca_dev
;
426 sd
->brightness
= val
;
427 if (gspca_dev
->streaming
)
428 setbrightness(gspca_dev
);
432 static int sd_getbrightness(struct gspca_dev
*gspca_dev
, __s32
*val
)
434 struct sd
*sd
= (struct sd
*) gspca_dev
;
436 *val
= sd
->brightness
;
440 static int sd_setexposure(struct gspca_dev
*gspca_dev
, __s32 val
)
442 struct sd
*sd
= (struct sd
*) gspca_dev
;
445 if (gspca_dev
->streaming
)
446 setexposure(gspca_dev
);
450 static int sd_getexposure(struct gspca_dev
*gspca_dev
, __s32
*val
)
452 struct sd
*sd
= (struct sd
*) gspca_dev
;
458 static int sd_setgain(struct gspca_dev
*gspca_dev
, __s32 val
)
460 struct sd
*sd
= (struct sd
*) gspca_dev
;
463 if (gspca_dev
->streaming
)
468 static int sd_getgain(struct gspca_dev
*gspca_dev
, __s32
*val
)
470 struct sd
*sd
= (struct sd
*) gspca_dev
;
476 static int sd_setautogain(struct gspca_dev
*gspca_dev
, __s32 val
)
478 struct sd
*sd
= (struct sd
*) gspca_dev
;
481 /* when switching to autogain set defaults to make sure
482 we are on a valid point of the autogain gain /
483 exposure knee graph, and give this change time to
484 take effect before doing autogain. */
486 sd
->exposure
= PAC207_EXPOSURE_DEFAULT
;
487 sd
->gain
= PAC207_GAIN_DEFAULT
;
488 if (gspca_dev
->streaming
) {
489 sd
->autogain_ignore_frames
=
490 PAC_AUTOGAIN_IGNORE_FRAMES
;
491 setexposure(gspca_dev
);
499 static int sd_getautogain(struct gspca_dev
*gspca_dev
, __s32
*val
)
501 struct sd
*sd
= (struct sd
*) gspca_dev
;
507 /* sub-driver description */
508 static const struct sd_desc sd_desc
= {
511 .nctrls
= ARRAY_SIZE(sd_ctrls
),
516 .dq_callback
= pac207_do_auto_gain
,
517 .pkt_scan
= sd_pkt_scan
,
520 /* -- module initialisation -- */
521 static const __devinitdata
struct usb_device_id device_table
[] = {
522 {USB_DEVICE(0x041e, 0x4028)},
523 {USB_DEVICE(0x093a, 0x2460)},
524 {USB_DEVICE(0x093a, 0x2461)},
525 {USB_DEVICE(0x093a, 0x2463)},
526 {USB_DEVICE(0x093a, 0x2464)},
527 {USB_DEVICE(0x093a, 0x2468)},
528 {USB_DEVICE(0x093a, 0x2470)},
529 {USB_DEVICE(0x093a, 0x2471)},
530 {USB_DEVICE(0x093a, 0x2472)},
531 {USB_DEVICE(0x093a, 0x2474)},
532 {USB_DEVICE(0x093a, 0x2476)},
533 {USB_DEVICE(0x145f, 0x013a)},
534 {USB_DEVICE(0x2001, 0xf115)},
537 MODULE_DEVICE_TABLE(usb
, device_table
);
539 /* -- device connect -- */
540 static int sd_probe(struct usb_interface
*intf
,
541 const struct usb_device_id
*id
)
543 return gspca_dev_probe(intf
, id
, &sd_desc
, sizeof(struct sd
),
547 static struct usb_driver sd_driver
= {
549 .id_table
= device_table
,
551 .disconnect
= gspca_disconnect
,
553 .suspend
= gspca_suspend
,
554 .resume
= gspca_resume
,
558 /* -- module insert / remove -- */
559 static int __init
sd_mod_init(void)
562 ret
= usb_register(&sd_driver
);
565 PDEBUG(D_PROBE
, "registered");
568 static void __exit
sd_mod_exit(void)
570 usb_deregister(&sd_driver
);
571 PDEBUG(D_PROBE
, "deregistered");
574 module_init(sd_mod_init
);
575 module_exit(sd_mod_exit
);