2 * uvc_ctrl.c -- USB Video Class driver - Controls
4 * Copyright (C) 2005-2009
5 * Laurent Pinchart (laurent.pinchart@skynet.be)
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
14 #include <linux/kernel.h>
15 #include <linux/list.h>
16 #include <linux/module.h>
17 #include <linux/uaccess.h>
18 #include <linux/usb.h>
19 #include <linux/videodev2.h>
20 #include <linux/vmalloc.h>
21 #include <linux/wait.h>
22 #include <asm/atomic.h>
26 #define UVC_CTRL_NDATA 2
27 #define UVC_CTRL_DATA_CURRENT 0
28 #define UVC_CTRL_DATA_BACKUP 1
30 /* ------------------------------------------------------------------------
34 static struct uvc_control_info uvc_ctrls[] = {
36 .entity = UVC_GUID_UVC_PROCESSING,
37 .selector = UVC_PU_BRIGHTNESS_CONTROL,
40 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
41 | UVC_CONTROL_RESTORE,
44 .entity = UVC_GUID_UVC_PROCESSING,
45 .selector = UVC_PU_CONTRAST_CONTROL,
48 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
49 | UVC_CONTROL_RESTORE,
52 .entity = UVC_GUID_UVC_PROCESSING,
53 .selector = UVC_PU_HUE_CONTROL,
56 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
57 | UVC_CONTROL_RESTORE | UVC_CONTROL_AUTO_UPDATE,
60 .entity = UVC_GUID_UVC_PROCESSING,
61 .selector = UVC_PU_SATURATION_CONTROL,
64 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
65 | UVC_CONTROL_RESTORE,
68 .entity = UVC_GUID_UVC_PROCESSING,
69 .selector = UVC_PU_SHARPNESS_CONTROL,
72 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
73 | UVC_CONTROL_RESTORE,
76 .entity = UVC_GUID_UVC_PROCESSING,
77 .selector = UVC_PU_GAMMA_CONTROL,
80 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
81 | UVC_CONTROL_RESTORE,
84 .entity = UVC_GUID_UVC_PROCESSING,
85 .selector = UVC_PU_WHITE_BALANCE_TEMPERATURE_CONTROL,
88 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
89 | UVC_CONTROL_RESTORE | UVC_CONTROL_AUTO_UPDATE,
92 .entity = UVC_GUID_UVC_PROCESSING,
93 .selector = UVC_PU_WHITE_BALANCE_COMPONENT_CONTROL,
96 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
97 | UVC_CONTROL_RESTORE | UVC_CONTROL_AUTO_UPDATE,
100 .entity = UVC_GUID_UVC_PROCESSING,
101 .selector = UVC_PU_BACKLIGHT_COMPENSATION_CONTROL,
104 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
105 | UVC_CONTROL_RESTORE,
108 .entity = UVC_GUID_UVC_PROCESSING,
109 .selector = UVC_PU_GAIN_CONTROL,
112 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
113 | UVC_CONTROL_RESTORE,
116 .entity = UVC_GUID_UVC_PROCESSING,
117 .selector = UVC_PU_POWER_LINE_FREQUENCY_CONTROL,
120 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
121 | UVC_CONTROL_RESTORE,
124 .entity = UVC_GUID_UVC_PROCESSING,
125 .selector = UVC_PU_HUE_AUTO_CONTROL,
128 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_CUR
129 | UVC_CONTROL_GET_DEF | UVC_CONTROL_RESTORE,
132 .entity = UVC_GUID_UVC_PROCESSING,
133 .selector = UVC_PU_WHITE_BALANCE_TEMPERATURE_AUTO_CONTROL,
136 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_CUR
137 | UVC_CONTROL_GET_DEF | UVC_CONTROL_RESTORE,
140 .entity = UVC_GUID_UVC_PROCESSING,
141 .selector = UVC_PU_WHITE_BALANCE_COMPONENT_AUTO_CONTROL,
144 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_CUR
145 | UVC_CONTROL_GET_DEF | UVC_CONTROL_RESTORE,
148 .entity = UVC_GUID_UVC_PROCESSING,
149 .selector = UVC_PU_DIGITAL_MULTIPLIER_CONTROL,
152 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
153 | UVC_CONTROL_RESTORE,
156 .entity = UVC_GUID_UVC_PROCESSING,
157 .selector = UVC_PU_DIGITAL_MULTIPLIER_LIMIT_CONTROL,
160 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
161 | UVC_CONTROL_RESTORE,
164 .entity = UVC_GUID_UVC_PROCESSING,
165 .selector = UVC_PU_ANALOG_VIDEO_STANDARD_CONTROL,
168 .flags = UVC_CONTROL_GET_CUR,
171 .entity = UVC_GUID_UVC_PROCESSING,
172 .selector = UVC_PU_ANALOG_LOCK_STATUS_CONTROL,
175 .flags = UVC_CONTROL_GET_CUR,
178 .entity = UVC_GUID_UVC_CAMERA,
179 .selector = UVC_CT_SCANNING_MODE_CONTROL,
182 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_CUR
183 | UVC_CONTROL_RESTORE,
186 .entity = UVC_GUID_UVC_CAMERA,
187 .selector = UVC_CT_AE_MODE_CONTROL,
190 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_CUR
191 | UVC_CONTROL_GET_DEF | UVC_CONTROL_GET_RES
192 | UVC_CONTROL_RESTORE,
195 .entity = UVC_GUID_UVC_CAMERA,
196 .selector = UVC_CT_AE_PRIORITY_CONTROL,
199 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_CUR
200 | UVC_CONTROL_RESTORE,
203 .entity = UVC_GUID_UVC_CAMERA,
204 .selector = UVC_CT_EXPOSURE_TIME_ABSOLUTE_CONTROL,
207 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
208 | UVC_CONTROL_RESTORE,
211 .entity = UVC_GUID_UVC_CAMERA,
212 .selector = UVC_CT_EXPOSURE_TIME_RELATIVE_CONTROL,
215 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_CUR
216 | UVC_CONTROL_RESTORE,
219 .entity = UVC_GUID_UVC_CAMERA,
220 .selector = UVC_CT_FOCUS_ABSOLUTE_CONTROL,
223 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
224 | UVC_CONTROL_RESTORE | UVC_CONTROL_AUTO_UPDATE,
227 .entity = UVC_GUID_UVC_CAMERA,
228 .selector = UVC_CT_FOCUS_RELATIVE_CONTROL,
231 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
232 | UVC_CONTROL_AUTO_UPDATE,
235 .entity = UVC_GUID_UVC_CAMERA,
236 .selector = UVC_CT_IRIS_ABSOLUTE_CONTROL,
239 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
240 | UVC_CONTROL_RESTORE | UVC_CONTROL_AUTO_UPDATE,
243 .entity = UVC_GUID_UVC_CAMERA,
244 .selector = UVC_CT_IRIS_RELATIVE_CONTROL,
247 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_CUR
248 | UVC_CONTROL_AUTO_UPDATE,
251 .entity = UVC_GUID_UVC_CAMERA,
252 .selector = UVC_CT_ZOOM_ABSOLUTE_CONTROL,
255 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
256 | UVC_CONTROL_RESTORE | UVC_CONTROL_AUTO_UPDATE,
259 .entity = UVC_GUID_UVC_CAMERA,
260 .selector = UVC_CT_ZOOM_RELATIVE_CONTROL,
263 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
264 | UVC_CONTROL_AUTO_UPDATE,
267 .entity = UVC_GUID_UVC_CAMERA,
268 .selector = UVC_CT_PANTILT_ABSOLUTE_CONTROL,
271 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
272 | UVC_CONTROL_RESTORE | UVC_CONTROL_AUTO_UPDATE,
275 .entity = UVC_GUID_UVC_CAMERA,
276 .selector = UVC_CT_PANTILT_RELATIVE_CONTROL,
279 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
280 | UVC_CONTROL_AUTO_UPDATE,
283 .entity = UVC_GUID_UVC_CAMERA,
284 .selector = UVC_CT_ROLL_ABSOLUTE_CONTROL,
287 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
288 | UVC_CONTROL_RESTORE | UVC_CONTROL_AUTO_UPDATE,
291 .entity = UVC_GUID_UVC_CAMERA,
292 .selector = UVC_CT_ROLL_RELATIVE_CONTROL,
295 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_RANGE
296 | UVC_CONTROL_AUTO_UPDATE,
299 .entity = UVC_GUID_UVC_CAMERA,
300 .selector = UVC_CT_FOCUS_AUTO_CONTROL,
303 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_CUR
304 | UVC_CONTROL_GET_DEF | UVC_CONTROL_RESTORE,
307 .entity = UVC_GUID_UVC_CAMERA,
308 .selector = UVC_CT_PRIVACY_CONTROL,
311 .flags = UVC_CONTROL_SET_CUR | UVC_CONTROL_GET_CUR
312 | UVC_CONTROL_RESTORE | UVC_CONTROL_AUTO_UPDATE,
316 static struct uvc_menu_info power_line_frequency_controls[] = {
322 static struct uvc_menu_info exposure_auto_controls[] = {
324 { 1, "Manual Mode" },
325 { 4, "Shutter Priority Mode" },
326 { 8, "Aperture Priority Mode" },
329 static __s32 uvc_ctrl_get_zoom(struct uvc_control_mapping *mapping,
330 __u8 query, const __u8 *data)
332 __s8 zoom = (__s8)data[0];
336 return (zoom == 0) ? 0 : (zoom > 0 ? data[2] : -data[2]);
347 static void uvc_ctrl_set_zoom(struct uvc_control_mapping *mapping,
348 __s32 value, __u8 *data)
350 data[0] = value == 0 ? 0 : (value > 0) ? 1 : 0xff;
351 data[2] = min((int)abs(value), 0xff);
354 static struct uvc_control_mapping uvc_ctrl_mappings[] = {
356 .id = V4L2_CID_BRIGHTNESS,
357 .name = "Brightness",
358 .entity = UVC_GUID_UVC_PROCESSING,
359 .selector = UVC_PU_BRIGHTNESS_CONTROL,
362 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
363 .data_type = UVC_CTRL_DATA_TYPE_SIGNED,
366 .id = V4L2_CID_CONTRAST,
368 .entity = UVC_GUID_UVC_PROCESSING,
369 .selector = UVC_PU_CONTRAST_CONTROL,
372 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
373 .data_type = UVC_CTRL_DATA_TYPE_UNSIGNED,
378 .entity = UVC_GUID_UVC_PROCESSING,
379 .selector = UVC_PU_HUE_CONTROL,
382 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
383 .data_type = UVC_CTRL_DATA_TYPE_SIGNED,
386 .id = V4L2_CID_SATURATION,
387 .name = "Saturation",
388 .entity = UVC_GUID_UVC_PROCESSING,
389 .selector = UVC_PU_SATURATION_CONTROL,
392 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
393 .data_type = UVC_CTRL_DATA_TYPE_UNSIGNED,
396 .id = V4L2_CID_SHARPNESS,
398 .entity = UVC_GUID_UVC_PROCESSING,
399 .selector = UVC_PU_SHARPNESS_CONTROL,
402 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
403 .data_type = UVC_CTRL_DATA_TYPE_UNSIGNED,
406 .id = V4L2_CID_GAMMA,
408 .entity = UVC_GUID_UVC_PROCESSING,
409 .selector = UVC_PU_GAMMA_CONTROL,
412 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
413 .data_type = UVC_CTRL_DATA_TYPE_UNSIGNED,
416 .id = V4L2_CID_BACKLIGHT_COMPENSATION,
417 .name = "Backlight Compensation",
418 .entity = UVC_GUID_UVC_PROCESSING,
419 .selector = UVC_PU_BACKLIGHT_COMPENSATION_CONTROL,
422 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
423 .data_type = UVC_CTRL_DATA_TYPE_UNSIGNED,
428 .entity = UVC_GUID_UVC_PROCESSING,
429 .selector = UVC_PU_GAIN_CONTROL,
432 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
433 .data_type = UVC_CTRL_DATA_TYPE_UNSIGNED,
436 .id = V4L2_CID_POWER_LINE_FREQUENCY,
437 .name = "Power Line Frequency",
438 .entity = UVC_GUID_UVC_PROCESSING,
439 .selector = UVC_PU_POWER_LINE_FREQUENCY_CONTROL,
442 .v4l2_type = V4L2_CTRL_TYPE_MENU,
443 .data_type = UVC_CTRL_DATA_TYPE_ENUM,
444 .menu_info = power_line_frequency_controls,
445 .menu_count = ARRAY_SIZE(power_line_frequency_controls),
448 .id = V4L2_CID_HUE_AUTO,
450 .entity = UVC_GUID_UVC_PROCESSING,
451 .selector = UVC_PU_HUE_AUTO_CONTROL,
454 .v4l2_type = V4L2_CTRL_TYPE_BOOLEAN,
455 .data_type = UVC_CTRL_DATA_TYPE_BOOLEAN,
458 .id = V4L2_CID_EXPOSURE_AUTO,
459 .name = "Exposure, Auto",
460 .entity = UVC_GUID_UVC_CAMERA,
461 .selector = UVC_CT_AE_MODE_CONTROL,
464 .v4l2_type = V4L2_CTRL_TYPE_MENU,
465 .data_type = UVC_CTRL_DATA_TYPE_BITMASK,
466 .menu_info = exposure_auto_controls,
467 .menu_count = ARRAY_SIZE(exposure_auto_controls),
470 .id = V4L2_CID_EXPOSURE_AUTO_PRIORITY,
471 .name = "Exposure, Auto Priority",
472 .entity = UVC_GUID_UVC_CAMERA,
473 .selector = UVC_CT_AE_PRIORITY_CONTROL,
476 .v4l2_type = V4L2_CTRL_TYPE_BOOLEAN,
477 .data_type = UVC_CTRL_DATA_TYPE_BOOLEAN,
480 .id = V4L2_CID_EXPOSURE_ABSOLUTE,
481 .name = "Exposure (Absolute)",
482 .entity = UVC_GUID_UVC_CAMERA,
483 .selector = UVC_CT_EXPOSURE_TIME_ABSOLUTE_CONTROL,
486 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
487 .data_type = UVC_CTRL_DATA_TYPE_UNSIGNED,
490 .id = V4L2_CID_AUTO_WHITE_BALANCE,
491 .name = "White Balance Temperature, Auto",
492 .entity = UVC_GUID_UVC_PROCESSING,
493 .selector = UVC_PU_WHITE_BALANCE_TEMPERATURE_AUTO_CONTROL,
496 .v4l2_type = V4L2_CTRL_TYPE_BOOLEAN,
497 .data_type = UVC_CTRL_DATA_TYPE_BOOLEAN,
500 .id = V4L2_CID_WHITE_BALANCE_TEMPERATURE,
501 .name = "White Balance Temperature",
502 .entity = UVC_GUID_UVC_PROCESSING,
503 .selector = UVC_PU_WHITE_BALANCE_TEMPERATURE_CONTROL,
506 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
507 .data_type = UVC_CTRL_DATA_TYPE_UNSIGNED,
510 .id = V4L2_CID_AUTO_WHITE_BALANCE,
511 .name = "White Balance Component, Auto",
512 .entity = UVC_GUID_UVC_PROCESSING,
513 .selector = UVC_PU_WHITE_BALANCE_COMPONENT_AUTO_CONTROL,
516 .v4l2_type = V4L2_CTRL_TYPE_BOOLEAN,
517 .data_type = UVC_CTRL_DATA_TYPE_BOOLEAN,
520 .id = V4L2_CID_BLUE_BALANCE,
521 .name = "White Balance Blue Component",
522 .entity = UVC_GUID_UVC_PROCESSING,
523 .selector = UVC_PU_WHITE_BALANCE_COMPONENT_CONTROL,
526 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
527 .data_type = UVC_CTRL_DATA_TYPE_SIGNED,
530 .id = V4L2_CID_RED_BALANCE,
531 .name = "White Balance Red Component",
532 .entity = UVC_GUID_UVC_PROCESSING,
533 .selector = UVC_PU_WHITE_BALANCE_COMPONENT_CONTROL,
536 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
537 .data_type = UVC_CTRL_DATA_TYPE_SIGNED,
540 .id = V4L2_CID_FOCUS_ABSOLUTE,
541 .name = "Focus (absolute)",
542 .entity = UVC_GUID_UVC_CAMERA,
543 .selector = UVC_CT_FOCUS_ABSOLUTE_CONTROL,
546 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
547 .data_type = UVC_CTRL_DATA_TYPE_UNSIGNED,
550 .id = V4L2_CID_FOCUS_AUTO,
551 .name = "Focus, Auto",
552 .entity = UVC_GUID_UVC_CAMERA,
553 .selector = UVC_CT_FOCUS_AUTO_CONTROL,
556 .v4l2_type = V4L2_CTRL_TYPE_BOOLEAN,
557 .data_type = UVC_CTRL_DATA_TYPE_BOOLEAN,
560 .id = V4L2_CID_ZOOM_ABSOLUTE,
561 .name = "Zoom, Absolute",
562 .entity = UVC_GUID_UVC_CAMERA,
563 .selector = UVC_CT_ZOOM_ABSOLUTE_CONTROL,
566 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
567 .data_type = UVC_CTRL_DATA_TYPE_UNSIGNED,
570 .id = V4L2_CID_ZOOM_CONTINUOUS,
571 .name = "Zoom, Continuous",
572 .entity = UVC_GUID_UVC_CAMERA,
573 .selector = UVC_CT_ZOOM_RELATIVE_CONTROL,
576 .v4l2_type = V4L2_CTRL_TYPE_INTEGER,
577 .data_type = UVC_CTRL_DATA_TYPE_SIGNED,
578 .get = uvc_ctrl_get_zoom,
579 .set = uvc_ctrl_set_zoom,
582 .id = V4L2_CID_PRIVACY,
584 .entity = UVC_GUID_UVC_CAMERA,
585 .selector = UVC_CT_PRIVACY_CONTROL,
588 .v4l2_type = V4L2_CTRL_TYPE_BOOLEAN,
589 .data_type = UVC_CTRL_DATA_TYPE_BOOLEAN,
593 /* ------------------------------------------------------------------------
597 static inline __u8 *uvc_ctrl_data(struct uvc_control *ctrl, int id)
599 return ctrl->data + id * ctrl->info->size;
602 static inline int uvc_test_bit(const __u8 *data, int bit)
604 return (data[bit >> 3] >> (bit & 7)) & 1;
607 static inline void uvc_clear_bit(__u8 *data, int bit)
609 data[bit >> 3] &= ~(1 << (bit & 7));
612 /* Extract the bit string specified by mapping->offset and mapping->size
613 * from the little-endian data stored at 'data' and return the result as
614 * a signed 32bit integer. Sign extension will be performed if the mapping
615 * references a signed data type.
617 static __s32 uvc_get_le_value(struct uvc_control_mapping *mapping,
618 __u8 query, const __u8 *data)
620 int bits = mapping->size;
621 int offset = mapping->offset;
627 mask = ((1LL << bits) - 1) << offset;
629 for (; bits > 0; data++) {
630 __u8 byte = *data & mask;
631 value |= offset > 0 ? (byte >> offset) : (byte << (-offset));
632 bits -= 8 - (offset > 0 ? offset : 0);
634 mask = (1 << bits) - 1;
637 /* Sign-extend the value if needed. */
638 if (mapping->data_type == UVC_CTRL_DATA_TYPE_SIGNED)
639 value |= -(value & (1 << (mapping->size - 1)));
644 /* Set the bit string specified by mapping->offset and mapping->size
645 * in the little-endian data stored at 'data' to the value 'value'.
647 static void uvc_set_le_value(struct uvc_control_mapping *mapping,
648 __s32 value, __u8 *data)
650 int bits = mapping->size;
651 int offset = mapping->offset;
657 for (; bits > 0; data++) {
658 mask = ((1LL << bits) - 1) << offset;
659 *data = (*data & ~mask) | ((value << offset) & mask);
660 value >>= offset ? offset : 8;
666 /* ------------------------------------------------------------------------
667 * Terminal and unit management
670 static const __u8 uvc_processing_guid[16] = UVC_GUID_UVC_PROCESSING;
671 static const __u8 uvc_camera_guid[16] = UVC_GUID_UVC_CAMERA;
672 static const __u8 uvc_media_transport_input_guid[16] =
673 UVC_GUID_UVC_MEDIA_TRANSPORT_INPUT;
675 static int uvc_entity_match_guid(struct uvc_entity *entity, __u8 guid[16])
677 switch (UVC_ENTITY_TYPE(entity)) {
679 return memcmp(uvc_camera_guid, guid, 16) == 0;
681 case UVC_ITT_MEDIA_TRANSPORT_INPUT:
682 return memcmp(uvc_media_transport_input_guid, guid, 16) == 0;
684 case UVC_VC_PROCESSING_UNIT:
685 return memcmp(uvc_processing_guid, guid, 16) == 0;
687 case UVC_VC_EXTENSION_UNIT:
688 return memcmp(entity->extension.guidExtensionCode,
696 /* ------------------------------------------------------------------------
700 static void __uvc_find_control(struct uvc_entity *entity, __u32 v4l2_id,
701 struct uvc_control_mapping **mapping, struct uvc_control **control,
704 struct uvc_control *ctrl;
705 struct uvc_control_mapping *map;
711 for (i = 0; i < entity->ncontrols; ++i) {
712 ctrl = &entity->controls[i];
713 if (ctrl->info == NULL)
716 list_for_each_entry(map, &ctrl->info->mappings, list) {
717 if ((map->id == v4l2_id) && !next) {
723 if ((*mapping == NULL || (*mapping)->id > map->id) &&
724 (map->id > v4l2_id) && next) {
732 struct uvc_control *uvc_find_control(struct uvc_video_chain *chain,
733 __u32 v4l2_id, struct uvc_control_mapping **mapping)
735 struct uvc_control *ctrl = NULL;
736 struct uvc_entity *entity;
737 int next = v4l2_id & V4L2_CTRL_FLAG_NEXT_CTRL;
741 /* Mask the query flags. */
742 v4l2_id &= V4L2_CTRL_ID_MASK;
744 /* Find the control. */
745 __uvc_find_control(chain->processing, v4l2_id, mapping, &ctrl, next);
749 list_for_each_entry(entity, &chain->iterms, chain) {
750 __uvc_find_control(entity, v4l2_id, mapping, &ctrl, next);
755 list_for_each_entry(entity, &chain->extensions, chain) {
756 __uvc_find_control(entity, v4l2_id, mapping, &ctrl, next);
761 if (ctrl == NULL && !next)
762 uvc_trace(UVC_TRACE_CONTROL, "Control 0x%08x not found.\n",
768 int uvc_query_v4l2_ctrl(struct uvc_video_chain *chain,
769 struct v4l2_queryctrl *v4l2_ctrl)
771 struct uvc_control *ctrl;
772 struct uvc_control_mapping *mapping;
773 struct uvc_menu_info *menu;
778 ctrl = uvc_find_control(chain, v4l2_ctrl->id, &mapping);
782 data = kmalloc(ctrl->info->size, GFP_KERNEL);
786 memset(v4l2_ctrl, 0, sizeof *v4l2_ctrl);
787 v4l2_ctrl->id = mapping->id;
788 v4l2_ctrl->type = mapping->v4l2_type;
789 strlcpy(v4l2_ctrl->name, mapping->name, sizeof v4l2_ctrl->name);
790 v4l2_ctrl->flags = 0;
792 if (!(ctrl->info->flags & UVC_CONTROL_SET_CUR))
793 v4l2_ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
795 if (ctrl->info->flags & UVC_CONTROL_GET_DEF) {
796 ret = uvc_query_ctrl(chain->dev, UVC_GET_DEF, ctrl->entity->id,
797 chain->dev->intfnum, ctrl->info->selector,
798 data, ctrl->info->size);
801 v4l2_ctrl->default_value =
802 mapping->get(mapping, UVC_GET_DEF, data);
805 switch (mapping->v4l2_type) {
806 case V4L2_CTRL_TYPE_MENU:
807 v4l2_ctrl->minimum = 0;
808 v4l2_ctrl->maximum = mapping->menu_count - 1;
811 menu = mapping->menu_info;
812 for (i = 0; i < mapping->menu_count; ++i, ++menu) {
813 if (menu->value == v4l2_ctrl->default_value) {
814 v4l2_ctrl->default_value = i;
822 case V4L2_CTRL_TYPE_BOOLEAN:
823 v4l2_ctrl->minimum = 0;
824 v4l2_ctrl->maximum = 1;
833 if (ctrl->info->flags & UVC_CONTROL_GET_MIN) {
834 ret = uvc_query_ctrl(chain->dev, UVC_GET_MIN, ctrl->entity->id,
835 chain->dev->intfnum, ctrl->info->selector,
836 data, ctrl->info->size);
839 v4l2_ctrl->minimum = mapping->get(mapping, UVC_GET_MIN, data);
841 if (ctrl->info->flags & UVC_CONTROL_GET_MAX) {
842 ret = uvc_query_ctrl(chain->dev, UVC_GET_MAX, ctrl->entity->id,
843 chain->dev->intfnum, ctrl->info->selector,
844 data, ctrl->info->size);
847 v4l2_ctrl->maximum = mapping->get(mapping, UVC_GET_MAX, data);
849 if (ctrl->info->flags & UVC_CONTROL_GET_RES) {
850 ret = uvc_query_ctrl(chain->dev, UVC_GET_RES, ctrl->entity->id,
851 chain->dev->intfnum, ctrl->info->selector,
852 data, ctrl->info->size);
855 v4l2_ctrl->step = mapping->get(mapping, UVC_GET_RES, data);
865 /* --------------------------------------------------------------------------
866 * Control transactions
868 * To make extended set operations as atomic as the hardware allows, controls
869 * are handled using begin/commit/rollback operations.
871 * At the beginning of a set request, uvc_ctrl_begin should be called to
872 * initialize the request. This function acquires the control lock.
874 * When setting a control, the new value is stored in the control data field
875 * at position UVC_CTRL_DATA_CURRENT. The control is then marked as dirty for
876 * later processing. If the UVC and V4L2 control sizes differ, the current
877 * value is loaded from the hardware before storing the new value in the data
880 * After processing all controls in the transaction, uvc_ctrl_commit or
881 * uvc_ctrl_rollback must be called to apply the pending changes to the
882 * hardware or revert them. When applying changes, all controls marked as
883 * dirty will be modified in the UVC device, and the dirty flag will be
884 * cleared. When reverting controls, the control data field
885 * UVC_CTRL_DATA_CURRENT is reverted to its previous value
886 * (UVC_CTRL_DATA_BACKUP) for all dirty controls. Both functions release the
889 int uvc_ctrl_begin(struct uvc_video_chain *chain)
891 return mutex_lock_interruptible(&chain->ctrl_mutex) ? -ERESTARTSYS : 0;
894 static int uvc_ctrl_commit_entity(struct uvc_device *dev,
895 struct uvc_entity *entity, int rollback)
897 struct uvc_control *ctrl;
904 for (i = 0; i < entity->ncontrols; ++i) {
905 ctrl = &entity->controls[i];
906 if (ctrl->info == NULL)
909 /* Reset the loaded flag for auto-update controls that were
910 * marked as loaded in uvc_ctrl_get/uvc_ctrl_set to prevent
911 * uvc_ctrl_get from using the cached value.
913 if (ctrl->info->flags & UVC_CONTROL_AUTO_UPDATE)
920 ret = uvc_query_ctrl(dev, UVC_SET_CUR, ctrl->entity->id,
921 dev->intfnum, ctrl->info->selector,
922 uvc_ctrl_data(ctrl, UVC_CTRL_DATA_CURRENT),
927 if (rollback || ret < 0)
928 memcpy(uvc_ctrl_data(ctrl, UVC_CTRL_DATA_CURRENT),
929 uvc_ctrl_data(ctrl, UVC_CTRL_DATA_BACKUP),
941 int __uvc_ctrl_commit(struct uvc_video_chain *chain, int rollback)
943 struct uvc_entity *entity;
946 /* Find the control. */
947 ret = uvc_ctrl_commit_entity(chain->dev, chain->processing, rollback);
951 list_for_each_entry(entity, &chain->iterms, chain) {
952 ret = uvc_ctrl_commit_entity(chain->dev, entity, rollback);
957 list_for_each_entry(entity, &chain->extensions, chain) {
958 ret = uvc_ctrl_commit_entity(chain->dev, entity, rollback);
964 mutex_unlock(&chain->ctrl_mutex);
968 int uvc_ctrl_get(struct uvc_video_chain *chain,
969 struct v4l2_ext_control *xctrl)
971 struct uvc_control *ctrl;
972 struct uvc_control_mapping *mapping;
973 struct uvc_menu_info *menu;
977 ctrl = uvc_find_control(chain, xctrl->id, &mapping);
978 if (ctrl == NULL || (ctrl->info->flags & UVC_CONTROL_GET_CUR) == 0)
982 ret = uvc_query_ctrl(chain->dev, UVC_GET_CUR, ctrl->entity->id,
983 chain->dev->intfnum, ctrl->info->selector,
984 uvc_ctrl_data(ctrl, UVC_CTRL_DATA_CURRENT),
992 xctrl->value = mapping->get(mapping, UVC_GET_CUR,
993 uvc_ctrl_data(ctrl, UVC_CTRL_DATA_CURRENT));
995 if (mapping->v4l2_type == V4L2_CTRL_TYPE_MENU) {
996 menu = mapping->menu_info;
997 for (i = 0; i < mapping->menu_count; ++i, ++menu) {
998 if (menu->value == xctrl->value) {
1008 int uvc_ctrl_set(struct uvc_video_chain *chain,
1009 struct v4l2_ext_control *xctrl)
1011 struct uvc_control *ctrl;
1012 struct uvc_control_mapping *mapping;
1013 s32 value = xctrl->value;
1016 ctrl = uvc_find_control(chain, xctrl->id, &mapping);
1017 if (ctrl == NULL || (ctrl->info->flags & UVC_CONTROL_SET_CUR) == 0)
1020 if (mapping->v4l2_type == V4L2_CTRL_TYPE_MENU) {
1021 if (value < 0 || value >= mapping->menu_count)
1023 value = mapping->menu_info[value].value;
1026 if (!ctrl->loaded && (ctrl->info->size * 8) != mapping->size) {
1027 if ((ctrl->info->flags & UVC_CONTROL_GET_CUR) == 0) {
1028 memset(uvc_ctrl_data(ctrl, UVC_CTRL_DATA_CURRENT),
1029 0, ctrl->info->size);
1031 ret = uvc_query_ctrl(chain->dev, UVC_GET_CUR,
1032 ctrl->entity->id, chain->dev->intfnum,
1033 ctrl->info->selector,
1034 uvc_ctrl_data(ctrl, UVC_CTRL_DATA_CURRENT),
1044 memcpy(uvc_ctrl_data(ctrl, UVC_CTRL_DATA_BACKUP),
1045 uvc_ctrl_data(ctrl, UVC_CTRL_DATA_CURRENT),
1049 mapping->set(mapping, value,
1050 uvc_ctrl_data(ctrl, UVC_CTRL_DATA_CURRENT));
1057 /* --------------------------------------------------------------------------
1061 int uvc_xu_ctrl_query(struct uvc_video_chain *chain,
1062 struct uvc_xu_control *xctrl, int set)
1064 struct uvc_entity *entity;
1065 struct uvc_control *ctrl = NULL;
1066 unsigned int i, found = 0;
1070 /* Find the extension unit. */
1071 list_for_each_entry(entity, &chain->extensions, chain) {
1072 if (entity->id == xctrl->unit)
1076 if (entity->id != xctrl->unit) {
1077 uvc_trace(UVC_TRACE_CONTROL, "Extension unit %u not found.\n",
1082 /* Find the control. */
1083 for (i = 0; i < entity->ncontrols; ++i) {
1084 ctrl = &entity->controls[i];
1085 if (ctrl->info == NULL)
1088 if (ctrl->info->selector == xctrl->selector) {
1095 uvc_trace(UVC_TRACE_CONTROL,
1096 "Control " UVC_GUID_FORMAT "/%u not found.\n",
1097 UVC_GUID_ARGS(entity->extension.guidExtensionCode),
1102 /* Validate control data size. */
1103 if (ctrl->info->size != xctrl->size)
1106 if ((set && !(ctrl->info->flags & UVC_CONTROL_SET_CUR)) ||
1107 (!set && !(ctrl->info->flags & UVC_CONTROL_GET_CUR)))
1110 if (mutex_lock_interruptible(&chain->ctrl_mutex))
1111 return -ERESTARTSYS;
1113 memcpy(uvc_ctrl_data(ctrl, UVC_CTRL_DATA_BACKUP),
1114 uvc_ctrl_data(ctrl, UVC_CTRL_DATA_CURRENT),
1116 data = uvc_ctrl_data(ctrl, UVC_CTRL_DATA_CURRENT);
1118 if (set && copy_from_user(data, xctrl->data, xctrl->size)) {
1123 ret = uvc_query_ctrl(chain->dev, set ? UVC_SET_CUR : UVC_GET_CUR,
1124 xctrl->unit, chain->dev->intfnum, xctrl->selector,
1129 if (!set && copy_to_user(xctrl->data, data, xctrl->size)) {
1136 memcpy(uvc_ctrl_data(ctrl, UVC_CTRL_DATA_CURRENT),
1137 uvc_ctrl_data(ctrl, UVC_CTRL_DATA_BACKUP),
1140 mutex_unlock(&chain->ctrl_mutex);
1144 /* --------------------------------------------------------------------------
1149 * Restore control values after resume, skipping controls that haven't been
1153 * - Don't restore modified controls that are back to their default value.
1154 * - Handle restore order (Auto-Exposure Mode should be restored before
1157 int uvc_ctrl_resume_device(struct uvc_device *dev)
1159 struct uvc_control *ctrl;
1160 struct uvc_entity *entity;
1164 /* Walk the entities list and restore controls when possible. */
1165 list_for_each_entry(entity, &dev->entities, list) {
1167 for (i = 0; i < entity->ncontrols; ++i) {
1168 ctrl = &entity->controls[i];
1170 if (ctrl->info == NULL || !ctrl->modified ||
1171 (ctrl->info->flags & UVC_CONTROL_RESTORE) == 0)
1174 printk(KERN_INFO "restoring control " UVC_GUID_FORMAT
1175 "/%u/%u\n", UVC_GUID_ARGS(ctrl->info->entity),
1176 ctrl->info->index, ctrl->info->selector);
1180 ret = uvc_ctrl_commit_entity(dev, entity, 0);
1188 /* --------------------------------------------------------------------------
1189 * Control and mapping handling
1192 static void uvc_ctrl_add_ctrl(struct uvc_device *dev,
1193 struct uvc_control_info *info)
1195 struct uvc_entity *entity;
1196 struct uvc_control *ctrl = NULL;
1200 list_for_each_entry(entity, &dev->entities, list) {
1201 if (!uvc_entity_match_guid(entity, info->entity))
1204 for (i = 0; i < entity->ncontrols; ++i) {
1205 ctrl = &entity->controls[i];
1206 if (ctrl->index == info->index) {
1219 if (UVC_ENTITY_TYPE(entity) == UVC_VC_EXTENSION_UNIT) {
1220 /* Check if the device control information and length match
1221 * the user supplied information.
1227 ret = uvc_query_ctrl(dev, UVC_GET_LEN, ctrl->entity->id,
1228 dev->intfnum, info->selector, (__u8 *)&size, 2);
1230 uvc_trace(UVC_TRACE_CONTROL, "GET_LEN failed on "
1231 "control " UVC_GUID_FORMAT "/%u (%d).\n",
1232 UVC_GUID_ARGS(info->entity), info->selector,
1237 if (info->size != le16_to_cpu(size)) {
1238 uvc_trace(UVC_TRACE_CONTROL, "Control " UVC_GUID_FORMAT
1239 "/%u size doesn't match user supplied "
1240 "value.\n", UVC_GUID_ARGS(info->entity),
1245 ret = uvc_query_ctrl(dev, UVC_GET_INFO, ctrl->entity->id,
1246 dev->intfnum, info->selector, &inf, 1);
1248 uvc_trace(UVC_TRACE_CONTROL, "GET_INFO failed on "
1249 "control " UVC_GUID_FORMAT "/%u (%d).\n",
1250 UVC_GUID_ARGS(info->entity), info->selector,
1255 flags = info->flags;
1256 if (((flags & UVC_CONTROL_GET_CUR) && !(inf & (1 << 0))) ||
1257 ((flags & UVC_CONTROL_SET_CUR) && !(inf & (1 << 1)))) {
1258 uvc_trace(UVC_TRACE_CONTROL, "Control "
1259 UVC_GUID_FORMAT "/%u flags don't match "
1260 "supported operations.\n",
1261 UVC_GUID_ARGS(info->entity), info->selector);
1267 ctrl->data = kmalloc(ctrl->info->size * UVC_CTRL_NDATA, GFP_KERNEL);
1268 uvc_trace(UVC_TRACE_CONTROL, "Added control " UVC_GUID_FORMAT "/%u "
1269 "to device %s entity %u\n", UVC_GUID_ARGS(ctrl->info->entity),
1270 ctrl->info->selector, dev->udev->devpath, entity->id);
1274 * Add an item to the UVC control information list, and instantiate a control
1275 * structure for each device that supports the control.
1277 int uvc_ctrl_add_info(struct uvc_control_info *info)
1279 struct uvc_control_info *ctrl;
1280 struct uvc_device *dev;
1283 /* Find matching controls by walking the devices, entities and
1286 mutex_lock(&uvc_driver.ctrl_mutex);
1288 /* First check if the list contains a control matching the new one.
1289 * Bail out if it does.
1291 list_for_each_entry(ctrl, &uvc_driver.controls, list) {
1292 if (memcmp(ctrl->entity, info->entity, 16))
1295 if (ctrl->selector == info->selector) {
1296 uvc_trace(UVC_TRACE_CONTROL, "Control "
1297 UVC_GUID_FORMAT "/%u is already defined.\n",
1298 UVC_GUID_ARGS(info->entity), info->selector);
1302 if (ctrl->index == info->index) {
1303 uvc_trace(UVC_TRACE_CONTROL, "Control "
1304 UVC_GUID_FORMAT "/%u would overwrite index "
1305 "%d.\n", UVC_GUID_ARGS(info->entity),
1306 info->selector, info->index);
1312 list_for_each_entry(dev, &uvc_driver.devices, list)
1313 uvc_ctrl_add_ctrl(dev, info);
1315 INIT_LIST_HEAD(&info->mappings);
1316 list_add_tail(&info->list, &uvc_driver.controls);
1318 mutex_unlock(&uvc_driver.ctrl_mutex);
1322 int uvc_ctrl_add_mapping(struct uvc_control_mapping *mapping)
1324 struct uvc_control_info *info;
1325 struct uvc_control_mapping *map;
1328 if (mapping->get == NULL)
1329 mapping->get = uvc_get_le_value;
1330 if (mapping->set == NULL)
1331 mapping->set = uvc_set_le_value;
1333 if (mapping->id & ~V4L2_CTRL_ID_MASK) {
1334 uvc_trace(UVC_TRACE_CONTROL, "Can't add mapping '%s' with "
1335 "invalid control id 0x%08x\n", mapping->name,
1340 mutex_lock(&uvc_driver.ctrl_mutex);
1341 list_for_each_entry(info, &uvc_driver.controls, list) {
1342 if (memcmp(info->entity, mapping->entity, 16) ||
1343 info->selector != mapping->selector)
1346 if (info->size * 8 < mapping->size + mapping->offset) {
1347 uvc_trace(UVC_TRACE_CONTROL, "Mapping '%s' would "
1348 "overflow control " UVC_GUID_FORMAT "/%u\n",
1349 mapping->name, UVC_GUID_ARGS(info->entity),
1355 /* Check if the list contains a mapping matching the new one.
1356 * Bail out if it does.
1358 list_for_each_entry(map, &info->mappings, list) {
1359 if (map->id == mapping->id) {
1360 uvc_trace(UVC_TRACE_CONTROL, "Mapping '%s' is "
1361 "already defined.\n", mapping->name);
1367 mapping->ctrl = info;
1368 list_add_tail(&mapping->list, &info->mappings);
1369 uvc_trace(UVC_TRACE_CONTROL, "Adding mapping %s to control "
1370 UVC_GUID_FORMAT "/%u.\n", mapping->name,
1371 UVC_GUID_ARGS(info->entity), info->selector);
1377 mutex_unlock(&uvc_driver.ctrl_mutex);
1382 * Prune an entity of its bogus controls using a blacklist. Bogus controls
1383 * are currently the ones that crash the camera or unconditionally return an
1384 * error when queried.
1387 uvc_ctrl_prune_entity(struct uvc_device *dev, struct uvc_entity *entity)
1389 static const struct {
1390 struct usb_device_id id;
1393 { { USB_DEVICE(0x1c4f, 0x3000) }, 6 }, /* WB Temperature */
1394 { { USB_DEVICE(0x5986, 0x0241) }, 2 }, /* Hue */
1401 if (UVC_ENTITY_TYPE(entity) != UVC_VC_PROCESSING_UNIT)
1404 controls = entity->processing.bmControls;
1405 size = entity->processing.bControlSize;
1407 for (i = 0; i < ARRAY_SIZE(blacklist); ++i) {
1408 if (!usb_match_id(dev->intf, &blacklist[i].id))
1411 if (blacklist[i].index >= 8 * size ||
1412 !uvc_test_bit(controls, blacklist[i].index))
1415 uvc_trace(UVC_TRACE_CONTROL, "%u/%u control is black listed, "
1416 "removing it.\n", entity->id, blacklist[i].index);
1418 uvc_clear_bit(controls, blacklist[i].index);
1423 * Initialize device controls.
1425 int uvc_ctrl_init_device(struct uvc_device *dev)
1427 struct uvc_control_info *info;
1428 struct uvc_control *ctrl;
1429 struct uvc_entity *entity;
1432 /* Walk the entities list and instantiate controls */
1433 list_for_each_entry(entity, &dev->entities, list) {
1434 unsigned int bControlSize = 0, ncontrols = 0;
1435 __u8 *bmControls = NULL;
1437 if (UVC_ENTITY_TYPE(entity) == UVC_VC_EXTENSION_UNIT) {
1438 bmControls = entity->extension.bmControls;
1439 bControlSize = entity->extension.bControlSize;
1440 } else if (UVC_ENTITY_TYPE(entity) == UVC_VC_PROCESSING_UNIT) {
1441 bmControls = entity->processing.bmControls;
1442 bControlSize = entity->processing.bControlSize;
1443 } else if (UVC_ENTITY_TYPE(entity) == UVC_ITT_CAMERA) {
1444 bmControls = entity->camera.bmControls;
1445 bControlSize = entity->camera.bControlSize;
1448 uvc_ctrl_prune_entity(dev, entity);
1450 for (i = 0; i < bControlSize; ++i)
1451 ncontrols += hweight8(bmControls[i]);
1456 entity->controls = kzalloc(ncontrols*sizeof *ctrl, GFP_KERNEL);
1457 if (entity->controls == NULL)
1460 entity->ncontrols = ncontrols;
1462 ctrl = entity->controls;
1463 for (i = 0; i < bControlSize * 8; ++i) {
1464 if (uvc_test_bit(bmControls, i) == 0)
1467 ctrl->entity = entity;
1473 /* Walk the controls info list and associate them with the device
1474 * controls, then add the device to the global device list. This has
1475 * to be done while holding the controls lock, to make sure
1476 * uvc_ctrl_add_info() will not get called in-between.
1478 mutex_lock(&uvc_driver.ctrl_mutex);
1479 list_for_each_entry(info, &uvc_driver.controls, list)
1480 uvc_ctrl_add_ctrl(dev, info);
1482 list_add_tail(&dev->list, &uvc_driver.devices);
1483 mutex_unlock(&uvc_driver.ctrl_mutex);
1489 * Cleanup device controls.
1491 void uvc_ctrl_cleanup_device(struct uvc_device *dev)
1493 struct uvc_entity *entity;
1496 /* Remove the device from the global devices list */
1497 mutex_lock(&uvc_driver.ctrl_mutex);
1498 if (dev->list.next != NULL)
1499 list_del(&dev->list);
1500 mutex_unlock(&uvc_driver.ctrl_mutex);
1502 list_for_each_entry(entity, &dev->entities, list) {
1503 for (i = 0; i < entity->ncontrols; ++i)
1504 kfree(entity->controls[i].data);
1506 kfree(entity->controls);
1510 void uvc_ctrl_init(void)
1512 struct uvc_control_info *ctrl = uvc_ctrls;
1513 struct uvc_control_info *cend = ctrl + ARRAY_SIZE(uvc_ctrls);
1514 struct uvc_control_mapping *mapping = uvc_ctrl_mappings;
1515 struct uvc_control_mapping *mend =
1516 mapping + ARRAY_SIZE(uvc_ctrl_mappings);
1518 for (; ctrl < cend; ++ctrl)
1519 uvc_ctrl_add_info(ctrl);
1521 for (; mapping < mend; ++mapping)
1522 uvc_ctrl_add_mapping(mapping);