2 Driver for Zarlink VP310/MT312 Satellite Channel Decoder
4 Copyright (C) 2003 Andreas Oberritter <obi@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
15 GNU General Public License for more details.
17 You should have received a copy of the GNU General Public License
18 along with this program; if not, write to the Free Software
19 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 http://products.zarlink.com/product_profiles/MT312.htm
23 http://products.zarlink.com/product_profiles/SL1935.htm
26 #include <linux/delay.h>
27 #include <linux/errno.h>
28 #include <linux/init.h>
29 #include <linux/kernel.h>
30 #include <linux/module.h>
31 #include <linux/moduleparam.h>
33 #include "dvb_frontend.h"
34 #include "mt312_priv.h"
39 struct i2c_adapter
* i2c
;
40 struct dvb_frontend_ops ops
;
41 /* configuration settings */
42 const struct mt312_config
* config
;
43 struct dvb_frontend frontend
;
50 #define dprintk(args...) \
52 if (debug) printk(KERN_DEBUG "mt312: " args); \
55 #define MT312_SYS_CLK 90000000UL /* 90 MHz */
56 #define MT312_LPOWER_SYS_CLK 60000000UL /* 60 MHz */
57 #define MT312_PLL_CLK 10000000UL /* 10 MHz */
59 static int mt312_read(struct mt312_state
* state
, const enum mt312_reg_addr reg
,
60 void *buf
, const size_t count
)
63 struct i2c_msg msg
[2];
64 u8 regbuf
[1] = { reg
};
66 msg
[0].addr
= state
->config
->demod_address
;
70 msg
[1].addr
= state
->config
->demod_address
;
71 msg
[1].flags
= I2C_M_RD
;
75 ret
= i2c_transfer(state
->i2c
, msg
, 2);
78 printk(KERN_ERR
"%s: ret == %d\n", __FUNCTION__
, ret
);
84 dprintk("R(%d):", reg
& 0x7f);
85 for (i
= 0; i
< count
; i
++)
86 printk(" %02x", ((const u8
*) buf
)[i
]);
93 static int mt312_write(struct mt312_state
* state
, const enum mt312_reg_addr reg
,
94 const void *src
, const size_t count
)
102 dprintk("W(%d):", reg
& 0x7f);
103 for (i
= 0; i
< count
; i
++)
104 printk(" %02x", ((const u8
*) src
)[i
]);
109 memcpy(&buf
[1], src
, count
);
111 msg
.addr
= state
->config
->demod_address
;
116 ret
= i2c_transfer(state
->i2c
, &msg
, 1);
119 dprintk("%s: ret == %d\n", __FUNCTION__
, ret
);
126 static inline int mt312_readreg(struct mt312_state
* state
,
127 const enum mt312_reg_addr reg
, u8
*val
)
129 return mt312_read(state
, reg
, val
, 1);
132 static inline int mt312_writereg(struct mt312_state
* state
,
133 const enum mt312_reg_addr reg
, const u8 val
)
135 return mt312_write(state
, reg
, &val
, 1);
138 static inline u32
mt312_div(u32 a
, u32 b
)
140 return (a
+ (b
/ 2)) / b
;
143 static int mt312_reset(struct mt312_state
* state
, const u8 full
)
145 return mt312_writereg(state
, RESET
, full
? 0x80 : 0x40);
148 static int mt312_get_inversion(struct mt312_state
* state
,
149 fe_spectral_inversion_t
*i
)
154 if ((ret
= mt312_readreg(state
, VIT_MODE
, &vit_mode
)) < 0)
157 if (vit_mode
& 0x80) /* auto inversion was used */
158 *i
= (vit_mode
& 0x40) ? INVERSION_ON
: INVERSION_OFF
;
163 static int mt312_get_symbol_rate(struct mt312_state
* state
, u32
*sr
)
172 if ((ret
= mt312_readreg(state
, SYM_RATE_H
, &sym_rate_h
)) < 0)
175 if (sym_rate_h
& 0x80) { /* symbol rate search was used */
176 if ((ret
= mt312_writereg(state
, MON_CTRL
, 0x03)) < 0)
179 if ((ret
= mt312_read(state
, MONITOR_H
, buf
, sizeof(buf
))) < 0)
182 monitor
= (buf
[0] << 8) | buf
[1];
184 dprintk(KERN_DEBUG
"sr(auto) = %u\n",
185 mt312_div(monitor
* 15625, 4));
187 if ((ret
= mt312_writereg(state
, MON_CTRL
, 0x05)) < 0)
190 if ((ret
= mt312_read(state
, MONITOR_H
, buf
, sizeof(buf
))) < 0)
193 dec_ratio
= ((buf
[0] >> 5) & 0x07) * 32;
195 if ((ret
= mt312_read(state
, SYM_RAT_OP_H
, buf
, sizeof(buf
))) < 0)
198 sym_rat_op
= (buf
[0] << 8) | buf
[1];
200 dprintk(KERN_DEBUG
"sym_rat_op=%d dec_ratio=%d\n",
201 sym_rat_op
, dec_ratio
);
202 dprintk(KERN_DEBUG
"*sr(manual) = %lu\n",
203 (((MT312_PLL_CLK
* 8192) / (sym_rat_op
+ 8192)) *
210 static int mt312_get_code_rate(struct mt312_state
* state
, fe_code_rate_t
*cr
)
212 const fe_code_rate_t fec_tab
[8] =
213 { FEC_1_2
, FEC_2_3
, FEC_3_4
, FEC_5_6
, FEC_6_7
, FEC_7_8
,
214 FEC_AUTO
, FEC_AUTO
};
219 if ((ret
= mt312_readreg(state
, FEC_STATUS
, &fec_status
)) < 0)
222 *cr
= fec_tab
[(fec_status
>> 4) & 0x07];
227 static int mt312_initfe(struct dvb_frontend
* fe
)
229 struct mt312_state
*state
= fe
->demodulator_priv
;
234 if ((ret
= mt312_writereg(state
, CONFIG
, (state
->frequency
== 60 ? 0x88 : 0x8c))) < 0)
237 /* wait at least 150 usec */
241 if ((ret
= mt312_reset(state
, 1)) < 0)
244 // Per datasheet, write correct values. 09/28/03 ACCJr.
245 // If we don't do this, we won't get FE_HAS_VITERBI in the VP310.
247 u8 buf_def
[8]={0x14, 0x12, 0x03, 0x02, 0x01, 0x00, 0x00, 0x00};
249 if ((ret
= mt312_write(state
, VIT_SETUP
, buf_def
, sizeof(buf_def
))) < 0)
254 buf
[0] = mt312_div((state
->frequency
== 60 ? MT312_LPOWER_SYS_CLK
: MT312_SYS_CLK
) * 2, 1000000);
257 buf
[1] = mt312_div(MT312_PLL_CLK
, 15000 * 4);
259 if ((ret
= mt312_write(state
, SYS_CLK
, buf
, sizeof(buf
))) < 0)
262 if ((ret
= mt312_writereg(state
, SNR_THS_HIGH
, 0x32)) < 0)
265 if ((ret
= mt312_writereg(state
, OP_CTRL
, 0x53)) < 0)
272 if ((ret
= mt312_write(state
, TS_SW_LIM_L
, buf
, sizeof(buf
))) < 0)
275 if ((ret
= mt312_writereg(state
, CS_SW_LIM
, 0x69)) < 0)
278 if (state
->config
->pll_init
) {
279 mt312_writereg(state
, GPP_CTRL
, 0x40);
280 state
->config
->pll_init(fe
);
281 mt312_writereg(state
, GPP_CTRL
, 0x00);
287 static int mt312_send_master_cmd(struct dvb_frontend
* fe
,
288 struct dvb_diseqc_master_cmd
*c
)
290 struct mt312_state
*state
= fe
->demodulator_priv
;
294 if ((c
->msg_len
== 0) || (c
->msg_len
> sizeof(c
->msg
)))
297 if ((ret
= mt312_readreg(state
, DISEQC_MODE
, &diseqc_mode
)) < 0)
301 mt312_write(state
, (0x80 | DISEQC_INSTR
), c
->msg
, c
->msg_len
)) < 0)
305 mt312_writereg(state
, DISEQC_MODE
,
306 (diseqc_mode
& 0x40) | ((c
->msg_len
- 1) << 3)
310 /* set DISEQC_MODE[2:0] to zero if a return message is expected */
311 if (c
->msg
[0] & 0x02)
313 mt312_writereg(state
, DISEQC_MODE
, (diseqc_mode
& 0x40))) < 0)
319 static int mt312_send_burst(struct dvb_frontend
* fe
, const fe_sec_mini_cmd_t c
)
321 struct mt312_state
*state
= fe
->demodulator_priv
;
322 const u8 mini_tab
[2] = { 0x02, 0x03 };
330 if ((ret
= mt312_readreg(state
, DISEQC_MODE
, &diseqc_mode
)) < 0)
334 mt312_writereg(state
, DISEQC_MODE
,
335 (diseqc_mode
& 0x40) | mini_tab
[c
])) < 0)
341 static int mt312_set_tone(struct dvb_frontend
* fe
, const fe_sec_tone_mode_t t
)
343 struct mt312_state
*state
= fe
->demodulator_priv
;
344 const u8 tone_tab
[2] = { 0x01, 0x00 };
349 if (t
> SEC_TONE_OFF
)
352 if ((ret
= mt312_readreg(state
, DISEQC_MODE
, &diseqc_mode
)) < 0)
356 mt312_writereg(state
, DISEQC_MODE
,
357 (diseqc_mode
& 0x40) | tone_tab
[t
])) < 0)
363 static int mt312_set_voltage(struct dvb_frontend
* fe
, const fe_sec_voltage_t v
)
365 struct mt312_state
*state
= fe
->demodulator_priv
;
366 const u8 volt_tab
[3] = { 0x00, 0x40, 0x00 };
368 if (v
> SEC_VOLTAGE_OFF
)
371 return mt312_writereg(state
, DISEQC_MODE
, volt_tab
[v
]);
374 static int mt312_read_status(struct dvb_frontend
* fe
, fe_status_t
*s
)
376 struct mt312_state
*state
= fe
->demodulator_priv
;
382 if ((ret
= mt312_read(state
, QPSK_STAT_H
, status
, sizeof(status
))) < 0)
385 dprintk(KERN_DEBUG
"QPSK_STAT_H: 0x%02x, QPSK_STAT_L: 0x%02x, FEC_STATUS: 0x%02x\n", status
[0], status
[1], status
[2]);
387 if (status
[0] & 0xc0)
388 *s
|= FE_HAS_SIGNAL
; /* signal noise ratio */
389 if (status
[0] & 0x04)
390 *s
|= FE_HAS_CARRIER
; /* qpsk carrier lock */
391 if (status
[2] & 0x02)
392 *s
|= FE_HAS_VITERBI
; /* viterbi lock */
393 if (status
[2] & 0x04)
394 *s
|= FE_HAS_SYNC
; /* byte align lock */
395 if (status
[0] & 0x01)
396 *s
|= FE_HAS_LOCK
; /* qpsk lock */
401 static int mt312_read_ber(struct dvb_frontend
* fe
, u32
*ber
)
403 struct mt312_state
*state
= fe
->demodulator_priv
;
407 if ((ret
= mt312_read(state
, RS_BERCNT_H
, buf
, 3)) < 0)
410 *ber
= ((buf
[0] << 16) | (buf
[1] << 8) | buf
[2]) * 64;
415 static int mt312_read_signal_strength(struct dvb_frontend
* fe
, u16
*signal_strength
)
417 struct mt312_state
*state
= fe
->demodulator_priv
;
423 if ((ret
= mt312_read(state
, AGC_H
, buf
, sizeof(buf
))) < 0)
426 agc
= (buf
[0] << 6) | (buf
[1] >> 2);
427 err_db
= (s16
) (((buf
[1] & 0x03) << 14) | buf
[2] << 6) >> 6;
429 *signal_strength
= agc
;
431 dprintk(KERN_DEBUG
"agc=%08x err_db=%hd\n", agc
, err_db
);
436 static int mt312_read_snr(struct dvb_frontend
* fe
, u16
*snr
)
438 struct mt312_state
*state
= fe
->demodulator_priv
;
442 if ((ret
= mt312_read(state
, M_SNR_H
, &buf
, sizeof(buf
))) < 0)
445 *snr
= 0xFFFF - ((((buf
[0] & 0x7f) << 8) | buf
[1]) << 1);
450 static int mt312_read_ucblocks(struct dvb_frontend
* fe
, u32
*ubc
)
452 struct mt312_state
*state
= fe
->demodulator_priv
;
456 if ((ret
= mt312_read(state
, RS_UBC_H
, &buf
, sizeof(buf
))) < 0)
459 *ubc
= (buf
[0] << 8) | buf
[1];
464 static int mt312_set_frontend(struct dvb_frontend
* fe
,
465 struct dvb_frontend_parameters
*p
)
467 struct mt312_state
*state
= fe
->demodulator_priv
;
469 u8 buf
[5], config_val
;
472 const u8 fec_tab
[10] =
473 { 0x00, 0x01, 0x02, 0x04, 0x3f, 0x08, 0x10, 0x20, 0x3f, 0x3f };
474 const u8 inv_tab
[3] = { 0x00, 0x40, 0x80 };
476 dprintk("%s: Freq %d\n", __FUNCTION__
, p
->frequency
);
478 if ((p
->frequency
< fe
->ops
->info
.frequency_min
)
479 || (p
->frequency
> fe
->ops
->info
.frequency_max
))
482 if ((p
->inversion
< INVERSION_OFF
)
483 || (p
->inversion
> INVERSION_ON
))
486 if ((p
->u
.qpsk
.symbol_rate
< fe
->ops
->info
.symbol_rate_min
)
487 || (p
->u
.qpsk
.symbol_rate
> fe
->ops
->info
.symbol_rate_max
))
490 if ((p
->u
.qpsk
.fec_inner
< FEC_NONE
)
491 || (p
->u
.qpsk
.fec_inner
> FEC_AUTO
))
494 if ((p
->u
.qpsk
.fec_inner
== FEC_4_5
)
495 || (p
->u
.qpsk
.fec_inner
== FEC_8_9
))
500 // For now we will do this only for the VP310.
501 // It should be better for the mt312 as well, but tunning will be slower. ACCJr 09/29/03
502 if ((ret
= mt312_readreg(state
, CONFIG
, &config_val
) < 0))
504 if (p
->u
.qpsk
.symbol_rate
>= 30000000) //Note that 30MS/s should use 90MHz
506 if ((config_val
& 0x0c) == 0x08) { //We are running 60MHz
507 state
->frequency
= 90;
508 if ((ret
= mt312_initfe(fe
)) < 0)
514 if ((config_val
& 0x0c) == 0x0C) { //We are running 90MHz
515 state
->frequency
= 60;
516 if ((ret
= mt312_initfe(fe
)) < 0)
529 mt312_writereg(state
, GPP_CTRL
, 0x40);
530 state
->config
->pll_set(fe
, p
);
531 mt312_writereg(state
, GPP_CTRL
, 0x00);
533 /* sr = (u16)(sr * 256.0 / 1000000.0) */
534 sr
= mt312_div(p
->u
.qpsk
.symbol_rate
* 4, 15625);
537 buf
[0] = (sr
>> 8) & 0x3f;
538 buf
[1] = (sr
>> 0) & 0xff;
541 buf
[2] = inv_tab
[p
->inversion
] | fec_tab
[p
->u
.qpsk
.fec_inner
];
544 buf
[3] = 0x40; /* swap I and Q before QPSK demodulation */
546 if (p
->u
.qpsk
.symbol_rate
< 10000000)
547 buf
[3] |= 0x04; /* use afc mode */
552 if ((ret
= mt312_write(state
, SYM_RATE_H
, buf
, sizeof(buf
))) < 0)
555 mt312_reset(state
, 0);
560 static int mt312_get_frontend(struct dvb_frontend
* fe
,
561 struct dvb_frontend_parameters
*p
)
563 struct mt312_state
*state
= fe
->demodulator_priv
;
566 if ((ret
= mt312_get_inversion(state
, &p
->inversion
)) < 0)
569 if ((ret
= mt312_get_symbol_rate(state
, &p
->u
.qpsk
.symbol_rate
)) < 0)
572 if ((ret
= mt312_get_code_rate(state
, &p
->u
.qpsk
.fec_inner
)) < 0)
578 static int mt312_sleep(struct dvb_frontend
* fe
)
580 struct mt312_state
*state
= fe
->demodulator_priv
;
584 /* reset all registers to defaults */
585 if ((ret
= mt312_reset(state
, 1)) < 0)
588 if ((ret
= mt312_readreg(state
, CONFIG
, &config
)) < 0)
592 if ((ret
= mt312_writereg(state
, CONFIG
, config
& 0x7f)) < 0)
598 static int mt312_get_tune_settings(struct dvb_frontend
* fe
, struct dvb_frontend_tune_settings
* fesettings
)
600 fesettings
->min_delay_ms
= 50;
601 fesettings
->step_size
= 0;
602 fesettings
->max_drift
= 0;
606 static void mt312_release(struct dvb_frontend
* fe
)
608 struct mt312_state
* state
= fe
->demodulator_priv
;
612 static struct dvb_frontend_ops vp310_mt312_ops
;
614 struct dvb_frontend
* vp310_attach(const struct mt312_config
* config
,
615 struct i2c_adapter
* i2c
)
617 struct mt312_state
* state
= NULL
;
619 /* allocate memory for the internal state */
620 state
= kmalloc(sizeof(struct mt312_state
), GFP_KERNEL
);
624 /* setup the state */
625 state
->config
= config
;
627 memcpy(&state
->ops
, &vp310_mt312_ops
, sizeof(struct dvb_frontend_ops
));
628 strcpy(state
->ops
.info
.name
, "Zarlink VP310 DVB-S");
630 /* check if the demod is there */
631 if (mt312_readreg(state
, ID
, &state
->id
) < 0)
633 if (state
->id
!= ID_VP310
) {
637 /* create dvb_frontend */
638 state
->frequency
= 90;
639 state
->frontend
.ops
= &state
->ops
;
640 state
->frontend
.demodulator_priv
= state
;
641 return &state
->frontend
;
648 struct dvb_frontend
* mt312_attach(const struct mt312_config
* config
,
649 struct i2c_adapter
* i2c
)
651 struct mt312_state
* state
= NULL
;
653 /* allocate memory for the internal state */
654 state
= kmalloc(sizeof(struct mt312_state
), GFP_KERNEL
);
658 /* setup the state */
659 state
->config
= config
;
661 memcpy(&state
->ops
, &vp310_mt312_ops
, sizeof(struct dvb_frontend_ops
));
662 strcpy(state
->ops
.info
.name
, "Zarlink MT312 DVB-S");
664 /* check if the demod is there */
665 if (mt312_readreg(state
, ID
, &state
->id
) < 0)
667 if (state
->id
!= ID_MT312
) {
671 /* create dvb_frontend */
672 state
->frequency
= 60;
673 state
->frontend
.ops
= &state
->ops
;
674 state
->frontend
.demodulator_priv
= state
;
675 return &state
->frontend
;
683 static struct dvb_frontend_ops vp310_mt312_ops
= {
686 .name
= "Zarlink ???? DVB-S",
688 .frequency_min
= 950000,
689 .frequency_max
= 2150000,
690 .frequency_stepsize
= (MT312_PLL_CLK
/ 1000) / 128,
691 .symbol_rate_min
= MT312_SYS_CLK
/ 128,
692 .symbol_rate_max
= MT312_SYS_CLK
/ 2,
694 FE_CAN_FEC_1_2
| FE_CAN_FEC_2_3
|
695 FE_CAN_FEC_3_4
| FE_CAN_FEC_5_6
| FE_CAN_FEC_7_8
|
696 FE_CAN_FEC_AUTO
| FE_CAN_QPSK
| FE_CAN_MUTE_TS
|
700 .release
= mt312_release
,
702 .init
= mt312_initfe
,
703 .sleep
= mt312_sleep
,
705 .set_frontend
= mt312_set_frontend
,
706 .get_frontend
= mt312_get_frontend
,
707 .get_tune_settings
= mt312_get_tune_settings
,
709 .read_status
= mt312_read_status
,
710 .read_ber
= mt312_read_ber
,
711 .read_signal_strength
= mt312_read_signal_strength
,
712 .read_snr
= mt312_read_snr
,
713 .read_ucblocks
= mt312_read_ucblocks
,
715 .diseqc_send_master_cmd
= mt312_send_master_cmd
,
716 .diseqc_send_burst
= mt312_send_burst
,
717 .set_tone
= mt312_set_tone
,
718 .set_voltage
= mt312_set_voltage
,
721 module_param(debug
, int, 0644);
722 MODULE_PARM_DESC(debug
, "Turn on/off frontend debugging (default:off).");
724 MODULE_DESCRIPTION("Zarlink VP310/MT312 DVB-S Demodulator driver");
725 MODULE_AUTHOR("Andreas Oberritter <obi@linuxtv.org>");
726 MODULE_LICENSE("GPL");
728 EXPORT_SYMBOL(mt312_attach
);
729 EXPORT_SYMBOL(vp310_attach
);