1 /* 2 Driver for ST STV0288 demodulator 3 Copyright (C) 2006 Georg Acher, BayCom GmbH, acher (at) baycom (dot) de 4 for Reel Multimedia 5 Copyright (C) 2008 TurboSight.com, Bob Liu <bob@turbosight.com> 6 Copyright (C) 2008 Igor M. Liplianin <liplianin@me.by> 7 Removed stb6000 specific tuner code and revised some 8 procedures. 9 2010-09-01 Josef Pavlik <josef@pavlik.it> 10 Fixed diseqc_msg, diseqc_burst and set_tone problems 11 12 This program is free software; you can redistribute it and/or modify 13 it under the terms of the GNU General Public License as published by 14 the Free Software Foundation; either version 2 of the License, or 15 (at your option) any later version. 16 17 This program is distributed in the hope that it will be useful, 18 but WITHOUT ANY WARRANTY; without even the implied warranty of 19 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 20 GNU General Public License for more details. 21 22 You should have received a copy of the GNU General Public License 23 along with this program; if not, write to the Free Software 24 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 25 26 */ 27 28 #include <linux/init.h> 29 #include <linux/kernel.h> 30 #include <linux/module.h> 31 #include <linux/string.h> 32 #include <linux/slab.h> 33 #include <linux/jiffies.h> 34 #include <asm/div64.h> 35 36 #include "dvb_frontend.h" 37 #include "stv0288.h" 38 39 struct stv0288_state { 40 struct i2c_adapter *i2c; 41 const struct stv0288_config *config; 42 struct dvb_frontend frontend; 43 44 u8 initialised:1; 45 u32 tuner_frequency; 46 u32 symbol_rate; 47 fe_code_rate_t fec_inner; 48 int errmode; 49 }; 50 51 #define STATUS_BER 0 52 #define STATUS_UCBLOCKS 1 53 54 static int debug; 55 static int debug_legacy_dish_switch; 56 #define dprintk(args...) \ 57 do { \ 58 if (debug) \ 59 printk(KERN_DEBUG "stv0288: " args); \ 60 } while (0) 61 62 63 static int stv0288_writeregI(struct stv0288_state *state, u8 reg, u8 data) 64 { 65 int ret; 66 u8 buf[] = { reg, data }; 67 struct i2c_msg msg = { 68 .addr = state->config->demod_address, 69 .flags = 0, 70 .buf = buf, 71 .len = 2 72 }; 73 74 ret = i2c_transfer(state->i2c, &msg, 1); 75 76 if (ret != 1) 77 dprintk("%s: writereg error (reg == 0x%02x, val == 0x%02x, " 78 "ret == %i)\n", __func__, reg, data, ret); 79 80 return (ret != 1) ? -EREMOTEIO : 0; 81 } 82 83 static int stv0288_write(struct dvb_frontend *fe, const u8 buf[], int len) 84 { 85 struct stv0288_state *state = fe->demodulator_priv; 86 87 if (len != 2) 88 return -EINVAL; 89 90 return stv0288_writeregI(state, buf[0], buf[1]); 91 } 92 93 static u8 stv0288_readreg(struct stv0288_state *state, u8 reg) 94 { 95 int ret; 96 u8 b0[] = { reg }; 97 u8 b1[] = { 0 }; 98 struct i2c_msg msg[] = { 99 { 100 .addr = state->config->demod_address, 101 .flags = 0, 102 .buf = b0, 103 .len = 1 104 }, { 105 .addr = state->config->demod_address, 106 .flags = I2C_M_RD, 107 .buf = b1, 108 .len = 1 109 } 110 }; 111 112 ret = i2c_transfer(state->i2c, msg, 2); 113 114 if (ret != 2) 115 dprintk("%s: readreg error (reg == 0x%02x, ret == %i)\n", 116 __func__, reg, ret); 117 118 return b1[0]; 119 } 120 121 static int stv0288_set_symbolrate(struct dvb_frontend *fe, u32 srate) 122 { 123 struct stv0288_state *state = fe->demodulator_priv; 124 unsigned int temp; 125 unsigned char b[3]; 126 127 if ((srate < 1000000) || (srate > 45000000)) 128 return -EINVAL; 129 130 stv0288_writeregI(state, 0x22, 0); 131 stv0288_writeregI(state, 0x23, 0); 132 stv0288_writeregI(state, 0x2b, 0xff); 133 stv0288_writeregI(state, 0x2c, 0xf7); 134 135 temp = (unsigned int)srate / 1000; 136 137 temp = temp * 32768; 138 temp = temp / 25; 139 temp = temp / 125; 140 b[0] = (unsigned char)((temp >> 12) & 0xff); 141 b[1] = (unsigned char)((temp >> 4) & 0xff); 142 b[2] = (unsigned char)((temp << 4) & 0xf0); 143 stv0288_writeregI(state, 0x28, 0x80); /* SFRH */ 144 stv0288_writeregI(state, 0x29, 0); /* SFRM */ 145 stv0288_writeregI(state, 0x2a, 0); /* SFRL */ 146 147 stv0288_writeregI(state, 0x28, b[0]); 148 stv0288_writeregI(state, 0x29, b[1]); 149 stv0288_writeregI(state, 0x2a, b[2]); 150 dprintk("stv0288: stv0288_set_symbolrate\n"); 151 152 return 0; 153 } 154 155 static int stv0288_send_diseqc_msg(struct dvb_frontend *fe, 156 struct dvb_diseqc_master_cmd *m) 157 { 158 struct stv0288_state *state = fe->demodulator_priv; 159 160 int i; 161 162 dprintk("%s\n", __func__); 163 164 stv0288_writeregI(state, 0x09, 0); 165 msleep(30); 166 stv0288_writeregI(state, 0x05, 0x12);/* modulated mode, single shot */ 167 168 for (i = 0; i < m->msg_len; i++) { 169 if (stv0288_writeregI(state, 0x06, m->msg[i])) 170 return -EREMOTEIO; 171 } 172 msleep(m->msg_len*12); 173 return 0; 174 } 175 176 static int stv0288_send_diseqc_burst(struct dvb_frontend *fe, 177 fe_sec_mini_cmd_t burst) 178 { 179 struct stv0288_state *state = fe->demodulator_priv; 180 181 dprintk("%s\n", __func__); 182 183 if (stv0288_writeregI(state, 0x05, 0x03))/* burst mode, single shot */ 184 return -EREMOTEIO; 185 186 if (stv0288_writeregI(state, 0x06, burst == SEC_MINI_A ? 0x00 : 0xff)) 187 return -EREMOTEIO; 188 189 msleep(15); 190 if (stv0288_writeregI(state, 0x05, 0x12)) 191 return -EREMOTEIO; 192 193 return 0; 194 } 195 196 static int stv0288_set_tone(struct dvb_frontend *fe, fe_sec_tone_mode_t tone) 197 { 198 struct stv0288_state *state = fe->demodulator_priv; 199 200 switch (tone) { 201 case SEC_TONE_ON: 202 if (stv0288_writeregI(state, 0x05, 0x10))/* cont carrier */ 203 return -EREMOTEIO; 204 break; 205 206 case SEC_TONE_OFF: 207 if (stv0288_writeregI(state, 0x05, 0x12))/* burst mode off*/ 208 return -EREMOTEIO; 209 break; 210 211 default: 212 return -EINVAL; 213 } 214 return 0; 215 } 216 217 static u8 stv0288_inittab[] = { 218 0x01, 0x15, 219 0x02, 0x20, 220 0x09, 0x0, 221 0x0a, 0x4, 222 0x0b, 0x0, 223 0x0c, 0x0, 224 0x0d, 0x0, 225 0x0e, 0xd4, 226 0x0f, 0x30, 227 0x11, 0x80, 228 0x12, 0x03, 229 0x13, 0x48, 230 0x14, 0x84, 231 0x15, 0x45, 232 0x16, 0xb7, 233 0x17, 0x9c, 234 0x18, 0x0, 235 0x19, 0xa6, 236 0x1a, 0x88, 237 0x1b, 0x8f, 238 0x1c, 0xf0, 239 0x20, 0x0b, 240 0x21, 0x54, 241 0x22, 0x0, 242 0x23, 0x0, 243 0x2b, 0xff, 244 0x2c, 0xf7, 245 0x30, 0x0, 246 0x31, 0x1e, 247 0x32, 0x14, 248 0x33, 0x0f, 249 0x34, 0x09, 250 0x35, 0x0c, 251 0x36, 0x05, 252 0x37, 0x2f, 253 0x38, 0x16, 254 0x39, 0xbe, 255 0x3a, 0x0, 256 0x3b, 0x13, 257 0x3c, 0x11, 258 0x3d, 0x30, 259 0x40, 0x63, 260 0x41, 0x04, 261 0x42, 0x20, 262 0x43, 0x00, 263 0x44, 0x00, 264 0x45, 0x00, 265 0x46, 0x00, 266 0x47, 0x00, 267 0x4a, 0x00, 268 0x50, 0x10, 269 0x51, 0x38, 270 0x52, 0x21, 271 0x58, 0x54, 272 0x59, 0x86, 273 0x5a, 0x0, 274 0x5b, 0x9b, 275 0x5c, 0x08, 276 0x5d, 0x7f, 277 0x5e, 0x0, 278 0x5f, 0xff, 279 0x70, 0x0, 280 0x71, 0x0, 281 0x72, 0x0, 282 0x74, 0x0, 283 0x75, 0x0, 284 0x76, 0x0, 285 0x81, 0x0, 286 0x82, 0x3f, 287 0x83, 0x3f, 288 0x84, 0x0, 289 0x85, 0x0, 290 0x88, 0x0, 291 0x89, 0x0, 292 0x8a, 0x0, 293 0x8b, 0x0, 294 0x8c, 0x0, 295 0x90, 0x0, 296 0x91, 0x0, 297 0x92, 0x0, 298 0x93, 0x0, 299 0x94, 0x1c, 300 0x97, 0x0, 301 0xa0, 0x48, 302 0xa1, 0x0, 303 0xb0, 0xb8, 304 0xb1, 0x3a, 305 0xb2, 0x10, 306 0xb3, 0x82, 307 0xb4, 0x80, 308 0xb5, 0x82, 309 0xb6, 0x82, 310 0xb7, 0x82, 311 0xb8, 0x20, 312 0xb9, 0x0, 313 0xf0, 0x0, 314 0xf1, 0x0, 315 0xf2, 0xc0, 316 0x51, 0x36, 317 0x52, 0x09, 318 0x53, 0x94, 319 0x54, 0x62, 320 0x55, 0x29, 321 0x56, 0x64, 322 0x57, 0x2b, 323 0xff, 0xff, 324 }; 325 326 static int stv0288_set_voltage(struct dvb_frontend *fe, fe_sec_voltage_t volt) 327 { 328 dprintk("%s: %s\n", __func__, 329 volt == SEC_VOLTAGE_13 ? "SEC_VOLTAGE_13" : 330 volt == SEC_VOLTAGE_18 ? "SEC_VOLTAGE_18" : "??"); 331 332 return 0; 333 } 334 335 static int stv0288_init(struct dvb_frontend *fe) 336 { 337 struct stv0288_state *state = fe->demodulator_priv; 338 int i; 339 u8 reg; 340 u8 val; 341 342 dprintk("stv0288: init chip\n"); 343 stv0288_writeregI(state, 0x41, 0x04); 344 msleep(50); 345 346 /* we have default inittab */ 347 if (state->config->inittab == NULL) { 348 for (i = 0; !(stv0288_inittab[i] == 0xff && 349 stv0288_inittab[i + 1] == 0xff); i += 2) 350 stv0288_writeregI(state, stv0288_inittab[i], 351 stv0288_inittab[i + 1]); 352 } else { 353 for (i = 0; ; i += 2) { 354 reg = state->config->inittab[i]; 355 val = state->config->inittab[i+1]; 356 if (reg == 0xff && val == 0xff) 357 break; 358 stv0288_writeregI(state, reg, val); 359 } 360 } 361 return 0; 362 } 363 364 static int stv0288_read_status(struct dvb_frontend *fe, fe_status_t *status) 365 { 366 struct stv0288_state *state = fe->demodulator_priv; 367 368 u8 sync = stv0288_readreg(state, 0x24); 369 if (sync == 255) 370 sync = 0; 371 372 dprintk("%s : FE_READ_STATUS : VSTATUS: 0x%02x\n", __func__, sync); 373 374 *status = 0; 375 if (sync & 0x80) 376 *status |= FE_HAS_CARRIER | FE_HAS_SIGNAL; 377 if (sync & 0x10) 378 *status |= FE_HAS_VITERBI; 379 if (sync & 0x08) { 380 *status |= FE_HAS_LOCK; 381 dprintk("stv0288 has locked\n"); 382 } 383 384 return 0; 385 } 386 387 static int stv0288_read_ber(struct dvb_frontend *fe, u32 *ber) 388 { 389 struct stv0288_state *state = fe->demodulator_priv; 390 391 if (state->errmode != STATUS_BER) 392 return 0; 393 *ber = (stv0288_readreg(state, 0x26) << 8) | 394 stv0288_readreg(state, 0x27); 395 dprintk("stv0288_read_ber %d\n", *ber); 396 397 return 0; 398 } 399 400 401 static int stv0288_read_signal_strength(struct dvb_frontend *fe, u16 *strength) 402 { 403 struct stv0288_state *state = fe->demodulator_priv; 404 405 s32 signal = 0xffff - ((stv0288_readreg(state, 0x10) << 8)); 406 407 408 signal = signal * 5 / 4; 409 *strength = (signal > 0xffff) ? 0xffff : (signal < 0) ? 0 : signal; 410 dprintk("stv0288_read_signal_strength %d\n", *strength); 411 412 return 0; 413 } 414 static int stv0288_sleep(struct dvb_frontend *fe) 415 { 416 struct stv0288_state *state = fe->demodulator_priv; 417 418 stv0288_writeregI(state, 0x41, 0x84); 419 state->initialised = 0; 420 421 return 0; 422 } 423 static int stv0288_read_snr(struct dvb_frontend *fe, u16 *snr) 424 { 425 struct stv0288_state *state = fe->demodulator_priv; 426 427 s32 xsnr = 0xffff - ((stv0288_readreg(state, 0x2d) << 8) 428 | stv0288_readreg(state, 0x2e)); 429 xsnr = 3 * (xsnr - 0xa100); 430 *snr = (xsnr > 0xffff) ? 0xffff : (xsnr < 0) ? 0 : xsnr; 431 dprintk("stv0288_read_snr %d\n", *snr); 432 433 return 0; 434 } 435 436 static int stv0288_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks) 437 { 438 struct stv0288_state *state = fe->demodulator_priv; 439 440 if (state->errmode != STATUS_BER) 441 return 0; 442 *ucblocks = (stv0288_readreg(state, 0x26) << 8) | 443 stv0288_readreg(state, 0x27); 444 dprintk("stv0288_read_ber %d\n", *ucblocks); 445 446 return 0; 447 } 448 449 static int stv0288_set_property(struct dvb_frontend *fe, struct dtv_property *p) 450 { 451 dprintk("%s(..)\n", __func__); 452 return 0; 453 } 454 455 static int stv0288_set_frontend(struct dvb_frontend *fe) 456 { 457 struct stv0288_state *state = fe->demodulator_priv; 458 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 459 460 char tm; 461 unsigned char tda[3]; 462 u8 reg, time_out = 0; 463 464 dprintk("%s : FE_SET_FRONTEND\n", __func__); 465 466 if (c->delivery_system != SYS_DVBS) { 467 dprintk("%s: unsupported delivery " 468 "system selected (%d)\n", 469 __func__, c->delivery_system); 470 return -EOPNOTSUPP; 471 } 472 473 if (state->config->set_ts_params) 474 state->config->set_ts_params(fe, 0); 475 476 /* only frequency & symbol_rate are used for tuner*/ 477 if (fe->ops.tuner_ops.set_params) { 478 fe->ops.tuner_ops.set_params(fe); 479 if (fe->ops.i2c_gate_ctrl) 480 fe->ops.i2c_gate_ctrl(fe, 0); 481 } 482 483 udelay(10); 484 stv0288_set_symbolrate(fe, c->symbol_rate); 485 /* Carrier lock control register */ 486 stv0288_writeregI(state, 0x15, 0xc5); 487 488 tda[2] = 0x0; /* CFRL */ 489 for (tm = -9; tm < 7;) { 490 /* Viterbi status */ 491 reg = stv0288_readreg(state, 0x24); 492 if (reg & 0x8) 493 break; 494 if (reg & 0x80) { 495 time_out++; 496 if (time_out > 10) 497 break; 498 tda[2] += 40; 499 if (tda[2] < 40) 500 tm++; 501 } else { 502 tm++; 503 tda[2] = 0; 504 time_out = 0; 505 } 506 tda[1] = (unsigned char)tm; 507 stv0288_writeregI(state, 0x2b, tda[1]); 508 stv0288_writeregI(state, 0x2c, tda[2]); 509 msleep(30); 510 } 511 state->tuner_frequency = c->frequency; 512 state->fec_inner = FEC_AUTO; 513 state->symbol_rate = c->symbol_rate; 514 515 return 0; 516 } 517 518 static int stv0288_i2c_gate_ctrl(struct dvb_frontend *fe, int enable) 519 { 520 struct stv0288_state *state = fe->demodulator_priv; 521 522 if (enable) 523 stv0288_writeregI(state, 0x01, 0xb5); 524 else 525 stv0288_writeregI(state, 0x01, 0x35); 526 527 udelay(1); 528 529 return 0; 530 } 531 532 static void stv0288_release(struct dvb_frontend *fe) 533 { 534 struct stv0288_state *state = fe->demodulator_priv; 535 kfree(state); 536 } 537 538 static struct dvb_frontend_ops stv0288_ops = { 539 .delsys = { SYS_DVBS }, 540 .info = { 541 .name = "ST STV0288 DVB-S", 542 .frequency_min = 950000, 543 .frequency_max = 2150000, 544 .frequency_stepsize = 1000, /* kHz for QPSK frontends */ 545 .frequency_tolerance = 0, 546 .symbol_rate_min = 1000000, 547 .symbol_rate_max = 45000000, 548 .symbol_rate_tolerance = 500, /* ppm */ 549 .caps = FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 | 550 FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | 551 FE_CAN_QPSK | 552 FE_CAN_FEC_AUTO 553 }, 554 555 .release = stv0288_release, 556 .init = stv0288_init, 557 .sleep = stv0288_sleep, 558 .write = stv0288_write, 559 .i2c_gate_ctrl = stv0288_i2c_gate_ctrl, 560 .read_status = stv0288_read_status, 561 .read_ber = stv0288_read_ber, 562 .read_signal_strength = stv0288_read_signal_strength, 563 .read_snr = stv0288_read_snr, 564 .read_ucblocks = stv0288_read_ucblocks, 565 .diseqc_send_master_cmd = stv0288_send_diseqc_msg, 566 .diseqc_send_burst = stv0288_send_diseqc_burst, 567 .set_tone = stv0288_set_tone, 568 .set_voltage = stv0288_set_voltage, 569 570 .set_property = stv0288_set_property, 571 .set_frontend = stv0288_set_frontend, 572 }; 573 574 struct dvb_frontend *stv0288_attach(const struct stv0288_config *config, 575 struct i2c_adapter *i2c) 576 { 577 struct stv0288_state *state = NULL; 578 int id; 579 580 /* allocate memory for the internal state */ 581 state = kzalloc(sizeof(struct stv0288_state), GFP_KERNEL); 582 if (state == NULL) 583 goto error; 584 585 /* setup the state */ 586 state->config = config; 587 state->i2c = i2c; 588 state->initialised = 0; 589 state->tuner_frequency = 0; 590 state->symbol_rate = 0; 591 state->fec_inner = 0; 592 state->errmode = STATUS_BER; 593 594 stv0288_writeregI(state, 0x41, 0x04); 595 msleep(200); 596 id = stv0288_readreg(state, 0x00); 597 dprintk("stv0288 id %x\n", id); 598 599 /* register 0x00 contains 0x11 for STV0288 */ 600 if (id != 0x11) 601 goto error; 602 603 /* create dvb_frontend */ 604 memcpy(&state->frontend.ops, &stv0288_ops, 605 sizeof(struct dvb_frontend_ops)); 606 state->frontend.demodulator_priv = state; 607 return &state->frontend; 608 609 error: 610 kfree(state); 611 612 return NULL; 613 } 614 EXPORT_SYMBOL(stv0288_attach); 615 616 module_param(debug_legacy_dish_switch, int, 0444); 617 MODULE_PARM_DESC(debug_legacy_dish_switch, 618 "Enable timing analysis for Dish Network legacy switches"); 619 620 module_param(debug, int, 0644); 621 MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off)."); 622 623 MODULE_DESCRIPTION("ST STV0288 DVB Demodulator driver"); 624 MODULE_AUTHOR("Georg Acher, Bob Liu, Igor liplianin"); 625 MODULE_LICENSE("GPL"); 626 627