[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / media / dvb / dvb-usb / dib0700_core.c

/* Linux driver for devices based on the DiBcom DiB0700 USB bridge
 *
 *	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.
 *
 *  Copyright (C) 2005-6 DiBcom, SA
 */
#include "dib0700.h"

/* debug */
int dvb_usb_dib0700_debug;
module_param_named(debug,dvb_usb_dib0700_debug, int, 0644);
MODULE_PARM_DESC(debug, "set debugging level (1=info,2=fw,4=fwdata,8=data (or-able))." DVB_USB_DEBUG_STATUS);

/* expecting rx buffer: request data[0] data[1] ... data[2] */
static int dib0700_ctrl_wr(struct dvb_usb_device *d, u8 *tx, u8 txlen)
{
	int status;

	deb_data(">>> ");
	debug_dump(tx,txlen,deb_data);

	status = usb_control_msg(d->udev, usb_sndctrlpipe(d->udev,0),
		tx[0], USB_TYPE_VENDOR | USB_DIR_OUT, 0, 0, tx, txlen,
		USB_CTRL_GET_TIMEOUT);

	if (status != txlen)
		deb_data("ep 0 write error (status = %d, len: %d)\n",status,txlen);

	return status < 0 ? status : 0;
}

/* expecting tx buffer: request data[0] ... data[n] (n <= 4) */
static int dib0700_ctrl_rd(struct dvb_usb_device *d, u8 *tx, u8 txlen, u8 *rx, u8 rxlen)
{
	u16 index, value;
	int status;

	if (txlen < 2) {
		err("tx buffer length is smaller than 2. Makes no sense.");
		return -EINVAL;
	}
	if (txlen > 4) {
		err("tx buffer length is larger than 4. Not supported.");
		return -EINVAL;
	}

	deb_data(">>> ");
	debug_dump(tx,txlen,deb_data);

	value = ((txlen - 2) << 8) | tx[1];
	index = 0;
	if (txlen > 2)
		index |= (tx[2] << 8);
	if (txlen > 3)
		index |= tx[3];

	/* think about swapping here */
	value = le16_to_cpu(value);
	index = le16_to_cpu(index);

	status = usb_control_msg(d->udev, usb_rcvctrlpipe(d->udev,0), tx[0],
			USB_TYPE_VENDOR | USB_DIR_IN, value, index, rx, rxlen,
			USB_CTRL_GET_TIMEOUT);

	if (status < 0)
		deb_info("ep 0 read error (status = %d)\n",status);

	deb_data("<<< ");
	debug_dump(rx,rxlen,deb_data);

	return status; /* length in case of success */
}

int dib0700_set_gpio(struct dvb_usb_device *d, enum dib07x0_gpios gpio, u8 gpio_dir, u8 gpio_val)
{
	u8 buf[3] = { REQUEST_SET_GPIO, gpio, ((gpio_dir & 0x01) << 7) | ((gpio_val & 0x01) << 6) };
	return dib0700_ctrl_wr(d,buf,3);
}

/*
 * I2C master xfer function
 */
static int dib0700_i2c_xfer(struct i2c_adapter *adap,struct i2c_msg *msg,int num)
{
	struct dvb_usb_device *d = i2c_get_adapdata(adap);
	int i,len;
	u8 buf[255];

	if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
		return -EAGAIN;

	for (i = 0; i < num; i++) {
		/* fill in the address */
		buf[1] = (msg[i].addr << 1);
		/* fill the buffer */
		memcpy(&buf[2], msg[i].buf, msg[i].len);

		/* write/read request */
		if (i+1 < num && (msg[i+1].flags & I2C_M_RD)) {
			buf[0] = REQUEST_I2C_READ;
			buf[1] |= 1;

			/* special thing in the current firmware: when length is zero the read-failed */
			if ((len = dib0700_ctrl_rd(d, buf, msg[i].len + 2, msg[i+1].buf, msg[i+1].len)) <= 0)
				break;

			msg[i+1].len = len;

			i++;
		} else {
			buf[0] = REQUEST_I2C_WRITE;
			if (dib0700_ctrl_wr(d, buf, msg[i].len + 2) < 0)
				break;
		}
	}

	mutex_unlock(&d->i2c_mutex);
	return i;
}

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

struct i2c_algorithm dib0700_i2c_algo = {
	.master_xfer   = dib0700_i2c_xfer,
	.functionality = dib0700_i2c_func,
};

int dib0700_identify_state(struct usb_device *udev, struct dvb_usb_device_properties *props,
			struct dvb_usb_device_description **desc, int *cold)
{
	u8 buf[3] = { REQUEST_SET_GPIO, 4, (GPIO_IN << 7) | (0 << 6) }; // GPIO4 is save - used for I2C
	*cold = usb_control_msg(udev, usb_sndctrlpipe(udev,0),
		buf[0], USB_TYPE_VENDOR | USB_DIR_OUT, 0, 0, buf, 3, USB_CTRL_GET_TIMEOUT) != 3;

	deb_info("cold: %d\n", *cold);
	return 0;
}

static int dib0700_jumpram(struct usb_device *udev, u32 address)
{
	int ret, actlen;
	u8 buf[8] = { REQUEST_JUMPRAM, 0, 0, 0,
		(address >> 24) & 0xff,
		(address >> 16) & 0xff,
		(address >> 8)  & 0xff,
		 address        & 0xff };

	if ((ret = usb_bulk_msg(udev, usb_sndbulkpipe(udev, 0x01),buf,8,&actlen,1000)) < 0) {
		deb_fw("jumpram to 0x%x failed\n",address);
		return ret;
	}
	if (actlen != 8) {
		deb_fw("jumpram to 0x%x failed\n",address);
		return -EIO;
	}
	return 0;
}

int dib0700_download_firmware(struct usb_device *udev, const struct firmware *fw)
{
	struct hexline hx;
	int pos = 0, ret, act_len;

	u8 buf[260];

	while ((ret = dvb_usb_get_hexline(fw, &hx, &pos)) > 0) {
		deb_fwdata("writing to address 0x%08x (buffer: 0x%02x %02x)\n",hx.addr, hx.len, hx.chk);

		buf[0] = hx.len;
		buf[1] = (hx.addr >> 8) & 0xff;
		buf[2] =  hx.addr       & 0xff;
		buf[3] = hx.type;
		memcpy(&buf[4],hx.data,hx.len);
		buf[4+hx.len] = hx.chk;

		ret = usb_bulk_msg(udev,
			usb_sndbulkpipe(udev, 0x01),
			buf,
			hx.len + 5,
			&act_len,
			1000);

		if (ret < 0) {
			err("firmware download failed at %d with %d",pos,ret);
			return ret;
		}
	}

	if (ret == 0) {
		/* start the firmware */
		if ((ret = dib0700_jumpram(udev, 0x70000000)) == 0) {
			info("firmware started successfully.");
			msleep(100);
		}
	} else
		ret = -EIO;

	return ret;
}

int dib0700_streaming_ctrl(struct dvb_usb_adapter *adap, int onoff)
{
	struct dib0700_state *st = adap->dev->priv;
	u8 b[4];

	b[0] = REQUEST_ENABLE_VIDEO;
	b[1] = 0x00;
	b[2] = (0x01 << 4); /* Master mode */
	b[3] = 0x00;

	deb_info("modifying (%d) streaming state for %d\n", onoff, adap->id);

	if (onoff)
		st->channel_state |=   1 << adap->id;
	else
		st->channel_state &= ~(1 << adap->id);

	b[2] |= st->channel_state;

	if (st->channel_state) /* if at least one channel is active */
		b[1] = (0x01 << 4) | 0x00;

	deb_info("data for streaming: %x %x\n",b[1],b[2]);

	return dib0700_ctrl_wr(adap->dev, b, 4);
}

static int dib0700_probe(struct usb_interface *intf,
		const struct usb_device_id *id)
{
	int i;

	for (i = 0; i < dib0700_device_count; i++)
		if (dvb_usb_device_init(intf, &dib0700_devices[i], THIS_MODULE, NULL) == 0)
			return 0;

	return -ENODEV;
}

static struct usb_driver dib0700_driver = {
	.name       = "dvb_usb_dib0700",
	.probe      = dib0700_probe,
	.disconnect = dvb_usb_device_exit,
	.id_table   = dib0700_usb_id_table,
};

/* module stuff */
static int __init dib0700_module_init(void)
{
	int result;
	info("loaded with support for %d different device-types", dib0700_device_count);
	if ((result = usb_register(&dib0700_driver))) {
		err("usb_register failed. Error number %d",result);
		return result;
	}

	return 0;
}

static void __exit dib0700_module_exit(void)
{
	/* deregister this driver from the USB subsystem */
	usb_deregister(&dib0700_driver);
}

module_init (dib0700_module_init);
module_exit (dib0700_module_exit);

MODULE_AUTHOR("Patrick Boettcher <pboettcher@dibcom.fr>");
MODULE_DESCRIPTION("Driver for devices based on DiBcom DiB0700 - USB bridge");
MODULE_VERSION("1.0");
MODULE_LICENSE("GPL");
Commit	Line	Data
b7f54910 PB	1	/* Linux driver for devices based on the DiBcom DiB0700 USB bridge
	2	*
	3	* This program is free software; you can redistribute it and/or modify it
	4	* under the terms of the GNU General Public License as published by the Free
	5	* Software Foundation, version 2.
	6	*
	7	* Copyright (C) 2005-6 DiBcom, SA
	8	*/
	9	#include "dib0700.h"
	10
	11	/* debug */
	12	int dvb_usb_dib0700_debug;
	13	module_param_named(debug,dvb_usb_dib0700_debug, int, 0644);
	14	MODULE_PARM_DESC(debug, "set debugging level (1=info,2=fw,4=fwdata,8=data (or-able))." DVB_USB_DEBUG_STATUS);
	15
	16	/* expecting rx buffer: request data[0] data[1] ... data[2] */
	17	static int dib0700_ctrl_wr(struct dvb_usb_device d, u8 tx, u8 txlen)
	18	{
	19	int status;
	20
	21	deb_data(">>> ");
	22	debug_dump(tx,txlen,deb_data);
	23
	24	status = usb_control_msg(d->udev, usb_sndctrlpipe(d->udev,0),
	25	tx[0], USB_TYPE_VENDOR \| USB_DIR_OUT, 0, 0, tx, txlen,
	26	USB_CTRL_GET_TIMEOUT);
	27
	28	if (status != txlen)
6958effe	29	deb_data("ep 0 write error (status = %d, len: %d)\n",status,txlen);
b7f54910 PB	30
	31	return status < 0 ? status : 0;
	32	}
	33
	34	/* expecting tx buffer: request data[0] ... data[n] (n <= 4) */
	35	static int dib0700_ctrl_rd(struct dvb_usb_device d, u8 tx, u8 txlen, u8 *rx, u8 rxlen)
	36	{
	37	u16 index, value;
	38	int status;
	39
	40	if (txlen < 2) {
	41	err("tx buffer length is smaller than 2. Makes no sense.");
	42	return -EINVAL;
	43	}
	44	if (txlen > 4) {
	45	err("tx buffer length is larger than 4. Not supported.");
	46	return -EINVAL;
	47	}
	48
	49	deb_data(">>> ");
	50	debug_dump(tx,txlen,deb_data);
	51
	52	value = ((txlen - 2) << 8) \| tx[1];
	53	index = 0;
	54	if (txlen > 2)
	55	index \|= (tx[2] << 8);
	56	if (txlen > 3)
	57	index \|= tx[3];
	58
	59	/* think about swapping here */
	60	value = le16_to_cpu(value);
	61	index = le16_to_cpu(index);
	62
	63	status = usb_control_msg(d->udev, usb_rcvctrlpipe(d->udev,0), tx[0],
	64	USB_TYPE_VENDOR \| USB_DIR_IN, value, index, rx, rxlen,
	65	USB_CTRL_GET_TIMEOUT);
	66
	67	if (status < 0)
6958effe	68	deb_info("ep 0 read error (status = %d)\n",status);
b7f54910 PB	69
	70	deb_data("<<< ");
	71	debug_dump(rx,rxlen,deb_data);
	72
	73	return status; /* length in case of success */
	74	}
	75
	76	int dib0700_set_gpio(struct dvb_usb_device *d, enum dib07x0_gpios gpio, u8 gpio_dir, u8 gpio_val)
	77	{
	78	u8 buf[3] = { REQUEST_SET_GPIO, gpio, ((gpio_dir & 0x01) << 7) \| ((gpio_val & 0x01) << 6) };
	79	return dib0700_ctrl_wr(d,buf,3);
	80	}
	81
	82	/*
	83	* I2C master xfer function
	84	*/
	85	static int dib0700_i2c_xfer(struct i2c_adapter adap,struct i2c_msg msg,int num)
	86	{
	87	struct dvb_usb_device *d = i2c_get_adapdata(adap);
	88	int i,len;
	89	u8 buf[255];
	90
	91	if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
	92	return -EAGAIN;
	93
	94	for (i = 0; i < num; i++) {
	95	/* fill in the address */
	96	buf[1] = (msg[i].addr << 1);
	97	/* fill the buffer */
	98	memcpy(&buf[2], msg[i].buf, msg[i].len);
	99
	100	/* write/read request */
	101	if (i+1 < num && (msg[i+1].flags & I2C_M_RD)) {
	102	buf[0] = REQUEST_I2C_READ;
	103	buf[1] \|= 1;
	104
	105	/* special thing in the current firmware: when length is zero the read-failed */
	106	if ((len = dib0700_ctrl_rd(d, buf, msg[i].len + 2, msg[i+1].buf, msg[i+1].len)) <= 0)
	107	break;
	108
	109	msg[i+1].len = len;
	110
	111	i++;
	112	} else {
	113	buf[0] = REQUEST_I2C_WRITE;
	114	if (dib0700_ctrl_wr(d, buf, msg[i].len + 2) < 0)
	115	break;
	116	}
	117	}
	118
	119	mutex_unlock(&d->i2c_mutex);
	120	return i;
	121	}
	122
	123	static u32 dib0700_i2c_func(struct i2c_adapter *adapter)
	124	{
	125	return I2C_FUNC_I2C;
	126	}
	127
	128	struct i2c_algorithm dib0700_i2c_algo = {
	129	.master_xfer = dib0700_i2c_xfer,
	130	.functionality = dib0700_i2c_func,
	131	};
	132
6958effe PB	133	int dib0700_identify_state(struct usb_device udev, struct dvb_usb_device_properties props,
	134	struct dvb_usb_device_description *desc, int cold)
	135	{
	136	u8 buf[3] = { REQUEST_SET_GPIO, 4, (GPIO_IN << 7) \| (0 << 6) }; // GPIO4 is save - used for I2C
	137	*cold = usb_control_msg(udev, usb_sndctrlpipe(udev,0),
	138	buf[0], USB_TYPE_VENDOR \| USB_DIR_OUT, 0, 0, buf, 3, USB_CTRL_GET_TIMEOUT) != 3;
	139
	140	deb_info("cold: %d\n", *cold);
6958effe PB	141	return 0;
	142	}
	143
b7f54910 PB	144	static int dib0700_jumpram(struct usb_device *udev, u32 address)
	145	{
	146	int ret, actlen;
	147	u8 buf[8] = { REQUEST_JUMPRAM, 0, 0, 0,
	148	(address >> 24) & 0xff,
	149	(address >> 16) & 0xff,
	150	(address >> 8) & 0xff,
	151	address & 0xff };
	152
	153	if ((ret = usb_bulk_msg(udev, usb_sndbulkpipe(udev, 0x01),buf,8,&actlen,1000)) < 0) {
	154	deb_fw("jumpram to 0x%x failed\n",address);
	155	return ret;
	156	}
	157	if (actlen != 8) {
	158	deb_fw("jumpram to 0x%x failed\n",address);
	159	return -EIO;
	160	}
	161	return 0;
	162	}
	163
	164	int dib0700_download_firmware(struct usb_device udev, const struct firmware fw)
	165	{
	166	struct hexline hx;
	167	int pos = 0, ret, act_len;
	168
	169	u8 buf[260];
	170
	171	while ((ret = dvb_usb_get_hexline(fw, &hx, &pos)) > 0) {
5bc63607	172	deb_fwdata("writing to address 0x%08x (buffer: 0x%02x %02x)\n",hx.addr, hx.len, hx.chk);
b7f54910 PB	173
b7f54910 PB	174	buf[0] = hx.len;
5bc63607 PB	175	buf[1] = (hx.addr >> 8) & 0xff;
5bc63607 PB	176	buf[2] = hx.addr & 0xff;
b7f54910 PB	177	buf[3] = hx.type;
	178	memcpy(&buf[4],hx.data,hx.len);
	179	buf[4+hx.len] = hx.chk;
	180
	181	ret = usb_bulk_msg(udev,
	182	usb_sndbulkpipe(udev, 0x01),
	183	buf,
	184	hx.len + 5,
	185	&act_len,
	186	1000);
	187
	188	if (ret < 0) {
	189	err("firmware download failed at %d with %d",pos,ret);
	190	return ret;
	191	}
	192	}
	193
	194	if (ret == 0) {
	195	/* start the firmware */
6958effe	196	if ((ret = dib0700_jumpram(udev, 0x70000000)) == 0) {
b7f54910	197	info("firmware started successfully.");
6958effe PB	198	msleep(100);
6958effe PB	199	}
b7f54910 PB	200	} else
	201	ret = -EIO;
	202
	203	return ret;
	204	}
	205
	206	int dib0700_streaming_ctrl(struct dvb_usb_adapter *adap, int onoff)
	207	{
	208	struct dib0700_state *st = adap->dev->priv;
	209	u8 b[4];
	210
	211	b[0] = REQUEST_ENABLE_VIDEO;
	212	b[1] = 0x00;
	213	b[2] = (0x01 << 4); /* Master mode */
	214	b[3] = 0x00;
	215
	216	deb_info("modifying (%d) streaming state for %d\n", onoff, adap->id);
	217
	218	if (onoff)
	219	st->channel_state \|= 1 << adap->id;
	220	else
	221	st->channel_state &= ~(1 << adap->id);
	222
	223	b[2] \|= st->channel_state;
	224
	225	if (st->channel_state) /* if at least one channel is active */
	226	b[1] = (0x01 << 4) \| 0x00;
	227
	228	deb_info("data for streaming: %x %x\n",b[1],b[2]);
	229
	230	return dib0700_ctrl_wr(adap->dev, b, 4);
	231	}
	232
	233	static int dib0700_probe(struct usb_interface *intf,
	234	const struct usb_device_id *id)
	235	{
	236	int i;
	237
	238	for (i = 0; i < dib0700_device_count; i++)
	239	if (dvb_usb_device_init(intf, &dib0700_devices[i], THIS_MODULE, NULL) == 0)
	240	return 0;
	241
	242	return -ENODEV;
	243	}
	244
	245	static struct usb_driver dib0700_driver = {
	246	.name = "dvb_usb_dib0700",
	247	.probe = dib0700_probe,
	248	.disconnect = dvb_usb_device_exit,
	249	.id_table = dib0700_usb_id_table,
	250	};
	251
	252	/* module stuff */
	253	static int __init dib0700_module_init(void)
	254	{
	255	int result;
	256	info("loaded with support for %d different device-types", dib0700_device_count);
	257	if ((result = usb_register(&dib0700_driver))) {
	258	err("usb_register failed. Error number %d",result);
	259	return result;
	260	}
	261
	262	return 0;
	263	}
264
265	static void __exit dib0700_module_exit(void)
266	{
267	/* deregister this driver from the USB subsystem */
268	usb_deregister(&dib0700_driver);
269	}
270
271	module_init (dib0700_module_init);
272	module_exit (dib0700_module_exit);
273
274	MODULE_AUTHOR("Patrick Boettcher <pboettcher@dibcom.fr>");
275	MODULE_DESCRIPTION("Driver for devices based on DiBcom DiB0700 - USB bridge");
276	MODULE_VERSION("1.0");
277	MODULE_LICENSE("GPL");