mirror of
https://gitlab.freedesktop.org/gstreamer/gstreamer.git
synced 2024-12-04 23:46:43 +00:00
426bf399d4
Imported dmabuf are not being duped, so they should never be closed. Instead, we ensure their live time by having strong reference on their original buffer. This should fix potential flickering due to dmabuf being closed too early. Part-of: <https://gitlab.freedesktop.org/gstreamer/gstreamer/-/merge_requests/5217>
1466 lines
39 KiB
C
1466 lines
39 KiB
C
/*
|
|
* Copyright (C) 2014 Collabora Ltd.
|
|
* Author: Nicolas Dufresne <nicolas.dufresne@collabora.com>
|
|
*
|
|
* This library is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU Library General Public
|
|
* License as published by the Free Software Foundation; either
|
|
* version 2 of the License, or (at your option) any later version.
|
|
*
|
|
* This library 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
|
|
* Library General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Library General Public
|
|
* License along with this library; if not, write to the
|
|
* Free Software Foundation, Inc., 51 Franklin St, Fifth Floor,
|
|
* Boston, MA 02110-1301, USA.
|
|
*
|
|
*/
|
|
|
|
#include "config.h"
|
|
|
|
#ifndef _GNU_SOURCE
|
|
# define _GNU_SOURCE /* O_CLOEXEC */
|
|
#endif
|
|
|
|
#include "ext/videodev2.h"
|
|
|
|
#include "gstv4l2object.h"
|
|
#include "gstv4l2allocator.h"
|
|
|
|
#include <gst/allocators/gstdmabuf.h>
|
|
|
|
#include <fcntl.h>
|
|
#include <string.h>
|
|
#include <sys/stat.h>
|
|
#include <sys/types.h>
|
|
#include <sys/mman.h>
|
|
#include <unistd.h>
|
|
|
|
#define GST_V4L2_MEMORY_TYPE "V4l2Memory"
|
|
|
|
#define gst_v4l2_allocator_parent_class parent_class
|
|
G_DEFINE_TYPE (GstV4l2Allocator, gst_v4l2_allocator, GST_TYPE_ALLOCATOR);
|
|
|
|
GST_DEBUG_CATEGORY_STATIC (v4l2allocator_debug);
|
|
#define GST_CAT_DEFAULT v4l2allocator_debug
|
|
|
|
#define UNSET_QUEUED(buffer) \
|
|
((buffer).flags &= ~(V4L2_BUF_FLAG_QUEUED | V4L2_BUF_FLAG_DONE))
|
|
|
|
#define SET_QUEUED(buffer) ((buffer).flags |= V4L2_BUF_FLAG_QUEUED)
|
|
|
|
#define IS_QUEUED(buffer) \
|
|
((buffer).flags & (V4L2_BUF_FLAG_QUEUED | V4L2_BUF_FLAG_DONE))
|
|
|
|
enum
|
|
{
|
|
GROUP_RELEASED,
|
|
LAST_SIGNAL
|
|
};
|
|
|
|
static guint gst_v4l2_allocator_signals[LAST_SIGNAL] = { 0 };
|
|
|
|
static void gst_v4l2_allocator_release (GstV4l2Allocator * allocator,
|
|
GstV4l2Memory * mem);
|
|
|
|
static const gchar *
|
|
memory_type_to_str (guint32 memory)
|
|
{
|
|
switch (memory) {
|
|
case V4L2_MEMORY_MMAP:
|
|
return "mmap";
|
|
case V4L2_MEMORY_USERPTR:
|
|
return "userptr";
|
|
case V4L2_MEMORY_DMABUF:
|
|
return "dmabuf";
|
|
default:
|
|
return "unknown";
|
|
}
|
|
}
|
|
|
|
/*************************************/
|
|
/* GstV4lMemory implementation */
|
|
/*************************************/
|
|
|
|
static gpointer
|
|
_v4l2mem_map (GstV4l2Memory * mem, gsize maxsize, GstMapFlags flags)
|
|
{
|
|
gpointer data = NULL;
|
|
|
|
switch (mem->group->buffer.memory) {
|
|
case V4L2_MEMORY_MMAP:
|
|
case V4L2_MEMORY_USERPTR:
|
|
data = mem->data;
|
|
break;
|
|
case V4L2_MEMORY_DMABUF:
|
|
/* v4l2 dmabuf memory are not shared with downstream */
|
|
g_assert_not_reached ();
|
|
break;
|
|
default:
|
|
GST_WARNING ("Unknown memory type %i", mem->group->buffer.memory);
|
|
break;
|
|
}
|
|
return data;
|
|
}
|
|
|
|
static gboolean
|
|
_v4l2mem_unmap (GstV4l2Memory * mem)
|
|
{
|
|
gboolean ret = FALSE;
|
|
|
|
switch (mem->group->buffer.memory) {
|
|
case V4L2_MEMORY_MMAP:
|
|
case V4L2_MEMORY_USERPTR:
|
|
ret = TRUE;
|
|
break;
|
|
case V4L2_MEMORY_DMABUF:
|
|
/* v4l2 dmabuf memory are not share with downstream */
|
|
g_assert_not_reached ();
|
|
break;
|
|
default:
|
|
GST_WARNING ("Unknown memory type %i", mem->group->buffer.memory);
|
|
break;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static gboolean
|
|
_v4l2mem_dispose (GstV4l2Memory * mem)
|
|
{
|
|
GstV4l2Allocator *allocator = (GstV4l2Allocator *) mem->mem.allocator;
|
|
GstV4l2MemoryGroup *group = mem->group;
|
|
gboolean ret;
|
|
|
|
if (group->mem[mem->plane]) {
|
|
/* We may have a dmabuf, replace it with returned original memory */
|
|
group->mem[mem->plane] = gst_memory_ref ((GstMemory *) mem);
|
|
gst_v4l2_allocator_release (allocator, mem);
|
|
ret = FALSE;
|
|
} else {
|
|
gst_object_ref (allocator);
|
|
ret = TRUE;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static inline GstV4l2Memory *
|
|
_v4l2mem_new (GstMemoryFlags flags, GstAllocator * allocator,
|
|
GstMemory * parent, gsize maxsize, gsize align, gsize offset, gsize size,
|
|
gint plane, gpointer data, int dmafd, GstV4l2MemoryGroup * group)
|
|
{
|
|
GstV4l2Memory *mem;
|
|
|
|
mem = g_slice_new0 (GstV4l2Memory);
|
|
gst_memory_init (GST_MEMORY_CAST (mem),
|
|
flags, allocator, parent, maxsize, align, offset, size);
|
|
|
|
if (parent == NULL)
|
|
mem->mem.mini_object.dispose =
|
|
(GstMiniObjectDisposeFunction) _v4l2mem_dispose;
|
|
|
|
mem->plane = plane;
|
|
mem->data = data;
|
|
mem->dmafd = dmafd;
|
|
mem->group = group;
|
|
|
|
return mem;
|
|
}
|
|
|
|
static GstV4l2Memory *
|
|
_v4l2mem_share (GstV4l2Memory * mem, gssize offset, gsize size)
|
|
{
|
|
GstV4l2Memory *sub;
|
|
GstMemory *parent;
|
|
|
|
/* find the real parent */
|
|
if ((parent = mem->mem.parent) == NULL)
|
|
parent = (GstMemory *) mem;
|
|
|
|
if (size == -1)
|
|
size = mem->mem.size - offset;
|
|
|
|
/* the shared memory is always readonly */
|
|
sub = _v4l2mem_new (GST_MINI_OBJECT_FLAGS (parent) |
|
|
GST_MINI_OBJECT_FLAG_LOCK_READONLY, mem->mem.allocator, parent,
|
|
mem->mem.maxsize, mem->mem.align, offset, size, mem->plane, mem->data,
|
|
-1, mem->group);
|
|
|
|
return sub;
|
|
}
|
|
|
|
static gboolean
|
|
_v4l2mem_is_span (GstV4l2Memory * mem1, GstV4l2Memory * mem2, gsize * offset)
|
|
{
|
|
if (offset)
|
|
*offset = mem1->mem.offset - mem1->mem.parent->offset;
|
|
|
|
/* and memory is contiguous */
|
|
return mem1->mem.offset + mem1->mem.size == mem2->mem.offset;
|
|
}
|
|
|
|
gboolean
|
|
gst_is_v4l2_memory (GstMemory * mem)
|
|
{
|
|
return gst_memory_is_type (mem, GST_V4L2_MEMORY_TYPE);
|
|
}
|
|
|
|
GQuark
|
|
gst_v4l2_memory_quark (void)
|
|
{
|
|
static GQuark quark = 0;
|
|
|
|
if (quark == 0)
|
|
quark = g_quark_from_string ("GstV4l2Memory");
|
|
|
|
return quark;
|
|
}
|
|
|
|
|
|
/*************************************/
|
|
/* GstV4l2MemoryGroup implementation */
|
|
/*************************************/
|
|
|
|
static void
|
|
gst_v4l2_memory_group_free (GstV4l2MemoryGroup * group)
|
|
{
|
|
gint i;
|
|
|
|
for (i = 0; i < group->n_mem; i++) {
|
|
GstMemory *mem = group->mem[i];
|
|
group->mem[i] = NULL;
|
|
if (mem)
|
|
gst_memory_unref (mem);
|
|
}
|
|
|
|
g_slice_free (GstV4l2MemoryGroup, group);
|
|
}
|
|
|
|
static GstV4l2MemoryGroup *
|
|
gst_v4l2_memory_group_new (GstV4l2Allocator * allocator, guint32 index)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
guint32 memory = allocator->memory;
|
|
struct v4l2_format *format = &obj->format;
|
|
GstV4l2MemoryGroup *group;
|
|
gsize img_size, buf_size;
|
|
|
|
group = g_slice_new0 (GstV4l2MemoryGroup);
|
|
|
|
group->buffer.type = format->type;
|
|
group->buffer.index = index;
|
|
group->buffer.memory = memory;
|
|
|
|
if (V4L2_TYPE_IS_MULTIPLANAR (format->type)) {
|
|
group->n_mem = group->buffer.length = format->fmt.pix_mp.num_planes;
|
|
group->buffer.m.planes = group->planes;
|
|
} else {
|
|
group->n_mem = 1;
|
|
}
|
|
|
|
if (obj->ioctl (obj->video_fd, VIDIOC_QUERYBUF, &group->buffer) < 0)
|
|
goto querybuf_failed;
|
|
|
|
if (group->buffer.index != index) {
|
|
GST_ERROR_OBJECT (allocator, "Buffer index returned by VIDIOC_QUERYBUF "
|
|
"didn't match, this indicate the presence of a bug in your driver or "
|
|
"libv4l2");
|
|
g_slice_free (GstV4l2MemoryGroup, group);
|
|
return NULL;
|
|
}
|
|
|
|
/* Check that provided size matches the format we have negotiation. Failing
|
|
* there usually means a driver of libv4l bug. */
|
|
if (V4L2_TYPE_IS_MULTIPLANAR (obj->type)) {
|
|
gint i;
|
|
|
|
for (i = 0; i < group->n_mem; i++) {
|
|
img_size = obj->format.fmt.pix_mp.plane_fmt[i].sizeimage;
|
|
buf_size = group->planes[i].length;
|
|
if (buf_size < img_size)
|
|
goto buffer_too_short;
|
|
}
|
|
} else {
|
|
img_size = obj->format.fmt.pix.sizeimage;
|
|
buf_size = group->buffer.length;
|
|
if (buf_size < img_size)
|
|
goto buffer_too_short;
|
|
}
|
|
|
|
/* We save non planar buffer information into the multi-planar plane array
|
|
* to avoid duplicating the code later */
|
|
if (!V4L2_TYPE_IS_MULTIPLANAR (format->type)) {
|
|
group->planes[0].bytesused = group->buffer.bytesused;
|
|
group->planes[0].length = group->buffer.length;
|
|
group->planes[0].data_offset = 0;
|
|
g_assert (sizeof (group->planes[0].m) == sizeof (group->buffer.m));
|
|
memcpy (&group->planes[0].m, &group->buffer.m, sizeof (group->buffer.m));
|
|
}
|
|
|
|
GST_LOG_OBJECT (allocator, "Got %s buffer", memory_type_to_str (memory));
|
|
GST_LOG_OBJECT (allocator, " index: %u", group->buffer.index);
|
|
GST_LOG_OBJECT (allocator, " type: %d", group->buffer.type);
|
|
GST_LOG_OBJECT (allocator, " flags: %08x", group->buffer.flags);
|
|
GST_LOG_OBJECT (allocator, " field: %d", group->buffer.field);
|
|
GST_LOG_OBJECT (allocator, " memory: %d", group->buffer.memory);
|
|
GST_LOG_OBJECT (allocator, " planes: %d", group->n_mem);
|
|
|
|
#ifndef GST_DISABLE_GST_DEBUG
|
|
if (memory == V4L2_MEMORY_MMAP) {
|
|
gint i;
|
|
for (i = 0; i < group->n_mem; i++) {
|
|
GST_LOG_OBJECT (allocator,
|
|
" [%u] bytesused: %u, length: %u, offset: %u", i,
|
|
group->planes[i].bytesused, group->planes[i].length,
|
|
group->planes[i].data_offset);
|
|
GST_LOG_OBJECT (allocator, " [%u] MMAP offset: %u", i,
|
|
group->planes[i].m.mem_offset);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
return group;
|
|
|
|
querybuf_failed:
|
|
{
|
|
GST_ERROR ("error querying buffer %d: %s", index, g_strerror (errno));
|
|
goto failed;
|
|
}
|
|
buffer_too_short:
|
|
{
|
|
GST_ERROR ("buffer size %" G_GSIZE_FORMAT
|
|
" is smaller then negotiated size %" G_GSIZE_FORMAT
|
|
", this is usually the result of a bug in the v4l2 driver or libv4l.",
|
|
buf_size, img_size);
|
|
goto failed;
|
|
}
|
|
failed:
|
|
gst_v4l2_memory_group_free (group);
|
|
return NULL;
|
|
}
|
|
|
|
|
|
/*************************************/
|
|
/* GstV4lAllocator implementation */
|
|
/*************************************/
|
|
|
|
static void
|
|
gst_v4l2_allocator_release (GstV4l2Allocator * allocator, GstV4l2Memory * mem)
|
|
{
|
|
GstV4l2MemoryGroup *group = mem->group;
|
|
|
|
GST_LOG_OBJECT (allocator, "plane %i of buffer %u released",
|
|
mem->plane, group->buffer.index);
|
|
|
|
switch (allocator->memory) {
|
|
case V4L2_MEMORY_DMABUF:
|
|
mem->dmafd = -1;
|
|
break;
|
|
case V4L2_MEMORY_USERPTR:
|
|
mem->data = NULL;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
/* When all memory are back, put the group back in the free queue */
|
|
if (g_atomic_int_dec_and_test (&group->mems_allocated)) {
|
|
GST_LOG_OBJECT (allocator, "buffer %u released", group->buffer.index);
|
|
gst_atomic_queue_push (allocator->free_queue, group);
|
|
g_signal_emit (allocator, gst_v4l2_allocator_signals[GROUP_RELEASED], 0);
|
|
}
|
|
|
|
/* Keep last, allocator may be freed after this call */
|
|
g_object_unref (allocator);
|
|
}
|
|
|
|
static void
|
|
gst_v4l2_allocator_free (GstAllocator * gallocator, GstMemory * gmem)
|
|
{
|
|
GstV4l2Allocator *allocator = (GstV4l2Allocator *) gallocator;
|
|
GstV4l2Object *obj = allocator->obj;
|
|
GstV4l2Memory *mem = (GstV4l2Memory *) gmem;
|
|
GstV4l2MemoryGroup *group = mem->group;
|
|
|
|
/* Only free unparented memory */
|
|
if (mem->mem.parent == NULL) {
|
|
GST_LOG_OBJECT (allocator, "freeing plane %i of buffer %u",
|
|
mem->plane, group->buffer.index);
|
|
|
|
if (allocator->memory == V4L2_MEMORY_MMAP) {
|
|
if (mem->data)
|
|
obj->munmap (mem->data, group->planes[mem->plane].length);
|
|
}
|
|
|
|
if (allocator->memory == V4L2_MEMORY_MMAP && mem->dmafd >= 0)
|
|
close (mem->dmafd);
|
|
}
|
|
|
|
g_slice_free (GstV4l2Memory, mem);
|
|
}
|
|
|
|
static void
|
|
gst_v4l2_allocator_dispose (GObject * obj)
|
|
{
|
|
GstV4l2Allocator *allocator = (GstV4l2Allocator *) obj;
|
|
gint i;
|
|
|
|
GST_LOG_OBJECT (obj, "called");
|
|
|
|
for (i = 0; i < allocator->count; i++) {
|
|
GstV4l2MemoryGroup *group = allocator->groups[i];
|
|
allocator->groups[i] = NULL;
|
|
if (group)
|
|
gst_v4l2_memory_group_free (group);
|
|
}
|
|
|
|
G_OBJECT_CLASS (parent_class)->dispose (obj);
|
|
}
|
|
|
|
static void
|
|
gst_v4l2_allocator_finalize (GObject * obj)
|
|
{
|
|
GstV4l2Allocator *allocator = (GstV4l2Allocator *) obj;
|
|
|
|
GST_LOG_OBJECT (obj, "called");
|
|
|
|
gst_atomic_queue_unref (allocator->free_queue);
|
|
gst_object_unref (allocator->obj->element);
|
|
|
|
G_OBJECT_CLASS (parent_class)->finalize (obj);
|
|
}
|
|
|
|
static void
|
|
gst_v4l2_allocator_class_init (GstV4l2AllocatorClass * klass)
|
|
{
|
|
GObjectClass *object_class;
|
|
GstAllocatorClass *allocator_class;
|
|
|
|
allocator_class = (GstAllocatorClass *) klass;
|
|
object_class = (GObjectClass *) klass;
|
|
|
|
allocator_class->alloc = NULL;
|
|
allocator_class->free = gst_v4l2_allocator_free;
|
|
|
|
object_class->dispose = gst_v4l2_allocator_dispose;
|
|
object_class->finalize = gst_v4l2_allocator_finalize;
|
|
|
|
gst_v4l2_allocator_signals[GROUP_RELEASED] = g_signal_new ("group-released",
|
|
G_TYPE_FROM_CLASS (object_class), G_SIGNAL_RUN_LAST, 0, NULL, NULL, NULL,
|
|
G_TYPE_NONE, 0);
|
|
|
|
GST_DEBUG_CATEGORY_INIT (v4l2allocator_debug, "v4l2allocator", 0,
|
|
"V4L2 Allocator");
|
|
}
|
|
|
|
static void
|
|
gst_v4l2_allocator_init (GstV4l2Allocator * allocator)
|
|
{
|
|
GstAllocator *alloc = GST_ALLOCATOR_CAST (allocator);
|
|
|
|
alloc->mem_type = GST_V4L2_MEMORY_TYPE;
|
|
alloc->mem_map = (GstMemoryMapFunction) _v4l2mem_map;
|
|
alloc->mem_unmap = (GstMemoryUnmapFunction) _v4l2mem_unmap;
|
|
alloc->mem_share = (GstMemoryShareFunction) _v4l2mem_share;
|
|
alloc->mem_is_span = (GstMemoryIsSpanFunction) _v4l2mem_is_span;
|
|
/* Use the default, fallback copy function */
|
|
|
|
allocator->free_queue = gst_atomic_queue_new (VIDEO_MAX_FRAME);
|
|
|
|
GST_OBJECT_FLAG_SET (allocator, GST_ALLOCATOR_FLAG_CUSTOM_ALLOC);
|
|
}
|
|
|
|
#define GST_V4L2_ALLOCATOR_PROBE(obj,type) \
|
|
gst_v4l2_allocator_probe ((obj), V4L2_MEMORY_ ## type, \
|
|
GST_V4L2_ALLOCATOR_FLAG_ ## type ## _REQBUFS, \
|
|
GST_V4L2_ALLOCATOR_FLAG_ ## type ## _CREATE_BUFS)
|
|
static guint32
|
|
gst_v4l2_allocator_probe (GstV4l2Allocator * allocator, guint32 memory,
|
|
guint32 breq_flag, guint32 bcreate_flag)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
struct v4l2_requestbuffers breq = { 0 };
|
|
guint32 flags = 0;
|
|
|
|
breq.type = obj->type;
|
|
breq.count = 0;
|
|
breq.memory = memory;
|
|
|
|
if (obj->ioctl (obj->video_fd, VIDIOC_REQBUFS, &breq) == 0) {
|
|
struct v4l2_create_buffers bcreate = { 0 };
|
|
|
|
flags |= breq_flag;
|
|
|
|
bcreate.memory = memory;
|
|
bcreate.format = obj->format;
|
|
|
|
if ((obj->ioctl (obj->video_fd, VIDIOC_CREATE_BUFS, &bcreate) == 0))
|
|
flags |= bcreate_flag;
|
|
}
|
|
|
|
if (breq.capabilities & V4L2_BUF_CAP_SUPPORTS_ORPHANED_BUFS)
|
|
flags |= GST_V4L2_ALLOCATOR_FLAG_SUPPORTS_ORPHANED_BUFS;
|
|
|
|
return flags;
|
|
}
|
|
|
|
static GstV4l2MemoryGroup *
|
|
gst_v4l2_allocator_create_buf (GstV4l2Allocator * allocator)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
struct v4l2_create_buffers bcreate = { 0 };
|
|
GstV4l2MemoryGroup *group = NULL;
|
|
|
|
GST_OBJECT_LOCK (allocator);
|
|
|
|
if (!g_atomic_int_get (&allocator->active))
|
|
goto done;
|
|
|
|
if (GST_V4L2_ALLOCATOR_IS_ORPHANED (allocator))
|
|
goto orphaned_bug;
|
|
|
|
bcreate.memory = allocator->memory;
|
|
bcreate.format = obj->format;
|
|
bcreate.count = 1;
|
|
|
|
if (!allocator->can_allocate)
|
|
goto done;
|
|
|
|
if (obj->ioctl (obj->video_fd, VIDIOC_CREATE_BUFS, &bcreate) < 0)
|
|
goto create_bufs_failed;
|
|
|
|
if (allocator->groups[bcreate.index] != NULL)
|
|
goto create_bufs_bug;
|
|
|
|
group = gst_v4l2_memory_group_new (allocator, bcreate.index);
|
|
|
|
if (group) {
|
|
allocator->groups[bcreate.index] = group;
|
|
allocator->count++;
|
|
}
|
|
|
|
done:
|
|
GST_OBJECT_UNLOCK (allocator);
|
|
return group;
|
|
|
|
orphaned_bug:
|
|
{
|
|
GST_ERROR_OBJECT (allocator, "allocator was orphaned, "
|
|
"not creating new buffers");
|
|
goto done;
|
|
}
|
|
create_bufs_failed:
|
|
{
|
|
GST_WARNING_OBJECT (allocator, "error creating a new buffer: %s",
|
|
g_strerror (errno));
|
|
goto done;
|
|
}
|
|
create_bufs_bug:
|
|
{
|
|
GST_ERROR_OBJECT (allocator, "created buffer has already used buffer "
|
|
"index %i, this means there is an bug in your driver or libv4l2",
|
|
bcreate.index);
|
|
goto done;
|
|
}
|
|
}
|
|
|
|
static GstV4l2MemoryGroup *
|
|
gst_v4l2_allocator_alloc (GstV4l2Allocator * allocator)
|
|
{
|
|
GstV4l2MemoryGroup *group;
|
|
|
|
if (!g_atomic_int_get (&allocator->active))
|
|
return NULL;
|
|
|
|
group = gst_atomic_queue_pop (allocator->free_queue);
|
|
|
|
if (group == NULL) {
|
|
if (allocator->can_allocate) {
|
|
group = gst_v4l2_allocator_create_buf (allocator);
|
|
|
|
/* Don't hammer on CREATE_BUFS */
|
|
if (group == NULL)
|
|
allocator->can_allocate = FALSE;
|
|
}
|
|
}
|
|
|
|
return group;
|
|
}
|
|
|
|
static void
|
|
gst_v4l2_allocator_reset_size (GstV4l2Allocator * allocator,
|
|
GstV4l2MemoryGroup * group)
|
|
{
|
|
gint i;
|
|
for (i = 0; i < group->n_mem; i++) {
|
|
group->mem[i]->maxsize = group->planes[i].length;
|
|
group->mem[i]->offset = 0;
|
|
group->mem[i]->size = group->planes[i].length;
|
|
}
|
|
}
|
|
|
|
static void
|
|
_cleanup_failed_alloc (GstV4l2Allocator * allocator, GstV4l2MemoryGroup * group)
|
|
{
|
|
if (group->mems_allocated > 0) {
|
|
gint i;
|
|
/* If one or more mmap worked, we need to unref the memory, otherwise
|
|
* they will keep a ref on the allocator and leak it. This will put back
|
|
* the group into the free_queue */
|
|
for (i = 0; i < group->n_mem; i++)
|
|
gst_memory_unref (group->mem[i]);
|
|
} else {
|
|
/* Otherwise, group has to be on free queue for _stop() to work */
|
|
gst_atomic_queue_push (allocator->free_queue, group);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
GstV4l2Allocator *
|
|
gst_v4l2_allocator_new (GstObject * parent, GstV4l2Object * v4l2object)
|
|
{
|
|
GstV4l2Allocator *allocator;
|
|
guint32 flags = 0;
|
|
gchar *name, *parent_name;
|
|
|
|
parent_name = gst_object_get_name (parent);
|
|
name = g_strconcat (parent_name, ":allocator", NULL);
|
|
g_free (parent_name);
|
|
|
|
allocator = g_object_new (GST_TYPE_V4L2_ALLOCATOR, "name", name, NULL);
|
|
gst_object_ref_sink (allocator);
|
|
g_free (name);
|
|
|
|
/* Save everything */
|
|
allocator->obj = v4l2object;
|
|
|
|
/* Keep a ref on the element so obj does not disappear */
|
|
gst_object_ref (allocator->obj->element);
|
|
|
|
flags |= GST_V4L2_ALLOCATOR_PROBE (allocator, MMAP);
|
|
flags |= GST_V4L2_ALLOCATOR_PROBE (allocator, USERPTR);
|
|
flags |= GST_V4L2_ALLOCATOR_PROBE (allocator, DMABUF);
|
|
|
|
|
|
if (flags == 0) {
|
|
/* Drivers not ported from videobuf to videbuf2 don't allow freeing buffers
|
|
* using REQBUFS(0). This is a workaround to still support these drivers,
|
|
* which are known to have MMAP support. */
|
|
GST_WARNING_OBJECT (allocator, "Could not probe supported memory type, "
|
|
"assuming MMAP is supported, this is expected for older drivers not "
|
|
" yet ported to videobuf2 framework");
|
|
flags = GST_V4L2_ALLOCATOR_FLAG_MMAP_REQBUFS;
|
|
}
|
|
|
|
GST_OBJECT_FLAG_SET (allocator, flags);
|
|
|
|
return allocator;
|
|
}
|
|
|
|
guint
|
|
gst_v4l2_allocator_start (GstV4l2Allocator * allocator, guint32 count,
|
|
guint32 memory)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
struct v4l2_requestbuffers breq = { count, obj->type, memory };
|
|
gboolean can_allocate;
|
|
gint i;
|
|
|
|
g_return_val_if_fail (count != 0, 0);
|
|
|
|
GST_OBJECT_LOCK (allocator);
|
|
|
|
if (g_atomic_int_get (&allocator->active))
|
|
goto already_active;
|
|
|
|
if (GST_V4L2_ALLOCATOR_IS_ORPHANED (allocator))
|
|
goto orphaned;
|
|
|
|
if (obj->ioctl (obj->video_fd, VIDIOC_REQBUFS, &breq) < 0)
|
|
goto reqbufs_failed;
|
|
|
|
if (breq.count < 1)
|
|
goto out_of_memory;
|
|
|
|
switch (memory) {
|
|
case V4L2_MEMORY_MMAP:
|
|
can_allocate = GST_V4L2_ALLOCATOR_CAN_ALLOCATE (allocator, MMAP);
|
|
break;
|
|
case V4L2_MEMORY_USERPTR:
|
|
can_allocate = GST_V4L2_ALLOCATOR_CAN_ALLOCATE (allocator, USERPTR);
|
|
break;
|
|
case V4L2_MEMORY_DMABUF:
|
|
can_allocate = GST_V4L2_ALLOCATOR_CAN_ALLOCATE (allocator, DMABUF);
|
|
break;
|
|
default:
|
|
can_allocate = FALSE;
|
|
break;
|
|
}
|
|
|
|
GST_DEBUG_OBJECT (allocator, "allocated %u %s buffers out of %u requested",
|
|
breq.count, memory_type_to_str (memory), count);
|
|
|
|
allocator->can_allocate = can_allocate;
|
|
allocator->count = breq.count;
|
|
allocator->memory = memory;
|
|
|
|
/* Create memory groups */
|
|
for (i = 0; i < allocator->count; i++) {
|
|
allocator->groups[i] = gst_v4l2_memory_group_new (allocator, i);
|
|
if (allocator->groups[i] == NULL)
|
|
goto error;
|
|
|
|
gst_atomic_queue_push (allocator->free_queue, allocator->groups[i]);
|
|
}
|
|
|
|
g_atomic_int_set (&allocator->active, TRUE);
|
|
|
|
done:
|
|
GST_OBJECT_UNLOCK (allocator);
|
|
return breq.count;
|
|
|
|
already_active:
|
|
{
|
|
GST_ERROR_OBJECT (allocator, "allocator already active");
|
|
goto error;
|
|
}
|
|
orphaned:
|
|
{
|
|
GST_ERROR_OBJECT (allocator, "allocator was orphaned");
|
|
goto error;
|
|
}
|
|
reqbufs_failed:
|
|
{
|
|
GST_ERROR_OBJECT (allocator,
|
|
"error requesting %d buffers: %s", count, g_strerror (errno));
|
|
goto error;
|
|
}
|
|
out_of_memory:
|
|
{
|
|
GST_ERROR_OBJECT (allocator, "Not enough memory to allocate buffers");
|
|
goto error;
|
|
}
|
|
error:
|
|
{
|
|
breq.count = 0;
|
|
goto done;
|
|
}
|
|
}
|
|
|
|
GstV4l2Return
|
|
gst_v4l2_allocator_stop (GstV4l2Allocator * allocator)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
struct v4l2_requestbuffers breq = { 0, obj->type, allocator->memory };
|
|
gint i = 0;
|
|
GstV4l2Return ret = GST_V4L2_OK;
|
|
|
|
GST_DEBUG_OBJECT (allocator, "stop allocator");
|
|
|
|
GST_OBJECT_LOCK (allocator);
|
|
|
|
if (!g_atomic_int_get (&allocator->active))
|
|
goto done;
|
|
|
|
if (gst_atomic_queue_length (allocator->free_queue) != allocator->count) {
|
|
GST_DEBUG_OBJECT (allocator, "allocator is still in use");
|
|
ret = GST_V4L2_BUSY;
|
|
goto done;
|
|
}
|
|
|
|
while (gst_atomic_queue_pop (allocator->free_queue)) {
|
|
/* nothing */
|
|
};
|
|
|
|
for (i = 0; i < allocator->count; i++) {
|
|
GstV4l2MemoryGroup *group = allocator->groups[i];
|
|
allocator->groups[i] = NULL;
|
|
if (group)
|
|
gst_v4l2_memory_group_free (group);
|
|
}
|
|
|
|
if (!GST_V4L2_ALLOCATOR_IS_ORPHANED (allocator)) {
|
|
/* Not all drivers support rebufs(0), so warn only */
|
|
if (obj->ioctl (obj->video_fd, VIDIOC_REQBUFS, &breq) < 0)
|
|
GST_WARNING_OBJECT (allocator,
|
|
"error releasing buffers buffers: %s", g_strerror (errno));
|
|
}
|
|
|
|
allocator->count = 0;
|
|
|
|
g_atomic_int_set (&allocator->active, FALSE);
|
|
|
|
done:
|
|
GST_OBJECT_UNLOCK (allocator);
|
|
return ret;
|
|
}
|
|
|
|
gboolean
|
|
gst_v4l2_allocator_orphan (GstV4l2Allocator * allocator)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
struct v4l2_requestbuffers breq = { 0, obj->type, allocator->memory };
|
|
|
|
if (!GST_V4L2_ALLOCATOR_CAN_ORPHAN_BUFS (allocator))
|
|
return FALSE;
|
|
|
|
GST_OBJECT_FLAG_SET (allocator, GST_V4L2_ALLOCATOR_FLAG_ORPHANED);
|
|
|
|
if (!g_atomic_int_get (&allocator->active))
|
|
return TRUE;
|
|
|
|
if (obj->ioctl (obj->video_fd, VIDIOC_REQBUFS, &breq) < 0) {
|
|
GST_ERROR_OBJECT (allocator,
|
|
"error orphaning buffers buffers: %s", g_strerror (errno));
|
|
return FALSE;
|
|
}
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
GstV4l2MemoryGroup *
|
|
gst_v4l2_allocator_alloc_mmap (GstV4l2Allocator * allocator)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
GstV4l2MemoryGroup *group;
|
|
gint i;
|
|
|
|
g_return_val_if_fail (allocator->memory == V4L2_MEMORY_MMAP, NULL);
|
|
|
|
group = gst_v4l2_allocator_alloc (allocator);
|
|
|
|
if (group == NULL)
|
|
return NULL;
|
|
|
|
for (i = 0; i < group->n_mem; i++) {
|
|
if (group->mem[i] == NULL) {
|
|
gpointer data;
|
|
data = obj->mmap (NULL, group->planes[i].length, PROT_READ | PROT_WRITE,
|
|
MAP_SHARED, obj->video_fd, group->planes[i].m.mem_offset);
|
|
|
|
if (data == MAP_FAILED)
|
|
goto mmap_failed;
|
|
|
|
GST_LOG_OBJECT (allocator,
|
|
"mmap buffer length %d, data offset %d, plane %d",
|
|
group->planes[i].length, group->planes[i].data_offset, i);
|
|
|
|
group->mem[i] = (GstMemory *) _v4l2mem_new (0, GST_ALLOCATOR (allocator),
|
|
NULL, group->planes[i].length, 0, 0, group->planes[i].length, i, data,
|
|
-1, group);
|
|
} else {
|
|
/* Take back the allocator reference */
|
|
gst_object_ref (allocator);
|
|
}
|
|
|
|
group->mems_allocated++;
|
|
}
|
|
|
|
/* Ensure group size. Unlike GST, v4l2 have size (bytesused) initially set
|
|
* to 0. As length might be bigger then the expected size exposed in the
|
|
* format, we simply set bytesused initially and reset it here for
|
|
* simplicity */
|
|
gst_v4l2_allocator_reset_size (allocator, group);
|
|
|
|
return group;
|
|
|
|
mmap_failed:
|
|
{
|
|
GST_ERROR_OBJECT (allocator, "Failed to mmap buffer: %s",
|
|
g_strerror (errno));
|
|
_cleanup_failed_alloc (allocator, group);
|
|
return NULL;
|
|
}
|
|
}
|
|
|
|
GstV4l2MemoryGroup *
|
|
gst_v4l2_allocator_alloc_dmabuf (GstV4l2Allocator * allocator,
|
|
GstAllocator * dmabuf_allocator)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
GstV4l2MemoryGroup *group;
|
|
gint i;
|
|
|
|
g_return_val_if_fail (allocator->memory == V4L2_MEMORY_MMAP, NULL);
|
|
|
|
group = gst_v4l2_allocator_alloc (allocator);
|
|
|
|
if (group == NULL)
|
|
return NULL;
|
|
|
|
for (i = 0; i < group->n_mem; i++) {
|
|
GstV4l2Memory *mem;
|
|
GstMemory *dma_mem;
|
|
|
|
if (group->mem[i] == NULL) {
|
|
struct v4l2_exportbuffer expbuf = { 0 };
|
|
|
|
expbuf.type = obj->type;
|
|
expbuf.index = group->buffer.index;
|
|
expbuf.plane = i;
|
|
expbuf.flags = O_CLOEXEC | O_RDWR;
|
|
|
|
if (obj->ioctl (obj->video_fd, VIDIOC_EXPBUF, &expbuf) < 0)
|
|
goto expbuf_failed;
|
|
|
|
GST_LOG_OBJECT (allocator, "exported DMABUF as fd %i plane %d",
|
|
expbuf.fd, i);
|
|
|
|
group->mem[i] = (GstMemory *) _v4l2mem_new (0, GST_ALLOCATOR (allocator),
|
|
NULL, group->planes[i].length, 0, group->planes[i].data_offset,
|
|
group->planes[i].length - group->planes[i].data_offset, i, NULL,
|
|
expbuf.fd, group);
|
|
} else {
|
|
/* Take back the allocator reference */
|
|
gst_object_ref (allocator);
|
|
}
|
|
|
|
group->mems_allocated++;
|
|
|
|
g_assert (gst_is_v4l2_memory (group->mem[i]));
|
|
mem = (GstV4l2Memory *) group->mem[i];
|
|
|
|
dma_mem = gst_fd_allocator_alloc (dmabuf_allocator, mem->dmafd,
|
|
group->planes[i].length, GST_FD_MEMORY_FLAG_DONT_CLOSE);
|
|
gst_memory_resize (dma_mem, group->planes[i].data_offset,
|
|
group->planes[i].length - group->planes[i].data_offset);
|
|
|
|
gst_mini_object_set_qdata (GST_MINI_OBJECT (dma_mem),
|
|
GST_V4L2_MEMORY_QUARK, mem, (GDestroyNotify) gst_memory_unref);
|
|
|
|
group->mem[i] = dma_mem;
|
|
}
|
|
|
|
gst_v4l2_allocator_reset_size (allocator, group);
|
|
|
|
return group;
|
|
|
|
expbuf_failed:
|
|
{
|
|
GST_ERROR_OBJECT (allocator, "Failed to export DMABUF: %s",
|
|
g_strerror (errno));
|
|
goto cleanup;
|
|
}
|
|
cleanup:
|
|
{
|
|
_cleanup_failed_alloc (allocator, group);
|
|
return NULL;
|
|
}
|
|
}
|
|
|
|
static void
|
|
gst_v4l2_allocator_clear_dmabufin (GstV4l2Allocator * allocator,
|
|
GstV4l2MemoryGroup * group)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
GstV4l2Memory *mem;
|
|
gint i;
|
|
|
|
g_return_if_fail (allocator->memory == V4L2_MEMORY_DMABUF);
|
|
|
|
for (i = 0; i < group->n_mem; i++) {
|
|
|
|
mem = (GstV4l2Memory *) group->mem[i];
|
|
|
|
GST_LOG_OBJECT (allocator, "[%i] clearing DMABUF import, fd %i plane %d",
|
|
group->buffer.index, mem->dmafd, i);
|
|
|
|
/* Update memory */
|
|
mem->mem.maxsize = 0;
|
|
mem->mem.offset = 0;
|
|
mem->mem.size = 0;
|
|
mem->dmafd = -1;
|
|
|
|
/* Update v4l2 structure */
|
|
group->planes[i].length = 0;
|
|
group->planes[i].bytesused = 0;
|
|
group->planes[i].m.fd = -1;
|
|
group->planes[i].data_offset = 0;
|
|
}
|
|
|
|
if (!V4L2_TYPE_IS_MULTIPLANAR (obj->type)) {
|
|
group->buffer.bytesused = 0;
|
|
group->buffer.length = 0;
|
|
group->buffer.m.fd = -1;
|
|
}
|
|
}
|
|
|
|
GstV4l2MemoryGroup *
|
|
gst_v4l2_allocator_alloc_dmabufin (GstV4l2Allocator * allocator)
|
|
{
|
|
GstV4l2MemoryGroup *group;
|
|
gint i;
|
|
|
|
g_return_val_if_fail (allocator->memory == V4L2_MEMORY_DMABUF, NULL);
|
|
|
|
group = gst_v4l2_allocator_alloc (allocator);
|
|
|
|
if (group == NULL)
|
|
return NULL;
|
|
|
|
GST_LOG_OBJECT (allocator, "allocating empty DMABUF import group");
|
|
|
|
for (i = 0; i < group->n_mem; i++) {
|
|
if (group->mem[i] == NULL) {
|
|
group->mem[i] = (GstMemory *) _v4l2mem_new (0, GST_ALLOCATOR (allocator),
|
|
NULL, 0, 0, 0, 0, i, NULL, -1, group);
|
|
} else {
|
|
/* Take back the allocator reference */
|
|
gst_object_ref (allocator);
|
|
}
|
|
|
|
group->mems_allocated++;
|
|
}
|
|
|
|
gst_v4l2_allocator_clear_dmabufin (allocator, group);
|
|
|
|
return group;
|
|
}
|
|
|
|
static void
|
|
gst_v4l2_allocator_clear_userptr (GstV4l2Allocator * allocator,
|
|
GstV4l2MemoryGroup * group)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
GstV4l2Memory *mem;
|
|
gint i;
|
|
|
|
g_return_if_fail (allocator->memory == V4L2_MEMORY_USERPTR);
|
|
|
|
for (i = 0; i < group->n_mem; i++) {
|
|
mem = (GstV4l2Memory *) group->mem[i];
|
|
|
|
GST_LOG_OBJECT (allocator, "[%i] clearing USERPTR %p plane %d size %"
|
|
G_GSIZE_FORMAT, group->buffer.index, mem->data, i, mem->mem.size);
|
|
|
|
mem->mem.maxsize = 0;
|
|
mem->mem.size = 0;
|
|
mem->data = NULL;
|
|
|
|
group->planes[i].length = 0;
|
|
group->planes[i].bytesused = 0;
|
|
group->planes[i].m.userptr = 0;
|
|
}
|
|
|
|
if (!V4L2_TYPE_IS_MULTIPLANAR (obj->type)) {
|
|
group->buffer.bytesused = 0;
|
|
group->buffer.length = 0;
|
|
group->buffer.m.userptr = 0;
|
|
}
|
|
}
|
|
|
|
GstV4l2MemoryGroup *
|
|
gst_v4l2_allocator_alloc_userptr (GstV4l2Allocator * allocator)
|
|
{
|
|
GstV4l2MemoryGroup *group;
|
|
gint i;
|
|
|
|
g_return_val_if_fail (allocator->memory == V4L2_MEMORY_USERPTR, NULL);
|
|
|
|
group = gst_v4l2_allocator_alloc (allocator);
|
|
|
|
if (group == NULL)
|
|
return NULL;
|
|
|
|
GST_LOG_OBJECT (allocator, "allocating empty USERPTR group");
|
|
|
|
for (i = 0; i < group->n_mem; i++) {
|
|
|
|
if (group->mem[i] == NULL) {
|
|
group->mem[i] = (GstMemory *) _v4l2mem_new (0, GST_ALLOCATOR (allocator),
|
|
NULL, 0, 0, 0, 0, i, NULL, -1, group);
|
|
} else {
|
|
/* Take back the allocator reference */
|
|
gst_object_ref (allocator);
|
|
}
|
|
|
|
group->mems_allocated++;
|
|
}
|
|
|
|
gst_v4l2_allocator_clear_userptr (allocator, group);
|
|
|
|
return group;
|
|
}
|
|
|
|
gboolean
|
|
gst_v4l2_allocator_import_dmabuf (GstV4l2Allocator * allocator,
|
|
GstV4l2MemoryGroup * group, gint n_mem, GstMemory ** dma_mem)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
GstV4l2Memory *mem;
|
|
gint i;
|
|
|
|
g_return_val_if_fail (allocator->memory == V4L2_MEMORY_DMABUF, FALSE);
|
|
|
|
if (group->n_mem != n_mem)
|
|
goto n_mem_missmatch;
|
|
|
|
for (i = 0; i < group->n_mem; i++) {
|
|
gint dmafd;
|
|
gsize size, offset, maxsize;
|
|
|
|
if (!gst_is_dmabuf_memory (dma_mem[i]))
|
|
goto not_dmabuf;
|
|
|
|
size = gst_memory_get_sizes (dma_mem[i], &offset, &maxsize);
|
|
|
|
dmafd = gst_dmabuf_memory_get_fd (dma_mem[i]);
|
|
|
|
GST_LOG_OBJECT (allocator, "[%i] imported DMABUF as fd %i plane %d",
|
|
group->buffer.index, dmafd, i);
|
|
|
|
mem = (GstV4l2Memory *) group->mem[i];
|
|
|
|
/* Update memory */
|
|
mem->mem.maxsize = maxsize;
|
|
mem->mem.offset = offset;
|
|
mem->mem.size = size;
|
|
mem->dmafd = dmafd;
|
|
|
|
/* Update v4l2 structure */
|
|
group->planes[i].length = maxsize;
|
|
group->planes[i].bytesused = size + offset;
|
|
group->planes[i].m.fd = dmafd;
|
|
group->planes[i].data_offset = offset;
|
|
}
|
|
|
|
/* Copy into buffer structure if not using planes */
|
|
if (!V4L2_TYPE_IS_MULTIPLANAR (obj->type)) {
|
|
group->buffer.bytesused = group->planes[0].bytesused;
|
|
group->buffer.length = group->planes[0].length;
|
|
group->buffer.m.fd = group->planes[0].m.fd;
|
|
|
|
/* FIXME Check if data_offset > 0 and fail for non-multi-planar */
|
|
g_assert (group->planes[0].data_offset == 0);
|
|
} else {
|
|
group->buffer.length = group->n_mem;
|
|
}
|
|
|
|
return TRUE;
|
|
|
|
n_mem_missmatch:
|
|
{
|
|
GST_ERROR_OBJECT (allocator, "Got %i dmabuf but needed %i", n_mem,
|
|
group->n_mem);
|
|
return FALSE;
|
|
}
|
|
not_dmabuf:
|
|
{
|
|
GST_ERROR_OBJECT (allocator, "Memory %i is not of DMABUF", i);
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
gboolean
|
|
gst_v4l2_allocator_import_userptr (GstV4l2Allocator * allocator,
|
|
GstV4l2MemoryGroup * group, gsize img_size, int n_planes,
|
|
gpointer * data, gsize * size)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
GstV4l2Memory *mem;
|
|
gint i;
|
|
|
|
g_return_val_if_fail (allocator->memory == V4L2_MEMORY_USERPTR, FALSE);
|
|
|
|
/* TODO Support passing N plane from 1 memory to MPLANE v4l2 format */
|
|
if (V4L2_TYPE_IS_MULTIPLANAR (obj->type) && n_planes != group->n_mem)
|
|
goto n_mem_missmatch;
|
|
|
|
for (i = 0; i < group->n_mem; i++) {
|
|
gsize maxsize, psize;
|
|
|
|
/* TODO request used size and maxsize separately */
|
|
if (V4L2_TYPE_IS_MULTIPLANAR (obj->type))
|
|
maxsize = psize = size[i];
|
|
else
|
|
maxsize = psize = img_size;
|
|
|
|
g_assert (psize <= img_size);
|
|
|
|
GST_LOG_OBJECT (allocator, "[%i] imported USERPTR %p plane %d size %"
|
|
G_GSIZE_FORMAT, group->buffer.index, data[i], i, psize);
|
|
|
|
mem = (GstV4l2Memory *) group->mem[i];
|
|
|
|
mem->mem.maxsize = maxsize;
|
|
mem->mem.size = psize;
|
|
mem->data = data[i];
|
|
|
|
group->planes[i].length = maxsize;
|
|
group->planes[i].bytesused = psize;
|
|
group->planes[i].m.userptr = (unsigned long) data[i];
|
|
group->planes[i].data_offset = 0;
|
|
}
|
|
|
|
/* Copy into buffer structure if not using planes */
|
|
if (!V4L2_TYPE_IS_MULTIPLANAR (obj->type)) {
|
|
group->buffer.bytesused = group->planes[0].bytesused;
|
|
group->buffer.length = group->planes[0].length;
|
|
group->buffer.m.userptr = group->planes[0].m.userptr;
|
|
} else {
|
|
group->buffer.length = group->n_mem;
|
|
}
|
|
|
|
return TRUE;
|
|
|
|
n_mem_missmatch:
|
|
{
|
|
GST_ERROR_OBJECT (allocator, "Got %i userptr plane while driver need %i",
|
|
n_planes, group->n_mem);
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
void
|
|
gst_v4l2_allocator_flush (GstV4l2Allocator * allocator)
|
|
{
|
|
gint i;
|
|
|
|
GST_OBJECT_LOCK (allocator);
|
|
|
|
if (!g_atomic_int_get (&allocator->active))
|
|
goto done;
|
|
|
|
for (i = 0; i < allocator->count; i++) {
|
|
GstV4l2MemoryGroup *group = allocator->groups[i];
|
|
gint n;
|
|
|
|
if (IS_QUEUED (group->buffer)) {
|
|
UNSET_QUEUED (group->buffer);
|
|
|
|
gst_v4l2_allocator_reset_group (allocator, group);
|
|
|
|
for (n = 0; n < group->n_mem; n++)
|
|
gst_memory_unref (group->mem[n]);
|
|
}
|
|
}
|
|
|
|
done:
|
|
GST_OBJECT_UNLOCK (allocator);
|
|
}
|
|
|
|
gboolean
|
|
gst_v4l2_allocator_qbuf (GstV4l2Allocator * allocator,
|
|
GstV4l2MemoryGroup * group)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
gboolean ret = TRUE;
|
|
gint i;
|
|
|
|
g_return_val_if_fail (g_atomic_int_get (&allocator->active), FALSE);
|
|
|
|
/* update sizes */
|
|
if (V4L2_TYPE_IS_MULTIPLANAR (obj->type)) {
|
|
for (i = 0; i < group->n_mem; i++)
|
|
group->planes[i].bytesused =
|
|
gst_memory_get_sizes (group->mem[i], NULL, NULL);
|
|
} else {
|
|
group->buffer.bytesused = gst_memory_get_sizes (group->mem[0], NULL, NULL);
|
|
}
|
|
|
|
/* Ensure the memory will stay around and is RO */
|
|
for (i = 0; i < group->n_mem; i++)
|
|
gst_memory_ref (group->mem[i]);
|
|
|
|
if (obj->ioctl (obj->video_fd, VIDIOC_QBUF, &group->buffer) < 0) {
|
|
GST_ERROR_OBJECT (allocator, "failed queueing buffer %i: %s",
|
|
group->buffer.index, g_strerror (errno));
|
|
|
|
/* Release the memory, possibly making it RW again */
|
|
for (i = 0; i < group->n_mem; i++)
|
|
gst_memory_unref (group->mem[i]);
|
|
|
|
ret = FALSE;
|
|
if (IS_QUEUED (group->buffer)) {
|
|
GST_DEBUG_OBJECT (allocator,
|
|
"driver pretends buffer is queued even if queue failed");
|
|
UNSET_QUEUED (group->buffer);
|
|
}
|
|
goto done;
|
|
}
|
|
|
|
GST_LOG_OBJECT (allocator, "queued buffer %i (flags 0x%X)",
|
|
group->buffer.index, group->buffer.flags);
|
|
|
|
if (!IS_QUEUED (group->buffer)) {
|
|
GST_DEBUG_OBJECT (allocator,
|
|
"driver pretends buffer is not queued even if queue succeeded");
|
|
SET_QUEUED (group->buffer);
|
|
}
|
|
|
|
done:
|
|
return ret;
|
|
}
|
|
|
|
GstFlowReturn
|
|
gst_v4l2_allocator_dqbuf (GstV4l2Allocator * allocator,
|
|
GstV4l2MemoryGroup ** group_out)
|
|
{
|
|
GstV4l2Object *obj = allocator->obj;
|
|
struct v4l2_buffer buffer = { 0 };
|
|
struct v4l2_plane planes[VIDEO_MAX_PLANES] = { {0} };
|
|
gint i;
|
|
|
|
GstV4l2MemoryGroup *group = NULL;
|
|
|
|
g_return_val_if_fail (g_atomic_int_get (&allocator->active), GST_FLOW_ERROR);
|
|
|
|
buffer.type = obj->type;
|
|
buffer.memory = allocator->memory;
|
|
|
|
if (V4L2_TYPE_IS_MULTIPLANAR (obj->type)) {
|
|
buffer.length = obj->format.fmt.pix_mp.num_planes;
|
|
buffer.m.planes = planes;
|
|
}
|
|
|
|
if (obj->ioctl (obj->video_fd, VIDIOC_DQBUF, &buffer) < 0)
|
|
goto error;
|
|
|
|
group = allocator->groups[buffer.index];
|
|
|
|
if (!IS_QUEUED (group->buffer)) {
|
|
GST_ERROR_OBJECT (allocator,
|
|
"buffer %i was not queued, this indicate a driver bug.", buffer.index);
|
|
return GST_FLOW_ERROR;
|
|
}
|
|
|
|
group->buffer = buffer;
|
|
|
|
GST_LOG_OBJECT (allocator, "dequeued buffer %i (flags 0x%X)", buffer.index,
|
|
buffer.flags);
|
|
|
|
if (IS_QUEUED (group->buffer)) {
|
|
GST_DEBUG_OBJECT (allocator,
|
|
"driver pretends buffer is queued even if dequeue succeeded");
|
|
UNSET_QUEUED (group->buffer);
|
|
}
|
|
|
|
if (V4L2_TYPE_IS_MULTIPLANAR (obj->type)) {
|
|
group->buffer.m.planes = group->planes;
|
|
memcpy (group->planes, buffer.m.planes, sizeof (planes));
|
|
} else {
|
|
group->planes[0].bytesused = group->buffer.bytesused;
|
|
group->planes[0].length = group->buffer.length;
|
|
g_assert (sizeof (group->planes[0].m) == sizeof (group->buffer.m));
|
|
memcpy (&group->planes[0].m, &group->buffer.m, sizeof (group->buffer.m));
|
|
}
|
|
|
|
/* And update memory size */
|
|
if (V4L2_TYPE_IS_OUTPUT (obj->type)) {
|
|
gst_v4l2_allocator_reset_size (allocator, group);
|
|
} else {
|
|
/* for capture, simply read the size */
|
|
for (i = 0; i < group->n_mem; i++) {
|
|
gsize size, offset;
|
|
|
|
GST_LOG_OBJECT (allocator,
|
|
"Dequeued capture buffer, length: %u bytesused: %u data_offset: %u",
|
|
group->planes[i].length, group->planes[i].bytesused,
|
|
group->planes[i].data_offset);
|
|
|
|
offset = group->planes[i].data_offset;
|
|
|
|
if (group->planes[i].bytesused >= group->planes[i].data_offset) {
|
|
size = group->planes[i].bytesused - group->planes[i].data_offset;
|
|
} else {
|
|
GST_WARNING_OBJECT (allocator, "V4L2 provided buffer has bytesused %"
|
|
G_GUINT32_FORMAT " which is too small to include data_offset %"
|
|
G_GUINT32_FORMAT, group->planes[i].bytesused,
|
|
group->planes[i].data_offset);
|
|
size = group->planes[i].bytesused;
|
|
}
|
|
|
|
if (G_LIKELY (size + offset <= group->mem[i]->maxsize))
|
|
gst_memory_resize (group->mem[i], offset, size);
|
|
else {
|
|
GST_WARNING_OBJECT (allocator,
|
|
"v4l2 provided buffer that is too big for the memory it was "
|
|
"writing into. v4l2 claims %" G_GSIZE_FORMAT " bytes used but "
|
|
"memory is only %" G_GSIZE_FORMAT "B. This is probably a driver "
|
|
"bug.", size, group->mem[i]->maxsize);
|
|
gst_memory_resize (group->mem[i], 0, group->mem[i]->maxsize);
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Release the memory, possibly making it RW again */
|
|
for (i = 0; i < group->n_mem; i++)
|
|
gst_memory_unref (group->mem[i]);
|
|
|
|
*group_out = group;
|
|
return GST_FLOW_OK;
|
|
|
|
error:
|
|
if (errno == EPIPE) {
|
|
GST_DEBUG_OBJECT (allocator, "broken pipe signals last buffer");
|
|
return GST_V4L2_FLOW_LAST_BUFFER;
|
|
}
|
|
|
|
GST_ERROR_OBJECT (allocator, "failed dequeuing a %s buffer: %s",
|
|
memory_type_to_str (allocator->memory), g_strerror (errno));
|
|
|
|
switch (errno) {
|
|
case EAGAIN:
|
|
GST_WARNING_OBJECT (allocator,
|
|
"Non-blocking I/O has been selected using O_NONBLOCK and"
|
|
" no buffer was in the outgoing queue.");
|
|
break;
|
|
case EINVAL:
|
|
GST_ERROR_OBJECT (allocator,
|
|
"The buffer type is not supported, or the index is out of bounds, "
|
|
"or no buffers have been allocated yet, or the userptr "
|
|
"or length are invalid.");
|
|
break;
|
|
case ENOMEM:
|
|
GST_ERROR_OBJECT (allocator,
|
|
"insufficient memory to enqueue a user pointer buffer");
|
|
break;
|
|
case EIO:
|
|
GST_INFO_OBJECT (allocator,
|
|
"VIDIOC_DQBUF failed due to an internal error."
|
|
" Can also indicate temporary problems like signal loss."
|
|
" Note the driver might dequeue an (empty) buffer despite"
|
|
" returning an error, or even stop capturing.");
|
|
/* have we de-queued a buffer ? */
|
|
if (!IS_QUEUED (buffer)) {
|
|
GST_DEBUG_OBJECT (allocator, "reenqueueing buffer");
|
|
/* FIXME ... should we do something here? */
|
|
}
|
|
break;
|
|
case EINTR:
|
|
GST_WARNING_OBJECT (allocator, "could not sync on a buffer on device");
|
|
break;
|
|
default:
|
|
GST_WARNING_OBJECT (allocator,
|
|
"Grabbing frame got interrupted unexpectedly. %d: %s.", errno,
|
|
g_strerror (errno));
|
|
break;
|
|
}
|
|
|
|
return GST_FLOW_ERROR;
|
|
}
|
|
|
|
void
|
|
gst_v4l2_allocator_reset_group (GstV4l2Allocator * allocator,
|
|
GstV4l2MemoryGroup * group)
|
|
{
|
|
switch (allocator->memory) {
|
|
case V4L2_MEMORY_USERPTR:
|
|
gst_v4l2_allocator_clear_userptr (allocator, group);
|
|
break;
|
|
case V4L2_MEMORY_DMABUF:
|
|
gst_v4l2_allocator_clear_dmabufin (allocator, group);
|
|
break;
|
|
case V4L2_MEMORY_MMAP:
|
|
break;
|
|
default:
|
|
g_assert_not_reached ();
|
|
break;
|
|
}
|
|
|
|
gst_v4l2_allocator_reset_size (allocator, group);
|
|
}
|