[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);

int dvb_usb_dib0700_ir_proto = 1;
module_param(dvb_usb_dib0700_ir_proto, int, 0644);
MODULE_PARM_DESC(dvb_usb_dib0700_ir_proto, "set ir protocol (0=NEC, 1=RC5 (default), 2=RC6).");

static int nb_packet_buffer_size = 21;
module_param(nb_packet_buffer_size, int, 0644);
MODULE_PARM_DESC(nb_packet_buffer_size,
	"Set the dib0700 driver data buffer size. This parameter "
	"corresponds to the number of TS packets. The actual size of "
	"the data buffer corresponds to this parameter "
	"multiplied by 188 (default: 21)");

DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);


int dib0700_get_version(struct dvb_usb_device *d, u32 *hwversion,
			u32 *romversion, u32 *ramversion, u32 *fwtype)
{
	u8 b[16];
	int ret = usb_control_msg(d->udev, usb_rcvctrlpipe(d->udev, 0),
				  REQUEST_GET_VERSION,
				  USB_TYPE_VENDOR | USB_DIR_IN, 0, 0,
				  b, sizeof(b), USB_CTRL_GET_TIMEOUT);
	if (hwversion != NULL)
		*hwversion  = (b[0] << 24)  | (b[1] << 16)  | (b[2] << 8)  | b[3];
	if (romversion != NULL)
		*romversion = (b[4] << 24)  | (b[5] << 16)  | (b[6] << 8)  | b[7];
	if (ramversion != NULL)
		*ramversion = (b[8] << 24)  | (b[9] << 16)  | (b[10] << 8) | b[11];
	if (fwtype != NULL)
		*fwtype     = (b[12] << 24) | (b[13] << 16) | (b[14] << 8) | b[15];
	return ret;
}

/* 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) */
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];

	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);
}

static int dib0700_set_usb_xfer_len(struct dvb_usb_device *d, u16 nb_ts_packets)
{
    struct dib0700_state *st = d->priv;
    u8 b[3];
    int ret;

    if (st->fw_version >= 0x10201) {
	b[0] = REQUEST_SET_USB_XFER_LEN;
	b[1] = (nb_ts_packets >> 8)&0xff;
	b[2] = nb_ts_packets & 0xff;

	deb_info("set the USB xfer len to %i Ts packet\n", nb_ts_packets);

	ret = dib0700_ctrl_wr(d, b, 3);
    } else {
	deb_info("this firmware does not allow to change the USB xfer len\n");
	ret = -EIO;
    }
    return ret;
}

/*
 * I2C master xfer function (supported in 1.20 firmware)
 */
static int dib0700_i2c_xfer_new(struct i2c_adapter *adap, struct i2c_msg *msg,
				int num)
{
	/* The new i2c firmware messages are more reliable and in particular
	   properly support i2c read calls not preceded by a write */

	struct dvb_usb_device *d = i2c_get_adapdata(adap);
	uint8_t bus_mode = 1;  /* 0=eeprom bus, 1=frontend bus */
	uint8_t gen_mode = 0; /* 0=master i2c, 1=gpio i2c */
	uint8_t en_start = 0;
	uint8_t en_stop = 0;
	uint8_t buf[255]; /* TBV: malloc ? */
	int result, i;

	/* Ensure nobody else hits the i2c bus while we're sending our
	   sequence of messages, (such as the remote control thread) */
	if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
		return -EAGAIN;

	for (i = 0; i < num; i++) {
		if (i == 0) {
			/* First message in the transaction */
			en_start = 1;
		} else if (!(msg[i].flags & I2C_M_NOSTART)) {
			/* Device supports repeated-start */
			en_start = 1;
		} else {
			/* Not the first packet and device doesn't support
			   repeated start */
			en_start = 0;
		}
		if (i == (num - 1)) {
			/* Last message in the transaction */
			en_stop = 1;
		}

		if (msg[i].flags & I2C_M_RD) {
			/* Read request */
			u16 index, value;
			uint8_t i2c_dest;

			i2c_dest = (msg[i].addr << 1);
			value = ((en_start << 7) | (en_stop << 6) |
				 (msg[i].len & 0x3F)) << 8 | i2c_dest;
			/* I2C ctrl + FE bus; */
			index = ((gen_mode<<6)&0xC0) | ((bus_mode<<4)&0x30);

			result = usb_control_msg(d->udev,
						 usb_rcvctrlpipe(d->udev, 0),
						 REQUEST_NEW_I2C_READ,
						 USB_TYPE_VENDOR | USB_DIR_IN,
						 value, index, msg[i].buf,
						 msg[i].len,
						 USB_CTRL_GET_TIMEOUT);
			if (result < 0) {
				err("i2c read error (status = %d)\n", result);
				break;
			}

			deb_data("<<< ");
			debug_dump(msg[i].buf, msg[i].len, deb_data);

		} else {
			/* Write request */
			buf[0] = REQUEST_NEW_I2C_WRITE;
			buf[1] = (msg[i].addr << 1);
			buf[2] = (en_start << 7) | (en_stop << 6) |
				(msg[i].len & 0x3F);
			/* I2C ctrl + FE bus; */
			buf[3] = ((gen_mode<<6)&0xC0) | ((bus_mode<<4)&0x30);
			/* The Actual i2c payload */
			memcpy(&buf[4], msg[i].buf, msg[i].len);

			deb_data(">>> ");
			debug_dump(buf, msg[i].len + 4, deb_data);

			result = usb_control_msg(d->udev,
						 usb_sndctrlpipe(d->udev, 0),
						 REQUEST_NEW_I2C_WRITE,
						 USB_TYPE_VENDOR | USB_DIR_OUT,
						 0, 0, buf, msg[i].len + 4,
						 USB_CTRL_GET_TIMEOUT);
			if (result < 0) {
				err("i2c write error (status = %d)\n", result);
				break;
			}
		}
	}
	mutex_unlock(&d->i2c_mutex);
	return i;
}

/*
 * I2C master xfer function (pre-1.20 firmware)
 */
static int dib0700_i2c_xfer_legacy(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) {
				deb_info("I2C read failed on address 0x%02x\n",
					 msg[i].addr);
				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 int dib0700_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msg,
			    int num)
{
	struct dvb_usb_device *d = i2c_get_adapdata(adap);
	struct dib0700_state *st = d->priv;

	if (st->fw_use_new_i2c_api == 1) {
		/* User running at least fw 1.20 */
		return dib0700_i2c_xfer_new(adap, msg, num);
	} else {
		/* Use legacy calls */
		return dib0700_i2c_xfer_legacy(adap, msg, num);
	}
}

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 b[16];
	s16 ret = usb_control_msg(udev, usb_rcvctrlpipe(udev,0),
		REQUEST_GET_VERSION, USB_TYPE_VENDOR | USB_DIR_IN, 0, 0, b, 16, USB_CTRL_GET_TIMEOUT);

	deb_info("FW GET_VERSION length: %d\n",ret);

	*cold = ret <= 0;

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

static int dib0700_set_clock(struct dvb_usb_device *d, u8 en_pll,
	u8 pll_src, u8 pll_range, u8 clock_gpio3, u16 pll_prediv,
	u16 pll_loopdiv, u16 free_div, u16 dsuScaler)
{
	u8 b[10];
	b[0] = REQUEST_SET_CLOCK;
	b[1] = (en_pll << 7) | (pll_src << 6) | (pll_range << 5) | (clock_gpio3 << 4);
	b[2] = (pll_prediv >> 8)  & 0xff; // MSB
	b[3] =  pll_prediv        & 0xff; // LSB
	b[4] = (pll_loopdiv >> 8) & 0xff; // MSB
	b[5] =  pll_loopdiv       & 0xff; // LSB
	b[6] = (free_div >> 8)    & 0xff; // MSB
	b[7] =  free_div          & 0xff; // LSB
	b[8] = (dsuScaler >> 8)   & 0xff; // MSB
	b[9] =  dsuScaler         & 0xff; // LSB

	return dib0700_ctrl_wr(d, b, 10);
}

int dib0700_ctrl_clock(struct dvb_usb_device *d, u32 clk_MHz, u8 clock_out_gp3)
{
	switch (clk_MHz) {
		case 72: dib0700_set_clock(d, 1, 0, 1, clock_out_gp3, 2, 24, 0, 0x4c); break;
		default: return -EINVAL;
	}
	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, i, adap_num;
	u8 b[16];
	u32 fw_version;

	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(500);
		}
	} else
		ret = -EIO;

	/* the number of ts packet has to be at least 1 */
	if (nb_packet_buffer_size < 1)
		nb_packet_buffer_size = 1;

	/* get the fimware version */
	usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
				  REQUEST_GET_VERSION,
				  USB_TYPE_VENDOR | USB_DIR_IN, 0, 0,
				  b, sizeof(b), USB_CTRL_GET_TIMEOUT);
	fw_version = (b[8] << 24)  | (b[9] << 16)  | (b[10] << 8) | b[11];

	/* set the buffer size - DVB-USB is allocating URB buffers
	 * only after the firwmare download was successful */
	for (i = 0; i < dib0700_device_count; i++) {
		for (adap_num = 0; adap_num < dib0700_devices[i].num_adapters;
				adap_num++) {
			if (fw_version >= 0x10201)
				dib0700_devices[i].adapter[adap_num].stream.u.bulk.buffersize = 188*nb_packet_buffer_size;
			else {
				/* for fw version older than 1.20.1,
				 * the buffersize has to be n times 512 */
				dib0700_devices[i].adapter[adap_num].stream.u.bulk.buffersize = ((188*nb_packet_buffer_size+188/2)/512)*512;
				if (dib0700_devices[i].adapter[adap_num].stream.u.bulk.buffersize < 512)
					dib0700_devices[i].adapter[adap_num].stream.u.bulk.buffersize = 512;
			}
		}
	}

	return ret;
}

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

	if ((onoff != 0) && (st->fw_version >= 0x10201)) {
		/* for firmware later than 1.20.1,
		 * the USB xfer length can be set  */
		ret = dib0700_set_usb_xfer_len(adap->dev,
			st->nb_packet_buffer_size);
		if (ret < 0) {
			deb_info("can not set the USB xfer len\n");
			return ret;
		}
	}

	b[0] = REQUEST_ENABLE_VIDEO;
	b[1] = (onoff << 4) | 0x00; /* this bit gives a kind of command, rather than enabling something or not */

	if (st->disable_streaming_master_mode == 1)
		b[2] = 0x00;
	else
		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;

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

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

int dib0700_rc_setup(struct dvb_usb_device *d)
{
	u8 rc_setup[3] = {REQUEST_SET_RC, dvb_usb_dib0700_ir_proto, 0};
	int i = dib0700_ctrl_wr(d, rc_setup, 3);
	if (i<0) {
		err("ir protocol setup failed");
		return -1;
	}
	return 0;
}

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

	for (i = 0; i < dib0700_device_count; i++)
		if (dvb_usb_device_init(intf, &dib0700_devices[i], THIS_MODULE,
		    &dev, adapter_nr) == 0) {
			struct dib0700_state *st = dev->priv;
			u32 hwversion, romversion, fw_version, fwtype;

			dib0700_get_version(dev, &hwversion, &romversion,
				&fw_version, &fwtype);

			deb_info("Firmware version: %x, %d, 0x%x, %d\n",
				hwversion, romversion, fw_version, fwtype);

			st->fw_version = fw_version;
			st->nb_packet_buffer_size = (u32)nb_packet_buffer_size;

			dib0700_rc_setup(dev);

			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
58e6f95e	16	int dvb_usb_dib0700_ir_proto = 1;
89f4267d JG	17	module_param(dvb_usb_dib0700_ir_proto, int, 0644);
	18	MODULE_PARM_DESC(dvb_usb_dib0700_ir_proto, "set ir protocol (0=NEC, 1=RC5 (default), 2=RC6).");
	19
acc5c9ee OG	20	static int nb_packet_buffer_size = 21;
	21	module_param(nb_packet_buffer_size, int, 0644);
	22	MODULE_PARM_DESC(nb_packet_buffer_size,
	23	"Set the dib0700 driver data buffer size. This parameter "
	24	"corresponds to the number of TS packets. The actual size of "
	25	"the data buffer corresponds to this parameter "
	26	"multiplied by 188 (default: 21)");
	27
78e92006 JG	28	DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
78e92006 JG	29
99afb989 DH	30
	31	int dib0700_get_version(struct dvb_usb_device d, u32 hwversion,
	32	u32 romversion, u32 ramversion, u32 *fwtype)
	33	{
	34	u8 b[16];
	35	int ret = usb_control_msg(d->udev, usb_rcvctrlpipe(d->udev, 0),
	36	REQUEST_GET_VERSION,
	37	USB_TYPE_VENDOR \| USB_DIR_IN, 0, 0,
	38	b, sizeof(b), USB_CTRL_GET_TIMEOUT);
acc5c9ee OG	39	if (hwversion != NULL)
	40	*hwversion = (b[0] << 24) \| (b[1] << 16) \| (b[2] << 8) \| b[3];
	41	if (romversion != NULL)
	42	*romversion = (b[4] << 24) \| (b[5] << 16) \| (b[6] << 8) \| b[7];
	43	if (ramversion != NULL)
	44	*ramversion = (b[8] << 24) \| (b[9] << 16) \| (b[10] << 8) \| b[11];
	45	if (fwtype != NULL)
	46	*fwtype = (b[12] << 24) \| (b[13] << 16) \| (b[14] << 8) \| b[15];
99afb989 DH	47	return ret;
	48	}
	49
b7f54910 PB	50	/* expecting rx buffer: request data[0] data[1] ... data[2] */
	51	static int dib0700_ctrl_wr(struct dvb_usb_device d, u8 tx, u8 txlen)
	52	{
	53	int status;
	54
	55	deb_data(">>> ");
	56	debug_dump(tx,txlen,deb_data);
	57
	58	status = usb_control_msg(d->udev, usb_sndctrlpipe(d->udev,0),
	59	tx[0], USB_TYPE_VENDOR \| USB_DIR_OUT, 0, 0, tx, txlen,
	60	USB_CTRL_GET_TIMEOUT);
	61
	62	if (status != txlen)
6958effe	63	deb_data("ep 0 write error (status = %d, len: %d)\n",status,txlen);
b7f54910 PB	64
	65	return status < 0 ? status : 0;
	66	}
	67
	68	/* expecting tx buffer: request data[0] ... data[n] (n <= 4) */
54d75eba	69	int dib0700_ctrl_rd(struct dvb_usb_device d, u8 tx, u8 txlen, u8 *rx, u8 rxlen)
b7f54910 PB	70	{
	71	u16 index, value;
	72	int status;
	73
	74	if (txlen < 2) {
	75	err("tx buffer length is smaller than 2. Makes no sense.");
	76	return -EINVAL;
	77	}
	78	if (txlen > 4) {
	79	err("tx buffer length is larger than 4. Not supported.");
	80	return -EINVAL;
	81	}
	82
	83	deb_data(">>> ");
	84	debug_dump(tx,txlen,deb_data);
	85
	86	value = ((txlen - 2) << 8) \| tx[1];
	87	index = 0;
	88	if (txlen > 2)
	89	index \|= (tx[2] << 8);
	90	if (txlen > 3)
	91	index \|= tx[3];
	92
b7f54910 PB	93	status = usb_control_msg(d->udev, usb_rcvctrlpipe(d->udev,0), tx[0],
	94	USB_TYPE_VENDOR \| USB_DIR_IN, value, index, rx, rxlen,
	95	USB_CTRL_GET_TIMEOUT);
	96
	97	if (status < 0)
6958effe	98	deb_info("ep 0 read error (status = %d)\n",status);
b7f54910 PB	99
	100	deb_data("<<< ");
	101	debug_dump(rx,rxlen,deb_data);
	102
	103	return status; /* length in case of success */
	104	}
	105
	106	int dib0700_set_gpio(struct dvb_usb_device *d, enum dib07x0_gpios gpio, u8 gpio_dir, u8 gpio_val)
	107	{
	108	u8 buf[3] = { REQUEST_SET_GPIO, gpio, ((gpio_dir & 0x01) << 7) \| ((gpio_val & 0x01) << 6) };
	109	return dib0700_ctrl_wr(d,buf,3);
	110	}
	111
acc5c9ee OG	112	static int dib0700_set_usb_xfer_len(struct dvb_usb_device *d, u16 nb_ts_packets)
	113	{
	114	struct dib0700_state *st = d->priv;
	115	u8 b[3];
	116	int ret;
	117
	118	if (st->fw_version >= 0x10201) {
	119	b[0] = REQUEST_SET_USB_XFER_LEN;
	120	b[1] = (nb_ts_packets >> 8)&0xff;
	121	b[2] = nb_ts_packets & 0xff;
	122
	123	deb_info("set the USB xfer len to %i Ts packet\n", nb_ts_packets);
	124
	125	ret = dib0700_ctrl_wr(d, b, 3);
	126	} else {
	127	deb_info("this firmware does not allow to change the USB xfer len\n");
	128	ret = -EIO;
	129	}
	130	return ret;
	131	}
	132
b7f54910	133	/*
bdc203e1	134	* I2C master xfer function (supported in 1.20 firmware)
b7f54910	135	*/
bdc203e1 DH	136	static int dib0700_i2c_xfer_new(struct i2c_adapter adap, struct i2c_msg msg,
	137	int num)
	138	{
	139	/* The new i2c firmware messages are more reliable and in particular
	140	properly support i2c read calls not preceded by a write */
	141
	142	struct dvb_usb_device *d = i2c_get_adapdata(adap);
	143	uint8_t bus_mode = 1; /* 0=eeprom bus, 1=frontend bus */
	144	uint8_t gen_mode = 0; /* 0=master i2c, 1=gpio i2c */
	145	uint8_t en_start = 0;
	146	uint8_t en_stop = 0;
	147	uint8_t buf[255]; /* TBV: malloc ? */
	148	int result, i;
	149
	150	/* Ensure nobody else hits the i2c bus while we're sending our
	151	sequence of messages, (such as the remote control thread) */
	152	if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
	153	return -EAGAIN;
	154
	155	for (i = 0; i < num; i++) {
	156	if (i == 0) {
	157	/* First message in the transaction */
	158	en_start = 1;
	159	} else if (!(msg[i].flags & I2C_M_NOSTART)) {
	160	/* Device supports repeated-start */
	161	en_start = 1;
	162	} else {
	163	/* Not the first packet and device doesn't support
	164	repeated start */
	165	en_start = 0;
	166	}
	167	if (i == (num - 1)) {
	168	/* Last message in the transaction */
	169	en_stop = 1;
	170	}
	171
	172	if (msg[i].flags & I2C_M_RD) {
	173	/* Read request */
	174	u16 index, value;
	175	uint8_t i2c_dest;
	176
	177	i2c_dest = (msg[i].addr << 1);
	178	value = ((en_start << 7) \| (en_stop << 6) \|
	179	(msg[i].len & 0x3F)) << 8 \| i2c_dest;
	180	/* I2C ctrl + FE bus; */
	181	index = ((gen_mode<<6)&0xC0) \| ((bus_mode<<4)&0x30);
	182
	183	result = usb_control_msg(d->udev,
	184	usb_rcvctrlpipe(d->udev, 0),
	185	REQUEST_NEW_I2C_READ,
	186	USB_TYPE_VENDOR \| USB_DIR_IN,
	187	value, index, msg[i].buf,
	188	msg[i].len,
	189	USB_CTRL_GET_TIMEOUT);
	190	if (result < 0) {
	191	err("i2c read error (status = %d)\n", result);
	192	break;
	193	}
d2514991 MK	194
	195	deb_data("<<< ");
	196	debug_dump(msg[i].buf, msg[i].len, deb_data);
	197
bdc203e1 DH	198	} else {
	199	/* Write request */
	200	buf[0] = REQUEST_NEW_I2C_WRITE;
	201	buf[1] = (msg[i].addr << 1);
	202	buf[2] = (en_start << 7) \| (en_stop << 6) \|
	203	(msg[i].len & 0x3F);
	204	/* I2C ctrl + FE bus; */
	205	buf[3] = ((gen_mode<<6)&0xC0) \| ((bus_mode<<4)&0x30);
	206	/* The Actual i2c payload */
	207	memcpy(&buf[4], msg[i].buf, msg[i].len);
	208
d2514991 MK	209	deb_data(">>> ");
	210	debug_dump(buf, msg[i].len + 4, deb_data);
	211
bdc203e1 DH	212	result = usb_control_msg(d->udev,
	213	usb_sndctrlpipe(d->udev, 0),
	214	REQUEST_NEW_I2C_WRITE,
	215	USB_TYPE_VENDOR \| USB_DIR_OUT,
	216	0, 0, buf, msg[i].len + 4,
	217	USB_CTRL_GET_TIMEOUT);
	218	if (result < 0) {
	219	err("i2c write error (status = %d)\n", result);
	220	break;
	221	}
	222	}
	223	}
	224	mutex_unlock(&d->i2c_mutex);
	225	return i;
	226	}
	227
	228	/*
	229	* I2C master xfer function (pre-1.20 firmware)
	230	*/
	231	static int dib0700_i2c_xfer_legacy(struct i2c_adapter *adap,
	232	struct i2c_msg *msg, int num)
b7f54910 PB	233	{
	234	struct dvb_usb_device *d = i2c_get_adapdata(adap);
	235	int i,len;
	236	u8 buf[255];
	237
	238	if (mutex_lock_interruptible(&d->i2c_mutex) < 0)
	239	return -EAGAIN;
	240
	241	for (i = 0; i < num; i++) {
	242	/* fill in the address */
	243	buf[1] = (msg[i].addr << 1);
	244	/* fill the buffer */
	245	memcpy(&buf[2], msg[i].buf, msg[i].len);
	246
	247	/* write/read request */
	248	if (i+1 < num && (msg[i+1].flags & I2C_M_RD)) {
	249	buf[0] = REQUEST_I2C_READ;
	250	buf[1] \|= 1;
	251
	252	/* special thing in the current firmware: when length is zero the read-failed */
303cbeaa	253	if ((len = dib0700_ctrl_rd(d, buf, msg[i].len + 2, msg[i+1].buf, msg[i+1].len)) <= 0) {
8db12cdf DH	254	deb_info("I2C read failed on address 0x%02x\n",
8db12cdf DH	255	msg[i].addr);
b7f54910	256	break;
303cbeaa	257	}
b7f54910 PB	258
	259	msg[i+1].len = len;
	260
	261	i++;
	262	} else {
	263	buf[0] = REQUEST_I2C_WRITE;
	264	if (dib0700_ctrl_wr(d, buf, msg[i].len + 2) < 0)
	265	break;
	266	}
	267	}
	268
	269	mutex_unlock(&d->i2c_mutex);
	270	return i;
	271	}
	272
bdc203e1 DH	273	static int dib0700_i2c_xfer(struct i2c_adapter adap, struct i2c_msg msg,
	274	int num)
	275	{
	276	struct dvb_usb_device *d = i2c_get_adapdata(adap);
	277	struct dib0700_state *st = d->priv;
	278
	279	if (st->fw_use_new_i2c_api == 1) {
	280	/* User running at least fw 1.20 */
	281	return dib0700_i2c_xfer_new(adap, msg, num);
	282	} else {
	283	/* Use legacy calls */
	284	return dib0700_i2c_xfer_legacy(adap, msg, num);
	285	}
	286	}
	287
b7f54910 PB	288	static u32 dib0700_i2c_func(struct i2c_adapter *adapter)
	289	{
	290	return I2C_FUNC_I2C;
	291	}
	292
	293	struct i2c_algorithm dib0700_i2c_algo = {
	294	.master_xfer = dib0700_i2c_xfer,
	295	.functionality = dib0700_i2c_func,
	296	};
	297
6958effe PB	298	int dib0700_identify_state(struct usb_device udev, struct dvb_usb_device_properties props,
	299	struct dvb_usb_device_description *desc, int cold)
	300	{
a75763ff PB	301	u8 b[16];
	302	s16 ret = usb_control_msg(udev, usb_rcvctrlpipe(udev,0),
	303	REQUEST_GET_VERSION, USB_TYPE_VENDOR \| USB_DIR_IN, 0, 0, b, 16, USB_CTRL_GET_TIMEOUT);
	304
	305	deb_info("FW GET_VERSION length: %d\n",ret);
	306
	307	*cold = ret <= 0;
6958effe PB	308
6958effe PB	309	deb_info("cold: %d\n", *cold);
6958effe PB	310	return 0;
	311	}
	312
a75763ff PB	313	static int dib0700_set_clock(struct dvb_usb_device *d, u8 en_pll,
	314	u8 pll_src, u8 pll_range, u8 clock_gpio3, u16 pll_prediv,
	315	u16 pll_loopdiv, u16 free_div, u16 dsuScaler)
	316	{
	317	u8 b[10];
	318	b[0] = REQUEST_SET_CLOCK;
	319	b[1] = (en_pll << 7) \| (pll_src << 6) \| (pll_range << 5) \| (clock_gpio3 << 4);
	320	b[2] = (pll_prediv >> 8) & 0xff; // MSB
	321	b[3] = pll_prediv & 0xff; // LSB
	322	b[4] = (pll_loopdiv >> 8) & 0xff; // MSB
	323	b[5] = pll_loopdiv & 0xff; // LSB
	324	b[6] = (free_div >> 8) & 0xff; // MSB
	325	b[7] = free_div & 0xff; // LSB
	326	b[8] = (dsuScaler >> 8) & 0xff; // MSB
	327	b[9] = dsuScaler & 0xff; // LSB
	328
	329	return dib0700_ctrl_wr(d, b, 10);
	330	}
	331
	332	int dib0700_ctrl_clock(struct dvb_usb_device *d, u32 clk_MHz, u8 clock_out_gp3)
	333	{
	334	switch (clk_MHz) {
	335	case 72: dib0700_set_clock(d, 1, 0, 1, clock_out_gp3, 2, 24, 0, 0x4c); break;
	336	default: return -EINVAL;
	337	}
	338	return 0;
	339	}
	340
b7f54910 PB	341	static int dib0700_jumpram(struct usb_device *udev, u32 address)
	342	{
	343	int ret, actlen;
	344	u8 buf[8] = { REQUEST_JUMPRAM, 0, 0, 0,
	345	(address >> 24) & 0xff,
	346	(address >> 16) & 0xff,
	347	(address >> 8) & 0xff,
	348	address & 0xff };
	349
	350	if ((ret = usb_bulk_msg(udev, usb_sndbulkpipe(udev, 0x01),buf,8,&actlen,1000)) < 0) {
	351	deb_fw("jumpram to 0x%x failed\n",address);
	352	return ret;
	353	}
	354	if (actlen != 8) {
	355	deb_fw("jumpram to 0x%x failed\n",address);
	356	return -EIO;
	357	}
	358	return 0;
	359	}
	360
	361	int dib0700_download_firmware(struct usb_device udev, const struct firmware fw)
	362	{
	363	struct hexline hx;
acc5c9ee OG	364	int pos = 0, ret, act_len, i, adap_num;
	365	u8 b[16];
	366	u32 fw_version;
b7f54910 PB	367
	368	u8 buf[260];
	369
	370	while ((ret = dvb_usb_get_hexline(fw, &hx, &pos)) > 0) {
5bc63607	371	deb_fwdata("writing to address 0x%08x (buffer: 0x%02x %02x)\n",hx.addr, hx.len, hx.chk);
b7f54910 PB	372
b7f54910 PB	373	buf[0] = hx.len;
5bc63607 PB	374	buf[1] = (hx.addr >> 8) & 0xff;
5bc63607 PB	375	buf[2] = hx.addr & 0xff;
b7f54910 PB	376	buf[3] = hx.type;
	377	memcpy(&buf[4],hx.data,hx.len);
	378	buf[4+hx.len] = hx.chk;
	379
	380	ret = usb_bulk_msg(udev,
	381	usb_sndbulkpipe(udev, 0x01),
	382	buf,
	383	hx.len + 5,
	384	&act_len,
	385	1000);
	386
	387	if (ret < 0) {
	388	err("firmware download failed at %d with %d",pos,ret);
	389	return ret;
	390	}
	391	}
	392
	393	if (ret == 0) {
	394	/* start the firmware */
6958effe	395	if ((ret = dib0700_jumpram(udev, 0x70000000)) == 0) {
b7f54910	396	info("firmware started successfully.");
a75763ff	397	msleep(500);
6958effe	398	}
b7f54910 PB	399	} else
	400	ret = -EIO;
	401
acc5c9ee OG	402	/* the number of ts packet has to be at least 1 */
	403	if (nb_packet_buffer_size < 1)
	404	nb_packet_buffer_size = 1;
	405
	406	/* get the fimware version */
	407	usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
	408	REQUEST_GET_VERSION,
	409	USB_TYPE_VENDOR \| USB_DIR_IN, 0, 0,
	410	b, sizeof(b), USB_CTRL_GET_TIMEOUT);
	411	fw_version = (b[8] << 24) \| (b[9] << 16) \| (b[10] << 8) \| b[11];
	412
	413	/* set the buffer size - DVB-USB is allocating URB buffers
	414	* only after the firwmare download was successful */
	415	for (i = 0; i < dib0700_device_count; i++) {
	416	for (adap_num = 0; adap_num < dib0700_devices[i].num_adapters;
	417	adap_num++) {
	418	if (fw_version >= 0x10201)
	419	dib0700_devices[i].adapter[adap_num].stream.u.bulk.buffersize = 188*nb_packet_buffer_size;
	420	else {
	421	/* for fw version older than 1.20.1,
	422	* the buffersize has to be n times 512 */
	423	dib0700_devices[i].adapter[adap_num].stream.u.bulk.buffersize = ((188nb_packet_buffer_size+188/2)/512)512;
	424	if (dib0700_devices[i].adapter[adap_num].stream.u.bulk.buffersize < 512)
	425	dib0700_devices[i].adapter[adap_num].stream.u.bulk.buffersize = 512;
	426	}
	427	}
	428	}
	429
b7f54910 PB	430	return ret;
	431	}
	432
	433	int dib0700_streaming_ctrl(struct dvb_usb_adapter *adap, int onoff)
	434	{
	435	struct dib0700_state *st = adap->dev->priv;
	436	u8 b[4];
acc5c9ee OG	437	int ret;
	438
	439	if ((onoff != 0) && (st->fw_version >= 0x10201)) {
	440	/* for firmware later than 1.20.1,
	441	* the USB xfer length can be set */
	442	ret = dib0700_set_usb_xfer_len(adap->dev,
	443	st->nb_packet_buffer_size);
	444	if (ret < 0) {
	445	deb_info("can not set the USB xfer len\n");
	446	return ret;
	447	}
	448	}
b7f54910 PB	449
b7f54910 PB	450	b[0] = REQUEST_ENABLE_VIDEO;
a162abb0	451	b[1] = (onoff << 4) \| 0x00; /* this bit gives a kind of command, rather than enabling something or not */
cb22cb52 DH	452
	453	if (st->disable_streaming_master_mode == 1)
	454	b[2] = 0x00;
	455	else
	456	b[2] = (0x01 << 4); /* Master mode */
	457
b7f54910 PB	458	b[3] = 0x00;
	459
	460	deb_info("modifying (%d) streaming state for %d\n", onoff, adap->id);
	461
	462	if (onoff)
	463	st->channel_state \|= 1 << adap->id;
	464	else
	465	st->channel_state &= ~(1 << adap->id);
	466
	467	b[2] \|= st->channel_state;
	468
b7f54910 PB	469	deb_info("data for streaming: %x %x\n",b[1],b[2]);
	470
	471	return dib0700_ctrl_wr(adap->dev, b, 4);
	472	}
	473
58e6f95e	474	int dib0700_rc_setup(struct dvb_usb_device *d)
89f4267d JG	475	{
	476	u8 rc_setup[3] = {REQUEST_SET_RC, dvb_usb_dib0700_ir_proto, 0};
	477	int i = dib0700_ctrl_wr(d, rc_setup, 3);
	478	if (i<0) {
	479	err("ir protocol setup failed");
	480	return -1;
	481	}
	482	return 0;
	483	}
	484
b7f54910 PB	485	static int dib0700_probe(struct usb_interface *intf,
	486	const struct usb_device_id *id)
	487	{
	488	int i;
89f4267d	489	struct dvb_usb_device *dev;
b7f54910 PB	490
b7f54910 PB	491	for (i = 0; i < dib0700_device_count; i++)
78e92006	492	if (dvb_usb_device_init(intf, &dib0700_devices[i], THIS_MODULE,
acc5c9ee OG	493	&dev, adapter_nr) == 0) {
	494	struct dib0700_state *st = dev->priv;
	495	u32 hwversion, romversion, fw_version, fwtype;
	496
	497	dib0700_get_version(dev, &hwversion, &romversion,
	498	&fw_version, &fwtype);
	499
	500	deb_info("Firmware version: %x, %d, 0x%x, %d\n",
	501	hwversion, romversion, fw_version, fwtype);
	502
	503	st->fw_version = fw_version;
	504	st->nb_packet_buffer_size = (u32)nb_packet_buffer_size;
	505
89f4267d	506	dib0700_rc_setup(dev);
acc5c9ee	507
b7f54910	508	return 0;
89f4267d	509	}
b7f54910 PB	510
	511	return -ENODEV;
	512	}
	513
	514	static struct usb_driver dib0700_driver = {
	515	.name = "dvb_usb_dib0700",
	516	.probe = dib0700_probe,
	517	.disconnect = dvb_usb_device_exit,
	518	.id_table = dib0700_usb_id_table,
	519	};
	520
	521	/* module stuff */
	522	static int __init dib0700_module_init(void)
	523	{
	524	int result;
	525	info("loaded with support for %d different device-types", dib0700_device_count);
	526	if ((result = usb_register(&dib0700_driver))) {
	527	err("usb_register failed. Error number %d",result);
	528	return result;
	529	}
	530
	531	return 0;
	532	}
	533
	534	static void __exit dib0700_module_exit(void)
	535	{
	536	/* deregister this driver from the USB subsystem */
	537	usb_deregister(&dib0700_driver);
	538	}
	539
	540	module_init (dib0700_module_init);
	541	module_exit (dib0700_module_exit);
	542
	543	MODULE_AUTHOR("Patrick Boettcher <pboettcher@dibcom.fr>");
	544	MODULE_DESCRIPTION("Driver for devices based on DiBcom DiB0700 - USB bridge");
	545	MODULE_VERSION("1.0");
	546	MODULE_LICENSE("GPL");