V4L/DVB (6962): tda18271: allow device-specific configuration of IF frequency and...
[linux-2.6] / drivers / media / dvb / frontends / dib7000p.c
1 /*
2  * Linux-DVB Driver for DiBcom's second generation DiB7000P (PC).
3  *
4  * Copyright (C) 2005-7 DiBcom (http://www.dibcom.fr/)
5  *
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.
9  */
10 #include <linux/kernel.h>
11 #include <linux/i2c.h>
12
13 #include "dvb_frontend.h"
14
15 #include "dib7000p.h"
16
17 static int debug;
18 module_param(debug, int, 0644);
19 MODULE_PARM_DESC(debug, "turn on debugging (default: 0)");
20
21 static int buggy_sfn_workaround;
22 module_param(buggy_sfn_workaround, int, 0644);
23 MODULE_PARM_DESC(buggy_sfn_workaround, "Enable work-around for buggy SFNs (default: 0)");
24
25 #define dprintk(args...) do { if (debug) { printk(KERN_DEBUG "DiB7000P: "); printk(args); printk("\n"); } } while (0)
26
27 struct dib7000p_state {
28         struct dvb_frontend demod;
29     struct dib7000p_config cfg;
30
31         u8 i2c_addr;
32         struct i2c_adapter   *i2c_adap;
33
34         struct dibx000_i2c_master i2c_master;
35
36         u16 wbd_ref;
37
38         u8 current_band;
39         fe_bandwidth_t current_bandwidth;
40         struct dibx000_agc_config *current_agc;
41         u32 timf;
42
43         u8 div_force_off : 1;
44         u8 div_state : 1;
45         u16 div_sync_wait;
46
47         u8 agc_state;
48
49         u16 gpio_dir;
50         u16 gpio_val;
51
52         u8 sfn_workaround_active :1;
53 };
54
55 enum dib7000p_power_mode {
56         DIB7000P_POWER_ALL = 0,
57         DIB7000P_POWER_ANALOG_ADC,
58         DIB7000P_POWER_INTERFACE_ONLY,
59 };
60
61 static u16 dib7000p_read_word(struct dib7000p_state *state, u16 reg)
62 {
63         u8 wb[2] = { reg >> 8, reg & 0xff };
64         u8 rb[2];
65         struct i2c_msg msg[2] = {
66                 { .addr = state->i2c_addr >> 1, .flags = 0,        .buf = wb, .len = 2 },
67                 { .addr = state->i2c_addr >> 1, .flags = I2C_M_RD, .buf = rb, .len = 2 },
68         };
69
70         if (i2c_transfer(state->i2c_adap, msg, 2) != 2)
71                 dprintk("i2c read error on %d",reg);
72
73         return (rb[0] << 8) | rb[1];
74 }
75
76 static int dib7000p_write_word(struct dib7000p_state *state, u16 reg, u16 val)
77 {
78         u8 b[4] = {
79                 (reg >> 8) & 0xff, reg & 0xff,
80                 (val >> 8) & 0xff, val & 0xff,
81         };
82         struct i2c_msg msg = {
83                 .addr = state->i2c_addr >> 1, .flags = 0, .buf = b, .len = 4
84         };
85         return i2c_transfer(state->i2c_adap, &msg, 1) != 1 ? -EREMOTEIO : 0;
86 }
87 static void dib7000p_write_tab(struct dib7000p_state *state, u16 *buf)
88 {
89         u16 l = 0, r, *n;
90         n = buf;
91         l = *n++;
92         while (l) {
93                 r = *n++;
94
95                 do {
96                         dib7000p_write_word(state, r, *n++);
97                         r++;
98                 } while (--l);
99                 l = *n++;
100         }
101 }
102
103 static int dib7000p_set_output_mode(struct dib7000p_state *state, int mode)
104 {
105         int    ret = 0;
106         u16 outreg, fifo_threshold, smo_mode;
107
108         outreg = 0;
109         fifo_threshold = 1792;
110         smo_mode = (dib7000p_read_word(state, 235) & 0x0010) | (1 << 1);
111
112         dprintk( "setting output mode for demod %p to %d",
113                         &state->demod, mode);
114
115         switch (mode) {
116                 case OUTMODE_MPEG2_PAR_GATED_CLK:   // STBs with parallel gated clock
117                         outreg = (1 << 10);  /* 0x0400 */
118                         break;
119                 case OUTMODE_MPEG2_PAR_CONT_CLK:    // STBs with parallel continues clock
120                         outreg = (1 << 10) | (1 << 6); /* 0x0440 */
121                         break;
122                 case OUTMODE_MPEG2_SERIAL:          // STBs with serial input
123                         outreg = (1 << 10) | (2 << 6) | (0 << 1); /* 0x0480 */
124                         break;
125                 case OUTMODE_DIVERSITY:
126                         if (state->cfg.hostbus_diversity)
127                                 outreg = (1 << 10) | (4 << 6); /* 0x0500 */
128                         else
129                                 outreg = (1 << 11);
130                         break;
131                 case OUTMODE_MPEG2_FIFO:            // e.g. USB feeding
132                         smo_mode |= (3 << 1);
133                         fifo_threshold = 512;
134                         outreg = (1 << 10) | (5 << 6);
135                         break;
136                 case OUTMODE_ANALOG_ADC:
137                         outreg = (1 << 10) | (3 << 6);
138                         break;
139                 case OUTMODE_HIGH_Z:  // disable
140                         outreg = 0;
141                         break;
142                 default:
143                         dprintk( "Unhandled output_mode passed to be set for demod %p",&state->demod);
144                         break;
145         }
146
147         if (state->cfg.output_mpeg2_in_188_bytes)
148                 smo_mode |= (1 << 5) ;
149
150         ret |= dib7000p_write_word(state,  235, smo_mode);
151         ret |= dib7000p_write_word(state,  236, fifo_threshold); /* synchronous fread */
152         ret |= dib7000p_write_word(state, 1286, outreg);         /* P_Div_active */
153
154         return ret;
155 }
156
157 static int dib7000p_set_diversity_in(struct dvb_frontend *demod, int onoff)
158 {
159         struct dib7000p_state *state = demod->demodulator_priv;
160
161         if (state->div_force_off) {
162                 dprintk( "diversity combination deactivated - forced by COFDM parameters");
163                 onoff = 0;
164         }
165         state->div_state = (u8)onoff;
166
167         if (onoff) {
168                 dib7000p_write_word(state, 204, 6);
169                 dib7000p_write_word(state, 205, 16);
170                 /* P_dvsy_sync_mode = 0, P_dvsy_sync_enable=1, P_dvcb_comb_mode=2 */
171                 dib7000p_write_word(state, 207, (state->div_sync_wait << 4) | (1 << 2) | (2 << 0));
172         } else {
173                 dib7000p_write_word(state, 204, 1);
174                 dib7000p_write_word(state, 205, 0);
175                 dib7000p_write_word(state, 207, 0);
176         }
177
178         return 0;
179 }
180
181 static int dib7000p_set_power_mode(struct dib7000p_state *state, enum dib7000p_power_mode mode)
182 {
183         /* by default everything is powered off */
184         u16 reg_774 = 0xffff, reg_775 = 0xffff, reg_776 = 0x0007, reg_899  = 0x0003,
185                 reg_1280 = (0xfe00) | (dib7000p_read_word(state, 1280) & 0x01ff);
186
187         /* now, depending on the requested mode, we power on */
188         switch (mode) {
189                 /* power up everything in the demod */
190                 case DIB7000P_POWER_ALL:
191                         reg_774 = 0x0000; reg_775 = 0x0000; reg_776 = 0x0; reg_899 = 0x0; reg_1280 &= 0x01ff;
192                         break;
193
194                 case DIB7000P_POWER_ANALOG_ADC:
195                         /* dem, cfg, iqc, sad, agc */
196                         reg_774 &= ~((1 << 15) | (1 << 14) | (1 << 11) | (1 << 10) | (1 << 9));
197                         /* nud */
198                         reg_776 &= ~((1 << 0));
199                         /* Dout */
200                         reg_1280 &= ~((1 << 11));
201                         /* fall through wanted to enable the interfaces */
202
203                 /* just leave power on the control-interfaces: GPIO and (I2C or SDIO) */
204                 case DIB7000P_POWER_INTERFACE_ONLY: /* TODO power up either SDIO or I2C */
205                         reg_1280 &= ~((1 << 14) | (1 << 13) | (1 << 12) | (1 << 10));
206                         break;
207
208 /* TODO following stuff is just converted from the dib7000-driver - check when is used what */
209         }
210
211         dib7000p_write_word(state,  774,  reg_774);
212         dib7000p_write_word(state,  775,  reg_775);
213         dib7000p_write_word(state,  776,  reg_776);
214         dib7000p_write_word(state,  899,  reg_899);
215         dib7000p_write_word(state, 1280, reg_1280);
216
217         return 0;
218 }
219
220 static void dib7000p_set_adc_state(struct dib7000p_state *state, enum dibx000_adc_states no)
221 {
222         u16 reg_908 = dib7000p_read_word(state, 908),
223                reg_909 = dib7000p_read_word(state, 909);
224
225         switch (no) {
226                 case DIBX000_SLOW_ADC_ON:
227                         reg_909 |= (1 << 1) | (1 << 0);
228                         dib7000p_write_word(state, 909, reg_909);
229                         reg_909 &= ~(1 << 1);
230                         break;
231
232                 case DIBX000_SLOW_ADC_OFF:
233                         reg_909 |=  (1 << 1) | (1 << 0);
234                         break;
235
236                 case DIBX000_ADC_ON:
237                         reg_908 &= 0x0fff;
238                         reg_909 &= 0x0003;
239                         break;
240
241                 case DIBX000_ADC_OFF: // leave the VBG voltage on
242                         reg_908 |= (1 << 14) | (1 << 13) | (1 << 12);
243                         reg_909 |= (1 << 5) | (1 << 4) | (1 << 3) | (1 << 2);
244                         break;
245
246                 case DIBX000_VBG_ENABLE:
247                         reg_908 &= ~(1 << 15);
248                         break;
249
250                 case DIBX000_VBG_DISABLE:
251                         reg_908 |= (1 << 15);
252                         break;
253
254                 default:
255                         break;
256         }
257
258 //      dprintk( "908: %x, 909: %x\n", reg_908, reg_909);
259
260         dib7000p_write_word(state, 908, reg_908);
261         dib7000p_write_word(state, 909, reg_909);
262 }
263
264 static int dib7000p_set_bandwidth(struct dib7000p_state *state, u32 bw)
265 {
266         u32 timf;
267
268         // store the current bandwidth for later use
269         state->current_bandwidth = bw;
270
271         if (state->timf == 0) {
272                 dprintk( "using default timf");
273                 timf = state->cfg.bw->timf;
274         } else {
275                 dprintk( "using updated timf");
276                 timf = state->timf;
277         }
278
279         timf = timf * (bw / 50) / 160;
280
281         dib7000p_write_word(state, 23, (u16) ((timf >> 16) & 0xffff));
282         dib7000p_write_word(state, 24, (u16) ((timf      ) & 0xffff));
283
284         return 0;
285 }
286
287 static int dib7000p_sad_calib(struct dib7000p_state *state)
288 {
289 /* internal */
290 //      dib7000p_write_word(state, 72, (3 << 14) | (1 << 12) | (524 << 0)); // sampling clock of the SAD is writting in set_bandwidth
291         dib7000p_write_word(state, 73, (0 << 1) | (0 << 0));
292         dib7000p_write_word(state, 74, 776); // 0.625*3.3 / 4096
293
294         /* do the calibration */
295         dib7000p_write_word(state, 73, (1 << 0));
296         dib7000p_write_word(state, 73, (0 << 0));
297
298         msleep(1);
299
300         return 0;
301 }
302
303 int dib7000p_set_wbd_ref(struct dvb_frontend *demod, u16 value)
304 {
305         struct dib7000p_state *state = demod->demodulator_priv;
306         if (value > 4095)
307                 value = 4095;
308         state->wbd_ref = value;
309         return dib7000p_write_word(state, 105, (dib7000p_read_word(state, 105) & 0xf000) | value);
310 }
311
312 EXPORT_SYMBOL(dib7000p_set_wbd_ref);
313 static void dib7000p_reset_pll(struct dib7000p_state *state)
314 {
315         struct dibx000_bandwidth_config *bw = &state->cfg.bw[0];
316         u16 clk_cfg0;
317
318         /* force PLL bypass */
319         clk_cfg0 = (1 << 15) | ((bw->pll_ratio & 0x3f) << 9) |
320                 (bw->modulo << 7) | (bw->ADClkSrc << 6) | (bw->IO_CLK_en_core << 5) |
321                 (bw->bypclk_div << 2) | (bw->enable_refdiv << 1) | (0 << 0);
322
323         dib7000p_write_word(state, 900, clk_cfg0);
324
325         /* P_pll_cfg */
326         dib7000p_write_word(state, 903, (bw->pll_prediv << 5) | (((bw->pll_ratio >> 6) & 0x3) << 3) | (bw->pll_range << 1) | bw->pll_reset);
327         clk_cfg0 = (bw->pll_bypass << 15) | (clk_cfg0 & 0x7fff);
328         dib7000p_write_word(state, 900, clk_cfg0);
329
330         dib7000p_write_word(state, 18, (u16) (((bw->internal*1000) >> 16) & 0xffff));
331         dib7000p_write_word(state, 19, (u16) ( (bw->internal*1000       ) & 0xffff));
332         dib7000p_write_word(state, 21, (u16) ( (bw->ifreq          >> 16) & 0xffff));
333         dib7000p_write_word(state, 22, (u16) ( (bw->ifreq               ) & 0xffff));
334
335         dib7000p_write_word(state, 72, bw->sad_cfg);
336 }
337
338 static int dib7000p_reset_gpio(struct dib7000p_state *st)
339 {
340         /* reset the GPIOs */
341         dprintk( "gpio dir: %x: val: %x, pwm_pos: %x",st->gpio_dir, st->gpio_val,st->cfg.gpio_pwm_pos);
342
343         dib7000p_write_word(st, 1029, st->gpio_dir);
344         dib7000p_write_word(st, 1030, st->gpio_val);
345
346         /* TODO 1031 is P_gpio_od */
347
348         dib7000p_write_word(st, 1032, st->cfg.gpio_pwm_pos);
349
350         dib7000p_write_word(st, 1037, st->cfg.pwm_freq_div);
351         return 0;
352 }
353
354 static int dib7000p_cfg_gpio(struct dib7000p_state *st, u8 num, u8 dir, u8 val)
355 {
356         st->gpio_dir = dib7000p_read_word(st, 1029);
357         st->gpio_dir &= ~(1 << num);         /* reset the direction bit */
358         st->gpio_dir |=  (dir & 0x1) << num; /* set the new direction */
359         dib7000p_write_word(st, 1029, st->gpio_dir);
360
361         st->gpio_val = dib7000p_read_word(st, 1030);
362         st->gpio_val &= ~(1 << num);          /* reset the direction bit */
363         st->gpio_val |=  (val & 0x01) << num; /* set the new value */
364         dib7000p_write_word(st, 1030, st->gpio_val);
365
366         return 0;
367 }
368
369 int dib7000p_set_gpio(struct dvb_frontend *demod, u8 num, u8 dir, u8 val)
370 {
371         struct dib7000p_state *state = demod->demodulator_priv;
372         return dib7000p_cfg_gpio(state, num, dir, val);
373 }
374
375 EXPORT_SYMBOL(dib7000p_set_gpio);
376 static u16 dib7000p_defaults[] =
377
378 {
379         // auto search configuration
380         3, 2,
381                 0x0004,
382                 0x1000,
383                 0x0814, /* Equal Lock */
384
385         12, 6,
386                 0x001b,
387                 0x7740,
388                 0x005b,
389                 0x8d80,
390                 0x01c9,
391                 0xc380,
392                 0x0000,
393                 0x0080,
394                 0x0000,
395                 0x0090,
396                 0x0001,
397                 0xd4c0,
398
399         1, 26,
400                 0x6680, // P_timf_alpha=6, P_corm_alpha=6, P_corm_thres=128 default: 6,4,26
401
402         /* set ADC level to -16 */
403         11, 79,
404                 (1 << 13) - 825 - 117,
405                 (1 << 13) - 837 - 117,
406                 (1 << 13) - 811 - 117,
407                 (1 << 13) - 766 - 117,
408                 (1 << 13) - 737 - 117,
409                 (1 << 13) - 693 - 117,
410                 (1 << 13) - 648 - 117,
411                 (1 << 13) - 619 - 117,
412                 (1 << 13) - 575 - 117,
413                 (1 << 13) - 531 - 117,
414                 (1 << 13) - 501 - 117,
415
416         1, 142,
417                 0x0410, // P_palf_filter_on=1, P_palf_filter_freeze=0, P_palf_alpha_regul=16
418
419         /* disable power smoothing */
420         8, 145,
421                 0,
422                 0,
423                 0,
424                 0,
425                 0,
426                 0,
427                 0,
428                 0,
429
430         1, 154,
431                 1 << 13, // P_fft_freq_dir=1, P_fft_nb_to_cut=0
432
433         1, 168,
434                 0x0ccd, // P_pha3_thres, default 0x3000
435
436 //      1, 169,
437 //              0x0010, // P_cti_use_cpe=0, P_cti_use_prog=0, P_cti_win_len=16, default: 0x0010
438
439         1, 183,
440                 0x200f, // P_cspu_regul=512, P_cspu_win_cut=15, default: 0x2005
441
442         5, 187,
443                 0x023d, // P_adp_regul_cnt=573, default: 410
444                 0x00a4, // P_adp_noise_cnt=
445                 0x00a4, // P_adp_regul_ext
446                 0x7ff0, // P_adp_noise_ext
447                 0x3ccc, // P_adp_fil
448
449         1, 198,
450                 0x800, // P_equal_thres_wgn
451
452         1, 222,
453                 0x0010, // P_fec_ber_rs_len=2
454
455         1, 235,
456                 0x0062, // P_smo_mode, P_smo_rs_discard, P_smo_fifo_flush, P_smo_pid_parse, P_smo_error_discard
457
458         2, 901,
459                 0x0006, // P_clk_cfg1
460                 (3 << 10) | (1 << 6), // P_divclksel=3 P_divbitsel=1
461
462         1, 905,
463                 0x2c8e, // Tuner IO bank: max drive (14mA) + divout pads max drive
464
465         0,
466 };
467
468 static int dib7000p_demod_reset(struct dib7000p_state *state)
469 {
470         dib7000p_set_power_mode(state, DIB7000P_POWER_ALL);
471
472         dib7000p_set_adc_state(state, DIBX000_VBG_ENABLE);
473
474         /* restart all parts */
475         dib7000p_write_word(state,  770, 0xffff);
476         dib7000p_write_word(state,  771, 0xffff);
477         dib7000p_write_word(state,  772, 0x001f);
478         dib7000p_write_word(state,  898, 0x0003);
479         /* except i2c, sdio, gpio - control interfaces */
480         dib7000p_write_word(state, 1280, 0x01fc - ((1 << 7) | (1 << 6) | (1 << 5)) );
481
482         dib7000p_write_word(state,  770, 0);
483         dib7000p_write_word(state,  771, 0);
484         dib7000p_write_word(state,  772, 0);
485         dib7000p_write_word(state,  898, 0);
486         dib7000p_write_word(state, 1280, 0);
487
488         /* default */
489         dib7000p_reset_pll(state);
490
491         if (dib7000p_reset_gpio(state) != 0)
492                 dprintk( "GPIO reset was not successful.");
493
494         if (dib7000p_set_output_mode(state, OUTMODE_HIGH_Z) != 0)
495                 dprintk( "OUTPUT_MODE could not be reset.");
496
497         /* unforce divstr regardless whether i2c enumeration was done or not */
498         dib7000p_write_word(state, 1285, dib7000p_read_word(state, 1285) & ~(1 << 1) );
499
500         dib7000p_set_bandwidth(state, 8000);
501
502         dib7000p_set_adc_state(state, DIBX000_SLOW_ADC_ON);
503         dib7000p_sad_calib(state);
504         dib7000p_set_adc_state(state, DIBX000_SLOW_ADC_OFF);
505
506         // P_iqc_alpha_pha, P_iqc_alpha_amp_dcc_alpha, ...
507         if(state->cfg.tuner_is_baseband)
508                 dib7000p_write_word(state, 36,0x0755);
509         else
510                 dib7000p_write_word(state, 36,0x1f55);
511
512         dib7000p_write_tab(state, dib7000p_defaults);
513
514         dib7000p_set_power_mode(state, DIB7000P_POWER_INTERFACE_ONLY);
515
516
517         return 0;
518 }
519
520 static void dib7000p_pll_clk_cfg(struct dib7000p_state *state)
521 {
522         u16 tmp = 0;
523         tmp = dib7000p_read_word(state, 903);
524         dib7000p_write_word(state, 903, (tmp | 0x1));   //pwr-up pll
525         tmp = dib7000p_read_word(state, 900);
526         dib7000p_write_word(state, 900, (tmp & 0x7fff) | (1 << 6));     //use High freq clock
527 }
528
529 static void dib7000p_restart_agc(struct dib7000p_state *state)
530 {
531         // P_restart_iqc & P_restart_agc
532         dib7000p_write_word(state, 770, (1 << 11) | (1 << 9));
533         dib7000p_write_word(state, 770, 0x0000);
534 }
535
536 static int dib7000p_update_lna(struct dib7000p_state *state)
537 {
538         u16 dyn_gain;
539
540         // when there is no LNA to program return immediatly
541         if (state->cfg.update_lna) {
542                 // read dyn_gain here (because it is demod-dependent and not fe)
543                 dyn_gain = dib7000p_read_word(state, 394);
544                 if (state->cfg.update_lna(&state->demod,dyn_gain)) { // LNA has changed
545                         dib7000p_restart_agc(state);
546                         return 1;
547                 }
548         }
549
550         return 0;
551 }
552
553 static int dib7000p_set_agc_config(struct dib7000p_state *state, u8 band)
554 {
555         struct dibx000_agc_config *agc = NULL;
556         int i;
557         if (state->current_band == band && state->current_agc != NULL)
558                 return 0;
559         state->current_band = band;
560
561         for (i = 0; i < state->cfg.agc_config_count; i++)
562                 if (state->cfg.agc[i].band_caps & band) {
563                         agc = &state->cfg.agc[i];
564                         break;
565                 }
566
567         if (agc == NULL) {
568                 dprintk( "no valid AGC configuration found for band 0x%02x",band);
569                 return -EINVAL;
570         }
571
572         state->current_agc = agc;
573
574         /* AGC */
575         dib7000p_write_word(state, 75 ,  agc->setup );
576         dib7000p_write_word(state, 76 ,  agc->inv_gain );
577         dib7000p_write_word(state, 77 ,  agc->time_stabiliz );
578         dib7000p_write_word(state, 100, (agc->alpha_level << 12) | agc->thlock);
579
580         // Demod AGC loop configuration
581         dib7000p_write_word(state, 101, (agc->alpha_mant << 5) | agc->alpha_exp);
582         dib7000p_write_word(state, 102, (agc->beta_mant << 6)  | agc->beta_exp);
583
584         /* AGC continued */
585         dprintk( "WBD: ref: %d, sel: %d, active: %d, alpha: %d",
586                 state->wbd_ref != 0 ? state->wbd_ref : agc->wbd_ref, agc->wbd_sel, !agc->perform_agc_softsplit, agc->wbd_sel);
587
588         if (state->wbd_ref != 0)
589                 dib7000p_write_word(state, 105, (agc->wbd_inv << 12) | state->wbd_ref);
590         else
591                 dib7000p_write_word(state, 105, (agc->wbd_inv << 12) | agc->wbd_ref);
592
593         dib7000p_write_word(state, 106, (agc->wbd_sel << 13) | (agc->wbd_alpha << 9) | (agc->perform_agc_softsplit << 8));
594
595         dib7000p_write_word(state, 107,  agc->agc1_max);
596         dib7000p_write_word(state, 108,  agc->agc1_min);
597         dib7000p_write_word(state, 109,  agc->agc2_max);
598         dib7000p_write_word(state, 110,  agc->agc2_min);
599         dib7000p_write_word(state, 111, (agc->agc1_pt1    << 8) | agc->agc1_pt2);
600         dib7000p_write_word(state, 112,  agc->agc1_pt3);
601         dib7000p_write_word(state, 113, (agc->agc1_slope1 << 8) | agc->agc1_slope2);
602         dib7000p_write_word(state, 114, (agc->agc2_pt1    << 8) | agc->agc2_pt2);
603         dib7000p_write_word(state, 115, (agc->agc2_slope1 << 8) | agc->agc2_slope2);
604         return 0;
605 }
606
607 static int dib7000p_agc_startup(struct dvb_frontend *demod, struct dvb_frontend_parameters *ch)
608 {
609         struct dib7000p_state *state = demod->demodulator_priv;
610         int ret = -1;
611         u8 *agc_state = &state->agc_state;
612         u8 agc_split;
613
614         switch (state->agc_state) {
615                 case 0:
616                         // set power-up level: interf+analog+AGC
617                         dib7000p_set_power_mode(state, DIB7000P_POWER_ALL);
618                         dib7000p_set_adc_state(state, DIBX000_ADC_ON);
619                         dib7000p_pll_clk_cfg(state);
620
621                         if (dib7000p_set_agc_config(state, BAND_OF_FREQUENCY(ch->frequency/1000)) != 0)
622                                 return -1;
623
624                         ret = 7;
625                         (*agc_state)++;
626                         break;
627
628                 case 1:
629                         // AGC initialization
630                         if (state->cfg.agc_control)
631                                 state->cfg.agc_control(&state->demod, 1);
632
633                         dib7000p_write_word(state, 78, 32768);
634                         if (!state->current_agc->perform_agc_softsplit) {
635                                 /* we are using the wbd - so slow AGC startup */
636                                 /* force 0 split on WBD and restart AGC */
637                                 dib7000p_write_word(state, 106, (state->current_agc->wbd_sel << 13) | (state->current_agc->wbd_alpha << 9) | (1 << 8));
638                                 (*agc_state)++;
639                                 ret = 5;
640                         } else {
641                                 /* default AGC startup */
642                                 (*agc_state) = 4;
643                                 /* wait AGC rough lock time */
644                                 ret = 7;
645                         }
646
647                         dib7000p_restart_agc(state);
648                         break;
649
650                 case 2: /* fast split search path after 5sec */
651                         dib7000p_write_word(state,  75, state->current_agc->setup | (1 << 4)); /* freeze AGC loop */
652                         dib7000p_write_word(state, 106, (state->current_agc->wbd_sel << 13) | (2 << 9) | (0 << 8)); /* fast split search 0.25kHz */
653                         (*agc_state)++;
654                         ret = 14;
655                         break;
656
657         case 3: /* split search ended */
658                         agc_split = (u8)dib7000p_read_word(state, 396); /* store the split value for the next time */
659                         dib7000p_write_word(state, 78, dib7000p_read_word(state, 394)); /* set AGC gain start value */
660
661                         dib7000p_write_word(state, 75,  state->current_agc->setup);   /* std AGC loop */
662                         dib7000p_write_word(state, 106, (state->current_agc->wbd_sel << 13) | (state->current_agc->wbd_alpha << 9) | agc_split); /* standard split search */
663
664                         dib7000p_restart_agc(state);
665
666                         dprintk( "SPLIT %p: %hd", demod, agc_split);
667
668                         (*agc_state)++;
669                         ret = 5;
670                         break;
671
672                 case 4: /* LNA startup */
673                         // wait AGC accurate lock time
674                         ret = 7;
675
676                         if (dib7000p_update_lna(state))
677                                 // wait only AGC rough lock time
678                                 ret = 5;
679                         else // nothing was done, go to the next state
680                                 (*agc_state)++;
681                         break;
682
683                 case 5:
684                         if (state->cfg.agc_control)
685                                 state->cfg.agc_control(&state->demod, 0);
686                         (*agc_state)++;
687                         break;
688                 default:
689                         break;
690         }
691         return ret;
692 }
693
694 static void dib7000p_update_timf(struct dib7000p_state *state)
695 {
696         u32 timf = (dib7000p_read_word(state, 427) << 16) | dib7000p_read_word(state, 428);
697         state->timf = timf * 160 / (state->current_bandwidth / 50);
698         dib7000p_write_word(state, 23, (u16) (timf >> 16));
699         dib7000p_write_word(state, 24, (u16) (timf & 0xffff));
700         dprintk( "updated timf_frequency: %d (default: %d)",state->timf, state->cfg.bw->timf);
701
702 }
703
704 static void dib7000p_set_channel(struct dib7000p_state *state, struct dvb_frontend_parameters *ch, u8 seq)
705 {
706         u16 value, est[4];
707
708     dib7000p_set_bandwidth(state, BANDWIDTH_TO_KHZ(ch->u.ofdm.bandwidth));
709
710         /* nfft, guard, qam, alpha */
711         value = 0;
712         switch (ch->u.ofdm.transmission_mode) {
713                 case TRANSMISSION_MODE_2K: value |= (0 << 7); break;
714                 case /* 4K MODE */ 255: value |= (2 << 7); break;
715                 default:
716                 case TRANSMISSION_MODE_8K: value |= (1 << 7); break;
717         }
718         switch (ch->u.ofdm.guard_interval) {
719                 case GUARD_INTERVAL_1_32: value |= (0 << 5); break;
720                 case GUARD_INTERVAL_1_16: value |= (1 << 5); break;
721                 case GUARD_INTERVAL_1_4:  value |= (3 << 5); break;
722                 default:
723                 case GUARD_INTERVAL_1_8:  value |= (2 << 5); break;
724         }
725         switch (ch->u.ofdm.constellation) {
726                 case QPSK:  value |= (0 << 3); break;
727                 case QAM_16: value |= (1 << 3); break;
728                 default:
729                 case QAM_64: value |= (2 << 3); break;
730         }
731         switch (HIERARCHY_1) {
732                 case HIERARCHY_2: value |= 2; break;
733                 case HIERARCHY_4: value |= 4; break;
734                 default:
735                 case HIERARCHY_1: value |= 1; break;
736         }
737         dib7000p_write_word(state, 0, value);
738         dib7000p_write_word(state, 5, (seq << 4) | 1); /* do not force tps, search list 0 */
739
740         /* P_dintl_native, P_dintlv_inv, P_hrch, P_code_rate, P_select_hp */
741         value = 0;
742         if (1 != 0)
743                 value |= (1 << 6);
744         if (ch->u.ofdm.hierarchy_information == 1)
745                 value |= (1 << 4);
746         if (1 == 1)
747                 value |= 1;
748         switch ((ch->u.ofdm.hierarchy_information == 0 || 1 == 1) ? ch->u.ofdm.code_rate_HP : ch->u.ofdm.code_rate_LP) {
749                 case FEC_2_3: value |= (2 << 1); break;
750                 case FEC_3_4: value |= (3 << 1); break;
751                 case FEC_5_6: value |= (5 << 1); break;
752                 case FEC_7_8: value |= (7 << 1); break;
753                 default:
754                 case FEC_1_2: value |= (1 << 1); break;
755         }
756         dib7000p_write_word(state, 208, value);
757
758         /* offset loop parameters */
759         dib7000p_write_word(state, 26, 0x6680); // timf(6xxx)
760         dib7000p_write_word(state, 32, 0x0003); // pha_off_max(xxx3)
761         dib7000p_write_word(state, 29, 0x1273); // isi
762         dib7000p_write_word(state, 33, 0x0005); // sfreq(xxx5)
763
764         /* P_dvsy_sync_wait */
765         switch (ch->u.ofdm.transmission_mode) {
766                 case TRANSMISSION_MODE_8K: value = 256; break;
767                 case /* 4K MODE */ 255: value = 128; break;
768                 case TRANSMISSION_MODE_2K:
769                 default: value = 64; break;
770         }
771         switch (ch->u.ofdm.guard_interval) {
772                 case GUARD_INTERVAL_1_16: value *= 2; break;
773                 case GUARD_INTERVAL_1_8:  value *= 4; break;
774                 case GUARD_INTERVAL_1_4:  value *= 8; break;
775                 default:
776                 case GUARD_INTERVAL_1_32: value *= 1; break;
777         }
778         state->div_sync_wait = (value * 3) / 2 + 32; // add 50% SFN margin + compensate for one DVSY-fifo TODO
779
780         /* deactive the possibility of diversity reception if extended interleaver */
781         state->div_force_off = !1 && ch->u.ofdm.transmission_mode != TRANSMISSION_MODE_8K;
782         dib7000p_set_diversity_in(&state->demod, state->div_state);
783
784         /* channel estimation fine configuration */
785         switch (ch->u.ofdm.constellation) {
786                 case QAM_64:
787                         est[0] = 0x0148;       /* P_adp_regul_cnt 0.04 */
788                         est[1] = 0xfff0;       /* P_adp_noise_cnt -0.002 */
789                         est[2] = 0x00a4;       /* P_adp_regul_ext 0.02 */
790                         est[3] = 0xfff8;       /* P_adp_noise_ext -0.001 */
791                         break;
792                 case QAM_16:
793                         est[0] = 0x023d;       /* P_adp_regul_cnt 0.07 */
794                         est[1] = 0xffdf;       /* P_adp_noise_cnt -0.004 */
795                         est[2] = 0x00a4;       /* P_adp_regul_ext 0.02 */
796                         est[3] = 0xfff0;       /* P_adp_noise_ext -0.002 */
797                         break;
798                 default:
799                         est[0] = 0x099a;       /* P_adp_regul_cnt 0.3 */
800                         est[1] = 0xffae;       /* P_adp_noise_cnt -0.01 */
801                         est[2] = 0x0333;       /* P_adp_regul_ext 0.1 */
802                         est[3] = 0xfff8;       /* P_adp_noise_ext -0.002 */
803                         break;
804         }
805         for (value = 0; value < 4; value++)
806                 dib7000p_write_word(state, 187 + value, est[value]);
807 }
808
809 static int dib7000p_autosearch_start(struct dvb_frontend *demod, struct dvb_frontend_parameters *ch)
810 {
811         struct dib7000p_state *state = demod->demodulator_priv;
812         struct dvb_frontend_parameters schan;
813         u32 value, factor;
814
815         schan = *ch;
816         schan.u.ofdm.constellation = QAM_64;
817         schan.u.ofdm.guard_interval         = GUARD_INTERVAL_1_32;
818         schan.u.ofdm.transmission_mode          = TRANSMISSION_MODE_8K;
819         schan.u.ofdm.code_rate_HP  = FEC_2_3;
820         schan.u.ofdm.code_rate_LP  = FEC_3_4;
821         schan.u.ofdm.hierarchy_information          = 0;
822
823         dib7000p_set_channel(state, &schan, 7);
824
825         factor = BANDWIDTH_TO_KHZ(ch->u.ofdm.bandwidth);
826         if (factor >= 5000)
827                 factor = 1;
828         else
829                 factor = 6;
830
831         // always use the setting for 8MHz here lock_time for 7,6 MHz are longer
832         value = 30 * state->cfg.bw->internal * factor;
833         dib7000p_write_word(state, 6,  (u16) ((value >> 16) & 0xffff)); // lock0 wait time
834         dib7000p_write_word(state, 7,  (u16)  (value        & 0xffff)); // lock0 wait time
835         value = 100 * state->cfg.bw->internal * factor;
836         dib7000p_write_word(state, 8,  (u16) ((value >> 16) & 0xffff)); // lock1 wait time
837         dib7000p_write_word(state, 9,  (u16)  (value        & 0xffff)); // lock1 wait time
838         value = 500 * state->cfg.bw->internal * factor;
839         dib7000p_write_word(state, 10, (u16) ((value >> 16) & 0xffff)); // lock2 wait time
840         dib7000p_write_word(state, 11, (u16)  (value        & 0xffff)); // lock2 wait time
841
842         value = dib7000p_read_word(state, 0);
843         dib7000p_write_word(state, 0, (u16) ((1 << 9) | value));
844         dib7000p_read_word(state, 1284);
845         dib7000p_write_word(state, 0, (u16) value);
846
847         return 0;
848 }
849
850 static int dib7000p_autosearch_is_irq(struct dvb_frontend *demod)
851 {
852         struct dib7000p_state *state = demod->demodulator_priv;
853         u16 irq_pending = dib7000p_read_word(state, 1284);
854
855         if (irq_pending & 0x1) // failed
856                 return 1;
857
858         if (irq_pending & 0x2) // succeeded
859                 return 2;
860
861         return 0; // still pending
862 }
863
864 static void dib7000p_spur_protect(struct dib7000p_state *state, u32 rf_khz, u32 bw)
865 {
866         static s16 notch[]={16143, 14402, 12238, 9713, 6902, 3888, 759, -2392};
867         static u8 sine [] ={0, 2, 3, 5, 6, 8, 9, 11, 13, 14, 16, 17, 19, 20, 22,
868         24, 25, 27, 28, 30, 31, 33, 34, 36, 38, 39, 41, 42, 44, 45, 47, 48, 50, 51,
869         53, 55, 56, 58, 59, 61, 62, 64, 65, 67, 68, 70, 71, 73, 74, 76, 77, 79, 80,
870         82, 83, 85, 86, 88, 89, 91, 92, 94, 95, 97, 98, 99, 101, 102, 104, 105,
871         107, 108, 109, 111, 112, 114, 115, 117, 118, 119, 121, 122, 123, 125, 126,
872         128, 129, 130, 132, 133, 134, 136, 137, 138, 140, 141, 142, 144, 145, 146,
873         147, 149, 150, 151, 152, 154, 155, 156, 157, 159, 160, 161, 162, 164, 165,
874         166, 167, 168, 170, 171, 172, 173, 174, 175, 177, 178, 179, 180, 181, 182,
875         183, 184, 185, 186, 188, 189, 190, 191, 192, 193, 194, 195, 196, 197, 198,
876         199, 200, 201, 202, 203, 204, 205, 206, 207, 207, 208, 209, 210, 211, 212,
877         213, 214, 215, 215, 216, 217, 218, 219, 220, 220, 221, 222, 223, 224, 224,
878         225, 226, 227, 227, 228, 229, 229, 230, 231, 231, 232, 233, 233, 234, 235,
879         235, 236, 237, 237, 238, 238, 239, 239, 240, 241, 241, 242, 242, 243, 243,
880         244, 244, 245, 245, 245, 246, 246, 247, 247, 248, 248, 248, 249, 249, 249,
881         250, 250, 250, 251, 251, 251, 252, 252, 252, 252, 253, 253, 253, 253, 254,
882         254, 254, 254, 254, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255, 255,
883         255, 255, 255, 255, 255, 255};
884
885         u32 xtal = state->cfg.bw->xtal_hz / 1000;
886         int f_rel = ( (rf_khz + xtal/2) / xtal) * xtal - rf_khz;
887         int k;
888         int coef_re[8],coef_im[8];
889         int bw_khz = bw;
890         u32 pha;
891
892         dprintk( "relative position of the Spur: %dk (RF: %dk, XTAL: %dk)", f_rel, rf_khz, xtal);
893
894
895         if (f_rel < -bw_khz/2 || f_rel > bw_khz/2)
896                 return;
897
898         bw_khz /= 100;
899
900         dib7000p_write_word(state, 142 ,0x0610);
901
902         for (k = 0; k < 8; k++) {
903                 pha = ((f_rel * (k+1) * 112 * 80/bw_khz) /1000) & 0x3ff;
904
905                 if (pha==0) {
906                         coef_re[k] = 256;
907                         coef_im[k] = 0;
908                 } else if(pha < 256) {
909                         coef_re[k] = sine[256-(pha&0xff)];
910                         coef_im[k] = sine[pha&0xff];
911                 } else if (pha == 256) {
912                         coef_re[k] = 0;
913                         coef_im[k] = 256;
914                 } else if (pha < 512) {
915                         coef_re[k] = -sine[pha&0xff];
916                         coef_im[k] = sine[256 - (pha&0xff)];
917                 } else if (pha == 512) {
918                         coef_re[k] = -256;
919                         coef_im[k] = 0;
920                 } else if (pha < 768) {
921                         coef_re[k] = -sine[256-(pha&0xff)];
922                         coef_im[k] = -sine[pha&0xff];
923                 } else if (pha == 768) {
924                         coef_re[k] = 0;
925                         coef_im[k] = -256;
926                 } else {
927                         coef_re[k] = sine[pha&0xff];
928                         coef_im[k] = -sine[256 - (pha&0xff)];
929                 }
930
931                 coef_re[k] *= notch[k];
932                 coef_re[k] += (1<<14);
933                 if (coef_re[k] >= (1<<24))
934                         coef_re[k]  = (1<<24) - 1;
935                 coef_re[k] /= (1<<15);
936
937                 coef_im[k] *= notch[k];
938                 coef_im[k] += (1<<14);
939                 if (coef_im[k] >= (1<<24))
940                         coef_im[k]  = (1<<24)-1;
941                 coef_im[k] /= (1<<15);
942
943                 dprintk( "PALF COEF: %d re: %d im: %d", k, coef_re[k], coef_im[k]);
944
945                 dib7000p_write_word(state, 143, (0 << 14) | (k << 10) | (coef_re[k] & 0x3ff));
946                 dib7000p_write_word(state, 144, coef_im[k] & 0x3ff);
947                 dib7000p_write_word(state, 143, (1 << 14) | (k << 10) | (coef_re[k] & 0x3ff));
948         }
949         dib7000p_write_word(state,143 ,0);
950 }
951
952 static int dib7000p_tune(struct dvb_frontend *demod, struct dvb_frontend_parameters *ch)
953 {
954         struct dib7000p_state *state = demod->demodulator_priv;
955         u16 tmp = 0;
956
957         if (ch != NULL)
958                 dib7000p_set_channel(state, ch, 0);
959         else
960                 return -EINVAL;
961
962         // restart demod
963         dib7000p_write_word(state, 770, 0x4000);
964         dib7000p_write_word(state, 770, 0x0000);
965         msleep(45);
966
967         /* 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 */
968         tmp = (0 << 14) | (4 << 10) | (0 << 9) | (3 << 5) | (1 << 4) | (0x3);
969         if (state->sfn_workaround_active) {
970                 dprintk( "SFN workaround is active");
971                 tmp |= (1 << 9);
972                 dib7000p_write_word(state, 166, 0x4000); // P_pha3_force_pha_shift
973         } else {
974                 dib7000p_write_word(state, 166, 0x0000); // P_pha3_force_pha_shift
975         }
976         dib7000p_write_word(state, 29, tmp);
977
978         // never achieved a lock with that bandwidth so far - wait for osc-freq to update
979         if (state->timf == 0)
980                 msleep(200);
981
982         /* offset loop parameters */
983
984         /* P_timf_alpha, P_corm_alpha=6, P_corm_thres=0x80 */
985         tmp = (6 << 8) | 0x80;
986         switch (ch->u.ofdm.transmission_mode) {
987                 case TRANSMISSION_MODE_2K: tmp |= (7 << 12); break;
988                 case /* 4K MODE */ 255: tmp |= (8 << 12); break;
989                 default:
990                 case TRANSMISSION_MODE_8K: tmp |= (9 << 12); break;
991         }
992         dib7000p_write_word(state, 26, tmp);  /* timf_a(6xxx) */
993
994         /* P_ctrl_freeze_pha_shift=0, P_ctrl_pha_off_max */
995         tmp = (0 << 4);
996         switch (ch->u.ofdm.transmission_mode) {
997                 case TRANSMISSION_MODE_2K: tmp |= 0x6; break;
998                 case /* 4K MODE */ 255: tmp |= 0x7; break;
999                 default:
1000                 case TRANSMISSION_MODE_8K: tmp |= 0x8; break;
1001         }
1002         dib7000p_write_word(state, 32,  tmp);
1003
1004         /* P_ctrl_sfreq_inh=0, P_ctrl_sfreq_step */
1005         tmp = (0 << 4);
1006         switch (ch->u.ofdm.transmission_mode) {
1007                 case TRANSMISSION_MODE_2K: tmp |= 0x6; break;
1008                 case /* 4K MODE */ 255: tmp |= 0x7; break;
1009                 default:
1010                 case TRANSMISSION_MODE_8K: tmp |= 0x8; break;
1011         }
1012         dib7000p_write_word(state, 33,  tmp);
1013
1014         tmp = dib7000p_read_word(state,509);
1015         if (!((tmp >> 6) & 0x1)) {
1016                 /* restart the fec */
1017                 tmp = dib7000p_read_word(state,771);
1018                 dib7000p_write_word(state, 771, tmp | (1 << 1));
1019                 dib7000p_write_word(state, 771, tmp);
1020                 msleep(10);
1021                 tmp = dib7000p_read_word(state,509);
1022         }
1023
1024         // we achieved a lock - it's time to update the osc freq
1025         if ((tmp >> 6) & 0x1)
1026                 dib7000p_update_timf(state);
1027
1028         if (state->cfg.spur_protect)
1029                 dib7000p_spur_protect(state, ch->frequency/1000, BANDWIDTH_TO_KHZ(ch->u.ofdm.bandwidth));
1030
1031     dib7000p_set_bandwidth(state, BANDWIDTH_TO_KHZ(ch->u.ofdm.bandwidth));
1032         return 0;
1033 }
1034
1035 static int dib7000p_wakeup(struct dvb_frontend *demod)
1036 {
1037         struct dib7000p_state *state = demod->demodulator_priv;
1038         dib7000p_set_power_mode(state, DIB7000P_POWER_ALL);
1039         dib7000p_set_adc_state(state, DIBX000_SLOW_ADC_ON);
1040         return 0;
1041 }
1042
1043 static int dib7000p_sleep(struct dvb_frontend *demod)
1044 {
1045         struct dib7000p_state *state = demod->demodulator_priv;
1046         return dib7000p_set_output_mode(state, OUTMODE_HIGH_Z) | dib7000p_set_power_mode(state, DIB7000P_POWER_INTERFACE_ONLY);
1047 }
1048
1049 static int dib7000p_identify(struct dib7000p_state *st)
1050 {
1051         u16 value;
1052         dprintk( "checking demod on I2C address: %d (%x)",
1053                 st->i2c_addr, st->i2c_addr);
1054
1055         if ((value = dib7000p_read_word(st, 768)) != 0x01b3) {
1056                 dprintk( "wrong Vendor ID (read=0x%x)",value);
1057                 return -EREMOTEIO;
1058         }
1059
1060         if ((value = dib7000p_read_word(st, 769)) != 0x4000) {
1061                 dprintk( "wrong Device ID (%x)",value);
1062                 return -EREMOTEIO;
1063         }
1064
1065         return 0;
1066 }
1067
1068
1069 static int dib7000p_get_frontend(struct dvb_frontend* fe,
1070                                 struct dvb_frontend_parameters *fep)
1071 {
1072         struct dib7000p_state *state = fe->demodulator_priv;
1073         u16 tps = dib7000p_read_word(state,463);
1074
1075         fep->inversion = INVERSION_AUTO;
1076
1077         fep->u.ofdm.bandwidth = state->current_bandwidth;
1078
1079         switch ((tps >> 8) & 0x3) {
1080                 case 0: fep->u.ofdm.transmission_mode = TRANSMISSION_MODE_2K; break;
1081                 case 1: fep->u.ofdm.transmission_mode = TRANSMISSION_MODE_8K; break;
1082                 /* case 2: fep->u.ofdm.transmission_mode = TRANSMISSION_MODE_4K; break; */
1083         }
1084
1085         switch (tps & 0x3) {
1086                 case 0: fep->u.ofdm.guard_interval = GUARD_INTERVAL_1_32; break;
1087                 case 1: fep->u.ofdm.guard_interval = GUARD_INTERVAL_1_16; break;
1088                 case 2: fep->u.ofdm.guard_interval = GUARD_INTERVAL_1_8; break;
1089                 case 3: fep->u.ofdm.guard_interval = GUARD_INTERVAL_1_4; break;
1090         }
1091
1092         switch ((tps >> 14) & 0x3) {
1093                 case 0: fep->u.ofdm.constellation = QPSK; break;
1094                 case 1: fep->u.ofdm.constellation = QAM_16; break;
1095                 case 2:
1096                 default: fep->u.ofdm.constellation = QAM_64; break;
1097         }
1098
1099         /* as long as the frontend_param structure is fixed for hierarchical transmission I refuse to use it */
1100         /* (tps >> 13) & 0x1 == hrch is used, (tps >> 10) & 0x7 == alpha */
1101
1102         fep->u.ofdm.hierarchy_information = HIERARCHY_NONE;
1103         switch ((tps >> 5) & 0x7) {
1104                 case 1: fep->u.ofdm.code_rate_HP = FEC_1_2; break;
1105                 case 2: fep->u.ofdm.code_rate_HP = FEC_2_3; break;
1106                 case 3: fep->u.ofdm.code_rate_HP = FEC_3_4; break;
1107                 case 5: fep->u.ofdm.code_rate_HP = FEC_5_6; break;
1108                 case 7:
1109                 default: fep->u.ofdm.code_rate_HP = FEC_7_8; break;
1110
1111         }
1112
1113         switch ((tps >> 2) & 0x7) {
1114                 case 1: fep->u.ofdm.code_rate_LP = FEC_1_2; break;
1115                 case 2: fep->u.ofdm.code_rate_LP = FEC_2_3; break;
1116                 case 3: fep->u.ofdm.code_rate_LP = FEC_3_4; break;
1117                 case 5: fep->u.ofdm.code_rate_LP = FEC_5_6; break;
1118                 case 7:
1119                 default: fep->u.ofdm.code_rate_LP = FEC_7_8; break;
1120         }
1121
1122         /* native interleaver: (dib7000p_read_word(state, 464) >>  5) & 0x1 */
1123
1124         return 0;
1125 }
1126
1127 static int dib7000p_set_frontend(struct dvb_frontend* fe,
1128                                 struct dvb_frontend_parameters *fep)
1129 {
1130         struct dib7000p_state *state = fe->demodulator_priv;
1131         int time;
1132
1133         state->current_bandwidth = fep->u.ofdm.bandwidth;
1134         dib7000p_set_bandwidth(state, BANDWIDTH_TO_KHZ(fep->u.ofdm.bandwidth));
1135
1136         /* maybe the parameter has been changed */
1137         state->sfn_workaround_active = buggy_sfn_workaround;
1138
1139         if (fe->ops.tuner_ops.set_params)
1140                 fe->ops.tuner_ops.set_params(fe, fep);
1141
1142         /* start up the AGC */
1143         state->agc_state = 0;
1144         do {
1145                 time = dib7000p_agc_startup(fe, fep);
1146                 if (time != -1)
1147                         msleep(time);
1148         } while (time != -1);
1149
1150         if (fep->u.ofdm.transmission_mode == TRANSMISSION_MODE_AUTO ||
1151                 fep->u.ofdm.guard_interval    == GUARD_INTERVAL_AUTO ||
1152                 fep->u.ofdm.constellation     == QAM_AUTO ||
1153                 fep->u.ofdm.code_rate_HP      == FEC_AUTO) {
1154                 int i = 800, found;
1155
1156                 dib7000p_autosearch_start(fe, fep);
1157                 do {
1158                         msleep(1);
1159                         found = dib7000p_autosearch_is_irq(fe);
1160                 } while (found == 0 && i--);
1161
1162                 dprintk("autosearch returns: %d",found);
1163                 if (found == 0 || found == 1)
1164                         return 0; // no channel found
1165
1166                 dib7000p_get_frontend(fe, fep);
1167         }
1168
1169         /* make this a config parameter */
1170         dib7000p_set_output_mode(state, OUTMODE_MPEG2_FIFO);
1171
1172         return dib7000p_tune(fe, fep);
1173 }
1174
1175 static int dib7000p_read_status(struct dvb_frontend *fe, fe_status_t *stat)
1176 {
1177         struct dib7000p_state *state = fe->demodulator_priv;
1178         u16 lock = dib7000p_read_word(state, 509);
1179
1180         *stat = 0;
1181
1182         if (lock & 0x8000)
1183                 *stat |= FE_HAS_SIGNAL;
1184         if (lock & 0x3000)
1185                 *stat |= FE_HAS_CARRIER;
1186         if (lock & 0x0100)
1187                 *stat |= FE_HAS_VITERBI;
1188         if (lock & 0x0010)
1189                 *stat |= FE_HAS_SYNC;
1190         if (lock & 0x0008)
1191                 *stat |= FE_HAS_LOCK;
1192
1193         return 0;
1194 }
1195
1196 static int dib7000p_read_ber(struct dvb_frontend *fe, u32 *ber)
1197 {
1198         struct dib7000p_state *state = fe->demodulator_priv;
1199         *ber = (dib7000p_read_word(state, 500) << 16) | dib7000p_read_word(state, 501);
1200         return 0;
1201 }
1202
1203 static int dib7000p_read_unc_blocks(struct dvb_frontend *fe, u32 *unc)
1204 {
1205         struct dib7000p_state *state = fe->demodulator_priv;
1206         *unc = dib7000p_read_word(state, 506);
1207         return 0;
1208 }
1209
1210 static int dib7000p_read_signal_strength(struct dvb_frontend *fe, u16 *strength)
1211 {
1212         struct dib7000p_state *state = fe->demodulator_priv;
1213         u16 val = dib7000p_read_word(state, 394);
1214         *strength = 65535 - val;
1215         return 0;
1216 }
1217
1218 static int dib7000p_read_snr(struct dvb_frontend* fe, u16 *snr)
1219 {
1220         *snr = 0x0000;
1221         return 0;
1222 }
1223
1224 static int dib7000p_fe_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings *tune)
1225 {
1226         tune->min_delay_ms = 1000;
1227         return 0;
1228 }
1229
1230 static void dib7000p_release(struct dvb_frontend *demod)
1231 {
1232         struct dib7000p_state *st = demod->demodulator_priv;
1233         dibx000_exit_i2c_master(&st->i2c_master);
1234         kfree(st);
1235 }
1236
1237 int dib7000pc_detection(struct i2c_adapter *i2c_adap)
1238 {
1239         u8 tx[2], rx[2];
1240         struct i2c_msg msg[2] = {
1241                 { .addr = 18 >> 1, .flags = 0,        .buf = tx, .len = 2 },
1242                 { .addr = 18 >> 1, .flags = I2C_M_RD, .buf = rx, .len = 2 },
1243         };
1244
1245         tx[0] = 0x03;
1246         tx[1] = 0x00;
1247
1248         if (i2c_transfer(i2c_adap, msg, 2) == 2)
1249                 if (rx[0] == 0x01 && rx[1] == 0xb3) {
1250                         dprintk("-D-  DiB7000PC detected");
1251                         return 1;
1252                 }
1253
1254         msg[0].addr = msg[1].addr = 0x40;
1255
1256         if (i2c_transfer(i2c_adap, msg, 2) == 2)
1257                 if (rx[0] == 0x01 && rx[1] == 0xb3) {
1258                         dprintk("-D-  DiB7000PC detected");
1259                         return 1;
1260                 }
1261
1262         dprintk("-D-  DiB7000PC not detected");
1263         return 0;
1264 }
1265 EXPORT_SYMBOL(dib7000pc_detection);
1266
1267 struct i2c_adapter * dib7000p_get_i2c_master(struct dvb_frontend *demod, enum dibx000_i2c_interface intf, int gating)
1268 {
1269         struct dib7000p_state *st = demod->demodulator_priv;
1270         return dibx000_get_i2c_adapter(&st->i2c_master, intf, gating);
1271 }
1272 EXPORT_SYMBOL(dib7000p_get_i2c_master);
1273
1274 int dib7000p_i2c_enumeration(struct i2c_adapter *i2c, int no_of_demods, u8 default_addr, struct dib7000p_config cfg[])
1275 {
1276         struct dib7000p_state st = { .i2c_adap = i2c };
1277         int k = 0;
1278         u8 new_addr = 0;
1279
1280         for (k = no_of_demods-1; k >= 0; k--) {
1281                 st.cfg = cfg[k];
1282
1283                 /* designated i2c address */
1284                 new_addr          = (0x40 + k) << 1;
1285                 st.i2c_addr = new_addr;
1286                 if (dib7000p_identify(&st) != 0) {
1287                         st.i2c_addr = default_addr;
1288                         if (dib7000p_identify(&st) != 0) {
1289                                 dprintk("DiB7000P #%d: not identified\n", k);
1290                                 return -EIO;
1291                         }
1292                 }
1293
1294                 /* start diversity to pull_down div_str - just for i2c-enumeration */
1295                 dib7000p_set_output_mode(&st, OUTMODE_DIVERSITY);
1296
1297                 /* set new i2c address and force divstart */
1298                 dib7000p_write_word(&st, 1285, (new_addr << 2) | 0x2);
1299
1300                 dprintk("IC %d initialized (to i2c_address 0x%x)", k, new_addr);
1301         }
1302
1303         for (k = 0; k < no_of_demods; k++) {
1304                 st.cfg = cfg[k];
1305                 st.i2c_addr = (0x40 + k) << 1;
1306
1307                 // unforce divstr
1308                 dib7000p_write_word(&st, 1285, st.i2c_addr << 2);
1309
1310                 /* deactivate div - it was just for i2c-enumeration */
1311                 dib7000p_set_output_mode(&st, OUTMODE_HIGH_Z);
1312         }
1313
1314         return 0;
1315 }
1316 EXPORT_SYMBOL(dib7000p_i2c_enumeration);
1317
1318 static struct dvb_frontend_ops dib7000p_ops;
1319 struct dvb_frontend * dib7000p_attach(struct i2c_adapter *i2c_adap, u8 i2c_addr, struct dib7000p_config *cfg)
1320 {
1321         struct dvb_frontend *demod;
1322         struct dib7000p_state *st;
1323         st = kzalloc(sizeof(struct dib7000p_state), GFP_KERNEL);
1324         if (st == NULL)
1325                 return NULL;
1326
1327         memcpy(&st->cfg, cfg, sizeof(struct dib7000p_config));
1328         st->i2c_adap = i2c_adap;
1329         st->i2c_addr = i2c_addr;
1330         st->gpio_val = cfg->gpio_val;
1331         st->gpio_dir = cfg->gpio_dir;
1332
1333         demod                   = &st->demod;
1334         demod->demodulator_priv = st;
1335         memcpy(&st->demod.ops, &dib7000p_ops, sizeof(struct dvb_frontend_ops));
1336
1337         if (dib7000p_identify(st) != 0)
1338                 goto error;
1339
1340         dibx000_init_i2c_master(&st->i2c_master, DIB7000P, st->i2c_adap, st->i2c_addr);
1341
1342         dib7000p_demod_reset(st);
1343
1344         return demod;
1345
1346 error:
1347         kfree(st);
1348         return NULL;
1349 }
1350 EXPORT_SYMBOL(dib7000p_attach);
1351
1352 static struct dvb_frontend_ops dib7000p_ops = {
1353         .info = {
1354                 .name = "DiBcom 7000PC",
1355                 .type = FE_OFDM,
1356                 .frequency_min      = 44250000,
1357                 .frequency_max      = 867250000,
1358                 .frequency_stepsize = 62500,
1359                 .caps = FE_CAN_INVERSION_AUTO |
1360                         FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
1361                         FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
1362                         FE_CAN_QPSK | FE_CAN_QAM_16 | FE_CAN_QAM_64 | FE_CAN_QAM_AUTO |
1363                         FE_CAN_TRANSMISSION_MODE_AUTO |
1364                         FE_CAN_GUARD_INTERVAL_AUTO |
1365                         FE_CAN_RECOVER |
1366                         FE_CAN_HIERARCHY_AUTO,
1367         },
1368
1369         .release              = dib7000p_release,
1370
1371         .init                 = dib7000p_wakeup,
1372         .sleep                = dib7000p_sleep,
1373
1374         .set_frontend         = dib7000p_set_frontend,
1375         .get_tune_settings    = dib7000p_fe_get_tune_settings,
1376         .get_frontend         = dib7000p_get_frontend,
1377
1378         .read_status          = dib7000p_read_status,
1379         .read_ber             = dib7000p_read_ber,
1380         .read_signal_strength = dib7000p_read_signal_strength,
1381         .read_snr             = dib7000p_read_snr,
1382         .read_ucblocks        = dib7000p_read_unc_blocks,
1383 };
1384
1385 MODULE_AUTHOR("Patrick Boettcher <pboettcher@dibcom.fr>");
1386 MODULE_DESCRIPTION("Driver for the DiBcom 7000PC COFDM demodulator");
1387 MODULE_LICENSE("GPL");