1 /* 2 * Linux-DVB Driver for DiBcom's DiB7000M and 3 * first generation DiB7000P-demodulator-family. 4 * 5 * Copyright (C) 2005-7 DiBcom (http://www.dibcom.fr/) 6 * 7 * This program is free software; you can redistribute it and/or 8 * modify it under the terms of the GNU General Public License as 9 * published by the Free Software Foundation, version 2. 10 */ 11 12 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 13 14 #include <linux/kernel.h> 15 #include <linux/slab.h> 16 #include <linux/i2c.h> 17 #include <linux/mutex.h> 18 19 #include <media/dvb_frontend.h> 20 21 #include "dib7000m.h" 22 23 static int debug; 24 module_param(debug, int, 0644); 25 MODULE_PARM_DESC(debug, "turn on debugging (default: 0)"); 26 27 #define dprintk(fmt, arg...) do { \ 28 if (debug) \ 29 printk(KERN_DEBUG pr_fmt("%s: " fmt), \ 30 __func__, ##arg); \ 31 } while (0) 32 33 struct dib7000m_state { 34 struct dvb_frontend demod; 35 struct dib7000m_config cfg; 36 37 u8 i2c_addr; 38 struct i2c_adapter *i2c_adap; 39 40 struct dibx000_i2c_master i2c_master; 41 42 /* offset is 1 in case of the 7000MC */ 43 u8 reg_offs; 44 45 u16 wbd_ref; 46 47 u8 current_band; 48 u32 current_bandwidth; 49 struct dibx000_agc_config *current_agc; 50 u32 timf; 51 u32 timf_default; 52 u32 internal_clk; 53 54 u8 div_force_off : 1; 55 u8 div_state : 1; 56 u16 div_sync_wait; 57 58 u16 revision; 59 60 u8 agc_state; 61 62 /* for the I2C transfer */ 63 struct i2c_msg msg[2]; 64 u8 i2c_write_buffer[4]; 65 u8 i2c_read_buffer[2]; 66 struct mutex i2c_buffer_lock; 67 }; 68 69 enum dib7000m_power_mode { 70 DIB7000M_POWER_ALL = 0, 71 72 DIB7000M_POWER_NO, 73 DIB7000M_POWER_INTERF_ANALOG_AGC, 74 DIB7000M_POWER_COR4_DINTLV_ICIRM_EQUAL_CFROD, 75 DIB7000M_POWER_COR4_CRY_ESRAM_MOUT_NUD, 76 DIB7000M_POWER_INTERFACE_ONLY, 77 }; 78 79 static u16 dib7000m_read_word(struct dib7000m_state *state, u16 reg) 80 { 81 u16 ret; 82 83 if (mutex_lock_interruptible(&state->i2c_buffer_lock) < 0) { 84 dprintk("could not acquire lock\n"); 85 return 0; 86 } 87 88 state->i2c_write_buffer[0] = (reg >> 8) | 0x80; 89 state->i2c_write_buffer[1] = reg & 0xff; 90 91 memset(state->msg, 0, 2 * sizeof(struct i2c_msg)); 92 state->msg[0].addr = state->i2c_addr >> 1; 93 state->msg[0].flags = 0; 94 state->msg[0].buf = state->i2c_write_buffer; 95 state->msg[0].len = 2; 96 state->msg[1].addr = state->i2c_addr >> 1; 97 state->msg[1].flags = I2C_M_RD; 98 state->msg[1].buf = state->i2c_read_buffer; 99 state->msg[1].len = 2; 100 101 if (i2c_transfer(state->i2c_adap, state->msg, 2) != 2) 102 dprintk("i2c read error on %d\n", reg); 103 104 ret = (state->i2c_read_buffer[0] << 8) | state->i2c_read_buffer[1]; 105 mutex_unlock(&state->i2c_buffer_lock); 106 107 return ret; 108 } 109 110 static int dib7000m_write_word(struct dib7000m_state *state, u16 reg, u16 val) 111 { 112 int ret; 113 114 if (mutex_lock_interruptible(&state->i2c_buffer_lock) < 0) { 115 dprintk("could not acquire lock\n"); 116 return -EINVAL; 117 } 118 119 state->i2c_write_buffer[0] = (reg >> 8) & 0xff; 120 state->i2c_write_buffer[1] = reg & 0xff; 121 state->i2c_write_buffer[2] = (val >> 8) & 0xff; 122 state->i2c_write_buffer[3] = val & 0xff; 123 124 memset(&state->msg[0], 0, sizeof(struct i2c_msg)); 125 state->msg[0].addr = state->i2c_addr >> 1; 126 state->msg[0].flags = 0; 127 state->msg[0].buf = state->i2c_write_buffer; 128 state->msg[0].len = 4; 129 130 ret = (i2c_transfer(state->i2c_adap, state->msg, 1) != 1 ? 131 -EREMOTEIO : 0); 132 mutex_unlock(&state->i2c_buffer_lock); 133 return ret; 134 } 135 static void dib7000m_write_tab(struct dib7000m_state *state, u16 *buf) 136 { 137 u16 l = 0, r, *n; 138 n = buf; 139 l = *n++; 140 while (l) { 141 r = *n++; 142 143 if (state->reg_offs && (r >= 112 && r <= 331)) // compensate for 7000MC 144 r++; 145 146 do { 147 dib7000m_write_word(state, r, *n++); 148 r++; 149 } while (--l); 150 l = *n++; 151 } 152 } 153 154 static int dib7000m_set_output_mode(struct dib7000m_state *state, int mode) 155 { 156 int ret = 0; 157 u16 outreg, fifo_threshold, smo_mode, 158 sram = 0x0005; /* by default SRAM output is disabled */ 159 160 outreg = 0; 161 fifo_threshold = 1792; 162 smo_mode = (dib7000m_read_word(state, 294 + state->reg_offs) & 0x0010) | (1 << 1); 163 164 dprintk("setting output mode for demod %p to %d\n", &state->demod, mode); 165 166 switch (mode) { 167 case OUTMODE_MPEG2_PAR_GATED_CLK: // STBs with parallel gated clock 168 outreg = (1 << 10); /* 0x0400 */ 169 break; 170 case OUTMODE_MPEG2_PAR_CONT_CLK: // STBs with parallel continues clock 171 outreg = (1 << 10) | (1 << 6); /* 0x0440 */ 172 break; 173 case OUTMODE_MPEG2_SERIAL: // STBs with serial input 174 outreg = (1 << 10) | (2 << 6) | (0 << 1); /* 0x0482 */ 175 break; 176 case OUTMODE_DIVERSITY: 177 if (state->cfg.hostbus_diversity) 178 outreg = (1 << 10) | (4 << 6); /* 0x0500 */ 179 else 180 sram |= 0x0c00; 181 break; 182 case OUTMODE_MPEG2_FIFO: // e.g. USB feeding 183 smo_mode |= (3 << 1); 184 fifo_threshold = 512; 185 outreg = (1 << 10) | (5 << 6); 186 break; 187 case OUTMODE_HIGH_Z: // disable 188 outreg = 0; 189 break; 190 default: 191 dprintk("Unhandled output_mode passed to be set for demod %p\n", &state->demod); 192 break; 193 } 194 195 if (state->cfg.output_mpeg2_in_188_bytes) 196 smo_mode |= (1 << 5) ; 197 198 ret |= dib7000m_write_word(state, 294 + state->reg_offs, smo_mode); 199 ret |= dib7000m_write_word(state, 295 + state->reg_offs, fifo_threshold); /* synchronous fread */ 200 ret |= dib7000m_write_word(state, 1795, outreg); 201 ret |= dib7000m_write_word(state, 1805, sram); 202 203 if (state->revision == 0x4003) { 204 u16 clk_cfg1 = dib7000m_read_word(state, 909) & 0xfffd; 205 if (mode == OUTMODE_DIVERSITY) 206 clk_cfg1 |= (1 << 1); // P_O_CLK_en 207 dib7000m_write_word(state, 909, clk_cfg1); 208 } 209 return ret; 210 } 211 212 static void dib7000m_set_power_mode(struct dib7000m_state *state, enum dib7000m_power_mode mode) 213 { 214 /* by default everything is going to be powered off */ 215 u16 reg_903 = 0xffff, reg_904 = 0xffff, reg_905 = 0xffff, reg_906 = 0x3fff; 216 u8 offset = 0; 217 218 /* now, depending on the requested mode, we power on */ 219 switch (mode) { 220 /* power up everything in the demod */ 221 case DIB7000M_POWER_ALL: 222 reg_903 = 0x0000; reg_904 = 0x0000; reg_905 = 0x0000; reg_906 = 0x0000; 223 break; 224 225 /* just leave power on the control-interfaces: GPIO and (I2C or SDIO or SRAM) */ 226 case DIB7000M_POWER_INTERFACE_ONLY: /* TODO power up either SDIO or I2C or SRAM */ 227 reg_905 &= ~((1 << 7) | (1 << 6) | (1 << 5) | (1 << 2)); 228 break; 229 230 case DIB7000M_POWER_INTERF_ANALOG_AGC: 231 reg_903 &= ~((1 << 15) | (1 << 14) | (1 << 11) | (1 << 10)); 232 reg_905 &= ~((1 << 7) | (1 << 6) | (1 << 5) | (1 << 4) | (1 << 2)); 233 reg_906 &= ~((1 << 0)); 234 break; 235 236 case DIB7000M_POWER_COR4_DINTLV_ICIRM_EQUAL_CFROD: 237 reg_903 = 0x0000; reg_904 = 0x801f; reg_905 = 0x0000; reg_906 = 0x0000; 238 break; 239 240 case DIB7000M_POWER_COR4_CRY_ESRAM_MOUT_NUD: 241 reg_903 = 0x0000; reg_904 = 0x8000; reg_905 = 0x010b; reg_906 = 0x0000; 242 break; 243 case DIB7000M_POWER_NO: 244 break; 245 } 246 247 /* always power down unused parts */ 248 if (!state->cfg.mobile_mode) 249 reg_904 |= (1 << 7) | (1 << 6) | (1 << 4) | (1 << 2) | (1 << 1); 250 251 /* P_sdio_select_clk = 0 on MC and after*/ 252 if (state->revision != 0x4000) 253 reg_906 <<= 1; 254 255 if (state->revision == 0x4003) 256 offset = 1; 257 258 dib7000m_write_word(state, 903 + offset, reg_903); 259 dib7000m_write_word(state, 904 + offset, reg_904); 260 dib7000m_write_word(state, 905 + offset, reg_905); 261 dib7000m_write_word(state, 906 + offset, reg_906); 262 } 263 264 static int dib7000m_set_adc_state(struct dib7000m_state *state, enum dibx000_adc_states no) 265 { 266 int ret = 0; 267 u16 reg_913 = dib7000m_read_word(state, 913), 268 reg_914 = dib7000m_read_word(state, 914); 269 270 switch (no) { 271 case DIBX000_SLOW_ADC_ON: 272 reg_914 |= (1 << 1) | (1 << 0); 273 ret |= dib7000m_write_word(state, 914, reg_914); 274 reg_914 &= ~(1 << 1); 275 break; 276 277 case DIBX000_SLOW_ADC_OFF: 278 reg_914 |= (1 << 1) | (1 << 0); 279 break; 280 281 case DIBX000_ADC_ON: 282 if (state->revision == 0x4000) { // workaround for PA/MA 283 // power-up ADC 284 dib7000m_write_word(state, 913, 0); 285 dib7000m_write_word(state, 914, reg_914 & 0x3); 286 // power-down bandgag 287 dib7000m_write_word(state, 913, (1 << 15)); 288 dib7000m_write_word(state, 914, reg_914 & 0x3); 289 } 290 291 reg_913 &= 0x0fff; 292 reg_914 &= 0x0003; 293 break; 294 295 case DIBX000_ADC_OFF: // leave the VBG voltage on 296 reg_913 |= (1 << 14) | (1 << 13) | (1 << 12); 297 reg_914 |= (1 << 5) | (1 << 4) | (1 << 3) | (1 << 2); 298 break; 299 300 case DIBX000_VBG_ENABLE: 301 reg_913 &= ~(1 << 15); 302 break; 303 304 case DIBX000_VBG_DISABLE: 305 reg_913 |= (1 << 15); 306 break; 307 308 default: 309 break; 310 } 311 312 // dprintk("913: %x, 914: %x\n", reg_913, reg_914); 313 ret |= dib7000m_write_word(state, 913, reg_913); 314 ret |= dib7000m_write_word(state, 914, reg_914); 315 316 return ret; 317 } 318 319 static int dib7000m_set_bandwidth(struct dib7000m_state *state, u32 bw) 320 { 321 u32 timf; 322 323 if (!bw) 324 bw = 8000; 325 326 // store the current bandwidth for later use 327 state->current_bandwidth = bw; 328 329 if (state->timf == 0) { 330 dprintk("using default timf\n"); 331 timf = state->timf_default; 332 } else { 333 dprintk("using updated timf\n"); 334 timf = state->timf; 335 } 336 337 timf = timf * (bw / 50) / 160; 338 339 dib7000m_write_word(state, 23, (u16) ((timf >> 16) & 0xffff)); 340 dib7000m_write_word(state, 24, (u16) ((timf ) & 0xffff)); 341 342 return 0; 343 } 344 345 static int dib7000m_set_diversity_in(struct dvb_frontend *demod, int onoff) 346 { 347 struct dib7000m_state *state = demod->demodulator_priv; 348 349 if (state->div_force_off) { 350 dprintk("diversity combination deactivated - forced by COFDM parameters\n"); 351 onoff = 0; 352 } 353 state->div_state = (u8)onoff; 354 355 if (onoff) { 356 dib7000m_write_word(state, 263 + state->reg_offs, 6); 357 dib7000m_write_word(state, 264 + state->reg_offs, 6); 358 dib7000m_write_word(state, 266 + state->reg_offs, (state->div_sync_wait << 4) | (1 << 2) | (2 << 0)); 359 } else { 360 dib7000m_write_word(state, 263 + state->reg_offs, 1); 361 dib7000m_write_word(state, 264 + state->reg_offs, 0); 362 dib7000m_write_word(state, 266 + state->reg_offs, 0); 363 } 364 365 return 0; 366 } 367 368 static int dib7000m_sad_calib(struct dib7000m_state *state) 369 { 370 371 /* internal */ 372 // dib7000m_write_word(state, 928, (3 << 14) | (1 << 12) | (524 << 0)); // sampling clock of the SAD is writing in set_bandwidth 373 dib7000m_write_word(state, 929, (0 << 1) | (0 << 0)); 374 dib7000m_write_word(state, 930, 776); // 0.625*3.3 / 4096 375 376 /* do the calibration */ 377 dib7000m_write_word(state, 929, (1 << 0)); 378 dib7000m_write_word(state, 929, (0 << 0)); 379 380 msleep(1); 381 382 return 0; 383 } 384 385 static void dib7000m_reset_pll_common(struct dib7000m_state *state, const struct dibx000_bandwidth_config *bw) 386 { 387 dib7000m_write_word(state, 18, (u16) (((bw->internal*1000) >> 16) & 0xffff)); 388 dib7000m_write_word(state, 19, (u16) ( (bw->internal*1000) & 0xffff)); 389 dib7000m_write_word(state, 21, (u16) ( (bw->ifreq >> 16) & 0xffff)); 390 dib7000m_write_word(state, 22, (u16) ( bw->ifreq & 0xffff)); 391 392 dib7000m_write_word(state, 928, bw->sad_cfg); 393 } 394 395 static void dib7000m_reset_pll(struct dib7000m_state *state) 396 { 397 const struct dibx000_bandwidth_config *bw = state->cfg.bw; 398 u16 reg_907,reg_910; 399 400 /* default */ 401 reg_907 = (bw->pll_bypass << 15) | (bw->modulo << 7) | 402 (bw->ADClkSrc << 6) | (bw->IO_CLK_en_core << 5) | (bw->bypclk_div << 2) | 403 (bw->enable_refdiv << 1) | (0 << 0); 404 reg_910 = (((bw->pll_ratio >> 6) & 0x3) << 3) | (bw->pll_range << 1) | bw->pll_reset; 405 406 // for this oscillator frequency should be 30 MHz for the Master (default values in the board_parameters give that value) 407 // this is only working only for 30 MHz crystals 408 if (!state->cfg.quartz_direct) { 409 reg_910 |= (1 << 5); // forcing the predivider to 1 410 411 // if the previous front-end is baseband, its output frequency is 15 MHz (prev freq divided by 2) 412 if(state->cfg.input_clk_is_div_2) 413 reg_907 |= (16 << 9); 414 else // otherwise the previous front-end puts out its input (default 30MHz) - no extra division necessary 415 reg_907 |= (8 << 9); 416 } else { 417 reg_907 |= (bw->pll_ratio & 0x3f) << 9; 418 reg_910 |= (bw->pll_prediv << 5); 419 } 420 421 dib7000m_write_word(state, 910, reg_910); // pll cfg 422 dib7000m_write_word(state, 907, reg_907); // clk cfg0 423 dib7000m_write_word(state, 908, 0x0006); // clk_cfg1 424 425 dib7000m_reset_pll_common(state, bw); 426 } 427 428 static void dib7000mc_reset_pll(struct dib7000m_state *state) 429 { 430 const struct dibx000_bandwidth_config *bw = state->cfg.bw; 431 u16 clk_cfg1; 432 433 // clk_cfg0 434 dib7000m_write_word(state, 907, (bw->pll_prediv << 8) | (bw->pll_ratio << 0)); 435 436 // clk_cfg1 437 //dib7000m_write_word(state, 908, (1 << 14) | (3 << 12) |(0 << 11) | 438 clk_cfg1 = (0 << 14) | (3 << 12) |(0 << 11) | 439 (bw->IO_CLK_en_core << 10) | (bw->bypclk_div << 5) | (bw->enable_refdiv << 4) | 440 (1 << 3) | (bw->pll_range << 1) | (bw->pll_reset << 0); 441 dib7000m_write_word(state, 908, clk_cfg1); 442 clk_cfg1 = (clk_cfg1 & 0xfff7) | (bw->pll_bypass << 3); 443 dib7000m_write_word(state, 908, clk_cfg1); 444 445 // smpl_cfg 446 dib7000m_write_word(state, 910, (1 << 12) | (2 << 10) | (bw->modulo << 8) | (bw->ADClkSrc << 7)); 447 448 dib7000m_reset_pll_common(state, bw); 449 } 450 451 static int dib7000m_reset_gpio(struct dib7000m_state *st) 452 { 453 /* reset the GPIOs */ 454 dib7000m_write_word(st, 773, st->cfg.gpio_dir); 455 dib7000m_write_word(st, 774, st->cfg.gpio_val); 456 457 /* TODO 782 is P_gpio_od */ 458 459 dib7000m_write_word(st, 775, st->cfg.gpio_pwm_pos); 460 461 dib7000m_write_word(st, 780, st->cfg.pwm_freq_div); 462 return 0; 463 } 464 465 static u16 dib7000m_defaults_common[] = 466 467 { 468 // auto search configuration 469 3, 2, 470 0x0004, 471 0x1000, 472 0x0814, 473 474 12, 6, 475 0x001b, 476 0x7740, 477 0x005b, 478 0x8d80, 479 0x01c9, 480 0xc380, 481 0x0000, 482 0x0080, 483 0x0000, 484 0x0090, 485 0x0001, 486 0xd4c0, 487 488 1, 26, 489 0x6680, // P_corm_thres Lock algorithms configuration 490 491 1, 170, 492 0x0410, // P_palf_alpha_regul, P_palf_filter_freeze, P_palf_filter_on 493 494 8, 173, 495 0, 496 0, 497 0, 498 0, 499 0, 500 0, 501 0, 502 0, 503 504 1, 182, 505 8192, // P_fft_nb_to_cut 506 507 2, 195, 508 0x0ccd, // P_pha3_thres 509 0, // P_cti_use_cpe, P_cti_use_prog 510 511 1, 205, 512 0x200f, // P_cspu_regul, P_cspu_win_cut 513 514 5, 214, 515 0x023d, // P_adp_regul_cnt 516 0x00a4, // P_adp_noise_cnt 517 0x00a4, // P_adp_regul_ext 518 0x7ff0, // P_adp_noise_ext 519 0x3ccc, // P_adp_fil 520 521 1, 226, 522 0, // P_2d_byp_ti_num 523 524 1, 255, 525 0x800, // P_equal_thres_wgn 526 527 1, 263, 528 0x0001, 529 530 1, 281, 531 0x0010, // P_fec_* 532 533 1, 294, 534 0x0062, // P_smo_mode, P_smo_rs_discard, P_smo_fifo_flush, P_smo_pid_parse, P_smo_error_discard 535 536 0 537 }; 538 539 static u16 dib7000m_defaults[] = 540 541 { 542 /* set ADC level to -16 */ 543 11, 76, 544 (1 << 13) - 825 - 117, 545 (1 << 13) - 837 - 117, 546 (1 << 13) - 811 - 117, 547 (1 << 13) - 766 - 117, 548 (1 << 13) - 737 - 117, 549 (1 << 13) - 693 - 117, 550 (1 << 13) - 648 - 117, 551 (1 << 13) - 619 - 117, 552 (1 << 13) - 575 - 117, 553 (1 << 13) - 531 - 117, 554 (1 << 13) - 501 - 117, 555 556 // Tuner IO bank: max drive (14mA) 557 1, 912, 558 0x2c8a, 559 560 1, 1817, 561 1, 562 563 0, 564 }; 565 566 static int dib7000m_demod_reset(struct dib7000m_state *state) 567 { 568 dib7000m_set_power_mode(state, DIB7000M_POWER_ALL); 569 570 /* always leave the VBG voltage on - it consumes almost nothing but takes a long time to start */ 571 dib7000m_set_adc_state(state, DIBX000_VBG_ENABLE); 572 573 /* restart all parts */ 574 dib7000m_write_word(state, 898, 0xffff); 575 dib7000m_write_word(state, 899, 0xffff); 576 dib7000m_write_word(state, 900, 0xff0f); 577 dib7000m_write_word(state, 901, 0xfffc); 578 579 dib7000m_write_word(state, 898, 0); 580 dib7000m_write_word(state, 899, 0); 581 dib7000m_write_word(state, 900, 0); 582 dib7000m_write_word(state, 901, 0); 583 584 if (state->revision == 0x4000) 585 dib7000m_reset_pll(state); 586 else 587 dib7000mc_reset_pll(state); 588 589 if (dib7000m_reset_gpio(state) != 0) 590 dprintk("GPIO reset was not successful.\n"); 591 592 if (dib7000m_set_output_mode(state, OUTMODE_HIGH_Z) != 0) 593 dprintk("OUTPUT_MODE could not be reset.\n"); 594 595 /* unforce divstr regardless whether i2c enumeration was done or not */ 596 dib7000m_write_word(state, 1794, dib7000m_read_word(state, 1794) & ~(1 << 1) ); 597 598 dib7000m_set_bandwidth(state, 8000); 599 600 dib7000m_set_adc_state(state, DIBX000_SLOW_ADC_ON); 601 dib7000m_sad_calib(state); 602 dib7000m_set_adc_state(state, DIBX000_SLOW_ADC_OFF); 603 604 if (state->cfg.dvbt_mode) 605 dib7000m_write_word(state, 1796, 0x0); // select DVB-T output 606 607 if (state->cfg.mobile_mode) 608 dib7000m_write_word(state, 261 + state->reg_offs, 2); 609 else 610 dib7000m_write_word(state, 224 + state->reg_offs, 1); 611 612 // P_iqc_alpha_pha, P_iqc_alpha_amp, P_iqc_dcc_alpha, ... 613 if(state->cfg.tuner_is_baseband) 614 dib7000m_write_word(state, 36, 0x0755); 615 else 616 dib7000m_write_word(state, 36, 0x1f55); 617 618 // P_divclksel=3 P_divbitsel=1 619 if (state->revision == 0x4000) 620 dib7000m_write_word(state, 909, (3 << 10) | (1 << 6)); 621 else 622 dib7000m_write_word(state, 909, (3 << 4) | 1); 623 624 dib7000m_write_tab(state, dib7000m_defaults_common); 625 dib7000m_write_tab(state, dib7000m_defaults); 626 627 dib7000m_set_power_mode(state, DIB7000M_POWER_INTERFACE_ONLY); 628 629 state->internal_clk = state->cfg.bw->internal; 630 631 return 0; 632 } 633 634 static void dib7000m_restart_agc(struct dib7000m_state *state) 635 { 636 // P_restart_iqc & P_restart_agc 637 dib7000m_write_word(state, 898, 0x0c00); 638 dib7000m_write_word(state, 898, 0x0000); 639 } 640 641 static int dib7000m_agc_soft_split(struct dib7000m_state *state) 642 { 643 u16 agc,split_offset; 644 645 if(!state->current_agc || !state->current_agc->perform_agc_softsplit || state->current_agc->split.max == 0) 646 return 0; 647 648 // n_agc_global 649 agc = dib7000m_read_word(state, 390); 650 651 if (agc > state->current_agc->split.min_thres) 652 split_offset = state->current_agc->split.min; 653 else if (agc < state->current_agc->split.max_thres) 654 split_offset = state->current_agc->split.max; 655 else 656 split_offset = state->current_agc->split.max * 657 (agc - state->current_agc->split.min_thres) / 658 (state->current_agc->split.max_thres - state->current_agc->split.min_thres); 659 660 dprintk("AGC split_offset: %d\n", split_offset); 661 662 // P_agc_force_split and P_agc_split_offset 663 return dib7000m_write_word(state, 103, (dib7000m_read_word(state, 103) & 0xff00) | split_offset); 664 } 665 666 static int dib7000m_update_lna(struct dib7000m_state *state) 667 { 668 u16 dyn_gain; 669 670 if (state->cfg.update_lna) { 671 // read dyn_gain here (because it is demod-dependent and not fe) 672 dyn_gain = dib7000m_read_word(state, 390); 673 674 if (state->cfg.update_lna(&state->demod,dyn_gain)) { // LNA has changed 675 dib7000m_restart_agc(state); 676 return 1; 677 } 678 } 679 return 0; 680 } 681 682 static int dib7000m_set_agc_config(struct dib7000m_state *state, u8 band) 683 { 684 struct dibx000_agc_config *agc = NULL; 685 int i; 686 if (state->current_band == band && state->current_agc != NULL) 687 return 0; 688 state->current_band = band; 689 690 for (i = 0; i < state->cfg.agc_config_count; i++) 691 if (state->cfg.agc[i].band_caps & band) { 692 agc = &state->cfg.agc[i]; 693 break; 694 } 695 696 if (agc == NULL) { 697 dprintk("no valid AGC configuration found for band 0x%02x\n", band); 698 return -EINVAL; 699 } 700 701 state->current_agc = agc; 702 703 /* AGC */ 704 dib7000m_write_word(state, 72 , agc->setup); 705 dib7000m_write_word(state, 73 , agc->inv_gain); 706 dib7000m_write_word(state, 74 , agc->time_stabiliz); 707 dib7000m_write_word(state, 97 , (agc->alpha_level << 12) | agc->thlock); 708 709 // Demod AGC loop configuration 710 dib7000m_write_word(state, 98, (agc->alpha_mant << 5) | agc->alpha_exp); 711 dib7000m_write_word(state, 99, (agc->beta_mant << 6) | agc->beta_exp); 712 713 dprintk("WBD: ref: %d, sel: %d, active: %d, alpha: %d\n", 714 state->wbd_ref != 0 ? state->wbd_ref : agc->wbd_ref, agc->wbd_sel, !agc->perform_agc_softsplit, agc->wbd_sel); 715 716 /* AGC continued */ 717 if (state->wbd_ref != 0) 718 dib7000m_write_word(state, 102, state->wbd_ref); 719 else // use default 720 dib7000m_write_word(state, 102, agc->wbd_ref); 721 722 dib7000m_write_word(state, 103, (agc->wbd_alpha << 9) | (agc->perform_agc_softsplit << 8) ); 723 dib7000m_write_word(state, 104, agc->agc1_max); 724 dib7000m_write_word(state, 105, agc->agc1_min); 725 dib7000m_write_word(state, 106, agc->agc2_max); 726 dib7000m_write_word(state, 107, agc->agc2_min); 727 dib7000m_write_word(state, 108, (agc->agc1_pt1 << 8) | agc->agc1_pt2 ); 728 dib7000m_write_word(state, 109, (agc->agc1_slope1 << 8) | agc->agc1_slope2); 729 dib7000m_write_word(state, 110, (agc->agc2_pt1 << 8) | agc->agc2_pt2); 730 dib7000m_write_word(state, 111, (agc->agc2_slope1 << 8) | agc->agc2_slope2); 731 732 if (state->revision > 0x4000) { // settings for the MC 733 dib7000m_write_word(state, 71, agc->agc1_pt3); 734 // dprintk("929: %x %d %d\n", 735 // (dib7000m_read_word(state, 929) & 0xffe3) | (agc->wbd_inv << 4) | (agc->wbd_sel << 2), agc->wbd_inv, agc->wbd_sel); 736 dib7000m_write_word(state, 929, (dib7000m_read_word(state, 929) & 0xffe3) | (agc->wbd_inv << 4) | (agc->wbd_sel << 2)); 737 } else { 738 // wrong default values 739 u16 b[9] = { 676, 696, 717, 737, 758, 778, 799, 819, 840 }; 740 for (i = 0; i < 9; i++) 741 dib7000m_write_word(state, 88 + i, b[i]); 742 } 743 return 0; 744 } 745 746 static void dib7000m_update_timf(struct dib7000m_state *state) 747 { 748 u32 timf = (dib7000m_read_word(state, 436) << 16) | dib7000m_read_word(state, 437); 749 state->timf = timf * 160 / (state->current_bandwidth / 50); 750 dib7000m_write_word(state, 23, (u16) (timf >> 16)); 751 dib7000m_write_word(state, 24, (u16) (timf & 0xffff)); 752 dprintk("updated timf_frequency: %d (default: %d)\n", state->timf, state->timf_default); 753 } 754 755 static int dib7000m_agc_startup(struct dvb_frontend *demod) 756 { 757 struct dtv_frontend_properties *ch = &demod->dtv_property_cache; 758 struct dib7000m_state *state = demod->demodulator_priv; 759 u16 cfg_72 = dib7000m_read_word(state, 72); 760 int ret = -1; 761 u8 *agc_state = &state->agc_state; 762 u8 agc_split; 763 764 switch (state->agc_state) { 765 case 0: 766 // set power-up level: interf+analog+AGC 767 dib7000m_set_power_mode(state, DIB7000M_POWER_INTERF_ANALOG_AGC); 768 dib7000m_set_adc_state(state, DIBX000_ADC_ON); 769 770 if (dib7000m_set_agc_config(state, BAND_OF_FREQUENCY(ch->frequency/1000)) != 0) 771 return -1; 772 773 ret = 7; /* ADC power up */ 774 (*agc_state)++; 775 break; 776 777 case 1: 778 /* AGC initialization */ 779 if (state->cfg.agc_control) 780 state->cfg.agc_control(&state->demod, 1); 781 782 dib7000m_write_word(state, 75, 32768); 783 if (!state->current_agc->perform_agc_softsplit) { 784 /* we are using the wbd - so slow AGC startup */ 785 dib7000m_write_word(state, 103, 1 << 8); /* force 0 split on WBD and restart AGC */ 786 (*agc_state)++; 787 ret = 5; 788 } else { 789 /* default AGC startup */ 790 (*agc_state) = 4; 791 /* wait AGC rough lock time */ 792 ret = 7; 793 } 794 795 dib7000m_restart_agc(state); 796 break; 797 798 case 2: /* fast split search path after 5sec */ 799 dib7000m_write_word(state, 72, cfg_72 | (1 << 4)); /* freeze AGC loop */ 800 dib7000m_write_word(state, 103, 2 << 9); /* fast split search 0.25kHz */ 801 (*agc_state)++; 802 ret = 14; 803 break; 804 805 case 3: /* split search ended */ 806 agc_split = (u8)dib7000m_read_word(state, 392); /* store the split value for the next time */ 807 dib7000m_write_word(state, 75, dib7000m_read_word(state, 390)); /* set AGC gain start value */ 808 809 dib7000m_write_word(state, 72, cfg_72 & ~(1 << 4)); /* std AGC loop */ 810 dib7000m_write_word(state, 103, (state->current_agc->wbd_alpha << 9) | agc_split); /* standard split search */ 811 812 dib7000m_restart_agc(state); 813 814 dprintk("SPLIT %p: %hd\n", demod, agc_split); 815 816 (*agc_state)++; 817 ret = 5; 818 break; 819 820 case 4: /* LNA startup */ 821 /* wait AGC accurate lock time */ 822 ret = 7; 823 824 if (dib7000m_update_lna(state)) 825 // wait only AGC rough lock time 826 ret = 5; 827 else 828 (*agc_state)++; 829 break; 830 831 case 5: 832 dib7000m_agc_soft_split(state); 833 834 if (state->cfg.agc_control) 835 state->cfg.agc_control(&state->demod, 0); 836 837 (*agc_state)++; 838 break; 839 840 default: 841 break; 842 } 843 return ret; 844 } 845 846 static void dib7000m_set_channel(struct dib7000m_state *state, struct dtv_frontend_properties *ch, 847 u8 seq) 848 { 849 u16 value, est[4]; 850 851 dib7000m_set_bandwidth(state, BANDWIDTH_TO_KHZ(ch->bandwidth_hz)); 852 853 /* nfft, guard, qam, alpha */ 854 value = 0; 855 switch (ch->transmission_mode) { 856 case TRANSMISSION_MODE_2K: value |= (0 << 7); break; 857 case TRANSMISSION_MODE_4K: value |= (2 << 7); break; 858 default: 859 case TRANSMISSION_MODE_8K: value |= (1 << 7); break; 860 } 861 switch (ch->guard_interval) { 862 case GUARD_INTERVAL_1_32: value |= (0 << 5); break; 863 case GUARD_INTERVAL_1_16: value |= (1 << 5); break; 864 case GUARD_INTERVAL_1_4: value |= (3 << 5); break; 865 default: 866 case GUARD_INTERVAL_1_8: value |= (2 << 5); break; 867 } 868 switch (ch->modulation) { 869 case QPSK: value |= (0 << 3); break; 870 case QAM_16: value |= (1 << 3); break; 871 default: 872 case QAM_64: value |= (2 << 3); break; 873 } 874 switch (HIERARCHY_1) { 875 case HIERARCHY_2: value |= 2; break; 876 case HIERARCHY_4: value |= 4; break; 877 default: 878 case HIERARCHY_1: value |= 1; break; 879 } 880 dib7000m_write_word(state, 0, value); 881 dib7000m_write_word(state, 5, (seq << 4)); 882 883 /* P_dintl_native, P_dintlv_inv, P_hrch, P_code_rate, P_select_hp */ 884 value = 0; 885 if (1 != 0) 886 value |= (1 << 6); 887 if (ch->hierarchy == 1) 888 value |= (1 << 4); 889 if (1 == 1) 890 value |= 1; 891 switch ((ch->hierarchy == 0 || 1 == 1) ? ch->code_rate_HP : ch->code_rate_LP) { 892 case FEC_2_3: value |= (2 << 1); break; 893 case FEC_3_4: value |= (3 << 1); break; 894 case FEC_5_6: value |= (5 << 1); break; 895 case FEC_7_8: value |= (7 << 1); break; 896 default: 897 case FEC_1_2: value |= (1 << 1); break; 898 } 899 dib7000m_write_word(state, 267 + state->reg_offs, value); 900 901 /* offset loop parameters */ 902 903 /* P_timf_alpha = 6, P_corm_alpha=6, P_corm_thres=0x80 */ 904 dib7000m_write_word(state, 26, (6 << 12) | (6 << 8) | 0x80); 905 906 /* P_ctrl_inh_cor=0, P_ctrl_alpha_cor=4, P_ctrl_inh_isi=1, P_ctrl_alpha_isi=3, P_ctrl_inh_cor4=1, P_ctrl_alpha_cor4=3 */ 907 dib7000m_write_word(state, 29, (0 << 14) | (4 << 10) | (1 << 9) | (3 << 5) | (1 << 4) | (0x3)); 908 909 /* P_ctrl_freeze_pha_shift=0, P_ctrl_pha_off_max=3 */ 910 dib7000m_write_word(state, 32, (0 << 4) | 0x3); 911 912 /* P_ctrl_sfreq_inh=0, P_ctrl_sfreq_step=5 */ 913 dib7000m_write_word(state, 33, (0 << 4) | 0x5); 914 915 /* P_dvsy_sync_wait */ 916 switch (ch->transmission_mode) { 917 case TRANSMISSION_MODE_8K: value = 256; break; 918 case TRANSMISSION_MODE_4K: value = 128; break; 919 case TRANSMISSION_MODE_2K: 920 default: value = 64; break; 921 } 922 switch (ch->guard_interval) { 923 case GUARD_INTERVAL_1_16: value *= 2; break; 924 case GUARD_INTERVAL_1_8: value *= 4; break; 925 case GUARD_INTERVAL_1_4: value *= 8; break; 926 default: 927 case GUARD_INTERVAL_1_32: value *= 1; break; 928 } 929 state->div_sync_wait = (value * 3) / 2 + 32; // add 50% SFN margin + compensate for one DVSY-fifo TODO 930 931 /* deactivate the possibility of diversity reception if extended interleave - not for 7000MC */ 932 /* P_dvsy_sync_mode = 0, P_dvsy_sync_enable=1, P_dvcb_comb_mode=2 */ 933 if (1 == 1 || state->revision > 0x4000) 934 state->div_force_off = 0; 935 else 936 state->div_force_off = 1; 937 dib7000m_set_diversity_in(&state->demod, state->div_state); 938 939 /* channel estimation fine configuration */ 940 switch (ch->modulation) { 941 case QAM_64: 942 est[0] = 0x0148; /* P_adp_regul_cnt 0.04 */ 943 est[1] = 0xfff0; /* P_adp_noise_cnt -0.002 */ 944 est[2] = 0x00a4; /* P_adp_regul_ext 0.02 */ 945 est[3] = 0xfff8; /* P_adp_noise_ext -0.001 */ 946 break; 947 case QAM_16: 948 est[0] = 0x023d; /* P_adp_regul_cnt 0.07 */ 949 est[1] = 0xffdf; /* P_adp_noise_cnt -0.004 */ 950 est[2] = 0x00a4; /* P_adp_regul_ext 0.02 */ 951 est[3] = 0xfff0; /* P_adp_noise_ext -0.002 */ 952 break; 953 default: 954 est[0] = 0x099a; /* P_adp_regul_cnt 0.3 */ 955 est[1] = 0xffae; /* P_adp_noise_cnt -0.01 */ 956 est[2] = 0x0333; /* P_adp_regul_ext 0.1 */ 957 est[3] = 0xfff8; /* P_adp_noise_ext -0.002 */ 958 break; 959 } 960 for (value = 0; value < 4; value++) 961 dib7000m_write_word(state, 214 + value + state->reg_offs, est[value]); 962 963 // set power-up level: autosearch 964 dib7000m_set_power_mode(state, DIB7000M_POWER_COR4_DINTLV_ICIRM_EQUAL_CFROD); 965 } 966 967 static int dib7000m_autosearch_start(struct dvb_frontend *demod) 968 { 969 struct dtv_frontend_properties *ch = &demod->dtv_property_cache; 970 struct dib7000m_state *state = demod->demodulator_priv; 971 struct dtv_frontend_properties schan; 972 int ret = 0; 973 u32 value, factor; 974 975 schan = *ch; 976 977 schan.modulation = QAM_64; 978 schan.guard_interval = GUARD_INTERVAL_1_32; 979 schan.transmission_mode = TRANSMISSION_MODE_8K; 980 schan.code_rate_HP = FEC_2_3; 981 schan.code_rate_LP = FEC_3_4; 982 schan.hierarchy = 0; 983 984 dib7000m_set_channel(state, &schan, 7); 985 986 factor = BANDWIDTH_TO_KHZ(schan.bandwidth_hz); 987 if (factor >= 5000) 988 factor = 1; 989 else 990 factor = 6; 991 992 // always use the setting for 8MHz here lock_time for 7,6 MHz are longer 993 value = 30 * state->internal_clk * factor; 994 ret |= dib7000m_write_word(state, 6, (u16) ((value >> 16) & 0xffff)); // lock0 wait time 995 ret |= dib7000m_write_word(state, 7, (u16) (value & 0xffff)); // lock0 wait time 996 value = 100 * state->internal_clk * factor; 997 ret |= dib7000m_write_word(state, 8, (u16) ((value >> 16) & 0xffff)); // lock1 wait time 998 ret |= dib7000m_write_word(state, 9, (u16) (value & 0xffff)); // lock1 wait time 999 value = 500 * state->internal_clk * factor; 1000 ret |= dib7000m_write_word(state, 10, (u16) ((value >> 16) & 0xffff)); // lock2 wait time 1001 ret |= dib7000m_write_word(state, 11, (u16) (value & 0xffff)); // lock2 wait time 1002 1003 // start search 1004 value = dib7000m_read_word(state, 0); 1005 ret |= dib7000m_write_word(state, 0, (u16) (value | (1 << 9))); 1006 1007 /* clear n_irq_pending */ 1008 if (state->revision == 0x4000) 1009 dib7000m_write_word(state, 1793, 0); 1010 else 1011 dib7000m_read_word(state, 537); 1012 1013 ret |= dib7000m_write_word(state, 0, (u16) value); 1014 1015 return ret; 1016 } 1017 1018 static int dib7000m_autosearch_irq(struct dib7000m_state *state, u16 reg) 1019 { 1020 u16 irq_pending = dib7000m_read_word(state, reg); 1021 1022 if (irq_pending & 0x1) { // failed 1023 dprintk("autosearch failed\n"); 1024 return 1; 1025 } 1026 1027 if (irq_pending & 0x2) { // succeeded 1028 dprintk("autosearch succeeded\n"); 1029 return 2; 1030 } 1031 return 0; // still pending 1032 } 1033 1034 static int dib7000m_autosearch_is_irq(struct dvb_frontend *demod) 1035 { 1036 struct dib7000m_state *state = demod->demodulator_priv; 1037 if (state->revision == 0x4000) 1038 return dib7000m_autosearch_irq(state, 1793); 1039 else 1040 return dib7000m_autosearch_irq(state, 537); 1041 } 1042 1043 static int dib7000m_tune(struct dvb_frontend *demod) 1044 { 1045 struct dtv_frontend_properties *ch = &demod->dtv_property_cache; 1046 struct dib7000m_state *state = demod->demodulator_priv; 1047 int ret = 0; 1048 u16 value; 1049 1050 // we are already tuned - just resuming from suspend 1051 dib7000m_set_channel(state, ch, 0); 1052 1053 // restart demod 1054 ret |= dib7000m_write_word(state, 898, 0x4000); 1055 ret |= dib7000m_write_word(state, 898, 0x0000); 1056 msleep(45); 1057 1058 dib7000m_set_power_mode(state, DIB7000M_POWER_COR4_CRY_ESRAM_MOUT_NUD); 1059 /* 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 */ 1060 ret |= dib7000m_write_word(state, 29, (0 << 14) | (4 << 10) | (0 << 9) | (3 << 5) | (1 << 4) | (0x3)); 1061 1062 // never achieved a lock before - wait for timfreq to update 1063 if (state->timf == 0) 1064 msleep(200); 1065 1066 //dump_reg(state); 1067 /* P_timf_alpha, P_corm_alpha=6, P_corm_thres=0x80 */ 1068 value = (6 << 8) | 0x80; 1069 switch (ch->transmission_mode) { 1070 case TRANSMISSION_MODE_2K: value |= (7 << 12); break; 1071 case TRANSMISSION_MODE_4K: value |= (8 << 12); break; 1072 default: 1073 case TRANSMISSION_MODE_8K: value |= (9 << 12); break; 1074 } 1075 ret |= dib7000m_write_word(state, 26, value); 1076 1077 /* P_ctrl_freeze_pha_shift=0, P_ctrl_pha_off_max */ 1078 value = (0 << 4); 1079 switch (ch->transmission_mode) { 1080 case TRANSMISSION_MODE_2K: value |= 0x6; break; 1081 case TRANSMISSION_MODE_4K: value |= 0x7; break; 1082 default: 1083 case TRANSMISSION_MODE_8K: value |= 0x8; break; 1084 } 1085 ret |= dib7000m_write_word(state, 32, value); 1086 1087 /* P_ctrl_sfreq_inh=0, P_ctrl_sfreq_step */ 1088 value = (0 << 4); 1089 switch (ch->transmission_mode) { 1090 case TRANSMISSION_MODE_2K: value |= 0x6; break; 1091 case TRANSMISSION_MODE_4K: value |= 0x7; break; 1092 default: 1093 case TRANSMISSION_MODE_8K: value |= 0x8; break; 1094 } 1095 ret |= dib7000m_write_word(state, 33, value); 1096 1097 // we achieved a lock - it's time to update the timf freq 1098 if ((dib7000m_read_word(state, 535) >> 6) & 0x1) 1099 dib7000m_update_timf(state); 1100 1101 dib7000m_set_bandwidth(state, BANDWIDTH_TO_KHZ(ch->bandwidth_hz)); 1102 return ret; 1103 } 1104 1105 static int dib7000m_wakeup(struct dvb_frontend *demod) 1106 { 1107 struct dib7000m_state *state = demod->demodulator_priv; 1108 1109 dib7000m_set_power_mode(state, DIB7000M_POWER_ALL); 1110 1111 if (dib7000m_set_adc_state(state, DIBX000_SLOW_ADC_ON) != 0) 1112 dprintk("could not start Slow ADC\n"); 1113 1114 return 0; 1115 } 1116 1117 static int dib7000m_sleep(struct dvb_frontend *demod) 1118 { 1119 struct dib7000m_state *st = demod->demodulator_priv; 1120 dib7000m_set_output_mode(st, OUTMODE_HIGH_Z); 1121 dib7000m_set_power_mode(st, DIB7000M_POWER_INTERFACE_ONLY); 1122 return dib7000m_set_adc_state(st, DIBX000_SLOW_ADC_OFF) | 1123 dib7000m_set_adc_state(st, DIBX000_ADC_OFF); 1124 } 1125 1126 static int dib7000m_identify(struct dib7000m_state *state) 1127 { 1128 u16 value; 1129 1130 if ((value = dib7000m_read_word(state, 896)) != 0x01b3) { 1131 dprintk("wrong Vendor ID (0x%x)\n", value); 1132 return -EREMOTEIO; 1133 } 1134 1135 state->revision = dib7000m_read_word(state, 897); 1136 if (state->revision != 0x4000 && 1137 state->revision != 0x4001 && 1138 state->revision != 0x4002 && 1139 state->revision != 0x4003) { 1140 dprintk("wrong Device ID (0x%x)\n", value); 1141 return -EREMOTEIO; 1142 } 1143 1144 /* protect this driver to be used with 7000PC */ 1145 if (state->revision == 0x4000 && dib7000m_read_word(state, 769) == 0x4000) { 1146 dprintk("this driver does not work with DiB7000PC\n"); 1147 return -EREMOTEIO; 1148 } 1149 1150 switch (state->revision) { 1151 case 0x4000: dprintk("found DiB7000MA/PA/MB/PB\n"); break; 1152 case 0x4001: state->reg_offs = 1; dprintk("found DiB7000HC\n"); break; 1153 case 0x4002: state->reg_offs = 1; dprintk("found DiB7000MC\n"); break; 1154 case 0x4003: state->reg_offs = 1; dprintk("found DiB9000\n"); break; 1155 } 1156 1157 return 0; 1158 } 1159 1160 1161 static int dib7000m_get_frontend(struct dvb_frontend* fe, 1162 struct dtv_frontend_properties *fep) 1163 { 1164 struct dib7000m_state *state = fe->demodulator_priv; 1165 u16 tps = dib7000m_read_word(state,480); 1166 1167 fep->inversion = INVERSION_AUTO; 1168 1169 fep->bandwidth_hz = BANDWIDTH_TO_HZ(state->current_bandwidth); 1170 1171 switch ((tps >> 8) & 0x3) { 1172 case 0: fep->transmission_mode = TRANSMISSION_MODE_2K; break; 1173 case 1: fep->transmission_mode = TRANSMISSION_MODE_8K; break; 1174 /* case 2: fep->transmission_mode = TRANSMISSION_MODE_4K; break; */ 1175 } 1176 1177 switch (tps & 0x3) { 1178 case 0: fep->guard_interval = GUARD_INTERVAL_1_32; break; 1179 case 1: fep->guard_interval = GUARD_INTERVAL_1_16; break; 1180 case 2: fep->guard_interval = GUARD_INTERVAL_1_8; break; 1181 case 3: fep->guard_interval = GUARD_INTERVAL_1_4; break; 1182 } 1183 1184 switch ((tps >> 14) & 0x3) { 1185 case 0: fep->modulation = QPSK; break; 1186 case 1: fep->modulation = QAM_16; break; 1187 case 2: 1188 default: fep->modulation = QAM_64; break; 1189 } 1190 1191 /* as long as the frontend_param structure is fixed for hierarchical transmission I refuse to use it */ 1192 /* (tps >> 13) & 0x1 == hrch is used, (tps >> 10) & 0x7 == alpha */ 1193 1194 fep->hierarchy = HIERARCHY_NONE; 1195 switch ((tps >> 5) & 0x7) { 1196 case 1: fep->code_rate_HP = FEC_1_2; break; 1197 case 2: fep->code_rate_HP = FEC_2_3; break; 1198 case 3: fep->code_rate_HP = FEC_3_4; break; 1199 case 5: fep->code_rate_HP = FEC_5_6; break; 1200 case 7: 1201 default: fep->code_rate_HP = FEC_7_8; break; 1202 1203 } 1204 1205 switch ((tps >> 2) & 0x7) { 1206 case 1: fep->code_rate_LP = FEC_1_2; break; 1207 case 2: fep->code_rate_LP = FEC_2_3; break; 1208 case 3: fep->code_rate_LP = FEC_3_4; break; 1209 case 5: fep->code_rate_LP = FEC_5_6; break; 1210 case 7: 1211 default: fep->code_rate_LP = FEC_7_8; break; 1212 } 1213 1214 /* native interleaver: (dib7000m_read_word(state, 481) >> 5) & 0x1 */ 1215 1216 return 0; 1217 } 1218 1219 static int dib7000m_set_frontend(struct dvb_frontend *fe) 1220 { 1221 struct dtv_frontend_properties *fep = &fe->dtv_property_cache; 1222 struct dib7000m_state *state = fe->demodulator_priv; 1223 int time, ret; 1224 1225 dib7000m_set_output_mode(state, OUTMODE_HIGH_Z); 1226 1227 dib7000m_set_bandwidth(state, BANDWIDTH_TO_KHZ(fep->bandwidth_hz)); 1228 1229 if (fe->ops.tuner_ops.set_params) 1230 fe->ops.tuner_ops.set_params(fe); 1231 1232 /* start up the AGC */ 1233 state->agc_state = 0; 1234 do { 1235 time = dib7000m_agc_startup(fe); 1236 if (time != -1) 1237 msleep(time); 1238 } while (time != -1); 1239 1240 if (fep->transmission_mode == TRANSMISSION_MODE_AUTO || 1241 fep->guard_interval == GUARD_INTERVAL_AUTO || 1242 fep->modulation == QAM_AUTO || 1243 fep->code_rate_HP == FEC_AUTO) { 1244 int i = 800, found; 1245 1246 dib7000m_autosearch_start(fe); 1247 do { 1248 msleep(1); 1249 found = dib7000m_autosearch_is_irq(fe); 1250 } while (found == 0 && i--); 1251 1252 dprintk("autosearch returns: %d\n", found); 1253 if (found == 0 || found == 1) 1254 return 0; // no channel found 1255 1256 dib7000m_get_frontend(fe, fep); 1257 } 1258 1259 ret = dib7000m_tune(fe); 1260 1261 /* make this a config parameter */ 1262 dib7000m_set_output_mode(state, OUTMODE_MPEG2_FIFO); 1263 return ret; 1264 } 1265 1266 static int dib7000m_read_status(struct dvb_frontend *fe, enum fe_status *stat) 1267 { 1268 struct dib7000m_state *state = fe->demodulator_priv; 1269 u16 lock = dib7000m_read_word(state, 535); 1270 1271 *stat = 0; 1272 1273 if (lock & 0x8000) 1274 *stat |= FE_HAS_SIGNAL; 1275 if (lock & 0x3000) 1276 *stat |= FE_HAS_CARRIER; 1277 if (lock & 0x0100) 1278 *stat |= FE_HAS_VITERBI; 1279 if (lock & 0x0010) 1280 *stat |= FE_HAS_SYNC; 1281 if (lock & 0x0008) 1282 *stat |= FE_HAS_LOCK; 1283 1284 return 0; 1285 } 1286 1287 static int dib7000m_read_ber(struct dvb_frontend *fe, u32 *ber) 1288 { 1289 struct dib7000m_state *state = fe->demodulator_priv; 1290 *ber = (dib7000m_read_word(state, 526) << 16) | dib7000m_read_word(state, 527); 1291 return 0; 1292 } 1293 1294 static int dib7000m_read_unc_blocks(struct dvb_frontend *fe, u32 *unc) 1295 { 1296 struct dib7000m_state *state = fe->demodulator_priv; 1297 *unc = dib7000m_read_word(state, 534); 1298 return 0; 1299 } 1300 1301 static int dib7000m_read_signal_strength(struct dvb_frontend *fe, u16 *strength) 1302 { 1303 struct dib7000m_state *state = fe->demodulator_priv; 1304 u16 val = dib7000m_read_word(state, 390); 1305 *strength = 65535 - val; 1306 return 0; 1307 } 1308 1309 static int dib7000m_read_snr(struct dvb_frontend* fe, u16 *snr) 1310 { 1311 *snr = 0x0000; 1312 return 0; 1313 } 1314 1315 static int dib7000m_fe_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings *tune) 1316 { 1317 tune->min_delay_ms = 1000; 1318 return 0; 1319 } 1320 1321 static void dib7000m_release(struct dvb_frontend *demod) 1322 { 1323 struct dib7000m_state *st = demod->demodulator_priv; 1324 dibx000_exit_i2c_master(&st->i2c_master); 1325 kfree(st); 1326 } 1327 1328 struct i2c_adapter * dib7000m_get_i2c_master(struct dvb_frontend *demod, enum dibx000_i2c_interface intf, int gating) 1329 { 1330 struct dib7000m_state *st = demod->demodulator_priv; 1331 return dibx000_get_i2c_adapter(&st->i2c_master, intf, gating); 1332 } 1333 EXPORT_SYMBOL(dib7000m_get_i2c_master); 1334 1335 int dib7000m_pid_filter_ctrl(struct dvb_frontend *fe, u8 onoff) 1336 { 1337 struct dib7000m_state *state = fe->demodulator_priv; 1338 u16 val = dib7000m_read_word(state, 294 + state->reg_offs) & 0xffef; 1339 val |= (onoff & 0x1) << 4; 1340 dprintk("PID filter enabled %d\n", onoff); 1341 return dib7000m_write_word(state, 294 + state->reg_offs, val); 1342 } 1343 EXPORT_SYMBOL(dib7000m_pid_filter_ctrl); 1344 1345 int dib7000m_pid_filter(struct dvb_frontend *fe, u8 id, u16 pid, u8 onoff) 1346 { 1347 struct dib7000m_state *state = fe->demodulator_priv; 1348 dprintk("PID filter: index %x, PID %d, OnOff %d\n", id, pid, onoff); 1349 return dib7000m_write_word(state, 300 + state->reg_offs + id, 1350 onoff ? (1 << 13) | pid : 0); 1351 } 1352 EXPORT_SYMBOL(dib7000m_pid_filter); 1353 1354 #if 0 1355 /* used with some prototype boards */ 1356 int dib7000m_i2c_enumeration(struct i2c_adapter *i2c, int no_of_demods, 1357 u8 default_addr, struct dib7000m_config cfg[]) 1358 { 1359 struct dib7000m_state st = { .i2c_adap = i2c }; 1360 int k = 0; 1361 u8 new_addr = 0; 1362 1363 for (k = no_of_demods-1; k >= 0; k--) { 1364 st.cfg = cfg[k]; 1365 1366 /* designated i2c address */ 1367 new_addr = (0x40 + k) << 1; 1368 st.i2c_addr = new_addr; 1369 if (dib7000m_identify(&st) != 0) { 1370 st.i2c_addr = default_addr; 1371 if (dib7000m_identify(&st) != 0) { 1372 dprintk("DiB7000M #%d: not identified\n", k); 1373 return -EIO; 1374 } 1375 } 1376 1377 /* start diversity to pull_down div_str - just for i2c-enumeration */ 1378 dib7000m_set_output_mode(&st, OUTMODE_DIVERSITY); 1379 1380 dib7000m_write_word(&st, 1796, 0x0); // select DVB-T output 1381 1382 /* set new i2c address and force divstart */ 1383 dib7000m_write_word(&st, 1794, (new_addr << 2) | 0x2); 1384 1385 dprintk("IC %d initialized (to i2c_address 0x%x)\n", k, new_addr); 1386 } 1387 1388 for (k = 0; k < no_of_demods; k++) { 1389 st.cfg = cfg[k]; 1390 st.i2c_addr = (0x40 + k) << 1; 1391 1392 // unforce divstr 1393 dib7000m_write_word(&st,1794, st.i2c_addr << 2); 1394 1395 /* deactivate div - it was just for i2c-enumeration */ 1396 dib7000m_set_output_mode(&st, OUTMODE_HIGH_Z); 1397 } 1398 1399 return 0; 1400 } 1401 EXPORT_SYMBOL(dib7000m_i2c_enumeration); 1402 #endif 1403 1404 static const struct dvb_frontend_ops dib7000m_ops; 1405 struct dvb_frontend * dib7000m_attach(struct i2c_adapter *i2c_adap, u8 i2c_addr, struct dib7000m_config *cfg) 1406 { 1407 struct dvb_frontend *demod; 1408 struct dib7000m_state *st; 1409 st = kzalloc(sizeof(struct dib7000m_state), GFP_KERNEL); 1410 if (st == NULL) 1411 return NULL; 1412 1413 memcpy(&st->cfg, cfg, sizeof(struct dib7000m_config)); 1414 st->i2c_adap = i2c_adap; 1415 st->i2c_addr = i2c_addr; 1416 1417 demod = &st->demod; 1418 demod->demodulator_priv = st; 1419 memcpy(&st->demod.ops, &dib7000m_ops, sizeof(struct dvb_frontend_ops)); 1420 mutex_init(&st->i2c_buffer_lock); 1421 1422 st->timf_default = cfg->bw->timf; 1423 1424 if (dib7000m_identify(st) != 0) 1425 goto error; 1426 1427 if (st->revision == 0x4000) 1428 dibx000_init_i2c_master(&st->i2c_master, DIB7000, st->i2c_adap, st->i2c_addr); 1429 else 1430 dibx000_init_i2c_master(&st->i2c_master, DIB7000MC, st->i2c_adap, st->i2c_addr); 1431 1432 dib7000m_demod_reset(st); 1433 1434 return demod; 1435 1436 error: 1437 kfree(st); 1438 return NULL; 1439 } 1440 EXPORT_SYMBOL(dib7000m_attach); 1441 1442 static const struct dvb_frontend_ops dib7000m_ops = { 1443 .delsys = { SYS_DVBT }, 1444 .info = { 1445 .name = "DiBcom 7000MA/MB/PA/PB/MC", 1446 .frequency_min_hz = 44250 * kHz, 1447 .frequency_max_hz = 867250 * kHz, 1448 .frequency_stepsize_hz = 62500, 1449 .caps = FE_CAN_INVERSION_AUTO | 1450 FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 | 1451 FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO | 1452 FE_CAN_QPSK | FE_CAN_QAM_16 | FE_CAN_QAM_64 | FE_CAN_QAM_AUTO | 1453 FE_CAN_TRANSMISSION_MODE_AUTO | 1454 FE_CAN_GUARD_INTERVAL_AUTO | 1455 FE_CAN_RECOVER | 1456 FE_CAN_HIERARCHY_AUTO, 1457 }, 1458 1459 .release = dib7000m_release, 1460 1461 .init = dib7000m_wakeup, 1462 .sleep = dib7000m_sleep, 1463 1464 .set_frontend = dib7000m_set_frontend, 1465 .get_tune_settings = dib7000m_fe_get_tune_settings, 1466 .get_frontend = dib7000m_get_frontend, 1467 1468 .read_status = dib7000m_read_status, 1469 .read_ber = dib7000m_read_ber, 1470 .read_signal_strength = dib7000m_read_signal_strength, 1471 .read_snr = dib7000m_read_snr, 1472 .read_ucblocks = dib7000m_read_unc_blocks, 1473 }; 1474 1475 MODULE_AUTHOR("Patrick Boettcher <patrick.boettcher@posteo.de>"); 1476 MODULE_DESCRIPTION("Driver for the DiBcom 7000MA/MB/PA/PB/MC COFDM demodulator"); 1477 MODULE_LICENSE("GPL"); 1478