![Julia Lawall](/assets/img/avatar_default.png)
The rest of the function uses ret to store the return value, even setting ret to i a few lines before this, so return ret instead of i. A simplified version of the semantic match that finds this problem is as follows: (http://coccinelle.lip6.fr/) // <smpl> ( if@p1 (\(ret < 0\|ret != 0\)) { ... return ret; } | ret@p1 = 0 ) ... when != ret = e1 when != &ret *if(...) { ... when != ret = e2 when forall return ret; } // </smpl> Signed-off-by: Julia Lawall <Julia.Lawall@lip6.fr> Cc: Antti Palosaari <crope@iki.fi> Signed-off-by: Mauro Carvalho Chehab <m.chehab@samsung.com>
386 lines
9.3 KiB
C
386 lines
9.3 KiB
C
/*
|
|
* E3C EC168 DVB USB driver
|
|
*
|
|
* Copyright (C) 2009 Antti Palosaari <crope@iki.fi>
|
|
*
|
|
* 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; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*
|
|
*/
|
|
|
|
#include "ec168.h"
|
|
#include "ec100.h"
|
|
#include "mxl5005s.h"
|
|
|
|
DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
|
|
|
|
static int ec168_ctrl_msg(struct dvb_usb_device *d, struct ec168_req *req)
|
|
{
|
|
int ret;
|
|
unsigned int pipe;
|
|
u8 request, requesttype;
|
|
u8 *buf;
|
|
|
|
switch (req->cmd) {
|
|
case DOWNLOAD_FIRMWARE:
|
|
case GPIO:
|
|
case WRITE_I2C:
|
|
case STREAMING_CTRL:
|
|
requesttype = (USB_TYPE_VENDOR | USB_DIR_OUT);
|
|
request = req->cmd;
|
|
break;
|
|
case READ_I2C:
|
|
requesttype = (USB_TYPE_VENDOR | USB_DIR_IN);
|
|
request = req->cmd;
|
|
break;
|
|
case GET_CONFIG:
|
|
requesttype = (USB_TYPE_VENDOR | USB_DIR_IN);
|
|
request = CONFIG;
|
|
break;
|
|
case SET_CONFIG:
|
|
requesttype = (USB_TYPE_VENDOR | USB_DIR_OUT);
|
|
request = CONFIG;
|
|
break;
|
|
case WRITE_DEMOD:
|
|
requesttype = (USB_TYPE_VENDOR | USB_DIR_OUT);
|
|
request = DEMOD_RW;
|
|
break;
|
|
case READ_DEMOD:
|
|
requesttype = (USB_TYPE_VENDOR | USB_DIR_IN);
|
|
request = DEMOD_RW;
|
|
break;
|
|
default:
|
|
dev_err(&d->udev->dev, "%s: unknown command=%02x\n",
|
|
KBUILD_MODNAME, req->cmd);
|
|
ret = -EINVAL;
|
|
goto error;
|
|
}
|
|
|
|
buf = kmalloc(req->size, GFP_KERNEL);
|
|
if (!buf) {
|
|
ret = -ENOMEM;
|
|
goto error;
|
|
}
|
|
|
|
if (requesttype == (USB_TYPE_VENDOR | USB_DIR_OUT)) {
|
|
/* write */
|
|
memcpy(buf, req->data, req->size);
|
|
pipe = usb_sndctrlpipe(d->udev, 0);
|
|
} else {
|
|
/* read */
|
|
pipe = usb_rcvctrlpipe(d->udev, 0);
|
|
}
|
|
|
|
msleep(1); /* avoid I2C errors */
|
|
|
|
ret = usb_control_msg(d->udev, pipe, request, requesttype, req->value,
|
|
req->index, buf, req->size, EC168_USB_TIMEOUT);
|
|
|
|
dvb_usb_dbg_usb_control_msg(d->udev, request, requesttype, req->value,
|
|
req->index, buf, req->size);
|
|
|
|
if (ret < 0)
|
|
goto err_dealloc;
|
|
else
|
|
ret = 0;
|
|
|
|
/* read request, copy returned data to return buf */
|
|
if (!ret && requesttype == (USB_TYPE_VENDOR | USB_DIR_IN))
|
|
memcpy(req->data, buf, req->size);
|
|
|
|
kfree(buf);
|
|
return ret;
|
|
|
|
err_dealloc:
|
|
kfree(buf);
|
|
error:
|
|
dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
|
|
return ret;
|
|
}
|
|
|
|
/* I2C */
|
|
static struct ec100_config ec168_ec100_config;
|
|
|
|
static int ec168_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msg[],
|
|
int num)
|
|
{
|
|
struct dvb_usb_device *d = i2c_get_adapdata(adap);
|
|
struct ec168_req req;
|
|
int i = 0;
|
|
int ret;
|
|
|
|
if (num > 2)
|
|
return -EINVAL;
|
|
|
|
if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
|
|
return -EAGAIN;
|
|
|
|
while (i < num) {
|
|
if (num > i + 1 && (msg[i+1].flags & I2C_M_RD)) {
|
|
if (msg[i].addr == ec168_ec100_config.demod_address) {
|
|
req.cmd = READ_DEMOD;
|
|
req.value = 0;
|
|
req.index = 0xff00 + msg[i].buf[0]; /* reg */
|
|
req.size = msg[i+1].len; /* bytes to read */
|
|
req.data = &msg[i+1].buf[0];
|
|
ret = ec168_ctrl_msg(d, &req);
|
|
i += 2;
|
|
} else {
|
|
dev_err(&d->udev->dev, "%s: I2C read not " \
|
|
"implemented\n",
|
|
KBUILD_MODNAME);
|
|
ret = -EOPNOTSUPP;
|
|
i += 2;
|
|
}
|
|
} else {
|
|
if (msg[i].addr == ec168_ec100_config.demod_address) {
|
|
req.cmd = WRITE_DEMOD;
|
|
req.value = msg[i].buf[1]; /* val */
|
|
req.index = 0xff00 + msg[i].buf[0]; /* reg */
|
|
req.size = 0;
|
|
req.data = NULL;
|
|
ret = ec168_ctrl_msg(d, &req);
|
|
i += 1;
|
|
} else {
|
|
req.cmd = WRITE_I2C;
|
|
req.value = msg[i].buf[0]; /* val */
|
|
req.index = 0x0100 + msg[i].addr; /* I2C addr */
|
|
req.size = msg[i].len-1;
|
|
req.data = &msg[i].buf[1];
|
|
ret = ec168_ctrl_msg(d, &req);
|
|
i += 1;
|
|
}
|
|
}
|
|
if (ret)
|
|
goto error;
|
|
|
|
}
|
|
ret = i;
|
|
|
|
error:
|
|
mutex_unlock(&d->i2c_mutex);
|
|
return ret;
|
|
}
|
|
|
|
static u32 ec168_i2c_func(struct i2c_adapter *adapter)
|
|
{
|
|
return I2C_FUNC_I2C;
|
|
}
|
|
|
|
static struct i2c_algorithm ec168_i2c_algo = {
|
|
.master_xfer = ec168_i2c_xfer,
|
|
.functionality = ec168_i2c_func,
|
|
};
|
|
|
|
/* Callbacks for DVB USB */
|
|
static int ec168_identify_state(struct dvb_usb_device *d, const char **name)
|
|
{
|
|
int ret;
|
|
u8 reply;
|
|
struct ec168_req req = {GET_CONFIG, 0, 1, sizeof(reply), &reply};
|
|
dev_dbg(&d->udev->dev, "%s:\n", __func__);
|
|
|
|
ret = ec168_ctrl_msg(d, &req);
|
|
if (ret)
|
|
goto error;
|
|
|
|
dev_dbg(&d->udev->dev, "%s: reply=%02x\n", __func__, reply);
|
|
|
|
if (reply == 0x01)
|
|
ret = WARM;
|
|
else
|
|
ret = COLD;
|
|
|
|
return ret;
|
|
error:
|
|
dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
|
|
return ret;
|
|
}
|
|
|
|
static int ec168_download_firmware(struct dvb_usb_device *d,
|
|
const struct firmware *fw)
|
|
{
|
|
int ret, len, remaining;
|
|
struct ec168_req req = {DOWNLOAD_FIRMWARE, 0, 0, 0, NULL};
|
|
dev_dbg(&d->udev->dev, "%s:\n", __func__);
|
|
|
|
#define LEN_MAX 2048 /* max packet size */
|
|
for (remaining = fw->size; remaining > 0; remaining -= LEN_MAX) {
|
|
len = remaining;
|
|
if (len > LEN_MAX)
|
|
len = LEN_MAX;
|
|
|
|
req.size = len;
|
|
req.data = (u8 *) &fw->data[fw->size - remaining];
|
|
req.index = fw->size - remaining;
|
|
|
|
ret = ec168_ctrl_msg(d, &req);
|
|
if (ret) {
|
|
dev_err(&d->udev->dev,
|
|
"%s: firmware download failed=%d\n",
|
|
KBUILD_MODNAME, ret);
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
req.size = 0;
|
|
|
|
/* set "warm"? */
|
|
req.cmd = SET_CONFIG;
|
|
req.value = 0;
|
|
req.index = 0x0001;
|
|
ret = ec168_ctrl_msg(d, &req);
|
|
if (ret)
|
|
goto error;
|
|
|
|
/* really needed - no idea what does */
|
|
req.cmd = GPIO;
|
|
req.value = 0;
|
|
req.index = 0x0206;
|
|
ret = ec168_ctrl_msg(d, &req);
|
|
if (ret)
|
|
goto error;
|
|
|
|
/* activate tuner I2C? */
|
|
req.cmd = WRITE_I2C;
|
|
req.value = 0;
|
|
req.index = 0x00c6;
|
|
ret = ec168_ctrl_msg(d, &req);
|
|
if (ret)
|
|
goto error;
|
|
|
|
return ret;
|
|
error:
|
|
dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
|
|
return ret;
|
|
}
|
|
|
|
static struct ec100_config ec168_ec100_config = {
|
|
.demod_address = 0xff, /* not real address, demod is integrated */
|
|
};
|
|
|
|
static int ec168_ec100_frontend_attach(struct dvb_usb_adapter *adap)
|
|
{
|
|
struct dvb_usb_device *d = adap_to_d(adap);
|
|
dev_dbg(&d->udev->dev, "%s:\n", __func__);
|
|
|
|
adap->fe[0] = dvb_attach(ec100_attach, &ec168_ec100_config,
|
|
&d->i2c_adap);
|
|
if (adap->fe[0] == NULL)
|
|
return -ENODEV;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct mxl5005s_config ec168_mxl5003s_config = {
|
|
.i2c_address = 0xc6,
|
|
.if_freq = IF_FREQ_4570000HZ,
|
|
.xtal_freq = CRYSTAL_FREQ_16000000HZ,
|
|
.agc_mode = MXL_SINGLE_AGC,
|
|
.tracking_filter = MXL_TF_OFF,
|
|
.rssi_enable = MXL_RSSI_ENABLE,
|
|
.cap_select = MXL_CAP_SEL_ENABLE,
|
|
.div_out = MXL_DIV_OUT_4,
|
|
.clock_out = MXL_CLOCK_OUT_DISABLE,
|
|
.output_load = MXL5005S_IF_OUTPUT_LOAD_200_OHM,
|
|
.top = MXL5005S_TOP_25P2,
|
|
.mod_mode = MXL_DIGITAL_MODE,
|
|
.if_mode = MXL_ZERO_IF,
|
|
.AgcMasterByte = 0x00,
|
|
};
|
|
|
|
static int ec168_mxl5003s_tuner_attach(struct dvb_usb_adapter *adap)
|
|
{
|
|
struct dvb_usb_device *d = adap_to_d(adap);
|
|
dev_dbg(&d->udev->dev, "%s:\n", __func__);
|
|
|
|
return dvb_attach(mxl5005s_attach, adap->fe[0], &d->i2c_adap,
|
|
&ec168_mxl5003s_config) == NULL ? -ENODEV : 0;
|
|
}
|
|
|
|
static int ec168_streaming_ctrl(struct dvb_frontend *fe, int onoff)
|
|
{
|
|
struct dvb_usb_device *d = fe_to_d(fe);
|
|
struct ec168_req req = {STREAMING_CTRL, 0x7f01, 0x0202, 0, NULL};
|
|
dev_dbg(&d->udev->dev, "%s: onoff=%d\n", __func__, onoff);
|
|
|
|
if (onoff)
|
|
req.index = 0x0102;
|
|
return ec168_ctrl_msg(d, &req);
|
|
}
|
|
|
|
/* DVB USB Driver stuff */
|
|
/* bInterfaceNumber 0 is HID
|
|
* bInterfaceNumber 1 is DVB-T */
|
|
static struct dvb_usb_device_properties ec168_props = {
|
|
.driver_name = KBUILD_MODNAME,
|
|
.owner = THIS_MODULE,
|
|
.adapter_nr = adapter_nr,
|
|
.bInterfaceNumber = 1,
|
|
|
|
.identify_state = ec168_identify_state,
|
|
.firmware = EC168_FIRMWARE,
|
|
.download_firmware = ec168_download_firmware,
|
|
|
|
.i2c_algo = &ec168_i2c_algo,
|
|
.frontend_attach = ec168_ec100_frontend_attach,
|
|
.tuner_attach = ec168_mxl5003s_tuner_attach,
|
|
.streaming_ctrl = ec168_streaming_ctrl,
|
|
|
|
.num_adapters = 1,
|
|
.adapter = {
|
|
{
|
|
.stream = DVB_USB_STREAM_BULK(0x82, 6, 32 * 512),
|
|
}
|
|
},
|
|
};
|
|
|
|
static const struct dvb_usb_driver_info ec168_driver_info = {
|
|
.name = "E3C EC168 reference design",
|
|
.props = &ec168_props,
|
|
};
|
|
|
|
static const struct usb_device_id ec168_id[] = {
|
|
{ USB_DEVICE(USB_VID_E3C, USB_PID_E3C_EC168),
|
|
.driver_info = (kernel_ulong_t) &ec168_driver_info },
|
|
{ USB_DEVICE(USB_VID_E3C, USB_PID_E3C_EC168_2),
|
|
.driver_info = (kernel_ulong_t) &ec168_driver_info },
|
|
{ USB_DEVICE(USB_VID_E3C, USB_PID_E3C_EC168_3),
|
|
.driver_info = (kernel_ulong_t) &ec168_driver_info },
|
|
{ USB_DEVICE(USB_VID_E3C, USB_PID_E3C_EC168_4),
|
|
.driver_info = (kernel_ulong_t) &ec168_driver_info },
|
|
{ USB_DEVICE(USB_VID_E3C, USB_PID_E3C_EC168_5),
|
|
.driver_info = (kernel_ulong_t) &ec168_driver_info },
|
|
{}
|
|
};
|
|
MODULE_DEVICE_TABLE(usb, ec168_id);
|
|
|
|
static struct usb_driver ec168_driver = {
|
|
.name = KBUILD_MODNAME,
|
|
.id_table = ec168_id,
|
|
.probe = dvb_usbv2_probe,
|
|
.disconnect = dvb_usbv2_disconnect,
|
|
.suspend = dvb_usbv2_suspend,
|
|
.resume = dvb_usbv2_resume,
|
|
.no_dynamic_id = 1,
|
|
.soft_unbind = 1,
|
|
};
|
|
|
|
module_usb_driver(ec168_driver);
|
|
|
|
MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
|
|
MODULE_DESCRIPTION("E3C EC168 driver");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_FIRMWARE(EC168_FIRMWARE);
|