Lines Matching full:q
37 #define dprintk(q, level, fmt, arg...) \ argument
40 pr_info("[%s] %s: " fmt, (q)->name, __func__, \
93 #define log_qop(q, op) \ argument
94 dprintk(q, 2, "call_qop(%s)%s\n", #op, \
95 (q)->ops->op ? "" : " (nop)")
97 #define call_qop(q, op, args...) \ argument
101 log_qop(q, op); \
102 err = (q)->ops->op ? (q)->ops->op(args) : 0; \
104 (q)->cnt_ ## op++; \
108 #define call_void_qop(q, op, args...) \ argument
110 log_qop(q, op); \
111 if ((q)->ops->op) \
112 (q)->ops->op(args); \
113 (q)->cnt_ ## op++; \
157 #define call_qop(q, op, args...) \ argument
158 ((q)->ops->op ? (q)->ops->op(args) : 0)
160 #define call_void_qop(q, op, args...) \ argument
162 if ((q)->ops->op) \
163 (q)->ops->op(args); \
177 #define call_bufop(q, op, args...) \ argument
180 if (q && q->buf_ops && q->buf_ops->op) \
181 ret = q->buf_ops->op(args); \
185 #define call_void_bufop(q, op, args...) \ argument
187 if (q && q->buf_ops && q->buf_ops->op) \
188 q->buf_ops->op(args); \
191 static void __vb2_queue_cancel(struct vb2_queue *q);
216 struct vb2_queue *q = vb->vb2_queue; in __vb2_buf_mem_alloc() local
234 q->alloc_devs[plane] ? : q->dev, in __vb2_buf_mem_alloc()
235 q->dma_attrs, size, q->dma_dir, q->gfp_flags); in __vb2_buf_mem_alloc()
362 struct vb2_queue *q = vb->vb2_queue; in __setup_offsets() local
367 struct vb2_buffer *prev = q->bufs[vb->index - 1]; in __setup_offsets()
376 dprintk(q, 3, "buffer %d, plane %d offset 0x%08lx\n", in __setup_offsets()
391 static int __vb2_queue_alloc(struct vb2_queue *q, enum vb2_memory memory, in __vb2_queue_alloc() argument
399 /* Ensure that q->num_buffers+num_buffers is below VB2_MAX_FRAME */ in __vb2_queue_alloc()
401 VB2_MAX_FRAME - q->num_buffers); in __vb2_queue_alloc()
405 vb = kzalloc(q->buf_struct_size, GFP_KERNEL); in __vb2_queue_alloc()
407 dprintk(q, 1, "memory alloc for buffer struct failed\n"); in __vb2_queue_alloc()
412 vb->vb2_queue = q; in __vb2_queue_alloc()
414 vb->index = q->num_buffers + buffer; in __vb2_queue_alloc()
415 vb->type = q->type; in __vb2_queue_alloc()
424 if (q->memory != VB2_MEMORY_DMABUF) { in __vb2_queue_alloc()
432 call_void_bufop(q, init_buffer, vb); in __vb2_queue_alloc()
434 q->bufs[vb->index] = vb; in __vb2_queue_alloc()
440 dprintk(q, 1, "failed allocating memory for buffer %d\n", in __vb2_queue_alloc()
442 q->bufs[vb->index] = NULL; in __vb2_queue_alloc()
454 dprintk(q, 1, "buffer %d %p initialization failed\n", in __vb2_queue_alloc()
457 q->bufs[vb->index] = NULL; in __vb2_queue_alloc()
464 dprintk(q, 3, "allocated %d buffers, %d plane(s) each\n", in __vb2_queue_alloc()
473 static void __vb2_free_mem(struct vb2_queue *q, unsigned int buffers) in __vb2_free_mem() argument
478 for (buffer = q->num_buffers - buffers; buffer < q->num_buffers; in __vb2_free_mem()
480 vb = q->bufs[buffer]; in __vb2_free_mem()
485 if (q->memory == VB2_MEMORY_MMAP) in __vb2_free_mem()
487 else if (q->memory == VB2_MEMORY_DMABUF) in __vb2_free_mem()
499 static int __vb2_queue_free(struct vb2_queue *q, unsigned int buffers) in __vb2_queue_free() argument
511 for (buffer = q->num_buffers - buffers; buffer < q->num_buffers; in __vb2_queue_free()
513 if (q->bufs[buffer] == NULL) in __vb2_queue_free()
515 if (q->bufs[buffer]->state == VB2_BUF_STATE_PREPARING) { in __vb2_queue_free()
516 dprintk(q, 1, "preparing buffers, cannot free\n"); in __vb2_queue_free()
522 for (buffer = q->num_buffers - buffers; buffer < q->num_buffers; in __vb2_queue_free()
524 struct vb2_buffer *vb = q->bufs[buffer]; in __vb2_queue_free()
531 __vb2_free_mem(q, buffers); in __vb2_queue_free()
539 if (q->num_buffers) { in __vb2_queue_free()
540 bool unbalanced = q->cnt_start_streaming != q->cnt_stop_streaming || in __vb2_queue_free()
541 q->cnt_wait_prepare != q->cnt_wait_finish; in __vb2_queue_free()
544 pr_info("counters for queue %p:%s\n", q, in __vb2_queue_free()
547 q->cnt_queue_setup, q->cnt_start_streaming, in __vb2_queue_free()
548 q->cnt_stop_streaming); in __vb2_queue_free()
550 q->cnt_wait_prepare, q->cnt_wait_finish); in __vb2_queue_free()
552 q->cnt_queue_setup = 0; in __vb2_queue_free()
553 q->cnt_wait_prepare = 0; in __vb2_queue_free()
554 q->cnt_wait_finish = 0; in __vb2_queue_free()
555 q->cnt_start_streaming = 0; in __vb2_queue_free()
556 q->cnt_stop_streaming = 0; in __vb2_queue_free()
558 for (buffer = 0; buffer < q->num_buffers; ++buffer) { in __vb2_queue_free()
559 struct vb2_buffer *vb = q->bufs[buffer]; in __vb2_queue_free()
571 q, buffer, unbalanced ? " UNBALANCED!" : ""); in __vb2_queue_free()
597 for (buffer = q->num_buffers - buffers; buffer < q->num_buffers; in __vb2_queue_free()
599 kfree(q->bufs[buffer]); in __vb2_queue_free()
600 q->bufs[buffer] = NULL; in __vb2_queue_free()
603 q->num_buffers -= buffers; in __vb2_queue_free()
604 if (!q->num_buffers) { in __vb2_queue_free()
605 q->memory = VB2_MEMORY_UNKNOWN; in __vb2_queue_free()
606 INIT_LIST_HEAD(&q->queued_list); in __vb2_queue_free()
611 bool vb2_buffer_in_use(struct vb2_queue *q, struct vb2_buffer *vb) in vb2_buffer_in_use() argument
633 static bool __buffers_in_use(struct vb2_queue *q) in __buffers_in_use() argument
636 for (buffer = 0; buffer < q->num_buffers; ++buffer) { in __buffers_in_use()
637 if (vb2_buffer_in_use(q, q->bufs[buffer])) in __buffers_in_use()
643 void vb2_core_querybuf(struct vb2_queue *q, unsigned int index, void *pb) in vb2_core_querybuf() argument
645 call_void_bufop(q, fill_user_buffer, q->bufs[index], pb); in vb2_core_querybuf()
653 static int __verify_userptr_ops(struct vb2_queue *q) in __verify_userptr_ops() argument
655 if (!(q->io_modes & VB2_USERPTR) || !q->mem_ops->get_userptr || in __verify_userptr_ops()
656 !q->mem_ops->put_userptr) in __verify_userptr_ops()
666 static int __verify_mmap_ops(struct vb2_queue *q) in __verify_mmap_ops() argument
668 if (!(q->io_modes & VB2_MMAP) || !q->mem_ops->alloc || in __verify_mmap_ops()
669 !q->mem_ops->put || !q->mem_ops->mmap) in __verify_mmap_ops()
679 static int __verify_dmabuf_ops(struct vb2_queue *q) in __verify_dmabuf_ops() argument
681 if (!(q->io_modes & VB2_DMABUF) || !q->mem_ops->attach_dmabuf || in __verify_dmabuf_ops()
682 !q->mem_ops->detach_dmabuf || !q->mem_ops->map_dmabuf || in __verify_dmabuf_ops()
683 !q->mem_ops->unmap_dmabuf) in __verify_dmabuf_ops()
689 int vb2_verify_memory_type(struct vb2_queue *q, in vb2_verify_memory_type() argument
694 dprintk(q, 1, "unsupported memory type\n"); in vb2_verify_memory_type()
698 if (type != q->type) { in vb2_verify_memory_type()
699 dprintk(q, 1, "requested type is incorrect\n"); in vb2_verify_memory_type()
707 if (memory == VB2_MEMORY_MMAP && __verify_mmap_ops(q)) { in vb2_verify_memory_type()
708 dprintk(q, 1, "MMAP for current setup unsupported\n"); in vb2_verify_memory_type()
712 if (memory == VB2_MEMORY_USERPTR && __verify_userptr_ops(q)) { in vb2_verify_memory_type()
713 dprintk(q, 1, "USERPTR for current setup unsupported\n"); in vb2_verify_memory_type()
717 if (memory == VB2_MEMORY_DMABUF && __verify_dmabuf_ops(q)) { in vb2_verify_memory_type()
718 dprintk(q, 1, "DMABUF for current setup unsupported\n"); in vb2_verify_memory_type()
727 if (vb2_fileio_is_active(q)) { in vb2_verify_memory_type()
728 dprintk(q, 1, "file io in progress\n"); in vb2_verify_memory_type()
735 int vb2_core_reqbufs(struct vb2_queue *q, enum vb2_memory memory, in vb2_core_reqbufs() argument
743 if (q->streaming) { in vb2_core_reqbufs()
744 dprintk(q, 1, "streaming active\n"); in vb2_core_reqbufs()
748 if (q->waiting_in_dqbuf && *count) { in vb2_core_reqbufs()
749 dprintk(q, 1, "another dup()ped fd is waiting for a buffer\n"); in vb2_core_reqbufs()
753 if (*count == 0 || q->num_buffers != 0 || in vb2_core_reqbufs()
754 (q->memory != VB2_MEMORY_UNKNOWN && q->memory != memory)) { in vb2_core_reqbufs()
759 mutex_lock(&q->mmap_lock); in vb2_core_reqbufs()
760 if (debug && q->memory == VB2_MEMORY_MMAP && in vb2_core_reqbufs()
761 __buffers_in_use(q)) in vb2_core_reqbufs()
762 dprintk(q, 1, "memory in use, orphaning buffers\n"); in vb2_core_reqbufs()
769 __vb2_queue_cancel(q); in vb2_core_reqbufs()
770 ret = __vb2_queue_free(q, q->num_buffers); in vb2_core_reqbufs()
771 mutex_unlock(&q->mmap_lock); in vb2_core_reqbufs()
786 WARN_ON(q->min_buffers_needed > VB2_MAX_FRAME); in vb2_core_reqbufs()
787 num_buffers = max_t(unsigned int, *count, q->min_buffers_needed); in vb2_core_reqbufs()
789 memset(q->alloc_devs, 0, sizeof(q->alloc_devs)); in vb2_core_reqbufs()
790 q->memory = memory; in vb2_core_reqbufs()
796 ret = call_qop(q, queue_setup, q, &num_buffers, &num_planes, in vb2_core_reqbufs()
797 plane_sizes, q->alloc_devs); in vb2_core_reqbufs()
811 __vb2_queue_alloc(q, memory, num_buffers, num_planes, plane_sizes); in vb2_core_reqbufs()
813 dprintk(q, 1, "memory allocation failed\n"); in vb2_core_reqbufs()
821 if (allocated_buffers < q->min_buffers_needed) in vb2_core_reqbufs()
837 ret = call_qop(q, queue_setup, q, &num_buffers, in vb2_core_reqbufs()
838 &num_planes, plane_sizes, q->alloc_devs); in vb2_core_reqbufs()
849 mutex_lock(&q->mmap_lock); in vb2_core_reqbufs()
850 q->num_buffers = allocated_buffers; in vb2_core_reqbufs()
855 * from q->num_buffers. in vb2_core_reqbufs()
857 __vb2_queue_free(q, allocated_buffers); in vb2_core_reqbufs()
858 mutex_unlock(&q->mmap_lock); in vb2_core_reqbufs()
861 mutex_unlock(&q->mmap_lock); in vb2_core_reqbufs()
868 q->waiting_for_buffers = !q->is_output; in vb2_core_reqbufs()
874 int vb2_core_create_bufs(struct vb2_queue *q, enum vb2_memory memory, in vb2_core_create_bufs() argument
883 if (q->num_buffers == VB2_MAX_FRAME) { in vb2_core_create_bufs()
884 dprintk(q, 1, "maximum number of buffers already allocated\n"); in vb2_core_create_bufs()
888 if (!q->num_buffers) { in vb2_core_create_bufs()
889 if (q->waiting_in_dqbuf && *count) { in vb2_core_create_bufs()
890 dprintk(q, 1, "another dup()ped fd is waiting for a buffer\n"); in vb2_core_create_bufs()
893 memset(q->alloc_devs, 0, sizeof(q->alloc_devs)); in vb2_core_create_bufs()
894 q->memory = memory; in vb2_core_create_bufs()
895 q->waiting_for_buffers = !q->is_output; in vb2_core_create_bufs()
897 if (q->memory != memory) { in vb2_core_create_bufs()
898 dprintk(q, 1, "memory model mismatch\n"); in vb2_core_create_bufs()
903 num_buffers = min(*count, VB2_MAX_FRAME - q->num_buffers); in vb2_core_create_bufs()
914 ret = call_qop(q, queue_setup, q, &num_buffers, in vb2_core_create_bufs()
915 &num_planes, plane_sizes, q->alloc_devs); in vb2_core_create_bufs()
920 allocated_buffers = __vb2_queue_alloc(q, memory, num_buffers, in vb2_core_create_bufs()
923 dprintk(q, 1, "memory allocation failed\n"); in vb2_core_create_bufs()
934 * q->num_buffers contains the total number of buffers, that the in vb2_core_create_bufs()
937 ret = call_qop(q, queue_setup, q, &num_buffers, in vb2_core_create_bufs()
938 &num_planes, plane_sizes, q->alloc_devs); in vb2_core_create_bufs()
949 mutex_lock(&q->mmap_lock); in vb2_core_create_bufs()
950 q->num_buffers += allocated_buffers; in vb2_core_create_bufs()
955 * from q->num_buffers. in vb2_core_create_bufs()
957 __vb2_queue_free(q, allocated_buffers); in vb2_core_create_bufs()
958 mutex_unlock(&q->mmap_lock); in vb2_core_create_bufs()
961 mutex_unlock(&q->mmap_lock); in vb2_core_create_bufs()
994 struct vb2_queue *q = vb->vb2_queue; in vb2_buffer_done() local
1012 dprintk(q, 4, "done processing on buffer %d, state: %s\n", in vb2_buffer_done()
1018 spin_lock_irqsave(&q->done_lock, flags); in vb2_buffer_done()
1023 list_add_tail(&vb->done_entry, &q->done_list); in vb2_buffer_done()
1026 atomic_dec(&q->owned_by_drv_count); in vb2_buffer_done()
1033 spin_unlock_irqrestore(&q->done_lock, flags); in vb2_buffer_done()
1035 trace_vb2_buf_done(q, vb); in vb2_buffer_done()
1042 wake_up(&q->done_wq); in vb2_buffer_done()
1048 void vb2_discard_done(struct vb2_queue *q) in vb2_discard_done() argument
1053 spin_lock_irqsave(&q->done_lock, flags); in vb2_discard_done()
1054 list_for_each_entry(vb, &q->done_list, done_entry) in vb2_discard_done()
1056 spin_unlock_irqrestore(&q->done_lock, flags); in vb2_discard_done()
1078 struct vb2_queue *q = vb->vb2_queue; in __prepare_userptr() local
1098 dprintk(q, 3, "userspace address for plane %d changed, reacquiring memory\n", in __prepare_userptr()
1103 dprintk(q, 1, "provided buffer size %u is less than setup size %u for plane %d\n", in __prepare_userptr()
1129 q->alloc_devs[plane] ? : q->dev, in __prepare_userptr()
1131 planes[plane].length, q->dma_dir); in __prepare_userptr()
1133 dprintk(q, 1, "failed acquiring userspace memory for plane %d\n", in __prepare_userptr()
1160 dprintk(q, 1, "buffer initialization failed\n"); in __prepare_userptr()
1167 dprintk(q, 1, "buffer preparation failed\n"); in __prepare_userptr()
1193 struct vb2_queue *q = vb->vb2_queue; in __prepare_dmabuf() local
1210 dprintk(q, 1, "invalid dmabuf fd for plane %d\n", in __prepare_dmabuf()
1221 dprintk(q, 1, "invalid dmabuf length %u for plane %d, minimum length %u\n", in __prepare_dmabuf()
1236 dprintk(q, 3, "buffer for plane %d changed\n", plane); in __prepare_dmabuf()
1253 q->alloc_devs[plane] ? : q->dev, in __prepare_dmabuf()
1254 dbuf, planes[plane].length, q->dma_dir); in __prepare_dmabuf()
1256 dprintk(q, 1, "failed to attach dmabuf\n"); in __prepare_dmabuf()
1277 dprintk(q, 1, "failed to map dmabuf for plane %d\n", in __prepare_dmabuf()
1302 dprintk(q, 1, "buffer initialization failed\n"); in __prepare_dmabuf()
1309 dprintk(q, 1, "buffer preparation failed\n"); in __prepare_dmabuf()
1327 struct vb2_queue *q = vb->vb2_queue; in __enqueue_in_driver() local
1330 atomic_inc(&q->owned_by_drv_count); in __enqueue_in_driver()
1332 trace_vb2_buf_queue(q, vb); in __enqueue_in_driver()
1339 struct vb2_queue *q = vb->vb2_queue; in __buf_prepare() local
1343 if (q->error) { in __buf_prepare()
1344 dprintk(q, 1, "fatal error occurred on queue\n"); in __buf_prepare()
1352 if (q->is_output) { in __buf_prepare()
1355 dprintk(q, 1, "buffer validation failed\n"); in __buf_prepare()
1362 switch (q->memory) { in __buf_prepare()
1379 dprintk(q, 1, "buffer preparation failed: %d\n", ret); in __buf_prepare()
1418 int vb2_core_qbuf(struct vb2_queue *q, unsigned int index, void *pb,
1480 int vb2_core_prepare_buf(struct vb2_queue *q, unsigned int index, void *pb) in vb2_core_prepare_buf() argument
1485 vb = q->bufs[index]; in vb2_core_prepare_buf()
1487 dprintk(q, 1, "invalid buffer state %s\n", in vb2_core_prepare_buf()
1492 dprintk(q, 1, "buffer already prepared\n"); in vb2_core_prepare_buf()
1501 call_void_bufop(q, fill_user_buffer, vb, pb); in vb2_core_prepare_buf()
1503 dprintk(q, 2, "prepare of buffer %d succeeded\n", vb->index); in vb2_core_prepare_buf()
1511 * @q: videobuf2 queue
1514 * at least q->min_buffers_needed buffers queued up (i.e. the minimum
1520 static int vb2_start_streaming(struct vb2_queue *q) in vb2_start_streaming() argument
1529 list_for_each_entry(vb, &q->queued_list, queued_entry) in vb2_start_streaming()
1533 q->start_streaming_called = 1; in vb2_start_streaming()
1534 ret = call_qop(q, start_streaming, q, in vb2_start_streaming()
1535 atomic_read(&q->owned_by_drv_count)); in vb2_start_streaming()
1539 q->start_streaming_called = 0; in vb2_start_streaming()
1541 dprintk(q, 1, "driver refused to start streaming\n"); in vb2_start_streaming()
1548 if (WARN_ON(atomic_read(&q->owned_by_drv_count))) { in vb2_start_streaming()
1555 for (i = 0; i < q->num_buffers; ++i) { in vb2_start_streaming()
1556 vb = q->bufs[i]; in vb2_start_streaming()
1561 WARN_ON(atomic_read(&q->owned_by_drv_count)); in vb2_start_streaming()
1568 WARN_ON(!list_empty(&q->done_list)); in vb2_start_streaming()
1572 int vb2_core_qbuf(struct vb2_queue *q, unsigned int index, void *pb, in vb2_core_qbuf() argument
1578 if (q->error) { in vb2_core_qbuf()
1579 dprintk(q, 1, "fatal error occurred on queue\n"); in vb2_core_qbuf()
1583 vb = q->bufs[index]; in vb2_core_qbuf()
1586 q->requires_requests) { in vb2_core_qbuf()
1587 dprintk(q, 1, "qbuf requires a request\n"); in vb2_core_qbuf()
1591 if ((req && q->uses_qbuf) || in vb2_core_qbuf()
1593 q->uses_requests)) { in vb2_core_qbuf()
1594 dprintk(q, 1, "queue in wrong mode (qbuf vs requests)\n"); in vb2_core_qbuf()
1601 q->uses_requests = 1; in vb2_core_qbuf()
1603 dprintk(q, 1, "buffer %d not in dequeued state\n", in vb2_core_qbuf()
1608 if (q->is_output && !vb->prepared) { in vb2_core_qbuf()
1611 dprintk(q, 1, "buffer validation failed\n"); in vb2_core_qbuf()
1623 q, true, &vb->req_obj); in vb2_core_qbuf()
1643 call_void_bufop(q, copy_timestamp, vb, pb); in vb2_core_qbuf()
1644 call_void_bufop(q, fill_user_buffer, vb, pb); in vb2_core_qbuf()
1647 dprintk(q, 2, "qbuf of buffer %d succeeded\n", vb->index); in vb2_core_qbuf()
1652 q->uses_qbuf = 1; in vb2_core_qbuf()
1664 dprintk(q, 1, "buffer still being prepared\n"); in vb2_core_qbuf()
1667 dprintk(q, 1, "invalid buffer state %s\n", in vb2_core_qbuf()
1676 list_add_tail(&vb->queued_entry, &q->queued_list); in vb2_core_qbuf()
1677 q->queued_count++; in vb2_core_qbuf()
1678 q->waiting_for_buffers = false; in vb2_core_qbuf()
1682 call_void_bufop(q, copy_timestamp, vb, pb); in vb2_core_qbuf()
1684 trace_vb2_qbuf(q, vb); in vb2_core_qbuf()
1690 if (q->start_streaming_called) in vb2_core_qbuf()
1695 call_void_bufop(q, fill_user_buffer, vb, pb); in vb2_core_qbuf()
1703 if (q->streaming && !q->start_streaming_called && in vb2_core_qbuf()
1704 q->queued_count >= q->min_buffers_needed) { in vb2_core_qbuf()
1705 ret = vb2_start_streaming(q); in vb2_core_qbuf()
1710 dprintk(q, 2, "qbuf of buffer %d succeeded\n", vb->index); in vb2_core_qbuf()
1721 static int __vb2_wait_for_done_vb(struct vb2_queue *q, int nonblocking) in __vb2_wait_for_done_vb() argument
1735 if (q->waiting_in_dqbuf) { in __vb2_wait_for_done_vb()
1736 dprintk(q, 1, "another dup()ped fd is waiting for a buffer\n"); in __vb2_wait_for_done_vb()
1740 if (!q->streaming) { in __vb2_wait_for_done_vb()
1741 dprintk(q, 1, "streaming off, will not wait for buffers\n"); in __vb2_wait_for_done_vb()
1745 if (q->error) { in __vb2_wait_for_done_vb()
1746 dprintk(q, 1, "Queue in error state, will not wait for buffers\n"); in __vb2_wait_for_done_vb()
1750 if (q->last_buffer_dequeued) { in __vb2_wait_for_done_vb()
1751 dprintk(q, 3, "last buffer dequeued already, will not wait for buffers\n"); in __vb2_wait_for_done_vb()
1755 if (!list_empty(&q->done_list)) { in __vb2_wait_for_done_vb()
1763 dprintk(q, 3, "nonblocking and no buffers to dequeue, will not wait\n"); in __vb2_wait_for_done_vb()
1767 q->waiting_in_dqbuf = 1; in __vb2_wait_for_done_vb()
1773 call_void_qop(q, wait_prepare, q); in __vb2_wait_for_done_vb()
1778 dprintk(q, 3, "will sleep waiting for buffers\n"); in __vb2_wait_for_done_vb()
1779 ret = wait_event_interruptible(q->done_wq, in __vb2_wait_for_done_vb()
1780 !list_empty(&q->done_list) || !q->streaming || in __vb2_wait_for_done_vb()
1781 q->error); in __vb2_wait_for_done_vb()
1787 call_void_qop(q, wait_finish, q); in __vb2_wait_for_done_vb()
1788 q->waiting_in_dqbuf = 0; in __vb2_wait_for_done_vb()
1790 dprintk(q, 1, "sleep was interrupted\n"); in __vb2_wait_for_done_vb()
1802 static int __vb2_get_done_vb(struct vb2_queue *q, struct vb2_buffer **vb, in __vb2_get_done_vb() argument
1811 ret = __vb2_wait_for_done_vb(q, nonblocking); in __vb2_get_done_vb()
1819 spin_lock_irqsave(&q->done_lock, flags); in __vb2_get_done_vb()
1820 *vb = list_first_entry(&q->done_list, struct vb2_buffer, done_entry); in __vb2_get_done_vb()
1827 ret = call_bufop(q, verify_planes_array, *vb, pb); in __vb2_get_done_vb()
1830 spin_unlock_irqrestore(&q->done_lock, flags); in __vb2_get_done_vb()
1835 int vb2_wait_for_all_buffers(struct vb2_queue *q) in vb2_wait_for_all_buffers() argument
1837 if (!q->streaming) { in vb2_wait_for_all_buffers()
1838 dprintk(q, 1, "streaming off, will not wait for buffers\n"); in vb2_wait_for_all_buffers()
1842 if (q->start_streaming_called) in vb2_wait_for_all_buffers()
1843 wait_event(q->done_wq, !atomic_read(&q->owned_by_drv_count)); in vb2_wait_for_all_buffers()
1853 struct vb2_queue *q = vb->vb2_queue; in __vb2_dqbuf() local
1861 call_void_bufop(q, init_buffer, vb); in __vb2_dqbuf()
1864 int vb2_core_dqbuf(struct vb2_queue *q, unsigned int *pindex, void *pb, in vb2_core_dqbuf() argument
1870 ret = __vb2_get_done_vb(q, &vb, pb, nonblocking); in vb2_core_dqbuf()
1876 dprintk(q, 3, "returning done buffer\n"); in vb2_core_dqbuf()
1879 dprintk(q, 3, "returning done buffer with errors\n"); in vb2_core_dqbuf()
1882 dprintk(q, 1, "invalid buffer state %s\n", in vb2_core_dqbuf()
1895 call_void_bufop(q, fill_user_buffer, vb, pb); in vb2_core_dqbuf()
1899 q->queued_count--; in vb2_core_dqbuf()
1901 trace_vb2_dqbuf(q, vb); in vb2_core_dqbuf()
1914 dprintk(q, 2, "dqbuf of buffer %d, state: %s\n", in vb2_core_dqbuf()
1928 static void __vb2_queue_cancel(struct vb2_queue *q) in __vb2_queue_cancel() argument
1936 if (q->start_streaming_called) in __vb2_queue_cancel()
1937 call_void_qop(q, stop_streaming, q); in __vb2_queue_cancel()
1945 if (WARN_ON(atomic_read(&q->owned_by_drv_count))) { in __vb2_queue_cancel()
1946 for (i = 0; i < q->num_buffers; ++i) in __vb2_queue_cancel()
1947 if (q->bufs[i]->state == VB2_BUF_STATE_ACTIVE) { in __vb2_queue_cancel()
1949 q->bufs[i]); in __vb2_queue_cancel()
1950 vb2_buffer_done(q->bufs[i], VB2_BUF_STATE_ERROR); in __vb2_queue_cancel()
1953 WARN_ON(atomic_read(&q->owned_by_drv_count)); in __vb2_queue_cancel()
1956 q->streaming = 0; in __vb2_queue_cancel()
1957 q->start_streaming_called = 0; in __vb2_queue_cancel()
1958 q->queued_count = 0; in __vb2_queue_cancel()
1959 q->error = 0; in __vb2_queue_cancel()
1960 q->uses_requests = 0; in __vb2_queue_cancel()
1961 q->uses_qbuf = 0; in __vb2_queue_cancel()
1966 INIT_LIST_HEAD(&q->queued_list); in __vb2_queue_cancel()
1971 INIT_LIST_HEAD(&q->done_list); in __vb2_queue_cancel()
1972 atomic_set(&q->owned_by_drv_count, 0); in __vb2_queue_cancel()
1973 wake_up_all(&q->done_wq); in __vb2_queue_cancel()
1984 for (i = 0; i < q->num_buffers; ++i) { in __vb2_queue_cancel()
1985 struct vb2_buffer *vb = q->bufs[i]; in __vb2_queue_cancel()
2025 int vb2_core_streamon(struct vb2_queue *q, unsigned int type) in vb2_core_streamon() argument
2029 if (type != q->type) { in vb2_core_streamon()
2030 dprintk(q, 1, "invalid stream type\n"); in vb2_core_streamon()
2034 if (q->streaming) { in vb2_core_streamon()
2035 dprintk(q, 3, "already streaming\n"); in vb2_core_streamon()
2039 if (!q->num_buffers) { in vb2_core_streamon()
2040 dprintk(q, 1, "no buffers have been allocated\n"); in vb2_core_streamon()
2044 if (q->num_buffers < q->min_buffers_needed) { in vb2_core_streamon()
2045 dprintk(q, 1, "need at least %u allocated buffers\n", in vb2_core_streamon()
2046 q->min_buffers_needed); in vb2_core_streamon()
2054 if (q->queued_count >= q->min_buffers_needed) { in vb2_core_streamon()
2055 ret = v4l_vb2q_enable_media_source(q); in vb2_core_streamon()
2058 ret = vb2_start_streaming(q); in vb2_core_streamon()
2063 q->streaming = 1; in vb2_core_streamon()
2065 dprintk(q, 3, "successful\n"); in vb2_core_streamon()
2070 void vb2_queue_error(struct vb2_queue *q) in vb2_queue_error() argument
2072 q->error = 1; in vb2_queue_error()
2074 wake_up_all(&q->done_wq); in vb2_queue_error()
2078 int vb2_core_streamoff(struct vb2_queue *q, unsigned int type) in vb2_core_streamoff() argument
2080 if (type != q->type) { in vb2_core_streamoff()
2081 dprintk(q, 1, "invalid stream type\n"); in vb2_core_streamoff()
2089 * Note that we do this even if q->streaming == 0: if you prepare or in vb2_core_streamoff()
2094 __vb2_queue_cancel(q); in vb2_core_streamoff()
2095 q->waiting_for_buffers = !q->is_output; in vb2_core_streamoff()
2096 q->last_buffer_dequeued = false; in vb2_core_streamoff()
2098 dprintk(q, 3, "successful\n"); in vb2_core_streamoff()
2106 static int __find_plane_by_offset(struct vb2_queue *q, unsigned long off, in __find_plane_by_offset() argument
2117 for (buffer = 0; buffer < q->num_buffers; ++buffer) { in __find_plane_by_offset()
2118 vb = q->bufs[buffer]; in __find_plane_by_offset()
2132 int vb2_core_expbuf(struct vb2_queue *q, int *fd, unsigned int type, in vb2_core_expbuf() argument
2140 if (q->memory != VB2_MEMORY_MMAP) { in vb2_core_expbuf()
2141 dprintk(q, 1, "queue is not currently set up for mmap\n"); in vb2_core_expbuf()
2145 if (!q->mem_ops->get_dmabuf) { in vb2_core_expbuf()
2146 dprintk(q, 1, "queue does not support DMA buffer exporting\n"); in vb2_core_expbuf()
2151 dprintk(q, 1, "queue does support only O_CLOEXEC and access mode flags\n"); in vb2_core_expbuf()
2155 if (type != q->type) { in vb2_core_expbuf()
2156 dprintk(q, 1, "invalid buffer type\n"); in vb2_core_expbuf()
2160 if (index >= q->num_buffers) { in vb2_core_expbuf()
2161 dprintk(q, 1, "buffer index out of range\n"); in vb2_core_expbuf()
2165 vb = q->bufs[index]; in vb2_core_expbuf()
2168 dprintk(q, 1, "buffer plane out of range\n"); in vb2_core_expbuf()
2172 if (vb2_fileio_is_active(q)) { in vb2_core_expbuf()
2173 dprintk(q, 1, "expbuf: file io in progress\n"); in vb2_core_expbuf()
2182 dprintk(q, 1, "failed to export buffer %d, plane %d\n", in vb2_core_expbuf()
2189 dprintk(q, 3, "buffer %d, plane %d failed to export (%d)\n", in vb2_core_expbuf()
2195 dprintk(q, 3, "buffer %d, plane %d exported as %d descriptor\n", in vb2_core_expbuf()
2203 int vb2_mmap(struct vb2_queue *q, struct vm_area_struct *vma) in vb2_mmap() argument
2211 if (q->memory != VB2_MEMORY_MMAP) { in vb2_mmap()
2212 dprintk(q, 1, "queue is not currently set up for mmap\n"); in vb2_mmap()
2220 dprintk(q, 1, "invalid vma flags, VM_SHARED needed\n"); in vb2_mmap()
2223 if (q->is_output) { in vb2_mmap()
2225 dprintk(q, 1, "invalid vma flags, VM_WRITE needed\n"); in vb2_mmap()
2230 dprintk(q, 1, "invalid vma flags, VM_READ needed\n"); in vb2_mmap()
2235 mutex_lock(&q->mmap_lock); in vb2_mmap()
2237 if (vb2_fileio_is_active(q)) { in vb2_mmap()
2238 dprintk(q, 1, "mmap: file io in progress\n"); in vb2_mmap()
2246 ret = __find_plane_by_offset(q, off, &buffer, &plane); in vb2_mmap()
2250 vb = q->bufs[buffer]; in vb2_mmap()
2259 dprintk(q, 1, in vb2_mmap()
2275 mutex_unlock(&q->mmap_lock); in vb2_mmap()
2279 dprintk(q, 3, "buffer %d, plane %d successfully mapped\n", buffer, plane); in vb2_mmap()
2285 unsigned long vb2_get_unmapped_area(struct vb2_queue *q, in vb2_get_unmapped_area() argument
2297 if (q->memory != VB2_MEMORY_MMAP) { in vb2_get_unmapped_area()
2298 dprintk(q, 1, "queue is not currently set up for mmap\n"); in vb2_get_unmapped_area()
2305 ret = __find_plane_by_offset(q, off, &buffer, &plane); in vb2_get_unmapped_area()
2309 vb = q->bufs[buffer]; in vb2_get_unmapped_area()
2317 int vb2_core_queue_init(struct vb2_queue *q) in vb2_core_queue_init() argument
2322 if (WARN_ON(!q) || in vb2_core_queue_init()
2323 WARN_ON(!q->ops) || in vb2_core_queue_init()
2324 WARN_ON(!q->mem_ops) || in vb2_core_queue_init()
2325 WARN_ON(!q->type) || in vb2_core_queue_init()
2326 WARN_ON(!q->io_modes) || in vb2_core_queue_init()
2327 WARN_ON(!q->ops->queue_setup) || in vb2_core_queue_init()
2328 WARN_ON(!q->ops->buf_queue)) in vb2_core_queue_init()
2331 if (WARN_ON(q->requires_requests && !q->supports_requests)) in vb2_core_queue_init()
2334 INIT_LIST_HEAD(&q->queued_list); in vb2_core_queue_init()
2335 INIT_LIST_HEAD(&q->done_list); in vb2_core_queue_init()
2336 spin_lock_init(&q->done_lock); in vb2_core_queue_init()
2337 mutex_init(&q->mmap_lock); in vb2_core_queue_init()
2338 init_waitqueue_head(&q->done_wq); in vb2_core_queue_init()
2340 q->memory = VB2_MEMORY_UNKNOWN; in vb2_core_queue_init()
2342 if (q->buf_struct_size == 0) in vb2_core_queue_init()
2343 q->buf_struct_size = sizeof(struct vb2_buffer); in vb2_core_queue_init()
2345 if (q->bidirectional) in vb2_core_queue_init()
2346 q->dma_dir = DMA_BIDIRECTIONAL; in vb2_core_queue_init()
2348 q->dma_dir = q->is_output ? DMA_TO_DEVICE : DMA_FROM_DEVICE; in vb2_core_queue_init()
2350 if (q->name[0] == '\0') in vb2_core_queue_init()
2351 snprintf(q->name, sizeof(q->name), "%s-%p", in vb2_core_queue_init()
2352 q->is_output ? "out" : "cap", q); in vb2_core_queue_init()
2358 static int __vb2_init_fileio(struct vb2_queue *q, int read);
2359 static int __vb2_cleanup_fileio(struct vb2_queue *q);
2360 void vb2_core_queue_release(struct vb2_queue *q) in vb2_core_queue_release() argument
2362 __vb2_cleanup_fileio(q); in vb2_core_queue_release()
2363 __vb2_queue_cancel(q); in vb2_core_queue_release()
2364 mutex_lock(&q->mmap_lock); in vb2_core_queue_release()
2365 __vb2_queue_free(q, q->num_buffers); in vb2_core_queue_release()
2366 mutex_unlock(&q->mmap_lock); in vb2_core_queue_release()
2370 __poll_t vb2_core_poll(struct vb2_queue *q, struct file *file, in vb2_core_poll() argument
2377 if (!q->is_output && !(req_events & (EPOLLIN | EPOLLRDNORM))) in vb2_core_poll()
2379 if (q->is_output && !(req_events & (EPOLLOUT | EPOLLWRNORM))) in vb2_core_poll()
2382 poll_wait(file, &q->done_wq, wait); in vb2_core_poll()
2387 if (q->num_buffers == 0 && !vb2_fileio_is_active(q)) { in vb2_core_poll()
2388 if (!q->is_output && (q->io_modes & VB2_READ) && in vb2_core_poll()
2390 if (__vb2_init_fileio(q, 1)) in vb2_core_poll()
2393 if (q->is_output && (q->io_modes & VB2_WRITE) && in vb2_core_poll()
2395 if (__vb2_init_fileio(q, 0)) in vb2_core_poll()
2408 if (!vb2_is_streaming(q) || q->error) in vb2_core_poll()
2417 if (q->quirk_poll_must_check_waiting_for_buffers && in vb2_core_poll()
2418 q->waiting_for_buffers && (req_events & (EPOLLIN | EPOLLRDNORM))) in vb2_core_poll()
2425 if (q->is_output && q->fileio && q->queued_count < q->num_buffers) in vb2_core_poll()
2428 if (list_empty(&q->done_list)) { in vb2_core_poll()
2433 if (q->last_buffer_dequeued) in vb2_core_poll()
2440 spin_lock_irqsave(&q->done_lock, flags); in vb2_core_poll()
2441 if (!list_empty(&q->done_list)) in vb2_core_poll()
2442 vb = list_first_entry(&q->done_list, struct vb2_buffer, in vb2_core_poll()
2444 spin_unlock_irqrestore(&q->done_lock, flags); in vb2_core_poll()
2448 return (q->is_output) ? in vb2_core_poll()
2474 * written to. If equal to q->num_buffers then a new buffer
2485 * in this field. Once it is equal to q->num_buffers all
2509 * @q: videobuf2 queue
2512 static int __vb2_init_fileio(struct vb2_queue *q, int read) in __vb2_init_fileio() argument
2521 if (WARN_ON((read && !(q->io_modes & VB2_READ)) || in __vb2_init_fileio()
2522 (!read && !(q->io_modes & VB2_WRITE)))) in __vb2_init_fileio()
2528 if (!q->mem_ops->vaddr) in __vb2_init_fileio()
2534 if (q->streaming || q->num_buffers > 0) in __vb2_init_fileio()
2542 dprintk(q, 3, "setting up file io: mode %s, count %d, read_once %d, write_immediately %d\n", in __vb2_init_fileio()
2543 (read) ? "read" : "write", count, q->fileio_read_once, in __vb2_init_fileio()
2544 q->fileio_write_immediately); in __vb2_init_fileio()
2550 fileio->read_once = q->fileio_read_once; in __vb2_init_fileio()
2551 fileio->write_immediately = q->fileio_write_immediately; in __vb2_init_fileio()
2559 fileio->type = q->type; in __vb2_init_fileio()
2560 q->fileio = fileio; in __vb2_init_fileio()
2561 ret = vb2_core_reqbufs(q, fileio->memory, &fileio->count); in __vb2_init_fileio()
2569 if (q->bufs[0]->num_planes != 1) { in __vb2_init_fileio()
2577 for (i = 0; i < q->num_buffers; i++) { in __vb2_init_fileio()
2578 fileio->bufs[i].vaddr = vb2_plane_vaddr(q->bufs[i], 0); in __vb2_init_fileio()
2583 fileio->bufs[i].size = vb2_plane_size(q->bufs[i], 0); in __vb2_init_fileio()
2593 for (i = 0; i < q->num_buffers; i++) { in __vb2_init_fileio()
2594 ret = vb2_core_qbuf(q, i, NULL, NULL); in __vb2_init_fileio()
2601 * initial_index to q->num_buffers in __vb2_init_fileio()
2603 fileio->initial_index = q->num_buffers; in __vb2_init_fileio()
2604 fileio->cur_index = q->num_buffers; in __vb2_init_fileio()
2610 ret = vb2_core_streamon(q, q->type); in __vb2_init_fileio()
2618 vb2_core_reqbufs(q, fileio->memory, &fileio->count); in __vb2_init_fileio()
2621 q->fileio = NULL; in __vb2_init_fileio()
2628 * @q: videobuf2 queue
2630 static int __vb2_cleanup_fileio(struct vb2_queue *q) in __vb2_cleanup_fileio() argument
2632 struct vb2_fileio_data *fileio = q->fileio; in __vb2_cleanup_fileio()
2635 vb2_core_streamoff(q, q->type); in __vb2_cleanup_fileio()
2636 q->fileio = NULL; in __vb2_cleanup_fileio()
2638 vb2_core_reqbufs(q, fileio->memory, &fileio->count); in __vb2_cleanup_fileio()
2640 dprintk(q, 3, "file io emulator closed\n"); in __vb2_cleanup_fileio()
2647 * @q: videobuf2 queue
2654 static size_t __vb2_perform_fileio(struct vb2_queue *q, char __user *data, size_t count, in __vb2_perform_fileio() argument
2659 bool is_multiplanar = q->is_multiplanar; in __vb2_perform_fileio()
2665 bool copy_timestamp = !read && q->copy_timestamp; in __vb2_perform_fileio()
2669 dprintk(q, 3, "mode %s, offset %ld, count %zd, %sblocking\n", in __vb2_perform_fileio()
2676 if (q->waiting_in_dqbuf) { in __vb2_perform_fileio()
2677 dprintk(q, 3, "another dup()ped fd is %s\n", in __vb2_perform_fileio()
2685 if (!vb2_fileio_is_active(q)) { in __vb2_perform_fileio()
2686 ret = __vb2_init_fileio(q, read); in __vb2_perform_fileio()
2687 dprintk(q, 3, "vb2_init_fileio result: %d\n", ret); in __vb2_perform_fileio()
2691 fileio = q->fileio; in __vb2_perform_fileio()
2697 if (index >= q->num_buffers) { in __vb2_perform_fileio()
2703 ret = vb2_core_dqbuf(q, &index, NULL, nonblock); in __vb2_perform_fileio()
2704 dprintk(q, 5, "vb2_dqbuf result: %d\n", ret); in __vb2_perform_fileio()
2711 b = q->bufs[index]; in __vb2_perform_fileio()
2718 buf->size = read ? vb2_get_plane_payload(q->bufs[index], 0) in __vb2_perform_fileio()
2719 : vb2_plane_size(q->bufs[index], 0); in __vb2_perform_fileio()
2735 dprintk(q, 5, "reducing read count: %zd\n", count); in __vb2_perform_fileio()
2741 dprintk(q, 3, "copying %zd bytes - buffer %d, offset %u\n", in __vb2_perform_fileio()
2748 dprintk(q, 3, "error copying data\n"); in __vb2_perform_fileio()
2762 struct vb2_buffer *b = q->bufs[index]; in __vb2_perform_fileio()
2768 dprintk(q, 3, "read limit reached\n"); in __vb2_perform_fileio()
2769 return __vb2_cleanup_fileio(q); in __vb2_perform_fileio()
2779 ret = vb2_core_qbuf(q, index, NULL, NULL); in __vb2_perform_fileio()
2780 dprintk(q, 5, "vb2_dbuf result: %d\n", ret); in __vb2_perform_fileio()
2789 buf->size = vb2_plane_size(q->bufs[index], 0); in __vb2_perform_fileio()
2795 if (fileio->initial_index < q->num_buffers) in __vb2_perform_fileio()
2799 * queued for the first time (initial_index < q->num_buffers) in __vb2_perform_fileio()
2800 * or it is equal to q->num_buffers, meaning that the next in __vb2_perform_fileio()
2815 size_t vb2_read(struct vb2_queue *q, char __user *data, size_t count, in vb2_read() argument
2818 return __vb2_perform_fileio(q, data, count, ppos, nonblocking, 1); in vb2_read()
2822 size_t vb2_write(struct vb2_queue *q, const char __user *data, size_t count, in vb2_write() argument
2825 return __vb2_perform_fileio(q, (char __user *) data, count, in vb2_write()
2839 struct vb2_queue *q = data; in vb2_thread() local
2840 struct vb2_threadio_data *threadio = q->threadio; in vb2_thread()
2846 if (q->is_output) { in vb2_thread()
2847 prequeue = q->num_buffers; in vb2_thread()
2848 copy_timestamp = q->copy_timestamp; in vb2_thread()
2860 vb = q->bufs[index++]; in vb2_thread()
2863 call_void_qop(q, wait_finish, q); in vb2_thread()
2865 ret = vb2_core_dqbuf(q, &index, NULL, 0); in vb2_thread()
2866 call_void_qop(q, wait_prepare, q); in vb2_thread()
2867 dprintk(q, 5, "file io: vb2_dqbuf result: %d\n", ret); in vb2_thread()
2869 vb = q->bufs[index]; in vb2_thread()
2878 call_void_qop(q, wait_finish, q); in vb2_thread()
2882 ret = vb2_core_qbuf(q, vb->index, NULL, NULL); in vb2_thread()
2883 call_void_qop(q, wait_prepare, q); in vb2_thread()
2901 int vb2_thread_start(struct vb2_queue *q, vb2_thread_fnc fnc, void *priv, in vb2_thread_start() argument
2907 if (q->threadio) in vb2_thread_start()
2909 if (vb2_is_busy(q)) in vb2_thread_start()
2911 if (WARN_ON(q->fileio)) in vb2_thread_start()
2920 ret = __vb2_init_fileio(q, !q->is_output); in vb2_thread_start()
2921 dprintk(q, 3, "file io: vb2_init_fileio result: %d\n", ret); in vb2_thread_start()
2924 q->threadio = threadio; in vb2_thread_start()
2925 threadio->thread = kthread_run(vb2_thread, q, "vb2-%s", thread_name); in vb2_thread_start()
2934 __vb2_cleanup_fileio(q); in vb2_thread_start()
2941 int vb2_thread_stop(struct vb2_queue *q) in vb2_thread_stop() argument
2943 struct vb2_threadio_data *threadio = q->threadio; in vb2_thread_stop()
2950 vb2_queue_error(q); in vb2_thread_stop()
2952 __vb2_cleanup_fileio(q); in vb2_thread_stop()
2955 q->threadio = NULL; in vb2_thread_stop()