mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-18 09:16:55 +07:00
V4L/DVB (8145a): USB Video Class driver
This driver supports video input devices compliant with the USB Video Class specification. This means lots of currently manufactured webcams, and probably most of the future ones. Signed-off-by: Laurent Pinchart <laurent.pinchart@skynet.be> Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
This commit is contained in:
parent
e1441b9a41
commit
c0efd23292
@ -4314,6 +4314,14 @@ L: netdev@vger.kernel.org
|
||||
W: http://www.linux-usb.org/usbnet
|
||||
S: Maintained
|
||||
|
||||
USB VIDEO CLASS
|
||||
P: Laurent Pinchart
|
||||
M: laurent.pinchart@skynet.be
|
||||
L: linx-uvc-devel@berlios.de
|
||||
L: video4linux-list@redhat.com
|
||||
W: http://linux-uvc.berlios.de
|
||||
S: Maintained
|
||||
|
||||
USB W996[87]CF DRIVER
|
||||
P: Luca Risolia
|
||||
M: luca.risolia@studio.unibo.it
|
||||
|
@ -793,6 +793,14 @@ menuconfig V4L_USB_DRIVERS
|
||||
|
||||
if V4L_USB_DRIVERS && USB
|
||||
|
||||
config USB_VIDEO_CLASS
|
||||
tristate "USB Video Class (UVC)"
|
||||
---help---
|
||||
Support for the USB Video Class (UVC). Currently only video
|
||||
input devices, such as webcams, are supported.
|
||||
|
||||
For more information see: <http://linux-uvc.berlios.de/>
|
||||
|
||||
source "drivers/media/video/pvrusb2/Kconfig"
|
||||
|
||||
source "drivers/media/video/em28xx/Kconfig"
|
||||
|
@ -136,6 +136,8 @@ obj-$(CONFIG_SOC_CAMERA_MT9V022) += mt9v022.o
|
||||
|
||||
obj-$(CONFIG_VIDEO_AU0828) += au0828/
|
||||
|
||||
obj-$(CONFIG_USB_VIDEO_CLASS) += uvc/
|
||||
|
||||
EXTRA_CFLAGS += -Idrivers/media/dvb/dvb-core
|
||||
EXTRA_CFLAGS += -Idrivers/media/dvb/frontends
|
||||
EXTRA_CFLAGS += -Idrivers/media/common/tuners
|
||||
|
3
drivers/media/video/uvc/Makefile
Normal file
3
drivers/media/video/uvc/Makefile
Normal file
@ -0,0 +1,3 @@
|
||||
uvcvideo-objs := uvc_driver.o uvc_queue.o uvc_v4l2.o uvc_video.o uvc_ctrl.o \
|
||||
uvc_status.o uvc_isight.o
|
||||
obj-$(CONFIG_USB_VIDEO_CLASS) := uvcvideo.o
|
1256
drivers/media/video/uvc/uvc_ctrl.c
Normal file
1256
drivers/media/video/uvc/uvc_ctrl.c
Normal file
File diff suppressed because it is too large
Load Diff
1955
drivers/media/video/uvc/uvc_driver.c
Normal file
1955
drivers/media/video/uvc/uvc_driver.c
Normal file
File diff suppressed because it is too large
Load Diff
134
drivers/media/video/uvc/uvc_isight.c
Normal file
134
drivers/media/video/uvc/uvc_isight.c
Normal file
@ -0,0 +1,134 @@
|
||||
/*
|
||||
* uvc_isight.c -- USB Video Class driver - iSight support
|
||||
*
|
||||
* Copyright (C) 2006-2007
|
||||
* Ivan N. Zlatev <contact@i-nz.net>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/usb.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/mm.h>
|
||||
|
||||
#include "uvcvideo.h"
|
||||
|
||||
/* Built-in iSight webcams implements most of UVC 1.0 except a
|
||||
* different packet format. Instead of sending a header at the
|
||||
* beginning of each isochronous transfer payload, the webcam sends a
|
||||
* single header per image (on its own in a packet), followed by
|
||||
* packets containing data only.
|
||||
*
|
||||
* Offset Size (bytes) Description
|
||||
* ------------------------------------------------------------------
|
||||
* 0x00 1 Header length
|
||||
* 0x01 1 Flags (UVC-compliant)
|
||||
* 0x02 4 Always equal to '11223344'
|
||||
* 0x06 8 Always equal to 'deadbeefdeadface'
|
||||
* 0x0e 16 Unknown
|
||||
*
|
||||
* The header can be prefixed by an optional, unknown-purpose byte.
|
||||
*/
|
||||
|
||||
static int isight_decode(struct uvc_video_queue *queue, struct uvc_buffer *buf,
|
||||
const __u8 *data, unsigned int len)
|
||||
{
|
||||
static const __u8 hdr[] = {
|
||||
0x11, 0x22, 0x33, 0x44,
|
||||
0xde, 0xad, 0xbe, 0xef,
|
||||
0xde, 0xad, 0xfa, 0xce
|
||||
};
|
||||
|
||||
unsigned int maxlen, nbytes;
|
||||
__u8 *mem;
|
||||
int is_header = 0;
|
||||
|
||||
if (buf == NULL)
|
||||
return 0;
|
||||
|
||||
if ((len >= 14 && memcmp(&data[2], hdr, 12) == 0) ||
|
||||
(len >= 15 && memcmp(&data[3], hdr, 12) == 0)) {
|
||||
uvc_trace(UVC_TRACE_FRAME, "iSight header found\n");
|
||||
is_header = 1;
|
||||
}
|
||||
|
||||
/* Synchronize to the input stream by waiting for a header packet. */
|
||||
if (buf->state != UVC_BUF_STATE_ACTIVE) {
|
||||
if (!is_header) {
|
||||
uvc_trace(UVC_TRACE_FRAME, "Dropping packet (out of "
|
||||
"sync).\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
buf->state = UVC_BUF_STATE_ACTIVE;
|
||||
}
|
||||
|
||||
/* Mark the buffer as done if we're at the beginning of a new frame.
|
||||
*
|
||||
* Empty buffers (bytesused == 0) don't trigger end of frame detection
|
||||
* as it doesn't make sense to return an empty buffer.
|
||||
*/
|
||||
if (is_header && buf->buf.bytesused != 0) {
|
||||
buf->state = UVC_BUF_STATE_DONE;
|
||||
return -EAGAIN;
|
||||
}
|
||||
|
||||
/* Copy the video data to the buffer. Skip header packets, as they
|
||||
* contain no data.
|
||||
*/
|
||||
if (!is_header) {
|
||||
maxlen = buf->buf.length - buf->buf.bytesused;
|
||||
mem = queue->mem + buf->buf.m.offset + buf->buf.bytesused;
|
||||
nbytes = min(len, maxlen);
|
||||
memcpy(mem, data, nbytes);
|
||||
buf->buf.bytesused += nbytes;
|
||||
|
||||
if (len > maxlen || buf->buf.bytesused == buf->buf.length) {
|
||||
uvc_trace(UVC_TRACE_FRAME, "Frame complete "
|
||||
"(overflow).\n");
|
||||
buf->state = UVC_BUF_STATE_DONE;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void uvc_video_decode_isight(struct urb *urb, struct uvc_video_device *video,
|
||||
struct uvc_buffer *buf)
|
||||
{
|
||||
int ret, i;
|
||||
|
||||
for (i = 0; i < urb->number_of_packets; ++i) {
|
||||
if (urb->iso_frame_desc[i].status < 0) {
|
||||
uvc_trace(UVC_TRACE_FRAME, "USB isochronous frame "
|
||||
"lost (%d).\n",
|
||||
urb->iso_frame_desc[i].status);
|
||||
}
|
||||
|
||||
/* Decode the payload packet.
|
||||
* uvc_video_decode is entered twice when a frame transition
|
||||
* has been detected because the end of frame can only be
|
||||
* reliably detected when the first packet of the new frame
|
||||
* is processed. The first pass detects the transition and
|
||||
* closes the previous frame's buffer, the second pass
|
||||
* processes the data of the first payload of the new frame.
|
||||
*/
|
||||
do {
|
||||
ret = isight_decode(&video->queue, buf,
|
||||
urb->transfer_buffer +
|
||||
urb->iso_frame_desc[i].offset,
|
||||
urb->iso_frame_desc[i].actual_length);
|
||||
|
||||
if (buf == NULL)
|
||||
break;
|
||||
|
||||
if (buf->state == UVC_BUF_STATE_DONE ||
|
||||
buf->state == UVC_BUF_STATE_ERROR)
|
||||
buf = uvc_queue_next_buffer(&video->queue, buf);
|
||||
} while (ret == -EAGAIN);
|
||||
}
|
||||
}
|
477
drivers/media/video/uvc/uvc_queue.c
Normal file
477
drivers/media/video/uvc/uvc_queue.c
Normal file
@ -0,0 +1,477 @@
|
||||
/*
|
||||
* uvc_queue.c -- USB Video Class driver - Buffers management
|
||||
*
|
||||
* Copyright (C) 2005-2008
|
||||
* Laurent Pinchart (laurent.pinchart@skynet.be)
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/version.h>
|
||||
#include <linux/list.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/usb.h>
|
||||
#include <linux/videodev2.h>
|
||||
#include <linux/vmalloc.h>
|
||||
#include <linux/wait.h>
|
||||
#include <asm/atomic.h>
|
||||
|
||||
#include "uvcvideo.h"
|
||||
|
||||
/* ------------------------------------------------------------------------
|
||||
* Video buffers queue management.
|
||||
*
|
||||
* Video queues is initialized by uvc_queue_init(). The function performs
|
||||
* basic initialization of the uvc_video_queue struct and never fails.
|
||||
*
|
||||
* Video buffer allocation and freeing are performed by uvc_alloc_buffers and
|
||||
* uvc_free_buffers respectively. The former acquires the video queue lock,
|
||||
* while the later must be called with the lock held (so that allocation can
|
||||
* free previously allocated buffers). Trying to free buffers that are mapped
|
||||
* to user space will return -EBUSY.
|
||||
*
|
||||
* Video buffers are managed using two queues. However, unlike most USB video
|
||||
* drivers which use an in queue and an out queue, we use a main queue which
|
||||
* holds all queued buffers (both 'empty' and 'done' buffers), and an irq
|
||||
* queue which holds empty buffers. This design (copied from video-buf)
|
||||
* minimizes locking in interrupt, as only one queue is shared between
|
||||
* interrupt and user contexts.
|
||||
*
|
||||
* Use cases
|
||||
* ---------
|
||||
*
|
||||
* Unless stated otherwise, all operations which modify the irq buffers queue
|
||||
* are protected by the irq spinlock.
|
||||
*
|
||||
* 1. The user queues the buffers, starts streaming and dequeues a buffer.
|
||||
*
|
||||
* The buffers are added to the main and irq queues. Both operations are
|
||||
* protected by the queue lock, and the latert is protected by the irq
|
||||
* spinlock as well.
|
||||
*
|
||||
* The completion handler fetches a buffer from the irq queue and fills it
|
||||
* with video data. If no buffer is available (irq queue empty), the handler
|
||||
* returns immediately.
|
||||
*
|
||||
* When the buffer is full, the completion handler removes it from the irq
|
||||
* queue, marks it as ready (UVC_BUF_STATE_DONE) and wake its wait queue.
|
||||
* At that point, any process waiting on the buffer will be woken up. If a
|
||||
* process tries to dequeue a buffer after it has been marked ready, the
|
||||
* dequeing will succeed immediately.
|
||||
*
|
||||
* 2. Buffers are queued, user is waiting on a buffer and the device gets
|
||||
* disconnected.
|
||||
*
|
||||
* When the device is disconnected, the kernel calls the completion handler
|
||||
* with an appropriate status code. The handler marks all buffers in the
|
||||
* irq queue as being erroneous (UVC_BUF_STATE_ERROR) and wakes them up so
|
||||
* that any process waiting on a buffer gets woken up.
|
||||
*
|
||||
* Waking up up the first buffer on the irq list is not enough, as the
|
||||
* process waiting on the buffer might restart the dequeue operation
|
||||
* immediately.
|
||||
*
|
||||
*/
|
||||
|
||||
void uvc_queue_init(struct uvc_video_queue *queue)
|
||||
{
|
||||
mutex_init(&queue->mutex);
|
||||
spin_lock_init(&queue->irqlock);
|
||||
INIT_LIST_HEAD(&queue->mainqueue);
|
||||
INIT_LIST_HEAD(&queue->irqqueue);
|
||||
}
|
||||
|
||||
/*
|
||||
* Allocate the video buffers.
|
||||
*
|
||||
* Pages are reserved to make sure they will not be swaped, as they will be
|
||||
* filled in URB completion handler.
|
||||
*
|
||||
* Buffers will be individually mapped, so they must all be page aligned.
|
||||
*/
|
||||
int uvc_alloc_buffers(struct uvc_video_queue *queue, unsigned int nbuffers,
|
||||
unsigned int buflength)
|
||||
{
|
||||
unsigned int bufsize = PAGE_ALIGN(buflength);
|
||||
unsigned int i;
|
||||
void *mem = NULL;
|
||||
int ret;
|
||||
|
||||
if (nbuffers > UVC_MAX_VIDEO_BUFFERS)
|
||||
nbuffers = UVC_MAX_VIDEO_BUFFERS;
|
||||
|
||||
mutex_lock(&queue->mutex);
|
||||
|
||||
if ((ret = uvc_free_buffers(queue)) < 0)
|
||||
goto done;
|
||||
|
||||
/* Bail out if no buffers should be allocated. */
|
||||
if (nbuffers == 0)
|
||||
goto done;
|
||||
|
||||
/* Decrement the number of buffers until allocation succeeds. */
|
||||
for (; nbuffers > 0; --nbuffers) {
|
||||
mem = vmalloc_32(nbuffers * bufsize);
|
||||
if (mem != NULL)
|
||||
break;
|
||||
}
|
||||
|
||||
if (mem == NULL) {
|
||||
ret = -ENOMEM;
|
||||
goto done;
|
||||
}
|
||||
|
||||
for (i = 0; i < nbuffers; ++i) {
|
||||
memset(&queue->buffer[i], 0, sizeof queue->buffer[i]);
|
||||
queue->buffer[i].buf.index = i;
|
||||
queue->buffer[i].buf.m.offset = i * bufsize;
|
||||
queue->buffer[i].buf.length = buflength;
|
||||
queue->buffer[i].buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
|
||||
queue->buffer[i].buf.sequence = 0;
|
||||
queue->buffer[i].buf.field = V4L2_FIELD_NONE;
|
||||
queue->buffer[i].buf.memory = V4L2_MEMORY_MMAP;
|
||||
queue->buffer[i].buf.flags = 0;
|
||||
init_waitqueue_head(&queue->buffer[i].wait);
|
||||
}
|
||||
|
||||
queue->mem = mem;
|
||||
queue->count = nbuffers;
|
||||
queue->buf_size = bufsize;
|
||||
ret = nbuffers;
|
||||
|
||||
done:
|
||||
mutex_unlock(&queue->mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* Free the video buffers.
|
||||
*
|
||||
* This function must be called with the queue lock held.
|
||||
*/
|
||||
int uvc_free_buffers(struct uvc_video_queue *queue)
|
||||
{
|
||||
unsigned int i;
|
||||
|
||||
for (i = 0; i < queue->count; ++i) {
|
||||
if (queue->buffer[i].vma_use_count != 0)
|
||||
return -EBUSY;
|
||||
}
|
||||
|
||||
if (queue->count) {
|
||||
vfree(queue->mem);
|
||||
queue->count = 0;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void __uvc_query_buffer(struct uvc_buffer *buf,
|
||||
struct v4l2_buffer *v4l2_buf)
|
||||
{
|
||||
memcpy(v4l2_buf, &buf->buf, sizeof *v4l2_buf);
|
||||
|
||||
if (buf->vma_use_count)
|
||||
v4l2_buf->flags |= V4L2_BUF_FLAG_MAPPED;
|
||||
|
||||
switch (buf->state) {
|
||||
case UVC_BUF_STATE_ERROR:
|
||||
case UVC_BUF_STATE_DONE:
|
||||
v4l2_buf->flags |= V4L2_BUF_FLAG_DONE;
|
||||
break;
|
||||
case UVC_BUF_STATE_QUEUED:
|
||||
case UVC_BUF_STATE_ACTIVE:
|
||||
v4l2_buf->flags |= V4L2_BUF_FLAG_QUEUED;
|
||||
break;
|
||||
case UVC_BUF_STATE_IDLE:
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
int uvc_query_buffer(struct uvc_video_queue *queue,
|
||||
struct v4l2_buffer *v4l2_buf)
|
||||
{
|
||||
int ret = 0;
|
||||
|
||||
mutex_lock(&queue->mutex);
|
||||
if (v4l2_buf->index >= queue->count) {
|
||||
ret = -EINVAL;
|
||||
goto done;
|
||||
}
|
||||
|
||||
__uvc_query_buffer(&queue->buffer[v4l2_buf->index], v4l2_buf);
|
||||
|
||||
done:
|
||||
mutex_unlock(&queue->mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* Queue a video buffer. Attempting to queue a buffer that has already been
|
||||
* queued will return -EINVAL.
|
||||
*/
|
||||
int uvc_queue_buffer(struct uvc_video_queue *queue,
|
||||
struct v4l2_buffer *v4l2_buf)
|
||||
{
|
||||
struct uvc_buffer *buf;
|
||||
unsigned long flags;
|
||||
int ret = 0;
|
||||
|
||||
uvc_trace(UVC_TRACE_CAPTURE, "Queuing buffer %u.\n", v4l2_buf->index);
|
||||
|
||||
if (v4l2_buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE ||
|
||||
v4l2_buf->memory != V4L2_MEMORY_MMAP) {
|
||||
uvc_trace(UVC_TRACE_CAPTURE, "[E] Invalid buffer type (%u) "
|
||||
"and/or memory (%u).\n", v4l2_buf->type,
|
||||
v4l2_buf->memory);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
mutex_lock(&queue->mutex);
|
||||
if (v4l2_buf->index >= queue->count) {
|
||||
uvc_trace(UVC_TRACE_CAPTURE, "[E] Out of range index.\n");
|
||||
ret = -EINVAL;
|
||||
goto done;
|
||||
}
|
||||
|
||||
buf = &queue->buffer[v4l2_buf->index];
|
||||
if (buf->state != UVC_BUF_STATE_IDLE) {
|
||||
uvc_trace(UVC_TRACE_CAPTURE, "[E] Invalid buffer state "
|
||||
"(%u).\n", buf->state);
|
||||
ret = -EINVAL;
|
||||
goto done;
|
||||
}
|
||||
|
||||
spin_lock_irqsave(&queue->irqlock, flags);
|
||||
if (queue->flags & UVC_QUEUE_DISCONNECTED) {
|
||||
spin_unlock_irqrestore(&queue->irqlock, flags);
|
||||
ret = -ENODEV;
|
||||
goto done;
|
||||
}
|
||||
buf->state = UVC_BUF_STATE_QUEUED;
|
||||
buf->buf.bytesused = 0;
|
||||
list_add_tail(&buf->stream, &queue->mainqueue);
|
||||
list_add_tail(&buf->queue, &queue->irqqueue);
|
||||
spin_unlock_irqrestore(&queue->irqlock, flags);
|
||||
|
||||
done:
|
||||
mutex_unlock(&queue->mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int uvc_queue_waiton(struct uvc_buffer *buf, int nonblocking)
|
||||
{
|
||||
if (nonblocking) {
|
||||
return (buf->state != UVC_BUF_STATE_QUEUED &&
|
||||
buf->state != UVC_BUF_STATE_ACTIVE)
|
||||
? 0 : -EAGAIN;
|
||||
}
|
||||
|
||||
return wait_event_interruptible(buf->wait,
|
||||
buf->state != UVC_BUF_STATE_QUEUED &&
|
||||
buf->state != UVC_BUF_STATE_ACTIVE);
|
||||
}
|
||||
|
||||
/*
|
||||
* Dequeue a video buffer. If nonblocking is false, block until a buffer is
|
||||
* available.
|
||||
*/
|
||||
int uvc_dequeue_buffer(struct uvc_video_queue *queue,
|
||||
struct v4l2_buffer *v4l2_buf, int nonblocking)
|
||||
{
|
||||
struct uvc_buffer *buf;
|
||||
int ret = 0;
|
||||
|
||||
if (v4l2_buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE ||
|
||||
v4l2_buf->memory != V4L2_MEMORY_MMAP) {
|
||||
uvc_trace(UVC_TRACE_CAPTURE, "[E] Invalid buffer type (%u) "
|
||||
"and/or memory (%u).\n", v4l2_buf->type,
|
||||
v4l2_buf->memory);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
mutex_lock(&queue->mutex);
|
||||
if (list_empty(&queue->mainqueue)) {
|
||||
uvc_trace(UVC_TRACE_CAPTURE, "[E] Empty buffer queue.\n");
|
||||
ret = -EINVAL;
|
||||
goto done;
|
||||
}
|
||||
|
||||
buf = list_first_entry(&queue->mainqueue, struct uvc_buffer, stream);
|
||||
if ((ret = uvc_queue_waiton(buf, nonblocking)) < 0)
|
||||
goto done;
|
||||
|
||||
uvc_trace(UVC_TRACE_CAPTURE, "Dequeuing buffer %u (%u, %u bytes).\n",
|
||||
buf->buf.index, buf->state, buf->buf.bytesused);
|
||||
|
||||
switch (buf->state) {
|
||||
case UVC_BUF_STATE_ERROR:
|
||||
uvc_trace(UVC_TRACE_CAPTURE, "[W] Corrupted data "
|
||||
"(transmission error).\n");
|
||||
ret = -EIO;
|
||||
case UVC_BUF_STATE_DONE:
|
||||
buf->state = UVC_BUF_STATE_IDLE;
|
||||
break;
|
||||
|
||||
case UVC_BUF_STATE_IDLE:
|
||||
case UVC_BUF_STATE_QUEUED:
|
||||
case UVC_BUF_STATE_ACTIVE:
|
||||
default:
|
||||
uvc_trace(UVC_TRACE_CAPTURE, "[E] Invalid buffer state %u "
|
||||
"(driver bug?).\n", buf->state);
|
||||
ret = -EINVAL;
|
||||
goto done;
|
||||
}
|
||||
|
||||
list_del(&buf->stream);
|
||||
__uvc_query_buffer(buf, v4l2_buf);
|
||||
|
||||
done:
|
||||
mutex_unlock(&queue->mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* Poll the video queue.
|
||||
*
|
||||
* This function implements video queue polling and is intended to be used by
|
||||
* the device poll handler.
|
||||
*/
|
||||
unsigned int uvc_queue_poll(struct uvc_video_queue *queue, struct file *file,
|
||||
poll_table *wait)
|
||||
{
|
||||
struct uvc_buffer *buf;
|
||||
unsigned int mask = 0;
|
||||
|
||||
mutex_lock(&queue->mutex);
|
||||
if (list_empty(&queue->mainqueue)) {
|
||||
mask |= POLLERR;
|
||||
goto done;
|
||||
}
|
||||
buf = list_first_entry(&queue->mainqueue, struct uvc_buffer, stream);
|
||||
|
||||
poll_wait(file, &buf->wait, wait);
|
||||
if (buf->state == UVC_BUF_STATE_DONE ||
|
||||
buf->state == UVC_BUF_STATE_ERROR)
|
||||
mask |= POLLIN | POLLRDNORM;
|
||||
|
||||
done:
|
||||
mutex_unlock(&queue->mutex);
|
||||
return mask;
|
||||
}
|
||||
|
||||
/*
|
||||
* Enable or disable the video buffers queue.
|
||||
*
|
||||
* The queue must be enabled before starting video acquisition and must be
|
||||
* disabled after stopping it. This ensures that the video buffers queue
|
||||
* state can be properly initialized before buffers are accessed from the
|
||||
* interrupt handler.
|
||||
*
|
||||
* Enabling the video queue initializes parameters (such as sequence number,
|
||||
* sync pattern, ...). If the queue is already enabled, return -EBUSY.
|
||||
*
|
||||
* Disabling the video queue cancels the queue and removes all buffers from
|
||||
* the main queue.
|
||||
*
|
||||
* This function can't be called from interrupt context. Use
|
||||
* uvc_queue_cancel() instead.
|
||||
*/
|
||||
int uvc_queue_enable(struct uvc_video_queue *queue, int enable)
|
||||
{
|
||||
unsigned int i;
|
||||
int ret = 0;
|
||||
|
||||
mutex_lock(&queue->mutex);
|
||||
if (enable) {
|
||||
if (uvc_queue_streaming(queue)) {
|
||||
ret = -EBUSY;
|
||||
goto done;
|
||||
}
|
||||
queue->sequence = 0;
|
||||
queue->flags |= UVC_QUEUE_STREAMING;
|
||||
} else {
|
||||
uvc_queue_cancel(queue, 0);
|
||||
INIT_LIST_HEAD(&queue->mainqueue);
|
||||
|
||||
for (i = 0; i < queue->count; ++i)
|
||||
queue->buffer[i].state = UVC_BUF_STATE_IDLE;
|
||||
|
||||
queue->flags &= ~UVC_QUEUE_STREAMING;
|
||||
}
|
||||
|
||||
done:
|
||||
mutex_unlock(&queue->mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* Cancel the video buffers queue.
|
||||
*
|
||||
* Cancelling the queue marks all buffers on the irq queue as erroneous,
|
||||
* wakes them up and remove them from the queue.
|
||||
*
|
||||
* If the disconnect parameter is set, further calls to uvc_queue_buffer will
|
||||
* fail with -ENODEV.
|
||||
*
|
||||
* This function acquires the irq spinlock and can be called from interrupt
|
||||
* context.
|
||||
*/
|
||||
void uvc_queue_cancel(struct uvc_video_queue *queue, int disconnect)
|
||||
{
|
||||
struct uvc_buffer *buf;
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&queue->irqlock, flags);
|
||||
while (!list_empty(&queue->irqqueue)) {
|
||||
buf = list_first_entry(&queue->irqqueue, struct uvc_buffer,
|
||||
queue);
|
||||
list_del(&buf->queue);
|
||||
buf->state = UVC_BUF_STATE_ERROR;
|
||||
wake_up(&buf->wait);
|
||||
}
|
||||
/* This must be protected by the irqlock spinlock to avoid race
|
||||
* conditions between uvc_queue_buffer and the disconnection event that
|
||||
* could result in an interruptible wait in uvc_dequeue_buffer. Do not
|
||||
* blindly replace this logic by checking for the UVC_DEV_DISCONNECTED
|
||||
* state outside the queue code.
|
||||
*/
|
||||
if (disconnect)
|
||||
queue->flags |= UVC_QUEUE_DISCONNECTED;
|
||||
spin_unlock_irqrestore(&queue->irqlock, flags);
|
||||
}
|
||||
|
||||
struct uvc_buffer *uvc_queue_next_buffer(struct uvc_video_queue *queue,
|
||||
struct uvc_buffer *buf)
|
||||
{
|
||||
struct uvc_buffer *nextbuf;
|
||||
unsigned long flags;
|
||||
|
||||
if ((queue->flags & UVC_QUEUE_DROP_INCOMPLETE) &&
|
||||
buf->buf.length != buf->buf.bytesused) {
|
||||
buf->state = UVC_BUF_STATE_QUEUED;
|
||||
buf->buf.bytesused = 0;
|
||||
return buf;
|
||||
}
|
||||
|
||||
spin_lock_irqsave(&queue->irqlock, flags);
|
||||
list_del(&buf->queue);
|
||||
if (!list_empty(&queue->irqqueue))
|
||||
nextbuf = list_first_entry(&queue->irqqueue, struct uvc_buffer,
|
||||
queue);
|
||||
else
|
||||
nextbuf = NULL;
|
||||
spin_unlock_irqrestore(&queue->irqlock, flags);
|
||||
|
||||
buf->buf.sequence = queue->sequence++;
|
||||
do_gettimeofday(&buf->buf.timestamp);
|
||||
|
||||
wake_up(&buf->wait);
|
||||
return nextbuf;
|
||||
}
|
207
drivers/media/video/uvc/uvc_status.c
Normal file
207
drivers/media/video/uvc/uvc_status.c
Normal file
@ -0,0 +1,207 @@
|
||||
/*
|
||||
* uvc_status.c -- USB Video Class driver - Status endpoint
|
||||
*
|
||||
* Copyright (C) 2007-2008
|
||||
* Laurent Pinchart (laurent.pinchart@skynet.be)
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/version.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/usb.h>
|
||||
#include <linux/usb/input.h>
|
||||
|
||||
#include "uvcvideo.h"
|
||||
|
||||
/* --------------------------------------------------------------------------
|
||||
* Input device
|
||||
*/
|
||||
static int uvc_input_init(struct uvc_device *dev)
|
||||
{
|
||||
struct usb_device *udev = dev->udev;
|
||||
struct input_dev *input;
|
||||
char *phys = NULL;
|
||||
int ret;
|
||||
|
||||
input = input_allocate_device();
|
||||
if (input == NULL)
|
||||
return -ENOMEM;
|
||||
|
||||
phys = kmalloc(6 + strlen(udev->bus->bus_name) + strlen(udev->devpath),
|
||||
GFP_KERNEL);
|
||||
if (phys == NULL) {
|
||||
ret = -ENOMEM;
|
||||
goto error;
|
||||
}
|
||||
sprintf(phys, "usb-%s-%s", udev->bus->bus_name, udev->devpath);
|
||||
|
||||
input->name = dev->name;
|
||||
input->phys = phys;
|
||||
usb_to_input_id(udev, &input->id);
|
||||
input->dev.parent = &dev->intf->dev;
|
||||
|
||||
set_bit(EV_KEY, input->evbit);
|
||||
set_bit(BTN_0, input->keybit);
|
||||
|
||||
if ((ret = input_register_device(input)) < 0)
|
||||
goto error;
|
||||
|
||||
dev->input = input;
|
||||
return 0;
|
||||
|
||||
error:
|
||||
input_free_device(input);
|
||||
kfree(phys);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void uvc_input_cleanup(struct uvc_device *dev)
|
||||
{
|
||||
if (dev->input)
|
||||
input_unregister_device(dev->input);
|
||||
}
|
||||
|
||||
/* --------------------------------------------------------------------------
|
||||
* Status interrupt endpoint
|
||||
*/
|
||||
static void uvc_event_streaming(struct uvc_device *dev, __u8 *data, int len)
|
||||
{
|
||||
if (len < 3) {
|
||||
uvc_trace(UVC_TRACE_STATUS, "Invalid streaming status event "
|
||||
"received.\n");
|
||||
return;
|
||||
}
|
||||
|
||||
if (data[2] == 0) {
|
||||
if (len < 4)
|
||||
return;
|
||||
uvc_trace(UVC_TRACE_STATUS, "Button (intf %u) %s len %d\n",
|
||||
data[1], data[3] ? "pressed" : "released", len);
|
||||
if (dev->input)
|
||||
input_report_key(dev->input, BTN_0, data[3]);
|
||||
} else {
|
||||
uvc_trace(UVC_TRACE_STATUS, "Stream %u error event %02x %02x "
|
||||
"len %d.\n", data[1], data[2], data[3], len);
|
||||
}
|
||||
}
|
||||
|
||||
static void uvc_event_control(struct uvc_device *dev, __u8 *data, int len)
|
||||
{
|
||||
char *attrs[3] = { "value", "info", "failure" };
|
||||
|
||||
if (len < 6 || data[2] != 0 || data[4] > 2) {
|
||||
uvc_trace(UVC_TRACE_STATUS, "Invalid control status event "
|
||||
"received.\n");
|
||||
return;
|
||||
}
|
||||
|
||||
uvc_trace(UVC_TRACE_STATUS, "Control %u/%u %s change len %d.\n",
|
||||
data[1], data[3], attrs[data[4]], len);
|
||||
}
|
||||
|
||||
static void uvc_status_complete(struct urb *urb)
|
||||
{
|
||||
struct uvc_device *dev = urb->context;
|
||||
int len, ret;
|
||||
|
||||
switch (urb->status) {
|
||||
case 0:
|
||||
break;
|
||||
|
||||
case -ENOENT: /* usb_kill_urb() called. */
|
||||
case -ECONNRESET: /* usb_unlink_urb() called. */
|
||||
case -ESHUTDOWN: /* The endpoint is being disabled. */
|
||||
case -EPROTO: /* Device is disconnected (reported by some
|
||||
* host controller). */
|
||||
return;
|
||||
|
||||
default:
|
||||
uvc_printk(KERN_WARNING, "Non-zero status (%d) in status "
|
||||
"completion handler.\n", urb->status);
|
||||
return;
|
||||
}
|
||||
|
||||
len = urb->actual_length;
|
||||
if (len > 0) {
|
||||
switch (dev->status[0] & 0x0f) {
|
||||
case UVC_STATUS_TYPE_CONTROL:
|
||||
uvc_event_control(dev, dev->status, len);
|
||||
break;
|
||||
|
||||
case UVC_STATUS_TYPE_STREAMING:
|
||||
uvc_event_streaming(dev, dev->status, len);
|
||||
break;
|
||||
|
||||
default:
|
||||
uvc_printk(KERN_INFO, "unknown event type %u.\n",
|
||||
dev->status[0]);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/* Resubmit the URB. */
|
||||
urb->interval = dev->int_ep->desc.bInterval;
|
||||
if ((ret = usb_submit_urb(urb, GFP_ATOMIC)) < 0) {
|
||||
uvc_printk(KERN_ERR, "Failed to resubmit status URB (%d).\n",
|
||||
ret);
|
||||
}
|
||||
}
|
||||
|
||||
int uvc_status_init(struct uvc_device *dev)
|
||||
{
|
||||
struct usb_host_endpoint *ep = dev->int_ep;
|
||||
unsigned int pipe;
|
||||
int interval;
|
||||
|
||||
if (ep == NULL)
|
||||
return 0;
|
||||
|
||||
uvc_input_init(dev);
|
||||
|
||||
dev->int_urb = usb_alloc_urb(0, GFP_KERNEL);
|
||||
if (dev->int_urb == NULL)
|
||||
return -ENOMEM;
|
||||
|
||||
pipe = usb_rcvintpipe(dev->udev, ep->desc.bEndpointAddress);
|
||||
|
||||
/* For high-speed interrupt endpoints, the bInterval value is used as
|
||||
* an exponent of two. Some developers forgot about it.
|
||||
*/
|
||||
interval = ep->desc.bInterval;
|
||||
if (interval > 16 && dev->udev->speed == USB_SPEED_HIGH &&
|
||||
(dev->quirks & UVC_QUIRK_STATUS_INTERVAL))
|
||||
interval = fls(interval) - 1;
|
||||
|
||||
usb_fill_int_urb(dev->int_urb, dev->udev, pipe,
|
||||
dev->status, sizeof dev->status, uvc_status_complete,
|
||||
dev, interval);
|
||||
|
||||
return usb_submit_urb(dev->int_urb, GFP_KERNEL);
|
||||
}
|
||||
|
||||
void uvc_status_cleanup(struct uvc_device *dev)
|
||||
{
|
||||
usb_kill_urb(dev->int_urb);
|
||||
usb_free_urb(dev->int_urb);
|
||||
uvc_input_cleanup(dev);
|
||||
}
|
||||
|
||||
int uvc_status_suspend(struct uvc_device *dev)
|
||||
{
|
||||
usb_kill_urb(dev->int_urb);
|
||||
return 0;
|
||||
}
|
||||
|
||||
int uvc_status_resume(struct uvc_device *dev)
|
||||
{
|
||||
if (dev->int_urb == NULL)
|
||||
return 0;
|
||||
|
||||
return usb_submit_urb(dev->int_urb, GFP_KERNEL);
|
||||
}
|
1105
drivers/media/video/uvc/uvc_v4l2.c
Normal file
1105
drivers/media/video/uvc/uvc_v4l2.c
Normal file
File diff suppressed because it is too large
Load Diff
934
drivers/media/video/uvc/uvc_video.c
Normal file
934
drivers/media/video/uvc/uvc_video.c
Normal file
@ -0,0 +1,934 @@
|
||||
/*
|
||||
* uvc_video.c -- USB Video Class driver - Video handling
|
||||
*
|
||||
* Copyright (C) 2005-2008
|
||||
* Laurent Pinchart (laurent.pinchart@skynet.be)
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/version.h>
|
||||
#include <linux/list.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/usb.h>
|
||||
#include <linux/videodev2.h>
|
||||
#include <linux/vmalloc.h>
|
||||
#include <linux/wait.h>
|
||||
#include <asm/atomic.h>
|
||||
#include <asm/unaligned.h>
|
||||
|
||||
#include <media/v4l2-common.h>
|
||||
|
||||
#include "uvcvideo.h"
|
||||
|
||||
/* ------------------------------------------------------------------------
|
||||
* UVC Controls
|
||||
*/
|
||||
|
||||
static int __uvc_query_ctrl(struct uvc_device *dev, __u8 query, __u8 unit,
|
||||
__u8 intfnum, __u8 cs, void *data, __u16 size,
|
||||
int timeout)
|
||||
{
|
||||
__u8 type = USB_TYPE_CLASS | USB_RECIP_INTERFACE;
|
||||
unsigned int pipe;
|
||||
int ret;
|
||||
|
||||
pipe = (query & 0x80) ? usb_rcvctrlpipe(dev->udev, 0)
|
||||
: usb_sndctrlpipe(dev->udev, 0);
|
||||
type |= (query & 0x80) ? USB_DIR_IN : USB_DIR_OUT;
|
||||
|
||||
ret = usb_control_msg(dev->udev, pipe, query, type, cs << 8,
|
||||
unit << 8 | intfnum, data, size, timeout);
|
||||
|
||||
if (ret != size) {
|
||||
uvc_printk(KERN_ERR, "Failed to query (%u) UVC control %u "
|
||||
"(unit %u) : %d (exp. %u).\n", query, cs, unit, ret,
|
||||
size);
|
||||
return -EIO;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int uvc_query_ctrl(struct uvc_device *dev, __u8 query, __u8 unit,
|
||||
__u8 intfnum, __u8 cs, void *data, __u16 size)
|
||||
{
|
||||
return __uvc_query_ctrl(dev, query, unit, intfnum, cs, data, size,
|
||||
UVC_CTRL_CONTROL_TIMEOUT);
|
||||
}
|
||||
|
||||
static void uvc_fixup_buffer_size(struct uvc_video_device *video,
|
||||
struct uvc_streaming_control *ctrl)
|
||||
{
|
||||
struct uvc_format *format;
|
||||
struct uvc_frame *frame;
|
||||
|
||||
if (ctrl->bFormatIndex <= 0 ||
|
||||
ctrl->bFormatIndex > video->streaming->nformats)
|
||||
return;
|
||||
|
||||
format = &video->streaming->format[ctrl->bFormatIndex - 1];
|
||||
|
||||
if (ctrl->bFrameIndex <= 0 ||
|
||||
ctrl->bFrameIndex > format->nframes)
|
||||
return;
|
||||
|
||||
frame = &format->frame[ctrl->bFrameIndex - 1];
|
||||
|
||||
if (!(format->flags & UVC_FMT_FLAG_COMPRESSED) ||
|
||||
(ctrl->dwMaxVideoFrameSize == 0 &&
|
||||
video->dev->uvc_version < 0x0110))
|
||||
ctrl->dwMaxVideoFrameSize =
|
||||
frame->dwMaxVideoFrameBufferSize;
|
||||
}
|
||||
|
||||
static int uvc_get_video_ctrl(struct uvc_video_device *video,
|
||||
struct uvc_streaming_control *ctrl, int probe, __u8 query)
|
||||
{
|
||||
__u8 data[34];
|
||||
__u8 size;
|
||||
int ret;
|
||||
|
||||
size = video->dev->uvc_version >= 0x0110 ? 34 : 26;
|
||||
ret = __uvc_query_ctrl(video->dev, query, 0, video->streaming->intfnum,
|
||||
probe ? VS_PROBE_CONTROL : VS_COMMIT_CONTROL, &data, size,
|
||||
UVC_CTRL_STREAMING_TIMEOUT);
|
||||
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
ctrl->bmHint = le16_to_cpup((__le16 *)&data[0]);
|
||||
ctrl->bFormatIndex = data[2];
|
||||
ctrl->bFrameIndex = data[3];
|
||||
ctrl->dwFrameInterval = le32_to_cpup((__le32 *)&data[4]);
|
||||
ctrl->wKeyFrameRate = le16_to_cpup((__le16 *)&data[8]);
|
||||
ctrl->wPFrameRate = le16_to_cpup((__le16 *)&data[10]);
|
||||
ctrl->wCompQuality = le16_to_cpup((__le16 *)&data[12]);
|
||||
ctrl->wCompWindowSize = le16_to_cpup((__le16 *)&data[14]);
|
||||
ctrl->wDelay = le16_to_cpup((__le16 *)&data[16]);
|
||||
ctrl->dwMaxVideoFrameSize =
|
||||
le32_to_cpu(get_unaligned((__le32 *)&data[18]));
|
||||
ctrl->dwMaxPayloadTransferSize =
|
||||
le32_to_cpu(get_unaligned((__le32 *)&data[22]));
|
||||
|
||||
if (size == 34) {
|
||||
ctrl->dwClockFrequency =
|
||||
le32_to_cpu(get_unaligned((__le32 *)&data[26]));
|
||||
ctrl->bmFramingInfo = data[30];
|
||||
ctrl->bPreferedVersion = data[31];
|
||||
ctrl->bMinVersion = data[32];
|
||||
ctrl->bMaxVersion = data[33];
|
||||
} else {
|
||||
ctrl->dwClockFrequency = video->dev->clock_frequency;
|
||||
ctrl->bmFramingInfo = 0;
|
||||
ctrl->bPreferedVersion = 0;
|
||||
ctrl->bMinVersion = 0;
|
||||
ctrl->bMaxVersion = 0;
|
||||
}
|
||||
|
||||
/* Some broken devices return a null or wrong dwMaxVideoFrameSize.
|
||||
* Try to get the value from the format and frame descriptor.
|
||||
*/
|
||||
uvc_fixup_buffer_size(video, ctrl);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int uvc_set_video_ctrl(struct uvc_video_device *video,
|
||||
struct uvc_streaming_control *ctrl, int probe)
|
||||
{
|
||||
__u8 data[34];
|
||||
__u8 size;
|
||||
|
||||
size = video->dev->uvc_version >= 0x0110 ? 34 : 26;
|
||||
memset(data, 0, sizeof data);
|
||||
|
||||
*(__le16 *)&data[0] = cpu_to_le16(ctrl->bmHint);
|
||||
data[2] = ctrl->bFormatIndex;
|
||||
data[3] = ctrl->bFrameIndex;
|
||||
*(__le32 *)&data[4] = cpu_to_le32(ctrl->dwFrameInterval);
|
||||
*(__le16 *)&data[8] = cpu_to_le16(ctrl->wKeyFrameRate);
|
||||
*(__le16 *)&data[10] = cpu_to_le16(ctrl->wPFrameRate);
|
||||
*(__le16 *)&data[12] = cpu_to_le16(ctrl->wCompQuality);
|
||||
*(__le16 *)&data[14] = cpu_to_le16(ctrl->wCompWindowSize);
|
||||
*(__le16 *)&data[16] = cpu_to_le16(ctrl->wDelay);
|
||||
/* Note: Some of the fields below are not required for IN devices (see
|
||||
* UVC spec, 4.3.1.1), but we still copy them in case support for OUT
|
||||
* devices is added in the future. */
|
||||
put_unaligned(cpu_to_le32(ctrl->dwMaxVideoFrameSize),
|
||||
(__le32 *)&data[18]);
|
||||
put_unaligned(cpu_to_le32(ctrl->dwMaxPayloadTransferSize),
|
||||
(__le32 *)&data[22]);
|
||||
|
||||
if (size == 34) {
|
||||
put_unaligned(cpu_to_le32(ctrl->dwClockFrequency),
|
||||
(__le32 *)&data[26]);
|
||||
data[30] = ctrl->bmFramingInfo;
|
||||
data[31] = ctrl->bPreferedVersion;
|
||||
data[32] = ctrl->bMinVersion;
|
||||
data[33] = ctrl->bMaxVersion;
|
||||
}
|
||||
|
||||
return __uvc_query_ctrl(video->dev, SET_CUR, 0,
|
||||
video->streaming->intfnum,
|
||||
probe ? VS_PROBE_CONTROL : VS_COMMIT_CONTROL, &data, size,
|
||||
UVC_CTRL_STREAMING_TIMEOUT);
|
||||
}
|
||||
|
||||
int uvc_probe_video(struct uvc_video_device *video,
|
||||
struct uvc_streaming_control *probe)
|
||||
{
|
||||
struct uvc_streaming_control probe_min, probe_max;
|
||||
__u16 bandwidth;
|
||||
unsigned int i;
|
||||
int ret;
|
||||
|
||||
mutex_lock(&video->streaming->mutex);
|
||||
|
||||
/* Perform probing. The device should adjust the requested values
|
||||
* according to its capabilities. However, some devices, namely the
|
||||
* first generation UVC Logitech webcams, don't implement the Video
|
||||
* Probe control properly, and just return the needed bandwidth. For
|
||||
* that reason, if the needed bandwidth exceeds the maximum available
|
||||
* bandwidth, try to lower the quality.
|
||||
*/
|
||||
if ((ret = uvc_set_video_ctrl(video, probe, 1)) < 0)
|
||||
goto done;
|
||||
|
||||
/* Get the minimum and maximum values for compression settings. */
|
||||
if (!(video->dev->quirks & UVC_QUIRK_PROBE_MINMAX)) {
|
||||
ret = uvc_get_video_ctrl(video, &probe_min, 1, GET_MIN);
|
||||
if (ret < 0)
|
||||
goto done;
|
||||
ret = uvc_get_video_ctrl(video, &probe_max, 1, GET_MAX);
|
||||
if (ret < 0)
|
||||
goto done;
|
||||
|
||||
probe->wCompQuality = probe_max.wCompQuality;
|
||||
}
|
||||
|
||||
for (i = 0; i < 2; ++i) {
|
||||
if ((ret = uvc_set_video_ctrl(video, probe, 1)) < 0 ||
|
||||
(ret = uvc_get_video_ctrl(video, probe, 1, GET_CUR)) < 0)
|
||||
goto done;
|
||||
|
||||
if (video->streaming->intf->num_altsetting == 1)
|
||||
break;
|
||||
|
||||
bandwidth = probe->dwMaxPayloadTransferSize;
|
||||
if (bandwidth <= video->streaming->maxpsize)
|
||||
break;
|
||||
|
||||
if (video->dev->quirks & UVC_QUIRK_PROBE_MINMAX) {
|
||||
ret = -ENOSPC;
|
||||
goto done;
|
||||
}
|
||||
|
||||
/* TODO: negotiate compression parameters */
|
||||
probe->wKeyFrameRate = probe_min.wKeyFrameRate;
|
||||
probe->wPFrameRate = probe_min.wPFrameRate;
|
||||
probe->wCompQuality = probe_max.wCompQuality;
|
||||
probe->wCompWindowSize = probe_min.wCompWindowSize;
|
||||
}
|
||||
|
||||
done:
|
||||
mutex_unlock(&video->streaming->mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* ------------------------------------------------------------------------
|
||||
* Video codecs
|
||||
*/
|
||||
|
||||
/* Values for bmHeaderInfo (Video and Still Image Payload Headers, 2.4.3.3) */
|
||||
#define UVC_STREAM_EOH (1 << 7)
|
||||
#define UVC_STREAM_ERR (1 << 6)
|
||||
#define UVC_STREAM_STI (1 << 5)
|
||||
#define UVC_STREAM_RES (1 << 4)
|
||||
#define UVC_STREAM_SCR (1 << 3)
|
||||
#define UVC_STREAM_PTS (1 << 2)
|
||||
#define UVC_STREAM_EOF (1 << 1)
|
||||
#define UVC_STREAM_FID (1 << 0)
|
||||
|
||||
/* Video payload decoding is handled by uvc_video_decode_start(),
|
||||
* uvc_video_decode_data() and uvc_video_decode_end().
|
||||
*
|
||||
* uvc_video_decode_start is called with URB data at the start of a bulk or
|
||||
* isochronous payload. It processes header data and returns the header size
|
||||
* in bytes if successful. If an error occurs, it returns a negative error
|
||||
* code. The following error codes have special meanings.
|
||||
*
|
||||
* - EAGAIN informs the caller that the current video buffer should be marked
|
||||
* as done, and that the function should be called again with the same data
|
||||
* and a new video buffer. This is used when end of frame conditions can be
|
||||
* reliably detected at the beginning of the next frame only.
|
||||
*
|
||||
* If an error other than -EAGAIN is returned, the caller will drop the current
|
||||
* payload. No call to uvc_video_decode_data and uvc_video_decode_end will be
|
||||
* made until the next payload. -ENODATA can be used to drop the current
|
||||
* payload if no other error code is appropriate.
|
||||
*
|
||||
* uvc_video_decode_data is called for every URB with URB data. It copies the
|
||||
* data to the video buffer.
|
||||
*
|
||||
* uvc_video_decode_end is called with header data at the end of a bulk or
|
||||
* isochronous payload. It performs any additional header data processing and
|
||||
* returns 0 or a negative error code if an error occured. As header data have
|
||||
* already been processed by uvc_video_decode_start, this functions isn't
|
||||
* required to perform sanity checks a second time.
|
||||
*
|
||||
* For isochronous transfers where a payload is always transfered in a single
|
||||
* URB, the three functions will be called in a row.
|
||||
*
|
||||
* To let the decoder process header data and update its internal state even
|
||||
* when no video buffer is available, uvc_video_decode_start must be prepared
|
||||
* to be called with a NULL buf parameter. uvc_video_decode_data and
|
||||
* uvc_video_decode_end will never be called with a NULL buffer.
|
||||
*/
|
||||
static int uvc_video_decode_start(struct uvc_video_device *video,
|
||||
struct uvc_buffer *buf, const __u8 *data, int len)
|
||||
{
|
||||
__u8 fid;
|
||||
|
||||
/* Sanity checks:
|
||||
* - packet must be at least 2 bytes long
|
||||
* - bHeaderLength value must be at least 2 bytes (see above)
|
||||
* - bHeaderLength value can't be larger than the packet size.
|
||||
*/
|
||||
if (len < 2 || data[0] < 2 || data[0] > len)
|
||||
return -EINVAL;
|
||||
|
||||
/* Skip payloads marked with the error bit ("error frames"). */
|
||||
if (data[1] & UVC_STREAM_ERR) {
|
||||
uvc_trace(UVC_TRACE_FRAME, "Dropping payload (error bit "
|
||||
"set).\n");
|
||||
return -ENODATA;
|
||||
}
|
||||
|
||||
fid = data[1] & UVC_STREAM_FID;
|
||||
|
||||
/* Store the payload FID bit and return immediately when the buffer is
|
||||
* NULL.
|
||||
*/
|
||||
if (buf == NULL) {
|
||||
video->last_fid = fid;
|
||||
return -ENODATA;
|
||||
}
|
||||
|
||||
/* Synchronize to the input stream by waiting for the FID bit to be
|
||||
* toggled when the the buffer state is not UVC_BUF_STATE_ACTIVE.
|
||||
* queue->last_fid is initialized to -1, so the first isochronous
|
||||
* frame will always be in sync.
|
||||
*
|
||||
* If the device doesn't toggle the FID bit, invert video->last_fid
|
||||
* when the EOF bit is set to force synchronisation on the next packet.
|
||||
*/
|
||||
if (buf->state != UVC_BUF_STATE_ACTIVE) {
|
||||
if (fid == video->last_fid) {
|
||||
uvc_trace(UVC_TRACE_FRAME, "Dropping payload (out of "
|
||||
"sync).\n");
|
||||
if ((video->dev->quirks & UVC_QUIRK_STREAM_NO_FID) &&
|
||||
(data[1] & UVC_STREAM_EOF))
|
||||
video->last_fid ^= UVC_STREAM_FID;
|
||||
return -ENODATA;
|
||||
}
|
||||
|
||||
/* TODO: Handle PTS and SCR. */
|
||||
buf->state = UVC_BUF_STATE_ACTIVE;
|
||||
}
|
||||
|
||||
/* Mark the buffer as done if we're at the beginning of a new frame.
|
||||
* End of frame detection is better implemented by checking the EOF
|
||||
* bit (FID bit toggling is delayed by one frame compared to the EOF
|
||||
* bit), but some devices don't set the bit at end of frame (and the
|
||||
* last payload can be lost anyway). We thus must check if the FID has
|
||||
* been toggled.
|
||||
*
|
||||
* queue->last_fid is initialized to -1, so the first isochronous
|
||||
* frame will never trigger an end of frame detection.
|
||||
*
|
||||
* Empty buffers (bytesused == 0) don't trigger end of frame detection
|
||||
* as it doesn't make sense to return an empty buffer. This also
|
||||
* avoids detecting and of frame conditions at FID toggling if the
|
||||
* previous payload had the EOF bit set.
|
||||
*/
|
||||
if (fid != video->last_fid && buf->buf.bytesused != 0) {
|
||||
uvc_trace(UVC_TRACE_FRAME, "Frame complete (FID bit "
|
||||
"toggled).\n");
|
||||
buf->state = UVC_BUF_STATE_DONE;
|
||||
return -EAGAIN;
|
||||
}
|
||||
|
||||
video->last_fid = fid;
|
||||
|
||||
return data[0];
|
||||
}
|
||||
|
||||
static void uvc_video_decode_data(struct uvc_video_device *video,
|
||||
struct uvc_buffer *buf, const __u8 *data, int len)
|
||||
{
|
||||
struct uvc_video_queue *queue = &video->queue;
|
||||
unsigned int maxlen, nbytes;
|
||||
void *mem;
|
||||
|
||||
if (len <= 0)
|
||||
return;
|
||||
|
||||
/* Copy the video data to the buffer. */
|
||||
maxlen = buf->buf.length - buf->buf.bytesused;
|
||||
mem = queue->mem + buf->buf.m.offset + buf->buf.bytesused;
|
||||
nbytes = min((unsigned int)len, maxlen);
|
||||
memcpy(mem, data, nbytes);
|
||||
buf->buf.bytesused += nbytes;
|
||||
|
||||
/* Complete the current frame if the buffer size was exceeded. */
|
||||
if (len > maxlen) {
|
||||
uvc_trace(UVC_TRACE_FRAME, "Frame complete (overflow).\n");
|
||||
buf->state = UVC_BUF_STATE_DONE;
|
||||
}
|
||||
}
|
||||
|
||||
static void uvc_video_decode_end(struct uvc_video_device *video,
|
||||
struct uvc_buffer *buf, const __u8 *data, int len)
|
||||
{
|
||||
/* Mark the buffer as done if the EOF marker is set. */
|
||||
if (data[1] & UVC_STREAM_EOF && buf->buf.bytesused != 0) {
|
||||
uvc_trace(UVC_TRACE_FRAME, "Frame complete (EOF found).\n");
|
||||
if (data[0] == len)
|
||||
uvc_trace(UVC_TRACE_FRAME, "EOF in empty payload.\n");
|
||||
buf->state = UVC_BUF_STATE_DONE;
|
||||
if (video->dev->quirks & UVC_QUIRK_STREAM_NO_FID)
|
||||
video->last_fid ^= UVC_STREAM_FID;
|
||||
}
|
||||
}
|
||||
|
||||
/* ------------------------------------------------------------------------
|
||||
* URB handling
|
||||
*/
|
||||
|
||||
/*
|
||||
* Completion handler for video URBs.
|
||||
*/
|
||||
static void uvc_video_decode_isoc(struct urb *urb,
|
||||
struct uvc_video_device *video, struct uvc_buffer *buf)
|
||||
{
|
||||
u8 *mem;
|
||||
int ret, i;
|
||||
|
||||
for (i = 0; i < urb->number_of_packets; ++i) {
|
||||
if (urb->iso_frame_desc[i].status < 0) {
|
||||
uvc_trace(UVC_TRACE_FRAME, "USB isochronous frame "
|
||||
"lost (%d).\n", urb->iso_frame_desc[i].status);
|
||||
continue;
|
||||
}
|
||||
|
||||
/* Decode the payload header. */
|
||||
mem = urb->transfer_buffer + urb->iso_frame_desc[i].offset;
|
||||
do {
|
||||
ret = uvc_video_decode_start(video, buf, mem,
|
||||
urb->iso_frame_desc[i].actual_length);
|
||||
if (ret == -EAGAIN)
|
||||
buf = uvc_queue_next_buffer(&video->queue, buf);
|
||||
} while (ret == -EAGAIN);
|
||||
|
||||
if (ret < 0)
|
||||
continue;
|
||||
|
||||
/* Decode the payload data. */
|
||||
uvc_video_decode_data(video, buf, mem + ret,
|
||||
urb->iso_frame_desc[i].actual_length - ret);
|
||||
|
||||
/* Process the header again. */
|
||||
uvc_video_decode_end(video, buf, mem, ret);
|
||||
|
||||
if (buf->state == UVC_BUF_STATE_DONE ||
|
||||
buf->state == UVC_BUF_STATE_ERROR)
|
||||
buf = uvc_queue_next_buffer(&video->queue, buf);
|
||||
}
|
||||
}
|
||||
|
||||
static void uvc_video_decode_bulk(struct urb *urb,
|
||||
struct uvc_video_device *video, struct uvc_buffer *buf)
|
||||
{
|
||||
u8 *mem;
|
||||
int len, ret;
|
||||
|
||||
mem = urb->transfer_buffer;
|
||||
len = urb->actual_length;
|
||||
video->bulk.payload_size += len;
|
||||
|
||||
/* If the URB is the first of its payload, decode and save the
|
||||
* header.
|
||||
*/
|
||||
if (video->bulk.header_size == 0) {
|
||||
do {
|
||||
ret = uvc_video_decode_start(video, buf, mem, len);
|
||||
if (ret == -EAGAIN)
|
||||
buf = uvc_queue_next_buffer(&video->queue, buf);
|
||||
} while (ret == -EAGAIN);
|
||||
|
||||
/* If an error occured skip the rest of the payload. */
|
||||
if (ret < 0 || buf == NULL) {
|
||||
video->bulk.skip_payload = 1;
|
||||
return;
|
||||
}
|
||||
|
||||
video->bulk.header_size = ret;
|
||||
memcpy(video->bulk.header, mem, video->bulk.header_size);
|
||||
|
||||
mem += ret;
|
||||
len -= ret;
|
||||
}
|
||||
|
||||
/* The buffer queue might have been cancelled while a bulk transfer
|
||||
* was in progress, so we can reach here with buf equal to NULL. Make
|
||||
* sure buf is never dereferenced if NULL.
|
||||
*/
|
||||
|
||||
/* Process video data. */
|
||||
if (!video->bulk.skip_payload && buf != NULL)
|
||||
uvc_video_decode_data(video, buf, mem, len);
|
||||
|
||||
/* Detect the payload end by a URB smaller than the maximum size (or
|
||||
* a payload size equal to the maximum) and process the header again.
|
||||
*/
|
||||
if (urb->actual_length < urb->transfer_buffer_length ||
|
||||
video->bulk.payload_size >= video->bulk.max_payload_size) {
|
||||
if (!video->bulk.skip_payload && buf != NULL) {
|
||||
uvc_video_decode_end(video, buf, video->bulk.header,
|
||||
video->bulk.header_size);
|
||||
if (buf->state == UVC_BUF_STATE_DONE ||
|
||||
buf->state == UVC_BUF_STATE_ERROR)
|
||||
buf = uvc_queue_next_buffer(&video->queue, buf);
|
||||
}
|
||||
|
||||
video->bulk.header_size = 0;
|
||||
video->bulk.skip_payload = 0;
|
||||
video->bulk.payload_size = 0;
|
||||
}
|
||||
}
|
||||
|
||||
static void uvc_video_complete(struct urb *urb)
|
||||
{
|
||||
struct uvc_video_device *video = urb->context;
|
||||
struct uvc_video_queue *queue = &video->queue;
|
||||
struct uvc_buffer *buf = NULL;
|
||||
unsigned long flags;
|
||||
int ret;
|
||||
|
||||
switch (urb->status) {
|
||||
case 0:
|
||||
break;
|
||||
|
||||
default:
|
||||
uvc_printk(KERN_WARNING, "Non-zero status (%d) in video "
|
||||
"completion handler.\n", urb->status);
|
||||
|
||||
case -ENOENT: /* usb_kill_urb() called. */
|
||||
if (video->frozen)
|
||||
return;
|
||||
|
||||
case -ECONNRESET: /* usb_unlink_urb() called. */
|
||||
case -ESHUTDOWN: /* The endpoint is being disabled. */
|
||||
uvc_queue_cancel(queue, urb->status == -ESHUTDOWN);
|
||||
return;
|
||||
}
|
||||
|
||||
spin_lock_irqsave(&queue->irqlock, flags);
|
||||
if (!list_empty(&queue->irqqueue))
|
||||
buf = list_first_entry(&queue->irqqueue, struct uvc_buffer,
|
||||
queue);
|
||||
spin_unlock_irqrestore(&queue->irqlock, flags);
|
||||
|
||||
video->decode(urb, video, buf);
|
||||
|
||||
if ((ret = usb_submit_urb(urb, GFP_ATOMIC)) < 0) {
|
||||
uvc_printk(KERN_ERR, "Failed to resubmit video URB (%d).\n",
|
||||
ret);
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* Uninitialize isochronous/bulk URBs and free transfer buffers.
|
||||
*/
|
||||
static void uvc_uninit_video(struct uvc_video_device *video)
|
||||
{
|
||||
struct urb *urb;
|
||||
unsigned int i;
|
||||
|
||||
for (i = 0; i < UVC_URBS; ++i) {
|
||||
if ((urb = video->urb[i]) == NULL)
|
||||
continue;
|
||||
|
||||
usb_kill_urb(urb);
|
||||
/* urb->transfer_buffer_length is not touched by USB core, so
|
||||
* we can use it here as the buffer length.
|
||||
*/
|
||||
if (video->urb_buffer[i]) {
|
||||
usb_buffer_free(video->dev->udev,
|
||||
urb->transfer_buffer_length,
|
||||
video->urb_buffer[i], urb->transfer_dma);
|
||||
video->urb_buffer[i] = NULL;
|
||||
}
|
||||
|
||||
usb_free_urb(urb);
|
||||
video->urb[i] = NULL;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* Initialize isochronous URBs and allocate transfer buffers. The packet size
|
||||
* is given by the endpoint.
|
||||
*/
|
||||
static int uvc_init_video_isoc(struct uvc_video_device *video,
|
||||
struct usb_host_endpoint *ep)
|
||||
{
|
||||
struct urb *urb;
|
||||
unsigned int npackets, i, j;
|
||||
__u16 psize;
|
||||
__u32 size;
|
||||
|
||||
/* Compute the number of isochronous packets to allocate by dividing
|
||||
* the maximum video frame size by the packet size. Limit the result
|
||||
* to UVC_MAX_ISO_PACKETS.
|
||||
*/
|
||||
psize = le16_to_cpu(ep->desc.wMaxPacketSize);
|
||||
psize = (psize & 0x07ff) * (1 + ((psize >> 11) & 3));
|
||||
|
||||
size = video->streaming->ctrl.dwMaxVideoFrameSize;
|
||||
if (size > UVC_MAX_FRAME_SIZE)
|
||||
return -EINVAL;
|
||||
|
||||
npackets = (size + psize - 1) / psize;
|
||||
if (npackets > UVC_MAX_ISO_PACKETS)
|
||||
npackets = UVC_MAX_ISO_PACKETS;
|
||||
|
||||
size = npackets * psize;
|
||||
|
||||
for (i = 0; i < UVC_URBS; ++i) {
|
||||
urb = usb_alloc_urb(npackets, GFP_KERNEL);
|
||||
if (urb == NULL) {
|
||||
uvc_uninit_video(video);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
video->urb_buffer[i] = usb_buffer_alloc(video->dev->udev,
|
||||
size, GFP_KERNEL, &urb->transfer_dma);
|
||||
if (video->urb_buffer[i] == NULL) {
|
||||
usb_free_urb(urb);
|
||||
uvc_uninit_video(video);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
urb->dev = video->dev->udev;
|
||||
urb->context = video;
|
||||
urb->pipe = usb_rcvisocpipe(video->dev->udev,
|
||||
ep->desc.bEndpointAddress);
|
||||
urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP;
|
||||
urb->interval = ep->desc.bInterval;
|
||||
urb->transfer_buffer = video->urb_buffer[i];
|
||||
urb->complete = uvc_video_complete;
|
||||
urb->number_of_packets = npackets;
|
||||
urb->transfer_buffer_length = size;
|
||||
|
||||
for (j = 0; j < npackets; ++j) {
|
||||
urb->iso_frame_desc[j].offset = j * psize;
|
||||
urb->iso_frame_desc[j].length = psize;
|
||||
}
|
||||
|
||||
video->urb[i] = urb;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Initialize bulk URBs and allocate transfer buffers. The packet size is
|
||||
* given by the endpoint.
|
||||
*/
|
||||
static int uvc_init_video_bulk(struct uvc_video_device *video,
|
||||
struct usb_host_endpoint *ep)
|
||||
{
|
||||
struct urb *urb;
|
||||
unsigned int pipe, i;
|
||||
__u16 psize;
|
||||
__u32 size;
|
||||
|
||||
/* Compute the bulk URB size. Some devices set the maximum payload
|
||||
* size to a value too high for memory-constrained devices. We must
|
||||
* then transfer the payload accross multiple URBs. To be consistant
|
||||
* with isochronous mode, allocate maximum UVC_MAX_ISO_PACKETS per bulk
|
||||
* URB.
|
||||
*/
|
||||
psize = le16_to_cpu(ep->desc.wMaxPacketSize) & 0x07ff;
|
||||
size = video->streaming->ctrl.dwMaxPayloadTransferSize;
|
||||
video->bulk.max_payload_size = size;
|
||||
if (size > psize * UVC_MAX_ISO_PACKETS)
|
||||
size = psize * UVC_MAX_ISO_PACKETS;
|
||||
|
||||
pipe = usb_rcvbulkpipe(video->dev->udev, ep->desc.bEndpointAddress);
|
||||
|
||||
for (i = 0; i < UVC_URBS; ++i) {
|
||||
urb = usb_alloc_urb(0, GFP_KERNEL);
|
||||
if (urb == NULL) {
|
||||
uvc_uninit_video(video);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
video->urb_buffer[i] = usb_buffer_alloc(video->dev->udev,
|
||||
size, GFP_KERNEL, &urb->transfer_dma);
|
||||
if (video->urb_buffer[i] == NULL) {
|
||||
usb_free_urb(urb);
|
||||
uvc_uninit_video(video);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
usb_fill_bulk_urb(urb, video->dev->udev, pipe,
|
||||
video->urb_buffer[i], size, uvc_video_complete,
|
||||
video);
|
||||
urb->transfer_flags = URB_NO_TRANSFER_DMA_MAP;
|
||||
|
||||
video->urb[i] = urb;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Initialize isochronous/bulk URBs and allocate transfer buffers.
|
||||
*/
|
||||
static int uvc_init_video(struct uvc_video_device *video)
|
||||
{
|
||||
struct usb_interface *intf = video->streaming->intf;
|
||||
struct usb_host_interface *alts;
|
||||
struct usb_host_endpoint *ep = NULL;
|
||||
int intfnum = video->streaming->intfnum;
|
||||
unsigned int bandwidth, psize, i;
|
||||
int ret;
|
||||
|
||||
video->last_fid = -1;
|
||||
video->bulk.header_size = 0;
|
||||
video->bulk.skip_payload = 0;
|
||||
video->bulk.payload_size = 0;
|
||||
|
||||
if (intf->num_altsetting > 1) {
|
||||
/* Isochronous endpoint, select the alternate setting. */
|
||||
bandwidth = video->streaming->ctrl.dwMaxPayloadTransferSize;
|
||||
|
||||
if (bandwidth == 0) {
|
||||
uvc_printk(KERN_WARNING, "device %s requested null "
|
||||
"bandwidth, defaulting to lowest.\n",
|
||||
video->vdev->name);
|
||||
bandwidth = 1;
|
||||
}
|
||||
|
||||
for (i = 0; i < intf->num_altsetting; ++i) {
|
||||
alts = &intf->altsetting[i];
|
||||
ep = uvc_find_endpoint(alts,
|
||||
video->streaming->header.bEndpointAddress);
|
||||
if (ep == NULL)
|
||||
continue;
|
||||
|
||||
/* Check if the bandwidth is high enough. */
|
||||
psize = le16_to_cpu(ep->desc.wMaxPacketSize);
|
||||
psize = (psize & 0x07ff) * (1 + ((psize >> 11) & 3));
|
||||
if (psize >= bandwidth)
|
||||
break;
|
||||
}
|
||||
|
||||
if (i >= intf->num_altsetting)
|
||||
return -EIO;
|
||||
|
||||
if ((ret = usb_set_interface(video->dev->udev, intfnum, i)) < 0)
|
||||
return ret;
|
||||
|
||||
ret = uvc_init_video_isoc(video, ep);
|
||||
} else {
|
||||
/* Bulk endpoint, proceed to URB initialization. */
|
||||
ep = uvc_find_endpoint(&intf->altsetting[0],
|
||||
video->streaming->header.bEndpointAddress);
|
||||
if (ep == NULL)
|
||||
return -EIO;
|
||||
|
||||
ret = uvc_init_video_bulk(video, ep);
|
||||
}
|
||||
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
/* Submit the URBs. */
|
||||
for (i = 0; i < UVC_URBS; ++i) {
|
||||
if ((ret = usb_submit_urb(video->urb[i], GFP_KERNEL)) < 0) {
|
||||
uvc_printk(KERN_ERR, "Failed to submit URB %u "
|
||||
"(%d).\n", i, ret);
|
||||
uvc_uninit_video(video);
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* --------------------------------------------------------------------------
|
||||
* Suspend/resume
|
||||
*/
|
||||
|
||||
/*
|
||||
* Stop streaming without disabling the video queue.
|
||||
*
|
||||
* To let userspace applications resume without trouble, we must not touch the
|
||||
* video buffers in any way. We mark the device as frozen to make sure the URB
|
||||
* completion handler won't try to cancel the queue when we kill the URBs.
|
||||
*/
|
||||
int uvc_video_suspend(struct uvc_video_device *video)
|
||||
{
|
||||
if (!uvc_queue_streaming(&video->queue))
|
||||
return 0;
|
||||
|
||||
video->frozen = 1;
|
||||
uvc_uninit_video(video);
|
||||
usb_set_interface(video->dev->udev, video->streaming->intfnum, 0);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Reconfigure the video interface and restart streaming if it was enable
|
||||
* before suspend.
|
||||
*
|
||||
* If an error occurs, disable the video queue. This will wake all pending
|
||||
* buffers, making sure userspace applications are notified of the problem
|
||||
* instead of waiting forever.
|
||||
*/
|
||||
int uvc_video_resume(struct uvc_video_device *video)
|
||||
{
|
||||
int ret;
|
||||
|
||||
video->frozen = 0;
|
||||
|
||||
if ((ret = uvc_set_video_ctrl(video, &video->streaming->ctrl, 0)) < 0) {
|
||||
uvc_queue_enable(&video->queue, 0);
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (!uvc_queue_streaming(&video->queue))
|
||||
return 0;
|
||||
|
||||
if ((ret = uvc_init_video(video)) < 0)
|
||||
uvc_queue_enable(&video->queue, 0);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* ------------------------------------------------------------------------
|
||||
* Video device
|
||||
*/
|
||||
|
||||
/*
|
||||
* Initialize the UVC video device by retrieving the default format and
|
||||
* committing it.
|
||||
*
|
||||
* Some cameras (namely the Fuji Finepix) set the format and frame
|
||||
* indexes to zero. The UVC standard doesn't clearly make this a spec
|
||||
* violation, so try to silently fix the values if possible.
|
||||
*
|
||||
* This function is called before registering the device with V4L.
|
||||
*/
|
||||
int uvc_video_init(struct uvc_video_device *video)
|
||||
{
|
||||
struct uvc_streaming_control *probe = &video->streaming->ctrl;
|
||||
struct uvc_format *format = NULL;
|
||||
struct uvc_frame *frame = NULL;
|
||||
unsigned int i;
|
||||
int ret;
|
||||
|
||||
if (video->streaming->nformats == 0) {
|
||||
uvc_printk(KERN_INFO, "No supported video formats found.\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
/* Alternate setting 0 should be the default, yet the XBox Live Vision
|
||||
* Cam (and possibly other devices) crash or otherwise misbehave if
|
||||
* they don't receive a SET_INTERFACE request before any other video
|
||||
* control request.
|
||||
*/
|
||||
usb_set_interface(video->dev->udev, video->streaming->intfnum, 0);
|
||||
|
||||
/* Some webcams don't suport GET_DEF request on the probe control. We
|
||||
* fall back to GET_CUR if GET_DEF fails.
|
||||
*/
|
||||
if ((ret = uvc_get_video_ctrl(video, probe, 1, GET_DEF)) < 0 &&
|
||||
(ret = uvc_get_video_ctrl(video, probe, 1, GET_CUR)) < 0)
|
||||
return ret;
|
||||
|
||||
/* Check if the default format descriptor exists. Use the first
|
||||
* available format otherwise.
|
||||
*/
|
||||
for (i = video->streaming->nformats; i > 0; --i) {
|
||||
format = &video->streaming->format[i-1];
|
||||
if (format->index == probe->bFormatIndex)
|
||||
break;
|
||||
}
|
||||
|
||||
if (format->nframes == 0) {
|
||||
uvc_printk(KERN_INFO, "No frame descriptor found for the "
|
||||
"default format.\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
/* Zero bFrameIndex might be correct. Stream-based formats (including
|
||||
* MPEG-2 TS and DV) do not support frames but have a dummy frame
|
||||
* descriptor with bFrameIndex set to zero. If the default frame
|
||||
* descriptor is not found, use the first avalable frame.
|
||||
*/
|
||||
for (i = format->nframes; i > 0; --i) {
|
||||
frame = &format->frame[i-1];
|
||||
if (frame->bFrameIndex == probe->bFrameIndex)
|
||||
break;
|
||||
}
|
||||
|
||||
/* Commit the default settings. */
|
||||
probe->bFormatIndex = format->index;
|
||||
probe->bFrameIndex = frame->bFrameIndex;
|
||||
if ((ret = uvc_set_video_ctrl(video, probe, 0)) < 0)
|
||||
return ret;
|
||||
|
||||
video->streaming->cur_format = format;
|
||||
video->streaming->cur_frame = frame;
|
||||
atomic_set(&video->active, 0);
|
||||
|
||||
/* Select the video decoding function */
|
||||
if (video->dev->quirks & UVC_QUIRK_BUILTIN_ISIGHT)
|
||||
video->decode = uvc_video_decode_isight;
|
||||
else if (video->streaming->intf->num_altsetting > 1)
|
||||
video->decode = uvc_video_decode_isoc;
|
||||
else
|
||||
video->decode = uvc_video_decode_bulk;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Enable or disable the video stream.
|
||||
*/
|
||||
int uvc_video_enable(struct uvc_video_device *video, int enable)
|
||||
{
|
||||
int ret;
|
||||
|
||||
if (!enable) {
|
||||
uvc_uninit_video(video);
|
||||
usb_set_interface(video->dev->udev,
|
||||
video->streaming->intfnum, 0);
|
||||
uvc_queue_enable(&video->queue, 0);
|
||||
return 0;
|
||||
}
|
||||
|
||||
if ((ret = uvc_queue_enable(&video->queue, 1)) < 0)
|
||||
return ret;
|
||||
|
||||
return uvc_init_video(video);
|
||||
}
|
796
drivers/media/video/uvc/uvcvideo.h
Normal file
796
drivers/media/video/uvc/uvcvideo.h
Normal file
@ -0,0 +1,796 @@
|
||||
#ifndef _USB_VIDEO_H_
|
||||
#define _USB_VIDEO_H_
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/videodev2.h>
|
||||
|
||||
|
||||
/*
|
||||
* Dynamic controls
|
||||
*/
|
||||
|
||||
/* Data types for UVC control data */
|
||||
#define UVC_CTRL_DATA_TYPE_RAW 0
|
||||
#define UVC_CTRL_DATA_TYPE_SIGNED 1
|
||||
#define UVC_CTRL_DATA_TYPE_UNSIGNED 2
|
||||
#define UVC_CTRL_DATA_TYPE_BOOLEAN 3
|
||||
#define UVC_CTRL_DATA_TYPE_ENUM 4
|
||||
#define UVC_CTRL_DATA_TYPE_BITMASK 5
|
||||
|
||||
/* Control flags */
|
||||
#define UVC_CONTROL_SET_CUR (1 << 0)
|
||||
#define UVC_CONTROL_GET_CUR (1 << 1)
|
||||
#define UVC_CONTROL_GET_MIN (1 << 2)
|
||||
#define UVC_CONTROL_GET_MAX (1 << 3)
|
||||
#define UVC_CONTROL_GET_RES (1 << 4)
|
||||
#define UVC_CONTROL_GET_DEF (1 << 5)
|
||||
/* Control should be saved at suspend and restored at resume. */
|
||||
#define UVC_CONTROL_RESTORE (1 << 6)
|
||||
/* Control can be updated by the camera. */
|
||||
#define UVC_CONTROL_AUTO_UPDATE (1 << 7)
|
||||
|
||||
#define UVC_CONTROL_GET_RANGE (UVC_CONTROL_GET_CUR | UVC_CONTROL_GET_MIN | \
|
||||
UVC_CONTROL_GET_MAX | UVC_CONTROL_GET_RES | \
|
||||
UVC_CONTROL_GET_DEF)
|
||||
|
||||
struct uvc_xu_control_info {
|
||||
__u8 entity[16];
|
||||
__u8 index;
|
||||
__u8 selector;
|
||||
__u16 size;
|
||||
__u32 flags;
|
||||
};
|
||||
|
||||
struct uvc_xu_control_mapping {
|
||||
__u32 id;
|
||||
__u8 name[32];
|
||||
__u8 entity[16];
|
||||
__u8 selector;
|
||||
|
||||
__u8 size;
|
||||
__u8 offset;
|
||||
enum v4l2_ctrl_type v4l2_type;
|
||||
__u32 data_type;
|
||||
};
|
||||
|
||||
struct uvc_xu_control {
|
||||
__u8 unit;
|
||||
__u8 selector;
|
||||
__u16 size;
|
||||
__u8 __user *data;
|
||||
};
|
||||
|
||||
#define UVCIOC_CTRL_ADD _IOW('U', 1, struct uvc_xu_control_info)
|
||||
#define UVCIOC_CTRL_MAP _IOWR('U', 2, struct uvc_xu_control_mapping)
|
||||
#define UVCIOC_CTRL_GET _IOWR('U', 3, struct uvc_xu_control)
|
||||
#define UVCIOC_CTRL_SET _IOW('U', 4, struct uvc_xu_control)
|
||||
|
||||
#ifdef __KERNEL__
|
||||
|
||||
#include <linux/poll.h>
|
||||
|
||||
/* --------------------------------------------------------------------------
|
||||
* UVC constants
|
||||
*/
|
||||
|
||||
#define SC_UNDEFINED 0x00
|
||||
#define SC_VIDEOCONTROL 0x01
|
||||
#define SC_VIDEOSTREAMING 0x02
|
||||
#define SC_VIDEO_INTERFACE_COLLECTION 0x03
|
||||
|
||||
#define PC_PROTOCOL_UNDEFINED 0x00
|
||||
|
||||
#define CS_UNDEFINED 0x20
|
||||
#define CS_DEVICE 0x21
|
||||
#define CS_CONFIGURATION 0x22
|
||||
#define CS_STRING 0x23
|
||||
#define CS_INTERFACE 0x24
|
||||
#define CS_ENDPOINT 0x25
|
||||
|
||||
/* VideoControl class specific interface descriptor */
|
||||
#define VC_DESCRIPTOR_UNDEFINED 0x00
|
||||
#define VC_HEADER 0x01
|
||||
#define VC_INPUT_TERMINAL 0x02
|
||||
#define VC_OUTPUT_TERMINAL 0x03
|
||||
#define VC_SELECTOR_UNIT 0x04
|
||||
#define VC_PROCESSING_UNIT 0x05
|
||||
#define VC_EXTENSION_UNIT 0x06
|
||||
|
||||
/* VideoStreaming class specific interface descriptor */
|
||||
#define VS_UNDEFINED 0x00
|
||||
#define VS_INPUT_HEADER 0x01
|
||||
#define VS_OUTPUT_HEADER 0x02
|
||||
#define VS_STILL_IMAGE_FRAME 0x03
|
||||
#define VS_FORMAT_UNCOMPRESSED 0x04
|
||||
#define VS_FRAME_UNCOMPRESSED 0x05
|
||||
#define VS_FORMAT_MJPEG 0x06
|
||||
#define VS_FRAME_MJPEG 0x07
|
||||
#define VS_FORMAT_MPEG2TS 0x0a
|
||||
#define VS_FORMAT_DV 0x0c
|
||||
#define VS_COLORFORMAT 0x0d
|
||||
#define VS_FORMAT_FRAME_BASED 0x10
|
||||
#define VS_FRAME_FRAME_BASED 0x11
|
||||
#define VS_FORMAT_STREAM_BASED 0x12
|
||||
|
||||
/* Endpoint type */
|
||||
#define EP_UNDEFINED 0x00
|
||||
#define EP_GENERAL 0x01
|
||||
#define EP_ENDPOINT 0x02
|
||||
#define EP_INTERRUPT 0x03
|
||||
|
||||
/* Request codes */
|
||||
#define RC_UNDEFINED 0x00
|
||||
#define SET_CUR 0x01
|
||||
#define GET_CUR 0x81
|
||||
#define GET_MIN 0x82
|
||||
#define GET_MAX 0x83
|
||||
#define GET_RES 0x84
|
||||
#define GET_LEN 0x85
|
||||
#define GET_INFO 0x86
|
||||
#define GET_DEF 0x87
|
||||
|
||||
/* VideoControl interface controls */
|
||||
#define VC_CONTROL_UNDEFINED 0x00
|
||||
#define VC_VIDEO_POWER_MODE_CONTROL 0x01
|
||||
#define VC_REQUEST_ERROR_CODE_CONTROL 0x02
|
||||
|
||||
/* Terminal controls */
|
||||
#define TE_CONTROL_UNDEFINED 0x00
|
||||
|
||||
/* Selector Unit controls */
|
||||
#define SU_CONTROL_UNDEFINED 0x00
|
||||
#define SU_INPUT_SELECT_CONTROL 0x01
|
||||
|
||||
/* Camera Terminal controls */
|
||||
#define CT_CONTROL_UNDEFINED 0x00
|
||||
#define CT_SCANNING_MODE_CONTROL 0x01
|
||||
#define CT_AE_MODE_CONTROL 0x02
|
||||
#define CT_AE_PRIORITY_CONTROL 0x03
|
||||
#define CT_EXPOSURE_TIME_ABSOLUTE_CONTROL 0x04
|
||||
#define CT_EXPOSURE_TIME_RELATIVE_CONTROL 0x05
|
||||
#define CT_FOCUS_ABSOLUTE_CONTROL 0x06
|
||||
#define CT_FOCUS_RELATIVE_CONTROL 0x07
|
||||
#define CT_FOCUS_AUTO_CONTROL 0x08
|
||||
#define CT_IRIS_ABSOLUTE_CONTROL 0x09
|
||||
#define CT_IRIS_RELATIVE_CONTROL 0x0a
|
||||
#define CT_ZOOM_ABSOLUTE_CONTROL 0x0b
|
||||
#define CT_ZOOM_RELATIVE_CONTROL 0x0c
|
||||
#define CT_PANTILT_ABSOLUTE_CONTROL 0x0d
|
||||
#define CT_PANTILT_RELATIVE_CONTROL 0x0e
|
||||
#define CT_ROLL_ABSOLUTE_CONTROL 0x0f
|
||||
#define CT_ROLL_RELATIVE_CONTROL 0x10
|
||||
#define CT_PRIVACY_CONTROL 0x11
|
||||
|
||||
/* Processing Unit controls */
|
||||
#define PU_CONTROL_UNDEFINED 0x00
|
||||
#define PU_BACKLIGHT_COMPENSATION_CONTROL 0x01
|
||||
#define PU_BRIGHTNESS_CONTROL 0x02
|
||||
#define PU_CONTRAST_CONTROL 0x03
|
||||
#define PU_GAIN_CONTROL 0x04
|
||||
#define PU_POWER_LINE_FREQUENCY_CONTROL 0x05
|
||||
#define PU_HUE_CONTROL 0x06
|
||||
#define PU_SATURATION_CONTROL 0x07
|
||||
#define PU_SHARPNESS_CONTROL 0x08
|
||||
#define PU_GAMMA_CONTROL 0x09
|
||||
#define PU_WHITE_BALANCE_TEMPERATURE_CONTROL 0x0a
|
||||
#define PU_WHITE_BALANCE_TEMPERATURE_AUTO_CONTROL 0x0b
|
||||
#define PU_WHITE_BALANCE_COMPONENT_CONTROL 0x0c
|
||||
#define PU_WHITE_BALANCE_COMPONENT_AUTO_CONTROL 0x0d
|
||||
#define PU_DIGITAL_MULTIPLIER_CONTROL 0x0e
|
||||
#define PU_DIGITAL_MULTIPLIER_LIMIT_CONTROL 0x0f
|
||||
#define PU_HUE_AUTO_CONTROL 0x10
|
||||
#define PU_ANALOG_VIDEO_STANDARD_CONTROL 0x11
|
||||
#define PU_ANALOG_LOCK_STATUS_CONTROL 0x12
|
||||
|
||||
#define LXU_MOTOR_PANTILT_RELATIVE_CONTROL 0x01
|
||||
#define LXU_MOTOR_PANTILT_RESET_CONTROL 0x02
|
||||
#define LXU_MOTOR_FOCUS_MOTOR_CONTROL 0x03
|
||||
|
||||
/* VideoStreaming interface controls */
|
||||
#define VS_CONTROL_UNDEFINED 0x00
|
||||
#define VS_PROBE_CONTROL 0x01
|
||||
#define VS_COMMIT_CONTROL 0x02
|
||||
#define VS_STILL_PROBE_CONTROL 0x03
|
||||
#define VS_STILL_COMMIT_CONTROL 0x04
|
||||
#define VS_STILL_IMAGE_TRIGGER_CONTROL 0x05
|
||||
#define VS_STREAM_ERROR_CODE_CONTROL 0x06
|
||||
#define VS_GENERATE_KEY_FRAME_CONTROL 0x07
|
||||
#define VS_UPDATE_FRAME_SEGMENT_CONTROL 0x08
|
||||
#define VS_SYNC_DELAY_CONTROL 0x09
|
||||
|
||||
#define TT_VENDOR_SPECIFIC 0x0100
|
||||
#define TT_STREAMING 0x0101
|
||||
|
||||
/* Input Terminal types */
|
||||
#define ITT_VENDOR_SPECIFIC 0x0200
|
||||
#define ITT_CAMERA 0x0201
|
||||
#define ITT_MEDIA_TRANSPORT_INPUT 0x0202
|
||||
|
||||
/* Output Terminal types */
|
||||
#define OTT_VENDOR_SPECIFIC 0x0300
|
||||
#define OTT_DISPLAY 0x0301
|
||||
#define OTT_MEDIA_TRANSPORT_OUTPUT 0x0302
|
||||
|
||||
/* External Terminal types */
|
||||
#define EXTERNAL_VENDOR_SPECIFIC 0x0400
|
||||
#define COMPOSITE_CONNECTOR 0x0401
|
||||
#define SVIDEO_CONNECTOR 0x0402
|
||||
#define COMPONENT_CONNECTOR 0x0403
|
||||
|
||||
#define UVC_TERM_INPUT 0x0000
|
||||
#define UVC_TERM_OUTPUT 0x8000
|
||||
|
||||
#define UVC_ENTITY_TYPE(entity) ((entity)->type & 0x7fff)
|
||||
#define UVC_ENTITY_IS_UNIT(entity) (((entity)->type & 0xff00) == 0)
|
||||
#define UVC_ENTITY_IS_TERM(entity) (((entity)->type & 0xff00) != 0)
|
||||
#define UVC_ENTITY_IS_ITERM(entity) \
|
||||
(((entity)->type & 0x8000) == UVC_TERM_INPUT)
|
||||
#define UVC_ENTITY_IS_OTERM(entity) \
|
||||
(((entity)->type & 0x8000) == UVC_TERM_OUTPUT)
|
||||
|
||||
#define UVC_STATUS_TYPE_CONTROL 1
|
||||
#define UVC_STATUS_TYPE_STREAMING 2
|
||||
|
||||
/* ------------------------------------------------------------------------
|
||||
* GUIDs
|
||||
*/
|
||||
#define UVC_GUID_UVC_CAMERA \
|
||||
{0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, \
|
||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01}
|
||||
#define UVC_GUID_UVC_OUTPUT \
|
||||
{0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, \
|
||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02}
|
||||
#define UVC_GUID_UVC_MEDIA_TRANSPORT_INPUT \
|
||||
{0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, \
|
||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x03}
|
||||
#define UVC_GUID_UVC_PROCESSING \
|
||||
{0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, \
|
||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x01}
|
||||
#define UVC_GUID_UVC_SELECTOR \
|
||||
{0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, \
|
||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x02}
|
||||
|
||||
#define UVC_GUID_LOGITECH_DEV_INFO \
|
||||
{0x82, 0x06, 0x61, 0x63, 0x70, 0x50, 0xab, 0x49, \
|
||||
0xb8, 0xcc, 0xb3, 0x85, 0x5e, 0x8d, 0x22, 0x1e}
|
||||
#define UVC_GUID_LOGITECH_USER_HW \
|
||||
{0x82, 0x06, 0x61, 0x63, 0x70, 0x50, 0xab, 0x49, \
|
||||
0xb8, 0xcc, 0xb3, 0x85, 0x5e, 0x8d, 0x22, 0x1f}
|
||||
#define UVC_GUID_LOGITECH_VIDEO \
|
||||
{0x82, 0x06, 0x61, 0x63, 0x70, 0x50, 0xab, 0x49, \
|
||||
0xb8, 0xcc, 0xb3, 0x85, 0x5e, 0x8d, 0x22, 0x50}
|
||||
#define UVC_GUID_LOGITECH_MOTOR \
|
||||
{0x82, 0x06, 0x61, 0x63, 0x70, 0x50, 0xab, 0x49, \
|
||||
0xb8, 0xcc, 0xb3, 0x85, 0x5e, 0x8d, 0x22, 0x56}
|
||||
|
||||
#define UVC_GUID_FORMAT_MJPEG \
|
||||
{ 'M', 'J', 'P', 'G', 0x00, 0x00, 0x10, 0x00, \
|
||||
0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71}
|
||||
#define UVC_GUID_FORMAT_YUY2 \
|
||||
{ 'Y', 'U', 'Y', '2', 0x00, 0x00, 0x10, 0x00, \
|
||||
0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71}
|
||||
#define UVC_GUID_FORMAT_NV12 \
|
||||
{ 'N', 'V', '1', '2', 0x00, 0x00, 0x10, 0x00, \
|
||||
0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71}
|
||||
#define UVC_GUID_FORMAT_YV12 \
|
||||
{ 'Y', 'V', '1', '2', 0x00, 0x00, 0x10, 0x00, \
|
||||
0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71}
|
||||
#define UVC_GUID_FORMAT_I420 \
|
||||
{ 'I', '4', '2', '0', 0x00, 0x00, 0x10, 0x00, \
|
||||
0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71}
|
||||
#define UVC_GUID_FORMAT_UYVY \
|
||||
{ 'U', 'Y', 'V', 'Y', 0x00, 0x00, 0x10, 0x00, \
|
||||
0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71}
|
||||
#define UVC_GUID_FORMAT_Y800 \
|
||||
{ 'Y', '8', '0', '0', 0x00, 0x00, 0x10, 0x00, \
|
||||
0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71}
|
||||
#define UVC_GUID_FORMAT_BY8 \
|
||||
{ 'B', 'Y', '8', ' ', 0x00, 0x00, 0x10, 0x00, \
|
||||
0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71}
|
||||
|
||||
|
||||
/* ------------------------------------------------------------------------
|
||||
* Driver specific constants.
|
||||
*/
|
||||
|
||||
#define DRIVER_VERSION_NUMBER KERNEL_VERSION(0, 1, 0)
|
||||
|
||||
/* Number of isochronous URBs. */
|
||||
#define UVC_URBS 5
|
||||
/* Maximum number of packets per isochronous URB. */
|
||||
#define UVC_MAX_ISO_PACKETS 40
|
||||
/* Maximum frame size in bytes, for sanity checking. */
|
||||
#define UVC_MAX_FRAME_SIZE (16*1024*1024)
|
||||
/* Maximum number of video buffers. */
|
||||
#define UVC_MAX_VIDEO_BUFFERS 32
|
||||
|
||||
#define UVC_CTRL_CONTROL_TIMEOUT 300
|
||||
#define UVC_CTRL_STREAMING_TIMEOUT 1000
|
||||
|
||||
/* Devices quirks */
|
||||
#define UVC_QUIRK_STATUS_INTERVAL 0x00000001
|
||||
#define UVC_QUIRK_PROBE_MINMAX 0x00000002
|
||||
#define UVC_QUIRK_PROBE_EXTRAFIELDS 0x00000004
|
||||
#define UVC_QUIRK_BUILTIN_ISIGHT 0x00000008
|
||||
#define UVC_QUIRK_STREAM_NO_FID 0x00000010
|
||||
#define UVC_QUIRK_IGNORE_SELECTOR_UNIT 0x00000020
|
||||
|
||||
/* Format flags */
|
||||
#define UVC_FMT_FLAG_COMPRESSED 0x00000001
|
||||
#define UVC_FMT_FLAG_STREAM 0x00000002
|
||||
|
||||
/* ------------------------------------------------------------------------
|
||||
* Structures.
|
||||
*/
|
||||
|
||||
struct uvc_device;
|
||||
|
||||
/* TODO: Put the most frequently accessed fields at the beginning of
|
||||
* structures to maximize cache efficiency.
|
||||
*/
|
||||
struct uvc_streaming_control {
|
||||
__u16 bmHint;
|
||||
__u8 bFormatIndex;
|
||||
__u8 bFrameIndex;
|
||||
__u32 dwFrameInterval;
|
||||
__u16 wKeyFrameRate;
|
||||
__u16 wPFrameRate;
|
||||
__u16 wCompQuality;
|
||||
__u16 wCompWindowSize;
|
||||
__u16 wDelay;
|
||||
__u32 dwMaxVideoFrameSize;
|
||||
__u32 dwMaxPayloadTransferSize;
|
||||
__u32 dwClockFrequency;
|
||||
__u8 bmFramingInfo;
|
||||
__u8 bPreferedVersion;
|
||||
__u8 bMinVersion;
|
||||
__u8 bMaxVersion;
|
||||
};
|
||||
|
||||
struct uvc_menu_info {
|
||||
__u32 value;
|
||||
__u8 name[32];
|
||||
};
|
||||
|
||||
struct uvc_control_info {
|
||||
struct list_head list;
|
||||
struct list_head mappings;
|
||||
|
||||
__u8 entity[16];
|
||||
__u8 index;
|
||||
__u8 selector;
|
||||
|
||||
__u16 size;
|
||||
__u32 flags;
|
||||
};
|
||||
|
||||
struct uvc_control_mapping {
|
||||
struct list_head list;
|
||||
|
||||
struct uvc_control_info *ctrl;
|
||||
|
||||
__u32 id;
|
||||
__u8 name[32];
|
||||
__u8 entity[16];
|
||||
__u8 selector;
|
||||
|
||||
__u8 size;
|
||||
__u8 offset;
|
||||
enum v4l2_ctrl_type v4l2_type;
|
||||
__u32 data_type;
|
||||
|
||||
struct uvc_menu_info *menu_info;
|
||||
__u32 menu_count;
|
||||
};
|
||||
|
||||
struct uvc_control {
|
||||
struct uvc_entity *entity;
|
||||
struct uvc_control_info *info;
|
||||
|
||||
__u8 index; /* Used to match the uvc_control entry with a
|
||||
uvc_control_info. */
|
||||
__u8 dirty : 1,
|
||||
loaded : 1,
|
||||
modified : 1;
|
||||
|
||||
__u8 *data;
|
||||
};
|
||||
|
||||
struct uvc_format_desc {
|
||||
char *name;
|
||||
__u8 guid[16];
|
||||
__u32 fcc;
|
||||
};
|
||||
|
||||
/* The term 'entity' refers to both UVC units and UVC terminals.
|
||||
*
|
||||
* The type field is either the terminal type (wTerminalType in the terminal
|
||||
* descriptor), or the unit type (bDescriptorSubtype in the unit descriptor).
|
||||
* As the bDescriptorSubtype field is one byte long, the type value will
|
||||
* always have a null MSB for units. All terminal types defined by the UVC
|
||||
* specification have a non-null MSB, so it is safe to use the MSB to
|
||||
* differentiate between units and terminals as long as the descriptor parsing
|
||||
* code makes sure terminal types have a non-null MSB.
|
||||
*
|
||||
* For terminals, the type's most significant bit stores the terminal
|
||||
* direction (either UVC_TERM_INPUT or UVC_TERM_OUTPUT). The type field should
|
||||
* always be accessed with the UVC_ENTITY_* macros and never directly.
|
||||
*/
|
||||
|
||||
struct uvc_entity {
|
||||
struct list_head list; /* Entity as part of a UVC device. */
|
||||
struct list_head chain; /* Entity as part of a video device
|
||||
* chain. */
|
||||
__u8 id;
|
||||
__u16 type;
|
||||
char name[64];
|
||||
|
||||
union {
|
||||
struct {
|
||||
__u16 wObjectiveFocalLengthMin;
|
||||
__u16 wObjectiveFocalLengthMax;
|
||||
__u16 wOcularFocalLength;
|
||||
__u8 bControlSize;
|
||||
__u8 *bmControls;
|
||||
} camera;
|
||||
|
||||
struct {
|
||||
__u8 bControlSize;
|
||||
__u8 *bmControls;
|
||||
__u8 bTransportModeSize;
|
||||
__u8 *bmTransportModes;
|
||||
} media;
|
||||
|
||||
struct {
|
||||
__u8 bSourceID;
|
||||
} output;
|
||||
|
||||
struct {
|
||||
__u8 bSourceID;
|
||||
__u16 wMaxMultiplier;
|
||||
__u8 bControlSize;
|
||||
__u8 *bmControls;
|
||||
__u8 bmVideoStandards;
|
||||
} processing;
|
||||
|
||||
struct {
|
||||
__u8 bNrInPins;
|
||||
__u8 *baSourceID;
|
||||
} selector;
|
||||
|
||||
struct {
|
||||
__u8 guidExtensionCode[16];
|
||||
__u8 bNumControls;
|
||||
__u8 bNrInPins;
|
||||
__u8 *baSourceID;
|
||||
__u8 bControlSize;
|
||||
__u8 *bmControls;
|
||||
__u8 *bmControlsType;
|
||||
} extension;
|
||||
};
|
||||
|
||||
unsigned int ncontrols;
|
||||
struct uvc_control *controls;
|
||||
};
|
||||
|
||||
struct uvc_frame {
|
||||
__u8 bFrameIndex;
|
||||
__u8 bmCapabilities;
|
||||
__u16 wWidth;
|
||||
__u16 wHeight;
|
||||
__u32 dwMinBitRate;
|
||||
__u32 dwMaxBitRate;
|
||||
__u32 dwMaxVideoFrameBufferSize;
|
||||
__u8 bFrameIntervalType;
|
||||
__u32 dwDefaultFrameInterval;
|
||||
__u32 *dwFrameInterval;
|
||||
};
|
||||
|
||||
struct uvc_format {
|
||||
__u8 type;
|
||||
__u8 index;
|
||||
__u8 bpp;
|
||||
__u8 colorspace;
|
||||
__u32 fcc;
|
||||
__u32 flags;
|
||||
|
||||
char name[32];
|
||||
|
||||
unsigned int nframes;
|
||||
struct uvc_frame *frame;
|
||||
};
|
||||
|
||||
struct uvc_streaming_header {
|
||||
__u8 bNumFormats;
|
||||
__u8 bEndpointAddress;
|
||||
__u8 bTerminalLink;
|
||||
__u8 bControlSize;
|
||||
__u8 *bmaControls;
|
||||
/* The following fields are used by input headers only. */
|
||||
__u8 bmInfo;
|
||||
__u8 bStillCaptureMethod;
|
||||
__u8 bTriggerSupport;
|
||||
__u8 bTriggerUsage;
|
||||
};
|
||||
|
||||
struct uvc_streaming {
|
||||
struct list_head list;
|
||||
|
||||
struct usb_interface *intf;
|
||||
int intfnum;
|
||||
__u16 maxpsize;
|
||||
|
||||
struct uvc_streaming_header header;
|
||||
|
||||
unsigned int nformats;
|
||||
struct uvc_format *format;
|
||||
|
||||
struct uvc_streaming_control ctrl;
|
||||
struct uvc_format *cur_format;
|
||||
struct uvc_frame *cur_frame;
|
||||
|
||||
struct mutex mutex;
|
||||
};
|
||||
|
||||
enum uvc_buffer_state {
|
||||
UVC_BUF_STATE_IDLE = 0,
|
||||
UVC_BUF_STATE_QUEUED = 1,
|
||||
UVC_BUF_STATE_ACTIVE = 2,
|
||||
UVC_BUF_STATE_DONE = 3,
|
||||
UVC_BUF_STATE_ERROR = 4,
|
||||
};
|
||||
|
||||
struct uvc_buffer {
|
||||
unsigned long vma_use_count;
|
||||
struct list_head stream;
|
||||
|
||||
/* Touched by interrupt handler. */
|
||||
struct v4l2_buffer buf;
|
||||
struct list_head queue;
|
||||
wait_queue_head_t wait;
|
||||
enum uvc_buffer_state state;
|
||||
};
|
||||
|
||||
#define UVC_QUEUE_STREAMING (1 << 0)
|
||||
#define UVC_QUEUE_DISCONNECTED (1 << 1)
|
||||
#define UVC_QUEUE_DROP_INCOMPLETE (1 << 2)
|
||||
|
||||
struct uvc_video_queue {
|
||||
void *mem;
|
||||
unsigned int flags;
|
||||
__u32 sequence;
|
||||
|
||||
unsigned int count;
|
||||
unsigned int buf_size;
|
||||
struct uvc_buffer buffer[UVC_MAX_VIDEO_BUFFERS];
|
||||
struct mutex mutex; /* protects buffers and mainqueue */
|
||||
spinlock_t irqlock; /* protects irqqueue */
|
||||
|
||||
struct list_head mainqueue;
|
||||
struct list_head irqqueue;
|
||||
};
|
||||
|
||||
struct uvc_video_device {
|
||||
struct uvc_device *dev;
|
||||
struct video_device *vdev;
|
||||
atomic_t active;
|
||||
unsigned int frozen : 1;
|
||||
|
||||
struct list_head iterms;
|
||||
struct uvc_entity *oterm;
|
||||
struct uvc_entity *processing;
|
||||
struct uvc_entity *selector;
|
||||
struct list_head extensions;
|
||||
struct mutex ctrl_mutex;
|
||||
|
||||
struct uvc_video_queue queue;
|
||||
|
||||
/* Video streaming object, must always be non-NULL. */
|
||||
struct uvc_streaming *streaming;
|
||||
|
||||
void (*decode) (struct urb *urb, struct uvc_video_device *video,
|
||||
struct uvc_buffer *buf);
|
||||
|
||||
/* Context data used by the bulk completion handler. */
|
||||
struct {
|
||||
__u8 header[256];
|
||||
unsigned int header_size;
|
||||
int skip_payload;
|
||||
__u32 payload_size;
|
||||
__u32 max_payload_size;
|
||||
} bulk;
|
||||
|
||||
struct urb *urb[UVC_URBS];
|
||||
char *urb_buffer[UVC_URBS];
|
||||
|
||||
__u8 last_fid;
|
||||
};
|
||||
|
||||
enum uvc_device_state {
|
||||
UVC_DEV_DISCONNECTED = 1,
|
||||
};
|
||||
|
||||
struct uvc_device {
|
||||
struct usb_device *udev;
|
||||
struct usb_interface *intf;
|
||||
__u32 quirks;
|
||||
int intfnum;
|
||||
char name[32];
|
||||
|
||||
enum uvc_device_state state;
|
||||
struct kref kref;
|
||||
struct list_head list;
|
||||
|
||||
/* Video control interface */
|
||||
__u16 uvc_version;
|
||||
__u32 clock_frequency;
|
||||
|
||||
struct list_head entities;
|
||||
|
||||
struct uvc_video_device video;
|
||||
|
||||
/* Status Interrupt Endpoint */
|
||||
struct usb_host_endpoint *int_ep;
|
||||
struct urb *int_urb;
|
||||
__u8 status[16];
|
||||
struct input_dev *input;
|
||||
|
||||
/* Video Streaming interfaces */
|
||||
struct list_head streaming;
|
||||
};
|
||||
|
||||
enum uvc_handle_state {
|
||||
UVC_HANDLE_PASSIVE = 0,
|
||||
UVC_HANDLE_ACTIVE = 1,
|
||||
};
|
||||
|
||||
struct uvc_fh {
|
||||
struct uvc_video_device *device;
|
||||
enum uvc_handle_state state;
|
||||
};
|
||||
|
||||
struct uvc_driver {
|
||||
struct usb_driver driver;
|
||||
|
||||
struct mutex open_mutex; /* protects from open/disconnect race */
|
||||
|
||||
struct list_head devices; /* struct uvc_device list */
|
||||
struct list_head controls; /* struct uvc_control_info list */
|
||||
struct mutex ctrl_mutex; /* protects controls and devices
|
||||
lists */
|
||||
};
|
||||
|
||||
/* ------------------------------------------------------------------------
|
||||
* Debugging, printing and logging
|
||||
*/
|
||||
|
||||
#define UVC_TRACE_PROBE (1 << 0)
|
||||
#define UVC_TRACE_DESCR (1 << 1)
|
||||
#define UVC_TRACE_CONTROL (1 << 2)
|
||||
#define UVC_TRACE_FORMAT (1 << 3)
|
||||
#define UVC_TRACE_CAPTURE (1 << 4)
|
||||
#define UVC_TRACE_CALLS (1 << 5)
|
||||
#define UVC_TRACE_IOCTL (1 << 6)
|
||||
#define UVC_TRACE_FRAME (1 << 7)
|
||||
#define UVC_TRACE_SUSPEND (1 << 8)
|
||||
#define UVC_TRACE_STATUS (1 << 9)
|
||||
|
||||
extern unsigned int uvc_trace_param;
|
||||
|
||||
#define uvc_trace(flag, msg...) \
|
||||
do { \
|
||||
if (uvc_trace_param & flag) \
|
||||
printk(KERN_DEBUG "uvcvideo: " msg); \
|
||||
} while (0)
|
||||
|
||||
#define uvc_printk(level, msg...) \
|
||||
printk(level "uvcvideo: " msg)
|
||||
|
||||
#define UVC_GUID_FORMAT "%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x-" \
|
||||
"%02x%02x%02x%02x%02x%02x"
|
||||
#define UVC_GUID_ARGS(guid) \
|
||||
(guid)[3], (guid)[2], (guid)[1], (guid)[0], \
|
||||
(guid)[5], (guid)[4], \
|
||||
(guid)[7], (guid)[6], \
|
||||
(guid)[8], (guid)[9], \
|
||||
(guid)[10], (guid)[11], (guid)[12], \
|
||||
(guid)[13], (guid)[14], (guid)[15]
|
||||
|
||||
/* --------------------------------------------------------------------------
|
||||
* Internal functions.
|
||||
*/
|
||||
|
||||
/* Core driver */
|
||||
extern struct uvc_driver uvc_driver;
|
||||
extern void uvc_delete(struct kref *kref);
|
||||
|
||||
/* Video buffers queue management. */
|
||||
extern void uvc_queue_init(struct uvc_video_queue *queue);
|
||||
extern int uvc_alloc_buffers(struct uvc_video_queue *queue,
|
||||
unsigned int nbuffers, unsigned int buflength);
|
||||
extern int uvc_free_buffers(struct uvc_video_queue *queue);
|
||||
extern int uvc_query_buffer(struct uvc_video_queue *queue,
|
||||
struct v4l2_buffer *v4l2_buf);
|
||||
extern int uvc_queue_buffer(struct uvc_video_queue *queue,
|
||||
struct v4l2_buffer *v4l2_buf);
|
||||
extern int uvc_dequeue_buffer(struct uvc_video_queue *queue,
|
||||
struct v4l2_buffer *v4l2_buf, int nonblocking);
|
||||
extern int uvc_queue_enable(struct uvc_video_queue *queue, int enable);
|
||||
extern void uvc_queue_cancel(struct uvc_video_queue *queue, int disconnect);
|
||||
extern struct uvc_buffer *uvc_queue_next_buffer(struct uvc_video_queue *queue,
|
||||
struct uvc_buffer *buf);
|
||||
extern unsigned int uvc_queue_poll(struct uvc_video_queue *queue,
|
||||
struct file *file, poll_table *wait);
|
||||
static inline int uvc_queue_streaming(struct uvc_video_queue *queue)
|
||||
{
|
||||
return queue->flags & UVC_QUEUE_STREAMING;
|
||||
}
|
||||
|
||||
/* V4L2 interface */
|
||||
extern struct file_operations uvc_fops;
|
||||
|
||||
/* Video */
|
||||
extern int uvc_video_init(struct uvc_video_device *video);
|
||||
extern int uvc_video_suspend(struct uvc_video_device *video);
|
||||
extern int uvc_video_resume(struct uvc_video_device *video);
|
||||
extern int uvc_video_enable(struct uvc_video_device *video, int enable);
|
||||
extern int uvc_probe_video(struct uvc_video_device *video,
|
||||
struct uvc_streaming_control *probe);
|
||||
extern int uvc_query_ctrl(struct uvc_device *dev, __u8 query, __u8 unit,
|
||||
__u8 intfnum, __u8 cs, void *data, __u16 size);
|
||||
extern int uvc_set_video_ctrl(struct uvc_video_device *video,
|
||||
struct uvc_streaming_control *ctrl, int probe);
|
||||
|
||||
/* Status */
|
||||
extern int uvc_status_init(struct uvc_device *dev);
|
||||
extern void uvc_status_cleanup(struct uvc_device *dev);
|
||||
extern int uvc_status_suspend(struct uvc_device *dev);
|
||||
extern int uvc_status_resume(struct uvc_device *dev);
|
||||
|
||||
/* Controls */
|
||||
extern struct uvc_control *uvc_find_control(struct uvc_video_device *video,
|
||||
__u32 v4l2_id, struct uvc_control_mapping **mapping);
|
||||
extern int uvc_query_v4l2_ctrl(struct uvc_video_device *video,
|
||||
struct v4l2_queryctrl *v4l2_ctrl);
|
||||
|
||||
extern int uvc_ctrl_add_info(struct uvc_control_info *info);
|
||||
extern int uvc_ctrl_add_mapping(struct uvc_control_mapping *mapping);
|
||||
extern int uvc_ctrl_init_device(struct uvc_device *dev);
|
||||
extern void uvc_ctrl_cleanup_device(struct uvc_device *dev);
|
||||
extern int uvc_ctrl_resume_device(struct uvc_device *dev);
|
||||
extern void uvc_ctrl_init(void);
|
||||
|
||||
extern int uvc_ctrl_begin(struct uvc_video_device *video);
|
||||
extern int __uvc_ctrl_commit(struct uvc_video_device *video, int rollback);
|
||||
static inline int uvc_ctrl_commit(struct uvc_video_device *video)
|
||||
{
|
||||
return __uvc_ctrl_commit(video, 0);
|
||||
}
|
||||
static inline int uvc_ctrl_rollback(struct uvc_video_device *video)
|
||||
{
|
||||
return __uvc_ctrl_commit(video, 1);
|
||||
}
|
||||
|
||||
extern int uvc_ctrl_get(struct uvc_video_device *video,
|
||||
struct v4l2_ext_control *xctrl);
|
||||
extern int uvc_ctrl_set(struct uvc_video_device *video,
|
||||
struct v4l2_ext_control *xctrl);
|
||||
|
||||
extern int uvc_xu_ctrl_query(struct uvc_video_device *video,
|
||||
struct uvc_xu_control *ctrl, int set);
|
||||
|
||||
/* Utility functions */
|
||||
extern void uvc_simplify_fraction(uint32_t *numerator, uint32_t *denominator,
|
||||
unsigned int n_terms, unsigned int threshold);
|
||||
extern uint32_t uvc_fraction_to_interval(uint32_t numerator,
|
||||
uint32_t denominator);
|
||||
extern struct usb_host_endpoint *uvc_find_endpoint(
|
||||
struct usb_host_interface *alts, __u8 epaddr);
|
||||
|
||||
/* Quirks support */
|
||||
void uvc_video_decode_isight(struct urb *urb, struct uvc_video_device *video,
|
||||
struct uvc_buffer *buf);
|
||||
|
||||
#endif /* __KERNEL__ */
|
||||
|
||||
#endif
|
Loading…
Reference in New Issue
Block a user