aboutsummaryrefslogtreecommitdiffstats
path: root/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files
diff options
context:
space:
mode:
authorMichele Paolino <m.paolino@virtualopensystems.com>2023-11-14 18:07:09 +0100
committerMichele Paolino <m.paolino@virtualopensystems.com>2023-12-13 10:27:55 +0000
commitb05512b81bbe1c90b71da9c571e742f162fc0575 (patch)
treedea9b67ff4dae3e227943382dd7b0b0565dc39d1 /meta-egvirt/recipes-kernel/kernel-module-virtio-video/files
parent31d4011207be008333c1945f18bb922b13816462 (diff)
CAN, GPIO, RNG vhost-devices for virtio-loopback [v6]quillback_16.92.0quillback/16.92.016.92.0
This patch adds key components of the viritio-loopback architecture: - kernel-module-virtio-loopback: the virtio loopback kernel driver - CAN, GPIO and RNG vhost-user devices from meta-virtualization (commit a215d8320edee0a317a6511e7e2efa5bba867486) Notes: - libgpiod, comes from meta-openembedded commit 3029554ceb0b0bb52a8d8ec3f0a75c5113662fe6 - cleaned eg-virt from unused drivers (kernel-module-virtio-video) Bug-AGL: SPEC-4834 V2 changes: - related meta-virtualization commit message added in the cover letter - updated libgpio recipe to v2.1 - SPEC reference added in cover letter v3 - add vhost-device-can preliminary version. This is placed here with the objective to share the link when proposing the new device to the rust-vmm/vhost-device community - remove cargo-update-recipe-crates includes in bb file because it is not supported by the rust mixin layer - vhost-device folder README changes v4 - fixed libgpiod required version - tested ref hw and qemu x86/64 builds - vsock, scsi and i2c rust devices removed from the build as they are not yet integrated in virtiod-loopback - cleaned-up kernel modules kernel-module-virtio-video and gstreamer1.0-plugins-bad - virtio-loopback-driver set to 2-or-later v5 - Merge with Jan-Simon version v4: - remove broken kernel-module-virtio-video - use FEATURE_PACKAGES instead of IMAGE_INSTALL:append - rename virtio-loopback-driver.bb to kernel-module-virtio-loopback_git.bb for consistency v6 - adding version in the title - removing MODULE_GIT_REPOSITORY in kernel-modules Change-Id: Id6cc58e777b9edad03b6c50d0dddaac8601edeaf Signed-off-by: Michele Paolino <m.paolino@virtualopensystems.com> Signed-off-by: Jan-Simon Moeller <jsmoeller@linuxfoundation.org>
Diffstat (limited to 'meta-egvirt/recipes-kernel/kernel-module-virtio-video/files')
-rw-r--r--meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/Kbuild22
-rw-r--r--meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/Makefile33
-rw-r--r--meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/include/uapi/linux/virtio_video.h493
-rw-r--r--meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video.h446
-rw-r--r--meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_cam.c359
-rw-r--r--meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_caps.c460
-rw-r--r--meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_dec.c424
-rw-r--r--meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_device.c1282
-rw-r--r--meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_driver.c246
-rw-r--r--meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_enc.c601
-rw-r--r--meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_helpers.c289
-rw-r--r--meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_vq.c981
12 files changed, 0 insertions, 5636 deletions
diff --git a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/Kbuild b/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/Kbuild
deleted file mode 100644
index f16a686b..00000000
--- a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/Kbuild
+++ /dev/null
@@ -1,22 +0,0 @@
-#
-# Kbuild for the virtio-video driver
-#
-
-# --tags to take into account non-annotated tags
-# --dirty to mark version with uncommitted changes as dirty
-GIT_VERSION = $(shell git -C "$(MODULE_GIT_REPOSITORY_DIR)" describe --tags --dirty | sed 's/^v//')
-
-ccflags-y := -I"$(src)/include/uapi"
-ccflags-y += -DDRIVER_VERSION=\"$(GIT_VERSION)\"
-
-virtio_video-y := \
- virtio_video_driver.o \
- virtio_video_vq.o \
- virtio_video_device.o \
- virtio_video_dec.o \
- virtio_video_enc.o \
- virtio_video_cam.o \
- virtio_video_caps.o \
- virtio_video_helpers.o
-
-obj-m += virtio_video.o
diff --git a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/Makefile b/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/Makefile
deleted file mode 100644
index e5a34b76..00000000
--- a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/Makefile
+++ /dev/null
@@ -1,33 +0,0 @@
-#
-# Makefile for mod coqos
-#
-KDIR ?= $(KERNEL_SRC)
-ifeq ($(KDIR),)
-$(error "KDIR must be specified.")
-endif
-
-# The variable "M" is used to point to the location of this module, and it is
-# passed to kbuild to build this module.
-#
-# Allow to specify variable "M" from outside. It is needed to set it to the
-# relative path to this module. It must be relative to the kernel source
-# directory.
-#
-# If kernel is built with "O" option then setting "M" to the relative path
-# empowers the build system to put output/object files (.o, .ko.) into a
-# directory different from the module source directory.
-M ?= $$PWD
-
-# Some build systems may rsync module sources out of git repository to have
-# sources directory untouched during build. Then, they should specify Git
-# repository directory separately for 'git describe' to work properly.
-MODULE_GIT_REPOSITORY_DIR ?= $(M)
-
-default:
- $(MAKE) -C $(KDIR) M=$(M) MODULE_GIT_REPOSITORY_DIR=$(MODULE_GIT_REPOSITORY_DIR)
-
-modules_install:
- $(MAKE) -C $(KDIR) M=$(M) $@
-
-clean:
- $(MAKE) -C $(KDIR) M=$(M) $@
diff --git a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/include/uapi/linux/virtio_video.h b/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/include/uapi/linux/virtio_video.h
deleted file mode 100644
index 12792129..00000000
--- a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/include/uapi/linux/virtio_video.h
+++ /dev/null
@@ -1,493 +0,0 @@
-/* SPDX-License-Identifier: GPL-2.0+ */
-/*
- * Virtio Video Device
- *
- * This header is BSD licensed so anyone can use the definitions
- * to implement compatible drivers/servers:
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- * 3. Neither the name of IBM nor the names of its contributors
- * may be used to endorse or promote products derived from this software
- * without specific prior written permission.
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
- * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
- * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
- * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL IBM OR
- * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
- * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
- * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
- * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
- * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
- * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
- * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
- * SUCH DAMAGE.
- *
- * Copyright (C) 2020 OpenSynergy GmbH.
- */
-
-#ifndef _UAPI_LINUX_VIRTIO_VIDEO_H
-#define _UAPI_LINUX_VIRTIO_VIDEO_H
-
-#include <linux/types.h>
-#include <linux/virtio_config.h>
-
-enum virtio_video_device_type {
- VIRTIO_VIDEO_DEVICE_ENCODER = 0x0100,
- VIRTIO_VIDEO_DEVICE_DECODER,
- VIRTIO_VIDEO_DEVICE_CAMERA,
-};
-
-/*
- * Feature bits
- */
-
-/* Guest pages can be used for video buffers. */
-#define VIRTIO_VIDEO_F_RESOURCE_GUEST_PAGES 0
-/*
- * The host can process buffers even if they are non-contiguous memory such as
- * scatter-gather lists.
- */
-#define VIRTIO_VIDEO_F_RESOURCE_NON_CONTIG 1
-
-#define VIRTIO_VIDEO_MAX_PLANES 8
-
-/*
- * Image formats
- */
-
-enum virtio_video_format {
- /* Raw formats */
- VIRTIO_VIDEO_FORMAT_RAW_MIN = 1,
- VIRTIO_VIDEO_FORMAT_ARGB8888 = VIRTIO_VIDEO_FORMAT_RAW_MIN,
- VIRTIO_VIDEO_FORMAT_BGRA8888,
- VIRTIO_VIDEO_FORMAT_RGBA8888,
- VIRTIO_VIDEO_FORMAT_NV12, /* 12 Y/CbCr 4:2:0 */
- VIRTIO_VIDEO_FORMAT_YUV420, /* 12 YUV 4:2:0 */
- VIRTIO_VIDEO_FORMAT_YVU420, /* 12 YVU 4:2:0 */
- VIRTIO_VIDEO_FORMAT_YUV422, /* 16 YUV 4:2:2 */
- VIRTIO_VIDEO_FORMAT_RAW_MAX = VIRTIO_VIDEO_FORMAT_YUV422,
-
- /* Coded formats */
- VIRTIO_VIDEO_FORMAT_CODED_MIN = 0x1000,
- VIRTIO_VIDEO_FORMAT_MPEG2 =
- VIRTIO_VIDEO_FORMAT_CODED_MIN, /* MPEG-2 Part 2 */
- VIRTIO_VIDEO_FORMAT_MPEG4, /* MPEG-4 Part 2 */
- VIRTIO_VIDEO_FORMAT_H264, /* H.264 */
- VIRTIO_VIDEO_FORMAT_HEVC, /* HEVC aka H.265*/
- VIRTIO_VIDEO_FORMAT_VP8, /* VP8 */
- VIRTIO_VIDEO_FORMAT_VP9, /* VP9 */
- VIRTIO_VIDEO_FORMAT_CODED_MAX = VIRTIO_VIDEO_FORMAT_VP9,
-};
-
-enum virtio_video_profile {
- /* H.264 */
- VIRTIO_VIDEO_PROFILE_H264_MIN = 0x100,
- VIRTIO_VIDEO_PROFILE_H264_BASELINE = VIRTIO_VIDEO_PROFILE_H264_MIN,
- VIRTIO_VIDEO_PROFILE_H264_MAIN,
- VIRTIO_VIDEO_PROFILE_H264_EXTENDED,
- VIRTIO_VIDEO_PROFILE_H264_HIGH,
- VIRTIO_VIDEO_PROFILE_H264_HIGH10PROFILE,
- VIRTIO_VIDEO_PROFILE_H264_HIGH422PROFILE,
- VIRTIO_VIDEO_PROFILE_H264_HIGH444PREDICTIVEPROFILE,
- VIRTIO_VIDEO_PROFILE_H264_SCALABLEBASELINE,
- VIRTIO_VIDEO_PROFILE_H264_SCALABLEHIGH,
- VIRTIO_VIDEO_PROFILE_H264_STEREOHIGH,
- VIRTIO_VIDEO_PROFILE_H264_MULTIVIEWHIGH,
- VIRTIO_VIDEO_PROFILE_H264_MAX = VIRTIO_VIDEO_PROFILE_H264_MULTIVIEWHIGH,
-
- /* HEVC */
- VIRTIO_VIDEO_PROFILE_HEVC_MIN = 0x200,
- VIRTIO_VIDEO_PROFILE_HEVC_MAIN = VIRTIO_VIDEO_PROFILE_HEVC_MIN,
- VIRTIO_VIDEO_PROFILE_HEVC_MAIN10,
- VIRTIO_VIDEO_PROFILE_HEVC_MAIN_STILL_PICTURE,
- VIRTIO_VIDEO_PROFILE_HEVC_MAX =
- VIRTIO_VIDEO_PROFILE_HEVC_MAIN_STILL_PICTURE,
-
- /* VP8 */
- VIRTIO_VIDEO_PROFILE_VP8_MIN = 0x300,
- VIRTIO_VIDEO_PROFILE_VP8_PROFILE0 = VIRTIO_VIDEO_PROFILE_VP8_MIN,
- VIRTIO_VIDEO_PROFILE_VP8_PROFILE1,
- VIRTIO_VIDEO_PROFILE_VP8_PROFILE2,
- VIRTIO_VIDEO_PROFILE_VP8_PROFILE3,
- VIRTIO_VIDEO_PROFILE_VP8_MAX = VIRTIO_VIDEO_PROFILE_VP8_PROFILE3,
-
- /* VP9 */
- VIRTIO_VIDEO_PROFILE_VP9_MIN = 0x400,
- VIRTIO_VIDEO_PROFILE_VP9_PROFILE0 = VIRTIO_VIDEO_PROFILE_VP9_MIN,
- VIRTIO_VIDEO_PROFILE_VP9_PROFILE1,
- VIRTIO_VIDEO_PROFILE_VP9_PROFILE2,
- VIRTIO_VIDEO_PROFILE_VP9_PROFILE3,
- VIRTIO_VIDEO_PROFILE_VP9_MAX = VIRTIO_VIDEO_PROFILE_VP9_PROFILE3,
-};
-
-enum virtio_video_level {
- /* H.264 */
- VIRTIO_VIDEO_LEVEL_H264_MIN = 0x100,
- VIRTIO_VIDEO_LEVEL_H264_1_0 = VIRTIO_VIDEO_LEVEL_H264_MIN,
- VIRTIO_VIDEO_LEVEL_H264_1_1,
- VIRTIO_VIDEO_LEVEL_H264_1_2,
- VIRTIO_VIDEO_LEVEL_H264_1_3,
- VIRTIO_VIDEO_LEVEL_H264_2_0,
- VIRTIO_VIDEO_LEVEL_H264_2_1,
- VIRTIO_VIDEO_LEVEL_H264_2_2,
- VIRTIO_VIDEO_LEVEL_H264_3_0,
- VIRTIO_VIDEO_LEVEL_H264_3_1,
- VIRTIO_VIDEO_LEVEL_H264_3_2,
- VIRTIO_VIDEO_LEVEL_H264_4_0,
- VIRTIO_VIDEO_LEVEL_H264_4_1,
- VIRTIO_VIDEO_LEVEL_H264_4_2,
- VIRTIO_VIDEO_LEVEL_H264_5_0,
- VIRTIO_VIDEO_LEVEL_H264_5_1,
- VIRTIO_VIDEO_LEVEL_H264_MAX = VIRTIO_VIDEO_LEVEL_H264_5_1,
-};
-
-/*
- * Config
- */
-
-struct virtio_video_config {
- __le32 version;
- __le32 max_caps_length;
- __le32 max_resp_length;
-};
-
-/*
- * Commands
- */
-
-enum virtio_video_cmd_type {
- /* Command */
- VIRTIO_VIDEO_CMD_QUERY_CAPABILITY = 0x0100,
- VIRTIO_VIDEO_CMD_STREAM_CREATE,
- VIRTIO_VIDEO_CMD_STREAM_DESTROY,
- VIRTIO_VIDEO_CMD_STREAM_DRAIN,
- VIRTIO_VIDEO_CMD_RESOURCE_ATTACH,
- VIRTIO_VIDEO_CMD_RESOURCE_QUEUE,
- VIRTIO_VIDEO_CMD_QUEUE_DETACH_RESOURCES,
- VIRTIO_VIDEO_CMD_QUEUE_CLEAR,
- VIRTIO_VIDEO_CMD_GET_PARAMS,
- VIRTIO_VIDEO_CMD_SET_PARAMS,
- VIRTIO_VIDEO_CMD_QUERY_CONTROL,
- VIRTIO_VIDEO_CMD_GET_CONTROL,
- VIRTIO_VIDEO_CMD_SET_CONTROL,
-
- /* Response */
- VIRTIO_VIDEO_RESP_OK_NODATA = 0x0200,
- VIRTIO_VIDEO_RESP_OK_QUERY_CAPABILITY,
- VIRTIO_VIDEO_RESP_OK_RESOURCE_QUEUE,
- VIRTIO_VIDEO_RESP_OK_GET_PARAMS,
- VIRTIO_VIDEO_RESP_OK_QUERY_CONTROL,
- VIRTIO_VIDEO_RESP_OK_GET_CONTROL,
-
- VIRTIO_VIDEO_RESP_ERR_INVALID_OPERATION = 0x0300,
- VIRTIO_VIDEO_RESP_ERR_OUT_OF_MEMORY,
- VIRTIO_VIDEO_RESP_ERR_INVALID_STREAM_ID,
- VIRTIO_VIDEO_RESP_ERR_INVALID_RESOURCE_ID,
- VIRTIO_VIDEO_RESP_ERR_INVALID_PARAMETER,
- VIRTIO_VIDEO_RESP_ERR_UNSUPPORTED_CONTROL,
-};
-
-struct virtio_video_cmd_hdr {
- __le32 type; /* One of enum virtio_video_cmd_type */
- __le32 stream_id;
-};
-
-/* VIRTIO_VIDEO_CMD_QUERY_CAPABILITY */
-enum virtio_video_queue_type {
- VIRTIO_VIDEO_QUEUE_TYPE_INPUT = 0x100,
- VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT,
-};
-
-struct virtio_video_query_capability {
- struct virtio_video_cmd_hdr hdr;
- __le32 queue_type; /* One of VIRTIO_VIDEO_QUEUE_TYPE_* types */
- __u8 padding[4];
-};
-
-enum virtio_video_planes_layout_flag {
- VIRTIO_VIDEO_PLANES_LAYOUT_SINGLE_BUFFER = 1 << 0,
- VIRTIO_VIDEO_PLANES_LAYOUT_PER_PLANE = 1 << 1,
-};
-
-struct virtio_video_format_range {
- __le32 min;
- __le32 max;
- __le32 step;
- __u8 padding[4];
-};
-
-struct virtio_video_format_frame {
- struct virtio_video_format_range width;
- struct virtio_video_format_range height;
- __le32 num_rates;
- __u8 padding[4];
- /* Followed by struct virtio_video_format_range frame_rates[] */
-};
-
-struct virtio_video_format_desc {
- __le64 mask;
- __le32 format; /* One of VIRTIO_VIDEO_FORMAT_* types */
- __le32 planes_layout; /* Bitmask with VIRTIO_VIDEO_PLANES_LAYOUT_* */
- __le32 plane_align;
- __le32 num_frames;
- /* Followed by struct virtio_video_format_frame frames[] */
-};
-
-struct virtio_video_query_capability_resp {
- struct virtio_video_cmd_hdr hdr;
- __le32 num_descs;
- __u8 padding[4];
- /* Followed by struct virtio_video_format_desc descs[] */
-};
-
-/* VIRTIO_VIDEO_CMD_STREAM_CREATE */
-enum virtio_video_mem_type {
- VIRTIO_VIDEO_MEM_TYPE_GUEST_PAGES,
-};
-
-struct virtio_video_stream_create {
- struct virtio_video_cmd_hdr hdr;
- __le32 in_mem_type; /* One of VIRTIO_VIDEO_MEM_TYPE_* types */
- __le32 out_mem_type; /* One of VIRTIO_VIDEO_MEM_TYPE_* types */
- __le32 coded_format; /* One of VIRTIO_VIDEO_FORMAT_* types */
- __u8 padding[4];
- __u8 tag[64];
-};
-
-/* VIRTIO_VIDEO_CMD_STREAM_DESTROY */
-struct virtio_video_stream_destroy {
- struct virtio_video_cmd_hdr hdr;
-};
-
-/* VIRTIO_VIDEO_CMD_STREAM_DRAIN */
-struct virtio_video_stream_drain {
- struct virtio_video_cmd_hdr hdr;
-};
-
-/* VIRTIO_VIDEO_CMD_RESOURCE_ATTACH */
-struct virtio_video_resource_object {
- __u8 uuid [16];
-};
-
-struct virtio_video_resource_sg_entry {
- __le64 addr;
- __le32 length;
- __u8 padding[4];
-};
-
-struct virtio_video_resource_sg_list {
- __le32 num_entries;
- __u8 padding[4];
- struct virtio_video_resource_sg_entry entries[];
-};
-#define VIRTIO_VIDEO_RESOURCE_SG_SIZE(n) \
- offsetof(struct virtio_video_resource_sg_list, entries[n])
-
-union virtio_video_resource {
- struct virtio_video_resource_sg_list sg_list;
- struct virtio_video_resource_object object;
-};
-
-struct virtio_video_resource_attach {
- __le32 cmd_type;
- __le32 stream_id;
- __le32 queue_type; /* VIRTIO_VIDEO_QUEUE_TYPE_* */
- __le32 resource_id;
- /* Followed by struct virtio_video_resource resources[] */
-};
-
-/* VIRTIO_VIDEO_CMD_RESOURCE_QUEUE */
-struct virtio_video_resource_queue {
- __le32 cmd_type;
- __le32 stream_id;
- __le32 queue_type; /* VIRTIO_VIDEO_QUEUE_TYPE_* */
- __le32 resource_id;
- __le32 flags; /* Bitmask with VIRTIO_VIDEO_ENQUEUE_FLAG_ * */
- __u8 padding[4];
- __le64 timestamp;
- __le32 data_sizes[VIRTIO_VIDEO_MAX_PLANES];
-};
-
-enum virtio_video_dequeue_flag {
- VIRTIO_VIDEO_DEQUEUE_FLAG_ERR = 0,
- VIRTIO_VIDEO_DEQUEUE_FLAG_EOS,
-
- /* Encoder only */
- VIRTIO_VIDEO_DEQUEUE_FLAG_KEY_FRAME,
- VIRTIO_VIDEO_DEQUEUE_FLAG_PFRAME,
- VIRTIO_VIDEO_DEQUEUE_FLAG_BFRAME,
-};
-
-struct virtio_video_resource_queue_resp {
- struct virtio_video_cmd_hdr hdr;
- __le32 flags;
- __le64 timestamp;
- __le32 data_sizes[VIRTIO_VIDEO_MAX_PLANES];
-};
-
-/* VIRTIO_VIDEO_CMD_QUEUE_DETACH_RESOURCES */
-struct virtio_video_queue_detach_resources {
- __le32 cmd_type;
- __le32 stream_id;
- __le32 queue_type; /* One of VIRTIO_VIDEO_QUEUE_TYPE_* types */
- __u8 padding[4];
-};
-
-/* VIRTIO_VIDEO_CMD_QUEUE_CLEAR */
-struct virtio_video_queue_clear {
- struct virtio_video_cmd_hdr hdr;
- __le32 queue_type; /* One of VIRTIO_VIDEO_QUEUE_TYPE_* types */
- __u8 padding[4];
-};
-
-/* VIRTIO_VIDEO_CMD_GET_PARAMS */
-struct virtio_video_plane_format {
- __le32 plane_size;
- __le32 stride;
-};
-
-struct virtio_video_crop {
- __le32 left;
- __le32 top;
- __le32 width;
- __le32 height;
-};
-
-struct virtio_video_params {
- __le32 queue_type; /* One of VIRTIO_VIDEO_QUEUE_TYPE_* types */
- __le32 format; /* One of VIRTIO_VIDEO_FORMAT_* types */
- __le32 frame_width;
- __le32 frame_height;
- __le32 min_buffers;
- __le32 max_buffers;
- struct virtio_video_crop crop;
- __le32 frame_rate;
- __le32 num_planes;
- struct virtio_video_plane_format plane_formats[VIRTIO_VIDEO_MAX_PLANES];
-};
-
-struct virtio_video_get_params {
- struct virtio_video_cmd_hdr hdr;
- __le32 queue_type; /* One of VIRTIO_VIDEO_QUEUE_TYPE_* types */
- __u8 padding[4];
-};
-
-struct virtio_video_get_params_resp {
- struct virtio_video_cmd_hdr hdr;
- struct virtio_video_params params;
-};
-
-/* VIRTIO_VIDEO_CMD_SET_PARAMS */
-struct virtio_video_set_params {
- struct virtio_video_cmd_hdr hdr;
- struct virtio_video_params params;
-};
-
-/* VIRTIO_VIDEO_CMD_QUERY_CONTROL */
-enum virtio_video_control_type {
- VIRTIO_VIDEO_CONTROL_BITRATE = 1,
- VIRTIO_VIDEO_CONTROL_PROFILE,
- VIRTIO_VIDEO_CONTROL_LEVEL,
-};
-
-struct virtio_video_query_control_profile {
- __le32 format; /* One of VIRTIO_VIDEO_FORMAT_* */
- __u8 padding[4];
-};
-
-struct virtio_video_query_control_level {
- __le32 format; /* One of VIRTIO_VIDEO_FORMAT_* */
- __u8 padding[4];
-};
-
-struct virtio_video_query_control {
- struct virtio_video_cmd_hdr hdr;
- __le32 control; /* One of VIRTIO_VIDEO_CONTROL_* types */
- __u8 padding[4];
- /*
- * Followed by a value of struct virtio_video_query_control_*
- * in accordance with the value of control.
- */
-};
-
-struct virtio_video_query_control_resp_profile {
- __le32 num;
- __u8 padding[4];
- /* Followed by an array le32 profiles[] */
-};
-
-struct virtio_video_query_control_resp_level {
- __le32 num;
- __u8 padding[4];
- /* Followed by an array le32 level[] */
-};
-
-struct virtio_video_query_control_resp {
- struct virtio_video_cmd_hdr hdr;
- /* Followed by one of struct virtio_video_query_control_resp_* */
-};
-
-/* VIRTIO_VIDEO_CMD_GET_CONTROL */
-struct virtio_video_get_control {
- struct virtio_video_cmd_hdr hdr;
- __le32 control; /* One of VIRTIO_VIDEO_CONTROL_* types */
- __u8 padding[4];
-};
-
-struct virtio_video_control_val_bitrate {
- __le32 bitrate;
- __u8 padding[4];
-};
-
-struct virtio_video_control_val_profile {
- __le32 profile;
- __u8 padding[4];
-};
-
-struct virtio_video_control_val_level {
- __le32 level;
- __u8 padding[4];
-};
-
-struct virtio_video_get_control_resp {
- struct virtio_video_cmd_hdr hdr;
- /* Followed by one of struct virtio_video_control_val_* */
-};
-
-/* VIRTIO_VIDEO_CMD_SET_CONTROL */
-struct virtio_video_set_control {
- struct virtio_video_cmd_hdr hdr;
- __le32 control; /* One of VIRTIO_VIDEO_CONTROL_* types */
- __u8 padding[4];
- /* Followed by one of struct virtio_video_control_val_* */
-};
-
-struct virtio_video_set_control_resp {
- struct virtio_video_cmd_hdr hdr;
-};
-
-/*
- * Events
- */
-
-enum virtio_video_event_type {
- /* For all devices */
- VIRTIO_VIDEO_EVENT_ERROR = 0x0100,
-
- /* For decoder only */
- VIRTIO_VIDEO_EVENT_DECODER_RESOLUTION_CHANGED = 0x0200,
-};
-
-struct virtio_video_event {
- __le32 event_type; /* One of VIRTIO_VIDEO_EVENT_* types */
- __le32 stream_id;
-};
-
-#endif /* _UAPI_LINUX_VIRTIO_VIDEO_H */
diff --git a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video.h b/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video.h
deleted file mode 100644
index 9ece57db..00000000
--- a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video.h
+++ /dev/null
@@ -1,446 +0,0 @@
-/* SPDX-License-Identifier: GPL-2.0+ */
-/* Common header for virtio video driver.
- *
- * Copyright 2020 OpenSynergy GmbH.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, see <http://www.gnu.org/licenses/>.
- */
-
-#ifndef _VIRTIO_VIDEO_H
-#define _VIRTIO_VIDEO_H
-
-#include <linux/virtio.h>
-#include <linux/virtio_ids.h>
-#include <linux/virtio_config.h>
-#include <linux/virtio_video.h>
-#include <linux/list.h>
-#include <linux/completion.h>
-#include <media/v4l2-device.h>
-#include <media/v4l2-mem2mem.h>
-#include <media/v4l2-ctrls.h>
-#include <media/videobuf2-dma-sg.h>
-#include <media/videobuf2-dma-contig.h>
-
-#define DRIVER_NAME "virtio-video"
-
-#define VIRTIO_ID_VIDEO_DEC 31
-#define VIRTIO_ID_VIDEO_ENC 30
-#define VIRTIO_ID_VIDEO_CAM 100
-
-#define MIN_BUFS_MIN 0
-#define MIN_BUFS_MAX VIDEO_MAX_FRAME
-#define MIN_BUFS_STEP 1
-#define MIN_BUFS_DEF 1
-
-struct video_format_frame {
- struct virtio_video_format_frame frame;
- struct virtio_video_format_range *frame_rates;
-};
-
-struct video_format {
- struct list_head formats_list_entry;
- struct virtio_video_format_desc desc;
- struct video_format_frame *frames;
-};
-
-struct video_control_fmt_data {
- uint32_t min;
- uint32_t max;
- uint32_t num;
- uint32_t skip_mask;
- uint32_t *entries;
-};
-
-struct video_control_format {
- struct list_head controls_list_entry;
- uint32_t format;
- struct video_control_fmt_data *profile;
- struct video_control_fmt_data *level;
-};
-
-struct video_plane_format {
- uint32_t plane_size;
- uint32_t stride;
-};
-
-struct video_format_info {
- uint32_t fourcc_format;
- uint32_t frame_rate;
- uint32_t frame_width;
- uint32_t frame_height;
- uint32_t min_buffers;
- uint32_t max_buffers;
- struct virtio_video_crop crop;
- uint32_t num_planes;
- struct video_plane_format plane_format[VIRTIO_VIDEO_MAX_PLANES];
-};
-
-struct video_control_info {
- uint32_t profile;
- uint32_t level;
- uint32_t bitrate;
-};
-
-struct virtio_video_device;
-struct virtio_video_vbuffer;
-
-typedef void (*virtio_video_resp_cb)(struct virtio_video_device *vvd,
- struct virtio_video_vbuffer *vbuf);
-
-struct virtio_video_vbuffer {
- char *buf;
- int size;
- uint32_t id;
-
- void *data_buf;
- uint32_t data_size;
-
- char *resp_buf;
- int resp_size;
-
- void *priv;
- virtio_video_resp_cb resp_cb;
-
- bool is_sync;
- struct completion reclaimed;
-
- struct list_head pending_list_entry;
-};
-
-struct virtio_video_cmd_queue {
- struct virtqueue *vq;
- bool ready;
- spinlock_t qlock;
- wait_queue_head_t reclaim_queue;
-};
-
-struct virtio_video_event_queue {
- struct virtqueue *vq;
- bool ready;
- struct work_struct work;
-};
-
-enum video_stream_state {
- STREAM_STATE_IDLE = 0,
- STREAM_STATE_INIT,
- STREAM_STATE_DYNAMIC_RES_CHANGE, /* specific to decoder */
- STREAM_STATE_RUNNING,
- STREAM_STATE_DRAIN,
- STREAM_STATE_STOPPED,
- STREAM_STATE_RESET, /* specific to encoder */
- STREAM_STATE_ERROR,
-};
-
-struct virtio_video_stream {
- uint32_t stream_id;
- atomic_t state;
- struct video_device *video_dev;
- struct v4l2_fh fh;
- struct mutex vq_mutex;
- struct v4l2_ctrl_handler ctrl_handler;
- struct video_format_info in_info;
- struct video_format_info out_info;
- struct video_control_info control;
- struct video_format_frame *current_frame;
-};
-
-struct virtio_video_device {
- struct virtio_device *vdev;
- struct virtio_video_cmd_queue commandq;
- struct virtio_video_event_queue eventq;
- wait_queue_head_t wq;
-
- struct kmem_cache *vbufs;
- struct virtio_video_event *evts;
-
- struct idr resource_idr;
- spinlock_t resource_idr_lock;
- struct idr stream_idr;
- spinlock_t stream_idr_lock;
-
- uint32_t max_caps_len;
- uint32_t max_resp_len;
-
- bool has_iommu;
- bool supp_non_contig;
-
- int debug;
- int use_dma_mem;
-
- struct v4l2_device v4l2_dev;
- struct video_device video_dev;
- struct mutex video_dev_mutex;
-
- bool is_m2m_dev;
- struct v4l2_m2m_dev *m2m_dev;
-
- /* non-m2m queue (camera) */
- struct vb2_queue vb2_output_queue;
- struct list_head pending_buf_list;
- spinlock_t pending_buf_list_lock;
-
- uint32_t vbufs_sent;
- struct list_head pending_vbuf_list;
-
- /* device_busy - to block multiple opens for non-m2m (camera) */
- bool device_busy;
-
- /* vid_dev_nr - try register starting at video device number */
- int vid_dev_nr;
-
- /* is_mplane_cam - camera has multiplanar capabilities (default true) */
- bool is_mplane_cam;
-
- /* VIRTIO_VIDEO_FUNC_ */
- uint32_t type;
-
- uint32_t num_input_fmts;
- struct list_head input_fmt_list;
-
- uint32_t num_output_fmts;
- struct list_head output_fmt_list;
-
- struct list_head controls_fmt_list;
- struct virtio_video_device_ops *ops;
-};
-
-struct virtio_video_device_ops {
- int (*init_ctrls)(struct virtio_video_stream *stream);
- int (*init_queues)(void *priv, struct vb2_queue *src_vq,
- struct vb2_queue *dst_vq);
- void* (*get_fmt_list)(struct virtio_video_device *vvd);
-};
-
-struct virtio_video_buffer {
- struct v4l2_m2m_buffer v4l2_m2m_vb;
- uint32_t resource_id;
- bool queued;
- struct list_head list;
-};
-
-static inline gfp_t
-virtio_video_gfp_flags(struct virtio_video_device *vvd)
-{
- if (vvd->use_dma_mem)
- return GFP_DMA;
- else
- return 0;
-}
-
-static inline const struct vb2_mem_ops *
-virtio_video_mem_ops(struct virtio_video_device *vvd)
-{
- if (vvd->supp_non_contig)
- return &vb2_dma_sg_memops;
- else
- return &vb2_dma_contig_memops;
-}
-
-static inline struct virtio_video_device *
-to_virtio_vd(struct video_device *video_dev)
-{
- return container_of(video_dev, struct virtio_video_device,
- video_dev);
-}
-
-static inline struct virtio_video_stream *file2stream(struct file *file)
-{
- return container_of(file->private_data, struct virtio_video_stream, fh);
-}
-
-static inline struct virtio_video_stream *ctrl2stream(struct v4l2_ctrl *ctrl)
-{
- return container_of(ctrl->handler, struct virtio_video_stream,
- ctrl_handler);
-}
-
-static inline struct virtio_video_buffer *to_virtio_vb(struct vb2_buffer *vb)
-{
- struct vb2_v4l2_buffer *v4l2_vb = to_vb2_v4l2_buffer(vb);
-
- return container_of(v4l2_vb, struct virtio_video_buffer,
- v4l2_m2m_vb.vb);
-}
-
-static inline enum virtio_video_queue_type
-to_virtio_queue_type(enum v4l2_buf_type type)
-{
- if (V4L2_TYPE_IS_OUTPUT(type))
- return VIRTIO_VIDEO_QUEUE_TYPE_INPUT;
- else
- return VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT;
-}
-
-static inline bool within_range(uint32_t min, uint32_t val, uint32_t max)
-{
- return ((min <= val) && (val <= max));
-}
-
-static inline bool needs_alignment(uint32_t val, uint32_t a)
-{
- if (a == 0 || IS_ALIGNED(val, a))
- return false;
-
- return true;
-}
-
-enum video_stream_state virtio_video_state(struct virtio_video_stream *stream);
-void virtio_video_state_reset(struct virtio_video_stream *stream);
-void virtio_video_state_update(struct virtio_video_stream *stream,
- enum video_stream_state new_state);
-
-int virtio_video_alloc_vbufs(struct virtio_video_device *vvd);
-void virtio_video_free_vbufs(struct virtio_video_device *vvd);
-int virtio_video_alloc_events(struct virtio_video_device *vvd);
-
-int virtio_video_device_init(struct virtio_video_device *vvd);
-void virtio_video_device_deinit(struct virtio_video_device *vvd);
-
-int virtio_video_dec_init(struct virtio_video_device *vvd);
-int virtio_video_enc_init(struct virtio_video_device *vvd);
-int virtio_video_cam_init(struct virtio_video_device *vvd);
-
-void virtio_video_stream_id_get(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- uint32_t *id);
-void virtio_video_stream_id_put(struct virtio_video_device *vvd, uint32_t id);
-void virtio_video_resource_id_get(struct virtio_video_device *vvd,
- uint32_t *id);
-void virtio_video_resource_id_put(struct virtio_video_device *vvd, uint32_t id);
-
-int virtio_video_cmd_stream_create(struct virtio_video_device *vvd,
- uint32_t stream_id,
- enum virtio_video_format format,
- const char *tag);
-int virtio_video_cmd_stream_destroy(struct virtio_video_device *vvd,
- uint32_t stream_id);
-int virtio_video_cmd_stream_drain(struct virtio_video_device *vvd,
- uint32_t stream_id);
-int virtio_video_cmd_resource_attach(struct virtio_video_device *vvd,
- uint32_t stream_id, uint32_t resource_id,
- enum virtio_video_queue_type queue_type,
- void *buf, size_t buf_size);
-int virtio_video_cmd_resource_queue(struct virtio_video_device *vvd,
- uint32_t stream_id,
- struct virtio_video_buffer *virtio_vb,
- uint32_t data_size[], uint8_t num_data_size,
- enum virtio_video_queue_type queue_type);
-int virtio_video_cmd_queue_detach_resources(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- enum virtio_video_queue_type queue_type);
-int virtio_video_cmd_queue_clear(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- enum virtio_video_queue_type queue_type);
-int virtio_video_cmd_query_capability(struct virtio_video_device *vvd,
- void *resp_buf, size_t resp_size,
- enum virtio_video_queue_type queue_type);
-int virtio_video_query_control_profile(struct virtio_video_device *vvd,
- void *resp_buf, size_t resp_size,
- enum virtio_video_format format);
-int virtio_video_query_control_level(struct virtio_video_device *vvd,
- void *resp_buf, size_t resp_size,
- enum virtio_video_format format);
-int virtio_video_cmd_set_params(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- struct video_format_info *format_info,
- enum virtio_video_queue_type queue_type);
-int virtio_video_cmd_get_params(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- enum virtio_video_queue_type queue_type);
-int virtio_video_cmd_set_control(struct virtio_video_device *vvd,
- uint32_t stream_id,
- enum virtio_video_control_type control,
- uint32_t value);
-int virtio_video_cmd_get_control(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- enum virtio_video_control_type control);
-
-void virtio_video_queue_res_chg_event(struct virtio_video_stream *stream);
-void virtio_video_queue_eos_event(struct virtio_video_stream *stream);
-void virtio_video_handle_error(struct virtio_video_stream *stream);
-int virtio_video_queue_release_buffers(struct virtio_video_stream *stream,
- enum virtio_video_queue_type queue_type);
-
-void virtio_video_cmd_cb(struct virtqueue *vq);
-void virtio_video_event_cb(struct virtqueue *vq);
-void virtio_video_process_events(struct work_struct *work);
-
-void virtio_video_buf_done(struct virtio_video_buffer *virtio_vb,
- uint32_t flags, uint64_t timestamp,
- uint32_t data_sizes[]);
-int virtio_video_buf_plane_init(uint32_t idx,uint32_t resource_id,
- struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- struct vb2_buffer *vb);
-int virtio_video_queue_setup(struct vb2_queue *vq, unsigned int *num_buffers,
- unsigned int *num_planes, unsigned int sizes[],
- struct device *alloc_devs[]);
-int virtio_video_buf_init(struct vb2_buffer *vb);
-void virtio_video_buf_cleanup(struct vb2_buffer *vb);
-void virtio_video_buf_queue(struct vb2_buffer *vb);
-int virtio_video_qbuf(struct file *file, void *priv,
- struct v4l2_buffer *buf);
-int virtio_video_dqbuf(struct file *file, void *priv,
- struct v4l2_buffer *buf);
-int virtio_video_querycap(struct file *file, void *fh,
- struct v4l2_capability *cap);
-int virtio_video_enum_framesizes(struct file *file, void *fh,
- struct v4l2_frmsizeenum *f);
-int virtio_video_enum_framemintervals(struct file *file, void *fh,
- struct v4l2_frmivalenum *f);
-int virtio_video_g_fmt(struct file *file, void *fh, struct v4l2_format *f);
-int virtio_video_s_fmt(struct file *file, void *fh, struct v4l2_format *f);
-int virtio_video_try_fmt(struct virtio_video_stream *stream,
- struct v4l2_format *f);
-int virtio_video_reqbufs(struct file *file, void *priv,
- struct v4l2_requestbuffers *rb);
-int virtio_video_subscribe_event(struct v4l2_fh *fh,
- const struct v4l2_event_subscription *sub);
-
-void virtio_video_free_caps_list(struct list_head *caps_list);
-int virtio_video_parse_virtio_capabilities(struct virtio_video_device *vvd,
- void *input_buf, void *output_buf);
-void virtio_video_clean_capability(struct virtio_video_device *vvd);
-int virtio_video_parse_virtio_control(struct virtio_video_device *vvd);
-void virtio_video_clean_control(struct virtio_video_device *vvd);
-
-uint32_t virtio_video_format_to_v4l2(uint32_t format);
-uint32_t virtio_video_control_to_v4l2(uint32_t control);
-uint32_t virtio_video_profile_to_v4l2(uint32_t profile);
-uint32_t virtio_video_level_to_v4l2(uint32_t level);
-uint32_t virtio_video_v4l2_format_to_virtio(uint32_t v4l2_format);
-uint32_t virtio_video_v4l2_control_to_virtio(uint32_t v4l2_control);
-uint32_t virtio_video_v4l2_profile_to_virtio(uint32_t v4l2_profile);
-uint32_t virtio_video_v4l2_level_to_virtio(uint32_t v4l2_level);
-
-struct video_format *virtio_video_find_video_format(struct list_head *fmts_list,
- uint32_t fourcc);
-void virtio_video_format_from_info(struct video_format_info *info,
- struct v4l2_pix_format_mplane *pix_mp);
-void virtio_video_format_fill_default_info(struct video_format_info *dst_info,
- struct video_format_info *src_info);
-void virtio_video_pix_fmt_sp2mp(const struct v4l2_pix_format *pix,
- struct v4l2_pix_format_mplane *pix_mp);
-void virtio_video_pix_fmt_mp2sp(const struct v4l2_pix_format_mplane *pix_mp,
- struct v4l2_pix_format *pix);
-
-int virtio_video_g_selection(struct file *file, void *fh,
- struct v4l2_selection *sel);
-
-int virtio_video_stream_get_params(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream);
-int virtio_video_stream_get_controls(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream);
-
-#endif /* _VIRTIO_VIDEO_H */
diff --git a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_cam.c b/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_cam.c
deleted file mode 100644
index d657ba8a..00000000
--- a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_cam.c
+++ /dev/null
@@ -1,359 +0,0 @@
-// SPDX-License-Identifier: GPL-2.0+
-/* Capture for virtio video device.
- *
- * Copyright 2021 OpenSynergy GmbH.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, see <http://www.gnu.org/licenses/>.
- */
-
-#include <linux/version.h>
-#include <media/v4l2-event.h>
-#include <media/v4l2-ioctl.h>
-
-#include "virtio_video.h"
-
-static int virtio_video_cam_start_streaming(struct vb2_queue *vq,
- unsigned int count)
-{
- struct virtio_video_stream *stream = vb2_get_drv_priv(vq);
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (virtio_video_state(stream) >= STREAM_STATE_INIT)
- virtio_video_state_update(stream, STREAM_STATE_RUNNING);
-
- return 0;
-}
-
-static void virtio_video_cam_stop_streaming(struct vb2_queue *vq)
-{
- struct virtio_video_stream *stream = vb2_get_drv_priv(vq);
-
- virtio_video_queue_release_buffers(stream,
- VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT);
-
- vb2_wait_for_all_buffers(vq);
-}
-
-static const struct vb2_ops virtio_video_cam_qops = {
- .queue_setup = virtio_video_queue_setup,
- .buf_init = virtio_video_buf_init,
- .buf_cleanup = virtio_video_buf_cleanup,
- .buf_queue = virtio_video_buf_queue,
- .start_streaming = virtio_video_cam_start_streaming,
- .stop_streaming = virtio_video_cam_stop_streaming,
- .wait_prepare = vb2_ops_wait_prepare,
- .wait_finish = vb2_ops_wait_finish,
-};
-
-static int virtio_video_cam_g_ctrl(struct v4l2_ctrl *ctrl)
-{
- int ret = 0;
- struct virtio_video_stream *stream = ctrl2stream(ctrl);
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- switch (ctrl->id) {
- case V4L2_CID_MIN_BUFFERS_FOR_CAPTURE:
- if (virtio_video_state(stream) >=
- STREAM_STATE_DYNAMIC_RES_CHANGE)
- ctrl->val = stream->out_info.min_buffers;
- else
- ctrl->val = 0;
- break;
- default:
- ret = -EINVAL;
- break;
- }
-
- return ret;
-}
-
-static const struct v4l2_ctrl_ops virtio_video_cam_ctrl_ops = {
- .g_volatile_ctrl = virtio_video_cam_g_ctrl,
-};
-
-int virtio_video_cam_init_ctrls(struct virtio_video_stream *stream)
-{
- struct v4l2_ctrl *ctrl;
-
- v4l2_ctrl_handler_init(&stream->ctrl_handler, 2);
-
- ctrl = v4l2_ctrl_new_std(&stream->ctrl_handler,
- &virtio_video_cam_ctrl_ops,
- V4L2_CID_MIN_BUFFERS_FOR_CAPTURE,
- MIN_BUFS_MIN, MIN_BUFS_MAX, MIN_BUFS_STEP,
- MIN_BUFS_DEF);
-
- if (ctrl)
- ctrl->flags |= V4L2_CTRL_FLAG_VOLATILE;
-
- if (stream->ctrl_handler.error)
- return stream->ctrl_handler.error;
-
- v4l2_ctrl_handler_setup(&stream->ctrl_handler);
-
- return 0;
-}
-
-int virtio_video_cam_init_queues(void *priv, struct vb2_queue *src_vq,
- struct vb2_queue *dst_vq)
-{
- struct virtio_video_stream *stream = priv;
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct device *dev = vvd->v4l2_dev.dev;
- int vq_type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
-
- if (!vvd->is_mplane_cam)
- vq_type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
-
- dst_vq->type = vq_type;
- dst_vq->io_modes = VB2_MMAP | VB2_DMABUF;
- dst_vq->drv_priv = stream;
- dst_vq->buf_struct_size = sizeof(struct virtio_video_buffer);
- dst_vq->ops = &virtio_video_cam_qops;
- dst_vq->mem_ops = virtio_video_mem_ops(vvd);
- dst_vq->min_buffers_needed = stream->out_info.min_buffers;
- dst_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC;
- dst_vq->lock = &stream->vq_mutex;
- dst_vq->gfp_flags = virtio_video_gfp_flags(vvd);
- dst_vq->dev = dev;
-
- return vb2_queue_init(dst_vq);
-}
-
-int virtio_video_cam_try_fmt(struct file *file, void *fh, struct v4l2_format *f)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct v4l2_format *fmt_try = f;
- struct v4l2_format fmt_mp = { 0 };
- int ret;
-
- if (!vvd->is_mplane_cam) {
- if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
-
- fmt_mp.type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
- fmt_try = &fmt_mp;
-
- virtio_video_pix_fmt_sp2mp(&f->fmt.pix, &fmt_try->fmt.pix_mp);
- }
-
- ret = virtio_video_try_fmt(stream, fmt_try);
- if (ret)
- return ret;
-
- if (!vvd->is_mplane_cam) {
- if (fmt_try->fmt.pix_mp.num_planes != 1)
- return -EINVAL;
-
- virtio_video_pix_fmt_mp2sp(&fmt_try->fmt.pix_mp, &f->fmt.pix);
- }
-
- return 0;
-}
-
-static int virtio_video_cam_enum_fmt_vid_cap(struct file *file, void *fh,
- struct v4l2_fmtdesc *f)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct video_format *fmt;
- int idx = 0;
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
- f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
- return -EINVAL;
-
- if (f->index >= vvd->num_output_fmts)
- return -EINVAL;
-
- list_for_each_entry(fmt, &vvd->output_fmt_list, formats_list_entry) {
- if (f->index == idx) {
- f->pixelformat = fmt->desc.format;
- return 0;
- }
- idx++;
- }
- return -EINVAL;
-}
-
-static int virtio_video_cam_g_fmt(struct file *file, void *fh,
- struct v4l2_format *f)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct v4l2_format fmt_mp = { 0 };
- struct v4l2_format *fmt_get = f;
- int ret;
-
- if (!vvd->is_mplane_cam) {
- fmt_mp.type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
- fmt_get = &fmt_mp;
- }
-
- ret = virtio_video_g_fmt(file, fh, fmt_get);
- if (ret)
- return ret;
-
- if (virtio_video_state(stream) == STREAM_STATE_IDLE)
- virtio_video_state_update(stream, STREAM_STATE_INIT);
-
- if (!vvd->is_mplane_cam) {
- if (fmt_get->fmt.pix_mp.num_planes != 1)
- return -EINVAL;
-
- virtio_video_pix_fmt_mp2sp(&fmt_get->fmt.pix_mp, &f->fmt.pix);
- }
-
- return 0;
-}
-
-static int virtio_video_cam_s_fmt(struct file *file, void *fh,
- struct v4l2_format *f)
-{
- int ret;
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct v4l2_format fmt_mp = { 0 };
- struct v4l2_format *fmt_set = f;
-
- if (!vvd->is_mplane_cam) {
- if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
-
- fmt_mp.type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
- fmt_set = &fmt_mp;
-
- virtio_video_pix_fmt_sp2mp(&f->fmt.pix, &fmt_set->fmt.pix_mp);
- }
-
- ret = virtio_video_s_fmt(file, fh, fmt_set);
- if (ret)
- return ret;
-
- if (virtio_video_state(stream) == STREAM_STATE_IDLE)
- virtio_video_state_update(stream, STREAM_STATE_INIT);
-
- if (!vvd->is_mplane_cam) {
- if (fmt_set->fmt.pix_mp.num_planes != 1)
- return -EINVAL;
-
- virtio_video_pix_fmt_mp2sp(&fmt_set->fmt.pix_mp, &f->fmt.pix);
- }
-
- return 0;
-}
-
-static int virtio_video_cam_s_selection(struct file *file, void *fh,
- struct v4l2_selection *sel)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- int ret;
-
- if (V4L2_TYPE_IS_OUTPUT(sel->type))
- return -EINVAL;
-
- switch (sel->target) {
- case V4L2_SEL_TGT_CROP:
- stream->out_info.crop.top = sel->r.top;
- stream->out_info.crop.left = sel->r.left;
- stream->out_info.crop.width = sel->r.width;
- stream->out_info.crop.height = sel->r.height;
- v4l2_info(&vvd->v4l2_dev,
- "Set : top:%d, left:%d, w:%d, h:%d\n",
- sel->r.top, sel->r.left, sel->r.width, sel->r.height);
- break;
- default:
- return -EINVAL;
- }
-
- ret = virtio_video_cmd_set_params(vvd, stream, &stream->out_info,
- VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT);
- if (ret)
- return -EINVAL;
-
- ret = virtio_video_cmd_get_params(vvd, stream,
- VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT);
- return ret;
-}
-
-static const struct v4l2_ioctl_ops virtio_video_cam_ioctl_ops = {
- .vidioc_querycap = virtio_video_querycap,
-
-#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 3, 0))
- .vidioc_enum_fmt_vid_cap_mplane = virtio_video_cam_enum_fmt_vid_cap,
-#endif
- .vidioc_try_fmt_vid_cap_mplane = virtio_video_cam_try_fmt,
- .vidioc_g_fmt_vid_cap_mplane = virtio_video_cam_g_fmt,
- .vidioc_s_fmt_vid_cap_mplane = virtio_video_cam_s_fmt,
-
- .vidioc_enum_fmt_vid_cap = virtio_video_cam_enum_fmt_vid_cap,
- .vidioc_try_fmt_vid_cap = virtio_video_cam_try_fmt,
- .vidioc_g_fmt_vid_cap = virtio_video_cam_g_fmt,
- .vidioc_s_fmt_vid_cap = virtio_video_cam_s_fmt,
-
- .vidioc_g_selection = virtio_video_g_selection,
- .vidioc_s_selection = virtio_video_cam_s_selection,
-
- .vidioc_enum_frameintervals = virtio_video_enum_framemintervals,
- .vidioc_enum_framesizes = virtio_video_enum_framesizes,
-
- .vidioc_reqbufs = virtio_video_reqbufs,
- .vidioc_querybuf = vb2_ioctl_querybuf,
- .vidioc_qbuf = virtio_video_qbuf,
- .vidioc_dqbuf = virtio_video_dqbuf,
- .vidioc_prepare_buf = vb2_ioctl_prepare_buf,
- .vidioc_create_bufs = vb2_ioctl_create_bufs,
- .vidioc_expbuf = vb2_ioctl_expbuf,
-
- .vidioc_streamon = vb2_ioctl_streamon,
- .vidioc_streamoff = vb2_ioctl_streamoff,
-
- .vidioc_subscribe_event = virtio_video_subscribe_event,
- .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
-};
-
-void *virtio_video_cam_get_fmt_list(struct virtio_video_device *vvd)
-{
- return &vvd->output_fmt_list;
-}
-
-static struct virtio_video_device_ops virtio_video_cam_ops = {
- .init_ctrls = virtio_video_cam_init_ctrls,
- .init_queues = virtio_video_cam_init_queues,
- .get_fmt_list = virtio_video_cam_get_fmt_list,
-};
-
-int virtio_video_cam_init(struct virtio_video_device *vvd)
-{
- ssize_t num;
- struct video_device *vd = &vvd->video_dev;
-
- vd->ioctl_ops = &virtio_video_cam_ioctl_ops;
- vvd->ops = &virtio_video_cam_ops;
-
- num = strscpy(vd->name, "camera", sizeof(vd->name));
- if (num < 0)
- return num;
-
- return 0;
-}
diff --git a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_caps.c b/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_caps.c
deleted file mode 100644
index fc815b18..00000000
--- a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_caps.c
+++ /dev/null
@@ -1,460 +0,0 @@
-// SPDX-License-Identifier: GPL-2.0+
-/* Driver for virtio video device.
- *
- * Copyright 2020 OpenSynergy GmbH.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, see <http://www.gnu.org/licenses/>.
- */
-
-#include <media/v4l2-ioctl.h>
-#include <media/videobuf2-dma-sg.h>
-
-#include "virtio_video.h"
-
-static void virtio_video_free_frame_rates(struct video_format_frame *frame)
-{
- kfree(frame->frame_rates);
-}
-
-static void virtio_video_free_frames(struct video_format *fmt)
-{
- size_t idx = 0;
-
- for (idx = 0; idx < fmt->desc.num_frames; idx++)
- virtio_video_free_frame_rates(&fmt->frames[idx]);
- kfree(fmt->frames);
-}
-
-static void virtio_video_free_fmt(struct list_head *fmts_list)
-{
- struct video_format *fmt, *tmp;
-
- list_for_each_entry_safe(fmt, tmp, fmts_list, formats_list_entry) {
- list_del(&fmt->formats_list_entry);
- virtio_video_free_frames(fmt);
- kfree(fmt);
- }
-}
-
-static void virtio_video_free_fmts(struct virtio_video_device *vvd)
-{
- virtio_video_free_fmt(&vvd->input_fmt_list);
- virtio_video_free_fmt(&vvd->output_fmt_list);
-}
-
-static void virtio_video_copy_fmt_range(struct virtio_video_format_range *d_rge,
- struct virtio_video_format_range *s_rge)
-{
- d_rge->min = le32_to_cpu(s_rge->min);
- d_rge->max = le32_to_cpu(s_rge->max);
- d_rge->step = le32_to_cpu(s_rge->step);
-}
-
-static size_t
-virtio_video_parse_virtio_frame_rate(struct virtio_video_device *vvd,
- struct virtio_video_format_range *f_rate,
- void *buf)
-{
- struct virtio_video_format_range *virtio_frame_rate;
-
- virtio_frame_rate = buf;
- virtio_video_copy_fmt_range(f_rate, virtio_frame_rate);
-
- return sizeof(struct virtio_video_format_range);
-}
-
-static size_t virtio_video_parse_virtio_frame(struct virtio_video_device *vvd,
- struct video_format_frame *frm,
- void *buf)
-{
- struct virtio_video_format_frame *virtio_frame;
- struct virtio_video_format_frame *frame = &frm->frame;
- struct virtio_video_format_range *rate;
- size_t idx, offset, extra_size;
-
- virtio_frame = buf;
-
- virtio_video_copy_fmt_range(&frame->width, &virtio_frame->width);
- virtio_video_copy_fmt_range(&frame->height, &virtio_frame->height);
-
- frame->num_rates = le32_to_cpu(virtio_frame->num_rates);
- frm->frame_rates = kcalloc(frame->num_rates,
- sizeof(struct virtio_video_format_range),
- GFP_KERNEL);
-
- offset = sizeof(struct virtio_video_format_frame);
- for (idx = 0; idx < frame->num_rates; idx++) {
- rate = &frm->frame_rates[idx];
- extra_size =
- virtio_video_parse_virtio_frame_rate(vvd, rate,
- buf + offset);
- if (extra_size == 0) {
- kfree(frm->frame_rates);
- v4l2_err(&vvd->v4l2_dev,
- "failed to parse frame rate\n");
- return 0;
- }
- offset += extra_size;
- }
-
- return offset;
-}
-
-static size_t virtio_video_parse_virtio_fmt(struct virtio_video_device *vvd,
- struct video_format *fmt, void *buf)
-{
- struct virtio_video_format_desc *virtio_fmt_desc;
- struct virtio_video_format_desc *fmt_desc;
- struct video_format_frame *frame;
- size_t idx, offset, extra_size;
-
- virtio_fmt_desc = buf;
- fmt_desc = &fmt->desc;
-
- fmt_desc->format =
- virtio_video_format_to_v4l2
- (le32_to_cpu(virtio_fmt_desc->format));
- fmt_desc->mask = le64_to_cpu(virtio_fmt_desc->mask);
- fmt_desc->planes_layout = le32_to_cpu(virtio_fmt_desc->planes_layout);
-
- fmt_desc->num_frames = le32_to_cpu(virtio_fmt_desc->num_frames);
- fmt->frames = kcalloc(fmt_desc->num_frames,
- sizeof(struct video_format_frame),
- GFP_KERNEL);
-
- offset = sizeof(struct virtio_video_format_desc);
- for (idx = 0; idx < fmt_desc->num_frames; idx++) {
- frame = &fmt->frames[idx];
- extra_size =
- virtio_video_parse_virtio_frame(vvd, frame,
- buf + offset);
- if (extra_size == 0) {
- kfree(fmt->frames);
- v4l2_err(&vvd->v4l2_dev, "failed to parse frame\n");
- return 0;
- }
- offset += extra_size;
- }
-
- return offset;
-}
-
-int virtio_video_parse_virtio_capability(struct virtio_video_device *vvd,
- void *resp_buf,
- struct list_head *ret_fmt_list,
- uint32_t *ret_num_fmts)
-{
- struct virtio_video_query_capability_resp *resp = resp_buf;
- struct video_format *fmt;
- uint32_t fmt_count;
- int fmt_idx;
- size_t offset;
- int ret;
-
- if (!resp || ret_fmt_list == NULL || ret_num_fmts == NULL) {
- v4l2_err(&vvd->v4l2_dev, "invalid arguments!\n");
- return -EINVAL;
- }
-
- if (le32_to_cpu(resp->num_descs) <= 0) {
- v4l2_err(&vvd->v4l2_dev, "invalid capability response\n");
- return -EINVAL;
- }
-
- fmt_count = le32_to_cpu(resp->num_descs);
- offset = sizeof(struct virtio_video_query_capability_resp);
-
- for (fmt_idx = 0; fmt_idx < fmt_count; fmt_idx++) {
- size_t fmt_size = 0;
-
- fmt = kzalloc(sizeof(*fmt), GFP_KERNEL);
- if (!fmt) {
- ret = -ENOMEM;
- goto alloc_err;
- }
-
- fmt_size = virtio_video_parse_virtio_fmt(vvd, fmt,
- resp_buf + offset);
- if (fmt_size == 0) {
- v4l2_err(&vvd->v4l2_dev, "failed to parse fmt\n");
- ret = -ENOENT;
- goto parse_fmt_err;
- }
- offset += fmt_size;
- list_add(&fmt->formats_list_entry, ret_fmt_list);
- }
-
- *ret_num_fmts = fmt_count;
- return 0;
-
-parse_fmt_err:
- kfree(fmt);
-alloc_err:
- virtio_video_free_fmts(vvd);
- return ret;
-}
-
-int virtio_video_parse_virtio_capabilities(struct virtio_video_device *vvd,
- void *input_buf, void *output_buf)
-{
- int ret;
-
- if (input_buf) {
- ret = virtio_video_parse_virtio_capability(vvd, input_buf,
- &vvd->input_fmt_list,
- &vvd->num_input_fmts);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev,
- "Failed to parse input capability: %d\n",
- ret);
- return ret;
- }
- }
-
- if (output_buf) {
- ret = virtio_video_parse_virtio_capability(vvd, output_buf,
- &vvd->output_fmt_list,
- &vvd->num_output_fmts);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev,
- "Failed to parse output capability: %d\n",
- ret);
- return ret;
- }
- }
-
- return 0;
-}
-
-void virtio_video_clean_capability(struct virtio_video_device *vvd)
-{
- virtio_video_free_fmts(vvd);
-}
-
-static void
-virtio_video_free_control_fmt_data(struct video_control_fmt_data *data)
-{
- kfree(data->entries);
- kfree(data);
-}
-
-static void virtio_video_free_control_formats(struct virtio_video_device *vvd)
-{
- struct video_control_format *c_fmt, *tmp;
-
- list_for_each_entry_safe(c_fmt, tmp, &vvd->controls_fmt_list,
- controls_list_entry) {
- list_del(&c_fmt->controls_list_entry);
- virtio_video_free_control_fmt_data(c_fmt->profile);
- virtio_video_free_control_fmt_data(c_fmt->level);
- kfree(c_fmt);
- }
-}
-
-static int virtio_video_parse_control_levels(struct virtio_video_device *vvd,
- struct video_control_format *fmt)
-{
- int idx, ret;
- struct virtio_video_query_control_resp *resp_buf;
- struct virtio_video_query_control_resp_level *l_resp_buf;
- struct video_control_fmt_data *level;
- enum virtio_video_format virtio_format;
- uint32_t *virtio_levels;
- uint32_t num_levels, mask = 0;
- int max = 0, min = UINT_MAX;
- size_t resp_size;
-
- resp_size = vvd->max_resp_len;
-
- virtio_format = virtio_video_v4l2_format_to_virtio(fmt->format);
-
- resp_buf = kzalloc(resp_size, GFP_KERNEL);
- if (IS_ERR(resp_buf)) {
- ret = PTR_ERR(resp_buf);
- goto lvl_err;
- }
-
- ret = virtio_video_query_control_level(vvd, resp_buf, resp_size,
- virtio_format);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to query level\n");
- goto lvl_err;
- }
-
- l_resp_buf = (void *)((char *)resp_buf + sizeof(*resp_buf));
- num_levels = le32_to_cpu(l_resp_buf->num);
- if (num_levels == 0)
- goto lvl_err;
-
- fmt->level = kzalloc(sizeof(*level), GFP_KERNEL);
- if (!fmt->level) {
- ret = -ENOMEM;
- goto lvl_err;
- }
-
- level = fmt->level;
- level->entries = kcalloc(num_levels, sizeof(uint32_t), GFP_KERNEL);
- if (!level->entries) {
- kfree(fmt->level);
- ret = -ENOMEM;
- goto lvl_err;
- }
-
- virtio_levels = (void *)((char *)l_resp_buf + sizeof(*l_resp_buf));
-
- for (idx = 0; idx < num_levels; idx++) {
- level->entries[idx] =
- virtio_video_level_to_v4l2
- (le32_to_cpu(virtio_levels[idx]));
-
- mask = mask | (1 << level->entries[idx]);
- if (level->entries[idx] > max)
- max = level->entries[idx];
- if (level->entries[idx] < min)
- min = level->entries[idx];
- }
- level->min = min;
- level->max = max;
- level->num = num_levels;
- level->skip_mask = ~mask;
-
-lvl_err:
- kfree(resp_buf);
-
- return ret;
-}
-
-static int virtio_video_parse_control_profiles(struct virtio_video_device *vvd,
- struct video_control_format *fmt)
-{
- int idx, ret;
- struct virtio_video_query_control_resp *resp_buf;
- struct virtio_video_query_control_resp_profile *p_resp_buf;
- struct video_control_fmt_data *profile;
- uint32_t virtio_format, num_profiles, mask = 0;
- uint32_t *virtio_profiles;
- int max = 0, min = UINT_MAX;
- size_t resp_size;
-
- resp_size = vvd->max_resp_len;
- virtio_format = virtio_video_v4l2_format_to_virtio(fmt->format);
- resp_buf = kzalloc(resp_size, GFP_KERNEL);
- if (IS_ERR(resp_buf)) {
- ret = PTR_ERR(resp_buf);
- goto prf_err;
- }
-
- ret = virtio_video_query_control_profile(vvd, resp_buf, resp_size,
- virtio_format);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to query profile\n");
- goto prf_err;
- }
-
- p_resp_buf = (void *)((char *)resp_buf + sizeof(*resp_buf));
- num_profiles = le32_to_cpu(p_resp_buf->num);
- if (num_profiles == 0)
- goto prf_err;
-
- fmt->profile = kzalloc(sizeof(*profile), GFP_KERNEL);
- if (!fmt->profile) {
- ret = -ENOMEM;
- goto prf_err;
- }
-
- profile = fmt->profile;
- profile->entries = kcalloc(num_profiles, sizeof(uint32_t), GFP_KERNEL);
- if (!profile->entries) {
- kfree(fmt->profile);
- ret = -ENOMEM;
- goto prf_err;
- }
-
- virtio_profiles = (void *)((char *)p_resp_buf + sizeof(*p_resp_buf));
-
- for (idx = 0; idx < num_profiles; idx++) {
- profile->entries[idx] =
- virtio_video_profile_to_v4l2
- (le32_to_cpu(virtio_profiles[idx]));
-
- mask = mask | (1 << profile->entries[idx]);
- if (profile->entries[idx] > max)
- max = profile->entries[idx];
- if (profile->entries[idx] < min)
- min = profile->entries[idx];
- }
- profile->min = min;
- profile->max = max;
- profile->num = num_profiles;
- profile->skip_mask = ~mask;
-
-prf_err:
- kfree(resp_buf);
-
- return ret;
-}
-
-int virtio_video_parse_virtio_control(struct virtio_video_device *vvd)
-{
- struct video_format *fmt;
- struct video_control_format *c_fmt;
- uint32_t virtio_format;
- int ret;
-
- list_for_each_entry(fmt, &vvd->output_fmt_list, formats_list_entry) {
- virtio_format =
- virtio_video_v4l2_format_to_virtio(fmt->desc.format);
- if (virtio_format < VIRTIO_VIDEO_FORMAT_CODED_MIN ||
- virtio_format > VIRTIO_VIDEO_FORMAT_CODED_MAX)
- continue;
-
- c_fmt = kzalloc(sizeof(*c_fmt), GFP_KERNEL);
- if (!c_fmt) {
- ret = -ENOMEM;
- goto parse_ctrl_alloc_err;
- }
-
- c_fmt->format = fmt->desc.format;
-
- ret = virtio_video_parse_control_profiles(vvd, c_fmt);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev,
- "failed to parse control profile\n");
- goto parse_ctrl_prf_err;
- }
-
- ret = virtio_video_parse_control_levels(vvd, c_fmt);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev,
- "failed to parse control level\n");
- goto parse_ctrl_lvl_err;
- }
- list_add(&c_fmt->controls_list_entry, &vvd->controls_fmt_list);
- }
- return 0;
-
-parse_ctrl_lvl_err:
- virtio_video_free_control_fmt_data(c_fmt->profile);
-parse_ctrl_prf_err:
- kfree(c_fmt);
-parse_ctrl_alloc_err:
- virtio_video_free_control_formats(vvd);
-
- return ret;
-}
-
-void virtio_video_clean_control(struct virtio_video_device *vvd)
-{
- virtio_video_free_control_formats(vvd);
-}
diff --git a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_dec.c b/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_dec.c
deleted file mode 100644
index 301a9a16..00000000
--- a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_dec.c
+++ /dev/null
@@ -1,424 +0,0 @@
-// SPDX-License-Identifier: GPL-2.0+
-/* Decoder for virtio video device.
- *
- * Copyright 2020 OpenSynergy GmbH.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, see <http://www.gnu.org/licenses/>.
- */
-
-#include <linux/version.h>
-#include <media/v4l2-event.h>
-#include <media/v4l2-ioctl.h>
-
-#include "virtio_video.h"
-
-static int virtio_video_dec_start_streaming(struct vb2_queue *vq,
- unsigned int count)
-{
- struct virtio_video_stream *stream = vb2_get_drv_priv(vq);
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (!V4L2_TYPE_IS_OUTPUT(vq->type) &&
- virtio_video_state(stream) >= STREAM_STATE_INIT)
- virtio_video_state_update(stream, STREAM_STATE_RUNNING);
-
- return 0;
-}
-
-static void virtio_video_dec_stop_streaming(struct vb2_queue *vq)
-{
- int queue_type;
- struct virtio_video_stream *stream = vb2_get_drv_priv(vq);
-
- if (V4L2_TYPE_IS_OUTPUT(vq->type))
- queue_type = VIRTIO_VIDEO_QUEUE_TYPE_INPUT;
- else
- queue_type = VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT;
-
- virtio_video_queue_release_buffers(stream, queue_type);
- vb2_wait_for_all_buffers(vq);
-}
-
-static const struct vb2_ops virtio_video_dec_qops = {
- .queue_setup = virtio_video_queue_setup,
- .buf_init = virtio_video_buf_init,
- .buf_cleanup = virtio_video_buf_cleanup,
- .buf_queue = virtio_video_buf_queue,
- .start_streaming = virtio_video_dec_start_streaming,
- .stop_streaming = virtio_video_dec_stop_streaming,
- .wait_prepare = vb2_ops_wait_prepare,
- .wait_finish = vb2_ops_wait_finish,
-};
-
-static int virtio_video_dec_g_ctrl(struct v4l2_ctrl *ctrl)
-{
- int ret = 0;
- struct virtio_video_stream *stream = ctrl2stream(ctrl);
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- switch (ctrl->id) {
- case V4L2_CID_MIN_BUFFERS_FOR_CAPTURE:
- if (virtio_video_state(stream) >=
- STREAM_STATE_DYNAMIC_RES_CHANGE)
- ctrl->val = stream->out_info.min_buffers;
- else
- ctrl->val = 0;
- break;
- default:
- ret = -EINVAL;
- break;
- }
-
- return ret;
-}
-
-static const struct v4l2_ctrl_ops virtio_video_dec_ctrl_ops = {
- .g_volatile_ctrl = virtio_video_dec_g_ctrl,
-};
-
-int virtio_video_dec_init_ctrls(struct virtio_video_stream *stream)
-{
- struct v4l2_ctrl *ctrl;
-
- v4l2_ctrl_handler_init(&stream->ctrl_handler, 2);
-
- ctrl = v4l2_ctrl_new_std(&stream->ctrl_handler,
- &virtio_video_dec_ctrl_ops,
- V4L2_CID_MIN_BUFFERS_FOR_CAPTURE,
- MIN_BUFS_MIN, MIN_BUFS_MAX, MIN_BUFS_STEP,
- MIN_BUFS_DEF);
-
- if (ctrl)
- ctrl->flags |= V4L2_CTRL_FLAG_VOLATILE;
-
- if (stream->ctrl_handler.error)
- return stream->ctrl_handler.error;
-
- (void)v4l2_ctrl_new_std(&stream->ctrl_handler, NULL,
- V4L2_CID_MIN_BUFFERS_FOR_OUTPUT,
- MIN_BUFS_MIN, MIN_BUFS_MAX, MIN_BUFS_STEP,
- stream->in_info.min_buffers);
-
- if (stream->ctrl_handler.error)
- return stream->ctrl_handler.error;
-
- v4l2_ctrl_handler_setup(&stream->ctrl_handler);
-
- return 0;
-}
-
-int virtio_video_dec_init_queues(void *priv, struct vb2_queue *src_vq,
- struct vb2_queue *dst_vq)
-{
- int ret;
- struct virtio_video_stream *stream = priv;
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct device *dev = vvd->v4l2_dev.dev;
-
- src_vq->type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
- src_vq->io_modes = VB2_MMAP | VB2_DMABUF;
- src_vq->drv_priv = stream;
- src_vq->buf_struct_size = sizeof(struct virtio_video_buffer);
- src_vq->ops = &virtio_video_dec_qops;
- src_vq->mem_ops = virtio_video_mem_ops(vvd);
- src_vq->min_buffers_needed = stream->in_info.min_buffers;
- src_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_COPY;
- src_vq->lock = &stream->vq_mutex;
- src_vq->gfp_flags = virtio_video_gfp_flags(vvd);
- src_vq->dev = dev;
-
- ret = vb2_queue_init(src_vq);
- if (ret)
- return ret;
-
- dst_vq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
- dst_vq->io_modes = VB2_MMAP | VB2_DMABUF;
- dst_vq->drv_priv = stream;
- dst_vq->buf_struct_size = sizeof(struct virtio_video_buffer);
- dst_vq->ops = &virtio_video_dec_qops;
- dst_vq->mem_ops = virtio_video_mem_ops(vvd);
- dst_vq->min_buffers_needed = stream->out_info.min_buffers;
- dst_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_COPY;
- dst_vq->lock = &stream->vq_mutex;
- dst_vq->gfp_flags = virtio_video_gfp_flags(vvd);
- dst_vq->dev = dev;
-
- return vb2_queue_init(dst_vq);
-}
-
-static int virtio_video_try_decoder_cmd(struct file *file, void *fh,
- struct v4l2_decoder_cmd *cmd)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = video_drvdata(file);
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (virtio_video_state(stream) == STREAM_STATE_DRAIN)
- return -EBUSY;
-
- switch (cmd->cmd) {
- case V4L2_DEC_CMD_STOP:
- case V4L2_DEC_CMD_START:
- if (cmd->flags != 0) {
- v4l2_err(&vvd->v4l2_dev, "flags=%u are not supported",
- cmd->flags);
- return -EINVAL;
- }
- break;
- default:
- return -EINVAL;
- }
-
- return 0;
-}
-
-static int virtio_video_decoder_cmd(struct file *file, void *fh,
- struct v4l2_decoder_cmd *cmd)
-{
- int ret;
- struct vb2_queue *src_vq, *dst_vq;
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = video_drvdata(file);
-
- ret = virtio_video_try_decoder_cmd(file, fh, cmd);
- if (ret < 0)
- return ret;
-
- dst_vq = v4l2_m2m_get_vq(stream->fh.m2m_ctx,
- V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE);
-
- switch (cmd->cmd) {
- case V4L2_DEC_CMD_START:
- vb2_clear_last_buffer_dequeued(dst_vq);
- break;
- case V4L2_DEC_CMD_STOP:
- src_vq = v4l2_m2m_get_vq(stream->fh.m2m_ctx,
- V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE);
-
- if (!vb2_is_streaming(src_vq)) {
- v4l2_dbg(1, vvd->debug,
- &vvd->v4l2_dev, "output is not streaming\n");
- return 0;
- }
-
- if (!vb2_is_streaming(dst_vq)) {
- v4l2_dbg(1, vvd->debug,
- &vvd->v4l2_dev, "capture is not streaming\n");
- return 0;
- }
-
- ret = virtio_video_cmd_stream_drain(vvd, stream->stream_id);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to drain stream\n");
- return ret;
- }
-
- virtio_video_state_update(stream, STREAM_STATE_DRAIN);
- break;
- default:
- return -EINVAL;
- }
-
- return 0;
-}
-
-static int virtio_video_dec_enum_fmt_vid_cap(struct file *file, void *fh,
- struct v4l2_fmtdesc *f)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct video_format_info *info;
- struct video_format *fmt;
- unsigned long input_mask = 0;
- int idx = 0, bit_num = 0;
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
- return -EINVAL;
-
- if (f->index >= vvd->num_output_fmts)
- return -EINVAL;
-
- info = &stream->in_info;
- list_for_each_entry(fmt, &vvd->input_fmt_list, formats_list_entry) {
- if (info->fourcc_format == fmt->desc.format) {
- input_mask = fmt->desc.mask;
- break;
- }
- }
-
- if (input_mask == 0)
- return -EINVAL;
-
- list_for_each_entry(fmt, &vvd->output_fmt_list, formats_list_entry) {
- if (test_bit(bit_num, &input_mask)) {
- if (f->index == idx) {
- f->pixelformat = fmt->desc.format;
- return 0;
- }
- idx++;
- }
- bit_num++;
- }
- return -EINVAL;
-}
-
-
-int virtio_video_dec_enum_fmt_vid_out(struct file *file, void *fh,
- struct v4l2_fmtdesc *f)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct video_format *fmt;
- int idx = 0;
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (f->type != V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
- return -EINVAL;
-
- if (f->index >= vvd->num_input_fmts)
- return -EINVAL;
-
- list_for_each_entry(fmt, &vvd->input_fmt_list, formats_list_entry) {
- if (f->index == idx) {
- f->pixelformat = fmt->desc.format;
- return 0;
- }
- idx++;
- }
- return -EINVAL;
-}
-
-static int virtio_video_dec_s_fmt(struct file *file, void *fh,
- struct v4l2_format *f)
-{
- int ret;
- struct virtio_video_stream *stream = file2stream(file);
-
- ret = virtio_video_s_fmt(file, fh, f);
- if (ret)
- return ret;
-
- if (V4L2_TYPE_IS_OUTPUT(f->type)) {
- if (virtio_video_state(stream) == STREAM_STATE_IDLE)
- virtio_video_state_update(stream, STREAM_STATE_INIT);
- }
-
- return 0;
-}
-
-static int virtio_video_dec_s_selection(struct file *file, void *fh,
- struct v4l2_selection *sel)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- int ret;
-
- if (V4L2_TYPE_IS_OUTPUT(sel->type))
- return -EINVAL;
-
- switch (sel->target) {
- case V4L2_SEL_TGT_COMPOSE:
- stream->out_info.crop.top = sel->r.top;
- stream->out_info.crop.left = sel->r.left;
- stream->out_info.crop.width = sel->r.width;
- stream->out_info.crop.height = sel->r.height;
- break;
- default:
- return -EINVAL;
- }
-
- ret = virtio_video_cmd_set_params(vvd, stream, &stream->out_info,
- VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT);
- if (ret)
- return -EINVAL;
-
- return virtio_video_cmd_get_params(vvd, stream,
- VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT);
-}
-
-static const struct v4l2_ioctl_ops virtio_video_dec_ioctl_ops = {
- .vidioc_querycap = virtio_video_querycap,
-
-#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0))
- .vidioc_enum_fmt_vid_cap = virtio_video_dec_enum_fmt_vid_cap,
- .vidioc_enum_fmt_vid_out = virtio_video_dec_enum_fmt_vid_out,
-#else
- .vidioc_enum_fmt_vid_cap_mplane = virtio_video_dec_enum_fmt_vid_cap,
- .vidioc_enum_fmt_vid_out_mplane = virtio_video_dec_enum_fmt_vid_out,
-#endif
- .vidioc_g_fmt_vid_cap_mplane = virtio_video_g_fmt,
- .vidioc_s_fmt_vid_cap_mplane = virtio_video_dec_s_fmt,
-
- .vidioc_g_fmt_vid_out_mplane = virtio_video_g_fmt,
- .vidioc_s_fmt_vid_out_mplane = virtio_video_dec_s_fmt,
-
- .vidioc_g_selection = virtio_video_g_selection,
- .vidioc_s_selection = virtio_video_dec_s_selection,
-
- .vidioc_try_decoder_cmd = virtio_video_try_decoder_cmd,
- .vidioc_decoder_cmd = virtio_video_decoder_cmd,
- .vidioc_enum_frameintervals = virtio_video_enum_framemintervals,
- .vidioc_enum_framesizes = virtio_video_enum_framesizes,
-
- .vidioc_reqbufs = virtio_video_reqbufs,
- .vidioc_querybuf = v4l2_m2m_ioctl_querybuf,
- .vidioc_qbuf = virtio_video_qbuf,
- .vidioc_dqbuf = virtio_video_dqbuf,
- .vidioc_prepare_buf = v4l2_m2m_ioctl_prepare_buf,
- .vidioc_create_bufs = v4l2_m2m_ioctl_create_bufs,
- .vidioc_expbuf = v4l2_m2m_ioctl_expbuf,
-
- .vidioc_streamon = v4l2_m2m_ioctl_streamon,
- .vidioc_streamoff = v4l2_m2m_ioctl_streamoff,
-
- .vidioc_subscribe_event = virtio_video_subscribe_event,
- .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
-};
-
-void *virtio_video_dec_get_fmt_list(struct virtio_video_device *vvd)
-{
- return &vvd->input_fmt_list;
-}
-
-static struct virtio_video_device_ops virtio_video_dec_ops = {
- .init_ctrls = virtio_video_dec_init_ctrls,
- .init_queues = virtio_video_dec_init_queues,
- .get_fmt_list = virtio_video_dec_get_fmt_list,
-};
-
-int virtio_video_dec_init(struct virtio_video_device *vvd)
-{
- ssize_t num;
- struct video_device *vd = &vvd->video_dev;
-
- vd->ioctl_ops = &virtio_video_dec_ioctl_ops;
- vvd->ops = &virtio_video_dec_ops;
-
- num = strscpy(vd->name, "stateful-decoder", sizeof(vd->name));
- if (num < 0)
- return num;
-
- return 0;
-}
diff --git a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_device.c b/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_device.c
deleted file mode 100644
index 2e1f90ae..00000000
--- a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_device.c
+++ /dev/null
@@ -1,1282 +0,0 @@
-// SPDX-License-Identifier: GPL-2.0+
-/* Driver for virtio video device.
- *
- * Copyright 2020 OpenSynergy GmbH.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, see <http://www.gnu.org/licenses/>.
- */
-
-#include <linux/version.h>
-#include <media/v4l2-event.h>
-#include <media/v4l2-ioctl.h>
-#include <media/videobuf2-dma-sg.h>
-
-#include "virtio_video.h"
-
-enum video_stream_state virtio_video_state(struct virtio_video_stream *stream)
-{
- return atomic_read(&stream->state);
-}
-
-void virtio_video_state_reset(struct virtio_video_stream *stream)
-{
- atomic_set(&stream->state, STREAM_STATE_IDLE);
-}
-
-void virtio_video_state_update(struct virtio_video_stream *stream,
- enum video_stream_state new_state)
-{
- enum video_stream_state prev_state;
-
- do {
- prev_state = atomic_read(&stream->state);
- if (prev_state == STREAM_STATE_ERROR)
- return;
- } while (atomic_cmpxchg(&stream->state, prev_state, new_state) !=
- prev_state);
-}
-
-int virtio_video_pending_buf_list_empty(struct virtio_video_device *vvd)
-{
- int ret = 0;
-
- if (vvd->is_m2m_dev) {
- v4l2_err(&vvd->v4l2_dev, "Unexpected call for m2m device!\n");
- return -EPERM;
- }
-
- spin_lock(&vvd->pending_buf_list_lock);
- if (list_empty(&vvd->pending_buf_list))
- ret = 1;
- spin_unlock(&vvd->pending_buf_list_lock);
-
- return ret;
-}
-
-int virtio_video_pending_buf_list_pop(struct virtio_video_device *vvd,
- struct virtio_video_buffer **virtio_vb)
-{
- struct virtio_video_buffer *retbuf;
-
- if (vvd->is_m2m_dev) {
- v4l2_err(&vvd->v4l2_dev, "Unexpected call for m2m device!\n");
- return -EPERM;
- }
-
- spin_lock(&vvd->pending_buf_list_lock);
- if (list_empty(&vvd->pending_buf_list)) {
- spin_unlock(&vvd->pending_buf_list_lock);
- return -EAGAIN;
- }
-
- retbuf = list_first_entry(&vvd->pending_buf_list,
- struct virtio_video_buffer, list);
- spin_unlock(&vvd->pending_buf_list_lock);
-
- *virtio_vb = retbuf;
- return 0;
-}
-
-int virtio_video_pending_buf_list_add(struct virtio_video_device *vvd,
- struct virtio_video_buffer *virtio_vb)
-{
- if (vvd->is_m2m_dev) {
- v4l2_err(&vvd->v4l2_dev, "Unexpected call for m2m device!\n");
- return -EPERM;
- }
-
- spin_lock(&vvd->pending_buf_list_lock);
- list_add_tail(&virtio_vb->list, &vvd->pending_buf_list);
- spin_unlock(&vvd->pending_buf_list_lock);
-
- return 0;
-}
-
-int virtio_video_pending_buf_list_del(struct virtio_video_device *vvd,
- struct virtio_video_buffer *virtio_vb)
-{
- struct virtio_video_buffer *vb, *vb_tmp;
- int ret = -EINVAL;
-
- if (vvd->is_m2m_dev) {
- v4l2_err(&vvd->v4l2_dev, "Unexpected call for m2m device!\n");
- return -EPERM;
- }
-
- spin_lock(&vvd->pending_buf_list_lock);
- if (list_empty(&vvd->pending_buf_list)) {
- spin_unlock(&vvd->pending_buf_list_lock);
- return -EAGAIN;
- }
-
- list_for_each_entry_safe(vb, vb_tmp, &vvd->pending_buf_list, list) {
- if (vb->resource_id == virtio_vb->resource_id) {
- list_del(&vb->list);
- ret = 0;
- break;
- }
- }
- spin_unlock(&vvd->pending_buf_list_lock);
-
- return ret;
-}
-
-int virtio_video_queue_setup(struct vb2_queue *vq, unsigned int *num_buffers,
- unsigned int *num_planes, unsigned int sizes[],
- struct device *alloc_devs[])
-{
- int i;
- struct virtio_video_stream *stream = vb2_get_drv_priv(vq);
- struct video_format_info *p_info;
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (*num_planes)
- return 0;
-
- if (V4L2_TYPE_IS_OUTPUT(vq->type))
- p_info = &stream->in_info;
- else
- p_info = &stream->out_info;
-
- *num_planes = p_info->num_planes;
-
- for (i = 0; i < p_info->num_planes; i++)
- sizes[i] = p_info->plane_format[i].plane_size;
-
- return 0;
-}
-
-static unsigned int
-build_virtio_video_sglist_contig(struct virtio_video_resource_sg_list *sgl,
- struct vb2_buffer *vb, unsigned int plane)
-{
- sgl->entries[0].addr = cpu_to_le64(vb2_dma_contig_plane_dma_addr(vb, plane));
- sgl->entries[0].length = cpu_to_le32(vb->planes[plane].length);
-
- sgl->num_entries = 1;
-
- return VIRTIO_VIDEO_RESOURCE_SG_SIZE(1);
-}
-
-static unsigned int
-build_virtio_video_sglist(struct virtio_video_resource_sg_list *sgl,
- struct vb2_buffer *vb, unsigned int plane,
- bool has_iommu)
-{
- int i;
- struct scatterlist *sg;
- struct sg_table *sgt = vb2_dma_sg_plane_desc(vb, plane);
-
- for_each_sg(sgt->sgl, sg, sgt->nents, i) {
- sgl->entries[i].addr = cpu_to_le64(has_iommu
- ? sg_dma_address(sg)
- : sg_phys(sg));
- sgl->entries[i].length = cpu_to_le32(sg->length);
- }
-
- sgl->num_entries = sgt->nents;
-
- return VIRTIO_VIDEO_RESOURCE_SG_SIZE(sgt->nents);
-}
-
-int virtio_video_buf_init(struct vb2_buffer *vb)
-{
- int ret = 0;
- void *buf;
- size_t buf_size = 0;
- struct virtio_video_resource_sg_list *sg_list;
- unsigned int i, offset = 0, resource_id, nents = 0;
- struct vb2_queue *vq = vb->vb2_queue;
- enum v4l2_buf_type queue_type = vq->type;
- struct virtio_video_stream *stream = vb2_get_drv_priv(vq);
- struct virtio_video_buffer *virtio_vb = to_virtio_vb(vb);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
-
- if (vvd->supp_non_contig) {
- for (i = 0; i < vb->num_planes; i++) {
- nents = vb2_dma_sg_plane_desc(vb, i)->nents;
- buf_size += VIRTIO_VIDEO_RESOURCE_SG_SIZE(nents);
- }
-
- buf = kcalloc(1, buf_size, GFP_KERNEL);
- if (!buf)
- return -ENOMEM;
-
- for (i = 0; i < vb->num_planes; i++) {
- sg_list = buf + offset;
- offset += build_virtio_video_sglist(sg_list, vb, i,
- vvd->has_iommu);
- }
- } else {
- buf_size = vb->num_planes * VIRTIO_VIDEO_RESOURCE_SG_SIZE(nents);
-
- buf = kcalloc(1, buf_size, GFP_KERNEL);
- if (!buf)
- return -ENOMEM;
-
- for (i = 0; i < vb->num_planes; i++) {
- sg_list = buf + offset;
- offset += build_virtio_video_sglist_contig(sg_list,
- vb, i);
- }
- }
-
- virtio_video_resource_id_get(vvd, &resource_id);
-
- ret = virtio_video_cmd_resource_attach(vvd, stream->stream_id,
- resource_id,
- to_virtio_queue_type(queue_type),
- buf, buf_size);
- if (ret) {
- virtio_video_resource_id_put(vvd, resource_id);
- kfree(buf);
- return ret;
- }
-
- virtio_vb->queued = false;
- virtio_vb->resource_id = resource_id;
-
- return 0;
-}
-
-void virtio_video_buf_cleanup(struct vb2_buffer *vb)
-{
- struct virtio_video_stream *stream = vb2_get_drv_priv(vb->vb2_queue);
- struct virtio_video_buffer *virtio_vb = to_virtio_vb(vb);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
-
- virtio_video_resource_id_put(vvd, virtio_vb->resource_id);
-}
-
-void virtio_video_buf_queue(struct vb2_buffer *vb)
-{
- int i, ret;
- struct virtio_video_buffer *virtio_vb;
- uint32_t data_size[VB2_MAX_PLANES] = {0};
- struct virtio_video_stream *stream = vb2_get_drv_priv(vb->vb2_queue);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
-
- for (i = 0; i < vb->num_planes; ++i)
- data_size[i] = vb->planes[i].bytesused;
-
- virtio_vb = to_virtio_vb(vb);
-
- if (!vvd->is_m2m_dev)
- virtio_video_pending_buf_list_add(vvd, virtio_vb);
-
- ret = virtio_video_cmd_resource_queue(vvd, stream->stream_id,
- virtio_vb, data_size,
- vb->num_planes,
- to_virtio_queue_type(vb->type));
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to queue buffer\n");
- return;
- }
-
- virtio_vb->queued = true;
-}
-
-int virtio_video_qbuf(struct file *file, void *priv,
- struct v4l2_buffer *buf)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = video_drvdata(file);
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (vvd->is_m2m_dev)
- return v4l2_m2m_ioctl_qbuf(file, priv, buf);
-
- return vb2_ioctl_qbuf(file, priv, buf);
-}
-
-int virtio_video_dqbuf(struct file *file, void *priv,
- struct v4l2_buffer *buf)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = video_drvdata(file);
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (vvd->is_m2m_dev)
- return v4l2_m2m_ioctl_dqbuf(file, priv, buf);
-
- return vb2_ioctl_dqbuf(file, priv, buf);
-}
-
-int virtio_video_querycap(struct file *file, void *fh,
- struct v4l2_capability *cap)
-{
- struct video_device *video_dev = video_devdata(file);
- struct virtio_video_device *vvd = video_drvdata(file);
-
- if (strscpy(cap->driver, DRIVER_NAME, sizeof(cap->driver)) < 0)
- v4l2_err(&vvd->v4l2_dev, "failed to copy driver name\n");
- if (strscpy(cap->card, video_dev->name, sizeof(cap->card)) < 0)
- v4l2_err(&vvd->v4l2_dev, "failed to copy card name\n");
-
- snprintf(cap->bus_info, sizeof(cap->bus_info), "virtio:%s",
- video_dev->name);
-
- cap->device_caps = video_dev->device_caps;
- return 0;
-}
-
-int virtio_video_enum_framesizes(struct file *file, void *fh,
- struct v4l2_frmsizeenum *f)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct video_format *fmt;
- struct video_format_frame *frm;
- struct virtio_video_format_frame *frame;
- int idx = f->index;
-
- fmt = virtio_video_find_video_format(&vvd->input_fmt_list,
- f->pixel_format);
- if (fmt == NULL)
- fmt = virtio_video_find_video_format(&vvd->output_fmt_list,
- f->pixel_format);
- if (fmt == NULL)
- return -EINVAL;
-
- if (idx >= fmt->desc.num_frames)
- return -EINVAL;
-
- frm = &fmt->frames[idx];
- frame = &frm->frame;
-
- if (frame->width.min == frame->width.max &&
- frame->height.min == frame->height.max) {
- f->type = V4L2_FRMSIZE_TYPE_DISCRETE;
- f->discrete.width = frame->width.min;
- f->discrete.height = frame->height.min;
- return 0;
- }
-
- f->type = V4L2_FRMSIZE_TYPE_CONTINUOUS;
- f->stepwise.min_width = frame->width.min;
- f->stepwise.max_width = frame->width.max;
- f->stepwise.min_height = frame->height.min;
- f->stepwise.max_height = frame->height.max;
- f->stepwise.step_width = frame->width.step;
- f->stepwise.step_height = frame->height.step;
- return 0;
-}
-
-static bool in_stepped_interval(struct virtio_video_format_range range,
- uint32_t point)
-{
- if (point < range.min || point > range.max)
- return false;
-
- if (range.step == 0 && range.min == range.max && range.min == point)
- return true;
-
- if (range.step != 0 && (point - range.min) % range.step == 0)
- return true;
-
- return false;
-}
-
-int virtio_video_enum_framemintervals(struct file *file, void *fh,
- struct v4l2_frmivalenum *f)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct video_format *fmt;
- struct video_format_frame *frm;
- struct virtio_video_format_frame *frame;
- struct virtio_video_format_range *frate;
- int idx = f->index;
- int f_idx;
-
- fmt = virtio_video_find_video_format(&vvd->input_fmt_list,
- f->pixel_format);
- if (fmt == NULL)
- fmt = virtio_video_find_video_format(&vvd->output_fmt_list,
- f->pixel_format);
- if (fmt == NULL)
- return -EINVAL;
-
- for (f_idx = 0; f_idx <= fmt->desc.num_frames; f_idx++) {
- frm = &fmt->frames[f_idx];
- frame = &frm->frame;
- if (in_stepped_interval(frame->width, f->width) &&
- in_stepped_interval(frame->height, f->height))
- break;
- }
-
- if (frame == NULL || f->index >= frame->num_rates)
- return -EINVAL;
-
- frate = &frm->frame_rates[idx];
- if (frate->max == frate->min) {
- f->type = V4L2_FRMIVAL_TYPE_DISCRETE;
- f->discrete.numerator = 1;
- f->discrete.denominator = frate->max;
- } else {
- f->stepwise.min.numerator = 1;
- f->stepwise.min.denominator = frate->max;
- f->stepwise.max.numerator = 1;
- f->stepwise.max.denominator = frate->min;
- f->stepwise.step.numerator = 1;
- f->stepwise.step.denominator = frate->step;
- if (frate->step == 1)
- f->type = V4L2_FRMIVAL_TYPE_CONTINUOUS;
- else
- f->type = V4L2_FRMIVAL_TYPE_STEPWISE;
- }
- return 0;
-}
-
-int virtio_video_stream_get_params(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream)
-{
- int ret;
-
- if (vvd->is_m2m_dev) {
- ret = virtio_video_cmd_get_params(vvd, stream,
- VIRTIO_VIDEO_QUEUE_TYPE_INPUT);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev,
- "failed to get stream in params\n");
- goto err_get_parms;
- }
- }
-
- ret = virtio_video_cmd_get_params(vvd, stream,
- VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT);
- if (ret)
- v4l2_err(&vvd->v4l2_dev, "failed to get stream out params\n");
-
-err_get_parms:
- return ret;
-}
-
-int virtio_video_stream_get_controls(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream)
-{
- int ret;
-
- ret = virtio_video_cmd_get_control(vvd, stream,
- VIRTIO_VIDEO_CONTROL_PROFILE);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to get stream profile\n");
- goto err_get_ctrl;
- }
-
- ret = virtio_video_cmd_get_control(vvd, stream,
- VIRTIO_VIDEO_CONTROL_LEVEL);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to get stream level\n");
- goto err_get_ctrl;
- }
-
- ret = virtio_video_cmd_get_control(vvd, stream,
- VIRTIO_VIDEO_CONTROL_BITRATE);
- if (ret)
- v4l2_err(&vvd->v4l2_dev, "failed to get stream bitrate\n");
-
-err_get_ctrl:
- return ret;
-}
-
-int virtio_video_g_fmt(struct file *file, void *fh, struct v4l2_format *f)
-{
- struct video_format_info *info;
- struct v4l2_pix_format_mplane *pix_mp = &f->fmt.pix_mp;
- struct virtio_video_stream *stream = file2stream(file);
-
- if (!V4L2_TYPE_IS_OUTPUT(f->type))
- info = &stream->out_info;
- else
- info = &stream->in_info;
-
- virtio_video_format_from_info(info, pix_mp);
-
- return 0;
-}
-
-int virtio_video_s_fmt(struct file *file, void *fh, struct v4l2_format *f)
-{
- int i, ret;
- struct virtio_video_stream *stream = file2stream(file);
- struct v4l2_pix_format_mplane *pix_mp = &f->fmt.pix_mp;
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct video_format_info info;
- struct video_format_info *p_info;
- uint32_t queue;
-
- ret = virtio_video_try_fmt(stream, f);
- if (ret)
- return ret;
-
- if (V4L2_TYPE_IS_OUTPUT(f->type)) {
- virtio_video_format_fill_default_info(&info, &stream->in_info);
- queue = VIRTIO_VIDEO_QUEUE_TYPE_INPUT;
- } else {
- virtio_video_format_fill_default_info(&info, &stream->out_info);
- queue = VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT;
- }
-
- info.frame_width = pix_mp->width;
- info.frame_height = pix_mp->height;
- info.num_planes = pix_mp->num_planes;
- info.fourcc_format = pix_mp->pixelformat;
-
- for (i = 0; i < info.num_planes; i++) {
- info.plane_format[i].stride =
- pix_mp->plane_fmt[i].bytesperline;
- info.plane_format[i].plane_size =
- pix_mp->plane_fmt[i].sizeimage;
- }
-
- virtio_video_cmd_set_params(vvd, stream, &info, queue);
- virtio_video_stream_get_params(vvd, stream);
-
- if (V4L2_TYPE_IS_OUTPUT(f->type))
- p_info = &stream->in_info;
- else
- p_info = &stream->out_info;
-
- virtio_video_format_from_info(p_info, pix_mp);
-
- return 0;
-}
-
-int virtio_video_g_selection(struct file *file, void *fh,
- struct v4l2_selection *sel)
-{
- struct video_format_info *info;
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = video_drvdata(file);
-
- switch (vvd->type) {
- case VIRTIO_VIDEO_DEVICE_ENCODER:
- if (!V4L2_TYPE_IS_OUTPUT(sel->type))
- return -EINVAL;
- info = &stream->in_info;
- break;
- case VIRTIO_VIDEO_DEVICE_DECODER:
- case VIRTIO_VIDEO_DEVICE_CAMERA:
- if (V4L2_TYPE_IS_OUTPUT(sel->type))
- return -EINVAL;
- info = &stream->out_info;
- break;
- default:
- v4l2_err(&vvd->v4l2_dev, "unsupported device type\n");
- return -EINVAL;
- }
-
- switch (sel->target) {
- case V4L2_SEL_TGT_COMPOSE:
- case V4L2_SEL_TGT_COMPOSE_BOUNDS:
- case V4L2_SEL_TGT_COMPOSE_PADDED:
- case V4L2_SEL_TGT_COMPOSE_DEFAULT:
- sel->r.width = info->frame_width;
- sel->r.height = info->frame_height;
- break;
- case V4L2_SEL_TGT_CROP_BOUNDS:
- case V4L2_SEL_TGT_CROP_DEFAULT:
- case V4L2_SEL_TGT_CROP:
- sel->r.top = info->crop.top;
- sel->r.left = info->crop.left;
- sel->r.width = info->frame_width;
- sel->r.height = info->frame_height;
- break;
- default:
- v4l2_dbg(1, vvd->debug, &vvd->v4l2_dev,
- "unsupported/invalid selection target: %d\n",
- sel->target);
- return -EINVAL;
- }
-
- return 0;
-}
-
-int virtio_video_try_fmt(struct virtio_video_stream *stream,
- struct v4l2_format *f)
-{
- int i, idx = 0;
- struct v4l2_pix_format_mplane *pix_mp = &f->fmt.pix_mp;
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct video_format *fmt;
- bool found = false;
- struct video_format_frame *frm;
- struct virtio_video_format_frame *frame;
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (V4L2_TYPE_IS_OUTPUT(f->type))
- fmt = virtio_video_find_video_format(&vvd->input_fmt_list,
- pix_mp->pixelformat);
- else
- fmt = virtio_video_find_video_format(&vvd->output_fmt_list,
- pix_mp->pixelformat);
-
- if (!fmt) {
- if (f->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
- virtio_video_format_from_info(&stream->out_info,
- pix_mp);
- else if (f->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
- virtio_video_format_from_info(&stream->in_info,
- pix_mp);
- else
- return -EINVAL;
- return 0;
- }
-
- for (i = 0; i < fmt->desc.num_frames && !found; i++) {
- frm = &fmt->frames[i];
- frame = &frm->frame;
- if (!within_range(frame->width.min, pix_mp->width,
- frame->width.max))
- continue;
-
- if (!within_range(frame->height.min, pix_mp->height,
- frame->height.max))
- continue;
- idx = i;
- /*
- * Try to find a more suitable frame size. Go with the current
- * one otherwise.
- */
- if (needs_alignment(pix_mp->width, frame->width.step))
- continue;
-
- if (needs_alignment(pix_mp->height, frame->height.step))
- continue;
-
- stream->current_frame = frm;
- found = true;
- }
-
- if (!found) {
- frm = &fmt->frames[idx];
- if (!frm)
- return -EINVAL;
-
- frame = &frm->frame;
- pix_mp->width = clamp(pix_mp->width, frame->width.min,
- frame->width.max);
- if (frame->width.step != 0)
- pix_mp->width = ALIGN(pix_mp->width, frame->width.step);
-
- pix_mp->height = clamp(pix_mp->height, frame->height.min,
- frame->height.max);
- if (frame->height.step != 0)
- pix_mp->height = ALIGN(pix_mp->height,
- frame->height.step);
- stream->current_frame = frm;
- }
-
- return 0;
-}
-
-static int virtio_video_queue_free(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- enum v4l2_buf_type type)
-{
- int ret;
- enum virtio_video_queue_type queue_type = to_virtio_queue_type(type);
-
- ret = virtio_video_cmd_queue_detach_resources(vvd, stream, queue_type);
- if (ret) {
- v4l2_warn(&vvd->v4l2_dev,
- "failed to destroy resources\n");
- return ret;
- }
-
- return 0;
-}
-
-int virtio_video_reqbufs(struct file *file, void *priv,
- struct v4l2_requestbuffers *rb)
-{
- int ret;
- struct virtio_video_stream *stream = file2stream(file);
- struct v4l2_m2m_ctx *m2m_ctx = stream->fh.m2m_ctx;
- struct virtio_video_device *vvd = video_drvdata(file);
- struct video_device *vdev = video_devdata(file);
- struct vb2_queue *vq;
-
- if (vvd->is_m2m_dev)
- vq = v4l2_m2m_get_vq(m2m_ctx, rb->type);
- else
- vq = vdev->queue;
-
- if (rb->count == 0) {
- ret = virtio_video_queue_free(vvd, stream, vq->type);
- if (ret < 0)
- return ret;
- }
-
- if (vvd->is_m2m_dev)
- return v4l2_m2m_reqbufs(file, m2m_ctx, rb);
- else
- return vb2_ioctl_reqbufs(file, priv, rb);
-}
-
-int virtio_video_subscribe_event(struct v4l2_fh *fh,
- const struct v4l2_event_subscription *sub)
-{
- switch (sub->type) {
- case V4L2_EVENT_SOURCE_CHANGE:
- return v4l2_src_change_event_subscribe(fh, sub);
- default:
- return v4l2_ctrl_subscribe_event(fh, sub);
- }
-}
-
-void virtio_video_queue_eos_event(struct virtio_video_stream *stream)
-{
- static const struct v4l2_event eos_event = {
- .type = V4L2_EVENT_EOS
- };
-
- v4l2_event_queue_fh(&stream->fh, &eos_event);
-}
-
-void virtio_video_queue_res_chg_event(struct virtio_video_stream *stream)
-{
- static const struct v4l2_event ev_src_ch = {
- .type = V4L2_EVENT_SOURCE_CHANGE,
- .u.src_change.changes =
- V4L2_EVENT_SRC_CH_RESOLUTION,
- };
-
- v4l2_event_queue_fh(&stream->fh, &ev_src_ch);
-}
-
-void virtio_video_handle_error(struct virtio_video_stream *stream)
-{
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
-
- if (vvd->is_m2m_dev)
- virtio_video_queue_release_buffers
- (stream, VIRTIO_VIDEO_QUEUE_TYPE_INPUT);
-
- virtio_video_queue_release_buffers
- (stream, VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT);
-}
-
-int virtio_video_queue_release_buffers(struct virtio_video_stream *stream,
- enum virtio_video_queue_type queue_type)
-{
- int ret;
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct vb2_v4l2_buffer *v4l2_vb;
- struct virtio_video_buffer *vvb;
-
- ret = virtio_video_cmd_queue_clear(vvd, stream, queue_type);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to clear queue\n");
- return ret;
- }
-
- if (!vvd->is_m2m_dev) {
- while (!virtio_video_pending_buf_list_pop(vvd, &vvb) && vvb) {
- v4l2_vb = &vvb->v4l2_m2m_vb.vb;
- v4l2_m2m_buf_done(v4l2_vb, VB2_BUF_STATE_ERROR);
- }
- return 0;
- }
-
- for (;;) {
- if (queue_type == VIRTIO_VIDEO_QUEUE_TYPE_INPUT)
- v4l2_vb = v4l2_m2m_src_buf_remove(stream->fh.m2m_ctx);
- else
- v4l2_vb = v4l2_m2m_dst_buf_remove(stream->fh.m2m_ctx);
- if (!v4l2_vb)
- break;
- v4l2_m2m_buf_done(v4l2_vb, VB2_BUF_STATE_ERROR);
- }
-
- return 0;
-}
-
-void virtio_video_buf_done(struct virtio_video_buffer *virtio_vb,
- uint32_t flags, uint64_t timestamp,
- uint32_t data_sizes[])
-{
- int i;
- enum vb2_buffer_state done_state = VB2_BUF_STATE_DONE;
- struct vb2_v4l2_buffer *v4l2_vb = &virtio_vb->v4l2_m2m_vb.vb;
- struct vb2_buffer *vb = &v4l2_vb->vb2_buf;
- struct vb2_queue *vb2_queue = vb->vb2_queue;
- struct virtio_video_stream *stream = vb2_get_drv_priv(vb2_queue);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct video_format_info *p_info;
-
- virtio_vb->queued = false;
-
- if (flags & VIRTIO_VIDEO_DEQUEUE_FLAG_ERR)
- done_state = VB2_BUF_STATE_ERROR;
-
- if (flags & VIRTIO_VIDEO_DEQUEUE_FLAG_KEY_FRAME)
- v4l2_vb->flags |= V4L2_BUF_FLAG_KEYFRAME;
-
- if (flags & VIRTIO_VIDEO_DEQUEUE_FLAG_BFRAME)
- v4l2_vb->flags |= V4L2_BUF_FLAG_BFRAME;
-
- if (flags & VIRTIO_VIDEO_DEQUEUE_FLAG_PFRAME)
- v4l2_vb->flags |= V4L2_BUF_FLAG_PFRAME;
-
- if (flags & VIRTIO_VIDEO_DEQUEUE_FLAG_EOS) {
- v4l2_vb->flags |= V4L2_BUF_FLAG_LAST;
- virtio_video_state_update(stream, STREAM_STATE_STOPPED);
- virtio_video_queue_eos_event(stream);
- }
-
- if ((flags & VIRTIO_VIDEO_DEQUEUE_FLAG_ERR) ||
- (flags & VIRTIO_VIDEO_DEQUEUE_FLAG_EOS)) {
- vb->planes[0].bytesused = 0;
-
- if (!vvd->is_m2m_dev)
- virtio_video_pending_buf_list_del(vvd, virtio_vb);
-
- v4l2_m2m_buf_done(v4l2_vb, done_state);
- return;
- }
-
- if (!V4L2_TYPE_IS_OUTPUT(vb2_queue->type)) {
- switch (vvd->type) {
- case VIRTIO_VIDEO_DEVICE_ENCODER:
- for (i = 0; i < vb->num_planes; i++)
- vb->planes[i].bytesused =
- le32_to_cpu(data_sizes[i]);
- break;
- case VIRTIO_VIDEO_DEVICE_CAMERA:
- case VIRTIO_VIDEO_DEVICE_DECODER:
- p_info = &stream->out_info;
- for (i = 0; i < p_info->num_planes; i++)
- vb->planes[i].bytesused =
- p_info->plane_format[i].plane_size;
- break;
- }
-
- vb->timestamp = timestamp;
- }
-
- if (!vvd->is_m2m_dev)
- virtio_video_pending_buf_list_del(vvd, virtio_vb);
-
- v4l2_m2m_buf_done(v4l2_vb, done_state);
-}
-
-static int virtio_video_set_device_busy(struct virtio_video_device *vvd)
-{
- struct video_device *vd = &vvd->video_dev;
- int ret = 0;
-
- /* Multiple open is allowed for m2m device */
- if (vvd->is_m2m_dev)
- return 0;
-
- mutex_lock(vd->lock);
-
- if (vvd->device_busy)
- ret = -EBUSY;
- else
- vvd->device_busy = true;
-
- mutex_unlock(vd->lock);
-
- return ret;
-}
-
-static void virtio_video_clear_device_busy(struct virtio_video_device *vvd,
- struct mutex *lock)
-{
- /* Nothing to do for m2m device */
- if (vvd->is_m2m_dev)
- return;
-
- if (lock)
- mutex_lock(lock);
-
- vvd->device_busy = false;
-
- if (lock)
- mutex_unlock(lock);
-}
-
-static int virtio_video_device_open(struct file *file)
-{
- int ret;
- uint32_t stream_id;
- char name[TASK_COMM_LEN];
- struct virtio_video_stream *stream;
- struct video_format *default_fmt;
- enum virtio_video_format format;
- struct video_device *video_dev = video_devdata(file);
- struct virtio_video_device *vvd = video_drvdata(file);
-
- ret = virtio_video_set_device_busy(vvd);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "device already in use.\n");
- return ret;
- }
-
- default_fmt = list_first_entry_or_null(vvd->ops->get_fmt_list(vvd),
- struct video_format,
- formats_list_entry);
- if (!default_fmt) {
- v4l2_err(&vvd->v4l2_dev, "device failed to start\n");
- ret = -EIO;
- goto err;
- }
-
- stream = kzalloc(sizeof(*stream), GFP_KERNEL);
- if (!stream) {
- ret = -ENOMEM;
- goto err;
- }
-
- get_task_comm(name, current);
- format = virtio_video_v4l2_format_to_virtio(default_fmt->desc.format);
- virtio_video_stream_id_get(vvd, stream, &stream_id);
- ret = virtio_video_cmd_stream_create(vvd, stream_id, format, name);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to create stream\n");
- goto err_stream_create;
- }
-
- stream->video_dev = video_dev;
- stream->stream_id = stream_id;
-
- virtio_video_state_reset(stream);
-
- ret = virtio_video_stream_get_params(vvd, stream);
- if (ret)
- goto err_stream_create;
-
- if (format >= VIRTIO_VIDEO_FORMAT_CODED_MIN &&
- format <= VIRTIO_VIDEO_FORMAT_CODED_MAX) {
- ret = virtio_video_stream_get_controls(vvd, stream);
- if (ret)
- goto err_stream_create;
- }
-
- mutex_init(&stream->vq_mutex);
- v4l2_fh_init(&stream->fh, video_dev);
- stream->fh.ctrl_handler = &stream->ctrl_handler;
-
- if (vvd->is_m2m_dev) {
- stream->fh.m2m_ctx = v4l2_m2m_ctx_init(vvd->m2m_dev, stream,
- vvd->ops->init_queues);
- if (IS_ERR(stream->fh.m2m_ctx)) {
- ret = PTR_ERR(stream->fh.m2m_ctx);
- goto err_init_ctx;
- }
-
- v4l2_m2m_set_src_buffered(stream->fh.m2m_ctx, true);
- v4l2_m2m_set_dst_buffered(stream->fh.m2m_ctx, true);
- } else {
- vvd->ops->init_queues(stream, NULL, &vvd->vb2_output_queue);
- /* Video dev queue is required for vb2 ioctl wrappers */
- video_dev->queue = &vvd->vb2_output_queue;
- }
-
- file->private_data = &stream->fh;
- v4l2_fh_add(&stream->fh);
-
- if (vvd->ops->init_ctrls) {
- ret = vvd->ops->init_ctrls(stream);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to init controls\n");
- goto err_init_ctrls;
- }
- }
- return 0;
-
-err_init_ctrls:
- v4l2_fh_del(&stream->fh);
- mutex_lock(video_dev->lock);
- if (vvd->is_m2m_dev)
- v4l2_m2m_ctx_release(stream->fh.m2m_ctx);
- mutex_unlock(video_dev->lock);
-err_init_ctx:
- v4l2_fh_exit(&stream->fh);
-err_stream_create:
- virtio_video_stream_id_put(vvd, stream_id);
- kfree(stream);
-err:
- virtio_video_clear_device_busy(vvd, video_dev->lock);
- return ret;
-}
-
-static int virtio_video_device_release(struct file *file)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct video_device *video_dev = video_devdata(file);
- struct virtio_video_device *vvd = video_drvdata(file);
-
- mutex_lock(video_dev->lock);
-
- v4l2_fh_del(&stream->fh);
- if (vvd->is_m2m_dev) {
- v4l2_m2m_ctx_release(stream->fh.m2m_ctx);
- } else if (file->private_data == video_dev->queue->owner) {
- vb2_queue_release(&vvd->vb2_output_queue);
- video_dev->queue->owner = NULL;
- }
-
- v4l2_fh_exit(&stream->fh);
-
- virtio_video_cmd_stream_destroy(vvd, stream->stream_id);
- virtio_video_stream_id_put(vvd, stream->stream_id);
-
- kfree(stream);
-
- /* Mutex already locked here, passing NULL */
- virtio_video_clear_device_busy(vvd, NULL);
-
- mutex_unlock(video_dev->lock);
-
- return 0;
-}
-
-static const struct v4l2_file_operations virtio_video_device_m2m_fops = {
- .owner = THIS_MODULE,
- .open = virtio_video_device_open,
- .release = virtio_video_device_release,
- .poll = v4l2_m2m_fop_poll,
- .unlocked_ioctl = video_ioctl2,
- .mmap = v4l2_m2m_fop_mmap,
-};
-
-static const struct v4l2_file_operations virtio_video_device_fops = {
- .owner = THIS_MODULE,
- .open = virtio_video_device_open,
- .release = virtio_video_device_release,
- .poll = vb2_fop_poll,
- .unlocked_ioctl = video_ioctl2,
- .mmap = vb2_fop_mmap,
-};
-
-static void virtio_video_device_run(void *priv)
-{
-
-}
-
-static void virtio_video_device_job_abort(void *priv)
-{
- struct virtio_video_stream *stream = priv;
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
-
- v4l2_m2m_job_finish(vvd->m2m_dev, stream->fh.m2m_ctx);
-}
-
-static const struct v4l2_m2m_ops virtio_video_device_m2m_ops = {
- .device_run = virtio_video_device_run,
- .job_abort = virtio_video_device_job_abort,
-};
-
-static int virtio_video_device_register(struct virtio_video_device *vvd)
-{
- int ret;
- struct video_device *vd;
-
- vd = &vvd->video_dev;
-
-#if LINUX_VERSION_CODE >= KERNEL_VERSION(5,7,0)
- ret = video_register_device(vd, VFL_TYPE_VIDEO, vvd->vid_dev_nr);
-#else
- ret = video_register_device(vd, VFL_TYPE_GRABBER, vvd->vid_dev_nr);
-#endif
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to register video device\n");
- return ret;
- }
-
- v4l2_info(&vvd->v4l2_dev, "Device '%s' registered as /dev/video%d\n",
- vd->name, vd->num);
-
- return 0;
-}
-
-static void virtio_video_device_unregister(struct virtio_video_device *vvd)
-{
- video_unregister_device(&vvd->video_dev);
-}
-
-static int
-virtio_video_query_capability(struct virtio_video_device *vvd,
- void *resp_buf,
- enum virtio_video_queue_type queue_type)
-{
- int ret;
- int resp_size = vvd->max_caps_len;
-
- ret = virtio_video_cmd_query_capability(vvd, resp_buf, resp_size,
- queue_type);
- if (ret)
- v4l2_err(&vvd->v4l2_dev, "failed to query capability\n");
-
- return ret;
-}
-
-int virtio_video_device_init(struct virtio_video_device *vvd)
-{
- int ret;
- int vfl_dir;
- u32 dev_caps;
- struct video_device *vd;
- struct v4l2_m2m_dev *m2m_dev;
- const struct v4l2_file_operations *fops;
- void *input_resp_buf, *output_resp_buf;
-
- output_resp_buf = kzalloc(vvd->max_caps_len, GFP_KERNEL);
- if (!output_resp_buf)
- return -ENOMEM;
-
- ret = virtio_video_query_capability(vvd, output_resp_buf,
- VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to get output caps\n");
- goto err_output_cap;
- }
-
- if (vvd->is_m2m_dev) {
- input_resp_buf = kzalloc(vvd->max_caps_len, GFP_KERNEL);
- if (!input_resp_buf) {
- ret = -ENOMEM;
- goto err_input_buf;
- }
-
- ret = virtio_video_query_capability(vvd, input_resp_buf,
- VIRTIO_VIDEO_QUEUE_TYPE_INPUT);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to get input caps\n");
- goto err_input_cap;
- }
-
- m2m_dev = v4l2_m2m_init(&virtio_video_device_m2m_ops);
- if (IS_ERR(m2m_dev)) {
- v4l2_err(&vvd->v4l2_dev, "failed to init m2m device\n");
- ret = PTR_ERR(m2m_dev);
- goto err_m2m_dev;
- }
- vfl_dir = VFL_DIR_M2M;
- fops = &virtio_video_device_m2m_fops;
- dev_caps = V4L2_CAP_STREAMING | V4L2_CAP_VIDEO_M2M_MPLANE;
- } else {
- input_resp_buf = NULL;
- m2m_dev = NULL;
- vfl_dir = VFL_DIR_RX;
- fops = &virtio_video_device_fops;
- dev_caps = V4L2_CAP_STREAMING;
- if (vvd->is_mplane_cam)
- dev_caps |= V4L2_CAP_VIDEO_CAPTURE_MPLANE;
- else
- dev_caps |= V4L2_CAP_VIDEO_CAPTURE;
- }
-
- vvd->m2m_dev = m2m_dev;
- mutex_init(&vvd->video_dev_mutex);
- vd = &vvd->video_dev;
- vd->lock = &vvd->video_dev_mutex;
- vd->v4l2_dev = &vvd->v4l2_dev;
- vd->vfl_dir = vfl_dir;
- vd->ioctl_ops = NULL;
- vd->fops = fops;
- vd->device_caps = dev_caps;
- vd->release = video_device_release_empty;
-
- /* Use the selection API instead */
- v4l2_disable_ioctl(vd, VIDIOC_CROPCAP);
- v4l2_disable_ioctl(vd, VIDIOC_G_CROP);
-
- video_set_drvdata(vd, vvd);
-
- INIT_LIST_HEAD(&vvd->input_fmt_list);
- INIT_LIST_HEAD(&vvd->output_fmt_list);
- INIT_LIST_HEAD(&vvd->controls_fmt_list);
- INIT_LIST_HEAD(&vvd->pending_buf_list);
-
- vvd->num_output_fmts = 0;
- vvd->num_input_fmts = 0;
-
- switch (vvd->type) {
- case VIRTIO_VIDEO_DEVICE_CAMERA:
- virtio_video_cam_init(vvd);
- break;
- case VIRTIO_VIDEO_DEVICE_ENCODER:
- virtio_video_enc_init(vvd);
- break;
- case VIRTIO_VIDEO_DEVICE_DECODER:
- default:
- virtio_video_dec_init(vvd);
- break;
- }
-
- ret = virtio_video_parse_virtio_capabilities(vvd, input_resp_buf,
- output_resp_buf);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to parse a function\n");
- goto parse_cap_err;
- }
-
- ret = virtio_video_parse_virtio_control(vvd);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to query controls\n");
- goto parse_ctrl_err;
- }
-
- ret = virtio_video_device_register(vvd);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev,
- "failed to init virtio video device\n");
- goto register_err;
- }
-
- goto out_cleanup;
-
-register_err:
- virtio_video_clean_control(vvd);
-parse_ctrl_err:
- virtio_video_clean_capability(vvd);
-parse_cap_err:
- if (vvd->is_m2m_dev)
- v4l2_m2m_release(vvd->m2m_dev);
-err_m2m_dev:
-err_input_cap:
-out_cleanup:
- if (vvd->is_m2m_dev)
- kfree(input_resp_buf);
-err_input_buf:
-err_output_cap:
- kfree(output_resp_buf);
-
- return ret;
-}
-
-void virtio_video_device_deinit(struct virtio_video_device *vvd)
-{
- vvd->commandq.ready = false;
- vvd->eventq.ready = false;
-
- virtio_video_device_unregister(vvd);
- if (vvd->is_m2m_dev)
- v4l2_m2m_release(vvd->m2m_dev);
- virtio_video_clean_control(vvd);
- virtio_video_clean_capability(vvd);
-}
diff --git a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_driver.c b/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_driver.c
deleted file mode 100644
index 734c5b73..00000000
--- a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_driver.c
+++ /dev/null
@@ -1,246 +0,0 @@
-// SPDX-License-Identifier: GPL-2.0+
-/* Driver for virtio video device.
- *
- * Copyright 2020 OpenSynergy GmbH.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, see <http://www.gnu.org/licenses/>.
- */
-#include <linux/module.h>
-#include <linux/version.h>
-#if LINUX_VERSION_CODE >= KERNEL_VERSION(5,10,0)
-#include <linux/dma-map-ops.h>
-#else
-#include <linux/dma-mapping.h>
-#endif
-
-#include "virtio_video.h"
-
-static unsigned int debug;
-module_param(debug, uint, 0644);
-
-static unsigned int use_dma_mem;
-module_param(use_dma_mem, uint, 0644);
-MODULE_PARM_DESC(use_dma_mem, "Try to allocate buffers from the DMA zone");
-
-static int vid_nr_dec = -1;
-module_param(vid_nr_dec, int, 0644);
-MODULE_PARM_DESC(vid_nr_dec, "videoN start number, -1 is autodetect");
-
-static int vid_nr_enc = -1;
-module_param(vid_nr_enc, int, 0644);
-MODULE_PARM_DESC(vid_nr_enc, "videoN start number, -1 is autodetect");
-
-static int vid_nr_cam = -1;
-module_param(vid_nr_cam, int, 0644);
-MODULE_PARM_DESC(vid_nr_cam, "videoN start number, -1 is autodetect");
-
-static bool mplane_cam = true;
-module_param(mplane_cam, bool, 0644);
-MODULE_PARM_DESC(mplane_cam,
- "1 (default) - multiplanar camera, 0 - single planar camera");
-
-static int virtio_video_probe(struct virtio_device *vdev)
-{
- int ret;
- struct virtio_video_device *vvd;
- struct virtqueue *vqs[2];
- struct device *dev = &vdev->dev;
- struct device *pdev = dev->parent;
-
- static const char * const names[] = { "commandq", "eventq" };
- static vq_callback_t *callbacks[] = {
- virtio_video_cmd_cb,
- virtio_video_event_cb
- };
-
- if (!virtio_has_feature(vdev, VIRTIO_VIDEO_F_RESOURCE_GUEST_PAGES)) {
- dev_err(dev, "device must support guest allocated buffers\n");
- return -ENODEV;
- }
-
- vvd = devm_kzalloc(dev, sizeof(*vvd), GFP_KERNEL);
- if (!vvd)
- return -ENOMEM;
-
- vvd->is_m2m_dev = true;
-
- switch (vdev->id.device) {
- case VIRTIO_ID_VIDEO_CAM:
- vvd->is_m2m_dev = false;
- vvd->vid_dev_nr = vid_nr_cam;
- vvd->is_mplane_cam = mplane_cam;
- vvd->type = VIRTIO_VIDEO_DEVICE_CAMERA;
- break;
- case VIRTIO_ID_VIDEO_ENC:
- vvd->vid_dev_nr = vid_nr_enc;
- vvd->type = VIRTIO_VIDEO_DEVICE_ENCODER;
- break;
- case VIRTIO_ID_VIDEO_DEC:
- default:
- vvd->vid_dev_nr = vid_nr_dec;
- vvd->type = VIRTIO_VIDEO_DEVICE_DECODER;
- break;
- }
-
- vvd->vdev = vdev;
- vvd->debug = debug;
- vvd->use_dma_mem = use_dma_mem;
- vdev->priv = vvd;
-
- spin_lock_init(&vvd->pending_buf_list_lock);
- spin_lock_init(&vvd->resource_idr_lock);
- idr_init(&vvd->resource_idr);
- spin_lock_init(&vvd->stream_idr_lock);
- idr_init(&vvd->stream_idr);
-
- init_waitqueue_head(&vvd->wq);
-
- if (virtio_has_feature(vdev, VIRTIO_VIDEO_F_RESOURCE_NON_CONTIG))
- vvd->supp_non_contig = true;
-
-#if LINUX_VERSION_CODE >= KERNEL_VERSION(5,9,0)
- vvd->has_iommu = !virtio_has_dma_quirk(vdev);
-#else
- vvd->has_iommu = !virtio_has_iommu_quirk(vdev);
-#endif
-
- if (!dev->dma_ops)
- set_dma_ops(dev, pdev->dma_ops);
-
- /*
- * Set it to coherent_dma_mask by default if the architecture
- * code has not set it.
- */
- if (!dev->dma_mask)
- dev->dma_mask = &dev->coherent_dma_mask;
-
- dma_set_mask(dev, *pdev->dma_mask);
-
- dev_set_name(dev, "%s.%i", DRIVER_NAME, vdev->index);
- ret = v4l2_device_register(dev, &vvd->v4l2_dev);
- if (ret)
- goto err_v4l2_reg;
-
- spin_lock_init(&vvd->commandq.qlock);
- init_waitqueue_head(&vvd->commandq.reclaim_queue);
-
- INIT_WORK(&vvd->eventq.work, virtio_video_process_events);
-
- INIT_LIST_HEAD(&vvd->pending_vbuf_list);
-
- ret = virtio_find_vqs(vdev, 2, vqs, callbacks, names, NULL);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to find virt queues\n");
- goto err_vqs;
- }
-
- vvd->commandq.vq = vqs[0];
- vvd->eventq.vq = vqs[1];
-
- ret = virtio_video_alloc_vbufs(vvd);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to alloc vbufs\n");
- goto err_vbufs;
- }
-
- virtio_cread(vdev, struct virtio_video_config, max_caps_length,
- &vvd->max_caps_len);
- if (!vvd->max_caps_len) {
- v4l2_err(&vvd->v4l2_dev, "max_caps_len is zero\n");
- ret = -EINVAL;
- goto err_config;
- }
-
- virtio_cread(vdev, struct virtio_video_config, max_resp_length,
- &vvd->max_resp_len);
- if (!vvd->max_resp_len) {
- v4l2_err(&vvd->v4l2_dev, "max_resp_len is zero\n");
- ret = -EINVAL;
- goto err_config;
- }
-
- ret = virtio_video_alloc_events(vvd);
- if (ret)
- goto err_events;
-
- virtio_device_ready(vdev);
- vvd->commandq.ready = true;
- vvd->eventq.ready = true;
-
- ret = virtio_video_device_init(vvd);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev,
- "failed to init virtio video\n");
- goto err_init;
- }
-
- return 0;
-
-err_init:
-err_events:
-err_config:
- virtio_video_free_vbufs(vvd);
-err_vbufs:
- vdev->config->del_vqs(vdev);
-err_vqs:
- v4l2_device_unregister(&vvd->v4l2_dev);
-err_v4l2_reg:
- devm_kfree(&vdev->dev, vvd);
-
- return ret;
-}
-
-static void virtio_video_remove(struct virtio_device *vdev)
-{
- struct virtio_video_device *vvd = vdev->priv;
-
- virtio_video_device_deinit(vvd);
- virtio_video_free_vbufs(vvd);
- vdev->config->del_vqs(vdev);
- v4l2_device_unregister(&vvd->v4l2_dev);
- devm_kfree(&vdev->dev, vvd);
-}
-
-static struct virtio_device_id id_table[] = {
- { VIRTIO_ID_VIDEO_DEC, VIRTIO_DEV_ANY_ID },
- { VIRTIO_ID_VIDEO_ENC, VIRTIO_DEV_ANY_ID },
- { VIRTIO_ID_VIDEO_CAM, VIRTIO_DEV_ANY_ID },
- { 0 },
-};
-
-static unsigned int features[] = {
- VIRTIO_VIDEO_F_RESOURCE_GUEST_PAGES,
- VIRTIO_VIDEO_F_RESOURCE_NON_CONTIG,
-};
-
-static struct virtio_driver virtio_video_driver = {
- .feature_table = features,
- .feature_table_size = ARRAY_SIZE(features),
- .driver.name = DRIVER_NAME,
- .driver.owner = THIS_MODULE,
- .id_table = id_table,
- .probe = virtio_video_probe,
- .remove = virtio_video_remove,
-};
-
-module_virtio_driver(virtio_video_driver);
-
-MODULE_DEVICE_TABLE(virtio, id_table);
-MODULE_DESCRIPTION("virtio video driver");
-MODULE_AUTHOR("Dmitry Sepp <dmitry.sepp@opensynergy.com>");
-MODULE_AUTHOR("Kiran Pawar <kiran.pawar@opensynergy.com>");
-MODULE_AUTHOR("Nikolay Martyanov <nikolay.martyanov@opensynergy.com>");
-MODULE_AUTHOR("Samiullah Khawaja <samiullah.khawaja@opensynergy.com>");
-MODULE_VERSION(DRIVER_VERSION);
-MODULE_LICENSE("GPL");
diff --git a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_enc.c b/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_enc.c
deleted file mode 100644
index 66730bdb..00000000
--- a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_enc.c
+++ /dev/null
@@ -1,601 +0,0 @@
-// SPDX-License-Identifier: GPL-2.0+
-/* Encoder for virtio video device.
- *
- * Copyright 2020 OpenSynergy GmbH.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, see <http://www.gnu.org/licenses/>.
- */
-
-#include <linux/version.h>
-#include <media/v4l2-event.h>
-#include <media/v4l2-ioctl.h>
-
-#include "virtio_video.h"
-
-static int virtio_video_enc_start_streaming(struct vb2_queue *vq,
- unsigned int count)
-{
- struct virtio_video_stream *stream = vb2_get_drv_priv(vq);
- bool input_queue = V4L2_TYPE_IS_OUTPUT(vq->type);
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (virtio_video_state(stream) == STREAM_STATE_INIT ||
- (!input_queue &&
- virtio_video_state(stream) == STREAM_STATE_RESET) ||
- (input_queue &&
- virtio_video_state(stream) == STREAM_STATE_STOPPED))
- virtio_video_state_update(stream, STREAM_STATE_RUNNING);
-
- return 0;
-}
-
-static void virtio_video_enc_stop_streaming(struct vb2_queue *vq)
-{
- int ret, queue_type;
- struct virtio_video_stream *stream = vb2_get_drv_priv(vq);
-
- if (V4L2_TYPE_IS_OUTPUT(vq->type))
- queue_type = VIRTIO_VIDEO_QUEUE_TYPE_INPUT;
- else
- queue_type = VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT;
-
- ret = virtio_video_queue_release_buffers(stream, queue_type);
- if (ret)
- return;
-
- vb2_wait_for_all_buffers(vq);
-
- if (V4L2_TYPE_IS_OUTPUT(vq->type))
- virtio_video_state_update(stream, STREAM_STATE_STOPPED);
- else
- virtio_video_state_update(stream, STREAM_STATE_RESET);
-}
-
-static const struct vb2_ops virtio_video_enc_qops = {
- .queue_setup = virtio_video_queue_setup,
- .buf_init = virtio_video_buf_init,
- .buf_cleanup = virtio_video_buf_cleanup,
- .buf_queue = virtio_video_buf_queue,
- .start_streaming = virtio_video_enc_start_streaming,
- .stop_streaming = virtio_video_enc_stop_streaming,
- .wait_prepare = vb2_ops_wait_prepare,
- .wait_finish = vb2_ops_wait_finish,
-};
-
-static int virtio_video_enc_s_ctrl(struct v4l2_ctrl *ctrl)
-{
- int ret = 0;
- struct virtio_video_stream *stream = ctrl2stream(ctrl);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- uint32_t control, value;
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- control = virtio_video_v4l2_control_to_virtio(ctrl->id);
-
- switch (ctrl->id) {
- case V4L2_CID_MPEG_VIDEO_BITRATE:
- ret = virtio_video_cmd_set_control(vvd, stream->stream_id,
- control, ctrl->val);
- break;
- case V4L2_CID_MPEG_VIDEO_H264_LEVEL:
- value = virtio_video_v4l2_level_to_virtio(ctrl->val);
- ret = virtio_video_cmd_set_control(vvd, stream->stream_id,
- control, value);
- break;
- case V4L2_CID_MPEG_VIDEO_H264_PROFILE:
- value = virtio_video_v4l2_profile_to_virtio(ctrl->val);
- ret = virtio_video_cmd_set_control(vvd, stream->stream_id,
- control, value);
- break;
- default:
- ret = -EINVAL;
- break;
- }
-
- return ret;
-}
-
-static int virtio_video_enc_g_ctrl(struct v4l2_ctrl *ctrl)
-{
- int ret = 0;
- struct virtio_video_stream *stream = ctrl2stream(ctrl);
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- switch (ctrl->id) {
- case V4L2_CID_MIN_BUFFERS_FOR_OUTPUT:
- if (virtio_video_state(stream) >= STREAM_STATE_INIT)
- ctrl->val = stream->in_info.min_buffers;
- else
- ctrl->val = 0;
- break;
- default:
- ret = -EINVAL;
- break;
- }
-
- return ret;
-}
-
-static const struct v4l2_ctrl_ops virtio_video_enc_ctrl_ops = {
- .g_volatile_ctrl = virtio_video_enc_g_ctrl,
- .s_ctrl = virtio_video_enc_s_ctrl,
-};
-
-int virtio_video_enc_init_ctrls(struct virtio_video_stream *stream)
-{
- struct v4l2_ctrl *ctrl;
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct video_control_format *c_fmt = NULL;
-
- v4l2_ctrl_handler_init(&stream->ctrl_handler, 1);
-
- ctrl = v4l2_ctrl_new_std(&stream->ctrl_handler,
- &virtio_video_enc_ctrl_ops,
- V4L2_CID_MIN_BUFFERS_FOR_OUTPUT,
- MIN_BUFS_MIN, MIN_BUFS_MAX, MIN_BUFS_STEP,
- MIN_BUFS_DEF);
-
- if (ctrl)
- ctrl->flags |= V4L2_CTRL_FLAG_VOLATILE;
-
- list_for_each_entry(c_fmt, &vvd->controls_fmt_list,
- controls_list_entry) {
- switch (c_fmt->format) {
- case V4L2_PIX_FMT_H264:
- if (c_fmt->profile)
- v4l2_ctrl_new_std_menu
- (&stream->ctrl_handler,
- &virtio_video_enc_ctrl_ops,
- V4L2_CID_MPEG_VIDEO_H264_PROFILE,
- c_fmt->profile->max,
- c_fmt->profile->skip_mask,
- c_fmt->profile->min);
-
- if (c_fmt->level)
- v4l2_ctrl_new_std_menu
- (&stream->ctrl_handler,
- &virtio_video_enc_ctrl_ops,
- V4L2_CID_MPEG_VIDEO_H264_LEVEL,
- c_fmt->level->max,
- c_fmt->level->skip_mask,
- c_fmt->level->min);
- break;
- default:
- v4l2_dbg(1, vvd->debug,
- &vvd->v4l2_dev, "unsupported format\n");
- break;
- }
- }
-
- if (stream->control.bitrate) {
- v4l2_ctrl_new_std(&stream->ctrl_handler,
- &virtio_video_enc_ctrl_ops,
- V4L2_CID_MPEG_VIDEO_BITRATE,
- 1, S32_MAX,
- 1, stream->control.bitrate);
- }
-
- if (stream->ctrl_handler.error)
- return stream->ctrl_handler.error;
-
- v4l2_ctrl_handler_setup(&stream->ctrl_handler);
-
- return 0;
-}
-
-int virtio_video_enc_init_queues(void *priv, struct vb2_queue *src_vq,
- struct vb2_queue *dst_vq)
-{
- int ret;
- struct virtio_video_stream *stream = priv;
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct device *dev = vvd->v4l2_dev.dev;
-
- src_vq->type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
- src_vq->io_modes = VB2_MMAP | VB2_DMABUF;
- src_vq->drv_priv = stream;
- src_vq->buf_struct_size = sizeof(struct virtio_video_buffer);
- src_vq->ops = &virtio_video_enc_qops;
- src_vq->mem_ops = virtio_video_mem_ops(vvd);
- src_vq->min_buffers_needed = stream->in_info.min_buffers;
- src_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_COPY;
- src_vq->lock = &stream->vq_mutex;
- src_vq->gfp_flags = virtio_video_gfp_flags(vvd);
- src_vq->dev = dev;
-
- ret = vb2_queue_init(src_vq);
- if (ret)
- return ret;
-
- dst_vq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
- dst_vq->io_modes = VB2_MMAP | VB2_DMABUF;
- dst_vq->drv_priv = stream;
- dst_vq->buf_struct_size = sizeof(struct virtio_video_buffer);
- dst_vq->ops = &virtio_video_enc_qops;
- dst_vq->mem_ops = virtio_video_mem_ops(vvd);
- dst_vq->min_buffers_needed = stream->out_info.min_buffers;
- dst_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_COPY;
- dst_vq->lock = &stream->vq_mutex;
- dst_vq->gfp_flags = virtio_video_gfp_flags(vvd);
- dst_vq->dev = dev;
-
- return vb2_queue_init(dst_vq);
-}
-
-static int virtio_video_try_encoder_cmd(struct file *file, void *fh,
- struct v4l2_encoder_cmd *cmd)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = video_drvdata(file);
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (virtio_video_state(stream) == STREAM_STATE_DRAIN)
- return -EBUSY;
-
- switch (cmd->cmd) {
- case V4L2_ENC_CMD_STOP:
- case V4L2_ENC_CMD_START:
- if (cmd->flags != 0) {
- v4l2_err(&vvd->v4l2_dev, "flags=%u are not supported",
- cmd->flags);
- return -EINVAL;
- }
- break;
- default:
- return -EINVAL;
- }
-
- return 0;
-}
-
-static int virtio_video_encoder_cmd(struct file *file, void *fh,
- struct v4l2_encoder_cmd *cmd)
-{
- int ret;
- struct vb2_queue *src_vq, *dst_vq;
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = video_drvdata(file);
-
- ret = virtio_video_try_encoder_cmd(file, fh, cmd);
- if (ret < 0)
- return ret;
-
- dst_vq = v4l2_m2m_get_vq(stream->fh.m2m_ctx,
- V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE);
-
- switch (cmd->cmd) {
- case V4L2_ENC_CMD_START:
- vb2_clear_last_buffer_dequeued(dst_vq);
- virtio_video_state_update(stream, STREAM_STATE_RUNNING);
- break;
- case V4L2_ENC_CMD_STOP:
- src_vq = v4l2_m2m_get_vq(stream->fh.m2m_ctx,
- V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE);
-
- if (!vb2_is_streaming(src_vq)) {
- v4l2_dbg(1, vvd->debug,
- &vvd->v4l2_dev, "output is not streaming\n");
- return 0;
- }
-
- if (!vb2_is_streaming(dst_vq)) {
- v4l2_dbg(1, vvd->debug,
- &vvd->v4l2_dev, "capture is not streaming\n");
- return 0;
- }
-
- ret = virtio_video_cmd_stream_drain(vvd, stream->stream_id);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to drain stream\n");
- return ret;
- }
-
- virtio_video_state_update(stream, STREAM_STATE_DRAIN);
- break;
- default:
- return -EINVAL;
- }
-
- return 0;
-}
-
-static int virtio_video_enc_enum_fmt_vid_cap(struct file *file, void *fh,
- struct v4l2_fmtdesc *f)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct video_format *fmt;
- int idx = 0;
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
- return -EINVAL;
-
- if (f->index >= vvd->num_output_fmts)
- return -EINVAL;
-
- list_for_each_entry(fmt, &vvd->output_fmt_list, formats_list_entry) {
- if (f->index == idx) {
- f->pixelformat = fmt->desc.format;
- return 0;
- }
- idx++;
- }
- return -EINVAL;
-}
-
-static int virtio_video_enc_enum_fmt_vid_out(struct file *file, void *fh,
- struct v4l2_fmtdesc *f)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct video_format_info *info = NULL;
- struct video_format *fmt = NULL;
- unsigned long output_mask = 0;
- int idx = 0, bit_num = 0;
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (f->type != V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
- return -EINVAL;
-
- if (f->index >= vvd->num_input_fmts)
- return -EINVAL;
-
- info = &stream->out_info;
- list_for_each_entry(fmt, &vvd->output_fmt_list, formats_list_entry) {
- if (info->fourcc_format == fmt->desc.format) {
- output_mask = fmt->desc.mask;
- break;
- }
- }
-
- if (output_mask == 0)
- return -EINVAL;
-
- list_for_each_entry(fmt, &vvd->input_fmt_list, formats_list_entry) {
- if (test_bit(bit_num, &output_mask)) {
- if (f->index == idx) {
- f->pixelformat = fmt->desc.format;
- return 0;
- }
- idx++;
- }
- bit_num++;
- }
- return -EINVAL;
-}
-
-static int virtio_video_enc_s_fmt(struct file *file, void *fh,
- struct v4l2_format *f)
-{
- int ret;
- struct virtio_video_stream *stream = file2stream(file);
-
- ret = virtio_video_s_fmt(file, fh, f);
- if (ret)
- return ret;
-
- if (!V4L2_TYPE_IS_OUTPUT(f->type)) {
- if (virtio_video_state(stream) == STREAM_STATE_IDLE)
- virtio_video_state_update(stream, STREAM_STATE_INIT);
- }
-
- return 0;
-}
-
-static int virtio_video_enc_try_framerate(struct virtio_video_stream *stream,
- unsigned int fps)
-{
- int rate_idx;
- struct video_format_frame *frame = NULL;
-
- if (stream->current_frame == NULL)
- return -EINVAL;
-
- frame = stream->current_frame;
- for (rate_idx = 0; rate_idx < frame->frame.num_rates; rate_idx++) {
- struct virtio_video_format_range *frame_rate =
- &frame->frame_rates[rate_idx];
-
- if (within_range(frame_rate->min, fps, frame_rate->max))
- return 0;
- }
-
- return -EINVAL;
-}
-
-static void virtio_video_timeperframe_from_info(struct video_format_info *info,
- struct v4l2_fract *timeperframe)
-{
- timeperframe->numerator = 1;
- timeperframe->denominator = info->frame_rate;
-}
-
-static int virtio_video_enc_g_parm(struct file *file, void *priv,
- struct v4l2_streamparm *a)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct v4l2_outputparm *out = &a->parm.output;
- struct v4l2_fract *timeperframe = &out->timeperframe;
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (!V4L2_TYPE_IS_OUTPUT(a->type)) {
- v4l2_err(&vvd->v4l2_dev,
- "getting FPS is only possible for the output queue\n");
- return -EINVAL;
- }
-
- out->capability = V4L2_CAP_TIMEPERFRAME;
- virtio_video_timeperframe_from_info(&stream->in_info, timeperframe);
-
- return 0;
-}
-
-static int virtio_video_enc_s_parm(struct file *file, void *priv,
- struct v4l2_streamparm *a)
-{
- int ret;
- u64 frame_interval, frame_rate;
- struct video_format_info info;
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- struct v4l2_outputparm *out = &a->parm.output;
- struct v4l2_fract *timeperframe = &out->timeperframe;
-
- if (virtio_video_state(stream) == STREAM_STATE_ERROR)
- return -EIO;
-
- if (V4L2_TYPE_IS_OUTPUT(a->type)) {
- frame_interval = timeperframe->numerator * (u64)USEC_PER_SEC;
- do_div(frame_interval, timeperframe->denominator);
- if (!frame_interval)
- return -EINVAL;
-
- frame_rate = (u64)USEC_PER_SEC;
- do_div(frame_rate, frame_interval);
- } else {
- v4l2_err(&vvd->v4l2_dev,
- "setting FPS is only possible for the output queue\n");
- return -EINVAL;
- }
-
- ret = virtio_video_enc_try_framerate(stream, frame_rate);
- if (ret)
- return ret;
-
- virtio_video_format_fill_default_info(&info, &stream->in_info);
- info.frame_rate = frame_rate;
-
- virtio_video_cmd_set_params(vvd, stream, &info,
- VIRTIO_VIDEO_QUEUE_TYPE_INPUT);
- virtio_video_stream_get_params(vvd, stream);
-
- out->capability = V4L2_CAP_TIMEPERFRAME;
- virtio_video_timeperframe_from_info(&stream->in_info, timeperframe);
-
- return 0;
-}
-
-static int virtio_video_enc_s_selection(struct file *file, void *fh,
- struct v4l2_selection *sel)
-{
- struct virtio_video_stream *stream = file2stream(file);
- struct virtio_video_device *vvd = to_virtio_vd(stream->video_dev);
- int ret;
-
- if (!V4L2_TYPE_IS_OUTPUT(sel->type))
- return -EINVAL;
-
- switch (sel->target) {
- case V4L2_SEL_TGT_CROP:
- stream->in_info.crop.top = sel->r.top;
- stream->in_info.crop.left = sel->r.left;
- stream->in_info.crop.width = sel->r.width;
- stream->in_info.crop.height = sel->r.height;
- break;
- default:
- return -EINVAL;
- }
-
- ret = virtio_video_cmd_set_params(vvd, stream, &stream->in_info,
- VIRTIO_VIDEO_QUEUE_TYPE_INPUT);
- if (ret)
- return -EINVAL;
-
- return virtio_video_cmd_get_params(vvd, stream,
- VIRTIO_VIDEO_QUEUE_TYPE_INPUT);
-}
-
-static const struct v4l2_ioctl_ops virtio_video_enc_ioctl_ops = {
- .vidioc_querycap = virtio_video_querycap,
-
-#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 3, 0))
- .vidioc_enum_fmt_vid_cap = virtio_video_enc_enum_fmt_vid_cap,
- .vidioc_enum_fmt_vid_out = virtio_video_enc_enum_fmt_vid_out,
-#else
- .vidioc_enum_fmt_vid_cap_mplane = virtio_video_enc_enum_fmt_vid_cap,
- .vidioc_enum_fmt_vid_out_mplane = virtio_video_enc_enum_fmt_vid_out,
-#endif
- .vidioc_g_fmt_vid_cap_mplane = virtio_video_g_fmt,
- .vidioc_s_fmt_vid_cap_mplane = virtio_video_enc_s_fmt,
-
- .vidioc_g_fmt_vid_out_mplane = virtio_video_g_fmt,
- .vidioc_s_fmt_vid_out_mplane = virtio_video_enc_s_fmt,
-
- .vidioc_try_encoder_cmd = virtio_video_try_encoder_cmd,
- .vidioc_encoder_cmd = virtio_video_encoder_cmd,
- .vidioc_enum_frameintervals = virtio_video_enum_framemintervals,
- .vidioc_enum_framesizes = virtio_video_enum_framesizes,
-
- .vidioc_g_selection = virtio_video_g_selection,
- .vidioc_s_selection = virtio_video_enc_s_selection,
-
- .vidioc_reqbufs = virtio_video_reqbufs,
- .vidioc_querybuf = v4l2_m2m_ioctl_querybuf,
- .vidioc_qbuf = virtio_video_qbuf,
- .vidioc_dqbuf = virtio_video_dqbuf,
- .vidioc_prepare_buf = v4l2_m2m_ioctl_prepare_buf,
- .vidioc_create_bufs = v4l2_m2m_ioctl_create_bufs,
- .vidioc_expbuf = v4l2_m2m_ioctl_expbuf,
-
- .vidioc_streamon = v4l2_m2m_ioctl_streamon,
- .vidioc_streamoff = v4l2_m2m_ioctl_streamoff,
-
- .vidioc_s_parm = virtio_video_enc_s_parm,
- .vidioc_g_parm = virtio_video_enc_g_parm,
-
- .vidioc_subscribe_event = virtio_video_subscribe_event,
- .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
-};
-
-void *virtio_video_enc_get_fmt_list(struct virtio_video_device *vvd)
-{
- return &vvd->output_fmt_list;
-}
-
-static struct virtio_video_device_ops virtio_video_enc_ops = {
- .init_ctrls = virtio_video_enc_init_ctrls,
- .init_queues = virtio_video_enc_init_queues,
- .get_fmt_list = virtio_video_enc_get_fmt_list,
-};
-
-int virtio_video_enc_init(struct virtio_video_device *vvd)
-{
- ssize_t num;
- struct video_device *vd = &vvd->video_dev;
-
- vd->ioctl_ops = &virtio_video_enc_ioctl_ops;
- vvd->ops = &virtio_video_enc_ops;
-
- num = strscpy(vd->name, "stateful-encoder", sizeof(vd->name));
- if (num < 0)
- return num;
-
- return 0;
-}
diff --git a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_helpers.c b/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_helpers.c
deleted file mode 100644
index ac487053..00000000
--- a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_helpers.c
+++ /dev/null
@@ -1,289 +0,0 @@
-// SPDX-License-Identifier: GPL-2.0+
-/* Driver for virtio video device.
- *
- * Copyright 2020 OpenSynergy GmbH.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, see <http://www.gnu.org/licenses/>.
- */
-
-#include "virtio_video.h"
-
-struct virtio_video_convert_table {
- uint32_t virtio_value;
- uint32_t v4l2_value;
-};
-
-static struct virtio_video_convert_table level_table[] = {
- { VIRTIO_VIDEO_LEVEL_H264_1_0, V4L2_MPEG_VIDEO_H264_LEVEL_1_0 },
- { VIRTIO_VIDEO_LEVEL_H264_1_1, V4L2_MPEG_VIDEO_H264_LEVEL_1_1 },
- { VIRTIO_VIDEO_LEVEL_H264_1_2, V4L2_MPEG_VIDEO_H264_LEVEL_1_2 },
- { VIRTIO_VIDEO_LEVEL_H264_1_3, V4L2_MPEG_VIDEO_H264_LEVEL_1_3 },
- { VIRTIO_VIDEO_LEVEL_H264_2_0, V4L2_MPEG_VIDEO_H264_LEVEL_2_0 },
- { VIRTIO_VIDEO_LEVEL_H264_2_1, V4L2_MPEG_VIDEO_H264_LEVEL_2_1 },
- { VIRTIO_VIDEO_LEVEL_H264_2_2, V4L2_MPEG_VIDEO_H264_LEVEL_2_2 },
- { VIRTIO_VIDEO_LEVEL_H264_3_0, V4L2_MPEG_VIDEO_H264_LEVEL_3_0 },
- { VIRTIO_VIDEO_LEVEL_H264_3_1, V4L2_MPEG_VIDEO_H264_LEVEL_3_1 },
- { VIRTIO_VIDEO_LEVEL_H264_3_2, V4L2_MPEG_VIDEO_H264_LEVEL_3_2 },
- { VIRTIO_VIDEO_LEVEL_H264_4_0, V4L2_MPEG_VIDEO_H264_LEVEL_4_0 },
- { VIRTIO_VIDEO_LEVEL_H264_4_1, V4L2_MPEG_VIDEO_H264_LEVEL_4_1 },
- { VIRTIO_VIDEO_LEVEL_H264_4_2, V4L2_MPEG_VIDEO_H264_LEVEL_4_2 },
- { VIRTIO_VIDEO_LEVEL_H264_5_0, V4L2_MPEG_VIDEO_H264_LEVEL_5_0 },
- { VIRTIO_VIDEO_LEVEL_H264_5_1, V4L2_MPEG_VIDEO_H264_LEVEL_5_1 },
- { 0 },
-};
-
-uint32_t virtio_video_level_to_v4l2(uint32_t level)
-{
- size_t idx;
-
- for (idx = 0; idx < ARRAY_SIZE(level_table); idx++) {
- if (level_table[idx].virtio_value == level)
- return level_table[idx].v4l2_value;
- }
-
- return 0;
-}
-
-uint32_t virtio_video_v4l2_level_to_virtio(uint32_t v4l2_level)
-{
- size_t idx;
-
- for (idx = 0; idx < ARRAY_SIZE(level_table); idx++) {
- if (level_table[idx].v4l2_value == v4l2_level)
- return level_table[idx].virtio_value;
- }
-
- return 0;
-}
-
-static struct virtio_video_convert_table profile_table[] = {
- { VIRTIO_VIDEO_PROFILE_H264_BASELINE,
- V4L2_MPEG_VIDEO_H264_PROFILE_BASELINE },
- { VIRTIO_VIDEO_PROFILE_H264_MAIN, V4L2_MPEG_VIDEO_H264_PROFILE_MAIN },
- { VIRTIO_VIDEO_PROFILE_H264_EXTENDED,
- V4L2_MPEG_VIDEO_H264_PROFILE_EXTENDED },
- { VIRTIO_VIDEO_PROFILE_H264_HIGH, V4L2_MPEG_VIDEO_H264_PROFILE_HIGH },
- { VIRTIO_VIDEO_PROFILE_H264_HIGH10PROFILE,
- V4L2_MPEG_VIDEO_H264_PROFILE_HIGH_10 },
- { VIRTIO_VIDEO_PROFILE_H264_HIGH422PROFILE,
- V4L2_MPEG_VIDEO_H264_PROFILE_HIGH_422},
- { VIRTIO_VIDEO_PROFILE_H264_HIGH444PREDICTIVEPROFILE,
- V4L2_MPEG_VIDEO_H264_PROFILE_HIGH_444_PREDICTIVE },
- { VIRTIO_VIDEO_PROFILE_H264_SCALABLEBASELINE,
- V4L2_MPEG_VIDEO_H264_PROFILE_SCALABLE_BASELINE },
- { VIRTIO_VIDEO_PROFILE_H264_SCALABLEHIGH,
- V4L2_MPEG_VIDEO_H264_PROFILE_SCALABLE_HIGH },
- { VIRTIO_VIDEO_PROFILE_H264_STEREOHIGH,
- V4L2_MPEG_VIDEO_H264_PROFILE_STEREO_HIGH },
- { VIRTIO_VIDEO_PROFILE_H264_MULTIVIEWHIGH,
- V4L2_MPEG_VIDEO_H264_PROFILE_MULTIVIEW_HIGH },
- { 0 },
-};
-
-uint32_t virtio_video_profile_to_v4l2(uint32_t profile)
-{
- size_t idx;
-
- for (idx = 0; idx < ARRAY_SIZE(profile_table); idx++) {
- if (profile_table[idx].virtio_value == profile)
- return profile_table[idx].v4l2_value;
- }
-
- return 0;
-}
-
-uint32_t virtio_video_v4l2_profile_to_virtio(uint32_t v4l2_profile)
-{
- size_t idx;
-
- for (idx = 0; idx < ARRAY_SIZE(profile_table); idx++) {
- if (profile_table[idx].v4l2_value == v4l2_profile)
- return profile_table[idx].virtio_value;
- }
-
- return 0;
-}
-
-static struct virtio_video_convert_table format_table[] = {
- { VIRTIO_VIDEO_FORMAT_ARGB8888, V4L2_PIX_FMT_ARGB32 },
- { VIRTIO_VIDEO_FORMAT_BGRA8888, V4L2_PIX_FMT_ABGR32 },
- { VIRTIO_VIDEO_FORMAT_RGBA8888, V4L2_PIX_FMT_RGB32 },
- { VIRTIO_VIDEO_FORMAT_NV12, V4L2_PIX_FMT_NV12 },
- { VIRTIO_VIDEO_FORMAT_YUV420, V4L2_PIX_FMT_YUV420 },
- { VIRTIO_VIDEO_FORMAT_YVU420, V4L2_PIX_FMT_YVU420 },
- { VIRTIO_VIDEO_FORMAT_YUV422, V4L2_PIX_FMT_YUYV },
- { VIRTIO_VIDEO_FORMAT_MPEG2, V4L2_PIX_FMT_MPEG2 },
- { VIRTIO_VIDEO_FORMAT_MPEG4, V4L2_PIX_FMT_MPEG4 },
- { VIRTIO_VIDEO_FORMAT_H264, V4L2_PIX_FMT_H264 },
- { VIRTIO_VIDEO_FORMAT_HEVC, V4L2_PIX_FMT_HEVC },
- { VIRTIO_VIDEO_FORMAT_VP8, V4L2_PIX_FMT_VP8 },
- { VIRTIO_VIDEO_FORMAT_VP9, V4L2_PIX_FMT_VP9 },
- { 0 },
-};
-
-uint32_t virtio_video_format_to_v4l2(uint32_t format)
-{
- size_t idx;
-
- for (idx = 0; idx < ARRAY_SIZE(format_table); idx++) {
- if (format_table[idx].virtio_value == format)
- return format_table[idx].v4l2_value;
- }
-
- return 0;
-}
-
-uint32_t virtio_video_v4l2_format_to_virtio(uint32_t v4l2_format)
-{
- size_t idx;
-
- for (idx = 0; idx < ARRAY_SIZE(format_table); idx++) {
- if (format_table[idx].v4l2_value == v4l2_format)
- return format_table[idx].virtio_value;
- }
-
- return 0;
-}
-
-static struct virtio_video_convert_table control_table[] = {
- { VIRTIO_VIDEO_CONTROL_BITRATE, V4L2_CID_MPEG_VIDEO_BITRATE },
- { VIRTIO_VIDEO_CONTROL_PROFILE, V4L2_CID_MPEG_VIDEO_H264_PROFILE },
- { VIRTIO_VIDEO_CONTROL_LEVEL, V4L2_CID_MPEG_VIDEO_H264_LEVEL },
- { 0 },
-};
-
-uint32_t virtio_video_control_to_v4l2(uint32_t control)
-{
- size_t idx;
-
- for (idx = 0; idx < ARRAY_SIZE(control_table); idx++) {
- if (control_table[idx].virtio_value == control)
- return control_table[idx].v4l2_value;
- }
-
- return 0;
-}
-
-uint32_t virtio_video_v4l2_control_to_virtio(uint32_t v4l2_control)
-{
- size_t idx;
-
- for (idx = 0; idx < ARRAY_SIZE(control_table); idx++) {
- if (control_table[idx].v4l2_value == v4l2_control)
- return control_table[idx].virtio_value;
- }
-
- return 0;
-}
-
-uint32_t virtio_video_get_format_from_virtio_profile(uint32_t virtio_profile)
-{
- if (virtio_profile >= VIRTIO_VIDEO_PROFILE_H264_MIN &&
- virtio_profile <= VIRTIO_VIDEO_PROFILE_H264_MAX)
- return VIRTIO_VIDEO_FORMAT_H264;
- else if (virtio_profile >= VIRTIO_VIDEO_PROFILE_HEVC_MIN &&
- virtio_profile <= VIRTIO_VIDEO_PROFILE_HEVC_MAX)
- return VIRTIO_VIDEO_FORMAT_HEVC;
- else if (virtio_profile >= VIRTIO_VIDEO_PROFILE_VP8_MIN &&
- virtio_profile <= VIRTIO_VIDEO_PROFILE_VP8_MAX)
- return VIRTIO_VIDEO_FORMAT_VP8;
- else if (virtio_profile >= VIRTIO_VIDEO_PROFILE_VP9_MIN &&
- virtio_profile <= VIRTIO_VIDEO_PROFILE_VP9_MAX)
- return VIRTIO_VIDEO_FORMAT_VP9;
-
- return 0;
-}
-
-struct video_format *virtio_video_find_video_format(struct list_head *fmts_list,
- uint32_t format)
-{
- struct video_format *fmt = NULL;
-
- list_for_each_entry(fmt, fmts_list, formats_list_entry) {
- if (fmt->desc.format == format)
- return fmt;
- }
-
- return NULL;
-}
-
-void virtio_video_format_from_info(struct video_format_info *info,
- struct v4l2_pix_format_mplane *pix_mp)
-{
- int i;
-
- pix_mp->width = info->frame_width;
- pix_mp->height = info->frame_height;
- pix_mp->field = V4L2_FIELD_NONE;
- pix_mp->colorspace = V4L2_COLORSPACE_REC709;
- pix_mp->xfer_func = 0;
- pix_mp->ycbcr_enc = 0;
- pix_mp->quantization = 0;
- memset(pix_mp->reserved, 0, sizeof(pix_mp->reserved));
- memset(pix_mp->plane_fmt[0].reserved, 0,
- sizeof(pix_mp->plane_fmt[0].reserved));
-
- pix_mp->num_planes = info->num_planes;
- pix_mp->pixelformat = info->fourcc_format;
-
- for (i = 0; i < info->num_planes; i++) {
- pix_mp->plane_fmt[i].bytesperline =
- info->plane_format[i].stride;
- pix_mp->plane_fmt[i].sizeimage =
- info->plane_format[i].plane_size;
- }
-}
-
-void virtio_video_format_fill_default_info(struct video_format_info *dst_info,
- struct video_format_info *src_info)
-{
- memcpy(dst_info, src_info, sizeof(*dst_info));
-}
-
-void virtio_video_pix_fmt_sp2mp(const struct v4l2_pix_format *pix,
- struct v4l2_pix_format_mplane *pix_mp)
-{
- memset(pix_mp->reserved, 0, sizeof(pix_mp->reserved));
- memset(&pix_mp->plane_fmt[0].reserved, 0,
- sizeof(pix_mp->plane_fmt[0].reserved));
- pix_mp->num_planes = 1;
- pix_mp->width = pix->width;
- pix_mp->height = pix->height;
- pix_mp->pixelformat = pix->pixelformat;
- pix_mp->field = pix->field;
- pix_mp->plane_fmt[0].bytesperline = pix->bytesperline;
- pix_mp->plane_fmt[0].sizeimage = pix->sizeimage;
- pix_mp->colorspace = pix->colorspace;
- pix_mp->flags = pix->flags;
- pix_mp->ycbcr_enc = pix->ycbcr_enc;
- pix_mp->quantization = pix->quantization;
- pix_mp->xfer_func = pix->xfer_func;
-}
-
-void virtio_video_pix_fmt_mp2sp(const struct v4l2_pix_format_mplane *pix_mp,
- struct v4l2_pix_format *pix)
-{
- pix->width = pix_mp->width;
- pix->height = pix_mp->height;
- pix->pixelformat = pix_mp->pixelformat;
- pix->field = pix_mp->field;
- pix->bytesperline = pix_mp->plane_fmt[0].bytesperline;
- pix->sizeimage = pix_mp->plane_fmt[0].sizeimage;
- pix->colorspace = pix_mp->colorspace;
- pix->priv = 0;
- pix->flags = pix_mp->flags;
- pix->ycbcr_enc = pix_mp->ycbcr_enc;
- pix->quantization = pix_mp->quantization;
- pix->xfer_func = pix_mp->xfer_func;
-}
diff --git a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_vq.c b/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_vq.c
deleted file mode 100644
index f3c97c7e..00000000
--- a/meta-egvirt/recipes-kernel/kernel-module-virtio-video/files/virtio_video_vq.c
+++ /dev/null
@@ -1,981 +0,0 @@
-// SPDX-License-Identifier: GPL-2.0+
-/* Driver for virtio video device.
- *
- * Copyright 2020 OpenSynergy GmbH.
- *
- * Based on drivers/gpu/drm/virtio/virtgpu_vq.c
- * Copyright (C) 2015 Red Hat, Inc.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, see <http://www.gnu.org/licenses/>.
- */
-
-#include "virtio_video.h"
-
-#define MAX_INLINE_CMD_SIZE 298
-#define MAX_INLINE_RESP_SIZE 298
-#define VBUFFER_SIZE (sizeof(struct virtio_video_vbuffer) \
- + MAX_INLINE_CMD_SIZE \
- + MAX_INLINE_RESP_SIZE)
-
-static int virtio_video_queue_event_buffer(struct virtio_video_device *vvd,
- struct virtio_video_event *evt);
-static void virtio_video_handle_event(struct virtio_video_device *vvd,
- struct virtio_video_event *evt);
-
-void virtio_video_resource_id_get(struct virtio_video_device *vvd, uint32_t *id)
-{
- int handle;
-
- idr_preload(GFP_KERNEL);
- spin_lock(&vvd->resource_idr_lock);
- handle = idr_alloc(&vvd->resource_idr, NULL, 1, 0, GFP_NOWAIT);
- spin_unlock(&vvd->resource_idr_lock);
- idr_preload_end();
- *id = handle;
-}
-
-void virtio_video_resource_id_put(struct virtio_video_device *vvd, uint32_t id)
-{
- spin_lock(&vvd->resource_idr_lock);
- idr_remove(&vvd->resource_idr, id);
- spin_unlock(&vvd->resource_idr_lock);
-}
-
-void virtio_video_stream_id_get(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- uint32_t *id)
-{
- int handle;
-
- idr_preload(GFP_KERNEL);
- spin_lock(&vvd->stream_idr_lock);
- handle = idr_alloc(&vvd->stream_idr, stream, 1, 0, 0);
- spin_unlock(&vvd->stream_idr_lock);
- idr_preload_end();
- *id = handle;
-}
-
-void virtio_video_stream_id_put(struct virtio_video_device *vvd, uint32_t id)
-{
- spin_lock(&vvd->stream_idr_lock);
- idr_remove(&vvd->stream_idr, id);
- spin_unlock(&vvd->stream_idr_lock);
-}
-
-static bool vbuf_is_pending(struct virtio_video_device *vvd,
- struct virtio_video_vbuffer *vbuf)
-{
- struct virtio_video_vbuffer *entry;
-
- list_for_each_entry(entry, &vvd->pending_vbuf_list, pending_list_entry)
- {
- if (entry == vbuf && entry->id == vbuf->id)
- return true;
- }
-
- return false;
-}
-
-static void free_vbuf(struct virtio_video_device *vvd,
- struct virtio_video_vbuffer *vbuf)
-{
- list_del(&vbuf->pending_list_entry);
- kfree(vbuf->data_buf);
- kmem_cache_free(vvd->vbufs, vbuf);
-}
-
-void virtio_video_cmd_cb(struct virtqueue *vq)
-{
- struct virtio_video_device *vvd = vq->vdev->priv;
- struct virtio_video_vbuffer *vbuf;
- unsigned long flags;
- unsigned int len;
-
- spin_lock_irqsave(&vvd->commandq.qlock, flags);
- while (vvd->commandq.ready) {
- virtqueue_disable_cb(vq);
-
- while ((vbuf = virtqueue_get_buf(vq, &len))) {
- if (!vbuf_is_pending(vvd, vbuf))
- continue;
-
- if (vbuf->resp_cb)
- vbuf->resp_cb(vvd, vbuf);
-
- if (vbuf->is_sync)
- complete(&vbuf->reclaimed);
- else
- free_vbuf(vvd, vbuf);
- }
-
- if (unlikely(virtqueue_is_broken(vq)))
- break;
-
- if (virtqueue_enable_cb(vq))
- break;
- }
- spin_unlock_irqrestore(&vvd->commandq.qlock, flags);
-
- wake_up(&vvd->commandq.reclaim_queue);
-}
-
-void virtio_video_process_events(struct work_struct *work)
-{
- struct virtio_video_device *vvd = container_of(work,
- struct virtio_video_device, eventq.work);
- struct virtqueue *vq = vvd->eventq.vq;
- struct virtio_video_event *evt;
- unsigned int len;
-
- while (vvd->eventq.ready) {
- virtqueue_disable_cb(vq);
-
- while ((evt = virtqueue_get_buf(vq, &len))) {
- virtio_video_handle_event(vvd, evt);
- virtio_video_queue_event_buffer(vvd, evt);
- }
-
- if (unlikely(virtqueue_is_broken(vq)))
- break;
-
- if (virtqueue_enable_cb(vq))
- break;
- }
-}
-
-void virtio_video_event_cb(struct virtqueue *vq)
-{
- struct virtio_video_device *vvd = vq->vdev->priv;
-
- schedule_work(&vvd->eventq.work);
-}
-
-static struct virtio_video_vbuffer *
-virtio_video_get_vbuf(struct virtio_video_device *vvd, int size, int resp_size,
- void *resp_buf, virtio_video_resp_cb resp_cb)
-{
- struct virtio_video_vbuffer *vbuf;
-
- vbuf = kmem_cache_alloc(vvd->vbufs, GFP_KERNEL);
- if (!vbuf)
- return ERR_PTR(-ENOMEM);
- memset(vbuf, 0, VBUFFER_SIZE);
-
- BUG_ON(size > MAX_INLINE_CMD_SIZE);
- vbuf->buf = (void *)vbuf + sizeof(*vbuf);
- vbuf->size = size;
-
- vbuf->resp_cb = resp_cb;
- vbuf->resp_size = resp_size;
- if (resp_size <= MAX_INLINE_RESP_SIZE && !resp_buf)
- vbuf->resp_buf = (void *)vbuf->buf + size;
- else
- vbuf->resp_buf = resp_buf;
- BUG_ON(!vbuf->resp_buf);
-
- return vbuf;
-}
-
-int virtio_video_alloc_vbufs(struct virtio_video_device *vvd)
-{
- vvd->vbufs =
- kmem_cache_create("virtio-video-vbufs", VBUFFER_SIZE,
- __alignof__(struct virtio_video_vbuffer), 0,
- NULL);
- if (!vvd->vbufs)
- return -ENOMEM;
-
- return 0;
-}
-
-void virtio_video_free_vbufs(struct virtio_video_device *vvd)
-{
- struct virtio_video_vbuffer *vbuf;
-
- /* Release command buffers. Operation on vbufs here is lock safe,
- since before device was deinitialized and queues was stopped
- (in not ready state) */
- while ((vbuf = virtqueue_detach_unused_buf(vvd->commandq.vq))) {
- if (vbuf_is_pending(vvd, vbuf))
- free_vbuf(vvd, vbuf);
- }
-
- kmem_cache_destroy(vvd->vbufs);
- vvd->vbufs = NULL;
-
- /* Release event buffers */
- while (virtqueue_detach_unused_buf(vvd->eventq.vq));
-
- kfree(vvd->evts);
- vvd->evts = NULL;
-}
-
-static void *virtio_video_alloc_req(struct virtio_video_device *vvd,
- struct virtio_video_vbuffer **vbuffer_p,
- int size)
-{
- struct virtio_video_vbuffer *vbuf;
-
- vbuf = virtio_video_get_vbuf(vvd, size,
- sizeof(struct virtio_video_cmd_hdr),
- NULL, NULL);
- if (IS_ERR(vbuf)) {
- *vbuffer_p = NULL;
- return ERR_CAST(vbuf);
- }
- *vbuffer_p = vbuf;
-
- return vbuf->buf;
-}
-
-static void *
-virtio_video_alloc_req_resp(struct virtio_video_device *vvd,
- virtio_video_resp_cb cb,
- struct virtio_video_vbuffer **vbuffer_p,
- int req_size, int resp_size,
- void *resp_buf)
-{
- struct virtio_video_vbuffer *vbuf;
-
- vbuf = virtio_video_get_vbuf(vvd, req_size, resp_size, resp_buf, cb);
- if (IS_ERR(vbuf)) {
- *vbuffer_p = NULL;
- return ERR_CAST(vbuf);
- }
- *vbuffer_p = vbuf;
-
- return vbuf->buf;
-}
-
-static int
-virtio_video_queue_cmd_buffer(struct virtio_video_device *vvd,
- struct virtio_video_vbuffer *vbuf)
-{
- unsigned long flags;
- struct virtqueue *vq = vvd->commandq.vq;
- struct scatterlist *sgs[3], vreq, vout, vresp;
- int outcnt = 0, incnt = 0;
- int ret;
-
- if (!vvd->commandq.ready)
- return -ENODEV;
-
- spin_lock_irqsave(&vvd->commandq.qlock, flags);
-
- vbuf->id = vvd->vbufs_sent++;
- list_add_tail(&vbuf->pending_list_entry, &vvd->pending_vbuf_list);
-
- sg_init_one(&vreq, vbuf->buf, vbuf->size);
- sgs[outcnt + incnt] = &vreq;
- outcnt++;
-
- if (vbuf->data_size) {
- sg_init_one(&vout, vbuf->data_buf, vbuf->data_size);
- sgs[outcnt + incnt] = &vout;
- outcnt++;
- }
-
- if (vbuf->resp_size) {
- sg_init_one(&vresp, vbuf->resp_buf, vbuf->resp_size);
- sgs[outcnt + incnt] = &vresp;
- incnt++;
- }
-
-retry:
- ret = virtqueue_add_sgs(vq, sgs, outcnt, incnt, vbuf, GFP_ATOMIC);
- if (ret == -ENOSPC) {
- spin_unlock_irqrestore(&vvd->commandq.qlock, flags);
- wait_event(vvd->commandq.reclaim_queue, vq->num_free);
- spin_lock_irqsave(&vvd->commandq.qlock, flags);
- goto retry;
- } else {
- virtqueue_kick(vq);
- }
-
- spin_unlock_irqrestore(&vvd->commandq.qlock, flags);
-
- return ret;
-}
-
-static int
-virtio_video_queue_cmd_buffer_sync(struct virtio_video_device *vvd,
- struct virtio_video_vbuffer *vbuf)
-{
- int ret;
- unsigned long rem;
- unsigned long flags;
-
- vbuf->is_sync = true;
- init_completion(&vbuf->reclaimed);
-
- ret = virtio_video_queue_cmd_buffer(vvd, vbuf);
- if (ret)
- return ret;
-
- rem = wait_for_completion_timeout(&vbuf->reclaimed, 5 * HZ);
- if (rem == 0)
- ret = -ETIMEDOUT;
-
- spin_lock_irqsave(&vvd->commandq.qlock, flags);
- if (vbuf_is_pending(vvd, vbuf))
- free_vbuf(vvd, vbuf);
- spin_unlock_irqrestore(&vvd->commandq.qlock, flags);
-
- return ret;
-}
-
-static int virtio_video_queue_event_buffer(struct virtio_video_device *vvd,
- struct virtio_video_event *evt)
-{
- int ret;
- struct scatterlist sg;
- struct virtqueue *vq = vvd->eventq.vq;
-
- memset(evt, 0, sizeof(struct virtio_video_event));
- sg_init_one(&sg, evt, sizeof(struct virtio_video_event));
-
- ret = virtqueue_add_inbuf(vq, &sg, 1, evt, GFP_KERNEL);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev, "failed to queue event buffer\n");
- return ret;
- }
-
- virtqueue_kick(vq);
-
- return 0;
-}
-
-static void virtio_video_handle_event(struct virtio_video_device *vvd,
- struct virtio_video_event *evt)
-{
- int ret;
- struct virtio_video_stream *stream;
- uint32_t stream_id = evt->stream_id;
- struct video_device *vd = &vvd->video_dev;
-
- mutex_lock(vd->lock);
-
- stream = idr_find(&vvd->stream_idr, stream_id);
- if (!stream) {
- v4l2_warn(&vvd->v4l2_dev, "stream_id=%u not found for event\n",
- stream_id);
- mutex_unlock(vd->lock);
- return;
- }
-
- switch (le32_to_cpu(evt->event_type)) {
- case VIRTIO_VIDEO_EVENT_DECODER_RESOLUTION_CHANGED:
- v4l2_dbg(1, vvd->debug, &vvd->v4l2_dev,
- "stream_id=%u: resolution change event\n", stream_id);
- virtio_video_cmd_get_params(vvd, stream,
- VIRTIO_VIDEO_QUEUE_TYPE_OUTPUT);
- virtio_video_queue_res_chg_event(stream);
- if (virtio_video_state(stream) == STREAM_STATE_INIT) {
- virtio_video_state_update(stream,
- STREAM_STATE_DYNAMIC_RES_CHANGE);
- wake_up(&vvd->wq);
- }
- break;
- case VIRTIO_VIDEO_EVENT_ERROR:
- v4l2_err(&vvd->v4l2_dev, "stream_id=%i: error event\n",
- stream_id);
- virtio_video_state_update(stream, STREAM_STATE_ERROR);
- virtio_video_handle_error(stream);
- break;
- default:
- v4l2_warn(&vvd->v4l2_dev, "stream_id=%i: unknown event\n",
- stream_id);
- break;
- }
-
- mutex_unlock(vd->lock);
-}
-
-int virtio_video_alloc_events(struct virtio_video_device *vvd)
-{
- int ret;
- size_t i;
- struct virtio_video_event *evts;
- size_t num = vvd->eventq.vq->num_free;
-
- evts = kzalloc(num * sizeof(struct virtio_video_event), GFP_KERNEL);
- if (!evts) {
- v4l2_err(&vvd->v4l2_dev, "failed to alloc event buffers!!!\n");
- return -ENOMEM;
- }
- vvd->evts = evts;
-
- for (i = 0; i < num; i++) {
- ret = virtio_video_queue_event_buffer(vvd, &evts[i]);
- if (ret) {
- v4l2_err(&vvd->v4l2_dev,
- "failed to queue event buffer\n");
- return ret;
- }
- }
-
- return 0;
-}
-
-// TODO: replace virtio_video_cmd_hdr accoring to specification v4
-int virtio_video_cmd_stream_create(struct virtio_video_device *vvd,
- uint32_t stream_id,
- enum virtio_video_format format,
- const char *tag)
-{
- struct virtio_video_stream_create *req_p;
- struct virtio_video_vbuffer *vbuf;
-
- req_p = virtio_video_alloc_req(vvd, &vbuf, sizeof(*req_p));
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->hdr.type = cpu_to_le32(VIRTIO_VIDEO_CMD_STREAM_CREATE);
- req_p->hdr.stream_id = cpu_to_le32(stream_id);
- req_p->in_mem_type = cpu_to_le32(VIRTIO_VIDEO_MEM_TYPE_GUEST_PAGES);
- req_p->out_mem_type = cpu_to_le32(VIRTIO_VIDEO_MEM_TYPE_GUEST_PAGES);
- req_p->coded_format = cpu_to_le32(format);
- if (strscpy(req_p->tag, tag, sizeof(req_p->tag) - 1) < 0)
- v4l2_err(&vvd->v4l2_dev, "failed to copy stream tag\n");
- req_p->tag[sizeof(req_p->tag) - 1] = 0;
-
- return virtio_video_queue_cmd_buffer(vvd, vbuf);
-}
-
-// TODO: replace virtio_video_cmd_hdr accoring to specification v4
-int virtio_video_cmd_stream_destroy(struct virtio_video_device *vvd,
- uint32_t stream_id)
-{
- struct virtio_video_stream_destroy *req_p;
- struct virtio_video_vbuffer *vbuf;
-
- req_p = virtio_video_alloc_req(vvd, &vbuf, sizeof(*req_p));
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->hdr.type = cpu_to_le32(VIRTIO_VIDEO_CMD_STREAM_DESTROY);
- req_p->hdr.stream_id = cpu_to_le32(stream_id);
-
- return virtio_video_queue_cmd_buffer(vvd, vbuf);
-}
-
-// TODO: replace virtio_video_cmd_hdr accoring to specification v4
-int virtio_video_cmd_stream_drain(struct virtio_video_device *vvd,
- uint32_t stream_id)
-{
- struct virtio_video_stream_drain *req_p;
- struct virtio_video_vbuffer *vbuf;
-
- req_p = virtio_video_alloc_req(vvd, &vbuf, sizeof(*req_p));
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->hdr.type = cpu_to_le32(VIRTIO_VIDEO_CMD_STREAM_DRAIN);
- req_p->hdr.stream_id = cpu_to_le32(stream_id);
-
- return virtio_video_queue_cmd_buffer(vvd, vbuf);
-}
-
-int virtio_video_cmd_resource_attach(struct virtio_video_device *vvd,
- uint32_t stream_id, uint32_t resource_id,
- enum virtio_video_queue_type queue_type,
- void *buf, size_t buf_size)
-{
- struct virtio_video_resource_attach *req_p;
- struct virtio_video_vbuffer *vbuf;
-
- req_p = virtio_video_alloc_req(vvd, &vbuf, sizeof(*req_p));
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->cmd_type = cpu_to_le32(VIRTIO_VIDEO_CMD_RESOURCE_ATTACH);
- req_p->stream_id = cpu_to_le32(stream_id);
- req_p->queue_type = cpu_to_le32(queue_type);
- req_p->resource_id = cpu_to_le32(resource_id);
-
- vbuf->data_buf = buf;
- vbuf->data_size = buf_size;
-
- return virtio_video_queue_cmd_buffer(vvd, vbuf);
-}
-
-int virtio_video_cmd_queue_detach_resources(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- enum virtio_video_queue_type queue_type)
-{
- int ret;
- struct virtio_video_queue_detach_resources *req_p;
- struct virtio_video_vbuffer *vbuf;
-
- req_p = virtio_video_alloc_req(vvd, &vbuf, sizeof(*req_p));
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->cmd_type = cpu_to_le32(VIRTIO_VIDEO_CMD_QUEUE_DETACH_RESOURCES);
- req_p->stream_id = cpu_to_le32(stream->stream_id);
- req_p->queue_type = cpu_to_le32(queue_type);
-
- ret = virtio_video_queue_cmd_buffer_sync(vvd, vbuf);
- if (ret == -ETIMEDOUT)
- v4l2_err(&vvd->v4l2_dev,
- "timed out waiting for resource destruction for %s\n",
- (queue_type == VIRTIO_VIDEO_QUEUE_TYPE_INPUT) ?
- "OUTPUT" : "CAPTURE");
- return ret;
-}
-
-static void
-virtio_video_cmd_resource_queue_cb(struct virtio_video_device *vvd,
- struct virtio_video_vbuffer *vbuf)
-{
- uint32_t flags;
- uint64_t timestamp;
- struct virtio_video_buffer *virtio_vb = vbuf->priv;
- struct virtio_video_resource_queue_resp *resp =
- (struct virtio_video_resource_queue_resp *)vbuf->resp_buf;
-
- flags = le32_to_cpu(resp->flags);
- timestamp = le64_to_cpu(resp->timestamp);
-
- virtio_video_buf_done(virtio_vb, flags, timestamp, resp->data_sizes);
-}
-
-int virtio_video_cmd_resource_queue(struct virtio_video_device *vvd,
- uint32_t stream_id,
- struct virtio_video_buffer *virtio_vb,
- uint32_t data_size[],
- uint8_t num_data_size,
- enum virtio_video_queue_type queue_type)
-{
- uint8_t i;
- struct virtio_video_resource_queue *req_p;
- struct virtio_video_resource_queue_resp *resp_p;
- struct virtio_video_vbuffer *vbuf;
- size_t resp_size = sizeof(struct virtio_video_resource_queue_resp);
-
- req_p = virtio_video_alloc_req_resp(vvd,
- &virtio_video_cmd_resource_queue_cb,
- &vbuf, sizeof(*req_p), resp_size,
- NULL);
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->cmd_type = cpu_to_le32(VIRTIO_VIDEO_CMD_RESOURCE_QUEUE);
- req_p->stream_id = cpu_to_le32(stream_id);
- req_p->queue_type = cpu_to_le32(queue_type);
- req_p->resource_id = cpu_to_le32(virtio_vb->resource_id);
- req_p->flags = 0;
- req_p->timestamp =
- cpu_to_le64(virtio_vb->v4l2_m2m_vb.vb.vb2_buf.timestamp);
-
- for (i = 0; i < num_data_size; ++i)
- req_p->data_sizes[i] = cpu_to_le32(data_size[i]);
-
- resp_p = (struct virtio_video_resource_queue_resp *)vbuf->resp_buf;
- memset(resp_p, 0, sizeof(*resp_p));
-
- vbuf->priv = virtio_vb;
-
- return virtio_video_queue_cmd_buffer(vvd, vbuf);
-}
-
-// TODO: replace virtio_video_cmd_hdr accoring to specification v4
-int virtio_video_cmd_queue_clear(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- enum virtio_video_queue_type queue_type)
-{
- int ret;
- struct virtio_video_queue_clear *req_p;
- struct virtio_video_vbuffer *vbuf;
-
- req_p = virtio_video_alloc_req(vvd, &vbuf, sizeof(*req_p));
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->hdr.type = cpu_to_le32(VIRTIO_VIDEO_CMD_QUEUE_CLEAR);
- req_p->hdr.stream_id = cpu_to_le32(stream->stream_id);
- req_p->queue_type = cpu_to_le32(queue_type);
-
- ret = virtio_video_queue_cmd_buffer_sync(vvd, vbuf);
- if (ret == -ETIMEDOUT)
- v4l2_err(&vvd->v4l2_dev,
- "timed out waiting for %s queue clear\n",
- (queue_type == VIRTIO_VIDEO_QUEUE_TYPE_INPUT) ?
- "OUTPUT" : "CAPTURE");
- return ret;
-}
-
-// TODO: replace virtio_video_cmd_hdr accoring to specification v4
-int virtio_video_cmd_query_capability(struct virtio_video_device *vvd,
- void *resp_buf, size_t resp_size,
- enum virtio_video_queue_type queue_type)
-{
- int ret;
- struct virtio_video_query_capability *req_p;
- struct virtio_video_vbuffer *vbuf;
-
- req_p = virtio_video_alloc_req_resp(vvd, NULL, &vbuf, sizeof(*req_p),
- resp_size, resp_buf);
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->hdr.type = cpu_to_le32(VIRTIO_VIDEO_CMD_QUERY_CAPABILITY);
- req_p->queue_type = cpu_to_le32(queue_type);
-
- ret = virtio_video_queue_cmd_buffer_sync(vvd, vbuf);
- if (ret == -ETIMEDOUT)
- v4l2_err(&vvd->v4l2_dev,
- "timed out waiting for capabilities for %s\n",
- (queue_type == VIRTIO_VIDEO_QUEUE_TYPE_INPUT) ?
- "OUTPUT" : "CAPTURE");
- return ret;
-}
-
-// TODO: replace virtio_video_cmd_hdr accoring to specification v4
-int virtio_video_query_control_level(struct virtio_video_device *vvd,
- void *resp_buf, size_t resp_size,
- enum virtio_video_format format)
-{
- int ret;
- struct virtio_video_query_control *req_p;
- struct virtio_video_query_control_level *ctrl_l;
- struct virtio_video_vbuffer *vbuf;
- uint32_t req_size = 0;
-
- req_size = sizeof(struct virtio_video_query_control) +
- sizeof(struct virtio_video_query_control_level);
-
- req_p = virtio_video_alloc_req_resp(vvd, NULL, &vbuf, req_size,
- resp_size, resp_buf);
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->hdr.type = cpu_to_le32(VIRTIO_VIDEO_CMD_QUERY_CONTROL);
- req_p->control = cpu_to_le32(VIRTIO_VIDEO_CONTROL_LEVEL);
- ctrl_l = (void *)((char *)req_p +
- sizeof(struct virtio_video_query_control));
- ctrl_l->format = cpu_to_le32(format);
-
- ret = virtio_video_queue_cmd_buffer_sync(vvd, vbuf);
- if (ret == -ETIMEDOUT)
- v4l2_err(&vvd->v4l2_dev,
- "timed out waiting for level query\n");
- return ret;
-}
-
-// TODO: replace virtio_video_cmd_hdr accoring to specification v4
-int virtio_video_query_control_profile(struct virtio_video_device *vvd,
- void *resp_buf, size_t resp_size,
- enum virtio_video_format format)
-{
- int ret;
- struct virtio_video_query_control *req_p;
- struct virtio_video_query_control_profile *ctrl_p;
- struct virtio_video_vbuffer *vbuf;
- uint32_t req_size = 0;
-
- req_size = sizeof(struct virtio_video_query_control) +
- sizeof(struct virtio_video_query_control_profile);
-
- req_p = virtio_video_alloc_req_resp(vvd, NULL, &vbuf, req_size,
- resp_size, resp_buf);
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->hdr.type = cpu_to_le32(VIRTIO_VIDEO_CMD_QUERY_CONTROL);
- req_p->control = cpu_to_le32(VIRTIO_VIDEO_CONTROL_PROFILE);
- ctrl_p = (void *)((char *)req_p +
- sizeof(struct virtio_video_query_control));
- ctrl_p->format = cpu_to_le32(format);
-
- ret = virtio_video_queue_cmd_buffer_sync(vvd, vbuf);
- if (ret == -ETIMEDOUT)
- v4l2_err(&vvd->v4l2_dev,
- "timed out waiting for profile query\n");
- return ret;
-}
-
-static void
-virtio_video_cmd_get_params_cb(struct virtio_video_device *vvd,
- struct virtio_video_vbuffer *vbuf)
-{
- int i;
- struct virtio_video_get_params_resp *resp =
- (struct virtio_video_get_params_resp *)vbuf->resp_buf;
- struct virtio_video_params *params = &resp->params;
- struct virtio_video_stream *stream = vbuf->priv;
- enum virtio_video_queue_type queue_type;
- struct video_format_info *format_info;
-
- queue_type = le32_to_cpu(params->queue_type);
- if (queue_type == VIRTIO_VIDEO_QUEUE_TYPE_INPUT)
- format_info = &stream->in_info;
- else
- format_info = &stream->out_info;
-
- format_info->frame_rate = le32_to_cpu(params->frame_rate);
- format_info->frame_width = le32_to_cpu(params->frame_width);
- format_info->frame_height = le32_to_cpu(params->frame_height);
- format_info->min_buffers = le32_to_cpu(params->min_buffers);
- format_info->max_buffers = le32_to_cpu(params->max_buffers);
- format_info->fourcc_format =
- virtio_video_format_to_v4l2(le32_to_cpu(params->format));
-
- format_info->crop.top = le32_to_cpu(params->crop.top);
- format_info->crop.left = le32_to_cpu(params->crop.left);
- format_info->crop.width = le32_to_cpu(params->crop.width);
- format_info->crop.height = le32_to_cpu(params->crop.height);
-
- format_info->num_planes = le32_to_cpu(params->num_planes);
- for (i = 0; i < le32_to_cpu(params->num_planes); i++) {
- struct virtio_video_plane_format *plane_formats =
- &params->plane_formats[i];
- struct video_plane_format *plane_format =
- &format_info->plane_format[i];
-
- plane_format->plane_size =
- le32_to_cpu(plane_formats->plane_size);
- plane_format->stride = le32_to_cpu(plane_formats->stride);
- }
-}
-
-// TODO: replace virtio_video_cmd_hdr accoring to specification v4
-int virtio_video_cmd_get_params(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- enum virtio_video_queue_type queue_type)
-{
- int ret;
- struct virtio_video_get_params *req_p;
- struct virtio_video_vbuffer *vbuf;
- struct virtio_video_get_params_resp *resp_p;
- size_t resp_size = sizeof(struct virtio_video_get_params_resp);
-
- req_p = virtio_video_alloc_req_resp(vvd,
- &virtio_video_cmd_get_params_cb,
- &vbuf, sizeof(*req_p), resp_size,
- NULL);
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->hdr.type = cpu_to_le32(VIRTIO_VIDEO_CMD_GET_PARAMS);
- req_p->hdr.stream_id = cpu_to_le32(stream->stream_id);
- req_p->queue_type = cpu_to_le32(queue_type);
-
- resp_p = (struct virtio_video_get_params_resp *)vbuf->resp_buf;
-
- vbuf->priv = stream;
-
- ret = virtio_video_queue_cmd_buffer_sync(vvd, vbuf);
- if (ret == -ETIMEDOUT)
- v4l2_err(&vvd->v4l2_dev,
- "timed out waiting for get_params\n");
- return ret;
-}
-
-// TODO: replace virtio_video_cmd_hdr accoring to specification v4
-int
-virtio_video_cmd_set_params(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- struct video_format_info *format_info,
- enum virtio_video_queue_type queue_type)
-{
- int i;
- struct virtio_video_set_params *req_p;
- struct virtio_video_vbuffer *vbuf;
-
- req_p = virtio_video_alloc_req(vvd, &vbuf, sizeof(*req_p));
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->hdr.type = cpu_to_le32(VIRTIO_VIDEO_CMD_SET_PARAMS);
- req_p->hdr.stream_id = cpu_to_le32(stream->stream_id);
- req_p->params.queue_type = cpu_to_le32(queue_type);
- req_p->params.frame_rate = cpu_to_le32(format_info->frame_rate);
- req_p->params.frame_width = cpu_to_le32(format_info->frame_width);
- req_p->params.frame_height = cpu_to_le32(format_info->frame_height);
- req_p->params.format = virtio_video_v4l2_format_to_virtio(
- cpu_to_le32(format_info->fourcc_format));
- req_p->params.min_buffers = cpu_to_le32(format_info->min_buffers);
- req_p->params.max_buffers = cpu_to_le32(format_info->max_buffers);
- req_p->params.num_planes = cpu_to_le32(format_info->num_planes);
-
- for (i = 0; i < format_info->num_planes; i++) {
- struct virtio_video_plane_format *plane_formats =
- &req_p->params.plane_formats[i];
- struct video_plane_format *plane_format =
- &format_info->plane_format[i];
- plane_formats->plane_size =
- cpu_to_le32(plane_format->plane_size);
- plane_formats->stride = cpu_to_le32(plane_format->stride);
- }
-
- return virtio_video_queue_cmd_buffer(vvd, vbuf);
-}
-
-static void
-virtio_video_cmd_get_ctrl_profile_cb(struct virtio_video_device *vvd,
- struct virtio_video_vbuffer *vbuf)
-{
- struct virtio_video_get_control_resp *resp =
- (struct virtio_video_get_control_resp *)vbuf->resp_buf;
- struct virtio_video_control_val_profile *resp_p = NULL;
- struct virtio_video_stream *stream = vbuf->priv;
- struct video_control_info *control = &stream->control;
-
- resp_p = (void *)((char *)resp +
- sizeof(struct virtio_video_get_control_resp));
-
- control->profile = le32_to_cpu(resp_p->profile);
-}
-
-static void
-virtio_video_cmd_get_ctrl_level_cb(struct virtio_video_device *vvd,
- struct virtio_video_vbuffer *vbuf)
-{
- struct virtio_video_get_control_resp *resp =
- (struct virtio_video_get_control_resp *)vbuf->resp_buf;
- struct virtio_video_control_val_level *resp_p;
- struct virtio_video_stream *stream = vbuf->priv;
- struct video_control_info *control = &stream->control;
-
- resp_p = (void *)((char *)resp +
- sizeof(struct virtio_video_get_control_resp));
-
- control->level = le32_to_cpu(resp_p->level);
-}
-
-static void
-virtio_video_cmd_get_ctrl_bitrate_cb(struct virtio_video_device *vvd,
- struct virtio_video_vbuffer *vbuf)
-{
- struct virtio_video_get_control_resp *resp =
- (struct virtio_video_get_control_resp *)vbuf->resp_buf;
- struct virtio_video_control_val_bitrate *resp_p = NULL;
- struct virtio_video_stream *stream = vbuf->priv;
- struct video_control_info *control = &stream->control;
-
- resp_p = (void *)((char *) resp +
- sizeof(struct virtio_video_get_control_resp));
-
- control->bitrate = le32_to_cpu(resp_p->bitrate);
-}
-
-// TODO: replace virtio_video_cmd_hdr accoring to specification v4
-int virtio_video_cmd_get_control(struct virtio_video_device *vvd,
- struct virtio_video_stream *stream,
- enum virtio_video_control_type control)
-{
- int ret;
- struct virtio_video_get_control *req_p;
- struct virtio_video_get_control_resp *resp_p;
- struct virtio_video_vbuffer *vbuf;
- size_t resp_size = sizeof(struct virtio_video_get_control_resp);
- virtio_video_resp_cb cb;
-
- switch (control) {
- case VIRTIO_VIDEO_CONTROL_PROFILE:
- resp_size += sizeof(struct virtio_video_control_val_profile);
- cb = &virtio_video_cmd_get_ctrl_profile_cb;
- break;
- case VIRTIO_VIDEO_CONTROL_LEVEL:
- resp_size += sizeof(struct virtio_video_control_val_level);
- cb = &virtio_video_cmd_get_ctrl_level_cb;
- break;
- case VIRTIO_VIDEO_CONTROL_BITRATE:
- resp_size += sizeof(struct virtio_video_control_val_bitrate);
- cb = &virtio_video_cmd_get_ctrl_bitrate_cb;
- break;
- default:
- return -EINVAL;
- }
-
- req_p = virtio_video_alloc_req_resp(vvd, cb, &vbuf,
- sizeof(*req_p), resp_size, NULL);
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->hdr.type = cpu_to_le32(VIRTIO_VIDEO_CMD_GET_CONTROL);
- req_p->hdr.stream_id = cpu_to_le32(stream->stream_id);
- req_p->control = cpu_to_le32(control);
-
- resp_p = (struct virtio_video_get_control_resp *)vbuf->resp_buf;
-
- vbuf->priv = stream;
-
- ret = virtio_video_queue_cmd_buffer_sync(vvd, vbuf);
- if (ret == -ETIMEDOUT)
- v4l2_err(&vvd->v4l2_dev,
- "timed out waiting for get_control\n");
- return ret;
-}
-
-// TODO: replace virtio_video_cmd_hdr accoring to specification v4
-int virtio_video_cmd_set_control(struct virtio_video_device *vvd,
- uint32_t stream_id,
- enum virtio_video_control_type control,
- uint32_t value)
-{
- struct virtio_video_set_control *req_p;
- struct virtio_video_vbuffer *vbuf;
- struct virtio_video_control_val_level *ctrl_l;
- struct virtio_video_control_val_profile *ctrl_p;
- struct virtio_video_control_val_bitrate *ctrl_b;
- size_t size;
-
- if (value == 0)
- return -EINVAL;
-
- switch (control) {
- case VIRTIO_VIDEO_CONTROL_PROFILE:
- size = sizeof(struct virtio_video_control_val_profile);
- break;
- case VIRTIO_VIDEO_CONTROL_LEVEL:
- size = sizeof(struct virtio_video_control_val_level);
- break;
- case VIRTIO_VIDEO_CONTROL_BITRATE:
- size = sizeof(struct virtio_video_control_val_bitrate);
- break;
- default:
- return -EINVAL;
- }
-
- req_p = virtio_video_alloc_req(vvd, &vbuf, size + sizeof(*req_p));
- if (IS_ERR(req_p))
- return PTR_ERR(req_p);
-
- req_p->hdr.type = cpu_to_le32(VIRTIO_VIDEO_CMD_SET_CONTROL);
- req_p->hdr.stream_id = cpu_to_le32(stream_id);
- req_p->control = cpu_to_le32(control);
-
- switch (control) {
- case VIRTIO_VIDEO_CONTROL_PROFILE:
- ctrl_p = (void *)((char *)req_p +
- sizeof(struct virtio_video_set_control));
- ctrl_p->profile = cpu_to_le32(value);
- break;
- case VIRTIO_VIDEO_CONTROL_LEVEL:
- ctrl_l = (void *)((char *)req_p +
- sizeof(struct virtio_video_set_control));
- ctrl_l->level = cpu_to_le32(value);
- break;
- case VIRTIO_VIDEO_CONTROL_BITRATE:
- ctrl_b = (void *)((char *)req_p +
- sizeof(struct virtio_video_set_control));
- ctrl_b->bitrate = cpu_to_le32(value);
- break;
- }
-
- return virtio_video_queue_cmd_buffer(vvd, vbuf);
-}
-