123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661 |
- /* DVB USB compliant linux driver for GL861 USB2.0 devices.
- *
- * 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, version 2.
- *
- * see Documentation/media/dvb-drivers/dvb-usb.rst for more information
- */
- #include <linux/string.h>
- #include "gl861.h"
- #include "zl10353.h"
- #include "qt1010.h"
- #include "tc90522.h"
- #include "dvb-pll.h"
- DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
- static int gl861_i2c_msg(struct dvb_usb_device *d, u8 addr,
- u8 *wbuf, u16 wlen, u8 *rbuf, u16 rlen)
- {
- u16 index;
- u16 value = addr << (8 + 1);
- int wo = (rbuf == NULL || rlen == 0); /* write-only */
- u8 req, type;
- u8 *buf;
- int ret;
- if (wo) {
- req = GL861_REQ_I2C_WRITE;
- type = GL861_WRITE;
- buf = kmemdup(wbuf, wlen, GFP_KERNEL);
- } else { /* rw */
- req = GL861_REQ_I2C_READ;
- type = GL861_READ;
- buf = kmalloc(rlen, GFP_KERNEL);
- }
- if (!buf)
- return -ENOMEM;
- switch (wlen) {
- case 1:
- index = wbuf[0];
- break;
- case 2:
- index = wbuf[0];
- value = value + wbuf[1];
- break;
- default:
- dev_err(&d->udev->dev, "%s: wlen=%d, aborting\n",
- KBUILD_MODNAME, wlen);
- kfree(buf);
- return -EINVAL;
- }
- usleep_range(1000, 2000); /* avoid I2C errors */
- ret = usb_control_msg(d->udev, usb_rcvctrlpipe(d->udev, 0), req, type,
- value, index, buf, rlen, 2000);
- if (!wo && ret > 0)
- memcpy(rbuf, buf, rlen);
- kfree(buf);
- return ret;
- }
- /* I2C */
- static int gl861_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msg[],
- int num)
- {
- struct dvb_usb_device *d = i2c_get_adapdata(adap);
- int i;
- if (num > 2)
- return -EINVAL;
- if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
- return -EAGAIN;
- for (i = 0; i < num; i++) {
- /* write/read request */
- if (i+1 < num && (msg[i+1].flags & I2C_M_RD)) {
- if (gl861_i2c_msg(d, msg[i].addr, msg[i].buf,
- msg[i].len, msg[i+1].buf, msg[i+1].len) < 0)
- break;
- i++;
- } else
- if (gl861_i2c_msg(d, msg[i].addr, msg[i].buf,
- msg[i].len, NULL, 0) < 0)
- break;
- }
- mutex_unlock(&d->i2c_mutex);
- return i;
- }
- static u32 gl861_i2c_func(struct i2c_adapter *adapter)
- {
- return I2C_FUNC_I2C;
- }
- static struct i2c_algorithm gl861_i2c_algo = {
- .master_xfer = gl861_i2c_xfer,
- .functionality = gl861_i2c_func,
- };
- /* 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,
- .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_priv {
- struct i2c_adapter *demod_sub_i2c;
- struct i2c_client *i2c_client_demod;
- struct i2c_client *i2c_client_tuner;
- struct i2c_adapter tuner_adap;
- };
- 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), },
- .tuner_info = { I2C_BOARD_INFO("tua6034_friio", 0x60), },
- };
- /* For another type of I2C:
- * message sent by a USB control-read/write transaction with data stage.
- * Used in init/config of Friio.
- */
- static int
- gl861_i2c_write_ex(struct dvb_usb_device *d, u8 addr, u8 *wbuf, u16 wlen)
- {
- u8 *buf;
- int ret;
- buf = kmalloc(wlen, GFP_KERNEL);
- if (!buf)
- return -ENOMEM;
- memcpy(buf, wbuf, wlen);
- ret = usb_control_msg(d->udev, usb_sndctrlpipe(d->udev, 0),
- GL861_REQ_I2C_RAW, GL861_WRITE,
- addr << (8 + 1), 0x0100, buf, wlen, 2000);
- kfree(buf);
- return ret;
- }
- static int
- gl861_i2c_read_ex(struct dvb_usb_device *d, u8 addr, u8 *rbuf, u16 rlen)
- {
- u8 *buf;
- int ret;
- buf = kmalloc(rlen, GFP_KERNEL);
- if (!buf)
- return -ENOMEM;
- ret = usb_control_msg(d->udev, usb_rcvctrlpipe(d->udev, 0),
- GL861_REQ_I2C_READ, GL861_READ,
- addr << (8 + 1), 0x0100, buf, rlen, 2000);
- if (ret > 0 && rlen > 0)
- memcpy(buf, rbuf, rlen);
- kfree(buf);
- return ret;
- }
- /* For I2C transactions to the tuner of Friio (dvb_pll).
- *
- * Friio uses irregular USB encapsulation for tuner i2c transactions:
- * write transacions are encapsulated with a different USB 'request' value.
- *
- * Although all transactions are sent via the demod(tc90522)
- * and the demod provides an i2c adapter for them, it cannot be used in Friio
- * since it assumes using the same parent adapter with the demod,
- * which does not use the request value and uses same one for both read/write.
- * So we define a dedicated i2c adapter here.
- */
- static int
- friio_i2c_tuner_read(struct dvb_usb_device *d, struct i2c_msg *msg)
- {
- struct friio_priv *priv;
- u8 addr;
- priv = d_to_priv(d);
- addr = priv->i2c_client_demod->addr;
- return gl861_i2c_read_ex(d, addr, msg->buf, msg->len);
- }
- static int
- friio_i2c_tuner_write(struct dvb_usb_device *d, struct i2c_msg *msg)
- {
- u8 *buf;
- int ret;
- struct friio_priv *priv;
- priv = d_to_priv(d);
- if (msg->len < 1)
- return -EINVAL;
- buf = kmalloc(msg->len + 1, GFP_KERNEL);
- if (!buf)
- return -ENOMEM;
- buf[0] = msg->addr << 1;
- memcpy(buf + 1, msg->buf, msg->len);
- ret = usb_control_msg(d->udev, usb_sndctrlpipe(d->udev, 0),
- GL861_REQ_I2C_RAW, GL861_WRITE,
- priv->i2c_client_demod->addr << (8 + 1),
- 0xFE, buf, msg->len + 1, 2000);
- kfree(buf);
- return ret;
- }
- static int friio_tuner_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msg[],
- int num)
- {
- struct dvb_usb_device *d = i2c_get_adapdata(adap);
- int i;
- if (num > 2)
- return -EINVAL;
- if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
- return -EAGAIN;
- for (i = 0; i < num; i++) {
- int ret;
- if (msg[i].flags & I2C_M_RD)
- ret = friio_i2c_tuner_read(d, &msg[i]);
- else
- ret = friio_i2c_tuner_write(d, &msg[i]);
- if (ret < 0)
- break;
- usleep_range(1000, 2000); /* avoid I2C errors */
- }
- mutex_unlock(&d->i2c_mutex);
- return i;
- }
- static struct i2c_algorithm friio_tuner_i2c_algo = {
- .master_xfer = friio_tuner_i2c_xfer,
- .functionality = gl861_i2c_func,
- };
- /* 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 = 1 << 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 must be done before any activities like I2C,
- * but friio_init() is called by dvb-usbv2 after {_frontend, _tuner}_attach(),
- * where I2C communication is used.
- * 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[2], 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;
- wbuf[0] = 0x11;
- wbuf[1] = 0x02;
- ret = gl861_i2c_msg(d, 0x00, wbuf, 2, NULL, 0);
- if (ret < 0)
- return ret;
- usleep_range(2000, 3000);
- wbuf[0] = 0x11;
- wbuf[1] = 0x00;
- ret = gl861_i2c_msg(d, 0x00, wbuf, 2, NULL, 0);
- 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] = 0x03;
- wbuf[1] = 0x80;
- ret = gl861_i2c_write_ex(d, 0x09, wbuf, 2);
- if (ret < 0)
- return ret;
- usleep_range(2000, 3000);
- ret = gl861_i2c_read_ex(d, 0x09, rbuf, 2);
- if (ret < 0)
- return ret;
- if (rbuf[0] != 0xff || rbuf[1] != 0xff)
- return -ENODEV;
- usleep_range(1000, 2000);
- ret = gl861_i2c_write_ex(d, 0x48, wbuf, 2);
- if (ret < 0)
- return ret;
- usleep_range(2000, 3000);
- ret = gl861_i2c_read_ex(d, 0x48, rbuf, 2);
- if (ret < 0)
- return ret;
- if (rbuf[0] != 0xff || rbuf[1] != 0xff)
- return -ENODEV;
- wbuf[0] = 0x30;
- wbuf[1] = 0x04;
- ret = gl861_i2c_msg(d, 0x00, wbuf, 2, NULL, 0);
- if (ret < 0)
- return ret;
- wbuf[0] = 0x00;
- wbuf[1] = 0x01;
- ret = gl861_i2c_msg(d, 0x00, wbuf, 2, NULL, 0);
- if (ret < 0)
- return ret;
- wbuf[0] = 0x06;
- wbuf[1] = 0x0f;
- ret = gl861_i2c_msg(d, 0x00, wbuf, 2, NULL, 0);
- if (ret < 0)
- return ret;
- for (i = 0; i < ARRAY_SIZE(friio_init_cmds); i++) {
- ret = gl861_i2c_msg(d, 0x00, (u8 *)friio_init_cmds[i], 2,
- NULL, 0);
- 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 friio_priv *priv;
- info = &friio_config.demod_info;
- 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;
- /* ignore cfg.tuner_i2c and create new one */
- priv = adap_to_priv(adap);
- priv->i2c_client_demod = cl;
- priv->tuner_adap.algo = &friio_tuner_i2c_algo;
- priv->tuner_adap.dev.parent = &d->udev->dev;
- strlcpy(priv->tuner_adap.name, d->name, sizeof(priv->tuner_adap.name));
- strlcat(priv->tuner_adap.name, "-tuner", sizeof(priv->tuner_adap.name));
- priv->demod_sub_i2c = &priv->tuner_adap;
- i2c_set_adapdata(&priv->tuner_adap, d);
- return i2c_add_adapter(&priv->tuner_adap);
- }
- static int friio_frontend_detach(struct dvb_usb_adapter *adap)
- {
- struct friio_priv *priv;
- priv = adap_to_priv(adap);
- i2c_del_adapter(&priv->tuner_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 friio_priv *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 friio_priv *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 friio_priv *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 friio_priv),
- .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_VID_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");
|