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 42 static int pwc_g_volatile_ctrl(struct v4l2_ctrl *ctrl); 43 static int pwc_s_ctrl(struct v4l2_ctrl *ctrl); 44 45 static const struct v4l2_ctrl_ops pwc_ctrl_ops = { 46 .g_volatile_ctrl = pwc_g_volatile_ctrl, 47 .s_ctrl = pwc_s_ctrl, 48 }; 49 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 }; 54 55 static const 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 64 static 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 72 static 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 82 static 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 93 static 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 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, 106 .min = 0, 107 .max = 1, 108 .step = 1, 109 }; 110 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", 116 .min = 0, 117 .max = 3, 118 .step = 1, 119 }; 120 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", 126 }; 127 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", 133 }; 134 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", 140 }; 141 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", 147 .min = 1, 148 .max = 32, 149 .step = 1, 150 }; 151 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", 157 .min = 0, 158 .max = 63, 159 .step = 1, 160 }; 161 162 int 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 398 static 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 f->fmt.pix.colorspace = V4L2_COLORSPACE_SRGB; 409 PWC_DEBUG_IOCTL("pwc_vidioc_fill_fmt() 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) */ 421 static 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 f->fmt.pix.pixelformat = V4L2_PIX_FMT_YUV420; 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 f->fmt.pix.pixelformat = V4L2_PIX_FMT_YUV420; 443 } 444 break; 445 default: 446 PWC_DEBUG_IOCTL("Unsupported pixel format\n"); 447 f->fmt.pix.pixelformat = V4L2_PIX_FMT_YUV420; 448 } 449 450 size = pwc_get_size(pdev, f->fmt.pix.width, f->fmt.pix.height); 451 pwc_vidioc_fill_fmt(f, 452 pwc_image_sizes[size][0], 453 pwc_image_sizes[size][1], 454 f->fmt.pix.pixelformat); 455 456 return 0; 457 } 458 459 /* ioctl(VIDIOC_SET_FMT) */ 460 461 static int pwc_s_fmt_vid_cap(struct file *file, void *fh, struct v4l2_format *f) 462 { 463 struct pwc_device *pdev = video_drvdata(file); 464 int ret, pixelformat, compression = 0; 465 466 ret = pwc_vidioc_try_fmt(pdev, f); 467 if (ret < 0) 468 return ret; 469 470 if (vb2_is_busy(&pdev->vb_queue)) 471 return -EBUSY; 472 473 pixelformat = f->fmt.pix.pixelformat; 474 475 PWC_DEBUG_IOCTL("Trying to set format to: width=%d height=%d fps=%d format=%c%c%c%c\n", 476 f->fmt.pix.width, f->fmt.pix.height, pdev->vframes, 477 (pixelformat)&255, 478 (pixelformat>>8)&255, 479 (pixelformat>>16)&255, 480 (pixelformat>>24)&255); 481 482 ret = pwc_set_video_mode(pdev, f->fmt.pix.width, f->fmt.pix.height, 483 pixelformat, 30, &compression, 0); 484 485 PWC_DEBUG_IOCTL("pwc_set_video_mode(), return=%d\n", ret); 486 487 pwc_vidioc_fill_fmt(f, pdev->width, pdev->height, pdev->pixfmt); 488 return ret; 489 } 490 491 static int pwc_querycap(struct file *file, void *fh, struct v4l2_capability *cap) 492 { 493 struct pwc_device *pdev = video_drvdata(file); 494 495 strcpy(cap->driver, PWC_NAME); 496 strlcpy(cap->card, pdev->vdev.name, sizeof(cap->card)); 497 usb_make_path(pdev->udev, cap->bus_info, sizeof(cap->bus_info)); 498 cap->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING | 499 V4L2_CAP_READWRITE; 500 cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS; 501 return 0; 502 } 503 504 static int pwc_enum_input(struct file *file, void *fh, struct v4l2_input *i) 505 { 506 if (i->index) /* Only one INPUT is supported */ 507 return -EINVAL; 508 509 strlcpy(i->name, "Camera", sizeof(i->name)); 510 i->type = V4L2_INPUT_TYPE_CAMERA; 511 return 0; 512 } 513 514 static int pwc_g_input(struct file *file, void *fh, unsigned int *i) 515 { 516 *i = 0; 517 return 0; 518 } 519 520 static int pwc_s_input(struct file *file, void *fh, unsigned int i) 521 { 522 return i ? -EINVAL : 0; 523 } 524 525 static int pwc_g_volatile_ctrl(struct v4l2_ctrl *ctrl) 526 { 527 struct pwc_device *pdev = 528 container_of(ctrl->handler, struct pwc_device, ctrl_handler); 529 int ret = 0; 530 531 switch (ctrl->id) { 532 case V4L2_CID_AUTO_WHITE_BALANCE: 533 if (pdev->color_bal_valid && 534 (pdev->auto_white_balance->val != awb_auto || 535 time_before(jiffies, 536 pdev->last_color_bal_update + HZ / 4))) { 537 pdev->red_balance->val = pdev->last_red_balance; 538 pdev->blue_balance->val = pdev->last_blue_balance; 539 break; 540 } 541 ret = pwc_get_u8_ctrl(pdev, GET_STATUS_CTL, 542 READ_RED_GAIN_FORMATTER, 543 &pdev->red_balance->val); 544 if (ret) 545 break; 546 ret = pwc_get_u8_ctrl(pdev, GET_STATUS_CTL, 547 READ_BLUE_GAIN_FORMATTER, 548 &pdev->blue_balance->val); 549 if (ret) 550 break; 551 pdev->last_red_balance = pdev->red_balance->val; 552 pdev->last_blue_balance = pdev->blue_balance->val; 553 pdev->last_color_bal_update = jiffies; 554 pdev->color_bal_valid = true; 555 break; 556 case V4L2_CID_AUTOGAIN: 557 if (pdev->gain_valid && time_before(jiffies, 558 pdev->last_gain_update + HZ / 4)) { 559 pdev->gain->val = pdev->last_gain; 560 break; 561 } 562 ret = pwc_get_u8_ctrl(pdev, GET_STATUS_CTL, 563 READ_AGC_FORMATTER, &pdev->gain->val); 564 if (ret) 565 break; 566 pdev->last_gain = pdev->gain->val; 567 pdev->last_gain_update = jiffies; 568 pdev->gain_valid = true; 569 if (!DEVICE_USE_CODEC3(pdev->type)) 570 break; 571 /* For CODEC3 where autogain also controls expo */ 572 /* fall through */ 573 case V4L2_CID_EXPOSURE_AUTO: 574 if (pdev->exposure_valid && time_before(jiffies, 575 pdev->last_exposure_update + HZ / 4)) { 576 pdev->exposure->val = pdev->last_exposure; 577 break; 578 } 579 ret = pwc_get_u16_ctrl(pdev, GET_STATUS_CTL, 580 READ_SHUTTER_FORMATTER, 581 &pdev->exposure->val); 582 if (ret) 583 break; 584 pdev->last_exposure = pdev->exposure->val; 585 pdev->last_exposure_update = jiffies; 586 pdev->exposure_valid = true; 587 break; 588 default: 589 ret = -EINVAL; 590 } 591 592 if (ret) 593 PWC_ERROR("g_ctrl %s error %d\n", ctrl->name, ret); 594 595 return ret; 596 } 597 598 static int pwc_set_awb(struct pwc_device *pdev) 599 { 600 int ret; 601 602 if (pdev->auto_white_balance->is_new) { 603 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL, 604 WB_MODE_FORMATTER, 605 pdev->auto_white_balance->val); 606 if (ret) 607 return ret; 608 609 if (pdev->auto_white_balance->val != awb_manual) 610 pdev->color_bal_valid = false; /* Force cache update */ 611 612 /* 613 * If this is a preset, update our red / blue balance values 614 * so that events get generated for the new preset values 615 */ 616 if (pdev->auto_white_balance->val == awb_indoor || 617 pdev->auto_white_balance->val == awb_outdoor || 618 pdev->auto_white_balance->val == awb_fl) 619 pwc_g_volatile_ctrl(pdev->auto_white_balance); 620 } 621 if (pdev->auto_white_balance->val != awb_manual) 622 return 0; 623 624 if (pdev->red_balance->is_new) { 625 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL, 626 PRESET_MANUAL_RED_GAIN_FORMATTER, 627 pdev->red_balance->val); 628 if (ret) 629 return ret; 630 } 631 632 if (pdev->blue_balance->is_new) { 633 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL, 634 PRESET_MANUAL_BLUE_GAIN_FORMATTER, 635 pdev->blue_balance->val); 636 if (ret) 637 return ret; 638 } 639 return 0; 640 } 641 642 /* For CODEC2 models which have separate autogain and auto exposure */ 643 static int pwc_set_autogain(struct pwc_device *pdev) 644 { 645 int ret; 646 647 if (pdev->autogain->is_new) { 648 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 649 AGC_MODE_FORMATTER, 650 pdev->autogain->val ? 0 : 0xff); 651 if (ret) 652 return ret; 653 654 if (pdev->autogain->val) 655 pdev->gain_valid = false; /* Force cache update */ 656 } 657 658 if (pdev->autogain->val) 659 return 0; 660 661 if (pdev->gain->is_new) { 662 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 663 PRESET_AGC_FORMATTER, 664 pdev->gain->val); 665 if (ret) 666 return ret; 667 } 668 return 0; 669 } 670 671 /* For CODEC2 models which have separate autogain and auto exposure */ 672 static int pwc_set_exposure_auto(struct pwc_device *pdev) 673 { 674 int ret; 675 int is_auto = pdev->exposure_auto->val == V4L2_EXPOSURE_AUTO; 676 677 if (pdev->exposure_auto->is_new) { 678 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 679 SHUTTER_MODE_FORMATTER, 680 is_auto ? 0 : 0xff); 681 if (ret) 682 return ret; 683 684 if (is_auto) 685 pdev->exposure_valid = false; /* Force cache update */ 686 } 687 688 if (is_auto) 689 return 0; 690 691 if (pdev->exposure->is_new) { 692 ret = pwc_set_u16_ctrl(pdev, SET_LUM_CTL, 693 PRESET_SHUTTER_FORMATTER, 694 pdev->exposure->val); 695 if (ret) 696 return ret; 697 } 698 return 0; 699 } 700 701 /* For CODEC3 models which have autogain controlling both gain and exposure */ 702 static int pwc_set_autogain_expo(struct pwc_device *pdev) 703 { 704 int ret; 705 706 if (pdev->autogain->is_new) { 707 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 708 AGC_MODE_FORMATTER, 709 pdev->autogain->val ? 0 : 0xff); 710 if (ret) 711 return ret; 712 713 if (pdev->autogain->val) { 714 pdev->gain_valid = false; /* Force cache update */ 715 pdev->exposure_valid = false; /* Force cache update */ 716 } 717 } 718 719 if (pdev->autogain->val) 720 return 0; 721 722 if (pdev->gain->is_new) { 723 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 724 PRESET_AGC_FORMATTER, 725 pdev->gain->val); 726 if (ret) 727 return ret; 728 } 729 730 if (pdev->exposure->is_new) { 731 ret = pwc_set_u16_ctrl(pdev, SET_LUM_CTL, 732 PRESET_SHUTTER_FORMATTER, 733 pdev->exposure->val); 734 if (ret) 735 return ret; 736 } 737 return 0; 738 } 739 740 static int pwc_set_motor(struct pwc_device *pdev) 741 { 742 int ret; 743 744 pdev->ctrl_buf[0] = 0; 745 if (pdev->motor_pan_reset->is_new) 746 pdev->ctrl_buf[0] |= 0x01; 747 if (pdev->motor_tilt_reset->is_new) 748 pdev->ctrl_buf[0] |= 0x02; 749 if (pdev->motor_pan_reset->is_new || pdev->motor_tilt_reset->is_new) { 750 ret = send_control_msg(pdev, SET_MPT_CTL, 751 PT_RESET_CONTROL_FORMATTER, 752 pdev->ctrl_buf, 1); 753 if (ret < 0) 754 return ret; 755 } 756 757 memset(pdev->ctrl_buf, 0, 4); 758 if (pdev->motor_pan->is_new) { 759 pdev->ctrl_buf[0] = pdev->motor_pan->val & 0xFF; 760 pdev->ctrl_buf[1] = (pdev->motor_pan->val >> 8); 761 } 762 if (pdev->motor_tilt->is_new) { 763 pdev->ctrl_buf[2] = pdev->motor_tilt->val & 0xFF; 764 pdev->ctrl_buf[3] = (pdev->motor_tilt->val >> 8); 765 } 766 if (pdev->motor_pan->is_new || pdev->motor_tilt->is_new) { 767 ret = send_control_msg(pdev, SET_MPT_CTL, 768 PT_RELATIVE_CONTROL_FORMATTER, 769 pdev->ctrl_buf, 4); 770 if (ret < 0) 771 return ret; 772 } 773 774 return 0; 775 } 776 777 static int pwc_s_ctrl(struct v4l2_ctrl *ctrl) 778 { 779 struct pwc_device *pdev = 780 container_of(ctrl->handler, struct pwc_device, ctrl_handler); 781 int ret = 0; 782 783 switch (ctrl->id) { 784 case V4L2_CID_BRIGHTNESS: 785 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 786 BRIGHTNESS_FORMATTER, ctrl->val); 787 break; 788 case V4L2_CID_CONTRAST: 789 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 790 CONTRAST_FORMATTER, ctrl->val); 791 break; 792 case V4L2_CID_SATURATION: 793 ret = pwc_set_s8_ctrl(pdev, SET_CHROM_CTL, 794 pdev->saturation_fmt, ctrl->val); 795 break; 796 case V4L2_CID_GAMMA: 797 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 798 GAMMA_FORMATTER, ctrl->val); 799 break; 800 case V4L2_CID_AUTO_WHITE_BALANCE: 801 ret = pwc_set_awb(pdev); 802 break; 803 case V4L2_CID_AUTOGAIN: 804 if (DEVICE_USE_CODEC2(pdev->type)) 805 ret = pwc_set_autogain(pdev); 806 else if (DEVICE_USE_CODEC3(pdev->type)) 807 ret = pwc_set_autogain_expo(pdev); 808 else 809 ret = -EINVAL; 810 break; 811 case V4L2_CID_EXPOSURE_AUTO: 812 if (DEVICE_USE_CODEC2(pdev->type)) 813 ret = pwc_set_exposure_auto(pdev); 814 else 815 ret = -EINVAL; 816 break; 817 case V4L2_CID_COLORFX: 818 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL, 819 COLOUR_MODE_FORMATTER, 820 ctrl->val ? 0 : 0xff); 821 break; 822 case PWC_CID_CUSTOM(autocontour): 823 if (pdev->autocontour->is_new) { 824 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 825 AUTO_CONTOUR_FORMATTER, 826 pdev->autocontour->val ? 0 : 0xff); 827 } 828 if (ret == 0 && pdev->contour->is_new) { 829 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 830 PRESET_CONTOUR_FORMATTER, 831 pdev->contour->val); 832 } 833 break; 834 case V4L2_CID_BACKLIGHT_COMPENSATION: 835 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 836 BACK_LIGHT_COMPENSATION_FORMATTER, 837 ctrl->val ? 0 : 0xff); 838 break; 839 case V4L2_CID_BAND_STOP_FILTER: 840 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 841 FLICKERLESS_MODE_FORMATTER, 842 ctrl->val ? 0 : 0xff); 843 break; 844 case PWC_CID_CUSTOM(noise_reduction): 845 ret = pwc_set_u8_ctrl(pdev, SET_LUM_CTL, 846 DYNAMIC_NOISE_CONTROL_FORMATTER, 847 ctrl->val); 848 break; 849 case PWC_CID_CUSTOM(save_user): 850 ret = pwc_button_ctrl(pdev, SAVE_USER_DEFAULTS_FORMATTER); 851 break; 852 case PWC_CID_CUSTOM(restore_user): 853 ret = pwc_button_ctrl(pdev, RESTORE_USER_DEFAULTS_FORMATTER); 854 break; 855 case PWC_CID_CUSTOM(restore_factory): 856 ret = pwc_button_ctrl(pdev, 857 RESTORE_FACTORY_DEFAULTS_FORMATTER); 858 break; 859 case PWC_CID_CUSTOM(awb_speed): 860 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL, 861 AWB_CONTROL_SPEED_FORMATTER, 862 ctrl->val); 863 break; 864 case PWC_CID_CUSTOM(awb_delay): 865 ret = pwc_set_u8_ctrl(pdev, SET_CHROM_CTL, 866 AWB_CONTROL_DELAY_FORMATTER, 867 ctrl->val); 868 break; 869 case V4L2_CID_PAN_RELATIVE: 870 ret = pwc_set_motor(pdev); 871 break; 872 default: 873 ret = -EINVAL; 874 } 875 876 if (ret) 877 PWC_ERROR("s_ctrl %s error %d\n", ctrl->name, ret); 878 879 return ret; 880 } 881 882 static int pwc_enum_fmt_vid_cap(struct file *file, void *fh, struct v4l2_fmtdesc *f) 883 { 884 struct pwc_device *pdev = video_drvdata(file); 885 886 /* We only support two format: the raw format, and YUV */ 887 switch (f->index) { 888 case 0: 889 /* RAW format */ 890 f->pixelformat = pdev->type <= 646 ? V4L2_PIX_FMT_PWC1 : V4L2_PIX_FMT_PWC2; 891 f->flags = V4L2_FMT_FLAG_COMPRESSED; 892 strlcpy(f->description, "Raw Philips Webcam", sizeof(f->description)); 893 break; 894 case 1: 895 f->pixelformat = V4L2_PIX_FMT_YUV420; 896 strlcpy(f->description, "4:2:0, planar, Y-Cb-Cr", sizeof(f->description)); 897 break; 898 default: 899 return -EINVAL; 900 } 901 return 0; 902 } 903 904 static int pwc_g_fmt_vid_cap(struct file *file, void *fh, struct v4l2_format *f) 905 { 906 struct pwc_device *pdev = video_drvdata(file); 907 908 if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 909 return -EINVAL; 910 911 PWC_DEBUG_IOCTL("ioctl(VIDIOC_G_FMT) return size %dx%d\n", 912 pdev->width, pdev->height); 913 pwc_vidioc_fill_fmt(f, pdev->width, pdev->height, pdev->pixfmt); 914 return 0; 915 } 916 917 static int pwc_try_fmt_vid_cap(struct file *file, void *fh, struct v4l2_format *f) 918 { 919 struct pwc_device *pdev = video_drvdata(file); 920 921 return pwc_vidioc_try_fmt(pdev, f); 922 } 923 924 static int pwc_enum_framesizes(struct file *file, void *fh, 925 struct v4l2_frmsizeenum *fsize) 926 { 927 struct pwc_device *pdev = video_drvdata(file); 928 unsigned int i = 0, index = fsize->index; 929 930 if (fsize->pixel_format == V4L2_PIX_FMT_YUV420 || 931 (fsize->pixel_format == V4L2_PIX_FMT_PWC1 && 932 DEVICE_USE_CODEC1(pdev->type)) || 933 (fsize->pixel_format == V4L2_PIX_FMT_PWC2 && 934 DEVICE_USE_CODEC23(pdev->type))) { 935 for (i = 0; i < PSZ_MAX; i++) { 936 if (!(pdev->image_mask & (1UL << i))) 937 continue; 938 if (!index--) { 939 fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 940 fsize->discrete.width = pwc_image_sizes[i][0]; 941 fsize->discrete.height = pwc_image_sizes[i][1]; 942 return 0; 943 } 944 } 945 } 946 return -EINVAL; 947 } 948 949 static int pwc_enum_frameintervals(struct file *file, void *fh, 950 struct v4l2_frmivalenum *fival) 951 { 952 struct pwc_device *pdev = video_drvdata(file); 953 int size = -1; 954 unsigned int i; 955 956 for (i = 0; i < PSZ_MAX; i++) { 957 if (pwc_image_sizes[i][0] == fival->width && 958 pwc_image_sizes[i][1] == fival->height) { 959 size = i; 960 break; 961 } 962 } 963 964 /* TODO: Support raw format */ 965 if (size < 0 || fival->pixel_format != V4L2_PIX_FMT_YUV420) 966 return -EINVAL; 967 968 i = pwc_get_fps(pdev, fival->index, size); 969 if (!i) 970 return -EINVAL; 971 972 fival->type = V4L2_FRMIVAL_TYPE_DISCRETE; 973 fival->discrete.numerator = 1; 974 fival->discrete.denominator = i; 975 976 return 0; 977 } 978 979 static int pwc_g_parm(struct file *file, void *fh, 980 struct v4l2_streamparm *parm) 981 { 982 struct pwc_device *pdev = video_drvdata(file); 983 984 if (parm->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 985 return -EINVAL; 986 987 memset(parm, 0, sizeof(*parm)); 988 989 parm->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 990 parm->parm.capture.readbuffers = MIN_FRAMES; 991 parm->parm.capture.capability |= V4L2_CAP_TIMEPERFRAME; 992 parm->parm.capture.timeperframe.denominator = pdev->vframes; 993 parm->parm.capture.timeperframe.numerator = 1; 994 995 return 0; 996 } 997 998 static int pwc_s_parm(struct file *file, void *fh, 999 struct v4l2_streamparm *parm) 1000 { 1001 struct pwc_device *pdev = video_drvdata(file); 1002 int compression = 0; 1003 int ret, fps; 1004 1005 if (parm->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 1006 return -EINVAL; 1007 1008 /* If timeperframe == 0, then reset the framerate to the nominal value. 1009 We pick a high framerate here, and let pwc_set_video_mode() figure 1010 out the best match. */ 1011 if (parm->parm.capture.timeperframe.numerator == 0 || 1012 parm->parm.capture.timeperframe.denominator == 0) 1013 fps = 30; 1014 else 1015 fps = parm->parm.capture.timeperframe.denominator / 1016 parm->parm.capture.timeperframe.numerator; 1017 1018 if (vb2_is_busy(&pdev->vb_queue)) 1019 return -EBUSY; 1020 1021 ret = pwc_set_video_mode(pdev, pdev->width, pdev->height, pdev->pixfmt, 1022 fps, &compression, 0); 1023 1024 pwc_g_parm(file, fh, parm); 1025 1026 return ret; 1027 } 1028 1029 const struct v4l2_ioctl_ops pwc_ioctl_ops = { 1030 .vidioc_querycap = pwc_querycap, 1031 .vidioc_enum_input = pwc_enum_input, 1032 .vidioc_g_input = pwc_g_input, 1033 .vidioc_s_input = pwc_s_input, 1034 .vidioc_enum_fmt_vid_cap = pwc_enum_fmt_vid_cap, 1035 .vidioc_g_fmt_vid_cap = pwc_g_fmt_vid_cap, 1036 .vidioc_s_fmt_vid_cap = pwc_s_fmt_vid_cap, 1037 .vidioc_try_fmt_vid_cap = pwc_try_fmt_vid_cap, 1038 .vidioc_reqbufs = vb2_ioctl_reqbufs, 1039 .vidioc_querybuf = vb2_ioctl_querybuf, 1040 .vidioc_qbuf = vb2_ioctl_qbuf, 1041 .vidioc_dqbuf = vb2_ioctl_dqbuf, 1042 .vidioc_streamon = vb2_ioctl_streamon, 1043 .vidioc_streamoff = vb2_ioctl_streamoff, 1044 .vidioc_log_status = v4l2_ctrl_log_status, 1045 .vidioc_enum_framesizes = pwc_enum_framesizes, 1046 .vidioc_enum_frameintervals = pwc_enum_frameintervals, 1047 .vidioc_g_parm = pwc_g_parm, 1048 .vidioc_s_parm = pwc_s_parm, 1049 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 1050 .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 1051 }; 1052