Lines Matching +full:queue +full:- +full:sizes
1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * vimc-capture.c Virtual Media Controller Driver
5 * Copyright (C) 2015-2017 Helen Koike <helen.fornazier@gmail.com>
8 #include <media/v4l2-ioctl.h>
9 #include <media/videobuf2-core.h>
10 #include <media/videobuf2-dma-contig.h>
11 #include <media/videobuf2-vmalloc.h>
13 #include "vimc-common.h"
14 #include "vimc-streamer.h"
20 struct vb2_queue queue; member
24 * queue because the frames are generated from a hardware interruption
58 strscpy(cap->driver, VIMC_PDEV_NAME, sizeof(cap->driver)); in vimc_capture_querycap()
59 strscpy(cap->card, KBUILD_MODNAME, sizeof(cap->card)); in vimc_capture_querycap()
60 snprintf(cap->bus_info, sizeof(cap->bus_info), in vimc_capture_querycap()
72 *fmt = vcapture->format; in vimc_capture_get_format()
80 f->fmt.pix = vcapture->format; in vimc_capture_g_fmt_vid_cap()
88 struct v4l2_pix_format *format = &f->fmt.pix; in vimc_capture_try_fmt_vid_cap()
91 format->width = clamp_t(u32, format->width, VIMC_FRAME_MIN_WIDTH, in vimc_capture_try_fmt_vid_cap()
93 format->height = clamp_t(u32, format->height, VIMC_FRAME_MIN_HEIGHT, in vimc_capture_try_fmt_vid_cap()
97 vpix = vimc_pix_map_by_pixelformat(format->pixelformat); in vimc_capture_try_fmt_vid_cap()
99 format->pixelformat = fmt_default.pixelformat; in vimc_capture_try_fmt_vid_cap()
100 vpix = vimc_pix_map_by_pixelformat(format->pixelformat); in vimc_capture_try_fmt_vid_cap()
103 format->bytesperline = format->width * vpix->bpp; in vimc_capture_try_fmt_vid_cap()
104 format->sizeimage = format->bytesperline * format->height; in vimc_capture_try_fmt_vid_cap()
106 if (format->field == V4L2_FIELD_ANY) in vimc_capture_try_fmt_vid_cap()
107 format->field = fmt_default.field; in vimc_capture_try_fmt_vid_cap()
111 if (format->colorspace == V4L2_COLORSPACE_DEFAULT) in vimc_capture_try_fmt_vid_cap()
112 format->colorspace = fmt_default.colorspace; in vimc_capture_try_fmt_vid_cap()
124 if (vb2_is_busy(&vcapture->queue)) in vimc_capture_s_fmt_vid_cap()
125 return -EBUSY; in vimc_capture_s_fmt_vid_cap()
131 dev_dbg(vcapture->ved.dev, "%s: format update: " in vimc_capture_s_fmt_vid_cap()
133 "new:%dx%d (0x%x, %d, %d, %d, %d)\n", vcapture->vdev.name, in vimc_capture_s_fmt_vid_cap()
135 vcapture->format.width, vcapture->format.height, in vimc_capture_s_fmt_vid_cap()
136 vcapture->format.pixelformat, vcapture->format.colorspace, in vimc_capture_s_fmt_vid_cap()
137 vcapture->format.quantization, vcapture->format.xfer_func, in vimc_capture_s_fmt_vid_cap()
138 vcapture->format.ycbcr_enc, in vimc_capture_s_fmt_vid_cap()
140 f->fmt.pix.width, f->fmt.pix.height, in vimc_capture_s_fmt_vid_cap()
141 f->fmt.pix.pixelformat, f->fmt.pix.colorspace, in vimc_capture_s_fmt_vid_cap()
142 f->fmt.pix.quantization, f->fmt.pix.xfer_func, in vimc_capture_s_fmt_vid_cap()
143 f->fmt.pix.ycbcr_enc); in vimc_capture_s_fmt_vid_cap()
145 vcapture->format = f->fmt.pix; in vimc_capture_s_fmt_vid_cap()
155 if (f->mbus_code) { in vimc_capture_enum_fmt_vid_cap()
156 if (f->index > 0) in vimc_capture_enum_fmt_vid_cap()
157 return -EINVAL; in vimc_capture_enum_fmt_vid_cap()
159 vpix = vimc_pix_map_by_code(f->mbus_code); in vimc_capture_enum_fmt_vid_cap()
161 vpix = vimc_pix_map_by_index(f->index); in vimc_capture_enum_fmt_vid_cap()
165 return -EINVAL; in vimc_capture_enum_fmt_vid_cap()
167 f->pixelformat = vpix->pixelformat; in vimc_capture_enum_fmt_vid_cap()
177 if (fsize->index) in vimc_capture_enum_framesizes()
178 return -EINVAL; in vimc_capture_enum_framesizes()
181 vpix = vimc_pix_map_by_code(fsize->pixel_format); in vimc_capture_enum_framesizes()
183 return -EINVAL; in vimc_capture_enum_framesizes()
185 fsize->type = V4L2_FRMSIZE_TYPE_CONTINUOUS; in vimc_capture_enum_framesizes()
186 fsize->stepwise.min_width = VIMC_FRAME_MIN_WIDTH; in vimc_capture_enum_framesizes()
187 fsize->stepwise.max_width = VIMC_FRAME_MAX_WIDTH; in vimc_capture_enum_framesizes()
188 fsize->stepwise.min_height = VIMC_FRAME_MIN_HEIGHT; in vimc_capture_enum_framesizes()
189 fsize->stepwise.max_height = VIMC_FRAME_MAX_HEIGHT; in vimc_capture_enum_framesizes()
190 fsize->stepwise.step_width = 1; in vimc_capture_enum_framesizes()
191 fsize->stepwise.step_height = 1; in vimc_capture_enum_framesizes()
232 spin_lock(&vcapture->qlock); in vimc_capture_return_all_buffers()
234 list_for_each_entry_safe(vbuf, node, &vcapture->buf_list, list) { in vimc_capture_return_all_buffers()
235 list_del(&vbuf->list); in vimc_capture_return_all_buffers()
236 vb2_buffer_done(&vbuf->vb2.vb2_buf, state); in vimc_capture_return_all_buffers()
239 spin_unlock(&vcapture->qlock); in vimc_capture_return_all_buffers()
247 vcapture->sequence = 0; in vimc_capture_start_streaming()
250 ret = video_device_pipeline_start(&vcapture->vdev, &vcapture->stream.pipe); in vimc_capture_start_streaming()
256 ret = vimc_streamer_s_stream(&vcapture->stream, &vcapture->ved, 1); in vimc_capture_start_streaming()
258 video_device_pipeline_stop(&vcapture->vdev); in vimc_capture_start_streaming()
267 * Stop the stream engine. Any remaining buffers in the stream queue are
274 vimc_streamer_s_stream(&vcapture->stream, &vcapture->ved, 0); in vimc_capture_stop_streaming()
277 video_device_pipeline_stop(&vcapture->vdev); in vimc_capture_stop_streaming()
285 struct vimc_capture_device *vcapture = vb2_get_drv_priv(vb2_buf->vb2_queue); in vimc_capture_buf_queue()
290 spin_lock(&vcapture->qlock); in vimc_capture_buf_queue()
291 list_add_tail(&buf->list, &vcapture->buf_list); in vimc_capture_buf_queue()
292 spin_unlock(&vcapture->qlock); in vimc_capture_buf_queue()
296 unsigned int *nplanes, unsigned int sizes[], in vimc_capture_queue_setup() argument
302 return sizes[0] < vcapture->format.sizeimage ? -EINVAL : 0; in vimc_capture_queue_setup()
305 sizes[0] = vcapture->format.sizeimage; in vimc_capture_queue_setup()
312 struct vimc_capture_device *vcapture = vb2_get_drv_priv(vb->vb2_queue); in vimc_capture_buffer_prepare()
313 unsigned long size = vcapture->format.sizeimage; in vimc_capture_buffer_prepare()
316 dev_err(vcapture->ved.dev, "%s: buffer too small (%lu < %lu)\n", in vimc_capture_buffer_prepare()
317 vcapture->vdev.name, vb2_plane_size(vb, 0), size); in vimc_capture_buffer_prepare()
318 return -EINVAL; in vimc_capture_buffer_prepare()
340 media_entity_cleanup(vcapture->ved.ent); in vimc_capture_release()
349 vb2_video_unregister_device(&vcapture->vdev); in vimc_capture_unregister()
360 spin_lock(&vcapture->qlock); in vimc_capture_process_frame()
363 vimc_buf = list_first_entry_or_null(&vcapture->buf_list, in vimc_capture_process_frame()
366 spin_unlock(&vcapture->qlock); in vimc_capture_process_frame()
367 return ERR_PTR(-EAGAIN); in vimc_capture_process_frame()
371 list_del(&vimc_buf->list); in vimc_capture_process_frame()
373 spin_unlock(&vcapture->qlock); in vimc_capture_process_frame()
376 vimc_buf->vb2.vb2_buf.timestamp = ktime_get_ns(); in vimc_capture_process_frame()
377 vimc_buf->vb2.sequence = vcapture->sequence++; in vimc_capture_process_frame()
378 vimc_buf->vb2.field = vcapture->format.field; in vimc_capture_process_frame()
380 vbuf = vb2_plane_vaddr(&vimc_buf->vb2.vb2_buf, 0); in vimc_capture_process_frame()
382 memcpy(vbuf, frame, vcapture->format.sizeimage); in vimc_capture_process_frame()
385 vb2_set_plane_payload(&vimc_buf->vb2.vb2_buf, 0, in vimc_capture_process_frame()
386 vcapture->format.sizeimage); in vimc_capture_process_frame()
387 vb2_buffer_done(&vimc_buf->vb2.vb2_buf, VB2_BUF_STATE_DONE); in vimc_capture_process_frame()
394 struct v4l2_device *v4l2_dev = &vimc->v4l2_dev; in vimc_capture_add()
404 return ERR_PTR(-ENOMEM); in vimc_capture_add()
407 vcapture->vdev.entity.name = vcfg_name; in vimc_capture_add()
408 vcapture->vdev.entity.function = MEDIA_ENT_F_IO_V4L; in vimc_capture_add()
409 vcapture->pad.flags = MEDIA_PAD_FL_SINK; in vimc_capture_add()
410 ret = media_entity_pads_init(&vcapture->vdev.entity, in vimc_capture_add()
411 1, &vcapture->pad); in vimc_capture_add()
416 mutex_init(&vcapture->lock); in vimc_capture_add()
418 /* Initialize the vb2 queue */ in vimc_capture_add()
419 q = &vcapture->queue; in vimc_capture_add()
420 q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; in vimc_capture_add()
421 q->io_modes = VB2_MMAP | VB2_DMABUF; in vimc_capture_add()
423 q->io_modes |= VB2_USERPTR; in vimc_capture_add()
424 q->drv_priv = vcapture; in vimc_capture_add()
425 q->buf_struct_size = sizeof(struct vimc_capture_buffer); in vimc_capture_add()
426 q->ops = &vimc_capture_qops; in vimc_capture_add()
427 q->mem_ops = vimc_allocator == VIMC_ALLOCATOR_DMA_CONTIG in vimc_capture_add()
429 q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; in vimc_capture_add()
430 q->min_reqbufs_allocation = 2; in vimc_capture_add()
431 q->lock = &vcapture->lock; in vimc_capture_add()
432 q->dev = v4l2_dev->dev; in vimc_capture_add()
436 dev_err(vimc->mdev.dev, "%s: vb2 queue init failed (err=%d)\n", in vimc_capture_add()
442 INIT_LIST_HEAD(&vcapture->buf_list); in vimc_capture_add()
443 spin_lock_init(&vcapture->qlock); in vimc_capture_add()
446 vcapture->format = fmt_default; in vimc_capture_add()
447 vpix = vimc_pix_map_by_pixelformat(vcapture->format.pixelformat); in vimc_capture_add()
448 vcapture->format.bytesperline = vcapture->format.width * vpix->bpp; in vimc_capture_add()
449 vcapture->format.sizeimage = vcapture->format.bytesperline * in vimc_capture_add()
450 vcapture->format.height; in vimc_capture_add()
453 vcapture->ved.ent = &vcapture->vdev.entity; in vimc_capture_add()
454 vcapture->ved.process_frame = vimc_capture_process_frame; in vimc_capture_add()
455 vcapture->ved.vdev_get_format = vimc_capture_get_format; in vimc_capture_add()
456 vcapture->ved.dev = vimc->mdev.dev; in vimc_capture_add()
459 vdev = &vcapture->vdev; in vimc_capture_add()
460 vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING in vimc_capture_add()
462 vdev->entity.ops = &vimc_capture_mops; in vimc_capture_add()
463 vdev->release = video_device_release_empty; in vimc_capture_add()
464 vdev->fops = &vimc_capture_fops; in vimc_capture_add()
465 vdev->ioctl_ops = &vimc_capture_ioctl_ops; in vimc_capture_add()
466 vdev->lock = &vcapture->lock; in vimc_capture_add()
467 vdev->queue = q; in vimc_capture_add()
468 vdev->v4l2_dev = v4l2_dev; in vimc_capture_add()
469 vdev->vfl_dir = VFL_DIR_RX; in vimc_capture_add()
470 strscpy(vdev->name, vcfg_name, sizeof(vdev->name)); in vimc_capture_add()
471 video_set_drvdata(vdev, &vcapture->ved); in vimc_capture_add()
474 ret = video_register_device(vdev, VFL_TYPE_VIDEO, -1); in vimc_capture_add()
476 dev_err(vimc->mdev.dev, "%s: video register failed (err=%d)\n", in vimc_capture_add()
477 vcapture->vdev.name, ret); in vimc_capture_add()
481 return &vcapture->ved; in vimc_capture_add()
484 media_entity_cleanup(&vcapture->vdev.entity); in vimc_capture_add()