[deliverable/linux.git] / drivers / media / video / cx88 / cx88-vp3054-i2c.c

/*

    cx88-vp3054-i2c.c  --  support for the secondary I2C bus of the
			   DNTV Live! DVB-T Pro (VP-3054), wired as:
			   GPIO[0] -> SCL, GPIO[1] -> SDA

    (c) 2005 Chris Pascoe <c.pascoe@itee.uq.edu.au>

    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 <linux/module.h>
#include <linux/init.h>

#include <asm/io.h>

#include "cx88.h"
#include "cx88-vp3054-i2c.h"

MODULE_DESCRIPTION("driver for cx2388x VP3054 design");
MODULE_AUTHOR("Chris Pascoe <c.pascoe@itee.uq.edu.au>");
MODULE_LICENSE("GPL");

/* ----------------------------------------------------------------------- */

static void vp3054_bit_setscl(void *data, int state)
{
	struct cx8802_dev *dev = data;
	struct cx88_core *core = dev->core;
	struct vp3054_i2c_state *vp3054_i2c = dev->vp3054;

	if (state) {
		vp3054_i2c->state |=  0x0001;	/* SCL high */
		vp3054_i2c->state &= ~0x0100;	/* external pullup */
	} else {
		vp3054_i2c->state &= ~0x0001;	/* SCL low */
		vp3054_i2c->state |=  0x0100;	/* drive pin */
	}
	cx_write(MO_GP0_IO, 0x010000 | vp3054_i2c->state);
	cx_read(MO_GP0_IO);
}

static void vp3054_bit_setsda(void *data, int state)
{
	struct cx8802_dev *dev = data;
	struct cx88_core *core = dev->core;
	struct vp3054_i2c_state *vp3054_i2c = dev->vp3054;

	if (state) {
		vp3054_i2c->state |=  0x0002;	/* SDA high */
		vp3054_i2c->state &= ~0x0200;	/* tristate pin */
	} else {
		vp3054_i2c->state &= ~0x0002;	/* SDA low */
		vp3054_i2c->state |=  0x0200;	/* drive pin */
	}
	cx_write(MO_GP0_IO, 0x020000 | vp3054_i2c->state);
	cx_read(MO_GP0_IO);
}

static int vp3054_bit_getscl(void *data)
{
	struct cx8802_dev *dev = data;
	struct cx88_core *core = dev->core;
	u32 state;

	state = cx_read(MO_GP0_IO);
	return (state & 0x01) ? 1 : 0;
}

static int vp3054_bit_getsda(void *data)
{
	struct cx8802_dev *dev = data;
	struct cx88_core *core = dev->core;
	u32 state;

	state = cx_read(MO_GP0_IO);
	return (state & 0x02) ? 1 : 0;
}

/* ----------------------------------------------------------------------- */

static const struct i2c_algo_bit_data vp3054_i2c_algo_template = {
	.setsda  = vp3054_bit_setsda,
	.setscl  = vp3054_bit_setscl,
	.getsda  = vp3054_bit_getsda,
	.getscl  = vp3054_bit_getscl,
	.udelay  = 16,
	.timeout = 200,
};

/* ----------------------------------------------------------------------- */

int vp3054_i2c_probe(struct cx8802_dev *dev)
{
	struct cx88_core *core = dev->core;
	struct vp3054_i2c_state *vp3054_i2c;
	int rc;

	if (core->boardnr != CX88_BOARD_DNTV_LIVE_DVB_T_PRO)
		return 0;

	vp3054_i2c = kzalloc(sizeof(*vp3054_i2c), GFP_KERNEL);
	if (vp3054_i2c == NULL)
		return -ENOMEM;
	dev->vp3054 = vp3054_i2c;

	memcpy(&vp3054_i2c->algo, &vp3054_i2c_algo_template,
	       sizeof(vp3054_i2c->algo));

	vp3054_i2c->adap.class |= I2C_CLASS_TV_DIGITAL;

	vp3054_i2c->adap.dev.parent = &dev->pci->dev;
	strlcpy(vp3054_i2c->adap.name, core->name,
		sizeof(vp3054_i2c->adap.name));
	vp3054_i2c->adap.owner = THIS_MODULE;
	vp3054_i2c->adap.id = I2C_HW_B_CX2388x;
	vp3054_i2c->algo.data = dev;
	i2c_set_adapdata(&vp3054_i2c->adap, dev);
	vp3054_i2c->adap.algo_data = &vp3054_i2c->algo;

	vp3054_bit_setscl(dev,1);
	vp3054_bit_setsda(dev,1);

	rc = i2c_bit_add_bus(&vp3054_i2c->adap);
	if (0 != rc) {
		printk("%s: vp3054_i2c register FAILED\n", core->name);

		kfree(dev->vp3054);
		dev->vp3054 = NULL;
	}

	return rc;
}

void vp3054_i2c_remove(struct cx8802_dev *dev)
{
	struct vp3054_i2c_state *vp3054_i2c = dev->vp3054;

	if (vp3054_i2c == NULL ||
	    dev->core->boardnr != CX88_BOARD_DNTV_LIVE_DVB_T_PRO)
		return;

	i2c_del_adapter(&vp3054_i2c->adap);
	kfree(vp3054_i2c);
}

EXPORT_SYMBOL(vp3054_i2c_probe);
EXPORT_SYMBOL(vp3054_i2c_remove);
Commit	Line	Data
fc40b261 CP	1	/*
	2
	3	cx88-vp3054-i2c.c -- support for the secondary I2C bus of the
	4	DNTV Live! DVB-T Pro (VP-3054), wired as:
	5	GPIO[0] -> SCL, GPIO[1] -> SDA
	6
	7	(c) 2005 Chris Pascoe <c.pascoe@itee.uq.edu.au>
	8
	9	This program is free software; you can redistribute it and/or modify
	10	it under the terms of the GNU General Public License as published by
	11	the Free Software Foundation; either version 2 of the License, or
	12	(at your option) any later version.
	13
	14	This program is distributed in the hope that it will be useful,
	15	but WITHOUT ANY WARRANTY; without even the implied warranty of
	16	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	17	GNU General Public License for more details.
	18
	19	You should have received a copy of the GNU General Public License
	20	along with this program; if not, write to the Free Software
	21	Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	22
	23	*/
	24
	25	#include <linux/module.h>
fc40b261 CP	26	#include <linux/init.h>
	27
	28	#include <asm/io.h>
	29
	30	#include "cx88.h"
	31	#include "cx88-vp3054-i2c.h"
	32
45bf2daa MCC	33	MODULE_DESCRIPTION("driver for cx2388x VP3054 design");
	34	MODULE_AUTHOR("Chris Pascoe <c.pascoe@itee.uq.edu.au>");
	35	MODULE_LICENSE("GPL");
	36
fc40b261 CP	37	/* ----------------------------------------------------------------------- */
	38
	39	static void vp3054_bit_setscl(void *data, int state)
	40	{
	41	struct cx8802_dev *dev = data;
	42	struct cx88_core *core = dev->core;
f0ad9097	43	struct vp3054_i2c_state *vp3054_i2c = dev->vp3054;
fc40b261 CP	44
	45	if (state) {
	46	vp3054_i2c->state \|= 0x0001; /* SCL high */
	47	vp3054_i2c->state &= ~0x0100; /* external pullup */
	48	} else {
	49	vp3054_i2c->state &= ~0x0001; /* SCL low */
	50	vp3054_i2c->state \|= 0x0100; /* drive pin */
	51	}
	52	cx_write(MO_GP0_IO, 0x010000 \| vp3054_i2c->state);
	53	cx_read(MO_GP0_IO);
	54	}
	55
	56	static void vp3054_bit_setsda(void *data, int state)
	57	{
	58	struct cx8802_dev *dev = data;
	59	struct cx88_core *core = dev->core;
f0ad9097	60	struct vp3054_i2c_state *vp3054_i2c = dev->vp3054;
fc40b261 CP	61
	62	if (state) {
	63	vp3054_i2c->state \|= 0x0002; /* SDA high */
	64	vp3054_i2c->state &= ~0x0200; /* tristate pin */
	65	} else {
	66	vp3054_i2c->state &= ~0x0002; /* SDA low */
	67	vp3054_i2c->state \|= 0x0200; /* drive pin */
	68	}
	69	cx_write(MO_GP0_IO, 0x020000 \| vp3054_i2c->state);
	70	cx_read(MO_GP0_IO);
	71	}
	72
	73	static int vp3054_bit_getscl(void *data)
	74	{
	75	struct cx8802_dev *dev = data;
	76	struct cx88_core *core = dev->core;
	77	u32 state;
	78
	79	state = cx_read(MO_GP0_IO);
	80	return (state & 0x01) ? 1 : 0;
	81	}
	82
	83	static int vp3054_bit_getsda(void *data)
	84	{
	85	struct cx8802_dev *dev = data;
	86	struct cx88_core *core = dev->core;
	87	u32 state;
	88
	89	state = cx_read(MO_GP0_IO);
	90	return (state & 0x02) ? 1 : 0;
	91	}
	92
	93	/* ----------------------------------------------------------------------- */
	94
7e520d09	95	static const struct i2c_algo_bit_data vp3054_i2c_algo_template = {
fc40b261 CP	96	.setsda = vp3054_bit_setsda,
	97	.setscl = vp3054_bit_setscl,
	98	.getsda = vp3054_bit_getsda,
	99	.getscl = vp3054_bit_getscl,
	100	.udelay = 16,
fc40b261 CP	101	.timeout = 200,
	102	};
	103
	104	/* ----------------------------------------------------------------------- */
	105
fc40b261 CP	106	int vp3054_i2c_probe(struct cx8802_dev *dev)
	107	{
	108	struct cx88_core *core = dev->core;
	109	struct vp3054_i2c_state *vp3054_i2c;
	110	int rc;
	111
6a59d64c	112	if (core->boardnr != CX88_BOARD_DNTV_LIVE_DVB_T_PRO)
fc40b261 CP	113	return 0;
fc40b261 CP	114
f0ad9097 TP	115	vp3054_i2c = kzalloc(sizeof(*vp3054_i2c), GFP_KERNEL);
f0ad9097 TP	116	if (vp3054_i2c == NULL)
fc40b261	117	return -ENOMEM;
f0ad9097	118	dev->vp3054 = vp3054_i2c;
fc40b261	119
fc40b261 CP	120	memcpy(&vp3054_i2c->algo, &vp3054_i2c_algo_template,
fc40b261 CP	121	sizeof(vp3054_i2c->algo));
fc40b261 CP	122
	123	vp3054_i2c->adap.class \|= I2C_CLASS_TV_DIGITAL;
	124
	125	vp3054_i2c->adap.dev.parent = &dev->pci->dev;
	126	strlcpy(vp3054_i2c->adap.name, core->name,
	127	sizeof(vp3054_i2c->adap.name));
7e520d09 JD	128	vp3054_i2c->adap.owner = THIS_MODULE;
7e520d09 JD	129	vp3054_i2c->adap.id = I2C_HW_B_CX2388x;
fc40b261 CP	130	vp3054_i2c->algo.data = dev;
	131	i2c_set_adapdata(&vp3054_i2c->adap, dev);
	132	vp3054_i2c->adap.algo_data = &vp3054_i2c->algo;
fc40b261 CP	133
	134	vp3054_bit_setscl(dev,1);
	135	vp3054_bit_setsda(dev,1);
	136
	137	rc = i2c_bit_add_bus(&vp3054_i2c->adap);
	138	if (0 != rc) {
	139	printk("%s: vp3054_i2c register FAILED\n", core->name);
	140
f0ad9097 TP	141	kfree(dev->vp3054);
f0ad9097 TP	142	dev->vp3054 = NULL;
fc40b261 CP	143	}
	144
	145	return rc;
	146	}
	147
	148	void vp3054_i2c_remove(struct cx8802_dev *dev)
	149	{
f0ad9097	150	struct vp3054_i2c_state *vp3054_i2c = dev->vp3054;
fc40b261 CP	151
fc40b261 CP	152	if (vp3054_i2c == NULL \|\|
6a59d64c	153	dev->core->boardnr != CX88_BOARD_DNTV_LIVE_DVB_T_PRO)
fc40b261 CP	154	return;
fc40b261 CP	155
3269711b	156	i2c_del_adapter(&vp3054_i2c->adap);
fc40b261 CP	157	kfree(vp3054_i2c);
	158	}
	159
	160	EXPORT_SYMBOL(vp3054_i2c_probe);
	161	EXPORT_SYMBOL(vp3054_i2c_remove);