Moikka! >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/ Yes, the CIMax2 SP2 code here is the same as Olli's. But Olli comes to make a standard i2c driver, so I will remove the ci code from dvbsky usb driver. As Olli finish the code ready, I will use his code for ci part. > >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
