gadget/function/uvc_queue.c

26  * Video buffers queue management.
32  * the videobuf2 queue operations by serializing calls to videobuf2 and a
33  * spinlock to protect the IRQ queue that holds the buffers to be processed by
38  * videobuf2 queue operations
45 	struct uvc_video_queue *queue = vb2_get_drv_priv(vq);
46 	struct uvc_video *video = container_of(queue, struct uvc_video, queue);
73 	struct uvc_video_queue *queue = vb2_get_drv_priv(vb->vb2_queue);
83 	if (unlikely(queue->flags & UVC_QUEUE_DISCONNECTED))
87 	if (queue->use_sg) {
104 	struct uvc_video_queue *queue = vb2_get_drv_priv(vb->vb2_queue);
109 	spin_lock_irqsave(&queue->irqlock, flags);
111 	if (likely(!(queue->flags & UVC_QUEUE_DISCONNECTED))) {
112 		list_add_tail(&buf->queue, &queue->irqqueue);
122 	spin_unlock_irqrestore(&queue->irqlock, flags);
133 int uvcg_queue_init(struct uvc_video_queue *queue, struct device *dev, enum v4l2_buf_type type,
136 	struct uvc_video *video = container_of(queue, struct uvc_video, queue);
140 	queue->queue.type = type;
141 	queue->queue.io_modes = VB2_MMAP | VB2_USERPTR | VB2_DMABUF;
142 	queue->queue.drv_priv = queue;
143 	queue->queue.buf_struct_size = sizeof(struct uvc_buffer);
144 	queue->queue.ops = &uvc_queue_qops;
145 	queue->queue.lock = lock;
147 		queue->queue.mem_ops = &vb2_dma_sg_memops;
148 		queue->use_sg = 1;
150 		queue->queue.mem_ops = &vb2_vmalloc_memops;
153 	queue->queue.timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_COPY
155 	queue->queue.dev = dev;
157 	ret = vb2_queue_init(&queue->queue);
161 	spin_lock_init(&queue->irqlock);
162 	INIT_LIST_HEAD(&queue->irqqueue);
163 	queue->flags = 0;
171 void uvcg_free_buffers(struct uvc_video_queue *queue)
173 	vb2_queue_release(&queue->queue);
179 int uvcg_alloc_buffers(struct uvc_video_queue *queue,
184 	ret = vb2_reqbufs(&queue->queue, rb);
189 int uvcg_query_buffer(struct uvc_video_queue *queue, struct v4l2_buffer *buf)
191 	return vb2_querybuf(&queue->queue, buf);
194 int uvcg_queue_buffer(struct uvc_video_queue *queue, struct v4l2_buffer *buf)
196 	return vb2_qbuf(&queue->queue, NULL, buf);
203 int uvcg_dequeue_buffer(struct uvc_video_queue *queue, struct v4l2_buffer *buf,
206 	return vb2_dqbuf(&queue->queue, buf, nonblocking);
210  * Poll the video queue.
212  * This function implements video queue polling and is intended to be used by
215 __poll_t uvcg_queue_poll(struct uvc_video_queue *queue, struct file *file,
218 	return vb2_poll(&queue->queue, file, wait);
221 int uvcg_queue_mmap(struct uvc_video_queue *queue, struct vm_area_struct *vma)
223 	return vb2_mmap(&queue->queue, vma);
232 unsigned long uvcg_queue_get_unmapped_area(struct uvc_video_queue *queue,
235 	return vb2_get_unmapped_area(&queue->queue, 0, 0, pgoff, 0);
240  * Cancel the video buffers queue.
242  * Cancelling the queue marks all buffers on the irq queue as erroneous,
243  * wakes them up and removes them from the queue.
251 void uvcg_queue_cancel(struct uvc_video_queue *queue, int disconnect)
256 	spin_lock_irqsave(&queue->irqlock, flags);
257 	while (!list_empty(&queue->irqqueue)) {
258 		buf = list_first_entry(&queue->irqqueue, struct uvc_buffer,
259 				       queue);
260 		list_del(&buf->queue);
264 	queue->buf_used = 0;
271 	 * state outside the queue code.
274 		queue->flags |= UVC_QUEUE_DISCONNECTED;
275 	spin_unlock_irqrestore(&queue->irqlock, flags);
279  * Enable or disable the video buffers queue.
281  * The queue must be enabled before starting video acquisition and must be
282  * disabled after stopping it. This ensures that the video buffers queue
286  * Enabling the video queue initializes parameters (such as sequence number,
287  * sync pattern, ...). If the queue is already enabled, return -EBUSY.
289  * Disabling the video queue cancels the queue and removes all buffers from
290  * the main queue.
295 int uvcg_queue_enable(struct uvc_video_queue *queue, int enable)
301 		ret = vb2_streamon(&queue->queue, queue->queue.type);
305 		queue->sequence = 0;
306 		queue->buf_used = 0;
307 		queue->flags &= ~UVC_QUEUE_DROP_INCOMPLETE;
309 		ret = vb2_streamoff(&queue->queue, queue->queue.type);
313 		spin_lock_irqsave(&queue->irqlock, flags);
314 		INIT_LIST_HEAD(&queue->irqqueue);
318 		 * applications will be able to queue buffers for the next
322 		queue->flags &= ~UVC_QUEUE_DISCONNECTED;
323 		spin_unlock_irqrestore(&queue->irqlock, flags);
330 void uvcg_complete_buffer(struct uvc_video_queue *queue,
333 	if (queue->flags & UVC_QUEUE_DROP_INCOMPLETE) {
334 		queue->flags &= ~UVC_QUEUE_DROP_INCOMPLETE;
342 	buf->buf.sequence = queue->sequence++;
349 struct uvc_buffer *uvcg_queue_head(struct uvc_video_queue *queue)
353 	if (!list_empty(&queue->irqqueue))
354 		buf = list_first_entry(&queue->irqqueue, struct uvc_buffer,
355 				       queue);