1 /* 2 Conexant cx24120/cx24118 - DVBS/S2 Satellite demod/tuner driver 3 4 Copyright (C) 2008 Patrick Boettcher <pb@linuxtv.org> 5 Copyright (C) 2009 Sergey Tyurin <forum.free-x.de> 6 Updated 2012 by Jannis Achstetter <jannis_achstetter@web.de> 7 Copyright (C) 2015 Jemma Denson <jdenson@gmail.com> 8 April 2015 9 Refactored & simplified driver 10 Updated to work with delivery system supplied by DVBv5 11 Add frequency, fec & pilot to get_frontend 12 13 Cards supported: Technisat Skystar S2 14 15 This program is free software; you can redistribute it and/or modify 16 it under the terms of the GNU General Public License as published by 17 the Free Software Foundation; either version 2 of the License, or 18 (at your option) any later version. 19 20 This program is distributed in the hope that it will be useful, 21 but WITHOUT ANY WARRANTY; without even the implied warranty of 22 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 23 GNU General Public License for more details. 24 */ 25 26 #include <linux/slab.h> 27 #include <linux/kernel.h> 28 #include <linux/module.h> 29 #include <linux/moduleparam.h> 30 #include <linux/init.h> 31 #include <linux/firmware.h> 32 #include "dvb_frontend.h" 33 #include "cx24120.h" 34 35 #define CX24120_SEARCH_RANGE_KHZ 5000 36 #define CX24120_FIRMWARE "dvb-fe-cx24120-1.20.58.2.fw" 37 38 /* cx24120 i2c registers */ 39 #define CX24120_REG_CMD_START 0x00 /* write cmd_id */ 40 #define CX24120_REG_CMD_ARGS 0x01 /* write command arguments */ 41 #define CX24120_REG_CMD_END 0x1f /* write 0x01 for end */ 42 43 #define CX24120_REG_MAILBOX 0x33 44 #define CX24120_REG_FREQ3 0x34 /* frequency */ 45 #define CX24120_REG_FREQ2 0x35 46 #define CX24120_REG_FREQ1 0x36 47 48 #define CX24120_REG_FECMODE 0x39 /* FEC status */ 49 #define CX24120_REG_STATUS 0x3a /* Tuner status */ 50 #define CX24120_REG_SIGSTR_H 0x3a /* Signal strength high */ 51 #define CX24120_REG_SIGSTR_L 0x3b /* Signal strength low byte */ 52 #define CX24120_REG_QUALITY_H 0x40 /* SNR high byte */ 53 #define CX24120_REG_QUALITY_L 0x41 /* SNR low byte */ 54 55 #define CX24120_REG_BER_HH 0x47 /* BER high byte of high word */ 56 #define CX24120_REG_BER_HL 0x48 /* BER low byte of high word */ 57 #define CX24120_REG_BER_LH 0x49 /* BER high byte of low word */ 58 #define CX24120_REG_BER_LL 0x4a /* BER low byte of low word */ 59 60 #define CX24120_REG_UCB_H 0x50 /* UCB high byte */ 61 #define CX24120_REG_UCB_L 0x51 /* UCB low byte */ 62 63 #define CX24120_REG_CLKDIV 0xe6 64 #define CX24120_REG_RATEDIV 0xf0 65 66 #define CX24120_REG_REVISION 0xff /* Chip revision (ro) */ 67 68 /* Command messages */ 69 enum command_message_id { 70 CMD_VCO_SET = 0x10, /* cmd.len = 12; */ 71 CMD_TUNEREQUEST = 0x11, /* cmd.len = 15; */ 72 73 CMD_MPEG_ONOFF = 0x13, /* cmd.len = 4; */ 74 CMD_MPEG_INIT = 0x14, /* cmd.len = 7; */ 75 CMD_BANDWIDTH = 0x15, /* cmd.len = 12; */ 76 CMD_CLOCK_READ = 0x16, /* read clock */ 77 CMD_CLOCK_SET = 0x17, /* cmd.len = 10; */ 78 79 CMD_DISEQC_MSG1 = 0x20, /* cmd.len = 11; */ 80 CMD_DISEQC_MSG2 = 0x21, /* cmd.len = d->msg_len + 6; */ 81 CMD_SETVOLTAGE = 0x22, /* cmd.len = 2; */ 82 CMD_SETTONE = 0x23, /* cmd.len = 4; */ 83 CMD_DISEQC_BURST = 0x24, /* cmd.len not used !!! */ 84 85 CMD_READ_SNR = 0x1a, /* Read signal strength */ 86 CMD_START_TUNER = 0x1b, /* ??? */ 87 88 CMD_FWVERSION = 0x35, 89 90 CMD_BER_CTRL = 0x3c, /* cmd.len = 0x03; */ 91 }; 92 93 #define CX24120_MAX_CMD_LEN 30 94 95 /* pilot mask */ 96 #define CX24120_PILOT_OFF 0x00 97 #define CX24120_PILOT_ON 0x40 98 #define CX24120_PILOT_AUTO 0x80 99 100 /* signal status */ 101 #define CX24120_HAS_SIGNAL 0x01 102 #define CX24120_HAS_CARRIER 0x02 103 #define CX24120_HAS_VITERBI 0x04 104 #define CX24120_HAS_LOCK 0x08 105 #define CX24120_HAS_UNK1 0x10 106 #define CX24120_HAS_UNK2 0x20 107 #define CX24120_STATUS_MASK 0x0f 108 #define CX24120_SIGNAL_MASK 0xc0 109 110 /* ber window */ 111 #define CX24120_BER_WINDOW 16 112 #define CX24120_BER_WSIZE ((1 << CX24120_BER_WINDOW) * 208 * 8) 113 114 #define info(args...) pr_info("cx24120: " args) 115 #define err(args...) pr_err("cx24120: ### ERROR: " args) 116 117 /* The Demod/Tuner can't easily provide these, we cache them */ 118 struct cx24120_tuning { 119 u32 frequency; 120 u32 symbol_rate; 121 enum fe_spectral_inversion inversion; 122 enum fe_code_rate fec; 123 124 enum fe_delivery_system delsys; 125 enum fe_modulation modulation; 126 enum fe_pilot pilot; 127 128 /* Demod values */ 129 u8 fec_val; 130 u8 fec_mask; 131 u8 clkdiv; 132 u8 ratediv; 133 u8 inversion_val; 134 u8 pilot_val; 135 }; 136 137 /* Private state */ 138 struct cx24120_state { 139 struct i2c_adapter *i2c; 140 const struct cx24120_config *config; 141 struct dvb_frontend frontend; 142 143 u8 cold_init; 144 u8 mpeg_enabled; 145 u8 need_clock_set; 146 147 /* current and next tuning parameters */ 148 struct cx24120_tuning dcur; 149 struct cx24120_tuning dnxt; 150 151 enum fe_status fe_status; 152 153 /* dvbv5 stats calculations */ 154 u32 bitrate; 155 u32 berw_usecs; 156 u32 ber_prev; 157 u32 ucb_offset; 158 unsigned long ber_jiffies_stats; 159 unsigned long per_jiffies_stats; 160 }; 161 162 /* Command message to firmware */ 163 struct cx24120_cmd { 164 u8 id; 165 u8 len; 166 u8 arg[CX24120_MAX_CMD_LEN]; 167 }; 168 169 /* Read single register */ 170 static int cx24120_readreg(struct cx24120_state *state, u8 reg) 171 { 172 int ret; 173 u8 buf = 0; 174 struct i2c_msg msg[] = { 175 { 176 .addr = state->config->i2c_addr, 177 .flags = 0, 178 .len = 1, 179 .buf = ® 180 }, { 181 .addr = state->config->i2c_addr, 182 .flags = I2C_M_RD, 183 .len = 1, 184 .buf = &buf 185 } 186 }; 187 188 ret = i2c_transfer(state->i2c, msg, 2); 189 if (ret != 2) { 190 err("Read error: reg=0x%02x, ret=%i)\n", reg, ret); 191 return ret; 192 } 193 194 dev_dbg(&state->i2c->dev, "reg=0x%02x; data=0x%02x\n", reg, buf); 195 196 return buf; 197 } 198 199 /* Write single register */ 200 static int cx24120_writereg(struct cx24120_state *state, u8 reg, u8 data) 201 { 202 u8 buf[] = { reg, data }; 203 struct i2c_msg msg = { 204 .addr = state->config->i2c_addr, 205 .flags = 0, 206 .buf = buf, 207 .len = 2 208 }; 209 int ret; 210 211 ret = i2c_transfer(state->i2c, &msg, 1); 212 if (ret != 1) { 213 err("Write error: i2c_write error(err == %i, 0x%02x: 0x%02x)\n", 214 ret, reg, data); 215 return ret; 216 } 217 218 dev_dbg(&state->i2c->dev, "reg=0x%02x; data=0x%02x\n", reg, data); 219 220 return 0; 221 } 222 223 /* Write multiple registers in chunks of i2c_wr_max-sized buffers */ 224 static int cx24120_writeregs(struct cx24120_state *state, 225 u8 reg, const u8 *values, u16 len, u8 incr) 226 { 227 int ret; 228 u16 max = state->config->i2c_wr_max > 0 ? 229 state->config->i2c_wr_max : 230 len; 231 232 struct i2c_msg msg = { 233 .addr = state->config->i2c_addr, 234 .flags = 0, 235 }; 236 237 msg.buf = kmalloc(max + 1, GFP_KERNEL); 238 if (!msg.buf) 239 return -ENOMEM; 240 241 while (len) { 242 msg.buf[0] = reg; 243 msg.len = len > max ? max : len; 244 memcpy(&msg.buf[1], values, msg.len); 245 246 len -= msg.len; /* data length revers counter */ 247 values += msg.len; /* incr data pointer */ 248 249 if (incr) 250 reg += msg.len; 251 msg.len++; /* don't forget the addr byte */ 252 253 ret = i2c_transfer(state->i2c, &msg, 1); 254 if (ret != 1) { 255 err("i2c_write error(err == %i, 0x%02x)\n", ret, reg); 256 goto out; 257 } 258 259 dev_dbg(&state->i2c->dev, "reg=0x%02x; data=%*ph\n", 260 reg, msg.len - 1, msg.buf + 1); 261 } 262 263 ret = 0; 264 265 out: 266 kfree(msg.buf); 267 return ret; 268 } 269 270 static struct dvb_frontend_ops cx24120_ops; 271 272 struct dvb_frontend *cx24120_attach(const struct cx24120_config *config, 273 struct i2c_adapter *i2c) 274 { 275 struct cx24120_state *state; 276 int demod_rev; 277 278 info("Conexant cx24120/cx24118 - DVBS/S2 Satellite demod/tuner\n"); 279 state = kzalloc(sizeof(*state), GFP_KERNEL); 280 if (!state) { 281 err("Unable to allocate memory for cx24120_state\n"); 282 goto error; 283 } 284 285 /* setup the state */ 286 state->config = config; 287 state->i2c = i2c; 288 289 /* check if the demod is present and has proper type */ 290 demod_rev = cx24120_readreg(state, CX24120_REG_REVISION); 291 switch (demod_rev) { 292 case 0x07: 293 info("Demod cx24120 rev. 0x07 detected.\n"); 294 break; 295 case 0x05: 296 info("Demod cx24120 rev. 0x05 detected.\n"); 297 break; 298 default: 299 err("Unsupported demod revision: 0x%x detected.\n", demod_rev); 300 goto error; 301 } 302 303 /* create dvb_frontend */ 304 state->cold_init = 0; 305 memcpy(&state->frontend.ops, &cx24120_ops, 306 sizeof(struct dvb_frontend_ops)); 307 state->frontend.demodulator_priv = state; 308 309 info("Conexant cx24120/cx24118 attached.\n"); 310 return &state->frontend; 311 312 error: 313 kfree(state); 314 return NULL; 315 } 316 EXPORT_SYMBOL(cx24120_attach); 317 318 static int cx24120_test_rom(struct cx24120_state *state) 319 { 320 int err, ret; 321 322 err = cx24120_readreg(state, 0xfd); 323 if (err & 4) { 324 ret = cx24120_readreg(state, 0xdf) & 0xfe; 325 err = cx24120_writereg(state, 0xdf, ret); 326 } 327 return err; 328 } 329 330 static int cx24120_read_snr(struct dvb_frontend *fe, u16 *snr) 331 { 332 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 333 334 if (c->cnr.stat[0].scale != FE_SCALE_DECIBEL) 335 *snr = 0; 336 else 337 *snr = div_s64(c->cnr.stat[0].svalue, 100); 338 339 return 0; 340 } 341 342 static int cx24120_read_ber(struct dvb_frontend *fe, u32 *ber) 343 { 344 struct cx24120_state *state = fe->demodulator_priv; 345 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 346 347 if (c->post_bit_error.stat[0].scale != FE_SCALE_COUNTER) { 348 *ber = 0; 349 return 0; 350 } 351 352 *ber = c->post_bit_error.stat[0].uvalue - state->ber_prev; 353 state->ber_prev = c->post_bit_error.stat[0].uvalue; 354 355 return 0; 356 } 357 358 static int cx24120_msg_mpeg_output_global_config(struct cx24120_state *state, 359 u8 flag); 360 361 /* Check if we're running a command that needs to disable mpeg out */ 362 static void cx24120_check_cmd(struct cx24120_state *state, u8 id) 363 { 364 switch (id) { 365 case CMD_TUNEREQUEST: 366 case CMD_CLOCK_READ: 367 case CMD_DISEQC_MSG1: 368 case CMD_DISEQC_MSG2: 369 case CMD_SETVOLTAGE: 370 case CMD_SETTONE: 371 case CMD_DISEQC_BURST: 372 cx24120_msg_mpeg_output_global_config(state, 0); 373 /* Old driver would do a msleep(100) here */ 374 default: 375 return; 376 } 377 } 378 379 /* Send a message to the firmware */ 380 static int cx24120_message_send(struct cx24120_state *state, 381 struct cx24120_cmd *cmd) 382 { 383 int ficus; 384 385 if (state->mpeg_enabled) { 386 /* Disable mpeg out on certain commands */ 387 cx24120_check_cmd(state, cmd->id); 388 } 389 390 cx24120_writereg(state, CX24120_REG_CMD_START, cmd->id); 391 cx24120_writeregs(state, CX24120_REG_CMD_ARGS, &cmd->arg[0], 392 cmd->len, 1); 393 cx24120_writereg(state, CX24120_REG_CMD_END, 0x01); 394 395 ficus = 1000; 396 while (cx24120_readreg(state, CX24120_REG_CMD_END)) { 397 msleep(20); 398 ficus -= 20; 399 if (ficus == 0) { 400 err("Error sending message to firmware\n"); 401 return -EREMOTEIO; 402 } 403 } 404 dev_dbg(&state->i2c->dev, "sent message 0x%02x\n", cmd->id); 405 406 return 0; 407 } 408 409 /* Send a message and fill arg[] with the results */ 410 static int cx24120_message_sendrcv(struct cx24120_state *state, 411 struct cx24120_cmd *cmd, u8 numreg) 412 { 413 int ret, i; 414 415 if (numreg > CX24120_MAX_CMD_LEN) { 416 err("Too many registers to read. cmd->reg = %d", numreg); 417 return -EREMOTEIO; 418 } 419 420 ret = cx24120_message_send(state, cmd); 421 if (ret != 0) 422 return ret; 423 424 if (!numreg) 425 return 0; 426 427 /* Read numreg registers starting from register cmd->len */ 428 for (i = 0; i < numreg; i++) 429 cmd->arg[i] = cx24120_readreg(state, (cmd->len + i + 1)); 430 431 return 0; 432 } 433 434 static int cx24120_read_signal_strength(struct dvb_frontend *fe, 435 u16 *signal_strength) 436 { 437 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 438 439 if (c->strength.stat[0].scale != FE_SCALE_RELATIVE) 440 *signal_strength = 0; 441 else 442 *signal_strength = c->strength.stat[0].uvalue; 443 444 return 0; 445 } 446 447 static int cx24120_msg_mpeg_output_global_config(struct cx24120_state *state, 448 u8 enable) 449 { 450 struct cx24120_cmd cmd; 451 int ret; 452 453 cmd.id = CMD_MPEG_ONOFF; 454 cmd.len = 4; 455 cmd.arg[0] = 0x01; 456 cmd.arg[1] = 0x00; 457 cmd.arg[2] = enable ? 0 : (u8)(-1); 458 cmd.arg[3] = 0x01; 459 460 ret = cx24120_message_send(state, &cmd); 461 if (ret != 0) { 462 dev_dbg(&state->i2c->dev, "failed to %s MPEG output\n", 463 enable ? "enable" : "disable"); 464 return ret; 465 } 466 467 state->mpeg_enabled = enable; 468 dev_dbg(&state->i2c->dev, "MPEG output %s\n", 469 enable ? "enabled" : "disabled"); 470 471 return 0; 472 } 473 474 static int cx24120_msg_mpeg_output_config(struct cx24120_state *state, u8 seq) 475 { 476 struct cx24120_cmd cmd; 477 struct cx24120_initial_mpeg_config i = 478 state->config->initial_mpeg_config; 479 480 cmd.id = CMD_MPEG_INIT; 481 cmd.len = 7; 482 cmd.arg[0] = seq; /* sequental number - can be 0,1,2 */ 483 cmd.arg[1] = ((i.x1 & 0x01) << 1) | ((i.x1 >> 1) & 0x01); 484 cmd.arg[2] = 0x05; 485 cmd.arg[3] = 0x02; 486 cmd.arg[4] = ((i.x2 >> 1) & 0x01); 487 cmd.arg[5] = (i.x2 & 0xf0) | (i.x3 & 0x0f); 488 cmd.arg[6] = 0x10; 489 490 return cx24120_message_send(state, &cmd); 491 } 492 493 static int cx24120_diseqc_send_burst(struct dvb_frontend *fe, 494 enum fe_sec_mini_cmd burst) 495 { 496 struct cx24120_state *state = fe->demodulator_priv; 497 struct cx24120_cmd cmd; 498 499 dev_dbg(&state->i2c->dev, "\n"); 500 501 /* 502 * Yes, cmd.len is set to zero. The old driver 503 * didn't specify any len, but also had a 504 * memset 0 before every use of the cmd struct 505 * which would have set it to zero. 506 * This quite probably needs looking into. 507 */ 508 cmd.id = CMD_DISEQC_BURST; 509 cmd.len = 0; 510 cmd.arg[0] = 0x00; 511 cmd.arg[1] = (burst == SEC_MINI_B) ? 0x01 : 0x00; 512 513 return cx24120_message_send(state, &cmd); 514 } 515 516 static int cx24120_set_tone(struct dvb_frontend *fe, enum fe_sec_tone_mode tone) 517 { 518 struct cx24120_state *state = fe->demodulator_priv; 519 struct cx24120_cmd cmd; 520 521 dev_dbg(&state->i2c->dev, "(%d)\n", tone); 522 523 if ((tone != SEC_TONE_ON) && (tone != SEC_TONE_OFF)) { 524 err("Invalid tone=%d\n", tone); 525 return -EINVAL; 526 } 527 528 cmd.id = CMD_SETTONE; 529 cmd.len = 4; 530 cmd.arg[0] = 0x00; 531 cmd.arg[1] = 0x00; 532 cmd.arg[2] = 0x00; 533 cmd.arg[3] = (tone == SEC_TONE_ON) ? 0x01 : 0x00; 534 535 return cx24120_message_send(state, &cmd); 536 } 537 538 static int cx24120_set_voltage(struct dvb_frontend *fe, 539 enum fe_sec_voltage voltage) 540 { 541 struct cx24120_state *state = fe->demodulator_priv; 542 struct cx24120_cmd cmd; 543 544 dev_dbg(&state->i2c->dev, "(%d)\n", voltage); 545 546 cmd.id = CMD_SETVOLTAGE; 547 cmd.len = 2; 548 cmd.arg[0] = 0x00; 549 cmd.arg[1] = (voltage == SEC_VOLTAGE_18) ? 0x01 : 0x00; 550 551 return cx24120_message_send(state, &cmd); 552 } 553 554 static int cx24120_send_diseqc_msg(struct dvb_frontend *fe, 555 struct dvb_diseqc_master_cmd *d) 556 { 557 struct cx24120_state *state = fe->demodulator_priv; 558 struct cx24120_cmd cmd; 559 int back_count; 560 561 dev_dbg(&state->i2c->dev, "\n"); 562 563 cmd.id = CMD_DISEQC_MSG1; 564 cmd.len = 11; 565 cmd.arg[0] = 0x00; 566 cmd.arg[1] = 0x00; 567 cmd.arg[2] = 0x03; 568 cmd.arg[3] = 0x16; 569 cmd.arg[4] = 0x28; 570 cmd.arg[5] = 0x01; 571 cmd.arg[6] = 0x01; 572 cmd.arg[7] = 0x14; 573 cmd.arg[8] = 0x19; 574 cmd.arg[9] = 0x14; 575 cmd.arg[10] = 0x1e; 576 577 if (cx24120_message_send(state, &cmd)) { 578 err("send 1st message(0x%x) failed\n", cmd.id); 579 return -EREMOTEIO; 580 } 581 582 cmd.id = CMD_DISEQC_MSG2; 583 cmd.len = d->msg_len + 6; 584 cmd.arg[0] = 0x00; 585 cmd.arg[1] = 0x01; 586 cmd.arg[2] = 0x02; 587 cmd.arg[3] = 0x00; 588 cmd.arg[4] = 0x00; 589 cmd.arg[5] = d->msg_len; 590 591 memcpy(&cmd.arg[6], &d->msg, d->msg_len); 592 593 if (cx24120_message_send(state, &cmd)) { 594 err("send 2nd message(0x%x) failed\n", cmd.id); 595 return -EREMOTEIO; 596 } 597 598 back_count = 500; 599 do { 600 if (!(cx24120_readreg(state, 0x93) & 0x01)) { 601 dev_dbg(&state->i2c->dev, "diseqc sequence sent\n"); 602 return 0; 603 } 604 msleep(20); 605 back_count -= 20; 606 } while (back_count); 607 608 err("Too long waiting for diseqc.\n"); 609 return -ETIMEDOUT; 610 } 611 612 static void cx24120_get_stats(struct cx24120_state *state) 613 { 614 struct dvb_frontend *fe = &state->frontend; 615 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 616 struct cx24120_cmd cmd; 617 int ret, cnr, msecs; 618 u16 sig, ucb; 619 u32 ber; 620 621 dev_dbg(&state->i2c->dev, "\n"); 622 623 /* signal strength */ 624 if (state->fe_status & FE_HAS_SIGNAL) { 625 cmd.id = CMD_READ_SNR; 626 cmd.len = 1; 627 cmd.arg[0] = 0x00; 628 629 ret = cx24120_message_send(state, &cmd); 630 if (ret != 0) { 631 err("error reading signal strength\n"); 632 return; 633 } 634 635 /* raw */ 636 sig = cx24120_readreg(state, CX24120_REG_SIGSTR_H) >> 6; 637 sig = sig << 8; 638 sig |= cx24120_readreg(state, CX24120_REG_SIGSTR_L); 639 dev_dbg(&state->i2c->dev, 640 "signal strength from firmware = 0x%x\n", sig); 641 642 /* cooked */ 643 sig = -100 * sig + 94324; 644 645 c->strength.stat[0].scale = FE_SCALE_RELATIVE; 646 c->strength.stat[0].uvalue = sig; 647 } else { 648 c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 649 } 650 651 /* CNR */ 652 if (state->fe_status & FE_HAS_VITERBI) { 653 cnr = cx24120_readreg(state, CX24120_REG_QUALITY_H) << 8; 654 cnr |= cx24120_readreg(state, CX24120_REG_QUALITY_L); 655 dev_dbg(&state->i2c->dev, "read SNR index = %d\n", cnr); 656 657 /* guessed - seems about right */ 658 cnr = cnr * 100; 659 660 c->cnr.stat[0].scale = FE_SCALE_DECIBEL; 661 c->cnr.stat[0].svalue = cnr; 662 } else { 663 c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 664 } 665 666 /* BER & UCB require lock */ 667 if (!(state->fe_status & FE_HAS_LOCK)) { 668 c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 669 c->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 670 c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 671 c->block_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 672 return; 673 } 674 675 /* BER */ 676 if (time_after(jiffies, state->ber_jiffies_stats)) { 677 msecs = (state->berw_usecs + 500) / 1000; 678 state->ber_jiffies_stats = jiffies + msecs_to_jiffies(msecs); 679 680 ber = cx24120_readreg(state, CX24120_REG_BER_HH) << 24; 681 ber |= cx24120_readreg(state, CX24120_REG_BER_HL) << 16; 682 ber |= cx24120_readreg(state, CX24120_REG_BER_LH) << 8; 683 ber |= cx24120_readreg(state, CX24120_REG_BER_LL); 684 dev_dbg(&state->i2c->dev, "read BER index = %d\n", ber); 685 686 c->post_bit_error.stat[0].scale = FE_SCALE_COUNTER; 687 c->post_bit_error.stat[0].uvalue += ber; 688 689 c->post_bit_count.stat[0].scale = FE_SCALE_COUNTER; 690 c->post_bit_count.stat[0].uvalue += CX24120_BER_WSIZE; 691 } 692 693 /* UCB */ 694 if (time_after(jiffies, state->per_jiffies_stats)) { 695 state->per_jiffies_stats = jiffies + msecs_to_jiffies(1000); 696 697 ucb = cx24120_readreg(state, CX24120_REG_UCB_H) << 8; 698 ucb |= cx24120_readreg(state, CX24120_REG_UCB_L); 699 dev_dbg(&state->i2c->dev, "ucblocks = %d\n", ucb); 700 701 /* handle reset */ 702 if (ucb < state->ucb_offset) 703 state->ucb_offset = c->block_error.stat[0].uvalue; 704 705 c->block_error.stat[0].scale = FE_SCALE_COUNTER; 706 c->block_error.stat[0].uvalue = ucb + state->ucb_offset; 707 708 c->block_count.stat[0].scale = FE_SCALE_COUNTER; 709 c->block_count.stat[0].uvalue += state->bitrate / 8 / 208; 710 } 711 } 712 713 static void cx24120_set_clock_ratios(struct dvb_frontend *fe); 714 715 /* Read current tuning status */ 716 static int cx24120_read_status(struct dvb_frontend *fe, enum fe_status *status) 717 { 718 struct cx24120_state *state = fe->demodulator_priv; 719 int lock; 720 721 lock = cx24120_readreg(state, CX24120_REG_STATUS); 722 723 dev_dbg(&state->i2c->dev, "status = 0x%02x\n", lock); 724 725 *status = 0; 726 727 if (lock & CX24120_HAS_SIGNAL) 728 *status = FE_HAS_SIGNAL; 729 if (lock & CX24120_HAS_CARRIER) 730 *status |= FE_HAS_CARRIER; 731 if (lock & CX24120_HAS_VITERBI) 732 *status |= FE_HAS_VITERBI | FE_HAS_SYNC; 733 if (lock & CX24120_HAS_LOCK) 734 *status |= FE_HAS_LOCK; 735 736 /* 737 * TODO: is FE_HAS_SYNC in the right place? 738 * Other cx241xx drivers have this slightly 739 * different 740 */ 741 742 state->fe_status = *status; 743 cx24120_get_stats(state); 744 745 /* Set the clock once tuned in */ 746 if (state->need_clock_set && *status & FE_HAS_LOCK) { 747 /* Set clock ratios */ 748 cx24120_set_clock_ratios(fe); 749 750 /* Old driver would do a msleep(200) here */ 751 752 /* Renable mpeg output */ 753 if (!state->mpeg_enabled) 754 cx24120_msg_mpeg_output_global_config(state, 1); 755 756 state->need_clock_set = 0; 757 } 758 759 return 0; 760 } 761 762 /* 763 * FEC & modulation lookup table 764 * Used for decoding the REG_FECMODE register 765 * once tuned in. 766 */ 767 struct cx24120_modfec { 768 enum fe_delivery_system delsys; 769 enum fe_modulation mod; 770 enum fe_code_rate fec; 771 u8 val; 772 }; 773 774 static const struct cx24120_modfec modfec_lookup_table[] = { 775 /*delsys mod fec val */ 776 { SYS_DVBS, QPSK, FEC_1_2, 0x01 }, 777 { SYS_DVBS, QPSK, FEC_2_3, 0x02 }, 778 { SYS_DVBS, QPSK, FEC_3_4, 0x03 }, 779 { SYS_DVBS, QPSK, FEC_4_5, 0x04 }, 780 { SYS_DVBS, QPSK, FEC_5_6, 0x05 }, 781 { SYS_DVBS, QPSK, FEC_6_7, 0x06 }, 782 { SYS_DVBS, QPSK, FEC_7_8, 0x07 }, 783 784 { SYS_DVBS2, QPSK, FEC_1_2, 0x04 }, 785 { SYS_DVBS2, QPSK, FEC_3_5, 0x05 }, 786 { SYS_DVBS2, QPSK, FEC_2_3, 0x06 }, 787 { SYS_DVBS2, QPSK, FEC_3_4, 0x07 }, 788 { SYS_DVBS2, QPSK, FEC_4_5, 0x08 }, 789 { SYS_DVBS2, QPSK, FEC_5_6, 0x09 }, 790 { SYS_DVBS2, QPSK, FEC_8_9, 0x0a }, 791 { SYS_DVBS2, QPSK, FEC_9_10, 0x0b }, 792 793 { SYS_DVBS2, PSK_8, FEC_3_5, 0x0c }, 794 { SYS_DVBS2, PSK_8, FEC_2_3, 0x0d }, 795 { SYS_DVBS2, PSK_8, FEC_3_4, 0x0e }, 796 { SYS_DVBS2, PSK_8, FEC_5_6, 0x0f }, 797 { SYS_DVBS2, PSK_8, FEC_8_9, 0x10 }, 798 { SYS_DVBS2, PSK_8, FEC_9_10, 0x11 }, 799 }; 800 801 /* Retrieve current fec, modulation & pilot values */ 802 static int cx24120_get_fec(struct dvb_frontend *fe) 803 { 804 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 805 struct cx24120_state *state = fe->demodulator_priv; 806 int idx; 807 int ret; 808 int fec; 809 810 ret = cx24120_readreg(state, CX24120_REG_FECMODE); 811 fec = ret & 0x3f; /* Lower 6 bits */ 812 813 dev_dbg(&state->i2c->dev, "raw fec = %d\n", fec); 814 815 for (idx = 0; idx < ARRAY_SIZE(modfec_lookup_table); idx++) { 816 if (modfec_lookup_table[idx].delsys != state->dcur.delsys) 817 continue; 818 if (modfec_lookup_table[idx].val != fec) 819 continue; 820 821 break; /* found */ 822 } 823 824 if (idx >= ARRAY_SIZE(modfec_lookup_table)) { 825 dev_dbg(&state->i2c->dev, "couldn't find fec!\n"); 826 return -EINVAL; 827 } 828 829 /* save values back to cache */ 830 c->modulation = modfec_lookup_table[idx].mod; 831 c->fec_inner = modfec_lookup_table[idx].fec; 832 c->pilot = (ret & 0x80) ? PILOT_ON : PILOT_OFF; 833 834 dev_dbg(&state->i2c->dev, "mod(%d), fec(%d), pilot(%d)\n", 835 c->modulation, c->fec_inner, c->pilot); 836 837 return 0; 838 } 839 840 /* Calculate ber window time */ 841 static void cx24120_calculate_ber_window(struct cx24120_state *state, u32 rate) 842 { 843 struct dvb_frontend *fe = &state->frontend; 844 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 845 u64 tmp; 846 847 /* 848 * Calculate bitrate from rate in the clock ratios table. 849 * This isn't *exactly* right but close enough. 850 */ 851 tmp = (u64)c->symbol_rate * rate; 852 do_div(tmp, 256); 853 state->bitrate = tmp; 854 855 /* usecs per ber window */ 856 tmp = 1000000ULL * CX24120_BER_WSIZE; 857 do_div(tmp, state->bitrate); 858 state->berw_usecs = tmp; 859 860 dev_dbg(&state->i2c->dev, "bitrate: %u, berw_usecs: %u\n", 861 state->bitrate, state->berw_usecs); 862 } 863 864 /* 865 * Clock ratios lookup table 866 * 867 * Values obtained from much larger table in old driver 868 * which had numerous entries which would never match. 869 * 870 * There's probably some way of calculating these but I 871 * can't determine the pattern 872 */ 873 struct cx24120_clock_ratios_table { 874 enum fe_delivery_system delsys; 875 enum fe_pilot pilot; 876 enum fe_modulation mod; 877 enum fe_code_rate fec; 878 u32 m_rat; 879 u32 n_rat; 880 u32 rate; 881 }; 882 883 static const struct cx24120_clock_ratios_table clock_ratios_table[] = { 884 /*delsys pilot mod fec m_rat n_rat rate */ 885 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_1_2, 273088, 254505, 274 }, 886 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_3_5, 17272, 13395, 330 }, 887 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_2_3, 24344, 16967, 367 }, 888 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_3_4, 410788, 254505, 413 }, 889 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_4_5, 438328, 254505, 440 }, 890 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_5_6, 30464, 16967, 459 }, 891 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_8_9, 487832, 254505, 490 }, 892 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_9_10, 493952, 254505, 496 }, 893 { SYS_DVBS2, PILOT_OFF, PSK_8, FEC_3_5, 328168, 169905, 494 }, 894 { SYS_DVBS2, PILOT_OFF, PSK_8, FEC_2_3, 24344, 11327, 550 }, 895 { SYS_DVBS2, PILOT_OFF, PSK_8, FEC_3_4, 410788, 169905, 618 }, 896 { SYS_DVBS2, PILOT_OFF, PSK_8, FEC_5_6, 30464, 11327, 688 }, 897 { SYS_DVBS2, PILOT_OFF, PSK_8, FEC_8_9, 487832, 169905, 735 }, 898 { SYS_DVBS2, PILOT_OFF, PSK_8, FEC_9_10, 493952, 169905, 744 }, 899 { SYS_DVBS2, PILOT_ON, QPSK, FEC_1_2, 273088, 260709, 268 }, 900 { SYS_DVBS2, PILOT_ON, QPSK, FEC_3_5, 328168, 260709, 322 }, 901 { SYS_DVBS2, PILOT_ON, QPSK, FEC_2_3, 121720, 86903, 358 }, 902 { SYS_DVBS2, PILOT_ON, QPSK, FEC_3_4, 410788, 260709, 403 }, 903 { SYS_DVBS2, PILOT_ON, QPSK, FEC_4_5, 438328, 260709, 430 }, 904 { SYS_DVBS2, PILOT_ON, QPSK, FEC_5_6, 152320, 86903, 448 }, 905 { SYS_DVBS2, PILOT_ON, QPSK, FEC_8_9, 487832, 260709, 479 }, 906 { SYS_DVBS2, PILOT_ON, QPSK, FEC_9_10, 493952, 260709, 485 }, 907 { SYS_DVBS2, PILOT_ON, PSK_8, FEC_3_5, 328168, 173853, 483 }, 908 { SYS_DVBS2, PILOT_ON, PSK_8, FEC_2_3, 121720, 57951, 537 }, 909 { SYS_DVBS2, PILOT_ON, PSK_8, FEC_3_4, 410788, 173853, 604 }, 910 { SYS_DVBS2, PILOT_ON, PSK_8, FEC_5_6, 152320, 57951, 672 }, 911 { SYS_DVBS2, PILOT_ON, PSK_8, FEC_8_9, 487832, 173853, 718 }, 912 { SYS_DVBS2, PILOT_ON, PSK_8, FEC_9_10, 493952, 173853, 727 }, 913 { SYS_DVBS, PILOT_OFF, QPSK, FEC_1_2, 152592, 152592, 256 }, 914 { SYS_DVBS, PILOT_OFF, QPSK, FEC_2_3, 305184, 228888, 341 }, 915 { SYS_DVBS, PILOT_OFF, QPSK, FEC_3_4, 457776, 305184, 384 }, 916 { SYS_DVBS, PILOT_OFF, QPSK, FEC_5_6, 762960, 457776, 427 }, 917 { SYS_DVBS, PILOT_OFF, QPSK, FEC_7_8, 1068144, 610368, 448 }, 918 }; 919 920 /* Set clock ratio from lookup table */ 921 static void cx24120_set_clock_ratios(struct dvb_frontend *fe) 922 { 923 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 924 struct cx24120_state *state = fe->demodulator_priv; 925 struct cx24120_cmd cmd; 926 int ret, idx; 927 928 /* Find fec, modulation, pilot */ 929 ret = cx24120_get_fec(fe); 930 if (ret != 0) 931 return; 932 933 /* Find the clock ratios in the lookup table */ 934 for (idx = 0; idx < ARRAY_SIZE(clock_ratios_table); idx++) { 935 if (clock_ratios_table[idx].delsys != state->dcur.delsys) 936 continue; 937 if (clock_ratios_table[idx].mod != c->modulation) 938 continue; 939 if (clock_ratios_table[idx].fec != c->fec_inner) 940 continue; 941 if (clock_ratios_table[idx].pilot != c->pilot) 942 continue; 943 944 break; /* found */ 945 } 946 947 if (idx >= ARRAY_SIZE(clock_ratios_table)) { 948 info("Clock ratio not found - data reception in danger\n"); 949 return; 950 } 951 952 /* Read current values? */ 953 cmd.id = CMD_CLOCK_READ; 954 cmd.len = 1; 955 cmd.arg[0] = 0x00; 956 ret = cx24120_message_sendrcv(state, &cmd, 6); 957 if (ret != 0) 958 return; 959 /* in cmd[0]-[5] - result */ 960 961 dev_dbg(&state->i2c->dev, "m=%d, n=%d; idx: %d m=%d, n=%d, rate=%d\n", 962 cmd.arg[2] | (cmd.arg[1] << 8) | (cmd.arg[0] << 16), 963 cmd.arg[5] | (cmd.arg[4] << 8) | (cmd.arg[3] << 16), 964 idx, 965 clock_ratios_table[idx].m_rat, 966 clock_ratios_table[idx].n_rat, 967 clock_ratios_table[idx].rate); 968 969 /* Set the clock */ 970 cmd.id = CMD_CLOCK_SET; 971 cmd.len = 10; 972 cmd.arg[0] = 0; 973 cmd.arg[1] = 0x10; 974 cmd.arg[2] = (clock_ratios_table[idx].m_rat >> 16) & 0xff; 975 cmd.arg[3] = (clock_ratios_table[idx].m_rat >> 8) & 0xff; 976 cmd.arg[4] = (clock_ratios_table[idx].m_rat >> 0) & 0xff; 977 cmd.arg[5] = (clock_ratios_table[idx].n_rat >> 16) & 0xff; 978 cmd.arg[6] = (clock_ratios_table[idx].n_rat >> 8) & 0xff; 979 cmd.arg[7] = (clock_ratios_table[idx].n_rat >> 0) & 0xff; 980 cmd.arg[8] = (clock_ratios_table[idx].rate >> 8) & 0xff; 981 cmd.arg[9] = (clock_ratios_table[idx].rate >> 0) & 0xff; 982 983 cx24120_message_send(state, &cmd); 984 985 /* Calculate ber window rates for stat work */ 986 cx24120_calculate_ber_window(state, clock_ratios_table[idx].rate); 987 } 988 989 /* Set inversion value */ 990 static int cx24120_set_inversion(struct cx24120_state *state, 991 enum fe_spectral_inversion inversion) 992 { 993 dev_dbg(&state->i2c->dev, "(%d)\n", inversion); 994 995 switch (inversion) { 996 case INVERSION_OFF: 997 state->dnxt.inversion_val = 0x00; 998 break; 999 case INVERSION_ON: 1000 state->dnxt.inversion_val = 0x04; 1001 break; 1002 case INVERSION_AUTO: 1003 state->dnxt.inversion_val = 0x0c; 1004 break; 1005 default: 1006 return -EINVAL; 1007 } 1008 1009 state->dnxt.inversion = inversion; 1010 1011 return 0; 1012 } 1013 1014 /* FEC lookup table for tuning */ 1015 struct cx24120_modfec_table { 1016 enum fe_delivery_system delsys; 1017 enum fe_modulation mod; 1018 enum fe_code_rate fec; 1019 u8 val; 1020 }; 1021 1022 static const struct cx24120_modfec_table modfec_table[] = { 1023 /*delsys mod fec val */ 1024 { SYS_DVBS, QPSK, FEC_1_2, 0x2e }, 1025 { SYS_DVBS, QPSK, FEC_2_3, 0x2f }, 1026 { SYS_DVBS, QPSK, FEC_3_4, 0x30 }, 1027 { SYS_DVBS, QPSK, FEC_5_6, 0x31 }, 1028 { SYS_DVBS, QPSK, FEC_6_7, 0x32 }, 1029 { SYS_DVBS, QPSK, FEC_7_8, 0x33 }, 1030 1031 { SYS_DVBS2, QPSK, FEC_1_2, 0x04 }, 1032 { SYS_DVBS2, QPSK, FEC_3_5, 0x05 }, 1033 { SYS_DVBS2, QPSK, FEC_2_3, 0x06 }, 1034 { SYS_DVBS2, QPSK, FEC_3_4, 0x07 }, 1035 { SYS_DVBS2, QPSK, FEC_4_5, 0x08 }, 1036 { SYS_DVBS2, QPSK, FEC_5_6, 0x09 }, 1037 { SYS_DVBS2, QPSK, FEC_8_9, 0x0a }, 1038 { SYS_DVBS2, QPSK, FEC_9_10, 0x0b }, 1039 1040 { SYS_DVBS2, PSK_8, FEC_3_5, 0x0c }, 1041 { SYS_DVBS2, PSK_8, FEC_2_3, 0x0d }, 1042 { SYS_DVBS2, PSK_8, FEC_3_4, 0x0e }, 1043 { SYS_DVBS2, PSK_8, FEC_5_6, 0x0f }, 1044 { SYS_DVBS2, PSK_8, FEC_8_9, 0x10 }, 1045 { SYS_DVBS2, PSK_8, FEC_9_10, 0x11 }, 1046 }; 1047 1048 /* Set fec_val & fec_mask values from delsys, modulation & fec */ 1049 static int cx24120_set_fec(struct cx24120_state *state, enum fe_modulation mod, 1050 enum fe_code_rate fec) 1051 { 1052 int idx; 1053 1054 dev_dbg(&state->i2c->dev, "(0x%02x,0x%02x)\n", mod, fec); 1055 1056 state->dnxt.fec = fec; 1057 1058 /* Lookup fec_val from modfec table */ 1059 for (idx = 0; idx < ARRAY_SIZE(modfec_table); idx++) { 1060 if (modfec_table[idx].delsys != state->dnxt.delsys) 1061 continue; 1062 if (modfec_table[idx].mod != mod) 1063 continue; 1064 if (modfec_table[idx].fec != fec) 1065 continue; 1066 1067 /* found */ 1068 state->dnxt.fec_mask = 0x00; 1069 state->dnxt.fec_val = modfec_table[idx].val; 1070 return 0; 1071 } 1072 1073 if (state->dnxt.delsys == SYS_DVBS2) { 1074 /* DVBS2 auto is 0x00/0x00 */ 1075 state->dnxt.fec_mask = 0x00; 1076 state->dnxt.fec_val = 0x00; 1077 } else { 1078 /* Set DVB-S to auto */ 1079 state->dnxt.fec_val = 0x2e; 1080 state->dnxt.fec_mask = 0xac; 1081 } 1082 1083 return 0; 1084 } 1085 1086 /* Set pilot */ 1087 static int cx24120_set_pilot(struct cx24120_state *state, enum fe_pilot pilot) 1088 { 1089 dev_dbg(&state->i2c->dev, "(%d)\n", pilot); 1090 1091 /* Pilot only valid in DVBS2 */ 1092 if (state->dnxt.delsys != SYS_DVBS2) { 1093 state->dnxt.pilot_val = CX24120_PILOT_OFF; 1094 return 0; 1095 } 1096 1097 switch (pilot) { 1098 case PILOT_OFF: 1099 state->dnxt.pilot_val = CX24120_PILOT_OFF; 1100 break; 1101 case PILOT_ON: 1102 state->dnxt.pilot_val = CX24120_PILOT_ON; 1103 break; 1104 case PILOT_AUTO: 1105 default: 1106 state->dnxt.pilot_val = CX24120_PILOT_AUTO; 1107 } 1108 1109 return 0; 1110 } 1111 1112 /* Set symbol rate */ 1113 static int cx24120_set_symbolrate(struct cx24120_state *state, u32 rate) 1114 { 1115 dev_dbg(&state->i2c->dev, "(%d)\n", rate); 1116 1117 state->dnxt.symbol_rate = rate; 1118 1119 /* Check symbol rate */ 1120 if (rate > 31000000) { 1121 state->dnxt.clkdiv = (-(rate < 31000001) & 3) + 2; 1122 state->dnxt.ratediv = (-(rate < 31000001) & 6) + 4; 1123 } else { 1124 state->dnxt.clkdiv = 3; 1125 state->dnxt.ratediv = 6; 1126 } 1127 1128 return 0; 1129 } 1130 1131 /* Overwrite the current tuning params, we are about to tune */ 1132 static void cx24120_clone_params(struct dvb_frontend *fe) 1133 { 1134 struct cx24120_state *state = fe->demodulator_priv; 1135 1136 state->dcur = state->dnxt; 1137 } 1138 1139 static int cx24120_set_frontend(struct dvb_frontend *fe) 1140 { 1141 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1142 struct cx24120_state *state = fe->demodulator_priv; 1143 struct cx24120_cmd cmd; 1144 int ret; 1145 1146 switch (c->delivery_system) { 1147 case SYS_DVBS2: 1148 dev_dbg(&state->i2c->dev, "DVB-S2\n"); 1149 break; 1150 case SYS_DVBS: 1151 dev_dbg(&state->i2c->dev, "DVB-S\n"); 1152 break; 1153 default: 1154 dev_dbg(&state->i2c->dev, 1155 "delivery system(%d) not supported\n", 1156 c->delivery_system); 1157 ret = -EINVAL; 1158 break; 1159 } 1160 1161 state->dnxt.delsys = c->delivery_system; 1162 state->dnxt.modulation = c->modulation; 1163 state->dnxt.frequency = c->frequency; 1164 state->dnxt.pilot = c->pilot; 1165 1166 ret = cx24120_set_inversion(state, c->inversion); 1167 if (ret != 0) 1168 return ret; 1169 1170 ret = cx24120_set_fec(state, c->modulation, c->fec_inner); 1171 if (ret != 0) 1172 return ret; 1173 1174 ret = cx24120_set_pilot(state, c->pilot); 1175 if (ret != 0) 1176 return ret; 1177 1178 ret = cx24120_set_symbolrate(state, c->symbol_rate); 1179 if (ret != 0) 1180 return ret; 1181 1182 /* discard the 'current' tuning parameters and prepare to tune */ 1183 cx24120_clone_params(fe); 1184 1185 dev_dbg(&state->i2c->dev, 1186 "delsys = %d\n", state->dcur.delsys); 1187 dev_dbg(&state->i2c->dev, 1188 "modulation = %d\n", state->dcur.modulation); 1189 dev_dbg(&state->i2c->dev, 1190 "frequency = %d\n", state->dcur.frequency); 1191 dev_dbg(&state->i2c->dev, 1192 "pilot = %d (val = 0x%02x)\n", 1193 state->dcur.pilot, state->dcur.pilot_val); 1194 dev_dbg(&state->i2c->dev, 1195 "symbol_rate = %d (clkdiv/ratediv = 0x%02x/0x%02x)\n", 1196 state->dcur.symbol_rate, 1197 state->dcur.clkdiv, state->dcur.ratediv); 1198 dev_dbg(&state->i2c->dev, 1199 "FEC = %d (mask/val = 0x%02x/0x%02x)\n", 1200 state->dcur.fec, state->dcur.fec_mask, state->dcur.fec_val); 1201 dev_dbg(&state->i2c->dev, 1202 "Inversion = %d (val = 0x%02x)\n", 1203 state->dcur.inversion, state->dcur.inversion_val); 1204 1205 /* Flag that clock needs to be set after tune */ 1206 state->need_clock_set = 1; 1207 1208 /* Tune in */ 1209 cmd.id = CMD_TUNEREQUEST; 1210 cmd.len = 15; 1211 cmd.arg[0] = 0; 1212 cmd.arg[1] = (state->dcur.frequency & 0xff0000) >> 16; 1213 cmd.arg[2] = (state->dcur.frequency & 0x00ff00) >> 8; 1214 cmd.arg[3] = (state->dcur.frequency & 0x0000ff); 1215 cmd.arg[4] = ((state->dcur.symbol_rate / 1000) & 0xff00) >> 8; 1216 cmd.arg[5] = ((state->dcur.symbol_rate / 1000) & 0x00ff); 1217 cmd.arg[6] = state->dcur.inversion; 1218 cmd.arg[7] = state->dcur.fec_val | state->dcur.pilot_val; 1219 cmd.arg[8] = CX24120_SEARCH_RANGE_KHZ >> 8; 1220 cmd.arg[9] = CX24120_SEARCH_RANGE_KHZ & 0xff; 1221 cmd.arg[10] = 0; /* maybe rolloff? */ 1222 cmd.arg[11] = state->dcur.fec_mask; 1223 cmd.arg[12] = state->dcur.ratediv; 1224 cmd.arg[13] = state->dcur.clkdiv; 1225 cmd.arg[14] = 0; 1226 1227 /* Send tune command */ 1228 ret = cx24120_message_send(state, &cmd); 1229 if (ret != 0) 1230 return ret; 1231 1232 /* Write symbol rate values */ 1233 ret = cx24120_writereg(state, CX24120_REG_CLKDIV, state->dcur.clkdiv); 1234 ret = cx24120_readreg(state, CX24120_REG_RATEDIV); 1235 ret &= 0xfffffff0; 1236 ret |= state->dcur.ratediv; 1237 ret = cx24120_writereg(state, CX24120_REG_RATEDIV, ret); 1238 1239 return 0; 1240 } 1241 1242 /* Set vco from config */ 1243 static int cx24120_set_vco(struct cx24120_state *state) 1244 { 1245 struct cx24120_cmd cmd; 1246 u32 nxtal_khz, vco; 1247 u64 inv_vco; 1248 u32 xtal_khz = state->config->xtal_khz; 1249 1250 nxtal_khz = xtal_khz * 4; 1251 vco = nxtal_khz * 10; 1252 inv_vco = DIV_ROUND_CLOSEST_ULL(0x400000000ULL, vco); 1253 1254 dev_dbg(&state->i2c->dev, "xtal=%d, vco=%d, inv_vco=%lld\n", 1255 xtal_khz, vco, inv_vco); 1256 1257 cmd.id = CMD_VCO_SET; 1258 cmd.len = 12; 1259 cmd.arg[0] = (vco >> 16) & 0xff; 1260 cmd.arg[1] = (vco >> 8) & 0xff; 1261 cmd.arg[2] = vco & 0xff; 1262 cmd.arg[3] = (inv_vco >> 8) & 0xff; 1263 cmd.arg[4] = (inv_vco) & 0xff; 1264 cmd.arg[5] = 0x03; 1265 cmd.arg[6] = (nxtal_khz >> 8) & 0xff; 1266 cmd.arg[7] = nxtal_khz & 0xff; 1267 cmd.arg[8] = 0x06; 1268 cmd.arg[9] = 0x03; 1269 cmd.arg[10] = (xtal_khz >> 16) & 0xff; 1270 cmd.arg[11] = xtal_khz & 0xff; 1271 1272 return cx24120_message_send(state, &cmd); 1273 } 1274 1275 static int cx24120_init(struct dvb_frontend *fe) 1276 { 1277 const struct firmware *fw; 1278 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1279 struct cx24120_state *state = fe->demodulator_priv; 1280 struct cx24120_cmd cmd; 1281 u8 reg; 1282 int ret, i; 1283 unsigned char vers[4]; 1284 1285 if (state->cold_init) 1286 return 0; 1287 1288 /* ???? */ 1289 cx24120_writereg(state, 0xea, 0x00); 1290 cx24120_test_rom(state); 1291 reg = cx24120_readreg(state, 0xfb) & 0xfe; 1292 cx24120_writereg(state, 0xfb, reg); 1293 reg = cx24120_readreg(state, 0xfc) & 0xfe; 1294 cx24120_writereg(state, 0xfc, reg); 1295 cx24120_writereg(state, 0xc3, 0x04); 1296 cx24120_writereg(state, 0xc4, 0x04); 1297 cx24120_writereg(state, 0xce, 0x00); 1298 cx24120_writereg(state, 0xcf, 0x00); 1299 reg = cx24120_readreg(state, 0xea) & 0xfe; 1300 cx24120_writereg(state, 0xea, reg); 1301 cx24120_writereg(state, 0xeb, 0x0c); 1302 cx24120_writereg(state, 0xec, 0x06); 1303 cx24120_writereg(state, 0xed, 0x05); 1304 cx24120_writereg(state, 0xee, 0x03); 1305 cx24120_writereg(state, 0xef, 0x05); 1306 cx24120_writereg(state, 0xf3, 0x03); 1307 cx24120_writereg(state, 0xf4, 0x44); 1308 1309 for (i = 0; i < 3; i++) { 1310 cx24120_writereg(state, 0xf0 + i, 0x04); 1311 cx24120_writereg(state, 0xe6 + i, 0x02); 1312 } 1313 1314 cx24120_writereg(state, 0xea, (reg | 0x01)); 1315 for (i = 0; i < 6; i += 2) { 1316 cx24120_writereg(state, 0xc5 + i, 0x00); 1317 cx24120_writereg(state, 0xc6 + i, 0x00); 1318 } 1319 1320 cx24120_writereg(state, 0xe4, 0x03); 1321 cx24120_writereg(state, 0xeb, 0x0a); 1322 1323 dev_dbg(&state->i2c->dev, "requesting firmware (%s) to download...\n", 1324 CX24120_FIRMWARE); 1325 1326 ret = state->config->request_firmware(fe, &fw, CX24120_FIRMWARE); 1327 if (ret) { 1328 err("Could not load firmware (%s): %d\n", CX24120_FIRMWARE, 1329 ret); 1330 return ret; 1331 } 1332 1333 dev_dbg(&state->i2c->dev, 1334 "Firmware found, size %d bytes (%02x %02x .. %02x %02x)\n", 1335 (int)fw->size, /* firmware_size in bytes */ 1336 fw->data[0], /* fw 1st byte */ 1337 fw->data[1], /* fw 2d byte */ 1338 fw->data[fw->size - 2], /* fw before last byte */ 1339 fw->data[fw->size - 1]); /* fw last byte */ 1340 1341 cx24120_test_rom(state); 1342 reg = cx24120_readreg(state, 0xfb) & 0xfe; 1343 cx24120_writereg(state, 0xfb, reg); 1344 cx24120_writereg(state, 0xe0, 0x76); 1345 cx24120_writereg(state, 0xf7, 0x81); 1346 cx24120_writereg(state, 0xf8, 0x00); 1347 cx24120_writereg(state, 0xf9, 0x00); 1348 cx24120_writeregs(state, 0xfa, fw->data, (fw->size - 1), 0x00); 1349 cx24120_writereg(state, 0xf7, 0xc0); 1350 cx24120_writereg(state, 0xe0, 0x00); 1351 reg = (fw->size - 2) & 0x00ff; 1352 cx24120_writereg(state, 0xf8, reg); 1353 reg = ((fw->size - 2) >> 8) & 0x00ff; 1354 cx24120_writereg(state, 0xf9, reg); 1355 cx24120_writereg(state, 0xf7, 0x00); 1356 cx24120_writereg(state, 0xdc, 0x00); 1357 cx24120_writereg(state, 0xdc, 0x07); 1358 msleep(500); 1359 1360 /* Check final byte matches final byte of firmware */ 1361 reg = cx24120_readreg(state, 0xe1); 1362 if (reg == fw->data[fw->size - 1]) { 1363 dev_dbg(&state->i2c->dev, "Firmware uploaded successfully\n"); 1364 ret = 0; 1365 } else { 1366 err("Firmware upload failed. Last byte returned=0x%x\n", ret); 1367 ret = -EREMOTEIO; 1368 } 1369 cx24120_writereg(state, 0xdc, 0x00); 1370 release_firmware(fw); 1371 if (ret != 0) 1372 return ret; 1373 1374 /* Start tuner */ 1375 cmd.id = CMD_START_TUNER; 1376 cmd.len = 3; 1377 cmd.arg[0] = 0x00; 1378 cmd.arg[1] = 0x00; 1379 cmd.arg[2] = 0x00; 1380 1381 if (cx24120_message_send(state, &cmd) != 0) { 1382 err("Error tuner start! :(\n"); 1383 return -EREMOTEIO; 1384 } 1385 1386 /* Set VCO */ 1387 ret = cx24120_set_vco(state); 1388 if (ret != 0) { 1389 err("Error set VCO! :(\n"); 1390 return ret; 1391 } 1392 1393 /* set bandwidth */ 1394 cmd.id = CMD_BANDWIDTH; 1395 cmd.len = 12; 1396 cmd.arg[0] = 0x00; 1397 cmd.arg[1] = 0x00; 1398 cmd.arg[2] = 0x00; 1399 cmd.arg[3] = 0x00; 1400 cmd.arg[4] = 0x05; 1401 cmd.arg[5] = 0x02; 1402 cmd.arg[6] = 0x02; 1403 cmd.arg[7] = 0x00; 1404 cmd.arg[8] = 0x05; 1405 cmd.arg[9] = 0x02; 1406 cmd.arg[10] = 0x02; 1407 cmd.arg[11] = 0x00; 1408 1409 if (cx24120_message_send(state, &cmd)) { 1410 err("Error set bandwidth!\n"); 1411 return -EREMOTEIO; 1412 } 1413 1414 reg = cx24120_readreg(state, 0xba); 1415 if (reg > 3) { 1416 dev_dbg(&state->i2c->dev, "Reset-readreg 0xba: %x\n", ret); 1417 err("Error initialising tuner!\n"); 1418 return -EREMOTEIO; 1419 } 1420 1421 dev_dbg(&state->i2c->dev, "Tuner initialised correctly.\n"); 1422 1423 /* Initialise mpeg outputs */ 1424 cx24120_writereg(state, 0xeb, 0x0a); 1425 if (cx24120_msg_mpeg_output_global_config(state, 0) || 1426 cx24120_msg_mpeg_output_config(state, 0) || 1427 cx24120_msg_mpeg_output_config(state, 1) || 1428 cx24120_msg_mpeg_output_config(state, 2)) { 1429 err("Error initialising mpeg output. :(\n"); 1430 return -EREMOTEIO; 1431 } 1432 1433 /* Set size of BER window */ 1434 cmd.id = CMD_BER_CTRL; 1435 cmd.len = 3; 1436 cmd.arg[0] = 0x00; 1437 cmd.arg[1] = CX24120_BER_WINDOW; 1438 cmd.arg[2] = CX24120_BER_WINDOW; 1439 if (cx24120_message_send(state, &cmd)) { 1440 err("Error setting ber window\n"); 1441 return -EREMOTEIO; 1442 } 1443 1444 /* Firmware CMD 35: Get firmware version */ 1445 cmd.id = CMD_FWVERSION; 1446 cmd.len = 1; 1447 for (i = 0; i < 4; i++) { 1448 cmd.arg[0] = i; 1449 ret = cx24120_message_send(state, &cmd); 1450 if (ret != 0) 1451 return ret; 1452 vers[i] = cx24120_readreg(state, CX24120_REG_MAILBOX); 1453 } 1454 info("FW version %i.%i.%i.%i\n", vers[0], vers[1], vers[2], vers[3]); 1455 1456 /* init stats here in order signal app which stats are supported */ 1457 c->strength.len = 1; 1458 c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 1459 c->cnr.len = 1; 1460 c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 1461 c->post_bit_error.len = 1; 1462 c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 1463 c->post_bit_count.len = 1; 1464 c->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 1465 c->block_error.len = 1; 1466 c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 1467 c->block_count.len = 1; 1468 c->block_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 1469 1470 state->cold_init = 1; 1471 1472 return 0; 1473 } 1474 1475 static int cx24120_tune(struct dvb_frontend *fe, bool re_tune, 1476 unsigned int mode_flags, unsigned int *delay, 1477 enum fe_status *status) 1478 { 1479 struct cx24120_state *state = fe->demodulator_priv; 1480 int ret; 1481 1482 dev_dbg(&state->i2c->dev, "(%d)\n", re_tune); 1483 1484 /* TODO: Do we need to set delay? */ 1485 1486 if (re_tune) { 1487 ret = cx24120_set_frontend(fe); 1488 if (ret) 1489 return ret; 1490 } 1491 1492 return cx24120_read_status(fe, status); 1493 } 1494 1495 static int cx24120_get_algo(struct dvb_frontend *fe) 1496 { 1497 return DVBFE_ALGO_HW; 1498 } 1499 1500 static int cx24120_sleep(struct dvb_frontend *fe) 1501 { 1502 return 0; 1503 } 1504 1505 static int cx24120_get_frontend(struct dvb_frontend *fe) 1506 { 1507 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1508 struct cx24120_state *state = fe->demodulator_priv; 1509 u8 freq1, freq2, freq3; 1510 1511 dev_dbg(&state->i2c->dev, "\n"); 1512 1513 /* don't return empty data if we're not tuned in */ 1514 if ((state->fe_status & FE_HAS_LOCK) == 0) 1515 return 0; 1516 1517 /* Get frequency */ 1518 freq1 = cx24120_readreg(state, CX24120_REG_FREQ1); 1519 freq2 = cx24120_readreg(state, CX24120_REG_FREQ2); 1520 freq3 = cx24120_readreg(state, CX24120_REG_FREQ3); 1521 c->frequency = (freq3 << 16) | (freq2 << 8) | freq1; 1522 dev_dbg(&state->i2c->dev, "frequency = %d\n", c->frequency); 1523 1524 /* Get modulation, fec, pilot */ 1525 cx24120_get_fec(fe); 1526 1527 return 0; 1528 } 1529 1530 static void cx24120_release(struct dvb_frontend *fe) 1531 { 1532 struct cx24120_state *state = fe->demodulator_priv; 1533 1534 dev_dbg(&state->i2c->dev, "Clear state structure\n"); 1535 kfree(state); 1536 } 1537 1538 static int cx24120_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks) 1539 { 1540 struct cx24120_state *state = fe->demodulator_priv; 1541 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1542 1543 if (c->block_error.stat[0].scale != FE_SCALE_COUNTER) { 1544 *ucblocks = 0; 1545 return 0; 1546 } 1547 1548 *ucblocks = c->block_error.stat[0].uvalue - state->ucb_offset; 1549 1550 return 0; 1551 } 1552 1553 static struct dvb_frontend_ops cx24120_ops = { 1554 .delsys = { SYS_DVBS, SYS_DVBS2 }, 1555 .info = { 1556 .name = "Conexant CX24120/CX24118", 1557 .frequency_min = 950000, 1558 .frequency_max = 2150000, 1559 .frequency_stepsize = 1011, /* kHz for QPSK frontends */ 1560 .frequency_tolerance = 5000, 1561 .symbol_rate_min = 1000000, 1562 .symbol_rate_max = 45000000, 1563 .caps = FE_CAN_INVERSION_AUTO | 1564 FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 | 1565 FE_CAN_FEC_4_5 | FE_CAN_FEC_5_6 | FE_CAN_FEC_6_7 | 1566 FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO | 1567 FE_CAN_2G_MODULATION | 1568 FE_CAN_QPSK | FE_CAN_RECOVER 1569 }, 1570 .release = cx24120_release, 1571 1572 .init = cx24120_init, 1573 .sleep = cx24120_sleep, 1574 1575 .tune = cx24120_tune, 1576 .get_frontend_algo = cx24120_get_algo, 1577 .set_frontend = cx24120_set_frontend, 1578 1579 .get_frontend = cx24120_get_frontend, 1580 .read_status = cx24120_read_status, 1581 .read_ber = cx24120_read_ber, 1582 .read_signal_strength = cx24120_read_signal_strength, 1583 .read_snr = cx24120_read_snr, 1584 .read_ucblocks = cx24120_read_ucblocks, 1585 1586 .diseqc_send_master_cmd = cx24120_send_diseqc_msg, 1587 1588 .diseqc_send_burst = cx24120_diseqc_send_burst, 1589 .set_tone = cx24120_set_tone, 1590 .set_voltage = cx24120_set_voltage, 1591 }; 1592 1593 MODULE_DESCRIPTION("DVB Frontend module for Conexant CX24120/CX24118 hardware"); 1594 MODULE_AUTHOR("Jemma Denson"); 1595 MODULE_LICENSE("GPL"); 1596