373 static s32 uvc_ctrl_get_zoom(struct uvc_control_mapping *mapping,  in uvc_ctrl_get_zoom()  argument
391 static void uvc_ctrl_set_zoom(struct uvc_control_mapping *mapping,  in uvc_ctrl_set_zoom()  argument
398 static s32 uvc_ctrl_get_rel_speed(struct uvc_control_mapping *mapping,  in uvc_ctrl_get_rel_speed()  argument
401 	unsigned int first = mapping->offset / 8;  in uvc_ctrl_get_rel_speed()
418 static void uvc_ctrl_set_rel_speed(struct uvc_control_mapping *mapping,  in uvc_ctrl_set_rel_speed()  argument
421 	unsigned int first = mapping->offset / 8;  in uvc_ctrl_set_rel_speed()
777 /* Extract the bit string specified by mapping->offset and mapping->size
779  * a signed 32bit integer. Sign extension will be performed if the mapping
782 static s32 uvc_get_le_value(struct uvc_control_mapping *mapping,  in uvc_get_le_value()  argument
785 	int bits = mapping->size;  in uvc_get_le_value()
786 	int offset = mapping->offset;  in uvc_get_le_value()
807 	if (mapping->data_type == UVC_CTRL_DATA_TYPE_SIGNED)  in uvc_get_le_value()
808 		value |= -(value & (1 << (mapping->size - 1)));  in uvc_get_le_value()
813 /* Set the bit string specified by mapping->offset and mapping->size
816 static void uvc_set_le_value(struct uvc_control_mapping *mapping,  in uvc_set_le_value()  argument
819 	int bits = mapping->size;  in uvc_set_le_value()
820 	int offset = mapping->offset;  in uvc_set_le_value()
828 	if (mapping->v4l2_type == V4L2_CTRL_TYPE_BUTTON)  in uvc_set_le_value()
858 	struct uvc_control_mapping **mapping, struct uvc_control **control,  in __uvc_find_control()  argument
876 				*mapping = map;  in __uvc_find_control()
880 			if ((*mapping == NULL || (*mapping)->id > map->id) &&  in __uvc_find_control()
883 				*mapping = map;  in __uvc_find_control()
890 	u32 v4l2_id, struct uvc_control_mapping **mapping)  in uvc_find_control()  argument
896 	*mapping = NULL;  in uvc_find_control()
903 		__uvc_find_control(entity, v4l2_id, mapping, &ctrl, next);  in uvc_find_control()
971 static s32 __uvc_ctrl_get_value(struct uvc_control_mapping *mapping,  in __uvc_ctrl_get_value()  argument
974 	s32 value = mapping->get(mapping, UVC_GET_CUR, data);  in __uvc_ctrl_get_value()
976 	if (mapping->v4l2_type == V4L2_CTRL_TYPE_MENU) {  in __uvc_ctrl_get_value()
977 		const struct uvc_menu_info *menu = mapping->menu_info;  in __uvc_ctrl_get_value()
980 		for (i = 0; i < mapping->menu_count; ++i, ++menu) {  in __uvc_ctrl_get_value()
992 	struct uvc_control *ctrl, struct uvc_control_mapping *mapping,  in __uvc_ctrl_get()  argument
1021 	*value = __uvc_ctrl_get_value(mapping,  in __uvc_ctrl_get()
1029 	struct uvc_control_mapping *mapping,  in __uvc_query_v4l2_ctrl()  argument
1038 	v4l2_ctrl->id = mapping->id;  in __uvc_query_v4l2_ctrl()
1039 	v4l2_ctrl->type = mapping->v4l2_type;  in __uvc_query_v4l2_ctrl()
1040 	strscpy(v4l2_ctrl->name, mapping->name, sizeof(v4l2_ctrl->name));  in __uvc_query_v4l2_ctrl()
1048 	if (mapping->master_id)  in __uvc_query_v4l2_ctrl()
1049 		__uvc_find_control(ctrl->entity, mapping->master_id,  in __uvc_query_v4l2_ctrl()
1057 		if (val != mapping->master_manual)  in __uvc_query_v4l2_ctrl()
1068 		v4l2_ctrl->default_value = mapping->get(mapping, UVC_GET_DEF,  in __uvc_query_v4l2_ctrl()
1072 	switch (mapping->v4l2_type) {  in __uvc_query_v4l2_ctrl()
1075 		v4l2_ctrl->maximum = mapping->menu_count - 1;  in __uvc_query_v4l2_ctrl()
1078 		menu = mapping->menu_info;  in __uvc_query_v4l2_ctrl()
1079 		for (i = 0; i < mapping->menu_count; ++i, ++menu) {  in __uvc_query_v4l2_ctrl()
1105 		v4l2_ctrl->minimum = mapping->get(mapping, UVC_GET_MIN,  in __uvc_query_v4l2_ctrl()
1109 		v4l2_ctrl->maximum = mapping->get(mapping, UVC_GET_MAX,  in __uvc_query_v4l2_ctrl()
1113 		v4l2_ctrl->step = mapping->get(mapping, UVC_GET_RES,  in __uvc_query_v4l2_ctrl()
1123 	struct uvc_control_mapping *mapping;  in uvc_query_v4l2_ctrl()  local
1130 	ctrl = uvc_find_control(chain, v4l2_ctrl->id, &mapping);  in uvc_query_v4l2_ctrl()
1136 	ret = __uvc_query_v4l2_ctrl(chain, ctrl, mapping, v4l2_ctrl);  in uvc_query_v4l2_ctrl()
1143  * Mapping V4L2 controls to UVC controls can be straightforward if done well.
1155 	struct uvc_control_mapping *mapping;  in uvc_query_v4l2_menu()  local
1169 	ctrl = uvc_find_control(chain, query_menu->id, &mapping);  in uvc_query_v4l2_menu()
1170 	if (ctrl == NULL || mapping->v4l2_type != V4L2_CTRL_TYPE_MENU) {  in uvc_query_v4l2_menu()
1175 	if (query_menu->index >= mapping->menu_count) {  in uvc_query_v4l2_menu()
1180 	menu_info = &mapping->menu_info[query_menu->index];  in uvc_query_v4l2_menu()
1182 	if (mapping->data_type == UVC_CTRL_DATA_TYPE_BITMASK &&  in uvc_query_v4l2_menu()
1192 		bitmap = mapping->get(mapping, UVC_GET_RES,  in uvc_query_v4l2_menu()
1214 	struct uvc_control_mapping *mapping,  in uvc_ctrl_fill_event()  argument
1219 	__uvc_query_v4l2_ctrl(chain, ctrl, mapping, &v4l2_ctrl);  in uvc_ctrl_fill_event()
1243 	struct uvc_control_mapping *mapping, s32 value, u32 changes)  in uvc_ctrl_send_event()  argument
1249 	if (list_empty(&mapping->ev_subs))  in uvc_ctrl_send_event()
1252 	uvc_ctrl_fill_event(chain, &ev, ctrl, mapping, value, changes);  in uvc_ctrl_send_event()
1254 	list_for_each_entry(sev, &mapping->ev_subs, node) {  in uvc_ctrl_send_event()
1270 	struct uvc_control_mapping *mapping = NULL;  in uvc_ctrl_send_slave_event()  local
1275 	__uvc_find_control(master->entity, slave_id, &mapping, &ctrl, 0);  in uvc_ctrl_send_slave_event()
1279 	if (__uvc_ctrl_get(chain, ctrl, mapping, &val) == 0)  in uvc_ctrl_send_slave_event()
1282 	uvc_ctrl_send_event(chain, handle, ctrl, mapping, val, changes);  in uvc_ctrl_send_slave_event()
1288 	struct uvc_control_mapping *mapping;  in uvc_ctrl_status_event()  local
1297 	list_for_each_entry(mapping, &ctrl->info.mappings, list) {  in uvc_ctrl_status_event()
1298 		s32 value = __uvc_ctrl_get_value(mapping, data);  in uvc_ctrl_status_event()
1304 		for (i = 0; i < ARRAY_SIZE(mapping->slave_ids); ++i) {  in uvc_ctrl_status_event()
1305 			if (!mapping->slave_ids[i])  in uvc_ctrl_status_event()
1309 						  mapping->slave_ids[i]);  in uvc_ctrl_status_event()
1312 		uvc_ctrl_send_event(chain, handle, ctrl, mapping, value,  in uvc_ctrl_status_event()
1373 	struct uvc_control_mapping *mapping;  in uvc_ctrl_send_events()  local
1380 		ctrl = uvc_find_control(handle->chain, xctrls[i].id, &mapping);  in uvc_ctrl_send_events()
1386 		for (j = 0; j < ARRAY_SIZE(mapping->slave_ids); ++j) {  in uvc_ctrl_send_events()
1387 			u32 slave_id = mapping->slave_ids[j];  in uvc_ctrl_send_events()
1408 		if (mapping->master_id &&  in uvc_ctrl_send_events()
1410 						mapping->master_id))  in uvc_ctrl_send_events()
1413 		uvc_ctrl_send_event(handle->chain, handle, ctrl, mapping,  in uvc_ctrl_send_events()
1421 	struct uvc_control_mapping *mapping;  in uvc_ctrl_add_event()  local
1429 	ctrl = uvc_find_control(handle->chain, sev->id, &mapping);  in uvc_ctrl_add_event()
1435 	list_add_tail(&sev->node, &mapping->ev_subs);  in uvc_ctrl_add_event()
1441 		if (__uvc_ctrl_get(handle->chain, ctrl, mapping, &val) == 0)  in uvc_ctrl_add_event()
1444 		uvc_ctrl_fill_event(handle->chain, &ev, ctrl, mapping, val,  in uvc_ctrl_add_event()
1578 	struct uvc_control_mapping *mapping;  in uvc_ctrl_get()  local
1580 	ctrl = uvc_find_control(chain, xctrl->id, &mapping);  in uvc_ctrl_get()
1584 	return __uvc_ctrl_get(chain, ctrl, mapping, &xctrl->value);  in uvc_ctrl_get()
1592 	struct uvc_control_mapping *mapping;  in uvc_ctrl_set()  local
1599 	ctrl = uvc_find_control(chain, xctrl->id, &mapping);  in uvc_ctrl_set()
1606 	switch (mapping->v4l2_type) {  in uvc_ctrl_set()
1614 		min = mapping->get(mapping, UVC_GET_MIN,  in uvc_ctrl_set()
1616 		max = mapping->get(mapping, UVC_GET_MAX,  in uvc_ctrl_set()
1618 		step = mapping->get(mapping, UVC_GET_RES,  in uvc_ctrl_set()
1625 		if (mapping->data_type == UVC_CTRL_DATA_TYPE_SIGNED)  in uvc_ctrl_set()
1638 		if (xctrl->value < 0 || xctrl->value >= mapping->menu_count)  in uvc_ctrl_set()
1640 		value = mapping->menu_info[xctrl->value].value;  in uvc_ctrl_set()
1645 		if (mapping->data_type == UVC_CTRL_DATA_TYPE_BITMASK &&  in uvc_ctrl_set()
1653 			step = mapping->get(mapping, UVC_GET_RES,  in uvc_ctrl_set()
1666 	/* If the mapping doesn't span the whole UVC control, the current value  in uvc_ctrl_set()
1670 	if (!ctrl->loaded && (ctrl->info.size * 8) != mapping->size) {  in uvc_ctrl_set()
1694 	mapping->set(mapping, value,  in uvc_ctrl_set()
2030  * Control and mapping handling
2058  * Add a control mapping to a given control.
2061 	struct uvc_control *ctrl, const struct uvc_control_mapping *mapping)  in __uvc_ctrl_add_mapping()  argument
2070 	map = kmemdup(mapping, sizeof(*mapping), GFP_KERNEL);  in __uvc_ctrl_add_mapping()
2076 	size = sizeof(*mapping->menu_info) * mapping->menu_count;  in __uvc_ctrl_add_mapping()
2077 	map->menu_info = kmemdup(mapping->menu_info, size, GFP_KERNEL);  in __uvc_ctrl_add_mapping()
2089 	uvc_dbg(dev, CONTROL, "Adding mapping '%s' to control %pUl/%u\n",  in __uvc_ctrl_add_mapping()
2096 	const struct uvc_control_mapping *mapping)  in uvc_ctrl_add_mapping()  argument
2105 	if (mapping->id & ~V4L2_CTRL_ID_MASK) {  in uvc_ctrl_add_mapping()
2107 			"Can't add mapping '%s', control id 0x%08x is invalid\n",  in uvc_ctrl_add_mapping()
2108 			mapping->name, mapping->id);  in uvc_ctrl_add_mapping()
2117 		    !uvc_entity_match_guid(entity, mapping->entity))  in uvc_ctrl_add_mapping()
2122 			if (ctrl->index == mapping->selector - 1) {  in uvc_ctrl_add_mapping()
2145 	if (mapping->size > 32 ||  in uvc_ctrl_add_mapping()
2146 	    mapping->offset + mapping->size > ctrl->info.size * 8) {  in uvc_ctrl_add_mapping()
2152 		if (mapping->id == map->id) {  in uvc_ctrl_add_mapping()
2154 				"Can't add mapping '%s', control id 0x%08x already exists\n",  in uvc_ctrl_add_mapping()
2155 				mapping->name, mapping->id);  in uvc_ctrl_add_mapping()
2165 			"Can't add mapping '%s', maximum mappings count (%u) exceeded\n",  in uvc_ctrl_add_mapping()
2166 			mapping->name, UVC_MAX_CONTROL_MAPPINGS);  in uvc_ctrl_add_mapping()
2171 	ret = __uvc_ctrl_add_mapping(dev, ctrl, mapping);  in uvc_ctrl_add_mapping()
2251 	const struct uvc_control_mapping *mapping = uvc_ctrl_mappings;  in uvc_ctrl_init_ctrl()  local
2253 		mapping + ARRAY_SIZE(uvc_ctrl_mappings);  in uvc_ctrl_init_ctrl()
2281 	for (; mapping < mend; ++mapping) {  in uvc_ctrl_init_ctrl()
2282 		if (uvc_entity_match_guid(ctrl->entity, mapping->entity) &&  in uvc_ctrl_init_ctrl()
2283 		    ctrl->info.selector == mapping->selector)  in uvc_ctrl_init_ctrl()
2284 			__uvc_ctrl_add_mapping(dev, ctrl, mapping);  in uvc_ctrl_init_ctrl()
2355 	struct uvc_control_mapping *mapping, *nm;  in uvc_ctrl_cleanup_mappings()  local
2357 	list_for_each_entry_safe(mapping, nm, &ctrl->info.mappings, list) {  in uvc_ctrl_cleanup_mappings()
2358 		list_del(&mapping->list);  in uvc_ctrl_cleanup_mappings()
2359 		kfree(mapping->menu_info);  in uvc_ctrl_cleanup_mappings()
2360 		kfree(mapping);  in uvc_ctrl_cleanup_mappings()