365 static s32 uvc_ctrl_get_zoom(struct uvc_control_mapping *mapping,  in uvc_ctrl_get_zoom()  argument
383 static void uvc_ctrl_set_zoom(struct uvc_control_mapping *mapping,  in uvc_ctrl_set_zoom()  argument
390 static s32 uvc_ctrl_get_rel_speed(struct uvc_control_mapping *mapping,  in uvc_ctrl_get_rel_speed()  argument
393 	unsigned int first = mapping->offset / 8;  in uvc_ctrl_get_rel_speed()
410 static void uvc_ctrl_set_rel_speed(struct uvc_control_mapping *mapping,  in uvc_ctrl_set_rel_speed()  argument
413 	unsigned int first = mapping->offset / 8;  in uvc_ctrl_set_rel_speed()
759 /* Extract the bit string specified by mapping->offset and mapping->size
761  * a signed 32bit integer. Sign extension will be performed if the mapping
764 static s32 uvc_get_le_value(struct uvc_control_mapping *mapping,  in uvc_get_le_value()  argument
767 	int bits = mapping->size;  in uvc_get_le_value()
768 	int offset = mapping->offset;  in uvc_get_le_value()
785 	if (mapping->data_type == UVC_CTRL_DATA_TYPE_SIGNED)  in uvc_get_le_value()
786 		value |= -(value & (1 << (mapping->size - 1)));  in uvc_get_le_value()
791 /* Set the bit string specified by mapping->offset and mapping->size
794 static void uvc_set_le_value(struct uvc_control_mapping *mapping,  in uvc_set_le_value()  argument
797 	int bits = mapping->size;  in uvc_set_le_value()
798 	int offset = mapping->offset;  in uvc_set_le_value()
806 	if (mapping->v4l2_type == V4L2_CTRL_TYPE_BUTTON)  in uvc_set_le_value()
857 	struct uvc_control_mapping **mapping, struct uvc_control **control,  in __uvc_find_control()  argument
875 				*mapping = map;  in __uvc_find_control()
879 			if ((*mapping == NULL || (*mapping)->id > map->id) &&  in __uvc_find_control()
882 				*mapping = map;  in __uvc_find_control()
889 	u32 v4l2_id, struct uvc_control_mapping **mapping)  in uvc_find_control()  argument
895 	*mapping = NULL;  in uvc_find_control()
902 		__uvc_find_control(entity, v4l2_id, mapping, &ctrl, next);  in uvc_find_control()
970 static s32 __uvc_ctrl_get_value(struct uvc_control_mapping *mapping,  in __uvc_ctrl_get_value()  argument
973 	s32 value = mapping->get(mapping, UVC_GET_CUR, data);  in __uvc_ctrl_get_value()
975 	if (mapping->v4l2_type == V4L2_CTRL_TYPE_MENU) {  in __uvc_ctrl_get_value()
976 		const struct uvc_menu_info *menu = mapping->menu_info;  in __uvc_ctrl_get_value()
979 		for (i = 0; i < mapping->menu_count; ++i, ++menu) {  in __uvc_ctrl_get_value()
991 	struct uvc_control *ctrl, struct uvc_control_mapping *mapping,  in __uvc_ctrl_get()  argument
1010 	*value = __uvc_ctrl_get_value(mapping,  in __uvc_ctrl_get()
1018 	struct uvc_control_mapping *mapping,  in __uvc_query_v4l2_ctrl()  argument
1027 	v4l2_ctrl->id = mapping->id;  in __uvc_query_v4l2_ctrl()
1028 	v4l2_ctrl->type = mapping->v4l2_type;  in __uvc_query_v4l2_ctrl()
1029 	strscpy(v4l2_ctrl->name, mapping->name, sizeof(v4l2_ctrl->name));  in __uvc_query_v4l2_ctrl()
1037 	if (mapping->master_id)  in __uvc_query_v4l2_ctrl()
1038 		__uvc_find_control(ctrl->entity, mapping->master_id,  in __uvc_query_v4l2_ctrl()
1046 		if (val != mapping->master_manual)  in __uvc_query_v4l2_ctrl()
1057 		v4l2_ctrl->default_value = mapping->get(mapping, UVC_GET_DEF,  in __uvc_query_v4l2_ctrl()
1061 	switch (mapping->v4l2_type) {  in __uvc_query_v4l2_ctrl()
1064 		v4l2_ctrl->maximum = mapping->menu_count - 1;  in __uvc_query_v4l2_ctrl()
1067 		menu = mapping->menu_info;  in __uvc_query_v4l2_ctrl()
1068 		for (i = 0; i < mapping->menu_count; ++i, ++menu) {  in __uvc_query_v4l2_ctrl()
1094 		v4l2_ctrl->minimum = mapping->get(mapping, UVC_GET_MIN,  in __uvc_query_v4l2_ctrl()
1098 		v4l2_ctrl->maximum = mapping->get(mapping, UVC_GET_MAX,  in __uvc_query_v4l2_ctrl()
1102 		v4l2_ctrl->step = mapping->get(mapping, UVC_GET_RES,  in __uvc_query_v4l2_ctrl()
1112 	struct uvc_control_mapping *mapping;  in uvc_query_v4l2_ctrl()  local
1119 	ctrl = uvc_find_control(chain, v4l2_ctrl->id, &mapping);  in uvc_query_v4l2_ctrl()
1125 	ret = __uvc_query_v4l2_ctrl(chain, ctrl, mapping, v4l2_ctrl);  in uvc_query_v4l2_ctrl()
1132  * Mapping V4L2 controls to UVC controls can be straightforward if done well.
1144 	struct uvc_control_mapping *mapping;  in uvc_query_v4l2_menu()  local
1158 	ctrl = uvc_find_control(chain, query_menu->id, &mapping);  in uvc_query_v4l2_menu()
1159 	if (ctrl == NULL || mapping->v4l2_type != V4L2_CTRL_TYPE_MENU) {  in uvc_query_v4l2_menu()
1164 	if (query_menu->index >= mapping->menu_count) {  in uvc_query_v4l2_menu()
1169 	menu_info = &mapping->menu_info[query_menu->index];  in uvc_query_v4l2_menu()
1171 	if (mapping->data_type == UVC_CTRL_DATA_TYPE_BITMASK &&  in uvc_query_v4l2_menu()
1181 		bitmap = mapping->get(mapping, UVC_GET_RES,  in uvc_query_v4l2_menu()
1203 	struct uvc_control_mapping *mapping,  in uvc_ctrl_fill_event()  argument
1208 	__uvc_query_v4l2_ctrl(chain, ctrl, mapping, &v4l2_ctrl);  in uvc_ctrl_fill_event()
1232 	struct uvc_control_mapping *mapping, s32 value, u32 changes)  in uvc_ctrl_send_event()  argument
1238 	if (list_empty(&mapping->ev_subs))  in uvc_ctrl_send_event()
1241 	uvc_ctrl_fill_event(chain, &ev, ctrl, mapping, value, changes);  in uvc_ctrl_send_event()
1243 	list_for_each_entry(sev, &mapping->ev_subs, node) {  in uvc_ctrl_send_event()
1259 	struct uvc_control_mapping *mapping = NULL;  in uvc_ctrl_send_slave_event()  local
1264 	__uvc_find_control(master->entity, slave_id, &mapping, &ctrl, 0);  in uvc_ctrl_send_slave_event()
1268 	if (__uvc_ctrl_get(chain, ctrl, mapping, &val) == 0)  in uvc_ctrl_send_slave_event()
1271 	uvc_ctrl_send_event(chain, handle, ctrl, mapping, val, changes);  in uvc_ctrl_send_slave_event()
1280 	struct uvc_control_mapping *mapping;  in uvc_ctrl_status_event_work()  local
1291 	list_for_each_entry(mapping, &ctrl->info.mappings, list) {  in uvc_ctrl_status_event_work()
1292 		s32 value = __uvc_ctrl_get_value(mapping, w->data);  in uvc_ctrl_status_event_work()
1298 		for (i = 0; i < ARRAY_SIZE(mapping->slave_ids); ++i) {  in uvc_ctrl_status_event_work()
1299 			if (!mapping->slave_ids[i])  in uvc_ctrl_status_event_work()
1303 						  mapping->slave_ids[i]);  in uvc_ctrl_status_event_work()
1306 		uvc_ctrl_send_event(chain, handle, ctrl, mapping, value,  in uvc_ctrl_status_event_work()
1357 	struct uvc_control_mapping *mapping;  in uvc_ctrl_send_events()  local
1364 		ctrl = uvc_find_control(handle->chain, xctrls[i].id, &mapping);  in uvc_ctrl_send_events()
1370 		for (j = 0; j < ARRAY_SIZE(mapping->slave_ids); ++j) {  in uvc_ctrl_send_events()
1371 			u32 slave_id = mapping->slave_ids[j];  in uvc_ctrl_send_events()
1392 		if (mapping->master_id &&  in uvc_ctrl_send_events()
1394 						mapping->master_id))  in uvc_ctrl_send_events()
1397 		uvc_ctrl_send_event(handle->chain, handle, ctrl, mapping,  in uvc_ctrl_send_events()
1405 	struct uvc_control_mapping *mapping;  in uvc_ctrl_add_event()  local
1413 	ctrl = uvc_find_control(handle->chain, sev->id, &mapping);  in uvc_ctrl_add_event()
1419 	list_add_tail(&sev->node, &mapping->ev_subs);  in uvc_ctrl_add_event()
1425 		if (__uvc_ctrl_get(handle->chain, ctrl, mapping, &val) == 0)  in uvc_ctrl_add_event()
1428 		uvc_ctrl_fill_event(handle->chain, &ev, ctrl, mapping, val,  in uvc_ctrl_add_event()
1562 	struct uvc_control_mapping *mapping;  in uvc_ctrl_get()  local
1564 	ctrl = uvc_find_control(chain, xctrl->id, &mapping);  in uvc_ctrl_get()
1568 	return __uvc_ctrl_get(chain, ctrl, mapping, &xctrl->value);  in uvc_ctrl_get()
1576 	struct uvc_control_mapping *mapping;  in uvc_ctrl_set()  local
1583 	ctrl = uvc_find_control(chain, xctrl->id, &mapping);  in uvc_ctrl_set()
1590 	switch (mapping->v4l2_type) {  in uvc_ctrl_set()
1598 		min = mapping->get(mapping, UVC_GET_MIN,  in uvc_ctrl_set()
1600 		max = mapping->get(mapping, UVC_GET_MAX,  in uvc_ctrl_set()
1602 		step = mapping->get(mapping, UVC_GET_RES,  in uvc_ctrl_set()
1609 		if (mapping->data_type == UVC_CTRL_DATA_TYPE_SIGNED)  in uvc_ctrl_set()
1622 		if (xctrl->value < 0 || xctrl->value >= mapping->menu_count)  in uvc_ctrl_set()
1624 		value = mapping->menu_info[xctrl->value].value;  in uvc_ctrl_set()
1629 		if (mapping->data_type == UVC_CTRL_DATA_TYPE_BITMASK &&  in uvc_ctrl_set()
1637 			step = mapping->get(mapping, UVC_GET_RES,  in uvc_ctrl_set()
1650 	/* If the mapping doesn't span the whole UVC control, the current value  in uvc_ctrl_set()
1654 	if (!ctrl->loaded && (ctrl->info.size * 8) != mapping->size) {  in uvc_ctrl_set()
1678 	mapping->set(mapping, value,  in uvc_ctrl_set()
2005  * Control and mapping handling
2047  * Add a control mapping to a given control.
2050 	struct uvc_control *ctrl, const struct uvc_control_mapping *mapping)  in __uvc_ctrl_add_mapping()  argument
2059 	map = kmemdup(mapping, sizeof(*mapping), GFP_KERNEL);  in __uvc_ctrl_add_mapping()
2065 	size = sizeof(*mapping->menu_info) * mapping->menu_count;  in __uvc_ctrl_add_mapping()
2066 	map->menu_info = kmemdup(mapping->menu_info, size, GFP_KERNEL);  in __uvc_ctrl_add_mapping()
2079 		"Adding mapping '%s' to control %pUl/%u.\n",  in __uvc_ctrl_add_mapping()
2086 	const struct uvc_control_mapping *mapping)  in uvc_ctrl_add_mapping()  argument
2095 	if (mapping->id & ~V4L2_CTRL_ID_MASK) {  in uvc_ctrl_add_mapping()
2096 		uvc_trace(UVC_TRACE_CONTROL, "Can't add mapping '%s', control "  in uvc_ctrl_add_mapping()
2097 			"id 0x%08x is invalid.\n", mapping->name,  in uvc_ctrl_add_mapping()
2098 			mapping->id);  in uvc_ctrl_add_mapping()
2107 		    !uvc_entity_match_guid(entity, mapping->entity))  in uvc_ctrl_add_mapping()
2112 			if (ctrl->index == mapping->selector - 1) {  in uvc_ctrl_add_mapping()
2135 	if (mapping->size > 32 ||  in uvc_ctrl_add_mapping()
2136 	    mapping->offset + mapping->size > ctrl->info.size * 8) {  in uvc_ctrl_add_mapping()
2142 		if (mapping->id == map->id) {  in uvc_ctrl_add_mapping()
2143 			uvc_trace(UVC_TRACE_CONTROL, "Can't add mapping '%s', "  in uvc_ctrl_add_mapping()
2145 				mapping->name, mapping->id);  in uvc_ctrl_add_mapping()
2154 		uvc_trace(UVC_TRACE_CONTROL, "Can't add mapping '%s', maximum "  in uvc_ctrl_add_mapping()
2155 			"mappings count (%u) exceeded.\n", mapping->name,  in uvc_ctrl_add_mapping()
2161 	ret = __uvc_ctrl_add_mapping(dev, ctrl, mapping);  in uvc_ctrl_add_mapping()
2240 	const struct uvc_control_mapping *mapping = uvc_ctrl_mappings;  in uvc_ctrl_init_ctrl()  local
2242 		mapping + ARRAY_SIZE(uvc_ctrl_mappings);  in uvc_ctrl_init_ctrl()
2263 	for (; mapping < mend; ++mapping) {  in uvc_ctrl_init_ctrl()
2264 		if (uvc_entity_match_guid(ctrl->entity, mapping->entity) &&  in uvc_ctrl_init_ctrl()
2265 		    ctrl->info.selector == mapping->selector)  in uvc_ctrl_init_ctrl()
2266 			__uvc_ctrl_add_mapping(dev, ctrl, mapping);  in uvc_ctrl_init_ctrl()
2334 	struct uvc_control_mapping *mapping, *nm;  in uvc_ctrl_cleanup_mappings()  local
2336 	list_for_each_entry_safe(mapping, nm, &ctrl->info.mappings, list) {  in uvc_ctrl_cleanup_mappings()
2337 		list_del(&mapping->list);  in uvc_ctrl_cleanup_mappings()
2338 		kfree(mapping->menu_info);  in uvc_ctrl_cleanup_mappings()
2339 		kfree(mapping);  in uvc_ctrl_cleanup_mappings()