mirror of
https://github.com/torvalds/linux
synced 2024-11-05 18:23:50 +00:00
f85ed0ceeb
On Wed, 6 Feb 2013 09:04:39 +0000 Olivier GRENIE <olivier.grenie@parrot.com> wrote: > I do not agree with the patch. Let's take an example: adap->id = 0. Then: > * 1 << ~(adap->id) = 1 << ~(0) = 0 > * ~(1 << adap->id) = ~(1 << 0) = 0xFE > > The correct change should be: st->channel_state |= 1 << (1 - adap->id); Indeed, the original source code was not correct. Requested-by: Olivier GRENIE <olivier.grenie@parrot.com> Cc: Patrick Boettcher <patrick.boettcher@dibcom.fr> Cc: Nickolai Zeldovich <nickolai@csail.mit.edu> Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
844 lines
21 KiB
C
844 lines
21 KiB
C
/* Linux driver for devices based on the DiBcom DiB0700 USB bridge
|
|
*
|
|
* 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, version 2.
|
|
*
|
|
* Copyright (C) 2005-6 DiBcom, SA
|
|
*/
|
|
#include "dib0700.h"
|
|
|
|
/* debug */
|
|
int dvb_usb_dib0700_debug;
|
|
module_param_named(debug,dvb_usb_dib0700_debug, int, 0644);
|
|
MODULE_PARM_DESC(debug, "set debugging level (1=info,2=fw,4=fwdata,8=data (or-able))." DVB_USB_DEBUG_STATUS);
|
|
|
|
static int nb_packet_buffer_size = 21;
|
|
module_param(nb_packet_buffer_size, int, 0644);
|
|
MODULE_PARM_DESC(nb_packet_buffer_size,
|
|
"Set the dib0700 driver data buffer size. This parameter "
|
|
"corresponds to the number of TS packets. The actual size of "
|
|
"the data buffer corresponds to this parameter "
|
|
"multiplied by 188 (default: 21)");
|
|
|
|
DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
|
|
|
|
|
|
int dib0700_get_version(struct dvb_usb_device *d, u32 *hwversion,
|
|
u32 *romversion, u32 *ramversion, u32 *fwtype)
|
|
{
|
|
struct dib0700_state *st = d->priv;
|
|
int ret;
|
|
|
|
if (mutex_lock_interruptible(&d->usb_mutex) < 0) {
|
|
err("could not acquire lock");
|
|
return -EINTR;
|
|
}
|
|
|
|
ret = usb_control_msg(d->udev, usb_rcvctrlpipe(d->udev, 0),
|
|
REQUEST_GET_VERSION,
|
|
USB_TYPE_VENDOR | USB_DIR_IN, 0, 0,
|
|
st->buf, 16, USB_CTRL_GET_TIMEOUT);
|
|
if (hwversion != NULL)
|
|
*hwversion = (st->buf[0] << 24) | (st->buf[1] << 16) |
|
|
(st->buf[2] << 8) | st->buf[3];
|
|
if (romversion != NULL)
|
|
*romversion = (st->buf[4] << 24) | (st->buf[5] << 16) |
|
|
(st->buf[6] << 8) | st->buf[7];
|
|
if (ramversion != NULL)
|
|
*ramversion = (st->buf[8] << 24) | (st->buf[9] << 16) |
|
|
(st->buf[10] << 8) | st->buf[11];
|
|
if (fwtype != NULL)
|
|
*fwtype = (st->buf[12] << 24) | (st->buf[13] << 16) |
|
|
(st->buf[14] << 8) | st->buf[15];
|
|
mutex_unlock(&d->usb_mutex);
|
|
return ret;
|
|
}
|
|
|
|
/* expecting rx buffer: request data[0] data[1] ... data[2] */
|
|
static int dib0700_ctrl_wr(struct dvb_usb_device *d, u8 *tx, u8 txlen)
|
|
{
|
|
int status;
|
|
|
|
deb_data(">>> ");
|
|
debug_dump(tx, txlen, deb_data);
|
|
|
|
status = usb_control_msg(d->udev, usb_sndctrlpipe(d->udev,0),
|
|
tx[0], USB_TYPE_VENDOR | USB_DIR_OUT, 0, 0, tx, txlen,
|
|
USB_CTRL_GET_TIMEOUT);
|
|
|
|
if (status != txlen)
|
|
deb_data("ep 0 write error (status = %d, len: %d)\n",status,txlen);
|
|
|
|
return status < 0 ? status : 0;
|
|
}
|
|
|
|
/* expecting tx buffer: request data[0] ... data[n] (n <= 4) */
|
|
int dib0700_ctrl_rd(struct dvb_usb_device *d, u8 *tx, u8 txlen, u8 *rx, u8 rxlen)
|
|
{
|
|
u16 index, value;
|
|
int status;
|
|
|
|
if (txlen < 2) {
|
|
err("tx buffer length is smaller than 2. Makes no sense.");
|
|
return -EINVAL;
|
|
}
|
|
if (txlen > 4) {
|
|
err("tx buffer length is larger than 4. Not supported.");
|
|
return -EINVAL;
|
|
}
|
|
|
|
deb_data(">>> ");
|
|
debug_dump(tx,txlen,deb_data);
|
|
|
|
value = ((txlen - 2) << 8) | tx[1];
|
|
index = 0;
|
|
if (txlen > 2)
|
|
index |= (tx[2] << 8);
|
|
if (txlen > 3)
|
|
index |= tx[3];
|
|
|
|
status = usb_control_msg(d->udev, usb_rcvctrlpipe(d->udev,0), tx[0],
|
|
USB_TYPE_VENDOR | USB_DIR_IN, value, index, rx, rxlen,
|
|
USB_CTRL_GET_TIMEOUT);
|
|
|
|
if (status < 0)
|
|
deb_info("ep 0 read error (status = %d)\n",status);
|
|
|
|
deb_data("<<< ");
|
|
debug_dump(rx, rxlen, deb_data);
|
|
|
|
return status; /* length in case of success */
|
|
}
|
|
|
|
int dib0700_set_gpio(struct dvb_usb_device *d, enum dib07x0_gpios gpio, u8 gpio_dir, u8 gpio_val)
|
|
{
|
|
struct dib0700_state *st = d->priv;
|
|
int ret;
|
|
|
|
if (mutex_lock_interruptible(&d->usb_mutex) < 0) {
|
|
err("could not acquire lock");
|
|
return -EINTR;
|
|
}
|
|
|
|
st->buf[0] = REQUEST_SET_GPIO;
|
|
st->buf[1] = gpio;
|
|
st->buf[2] = ((gpio_dir & 0x01) << 7) | ((gpio_val & 0x01) << 6);
|
|
|
|
ret = dib0700_ctrl_wr(d, st->buf, 3);
|
|
|
|
mutex_unlock(&d->usb_mutex);
|
|
return ret;
|
|
}
|
|
|
|
static int dib0700_set_usb_xfer_len(struct dvb_usb_device *d, u16 nb_ts_packets)
|
|
{
|
|
struct dib0700_state *st = d->priv;
|
|
int ret;
|
|
|
|
if (st->fw_version >= 0x10201) {
|
|
if (mutex_lock_interruptible(&d->usb_mutex) < 0) {
|
|
err("could not acquire lock");
|
|
return -EINTR;
|
|
}
|
|
|
|
st->buf[0] = REQUEST_SET_USB_XFER_LEN;
|
|
st->buf[1] = (nb_ts_packets >> 8) & 0xff;
|
|
st->buf[2] = nb_ts_packets & 0xff;
|
|
|
|
deb_info("set the USB xfer len to %i Ts packet\n", nb_ts_packets);
|
|
|
|
ret = dib0700_ctrl_wr(d, st->buf, 3);
|
|
mutex_unlock(&d->usb_mutex);
|
|
} else {
|
|
deb_info("this firmware does not allow to change the USB xfer len\n");
|
|
ret = -EIO;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* I2C master xfer function (supported in 1.20 firmware)
|
|
*/
|
|
static int dib0700_i2c_xfer_new(struct i2c_adapter *adap, struct i2c_msg *msg,
|
|
int num)
|
|
{
|
|
/* The new i2c firmware messages are more reliable and in particular
|
|
properly support i2c read calls not preceded by a write */
|
|
|
|
struct dvb_usb_device *d = i2c_get_adapdata(adap);
|
|
struct dib0700_state *st = d->priv;
|
|
uint8_t bus_mode = 1; /* 0=eeprom bus, 1=frontend bus */
|
|
uint8_t gen_mode = 0; /* 0=master i2c, 1=gpio i2c */
|
|
uint8_t en_start = 0;
|
|
uint8_t en_stop = 0;
|
|
int result, i;
|
|
|
|
/* Ensure nobody else hits the i2c bus while we're sending our
|
|
sequence of messages, (such as the remote control thread) */
|
|
if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
|
|
return -EINTR;
|
|
|
|
for (i = 0; i < num; i++) {
|
|
if (i == 0) {
|
|
/* First message in the transaction */
|
|
en_start = 1;
|
|
} else if (!(msg[i].flags & I2C_M_NOSTART)) {
|
|
/* Device supports repeated-start */
|
|
en_start = 1;
|
|
} else {
|
|
/* Not the first packet and device doesn't support
|
|
repeated start */
|
|
en_start = 0;
|
|
}
|
|
if (i == (num - 1)) {
|
|
/* Last message in the transaction */
|
|
en_stop = 1;
|
|
}
|
|
|
|
if (msg[i].flags & I2C_M_RD) {
|
|
/* Read request */
|
|
u16 index, value;
|
|
uint8_t i2c_dest;
|
|
|
|
i2c_dest = (msg[i].addr << 1);
|
|
value = ((en_start << 7) | (en_stop << 6) |
|
|
(msg[i].len & 0x3F)) << 8 | i2c_dest;
|
|
/* I2C ctrl + FE bus; */
|
|
index = ((gen_mode << 6) & 0xC0) |
|
|
((bus_mode << 4) & 0x30);
|
|
|
|
result = usb_control_msg(d->udev,
|
|
usb_rcvctrlpipe(d->udev, 0),
|
|
REQUEST_NEW_I2C_READ,
|
|
USB_TYPE_VENDOR | USB_DIR_IN,
|
|
value, index, msg[i].buf,
|
|
msg[i].len,
|
|
USB_CTRL_GET_TIMEOUT);
|
|
if (result < 0) {
|
|
deb_info("i2c read error (status = %d)\n", result);
|
|
break;
|
|
}
|
|
|
|
deb_data("<<< ");
|
|
debug_dump(msg[i].buf, msg[i].len, deb_data);
|
|
|
|
} else {
|
|
/* Write request */
|
|
if (mutex_lock_interruptible(&d->usb_mutex) < 0) {
|
|
err("could not acquire lock");
|
|
mutex_unlock(&d->i2c_mutex);
|
|
return -EINTR;
|
|
}
|
|
st->buf[0] = REQUEST_NEW_I2C_WRITE;
|
|
st->buf[1] = msg[i].addr << 1;
|
|
st->buf[2] = (en_start << 7) | (en_stop << 6) |
|
|
(msg[i].len & 0x3F);
|
|
/* I2C ctrl + FE bus; */
|
|
st->buf[3] = ((gen_mode << 6) & 0xC0) |
|
|
((bus_mode << 4) & 0x30);
|
|
/* The Actual i2c payload */
|
|
memcpy(&st->buf[4], msg[i].buf, msg[i].len);
|
|
|
|
deb_data(">>> ");
|
|
debug_dump(st->buf, msg[i].len + 4, deb_data);
|
|
|
|
result = usb_control_msg(d->udev,
|
|
usb_sndctrlpipe(d->udev, 0),
|
|
REQUEST_NEW_I2C_WRITE,
|
|
USB_TYPE_VENDOR | USB_DIR_OUT,
|
|
0, 0, st->buf, msg[i].len + 4,
|
|
USB_CTRL_GET_TIMEOUT);
|
|
mutex_unlock(&d->usb_mutex);
|
|
if (result < 0) {
|
|
deb_info("i2c write error (status = %d)\n", result);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
mutex_unlock(&d->i2c_mutex);
|
|
return i;
|
|
}
|
|
|
|
/*
|
|
* I2C master xfer function (pre-1.20 firmware)
|
|
*/
|
|
static int dib0700_i2c_xfer_legacy(struct i2c_adapter *adap,
|
|
struct i2c_msg *msg, int num)
|
|
{
|
|
struct dvb_usb_device *d = i2c_get_adapdata(adap);
|
|
struct dib0700_state *st = d->priv;
|
|
int i,len;
|
|
|
|
if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
|
|
return -EINTR;
|
|
if (mutex_lock_interruptible(&d->usb_mutex) < 0) {
|
|
err("could not acquire lock");
|
|
mutex_unlock(&d->i2c_mutex);
|
|
return -EINTR;
|
|
}
|
|
|
|
for (i = 0; i < num; i++) {
|
|
/* fill in the address */
|
|
st->buf[1] = msg[i].addr << 1;
|
|
/* fill the buffer */
|
|
memcpy(&st->buf[2], msg[i].buf, msg[i].len);
|
|
|
|
/* write/read request */
|
|
if (i+1 < num && (msg[i+1].flags & I2C_M_RD)) {
|
|
st->buf[0] = REQUEST_I2C_READ;
|
|
st->buf[1] |= 1;
|
|
|
|
/* special thing in the current firmware: when length is zero the read-failed */
|
|
len = dib0700_ctrl_rd(d, st->buf, msg[i].len + 2,
|
|
msg[i+1].buf, msg[i+1].len);
|
|
if (len <= 0) {
|
|
deb_info("I2C read failed on address 0x%02x\n",
|
|
msg[i].addr);
|
|
break;
|
|
}
|
|
|
|
msg[i+1].len = len;
|
|
|
|
i++;
|
|
} else {
|
|
st->buf[0] = REQUEST_I2C_WRITE;
|
|
if (dib0700_ctrl_wr(d, st->buf, msg[i].len + 2) < 0)
|
|
break;
|
|
}
|
|
}
|
|
mutex_unlock(&d->usb_mutex);
|
|
mutex_unlock(&d->i2c_mutex);
|
|
|
|
return i;
|
|
}
|
|
|
|
static int dib0700_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msg,
|
|
int num)
|
|
{
|
|
struct dvb_usb_device *d = i2c_get_adapdata(adap);
|
|
struct dib0700_state *st = d->priv;
|
|
|
|
if (st->fw_use_new_i2c_api == 1) {
|
|
/* User running at least fw 1.20 */
|
|
return dib0700_i2c_xfer_new(adap, msg, num);
|
|
} else {
|
|
/* Use legacy calls */
|
|
return dib0700_i2c_xfer_legacy(adap, msg, num);
|
|
}
|
|
}
|
|
|
|
static u32 dib0700_i2c_func(struct i2c_adapter *adapter)
|
|
{
|
|
return I2C_FUNC_I2C;
|
|
}
|
|
|
|
struct i2c_algorithm dib0700_i2c_algo = {
|
|
.master_xfer = dib0700_i2c_xfer,
|
|
.functionality = dib0700_i2c_func,
|
|
};
|
|
|
|
int dib0700_identify_state(struct usb_device *udev, struct dvb_usb_device_properties *props,
|
|
struct dvb_usb_device_description **desc, int *cold)
|
|
{
|
|
s16 ret;
|
|
u8 *b;
|
|
|
|
b = kmalloc(16, GFP_KERNEL);
|
|
if (!b)
|
|
return -ENOMEM;
|
|
|
|
|
|
ret = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
|
|
REQUEST_GET_VERSION, USB_TYPE_VENDOR | USB_DIR_IN, 0, 0, b, 16, USB_CTRL_GET_TIMEOUT);
|
|
|
|
deb_info("FW GET_VERSION length: %d\n",ret);
|
|
|
|
*cold = ret <= 0;
|
|
deb_info("cold: %d\n", *cold);
|
|
|
|
kfree(b);
|
|
return 0;
|
|
}
|
|
|
|
static int dib0700_set_clock(struct dvb_usb_device *d, u8 en_pll,
|
|
u8 pll_src, u8 pll_range, u8 clock_gpio3, u16 pll_prediv,
|
|
u16 pll_loopdiv, u16 free_div, u16 dsuScaler)
|
|
{
|
|
struct dib0700_state *st = d->priv;
|
|
int ret;
|
|
|
|
if (mutex_lock_interruptible(&d->usb_mutex) < 0) {
|
|
err("could not acquire lock");
|
|
return -EINTR;
|
|
}
|
|
|
|
st->buf[0] = REQUEST_SET_CLOCK;
|
|
st->buf[1] = (en_pll << 7) | (pll_src << 6) |
|
|
(pll_range << 5) | (clock_gpio3 << 4);
|
|
st->buf[2] = (pll_prediv >> 8) & 0xff; /* MSB */
|
|
st->buf[3] = pll_prediv & 0xff; /* LSB */
|
|
st->buf[4] = (pll_loopdiv >> 8) & 0xff; /* MSB */
|
|
st->buf[5] = pll_loopdiv & 0xff; /* LSB */
|
|
st->buf[6] = (free_div >> 8) & 0xff; /* MSB */
|
|
st->buf[7] = free_div & 0xff; /* LSB */
|
|
st->buf[8] = (dsuScaler >> 8) & 0xff; /* MSB */
|
|
st->buf[9] = dsuScaler & 0xff; /* LSB */
|
|
|
|
ret = dib0700_ctrl_wr(d, st->buf, 10);
|
|
mutex_unlock(&d->usb_mutex);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int dib0700_set_i2c_speed(struct dvb_usb_device *d, u16 scl_kHz)
|
|
{
|
|
struct dib0700_state *st = d->priv;
|
|
u16 divider;
|
|
int ret;
|
|
|
|
if (scl_kHz == 0)
|
|
return -EINVAL;
|
|
|
|
if (mutex_lock_interruptible(&d->usb_mutex) < 0) {
|
|
err("could not acquire lock");
|
|
return -EINTR;
|
|
}
|
|
|
|
st->buf[0] = REQUEST_SET_I2C_PARAM;
|
|
divider = (u16) (30000 / scl_kHz);
|
|
st->buf[1] = 0;
|
|
st->buf[2] = (u8) (divider >> 8);
|
|
st->buf[3] = (u8) (divider & 0xff);
|
|
divider = (u16) (72000 / scl_kHz);
|
|
st->buf[4] = (u8) (divider >> 8);
|
|
st->buf[5] = (u8) (divider & 0xff);
|
|
divider = (u16) (72000 / scl_kHz); /* clock: 72MHz */
|
|
st->buf[6] = (u8) (divider >> 8);
|
|
st->buf[7] = (u8) (divider & 0xff);
|
|
|
|
deb_info("setting I2C speed: %04x %04x %04x (%d kHz).",
|
|
(st->buf[2] << 8) | (st->buf[3]), (st->buf[4] << 8) |
|
|
st->buf[5], (st->buf[6] << 8) | st->buf[7], scl_kHz);
|
|
|
|
ret = dib0700_ctrl_wr(d, st->buf, 8);
|
|
mutex_unlock(&d->usb_mutex);
|
|
|
|
return ret;
|
|
}
|
|
|
|
|
|
int dib0700_ctrl_clock(struct dvb_usb_device *d, u32 clk_MHz, u8 clock_out_gp3)
|
|
{
|
|
switch (clk_MHz) {
|
|
case 72: dib0700_set_clock(d, 1, 0, 1, clock_out_gp3, 2, 24, 0, 0x4c); break;
|
|
default: return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int dib0700_jumpram(struct usb_device *udev, u32 address)
|
|
{
|
|
int ret = 0, actlen;
|
|
u8 *buf;
|
|
|
|
buf = kmalloc(8, GFP_KERNEL);
|
|
if (!buf)
|
|
return -ENOMEM;
|
|
buf[0] = REQUEST_JUMPRAM;
|
|
buf[1] = 0;
|
|
buf[2] = 0;
|
|
buf[3] = 0;
|
|
buf[4] = (address >> 24) & 0xff;
|
|
buf[5] = (address >> 16) & 0xff;
|
|
buf[6] = (address >> 8) & 0xff;
|
|
buf[7] = address & 0xff;
|
|
|
|
if ((ret = usb_bulk_msg(udev, usb_sndbulkpipe(udev, 0x01),buf,8,&actlen,1000)) < 0) {
|
|
deb_fw("jumpram to 0x%x failed\n",address);
|
|
goto out;
|
|
}
|
|
if (actlen != 8) {
|
|
deb_fw("jumpram to 0x%x failed\n",address);
|
|
ret = -EIO;
|
|
goto out;
|
|
}
|
|
out:
|
|
kfree(buf);
|
|
return ret;
|
|
}
|
|
|
|
int dib0700_download_firmware(struct usb_device *udev, const struct firmware *fw)
|
|
{
|
|
struct hexline hx;
|
|
int pos = 0, ret, act_len, i, adap_num;
|
|
u8 *buf;
|
|
u32 fw_version;
|
|
|
|
buf = kmalloc(260, GFP_KERNEL);
|
|
if (!buf)
|
|
return -ENOMEM;
|
|
|
|
while ((ret = dvb_usb_get_hexline(fw, &hx, &pos)) > 0) {
|
|
deb_fwdata("writing to address 0x%08x (buffer: 0x%02x %02x)\n",
|
|
hx.addr, hx.len, hx.chk);
|
|
|
|
buf[0] = hx.len;
|
|
buf[1] = (hx.addr >> 8) & 0xff;
|
|
buf[2] = hx.addr & 0xff;
|
|
buf[3] = hx.type;
|
|
memcpy(&buf[4],hx.data,hx.len);
|
|
buf[4+hx.len] = hx.chk;
|
|
|
|
ret = usb_bulk_msg(udev,
|
|
usb_sndbulkpipe(udev, 0x01),
|
|
buf,
|
|
hx.len + 5,
|
|
&act_len,
|
|
1000);
|
|
|
|
if (ret < 0) {
|
|
err("firmware download failed at %d with %d",pos,ret);
|
|
goto out;
|
|
}
|
|
}
|
|
|
|
if (ret == 0) {
|
|
/* start the firmware */
|
|
if ((ret = dib0700_jumpram(udev, 0x70000000)) == 0) {
|
|
info("firmware started successfully.");
|
|
msleep(500);
|
|
}
|
|
} else
|
|
ret = -EIO;
|
|
|
|
/* the number of ts packet has to be at least 1 */
|
|
if (nb_packet_buffer_size < 1)
|
|
nb_packet_buffer_size = 1;
|
|
|
|
/* get the fimware version */
|
|
usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
|
|
REQUEST_GET_VERSION,
|
|
USB_TYPE_VENDOR | USB_DIR_IN, 0, 0,
|
|
buf, 16, USB_CTRL_GET_TIMEOUT);
|
|
fw_version = (buf[8] << 24) | (buf[9] << 16) | (buf[10] << 8) | buf[11];
|
|
|
|
/* set the buffer size - DVB-USB is allocating URB buffers
|
|
* only after the firwmare download was successful */
|
|
for (i = 0; i < dib0700_device_count; i++) {
|
|
for (adap_num = 0; adap_num < dib0700_devices[i].num_adapters;
|
|
adap_num++) {
|
|
if (fw_version >= 0x10201) {
|
|
dib0700_devices[i].adapter[adap_num].fe[0].stream.u.bulk.buffersize = 188*nb_packet_buffer_size;
|
|
} else {
|
|
/* for fw version older than 1.20.1,
|
|
* the buffersize has to be n times 512 */
|
|
dib0700_devices[i].adapter[adap_num].fe[0].stream.u.bulk.buffersize = ((188*nb_packet_buffer_size+188/2)/512)*512;
|
|
if (dib0700_devices[i].adapter[adap_num].fe[0].stream.u.bulk.buffersize < 512)
|
|
dib0700_devices[i].adapter[adap_num].fe[0].stream.u.bulk.buffersize = 512;
|
|
}
|
|
}
|
|
}
|
|
out:
|
|
kfree(buf);
|
|
return ret;
|
|
}
|
|
|
|
int dib0700_streaming_ctrl(struct dvb_usb_adapter *adap, int onoff)
|
|
{
|
|
struct dib0700_state *st = adap->dev->priv;
|
|
int ret;
|
|
|
|
if ((onoff != 0) && (st->fw_version >= 0x10201)) {
|
|
/* for firmware later than 1.20.1,
|
|
* the USB xfer length can be set */
|
|
ret = dib0700_set_usb_xfer_len(adap->dev,
|
|
st->nb_packet_buffer_size);
|
|
if (ret < 0) {
|
|
deb_info("can not set the USB xfer len\n");
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
mutex_lock(&adap->dev->usb_mutex);
|
|
|
|
st->buf[0] = REQUEST_ENABLE_VIDEO;
|
|
/* this bit gives a kind of command,
|
|
* rather than enabling something or not */
|
|
st->buf[1] = (onoff << 4) | 0x00;
|
|
|
|
if (st->disable_streaming_master_mode == 1)
|
|
st->buf[2] = 0x00;
|
|
else
|
|
st->buf[2] = 0x01 << 4; /* Master mode */
|
|
|
|
st->buf[3] = 0x00;
|
|
|
|
deb_info("modifying (%d) streaming state for %d\n", onoff, adap->id);
|
|
|
|
st->channel_state &= ~0x3;
|
|
if ((adap->fe_adap[0].stream.props.endpoint != 2)
|
|
&& (adap->fe_adap[0].stream.props.endpoint != 3)) {
|
|
deb_info("the endpoint number (%i) is not correct, use the adapter id instead", adap->fe_adap[0].stream.props.endpoint);
|
|
if (onoff)
|
|
st->channel_state |= 1 << (adap->id);
|
|
else
|
|
st->channel_state |= 1 << ~(adap->id);
|
|
} else {
|
|
if (onoff)
|
|
st->channel_state |= 1 << (adap->fe_adap[0].stream.props.endpoint-2);
|
|
else
|
|
st->channel_state |= 1 << (3-adap->fe_adap[0].stream.props.endpoint);
|
|
}
|
|
|
|
st->buf[2] |= st->channel_state;
|
|
|
|
deb_info("data for streaming: %x %x\n", st->buf[1], st->buf[2]);
|
|
|
|
ret = dib0700_ctrl_wr(adap->dev, st->buf, 4);
|
|
mutex_unlock(&adap->dev->usb_mutex);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int dib0700_change_protocol(struct rc_dev *rc, u64 *rc_type)
|
|
{
|
|
struct dvb_usb_device *d = rc->priv;
|
|
struct dib0700_state *st = d->priv;
|
|
int new_proto, ret;
|
|
|
|
if (mutex_lock_interruptible(&d->usb_mutex) < 0) {
|
|
err("could not acquire lock");
|
|
return -EINTR;
|
|
}
|
|
|
|
st->buf[0] = REQUEST_SET_RC;
|
|
st->buf[1] = 0;
|
|
st->buf[2] = 0;
|
|
|
|
/* Set the IR mode */
|
|
if (*rc_type & RC_BIT_RC5) {
|
|
new_proto = 1;
|
|
*rc_type = RC_BIT_RC5;
|
|
} else if (*rc_type & RC_BIT_NEC) {
|
|
new_proto = 0;
|
|
*rc_type = RC_BIT_NEC;
|
|
} else if (*rc_type & RC_BIT_RC6_MCE) {
|
|
if (st->fw_version < 0x10200) {
|
|
ret = -EINVAL;
|
|
goto out;
|
|
}
|
|
new_proto = 2;
|
|
*rc_type = RC_BIT_RC6_MCE;
|
|
} else {
|
|
ret = -EINVAL;
|
|
goto out;
|
|
}
|
|
|
|
st->buf[1] = new_proto;
|
|
|
|
ret = dib0700_ctrl_wr(d, st->buf, 3);
|
|
if (ret < 0) {
|
|
err("ir protocol setup failed");
|
|
goto out;
|
|
}
|
|
|
|
d->props.rc.core.protocol = *rc_type;
|
|
|
|
out:
|
|
mutex_unlock(&d->usb_mutex);
|
|
return ret;
|
|
}
|
|
|
|
/* Number of keypresses to ignore before start repeating */
|
|
#define RC_REPEAT_DELAY_V1_20 10
|
|
|
|
/* This is the structure of the RC response packet starting in firmware 1.20 */
|
|
struct dib0700_rc_response {
|
|
u8 report_id;
|
|
u8 data_state;
|
|
union {
|
|
u16 system16;
|
|
struct {
|
|
u8 not_system;
|
|
u8 system;
|
|
};
|
|
};
|
|
u8 data;
|
|
u8 not_data;
|
|
};
|
|
#define RC_MSG_SIZE_V1_20 6
|
|
|
|
static void dib0700_rc_urb_completion(struct urb *purb)
|
|
{
|
|
struct dvb_usb_device *d = purb->context;
|
|
struct dib0700_rc_response *poll_reply;
|
|
u32 uninitialized_var(keycode);
|
|
u8 toggle;
|
|
|
|
deb_info("%s()\n", __func__);
|
|
if (d->rc_dev == NULL) {
|
|
/* This will occur if disable_rc_polling=1 */
|
|
kfree(purb->transfer_buffer);
|
|
usb_free_urb(purb);
|
|
return;
|
|
}
|
|
|
|
poll_reply = purb->transfer_buffer;
|
|
|
|
if (purb->status < 0) {
|
|
deb_info("discontinuing polling\n");
|
|
kfree(purb->transfer_buffer);
|
|
usb_free_urb(purb);
|
|
return;
|
|
}
|
|
|
|
if (purb->actual_length != RC_MSG_SIZE_V1_20) {
|
|
deb_info("malformed rc msg size=%d\n", purb->actual_length);
|
|
goto resubmit;
|
|
}
|
|
|
|
deb_data("IR ID = %02X state = %02X System = %02X %02X Cmd = %02X %02X (len %d)\n",
|
|
poll_reply->report_id, poll_reply->data_state,
|
|
poll_reply->system, poll_reply->not_system,
|
|
poll_reply->data, poll_reply->not_data,
|
|
purb->actual_length);
|
|
|
|
switch (d->props.rc.core.protocol) {
|
|
case RC_BIT_NEC:
|
|
toggle = 0;
|
|
|
|
/* NEC protocol sends repeat code as 0 0 0 FF */
|
|
if ((poll_reply->system == 0x00) && (poll_reply->data == 0x00)
|
|
&& (poll_reply->not_data == 0xff)) {
|
|
poll_reply->data_state = 2;
|
|
break;
|
|
}
|
|
|
|
if ((poll_reply->system ^ poll_reply->not_system) != 0xff) {
|
|
deb_data("NEC extended protocol\n");
|
|
/* NEC extended code - 24 bits */
|
|
keycode = be16_to_cpu(poll_reply->system16) << 8 | poll_reply->data;
|
|
} else {
|
|
deb_data("NEC normal protocol\n");
|
|
/* normal NEC code - 16 bits */
|
|
keycode = poll_reply->system << 8 | poll_reply->data;
|
|
}
|
|
|
|
break;
|
|
default:
|
|
deb_data("RC5 protocol\n");
|
|
/* RC5 Protocol */
|
|
toggle = poll_reply->report_id;
|
|
keycode = poll_reply->system << 8 | poll_reply->data;
|
|
|
|
break;
|
|
}
|
|
|
|
if ((poll_reply->data + poll_reply->not_data) != 0xff) {
|
|
/* Key failed integrity check */
|
|
err("key failed integrity check: %04x %02x %02x",
|
|
poll_reply->system,
|
|
poll_reply->data, poll_reply->not_data);
|
|
goto resubmit;
|
|
}
|
|
|
|
rc_keydown(d->rc_dev, keycode, toggle);
|
|
|
|
resubmit:
|
|
/* Clean the buffer before we requeue */
|
|
memset(purb->transfer_buffer, 0, RC_MSG_SIZE_V1_20);
|
|
|
|
/* Requeue URB */
|
|
usb_submit_urb(purb, GFP_ATOMIC);
|
|
}
|
|
|
|
int dib0700_rc_setup(struct dvb_usb_device *d)
|
|
{
|
|
struct dib0700_state *st = d->priv;
|
|
struct urb *purb;
|
|
int ret;
|
|
|
|
/* Poll-based. Don't initialize bulk mode */
|
|
if (st->fw_version < 0x10200)
|
|
return 0;
|
|
|
|
/* Starting in firmware 1.20, the RC info is provided on a bulk pipe */
|
|
purb = usb_alloc_urb(0, GFP_KERNEL);
|
|
if (purb == NULL) {
|
|
err("rc usb alloc urb failed");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
purb->transfer_buffer = kzalloc(RC_MSG_SIZE_V1_20, GFP_KERNEL);
|
|
if (purb->transfer_buffer == NULL) {
|
|
err("rc kzalloc failed");
|
|
usb_free_urb(purb);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
purb->status = -EINPROGRESS;
|
|
usb_fill_bulk_urb(purb, d->udev, usb_rcvbulkpipe(d->udev, 1),
|
|
purb->transfer_buffer, RC_MSG_SIZE_V1_20,
|
|
dib0700_rc_urb_completion, d);
|
|
|
|
ret = usb_submit_urb(purb, GFP_ATOMIC);
|
|
if (ret) {
|
|
err("rc submit urb failed");
|
|
kfree(purb->transfer_buffer);
|
|
usb_free_urb(purb);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int dib0700_probe(struct usb_interface *intf,
|
|
const struct usb_device_id *id)
|
|
{
|
|
int i;
|
|
struct dvb_usb_device *dev;
|
|
|
|
for (i = 0; i < dib0700_device_count; i++)
|
|
if (dvb_usb_device_init(intf, &dib0700_devices[i], THIS_MODULE,
|
|
&dev, adapter_nr) == 0) {
|
|
struct dib0700_state *st = dev->priv;
|
|
u32 hwversion, romversion, fw_version, fwtype;
|
|
|
|
dib0700_get_version(dev, &hwversion, &romversion,
|
|
&fw_version, &fwtype);
|
|
|
|
deb_info("Firmware version: %x, %d, 0x%x, %d\n",
|
|
hwversion, romversion, fw_version, fwtype);
|
|
|
|
st->fw_version = fw_version;
|
|
st->nb_packet_buffer_size = (u32)nb_packet_buffer_size;
|
|
|
|
/* Disable polling mode on newer firmwares */
|
|
if (st->fw_version >= 0x10200)
|
|
dev->props.rc.core.bulk_mode = true;
|
|
else
|
|
dev->props.rc.core.bulk_mode = false;
|
|
|
|
dib0700_rc_setup(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
return -ENODEV;
|
|
}
|
|
|
|
static struct usb_driver dib0700_driver = {
|
|
.name = "dvb_usb_dib0700",
|
|
.probe = dib0700_probe,
|
|
.disconnect = dvb_usb_device_exit,
|
|
.id_table = dib0700_usb_id_table,
|
|
};
|
|
|
|
module_usb_driver(dib0700_driver);
|
|
|
|
MODULE_FIRMWARE("dvb-usb-dib0700-1.20.fw");
|
|
MODULE_AUTHOR("Patrick Boettcher <pboettcher@dibcom.fr>");
|
|
MODULE_DESCRIPTION("Driver for devices based on DiBcom DiB0700 - USB bridge");
|
|
MODULE_VERSION("1.0");
|
|
MODULE_LICENSE("GPL");
|