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.buf_used == 0 && ts.tv_sec) { in uvc_video_encode_header()
62 if (buf->bytesused - video->queue.buf_used <= len - pos) in uvc_video_encode_header()
69 uvc_video_encode_data(struct uvc_video *video, struct uvc_buffer *buf, in uvc_video_encode_data() argument
72 struct uvc_video_queue *queue = &video->queue; in uvc_video_encode_data()
76 /* Copy video data to the USB buffer. */ in uvc_video_encode_data()
87 uvc_video_encode_bulk(struct usb_request *req, struct uvc_video *video, in uvc_video_encode_bulk() argument
92 int len = video->req_size; in uvc_video_encode_bulk()
96 if (video->payload_size == 0) { in uvc_video_encode_bulk()
97 ret = uvc_video_encode_header(video, buf, mem, len); in uvc_video_encode_bulk()
98 video->payload_size += ret; in uvc_video_encode_bulk()
103 /* Process video data. */ in uvc_video_encode_bulk()
104 len = min((int)(video->max_payload_size - video->payload_size), len); in uvc_video_encode_bulk()
105 ret = uvc_video_encode_data(video, buf, mem, len); in uvc_video_encode_bulk()
107 video->payload_size += ret; in uvc_video_encode_bulk()
110 req->length = video->req_size - len; in uvc_video_encode_bulk()
111 req->zero = video->payload_size == video->max_payload_size; in uvc_video_encode_bulk()
113 if (buf->bytesused == video->queue.buf_used) { in uvc_video_encode_bulk()
114 video->queue.buf_used = 0; in uvc_video_encode_bulk()
117 video->fid ^= UVC_STREAM_FID; in uvc_video_encode_bulk()
120 video->payload_size = 0; in uvc_video_encode_bulk()
123 if (video->payload_size == video->max_payload_size || in uvc_video_encode_bulk()
124 video->queue.flags & UVC_QUEUE_DROP_INCOMPLETE || in uvc_video_encode_bulk()
125 buf->bytesused == video->queue.buf_used) in uvc_video_encode_bulk()
126 video->payload_size = 0; in uvc_video_encode_bulk()
130 uvc_video_encode_isoc_sg(struct usb_request *req, struct uvc_video *video, in uvc_video_encode_isoc_sg() argument
133 unsigned int pending = buf->bytesused - video->queue.buf_used; in uvc_video_encode_isoc_sg()
136 unsigned int len = video->req_size; in uvc_video_encode_isoc_sg()
145 header_len = uvc_video_encode_header(video, buf, ureq->header, in uvc_video_encode_isoc_sg()
146 video->req_size); in uvc_video_encode_isoc_sg()
154 len + header_len : video->req_size; in uvc_video_encode_isoc_sg()
177 /* Assign the video data with header. */ in uvc_video_encode_isoc_sg()
183 video->queue.buf_used += req->length - header_len; in uvc_video_encode_isoc_sg()
185 if (buf->bytesused == video->queue.buf_used || !buf->sg || in uvc_video_encode_isoc_sg()
186 video->queue.flags & UVC_QUEUE_DROP_INCOMPLETE) { in uvc_video_encode_isoc_sg()
187 video->queue.buf_used = 0; in uvc_video_encode_isoc_sg()
191 video->fid ^= UVC_STREAM_FID; in uvc_video_encode_isoc_sg()
197 uvc_video_encode_isoc(struct usb_request *req, struct uvc_video *video, in uvc_video_encode_isoc() argument
202 int len = video->req_size; in uvc_video_encode_isoc()
206 ret = uvc_video_encode_header(video, buf, mem, len); in uvc_video_encode_isoc()
210 /* Process video data. */ in uvc_video_encode_isoc()
211 ret = uvc_video_encode_data(video, buf, mem, len); in uvc_video_encode_isoc()
214 req->length = video->req_size - len; in uvc_video_encode_isoc()
216 if (buf->bytesused == video->queue.buf_used || in uvc_video_encode_isoc()
217 video->queue.flags & UVC_QUEUE_DROP_INCOMPLETE) { in uvc_video_encode_isoc()
218 video->queue.buf_used = 0; in uvc_video_encode_isoc()
221 video->fid ^= UVC_STREAM_FID; in uvc_video_encode_isoc()
252 static int uvcg_video_ep_queue(struct uvc_video *video, struct usb_request *req) in uvcg_video_ep_queue() argument
256 ret = usb_ep_queue(video->ep, req, GFP_ATOMIC); in uvcg_video_ep_queue()
258 uvcg_err(&video->uvc->func, "Failed to queue request (%d).\n", in uvcg_video_ep_queue()
262 if (video->ep->desc) { in uvcg_video_ep_queue()
264 if (usb_endpoint_xfer_bulk(video->ep->desc)) in uvcg_video_ep_queue()
265 usb_ep_set_halt(video->ep); in uvcg_video_ep_queue()
272 /* This function must be called with video->req_lock held. */
273 static int uvcg_video_usb_req_queue(struct uvc_video *video, in uvcg_video_usb_req_queue() argument
276 bool is_bulk = video->max_payload_size; in uvcg_video_usb_req_queue()
279 if (!video->is_enabled) in uvcg_video_usb_req_queue()
293 * - When this is request is the last request for the video in uvcg_video_usb_req_queue()
294 * buffer, as we want to start sending the next video buffer in uvcg_video_usb_req_queue()
299 * indicated by video->uvc_num_requests), as a trade-off in uvcg_video_usb_req_queue()
302 if (list_empty(&video->req_free) || ureq->last_buf || in uvcg_video_usb_req_queue()
303 !(video->req_int_count % in uvcg_video_usb_req_queue()
304 DIV_ROUND_UP(video->uvc_num_requests, 4))) { in uvcg_video_usb_req_queue()
305 video->req_int_count = 0; in uvcg_video_usb_req_queue()
310 video->req_int_count++; in uvcg_video_usb_req_queue()
311 return uvcg_video_ep_queue(video, req); in uvcg_video_usb_req_queue()
317 list = is_bulk ? &video->req_free : &video->req_ready; in uvcg_video_usb_req_queue()
328 static void uvc_video_ep_queue_initial_requests(struct uvc_video *video) in uvc_video_ep_queue_initial_requests() argument
343 unsigned int half_list_size = video->uvc_num_requests / 2; in uvc_video_ep_queue_initial_requests()
345 spin_lock_irqsave(&video->req_lock, flags); in uvc_video_ep_queue_initial_requests()
352 req = list_first_entry(&video->req_free, struct usb_request, in uvc_video_ep_queue_initial_requests()
356 ret = uvcg_video_ep_queue(video, req); in uvc_video_ep_queue_initial_requests()
358 uvcg_queue_cancel(&video->queue, 0); in uvc_video_ep_queue_initial_requests()
363 spin_unlock_irqrestore(&video->req_lock, flags); in uvc_video_ep_queue_initial_requests()
370 struct uvc_video *video = ureq->video; in uvc_video_complete() local
371 struct uvc_video_queue *queue = &video->queue; in uvc_video_complete()
374 bool is_bulk = video->max_payload_size; in uvc_video_complete()
377 spin_lock_irqsave(&video->req_lock, flags); in uvc_video_complete()
378 if (!video->is_enabled) { in uvc_video_complete()
386 spin_unlock_irqrestore(&video->req_lock, flags); in uvc_video_complete()
392 spin_unlock_irqrestore(&video->req_lock, flags); in uvc_video_complete()
399 uvcg_dbg(&video->uvc->func, "VS request missed xfer.\n"); in uvc_video_complete()
404 uvcg_dbg(&video->uvc->func, "VS request cancelled.\n"); in uvc_video_complete()
409 uvcg_warn(&video->uvc->func, in uvc_video_complete()
421 spin_lock_irqsave(&video->req_lock, flags); in uvc_video_complete()
423 * Video stream might have been disabled while we were in uvc_video_complete()
428 if (video->is_enabled) { in uvc_video_complete()
442 if (!list_empty(&video->req_ready)) { in uvc_video_complete()
443 to_queue = list_first_entry(&video->req_ready, in uvc_video_complete()
446 list_add_tail(&req->list, &video->req_free); in uvc_video_complete()
458 queue_work(video->async_wq, &video->pump); in uvc_video_complete()
465 ret = uvcg_video_usb_req_queue(video, to_queue, !is_bulk); in uvc_video_complete()
472 list_add_tail(&to_queue->list, &video->req_free); in uvc_video_complete()
478 spin_unlock_irqrestore(&video->req_lock, flags); in uvc_video_complete()
484 uvc_video_free_requests(struct uvc_video *video) in uvc_video_free_requests() argument
488 list_for_each_entry_safe(ureq, temp, &video->ureqs, list) in uvc_video_free_requests()
489 uvc_video_free_request(ureq, video->ep); in uvc_video_free_requests()
491 INIT_LIST_HEAD(&video->ureqs); in uvc_video_free_requests()
492 INIT_LIST_HEAD(&video->req_free); in uvc_video_free_requests()
493 INIT_LIST_HEAD(&video->req_ready); in uvc_video_free_requests()
494 video->req_size = 0; in uvc_video_free_requests()
499 uvc_video_alloc_requests(struct uvc_video *video) in uvc_video_alloc_requests() argument
506 BUG_ON(video->req_size); in uvc_video_alloc_requests()
508 req_size = video->ep->maxpacket in uvc_video_alloc_requests()
509 * max_t(unsigned int, video->ep->maxburst, 1) in uvc_video_alloc_requests()
510 * (video->ep->mult); in uvc_video_alloc_requests()
512 for (i = 0; i < video->uvc_num_requests; i++) { in uvc_video_alloc_requests()
519 list_add_tail(&ureq->list, &video->ureqs); in uvc_video_alloc_requests()
525 ureq->req = usb_ep_alloc_request(video->ep, GFP_KERNEL); in uvc_video_alloc_requests()
533 ureq->video = video; in uvc_video_alloc_requests()
536 list_add_tail(&ureq->req->list, &video->req_free); in uvc_video_alloc_requests()
543 video->req_size = req_size; in uvc_video_alloc_requests()
548 uvc_video_free_requests(video); in uvc_video_alloc_requests()
553 * Video streaming
557 * uvcg_video_pump - Pump video data into the USB requests
560 * video data from the queued buffers.
564 struct uvc_video *video = container_of(work, struct uvc_video, pump); in uvcg_video_pump() local
565 struct uvc_video_queue *queue = &video->queue; in uvcg_video_pump()
566 /* video->max_payload_size is only set when using bulk transfer */ in uvcg_video_pump()
567 bool is_bulk = video->max_payload_size; in uvcg_video_pump()
574 if (!video->ep->enabled) in uvcg_video_pump()
581 spin_lock_irqsave(&video->req_lock, flags); in uvcg_video_pump()
582 if (!video->is_enabled || list_empty(&video->req_free)) { in uvcg_video_pump()
583 spin_unlock_irqrestore(&video->req_lock, flags); in uvcg_video_pump()
586 req = list_first_entry(&video->req_free, struct usb_request, in uvcg_video_pump()
589 spin_unlock_irqrestore(&video->req_lock, flags); in uvcg_video_pump()
592 * Retrieve the first available video buffer and fill the in uvcg_video_pump()
593 * request, protected by the video queue irqlock. in uvcg_video_pump()
599 video->encode(req, video, buf); in uvcg_video_pump()
602 * Either the queue has been disconnected or no video buffer in uvcg_video_pump()
612 spin_lock_irqsave(&video->req_lock, flags); in uvcg_video_pump()
619 ret = uvcg_video_usb_req_queue(video, req, is_bulk); in uvcg_video_pump()
620 spin_unlock_irqrestore(&video->req_lock, flags); in uvcg_video_pump()
634 spin_lock_irqsave(&video->req_lock, flags); in uvcg_video_pump()
635 if (video->is_enabled) in uvcg_video_pump()
636 list_add_tail(&req->list, &video->req_free); in uvcg_video_pump()
638 uvc_video_free_request(req->context, video->ep); in uvcg_video_pump()
639 spin_unlock_irqrestore(&video->req_lock, flags); in uvcg_video_pump()
643 * Disable the video stream
646 uvcg_video_disable(struct uvc_video *video) in uvcg_video_disable() argument
654 if (video->ep == NULL) { in uvcg_video_disable()
655 uvcg_info(&video->uvc->func, in uvcg_video_disable()
656 "Video disable failed, device is uninitialized.\n"); in uvcg_video_disable()
661 spin_lock_irqsave(&video->req_lock, flags); in uvcg_video_disable()
662 video->is_enabled = false; in uvcg_video_disable()
671 list_for_each_entry(ureq, &video->ureqs, list) { in uvcg_video_disable()
677 spin_unlock_irqrestore(&video->req_lock, flags); in uvcg_video_disable()
679 cancel_work_sync(&video->pump); in uvcg_video_disable()
680 uvcg_queue_cancel(&video->queue, 0); in uvcg_video_disable()
682 spin_lock_irqsave(&video->req_lock, flags); in uvcg_video_disable()
689 list_for_each_entry_safe(ureq, utemp, &video->ureqs, list) in uvcg_video_disable()
692 list_for_each_entry_safe(req, temp, &video->req_free, list) { in uvcg_video_disable()
694 uvc_video_free_request(req->context, video->ep); in uvcg_video_disable()
697 list_for_each_entry_safe(req, temp, &video->req_ready, list) { in uvcg_video_disable()
699 uvc_video_free_request(req->context, video->ep); in uvcg_video_disable()
702 INIT_LIST_HEAD(&video->ureqs); in uvcg_video_disable()
703 INIT_LIST_HEAD(&video->req_free); in uvcg_video_disable()
704 INIT_LIST_HEAD(&video->req_ready); in uvcg_video_disable()
705 video->req_size = 0; in uvcg_video_disable()
706 spin_unlock_irqrestore(&video->req_lock, flags); in uvcg_video_disable()
709 * Return all the video buffers before disabling the queue. in uvcg_video_disable()
711 spin_lock_irqsave(&video->queue.irqlock, flags); in uvcg_video_disable()
714 uvcg_complete_buffer(&video->queue, buf); in uvcg_video_disable()
716 spin_unlock_irqrestore(&video->queue.irqlock, flags); in uvcg_video_disable()
718 uvcg_queue_enable(&video->queue, 0); in uvcg_video_disable()
723 * Enable the video stream.
725 int uvcg_video_enable(struct uvc_video *video) in uvcg_video_enable() argument
729 if (video->ep == NULL) { in uvcg_video_enable()
730 uvcg_info(&video->uvc->func, in uvcg_video_enable()
731 "Video enable failed, device is uninitialized.\n"); in uvcg_video_enable()
741 video->is_enabled = true; in uvcg_video_enable()
743 if ((ret = uvcg_queue_enable(&video->queue, 1)) < 0) in uvcg_video_enable()
746 if ((ret = uvc_video_alloc_requests(video)) < 0) in uvcg_video_enable()
749 if (video->max_payload_size) { in uvcg_video_enable()
750 video->encode = uvc_video_encode_bulk; in uvcg_video_enable()
751 video->payload_size = 0; in uvcg_video_enable()
753 video->encode = video->queue.use_sg ? in uvcg_video_enable()
756 video->req_int_count = 0; in uvcg_video_enable()
758 uvc_video_ep_queue_initial_requests(video); in uvcg_video_enable()
764 * Initialize the UVC video stream.
766 int uvcg_video_init(struct uvc_video *video, struct uvc_device *uvc) in uvcg_video_init() argument
768 video->is_enabled = false; in uvcg_video_init()
769 INIT_LIST_HEAD(&video->ureqs); in uvcg_video_init()
770 INIT_LIST_HEAD(&video->req_free); in uvcg_video_init()
771 INIT_LIST_HEAD(&video->req_ready); in uvcg_video_init()
772 spin_lock_init(&video->req_lock); in uvcg_video_init()
773 INIT_WORK(&video->pump, uvcg_video_pump); in uvcg_video_init()
775 /* Allocate a work queue for asynchronous video pump handler. */ in uvcg_video_init()
776 video->async_wq = alloc_workqueue("uvcgadget", WQ_UNBOUND | WQ_HIGHPRI, 0); in uvcg_video_init()
777 if (!video->async_wq) in uvcg_video_init()
780 video->uvc = uvc; in uvcg_video_init()
781 video->fcc = V4L2_PIX_FMT_YUYV; in uvcg_video_init()
782 video->bpp = 16; in uvcg_video_init()
783 video->width = 320; in uvcg_video_init()
784 video->height = 240; in uvcg_video_init()
785 video->imagesize = 320 * 240 * 2; in uvcg_video_init()
787 /* Initialize the video buffers queue. */ in uvcg_video_init()
788 uvcg_queue_init(&video->queue, uvc->v4l2_dev.dev->parent, in uvcg_video_init()
789 V4L2_BUF_TYPE_VIDEO_OUTPUT, &video->mutex); in uvcg_video_init()