1 /* 2 * mxl111sf-demod.c - driver for the MaxLinear MXL111SF DVB-T demodulator 3 * 4 * Copyright (C) 2010 Michael Krufky <mkrufky@kernellabs.com> 5 * 6 * This program is free software; you can redistribute it and/or modify 7 * it under the terms of the GNU General Public License as published by 8 * the Free Software Foundation; either version 2 of the License, or 9 * (at your option) any later version. 10 * 11 * This program is distributed in the hope that it will be useful, 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 * GNU General Public License for more details. 15 * 16 * You should have received a copy of the GNU General Public License 17 * along with this program; if not, write to the Free Software 18 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 19 */ 20 21 #include "mxl111sf-demod.h" 22 #include "mxl111sf-reg.h" 23 24 /* debug */ 25 static int mxl111sf_demod_debug; 26 module_param_named(debug, mxl111sf_demod_debug, int, 0644); 27 MODULE_PARM_DESC(debug, "set debugging level (1=info (or-able))."); 28 29 #define mxl_dbg(fmt, arg...) \ 30 if (mxl111sf_demod_debug) \ 31 mxl_printk(KERN_DEBUG, fmt, ##arg) 32 33 /* ------------------------------------------------------------------------ */ 34 35 struct mxl111sf_demod_state { 36 struct mxl111sf_state *mxl_state; 37 38 struct mxl111sf_demod_config *cfg; 39 40 struct dvb_frontend fe; 41 }; 42 43 /* ------------------------------------------------------------------------ */ 44 45 static int mxl111sf_demod_read_reg(struct mxl111sf_demod_state *state, 46 u8 addr, u8 *data) 47 { 48 return (state->cfg->read_reg) ? 49 state->cfg->read_reg(state->mxl_state, addr, data) : 50 -EINVAL; 51 } 52 53 static int mxl111sf_demod_write_reg(struct mxl111sf_demod_state *state, 54 u8 addr, u8 data) 55 { 56 return (state->cfg->write_reg) ? 57 state->cfg->write_reg(state->mxl_state, addr, data) : 58 -EINVAL; 59 } 60 61 static 62 int mxl111sf_demod_program_regs(struct mxl111sf_demod_state *state, 63 struct mxl111sf_reg_ctrl_info *ctrl_reg_info) 64 { 65 return (state->cfg->program_regs) ? 66 state->cfg->program_regs(state->mxl_state, ctrl_reg_info) : 67 -EINVAL; 68 } 69 70 /* ------------------------------------------------------------------------ */ 71 /* TPS */ 72 73 static 74 int mxl1x1sf_demod_get_tps_code_rate(struct mxl111sf_demod_state *state, 75 fe_code_rate_t *code_rate) 76 { 77 u8 val; 78 int ret = mxl111sf_demod_read_reg(state, V6_CODE_RATE_TPS_REG, &val); 79 /* bit<2:0> - 000:1/2, 001:2/3, 010:3/4, 011:5/6, 100:7/8 */ 80 if (mxl_fail(ret)) 81 goto fail; 82 83 switch (val & V6_CODE_RATE_TPS_MASK) { 84 case 0: 85 *code_rate = FEC_1_2; 86 break; 87 case 1: 88 *code_rate = FEC_2_3; 89 break; 90 case 2: 91 *code_rate = FEC_3_4; 92 break; 93 case 3: 94 *code_rate = FEC_5_6; 95 break; 96 case 4: 97 *code_rate = FEC_7_8; 98 break; 99 } 100 fail: 101 return ret; 102 } 103 104 static 105 int mxl1x1sf_demod_get_tps_modulation(struct mxl111sf_demod_state *state, 106 fe_modulation_t *modulation) 107 { 108 u8 val; 109 int ret = mxl111sf_demod_read_reg(state, V6_MODORDER_TPS_REG, &val); 110 /* Constellation, 00 : QPSK, 01 : 16QAM, 10:64QAM */ 111 if (mxl_fail(ret)) 112 goto fail; 113 114 switch ((val & V6_PARAM_CONSTELLATION_MASK) >> 4) { 115 case 0: 116 *modulation = QPSK; 117 break; 118 case 1: 119 *modulation = QAM_16; 120 break; 121 case 2: 122 *modulation = QAM_64; 123 break; 124 } 125 fail: 126 return ret; 127 } 128 129 static 130 int mxl1x1sf_demod_get_tps_guard_fft_mode(struct mxl111sf_demod_state *state, 131 fe_transmit_mode_t *fft_mode) 132 { 133 u8 val; 134 int ret = mxl111sf_demod_read_reg(state, V6_MODE_TPS_REG, &val); 135 /* FFT Mode, 00:2K, 01:8K, 10:4K */ 136 if (mxl_fail(ret)) 137 goto fail; 138 139 switch ((val & V6_PARAM_FFT_MODE_MASK) >> 2) { 140 case 0: 141 *fft_mode = TRANSMISSION_MODE_2K; 142 break; 143 case 1: 144 *fft_mode = TRANSMISSION_MODE_8K; 145 break; 146 case 2: 147 *fft_mode = TRANSMISSION_MODE_4K; 148 break; 149 } 150 fail: 151 return ret; 152 } 153 154 static 155 int mxl1x1sf_demod_get_tps_guard_interval(struct mxl111sf_demod_state *state, 156 fe_guard_interval_t *guard) 157 { 158 u8 val; 159 int ret = mxl111sf_demod_read_reg(state, V6_CP_TPS_REG, &val); 160 /* 00:1/32, 01:1/16, 10:1/8, 11:1/4 */ 161 if (mxl_fail(ret)) 162 goto fail; 163 164 switch ((val & V6_PARAM_GI_MASK) >> 4) { 165 case 0: 166 *guard = GUARD_INTERVAL_1_32; 167 break; 168 case 1: 169 *guard = GUARD_INTERVAL_1_16; 170 break; 171 case 2: 172 *guard = GUARD_INTERVAL_1_8; 173 break; 174 case 3: 175 *guard = GUARD_INTERVAL_1_4; 176 break; 177 } 178 fail: 179 return ret; 180 } 181 182 static 183 int mxl1x1sf_demod_get_tps_hierarchy(struct mxl111sf_demod_state *state, 184 fe_hierarchy_t *hierarchy) 185 { 186 u8 val; 187 int ret = mxl111sf_demod_read_reg(state, V6_TPS_HIERACHY_REG, &val); 188 /* bit<6:4> - 000:Non hierarchy, 001:1, 010:2, 011:4 */ 189 if (mxl_fail(ret)) 190 goto fail; 191 192 switch ((val & V6_TPS_HIERARCHY_INFO_MASK) >> 6) { 193 case 0: 194 *hierarchy = HIERARCHY_NONE; 195 break; 196 case 1: 197 *hierarchy = HIERARCHY_1; 198 break; 199 case 2: 200 *hierarchy = HIERARCHY_2; 201 break; 202 case 3: 203 *hierarchy = HIERARCHY_4; 204 break; 205 } 206 fail: 207 return ret; 208 } 209 210 /* ------------------------------------------------------------------------ */ 211 /* LOCKS */ 212 213 static 214 int mxl1x1sf_demod_get_sync_lock_status(struct mxl111sf_demod_state *state, 215 int *sync_lock) 216 { 217 u8 val = 0; 218 int ret = mxl111sf_demod_read_reg(state, V6_SYNC_LOCK_REG, &val); 219 if (mxl_fail(ret)) 220 goto fail; 221 *sync_lock = (val & SYNC_LOCK_MASK) >> 4; 222 fail: 223 return ret; 224 } 225 226 static 227 int mxl1x1sf_demod_get_rs_lock_status(struct mxl111sf_demod_state *state, 228 int *rs_lock) 229 { 230 u8 val = 0; 231 int ret = mxl111sf_demod_read_reg(state, V6_RS_LOCK_DET_REG, &val); 232 if (mxl_fail(ret)) 233 goto fail; 234 *rs_lock = (val & RS_LOCK_DET_MASK) >> 3; 235 fail: 236 return ret; 237 } 238 239 static 240 int mxl1x1sf_demod_get_tps_lock_status(struct mxl111sf_demod_state *state, 241 int *tps_lock) 242 { 243 u8 val = 0; 244 int ret = mxl111sf_demod_read_reg(state, V6_TPS_LOCK_REG, &val); 245 if (mxl_fail(ret)) 246 goto fail; 247 *tps_lock = (val & V6_PARAM_TPS_LOCK_MASK) >> 6; 248 fail: 249 return ret; 250 } 251 252 static 253 int mxl1x1sf_demod_get_fec_lock_status(struct mxl111sf_demod_state *state, 254 int *fec_lock) 255 { 256 u8 val = 0; 257 int ret = mxl111sf_demod_read_reg(state, V6_IRQ_STATUS_REG, &val); 258 if (mxl_fail(ret)) 259 goto fail; 260 *fec_lock = (val & IRQ_MASK_FEC_LOCK) >> 4; 261 fail: 262 return ret; 263 } 264 265 #if 0 266 static 267 int mxl1x1sf_demod_get_cp_lock_status(struct mxl111sf_demod_state *state, 268 int *cp_lock) 269 { 270 u8 val = 0; 271 int ret = mxl111sf_demod_read_reg(state, V6_CP_LOCK_DET_REG, &val); 272 if (mxl_fail(ret)) 273 goto fail; 274 *cp_lock = (val & V6_CP_LOCK_DET_MASK) >> 2; 275 fail: 276 return ret; 277 } 278 #endif 279 280 static int mxl1x1sf_demod_reset_irq_status(struct mxl111sf_demod_state *state) 281 { 282 return mxl111sf_demod_write_reg(state, 0x0e, 0xff); 283 } 284 285 /* ------------------------------------------------------------------------ */ 286 287 static int mxl111sf_demod_set_frontend(struct dvb_frontend *fe) 288 { 289 struct mxl111sf_demod_state *state = fe->demodulator_priv; 290 int ret = 0; 291 292 struct mxl111sf_reg_ctrl_info phy_pll_patch[] = { 293 {0x00, 0xff, 0x01}, /* change page to 1 */ 294 {0x40, 0xff, 0x05}, 295 {0x40, 0xff, 0x01}, 296 {0x41, 0xff, 0xca}, 297 {0x41, 0xff, 0xc0}, 298 {0x00, 0xff, 0x00}, /* change page to 0 */ 299 {0, 0, 0} 300 }; 301 302 mxl_dbg("()"); 303 304 if (fe->ops.tuner_ops.set_params) { 305 ret = fe->ops.tuner_ops.set_params(fe); 306 if (mxl_fail(ret)) 307 goto fail; 308 msleep(50); 309 } 310 ret = mxl111sf_demod_program_regs(state, phy_pll_patch); 311 mxl_fail(ret); 312 msleep(50); 313 ret = mxl1x1sf_demod_reset_irq_status(state); 314 mxl_fail(ret); 315 msleep(100); 316 fail: 317 return ret; 318 } 319 320 /* ------------------------------------------------------------------------ */ 321 322 #if 0 323 /* resets TS Packet error count */ 324 /* After setting 7th bit of V5_PER_COUNT_RESET_REG, it should be reset to 0. */ 325 static 326 int mxl1x1sf_demod_reset_packet_error_count(struct mxl111sf_demod_state *state) 327 { 328 struct mxl111sf_reg_ctrl_info reset_per_count[] = { 329 {0x20, 0x01, 0x01}, 330 {0x20, 0x01, 0x00}, 331 {0, 0, 0} 332 }; 333 return mxl111sf_demod_program_regs(state, reset_per_count); 334 } 335 #endif 336 337 /* returns TS Packet error count */ 338 /* PER Count = FEC_PER_COUNT * (2 ** (FEC_PER_SCALE * 4)) */ 339 static int mxl111sf_demod_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks) 340 { 341 struct mxl111sf_demod_state *state = fe->demodulator_priv; 342 u32 fec_per_count, fec_per_scale; 343 u8 val; 344 int ret; 345 346 *ucblocks = 0; 347 348 /* FEC_PER_COUNT Register */ 349 ret = mxl111sf_demod_read_reg(state, V6_FEC_PER_COUNT_REG, &val); 350 if (mxl_fail(ret)) 351 goto fail; 352 353 fec_per_count = val; 354 355 /* FEC_PER_SCALE Register */ 356 ret = mxl111sf_demod_read_reg(state, V6_FEC_PER_SCALE_REG, &val); 357 if (mxl_fail(ret)) 358 goto fail; 359 360 val &= V6_FEC_PER_SCALE_MASK; 361 val *= 4; 362 363 fec_per_scale = 1 << val; 364 365 fec_per_count *= fec_per_scale; 366 367 *ucblocks = fec_per_count; 368 fail: 369 return ret; 370 } 371 372 #ifdef MXL111SF_DEMOD_ENABLE_CALCULATIONS 373 /* FIXME: leaving this enabled breaks the build on some architectures, 374 * and we shouldn't have any floating point math in the kernel, anyway. 375 * 376 * These macros need to be re-written, but it's harmless to simply 377 * return zero for now. */ 378 #define CALCULATE_BER(avg_errors, count) \ 379 ((u32)(avg_errors * 4)/(count*64*188*8)) 380 #define CALCULATE_SNR(data) \ 381 ((u32)((10 * (u32)data / 64) - 2.5)) 382 #else 383 #define CALCULATE_BER(avg_errors, count) 0 384 #define CALCULATE_SNR(data) 0 385 #endif 386 387 static int mxl111sf_demod_read_ber(struct dvb_frontend *fe, u32 *ber) 388 { 389 struct mxl111sf_demod_state *state = fe->demodulator_priv; 390 u8 val1, val2, val3; 391 int ret; 392 393 *ber = 0; 394 395 ret = mxl111sf_demod_read_reg(state, V6_RS_AVG_ERRORS_LSB_REG, &val1); 396 if (mxl_fail(ret)) 397 goto fail; 398 ret = mxl111sf_demod_read_reg(state, V6_RS_AVG_ERRORS_MSB_REG, &val2); 399 if (mxl_fail(ret)) 400 goto fail; 401 ret = mxl111sf_demod_read_reg(state, V6_N_ACCUMULATE_REG, &val3); 402 if (mxl_fail(ret)) 403 goto fail; 404 405 *ber = CALCULATE_BER((val1 | (val2 << 8)), val3); 406 fail: 407 return ret; 408 } 409 410 static int mxl111sf_demod_calc_snr(struct mxl111sf_demod_state *state, 411 u16 *snr) 412 { 413 u8 val1, val2; 414 int ret; 415 416 *snr = 0; 417 418 ret = mxl111sf_demod_read_reg(state, V6_SNR_RB_LSB_REG, &val1); 419 if (mxl_fail(ret)) 420 goto fail; 421 ret = mxl111sf_demod_read_reg(state, V6_SNR_RB_MSB_REG, &val2); 422 if (mxl_fail(ret)) 423 goto fail; 424 425 *snr = CALCULATE_SNR(val1 | ((val2 & 0x03) << 8)); 426 fail: 427 return ret; 428 } 429 430 static int mxl111sf_demod_read_snr(struct dvb_frontend *fe, u16 *snr) 431 { 432 struct mxl111sf_demod_state *state = fe->demodulator_priv; 433 434 int ret = mxl111sf_demod_calc_snr(state, snr); 435 if (mxl_fail(ret)) 436 goto fail; 437 438 *snr /= 10; /* 0.1 dB */ 439 fail: 440 return ret; 441 } 442 443 static int mxl111sf_demod_read_status(struct dvb_frontend *fe, 444 fe_status_t *status) 445 { 446 struct mxl111sf_demod_state *state = fe->demodulator_priv; 447 int ret, locked, cr_lock, sync_lock, fec_lock; 448 449 *status = 0; 450 451 ret = mxl1x1sf_demod_get_rs_lock_status(state, &locked); 452 if (mxl_fail(ret)) 453 goto fail; 454 ret = mxl1x1sf_demod_get_tps_lock_status(state, &cr_lock); 455 if (mxl_fail(ret)) 456 goto fail; 457 ret = mxl1x1sf_demod_get_sync_lock_status(state, &sync_lock); 458 if (mxl_fail(ret)) 459 goto fail; 460 ret = mxl1x1sf_demod_get_fec_lock_status(state, &fec_lock); 461 if (mxl_fail(ret)) 462 goto fail; 463 464 if (locked) 465 *status |= FE_HAS_SIGNAL; 466 if (cr_lock) 467 *status |= FE_HAS_CARRIER; 468 if (sync_lock) 469 *status |= FE_HAS_SYNC; 470 if (fec_lock) /* false positives? */ 471 *status |= FE_HAS_VITERBI; 472 473 if ((locked) && (cr_lock) && (sync_lock)) 474 *status |= FE_HAS_LOCK; 475 fail: 476 return ret; 477 } 478 479 static int mxl111sf_demod_read_signal_strength(struct dvb_frontend *fe, 480 u16 *signal_strength) 481 { 482 struct mxl111sf_demod_state *state = fe->demodulator_priv; 483 fe_modulation_t modulation; 484 u16 snr; 485 486 mxl111sf_demod_calc_snr(state, &snr); 487 mxl1x1sf_demod_get_tps_modulation(state, &modulation); 488 489 switch (modulation) { 490 case QPSK: 491 *signal_strength = (snr >= 1300) ? 492 min(65535, snr * 44) : snr * 38; 493 break; 494 case QAM_16: 495 *signal_strength = (snr >= 1500) ? 496 min(65535, snr * 38) : snr * 33; 497 break; 498 case QAM_64: 499 *signal_strength = (snr >= 2000) ? 500 min(65535, snr * 29) : snr * 25; 501 break; 502 default: 503 *signal_strength = 0; 504 return -EINVAL; 505 } 506 507 return 0; 508 } 509 510 static int mxl111sf_demod_get_frontend(struct dvb_frontend *fe) 511 { 512 struct dtv_frontend_properties *p = &fe->dtv_property_cache; 513 struct mxl111sf_demod_state *state = fe->demodulator_priv; 514 515 mxl_dbg("()"); 516 #if 0 517 p->inversion = /* FIXME */ ? INVERSION_ON : INVERSION_OFF; 518 #endif 519 if (fe->ops.tuner_ops.get_bandwidth) 520 fe->ops.tuner_ops.get_bandwidth(fe, &p->bandwidth_hz); 521 if (fe->ops.tuner_ops.get_frequency) 522 fe->ops.tuner_ops.get_frequency(fe, &p->frequency); 523 mxl1x1sf_demod_get_tps_code_rate(state, &p->code_rate_HP); 524 mxl1x1sf_demod_get_tps_code_rate(state, &p->code_rate_LP); 525 mxl1x1sf_demod_get_tps_modulation(state, &p->modulation); 526 mxl1x1sf_demod_get_tps_guard_fft_mode(state, 527 &p->transmission_mode); 528 mxl1x1sf_demod_get_tps_guard_interval(state, 529 &p->guard_interval); 530 mxl1x1sf_demod_get_tps_hierarchy(state, 531 &p->hierarchy); 532 533 return 0; 534 } 535 536 static 537 int mxl111sf_demod_get_tune_settings(struct dvb_frontend *fe, 538 struct dvb_frontend_tune_settings *tune) 539 { 540 tune->min_delay_ms = 1000; 541 return 0; 542 } 543 544 static void mxl111sf_demod_release(struct dvb_frontend *fe) 545 { 546 struct mxl111sf_demod_state *state = fe->demodulator_priv; 547 mxl_dbg("()"); 548 kfree(state); 549 fe->demodulator_priv = NULL; 550 } 551 552 static struct dvb_frontend_ops mxl111sf_demod_ops = { 553 .delsys = { SYS_DVBT }, 554 .info = { 555 .name = "MaxLinear MxL111SF DVB-T demodulator", 556 .frequency_min = 177000000, 557 .frequency_max = 858000000, 558 .frequency_stepsize = 166666, 559 .caps = FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 | 560 FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO | 561 FE_CAN_QPSK | FE_CAN_QAM_16 | FE_CAN_QAM_64 | 562 FE_CAN_QAM_AUTO | 563 FE_CAN_HIERARCHY_AUTO | FE_CAN_GUARD_INTERVAL_AUTO | 564 FE_CAN_TRANSMISSION_MODE_AUTO | FE_CAN_RECOVER 565 }, 566 .release = mxl111sf_demod_release, 567 #if 0 568 .init = mxl111sf_init, 569 .i2c_gate_ctrl = mxl111sf_i2c_gate_ctrl, 570 #endif 571 .set_frontend = mxl111sf_demod_set_frontend, 572 .get_frontend = mxl111sf_demod_get_frontend, 573 .get_tune_settings = mxl111sf_demod_get_tune_settings, 574 .read_status = mxl111sf_demod_read_status, 575 .read_signal_strength = mxl111sf_demod_read_signal_strength, 576 .read_ber = mxl111sf_demod_read_ber, 577 .read_snr = mxl111sf_demod_read_snr, 578 .read_ucblocks = mxl111sf_demod_read_ucblocks, 579 }; 580 581 struct dvb_frontend *mxl111sf_demod_attach(struct mxl111sf_state *mxl_state, 582 struct mxl111sf_demod_config *cfg) 583 { 584 struct mxl111sf_demod_state *state = NULL; 585 586 mxl_dbg("()"); 587 588 state = kzalloc(sizeof(struct mxl111sf_demod_state), GFP_KERNEL); 589 if (state == NULL) 590 return NULL; 591 592 state->mxl_state = mxl_state; 593 state->cfg = cfg; 594 595 memcpy(&state->fe.ops, &mxl111sf_demod_ops, 596 sizeof(struct dvb_frontend_ops)); 597 598 state->fe.demodulator_priv = state; 599 return &state->fe; 600 } 601 EXPORT_SYMBOL_GPL(mxl111sf_demod_attach); 602 603 MODULE_DESCRIPTION("MaxLinear MxL111SF DVB-T demodulator driver"); 604 MODULE_AUTHOR("Michael Krufky <mkrufky@kernellabs.com>"); 605 MODULE_LICENSE("GPL"); 606 MODULE_VERSION("0.1"); 607 608 /* 609 * Local variables: 610 * c-basic-offset: 8 611 * End: 612 */ 613