Commit 67ea14f2 authored by Markus Rechberger's avatar Markus Rechberger Committed by Mauro Carvalho Chehab
Browse files

V4L/DVB (9365): adding lgdt3304 based driver 



lgdt3304.c:
    frontend driver for the lgdt3304 chip, this driver is not compatible
    with the lgdt330x.

Signed-off-by: default avatarMarkus Rechberger <mrechberger@sundtek.de>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent aa56cb9d

drivers/media/video/empia/lgdt3304/Makefile

0 → 100644
+7 −0
Original line number Diff line number Diff line 
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

drivers/media/video/empia/lgdt3304/lgdt3304.c

0 → 100644
+378 −0
Original line number Diff line number Diff line 
/*

 * 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");

drivers/media/video/empia/lgdt3304/lgdt3304.h

0 → 100644
+45 −0
Original line number Diff line number Diff line 
/*

 *  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 */