#include <linux/string.h>
#include "dvb_usb.h"
#include "zl10353.h"
#include "qt1010.h"
#include "tc90522.h"
#include "dvb-pll.h"
DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
struct gl861 {
u8 buf[16];
struct i2c_adapter *demod_sub_i2c;
struct i2c_client *i2c_client_demod;
struct i2c_client *i2c_client_tuner;
};
#define CMD_WRITE_SHORT 0x01
#define CMD_READ 0x02
#define CMD_WRITE 0x03
static int gl861_ctrl_msg(struct dvb_usb_device *d, u8 request, u16 value,
u16 index, void *data, u16 size)
{
struct gl861 *ctx = d_to_priv(d);
struct usb_interface *intf = d->intf;
int ret;
unsigned int pipe;
u8 requesttype;
mutex_lock(&d->usb_mutex);
switch (request) {
case CMD_WRITE:
memcpy(ctx->buf, data, size);
fallthrough;
case CMD_WRITE_SHORT:
pipe = usb_sndctrlpipe(d->udev, 0);
requesttype = USB_TYPE_VENDOR | USB_DIR_OUT;
break;
case CMD_READ:
pipe = usb_rcvctrlpipe(d->udev, 0);
requesttype = USB_TYPE_VENDOR | USB_DIR_IN;
break;
default:
ret = -EINVAL;
goto err_mutex_unlock;
}
ret = usb_control_msg(d->udev, pipe, request, requesttype, value,
index, ctx->buf, size, 200);
dev_dbg(&intf->dev, "%d | %02x %02x %*ph %*ph %*ph %s %*ph\n",
ret, requesttype, request, 2, &value, 2, &index, 2, &size,
(requesttype & USB_DIR_IN) ? "<<<" : ">>>", size, ctx->buf);
if (ret < 0)
goto err_mutex_unlock;
if (request == CMD_READ)
memcpy(data, ctx->buf, size);
usleep_range(1000, 2000);
mutex_unlock(&d->usb_mutex);
return 0;
err_mutex_unlock:
mutex_unlock(&d->usb_mutex);
dev_dbg(&intf->dev, "failed %d\n", ret);
return ret;
}
static int gl861_short_write(struct dvb_usb_device *d, u8 addr, u8 reg, u8 val)
{
return gl861_ctrl_msg(d, CMD_WRITE_SHORT,
(addr << 9) | val, reg, NULL, 0);
}
static int gl861_i2c_master_xfer(struct i2c_adapter *adap, struct i2c_msg msg[],
int num)
{
struct dvb_usb_device *d = i2c_get_adapdata(adap);
struct usb_interface *intf = d->intf;
struct gl861 *ctx = d_to_priv(d);
int ret;
u8 request, *data;
u16 value, index, size;
if (num == 1 && !(msg[0].flags & I2C_M_RD)) {
if (msg[0].len < 2 || msg[0].len > sizeof(ctx->buf)) {
ret = -EOPNOTSUPP;
goto err;
}
value = (msg[0].addr << 1) << 8;
index = msg[0].buf[0];
if (msg[0].len == 2) {
request = CMD_WRITE_SHORT;
value |= msg[0].buf[1];
size = 0;
data = NULL;
} else {
request = CMD_WRITE;
size = msg[0].len - 1;
data = &msg[0].buf[1];
}
ret = gl861_ctrl_msg(d, request, value, index, data, size);
} else if (num == 2 && !(msg[0].flags & I2C_M_RD) &&
(msg[1].flags & I2C_M_RD)) {
if (msg[0].len != 1 || msg[1].len > sizeof(ctx->buf)) {
ret = -EOPNOTSUPP;
goto err;
}
value = (msg[0].addr << 1) << 8;
index = msg[0].buf[0];
request = CMD_READ;
ret = gl861_ctrl_msg(d, request, value, index,
msg[1].buf, msg[1].len);
} else if (num == 1 && (msg[0].flags & I2C_M_RD)) {
if (msg[0].len > sizeof(ctx->buf)) {
ret = -EOPNOTSUPP;
goto err;
}
value = (msg[0].addr << 1) << 8;
index = 0x0100;
request = CMD_READ;
ret = gl861_ctrl_msg(d, request, value, index,
msg[0].buf, msg[0].len);
} else {
dev_dbg(&intf->dev, "unknown i2c msg, num %u\n", num);
ret = -EOPNOTSUPP;
}
if (ret)
goto err;
return num;
err:
dev_dbg(&intf->dev, "failed %d\n", ret);
return ret;
}
static u32 gl861_i2c_functionality(struct i2c_adapter *adapter)
{
return I2C_FUNC_I2C;
}
static struct i2c_algorithm gl861_i2c_algo = {
.master_xfer = gl861_i2c_master_xfer,
.functionality = gl861_i2c_functionality,
};
static struct zl10353_config gl861_zl10353_config = {
.demod_address = 0x0f,
.no_tuner = 1,
.parallel_ts = 1,
};
static int gl861_frontend_attach(struct dvb_usb_adapter *adap)
{
adap->fe[0] = dvb_attach(zl10353_attach, &gl861_zl10353_config,
&adap_to_d(adap)->i2c_adap);
if (adap->fe[0] == NULL)
return -EIO;
return 0;
}
static struct qt1010_config gl861_qt1010_config = {
.i2c_address = 0x62
};
static int gl861_tuner_attach(struct dvb_usb_adapter *adap)
{
return dvb_attach(qt1010_attach,
adap->fe[0], &adap_to_d(adap)->i2c_adap,
&gl861_qt1010_config) == NULL ? -ENODEV : 0;
}
static int gl861_init(struct dvb_usb_device *d)
{
return usb_set_interface(d->udev, 0, 0);
}
static struct dvb_usb_device_properties gl861_props = {
.driver_name = KBUILD_MODNAME,
.owner = THIS_MODULE,
.adapter_nr = adapter_nr,
.size_of_priv = sizeof(struct gl861),
.i2c_algo = &gl861_i2c_algo,
.frontend_attach = gl861_frontend_attach,
.tuner_attach = gl861_tuner_attach,
.init = gl861_init,
.num_adapters = 1,
.adapter = {
{
.stream = DVB_USB_STREAM_BULK(0x81, 7, 512),
}
}
};
struct friio_config {
struct i2c_board_info demod_info;
struct tc90522_config demod_cfg;
struct i2c_board_info tuner_info;
struct dvb_pll_config tuner_cfg;
};
static const struct friio_config friio_config = {
.demod_info = { I2C_BOARD_INFO(TC90522_I2C_DEV_TER, 0x18), },
.demod_cfg = { .split_tuner_read_i2c = true, },
.tuner_info = { I2C_BOARD_INFO("tua6034_friio", 0x60), },
};
#define FRIIO_CTL_LNB (1 << 0)
#define FRIIO_CTL_STROBE (1 << 1)
#define FRIIO_CTL_CLK (1 << 2)
#define FRIIO_CTL_LED (1 << 3)
#define FRIIO_LED_RUNNING 0x6400ff64
#define FRIIO_LED_STOPPED 0x96ff00ff
static int friio_ext_ctl(struct dvb_usb_device *d,
u32 sat_color, int power_on)
{
int i, ret;
struct i2c_msg msg;
u8 *buf;
u32 mask;
u8 power = (power_on) ? FRIIO_CTL_LNB : 0;
buf = kmalloc(2, GFP_KERNEL);
if (!buf)
return -ENOMEM;
msg.addr = 0x00;
msg.flags = 0;
msg.len = 2;
msg.buf = buf;
buf[0] = 0x00;
buf[1] = power | FRIIO_CTL_LED | FRIIO_CTL_STROBE;
ret = i2c_transfer(&d->i2c_adap, &msg, 1);
buf[1] |= FRIIO_CTL_CLK;
ret += i2c_transfer(&d->i2c_adap, &msg, 1);
buf[1] = power | FRIIO_CTL_STROBE;
ret += i2c_transfer(&d->i2c_adap, &msg, 1);
buf[1] |= FRIIO_CTL_CLK;
ret += i2c_transfer(&d->i2c_adap, &msg, 1);
mask = 1UL << 31;
for (i = 0; i < 32; i++) {
buf[1] = power | FRIIO_CTL_STROBE;
if (sat_color & mask)
buf[1] |= FRIIO_CTL_LED;
ret += i2c_transfer(&d->i2c_adap, &msg, 1);
buf[1] |= FRIIO_CTL_CLK;
ret += i2c_transfer(&d->i2c_adap, &msg, 1);
mask >>= 1;
}
buf[1] = power;
ret += i2c_transfer(&d->i2c_adap, &msg, 1);
buf[1] |= FRIIO_CTL_CLK;
ret += i2c_transfer(&d->i2c_adap, &msg, 1);
kfree(buf);
return (ret == 70) ? 0 : -EREMOTEIO;
}
static int friio_reset(struct dvb_usb_device *d)
{
int i, ret;
u8 wbuf[1], rbuf[2];
static const u8 friio_init_cmds[][2] = {
{0x33, 0x08}, {0x37, 0x40}, {0x3a, 0x1f}, {0x3b, 0xff},
{0x3c, 0x1f}, {0x3d, 0xff}, {0x38, 0x00}, {0x35, 0x00},
{0x39, 0x00}, {0x36, 0x00},
};
ret = usb_set_interface(d->udev, 0, 0);
if (ret < 0)
return ret;
ret = gl861_short_write(d, 0x00, 0x11, 0x02);
if (ret < 0)
return ret;
usleep_range(2000, 3000);
ret = gl861_short_write(d, 0x00, 0x11, 0x00);
if (ret < 0)
return ret;
usleep_range(1000, 2000);
wbuf[0] = 0x80;
ret = gl861_ctrl_msg(d, CMD_WRITE, 0x09 << 9, 0x03, wbuf, 1);
if (ret < 0)
return ret;
usleep_range(2000, 3000);
ret = gl861_ctrl_msg(d, CMD_READ, 0x09 << 9, 0x0100, rbuf, 2);
if (ret < 0)
return ret;
if (rbuf[0] != 0xff || rbuf[1] != 0xff)
return -ENODEV;
usleep_range(1000, 2000);
wbuf[0] = 0x80;
ret = gl861_ctrl_msg(d, CMD_WRITE, 0x48 << 9, 0x03, wbuf, 1);
if (ret < 0)
return ret;
usleep_range(2000, 3000);
ret = gl861_ctrl_msg(d, CMD_READ, 0x48 << 9, 0x0100, rbuf, 2);
if (ret < 0)
return ret;
if (rbuf[0] != 0xff || rbuf[1] != 0xff)
return -ENODEV;
ret = gl861_short_write(d, 0x00, 0x30, 0x04);
if (ret < 0)
return ret;
ret = gl861_short_write(d, 0x00, 0x00, 0x01);
if (ret < 0)
return ret;
ret = gl861_short_write(d, 0x00, 0x06, 0x0f);
if (ret < 0)
return ret;
for (i = 0; i < ARRAY_SIZE(friio_init_cmds); i++) {
ret = gl861_short_write(d, 0x00, friio_init_cmds[i][0],
friio_init_cmds[i][1]);
if (ret < 0)
return ret;
}
return 0;
}
static int friio_power_ctrl(struct dvb_usb_device *d, int onoff)
{
return onoff ? friio_reset(d) : 0;
}
static int friio_frontend_attach(struct dvb_usb_adapter *adap)
{
const struct i2c_board_info *info;
struct dvb_usb_device *d;
struct tc90522_config cfg;
struct i2c_client *cl;
struct gl861 *priv;
info = &friio_config.demod_info;
cfg = friio_config.demod_cfg;
d = adap_to_d(adap);
cl = dvb_module_probe("tc90522", info->type,
&d->i2c_adap, info->addr, &cfg);
if (!cl)
return -ENODEV;
adap->fe[0] = cfg.fe;
priv = adap_to_priv(adap);
priv->i2c_client_demod = cl;
priv->demod_sub_i2c = cfg.tuner_i2c;
return 0;
}
static int friio_frontend_detach(struct dvb_usb_adapter *adap)
{
struct gl861 *priv;
priv = adap_to_priv(adap);
dvb_module_release(priv->i2c_client_demod);
return 0;
}
static int friio_tuner_attach(struct dvb_usb_adapter *adap)
{
const struct i2c_board_info *info;
struct dvb_pll_config cfg;
struct i2c_client *cl;
struct gl861 *priv;
priv = adap_to_priv(adap);
info = &friio_config.tuner_info;
cfg = friio_config.tuner_cfg;
cfg.fe = adap->fe[0];
cl = dvb_module_probe("dvb_pll", info->type,
priv->demod_sub_i2c, info->addr, &cfg);
if (!cl)
return -ENODEV;
priv->i2c_client_tuner = cl;
return 0;
}
static int friio_tuner_detach(struct dvb_usb_adapter *adap)
{
struct gl861 *priv;
priv = adap_to_priv(adap);
dvb_module_release(priv->i2c_client_tuner);
return 0;
}
static int friio_init(struct dvb_usb_device *d)
{
int i;
int ret;
struct gl861 *priv;
static const u8 demod_init[][2] = {
{0x01, 0x40}, {0x04, 0x38}, {0x05, 0x40}, {0x07, 0x40},
{0x0f, 0x4f}, {0x11, 0x21}, {0x12, 0x0b}, {0x13, 0x2f},
{0x14, 0x31}, {0x16, 0x02}, {0x21, 0xc4}, {0x22, 0x20},
{0x2c, 0x79}, {0x2d, 0x34}, {0x2f, 0x00}, {0x30, 0x28},
{0x31, 0x31}, {0x32, 0xdf}, {0x38, 0x01}, {0x39, 0x78},
{0x3b, 0x33}, {0x3c, 0x33}, {0x48, 0x90}, {0x51, 0x68},
{0x5e, 0x38}, {0x71, 0x00}, {0x72, 0x08}, {0x77, 0x00},
{0xc0, 0x21}, {0xc1, 0x10}, {0xe4, 0x1a}, {0xea, 0x1f},
{0x77, 0x00}, {0x71, 0x00}, {0x71, 0x00}, {0x76, 0x0c},
};
ret = friio_ext_ctl(d, FRIIO_LED_STOPPED, true);
if (ret < 0)
return ret;
msleep(20);
priv = d_to_priv(d);
for (i = 0; i < ARRAY_SIZE(demod_init); i++) {
int ret;
ret = i2c_master_send(priv->i2c_client_demod, demod_init[i], 2);
if (ret < 0)
return ret;
}
msleep(100);
return 0;
}
static void friio_exit(struct dvb_usb_device *d)
{
friio_ext_ctl(d, FRIIO_LED_STOPPED, false);
}
static int friio_streaming_ctrl(struct dvb_frontend *fe, int onoff)
{
u32 led_color;
led_color = onoff ? FRIIO_LED_RUNNING : FRIIO_LED_STOPPED;
return friio_ext_ctl(fe_to_d(fe), led_color, true);
}
static struct dvb_usb_device_properties friio_props = {
.driver_name = KBUILD_MODNAME,
.owner = THIS_MODULE,
.adapter_nr = adapter_nr,
.size_of_priv = sizeof(struct gl861),
.i2c_algo = &gl861_i2c_algo,
.power_ctrl = friio_power_ctrl,
.frontend_attach = friio_frontend_attach,
.frontend_detach = friio_frontend_detach,
.tuner_attach = friio_tuner_attach,
.tuner_detach = friio_tuner_detach,
.init = friio_init,
.exit = friio_exit,
.streaming_ctrl = friio_streaming_ctrl,
.num_adapters = 1,
.adapter = {
{
.stream = DVB_USB_STREAM_BULK(0x01, 8, 16384),
}
}
};
static const struct usb_device_id gl861_id_table[] = {
{ DVB_USB_DEVICE(USB_VID_MSI, USB_PID_MSI_MEGASKY580_55801,
&gl861_props, "MSI Mega Sky 55801 DVB-T USB2.0", NULL) },
{ DVB_USB_DEVICE(USB_VID_ALINK, USB_PID_ALINK_DTU,
&gl861_props, "A-LINK DTU DVB-T USB2.0", NULL) },
{ DVB_USB_DEVICE(USB_VID_774, USB_PID_FRIIO_WHITE,
&friio_props, "774 Friio White ISDB-T USB2.0", NULL) },
{ }
};
MODULE_DEVICE_TABLE(usb, gl861_id_table);
static struct usb_driver gl861_usb_driver = {
.name = KBUILD_MODNAME,
.id_table = gl861_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(gl861_usb_driver);
MODULE_AUTHOR("Carl Lundqvist <comabug@gmail.com>");
MODULE_DESCRIPTION("Driver MSI Mega Sky 580 DVB-T USB2.0 / GL861");
MODULE_VERSION("0.1");
MODULE_LICENSE("GPL"