Merge git://git.kernel.org/pub/scm/linux/kernel/git/mchehab/v4l-dvb
* git://git.kernel.org/pub/scm/linux/kernel/git/mchehab/v4l-dvb: V4L/DVB (8178): uvc: Fix compilation breakage for the other drivers, if uvc is selected V4L/DVB (8145a): USB Video Class driver
This commit is contained in:
Linus Torvalds
Коммит
3a57a78875
|
|
@ -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
|
||||
|
|
|
|||
|
|
@ -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
|
||||
Разница между файлами не показана из-за своего большого размера
Загрузить разницу
Разница между файлами не показана из-за своего большого размера
Загрузить разницу
|
|
@ -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);
|
||||
}
|
||||
}
|
||||
|
|
@ -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;
|
||||
}
|
||||
|
|
@ -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);
|
||||
}
|
||||
Разница между файлами не показана из-за своего большого размера
Загрузить разницу
|
|
@ -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);
|
||||
}
|
||||
|
|
@ -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
|
||||
Загрузка…
Ссылка в новой задаче