1 // SPDX-License-Identifier: GPL-2.0-or-later
3 Driver for Philips tda10086 DVBS Demodulator
5 (c) 2006 Andrew de Quincey
10 #include <linux/init.h>
11 #include <linux/module.h>
12 #include <linux/device.h>
13 #include <linux/jiffies.h>
14 #include <linux/string.h>
15 #include <linux/slab.h>
17 #include <media/dvb_frontend.h>
20 #define SACLK 96000000
22 struct tda10086_state
{
23 struct i2c_adapter
* i2c
;
24 const struct tda10086_config
* config
;
25 struct dvb_frontend frontend
;
27 /* private demod data */
34 #define dprintk(args...) \
36 if (debug) printk(KERN_DEBUG "tda10086: " args); \
39 static int tda10086_write_byte(struct tda10086_state
*state
, int reg
, int data
)
42 u8 b0
[] = { reg
, data
};
43 struct i2c_msg msg
= { .flags
= 0, .buf
= b0
, .len
= 2 };
45 msg
.addr
= state
->config
->demod_address
;
46 ret
= i2c_transfer(state
->i2c
, &msg
, 1);
49 dprintk("%s: error reg=0x%x, data=0x%x, ret=%i\n",
50 __func__
, reg
, data
, ret
);
52 return (ret
!= 1) ? ret
: 0;
55 static int tda10086_read_byte(struct tda10086_state
*state
, int reg
)
60 struct i2c_msg msg
[] = {{ .flags
= 0, .buf
= b0
, .len
= 1 },
61 { .flags
= I2C_M_RD
, .buf
= b1
, .len
= 1 }};
63 msg
[0].addr
= state
->config
->demod_address
;
64 msg
[1].addr
= state
->config
->demod_address
;
65 ret
= i2c_transfer(state
->i2c
, msg
, 2);
68 dprintk("%s: error reg=0x%x, ret=%i\n", __func__
, reg
,
76 static int tda10086_write_mask(struct tda10086_state
*state
, int reg
, int mask
, int data
)
80 /* read a byte and check */
81 val
= tda10086_read_byte(state
, reg
);
89 /* write it out again */
90 return tda10086_write_byte(state
, reg
, val
);
93 static int tda10086_init(struct dvb_frontend
* fe
)
95 struct tda10086_state
* state
= fe
->demodulator_priv
;
98 dprintk ("%s\n", __func__
);
100 if (state
->config
->diseqc_tone
)
103 tda10086_write_byte(state
, 0x00, 0x00);
107 tda10086_write_byte(state
, 0x01, 0x94);
108 tda10086_write_byte(state
, 0x02, 0x35); /* NOTE: TT drivers appear to disable CSWP */
109 tda10086_write_byte(state
, 0x03, 0xe4);
110 tda10086_write_byte(state
, 0x04, 0x43);
111 tda10086_write_byte(state
, 0x0c, 0x0c);
112 tda10086_write_byte(state
, 0x1b, 0xb0); /* noise threshold */
113 tda10086_write_byte(state
, 0x20, 0x89); /* misc */
114 tda10086_write_byte(state
, 0x30, 0x04); /* acquisition period length */
115 tda10086_write_byte(state
, 0x32, 0x00); /* irq off */
116 tda10086_write_byte(state
, 0x31, 0x56); /* setup AFC */
118 /* setup PLL (this assumes SACLK = 96MHz) */
119 tda10086_write_byte(state
, 0x55, 0x2c); /* misc PLL setup */
120 if (state
->config
->xtal_freq
== TDA10086_XTAL_16M
) {
121 tda10086_write_byte(state
, 0x3a, 0x0b); /* M=12 */
122 tda10086_write_byte(state
, 0x3b, 0x01); /* P=2 */
124 tda10086_write_byte(state
, 0x3a, 0x17); /* M=24 */
125 tda10086_write_byte(state
, 0x3b, 0x00); /* P=1 */
127 tda10086_write_mask(state
, 0x55, 0x20, 0x00); /* powerup PLL */
129 /* setup TS interface */
130 tda10086_write_byte(state
, 0x11, 0x81);
131 tda10086_write_byte(state
, 0x12, 0x81);
132 tda10086_write_byte(state
, 0x19, 0x40); /* parallel mode A + MSBFIRST */
133 tda10086_write_byte(state
, 0x56, 0x80); /* powerdown WPLL - unused in the mode we use */
134 tda10086_write_byte(state
, 0x57, 0x08); /* bypass WPLL - unused in the mode we use */
135 tda10086_write_byte(state
, 0x10, 0x2a);
138 tda10086_write_byte(state
, 0x58, 0x61); /* ADC setup */
139 tda10086_write_mask(state
, 0x58, 0x01, 0x00); /* powerup ADC */
142 tda10086_write_byte(state
, 0x05, 0x0B);
143 tda10086_write_byte(state
, 0x37, 0x63);
144 tda10086_write_byte(state
, 0x3f, 0x0a); /* NOTE: flydvb varies it */
145 tda10086_write_byte(state
, 0x40, 0x64);
146 tda10086_write_byte(state
, 0x41, 0x4f);
147 tda10086_write_byte(state
, 0x42, 0x43);
150 tda10086_write_byte(state
, 0x1a, 0x11); /* VBER 10^6, DVB, QPSK */
152 /* setup carrier recovery */
153 tda10086_write_byte(state
, 0x3d, 0x80);
156 tda10086_write_byte(state
, 0x36, t22k_off
); /* all SEC off, 22k tone */
157 tda10086_write_byte(state
, 0x34, (((1<<19) * (22000/1000)) / (SACLK
/1000)));
158 tda10086_write_byte(state
, 0x35, (((1<<19) * (22000/1000)) / (SACLK
/1000)) >> 8);
163 static void tda10086_diseqc_wait(struct tda10086_state
*state
)
165 unsigned long timeout
= jiffies
+ msecs_to_jiffies(200);
166 while (!(tda10086_read_byte(state
, 0x50) & 0x01)) {
167 if(time_after(jiffies
, timeout
)) {
168 printk("%s: diseqc queue not ready, command may be lost.\n", __func__
);
175 static int tda10086_set_tone(struct dvb_frontend
*fe
,
176 enum fe_sec_tone_mode tone
)
178 struct tda10086_state
* state
= fe
->demodulator_priv
;
181 dprintk ("%s\n", __func__
);
183 if (state
->config
->diseqc_tone
)
188 tda10086_write_byte(state
, 0x36, t22k_off
);
192 tda10086_write_byte(state
, 0x36, 0x01 + t22k_off
);
199 static int tda10086_send_master_cmd (struct dvb_frontend
* fe
,
200 struct dvb_diseqc_master_cmd
* cmd
)
202 struct tda10086_state
* state
= fe
->demodulator_priv
;
207 dprintk ("%s\n", __func__
);
209 if (state
->config
->diseqc_tone
)
212 if (cmd
->msg_len
> 6)
214 oldval
= tda10086_read_byte(state
, 0x36);
216 for(i
=0; i
< cmd
->msg_len
; i
++) {
217 tda10086_write_byte(state
, 0x48+i
, cmd
->msg
[i
]);
219 tda10086_write_byte(state
, 0x36, (0x08 + t22k_off
)
220 | ((cmd
->msg_len
- 1) << 4));
222 tda10086_diseqc_wait(state
);
224 tda10086_write_byte(state
, 0x36, oldval
);
229 static int tda10086_send_burst(struct dvb_frontend
*fe
,
230 enum fe_sec_mini_cmd minicmd
)
232 struct tda10086_state
* state
= fe
->demodulator_priv
;
233 u8 oldval
= tda10086_read_byte(state
, 0x36);
236 dprintk ("%s\n", __func__
);
238 if (state
->config
->diseqc_tone
)
243 tda10086_write_byte(state
, 0x36, 0x04 + t22k_off
);
247 tda10086_write_byte(state
, 0x36, 0x06 + t22k_off
);
251 tda10086_diseqc_wait(state
);
253 tda10086_write_byte(state
, 0x36, oldval
);
258 static int tda10086_set_inversion(struct tda10086_state
*state
,
259 struct dtv_frontend_properties
*fe_params
)
263 dprintk ("%s %i %i\n", __func__
, fe_params
->inversion
, state
->config
->invert
);
265 switch(fe_params
->inversion
) {
267 if (state
->config
->invert
)
271 if (!state
->config
->invert
)
278 tda10086_write_mask(state
, 0x0c, 0xc0, invval
);
283 static int tda10086_set_symbol_rate(struct tda10086_state
*state
,
284 struct dtv_frontend_properties
*fe_params
)
295 u32 symbol_rate
= fe_params
->symbol_rate
;
297 dprintk ("%s %i\n", __func__
, symbol_rate
);
299 /* setup the decimation and anti-aliasing filters.. */
300 if (symbol_rate
< (u32
) (SACLK
* 0.0137)) {
303 } else if (symbol_rate
< (u32
) (SACLK
* 0.0208)) {
306 } else if (symbol_rate
< (u32
) (SACLK
* 0.0270)) {
309 } else if (symbol_rate
< (u32
) (SACLK
* 0.0416)) {
312 } else if (symbol_rate
< (u32
) (SACLK
* 0.0550)) {
315 } else if (symbol_rate
< (u32
) (SACLK
* 0.0833)) {
318 } else if (symbol_rate
< (u32
) (SACLK
* 0.1100)) {
321 } else if (symbol_rate
< (u32
) (SACLK
* 0.1666)) {
324 } else if (symbol_rate
< (u32
) (SACLK
* 0.2200)) {
327 } else if (symbol_rate
< (u32
) (SACLK
* 0.3333)) {
337 big
= (1ULL<<21) * ((u64
) symbol_rate
/1000ULL) * (1ULL<<dfn
);
338 big
+= ((SACLK
/1000ULL)-1ULL);
339 do_div(big
, (SACLK
/1000ULL));
343 tmp
= (1<<dfn
)*(symbol_rate
/1000);
344 bdri
= ((32 * (SACLK
/1000)) + (tmp
-1)) / tmp
;
346 tda10086_write_byte(state
, 0x21, (afs
<< 7) | dfn
);
347 tda10086_write_mask(state
, 0x20, 0x08, byp
<< 3);
348 tda10086_write_byte(state
, 0x06, bdr
);
349 tda10086_write_byte(state
, 0x07, bdr
>> 8);
350 tda10086_write_byte(state
, 0x08, bdr
>> 16);
351 tda10086_write_byte(state
, 0x09, bdri
);
352 tda10086_write_byte(state
, 0x37, reg37
);
353 tda10086_write_byte(state
, 0x42, reg42
);
358 static int tda10086_set_fec(struct tda10086_state
*state
,
359 struct dtv_frontend_properties
*fe_params
)
363 dprintk("%s %i\n", __func__
, fe_params
->fec_inner
);
365 switch (fe_params
->fec_inner
) {
396 tda10086_write_byte(state
, 0x0d, fecval
);
401 static int tda10086_set_frontend(struct dvb_frontend
*fe
)
403 struct dtv_frontend_properties
*fe_params
= &fe
->dtv_property_cache
;
404 struct tda10086_state
*state
= fe
->demodulator_priv
;
409 dprintk ("%s\n", __func__
);
411 /* modify parameters for tuning */
412 tda10086_write_byte(state
, 0x02, 0x35);
413 state
->has_lock
= false;
416 if (fe
->ops
.tuner_ops
.set_params
) {
417 fe
->ops
.tuner_ops
.set_params(fe
);
418 if (fe
->ops
.i2c_gate_ctrl
)
419 fe
->ops
.i2c_gate_ctrl(fe
, 0);
421 if (fe
->ops
.tuner_ops
.get_frequency
)
422 fe
->ops
.tuner_ops
.get_frequency(fe
, &freq
);
423 if (fe
->ops
.i2c_gate_ctrl
)
424 fe
->ops
.i2c_gate_ctrl(fe
, 0);
427 /* calculate the frequency offset (in *Hz* not kHz) */
428 freqoff
= fe_params
->frequency
- freq
;
429 freqoff
= ((1<<16) * freqoff
) / (SACLK
/1000);
430 tda10086_write_byte(state
, 0x3d, 0x80 | ((freqoff
>> 8) & 0x7f));
431 tda10086_write_byte(state
, 0x3e, freqoff
);
433 if ((ret
= tda10086_set_inversion(state
, fe_params
)) < 0)
435 if ((ret
= tda10086_set_symbol_rate(state
, fe_params
)) < 0)
437 if ((ret
= tda10086_set_fec(state
, fe_params
)) < 0)
440 /* soft reset + disable TS output until lock */
441 tda10086_write_mask(state
, 0x10, 0x40, 0x40);
442 tda10086_write_mask(state
, 0x00, 0x01, 0x00);
444 state
->symbol_rate
= fe_params
->symbol_rate
;
445 state
->frequency
= fe_params
->frequency
;
449 static int tda10086_get_frontend(struct dvb_frontend
*fe
,
450 struct dtv_frontend_properties
*fe_params
)
452 struct tda10086_state
* state
= fe
->demodulator_priv
;
457 dprintk ("%s\n", __func__
);
459 /* check for invalid symbol rate */
460 if (fe_params
->symbol_rate
< 500000)
463 /* calculate the updated frequency (note: we convert from Hz->kHz) */
464 tmp64
= ((u64
)tda10086_read_byte(state
, 0x52)
465 | (tda10086_read_byte(state
, 0x51) << 8));
467 tmp64
|= 0xffffffffffff0000ULL
;
468 tmp64
= (tmp64
* (SACLK
/1000ULL));
469 do_div(tmp64
, (1ULL<<15) * (1ULL<<1));
470 fe_params
->frequency
= (int) state
->frequency
+ (int) tmp64
;
473 val
= tda10086_read_byte(state
, 0x0c);
477 fe_params
->inversion
= INVERSION_OFF
;
478 if (state
->config
->invert
)
479 fe_params
->inversion
= INVERSION_ON
;
482 fe_params
->inversion
= INVERSION_ON
;
483 if (state
->config
->invert
)
484 fe_params
->inversion
= INVERSION_OFF
;
488 tda10086_read_byte(state
, 0x0f);
491 fe_params
->inversion
= INVERSION_OFF
;
492 if (state
->config
->invert
)
493 fe_params
->inversion
= INVERSION_ON
;
496 fe_params
->inversion
= INVERSION_ON
;
497 if (state
->config
->invert
)
498 fe_params
->inversion
= INVERSION_OFF
;
503 /* calculate the updated symbol rate */
504 tmp
= tda10086_read_byte(state
, 0x1d);
507 tmp
= (tmp
* 480 * (1<<1)) / 128;
508 tmp
= ((state
->symbol_rate
/1000) * tmp
) / (1000000/1000);
509 fe_params
->symbol_rate
= state
->symbol_rate
+ tmp
;
512 val
= (tda10086_read_byte(state
, 0x0d) & 0x70) >> 4;
515 fe_params
->fec_inner
= FEC_1_2
;
518 fe_params
->fec_inner
= FEC_2_3
;
521 fe_params
->fec_inner
= FEC_3_4
;
524 fe_params
->fec_inner
= FEC_4_5
;
527 fe_params
->fec_inner
= FEC_5_6
;
530 fe_params
->fec_inner
= FEC_6_7
;
533 fe_params
->fec_inner
= FEC_7_8
;
536 fe_params
->fec_inner
= FEC_8_9
;
543 static int tda10086_read_status(struct dvb_frontend
*fe
,
544 enum fe_status
*fe_status
)
546 struct tda10086_state
* state
= fe
->demodulator_priv
;
549 dprintk ("%s\n", __func__
);
551 val
= tda10086_read_byte(state
, 0x0e);
554 *fe_status
|= FE_HAS_SIGNAL
;
556 *fe_status
|= FE_HAS_CARRIER
;
558 *fe_status
|= FE_HAS_VITERBI
;
560 *fe_status
|= FE_HAS_SYNC
;
562 *fe_status
|= FE_HAS_LOCK
;
563 if (!state
->has_lock
) {
564 state
->has_lock
= true;
565 /* modify parameters for stable reception */
566 tda10086_write_byte(state
, 0x02, 0x00);
573 static int tda10086_read_signal_strength(struct dvb_frontend
* fe
, u16
* signal
)
575 struct tda10086_state
* state
= fe
->demodulator_priv
;
578 dprintk ("%s\n", __func__
);
580 _str
= 0xff - tda10086_read_byte(state
, 0x43);
581 *signal
= (_str
<< 8) | _str
;
586 static int tda10086_read_snr(struct dvb_frontend
* fe
, u16
* snr
)
588 struct tda10086_state
* state
= fe
->demodulator_priv
;
591 dprintk ("%s\n", __func__
);
593 _snr
= 0xff - tda10086_read_byte(state
, 0x1c);
594 *snr
= (_snr
<< 8) | _snr
;
599 static int tda10086_read_ucblocks(struct dvb_frontend
* fe
, u32
* ucblocks
)
601 struct tda10086_state
* state
= fe
->demodulator_priv
;
603 dprintk ("%s\n", __func__
);
606 *ucblocks
= tda10086_read_byte(state
, 0x18) & 0x7f;
609 tda10086_write_byte(state
, 0x18, 0x00);
610 tda10086_write_byte(state
, 0x18, 0x80);
615 static int tda10086_read_ber(struct dvb_frontend
* fe
, u32
* ber
)
617 struct tda10086_state
* state
= fe
->demodulator_priv
;
619 dprintk ("%s\n", __func__
);
623 *ber
|= tda10086_read_byte(state
, 0x15);
624 *ber
|= tda10086_read_byte(state
, 0x16) << 8;
625 *ber
|= (tda10086_read_byte(state
, 0x17) & 0xf) << 16;
630 static int tda10086_sleep(struct dvb_frontend
* fe
)
632 struct tda10086_state
* state
= fe
->demodulator_priv
;
634 dprintk ("%s\n", __func__
);
636 tda10086_write_mask(state
, 0x00, 0x08, 0x08);
641 static int tda10086_i2c_gate_ctrl(struct dvb_frontend
* fe
, int enable
)
643 struct tda10086_state
* state
= fe
->demodulator_priv
;
645 dprintk ("%s\n", __func__
);
648 tda10086_write_mask(state
, 0x00, 0x10, 0x10);
650 tda10086_write_mask(state
, 0x00, 0x10, 0x00);
656 static int tda10086_get_tune_settings(struct dvb_frontend
* fe
, struct dvb_frontend_tune_settings
* fesettings
)
658 struct dtv_frontend_properties
*p
= &fe
->dtv_property_cache
;
660 if (p
->symbol_rate
> 20000000) {
661 fesettings
->min_delay_ms
= 50;
662 fesettings
->step_size
= 2000;
663 fesettings
->max_drift
= 8000;
664 } else if (p
->symbol_rate
> 12000000) {
665 fesettings
->min_delay_ms
= 100;
666 fesettings
->step_size
= 1500;
667 fesettings
->max_drift
= 9000;
668 } else if (p
->symbol_rate
> 8000000) {
669 fesettings
->min_delay_ms
= 100;
670 fesettings
->step_size
= 1000;
671 fesettings
->max_drift
= 8000;
672 } else if (p
->symbol_rate
> 4000000) {
673 fesettings
->min_delay_ms
= 100;
674 fesettings
->step_size
= 500;
675 fesettings
->max_drift
= 7000;
676 } else if (p
->symbol_rate
> 2000000) {
677 fesettings
->min_delay_ms
= 200;
678 fesettings
->step_size
= p
->symbol_rate
/ 8000;
679 fesettings
->max_drift
= 14 * fesettings
->step_size
;
681 fesettings
->min_delay_ms
= 200;
682 fesettings
->step_size
= p
->symbol_rate
/ 8000;
683 fesettings
->max_drift
= 18 * fesettings
->step_size
;
689 static void tda10086_release(struct dvb_frontend
* fe
)
691 struct tda10086_state
*state
= fe
->demodulator_priv
;
696 static const struct dvb_frontend_ops tda10086_ops
= {
697 .delsys
= { SYS_DVBS
},
699 .name
= "Philips TDA10086 DVB-S",
700 .frequency_min_hz
= 950 * MHz
,
701 .frequency_max_hz
= 2150 * MHz
,
702 .frequency_stepsize_hz
= 125 * kHz
,
703 .symbol_rate_min
= 1000000,
704 .symbol_rate_max
= 45000000,
705 .caps
= FE_CAN_INVERSION_AUTO
|
706 FE_CAN_FEC_1_2
| FE_CAN_FEC_2_3
| FE_CAN_FEC_3_4
|
707 FE_CAN_FEC_5_6
| FE_CAN_FEC_6_7
| FE_CAN_FEC_7_8
| FE_CAN_FEC_AUTO
|
711 .release
= tda10086_release
,
713 .init
= tda10086_init
,
714 .sleep
= tda10086_sleep
,
715 .i2c_gate_ctrl
= tda10086_i2c_gate_ctrl
,
717 .set_frontend
= tda10086_set_frontend
,
718 .get_frontend
= tda10086_get_frontend
,
719 .get_tune_settings
= tda10086_get_tune_settings
,
721 .read_status
= tda10086_read_status
,
722 .read_ber
= tda10086_read_ber
,
723 .read_signal_strength
= tda10086_read_signal_strength
,
724 .read_snr
= tda10086_read_snr
,
725 .read_ucblocks
= tda10086_read_ucblocks
,
727 .diseqc_send_master_cmd
= tda10086_send_master_cmd
,
728 .diseqc_send_burst
= tda10086_send_burst
,
729 .set_tone
= tda10086_set_tone
,
732 struct dvb_frontend
* tda10086_attach(const struct tda10086_config
* config
,
733 struct i2c_adapter
* i2c
)
735 struct tda10086_state
*state
;
737 dprintk ("%s\n", __func__
);
739 /* allocate memory for the internal state */
740 state
= kzalloc(sizeof(struct tda10086_state
), GFP_KERNEL
);
744 /* setup the state */
745 state
->config
= config
;
748 /* check if the demod is there */
749 if (tda10086_read_byte(state
, 0x1e) != 0xe1) {
754 /* create dvb_frontend */
755 memcpy(&state
->frontend
.ops
, &tda10086_ops
, sizeof(struct dvb_frontend_ops
));
756 state
->frontend
.demodulator_priv
= state
;
757 return &state
->frontend
;
760 module_param(debug
, int, 0644);
761 MODULE_PARM_DESC(debug
, "Turn on/off frontend debugging (default:off).");
763 MODULE_DESCRIPTION("Philips TDA10086 DVB-S Demodulator");
764 MODULE_AUTHOR("Andrew de Quincey");
765 MODULE_LICENSE("GPL");
767 EXPORT_SYMBOL(tda10086_attach
);