Introduce and use dedicated v4l2 helpers to replace inline ioctls
Signed-off-by: Paul Kocialkowski <paul.kocialkowski@bootlin.com>
This commit is contained in:
Paul Kocialkowski
+249
@@ -0,0 +1,249 @@
|
||||
/*
|
||||
* Copyright (C) 2018 Paul Kocialkowski <paul.kocialkowski@bootlin.com>
|
||||
*
|
||||
* Permission is hereby granted, free of charge, to any person obtaining a
|
||||
* copy of this software and associated documentation files (the
|
||||
* "Software"), to deal in the Software without restriction, including
|
||||
* without limitation the rights to use, copy, modify, merge, publish,
|
||||
* distribute, sub license, and/or sell copies of the Software, and to
|
||||
* permit persons to whom the Software is furnished to do so, subject to
|
||||
* the following conditions:
|
||||
*
|
||||
* The above copyright notice and this permission notice (including the
|
||||
* next paragraph) shall be included in all copies or substantial portions
|
||||
* of the Software.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
|
||||
* OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.
|
||||
* IN NO EVENT SHALL PRECISION INSIGHT AND/OR ITS SUPPLIERS BE LIABLE FOR
|
||||
* ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
|
||||
* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
|
||||
* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
||||
*/
|
||||
|
||||
#include <stdlib.h>
|
||||
|
||||
#include <linux/videodev2.h>
|
||||
|
||||
#include "sunxi_cedrus.h"
|
||||
#include "v4l2.h"
|
||||
|
||||
bool v4l2_find_format(int video_fd, unsigned int type, unsigned int pixelformat)
|
||||
{
|
||||
struct v4l2_fmtdesc fmtdesc;
|
||||
int rc;
|
||||
|
||||
memset(&fmtdesc, 0, sizeof(fmtdesc));
|
||||
fmtdesc.type = type;
|
||||
fmtdesc.index = 0;
|
||||
|
||||
do {
|
||||
rc = ioctl(video_fd, VIDIOC_ENUM_FMT, &fmtdesc);
|
||||
if (rc < 0)
|
||||
break;
|
||||
|
||||
if (fmtdesc.pixelformat == pixelformat)
|
||||
return true;
|
||||
|
||||
fmtdesc.index++;
|
||||
} while (rc >= 0);
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
int v4l2_set_format(int video_fd, unsigned int type, unsigned int pixelformat,
|
||||
unsigned int width, unsigned int height)
|
||||
{
|
||||
struct v4l2_format format;
|
||||
int rc;
|
||||
|
||||
memset(&format, 0, sizeof(format));
|
||||
format.type = type;
|
||||
format.fmt.pix_mp.width = width;
|
||||
format.fmt.pix_mp.height = height;
|
||||
format.fmt.pix_mp.plane_fmt[0].sizeimage = type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE ? DESTINATION_SIZE_MAX : 0;
|
||||
format.fmt.pix_mp.pixelformat = pixelformat;
|
||||
format.fmt.pix_mp.field = V4L2_FIELD_ANY;
|
||||
format.fmt.pix_mp.num_planes = type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE ? 2 : 1;
|
||||
|
||||
rc = ioctl(video_fd, VIDIOC_S_FMT, &format);
|
||||
if (rc < 0) {
|
||||
sunxi_cedrus_msg("Unable to set format for type %d: %s\n", type, strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int v4l2_create_buffers(int video_fd, unsigned int type,
|
||||
unsigned int buffers_count)
|
||||
{
|
||||
struct v4l2_create_buffers buffers;
|
||||
int rc;
|
||||
|
||||
memset(&buffers, 0, sizeof(buffers));
|
||||
buffers.format.type = type;
|
||||
buffers.memory = V4L2_MEMORY_MMAP;
|
||||
buffers.count = buffers_count;
|
||||
|
||||
rc = ioctl(video_fd, VIDIOC_G_FMT, &buffers.format);
|
||||
if (rc < 0) {
|
||||
sunxi_cedrus_msg("Unable to get format for type %d: %s\n", type, strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
|
||||
rc = ioctl(video_fd, VIDIOC_CREATE_BUFS, &buffers);
|
||||
if (rc < 0) {
|
||||
sunxi_cedrus_msg("Unable to create buffer for type %d: %s\n", type, strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int v4l2_request_buffer(int video_fd, unsigned int type, unsigned int index,
|
||||
unsigned int *length, unsigned int *offset)
|
||||
{
|
||||
struct v4l2_plane planes[2];
|
||||
struct v4l2_buffer buffer;
|
||||
int rc;
|
||||
|
||||
memset(planes, 0, sizeof(planes));
|
||||
memset(&buffer, 0, sizeof(buffer));
|
||||
|
||||
buffer.type = type;
|
||||
buffer.memory = V4L2_MEMORY_MMAP;
|
||||
buffer.index = index;
|
||||
buffer.length = type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE ? 2 : 1;
|
||||
buffer.m.planes = planes;
|
||||
|
||||
rc = ioctl(video_fd, VIDIOC_QUERYBUF, &buffer);
|
||||
if (rc < 0) {
|
||||
fprintf(stderr, "Unable to query buffer: %s\n", strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
|
||||
if (length != NULL) {
|
||||
if (type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) {
|
||||
length[0] = buffer.m.planes[0].length;
|
||||
length[1] = buffer.m.planes[1].length;
|
||||
} else {
|
||||
*length = buffer.m.planes[0].length;
|
||||
}
|
||||
}
|
||||
|
||||
if (offset != NULL) {
|
||||
if (type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) {
|
||||
offset[0] = buffer.m.planes[0].m.mem_offset;
|
||||
offset[1] = buffer.m.planes[1].m.mem_offset;
|
||||
} else {
|
||||
*offset = buffer.m.planes[0].m.mem_offset;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int v4l2_queue_buffer(int video_fd, int request_fd, unsigned int type,
|
||||
unsigned int index, unsigned int size)
|
||||
{
|
||||
struct v4l2_plane planes[2];
|
||||
struct v4l2_buffer buffer;
|
||||
int rc;
|
||||
|
||||
memset(planes, 0, sizeof(planes));
|
||||
memset(&buffer, 0, sizeof(buffer));
|
||||
|
||||
buffer.type = type;
|
||||
buffer.memory = V4L2_MEMORY_MMAP;
|
||||
buffer.index = index;
|
||||
buffer.length = type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE ? 2 : 1;
|
||||
buffer.m.planes = planes;
|
||||
|
||||
buffer.m.planes[0].bytesused = size;
|
||||
|
||||
if (request_fd >= 0) {
|
||||
buffer.flags = V4L2_BUF_FLAG_REQUEST_FD;
|
||||
buffer.request_fd = request_fd;
|
||||
}
|
||||
|
||||
rc = ioctl(video_fd, VIDIOC_QBUF, &buffer);
|
||||
if (rc < 0) {
|
||||
fprintf(stderr, "Unable to queue buffer: %s\n", strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
|
||||
int v4l2_dequeue_buffer(int video_fd, int request_fd, unsigned int type,
|
||||
unsigned int index)
|
||||
{
|
||||
struct v4l2_plane planes[2];
|
||||
struct v4l2_buffer buffer;
|
||||
int rc;
|
||||
|
||||
memset(planes, 0, sizeof(planes));
|
||||
memset(&buffer, 0, sizeof(buffer));
|
||||
|
||||
buffer.type = type;
|
||||
buffer.memory = V4L2_MEMORY_MMAP;
|
||||
buffer.index = index;
|
||||
buffer.length = type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE ? 2 : 1;
|
||||
buffer.m.planes = planes;
|
||||
|
||||
if (request_fd >= 0) {
|
||||
buffer.flags = V4L2_BUF_FLAG_REQUEST_FD;
|
||||
buffer.request_fd = request_fd;
|
||||
}
|
||||
|
||||
rc = ioctl(video_fd, VIDIOC_DQBUF, &buffer);
|
||||
if (rc < 0) {
|
||||
fprintf(stderr, "Unable to dequeue buffer: %s\n", strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
|
||||
int v4l2_set_control(int video_fd, int request_fd, unsigned int id, void *data,
|
||||
unsigned int size)
|
||||
{
|
||||
struct v4l2_ext_control control;
|
||||
struct v4l2_ext_controls controls;
|
||||
int rc;
|
||||
|
||||
memset(&control, 0, sizeof(control));
|
||||
memset(&controls, 0, sizeof(controls));
|
||||
|
||||
control.id = id;
|
||||
control.ptr = data;
|
||||
control.size = size;
|
||||
|
||||
controls.controls = &control;
|
||||
controls.count = 1;
|
||||
|
||||
if (request_fd >= 0) {
|
||||
controls.which = V4L2_CTRL_WHICH_REQUEST;
|
||||
controls.request_fd = request_fd;
|
||||
}
|
||||
|
||||
rc = ioctl(video_fd, VIDIOC_S_EXT_CTRLS, &controls);
|
||||
if (rc < 0) {
|
||||
fprintf(stderr, "Unable to set control: %s\n", strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int v4l2_set_stream(int video_fd, unsigned int type, bool enable)
|
||||
{
|
||||
enum v4l2_buf_type buf_type = type;
|
||||
int rc;
|
||||
|
||||
rc = ioctl(video_fd, enable ? VIDIOC_STREAMON : VIDIOC_STREAMOFF, &buf_type);
|
||||
if (rc < 0) {
|
||||
sunxi_cedrus_msg("Unable to %sable stream: %s\n", enable ? "en" : "dis", strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user