[New Driver]: usbvideo2 webcam core + pac207 driver using it.
by Hans de Goede
<Sorry, this time with attachments>
Hi All,
As explained in my introduction mail I've been working on a standalone v4l2
driver for pac207 based usb webcams. I've attached the hopefully pretty clean
result to this mail.
This is the promised split version of the pac207 driver I've been working on, I
would like to ask everyone to take a good look at this, as I plan to base a
number of other (gspca derived) v4l2 drivers on this same core.
I'm currently posting these as .c files for easy reading and compilation /
testing, but I still hope to get a lot of feedback / a thorough review, esp of
the core <-> pac207 split version as I hope to submit that as a patch for
mainline inclusion soon.
Thanks & Regards,
Hans
obj-m += usbvideo2.o pac207.o
all:
make -C /lib/modules/$(shell uname -r)/build M=$(PWD) modules
clean:
make -C /lib/modules/$(shell uname -r)/build M=$(PWD) clean
-unlock fileop_mutex while waiting for frame in dqbuf, since when unlocked
the v4ldev could be unregistered (disconnect) this means that dqbuf should
be handled outside video2_ioctl()
/***************************************************************************
* Video4Linux2 driver for Pixart PAC207BCA Camera bridge and sensor *
* *
* Copyright (C) 2008 by Hans de Goede <j.w.r.degoede(a)hhs.nl> *
* PAC207BCA code derived from the gspca Pixart PAC207BCA library: *
* Copyright (C) 2005 Thomas Kaiser thomas(a)kaiser-linux.li *
* Copyright (C) 2005 Bertrik.Sikken *
* Copyleft (C) 2005 Michel Xhaard mxhaard(a)magic.fr *
* *
* 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. *
* *
* This program is distributed in the hope that it will be useful, *
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
* GNU General Public License for more details. *
* *
* You should have received a copy of the GNU General Public License *
* along with this program; if not, write to the Free Software *
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. *
***************************************************************************/
#include <linux/module.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/param.h>
#include <linux/errno.h>
#include <linux/slab.h>
#include <linux/device.h>
#include <linux/fs.h>
#include <linux/delay.h>
#include <linux/compiler.h>
#include <linux/ioctl.h>
#include <linux/poll.h>
#include <linux/stat.h>
#include <linux/mm.h>
#include <linux/vmalloc.h>
#include <linux/page-flags.h>
#include <linux/byteorder/generic.h>
#include <asm/page.h>
#include <asm/uaccess.h>
#include "usbvideo2.h"
/*****************************************************************************/
static __devinitdata struct usb_device_id pac207_id_table[] = {
{ USB_DEVICE(0x041E, 0x4028) }, /* Creative VistaPlus */
{ USB_DEVICE(0x093a, 0x2460) }, /* Qtec Wb100 */
{ USB_DEVICE(0x093a, 0x2463) }, /* Philips SPC220NC */
{ USB_DEVICE(0x093a, 0x2468) }, /* Generic PAC 207 */
{ USB_DEVICE(0x093a, 0x2470) }, /* Genius GF112 */
{ USB_DEVICE(0x093a, 0x2471) }, /* Genius GF111 */
{ USB_DEVICE(0x093a, 0x2472) }, /* Genius GF111 */
{ 0 }
};
/*****************************************************************************/
MODULE_DEVICE_TABLE(usb, pac207_id_table);
MODULE_AUTHOR("Hans de Goede <j.w.r.degoede(a)hhs.nl>");
MODULE_DESCRIPTION("Pixart PAC207BCA Camera Driver");
MODULE_LICENSE("GPL");
/*****************************************************************************/
#define PAC207_NAME "pac207"
#define PAC207_BRIGHTNESS_MIN 0
#define PAC207_BRIGHTNESS_MAX 255
#define PAC207_BRIGHTNESS_DEFAULT 4 /* power on default: 4 */
#define PAC207_EXPOSURE_MIN 4
#define PAC207_EXPOSURE_MAX 26
#define PAC207_EXPOSURE_DEFAULT 4 /* power on default: 3 ?? */
#define PAC207_EXPOSURE_KNEE 15
#define PAC207_GAIN_MIN 0
#define PAC207_GAIN_MAX 31
#define PAC207_GAIN_DEFAULT 9 /* power on default: 9 */
#define PAC207_GAIN_KNEE 20
#define PAC207_AUTOGAIN_DEADZONE 10
/* We calculating the autogain at the end of the transfer of a frame, at this
moment a frame with the old settings is being transmitted, and a frame is
being captured with the old settings. So if we adjust the autogain we must
ignore atleast the 2 next frames for the new settings to come into effect
before doing any other adjustments */
#define PAC207_AUTOGAIN_IGNORE_FRAMES 3
#define PAC207_DEFAULT_READBUFFERS 3
/*****************************************************************************/
enum pac207_line_state {
LINE_HEADER1,
LINE_HEADER2,
LINE_UNCOMPRESSED,
LINE_COMPRESSED,
};
struct pac207_decompress_table_t {
u8 is_abs;
u8 len;
s8 val;
};
struct pac207_decoder_state {
u16 line_read;
u16 line_marker;
u8 line_state;
u8 header_read;
u8 remaining_bits;
s8 no_remaining_bits;
u8 get_abs;
u8 discard_byte;
};
struct pac207_data {
struct pac207_decoder_state decoder_state;
u8 mode;
u8 brightness;
u8 exposure;
u8 autogain;
u8 gain;
u8 sof_read;
u8 autogain_ignore_frames;
atomic_t avg_lum;
};
static const char pac207_sof_marker[5] = { 0xFF, 0xFF, 0x00, 0xFF, 0x96 };
static const u8 pac207_sensor_init[][8] = {
{0x10, 0x12, 0x0d, 0x12, 0x0c, 0x01, 0x29, 0xf0}, /* 2 */
/* {0x10, 0x24, 0x06, 0x12, 0x0c, 0x01, 0x29, 0xf0}, ** 2 increase the times exposure decrease frame rate */
{0x00, 0x64, 0x64, 0x64, 0x04, 0x10, 0xF0, 0x30}, /* a reg_10 digital gain Red Green Blue Ggain */
{0x00, 0x00, 0x00, 0x70, 0xA0, 0xF8, 0x00, 0x00}, /* 12 */
{0x00, 0x00, 0x32, 0x00, 0x96, 0x00, 0xA2, 0x02}, /* 40 */
{0x32, 0x00, 0x96, 0x00, 0xA2, 0x02, 0xAF, 0x00}, /* 42 reg_66 rate control */
};
static const u8 PacReg72[] = { 0x00, 0x00, 0x36, 0x00 }; /* 48 reg_72 Rate Control end BalSize_4a =0x36 */
static const struct v4l2_pix_format pac207_pix_fmt[2] = { {
.width = 352,
.height = 288,
.pixelformat = V4L2_PIX_FMT_SBGGR8,
.field = V4L2_FIELD_NONE,
.bytesperline = 0,
.sizeimage = 352 * 288,
.colorspace = V4L2_COLORSPACE_SRGB,
.priv = 8,
}, {
.width = 176,
.height = 144,
.pixelformat = V4L2_PIX_FMT_SBGGR8,
.field = V4L2_FIELD_NONE,
.bytesperline = 0,
.sizeimage = 176 * 144,
.colorspace = V4L2_COLORSPACE_SRGB,
.priv = 8,
} };
static struct pac207_decompress_table_t pac207_decompress_table[256];
/*****************************************************************************/
int pac207_write_regs(struct usbvideo2_device* cam, u16 index,
const u8 *buffer, u16 length)
{
struct usb_device* udev = cam->usbdev;
int err = 0;
u8 *kbuffer;
kbuffer = (u8 *) kmalloc(length, GFP_KERNEL);
if (!kbuffer) {
DBG(1, "Not enough memory");
return -ENOMEM;
}
memcpy(kbuffer, buffer, length);
err = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x01,
USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
0x00, index, kbuffer, length, USBVIDEO2_CTRL_TIMEOUT);
if (err < 0)
DBG(1, "Failed to write registers to index 0x%04X, error %d)",
index, err);
kfree(kbuffer);
return err;
}
int pac207_write_reg(struct usbvideo2_device* cam, u16 index, u16 value)
{
struct usb_device* udev = cam->usbdev;
int err;
err = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x00,
USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
value, index, NULL, 0, USBVIDEO2_CTRL_TIMEOUT);
if (err && err != -ENODEV)
DBG(1, "Failed to write a register (index 0x%04X, "
"value 0x%02X, error %d)",index, value, err);
return err;
}
int pac207_read_reg(struct usbvideo2_device* cam, u16 index)
{
struct usb_device* udev = cam->usbdev;
u8* buff = cam->control_buffer;
int res;
res = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), 0x00,
USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
0x00, index, buff, 1, USBVIDEO2_CTRL_TIMEOUT);
if (res < 0)
DBG(1, "Failed to read a register (index 0x%04X, error %d)",
index, res);
return (res >= 0) ? (int)(*buff) : res;
}
/*****************************************************************************/
/* auto gain and exposure algorithm based on the knee algorithm described here:
http://ytse.tricolour.net/docs/LowLightOptimization.html */
static void pac207_do_auto_gain(struct usbvideo2_device* cam)
{
int i, steps, desired_avg_lum;
struct pac207_data *data = cam->cam_data;
int orig_gain = data->gain;
int orig_exposure = data->exposure;
int avg_lum = atomic_read(&data->avg_lum);
if (!data->autogain || avg_lum == -1)
return;
if (data->autogain_ignore_frames > 0) {
data->autogain_ignore_frames--;
return;
}
/* correct desired lumination for the configured brightness */
desired_avg_lum = 100 + data->brightness / 2;
/* If we are of a multiple of deadzone, do multiple step to reach the
desired lumination fast (with the risc of a slight overshoot */
steps = abs(desired_avg_lum - avg_lum) / PAC207_AUTOGAIN_DEADZONE;
for (i = 0; i < steps; i++) {
if (avg_lum > desired_avg_lum) {
if (data->gain > PAC207_GAIN_KNEE) {
data->gain--;
} else if (data->exposure > PAC207_EXPOSURE_KNEE) {
data->exposure--;
} else if (data->gain > PAC207_GAIN_DEFAULT) {
data->gain--;
} else if (data->exposure > PAC207_EXPOSURE_MIN) {
data->exposure--;
} else if (data->gain > PAC207_GAIN_MIN) {
data->gain--;
} else
break;
} else {
if (data->gain < PAC207_GAIN_DEFAULT) {
data->gain++;
} else if (data->exposure < PAC207_EXPOSURE_KNEE) {
data->exposure++;
} else if (data->gain < PAC207_GAIN_KNEE) {
data->gain++;
} else if (data->exposure < PAC207_EXPOSURE_MAX) {
data->exposure++;
} else if (data->gain < PAC207_GAIN_MAX) {
data->gain++;
} else
break;
}
}
if (data->exposure != orig_exposure || data->gain != orig_gain) {
if (data->exposure != orig_exposure)
pac207_write_reg(cam, 0x0002, data->exposure);
else
pac207_write_reg(cam, 0x000e, data->gain);
pac207_write_reg(cam, 0x13, 0x01); /* load registers to sen. */
pac207_write_reg(cam, 0x1c, 0x01); /* not documented */
data->autogain_ignore_frames = PAC207_AUTOGAIN_IGNORE_FRAMES;
}
}
/*****************************************************************************/
static u8 *pac207_find_sof(struct usbvideo2_device* cam, u8 *m,
unsigned int len, int repeat)
{
struct pac207_data *data = cam->cam_data;
unsigned int i;
/* Search for the SOF marker (fixed part) in the header */
for (i = 0; i < len; i++) {
if (m[i] == pac207_sof_marker[data->sof_read]) {
data->sof_read++;
if (data->sof_read == sizeof(pac207_sof_marker)) {
DBG(3, "SOF found, bytes to analyze: %u. Frame"
"starts at byte #%u", len, i + 1);
data->sof_read = 0;
return m + i + 1;
}
} else
data->sof_read = 0;
}
return NULL;
}
#define CLIP(color) (unsigned char)(((color)>0xFF)?0xff:(((color)<0)?0:(color)))
/* Note len is deliberately signed here, where it is unsigned everywhere else
as it gets compared with the signed bitpos and can even become negative! */
static int pac207_decompress_row(struct usbvideo2_device* cam,
struct usbvideo2_frame_t* f, u8 *cdata, int len)
{
struct pac207_data *data = cam->cam_data;
const struct v4l2_pix_format *pix_format = &pac207_pix_fmt[data->mode];
struct pac207_decoder_state *decoder_state = &data->decoder_state;
u8 *outp = f->bufmem + f->buf.bytesused;
int val, bitlen, bitpos = -decoder_state->no_remaining_bits;
u8 code;
/* first two pixels are stored as raw 8-bit */
while (decoder_state->line_read < 2) {
*outp++ = *cdata++;
decoder_state->line_read++;
len--;
if (len == 0)
goto decompress_exit;
}
while (decoder_state->line_read < pix_format->width) {
if (bitpos < 0) {
code = decoder_state->remaining_bits << (8 + bitpos) |
cdata[0] >> -bitpos;
} else {
u8 *addr = cdata + bitpos / 8;
code = addr[0] << (bitpos & 7) |
addr[1] >> (8 - (bitpos & 7));
}
bitlen = decoder_state->get_abs ?
6 : pac207_decompress_table[code].len;
/* Stop decompressing if we're out of input data */
if ((bitpos + bitlen) > (len * 8))
break;
if (decoder_state->get_abs) {
*outp++ = code & 0xFC;
decoder_state->line_read++;
decoder_state->get_abs = 0;
} else {
if (pac207_decompress_table[code].is_abs)
decoder_state->get_abs = 1;
else {
/* relative to left pixel */
val = outp[-2] +
pac207_decompress_table[code].val;
*outp++ = CLIP(val);
decoder_state->line_read++;
}
}
bitpos += bitlen;
}
if (decoder_state->line_read == pix_format->width) {
/* completely decompressed line, round pos to nearest word */
len -= 2 * ((bitpos + 15) / 16);
if (len < 0) {
decoder_state->discard_byte = 1;
len = 0;
}
} else {
decoder_state->remaining_bits = cdata[bitpos/8];
decoder_state->no_remaining_bits = (8 - bitpos) & 7;
len = 0;
}
decompress_exit:
f->buf.bytesused = outp - (u8 *)f->bufmem;
return len;
}
static void pac207_decode_line_init(struct usbvideo2_device* cam)
{
struct pac207_data *data = cam->cam_data;
struct pac207_decoder_state *decoder_state = &data->decoder_state;
decoder_state->line_read = 0;
decoder_state->line_state = LINE_HEADER1;
decoder_state->no_remaining_bits = 0;
decoder_state->get_abs = 0;
}
static void pac207_decode_frame_init(struct usbvideo2_device* cam)
{
struct pac207_data *data = cam->cam_data;
struct pac207_decoder_state *decoder_state = &data->decoder_state;
decoder_state->header_read = 0;
decoder_state->discard_byte = 0;
pac207_decode_line_init(cam);
}
static int pac207_decode(struct usbvideo2_device *cam,
struct usbvideo2_frame_t *f, u8 *data, unsigned int len)
{
struct pac207_data *cam_data = cam->cam_data;
struct pac207_decoder_state *decoder_state = &cam_data->decoder_state;
const struct v4l2_pix_format *pix_format =
&pac207_pix_fmt[cam_data->mode];
unsigned int needed = 0;
/* first 11 bytes after sof marker: frame header */
if (decoder_state->header_read < 11 ) {
/* get average lumination from frame header (byte 5) */
if (decoder_state->header_read < 5 ) {
needed = 5 - decoder_state->header_read;
if (len >= needed)
atomic_set(&cam_data->avg_lum, data[needed-1]);
}
/* skip the rest of the header */
needed = 11 - decoder_state->header_read;
if (len <= needed) {
decoder_state->header_read += len;
return 0;
}
data += needed;
len -= needed;
decoder_state->header_read = 11;
}
while (len) {
if (decoder_state->discard_byte) {
data++;
len--;
decoder_state->discard_byte = 0;
continue;
}
switch (decoder_state->line_state) {
case LINE_HEADER1:
decoder_state->line_marker = data[0] << 8;
decoder_state->line_state = LINE_HEADER2;
needed = 1;
break;
case LINE_HEADER2:
decoder_state->line_marker |= data[0];
switch (decoder_state->line_marker) {
case 0x0FF0:
decoder_state->line_state = LINE_UNCOMPRESSED;
break;
case 0x1EE1:
decoder_state->line_state = LINE_COMPRESSED;
break;
default:
DBG(3, "Error unknown line-header %04X",
(int)decoder_state->line_marker);
f->state = F_ERROR;
return 0;
}
needed = 1;
break;
case LINE_UNCOMPRESSED:
needed = pix_format->width - decoder_state->line_read;
if (needed > len)
needed = len;
memcpy(f->bufmem + f->buf.bytesused, data, needed);
f->buf.bytesused += needed;
decoder_state->line_read += needed;
break;
case LINE_COMPRESSED:
needed = len -
pac207_decompress_row(cam, f, data, len);
break;
}
data += needed;
len -= needed;
if (decoder_state->line_read == pix_format->width) {
if (f->buf.bytesused == cam->imagesize) {
/* eureka we've got a frame */
f->state = F_DONE;
return 1;
}
pac207_decode_line_init(cam);
}
}
return 0;
}
/*****************************************************************************/
static int pac207_start_transfer(struct usbvideo2_device* cam)
{
u8 mode;
struct pac207_data *data = cam->cam_data;
pac207_write_reg(cam, 0x0f, 0x10); /* Power control (Bit 6-0) */
pac207_write_regs(cam, 0x0002, pac207_sensor_init[0], 8);
pac207_write_regs(cam, 0x000a, pac207_sensor_init[1], 8);
pac207_write_regs(cam, 0x0012, pac207_sensor_init[2], 8);
pac207_write_regs(cam, 0x0040, pac207_sensor_init[3], 8);
pac207_write_regs(cam, 0x0042, pac207_sensor_init[4], 8);
pac207_write_regs(cam, 0x0048, PacReg72, 4);
pac207_write_reg(cam, 0x4a, 0x88); /* Compression Balance size */
pac207_write_reg(cam, 0x4b, 0x00); /* Sram test value */
pac207_write_reg(cam, 0x08, data->brightness);
pac207_write_reg(cam, 0x0e, data->gain); /* PGA global gain (Bit 4-0) */
pac207_write_reg(cam, 0x02, data->exposure); /* PXCK = 12MHz /n */
mode = 0x02; /* Image Format (Bit 0), LED (1), Compr. test mode (2) */
if (data->mode) { /* 176x144 */
mode |= 0x01;
DBG(3, "pac207_start mode 176x144");
} else /* 352x288 */
DBG(3, "pac207_start mode 352x288");
pac207_write_reg(cam, 0x41, mode);
pac207_write_reg(cam, 0x13, 0x01); /* load registers to sensor (Bit 0, auto clear) */
pac207_write_reg(cam, 0x1c, 0x01); /* not documented */
udelay(1000); /* taken from gspca */
pac207_write_reg(cam, 0x40, 0x01); /* Start ISO pipe */
data->sof_read = 0;
data->autogain_ignore_frames = 0;
atomic_set (&data->avg_lum, -1);
return 0;
}
static void pac207_stop_transfer_pre_kill_urbs(struct usbvideo2_device* cam)
{
pac207_write_reg(cam, 0x40, 0x00); /* Stop ISO pipe */
pac207_write_reg(cam, 0x41, 0x00); /* Turn of LED */
pac207_write_reg(cam, 0x0f, 0x00); /* Power Control */
}
/*****************************************************************************/
static int pac207_open(struct usbvideo2_device* cam)
{
struct pac207_data *data = cam->cam_data;
data->mode = 0;
cam->imagesize = 352 * 288;
data->brightness = PAC207_BRIGHTNESS_DEFAULT;
data->exposure = PAC207_EXPOSURE_DEFAULT;
data->gain = PAC207_GAIN_DEFAULT;
data->autogain = 1;
return 0;
}
static int
pac207_vidioc_query_ctrl(struct file *file, void *fh, struct v4l2_queryctrl *a)
{
const struct v4l2_queryctrl qctl[] = { {
.id = V4L2_CID_BRIGHTNESS,
.type = V4L2_CTRL_TYPE_INTEGER,
.name = "brightness",
.minimum = PAC207_BRIGHTNESS_MIN,
.maximum = PAC207_BRIGHTNESS_MAX,
.step = 1,
.default_value = PAC207_BRIGHTNESS_DEFAULT,
.flags = 0,
}, {
.id = V4L2_CID_EXPOSURE,
.type = V4L2_CTRL_TYPE_INTEGER,
.name = "exposure",
.minimum = PAC207_EXPOSURE_MIN,
.maximum = PAC207_EXPOSURE_MAX,
.step = 1,
.default_value = PAC207_EXPOSURE_DEFAULT,
.flags = 0,
}, {
.id = V4L2_CID_AUTOGAIN,
.type = V4L2_CTRL_TYPE_BOOLEAN,
.name = "autogain",
.minimum = 0,
.maximum = 1,
.step = 1,
.default_value = 1,
.flags = 0,
}, {
.id = V4L2_CID_GAIN,
.type = V4L2_CTRL_TYPE_INTEGER,
.name = "gain",
.minimum = PAC207_GAIN_MIN,
.maximum = PAC207_GAIN_MAX,
.step = 1,
.default_value = PAC207_GAIN_DEFAULT,
.flags = 0,
} };
int i;
for (i = 0; i < ARRAY_SIZE(qctl); i++)
if (qctl[i].id == a->id) {
memcpy(a, &qctl[i], sizeof(qctl[0]));
return 0;
}
return -EINVAL;
}
static int
pac207_vidioc_g_ctrl(struct file *file, void *fh, struct v4l2_control *a)
{
struct usbvideo2_device* cam = fh;
struct pac207_data *data = cam->cam_data;
switch (a->id) {
case V4L2_CID_BRIGHTNESS:
a->value = data->brightness;
break;
case V4L2_CID_EXPOSURE:
a->value = data->exposure;
break;
case V4L2_CID_AUTOGAIN:
a->value = data->autogain;
break;
case V4L2_CID_GAIN:
a->value = data->gain;
break;
default:
return -EINVAL;
}
return 0;
}
static int
pac207_vidioc_s_ctrl(struct file *file, void *fh, struct v4l2_control *a)
{
struct usbvideo2_device* cam = fh;
struct pac207_data *data = cam->cam_data;
int new_value = a->value;
int err;
if ((err = pac207_vidioc_g_ctrl(file, fh, a)))
return err;
if (a->value == new_value)
return 0;
/* don't allow mucking with gain / exposure when using autogain */
if (data->autogain && (a->id == V4L2_CID_GAIN ||
a->id == V4L2_CID_EXPOSURE))
return -EINVAL;
switch (a->id) {
case V4L2_CID_BRIGHTNESS:
data->brightness = new_value;
pac207_write_reg(cam, 0x0008, data->brightness);
/* give brightness change time to take effect before
doing autogain based on the new brightness */
data->autogain_ignore_frames =
PAC207_AUTOGAIN_IGNORE_FRAMES;
break;
case V4L2_CID_EXPOSURE:
data->exposure = new_value;
pac207_write_reg(cam, 0x0002, data->exposure);
break;
case V4L2_CID_AUTOGAIN:
data->autogain = new_value;
/* when switching to autogain set defaults to make sure
we are on a valid point of the autogain gain /
exposure knee graph, and give this change time to
take effect before doing autogain. */
if (data->autogain) {
data->exposure = PAC207_EXPOSURE_DEFAULT;
data->gain = PAC207_GAIN_DEFAULT;
data->autogain_ignore_frames =
PAC207_AUTOGAIN_IGNORE_FRAMES;
pac207_write_reg(cam, 0x0002, data->exposure);
pac207_write_reg(cam, 0x000e, data->gain);
}
break;
case V4L2_CID_GAIN:
data->gain = new_value;
pac207_write_reg(cam, 0x000e, data->gain);
break;
/* no default needed already checked in pac207_vidioc_g_ctrl */
}
pac207_write_reg(cam, 0x13, 0x01); /* load registers to sensor */
pac207_write_reg(cam, 0x1c, 0x01); /* not documented */
return 0;
}
static int
pac207_vidioc_enum_fmt_cap(struct file *file, void *fh, struct v4l2_fmtdesc *f)
{
if (f->index != 0)
return -EINVAL;
f->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
f->flags = 0;
strcpy(f->description, "bayer rgb");
f->pixelformat = V4L2_PIX_FMT_SBGGR8;
memset(&f->reserved, 0, sizeof(f->reserved));
return 0;
}
static int
pac207_vidioc_g_fmt_cap(struct file *file, void *fh, struct v4l2_format *f)
{
struct usbvideo2_device* cam = fh;
struct pac207_data *data = cam->cam_data;
memcpy(&(f->fmt.pix), &pac207_pix_fmt[data->mode],
sizeof(pac207_pix_fmt[0]));
return 0;
}
static int
pac207_vidioc_try_fmt_cap(struct file *file, void *fh, struct v4l2_format *f)
{
if (f->fmt.pix.pixelformat != V4L2_PIX_FMT_SBGGR8)
return -EINVAL;
if (f->fmt.pix.width >= 352 && f->fmt.pix.height >= 288)
memcpy(&(f->fmt.pix), &pac207_pix_fmt[0],
sizeof(pac207_pix_fmt[0]));
else
memcpy(&(f->fmt.pix), &pac207_pix_fmt[1],
sizeof(pac207_pix_fmt[0]));
return 0;
}
static int
pac207_vidioc_s_fmt_cap(struct file *file, void *fh, struct v4l2_format *f)
{
struct usbvideo2_device* cam = fh;
struct pac207_data *data = cam->cam_data;
if (f->fmt.pix.width == pac207_pix_fmt[0].width) {
data->mode = 0;
cam->imagesize = 352 * 288;
} else {
data->mode = 1;
cam->imagesize = 176 * 144;
}
return 0;
}
/*****************************************************************************/
static int
pac207_probe(struct usbvideo2_device* cam, const struct usb_device_id* id)
{
u8 idreg[2];
idreg[0] = pac207_read_reg(cam, 0x0000);
idreg[1] = pac207_read_reg(cam, 0x0001);
idreg[0] = ((idreg[0] & 0x0F) << 4) | ((idreg[1] & 0xf0) >> 4);
idreg[1] = idreg[1] & 0x0f;
DBG(2, "Pixart Sensor ID 0x%02X Chips ID 0x%02X", idreg[0],
idreg[1]);
if (idreg[0] != 0x27) {
DBG(1, "Error invalid sensor ID!");
return -ENODEV;
}
pac207_write_reg(cam, 0x41, 0x00); /* 00 Bit_0=Image Format, Bit_1=LED, Bit_2=Compression test mode enable */
pac207_write_reg(cam, 0x0f, 0x00); /* Power Control */
pac207_write_reg(cam, 0x11, 0x30); /* Analog Bias */
DBG(2, "Pixart PAC207BCA Image Processor and Control Chip detected "
"(vid/pid 0x%04X:0x%04X)",id->idVendor, id->idProduct);
cam->imagesize = 352 * 288;
strcpy(cam->driver, PAC207_NAME);
strcpy(cam->name, "Pixart PAC207BCA USB Camera");
cam->sof_marker_size = sizeof(pac207_sof_marker);
cam->endpoint_address = 0x85;
return 0;
}
const struct usbvideo2_cam_funcs pac207_funcs = {
.owner = THIS_MODULE,
.probe = pac207_probe,
.find_sof = pac207_find_sof,
.decode_frame_init = pac207_decode_frame_init,
.decode_frame_data = pac207_decode,
.start_transfer = pac207_start_transfer,
.stop_transfer_pre_kill_urbs = pac207_stop_transfer_pre_kill_urbs,
.open = pac207_open,
.frame_dequeued = pac207_do_auto_gain,
.vidioc_query_ctrl = pac207_vidioc_query_ctrl,
.vidioc_s_ctrl = pac207_vidioc_s_ctrl,
.vidioc_g_ctrl = pac207_vidioc_g_ctrl,
.vidioc_enum_fmt_cap = pac207_vidioc_enum_fmt_cap,
.vidioc_g_fmt_cap = pac207_vidioc_g_fmt_cap,
.vidioc_try_fmt_cap = pac207_vidioc_try_fmt_cap,
.vidioc_s_fmt_cap = pac207_vidioc_s_fmt_cap,
};
static int
pac207_usb_probe(struct usb_interface* intf, const struct usb_device_id* id)
{
return usbvideo2_probe(intf, id, &pac207_funcs,
sizeof(struct pac207_data));
}
static struct usb_driver pac207_usb_driver = {
.name = PAC207_NAME,
.id_table = pac207_id_table,
.probe = pac207_usb_probe,
.disconnect = usbvideo2_disconnect,
};
/*****************************************************************************/
static void pac207_init_decompress_table(void)
{
int i;
u8 is_abs, len;
s8 val;
for (i = 0; i < 256; i++) {
is_abs = 0;
val = 0;
len = 0;
if ((i & 0xC0) == 0) {
/* code 00 */
val = 0;
len = 2;
} else if ((i & 0xC0) == 0x40) {
/* code 01 */
val = -5;
len = 2;
} else if ((i & 0xC0) == 0x80) {
/* code 10 */
val = +5;
len = 2;
} else if ((i & 0xF0) == 0xC0) {
/* code 1100 */
val = -10;
len = 4;
} else if ((i & 0xF0) == 0xD0) {
/* code 1101 */
val = +10;
len = 4;
} else if ((i & 0xF8) == 0xE0) {
/* code 11100 */
val = -15;
len = 5;
} else if ((i & 0xF8) == 0xE8) {
/* code 11101 */
val = +15;
len = 5;
} else if ((i & 0xFC) == 0xF0) {
/* code 111100 */
val = -20;
len = 6;
} else if ((i & 0xFC) == 0xF4) {
/* code 111101 */
val = +20;
len = 6;
} else if ((i & 0xF8) == 0xF8) {
/* code 11111xxxxxx */
is_abs = 1;
val = 0;
len = 5;
}
pac207_decompress_table[i].is_abs = is_abs;
pac207_decompress_table[i].val = val;
pac207_decompress_table[i].len = len;
}
}
/*****************************************************************************/
static int __init pac207_module_init(void)
{
int err = 0;
pac207_init_decompress_table();
if ((err = usb_register(&pac207_usb_driver)))
printk(KERN_ERR PAC207_NAME
": usb_register() failed, error: %d", err);
return err;
}
static void __exit pac207_module_exit(void)
{
usb_deregister(&pac207_usb_driver);
}
module_init(pac207_module_init);
module_exit(pac207_module_exit);
/* Video4Linux2 framework for usb video devices (webcams) *
* *
* Copyright (C) 2008 by Hans de Goede <j.w.r.degoede(a)hhs.nl> *
* Buffer management code taken from the Video4Linux2 zc030x driver: *
* Copyright (C) 2006-2007 by Luca Risolia <luca.risolia(a)studio.unibo.it> *
* Many ideas and code snippets taken from the gspca driver: *
* Copyleft (C) 2005 Michel Xhaard mxhaard(a)magic.fr *
* *
* 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. *
* *
* This program is distributed in the hope that it will be useful, *
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
* GNU General Public License for more details. *
* *
* You should have received a copy of the GNU General Public License *
* along with this program; if not, write to the Free Software *
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. *
***************************************************************************/
#include <linux/module.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/param.h>
#include <linux/errno.h>
#include <linux/slab.h>
#include <linux/device.h>
#include <linux/fs.h>
#include <linux/delay.h>
#include <linux/compiler.h>
#include <linux/ioctl.h>
#include <linux/poll.h>
#include <linux/stat.h>
#include <linux/mm.h>
#include <linux/vmalloc.h>
#include <linux/page-flags.h>
#include <linux/byteorder/generic.h>
#include <asm/page.h>
#include <asm/uaccess.h>
#include "usbvideo2.h"
/*****************************************************************************/
MODULE_AUTHOR("Hans de Goede <j.w.r.degoede(a)hhs.nl>");
MODULE_DESCRIPTION("Video4Linux2 framework for usb video devices (webcams)");
MODULE_LICENSE("GPL");
static unsigned short debug = USBVIDEO2_DEBUG_LEVEL;
module_param(debug, ushort, 0644);
MODULE_PARM_DESC(debug,
"\n<n> Debugging information level, from 0 to 3:"
"\n0 = none (use carefully)"
"\n1 = critical errors"
"\n2 = significant informations"
"\n3 = more verbose messages"
"\nLevel 3 is useful for testing only, when only "
"one device is used."
"\nDefault value is "__MODULE_STRING(USBVIDEO2_DEBUG_LEVEL)"."
"\n");
/*****************************************************************************/
static DEFINE_MUTEX(usbvideo2_dev_lock);
/*****************************************************************************/
static u32
usbvideo2_request_buffers(struct usbvideo2_device* cam, u32 count)
{
void* buff = NULL;
u32 i;
if (count > USBVIDEO2_MAX_FRAMES)
count = USBVIDEO2_MAX_FRAMES;
cam->nbuffers = count;
while (cam->nbuffers) {
if ((buff = vmalloc_32_user(cam->nbuffers *
PAGE_ALIGN(cam->imagesize))))
break;
cam->nbuffers--;
}
for (i = 0; i < cam->nbuffers; i++) {
cam->frame[i].bufmem = buff + i*PAGE_ALIGN(cam->imagesize);
cam->frame[i].buf.index = i;
cam->frame[i].buf.m.offset = i*PAGE_ALIGN(cam->imagesize);
cam->frame[i].buf.length = cam->imagesize;
cam->frame[i].buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
cam->frame[i].buf.sequence = 0;
cam->frame[i].buf.field = V4L2_FIELD_NONE;
cam->frame[i].buf.memory = V4L2_MEMORY_MMAP;
cam->frame[i].buf.flags = 0;
cam->frame[i].buf.bytesused = 0;
cam->frame[i].state = F_UNUSED;
}
return cam->nbuffers;
}
static void usbvideo2_release_buffers(struct usbvideo2_device* cam)
{
if (cam->nbuffers) {
vfree(cam->frame[0].bufmem);
cam->nbuffers = 0;
}
}
static void usbvideo2_empty_framequeues(struct usbvideo2_device* cam)
{
u32 i;
INIT_LIST_HEAD(&cam->inqueue);
INIT_LIST_HEAD(&cam->outqueue);
for (i = 0; i < USBVIDEO2_MAX_FRAMES; i++) {
cam->frame[i].state = F_UNUSED;
cam->frame[i].buf.bytesused = 0;
}
}
static void usbvideo2_queue_unusedframes(struct usbvideo2_device* cam)
{
unsigned long lock_flags;
u32 i;
for (i = 0; i < cam->nbuffers; i++)
if (cam->frame[i].state == F_UNUSED) {
cam->frame[i].state = F_QUEUED;
spin_lock_irqsave(&cam->queue_lock, lock_flags);
list_add_tail(&cam->frame[i].frame, &cam->inqueue);
spin_unlock_irqrestore(&cam->queue_lock, lock_flags);
}
}
/*****************************************************************************/
static void usbvideo2_urb_complete(struct urb *urb)
{
struct usbvideo2_device* cam = urb->context;
struct usbvideo2_frame_t** f;
int i, 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. */
return;
default:
goto resubmit_urb;
}
f = &cam->frame_current;
if (!(*f)) {
if (list_empty(&cam->inqueue))
goto resubmit_urb;
(*f) = list_entry(cam->inqueue.next, struct usbvideo2_frame_t,
frame);
}
for (i = 0; i < urb->number_of_packets; i++) {
unsigned int len, repeat = 0;
u8 *pos, *sof;
len = urb->iso_frame_desc[i].actual_length;
pos = urb->iso_frame_desc[i].offset + urb->transfer_buffer;
if (urb->iso_frame_desc[i].status) {
DBG(3, "Error in isochronous frame");
(*f)->state = F_ERROR;
continue;
}
while (len) {
sof = cam->funcs->find_sof(cam, pos, len, repeat++);
if (((*f)->state == F_QUEUED ||
(*f)->state == F_ERROR) && sof) {
start_of_frame:
(*f)->state = F_GRABBING;
(*f)->buf.bytesused = 0;
do_gettimeofday(&(*f)->buf.timestamp);
cam->funcs->decode_frame_init(cam);
len -= sof - pos;
pos = sof;
continue; /* check for another sof in packet */
}
if ((*f)->state == F_GRABBING) {
unsigned int n;
/* If sof decode until sof */
if (sof) {
n = sof - pos;
if (n > cam->sof_marker_size)
n -= cam->sof_marker_size;
else
n = 0;
} else
n = len;
if ((ret = cam->funcs->decode_frame_data(cam,
*f, pos, n))) {
(*f)->buf.sequence= ++cam->frame_count;
spin_lock(&cam->queue_lock);
list_move_tail(&(*f)->frame,
&cam->outqueue);
if (!list_empty(&cam->inqueue))
(*f) = list_entry(
cam->inqueue.next,
struct usbvideo2_frame_t,
frame);
else
(*f) = NULL;
spin_unlock(&cam->queue_lock);
wake_up_interruptible(&cam->wait_frame);
DBG(3, "Video frame captured");
if (!(*f))
goto resubmit_urb;
}
if (sof) {
if (!ret)
DBG(3, "Incomplete frame");
goto start_of_frame;
}
len -= n;
pos += n;
}
else
break;
}
}
resubmit_urb:
urb->dev = cam->usbdev;
ret = usb_submit_urb(urb, GFP_ATOMIC);
if (ret < 0)
DBG(1, "usb_submit_urb() failed, error: %d", ret);
}
static void usbvideo2_kill_and_free_urbs(struct usbvideo2_device* cam)
{
int i;
struct urb* urb;
struct usb_device *udev = cam->usbdev;
for (i = 0; i < USBVIDEO2_URBS; i++) {
if (!(urb = cam->urb[i]))
continue;
/* Note: usb_kill_urb() is harmless on a not submitted urb */
usb_kill_urb(urb);
if (urb->transfer_buffer) {
usb_buffer_free(udev, urb->transfer_buffer_length,
urb->transfer_buffer, urb->transfer_dma);
}
usb_free_urb(urb);
cam->urb[i] = NULL;
}
}
static void usbvideo2_stop_transfer(struct usbvideo2_device* cam);
static int usbvideo2_start_transfer(struct usbvideo2_device* cam)
{
struct usb_device *udev = cam->usbdev;
struct usb_interface *intf = usb_ifnum_to_if(udev, 0);
struct usb_host_interface* altsetting;
unsigned int psz;
struct urb* urb;
int i, j, alt, err = -ENOSPC;
if (cam->stream == STREAM_ON)
return -EBUSY;
for (alt = intf->num_altsetting - 1; alt && err == -ENOSPC; alt--) {
altsetting = usb_altnum_to_altsetting(intf, alt);
/* Find our endpoint to determine the packetsize */
for (i = 0; i < altsetting->desc.bNumEndpoints; i++) {
if (altsetting->endpoint[i].desc.bEndpointAddress ==
cam->endpoint_address)
break;
}
/* Endpoint not found or not isoc in this altsetting ?? */
if (i == altsetting->desc.bNumEndpoints ||
(altsetting->endpoint[i].desc.bmAttributes &
USB_ENDPOINT_XFERTYPE_MASK) !=
USB_ENDPOINT_XFER_ISOC)
continue;
psz = le16_to_cpu(altsetting->endpoint[i].desc.wMaxPacketSize);
/* See paragraph 5.9 / table 5-11 of the usb 2.0 spec. */
psz = (psz & 0x07ff) * (1 + ((psz >> 11) & 3));
err = usb_set_interface(udev, 0, alt);
if (err) {
DBG(1, "usb_set_interface() failed");
return err;
}
for (i = 0; i < USBVIDEO2_URBS; i++) {
urb = usb_alloc_urb(USBVIDEO2_ISO_PACKETS, GFP_KERNEL);
if (!urb) {
DBG(1, "usb_alloc_urb() failed");
usbvideo2_kill_and_free_urbs(cam);
return -ENOMEM;
}
cam->urb[i] = urb;
/* We alloc psz + 1 bytes per packet, because the
decompression code reads bytes at bit offsets and
thus can peek up to 7 bits ahead (which will not be
used if outside of the actual data, but they will
be read)! */
urb->transfer_buffer = usb_buffer_alloc(udev,
(psz + 1) *
USBVIDEO2_ISO_PACKETS,
GFP_KERNEL,
&urb->transfer_dma);
if (!urb->transfer_buffer) {
DBG(1, "usb_buffer_alloc() failed");
usbvideo2_kill_and_free_urbs(cam);
return -ENOMEM;
}
urb->dev = udev;
urb->context = cam;
urb->pipe = usb_rcvisocpipe(udev,
cam->endpoint_address);
urb->transfer_flags = URB_ISO_ASAP |
URB_NO_TRANSFER_DMA_MAP;
urb->number_of_packets = USBVIDEO2_ISO_PACKETS;
urb->complete = usbvideo2_urb_complete;
urb->transfer_buffer_length = (psz + 1) *
USBVIDEO2_ISO_PACKETS;
urb->interval = 1;
for (j = 0; j < USBVIDEO2_ISO_PACKETS; j++) {
urb->iso_frame_desc[j].offset = (psz + 1) * j;
urb->iso_frame_desc[j].length = psz;
}
}
err = cam->funcs->start_transfer(cam);
if (err) {
DBG(1, "camera specific start_transfer() failed");
usbvideo2_kill_and_free_urbs(cam);
return err;
}
cam->stream = STREAM_ON;
DBG(3, "Stream on");
for (i = 0; i < USBVIDEO2_URBS; i++) {
err = usb_submit_urb(cam->urb[i], GFP_KERNEL);
if (err) {
DBG(1, "usb_submit_urb() failed, error %d",
err);
usbvideo2_stop_transfer(cam);
break;
}
}
}
return err;
}
static void usbvideo2_stop_transfer(struct usbvideo2_device* cam)
{
struct usb_device *udev = cam->usbdev;
if (cam->stream == STREAM_OFF)
return;
if (cam->funcs->stop_transfer_pre_kill_urbs)
cam->funcs->stop_transfer_pre_kill_urbs(cam);
usbvideo2_kill_and_free_urbs(cam);
if (!cam->disconnected) {
int err = usb_set_interface(udev, 0, 0); /* 0 Mb/s */
if (err)
DBG(1, "usb_set_interface( 0 ) error: %d\n", err);
}
if (cam->funcs->stop_transfer_post_kill_urbs)
cam->funcs->stop_transfer_post_kill_urbs(cam);
cam->frame_current = NULL;
cam->stream = STREAM_OFF;
DBG(3, "Stream off");
}
/*****************************************************************************/
static void usbvideo2_release_resources(struct kref *kref)
{
struct usbvideo2_device *cam = container_of(kref,
struct usbvideo2_device, kref);
kfree(cam);
}
static int usbvideo2_open(struct inode* inode, struct file* filp)
{
struct usbvideo2_device* cam;
int err = 0;
/* usb driver disconnect may be running and waiting in
video_unregister_device() for the videodev_lock (from videodev.c),
which we hold when being called! */
if (!mutex_trylock(&usbvideo2_dev_lock))
return -EAGAIN;
cam = video_get_drvdata(video_devdata(filp));
if (cam->users) {
err = -EBUSY;
goto out;
}
if (!try_module_get(cam->funcs->owner)) {
/* Our cam specific module is being removed ! */
err = -ENODEV;
goto out;
}
kref_get(&cam->kref);
filp->private_data = cam;
cam->users++;
cam->io = IO_NONE;
cam->nreadbuffers = USBVIDEO2_DEFAULT_READBUFFERS;
cam->frame_count = 0;
/* init the frame queues */
usbvideo2_empty_framequeues(cam);
err = cam->funcs->open(cam);
if (err) {
DBG(1, "Cam specific open() failed");
module_put(cam->funcs->owner);
kref_put(&cam->kref, usbvideo2_release_resources);
}
out:
mutex_unlock(&usbvideo2_dev_lock);
return err;
}
static int usbvideo2_release(struct inode* inode, struct file* filp)
{
struct usbvideo2_device* cam;
mutex_lock(&usbvideo2_dev_lock);
cam = filp->private_data;
usbvideo2_stop_transfer(cam);
usbvideo2_release_buffers(cam);
cam->users--;
module_put(cam->funcs->owner);
kref_put(&cam->kref, usbvideo2_release_resources);
mutex_unlock(&usbvideo2_dev_lock);
return 0;
}
static ssize_t
usbvideo2_read(struct file* filp, char __user * buf, size_t count, loff_t* f_pos)
{
struct usbvideo2_device *cam = filp->private_data;
struct usbvideo2_frame_t *f;
unsigned long lock_flags;
long timeout;
int err = 0;
if (cam->disconnected) {
err = -ENODEV;
goto out;
}
if (cam->io == IO_MMAP) {
DBG(2, "Close and open the device again to choose the read "
"method");
err = -EBUSY;
goto out;
}
if (cam->io == IO_NONE) {
if (!usbvideo2_request_buffers(cam, cam->nreadbuffers)) {
DBG(1, "read() failed, not enough memory");
err = -ENOMEM;
goto out;
}
usbvideo2_queue_unusedframes(cam);
if ((err = usbvideo2_start_transfer(cam)))
goto out;
cam->io = IO_READ;
}
/* If the inqueue is depleted, chances are there are some rather old
frames in the outqueue (for example an application doing one read
every minute), so flush it. */
if (list_empty(&cam->inqueue)) {
spin_lock_irqsave(&cam->queue_lock, lock_flags);
list_for_each_entry(f, &cam->outqueue, frame)
f->state = F_UNUSED;
INIT_LIST_HEAD(&cam->outqueue);
spin_unlock_irqrestore(&cam->queue_lock, lock_flags);
usbvideo2_queue_unusedframes(cam);
}
if (!count)
goto out;
/* loop until we get a frame or error, the frame we've been waiting
for may be stolen from underneed us, as we release the lock while
waiting */
while (list_empty(&cam->outqueue)) {
if (filp->f_flags & O_NONBLOCK) {
err = -EAGAIN;
goto out;
}
mutex_unlock(&cam->fileop_mutex);
timeout = wait_event_interruptible_timeout(cam->wait_frame,
!list_empty(&cam->outqueue) ||
cam->disconnected,
msecs_to_jiffies(USBVIDEO2_FRAME_TIMEOUT) );
if (mutex_lock_interruptible(&cam->fileop_mutex))
return -ERESTARTSYS;
if (cam->disconnected) {
err = -ENODEV;
goto out;
}
if (timeout <= 0) {
err = (timeout < 0)? timeout : -EIO;
goto out;
}
}
if (cam->funcs->frame_dequeued)
cam->funcs->frame_dequeued(cam);
spin_lock_irqsave(&cam->queue_lock, lock_flags);
f = list_entry(cam->outqueue.next, struct usbvideo2_frame_t, frame);
list_del(cam->outqueue.next);
spin_unlock_irqrestore(&cam->queue_lock, lock_flags);
if (count > f->buf.bytesused)
count = f->buf.bytesused;
if (copy_to_user(buf, f->bufmem, count))
err = -EFAULT;
else
*f_pos += count;
f->state = F_UNUSED;
usbvideo2_queue_unusedframes(cam);
out:
mutex_unlock(&cam->fileop_mutex);
return err ? err : count;
}
static unsigned int usbvideo2_poll(struct file *filp, poll_table *wait)
{
struct usbvideo2_device* cam = filp->private_data;
struct usbvideo2_frame_t* f;
unsigned long lock_flags;
unsigned int mask = 0;
if (mutex_lock_interruptible(&cam->fileop_mutex))
return POLLERR;
if (cam->disconnected) {
mask = POLLERR;
goto out;
}
if (cam->io == IO_NONE) {
if (!usbvideo2_request_buffers(cam, cam->nreadbuffers)) {
DBG(1, "poll() failed, not enough memory");
mask = POLLERR;
goto out;
}
usbvideo2_queue_unusedframes(cam);
if (usbvideo2_start_transfer(cam)) {
DBG(1, "poll() failed, start transfer failed");
mask = POLLERR;
goto out;
}
cam->io = IO_READ;
}
if (cam->io == IO_READ) {
/* If the inqueue is depleted, read will flush the outqueue,
so do that here, otherwise read will still block. */
if (list_empty(&cam->inqueue)) {
spin_lock_irqsave(&cam->queue_lock, lock_flags);
list_for_each_entry(f, &cam->outqueue, frame)
f->state = F_UNUSED;
INIT_LIST_HEAD(&cam->outqueue);
spin_unlock_irqrestore(&cam->queue_lock, lock_flags);
usbvideo2_queue_unusedframes(cam);
}
}
poll_wait(filp, &cam->wait_frame, wait);
if (!list_empty(&cam->outqueue))
mask |= POLLIN | POLLRDNORM;
out:
mutex_unlock(&cam->fileop_mutex);
return mask;
}
static void usbvideo2_vm_open(struct vm_area_struct* vma)
{
struct usbvideo2_frame_t* f = vma->vm_private_data;
f->vma_use_count++;
}
static void usbvideo2_vm_close(struct vm_area_struct* vma)
{
/* NOTE: buffers are not freed here */
struct usbvideo2_frame_t* f = vma->vm_private_data;
f->vma_use_count--;
}
static struct vm_operations_struct usbvideo2_vm_ops = {
.open = usbvideo2_vm_open,
.close = usbvideo2_vm_close,
};
static int usbvideo2_mmap(struct file* filp, struct vm_area_struct *vma)
{
struct usbvideo2_device* cam = filp->private_data;
unsigned long size = vma->vm_end - vma->vm_start,
start = vma->vm_start;
void *pos;
u32 i;
int err = 0;
if (mutex_lock_interruptible(&cam->fileop_mutex))
return -ERESTARTSYS;
if (cam->disconnected) {
err = -ENODEV;
goto out;
}
if (!(vma->vm_flags & (VM_WRITE | VM_READ))) {
err = -EACCES;
goto out;
}
if (cam->io != IO_MMAP ||
size != PAGE_ALIGN(cam->frame[0].buf.length)) {
err = -EINVAL;
goto out;
}
for (i = 0; i < cam->nbuffers; i++) {
if ((cam->frame[i].buf.m.offset>>PAGE_SHIFT) == vma->vm_pgoff)
break;
}
if (i == cam->nbuffers) {
err = -EINVAL;
goto out;
}
vma->vm_flags |= VM_IO;
vma->vm_flags |= VM_RESERVED;
pos = cam->frame[i].bufmem;
while (size > 0) { /* size is page-aligned */
if (vm_insert_page(vma, start, vmalloc_to_page(pos))) {
err = -EAGAIN;
goto out;
}
start += PAGE_SIZE;
pos += PAGE_SIZE;
size -= PAGE_SIZE;
}
vma->vm_ops = &usbvideo2_vm_ops;
vma->vm_private_data = &cam->frame[i];
usbvideo2_vm_open(vma);
out:
mutex_unlock(&cam->fileop_mutex);
return err;
}
static int usbvideo2_ioctl(struct inode *inode, struct file *filp,
unsigned int cmd, unsigned long arg)
{
struct usbvideo2_device* cam = filp->private_data;
int err;
if (mutex_lock_interruptible(&cam->fileop_mutex))
return -ERESTARTSYS;
if (cam->disconnected) {
err = -ENODEV;
goto out;
}
err = video_ioctl2(inode, filp, cmd, arg);
out:
mutex_unlock(&cam->fileop_mutex);
return err;
}
static const struct file_operations usbvideo2_fops = {
.owner = THIS_MODULE,
.open = usbvideo2_open,
.release = usbvideo2_release,
.ioctl = usbvideo2_ioctl,
.compat_ioctl = v4l_compat_ioctl32,
.read = usbvideo2_read,
.poll = usbvideo2_poll,
.mmap = usbvideo2_mmap,
.llseek = no_llseek,
};
/*****************************************************************************/
static int
usbvideo2_vidioc_querycap(struct file *file, void *fh, struct v4l2_capability *cap)
{
struct usbvideo2_device* cam = fh;
cap->version = LINUX_VERSION_CODE;
cap->capabilities = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_READWRITE |
V4L2_CAP_STREAMING;
strcpy(cap->driver, cam->driver);
strlcpy(cap->card, cam->name, sizeof(cap->card));
if (usb_make_path(cam->usbdev, cap->bus_info, sizeof(cap->bus_info))
< 0)
strlcpy(cap->bus_info, cam->usbdev->dev.bus_id,
sizeof(cap->bus_info));
return 0;
}
static int
usbvideo2_vidioc_enuminput(struct file *file, void *fh, struct v4l2_input *inp)
{
if (inp->index)
return -EINVAL;
memset(inp, 0, sizeof(*inp));
strcpy(inp->name, "Camera");
inp->type = V4L2_INPUT_TYPE_CAMERA;
return 0;
}
static int
usbvideo2_vidioc_g_input(struct file *file, void *fh, unsigned int *i)
{
*i = 0;
return 0;
}
static int
usbvideo2_vidioc_s_input(struct file *file, void *fh, unsigned int i)
{
if (i != 0)
return -EINVAL;
return 0;
}
static int
usbvideo2_vidioc_s_fmt_cap(struct file *file, void *fh, struct v4l2_format *f)
{
struct usbvideo2_device* cam = fh;
int err;
if ((err = cam->funcs->vidioc_try_fmt_cap(file, fh, f)))
return err;
if (cam->stream != STREAM_OFF)
return -EBUSY;
return cam->funcs->vidioc_s_fmt_cap(file, fh, f);
}
static int
usbvideo2_vidioc_reqbufs(struct file *file, void *fh, struct v4l2_requestbuffers *b)
{
u32 i;
struct usbvideo2_device* cam = fh;
if (b->type != V4L2_BUF_TYPE_VIDEO_CAPTURE ||
b->memory != V4L2_MEMORY_MMAP)
return -EINVAL;
if (cam->io == IO_READ) {
DBG(2, "Close and open the device again to choose the "
"mmap I/O method");
return -EBUSY;
}
if (cam->stream == STREAM_ON)
return -EBUSY;
for (i = 0; i < cam->nbuffers; i++)
if (cam->frame[i].vma_use_count) {
DBG(2, "VIDIOC_REQBUFS failed. "
"Previous buffers are still mapped.");
return -EBUSY;
}
usbvideo2_release_buffers(cam);
if (b->count)
b->count = usbvideo2_request_buffers(cam, b->count);
cam->io = b->count ? IO_MMAP : IO_NONE;
return 0;
}
static int
usbvideo2_vidioc_querybuf(struct file *file, void *fh, struct v4l2_buffer *b)
{
struct usbvideo2_device* cam = fh;
if (b->type != V4L2_BUF_TYPE_VIDEO_CAPTURE ||
b->index >= cam->nbuffers || cam->io != IO_MMAP)
return -EINVAL;
memcpy(b, &cam->frame[b->index].buf, sizeof(*b));
if (cam->frame[b->index].vma_use_count)
b->flags |= V4L2_BUF_FLAG_MAPPED;
if (cam->frame[b->index].state == F_DONE)
b->flags |= V4L2_BUF_FLAG_DONE;
else if (cam->frame[b->index].state != F_UNUSED)
b->flags |= V4L2_BUF_FLAG_QUEUED;
return 0;
}
static int
usbvideo2_vidioc_qbuf(struct file *file, void *fh, struct v4l2_buffer *b)
{
struct usbvideo2_device* cam = fh;
unsigned long lock_flags;
if (b->type != V4L2_BUF_TYPE_VIDEO_CAPTURE ||
b->index >= cam->nbuffers ||
cam->io != IO_MMAP ||
cam->frame[b->index].state != F_UNUSED)
return -EINVAL;
cam->frame[b->index].state = F_QUEUED;
spin_lock_irqsave(&cam->queue_lock, lock_flags);
list_add_tail(&cam->frame[b->index].frame, &cam->inqueue);
spin_unlock_irqrestore(&cam->queue_lock, lock_flags);
return 0;
}
static int
usbvideo2_vidioc_dqbuf(struct file *file, void *fh, struct v4l2_buffer *b)
{
struct usbvideo2_device* cam = fh;
struct usbvideo2_frame_t *f;
unsigned long lock_flags;
long timeout;
if (b->type != V4L2_BUF_TYPE_VIDEO_CAPTURE || cam->io != IO_MMAP ||
cam->stream == STREAM_OFF)
return -EINVAL;
if (list_empty(&cam->outqueue)) {
if (file->f_flags & O_NONBLOCK)
return -EAGAIN;
timeout = wait_event_interruptible_timeout(cam->wait_frame,
!list_empty(&cam->outqueue) ||
cam->disconnected,
msecs_to_jiffies(USBVIDEO2_FRAME_TIMEOUT) );
if (cam->disconnected)
return -ENODEV;
if (timeout <= 0)
return (timeout < 0)? timeout : -EIO;
}
if (cam->funcs->frame_dequeued)
cam->funcs->frame_dequeued(cam);
spin_lock_irqsave(&cam->queue_lock, lock_flags);
f = list_entry(cam->outqueue.next, struct usbvideo2_frame_t, frame);
list_del(cam->outqueue.next);
spin_unlock_irqrestore(&cam->queue_lock, lock_flags);
f->state = F_UNUSED;
memcpy(b, &f->buf, sizeof(*b));
if (f->vma_use_count)
b->flags |= V4L2_BUF_FLAG_MAPPED;
return 0;
}
static int
usbvideo2_vidioc_streamon(struct file *file, void *fh, enum v4l2_buf_type i)
{
struct usbvideo2_device* cam = fh;
if (i != V4L2_BUF_TYPE_VIDEO_CAPTURE || cam->io != IO_MMAP)
return -EINVAL;
return usbvideo2_start_transfer(cam);
}
static int
usbvideo2_vidioc_streamoff(struct file *file, void *fh, enum v4l2_buf_type i)
{
struct usbvideo2_device* cam = fh;
if (i != V4L2_BUF_TYPE_VIDEO_CAPTURE || cam->io != IO_MMAP)
return -EINVAL;
usbvideo2_stop_transfer(cam);
usbvideo2_empty_framequeues(cam);
return 0;
}
static int
usbvideo2_vidioc_g_parm(struct file *file, void *fh, struct v4l2_streamparm *a)
{
struct usbvideo2_device* cam = fh;
if (a->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
return -EINVAL;
a->parm.capture.extendedmode = 0;
a->parm.capture.readbuffers = cam->nreadbuffers;
return 0;
}
static int
usbvideo2_vidioc_s_parm(struct file *file, void *fh, struct v4l2_streamparm *a)
{
struct usbvideo2_device* cam = fh;
if (a->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
return -EINVAL;
a->parm.capture.extendedmode = 0;
if (a->parm.capture.readbuffers == 0)
a->parm.capture.readbuffers = cam->nreadbuffers;
if (a->parm.capture.readbuffers > USBVIDEO2_MAX_FRAMES)
a->parm.capture.readbuffers = USBVIDEO2_MAX_FRAMES;
cam->nreadbuffers = a->parm.capture.readbuffers;
return 0;
}
/*****************************************************************************/
int
usbvideo2_probe(struct usb_interface* intf, const struct usb_device_id* id,
const struct usbvideo2_cam_funcs *funcs, int cam_specific_data_size)
{
struct usb_device *udev = interface_to_usbdev(intf);
struct usbvideo2_device* cam;
int err = -ENOMEM;
if (!(cam = kzalloc(sizeof(struct usbvideo2_device), GFP_KERNEL)))
return -ENOMEM;
if (!(cam->control_buffer = kzalloc(4, GFP_KERNEL)))
goto fail;
if (!(cam->cam_data = kzalloc(cam_specific_data_size, GFP_KERNEL)))
goto fail;
if (!(cam->v4ldev = video_device_alloc())) {
DBG(1, "video_device_alloc() failed");
goto fail;
}
cam->usbdev = udev;
cam->funcs = funcs;
cam->debug = debug;
if ((err = funcs->probe(cam, id))) {
DBG(1, "Error cam initialization failed");
goto fail;
}
cam->v4ldev->owner = THIS_MODULE;
cam->v4ldev->fops = &usbvideo2_fops;
cam->v4ldev->type = VID_TYPE_CAPTURE | VID_TYPE_SCALES;
cam->v4ldev->release = video_device_release;
/* cam->v4ldev->debug = V4L2_DEBUG_IOCTL_ARG; */
cam->v4ldev->vidioc_querycap = usbvideo2_vidioc_querycap;
cam->v4ldev->vidioc_enum_input = usbvideo2_vidioc_enuminput;
cam->v4ldev->vidioc_g_input = usbvideo2_vidioc_g_input;
cam->v4ldev->vidioc_s_input = usbvideo2_vidioc_s_input;
cam->v4ldev->vidioc_queryctrl = funcs->vidioc_query_ctrl;
cam->v4ldev->vidioc_g_ctrl = funcs->vidioc_g_ctrl;
cam->v4ldev->vidioc_s_ctrl = funcs->vidioc_s_ctrl;
cam->v4ldev->vidioc_enum_fmt_cap = funcs->vidioc_enum_fmt_cap;
cam->v4ldev->vidioc_g_fmt_cap = funcs->vidioc_g_fmt_cap;
cam->v4ldev->vidioc_s_fmt_cap = usbvideo2_vidioc_s_fmt_cap;
cam->v4ldev->vidioc_try_fmt_cap = funcs->vidioc_try_fmt_cap;
cam->v4ldev->vidioc_reqbufs = usbvideo2_vidioc_reqbufs;
cam->v4ldev->vidioc_querybuf = usbvideo2_vidioc_querybuf;
cam->v4ldev->vidioc_qbuf = usbvideo2_vidioc_qbuf;
cam->v4ldev->vidioc_dqbuf = usbvideo2_vidioc_dqbuf;
cam->v4ldev->vidioc_streamon = usbvideo2_vidioc_streamon;
cam->v4ldev->vidioc_streamoff = usbvideo2_vidioc_streamoff;
cam->v4ldev->vidioc_g_parm = usbvideo2_vidioc_g_parm;
cam->v4ldev->vidioc_s_parm = usbvideo2_vidioc_s_parm;
strlcpy(cam->v4ldev->name, cam->name, sizeof(cam->v4ldev->name));
video_set_drvdata(cam->v4ldev, cam);
mutex_init(&cam->fileop_mutex);
spin_lock_init(&cam->queue_lock);
init_waitqueue_head(&cam->wait_frame);
kref_init(&cam->kref);
usb_get_dev(cam->usbdev);
err = video_register_device(cam->v4ldev, VFL_TYPE_GRABBER, -1);
if (err) {
DBG(1, "V4L2 device registration failed");
usb_put_dev(cam->usbdev);
goto fail;
}
DBG(2, "V4L2 device registered as /dev/video%d", cam->v4ldev->minor);
usb_set_intfdata(intf, cam);
return 0;
fail:
kfree(cam->control_buffer);
kfree(cam->cam_data);
if (cam->v4ldev)
video_device_release(cam->v4ldev);
kfree(cam);
return err;
}
EXPORT_SYMBOL_GPL(usbvideo2_probe);
void usbvideo2_disconnect(struct usb_interface* intf)
{
struct usbvideo2_device* cam;
mutex_lock(&usbvideo2_dev_lock);
cam = usb_get_intfdata(intf);
DBG(2, "Disconnecting %s...", cam->name);
cam->disconnected = 1;
if (cam->users) {
/* The cam device is still open by some app */
wake_up_interruptible(&cam->wait_frame);
/* Take the fileop_mutex:
1) Because we touch shared resources protected by it
2) So that we know any current users of the usbdev / v4ldev
will be done, there won't come any new ones as we've set
the disconnected flag */
mutex_lock(&cam->fileop_mutex);
usbvideo2_stop_transfer(cam);
mutex_unlock(&cam->fileop_mutex);
}
DBG(2, "V4L2 device /dev/video%d deregistered", cam->v4ldev->minor);
video_set_drvdata(cam->v4ldev, NULL);
video_unregister_device(cam->v4ldev);
cam->v4ldev = NULL;
usb_put_dev(cam->usbdev);
cam->usbdev = NULL;
kfree(cam->control_buffer);
kfree(cam->cam_data);
cam->control_buffer = NULL;
cam->cam_data = NULL;
kref_put(&cam->kref, usbvideo2_release_resources);
mutex_unlock(&usbvideo2_dev_lock);
}
EXPORT_SYMBOL_GPL(usbvideo2_disconnect);
/* Video4Linux2 framework for usb video devices (webcams) *
* *
* Copyright (C) 2008 by Hans de Goede <j.w.r.degoede(a)hhs.nl> *
* Buffer management code taken from the Video4Linux2 zc030x driver: *
* Copyright (C) 2006-2007 by Luca Risolia <luca.risolia(a)studio.unibo.it> *
* Many ideas and code snippets taken from the gspca driver: *
* Copyleft (C) 2005 Michel Xhaard mxhaard(a)magic.fr *
* *
* 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. *
* *
* This program is distributed in the hope that it will be useful, *
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
* GNU General Public License for more details. *
* *
* You should have received a copy of the GNU General Public License *
* along with this program; if not, write to the Free Software *
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. *
***************************************************************************/
#ifndef _USBVIDEO2_H_
#define _USBVIDEO2_H_
#include <linux/version.h>
#include <linux/usb.h>
#include <linux/videodev2.h>
#include <media/v4l2-common.h>
#include <linux/device.h>
#include <linux/list.h>
#include <linux/spinlock.h>
#include <linux/time.h>
#include <linux/wait.h>
#include <linux/types.h>
#include <linux/param.h>
#include <linux/mutex.h>
#include <linux/rwsem.h>
#include <linux/stddef.h>
#include <linux/string.h>
#include <linux/kref.h>
/*****************************************************************************/
#define USBVIDEO2_DEBUG_LEVEL 2
#define USBVIDEO2_MAX_FRAMES 32
#define USBVIDEO2_URBS 4 /* 2 is problematic on some systems */
#define USBVIDEO2_ISO_PACKETS 16 /* gspca uses 16 */
#define USBVIDEO2_CTRL_TIMEOUT 100 /* ms */
#define USBVIDEO2_FRAME_TIMEOUT 2000 /* ms */
#define USBVIDEO2_DEFAULT_READBUFFERS 3
/*****************************************************************************/
struct usbvideo2_frame_t;
struct usbvideo2_device;
/*****************************************************************************/
/* How to write a cam specific driver:
1) Implement the below functions (except for those marked optional)
2) fill an instance of the struct below with pointers to your implementation
3) Add an usb device id table to your module
4) Add a simple usb probe function which simply calls the usbvideo2_probe
function (further below), passing in your cam specific functions and
the sizeof your cam specific data structure (usbvideo2 will kzalloc and
free it for you)
5) Let the disconnect member of your usb_driver struct point to
usbvideo2_disconnect
*/
/* Cam specific functions structure */
struct usbvideo2_cam_funcs {
/* set this to THIS_MODULE */
struct module *owner;
/* This function gets called from usbvideo2_probe() when a new device
matching any of the listed usb ID's is connnected / inserted. This
function should:
1) Check if the device is supported by the cam specific code
2) initialize the device (turn of led, etc.)
3) Set the cam specific data in the usbvideo2_device (which data
is cam specific is detailed in the struct declaration)
4) initialize cam->cam_data as needed, it is already allocated
by usbvideo2_probe() when this function gets called,
one just needs to fill in any non 0 values */
int (*probe) (struct usbvideo2_device* cam,
const struct usb_device_id* id);
/* Note the 3 sof / decode functions below are called from the urb
completion handler and thus must not sleep! No locks are held when
they are called! */
/* Should return NULL when no sof, otherwise a pointer to the first
byte after the SOF marker, the repeat param gets set to 0 the first
call for one iso packet, to 1 the second call within the same iso
packet, etc. This can be used for optimalization when the cam driver
knows that there can be only one sof in a frame */
u8 * (*find_sof) (struct usbvideo2_device* cam, u8* data,
unsigned int len, int repeat);
/* This function gets called before the decode_frame_data() gets called
for the first time after a sof has been detected, this can be used
to reset the decoder state */
void (*decode_frame_init) (struct usbvideo2_device* cam);
/* This function gets called when there is iso packet data to decode
the first time it gets called after a call to decode_frame_init()
the data pointer will point to the first byte after the sof header,
iow to the byte returned by find_sof().
This function should return 1 if a frame was completely written to
f->buf, in all other circumstances it should return 0. It can signal
an error in decoding by setting f->state to F_ERROR, and when
returning 1 it should also set f->state to F_DONE. */
int (*decode_frame_data) (struct usbvideo2_device* cam,
struct usbvideo2_frame_t *f, u8 *data, unsigned int len);
/* Note all functions below are called with the fileop_mutex locked
and thus you can be sure only one of them will be called at a time.
Notice that the sof / frame decode functions above may still run
simultaniously though! */
/* Start transfer: activate sampling and start up iso endpoint,
return 0 on success, otherwise a negative errorcode */
int (*start_transfer) (struct usbvideo2_device* cam);
/* Stop transfer: stop sampling and shut down iso endpoint.
This version of stop_transfer gets called _before_ the urbs
currently in progress are killed. This function should check
cam->disconnected before doing any usb I/O, its still called on
a disconnected webcam to free any resources claimed by
start_transfer() (optional). */
void (*stop_transfer_pre_kill_urbs) (struct usbvideo2_device* cam);
/* Like stop_transfer_pre_kill_urbs, but gets called _after_ the urbs
currently in progress are killed (optional). */
void (*stop_transfer_post_kill_urbs) (struct usbvideo2_device* cam);
/* Open: called when the /dev/videoX device gets opened this function
should reset things like contrast and brightness, etc. Back to their
defaults. return 0 on success, otherwise a negative errorcode */
int (*open) (struct usbvideo2_device* cam);
/* Post frame dequeue (or read) callback, usefull todo things like
semi software auto exposure / gain (optional) */
void (*frame_dequeued) (struct usbvideo2_device* cam);
/* Below are standard v4l2 ioctl handlers */
int (*vidioc_query_ctrl) (struct file *file, void *fh,
struct v4l2_queryctrl *a);
int (*vidioc_g_ctrl) (struct file *file, void *fh,
struct v4l2_control *a);
int (*vidioc_s_ctrl) (struct file *file, void *fh,
struct v4l2_control *a);
int (*vidioc_enum_fmt_cap) (struct file *file, void *fh,
struct v4l2_fmtdesc *f);
int (*vidioc_g_fmt_cap) (struct file *file, void *fh,
struct v4l2_format *f);
int (*vidioc_try_fmt_cap) (struct file *file, void *fh,
struct v4l2_format *f);
/* Note some sanity checks (try_fmt_cap, not streaming) are already
done when this gets called */
int (*vidioc_s_fmt_cap) (struct file *file, void *fh,
struct v4l2_format *f);
};
/* Use as explained above in "How to write a cam specific driver" */
int usbvideo2_probe(struct usb_interface* intf, const struct usb_device_id* id,
const struct usbvideo2_cam_funcs *funcs, int cam_specific_data_size);
void usbvideo2_disconnect(struct usb_interface* intf);
/*****************************************************************************/
enum usbvideo2_frame_state {
F_UNUSED,
F_QUEUED,
F_GRABBING,
F_DONE,
F_ERROR,
};
struct usbvideo2_frame_t {
void* bufmem;
struct v4l2_buffer buf;
enum usbvideo2_frame_state state;
struct list_head frame;
unsigned long vma_use_count;
};
enum usbvideo2_io_method {
IO_NONE,
IO_READ,
IO_MMAP,
};
enum usbvideo2_stream_state {
STREAM_OFF,
STREAM_ON,
};
struct usbvideo2_device {
const struct usbvideo2_cam_funcs *funcs;
void *cam_data; /* cam specific functions private data */
struct usb_device* usbdev;
/* 4 kmalloc-ed bytes for cam read / write register methods */
u8* control_buffer;
/* These should not be touched by the cam specific code */
struct video_device* v4ldev;
struct urb* urb[USBVIDEO2_URBS];
struct usbvideo2_frame_t *frame_current, frame[USBVIDEO2_MAX_FRAMES];
struct list_head inqueue, outqueue;
struct kref kref;
struct mutex fileop_mutex;
spinlock_t queue_lock;
wait_queue_head_t wait_frame;
u32 frame_count, nbuffers, nreadbuffers;
/* End usbvideo2 core private data */
/* These should be initialised by the cam specific code in its probe
function and be updated as necessary */
u32 imagesize;
char driver[16];
char name[32];
u8 sof_marker_size;
u8 endpoint_address;
/* end cam specific data */
/* Thse should only be read by the cam specific code */
u8 debug;
u8 disconnected;
/* These should not be touched by the cam specific code */
u8 users;
u8 io;
u8 stream;
};
/*****************************************************************************/
#undef DBG
#define DBG(level, fmt, args...) \
do { \
if (cam->debug >= (level)) { \
if ((level) == 1) \
dev_err(&cam->usbdev->dev, fmt "\n", ## args); \
else if ((level) == 2) \
dev_info(&cam->usbdev->dev, fmt "\n", ## args); \
else if ((level) >= 3) \
dev_info(&cam->usbdev->dev, "[%s:%s:%d] " fmt "\n", \
__FILE__, __FUNCTION__, __LINE__ , ## args); \
} \
} while (0)
#endif /* _USBVIDEO2_H_ */
16 years
- 3
- 6
Self Introduction: Hans de Goede
by Hans de Goede
Hi All,
I'm a Linux enthusiast / developer. Lately I'm mainly active doing development
for Fedora and writing kernel drivers (and as my day job I'm a lecturer in
Computer Science).
Fedora has a policy of not shipping a heavily patched kernel, but instead tries
to work with upstream to get any needed patches integrated. This policy extends
to not shipping any addon drivers, but rather working to get drivers integrated
upstream.
As such I've decided to start spending my spare time on getting more and better
usb webcam support integrated upstream (for non usb video class devices). I
wanted to have something to show, so I've gone to the store, bought a couple of
webcams and started hacking and learning.
2 days ago I have finished my first pretty clean, standalone v4l2 webcam driver
for Pixart pac207 webcams.
In the beginning I modelled this driver after the zc301 and sn9c102 driver
which are currently already in the mainline kernel, using the memory management
and other structure from these drivers and filling in the hardware dependent
parts with the pac207 code from the out of tree gpsca driver.
During the development I kept the buffer management from the zc301 driver, but
modelled the rest of the driver more and more after gspca. For example don't
start the iso stream on device open and throw away iso packets received before
the stream-on ioctl, but instead start and stop the stream as needed.
This has resulted in what I consider a nice and clean pac207 driver. But when I
finished it I noticed that a lot of code in their was generic code for any
simple usb webcam.
Since I plan to write standalone v4l2 drivers for mainline inclusion for other
simple usb webcams I spend the last 2 days splitting the code of my pac207
driver into a generic usbvideo2 core (the kernel already has usbvideo, which
has a number of v4l1 drivers) and a camera specific pac207 driver which builds
on top of the usbvideo2 core.
So I've ended up with a model very much like gspca, but then not one large
monolithic kernel module, but a more modular design with an core kernel module
with (hopefully) generic code for simple usb webcam's, and a per usb controller
chip type specific module (currently only one for pac207 controllers), and
ofcourse very important this is code for v4l2 drivers, whereas the current
gspca is v4l1.
I just recently (today) learned that there is work underway to make a v4l2
version of gspca by Jean-François Moine: http://moinejf.free.fr/ ), I hope that
we can work together somehow on getting support for all the webcam's supported
in gscpa integrated into the mainline kernel with a v4l2 interface.
I'll be sending 2 seperate mails one with my standalone pac207 driver, and one
with the usbvideo2 core and a pac207 driver using this core, I'll include
Makefiles for out of tree building with both of them so that interested people
can test them.
I'm currently posting these as .c files for easy reading and compilation /
testing, but I still hope to get a lot of feedback / a thorough review, esp of
the core <-> pac207 split version as I hope to submit that as a patch for
mainline inclusion soon.
Thanks & Regards,
Hans
16 years
- 4
- 4
OT - High amount of spam on this list
by Rui Tiago Cação Matos
Hi,
Is it just me that is receiving a lot of spam on this list? Other
fedora lists I'm subscribed to don't seem to suffer from this. Can
anyone have a look at it?
Sorry for adding to the noise :-/
Rui
16 years
- 3
- 3
Re: kernel-xen f9 spec update
by Mark McLoughlin
Hi Jarod,
(Copying fedora-kernel-list so other folks know what we're at)
On Sat, 2008-03-29 at 15:19 -0400, Jarod Wilson wrote:
> We recently tweaked the main kernel package's spec file such that we now
> include arch in uname -r output, and have standardized a bunch of path names
> to match. Completely forgot about kernel-xen in the process, until yesterday,
> when I started porting everything over the the kernel-xen-2.6/devel spec.
>
> The attached spec patch has been build-tested, with some manual inspection of
> the resulting packages, but hasn't yet been run-time tested for possible
> issues (none expected, but you never know...). I'll happily help out with any
> possible issues if you guys could give this a spin.
>
> Definitely want this in ASAP so the kernel and kernel-xen bits stay mostly in
> sync (speaking of which, there's also some rpmposttrans stuff -- dkms
> hooks -- which went into the main kernel spec a bit ago that I don't see in
> the kernel-xen-2.6 spec
Thanks for the heads-up and the patch. I'm planning on rebasing
kernel-xen-2.6/devel to the latest kernel/devel sometime this week, so
we'll pick up all this stuff.
We eventually plan to get rid of the separate kernel-xen RPM altogether,
but that will probably have to wait until we get most of the x86_64 and
dom0 work upstream.
In the meantime, we do intend to keep closely in sync with the latest
stock kernel, and we're currently doing that using two git trees:
a) http://git.et.redhat.com/?p=linux-2.6-fedora-pvops.git
b) http://git.et.redhat.com/?p=kernel-xen-rpm.git
If you look at e.g. the kernel-xen-2_6-2_6_25-0_6_rc4_fc9 tag for each
of those you'll see a (a) a bunch of commits on top of the fedora kernel
source tree and (b) a bunch of commits on top of kernel/devel from CVS.
Each time we sync up with a new kernel version, we import a "make prep"
tree into (a) and the corresponding kernel/devel tag from CVS into (b)
and then use git to rebase the commits from the last kernel-xen tag for
both of these.
The easier we can make this rebasing process, the more frequent we'll
rebase. Right now, I've got a few lame scripts to:
1) Import the result of "make prep" into (a)
2) Import a kernel/devel CVS tag into (b)
3) Export the xen patches from (a) and include them into the spec
file in (b)
4) Copy everything from (b) to kernel-xen-2.6/devel
but it's all still quite manual and error prone.
Cheers,
Mark.
16 years, 1 month
- 2
- 3
Add SELinux permissive domains to fedora kernels
by Eric Paris
I know its way late but I'd like to add a new SELinux concept to the F9
kernels. Its going to be a backport of a couple of my changesets headed
upstream
http://git.kernel.org/?p=linux/kernel/git/jmorris/selinux-2.6.git;a=commi...
http://git.kernel.org/?p=linux/kernel/git/jmorris/selinux-2.6.git;a=commi...
http://git.kernel.org/?p=linux/kernel/git/jmorris/selinux-2.6.git;a=commi...
Only the third patch is truly interesting.
A permissive domain is a new concept in which a sysadmin can say that a
given domain is free to do anything it wants. Lets say a user seriously
customized httpd and they want httpd to just be allowed to run wild
while still keeping enforcing for everything else in the system. With
the kernel patch I want to commit and the userspace changes dan has
already pushed this week they just need a simple policy which says
"permissive httpd_t" and all their httpd_t denials become allows!
One of the upstream patches adds a BUG_ON() but I'm still a teensy bit
scared of it so in the F9 patch I'll probably make it a WARN_ON since it
isn't really deadly to the kernel... anyway. Chances of regression
here are very very low.
I would just jam this in myself but we are getting really late and I
wanted people to be able to tell me no before I did it. If noone
strongly objects quickly expect to see a commit message early this
week....
-Eric
16 years, 1 month
- 5
- 7
kernel posttrans and preun hooks for other packages
by Matt Domsch
https://bugzilla.redhat.com/show_bug.cgi?id=433121
DKMS would like to have the opportunity to run it's
auto-rebuilder/installer after a new kernel RPM has been installed,
without having to wait for a system restart to run it. Likewise, when
a kernel RPM is removed, it would like to be able to run to remove
modules managed by it.
Debian kernels intentionally run scripts located in
/etc/kernel/postinst.d/ following new kernel package installation,
/etc/kernel/prerm.d/ before kernel package removal. DKMS drops a
script into these directories, to perform the appropriate actions.
I want Fedora and RHEL kernels to do likewise. Patch attached.
This patch implements the same interface as that used for Debian and
Ubuntu kernels. The scripts are invoked with $1 = kernel version, and
$2 = path to vmlinuz file. (DKMS doesn't need $2, but I'm keeping the
interface the same to match so people can reuse their scriptlets.)
--
Matt Domsch
Linux Technology Strategist, Dell Office of the CTO
linux.dell.com & www.dell.com/linux
--- kernel.spec.orig 2008-02-15 21:06:33.000000000 -0600
+++ kernel.spec 2008-02-16 00:07:36.000000000 -0600
@@ -1610,11 +1610,35 @@
%{nil}
#
+# This macro defines a %%posttrans script for a kernel package.
+# %%kernel_variant_posttrans [-v <subpackage>] [-s <s> -r <r>] <mkinitrd-args>
+# More text can follow to go at the end of this variant's %%posttrans.
+#
+%define kernel_variant_posttrans(v:) \
+%{expand:%%posttrans %{?-v*}}\
+for d in /etc/kernel/postinst.d /etc/kernel/postinst.d/%{KVERREL}%{?-v*} ; do \
+ if [ -d "${d}" ]; then \
+ for f in $(ls ${d}/); do \
+ [ -x "${d}/${f}" ] && "${d}/${f}" %{KVERREL}%{?-v*} /boot/vmlinuz-%{KVERREL}%{?-v*} \
+ done \
+ fi \
+done \
+exit 0\
+%{nil}
+
+#
# This macro defines a %%preun script for a kernel package.
# %%kernel_variant_preun <subpackage>
#
%define kernel_variant_preun() \
%{expand:%%preun %{?1}}\
+for d in /etc/kernel/prerm.d /etc/kernel/prerm.d/%{KVERREL}%{?1} ; do \
+ if [ -d "${d}" ]; then \
+ for f in $(ls ${d}/); do \
+ [ -x "${d}/${f}" ] && "${d}/${f}" %{KVERREL}%{?1} /boot/vmlinuz-%{KVERREL}%{?1} \
+ done \
+ fi \
+done \
/sbin/new-kernel-pkg --rminitrd --rmmoddep --remove %{KVERREL}%{?1} || exit $?\
#if [ -x /sbin/weak-modules ]\
#then\
@@ -1624,12 +1648,15 @@
%kernel_variant_preun
%kernel_variant_post -s kernel-smp -r kernel
+%kernel_variant_posttrans
%kernel_variant_preun smp
%kernel_variant_post -v smp
+%kernel_variant_posttrans -v smp
%kernel_variant_preun PAE
%kernel_variant_post -v PAE -s kernel-smp -r kernel-PAE
+%kernel_variant_posttrans -v PAE
%kernel_variant_preun debug
%kernel_variant_post -v debug
@@ -1644,6 +1671,8 @@
/sbin/ldconfig -X || exit $?
fi
+%kernel_variant_posttrans -v xen
+
###
### file lists
###
16 years, 1 month
- 8
- 26
Rawhide kernel debuginfo size more than doubled!
by Ananth N Mavinakayanahalli
Hi,
Updating my rawhide box, I found:
kernel-debuginfo i686 2.6.25-0.172.rc7.git4.fc9 rawhide-debuginfo 47 k
kernel-debuginfo-common i686 2.6.25-0.172.rc7.git4.fc9 rawhide-debuginfo 486 M
- Did anything in the F9 builds change that lead to this more than
two-fold increase in the debuginfo size?
- Or is it that the "common" rpm needs updation once every kernel
release with just "updates" for every update to the same release
thereafter?
Ananth
16 years, 1 month
- 3
- 8
Re: WebCam drivers ...
by Clinton Lee Taylor
Greetings Hans de Goede ...
I can't comment on the code, but I, and I'm sure many others welcome
any effort to improve the WebCam drivers in Fedora. Many thanks.
I have three USB WebCam's myself
- 05a9:a511 OmniVision Technologies, Inc. OV511+ WebCam (Creative )
- 05a9:8519 OmniVision Technologies, Inc. OV519 WebCam (D-Link)
- 046d:08c2 Logitech, Inc.
So if you hack on any of these and need a tester, I'm always lurking
on the list.
Mailed
LeeT
P.S. Also have 08bb:2901 Texas Instruments Japan (Burr-Brown from TI)
Multiple Telephone recorder if you want to test something else ... ;-)
16 years, 1 month
- 2
- 2
utrace is back
by Roland McGrath
I've put the 2.6.25 rebase of utrace back in and kicked off a build.
I'll pick up the pieces if it comes out all broken.
(It already did, cause I forgot to test the ppc32 build upstream.)
For the moment it's applied as one big patch instead of a series.
I haven't figured out the arrangement for the new series yet.
There is some amount of mayhem going on and this rebase was kind of hack
and slash. But there's more churn than real change. About a third of the
work is upstream now. All of the "quick and dirty" I've put together this
week is actually either what's already upstream or nearly identical to
what's been in F8 et al for a long time. So despite the late date and
general disorganization of it all, this won't be as destabilizing as it sounds.
Thanks,
Roland
16 years, 1 month
- 2
- 3
[New Driver]: usbvideo2 webcam core + pac207 driver using it.
by Hans de Goede
Hi All,
As explained in my introduction mail I've been working on a standalone v4l2
driver for pac207 based usb webcams. I've attached the hopefully pretty clean
result to this mail.
This is the promised split version of the pac207 driver I've been working on, I
would like to ask everyone to take a good look at this, as I plan to base a
number of other (gspca derived) v4l2 drivers on this same core.
I'm currently posting these as .c files for easy reading and compilation /
testing, but I still hope to get a lot of feedback / a thorough review, esp of
the core <-> pac207 split version as I hope to submit that as a patch for
mainline inclusion soon.
Thanks & Regards,
Hans
16 years, 1 month
- 1
- 0