V4L/DVB (9365): adding lgdt3304 based driver
authorMarkus Rechberger <mrechberger@gmail.com>
Thu, 23 Oct 2008 00:08:47 +0000 (21:08 -0300)
committerMauro Carvalho Chehab <mchehab@redhat.com>
Mon, 29 Dec 2008 19:53:13 +0000 (17:53 -0200)
lgdt3304.c:
    frontend driver for the lgdt3304 chip, this driver is not compatible
    with the lgdt330x.

Signed-off-by: Markus Rechberger <mrechberger@sundtek.de>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
drivers/media/video/empia/lgdt3304/Makefile [new file with mode: 0644]
drivers/media/video/empia/lgdt3304/lgdt3304.c [new file with mode: 0644]
drivers/media/video/empia/lgdt3304/lgdt3304.h [new file with mode: 0644]

diff --git a/drivers/media/video/empia/lgdt3304/Makefile b/drivers/media/video/empia/lgdt3304/Makefile
new file mode 100644 (file)
index 0000000..4d261a7
--- /dev/null
@@ -0,0 +1,7 @@
+lgdt3304-demod-objs   := lgdt3304.o
+
+obj-m += lgdt3304-demod.o
+
+EXTRA_CFLAGS += -Idrivers/media/dvb/dvb-core
+EXTRA_CFLAGS += -Idrivers/media/dvb/frontends
+EXTRA_CFLAGS += -DCONFIG_DVB_LGDT3304
diff --git a/drivers/media/video/empia/lgdt3304/lgdt3304.c b/drivers/media/video/empia/lgdt3304/lgdt3304.c
new file mode 100644 (file)
index 0000000..2af09be
--- /dev/null
@@ -0,0 +1,378 @@
+/*
+ * Driver for LG ATSC lgdt3304 driver
+ *
+ * Copyright (C) 2008 Markus Rechberger <mrechberger@sundtek.de>
+ *
+ */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/delay.h>
+#include "dvb_frontend.h"
+#include "lgdt3304.h"
+
+static  unsigned int debug = 0;
+module_param(debug, int, 0644);
+MODULE_PARM_DESC(debug,"lgdt3304 debugging (default off)");
+
+#define dprintk(fmt, args...) if (debug) do {\
+                       printk("lgdt3304 debug: " fmt, ##args); } while (0)
+
+struct lgdt3304_state
+{
+        struct dvb_frontend frontend;
+        fe_modulation_t current_modulation;
+        __u32 snr;
+        __u32 current_frequency;
+       __u8 addr;
+       struct i2c_adapter *i2c;
+};
+
+static int i2c_write_demod_bytes (struct dvb_frontend *fe, __u8 *buf, int len)
+{
+       struct lgdt3304_state *state = fe->demodulator_priv;
+       struct i2c_msg i2cmsgs = {
+               .addr = state->addr,
+               .flags = 0,
+               .len = 3,
+               .buf = buf
+       };
+        int i;
+        int err;
+
+        for (i=0; i<len-1; i+=3){
+               if((err = i2c_transfer(state->i2c, &i2cmsgs, 1))<0) {
+                       printk("%s i2c_transfer error %d\n", __FUNCTION__, err);
+                        if (err < 0)
+                                return err;
+                        else
+                                return -EREMOTEIO;
+                }
+                i2cmsgs.buf += 3;
+        }
+        return 0;
+}
+
+static int lgdt3304_i2c_read_reg(struct dvb_frontend *fe, unsigned int reg)
+{
+       struct lgdt3304_state *state = fe->demodulator_priv;
+       struct i2c_msg i2cmsgs[2];
+       int ret;
+       __u8 buf;
+
+       __u8 regbuf[2] = { reg>>8, reg&0xff };
+
+       i2cmsgs[0].addr = state->addr;
+       i2cmsgs[0].flags = 0;
+       i2cmsgs[0].len = 2;
+       i2cmsgs[0].buf = regbuf;
+
+       i2cmsgs[1].addr = state->addr;
+       i2cmsgs[1].flags = I2C_M_RD;
+       i2cmsgs[1].len = 1;
+       i2cmsgs[1].buf = &buf;
+
+       if((ret = i2c_transfer(state->i2c, i2cmsgs, 2))<0) {
+               printk("%s i2c_transfer error %d\n", __FUNCTION__, ret);
+               return ret;
+       }
+
+       return buf;
+}
+
+static int lgdt3304_i2c_write_reg(struct dvb_frontend *fe, int reg, int val)
+{
+       struct lgdt3304_state *state = fe->demodulator_priv;
+       char buffer[3] = { reg>>8, reg&0xff, val };
+       int ret;
+
+       struct i2c_msg i2cmsgs = {
+               .addr = state->addr,
+               .flags = 0,
+               .len = 3,
+               .buf=buffer
+       };
+       ret = i2c_transfer(state->i2c, &i2cmsgs, 1);
+       if (ret != 1) {
+               printk("%s i2c_transfer error %d\n", __FUNCTION__, ret);
+               return ret;
+       }
+
+       return 0;
+}
+
+
+static int lgdt3304_soft_Reset(struct dvb_frontend *fe)
+{
+       lgdt3304_i2c_write_reg(fe, 0x0002, 0x9a);
+       lgdt3304_i2c_write_reg(fe, 0x0002, 0x9b);
+       mdelay(200);
+       return 0;
+}
+
+static int lgdt3304_set_parameters(struct dvb_frontend *fe, struct dvb_frontend_parameters *param) {
+       int err = 0;
+
+       static __u8 lgdt3304_vsb8_data[] = {
+               /* 16bit  , 8bit */
+               /* regs   , val  */
+               0x00, 0x00, 0x02,
+               0x00, 0x00, 0x13,
+               0x00, 0x0d, 0x02,
+               0x00, 0x0e, 0x02,
+               0x00, 0x12, 0x32,
+               0x00, 0x13, 0xc4,
+               0x01, 0x12, 0x17,
+               0x01, 0x13, 0x15,
+               0x01, 0x14, 0x18,
+               0x01, 0x15, 0xff,
+               0x01, 0x16, 0x2c,
+               0x02, 0x14, 0x67,
+               0x02, 0x24, 0x8d,
+               0x04, 0x27, 0x12,
+               0x04, 0x28, 0x4f,
+               0x03, 0x08, 0x80,
+               0x03, 0x09, 0x00,
+               0x03, 0x0d, 0x00,
+               0x03, 0x0e, 0x1c,
+               0x03, 0x14, 0xe1,
+               0x05, 0x0e, 0x5b,
+       };
+
+       /* not yet tested .. */
+       static __u8 lgdt3304_qam64_data[] = {
+               /* 16bit  , 8bit */
+               /* regs   , val  */
+               0x00, 0x00, 0x18,
+               0x00, 0x0d, 0x02,
+               //0x00, 0x0e, 0x02,
+               0x00, 0x12, 0x2a,
+               0x00, 0x13, 0x00,
+               0x03, 0x14, 0xe3,
+               0x03, 0x0e, 0x1c,
+               0x03, 0x08, 0x66,
+               0x03, 0x09, 0x66,
+               0x03, 0x0a, 0x08,
+               0x03, 0x0b, 0x9b,
+               0x05, 0x0e, 0x5b,
+       };
+
+
+       /* tested with KWorld a340 */
+       static __u8 lgdt3304_qam256_data[] = {
+               /* 16bit  , 8bit */
+               /* regs   , val  */
+               0x00, 0x00, 0x01,  //0x19,
+               0x00, 0x12, 0x2a,
+               0x00, 0x13, 0x80,
+               0x00, 0x0d, 0x02,
+               0x03, 0x14, 0xe3,
+
+               0x03, 0x0e, 0x1c,
+               0x03, 0x08, 0x66,
+               0x03, 0x09, 0x66,
+               0x03, 0x0a, 0x08,
+               0x03, 0x0b, 0x9b,
+
+               0x03, 0x0d, 0x14,
+               //0x05, 0x0e, 0x5b,
+               0x01, 0x06, 0x4a,
+               0x01, 0x07, 0x3d,
+               0x01, 0x08, 0x70,
+               0x01, 0x09, 0xa3,
+
+               0x05, 0x04, 0xfd,
+
+               0x00, 0x0d, 0x82,
+
+               0x05, 0x0e, 0x5b,
+
+               0x05, 0x0e, 0x5b,
+
+               0x00, 0x02, 0x9a,
+
+               0x00, 0x02, 0x9b,
+
+               0x00, 0x00, 0x01,
+               0x00, 0x12, 0x2a,
+               0x00, 0x13, 0x80,
+               0x00, 0x0d, 0x02,
+               0x03, 0x14, 0xe3,
+
+               0x03, 0x0e, 0x1c,
+               0x03, 0x08, 0x66,
+               0x03, 0x09, 0x66,
+               0x03, 0x0a, 0x08,
+               0x03, 0x0b, 0x9b,
+
+               0x03, 0x0d, 0x14,
+               0x01, 0x06, 0x4a,
+               0x01, 0x07, 0x3d,
+               0x01, 0x08, 0x70,
+               0x01, 0x09, 0xa3,
+
+               0x05, 0x04, 0xfd,
+
+               0x00, 0x0d, 0x82,
+
+               0x05, 0x0e, 0x5b,
+       };
+
+       struct lgdt3304_state *state = fe->demodulator_priv;
+       if (state->current_modulation != param->u.vsb.modulation) {
+               switch(param->u.vsb.modulation) {
+               case VSB_8:
+                       err = i2c_write_demod_bytes(fe, lgdt3304_vsb8_data,
+                                       sizeof(lgdt3304_vsb8_data));
+                       break;
+               case QAM_64:
+                       err = i2c_write_demod_bytes(fe, lgdt3304_qam64_data,
+                                       sizeof(lgdt3304_qam64_data));
+                       break;
+               case QAM_256:
+                       err = i2c_write_demod_bytes(fe, lgdt3304_qam256_data,
+                                       sizeof(lgdt3304_qam256_data));
+                       break;
+               default:
+                       break;
+               }
+
+               if (err) {
+                       printk("%s error setting modulation\n", __FUNCTION__);
+               } else {
+                       state->current_modulation = param->u.vsb.modulation;
+               }
+       }
+       state->current_frequency = param->frequency;
+
+       lgdt3304_soft_Reset(fe);
+
+
+        if (fe->ops.tuner_ops.set_params)
+                fe->ops.tuner_ops.set_params(fe, param);
+
+       return 0;
+}
+
+static int lgdt3304_init(struct dvb_frontend *fe) {
+        return 0;
+}
+
+static int lgdt3304_sleep(struct dvb_frontend *fe) {
+       return 0;
+}
+
+
+static int lgdt3304_read_status(struct dvb_frontend *fe, fe_status_t *status)
+{
+       struct lgdt3304_state *state = fe->demodulator_priv;
+       int r011d;
+       int qam_lck;
+
+       *status = 0;
+       dprintk("lgdt read status\n");
+
+       r011d = lgdt3304_i2c_read_reg(fe, 0x011d);
+
+       dprintk("%02x\n", r011d);
+
+       switch(state->current_modulation) {
+       case VSB_8:
+               if (r011d & 0x80) {
+                       dprintk("VSB Locked\n");
+                       *status |= FE_HAS_CARRIER;
+                       *status |= FE_HAS_LOCK;
+                       *status |= FE_HAS_SYNC;
+                       *status |= FE_HAS_SIGNAL;
+               }
+               break;
+       case QAM_64:
+       case QAM_256:
+               qam_lck = r011d & 0x7;
+               switch(qam_lck) {
+                       case 0x0: dprintk("Unlock\n");
+                                 break;
+                       case 0x4: dprintk("1st Lock in acquisition state\n");
+                                 break;
+                       case 0x6: dprintk("2nd Lock in acquisition state\n");
+                                 break;
+                       case 0x7: dprintk("Final Lock in good reception state\n");
+                                 *status |= FE_HAS_CARRIER;
+                                 *status |= FE_HAS_LOCK;
+                                 *status |= FE_HAS_SYNC;
+                                 *status |= FE_HAS_SIGNAL;
+                                 break;
+               }
+               break;
+       default:
+               printk("%s unhandled modulation\n", __FUNCTION__);
+       }
+
+
+       return 0;
+}
+
+static int lgdt3304_read_ber(struct dvb_frontend *fe, __u32 *ber)
+{
+       dprintk("read ber\n");
+       return 0;
+}
+
+static int lgdt3304_read_snr(struct dvb_frontend *fe, __u16 *snr)
+{
+       dprintk("read snr\n");
+       return 0;
+}
+
+static int lgdt3304_read_ucblocks(struct dvb_frontend *fe, __u32 *ucblocks)
+{
+       dprintk("read ucblocks\n");
+       return 0;
+}
+
+static void lgdt3304_release(struct dvb_frontend *fe)
+{
+       struct lgdt3304_state *state = (struct lgdt3304_state *)fe->demodulator_priv;
+       kfree(state);
+}
+
+static struct dvb_frontend_ops demod_lgdt3304={
+       .info = {
+               .name = "LG 3304",
+               .type = FE_ATSC,
+               .frequency_min = 54000000,
+               .frequency_max = 858000000,
+               .frequency_stepsize = 62500,
+               .symbol_rate_min = 5056941,
+               .symbol_rate_max = 10762000,
+               .caps = FE_CAN_QAM_64 | FE_CAN_QAM_256 | FE_CAN_8VSB
+       },
+       .init = lgdt3304_init,
+       .sleep = lgdt3304_sleep,
+       .set_frontend = lgdt3304_set_parameters,
+       .read_snr = lgdt3304_read_snr,
+       .read_ber = lgdt3304_read_ber,
+       .read_status = lgdt3304_read_status,
+       .read_ucblocks = lgdt3304_read_ucblocks,
+       .release = lgdt3304_release,
+};
+
+struct dvb_frontend* lgdt3304_attach(const struct lgdt3304_config *config,
+                                          struct i2c_adapter *i2c)
+{
+
+       struct lgdt3304_state *state;
+       state = kzalloc(sizeof(struct lgdt3304_state), GFP_KERNEL);
+       memset(state, 0x0, sizeof(struct lgdt3304_state));
+       state->addr = config->i2c_address;
+       state->i2c = i2c;
+
+       memcpy(&state->frontend.ops, &demod_lgdt3304, sizeof(struct dvb_frontend_ops));
+       state->frontend.demodulator_priv = state;
+       return &state->frontend;
+}
+
+EXPORT_SYMBOL_GPL(lgdt3304_attach);
+MODULE_AUTHOR("Markus Rechberger <mrechberger@empiatech.com>");
+MODULE_DESCRIPTION("LGE LGDT3304 DVB-T demodulator driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/media/video/empia/lgdt3304/lgdt3304.h b/drivers/media/video/empia/lgdt3304/lgdt3304.h
new file mode 100644 (file)
index 0000000..fc409fe
--- /dev/null
@@ -0,0 +1,45 @@
+/*
+ *  Driver for DVB-T lgdt3304 demodulator
+ *
+ *  Copyright (C) 2008 Markus Rechberger <mrechberger@gmail.com>
+ *
+ *  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.=
+ */
+
+#ifndef LGDT3304_H
+#define LGDT3304_H
+
+#include <linux/dvb/frontend.h>
+
+struct lgdt3304_config
+{
+       /* demodulator's I2C address */
+       u8 i2c_address;
+};
+
+#if defined(CONFIG_DVB_LGDT3304) || (defined(CONFIG_DVB_LGDT3304_MODULE) && defined(MODULE))
+extern struct dvb_frontend* lgdt3304_attach(const struct lgdt3304_config *config,
+                                          struct i2c_adapter *i2c);
+#else
+static inline struct dvb_frontend* lgdt3304_attach(const struct lgdt3304_config *config,
+                                          struct i2c_adapter *i2c)
+{
+       printk(KERN_WARNING "%s: driver disabled by Kconfig\n", __func__);
+       return NULL;
+}
+#endif /* CONFIG_DVB_LGDT */
+
+#endif /* LGDT3304_H */