1 /* Linux driver for Philips webcam
2 USB and Video4Linux interface part.
3 (C) 1999-2004 Nemosoft Unv.
4 (C) 2004-2006 Luc Saillard (luc@saillard.org)
5 (C) 2011 Hans de Goede <hdegoede@redhat.com>
7 NOTE: this version of pwc is an unofficial (modified) release of pwc & pcwx
8 driver and thus may have bugs that are not present in the original version.
9 Please send bug reports and support requests to <luc@saillard.org>.
10 The decompression routines have been implemented by reverse-engineering the
11 Nemosoft binary pwcx module. Caveat emptor.
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.
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.
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
29 #include <linux/errno.h>
30 #include <linux/init.h>
32 #include <linux/module.h>
33 #include <linux/poll.h>
34 #include <linux/vmalloc.h>
35 #include <linux/jiffies.h>
40 #define PWC_CID_CUSTOM(ctrl) ((V4L2_CID_USER_BASE | 0xf000) + custom_ ## ctrl)
42 static int pwc_g_volatile_ctrl(struct v4l2_ctrl *ctrl);
43 static int pwc_s_ctrl(struct v4l2_ctrl *ctrl);
45 static const struct v4l2_ctrl_ops pwc_ctrl_ops = {
46 .g_volatile_ctrl = pwc_g_volatile_ctrl,
50 enum { awb_indoor, awb_outdoor, awb_fl, awb_manual, awb_auto };
51 enum { custom_autocontour, custom_contour, custom_noise_reduction,
52 custom_awb_speed, custom_awb_delay,
53 custom_save_user, custom_restore_user, custom_restore_factory };
55 const char * const pwc_auto_whitebal_qmenu[] = {
56 "Indoor (Incandescant Lighting) Mode",
57 "Outdoor (Sunlight) Mode",
58 "Indoor (Fluorescent Lighting) Mode",
64 static const struct v4l2_ctrl_config pwc_auto_white_balance_cfg = {
66 .id = V4L2_CID_AUTO_WHITE_BALANCE,
67 .type = V4L2_CTRL_TYPE_MENU,
69 .qmenu = pwc_auto_whitebal_qmenu,
72 static const struct v4l2_ctrl_config pwc_autocontour_cfg = {
74 .id = PWC_CID_CUSTOM(autocontour),
75 .type = V4L2_CTRL_TYPE_BOOLEAN,
76 .name = "Auto contour",
82 static const struct v4l2_ctrl_config pwc_contour_cfg = {
84 .id = PWC_CID_CUSTOM(contour),
85 .type = V4L2_CTRL_TYPE_INTEGER,
87 .flags = V4L2_CTRL_FLAG_SLIDER,
93 static const struct v4l2_ctrl_config pwc_backlight_cfg = {
95 .id = V4L2_CID_BACKLIGHT_COMPENSATION,
96 .type = V4L2_CTRL_TYPE_BOOLEAN,
102 static const struct v4l2_ctrl_config pwc_flicker_cfg = {
103 .ops = &pwc_ctrl_ops,
104 .id = V4L2_CID_BAND_STOP_FILTER,
105 .type = V4L2_CTRL_TYPE_BOOLEAN,
111 static const struct v4l2_ctrl_config pwc_noise_reduction_cfg = {
112 .ops = &pwc_ctrl_ops,
113 .id = PWC_CID_CUSTOM(noise_reduction),
114 .type = V4L2_CTRL_TYPE_INTEGER,
115 .name = "Dynamic Noise Reduction",
121 static const struct v4l2_ctrl_config pwc_save_user_cfg = {
122 .ops = &pwc_ctrl_ops,
123 .id = PWC_CID_CUSTOM(save_user),
124 .type = V4L2_CTRL_TYPE_BUTTON,
125 .name = "Save User Settings",
128 static const struct v4l2_ctrl_config pwc_restore_user_cfg = {
129 .ops = &pwc_ctrl_ops,
130 .id = PWC_CID_CUSTOM(restore_user),
131 .type = V4L2_CTRL_TYPE_BUTTON,
132 .name = "Restore User Settings",
135 static const struct v4l2_ctrl_config pwc_restore_factory_cfg = {
136 .ops = &pwc_ctrl_ops,
137 .id = PWC_CID_CUSTOM(restore_factory),
138 .type = V4L2_CTRL_TYPE_BUTTON,
139 .name = "Restore Factory Settings",
142 static const struct v4l2_ctrl_config pwc_awb_speed_cfg = {
143 .ops = &pwc_ctrl_ops,
144 .id = PWC_CID_CUSTOM(awb_speed),
145 .type = V4L2_CTRL_TYPE_INTEGER,
146 .name = "Auto White Balance Speed",
152 static const struct v4l2_ctrl_config pwc_awb_delay_cfg = {
153 .ops = &pwc_ctrl_ops,
154 .id = PWC_CID_CUSTOM(awb_delay),
155 .type = V4L2_CTRL_TYPE_INTEGER,
156 .name = "Auto White Balance Delay",
162 int pwc_init_controls(struct pwc_device *pdev)
164 struct v4l2_ctrl_handler *hdl;
165 struct v4l2_ctrl_config cfg;
168 hdl = &pdev->ctrl_handler;
169 r = v4l2_ctrl_handler_init(hdl, 20);
173 /* Brightness, contrast, saturation, gamma */
174 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, BRIGHTNESS_FORMATTER, &def);
177 pdev->brightness = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
178 V4L2_CID_BRIGHTNESS, 0, 127, 1, def);
180 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, CONTRAST_FORMATTER, &def);
183 pdev->contrast = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
184 V4L2_CID_CONTRAST, 0, 63, 1, def);
186 if (pdev->type >= 675) {
187 if (pdev->type < 730)
188 pdev->saturation_fmt = SATURATION_MODE_FORMATTER2;
190 pdev->saturation_fmt = SATURATION_MODE_FORMATTER1;
191 r = pwc_get_s8_ctrl(pdev, GET_CHROM_CTL, pdev->saturation_fmt,
193 if (r || def < -100 || def > 100)
195 pdev->saturation = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
196 V4L2_CID_SATURATION, -100, 100, 1, def);
199 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, GAMMA_FORMATTER, &def);
202 pdev->gamma = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
203 V4L2_CID_GAMMA, 0, 31, 1, def);
205 /* auto white balance, red gain, blue gain */
206 r = pwc_get_u8_ctrl(pdev, GET_CHROM_CTL, WB_MODE_FORMATTER, &def);
207 if (r || def > awb_auto)
209 cfg = pwc_auto_white_balance_cfg;
210 cfg.name = v4l2_ctrl_get_name(cfg.id);
212 pdev->auto_white_balance = v4l2_ctrl_new_custom(hdl, &cfg, NULL);
213 /* check auto controls to avoid NULL deref in v4l2_ctrl_auto_cluster */
214 if (!pdev->auto_white_balance)
217 r = pwc_get_u8_ctrl(pdev, GET_CHROM_CTL,
218 PRESET_MANUAL_RED_GAIN_FORMATTER, &def);
221 pdev->red_balance = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
222 V4L2_CID_RED_BALANCE, 0, 255, 1, def);
224 r = pwc_get_u8_ctrl(pdev, GET_CHROM_CTL,
225 PRESET_MANUAL_BLUE_GAIN_FORMATTER, &def);
228 pdev->blue_balance = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
229 V4L2_CID_BLUE_BALANCE, 0, 255, 1, def);
231 v4l2_ctrl_auto_cluster(3, &pdev->auto_white_balance, awb_manual, true);
234 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, AGC_MODE_FORMATTER, &def);
235 if (r || (def != 0 && def != 0xff))
237 /* Note a register value if 0 means auto gain is on */
238 pdev->autogain = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
239 V4L2_CID_AUTOGAIN, 0, 1, 1, def == 0);
243 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, PRESET_AGC_FORMATTER, &def);
246 pdev->gain = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
247 V4L2_CID_GAIN, 0, 63, 1, def);
249 /* auto exposure, exposure */
250 if (DEVICE_USE_CODEC2(pdev->type)) {
251 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, SHUTTER_MODE_FORMATTER,
253 if (r || (def != 0 && def != 0xff))
256 * def = 0 auto, def = ff manual
257 * menu idx 0 = auto, idx 1 = manual
259 pdev->exposure_auto = v4l2_ctrl_new_std_menu(hdl,
261 V4L2_CID_EXPOSURE_AUTO,
263 if (!pdev->exposure_auto)
266 /* GET_LUM_CTL, PRESET_SHUTTER_FORMATTER is unreliable */
267 r = pwc_get_u16_ctrl(pdev, GET_STATUS_CTL,
268 READ_SHUTTER_FORMATTER, &def);
271 pdev->exposure = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
272 V4L2_CID_EXPOSURE, 0, 655, 1, def);
273 /* CODEC2: separate auto gain & auto exposure */
274 v4l2_ctrl_auto_cluster(2, &pdev->autogain, 0, true);
275 v4l2_ctrl_auto_cluster(2, &pdev->exposure_auto,
276 V4L2_EXPOSURE_MANUAL, true);
277 } else if (DEVICE_USE_CODEC3(pdev->type)) {
278 /* GET_LUM_CTL, PRESET_SHUTTER_FORMATTER is unreliable */
279 r = pwc_get_u16_ctrl(pdev, GET_STATUS_CTL,
280 READ_SHUTTER_FORMATTER, &def);
283 pdev->exposure = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
284 V4L2_CID_EXPOSURE, 0, 255, 1, def);
285 /* CODEC3: both gain and exposure controlled by autogain */
286 pdev->autogain_expo_cluster[0] = pdev->autogain;
287 pdev->autogain_expo_cluster[1] = pdev->gain;
288 pdev->autogain_expo_cluster[2] = pdev->exposure;
289 v4l2_ctrl_auto_cluster(3, pdev->autogain_expo_cluster,
293 /* color / bw setting */
294 r = pwc_get_u8_ctrl(pdev, GET_CHROM_CTL, COLOUR_MODE_FORMATTER,
296 if (r || (def != 0 && def != 0xff))
298 /* def = 0 bw, def = ff color, menu idx 0 = color, idx 1 = bw */
299 pdev->colorfx = v4l2_ctrl_new_std_menu(hdl, &pwc_ctrl_ops,
300 V4L2_CID_COLORFX, 1, 0, def == 0);
302 /* autocontour, contour */
303 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, AUTO_CONTOUR_FORMATTER, &def);
304 if (r || (def != 0 && def != 0xff))
306 cfg = pwc_autocontour_cfg;
308 pdev->autocontour = v4l2_ctrl_new_custom(hdl, &cfg, NULL);
309 if (!pdev->autocontour)
312 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, PRESET_CONTOUR_FORMATTER, &def);
315 cfg = pwc_contour_cfg;
317 pdev->contour = v4l2_ctrl_new_custom(hdl, &cfg, NULL);
319 v4l2_ctrl_auto_cluster(2, &pdev->autocontour, 0, false);
322 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL,
323 BACK_LIGHT_COMPENSATION_FORMATTER, &def);
324 if (r || (def != 0 && def != 0xff))
326 cfg = pwc_backlight_cfg;
327 cfg.name = v4l2_ctrl_get_name(cfg.id);
329 pdev->backlight = v4l2_ctrl_new_custom(hdl, &cfg, NULL);
331 /* flikker rediction */
332 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL,
333 FLICKERLESS_MODE_FORMATTER, &def);
334 if (r || (def != 0 && def != 0xff))
336 cfg = pwc_flicker_cfg;
337 cfg.name = v4l2_ctrl_get_name(cfg.id);
339 pdev->flicker = v4l2_ctrl_new_custom(hdl, &cfg, NULL);
341 /* Dynamic noise reduction */
342 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL,
343 DYNAMIC_NOISE_CONTROL_FORMATTER, &def);
346 cfg = pwc_noise_reduction_cfg;
348 pdev->noise_reduction = v4l2_ctrl_new_custom(hdl, &cfg, NULL);
350 /* Save / Restore User / Factory Settings */
351 pdev->save_user = v4l2_ctrl_new_custom(hdl, &pwc_save_user_cfg, NULL);
352 pdev->restore_user = v4l2_ctrl_new_custom(hdl, &pwc_restore_user_cfg,
354 if (pdev->restore_user)
355 pdev->restore_user->flags |= V4L2_CTRL_FLAG_UPDATE;
356 pdev->restore_factory = v4l2_ctrl_new_custom(hdl,
357 &pwc_restore_factory_cfg,
359 if (pdev->restore_factory)
360 pdev->restore_factory->flags |= V4L2_CTRL_FLAG_UPDATE;
362 /* Auto White Balance speed & delay */
363 r = pwc_get_u8_ctrl(pdev, GET_CHROM_CTL,
364 AWB_CONTROL_SPEED_FORMATTER, &def);
365 if (r || def < 1 || def > 32)
367 cfg = pwc_awb_speed_cfg;
369 pdev->awb_speed = v4l2_ctrl_new_custom(hdl, &cfg, NULL);
371 r = pwc_get_u8_ctrl(pdev, GET_CHROM_CTL,
372 AWB_CONTROL_DELAY_FORMATTER, &def);
375 cfg = pwc_awb_delay_cfg;
377 pdev->awb_delay = v4l2_ctrl_new_custom(hdl, &cfg, NULL);
379 if (!(pdev->features & FEATURE_MOTOR_PANTILT))
382 /* Motor pan / tilt / reset */
383 pdev->motor_pan = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
384 V4L2_CID_PAN_RELATIVE, -4480, 4480, 64, 0);
385 if (!pdev->motor_pan)
387 pdev->motor_tilt = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
388 V4L2_CID_TILT_RELATIVE, -1920, 1920, 64, 0);
389 pdev->motor_pan_reset = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
390 V4L2_CID_PAN_RESET, 0, 0, 0, 0);
391 pdev->motor_tilt_reset = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops,
392 V4L2_CID_TILT_RESET, 0, 0, 0, 0);
393 v4l2_ctrl_cluster(4, &pdev->motor_pan);
398 static void pwc_vidioc_fill_fmt(struct v4l2_format *f,
399 int width, int height, u32 pixfmt)
401 memset(&f->fmt.pix, 0, sizeof(struct v4l2_pix_format));
402 f->fmt.pix.width = width;
403 f->fmt.pix.height = height;
404 f->fmt.pix.field = V4L2_FIELD_NONE;
405 f->fmt.pix.pixelformat = pixfmt;
406 f->fmt.pix.bytesperline = f->fmt.pix.width;
407 f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.width * 3 / 2;
408 PWC_DEBUG_IOCTL("pwc_vidioc_fill_fmt() "
409 "width=%d, height=%d, bytesperline=%d, sizeimage=%d, pixelformat=%c%c%c%c\n",
412 f->fmt.pix.bytesperline,
413 f->fmt.pix.sizeimage,
414 (f->fmt.pix.pixelformat)&255,
415 (f->fmt.pix.pixelformat>>8)&255,
416 (f->fmt.pix.pixelformat>>16)&255,
417 (f->fmt.pix.pixelformat>>24)&255);
420 /* ioctl(VIDIOC_TRY_FMT) */
421 static int pwc_vidioc_try_fmt(struct pwc_device *pdev, struct v4l2_format *f)
425 if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) {
426 PWC_DEBUG_IOCTL("Bad video type must be V4L2_BUF_TYPE_VIDEO_CAPTURE\n");
430 switch (f->fmt.pix.pixelformat) {
431 case V4L2_PIX_FMT_YUV420:
433 case V4L2_PIX_FMT_PWC1:
434 if (DEVICE_USE_CODEC23(pdev->type)) {
435 PWC_DEBUG_IOCTL("codec1 is only supported for old pwc webcam\n");
439 case V4L2_PIX_FMT_PWC2:
440 if (DEVICE_USE_CODEC1(pdev->type)) {
441 PWC_DEBUG_IOCTL("codec23 is only supported for new pwc webcam\n");
446 PWC_DEBUG_IOCTL("Unsupported pixel format\n");
451 size = pwc_get_size(pdev, f->fmt.pix.width, f->fmt.pix.height);
452 pwc_vidioc_fill_fmt(f,
453 pwc_image_sizes[size][0],
454 pwc_image_sizes[size][1],
455 f->fmt.pix.pixelformat);
460 /* ioctl(VIDIOC_SET_FMT) */
462 static int pwc_s_fmt_vid_cap(struct file *file, void *fh, struct v4l2_format *f)
464 struct pwc_device *pdev = video_drvdata(file);
465 int ret, pixelformat, compression = 0;
467 ret = pwc_vidioc_try_fmt(pdev, f);
471 if (mutex_lock_interruptible(&pdev->vb_queue_lock))
474 ret = pwc_test_n_set_capt_file(pdev, file);
478 if (pdev->vb_queue.streaming) {
483 pixelformat = f->fmt.pix.pixelformat;
485 PWC_DEBUG_IOCTL("Trying to set format to: width=%d height=%d fps=%d "
487 f->fmt.pix.width, f->fmt.pix.height, pdev->vframes,
489 (pixelformat>>8)&255,
490 (pixelformat>>16)&255,
491 (pixelformat>>24)&255);
493 ret = pwc_set_video_mode(pdev, f->fmt.pix.width, f->fmt.pix.height,
494 pixelformat, 30, &compression, 0);
496 PWC_DEBUG_IOCTL("pwc_set_video_mode(), return=%d\n", ret);
498 pwc_vidioc_fill_fmt(f, pdev->width, pdev->height, pdev->pixfmt);
500 mutex_unlock(&pdev->vb_queue_lock);
504 static int pwc_querycap(struct file *file, void *fh, struct v4l2_capability *cap)
506 struct pwc_device *pdev = video_drvdata(file);
508 strcpy(cap->driver, PWC_NAME);
509 strlcpy(cap->card, pdev->vdev.name, sizeof(cap->card));
510 usb_make_path(pdev->udev, cap->bus_info, sizeof(cap->bus_info));
512 V4L2_CAP_VIDEO_CAPTURE |
518 static int pwc_enum_input(struct file *file, void *fh, struct v4l2_input *i)
520 if (i->index) /* Only one INPUT is supported */
523 strcpy(i->name, "usb");
527 static int pwc_g_input(struct file *file, void *fh, unsigned int *i)
533 static int pwc_s_input(struct file *file, void *fh, unsigned int i)
535 return i ? -EINVAL : 0;
538 static int pwc_g_volatile_ctrl(struct v4l2_ctrl *ctrl)
540 struct pwc_device *pdev =
541 container_of(ctrl->handler, struct pwc_device, ctrl_handler);
545 case V4L2_CID_AUTO_WHITE_BALANCE:
546 if (pdev->color_bal_valid &&
547 (pdev->auto_white_balance->val != awb_auto ||
549 pdev->last_color_bal_update + HZ / 4))) {
550 pdev->red_balance->val = pdev->last_red_balance;
551 pdev->blue_balance->val = pdev->last_blue_balance;
554 ret = pwc_get_u8_ctrl(pdev, GET_STATUS_CTL,
555 READ_RED_GAIN_FORMATTER,
556 &pdev->red_balance->val);
559 ret = pwc_get_u8_ctrl(pdev, GET_STATUS_CTL,
560 READ_BLUE_GAIN_FORMATTER,
561 &pdev->blue_balance->val);
564 pdev->last_red_balance = pdev->red_balance->val;
565 pdev->last_blue_balance = pdev->blue_balance->val;
566 pdev->last_color_bal_update = jiffies;
567 pdev->color_bal_valid = true;
569 case V4L2_CID_AUTOGAIN:
570 if (pdev->gain_valid && time_before(jiffies,
571 pdev->last_gain_update + HZ / 4)) {
572 pdev->gain->val = pdev->last_gain;
575 ret = pwc_get_u8_ctrl(pdev, GET_STATUS_CTL,
576 READ_AGC_FORMATTER, &pdev->gain->val);
579 pdev->last_gain = pdev->gain->val;
580 pdev->last_gain_update = jiffies;
581 pdev->gain_valid = true;
582 if (!DEVICE_USE_CODEC3(pdev->type))
584 /* Fall through for CODEC3 where autogain also controls expo */
585 case V4L2_CID_EXPOSURE_AUTO:
586 if (pdev->exposure_valid && time_before(jiffies,
587 pdev->last_exposure_update + HZ / 4)) {
588 pdev->exposure->val = pdev->last_exposure;
591 ret = pwc_get_u16_ctrl(pdev, GET_STATUS_CTL,
592 READ_SHUTTER_FORMATTER,
593 &pdev->exposure->val);
596 pdev->last_exposure = pdev->exposure->val;
597 pdev->last_exposure_update = jiffies;
598 pdev->exposure_valid = true;
605 PWC_ERROR("g_ctrl %s error %d\n", ctrl->name, ret);
610 static int pwc_set_awb(struct pwc_device *pdev)
614 if (pdev->auto_white_balance->is_new) {
615 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL,
617 pdev->auto_white_balance->val);
621 if (pdev->auto_white_balance->val != awb_manual)
622 pdev->color_bal_valid = false; /* Force cache update */
625 * If this is a preset, update our red / blue balance values
626 * so that events get generated for the new preset values
628 if (pdev->auto_white_balance->val == awb_indoor ||
629 pdev->auto_white_balance->val == awb_outdoor ||
630 pdev->auto_white_balance->val == awb_fl)
631 pwc_g_volatile_ctrl(pdev->auto_white_balance);
633 if (pdev->auto_white_balance->val != awb_manual)
636 if (pdev->red_balance->is_new) {
637 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL,
638 PRESET_MANUAL_RED_GAIN_FORMATTER,
639 pdev->red_balance->val);
644 if (pdev->blue_balance->is_new) {
645 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL,
646 PRESET_MANUAL_BLUE_GAIN_FORMATTER,
647 pdev->blue_balance->val);
654 /* For CODEC2 models which have separate autogain and auto exposure */
655 static int pwc_set_autogain(struct pwc_device *pdev)
659 if (pdev->autogain->is_new) {
660 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL,
662 pdev->autogain->val ? 0 : 0xff);
666 if (pdev->autogain->val)
667 pdev->gain_valid = false; /* Force cache update */
670 if (pdev->autogain->val)
673 if (pdev->gain->is_new) {
674 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL,
675 PRESET_AGC_FORMATTER,
683 /* For CODEC2 models which have separate autogain and auto exposure */
684 static int pwc_set_exposure_auto(struct pwc_device *pdev)
687 int is_auto = pdev->exposure_auto->val == V4L2_EXPOSURE_AUTO;
689 if (pdev->exposure_auto->is_new) {
690 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL,
691 SHUTTER_MODE_FORMATTER,
697 pdev->exposure_valid = false; /* Force cache update */
703 if (pdev->exposure->is_new) {
704 ret = pwc_set_u16_ctrl(pdev, SET_LUM_CTL,
705 PRESET_SHUTTER_FORMATTER,
706 pdev->exposure->val);
713 /* For CODEC3 models which have autogain controlling both gain and exposure */
714 static int pwc_set_autogain_expo(struct pwc_device *pdev)
718 if (pdev->autogain->is_new) {
719 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL,
721 pdev->autogain->val ? 0 : 0xff);
725 if (pdev->autogain->val) {
726 pdev->gain_valid = false; /* Force cache update */
727 pdev->exposure_valid = false; /* Force cache update */
731 if (pdev->autogain->val)
734 if (pdev->gain->is_new) {
735 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL,
736 PRESET_AGC_FORMATTER,
742 if (pdev->exposure->is_new) {
743 ret = pwc_set_u16_ctrl(pdev, SET_LUM_CTL,
744 PRESET_SHUTTER_FORMATTER,
745 pdev->exposure->val);
752 static int pwc_set_motor(struct pwc_device *pdev)
756 pdev->ctrl_buf[0] = 0;
757 if (pdev->motor_pan_reset->is_new)
758 pdev->ctrl_buf[0] |= 0x01;
759 if (pdev->motor_tilt_reset->is_new)
760 pdev->ctrl_buf[0] |= 0x02;
761 if (pdev->motor_pan_reset->is_new || pdev->motor_tilt_reset->is_new) {
762 ret = send_control_msg(pdev, SET_MPT_CTL,
763 PT_RESET_CONTROL_FORMATTER,
769 memset(pdev->ctrl_buf, 0, 4);
770 if (pdev->motor_pan->is_new) {
771 pdev->ctrl_buf[0] = pdev->motor_pan->val & 0xFF;
772 pdev->ctrl_buf[1] = (pdev->motor_pan->val >> 8);
774 if (pdev->motor_tilt->is_new) {
775 pdev->ctrl_buf[2] = pdev->motor_tilt->val & 0xFF;
776 pdev->ctrl_buf[3] = (pdev->motor_tilt->val >> 8);
778 if (pdev->motor_pan->is_new || pdev->motor_tilt->is_new) {
779 ret = send_control_msg(pdev, SET_MPT_CTL,
780 PT_RELATIVE_CONTROL_FORMATTER,
789 static int pwc_s_ctrl(struct v4l2_ctrl *ctrl)
791 struct pwc_device *pdev =
792 container_of(ctrl->handler, struct pwc_device, ctrl_handler);
796 case V4L2_CID_BRIGHTNESS:
797 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL,
798 BRIGHTNESS_FORMATTER, ctrl->val);
800 case V4L2_CID_CONTRAST:
801 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL,
802 CONTRAST_FORMATTER, ctrl->val);
804 case V4L2_CID_SATURATION:
805 ret = pwc_set_s8_ctrl(pdev, SET_CHROM_CTL,
806 pdev->saturation_fmt, ctrl->val);
809 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL,
810 GAMMA_FORMATTER, ctrl->val);
812 case V4L2_CID_AUTO_WHITE_BALANCE:
813 ret = pwc_set_awb(pdev);
815 case V4L2_CID_AUTOGAIN:
816 if (DEVICE_USE_CODEC2(pdev->type))
817 ret = pwc_set_autogain(pdev);
818 else if (DEVICE_USE_CODEC3(pdev->type))
819 ret = pwc_set_autogain_expo(pdev);
823 case V4L2_CID_EXPOSURE_AUTO:
824 if (DEVICE_USE_CODEC2(pdev->type))
825 ret = pwc_set_exposure_auto(pdev);
829 case V4L2_CID_COLORFX:
830 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL,
831 COLOUR_MODE_FORMATTER,
832 ctrl->val ? 0 : 0xff);
834 case PWC_CID_CUSTOM(autocontour):
835 if (pdev->autocontour->is_new) {
836 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL,
837 AUTO_CONTOUR_FORMATTER,
838 pdev->autocontour->val ? 0 : 0xff);
840 if (ret == 0 && pdev->contour->is_new) {
841 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL,
842 PRESET_CONTOUR_FORMATTER,
846 case V4L2_CID_BACKLIGHT_COMPENSATION:
847 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL,
848 BACK_LIGHT_COMPENSATION_FORMATTER,
849 ctrl->val ? 0 : 0xff);
851 case V4L2_CID_BAND_STOP_FILTER:
852 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL,
853 FLICKERLESS_MODE_FORMATTER,
854 ctrl->val ? 0 : 0xff);
856 case PWC_CID_CUSTOM(noise_reduction):
857 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL,
858 DYNAMIC_NOISE_CONTROL_FORMATTER,
861 case PWC_CID_CUSTOM(save_user):
862 ret = pwc_button_ctrl(pdev, SAVE_USER_DEFAULTS_FORMATTER);
864 case PWC_CID_CUSTOM(restore_user):
865 ret = pwc_button_ctrl(pdev, RESTORE_USER_DEFAULTS_FORMATTER);
867 case PWC_CID_CUSTOM(restore_factory):
868 ret = pwc_button_ctrl(pdev,
869 RESTORE_FACTORY_DEFAULTS_FORMATTER);
871 case PWC_CID_CUSTOM(awb_speed):
872 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL,
873 AWB_CONTROL_SPEED_FORMATTER,
876 case PWC_CID_CUSTOM(awb_delay):
877 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL,
878 AWB_CONTROL_DELAY_FORMATTER,
881 case V4L2_CID_PAN_RELATIVE:
882 ret = pwc_set_motor(pdev);
889 PWC_ERROR("s_ctrl %s error %d\n", ctrl->name, ret);
894 static int pwc_enum_fmt_vid_cap(struct file *file, void *fh, struct v4l2_fmtdesc *f)
896 struct pwc_device *pdev = video_drvdata(file);
898 /* We only support two format: the raw format, and YUV */
902 f->pixelformat = pdev->type <= 646 ? V4L2_PIX_FMT_PWC1 : V4L2_PIX_FMT_PWC2;
903 f->flags = V4L2_FMT_FLAG_COMPRESSED;
904 strlcpy(f->description, "Raw Philips Webcam", sizeof(f->description));
907 f->pixelformat = V4L2_PIX_FMT_YUV420;
908 strlcpy(f->description, "4:2:0, planar, Y-Cb-Cr", sizeof(f->description));
916 static int pwc_g_fmt_vid_cap(struct file *file, void *fh, struct v4l2_format *f)
918 struct pwc_device *pdev = video_drvdata(file);
920 if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
923 PWC_DEBUG_IOCTL("ioctl(VIDIOC_G_FMT) return size %dx%d\n",
924 pdev->width, pdev->height);
925 pwc_vidioc_fill_fmt(f, pdev->width, pdev->height, pdev->pixfmt);
929 static int pwc_try_fmt_vid_cap(struct file *file, void *fh, struct v4l2_format *f)
931 struct pwc_device *pdev = video_drvdata(file);
933 return pwc_vidioc_try_fmt(pdev, f);
936 static int pwc_reqbufs(struct file *file, void *fh,
937 struct v4l2_requestbuffers *rb)
939 struct pwc_device *pdev = video_drvdata(file);
942 if (mutex_lock_interruptible(&pdev->vb_queue_lock))
945 ret = pwc_test_n_set_capt_file(pdev, file);
947 ret = vb2_reqbufs(&pdev->vb_queue, rb);
949 mutex_unlock(&pdev->vb_queue_lock);
953 static int pwc_querybuf(struct file *file, void *fh, struct v4l2_buffer *buf)
955 struct pwc_device *pdev = video_drvdata(file);
958 if (mutex_lock_interruptible(&pdev->vb_queue_lock))
961 ret = pwc_test_n_set_capt_file(pdev, file);
963 ret = vb2_querybuf(&pdev->vb_queue, buf);
965 mutex_unlock(&pdev->vb_queue_lock);
969 static int pwc_qbuf(struct file *file, void *fh, struct v4l2_buffer *buf)
971 struct pwc_device *pdev = video_drvdata(file);
974 if (mutex_lock_interruptible(&pdev->vb_queue_lock))
977 ret = pwc_test_n_set_capt_file(pdev, file);
979 ret = vb2_qbuf(&pdev->vb_queue, buf);
981 mutex_unlock(&pdev->vb_queue_lock);
985 static int pwc_dqbuf(struct file *file, void *fh, struct v4l2_buffer *buf)
987 struct pwc_device *pdev = video_drvdata(file);
990 if (mutex_lock_interruptible(&pdev->vb_queue_lock))
993 ret = pwc_test_n_set_capt_file(pdev, file);
995 ret = vb2_dqbuf(&pdev->vb_queue, buf,
996 file->f_flags & O_NONBLOCK);
998 mutex_unlock(&pdev->vb_queue_lock);
1002 static int pwc_streamon(struct file *file, void *fh, enum v4l2_buf_type i)
1004 struct pwc_device *pdev = video_drvdata(file);
1007 if (mutex_lock_interruptible(&pdev->vb_queue_lock))
1008 return -ERESTARTSYS;
1010 ret = pwc_test_n_set_capt_file(pdev, file);
1012 ret = vb2_streamon(&pdev->vb_queue, i);
1014 mutex_unlock(&pdev->vb_queue_lock);
1018 static int pwc_streamoff(struct file *file, void *fh, enum v4l2_buf_type i)
1020 struct pwc_device *pdev = video_drvdata(file);
1023 if (mutex_lock_interruptible(&pdev->vb_queue_lock))
1024 return -ERESTARTSYS;
1026 ret = pwc_test_n_set_capt_file(pdev, file);
1028 ret = vb2_streamoff(&pdev->vb_queue, i);
1030 mutex_unlock(&pdev->vb_queue_lock);
1034 static int pwc_enum_framesizes(struct file *file, void *fh,
1035 struct v4l2_frmsizeenum *fsize)
1037 struct pwc_device *pdev = video_drvdata(file);
1038 unsigned int i = 0, index = fsize->index;
1040 if (fsize->pixel_format == V4L2_PIX_FMT_YUV420 ||
1041 (fsize->pixel_format == V4L2_PIX_FMT_PWC1 &&
1042 DEVICE_USE_CODEC1(pdev->type)) ||
1043 (fsize->pixel_format == V4L2_PIX_FMT_PWC2 &&
1044 DEVICE_USE_CODEC23(pdev->type))) {
1045 for (i = 0; i < PSZ_MAX; i++) {
1046 if (!(pdev->image_mask & (1UL << i)))
1049 fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE;
1050 fsize->discrete.width = pwc_image_sizes[i][0];
1051 fsize->discrete.height = pwc_image_sizes[i][1];
1059 static int pwc_enum_frameintervals(struct file *file, void *fh,
1060 struct v4l2_frmivalenum *fival)
1062 struct pwc_device *pdev = video_drvdata(file);
1066 for (i = 0; i < PSZ_MAX; i++) {
1067 if (pwc_image_sizes[i][0] == fival->width &&
1068 pwc_image_sizes[i][1] == fival->height) {
1074 /* TODO: Support raw format */
1075 if (size < 0 || fival->pixel_format != V4L2_PIX_FMT_YUV420)
1078 i = pwc_get_fps(pdev, fival->index, size);
1082 fival->type = V4L2_FRMIVAL_TYPE_DISCRETE;
1083 fival->discrete.numerator = 1;
1084 fival->discrete.denominator = i;
1089 static int pwc_g_parm(struct file *file, void *fh,
1090 struct v4l2_streamparm *parm)
1092 struct pwc_device *pdev = video_drvdata(file);
1094 if (parm->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
1097 memset(parm, 0, sizeof(*parm));
1099 parm->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1100 parm->parm.capture.readbuffers = MIN_FRAMES;
1101 parm->parm.capture.capability |= V4L2_CAP_TIMEPERFRAME;
1102 parm->parm.capture.timeperframe.denominator = pdev->vframes;
1103 parm->parm.capture.timeperframe.numerator = 1;
1108 static int pwc_s_parm(struct file *file, void *fh,
1109 struct v4l2_streamparm *parm)
1111 struct pwc_device *pdev = video_drvdata(file);
1112 int compression = 0;
1115 if (parm->type != V4L2_BUF_TYPE_VIDEO_CAPTURE ||
1116 parm->parm.capture.timeperframe.numerator == 0)
1119 fps = parm->parm.capture.timeperframe.denominator /
1120 parm->parm.capture.timeperframe.numerator;
1122 if (mutex_lock_interruptible(&pdev->vb_queue_lock))
1123 return -ERESTARTSYS;
1125 ret = pwc_test_n_set_capt_file(pdev, file);
1129 if (pdev->vb_queue.streaming) {
1134 ret = pwc_set_video_mode(pdev, pdev->width, pdev->height, pdev->pixfmt,
1135 fps, &compression, 0);
1137 pwc_g_parm(file, fh, parm);
1140 mutex_unlock(&pdev->vb_queue_lock);
1144 const struct v4l2_ioctl_ops pwc_ioctl_ops = {
1145 .vidioc_querycap = pwc_querycap,
1146 .vidioc_enum_input = pwc_enum_input,
1147 .vidioc_g_input = pwc_g_input,
1148 .vidioc_s_input = pwc_s_input,
1149 .vidioc_enum_fmt_vid_cap = pwc_enum_fmt_vid_cap,
1150 .vidioc_g_fmt_vid_cap = pwc_g_fmt_vid_cap,
1151 .vidioc_s_fmt_vid_cap = pwc_s_fmt_vid_cap,
1152 .vidioc_try_fmt_vid_cap = pwc_try_fmt_vid_cap,
1153 .vidioc_reqbufs = pwc_reqbufs,
1154 .vidioc_querybuf = pwc_querybuf,
1155 .vidioc_qbuf = pwc_qbuf,
1156 .vidioc_dqbuf = pwc_dqbuf,
1157 .vidioc_streamon = pwc_streamon,
1158 .vidioc_streamoff = pwc_streamoff,
1159 .vidioc_log_status = v4l2_ctrl_log_status,
1160 .vidioc_enum_framesizes = pwc_enum_framesizes,
1161 .vidioc_enum_frameintervals = pwc_enum_frameintervals,
1162 .vidioc_g_parm = pwc_g_parm,
1163 .vidioc_s_parm = pwc_s_parm,
1164 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
1165 .vidioc_unsubscribe_event = v4l2_event_unsubscribe,