forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
578 lines
14 KiB
578 lines
14 KiB
// 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 <[email protected]>"); |
|
MODULE_DESCRIPTION("Driver MSI Mega Sky 580 DVB-T USB2.0 / GL861"); |
|
MODULE_VERSION("0.1"); |
|
MODULE_LICENSE("GPL");
|
|
|