162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * uvc_v4l2.c -- USB Video Class driver - V4L2 API 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (C) 2005-2010 662306a36Sopenharmony_ci * Laurent Pinchart (laurent.pinchart@ideasonboard.com) 762306a36Sopenharmony_ci */ 862306a36Sopenharmony_ci 962306a36Sopenharmony_ci#include <linux/bits.h> 1062306a36Sopenharmony_ci#include <linux/compat.h> 1162306a36Sopenharmony_ci#include <linux/kernel.h> 1262306a36Sopenharmony_ci#include <linux/list.h> 1362306a36Sopenharmony_ci#include <linux/module.h> 1462306a36Sopenharmony_ci#include <linux/slab.h> 1562306a36Sopenharmony_ci#include <linux/usb.h> 1662306a36Sopenharmony_ci#include <linux/videodev2.h> 1762306a36Sopenharmony_ci#include <linux/vmalloc.h> 1862306a36Sopenharmony_ci#include <linux/mm.h> 1962306a36Sopenharmony_ci#include <linux/wait.h> 2062306a36Sopenharmony_ci#include <linux/atomic.h> 2162306a36Sopenharmony_ci 2262306a36Sopenharmony_ci#include <media/v4l2-common.h> 2362306a36Sopenharmony_ci#include <media/v4l2-ctrls.h> 2462306a36Sopenharmony_ci#include <media/v4l2-event.h> 2562306a36Sopenharmony_ci#include <media/v4l2-ioctl.h> 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_ci#include "uvcvideo.h" 2862306a36Sopenharmony_ci 2962306a36Sopenharmony_cistatic int uvc_control_add_xu_mapping(struct uvc_video_chain *chain, 3062306a36Sopenharmony_ci struct uvc_control_mapping *map, 3162306a36Sopenharmony_ci const struct uvc_xu_control_mapping *xmap) 3262306a36Sopenharmony_ci{ 3362306a36Sopenharmony_ci unsigned int i; 3462306a36Sopenharmony_ci size_t size; 3562306a36Sopenharmony_ci int ret; 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_ci /* 3862306a36Sopenharmony_ci * Prevent excessive memory consumption, as well as integer 3962306a36Sopenharmony_ci * overflows. 4062306a36Sopenharmony_ci */ 4162306a36Sopenharmony_ci if (xmap->menu_count == 0 || 4262306a36Sopenharmony_ci xmap->menu_count > UVC_MAX_CONTROL_MENU_ENTRIES) 4362306a36Sopenharmony_ci return -EINVAL; 4462306a36Sopenharmony_ci 4562306a36Sopenharmony_ci map->menu_names = NULL; 4662306a36Sopenharmony_ci map->menu_mapping = NULL; 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_ci map->menu_mask = GENMASK(xmap->menu_count - 1, 0); 4962306a36Sopenharmony_ci 5062306a36Sopenharmony_ci size = xmap->menu_count * sizeof(*map->menu_mapping); 5162306a36Sopenharmony_ci map->menu_mapping = kzalloc(size, GFP_KERNEL); 5262306a36Sopenharmony_ci if (!map->menu_mapping) { 5362306a36Sopenharmony_ci ret = -ENOMEM; 5462306a36Sopenharmony_ci goto done; 5562306a36Sopenharmony_ci } 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_ci for (i = 0; i < xmap->menu_count ; i++) { 5862306a36Sopenharmony_ci if (copy_from_user((u32 *)&map->menu_mapping[i], 5962306a36Sopenharmony_ci &xmap->menu_info[i].value, 6062306a36Sopenharmony_ci sizeof(map->menu_mapping[i]))) { 6162306a36Sopenharmony_ci ret = -EACCES; 6262306a36Sopenharmony_ci goto done; 6362306a36Sopenharmony_ci } 6462306a36Sopenharmony_ci } 6562306a36Sopenharmony_ci 6662306a36Sopenharmony_ci /* 6762306a36Sopenharmony_ci * Always use the standard naming if available, otherwise copy the 6862306a36Sopenharmony_ci * names supplied by userspace. 6962306a36Sopenharmony_ci */ 7062306a36Sopenharmony_ci if (!v4l2_ctrl_get_menu(map->id)) { 7162306a36Sopenharmony_ci size = xmap->menu_count * sizeof(map->menu_names[0]); 7262306a36Sopenharmony_ci map->menu_names = kzalloc(size, GFP_KERNEL); 7362306a36Sopenharmony_ci if (!map->menu_names) { 7462306a36Sopenharmony_ci ret = -ENOMEM; 7562306a36Sopenharmony_ci goto done; 7662306a36Sopenharmony_ci } 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_ci for (i = 0; i < xmap->menu_count ; i++) { 7962306a36Sopenharmony_ci /* sizeof(names[i]) - 1: to take care of \0 */ 8062306a36Sopenharmony_ci if (copy_from_user((char *)map->menu_names[i], 8162306a36Sopenharmony_ci xmap->menu_info[i].name, 8262306a36Sopenharmony_ci sizeof(map->menu_names[i]) - 1)) { 8362306a36Sopenharmony_ci ret = -EACCES; 8462306a36Sopenharmony_ci goto done; 8562306a36Sopenharmony_ci } 8662306a36Sopenharmony_ci } 8762306a36Sopenharmony_ci } 8862306a36Sopenharmony_ci 8962306a36Sopenharmony_ci ret = uvc_ctrl_add_mapping(chain, map); 9062306a36Sopenharmony_ci 9162306a36Sopenharmony_cidone: 9262306a36Sopenharmony_ci kfree(map->menu_names); 9362306a36Sopenharmony_ci map->menu_names = NULL; 9462306a36Sopenharmony_ci kfree(map->menu_mapping); 9562306a36Sopenharmony_ci map->menu_mapping = NULL; 9662306a36Sopenharmony_ci 9762306a36Sopenharmony_ci return ret; 9862306a36Sopenharmony_ci} 9962306a36Sopenharmony_ci 10062306a36Sopenharmony_ci/* ------------------------------------------------------------------------ 10162306a36Sopenharmony_ci * UVC ioctls 10262306a36Sopenharmony_ci */ 10362306a36Sopenharmony_cistatic int uvc_ioctl_xu_ctrl_map(struct uvc_video_chain *chain, 10462306a36Sopenharmony_ci struct uvc_xu_control_mapping *xmap) 10562306a36Sopenharmony_ci{ 10662306a36Sopenharmony_ci struct uvc_control_mapping *map; 10762306a36Sopenharmony_ci int ret; 10862306a36Sopenharmony_ci 10962306a36Sopenharmony_ci map = kzalloc(sizeof(*map), GFP_KERNEL); 11062306a36Sopenharmony_ci if (map == NULL) 11162306a36Sopenharmony_ci return -ENOMEM; 11262306a36Sopenharmony_ci 11362306a36Sopenharmony_ci map->id = xmap->id; 11462306a36Sopenharmony_ci /* Non standard control id. */ 11562306a36Sopenharmony_ci if (v4l2_ctrl_get_name(map->id) == NULL) { 11662306a36Sopenharmony_ci if (xmap->name[0] == '\0') { 11762306a36Sopenharmony_ci ret = -EINVAL; 11862306a36Sopenharmony_ci goto free_map; 11962306a36Sopenharmony_ci } 12062306a36Sopenharmony_ci xmap->name[sizeof(xmap->name) - 1] = '\0'; 12162306a36Sopenharmony_ci map->name = xmap->name; 12262306a36Sopenharmony_ci } 12362306a36Sopenharmony_ci memcpy(map->entity, xmap->entity, sizeof(map->entity)); 12462306a36Sopenharmony_ci map->selector = xmap->selector; 12562306a36Sopenharmony_ci map->size = xmap->size; 12662306a36Sopenharmony_ci map->offset = xmap->offset; 12762306a36Sopenharmony_ci map->v4l2_type = xmap->v4l2_type; 12862306a36Sopenharmony_ci map->data_type = xmap->data_type; 12962306a36Sopenharmony_ci 13062306a36Sopenharmony_ci switch (xmap->v4l2_type) { 13162306a36Sopenharmony_ci case V4L2_CTRL_TYPE_INTEGER: 13262306a36Sopenharmony_ci case V4L2_CTRL_TYPE_BOOLEAN: 13362306a36Sopenharmony_ci case V4L2_CTRL_TYPE_BUTTON: 13462306a36Sopenharmony_ci ret = uvc_ctrl_add_mapping(chain, map); 13562306a36Sopenharmony_ci break; 13662306a36Sopenharmony_ci 13762306a36Sopenharmony_ci case V4L2_CTRL_TYPE_MENU: 13862306a36Sopenharmony_ci ret = uvc_control_add_xu_mapping(chain, map, xmap); 13962306a36Sopenharmony_ci break; 14062306a36Sopenharmony_ci 14162306a36Sopenharmony_ci default: 14262306a36Sopenharmony_ci uvc_dbg(chain->dev, CONTROL, 14362306a36Sopenharmony_ci "Unsupported V4L2 control type %u\n", xmap->v4l2_type); 14462306a36Sopenharmony_ci ret = -ENOTTY; 14562306a36Sopenharmony_ci break; 14662306a36Sopenharmony_ci } 14762306a36Sopenharmony_ci 14862306a36Sopenharmony_cifree_map: 14962306a36Sopenharmony_ci kfree(map); 15062306a36Sopenharmony_ci 15162306a36Sopenharmony_ci return ret; 15262306a36Sopenharmony_ci} 15362306a36Sopenharmony_ci 15462306a36Sopenharmony_ci/* ------------------------------------------------------------------------ 15562306a36Sopenharmony_ci * V4L2 interface 15662306a36Sopenharmony_ci */ 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_ci/* 15962306a36Sopenharmony_ci * Find the frame interval closest to the requested frame interval for the 16062306a36Sopenharmony_ci * given frame format and size. This should be done by the device as part of 16162306a36Sopenharmony_ci * the Video Probe and Commit negotiation, but some hardware don't implement 16262306a36Sopenharmony_ci * that feature. 16362306a36Sopenharmony_ci */ 16462306a36Sopenharmony_cistatic u32 uvc_try_frame_interval(const struct uvc_frame *frame, u32 interval) 16562306a36Sopenharmony_ci{ 16662306a36Sopenharmony_ci unsigned int i; 16762306a36Sopenharmony_ci 16862306a36Sopenharmony_ci if (frame->bFrameIntervalType) { 16962306a36Sopenharmony_ci u32 best = -1, dist; 17062306a36Sopenharmony_ci 17162306a36Sopenharmony_ci for (i = 0; i < frame->bFrameIntervalType; ++i) { 17262306a36Sopenharmony_ci dist = interval > frame->dwFrameInterval[i] 17362306a36Sopenharmony_ci ? interval - frame->dwFrameInterval[i] 17462306a36Sopenharmony_ci : frame->dwFrameInterval[i] - interval; 17562306a36Sopenharmony_ci 17662306a36Sopenharmony_ci if (dist > best) 17762306a36Sopenharmony_ci break; 17862306a36Sopenharmony_ci 17962306a36Sopenharmony_ci best = dist; 18062306a36Sopenharmony_ci } 18162306a36Sopenharmony_ci 18262306a36Sopenharmony_ci interval = frame->dwFrameInterval[i-1]; 18362306a36Sopenharmony_ci } else { 18462306a36Sopenharmony_ci const u32 min = frame->dwFrameInterval[0]; 18562306a36Sopenharmony_ci const u32 max = frame->dwFrameInterval[1]; 18662306a36Sopenharmony_ci const u32 step = frame->dwFrameInterval[2]; 18762306a36Sopenharmony_ci 18862306a36Sopenharmony_ci interval = min + (interval - min + step/2) / step * step; 18962306a36Sopenharmony_ci if (interval > max) 19062306a36Sopenharmony_ci interval = max; 19162306a36Sopenharmony_ci } 19262306a36Sopenharmony_ci 19362306a36Sopenharmony_ci return interval; 19462306a36Sopenharmony_ci} 19562306a36Sopenharmony_ci 19662306a36Sopenharmony_cistatic u32 uvc_v4l2_get_bytesperline(const struct uvc_format *format, 19762306a36Sopenharmony_ci const struct uvc_frame *frame) 19862306a36Sopenharmony_ci{ 19962306a36Sopenharmony_ci switch (format->fcc) { 20062306a36Sopenharmony_ci case V4L2_PIX_FMT_NV12: 20162306a36Sopenharmony_ci case V4L2_PIX_FMT_YVU420: 20262306a36Sopenharmony_ci case V4L2_PIX_FMT_YUV420: 20362306a36Sopenharmony_ci case V4L2_PIX_FMT_M420: 20462306a36Sopenharmony_ci return frame->wWidth; 20562306a36Sopenharmony_ci 20662306a36Sopenharmony_ci default: 20762306a36Sopenharmony_ci return format->bpp * frame->wWidth / 8; 20862306a36Sopenharmony_ci } 20962306a36Sopenharmony_ci} 21062306a36Sopenharmony_ci 21162306a36Sopenharmony_cistatic int uvc_v4l2_try_format(struct uvc_streaming *stream, 21262306a36Sopenharmony_ci struct v4l2_format *fmt, struct uvc_streaming_control *probe, 21362306a36Sopenharmony_ci const struct uvc_format **uvc_format, 21462306a36Sopenharmony_ci const struct uvc_frame **uvc_frame) 21562306a36Sopenharmony_ci{ 21662306a36Sopenharmony_ci const struct uvc_format *format = NULL; 21762306a36Sopenharmony_ci const struct uvc_frame *frame = NULL; 21862306a36Sopenharmony_ci u16 rw, rh; 21962306a36Sopenharmony_ci unsigned int d, maxd; 22062306a36Sopenharmony_ci unsigned int i; 22162306a36Sopenharmony_ci u32 interval; 22262306a36Sopenharmony_ci int ret = 0; 22362306a36Sopenharmony_ci u8 *fcc; 22462306a36Sopenharmony_ci 22562306a36Sopenharmony_ci if (fmt->type != stream->type) 22662306a36Sopenharmony_ci return -EINVAL; 22762306a36Sopenharmony_ci 22862306a36Sopenharmony_ci fcc = (u8 *)&fmt->fmt.pix.pixelformat; 22962306a36Sopenharmony_ci uvc_dbg(stream->dev, FORMAT, "Trying format 0x%08x (%c%c%c%c): %ux%u\n", 23062306a36Sopenharmony_ci fmt->fmt.pix.pixelformat, 23162306a36Sopenharmony_ci fcc[0], fcc[1], fcc[2], fcc[3], 23262306a36Sopenharmony_ci fmt->fmt.pix.width, fmt->fmt.pix.height); 23362306a36Sopenharmony_ci 23462306a36Sopenharmony_ci /* 23562306a36Sopenharmony_ci * Check if the hardware supports the requested format, use the default 23662306a36Sopenharmony_ci * format otherwise. 23762306a36Sopenharmony_ci */ 23862306a36Sopenharmony_ci for (i = 0; i < stream->nformats; ++i) { 23962306a36Sopenharmony_ci format = &stream->formats[i]; 24062306a36Sopenharmony_ci if (format->fcc == fmt->fmt.pix.pixelformat) 24162306a36Sopenharmony_ci break; 24262306a36Sopenharmony_ci } 24362306a36Sopenharmony_ci 24462306a36Sopenharmony_ci if (i == stream->nformats) { 24562306a36Sopenharmony_ci format = stream->def_format; 24662306a36Sopenharmony_ci fmt->fmt.pix.pixelformat = format->fcc; 24762306a36Sopenharmony_ci } 24862306a36Sopenharmony_ci 24962306a36Sopenharmony_ci /* 25062306a36Sopenharmony_ci * Find the closest image size. The distance between image sizes is 25162306a36Sopenharmony_ci * the size in pixels of the non-overlapping regions between the 25262306a36Sopenharmony_ci * requested size and the frame-specified size. 25362306a36Sopenharmony_ci */ 25462306a36Sopenharmony_ci rw = fmt->fmt.pix.width; 25562306a36Sopenharmony_ci rh = fmt->fmt.pix.height; 25662306a36Sopenharmony_ci maxd = (unsigned int)-1; 25762306a36Sopenharmony_ci 25862306a36Sopenharmony_ci for (i = 0; i < format->nframes; ++i) { 25962306a36Sopenharmony_ci u16 w = format->frames[i].wWidth; 26062306a36Sopenharmony_ci u16 h = format->frames[i].wHeight; 26162306a36Sopenharmony_ci 26262306a36Sopenharmony_ci d = min(w, rw) * min(h, rh); 26362306a36Sopenharmony_ci d = w*h + rw*rh - 2*d; 26462306a36Sopenharmony_ci if (d < maxd) { 26562306a36Sopenharmony_ci maxd = d; 26662306a36Sopenharmony_ci frame = &format->frames[i]; 26762306a36Sopenharmony_ci } 26862306a36Sopenharmony_ci 26962306a36Sopenharmony_ci if (maxd == 0) 27062306a36Sopenharmony_ci break; 27162306a36Sopenharmony_ci } 27262306a36Sopenharmony_ci 27362306a36Sopenharmony_ci if (frame == NULL) { 27462306a36Sopenharmony_ci uvc_dbg(stream->dev, FORMAT, "Unsupported size %ux%u\n", 27562306a36Sopenharmony_ci fmt->fmt.pix.width, fmt->fmt.pix.height); 27662306a36Sopenharmony_ci return -EINVAL; 27762306a36Sopenharmony_ci } 27862306a36Sopenharmony_ci 27962306a36Sopenharmony_ci /* Use the default frame interval. */ 28062306a36Sopenharmony_ci interval = frame->dwDefaultFrameInterval; 28162306a36Sopenharmony_ci uvc_dbg(stream->dev, FORMAT, 28262306a36Sopenharmony_ci "Using default frame interval %u.%u us (%u.%u fps)\n", 28362306a36Sopenharmony_ci interval / 10, interval % 10, 10000000 / interval, 28462306a36Sopenharmony_ci (100000000 / interval) % 10); 28562306a36Sopenharmony_ci 28662306a36Sopenharmony_ci /* Set the format index, frame index and frame interval. */ 28762306a36Sopenharmony_ci memset(probe, 0, sizeof(*probe)); 28862306a36Sopenharmony_ci probe->bmHint = 1; /* dwFrameInterval */ 28962306a36Sopenharmony_ci probe->bFormatIndex = format->index; 29062306a36Sopenharmony_ci probe->bFrameIndex = frame->bFrameIndex; 29162306a36Sopenharmony_ci probe->dwFrameInterval = uvc_try_frame_interval(frame, interval); 29262306a36Sopenharmony_ci /* 29362306a36Sopenharmony_ci * Some webcams stall the probe control set request when the 29462306a36Sopenharmony_ci * dwMaxVideoFrameSize field is set to zero. The UVC specification 29562306a36Sopenharmony_ci * clearly states that the field is read-only from the host, so this 29662306a36Sopenharmony_ci * is a webcam bug. Set dwMaxVideoFrameSize to the value reported by 29762306a36Sopenharmony_ci * the webcam to work around the problem. 29862306a36Sopenharmony_ci * 29962306a36Sopenharmony_ci * The workaround could probably be enabled for all webcams, so the 30062306a36Sopenharmony_ci * quirk can be removed if needed. It's currently useful to detect 30162306a36Sopenharmony_ci * webcam bugs and fix them before they hit the market (providing 30262306a36Sopenharmony_ci * developers test their webcams with the Linux driver as well as with 30362306a36Sopenharmony_ci * the Windows driver). 30462306a36Sopenharmony_ci */ 30562306a36Sopenharmony_ci mutex_lock(&stream->mutex); 30662306a36Sopenharmony_ci if (stream->dev->quirks & UVC_QUIRK_PROBE_EXTRAFIELDS) 30762306a36Sopenharmony_ci probe->dwMaxVideoFrameSize = 30862306a36Sopenharmony_ci stream->ctrl.dwMaxVideoFrameSize; 30962306a36Sopenharmony_ci 31062306a36Sopenharmony_ci /* Probe the device. */ 31162306a36Sopenharmony_ci ret = uvc_probe_video(stream, probe); 31262306a36Sopenharmony_ci mutex_unlock(&stream->mutex); 31362306a36Sopenharmony_ci if (ret < 0) 31462306a36Sopenharmony_ci return ret; 31562306a36Sopenharmony_ci 31662306a36Sopenharmony_ci /* 31762306a36Sopenharmony_ci * After the probe, update fmt with the values returned from 31862306a36Sopenharmony_ci * negotiation with the device. Some devices return invalid bFormatIndex 31962306a36Sopenharmony_ci * and bFrameIndex values, in which case we can only assume they have 32062306a36Sopenharmony_ci * accepted the requested format as-is. 32162306a36Sopenharmony_ci */ 32262306a36Sopenharmony_ci for (i = 0; i < stream->nformats; ++i) { 32362306a36Sopenharmony_ci if (probe->bFormatIndex == stream->formats[i].index) { 32462306a36Sopenharmony_ci format = &stream->formats[i]; 32562306a36Sopenharmony_ci break; 32662306a36Sopenharmony_ci } 32762306a36Sopenharmony_ci } 32862306a36Sopenharmony_ci 32962306a36Sopenharmony_ci if (i == stream->nformats) 33062306a36Sopenharmony_ci uvc_dbg(stream->dev, FORMAT, 33162306a36Sopenharmony_ci "Unknown bFormatIndex %u, using default\n", 33262306a36Sopenharmony_ci probe->bFormatIndex); 33362306a36Sopenharmony_ci 33462306a36Sopenharmony_ci for (i = 0; i < format->nframes; ++i) { 33562306a36Sopenharmony_ci if (probe->bFrameIndex == format->frames[i].bFrameIndex) { 33662306a36Sopenharmony_ci frame = &format->frames[i]; 33762306a36Sopenharmony_ci break; 33862306a36Sopenharmony_ci } 33962306a36Sopenharmony_ci } 34062306a36Sopenharmony_ci 34162306a36Sopenharmony_ci if (i == format->nframes) 34262306a36Sopenharmony_ci uvc_dbg(stream->dev, FORMAT, 34362306a36Sopenharmony_ci "Unknown bFrameIndex %u, using default\n", 34462306a36Sopenharmony_ci probe->bFrameIndex); 34562306a36Sopenharmony_ci 34662306a36Sopenharmony_ci fmt->fmt.pix.width = frame->wWidth; 34762306a36Sopenharmony_ci fmt->fmt.pix.height = frame->wHeight; 34862306a36Sopenharmony_ci fmt->fmt.pix.field = V4L2_FIELD_NONE; 34962306a36Sopenharmony_ci fmt->fmt.pix.bytesperline = uvc_v4l2_get_bytesperline(format, frame); 35062306a36Sopenharmony_ci fmt->fmt.pix.sizeimage = probe->dwMaxVideoFrameSize; 35162306a36Sopenharmony_ci fmt->fmt.pix.pixelformat = format->fcc; 35262306a36Sopenharmony_ci fmt->fmt.pix.colorspace = format->colorspace; 35362306a36Sopenharmony_ci fmt->fmt.pix.xfer_func = format->xfer_func; 35462306a36Sopenharmony_ci fmt->fmt.pix.ycbcr_enc = format->ycbcr_enc; 35562306a36Sopenharmony_ci 35662306a36Sopenharmony_ci if (uvc_format != NULL) 35762306a36Sopenharmony_ci *uvc_format = format; 35862306a36Sopenharmony_ci if (uvc_frame != NULL) 35962306a36Sopenharmony_ci *uvc_frame = frame; 36062306a36Sopenharmony_ci 36162306a36Sopenharmony_ci return ret; 36262306a36Sopenharmony_ci} 36362306a36Sopenharmony_ci 36462306a36Sopenharmony_cistatic int uvc_v4l2_get_format(struct uvc_streaming *stream, 36562306a36Sopenharmony_ci struct v4l2_format *fmt) 36662306a36Sopenharmony_ci{ 36762306a36Sopenharmony_ci const struct uvc_format *format; 36862306a36Sopenharmony_ci const struct uvc_frame *frame; 36962306a36Sopenharmony_ci int ret = 0; 37062306a36Sopenharmony_ci 37162306a36Sopenharmony_ci if (fmt->type != stream->type) 37262306a36Sopenharmony_ci return -EINVAL; 37362306a36Sopenharmony_ci 37462306a36Sopenharmony_ci mutex_lock(&stream->mutex); 37562306a36Sopenharmony_ci format = stream->cur_format; 37662306a36Sopenharmony_ci frame = stream->cur_frame; 37762306a36Sopenharmony_ci 37862306a36Sopenharmony_ci if (format == NULL || frame == NULL) { 37962306a36Sopenharmony_ci ret = -EINVAL; 38062306a36Sopenharmony_ci goto done; 38162306a36Sopenharmony_ci } 38262306a36Sopenharmony_ci 38362306a36Sopenharmony_ci fmt->fmt.pix.pixelformat = format->fcc; 38462306a36Sopenharmony_ci fmt->fmt.pix.width = frame->wWidth; 38562306a36Sopenharmony_ci fmt->fmt.pix.height = frame->wHeight; 38662306a36Sopenharmony_ci fmt->fmt.pix.field = V4L2_FIELD_NONE; 38762306a36Sopenharmony_ci fmt->fmt.pix.bytesperline = uvc_v4l2_get_bytesperline(format, frame); 38862306a36Sopenharmony_ci fmt->fmt.pix.sizeimage = stream->ctrl.dwMaxVideoFrameSize; 38962306a36Sopenharmony_ci fmt->fmt.pix.colorspace = format->colorspace; 39062306a36Sopenharmony_ci fmt->fmt.pix.xfer_func = format->xfer_func; 39162306a36Sopenharmony_ci fmt->fmt.pix.ycbcr_enc = format->ycbcr_enc; 39262306a36Sopenharmony_ci 39362306a36Sopenharmony_cidone: 39462306a36Sopenharmony_ci mutex_unlock(&stream->mutex); 39562306a36Sopenharmony_ci return ret; 39662306a36Sopenharmony_ci} 39762306a36Sopenharmony_ci 39862306a36Sopenharmony_cistatic int uvc_v4l2_set_format(struct uvc_streaming *stream, 39962306a36Sopenharmony_ci struct v4l2_format *fmt) 40062306a36Sopenharmony_ci{ 40162306a36Sopenharmony_ci struct uvc_streaming_control probe; 40262306a36Sopenharmony_ci const struct uvc_format *format; 40362306a36Sopenharmony_ci const struct uvc_frame *frame; 40462306a36Sopenharmony_ci int ret; 40562306a36Sopenharmony_ci 40662306a36Sopenharmony_ci if (fmt->type != stream->type) 40762306a36Sopenharmony_ci return -EINVAL; 40862306a36Sopenharmony_ci 40962306a36Sopenharmony_ci ret = uvc_v4l2_try_format(stream, fmt, &probe, &format, &frame); 41062306a36Sopenharmony_ci if (ret < 0) 41162306a36Sopenharmony_ci return ret; 41262306a36Sopenharmony_ci 41362306a36Sopenharmony_ci mutex_lock(&stream->mutex); 41462306a36Sopenharmony_ci 41562306a36Sopenharmony_ci if (uvc_queue_allocated(&stream->queue)) { 41662306a36Sopenharmony_ci ret = -EBUSY; 41762306a36Sopenharmony_ci goto done; 41862306a36Sopenharmony_ci } 41962306a36Sopenharmony_ci 42062306a36Sopenharmony_ci stream->ctrl = probe; 42162306a36Sopenharmony_ci stream->cur_format = format; 42262306a36Sopenharmony_ci stream->cur_frame = frame; 42362306a36Sopenharmony_ci 42462306a36Sopenharmony_cidone: 42562306a36Sopenharmony_ci mutex_unlock(&stream->mutex); 42662306a36Sopenharmony_ci return ret; 42762306a36Sopenharmony_ci} 42862306a36Sopenharmony_ci 42962306a36Sopenharmony_cistatic int uvc_v4l2_get_streamparm(struct uvc_streaming *stream, 43062306a36Sopenharmony_ci struct v4l2_streamparm *parm) 43162306a36Sopenharmony_ci{ 43262306a36Sopenharmony_ci u32 numerator, denominator; 43362306a36Sopenharmony_ci 43462306a36Sopenharmony_ci if (parm->type != stream->type) 43562306a36Sopenharmony_ci return -EINVAL; 43662306a36Sopenharmony_ci 43762306a36Sopenharmony_ci mutex_lock(&stream->mutex); 43862306a36Sopenharmony_ci numerator = stream->ctrl.dwFrameInterval; 43962306a36Sopenharmony_ci mutex_unlock(&stream->mutex); 44062306a36Sopenharmony_ci 44162306a36Sopenharmony_ci denominator = 10000000; 44262306a36Sopenharmony_ci v4l2_simplify_fraction(&numerator, &denominator, 8, 333); 44362306a36Sopenharmony_ci 44462306a36Sopenharmony_ci memset(parm, 0, sizeof(*parm)); 44562306a36Sopenharmony_ci parm->type = stream->type; 44662306a36Sopenharmony_ci 44762306a36Sopenharmony_ci if (stream->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { 44862306a36Sopenharmony_ci parm->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; 44962306a36Sopenharmony_ci parm->parm.capture.capturemode = 0; 45062306a36Sopenharmony_ci parm->parm.capture.timeperframe.numerator = numerator; 45162306a36Sopenharmony_ci parm->parm.capture.timeperframe.denominator = denominator; 45262306a36Sopenharmony_ci parm->parm.capture.extendedmode = 0; 45362306a36Sopenharmony_ci parm->parm.capture.readbuffers = 0; 45462306a36Sopenharmony_ci } else { 45562306a36Sopenharmony_ci parm->parm.output.capability = V4L2_CAP_TIMEPERFRAME; 45662306a36Sopenharmony_ci parm->parm.output.outputmode = 0; 45762306a36Sopenharmony_ci parm->parm.output.timeperframe.numerator = numerator; 45862306a36Sopenharmony_ci parm->parm.output.timeperframe.denominator = denominator; 45962306a36Sopenharmony_ci } 46062306a36Sopenharmony_ci 46162306a36Sopenharmony_ci return 0; 46262306a36Sopenharmony_ci} 46362306a36Sopenharmony_ci 46462306a36Sopenharmony_cistatic int uvc_v4l2_set_streamparm(struct uvc_streaming *stream, 46562306a36Sopenharmony_ci struct v4l2_streamparm *parm) 46662306a36Sopenharmony_ci{ 46762306a36Sopenharmony_ci struct uvc_streaming_control probe; 46862306a36Sopenharmony_ci struct v4l2_fract timeperframe; 46962306a36Sopenharmony_ci const struct uvc_format *format; 47062306a36Sopenharmony_ci const struct uvc_frame *frame; 47162306a36Sopenharmony_ci u32 interval, maxd; 47262306a36Sopenharmony_ci unsigned int i; 47362306a36Sopenharmony_ci int ret; 47462306a36Sopenharmony_ci 47562306a36Sopenharmony_ci if (parm->type != stream->type) 47662306a36Sopenharmony_ci return -EINVAL; 47762306a36Sopenharmony_ci 47862306a36Sopenharmony_ci if (parm->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 47962306a36Sopenharmony_ci timeperframe = parm->parm.capture.timeperframe; 48062306a36Sopenharmony_ci else 48162306a36Sopenharmony_ci timeperframe = parm->parm.output.timeperframe; 48262306a36Sopenharmony_ci 48362306a36Sopenharmony_ci interval = v4l2_fraction_to_interval(timeperframe.numerator, 48462306a36Sopenharmony_ci timeperframe.denominator); 48562306a36Sopenharmony_ci uvc_dbg(stream->dev, FORMAT, "Setting frame interval to %u/%u (%u)\n", 48662306a36Sopenharmony_ci timeperframe.numerator, timeperframe.denominator, interval); 48762306a36Sopenharmony_ci 48862306a36Sopenharmony_ci mutex_lock(&stream->mutex); 48962306a36Sopenharmony_ci 49062306a36Sopenharmony_ci if (uvc_queue_streaming(&stream->queue)) { 49162306a36Sopenharmony_ci mutex_unlock(&stream->mutex); 49262306a36Sopenharmony_ci return -EBUSY; 49362306a36Sopenharmony_ci } 49462306a36Sopenharmony_ci 49562306a36Sopenharmony_ci format = stream->cur_format; 49662306a36Sopenharmony_ci frame = stream->cur_frame; 49762306a36Sopenharmony_ci probe = stream->ctrl; 49862306a36Sopenharmony_ci probe.dwFrameInterval = uvc_try_frame_interval(frame, interval); 49962306a36Sopenharmony_ci maxd = abs((s32)probe.dwFrameInterval - interval); 50062306a36Sopenharmony_ci 50162306a36Sopenharmony_ci /* Try frames with matching size to find the best frame interval. */ 50262306a36Sopenharmony_ci for (i = 0; i < format->nframes && maxd != 0; i++) { 50362306a36Sopenharmony_ci u32 d, ival; 50462306a36Sopenharmony_ci 50562306a36Sopenharmony_ci if (&format->frames[i] == stream->cur_frame) 50662306a36Sopenharmony_ci continue; 50762306a36Sopenharmony_ci 50862306a36Sopenharmony_ci if (format->frames[i].wWidth != stream->cur_frame->wWidth || 50962306a36Sopenharmony_ci format->frames[i].wHeight != stream->cur_frame->wHeight) 51062306a36Sopenharmony_ci continue; 51162306a36Sopenharmony_ci 51262306a36Sopenharmony_ci ival = uvc_try_frame_interval(&format->frames[i], interval); 51362306a36Sopenharmony_ci d = abs((s32)ival - interval); 51462306a36Sopenharmony_ci if (d >= maxd) 51562306a36Sopenharmony_ci continue; 51662306a36Sopenharmony_ci 51762306a36Sopenharmony_ci frame = &format->frames[i]; 51862306a36Sopenharmony_ci probe.bFrameIndex = frame->bFrameIndex; 51962306a36Sopenharmony_ci probe.dwFrameInterval = ival; 52062306a36Sopenharmony_ci maxd = d; 52162306a36Sopenharmony_ci } 52262306a36Sopenharmony_ci 52362306a36Sopenharmony_ci /* Probe the device with the new settings. */ 52462306a36Sopenharmony_ci ret = uvc_probe_video(stream, &probe); 52562306a36Sopenharmony_ci if (ret < 0) { 52662306a36Sopenharmony_ci mutex_unlock(&stream->mutex); 52762306a36Sopenharmony_ci return ret; 52862306a36Sopenharmony_ci } 52962306a36Sopenharmony_ci 53062306a36Sopenharmony_ci stream->ctrl = probe; 53162306a36Sopenharmony_ci stream->cur_frame = frame; 53262306a36Sopenharmony_ci mutex_unlock(&stream->mutex); 53362306a36Sopenharmony_ci 53462306a36Sopenharmony_ci /* Return the actual frame period. */ 53562306a36Sopenharmony_ci timeperframe.numerator = probe.dwFrameInterval; 53662306a36Sopenharmony_ci timeperframe.denominator = 10000000; 53762306a36Sopenharmony_ci v4l2_simplify_fraction(&timeperframe.numerator, 53862306a36Sopenharmony_ci &timeperframe.denominator, 8, 333); 53962306a36Sopenharmony_ci 54062306a36Sopenharmony_ci if (parm->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { 54162306a36Sopenharmony_ci parm->parm.capture.timeperframe = timeperframe; 54262306a36Sopenharmony_ci parm->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; 54362306a36Sopenharmony_ci } else { 54462306a36Sopenharmony_ci parm->parm.output.timeperframe = timeperframe; 54562306a36Sopenharmony_ci parm->parm.output.capability = V4L2_CAP_TIMEPERFRAME; 54662306a36Sopenharmony_ci } 54762306a36Sopenharmony_ci 54862306a36Sopenharmony_ci return 0; 54962306a36Sopenharmony_ci} 55062306a36Sopenharmony_ci 55162306a36Sopenharmony_ci/* ------------------------------------------------------------------------ 55262306a36Sopenharmony_ci * Privilege management 55362306a36Sopenharmony_ci */ 55462306a36Sopenharmony_ci 55562306a36Sopenharmony_ci/* 55662306a36Sopenharmony_ci * Privilege management is the multiple-open implementation basis. The current 55762306a36Sopenharmony_ci * implementation is completely transparent for the end-user and doesn't 55862306a36Sopenharmony_ci * require explicit use of the VIDIOC_G_PRIORITY and VIDIOC_S_PRIORITY ioctls. 55962306a36Sopenharmony_ci * Those ioctls enable finer control on the device (by making possible for a 56062306a36Sopenharmony_ci * user to request exclusive access to a device), but are not mature yet. 56162306a36Sopenharmony_ci * Switching to the V4L2 priority mechanism might be considered in the future 56262306a36Sopenharmony_ci * if this situation changes. 56362306a36Sopenharmony_ci * 56462306a36Sopenharmony_ci * Each open instance of a UVC device can either be in a privileged or 56562306a36Sopenharmony_ci * unprivileged state. Only a single instance can be in a privileged state at 56662306a36Sopenharmony_ci * a given time. Trying to perform an operation that requires privileges will 56762306a36Sopenharmony_ci * automatically acquire the required privileges if possible, or return -EBUSY 56862306a36Sopenharmony_ci * otherwise. Privileges are dismissed when closing the instance or when 56962306a36Sopenharmony_ci * freeing the video buffers using VIDIOC_REQBUFS. 57062306a36Sopenharmony_ci * 57162306a36Sopenharmony_ci * Operations that require privileges are: 57262306a36Sopenharmony_ci * 57362306a36Sopenharmony_ci * - VIDIOC_S_INPUT 57462306a36Sopenharmony_ci * - VIDIOC_S_PARM 57562306a36Sopenharmony_ci * - VIDIOC_S_FMT 57662306a36Sopenharmony_ci * - VIDIOC_REQBUFS 57762306a36Sopenharmony_ci */ 57862306a36Sopenharmony_cistatic int uvc_acquire_privileges(struct uvc_fh *handle) 57962306a36Sopenharmony_ci{ 58062306a36Sopenharmony_ci /* Always succeed if the handle is already privileged. */ 58162306a36Sopenharmony_ci if (handle->state == UVC_HANDLE_ACTIVE) 58262306a36Sopenharmony_ci return 0; 58362306a36Sopenharmony_ci 58462306a36Sopenharmony_ci /* Check if the device already has a privileged handle. */ 58562306a36Sopenharmony_ci if (atomic_inc_return(&handle->stream->active) != 1) { 58662306a36Sopenharmony_ci atomic_dec(&handle->stream->active); 58762306a36Sopenharmony_ci return -EBUSY; 58862306a36Sopenharmony_ci } 58962306a36Sopenharmony_ci 59062306a36Sopenharmony_ci handle->state = UVC_HANDLE_ACTIVE; 59162306a36Sopenharmony_ci return 0; 59262306a36Sopenharmony_ci} 59362306a36Sopenharmony_ci 59462306a36Sopenharmony_cistatic void uvc_dismiss_privileges(struct uvc_fh *handle) 59562306a36Sopenharmony_ci{ 59662306a36Sopenharmony_ci if (handle->state == UVC_HANDLE_ACTIVE) 59762306a36Sopenharmony_ci atomic_dec(&handle->stream->active); 59862306a36Sopenharmony_ci 59962306a36Sopenharmony_ci handle->state = UVC_HANDLE_PASSIVE; 60062306a36Sopenharmony_ci} 60162306a36Sopenharmony_ci 60262306a36Sopenharmony_cistatic int uvc_has_privileges(struct uvc_fh *handle) 60362306a36Sopenharmony_ci{ 60462306a36Sopenharmony_ci return handle->state == UVC_HANDLE_ACTIVE; 60562306a36Sopenharmony_ci} 60662306a36Sopenharmony_ci 60762306a36Sopenharmony_ci/* ------------------------------------------------------------------------ 60862306a36Sopenharmony_ci * V4L2 file operations 60962306a36Sopenharmony_ci */ 61062306a36Sopenharmony_ci 61162306a36Sopenharmony_cistatic int uvc_v4l2_open(struct file *file) 61262306a36Sopenharmony_ci{ 61362306a36Sopenharmony_ci struct uvc_streaming *stream; 61462306a36Sopenharmony_ci struct uvc_fh *handle; 61562306a36Sopenharmony_ci int ret = 0; 61662306a36Sopenharmony_ci 61762306a36Sopenharmony_ci stream = video_drvdata(file); 61862306a36Sopenharmony_ci uvc_dbg(stream->dev, CALLS, "%s\n", __func__); 61962306a36Sopenharmony_ci 62062306a36Sopenharmony_ci ret = usb_autopm_get_interface(stream->dev->intf); 62162306a36Sopenharmony_ci if (ret < 0) 62262306a36Sopenharmony_ci return ret; 62362306a36Sopenharmony_ci 62462306a36Sopenharmony_ci /* Create the device handle. */ 62562306a36Sopenharmony_ci handle = kzalloc(sizeof(*handle), GFP_KERNEL); 62662306a36Sopenharmony_ci if (handle == NULL) { 62762306a36Sopenharmony_ci usb_autopm_put_interface(stream->dev->intf); 62862306a36Sopenharmony_ci return -ENOMEM; 62962306a36Sopenharmony_ci } 63062306a36Sopenharmony_ci 63162306a36Sopenharmony_ci mutex_lock(&stream->dev->lock); 63262306a36Sopenharmony_ci if (stream->dev->users == 0) { 63362306a36Sopenharmony_ci ret = uvc_status_start(stream->dev, GFP_KERNEL); 63462306a36Sopenharmony_ci if (ret < 0) { 63562306a36Sopenharmony_ci mutex_unlock(&stream->dev->lock); 63662306a36Sopenharmony_ci usb_autopm_put_interface(stream->dev->intf); 63762306a36Sopenharmony_ci kfree(handle); 63862306a36Sopenharmony_ci return ret; 63962306a36Sopenharmony_ci } 64062306a36Sopenharmony_ci } 64162306a36Sopenharmony_ci 64262306a36Sopenharmony_ci stream->dev->users++; 64362306a36Sopenharmony_ci mutex_unlock(&stream->dev->lock); 64462306a36Sopenharmony_ci 64562306a36Sopenharmony_ci v4l2_fh_init(&handle->vfh, &stream->vdev); 64662306a36Sopenharmony_ci v4l2_fh_add(&handle->vfh); 64762306a36Sopenharmony_ci handle->chain = stream->chain; 64862306a36Sopenharmony_ci handle->stream = stream; 64962306a36Sopenharmony_ci handle->state = UVC_HANDLE_PASSIVE; 65062306a36Sopenharmony_ci file->private_data = handle; 65162306a36Sopenharmony_ci 65262306a36Sopenharmony_ci return 0; 65362306a36Sopenharmony_ci} 65462306a36Sopenharmony_ci 65562306a36Sopenharmony_cistatic int uvc_v4l2_release(struct file *file) 65662306a36Sopenharmony_ci{ 65762306a36Sopenharmony_ci struct uvc_fh *handle = file->private_data; 65862306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 65962306a36Sopenharmony_ci 66062306a36Sopenharmony_ci uvc_dbg(stream->dev, CALLS, "%s\n", __func__); 66162306a36Sopenharmony_ci 66262306a36Sopenharmony_ci /* Only free resources if this is a privileged handle. */ 66362306a36Sopenharmony_ci if (uvc_has_privileges(handle)) 66462306a36Sopenharmony_ci uvc_queue_release(&stream->queue); 66562306a36Sopenharmony_ci 66662306a36Sopenharmony_ci /* Release the file handle. */ 66762306a36Sopenharmony_ci uvc_dismiss_privileges(handle); 66862306a36Sopenharmony_ci v4l2_fh_del(&handle->vfh); 66962306a36Sopenharmony_ci v4l2_fh_exit(&handle->vfh); 67062306a36Sopenharmony_ci kfree(handle); 67162306a36Sopenharmony_ci file->private_data = NULL; 67262306a36Sopenharmony_ci 67362306a36Sopenharmony_ci mutex_lock(&stream->dev->lock); 67462306a36Sopenharmony_ci if (--stream->dev->users == 0) 67562306a36Sopenharmony_ci uvc_status_stop(stream->dev); 67662306a36Sopenharmony_ci mutex_unlock(&stream->dev->lock); 67762306a36Sopenharmony_ci 67862306a36Sopenharmony_ci usb_autopm_put_interface(stream->dev->intf); 67962306a36Sopenharmony_ci return 0; 68062306a36Sopenharmony_ci} 68162306a36Sopenharmony_ci 68262306a36Sopenharmony_cistatic int uvc_ioctl_querycap(struct file *file, void *fh, 68362306a36Sopenharmony_ci struct v4l2_capability *cap) 68462306a36Sopenharmony_ci{ 68562306a36Sopenharmony_ci struct uvc_fh *handle = file->private_data; 68662306a36Sopenharmony_ci struct uvc_video_chain *chain = handle->chain; 68762306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 68862306a36Sopenharmony_ci 68962306a36Sopenharmony_ci strscpy(cap->driver, "uvcvideo", sizeof(cap->driver)); 69062306a36Sopenharmony_ci strscpy(cap->card, handle->stream->dev->name, sizeof(cap->card)); 69162306a36Sopenharmony_ci usb_make_path(stream->dev->udev, cap->bus_info, sizeof(cap->bus_info)); 69262306a36Sopenharmony_ci cap->capabilities = V4L2_CAP_DEVICE_CAPS | V4L2_CAP_STREAMING 69362306a36Sopenharmony_ci | chain->caps; 69462306a36Sopenharmony_ci 69562306a36Sopenharmony_ci return 0; 69662306a36Sopenharmony_ci} 69762306a36Sopenharmony_ci 69862306a36Sopenharmony_cistatic int uvc_ioctl_enum_fmt(struct uvc_streaming *stream, 69962306a36Sopenharmony_ci struct v4l2_fmtdesc *fmt) 70062306a36Sopenharmony_ci{ 70162306a36Sopenharmony_ci const struct uvc_format *format; 70262306a36Sopenharmony_ci enum v4l2_buf_type type = fmt->type; 70362306a36Sopenharmony_ci u32 index = fmt->index; 70462306a36Sopenharmony_ci 70562306a36Sopenharmony_ci if (fmt->type != stream->type || fmt->index >= stream->nformats) 70662306a36Sopenharmony_ci return -EINVAL; 70762306a36Sopenharmony_ci 70862306a36Sopenharmony_ci memset(fmt, 0, sizeof(*fmt)); 70962306a36Sopenharmony_ci fmt->index = index; 71062306a36Sopenharmony_ci fmt->type = type; 71162306a36Sopenharmony_ci 71262306a36Sopenharmony_ci format = &stream->formats[fmt->index]; 71362306a36Sopenharmony_ci fmt->flags = 0; 71462306a36Sopenharmony_ci if (format->flags & UVC_FMT_FLAG_COMPRESSED) 71562306a36Sopenharmony_ci fmt->flags |= V4L2_FMT_FLAG_COMPRESSED; 71662306a36Sopenharmony_ci fmt->pixelformat = format->fcc; 71762306a36Sopenharmony_ci return 0; 71862306a36Sopenharmony_ci} 71962306a36Sopenharmony_ci 72062306a36Sopenharmony_cistatic int uvc_ioctl_enum_fmt_vid_cap(struct file *file, void *fh, 72162306a36Sopenharmony_ci struct v4l2_fmtdesc *fmt) 72262306a36Sopenharmony_ci{ 72362306a36Sopenharmony_ci struct uvc_fh *handle = fh; 72462306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 72562306a36Sopenharmony_ci 72662306a36Sopenharmony_ci return uvc_ioctl_enum_fmt(stream, fmt); 72762306a36Sopenharmony_ci} 72862306a36Sopenharmony_ci 72962306a36Sopenharmony_cistatic int uvc_ioctl_enum_fmt_vid_out(struct file *file, void *fh, 73062306a36Sopenharmony_ci struct v4l2_fmtdesc *fmt) 73162306a36Sopenharmony_ci{ 73262306a36Sopenharmony_ci struct uvc_fh *handle = fh; 73362306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 73462306a36Sopenharmony_ci 73562306a36Sopenharmony_ci return uvc_ioctl_enum_fmt(stream, fmt); 73662306a36Sopenharmony_ci} 73762306a36Sopenharmony_ci 73862306a36Sopenharmony_cistatic int uvc_ioctl_g_fmt_vid_cap(struct file *file, void *fh, 73962306a36Sopenharmony_ci struct v4l2_format *fmt) 74062306a36Sopenharmony_ci{ 74162306a36Sopenharmony_ci struct uvc_fh *handle = fh; 74262306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 74362306a36Sopenharmony_ci 74462306a36Sopenharmony_ci return uvc_v4l2_get_format(stream, fmt); 74562306a36Sopenharmony_ci} 74662306a36Sopenharmony_ci 74762306a36Sopenharmony_cistatic int uvc_ioctl_g_fmt_vid_out(struct file *file, void *fh, 74862306a36Sopenharmony_ci struct v4l2_format *fmt) 74962306a36Sopenharmony_ci{ 75062306a36Sopenharmony_ci struct uvc_fh *handle = fh; 75162306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 75262306a36Sopenharmony_ci 75362306a36Sopenharmony_ci return uvc_v4l2_get_format(stream, fmt); 75462306a36Sopenharmony_ci} 75562306a36Sopenharmony_ci 75662306a36Sopenharmony_cistatic int uvc_ioctl_s_fmt_vid_cap(struct file *file, void *fh, 75762306a36Sopenharmony_ci struct v4l2_format *fmt) 75862306a36Sopenharmony_ci{ 75962306a36Sopenharmony_ci struct uvc_fh *handle = fh; 76062306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 76162306a36Sopenharmony_ci int ret; 76262306a36Sopenharmony_ci 76362306a36Sopenharmony_ci ret = uvc_acquire_privileges(handle); 76462306a36Sopenharmony_ci if (ret < 0) 76562306a36Sopenharmony_ci return ret; 76662306a36Sopenharmony_ci 76762306a36Sopenharmony_ci return uvc_v4l2_set_format(stream, fmt); 76862306a36Sopenharmony_ci} 76962306a36Sopenharmony_ci 77062306a36Sopenharmony_cistatic int uvc_ioctl_s_fmt_vid_out(struct file *file, void *fh, 77162306a36Sopenharmony_ci struct v4l2_format *fmt) 77262306a36Sopenharmony_ci{ 77362306a36Sopenharmony_ci struct uvc_fh *handle = fh; 77462306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 77562306a36Sopenharmony_ci int ret; 77662306a36Sopenharmony_ci 77762306a36Sopenharmony_ci ret = uvc_acquire_privileges(handle); 77862306a36Sopenharmony_ci if (ret < 0) 77962306a36Sopenharmony_ci return ret; 78062306a36Sopenharmony_ci 78162306a36Sopenharmony_ci return uvc_v4l2_set_format(stream, fmt); 78262306a36Sopenharmony_ci} 78362306a36Sopenharmony_ci 78462306a36Sopenharmony_cistatic int uvc_ioctl_try_fmt_vid_cap(struct file *file, void *fh, 78562306a36Sopenharmony_ci struct v4l2_format *fmt) 78662306a36Sopenharmony_ci{ 78762306a36Sopenharmony_ci struct uvc_fh *handle = fh; 78862306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 78962306a36Sopenharmony_ci struct uvc_streaming_control probe; 79062306a36Sopenharmony_ci 79162306a36Sopenharmony_ci return uvc_v4l2_try_format(stream, fmt, &probe, NULL, NULL); 79262306a36Sopenharmony_ci} 79362306a36Sopenharmony_ci 79462306a36Sopenharmony_cistatic int uvc_ioctl_try_fmt_vid_out(struct file *file, void *fh, 79562306a36Sopenharmony_ci struct v4l2_format *fmt) 79662306a36Sopenharmony_ci{ 79762306a36Sopenharmony_ci struct uvc_fh *handle = fh; 79862306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 79962306a36Sopenharmony_ci struct uvc_streaming_control probe; 80062306a36Sopenharmony_ci 80162306a36Sopenharmony_ci return uvc_v4l2_try_format(stream, fmt, &probe, NULL, NULL); 80262306a36Sopenharmony_ci} 80362306a36Sopenharmony_ci 80462306a36Sopenharmony_cistatic int uvc_ioctl_reqbufs(struct file *file, void *fh, 80562306a36Sopenharmony_ci struct v4l2_requestbuffers *rb) 80662306a36Sopenharmony_ci{ 80762306a36Sopenharmony_ci struct uvc_fh *handle = fh; 80862306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 80962306a36Sopenharmony_ci int ret; 81062306a36Sopenharmony_ci 81162306a36Sopenharmony_ci ret = uvc_acquire_privileges(handle); 81262306a36Sopenharmony_ci if (ret < 0) 81362306a36Sopenharmony_ci return ret; 81462306a36Sopenharmony_ci 81562306a36Sopenharmony_ci mutex_lock(&stream->mutex); 81662306a36Sopenharmony_ci ret = uvc_request_buffers(&stream->queue, rb); 81762306a36Sopenharmony_ci mutex_unlock(&stream->mutex); 81862306a36Sopenharmony_ci if (ret < 0) 81962306a36Sopenharmony_ci return ret; 82062306a36Sopenharmony_ci 82162306a36Sopenharmony_ci if (ret == 0) 82262306a36Sopenharmony_ci uvc_dismiss_privileges(handle); 82362306a36Sopenharmony_ci 82462306a36Sopenharmony_ci return 0; 82562306a36Sopenharmony_ci} 82662306a36Sopenharmony_ci 82762306a36Sopenharmony_cistatic int uvc_ioctl_querybuf(struct file *file, void *fh, 82862306a36Sopenharmony_ci struct v4l2_buffer *buf) 82962306a36Sopenharmony_ci{ 83062306a36Sopenharmony_ci struct uvc_fh *handle = fh; 83162306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 83262306a36Sopenharmony_ci 83362306a36Sopenharmony_ci if (!uvc_has_privileges(handle)) 83462306a36Sopenharmony_ci return -EBUSY; 83562306a36Sopenharmony_ci 83662306a36Sopenharmony_ci return uvc_query_buffer(&stream->queue, buf); 83762306a36Sopenharmony_ci} 83862306a36Sopenharmony_ci 83962306a36Sopenharmony_cistatic int uvc_ioctl_qbuf(struct file *file, void *fh, struct v4l2_buffer *buf) 84062306a36Sopenharmony_ci{ 84162306a36Sopenharmony_ci struct uvc_fh *handle = fh; 84262306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 84362306a36Sopenharmony_ci 84462306a36Sopenharmony_ci if (!uvc_has_privileges(handle)) 84562306a36Sopenharmony_ci return -EBUSY; 84662306a36Sopenharmony_ci 84762306a36Sopenharmony_ci return uvc_queue_buffer(&stream->queue, 84862306a36Sopenharmony_ci stream->vdev.v4l2_dev->mdev, buf); 84962306a36Sopenharmony_ci} 85062306a36Sopenharmony_ci 85162306a36Sopenharmony_cistatic int uvc_ioctl_expbuf(struct file *file, void *fh, 85262306a36Sopenharmony_ci struct v4l2_exportbuffer *exp) 85362306a36Sopenharmony_ci{ 85462306a36Sopenharmony_ci struct uvc_fh *handle = fh; 85562306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 85662306a36Sopenharmony_ci 85762306a36Sopenharmony_ci if (!uvc_has_privileges(handle)) 85862306a36Sopenharmony_ci return -EBUSY; 85962306a36Sopenharmony_ci 86062306a36Sopenharmony_ci return uvc_export_buffer(&stream->queue, exp); 86162306a36Sopenharmony_ci} 86262306a36Sopenharmony_ci 86362306a36Sopenharmony_cistatic int uvc_ioctl_dqbuf(struct file *file, void *fh, struct v4l2_buffer *buf) 86462306a36Sopenharmony_ci{ 86562306a36Sopenharmony_ci struct uvc_fh *handle = fh; 86662306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 86762306a36Sopenharmony_ci 86862306a36Sopenharmony_ci if (!uvc_has_privileges(handle)) 86962306a36Sopenharmony_ci return -EBUSY; 87062306a36Sopenharmony_ci 87162306a36Sopenharmony_ci return uvc_dequeue_buffer(&stream->queue, buf, 87262306a36Sopenharmony_ci file->f_flags & O_NONBLOCK); 87362306a36Sopenharmony_ci} 87462306a36Sopenharmony_ci 87562306a36Sopenharmony_cistatic int uvc_ioctl_create_bufs(struct file *file, void *fh, 87662306a36Sopenharmony_ci struct v4l2_create_buffers *cb) 87762306a36Sopenharmony_ci{ 87862306a36Sopenharmony_ci struct uvc_fh *handle = fh; 87962306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 88062306a36Sopenharmony_ci int ret; 88162306a36Sopenharmony_ci 88262306a36Sopenharmony_ci ret = uvc_acquire_privileges(handle); 88362306a36Sopenharmony_ci if (ret < 0) 88462306a36Sopenharmony_ci return ret; 88562306a36Sopenharmony_ci 88662306a36Sopenharmony_ci return uvc_create_buffers(&stream->queue, cb); 88762306a36Sopenharmony_ci} 88862306a36Sopenharmony_ci 88962306a36Sopenharmony_cistatic int uvc_ioctl_streamon(struct file *file, void *fh, 89062306a36Sopenharmony_ci enum v4l2_buf_type type) 89162306a36Sopenharmony_ci{ 89262306a36Sopenharmony_ci struct uvc_fh *handle = fh; 89362306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 89462306a36Sopenharmony_ci int ret; 89562306a36Sopenharmony_ci 89662306a36Sopenharmony_ci if (!uvc_has_privileges(handle)) 89762306a36Sopenharmony_ci return -EBUSY; 89862306a36Sopenharmony_ci 89962306a36Sopenharmony_ci mutex_lock(&stream->mutex); 90062306a36Sopenharmony_ci ret = uvc_queue_streamon(&stream->queue, type); 90162306a36Sopenharmony_ci mutex_unlock(&stream->mutex); 90262306a36Sopenharmony_ci 90362306a36Sopenharmony_ci return ret; 90462306a36Sopenharmony_ci} 90562306a36Sopenharmony_ci 90662306a36Sopenharmony_cistatic int uvc_ioctl_streamoff(struct file *file, void *fh, 90762306a36Sopenharmony_ci enum v4l2_buf_type type) 90862306a36Sopenharmony_ci{ 90962306a36Sopenharmony_ci struct uvc_fh *handle = fh; 91062306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 91162306a36Sopenharmony_ci 91262306a36Sopenharmony_ci if (!uvc_has_privileges(handle)) 91362306a36Sopenharmony_ci return -EBUSY; 91462306a36Sopenharmony_ci 91562306a36Sopenharmony_ci mutex_lock(&stream->mutex); 91662306a36Sopenharmony_ci uvc_queue_streamoff(&stream->queue, type); 91762306a36Sopenharmony_ci mutex_unlock(&stream->mutex); 91862306a36Sopenharmony_ci 91962306a36Sopenharmony_ci return 0; 92062306a36Sopenharmony_ci} 92162306a36Sopenharmony_ci 92262306a36Sopenharmony_cistatic int uvc_ioctl_enum_input(struct file *file, void *fh, 92362306a36Sopenharmony_ci struct v4l2_input *input) 92462306a36Sopenharmony_ci{ 92562306a36Sopenharmony_ci struct uvc_fh *handle = fh; 92662306a36Sopenharmony_ci struct uvc_video_chain *chain = handle->chain; 92762306a36Sopenharmony_ci const struct uvc_entity *selector = chain->selector; 92862306a36Sopenharmony_ci struct uvc_entity *iterm = NULL; 92962306a36Sopenharmony_ci struct uvc_entity *it; 93062306a36Sopenharmony_ci u32 index = input->index; 93162306a36Sopenharmony_ci 93262306a36Sopenharmony_ci if (selector == NULL || 93362306a36Sopenharmony_ci (chain->dev->quirks & UVC_QUIRK_IGNORE_SELECTOR_UNIT)) { 93462306a36Sopenharmony_ci if (index != 0) 93562306a36Sopenharmony_ci return -EINVAL; 93662306a36Sopenharmony_ci list_for_each_entry(it, &chain->entities, chain) { 93762306a36Sopenharmony_ci if (UVC_ENTITY_IS_ITERM(it)) { 93862306a36Sopenharmony_ci iterm = it; 93962306a36Sopenharmony_ci break; 94062306a36Sopenharmony_ci } 94162306a36Sopenharmony_ci } 94262306a36Sopenharmony_ci } else if (index < selector->bNrInPins) { 94362306a36Sopenharmony_ci list_for_each_entry(it, &chain->entities, chain) { 94462306a36Sopenharmony_ci if (!UVC_ENTITY_IS_ITERM(it)) 94562306a36Sopenharmony_ci continue; 94662306a36Sopenharmony_ci if (it->id == selector->baSourceID[index]) { 94762306a36Sopenharmony_ci iterm = it; 94862306a36Sopenharmony_ci break; 94962306a36Sopenharmony_ci } 95062306a36Sopenharmony_ci } 95162306a36Sopenharmony_ci } 95262306a36Sopenharmony_ci 95362306a36Sopenharmony_ci if (iterm == NULL) 95462306a36Sopenharmony_ci return -EINVAL; 95562306a36Sopenharmony_ci 95662306a36Sopenharmony_ci memset(input, 0, sizeof(*input)); 95762306a36Sopenharmony_ci input->index = index; 95862306a36Sopenharmony_ci strscpy(input->name, iterm->name, sizeof(input->name)); 95962306a36Sopenharmony_ci if (UVC_ENTITY_TYPE(iterm) == UVC_ITT_CAMERA) 96062306a36Sopenharmony_ci input->type = V4L2_INPUT_TYPE_CAMERA; 96162306a36Sopenharmony_ci 96262306a36Sopenharmony_ci return 0; 96362306a36Sopenharmony_ci} 96462306a36Sopenharmony_ci 96562306a36Sopenharmony_cistatic int uvc_ioctl_g_input(struct file *file, void *fh, unsigned int *input) 96662306a36Sopenharmony_ci{ 96762306a36Sopenharmony_ci struct uvc_fh *handle = fh; 96862306a36Sopenharmony_ci struct uvc_video_chain *chain = handle->chain; 96962306a36Sopenharmony_ci u8 *buf; 97062306a36Sopenharmony_ci int ret; 97162306a36Sopenharmony_ci 97262306a36Sopenharmony_ci if (chain->selector == NULL || 97362306a36Sopenharmony_ci (chain->dev->quirks & UVC_QUIRK_IGNORE_SELECTOR_UNIT)) { 97462306a36Sopenharmony_ci *input = 0; 97562306a36Sopenharmony_ci return 0; 97662306a36Sopenharmony_ci } 97762306a36Sopenharmony_ci 97862306a36Sopenharmony_ci buf = kmalloc(1, GFP_KERNEL); 97962306a36Sopenharmony_ci if (!buf) 98062306a36Sopenharmony_ci return -ENOMEM; 98162306a36Sopenharmony_ci 98262306a36Sopenharmony_ci ret = uvc_query_ctrl(chain->dev, UVC_GET_CUR, chain->selector->id, 98362306a36Sopenharmony_ci chain->dev->intfnum, UVC_SU_INPUT_SELECT_CONTROL, 98462306a36Sopenharmony_ci buf, 1); 98562306a36Sopenharmony_ci if (!ret) 98662306a36Sopenharmony_ci *input = *buf - 1; 98762306a36Sopenharmony_ci 98862306a36Sopenharmony_ci kfree(buf); 98962306a36Sopenharmony_ci 99062306a36Sopenharmony_ci return ret; 99162306a36Sopenharmony_ci} 99262306a36Sopenharmony_ci 99362306a36Sopenharmony_cistatic int uvc_ioctl_s_input(struct file *file, void *fh, unsigned int input) 99462306a36Sopenharmony_ci{ 99562306a36Sopenharmony_ci struct uvc_fh *handle = fh; 99662306a36Sopenharmony_ci struct uvc_video_chain *chain = handle->chain; 99762306a36Sopenharmony_ci u8 *buf; 99862306a36Sopenharmony_ci int ret; 99962306a36Sopenharmony_ci 100062306a36Sopenharmony_ci ret = uvc_acquire_privileges(handle); 100162306a36Sopenharmony_ci if (ret < 0) 100262306a36Sopenharmony_ci return ret; 100362306a36Sopenharmony_ci 100462306a36Sopenharmony_ci if (chain->selector == NULL || 100562306a36Sopenharmony_ci (chain->dev->quirks & UVC_QUIRK_IGNORE_SELECTOR_UNIT)) { 100662306a36Sopenharmony_ci if (input) 100762306a36Sopenharmony_ci return -EINVAL; 100862306a36Sopenharmony_ci return 0; 100962306a36Sopenharmony_ci } 101062306a36Sopenharmony_ci 101162306a36Sopenharmony_ci if (input >= chain->selector->bNrInPins) 101262306a36Sopenharmony_ci return -EINVAL; 101362306a36Sopenharmony_ci 101462306a36Sopenharmony_ci buf = kmalloc(1, GFP_KERNEL); 101562306a36Sopenharmony_ci if (!buf) 101662306a36Sopenharmony_ci return -ENOMEM; 101762306a36Sopenharmony_ci 101862306a36Sopenharmony_ci *buf = input + 1; 101962306a36Sopenharmony_ci ret = uvc_query_ctrl(chain->dev, UVC_SET_CUR, chain->selector->id, 102062306a36Sopenharmony_ci chain->dev->intfnum, UVC_SU_INPUT_SELECT_CONTROL, 102162306a36Sopenharmony_ci buf, 1); 102262306a36Sopenharmony_ci kfree(buf); 102362306a36Sopenharmony_ci 102462306a36Sopenharmony_ci return ret; 102562306a36Sopenharmony_ci} 102662306a36Sopenharmony_ci 102762306a36Sopenharmony_cistatic int uvc_ioctl_queryctrl(struct file *file, void *fh, 102862306a36Sopenharmony_ci struct v4l2_queryctrl *qc) 102962306a36Sopenharmony_ci{ 103062306a36Sopenharmony_ci struct uvc_fh *handle = fh; 103162306a36Sopenharmony_ci struct uvc_video_chain *chain = handle->chain; 103262306a36Sopenharmony_ci 103362306a36Sopenharmony_ci return uvc_query_v4l2_ctrl(chain, qc); 103462306a36Sopenharmony_ci} 103562306a36Sopenharmony_ci 103662306a36Sopenharmony_cistatic int uvc_ioctl_query_ext_ctrl(struct file *file, void *fh, 103762306a36Sopenharmony_ci struct v4l2_query_ext_ctrl *qec) 103862306a36Sopenharmony_ci{ 103962306a36Sopenharmony_ci struct uvc_fh *handle = fh; 104062306a36Sopenharmony_ci struct uvc_video_chain *chain = handle->chain; 104162306a36Sopenharmony_ci struct v4l2_queryctrl qc = { qec->id }; 104262306a36Sopenharmony_ci int ret; 104362306a36Sopenharmony_ci 104462306a36Sopenharmony_ci ret = uvc_query_v4l2_ctrl(chain, &qc); 104562306a36Sopenharmony_ci if (ret) 104662306a36Sopenharmony_ci return ret; 104762306a36Sopenharmony_ci 104862306a36Sopenharmony_ci qec->id = qc.id; 104962306a36Sopenharmony_ci qec->type = qc.type; 105062306a36Sopenharmony_ci strscpy(qec->name, qc.name, sizeof(qec->name)); 105162306a36Sopenharmony_ci qec->minimum = qc.minimum; 105262306a36Sopenharmony_ci qec->maximum = qc.maximum; 105362306a36Sopenharmony_ci qec->step = qc.step; 105462306a36Sopenharmony_ci qec->default_value = qc.default_value; 105562306a36Sopenharmony_ci qec->flags = qc.flags; 105662306a36Sopenharmony_ci qec->elem_size = 4; 105762306a36Sopenharmony_ci qec->elems = 1; 105862306a36Sopenharmony_ci qec->nr_of_dims = 0; 105962306a36Sopenharmony_ci memset(qec->dims, 0, sizeof(qec->dims)); 106062306a36Sopenharmony_ci memset(qec->reserved, 0, sizeof(qec->reserved)); 106162306a36Sopenharmony_ci 106262306a36Sopenharmony_ci return 0; 106362306a36Sopenharmony_ci} 106462306a36Sopenharmony_ci 106562306a36Sopenharmony_cistatic int uvc_ctrl_check_access(struct uvc_video_chain *chain, 106662306a36Sopenharmony_ci struct v4l2_ext_controls *ctrls, 106762306a36Sopenharmony_ci unsigned long ioctl) 106862306a36Sopenharmony_ci{ 106962306a36Sopenharmony_ci struct v4l2_ext_control *ctrl = ctrls->controls; 107062306a36Sopenharmony_ci unsigned int i; 107162306a36Sopenharmony_ci int ret = 0; 107262306a36Sopenharmony_ci 107362306a36Sopenharmony_ci for (i = 0; i < ctrls->count; ++ctrl, ++i) { 107462306a36Sopenharmony_ci ret = uvc_ctrl_is_accessible(chain, ctrl->id, ctrls, ioctl); 107562306a36Sopenharmony_ci if (ret) 107662306a36Sopenharmony_ci break; 107762306a36Sopenharmony_ci } 107862306a36Sopenharmony_ci 107962306a36Sopenharmony_ci ctrls->error_idx = ioctl == VIDIOC_TRY_EXT_CTRLS ? i : ctrls->count; 108062306a36Sopenharmony_ci 108162306a36Sopenharmony_ci return ret; 108262306a36Sopenharmony_ci} 108362306a36Sopenharmony_ci 108462306a36Sopenharmony_cistatic int uvc_ioctl_g_ext_ctrls(struct file *file, void *fh, 108562306a36Sopenharmony_ci struct v4l2_ext_controls *ctrls) 108662306a36Sopenharmony_ci{ 108762306a36Sopenharmony_ci struct uvc_fh *handle = fh; 108862306a36Sopenharmony_ci struct uvc_video_chain *chain = handle->chain; 108962306a36Sopenharmony_ci struct v4l2_ext_control *ctrl = ctrls->controls; 109062306a36Sopenharmony_ci unsigned int i; 109162306a36Sopenharmony_ci int ret; 109262306a36Sopenharmony_ci 109362306a36Sopenharmony_ci ret = uvc_ctrl_check_access(chain, ctrls, VIDIOC_G_EXT_CTRLS); 109462306a36Sopenharmony_ci if (ret < 0) 109562306a36Sopenharmony_ci return ret; 109662306a36Sopenharmony_ci 109762306a36Sopenharmony_ci if (ctrls->which == V4L2_CTRL_WHICH_DEF_VAL) { 109862306a36Sopenharmony_ci for (i = 0; i < ctrls->count; ++ctrl, ++i) { 109962306a36Sopenharmony_ci struct v4l2_queryctrl qc = { .id = ctrl->id }; 110062306a36Sopenharmony_ci 110162306a36Sopenharmony_ci ret = uvc_query_v4l2_ctrl(chain, &qc); 110262306a36Sopenharmony_ci if (ret < 0) { 110362306a36Sopenharmony_ci ctrls->error_idx = i; 110462306a36Sopenharmony_ci return ret; 110562306a36Sopenharmony_ci } 110662306a36Sopenharmony_ci 110762306a36Sopenharmony_ci ctrl->value = qc.default_value; 110862306a36Sopenharmony_ci } 110962306a36Sopenharmony_ci 111062306a36Sopenharmony_ci return 0; 111162306a36Sopenharmony_ci } 111262306a36Sopenharmony_ci 111362306a36Sopenharmony_ci ret = uvc_ctrl_begin(chain); 111462306a36Sopenharmony_ci if (ret < 0) 111562306a36Sopenharmony_ci return ret; 111662306a36Sopenharmony_ci 111762306a36Sopenharmony_ci for (i = 0; i < ctrls->count; ++ctrl, ++i) { 111862306a36Sopenharmony_ci ret = uvc_ctrl_get(chain, ctrl); 111962306a36Sopenharmony_ci if (ret < 0) { 112062306a36Sopenharmony_ci uvc_ctrl_rollback(handle); 112162306a36Sopenharmony_ci ctrls->error_idx = i; 112262306a36Sopenharmony_ci return ret; 112362306a36Sopenharmony_ci } 112462306a36Sopenharmony_ci } 112562306a36Sopenharmony_ci 112662306a36Sopenharmony_ci ctrls->error_idx = 0; 112762306a36Sopenharmony_ci 112862306a36Sopenharmony_ci return uvc_ctrl_rollback(handle); 112962306a36Sopenharmony_ci} 113062306a36Sopenharmony_ci 113162306a36Sopenharmony_cistatic int uvc_ioctl_s_try_ext_ctrls(struct uvc_fh *handle, 113262306a36Sopenharmony_ci struct v4l2_ext_controls *ctrls, 113362306a36Sopenharmony_ci unsigned long ioctl) 113462306a36Sopenharmony_ci{ 113562306a36Sopenharmony_ci struct v4l2_ext_control *ctrl = ctrls->controls; 113662306a36Sopenharmony_ci struct uvc_video_chain *chain = handle->chain; 113762306a36Sopenharmony_ci unsigned int i; 113862306a36Sopenharmony_ci int ret; 113962306a36Sopenharmony_ci 114062306a36Sopenharmony_ci ret = uvc_ctrl_check_access(chain, ctrls, ioctl); 114162306a36Sopenharmony_ci if (ret < 0) 114262306a36Sopenharmony_ci return ret; 114362306a36Sopenharmony_ci 114462306a36Sopenharmony_ci ret = uvc_ctrl_begin(chain); 114562306a36Sopenharmony_ci if (ret < 0) 114662306a36Sopenharmony_ci return ret; 114762306a36Sopenharmony_ci 114862306a36Sopenharmony_ci for (i = 0; i < ctrls->count; ++ctrl, ++i) { 114962306a36Sopenharmony_ci ret = uvc_ctrl_set(handle, ctrl); 115062306a36Sopenharmony_ci if (ret < 0) { 115162306a36Sopenharmony_ci uvc_ctrl_rollback(handle); 115262306a36Sopenharmony_ci ctrls->error_idx = ioctl == VIDIOC_S_EXT_CTRLS ? 115362306a36Sopenharmony_ci ctrls->count : i; 115462306a36Sopenharmony_ci return ret; 115562306a36Sopenharmony_ci } 115662306a36Sopenharmony_ci } 115762306a36Sopenharmony_ci 115862306a36Sopenharmony_ci ctrls->error_idx = 0; 115962306a36Sopenharmony_ci 116062306a36Sopenharmony_ci if (ioctl == VIDIOC_S_EXT_CTRLS) 116162306a36Sopenharmony_ci return uvc_ctrl_commit(handle, ctrls); 116262306a36Sopenharmony_ci else 116362306a36Sopenharmony_ci return uvc_ctrl_rollback(handle); 116462306a36Sopenharmony_ci} 116562306a36Sopenharmony_ci 116662306a36Sopenharmony_cistatic int uvc_ioctl_s_ext_ctrls(struct file *file, void *fh, 116762306a36Sopenharmony_ci struct v4l2_ext_controls *ctrls) 116862306a36Sopenharmony_ci{ 116962306a36Sopenharmony_ci struct uvc_fh *handle = fh; 117062306a36Sopenharmony_ci 117162306a36Sopenharmony_ci return uvc_ioctl_s_try_ext_ctrls(handle, ctrls, VIDIOC_S_EXT_CTRLS); 117262306a36Sopenharmony_ci} 117362306a36Sopenharmony_ci 117462306a36Sopenharmony_cistatic int uvc_ioctl_try_ext_ctrls(struct file *file, void *fh, 117562306a36Sopenharmony_ci struct v4l2_ext_controls *ctrls) 117662306a36Sopenharmony_ci{ 117762306a36Sopenharmony_ci struct uvc_fh *handle = fh; 117862306a36Sopenharmony_ci 117962306a36Sopenharmony_ci return uvc_ioctl_s_try_ext_ctrls(handle, ctrls, VIDIOC_TRY_EXT_CTRLS); 118062306a36Sopenharmony_ci} 118162306a36Sopenharmony_ci 118262306a36Sopenharmony_cistatic int uvc_ioctl_querymenu(struct file *file, void *fh, 118362306a36Sopenharmony_ci struct v4l2_querymenu *qm) 118462306a36Sopenharmony_ci{ 118562306a36Sopenharmony_ci struct uvc_fh *handle = fh; 118662306a36Sopenharmony_ci struct uvc_video_chain *chain = handle->chain; 118762306a36Sopenharmony_ci 118862306a36Sopenharmony_ci return uvc_query_v4l2_menu(chain, qm); 118962306a36Sopenharmony_ci} 119062306a36Sopenharmony_ci 119162306a36Sopenharmony_cistatic int uvc_ioctl_g_selection(struct file *file, void *fh, 119262306a36Sopenharmony_ci struct v4l2_selection *sel) 119362306a36Sopenharmony_ci{ 119462306a36Sopenharmony_ci struct uvc_fh *handle = fh; 119562306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 119662306a36Sopenharmony_ci 119762306a36Sopenharmony_ci if (sel->type != stream->type) 119862306a36Sopenharmony_ci return -EINVAL; 119962306a36Sopenharmony_ci 120062306a36Sopenharmony_ci switch (sel->target) { 120162306a36Sopenharmony_ci case V4L2_SEL_TGT_CROP_DEFAULT: 120262306a36Sopenharmony_ci case V4L2_SEL_TGT_CROP_BOUNDS: 120362306a36Sopenharmony_ci if (stream->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 120462306a36Sopenharmony_ci return -EINVAL; 120562306a36Sopenharmony_ci break; 120662306a36Sopenharmony_ci case V4L2_SEL_TGT_COMPOSE_DEFAULT: 120762306a36Sopenharmony_ci case V4L2_SEL_TGT_COMPOSE_BOUNDS: 120862306a36Sopenharmony_ci if (stream->type != V4L2_BUF_TYPE_VIDEO_OUTPUT) 120962306a36Sopenharmony_ci return -EINVAL; 121062306a36Sopenharmony_ci break; 121162306a36Sopenharmony_ci default: 121262306a36Sopenharmony_ci return -EINVAL; 121362306a36Sopenharmony_ci } 121462306a36Sopenharmony_ci 121562306a36Sopenharmony_ci sel->r.left = 0; 121662306a36Sopenharmony_ci sel->r.top = 0; 121762306a36Sopenharmony_ci mutex_lock(&stream->mutex); 121862306a36Sopenharmony_ci sel->r.width = stream->cur_frame->wWidth; 121962306a36Sopenharmony_ci sel->r.height = stream->cur_frame->wHeight; 122062306a36Sopenharmony_ci mutex_unlock(&stream->mutex); 122162306a36Sopenharmony_ci 122262306a36Sopenharmony_ci return 0; 122362306a36Sopenharmony_ci} 122462306a36Sopenharmony_ci 122562306a36Sopenharmony_cistatic int uvc_ioctl_g_parm(struct file *file, void *fh, 122662306a36Sopenharmony_ci struct v4l2_streamparm *parm) 122762306a36Sopenharmony_ci{ 122862306a36Sopenharmony_ci struct uvc_fh *handle = fh; 122962306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 123062306a36Sopenharmony_ci 123162306a36Sopenharmony_ci return uvc_v4l2_get_streamparm(stream, parm); 123262306a36Sopenharmony_ci} 123362306a36Sopenharmony_ci 123462306a36Sopenharmony_cistatic int uvc_ioctl_s_parm(struct file *file, void *fh, 123562306a36Sopenharmony_ci struct v4l2_streamparm *parm) 123662306a36Sopenharmony_ci{ 123762306a36Sopenharmony_ci struct uvc_fh *handle = fh; 123862306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 123962306a36Sopenharmony_ci int ret; 124062306a36Sopenharmony_ci 124162306a36Sopenharmony_ci ret = uvc_acquire_privileges(handle); 124262306a36Sopenharmony_ci if (ret < 0) 124362306a36Sopenharmony_ci return ret; 124462306a36Sopenharmony_ci 124562306a36Sopenharmony_ci return uvc_v4l2_set_streamparm(stream, parm); 124662306a36Sopenharmony_ci} 124762306a36Sopenharmony_ci 124862306a36Sopenharmony_cistatic int uvc_ioctl_enum_framesizes(struct file *file, void *fh, 124962306a36Sopenharmony_ci struct v4l2_frmsizeenum *fsize) 125062306a36Sopenharmony_ci{ 125162306a36Sopenharmony_ci struct uvc_fh *handle = fh; 125262306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 125362306a36Sopenharmony_ci const struct uvc_format *format = NULL; 125462306a36Sopenharmony_ci const struct uvc_frame *frame = NULL; 125562306a36Sopenharmony_ci unsigned int index; 125662306a36Sopenharmony_ci unsigned int i; 125762306a36Sopenharmony_ci 125862306a36Sopenharmony_ci /* Look for the given pixel format */ 125962306a36Sopenharmony_ci for (i = 0; i < stream->nformats; i++) { 126062306a36Sopenharmony_ci if (stream->formats[i].fcc == fsize->pixel_format) { 126162306a36Sopenharmony_ci format = &stream->formats[i]; 126262306a36Sopenharmony_ci break; 126362306a36Sopenharmony_ci } 126462306a36Sopenharmony_ci } 126562306a36Sopenharmony_ci if (format == NULL) 126662306a36Sopenharmony_ci return -EINVAL; 126762306a36Sopenharmony_ci 126862306a36Sopenharmony_ci /* Skip duplicate frame sizes */ 126962306a36Sopenharmony_ci for (i = 0, index = 0; i < format->nframes; i++) { 127062306a36Sopenharmony_ci if (frame && frame->wWidth == format->frames[i].wWidth && 127162306a36Sopenharmony_ci frame->wHeight == format->frames[i].wHeight) 127262306a36Sopenharmony_ci continue; 127362306a36Sopenharmony_ci frame = &format->frames[i]; 127462306a36Sopenharmony_ci if (index == fsize->index) 127562306a36Sopenharmony_ci break; 127662306a36Sopenharmony_ci index++; 127762306a36Sopenharmony_ci } 127862306a36Sopenharmony_ci 127962306a36Sopenharmony_ci if (i == format->nframes) 128062306a36Sopenharmony_ci return -EINVAL; 128162306a36Sopenharmony_ci 128262306a36Sopenharmony_ci fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 128362306a36Sopenharmony_ci fsize->discrete.width = frame->wWidth; 128462306a36Sopenharmony_ci fsize->discrete.height = frame->wHeight; 128562306a36Sopenharmony_ci return 0; 128662306a36Sopenharmony_ci} 128762306a36Sopenharmony_ci 128862306a36Sopenharmony_cistatic int uvc_ioctl_enum_frameintervals(struct file *file, void *fh, 128962306a36Sopenharmony_ci struct v4l2_frmivalenum *fival) 129062306a36Sopenharmony_ci{ 129162306a36Sopenharmony_ci struct uvc_fh *handle = fh; 129262306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 129362306a36Sopenharmony_ci const struct uvc_format *format = NULL; 129462306a36Sopenharmony_ci const struct uvc_frame *frame = NULL; 129562306a36Sopenharmony_ci unsigned int nintervals; 129662306a36Sopenharmony_ci unsigned int index; 129762306a36Sopenharmony_ci unsigned int i; 129862306a36Sopenharmony_ci 129962306a36Sopenharmony_ci /* Look for the given pixel format and frame size */ 130062306a36Sopenharmony_ci for (i = 0; i < stream->nformats; i++) { 130162306a36Sopenharmony_ci if (stream->formats[i].fcc == fival->pixel_format) { 130262306a36Sopenharmony_ci format = &stream->formats[i]; 130362306a36Sopenharmony_ci break; 130462306a36Sopenharmony_ci } 130562306a36Sopenharmony_ci } 130662306a36Sopenharmony_ci if (format == NULL) 130762306a36Sopenharmony_ci return -EINVAL; 130862306a36Sopenharmony_ci 130962306a36Sopenharmony_ci index = fival->index; 131062306a36Sopenharmony_ci for (i = 0; i < format->nframes; i++) { 131162306a36Sopenharmony_ci if (format->frames[i].wWidth == fival->width && 131262306a36Sopenharmony_ci format->frames[i].wHeight == fival->height) { 131362306a36Sopenharmony_ci frame = &format->frames[i]; 131462306a36Sopenharmony_ci nintervals = frame->bFrameIntervalType ?: 1; 131562306a36Sopenharmony_ci if (index < nintervals) 131662306a36Sopenharmony_ci break; 131762306a36Sopenharmony_ci index -= nintervals; 131862306a36Sopenharmony_ci } 131962306a36Sopenharmony_ci } 132062306a36Sopenharmony_ci if (i == format->nframes) 132162306a36Sopenharmony_ci return -EINVAL; 132262306a36Sopenharmony_ci 132362306a36Sopenharmony_ci if (frame->bFrameIntervalType) { 132462306a36Sopenharmony_ci fival->type = V4L2_FRMIVAL_TYPE_DISCRETE; 132562306a36Sopenharmony_ci fival->discrete.numerator = 132662306a36Sopenharmony_ci frame->dwFrameInterval[index]; 132762306a36Sopenharmony_ci fival->discrete.denominator = 10000000; 132862306a36Sopenharmony_ci v4l2_simplify_fraction(&fival->discrete.numerator, 132962306a36Sopenharmony_ci &fival->discrete.denominator, 8, 333); 133062306a36Sopenharmony_ci } else { 133162306a36Sopenharmony_ci fival->type = V4L2_FRMIVAL_TYPE_STEPWISE; 133262306a36Sopenharmony_ci fival->stepwise.min.numerator = frame->dwFrameInterval[0]; 133362306a36Sopenharmony_ci fival->stepwise.min.denominator = 10000000; 133462306a36Sopenharmony_ci fival->stepwise.max.numerator = frame->dwFrameInterval[1]; 133562306a36Sopenharmony_ci fival->stepwise.max.denominator = 10000000; 133662306a36Sopenharmony_ci fival->stepwise.step.numerator = frame->dwFrameInterval[2]; 133762306a36Sopenharmony_ci fival->stepwise.step.denominator = 10000000; 133862306a36Sopenharmony_ci v4l2_simplify_fraction(&fival->stepwise.min.numerator, 133962306a36Sopenharmony_ci &fival->stepwise.min.denominator, 8, 333); 134062306a36Sopenharmony_ci v4l2_simplify_fraction(&fival->stepwise.max.numerator, 134162306a36Sopenharmony_ci &fival->stepwise.max.denominator, 8, 333); 134262306a36Sopenharmony_ci v4l2_simplify_fraction(&fival->stepwise.step.numerator, 134362306a36Sopenharmony_ci &fival->stepwise.step.denominator, 8, 333); 134462306a36Sopenharmony_ci } 134562306a36Sopenharmony_ci 134662306a36Sopenharmony_ci return 0; 134762306a36Sopenharmony_ci} 134862306a36Sopenharmony_ci 134962306a36Sopenharmony_cistatic int uvc_ioctl_subscribe_event(struct v4l2_fh *fh, 135062306a36Sopenharmony_ci const struct v4l2_event_subscription *sub) 135162306a36Sopenharmony_ci{ 135262306a36Sopenharmony_ci switch (sub->type) { 135362306a36Sopenharmony_ci case V4L2_EVENT_CTRL: 135462306a36Sopenharmony_ci return v4l2_event_subscribe(fh, sub, 0, &uvc_ctrl_sub_ev_ops); 135562306a36Sopenharmony_ci default: 135662306a36Sopenharmony_ci return -EINVAL; 135762306a36Sopenharmony_ci } 135862306a36Sopenharmony_ci} 135962306a36Sopenharmony_ci 136062306a36Sopenharmony_cistatic long uvc_ioctl_default(struct file *file, void *fh, bool valid_prio, 136162306a36Sopenharmony_ci unsigned int cmd, void *arg) 136262306a36Sopenharmony_ci{ 136362306a36Sopenharmony_ci struct uvc_fh *handle = fh; 136462306a36Sopenharmony_ci struct uvc_video_chain *chain = handle->chain; 136562306a36Sopenharmony_ci 136662306a36Sopenharmony_ci switch (cmd) { 136762306a36Sopenharmony_ci /* Dynamic controls. */ 136862306a36Sopenharmony_ci case UVCIOC_CTRL_MAP: 136962306a36Sopenharmony_ci return uvc_ioctl_xu_ctrl_map(chain, arg); 137062306a36Sopenharmony_ci 137162306a36Sopenharmony_ci case UVCIOC_CTRL_QUERY: 137262306a36Sopenharmony_ci return uvc_xu_ctrl_query(chain, arg); 137362306a36Sopenharmony_ci 137462306a36Sopenharmony_ci default: 137562306a36Sopenharmony_ci return -ENOTTY; 137662306a36Sopenharmony_ci } 137762306a36Sopenharmony_ci} 137862306a36Sopenharmony_ci 137962306a36Sopenharmony_ci#ifdef CONFIG_COMPAT 138062306a36Sopenharmony_cistruct uvc_xu_control_mapping32 { 138162306a36Sopenharmony_ci u32 id; 138262306a36Sopenharmony_ci u8 name[32]; 138362306a36Sopenharmony_ci u8 entity[16]; 138462306a36Sopenharmony_ci u8 selector; 138562306a36Sopenharmony_ci 138662306a36Sopenharmony_ci u8 size; 138762306a36Sopenharmony_ci u8 offset; 138862306a36Sopenharmony_ci u32 v4l2_type; 138962306a36Sopenharmony_ci u32 data_type; 139062306a36Sopenharmony_ci 139162306a36Sopenharmony_ci compat_caddr_t menu_info; 139262306a36Sopenharmony_ci u32 menu_count; 139362306a36Sopenharmony_ci 139462306a36Sopenharmony_ci u32 reserved[4]; 139562306a36Sopenharmony_ci}; 139662306a36Sopenharmony_ci 139762306a36Sopenharmony_cistatic int uvc_v4l2_get_xu_mapping(struct uvc_xu_control_mapping *kp, 139862306a36Sopenharmony_ci const struct uvc_xu_control_mapping32 __user *up) 139962306a36Sopenharmony_ci{ 140062306a36Sopenharmony_ci struct uvc_xu_control_mapping32 *p = (void *)kp; 140162306a36Sopenharmony_ci compat_caddr_t info; 140262306a36Sopenharmony_ci u32 count; 140362306a36Sopenharmony_ci 140462306a36Sopenharmony_ci if (copy_from_user(p, up, sizeof(*p))) 140562306a36Sopenharmony_ci return -EFAULT; 140662306a36Sopenharmony_ci 140762306a36Sopenharmony_ci count = p->menu_count; 140862306a36Sopenharmony_ci info = p->menu_info; 140962306a36Sopenharmony_ci 141062306a36Sopenharmony_ci memset(kp->reserved, 0, sizeof(kp->reserved)); 141162306a36Sopenharmony_ci kp->menu_info = count ? compat_ptr(info) : NULL; 141262306a36Sopenharmony_ci kp->menu_count = count; 141362306a36Sopenharmony_ci return 0; 141462306a36Sopenharmony_ci} 141562306a36Sopenharmony_ci 141662306a36Sopenharmony_cistatic int uvc_v4l2_put_xu_mapping(const struct uvc_xu_control_mapping *kp, 141762306a36Sopenharmony_ci struct uvc_xu_control_mapping32 __user *up) 141862306a36Sopenharmony_ci{ 141962306a36Sopenharmony_ci if (copy_to_user(up, kp, offsetof(typeof(*up), menu_info)) || 142062306a36Sopenharmony_ci put_user(kp->menu_count, &up->menu_count)) 142162306a36Sopenharmony_ci return -EFAULT; 142262306a36Sopenharmony_ci 142362306a36Sopenharmony_ci if (clear_user(up->reserved, sizeof(up->reserved))) 142462306a36Sopenharmony_ci return -EFAULT; 142562306a36Sopenharmony_ci 142662306a36Sopenharmony_ci return 0; 142762306a36Sopenharmony_ci} 142862306a36Sopenharmony_ci 142962306a36Sopenharmony_cistruct uvc_xu_control_query32 { 143062306a36Sopenharmony_ci u8 unit; 143162306a36Sopenharmony_ci u8 selector; 143262306a36Sopenharmony_ci u8 query; 143362306a36Sopenharmony_ci u16 size; 143462306a36Sopenharmony_ci compat_caddr_t data; 143562306a36Sopenharmony_ci}; 143662306a36Sopenharmony_ci 143762306a36Sopenharmony_cistatic int uvc_v4l2_get_xu_query(struct uvc_xu_control_query *kp, 143862306a36Sopenharmony_ci const struct uvc_xu_control_query32 __user *up) 143962306a36Sopenharmony_ci{ 144062306a36Sopenharmony_ci struct uvc_xu_control_query32 v; 144162306a36Sopenharmony_ci 144262306a36Sopenharmony_ci if (copy_from_user(&v, up, sizeof(v))) 144362306a36Sopenharmony_ci return -EFAULT; 144462306a36Sopenharmony_ci 144562306a36Sopenharmony_ci *kp = (struct uvc_xu_control_query){ 144662306a36Sopenharmony_ci .unit = v.unit, 144762306a36Sopenharmony_ci .selector = v.selector, 144862306a36Sopenharmony_ci .query = v.query, 144962306a36Sopenharmony_ci .size = v.size, 145062306a36Sopenharmony_ci .data = v.size ? compat_ptr(v.data) : NULL 145162306a36Sopenharmony_ci }; 145262306a36Sopenharmony_ci return 0; 145362306a36Sopenharmony_ci} 145462306a36Sopenharmony_ci 145562306a36Sopenharmony_cistatic int uvc_v4l2_put_xu_query(const struct uvc_xu_control_query *kp, 145662306a36Sopenharmony_ci struct uvc_xu_control_query32 __user *up) 145762306a36Sopenharmony_ci{ 145862306a36Sopenharmony_ci if (copy_to_user(up, kp, offsetof(typeof(*up), data))) 145962306a36Sopenharmony_ci return -EFAULT; 146062306a36Sopenharmony_ci return 0; 146162306a36Sopenharmony_ci} 146262306a36Sopenharmony_ci 146362306a36Sopenharmony_ci#define UVCIOC_CTRL_MAP32 _IOWR('u', 0x20, struct uvc_xu_control_mapping32) 146462306a36Sopenharmony_ci#define UVCIOC_CTRL_QUERY32 _IOWR('u', 0x21, struct uvc_xu_control_query32) 146562306a36Sopenharmony_ci 146662306a36Sopenharmony_cistatic long uvc_v4l2_compat_ioctl32(struct file *file, 146762306a36Sopenharmony_ci unsigned int cmd, unsigned long arg) 146862306a36Sopenharmony_ci{ 146962306a36Sopenharmony_ci struct uvc_fh *handle = file->private_data; 147062306a36Sopenharmony_ci union { 147162306a36Sopenharmony_ci struct uvc_xu_control_mapping xmap; 147262306a36Sopenharmony_ci struct uvc_xu_control_query xqry; 147362306a36Sopenharmony_ci } karg; 147462306a36Sopenharmony_ci void __user *up = compat_ptr(arg); 147562306a36Sopenharmony_ci long ret; 147662306a36Sopenharmony_ci 147762306a36Sopenharmony_ci switch (cmd) { 147862306a36Sopenharmony_ci case UVCIOC_CTRL_MAP32: 147962306a36Sopenharmony_ci ret = uvc_v4l2_get_xu_mapping(&karg.xmap, up); 148062306a36Sopenharmony_ci if (ret) 148162306a36Sopenharmony_ci return ret; 148262306a36Sopenharmony_ci ret = uvc_ioctl_xu_ctrl_map(handle->chain, &karg.xmap); 148362306a36Sopenharmony_ci if (ret) 148462306a36Sopenharmony_ci return ret; 148562306a36Sopenharmony_ci ret = uvc_v4l2_put_xu_mapping(&karg.xmap, up); 148662306a36Sopenharmony_ci if (ret) 148762306a36Sopenharmony_ci return ret; 148862306a36Sopenharmony_ci 148962306a36Sopenharmony_ci break; 149062306a36Sopenharmony_ci 149162306a36Sopenharmony_ci case UVCIOC_CTRL_QUERY32: 149262306a36Sopenharmony_ci ret = uvc_v4l2_get_xu_query(&karg.xqry, up); 149362306a36Sopenharmony_ci if (ret) 149462306a36Sopenharmony_ci return ret; 149562306a36Sopenharmony_ci ret = uvc_xu_ctrl_query(handle->chain, &karg.xqry); 149662306a36Sopenharmony_ci if (ret) 149762306a36Sopenharmony_ci return ret; 149862306a36Sopenharmony_ci ret = uvc_v4l2_put_xu_query(&karg.xqry, up); 149962306a36Sopenharmony_ci if (ret) 150062306a36Sopenharmony_ci return ret; 150162306a36Sopenharmony_ci break; 150262306a36Sopenharmony_ci 150362306a36Sopenharmony_ci default: 150462306a36Sopenharmony_ci return -ENOIOCTLCMD; 150562306a36Sopenharmony_ci } 150662306a36Sopenharmony_ci 150762306a36Sopenharmony_ci return ret; 150862306a36Sopenharmony_ci} 150962306a36Sopenharmony_ci#endif 151062306a36Sopenharmony_ci 151162306a36Sopenharmony_cistatic ssize_t uvc_v4l2_read(struct file *file, char __user *data, 151262306a36Sopenharmony_ci size_t count, loff_t *ppos) 151362306a36Sopenharmony_ci{ 151462306a36Sopenharmony_ci struct uvc_fh *handle = file->private_data; 151562306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 151662306a36Sopenharmony_ci 151762306a36Sopenharmony_ci uvc_dbg(stream->dev, CALLS, "%s: not implemented\n", __func__); 151862306a36Sopenharmony_ci return -EINVAL; 151962306a36Sopenharmony_ci} 152062306a36Sopenharmony_ci 152162306a36Sopenharmony_cistatic int uvc_v4l2_mmap(struct file *file, struct vm_area_struct *vma) 152262306a36Sopenharmony_ci{ 152362306a36Sopenharmony_ci struct uvc_fh *handle = file->private_data; 152462306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 152562306a36Sopenharmony_ci 152662306a36Sopenharmony_ci uvc_dbg(stream->dev, CALLS, "%s\n", __func__); 152762306a36Sopenharmony_ci 152862306a36Sopenharmony_ci return uvc_queue_mmap(&stream->queue, vma); 152962306a36Sopenharmony_ci} 153062306a36Sopenharmony_ci 153162306a36Sopenharmony_cistatic __poll_t uvc_v4l2_poll(struct file *file, poll_table *wait) 153262306a36Sopenharmony_ci{ 153362306a36Sopenharmony_ci struct uvc_fh *handle = file->private_data; 153462306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 153562306a36Sopenharmony_ci 153662306a36Sopenharmony_ci uvc_dbg(stream->dev, CALLS, "%s\n", __func__); 153762306a36Sopenharmony_ci 153862306a36Sopenharmony_ci return uvc_queue_poll(&stream->queue, file, wait); 153962306a36Sopenharmony_ci} 154062306a36Sopenharmony_ci 154162306a36Sopenharmony_ci#ifndef CONFIG_MMU 154262306a36Sopenharmony_cistatic unsigned long uvc_v4l2_get_unmapped_area(struct file *file, 154362306a36Sopenharmony_ci unsigned long addr, unsigned long len, unsigned long pgoff, 154462306a36Sopenharmony_ci unsigned long flags) 154562306a36Sopenharmony_ci{ 154662306a36Sopenharmony_ci struct uvc_fh *handle = file->private_data; 154762306a36Sopenharmony_ci struct uvc_streaming *stream = handle->stream; 154862306a36Sopenharmony_ci 154962306a36Sopenharmony_ci uvc_dbg(stream->dev, CALLS, "%s\n", __func__); 155062306a36Sopenharmony_ci 155162306a36Sopenharmony_ci return uvc_queue_get_unmapped_area(&stream->queue, pgoff); 155262306a36Sopenharmony_ci} 155362306a36Sopenharmony_ci#endif 155462306a36Sopenharmony_ci 155562306a36Sopenharmony_ciconst struct v4l2_ioctl_ops uvc_ioctl_ops = { 155662306a36Sopenharmony_ci .vidioc_querycap = uvc_ioctl_querycap, 155762306a36Sopenharmony_ci .vidioc_enum_fmt_vid_cap = uvc_ioctl_enum_fmt_vid_cap, 155862306a36Sopenharmony_ci .vidioc_enum_fmt_vid_out = uvc_ioctl_enum_fmt_vid_out, 155962306a36Sopenharmony_ci .vidioc_g_fmt_vid_cap = uvc_ioctl_g_fmt_vid_cap, 156062306a36Sopenharmony_ci .vidioc_g_fmt_vid_out = uvc_ioctl_g_fmt_vid_out, 156162306a36Sopenharmony_ci .vidioc_s_fmt_vid_cap = uvc_ioctl_s_fmt_vid_cap, 156262306a36Sopenharmony_ci .vidioc_s_fmt_vid_out = uvc_ioctl_s_fmt_vid_out, 156362306a36Sopenharmony_ci .vidioc_try_fmt_vid_cap = uvc_ioctl_try_fmt_vid_cap, 156462306a36Sopenharmony_ci .vidioc_try_fmt_vid_out = uvc_ioctl_try_fmt_vid_out, 156562306a36Sopenharmony_ci .vidioc_reqbufs = uvc_ioctl_reqbufs, 156662306a36Sopenharmony_ci .vidioc_querybuf = uvc_ioctl_querybuf, 156762306a36Sopenharmony_ci .vidioc_qbuf = uvc_ioctl_qbuf, 156862306a36Sopenharmony_ci .vidioc_expbuf = uvc_ioctl_expbuf, 156962306a36Sopenharmony_ci .vidioc_dqbuf = uvc_ioctl_dqbuf, 157062306a36Sopenharmony_ci .vidioc_create_bufs = uvc_ioctl_create_bufs, 157162306a36Sopenharmony_ci .vidioc_streamon = uvc_ioctl_streamon, 157262306a36Sopenharmony_ci .vidioc_streamoff = uvc_ioctl_streamoff, 157362306a36Sopenharmony_ci .vidioc_enum_input = uvc_ioctl_enum_input, 157462306a36Sopenharmony_ci .vidioc_g_input = uvc_ioctl_g_input, 157562306a36Sopenharmony_ci .vidioc_s_input = uvc_ioctl_s_input, 157662306a36Sopenharmony_ci .vidioc_queryctrl = uvc_ioctl_queryctrl, 157762306a36Sopenharmony_ci .vidioc_query_ext_ctrl = uvc_ioctl_query_ext_ctrl, 157862306a36Sopenharmony_ci .vidioc_g_ext_ctrls = uvc_ioctl_g_ext_ctrls, 157962306a36Sopenharmony_ci .vidioc_s_ext_ctrls = uvc_ioctl_s_ext_ctrls, 158062306a36Sopenharmony_ci .vidioc_try_ext_ctrls = uvc_ioctl_try_ext_ctrls, 158162306a36Sopenharmony_ci .vidioc_querymenu = uvc_ioctl_querymenu, 158262306a36Sopenharmony_ci .vidioc_g_selection = uvc_ioctl_g_selection, 158362306a36Sopenharmony_ci .vidioc_g_parm = uvc_ioctl_g_parm, 158462306a36Sopenharmony_ci .vidioc_s_parm = uvc_ioctl_s_parm, 158562306a36Sopenharmony_ci .vidioc_enum_framesizes = uvc_ioctl_enum_framesizes, 158662306a36Sopenharmony_ci .vidioc_enum_frameintervals = uvc_ioctl_enum_frameintervals, 158762306a36Sopenharmony_ci .vidioc_subscribe_event = uvc_ioctl_subscribe_event, 158862306a36Sopenharmony_ci .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 158962306a36Sopenharmony_ci .vidioc_default = uvc_ioctl_default, 159062306a36Sopenharmony_ci}; 159162306a36Sopenharmony_ci 159262306a36Sopenharmony_ciconst struct v4l2_file_operations uvc_fops = { 159362306a36Sopenharmony_ci .owner = THIS_MODULE, 159462306a36Sopenharmony_ci .open = uvc_v4l2_open, 159562306a36Sopenharmony_ci .release = uvc_v4l2_release, 159662306a36Sopenharmony_ci .unlocked_ioctl = video_ioctl2, 159762306a36Sopenharmony_ci#ifdef CONFIG_COMPAT 159862306a36Sopenharmony_ci .compat_ioctl32 = uvc_v4l2_compat_ioctl32, 159962306a36Sopenharmony_ci#endif 160062306a36Sopenharmony_ci .read = uvc_v4l2_read, 160162306a36Sopenharmony_ci .mmap = uvc_v4l2_mmap, 160262306a36Sopenharmony_ci .poll = uvc_v4l2_poll, 160362306a36Sopenharmony_ci#ifndef CONFIG_MMU 160462306a36Sopenharmony_ci .get_unmapped_area = uvc_v4l2_get_unmapped_area, 160562306a36Sopenharmony_ci#endif 160662306a36Sopenharmony_ci}; 160762306a36Sopenharmony_ci 1608