usb/uvc/uvc_queue.c

24  * Video buffers queue management.
30  * the videobuf2 queue operations by serializing calls to videobuf2 and a
31  * spinlock to protect the IRQ queue that holds the buffers to be processed by
43  * This function must be called with the queue spinlock held.
45 static void uvc_queue_return_buffers(struct uvc_video_queue *queue,
52 	while (!list_empty(&queue->irqqueue)) {
53 		struct uvc_buffer *buf = list_first_entry(&queue->irqqueue,
55 							  queue);
56 		list_del(&buf->queue);
63  * videobuf2 queue operations
70 	struct uvc_video_queue *queue = vb2_get_drv_priv(vq);
80 		stream = uvc_queue_to_stream(queue);
101 	struct uvc_video_queue *queue = vb2_get_drv_priv(vb->vb2_queue);
106 		uvc_dbg(uvc_queue_to_stream(queue)->dev, CAPTURE,
111 	if (unlikely(queue->flags & UVC_QUEUE_DISCONNECTED))
129 	struct uvc_video_queue *queue = vb2_get_drv_priv(vb->vb2_queue);
133 	spin_lock_irqsave(&queue->irqlock, flags);
134 	if (likely(!(queue->flags & UVC_QUEUE_DISCONNECTED))) {
136 		list_add_tail(&buf->queue, &queue->irqqueue);
146 	spin_unlock_irqrestore(&queue->irqlock, flags);
152 	struct uvc_video_queue *queue = vb2_get_drv_priv(vb->vb2_queue);
153 	struct uvc_streaming *stream = uvc_queue_to_stream(queue);
162 	struct uvc_video_queue *queue = vb2_get_drv_priv(vq);
163 	struct uvc_streaming *stream = uvc_queue_to_stream(queue);
168 	queue->buf_used = 0;
174 	spin_lock_irq(&queue->irqlock);
175 	uvc_queue_return_buffers(queue, UVC_BUF_STATE_QUEUED);
176 	spin_unlock_irq(&queue->irqlock);
183 	struct uvc_video_queue *queue = vb2_get_drv_priv(vq);
188 		uvc_video_stop_streaming(uvc_queue_to_stream(queue));
190 	spin_lock_irq(&queue->irqlock);
191 	uvc_queue_return_buffers(queue, UVC_BUF_STATE_ERROR);
192 	spin_unlock_irq(&queue->irqlock);
215 int uvc_queue_init(struct uvc_video_queue *queue, enum v4l2_buf_type type,
220 	queue->queue.type = type;
221 	queue->queue.io_modes = VB2_MMAP | VB2_USERPTR;
222 	queue->queue.drv_priv = queue;
223 	queue->queue.buf_struct_size = sizeof(struct uvc_buffer);
224 	queue->queue.mem_ops = &vb2_vmalloc_memops;
225 	queue->queue.timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC
227 	queue->queue.lock = &queue->mutex;
231 		queue->queue.ops = &uvc_meta_queue_qops;
234 		queue->queue.io_modes |= VB2_DMABUF;
235 		queue->queue.ops = &uvc_queue_qops;
239 	ret = vb2_queue_init(&queue->queue);
243 	mutex_init(&queue->mutex);
244 	spin_lock_init(&queue->irqlock);
245 	INIT_LIST_HEAD(&queue->irqqueue);
246 	queue->flags = drop_corrupted ? UVC_QUEUE_DROP_CORRUPTED : 0;
251 void uvc_queue_release(struct uvc_video_queue *queue)
253 	mutex_lock(&queue->mutex);
254 	vb2_queue_release(&queue->queue);
255 	mutex_unlock(&queue->mutex);
259  * V4L2 queue operations
262 int uvc_request_buffers(struct uvc_video_queue *queue,
267 	mutex_lock(&queue->mutex);
268 	ret = vb2_reqbufs(&queue->queue, rb);
269 	mutex_unlock(&queue->mutex);
274 int uvc_query_buffer(struct uvc_video_queue *queue, struct v4l2_buffer *buf)
278 	mutex_lock(&queue->mutex);
279 	ret = vb2_querybuf(&queue->queue, buf);
280 	mutex_unlock(&queue->mutex);
285 int uvc_create_buffers(struct uvc_video_queue *queue,
290 	mutex_lock(&queue->mutex);
291 	ret = vb2_create_bufs(&queue->queue, cb);
292 	mutex_unlock(&queue->mutex);
297 int uvc_queue_buffer(struct uvc_video_queue *queue,
302 	mutex_lock(&queue->mutex);
303 	ret = vb2_qbuf(&queue->queue, mdev, buf);
304 	mutex_unlock(&queue->mutex);
309 int uvc_export_buffer(struct uvc_video_queue *queue,
314 	mutex_lock(&queue->mutex);
315 	ret = vb2_expbuf(&queue->queue, exp);
316 	mutex_unlock(&queue->mutex);
321 int uvc_dequeue_buffer(struct uvc_video_queue *queue, struct v4l2_buffer *buf,
326 	mutex_lock(&queue->mutex);
327 	ret = vb2_dqbuf(&queue->queue, buf, nonblocking);
328 	mutex_unlock(&queue->mutex);
333 int uvc_queue_streamon(struct uvc_video_queue *queue, enum v4l2_buf_type type)
337 	mutex_lock(&queue->mutex);
338 	ret = vb2_streamon(&queue->queue, type);
339 	mutex_unlock(&queue->mutex);
344 int uvc_queue_streamoff(struct uvc_video_queue *queue, enum v4l2_buf_type type)
348 	mutex_lock(&queue->mutex);
349 	ret = vb2_streamoff(&queue->queue, type);
350 	mutex_unlock(&queue->mutex);
355 int uvc_queue_mmap(struct uvc_video_queue *queue, struct vm_area_struct *vma)
357 	return vb2_mmap(&queue->queue, vma);
361 unsigned long uvc_queue_get_unmapped_area(struct uvc_video_queue *queue,
364 	return vb2_get_unmapped_area(&queue->queue, 0, 0, pgoff, 0);
368 __poll_t uvc_queue_poll(struct uvc_video_queue *queue, struct file *file,
373 	mutex_lock(&queue->mutex);
374 	ret = vb2_poll(&queue->queue, file, wait);
375 	mutex_unlock(&queue->mutex);
387 int uvc_queue_allocated(struct uvc_video_queue *queue)
391 	mutex_lock(&queue->mutex);
392 	allocated = vb2_is_busy(&queue->queue);
393 	mutex_unlock(&queue->mutex);
399  * Cancel the video buffers queue.
401  * Cancelling the queue marks all buffers on the irq queue as erroneous,
402  * wakes them up and removes them from the queue.
410 void uvc_queue_cancel(struct uvc_video_queue *queue, int disconnect)
414 	spin_lock_irqsave(&queue->irqlock, flags);
415 	uvc_queue_return_buffers(queue, UVC_BUF_STATE_ERROR);
421 	 * state outside the queue code.
424 		queue->flags |= UVC_QUEUE_DISCONNECTED;
425 	spin_unlock_irqrestore(&queue->irqlock, flags);
432  * remains on the queue until the EOF marker.
435 __uvc_queue_get_current_buffer(struct uvc_video_queue *queue)
437 	if (list_empty(&queue->irqqueue))
440 	return list_first_entry(&queue->irqqueue, struct uvc_buffer, queue);
443 struct uvc_buffer *uvc_queue_get_current_buffer(struct uvc_video_queue *queue)
448 	spin_lock_irqsave(&queue->irqlock, flags);
449 	nextbuf = __uvc_queue_get_current_buffer(queue);
450 	spin_unlock_irqrestore(&queue->irqlock, flags);
458  * Reuse a buffer through our internal queue without the need to 'prepare'.
462 static void uvc_queue_buffer_requeue(struct uvc_video_queue *queue,
477 	struct uvc_video_queue *queue = vb2_get_drv_priv(vb->vb2_queue);
479 	if ((queue->flags & UVC_QUEUE_DROP_CORRUPTED) && buf->error) {
480 		uvc_queue_buffer_requeue(queue, buf);
499  * Remove this buffer from the queue. Lifetime will persist while async actions
503 struct uvc_buffer *uvc_queue_next_buffer(struct uvc_video_queue *queue,
509 	spin_lock_irqsave(&queue->irqlock, flags);
510 	list_del(&buf->queue);
511 	nextbuf = __uvc_queue_get_current_buffer(queue);
512 	spin_unlock_irqrestore(&queue->irqlock, flags);