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> 6 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. 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/errno.h> 30#include <linux/init.h> 31#include <linux/mm.h> 32#include <linux/module.h> 33#include <linux/poll.h> 34#include <linux/vmalloc.h> 35#include <linux/jiffies.h> 36#include <asm/io.h> 37 38#include "pwc.h" 39 40#define PWC_CID_CUSTOM(ctrl) ((V4L2_CID_USER_BASE | 0xf000) + custom_ ## ctrl) 41 42static int pwc_g_volatile_ctrl(struct v4l2_ctrl *ctrl); 43static int pwc_s_ctrl(struct v4l2_ctrl *ctrl); 44 45static const struct v4l2_ctrl_ops pwc_ctrl_ops = { 46 .g_volatile_ctrl = pwc_g_volatile_ctrl, 47 .s_ctrl = pwc_s_ctrl, 48}; 49 50enum { awb_indoor, awb_outdoor, awb_fl, awb_manual, awb_auto }; 51enum { custom_autocontour, custom_contour, custom_noise_reduction, 52 custom_awb_speed, custom_awb_delay, 53 custom_save_user, custom_restore_user, custom_restore_factory }; 54 55const char * const pwc_auto_whitebal_qmenu[] = { 56 "Indoor (Incandescant Lighting) Mode", 57 "Outdoor (Sunlight) Mode", 58 "Indoor (Fluorescent Lighting) Mode", 59 "Manual Mode", 60 "Auto Mode", 61 NULL 62}; 63 64static const struct v4l2_ctrl_config pwc_auto_white_balance_cfg = { 65 .ops = &pwc_ctrl_ops, 66 .id = V4L2_CID_AUTO_WHITE_BALANCE, 67 .type = V4L2_CTRL_TYPE_MENU, 68 .max = awb_auto, 69 .qmenu = pwc_auto_whitebal_qmenu, 70}; 71 72static const struct v4l2_ctrl_config pwc_autocontour_cfg = { 73 .ops = &pwc_ctrl_ops, 74 .id = PWC_CID_CUSTOM(autocontour), 75 .type = V4L2_CTRL_TYPE_BOOLEAN, 76 .name = "Auto contour", 77 .min = 0, 78 .max = 1, 79 .step = 1, 80}; 81 82static const struct v4l2_ctrl_config pwc_contour_cfg = { 83 .ops = &pwc_ctrl_ops, 84 .id = PWC_CID_CUSTOM(contour), 85 .type = V4L2_CTRL_TYPE_INTEGER, 86 .name = "Contour", 87 .flags = V4L2_CTRL_FLAG_SLIDER, 88 .min = 0, 89 .max = 63, 90 .step = 1, 91}; 92 93static const struct v4l2_ctrl_config pwc_backlight_cfg = { 94 .ops = &pwc_ctrl_ops, 95 .id = V4L2_CID_BACKLIGHT_COMPENSATION, 96 .type = V4L2_CTRL_TYPE_BOOLEAN, 97 .min = 0, 98 .max = 1, 99 .step = 1, 100}; 101 102static 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, 106 .min = 0, 107 .max = 1, 108 .step = 1, 109}; 110 111static 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", 116 .min = 0, 117 .max = 3, 118 .step = 1, 119}; 120 121static 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", 126}; 127 128static 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", 133}; 134 135static 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", 140}; 141 142static 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", 147 .min = 1, 148 .max = 32, 149 .step = 1, 150}; 151 152static 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", 157 .min = 0, 158 .max = 63, 159 .step = 1, 160}; 161 162int pwc_init_controls(struct pwc_device *pdev) 163{ 164 struct v4l2_ctrl_handler *hdl; 165 struct v4l2_ctrl_config cfg; 166 int r, def; 167 168 hdl = &pdev->ctrl_handler; 169 r = v4l2_ctrl_handler_init(hdl, 20); 170 if (r) 171 return r; 172 173 /* Brightness, contrast, saturation, gamma */ 174 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, BRIGHTNESS_FORMATTER, &def); 175 if (r || def > 127) 176 def = 63; 177 pdev->brightness = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops, 178 V4L2_CID_BRIGHTNESS, 0, 127, 1, def); 179 180 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, CONTRAST_FORMATTER, &def); 181 if (r || def > 63) 182 def = 31; 183 pdev->contrast = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops, 184 V4L2_CID_CONTRAST, 0, 63, 1, def); 185 186 if (pdev->type >= 675) { 187 if (pdev->type < 730) 188 pdev->saturation_fmt = SATURATION_MODE_FORMATTER2; 189 else 190 pdev->saturation_fmt = SATURATION_MODE_FORMATTER1; 191 r = pwc_get_s8_ctrl(pdev, GET_CHROM_CTL, pdev->saturation_fmt, 192 &def); 193 if (r || def < -100 || def > 100) 194 def = 0; 195 pdev->saturation = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops, 196 V4L2_CID_SATURATION, -100, 100, 1, def); 197 } 198 199 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, GAMMA_FORMATTER, &def); 200 if (r || def > 31) 201 def = 15; 202 pdev->gamma = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops, 203 V4L2_CID_GAMMA, 0, 31, 1, def); 204 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) 208 def = awb_auto; 209 cfg = pwc_auto_white_balance_cfg; 210 cfg.name = v4l2_ctrl_get_name(cfg.id); 211 cfg.def = def; 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) 215 return hdl->error; 216 217 r = pwc_get_u8_ctrl(pdev, GET_CHROM_CTL, 218 PRESET_MANUAL_RED_GAIN_FORMATTER, &def); 219 if (r) 220 def = 127; 221 pdev->red_balance = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops, 222 V4L2_CID_RED_BALANCE, 0, 255, 1, def); 223 224 r = pwc_get_u8_ctrl(pdev, GET_CHROM_CTL, 225 PRESET_MANUAL_BLUE_GAIN_FORMATTER, &def); 226 if (r) 227 def = 127; 228 pdev->blue_balance = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops, 229 V4L2_CID_BLUE_BALANCE, 0, 255, 1, def); 230 231 v4l2_ctrl_auto_cluster(3, &pdev->auto_white_balance, awb_manual, true); 232 233 /* autogain, gain */ 234 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, AGC_MODE_FORMATTER, &def); 235 if (r || (def != 0 && def != 0xff)) 236 def = 0; 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); 240 if (!pdev->autogain) 241 return hdl->error; 242 243 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, PRESET_AGC_FORMATTER, &def); 244 if (r || def > 63) 245 def = 31; 246 pdev->gain = v4l2_ctrl_new_std(hdl, &pwc_ctrl_ops, 247 V4L2_CID_GAIN, 0, 63, 1, def); 248 249 /* auto exposure, exposure */ 250 if (DEVICE_USE_CODEC2(pdev->type)) { 251 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, SHUTTER_MODE_FORMATTER, 252 &def); 253 if (r || (def != 0 && def != 0xff)) 254 def = 0; 255 /* 256 * def = 0 auto, def = ff manual 257 * menu idx 0 = auto, idx 1 = manual 258 */ 259 pdev->exposure_auto = v4l2_ctrl_new_std_menu(hdl, 260 &pwc_ctrl_ops, 261 V4L2_CID_EXPOSURE_AUTO, 262 1, 0, def != 0); 263 if (!pdev->exposure_auto) 264 return hdl->error; 265 266 /* GET_LUM_CTL, PRESET_SHUTTER_FORMATTER is unreliable */ 267 r = pwc_get_u16_ctrl(pdev, GET_STATUS_CTL, 268 READ_SHUTTER_FORMATTER, &def); 269 if (r || def > 655) 270 def = 655; 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); 281 if (r || def > 255) 282 def = 255; 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, 290 0, true); 291 } 292 293 /* color / bw setting */ 294 r = pwc_get_u8_ctrl(pdev, GET_CHROM_CTL, COLOUR_MODE_FORMATTER, 295 &def); 296 if (r || (def != 0 && def != 0xff)) 297 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); 301 302 /* autocontour, contour */ 303 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, AUTO_CONTOUR_FORMATTER, &def); 304 if (r || (def != 0 && def != 0xff)) 305 def = 0; 306 cfg = pwc_autocontour_cfg; 307 cfg.def = def == 0; 308 pdev->autocontour = v4l2_ctrl_new_custom(hdl, &cfg, NULL); 309 if (!pdev->autocontour) 310 return hdl->error; 311 312 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, PRESET_CONTOUR_FORMATTER, &def); 313 if (r || def > 63) 314 def = 31; 315 cfg = pwc_contour_cfg; 316 cfg.def = def; 317 pdev->contour = v4l2_ctrl_new_custom(hdl, &cfg, NULL); 318 319 v4l2_ctrl_auto_cluster(2, &pdev->autocontour, 0, false); 320 321 /* backlight */ 322 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, 323 BACK_LIGHT_COMPENSATION_FORMATTER, &def); 324 if (r || (def != 0 && def != 0xff)) 325 def = 0; 326 cfg = pwc_backlight_cfg; 327 cfg.name = v4l2_ctrl_get_name(cfg.id); 328 cfg.def = def == 0; 329 pdev->backlight = v4l2_ctrl_new_custom(hdl, &cfg, NULL); 330 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)) 335 def = 0; 336 cfg = pwc_flicker_cfg; 337 cfg.name = v4l2_ctrl_get_name(cfg.id); 338 cfg.def = def == 0; 339 pdev->flicker = v4l2_ctrl_new_custom(hdl, &cfg, NULL); 340 341 /* Dynamic noise reduction */ 342 r = pwc_get_u8_ctrl(pdev, GET_LUM_CTL, 343 DYNAMIC_NOISE_CONTROL_FORMATTER, &def); 344 if (r || def > 3) 345 def = 2; 346 cfg = pwc_noise_reduction_cfg; 347 cfg.def = def; 348 pdev->noise_reduction = v4l2_ctrl_new_custom(hdl, &cfg, NULL); 349 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, 353 NULL); 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, 358 NULL); 359 if (pdev->restore_factory) 360 pdev->restore_factory->flags |= V4L2_CTRL_FLAG_UPDATE; 361 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) 366 def = 1; 367 cfg = pwc_awb_speed_cfg; 368 cfg.def = def; 369 pdev->awb_speed = v4l2_ctrl_new_custom(hdl, &cfg, NULL); 370 371 r = pwc_get_u8_ctrl(pdev, GET_CHROM_CTL, 372 AWB_CONTROL_DELAY_FORMATTER, &def); 373 if (r || def > 63) 374 def = 0; 375 cfg = pwc_awb_delay_cfg; 376 cfg.def = def; 377 pdev->awb_delay = v4l2_ctrl_new_custom(hdl, &cfg, NULL); 378 379 if (!(pdev->features & FEATURE_MOTOR_PANTILT)) 380 return hdl->error; 381 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) 386 return hdl->error; 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); 394 395 return hdl->error; 396} 397 398static void pwc_vidioc_fill_fmt(struct v4l2_format *f, 399 int width, int height, u32 pixfmt) 400{ 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", 410 f->fmt.pix.width, 411 f->fmt.pix.height, 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); 418} 419 420/* ioctl(VIDIOC_TRY_FMT) */ 421static int pwc_vidioc_try_fmt(struct pwc_device *pdev, struct v4l2_format *f) 422{ 423 int size; 424 425 if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) { 426 PWC_DEBUG_IOCTL("Bad video type must be V4L2_BUF_TYPE_VIDEO_CAPTURE\n"); 427 return -EINVAL; 428 } 429 430 switch (f->fmt.pix.pixelformat) { 431 case V4L2_PIX_FMT_YUV420: 432 break; 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"); 436 return -EINVAL; 437 } 438 break; 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"); 442 return -EINVAL; 443 } 444 break; 445 default: 446 PWC_DEBUG_IOCTL("Unsupported pixel format\n"); 447 return -EINVAL; 448 449 } 450 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); 456 457 return 0; 458} 459 460/* ioctl(VIDIOC_SET_FMT) */ 461 462static int pwc_s_fmt_vid_cap(struct file *file, void *fh, struct v4l2_format *f) 463{ 464 struct pwc_device *pdev = video_drvdata(file); 465 int ret, pixelformat, compression = 0; 466 467 if (pwc_test_n_set_capt_file(pdev, file)) 468 return -EBUSY; 469 470 ret = pwc_vidioc_try_fmt(pdev, f); 471 if (ret < 0) 472 return ret; 473 474 pixelformat = f->fmt.pix.pixelformat; 475 476 mutex_lock(&pdev->udevlock); 477 if (!pdev->udev) { 478 ret = -ENODEV; 479 goto leave; 480 } 481 482 if (pdev->iso_init) { 483 ret = -EBUSY; 484 goto leave; 485 } 486 487 PWC_DEBUG_IOCTL("Trying to set format to: width=%d height=%d fps=%d " 488 "format=%c%c%c%c\n", 489 f->fmt.pix.width, f->fmt.pix.height, pdev->vframes, 490 (pixelformat)&255, 491 (pixelformat>>8)&255, 492 (pixelformat>>16)&255, 493 (pixelformat>>24)&255); 494 495 ret = pwc_set_video_mode(pdev, f->fmt.pix.width, f->fmt.pix.height, 496 pixelformat, 30, &compression, 0); 497 498 PWC_DEBUG_IOCTL("pwc_set_video_mode(), return=%d\n", ret); 499 500 pwc_vidioc_fill_fmt(f, pdev->width, pdev->height, pdev->pixfmt); 501leave: 502 mutex_unlock(&pdev->udevlock); 503 return ret; 504} 505 506static int pwc_querycap(struct file *file, void *fh, struct v4l2_capability *cap) 507{ 508 struct pwc_device *pdev = video_drvdata(file); 509 510 if (!pdev->udev) 511 return -ENODEV; 512 513 strcpy(cap->driver, PWC_NAME); 514 strlcpy(cap->card, pdev->vdev.name, sizeof(cap->card)); 515 usb_make_path(pdev->udev, cap->bus_info, sizeof(cap->bus_info)); 516 cap->capabilities = 517 V4L2_CAP_VIDEO_CAPTURE | 518 V4L2_CAP_STREAMING | 519 V4L2_CAP_READWRITE; 520 return 0; 521} 522 523static int pwc_enum_input(struct file *file, void *fh, struct v4l2_input *i) 524{ 525 if (i->index) /* Only one INPUT is supported */ 526 return -EINVAL; 527 528 strcpy(i->name, "usb"); 529 return 0; 530} 531 532static int pwc_g_input(struct file *file, void *fh, unsigned int *i) 533{ 534 *i = 0; 535 return 0; 536} 537 538static int pwc_s_input(struct file *file, void *fh, unsigned int i) 539{ 540 return i ? -EINVAL : 0; 541} 542 543static int pwc_g_volatile_ctrl_unlocked(struct v4l2_ctrl *ctrl) 544{ 545 struct pwc_device *pdev = 546 container_of(ctrl->handler, struct pwc_device, ctrl_handler); 547 int ret = 0; 548 549 if (!pdev->udev) 550 return -ENODEV; 551 552 switch (ctrl->id) { 553 case V4L2_CID_AUTO_WHITE_BALANCE: 554 if (pdev->color_bal_valid && 555 (pdev->auto_white_balance->val != awb_auto || 556 time_before(jiffies, 557 pdev->last_color_bal_update + HZ / 4))) { 558 pdev->red_balance->val = pdev->last_red_balance; 559 pdev->blue_balance->val = pdev->last_blue_balance; 560 break; 561 } 562 ret = pwc_get_u8_ctrl(pdev, GET_STATUS_CTL, 563 READ_RED_GAIN_FORMATTER, 564 &pdev->red_balance->val); 565 if (ret) 566 break; 567 ret = pwc_get_u8_ctrl(pdev, GET_STATUS_CTL, 568 READ_BLUE_GAIN_FORMATTER, 569 &pdev->blue_balance->val); 570 if (ret) 571 break; 572 pdev->last_red_balance = pdev->red_balance->val; 573 pdev->last_blue_balance = pdev->blue_balance->val; 574 pdev->last_color_bal_update = jiffies; 575 pdev->color_bal_valid = true; 576 break; 577 case V4L2_CID_AUTOGAIN: 578 if (pdev->gain_valid && time_before(jiffies, 579 pdev->last_gain_update + HZ / 4)) { 580 pdev->gain->val = pdev->last_gain; 581 break; 582 } 583 ret = pwc_get_u8_ctrl(pdev, GET_STATUS_CTL, 584 READ_AGC_FORMATTER, &pdev->gain->val); 585 if (ret) 586 break; 587 pdev->last_gain = pdev->gain->val; 588 pdev->last_gain_update = jiffies; 589 pdev->gain_valid = true; 590 if (!DEVICE_USE_CODEC3(pdev->type)) 591 break; 592 /* Fall through for CODEC3 where autogain also controls expo */ 593 case V4L2_CID_EXPOSURE_AUTO: 594 if (pdev->exposure_valid && time_before(jiffies, 595 pdev->last_exposure_update + HZ / 4)) { 596 pdev->exposure->val = pdev->last_exposure; 597 break; 598 } 599 ret = pwc_get_u16_ctrl(pdev, GET_STATUS_CTL, 600 READ_SHUTTER_FORMATTER, 601 &pdev->exposure->val); 602 if (ret) 603 break; 604 pdev->last_exposure = pdev->exposure->val; 605 pdev->last_exposure_update = jiffies; 606 pdev->exposure_valid = true; 607 break; 608 default: 609 ret = -EINVAL; 610 } 611 612 if (ret) 613 PWC_ERROR("g_ctrl %s error %d\n", ctrl->name, ret); 614 615 return ret; 616} 617 618static int pwc_g_volatile_ctrl(struct v4l2_ctrl *ctrl) 619{ 620 struct pwc_device *pdev = 621 container_of(ctrl->handler, struct pwc_device, ctrl_handler); 622 int ret; 623 624 mutex_lock(&pdev->udevlock); 625 ret = pwc_g_volatile_ctrl_unlocked(ctrl); 626 mutex_unlock(&pdev->udevlock); 627 return ret; 628} 629 630static int pwc_set_awb(struct pwc_device *pdev) 631{ 632 int ret; 633 634 if (pdev->auto_white_balance->is_new) { 635 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL, 636 WB_MODE_FORMATTER, 637 pdev->auto_white_balance->val); 638 if (ret) 639 return ret; 640 641 if (pdev->auto_white_balance->val != awb_manual) 642 pdev->color_bal_valid = false; /* Force cache update */ 643 644 /* 645 * If this is a preset, update our red / blue balance values 646 * so that events get generated for the new preset values 647 */ 648 if (pdev->auto_white_balance->val == awb_indoor || 649 pdev->auto_white_balance->val == awb_outdoor || 650 pdev->auto_white_balance->val == awb_fl) 651 pwc_g_volatile_ctrl_unlocked(pdev->auto_white_balance); 652 } 653 if (pdev->auto_white_balance->val != awb_manual) 654 return 0; 655 656 if (pdev->red_balance->is_new) { 657 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL, 658 PRESET_MANUAL_RED_GAIN_FORMATTER, 659 pdev->red_balance->val); 660 if (ret) 661 return ret; 662 } 663 664 if (pdev->blue_balance->is_new) { 665 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL, 666 PRESET_MANUAL_BLUE_GAIN_FORMATTER, 667 pdev->blue_balance->val); 668 if (ret) 669 return ret; 670 } 671 return 0; 672} 673 674/* For CODEC2 models which have separate autogain and auto exposure */ 675static int pwc_set_autogain(struct pwc_device *pdev) 676{ 677 int ret; 678 679 if (pdev->autogain->is_new) { 680 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 681 AGC_MODE_FORMATTER, 682 pdev->autogain->val ? 0 : 0xff); 683 if (ret) 684 return ret; 685 686 if (pdev->autogain->val) 687 pdev->gain_valid = false; /* Force cache update */ 688 } 689 690 if (pdev->autogain->val) 691 return 0; 692 693 if (pdev->gain->is_new) { 694 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 695 PRESET_AGC_FORMATTER, 696 pdev->gain->val); 697 if (ret) 698 return ret; 699 } 700 return 0; 701} 702 703/* For CODEC2 models which have separate autogain and auto exposure */ 704static int pwc_set_exposure_auto(struct pwc_device *pdev) 705{ 706 int ret; 707 int is_auto = pdev->exposure_auto->val == V4L2_EXPOSURE_AUTO; 708 709 if (pdev->exposure_auto->is_new) { 710 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 711 SHUTTER_MODE_FORMATTER, 712 is_auto ? 0 : 0xff); 713 if (ret) 714 return ret; 715 716 if (is_auto) 717 pdev->exposure_valid = false; /* Force cache update */ 718 } 719 720 if (is_auto) 721 return 0; 722 723 if (pdev->exposure->is_new) { 724 ret = pwc_set_u16_ctrl(pdev, SET_LUM_CTL, 725 PRESET_SHUTTER_FORMATTER, 726 pdev->exposure->val); 727 if (ret) 728 return ret; 729 } 730 return 0; 731} 732 733/* For CODEC3 models which have autogain controlling both gain and exposure */ 734static int pwc_set_autogain_expo(struct pwc_device *pdev) 735{ 736 int ret; 737 738 if (pdev->autogain->is_new) { 739 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 740 AGC_MODE_FORMATTER, 741 pdev->autogain->val ? 0 : 0xff); 742 if (ret) 743 return ret; 744 745 if (pdev->autogain->val) { 746 pdev->gain_valid = false; /* Force cache update */ 747 pdev->exposure_valid = false; /* Force cache update */ 748 } 749 } 750 751 if (pdev->autogain->val) 752 return 0; 753 754 if (pdev->gain->is_new) { 755 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 756 PRESET_AGC_FORMATTER, 757 pdev->gain->val); 758 if (ret) 759 return ret; 760 } 761 762 if (pdev->exposure->is_new) { 763 ret = pwc_set_u16_ctrl(pdev, SET_LUM_CTL, 764 PRESET_SHUTTER_FORMATTER, 765 pdev->exposure->val); 766 if (ret) 767 return ret; 768 } 769 return 0; 770} 771 772static int pwc_set_motor(struct pwc_device *pdev) 773{ 774 int ret; 775 776 pdev->ctrl_buf[0] = 0; 777 if (pdev->motor_pan_reset->is_new) 778 pdev->ctrl_buf[0] |= 0x01; 779 if (pdev->motor_tilt_reset->is_new) 780 pdev->ctrl_buf[0] |= 0x02; 781 if (pdev->motor_pan_reset->is_new || pdev->motor_tilt_reset->is_new) { 782 ret = send_control_msg(pdev, SET_MPT_CTL, 783 PT_RESET_CONTROL_FORMATTER, 784 pdev->ctrl_buf, 1); 785 if (ret < 0) 786 return ret; 787 } 788 789 memset(pdev->ctrl_buf, 0, 4); 790 if (pdev->motor_pan->is_new) { 791 pdev->ctrl_buf[0] = pdev->motor_pan->val & 0xFF; 792 pdev->ctrl_buf[1] = (pdev->motor_pan->val >> 8); 793 } 794 if (pdev->motor_tilt->is_new) { 795 pdev->ctrl_buf[2] = pdev->motor_tilt->val & 0xFF; 796 pdev->ctrl_buf[3] = (pdev->motor_tilt->val >> 8); 797 } 798 if (pdev->motor_pan->is_new || pdev->motor_tilt->is_new) { 799 ret = send_control_msg(pdev, SET_MPT_CTL, 800 PT_RELATIVE_CONTROL_FORMATTER, 801 pdev->ctrl_buf, 4); 802 if (ret < 0) 803 return ret; 804 } 805 806 return 0; 807} 808 809static int pwc_s_ctrl(struct v4l2_ctrl *ctrl) 810{ 811 struct pwc_device *pdev = 812 container_of(ctrl->handler, struct pwc_device, ctrl_handler); 813 int ret = 0; 814 815 mutex_lock(&pdev->udevlock); 816 817 if (!pdev->udev) { 818 ret = -ENODEV; 819 goto leave; 820 } 821 822 switch (ctrl->id) { 823 case V4L2_CID_BRIGHTNESS: 824 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 825 BRIGHTNESS_FORMATTER, ctrl->val); 826 break; 827 case V4L2_CID_CONTRAST: 828 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 829 CONTRAST_FORMATTER, ctrl->val); 830 break; 831 case V4L2_CID_SATURATION: 832 ret = pwc_set_s8_ctrl(pdev, SET_CHROM_CTL, 833 pdev->saturation_fmt, ctrl->val); 834 break; 835 case V4L2_CID_GAMMA: 836 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 837 GAMMA_FORMATTER, ctrl->val); 838 break; 839 case V4L2_CID_AUTO_WHITE_BALANCE: 840 ret = pwc_set_awb(pdev); 841 break; 842 case V4L2_CID_AUTOGAIN: 843 if (DEVICE_USE_CODEC2(pdev->type)) 844 ret = pwc_set_autogain(pdev); 845 else if (DEVICE_USE_CODEC3(pdev->type)) 846 ret = pwc_set_autogain_expo(pdev); 847 else 848 ret = -EINVAL; 849 break; 850 case V4L2_CID_EXPOSURE_AUTO: 851 if (DEVICE_USE_CODEC2(pdev->type)) 852 ret = pwc_set_exposure_auto(pdev); 853 else 854 ret = -EINVAL; 855 break; 856 case V4L2_CID_COLORFX: 857 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL, 858 COLOUR_MODE_FORMATTER, 859 ctrl->val ? 0 : 0xff); 860 break; 861 case PWC_CID_CUSTOM(autocontour): 862 if (pdev->autocontour->is_new) { 863 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 864 AUTO_CONTOUR_FORMATTER, 865 pdev->autocontour->val ? 0 : 0xff); 866 } 867 if (ret == 0 && pdev->contour->is_new) { 868 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 869 PRESET_CONTOUR_FORMATTER, 870 pdev->contour->val); 871 } 872 break; 873 case V4L2_CID_BACKLIGHT_COMPENSATION: 874 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 875 BACK_LIGHT_COMPENSATION_FORMATTER, 876 ctrl->val ? 0 : 0xff); 877 break; 878 case V4L2_CID_BAND_STOP_FILTER: 879 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 880 FLICKERLESS_MODE_FORMATTER, 881 ctrl->val ? 0 : 0xff); 882 break; 883 case PWC_CID_CUSTOM(noise_reduction): 884 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 885 DYNAMIC_NOISE_CONTROL_FORMATTER, 886 ctrl->val); 887 break; 888 case PWC_CID_CUSTOM(save_user): 889 ret = pwc_button_ctrl(pdev, SAVE_USER_DEFAULTS_FORMATTER); 890 break; 891 case PWC_CID_CUSTOM(restore_user): 892 ret = pwc_button_ctrl(pdev, RESTORE_USER_DEFAULTS_FORMATTER); 893 break; 894 case PWC_CID_CUSTOM(restore_factory): 895 ret = pwc_button_ctrl(pdev, 896 RESTORE_FACTORY_DEFAULTS_FORMATTER); 897 break; 898 case PWC_CID_CUSTOM(awb_speed): 899 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL, 900 AWB_CONTROL_SPEED_FORMATTER, 901 ctrl->val); 902 break; 903 case PWC_CID_CUSTOM(awb_delay): 904 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL, 905 AWB_CONTROL_DELAY_FORMATTER, 906 ctrl->val); 907 break; 908 case V4L2_CID_PAN_RELATIVE: 909 ret = pwc_set_motor(pdev); 910 break; 911 default: 912 ret = -EINVAL; 913 } 914 915 if (ret) 916 PWC_ERROR("s_ctrl %s error %d\n", ctrl->name, ret); 917 918leave: 919 mutex_unlock(&pdev->udevlock); 920 return ret; 921} 922 923static int pwc_enum_fmt_vid_cap(struct file *file, void *fh, struct v4l2_fmtdesc *f) 924{ 925 struct pwc_device *pdev = video_drvdata(file); 926 927 /* We only support two format: the raw format, and YUV */ 928 switch (f->index) { 929 case 0: 930 /* RAW format */ 931 f->pixelformat = pdev->type <= 646 ? V4L2_PIX_FMT_PWC1 : V4L2_PIX_FMT_PWC2; 932 f->flags = V4L2_FMT_FLAG_COMPRESSED; 933 strlcpy(f->description, "Raw Philips Webcam", sizeof(f->description)); 934 break; 935 case 1: 936 f->pixelformat = V4L2_PIX_FMT_YUV420; 937 strlcpy(f->description, "4:2:0, planar, Y-Cb-Cr", sizeof(f->description)); 938 break; 939 default: 940 return -EINVAL; 941 } 942 return 0; 943} 944 945static int pwc_g_fmt_vid_cap(struct file *file, void *fh, struct v4l2_format *f) 946{ 947 struct pwc_device *pdev = video_drvdata(file); 948 949 if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 950 return -EINVAL; 951 952 mutex_lock(&pdev->udevlock); /* To avoid race with s_fmt */ 953 PWC_DEBUG_IOCTL("ioctl(VIDIOC_G_FMT) return size %dx%d\n", 954 pdev->width, pdev->height); 955 pwc_vidioc_fill_fmt(f, pdev->width, pdev->height, pdev->pixfmt); 956 mutex_unlock(&pdev->udevlock); 957 return 0; 958} 959 960static int pwc_try_fmt_vid_cap(struct file *file, void *fh, struct v4l2_format *f) 961{ 962 struct pwc_device *pdev = video_drvdata(file); 963 964 return pwc_vidioc_try_fmt(pdev, f); 965} 966 967static int pwc_reqbufs(struct file *file, void *fh, 968 struct v4l2_requestbuffers *rb) 969{ 970 struct pwc_device *pdev = video_drvdata(file); 971 972 if (pwc_test_n_set_capt_file(pdev, file)) 973 return -EBUSY; 974 975 return vb2_reqbufs(&pdev->vb_queue, rb); 976} 977 978static int pwc_querybuf(struct file *file, void *fh, struct v4l2_buffer *buf) 979{ 980 struct pwc_device *pdev = video_drvdata(file); 981 982 return vb2_querybuf(&pdev->vb_queue, buf); 983} 984 985static int pwc_qbuf(struct file *file, void *fh, struct v4l2_buffer *buf) 986{ 987 struct pwc_device *pdev = video_drvdata(file); 988 989 if (!pdev->udev) 990 return -ENODEV; 991 992 if (pdev->capt_file != file) 993 return -EBUSY; 994 995 return vb2_qbuf(&pdev->vb_queue, buf); 996} 997 998static int pwc_dqbuf(struct file *file, void *fh, struct v4l2_buffer *buf) 999{ 1000 struct pwc_device *pdev = video_drvdata(file); 1001 1002 if (!pdev->udev) 1003 return -ENODEV; 1004 1005 if (pdev->capt_file != file) 1006 return -EBUSY; 1007 1008 return vb2_dqbuf(&pdev->vb_queue, buf, file->f_flags & O_NONBLOCK); 1009} 1010 1011static int pwc_streamon(struct file *file, void *fh, enum v4l2_buf_type i) 1012{ 1013 struct pwc_device *pdev = video_drvdata(file); 1014 1015 if (!pdev->udev) 1016 return -ENODEV; 1017 1018 if (pdev->capt_file != file) 1019 return -EBUSY; 1020 1021 return vb2_streamon(&pdev->vb_queue, i); 1022} 1023 1024static int pwc_streamoff(struct file *file, void *fh, enum v4l2_buf_type i) 1025{ 1026 struct pwc_device *pdev = video_drvdata(file); 1027 1028 if (!pdev->udev) 1029 return -ENODEV; 1030 1031 if (pdev->capt_file != file) 1032 return -EBUSY; 1033 1034 return vb2_streamoff(&pdev->vb_queue, i); 1035} 1036 1037static int pwc_enum_framesizes(struct file *file, void *fh, 1038 struct v4l2_frmsizeenum *fsize) 1039{ 1040 struct pwc_device *pdev = video_drvdata(file); 1041 unsigned int i = 0, index = fsize->index; 1042 1043 if (fsize->pixel_format == V4L2_PIX_FMT_YUV420 || 1044 (fsize->pixel_format == V4L2_PIX_FMT_PWC1 && 1045 DEVICE_USE_CODEC1(pdev->type)) || 1046 (fsize->pixel_format == V4L2_PIX_FMT_PWC2 && 1047 DEVICE_USE_CODEC23(pdev->type))) { 1048 for (i = 0; i < PSZ_MAX; i++) { 1049 if (!(pdev->image_mask & (1UL << i))) 1050 continue; 1051 if (!index--) { 1052 fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 1053 fsize->discrete.width = pwc_image_sizes[i][0]; 1054 fsize->discrete.height = pwc_image_sizes[i][1]; 1055 return 0; 1056 } 1057 } 1058 } 1059 return -EINVAL; 1060} 1061 1062static int pwc_enum_frameintervals(struct file *file, void *fh, 1063 struct v4l2_frmivalenum *fival) 1064{ 1065 struct pwc_device *pdev = video_drvdata(file); 1066 int size = -1; 1067 unsigned int i; 1068 1069 for (i = 0; i < PSZ_MAX; i++) { 1070 if (pwc_image_sizes[i][0] == fival->width && 1071 pwc_image_sizes[i][1] == fival->height) { 1072 size = i; 1073 break; 1074 } 1075 } 1076 1077 /* TODO: Support raw format */ 1078 if (size < 0 || fival->pixel_format != V4L2_PIX_FMT_YUV420) 1079 return -EINVAL; 1080 1081 i = pwc_get_fps(pdev, fival->index, size); 1082 if (!i) 1083 return -EINVAL; 1084 1085 fival->type = V4L2_FRMIVAL_TYPE_DISCRETE; 1086 fival->discrete.numerator = 1; 1087 fival->discrete.denominator = i; 1088 1089 return 0; 1090} 1091 1092static int pwc_g_parm(struct file *file, void *fh, 1093 struct v4l2_streamparm *parm) 1094{ 1095 struct pwc_device *pdev = video_drvdata(file); 1096 1097 if (parm->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 1098 return -EINVAL; 1099 1100 memset(parm, 0, sizeof(*parm)); 1101 1102 parm->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1103 parm->parm.capture.readbuffers = MIN_FRAMES; 1104 parm->parm.capture.capability |= V4L2_CAP_TIMEPERFRAME; 1105 parm->parm.capture.timeperframe.denominator = pdev->vframes; 1106 parm->parm.capture.timeperframe.numerator = 1; 1107 1108 return 0; 1109} 1110 1111static int pwc_s_parm(struct file *file, void *fh, 1112 struct v4l2_streamparm *parm) 1113{ 1114 struct pwc_device *pdev = video_drvdata(file); 1115 int compression = 0; 1116 int ret, fps; 1117 1118 if (parm->type != V4L2_BUF_TYPE_VIDEO_CAPTURE || 1119 parm->parm.capture.timeperframe.numerator == 0) 1120 return -EINVAL; 1121 1122 if (pwc_test_n_set_capt_file(pdev, file)) 1123 return -EBUSY; 1124 1125 fps = parm->parm.capture.timeperframe.denominator / 1126 parm->parm.capture.timeperframe.numerator; 1127 1128 mutex_lock(&pdev->udevlock); 1129 if (!pdev->udev) { 1130 ret = -ENODEV; 1131 goto leave; 1132 } 1133 1134 if (pdev->iso_init) { 1135 ret = -EBUSY; 1136 goto leave; 1137 } 1138 1139 ret = pwc_set_video_mode(pdev, pdev->width, pdev->height, pdev->pixfmt, 1140 fps, &compression, 0); 1141 1142 pwc_g_parm(file, fh, parm); 1143 1144leave: 1145 mutex_unlock(&pdev->udevlock); 1146 return ret; 1147} 1148 1149const struct v4l2_ioctl_ops pwc_ioctl_ops = { 1150 .vidioc_querycap = pwc_querycap, 1151 .vidioc_enum_input = pwc_enum_input, 1152 .vidioc_g_input = pwc_g_input, 1153 .vidioc_s_input = pwc_s_input, 1154 .vidioc_enum_fmt_vid_cap = pwc_enum_fmt_vid_cap, 1155 .vidioc_g_fmt_vid_cap = pwc_g_fmt_vid_cap, 1156 .vidioc_s_fmt_vid_cap = pwc_s_fmt_vid_cap, 1157 .vidioc_try_fmt_vid_cap = pwc_try_fmt_vid_cap, 1158 .vidioc_reqbufs = pwc_reqbufs, 1159 .vidioc_querybuf = pwc_querybuf, 1160 .vidioc_qbuf = pwc_qbuf, 1161 .vidioc_dqbuf = pwc_dqbuf, 1162 .vidioc_streamon = pwc_streamon, 1163 .vidioc_streamoff = pwc_streamoff, 1164 .vidioc_log_status = v4l2_ctrl_log_status, 1165 .vidioc_enum_framesizes = pwc_enum_framesizes, 1166 .vidioc_enum_frameintervals = pwc_enum_frameintervals, 1167 .vidioc_g_parm = pwc_g_parm, 1168 .vidioc_s_parm = pwc_s_parm, 1169}; 1170