1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * drxk_hard: DRX-K DVB-C/T demodulator driver 4 * 5 * Copyright (C) 2010-2011 Digital Devices GmbH 6 */ 7 8 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 9 10 #include <linux/kernel.h> 11 #include <linux/module.h> 12 #include <linux/moduleparam.h> 13 #include <linux/init.h> 14 #include <linux/delay.h> 15 #include <linux/firmware.h> 16 #include <linux/i2c.h> 17 #include <linux/hardirq.h> 18 #include <asm/div64.h> 19 20 #include <media/dvb_frontend.h> 21 #include "drxk.h" 22 #include "drxk_hard.h" 23 #include <media/dvb_math.h> 24 25 static int power_down_dvbt(struct drxk_state *state, bool set_power_mode); 26 static int power_down_qam(struct drxk_state *state); 27 static int set_dvbt_standard(struct drxk_state *state, 28 enum operation_mode o_mode); 29 static int set_qam_standard(struct drxk_state *state, 30 enum operation_mode o_mode); 31 static int set_qam(struct drxk_state *state, u16 intermediate_freqk_hz, 32 s32 tuner_freq_offset); 33 static int set_dvbt_standard(struct drxk_state *state, 34 enum operation_mode o_mode); 35 static int dvbt_start(struct drxk_state *state); 36 static int set_dvbt(struct drxk_state *state, u16 intermediate_freqk_hz, 37 s32 tuner_freq_offset); 38 static int get_qam_lock_status(struct drxk_state *state, u32 *p_lock_status); 39 static int get_dvbt_lock_status(struct drxk_state *state, u32 *p_lock_status); 40 static int switch_antenna_to_qam(struct drxk_state *state); 41 static int switch_antenna_to_dvbt(struct drxk_state *state); 42 43 static bool is_dvbt(struct drxk_state *state) 44 { 45 return state->m_operation_mode == OM_DVBT; 46 } 47 48 static bool is_qam(struct drxk_state *state) 49 { 50 return state->m_operation_mode == OM_QAM_ITU_A || 51 state->m_operation_mode == OM_QAM_ITU_B || 52 state->m_operation_mode == OM_QAM_ITU_C; 53 } 54 55 #define NOA1ROM 0 56 57 #define DRXDAP_FASI_SHORT_FORMAT(addr) (((addr) & 0xFC30FF80) == 0) 58 #define DRXDAP_FASI_LONG_FORMAT(addr) (((addr) & 0xFC30FF80) != 0) 59 60 #define DEFAULT_MER_83 165 61 #define DEFAULT_MER_93 250 62 63 #ifndef DRXK_MPEG_SERIAL_OUTPUT_PIN_DRIVE_STRENGTH 64 #define DRXK_MPEG_SERIAL_OUTPUT_PIN_DRIVE_STRENGTH (0x02) 65 #endif 66 67 #ifndef DRXK_MPEG_PARALLEL_OUTPUT_PIN_DRIVE_STRENGTH 68 #define DRXK_MPEG_PARALLEL_OUTPUT_PIN_DRIVE_STRENGTH (0x03) 69 #endif 70 71 #define DEFAULT_DRXK_MPEG_LOCK_TIMEOUT 700 72 #define DEFAULT_DRXK_DEMOD_LOCK_TIMEOUT 500 73 74 #ifndef DRXK_KI_RAGC_ATV 75 #define DRXK_KI_RAGC_ATV 4 76 #endif 77 #ifndef DRXK_KI_IAGC_ATV 78 #define DRXK_KI_IAGC_ATV 6 79 #endif 80 #ifndef DRXK_KI_DAGC_ATV 81 #define DRXK_KI_DAGC_ATV 7 82 #endif 83 84 #ifndef DRXK_KI_RAGC_QAM 85 #define DRXK_KI_RAGC_QAM 3 86 #endif 87 #ifndef DRXK_KI_IAGC_QAM 88 #define DRXK_KI_IAGC_QAM 4 89 #endif 90 #ifndef DRXK_KI_DAGC_QAM 91 #define DRXK_KI_DAGC_QAM 7 92 #endif 93 #ifndef DRXK_KI_RAGC_DVBT 94 #define DRXK_KI_RAGC_DVBT (IsA1WithPatchCode(state) ? 3 : 2) 95 #endif 96 #ifndef DRXK_KI_IAGC_DVBT 97 #define DRXK_KI_IAGC_DVBT (IsA1WithPatchCode(state) ? 4 : 2) 98 #endif 99 #ifndef DRXK_KI_DAGC_DVBT 100 #define DRXK_KI_DAGC_DVBT (IsA1WithPatchCode(state) ? 10 : 7) 101 #endif 102 103 #ifndef DRXK_AGC_DAC_OFFSET 104 #define DRXK_AGC_DAC_OFFSET (0x800) 105 #endif 106 107 #ifndef DRXK_BANDWIDTH_8MHZ_IN_HZ 108 #define DRXK_BANDWIDTH_8MHZ_IN_HZ (0x8B8249L) 109 #endif 110 111 #ifndef DRXK_BANDWIDTH_7MHZ_IN_HZ 112 #define DRXK_BANDWIDTH_7MHZ_IN_HZ (0x7A1200L) 113 #endif 114 115 #ifndef DRXK_BANDWIDTH_6MHZ_IN_HZ 116 #define DRXK_BANDWIDTH_6MHZ_IN_HZ (0x68A1B6L) 117 #endif 118 119 #ifndef DRXK_QAM_SYMBOLRATE_MAX 120 #define DRXK_QAM_SYMBOLRATE_MAX (7233000) 121 #endif 122 123 #define DRXK_BL_ROM_OFFSET_TAPS_DVBT 56 124 #define DRXK_BL_ROM_OFFSET_TAPS_ITU_A 64 125 #define DRXK_BL_ROM_OFFSET_TAPS_ITU_C 0x5FE0 126 #define DRXK_BL_ROM_OFFSET_TAPS_BG 24 127 #define DRXK_BL_ROM_OFFSET_TAPS_DKILLP 32 128 #define DRXK_BL_ROM_OFFSET_TAPS_NTSC 40 129 #define DRXK_BL_ROM_OFFSET_TAPS_FM 48 130 #define DRXK_BL_ROM_OFFSET_UCODE 0 131 132 #define DRXK_BLC_TIMEOUT 100 133 134 #define DRXK_BLCC_NR_ELEMENTS_TAPS 2 135 #define DRXK_BLCC_NR_ELEMENTS_UCODE 6 136 137 #define DRXK_BLDC_NR_ELEMENTS_TAPS 28 138 139 #ifndef DRXK_OFDM_NE_NOTCH_WIDTH 140 #define DRXK_OFDM_NE_NOTCH_WIDTH (4) 141 #endif 142 143 #define DRXK_QAM_SL_SIG_POWER_QAM16 (40960) 144 #define DRXK_QAM_SL_SIG_POWER_QAM32 (20480) 145 #define DRXK_QAM_SL_SIG_POWER_QAM64 (43008) 146 #define DRXK_QAM_SL_SIG_POWER_QAM128 (20992) 147 #define DRXK_QAM_SL_SIG_POWER_QAM256 (43520) 148 149 static unsigned int debug; 150 module_param(debug, int, 0644); 151 MODULE_PARM_DESC(debug, "enable debug messages"); 152 153 #define dprintk(level, fmt, arg...) do { \ 154 if (debug >= level) \ 155 printk(KERN_DEBUG KBUILD_MODNAME ": %s " fmt, __func__, ##arg); \ 156 } while (0) 157 158 static inline u32 Frac28a(u32 a, u32 c) 159 { 160 int i = 0; 161 u32 Q1 = 0; 162 u32 R0 = 0; 163 164 R0 = (a % c) << 4; /* 32-28 == 4 shifts possible at max */ 165 Q1 = a / c; /* 166 * integer part, only the 4 least significant 167 * bits will be visible in the result 168 */ 169 170 /* division using radix 16, 7 nibbles in the result */ 171 for (i = 0; i < 7; i++) { 172 Q1 = (Q1 << 4) | (R0 / c); 173 R0 = (R0 % c) << 4; 174 } 175 /* rounding */ 176 if ((R0 >> 3) >= c) 177 Q1++; 178 179 return Q1; 180 } 181 182 static inline u32 log10times100(u32 value) 183 { 184 return (100L * intlog10(value)) >> 24; 185 } 186 187 /***************************************************************************/ 188 /* I2C **********************************************************************/ 189 /***************************************************************************/ 190 191 static int drxk_i2c_lock(struct drxk_state *state) 192 { 193 i2c_lock_bus(state->i2c, I2C_LOCK_SEGMENT); 194 state->drxk_i2c_exclusive_lock = true; 195 196 return 0; 197 } 198 199 static void drxk_i2c_unlock(struct drxk_state *state) 200 { 201 if (!state->drxk_i2c_exclusive_lock) 202 return; 203 204 i2c_unlock_bus(state->i2c, I2C_LOCK_SEGMENT); 205 state->drxk_i2c_exclusive_lock = false; 206 } 207 208 static int drxk_i2c_transfer(struct drxk_state *state, struct i2c_msg *msgs, 209 unsigned len) 210 { 211 if (state->drxk_i2c_exclusive_lock) 212 return __i2c_transfer(state->i2c, msgs, len); 213 else 214 return i2c_transfer(state->i2c, msgs, len); 215 } 216 217 static int i2c_read1(struct drxk_state *state, u8 adr, u8 *val) 218 { 219 struct i2c_msg msgs[1] = { {.addr = adr, .flags = I2C_M_RD, 220 .buf = val, .len = 1} 221 }; 222 223 return drxk_i2c_transfer(state, msgs, 1); 224 } 225 226 static int i2c_write(struct drxk_state *state, u8 adr, u8 *data, int len) 227 { 228 int status; 229 struct i2c_msg msg = { 230 .addr = adr, .flags = 0, .buf = data, .len = len }; 231 232 dprintk(3, ":"); 233 if (debug > 2) { 234 int i; 235 for (i = 0; i < len; i++) 236 pr_cont(" %02x", data[i]); 237 pr_cont("\n"); 238 } 239 status = drxk_i2c_transfer(state, &msg, 1); 240 if (status >= 0 && status != 1) 241 status = -EIO; 242 243 if (status < 0) 244 pr_err("i2c write error at addr 0x%02x\n", adr); 245 246 return status; 247 } 248 249 static int i2c_read(struct drxk_state *state, 250 u8 adr, u8 *msg, int len, u8 *answ, int alen) 251 { 252 int status; 253 struct i2c_msg msgs[2] = { 254 {.addr = adr, .flags = 0, 255 .buf = msg, .len = len}, 256 {.addr = adr, .flags = I2C_M_RD, 257 .buf = answ, .len = alen} 258 }; 259 260 status = drxk_i2c_transfer(state, msgs, 2); 261 if (status != 2) { 262 if (debug > 2) 263 pr_cont(": ERROR!\n"); 264 if (status >= 0) 265 status = -EIO; 266 267 pr_err("i2c read error at addr 0x%02x\n", adr); 268 return status; 269 } 270 if (debug > 2) { 271 int i; 272 dprintk(2, ": read from"); 273 for (i = 0; i < len; i++) 274 pr_cont(" %02x", msg[i]); 275 pr_cont(", value = "); 276 for (i = 0; i < alen; i++) 277 pr_cont(" %02x", answ[i]); 278 pr_cont("\n"); 279 } 280 return 0; 281 } 282 283 static int read16_flags(struct drxk_state *state, u32 reg, u16 *data, u8 flags) 284 { 285 int status; 286 u8 adr = state->demod_address, mm1[4], mm2[2], len; 287 288 if (state->single_master) 289 flags |= 0xC0; 290 291 if (DRXDAP_FASI_LONG_FORMAT(reg) || (flags != 0)) { 292 mm1[0] = (((reg << 1) & 0xFF) | 0x01); 293 mm1[1] = ((reg >> 16) & 0xFF); 294 mm1[2] = ((reg >> 24) & 0xFF) | flags; 295 mm1[3] = ((reg >> 7) & 0xFF); 296 len = 4; 297 } else { 298 mm1[0] = ((reg << 1) & 0xFF); 299 mm1[1] = (((reg >> 16) & 0x0F) | ((reg >> 18) & 0xF0)); 300 len = 2; 301 } 302 dprintk(2, "(0x%08x, 0x%02x)\n", reg, flags); 303 status = i2c_read(state, adr, mm1, len, mm2, 2); 304 if (status < 0) 305 return status; 306 if (data) 307 *data = mm2[0] | (mm2[1] << 8); 308 309 return 0; 310 } 311 312 static int read16(struct drxk_state *state, u32 reg, u16 *data) 313 { 314 return read16_flags(state, reg, data, 0); 315 } 316 317 static int read32_flags(struct drxk_state *state, u32 reg, u32 *data, u8 flags) 318 { 319 int status; 320 u8 adr = state->demod_address, mm1[4], mm2[4], len; 321 322 if (state->single_master) 323 flags |= 0xC0; 324 325 if (DRXDAP_FASI_LONG_FORMAT(reg) || (flags != 0)) { 326 mm1[0] = (((reg << 1) & 0xFF) | 0x01); 327 mm1[1] = ((reg >> 16) & 0xFF); 328 mm1[2] = ((reg >> 24) & 0xFF) | flags; 329 mm1[3] = ((reg >> 7) & 0xFF); 330 len = 4; 331 } else { 332 mm1[0] = ((reg << 1) & 0xFF); 333 mm1[1] = (((reg >> 16) & 0x0F) | ((reg >> 18) & 0xF0)); 334 len = 2; 335 } 336 dprintk(2, "(0x%08x, 0x%02x)\n", reg, flags); 337 status = i2c_read(state, adr, mm1, len, mm2, 4); 338 if (status < 0) 339 return status; 340 if (data) 341 *data = mm2[0] | (mm2[1] << 8) | 342 (mm2[2] << 16) | (mm2[3] << 24); 343 344 return 0; 345 } 346 347 static int read32(struct drxk_state *state, u32 reg, u32 *data) 348 { 349 return read32_flags(state, reg, data, 0); 350 } 351 352 static int write16_flags(struct drxk_state *state, u32 reg, u16 data, u8 flags) 353 { 354 u8 adr = state->demod_address, mm[6], len; 355 356 if (state->single_master) 357 flags |= 0xC0; 358 if (DRXDAP_FASI_LONG_FORMAT(reg) || (flags != 0)) { 359 mm[0] = (((reg << 1) & 0xFF) | 0x01); 360 mm[1] = ((reg >> 16) & 0xFF); 361 mm[2] = ((reg >> 24) & 0xFF) | flags; 362 mm[3] = ((reg >> 7) & 0xFF); 363 len = 4; 364 } else { 365 mm[0] = ((reg << 1) & 0xFF); 366 mm[1] = (((reg >> 16) & 0x0F) | ((reg >> 18) & 0xF0)); 367 len = 2; 368 } 369 mm[len] = data & 0xff; 370 mm[len + 1] = (data >> 8) & 0xff; 371 372 dprintk(2, "(0x%08x, 0x%04x, 0x%02x)\n", reg, data, flags); 373 return i2c_write(state, adr, mm, len + 2); 374 } 375 376 static int write16(struct drxk_state *state, u32 reg, u16 data) 377 { 378 return write16_flags(state, reg, data, 0); 379 } 380 381 static int write32_flags(struct drxk_state *state, u32 reg, u32 data, u8 flags) 382 { 383 u8 adr = state->demod_address, mm[8], len; 384 385 if (state->single_master) 386 flags |= 0xC0; 387 if (DRXDAP_FASI_LONG_FORMAT(reg) || (flags != 0)) { 388 mm[0] = (((reg << 1) & 0xFF) | 0x01); 389 mm[1] = ((reg >> 16) & 0xFF); 390 mm[2] = ((reg >> 24) & 0xFF) | flags; 391 mm[3] = ((reg >> 7) & 0xFF); 392 len = 4; 393 } else { 394 mm[0] = ((reg << 1) & 0xFF); 395 mm[1] = (((reg >> 16) & 0x0F) | ((reg >> 18) & 0xF0)); 396 len = 2; 397 } 398 mm[len] = data & 0xff; 399 mm[len + 1] = (data >> 8) & 0xff; 400 mm[len + 2] = (data >> 16) & 0xff; 401 mm[len + 3] = (data >> 24) & 0xff; 402 dprintk(2, "(0x%08x, 0x%08x, 0x%02x)\n", reg, data, flags); 403 404 return i2c_write(state, adr, mm, len + 4); 405 } 406 407 static int write32(struct drxk_state *state, u32 reg, u32 data) 408 { 409 return write32_flags(state, reg, data, 0); 410 } 411 412 static int write_block(struct drxk_state *state, u32 address, 413 const int block_size, const u8 p_block[]) 414 { 415 int status = 0, blk_size = block_size; 416 u8 flags = 0; 417 418 if (state->single_master) 419 flags |= 0xC0; 420 421 while (blk_size > 0) { 422 int chunk = blk_size > state->m_chunk_size ? 423 state->m_chunk_size : blk_size; 424 u8 *adr_buf = &state->chunk[0]; 425 u32 adr_length = 0; 426 427 if (DRXDAP_FASI_LONG_FORMAT(address) || (flags != 0)) { 428 adr_buf[0] = (((address << 1) & 0xFF) | 0x01); 429 adr_buf[1] = ((address >> 16) & 0xFF); 430 adr_buf[2] = ((address >> 24) & 0xFF); 431 adr_buf[3] = ((address >> 7) & 0xFF); 432 adr_buf[2] |= flags; 433 adr_length = 4; 434 if (chunk == state->m_chunk_size) 435 chunk -= 2; 436 } else { 437 adr_buf[0] = ((address << 1) & 0xFF); 438 adr_buf[1] = (((address >> 16) & 0x0F) | 439 ((address >> 18) & 0xF0)); 440 adr_length = 2; 441 } 442 memcpy(&state->chunk[adr_length], p_block, chunk); 443 dprintk(2, "(0x%08x, 0x%02x)\n", address, flags); 444 if (debug > 1) { 445 int i; 446 if (p_block) 447 for (i = 0; i < chunk; i++) 448 pr_cont(" %02x", p_block[i]); 449 pr_cont("\n"); 450 } 451 status = i2c_write(state, state->demod_address, 452 &state->chunk[0], chunk + adr_length); 453 if (status < 0) { 454 pr_err("%s: i2c write error at addr 0x%02x\n", 455 __func__, address); 456 break; 457 } 458 p_block += chunk; 459 address += (chunk >> 1); 460 blk_size -= chunk; 461 } 462 return status; 463 } 464 465 #ifndef DRXK_MAX_RETRIES_POWERUP 466 #define DRXK_MAX_RETRIES_POWERUP 20 467 #endif 468 469 static int power_up_device(struct drxk_state *state) 470 { 471 int status; 472 u8 data = 0; 473 u16 retry_count = 0; 474 475 dprintk(1, "\n"); 476 477 status = i2c_read1(state, state->demod_address, &data); 478 if (status < 0) { 479 do { 480 data = 0; 481 status = i2c_write(state, state->demod_address, 482 &data, 1); 483 usleep_range(10000, 11000); 484 retry_count++; 485 if (status < 0) 486 continue; 487 status = i2c_read1(state, state->demod_address, 488 &data); 489 } while (status < 0 && 490 (retry_count < DRXK_MAX_RETRIES_POWERUP)); 491 if (status < 0 && retry_count >= DRXK_MAX_RETRIES_POWERUP) 492 goto error; 493 } 494 495 /* Make sure all clk domains are active */ 496 status = write16(state, SIO_CC_PWD_MODE__A, SIO_CC_PWD_MODE_LEVEL_NONE); 497 if (status < 0) 498 goto error; 499 status = write16(state, SIO_CC_UPDATE__A, SIO_CC_UPDATE_KEY); 500 if (status < 0) 501 goto error; 502 /* Enable pll lock tests */ 503 status = write16(state, SIO_CC_PLL_LOCK__A, 1); 504 if (status < 0) 505 goto error; 506 507 state->m_current_power_mode = DRX_POWER_UP; 508 509 error: 510 if (status < 0) 511 pr_err("Error %d on %s\n", status, __func__); 512 513 return status; 514 } 515 516 517 static int init_state(struct drxk_state *state) 518 { 519 /* 520 * FIXME: most (all?) of the values below should be moved into 521 * struct drxk_config, as they are probably board-specific 522 */ 523 u32 ul_vsb_if_agc_mode = DRXK_AGC_CTRL_AUTO; 524 u32 ul_vsb_if_agc_output_level = 0; 525 u32 ul_vsb_if_agc_min_level = 0; 526 u32 ul_vsb_if_agc_max_level = 0x7FFF; 527 u32 ul_vsb_if_agc_speed = 3; 528 529 u32 ul_vsb_rf_agc_mode = DRXK_AGC_CTRL_AUTO; 530 u32 ul_vsb_rf_agc_output_level = 0; 531 u32 ul_vsb_rf_agc_min_level = 0; 532 u32 ul_vsb_rf_agc_max_level = 0x7FFF; 533 u32 ul_vsb_rf_agc_speed = 3; 534 u32 ul_vsb_rf_agc_top = 9500; 535 u32 ul_vsb_rf_agc_cut_off_current = 4000; 536 537 u32 ul_atv_if_agc_mode = DRXK_AGC_CTRL_AUTO; 538 u32 ul_atv_if_agc_output_level = 0; 539 u32 ul_atv_if_agc_min_level = 0; 540 u32 ul_atv_if_agc_max_level = 0; 541 u32 ul_atv_if_agc_speed = 3; 542 543 u32 ul_atv_rf_agc_mode = DRXK_AGC_CTRL_OFF; 544 u32 ul_atv_rf_agc_output_level = 0; 545 u32 ul_atv_rf_agc_min_level = 0; 546 u32 ul_atv_rf_agc_max_level = 0; 547 u32 ul_atv_rf_agc_top = 9500; 548 u32 ul_atv_rf_agc_cut_off_current = 4000; 549 u32 ul_atv_rf_agc_speed = 3; 550 551 u32 ulQual83 = DEFAULT_MER_83; 552 u32 ulQual93 = DEFAULT_MER_93; 553 554 u32 ul_mpeg_lock_time_out = DEFAULT_DRXK_MPEG_LOCK_TIMEOUT; 555 u32 ul_demod_lock_time_out = DEFAULT_DRXK_DEMOD_LOCK_TIMEOUT; 556 557 /* io_pad_cfg register (8 bit reg.) MSB bit is 1 (default value) */ 558 /* io_pad_cfg_mode output mode is drive always */ 559 /* io_pad_cfg_drive is set to power 2 (23 mA) */ 560 u32 ul_gpio_cfg = 0x0113; 561 u32 ul_invert_ts_clock = 0; 562 u32 ul_ts_data_strength = DRXK_MPEG_SERIAL_OUTPUT_PIN_DRIVE_STRENGTH; 563 u32 ul_dvbt_bitrate = 50000000; 564 u32 ul_dvbc_bitrate = DRXK_QAM_SYMBOLRATE_MAX * 8; 565 566 u32 ul_insert_rs_byte = 0; 567 568 u32 ul_rf_mirror = 1; 569 u32 ul_power_down = 0; 570 571 dprintk(1, "\n"); 572 573 state->m_has_lna = false; 574 state->m_has_dvbt = false; 575 state->m_has_dvbc = false; 576 state->m_has_atv = false; 577 state->m_has_oob = false; 578 state->m_has_audio = false; 579 580 if (!state->m_chunk_size) 581 state->m_chunk_size = 124; 582 583 state->m_osc_clock_freq = 0; 584 state->m_smart_ant_inverted = false; 585 state->m_b_p_down_open_bridge = false; 586 587 /* real system clock frequency in kHz */ 588 state->m_sys_clock_freq = 151875; 589 /* Timing div, 250ns/Psys */ 590 /* Timing div, = (delay (nano seconds) * sysclk (kHz))/ 1000 */ 591 state->m_hi_cfg_timing_div = ((state->m_sys_clock_freq / 1000) * 592 HI_I2C_DELAY) / 1000; 593 /* Clipping */ 594 if (state->m_hi_cfg_timing_div > SIO_HI_RA_RAM_PAR_2_CFG_DIV__M) 595 state->m_hi_cfg_timing_div = SIO_HI_RA_RAM_PAR_2_CFG_DIV__M; 596 state->m_hi_cfg_wake_up_key = (state->demod_address << 1); 597 /* port/bridge/power down ctrl */ 598 state->m_hi_cfg_ctrl = SIO_HI_RA_RAM_PAR_5_CFG_SLV0_SLAVE; 599 600 state->m_b_power_down = (ul_power_down != 0); 601 602 state->m_drxk_a3_patch_code = false; 603 604 /* Init AGC and PGA parameters */ 605 /* VSB IF */ 606 state->m_vsb_if_agc_cfg.ctrl_mode = ul_vsb_if_agc_mode; 607 state->m_vsb_if_agc_cfg.output_level = ul_vsb_if_agc_output_level; 608 state->m_vsb_if_agc_cfg.min_output_level = ul_vsb_if_agc_min_level; 609 state->m_vsb_if_agc_cfg.max_output_level = ul_vsb_if_agc_max_level; 610 state->m_vsb_if_agc_cfg.speed = ul_vsb_if_agc_speed; 611 state->m_vsb_pga_cfg = 140; 612 613 /* VSB RF */ 614 state->m_vsb_rf_agc_cfg.ctrl_mode = ul_vsb_rf_agc_mode; 615 state->m_vsb_rf_agc_cfg.output_level = ul_vsb_rf_agc_output_level; 616 state->m_vsb_rf_agc_cfg.min_output_level = ul_vsb_rf_agc_min_level; 617 state->m_vsb_rf_agc_cfg.max_output_level = ul_vsb_rf_agc_max_level; 618 state->m_vsb_rf_agc_cfg.speed = ul_vsb_rf_agc_speed; 619 state->m_vsb_rf_agc_cfg.top = ul_vsb_rf_agc_top; 620 state->m_vsb_rf_agc_cfg.cut_off_current = ul_vsb_rf_agc_cut_off_current; 621 state->m_vsb_pre_saw_cfg.reference = 0x07; 622 state->m_vsb_pre_saw_cfg.use_pre_saw = true; 623 624 state->m_Quality83percent = DEFAULT_MER_83; 625 state->m_Quality93percent = DEFAULT_MER_93; 626 if (ulQual93 <= 500 && ulQual83 < ulQual93) { 627 state->m_Quality83percent = ulQual83; 628 state->m_Quality93percent = ulQual93; 629 } 630 631 /* ATV IF */ 632 state->m_atv_if_agc_cfg.ctrl_mode = ul_atv_if_agc_mode; 633 state->m_atv_if_agc_cfg.output_level = ul_atv_if_agc_output_level; 634 state->m_atv_if_agc_cfg.min_output_level = ul_atv_if_agc_min_level; 635 state->m_atv_if_agc_cfg.max_output_level = ul_atv_if_agc_max_level; 636 state->m_atv_if_agc_cfg.speed = ul_atv_if_agc_speed; 637 638 /* ATV RF */ 639 state->m_atv_rf_agc_cfg.ctrl_mode = ul_atv_rf_agc_mode; 640 state->m_atv_rf_agc_cfg.output_level = ul_atv_rf_agc_output_level; 641 state->m_atv_rf_agc_cfg.min_output_level = ul_atv_rf_agc_min_level; 642 state->m_atv_rf_agc_cfg.max_output_level = ul_atv_rf_agc_max_level; 643 state->m_atv_rf_agc_cfg.speed = ul_atv_rf_agc_speed; 644 state->m_atv_rf_agc_cfg.top = ul_atv_rf_agc_top; 645 state->m_atv_rf_agc_cfg.cut_off_current = ul_atv_rf_agc_cut_off_current; 646 state->m_atv_pre_saw_cfg.reference = 0x04; 647 state->m_atv_pre_saw_cfg.use_pre_saw = true; 648 649 650 /* DVBT RF */ 651 state->m_dvbt_rf_agc_cfg.ctrl_mode = DRXK_AGC_CTRL_OFF; 652 state->m_dvbt_rf_agc_cfg.output_level = 0; 653 state->m_dvbt_rf_agc_cfg.min_output_level = 0; 654 state->m_dvbt_rf_agc_cfg.max_output_level = 0xFFFF; 655 state->m_dvbt_rf_agc_cfg.top = 0x2100; 656 state->m_dvbt_rf_agc_cfg.cut_off_current = 4000; 657 state->m_dvbt_rf_agc_cfg.speed = 1; 658 659 660 /* DVBT IF */ 661 state->m_dvbt_if_agc_cfg.ctrl_mode = DRXK_AGC_CTRL_AUTO; 662 state->m_dvbt_if_agc_cfg.output_level = 0; 663 state->m_dvbt_if_agc_cfg.min_output_level = 0; 664 state->m_dvbt_if_agc_cfg.max_output_level = 9000; 665 state->m_dvbt_if_agc_cfg.top = 13424; 666 state->m_dvbt_if_agc_cfg.cut_off_current = 0; 667 state->m_dvbt_if_agc_cfg.speed = 3; 668 state->m_dvbt_if_agc_cfg.fast_clip_ctrl_delay = 30; 669 state->m_dvbt_if_agc_cfg.ingain_tgt_max = 30000; 670 /* state->m_dvbtPgaCfg = 140; */ 671 672 state->m_dvbt_pre_saw_cfg.reference = 4; 673 state->m_dvbt_pre_saw_cfg.use_pre_saw = false; 674 675 /* QAM RF */ 676 state->m_qam_rf_agc_cfg.ctrl_mode = DRXK_AGC_CTRL_OFF; 677 state->m_qam_rf_agc_cfg.output_level = 0; 678 state->m_qam_rf_agc_cfg.min_output_level = 6023; 679 state->m_qam_rf_agc_cfg.max_output_level = 27000; 680 state->m_qam_rf_agc_cfg.top = 0x2380; 681 state->m_qam_rf_agc_cfg.cut_off_current = 4000; 682 state->m_qam_rf_agc_cfg.speed = 3; 683 684 /* QAM IF */ 685 state->m_qam_if_agc_cfg.ctrl_mode = DRXK_AGC_CTRL_AUTO; 686 state->m_qam_if_agc_cfg.output_level = 0; 687 state->m_qam_if_agc_cfg.min_output_level = 0; 688 state->m_qam_if_agc_cfg.max_output_level = 9000; 689 state->m_qam_if_agc_cfg.top = 0x0511; 690 state->m_qam_if_agc_cfg.cut_off_current = 0; 691 state->m_qam_if_agc_cfg.speed = 3; 692 state->m_qam_if_agc_cfg.ingain_tgt_max = 5119; 693 state->m_qam_if_agc_cfg.fast_clip_ctrl_delay = 50; 694 695 state->m_qam_pga_cfg = 140; 696 state->m_qam_pre_saw_cfg.reference = 4; 697 state->m_qam_pre_saw_cfg.use_pre_saw = false; 698 699 state->m_operation_mode = OM_NONE; 700 state->m_drxk_state = DRXK_UNINITIALIZED; 701 702 /* MPEG output configuration */ 703 state->m_enable_mpeg_output = true; /* If TRUE; enable MPEG output */ 704 state->m_insert_rs_byte = false; /* If TRUE; insert RS byte */ 705 state->m_invert_data = false; /* If TRUE; invert DATA signals */ 706 state->m_invert_err = false; /* If TRUE; invert ERR signal */ 707 state->m_invert_str = false; /* If TRUE; invert STR signals */ 708 state->m_invert_val = false; /* If TRUE; invert VAL signals */ 709 state->m_invert_clk = (ul_invert_ts_clock != 0); /* If TRUE; invert CLK signals */ 710 711 /* If TRUE; static MPEG clockrate will be used; 712 otherwise clockrate will adapt to the bitrate of the TS */ 713 714 state->m_dvbt_bitrate = ul_dvbt_bitrate; 715 state->m_dvbc_bitrate = ul_dvbc_bitrate; 716 717 state->m_ts_data_strength = (ul_ts_data_strength & 0x07); 718 719 /* Maximum bitrate in b/s in case static clockrate is selected */ 720 state->m_mpeg_ts_static_bitrate = 19392658; 721 state->m_disable_te_ihandling = false; 722 723 if (ul_insert_rs_byte) 724 state->m_insert_rs_byte = true; 725 726 state->m_mpeg_lock_time_out = DEFAULT_DRXK_MPEG_LOCK_TIMEOUT; 727 if (ul_mpeg_lock_time_out < 10000) 728 state->m_mpeg_lock_time_out = ul_mpeg_lock_time_out; 729 state->m_demod_lock_time_out = DEFAULT_DRXK_DEMOD_LOCK_TIMEOUT; 730 if (ul_demod_lock_time_out < 10000) 731 state->m_demod_lock_time_out = ul_demod_lock_time_out; 732 733 /* QAM defaults */ 734 state->m_constellation = DRX_CONSTELLATION_AUTO; 735 state->m_qam_interleave_mode = DRXK_QAM_I12_J17; 736 state->m_fec_rs_plen = 204 * 8; /* fecRsPlen annex A */ 737 state->m_fec_rs_prescale = 1; 738 739 state->m_sqi_speed = DRXK_DVBT_SQI_SPEED_MEDIUM; 740 state->m_agcfast_clip_ctrl_delay = 0; 741 742 state->m_gpio_cfg = ul_gpio_cfg; 743 744 state->m_b_power_down = false; 745 state->m_current_power_mode = DRX_POWER_DOWN; 746 747 state->m_rfmirror = (ul_rf_mirror == 0); 748 state->m_if_agc_pol = false; 749 return 0; 750 } 751 752 static int drxx_open(struct drxk_state *state) 753 { 754 int status = 0; 755 u32 jtag = 0; 756 u16 bid = 0; 757 u16 key = 0; 758 759 dprintk(1, "\n"); 760 /* stop lock indicator process */ 761 status = write16(state, SCU_RAM_GPIO__A, 762 SCU_RAM_GPIO_HW_LOCK_IND_DISABLE); 763 if (status < 0) 764 goto error; 765 /* Check device id */ 766 status = read16(state, SIO_TOP_COMM_KEY__A, &key); 767 if (status < 0) 768 goto error; 769 status = write16(state, SIO_TOP_COMM_KEY__A, SIO_TOP_COMM_KEY_KEY); 770 if (status < 0) 771 goto error; 772 status = read32(state, SIO_TOP_JTAGID_LO__A, &jtag); 773 if (status < 0) 774 goto error; 775 status = read16(state, SIO_PDR_UIO_IN_HI__A, &bid); 776 if (status < 0) 777 goto error; 778 status = write16(state, SIO_TOP_COMM_KEY__A, key); 779 error: 780 if (status < 0) 781 pr_err("Error %d on %s\n", status, __func__); 782 return status; 783 } 784 785 static int get_device_capabilities(struct drxk_state *state) 786 { 787 u16 sio_pdr_ohw_cfg = 0; 788 u32 sio_top_jtagid_lo = 0; 789 int status; 790 const char *spin = ""; 791 792 dprintk(1, "\n"); 793 794 /* driver 0.9.0 */ 795 /* stop lock indicator process */ 796 status = write16(state, SCU_RAM_GPIO__A, 797 SCU_RAM_GPIO_HW_LOCK_IND_DISABLE); 798 if (status < 0) 799 goto error; 800 status = write16(state, SIO_TOP_COMM_KEY__A, SIO_TOP_COMM_KEY_KEY); 801 if (status < 0) 802 goto error; 803 status = read16(state, SIO_PDR_OHW_CFG__A, &sio_pdr_ohw_cfg); 804 if (status < 0) 805 goto error; 806 status = write16(state, SIO_TOP_COMM_KEY__A, 0x0000); 807 if (status < 0) 808 goto error; 809 810 switch ((sio_pdr_ohw_cfg & SIO_PDR_OHW_CFG_FREF_SEL__M)) { 811 case 0: 812 /* ignore (bypass ?) */ 813 break; 814 case 1: 815 /* 27 MHz */ 816 state->m_osc_clock_freq = 27000; 817 break; 818 case 2: 819 /* 20.25 MHz */ 820 state->m_osc_clock_freq = 20250; 821 break; 822 case 3: 823 /* 4 MHz */ 824 state->m_osc_clock_freq = 20250; 825 break; 826 default: 827 pr_err("Clock Frequency is unknown\n"); 828 return -EINVAL; 829 } 830 /* 831 Determine device capabilities 832 Based on pinning v14 833 */ 834 status = read32(state, SIO_TOP_JTAGID_LO__A, &sio_top_jtagid_lo); 835 if (status < 0) 836 goto error; 837 838 pr_info("status = 0x%08x\n", sio_top_jtagid_lo); 839 840 /* driver 0.9.0 */ 841 switch ((sio_top_jtagid_lo >> 29) & 0xF) { 842 case 0: 843 state->m_device_spin = DRXK_SPIN_A1; 844 spin = "A1"; 845 break; 846 case 2: 847 state->m_device_spin = DRXK_SPIN_A2; 848 spin = "A2"; 849 break; 850 case 3: 851 state->m_device_spin = DRXK_SPIN_A3; 852 spin = "A3"; 853 break; 854 default: 855 state->m_device_spin = DRXK_SPIN_UNKNOWN; 856 status = -EINVAL; 857 pr_err("Spin %d unknown\n", (sio_top_jtagid_lo >> 29) & 0xF); 858 goto error2; 859 } 860 switch ((sio_top_jtagid_lo >> 12) & 0xFF) { 861 case 0x13: 862 /* typeId = DRX3913K_TYPE_ID */ 863 state->m_has_lna = false; 864 state->m_has_oob = false; 865 state->m_has_atv = false; 866 state->m_has_audio = false; 867 state->m_has_dvbt = true; 868 state->m_has_dvbc = true; 869 state->m_has_sawsw = true; 870 state->m_has_gpio2 = false; 871 state->m_has_gpio1 = false; 872 state->m_has_irqn = false; 873 break; 874 case 0x15: 875 /* typeId = DRX3915K_TYPE_ID */ 876 state->m_has_lna = false; 877 state->m_has_oob = false; 878 state->m_has_atv = true; 879 state->m_has_audio = false; 880 state->m_has_dvbt = true; 881 state->m_has_dvbc = false; 882 state->m_has_sawsw = true; 883 state->m_has_gpio2 = true; 884 state->m_has_gpio1 = true; 885 state->m_has_irqn = false; 886 break; 887 case 0x16: 888 /* typeId = DRX3916K_TYPE_ID */ 889 state->m_has_lna = false; 890 state->m_has_oob = false; 891 state->m_has_atv = true; 892 state->m_has_audio = false; 893 state->m_has_dvbt = true; 894 state->m_has_dvbc = false; 895 state->m_has_sawsw = true; 896 state->m_has_gpio2 = true; 897 state->m_has_gpio1 = true; 898 state->m_has_irqn = false; 899 break; 900 case 0x18: 901 /* typeId = DRX3918K_TYPE_ID */ 902 state->m_has_lna = false; 903 state->m_has_oob = false; 904 state->m_has_atv = true; 905 state->m_has_audio = true; 906 state->m_has_dvbt = true; 907 state->m_has_dvbc = false; 908 state->m_has_sawsw = true; 909 state->m_has_gpio2 = true; 910 state->m_has_gpio1 = true; 911 state->m_has_irqn = false; 912 break; 913 case 0x21: 914 /* typeId = DRX3921K_TYPE_ID */ 915 state->m_has_lna = false; 916 state->m_has_oob = false; 917 state->m_has_atv = true; 918 state->m_has_audio = true; 919 state->m_has_dvbt = true; 920 state->m_has_dvbc = true; 921 state->m_has_sawsw = true; 922 state->m_has_gpio2 = true; 923 state->m_has_gpio1 = true; 924 state->m_has_irqn = false; 925 break; 926 case 0x23: 927 /* typeId = DRX3923K_TYPE_ID */ 928 state->m_has_lna = false; 929 state->m_has_oob = false; 930 state->m_has_atv = true; 931 state->m_has_audio = true; 932 state->m_has_dvbt = true; 933 state->m_has_dvbc = true; 934 state->m_has_sawsw = true; 935 state->m_has_gpio2 = true; 936 state->m_has_gpio1 = true; 937 state->m_has_irqn = false; 938 break; 939 case 0x25: 940 /* typeId = DRX3925K_TYPE_ID */ 941 state->m_has_lna = false; 942 state->m_has_oob = false; 943 state->m_has_atv = true; 944 state->m_has_audio = true; 945 state->m_has_dvbt = true; 946 state->m_has_dvbc = true; 947 state->m_has_sawsw = true; 948 state->m_has_gpio2 = true; 949 state->m_has_gpio1 = true; 950 state->m_has_irqn = false; 951 break; 952 case 0x26: 953 /* typeId = DRX3926K_TYPE_ID */ 954 state->m_has_lna = false; 955 state->m_has_oob = false; 956 state->m_has_atv = true; 957 state->m_has_audio = false; 958 state->m_has_dvbt = true; 959 state->m_has_dvbc = true; 960 state->m_has_sawsw = true; 961 state->m_has_gpio2 = true; 962 state->m_has_gpio1 = true; 963 state->m_has_irqn = false; 964 break; 965 default: 966 pr_err("DeviceID 0x%02x not supported\n", 967 ((sio_top_jtagid_lo >> 12) & 0xFF)); 968 status = -EINVAL; 969 goto error2; 970 } 971 972 pr_info("detected a drx-39%02xk, spin %s, xtal %d.%03d MHz\n", 973 ((sio_top_jtagid_lo >> 12) & 0xFF), spin, 974 state->m_osc_clock_freq / 1000, 975 state->m_osc_clock_freq % 1000); 976 977 error: 978 if (status < 0) 979 pr_err("Error %d on %s\n", status, __func__); 980 981 error2: 982 return status; 983 } 984 985 static int hi_command(struct drxk_state *state, u16 cmd, u16 *p_result) 986 { 987 int status; 988 bool powerdown_cmd; 989 990 dprintk(1, "\n"); 991 992 /* Write command */ 993 status = write16(state, SIO_HI_RA_RAM_CMD__A, cmd); 994 if (status < 0) 995 goto error; 996 if (cmd == SIO_HI_RA_RAM_CMD_RESET) 997 usleep_range(1000, 2000); 998 999 powerdown_cmd = 1000 (bool) ((cmd == SIO_HI_RA_RAM_CMD_CONFIG) && 1001 ((state->m_hi_cfg_ctrl) & 1002 SIO_HI_RA_RAM_PAR_5_CFG_SLEEP__M) == 1003 SIO_HI_RA_RAM_PAR_5_CFG_SLEEP_ZZZ); 1004 if (!powerdown_cmd) { 1005 /* Wait until command rdy */ 1006 u32 retry_count = 0; 1007 u16 wait_cmd; 1008 1009 do { 1010 usleep_range(1000, 2000); 1011 retry_count += 1; 1012 status = read16(state, SIO_HI_RA_RAM_CMD__A, 1013 &wait_cmd); 1014 } while ((status < 0 || wait_cmd) && (retry_count < DRXK_MAX_RETRIES)); 1015 if (status < 0) 1016 goto error; 1017 status = read16(state, SIO_HI_RA_RAM_RES__A, p_result); 1018 } 1019 error: 1020 if (status < 0) 1021 pr_err("Error %d on %s\n", status, __func__); 1022 1023 return status; 1024 } 1025 1026 static int hi_cfg_command(struct drxk_state *state) 1027 { 1028 int status; 1029 1030 dprintk(1, "\n"); 1031 1032 mutex_lock(&state->mutex); 1033 1034 status = write16(state, SIO_HI_RA_RAM_PAR_6__A, 1035 state->m_hi_cfg_timeout); 1036 if (status < 0) 1037 goto error; 1038 status = write16(state, SIO_HI_RA_RAM_PAR_5__A, 1039 state->m_hi_cfg_ctrl); 1040 if (status < 0) 1041 goto error; 1042 status = write16(state, SIO_HI_RA_RAM_PAR_4__A, 1043 state->m_hi_cfg_wake_up_key); 1044 if (status < 0) 1045 goto error; 1046 status = write16(state, SIO_HI_RA_RAM_PAR_3__A, 1047 state->m_hi_cfg_bridge_delay); 1048 if (status < 0) 1049 goto error; 1050 status = write16(state, SIO_HI_RA_RAM_PAR_2__A, 1051 state->m_hi_cfg_timing_div); 1052 if (status < 0) 1053 goto error; 1054 status = write16(state, SIO_HI_RA_RAM_PAR_1__A, 1055 SIO_HI_RA_RAM_PAR_1_PAR1_SEC_KEY); 1056 if (status < 0) 1057 goto error; 1058 status = hi_command(state, SIO_HI_RA_RAM_CMD_CONFIG, NULL); 1059 if (status < 0) 1060 goto error; 1061 1062 state->m_hi_cfg_ctrl &= ~SIO_HI_RA_RAM_PAR_5_CFG_SLEEP_ZZZ; 1063 error: 1064 mutex_unlock(&state->mutex); 1065 if (status < 0) 1066 pr_err("Error %d on %s\n", status, __func__); 1067 return status; 1068 } 1069 1070 static int init_hi(struct drxk_state *state) 1071 { 1072 dprintk(1, "\n"); 1073 1074 state->m_hi_cfg_wake_up_key = (state->demod_address << 1); 1075 state->m_hi_cfg_timeout = 0x96FF; 1076 /* port/bridge/power down ctrl */ 1077 state->m_hi_cfg_ctrl = SIO_HI_RA_RAM_PAR_5_CFG_SLV0_SLAVE; 1078 1079 return hi_cfg_command(state); 1080 } 1081 1082 static int mpegts_configure_pins(struct drxk_state *state, bool mpeg_enable) 1083 { 1084 int status; 1085 u16 sio_pdr_mclk_cfg = 0; 1086 u16 sio_pdr_mdx_cfg = 0; 1087 u16 err_cfg = 0; 1088 1089 dprintk(1, ": mpeg %s, %s mode\n", 1090 mpeg_enable ? "enable" : "disable", 1091 state->m_enable_parallel ? "parallel" : "serial"); 1092 1093 /* stop lock indicator process */ 1094 status = write16(state, SCU_RAM_GPIO__A, 1095 SCU_RAM_GPIO_HW_LOCK_IND_DISABLE); 1096 if (status < 0) 1097 goto error; 1098 1099 /* MPEG TS pad configuration */ 1100 status = write16(state, SIO_TOP_COMM_KEY__A, SIO_TOP_COMM_KEY_KEY); 1101 if (status < 0) 1102 goto error; 1103 1104 if (!mpeg_enable) { 1105 /* Set MPEG TS pads to inputmode */ 1106 status = write16(state, SIO_PDR_MSTRT_CFG__A, 0x0000); 1107 if (status < 0) 1108 goto error; 1109 status = write16(state, SIO_PDR_MERR_CFG__A, 0x0000); 1110 if (status < 0) 1111 goto error; 1112 status = write16(state, SIO_PDR_MCLK_CFG__A, 0x0000); 1113 if (status < 0) 1114 goto error; 1115 status = write16(state, SIO_PDR_MVAL_CFG__A, 0x0000); 1116 if (status < 0) 1117 goto error; 1118 status = write16(state, SIO_PDR_MD0_CFG__A, 0x0000); 1119 if (status < 0) 1120 goto error; 1121 status = write16(state, SIO_PDR_MD1_CFG__A, 0x0000); 1122 if (status < 0) 1123 goto error; 1124 status = write16(state, SIO_PDR_MD2_CFG__A, 0x0000); 1125 if (status < 0) 1126 goto error; 1127 status = write16(state, SIO_PDR_MD3_CFG__A, 0x0000); 1128 if (status < 0) 1129 goto error; 1130 status = write16(state, SIO_PDR_MD4_CFG__A, 0x0000); 1131 if (status < 0) 1132 goto error; 1133 status = write16(state, SIO_PDR_MD5_CFG__A, 0x0000); 1134 if (status < 0) 1135 goto error; 1136 status = write16(state, SIO_PDR_MD6_CFG__A, 0x0000); 1137 if (status < 0) 1138 goto error; 1139 status = write16(state, SIO_PDR_MD7_CFG__A, 0x0000); 1140 if (status < 0) 1141 goto error; 1142 } else { 1143 /* Enable MPEG output */ 1144 sio_pdr_mdx_cfg = 1145 ((state->m_ts_data_strength << 1146 SIO_PDR_MD0_CFG_DRIVE__B) | 0x0003); 1147 sio_pdr_mclk_cfg = ((state->m_ts_clockk_strength << 1148 SIO_PDR_MCLK_CFG_DRIVE__B) | 1149 0x0003); 1150 1151 status = write16(state, SIO_PDR_MSTRT_CFG__A, sio_pdr_mdx_cfg); 1152 if (status < 0) 1153 goto error; 1154 1155 if (state->enable_merr_cfg) 1156 err_cfg = sio_pdr_mdx_cfg; 1157 1158 status = write16(state, SIO_PDR_MERR_CFG__A, err_cfg); 1159 if (status < 0) 1160 goto error; 1161 status = write16(state, SIO_PDR_MVAL_CFG__A, err_cfg); 1162 if (status < 0) 1163 goto error; 1164 1165 if (state->m_enable_parallel) { 1166 /* parallel -> enable MD1 to MD7 */ 1167 status = write16(state, SIO_PDR_MD1_CFG__A, 1168 sio_pdr_mdx_cfg); 1169 if (status < 0) 1170 goto error; 1171 status = write16(state, SIO_PDR_MD2_CFG__A, 1172 sio_pdr_mdx_cfg); 1173 if (status < 0) 1174 goto error; 1175 status = write16(state, SIO_PDR_MD3_CFG__A, 1176 sio_pdr_mdx_cfg); 1177 if (status < 0) 1178 goto error; 1179 status = write16(state, SIO_PDR_MD4_CFG__A, 1180 sio_pdr_mdx_cfg); 1181 if (status < 0) 1182 goto error; 1183 status = write16(state, SIO_PDR_MD5_CFG__A, 1184 sio_pdr_mdx_cfg); 1185 if (status < 0) 1186 goto error; 1187 status = write16(state, SIO_PDR_MD6_CFG__A, 1188 sio_pdr_mdx_cfg); 1189 if (status < 0) 1190 goto error; 1191 status = write16(state, SIO_PDR_MD7_CFG__A, 1192 sio_pdr_mdx_cfg); 1193 if (status < 0) 1194 goto error; 1195 } else { 1196 sio_pdr_mdx_cfg = ((state->m_ts_data_strength << 1197 SIO_PDR_MD0_CFG_DRIVE__B) 1198 | 0x0003); 1199 /* serial -> disable MD1 to MD7 */ 1200 status = write16(state, SIO_PDR_MD1_CFG__A, 0x0000); 1201 if (status < 0) 1202 goto error; 1203 status = write16(state, SIO_PDR_MD2_CFG__A, 0x0000); 1204 if (status < 0) 1205 goto error; 1206 status = write16(state, SIO_PDR_MD3_CFG__A, 0x0000); 1207 if (status < 0) 1208 goto error; 1209 status = write16(state, SIO_PDR_MD4_CFG__A, 0x0000); 1210 if (status < 0) 1211 goto error; 1212 status = write16(state, SIO_PDR_MD5_CFG__A, 0x0000); 1213 if (status < 0) 1214 goto error; 1215 status = write16(state, SIO_PDR_MD6_CFG__A, 0x0000); 1216 if (status < 0) 1217 goto error; 1218 status = write16(state, SIO_PDR_MD7_CFG__A, 0x0000); 1219 if (status < 0) 1220 goto error; 1221 } 1222 status = write16(state, SIO_PDR_MCLK_CFG__A, sio_pdr_mclk_cfg); 1223 if (status < 0) 1224 goto error; 1225 status = write16(state, SIO_PDR_MD0_CFG__A, sio_pdr_mdx_cfg); 1226 if (status < 0) 1227 goto error; 1228 } 1229 /* Enable MB output over MPEG pads and ctl input */ 1230 status = write16(state, SIO_PDR_MON_CFG__A, 0x0000); 1231 if (status < 0) 1232 goto error; 1233 /* Write nomagic word to enable pdr reg write */ 1234 status = write16(state, SIO_TOP_COMM_KEY__A, 0x0000); 1235 error: 1236 if (status < 0) 1237 pr_err("Error %d on %s\n", status, __func__); 1238 return status; 1239 } 1240 1241 static int mpegts_disable(struct drxk_state *state) 1242 { 1243 dprintk(1, "\n"); 1244 1245 return mpegts_configure_pins(state, false); 1246 } 1247 1248 static int bl_chain_cmd(struct drxk_state *state, 1249 u16 rom_offset, u16 nr_of_elements, u32 time_out) 1250 { 1251 u16 bl_status = 0; 1252 int status; 1253 unsigned long end; 1254 1255 dprintk(1, "\n"); 1256 mutex_lock(&state->mutex); 1257 status = write16(state, SIO_BL_MODE__A, SIO_BL_MODE_CHAIN); 1258 if (status < 0) 1259 goto error; 1260 status = write16(state, SIO_BL_CHAIN_ADDR__A, rom_offset); 1261 if (status < 0) 1262 goto error; 1263 status = write16(state, SIO_BL_CHAIN_LEN__A, nr_of_elements); 1264 if (status < 0) 1265 goto error; 1266 status = write16(state, SIO_BL_ENABLE__A, SIO_BL_ENABLE_ON); 1267 if (status < 0) 1268 goto error; 1269 1270 end = jiffies + msecs_to_jiffies(time_out); 1271 do { 1272 usleep_range(1000, 2000); 1273 status = read16(state, SIO_BL_STATUS__A, &bl_status); 1274 if (status < 0) 1275 goto error; 1276 } while ((bl_status == 0x1) && 1277 ((time_is_after_jiffies(end)))); 1278 1279 if (bl_status == 0x1) { 1280 pr_err("SIO not ready\n"); 1281 status = -EINVAL; 1282 goto error2; 1283 } 1284 error: 1285 if (status < 0) 1286 pr_err("Error %d on %s\n", status, __func__); 1287 error2: 1288 mutex_unlock(&state->mutex); 1289 return status; 1290 } 1291 1292 1293 static int download_microcode(struct drxk_state *state, 1294 const u8 p_mc_image[], u32 length) 1295 { 1296 const u8 *p_src = p_mc_image; 1297 u32 address; 1298 u16 n_blocks; 1299 u16 block_size; 1300 u32 offset = 0; 1301 u32 i; 1302 int status = 0; 1303 1304 dprintk(1, "\n"); 1305 1306 /* down the drain (we don't care about MAGIC_WORD) */ 1307 #if 0 1308 /* For future reference */ 1309 drain = (p_src[0] << 8) | p_src[1]; 1310 #endif 1311 p_src += sizeof(u16); 1312 offset += sizeof(u16); 1313 n_blocks = (p_src[0] << 8) | p_src[1]; 1314 p_src += sizeof(u16); 1315 offset += sizeof(u16); 1316 1317 for (i = 0; i < n_blocks; i += 1) { 1318 address = (p_src[0] << 24) | (p_src[1] << 16) | 1319 (p_src[2] << 8) | p_src[3]; 1320 p_src += sizeof(u32); 1321 offset += sizeof(u32); 1322 1323 block_size = ((p_src[0] << 8) | p_src[1]) * sizeof(u16); 1324 p_src += sizeof(u16); 1325 offset += sizeof(u16); 1326 1327 #if 0 1328 /* For future reference */ 1329 flags = (p_src[0] << 8) | p_src[1]; 1330 #endif 1331 p_src += sizeof(u16); 1332 offset += sizeof(u16); 1333 1334 #if 0 1335 /* For future reference */ 1336 block_crc = (p_src[0] << 8) | p_src[1]; 1337 #endif 1338 p_src += sizeof(u16); 1339 offset += sizeof(u16); 1340 1341 if (offset + block_size > length) { 1342 pr_err("Firmware is corrupted.\n"); 1343 return -EINVAL; 1344 } 1345 1346 status = write_block(state, address, block_size, p_src); 1347 if (status < 0) { 1348 pr_err("Error %d while loading firmware\n", status); 1349 break; 1350 } 1351 p_src += block_size; 1352 offset += block_size; 1353 } 1354 return status; 1355 } 1356 1357 static int dvbt_enable_ofdm_token_ring(struct drxk_state *state, bool enable) 1358 { 1359 int status; 1360 u16 data = 0; 1361 u16 desired_ctrl = SIO_OFDM_SH_OFDM_RING_ENABLE_ON; 1362 u16 desired_status = SIO_OFDM_SH_OFDM_RING_STATUS_ENABLED; 1363 unsigned long end; 1364 1365 dprintk(1, "\n"); 1366 1367 if (!enable) { 1368 desired_ctrl = SIO_OFDM_SH_OFDM_RING_ENABLE_OFF; 1369 desired_status = SIO_OFDM_SH_OFDM_RING_STATUS_DOWN; 1370 } 1371 1372 status = read16(state, SIO_OFDM_SH_OFDM_RING_STATUS__A, &data); 1373 if (status >= 0 && data == desired_status) { 1374 /* tokenring already has correct status */ 1375 return status; 1376 } 1377 /* Disable/enable dvbt tokenring bridge */ 1378 status = write16(state, SIO_OFDM_SH_OFDM_RING_ENABLE__A, desired_ctrl); 1379 1380 end = jiffies + msecs_to_jiffies(DRXK_OFDM_TR_SHUTDOWN_TIMEOUT); 1381 do { 1382 status = read16(state, SIO_OFDM_SH_OFDM_RING_STATUS__A, &data); 1383 if ((status >= 0 && data == desired_status) 1384 || time_is_after_jiffies(end)) 1385 break; 1386 usleep_range(1000, 2000); 1387 } while (1); 1388 if (data != desired_status) { 1389 pr_err("SIO not ready\n"); 1390 return -EINVAL; 1391 } 1392 return status; 1393 } 1394 1395 static int mpegts_stop(struct drxk_state *state) 1396 { 1397 int status = 0; 1398 u16 fec_oc_snc_mode = 0; 1399 u16 fec_oc_ipr_mode = 0; 1400 1401 dprintk(1, "\n"); 1402 1403 /* Graceful shutdown (byte boundaries) */ 1404 status = read16(state, FEC_OC_SNC_MODE__A, &fec_oc_snc_mode); 1405 if (status < 0) 1406 goto error; 1407 fec_oc_snc_mode |= FEC_OC_SNC_MODE_SHUTDOWN__M; 1408 status = write16(state, FEC_OC_SNC_MODE__A, fec_oc_snc_mode); 1409 if (status < 0) 1410 goto error; 1411 1412 /* Suppress MCLK during absence of data */ 1413 status = read16(state, FEC_OC_IPR_MODE__A, &fec_oc_ipr_mode); 1414 if (status < 0) 1415 goto error; 1416 fec_oc_ipr_mode |= FEC_OC_IPR_MODE_MCLK_DIS_DAT_ABS__M; 1417 status = write16(state, FEC_OC_IPR_MODE__A, fec_oc_ipr_mode); 1418 1419 error: 1420 if (status < 0) 1421 pr_err("Error %d on %s\n", status, __func__); 1422 1423 return status; 1424 } 1425 1426 static int scu_command(struct drxk_state *state, 1427 u16 cmd, u8 parameter_len, 1428 u16 *parameter, u8 result_len, u16 *result) 1429 { 1430 #if (SCU_RAM_PARAM_0__A - SCU_RAM_PARAM_15__A) != 15 1431 #error DRXK register mapping no longer compatible with this routine! 1432 #endif 1433 u16 cur_cmd = 0; 1434 int status = -EINVAL; 1435 unsigned long end; 1436 u8 buffer[34]; 1437 int cnt = 0, ii; 1438 const char *p; 1439 char errname[30]; 1440 1441 dprintk(1, "\n"); 1442 1443 if ((cmd == 0) || ((parameter_len > 0) && (parameter == NULL)) || 1444 ((result_len > 0) && (result == NULL))) { 1445 pr_err("Error %d on %s\n", status, __func__); 1446 return status; 1447 } 1448 1449 mutex_lock(&state->mutex); 1450 1451 /* assume that the command register is ready 1452 since it is checked afterwards */ 1453 if (parameter) { 1454 for (ii = parameter_len - 1; ii >= 0; ii -= 1) { 1455 buffer[cnt++] = (parameter[ii] & 0xFF); 1456 buffer[cnt++] = ((parameter[ii] >> 8) & 0xFF); 1457 } 1458 } 1459 buffer[cnt++] = (cmd & 0xFF); 1460 buffer[cnt++] = ((cmd >> 8) & 0xFF); 1461 1462 write_block(state, SCU_RAM_PARAM_0__A - 1463 (parameter_len - 1), cnt, buffer); 1464 /* Wait until SCU has processed command */ 1465 end = jiffies + msecs_to_jiffies(DRXK_MAX_WAITTIME); 1466 do { 1467 usleep_range(1000, 2000); 1468 status = read16(state, SCU_RAM_COMMAND__A, &cur_cmd); 1469 if (status < 0) 1470 goto error; 1471 } while (!(cur_cmd == DRX_SCU_READY) && (time_is_after_jiffies(end))); 1472 if (cur_cmd != DRX_SCU_READY) { 1473 pr_err("SCU not ready\n"); 1474 status = -EIO; 1475 goto error2; 1476 } 1477 /* read results */ 1478 if ((result_len > 0) && (result != NULL)) { 1479 s16 err; 1480 int ii; 1481 1482 for (ii = result_len - 1; ii >= 0; ii -= 1) { 1483 status = read16(state, SCU_RAM_PARAM_0__A - ii, 1484 &result[ii]); 1485 if (status < 0) 1486 goto error; 1487 } 1488 1489 /* Check if an error was reported by SCU */ 1490 err = (s16)result[0]; 1491 if (err >= 0) 1492 goto error; 1493 1494 /* check for the known error codes */ 1495 switch (err) { 1496 case SCU_RESULT_UNKCMD: 1497 p = "SCU_RESULT_UNKCMD"; 1498 break; 1499 case SCU_RESULT_UNKSTD: 1500 p = "SCU_RESULT_UNKSTD"; 1501 break; 1502 case SCU_RESULT_SIZE: 1503 p = "SCU_RESULT_SIZE"; 1504 break; 1505 case SCU_RESULT_INVPAR: 1506 p = "SCU_RESULT_INVPAR"; 1507 break; 1508 default: /* Other negative values are errors */ 1509 sprintf(errname, "ERROR: %d\n", err); 1510 p = errname; 1511 } 1512 pr_err("%s while sending cmd 0x%04x with params:", p, cmd); 1513 print_hex_dump_bytes("drxk: ", DUMP_PREFIX_NONE, buffer, cnt); 1514 status = -EINVAL; 1515 goto error2; 1516 } 1517 1518 error: 1519 if (status < 0) 1520 pr_err("Error %d on %s\n", status, __func__); 1521 error2: 1522 mutex_unlock(&state->mutex); 1523 return status; 1524 } 1525 1526 static int set_iqm_af(struct drxk_state *state, bool active) 1527 { 1528 u16 data = 0; 1529 int status; 1530 1531 dprintk(1, "\n"); 1532 1533 /* Configure IQM */ 1534 status = read16(state, IQM_AF_STDBY__A, &data); 1535 if (status < 0) 1536 goto error; 1537 1538 if (!active) { 1539 data |= (IQM_AF_STDBY_STDBY_ADC_STANDBY 1540 | IQM_AF_STDBY_STDBY_AMP_STANDBY 1541 | IQM_AF_STDBY_STDBY_PD_STANDBY 1542 | IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY 1543 | IQM_AF_STDBY_STDBY_TAGC_RF_STANDBY); 1544 } else { 1545 data &= ((~IQM_AF_STDBY_STDBY_ADC_STANDBY) 1546 & (~IQM_AF_STDBY_STDBY_AMP_STANDBY) 1547 & (~IQM_AF_STDBY_STDBY_PD_STANDBY) 1548 & (~IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY) 1549 & (~IQM_AF_STDBY_STDBY_TAGC_RF_STANDBY) 1550 ); 1551 } 1552 status = write16(state, IQM_AF_STDBY__A, data); 1553 1554 error: 1555 if (status < 0) 1556 pr_err("Error %d on %s\n", status, __func__); 1557 return status; 1558 } 1559 1560 static int ctrl_power_mode(struct drxk_state *state, enum drx_power_mode *mode) 1561 { 1562 int status = 0; 1563 u16 sio_cc_pwd_mode = 0; 1564 1565 dprintk(1, "\n"); 1566 1567 /* Check arguments */ 1568 if (mode == NULL) 1569 return -EINVAL; 1570 1571 switch (*mode) { 1572 case DRX_POWER_UP: 1573 sio_cc_pwd_mode = SIO_CC_PWD_MODE_LEVEL_NONE; 1574 break; 1575 case DRXK_POWER_DOWN_OFDM: 1576 sio_cc_pwd_mode = SIO_CC_PWD_MODE_LEVEL_OFDM; 1577 break; 1578 case DRXK_POWER_DOWN_CORE: 1579 sio_cc_pwd_mode = SIO_CC_PWD_MODE_LEVEL_CLOCK; 1580 break; 1581 case DRXK_POWER_DOWN_PLL: 1582 sio_cc_pwd_mode = SIO_CC_PWD_MODE_LEVEL_PLL; 1583 break; 1584 case DRX_POWER_DOWN: 1585 sio_cc_pwd_mode = SIO_CC_PWD_MODE_LEVEL_OSC; 1586 break; 1587 default: 1588 /* Unknow sleep mode */ 1589 return -EINVAL; 1590 } 1591 1592 /* If already in requested power mode, do nothing */ 1593 if (state->m_current_power_mode == *mode) 1594 return 0; 1595 1596 /* For next steps make sure to start from DRX_POWER_UP mode */ 1597 if (state->m_current_power_mode != DRX_POWER_UP) { 1598 status = power_up_device(state); 1599 if (status < 0) 1600 goto error; 1601 status = dvbt_enable_ofdm_token_ring(state, true); 1602 if (status < 0) 1603 goto error; 1604 } 1605 1606 if (*mode == DRX_POWER_UP) { 1607 /* Restore analog & pin configuration */ 1608 } else { 1609 /* Power down to requested mode */ 1610 /* Backup some register settings */ 1611 /* Set pins with possible pull-ups connected 1612 to them in input mode */ 1613 /* Analog power down */ 1614 /* ADC power down */ 1615 /* Power down device */ 1616 /* stop all comm_exec */ 1617 /* Stop and power down previous standard */ 1618 switch (state->m_operation_mode) { 1619 case OM_DVBT: 1620 status = mpegts_stop(state); 1621 if (status < 0) 1622 goto error; 1623 status = power_down_dvbt(state, false); 1624 if (status < 0) 1625 goto error; 1626 break; 1627 case OM_QAM_ITU_A: 1628 case OM_QAM_ITU_C: 1629 status = mpegts_stop(state); 1630 if (status < 0) 1631 goto error; 1632 status = power_down_qam(state); 1633 if (status < 0) 1634 goto error; 1635 break; 1636 default: 1637 break; 1638 } 1639 status = dvbt_enable_ofdm_token_ring(state, false); 1640 if (status < 0) 1641 goto error; 1642 status = write16(state, SIO_CC_PWD_MODE__A, sio_cc_pwd_mode); 1643 if (status < 0) 1644 goto error; 1645 status = write16(state, SIO_CC_UPDATE__A, SIO_CC_UPDATE_KEY); 1646 if (status < 0) 1647 goto error; 1648 1649 if (*mode != DRXK_POWER_DOWN_OFDM) { 1650 state->m_hi_cfg_ctrl |= 1651 SIO_HI_RA_RAM_PAR_5_CFG_SLEEP_ZZZ; 1652 status = hi_cfg_command(state); 1653 if (status < 0) 1654 goto error; 1655 } 1656 } 1657 state->m_current_power_mode = *mode; 1658 1659 error: 1660 if (status < 0) 1661 pr_err("Error %d on %s\n", status, __func__); 1662 1663 return status; 1664 } 1665 1666 static int power_down_dvbt(struct drxk_state *state, bool set_power_mode) 1667 { 1668 enum drx_power_mode power_mode = DRXK_POWER_DOWN_OFDM; 1669 u16 cmd_result = 0; 1670 u16 data = 0; 1671 int status; 1672 1673 dprintk(1, "\n"); 1674 1675 status = read16(state, SCU_COMM_EXEC__A, &data); 1676 if (status < 0) 1677 goto error; 1678 if (data == SCU_COMM_EXEC_ACTIVE) { 1679 /* Send OFDM stop command */ 1680 status = scu_command(state, 1681 SCU_RAM_COMMAND_STANDARD_OFDM 1682 | SCU_RAM_COMMAND_CMD_DEMOD_STOP, 1683 0, NULL, 1, &cmd_result); 1684 if (status < 0) 1685 goto error; 1686 /* Send OFDM reset command */ 1687 status = scu_command(state, 1688 SCU_RAM_COMMAND_STANDARD_OFDM 1689 | SCU_RAM_COMMAND_CMD_DEMOD_RESET, 1690 0, NULL, 1, &cmd_result); 1691 if (status < 0) 1692 goto error; 1693 } 1694 1695 /* Reset datapath for OFDM, processors first */ 1696 status = write16(state, OFDM_SC_COMM_EXEC__A, OFDM_SC_COMM_EXEC_STOP); 1697 if (status < 0) 1698 goto error; 1699 status = write16(state, OFDM_LC_COMM_EXEC__A, OFDM_LC_COMM_EXEC_STOP); 1700 if (status < 0) 1701 goto error; 1702 status = write16(state, IQM_COMM_EXEC__A, IQM_COMM_EXEC_B_STOP); 1703 if (status < 0) 1704 goto error; 1705 1706 /* powerdown AFE */ 1707 status = set_iqm_af(state, false); 1708 if (status < 0) 1709 goto error; 1710 1711 /* powerdown to OFDM mode */ 1712 if (set_power_mode) { 1713 status = ctrl_power_mode(state, &power_mode); 1714 if (status < 0) 1715 goto error; 1716 } 1717 error: 1718 if (status < 0) 1719 pr_err("Error %d on %s\n", status, __func__); 1720 return status; 1721 } 1722 1723 static int setoperation_mode(struct drxk_state *state, 1724 enum operation_mode o_mode) 1725 { 1726 int status = 0; 1727 1728 dprintk(1, "\n"); 1729 /* 1730 Stop and power down previous standard 1731 TODO investigate total power down instead of partial 1732 power down depending on "previous" standard. 1733 */ 1734 1735 /* disable HW lock indicator */ 1736 status = write16(state, SCU_RAM_GPIO__A, 1737 SCU_RAM_GPIO_HW_LOCK_IND_DISABLE); 1738 if (status < 0) 1739 goto error; 1740 1741 /* Device is already at the required mode */ 1742 if (state->m_operation_mode == o_mode) 1743 return 0; 1744 1745 switch (state->m_operation_mode) { 1746 /* OM_NONE was added for start up */ 1747 case OM_NONE: 1748 break; 1749 case OM_DVBT: 1750 status = mpegts_stop(state); 1751 if (status < 0) 1752 goto error; 1753 status = power_down_dvbt(state, true); 1754 if (status < 0) 1755 goto error; 1756 state->m_operation_mode = OM_NONE; 1757 break; 1758 case OM_QAM_ITU_A: 1759 case OM_QAM_ITU_C: 1760 status = mpegts_stop(state); 1761 if (status < 0) 1762 goto error; 1763 status = power_down_qam(state); 1764 if (status < 0) 1765 goto error; 1766 state->m_operation_mode = OM_NONE; 1767 break; 1768 case OM_QAM_ITU_B: 1769 default: 1770 status = -EINVAL; 1771 goto error; 1772 } 1773 1774 /* 1775 Power up new standard 1776 */ 1777 switch (o_mode) { 1778 case OM_DVBT: 1779 dprintk(1, ": DVB-T\n"); 1780 state->m_operation_mode = o_mode; 1781 status = set_dvbt_standard(state, o_mode); 1782 if (status < 0) 1783 goto error; 1784 break; 1785 case OM_QAM_ITU_A: 1786 case OM_QAM_ITU_C: 1787 dprintk(1, ": DVB-C Annex %c\n", 1788 (state->m_operation_mode == OM_QAM_ITU_A) ? 'A' : 'C'); 1789 state->m_operation_mode = o_mode; 1790 status = set_qam_standard(state, o_mode); 1791 if (status < 0) 1792 goto error; 1793 break; 1794 case OM_QAM_ITU_B: 1795 default: 1796 status = -EINVAL; 1797 } 1798 error: 1799 if (status < 0) 1800 pr_err("Error %d on %s\n", status, __func__); 1801 return status; 1802 } 1803 1804 static int start(struct drxk_state *state, s32 offset_freq, 1805 s32 intermediate_frequency) 1806 { 1807 int status = -EINVAL; 1808 1809 u16 i_freqk_hz; 1810 s32 offsetk_hz = offset_freq / 1000; 1811 1812 dprintk(1, "\n"); 1813 if (state->m_drxk_state != DRXK_STOPPED && 1814 state->m_drxk_state != DRXK_DTV_STARTED) 1815 goto error; 1816 1817 state->m_b_mirror_freq_spect = (state->props.inversion == INVERSION_ON); 1818 1819 if (intermediate_frequency < 0) { 1820 state->m_b_mirror_freq_spect = !state->m_b_mirror_freq_spect; 1821 intermediate_frequency = -intermediate_frequency; 1822 } 1823 1824 switch (state->m_operation_mode) { 1825 case OM_QAM_ITU_A: 1826 case OM_QAM_ITU_C: 1827 i_freqk_hz = (intermediate_frequency / 1000); 1828 status = set_qam(state, i_freqk_hz, offsetk_hz); 1829 if (status < 0) 1830 goto error; 1831 state->m_drxk_state = DRXK_DTV_STARTED; 1832 break; 1833 case OM_DVBT: 1834 i_freqk_hz = (intermediate_frequency / 1000); 1835 status = mpegts_stop(state); 1836 if (status < 0) 1837 goto error; 1838 status = set_dvbt(state, i_freqk_hz, offsetk_hz); 1839 if (status < 0) 1840 goto error; 1841 status = dvbt_start(state); 1842 if (status < 0) 1843 goto error; 1844 state->m_drxk_state = DRXK_DTV_STARTED; 1845 break; 1846 default: 1847 break; 1848 } 1849 error: 1850 if (status < 0) 1851 pr_err("Error %d on %s\n", status, __func__); 1852 return status; 1853 } 1854 1855 static int shut_down(struct drxk_state *state) 1856 { 1857 dprintk(1, "\n"); 1858 1859 mpegts_stop(state); 1860 return 0; 1861 } 1862 1863 static int get_lock_status(struct drxk_state *state, u32 *p_lock_status) 1864 { 1865 int status = -EINVAL; 1866 1867 dprintk(1, "\n"); 1868 1869 if (p_lock_status == NULL) 1870 goto error; 1871 1872 *p_lock_status = NOT_LOCKED; 1873 1874 /* define the SCU command code */ 1875 switch (state->m_operation_mode) { 1876 case OM_QAM_ITU_A: 1877 case OM_QAM_ITU_B: 1878 case OM_QAM_ITU_C: 1879 status = get_qam_lock_status(state, p_lock_status); 1880 break; 1881 case OM_DVBT: 1882 status = get_dvbt_lock_status(state, p_lock_status); 1883 break; 1884 default: 1885 pr_debug("Unsupported operation mode %d in %s\n", 1886 state->m_operation_mode, __func__); 1887 return 0; 1888 } 1889 error: 1890 if (status < 0) 1891 pr_err("Error %d on %s\n", status, __func__); 1892 return status; 1893 } 1894 1895 static int mpegts_start(struct drxk_state *state) 1896 { 1897 int status; 1898 1899 u16 fec_oc_snc_mode = 0; 1900 1901 /* Allow OC to sync again */ 1902 status = read16(state, FEC_OC_SNC_MODE__A, &fec_oc_snc_mode); 1903 if (status < 0) 1904 goto error; 1905 fec_oc_snc_mode &= ~FEC_OC_SNC_MODE_SHUTDOWN__M; 1906 status = write16(state, FEC_OC_SNC_MODE__A, fec_oc_snc_mode); 1907 if (status < 0) 1908 goto error; 1909 status = write16(state, FEC_OC_SNC_UNLOCK__A, 1); 1910 error: 1911 if (status < 0) 1912 pr_err("Error %d on %s\n", status, __func__); 1913 return status; 1914 } 1915 1916 static int mpegts_dto_init(struct drxk_state *state) 1917 { 1918 int status; 1919 1920 dprintk(1, "\n"); 1921 1922 /* Rate integration settings */ 1923 status = write16(state, FEC_OC_RCN_CTL_STEP_LO__A, 0x0000); 1924 if (status < 0) 1925 goto error; 1926 status = write16(state, FEC_OC_RCN_CTL_STEP_HI__A, 0x000C); 1927 if (status < 0) 1928 goto error; 1929 status = write16(state, FEC_OC_RCN_GAIN__A, 0x000A); 1930 if (status < 0) 1931 goto error; 1932 status = write16(state, FEC_OC_AVR_PARM_A__A, 0x0008); 1933 if (status < 0) 1934 goto error; 1935 status = write16(state, FEC_OC_AVR_PARM_B__A, 0x0006); 1936 if (status < 0) 1937 goto error; 1938 status = write16(state, FEC_OC_TMD_HI_MARGIN__A, 0x0680); 1939 if (status < 0) 1940 goto error; 1941 status = write16(state, FEC_OC_TMD_LO_MARGIN__A, 0x0080); 1942 if (status < 0) 1943 goto error; 1944 status = write16(state, FEC_OC_TMD_COUNT__A, 0x03F4); 1945 if (status < 0) 1946 goto error; 1947 1948 /* Additional configuration */ 1949 status = write16(state, FEC_OC_OCR_INVERT__A, 0); 1950 if (status < 0) 1951 goto error; 1952 status = write16(state, FEC_OC_SNC_LWM__A, 2); 1953 if (status < 0) 1954 goto error; 1955 status = write16(state, FEC_OC_SNC_HWM__A, 12); 1956 error: 1957 if (status < 0) 1958 pr_err("Error %d on %s\n", status, __func__); 1959 1960 return status; 1961 } 1962 1963 static int mpegts_dto_setup(struct drxk_state *state, 1964 enum operation_mode o_mode) 1965 { 1966 int status; 1967 1968 u16 fec_oc_reg_mode = 0; /* FEC_OC_MODE register value */ 1969 u16 fec_oc_reg_ipr_mode = 0; /* FEC_OC_IPR_MODE register value */ 1970 u16 fec_oc_dto_mode = 0; /* FEC_OC_IPR_INVERT register value */ 1971 u16 fec_oc_fct_mode = 0; /* FEC_OC_IPR_INVERT register value */ 1972 u16 fec_oc_dto_period = 2; /* FEC_OC_IPR_INVERT register value */ 1973 u16 fec_oc_dto_burst_len = 188; /* FEC_OC_IPR_INVERT register value */ 1974 u32 fec_oc_rcn_ctl_rate = 0; /* FEC_OC_IPR_INVERT register value */ 1975 u16 fec_oc_tmd_mode = 0; 1976 u16 fec_oc_tmd_int_upd_rate = 0; 1977 u32 max_bit_rate = 0; 1978 bool static_clk = false; 1979 1980 dprintk(1, "\n"); 1981 1982 /* Check insertion of the Reed-Solomon parity bytes */ 1983 status = read16(state, FEC_OC_MODE__A, &fec_oc_reg_mode); 1984 if (status < 0) 1985 goto error; 1986 status = read16(state, FEC_OC_IPR_MODE__A, &fec_oc_reg_ipr_mode); 1987 if (status < 0) 1988 goto error; 1989 fec_oc_reg_mode &= (~FEC_OC_MODE_PARITY__M); 1990 fec_oc_reg_ipr_mode &= (~FEC_OC_IPR_MODE_MVAL_DIS_PAR__M); 1991 if (state->m_insert_rs_byte) { 1992 /* enable parity symbol forward */ 1993 fec_oc_reg_mode |= FEC_OC_MODE_PARITY__M; 1994 /* MVAL disable during parity bytes */ 1995 fec_oc_reg_ipr_mode |= FEC_OC_IPR_MODE_MVAL_DIS_PAR__M; 1996 /* TS burst length to 204 */ 1997 fec_oc_dto_burst_len = 204; 1998 } 1999 2000 /* Check serial or parallel output */ 2001 fec_oc_reg_ipr_mode &= (~(FEC_OC_IPR_MODE_SERIAL__M)); 2002 if (!state->m_enable_parallel) { 2003 /* MPEG data output is serial -> set ipr_mode[0] */ 2004 fec_oc_reg_ipr_mode |= FEC_OC_IPR_MODE_SERIAL__M; 2005 } 2006 2007 switch (o_mode) { 2008 case OM_DVBT: 2009 max_bit_rate = state->m_dvbt_bitrate; 2010 fec_oc_tmd_mode = 3; 2011 fec_oc_rcn_ctl_rate = 0xC00000; 2012 static_clk = state->m_dvbt_static_clk; 2013 break; 2014 case OM_QAM_ITU_A: 2015 case OM_QAM_ITU_C: 2016 fec_oc_tmd_mode = 0x0004; 2017 fec_oc_rcn_ctl_rate = 0xD2B4EE; /* good for >63 Mb/s */ 2018 max_bit_rate = state->m_dvbc_bitrate; 2019 static_clk = state->m_dvbc_static_clk; 2020 break; 2021 default: 2022 status = -EINVAL; 2023 } /* switch (standard) */ 2024 if (status < 0) 2025 goto error; 2026 2027 /* Configure DTO's */ 2028 if (static_clk) { 2029 u32 bit_rate = 0; 2030 2031 /* Rational DTO for MCLK source (static MCLK rate), 2032 Dynamic DTO for optimal grouping 2033 (avoid intra-packet gaps), 2034 DTO offset enable to sync TS burst with MSTRT */ 2035 fec_oc_dto_mode = (FEC_OC_DTO_MODE_DYNAMIC__M | 2036 FEC_OC_DTO_MODE_OFFSET_ENABLE__M); 2037 fec_oc_fct_mode = (FEC_OC_FCT_MODE_RAT_ENA__M | 2038 FEC_OC_FCT_MODE_VIRT_ENA__M); 2039 2040 /* Check user defined bitrate */ 2041 bit_rate = max_bit_rate; 2042 if (bit_rate > 75900000UL) { /* max is 75.9 Mb/s */ 2043 bit_rate = 75900000UL; 2044 } 2045 /* Rational DTO period: 2046 dto_period = (Fsys / bitrate) - 2 2047 2048 result should be floored, 2049 to make sure >= requested bitrate 2050 */ 2051 fec_oc_dto_period = (u16) (((state->m_sys_clock_freq) 2052 * 1000) / bit_rate); 2053 if (fec_oc_dto_period <= 2) 2054 fec_oc_dto_period = 0; 2055 else 2056 fec_oc_dto_period -= 2; 2057 fec_oc_tmd_int_upd_rate = 8; 2058 } else { 2059 /* (commonAttr->static_clk == false) => dynamic mode */ 2060 fec_oc_dto_mode = FEC_OC_DTO_MODE_DYNAMIC__M; 2061 fec_oc_fct_mode = FEC_OC_FCT_MODE__PRE; 2062 fec_oc_tmd_int_upd_rate = 5; 2063 } 2064 2065 /* Write appropriate registers with requested configuration */ 2066 status = write16(state, FEC_OC_DTO_BURST_LEN__A, fec_oc_dto_burst_len); 2067 if (status < 0) 2068 goto error; 2069 status = write16(state, FEC_OC_DTO_PERIOD__A, fec_oc_dto_period); 2070 if (status < 0) 2071 goto error; 2072 status = write16(state, FEC_OC_DTO_MODE__A, fec_oc_dto_mode); 2073 if (status < 0) 2074 goto error; 2075 status = write16(state, FEC_OC_FCT_MODE__A, fec_oc_fct_mode); 2076 if (status < 0) 2077 goto error; 2078 status = write16(state, FEC_OC_MODE__A, fec_oc_reg_mode); 2079 if (status < 0) 2080 goto error; 2081 status = write16(state, FEC_OC_IPR_MODE__A, fec_oc_reg_ipr_mode); 2082 if (status < 0) 2083 goto error; 2084 2085 /* Rate integration settings */ 2086 status = write32(state, FEC_OC_RCN_CTL_RATE_LO__A, fec_oc_rcn_ctl_rate); 2087 if (status < 0) 2088 goto error; 2089 status = write16(state, FEC_OC_TMD_INT_UPD_RATE__A, 2090 fec_oc_tmd_int_upd_rate); 2091 if (status < 0) 2092 goto error; 2093 status = write16(state, FEC_OC_TMD_MODE__A, fec_oc_tmd_mode); 2094 error: 2095 if (status < 0) 2096 pr_err("Error %d on %s\n", status, __func__); 2097 return status; 2098 } 2099 2100 static int mpegts_configure_polarity(struct drxk_state *state) 2101 { 2102 u16 fec_oc_reg_ipr_invert = 0; 2103 2104 /* Data mask for the output data byte */ 2105 u16 invert_data_mask = 2106 FEC_OC_IPR_INVERT_MD7__M | FEC_OC_IPR_INVERT_MD6__M | 2107 FEC_OC_IPR_INVERT_MD5__M | FEC_OC_IPR_INVERT_MD4__M | 2108 FEC_OC_IPR_INVERT_MD3__M | FEC_OC_IPR_INVERT_MD2__M | 2109 FEC_OC_IPR_INVERT_MD1__M | FEC_OC_IPR_INVERT_MD0__M; 2110 2111 dprintk(1, "\n"); 2112 2113 /* Control selective inversion of output bits */ 2114 fec_oc_reg_ipr_invert &= (~(invert_data_mask)); 2115 if (state->m_invert_data) 2116 fec_oc_reg_ipr_invert |= invert_data_mask; 2117 fec_oc_reg_ipr_invert &= (~(FEC_OC_IPR_INVERT_MERR__M)); 2118 if (state->m_invert_err) 2119 fec_oc_reg_ipr_invert |= FEC_OC_IPR_INVERT_MERR__M; 2120 fec_oc_reg_ipr_invert &= (~(FEC_OC_IPR_INVERT_MSTRT__M)); 2121 if (state->m_invert_str) 2122 fec_oc_reg_ipr_invert |= FEC_OC_IPR_INVERT_MSTRT__M; 2123 fec_oc_reg_ipr_invert &= (~(FEC_OC_IPR_INVERT_MVAL__M)); 2124 if (state->m_invert_val) 2125 fec_oc_reg_ipr_invert |= FEC_OC_IPR_INVERT_MVAL__M; 2126 fec_oc_reg_ipr_invert &= (~(FEC_OC_IPR_INVERT_MCLK__M)); 2127 if (state->m_invert_clk) 2128 fec_oc_reg_ipr_invert |= FEC_OC_IPR_INVERT_MCLK__M; 2129 2130 return write16(state, FEC_OC_IPR_INVERT__A, fec_oc_reg_ipr_invert); 2131 } 2132 2133 #define SCU_RAM_AGC_KI_INV_RF_POL__M 0x4000 2134 2135 static int set_agc_rf(struct drxk_state *state, 2136 struct s_cfg_agc *p_agc_cfg, bool is_dtv) 2137 { 2138 int status = -EINVAL; 2139 u16 data = 0; 2140 struct s_cfg_agc *p_if_agc_settings; 2141 2142 dprintk(1, "\n"); 2143 2144 if (p_agc_cfg == NULL) 2145 goto error; 2146 2147 switch (p_agc_cfg->ctrl_mode) { 2148 case DRXK_AGC_CTRL_AUTO: 2149 /* Enable RF AGC DAC */ 2150 status = read16(state, IQM_AF_STDBY__A, &data); 2151 if (status < 0) 2152 goto error; 2153 data &= ~IQM_AF_STDBY_STDBY_TAGC_RF_STANDBY; 2154 status = write16(state, IQM_AF_STDBY__A, data); 2155 if (status < 0) 2156 goto error; 2157 status = read16(state, SCU_RAM_AGC_CONFIG__A, &data); 2158 if (status < 0) 2159 goto error; 2160 2161 /* Enable SCU RF AGC loop */ 2162 data &= ~SCU_RAM_AGC_CONFIG_DISABLE_RF_AGC__M; 2163 2164 /* Polarity */ 2165 if (state->m_rf_agc_pol) 2166 data |= SCU_RAM_AGC_CONFIG_INV_RF_POL__M; 2167 else 2168 data &= ~SCU_RAM_AGC_CONFIG_INV_RF_POL__M; 2169 status = write16(state, SCU_RAM_AGC_CONFIG__A, data); 2170 if (status < 0) 2171 goto error; 2172 2173 /* Set speed (using complementary reduction value) */ 2174 status = read16(state, SCU_RAM_AGC_KI_RED__A, &data); 2175 if (status < 0) 2176 goto error; 2177 2178 data &= ~SCU_RAM_AGC_KI_RED_RAGC_RED__M; 2179 data |= (~(p_agc_cfg->speed << 2180 SCU_RAM_AGC_KI_RED_RAGC_RED__B) 2181 & SCU_RAM_AGC_KI_RED_RAGC_RED__M); 2182 2183 status = write16(state, SCU_RAM_AGC_KI_RED__A, data); 2184 if (status < 0) 2185 goto error; 2186 2187 if (is_dvbt(state)) 2188 p_if_agc_settings = &state->m_dvbt_if_agc_cfg; 2189 else if (is_qam(state)) 2190 p_if_agc_settings = &state->m_qam_if_agc_cfg; 2191 else 2192 p_if_agc_settings = &state->m_atv_if_agc_cfg; 2193 if (p_if_agc_settings == NULL) { 2194 status = -EINVAL; 2195 goto error; 2196 } 2197 2198 /* Set TOP, only if IF-AGC is in AUTO mode */ 2199 if (p_if_agc_settings->ctrl_mode == DRXK_AGC_CTRL_AUTO) { 2200 status = write16(state, 2201 SCU_RAM_AGC_IF_IACCU_HI_TGT_MAX__A, 2202 p_agc_cfg->top); 2203 if (status < 0) 2204 goto error; 2205 } 2206 2207 /* Cut-Off current */ 2208 status = write16(state, SCU_RAM_AGC_RF_IACCU_HI_CO__A, 2209 p_agc_cfg->cut_off_current); 2210 if (status < 0) 2211 goto error; 2212 2213 /* Max. output level */ 2214 status = write16(state, SCU_RAM_AGC_RF_MAX__A, 2215 p_agc_cfg->max_output_level); 2216 if (status < 0) 2217 goto error; 2218 2219 break; 2220 2221 case DRXK_AGC_CTRL_USER: 2222 /* Enable RF AGC DAC */ 2223 status = read16(state, IQM_AF_STDBY__A, &data); 2224 if (status < 0) 2225 goto error; 2226 data &= ~IQM_AF_STDBY_STDBY_TAGC_RF_STANDBY; 2227 status = write16(state, IQM_AF_STDBY__A, data); 2228 if (status < 0) 2229 goto error; 2230 2231 /* Disable SCU RF AGC loop */ 2232 status = read16(state, SCU_RAM_AGC_CONFIG__A, &data); 2233 if (status < 0) 2234 goto error; 2235 data |= SCU_RAM_AGC_CONFIG_DISABLE_RF_AGC__M; 2236 if (state->m_rf_agc_pol) 2237 data |= SCU_RAM_AGC_CONFIG_INV_RF_POL__M; 2238 else 2239 data &= ~SCU_RAM_AGC_CONFIG_INV_RF_POL__M; 2240 status = write16(state, SCU_RAM_AGC_CONFIG__A, data); 2241 if (status < 0) 2242 goto error; 2243 2244 /* SCU c.o.c. to 0, enabling full control range */ 2245 status = write16(state, SCU_RAM_AGC_RF_IACCU_HI_CO__A, 0); 2246 if (status < 0) 2247 goto error; 2248 2249 /* Write value to output pin */ 2250 status = write16(state, SCU_RAM_AGC_RF_IACCU_HI__A, 2251 p_agc_cfg->output_level); 2252 if (status < 0) 2253 goto error; 2254 break; 2255 2256 case DRXK_AGC_CTRL_OFF: 2257 /* Disable RF AGC DAC */ 2258 status = read16(state, IQM_AF_STDBY__A, &data); 2259 if (status < 0) 2260 goto error; 2261 data |= IQM_AF_STDBY_STDBY_TAGC_RF_STANDBY; 2262 status = write16(state, IQM_AF_STDBY__A, data); 2263 if (status < 0) 2264 goto error; 2265 2266 /* Disable SCU RF AGC loop */ 2267 status = read16(state, SCU_RAM_AGC_CONFIG__A, &data); 2268 if (status < 0) 2269 goto error; 2270 data |= SCU_RAM_AGC_CONFIG_DISABLE_RF_AGC__M; 2271 status = write16(state, SCU_RAM_AGC_CONFIG__A, data); 2272 if (status < 0) 2273 goto error; 2274 break; 2275 2276 default: 2277 status = -EINVAL; 2278 2279 } 2280 error: 2281 if (status < 0) 2282 pr_err("Error %d on %s\n", status, __func__); 2283 return status; 2284 } 2285 2286 #define SCU_RAM_AGC_KI_INV_IF_POL__M 0x2000 2287 2288 static int set_agc_if(struct drxk_state *state, 2289 struct s_cfg_agc *p_agc_cfg, bool is_dtv) 2290 { 2291 u16 data = 0; 2292 int status = 0; 2293 struct s_cfg_agc *p_rf_agc_settings; 2294 2295 dprintk(1, "\n"); 2296 2297 switch (p_agc_cfg->ctrl_mode) { 2298 case DRXK_AGC_CTRL_AUTO: 2299 2300 /* Enable IF AGC DAC */ 2301 status = read16(state, IQM_AF_STDBY__A, &data); 2302 if (status < 0) 2303 goto error; 2304 data &= ~IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY; 2305 status = write16(state, IQM_AF_STDBY__A, data); 2306 if (status < 0) 2307 goto error; 2308 2309 status = read16(state, SCU_RAM_AGC_CONFIG__A, &data); 2310 if (status < 0) 2311 goto error; 2312 2313 /* Enable SCU IF AGC loop */ 2314 data &= ~SCU_RAM_AGC_CONFIG_DISABLE_IF_AGC__M; 2315 2316 /* Polarity */ 2317 if (state->m_if_agc_pol) 2318 data |= SCU_RAM_AGC_CONFIG_INV_IF_POL__M; 2319 else 2320 data &= ~SCU_RAM_AGC_CONFIG_INV_IF_POL__M; 2321 status = write16(state, SCU_RAM_AGC_CONFIG__A, data); 2322 if (status < 0) 2323 goto error; 2324 2325 /* Set speed (using complementary reduction value) */ 2326 status = read16(state, SCU_RAM_AGC_KI_RED__A, &data); 2327 if (status < 0) 2328 goto error; 2329 data &= ~SCU_RAM_AGC_KI_RED_IAGC_RED__M; 2330 data |= (~(p_agc_cfg->speed << 2331 SCU_RAM_AGC_KI_RED_IAGC_RED__B) 2332 & SCU_RAM_AGC_KI_RED_IAGC_RED__M); 2333 2334 status = write16(state, SCU_RAM_AGC_KI_RED__A, data); 2335 if (status < 0) 2336 goto error; 2337 2338 if (is_qam(state)) 2339 p_rf_agc_settings = &state->m_qam_rf_agc_cfg; 2340 else 2341 p_rf_agc_settings = &state->m_atv_rf_agc_cfg; 2342 if (p_rf_agc_settings == NULL) 2343 return -1; 2344 /* Restore TOP */ 2345 status = write16(state, SCU_RAM_AGC_IF_IACCU_HI_TGT_MAX__A, 2346 p_rf_agc_settings->top); 2347 if (status < 0) 2348 goto error; 2349 break; 2350 2351 case DRXK_AGC_CTRL_USER: 2352 2353 /* Enable IF AGC DAC */ 2354 status = read16(state, IQM_AF_STDBY__A, &data); 2355 if (status < 0) 2356 goto error; 2357 data &= ~IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY; 2358 status = write16(state, IQM_AF_STDBY__A, data); 2359 if (status < 0) 2360 goto error; 2361 2362 status = read16(state, SCU_RAM_AGC_CONFIG__A, &data); 2363 if (status < 0) 2364 goto error; 2365 2366 /* Disable SCU IF AGC loop */ 2367 data |= SCU_RAM_AGC_CONFIG_DISABLE_IF_AGC__M; 2368 2369 /* Polarity */ 2370 if (state->m_if_agc_pol) 2371 data |= SCU_RAM_AGC_CONFIG_INV_IF_POL__M; 2372 else 2373 data &= ~SCU_RAM_AGC_CONFIG_INV_IF_POL__M; 2374 status = write16(state, SCU_RAM_AGC_CONFIG__A, data); 2375 if (status < 0) 2376 goto error; 2377 2378 /* Write value to output pin */ 2379 status = write16(state, SCU_RAM_AGC_IF_IACCU_HI_TGT_MAX__A, 2380 p_agc_cfg->output_level); 2381 if (status < 0) 2382 goto error; 2383 break; 2384 2385 case DRXK_AGC_CTRL_OFF: 2386 2387 /* Disable If AGC DAC */ 2388 status = read16(state, IQM_AF_STDBY__A, &data); 2389 if (status < 0) 2390 goto error; 2391 data |= IQM_AF_STDBY_STDBY_TAGC_IF_STANDBY; 2392 status = write16(state, IQM_AF_STDBY__A, data); 2393 if (status < 0) 2394 goto error; 2395 2396 /* Disable SCU IF AGC loop */ 2397 status = read16(state, SCU_RAM_AGC_CONFIG__A, &data); 2398 if (status < 0) 2399 goto error; 2400 data |= SCU_RAM_AGC_CONFIG_DISABLE_IF_AGC__M; 2401 status = write16(state, SCU_RAM_AGC_CONFIG__A, data); 2402 if (status < 0) 2403 goto error; 2404 break; 2405 } /* switch (agcSettingsIf->ctrl_mode) */ 2406 2407 /* always set the top to support 2408 configurations without if-loop */ 2409 status = write16(state, SCU_RAM_AGC_INGAIN_TGT_MIN__A, p_agc_cfg->top); 2410 error: 2411 if (status < 0) 2412 pr_err("Error %d on %s\n", status, __func__); 2413 return status; 2414 } 2415 2416 static int get_qam_signal_to_noise(struct drxk_state *state, 2417 s32 *p_signal_to_noise) 2418 { 2419 int status = 0; 2420 u16 qam_sl_err_power = 0; /* accum. error between 2421 raw and sliced symbols */ 2422 u32 qam_sl_sig_power = 0; /* used for MER, depends of 2423 QAM modulation */ 2424 u32 qam_sl_mer = 0; /* QAM MER */ 2425 2426 dprintk(1, "\n"); 2427 2428 /* MER calculation */ 2429 2430 /* get the register value needed for MER */ 2431 status = read16(state, QAM_SL_ERR_POWER__A, &qam_sl_err_power); 2432 if (status < 0) { 2433 pr_err("Error %d on %s\n", status, __func__); 2434 return -EINVAL; 2435 } 2436 2437 switch (state->props.modulation) { 2438 case QAM_16: 2439 qam_sl_sig_power = DRXK_QAM_SL_SIG_POWER_QAM16 << 2; 2440 break; 2441 case QAM_32: 2442 qam_sl_sig_power = DRXK_QAM_SL_SIG_POWER_QAM32 << 2; 2443 break; 2444 case QAM_64: 2445 qam_sl_sig_power = DRXK_QAM_SL_SIG_POWER_QAM64 << 2; 2446 break; 2447 case QAM_128: 2448 qam_sl_sig_power = DRXK_QAM_SL_SIG_POWER_QAM128 << 2; 2449 break; 2450 default: 2451 case QAM_256: 2452 qam_sl_sig_power = DRXK_QAM_SL_SIG_POWER_QAM256 << 2; 2453 break; 2454 } 2455 2456 if (qam_sl_err_power > 0) { 2457 qam_sl_mer = log10times100(qam_sl_sig_power) - 2458 log10times100((u32) qam_sl_err_power); 2459 } 2460 *p_signal_to_noise = qam_sl_mer; 2461 2462 return status; 2463 } 2464 2465 static int get_dvbt_signal_to_noise(struct drxk_state *state, 2466 s32 *p_signal_to_noise) 2467 { 2468 int status; 2469 u16 reg_data = 0; 2470 u32 eq_reg_td_sqr_err_i = 0; 2471 u32 eq_reg_td_sqr_err_q = 0; 2472 u16 eq_reg_td_sqr_err_exp = 0; 2473 u16 eq_reg_td_tps_pwr_ofs = 0; 2474 u16 eq_reg_td_req_smb_cnt = 0; 2475 u32 tps_cnt = 0; 2476 u32 sqr_err_iq = 0; 2477 u32 a = 0; 2478 u32 b = 0; 2479 u32 c = 0; 2480 u32 i_mer = 0; 2481 u16 transmission_params = 0; 2482 2483 dprintk(1, "\n"); 2484 2485 status = read16(state, OFDM_EQ_TOP_TD_TPS_PWR_OFS__A, 2486 &eq_reg_td_tps_pwr_ofs); 2487 if (status < 0) 2488 goto error; 2489 status = read16(state, OFDM_EQ_TOP_TD_REQ_SMB_CNT__A, 2490 &eq_reg_td_req_smb_cnt); 2491 if (status < 0) 2492 goto error; 2493 status = read16(state, OFDM_EQ_TOP_TD_SQR_ERR_EXP__A, 2494 &eq_reg_td_sqr_err_exp); 2495 if (status < 0) 2496 goto error; 2497 status = read16(state, OFDM_EQ_TOP_TD_SQR_ERR_I__A, 2498 ®_data); 2499 if (status < 0) 2500 goto error; 2501 /* Extend SQR_ERR_I operational range */ 2502 eq_reg_td_sqr_err_i = (u32) reg_data; 2503 if ((eq_reg_td_sqr_err_exp > 11) && 2504 (eq_reg_td_sqr_err_i < 0x00000FFFUL)) { 2505 eq_reg_td_sqr_err_i += 0x00010000UL; 2506 } 2507 status = read16(state, OFDM_EQ_TOP_TD_SQR_ERR_Q__A, ®_data); 2508 if (status < 0) 2509 goto error; 2510 /* Extend SQR_ERR_Q operational range */ 2511 eq_reg_td_sqr_err_q = (u32) reg_data; 2512 if ((eq_reg_td_sqr_err_exp > 11) && 2513 (eq_reg_td_sqr_err_q < 0x00000FFFUL)) 2514 eq_reg_td_sqr_err_q += 0x00010000UL; 2515 2516 status = read16(state, OFDM_SC_RA_RAM_OP_PARAM__A, 2517 &transmission_params); 2518 if (status < 0) 2519 goto error; 2520 2521 /* Check input data for MER */ 2522 2523 /* MER calculation (in 0.1 dB) without math.h */ 2524 if ((eq_reg_td_tps_pwr_ofs == 0) || (eq_reg_td_req_smb_cnt == 0)) 2525 i_mer = 0; 2526 else if ((eq_reg_td_sqr_err_i + eq_reg_td_sqr_err_q) == 0) { 2527 /* No error at all, this must be the HW reset value 2528 * Apparently no first measurement yet 2529 * Set MER to 0.0 */ 2530 i_mer = 0; 2531 } else { 2532 sqr_err_iq = (eq_reg_td_sqr_err_i + eq_reg_td_sqr_err_q) << 2533 eq_reg_td_sqr_err_exp; 2534 if ((transmission_params & 2535 OFDM_SC_RA_RAM_OP_PARAM_MODE__M) 2536 == OFDM_SC_RA_RAM_OP_PARAM_MODE_2K) 2537 tps_cnt = 17; 2538 else 2539 tps_cnt = 68; 2540 2541 /* IMER = 100 * log10 (x) 2542 where x = (eq_reg_td_tps_pwr_ofs^2 * 2543 eq_reg_td_req_smb_cnt * tps_cnt)/sqr_err_iq 2544 2545 => IMER = a + b -c 2546 where a = 100 * log10 (eq_reg_td_tps_pwr_ofs^2) 2547 b = 100 * log10 (eq_reg_td_req_smb_cnt * tps_cnt) 2548 c = 100 * log10 (sqr_err_iq) 2549 */ 2550 2551 /* log(x) x = 9bits * 9bits->18 bits */ 2552 a = log10times100(eq_reg_td_tps_pwr_ofs * 2553 eq_reg_td_tps_pwr_ofs); 2554 /* log(x) x = 16bits * 7bits->23 bits */ 2555 b = log10times100(eq_reg_td_req_smb_cnt * tps_cnt); 2556 /* log(x) x = (16bits + 16bits) << 15 ->32 bits */ 2557 c = log10times100(sqr_err_iq); 2558 2559 i_mer = a + b - c; 2560 } 2561 *p_signal_to_noise = i_mer; 2562 2563 error: 2564 if (status < 0) 2565 pr_err("Error %d on %s\n", status, __func__); 2566 return status; 2567 } 2568 2569 static int get_signal_to_noise(struct drxk_state *state, s32 *p_signal_to_noise) 2570 { 2571 dprintk(1, "\n"); 2572 2573 *p_signal_to_noise = 0; 2574 switch (state->m_operation_mode) { 2575 case OM_DVBT: 2576 return get_dvbt_signal_to_noise(state, p_signal_to_noise); 2577 case OM_QAM_ITU_A: 2578 case OM_QAM_ITU_C: 2579 return get_qam_signal_to_noise(state, p_signal_to_noise); 2580 default: 2581 break; 2582 } 2583 return 0; 2584 } 2585 2586 #if 0 2587 static int get_dvbt_quality(struct drxk_state *state, s32 *p_quality) 2588 { 2589 /* SNR Values for quasi errorfree reception rom Nordig 2.2 */ 2590 int status = 0; 2591 2592 dprintk(1, "\n"); 2593 2594 static s32 QE_SN[] = { 2595 51, /* QPSK 1/2 */ 2596 69, /* QPSK 2/3 */ 2597 79, /* QPSK 3/4 */ 2598 89, /* QPSK 5/6 */ 2599 97, /* QPSK 7/8 */ 2600 108, /* 16-QAM 1/2 */ 2601 131, /* 16-QAM 2/3 */ 2602 146, /* 16-QAM 3/4 */ 2603 156, /* 16-QAM 5/6 */ 2604 160, /* 16-QAM 7/8 */ 2605 165, /* 64-QAM 1/2 */ 2606 187, /* 64-QAM 2/3 */ 2607 202, /* 64-QAM 3/4 */ 2608 216, /* 64-QAM 5/6 */ 2609 225, /* 64-QAM 7/8 */ 2610 }; 2611 2612 *p_quality = 0; 2613 2614 do { 2615 s32 signal_to_noise = 0; 2616 u16 constellation = 0; 2617 u16 code_rate = 0; 2618 u32 signal_to_noise_rel; 2619 u32 ber_quality; 2620 2621 status = get_dvbt_signal_to_noise(state, &signal_to_noise); 2622 if (status < 0) 2623 break; 2624 status = read16(state, OFDM_EQ_TOP_TD_TPS_CONST__A, 2625 &constellation); 2626 if (status < 0) 2627 break; 2628 constellation &= OFDM_EQ_TOP_TD_TPS_CONST__M; 2629 2630 status = read16(state, OFDM_EQ_TOP_TD_TPS_CODE_HP__A, 2631 &code_rate); 2632 if (status < 0) 2633 break; 2634 code_rate &= OFDM_EQ_TOP_TD_TPS_CODE_HP__M; 2635 2636 if (constellation > OFDM_EQ_TOP_TD_TPS_CONST_64QAM || 2637 code_rate > OFDM_EQ_TOP_TD_TPS_CODE_LP_7_8) 2638 break; 2639 signal_to_noise_rel = signal_to_noise - 2640 QE_SN[constellation * 5 + code_rate]; 2641 ber_quality = 100; 2642 2643 if (signal_to_noise_rel < -70) 2644 *p_quality = 0; 2645 else if (signal_to_noise_rel < 30) 2646 *p_quality = ((signal_to_noise_rel + 70) * 2647 ber_quality) / 100; 2648 else 2649 *p_quality = ber_quality; 2650 } while (0); 2651 return 0; 2652 }; 2653 2654 static int get_dvbc_quality(struct drxk_state *state, s32 *p_quality) 2655 { 2656 int status = 0; 2657 *p_quality = 0; 2658 2659 dprintk(1, "\n"); 2660 2661 do { 2662 u32 signal_to_noise = 0; 2663 u32 ber_quality = 100; 2664 u32 signal_to_noise_rel = 0; 2665 2666 status = get_qam_signal_to_noise(state, &signal_to_noise); 2667 if (status < 0) 2668 break; 2669 2670 switch (state->props.modulation) { 2671 case QAM_16: 2672 signal_to_noise_rel = signal_to_noise - 200; 2673 break; 2674 case QAM_32: 2675 signal_to_noise_rel = signal_to_noise - 230; 2676 break; /* Not in NorDig */ 2677 case QAM_64: 2678 signal_to_noise_rel = signal_to_noise - 260; 2679 break; 2680 case QAM_128: 2681 signal_to_noise_rel = signal_to_noise - 290; 2682 break; 2683 default: 2684 case QAM_256: 2685 signal_to_noise_rel = signal_to_noise - 320; 2686 break; 2687 } 2688 2689 if (signal_to_noise_rel < -70) 2690 *p_quality = 0; 2691 else if (signal_to_noise_rel < 30) 2692 *p_quality = ((signal_to_noise_rel + 70) * 2693 ber_quality) / 100; 2694 else 2695 *p_quality = ber_quality; 2696 } while (0); 2697 2698 return status; 2699 } 2700 2701 static int get_quality(struct drxk_state *state, s32 *p_quality) 2702 { 2703 dprintk(1, "\n"); 2704 2705 switch (state->m_operation_mode) { 2706 case OM_DVBT: 2707 return get_dvbt_quality(state, p_quality); 2708 case OM_QAM_ITU_A: 2709 return get_dvbc_quality(state, p_quality); 2710 default: 2711 break; 2712 } 2713 2714 return 0; 2715 } 2716 #endif 2717 2718 /* Free data ram in SIO HI */ 2719 #define SIO_HI_RA_RAM_USR_BEGIN__A 0x420040 2720 #define SIO_HI_RA_RAM_USR_END__A 0x420060 2721 2722 #define DRXK_HI_ATOMIC_BUF_START (SIO_HI_RA_RAM_USR_BEGIN__A) 2723 #define DRXK_HI_ATOMIC_BUF_END (SIO_HI_RA_RAM_USR_BEGIN__A + 7) 2724 #define DRXK_HI_ATOMIC_READ SIO_HI_RA_RAM_PAR_3_ACP_RW_READ 2725 #define DRXK_HI_ATOMIC_WRITE SIO_HI_RA_RAM_PAR_3_ACP_RW_WRITE 2726 2727 #define DRXDAP_FASI_ADDR2BLOCK(addr) (((addr) >> 22) & 0x3F) 2728 #define DRXDAP_FASI_ADDR2BANK(addr) (((addr) >> 16) & 0x3F) 2729 #define DRXDAP_FASI_ADDR2OFFSET(addr) ((addr) & 0x7FFF) 2730 2731 static int ConfigureI2CBridge(struct drxk_state *state, bool b_enable_bridge) 2732 { 2733 int status = -EINVAL; 2734 2735 dprintk(1, "\n"); 2736 2737 if (state->m_drxk_state == DRXK_UNINITIALIZED) 2738 return 0; 2739 if (state->m_drxk_state == DRXK_POWERED_DOWN) 2740 goto error; 2741 2742 if (state->no_i2c_bridge) 2743 return 0; 2744 2745 status = write16(state, SIO_HI_RA_RAM_PAR_1__A, 2746 SIO_HI_RA_RAM_PAR_1_PAR1_SEC_KEY); 2747 if (status < 0) 2748 goto error; 2749 if (b_enable_bridge) { 2750 status = write16(state, SIO_HI_RA_RAM_PAR_2__A, 2751 SIO_HI_RA_RAM_PAR_2_BRD_CFG_CLOSED); 2752 if (status < 0) 2753 goto error; 2754 } else { 2755 status = write16(state, SIO_HI_RA_RAM_PAR_2__A, 2756 SIO_HI_RA_RAM_PAR_2_BRD_CFG_OPEN); 2757 if (status < 0) 2758 goto error; 2759 } 2760 2761 status = hi_command(state, SIO_HI_RA_RAM_CMD_BRDCTRL, NULL); 2762 2763 error: 2764 if (status < 0) 2765 pr_err("Error %d on %s\n", status, __func__); 2766 return status; 2767 } 2768 2769 static int set_pre_saw(struct drxk_state *state, 2770 struct s_cfg_pre_saw *p_pre_saw_cfg) 2771 { 2772 int status = -EINVAL; 2773 2774 dprintk(1, "\n"); 2775 2776 if ((p_pre_saw_cfg == NULL) 2777 || (p_pre_saw_cfg->reference > IQM_AF_PDREF__M)) 2778 goto error; 2779 2780 status = write16(state, IQM_AF_PDREF__A, p_pre_saw_cfg->reference); 2781 error: 2782 if (status < 0) 2783 pr_err("Error %d on %s\n", status, __func__); 2784 return status; 2785 } 2786 2787 static int bl_direct_cmd(struct drxk_state *state, u32 target_addr, 2788 u16 rom_offset, u16 nr_of_elements, u32 time_out) 2789 { 2790 u16 bl_status = 0; 2791 u16 offset = (u16) ((target_addr >> 0) & 0x00FFFF); 2792 u16 blockbank = (u16) ((target_addr >> 16) & 0x000FFF); 2793 int status; 2794 unsigned long end; 2795 2796 dprintk(1, "\n"); 2797 2798 mutex_lock(&state->mutex); 2799 status = write16(state, SIO_BL_MODE__A, SIO_BL_MODE_DIRECT); 2800 if (status < 0) 2801 goto error; 2802 status = write16(state, SIO_BL_TGT_HDR__A, blockbank); 2803 if (status < 0) 2804 goto error; 2805 status = write16(state, SIO_BL_TGT_ADDR__A, offset); 2806 if (status < 0) 2807 goto error; 2808 status = write16(state, SIO_BL_SRC_ADDR__A, rom_offset); 2809 if (status < 0) 2810 goto error; 2811 status = write16(state, SIO_BL_SRC_LEN__A, nr_of_elements); 2812 if (status < 0) 2813 goto error; 2814 status = write16(state, SIO_BL_ENABLE__A, SIO_BL_ENABLE_ON); 2815 if (status < 0) 2816 goto error; 2817 2818 end = jiffies + msecs_to_jiffies(time_out); 2819 do { 2820 status = read16(state, SIO_BL_STATUS__A, &bl_status); 2821 if (status < 0) 2822 goto error; 2823 } while ((bl_status == 0x1) && time_is_after_jiffies(end)); 2824 if (bl_status == 0x1) { 2825 pr_err("SIO not ready\n"); 2826 status = -EINVAL; 2827 goto error2; 2828 } 2829 error: 2830 if (status < 0) 2831 pr_err("Error %d on %s\n", status, __func__); 2832 error2: 2833 mutex_unlock(&state->mutex); 2834 return status; 2835 2836 } 2837 2838 static int adc_sync_measurement(struct drxk_state *state, u16 *count) 2839 { 2840 u16 data = 0; 2841 int status; 2842 2843 dprintk(1, "\n"); 2844 2845 /* start measurement */ 2846 status = write16(state, IQM_AF_COMM_EXEC__A, IQM_AF_COMM_EXEC_ACTIVE); 2847 if (status < 0) 2848 goto error; 2849 status = write16(state, IQM_AF_START_LOCK__A, 1); 2850 if (status < 0) 2851 goto error; 2852 2853 *count = 0; 2854 status = read16(state, IQM_AF_PHASE0__A, &data); 2855 if (status < 0) 2856 goto error; 2857 if (data == 127) 2858 *count = *count + 1; 2859 status = read16(state, IQM_AF_PHASE1__A, &data); 2860 if (status < 0) 2861 goto error; 2862 if (data == 127) 2863 *count = *count + 1; 2864 status = read16(state, IQM_AF_PHASE2__A, &data); 2865 if (status < 0) 2866 goto error; 2867 if (data == 127) 2868 *count = *count + 1; 2869 2870 error: 2871 if (status < 0) 2872 pr_err("Error %d on %s\n", status, __func__); 2873 return status; 2874 } 2875 2876 static int adc_synchronization(struct drxk_state *state) 2877 { 2878 u16 count = 0; 2879 int status; 2880 2881 dprintk(1, "\n"); 2882 2883 status = adc_sync_measurement(state, &count); 2884 if (status < 0) 2885 goto error; 2886 2887 if (count == 1) { 2888 /* Try sampling on a different edge */ 2889 u16 clk_neg = 0; 2890 2891 status = read16(state, IQM_AF_CLKNEG__A, &clk_neg); 2892 if (status < 0) 2893 goto error; 2894 if ((clk_neg & IQM_AF_CLKNEG_CLKNEGDATA__M) == 2895 IQM_AF_CLKNEG_CLKNEGDATA_CLK_ADC_DATA_POS) { 2896 clk_neg &= (~(IQM_AF_CLKNEG_CLKNEGDATA__M)); 2897 clk_neg |= 2898 IQM_AF_CLKNEG_CLKNEGDATA_CLK_ADC_DATA_NEG; 2899 } else { 2900 clk_neg &= (~(IQM_AF_CLKNEG_CLKNEGDATA__M)); 2901 clk_neg |= 2902 IQM_AF_CLKNEG_CLKNEGDATA_CLK_ADC_DATA_POS; 2903 } 2904 status = write16(state, IQM_AF_CLKNEG__A, clk_neg); 2905 if (status < 0) 2906 goto error; 2907 status = adc_sync_measurement(state, &count); 2908 if (status < 0) 2909 goto error; 2910 } 2911 2912 if (count < 2) 2913 status = -EINVAL; 2914 error: 2915 if (status < 0) 2916 pr_err("Error %d on %s\n", status, __func__); 2917 return status; 2918 } 2919 2920 static int set_frequency_shifter(struct drxk_state *state, 2921 u16 intermediate_freqk_hz, 2922 s32 tuner_freq_offset, bool is_dtv) 2923 { 2924 bool select_pos_image = false; 2925 u32 rf_freq_residual = tuner_freq_offset; 2926 u32 fm_frequency_shift = 0; 2927 bool tuner_mirror = !state->m_b_mirror_freq_spect; 2928 u32 adc_freq; 2929 bool adc_flip; 2930 int status; 2931 u32 if_freq_actual; 2932 u32 sampling_frequency = (u32) (state->m_sys_clock_freq / 3); 2933 u32 frequency_shift; 2934 bool image_to_select; 2935 2936 dprintk(1, "\n"); 2937 2938 /* 2939 Program frequency shifter 2940 No need to account for mirroring on RF 2941 */ 2942 if (is_dtv) { 2943 if ((state->m_operation_mode == OM_QAM_ITU_A) || 2944 (state->m_operation_mode == OM_QAM_ITU_C) || 2945 (state->m_operation_mode == OM_DVBT)) 2946 select_pos_image = true; 2947 else 2948 select_pos_image = false; 2949 } 2950 if (tuner_mirror) 2951 /* tuner doesn't mirror */ 2952 if_freq_actual = intermediate_freqk_hz + 2953 rf_freq_residual + fm_frequency_shift; 2954 else 2955 /* tuner mirrors */ 2956 if_freq_actual = intermediate_freqk_hz - 2957 rf_freq_residual - fm_frequency_shift; 2958 if (if_freq_actual > sampling_frequency / 2) { 2959 /* adc mirrors */ 2960 adc_freq = sampling_frequency - if_freq_actual; 2961 adc_flip = true; 2962 } else { 2963 /* adc doesn't mirror */ 2964 adc_freq = if_freq_actual; 2965 adc_flip = false; 2966 } 2967 2968 frequency_shift = adc_freq; 2969 image_to_select = state->m_rfmirror ^ tuner_mirror ^ 2970 adc_flip ^ select_pos_image; 2971 state->m_iqm_fs_rate_ofs = 2972 Frac28a((frequency_shift), sampling_frequency); 2973 2974 if (image_to_select) 2975 state->m_iqm_fs_rate_ofs = ~state->m_iqm_fs_rate_ofs + 1; 2976 2977 /* Program frequency shifter with tuner offset compensation */ 2978 /* frequency_shift += tuner_freq_offset; TODO */ 2979 status = write32(state, IQM_FS_RATE_OFS_LO__A, 2980 state->m_iqm_fs_rate_ofs); 2981 if (status < 0) 2982 pr_err("Error %d on %s\n", status, __func__); 2983 return status; 2984 } 2985 2986 static int init_agc(struct drxk_state *state, bool is_dtv) 2987 { 2988 u16 ingain_tgt = 0; 2989 u16 ingain_tgt_min = 0; 2990 u16 ingain_tgt_max = 0; 2991 u16 clp_cyclen = 0; 2992 u16 clp_sum_min = 0; 2993 u16 clp_dir_to = 0; 2994 u16 sns_sum_min = 0; 2995 u16 sns_sum_max = 0; 2996 u16 clp_sum_max = 0; 2997 u16 sns_dir_to = 0; 2998 u16 ki_innergain_min = 0; 2999 u16 if_iaccu_hi_tgt = 0; 3000 u16 if_iaccu_hi_tgt_min = 0; 3001 u16 if_iaccu_hi_tgt_max = 0; 3002 u16 data = 0; 3003 u16 fast_clp_ctrl_delay = 0; 3004 u16 clp_ctrl_mode = 0; 3005 int status = 0; 3006 3007 dprintk(1, "\n"); 3008 3009 /* Common settings */ 3010 sns_sum_max = 1023; 3011 if_iaccu_hi_tgt_min = 2047; 3012 clp_cyclen = 500; 3013 clp_sum_max = 1023; 3014 3015 /* AGCInit() not available for DVBT; init done in microcode */ 3016 if (!is_qam(state)) { 3017 pr_err("%s: mode %d is not DVB-C\n", 3018 __func__, state->m_operation_mode); 3019 return -EINVAL; 3020 } 3021 3022 /* FIXME: Analog TV AGC require different settings */ 3023 3024 /* Standard specific settings */ 3025 clp_sum_min = 8; 3026 clp_dir_to = (u16) -9; 3027 clp_ctrl_mode = 0; 3028 sns_sum_min = 8; 3029 sns_dir_to = (u16) -9; 3030 ki_innergain_min = (u16) -1030; 3031 if_iaccu_hi_tgt_max = 0x2380; 3032 if_iaccu_hi_tgt = 0x2380; 3033 ingain_tgt_min = 0x0511; 3034 ingain_tgt = 0x0511; 3035 ingain_tgt_max = 5119; 3036 fast_clp_ctrl_delay = state->m_qam_if_agc_cfg.fast_clip_ctrl_delay; 3037 3038 status = write16(state, SCU_RAM_AGC_FAST_CLP_CTRL_DELAY__A, 3039 fast_clp_ctrl_delay); 3040 if (status < 0) 3041 goto error; 3042 3043 status = write16(state, SCU_RAM_AGC_CLP_CTRL_MODE__A, clp_ctrl_mode); 3044 if (status < 0) 3045 goto error; 3046 status = write16(state, SCU_RAM_AGC_INGAIN_TGT__A, ingain_tgt); 3047 if (status < 0) 3048 goto error; 3049 status = write16(state, SCU_RAM_AGC_INGAIN_TGT_MIN__A, ingain_tgt_min); 3050 if (status < 0) 3051 goto error; 3052 status = write16(state, SCU_RAM_AGC_INGAIN_TGT_MAX__A, ingain_tgt_max); 3053 if (status < 0) 3054 goto error; 3055 status = write16(state, SCU_RAM_AGC_IF_IACCU_HI_TGT_MIN__A, 3056 if_iaccu_hi_tgt_min); 3057 if (status < 0) 3058 goto error; 3059 status = write16(state, SCU_RAM_AGC_IF_IACCU_HI_TGT_MAX__A, 3060 if_iaccu_hi_tgt_max); 3061 if (status < 0) 3062 goto error; 3063 status = write16(state, SCU_RAM_AGC_IF_IACCU_HI__A, 0); 3064 if (status < 0) 3065 goto error; 3066 status = write16(state, SCU_RAM_AGC_IF_IACCU_LO__A, 0); 3067 if (status < 0) 3068 goto error; 3069 status = write16(state, SCU_RAM_AGC_RF_IACCU_HI__A, 0); 3070 if (status < 0) 3071 goto error; 3072 status = write16(state, SCU_RAM_AGC_RF_IACCU_LO__A, 0); 3073 if (status < 0) 3074 goto error; 3075 status = write16(state, SCU_RAM_AGC_CLP_SUM_MAX__A, clp_sum_max); 3076 if (status < 0) 3077 goto error; 3078 status = write16(state, SCU_RAM_AGC_SNS_SUM_MAX__A, sns_sum_max); 3079 if (status < 0) 3080 goto error; 3081 3082 status = write16(state, SCU_RAM_AGC_KI_INNERGAIN_MIN__A, 3083 ki_innergain_min); 3084 if (status < 0) 3085 goto error; 3086 status = write16(state, SCU_RAM_AGC_IF_IACCU_HI_TGT__A, 3087 if_iaccu_hi_tgt); 3088 if (status < 0) 3089 goto error; 3090 status = write16(state, SCU_RAM_AGC_CLP_CYCLEN__A, clp_cyclen); 3091 if (status < 0) 3092 goto error; 3093 3094 status = write16(state, SCU_RAM_AGC_RF_SNS_DEV_MAX__A, 1023); 3095 if (status < 0) 3096 goto error; 3097 status = write16(state, SCU_RAM_AGC_RF_SNS_DEV_MIN__A, (u16) -1023); 3098 if (status < 0) 3099 goto error; 3100 status = write16(state, SCU_RAM_AGC_FAST_SNS_CTRL_DELAY__A, 50); 3101 if (status < 0) 3102 goto error; 3103 3104 status = write16(state, SCU_RAM_AGC_KI_MAXMINGAIN_TH__A, 20); 3105 if (status < 0) 3106 goto error; 3107 status = write16(state, SCU_RAM_AGC_CLP_SUM_MIN__A, clp_sum_min); 3108 if (status < 0) 3109 goto error; 3110 status = write16(state, SCU_RAM_AGC_SNS_SUM_MIN__A, sns_sum_min); 3111 if (status < 0) 3112 goto error; 3113 status = write16(state, SCU_RAM_AGC_CLP_DIR_TO__A, clp_dir_to); 3114 if (status < 0) 3115 goto error; 3116 status = write16(state, SCU_RAM_AGC_SNS_DIR_TO__A, sns_dir_to); 3117 if (status < 0) 3118 goto error; 3119 status = write16(state, SCU_RAM_AGC_KI_MINGAIN__A, 0x7fff); 3120 if (status < 0) 3121 goto error; 3122 status = write16(state, SCU_RAM_AGC_KI_MAXGAIN__A, 0x0); 3123 if (status < 0) 3124 goto error; 3125 status = write16(state, SCU_RAM_AGC_KI_MIN__A, 0x0117); 3126 if (status < 0) 3127 goto error; 3128 status = write16(state, SCU_RAM_AGC_KI_MAX__A, 0x0657); 3129 if (status < 0) 3130 goto error; 3131 status = write16(state, SCU_RAM_AGC_CLP_SUM__A, 0); 3132 if (status < 0) 3133 goto error; 3134 status = write16(state, SCU_RAM_AGC_CLP_CYCCNT__A, 0); 3135 if (status < 0) 3136 goto error; 3137 status = write16(state, SCU_RAM_AGC_CLP_DIR_WD__A, 0); 3138 if (status < 0) 3139 goto error; 3140 status = write16(state, SCU_RAM_AGC_CLP_DIR_STP__A, 1); 3141 if (status < 0) 3142 goto error; 3143 status = write16(state, SCU_RAM_AGC_SNS_SUM__A, 0); 3144 if (status < 0) 3145 goto error; 3146 status = write16(state, SCU_RAM_AGC_SNS_CYCCNT__A, 0); 3147 if (status < 0) 3148 goto error; 3149 status = write16(state, SCU_RAM_AGC_SNS_DIR_WD__A, 0); 3150 if (status < 0) 3151 goto error; 3152 status = write16(state, SCU_RAM_AGC_SNS_DIR_STP__A, 1); 3153 if (status < 0) 3154 goto error; 3155 status = write16(state, SCU_RAM_AGC_SNS_CYCLEN__A, 500); 3156 if (status < 0) 3157 goto error; 3158 status = write16(state, SCU_RAM_AGC_KI_CYCLEN__A, 500); 3159 if (status < 0) 3160 goto error; 3161 3162 /* Initialize inner-loop KI gain factors */ 3163 status = read16(state, SCU_RAM_AGC_KI__A, &data); 3164 if (status < 0) 3165 goto error; 3166 3167 data = 0x0657; 3168 data &= ~SCU_RAM_AGC_KI_RF__M; 3169 data |= (DRXK_KI_RAGC_QAM << SCU_RAM_AGC_KI_RF__B); 3170 data &= ~SCU_RAM_AGC_KI_IF__M; 3171 data |= (DRXK_KI_IAGC_QAM << SCU_RAM_AGC_KI_IF__B); 3172 3173 status = write16(state, SCU_RAM_AGC_KI__A, data); 3174 error: 3175 if (status < 0) 3176 pr_err("Error %d on %s\n", status, __func__); 3177 return status; 3178 } 3179 3180 static int dvbtqam_get_acc_pkt_err(struct drxk_state *state, u16 *packet_err) 3181 { 3182 int status; 3183 3184 dprintk(1, "\n"); 3185 if (packet_err == NULL) 3186 status = write16(state, SCU_RAM_FEC_ACCUM_PKT_FAILURES__A, 0); 3187 else 3188 status = read16(state, SCU_RAM_FEC_ACCUM_PKT_FAILURES__A, 3189 packet_err); 3190 if (status < 0) 3191 pr_err("Error %d on %s\n", status, __func__); 3192 return status; 3193 } 3194 3195 static int dvbt_sc_command(struct drxk_state *state, 3196 u16 cmd, u16 subcmd, 3197 u16 param0, u16 param1, u16 param2, 3198 u16 param3, u16 param4) 3199 { 3200 u16 cur_cmd = 0; 3201 u16 err_code = 0; 3202 u16 retry_cnt = 0; 3203 u16 sc_exec = 0; 3204 int status; 3205 3206 dprintk(1, "\n"); 3207 status = read16(state, OFDM_SC_COMM_EXEC__A, &sc_exec); 3208 if (sc_exec != 1) { 3209 /* SC is not running */ 3210 status = -EINVAL; 3211 } 3212 if (status < 0) 3213 goto error; 3214 3215 /* Wait until sc is ready to receive command */ 3216 retry_cnt = 0; 3217 do { 3218 usleep_range(1000, 2000); 3219 status = read16(state, OFDM_SC_RA_RAM_CMD__A, &cur_cmd); 3220 retry_cnt++; 3221 } while ((cur_cmd != 0) && (retry_cnt < DRXK_MAX_RETRIES)); 3222 if (retry_cnt >= DRXK_MAX_RETRIES && (status < 0)) 3223 goto error; 3224 3225 /* Write sub-command */ 3226 switch (cmd) { 3227 /* All commands using sub-cmd */ 3228 case OFDM_SC_RA_RAM_CMD_PROC_START: 3229 case OFDM_SC_RA_RAM_CMD_SET_PREF_PARAM: 3230 case OFDM_SC_RA_RAM_CMD_PROGRAM_PARAM: 3231 status = write16(state, OFDM_SC_RA_RAM_CMD_ADDR__A, subcmd); 3232 if (status < 0) 3233 goto error; 3234 break; 3235 default: 3236 /* Do nothing */ 3237 break; 3238 } 3239 3240 /* Write needed parameters and the command */ 3241 status = 0; 3242 switch (cmd) { 3243 /* All commands using 5 parameters */ 3244 /* All commands using 4 parameters */ 3245 /* All commands using 3 parameters */ 3246 /* All commands using 2 parameters */ 3247 case OFDM_SC_RA_RAM_CMD_PROC_START: 3248 case OFDM_SC_RA_RAM_CMD_SET_PREF_PARAM: 3249 case OFDM_SC_RA_RAM_CMD_PROGRAM_PARAM: 3250 status |= write16(state, OFDM_SC_RA_RAM_PARAM1__A, param1); 3251 fallthrough; /* All commands using 1 parameters */ 3252 case OFDM_SC_RA_RAM_CMD_SET_ECHO_TIMING: 3253 case OFDM_SC_RA_RAM_CMD_USER_IO: 3254 status |= write16(state, OFDM_SC_RA_RAM_PARAM0__A, param0); 3255 fallthrough; /* All commands using 0 parameters */ 3256 case OFDM_SC_RA_RAM_CMD_GET_OP_PARAM: 3257 case OFDM_SC_RA_RAM_CMD_NULL: 3258 /* Write command */ 3259 status |= write16(state, OFDM_SC_RA_RAM_CMD__A, cmd); 3260 break; 3261 default: 3262 /* Unknown command */ 3263 status = -EINVAL; 3264 } 3265 if (status < 0) 3266 goto error; 3267 3268 /* Wait until sc is ready processing command */ 3269 retry_cnt = 0; 3270 do { 3271 usleep_range(1000, 2000); 3272 status = read16(state, OFDM_SC_RA_RAM_CMD__A, &cur_cmd); 3273 retry_cnt++; 3274 } while ((cur_cmd != 0) && (retry_cnt < DRXK_MAX_RETRIES)); 3275 if (retry_cnt >= DRXK_MAX_RETRIES && (status < 0)) 3276 goto error; 3277 3278 /* Check for illegal cmd */ 3279 status = read16(state, OFDM_SC_RA_RAM_CMD_ADDR__A, &err_code); 3280 if (err_code == 0xFFFF) { 3281 /* illegal command */ 3282 status = -EINVAL; 3283 } 3284 if (status < 0) 3285 goto error; 3286 3287 /* Retrieve results parameters from SC */ 3288 switch (cmd) { 3289 /* All commands yielding 5 results */ 3290 /* All commands yielding 4 results */ 3291 /* All commands yielding 3 results */ 3292 /* All commands yielding 2 results */ 3293 /* All commands yielding 1 result */ 3294 case OFDM_SC_RA_RAM_CMD_USER_IO: 3295 case OFDM_SC_RA_RAM_CMD_GET_OP_PARAM: 3296 status = read16(state, OFDM_SC_RA_RAM_PARAM0__A, &(param0)); 3297 break; 3298 /* All commands yielding 0 results */ 3299 case OFDM_SC_RA_RAM_CMD_SET_ECHO_TIMING: 3300 case OFDM_SC_RA_RAM_CMD_SET_TIMER: 3301 case OFDM_SC_RA_RAM_CMD_PROC_START: 3302 case OFDM_SC_RA_RAM_CMD_SET_PREF_PARAM: 3303 case OFDM_SC_RA_RAM_CMD_PROGRAM_PARAM: 3304 case OFDM_SC_RA_RAM_CMD_NULL: 3305 break; 3306 default: 3307 /* Unknown command */ 3308 status = -EINVAL; 3309 break; 3310 } /* switch (cmd->cmd) */ 3311 error: 3312 if (status < 0) 3313 pr_err("Error %d on %s\n", status, __func__); 3314 return status; 3315 } 3316 3317 static int power_up_dvbt(struct drxk_state *state) 3318 { 3319 enum drx_power_mode power_mode = DRX_POWER_UP; 3320 int status; 3321 3322 dprintk(1, "\n"); 3323 status = ctrl_power_mode(state, &power_mode); 3324 if (status < 0) 3325 pr_err("Error %d on %s\n", status, __func__); 3326 return status; 3327 } 3328 3329 static int dvbt_ctrl_set_inc_enable(struct drxk_state *state, bool *enabled) 3330 { 3331 int status; 3332 3333 dprintk(1, "\n"); 3334 if (*enabled) 3335 status = write16(state, IQM_CF_BYPASSDET__A, 0); 3336 else 3337 status = write16(state, IQM_CF_BYPASSDET__A, 1); 3338 if (status < 0) 3339 pr_err("Error %d on %s\n", status, __func__); 3340 return status; 3341 } 3342 3343 #define DEFAULT_FR_THRES_8K 4000 3344 static int dvbt_ctrl_set_fr_enable(struct drxk_state *state, bool *enabled) 3345 { 3346 3347 int status; 3348 3349 dprintk(1, "\n"); 3350 if (*enabled) { 3351 /* write mask to 1 */ 3352 status = write16(state, OFDM_SC_RA_RAM_FR_THRES_8K__A, 3353 DEFAULT_FR_THRES_8K); 3354 } else { 3355 /* write mask to 0 */ 3356 status = write16(state, OFDM_SC_RA_RAM_FR_THRES_8K__A, 0); 3357 } 3358 if (status < 0) 3359 pr_err("Error %d on %s\n", status, __func__); 3360 3361 return status; 3362 } 3363 3364 static int dvbt_ctrl_set_echo_threshold(struct drxk_state *state, 3365 struct drxk_cfg_dvbt_echo_thres_t *echo_thres) 3366 { 3367 u16 data = 0; 3368 int status; 3369 3370 dprintk(1, "\n"); 3371 status = read16(state, OFDM_SC_RA_RAM_ECHO_THRES__A, &data); 3372 if (status < 0) 3373 goto error; 3374 3375 switch (echo_thres->fft_mode) { 3376 case DRX_FFTMODE_2K: 3377 data &= ~OFDM_SC_RA_RAM_ECHO_THRES_2K__M; 3378 data |= ((echo_thres->threshold << 3379 OFDM_SC_RA_RAM_ECHO_THRES_2K__B) 3380 & (OFDM_SC_RA_RAM_ECHO_THRES_2K__M)); 3381 break; 3382 case DRX_FFTMODE_8K: 3383 data &= ~OFDM_SC_RA_RAM_ECHO_THRES_8K__M; 3384 data |= ((echo_thres->threshold << 3385 OFDM_SC_RA_RAM_ECHO_THRES_8K__B) 3386 & (OFDM_SC_RA_RAM_ECHO_THRES_8K__M)); 3387 break; 3388 default: 3389 return -EINVAL; 3390 } 3391 3392 status = write16(state, OFDM_SC_RA_RAM_ECHO_THRES__A, data); 3393 error: 3394 if (status < 0) 3395 pr_err("Error %d on %s\n", status, __func__); 3396 return status; 3397 } 3398 3399 static int dvbt_ctrl_set_sqi_speed(struct drxk_state *state, 3400 enum drxk_cfg_dvbt_sqi_speed *speed) 3401 { 3402 int status = -EINVAL; 3403 3404 dprintk(1, "\n"); 3405 3406 switch (*speed) { 3407 case DRXK_DVBT_SQI_SPEED_FAST: 3408 case DRXK_DVBT_SQI_SPEED_MEDIUM: 3409 case DRXK_DVBT_SQI_SPEED_SLOW: 3410 break; 3411 default: 3412 goto error; 3413 } 3414 status = write16(state, SCU_RAM_FEC_PRE_RS_BER_FILTER_SH__A, 3415 (u16) *speed); 3416 error: 3417 if (status < 0) 3418 pr_err("Error %d on %s\n", status, __func__); 3419 return status; 3420 } 3421 3422 /*============================================================================*/ 3423 3424 /* 3425 * \brief Activate DVBT specific presets 3426 * \param demod instance of demodulator. 3427 * \return DRXStatus_t. 3428 * 3429 * Called in DVBTSetStandard 3430 * 3431 */ 3432 static int dvbt_activate_presets(struct drxk_state *state) 3433 { 3434 int status; 3435 bool setincenable = false; 3436 bool setfrenable = true; 3437 3438 struct drxk_cfg_dvbt_echo_thres_t echo_thres2k = { 0, DRX_FFTMODE_2K }; 3439 struct drxk_cfg_dvbt_echo_thres_t echo_thres8k = { 0, DRX_FFTMODE_8K }; 3440 3441 dprintk(1, "\n"); 3442 status = dvbt_ctrl_set_inc_enable(state, &setincenable); 3443 if (status < 0) 3444 goto error; 3445 status = dvbt_ctrl_set_fr_enable(state, &setfrenable); 3446 if (status < 0) 3447 goto error; 3448 status = dvbt_ctrl_set_echo_threshold(state, &echo_thres2k); 3449 if (status < 0) 3450 goto error; 3451 status = dvbt_ctrl_set_echo_threshold(state, &echo_thres8k); 3452 if (status < 0) 3453 goto error; 3454 status = write16(state, SCU_RAM_AGC_INGAIN_TGT_MAX__A, 3455 state->m_dvbt_if_agc_cfg.ingain_tgt_max); 3456 error: 3457 if (status < 0) 3458 pr_err("Error %d on %s\n", status, __func__); 3459 return status; 3460 } 3461 3462 /*============================================================================*/ 3463 3464 /* 3465 * \brief Initialize channelswitch-independent settings for DVBT. 3466 * \param demod instance of demodulator. 3467 * \return DRXStatus_t. 3468 * 3469 * For ROM code channel filter taps are loaded from the bootloader. For microcode 3470 * the DVB-T taps from the drxk_filters.h are used. 3471 */ 3472 static int set_dvbt_standard(struct drxk_state *state, 3473 enum operation_mode o_mode) 3474 { 3475 u16 cmd_result = 0; 3476 u16 data = 0; 3477 int status; 3478 3479 dprintk(1, "\n"); 3480 3481 power_up_dvbt(state); 3482 /* added antenna switch */ 3483 switch_antenna_to_dvbt(state); 3484 /* send OFDM reset command */ 3485 status = scu_command(state, 3486 SCU_RAM_COMMAND_STANDARD_OFDM 3487 | SCU_RAM_COMMAND_CMD_DEMOD_RESET, 3488 0, NULL, 1, &cmd_result); 3489 if (status < 0) 3490 goto error; 3491 3492 /* send OFDM setenv command */ 3493 status = scu_command(state, SCU_RAM_COMMAND_STANDARD_OFDM 3494 | SCU_RAM_COMMAND_CMD_DEMOD_SET_ENV, 3495 0, NULL, 1, &cmd_result); 3496 if (status < 0) 3497 goto error; 3498 3499 /* reset datapath for OFDM, processors first */ 3500 status = write16(state, OFDM_SC_COMM_EXEC__A, OFDM_SC_COMM_EXEC_STOP); 3501 if (status < 0) 3502 goto error; 3503 status = write16(state, OFDM_LC_COMM_EXEC__A, OFDM_LC_COMM_EXEC_STOP); 3504 if (status < 0) 3505 goto error; 3506 status = write16(state, IQM_COMM_EXEC__A, IQM_COMM_EXEC_B_STOP); 3507 if (status < 0) 3508 goto error; 3509 3510 /* IQM setup */ 3511 /* synchronize on ofdstate->m_festart */ 3512 status = write16(state, IQM_AF_UPD_SEL__A, 1); 3513 if (status < 0) 3514 goto error; 3515 /* window size for clipping ADC detection */ 3516 status = write16(state, IQM_AF_CLP_LEN__A, 0); 3517 if (status < 0) 3518 goto error; 3519 /* window size for sense pre-SAW detection */ 3520 status = write16(state, IQM_AF_SNS_LEN__A, 0); 3521 if (status < 0) 3522 goto error; 3523 /* sense threshold for sense pre-SAW detection */ 3524 status = write16(state, IQM_AF_AMUX__A, IQM_AF_AMUX_SIGNAL2ADC); 3525 if (status < 0) 3526 goto error; 3527 status = set_iqm_af(state, true); 3528 if (status < 0) 3529 goto error; 3530 3531 status = write16(state, IQM_AF_AGC_RF__A, 0); 3532 if (status < 0) 3533 goto error; 3534 3535 /* Impulse noise cruncher setup */ 3536 status = write16(state, IQM_AF_INC_LCT__A, 0); /* crunch in IQM_CF */ 3537 if (status < 0) 3538 goto error; 3539 status = write16(state, IQM_CF_DET_LCT__A, 0); /* detect in IQM_CF */ 3540 if (status < 0) 3541 goto error; 3542 status = write16(state, IQM_CF_WND_LEN__A, 3); /* peak detector window length */ 3543 if (status < 0) 3544 goto error; 3545 3546 status = write16(state, IQM_RC_STRETCH__A, 16); 3547 if (status < 0) 3548 goto error; 3549 status = write16(state, IQM_CF_OUT_ENA__A, 0x4); /* enable output 2 */ 3550 if (status < 0) 3551 goto error; 3552 status = write16(state, IQM_CF_DS_ENA__A, 0x4); /* decimate output 2 */ 3553 if (status < 0) 3554 goto error; 3555 status = write16(state, IQM_CF_SCALE__A, 1600); 3556 if (status < 0) 3557 goto error; 3558 status = write16(state, IQM_CF_SCALE_SH__A, 0); 3559 if (status < 0) 3560 goto error; 3561 3562 /* virtual clipping threshold for clipping ADC detection */ 3563 status = write16(state, IQM_AF_CLP_TH__A, 448); 3564 if (status < 0) 3565 goto error; 3566 status = write16(state, IQM_CF_DATATH__A, 495); /* crunching threshold */ 3567 if (status < 0) 3568 goto error; 3569 3570 status = bl_chain_cmd(state, DRXK_BL_ROM_OFFSET_TAPS_DVBT, 3571 DRXK_BLCC_NR_ELEMENTS_TAPS, DRXK_BLC_TIMEOUT); 3572 if (status < 0) 3573 goto error; 3574 3575 status = write16(state, IQM_CF_PKDTH__A, 2); /* peak detector threshold */ 3576 if (status < 0) 3577 goto error; 3578 status = write16(state, IQM_CF_POW_MEAS_LEN__A, 2); 3579 if (status < 0) 3580 goto error; 3581 /* enable power measurement interrupt */ 3582 status = write16(state, IQM_CF_COMM_INT_MSK__A, 1); 3583 if (status < 0) 3584 goto error; 3585 status = write16(state, IQM_COMM_EXEC__A, IQM_COMM_EXEC_B_ACTIVE); 3586 if (status < 0) 3587 goto error; 3588 3589 /* IQM will not be reset from here, sync ADC and update/init AGC */ 3590 status = adc_synchronization(state); 3591 if (status < 0) 3592 goto error; 3593 status = set_pre_saw(state, &state->m_dvbt_pre_saw_cfg); 3594 if (status < 0) 3595 goto error; 3596 3597 /* Halt SCU to enable safe non-atomic accesses */ 3598 status = write16(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_HOLD); 3599 if (status < 0) 3600 goto error; 3601 3602 status = set_agc_rf(state, &state->m_dvbt_rf_agc_cfg, true); 3603 if (status < 0) 3604 goto error; 3605 status = set_agc_if(state, &state->m_dvbt_if_agc_cfg, true); 3606 if (status < 0) 3607 goto error; 3608 3609 /* Set Noise Estimation notch width and enable DC fix */ 3610 status = read16(state, OFDM_SC_RA_RAM_CONFIG__A, &data); 3611 if (status < 0) 3612 goto error; 3613 data |= OFDM_SC_RA_RAM_CONFIG_NE_FIX_ENABLE__M; 3614 status = write16(state, OFDM_SC_RA_RAM_CONFIG__A, data); 3615 if (status < 0) 3616 goto error; 3617 3618 /* Activate SCU to enable SCU commands */ 3619 status = write16(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE); 3620 if (status < 0) 3621 goto error; 3622 3623 if (!state->m_drxk_a3_rom_code) { 3624 /* AGCInit() is not done for DVBT, so set agcfast_clip_ctrl_delay */ 3625 status = write16(state, SCU_RAM_AGC_FAST_CLP_CTRL_DELAY__A, 3626 state->m_dvbt_if_agc_cfg.fast_clip_ctrl_delay); 3627 if (status < 0) 3628 goto error; 3629 } 3630 3631 /* OFDM_SC setup */ 3632 #ifdef COMPILE_FOR_NONRT 3633 status = write16(state, OFDM_SC_RA_RAM_BE_OPT_DELAY__A, 1); 3634 if (status < 0) 3635 goto error; 3636 status = write16(state, OFDM_SC_RA_RAM_BE_OPT_INIT_DELAY__A, 2); 3637 if (status < 0) 3638 goto error; 3639 #endif 3640 3641 /* FEC setup */ 3642 status = write16(state, FEC_DI_INPUT_CTL__A, 1); /* OFDM input */ 3643 if (status < 0) 3644 goto error; 3645 3646 3647 #ifdef COMPILE_FOR_NONRT 3648 status = write16(state, FEC_RS_MEASUREMENT_PERIOD__A, 0x400); 3649 if (status < 0) 3650 goto error; 3651 #else 3652 status = write16(state, FEC_RS_MEASUREMENT_PERIOD__A, 0x1000); 3653 if (status < 0) 3654 goto error; 3655 #endif 3656 status = write16(state, FEC_RS_MEASUREMENT_PRESCALE__A, 0x0001); 3657 if (status < 0) 3658 goto error; 3659 3660 /* Setup MPEG bus */ 3661 status = mpegts_dto_setup(state, OM_DVBT); 3662 if (status < 0) 3663 goto error; 3664 /* Set DVBT Presets */ 3665 status = dvbt_activate_presets(state); 3666 if (status < 0) 3667 goto error; 3668 3669 error: 3670 if (status < 0) 3671 pr_err("Error %d on %s\n", status, __func__); 3672 return status; 3673 } 3674 3675 /*============================================================================*/ 3676 /* 3677 * \brief start dvbt demodulating for channel. 3678 * \param demod instance of demodulator. 3679 * \return DRXStatus_t. 3680 */ 3681 static int dvbt_start(struct drxk_state *state) 3682 { 3683 u16 param1; 3684 int status; 3685 /* drxk_ofdm_sc_cmd_t scCmd; */ 3686 3687 dprintk(1, "\n"); 3688 /* start correct processes to get in lock */ 3689 /* DRXK: OFDM_SC_RA_RAM_PROC_LOCKTRACK is no longer in mapfile! */ 3690 param1 = OFDM_SC_RA_RAM_LOCKTRACK_MIN; 3691 status = dvbt_sc_command(state, OFDM_SC_RA_RAM_CMD_PROC_START, 0, 3692 OFDM_SC_RA_RAM_SW_EVENT_RUN_NMASK__M, param1, 3693 0, 0, 0); 3694 if (status < 0) 3695 goto error; 3696 /* start FEC OC */ 3697 status = mpegts_start(state); 3698 if (status < 0) 3699 goto error; 3700 status = write16(state, FEC_COMM_EXEC__A, FEC_COMM_EXEC_ACTIVE); 3701 if (status < 0) 3702 goto error; 3703 error: 3704 if (status < 0) 3705 pr_err("Error %d on %s\n", status, __func__); 3706 return status; 3707 } 3708 3709 3710 /*============================================================================*/ 3711 3712 /* 3713 * \brief Set up dvbt demodulator for channel. 3714 * \param demod instance of demodulator. 3715 * \return DRXStatus_t. 3716 * // original DVBTSetChannel() 3717 */ 3718 static int set_dvbt(struct drxk_state *state, u16 intermediate_freqk_hz, 3719 s32 tuner_freq_offset) 3720 { 3721 u16 cmd_result = 0; 3722 u16 transmission_params = 0; 3723 u32 iqm_rc_rate_ofs = 0; 3724 u32 bandwidth = 0; 3725 u16 param1; 3726 int status; 3727 3728 dprintk(1, "IF =%d, TFO = %d\n", 3729 intermediate_freqk_hz, tuner_freq_offset); 3730 3731 status = scu_command(state, SCU_RAM_COMMAND_STANDARD_OFDM 3732 | SCU_RAM_COMMAND_CMD_DEMOD_STOP, 3733 0, NULL, 1, &cmd_result); 3734 if (status < 0) 3735 goto error; 3736 3737 /* Halt SCU to enable safe non-atomic accesses */ 3738 status = write16(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_HOLD); 3739 if (status < 0) 3740 goto error; 3741 3742 /* Stop processors */ 3743 status = write16(state, OFDM_SC_COMM_EXEC__A, OFDM_SC_COMM_EXEC_STOP); 3744 if (status < 0) 3745 goto error; 3746 status = write16(state, OFDM_LC_COMM_EXEC__A, OFDM_LC_COMM_EXEC_STOP); 3747 if (status < 0) 3748 goto error; 3749 3750 /* Mandatory fix, always stop CP, required to set spl offset back to 3751 hardware default (is set to 0 by ucode during pilot detection */ 3752 status = write16(state, OFDM_CP_COMM_EXEC__A, OFDM_CP_COMM_EXEC_STOP); 3753 if (status < 0) 3754 goto error; 3755 3756 /*== Write channel settings to device ================================*/ 3757 3758 /* mode */ 3759 switch (state->props.transmission_mode) { 3760 case TRANSMISSION_MODE_AUTO: 3761 case TRANSMISSION_MODE_8K: 3762 default: 3763 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_MODE_8K; 3764 break; 3765 case TRANSMISSION_MODE_2K: 3766 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_MODE_2K; 3767 break; 3768 } 3769 3770 /* guard */ 3771 switch (state->props.guard_interval) { 3772 default: 3773 case GUARD_INTERVAL_AUTO: /* try first guess DRX_GUARD_1DIV4 */ 3774 case GUARD_INTERVAL_1_4: 3775 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_GUARD_4; 3776 break; 3777 case GUARD_INTERVAL_1_32: 3778 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_GUARD_32; 3779 break; 3780 case GUARD_INTERVAL_1_16: 3781 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_GUARD_16; 3782 break; 3783 case GUARD_INTERVAL_1_8: 3784 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_GUARD_8; 3785 break; 3786 } 3787 3788 /* hierarchy */ 3789 switch (state->props.hierarchy) { 3790 case HIERARCHY_AUTO: 3791 case HIERARCHY_NONE: 3792 default: /* try first guess SC_RA_RAM_OP_PARAM_HIER_NO */ 3793 case HIERARCHY_1: 3794 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_HIER_A1; 3795 break; 3796 case HIERARCHY_2: 3797 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_HIER_A2; 3798 break; 3799 case HIERARCHY_4: 3800 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_HIER_A4; 3801 break; 3802 } 3803 3804 3805 /* modulation */ 3806 switch (state->props.modulation) { 3807 case QAM_AUTO: 3808 default: /* try first guess DRX_CONSTELLATION_QAM64 */ 3809 case QAM_64: 3810 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_CONST_QAM64; 3811 break; 3812 case QPSK: 3813 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_CONST_QPSK; 3814 break; 3815 case QAM_16: 3816 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_CONST_QAM16; 3817 break; 3818 } 3819 #if 0 3820 /* No hierarchical channels support in BDA */ 3821 /* Priority (only for hierarchical channels) */ 3822 switch (channel->priority) { 3823 case DRX_PRIORITY_LOW: 3824 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_PRIO_LO; 3825 WR16(dev_addr, OFDM_EC_SB_PRIOR__A, 3826 OFDM_EC_SB_PRIOR_LO); 3827 break; 3828 case DRX_PRIORITY_HIGH: 3829 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_PRIO_HI; 3830 WR16(dev_addr, OFDM_EC_SB_PRIOR__A, 3831 OFDM_EC_SB_PRIOR_HI)); 3832 break; 3833 case DRX_PRIORITY_UNKNOWN: 3834 default: 3835 status = -EINVAL; 3836 goto error; 3837 } 3838 #else 3839 /* Set Priority high */ 3840 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_PRIO_HI; 3841 status = write16(state, OFDM_EC_SB_PRIOR__A, OFDM_EC_SB_PRIOR_HI); 3842 if (status < 0) 3843 goto error; 3844 #endif 3845 3846 /* coderate */ 3847 switch (state->props.code_rate_HP) { 3848 case FEC_AUTO: 3849 default: /* try first guess DRX_CODERATE_2DIV3 */ 3850 case FEC_2_3: 3851 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_RATE_2_3; 3852 break; 3853 case FEC_1_2: 3854 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_RATE_1_2; 3855 break; 3856 case FEC_3_4: 3857 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_RATE_3_4; 3858 break; 3859 case FEC_5_6: 3860 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_RATE_5_6; 3861 break; 3862 case FEC_7_8: 3863 transmission_params |= OFDM_SC_RA_RAM_OP_PARAM_RATE_7_8; 3864 break; 3865 } 3866 3867 /* 3868 * SAW filter selection: normally not necessary, but if wanted 3869 * the application can select a SAW filter via the driver by 3870 * using UIOs 3871 */ 3872 3873 /* First determine real bandwidth (Hz) */ 3874 /* Also set delay for impulse noise cruncher */ 3875 /* 3876 * Also set parameters for EC_OC fix, note EC_OC_REG_TMD_HIL_MAR is 3877 * changed by SC for fix for some 8K,1/8 guard but is restored by 3878 * InitEC and ResetEC functions 3879 */ 3880 switch (state->props.bandwidth_hz) { 3881 case 0: 3882 state->props.bandwidth_hz = 8000000; 3883 fallthrough; 3884 case 8000000: 3885 bandwidth = DRXK_BANDWIDTH_8MHZ_IN_HZ; 3886 status = write16(state, OFDM_SC_RA_RAM_SRMM_FIX_FACT_8K__A, 3887 3052); 3888 if (status < 0) 3889 goto error; 3890 /* cochannel protection for PAL 8 MHz */ 3891 status = write16(state, OFDM_SC_RA_RAM_NI_INIT_8K_PER_LEFT__A, 3892 7); 3893 if (status < 0) 3894 goto error; 3895 status = write16(state, OFDM_SC_RA_RAM_NI_INIT_8K_PER_RIGHT__A, 3896 7); 3897 if (status < 0) 3898 goto error; 3899 status = write16(state, OFDM_SC_RA_RAM_NI_INIT_2K_PER_LEFT__A, 3900 7); 3901 if (status < 0) 3902 goto error; 3903 status = write16(state, OFDM_SC_RA_RAM_NI_INIT_2K_PER_RIGHT__A, 3904 1); 3905 if (status < 0) 3906 goto error; 3907 break; 3908 case 7000000: 3909 bandwidth = DRXK_BANDWIDTH_7MHZ_IN_HZ; 3910 status = write16(state, OFDM_SC_RA_RAM_SRMM_FIX_FACT_8K__A, 3911 3491); 3912 if (status < 0) 3913 goto error; 3914 /* cochannel protection for PAL 7 MHz */ 3915 status = write16(state, OFDM_SC_RA_RAM_NI_INIT_8K_PER_LEFT__A, 3916 8); 3917 if (status < 0) 3918 goto error; 3919 status = write16(state, OFDM_SC_RA_RAM_NI_INIT_8K_PER_RIGHT__A, 3920 8); 3921 if (status < 0) 3922 goto error; 3923 status = write16(state, OFDM_SC_RA_RAM_NI_INIT_2K_PER_LEFT__A, 3924 4); 3925 if (status < 0) 3926 goto error; 3927 status = write16(state, OFDM_SC_RA_RAM_NI_INIT_2K_PER_RIGHT__A, 3928 1); 3929 if (status < 0) 3930 goto error; 3931 break; 3932 case 6000000: 3933 bandwidth = DRXK_BANDWIDTH_6MHZ_IN_HZ; 3934 status = write16(state, OFDM_SC_RA_RAM_SRMM_FIX_FACT_8K__A, 3935 4073); 3936 if (status < 0) 3937 goto error; 3938 /* cochannel protection for NTSC 6 MHz */ 3939 status = write16(state, OFDM_SC_RA_RAM_NI_INIT_8K_PER_LEFT__A, 3940 19); 3941 if (status < 0) 3942 goto error; 3943 status = write16(state, OFDM_SC_RA_RAM_NI_INIT_8K_PER_RIGHT__A, 3944 19); 3945 if (status < 0) 3946 goto error; 3947 status = write16(state, OFDM_SC_RA_RAM_NI_INIT_2K_PER_LEFT__A, 3948 14); 3949 if (status < 0) 3950 goto error; 3951 status = write16(state, OFDM_SC_RA_RAM_NI_INIT_2K_PER_RIGHT__A, 3952 1); 3953 if (status < 0) 3954 goto error; 3955 break; 3956 default: 3957 status = -EINVAL; 3958 goto error; 3959 } 3960 3961 if (iqm_rc_rate_ofs == 0) { 3962 /* Now compute IQM_RC_RATE_OFS 3963 (((SysFreq/BandWidth)/2)/2) -1) * 2^23) 3964 => 3965 ((SysFreq / BandWidth) * (2^21)) - (2^23) 3966 */ 3967 /* (SysFreq / BandWidth) * (2^28) */ 3968 /* 3969 * assert (MAX(sysClk)/MIN(bandwidth) < 16) 3970 * => assert(MAX(sysClk) < 16*MIN(bandwidth)) 3971 * => assert(109714272 > 48000000) = true 3972 * so Frac 28 can be used 3973 */ 3974 iqm_rc_rate_ofs = Frac28a((u32) 3975 ((state->m_sys_clock_freq * 3976 1000) / 3), bandwidth); 3977 /* (SysFreq / BandWidth) * (2^21), rounding before truncating */ 3978 if ((iqm_rc_rate_ofs & 0x7fL) >= 0x40) 3979 iqm_rc_rate_ofs += 0x80L; 3980 iqm_rc_rate_ofs = iqm_rc_rate_ofs >> 7; 3981 /* ((SysFreq / BandWidth) * (2^21)) - (2^23) */ 3982 iqm_rc_rate_ofs = iqm_rc_rate_ofs - (1 << 23); 3983 } 3984 3985 iqm_rc_rate_ofs &= 3986 ((((u32) IQM_RC_RATE_OFS_HI__M) << 3987 IQM_RC_RATE_OFS_LO__W) | IQM_RC_RATE_OFS_LO__M); 3988 status = write32(state, IQM_RC_RATE_OFS_LO__A, iqm_rc_rate_ofs); 3989 if (status < 0) 3990 goto error; 3991 3992 /* Bandwidth setting done */ 3993 3994 #if 0 3995 status = dvbt_set_frequency_shift(demod, channel, tuner_offset); 3996 if (status < 0) 3997 goto error; 3998 #endif 3999 status = set_frequency_shifter(state, intermediate_freqk_hz, 4000 tuner_freq_offset, true); 4001 if (status < 0) 4002 goto error; 4003 4004 /*== start SC, write channel settings to SC ==========================*/ 4005 4006 /* Activate SCU to enable SCU commands */ 4007 status = write16(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE); 4008 if (status < 0) 4009 goto error; 4010 4011 /* Enable SC after setting all other parameters */ 4012 status = write16(state, OFDM_SC_COMM_STATE__A, 0); 4013 if (status < 0) 4014 goto error; 4015 status = write16(state, OFDM_SC_COMM_EXEC__A, 1); 4016 if (status < 0) 4017 goto error; 4018 4019 4020 status = scu_command(state, SCU_RAM_COMMAND_STANDARD_OFDM 4021 | SCU_RAM_COMMAND_CMD_DEMOD_START, 4022 0, NULL, 1, &cmd_result); 4023 if (status < 0) 4024 goto error; 4025 4026 /* Write SC parameter registers, set all AUTO flags in operation mode */ 4027 param1 = (OFDM_SC_RA_RAM_OP_AUTO_MODE__M | 4028 OFDM_SC_RA_RAM_OP_AUTO_GUARD__M | 4029 OFDM_SC_RA_RAM_OP_AUTO_CONST__M | 4030 OFDM_SC_RA_RAM_OP_AUTO_HIER__M | 4031 OFDM_SC_RA_RAM_OP_AUTO_RATE__M); 4032 status = dvbt_sc_command(state, OFDM_SC_RA_RAM_CMD_SET_PREF_PARAM, 4033 0, transmission_params, param1, 0, 0, 0); 4034 if (status < 0) 4035 goto error; 4036 4037 if (!state->m_drxk_a3_rom_code) 4038 status = dvbt_ctrl_set_sqi_speed(state, &state->m_sqi_speed); 4039 error: 4040 if (status < 0) 4041 pr_err("Error %d on %s\n", status, __func__); 4042 4043 return status; 4044 } 4045 4046 4047 /*============================================================================*/ 4048 4049 /* 4050 * \brief Retrieve lock status . 4051 * \param demod Pointer to demodulator instance. 4052 * \param lockStat Pointer to lock status structure. 4053 * \return DRXStatus_t. 4054 * 4055 */ 4056 static int get_dvbt_lock_status(struct drxk_state *state, u32 *p_lock_status) 4057 { 4058 int status; 4059 const u16 mpeg_lock_mask = (OFDM_SC_RA_RAM_LOCK_MPEG__M | 4060 OFDM_SC_RA_RAM_LOCK_FEC__M); 4061 const u16 fec_lock_mask = (OFDM_SC_RA_RAM_LOCK_FEC__M); 4062 const u16 demod_lock_mask = OFDM_SC_RA_RAM_LOCK_DEMOD__M; 4063 4064 u16 sc_ra_ram_lock = 0; 4065 u16 sc_comm_exec = 0; 4066 4067 dprintk(1, "\n"); 4068 4069 *p_lock_status = NOT_LOCKED; 4070 /* driver 0.9.0 */ 4071 /* Check if SC is running */ 4072 status = read16(state, OFDM_SC_COMM_EXEC__A, &sc_comm_exec); 4073 if (status < 0) 4074 goto end; 4075 if (sc_comm_exec == OFDM_SC_COMM_EXEC_STOP) 4076 goto end; 4077 4078 status = read16(state, OFDM_SC_RA_RAM_LOCK__A, &sc_ra_ram_lock); 4079 if (status < 0) 4080 goto end; 4081 4082 if ((sc_ra_ram_lock & mpeg_lock_mask) == mpeg_lock_mask) 4083 *p_lock_status = MPEG_LOCK; 4084 else if ((sc_ra_ram_lock & fec_lock_mask) == fec_lock_mask) 4085 *p_lock_status = FEC_LOCK; 4086 else if ((sc_ra_ram_lock & demod_lock_mask) == demod_lock_mask) 4087 *p_lock_status = DEMOD_LOCK; 4088 else if (sc_ra_ram_lock & OFDM_SC_RA_RAM_LOCK_NODVBT__M) 4089 *p_lock_status = NEVER_LOCK; 4090 end: 4091 if (status < 0) 4092 pr_err("Error %d on %s\n", status, __func__); 4093 4094 return status; 4095 } 4096 4097 static int power_up_qam(struct drxk_state *state) 4098 { 4099 enum drx_power_mode power_mode = DRXK_POWER_DOWN_OFDM; 4100 int status; 4101 4102 dprintk(1, "\n"); 4103 status = ctrl_power_mode(state, &power_mode); 4104 if (status < 0) 4105 pr_err("Error %d on %s\n", status, __func__); 4106 4107 return status; 4108 } 4109 4110 4111 /* Power Down QAM */ 4112 static int power_down_qam(struct drxk_state *state) 4113 { 4114 u16 data = 0; 4115 u16 cmd_result; 4116 int status = 0; 4117 4118 dprintk(1, "\n"); 4119 status = read16(state, SCU_COMM_EXEC__A, &data); 4120 if (status < 0) 4121 goto error; 4122 if (data == SCU_COMM_EXEC_ACTIVE) { 4123 /* 4124 STOP demodulator 4125 QAM and HW blocks 4126 */ 4127 /* stop all comstate->m_exec */ 4128 status = write16(state, QAM_COMM_EXEC__A, QAM_COMM_EXEC_STOP); 4129 if (status < 0) 4130 goto error; 4131 status = scu_command(state, SCU_RAM_COMMAND_STANDARD_QAM 4132 | SCU_RAM_COMMAND_CMD_DEMOD_STOP, 4133 0, NULL, 1, &cmd_result); 4134 if (status < 0) 4135 goto error; 4136 } 4137 /* powerdown AFE */ 4138 status = set_iqm_af(state, false); 4139 4140 error: 4141 if (status < 0) 4142 pr_err("Error %d on %s\n", status, __func__); 4143 4144 return status; 4145 } 4146 4147 /*============================================================================*/ 4148 4149 /* 4150 * \brief Setup of the QAM Measurement intervals for signal quality 4151 * \param demod instance of demod. 4152 * \param modulation current modulation. 4153 * \return DRXStatus_t. 4154 * 4155 * NOTE: 4156 * Take into account that for certain settings the errorcounters can overflow. 4157 * The implementation does not check this. 4158 * 4159 */ 4160 static int set_qam_measurement(struct drxk_state *state, 4161 enum e_drxk_constellation modulation, 4162 u32 symbol_rate) 4163 { 4164 u32 fec_bits_desired = 0; /* BER accounting period */ 4165 u32 fec_rs_period_total = 0; /* Total period */ 4166 u16 fec_rs_prescale = 0; /* ReedSolomon Measurement Prescale */ 4167 u16 fec_rs_period = 0; /* Value for corresponding I2C register */ 4168 int status = 0; 4169 4170 dprintk(1, "\n"); 4171 4172 fec_rs_prescale = 1; 4173 /* fec_bits_desired = symbol_rate [kHz] * 4174 FrameLenght [ms] * 4175 (modulation + 1) * 4176 SyncLoss (== 1) * 4177 ViterbiLoss (==1) 4178 */ 4179 switch (modulation) { 4180 case DRX_CONSTELLATION_QAM16: 4181 fec_bits_desired = 4 * symbol_rate; 4182 break; 4183 case DRX_CONSTELLATION_QAM32: 4184 fec_bits_desired = 5 * symbol_rate; 4185 break; 4186 case DRX_CONSTELLATION_QAM64: 4187 fec_bits_desired = 6 * symbol_rate; 4188 break; 4189 case DRX_CONSTELLATION_QAM128: 4190 fec_bits_desired = 7 * symbol_rate; 4191 break; 4192 case DRX_CONSTELLATION_QAM256: 4193 fec_bits_desired = 8 * symbol_rate; 4194 break; 4195 default: 4196 status = -EINVAL; 4197 } 4198 if (status < 0) 4199 goto error; 4200 4201 fec_bits_desired /= 1000; /* symbol_rate [Hz] -> symbol_rate [kHz] */ 4202 fec_bits_desired *= 500; /* meas. period [ms] */ 4203 4204 /* Annex A/C: bits/RsPeriod = 204 * 8 = 1632 */ 4205 /* fec_rs_period_total = fec_bits_desired / 1632 */ 4206 fec_rs_period_total = (fec_bits_desired / 1632UL) + 1; /* roughly ceil */ 4207 4208 /* fec_rs_period_total = fec_rs_prescale * fec_rs_period */ 4209 fec_rs_prescale = 1 + (u16) (fec_rs_period_total >> 16); 4210 if (fec_rs_prescale == 0) { 4211 /* Divide by zero (though impossible) */ 4212 status = -EINVAL; 4213 if (status < 0) 4214 goto error; 4215 } 4216 fec_rs_period = 4217 ((u16) fec_rs_period_total + 4218 (fec_rs_prescale >> 1)) / fec_rs_prescale; 4219 4220 /* write corresponding registers */ 4221 status = write16(state, FEC_RS_MEASUREMENT_PERIOD__A, fec_rs_period); 4222 if (status < 0) 4223 goto error; 4224 status = write16(state, FEC_RS_MEASUREMENT_PRESCALE__A, 4225 fec_rs_prescale); 4226 if (status < 0) 4227 goto error; 4228 status = write16(state, FEC_OC_SNC_FAIL_PERIOD__A, fec_rs_period); 4229 error: 4230 if (status < 0) 4231 pr_err("Error %d on %s\n", status, __func__); 4232 return status; 4233 } 4234 4235 static int set_qam16(struct drxk_state *state) 4236 { 4237 int status = 0; 4238 4239 dprintk(1, "\n"); 4240 /* QAM Equalizer Setup */ 4241 /* Equalizer */ 4242 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 13517); 4243 if (status < 0) 4244 goto error; 4245 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 13517); 4246 if (status < 0) 4247 goto error; 4248 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 13517); 4249 if (status < 0) 4250 goto error; 4251 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 13517); 4252 if (status < 0) 4253 goto error; 4254 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 13517); 4255 if (status < 0) 4256 goto error; 4257 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 13517); 4258 if (status < 0) 4259 goto error; 4260 /* Decision Feedback Equalizer */ 4261 status = write16(state, QAM_DQ_QUAL_FUN0__A, 2); 4262 if (status < 0) 4263 goto error; 4264 status = write16(state, QAM_DQ_QUAL_FUN1__A, 2); 4265 if (status < 0) 4266 goto error; 4267 status = write16(state, QAM_DQ_QUAL_FUN2__A, 2); 4268 if (status < 0) 4269 goto error; 4270 status = write16(state, QAM_DQ_QUAL_FUN3__A, 2); 4271 if (status < 0) 4272 goto error; 4273 status = write16(state, QAM_DQ_QUAL_FUN4__A, 2); 4274 if (status < 0) 4275 goto error; 4276 status = write16(state, QAM_DQ_QUAL_FUN5__A, 0); 4277 if (status < 0) 4278 goto error; 4279 4280 status = write16(state, QAM_SY_SYNC_HWM__A, 5); 4281 if (status < 0) 4282 goto error; 4283 status = write16(state, QAM_SY_SYNC_AWM__A, 4); 4284 if (status < 0) 4285 goto error; 4286 status = write16(state, QAM_SY_SYNC_LWM__A, 3); 4287 if (status < 0) 4288 goto error; 4289 4290 /* QAM Slicer Settings */ 4291 status = write16(state, SCU_RAM_QAM_SL_SIG_POWER__A, 4292 DRXK_QAM_SL_SIG_POWER_QAM16); 4293 if (status < 0) 4294 goto error; 4295 4296 /* QAM Loop Controller Coeficients */ 4297 status = write16(state, SCU_RAM_QAM_LC_CA_FINE__A, 15); 4298 if (status < 0) 4299 goto error; 4300 status = write16(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40); 4301 if (status < 0) 4302 goto error; 4303 status = write16(state, SCU_RAM_QAM_LC_EP_FINE__A, 12); 4304 if (status < 0) 4305 goto error; 4306 status = write16(state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24); 4307 if (status < 0) 4308 goto error; 4309 status = write16(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24); 4310 if (status < 0) 4311 goto error; 4312 status = write16(state, SCU_RAM_QAM_LC_EI_FINE__A, 12); 4313 if (status < 0) 4314 goto error; 4315 status = write16(state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16); 4316 if (status < 0) 4317 goto error; 4318 status = write16(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16); 4319 if (status < 0) 4320 goto error; 4321 4322 status = write16(state, SCU_RAM_QAM_LC_CP_FINE__A, 5); 4323 if (status < 0) 4324 goto error; 4325 status = write16(state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 20); 4326 if (status < 0) 4327 goto error; 4328 status = write16(state, SCU_RAM_QAM_LC_CP_COARSE__A, 80); 4329 if (status < 0) 4330 goto error; 4331 status = write16(state, SCU_RAM_QAM_LC_CI_FINE__A, 5); 4332 if (status < 0) 4333 goto error; 4334 status = write16(state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 20); 4335 if (status < 0) 4336 goto error; 4337 status = write16(state, SCU_RAM_QAM_LC_CI_COARSE__A, 50); 4338 if (status < 0) 4339 goto error; 4340 status = write16(state, SCU_RAM_QAM_LC_CF_FINE__A, 16); 4341 if (status < 0) 4342 goto error; 4343 status = write16(state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 16); 4344 if (status < 0) 4345 goto error; 4346 status = write16(state, SCU_RAM_QAM_LC_CF_COARSE__A, 32); 4347 if (status < 0) 4348 goto error; 4349 status = write16(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5); 4350 if (status < 0) 4351 goto error; 4352 status = write16(state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10); 4353 if (status < 0) 4354 goto error; 4355 status = write16(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 10); 4356 if (status < 0) 4357 goto error; 4358 4359 4360 /* QAM State Machine (FSM) Thresholds */ 4361 4362 status = write16(state, SCU_RAM_QAM_FSM_RTH__A, 140); 4363 if (status < 0) 4364 goto error; 4365 status = write16(state, SCU_RAM_QAM_FSM_FTH__A, 50); 4366 if (status < 0) 4367 goto error; 4368 status = write16(state, SCU_RAM_QAM_FSM_CTH__A, 95); 4369 if (status < 0) 4370 goto error; 4371 status = write16(state, SCU_RAM_QAM_FSM_PTH__A, 120); 4372 if (status < 0) 4373 goto error; 4374 status = write16(state, SCU_RAM_QAM_FSM_QTH__A, 230); 4375 if (status < 0) 4376 goto error; 4377 status = write16(state, SCU_RAM_QAM_FSM_MTH__A, 105); 4378 if (status < 0) 4379 goto error; 4380 4381 status = write16(state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40); 4382 if (status < 0) 4383 goto error; 4384 status = write16(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 4); 4385 if (status < 0) 4386 goto error; 4387 status = write16(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 24); 4388 if (status < 0) 4389 goto error; 4390 4391 4392 /* QAM FSM Tracking Parameters */ 4393 4394 status = write16(state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, (u16) 16); 4395 if (status < 0) 4396 goto error; 4397 status = write16(state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, (u16) 220); 4398 if (status < 0) 4399 goto error; 4400 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, (u16) 25); 4401 if (status < 0) 4402 goto error; 4403 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, (u16) 6); 4404 if (status < 0) 4405 goto error; 4406 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16) -24); 4407 if (status < 0) 4408 goto error; 4409 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, (u16) -65); 4410 if (status < 0) 4411 goto error; 4412 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16) -127); 4413 if (status < 0) 4414 goto error; 4415 4416 error: 4417 if (status < 0) 4418 pr_err("Error %d on %s\n", status, __func__); 4419 return status; 4420 } 4421 4422 /*============================================================================*/ 4423 4424 /* 4425 * \brief QAM32 specific setup 4426 * \param demod instance of demod. 4427 * \return DRXStatus_t. 4428 */ 4429 static int set_qam32(struct drxk_state *state) 4430 { 4431 int status = 0; 4432 4433 dprintk(1, "\n"); 4434 4435 /* QAM Equalizer Setup */ 4436 /* Equalizer */ 4437 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 6707); 4438 if (status < 0) 4439 goto error; 4440 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 6707); 4441 if (status < 0) 4442 goto error; 4443 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 6707); 4444 if (status < 0) 4445 goto error; 4446 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 6707); 4447 if (status < 0) 4448 goto error; 4449 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 6707); 4450 if (status < 0) 4451 goto error; 4452 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 6707); 4453 if (status < 0) 4454 goto error; 4455 4456 /* Decision Feedback Equalizer */ 4457 status = write16(state, QAM_DQ_QUAL_FUN0__A, 3); 4458 if (status < 0) 4459 goto error; 4460 status = write16(state, QAM_DQ_QUAL_FUN1__A, 3); 4461 if (status < 0) 4462 goto error; 4463 status = write16(state, QAM_DQ_QUAL_FUN2__A, 3); 4464 if (status < 0) 4465 goto error; 4466 status = write16(state, QAM_DQ_QUAL_FUN3__A, 3); 4467 if (status < 0) 4468 goto error; 4469 status = write16(state, QAM_DQ_QUAL_FUN4__A, 3); 4470 if (status < 0) 4471 goto error; 4472 status = write16(state, QAM_DQ_QUAL_FUN5__A, 0); 4473 if (status < 0) 4474 goto error; 4475 4476 status = write16(state, QAM_SY_SYNC_HWM__A, 6); 4477 if (status < 0) 4478 goto error; 4479 status = write16(state, QAM_SY_SYNC_AWM__A, 5); 4480 if (status < 0) 4481 goto error; 4482 status = write16(state, QAM_SY_SYNC_LWM__A, 3); 4483 if (status < 0) 4484 goto error; 4485 4486 /* QAM Slicer Settings */ 4487 4488 status = write16(state, SCU_RAM_QAM_SL_SIG_POWER__A, 4489 DRXK_QAM_SL_SIG_POWER_QAM32); 4490 if (status < 0) 4491 goto error; 4492 4493 4494 /* QAM Loop Controller Coeficients */ 4495 4496 status = write16(state, SCU_RAM_QAM_LC_CA_FINE__A, 15); 4497 if (status < 0) 4498 goto error; 4499 status = write16(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40); 4500 if (status < 0) 4501 goto error; 4502 status = write16(state, SCU_RAM_QAM_LC_EP_FINE__A, 12); 4503 if (status < 0) 4504 goto error; 4505 status = write16(state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24); 4506 if (status < 0) 4507 goto error; 4508 status = write16(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24); 4509 if (status < 0) 4510 goto error; 4511 status = write16(state, SCU_RAM_QAM_LC_EI_FINE__A, 12); 4512 if (status < 0) 4513 goto error; 4514 status = write16(state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16); 4515 if (status < 0) 4516 goto error; 4517 status = write16(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16); 4518 if (status < 0) 4519 goto error; 4520 4521 status = write16(state, SCU_RAM_QAM_LC_CP_FINE__A, 5); 4522 if (status < 0) 4523 goto error; 4524 status = write16(state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 20); 4525 if (status < 0) 4526 goto error; 4527 status = write16(state, SCU_RAM_QAM_LC_CP_COARSE__A, 80); 4528 if (status < 0) 4529 goto error; 4530 status = write16(state, SCU_RAM_QAM_LC_CI_FINE__A, 5); 4531 if (status < 0) 4532 goto error; 4533 status = write16(state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 20); 4534 if (status < 0) 4535 goto error; 4536 status = write16(state, SCU_RAM_QAM_LC_CI_COARSE__A, 50); 4537 if (status < 0) 4538 goto error; 4539 status = write16(state, SCU_RAM_QAM_LC_CF_FINE__A, 16); 4540 if (status < 0) 4541 goto error; 4542 status = write16(state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 16); 4543 if (status < 0) 4544 goto error; 4545 status = write16(state, SCU_RAM_QAM_LC_CF_COARSE__A, 16); 4546 if (status < 0) 4547 goto error; 4548 status = write16(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5); 4549 if (status < 0) 4550 goto error; 4551 status = write16(state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10); 4552 if (status < 0) 4553 goto error; 4554 status = write16(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 0); 4555 if (status < 0) 4556 goto error; 4557 4558 4559 /* QAM State Machine (FSM) Thresholds */ 4560 4561 status = write16(state, SCU_RAM_QAM_FSM_RTH__A, 90); 4562 if (status < 0) 4563 goto error; 4564 status = write16(state, SCU_RAM_QAM_FSM_FTH__A, 50); 4565 if (status < 0) 4566 goto error; 4567 status = write16(state, SCU_RAM_QAM_FSM_CTH__A, 80); 4568 if (status < 0) 4569 goto error; 4570 status = write16(state, SCU_RAM_QAM_FSM_PTH__A, 100); 4571 if (status < 0) 4572 goto error; 4573 status = write16(state, SCU_RAM_QAM_FSM_QTH__A, 170); 4574 if (status < 0) 4575 goto error; 4576 status = write16(state, SCU_RAM_QAM_FSM_MTH__A, 100); 4577 if (status < 0) 4578 goto error; 4579 4580 status = write16(state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40); 4581 if (status < 0) 4582 goto error; 4583 status = write16(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 4); 4584 if (status < 0) 4585 goto error; 4586 status = write16(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 10); 4587 if (status < 0) 4588 goto error; 4589 4590 4591 /* QAM FSM Tracking Parameters */ 4592 4593 status = write16(state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, (u16) 12); 4594 if (status < 0) 4595 goto error; 4596 status = write16(state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, (u16) 140); 4597 if (status < 0) 4598 goto error; 4599 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, (u16) -8); 4600 if (status < 0) 4601 goto error; 4602 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, (u16) -16); 4603 if (status < 0) 4604 goto error; 4605 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16) -26); 4606 if (status < 0) 4607 goto error; 4608 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, (u16) -56); 4609 if (status < 0) 4610 goto error; 4611 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16) -86); 4612 error: 4613 if (status < 0) 4614 pr_err("Error %d on %s\n", status, __func__); 4615 return status; 4616 } 4617 4618 /*============================================================================*/ 4619 4620 /* 4621 * \brief QAM64 specific setup 4622 * \param demod instance of demod. 4623 * \return DRXStatus_t. 4624 */ 4625 static int set_qam64(struct drxk_state *state) 4626 { 4627 int status = 0; 4628 4629 dprintk(1, "\n"); 4630 /* QAM Equalizer Setup */ 4631 /* Equalizer */ 4632 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 13336); 4633 if (status < 0) 4634 goto error; 4635 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 12618); 4636 if (status < 0) 4637 goto error; 4638 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 11988); 4639 if (status < 0) 4640 goto error; 4641 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 13809); 4642 if (status < 0) 4643 goto error; 4644 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 13809); 4645 if (status < 0) 4646 goto error; 4647 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 15609); 4648 if (status < 0) 4649 goto error; 4650 4651 /* Decision Feedback Equalizer */ 4652 status = write16(state, QAM_DQ_QUAL_FUN0__A, 4); 4653 if (status < 0) 4654 goto error; 4655 status = write16(state, QAM_DQ_QUAL_FUN1__A, 4); 4656 if (status < 0) 4657 goto error; 4658 status = write16(state, QAM_DQ_QUAL_FUN2__A, 4); 4659 if (status < 0) 4660 goto error; 4661 status = write16(state, QAM_DQ_QUAL_FUN3__A, 4); 4662 if (status < 0) 4663 goto error; 4664 status = write16(state, QAM_DQ_QUAL_FUN4__A, 3); 4665 if (status < 0) 4666 goto error; 4667 status = write16(state, QAM_DQ_QUAL_FUN5__A, 0); 4668 if (status < 0) 4669 goto error; 4670 4671 status = write16(state, QAM_SY_SYNC_HWM__A, 5); 4672 if (status < 0) 4673 goto error; 4674 status = write16(state, QAM_SY_SYNC_AWM__A, 4); 4675 if (status < 0) 4676 goto error; 4677 status = write16(state, QAM_SY_SYNC_LWM__A, 3); 4678 if (status < 0) 4679 goto error; 4680 4681 /* QAM Slicer Settings */ 4682 status = write16(state, SCU_RAM_QAM_SL_SIG_POWER__A, 4683 DRXK_QAM_SL_SIG_POWER_QAM64); 4684 if (status < 0) 4685 goto error; 4686 4687 4688 /* QAM Loop Controller Coeficients */ 4689 4690 status = write16(state, SCU_RAM_QAM_LC_CA_FINE__A, 15); 4691 if (status < 0) 4692 goto error; 4693 status = write16(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40); 4694 if (status < 0) 4695 goto error; 4696 status = write16(state, SCU_RAM_QAM_LC_EP_FINE__A, 12); 4697 if (status < 0) 4698 goto error; 4699 status = write16(state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24); 4700 if (status < 0) 4701 goto error; 4702 status = write16(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24); 4703 if (status < 0) 4704 goto error; 4705 status = write16(state, SCU_RAM_QAM_LC_EI_FINE__A, 12); 4706 if (status < 0) 4707 goto error; 4708 status = write16(state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16); 4709 if (status < 0) 4710 goto error; 4711 status = write16(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16); 4712 if (status < 0) 4713 goto error; 4714 4715 status = write16(state, SCU_RAM_QAM_LC_CP_FINE__A, 5); 4716 if (status < 0) 4717 goto error; 4718 status = write16(state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 30); 4719 if (status < 0) 4720 goto error; 4721 status = write16(state, SCU_RAM_QAM_LC_CP_COARSE__A, 100); 4722 if (status < 0) 4723 goto error; 4724 status = write16(state, SCU_RAM_QAM_LC_CI_FINE__A, 5); 4725 if (status < 0) 4726 goto error; 4727 status = write16(state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 30); 4728 if (status < 0) 4729 goto error; 4730 status = write16(state, SCU_RAM_QAM_LC_CI_COARSE__A, 50); 4731 if (status < 0) 4732 goto error; 4733 status = write16(state, SCU_RAM_QAM_LC_CF_FINE__A, 16); 4734 if (status < 0) 4735 goto error; 4736 status = write16(state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 25); 4737 if (status < 0) 4738 goto error; 4739 status = write16(state, SCU_RAM_QAM_LC_CF_COARSE__A, 48); 4740 if (status < 0) 4741 goto error; 4742 status = write16(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5); 4743 if (status < 0) 4744 goto error; 4745 status = write16(state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10); 4746 if (status < 0) 4747 goto error; 4748 status = write16(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 10); 4749 if (status < 0) 4750 goto error; 4751 4752 4753 /* QAM State Machine (FSM) Thresholds */ 4754 4755 status = write16(state, SCU_RAM_QAM_FSM_RTH__A, 100); 4756 if (status < 0) 4757 goto error; 4758 status = write16(state, SCU_RAM_QAM_FSM_FTH__A, 60); 4759 if (status < 0) 4760 goto error; 4761 status = write16(state, SCU_RAM_QAM_FSM_CTH__A, 80); 4762 if (status < 0) 4763 goto error; 4764 status = write16(state, SCU_RAM_QAM_FSM_PTH__A, 110); 4765 if (status < 0) 4766 goto error; 4767 status = write16(state, SCU_RAM_QAM_FSM_QTH__A, 200); 4768 if (status < 0) 4769 goto error; 4770 status = write16(state, SCU_RAM_QAM_FSM_MTH__A, 95); 4771 if (status < 0) 4772 goto error; 4773 4774 status = write16(state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40); 4775 if (status < 0) 4776 goto error; 4777 status = write16(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 4); 4778 if (status < 0) 4779 goto error; 4780 status = write16(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 15); 4781 if (status < 0) 4782 goto error; 4783 4784 4785 /* QAM FSM Tracking Parameters */ 4786 4787 status = write16(state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, (u16) 12); 4788 if (status < 0) 4789 goto error; 4790 status = write16(state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, (u16) 141); 4791 if (status < 0) 4792 goto error; 4793 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, (u16) 7); 4794 if (status < 0) 4795 goto error; 4796 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, (u16) 0); 4797 if (status < 0) 4798 goto error; 4799 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16) -15); 4800 if (status < 0) 4801 goto error; 4802 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, (u16) -45); 4803 if (status < 0) 4804 goto error; 4805 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16) -80); 4806 error: 4807 if (status < 0) 4808 pr_err("Error %d on %s\n", status, __func__); 4809 4810 return status; 4811 } 4812 4813 /*============================================================================*/ 4814 4815 /* 4816 * \brief QAM128 specific setup 4817 * \param demod: instance of demod. 4818 * \return DRXStatus_t. 4819 */ 4820 static int set_qam128(struct drxk_state *state) 4821 { 4822 int status = 0; 4823 4824 dprintk(1, "\n"); 4825 /* QAM Equalizer Setup */ 4826 /* Equalizer */ 4827 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 6564); 4828 if (status < 0) 4829 goto error; 4830 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 6598); 4831 if (status < 0) 4832 goto error; 4833 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 6394); 4834 if (status < 0) 4835 goto error; 4836 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 6409); 4837 if (status < 0) 4838 goto error; 4839 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 6656); 4840 if (status < 0) 4841 goto error; 4842 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 7238); 4843 if (status < 0) 4844 goto error; 4845 4846 /* Decision Feedback Equalizer */ 4847 status = write16(state, QAM_DQ_QUAL_FUN0__A, 6); 4848 if (status < 0) 4849 goto error; 4850 status = write16(state, QAM_DQ_QUAL_FUN1__A, 6); 4851 if (status < 0) 4852 goto error; 4853 status = write16(state, QAM_DQ_QUAL_FUN2__A, 6); 4854 if (status < 0) 4855 goto error; 4856 status = write16(state, QAM_DQ_QUAL_FUN3__A, 6); 4857 if (status < 0) 4858 goto error; 4859 status = write16(state, QAM_DQ_QUAL_FUN4__A, 5); 4860 if (status < 0) 4861 goto error; 4862 status = write16(state, QAM_DQ_QUAL_FUN5__A, 0); 4863 if (status < 0) 4864 goto error; 4865 4866 status = write16(state, QAM_SY_SYNC_HWM__A, 6); 4867 if (status < 0) 4868 goto error; 4869 status = write16(state, QAM_SY_SYNC_AWM__A, 5); 4870 if (status < 0) 4871 goto error; 4872 status = write16(state, QAM_SY_SYNC_LWM__A, 3); 4873 if (status < 0) 4874 goto error; 4875 4876 4877 /* QAM Slicer Settings */ 4878 4879 status = write16(state, SCU_RAM_QAM_SL_SIG_POWER__A, 4880 DRXK_QAM_SL_SIG_POWER_QAM128); 4881 if (status < 0) 4882 goto error; 4883 4884 4885 /* QAM Loop Controller Coeficients */ 4886 4887 status = write16(state, SCU_RAM_QAM_LC_CA_FINE__A, 15); 4888 if (status < 0) 4889 goto error; 4890 status = write16(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40); 4891 if (status < 0) 4892 goto error; 4893 status = write16(state, SCU_RAM_QAM_LC_EP_FINE__A, 12); 4894 if (status < 0) 4895 goto error; 4896 status = write16(state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24); 4897 if (status < 0) 4898 goto error; 4899 status = write16(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24); 4900 if (status < 0) 4901 goto error; 4902 status = write16(state, SCU_RAM_QAM_LC_EI_FINE__A, 12); 4903 if (status < 0) 4904 goto error; 4905 status = write16(state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16); 4906 if (status < 0) 4907 goto error; 4908 status = write16(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16); 4909 if (status < 0) 4910 goto error; 4911 4912 status = write16(state, SCU_RAM_QAM_LC_CP_FINE__A, 5); 4913 if (status < 0) 4914 goto error; 4915 status = write16(state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 40); 4916 if (status < 0) 4917 goto error; 4918 status = write16(state, SCU_RAM_QAM_LC_CP_COARSE__A, 120); 4919 if (status < 0) 4920 goto error; 4921 status = write16(state, SCU_RAM_QAM_LC_CI_FINE__A, 5); 4922 if (status < 0) 4923 goto error; 4924 status = write16(state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 40); 4925 if (status < 0) 4926 goto error; 4927 status = write16(state, SCU_RAM_QAM_LC_CI_COARSE__A, 60); 4928 if (status < 0) 4929 goto error; 4930 status = write16(state, SCU_RAM_QAM_LC_CF_FINE__A, 16); 4931 if (status < 0) 4932 goto error; 4933 status = write16(state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 25); 4934 if (status < 0) 4935 goto error; 4936 status = write16(state, SCU_RAM_QAM_LC_CF_COARSE__A, 64); 4937 if (status < 0) 4938 goto error; 4939 status = write16(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5); 4940 if (status < 0) 4941 goto error; 4942 status = write16(state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10); 4943 if (status < 0) 4944 goto error; 4945 status = write16(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 0); 4946 if (status < 0) 4947 goto error; 4948 4949 4950 /* QAM State Machine (FSM) Thresholds */ 4951 4952 status = write16(state, SCU_RAM_QAM_FSM_RTH__A, 50); 4953 if (status < 0) 4954 goto error; 4955 status = write16(state, SCU_RAM_QAM_FSM_FTH__A, 60); 4956 if (status < 0) 4957 goto error; 4958 status = write16(state, SCU_RAM_QAM_FSM_CTH__A, 80); 4959 if (status < 0) 4960 goto error; 4961 status = write16(state, SCU_RAM_QAM_FSM_PTH__A, 100); 4962 if (status < 0) 4963 goto error; 4964 status = write16(state, SCU_RAM_QAM_FSM_QTH__A, 140); 4965 if (status < 0) 4966 goto error; 4967 status = write16(state, SCU_RAM_QAM_FSM_MTH__A, 100); 4968 if (status < 0) 4969 goto error; 4970 4971 status = write16(state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40); 4972 if (status < 0) 4973 goto error; 4974 status = write16(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 5); 4975 if (status < 0) 4976 goto error; 4977 4978 status = write16(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 12); 4979 if (status < 0) 4980 goto error; 4981 4982 /* QAM FSM Tracking Parameters */ 4983 4984 status = write16(state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, (u16) 8); 4985 if (status < 0) 4986 goto error; 4987 status = write16(state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, (u16) 65); 4988 if (status < 0) 4989 goto error; 4990 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, (u16) 5); 4991 if (status < 0) 4992 goto error; 4993 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, (u16) 3); 4994 if (status < 0) 4995 goto error; 4996 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16) -1); 4997 if (status < 0) 4998 goto error; 4999 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, (u16) -12); 5000 if (status < 0) 5001 goto error; 5002 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16) -23); 5003 error: 5004 if (status < 0) 5005 pr_err("Error %d on %s\n", status, __func__); 5006 5007 return status; 5008 } 5009 5010 /*============================================================================*/ 5011 5012 /* 5013 * \brief QAM256 specific setup 5014 * \param demod: instance of demod. 5015 * \return DRXStatus_t. 5016 */ 5017 static int set_qam256(struct drxk_state *state) 5018 { 5019 int status = 0; 5020 5021 dprintk(1, "\n"); 5022 /* QAM Equalizer Setup */ 5023 /* Equalizer */ 5024 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD0__A, 11502); 5025 if (status < 0) 5026 goto error; 5027 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD1__A, 12084); 5028 if (status < 0) 5029 goto error; 5030 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD2__A, 12543); 5031 if (status < 0) 5032 goto error; 5033 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD3__A, 12931); 5034 if (status < 0) 5035 goto error; 5036 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD4__A, 13629); 5037 if (status < 0) 5038 goto error; 5039 status = write16(state, SCU_RAM_QAM_EQ_CMA_RAD5__A, 15385); 5040 if (status < 0) 5041 goto error; 5042 5043 /* Decision Feedback Equalizer */ 5044 status = write16(state, QAM_DQ_QUAL_FUN0__A, 8); 5045 if (status < 0) 5046 goto error; 5047 status = write16(state, QAM_DQ_QUAL_FUN1__A, 8); 5048 if (status < 0) 5049 goto error; 5050 status = write16(state, QAM_DQ_QUAL_FUN2__A, 8); 5051 if (status < 0) 5052 goto error; 5053 status = write16(state, QAM_DQ_QUAL_FUN3__A, 8); 5054 if (status < 0) 5055 goto error; 5056 status = write16(state, QAM_DQ_QUAL_FUN4__A, 6); 5057 if (status < 0) 5058 goto error; 5059 status = write16(state, QAM_DQ_QUAL_FUN5__A, 0); 5060 if (status < 0) 5061 goto error; 5062 5063 status = write16(state, QAM_SY_SYNC_HWM__A, 5); 5064 if (status < 0) 5065 goto error; 5066 status = write16(state, QAM_SY_SYNC_AWM__A, 4); 5067 if (status < 0) 5068 goto error; 5069 status = write16(state, QAM_SY_SYNC_LWM__A, 3); 5070 if (status < 0) 5071 goto error; 5072 5073 /* QAM Slicer Settings */ 5074 5075 status = write16(state, SCU_RAM_QAM_SL_SIG_POWER__A, 5076 DRXK_QAM_SL_SIG_POWER_QAM256); 5077 if (status < 0) 5078 goto error; 5079 5080 5081 /* QAM Loop Controller Coeficients */ 5082 5083 status = write16(state, SCU_RAM_QAM_LC_CA_FINE__A, 15); 5084 if (status < 0) 5085 goto error; 5086 status = write16(state, SCU_RAM_QAM_LC_CA_COARSE__A, 40); 5087 if (status < 0) 5088 goto error; 5089 status = write16(state, SCU_RAM_QAM_LC_EP_FINE__A, 12); 5090 if (status < 0) 5091 goto error; 5092 status = write16(state, SCU_RAM_QAM_LC_EP_MEDIUM__A, 24); 5093 if (status < 0) 5094 goto error; 5095 status = write16(state, SCU_RAM_QAM_LC_EP_COARSE__A, 24); 5096 if (status < 0) 5097 goto error; 5098 status = write16(state, SCU_RAM_QAM_LC_EI_FINE__A, 12); 5099 if (status < 0) 5100 goto error; 5101 status = write16(state, SCU_RAM_QAM_LC_EI_MEDIUM__A, 16); 5102 if (status < 0) 5103 goto error; 5104 status = write16(state, SCU_RAM_QAM_LC_EI_COARSE__A, 16); 5105 if (status < 0) 5106 goto error; 5107 5108 status = write16(state, SCU_RAM_QAM_LC_CP_FINE__A, 5); 5109 if (status < 0) 5110 goto error; 5111 status = write16(state, SCU_RAM_QAM_LC_CP_MEDIUM__A, 50); 5112 if (status < 0) 5113 goto error; 5114 status = write16(state, SCU_RAM_QAM_LC_CP_COARSE__A, 250); 5115 if (status < 0) 5116 goto error; 5117 status = write16(state, SCU_RAM_QAM_LC_CI_FINE__A, 5); 5118 if (status < 0) 5119 goto error; 5120 status = write16(state, SCU_RAM_QAM_LC_CI_MEDIUM__A, 50); 5121 if (status < 0) 5122 goto error; 5123 status = write16(state, SCU_RAM_QAM_LC_CI_COARSE__A, 125); 5124 if (status < 0) 5125 goto error; 5126 status = write16(state, SCU_RAM_QAM_LC_CF_FINE__A, 16); 5127 if (status < 0) 5128 goto error; 5129 status = write16(state, SCU_RAM_QAM_LC_CF_MEDIUM__A, 25); 5130 if (status < 0) 5131 goto error; 5132 status = write16(state, SCU_RAM_QAM_LC_CF_COARSE__A, 48); 5133 if (status < 0) 5134 goto error; 5135 status = write16(state, SCU_RAM_QAM_LC_CF1_FINE__A, 5); 5136 if (status < 0) 5137 goto error; 5138 status = write16(state, SCU_RAM_QAM_LC_CF1_MEDIUM__A, 10); 5139 if (status < 0) 5140 goto error; 5141 status = write16(state, SCU_RAM_QAM_LC_CF1_COARSE__A, 10); 5142 if (status < 0) 5143 goto error; 5144 5145 5146 /* QAM State Machine (FSM) Thresholds */ 5147 5148 status = write16(state, SCU_RAM_QAM_FSM_RTH__A, 50); 5149 if (status < 0) 5150 goto error; 5151 status = write16(state, SCU_RAM_QAM_FSM_FTH__A, 60); 5152 if (status < 0) 5153 goto error; 5154 status = write16(state, SCU_RAM_QAM_FSM_CTH__A, 80); 5155 if (status < 0) 5156 goto error; 5157 status = write16(state, SCU_RAM_QAM_FSM_PTH__A, 100); 5158 if (status < 0) 5159 goto error; 5160 status = write16(state, SCU_RAM_QAM_FSM_QTH__A, 150); 5161 if (status < 0) 5162 goto error; 5163 status = write16(state, SCU_RAM_QAM_FSM_MTH__A, 110); 5164 if (status < 0) 5165 goto error; 5166 5167 status = write16(state, SCU_RAM_QAM_FSM_RATE_LIM__A, 40); 5168 if (status < 0) 5169 goto error; 5170 status = write16(state, SCU_RAM_QAM_FSM_COUNT_LIM__A, 4); 5171 if (status < 0) 5172 goto error; 5173 status = write16(state, SCU_RAM_QAM_FSM_FREQ_LIM__A, 12); 5174 if (status < 0) 5175 goto error; 5176 5177 5178 /* QAM FSM Tracking Parameters */ 5179 5180 status = write16(state, SCU_RAM_QAM_FSM_MEDIAN_AV_MULT__A, (u16) 8); 5181 if (status < 0) 5182 goto error; 5183 status = write16(state, SCU_RAM_QAM_FSM_RADIUS_AV_LIMIT__A, (u16) 74); 5184 if (status < 0) 5185 goto error; 5186 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET1__A, (u16) 18); 5187 if (status < 0) 5188 goto error; 5189 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET2__A, (u16) 13); 5190 if (status < 0) 5191 goto error; 5192 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET3__A, (u16) 7); 5193 if (status < 0) 5194 goto error; 5195 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET4__A, (u16) 0); 5196 if (status < 0) 5197 goto error; 5198 status = write16(state, SCU_RAM_QAM_FSM_LCAVG_OFFSET5__A, (u16) -8); 5199 error: 5200 if (status < 0) 5201 pr_err("Error %d on %s\n", status, __func__); 5202 return status; 5203 } 5204 5205 5206 /*============================================================================*/ 5207 /* 5208 * \brief Reset QAM block. 5209 * \param demod: instance of demod. 5210 * \param channel: pointer to channel data. 5211 * \return DRXStatus_t. 5212 */ 5213 static int qam_reset_qam(struct drxk_state *state) 5214 { 5215 int status; 5216 u16 cmd_result; 5217 5218 dprintk(1, "\n"); 5219 /* Stop QAM comstate->m_exec */ 5220 status = write16(state, QAM_COMM_EXEC__A, QAM_COMM_EXEC_STOP); 5221 if (status < 0) 5222 goto error; 5223 5224 status = scu_command(state, SCU_RAM_COMMAND_STANDARD_QAM 5225 | SCU_RAM_COMMAND_CMD_DEMOD_RESET, 5226 0, NULL, 1, &cmd_result); 5227 error: 5228 if (status < 0) 5229 pr_err("Error %d on %s\n", status, __func__); 5230 return status; 5231 } 5232 5233 /*============================================================================*/ 5234 5235 /* 5236 * \brief Set QAM symbolrate. 5237 * \param demod: instance of demod. 5238 * \param channel: pointer to channel data. 5239 * \return DRXStatus_t. 5240 */ 5241 static int qam_set_symbolrate(struct drxk_state *state) 5242 { 5243 u32 adc_frequency = 0; 5244 u32 symb_freq = 0; 5245 u32 iqm_rc_rate = 0; 5246 u16 ratesel = 0; 5247 u32 lc_symb_rate = 0; 5248 int status; 5249 5250 dprintk(1, "\n"); 5251 /* Select & calculate correct IQM rate */ 5252 adc_frequency = (state->m_sys_clock_freq * 1000) / 3; 5253 ratesel = 0; 5254 if (state->props.symbol_rate <= 1188750) 5255 ratesel = 3; 5256 else if (state->props.symbol_rate <= 2377500) 5257 ratesel = 2; 5258 else if (state->props.symbol_rate <= 4755000) 5259 ratesel = 1; 5260 status = write16(state, IQM_FD_RATESEL__A, ratesel); 5261 if (status < 0) 5262 goto error; 5263 5264 /* 5265 IqmRcRate = ((Fadc / (symbolrate * (4<<ratesel))) - 1) * (1<<23) 5266 */ 5267 symb_freq = state->props.symbol_rate * (1 << ratesel); 5268 if (symb_freq == 0) { 5269 /* Divide by zero */ 5270 status = -EINVAL; 5271 goto error; 5272 } 5273 iqm_rc_rate = (adc_frequency / symb_freq) * (1 << 21) + 5274 (Frac28a((adc_frequency % symb_freq), symb_freq) >> 7) - 5275 (1 << 23); 5276 status = write32(state, IQM_RC_RATE_OFS_LO__A, iqm_rc_rate); 5277 if (status < 0) 5278 goto error; 5279 state->m_iqm_rc_rate = iqm_rc_rate; 5280 /* 5281 LcSymbFreq = round (.125 * symbolrate / adc_freq * (1<<15)) 5282 */ 5283 symb_freq = state->props.symbol_rate; 5284 if (adc_frequency == 0) { 5285 /* Divide by zero */ 5286 status = -EINVAL; 5287 goto error; 5288 } 5289 lc_symb_rate = (symb_freq / adc_frequency) * (1 << 12) + 5290 (Frac28a((symb_freq % adc_frequency), adc_frequency) >> 5291 16); 5292 if (lc_symb_rate > 511) 5293 lc_symb_rate = 511; 5294 status = write16(state, QAM_LC_SYMBOL_FREQ__A, (u16) lc_symb_rate); 5295 5296 error: 5297 if (status < 0) 5298 pr_err("Error %d on %s\n", status, __func__); 5299 return status; 5300 } 5301 5302 /*============================================================================*/ 5303 5304 /* 5305 * \brief Get QAM lock status. 5306 * \param demod: instance of demod. 5307 * \param channel: pointer to channel data. 5308 * \return DRXStatus_t. 5309 */ 5310 5311 static int get_qam_lock_status(struct drxk_state *state, u32 *p_lock_status) 5312 { 5313 int status; 5314 u16 result[2] = { 0, 0 }; 5315 5316 dprintk(1, "\n"); 5317 *p_lock_status = NOT_LOCKED; 5318 status = scu_command(state, 5319 SCU_RAM_COMMAND_STANDARD_QAM | 5320 SCU_RAM_COMMAND_CMD_DEMOD_GET_LOCK, 0, NULL, 2, 5321 result); 5322 if (status < 0) 5323 pr_err("Error %d on %s\n", status, __func__); 5324 5325 if (result[1] < SCU_RAM_QAM_LOCKED_LOCKED_DEMOD_LOCKED) { 5326 /* 0x0000 NOT LOCKED */ 5327 } else if (result[1] < SCU_RAM_QAM_LOCKED_LOCKED_LOCKED) { 5328 /* 0x4000 DEMOD LOCKED */ 5329 *p_lock_status = DEMOD_LOCK; 5330 } else if (result[1] < SCU_RAM_QAM_LOCKED_LOCKED_NEVER_LOCK) { 5331 /* 0x8000 DEMOD + FEC LOCKED (system lock) */ 5332 *p_lock_status = MPEG_LOCK; 5333 } else { 5334 /* 0xC000 NEVER LOCKED */ 5335 /* (system will never be able to lock to the signal) */ 5336 /* 5337 * TODO: check this, intermediate & standard specific lock 5338 * states are not taken into account here 5339 */ 5340 *p_lock_status = NEVER_LOCK; 5341 } 5342 return status; 5343 } 5344 5345 #define QAM_MIRROR__M 0x03 5346 #define QAM_MIRROR_NORMAL 0x00 5347 #define QAM_MIRRORED 0x01 5348 #define QAM_MIRROR_AUTO_ON 0x02 5349 #define QAM_LOCKRANGE__M 0x10 5350 #define QAM_LOCKRANGE_NORMAL 0x10 5351 5352 static int qam_demodulator_command(struct drxk_state *state, 5353 int number_of_parameters) 5354 { 5355 int status; 5356 u16 cmd_result; 5357 u16 set_param_parameters[4] = { 0, 0, 0, 0 }; 5358 5359 set_param_parameters[0] = state->m_constellation; /* modulation */ 5360 set_param_parameters[1] = DRXK_QAM_I12_J17; /* interleave mode */ 5361 5362 if (number_of_parameters == 2) { 5363 u16 set_env_parameters[1] = { 0 }; 5364 5365 if (state->m_operation_mode == OM_QAM_ITU_C) 5366 set_env_parameters[0] = QAM_TOP_ANNEX_C; 5367 else 5368 set_env_parameters[0] = QAM_TOP_ANNEX_A; 5369 5370 status = scu_command(state, 5371 SCU_RAM_COMMAND_STANDARD_QAM 5372 | SCU_RAM_COMMAND_CMD_DEMOD_SET_ENV, 5373 1, set_env_parameters, 1, &cmd_result); 5374 if (status < 0) 5375 goto error; 5376 5377 status = scu_command(state, 5378 SCU_RAM_COMMAND_STANDARD_QAM 5379 | SCU_RAM_COMMAND_CMD_DEMOD_SET_PARAM, 5380 number_of_parameters, set_param_parameters, 5381 1, &cmd_result); 5382 } else if (number_of_parameters == 4) { 5383 if (state->m_operation_mode == OM_QAM_ITU_C) 5384 set_param_parameters[2] = QAM_TOP_ANNEX_C; 5385 else 5386 set_param_parameters[2] = QAM_TOP_ANNEX_A; 5387 5388 set_param_parameters[3] |= (QAM_MIRROR_AUTO_ON); 5389 /* Env parameters */ 5390 /* check for LOCKRANGE Extended */ 5391 /* set_param_parameters[3] |= QAM_LOCKRANGE_NORMAL; */ 5392 5393 status = scu_command(state, 5394 SCU_RAM_COMMAND_STANDARD_QAM 5395 | SCU_RAM_COMMAND_CMD_DEMOD_SET_PARAM, 5396 number_of_parameters, set_param_parameters, 5397 1, &cmd_result); 5398 } else { 5399 pr_warn("Unknown QAM demodulator parameter count %d\n", 5400 number_of_parameters); 5401 status = -EINVAL; 5402 } 5403 5404 error: 5405 if (status < 0) 5406 pr_warn("Warning %d on %s\n", status, __func__); 5407 return status; 5408 } 5409 5410 static int set_qam(struct drxk_state *state, u16 intermediate_freqk_hz, 5411 s32 tuner_freq_offset) 5412 { 5413 int status; 5414 u16 cmd_result; 5415 int qam_demod_param_count = state->qam_demod_parameter_count; 5416 5417 dprintk(1, "\n"); 5418 /* 5419 * STEP 1: reset demodulator 5420 * resets FEC DI and FEC RS 5421 * resets QAM block 5422 * resets SCU variables 5423 */ 5424 status = write16(state, FEC_DI_COMM_EXEC__A, FEC_DI_COMM_EXEC_STOP); 5425 if (status < 0) 5426 goto error; 5427 status = write16(state, FEC_RS_COMM_EXEC__A, FEC_RS_COMM_EXEC_STOP); 5428 if (status < 0) 5429 goto error; 5430 status = qam_reset_qam(state); 5431 if (status < 0) 5432 goto error; 5433 5434 /* 5435 * STEP 2: configure demodulator 5436 * -set params; resets IQM,QAM,FEC HW; initializes some 5437 * SCU variables 5438 */ 5439 status = qam_set_symbolrate(state); 5440 if (status < 0) 5441 goto error; 5442 5443 /* Set params */ 5444 switch (state->props.modulation) { 5445 case QAM_256: 5446 state->m_constellation = DRX_CONSTELLATION_QAM256; 5447 break; 5448 case QAM_AUTO: 5449 case QAM_64: 5450 state->m_constellation = DRX_CONSTELLATION_QAM64; 5451 break; 5452 case QAM_16: 5453 state->m_constellation = DRX_CONSTELLATION_QAM16; 5454 break; 5455 case QAM_32: 5456 state->m_constellation = DRX_CONSTELLATION_QAM32; 5457 break; 5458 case QAM_128: 5459 state->m_constellation = DRX_CONSTELLATION_QAM128; 5460 break; 5461 default: 5462 status = -EINVAL; 5463 break; 5464 } 5465 if (status < 0) 5466 goto error; 5467 5468 /* Use the 4-parameter if it's requested or we're probing for 5469 * the correct command. */ 5470 if (state->qam_demod_parameter_count == 4 5471 || !state->qam_demod_parameter_count) { 5472 qam_demod_param_count = 4; 5473 status = qam_demodulator_command(state, qam_demod_param_count); 5474 } 5475 5476 /* Use the 2-parameter command if it was requested or if we're 5477 * probing for the correct command and the 4-parameter command 5478 * failed. */ 5479 if (state->qam_demod_parameter_count == 2 5480 || (!state->qam_demod_parameter_count && status < 0)) { 5481 qam_demod_param_count = 2; 5482 status = qam_demodulator_command(state, qam_demod_param_count); 5483 } 5484 5485 if (status < 0) { 5486 dprintk(1, "Could not set demodulator parameters.\n"); 5487 dprintk(1, 5488 "Make sure qam_demod_parameter_count (%d) is correct for your firmware (%s).\n", 5489 state->qam_demod_parameter_count, 5490 state->microcode_name); 5491 goto error; 5492 } else if (!state->qam_demod_parameter_count) { 5493 dprintk(1, 5494 "Auto-probing the QAM command parameters was successful - using %d parameters.\n", 5495 qam_demod_param_count); 5496 5497 /* 5498 * One of our commands was successful. We don't need to 5499 * auto-probe anymore, now that we got the correct command. 5500 */ 5501 state->qam_demod_parameter_count = qam_demod_param_count; 5502 } 5503 5504 /* 5505 * STEP 3: enable the system in a mode where the ADC provides valid 5506 * signal setup modulation independent registers 5507 */ 5508 #if 0 5509 status = set_frequency(channel, tuner_freq_offset)); 5510 if (status < 0) 5511 goto error; 5512 #endif 5513 status = set_frequency_shifter(state, intermediate_freqk_hz, 5514 tuner_freq_offset, true); 5515 if (status < 0) 5516 goto error; 5517 5518 /* Setup BER measurement */ 5519 status = set_qam_measurement(state, state->m_constellation, 5520 state->props.symbol_rate); 5521 if (status < 0) 5522 goto error; 5523 5524 /* Reset default values */ 5525 status = write16(state, IQM_CF_SCALE_SH__A, IQM_CF_SCALE_SH__PRE); 5526 if (status < 0) 5527 goto error; 5528 status = write16(state, QAM_SY_TIMEOUT__A, QAM_SY_TIMEOUT__PRE); 5529 if (status < 0) 5530 goto error; 5531 5532 /* Reset default LC values */ 5533 status = write16(state, QAM_LC_RATE_LIMIT__A, 3); 5534 if (status < 0) 5535 goto error; 5536 status = write16(state, QAM_LC_LPF_FACTORP__A, 4); 5537 if (status < 0) 5538 goto error; 5539 status = write16(state, QAM_LC_LPF_FACTORI__A, 4); 5540 if (status < 0) 5541 goto error; 5542 status = write16(state, QAM_LC_MODE__A, 7); 5543 if (status < 0) 5544 goto error; 5545 5546 status = write16(state, QAM_LC_QUAL_TAB0__A, 1); 5547 if (status < 0) 5548 goto error; 5549 status = write16(state, QAM_LC_QUAL_TAB1__A, 1); 5550 if (status < 0) 5551 goto error; 5552 status = write16(state, QAM_LC_QUAL_TAB2__A, 1); 5553 if (status < 0) 5554 goto error; 5555 status = write16(state, QAM_LC_QUAL_TAB3__A, 1); 5556 if (status < 0) 5557 goto error; 5558 status = write16(state, QAM_LC_QUAL_TAB4__A, 2); 5559 if (status < 0) 5560 goto error; 5561 status = write16(state, QAM_LC_QUAL_TAB5__A, 2); 5562 if (status < 0) 5563 goto error; 5564 status = write16(state, QAM_LC_QUAL_TAB6__A, 2); 5565 if (status < 0) 5566 goto error; 5567 status = write16(state, QAM_LC_QUAL_TAB8__A, 2); 5568 if (status < 0) 5569 goto error; 5570 status = write16(state, QAM_LC_QUAL_TAB9__A, 2); 5571 if (status < 0) 5572 goto error; 5573 status = write16(state, QAM_LC_QUAL_TAB10__A, 2); 5574 if (status < 0) 5575 goto error; 5576 status = write16(state, QAM_LC_QUAL_TAB12__A, 2); 5577 if (status < 0) 5578 goto error; 5579 status = write16(state, QAM_LC_QUAL_TAB15__A, 3); 5580 if (status < 0) 5581 goto error; 5582 status = write16(state, QAM_LC_QUAL_TAB16__A, 3); 5583 if (status < 0) 5584 goto error; 5585 status = write16(state, QAM_LC_QUAL_TAB20__A, 4); 5586 if (status < 0) 5587 goto error; 5588 status = write16(state, QAM_LC_QUAL_TAB25__A, 4); 5589 if (status < 0) 5590 goto error; 5591 5592 /* Mirroring, QAM-block starting point not inverted */ 5593 status = write16(state, QAM_SY_SP_INV__A, 5594 QAM_SY_SP_INV_SPECTRUM_INV_DIS); 5595 if (status < 0) 5596 goto error; 5597 5598 /* Halt SCU to enable safe non-atomic accesses */ 5599 status = write16(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_HOLD); 5600 if (status < 0) 5601 goto error; 5602 5603 /* STEP 4: modulation specific setup */ 5604 switch (state->props.modulation) { 5605 case QAM_16: 5606 status = set_qam16(state); 5607 break; 5608 case QAM_32: 5609 status = set_qam32(state); 5610 break; 5611 case QAM_AUTO: 5612 case QAM_64: 5613 status = set_qam64(state); 5614 break; 5615 case QAM_128: 5616 status = set_qam128(state); 5617 break; 5618 case QAM_256: 5619 status = set_qam256(state); 5620 break; 5621 default: 5622 status = -EINVAL; 5623 break; 5624 } 5625 if (status < 0) 5626 goto error; 5627 5628 /* Activate SCU to enable SCU commands */ 5629 status = write16(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE); 5630 if (status < 0) 5631 goto error; 5632 5633 /* Re-configure MPEG output, requires knowledge of channel bitrate */ 5634 /* extAttr->currentChannel.modulation = channel->modulation; */ 5635 /* extAttr->currentChannel.symbolrate = channel->symbolrate; */ 5636 status = mpegts_dto_setup(state, state->m_operation_mode); 5637 if (status < 0) 5638 goto error; 5639 5640 /* start processes */ 5641 status = mpegts_start(state); 5642 if (status < 0) 5643 goto error; 5644 status = write16(state, FEC_COMM_EXEC__A, FEC_COMM_EXEC_ACTIVE); 5645 if (status < 0) 5646 goto error; 5647 status = write16(state, QAM_COMM_EXEC__A, QAM_COMM_EXEC_ACTIVE); 5648 if (status < 0) 5649 goto error; 5650 status = write16(state, IQM_COMM_EXEC__A, IQM_COMM_EXEC_B_ACTIVE); 5651 if (status < 0) 5652 goto error; 5653 5654 /* STEP 5: start QAM demodulator (starts FEC, QAM and IQM HW) */ 5655 status = scu_command(state, SCU_RAM_COMMAND_STANDARD_QAM 5656 | SCU_RAM_COMMAND_CMD_DEMOD_START, 5657 0, NULL, 1, &cmd_result); 5658 if (status < 0) 5659 goto error; 5660 5661 /* update global DRXK data container */ 5662 /*? extAttr->qamInterleaveMode = DRXK_QAM_I12_J17; */ 5663 5664 error: 5665 if (status < 0) 5666 pr_err("Error %d on %s\n", status, __func__); 5667 return status; 5668 } 5669 5670 static int set_qam_standard(struct drxk_state *state, 5671 enum operation_mode o_mode) 5672 { 5673 int status; 5674 #ifdef DRXK_QAM_TAPS 5675 #define DRXK_QAMA_TAPS_SELECT 5676 #include "drxk_filters.h" 5677 #undef DRXK_QAMA_TAPS_SELECT 5678 #endif 5679 5680 dprintk(1, "\n"); 5681 5682 /* added antenna switch */ 5683 switch_antenna_to_qam(state); 5684 5685 /* Ensure correct power-up mode */ 5686 status = power_up_qam(state); 5687 if (status < 0) 5688 goto error; 5689 /* Reset QAM block */ 5690 status = qam_reset_qam(state); 5691 if (status < 0) 5692 goto error; 5693 5694 /* Setup IQM */ 5695 5696 status = write16(state, IQM_COMM_EXEC__A, IQM_COMM_EXEC_B_STOP); 5697 if (status < 0) 5698 goto error; 5699 status = write16(state, IQM_AF_AMUX__A, IQM_AF_AMUX_SIGNAL2ADC); 5700 if (status < 0) 5701 goto error; 5702 5703 /* Upload IQM Channel Filter settings by 5704 boot loader from ROM table */ 5705 switch (o_mode) { 5706 case OM_QAM_ITU_A: 5707 status = bl_chain_cmd(state, DRXK_BL_ROM_OFFSET_TAPS_ITU_A, 5708 DRXK_BLCC_NR_ELEMENTS_TAPS, 5709 DRXK_BLC_TIMEOUT); 5710 break; 5711 case OM_QAM_ITU_C: 5712 status = bl_direct_cmd(state, IQM_CF_TAP_RE0__A, 5713 DRXK_BL_ROM_OFFSET_TAPS_ITU_C, 5714 DRXK_BLDC_NR_ELEMENTS_TAPS, 5715 DRXK_BLC_TIMEOUT); 5716 if (status < 0) 5717 goto error; 5718 status = bl_direct_cmd(state, 5719 IQM_CF_TAP_IM0__A, 5720 DRXK_BL_ROM_OFFSET_TAPS_ITU_C, 5721 DRXK_BLDC_NR_ELEMENTS_TAPS, 5722 DRXK_BLC_TIMEOUT); 5723 break; 5724 default: 5725 status = -EINVAL; 5726 } 5727 if (status < 0) 5728 goto error; 5729 5730 status = write16(state, IQM_CF_OUT_ENA__A, 1 << IQM_CF_OUT_ENA_QAM__B); 5731 if (status < 0) 5732 goto error; 5733 status = write16(state, IQM_CF_SYMMETRIC__A, 0); 5734 if (status < 0) 5735 goto error; 5736 status = write16(state, IQM_CF_MIDTAP__A, 5737 ((1 << IQM_CF_MIDTAP_RE__B) | (1 << IQM_CF_MIDTAP_IM__B))); 5738 if (status < 0) 5739 goto error; 5740 5741 status = write16(state, IQM_RC_STRETCH__A, 21); 5742 if (status < 0) 5743 goto error; 5744 status = write16(state, IQM_AF_CLP_LEN__A, 0); 5745 if (status < 0) 5746 goto error; 5747 status = write16(state, IQM_AF_CLP_TH__A, 448); 5748 if (status < 0) 5749 goto error; 5750 status = write16(state, IQM_AF_SNS_LEN__A, 0); 5751 if (status < 0) 5752 goto error; 5753 status = write16(state, IQM_CF_POW_MEAS_LEN__A, 0); 5754 if (status < 0) 5755 goto error; 5756 5757 status = write16(state, IQM_FS_ADJ_SEL__A, 1); 5758 if (status < 0) 5759 goto error; 5760 status = write16(state, IQM_RC_ADJ_SEL__A, 1); 5761 if (status < 0) 5762 goto error; 5763 status = write16(state, IQM_CF_ADJ_SEL__A, 1); 5764 if (status < 0) 5765 goto error; 5766 status = write16(state, IQM_AF_UPD_SEL__A, 0); 5767 if (status < 0) 5768 goto error; 5769 5770 /* IQM Impulse Noise Processing Unit */ 5771 status = write16(state, IQM_CF_CLP_VAL__A, 500); 5772 if (status < 0) 5773 goto error; 5774 status = write16(state, IQM_CF_DATATH__A, 1000); 5775 if (status < 0) 5776 goto error; 5777 status = write16(state, IQM_CF_BYPASSDET__A, 1); 5778 if (status < 0) 5779 goto error; 5780 status = write16(state, IQM_CF_DET_LCT__A, 0); 5781 if (status < 0) 5782 goto error; 5783 status = write16(state, IQM_CF_WND_LEN__A, 1); 5784 if (status < 0) 5785 goto error; 5786 status = write16(state, IQM_CF_PKDTH__A, 1); 5787 if (status < 0) 5788 goto error; 5789 status = write16(state, IQM_AF_INC_BYPASS__A, 1); 5790 if (status < 0) 5791 goto error; 5792 5793 /* turn on IQMAF. Must be done before setAgc**() */ 5794 status = set_iqm_af(state, true); 5795 if (status < 0) 5796 goto error; 5797 status = write16(state, IQM_AF_START_LOCK__A, 0x01); 5798 if (status < 0) 5799 goto error; 5800 5801 /* IQM will not be reset from here, sync ADC and update/init AGC */ 5802 status = adc_synchronization(state); 5803 if (status < 0) 5804 goto error; 5805 5806 /* Set the FSM step period */ 5807 status = write16(state, SCU_RAM_QAM_FSM_STEP_PERIOD__A, 2000); 5808 if (status < 0) 5809 goto error; 5810 5811 /* Halt SCU to enable safe non-atomic accesses */ 5812 status = write16(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_HOLD); 5813 if (status < 0) 5814 goto error; 5815 5816 /* No more resets of the IQM, current standard correctly set => 5817 now AGCs can be configured. */ 5818 5819 status = init_agc(state, true); 5820 if (status < 0) 5821 goto error; 5822 status = set_pre_saw(state, &(state->m_qam_pre_saw_cfg)); 5823 if (status < 0) 5824 goto error; 5825 5826 /* Configure AGC's */ 5827 status = set_agc_rf(state, &(state->m_qam_rf_agc_cfg), true); 5828 if (status < 0) 5829 goto error; 5830 status = set_agc_if(state, &(state->m_qam_if_agc_cfg), true); 5831 if (status < 0) 5832 goto error; 5833 5834 /* Activate SCU to enable SCU commands */ 5835 status = write16(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE); 5836 error: 5837 if (status < 0) 5838 pr_err("Error %d on %s\n", status, __func__); 5839 return status; 5840 } 5841 5842 static int write_gpio(struct drxk_state *state) 5843 { 5844 int status; 5845 u16 value = 0; 5846 5847 dprintk(1, "\n"); 5848 /* stop lock indicator process */ 5849 status = write16(state, SCU_RAM_GPIO__A, 5850 SCU_RAM_GPIO_HW_LOCK_IND_DISABLE); 5851 if (status < 0) 5852 goto error; 5853 5854 /* Write magic word to enable pdr reg write */ 5855 status = write16(state, SIO_TOP_COMM_KEY__A, SIO_TOP_COMM_KEY_KEY); 5856 if (status < 0) 5857 goto error; 5858 5859 if (state->m_has_sawsw) { 5860 if (state->uio_mask & 0x0001) { /* UIO-1 */ 5861 /* write to io pad configuration register - output mode */ 5862 status = write16(state, SIO_PDR_SMA_TX_CFG__A, 5863 state->m_gpio_cfg); 5864 if (status < 0) 5865 goto error; 5866 5867 /* use corresponding bit in io data output registar */ 5868 status = read16(state, SIO_PDR_UIO_OUT_LO__A, &value); 5869 if (status < 0) 5870 goto error; 5871 if ((state->m_gpio & 0x0001) == 0) 5872 value &= 0x7FFF; /* write zero to 15th bit - 1st UIO */ 5873 else 5874 value |= 0x8000; /* write one to 15th bit - 1st UIO */ 5875 /* write back to io data output register */ 5876 status = write16(state, SIO_PDR_UIO_OUT_LO__A, value); 5877 if (status < 0) 5878 goto error; 5879 } 5880 if (state->uio_mask & 0x0002) { /* UIO-2 */ 5881 /* write to io pad configuration register - output mode */ 5882 status = write16(state, SIO_PDR_SMA_RX_CFG__A, 5883 state->m_gpio_cfg); 5884 if (status < 0) 5885 goto error; 5886 5887 /* use corresponding bit in io data output registar */ 5888 status = read16(state, SIO_PDR_UIO_OUT_LO__A, &value); 5889 if (status < 0) 5890 goto error; 5891 if ((state->m_gpio & 0x0002) == 0) 5892 value &= 0xBFFF; /* write zero to 14th bit - 2st UIO */ 5893 else 5894 value |= 0x4000; /* write one to 14th bit - 2st UIO */ 5895 /* write back to io data output register */ 5896 status = write16(state, SIO_PDR_UIO_OUT_LO__A, value); 5897 if (status < 0) 5898 goto error; 5899 } 5900 if (state->uio_mask & 0x0004) { /* UIO-3 */ 5901 /* write to io pad configuration register - output mode */ 5902 status = write16(state, SIO_PDR_GPIO_CFG__A, 5903 state->m_gpio_cfg); 5904 if (status < 0) 5905 goto error; 5906 5907 /* use corresponding bit in io data output registar */ 5908 status = read16(state, SIO_PDR_UIO_OUT_LO__A, &value); 5909 if (status < 0) 5910 goto error; 5911 if ((state->m_gpio & 0x0004) == 0) 5912 value &= 0xFFFB; /* write zero to 2nd bit - 3rd UIO */ 5913 else 5914 value |= 0x0004; /* write one to 2nd bit - 3rd UIO */ 5915 /* write back to io data output register */ 5916 status = write16(state, SIO_PDR_UIO_OUT_LO__A, value); 5917 if (status < 0) 5918 goto error; 5919 } 5920 } 5921 /* Write magic word to disable pdr reg write */ 5922 status = write16(state, SIO_TOP_COMM_KEY__A, 0x0000); 5923 error: 5924 if (status < 0) 5925 pr_err("Error %d on %s\n", status, __func__); 5926 return status; 5927 } 5928 5929 static int switch_antenna_to_qam(struct drxk_state *state) 5930 { 5931 int status = 0; 5932 bool gpio_state; 5933 5934 dprintk(1, "\n"); 5935 5936 if (!state->antenna_gpio) 5937 return 0; 5938 5939 gpio_state = state->m_gpio & state->antenna_gpio; 5940 5941 if (state->antenna_dvbt ^ gpio_state) { 5942 /* Antenna is on DVB-T mode. Switch */ 5943 if (state->antenna_dvbt) 5944 state->m_gpio &= ~state->antenna_gpio; 5945 else 5946 state->m_gpio |= state->antenna_gpio; 5947 status = write_gpio(state); 5948 } 5949 if (status < 0) 5950 pr_err("Error %d on %s\n", status, __func__); 5951 return status; 5952 } 5953 5954 static int switch_antenna_to_dvbt(struct drxk_state *state) 5955 { 5956 int status = 0; 5957 bool gpio_state; 5958 5959 dprintk(1, "\n"); 5960 5961 if (!state->antenna_gpio) 5962 return 0; 5963 5964 gpio_state = state->m_gpio & state->antenna_gpio; 5965 5966 if (!(state->antenna_dvbt ^ gpio_state)) { 5967 /* Antenna is on DVB-C mode. Switch */ 5968 if (state->antenna_dvbt) 5969 state->m_gpio |= state->antenna_gpio; 5970 else 5971 state->m_gpio &= ~state->antenna_gpio; 5972 status = write_gpio(state); 5973 } 5974 if (status < 0) 5975 pr_err("Error %d on %s\n", status, __func__); 5976 return status; 5977 } 5978 5979 5980 static int power_down_device(struct drxk_state *state) 5981 { 5982 /* Power down to requested mode */ 5983 /* Backup some register settings */ 5984 /* Set pins with possible pull-ups connected to them in input mode */ 5985 /* Analog power down */ 5986 /* ADC power down */ 5987 /* Power down device */ 5988 int status; 5989 5990 dprintk(1, "\n"); 5991 if (state->m_b_p_down_open_bridge) { 5992 /* Open I2C bridge before power down of DRXK */ 5993 status = ConfigureI2CBridge(state, true); 5994 if (status < 0) 5995 goto error; 5996 } 5997 /* driver 0.9.0 */ 5998 status = dvbt_enable_ofdm_token_ring(state, false); 5999 if (status < 0) 6000 goto error; 6001 6002 status = write16(state, SIO_CC_PWD_MODE__A, 6003 SIO_CC_PWD_MODE_LEVEL_CLOCK); 6004 if (status < 0) 6005 goto error; 6006 status = write16(state, SIO_CC_UPDATE__A, SIO_CC_UPDATE_KEY); 6007 if (status < 0) 6008 goto error; 6009 state->m_hi_cfg_ctrl |= SIO_HI_RA_RAM_PAR_5_CFG_SLEEP_ZZZ; 6010 status = hi_cfg_command(state); 6011 error: 6012 if (status < 0) 6013 pr_err("Error %d on %s\n", status, __func__); 6014 6015 return status; 6016 } 6017 6018 static int init_drxk(struct drxk_state *state) 6019 { 6020 int status = 0, n = 0; 6021 enum drx_power_mode power_mode = DRXK_POWER_DOWN_OFDM; 6022 u16 driver_version; 6023 6024 dprintk(1, "\n"); 6025 if (state->m_drxk_state == DRXK_UNINITIALIZED) { 6026 drxk_i2c_lock(state); 6027 status = power_up_device(state); 6028 if (status < 0) 6029 goto error; 6030 status = drxx_open(state); 6031 if (status < 0) 6032 goto error; 6033 /* Soft reset of OFDM-, sys- and osc-clockdomain */ 6034 status = write16(state, SIO_CC_SOFT_RST__A, 6035 SIO_CC_SOFT_RST_OFDM__M 6036 | SIO_CC_SOFT_RST_SYS__M 6037 | SIO_CC_SOFT_RST_OSC__M); 6038 if (status < 0) 6039 goto error; 6040 status = write16(state, SIO_CC_UPDATE__A, SIO_CC_UPDATE_KEY); 6041 if (status < 0) 6042 goto error; 6043 /* 6044 * TODO is this needed? If yes, how much delay in 6045 * worst case scenario 6046 */ 6047 usleep_range(1000, 2000); 6048 state->m_drxk_a3_patch_code = true; 6049 status = get_device_capabilities(state); 6050 if (status < 0) 6051 goto error; 6052 6053 /* Bridge delay, uses oscilator clock */ 6054 /* Delay = (delay (nano seconds) * oscclk (kHz))/ 1000 */ 6055 /* SDA brdige delay */ 6056 state->m_hi_cfg_bridge_delay = 6057 (u16) ((state->m_osc_clock_freq / 1000) * 6058 HI_I2C_BRIDGE_DELAY) / 1000; 6059 /* Clipping */ 6060 if (state->m_hi_cfg_bridge_delay > 6061 SIO_HI_RA_RAM_PAR_3_CFG_DBL_SDA__M) { 6062 state->m_hi_cfg_bridge_delay = 6063 SIO_HI_RA_RAM_PAR_3_CFG_DBL_SDA__M; 6064 } 6065 /* SCL bridge delay, same as SDA for now */ 6066 state->m_hi_cfg_bridge_delay += 6067 state->m_hi_cfg_bridge_delay << 6068 SIO_HI_RA_RAM_PAR_3_CFG_DBL_SCL__B; 6069 6070 status = init_hi(state); 6071 if (status < 0) 6072 goto error; 6073 /* disable various processes */ 6074 #if NOA1ROM 6075 if (!(state->m_DRXK_A1_ROM_CODE) 6076 && !(state->m_DRXK_A2_ROM_CODE)) 6077 #endif 6078 { 6079 status = write16(state, SCU_RAM_GPIO__A, 6080 SCU_RAM_GPIO_HW_LOCK_IND_DISABLE); 6081 if (status < 0) 6082 goto error; 6083 } 6084 6085 /* disable MPEG port */ 6086 status = mpegts_disable(state); 6087 if (status < 0) 6088 goto error; 6089 6090 /* Stop AUD and SCU */ 6091 status = write16(state, AUD_COMM_EXEC__A, AUD_COMM_EXEC_STOP); 6092 if (status < 0) 6093 goto error; 6094 status = write16(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_STOP); 6095 if (status < 0) 6096 goto error; 6097 6098 /* enable token-ring bus through OFDM block for possible ucode upload */ 6099 status = write16(state, SIO_OFDM_SH_OFDM_RING_ENABLE__A, 6100 SIO_OFDM_SH_OFDM_RING_ENABLE_ON); 6101 if (status < 0) 6102 goto error; 6103 6104 /* include boot loader section */ 6105 status = write16(state, SIO_BL_COMM_EXEC__A, 6106 SIO_BL_COMM_EXEC_ACTIVE); 6107 if (status < 0) 6108 goto error; 6109 status = bl_chain_cmd(state, 0, 6, 100); 6110 if (status < 0) 6111 goto error; 6112 6113 if (state->fw) { 6114 status = download_microcode(state, state->fw->data, 6115 state->fw->size); 6116 if (status < 0) 6117 goto error; 6118 } 6119 6120 /* disable token-ring bus through OFDM block for possible ucode upload */ 6121 status = write16(state, SIO_OFDM_SH_OFDM_RING_ENABLE__A, 6122 SIO_OFDM_SH_OFDM_RING_ENABLE_OFF); 6123 if (status < 0) 6124 goto error; 6125 6126 /* Run SCU for a little while to initialize microcode version numbers */ 6127 status = write16(state, SCU_COMM_EXEC__A, SCU_COMM_EXEC_ACTIVE); 6128 if (status < 0) 6129 goto error; 6130 status = drxx_open(state); 6131 if (status < 0) 6132 goto error; 6133 /* added for test */ 6134 msleep(30); 6135 6136 power_mode = DRXK_POWER_DOWN_OFDM; 6137 status = ctrl_power_mode(state, &power_mode); 6138 if (status < 0) 6139 goto error; 6140 6141 /* Stamp driver version number in SCU data RAM in BCD code 6142 Done to enable field application engineers to retrieve drxdriver version 6143 via I2C from SCU RAM. 6144 Not using SCU command interface for SCU register access since no 6145 microcode may be present. 6146 */ 6147 driver_version = 6148 (((DRXK_VERSION_MAJOR / 100) % 10) << 12) + 6149 (((DRXK_VERSION_MAJOR / 10) % 10) << 8) + 6150 ((DRXK_VERSION_MAJOR % 10) << 4) + 6151 (DRXK_VERSION_MINOR % 10); 6152 status = write16(state, SCU_RAM_DRIVER_VER_HI__A, 6153 driver_version); 6154 if (status < 0) 6155 goto error; 6156 driver_version = 6157 (((DRXK_VERSION_PATCH / 1000) % 10) << 12) + 6158 (((DRXK_VERSION_PATCH / 100) % 10) << 8) + 6159 (((DRXK_VERSION_PATCH / 10) % 10) << 4) + 6160 (DRXK_VERSION_PATCH % 10); 6161 status = write16(state, SCU_RAM_DRIVER_VER_LO__A, 6162 driver_version); 6163 if (status < 0) 6164 goto error; 6165 6166 pr_info("DRXK driver version %d.%d.%d\n", 6167 DRXK_VERSION_MAJOR, DRXK_VERSION_MINOR, 6168 DRXK_VERSION_PATCH); 6169 6170 /* 6171 * Dirty fix of default values for ROM/PATCH microcode 6172 * Dirty because this fix makes it impossible to setup 6173 * suitable values before calling DRX_Open. This solution 6174 * requires changes to RF AGC speed to be done via the CTRL 6175 * function after calling DRX_Open 6176 */ 6177 6178 /* m_dvbt_rf_agc_cfg.speed = 3; */ 6179 6180 /* Reset driver debug flags to 0 */ 6181 status = write16(state, SCU_RAM_DRIVER_DEBUG__A, 0); 6182 if (status < 0) 6183 goto error; 6184 /* driver 0.9.0 */ 6185 /* Setup FEC OC: 6186 NOTE: No more full FEC resets allowed afterwards!! */ 6187 status = write16(state, FEC_COMM_EXEC__A, FEC_COMM_EXEC_STOP); 6188 if (status < 0) 6189 goto error; 6190 /* MPEGTS functions are still the same */ 6191 status = mpegts_dto_init(state); 6192 if (status < 0) 6193 goto error; 6194 status = mpegts_stop(state); 6195 if (status < 0) 6196 goto error; 6197 status = mpegts_configure_polarity(state); 6198 if (status < 0) 6199 goto error; 6200 status = mpegts_configure_pins(state, state->m_enable_mpeg_output); 6201 if (status < 0) 6202 goto error; 6203 /* added: configure GPIO */ 6204 status = write_gpio(state); 6205 if (status < 0) 6206 goto error; 6207 6208 state->m_drxk_state = DRXK_STOPPED; 6209 6210 if (state->m_b_power_down) { 6211 status = power_down_device(state); 6212 if (status < 0) 6213 goto error; 6214 state->m_drxk_state = DRXK_POWERED_DOWN; 6215 } else 6216 state->m_drxk_state = DRXK_STOPPED; 6217 6218 /* Initialize the supported delivery systems */ 6219 n = 0; 6220 if (state->m_has_dvbc) { 6221 state->frontend.ops.delsys[n++] = SYS_DVBC_ANNEX_A; 6222 state->frontend.ops.delsys[n++] = SYS_DVBC_ANNEX_C; 6223 strlcat(state->frontend.ops.info.name, " DVB-C", 6224 sizeof(state->frontend.ops.info.name)); 6225 } 6226 if (state->m_has_dvbt) { 6227 state->frontend.ops.delsys[n++] = SYS_DVBT; 6228 strlcat(state->frontend.ops.info.name, " DVB-T", 6229 sizeof(state->frontend.ops.info.name)); 6230 } 6231 drxk_i2c_unlock(state); 6232 } 6233 error: 6234 if (status < 0) { 6235 state->m_drxk_state = DRXK_NO_DEV; 6236 drxk_i2c_unlock(state); 6237 pr_err("Error %d on %s\n", status, __func__); 6238 } 6239 6240 return status; 6241 } 6242 6243 static void load_firmware_cb(const struct firmware *fw, 6244 void *context) 6245 { 6246 struct drxk_state *state = context; 6247 6248 dprintk(1, ": %s\n", fw ? "firmware loaded" : "firmware not loaded"); 6249 if (!fw) { 6250 pr_err("Could not load firmware file %s.\n", 6251 state->microcode_name); 6252 pr_info("Copy %s to your hotplug directory!\n", 6253 state->microcode_name); 6254 state->microcode_name = NULL; 6255 6256 /* 6257 * As firmware is now load asynchronous, it is not possible 6258 * anymore to fail at frontend attach. We might silently 6259 * return here, and hope that the driver won't crash. 6260 * We might also change all DVB callbacks to return -ENODEV 6261 * if the device is not initialized. 6262 * As the DRX-K devices have their own internal firmware, 6263 * let's just hope that it will match a firmware revision 6264 * compatible with this driver and proceed. 6265 */ 6266 } 6267 state->fw = fw; 6268 6269 init_drxk(state); 6270 } 6271 6272 static void drxk_release(struct dvb_frontend *fe) 6273 { 6274 struct drxk_state *state = fe->demodulator_priv; 6275 6276 dprintk(1, "\n"); 6277 release_firmware(state->fw); 6278 6279 kfree(state); 6280 } 6281 6282 static int drxk_sleep(struct dvb_frontend *fe) 6283 { 6284 struct drxk_state *state = fe->demodulator_priv; 6285 6286 dprintk(1, "\n"); 6287 6288 if (state->m_drxk_state == DRXK_NO_DEV) 6289 return -ENODEV; 6290 if (state->m_drxk_state == DRXK_UNINITIALIZED) 6291 return 0; 6292 6293 shut_down(state); 6294 return 0; 6295 } 6296 6297 static int drxk_gate_ctrl(struct dvb_frontend *fe, int enable) 6298 { 6299 struct drxk_state *state = fe->demodulator_priv; 6300 6301 dprintk(1, ": %s\n", enable ? "enable" : "disable"); 6302 6303 if (state->m_drxk_state == DRXK_NO_DEV) 6304 return -ENODEV; 6305 6306 return ConfigureI2CBridge(state, enable ? true : false); 6307 } 6308 6309 static int drxk_set_parameters(struct dvb_frontend *fe) 6310 { 6311 struct dtv_frontend_properties *p = &fe->dtv_property_cache; 6312 u32 delsys = p->delivery_system, old_delsys; 6313 struct drxk_state *state = fe->demodulator_priv; 6314 u32 IF; 6315 6316 dprintk(1, "\n"); 6317 6318 if (state->m_drxk_state == DRXK_NO_DEV) 6319 return -ENODEV; 6320 6321 if (state->m_drxk_state == DRXK_UNINITIALIZED) 6322 return -EAGAIN; 6323 6324 if (!fe->ops.tuner_ops.get_if_frequency) { 6325 pr_err("Error: get_if_frequency() not defined at tuner. Can't work without it!\n"); 6326 return -EINVAL; 6327 } 6328 6329 if (fe->ops.i2c_gate_ctrl) 6330 fe->ops.i2c_gate_ctrl(fe, 1); 6331 if (fe->ops.tuner_ops.set_params) 6332 fe->ops.tuner_ops.set_params(fe); 6333 if (fe->ops.i2c_gate_ctrl) 6334 fe->ops.i2c_gate_ctrl(fe, 0); 6335 6336 old_delsys = state->props.delivery_system; 6337 state->props = *p; 6338 6339 if (old_delsys != delsys) { 6340 shut_down(state); 6341 switch (delsys) { 6342 case SYS_DVBC_ANNEX_A: 6343 case SYS_DVBC_ANNEX_C: 6344 if (!state->m_has_dvbc) 6345 return -EINVAL; 6346 state->m_itut_annex_c = (delsys == SYS_DVBC_ANNEX_C) ? 6347 true : false; 6348 if (state->m_itut_annex_c) 6349 setoperation_mode(state, OM_QAM_ITU_C); 6350 else 6351 setoperation_mode(state, OM_QAM_ITU_A); 6352 break; 6353 case SYS_DVBT: 6354 if (!state->m_has_dvbt) 6355 return -EINVAL; 6356 setoperation_mode(state, OM_DVBT); 6357 break; 6358 default: 6359 return -EINVAL; 6360 } 6361 } 6362 6363 fe->ops.tuner_ops.get_if_frequency(fe, &IF); 6364 start(state, 0, IF); 6365 6366 /* After set_frontend, stats aren't available */ 6367 p->strength.stat[0].scale = FE_SCALE_RELATIVE; 6368 p->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6369 p->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6370 p->block_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6371 p->pre_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6372 p->pre_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6373 p->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6374 p->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6375 6376 /* printk(KERN_DEBUG "drxk: %s IF=%d done\n", __func__, IF); */ 6377 6378 return 0; 6379 } 6380 6381 static int get_strength(struct drxk_state *state, u64 *strength) 6382 { 6383 int status; 6384 struct s_cfg_agc rf_agc, if_agc; 6385 u32 total_gain = 0; 6386 u32 atten = 0; 6387 u32 agc_range = 0; 6388 u16 scu_lvl = 0; 6389 u16 scu_coc = 0; 6390 /* FIXME: those are part of the tuner presets */ 6391 u16 tuner_rf_gain = 50; /* Default value on az6007 driver */ 6392 u16 tuner_if_gain = 40; /* Default value on az6007 driver */ 6393 6394 *strength = 0; 6395 6396 if (is_dvbt(state)) { 6397 rf_agc = state->m_dvbt_rf_agc_cfg; 6398 if_agc = state->m_dvbt_if_agc_cfg; 6399 } else if (is_qam(state)) { 6400 rf_agc = state->m_qam_rf_agc_cfg; 6401 if_agc = state->m_qam_if_agc_cfg; 6402 } else { 6403 rf_agc = state->m_atv_rf_agc_cfg; 6404 if_agc = state->m_atv_if_agc_cfg; 6405 } 6406 6407 if (rf_agc.ctrl_mode == DRXK_AGC_CTRL_AUTO) { 6408 /* SCU output_level */ 6409 status = read16(state, SCU_RAM_AGC_RF_IACCU_HI__A, &scu_lvl); 6410 if (status < 0) 6411 return status; 6412 6413 /* SCU c.o.c. */ 6414 status = read16(state, SCU_RAM_AGC_RF_IACCU_HI_CO__A, &scu_coc); 6415 if (status < 0) 6416 return status; 6417 6418 if (((u32) scu_lvl + (u32) scu_coc) < 0xffff) 6419 rf_agc.output_level = scu_lvl + scu_coc; 6420 else 6421 rf_agc.output_level = 0xffff; 6422 6423 /* Take RF gain into account */ 6424 total_gain += tuner_rf_gain; 6425 6426 /* clip output value */ 6427 if (rf_agc.output_level < rf_agc.min_output_level) 6428 rf_agc.output_level = rf_agc.min_output_level; 6429 if (rf_agc.output_level > rf_agc.max_output_level) 6430 rf_agc.output_level = rf_agc.max_output_level; 6431 6432 agc_range = (u32) (rf_agc.max_output_level - rf_agc.min_output_level); 6433 if (agc_range > 0) { 6434 atten += 100UL * 6435 ((u32)(tuner_rf_gain)) * 6436 ((u32)(rf_agc.output_level - rf_agc.min_output_level)) 6437 / agc_range; 6438 } 6439 } 6440 6441 if (if_agc.ctrl_mode == DRXK_AGC_CTRL_AUTO) { 6442 status = read16(state, SCU_RAM_AGC_IF_IACCU_HI__A, 6443 &if_agc.output_level); 6444 if (status < 0) 6445 return status; 6446 6447 status = read16(state, SCU_RAM_AGC_INGAIN_TGT_MIN__A, 6448 &if_agc.top); 6449 if (status < 0) 6450 return status; 6451 6452 /* Take IF gain into account */ 6453 total_gain += (u32) tuner_if_gain; 6454 6455 /* clip output value */ 6456 if (if_agc.output_level < if_agc.min_output_level) 6457 if_agc.output_level = if_agc.min_output_level; 6458 if (if_agc.output_level > if_agc.max_output_level) 6459 if_agc.output_level = if_agc.max_output_level; 6460 6461 agc_range = (u32)(if_agc.max_output_level - if_agc.min_output_level); 6462 if (agc_range > 0) { 6463 atten += 100UL * 6464 ((u32)(tuner_if_gain)) * 6465 ((u32)(if_agc.output_level - if_agc.min_output_level)) 6466 / agc_range; 6467 } 6468 } 6469 6470 /* 6471 * Convert to 0..65535 scale. 6472 * If it can't be measured (AGC is disabled), just show 100%. 6473 */ 6474 if (total_gain > 0) 6475 *strength = (65535UL * atten / total_gain / 100); 6476 else 6477 *strength = 65535; 6478 6479 return 0; 6480 } 6481 6482 static int drxk_get_stats(struct dvb_frontend *fe) 6483 { 6484 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 6485 struct drxk_state *state = fe->demodulator_priv; 6486 int status; 6487 u32 stat; 6488 u16 reg16; 6489 u32 post_bit_count; 6490 u32 post_bit_err_count; 6491 u32 post_bit_error_scale; 6492 u32 pre_bit_err_count; 6493 u32 pre_bit_count; 6494 u32 pkt_count; 6495 u32 pkt_error_count; 6496 s32 cnr; 6497 6498 if (state->m_drxk_state == DRXK_NO_DEV) 6499 return -ENODEV; 6500 if (state->m_drxk_state == DRXK_UNINITIALIZED) 6501 return -EAGAIN; 6502 6503 /* get status */ 6504 state->fe_status = 0; 6505 get_lock_status(state, &stat); 6506 if (stat == MPEG_LOCK) 6507 state->fe_status |= 0x1f; 6508 if (stat == FEC_LOCK) 6509 state->fe_status |= 0x0f; 6510 if (stat == DEMOD_LOCK) 6511 state->fe_status |= 0x07; 6512 6513 /* 6514 * Estimate signal strength from AGC 6515 */ 6516 get_strength(state, &c->strength.stat[0].uvalue); 6517 c->strength.stat[0].scale = FE_SCALE_RELATIVE; 6518 6519 6520 if (stat >= DEMOD_LOCK) { 6521 get_signal_to_noise(state, &cnr); 6522 c->cnr.stat[0].svalue = cnr * 100; 6523 c->cnr.stat[0].scale = FE_SCALE_DECIBEL; 6524 } else { 6525 c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6526 } 6527 6528 if (stat < FEC_LOCK) { 6529 c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6530 c->block_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6531 c->pre_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6532 c->pre_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6533 c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6534 c->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6535 return 0; 6536 } 6537 6538 /* Get post BER */ 6539 6540 /* BER measurement is valid if at least FEC lock is achieved */ 6541 6542 /* 6543 * OFDM_EC_VD_REQ_SMB_CNT__A and/or OFDM_EC_VD_REQ_BIT_CNT can be 6544 * written to set nr of symbols or bits over which to measure 6545 * EC_VD_REG_ERR_BIT_CNT__A . See CtrlSetCfg(). 6546 */ 6547 6548 /* Read registers for post/preViterbi BER calculation */ 6549 status = read16(state, OFDM_EC_VD_ERR_BIT_CNT__A, ®16); 6550 if (status < 0) 6551 goto error; 6552 pre_bit_err_count = reg16; 6553 6554 status = read16(state, OFDM_EC_VD_IN_BIT_CNT__A , ®16); 6555 if (status < 0) 6556 goto error; 6557 pre_bit_count = reg16; 6558 6559 /* Number of bit-errors */ 6560 status = read16(state, FEC_RS_NR_BIT_ERRORS__A, ®16); 6561 if (status < 0) 6562 goto error; 6563 post_bit_err_count = reg16; 6564 6565 status = read16(state, FEC_RS_MEASUREMENT_PRESCALE__A, ®16); 6566 if (status < 0) 6567 goto error; 6568 post_bit_error_scale = reg16; 6569 6570 status = read16(state, FEC_RS_MEASUREMENT_PERIOD__A, ®16); 6571 if (status < 0) 6572 goto error; 6573 pkt_count = reg16; 6574 6575 status = read16(state, SCU_RAM_FEC_ACCUM_PKT_FAILURES__A, ®16); 6576 if (status < 0) 6577 goto error; 6578 pkt_error_count = reg16; 6579 write16(state, SCU_RAM_FEC_ACCUM_PKT_FAILURES__A, 0); 6580 6581 post_bit_err_count *= post_bit_error_scale; 6582 6583 post_bit_count = pkt_count * 204 * 8; 6584 6585 /* Store the results */ 6586 c->block_error.stat[0].scale = FE_SCALE_COUNTER; 6587 c->block_error.stat[0].uvalue += pkt_error_count; 6588 c->block_count.stat[0].scale = FE_SCALE_COUNTER; 6589 c->block_count.stat[0].uvalue += pkt_count; 6590 6591 c->pre_bit_error.stat[0].scale = FE_SCALE_COUNTER; 6592 c->pre_bit_error.stat[0].uvalue += pre_bit_err_count; 6593 c->pre_bit_count.stat[0].scale = FE_SCALE_COUNTER; 6594 c->pre_bit_count.stat[0].uvalue += pre_bit_count; 6595 6596 c->post_bit_error.stat[0].scale = FE_SCALE_COUNTER; 6597 c->post_bit_error.stat[0].uvalue += post_bit_err_count; 6598 c->post_bit_count.stat[0].scale = FE_SCALE_COUNTER; 6599 c->post_bit_count.stat[0].uvalue += post_bit_count; 6600 6601 error: 6602 return status; 6603 } 6604 6605 6606 static int drxk_read_status(struct dvb_frontend *fe, enum fe_status *status) 6607 { 6608 struct drxk_state *state = fe->demodulator_priv; 6609 int rc; 6610 6611 dprintk(1, "\n"); 6612 6613 rc = drxk_get_stats(fe); 6614 if (rc < 0) 6615 return rc; 6616 6617 *status = state->fe_status; 6618 6619 return 0; 6620 } 6621 6622 static int drxk_read_signal_strength(struct dvb_frontend *fe, 6623 u16 *strength) 6624 { 6625 struct drxk_state *state = fe->demodulator_priv; 6626 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 6627 6628 dprintk(1, "\n"); 6629 6630 if (state->m_drxk_state == DRXK_NO_DEV) 6631 return -ENODEV; 6632 if (state->m_drxk_state == DRXK_UNINITIALIZED) 6633 return -EAGAIN; 6634 6635 *strength = c->strength.stat[0].uvalue; 6636 return 0; 6637 } 6638 6639 static int drxk_read_snr(struct dvb_frontend *fe, u16 *snr) 6640 { 6641 struct drxk_state *state = fe->demodulator_priv; 6642 s32 snr2; 6643 6644 dprintk(1, "\n"); 6645 6646 if (state->m_drxk_state == DRXK_NO_DEV) 6647 return -ENODEV; 6648 if (state->m_drxk_state == DRXK_UNINITIALIZED) 6649 return -EAGAIN; 6650 6651 get_signal_to_noise(state, &snr2); 6652 6653 /* No negative SNR, clip to zero */ 6654 if (snr2 < 0) 6655 snr2 = 0; 6656 *snr = snr2 & 0xffff; 6657 return 0; 6658 } 6659 6660 static int drxk_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks) 6661 { 6662 struct drxk_state *state = fe->demodulator_priv; 6663 u16 err; 6664 6665 dprintk(1, "\n"); 6666 6667 if (state->m_drxk_state == DRXK_NO_DEV) 6668 return -ENODEV; 6669 if (state->m_drxk_state == DRXK_UNINITIALIZED) 6670 return -EAGAIN; 6671 6672 dvbtqam_get_acc_pkt_err(state, &err); 6673 *ucblocks = (u32) err; 6674 return 0; 6675 } 6676 6677 static int drxk_get_tune_settings(struct dvb_frontend *fe, 6678 struct dvb_frontend_tune_settings *sets) 6679 { 6680 struct drxk_state *state = fe->demodulator_priv; 6681 struct dtv_frontend_properties *p = &fe->dtv_property_cache; 6682 6683 dprintk(1, "\n"); 6684 6685 if (state->m_drxk_state == DRXK_NO_DEV) 6686 return -ENODEV; 6687 if (state->m_drxk_state == DRXK_UNINITIALIZED) 6688 return -EAGAIN; 6689 6690 switch (p->delivery_system) { 6691 case SYS_DVBC_ANNEX_A: 6692 case SYS_DVBC_ANNEX_C: 6693 case SYS_DVBT: 6694 sets->min_delay_ms = 3000; 6695 sets->max_drift = 0; 6696 sets->step_size = 0; 6697 return 0; 6698 default: 6699 return -EINVAL; 6700 } 6701 } 6702 6703 static const struct dvb_frontend_ops drxk_ops = { 6704 /* .delsys will be filled dynamically */ 6705 .info = { 6706 .name = "DRXK", 6707 .frequency_min_hz = 47 * MHz, 6708 .frequency_max_hz = 865 * MHz, 6709 /* For DVB-C */ 6710 .symbol_rate_min = 870000, 6711 .symbol_rate_max = 11700000, 6712 /* For DVB-T */ 6713 .frequency_stepsize_hz = 166667, 6714 6715 .caps = FE_CAN_QAM_16 | FE_CAN_QAM_32 | FE_CAN_QAM_64 | 6716 FE_CAN_QAM_128 | FE_CAN_QAM_256 | FE_CAN_FEC_AUTO | 6717 FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 | 6718 FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_MUTE_TS | 6719 FE_CAN_TRANSMISSION_MODE_AUTO | FE_CAN_RECOVER | 6720 FE_CAN_GUARD_INTERVAL_AUTO | FE_CAN_HIERARCHY_AUTO 6721 }, 6722 6723 .release = drxk_release, 6724 .sleep = drxk_sleep, 6725 .i2c_gate_ctrl = drxk_gate_ctrl, 6726 6727 .set_frontend = drxk_set_parameters, 6728 .get_tune_settings = drxk_get_tune_settings, 6729 6730 .read_status = drxk_read_status, 6731 .read_signal_strength = drxk_read_signal_strength, 6732 .read_snr = drxk_read_snr, 6733 .read_ucblocks = drxk_read_ucblocks, 6734 }; 6735 6736 struct dvb_frontend *drxk_attach(const struct drxk_config *config, 6737 struct i2c_adapter *i2c) 6738 { 6739 struct dtv_frontend_properties *p; 6740 struct drxk_state *state = NULL; 6741 u8 adr = config->adr; 6742 int status; 6743 6744 dprintk(1, "\n"); 6745 state = kzalloc(sizeof(struct drxk_state), GFP_KERNEL); 6746 if (!state) 6747 return NULL; 6748 6749 state->i2c = i2c; 6750 state->demod_address = adr; 6751 state->single_master = config->single_master; 6752 state->microcode_name = config->microcode_name; 6753 state->qam_demod_parameter_count = config->qam_demod_parameter_count; 6754 state->no_i2c_bridge = config->no_i2c_bridge; 6755 state->antenna_gpio = config->antenna_gpio; 6756 state->antenna_dvbt = config->antenna_dvbt; 6757 state->m_chunk_size = config->chunk_size; 6758 state->enable_merr_cfg = config->enable_merr_cfg; 6759 6760 if (config->dynamic_clk) { 6761 state->m_dvbt_static_clk = false; 6762 state->m_dvbc_static_clk = false; 6763 } else { 6764 state->m_dvbt_static_clk = true; 6765 state->m_dvbc_static_clk = true; 6766 } 6767 6768 6769 if (config->mpeg_out_clk_strength) 6770 state->m_ts_clockk_strength = config->mpeg_out_clk_strength & 0x07; 6771 else 6772 state->m_ts_clockk_strength = 0x06; 6773 6774 if (config->parallel_ts) 6775 state->m_enable_parallel = true; 6776 else 6777 state->m_enable_parallel = false; 6778 6779 /* NOTE: as more UIO bits will be used, add them to the mask */ 6780 state->uio_mask = config->antenna_gpio; 6781 6782 /* Default gpio to DVB-C */ 6783 if (!state->antenna_dvbt && state->antenna_gpio) 6784 state->m_gpio |= state->antenna_gpio; 6785 else 6786 state->m_gpio &= ~state->antenna_gpio; 6787 6788 mutex_init(&state->mutex); 6789 6790 memcpy(&state->frontend.ops, &drxk_ops, sizeof(drxk_ops)); 6791 state->frontend.demodulator_priv = state; 6792 6793 init_state(state); 6794 6795 /* Load firmware and initialize DRX-K */ 6796 if (state->microcode_name) { 6797 const struct firmware *fw = NULL; 6798 6799 status = request_firmware(&fw, state->microcode_name, 6800 state->i2c->dev.parent); 6801 if (status < 0) 6802 fw = NULL; 6803 load_firmware_cb(fw, state); 6804 } else if (init_drxk(state) < 0) 6805 goto error; 6806 6807 6808 /* Initialize stats */ 6809 p = &state->frontend.dtv_property_cache; 6810 p->strength.len = 1; 6811 p->cnr.len = 1; 6812 p->block_error.len = 1; 6813 p->block_count.len = 1; 6814 p->pre_bit_error.len = 1; 6815 p->pre_bit_count.len = 1; 6816 p->post_bit_error.len = 1; 6817 p->post_bit_count.len = 1; 6818 6819 p->strength.stat[0].scale = FE_SCALE_RELATIVE; 6820 p->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6821 p->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6822 p->block_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6823 p->pre_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6824 p->pre_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6825 p->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6826 p->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 6827 6828 pr_info("frontend initialized.\n"); 6829 return &state->frontend; 6830 6831 error: 6832 pr_err("not found\n"); 6833 kfree(state); 6834 return NULL; 6835 } 6836 EXPORT_SYMBOL(drxk_attach); 6837 6838 MODULE_DESCRIPTION("DRX-K driver"); 6839 MODULE_AUTHOR("Ralph Metzler"); 6840 MODULE_LICENSE("GPL"); 6841