cregit-Linux how code gets into the kernel

Release 4.11 drivers/media/usb/dvb-usb/friio.c

/* DVB USB compliant Linux driver for the Friio USB2.0 ISDB-T receiver.
 *
 * Copyright (C) 2009 Akihiro Tsukada <tskd2@yahoo.co.jp>
 *
 * This module is based off the the gl861 and vp702x modules.
 *
 * 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/dvb/README.dvb-usb for more information
 */
#include "friio.h"

/* debug */

int dvb_usb_friio_debug;
module_param_named(debug, dvb_usb_friio_debug, int, 0644);
MODULE_PARM_DESC(debug,
		 "set debugging level (1=info,2=xfer,4=rc,8=fe (or-able))."
		 DVB_USB_DEBUG_STATUS);


DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);

/**
 * Indirect I2C access to the PLL via FE.
 * whole I2C protocol data to the PLL is sent via the FE's I2C register.
 * This is done by a control msg to the FE with the I2C data accompanied, and
 * a specific USB request number is assigned for that purpose.
 *
 * this func sends wbuf[1..] to the I2C register wbuf[0] at addr (= at FE).
 * TODO: refoctored, smarter i2c functions.
 */

static int gl861_i2c_ctrlmsg_data(struct dvb_usb_device *d, u8 addr, u8 *wbuf, u16 wlen, u8 *rbuf, u16 rlen) { u16 index = wbuf[0]; /* must be JDVBT90502_2ND_I2C_REG(=0xFE) */ u16 value = addr << (8 + 1); int wo = (rbuf == NULL || rlen == 0); /* write only */ u8 req, type; deb_xfer("write to PLL:0x%02x via FE reg:0x%02x, len:%d\n", wbuf[1], wbuf[0], wlen - 1); if (wo && wlen >= 2) { req = GL861_REQ_I2C_DATA_CTRL_WRITE; type = GL861_WRITE; udelay(20); return usb_control_msg(d->udev, usb_sndctrlpipe(d->udev, 0), req, type, value, index, &wbuf[1], wlen - 1, 2000); } deb_xfer("not supported ctrl-msg, aborting."); return -EINVAL; }

Contributors

PersonTokensPropCommitsCommitProp
Akihiro Tsukada155100.00%1100.00%
Total155100.00%1100.00%

/* normal I2C access (without extra data arguments). * write to the register wbuf[0] at I2C address addr with the value wbuf[1], * or read from the register wbuf[0]. * register address can be 16bit (wbuf[2]<<8 | wbuf[0]) if wlen==3 */
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; unsigned int pipe; /* special case for the indirect I2C access to the PLL via FE, */ if (addr == friio_fe_config.demod_address && wbuf[0] == JDVBT90502_2ND_I2C_REG) return gl861_i2c_ctrlmsg_data(d, addr, wbuf, wlen, rbuf, rlen); if (wo) { req = GL861_REQ_I2C_WRITE; type = GL861_WRITE; pipe = usb_sndctrlpipe(d->udev, 0); } else { /* rw */ req = GL861_REQ_I2C_READ; type = GL861_READ; pipe = usb_rcvctrlpipe(d->udev, 0); } switch (wlen) { case 1: index = wbuf[0]; break; case 2: index = wbuf[0]; value = value + wbuf[1]; break; case 3: /* special case for 16bit register-address */ index = (wbuf[2] << 8) | wbuf[0]; value = value + wbuf[1]; break; default: deb_xfer("wlen = %x, aborting.", wlen); return -EINVAL; } msleep(1); return usb_control_msg(d->udev, pipe, req, type, value, index, rbuf, rlen, 2000); }

Contributors

PersonTokensPropCommitsCommitProp
Akihiro Tsukada253100.00%1100.00%
Total253100.00%1100.00%

/* 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; }

Contributors

PersonTokensPropCommitsCommitProp
Akihiro Tsukada196100.00%1100.00%
Total196100.00%1100.00%


static u32 gl861_i2c_func(struct i2c_adapter *adapter) { return I2C_FUNC_I2C; }

Contributors

PersonTokensPropCommitsCommitProp
Akihiro Tsukada14100.00%1100.00%
Total14100.00%1100.00%


static int friio_ext_ctl(struct dvb_usb_adapter *adap, u32 sat_color, int lnb_on) { int i; int ret; struct i2c_msg msg; u8 *buf; u32 mask; u8 lnb = (lnb_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] = lnb | FRIIO_CTL_LED | FRIIO_CTL_STROBE; ret = gl861_i2c_xfer(&adap->dev->i2c_adap, &msg, 1); buf[1] |= FRIIO_CTL_CLK; ret += gl861_i2c_xfer(&adap->dev->i2c_adap, &msg, 1); buf[1] = lnb | FRIIO_CTL_STROBE; ret += gl861_i2c_xfer(&adap->dev->i2c_adap, &msg, 1); buf[1] |= FRIIO_CTL_CLK; ret += gl861_i2c_xfer(&adap->dev->i2c_adap, &msg, 1); /* send 32bit(satur, R, G, B) data in serial */ mask = 1 << 31; for (i = 0; i < 32; i++) { buf[1] = lnb | FRIIO_CTL_STROBE; if (sat_color & mask) buf[1] |= FRIIO_CTL_LED; ret += gl861_i2c_xfer(&adap->dev->i2c_adap, &msg, 1); buf[1] |= FRIIO_CTL_CLK; ret += gl861_i2c_xfer(&adap->dev->i2c_adap, &msg, 1); mask >>= 1; } /* set the strobe off */ buf[1] = lnb; ret += gl861_i2c_xfer(&adap->dev->i2c_adap, &msg, 1); buf[1] |= FRIIO_CTL_CLK; ret += gl861_i2c_xfer(&adap->dev->i2c_adap, &msg, 1); kfree(buf); return (ret == 70); }

Contributors

PersonTokensPropCommitsCommitProp
Akihiro Tsukada32393.08%150.00%
Florian Mickler246.92%150.00%
Total347100.00%2100.00%

static int friio_streaming_ctrl(struct dvb_usb_adapter *adap, int onoff); /* TODO: move these init cmds to the FE's init routine? */ static u8 streaming_init_cmds[][2] = { {0x33, 0x08}, {0x37, 0x40}, {0x3A, 0x1F}, {0x3B, 0xFF}, {0x3C, 0x1F}, {0x3D, 0xFF}, {0x38, 0x00}, {0x35, 0x00}, {0x39, 0x00}, {0x36, 0x00}, }; static int cmdlen = sizeof(streaming_init_cmds) / 2; /* * Command sequence in this init function is a replay * of the captured USB commands from the Windows proprietary driver. */
static int friio_initialize(struct dvb_usb_device *d) { int ret; int i; int retry = 0; u8 *rbuf, *wbuf; deb_info("%s called.\n", __func__); wbuf = kmalloc(3, GFP_KERNEL); if (!wbuf) return -ENOMEM; rbuf = kmalloc(2, GFP_KERNEL); if (!rbuf) { kfree(wbuf); return -ENOMEM; } /* use gl861_i2c_msg instead of gl861_i2c_xfer(), */ /* because the i2c device is not set up yet. */ wbuf[0] = 0x11; wbuf[1] = 0x02; ret = gl861_i2c_msg(d, 0x00, wbuf, 2, NULL, 0); if (ret < 0) goto error; msleep(2); wbuf[0] = 0x11; wbuf[1] = 0x00; ret = gl861_i2c_msg(d, 0x00, wbuf, 2, NULL, 0); if (ret < 0) goto error; msleep(1); /* following msgs should be in the FE's init code? */ /* cmd sequence to identify the device type? (friio black/white) */ wbuf[0] = 0x03; wbuf[1] = 0x80; /* can't use gl861_i2c_cmd, as the register-addr is 16bit(0x0100) */ ret = usb_control_msg(d->udev, usb_sndctrlpipe(d->udev, 0), GL861_REQ_I2C_DATA_CTRL_WRITE, GL861_WRITE, 0x1200, 0x0100, wbuf, 2, 2000); if (ret < 0) goto error; msleep(2); wbuf[0] = 0x00; wbuf[2] = 0x01; /* reg.0x0100 */ wbuf[1] = 0x00; ret = gl861_i2c_msg(d, 0x12 >> 1, wbuf, 3, rbuf, 2); /* my Friio White returns 0xffff. */ if (ret < 0 || rbuf[0] != 0xff || rbuf[1] != 0xff) goto error; msleep(2); wbuf[0] = 0x03; wbuf[1] = 0x80; ret = usb_control_msg(d->udev, usb_sndctrlpipe(d->udev, 0), GL861_REQ_I2C_DATA_CTRL_WRITE, GL861_WRITE, 0x9000, 0x0100, wbuf, 2, 2000); if (ret < 0) goto error; msleep(2); wbuf[0] = 0x00; wbuf[2] = 0x01; /* reg.0x0100 */ wbuf[1] = 0x00; ret = gl861_i2c_msg(d, 0x90 >> 1, wbuf, 3, rbuf, 2); /* my Friio White returns 0xffff again. */ if (ret < 0 || rbuf[0] != 0xff || rbuf[1] != 0xff) goto error; msleep(1); restart: /* ============ start DEMOD init cmds ================== */ /* read PLL status to clear the POR bit */ wbuf[0] = JDVBT90502_2ND_I2C_REG; wbuf[1] = (FRIIO_PLL_ADDR << 1) + 1; /* +1 for reading */ ret = gl861_i2c_msg(d, FRIIO_DEMOD_ADDR, wbuf, 2, NULL, 0); if (ret < 0) goto error; msleep(5); /* note: DEMODULATOR has 16bit register-address. */ wbuf[0] = 0x00; wbuf[2] = 0x01; /* reg addr: 0x0100 */ wbuf[1] = 0x00; /* val: not used */ ret = gl861_i2c_msg(d, FRIIO_DEMOD_ADDR, wbuf, 3, rbuf, 1); if (ret < 0) goto error; /* msleep(1); wbuf[0] = 0x80; wbuf[1] = 0x00; ret = gl861_i2c_msg(d, FRIIO_DEMOD_ADDR, wbuf, 2, rbuf, 1); if (ret < 0) goto error; */ if (rbuf[0] & 0x80) { /* still in PowerOnReset state? */ if (++retry > 3) { deb_info("failed to get the correct FE demod status:0x%02x\n", rbuf[0]); goto error; } msleep(100); goto restart; } /* TODO: check return value in rbuf */ /* =========== end DEMOD init cmds ===================== */ msleep(1); wbuf[0] = 0x30; wbuf[1] = 0x04; ret = gl861_i2c_msg(d, 0x00, wbuf, 2, NULL, 0); if (ret < 0) goto error; msleep(2); /* following 2 cmds unnecessary? */ wbuf[0] = 0x00; wbuf[1] = 0x01; ret = gl861_i2c_msg(d, 0x00, wbuf, 2, NULL, 0); if (ret < 0) goto error; wbuf[0] = 0x06; wbuf[1] = 0x0F; ret = gl861_i2c_msg(d, 0x00, wbuf, 2, NULL, 0); if (ret < 0) goto error; /* some streaming ctl cmds (maybe) */ msleep(10); for (i = 0; i < cmdlen; i++) { ret = gl861_i2c_msg(d, 0x00, streaming_init_cmds[i], 2, NULL, 0); if (ret < 0) goto error; msleep(1); } msleep(20); /* change the LED color etc. */ ret = friio_streaming_ctrl(&d->adapter[0], 0); if (ret < 0) goto error; return 0; error: kfree(wbuf); kfree(rbuf); deb_info("%s:ret == %d\n", __func__, ret); return -EIO; }

Contributors

PersonTokensPropCommitsCommitProp
Akihiro Tsukada77293.12%133.33%
Florian Mickler566.76%133.33%
Mauro Carvalho Chehab10.12%133.33%
Total829100.00%3100.00%

/* Callbacks for DVB USB */
static int friio_streaming_ctrl(struct dvb_usb_adapter *adap, int onoff) { int ret; deb_info("%s called.(%d)\n", __func__, onoff); /* set the LED color and saturation (and LNB on) */ if (onoff) ret = friio_ext_ctl(adap, 0x6400ff64, 1); else ret = friio_ext_ctl(adap, 0x96ff00ff, 1); if (ret != 1) { deb_info("%s failed to send cmdx. ret==%d\n", __func__, ret); return -EREMOTEIO; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Akihiro Tsukada78100.00%1100.00%
Total78100.00%1100.00%


static int friio_frontend_attach(struct dvb_usb_adapter *adap) { if (friio_initialize(adap->dev) < 0) return -EIO; adap->fe_adap[0].fe = jdvbt90502_attach(adap->dev); if (adap->fe_adap[0].fe == NULL) return -EIO; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Akihiro Tsukada5080.65%133.33%
Antti Palosaari69.68%133.33%
Michael Ira Krufky69.68%133.33%
Total62100.00%3100.00%

/* DVB USB Driver stuff */ static struct dvb_usb_device_properties friio_properties;
static int friio_probe(struct usb_interface *intf, const struct usb_device_id *id) { struct dvb_usb_device *d; struct usb_host_interface *alt; int ret; if (intf->num_altsetting < GL861_ALTSETTING_COUNT) return -ENODEV; alt = usb_altnum_to_altsetting(intf, FRIIO_BULK_ALTSETTING); if (alt == NULL) { deb_rc("not alt found!\n"); return -ENODEV; } ret = usb_set_interface(interface_to_usbdev(intf), alt->desc.bInterfaceNumber, alt->desc.bAlternateSetting); if (ret != 0) { deb_rc("failed to set alt-setting!\n"); return ret; } ret = dvb_usb_device_init(intf, &friio_properties, THIS_MODULE, &d, adapter_nr); if (ret == 0) friio_streaming_ctrl(&d->adapter[0], 1); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Akihiro Tsukada145100.00%1100.00%
Total145100.00%1100.00%

struct jdvbt90502_config friio_fe_config = { .demod_address = FRIIO_DEMOD_ADDR, .pll_address = FRIIO_PLL_ADDR, }; static struct i2c_algorithm gl861_i2c_algo = { .master_xfer = gl861_i2c_xfer, .functionality = gl861_i2c_func, }; static struct usb_device_id friio_table[] = { { USB_DEVICE(USB_VID_774, USB_PID_FRIIO_WHITE) }, { } /* Terminating entry */ }; MODULE_DEVICE_TABLE(usb, friio_table); static struct dvb_usb_device_properties friio_properties = { .caps = DVB_USB_IS_AN_I2C_ADAPTER, .usb_ctrl = DEVICE_SPECIFIC, .size_of_priv = 0, .num_adapters = 1, .adapter = { /* caps:0 => no pid filter, 188B TS packet */ /* GL861 has a HW pid filter, but no info available. */ { .num_frontends = 1, .fe = {{ .caps = 0, .frontend_attach = friio_frontend_attach, .streaming_ctrl = friio_streaming_ctrl, .stream = { .type = USB_BULK, /* count <= MAX_NO_URBS_FOR_DATA_STREAM(10) */ .count = 8, .endpoint = 0x01, .u = { /* GL861 has 6KB buf inside */ .bulk = { .buffersize = 16384, } } }, }}, } }, .i2c_algo = &gl861_i2c_algo, .num_device_descs = 1, .devices = { { .name = "774 Friio ISDB-T USB2.0", .cold_ids = { NULL }, .warm_ids = { &friio_table[0], NULL }, }, } }; static struct usb_driver friio_driver = { .name = "dvb_usb_friio", .probe = friio_probe, .disconnect = dvb_usb_device_exit, .id_table = friio_table, }; module_usb_driver(friio_driver); MODULE_AUTHOR("Akihiro Tsukada <tskd2@yahoo.co.jp>"); MODULE_DESCRIPTION("Driver for Friio ISDB-T USB2.0 Receiver"); MODULE_VERSION("0.2"); MODULE_LICENSE("GPL");

Overall Contributors

PersonTokensPropCommitsCommitProp
Akihiro Tsukada236595.67%116.67%
Florian Mickler803.24%116.67%
Michael Ira Krufky180.73%116.67%
Antti Palosaari60.24%116.67%
Greg Kroah-Hartman20.08%116.67%
Mauro Carvalho Chehab10.04%116.67%
Total2472100.00%6100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.