2 * Linux-DVB Driver for DiBcom's second generation DiB7000P (PC).
4 * Copyright (C) 2005-7 DiBcom (http://www.dibcom.fr/)
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License as
8 * published by the Free Software Foundation, version 2.
10 #include <linux/kernel.h>
11 #include <linux/slab.h>
12 #include <linux/i2c.h>
13 #include <linux/mutex.h>
16 #include "dvb_frontend.h"
21 module_param(debug
, int, 0644);
22 MODULE_PARM_DESC(debug
, "turn on debugging (default: 0)");
24 static int buggy_sfn_workaround
;
25 module_param(buggy_sfn_workaround
, int, 0644);
26 MODULE_PARM_DESC(buggy_sfn_workaround
, "Enable work-around for buggy SFNs (default: 0)");
28 #define dprintk(args...) do { if (debug) { printk(KERN_DEBUG "DiB7000P: "); printk(args); printk("\n"); } } while (0)
31 struct i2c_adapter
*i2c_adap
;
35 struct dib7000p_state
{
36 struct dvb_frontend demod
;
37 struct dib7000p_config cfg
;
40 struct i2c_adapter
*i2c_adap
;
42 struct dibx000_i2c_master i2c_master
;
47 u32 current_bandwidth
;
48 struct dibx000_agc_config
*current_agc
;
60 u8 sfn_workaround_active
:1;
62 #define SOC7090 0x7090
66 struct i2c_adapter dib7090_tuner_adap
;
68 /* for the I2C transfer */
69 struct i2c_msg msg
[2];
70 u8 i2c_write_buffer
[4];
71 u8 i2c_read_buffer
[2];
72 struct mutex i2c_buffer_lock
;
77 enum dib7000p_power_mode
{
78 DIB7000P_POWER_ALL
= 0,
79 DIB7000P_POWER_ANALOG_ADC
,
80 DIB7000P_POWER_INTERFACE_ONLY
,
83 /* dib7090 specific fonctions */
84 static int dib7090_set_output_mode(struct dvb_frontend
*fe
, int mode
);
85 static int dib7090_set_diversity_in(struct dvb_frontend
*fe
, int onoff
);
86 static void dib7090_setDibTxMux(struct dib7000p_state
*state
, int mode
);
87 static void dib7090_setHostBusMux(struct dib7000p_state
*state
, int mode
);
89 static u16
dib7000p_read_word(struct dib7000p_state
*state
, u16 reg
)
93 if (mutex_lock_interruptible(&state
->i2c_buffer_lock
) < 0) {
94 dprintk("could not acquire lock");
98 state
->i2c_write_buffer
[0] = reg
>> 8;
99 state
->i2c_write_buffer
[1] = reg
& 0xff;
101 memset(state
->msg
, 0, 2 * sizeof(struct i2c_msg
));
102 state
->msg
[0].addr
= state
->i2c_addr
>> 1;
103 state
->msg
[0].flags
= 0;
104 state
->msg
[0].buf
= state
->i2c_write_buffer
;
105 state
->msg
[0].len
= 2;
106 state
->msg
[1].addr
= state
->i2c_addr
>> 1;
107 state
->msg
[1].flags
= I2C_M_RD
;
108 state
->msg
[1].buf
= state
->i2c_read_buffer
;
109 state
->msg
[1].len
= 2;
111 if (i2c_transfer(state
->i2c_adap
, state
->msg
, 2) != 2)
112 dprintk("i2c read error on %d", reg
);
114 ret
= (state
->i2c_read_buffer
[0] << 8) | state
->i2c_read_buffer
[1];
115 mutex_unlock(&state
->i2c_buffer_lock
);
119 static int dib7000p_write_word(struct dib7000p_state
*state
, u16 reg
, u16 val
)
123 if (mutex_lock_interruptible(&state
->i2c_buffer_lock
) < 0) {
124 dprintk("could not acquire lock");
128 state
->i2c_write_buffer
[0] = (reg
>> 8) & 0xff;
129 state
->i2c_write_buffer
[1] = reg
& 0xff;
130 state
->i2c_write_buffer
[2] = (val
>> 8) & 0xff;
131 state
->i2c_write_buffer
[3] = val
& 0xff;
133 memset(&state
->msg
[0], 0, sizeof(struct i2c_msg
));
134 state
->msg
[0].addr
= state
->i2c_addr
>> 1;
135 state
->msg
[0].flags
= 0;
136 state
->msg
[0].buf
= state
->i2c_write_buffer
;
137 state
->msg
[0].len
= 4;
139 ret
= (i2c_transfer(state
->i2c_adap
, state
->msg
, 1) != 1 ?
141 mutex_unlock(&state
->i2c_buffer_lock
);
145 static void dib7000p_write_tab(struct dib7000p_state
*state
, u16
* buf
)
154 dib7000p_write_word(state
, r
, *n
++);
161 static int dib7000p_set_output_mode(struct dib7000p_state
*state
, int mode
)
164 u16 outreg
, fifo_threshold
, smo_mode
;
167 fifo_threshold
= 1792;
168 smo_mode
= (dib7000p_read_word(state
, 235) & 0x0050) | (1 << 1);
170 dprintk("setting output mode for demod %p to %d", &state
->demod
, mode
);
173 case OUTMODE_MPEG2_PAR_GATED_CLK
:
174 outreg
= (1 << 10); /* 0x0400 */
176 case OUTMODE_MPEG2_PAR_CONT_CLK
:
177 outreg
= (1 << 10) | (1 << 6); /* 0x0440 */
179 case OUTMODE_MPEG2_SERIAL
:
180 outreg
= (1 << 10) | (2 << 6) | (0 << 1); /* 0x0480 */
182 case OUTMODE_DIVERSITY
:
183 if (state
->cfg
.hostbus_diversity
)
184 outreg
= (1 << 10) | (4 << 6); /* 0x0500 */
188 case OUTMODE_MPEG2_FIFO
:
189 smo_mode
|= (3 << 1);
190 fifo_threshold
= 512;
191 outreg
= (1 << 10) | (5 << 6);
193 case OUTMODE_ANALOG_ADC
:
194 outreg
= (1 << 10) | (3 << 6);
200 dprintk("Unhandled output_mode passed to be set for demod %p", &state
->demod
);
204 if (state
->cfg
.output_mpeg2_in_188_bytes
)
205 smo_mode
|= (1 << 5);
207 ret
|= dib7000p_write_word(state
, 235, smo_mode
);
208 ret
|= dib7000p_write_word(state
, 236, fifo_threshold
); /* synchronous fread */
209 if (state
->version
!= SOC7090
)
210 ret
|= dib7000p_write_word(state
, 1286, outreg
); /* P_Div_active */
215 static int dib7000p_set_diversity_in(struct dvb_frontend
*demod
, int onoff
)
217 struct dib7000p_state
*state
= demod
->demodulator_priv
;
219 if (state
->div_force_off
) {
220 dprintk("diversity combination deactivated - forced by COFDM parameters");
222 dib7000p_write_word(state
, 207, 0);
224 dib7000p_write_word(state
, 207, (state
->div_sync_wait
<< 4) | (1 << 2) | (2 << 0));
226 state
->div_state
= (u8
) onoff
;
229 dib7000p_write_word(state
, 204, 6);
230 dib7000p_write_word(state
, 205, 16);
231 /* P_dvsy_sync_mode = 0, P_dvsy_sync_enable=1, P_dvcb_comb_mode=2 */
233 dib7000p_write_word(state
, 204, 1);
234 dib7000p_write_word(state
, 205, 0);
240 static int dib7000p_set_power_mode(struct dib7000p_state
*state
, enum dib7000p_power_mode mode
)
242 /* by default everything is powered off */
243 u16 reg_774
= 0x3fff, reg_775
= 0xffff, reg_776
= 0x0007, reg_899
= 0x0003, reg_1280
= (0xfe00) | (dib7000p_read_word(state
, 1280) & 0x01ff);
245 /* now, depending on the requested mode, we power on */
247 /* power up everything in the demod */
248 case DIB7000P_POWER_ALL
:
253 if (state
->version
== SOC7090
)
259 case DIB7000P_POWER_ANALOG_ADC
:
260 /* dem, cfg, iqc, sad, agc */
261 reg_774
&= ~((1 << 15) | (1 << 14) | (1 << 11) | (1 << 10) | (1 << 9));
263 reg_776
&= ~((1 << 0));
265 if (state
->version
!= SOC7090
)
266 reg_1280
&= ~((1 << 11));
267 reg_1280
&= ~(1 << 6);
268 /* fall through wanted to enable the interfaces */
270 /* just leave power on the control-interfaces: GPIO and (I2C or SDIO) */
271 case DIB7000P_POWER_INTERFACE_ONLY
: /* TODO power up either SDIO or I2C */
272 if (state
->version
== SOC7090
)
273 reg_1280
&= ~((1 << 7) | (1 << 5));
275 reg_1280
&= ~((1 << 14) | (1 << 13) | (1 << 12) | (1 << 10));
278 /* TODO following stuff is just converted from the dib7000-driver - check when is used what */
281 dib7000p_write_word(state
, 774, reg_774
);
282 dib7000p_write_word(state
, 775, reg_775
);
283 dib7000p_write_word(state
, 776, reg_776
);
284 dib7000p_write_word(state
, 1280, reg_1280
);
285 if (state
->version
!= SOC7090
)
286 dib7000p_write_word(state
, 899, reg_899
);
291 static void dib7000p_set_adc_state(struct dib7000p_state
*state
, enum dibx000_adc_states no
)
293 u16 reg_908
= 0, reg_909
= 0;
296 if (state
->version
!= SOC7090
) {
297 reg_908
= dib7000p_read_word(state
, 908);
298 reg_909
= dib7000p_read_word(state
, 909);
302 case DIBX000_SLOW_ADC_ON
:
303 if (state
->version
== SOC7090
) {
304 reg
= dib7000p_read_word(state
, 1925);
306 dib7000p_write_word(state
, 1925, reg
| (1 << 4) | (1 << 2)); /* en_slowAdc = 1 & reset_sladc = 1 */
308 reg
= dib7000p_read_word(state
, 1925); /* read acces to make it works... strange ... */
310 dib7000p_write_word(state
, 1925, reg
& ~(1 << 4)); /* en_slowAdc = 1 & reset_sladc = 0 */
312 reg
= dib7000p_read_word(state
, 72) & ~((0x3 << 14) | (0x3 << 12));
313 dib7000p_write_word(state
, 72, reg
| (1 << 14) | (3 << 12) | 524); /* ref = Vin1 => Vbg ; sel = Vin0 or Vin3 ; (Vin2 = Vcm) */
315 reg_909
|= (1 << 1) | (1 << 0);
316 dib7000p_write_word(state
, 909, reg_909
);
317 reg_909
&= ~(1 << 1);
321 case DIBX000_SLOW_ADC_OFF
:
322 if (state
->version
== SOC7090
) {
323 reg
= dib7000p_read_word(state
, 1925);
324 dib7000p_write_word(state
, 1925, (reg
& ~(1 << 2)) | (1 << 4)); /* reset_sladc = 1 en_slowAdc = 0 */
326 reg_909
|= (1 << 1) | (1 << 0);
334 case DIBX000_ADC_OFF
:
335 reg_908
|= (1 << 14) | (1 << 13) | (1 << 12);
336 reg_909
|= (1 << 5) | (1 << 4) | (1 << 3) | (1 << 2);
339 case DIBX000_VBG_ENABLE
:
340 reg_908
&= ~(1 << 15);
343 case DIBX000_VBG_DISABLE
:
344 reg_908
|= (1 << 15);
351 // dprintk( "908: %x, 909: %x\n", reg_908, reg_909);
353 reg_909
|= (state
->cfg
.disable_sample_and_hold
& 1) << 4;
354 reg_908
|= (state
->cfg
.enable_current_mirror
& 1) << 7;
356 if (state
->version
!= SOC7090
) {
357 dib7000p_write_word(state
, 908, reg_908
);
358 dib7000p_write_word(state
, 909, reg_909
);
362 static int dib7000p_set_bandwidth(struct dib7000p_state
*state
, u32 bw
)
366 // store the current bandwidth for later use
367 state
->current_bandwidth
= bw
;
369 if (state
->timf
== 0) {
370 dprintk("using default timf");
371 timf
= state
->cfg
.bw
->timf
;
373 dprintk("using updated timf");
377 timf
= timf
* (bw
/ 50) / 160;
379 dib7000p_write_word(state
, 23, (u16
) ((timf
>> 16) & 0xffff));
380 dib7000p_write_word(state
, 24, (u16
) ((timf
) & 0xffff));
385 static int dib7000p_sad_calib(struct dib7000p_state
*state
)
388 dib7000p_write_word(state
, 73, (0 << 1) | (0 << 0));
390 if (state
->version
== SOC7090
)
391 dib7000p_write_word(state
, 74, 2048);
393 dib7000p_write_word(state
, 74, 776);
395 /* do the calibration */
396 dib7000p_write_word(state
, 73, (1 << 0));
397 dib7000p_write_word(state
, 73, (0 << 0));
404 int dib7000p_set_wbd_ref(struct dvb_frontend
*demod
, u16 value
)
406 struct dib7000p_state
*state
= demod
->demodulator_priv
;
409 state
->wbd_ref
= value
;
410 return dib7000p_write_word(state
, 105, (dib7000p_read_word(state
, 105) & 0xf000) | value
);
412 EXPORT_SYMBOL(dib7000p_set_wbd_ref
);
414 int dib7000p_get_agc_values(struct dvb_frontend
*fe
,
415 u16
*agc_global
, u16
*agc1
, u16
*agc2
, u16
*wbd
)
417 struct dib7000p_state
*state
= fe
->demodulator_priv
;
419 if (agc_global
!= NULL
)
420 *agc_global
= dib7000p_read_word(state
, 394);
422 *agc1
= dib7000p_read_word(state
, 392);
424 *agc2
= dib7000p_read_word(state
, 393);
426 *wbd
= dib7000p_read_word(state
, 397);
430 EXPORT_SYMBOL(dib7000p_get_agc_values
);
432 static void dib7000p_reset_pll(struct dib7000p_state
*state
)
434 struct dibx000_bandwidth_config
*bw
= &state
->cfg
.bw
[0];
437 if (state
->version
== SOC7090
) {
438 dib7000p_write_word(state
, 1856, (!bw
->pll_reset
<< 13) | (bw
->pll_range
<< 12) | (bw
->pll_ratio
<< 6) | (bw
->pll_prediv
));
440 while (((dib7000p_read_word(state
, 1856) >> 15) & 0x1) != 1)
443 dib7000p_write_word(state
, 1857, dib7000p_read_word(state
, 1857) | (!bw
->pll_bypass
<< 15));
445 /* force PLL bypass */
446 clk_cfg0
= (1 << 15) | ((bw
->pll_ratio
& 0x3f) << 9) |
447 (bw
->modulo
<< 7) | (bw
->ADClkSrc
<< 6) | (bw
->IO_CLK_en_core
<< 5) | (bw
->bypclk_div
<< 2) | (bw
->enable_refdiv
<< 1) | (0 << 0);
449 dib7000p_write_word(state
, 900, clk_cfg0
);
452 dib7000p_write_word(state
, 903, (bw
->pll_prediv
<< 5) | (((bw
->pll_ratio
>> 6) & 0x3) << 3) | (bw
->pll_range
<< 1) | bw
->pll_reset
);
453 clk_cfg0
= (bw
->pll_bypass
<< 15) | (clk_cfg0
& 0x7fff);
454 dib7000p_write_word(state
, 900, clk_cfg0
);
457 dib7000p_write_word(state
, 18, (u16
) (((bw
->internal
* 1000) >> 16) & 0xffff));
458 dib7000p_write_word(state
, 19, (u16
) ((bw
->internal
* 1000) & 0xffff));
459 dib7000p_write_word(state
, 21, (u16
) ((bw
->ifreq
>> 16) & 0xffff));
460 dib7000p_write_word(state
, 22, (u16
) ((bw
->ifreq
) & 0xffff));
462 dib7000p_write_word(state
, 72, bw
->sad_cfg
);
465 static u32
dib7000p_get_internal_freq(struct dib7000p_state
*state
)
467 u32 internal
= (u32
) dib7000p_read_word(state
, 18) << 16;
468 internal
|= (u32
) dib7000p_read_word(state
, 19);
474 int dib7000p_update_pll(struct dvb_frontend
*fe
, struct dibx000_bandwidth_config
*bw
)
476 struct dib7000p_state
*state
= fe
->demodulator_priv
;
477 u16 reg_1857
, reg_1856
= dib7000p_read_word(state
, 1856);
481 /* get back old values */
482 prediv
= reg_1856
& 0x3f;
483 loopdiv
= (reg_1856
>> 6) & 0x3f;
485 if ((bw
!= NULL
) && (bw
->pll_prediv
!= prediv
|| bw
->pll_ratio
!= loopdiv
)) {
486 dprintk("Updating pll (prediv: old = %d new = %d ; loopdiv : old = %d new = %d)", prediv
, bw
->pll_prediv
, loopdiv
, bw
->pll_ratio
);
488 reg_1857
= dib7000p_read_word(state
, 1857);
489 dib7000p_write_word(state
, 1857, reg_1857
& ~(1 << 15));
491 dib7000p_write_word(state
, 1856, reg_1856
| ((bw
->pll_ratio
& 0x3f) << 6) | (bw
->pll_prediv
& 0x3f));
493 /* write new system clk into P_sec_len */
494 internal
= dib7000p_get_internal_freq(state
);
495 xtal
= (internal
/ loopdiv
) * prediv
;
496 internal
= 1000 * (xtal
/ bw
->pll_prediv
) * bw
->pll_ratio
; /* new internal */
497 dib7000p_write_word(state
, 18, (u16
) ((internal
>> 16) & 0xffff));
498 dib7000p_write_word(state
, 19, (u16
) (internal
& 0xffff));
500 dib7000p_write_word(state
, 1857, reg_1857
| (1 << 15));
502 while (((dib7000p_read_word(state
, 1856) >> 15) & 0x1) != 1)
503 dprintk("Waiting for PLL to lock");
509 EXPORT_SYMBOL(dib7000p_update_pll
);
511 static int dib7000p_reset_gpio(struct dib7000p_state
*st
)
513 /* reset the GPIOs */
514 dprintk("gpio dir: %x: val: %x, pwm_pos: %x", st
->gpio_dir
, st
->gpio_val
, st
->cfg
.gpio_pwm_pos
);
516 dib7000p_write_word(st
, 1029, st
->gpio_dir
);
517 dib7000p_write_word(st
, 1030, st
->gpio_val
);
519 /* TODO 1031 is P_gpio_od */
521 dib7000p_write_word(st
, 1032, st
->cfg
.gpio_pwm_pos
);
523 dib7000p_write_word(st
, 1037, st
->cfg
.pwm_freq_div
);
527 static int dib7000p_cfg_gpio(struct dib7000p_state
*st
, u8 num
, u8 dir
, u8 val
)
529 st
->gpio_dir
= dib7000p_read_word(st
, 1029);
530 st
->gpio_dir
&= ~(1 << num
); /* reset the direction bit */
531 st
->gpio_dir
|= (dir
& 0x1) << num
; /* set the new direction */
532 dib7000p_write_word(st
, 1029, st
->gpio_dir
);
534 st
->gpio_val
= dib7000p_read_word(st
, 1030);
535 st
->gpio_val
&= ~(1 << num
); /* reset the direction bit */
536 st
->gpio_val
|= (val
& 0x01) << num
; /* set the new value */
537 dib7000p_write_word(st
, 1030, st
->gpio_val
);
542 int dib7000p_set_gpio(struct dvb_frontend
*demod
, u8 num
, u8 dir
, u8 val
)
544 struct dib7000p_state
*state
= demod
->demodulator_priv
;
545 return dib7000p_cfg_gpio(state
, num
, dir
, val
);
547 EXPORT_SYMBOL(dib7000p_set_gpio
);
549 static u16 dib7000p_defaults
[] = {
550 // auto search configuration
553 (1<<3)|(1<<11)|(1<<12)|(1<<13),
554 0x0814, /* Equal Lock */
573 /* set ADC level to -16 */
575 (1 << 13) - 825 - 117,
576 (1 << 13) - 837 - 117,
577 (1 << 13) - 811 - 117,
578 (1 << 13) - 766 - 117,
579 (1 << 13) - 737 - 117,
580 (1 << 13) - 693 - 117,
581 (1 << 13) - 648 - 117,
582 (1 << 13) - 619 - 117,
583 (1 << 13) - 575 - 117,
584 (1 << 13) - 531 - 117,
585 (1 << 13) - 501 - 117,
590 /* disable power smoothing */
632 static int dib7000p_demod_reset(struct dib7000p_state
*state
)
634 dib7000p_set_power_mode(state
, DIB7000P_POWER_ALL
);
636 if (state
->version
== SOC7090
)
637 dibx000_reset_i2c_master(&state
->i2c_master
);
639 dib7000p_set_adc_state(state
, DIBX000_VBG_ENABLE
);
641 /* restart all parts */
642 dib7000p_write_word(state
, 770, 0xffff);
643 dib7000p_write_word(state
, 771, 0xffff);
644 dib7000p_write_word(state
, 772, 0x001f);
645 dib7000p_write_word(state
, 1280, 0x001f - ((1 << 4) | (1 << 3)));
647 dib7000p_write_word(state
, 770, 0);
648 dib7000p_write_word(state
, 771, 0);
649 dib7000p_write_word(state
, 772, 0);
650 dib7000p_write_word(state
, 1280, 0);
652 if (state
->version
!= SOC7090
) {
653 dib7000p_write_word(state
, 898, 0x0003);
654 dib7000p_write_word(state
, 898, 0);
658 dib7000p_reset_pll(state
);
660 if (dib7000p_reset_gpio(state
) != 0)
661 dprintk("GPIO reset was not successful.");
663 if (state
->version
== SOC7090
) {
664 dib7000p_write_word(state
, 899, 0);
667 dib7000p_write_word(state
, 42, (1<<5) | 3); /* P_iqc_thsat_ipc = 1 ; P_iqc_win2 = 3 */
668 dib7000p_write_word(state
, 43, 0x2d4); /*-300 fag P_iqc_dect_min = -280 */
669 dib7000p_write_word(state
, 44, 300); /* 300 fag P_iqc_dect_min = +280 */
670 dib7000p_write_word(state
, 273, (0<<6) | 30);
672 if (dib7000p_set_output_mode(state
, OUTMODE_HIGH_Z
) != 0)
673 dprintk("OUTPUT_MODE could not be reset.");
675 dib7000p_set_adc_state(state
, DIBX000_SLOW_ADC_ON
);
676 dib7000p_sad_calib(state
);
677 dib7000p_set_adc_state(state
, DIBX000_SLOW_ADC_OFF
);
679 /* unforce divstr regardless whether i2c enumeration was done or not */
680 dib7000p_write_word(state
, 1285, dib7000p_read_word(state
, 1285) & ~(1 << 1));
682 dib7000p_set_bandwidth(state
, 8000);
684 if (state
->version
== SOC7090
) {
685 dib7000p_write_word(state
, 36, 0x0755);/* P_iqc_impnc_on =1 & P_iqc_corr_inh = 1 for impulsive noise */
687 if (state
->cfg
.tuner_is_baseband
)
688 dib7000p_write_word(state
, 36, 0x0755);
690 dib7000p_write_word(state
, 36, 0x1f55);
693 dib7000p_write_tab(state
, dib7000p_defaults
);
694 if (state
->version
!= SOC7090
) {
695 dib7000p_write_word(state
, 901, 0x0006);
696 dib7000p_write_word(state
, 902, (3 << 10) | (1 << 6));
697 dib7000p_write_word(state
, 905, 0x2c8e);
700 dib7000p_set_power_mode(state
, DIB7000P_POWER_INTERFACE_ONLY
);
705 static void dib7000p_pll_clk_cfg(struct dib7000p_state
*state
)
708 tmp
= dib7000p_read_word(state
, 903);
709 dib7000p_write_word(state
, 903, (tmp
| 0x1));
710 tmp
= dib7000p_read_word(state
, 900);
711 dib7000p_write_word(state
, 900, (tmp
& 0x7fff) | (1 << 6));
714 static void dib7000p_restart_agc(struct dib7000p_state
*state
)
716 // P_restart_iqc & P_restart_agc
717 dib7000p_write_word(state
, 770, (1 << 11) | (1 << 9));
718 dib7000p_write_word(state
, 770, 0x0000);
721 static int dib7000p_update_lna(struct dib7000p_state
*state
)
725 if (state
->cfg
.update_lna
) {
726 dyn_gain
= dib7000p_read_word(state
, 394);
727 if (state
->cfg
.update_lna(&state
->demod
, dyn_gain
)) {
728 dib7000p_restart_agc(state
);
736 static int dib7000p_set_agc_config(struct dib7000p_state
*state
, u8 band
)
738 struct dibx000_agc_config
*agc
= NULL
;
740 if (state
->current_band
== band
&& state
->current_agc
!= NULL
)
742 state
->current_band
= band
;
744 for (i
= 0; i
< state
->cfg
.agc_config_count
; i
++)
745 if (state
->cfg
.agc
[i
].band_caps
& band
) {
746 agc
= &state
->cfg
.agc
[i
];
751 dprintk("no valid AGC configuration found for band 0x%02x", band
);
755 state
->current_agc
= agc
;
758 dib7000p_write_word(state
, 75, agc
->setup
);
759 dib7000p_write_word(state
, 76, agc
->inv_gain
);
760 dib7000p_write_word(state
, 77, agc
->time_stabiliz
);
761 dib7000p_write_word(state
, 100, (agc
->alpha_level
<< 12) | agc
->thlock
);
763 // Demod AGC loop configuration
764 dib7000p_write_word(state
, 101, (agc
->alpha_mant
<< 5) | agc
->alpha_exp
);
765 dib7000p_write_word(state
, 102, (agc
->beta_mant
<< 6) | agc
->beta_exp
);
768 dprintk("WBD: ref: %d, sel: %d, active: %d, alpha: %d",
769 state
->wbd_ref
!= 0 ? state
->wbd_ref
: agc
->wbd_ref
, agc
->wbd_sel
, !agc
->perform_agc_softsplit
, agc
->wbd_sel
);
771 if (state
->wbd_ref
!= 0)
772 dib7000p_write_word(state
, 105, (agc
->wbd_inv
<< 12) | state
->wbd_ref
);
774 dib7000p_write_word(state
, 105, (agc
->wbd_inv
<< 12) | agc
->wbd_ref
);
776 dib7000p_write_word(state
, 106, (agc
->wbd_sel
<< 13) | (agc
->wbd_alpha
<< 9) | (agc
->perform_agc_softsplit
<< 8));
778 dib7000p_write_word(state
, 107, agc
->agc1_max
);
779 dib7000p_write_word(state
, 108, agc
->agc1_min
);
780 dib7000p_write_word(state
, 109, agc
->agc2_max
);
781 dib7000p_write_word(state
, 110, agc
->agc2_min
);
782 dib7000p_write_word(state
, 111, (agc
->agc1_pt1
<< 8) | agc
->agc1_pt2
);
783 dib7000p_write_word(state
, 112, agc
->agc1_pt3
);
784 dib7000p_write_word(state
, 113, (agc
->agc1_slope1
<< 8) | agc
->agc1_slope2
);
785 dib7000p_write_word(state
, 114, (agc
->agc2_pt1
<< 8) | agc
->agc2_pt2
);
786 dib7000p_write_word(state
, 115, (agc
->agc2_slope1
<< 8) | agc
->agc2_slope2
);
790 static void dib7000p_set_dds(struct dib7000p_state
*state
, s32 offset_khz
)
792 u32 internal
= dib7000p_get_internal_freq(state
);
793 s32 unit_khz_dds_val
= 67108864 / (internal
); /* 2**26 / Fsampling is the unit 1KHz offset */
794 u32 abs_offset_khz
= ABS(offset_khz
);
795 u32 dds
= state
->cfg
.bw
->ifreq
& 0x1ffffff;
796 u8 invert
= !!(state
->cfg
.bw
->ifreq
& (1 << 25));
798 dprintk("setting a frequency offset of %dkHz internal freq = %d invert = %d", offset_khz
, internal
, invert
);
801 unit_khz_dds_val
*= -1;
805 dds
-= (abs_offset_khz
* unit_khz_dds_val
); /* /100 because of /100 on the unit_khz_dds_val line calc for better accuracy */
807 dds
+= (abs_offset_khz
* unit_khz_dds_val
);
809 if (abs_offset_khz
<= (internal
/ 2)) { /* Max dds offset is the half of the demod freq */
810 dib7000p_write_word(state
, 21, (u16
) (((dds
>> 16) & 0x1ff) | (0 << 10) | (invert
<< 9)));
811 dib7000p_write_word(state
, 22, (u16
) (dds
& 0xffff));
815 static int dib7000p_agc_startup(struct dvb_frontend
*demod
)
817 struct dtv_frontend_properties
*ch
= &demod
->dtv_property_cache
;
818 struct dib7000p_state
*state
= demod
->demodulator_priv
;
820 u8
*agc_state
= &state
->agc_state
;
823 u32 upd_demod_gain_period
= 0x1000;
825 switch (state
->agc_state
) {
827 dib7000p_set_power_mode(state
, DIB7000P_POWER_ALL
);
828 if (state
->version
== SOC7090
) {
829 reg
= dib7000p_read_word(state
, 0x79b) & 0xff00;
830 dib7000p_write_word(state
, 0x79a, upd_demod_gain_period
& 0xFFFF); /* lsb */
831 dib7000p_write_word(state
, 0x79b, reg
| (1 << 14) | ((upd_demod_gain_period
>> 16) & 0xFF));
833 /* enable adc i & q */
834 reg
= dib7000p_read_word(state
, 0x780);
835 dib7000p_write_word(state
, 0x780, (reg
| (0x3)) & (~(1 << 7)));
837 dib7000p_set_adc_state(state
, DIBX000_ADC_ON
);
838 dib7000p_pll_clk_cfg(state
);
841 if (dib7000p_set_agc_config(state
, BAND_OF_FREQUENCY(ch
->frequency
/ 1000)) != 0)
844 dib7000p_set_dds(state
, 0);
850 if (state
->cfg
.agc_control
)
851 state
->cfg
.agc_control(&state
->demod
, 1);
853 dib7000p_write_word(state
, 78, 32768);
854 if (!state
->current_agc
->perform_agc_softsplit
) {
855 /* we are using the wbd - so slow AGC startup */
856 /* force 0 split on WBD and restart AGC */
857 dib7000p_write_word(state
, 106, (state
->current_agc
->wbd_sel
<< 13) | (state
->current_agc
->wbd_alpha
<< 9) | (1 << 8));
861 /* default AGC startup */
863 /* wait AGC rough lock time */
867 dib7000p_restart_agc(state
);
870 case 2: /* fast split search path after 5sec */
871 dib7000p_write_word(state
, 75, state
->current_agc
->setup
| (1 << 4)); /* freeze AGC loop */
872 dib7000p_write_word(state
, 106, (state
->current_agc
->wbd_sel
<< 13) | (2 << 9) | (0 << 8)); /* fast split search 0.25kHz */
877 case 3: /* split search ended */
878 agc_split
= (u8
) dib7000p_read_word(state
, 396); /* store the split value for the next time */
879 dib7000p_write_word(state
, 78, dib7000p_read_word(state
, 394)); /* set AGC gain start value */
881 dib7000p_write_word(state
, 75, state
->current_agc
->setup
); /* std AGC loop */
882 dib7000p_write_word(state
, 106, (state
->current_agc
->wbd_sel
<< 13) | (state
->current_agc
->wbd_alpha
<< 9) | agc_split
); /* standard split search */
884 dib7000p_restart_agc(state
);
886 dprintk("SPLIT %p: %hd", demod
, agc_split
);
892 case 4: /* LNA startup */
895 if (dib7000p_update_lna(state
))
902 if (state
->cfg
.agc_control
)
903 state
->cfg
.agc_control(&state
->demod
, 0);
912 static void dib7000p_update_timf(struct dib7000p_state
*state
)
914 u32 timf
= (dib7000p_read_word(state
, 427) << 16) | dib7000p_read_word(state
, 428);
915 state
->timf
= timf
* 160 / (state
->current_bandwidth
/ 50);
916 dib7000p_write_word(state
, 23, (u16
) (timf
>> 16));
917 dib7000p_write_word(state
, 24, (u16
) (timf
& 0xffff));
918 dprintk("updated timf_frequency: %d (default: %d)", state
->timf
, state
->cfg
.bw
->timf
);
922 u32
dib7000p_ctrl_timf(struct dvb_frontend
*fe
, u8 op
, u32 timf
)
924 struct dib7000p_state
*state
= fe
->demodulator_priv
;
929 case DEMOD_TIMF_UPDATE
:
930 dib7000p_update_timf(state
);
935 dib7000p_set_bandwidth(state
, state
->current_bandwidth
);
938 EXPORT_SYMBOL(dib7000p_ctrl_timf
);
940 static void dib7000p_set_channel(struct dib7000p_state
*state
,
941 struct dtv_frontend_properties
*ch
, u8 seq
)
945 dib7000p_set_bandwidth(state
, BANDWIDTH_TO_KHZ(ch
->bandwidth_hz
));
947 /* nfft, guard, qam, alpha */
949 switch (ch
->transmission_mode
) {
950 case TRANSMISSION_MODE_2K
:
953 case TRANSMISSION_MODE_4K
:
957 case TRANSMISSION_MODE_8K
:
961 switch (ch
->guard_interval
) {
962 case GUARD_INTERVAL_1_32
:
965 case GUARD_INTERVAL_1_16
:
968 case GUARD_INTERVAL_1_4
:
972 case GUARD_INTERVAL_1_8
:
976 switch (ch
->modulation
) {
988 switch (HIERARCHY_1
) {
1000 dib7000p_write_word(state
, 0, value
);
1001 dib7000p_write_word(state
, 5, (seq
<< 4) | 1); /* do not force tps, search list 0 */
1003 /* P_dintl_native, P_dintlv_inv, P_hrch, P_code_rate, P_select_hp */
1007 if (ch
->hierarchy
== 1)
1011 switch ((ch
->hierarchy
== 0 || 1 == 1) ? ch
->code_rate_HP
: ch
->code_rate_LP
) {
1029 dib7000p_write_word(state
, 208, value
);
1031 /* offset loop parameters */
1032 dib7000p_write_word(state
, 26, 0x6680);
1033 dib7000p_write_word(state
, 32, 0x0003);
1034 dib7000p_write_word(state
, 29, 0x1273);
1035 dib7000p_write_word(state
, 33, 0x0005);
1037 /* P_dvsy_sync_wait */
1038 switch (ch
->transmission_mode
) {
1039 case TRANSMISSION_MODE_8K
:
1042 case TRANSMISSION_MODE_4K
:
1045 case TRANSMISSION_MODE_2K
:
1050 switch (ch
->guard_interval
) {
1051 case GUARD_INTERVAL_1_16
:
1054 case GUARD_INTERVAL_1_8
:
1057 case GUARD_INTERVAL_1_4
:
1061 case GUARD_INTERVAL_1_32
:
1065 if (state
->cfg
.diversity_delay
== 0)
1066 state
->div_sync_wait
= (value
* 3) / 2 + 48;
1068 state
->div_sync_wait
= (value
* 3) / 2 + state
->cfg
.diversity_delay
;
1070 /* deactive the possibility of diversity reception if extended interleaver */
1071 state
->div_force_off
= !1 && ch
->transmission_mode
!= TRANSMISSION_MODE_8K
;
1072 dib7000p_set_diversity_in(&state
->demod
, state
->div_state
);
1074 /* channel estimation fine configuration */
1075 switch (ch
->modulation
) {
1077 est
[0] = 0x0148; /* P_adp_regul_cnt 0.04 */
1078 est
[1] = 0xfff0; /* P_adp_noise_cnt -0.002 */
1079 est
[2] = 0x00a4; /* P_adp_regul_ext 0.02 */
1080 est
[3] = 0xfff8; /* P_adp_noise_ext -0.001 */
1083 est
[0] = 0x023d; /* P_adp_regul_cnt 0.07 */
1084 est
[1] = 0xffdf; /* P_adp_noise_cnt -0.004 */
1085 est
[2] = 0x00a4; /* P_adp_regul_ext 0.02 */
1086 est
[3] = 0xfff0; /* P_adp_noise_ext -0.002 */
1089 est
[0] = 0x099a; /* P_adp_regul_cnt 0.3 */
1090 est
[1] = 0xffae; /* P_adp_noise_cnt -0.01 */
1091 est
[2] = 0x0333; /* P_adp_regul_ext 0.1 */
1092 est
[3] = 0xfff8; /* P_adp_noise_ext -0.002 */
1095 for (value
= 0; value
< 4; value
++)
1096 dib7000p_write_word(state
, 187 + value
, est
[value
]);
1099 static int dib7000p_autosearch_start(struct dvb_frontend
*demod
)
1101 struct dtv_frontend_properties
*ch
= &demod
->dtv_property_cache
;
1102 struct dib7000p_state
*state
= demod
->demodulator_priv
;
1103 struct dtv_frontend_properties schan
;
1105 u32 internal
= dib7000p_get_internal_freq(state
);
1108 schan
.modulation
= QAM_64
;
1109 schan
.guard_interval
= GUARD_INTERVAL_1_32
;
1110 schan
.transmission_mode
= TRANSMISSION_MODE_8K
;
1111 schan
.code_rate_HP
= FEC_2_3
;
1112 schan
.code_rate_LP
= FEC_3_4
;
1113 schan
.hierarchy
= 0;
1115 dib7000p_set_channel(state
, &schan
, 7);
1117 factor
= BANDWIDTH_TO_KHZ(ch
->bandwidth_hz
);
1118 if (factor
>= 5000) {
1119 if (state
->version
== SOC7090
)
1126 value
= 30 * internal
* factor
;
1127 dib7000p_write_word(state
, 6, (u16
) ((value
>> 16) & 0xffff));
1128 dib7000p_write_word(state
, 7, (u16
) (value
& 0xffff));
1129 value
= 100 * internal
* factor
;
1130 dib7000p_write_word(state
, 8, (u16
) ((value
>> 16) & 0xffff));
1131 dib7000p_write_word(state
, 9, (u16
) (value
& 0xffff));
1132 value
= 500 * internal
* factor
;
1133 dib7000p_write_word(state
, 10, (u16
) ((value
>> 16) & 0xffff));
1134 dib7000p_write_word(state
, 11, (u16
) (value
& 0xffff));
1136 value
= dib7000p_read_word(state
, 0);
1137 dib7000p_write_word(state
, 0, (u16
) ((1 << 9) | value
));
1138 dib7000p_read_word(state
, 1284);
1139 dib7000p_write_word(state
, 0, (u16
) value
);
1144 static int dib7000p_autosearch_is_irq(struct dvb_frontend
*demod
)
1146 struct dib7000p_state
*state
= demod
->demodulator_priv
;
1147 u16 irq_pending
= dib7000p_read_word(state
, 1284);
1149 if (irq_pending
& 0x1)
1152 if (irq_pending
& 0x2)
1158 static void dib7000p_spur_protect(struct dib7000p_state
*state
, u32 rf_khz
, u32 bw
)
1160 static s16 notch
[] = { 16143, 14402, 12238, 9713, 6902, 3888, 759, -2392 };
1161 static u8 sine
[] = { 0, 2, 3, 5, 6, 8, 9, 11, 13, 14, 16, 17, 19, 20, 22,
1162 24, 25, 27, 28, 30, 31, 33, 34, 36, 38, 39, 41, 42, 44, 45, 47, 48, 50, 51,
1163 53, 55, 56, 58, 59, 61, 62, 64, 65, 67, 68, 70, 71, 73, 74, 76, 77, 79, 80,
1164 82, 83, 85, 86, 88, 89, 91, 92, 94, 95, 97, 98, 99, 101, 102, 104, 105,
1165 107, 108, 109, 111, 112, 114, 115, 117, 118, 119, 121, 122, 123, 125, 126,
1166 128, 129, 130, 132, 133, 134, 136, 137, 138, 140, 141, 142, 144, 145, 146,
1167 147, 149, 150, 151, 152, 154, 155, 156, 157, 159, 160, 161, 162, 164, 165,
1168 166, 167, 168, 170, 171, 172, 173, 174, 175, 177, 178, 179, 180, 181, 182,
1169 183, 184, 185, 186, 188, 189, 190, 191, 192, 193, 194, 195, 196, 197, 198,
1170 199, 200, 201, 202, 203, 204, 205, 206, 207, 207, 208, 209, 210, 211, 212,
1171 213, 214, 215, 215, 216, 217, 218, 219, 220, 220, 221, 222, 223, 224, 224,
1172 225, 226, 227, 227, 228, 229, 229, 230, 231, 231, 232, 233, 233, 234, 235,
1173 235, 236, 237, 237, 238, 238, 239, 239, 240, 241, 241, 242, 242, 243, 243,
1174 244, 244, 245, 245, 245, 246, 246, 247, 247, 248, 248, 248, 249, 249, 249,
1175 250, 250, 250, 251, 251, 251, 252, 252, 252, 252, 253, 253, 253, 253, 254,
1176 254, 254, 254, 254, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
1177 255, 255, 255, 255, 255, 255
1180 u32 xtal
= state
->cfg
.bw
->xtal_hz
/ 1000;
1181 int f_rel
= DIV_ROUND_CLOSEST(rf_khz
, xtal
) * xtal
- rf_khz
;
1183 int coef_re
[8], coef_im
[8];
1187 dprintk("relative position of the Spur: %dk (RF: %dk, XTAL: %dk)", f_rel
, rf_khz
, xtal
);
1189 if (f_rel
< -bw_khz
/ 2 || f_rel
> bw_khz
/ 2)
1194 dib7000p_write_word(state
, 142, 0x0610);
1196 for (k
= 0; k
< 8; k
++) {
1197 pha
= ((f_rel
* (k
+ 1) * 112 * 80 / bw_khz
) / 1000) & 0x3ff;
1202 } else if (pha
< 256) {
1203 coef_re
[k
] = sine
[256 - (pha
& 0xff)];
1204 coef_im
[k
] = sine
[pha
& 0xff];
1205 } else if (pha
== 256) {
1208 } else if (pha
< 512) {
1209 coef_re
[k
] = -sine
[pha
& 0xff];
1210 coef_im
[k
] = sine
[256 - (pha
& 0xff)];
1211 } else if (pha
== 512) {
1214 } else if (pha
< 768) {
1215 coef_re
[k
] = -sine
[256 - (pha
& 0xff)];
1216 coef_im
[k
] = -sine
[pha
& 0xff];
1217 } else if (pha
== 768) {
1221 coef_re
[k
] = sine
[pha
& 0xff];
1222 coef_im
[k
] = -sine
[256 - (pha
& 0xff)];
1225 coef_re
[k
] *= notch
[k
];
1226 coef_re
[k
] += (1 << 14);
1227 if (coef_re
[k
] >= (1 << 24))
1228 coef_re
[k
] = (1 << 24) - 1;
1229 coef_re
[k
] /= (1 << 15);
1231 coef_im
[k
] *= notch
[k
];
1232 coef_im
[k
] += (1 << 14);
1233 if (coef_im
[k
] >= (1 << 24))
1234 coef_im
[k
] = (1 << 24) - 1;
1235 coef_im
[k
] /= (1 << 15);
1237 dprintk("PALF COEF: %d re: %d im: %d", k
, coef_re
[k
], coef_im
[k
]);
1239 dib7000p_write_word(state
, 143, (0 << 14) | (k
<< 10) | (coef_re
[k
] & 0x3ff));
1240 dib7000p_write_word(state
, 144, coef_im
[k
] & 0x3ff);
1241 dib7000p_write_word(state
, 143, (1 << 14) | (k
<< 10) | (coef_re
[k
] & 0x3ff));
1243 dib7000p_write_word(state
, 143, 0);
1246 static int dib7000p_tune(struct dvb_frontend
*demod
)
1248 struct dtv_frontend_properties
*ch
= &demod
->dtv_property_cache
;
1249 struct dib7000p_state
*state
= demod
->demodulator_priv
;
1253 dib7000p_set_channel(state
, ch
, 0);
1258 dib7000p_write_word(state
, 770, 0x4000);
1259 dib7000p_write_word(state
, 770, 0x0000);
1262 /* P_ctrl_inh_cor=0, P_ctrl_alpha_cor=4, P_ctrl_inh_isi=0, P_ctrl_alpha_isi=3, P_ctrl_inh_cor4=1, P_ctrl_alpha_cor4=3 */
1263 tmp
= (0 << 14) | (4 << 10) | (0 << 9) | (3 << 5) | (1 << 4) | (0x3);
1264 if (state
->sfn_workaround_active
) {
1265 dprintk("SFN workaround is active");
1267 dib7000p_write_word(state
, 166, 0x4000);
1269 dib7000p_write_word(state
, 166, 0x0000);
1271 dib7000p_write_word(state
, 29, tmp
);
1273 // never achieved a lock with that bandwidth so far - wait for osc-freq to update
1274 if (state
->timf
== 0)
1277 /* offset loop parameters */
1279 /* P_timf_alpha, P_corm_alpha=6, P_corm_thres=0x80 */
1280 tmp
= (6 << 8) | 0x80;
1281 switch (ch
->transmission_mode
) {
1282 case TRANSMISSION_MODE_2K
:
1285 case TRANSMISSION_MODE_4K
:
1289 case TRANSMISSION_MODE_8K
:
1293 dib7000p_write_word(state
, 26, tmp
); /* timf_a(6xxx) */
1295 /* P_ctrl_freeze_pha_shift=0, P_ctrl_pha_off_max */
1297 switch (ch
->transmission_mode
) {
1298 case TRANSMISSION_MODE_2K
:
1301 case TRANSMISSION_MODE_4K
:
1305 case TRANSMISSION_MODE_8K
:
1309 dib7000p_write_word(state
, 32, tmp
);
1311 /* P_ctrl_sfreq_inh=0, P_ctrl_sfreq_step */
1313 switch (ch
->transmission_mode
) {
1314 case TRANSMISSION_MODE_2K
:
1317 case TRANSMISSION_MODE_4K
:
1321 case TRANSMISSION_MODE_8K
:
1325 dib7000p_write_word(state
, 33, tmp
);
1327 tmp
= dib7000p_read_word(state
, 509);
1328 if (!((tmp
>> 6) & 0x1)) {
1329 /* restart the fec */
1330 tmp
= dib7000p_read_word(state
, 771);
1331 dib7000p_write_word(state
, 771, tmp
| (1 << 1));
1332 dib7000p_write_word(state
, 771, tmp
);
1334 tmp
= dib7000p_read_word(state
, 509);
1336 // we achieved a lock - it's time to update the osc freq
1337 if ((tmp
>> 6) & 0x1) {
1338 dib7000p_update_timf(state
);
1339 /* P_timf_alpha += 2 */
1340 tmp
= dib7000p_read_word(state
, 26);
1341 dib7000p_write_word(state
, 26, (tmp
& ~(0xf << 12)) | ((((tmp
>> 12) & 0xf) + 5) << 12));
1344 if (state
->cfg
.spur_protect
)
1345 dib7000p_spur_protect(state
, ch
->frequency
/ 1000, BANDWIDTH_TO_KHZ(ch
->bandwidth_hz
));
1347 dib7000p_set_bandwidth(state
, BANDWIDTH_TO_KHZ(ch
->bandwidth_hz
));
1351 static int dib7000p_wakeup(struct dvb_frontend
*demod
)
1353 struct dib7000p_state
*state
= demod
->demodulator_priv
;
1354 dib7000p_set_power_mode(state
, DIB7000P_POWER_ALL
);
1355 dib7000p_set_adc_state(state
, DIBX000_SLOW_ADC_ON
);
1356 if (state
->version
== SOC7090
)
1357 dib7000p_sad_calib(state
);
1361 static int dib7000p_sleep(struct dvb_frontend
*demod
)
1363 struct dib7000p_state
*state
= demod
->demodulator_priv
;
1364 if (state
->version
== SOC7090
)
1365 return dib7000p_set_power_mode(state
, DIB7000P_POWER_INTERFACE_ONLY
);
1366 return dib7000p_set_output_mode(state
, OUTMODE_HIGH_Z
) | dib7000p_set_power_mode(state
, DIB7000P_POWER_INTERFACE_ONLY
);
1369 static int dib7000p_identify(struct dib7000p_state
*st
)
1372 dprintk("checking demod on I2C address: %d (%x)", st
->i2c_addr
, st
->i2c_addr
);
1374 if ((value
= dib7000p_read_word(st
, 768)) != 0x01b3) {
1375 dprintk("wrong Vendor ID (read=0x%x)", value
);
1379 if ((value
= dib7000p_read_word(st
, 769)) != 0x4000) {
1380 dprintk("wrong Device ID (%x)", value
);
1387 static int dib7000p_get_frontend(struct dvb_frontend
*fe
)
1389 struct dtv_frontend_properties
*fep
= &fe
->dtv_property_cache
;
1390 struct dib7000p_state
*state
= fe
->demodulator_priv
;
1391 u16 tps
= dib7000p_read_word(state
, 463);
1393 fep
->inversion
= INVERSION_AUTO
;
1395 fep
->bandwidth_hz
= BANDWIDTH_TO_HZ(state
->current_bandwidth
);
1397 switch ((tps
>> 8) & 0x3) {
1399 fep
->transmission_mode
= TRANSMISSION_MODE_2K
;
1402 fep
->transmission_mode
= TRANSMISSION_MODE_8K
;
1404 /* case 2: fep->transmission_mode = TRANSMISSION_MODE_4K; break; */
1407 switch (tps
& 0x3) {
1409 fep
->guard_interval
= GUARD_INTERVAL_1_32
;
1412 fep
->guard_interval
= GUARD_INTERVAL_1_16
;
1415 fep
->guard_interval
= GUARD_INTERVAL_1_8
;
1418 fep
->guard_interval
= GUARD_INTERVAL_1_4
;
1422 switch ((tps
>> 14) & 0x3) {
1424 fep
->modulation
= QPSK
;
1427 fep
->modulation
= QAM_16
;
1431 fep
->modulation
= QAM_64
;
1435 /* as long as the frontend_param structure is fixed for hierarchical transmission I refuse to use it */
1436 /* (tps >> 13) & 0x1 == hrch is used, (tps >> 10) & 0x7 == alpha */
1438 fep
->hierarchy
= HIERARCHY_NONE
;
1439 switch ((tps
>> 5) & 0x7) {
1441 fep
->code_rate_HP
= FEC_1_2
;
1444 fep
->code_rate_HP
= FEC_2_3
;
1447 fep
->code_rate_HP
= FEC_3_4
;
1450 fep
->code_rate_HP
= FEC_5_6
;
1454 fep
->code_rate_HP
= FEC_7_8
;
1459 switch ((tps
>> 2) & 0x7) {
1461 fep
->code_rate_LP
= FEC_1_2
;
1464 fep
->code_rate_LP
= FEC_2_3
;
1467 fep
->code_rate_LP
= FEC_3_4
;
1470 fep
->code_rate_LP
= FEC_5_6
;
1474 fep
->code_rate_LP
= FEC_7_8
;
1478 /* native interleaver: (dib7000p_read_word(state, 464) >> 5) & 0x1 */
1483 static int dib7000p_set_frontend(struct dvb_frontend
*fe
)
1485 struct dtv_frontend_properties
*fep
= &fe
->dtv_property_cache
;
1486 struct dib7000p_state
*state
= fe
->demodulator_priv
;
1489 if (state
->version
== SOC7090
)
1490 dib7090_set_diversity_in(fe
, 0);
1492 dib7000p_set_output_mode(state
, OUTMODE_HIGH_Z
);
1494 /* maybe the parameter has been changed */
1495 state
->sfn_workaround_active
= buggy_sfn_workaround
;
1497 if (fe
->ops
.tuner_ops
.set_params
)
1498 fe
->ops
.tuner_ops
.set_params(fe
);
1500 /* start up the AGC */
1501 state
->agc_state
= 0;
1503 time
= dib7000p_agc_startup(fe
);
1506 } while (time
!= -1);
1508 if (fep
->transmission_mode
== TRANSMISSION_MODE_AUTO
||
1509 fep
->guard_interval
== GUARD_INTERVAL_AUTO
|| fep
->modulation
== QAM_AUTO
|| fep
->code_rate_HP
== FEC_AUTO
) {
1512 dib7000p_autosearch_start(fe
);
1515 found
= dib7000p_autosearch_is_irq(fe
);
1516 } while (found
== 0 && i
--);
1518 dprintk("autosearch returns: %d", found
);
1519 if (found
== 0 || found
== 1)
1522 dib7000p_get_frontend(fe
);
1525 ret
= dib7000p_tune(fe
);
1527 /* make this a config parameter */
1528 if (state
->version
== SOC7090
) {
1529 dib7090_set_output_mode(fe
, state
->cfg
.output_mode
);
1530 if (state
->cfg
.enMpegOutput
== 0) {
1531 dib7090_setDibTxMux(state
, MPEG_ON_DIBTX
);
1532 dib7090_setHostBusMux(state
, DIBTX_ON_HOSTBUS
);
1535 dib7000p_set_output_mode(state
, state
->cfg
.output_mode
);
1540 static int dib7000p_read_status(struct dvb_frontend
*fe
, fe_status_t
* stat
)
1542 struct dib7000p_state
*state
= fe
->demodulator_priv
;
1543 u16 lock
= dib7000p_read_word(state
, 509);
1548 *stat
|= FE_HAS_SIGNAL
;
1550 *stat
|= FE_HAS_CARRIER
;
1552 *stat
|= FE_HAS_VITERBI
;
1554 *stat
|= FE_HAS_SYNC
;
1555 if ((lock
& 0x0038) == 0x38)
1556 *stat
|= FE_HAS_LOCK
;
1561 static int dib7000p_read_ber(struct dvb_frontend
*fe
, u32
* ber
)
1563 struct dib7000p_state
*state
= fe
->demodulator_priv
;
1564 *ber
= (dib7000p_read_word(state
, 500) << 16) | dib7000p_read_word(state
, 501);
1568 static int dib7000p_read_unc_blocks(struct dvb_frontend
*fe
, u32
* unc
)
1570 struct dib7000p_state
*state
= fe
->demodulator_priv
;
1571 *unc
= dib7000p_read_word(state
, 506);
1575 static int dib7000p_read_signal_strength(struct dvb_frontend
*fe
, u16
* strength
)
1577 struct dib7000p_state
*state
= fe
->demodulator_priv
;
1578 u16 val
= dib7000p_read_word(state
, 394);
1579 *strength
= 65535 - val
;
1583 static int dib7000p_read_snr(struct dvb_frontend
*fe
, u16
* snr
)
1585 struct dib7000p_state
*state
= fe
->demodulator_priv
;
1587 s32 signal_mant
, signal_exp
, noise_mant
, noise_exp
;
1590 val
= dib7000p_read_word(state
, 479);
1591 noise_mant
= (val
>> 4) & 0xff;
1592 noise_exp
= ((val
& 0xf) << 2);
1593 val
= dib7000p_read_word(state
, 480);
1594 noise_exp
+= ((val
>> 14) & 0x3);
1595 if ((noise_exp
& 0x20) != 0)
1598 signal_mant
= (val
>> 6) & 0xFF;
1599 signal_exp
= (val
& 0x3F);
1600 if ((signal_exp
& 0x20) != 0)
1603 if (signal_mant
!= 0)
1604 result
= intlog10(2) * 10 * signal_exp
+ 10 * intlog10(signal_mant
);
1606 result
= intlog10(2) * 10 * signal_exp
- 100;
1608 if (noise_mant
!= 0)
1609 result
-= intlog10(2) * 10 * noise_exp
+ 10 * intlog10(noise_mant
);
1611 result
-= intlog10(2) * 10 * noise_exp
- 100;
1613 *snr
= result
/ ((1 << 24) / 10);
1617 static int dib7000p_fe_get_tune_settings(struct dvb_frontend
*fe
, struct dvb_frontend_tune_settings
*tune
)
1619 tune
->min_delay_ms
= 1000;
1623 static void dib7000p_release(struct dvb_frontend
*demod
)
1625 struct dib7000p_state
*st
= demod
->demodulator_priv
;
1626 dibx000_exit_i2c_master(&st
->i2c_master
);
1627 i2c_del_adapter(&st
->dib7090_tuner_adap
);
1631 int dib7000pc_detection(struct i2c_adapter
*i2c_adap
)
1634 struct i2c_msg msg
[2] = {
1635 {.addr
= 18 >> 1, .flags
= 0, .len
= 2},
1636 {.addr
= 18 >> 1, .flags
= I2C_M_RD
, .len
= 2},
1640 tx
= kzalloc(2*sizeof(u8
), GFP_KERNEL
);
1643 rx
= kzalloc(2*sizeof(u8
), GFP_KERNEL
);
1646 goto rx_memory_error
;
1655 if (i2c_transfer(i2c_adap
, msg
, 2) == 2)
1656 if (rx
[0] == 0x01 && rx
[1] == 0xb3) {
1657 dprintk("-D- DiB7000PC detected");
1661 msg
[0].addr
= msg
[1].addr
= 0x40;
1663 if (i2c_transfer(i2c_adap
, msg
, 2) == 2)
1664 if (rx
[0] == 0x01 && rx
[1] == 0xb3) {
1665 dprintk("-D- DiB7000PC detected");
1669 dprintk("-D- DiB7000PC not detected");
1676 EXPORT_SYMBOL(dib7000pc_detection
);
1678 struct i2c_adapter
*dib7000p_get_i2c_master(struct dvb_frontend
*demod
, enum dibx000_i2c_interface intf
, int gating
)
1680 struct dib7000p_state
*st
= demod
->demodulator_priv
;
1681 return dibx000_get_i2c_adapter(&st
->i2c_master
, intf
, gating
);
1683 EXPORT_SYMBOL(dib7000p_get_i2c_master
);
1685 int dib7000p_pid_filter_ctrl(struct dvb_frontend
*fe
, u8 onoff
)
1687 struct dib7000p_state
*state
= fe
->demodulator_priv
;
1688 u16 val
= dib7000p_read_word(state
, 235) & 0xffef;
1689 val
|= (onoff
& 0x1) << 4;
1690 dprintk("PID filter enabled %d", onoff
);
1691 return dib7000p_write_word(state
, 235, val
);
1693 EXPORT_SYMBOL(dib7000p_pid_filter_ctrl
);
1695 int dib7000p_pid_filter(struct dvb_frontend
*fe
, u8 id
, u16 pid
, u8 onoff
)
1697 struct dib7000p_state
*state
= fe
->demodulator_priv
;
1698 dprintk("PID filter: index %x, PID %d, OnOff %d", id
, pid
, onoff
);
1699 return dib7000p_write_word(state
, 241 + id
, onoff
? (1 << 13) | pid
: 0);
1701 EXPORT_SYMBOL(dib7000p_pid_filter
);
1703 int dib7000p_i2c_enumeration(struct i2c_adapter
*i2c
, int no_of_demods
, u8 default_addr
, struct dib7000p_config cfg
[])
1705 struct dib7000p_state
*dpst
;
1709 dpst
= kzalloc(sizeof(struct dib7000p_state
), GFP_KERNEL
);
1713 dpst
->i2c_adap
= i2c
;
1714 mutex_init(&dpst
->i2c_buffer_lock
);
1716 for (k
= no_of_demods
- 1; k
>= 0; k
--) {
1719 /* designated i2c address */
1720 if (cfg
[k
].default_i2c_addr
!= 0)
1721 new_addr
= cfg
[k
].default_i2c_addr
+ (k
<< 1);
1723 new_addr
= (0x40 + k
) << 1;
1724 dpst
->i2c_addr
= new_addr
;
1725 dib7000p_write_word(dpst
, 1287, 0x0003); /* sram lead in, rdy */
1726 if (dib7000p_identify(dpst
) != 0) {
1727 dpst
->i2c_addr
= default_addr
;
1728 dib7000p_write_word(dpst
, 1287, 0x0003); /* sram lead in, rdy */
1729 if (dib7000p_identify(dpst
) != 0) {
1730 dprintk("DiB7000P #%d: not identified\n", k
);
1736 /* start diversity to pull_down div_str - just for i2c-enumeration */
1737 dib7000p_set_output_mode(dpst
, OUTMODE_DIVERSITY
);
1739 /* set new i2c address and force divstart */
1740 dib7000p_write_word(dpst
, 1285, (new_addr
<< 2) | 0x2);
1742 dprintk("IC %d initialized (to i2c_address 0x%x)", k
, new_addr
);
1745 for (k
= 0; k
< no_of_demods
; k
++) {
1747 if (cfg
[k
].default_i2c_addr
!= 0)
1748 dpst
->i2c_addr
= (cfg
[k
].default_i2c_addr
+ k
) << 1;
1750 dpst
->i2c_addr
= (0x40 + k
) << 1;
1753 dib7000p_write_word(dpst
, 1285, dpst
->i2c_addr
<< 2);
1755 /* deactivate div - it was just for i2c-enumeration */
1756 dib7000p_set_output_mode(dpst
, OUTMODE_HIGH_Z
);
1762 EXPORT_SYMBOL(dib7000p_i2c_enumeration
);
1764 static const s32 lut_1000ln_mant
[] = {
1765 6908, 6956, 7003, 7047, 7090, 7131, 7170, 7208, 7244, 7279, 7313, 7346, 7377, 7408, 7438, 7467, 7495, 7523, 7549, 7575, 7600
1768 static s32
dib7000p_get_adc_power(struct dvb_frontend
*fe
)
1770 struct dib7000p_state
*state
= fe
->demodulator_priv
;
1771 u32 tmp_val
= 0, exp
= 0, mant
= 0;
1776 buf
[0] = dib7000p_read_word(state
, 0x184);
1777 buf
[1] = dib7000p_read_word(state
, 0x185);
1778 pow_i
= (buf
[0] << 16) | buf
[1];
1779 dprintk("raw pow_i = %d", pow_i
);
1782 while (tmp_val
>>= 1)
1785 mant
= (pow_i
* 1000 / (1 << exp
));
1786 dprintk(" mant = %d exp = %d", mant
/ 1000, exp
);
1788 ix
= (u8
) ((mant
- 1000) / 100); /* index of the LUT */
1789 dprintk(" ix = %d", ix
);
1791 pow_i
= (lut_1000ln_mant
[ix
] + 693 * (exp
- 20) - 6908);
1792 pow_i
= (pow_i
<< 8) / 1000;
1793 dprintk(" pow_i = %d", pow_i
);
1798 static int map_addr_to_serpar_number(struct i2c_msg
*msg
)
1800 if ((msg
->buf
[0] <= 15))
1802 else if (msg
->buf
[0] == 17)
1804 else if (msg
->buf
[0] == 16)
1806 else if (msg
->buf
[0] == 19)
1808 else if (msg
->buf
[0] >= 21 && msg
->buf
[0] <= 25)
1810 else if (msg
->buf
[0] == 28)
1817 static int w7090p_tuner_write_serpar(struct i2c_adapter
*i2c_adap
, struct i2c_msg msg
[], int num
)
1819 struct dib7000p_state
*state
= i2c_get_adapdata(i2c_adap
);
1822 u16 serpar_num
= msg
[0].buf
[0];
1824 while (n_overflow
== 1 && i
) {
1825 n_overflow
= (dib7000p_read_word(state
, 1984) >> 1) & 0x1;
1828 dprintk("Tuner ITF: write busy (overflow)");
1830 dib7000p_write_word(state
, 1985, (1 << 6) | (serpar_num
& 0x3f));
1831 dib7000p_write_word(state
, 1986, (msg
[0].buf
[1] << 8) | msg
[0].buf
[2]);
1836 static int w7090p_tuner_read_serpar(struct i2c_adapter
*i2c_adap
, struct i2c_msg msg
[], int num
)
1838 struct dib7000p_state
*state
= i2c_get_adapdata(i2c_adap
);
1839 u8 n_overflow
= 1, n_empty
= 1;
1841 u16 serpar_num
= msg
[0].buf
[0];
1844 while (n_overflow
== 1 && i
) {
1845 n_overflow
= (dib7000p_read_word(state
, 1984) >> 1) & 0x1;
1848 dprintk("TunerITF: read busy (overflow)");
1850 dib7000p_write_word(state
, 1985, (0 << 6) | (serpar_num
& 0x3f));
1853 while (n_empty
== 1 && i
) {
1854 n_empty
= dib7000p_read_word(state
, 1984) & 0x1;
1857 dprintk("TunerITF: read busy (empty)");
1859 read_word
= dib7000p_read_word(state
, 1987);
1860 msg
[1].buf
[0] = (read_word
>> 8) & 0xff;
1861 msg
[1].buf
[1] = (read_word
) & 0xff;
1866 static int w7090p_tuner_rw_serpar(struct i2c_adapter
*i2c_adap
, struct i2c_msg msg
[], int num
)
1868 if (map_addr_to_serpar_number(&msg
[0]) == 0) { /* else = Tuner regs to ignore : DIG_CFG, CTRL_RF_LT, PLL_CFG, PWM1_REG, ADCCLK, DIG_CFG_3; SLEEP_EN... */
1869 if (num
== 1) { /* write */
1870 return w7090p_tuner_write_serpar(i2c_adap
, msg
, 1);
1872 return w7090p_tuner_read_serpar(i2c_adap
, msg
, 2);
1878 static int dib7090p_rw_on_apb(struct i2c_adapter
*i2c_adap
,
1879 struct i2c_msg msg
[], int num
, u16 apb_address
)
1881 struct dib7000p_state
*state
= i2c_get_adapdata(i2c_adap
);
1884 if (num
== 1) { /* write */
1885 dib7000p_write_word(state
, apb_address
, ((msg
[0].buf
[1] << 8) | (msg
[0].buf
[2])));
1887 word
= dib7000p_read_word(state
, apb_address
);
1888 msg
[1].buf
[0] = (word
>> 8) & 0xff;
1889 msg
[1].buf
[1] = (word
) & 0xff;
1895 static int dib7090_tuner_xfer(struct i2c_adapter
*i2c_adap
, struct i2c_msg msg
[], int num
)
1897 struct dib7000p_state
*state
= i2c_get_adapdata(i2c_adap
);
1899 u16 apb_address
= 0, word
;
1901 switch (msg
[0].buf
[0]) {
1987 i
= ((dib7000p_read_word(state
, 72) >> 12) & 0x3);
1988 word
= dib7000p_read_word(state
, 384 + i
);
1989 msg
[1].buf
[0] = (word
>> 8) & 0xff;
1990 msg
[1].buf
[1] = (word
) & 0xff;
1993 if (num
== 1) { /* write */
1994 word
= (u16
) ((msg
[0].buf
[1] << 8) | msg
[0].buf
[2]);
1996 word
= (dib7000p_read_word(state
, 72) & ~(3 << 12)) | (word
<< 12);
1997 dib7000p_write_word(state
, 72, word
); /* Set the proper input */
2002 if (apb_address
!= 0) /* R/W acces via APB */
2003 return dib7090p_rw_on_apb(i2c_adap
, msg
, num
, apb_address
);
2004 else /* R/W access via SERPAR */
2005 return w7090p_tuner_rw_serpar(i2c_adap
, msg
, num
);
2010 static u32
dib7000p_i2c_func(struct i2c_adapter
*adapter
)
2012 return I2C_FUNC_I2C
;
2015 static struct i2c_algorithm dib7090_tuner_xfer_algo
= {
2016 .master_xfer
= dib7090_tuner_xfer
,
2017 .functionality
= dib7000p_i2c_func
,
2020 struct i2c_adapter
*dib7090_get_i2c_tuner(struct dvb_frontend
*fe
)
2022 struct dib7000p_state
*st
= fe
->demodulator_priv
;
2023 return &st
->dib7090_tuner_adap
;
2025 EXPORT_SYMBOL(dib7090_get_i2c_tuner
);
2027 static int dib7090_host_bus_drive(struct dib7000p_state
*state
, u8 drive
)
2031 /* drive host bus 2, 3, 4 */
2032 reg
= dib7000p_read_word(state
, 1798) & ~((0x7) | (0x7 << 6) | (0x7 << 12));
2033 reg
|= (drive
<< 12) | (drive
<< 6) | drive
;
2034 dib7000p_write_word(state
, 1798, reg
);
2036 /* drive host bus 5,6 */
2037 reg
= dib7000p_read_word(state
, 1799) & ~((0x7 << 2) | (0x7 << 8));
2038 reg
|= (drive
<< 8) | (drive
<< 2);
2039 dib7000p_write_word(state
, 1799, reg
);
2041 /* drive host bus 7, 8, 9 */
2042 reg
= dib7000p_read_word(state
, 1800) & ~((0x7) | (0x7 << 6) | (0x7 << 12));
2043 reg
|= (drive
<< 12) | (drive
<< 6) | drive
;
2044 dib7000p_write_word(state
, 1800, reg
);
2046 /* drive host bus 10, 11 */
2047 reg
= dib7000p_read_word(state
, 1801) & ~((0x7 << 2) | (0x7 << 8));
2048 reg
|= (drive
<< 8) | (drive
<< 2);
2049 dib7000p_write_word(state
, 1801, reg
);
2051 /* drive host bus 12, 13, 14 */
2052 reg
= dib7000p_read_word(state
, 1802) & ~((0x7) | (0x7 << 6) | (0x7 << 12));
2053 reg
|= (drive
<< 12) | (drive
<< 6) | drive
;
2054 dib7000p_write_word(state
, 1802, reg
);
2059 static u32
dib7090_calcSyncFreq(u32 P_Kin
, u32 P_Kout
, u32 insertExtSynchro
, u32 syncSize
)
2062 u32 nom
= (insertExtSynchro
* P_Kin
+ syncSize
);
2064 u32 syncFreq
= ((nom
<< quantif
) / denom
);
2066 if ((syncFreq
& ((1 << quantif
) - 1)) != 0)
2067 syncFreq
= (syncFreq
>> quantif
) + 1;
2069 syncFreq
= (syncFreq
>> quantif
);
2072 syncFreq
= syncFreq
- 1;
2077 static int dib7090_cfg_DibTx(struct dib7000p_state
*state
, u32 P_Kin
, u32 P_Kout
, u32 insertExtSynchro
, u32 synchroMode
, u32 syncWord
, u32 syncSize
)
2079 dprintk("Configure DibStream Tx");
2081 dib7000p_write_word(state
, 1615, 1);
2082 dib7000p_write_word(state
, 1603, P_Kin
);
2083 dib7000p_write_word(state
, 1605, P_Kout
);
2084 dib7000p_write_word(state
, 1606, insertExtSynchro
);
2085 dib7000p_write_word(state
, 1608, synchroMode
);
2086 dib7000p_write_word(state
, 1609, (syncWord
>> 16) & 0xffff);
2087 dib7000p_write_word(state
, 1610, syncWord
& 0xffff);
2088 dib7000p_write_word(state
, 1612, syncSize
);
2089 dib7000p_write_word(state
, 1615, 0);
2094 static int dib7090_cfg_DibRx(struct dib7000p_state
*state
, u32 P_Kin
, u32 P_Kout
, u32 synchroMode
, u32 insertExtSynchro
, u32 syncWord
, u32 syncSize
,
2099 dprintk("Configure DibStream Rx");
2100 if ((P_Kin
!= 0) && (P_Kout
!= 0)) {
2101 syncFreq
= dib7090_calcSyncFreq(P_Kin
, P_Kout
, insertExtSynchro
, syncSize
);
2102 dib7000p_write_word(state
, 1542, syncFreq
);
2104 dib7000p_write_word(state
, 1554, 1);
2105 dib7000p_write_word(state
, 1536, P_Kin
);
2106 dib7000p_write_word(state
, 1537, P_Kout
);
2107 dib7000p_write_word(state
, 1539, synchroMode
);
2108 dib7000p_write_word(state
, 1540, (syncWord
>> 16) & 0xffff);
2109 dib7000p_write_word(state
, 1541, syncWord
& 0xffff);
2110 dib7000p_write_word(state
, 1543, syncSize
);
2111 dib7000p_write_word(state
, 1544, dataOutRate
);
2112 dib7000p_write_word(state
, 1554, 0);
2117 static void dib7090_enMpegMux(struct dib7000p_state
*state
, int onoff
)
2119 u16 reg_1287
= dib7000p_read_word(state
, 1287);
2123 reg_1287
&= ~(1<<7);
2130 dib7000p_write_word(state
, 1287, reg_1287
);
2133 static void dib7090_configMpegMux(struct dib7000p_state
*state
,
2134 u16 pulseWidth
, u16 enSerialMode
, u16 enSerialClkDiv2
)
2136 dprintk("Enable Mpeg mux");
2138 dib7090_enMpegMux(state
, 0);
2140 /* If the input mode is MPEG do not divide the serial clock */
2141 if ((enSerialMode
== 1) && (state
->input_mode_mpeg
== 1))
2142 enSerialClkDiv2
= 0;
2144 dib7000p_write_word(state
, 1287, ((pulseWidth
& 0x1f) << 2)
2145 | ((enSerialMode
& 0x1) << 1)
2146 | (enSerialClkDiv2
& 0x1));
2148 dib7090_enMpegMux(state
, 1);
2151 static void dib7090_setDibTxMux(struct dib7000p_state
*state
, int mode
)
2153 u16 reg_1288
= dib7000p_read_word(state
, 1288) & ~(0x7 << 7);
2157 dprintk("SET MPEG ON DIBSTREAM TX");
2158 dib7090_cfg_DibTx(state
, 8, 5, 0, 0, 0, 0);
2162 dprintk("SET DIV_OUT ON DIBSTREAM TX");
2163 dib7090_cfg_DibTx(state
, 5, 5, 0, 0, 0, 0);
2167 dprintk("SET ADC_OUT ON DIBSTREAM TX");
2168 dib7090_cfg_DibTx(state
, 20, 5, 10, 0, 0, 0);
2174 dib7000p_write_word(state
, 1288, reg_1288
);
2177 static void dib7090_setHostBusMux(struct dib7000p_state
*state
, int mode
)
2179 u16 reg_1288
= dib7000p_read_word(state
, 1288) & ~(0x7 << 4);
2182 case DEMOUT_ON_HOSTBUS
:
2183 dprintk("SET DEM OUT OLD INTERF ON HOST BUS");
2184 dib7090_enMpegMux(state
, 0);
2187 case DIBTX_ON_HOSTBUS
:
2188 dprintk("SET DIBSTREAM TX ON HOST BUS");
2189 dib7090_enMpegMux(state
, 0);
2192 case MPEG_ON_HOSTBUS
:
2193 dprintk("SET MPEG MUX ON HOST BUS");
2199 dib7000p_write_word(state
, 1288, reg_1288
);
2202 int dib7090_set_diversity_in(struct dvb_frontend
*fe
, int onoff
)
2204 struct dib7000p_state
*state
= fe
->demodulator_priv
;
2208 case 0: /* only use the internal way - not the diversity input */
2209 dprintk("%s mode OFF : by default Enable Mpeg INPUT", __func__
);
2210 dib7090_cfg_DibRx(state
, 8, 5, 0, 0, 0, 8, 0);
2212 /* Do not divide the serial clock of MPEG MUX */
2213 /* in SERIAL MODE in case input mode MPEG is used */
2214 reg_1287
= dib7000p_read_word(state
, 1287);
2215 /* enSerialClkDiv2 == 1 ? */
2216 if ((reg_1287
& 0x1) == 1) {
2217 /* force enSerialClkDiv2 = 0 */
2219 dib7000p_write_word(state
, 1287, reg_1287
);
2221 state
->input_mode_mpeg
= 1;
2223 case 1: /* both ways */
2224 case 2: /* only the diversity input */
2225 dprintk("%s ON : Enable diversity INPUT", __func__
);
2226 dib7090_cfg_DibRx(state
, 5, 5, 0, 0, 0, 0, 0);
2227 state
->input_mode_mpeg
= 0;
2231 dib7000p_set_diversity_in(&state
->demod
, onoff
);
2235 static int dib7090_set_output_mode(struct dvb_frontend
*fe
, int mode
)
2237 struct dib7000p_state
*state
= fe
->demodulator_priv
;
2239 u16 outreg
, smo_mode
, fifo_threshold
;
2240 u8 prefer_mpeg_mux_use
= 1;
2243 dib7090_host_bus_drive(state
, 1);
2245 fifo_threshold
= 1792;
2246 smo_mode
= (dib7000p_read_word(state
, 235) & 0x0050) | (1 << 1);
2247 outreg
= dib7000p_read_word(state
, 1286) & ~((1 << 10) | (0x7 << 6) | (1 << 1));
2250 case OUTMODE_HIGH_Z
:
2254 case OUTMODE_MPEG2_SERIAL
:
2255 if (prefer_mpeg_mux_use
) {
2256 dprintk("setting output mode TS_SERIAL using Mpeg Mux");
2257 dib7090_configMpegMux(state
, 3, 1, 1);
2258 dib7090_setHostBusMux(state
, MPEG_ON_HOSTBUS
);
2259 } else {/* Use Smooth block */
2260 dprintk("setting output mode TS_SERIAL using Smooth bloc");
2261 dib7090_setHostBusMux(state
, DEMOUT_ON_HOSTBUS
);
2262 outreg
|= (2<<6) | (0 << 1);
2266 case OUTMODE_MPEG2_PAR_GATED_CLK
:
2267 if (prefer_mpeg_mux_use
) {
2268 dprintk("setting output mode TS_PARALLEL_GATED using Mpeg Mux");
2269 dib7090_configMpegMux(state
, 2, 0, 0);
2270 dib7090_setHostBusMux(state
, MPEG_ON_HOSTBUS
);
2271 } else { /* Use Smooth block */
2272 dprintk("setting output mode TS_PARALLEL_GATED using Smooth block");
2273 dib7090_setHostBusMux(state
, DEMOUT_ON_HOSTBUS
);
2278 case OUTMODE_MPEG2_PAR_CONT_CLK
: /* Using Smooth block only */
2279 dprintk("setting output mode TS_PARALLEL_CONT using Smooth block");
2280 dib7090_setHostBusMux(state
, DEMOUT_ON_HOSTBUS
);
2284 case OUTMODE_MPEG2_FIFO
: /* Using Smooth block because not supported by new Mpeg Mux bloc */
2285 dprintk("setting output mode TS_FIFO using Smooth block");
2286 dib7090_setHostBusMux(state
, DEMOUT_ON_HOSTBUS
);
2288 smo_mode
|= (3 << 1);
2289 fifo_threshold
= 512;
2292 case OUTMODE_DIVERSITY
:
2293 dprintk("setting output mode MODE_DIVERSITY");
2294 dib7090_setDibTxMux(state
, DIV_ON_DIBTX
);
2295 dib7090_setHostBusMux(state
, DIBTX_ON_HOSTBUS
);
2298 case OUTMODE_ANALOG_ADC
:
2299 dprintk("setting output mode MODE_ANALOG_ADC");
2300 dib7090_setDibTxMux(state
, ADC_ON_DIBTX
);
2301 dib7090_setHostBusMux(state
, DIBTX_ON_HOSTBUS
);
2304 if (mode
!= OUTMODE_HIGH_Z
)
2305 outreg
|= (1 << 10);
2307 if (state
->cfg
.output_mpeg2_in_188_bytes
)
2308 smo_mode
|= (1 << 5);
2310 ret
|= dib7000p_write_word(state
, 235, smo_mode
);
2311 ret
|= dib7000p_write_word(state
, 236, fifo_threshold
); /* synchronous fread */
2312 ret
|= dib7000p_write_word(state
, 1286, outreg
);
2317 int dib7090_tuner_sleep(struct dvb_frontend
*fe
, int onoff
)
2319 struct dib7000p_state
*state
= fe
->demodulator_priv
;
2322 dprintk("sleep dib7090: %d", onoff
);
2324 en_cur_state
= dib7000p_read_word(state
, 1922);
2326 if (en_cur_state
> 0xff)
2327 state
->tuner_enable
= en_cur_state
;
2330 en_cur_state
&= 0x00ff;
2332 if (state
->tuner_enable
!= 0)
2333 en_cur_state
= state
->tuner_enable
;
2336 dib7000p_write_word(state
, 1922, en_cur_state
);
2340 EXPORT_SYMBOL(dib7090_tuner_sleep
);
2342 int dib7090_get_adc_power(struct dvb_frontend
*fe
)
2344 return dib7000p_get_adc_power(fe
);
2346 EXPORT_SYMBOL(dib7090_get_adc_power
);
2348 int dib7090_slave_reset(struct dvb_frontend
*fe
)
2350 struct dib7000p_state
*state
= fe
->demodulator_priv
;
2353 reg
= dib7000p_read_word(state
, 1794);
2354 dib7000p_write_word(state
, 1794, reg
| (4 << 12));
2356 dib7000p_write_word(state
, 1032, 0xffff);
2359 EXPORT_SYMBOL(dib7090_slave_reset
);
2361 static struct dvb_frontend_ops dib7000p_ops
;
2362 struct dvb_frontend
*dib7000p_attach(struct i2c_adapter
*i2c_adap
, u8 i2c_addr
, struct dib7000p_config
*cfg
)
2364 struct dvb_frontend
*demod
;
2365 struct dib7000p_state
*st
;
2366 st
= kzalloc(sizeof(struct dib7000p_state
), GFP_KERNEL
);
2370 memcpy(&st
->cfg
, cfg
, sizeof(struct dib7000p_config
));
2371 st
->i2c_adap
= i2c_adap
;
2372 st
->i2c_addr
= i2c_addr
;
2373 st
->gpio_val
= cfg
->gpio_val
;
2374 st
->gpio_dir
= cfg
->gpio_dir
;
2376 /* Ensure the output mode remains at the previous default if it's
2377 * not specifically set by the caller.
2379 if ((st
->cfg
.output_mode
!= OUTMODE_MPEG2_SERIAL
) && (st
->cfg
.output_mode
!= OUTMODE_MPEG2_PAR_GATED_CLK
))
2380 st
->cfg
.output_mode
= OUTMODE_MPEG2_FIFO
;
2383 demod
->demodulator_priv
= st
;
2384 memcpy(&st
->demod
.ops
, &dib7000p_ops
, sizeof(struct dvb_frontend_ops
));
2385 mutex_init(&st
->i2c_buffer_lock
);
2387 dib7000p_write_word(st
, 1287, 0x0003); /* sram lead in, rdy */
2389 if (dib7000p_identify(st
) != 0)
2392 st
->version
= dib7000p_read_word(st
, 897);
2394 /* FIXME: make sure the dev.parent field is initialized, or else
2395 request_firmware() will hit an OOPS (this should be moved somewhere
2397 st
->i2c_master
.gated_tuner_i2c_adap
.dev
.parent
= i2c_adap
->dev
.parent
;
2399 /* FIXME: make sure the dev.parent field is initialized, or else
2400 request_firmware() will hit an OOPS (this should be moved somewhere
2402 st
->i2c_master
.gated_tuner_i2c_adap
.dev
.parent
= i2c_adap
->dev
.parent
;
2404 dibx000_init_i2c_master(&st
->i2c_master
, DIB7000P
, st
->i2c_adap
, st
->i2c_addr
);
2406 /* init 7090 tuner adapter */
2407 strncpy(st
->dib7090_tuner_adap
.name
, "DiB7090 tuner interface", sizeof(st
->dib7090_tuner_adap
.name
));
2408 st
->dib7090_tuner_adap
.algo
= &dib7090_tuner_xfer_algo
;
2409 st
->dib7090_tuner_adap
.algo_data
= NULL
;
2410 st
->dib7090_tuner_adap
.dev
.parent
= st
->i2c_adap
->dev
.parent
;
2411 i2c_set_adapdata(&st
->dib7090_tuner_adap
, st
);
2412 i2c_add_adapter(&st
->dib7090_tuner_adap
);
2414 dib7000p_demod_reset(st
);
2416 if (st
->version
== SOC7090
) {
2417 dib7090_set_output_mode(demod
, st
->cfg
.output_mode
);
2418 dib7090_set_diversity_in(demod
, 0);
2427 EXPORT_SYMBOL(dib7000p_attach
);
2429 static struct dvb_frontend_ops dib7000p_ops
= {
2430 .delsys
= { SYS_DVBT
},
2432 .name
= "DiBcom 7000PC",
2433 .frequency_min
= 44250000,
2434 .frequency_max
= 867250000,
2435 .frequency_stepsize
= 62500,
2436 .caps
= FE_CAN_INVERSION_AUTO
|
2437 FE_CAN_FEC_1_2
| FE_CAN_FEC_2_3
| FE_CAN_FEC_3_4
|
2438 FE_CAN_FEC_5_6
| FE_CAN_FEC_7_8
| FE_CAN_FEC_AUTO
|
2439 FE_CAN_QPSK
| FE_CAN_QAM_16
| FE_CAN_QAM_64
| FE_CAN_QAM_AUTO
|
2440 FE_CAN_TRANSMISSION_MODE_AUTO
| FE_CAN_GUARD_INTERVAL_AUTO
| FE_CAN_RECOVER
| FE_CAN_HIERARCHY_AUTO
,
2443 .release
= dib7000p_release
,
2445 .init
= dib7000p_wakeup
,
2446 .sleep
= dib7000p_sleep
,
2448 .set_frontend
= dib7000p_set_frontend
,
2449 .get_tune_settings
= dib7000p_fe_get_tune_settings
,
2450 .get_frontend
= dib7000p_get_frontend
,
2452 .read_status
= dib7000p_read_status
,
2453 .read_ber
= dib7000p_read_ber
,
2454 .read_signal_strength
= dib7000p_read_signal_strength
,
2455 .read_snr
= dib7000p_read_snr
,
2456 .read_ucblocks
= dib7000p_read_unc_blocks
,
2459 MODULE_AUTHOR("Olivier Grenie <ogrenie@dibcom.fr>");
2460 MODULE_AUTHOR("Patrick Boettcher <pboettcher@dibcom.fr>");
2461 MODULE_DESCRIPTION("Driver for the DiBcom 7000PC COFDM demodulator");
2462 MODULE_LICENSE("GPL");