Lines Matching full:video
3 * uvc_video.c -- USB Video Class Gadget driver
14 #include <linux/usb/video.h>
24 * Video codecs
28 uvc_video_encode_header(struct uvc_video *video, struct uvc_buffer *buf, in uvc_video_encode_header() argument
31 struct uvc_device *uvc = container_of(video, struct uvc_device, video); in uvc_video_encode_header()
36 data[1] = UVC_STREAM_EOH | video->fid; in uvc_video_encode_header()
38 if (video->queue.flags & UVC_QUEUE_DROP_INCOMPLETE) in uvc_video_encode_header()
41 if (video->queue.buf_used == 0 && ts.tv_sec) { in uvc_video_encode_header()
65 if (buf->bytesused - video->queue.buf_used <= len - pos) in uvc_video_encode_header()
72 uvc_video_encode_data(struct uvc_video *video, struct uvc_buffer *buf, in uvc_video_encode_data() argument
75 struct uvc_video_queue *queue = &video->queue; in uvc_video_encode_data()
79 /* Copy video data to the USB buffer. */ in uvc_video_encode_data()
90 uvc_video_encode_bulk(struct usb_request *req, struct uvc_video *video, in uvc_video_encode_bulk() argument
95 int len = video->req_size; in uvc_video_encode_bulk()
99 if (video->payload_size == 0) { in uvc_video_encode_bulk()
100 ret = uvc_video_encode_header(video, buf, mem, len); in uvc_video_encode_bulk()
101 video->payload_size += ret; in uvc_video_encode_bulk()
106 /* Process video data. */ in uvc_video_encode_bulk()
107 len = min((int)(video->max_payload_size - video->payload_size), len); in uvc_video_encode_bulk()
108 ret = uvc_video_encode_data(video, buf, mem, len); in uvc_video_encode_bulk()
110 video->payload_size += ret; in uvc_video_encode_bulk()
113 req->length = video->req_size - len; in uvc_video_encode_bulk()
114 req->zero = video->payload_size == video->max_payload_size; in uvc_video_encode_bulk()
116 if (buf->bytesused == video->queue.buf_used) { in uvc_video_encode_bulk()
117 video->queue.buf_used = 0; in uvc_video_encode_bulk()
120 video->fid ^= UVC_STREAM_FID; in uvc_video_encode_bulk()
123 video->payload_size = 0; in uvc_video_encode_bulk()
126 if (video->payload_size == video->max_payload_size || in uvc_video_encode_bulk()
127 video->queue.flags & UVC_QUEUE_DROP_INCOMPLETE || in uvc_video_encode_bulk()
128 buf->bytesused == video->queue.buf_used) in uvc_video_encode_bulk()
129 video->payload_size = 0; in uvc_video_encode_bulk()
133 uvc_video_encode_isoc_sg(struct usb_request *req, struct uvc_video *video, in uvc_video_encode_isoc_sg() argument
136 unsigned int pending = buf->bytesused - video->queue.buf_used; in uvc_video_encode_isoc_sg()
139 unsigned int len = video->req_size; in uvc_video_encode_isoc_sg()
148 header_len = uvc_video_encode_header(video, buf, ureq->header, in uvc_video_encode_isoc_sg()
149 video->req_size); in uvc_video_encode_isoc_sg()
157 len + header_len : video->req_size; in uvc_video_encode_isoc_sg()
180 /* Assign the video data with header. */ in uvc_video_encode_isoc_sg()
186 video->queue.buf_used += req->length - header_len; in uvc_video_encode_isoc_sg()
188 if (buf->bytesused == video->queue.buf_used || !buf->sg || in uvc_video_encode_isoc_sg()
189 video->queue.flags & UVC_QUEUE_DROP_INCOMPLETE) { in uvc_video_encode_isoc_sg()
190 video->queue.buf_used = 0; in uvc_video_encode_isoc_sg()
194 video->fid ^= UVC_STREAM_FID; in uvc_video_encode_isoc_sg()
200 uvc_video_encode_isoc(struct usb_request *req, struct uvc_video *video, in uvc_video_encode_isoc() argument
205 int len = video->req_size; in uvc_video_encode_isoc()
209 ret = uvc_video_encode_header(video, buf, mem, len); in uvc_video_encode_isoc()
213 /* Process video data. */ in uvc_video_encode_isoc()
214 ret = uvc_video_encode_data(video, buf, mem, len); in uvc_video_encode_isoc()
217 req->length = video->req_size - len; in uvc_video_encode_isoc()
219 if (buf->bytesused == video->queue.buf_used || in uvc_video_encode_isoc()
220 video->queue.flags & UVC_QUEUE_DROP_INCOMPLETE) { in uvc_video_encode_isoc()
221 video->queue.buf_used = 0; in uvc_video_encode_isoc()
224 video->fid ^= UVC_STREAM_FID; in uvc_video_encode_isoc()
255 static int uvcg_video_ep_queue(struct uvc_video *video, struct usb_request *req) in uvcg_video_ep_queue() argument
259 ret = usb_ep_queue(video->ep, req, GFP_ATOMIC); in uvcg_video_ep_queue()
261 uvcg_err(&video->uvc->func, "Failed to queue request (%d).\n", in uvcg_video_ep_queue()
265 if (video->ep->desc) { in uvcg_video_ep_queue()
267 if (usb_endpoint_xfer_bulk(video->ep->desc)) in uvcg_video_ep_queue()
268 usb_ep_set_halt(video->ep); in uvcg_video_ep_queue()
275 /* This function must be called with video->req_lock held. */
276 static int uvcg_video_usb_req_queue(struct uvc_video *video, in uvcg_video_usb_req_queue() argument
279 bool is_bulk = video->max_payload_size; in uvcg_video_usb_req_queue()
282 if (!video->is_enabled) in uvcg_video_usb_req_queue()
296 * - When this is request is the last request for the video in uvcg_video_usb_req_queue()
297 * buffer, as we want to start sending the next video buffer in uvcg_video_usb_req_queue()
302 * indicated by video->uvc_num_requests), as a trade-off in uvcg_video_usb_req_queue()
305 if (list_empty(&video->req_free) || ureq->last_buf || in uvcg_video_usb_req_queue()
306 !(video->req_int_count % in uvcg_video_usb_req_queue()
307 DIV_ROUND_UP(video->uvc_num_requests, 4))) { in uvcg_video_usb_req_queue()
308 video->req_int_count = 0; in uvcg_video_usb_req_queue()
313 video->req_int_count++; in uvcg_video_usb_req_queue()
314 return uvcg_video_ep_queue(video, req); in uvcg_video_usb_req_queue()
320 list = is_bulk ? &video->req_free : &video->req_ready; in uvcg_video_usb_req_queue()
331 static void uvc_video_ep_queue_initial_requests(struct uvc_video *video) in uvc_video_ep_queue_initial_requests() argument
346 unsigned int half_list_size = video->uvc_num_requests / 2; in uvc_video_ep_queue_initial_requests()
348 spin_lock_irqsave(&video->req_lock, flags); in uvc_video_ep_queue_initial_requests()
355 req = list_first_entry(&video->req_free, struct usb_request, in uvc_video_ep_queue_initial_requests()
359 ret = uvcg_video_ep_queue(video, req); in uvc_video_ep_queue_initial_requests()
361 uvcg_queue_cancel(&video->queue, 0); in uvc_video_ep_queue_initial_requests()
366 spin_unlock_irqrestore(&video->req_lock, flags); in uvc_video_ep_queue_initial_requests()
373 struct uvc_video *video = ureq->video; in uvc_video_complete() local
374 struct uvc_video_queue *queue = &video->queue; in uvc_video_complete()
378 bool is_bulk = video->max_payload_size; in uvc_video_complete()
381 spin_lock_irqsave(&video->req_lock, flags); in uvc_video_complete()
382 if (!video->is_enabled) { in uvc_video_complete()
390 spin_unlock_irqrestore(&video->req_lock, flags); in uvc_video_complete()
396 spin_unlock_irqrestore(&video->req_lock, flags); in uvc_video_complete()
403 uvcg_dbg(&video->uvc->func, "VS request missed xfer.\n"); in uvc_video_complete()
409 uvcg_dbg(&video->uvc->func, "VS request cancelled.\n"); in uvc_video_complete()
414 uvcg_warn(&video->uvc->func, in uvc_video_complete()
426 spin_lock_irqsave(&video->req_lock, flags); in uvc_video_complete()
428 * Video stream might have been disabled while we were in uvc_video_complete()
433 if (!video->is_enabled) { in uvc_video_complete()
435 spin_unlock_irqrestore(&video->req_lock, flags); in uvc_video_complete()
452 if (!list_empty(&video->req_ready)) { in uvc_video_complete()
453 to_queue = list_first_entry(&video->req_ready, in uvc_video_complete()
456 list_add_tail(&req->list, &video->req_free); in uvc_video_complete()
468 queue_work(video->async_wq, &video->pump); in uvc_video_complete()
475 ret = uvcg_video_usb_req_queue(video, to_queue, !is_bulk); in uvc_video_complete()
482 list_add_tail(&to_queue->list, &video->req_free); in uvc_video_complete()
485 spin_unlock_irqrestore(&video->req_lock, flags); in uvc_video_complete()
489 uvc_video_free_requests(struct uvc_video *video) in uvc_video_free_requests() argument
493 list_for_each_entry_safe(ureq, temp, &video->ureqs, list) in uvc_video_free_requests()
494 uvc_video_free_request(ureq, video->ep); in uvc_video_free_requests()
496 INIT_LIST_HEAD(&video->ureqs); in uvc_video_free_requests()
497 INIT_LIST_HEAD(&video->req_free); in uvc_video_free_requests()
498 INIT_LIST_HEAD(&video->req_ready); in uvc_video_free_requests()
499 video->req_size = 0; in uvc_video_free_requests()
504 uvc_video_alloc_requests(struct uvc_video *video) in uvc_video_alloc_requests() argument
511 BUG_ON(video->req_size); in uvc_video_alloc_requests()
513 req_size = video->ep->maxpacket in uvc_video_alloc_requests()
514 * max_t(unsigned int, video->ep->maxburst, 1) in uvc_video_alloc_requests()
515 * (video->ep->mult); in uvc_video_alloc_requests()
517 for (i = 0; i < video->uvc_num_requests; i++) { in uvc_video_alloc_requests()
524 list_add_tail(&ureq->list, &video->ureqs); in uvc_video_alloc_requests()
530 ureq->req = usb_ep_alloc_request(video->ep, GFP_KERNEL); in uvc_video_alloc_requests()
538 ureq->video = video; in uvc_video_alloc_requests()
541 list_add_tail(&ureq->req->list, &video->req_free); in uvc_video_alloc_requests()
548 video->req_size = req_size; in uvc_video_alloc_requests()
553 uvc_video_free_requests(video); in uvc_video_alloc_requests()
558 * Video streaming
562 * uvcg_video_pump - Pump video data into the USB requests
565 * video data from the queued buffers.
569 struct uvc_video *video = container_of(work, struct uvc_video, pump); in uvcg_video_pump() local
570 struct uvc_video_queue *queue = &video->queue; in uvcg_video_pump()
571 /* video->max_payload_size is only set when using bulk transfer */ in uvcg_video_pump()
572 bool is_bulk = video->max_payload_size; in uvcg_video_pump()
579 if (!video->ep->enabled) in uvcg_video_pump()
586 spin_lock_irqsave(&video->req_lock, flags); in uvcg_video_pump()
587 if (!video->is_enabled || list_empty(&video->req_free)) { in uvcg_video_pump()
588 spin_unlock_irqrestore(&video->req_lock, flags); in uvcg_video_pump()
591 req = list_first_entry(&video->req_free, struct usb_request, in uvcg_video_pump()
594 spin_unlock_irqrestore(&video->req_lock, flags); in uvcg_video_pump()
597 * Retrieve the first available video buffer and fill the in uvcg_video_pump()
598 * request, protected by the video queue irqlock. in uvcg_video_pump()
604 * Either the queue has been disconnected or no video buffer in uvcg_video_pump()
612 video->encode(req, video, buf); in uvcg_video_pump()
616 spin_lock_irqsave(&video->req_lock, flags); in uvcg_video_pump()
623 ret = uvcg_video_usb_req_queue(video, req, is_bulk); in uvcg_video_pump()
624 spin_unlock_irqrestore(&video->req_lock, flags); in uvcg_video_pump()
631 spin_lock_irqsave(&video->req_lock, flags); in uvcg_video_pump()
632 if (video->is_enabled) in uvcg_video_pump()
633 list_add_tail(&req->list, &video->req_free); in uvcg_video_pump()
635 uvc_video_free_request(req->context, video->ep); in uvcg_video_pump()
636 spin_unlock_irqrestore(&video->req_lock, flags); in uvcg_video_pump()
640 * Disable the video stream
643 uvcg_video_disable(struct uvc_video *video) in uvcg_video_disable() argument
651 if (video->ep == NULL) { in uvcg_video_disable()
652 uvcg_info(&video->uvc->func, in uvcg_video_disable()
653 "Video disable failed, device is uninitialized.\n"); in uvcg_video_disable()
658 spin_lock_irqsave(&video->req_lock, flags); in uvcg_video_disable()
659 video->is_enabled = false; in uvcg_video_disable()
668 list_for_each_entry(ureq, &video->ureqs, list) { in uvcg_video_disable()
674 spin_unlock_irqrestore(&video->req_lock, flags); in uvcg_video_disable()
676 cancel_work_sync(&video->pump); in uvcg_video_disable()
677 uvcg_queue_cancel(&video->queue, 0); in uvcg_video_disable()
679 spin_lock_irqsave(&video->req_lock, flags); in uvcg_video_disable()
686 list_for_each_entry_safe(ureq, utemp, &video->ureqs, list) in uvcg_video_disable()
689 list_for_each_entry_safe(req, temp, &video->req_free, list) { in uvcg_video_disable()
691 uvc_video_free_request(req->context, video->ep); in uvcg_video_disable()
694 list_for_each_entry_safe(req, temp, &video->req_ready, list) { in uvcg_video_disable()
696 uvc_video_free_request(req->context, video->ep); in uvcg_video_disable()
699 INIT_LIST_HEAD(&video->ureqs); in uvcg_video_disable()
700 INIT_LIST_HEAD(&video->req_free); in uvcg_video_disable()
701 INIT_LIST_HEAD(&video->req_ready); in uvcg_video_disable()
702 video->req_size = 0; in uvcg_video_disable()
703 spin_unlock_irqrestore(&video->req_lock, flags); in uvcg_video_disable()
706 * Return all the video buffers before disabling the queue. in uvcg_video_disable()
708 spin_lock_irqsave(&video->queue.irqlock, flags); in uvcg_video_disable()
711 uvcg_complete_buffer(&video->queue, buf); in uvcg_video_disable()
713 spin_unlock_irqrestore(&video->queue.irqlock, flags); in uvcg_video_disable()
715 uvcg_queue_enable(&video->queue, 0); in uvcg_video_disable()
720 * Enable the video stream.
722 int uvcg_video_enable(struct uvc_video *video) in uvcg_video_enable() argument
726 if (video->ep == NULL) { in uvcg_video_enable()
727 uvcg_info(&video->uvc->func, in uvcg_video_enable()
728 "Video enable failed, device is uninitialized.\n"); in uvcg_video_enable()
738 video->is_enabled = true; in uvcg_video_enable()
740 if ((ret = uvcg_queue_enable(&video->queue, 1)) < 0) in uvcg_video_enable()
743 if ((ret = uvc_video_alloc_requests(video)) < 0) in uvcg_video_enable()
746 if (video->max_payload_size) { in uvcg_video_enable()
747 video->encode = uvc_video_encode_bulk; in uvcg_video_enable()
748 video->payload_size = 0; in uvcg_video_enable()
750 video->encode = video->queue.use_sg ? in uvcg_video_enable()
753 video->req_int_count = 0; in uvcg_video_enable()
755 uvc_video_ep_queue_initial_requests(video); in uvcg_video_enable()
756 queue_work(video->async_wq, &video->pump); in uvcg_video_enable()
762 * Initialize the UVC video stream.
764 int uvcg_video_init(struct uvc_video *video, struct uvc_device *uvc) in uvcg_video_init() argument
766 video->is_enabled = false; in uvcg_video_init()
767 INIT_LIST_HEAD(&video->ureqs); in uvcg_video_init()
768 INIT_LIST_HEAD(&video->req_free); in uvcg_video_init()
769 INIT_LIST_HEAD(&video->req_ready); in uvcg_video_init()
770 spin_lock_init(&video->req_lock); in uvcg_video_init()
771 INIT_WORK(&video->pump, uvcg_video_pump); in uvcg_video_init()
773 /* Allocate a work queue for asynchronous video pump handler. */ in uvcg_video_init()
774 video->async_wq = alloc_workqueue("uvcgadget", WQ_UNBOUND | WQ_HIGHPRI, 0); in uvcg_video_init()
775 if (!video->async_wq) in uvcg_video_init()
778 video->uvc = uvc; in uvcg_video_init()
779 video->fcc = V4L2_PIX_FMT_YUYV; in uvcg_video_init()
780 video->bpp = 16; in uvcg_video_init()
781 video->width = 320; in uvcg_video_init()
782 video->height = 240; in uvcg_video_init()
783 video->imagesize = 320 * 240 * 2; in uvcg_video_init()
785 /* Initialize the video buffers queue. */ in uvcg_video_init()
786 uvcg_queue_init(&video->queue, uvc->v4l2_dev.dev->parent, in uvcg_video_init()
787 V4L2_BUF_TYPE_VIDEO_OUTPUT, &video->mutex); in uvcg_video_init()