2 * Support for LG Electronics LGDT3304 and LGDT3305 - VSB/QAM
4 * Copyright (C) 2008, 2009 Michael Krufky <mkrufky@linuxtv.org>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 #include <asm/div64.h>
23 #include <linux/dvb/frontend.h>
24 #include <linux/slab.h>
29 module_param(debug, int, 0644);
30 MODULE_PARM_DESC(debug, "set debug level (info=1, reg=2 (or-able))");
35 #define lg_printk(kern, fmt, arg...) \
36 printk(kern "%s: " fmt, __func__, ##arg)
38 #define lg_info(fmt, arg...) printk(KERN_INFO "lgdt3305: " fmt, ##arg)
39 #define lg_warn(fmt, arg...) lg_printk(KERN_WARNING, fmt, ##arg)
40 #define lg_err(fmt, arg...) lg_printk(KERN_ERR, fmt, ##arg)
41 #define lg_dbg(fmt, arg...) if (debug & DBG_INFO) \
42 lg_printk(KERN_DEBUG, fmt, ##arg)
43 #define lg_reg(fmt, arg...) if (debug & DBG_REG) \
44 lg_printk(KERN_DEBUG, fmt, ##arg)
46 #define lg_fail(ret) \
51 lg_err("error %d on line %d\n", ret, __LINE__); \
55 struct lgdt3305_state {
56 struct i2c_adapter *i2c_adap;
57 const struct lgdt3305_config *cfg;
59 struct dvb_frontend frontend;
61 fe_modulation_t current_modulation;
62 u32 current_frequency;
66 /* ------------------------------------------------------------------------ */
68 #define LGDT3305_GEN_CTRL_1 0x0000
69 #define LGDT3305_GEN_CTRL_2 0x0001
70 #define LGDT3305_GEN_CTRL_3 0x0002
71 #define LGDT3305_GEN_STATUS 0x0003
72 #define LGDT3305_GEN_CONTROL 0x0007
73 #define LGDT3305_GEN_CTRL_4 0x000a
74 #define LGDT3305_DGTL_AGC_REF_1 0x0012
75 #define LGDT3305_DGTL_AGC_REF_2 0x0013
76 #define LGDT3305_CR_CTR_FREQ_1 0x0106
77 #define LGDT3305_CR_CTR_FREQ_2 0x0107
78 #define LGDT3305_CR_CTR_FREQ_3 0x0108
79 #define LGDT3305_CR_CTR_FREQ_4 0x0109
80 #define LGDT3305_CR_MSE_1 0x011b
81 #define LGDT3305_CR_MSE_2 0x011c
82 #define LGDT3305_CR_LOCK_STATUS 0x011d
83 #define LGDT3305_CR_CTRL_7 0x0126
84 #define LGDT3305_AGC_POWER_REF_1 0x0300
85 #define LGDT3305_AGC_POWER_REF_2 0x0301
86 #define LGDT3305_AGC_DELAY_PT_1 0x0302
87 #define LGDT3305_AGC_DELAY_PT_2 0x0303
88 #define LGDT3305_RFAGC_LOOP_FLTR_BW_1 0x0306
89 #define LGDT3305_RFAGC_LOOP_FLTR_BW_2 0x0307
90 #define LGDT3305_IFBW_1 0x0308
91 #define LGDT3305_IFBW_2 0x0309
92 #define LGDT3305_AGC_CTRL_1 0x030c
93 #define LGDT3305_AGC_CTRL_4 0x0314
94 #define LGDT3305_EQ_MSE_1 0x0413
95 #define LGDT3305_EQ_MSE_2 0x0414
96 #define LGDT3305_EQ_MSE_3 0x0415
97 #define LGDT3305_PT_MSE_1 0x0417
98 #define LGDT3305_PT_MSE_2 0x0418
99 #define LGDT3305_PT_MSE_3 0x0419
100 #define LGDT3305_FEC_BLOCK_CTRL 0x0504
101 #define LGDT3305_FEC_LOCK_STATUS 0x050a
102 #define LGDT3305_FEC_PKT_ERR_1 0x050c
103 #define LGDT3305_FEC_PKT_ERR_2 0x050d
104 #define LGDT3305_TP_CTRL_1 0x050e
105 #define LGDT3305_BERT_PERIOD 0x0801
106 #define LGDT3305_BERT_ERROR_COUNT_1 0x080a
107 #define LGDT3305_BERT_ERROR_COUNT_2 0x080b
108 #define LGDT3305_BERT_ERROR_COUNT_3 0x080c
109 #define LGDT3305_BERT_ERROR_COUNT_4 0x080d
111 static int lgdt3305_write_reg(struct lgdt3305_state *state, u16 reg, u8 val)
114 u8 buf[] = { reg >> 8, reg & 0xff, val };
115 struct i2c_msg msg = {
116 .addr = state->cfg->i2c_addr, .flags = 0,
117 .buf = buf, .len = 3,
120 lg_reg("reg: 0x%04x, val: 0x%02x\n", reg, val);
122 ret = i2c_transfer(state->i2c_adap, &msg, 1);
125 lg_err("error (addr %02x %02x <- %02x, err = %i)\n",
126 msg.buf[0], msg.buf[1], msg.buf[2], ret);
135 static int lgdt3305_read_reg(struct lgdt3305_state *state, u16 reg, u8 *val)
138 u8 reg_buf[] = { reg >> 8, reg & 0xff };
139 struct i2c_msg msg[] = {
140 { .addr = state->cfg->i2c_addr,
141 .flags = 0, .buf = reg_buf, .len = 2 },
142 { .addr = state->cfg->i2c_addr,
143 .flags = I2C_M_RD, .buf = val, .len = 1 },
146 lg_reg("reg: 0x%04x\n", reg);
148 ret = i2c_transfer(state->i2c_adap, msg, 2);
151 lg_err("error (addr %02x reg %04x error (ret == %i)\n",
152 state->cfg->i2c_addr, reg, ret);
161 #define read_reg(state, reg) \
164 int ret = lgdt3305_read_reg(state, reg, &__val); \
170 static int lgdt3305_set_reg_bit(struct lgdt3305_state *state,
171 u16 reg, int bit, int onoff)
176 lg_reg("reg: 0x%04x, bit: %d, level: %d\n", reg, bit, onoff);
178 ret = lgdt3305_read_reg(state, reg, &val);
183 val |= (onoff & 1) << bit;
185 ret = lgdt3305_write_reg(state, reg, val);
190 struct lgdt3305_reg {
195 static int lgdt3305_write_regs(struct lgdt3305_state *state,
196 struct lgdt3305_reg *regs, int len)
200 lg_reg("writing %d registers...\n", len);
202 for (i = 0; i < len - 1; i++) {
203 ret = lgdt3305_write_reg(state, regs[i].reg, regs[i].val);
210 /* ------------------------------------------------------------------------ */
212 static int lgdt3305_soft_reset(struct lgdt3305_state *state)
218 ret = lgdt3305_set_reg_bit(state, LGDT3305_GEN_CTRL_3, 0, 0);
223 ret = lgdt3305_set_reg_bit(state, LGDT3305_GEN_CTRL_3, 0, 1);
228 static inline int lgdt3305_mpeg_mode(struct lgdt3305_state *state,
229 enum lgdt3305_mpeg_mode mode)
231 lg_dbg("(%d)\n", mode);
232 return lgdt3305_set_reg_bit(state, LGDT3305_TP_CTRL_1, 5, mode);
235 static int lgdt3305_mpeg_mode_polarity(struct lgdt3305_state *state,
236 enum lgdt3305_tp_clock_edge edge,
237 enum lgdt3305_tp_valid_polarity valid)
242 lg_dbg("edge = %d, valid = %d\n", edge, valid);
244 ret = lgdt3305_read_reg(state, LGDT3305_TP_CTRL_1, &val);
255 ret = lgdt3305_write_reg(state, LGDT3305_TP_CTRL_1, val);
259 ret = lgdt3305_soft_reset(state);
264 static int lgdt3305_set_modulation(struct lgdt3305_state *state,
265 struct dvb_frontend_parameters *param)
272 ret = lgdt3305_read_reg(state, LGDT3305_GEN_CTRL_1, &opermode);
278 switch (param->u.vsb.modulation) {
291 ret = lgdt3305_write_reg(state, LGDT3305_GEN_CTRL_1, opermode);
296 static int lgdt3305_set_filter_extension(struct lgdt3305_state *state,
297 struct dvb_frontend_parameters *param)
301 switch (param->u.vsb.modulation) {
312 lg_dbg("val = %d\n", val);
314 return lgdt3305_set_reg_bit(state, 0x043f, 2, val);
317 /* ------------------------------------------------------------------------ */
319 static int lgdt3305_passband_digital_agc(struct lgdt3305_state *state,
320 struct dvb_frontend_parameters *param)
324 switch (param->u.vsb.modulation) {
338 lg_dbg("agc ref: 0x%04x\n", agc_ref);
340 lgdt3305_write_reg(state, LGDT3305_DGTL_AGC_REF_1, agc_ref >> 8);
341 lgdt3305_write_reg(state, LGDT3305_DGTL_AGC_REF_2, agc_ref & 0xff);
346 static int lgdt3305_rfagc_loop(struct lgdt3305_state *state,
347 struct dvb_frontend_parameters *param)
349 u16 ifbw, rfbw, agcdelay;
351 switch (param->u.vsb.modulation) {
361 if (state->cfg->demod_chip == LGDT3305)
370 if (state->cfg->rf_agc_loop) {
371 lg_dbg("agcdelay: 0x%04x, rfbw: 0x%04x\n", agcdelay, rfbw);
373 /* rf agc loop filter bandwidth */
374 lgdt3305_write_reg(state, LGDT3305_AGC_DELAY_PT_1,
376 lgdt3305_write_reg(state, LGDT3305_AGC_DELAY_PT_2,
379 lgdt3305_write_reg(state, LGDT3305_RFAGC_LOOP_FLTR_BW_1,
381 lgdt3305_write_reg(state, LGDT3305_RFAGC_LOOP_FLTR_BW_2,
384 lg_dbg("ifbw: 0x%04x\n", ifbw);
386 /* if agc loop filter bandwidth */
387 lgdt3305_write_reg(state, LGDT3305_IFBW_1, ifbw >> 8);
388 lgdt3305_write_reg(state, LGDT3305_IFBW_2, ifbw & 0xff);
394 static int lgdt3305_agc_setup(struct lgdt3305_state *state,
395 struct dvb_frontend_parameters *param)
399 switch (param->u.vsb.modulation) {
413 lg_dbg("lockdten = %d, acqen = %d\n", lockdten, acqen);
415 /* control agc function */
416 switch (state->cfg->demod_chip) {
418 lgdt3305_write_reg(state, 0x0314, 0xe1 | lockdten << 1);
419 lgdt3305_set_reg_bit(state, 0x030e, 2, acqen);
422 lgdt3305_write_reg(state, LGDT3305_AGC_CTRL_4, 0xe1 | lockdten << 1);
423 lgdt3305_set_reg_bit(state, LGDT3305_AGC_CTRL_1, 2, acqen);
429 return lgdt3305_rfagc_loop(state, param);
432 static int lgdt3305_set_agc_power_ref(struct lgdt3305_state *state,
433 struct dvb_frontend_parameters *param)
437 switch (param->u.vsb.modulation) {
439 if (state->cfg->usref_8vsb)
440 usref = state->cfg->usref_8vsb;
443 if (state->cfg->usref_qam64)
444 usref = state->cfg->usref_qam64;
447 if (state->cfg->usref_qam256)
448 usref = state->cfg->usref_qam256;
455 lg_dbg("set manual mode: 0x%04x\n", usref);
457 lgdt3305_set_reg_bit(state, LGDT3305_AGC_CTRL_1, 3, 1);
459 lgdt3305_write_reg(state, LGDT3305_AGC_POWER_REF_1,
460 0xff & (usref >> 8));
461 lgdt3305_write_reg(state, LGDT3305_AGC_POWER_REF_2,
462 0xff & (usref >> 0));
467 /* ------------------------------------------------------------------------ */
469 static int lgdt3305_spectral_inversion(struct lgdt3305_state *state,
470 struct dvb_frontend_parameters *param,
475 lg_dbg("(%d)\n", inversion);
477 switch (param->u.vsb.modulation) {
479 ret = lgdt3305_write_reg(state, LGDT3305_CR_CTRL_7,
480 inversion ? 0xf9 : 0x79);
484 ret = lgdt3305_write_reg(state, LGDT3305_FEC_BLOCK_CTRL,
485 inversion ? 0xfd : 0xff);
493 static int lgdt3305_set_if(struct lgdt3305_state *state,
494 struct dvb_frontend_parameters *param)
497 u8 nco1, nco2, nco3, nco4;
500 switch (param->u.vsb.modulation) {
502 if_freq_khz = state->cfg->vsb_if_khz;
506 if_freq_khz = state->cfg->qam_if_khz;
512 nco = if_freq_khz / 10;
514 switch (param->u.vsb.modulation) {
528 nco1 = (nco >> 24) & 0x3f;
530 nco2 = (nco >> 16) & 0xff;
531 nco3 = (nco >> 8) & 0xff;
534 lgdt3305_write_reg(state, LGDT3305_CR_CTR_FREQ_1, nco1);
535 lgdt3305_write_reg(state, LGDT3305_CR_CTR_FREQ_2, nco2);
536 lgdt3305_write_reg(state, LGDT3305_CR_CTR_FREQ_3, nco3);
537 lgdt3305_write_reg(state, LGDT3305_CR_CTR_FREQ_4, nco4);
539 lg_dbg("%d KHz -> [%02x%02x%02x%02x]\n",
540 if_freq_khz, nco1, nco2, nco3, nco4);
545 /* ------------------------------------------------------------------------ */
547 static int lgdt3305_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
549 struct lgdt3305_state *state = fe->demodulator_priv;
551 if (state->cfg->deny_i2c_rptr)
554 lg_dbg("(%d)\n", enable);
556 return lgdt3305_set_reg_bit(state, LGDT3305_GEN_CTRL_2, 5,
560 static int lgdt3304_sleep(struct dvb_frontend *fe)
565 static int lgdt3305_sleep(struct dvb_frontend *fe)
567 struct lgdt3305_state *state = fe->demodulator_priv;
568 u8 gen_ctrl_3, gen_ctrl_4;
572 gen_ctrl_3 = read_reg(state, LGDT3305_GEN_CTRL_3);
573 gen_ctrl_4 = read_reg(state, LGDT3305_GEN_CTRL_4);
575 /* hold in software reset while sleeping */
577 /* tristate the IF-AGC pin */
579 /* tristate the RF-AGC pin */
582 /* disable vsb/qam module */
584 /* disable adc module */
587 lgdt3305_write_reg(state, LGDT3305_GEN_CTRL_3, gen_ctrl_3);
588 lgdt3305_write_reg(state, LGDT3305_GEN_CTRL_4, gen_ctrl_4);
593 static int lgdt3304_init(struct dvb_frontend *fe)
595 struct lgdt3305_state *state = fe->demodulator_priv;
598 static struct lgdt3305_reg lgdt3304_init_data[] = {
599 { .reg = LGDT3305_GEN_CTRL_1, .val = 0x03, },
600 { .reg = 0x000d, .val = 0x02, },
601 { .reg = 0x000e, .val = 0x02, },
602 { .reg = LGDT3305_DGTL_AGC_REF_1, .val = 0x32, },
603 { .reg = LGDT3305_DGTL_AGC_REF_2, .val = 0xc4, },
604 { .reg = LGDT3305_CR_CTR_FREQ_1, .val = 0x00, },
605 { .reg = LGDT3305_CR_CTR_FREQ_2, .val = 0x00, },
606 { .reg = LGDT3305_CR_CTR_FREQ_3, .val = 0x00, },
607 { .reg = LGDT3305_CR_CTR_FREQ_4, .val = 0x00, },
608 { .reg = LGDT3305_CR_CTRL_7, .val = 0xf9, },
609 { .reg = 0x0112, .val = 0x17, },
610 { .reg = 0x0113, .val = 0x15, },
611 { .reg = 0x0114, .val = 0x18, },
612 { .reg = 0x0115, .val = 0xff, },
613 { .reg = 0x0116, .val = 0x3c, },
614 { .reg = 0x0214, .val = 0x67, },
615 { .reg = 0x0424, .val = 0x8d, },
616 { .reg = 0x0427, .val = 0x12, },
617 { .reg = 0x0428, .val = 0x4f, },
618 { .reg = LGDT3305_IFBW_1, .val = 0x80, },
619 { .reg = LGDT3305_IFBW_2, .val = 0x00, },
620 { .reg = 0x030a, .val = 0x08, },
621 { .reg = 0x030b, .val = 0x9b, },
622 { .reg = 0x030d, .val = 0x00, },
623 { .reg = 0x030e, .val = 0x1c, },
624 { .reg = 0x0314, .val = 0xe1, },
625 { .reg = 0x000d, .val = 0x82, },
626 { .reg = LGDT3305_TP_CTRL_1, .val = 0x5b, },
627 { .reg = LGDT3305_TP_CTRL_1, .val = 0x5b, },
632 ret = lgdt3305_write_regs(state, lgdt3304_init_data,
633 ARRAY_SIZE(lgdt3304_init_data));
637 ret = lgdt3305_soft_reset(state);
642 static int lgdt3305_init(struct dvb_frontend *fe)
644 struct lgdt3305_state *state = fe->demodulator_priv;
647 static struct lgdt3305_reg lgdt3305_init_data[] = {
648 { .reg = LGDT3305_GEN_CTRL_1,
650 { .reg = LGDT3305_GEN_CTRL_2,
652 { .reg = LGDT3305_GEN_CTRL_3,
654 { .reg = LGDT3305_GEN_CONTROL,
656 { .reg = LGDT3305_GEN_CTRL_4,
658 { .reg = LGDT3305_DGTL_AGC_REF_1,
660 { .reg = LGDT3305_DGTL_AGC_REF_2,
662 { .reg = LGDT3305_CR_CTR_FREQ_1,
664 { .reg = LGDT3305_CR_CTR_FREQ_2,
666 { .reg = LGDT3305_CR_CTR_FREQ_3,
668 { .reg = LGDT3305_CR_CTR_FREQ_4,
670 { .reg = LGDT3305_CR_CTRL_7,
672 { .reg = LGDT3305_AGC_POWER_REF_1,
674 { .reg = LGDT3305_AGC_POWER_REF_2,
676 { .reg = LGDT3305_AGC_DELAY_PT_1,
678 { .reg = LGDT3305_AGC_DELAY_PT_2,
680 { .reg = LGDT3305_RFAGC_LOOP_FLTR_BW_1,
682 { .reg = LGDT3305_RFAGC_LOOP_FLTR_BW_2,
684 { .reg = LGDT3305_IFBW_1,
686 { .reg = LGDT3305_IFBW_2,
688 { .reg = LGDT3305_AGC_CTRL_1,
690 { .reg = LGDT3305_AGC_CTRL_4,
692 { .reg = LGDT3305_FEC_BLOCK_CTRL,
694 { .reg = LGDT3305_TP_CTRL_1,
700 ret = lgdt3305_write_regs(state, lgdt3305_init_data,
701 ARRAY_SIZE(lgdt3305_init_data));
705 ret = lgdt3305_soft_reset(state);
710 static int lgdt3304_set_parameters(struct dvb_frontend *fe,
711 struct dvb_frontend_parameters *param)
713 struct lgdt3305_state *state = fe->demodulator_priv;
716 lg_dbg("(%d, %d)\n", param->frequency, param->u.vsb.modulation);
718 if (fe->ops.tuner_ops.set_params) {
719 ret = fe->ops.tuner_ops.set_params(fe, param);
720 if (fe->ops.i2c_gate_ctrl)
721 fe->ops.i2c_gate_ctrl(fe, 0);
724 state->current_frequency = param->frequency;
727 ret = lgdt3305_set_modulation(state, param);
731 ret = lgdt3305_passband_digital_agc(state, param);
735 ret = lgdt3305_agc_setup(state, param);
739 /* reg 0x030d is 3304-only... seen in vsb and qam usbsnoops... */
740 switch (param->u.vsb.modulation) {
742 lgdt3305_write_reg(state, 0x030d, 0x00);
743 lgdt3305_write_reg(state, LGDT3305_CR_CTR_FREQ_1, 0x4f);
744 lgdt3305_write_reg(state, LGDT3305_CR_CTR_FREQ_2, 0x0c);
745 lgdt3305_write_reg(state, LGDT3305_CR_CTR_FREQ_3, 0xac);
746 lgdt3305_write_reg(state, LGDT3305_CR_CTR_FREQ_4, 0xba);
750 lgdt3305_write_reg(state, 0x030d, 0x14);
751 ret = lgdt3305_set_if(state, param);
760 ret = lgdt3305_spectral_inversion(state, param,
761 state->cfg->spectral_inversion
766 state->current_modulation = param->u.vsb.modulation;
768 ret = lgdt3305_mpeg_mode(state, state->cfg->mpeg_mode);
772 /* lgdt3305_mpeg_mode_polarity calls lgdt3305_soft_reset */
773 ret = lgdt3305_mpeg_mode_polarity(state,
774 state->cfg->tpclk_edge,
775 state->cfg->tpvalid_polarity);
780 static int lgdt3305_set_parameters(struct dvb_frontend *fe,
781 struct dvb_frontend_parameters *param)
783 struct lgdt3305_state *state = fe->demodulator_priv;
786 lg_dbg("(%d, %d)\n", param->frequency, param->u.vsb.modulation);
788 if (fe->ops.tuner_ops.set_params) {
789 ret = fe->ops.tuner_ops.set_params(fe, param);
790 if (fe->ops.i2c_gate_ctrl)
791 fe->ops.i2c_gate_ctrl(fe, 0);
794 state->current_frequency = param->frequency;
797 ret = lgdt3305_set_modulation(state, param);
801 ret = lgdt3305_passband_digital_agc(state, param);
804 ret = lgdt3305_set_agc_power_ref(state, param);
807 ret = lgdt3305_agc_setup(state, param);
812 ret = lgdt3305_write_reg(state, LGDT3305_GEN_CONTROL, 0x2f);
815 ret = lgdt3305_set_reg_bit(state, LGDT3305_CR_CTR_FREQ_1, 6, 1);
819 ret = lgdt3305_set_if(state, param);
822 ret = lgdt3305_spectral_inversion(state, param,
823 state->cfg->spectral_inversion
828 ret = lgdt3305_set_filter_extension(state, param);
832 state->current_modulation = param->u.vsb.modulation;
834 ret = lgdt3305_mpeg_mode(state, state->cfg->mpeg_mode);
838 /* lgdt3305_mpeg_mode_polarity calls lgdt3305_soft_reset */
839 ret = lgdt3305_mpeg_mode_polarity(state,
840 state->cfg->tpclk_edge,
841 state->cfg->tpvalid_polarity);
846 static int lgdt3305_get_frontend(struct dvb_frontend *fe,
847 struct dvb_frontend_parameters *param)
849 struct lgdt3305_state *state = fe->demodulator_priv;
853 param->u.vsb.modulation = state->current_modulation;
854 param->frequency = state->current_frequency;
858 /* ------------------------------------------------------------------------ */
860 static int lgdt3305_read_cr_lock_status(struct lgdt3305_state *state,
865 char *cr_lock_state = "";
869 ret = lgdt3305_read_reg(state, LGDT3305_CR_LOCK_STATUS, &val);
873 switch (state->current_modulation) {
879 switch (val & 0x07) {
881 cr_lock_state = "QAM UNLOCK";
884 cr_lock_state = "QAM 1stLock";
887 cr_lock_state = "QAM 2ndLock";
890 cr_lock_state = "QAM FinalLock";
893 cr_lock_state = "CLOCKQAM-INVALID!";
898 if (val & (1 << 7)) {
900 cr_lock_state = "CLOCKVSB";
906 lg_dbg("(%d) %s\n", *locked, cr_lock_state);
911 static int lgdt3305_read_fec_lock_status(struct lgdt3305_state *state,
915 int ret, mpeg_lock, fec_lock, viterbi_lock;
919 switch (state->current_modulation) {
922 ret = lgdt3305_read_reg(state,
923 LGDT3305_FEC_LOCK_STATUS, &val);
927 mpeg_lock = (val & (1 << 0)) ? 1 : 0;
928 fec_lock = (val & (1 << 2)) ? 1 : 0;
929 viterbi_lock = (val & (1 << 3)) ? 1 : 0;
931 *locked = mpeg_lock && fec_lock && viterbi_lock;
933 lg_dbg("(%d) %s%s%s\n", *locked,
934 mpeg_lock ? "mpeg lock " : "",
935 fec_lock ? "fec lock " : "",
936 viterbi_lock ? "viterbi lock" : "");
946 static int lgdt3305_read_status(struct dvb_frontend *fe, fe_status_t *status)
948 struct lgdt3305_state *state = fe->demodulator_priv;
950 int ret, signal, inlock, nofecerr, snrgood,
951 cr_lock, fec_lock, sync_lock;
955 ret = lgdt3305_read_reg(state, LGDT3305_GEN_STATUS, &val);
959 signal = (val & (1 << 4)) ? 1 : 0;
960 inlock = (val & (1 << 3)) ? 0 : 1;
961 sync_lock = (val & (1 << 2)) ? 1 : 0;
962 nofecerr = (val & (1 << 1)) ? 1 : 0;
963 snrgood = (val & (1 << 0)) ? 1 : 0;
965 lg_dbg("%s%s%s%s%s\n",
966 signal ? "SIGNALEXIST " : "",
967 inlock ? "INLOCK " : "",
968 sync_lock ? "SYNCLOCK " : "",
969 nofecerr ? "NOFECERR " : "",
970 snrgood ? "SNRGOOD " : "");
972 ret = lgdt3305_read_cr_lock_status(state, &cr_lock);
977 *status |= FE_HAS_SIGNAL;
979 *status |= FE_HAS_CARRIER;
981 *status |= FE_HAS_VITERBI;
983 *status |= FE_HAS_SYNC;
985 switch (state->current_modulation) {
988 ret = lgdt3305_read_fec_lock_status(state, &fec_lock);
993 *status |= FE_HAS_LOCK;
997 *status |= FE_HAS_LOCK;
1006 /* ------------------------------------------------------------------------ */
1008 /* borrowed from lgdt330x.c */
1009 static u32 calculate_snr(u32 mse, u32 c)
1011 if (mse == 0) /* no signal */
1014 mse = intlog10(mse);
1016 /* Negative SNR, which is possible, but realisticly the
1017 demod will lose lock before the signal gets this bad. The
1018 API only allows for unsigned values, so just return 0 */
1021 return 10*(c - mse);
1024 static int lgdt3305_read_snr(struct dvb_frontend *fe, u16 *snr)
1026 struct lgdt3305_state *state = fe->demodulator_priv;
1027 u32 noise; /* noise value */
1028 u32 c; /* per-modulation SNR calculation constant */
1030 switch (state->current_modulation) {
1033 /* Use Phase Tracker Mean-Square Error Register */
1034 /* SNR for ranges from -13.11 to +44.08 */
1035 noise = ((read_reg(state, LGDT3305_PT_MSE_1) & 0x07) << 16) |
1036 (read_reg(state, LGDT3305_PT_MSE_2) << 8) |
1037 (read_reg(state, LGDT3305_PT_MSE_3) & 0xff);
1038 c = 73957994; /* log10(25*32^2)*2^24 */
1040 /* Use Equalizer Mean-Square Error Register */
1041 /* SNR for ranges from -16.12 to +44.08 */
1042 noise = ((read_reg(state, LGDT3305_EQ_MSE_1) & 0x0f) << 16) |
1043 (read_reg(state, LGDT3305_EQ_MSE_2) << 8) |
1044 (read_reg(state, LGDT3305_EQ_MSE_3) & 0xff);
1045 c = 73957994; /* log10(25*32^2)*2^24 */
1050 noise = (read_reg(state, LGDT3305_CR_MSE_1) << 8) |
1051 (read_reg(state, LGDT3305_CR_MSE_2) & 0xff);
1053 c = (state->current_modulation == QAM_64) ?
1054 97939837 : 98026066;
1055 /* log10(688128)*2^24 and log10(696320)*2^24 */
1060 state->snr = calculate_snr(noise, c);
1061 /* report SNR in dB * 10 */
1062 *snr = (state->snr / ((1 << 24) / 10));
1063 lg_dbg("noise = 0x%08x, snr = %d.%02d dB\n", noise,
1064 state->snr >> 24, (((state->snr >> 8) & 0xffff) * 100) >> 16);
1069 static int lgdt3305_read_signal_strength(struct dvb_frontend *fe,
1072 /* borrowed from lgdt330x.c
1074 * Calculate strength from SNR up to 35dB
1075 * Even though the SNR can go higher than 35dB,
1076 * there is some comfort factor in having a range of
1077 * strong signals that can show at 100%
1079 struct lgdt3305_state *state = fe->demodulator_priv;
1085 ret = fe->ops.read_snr(fe, &snr);
1088 /* Rather than use the 8.8 value snr, use state->snr which is 8.24 */
1089 /* scale the range 0 - 35*2^24 into 0 - 65535 */
1090 if (state->snr >= 8960 * 0x10000)
1093 *strength = state->snr / 8960;
1098 /* ------------------------------------------------------------------------ */
1100 static int lgdt3305_read_ber(struct dvb_frontend *fe, u32 *ber)
1106 static int lgdt3305_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
1108 struct lgdt3305_state *state = fe->demodulator_priv;
1111 (read_reg(state, LGDT3305_FEC_PKT_ERR_1) << 8) |
1112 (read_reg(state, LGDT3305_FEC_PKT_ERR_2) & 0xff);
1117 static int lgdt3305_get_tune_settings(struct dvb_frontend *fe,
1118 struct dvb_frontend_tune_settings
1121 fe_tune_settings->min_delay_ms = 500;
1126 static void lgdt3305_release(struct dvb_frontend *fe)
1128 struct lgdt3305_state *state = fe->demodulator_priv;
1133 static struct dvb_frontend_ops lgdt3304_ops;
1134 static struct dvb_frontend_ops lgdt3305_ops;
1136 struct dvb_frontend *lgdt3305_attach(const struct lgdt3305_config *config,
1137 struct i2c_adapter *i2c_adap)
1139 struct lgdt3305_state *state = NULL;
1143 lg_dbg("(%d-%04x)\n",
1144 i2c_adap ? i2c_adapter_id(i2c_adap) : 0,
1145 config ? config->i2c_addr : 0);
1147 state = kzalloc(sizeof(struct lgdt3305_state), GFP_KERNEL);
1151 state->cfg = config;
1152 state->i2c_adap = i2c_adap;
1154 switch (config->demod_chip) {
1156 memcpy(&state->frontend.ops, &lgdt3304_ops,
1157 sizeof(struct dvb_frontend_ops));
1160 memcpy(&state->frontend.ops, &lgdt3305_ops,
1161 sizeof(struct dvb_frontend_ops));
1166 state->frontend.demodulator_priv = state;
1168 /* verify that we're talking to a lg dt3304/5 */
1169 ret = lgdt3305_read_reg(state, LGDT3305_GEN_CTRL_2, &val);
1170 if ((lg_fail(ret)) | (val == 0))
1172 ret = lgdt3305_write_reg(state, 0x0808, 0x80);
1175 ret = lgdt3305_read_reg(state, 0x0808, &val);
1176 if ((lg_fail(ret)) | (val != 0x80))
1178 ret = lgdt3305_write_reg(state, 0x0808, 0x00);
1182 state->current_frequency = -1;
1183 state->current_modulation = -1;
1185 return &state->frontend;
1187 lg_warn("unable to detect %s hardware\n",
1188 config->demod_chip ? "LGDT3304" : "LGDT3305");
1192 EXPORT_SYMBOL(lgdt3305_attach);
1194 static struct dvb_frontend_ops lgdt3304_ops = {
1196 .name = "LG Electronics LGDT3304 VSB/QAM Frontend",
1198 .frequency_min = 54000000,
1199 .frequency_max = 858000000,
1200 .frequency_stepsize = 62500,
1201 .caps = FE_CAN_QAM_64 | FE_CAN_QAM_256 | FE_CAN_8VSB
1203 .i2c_gate_ctrl = lgdt3305_i2c_gate_ctrl,
1204 .init = lgdt3304_init,
1205 .sleep = lgdt3304_sleep,
1206 .set_frontend = lgdt3304_set_parameters,
1207 .get_frontend = lgdt3305_get_frontend,
1208 .get_tune_settings = lgdt3305_get_tune_settings,
1209 .read_status = lgdt3305_read_status,
1210 .read_ber = lgdt3305_read_ber,
1211 .read_signal_strength = lgdt3305_read_signal_strength,
1212 .read_snr = lgdt3305_read_snr,
1213 .read_ucblocks = lgdt3305_read_ucblocks,
1214 .release = lgdt3305_release,
1217 static struct dvb_frontend_ops lgdt3305_ops = {
1219 .name = "LG Electronics LGDT3305 VSB/QAM Frontend",
1221 .frequency_min = 54000000,
1222 .frequency_max = 858000000,
1223 .frequency_stepsize = 62500,
1224 .caps = FE_CAN_QAM_64 | FE_CAN_QAM_256 | FE_CAN_8VSB
1226 .i2c_gate_ctrl = lgdt3305_i2c_gate_ctrl,
1227 .init = lgdt3305_init,
1228 .sleep = lgdt3305_sleep,
1229 .set_frontend = lgdt3305_set_parameters,
1230 .get_frontend = lgdt3305_get_frontend,
1231 .get_tune_settings = lgdt3305_get_tune_settings,
1232 .read_status = lgdt3305_read_status,
1233 .read_ber = lgdt3305_read_ber,
1234 .read_signal_strength = lgdt3305_read_signal_strength,
1235 .read_snr = lgdt3305_read_snr,
1236 .read_ucblocks = lgdt3305_read_ucblocks,
1237 .release = lgdt3305_release,
1240 MODULE_DESCRIPTION("LG Electronics LGDT3304/5 ATSC/QAM-B Demodulator Driver");
1241 MODULE_AUTHOR("Michael Krufky <mkrufky@linuxtv.org>");
1242 MODULE_LICENSE("GPL");
1243 MODULE_VERSION("0.1");