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