Moikka! Biggest issue is that CIMax2 SP2 driver. Olli put all that stuff to own I2C driver recently. Could you took SP2 from patchwork and use it instead: https://patchwork.linuxtv.org/patch/25206/ https://patchwork.linuxtv.org/patch/25210/ It is not yet in mainline, but there should not be any big changes coming to that driver. regards Antti On 08/06/2014 07:36 AM, nibble.max wrote: > add dvb-usb-v2 driver for DVBSky dvb-s2 box > > Signed-off-by: Nibble Max <nibble.max@xxxxxxxxx> > --- > drivers/media/usb/dvb-usb-v2/Kconfig | 6 + > drivers/media/usb/dvb-usb-v2/Makefile | 3 + > drivers/media/usb/dvb-usb-v2/dvbsky.c | 872 ++++++++++++++++++++++++++++++++++ > 3 files changed, 881 insertions(+) > > diff --git a/drivers/media/usb/dvb-usb-v2/Kconfig b/drivers/media/usb/dvb-usb-v2/Kconfig > index 66645b0..8107c8d 100644 > --- a/drivers/media/usb/dvb-usb-v2/Kconfig > +++ b/drivers/media/usb/dvb-usb-v2/Kconfig > @@ -141,3 +141,9 @@ config DVB_USB_RTL28XXU > help > Say Y here to support the Realtek RTL28xxU DVB USB receiver. > > +config DVB_USB_DVBSKY > + tristate "DVBSky USB support" > + depends on DVB_USB_V2 > + select DVB_M88DS3103 if MEDIA_SUBDRV_AUTOSELECT > + help > + Say Y here to support the USB receivers from DVBSky. > diff --git a/drivers/media/usb/dvb-usb-v2/Makefile b/drivers/media/usb/dvb-usb-v2/Makefile > index bc38f03..f10d4df 100644 > --- a/drivers/media/usb/dvb-usb-v2/Makefile > +++ b/drivers/media/usb/dvb-usb-v2/Makefile > @@ -37,6 +37,9 @@ obj-$(CONFIG_DVB_USB_MXL111SF) += mxl111sf-tuner.o > dvb-usb-rtl28xxu-objs := rtl28xxu.o > obj-$(CONFIG_DVB_USB_RTL28XXU) += dvb-usb-rtl28xxu.o > > +dvb-usb-dvbsky-objs := dvbsky.o > +obj-$(CONFIG_DVB_USB_DVBSKY) += dvb-usb-dvbsky.o > + > ccflags-y += -I$(srctree)/drivers/media/dvb-core > ccflags-y += -I$(srctree)/drivers/media/dvb-frontends > ccflags-y += -I$(srctree)/drivers/media/tuners > diff --git a/drivers/media/usb/dvb-usb-v2/dvbsky.c b/drivers/media/usb/dvb-usb-v2/dvbsky.c > new file mode 100644 > index 0000000..c86927f > --- /dev/null > +++ b/drivers/media/usb/dvb-usb-v2/dvbsky.c > @@ -0,0 +1,872 @@ > +/* > + * Driver for DVBSky USB2.0 receiver > + * > + * Copyright (C) 2013 Max nibble <nibble.max@xxxxxxxxx> > + * > + * CIMax code is copied and modified from: > + * CIMax2(R) SP2 driver in conjunction with NetUp Dual DVB-S2 CI card > + * Copyright (C) 2009 NetUP Inc. > + * Copyright (C) 2009 Igor M. Liplianin <liplianin@xxxxxxxx> > + * Copyright (C) 2009 Abylay Ospan <aospan@xxxxxxxx> > + * > + * 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 "dvb_ca_en50221.h" > +#include "dvb_usb.h" > +#include "m88ds3103.h" > +#include "m88ts2022.h" > + > +static int dvbsky_debug; > +module_param(dvbsky_debug, int, 0644); > +MODULE_PARM_DESC(dvbsky_debug, "Activates dvbsky usb debugging (default:0)"); > + > +#define DVBSKY_MSG_DELAY 0/*2000*/ > +#define DVBSKY_CI_CTL 0x04 > +#define DVBSKY_CI_RD 1 > + > +#define dprintk(args...) \ > + do { \ > + if (dvbsky_debug) \ > + printk(KERN_INFO "dvbsky_usb: " args); \ > + } while (0) > + > +DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr); > + > +struct dvbsky_state { > + struct mutex stream_mutex; > + u8 has_ci; > + u8 ci_attached; > + struct dvb_ca_en50221 ci; > + unsigned long next_status_checked_time; > + u8 ci_i2c_addr; > + u8 current_ci_flag; > + int ci_status; > + struct i2c_client *i2c_client_tuner; > +}; > + > +static int dvbsky_stream_ctrl(struct dvb_usb_device *d, u8 onoff) > +{ > + struct dvbsky_state *state = d_to_priv(d); > + int ret; > + u8 obuf_pre[3] = { 0x37, 0, 0 }; > + u8 obuf_post[3] = { 0x36, 3, 0 }; > + dprintk("%s() -off \n", __func__); > + mutex_lock(&state->stream_mutex); > + ret = dvb_usbv2_generic_write(d, obuf_pre, 3); > + if (!ret && onoff) { > + msleep(10); > + ret = dvb_usbv2_generic_write(d, obuf_post, 3); > + dprintk("%s() -on \n", __func__); > + } > + mutex_unlock(&state->stream_mutex); > + return ret; > +} > + > +/* CI opertaions */ > +static int dvbsky_ci_read_i2c(struct i2c_adapter *i2c_adap, u8 addr, u8 reg, > + u8 *buf, int len) > +{ > + int ret; > + struct i2c_msg msg[] = { > + { > + .addr = addr, > + .flags = 0, > + .buf = ®, > + .len = 1 > + }, { > + .addr = addr, > + .flags = I2C_M_RD, > + .buf = buf, > + .len = len > + } > + }; > + > + ret = i2c_transfer(i2c_adap, msg, 2); > + if (ret != 2) { > + dprintk("%s: error, Reg = 0x%02x, Status = %d\n", > + __func__, reg, ret); > + return -1; > + } > + return 0; > +} > + > +static int dvbsky_ci_write_i2c(struct i2c_adapter *i2c_adap, u8 addr, u8 reg, > + u8 *buf, int len) > +{ > + int ret; > + u8 buffer[64]; > + > + struct i2c_msg msg = { > + .addr = addr, > + .flags = 0, > + .buf = &buffer[0], > + .len = len + 1 > + }; > + > + if (len + 1 > sizeof(buffer)) { > + dprintk("%s: len overflow.\n", __func__); > + return -1; > + } > + > + buffer[0] = reg; > + memcpy(&buffer[1], buf, len); > + > + ret = i2c_transfer(i2c_adap, &msg, 1); > + > + if (ret != 1) { > + dprintk("%s: error, Reg=[0x%02x], Status=%d\n", > + __func__, reg, ret); > + return -1; > + } > + return 0; > +} > + > +static int dvbsky_ci_op_cam(struct dvb_ca_en50221 *ci, int slot, > + u8 flag, u8 read, int addr, u8 data) > +{ > + struct dvb_usb_device *d = ci->data; > + struct dvbsky_state *state = d_to_priv(d); > + u8 store; > + int ret; > + u8 command[4], respond[2], command_size, respond_size; > + > + /*dprintk("%s()\n", __func__);*/ > + if (0 != slot) > + return -EINVAL; > + > + if (state->current_ci_flag != flag) { > + ret = dvbsky_ci_read_i2c(&d->i2c_adap, state->ci_i2c_addr, > + 0, &store, 1); > + if (ret != 0) > + return ret; > + > + store &= ~0x0c; > + store |= flag; > + > + ret = dvbsky_ci_write_i2c(&d->i2c_adap, state->ci_i2c_addr, > + 0, &store, 1); > + if (ret != 0) > + return ret; > + } > + state->current_ci_flag = flag; > + > + command[1] = (u8)((addr >> 8) & 0xff); /*high part of address*/ > + command[2] = (u8)(addr & 0xff); /*low part of address*/ > + if (read) { > + command[0] = 0x71; > + command_size = 3; > + respond_size = 2; > + } else { > + command[0] = 0x70; > + command[3] = data; > + command_size = 4; > + respond_size = 1; > + } > + ret = dvb_usbv2_generic_rw(d, command, command_size, > + respond, respond_size); > + if (ret) > + dev_err(&d->udev->dev, "%s: %s() " \ > + "failed=%d\n", KBUILD_MODNAME, __func__, ret); > + > + return (read) ? respond[1] : 0; > +} > + > +static int dvbsky_ci_read_attribute_mem(struct dvb_ca_en50221 *ci, > + int slot, int addr) > +{ > + return dvbsky_ci_op_cam(ci, slot, 0, DVBSKY_CI_RD, addr, 0); > +} > + > +static int dvbsky_ci_write_attribute_mem(struct dvb_ca_en50221 *ci, > + int slot, int addr, u8 data) > +{ > + return dvbsky_ci_op_cam(ci, slot, 0, 0, addr, data); > +} > + > +static int dvbsky_ci_read_cam_ctl(struct dvb_ca_en50221 *ci, int slot, u8 addr) > +{ > + return dvbsky_ci_op_cam(ci, slot, DVBSKY_CI_CTL, DVBSKY_CI_RD, addr, 0); > +} > + > +static int dvbsky_ci_write_cam_ctl(struct dvb_ca_en50221 *ci, int slot, > + u8 addr, u8 data) > +{ > + return dvbsky_ci_op_cam(ci, slot, DVBSKY_CI_CTL, 0, addr, data); > +} > + > +static int dvbsky_ci_slot_reset(struct dvb_ca_en50221 *ci, int slot) > +{ > + struct dvb_usb_device *d = ci->data; > + struct dvbsky_state *state = d_to_priv(d); > + u8 buf = 0x80; > + int ret; > + dprintk("%s() slot=%d\n", __func__, slot); > + > + if (0 != slot) > + return -EINVAL; > + > + udelay(500); > + ret = dvbsky_ci_write_i2c(&d->i2c_adap, state->ci_i2c_addr, > + 0, &buf, 1); > + > + if (ret != 0) > + return ret; > + > + udelay(500); > + > + buf = 0x00; > + ret = dvbsky_ci_write_i2c(&d->i2c_adap, state->ci_i2c_addr, > + 0, &buf, 1); > + msleep(1000); > + dprintk("%s() slot=%d complete\n", __func__, slot); > + return 0; > + > +} > + > +static int dvbsky_ci_slot_shutdown(struct dvb_ca_en50221 *ci, int slot) > +{ > + /* not implemented */ > + dprintk("%s()\n", __func__); > + return 0; > +} > + > +static int dvbsky_ci_slot_ts_enable(struct dvb_ca_en50221 *ci, int slot) > +{ > + struct dvb_usb_device *d = ci->data; > + struct dvbsky_state *state = d_to_priv(d); > + u8 buf; > + int ret; > + > + dprintk("%s()\n", __func__); > + if (0 != slot) > + return -EINVAL; > + > + dvbsky_ci_read_i2c(&d->i2c_adap, state->ci_i2c_addr, > + 0, &buf, 1); > + buf |= 0x60; > + > + ret = dvbsky_ci_write_i2c(&d->i2c_adap, state->ci_i2c_addr, > + 0, &buf, 1); > + return ret; > +} > + > +static int dvbsky_ci_poll_slot_status(struct dvb_ca_en50221 *ci, int slot, > + int open) > +{ > + struct dvb_usb_device *d = ci->data; > + struct dvbsky_state *state = d_to_priv(d); > + int ret = 0; > + u8 buf = 0; > + > + /* CAM module INSERT/REMOVE processing. slow operation because of i2c > + * transfers */ > + if (time_after(jiffies, state->next_status_checked_time)) { > + ret = dvbsky_ci_read_i2c(&d->i2c_adap, state->ci_i2c_addr, > + 0, &buf, 1); > + > + state->next_status_checked_time = jiffies > + + msecs_to_jiffies(1000); > + > + if (ret != 0) > + return 0; > + > + if (buf & 1) { > + state->ci_status = DVB_CA_EN50221_POLL_CAM_PRESENT | > + DVB_CA_EN50221_POLL_CAM_READY; > + } else > + state->ci_status = 0; > + } > + return state->ci_status; > +} > + > +static int dvbsky_ci_init(struct dvb_usb_device *d) > +{ > + struct dvbsky_state *state = d_to_priv(d); > + int ret; > + u8 cimax_init[34] = { > + 0x00, /* module A control*/ > + 0x00, /* auto select mask high A */ > + 0x00, /* auto select mask low A */ > + 0x00, /* auto select pattern high A */ > + 0x00, /* auto select pattern low A */ > + 0x44, /* memory access time A */ > + 0x00, /* invert input A */ > + 0x00, /* RFU */ > + 0x00, /* RFU */ > + 0x00, /* module B control*/ > + 0x00, /* auto select mask high B */ > + 0x00, /* auto select mask low B */ > + 0x00, /* auto select pattern high B */ > + 0x00, /* auto select pattern low B */ > + 0x44, /* memory access time B */ > + 0x00, /* invert input B */ > + 0x00, /* RFU */ > + 0x00, /* RFU */ > + 0x00, /* auto select mask high Ext */ > + 0x00, /* auto select mask low Ext */ > + 0x00, /* auto select pattern high Ext */ > + 0x00, /* auto select pattern low Ext */ > + 0x00, /* RFU */ > + 0x02, /* destination - module A */ > + 0x01, /* power on (use it like store place) */ > + 0x00, /* RFU */ > + 0x00, /* int status read only */ > + 0x00, /* Max: Disable the interrupt in USB solution.*/ > + 0x05, /* EXTINT=active-high, INT=push-pull */ > + 0x00, /* USCG1 */ > + 0x04, /* ack active low */ > + 0x00, /* LOCK = 0 */ > + 0x22, /* serial mode, rising in, rising out, MSB first*/ > + 0x00 /* synchronization */ > + }; > + dprintk("%s()\n", __func__); > + state->current_ci_flag = 0xff; > + state->ci_status = 0; > + state->next_status_checked_time = jiffies + msecs_to_jiffies(1000); > + state->ci_i2c_addr = 0x40; > + > + state->ci.owner = THIS_MODULE; > + state->ci.read_attribute_mem = dvbsky_ci_read_attribute_mem; > + state->ci.write_attribute_mem = dvbsky_ci_write_attribute_mem; > + state->ci.read_cam_control = dvbsky_ci_read_cam_ctl; > + state->ci.write_cam_control = dvbsky_ci_write_cam_ctl; > + state->ci.slot_reset = dvbsky_ci_slot_reset; > + state->ci.slot_shutdown = dvbsky_ci_slot_shutdown; > + state->ci.slot_ts_enable = dvbsky_ci_slot_ts_enable; > + state->ci.poll_slot_status = dvbsky_ci_poll_slot_status; > + state->ci.data = d; > + > + ret = dvbsky_ci_write_i2c(&d->i2c_adap, state->ci_i2c_addr, > + 0, &cimax_init[0], 34); > + /* lock registers */ > + ret |= dvbsky_ci_write_i2c(&d->i2c_adap, state->ci_i2c_addr, > + 0x1f, &cimax_init[0x18], 1); > + /* power on slots */ > + ret |= dvbsky_ci_write_i2c(&d->i2c_adap, state->ci_i2c_addr, > + 0x18, &cimax_init[0x18], 1); > + if (0 != ret) > + return ret; > + > + ret = dvb_ca_en50221_init(&d->adapter[0].dvb_adap, &state->ci, 0, 1); > + if (ret) > + return ret; > + state->ci_attached = 1; > + dprintk("%s() complete.\n", __func__); > + return 0; > +} > + > +static void dvbsky_ci_release(struct dvb_usb_device *d) > +{ > + struct dvbsky_state *state = d_to_priv(d); > + > + /* detach CI */ > + if (state->ci_attached) > + dvb_ca_en50221_release(&state->ci); > + > + return; > +} > + > +static int dvbsky_streaming_ctrl(struct dvb_frontend *fe, int onoff) > +{ > + struct dvb_usb_device *d = fe_to_d(fe); > + /*dprintk("%s() %d\n", __func__, onoff);*/ > + return dvbsky_stream_ctrl(d, (onoff == 0) ? 0 : 1); > +} > + > +/* GPIO */ > +static int dvbsky_gpio_ctrl(struct dvb_usb_device *d, u8 gport, u8 value) > +{ > + int ret; > + u8 obuf[64], ibuf[64]; > + obuf[0] = 0x0e; > + obuf[1] = gport; > + obuf[2] = value; > + ret = dvb_usbv2_generic_rw(d, obuf, 3, ibuf, 1); > + if (ret) > + dev_err(&d->udev->dev, "%s: %s() " \ > + "failed=%d\n", KBUILD_MODNAME, __func__, ret); > + return ret; > +} > + > +/* I2C */ > +static int dvbsky_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msg[], > + int num) > +{ > + struct dvb_usb_device *d = i2c_get_adapdata(adap); > + int ret = 0; > + u8 ibuf[64], obuf[64]; > + > + if (mutex_lock_interruptible(&d->i2c_mutex) < 0) > + return -EAGAIN; > + > + if (num > 2) { > + printk(KERN_ERR > + "dvbsky_usb: too many i2c messages[%d] than 2.", num); > + ret = -EOPNOTSUPP; > + goto i2c_error; > + } > + > + if (num == 1) { > + if (msg[0].len > 60) { > + printk(KERN_ERR > + "dvbsky_usb: too many i2c bytes[%d] than 60.", > + msg[0].len); > + ret = -EOPNOTSUPP; > + goto i2c_error; > + } > + if (msg[0].flags & I2C_M_RD) { > + /* single read */ > + obuf[0] = 0x09; > + obuf[1] = 0; > + obuf[2] = msg[0].len; > + obuf[3] = msg[0].addr; > + ret = dvb_usbv2_generic_rw(d, obuf, 4, > + ibuf, msg[0].len + 1); > + if (ret) > + dev_err(&d->udev->dev, "%s: %s() " \ > + "failed=%d\n", > + KBUILD_MODNAME, __func__, ret); > + /*dprintk("%s(): read status = %d\n", > + __func__, ibuf[0]);*/ > + if (!ret) > + memcpy(msg[0].buf, &ibuf[1], msg[0].len); > + } else { > + /* write */ > + obuf[0] = 0x08; > + obuf[1] = msg[0].addr; > + obuf[2] = msg[0].len; > + memcpy(&obuf[3], msg[0].buf, msg[0].len); > + ret = dvb_usbv2_generic_rw(d, obuf, > + msg[0].len + 3, ibuf, 1); > + if (ret) > + dev_err(&d->udev->dev, "%s: %s() " \ > + "failed=%d\n", > + KBUILD_MODNAME, __func__, ret); > + /*dprintk("%s(): write status = %d\n", > + __func__, ibuf[0]);*/ > + } > + } else { > + if ((msg[0].len > 60) || (msg[1].len > 60)) { > + printk(KERN_ERR > + "dvbsky_usb: too many i2c bytes[w-%d][r-%d] than 60.", > + msg[0].len, msg[1].len); > + ret = -EOPNOTSUPP; > + goto i2c_error; > + } > + /* write then read */ > + obuf[0] = 0x09; > + obuf[1] = msg[0].len; > + obuf[2] = msg[1].len; > + obuf[3] = msg[0].addr; > + memcpy(&obuf[4], msg[0].buf, msg[0].len); > + ret = dvb_usbv2_generic_rw(d, obuf, > + msg[0].len + 4, ibuf, msg[1].len + 1); > + if (ret) > + dev_err(&d->udev->dev, "%s: %s() " \ > + "failed=%d\n", KBUILD_MODNAME, __func__, ret); > + /*dprintk("%s(): write then read status = %d\n", > + __func__, ibuf[0]);*/ > + if (!ret) > + memcpy(msg[1].buf, &ibuf[1], msg[1].len); > + } > +i2c_error: > + mutex_unlock(&d->i2c_mutex); > + return (ret) ? ret : num; > +} > + > +static u32 dvbsky_i2c_func(struct i2c_adapter *adapter) > +{ > + return I2C_FUNC_I2C; > +} > + > +static struct i2c_algorithm dvbsky_i2c_algo = { > + .master_xfer = dvbsky_i2c_xfer, > + .functionality = dvbsky_i2c_func, > +}; > + > +#if IS_ENABLED(CONFIG_RC_CORE) > +static int dvbsky_rc_query(struct dvb_usb_device *d) > +{ > + > + u32 code = 0xffff, scancode; > + u8 rc5_command, rc5_system; > + u8 obuf[2], ibuf[2], toggle; > + int ret; > + obuf[0] = 0x10; > + ret = dvb_usbv2_generic_rw(d, obuf, 1, ibuf, 2); > + if (ret) > + dev_err(&d->udev->dev, "%s: %s() " \ > + "failed=%d\n", KBUILD_MODNAME, __func__, ret); > + if (ret == 0) > + code = (ibuf[0] << 8) | ibuf[1]; > + if (code != 0xffff) { > + dprintk("rc code: %x \n", code); > + rc5_command = code & 0x3F; > + rc5_system = (code & 0x7C0) >> 6; > + toggle = (code & 0x800) ? 1 : 0; > + scancode = rc5_system << 8 | rc5_command; > + rc_keydown(d->rc_dev, RC_TYPE_RC5, scancode, toggle); > + } > + return 0; > +} > + > +static int dvbsky_get_rc_config(struct dvb_usb_device *d, struct dvb_usb_rc *rc) > +{ > + rc->allowed_protos = RC_BIT_RC5; > + rc->query = dvbsky_rc_query; > + rc->interval = 300; > + return 0; > +} > +#else > + #define dvbsky_get_rc_config NULL > +#endif > + > +static int dvbsky_sync_ctrl(struct dvb_frontend *fe) > +{ > + struct dvb_usb_device *d = fe_to_d(fe); > + return dvbsky_stream_ctrl(d, 1); > +} > + > +static int dvbsky_usb_set_voltage(struct dvb_frontend *fe, > + fe_sec_voltage_t voltage) > +{ > + struct dvb_usb_device *d = fe_to_d(fe); > + u8 value; > + > + if (voltage == SEC_VOLTAGE_OFF) > + value = 0; > + else > + value = 1; > + return dvbsky_gpio_ctrl(d, 0x80, value); > +} > + > +static int dvbsky_usb_ci_set_voltage(struct dvb_frontend *fe, > + fe_sec_voltage_t voltage) > +{ > + struct dvb_usb_device *d = fe_to_d(fe); > + u8 value; > + > + if (voltage == SEC_VOLTAGE_OFF) > + value = 0; > + else > + value = 1; > + return dvbsky_gpio_ctrl(d, 0x00, value); > +} > + > +static int dvbsky_read_mac_addr(struct dvb_usb_adapter *adap, u8 mac[6]) > +{ > + struct dvb_usb_device *d = adap_to_d(adap); > + u8 obuf[] = { 0x1e, 0x00 }; > + u8 ibuf[6] = { 0 }; > + struct i2c_msg msg[] = { > + { > + .addr = 0x51, > + .flags = 0, > + .buf = obuf, > + .len = 2, > + }, { > + .addr = 0x51, > + .flags = I2C_M_RD, > + .buf = ibuf, > + .len = 6, > + } > + }; > + > + if (i2c_transfer(&d->i2c_adap, msg, 2) == 2) > + memcpy(mac, ibuf, 6); > + > + printk(KERN_INFO "dvbsky_usb MAC address=%pM\n", mac); > + > + return 0; > +} > + > +static const struct m88ds3103_config dvbsky_s960_m88ds3103_config = { > + .i2c_addr = 0x68, > + .clock = 27000000, > + .i2c_wr_max = 33, > + .clock_out = 0, > + .ts_mode = M88DS3103_TS_CI, > + .ts_clk = 16000, > + .ts_clk_pol = 0, > + .agc = 0x99, > + .pin_ctrl = 0x83, > + .set_voltage = dvbsky_usb_set_voltage, > + .start_ctrl = dvbsky_sync_ctrl, > +}; > + > +static int dvbsky_s960_attach(struct dvb_usb_adapter *adap) > +{ > + struct dvbsky_state *state = adap_to_priv(adap); > + struct dvb_usb_device *d = adap_to_d(adap); > + int ret = 0; > + /* demod I2C adapter */ > + struct i2c_adapter *i2c_adapter; > + struct i2c_client *client; > + struct i2c_board_info info; > + struct m88ts2022_config m88ts2022_config = { > + .clock = 27000000, > + }; > + memset(&info, 0, sizeof(struct i2c_board_info)); > + > + /* attach demod */ > + adap->fe[0] = dvb_attach(m88ds3103_attach, > + &dvbsky_s960_m88ds3103_config, > + &d->i2c_adap, > + &i2c_adapter); > + if (!adap->fe[0]) { > + printk(KERN_ERR "dvbsky_s960_attach fail."); > + ret = -ENODEV; > + goto fail_attach; > + } > + > + /* attach tuner */ > + m88ts2022_config.fe = adap->fe[0]; > + strlcpy(info.type, "m88ts2022", I2C_NAME_SIZE); > + info.addr = 0x60; > + info.platform_data = &m88ts2022_config; > + request_module("m88ts2022"); > + client = i2c_new_device(i2c_adapter, &info); > + if (client == NULL || client->dev.driver == NULL) { > + dvb_frontend_detach(adap->fe[0]); > + ret = -ENODEV; > + goto fail_attach; > + } > + > + if (!try_module_get(client->dev.driver->owner)) { > + i2c_unregister_device(client); > + dvb_frontend_detach(adap->fe[0]); > + ret = -ENODEV; > + goto fail_attach; > + } > + > + /* delegate signal strength measurement to tuner */ > + adap->fe[0]->ops.read_signal_strength = > + adap->fe[0]->ops.tuner_ops.get_rf_strength; > + > + state->i2c_client_tuner = client; > + > +fail_attach: > + state->has_ci = 0; > + return ret; > +} > + > +static const struct m88ds3103_config dvbsky_s960_ci_m88ds3103_config = { > + .i2c_addr = 0x68, > + .clock = 27000000, > + .i2c_wr_max = 33, > + .clock_out = 0, > + .ts_mode = M88DS3103_TS_CI, > + .ts_clk = 8000, > + .ts_clk_pol = 1, > + .agc = 0x99, > + .pin_ctrl = 0x82, > + .set_voltage = dvbsky_usb_ci_set_voltage, > + .start_ctrl = dvbsky_sync_ctrl, > +}; > + > +static int dvbsky_s960c_attach(struct dvb_usb_adapter *adap) > +{ > + struct dvbsky_state *state = adap_to_priv(adap); > + struct dvb_usb_device *d = adap_to_d(adap); > + int ret = 0; > + /* demod I2C adapter */ > + struct i2c_adapter *i2c_adapter; > + struct i2c_client *client; > + struct i2c_board_info info; > + struct m88ts2022_config m88ts2022_config = { > + .clock = 27000000, > + }; > + memset(&info, 0, sizeof(struct i2c_board_info)); > + > + /* attach demod */ > + adap->fe[0] = dvb_attach(m88ds3103_attach, > + &dvbsky_s960_ci_m88ds3103_config, > + &d->i2c_adap, > + &i2c_adapter); > + if (!adap->fe[0]) { > + printk(KERN_ERR "dvbsky_s960c_attach fail."); > + ret = -ENODEV; > + goto fail_attach; > + } > + > + /* attach tuner */ > + m88ts2022_config.fe = adap->fe[0]; > + strlcpy(info.type, "m88ts2022", I2C_NAME_SIZE); > + info.addr = 0x60; > + info.platform_data = &m88ts2022_config; > + request_module("m88ts2022"); > + client = i2c_new_device(i2c_adapter, &info); > + if (client == NULL || client->dev.driver == NULL) { > + dvb_frontend_detach(adap->fe[0]); > + ret = -ENODEV; > + goto fail_attach; > + } > + > + if (!try_module_get(client->dev.driver->owner)) { > + i2c_unregister_device(client); > + dvb_frontend_detach(adap->fe[0]); > + ret = -ENODEV; > + goto fail_attach; > + } > + > + /* delegate signal strength measurement to tuner */ > + adap->fe[0]->ops.read_signal_strength = > + adap->fe[0]->ops.tuner_ops.get_rf_strength; > + > + state->i2c_client_tuner = client; > + > +fail_attach: > + state->has_ci = 1; > + return ret; > +} > + > +static int dvbsky_identify_state(struct dvb_usb_device *d, const char **name) > +{ > + /* > + printk(KERN_INFO "%s, build on %s %s(),delay=%d\n", > + __func__, __DATE__,__TIME__,d->props->generic_bulk_ctrl_delay); > + */ > + dvbsky_gpio_ctrl(d, 0x04, 1); > + msleep(10); > + dvbsky_gpio_ctrl(d, 0x83, 0); > + dvbsky_gpio_ctrl(d, 0xc0, 1); > + msleep(100); > + dvbsky_gpio_ctrl(d, 0x83, 1); > + dvbsky_gpio_ctrl(d, 0xc0, 0); > + msleep(50); > + > + return WARM; > +} > + > +static int dvbsky_init(struct dvb_usb_device *d) > +{ > + struct dvbsky_state *state = d_to_priv(d); > + int ret; > + > + /* use default interface */ > + /* > + ret = usb_set_interface(d->udev, 0, 0); > + if (ret) > + return ret; > + */ > + mutex_init(&state->stream_mutex); > + > + /* attach CI */ > + if (state->has_ci) { > + state->ci_attached = 0; > + ret = dvbsky_ci_init(d); > + if (ret) > + return ret; > + } > + return 0; > +} > + > +static void dvbsky_exit(struct dvb_usb_device *d) > +{ > + struct dvbsky_state *state = d_to_priv(d); > + struct i2c_client *client; > + > + client = state->i2c_client_tuner; > + /* remove I2C tuner */ > + if (client) { > + module_put(client->dev.driver->owner); > + i2c_unregister_device(client); > + } > + > + return dvbsky_ci_release(d); > +} > + > +/* DVB USB Driver stuff */ > +static struct dvb_usb_device_properties dvbsky_s960c_props = { > + .driver_name = KBUILD_MODNAME, > + .owner = THIS_MODULE, > + .adapter_nr = adapter_nr, > + .size_of_priv = sizeof(struct dvbsky_state), > + > + .generic_bulk_ctrl_endpoint = 0x01, > + .generic_bulk_ctrl_endpoint_response = 0x81, > + .generic_bulk_ctrl_delay = DVBSKY_MSG_DELAY, > + > + .i2c_algo = &dvbsky_i2c_algo, > + .frontend_attach = dvbsky_s960c_attach, > + .init = dvbsky_init, > + .get_rc_config = dvbsky_get_rc_config, > + .streaming_ctrl = dvbsky_streaming_ctrl, > + .identify_state = dvbsky_identify_state, > + .exit = dvbsky_exit, > + .read_mac_address = dvbsky_read_mac_addr, > + > + .num_adapters = 1, > + .adapter = { > + { > + .stream = DVB_USB_STREAM_BULK(0x82, 8, 4096), > + } > + } > +}; > + > +static struct dvb_usb_device_properties dvbsky_s960_props = { > + .driver_name = KBUILD_MODNAME, > + .owner = THIS_MODULE, > + .adapter_nr = adapter_nr, > + .size_of_priv = sizeof(struct dvbsky_state), > + > + .generic_bulk_ctrl_endpoint = 0x01, > + .generic_bulk_ctrl_endpoint_response = 0x81, > + .generic_bulk_ctrl_delay = DVBSKY_MSG_DELAY, > + > + .i2c_algo = &dvbsky_i2c_algo, > + .frontend_attach = dvbsky_s960_attach, > + .init = dvbsky_init, > + .get_rc_config = dvbsky_get_rc_config, > + .streaming_ctrl = dvbsky_streaming_ctrl, > + .identify_state = dvbsky_identify_state, > + .exit = dvbsky_exit, > + .read_mac_address = dvbsky_read_mac_addr, > + > + .num_adapters = 1, > + .adapter = { > + { > + .stream = DVB_USB_STREAM_BULK(0x82, 8, 4096), > + } > + } > +}; > + > +static const struct usb_device_id dvbsky_id_table[] = { > + { DVB_USB_DEVICE(0x0572, 0x960c, > + &dvbsky_s960c_props, "DVBSky S960CI", RC_MAP_DVBSKY) }, > + { DVB_USB_DEVICE(0x0572, 0x6831, > + &dvbsky_s960_props, "DVBSky S960/S860", RC_MAP_DVBSKY) }, > + { } > +}; > +MODULE_DEVICE_TABLE(usb, dvbsky_id_table); > + > +static struct usb_driver dvbsky_usb_driver = { > + .name = KBUILD_MODNAME, > + .id_table = dvbsky_id_table, > + .probe = dvb_usbv2_probe, > + .disconnect = dvb_usbv2_disconnect, > + .suspend = dvb_usbv2_suspend, > + .resume = dvb_usbv2_resume, > + .reset_resume = dvb_usbv2_reset_resume, > + .no_dynamic_id = 1, > + .soft_unbind = 1, > +}; > + > +module_usb_driver(dvbsky_usb_driver); > + > +MODULE_AUTHOR("Max nibble <nibble.max@xxxxxxxxx>"); > +MODULE_DESCRIPTION("Driver for DVBSky USB"); > +MODULE_LICENSE("GPL"); > > > -- > To unsubscribe from this list: send the line "unsubscribe linux-media" in > the body of a message to majordomo@xxxxxxxxxxxxxxx > More majordomo info at http://vger.kernel.org/majordomo-info.html > -- http://palosaari.fi/ -- To unsubscribe from this list: send the line "unsubscribe linux-media" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html
