[media] ttusb2: TT CT-3650 CI support
Signed-off-by: Jose Alberto Reguero <jareguero@telefonica.net> Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
Jose Alberto Reguero
Mauro Carvalho Chehab
Родитель
1cd7acc4ef
Коммит
8c0bc03c80
|
|
@ -33,16 +33,40 @@
|
|||
#include "tda10048.h"
|
||||
#include "tda827x.h"
|
||||
#include "lnbp21.h"
|
||||
/* CA */
|
||||
#include "dvb_ca_en50221.h"
|
||||
|
||||
/* debug */
|
||||
static int dvb_usb_ttusb2_debug;
|
||||
#define deb_info(args...) dprintk(dvb_usb_ttusb2_debug,0x01,args)
|
||||
module_param_named(debug,dvb_usb_ttusb2_debug, int, 0644);
|
||||
MODULE_PARM_DESC(debug, "set debugging level (1=info (or-able))." DVB_USB_DEBUG_STATUS);
|
||||
static int dvb_usb_ttusb2_debug_ci;
|
||||
module_param_named(debug_ci,dvb_usb_ttusb2_debug_ci, int, 0644);
|
||||
MODULE_PARM_DESC(debug_ci, "set debugging ci." DVB_USB_DEBUG_STATUS);
|
||||
|
||||
DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
|
||||
|
||||
#define ci_dbg(format, arg...) \
|
||||
do { \
|
||||
if (dvb_usb_ttusb2_debug_ci) \
|
||||
printk(KERN_DEBUG DVB_USB_LOG_PREFIX \
|
||||
": %s " format "\n" , __func__, ## arg); \
|
||||
} while (0)
|
||||
|
||||
enum {
|
||||
TT3650_CMD_CI_TEST = 0x40,
|
||||
TT3650_CMD_CI_RD_CTRL,
|
||||
TT3650_CMD_CI_WR_CTRL,
|
||||
TT3650_CMD_CI_RD_ATTR,
|
||||
TT3650_CMD_CI_WR_ATTR,
|
||||
TT3650_CMD_CI_RESET,
|
||||
TT3650_CMD_CI_SET_VIDEO_PORT
|
||||
};
|
||||
|
||||
struct ttusb2_state {
|
||||
struct dvb_ca_en50221 ca;
|
||||
struct mutex ca_mutex;
|
||||
u8 id;
|
||||
u16 last_rc_key;
|
||||
};
|
||||
|
|
@ -79,6 +103,255 @@ static int ttusb2_msg(struct dvb_usb_device *d, u8 cmd,
|
|||
return 0;
|
||||
}
|
||||
|
||||
/* ci */
|
||||
static int tt3650_ci_msg(struct dvb_usb_device *d, u8 cmd, u8 *data, unsigned int write_len, unsigned int read_len)
|
||||
{
|
||||
int ret;
|
||||
u8 rx[60];/* (64 -4) */
|
||||
ret = ttusb2_msg(d, cmd, data, write_len, rx, read_len);
|
||||
if (!ret)
|
||||
memcpy(data, rx, read_len);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int tt3650_ci_msg_locked(struct dvb_ca_en50221 *ca, u8 cmd, u8 *data, unsigned int write_len, unsigned int read_len)
|
||||
{
|
||||
struct dvb_usb_device *d = ca->data;
|
||||
struct ttusb2_state *state = d->priv;
|
||||
int ret;
|
||||
|
||||
mutex_lock(&state->ca_mutex);
|
||||
ret = tt3650_ci_msg(d, cmd, data, write_len, read_len);
|
||||
mutex_unlock(&state->ca_mutex);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int tt3650_ci_read_attribute_mem(struct dvb_ca_en50221 *ca, int slot, int address)
|
||||
{
|
||||
u8 buf[3];
|
||||
int ret = 0;
|
||||
|
||||
if (slot)
|
||||
return -EINVAL;
|
||||
|
||||
buf[0] = (address >> 8) & 0x0F;
|
||||
buf[1] = address;
|
||||
|
||||
|
||||
ret = tt3650_ci_msg_locked(ca, TT3650_CMD_CI_RD_ATTR, buf, 2, 3);
|
||||
|
||||
ci_dbg("%04x -> %d 0x%02x", address, ret, buf[2]);
|
||||
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return buf[2];
|
||||
}
|
||||
|
||||
static int tt3650_ci_write_attribute_mem(struct dvb_ca_en50221 *ca, int slot, int address, u8 value)
|
||||
{
|
||||
u8 buf[3];
|
||||
|
||||
ci_dbg("%d 0x%04x 0x%02x", slot, address, value);
|
||||
|
||||
if (slot)
|
||||
return -EINVAL;
|
||||
|
||||
buf[0] = (address >> 8) & 0x0F;
|
||||
buf[1] = address;
|
||||
buf[2] = value;
|
||||
|
||||
return tt3650_ci_msg_locked(ca, TT3650_CMD_CI_WR_ATTR, buf, 3, 3);
|
||||
}
|
||||
|
||||
static int tt3650_ci_read_cam_control(struct dvb_ca_en50221 *ca, int slot, u8 address)
|
||||
{
|
||||
u8 buf[2];
|
||||
int ret;
|
||||
|
||||
if (slot)
|
||||
return -EINVAL;
|
||||
|
||||
buf[0] = address & 3;
|
||||
|
||||
ret = tt3650_ci_msg_locked(ca, TT3650_CMD_CI_RD_CTRL, buf, 1, 2);
|
||||
|
||||
ci_dbg("0x%02x -> %d 0x%02x", address, ret, buf[1]);
|
||||
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return buf[1];
|
||||
}
|
||||
|
||||
static int tt3650_ci_write_cam_control(struct dvb_ca_en50221 *ca, int slot, u8 address, u8 value)
|
||||
{
|
||||
u8 buf[2];
|
||||
|
||||
ci_dbg("%d 0x%02x 0x%02x", slot, address, value);
|
||||
|
||||
if (slot)
|
||||
return -EINVAL;
|
||||
|
||||
buf[0] = address;
|
||||
buf[1] = value;
|
||||
|
||||
return tt3650_ci_msg_locked(ca, TT3650_CMD_CI_WR_CTRL, buf, 2, 2);
|
||||
}
|
||||
|
||||
static int tt3650_ci_set_video_port(struct dvb_ca_en50221 *ca, int slot, int enable)
|
||||
{
|
||||
u8 buf[1];
|
||||
int ret;
|
||||
|
||||
ci_dbg("%d %d", slot, enable);
|
||||
|
||||
if (slot)
|
||||
return -EINVAL;
|
||||
|
||||
buf[0] = enable;
|
||||
|
||||
ret = tt3650_ci_msg_locked(ca, TT3650_CMD_CI_SET_VIDEO_PORT, buf, 1, 1);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
if (enable != buf[0]) {
|
||||
err("CI not %sabled.", enable ? "en" : "dis");
|
||||
return -EIO;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int tt3650_ci_slot_shutdown(struct dvb_ca_en50221 *ca, int slot)
|
||||
{
|
||||
return tt3650_ci_set_video_port(ca, slot, 0);
|
||||
}
|
||||
|
||||
static int tt3650_ci_slot_ts_enable(struct dvb_ca_en50221 *ca, int slot)
|
||||
{
|
||||
return tt3650_ci_set_video_port(ca, slot, 1);
|
||||
}
|
||||
|
||||
static int tt3650_ci_slot_reset(struct dvb_ca_en50221 *ca, int slot)
|
||||
{
|
||||
struct dvb_usb_device *d = ca->data;
|
||||
struct ttusb2_state *state = d->priv;
|
||||
u8 buf[1];
|
||||
int ret;
|
||||
|
||||
ci_dbg("%d", slot);
|
||||
|
||||
if (slot)
|
||||
return -EINVAL;
|
||||
|
||||
buf[0] = 0;
|
||||
|
||||
mutex_lock(&state->ca_mutex);
|
||||
|
||||
ret = tt3650_ci_msg(d, TT3650_CMD_CI_RESET, buf, 1, 1);
|
||||
if (ret)
|
||||
goto failed;
|
||||
|
||||
msleep(500);
|
||||
|
||||
buf[0] = 1;
|
||||
|
||||
ret = tt3650_ci_msg(d, TT3650_CMD_CI_RESET, buf, 1, 1);
|
||||
if (ret)
|
||||
goto failed;
|
||||
|
||||
msleep(500);
|
||||
|
||||
buf[0] = 0; /* FTA */
|
||||
|
||||
ret = tt3650_ci_msg(d, TT3650_CMD_CI_SET_VIDEO_PORT, buf, 1, 1);
|
||||
|
||||
msleep(1100);
|
||||
|
||||
failed:
|
||||
mutex_unlock(&state->ca_mutex);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int tt3650_ci_poll_slot_status(struct dvb_ca_en50221 *ca, int slot, int open)
|
||||
{
|
||||
u8 buf[1];
|
||||
int ret;
|
||||
|
||||
if (slot)
|
||||
return -EINVAL;
|
||||
|
||||
ret = tt3650_ci_msg_locked(ca, TT3650_CMD_CI_TEST, buf, 0, 1);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
if (1 == buf[0]) {
|
||||
return DVB_CA_EN50221_POLL_CAM_PRESENT |
|
||||
DVB_CA_EN50221_POLL_CAM_READY;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void tt3650_ci_uninit(struct dvb_usb_device *d)
|
||||
{
|
||||
struct ttusb2_state *state;
|
||||
|
||||
ci_dbg("");
|
||||
|
||||
if (NULL == d)
|
||||
return;
|
||||
|
||||
state = d->priv;
|
||||
if (NULL == state)
|
||||
return;
|
||||
|
||||
if (NULL == state->ca.data)
|
||||
return;
|
||||
|
||||
dvb_ca_en50221_release(&state->ca);
|
||||
|
||||
memset(&state->ca, 0, sizeof(state->ca));
|
||||
}
|
||||
|
||||
static int tt3650_ci_init(struct dvb_usb_adapter *a)
|
||||
{
|
||||
struct dvb_usb_device *d = a->dev;
|
||||
struct ttusb2_state *state = d->priv;
|
||||
int ret;
|
||||
|
||||
ci_dbg("");
|
||||
|
||||
mutex_init(&state->ca_mutex);
|
||||
|
||||
state->ca.owner = THIS_MODULE;
|
||||
state->ca.read_attribute_mem = tt3650_ci_read_attribute_mem;
|
||||
state->ca.write_attribute_mem = tt3650_ci_write_attribute_mem;
|
||||
state->ca.read_cam_control = tt3650_ci_read_cam_control;
|
||||
state->ca.write_cam_control = tt3650_ci_write_cam_control;
|
||||
state->ca.slot_reset = tt3650_ci_slot_reset;
|
||||
state->ca.slot_shutdown = tt3650_ci_slot_shutdown;
|
||||
state->ca.slot_ts_enable = tt3650_ci_slot_ts_enable;
|
||||
state->ca.poll_slot_status = tt3650_ci_poll_slot_status;
|
||||
state->ca.data = d;
|
||||
|
||||
ret = dvb_ca_en50221_init(&a->dvb_adap,
|
||||
&state->ca,
|
||||
/* flags */ 0,
|
||||
/* n_slots */ 1);
|
||||
if (ret) {
|
||||
err("Cannot initialize CI: Error %d.", ret);
|
||||
memset(&state->ca, 0, sizeof(state->ca));
|
||||
return ret;
|
||||
}
|
||||
|
||||
info("CI initialized.");
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ttusb2_i2c_xfer(struct i2c_adapter *adap,struct i2c_msg msg[],int num)
|
||||
{
|
||||
struct dvb_usb_device *d = i2c_get_adapdata(adap);
|
||||
|
|
@ -251,6 +524,7 @@ static int ttusb2_frontend_tda10023_attach(struct dvb_usb_adapter *adap)
|
|||
deb_info("TDA10023 attach failed\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
tt3650_ci_init(adap);
|
||||
} else {
|
||||
adap->fe_adap[1].fe = dvb_attach(tda10048_attach,
|
||||
&tda10048_config, &adap->dev->i2c_adap);
|
||||
|
|
@ -305,6 +579,14 @@ static struct dvb_usb_device_properties ttusb2_properties;
|
|||
static struct dvb_usb_device_properties ttusb2_properties_s2400;
|
||||
static struct dvb_usb_device_properties ttusb2_properties_ct3650;
|
||||
|
||||
static void ttusb2_usb_disconnect(struct usb_interface *intf)
|
||||
{
|
||||
struct dvb_usb_device *d = usb_get_intfdata(intf);
|
||||
|
||||
tt3650_ci_uninit(d);
|
||||
dvb_usb_device_exit(intf);
|
||||
}
|
||||
|
||||
static int ttusb2_probe(struct usb_interface *intf,
|
||||
const struct usb_device_id *id)
|
||||
{
|
||||
|
|
@ -513,7 +795,7 @@ static struct dvb_usb_device_properties ttusb2_properties_ct3650 = {
|
|||
static struct usb_driver ttusb2_driver = {
|
||||
.name = "dvb_usb_ttusb2",
|
||||
.probe = ttusb2_probe,
|
||||
.disconnect = dvb_usb_device_exit,
|
||||
.disconnect = ttusb2_usb_disconnect,
|
||||
.id_table = ttusb2_table,
|
||||
};
|
||||
|
||||
|
|
|
|||
Загрузка…
Ссылка в новой задаче