|
@@ -30,7 +30,7 @@
|
|
#include <media/v4l2-common.h>
|
|
#include <media/v4l2-common.h>
|
|
#include <media/videobuf2-v4l2.h>
|
|
#include <media/videobuf2-v4l2.h>
|
|
|
|
|
|
-#include <trace/events/v4l2.h>
|
|
|
|
|
|
+#include <trace/events/vb2.h>
|
|
|
|
|
|
static int debug;
|
|
static int debug;
|
|
module_param(debug, int, 0644);
|
|
module_param(debug, int, 0644);
|
|
@@ -174,6 +174,14 @@ module_param(debug, int, 0644);
|
|
|
|
|
|
#endif
|
|
#endif
|
|
|
|
|
|
|
|
+#define call_bufop(q, op, args...) \
|
|
|
|
+({ \
|
|
|
|
+ int ret = 0; \
|
|
|
|
+ if (q && q->buf_ops && q->buf_ops->op) \
|
|
|
|
+ ret = q->buf_ops->op(args); \
|
|
|
|
+ ret; \
|
|
|
|
+})
|
|
|
|
+
|
|
/* Flags that are set by the vb2 core */
|
|
/* Flags that are set by the vb2 core */
|
|
#define V4L2_BUFFER_MASK_FLAGS (V4L2_BUF_FLAG_MAPPED | V4L2_BUF_FLAG_QUEUED | \
|
|
#define V4L2_BUFFER_MASK_FLAGS (V4L2_BUF_FLAG_MAPPED | V4L2_BUF_FLAG_QUEUED | \
|
|
V4L2_BUF_FLAG_DONE | V4L2_BUF_FLAG_ERROR | \
|
|
V4L2_BUF_FLAG_DONE | V4L2_BUF_FLAG_ERROR | \
|
|
@@ -612,10 +620,10 @@ static int __verify_length(struct vb2_buffer *vb, const struct v4l2_buffer *b)
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
- * __buffer_in_use() - return true if the buffer is in use and
|
|
|
|
|
|
+ * vb2_buffer_in_use() - return true if the buffer is in use and
|
|
* the queue cannot be freed (by the means of REQBUFS(0)) call
|
|
* the queue cannot be freed (by the means of REQBUFS(0)) call
|
|
*/
|
|
*/
|
|
-static bool __buffer_in_use(struct vb2_queue *q, struct vb2_buffer *vb)
|
|
|
|
|
|
+static bool vb2_buffer_in_use(struct vb2_queue *q, struct vb2_buffer *vb)
|
|
{
|
|
{
|
|
unsigned int plane;
|
|
unsigned int plane;
|
|
for (plane = 0; plane < vb->num_planes; ++plane) {
|
|
for (plane = 0; plane < vb->num_planes; ++plane) {
|
|
@@ -640,7 +648,7 @@ static bool __buffers_in_use(struct vb2_queue *q)
|
|
{
|
|
{
|
|
unsigned int buffer;
|
|
unsigned int buffer;
|
|
for (buffer = 0; buffer < q->num_buffers; ++buffer) {
|
|
for (buffer = 0; buffer < q->num_buffers; ++buffer) {
|
|
- if (__buffer_in_use(q, q->bufs[buffer]))
|
|
|
|
|
|
+ if (vb2_buffer_in_use(q, q->bufs[buffer]))
|
|
return true;
|
|
return true;
|
|
}
|
|
}
|
|
return false;
|
|
return false;
|
|
@@ -650,8 +658,9 @@ static bool __buffers_in_use(struct vb2_queue *q)
|
|
* __fill_v4l2_buffer() - fill in a struct v4l2_buffer with information to be
|
|
* __fill_v4l2_buffer() - fill in a struct v4l2_buffer with information to be
|
|
* returned to userspace
|
|
* returned to userspace
|
|
*/
|
|
*/
|
|
-static void __fill_v4l2_buffer(struct vb2_buffer *vb, struct v4l2_buffer *b)
|
|
|
|
|
|
+static int __fill_v4l2_buffer(struct vb2_buffer *vb, void *pb)
|
|
{
|
|
{
|
|
|
|
+ struct v4l2_buffer *b = pb;
|
|
struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
|
|
struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
|
|
struct vb2_queue *q = vb->vb2_queue;
|
|
struct vb2_queue *q = vb->vb2_queue;
|
|
unsigned int plane;
|
|
unsigned int plane;
|
|
@@ -742,8 +751,28 @@ static void __fill_v4l2_buffer(struct vb2_buffer *vb, struct v4l2_buffer *b)
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
- if (__buffer_in_use(q, vb))
|
|
|
|
|
|
+ if (vb2_buffer_in_use(q, vb))
|
|
b->flags |= V4L2_BUF_FLAG_MAPPED;
|
|
b->flags |= V4L2_BUF_FLAG_MAPPED;
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * vb2_core_querybuf() - query video buffer information
|
|
|
|
+ * @q: videobuf queue
|
|
|
|
+ * @index: id number of the buffer
|
|
|
|
+ * @pb: buffer struct passed from userspace
|
|
|
|
+ *
|
|
|
|
+ * Should be called from vidioc_querybuf ioctl handler in driver.
|
|
|
|
+ * The passed buffer should have been verified.
|
|
|
|
+ * This function fills the relevant information for the userspace.
|
|
|
|
+ *
|
|
|
|
+ * The return values from this function are intended to be directly returned
|
|
|
|
+ * from vidioc_querybuf handler in driver.
|
|
|
|
+ */
|
|
|
|
+static int vb2_core_querybuf(struct vb2_queue *q, unsigned int index, void *pb)
|
|
|
|
+{
|
|
|
|
+ return call_bufop(q, fill_user_buffer, q->bufs[index], pb);
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -775,9 +804,8 @@ int vb2_querybuf(struct vb2_queue *q, struct v4l2_buffer *b)
|
|
}
|
|
}
|
|
vb = q->bufs[b->index];
|
|
vb = q->bufs[b->index];
|
|
ret = __verify_planes_array(vb, b);
|
|
ret = __verify_planes_array(vb, b);
|
|
- if (!ret)
|
|
|
|
- __fill_v4l2_buffer(vb, b);
|
|
|
|
- return ret;
|
|
|
|
|
|
+
|
|
|
|
+ return ret ? ret : vb2_core_querybuf(q, b->index, b);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(vb2_querybuf);
|
|
EXPORT_SYMBOL(vb2_querybuf);
|
|
|
|
|
|
@@ -822,10 +850,10 @@ static int __verify_dmabuf_ops(struct vb2_queue *q)
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
- * __verify_memory_type() - Check whether the memory type and buffer type
|
|
|
|
|
|
+ * vb2_verify_memory_type() - Check whether the memory type and buffer type
|
|
* passed to a buffer operation are compatible with the queue.
|
|
* passed to a buffer operation are compatible with the queue.
|
|
*/
|
|
*/
|
|
-static int __verify_memory_type(struct vb2_queue *q,
|
|
|
|
|
|
+static int vb2_verify_memory_type(struct vb2_queue *q,
|
|
enum vb2_memory memory, unsigned int type)
|
|
enum vb2_memory memory, unsigned int type)
|
|
{
|
|
{
|
|
if (memory != VB2_MEMORY_MMAP && memory != VB2_MEMORY_USERPTR &&
|
|
if (memory != VB2_MEMORY_MMAP && memory != VB2_MEMORY_USERPTR &&
|
|
@@ -871,9 +899,10 @@ static int __verify_memory_type(struct vb2_queue *q,
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
- * __reqbufs() - Initiate streaming
|
|
|
|
|
|
+ * vb2_core_reqbufs() - Initiate streaming
|
|
* @q: videobuf2 queue
|
|
* @q: videobuf2 queue
|
|
- * @req: struct passed from userspace to vidioc_reqbufs handler in driver
|
|
|
|
|
|
+ * @memory: memory type
|
|
|
|
+ * @count: requested buffer count
|
|
*
|
|
*
|
|
* Should be called from vidioc_reqbufs ioctl handler of a driver.
|
|
* Should be called from vidioc_reqbufs ioctl handler of a driver.
|
|
* This function:
|
|
* This function:
|
|
@@ -893,7 +922,8 @@ static int __verify_memory_type(struct vb2_queue *q,
|
|
* The return values from this function are intended to be directly returned
|
|
* The return values from this function are intended to be directly returned
|
|
* from vidioc_reqbufs handler in driver.
|
|
* from vidioc_reqbufs handler in driver.
|
|
*/
|
|
*/
|
|
-static int __reqbufs(struct vb2_queue *q, struct v4l2_requestbuffers *req)
|
|
|
|
|
|
+static int vb2_core_reqbufs(struct vb2_queue *q, enum vb2_memory memory,
|
|
|
|
+ unsigned int *count)
|
|
{
|
|
{
|
|
unsigned int num_buffers, allocated_buffers, num_planes = 0;
|
|
unsigned int num_buffers, allocated_buffers, num_planes = 0;
|
|
int ret;
|
|
int ret;
|
|
@@ -903,7 +933,7 @@ static int __reqbufs(struct vb2_queue *q, struct v4l2_requestbuffers *req)
|
|
return -EBUSY;
|
|
return -EBUSY;
|
|
}
|
|
}
|
|
|
|
|
|
- if (req->count == 0 || q->num_buffers != 0 || q->memory != req->memory) {
|
|
|
|
|
|
+ if (*count == 0 || q->num_buffers != 0 || q->memory != memory) {
|
|
/*
|
|
/*
|
|
* We already have buffers allocated, so first check if they
|
|
* We already have buffers allocated, so first check if they
|
|
* are not in use and can be freed.
|
|
* are not in use and can be freed.
|
|
@@ -930,18 +960,18 @@ static int __reqbufs(struct vb2_queue *q, struct v4l2_requestbuffers *req)
|
|
* In case of REQBUFS(0) return immediately without calling
|
|
* In case of REQBUFS(0) return immediately without calling
|
|
* driver's queue_setup() callback and allocating resources.
|
|
* driver's queue_setup() callback and allocating resources.
|
|
*/
|
|
*/
|
|
- if (req->count == 0)
|
|
|
|
|
|
+ if (*count == 0)
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
/*
|
|
* Make sure the requested values and current defaults are sane.
|
|
* Make sure the requested values and current defaults are sane.
|
|
*/
|
|
*/
|
|
- num_buffers = min_t(unsigned int, req->count, VB2_MAX_FRAME);
|
|
|
|
|
|
+ num_buffers = min_t(unsigned int, *count, VB2_MAX_FRAME);
|
|
num_buffers = max_t(unsigned int, num_buffers, q->min_buffers_needed);
|
|
num_buffers = max_t(unsigned int, num_buffers, q->min_buffers_needed);
|
|
memset(q->plane_sizes, 0, sizeof(q->plane_sizes));
|
|
memset(q->plane_sizes, 0, sizeof(q->plane_sizes));
|
|
memset(q->alloc_ctx, 0, sizeof(q->alloc_ctx));
|
|
memset(q->alloc_ctx, 0, sizeof(q->alloc_ctx));
|
|
- q->memory = req->memory;
|
|
|
|
|
|
+ q->memory = memory;
|
|
|
|
|
|
/*
|
|
/*
|
|
* Ask the driver how many buffers and planes per buffer it requires.
|
|
* Ask the driver how many buffers and planes per buffer it requires.
|
|
@@ -953,7 +983,8 @@ static int __reqbufs(struct vb2_queue *q, struct v4l2_requestbuffers *req)
|
|
return ret;
|
|
return ret;
|
|
|
|
|
|
/* Finally, allocate buffers and video memory */
|
|
/* Finally, allocate buffers and video memory */
|
|
- allocated_buffers = __vb2_queue_alloc(q, req->memory, num_buffers, num_planes);
|
|
|
|
|
|
+ allocated_buffers =
|
|
|
|
+ __vb2_queue_alloc(q, memory, num_buffers, num_planes);
|
|
if (allocated_buffers == 0) {
|
|
if (allocated_buffers == 0) {
|
|
dprintk(1, "memory allocation failed\n");
|
|
dprintk(1, "memory allocation failed\n");
|
|
return -ENOMEM;
|
|
return -ENOMEM;
|
|
@@ -1002,31 +1033,33 @@ static int __reqbufs(struct vb2_queue *q, struct v4l2_requestbuffers *req)
|
|
* Return the number of successfully allocated buffers
|
|
* Return the number of successfully allocated buffers
|
|
* to the userspace.
|
|
* to the userspace.
|
|
*/
|
|
*/
|
|
- req->count = allocated_buffers;
|
|
|
|
|
|
+ *count = allocated_buffers;
|
|
q->waiting_for_buffers = !q->is_output;
|
|
q->waiting_for_buffers = !q->is_output;
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
- * vb2_reqbufs() - Wrapper for __reqbufs() that also verifies the memory and
|
|
|
|
- * type values.
|
|
|
|
|
|
+ * vb2_reqbufs() - Wrapper for vb2_core_reqbufs() that also verifies
|
|
|
|
+ * the memory and type values.
|
|
* @q: videobuf2 queue
|
|
* @q: videobuf2 queue
|
|
- * @req: struct passed from userspace to vidioc_reqbufs handler in driver
|
|
|
|
|
|
+ * @req: struct passed from userspace to vidioc_reqbufs handler
|
|
|
|
+ * in driver
|
|
*/
|
|
*/
|
|
int vb2_reqbufs(struct vb2_queue *q, struct v4l2_requestbuffers *req)
|
|
int vb2_reqbufs(struct vb2_queue *q, struct v4l2_requestbuffers *req)
|
|
{
|
|
{
|
|
- int ret = __verify_memory_type(q, req->memory, req->type);
|
|
|
|
|
|
+ int ret = vb2_verify_memory_type(q, req->memory, req->type);
|
|
|
|
|
|
- return ret ? ret : __reqbufs(q, req);
|
|
|
|
|
|
+ return ret ? ret : vb2_core_reqbufs(q, req->memory, &req->count);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(vb2_reqbufs);
|
|
EXPORT_SYMBOL_GPL(vb2_reqbufs);
|
|
|
|
|
|
/**
|
|
/**
|
|
- * __create_bufs() - Allocate buffers and any required auxiliary structs
|
|
|
|
|
|
+ * vb2_core_create_bufs() - Allocate buffers and any required auxiliary structs
|
|
* @q: videobuf2 queue
|
|
* @q: videobuf2 queue
|
|
- * @create: creation parameters, passed from userspace to vidioc_create_bufs
|
|
|
|
- * handler in driver
|
|
|
|
|
|
+ * @memory: memory type
|
|
|
|
+ * @count: requested buffer count
|
|
|
|
+ * @parg: parameter passed to device driver
|
|
*
|
|
*
|
|
* Should be called from vidioc_create_bufs ioctl handler of a driver.
|
|
* Should be called from vidioc_create_bufs ioctl handler of a driver.
|
|
* This function:
|
|
* This function:
|
|
@@ -1037,7 +1070,8 @@ EXPORT_SYMBOL_GPL(vb2_reqbufs);
|
|
* The return values from this function are intended to be directly returned
|
|
* The return values from this function are intended to be directly returned
|
|
* from vidioc_create_bufs handler in driver.
|
|
* from vidioc_create_bufs handler in driver.
|
|
*/
|
|
*/
|
|
-static int __create_bufs(struct vb2_queue *q, struct v4l2_create_buffers *create)
|
|
|
|
|
|
+static int vb2_core_create_bufs(struct vb2_queue *q, enum vb2_memory memory,
|
|
|
|
+ unsigned int *count, const void *parg)
|
|
{
|
|
{
|
|
unsigned int num_planes = 0, num_buffers, allocated_buffers;
|
|
unsigned int num_planes = 0, num_buffers, allocated_buffers;
|
|
int ret;
|
|
int ret;
|
|
@@ -1050,23 +1084,23 @@ static int __create_bufs(struct vb2_queue *q, struct v4l2_create_buffers *create
|
|
if (!q->num_buffers) {
|
|
if (!q->num_buffers) {
|
|
memset(q->plane_sizes, 0, sizeof(q->plane_sizes));
|
|
memset(q->plane_sizes, 0, sizeof(q->plane_sizes));
|
|
memset(q->alloc_ctx, 0, sizeof(q->alloc_ctx));
|
|
memset(q->alloc_ctx, 0, sizeof(q->alloc_ctx));
|
|
- q->memory = create->memory;
|
|
|
|
|
|
+ q->memory = memory;
|
|
q->waiting_for_buffers = !q->is_output;
|
|
q->waiting_for_buffers = !q->is_output;
|
|
}
|
|
}
|
|
|
|
|
|
- num_buffers = min(create->count, VB2_MAX_FRAME - q->num_buffers);
|
|
|
|
|
|
+ num_buffers = min(*count, VB2_MAX_FRAME - q->num_buffers);
|
|
|
|
|
|
/*
|
|
/*
|
|
* Ask the driver, whether the requested number of buffers, planes per
|
|
* Ask the driver, whether the requested number of buffers, planes per
|
|
* buffer and their sizes are acceptable
|
|
* buffer and their sizes are acceptable
|
|
*/
|
|
*/
|
|
- ret = call_qop(q, queue_setup, q, &create->format, &num_buffers,
|
|
|
|
|
|
+ ret = call_qop(q, queue_setup, q, parg, &num_buffers,
|
|
&num_planes, q->plane_sizes, q->alloc_ctx);
|
|
&num_planes, q->plane_sizes, q->alloc_ctx);
|
|
if (ret)
|
|
if (ret)
|
|
return ret;
|
|
return ret;
|
|
|
|
|
|
/* Finally, allocate buffers and video memory */
|
|
/* Finally, allocate buffers and video memory */
|
|
- allocated_buffers = __vb2_queue_alloc(q, create->memory, num_buffers,
|
|
|
|
|
|
+ allocated_buffers = __vb2_queue_alloc(q, memory, num_buffers,
|
|
num_planes);
|
|
num_planes);
|
|
if (allocated_buffers == 0) {
|
|
if (allocated_buffers == 0) {
|
|
dprintk(1, "memory allocation failed\n");
|
|
dprintk(1, "memory allocation failed\n");
|
|
@@ -1083,7 +1117,7 @@ static int __create_bufs(struct vb2_queue *q, struct v4l2_create_buffers *create
|
|
* q->num_buffers contains the total number of buffers, that the
|
|
* q->num_buffers contains the total number of buffers, that the
|
|
* queue driver has set up
|
|
* queue driver has set up
|
|
*/
|
|
*/
|
|
- ret = call_qop(q, queue_setup, q, &create->format, &num_buffers,
|
|
|
|
|
|
+ ret = call_qop(q, queue_setup, q, parg, &num_buffers,
|
|
&num_planes, q->plane_sizes, q->alloc_ctx);
|
|
&num_planes, q->plane_sizes, q->alloc_ctx);
|
|
|
|
|
|
if (!ret && allocated_buffers < num_buffers)
|
|
if (!ret && allocated_buffers < num_buffers)
|
|
@@ -1113,26 +1147,28 @@ static int __create_bufs(struct vb2_queue *q, struct v4l2_create_buffers *create
|
|
* Return the number of successfully allocated buffers
|
|
* Return the number of successfully allocated buffers
|
|
* to the userspace.
|
|
* to the userspace.
|
|
*/
|
|
*/
|
|
- create->count = allocated_buffers;
|
|
|
|
|
|
+ *count = allocated_buffers;
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
- * vb2_create_bufs() - Wrapper for __create_bufs() that also verifies the
|
|
|
|
- * memory and type values.
|
|
|
|
|
|
+ * vb2_create_bufs() - Wrapper for vb2_core_create_bufs() that also verifies
|
|
|
|
+ * the memory and type values.
|
|
* @q: videobuf2 queue
|
|
* @q: videobuf2 queue
|
|
* @create: creation parameters, passed from userspace to vidioc_create_bufs
|
|
* @create: creation parameters, passed from userspace to vidioc_create_bufs
|
|
* handler in driver
|
|
* handler in driver
|
|
*/
|
|
*/
|
|
int vb2_create_bufs(struct vb2_queue *q, struct v4l2_create_buffers *create)
|
|
int vb2_create_bufs(struct vb2_queue *q, struct v4l2_create_buffers *create)
|
|
{
|
|
{
|
|
- int ret = __verify_memory_type(q, create->memory, create->format.type);
|
|
|
|
|
|
+ int ret = vb2_verify_memory_type(q, create->memory,
|
|
|
|
+ create->format.type);
|
|
|
|
|
|
create->index = q->num_buffers;
|
|
create->index = q->num_buffers;
|
|
if (create->count == 0)
|
|
if (create->count == 0)
|
|
return ret != -EBUSY ? ret : 0;
|
|
return ret != -EBUSY ? ret : 0;
|
|
- return ret ? ret : __create_bufs(q, create);
|
|
|
|
|
|
+ return ret ? ret : vb2_core_create_bufs(q, create->memory,
|
|
|
|
+ &create->count, &create->format);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(vb2_create_bufs);
|
|
EXPORT_SYMBOL_GPL(vb2_create_bufs);
|
|
|
|
|
|
@@ -1293,16 +1329,64 @@ static void vb2_warn_zero_bytesused(struct vb2_buffer *vb)
|
|
pr_warn("use the actual size instead.\n");
|
|
pr_warn("use the actual size instead.\n");
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+static int __set_timestamp(struct vb2_buffer *vb, const void *pb)
|
|
|
|
+{
|
|
|
|
+ const struct v4l2_buffer *b = pb;
|
|
|
|
+ struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
|
|
|
|
+ struct vb2_queue *q = vb->vb2_queue;
|
|
|
|
+
|
|
|
|
+ if (q->is_output) {
|
|
|
|
+ /*
|
|
|
|
+ * For output buffers copy the timestamp if needed,
|
|
|
|
+ * and the timecode field and flag if needed.
|
|
|
|
+ */
|
|
|
|
+ if ((q->timestamp_flags & V4L2_BUF_FLAG_TIMESTAMP_MASK) ==
|
|
|
|
+ V4L2_BUF_FLAG_TIMESTAMP_COPY)
|
|
|
|
+ vbuf->timestamp = b->timestamp;
|
|
|
|
+ vbuf->flags |= b->flags & V4L2_BUF_FLAG_TIMECODE;
|
|
|
|
+ if (b->flags & V4L2_BUF_FLAG_TIMECODE)
|
|
|
|
+ vbuf->timecode = b->timecode;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+};
|
|
|
|
+
|
|
/**
|
|
/**
|
|
* __fill_vb2_buffer() - fill a vb2_buffer with information provided in a
|
|
* __fill_vb2_buffer() - fill a vb2_buffer with information provided in a
|
|
- * v4l2_buffer by the userspace. The caller has already verified that struct
|
|
|
|
|
|
+ * v4l2_buffer by the userspace. It also verifies that struct
|
|
* v4l2_buffer has a valid number of planes.
|
|
* v4l2_buffer has a valid number of planes.
|
|
*/
|
|
*/
|
|
-static void __fill_vb2_buffer(struct vb2_buffer *vb,
|
|
|
|
- const struct v4l2_buffer *b, struct vb2_plane *planes)
|
|
|
|
|
|
+static int __fill_vb2_buffer(struct vb2_buffer *vb,
|
|
|
|
+ const void *pb, struct vb2_plane *planes)
|
|
{
|
|
{
|
|
|
|
+ struct vb2_queue *q = vb->vb2_queue;
|
|
|
|
+ const struct v4l2_buffer *b = pb;
|
|
struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
|
|
struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
|
|
unsigned int plane;
|
|
unsigned int plane;
|
|
|
|
+ int ret;
|
|
|
|
+
|
|
|
|
+ ret = __verify_length(vb, b);
|
|
|
|
+ if (ret < 0) {
|
|
|
|
+ dprintk(1, "plane parameters verification failed: %d\n", ret);
|
|
|
|
+ return ret;
|
|
|
|
+ }
|
|
|
|
+ if (b->field == V4L2_FIELD_ALTERNATE && q->is_output) {
|
|
|
|
+ /*
|
|
|
|
+ * If the format's field is ALTERNATE, then the buffer's field
|
|
|
|
+ * should be either TOP or BOTTOM, not ALTERNATE since that
|
|
|
|
+ * makes no sense. The driver has to know whether the
|
|
|
|
+ * buffer represents a top or a bottom field in order to
|
|
|
|
+ * program any DMA correctly. Using ALTERNATE is wrong, since
|
|
|
|
+ * that just says that it is either a top or a bottom field,
|
|
|
|
+ * but not which of the two it is.
|
|
|
|
+ */
|
|
|
|
+ dprintk(1, "the field is incorrectly set to ALTERNATE "
|
|
|
|
+ "for an output buffer\n");
|
|
|
|
+ return -EINVAL;
|
|
|
|
+ }
|
|
|
|
+ vbuf->timestamp.tv_sec = 0;
|
|
|
|
+ vbuf->timestamp.tv_usec = 0;
|
|
|
|
+ vbuf->sequence = 0;
|
|
|
|
|
|
if (V4L2_TYPE_IS_MULTIPLANAR(b->type)) {
|
|
if (V4L2_TYPE_IS_MULTIPLANAR(b->type)) {
|
|
if (b->memory == VB2_MEMORY_USERPTR) {
|
|
if (b->memory == VB2_MEMORY_USERPTR) {
|
|
@@ -1419,21 +1503,24 @@ static void __fill_vb2_buffer(struct vb2_buffer *vb,
|
|
/* Zero any output buffer flags as this is a capture buffer */
|
|
/* Zero any output buffer flags as this is a capture buffer */
|
|
vbuf->flags &= ~V4L2_BUFFER_OUT_FLAGS;
|
|
vbuf->flags &= ~V4L2_BUFFER_OUT_FLAGS;
|
|
}
|
|
}
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
* __qbuf_mmap() - handle qbuf of an MMAP buffer
|
|
* __qbuf_mmap() - handle qbuf of an MMAP buffer
|
|
*/
|
|
*/
|
|
-static int __qbuf_mmap(struct vb2_buffer *vb, const struct v4l2_buffer *b)
|
|
|
|
|
|
+static int __qbuf_mmap(struct vb2_buffer *vb, const void *pb)
|
|
{
|
|
{
|
|
- __fill_vb2_buffer(vb, b, vb->planes);
|
|
|
|
- return call_vb_qop(vb, buf_prepare, vb);
|
|
|
|
|
|
+ int ret = call_bufop(vb->vb2_queue, fill_vb2_buffer,
|
|
|
|
+ vb, pb, vb->planes);
|
|
|
|
+ return ret ? ret : call_vb_qop(vb, buf_prepare, vb);
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
* __qbuf_userptr() - handle qbuf of a USERPTR buffer
|
|
* __qbuf_userptr() - handle qbuf of a USERPTR buffer
|
|
*/
|
|
*/
|
|
-static int __qbuf_userptr(struct vb2_buffer *vb, const struct v4l2_buffer *b)
|
|
|
|
|
|
+static int __qbuf_userptr(struct vb2_buffer *vb, const void *pb)
|
|
{
|
|
{
|
|
struct vb2_plane planes[VB2_MAX_PLANES];
|
|
struct vb2_plane planes[VB2_MAX_PLANES];
|
|
struct vb2_queue *q = vb->vb2_queue;
|
|
struct vb2_queue *q = vb->vb2_queue;
|
|
@@ -1446,7 +1533,9 @@ static int __qbuf_userptr(struct vb2_buffer *vb, const struct v4l2_buffer *b)
|
|
|
|
|
|
memset(planes, 0, sizeof(planes[0]) * vb->num_planes);
|
|
memset(planes, 0, sizeof(planes[0]) * vb->num_planes);
|
|
/* Copy relevant information provided by the userspace */
|
|
/* Copy relevant information provided by the userspace */
|
|
- __fill_vb2_buffer(vb, b, planes);
|
|
|
|
|
|
+ ret = call_bufop(vb->vb2_queue, fill_vb2_buffer, vb, pb, planes);
|
|
|
|
+ if (ret)
|
|
|
|
+ return ret;
|
|
|
|
|
|
for (plane = 0; plane < vb->num_planes; ++plane) {
|
|
for (plane = 0; plane < vb->num_planes; ++plane) {
|
|
/* Skip the plane if already verified */
|
|
/* Skip the plane if already verified */
|
|
@@ -1545,7 +1634,7 @@ err:
|
|
/**
|
|
/**
|
|
* __qbuf_dmabuf() - handle qbuf of a DMABUF buffer
|
|
* __qbuf_dmabuf() - handle qbuf of a DMABUF buffer
|
|
*/
|
|
*/
|
|
-static int __qbuf_dmabuf(struct vb2_buffer *vb, const struct v4l2_buffer *b)
|
|
|
|
|
|
+static int __qbuf_dmabuf(struct vb2_buffer *vb, const void *pb)
|
|
{
|
|
{
|
|
struct vb2_plane planes[VB2_MAX_PLANES];
|
|
struct vb2_plane planes[VB2_MAX_PLANES];
|
|
struct vb2_queue *q = vb->vb2_queue;
|
|
struct vb2_queue *q = vb->vb2_queue;
|
|
@@ -1558,7 +1647,9 @@ static int __qbuf_dmabuf(struct vb2_buffer *vb, const struct v4l2_buffer *b)
|
|
|
|
|
|
memset(planes, 0, sizeof(planes[0]) * vb->num_planes);
|
|
memset(planes, 0, sizeof(planes[0]) * vb->num_planes);
|
|
/* Copy relevant information provided by the userspace */
|
|
/* Copy relevant information provided by the userspace */
|
|
- __fill_vb2_buffer(vb, b, planes);
|
|
|
|
|
|
+ ret = call_bufop(vb->vb2_queue, fill_vb2_buffer, vb, pb, planes);
|
|
|
|
+ if (ret)
|
|
|
|
+ return ret;
|
|
|
|
|
|
for (plane = 0; plane < vb->num_planes; ++plane) {
|
|
for (plane = 0; plane < vb->num_planes; ++plane) {
|
|
struct dma_buf *dbuf = dma_buf_get(planes[plane].m.fd);
|
|
struct dma_buf *dbuf = dma_buf_get(planes[plane].m.fd);
|
|
@@ -1689,50 +1780,27 @@ static void __enqueue_in_driver(struct vb2_buffer *vb)
|
|
call_void_vb_qop(vb, buf_queue, vb);
|
|
call_void_vb_qop(vb, buf_queue, vb);
|
|
}
|
|
}
|
|
|
|
|
|
-static int __buf_prepare(struct vb2_buffer *vb, const struct v4l2_buffer *b)
|
|
|
|
|
|
+static int __buf_prepare(struct vb2_buffer *vb, const void *pb)
|
|
{
|
|
{
|
|
- struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
|
|
|
|
struct vb2_queue *q = vb->vb2_queue;
|
|
struct vb2_queue *q = vb->vb2_queue;
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
- ret = __verify_length(vb, b);
|
|
|
|
- if (ret < 0) {
|
|
|
|
- dprintk(1, "plane parameters verification failed: %d\n", ret);
|
|
|
|
- return ret;
|
|
|
|
- }
|
|
|
|
- if (b->field == V4L2_FIELD_ALTERNATE && q->is_output) {
|
|
|
|
- /*
|
|
|
|
- * If the format's field is ALTERNATE, then the buffer's field
|
|
|
|
- * should be either TOP or BOTTOM, not ALTERNATE since that
|
|
|
|
- * makes no sense. The driver has to know whether the
|
|
|
|
- * buffer represents a top or a bottom field in order to
|
|
|
|
- * program any DMA correctly. Using ALTERNATE is wrong, since
|
|
|
|
- * that just says that it is either a top or a bottom field,
|
|
|
|
- * but not which of the two it is.
|
|
|
|
- */
|
|
|
|
- dprintk(1, "the field is incorrectly set to ALTERNATE for an output buffer\n");
|
|
|
|
- return -EINVAL;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
if (q->error) {
|
|
if (q->error) {
|
|
dprintk(1, "fatal error occurred on queue\n");
|
|
dprintk(1, "fatal error occurred on queue\n");
|
|
return -EIO;
|
|
return -EIO;
|
|
}
|
|
}
|
|
|
|
|
|
vb->state = VB2_BUF_STATE_PREPARING;
|
|
vb->state = VB2_BUF_STATE_PREPARING;
|
|
- vbuf->timestamp.tv_sec = 0;
|
|
|
|
- vbuf->timestamp.tv_usec = 0;
|
|
|
|
- vbuf->sequence = 0;
|
|
|
|
|
|
|
|
switch (q->memory) {
|
|
switch (q->memory) {
|
|
case VB2_MEMORY_MMAP:
|
|
case VB2_MEMORY_MMAP:
|
|
- ret = __qbuf_mmap(vb, b);
|
|
|
|
|
|
+ ret = __qbuf_mmap(vb, pb);
|
|
break;
|
|
break;
|
|
case VB2_MEMORY_USERPTR:
|
|
case VB2_MEMORY_USERPTR:
|
|
- ret = __qbuf_userptr(vb, b);
|
|
|
|
|
|
+ ret = __qbuf_userptr(vb, pb);
|
|
break;
|
|
break;
|
|
case VB2_MEMORY_DMABUF:
|
|
case VB2_MEMORY_DMABUF:
|
|
- ret = __qbuf_dmabuf(vb, b);
|
|
|
|
|
|
+ ret = __qbuf_dmabuf(vb, pb);
|
|
break;
|
|
break;
|
|
default:
|
|
default:
|
|
WARN(1, "Invalid queue type\n");
|
|
WARN(1, "Invalid queue type\n");
|
|
@@ -1773,6 +1841,48 @@ static int vb2_queue_or_prepare_buf(struct vb2_queue *q, struct v4l2_buffer *b,
|
|
return __verify_planes_array(q->bufs[b->index], b);
|
|
return __verify_planes_array(q->bufs[b->index], b);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+/**
|
|
|
|
+ * vb2_core_prepare_buf() - Pass ownership of a buffer from userspace
|
|
|
|
+ * to the kernel
|
|
|
|
+ * @q: videobuf2 queue
|
|
|
|
+ * @index: id number of the buffer
|
|
|
|
+ * @pb: buffer structure passed from userspace to vidioc_prepare_buf
|
|
|
|
+ * handler in driver
|
|
|
|
+ *
|
|
|
|
+ * Should be called from vidioc_prepare_buf ioctl handler of a driver.
|
|
|
|
+ * The passed buffer should have been verified.
|
|
|
|
+ * This function calls buf_prepare callback in the driver (if provided),
|
|
|
|
+ * in which driver-specific buffer initialization can be performed,
|
|
|
|
+ *
|
|
|
|
+ * The return values from this function are intended to be directly returned
|
|
|
|
+ * from vidioc_prepare_buf handler in driver.
|
|
|
|
+ */
|
|
|
|
+static int vb2_core_prepare_buf(struct vb2_queue *q, unsigned int index, void *pb)
|
|
|
|
+{
|
|
|
|
+ struct vb2_buffer *vb;
|
|
|
|
+ int ret;
|
|
|
|
+
|
|
|
|
+ vb = q->bufs[index];
|
|
|
|
+ if (vb->state != VB2_BUF_STATE_DEQUEUED) {
|
|
|
|
+ dprintk(1, "invalid buffer state %d\n",
|
|
|
|
+ vb->state);
|
|
|
|
+ return -EINVAL;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ ret = __buf_prepare(vb, pb);
|
|
|
|
+ if (ret)
|
|
|
|
+ return ret;
|
|
|
|
+
|
|
|
|
+ /* Fill buffer information for the userspace */
|
|
|
|
+ ret = call_bufop(q, fill_user_buffer, vb, pb);
|
|
|
|
+ if (ret)
|
|
|
|
+ return ret;
|
|
|
|
+
|
|
|
|
+ dprintk(1, "prepare of buffer %d succeeded\n", vb->index);
|
|
|
|
+
|
|
|
|
+ return ret;
|
|
|
|
+}
|
|
|
|
+
|
|
/**
|
|
/**
|
|
* vb2_prepare_buf() - Pass ownership of a buffer from userspace to the kernel
|
|
* vb2_prepare_buf() - Pass ownership of a buffer from userspace to the kernel
|
|
* @q: videobuf2 queue
|
|
* @q: videobuf2 queue
|
|
@@ -1790,7 +1900,6 @@ static int vb2_queue_or_prepare_buf(struct vb2_queue *q, struct v4l2_buffer *b,
|
|
*/
|
|
*/
|
|
int vb2_prepare_buf(struct vb2_queue *q, struct v4l2_buffer *b)
|
|
int vb2_prepare_buf(struct vb2_queue *q, struct v4l2_buffer *b)
|
|
{
|
|
{
|
|
- struct vb2_buffer *vb;
|
|
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
if (vb2_fileio_is_active(q)) {
|
|
if (vb2_fileio_is_active(q)) {
|
|
@@ -1799,24 +1908,8 @@ int vb2_prepare_buf(struct vb2_queue *q, struct v4l2_buffer *b)
|
|
}
|
|
}
|
|
|
|
|
|
ret = vb2_queue_or_prepare_buf(q, b, "prepare_buf");
|
|
ret = vb2_queue_or_prepare_buf(q, b, "prepare_buf");
|
|
- if (ret)
|
|
|
|
- return ret;
|
|
|
|
|
|
|
|
- vb = q->bufs[b->index];
|
|
|
|
- if (vb->state != VB2_BUF_STATE_DEQUEUED) {
|
|
|
|
- dprintk(1, "invalid buffer state %d\n",
|
|
|
|
- vb->state);
|
|
|
|
- return -EINVAL;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- ret = __buf_prepare(vb, b);
|
|
|
|
- if (!ret) {
|
|
|
|
- /* Fill buffer information for the userspace */
|
|
|
|
- __fill_v4l2_buffer(vb, b);
|
|
|
|
-
|
|
|
|
- dprintk(1, "prepare of buffer %d succeeded\n", vb->index);
|
|
|
|
- }
|
|
|
|
- return ret;
|
|
|
|
|
|
+ return ret ? ret : vb2_core_prepare_buf(q, b->index, b);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(vb2_prepare_buf);
|
|
EXPORT_SYMBOL_GPL(vb2_prepare_buf);
|
|
|
|
|
|
@@ -1883,21 +1976,34 @@ static int vb2_start_streaming(struct vb2_queue *q)
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
-static int vb2_internal_qbuf(struct vb2_queue *q, struct v4l2_buffer *b)
|
|
|
|
|
|
+/**
|
|
|
|
+ * vb2_core_qbuf() - Queue a buffer from userspace
|
|
|
|
+ * @q: videobuf2 queue
|
|
|
|
+ * @index: id number of the buffer
|
|
|
|
+ * @pb: buffer structure passed from userspace to vidioc_qbuf handler
|
|
|
|
+ * in driver
|
|
|
|
+ *
|
|
|
|
+ * Should be called from vidioc_qbuf ioctl handler of a driver.
|
|
|
|
+ * The passed buffer should have been verified.
|
|
|
|
+ * This function:
|
|
|
|
+ * 1) if necessary, calls buf_prepare callback in the driver (if provided), in
|
|
|
|
+ * which driver-specific buffer initialization can be performed,
|
|
|
|
+ * 2) if streaming is on, queues the buffer in driver by the means of buf_queue
|
|
|
|
+ * callback for processing.
|
|
|
|
+ *
|
|
|
|
+ * The return values from this function are intended to be directly returned
|
|
|
|
+ * from vidioc_qbuf handler in driver.
|
|
|
|
+ */
|
|
|
|
+static int vb2_core_qbuf(struct vb2_queue *q, unsigned int index, void *pb)
|
|
{
|
|
{
|
|
- int ret = vb2_queue_or_prepare_buf(q, b, "qbuf");
|
|
|
|
struct vb2_buffer *vb;
|
|
struct vb2_buffer *vb;
|
|
- struct vb2_v4l2_buffer *vbuf;
|
|
|
|
-
|
|
|
|
- if (ret)
|
|
|
|
- return ret;
|
|
|
|
|
|
+ int ret;
|
|
|
|
|
|
- vb = q->bufs[b->index];
|
|
|
|
- vbuf = to_vb2_v4l2_buffer(vb);
|
|
|
|
|
|
+ vb = q->bufs[index];
|
|
|
|
|
|
switch (vb->state) {
|
|
switch (vb->state) {
|
|
case VB2_BUF_STATE_DEQUEUED:
|
|
case VB2_BUF_STATE_DEQUEUED:
|
|
- ret = __buf_prepare(vb, b);
|
|
|
|
|
|
+ ret = __buf_prepare(vb, pb);
|
|
if (ret)
|
|
if (ret)
|
|
return ret;
|
|
return ret;
|
|
break;
|
|
break;
|
|
@@ -1919,18 +2025,8 @@ static int vb2_internal_qbuf(struct vb2_queue *q, struct v4l2_buffer *b)
|
|
q->queued_count++;
|
|
q->queued_count++;
|
|
q->waiting_for_buffers = false;
|
|
q->waiting_for_buffers = false;
|
|
vb->state = VB2_BUF_STATE_QUEUED;
|
|
vb->state = VB2_BUF_STATE_QUEUED;
|
|
- if (q->is_output) {
|
|
|
|
- /*
|
|
|
|
- * For output buffers copy the timestamp if needed,
|
|
|
|
- * and the timecode field and flag if needed.
|
|
|
|
- */
|
|
|
|
- if ((q->timestamp_flags & V4L2_BUF_FLAG_TIMESTAMP_MASK) ==
|
|
|
|
- V4L2_BUF_FLAG_TIMESTAMP_COPY)
|
|
|
|
- vbuf->timestamp = b->timestamp;
|
|
|
|
- vbuf->flags |= b->flags & V4L2_BUF_FLAG_TIMECODE;
|
|
|
|
- if (b->flags & V4L2_BUF_FLAG_TIMECODE)
|
|
|
|
- vbuf->timecode = b->timecode;
|
|
|
|
- }
|
|
|
|
|
|
+
|
|
|
|
+ __set_timestamp(vb, pb);
|
|
|
|
|
|
trace_vb2_qbuf(q, vb);
|
|
trace_vb2_qbuf(q, vb);
|
|
|
|
|
|
@@ -1942,7 +2038,9 @@ static int vb2_internal_qbuf(struct vb2_queue *q, struct v4l2_buffer *b)
|
|
__enqueue_in_driver(vb);
|
|
__enqueue_in_driver(vb);
|
|
|
|
|
|
/* Fill buffer information for the userspace */
|
|
/* Fill buffer information for the userspace */
|
|
- __fill_v4l2_buffer(vb, b);
|
|
|
|
|
|
+ ret = call_bufop(q, fill_user_buffer, vb, pb);
|
|
|
|
+ if (ret)
|
|
|
|
+ return ret;
|
|
|
|
|
|
/*
|
|
/*
|
|
* If streamon has been called, and we haven't yet called
|
|
* If streamon has been called, and we haven't yet called
|
|
@@ -1961,6 +2059,13 @@ static int vb2_internal_qbuf(struct vb2_queue *q, struct v4l2_buffer *b)
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+static int vb2_internal_qbuf(struct vb2_queue *q, struct v4l2_buffer *b)
|
|
|
|
+{
|
|
|
|
+ int ret = vb2_queue_or_prepare_buf(q, b, "qbuf");
|
|
|
|
+
|
|
|
|
+ return ret ? ret : vb2_core_qbuf(q, b->index, b);
|
|
|
|
+}
|
|
|
|
+
|
|
/**
|
|
/**
|
|
* vb2_qbuf() - Queue a buffer from userspace
|
|
* vb2_qbuf() - Queue a buffer from userspace
|
|
* @q: videobuf2 queue
|
|
* @q: videobuf2 queue
|
|
@@ -2071,7 +2176,7 @@ static int __vb2_wait_for_done_vb(struct vb2_queue *q, int nonblocking)
|
|
* Will sleep if required for nonblocking == false.
|
|
* Will sleep if required for nonblocking == false.
|
|
*/
|
|
*/
|
|
static int __vb2_get_done_vb(struct vb2_queue *q, struct vb2_buffer **vb,
|
|
static int __vb2_get_done_vb(struct vb2_queue *q, struct vb2_buffer **vb,
|
|
- struct v4l2_buffer *b, int nonblocking)
|
|
|
|
|
|
+ int nonblocking)
|
|
{
|
|
{
|
|
unsigned long flags;
|
|
unsigned long flags;
|
|
int ret;
|
|
int ret;
|
|
@@ -2092,10 +2197,10 @@ static int __vb2_get_done_vb(struct vb2_queue *q, struct vb2_buffer **vb,
|
|
/*
|
|
/*
|
|
* Only remove the buffer from done_list if v4l2_buffer can handle all
|
|
* Only remove the buffer from done_list if v4l2_buffer can handle all
|
|
* the planes.
|
|
* the planes.
|
|
|
|
+ * Verifying planes is NOT necessary since it already has been checked
|
|
|
|
+ * before the buffer is queued/prepared. So it can never fail.
|
|
*/
|
|
*/
|
|
- ret = __verify_planes_array(*vb, b);
|
|
|
|
- if (!ret)
|
|
|
|
- list_del(&(*vb)->done_entry);
|
|
|
|
|
|
+ list_del(&(*vb)->done_entry);
|
|
spin_unlock_irqrestore(&q->done_lock, flags);
|
|
spin_unlock_irqrestore(&q->done_lock, flags);
|
|
|
|
|
|
return ret;
|
|
return ret;
|
|
@@ -2147,18 +2252,33 @@ static void __vb2_dqbuf(struct vb2_buffer *vb)
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
-static int vb2_internal_dqbuf(struct vb2_queue *q, struct v4l2_buffer *b,
|
|
|
|
- bool nonblocking)
|
|
|
|
|
|
+/**
|
|
|
|
+ * vb2_dqbuf() - Dequeue a buffer to the userspace
|
|
|
|
+ * @q: videobuf2 queue
|
|
|
|
+ * @pb: buffer structure passed from userspace to vidioc_dqbuf handler
|
|
|
|
+ * in driver
|
|
|
|
+ * @nonblocking: if true, this call will not sleep waiting for a buffer if no
|
|
|
|
+ * buffers ready for dequeuing are present. Normally the driver
|
|
|
|
+ * would be passing (file->f_flags & O_NONBLOCK) here
|
|
|
|
+ *
|
|
|
|
+ * Should be called from vidioc_dqbuf ioctl handler of a driver.
|
|
|
|
+ * The passed buffer should have been verified.
|
|
|
|
+ * This function:
|
|
|
|
+ * 1) calls buf_finish callback in the driver (if provided), in which
|
|
|
|
+ * driver can perform any additional operations that may be required before
|
|
|
|
+ * returning the buffer to userspace, such as cache sync,
|
|
|
|
+ * 2) the buffer struct members are filled with relevant information for
|
|
|
|
+ * the userspace.
|
|
|
|
+ *
|
|
|
|
+ * The return values from this function are intended to be directly returned
|
|
|
|
+ * from vidioc_dqbuf handler in driver.
|
|
|
|
+ */
|
|
|
|
+static int vb2_core_dqbuf(struct vb2_queue *q, void *pb, bool nonblocking)
|
|
{
|
|
{
|
|
struct vb2_buffer *vb = NULL;
|
|
struct vb2_buffer *vb = NULL;
|
|
- struct vb2_v4l2_buffer *vbuf = NULL;
|
|
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
- if (b->type != q->type) {
|
|
|
|
- dprintk(1, "invalid buffer type\n");
|
|
|
|
- return -EINVAL;
|
|
|
|
- }
|
|
|
|
- ret = __vb2_get_done_vb(q, &vb, b, nonblocking);
|
|
|
|
|
|
+ ret = __vb2_get_done_vb(q, &vb, nonblocking);
|
|
if (ret < 0)
|
|
if (ret < 0)
|
|
return ret;
|
|
return ret;
|
|
|
|
|
|
@@ -2177,17 +2297,16 @@ static int vb2_internal_dqbuf(struct vb2_queue *q, struct v4l2_buffer *b,
|
|
call_void_vb_qop(vb, buf_finish, vb);
|
|
call_void_vb_qop(vb, buf_finish, vb);
|
|
|
|
|
|
/* Fill buffer information for the userspace */
|
|
/* Fill buffer information for the userspace */
|
|
- __fill_v4l2_buffer(vb, b);
|
|
|
|
|
|
+ ret = call_bufop(q, fill_user_buffer, vb, pb);
|
|
|
|
+ if (ret)
|
|
|
|
+ return ret;
|
|
|
|
+
|
|
/* Remove from videobuf queue */
|
|
/* Remove from videobuf queue */
|
|
list_del(&vb->queued_entry);
|
|
list_del(&vb->queued_entry);
|
|
q->queued_count--;
|
|
q->queued_count--;
|
|
|
|
|
|
trace_vb2_dqbuf(q, vb);
|
|
trace_vb2_dqbuf(q, vb);
|
|
|
|
|
|
- vbuf = to_vb2_v4l2_buffer(vb);
|
|
|
|
- if (!q->is_output &&
|
|
|
|
- vbuf->flags & V4L2_BUF_FLAG_LAST)
|
|
|
|
- q->last_buffer_dequeued = true;
|
|
|
|
/* go back to dequeued state */
|
|
/* go back to dequeued state */
|
|
__vb2_dqbuf(vb);
|
|
__vb2_dqbuf(vb);
|
|
|
|
|
|
@@ -2195,6 +2314,26 @@ static int vb2_internal_dqbuf(struct vb2_queue *q, struct v4l2_buffer *b,
|
|
vb->index, vb->state);
|
|
vb->index, vb->state);
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
|
|
+
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int vb2_internal_dqbuf(struct vb2_queue *q, struct v4l2_buffer *b,
|
|
|
|
+ bool nonblocking)
|
|
|
|
+{
|
|
|
|
+ int ret;
|
|
|
|
+
|
|
|
|
+ if (b->type != q->type) {
|
|
|
|
+ dprintk(1, "invalid buffer type\n");
|
|
|
|
+ return -EINVAL;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ ret = vb2_core_dqbuf(q, b, nonblocking);
|
|
|
|
+
|
|
|
|
+ if (!ret && !q->is_output &&
|
|
|
|
+ b->flags & V4L2_BUF_FLAG_LAST)
|
|
|
|
+ q->last_buffer_dequeued = true;
|
|
|
|
+
|
|
|
|
+ return ret;
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -2296,7 +2435,7 @@ static void __vb2_queue_cancel(struct vb2_queue *q)
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
-static int vb2_internal_streamon(struct vb2_queue *q, enum v4l2_buf_type type)
|
|
|
|
|
|
+static int vb2_core_streamon(struct vb2_queue *q, unsigned int type)
|
|
{
|
|
{
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
@@ -2379,11 +2518,11 @@ int vb2_streamon(struct vb2_queue *q, enum v4l2_buf_type type)
|
|
dprintk(1, "file io in progress\n");
|
|
dprintk(1, "file io in progress\n");
|
|
return -EBUSY;
|
|
return -EBUSY;
|
|
}
|
|
}
|
|
- return vb2_internal_streamon(q, type);
|
|
|
|
|
|
+ return vb2_core_streamon(q, type);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(vb2_streamon);
|
|
EXPORT_SYMBOL_GPL(vb2_streamon);
|
|
|
|
|
|
-static int vb2_internal_streamoff(struct vb2_queue *q, enum v4l2_buf_type type)
|
|
|
|
|
|
+static int vb2_core_streamoff(struct vb2_queue *q, unsigned int type)
|
|
{
|
|
{
|
|
if (type != q->type) {
|
|
if (type != q->type) {
|
|
dprintk(1, "invalid stream type\n");
|
|
dprintk(1, "invalid stream type\n");
|
|
@@ -2428,7 +2567,7 @@ int vb2_streamoff(struct vb2_queue *q, enum v4l2_buf_type type)
|
|
dprintk(1, "file io in progress\n");
|
|
dprintk(1, "file io in progress\n");
|
|
return -EBUSY;
|
|
return -EBUSY;
|
|
}
|
|
}
|
|
- return vb2_internal_streamoff(q, type);
|
|
|
|
|
|
+ return vb2_core_streamoff(q, type);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(vb2_streamoff);
|
|
EXPORT_SYMBOL_GPL(vb2_streamoff);
|
|
|
|
|
|
@@ -2462,15 +2601,20 @@ static int __find_plane_by_offset(struct vb2_queue *q, unsigned long off,
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
/**
|
|
- * vb2_expbuf() - Export a buffer as a file descriptor
|
|
|
|
|
|
+ * vb2_core_expbuf() - Export a buffer as a file descriptor
|
|
* @q: videobuf2 queue
|
|
* @q: videobuf2 queue
|
|
- * @eb: export buffer structure passed from userspace to vidioc_expbuf
|
|
|
|
- * handler in driver
|
|
|
|
|
|
+ * @fd: file descriptor associated with DMABUF (set by driver) *
|
|
|
|
+ * @type: buffer type
|
|
|
|
+ * @index: id number of the buffer
|
|
|
|
+ * @plane: index of the plane to be exported, 0 for single plane queues
|
|
|
|
+ * @flags: flags for newly created file, currently only O_CLOEXEC is
|
|
|
|
+ * supported, refer to manual of open syscall for more details
|
|
*
|
|
*
|
|
* The return values from this function are intended to be directly returned
|
|
* The return values from this function are intended to be directly returned
|
|
* from vidioc_expbuf handler in driver.
|
|
* from vidioc_expbuf handler in driver.
|
|
*/
|
|
*/
|
|
-int vb2_expbuf(struct vb2_queue *q, struct v4l2_exportbuffer *eb)
|
|
|
|
|
|
+static int vb2_core_expbuf(struct vb2_queue *q, int *fd, unsigned int type,
|
|
|
|
+ unsigned int index, unsigned int plane, unsigned int flags)
|
|
{
|
|
{
|
|
struct vb2_buffer *vb = NULL;
|
|
struct vb2_buffer *vb = NULL;
|
|
struct vb2_plane *vb_plane;
|
|
struct vb2_plane *vb_plane;
|
|
@@ -2487,24 +2631,24 @@ int vb2_expbuf(struct vb2_queue *q, struct v4l2_exportbuffer *eb)
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
|
|
- if (eb->flags & ~(O_CLOEXEC | O_ACCMODE)) {
|
|
|
|
|
|
+ if (flags & ~(O_CLOEXEC | O_ACCMODE)) {
|
|
dprintk(1, "queue does support only O_CLOEXEC and access mode flags\n");
|
|
dprintk(1, "queue does support only O_CLOEXEC and access mode flags\n");
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
|
|
- if (eb->type != q->type) {
|
|
|
|
|
|
+ if (type != q->type) {
|
|
dprintk(1, "invalid buffer type\n");
|
|
dprintk(1, "invalid buffer type\n");
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
|
|
- if (eb->index >= q->num_buffers) {
|
|
|
|
|
|
+ if (index >= q->num_buffers) {
|
|
dprintk(1, "buffer index out of range\n");
|
|
dprintk(1, "buffer index out of range\n");
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
|
|
- vb = q->bufs[eb->index];
|
|
|
|
|
|
+ vb = q->bufs[index];
|
|
|
|
|
|
- if (eb->plane >= vb->num_planes) {
|
|
|
|
|
|
+ if (plane >= vb->num_planes) {
|
|
dprintk(1, "buffer plane out of range\n");
|
|
dprintk(1, "buffer plane out of range\n");
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
@@ -2514,29 +2658,45 @@ int vb2_expbuf(struct vb2_queue *q, struct v4l2_exportbuffer *eb)
|
|
return -EBUSY;
|
|
return -EBUSY;
|
|
}
|
|
}
|
|
|
|
|
|
- vb_plane = &vb->planes[eb->plane];
|
|
|
|
|
|
+ vb_plane = &vb->planes[plane];
|
|
|
|
|
|
- dbuf = call_ptr_memop(vb, get_dmabuf, vb_plane->mem_priv, eb->flags & O_ACCMODE);
|
|
|
|
|
|
+ dbuf = call_ptr_memop(vb, get_dmabuf, vb_plane->mem_priv,
|
|
|
|
+ flags & O_ACCMODE);
|
|
if (IS_ERR_OR_NULL(dbuf)) {
|
|
if (IS_ERR_OR_NULL(dbuf)) {
|
|
dprintk(1, "failed to export buffer %d, plane %d\n",
|
|
dprintk(1, "failed to export buffer %d, plane %d\n",
|
|
- eb->index, eb->plane);
|
|
|
|
|
|
+ index, plane);
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
|
|
- ret = dma_buf_fd(dbuf, eb->flags & ~O_ACCMODE);
|
|
|
|
|
|
+ ret = dma_buf_fd(dbuf, flags & ~O_ACCMODE);
|
|
if (ret < 0) {
|
|
if (ret < 0) {
|
|
dprintk(3, "buffer %d, plane %d failed to export (%d)\n",
|
|
dprintk(3, "buffer %d, plane %d failed to export (%d)\n",
|
|
- eb->index, eb->plane, ret);
|
|
|
|
|
|
+ index, plane, ret);
|
|
dma_buf_put(dbuf);
|
|
dma_buf_put(dbuf);
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
dprintk(3, "buffer %d, plane %d exported as %d descriptor\n",
|
|
dprintk(3, "buffer %d, plane %d exported as %d descriptor\n",
|
|
- eb->index, eb->plane, ret);
|
|
|
|
- eb->fd = ret;
|
|
|
|
|
|
+ index, plane, ret);
|
|
|
|
+ *fd = ret;
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * vb2_expbuf() - Export a buffer as a file descriptor
|
|
|
|
+ * @q: videobuf2 queue
|
|
|
|
+ * @eb: export buffer structure passed from userspace to vidioc_expbuf
|
|
|
|
+ * handler in driver
|
|
|
|
+ *
|
|
|
|
+ * The return values from this function are intended to be directly returned
|
|
|
|
+ * from vidioc_expbuf handler in driver.
|
|
|
|
+ */
|
|
|
|
+int vb2_expbuf(struct vb2_queue *q, struct v4l2_exportbuffer *eb)
|
|
|
|
+{
|
|
|
|
+ return vb2_core_expbuf(q, &eb->fd, eb->type, eb->index,
|
|
|
|
+ eb->plane, eb->flags);
|
|
|
|
+}
|
|
EXPORT_SYMBOL_GPL(vb2_expbuf);
|
|
EXPORT_SYMBOL_GPL(vb2_expbuf);
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -2775,7 +2935,7 @@ unsigned int vb2_poll(struct vb2_queue *q, struct file *file, poll_table *wait)
|
|
EXPORT_SYMBOL_GPL(vb2_poll);
|
|
EXPORT_SYMBOL_GPL(vb2_poll);
|
|
|
|
|
|
/**
|
|
/**
|
|
- * vb2_queue_init() - initialize a videobuf2 queue
|
|
|
|
|
|
+ * vb2_core_queue_init() - initialize a videobuf2 queue
|
|
* @q: videobuf2 queue; this structure should be allocated in driver
|
|
* @q: videobuf2 queue; this structure should be allocated in driver
|
|
*
|
|
*
|
|
* The vb2_queue structure should be allocated by the driver. The driver is
|
|
* The vb2_queue structure should be allocated by the driver. The driver is
|
|
@@ -2785,7 +2945,7 @@ EXPORT_SYMBOL_GPL(vb2_poll);
|
|
* to the struct vb2_queue description in include/media/videobuf2-core.h
|
|
* to the struct vb2_queue description in include/media/videobuf2-core.h
|
|
* for more information.
|
|
* for more information.
|
|
*/
|
|
*/
|
|
-int vb2_queue_init(struct vb2_queue *q)
|
|
|
|
|
|
+static int vb2_core_queue_init(struct vb2_queue *q)
|
|
{
|
|
{
|
|
/*
|
|
/*
|
|
* Sanity check
|
|
* Sanity check
|
|
@@ -2796,7 +2956,44 @@ int vb2_queue_init(struct vb2_queue *q)
|
|
WARN_ON(!q->type) ||
|
|
WARN_ON(!q->type) ||
|
|
WARN_ON(!q->io_modes) ||
|
|
WARN_ON(!q->io_modes) ||
|
|
WARN_ON(!q->ops->queue_setup) ||
|
|
WARN_ON(!q->ops->queue_setup) ||
|
|
- WARN_ON(!q->ops->buf_queue) ||
|
|
|
|
|
|
+ WARN_ON(!q->ops->buf_queue))
|
|
|
|
+ return -EINVAL;
|
|
|
|
+
|
|
|
|
+ INIT_LIST_HEAD(&q->queued_list);
|
|
|
|
+ INIT_LIST_HEAD(&q->done_list);
|
|
|
|
+ spin_lock_init(&q->done_lock);
|
|
|
|
+ mutex_init(&q->mmap_lock);
|
|
|
|
+ init_waitqueue_head(&q->done_wq);
|
|
|
|
+
|
|
|
|
+ if (q->buf_struct_size == 0)
|
|
|
|
+ q->buf_struct_size = sizeof(struct vb2_buffer);
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static const struct vb2_buf_ops v4l2_buf_ops = {
|
|
|
|
+ .fill_user_buffer = __fill_v4l2_buffer,
|
|
|
|
+ .fill_vb2_buffer = __fill_vb2_buffer,
|
|
|
|
+ .set_timestamp = __set_timestamp,
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * vb2_queue_init() - initialize a videobuf2 queue
|
|
|
|
+ * @q: videobuf2 queue; this structure should be allocated in driver
|
|
|
|
+ *
|
|
|
|
+ * The vb2_queue structure should be allocated by the driver. The driver is
|
|
|
|
+ * responsible of clearing it's content and setting initial values for some
|
|
|
|
+ * required entries before calling this function.
|
|
|
|
+ * q->ops, q->mem_ops, q->type and q->io_modes are mandatory. Please refer
|
|
|
|
+ * to the struct vb2_queue description in include/media/videobuf2-core.h
|
|
|
|
+ * for more information.
|
|
|
|
+ */
|
|
|
|
+int vb2_queue_init(struct vb2_queue *q)
|
|
|
|
+{
|
|
|
|
+ /*
|
|
|
|
+ * Sanity check
|
|
|
|
+ */
|
|
|
|
+ if (WARN_ON(!q) ||
|
|
WARN_ON(q->timestamp_flags &
|
|
WARN_ON(q->timestamp_flags &
|
|
~(V4L2_BUF_FLAG_TIMESTAMP_MASK |
|
|
~(V4L2_BUF_FLAG_TIMESTAMP_MASK |
|
|
V4L2_BUF_FLAG_TSTAMP_SRC_MASK)))
|
|
V4L2_BUF_FLAG_TSTAMP_SRC_MASK)))
|
|
@@ -2812,38 +3009,46 @@ int vb2_queue_init(struct vb2_queue *q)
|
|
|| WARN_ON(VB2_MEMORY_DMABUF != (int)V4L2_MEMORY_DMABUF))
|
|
|| WARN_ON(VB2_MEMORY_DMABUF != (int)V4L2_MEMORY_DMABUF))
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
|
|
|
|
- INIT_LIST_HEAD(&q->queued_list);
|
|
|
|
- INIT_LIST_HEAD(&q->done_list);
|
|
|
|
- spin_lock_init(&q->done_lock);
|
|
|
|
- mutex_init(&q->mmap_lock);
|
|
|
|
- init_waitqueue_head(&q->done_wq);
|
|
|
|
-
|
|
|
|
if (q->buf_struct_size == 0)
|
|
if (q->buf_struct_size == 0)
|
|
q->buf_struct_size = sizeof(struct vb2_v4l2_buffer);
|
|
q->buf_struct_size = sizeof(struct vb2_v4l2_buffer);
|
|
|
|
|
|
|
|
+ q->buf_ops = &v4l2_buf_ops;
|
|
q->is_multiplanar = V4L2_TYPE_IS_MULTIPLANAR(q->type);
|
|
q->is_multiplanar = V4L2_TYPE_IS_MULTIPLANAR(q->type);
|
|
q->is_output = V4L2_TYPE_IS_OUTPUT(q->type);
|
|
q->is_output = V4L2_TYPE_IS_OUTPUT(q->type);
|
|
|
|
|
|
- return 0;
|
|
|
|
|
|
+ return vb2_core_queue_init(q);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(vb2_queue_init);
|
|
EXPORT_SYMBOL_GPL(vb2_queue_init);
|
|
|
|
|
|
/**
|
|
/**
|
|
- * vb2_queue_release() - stop streaming, release the queue and free memory
|
|
|
|
|
|
+ * vb2_core_queue_release() - stop streaming, release the queue and free memory
|
|
* @q: videobuf2 queue
|
|
* @q: videobuf2 queue
|
|
*
|
|
*
|
|
* This function stops streaming and performs necessary clean ups, including
|
|
* This function stops streaming and performs necessary clean ups, including
|
|
* freeing video buffer memory. The driver is responsible for freeing
|
|
* freeing video buffer memory. The driver is responsible for freeing
|
|
* the vb2_queue structure itself.
|
|
* the vb2_queue structure itself.
|
|
*/
|
|
*/
|
|
-void vb2_queue_release(struct vb2_queue *q)
|
|
|
|
|
|
+static void vb2_core_queue_release(struct vb2_queue *q)
|
|
{
|
|
{
|
|
- __vb2_cleanup_fileio(q);
|
|
|
|
__vb2_queue_cancel(q);
|
|
__vb2_queue_cancel(q);
|
|
mutex_lock(&q->mmap_lock);
|
|
mutex_lock(&q->mmap_lock);
|
|
__vb2_queue_free(q, q->num_buffers);
|
|
__vb2_queue_free(q, q->num_buffers);
|
|
mutex_unlock(&q->mmap_lock);
|
|
mutex_unlock(&q->mmap_lock);
|
|
}
|
|
}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * vb2_queue_release() - stop streaming, release the queue and free memory
|
|
|
|
+ * @q: videobuf2 queue
|
|
|
|
+ *
|
|
|
|
+ * This function stops streaming and performs necessary clean ups, including
|
|
|
|
+ * freeing video buffer memory. The driver is responsible for freeing
|
|
|
|
+ * the vb2_queue structure itself.
|
|
|
|
+ */
|
|
|
|
+void vb2_queue_release(struct vb2_queue *q)
|
|
|
|
+{
|
|
|
|
+ __vb2_cleanup_fileio(q);
|
|
|
|
+ vb2_core_queue_release(q);
|
|
|
|
+}
|
|
EXPORT_SYMBOL_GPL(vb2_queue_release);
|
|
EXPORT_SYMBOL_GPL(vb2_queue_release);
|
|
|
|
|
|
/**
|
|
/**
|
|
@@ -2951,7 +3156,7 @@ static int __vb2_init_fileio(struct vb2_queue *q, int read)
|
|
fileio->req.memory = VB2_MEMORY_MMAP;
|
|
fileio->req.memory = VB2_MEMORY_MMAP;
|
|
fileio->req.type = q->type;
|
|
fileio->req.type = q->type;
|
|
q->fileio = fileio;
|
|
q->fileio = fileio;
|
|
- ret = __reqbufs(q, &fileio->req);
|
|
|
|
|
|
+ ret = vb2_core_reqbufs(q, fileio->req.memory, &fileio->req.count);
|
|
if (ret)
|
|
if (ret)
|
|
goto err_kfree;
|
|
goto err_kfree;
|
|
|
|
|
|
@@ -3013,7 +3218,7 @@ static int __vb2_init_fileio(struct vb2_queue *q, int read)
|
|
/*
|
|
/*
|
|
* Start streaming.
|
|
* Start streaming.
|
|
*/
|
|
*/
|
|
- ret = vb2_internal_streamon(q, q->type);
|
|
|
|
|
|
+ ret = vb2_core_streamon(q, q->type);
|
|
if (ret)
|
|
if (ret)
|
|
goto err_reqbufs;
|
|
goto err_reqbufs;
|
|
|
|
|
|
@@ -3021,7 +3226,7 @@ static int __vb2_init_fileio(struct vb2_queue *q, int read)
|
|
|
|
|
|
err_reqbufs:
|
|
err_reqbufs:
|
|
fileio->req.count = 0;
|
|
fileio->req.count = 0;
|
|
- __reqbufs(q, &fileio->req);
|
|
|
|
|
|
+ vb2_core_reqbufs(q, fileio->req.memory, &fileio->req.count);
|
|
|
|
|
|
err_kfree:
|
|
err_kfree:
|
|
q->fileio = NULL;
|
|
q->fileio = NULL;
|
|
@@ -3038,7 +3243,7 @@ static int __vb2_cleanup_fileio(struct vb2_queue *q)
|
|
struct vb2_fileio_data *fileio = q->fileio;
|
|
struct vb2_fileio_data *fileio = q->fileio;
|
|
|
|
|
|
if (fileio) {
|
|
if (fileio) {
|
|
- vb2_internal_streamoff(q, q->type);
|
|
|
|
|
|
+ vb2_core_streamoff(q, q->type);
|
|
q->fileio = NULL;
|
|
q->fileio = NULL;
|
|
fileio->req.count = 0;
|
|
fileio->req.count = 0;
|
|
vb2_reqbufs(q, &fileio->req);
|
|
vb2_reqbufs(q, &fileio->req);
|
|
@@ -3395,13 +3600,13 @@ int vb2_ioctl_reqbufs(struct file *file, void *priv,
|
|
struct v4l2_requestbuffers *p)
|
|
struct v4l2_requestbuffers *p)
|
|
{
|
|
{
|
|
struct video_device *vdev = video_devdata(file);
|
|
struct video_device *vdev = video_devdata(file);
|
|
- int res = __verify_memory_type(vdev->queue, p->memory, p->type);
|
|
|
|
|
|
+ int res = vb2_verify_memory_type(vdev->queue, p->memory, p->type);
|
|
|
|
|
|
if (res)
|
|
if (res)
|
|
return res;
|
|
return res;
|
|
if (vb2_queue_is_busy(vdev, file))
|
|
if (vb2_queue_is_busy(vdev, file))
|
|
return -EBUSY;
|
|
return -EBUSY;
|
|
- res = __reqbufs(vdev->queue, p);
|
|
|
|
|
|
+ res = vb2_core_reqbufs(vdev->queue, p->memory, &p->count);
|
|
/* If count == 0, then the owner has released all buffers and he
|
|
/* If count == 0, then the owner has released all buffers and he
|
|
is no longer owner of the queue. Otherwise we have a new owner. */
|
|
is no longer owner of the queue. Otherwise we have a new owner. */
|
|
if (res == 0)
|
|
if (res == 0)
|
|
@@ -3414,18 +3619,22 @@ int vb2_ioctl_create_bufs(struct file *file, void *priv,
|
|
struct v4l2_create_buffers *p)
|
|
struct v4l2_create_buffers *p)
|
|
{
|
|
{
|
|
struct video_device *vdev = video_devdata(file);
|
|
struct video_device *vdev = video_devdata(file);
|
|
- int res = __verify_memory_type(vdev->queue, p->memory, p->format.type);
|
|
|
|
|
|
+ int res = vb2_verify_memory_type(vdev->queue, p->memory,
|
|
|
|
+ p->format.type);
|
|
|
|
|
|
p->index = vdev->queue->num_buffers;
|
|
p->index = vdev->queue->num_buffers;
|
|
- /* If count == 0, then just check if memory and type are valid.
|
|
|
|
- Any -EBUSY result from __verify_memory_type can be mapped to 0. */
|
|
|
|
|
|
+ /*
|
|
|
|
+ * If count == 0, then just check if memory and type are valid.
|
|
|
|
+ * Any -EBUSY result from vb2_verify_memory_type can be mapped to 0.
|
|
|
|
+ */
|
|
if (p->count == 0)
|
|
if (p->count == 0)
|
|
return res != -EBUSY ? res : 0;
|
|
return res != -EBUSY ? res : 0;
|
|
if (res)
|
|
if (res)
|
|
return res;
|
|
return res;
|
|
if (vb2_queue_is_busy(vdev, file))
|
|
if (vb2_queue_is_busy(vdev, file))
|
|
return -EBUSY;
|
|
return -EBUSY;
|
|
- res = __create_bufs(vdev->queue, p);
|
|
|
|
|
|
+ res = vb2_core_create_bufs(vdev->queue, p->memory,
|
|
|
|
+ &p->count, &p->format);
|
|
if (res == 0)
|
|
if (res == 0)
|
|
vdev->queue->owner = file->private_data;
|
|
vdev->queue->owner = file->private_data;
|
|
return res;
|
|
return res;
|