579 lines
14 KiB
C
579 lines
14 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/* DVB USB compliant linux driver for GL861 USB2.0 devices.
|
|
*
|
|
* see Documentation/driver-api/media/drivers/dvb-usb.rst for more information
|
|
*/
|
|
#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 {
|
|
/* USB control message buffer */
|
|
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); /* Avoid I2C errors */
|
|
|
|
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;
|
|
|
|
/* XXX: I2C adapter maximum data lengths are not tested */
|
|
if (num == 1 && !(msg[0].flags & I2C_M_RD)) {
|
|
/* I2C write */
|
|
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)) {
|
|
/* I2C write + read */
|
|
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)) {
|
|
/* I2C read */
|
|
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 {
|
|
/* Unsupported I2C message */
|
|
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,
|
|
};
|
|
|
|
/* Callbacks for DVB USB */
|
|
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)
|
|
{
|
|
/*
|
|
* There is 2 interfaces. Interface 0 is for TV and interface 1 is
|
|
* for HID remote controller. Interface 0 has 2 alternate settings.
|
|
* For some reason we need to set interface explicitly, defaulted
|
|
* as alternate setting 1?
|
|
*/
|
|
return usb_set_interface(d->udev, 0, 0);
|
|
}
|
|
|
|
/* DVB USB Driver stuff */
|
|
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),
|
|
}
|
|
}
|
|
};
|
|
|
|
|
|
/*
|
|
* For Friio
|
|
*/
|
|
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), },
|
|
};
|
|
|
|
|
|
/* GPIO control in Friio */
|
|
|
|
#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
|
|
|
|
/* control PIC16F676 attached to Friio */
|
|
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;
|
|
|
|
/* send 2bit header (&B10) */
|
|
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);
|
|
|
|
/* send 32bit(satur, R, G, B) data in serial */
|
|
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;
|
|
}
|
|
|
|
/* set the strobe off */
|
|
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;
|
|
}
|
|
|
|
/* init/config of gl861 for Friio */
|
|
/* NOTE:
|
|
* This function cannot be moved to friio_init()/dvb_usbv2_init(),
|
|
* because the init defined here includes a whole device reset,
|
|
* it must be run early before any activities like I2C,
|
|
* but friio_init() is called by dvb-usbv2 after {_frontend, _tuner}_attach(),
|
|
* where I2C communication is used.
|
|
* In addition, this reset is required in reset_resume() as well.
|
|
* Thus this function is set to be called from _power_ctl().
|
|
*
|
|
* Since it will be called on the early init stage
|
|
* where the i2c adapter is not initialized yet,
|
|
* we cannot use i2c_transfer() here.
|
|
*/
|
|
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;
|
|
|
|
/*
|
|
* Check if the dev is really a Friio White, since it might be
|
|
* another device, Friio Black, with the same VID/PID.
|
|
*/
|
|
|
|
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;
|
|
}
|
|
|
|
/*
|
|
* DVB callbacks for Friio
|
|
*/
|
|
|
|
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},
|
|
};
|
|
|
|
/* power on LNA? */
|
|
ret = friio_ext_ctl(d, FRIIO_LED_STOPPED, true);
|
|
if (ret < 0)
|
|
return ret;
|
|
msleep(20);
|
|
|
|
/* init/config demod */
|
|
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");
|