Quelle  gl861.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 const 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");