mirror of https://gitee.com/openkylin/linux.git
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: Markus Rechberger <mrechberger@sundtek.de>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
Markus Rechberger
Mauro Carvalho Chehab
parent
aa56cb9db0
commit
67ea14f250
|
|
@ -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
|
||||
|
|
@ -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");
|
||||
|
|
@ -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 */
|
||||
Loading…
Reference in New Issue