2005-11-09 13:37:07 +08:00
|
|
|
/*
|
2005-11-09 13:38:27 +08:00
|
|
|
em28xx-core.c - driver for Empia EM2800/EM2820/2840 USB video capture devices
|
2005-11-09 13:37:07 +08:00
|
|
|
|
2005-11-09 13:38:25 +08:00
|
|
|
Copyright (C) 2005 Ludovico Cavedon <cavedon@sssup.it>
|
|
|
|
Markus Rechberger <mrechberger@gmail.com>
|
2006-04-03 18:53:40 +08:00
|
|
|
Mauro Carvalho Chehab <mchehab@infradead.org>
|
2005-11-09 13:38:25 +08:00
|
|
|
Sascha Sommer <saschasommer@freenet.de>
|
2005-11-09 13:37:07 +08:00
|
|
|
|
|
|
|
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/init.h>
|
|
|
|
#include <linux/list.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/usb.h>
|
|
|
|
#include <linux/vmalloc.h>
|
|
|
|
|
2005-11-09 13:38:25 +08:00
|
|
|
#include "em28xx.h"
|
2005-11-09 13:37:07 +08:00
|
|
|
|
|
|
|
/* #define ENABLE_DEBUG_ISOC_FRAMES */
|
|
|
|
|
2008-04-23 01:41:48 +08:00
|
|
|
static unsigned int core_debug;
|
2005-11-09 13:37:07 +08:00
|
|
|
module_param(core_debug,int,0644);
|
|
|
|
MODULE_PARM_DESC(core_debug,"enable debug messages [core]");
|
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
#define em28xx_coredbg(fmt, arg...) do {\
|
2005-11-09 13:37:43 +08:00
|
|
|
if (core_debug) \
|
|
|
|
printk(KERN_INFO "%s %s :"fmt, \
|
2008-04-09 10:20:00 +08:00
|
|
|
dev->name, __func__ , ##arg); } while (0)
|
2005-11-09 13:37:07 +08:00
|
|
|
|
2008-04-23 01:41:48 +08:00
|
|
|
static unsigned int reg_debug;
|
2005-11-09 13:37:07 +08:00
|
|
|
module_param(reg_debug,int,0644);
|
|
|
|
MODULE_PARM_DESC(reg_debug,"enable debug messages [URB reg]");
|
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
#define em28xx_regdbg(fmt, arg...) do {\
|
2005-11-09 13:37:43 +08:00
|
|
|
if (reg_debug) \
|
|
|
|
printk(KERN_INFO "%s %s :"fmt, \
|
2008-04-09 10:20:00 +08:00
|
|
|
dev->name, __func__ , ##arg); } while (0)
|
2005-11-09 13:37:07 +08:00
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
static int alt = EM28XX_PINOUT;
|
2005-11-09 13:37:07 +08:00
|
|
|
module_param(alt, int, 0644);
|
|
|
|
MODULE_PARM_DESC(alt, "alternate setting to use for video endpoint");
|
|
|
|
|
2008-04-18 08:40:16 +08:00
|
|
|
/* FIXME */
|
|
|
|
#define em28xx_isocdbg(fmt, arg...) do {\
|
|
|
|
if (core_debug) \
|
|
|
|
printk(KERN_INFO "%s %s :"fmt, \
|
|
|
|
dev->name, __func__ , ##arg); } while (0)
|
|
|
|
|
2005-11-09 13:37:07 +08:00
|
|
|
/*
|
2005-11-09 13:38:27 +08:00
|
|
|
* em28xx_read_reg_req()
|
2005-11-09 13:37:07 +08:00
|
|
|
* reads data from the usb device specifying bRequest
|
|
|
|
*/
|
2005-11-09 13:38:27 +08:00
|
|
|
int em28xx_read_reg_req_len(struct em28xx *dev, u8 req, u16 reg,
|
2005-11-09 13:37:07 +08:00
|
|
|
char *buf, int len)
|
|
|
|
{
|
|
|
|
int ret, byte;
|
|
|
|
|
2006-02-07 16:49:11 +08:00
|
|
|
if (dev->state & DEV_DISCONNECTED)
|
|
|
|
return(-ENODEV);
|
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
em28xx_regdbg("req=%02x, reg=%02x ", req, reg);
|
2005-11-09 13:37:07 +08:00
|
|
|
|
|
|
|
ret = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0), req,
|
|
|
|
USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
|
|
|
|
0x0000, reg, buf, len, HZ);
|
|
|
|
|
2008-04-18 08:41:10 +08:00
|
|
|
if (reg_debug) {
|
2005-11-09 13:37:07 +08:00
|
|
|
printk(ret < 0 ? " failed!\n" : "%02x values: ", ret);
|
2008-04-18 08:41:10 +08:00
|
|
|
for (byte = 0; byte < len; byte++)
|
2008-04-18 08:46:14 +08:00
|
|
|
printk(" %02x", (unsigned char)buf[byte]);
|
2008-04-18 08:41:10 +08:00
|
|
|
|
2008-04-18 08:46:14 +08:00
|
|
|
printk("\n");
|
2005-11-09 13:37:07 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
2005-11-09 13:38:27 +08:00
|
|
|
* em28xx_read_reg_req()
|
2005-11-09 13:37:07 +08:00
|
|
|
* reads data from the usb device specifying bRequest
|
|
|
|
*/
|
2005-11-09 13:38:27 +08:00
|
|
|
int em28xx_read_reg_req(struct em28xx *dev, u8 req, u16 reg)
|
2005-11-09 13:37:07 +08:00
|
|
|
{
|
|
|
|
u8 val;
|
|
|
|
int ret;
|
|
|
|
|
2006-02-07 16:49:11 +08:00
|
|
|
if (dev->state & DEV_DISCONNECTED)
|
|
|
|
return(-ENODEV);
|
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
em28xx_regdbg("req=%02x, reg=%02x:", req, reg);
|
2005-11-09 13:37:07 +08:00
|
|
|
|
|
|
|
ret = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0), req,
|
|
|
|
USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
|
|
|
|
0x0000, reg, &val, 1, HZ);
|
|
|
|
|
|
|
|
if (reg_debug)
|
2008-02-07 02:55:19 +08:00
|
|
|
printk(ret < 0 ? " failed!\n" :
|
|
|
|
"%02x\n", (unsigned char) val);
|
2005-11-09 13:37:07 +08:00
|
|
|
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
return val;
|
|
|
|
}
|
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
int em28xx_read_reg(struct em28xx *dev, u16 reg)
|
2005-11-09 13:37:07 +08:00
|
|
|
{
|
2005-11-09 13:38:27 +08:00
|
|
|
return em28xx_read_reg_req(dev, USB_REQ_GET_STATUS, reg);
|
2005-11-09 13:37:07 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
2005-11-09 13:38:27 +08:00
|
|
|
* em28xx_write_regs_req()
|
2005-11-09 13:37:07 +08:00
|
|
|
* sends data to the usb device, specifying bRequest
|
|
|
|
*/
|
2005-11-09 13:38:27 +08:00
|
|
|
int em28xx_write_regs_req(struct em28xx *dev, u8 req, u16 reg, char *buf,
|
2005-11-09 13:37:07 +08:00
|
|
|
int len)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
/*usb_control_msg seems to expect a kmalloced buffer */
|
2006-02-07 16:49:11 +08:00
|
|
|
unsigned char *bufs;
|
|
|
|
|
|
|
|
if (dev->state & DEV_DISCONNECTED)
|
2008-04-18 08:48:00 +08:00
|
|
|
return -ENODEV;
|
|
|
|
|
|
|
|
if (len < 1)
|
|
|
|
return -EINVAL;
|
2006-02-07 16:49:11 +08:00
|
|
|
|
|
|
|
bufs = kmalloc(len, GFP_KERNEL);
|
2005-11-09 13:37:07 +08:00
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
em28xx_regdbg("req=%02x reg=%02x:", req, reg);
|
2005-11-09 13:37:07 +08:00
|
|
|
|
|
|
|
if (reg_debug) {
|
|
|
|
int i;
|
|
|
|
for (i = 0; i < len; ++i)
|
2008-04-18 08:46:14 +08:00
|
|
|
printk(" %02x", (unsigned char)buf[i]);
|
|
|
|
printk("\n");
|
2005-11-09 13:37:07 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
if (!bufs)
|
|
|
|
return -ENOMEM;
|
|
|
|
memcpy(bufs, buf, len);
|
|
|
|
ret = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0), req,
|
|
|
|
USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
|
|
|
|
0x0000, reg, bufs, len, HZ);
|
2008-04-18 08:42:14 +08:00
|
|
|
if (dev->wait_after_write)
|
|
|
|
msleep(dev->wait_after_write);
|
|
|
|
|
2005-11-09 13:37:07 +08:00
|
|
|
kfree(bufs);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
int em28xx_write_regs(struct em28xx *dev, u16 reg, char *buf, int len)
|
2005-11-09 13:37:07 +08:00
|
|
|
{
|
2008-04-18 08:48:00 +08:00
|
|
|
int rc;
|
|
|
|
|
|
|
|
rc = em28xx_write_regs_req(dev, USB_REQ_GET_STATUS, reg, buf, len);
|
|
|
|
|
|
|
|
/* Stores GPO/GPIO values at the cache, if changed
|
|
|
|
Only write values should be stored, since input on a GPIO
|
|
|
|
register will return the input bits.
|
|
|
|
Not sure what happens on reading GPO register.
|
|
|
|
*/
|
|
|
|
if (rc >= 0) {
|
|
|
|
if (reg == EM2880_R04_GPO)
|
|
|
|
dev->reg_gpo = buf[0];
|
|
|
|
else if (reg == EM28XX_R08_GPIO)
|
|
|
|
dev->reg_gpio = buf[0];
|
|
|
|
}
|
|
|
|
|
|
|
|
return rc;
|
2005-11-09 13:37:07 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
2005-11-09 13:38:27 +08:00
|
|
|
* em28xx_write_reg_bits()
|
2005-11-09 13:37:07 +08:00
|
|
|
* sets only some bits (specified by bitmask) of a register, by first reading
|
|
|
|
* the actual value
|
|
|
|
*/
|
2008-01-29 09:10:48 +08:00
|
|
|
static int em28xx_write_reg_bits(struct em28xx *dev, u16 reg, u8 val,
|
2005-11-09 13:37:07 +08:00
|
|
|
u8 bitmask)
|
|
|
|
{
|
|
|
|
int oldval;
|
|
|
|
u8 newval;
|
2008-04-18 08:41:10 +08:00
|
|
|
|
2008-04-18 08:48:00 +08:00
|
|
|
/* Uses cache for gpo/gpio registers */
|
|
|
|
if (reg == EM2880_R04_GPO)
|
|
|
|
oldval = dev->reg_gpo;
|
|
|
|
else if (reg == EM28XX_R08_GPIO)
|
|
|
|
oldval = dev->reg_gpio;
|
|
|
|
else
|
|
|
|
oldval = em28xx_read_reg(dev, reg);
|
2008-04-18 08:41:10 +08:00
|
|
|
|
|
|
|
if (oldval < 0)
|
2005-11-09 13:37:07 +08:00
|
|
|
return oldval;
|
2008-04-18 08:41:10 +08:00
|
|
|
|
2005-11-09 13:37:07 +08:00
|
|
|
newval = (((u8) oldval) & ~bitmask) | (val & bitmask);
|
2008-04-18 08:48:00 +08:00
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
return em28xx_write_regs(dev, reg, &newval, 1);
|
2005-11-09 13:37:07 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
2005-11-09 13:38:27 +08:00
|
|
|
* em28xx_write_ac97()
|
2005-11-09 13:37:07 +08:00
|
|
|
* write a 16 bit value to the specified AC97 address (LSB first!)
|
|
|
|
*/
|
2008-01-05 20:53:54 +08:00
|
|
|
static int em28xx_write_ac97(struct em28xx *dev, u8 reg, u8 *val)
|
2005-11-09 13:37:07 +08:00
|
|
|
{
|
2008-02-07 05:34:13 +08:00
|
|
|
int ret, i;
|
2005-11-09 13:37:07 +08:00
|
|
|
u8 addr = reg & 0x7f;
|
2008-04-18 08:41:10 +08:00
|
|
|
|
2008-04-18 08:44:58 +08:00
|
|
|
ret = em28xx_write_regs(dev, EM28XX_R40_AC97LSB, val, 2);
|
2008-04-18 08:41:10 +08:00
|
|
|
if (ret < 0)
|
2005-11-09 13:37:07 +08:00
|
|
|
return ret;
|
2008-04-18 08:41:10 +08:00
|
|
|
|
2008-04-18 08:44:58 +08:00
|
|
|
ret = em28xx_write_regs(dev, EM28XX_R42_AC97ADDR, &addr, 1);
|
2008-04-18 08:41:10 +08:00
|
|
|
if (ret < 0)
|
2005-11-09 13:37:07 +08:00
|
|
|
return ret;
|
2008-02-07 05:34:13 +08:00
|
|
|
|
|
|
|
/* Wait up to 50 ms for AC97 command to complete */
|
|
|
|
for (i = 0; i < 10; i++) {
|
2008-04-18 08:44:58 +08:00
|
|
|
ret = em28xx_read_reg(dev, EM28XX_R43_AC97BUSY);
|
2008-04-18 08:41:10 +08:00
|
|
|
if (ret < 0)
|
2008-02-07 05:34:13 +08:00
|
|
|
return ret;
|
2008-04-18 08:41:10 +08:00
|
|
|
|
2008-03-05 00:09:09 +08:00
|
|
|
if (!(ret & 0x01))
|
2008-02-07 05:34:13 +08:00
|
|
|
return 0;
|
|
|
|
msleep(5);
|
2005-11-09 13:37:07 +08:00
|
|
|
}
|
2008-04-18 08:41:10 +08:00
|
|
|
em28xx_warn("AC97 command still being executed: not handled properly!\n");
|
2005-11-09 13:37:07 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2008-02-07 05:34:13 +08:00
|
|
|
static int em28xx_set_audio_source(struct em28xx *dev)
|
2008-01-05 20:53:54 +08:00
|
|
|
{
|
|
|
|
static char *enable = "\x08\x08";
|
|
|
|
static char *disable = "\x08\x88";
|
|
|
|
char *video = enable, *line = disable;
|
2008-02-05 18:37:21 +08:00
|
|
|
int ret;
|
2008-01-05 20:53:54 +08:00
|
|
|
u8 input;
|
|
|
|
|
|
|
|
if (dev->is_em2800) {
|
|
|
|
if (dev->ctl_ainput)
|
|
|
|
input = EM2800_AUDIO_SRC_LINE;
|
|
|
|
else
|
|
|
|
input = EM2800_AUDIO_SRC_TUNER;
|
|
|
|
|
2008-04-18 08:44:58 +08:00
|
|
|
ret = em28xx_write_regs(dev, EM2800_R08_AUDIOSRC, &input, 1);
|
2008-01-05 20:53:54 +08:00
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (dev->has_msp34xx)
|
|
|
|
input = EM28XX_AUDIO_SRC_TUNER;
|
|
|
|
else {
|
|
|
|
switch (dev->ctl_ainput) {
|
|
|
|
case EM28XX_AMUX_VIDEO:
|
|
|
|
input = EM28XX_AUDIO_SRC_TUNER;
|
|
|
|
break;
|
|
|
|
case EM28XX_AMUX_LINE_IN:
|
|
|
|
input = EM28XX_AUDIO_SRC_LINE;
|
|
|
|
break;
|
|
|
|
case EM28XX_AMUX_AC97_VIDEO:
|
|
|
|
input = EM28XX_AUDIO_SRC_LINE;
|
|
|
|
break;
|
|
|
|
case EM28XX_AMUX_AC97_LINE_IN:
|
|
|
|
input = EM28XX_AUDIO_SRC_LINE;
|
|
|
|
video = disable;
|
|
|
|
line = enable;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2008-04-18 08:44:58 +08:00
|
|
|
ret = em28xx_write_reg_bits(dev, EM28XX_R0E_AUDIOSRC, input, 0xc0);
|
2008-01-05 20:53:54 +08:00
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
2008-02-07 05:34:13 +08:00
|
|
|
msleep(5);
|
2008-01-05 20:53:54 +08:00
|
|
|
|
2008-02-06 09:29:26 +08:00
|
|
|
/* Sets AC97 mixer registers
|
|
|
|
This is seems to be needed, even for non-ac97 configs
|
|
|
|
*/
|
2008-04-18 08:44:58 +08:00
|
|
|
ret = em28xx_write_ac97(dev, EM28XX_R14_VIDEO_AC97, video);
|
2008-01-05 20:53:54 +08:00
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
2008-04-18 08:44:58 +08:00
|
|
|
ret = em28xx_write_ac97(dev, EM28XX_R10_LINE_IN_AC97, line);
|
2008-01-05 20:53:54 +08:00
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
int em28xx_audio_analog_set(struct em28xx *dev)
|
2005-11-09 13:37:07 +08:00
|
|
|
{
|
2008-01-05 20:53:54 +08:00
|
|
|
int ret;
|
2005-11-09 13:37:07 +08:00
|
|
|
char s[2] = { 0x00, 0x00 };
|
2008-01-06 04:01:41 +08:00
|
|
|
u8 xclk = 0x07;
|
2008-01-05 20:53:54 +08:00
|
|
|
|
2005-11-09 13:37:07 +08:00
|
|
|
s[0] |= 0x1f - dev->volume;
|
|
|
|
s[1] |= 0x1f - dev->volume;
|
2008-01-05 20:53:54 +08:00
|
|
|
|
2008-02-07 05:34:13 +08:00
|
|
|
/* Mute */
|
|
|
|
s[1] |= 0x80;
|
2008-04-18 08:44:58 +08:00
|
|
|
ret = em28xx_write_ac97(dev, EM28XX_R02_MASTER_AC97, s);
|
2008-02-07 05:34:13 +08:00
|
|
|
|
2008-01-05 20:53:54 +08:00
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
2008-01-06 04:01:41 +08:00
|
|
|
if (dev->has_12mhz_i2s)
|
|
|
|
xclk |= 0x20;
|
|
|
|
|
|
|
|
if (!dev->mute)
|
|
|
|
xclk |= 0x80;
|
|
|
|
|
2008-04-18 08:44:58 +08:00
|
|
|
ret = em28xx_write_reg_bits(dev, EM28XX_R0F_XCLK, xclk, 0xa7);
|
2008-01-05 20:53:54 +08:00
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
2008-01-06 04:01:41 +08:00
|
|
|
msleep(10);
|
2008-01-05 20:53:54 +08:00
|
|
|
|
|
|
|
/* Selects the proper audio input */
|
|
|
|
ret = em28xx_set_audio_source(dev);
|
2005-11-09 13:37:07 +08:00
|
|
|
|
2008-02-07 05:34:13 +08:00
|
|
|
/* Unmute device */
|
|
|
|
if (!dev->mute)
|
|
|
|
s[1] &= ~0x80;
|
2008-04-18 08:44:58 +08:00
|
|
|
ret = em28xx_write_ac97(dev, EM28XX_R02_MASTER_AC97, s);
|
2008-02-07 05:34:13 +08:00
|
|
|
|
2008-01-05 20:53:54 +08:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(em28xx_audio_analog_set);
|
2005-11-09 13:37:07 +08:00
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
int em28xx_colorlevels_set_default(struct em28xx *dev)
|
2005-11-09 13:37:07 +08:00
|
|
|
{
|
2008-04-18 08:44:58 +08:00
|
|
|
em28xx_write_regs(dev, EM28XX_R20_YGAIN, "\x10", 1); /* contrast */
|
|
|
|
em28xx_write_regs(dev, EM28XX_R21_YOFFSET, "\x00", 1); /* brightness */
|
|
|
|
em28xx_write_regs(dev, EM28XX_R22_UVGAIN, "\x10", 1); /* saturation */
|
|
|
|
em28xx_write_regs(dev, EM28XX_R23_UOFFSET, "\x00", 1);
|
|
|
|
em28xx_write_regs(dev, EM28XX_R24_VOFFSET, "\x00", 1);
|
|
|
|
em28xx_write_regs(dev, EM28XX_R25_SHARPNESS, "\x00", 1);
|
|
|
|
|
|
|
|
em28xx_write_regs(dev, EM28XX_R14_GAMMA, "\x20", 1);
|
|
|
|
em28xx_write_regs(dev, EM28XX_R15_RGAIN, "\x20", 1);
|
|
|
|
em28xx_write_regs(dev, EM28XX_R16_GGAIN, "\x20", 1);
|
|
|
|
em28xx_write_regs(dev, EM28XX_R17_BGAIN, "\x20", 1);
|
|
|
|
em28xx_write_regs(dev, EM28XX_R18_ROFFSET, "\x00", 1);
|
|
|
|
em28xx_write_regs(dev, EM28XX_R19_GOFFSET, "\x00", 1);
|
|
|
|
return em28xx_write_regs(dev, EM28XX_R1A_BOFFSET, "\x00", 1);
|
2005-11-09 13:37:07 +08:00
|
|
|
}
|
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
int em28xx_capture_start(struct em28xx *dev, int start)
|
2005-11-09 13:37:07 +08:00
|
|
|
{
|
2008-04-18 08:37:31 +08:00
|
|
|
int rc;
|
2005-11-09 13:37:07 +08:00
|
|
|
/* FIXME: which is the best order? */
|
|
|
|
/* video registers are sampled by VREF */
|
2008-04-18 08:44:58 +08:00
|
|
|
rc = em28xx_write_reg_bits(dev, EM28XX_R0C_USBSUSP,
|
2008-04-18 08:37:31 +08:00
|
|
|
start ? 0x10 : 0x00, 0x10);
|
|
|
|
if (rc < 0)
|
|
|
|
return rc;
|
|
|
|
|
|
|
|
if (!start) {
|
|
|
|
/* disable video capture */
|
2008-04-18 08:44:58 +08:00
|
|
|
rc = em28xx_write_regs(dev, EM28XX_R12_VINENABLE, "\x27", 1);
|
2008-04-18 08:40:45 +08:00
|
|
|
return rc;
|
2008-04-18 08:37:31 +08:00
|
|
|
}
|
|
|
|
|
2005-11-09 13:37:07 +08:00
|
|
|
/* enable video capture */
|
2008-04-18 08:37:31 +08:00
|
|
|
rc = em28xx_write_regs_req(dev, 0x00, 0x48, "\x00", 1);
|
2008-04-18 08:40:45 +08:00
|
|
|
|
2008-04-18 08:37:31 +08:00
|
|
|
if (dev->mode == EM28XX_ANALOG_MODE)
|
2008-04-18 08:44:58 +08:00
|
|
|
rc = em28xx_write_regs(dev, EM28XX_R12_VINENABLE, "\x67", 1);
|
2008-04-18 08:37:31 +08:00
|
|
|
else
|
2008-04-18 08:44:58 +08:00
|
|
|
rc = em28xx_write_regs(dev, EM28XX_R12_VINENABLE, "\x37", 1);
|
2008-04-18 08:37:31 +08:00
|
|
|
|
2008-04-18 08:41:10 +08:00
|
|
|
msleep(6);
|
2008-04-18 08:37:31 +08:00
|
|
|
|
|
|
|
return rc;
|
2005-11-09 13:37:07 +08:00
|
|
|
}
|
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
int em28xx_outfmt_set_yuv422(struct em28xx *dev)
|
2005-11-09 13:37:07 +08:00
|
|
|
{
|
2008-04-18 08:44:58 +08:00
|
|
|
em28xx_write_regs(dev, EM28XX_R27_OUTFMT, "\x34", 1);
|
|
|
|
em28xx_write_regs(dev, EM28XX_R10_VINMODE, "\x10", 1);
|
|
|
|
return em28xx_write_regs(dev, EM28XX_R11_VINCTRL, "\x11", 1);
|
2005-11-09 13:37:07 +08:00
|
|
|
}
|
|
|
|
|
2006-05-22 21:31:42 +08:00
|
|
|
static int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax,
|
|
|
|
u8 ymin, u8 ymax)
|
2005-11-09 13:37:07 +08:00
|
|
|
{
|
2008-04-18 08:41:10 +08:00
|
|
|
em28xx_coredbg("em28xx Scale: (%d,%d)-(%d,%d)\n",
|
|
|
|
xmin, ymin, xmax, ymax);
|
2005-11-09 13:37:07 +08:00
|
|
|
|
2008-04-18 08:44:58 +08:00
|
|
|
em28xx_write_regs(dev, EM28XX_R28_XMIN, &xmin, 1);
|
|
|
|
em28xx_write_regs(dev, EM28XX_R29_XMAX, &xmax, 1);
|
|
|
|
em28xx_write_regs(dev, EM28XX_R2A_YMIN, &ymin, 1);
|
|
|
|
return em28xx_write_regs(dev, EM28XX_R2B_YMAX, &ymax, 1);
|
2005-11-09 13:37:07 +08:00
|
|
|
}
|
|
|
|
|
2006-05-22 21:31:42 +08:00
|
|
|
static int em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart,
|
2005-11-09 13:37:07 +08:00
|
|
|
u16 width, u16 height)
|
|
|
|
{
|
|
|
|
u8 cwidth = width;
|
|
|
|
u8 cheight = height;
|
|
|
|
u8 overflow = (height >> 7 & 0x02) | (width >> 8 & 0x01);
|
|
|
|
|
2008-04-18 08:41:10 +08:00
|
|
|
em28xx_coredbg("em28xx Area Set: (%d,%d)\n",
|
|
|
|
(width | (overflow & 2) << 7),
|
2005-11-09 13:37:07 +08:00
|
|
|
(height | (overflow & 1) << 8));
|
|
|
|
|
2008-04-18 08:44:58 +08:00
|
|
|
em28xx_write_regs(dev, EM28XX_R1C_HSTART, &hstart, 1);
|
|
|
|
em28xx_write_regs(dev, EM28XX_R1D_VSTART, &vstart, 1);
|
|
|
|
em28xx_write_regs(dev, EM28XX_R1E_CWIDTH, &cwidth, 1);
|
|
|
|
em28xx_write_regs(dev, EM28XX_R1F_CHEIGHT, &cheight, 1);
|
|
|
|
return em28xx_write_regs(dev, EM28XX_R1B_OFLOW, &overflow, 1);
|
2005-11-09 13:37:07 +08:00
|
|
|
}
|
|
|
|
|
2006-05-22 21:31:42 +08:00
|
|
|
static int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v)
|
2005-11-09 13:37:07 +08:00
|
|
|
{
|
2005-11-09 13:38:10 +08:00
|
|
|
u8 mode;
|
|
|
|
/* the em2800 scaler only supports scaling down to 50% */
|
2008-04-18 08:41:10 +08:00
|
|
|
if (dev->is_em2800)
|
2005-11-09 13:38:10 +08:00
|
|
|
mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00);
|
|
|
|
else {
|
|
|
|
u8 buf[2];
|
|
|
|
buf[0] = h;
|
|
|
|
buf[1] = h >> 8;
|
2008-04-18 08:44:58 +08:00
|
|
|
em28xx_write_regs(dev, EM28XX_R30_HSCALELOW, (char *)buf, 2);
|
2005-11-09 13:38:10 +08:00
|
|
|
buf[0] = v;
|
|
|
|
buf[1] = v >> 8;
|
2008-04-18 08:44:58 +08:00
|
|
|
em28xx_write_regs(dev, EM28XX_R32_VSCALELOW, (char *)buf, 2);
|
2008-04-18 08:41:10 +08:00
|
|
|
/* it seems that both H and V scalers must be active
|
|
|
|
to work correctly */
|
2005-11-09 13:38:10 +08:00
|
|
|
mode = (h || v)? 0x30: 0x00;
|
2005-11-09 13:37:33 +08:00
|
|
|
}
|
2008-04-18 08:44:58 +08:00
|
|
|
return em28xx_write_reg_bits(dev, EM28XX_R26_COMPR, mode, 0x30);
|
2005-11-09 13:37:07 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/* FIXME: this only function read values from dev */
|
2005-11-09 13:38:27 +08:00
|
|
|
int em28xx_resolution_set(struct em28xx *dev)
|
2005-11-09 13:37:07 +08:00
|
|
|
{
|
|
|
|
int width, height;
|
|
|
|
width = norm_maxw(dev);
|
|
|
|
height = norm_maxh(dev) >> 1;
|
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
em28xx_outfmt_set_yuv422(dev);
|
|
|
|
em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2);
|
|
|
|
em28xx_capture_area_set(dev, 0, 0, width >> 2, height >> 2);
|
|
|
|
return em28xx_scaler_set(dev, dev->hscale, dev->vscale);
|
2005-11-09 13:37:07 +08:00
|
|
|
}
|
|
|
|
|
2005-11-09 13:38:27 +08:00
|
|
|
int em28xx_set_alternate(struct em28xx *dev)
|
2005-11-09 13:37:07 +08:00
|
|
|
{
|
|
|
|
int errCode, prev_alt = dev->alt;
|
V4L/DVB (7179): Allow more than one em28xx board
em28xx driver is capable of handling more than one usb device. However, isoc
transfers require a large amount of data to be transfered.
Before this patch, just one em28xx board were enough to allocate more than 50%
URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=480/800 us (60%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, only one board could use an USB host at the same time. After the patch, it
is possible to use more than one em28xx at the same time, on the same usb host,
if the image size is slower or equal to 345600, since those images will
require about 30% of the URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=232/800 us (29%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, in thesis, after the patch, it would be possible to use up to 3 boards by
each usb host, if the devices are generating small images.
Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
2008-02-09 02:44:25 +08:00
|
|
|
int i;
|
2008-04-14 02:11:08 +08:00
|
|
|
unsigned int min_pkt_size = dev->width * 2 + 4;
|
V4L/DVB (7179): Allow more than one em28xx board
em28xx driver is capable of handling more than one usb device. However, isoc
transfers require a large amount of data to be transfered.
Before this patch, just one em28xx board were enough to allocate more than 50%
URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=480/800 us (60%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, only one board could use an USB host at the same time. After the patch, it
is possible to use more than one em28xx at the same time, on the same usb host,
if the image size is slower or equal to 345600, since those images will
require about 30% of the URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=232/800 us (29%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, in thesis, after the patch, it would be possible to use up to 3 boards by
each usb host, if the devices are generating small images.
Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
2008-02-09 02:44:25 +08:00
|
|
|
|
2008-04-23 01:45:47 +08:00
|
|
|
/* When image size is bigger than a certain value,
|
V4L/DVB (7179): Allow more than one em28xx board
em28xx driver is capable of handling more than one usb device. However, isoc
transfers require a large amount of data to be transfered.
Before this patch, just one em28xx board were enough to allocate more than 50%
URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=480/800 us (60%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, only one board could use an USB host at the same time. After the patch, it
is possible to use more than one em28xx at the same time, on the same usb host,
if the image size is slower or equal to 345600, since those images will
require about 30% of the URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=232/800 us (29%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, in thesis, after the patch, it would be possible to use up to 3 boards by
each usb host, if the devices are generating small images.
Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
2008-02-09 02:44:25 +08:00
|
|
|
the frame size should be increased, otherwise, only
|
|
|
|
green screen will be received.
|
|
|
|
*/
|
2008-04-14 02:11:08 +08:00
|
|
|
if (dev->width * 2 * dev->height > 720 * 240 * 2)
|
V4L/DVB (7179): Allow more than one em28xx board
em28xx driver is capable of handling more than one usb device. However, isoc
transfers require a large amount of data to be transfered.
Before this patch, just one em28xx board were enough to allocate more than 50%
URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=480/800 us (60%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, only one board could use an USB host at the same time. After the patch, it
is possible to use more than one em28xx at the same time, on the same usb host,
if the image size is slower or equal to 345600, since those images will
require about 30% of the URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=232/800 us (29%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, in thesis, after the patch, it would be possible to use up to 3 boards by
each usb host, if the devices are generating small images.
Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
2008-02-09 02:44:25 +08:00
|
|
|
min_pkt_size *= 2;
|
|
|
|
|
2008-04-23 01:45:47 +08:00
|
|
|
for (i = 0; i < dev->num_alt; i++) {
|
|
|
|
/* stop when the selected alt setting offers enough bandwidth */
|
|
|
|
if (dev->alt_max_pkt_size[i] >= min_pkt_size) {
|
|
|
|
dev->alt = i;
|
V4L/DVB (7179): Allow more than one em28xx board
em28xx driver is capable of handling more than one usb device. However, isoc
transfers require a large amount of data to be transfered.
Before this patch, just one em28xx board were enough to allocate more than 50%
URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=480/800 us (60%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, only one board could use an USB host at the same time. After the patch, it
is possible to use more than one em28xx at the same time, on the same usb host,
if the image size is slower or equal to 345600, since those images will
require about 30% of the URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=232/800 us (29%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, in thesis, after the patch, it would be possible to use up to 3 boards by
each usb host, if the devices are generating small images.
Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
2008-02-09 02:44:25 +08:00
|
|
|
break;
|
2008-04-23 01:45:47 +08:00
|
|
|
/* otherwise make sure that we end up with the maximum bandwidth
|
|
|
|
because the min_pkt_size equation might be wrong...
|
|
|
|
*/
|
|
|
|
} else if (dev->alt_max_pkt_size[i] >
|
|
|
|
dev->alt_max_pkt_size[dev->alt])
|
|
|
|
dev->alt = i;
|
|
|
|
}
|
2005-11-09 13:37:07 +08:00
|
|
|
|
|
|
|
if (dev->alt != prev_alt) {
|
V4L/DVB (7179): Allow more than one em28xx board
em28xx driver is capable of handling more than one usb device. However, isoc
transfers require a large amount of data to be transfered.
Before this patch, just one em28xx board were enough to allocate more than 50%
URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=480/800 us (60%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, only one board could use an USB host at the same time. After the patch, it
is possible to use more than one em28xx at the same time, on the same usb host,
if the image size is slower or equal to 345600, since those images will
require about 30% of the URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=232/800 us (29%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, in thesis, after the patch, it would be possible to use up to 3 boards by
each usb host, if the devices are generating small images.
Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
2008-02-09 02:44:25 +08:00
|
|
|
em28xx_coredbg("minimum isoc packet size: %u (alt=%d)\n",
|
|
|
|
min_pkt_size, dev->alt);
|
2005-11-09 13:37:07 +08:00
|
|
|
dev->max_pkt_size = dev->alt_max_pkt_size[dev->alt];
|
V4L/DVB (7179): Allow more than one em28xx board
em28xx driver is capable of handling more than one usb device. However, isoc
transfers require a large amount of data to be transfered.
Before this patch, just one em28xx board were enough to allocate more than 50%
URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=480/800 us (60%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, only one board could use an USB host at the same time. After the patch, it
is possible to use more than one em28xx at the same time, on the same usb host,
if the image size is slower or equal to 345600, since those images will
require about 30% of the URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=232/800 us (29%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, in thesis, after the patch, it would be possible to use up to 3 boards by
each usb host, if the devices are generating small images.
Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
2008-02-09 02:44:25 +08:00
|
|
|
em28xx_coredbg("setting alternate %d with wMaxPacketSize=%u\n",
|
|
|
|
dev->alt, dev->max_pkt_size);
|
2005-11-09 13:37:07 +08:00
|
|
|
errCode = usb_set_interface(dev->udev, 0, dev->alt);
|
|
|
|
if (errCode < 0) {
|
2008-04-18 08:41:10 +08:00
|
|
|
em28xx_errdev("cannot change alternate number to %d (error=%i)\n",
|
V4L/DVB (7179): Allow more than one em28xx board
em28xx driver is capable of handling more than one usb device. However, isoc
transfers require a large amount of data to be transfered.
Before this patch, just one em28xx board were enough to allocate more than 50%
URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=480/800 us (60%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, only one board could use an USB host at the same time. After the patch, it
is possible to use more than one em28xx at the same time, on the same usb host,
if the image size is slower or equal to 345600, since those images will
require about 30% of the URBs:
T: Bus=02 Lev=00 Prnt=00 Port=00 Cnt=00 Dev#= 1 Spd=480 MxCh= 8
B: Alloc=232/800 us (29%), #Int= 0, #Iso= 2
D: Ver= 2.00 Cls=09(hub ) Sub=00 Prot=01 MxPS=64 #Cfgs= 1
So, in thesis, after the patch, it would be possible to use up to 3 boards by
each usb host, if the devices are generating small images.
Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
2008-02-09 02:44:25 +08:00
|
|
|
dev->alt, errCode);
|
2005-11-09 13:37:07 +08:00
|
|
|
return errCode;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
2008-04-18 08:40:16 +08:00
|
|
|
|
2008-04-18 08:48:00 +08:00
|
|
|
int em28xx_gpio_set(struct em28xx *dev, struct em28xx_reg_seq *gpio)
|
|
|
|
{
|
|
|
|
int rc = 0;
|
|
|
|
|
|
|
|
if (!gpio)
|
|
|
|
return rc;
|
|
|
|
|
|
|
|
dev->em28xx_write_regs_req(dev, 0x00, 0x48, "\x00", 1);
|
|
|
|
if (dev->mode == EM28XX_ANALOG_MODE)
|
|
|
|
dev->em28xx_write_regs_req(dev, 0x00, 0x12, "\x67", 1);
|
|
|
|
else
|
|
|
|
dev->em28xx_write_regs_req(dev, 0x00, 0x12, "\x37", 1);
|
|
|
|
msleep(6);
|
|
|
|
|
|
|
|
/* Send GPIO reset sequences specified at board entry */
|
|
|
|
while (gpio->sleep >= 0) {
|
|
|
|
if (gpio->reg >= 0) {
|
|
|
|
rc = em28xx_write_reg_bits(dev,
|
|
|
|
gpio->reg,
|
|
|
|
gpio->val,
|
|
|
|
gpio->mask);
|
|
|
|
if (rc < 0)
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
if (gpio->sleep > 0)
|
|
|
|
msleep(gpio->sleep);
|
|
|
|
|
|
|
|
gpio++;
|
|
|
|
}
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
|
|
|
int em28xx_set_mode(struct em28xx *dev, enum em28xx_mode set_mode)
|
|
|
|
{
|
|
|
|
if (dev->mode == set_mode)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
if (set_mode == EM28XX_MODE_UNDEFINED) {
|
|
|
|
dev->mode = set_mode;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
dev->mode = set_mode;
|
|
|
|
|
|
|
|
if (dev->mode == EM28XX_DIGITAL_MODE)
|
|
|
|
return em28xx_gpio_set(dev, dev->digital_gpio);
|
|
|
|
else
|
|
|
|
return em28xx_gpio_set(dev, dev->analog_gpio);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(em28xx_set_mode);
|
|
|
|
|
2008-04-18 08:40:16 +08:00
|
|
|
/* ------------------------------------------------------------------
|
|
|
|
URB control
|
|
|
|
------------------------------------------------------------------*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
* IRQ callback, called by URB callback
|
|
|
|
*/
|
|
|
|
static void em28xx_irq_callback(struct urb *urb)
|
|
|
|
{
|
|
|
|
struct em28xx_dmaqueue *dma_q = urb->context;
|
|
|
|
struct em28xx *dev = container_of(dma_q, struct em28xx, vidq);
|
|
|
|
int rc, i;
|
|
|
|
|
|
|
|
/* Copy data from URB */
|
|
|
|
spin_lock(&dev->slock);
|
|
|
|
rc = dev->isoc_ctl.isoc_copy(dev, urb);
|
|
|
|
spin_unlock(&dev->slock);
|
|
|
|
|
|
|
|
/* Reset urb buffers */
|
|
|
|
for (i = 0; i < urb->number_of_packets; i++) {
|
|
|
|
urb->iso_frame_desc[i].status = 0;
|
|
|
|
urb->iso_frame_desc[i].actual_length = 0;
|
|
|
|
}
|
|
|
|
urb->status = 0;
|
|
|
|
|
|
|
|
urb->status = usb_submit_urb(urb, GFP_ATOMIC);
|
|
|
|
if (urb->status) {
|
2008-04-21 18:01:09 +08:00
|
|
|
em28xx_isocdbg("urb resubmit failed (error=%i)\n",
|
|
|
|
urb->status);
|
2008-04-18 08:40:16 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Stop and Deallocate URBs
|
|
|
|
*/
|
|
|
|
void em28xx_uninit_isoc(struct em28xx *dev)
|
|
|
|
{
|
|
|
|
struct urb *urb;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
em28xx_isocdbg("em28xx: called em28xx_uninit_isoc\n");
|
|
|
|
|
|
|
|
dev->isoc_ctl.nfields = -1;
|
|
|
|
for (i = 0; i < dev->isoc_ctl.num_bufs; i++) {
|
|
|
|
urb = dev->isoc_ctl.urb[i];
|
|
|
|
if (urb) {
|
|
|
|
usb_kill_urb(urb);
|
|
|
|
usb_unlink_urb(urb);
|
|
|
|
if (dev->isoc_ctl.transfer_buffer[i]) {
|
|
|
|
usb_buffer_free(dev->udev,
|
2008-04-18 08:41:10 +08:00
|
|
|
urb->transfer_buffer_length,
|
|
|
|
dev->isoc_ctl.transfer_buffer[i],
|
|
|
|
urb->transfer_dma);
|
2008-04-18 08:40:16 +08:00
|
|
|
}
|
|
|
|
usb_free_urb(urb);
|
|
|
|
dev->isoc_ctl.urb[i] = NULL;
|
|
|
|
}
|
|
|
|
dev->isoc_ctl.transfer_buffer[i] = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
kfree(dev->isoc_ctl.urb);
|
|
|
|
kfree(dev->isoc_ctl.transfer_buffer);
|
|
|
|
|
|
|
|
dev->isoc_ctl.urb = NULL;
|
|
|
|
dev->isoc_ctl.transfer_buffer = NULL;
|
|
|
|
dev->isoc_ctl.num_bufs = 0;
|
|
|
|
|
|
|
|
em28xx_capture_start(dev, 0);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(em28xx_uninit_isoc);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Allocate URBs and start IRQ
|
|
|
|
*/
|
|
|
|
int em28xx_init_isoc(struct em28xx *dev, int max_packets,
|
|
|
|
int num_bufs, int max_pkt_size,
|
2008-04-18 08:48:00 +08:00
|
|
|
int (*isoc_copy) (struct em28xx *dev, struct urb *urb))
|
2008-04-18 08:40:16 +08:00
|
|
|
{
|
|
|
|
struct em28xx_dmaqueue *dma_q = &dev->vidq;
|
|
|
|
int i;
|
|
|
|
int sb_size, pipe;
|
|
|
|
struct urb *urb;
|
|
|
|
int j, k;
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
em28xx_isocdbg("em28xx: called em28xx_prepare_isoc\n");
|
|
|
|
|
|
|
|
/* De-allocates all pending stuff */
|
|
|
|
em28xx_uninit_isoc(dev);
|
|
|
|
|
|
|
|
dev->isoc_ctl.isoc_copy = isoc_copy;
|
|
|
|
dev->isoc_ctl.num_bufs = num_bufs;
|
|
|
|
|
|
|
|
dev->isoc_ctl.urb = kzalloc(sizeof(void *)*num_bufs, GFP_KERNEL);
|
|
|
|
if (!dev->isoc_ctl.urb) {
|
|
|
|
em28xx_errdev("cannot alloc memory for usb buffers\n");
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
dev->isoc_ctl.transfer_buffer = kzalloc(sizeof(void *)*num_bufs,
|
|
|
|
GFP_KERNEL);
|
2008-04-25 07:19:22 +08:00
|
|
|
if (!dev->isoc_ctl.transfer_buffer) {
|
2008-04-18 08:40:16 +08:00
|
|
|
em28xx_errdev("cannot allocate memory for usbtransfer\n");
|
|
|
|
kfree(dev->isoc_ctl.urb);
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
dev->isoc_ctl.max_pkt_size = max_pkt_size;
|
|
|
|
dev->isoc_ctl.buf = NULL;
|
|
|
|
|
|
|
|
sb_size = max_packets * dev->isoc_ctl.max_pkt_size;
|
|
|
|
|
|
|
|
/* allocate urbs and transfer buffers */
|
|
|
|
for (i = 0; i < dev->isoc_ctl.num_bufs; i++) {
|
|
|
|
urb = usb_alloc_urb(max_packets, GFP_KERNEL);
|
|
|
|
if (!urb) {
|
|
|
|
em28xx_err("cannot alloc isoc_ctl.urb %i\n", i);
|
|
|
|
em28xx_uninit_isoc(dev);
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
dev->isoc_ctl.urb[i] = urb;
|
|
|
|
|
|
|
|
dev->isoc_ctl.transfer_buffer[i] = usb_buffer_alloc(dev->udev,
|
|
|
|
sb_size, GFP_KERNEL, &urb->transfer_dma);
|
|
|
|
if (!dev->isoc_ctl.transfer_buffer[i]) {
|
|
|
|
em28xx_err("unable to allocate %i bytes for transfer"
|
|
|
|
" buffer %i%s\n",
|
|
|
|
sb_size, i,
|
|
|
|
in_interrupt()?" while in int":"");
|
|
|
|
em28xx_uninit_isoc(dev);
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
memset(dev->isoc_ctl.transfer_buffer[i], 0, sb_size);
|
|
|
|
|
|
|
|
/* FIXME: this is a hack - should be
|
|
|
|
'desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK'
|
|
|
|
should also be using 'desc.bInterval'
|
|
|
|
*/
|
2008-04-18 08:41:10 +08:00
|
|
|
pipe = usb_rcvisocpipe(dev->udev,
|
2008-04-18 08:48:00 +08:00
|
|
|
dev->mode == EM28XX_ANALOG_MODE ? 0x82 : 0x84);
|
2008-04-18 08:41:10 +08:00
|
|
|
|
2008-04-18 08:40:16 +08:00
|
|
|
usb_fill_int_urb(urb, dev->udev, pipe,
|
|
|
|
dev->isoc_ctl.transfer_buffer[i], sb_size,
|
|
|
|
em28xx_irq_callback, dma_q, 1);
|
|
|
|
|
|
|
|
urb->number_of_packets = max_packets;
|
|
|
|
urb->transfer_flags = URB_ISO_ASAP;
|
|
|
|
|
|
|
|
k = 0;
|
|
|
|
for (j = 0; j < max_packets; j++) {
|
|
|
|
urb->iso_frame_desc[j].offset = k;
|
|
|
|
urb->iso_frame_desc[j].length =
|
|
|
|
dev->isoc_ctl.max_pkt_size;
|
|
|
|
k += dev->isoc_ctl.max_pkt_size;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
init_waitqueue_head(&dma_q->wq);
|
|
|
|
|
2008-04-18 08:48:00 +08:00
|
|
|
em28xx_capture_start(dev, 1);
|
2008-04-18 08:40:16 +08:00
|
|
|
|
|
|
|
/* submit urbs and enables IRQ */
|
|
|
|
for (i = 0; i < dev->isoc_ctl.num_bufs; i++) {
|
|
|
|
rc = usb_submit_urb(dev->isoc_ctl.urb[i], GFP_ATOMIC);
|
|
|
|
if (rc) {
|
|
|
|
em28xx_err("submit of urb %i failed (error=%i)\n", i,
|
|
|
|
rc);
|
|
|
|
em28xx_uninit_isoc(dev);
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(em28xx_init_isoc);
|