V4L/DVB (3220): Add support for VP-3054 HDTV board

[safe/jmp/linux-2.6] / drivers / media / video / cx88 / cx88-vp3054-i2c.c

diff --git a/drivers/media/video/cx88/cx88-vp3054-i2c.c b/drivers/media/video/cx88/cx88-vp3054-i2c.c
new file mode 100644 (file)
index 0000000..372cd29
--- /dev/null
+++ b/drivers/media/video/cx88/cx88-vp3054-i2c.c
@@ -0,0 +1,173 @@
+/*
+
+    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/moduleparam.h>
+#include <linux/init.h>
+
+#include <asm/io.h>
+
+#include "cx88.h"
+#include "cx88-vp3054-i2c.h"
+
+
+/* ----------------------------------------------------------------------- */
+
+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->card_priv;
+
+       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->card_priv;
+
+       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 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,
+       .mdelay  = 10,
+       .timeout = 200,
+};
+
+/* ----------------------------------------------------------------------- */
+
+static struct i2c_adapter vp3054_i2c_adap_template = {
+       .name              = "cx2388x",
+       .owner             = THIS_MODULE,
+       .id                = I2C_HW_B_CX2388x,
+};
+
+static struct i2c_client vp3054_i2c_client_template = {
+       .name   = "VP-3054",
+};
+
+int vp3054_i2c_probe(struct cx8802_dev *dev)
+{
+       struct cx88_core *core = dev->core;
+       struct vp3054_i2c_state *vp3054_i2c;
+       int rc;
+
+       if (core->board != CX88_BOARD_DNTV_LIVE_DVB_T_PRO)
+               return 0;
+
+       dev->card_priv = kzalloc(sizeof(*vp3054_i2c), GFP_KERNEL);
+       if (dev->card_priv == NULL)
+               return -ENOMEM;
+       vp3054_i2c = dev->card_priv;
+
+       memcpy(&vp3054_i2c->adap, &vp3054_i2c_adap_template,
+              sizeof(vp3054_i2c->adap));
+       memcpy(&vp3054_i2c->algo, &vp3054_i2c_algo_template,
+              sizeof(vp3054_i2c->algo));
+       memcpy(&vp3054_i2c->client, &vp3054_i2c_client_template,
+              sizeof(vp3054_i2c->client));
+
+       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->algo.data = dev;
+       i2c_set_adapdata(&vp3054_i2c->adap, dev);
+       vp3054_i2c->adap.algo_data = &vp3054_i2c->algo;
+       vp3054_i2c->client.adapter = &vp3054_i2c->adap;
+
+       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->card_priv);
+               dev->card_priv = NULL;
+       }
+
+       return rc;
+}
+
+void vp3054_i2c_remove(struct cx8802_dev *dev)
+{
+       struct vp3054_i2c_state *vp3054_i2c = dev->card_priv;
+
+       if (vp3054_i2c == NULL ||
+           dev->core->board != CX88_BOARD_DNTV_LIVE_DVB_T_PRO)
+               return;
+
+       i2c_bit_del_bus(&vp3054_i2c->adap);
+       kfree(vp3054_i2c);
+}
+
+EXPORT_SYMBOL(vp3054_i2c_probe);
+EXPORT_SYMBOL(vp3054_i2c_remove);