[net-next-2.6.git] / drivers / media / dvb / frontends / dibx000_common.c

#include <linux/i2c.h>

#include "dibx000_common.h"

static int debug;
module_param(debug, int, 0644);
MODULE_PARM_DESC(debug, "turn on debugging (default: 0)");

#define dprintk(args...) do { if (debug) { printk(KERN_DEBUG "DiBX000: "); printk(args); printk("\n"); } } while (0)

static int dibx000_write_word(struct dibx000_i2c_master *mst, u16 reg, u16 val)
{
	u8 b[4] = {
		(reg >> 8) & 0xff, reg & 0xff,
		(val >> 8) & 0xff, val & 0xff,
	};
	struct i2c_msg msg = {
		.addr = mst->i2c_addr,.flags = 0,.buf = b,.len = 4
	};
	return i2c_transfer(mst->i2c_adap, &msg, 1) != 1 ? -EREMOTEIO : 0;
}


static int dibx000_i2c_select_interface(struct dibx000_i2c_master *mst,
					enum dibx000_i2c_interface intf)
{
	if (mst->device_rev > DIB3000MC && mst->selected_interface != intf) {
		dprintk("selecting interface: %d", intf);
		mst->selected_interface = intf;
		return dibx000_write_word(mst, mst->base_reg + 4, intf);
	}
	return 0;
}

static int dibx000_i2c_gate_ctrl(struct dibx000_i2c_master *mst, u8 tx[4],
				 u8 addr, int onoff)
{
	u16 val;


	if (onoff)
		val = addr << 8;	// bit 7 = use master or not, if 0, the gate is open
	else
		val = 1 << 7;

	if (mst->device_rev > DIB7000)
		val <<= 1;

	tx[0] = (((mst->base_reg + 1) >> 8) & 0xff);
	tx[1] = ((mst->base_reg + 1) & 0xff);
	tx[2] = val >> 8;
	tx[3] = val & 0xff;

	return 0;
}

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

static int dibx000_i2c_gated_tuner_xfer(struct i2c_adapter *i2c_adap,
					struct i2c_msg msg[], int num)
{
	struct dibx000_i2c_master *mst = i2c_get_adapdata(i2c_adap);
	struct i2c_msg m[2 + num];
	u8 tx_open[4], tx_close[4];

	memset(m, 0, sizeof(struct i2c_msg) * (2 + num));

	dibx000_i2c_select_interface(mst, DIBX000_I2C_INTERFACE_TUNER);

	dibx000_i2c_gate_ctrl(mst, tx_open, msg[0].addr, 1);
	m[0].addr = mst->i2c_addr;
	m[0].buf = tx_open;
	m[0].len = 4;

	memcpy(&m[1], msg, sizeof(struct i2c_msg) * num);

	dibx000_i2c_gate_ctrl(mst, tx_close, 0, 0);
	m[num + 1].addr = mst->i2c_addr;
	m[num + 1].buf = tx_close;
	m[num + 1].len = 4;

	return i2c_transfer(mst->i2c_adap, m, 2 + num) == 2 + num ? num : -EIO;
}

static struct i2c_algorithm dibx000_i2c_gated_tuner_algo = {
	.master_xfer = dibx000_i2c_gated_tuner_xfer,
	.functionality = dibx000_i2c_func,
};

struct i2c_adapter *dibx000_get_i2c_adapter(struct dibx000_i2c_master *mst,
					    enum dibx000_i2c_interface intf,
					    int gating)
{
	struct i2c_adapter *i2c = NULL;

	switch (intf) {
	case DIBX000_I2C_INTERFACE_TUNER:
		if (gating)
			i2c = &mst->gated_tuner_i2c_adap;
		break;
	default:
		printk(KERN_ERR "DiBX000: incorrect I2C interface selected\n");
		break;
	}

	return i2c;
}

EXPORT_SYMBOL(dibx000_get_i2c_adapter);

void dibx000_reset_i2c_master(struct dibx000_i2c_master *mst)
{
	/* initialize the i2c-master by closing the gate */
	u8 tx[4];
	struct i2c_msg m = {.addr = mst->i2c_addr,.buf = tx,.len = 4 };

	dibx000_i2c_gate_ctrl(mst, tx, 0, 0);
	i2c_transfer(mst->i2c_adap, &m, 1);
	mst->selected_interface = 0xff;	// the first time force a select of the I2C
	dibx000_i2c_select_interface(mst, DIBX000_I2C_INTERFACE_TUNER);
}

EXPORT_SYMBOL(dibx000_reset_i2c_master);

static int i2c_adapter_init(struct i2c_adapter *i2c_adap,
			    struct i2c_algorithm *algo, const char *name,
			    struct dibx000_i2c_master *mst)
{
	strncpy(i2c_adap->name, name, sizeof(i2c_adap->name));
	i2c_adap->algo_data = NULL;
	i2c_set_adapdata(i2c_adap, mst);
	if (i2c_add_adapter(i2c_adap) < 0)
		return -ENODEV;
	return 0;
}

int dibx000_init_i2c_master(struct dibx000_i2c_master *mst, u16 device_rev,
			    struct i2c_adapter *i2c_adap, u8 i2c_addr)
{
	u8 tx[4];
	struct i2c_msg m = {.addr = i2c_addr >> 1,.buf = tx,.len = 4 };

	mst->device_rev = device_rev;
	mst->i2c_adap = i2c_adap;
	mst->i2c_addr = i2c_addr >> 1;

	if (device_rev == DIB7000P || device_rev == DIB8000)
		mst->base_reg = 1024;
	else
		mst->base_reg = 768;

	if (i2c_adapter_init
	    (&mst->gated_tuner_i2c_adap, &dibx000_i2c_gated_tuner_algo,
	     "DiBX000 tuner I2C bus", mst) != 0)
		printk(KERN_ERR
		       "DiBX000: could not initialize the tuner i2c_adapter\n");

	/* initialize the i2c-master by closing the gate */
	dibx000_i2c_gate_ctrl(mst, tx, 0, 0);

	return i2c_transfer(i2c_adap, &m, 1) == 1;
}

EXPORT_SYMBOL(dibx000_init_i2c_master);

void dibx000_exit_i2c_master(struct dibx000_i2c_master *mst)
{
	i2c_del_adapter(&mst->gated_tuner_i2c_adap);
}
EXPORT_SYMBOL(dibx000_exit_i2c_master);


u32 systime(void)
{
    struct timespec t;

    t = current_kernel_time();
    return (t.tv_sec * 10000) + (t.tv_nsec / 100000);
}
EXPORT_SYMBOL(systime);

MODULE_AUTHOR("Patrick Boettcher <pboettcher@dibcom.fr>");
MODULE_DESCRIPTION("Common function the DiBcom demodulator family");
MODULE_LICENSE("GPL");
Commit	Line	Data
42afd061 PB	1	#include <linux/i2c.h>
	2
	3	#include "dibx000_common.h"
	4
	5	static int debug;
	6	module_param(debug, int, 0644);
	7	MODULE_PARM_DESC(debug, "turn on debugging (default: 0)");
	8
03245a5e	9	#define dprintk(args...) do { if (debug) { printk(KERN_DEBUG "DiBX000: "); printk(args); printk("\n"); } } while (0)
42afd061 PB	10
	11	static int dibx000_write_word(struct dibx000_i2c_master *mst, u16 reg, u16 val)
	12	{
	13	u8 b[4] = {
	14	(reg >> 8) & 0xff, reg & 0xff,
	15	(val >> 8) & 0xff, val & 0xff,
	16	};
	17	struct i2c_msg msg = {
77e2c0f5	18	.addr = mst->i2c_addr,.flags = 0,.buf = b,.len = 4
42afd061 PB	19	};
	20	return i2c_transfer(mst->i2c_adap, &msg, 1) != 1 ? -EREMOTEIO : 0;
	21	}
	22
	23
77e2c0f5 PB	24	static int dibx000_i2c_select_interface(struct dibx000_i2c_master *mst,
77e2c0f5 PB	25	enum dibx000_i2c_interface intf)
42afd061 PB	26	{
42afd061 PB	27	if (mst->device_rev > DIB3000MC && mst->selected_interface != intf) {
03245a5e	28	dprintk("selecting interface: %d", intf);
42afd061 PB	29	mst->selected_interface = intf;
	30	return dibx000_write_word(mst, mst->base_reg + 4, intf);
	31	}
	32	return 0;
	33	}
	34
77e2c0f5 PB	35	static int dibx000_i2c_gate_ctrl(struct dibx000_i2c_master *mst, u8 tx[4],
77e2c0f5 PB	36	u8 addr, int onoff)
42afd061 PB	37	{
	38	u16 val;
	39
	40
	41	if (onoff)
77e2c0f5	42	val = addr << 8; // bit 7 = use master or not, if 0, the gate is open
42afd061 PB	43	else
	44	val = 1 << 7;
	45
	46	if (mst->device_rev > DIB7000)
	47	val <<= 1;
	48
	49	tx[0] = (((mst->base_reg + 1) >> 8) & 0xff);
77e2c0f5	50	tx[1] = ((mst->base_reg + 1) & 0xff);
42afd061 PB	51	tx[2] = val >> 8;
	52	tx[3] = val & 0xff;
	53
	54	return 0;
	55	}
	56
	57	static u32 dibx000_i2c_func(struct i2c_adapter *adapter)
	58	{
	59	return I2C_FUNC_I2C;
	60	}
	61
77e2c0f5 PB	62	static int dibx000_i2c_gated_tuner_xfer(struct i2c_adapter *i2c_adap,
77e2c0f5 PB	63	struct i2c_msg msg[], int num)
42afd061 PB	64	{
	65	struct dibx000_i2c_master *mst = i2c_get_adapdata(i2c_adap);
	66	struct i2c_msg m[2 + num];
	67	u8 tx_open[4], tx_close[4];
	68
77e2c0f5	69	memset(m, 0, sizeof(struct i2c_msg) * (2 + num));
42afd061 PB	70
	71	dibx000_i2c_select_interface(mst, DIBX000_I2C_INTERFACE_TUNER);
	72
77e2c0f5	73	dibx000_i2c_gate_ctrl(mst, tx_open, msg[0].addr, 1);
42afd061	74	m[0].addr = mst->i2c_addr;
77e2c0f5 PB	75	m[0].buf = tx_open;
77e2c0f5 PB	76	m[0].len = 4;
42afd061 PB	77
	78	memcpy(&m[1], msg, sizeof(struct i2c_msg) * num);
	79
	80	dibx000_i2c_gate_ctrl(mst, tx_close, 0, 0);
77e2c0f5 PB	81	m[num + 1].addr = mst->i2c_addr;
	82	m[num + 1].buf = tx_close;
	83	m[num + 1].len = 4;
42afd061	84
77e2c0f5	85	return i2c_transfer(mst->i2c_adap, m, 2 + num) == 2 + num ? num : -EIO;
42afd061 PB	86	}
	87
	88	static struct i2c_algorithm dibx000_i2c_gated_tuner_algo = {
77e2c0f5	89	.master_xfer = dibx000_i2c_gated_tuner_xfer,
42afd061 PB	90	.functionality = dibx000_i2c_func,
	91	};
	92
77e2c0f5 PB	93	struct i2c_adapter dibx000_get_i2c_adapter(struct dibx000_i2c_master mst,
	94	enum dibx000_i2c_interface intf,
	95	int gating)
42afd061 PB	96	{
	97	struct i2c_adapter *i2c = NULL;
	98
	99	switch (intf) {
77e2c0f5 PB	100	case DIBX000_I2C_INTERFACE_TUNER:
	101	if (gating)
	102	i2c = &mst->gated_tuner_i2c_adap;
	103	break;
	104	default:
	105	printk(KERN_ERR "DiBX000: incorrect I2C interface selected\n");
	106	break;
42afd061 PB	107	}
	108
	109	return i2c;
	110	}
77e2c0f5	111
42afd061 PB	112	EXPORT_SYMBOL(dibx000_get_i2c_adapter);
42afd061 PB	113
77e2c0f5 PB	114	void dibx000_reset_i2c_master(struct dibx000_i2c_master *mst)
	115	{
	116	/* initialize the i2c-master by closing the gate */
	117	u8 tx[4];
	118	struct i2c_msg m = {.addr = mst->i2c_addr,.buf = tx,.len = 4 };
	119
	120	dibx000_i2c_gate_ctrl(mst, tx, 0, 0);
	121	i2c_transfer(mst->i2c_adap, &m, 1);
	122	mst->selected_interface = 0xff; // the first time force a select of the I2C
	123	dibx000_i2c_select_interface(mst, DIBX000_I2C_INTERFACE_TUNER);
	124	}
	125
	126	EXPORT_SYMBOL(dibx000_reset_i2c_master);
	127
	128	static int i2c_adapter_init(struct i2c_adapter *i2c_adap,
	129	struct i2c_algorithm algo, const char name,
	130	struct dibx000_i2c_master *mst)
42afd061	131	{
2096b956	132	strncpy(i2c_adap->name, name, sizeof(i2c_adap->name));
42afd061 PB	133	i2c_adap->algo_data = NULL;
	134	i2c_set_adapdata(i2c_adap, mst);
	135	if (i2c_add_adapter(i2c_adap) < 0)
	136	return -ENODEV;
	137	return 0;
	138	}
	139
77e2c0f5 PB	140	int dibx000_init_i2c_master(struct dibx000_i2c_master *mst, u16 device_rev,
77e2c0f5 PB	141	struct i2c_adapter *i2c_adap, u8 i2c_addr)
42afd061 PB	142	{
42afd061 PB	143	u8 tx[4];
77e2c0f5	144	struct i2c_msg m = {.addr = i2c_addr >> 1,.buf = tx,.len = 4 };
42afd061 PB	145
42afd061 PB	146	mst->device_rev = device_rev;
77e2c0f5 PB	147	mst->i2c_adap = i2c_adap;
77e2c0f5 PB	148	mst->i2c_addr = i2c_addr >> 1;
42afd061	149
77e2c0f5	150	if (device_rev == DIB7000P \|\| device_rev == DIB8000)
42afd061 PB	151	mst->base_reg = 1024;
	152	else
	153	mst->base_reg = 768;
	154
77e2c0f5 PB	155	if (i2c_adapter_init
	156	(&mst->gated_tuner_i2c_adap, &dibx000_i2c_gated_tuner_algo,
	157	"DiBX000 tuner I2C bus", mst) != 0)
	158	printk(KERN_ERR
	159	"DiBX000: could not initialize the tuner i2c_adapter\n");
42afd061 PB	160
	161	/* initialize the i2c-master by closing the gate */
	162	dibx000_i2c_gate_ctrl(mst, tx, 0, 0);
	163
	164	return i2c_transfer(i2c_adap, &m, 1) == 1;
	165	}
77e2c0f5	166
42afd061 PB	167	EXPORT_SYMBOL(dibx000_init_i2c_master);
	168
	169	void dibx000_exit_i2c_master(struct dibx000_i2c_master *mst)
	170	{
	171	i2c_del_adapter(&mst->gated_tuner_i2c_adap);
	172	}
	173	EXPORT_SYMBOL(dibx000_exit_i2c_master);
c6d74c2c	174
03245a5e	175
7ccf1eea	176	u32 systime(void)
03245a5e OG	177	{
	178	struct timespec t;
	179
	180	t = current_kernel_time();
	181	return (t.tv_sec * 10000) + (t.tv_nsec / 100000);
	182	}
	183	EXPORT_SYMBOL(systime);
	184
c6d74c2c PB	185	MODULE_AUTHOR("Patrick Boettcher <pboettcher@dibcom.fr>");
	186	MODULE_DESCRIPTION("Common function the DiBcom demodulator family");
	187	MODULE_LICENSE("GPL");