1/* 2 Fujitsu MB86A16 DVB-S/DSS DC Receiver driver 3 4 Copyright (C) Manu Abraham (abraham.manu@gmail.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 <linux/init.h> 22#include <linux/kernel.h> 23#include <linux/module.h> 24#include <linux/moduleparam.h> 25#include <linux/slab.h> 26 27#include "dvb_frontend.h" 28#include "mb86a16.h" 29#include "mb86a16_priv.h" 30 31static unsigned int verbose = 5; 32module_param(verbose, int, 0644); 33 34#define ABS(x) ((x) < 0 ? (-x) : (x)) 35 36struct mb86a16_state { 37 struct i2c_adapter *i2c_adap; 38 const struct mb86a16_config *config; 39 struct dvb_frontend frontend; 40 41 /* tuning parameters */ 42 int frequency; 43 int srate; 44 45 /* Internal stuff */ 46 int master_clk; 47 int deci; 48 int csel; 49 int rsel; 50}; 51 52#define MB86A16_ERROR 0 53#define MB86A16_NOTICE 1 54#define MB86A16_INFO 2 55#define MB86A16_DEBUG 3 56 57#define dprintk(x, y, z, format, arg...) do { \ 58 if (z) { \ 59 if ((x > MB86A16_ERROR) && (x > y)) \ 60 printk(KERN_ERR "%s: " format "\n", __func__, ##arg); \ 61 else if ((x > MB86A16_NOTICE) && (x > y)) \ 62 printk(KERN_NOTICE "%s: " format "\n", __func__, ##arg); \ 63 else if ((x > MB86A16_INFO) && (x > y)) \ 64 printk(KERN_INFO "%s: " format "\n", __func__, ##arg); \ 65 else if ((x > MB86A16_DEBUG) && (x > y)) \ 66 printk(KERN_DEBUG "%s: " format "\n", __func__, ##arg); \ 67 } else { \ 68 if (x > y) \ 69 printk(format, ##arg); \ 70 } \ 71} while (0) 72 73#define TRACE_IN dprintk(verbose, MB86A16_DEBUG, 1, "-->()") 74#define TRACE_OUT dprintk(verbose, MB86A16_DEBUG, 1, "()-->") 75 76static int mb86a16_write(struct mb86a16_state *state, u8 reg, u8 val) 77{ 78 int ret; 79 u8 buf[] = { reg, val }; 80 81 struct i2c_msg msg = { 82 .addr = state->config->demod_address, 83 .flags = 0, 84 .buf = buf, 85 .len = 2 86 }; 87 88 dprintk(verbose, MB86A16_DEBUG, 1, 89 "writing to [0x%02x],Reg[0x%02x],Data[0x%02x]", 90 state->config->demod_address, buf[0], buf[1]); 91 92 ret = i2c_transfer(state->i2c_adap, &msg, 1); 93 94 return (ret != 1) ? -EREMOTEIO : 0; 95} 96 97static int mb86a16_read(struct mb86a16_state *state, u8 reg, u8 *val) 98{ 99 int ret; 100 u8 b0[] = { reg }; 101 u8 b1[] = { 0 }; 102 103 struct i2c_msg msg[] = { 104 { 105 .addr = state->config->demod_address, 106 .flags = 0, 107 .buf = b0, 108 .len = 1 109 }, { 110 .addr = state->config->demod_address, 111 .flags = I2C_M_RD, 112 .buf = b1, 113 .len = 1 114 } 115 }; 116 ret = i2c_transfer(state->i2c_adap, msg, 2); 117 if (ret != 2) { 118 dprintk(verbose, MB86A16_ERROR, 1, "read error(reg=0x%02x, ret=%i)", 119 reg, ret); 120 121 if (ret < 0) 122 return ret; 123 return -EREMOTEIO; 124 } 125 *val = b1[0]; 126 127 return ret; 128} 129 130static int CNTM_set(struct mb86a16_state *state, 131 unsigned char timint1, 132 unsigned char timint2, 133 unsigned char cnext) 134{ 135 unsigned char val; 136 137 val = (timint1 << 4) | (timint2 << 2) | cnext; 138 if (mb86a16_write(state, MB86A16_CNTMR, val) < 0) 139 goto err; 140 141 return 0; 142 143err: 144 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 145 return -EREMOTEIO; 146} 147 148static int smrt_set(struct mb86a16_state *state, int rate) 149{ 150 int tmp ; 151 int m ; 152 unsigned char STOFS0, STOFS1; 153 154 m = 1 << state->deci; 155 tmp = (8192 * state->master_clk - 2 * m * rate * 8192 + state->master_clk / 2) / state->master_clk; 156 157 STOFS0 = tmp & 0x0ff; 158 STOFS1 = (tmp & 0xf00) >> 8; 159 160 if (mb86a16_write(state, MB86A16_SRATE1, (state->deci << 2) | 161 (state->csel << 1) | 162 state->rsel) < 0) 163 goto err; 164 if (mb86a16_write(state, MB86A16_SRATE2, STOFS0) < 0) 165 goto err; 166 if (mb86a16_write(state, MB86A16_SRATE3, STOFS1) < 0) 167 goto err; 168 169 return 0; 170err: 171 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 172 return -1; 173} 174 175static int srst(struct mb86a16_state *state) 176{ 177 if (mb86a16_write(state, MB86A16_RESET, 0x04) < 0) 178 goto err; 179 180 return 0; 181err: 182 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 183 return -EREMOTEIO; 184 185} 186 187static int afcex_data_set(struct mb86a16_state *state, 188 unsigned char AFCEX_L, 189 unsigned char AFCEX_H) 190{ 191 if (mb86a16_write(state, MB86A16_AFCEXL, AFCEX_L) < 0) 192 goto err; 193 if (mb86a16_write(state, MB86A16_AFCEXH, AFCEX_H) < 0) 194 goto err; 195 196 return 0; 197err: 198 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 199 200 return -1; 201} 202 203static int afcofs_data_set(struct mb86a16_state *state, 204 unsigned char AFCEX_L, 205 unsigned char AFCEX_H) 206{ 207 if (mb86a16_write(state, 0x58, AFCEX_L) < 0) 208 goto err; 209 if (mb86a16_write(state, 0x59, AFCEX_H) < 0) 210 goto err; 211 212 return 0; 213err: 214 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 215 return -EREMOTEIO; 216} 217 218static int stlp_set(struct mb86a16_state *state, 219 unsigned char STRAS, 220 unsigned char STRBS) 221{ 222 if (mb86a16_write(state, MB86A16_STRFILTCOEF1, (STRBS << 3) | (STRAS)) < 0) 223 goto err; 224 225 return 0; 226err: 227 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 228 return -EREMOTEIO; 229} 230 231static int Vi_set(struct mb86a16_state *state, unsigned char ETH, unsigned char VIA) 232{ 233 if (mb86a16_write(state, MB86A16_VISET2, 0x04) < 0) 234 goto err; 235 if (mb86a16_write(state, MB86A16_VISET3, 0xf5) < 0) 236 goto err; 237 238 return 0; 239err: 240 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 241 return -EREMOTEIO; 242} 243 244static int initial_set(struct mb86a16_state *state) 245{ 246 if (stlp_set(state, 5, 7)) 247 goto err; 248 249 udelay(100); 250 if (afcex_data_set(state, 0, 0)) 251 goto err; 252 253 udelay(100); 254 if (afcofs_data_set(state, 0, 0)) 255 goto err; 256 257 udelay(100); 258 if (mb86a16_write(state, MB86A16_CRLFILTCOEF1, 0x16) < 0) 259 goto err; 260 if (mb86a16_write(state, 0x2f, 0x21) < 0) 261 goto err; 262 if (mb86a16_write(state, MB86A16_VIMAG, 0x38) < 0) 263 goto err; 264 if (mb86a16_write(state, MB86A16_FAGCS1, 0x00) < 0) 265 goto err; 266 if (mb86a16_write(state, MB86A16_FAGCS2, 0x1c) < 0) 267 goto err; 268 if (mb86a16_write(state, MB86A16_FAGCS3, 0x20) < 0) 269 goto err; 270 if (mb86a16_write(state, MB86A16_FAGCS4, 0x1e) < 0) 271 goto err; 272 if (mb86a16_write(state, MB86A16_FAGCS5, 0x23) < 0) 273 goto err; 274 if (mb86a16_write(state, 0x54, 0xff) < 0) 275 goto err; 276 if (mb86a16_write(state, MB86A16_TSOUT, 0x00) < 0) 277 goto err; 278 279 return 0; 280 281err: 282 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 283 return -EREMOTEIO; 284} 285 286static int S01T_set(struct mb86a16_state *state, 287 unsigned char s1t, 288 unsigned s0t) 289{ 290 if (mb86a16_write(state, 0x33, (s1t << 3) | s0t) < 0) 291 goto err; 292 293 return 0; 294err: 295 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 296 return -EREMOTEIO; 297} 298 299 300static int EN_set(struct mb86a16_state *state, 301 int cren, 302 int afcen) 303{ 304 unsigned char val; 305 306 val = 0x7a | (cren << 7) | (afcen << 2); 307 if (mb86a16_write(state, 0x49, val) < 0) 308 goto err; 309 310 return 0; 311err: 312 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 313 return -EREMOTEIO; 314} 315 316static int AFCEXEN_set(struct mb86a16_state *state, 317 int afcexen, 318 int smrt) 319{ 320 unsigned char AFCA ; 321 322 if (smrt > 18875) 323 AFCA = 4; 324 else if (smrt > 9375) 325 AFCA = 3; 326 else if (smrt > 2250) 327 AFCA = 2; 328 else 329 AFCA = 1; 330 331 if (mb86a16_write(state, 0x2a, 0x02 | (afcexen << 5) | (AFCA << 2)) < 0) 332 goto err; 333 334 return 0; 335 336err: 337 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 338 return -EREMOTEIO; 339} 340 341static int DAGC_data_set(struct mb86a16_state *state, 342 unsigned char DAGCA, 343 unsigned char DAGCW) 344{ 345 if (mb86a16_write(state, 0x2d, (DAGCA << 3) | DAGCW) < 0) 346 goto err; 347 348 return 0; 349 350err: 351 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 352 return -EREMOTEIO; 353} 354 355static void smrt_info_get(struct mb86a16_state *state, int rate) 356{ 357 if (rate >= 37501) { 358 state->deci = 0; state->csel = 0; state->rsel = 0; 359 } else if (rate >= 30001) { 360 state->deci = 0; state->csel = 0; state->rsel = 1; 361 } else if (rate >= 26251) { 362 state->deci = 0; state->csel = 1; state->rsel = 0; 363 } else if (rate >= 22501) { 364 state->deci = 0; state->csel = 1; state->rsel = 1; 365 } else if (rate >= 18751) { 366 state->deci = 1; state->csel = 0; state->rsel = 0; 367 } else if (rate >= 15001) { 368 state->deci = 1; state->csel = 0; state->rsel = 1; 369 } else if (rate >= 13126) { 370 state->deci = 1; state->csel = 1; state->rsel = 0; 371 } else if (rate >= 11251) { 372 state->deci = 1; state->csel = 1; state->rsel = 1; 373 } else if (rate >= 9376) { 374 state->deci = 2; state->csel = 0; state->rsel = 0; 375 } else if (rate >= 7501) { 376 state->deci = 2; state->csel = 0; state->rsel = 1; 377 } else if (rate >= 6563) { 378 state->deci = 2; state->csel = 1; state->rsel = 0; 379 } else if (rate >= 5626) { 380 state->deci = 2; state->csel = 1; state->rsel = 1; 381 } else if (rate >= 4688) { 382 state->deci = 3; state->csel = 0; state->rsel = 0; 383 } else if (rate >= 3751) { 384 state->deci = 3; state->csel = 0; state->rsel = 1; 385 } else if (rate >= 3282) { 386 state->deci = 3; state->csel = 1; state->rsel = 0; 387 } else if (rate >= 2814) { 388 state->deci = 3; state->csel = 1; state->rsel = 1; 389 } else if (rate >= 2344) { 390 state->deci = 4; state->csel = 0; state->rsel = 0; 391 } else if (rate >= 1876) { 392 state->deci = 4; state->csel = 0; state->rsel = 1; 393 } else if (rate >= 1641) { 394 state->deci = 4; state->csel = 1; state->rsel = 0; 395 } else if (rate >= 1407) { 396 state->deci = 4; state->csel = 1; state->rsel = 1; 397 } else if (rate >= 1172) { 398 state->deci = 5; state->csel = 0; state->rsel = 0; 399 } else if (rate >= 939) { 400 state->deci = 5; state->csel = 0; state->rsel = 1; 401 } else if (rate >= 821) { 402 state->deci = 5; state->csel = 1; state->rsel = 0; 403 } else { 404 state->deci = 5; state->csel = 1; state->rsel = 1; 405 } 406 407 if (state->csel == 0) 408 state->master_clk = 92000; 409 else 410 state->master_clk = 61333; 411 412} 413 414static int signal_det(struct mb86a16_state *state, 415 int smrt, 416 unsigned char *SIG) 417{ 418 419 int ret ; 420 int smrtd ; 421 int wait_sym ; 422 423 u32 wait_t; 424 unsigned char S[3] ; 425 int i ; 426 427 if (*SIG > 45) { 428 if (CNTM_set(state, 2, 1, 2) < 0) { 429 dprintk(verbose, MB86A16_ERROR, 1, "CNTM set Error"); 430 return -1; 431 } 432 wait_sym = 40000; 433 } else { 434 if (CNTM_set(state, 3, 1, 2) < 0) { 435 dprintk(verbose, MB86A16_ERROR, 1, "CNTM set Error"); 436 return -1; 437 } 438 wait_sym = 80000; 439 } 440 for (i = 0; i < 3; i++) { 441 if (i == 0) 442 smrtd = smrt * 98 / 100; 443 else if (i == 1) 444 smrtd = smrt; 445 else 446 smrtd = smrt * 102 / 100; 447 smrt_info_get(state, smrtd); 448 smrt_set(state, smrtd); 449 srst(state); 450 wait_t = (wait_sym + 99 * smrtd / 100) / smrtd; 451 if (wait_t == 0) 452 wait_t = 1; 453 msleep_interruptible(10); 454 if (mb86a16_read(state, 0x37, &(S[i])) != 2) { 455 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 456 return -EREMOTEIO; 457 } 458 } 459 if ((S[1] > S[0] * 112 / 100) && 460 (S[1] > S[2] * 112 / 100)) { 461 462 ret = 1; 463 } else { 464 ret = 0; 465 } 466 *SIG = S[1]; 467 468 if (CNTM_set(state, 0, 1, 2) < 0) { 469 dprintk(verbose, MB86A16_ERROR, 1, "CNTM set Error"); 470 return -1; 471 } 472 473 return ret; 474} 475 476static int rf_val_set(struct mb86a16_state *state, 477 int f, 478 int smrt, 479 unsigned char R) 480{ 481 unsigned char C, F, B; 482 int M; 483 unsigned char rf_val[5]; 484 int ack = -1; 485 486 if (smrt > 37750) 487 C = 1; 488 else if (smrt > 18875) 489 C = 2; 490 else if (smrt > 5500) 491 C = 3; 492 else 493 C = 4; 494 495 if (smrt > 30500) 496 F = 3; 497 else if (smrt > 9375) 498 F = 1; 499 else if (smrt > 4625) 500 F = 0; 501 else 502 F = 2; 503 504 if (f < 1060) 505 B = 0; 506 else if (f < 1175) 507 B = 1; 508 else if (f < 1305) 509 B = 2; 510 else if (f < 1435) 511 B = 3; 512 else if (f < 1570) 513 B = 4; 514 else if (f < 1715) 515 B = 5; 516 else if (f < 1845) 517 B = 6; 518 else if (f < 1980) 519 B = 7; 520 else if (f < 2080) 521 B = 8; 522 else 523 B = 9; 524 525 M = f * (1 << R) / 2; 526 527 rf_val[0] = 0x01 | (C << 3) | (F << 1); 528 rf_val[1] = (R << 5) | ((M & 0x1f000) >> 12); 529 rf_val[2] = (M & 0x00ff0) >> 4; 530 rf_val[3] = ((M & 0x0000f) << 4) | B; 531 532 /* Frequency Set */ 533 if (mb86a16_write(state, 0x21, rf_val[0]) < 0) 534 ack = 0; 535 if (mb86a16_write(state, 0x22, rf_val[1]) < 0) 536 ack = 0; 537 if (mb86a16_write(state, 0x23, rf_val[2]) < 0) 538 ack = 0; 539 if (mb86a16_write(state, 0x24, rf_val[3]) < 0) 540 ack = 0; 541 if (mb86a16_write(state, 0x25, 0x01) < 0) 542 ack = 0; 543 if (ack == 0) { 544 dprintk(verbose, MB86A16_ERROR, 1, "RF Setup - I2C transfer error"); 545 return -EREMOTEIO; 546 } 547 548 return 0; 549} 550 551static int afcerr_chk(struct mb86a16_state *state) 552{ 553 unsigned char AFCM_L, AFCM_H ; 554 int AFCM ; 555 int afcm, afcerr ; 556 557 if (mb86a16_read(state, 0x0e, &AFCM_L) != 2) 558 goto err; 559 if (mb86a16_read(state, 0x0f, &AFCM_H) != 2) 560 goto err; 561 562 AFCM = (AFCM_H << 8) + AFCM_L; 563 564 if (AFCM > 2048) 565 afcm = AFCM - 4096; 566 else 567 afcm = AFCM; 568 afcerr = afcm * state->master_clk / 8192; 569 570 return afcerr; 571 572err: 573 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 574 return -EREMOTEIO; 575} 576 577static int dagcm_val_get(struct mb86a16_state *state) 578{ 579 int DAGCM; 580 unsigned char DAGCM_H, DAGCM_L; 581 582 if (mb86a16_read(state, 0x45, &DAGCM_L) != 2) 583 goto err; 584 if (mb86a16_read(state, 0x46, &DAGCM_H) != 2) 585 goto err; 586 587 DAGCM = (DAGCM_H << 8) + DAGCM_L; 588 589 return DAGCM; 590 591err: 592 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 593 return -EREMOTEIO; 594} 595 596static int mb86a16_read_status(struct dvb_frontend *fe, fe_status_t *status) 597{ 598 u8 stat, stat2; 599 struct mb86a16_state *state = fe->demodulator_priv; 600 601 *status = 0; 602 603 if (mb86a16_read(state, MB86A16_SIG1, &stat) != 2) 604 goto err; 605 if (mb86a16_read(state, MB86A16_SIG2, &stat2) != 2) 606 goto err; 607 if ((stat > 25) && (stat2 > 25)) 608 *status |= FE_HAS_SIGNAL; 609 if ((stat > 45) && (stat2 > 45)) 610 *status |= FE_HAS_CARRIER; 611 612 if (mb86a16_read(state, MB86A16_STATUS, &stat) != 2) 613 goto err; 614 615 if (stat & 0x01) 616 *status |= FE_HAS_SYNC; 617 if (stat & 0x01) 618 *status |= FE_HAS_VITERBI; 619 620 if (mb86a16_read(state, MB86A16_FRAMESYNC, &stat) != 2) 621 goto err; 622 623 if ((stat & 0x0f) && (*status & FE_HAS_VITERBI)) 624 *status |= FE_HAS_LOCK; 625 626 return 0; 627 628err: 629 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 630 return -EREMOTEIO; 631} 632 633static int sync_chk(struct mb86a16_state *state, 634 unsigned char *VIRM) 635{ 636 unsigned char val; 637 int sync; 638 639 if (mb86a16_read(state, 0x0d, &val) != 2) 640 goto err; 641 642 dprintk(verbose, MB86A16_INFO, 1, "Status = %02x,", val); 643 sync = val & 0x01; 644 *VIRM = (val & 0x1c) >> 2; 645 646 return sync; 647err: 648 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 649 return -EREMOTEIO; 650 651} 652 653static int freqerr_chk(struct mb86a16_state *state, 654 int fTP, 655 int smrt, 656 int unit) 657{ 658 unsigned char CRM, AFCML, AFCMH; 659 unsigned char temp1, temp2, temp3; 660 int crm, afcm, AFCM; 661 int crrerr, afcerr; /* kHz */ 662 int frqerr; /* MHz */ 663 int afcen, afcexen = 0; 664 int R, M, fOSC, fOSC_OFS; 665 666 if (mb86a16_read(state, 0x43, &CRM) != 2) 667 goto err; 668 669 if (CRM > 127) 670 crm = CRM - 256; 671 else 672 crm = CRM; 673 674 crrerr = smrt * crm / 256; 675 if (mb86a16_read(state, 0x49, &temp1) != 2) 676 goto err; 677 678 afcen = (temp1 & 0x04) >> 2; 679 if (afcen == 0) { 680 if (mb86a16_read(state, 0x2a, &temp1) != 2) 681 goto err; 682 afcexen = (temp1 & 0x20) >> 5; 683 } 684 685 if (afcen == 1) { 686 if (mb86a16_read(state, 0x0e, &AFCML) != 2) 687 goto err; 688 if (mb86a16_read(state, 0x0f, &AFCMH) != 2) 689 goto err; 690 } else if (afcexen == 1) { 691 if (mb86a16_read(state, 0x2b, &AFCML) != 2) 692 goto err; 693 if (mb86a16_read(state, 0x2c, &AFCMH) != 2) 694 goto err; 695 } 696 if ((afcen == 1) || (afcexen == 1)) { 697 smrt_info_get(state, smrt); 698 AFCM = ((AFCMH & 0x01) << 8) + AFCML; 699 if (AFCM > 255) 700 afcm = AFCM - 512; 701 else 702 afcm = AFCM; 703 704 afcerr = afcm * state->master_clk / 8192; 705 } else 706 afcerr = 0; 707 708 if (mb86a16_read(state, 0x22, &temp1) != 2) 709 goto err; 710 if (mb86a16_read(state, 0x23, &temp2) != 2) 711 goto err; 712 if (mb86a16_read(state, 0x24, &temp3) != 2) 713 goto err; 714 715 R = (temp1 & 0xe0) >> 5; 716 M = ((temp1 & 0x1f) << 12) + (temp2 << 4) + (temp3 >> 4); 717 if (R == 0) 718 fOSC = 2 * M; 719 else 720 fOSC = M; 721 722 fOSC_OFS = fOSC - fTP; 723 724 if (unit == 0) { /* MHz */ 725 if (crrerr + afcerr + fOSC_OFS * 1000 >= 0) 726 frqerr = (crrerr + afcerr + fOSC_OFS * 1000 + 500) / 1000; 727 else 728 frqerr = (crrerr + afcerr + fOSC_OFS * 1000 - 500) / 1000; 729 } else { /* kHz */ 730 frqerr = crrerr + afcerr + fOSC_OFS * 1000; 731 } 732 733 return frqerr; 734err: 735 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 736 return -EREMOTEIO; 737} 738 739static unsigned char vco_dev_get(struct mb86a16_state *state, int smrt) 740{ 741 unsigned char R; 742 743 if (smrt > 9375) 744 R = 0; 745 else 746 R = 1; 747 748 return R; 749} 750 751static void swp_info_get(struct mb86a16_state *state, 752 int fOSC_start, 753 int smrt, 754 int v, int R, 755 int swp_ofs, 756 int *fOSC, 757 int *afcex_freq, 758 unsigned char *AFCEX_L, 759 unsigned char *AFCEX_H) 760{ 761 int AFCEX ; 762 int crnt_swp_freq ; 763 764 crnt_swp_freq = fOSC_start * 1000 + v * swp_ofs; 765 766 if (R == 0) 767 *fOSC = (crnt_swp_freq + 1000) / 2000 * 2; 768 else 769 *fOSC = (crnt_swp_freq + 500) / 1000; 770 771 if (*fOSC >= crnt_swp_freq) 772 *afcex_freq = *fOSC * 1000 - crnt_swp_freq; 773 else 774 *afcex_freq = crnt_swp_freq - *fOSC * 1000; 775 776 AFCEX = *afcex_freq * 8192 / state->master_clk; 777 *AFCEX_L = AFCEX & 0x00ff; 778 *AFCEX_H = (AFCEX & 0x0f00) >> 8; 779} 780 781 782static int swp_freq_calcuation(struct mb86a16_state *state, int i, int v, int *V, int vmax, int vmin, 783 int SIGMIN, int fOSC, int afcex_freq, int swp_ofs, unsigned char *SIG1) 784{ 785 int swp_freq ; 786 787 if ((i % 2 == 1) && (v <= vmax)) { 788 /* positive v (case 1) */ 789 if ((v - 1 == vmin) && 790 (*(V + 30 + v) >= 0) && 791 (*(V + 30 + v - 1) >= 0) && 792 (*(V + 30 + v - 1) > *(V + 30 + v)) && 793 (*(V + 30 + v - 1) > SIGMIN)) { 794 795 swp_freq = fOSC * 1000 + afcex_freq - swp_ofs; 796 *SIG1 = *(V + 30 + v - 1); 797 } else if ((v == vmax) && 798 (*(V + 30 + v) >= 0) && 799 (*(V + 30 + v - 1) >= 0) && 800 (*(V + 30 + v) > *(V + 30 + v - 1)) && 801 (*(V + 30 + v) > SIGMIN)) { 802 /* (case 2) */ 803 swp_freq = fOSC * 1000 + afcex_freq; 804 *SIG1 = *(V + 30 + v); 805 } else if ((*(V + 30 + v) > 0) && 806 (*(V + 30 + v - 1) > 0) && 807 (*(V + 30 + v - 2) > 0) && 808 (*(V + 30 + v - 3) > 0) && 809 (*(V + 30 + v - 1) > *(V + 30 + v)) && 810 (*(V + 30 + v - 2) > *(V + 30 + v - 3)) && 811 ((*(V + 30 + v - 1) > SIGMIN) || 812 (*(V + 30 + v - 2) > SIGMIN))) { 813 /* (case 3) */ 814 if (*(V + 30 + v - 1) >= *(V + 30 + v - 2)) { 815 swp_freq = fOSC * 1000 + afcex_freq - swp_ofs; 816 *SIG1 = *(V + 30 + v - 1); 817 } else { 818 swp_freq = fOSC * 1000 + afcex_freq - swp_ofs * 2; 819 *SIG1 = *(V + 30 + v - 2); 820 } 821 } else if ((v == vmax) && 822 (*(V + 30 + v) >= 0) && 823 (*(V + 30 + v - 1) >= 0) && 824 (*(V + 30 + v - 2) >= 0) && 825 (*(V + 30 + v) > *(V + 30 + v - 2)) && 826 (*(V + 30 + v - 1) > *(V + 30 + v - 2)) && 827 ((*(V + 30 + v) > SIGMIN) || 828 (*(V + 30 + v - 1) > SIGMIN))) { 829 /* (case 4) */ 830 if (*(V + 30 + v) >= *(V + 30 + v - 1)) { 831 swp_freq = fOSC * 1000 + afcex_freq; 832 *SIG1 = *(V + 30 + v); 833 } else { 834 swp_freq = fOSC * 1000 + afcex_freq - swp_ofs; 835 *SIG1 = *(V + 30 + v - 1); 836 } 837 } else { 838 swp_freq = -1 ; 839 } 840 } else if ((i % 2 == 0) && (v >= vmin)) { 841 /* Negative v (case 1) */ 842 if ((*(V + 30 + v) > 0) && 843 (*(V + 30 + v + 1) > 0) && 844 (*(V + 30 + v + 2) > 0) && 845 (*(V + 30 + v + 1) > *(V + 30 + v)) && 846 (*(V + 30 + v + 1) > *(V + 30 + v + 2)) && 847 (*(V + 30 + v + 1) > SIGMIN)) { 848 849 swp_freq = fOSC * 1000 + afcex_freq + swp_ofs; 850 *SIG1 = *(V + 30 + v + 1); 851 } else if ((v + 1 == vmax) && 852 (*(V + 30 + v) >= 0) && 853 (*(V + 30 + v + 1) >= 0) && 854 (*(V + 30 + v + 1) > *(V + 30 + v)) && 855 (*(V + 30 + v + 1) > SIGMIN)) { 856 /* (case 2) */ 857 swp_freq = fOSC * 1000 + afcex_freq + swp_ofs; 858 *SIG1 = *(V + 30 + v); 859 } else if ((v == vmin) && 860 (*(V + 30 + v) > 0) && 861 (*(V + 30 + v + 1) > 0) && 862 (*(V + 30 + v + 2) > 0) && 863 (*(V + 30 + v) > *(V + 30 + v + 1)) && 864 (*(V + 30 + v) > *(V + 30 + v + 2)) && 865 (*(V + 30 + v) > SIGMIN)) { 866 /* (case 3) */ 867 swp_freq = fOSC * 1000 + afcex_freq; 868 *SIG1 = *(V + 30 + v); 869 } else if ((*(V + 30 + v) >= 0) && 870 (*(V + 30 + v + 1) >= 0) && 871 (*(V + 30 + v + 2) >= 0) && 872 (*(V + 30 + v + 3) >= 0) && 873 (*(V + 30 + v + 1) > *(V + 30 + v)) && 874 (*(V + 30 + v + 2) > *(V + 30 + v + 3)) && 875 ((*(V + 30 + v + 1) > SIGMIN) || 876 (*(V + 30 + v + 2) > SIGMIN))) { 877 /* (case 4) */ 878 if (*(V + 30 + v + 1) >= *(V + 30 + v + 2)) { 879 swp_freq = fOSC * 1000 + afcex_freq + swp_ofs; 880 *SIG1 = *(V + 30 + v + 1); 881 } else { 882 swp_freq = fOSC * 1000 + afcex_freq + swp_ofs * 2; 883 *SIG1 = *(V + 30 + v + 2); 884 } 885 } else if ((*(V + 30 + v) >= 0) && 886 (*(V + 30 + v + 1) >= 0) && 887 (*(V + 30 + v + 2) >= 0) && 888 (*(V + 30 + v + 3) >= 0) && 889 (*(V + 30 + v) > *(V + 30 + v + 2)) && 890 (*(V + 30 + v + 1) > *(V + 30 + v + 2)) && 891 (*(V + 30 + v) > *(V + 30 + v + 3)) && 892 (*(V + 30 + v + 1) > *(V + 30 + v + 3)) && 893 ((*(V + 30 + v) > SIGMIN) || 894 (*(V + 30 + v + 1) > SIGMIN))) { 895 /* (case 5) */ 896 if (*(V + 30 + v) >= *(V + 30 + v + 1)) { 897 swp_freq = fOSC * 1000 + afcex_freq; 898 *SIG1 = *(V + 30 + v); 899 } else { 900 swp_freq = fOSC * 1000 + afcex_freq + swp_ofs; 901 *SIG1 = *(V + 30 + v + 1); 902 } 903 } else if ((v + 2 == vmin) && 904 (*(V + 30 + v) >= 0) && 905 (*(V + 30 + v + 1) >= 0) && 906 (*(V + 30 + v + 2) >= 0) && 907 (*(V + 30 + v + 1) > *(V + 30 + v)) && 908 (*(V + 30 + v + 2) > *(V + 30 + v)) && 909 ((*(V + 30 + v + 1) > SIGMIN) || 910 (*(V + 30 + v + 2) > SIGMIN))) { 911 /* (case 6) */ 912 if (*(V + 30 + v + 1) >= *(V + 30 + v + 2)) { 913 swp_freq = fOSC * 1000 + afcex_freq + swp_ofs; 914 *SIG1 = *(V + 30 + v + 1); 915 } else { 916 swp_freq = fOSC * 1000 + afcex_freq + swp_ofs * 2; 917 *SIG1 = *(V + 30 + v + 2); 918 } 919 } else if ((vmax == 0) && (vmin == 0) && (*(V + 30 + v) > SIGMIN)) { 920 swp_freq = fOSC * 1000; 921 *SIG1 = *(V + 30 + v); 922 } else 923 swp_freq = -1; 924 } else 925 swp_freq = -1; 926 927 return swp_freq; 928} 929 930static void swp_info_get2(struct mb86a16_state *state, 931 int smrt, 932 int R, 933 int swp_freq, 934 int *afcex_freq, 935 int *fOSC, 936 unsigned char *AFCEX_L, 937 unsigned char *AFCEX_H) 938{ 939 int AFCEX ; 940 941 if (R == 0) 942 *fOSC = (swp_freq + 1000) / 2000 * 2; 943 else 944 *fOSC = (swp_freq + 500) / 1000; 945 946 if (*fOSC >= swp_freq) 947 *afcex_freq = *fOSC * 1000 - swp_freq; 948 else 949 *afcex_freq = swp_freq - *fOSC * 1000; 950 951 AFCEX = *afcex_freq * 8192 / state->master_clk; 952 *AFCEX_L = AFCEX & 0x00ff; 953 *AFCEX_H = (AFCEX & 0x0f00) >> 8; 954} 955 956static void afcex_info_get(struct mb86a16_state *state, 957 int afcex_freq, 958 unsigned char *AFCEX_L, 959 unsigned char *AFCEX_H) 960{ 961 int AFCEX ; 962 963 AFCEX = afcex_freq * 8192 / state->master_clk; 964 *AFCEX_L = AFCEX & 0x00ff; 965 *AFCEX_H = (AFCEX & 0x0f00) >> 8; 966} 967 968static int SEQ_set(struct mb86a16_state *state, unsigned char loop) 969{ 970 /* SLOCK0 = 0 */ 971 if (mb86a16_write(state, 0x32, 0x02 | (loop << 2)) < 0) { 972 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 973 return -EREMOTEIO; 974 } 975 976 return 0; 977} 978 979static int iq_vt_set(struct mb86a16_state *state, unsigned char IQINV) 980{ 981 /* Viterbi Rate, IQ Settings */ 982 if (mb86a16_write(state, 0x06, 0xdf | (IQINV << 5)) < 0) { 983 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 984 return -EREMOTEIO; 985 } 986 987 return 0; 988} 989 990static int FEC_srst(struct mb86a16_state *state) 991{ 992 if (mb86a16_write(state, MB86A16_RESET, 0x02) < 0) { 993 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 994 return -EREMOTEIO; 995 } 996 997 return 0; 998} 999 1000static int S2T_set(struct mb86a16_state *state, unsigned char S2T) 1001{ 1002 if (mb86a16_write(state, 0x34, 0x70 | S2T) < 0) { 1003 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 1004 return -EREMOTEIO; 1005 } 1006 1007 return 0; 1008} 1009 1010static int S45T_set(struct mb86a16_state *state, unsigned char S4T, unsigned char S5T) 1011{ 1012 if (mb86a16_write(state, 0x35, 0x00 | (S5T << 4) | S4T) < 0) { 1013 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 1014 return -EREMOTEIO; 1015 } 1016 1017 return 0; 1018} 1019 1020 1021static int mb86a16_set_fe(struct mb86a16_state *state) 1022{ 1023 u8 agcval, cnmval; 1024 1025 int i, j; 1026 int fOSC = 0; 1027 int fOSC_start = 0; 1028 int wait_t; 1029 int fcp; 1030 int swp_ofs; 1031 int V[60]; 1032 u8 SIG1MIN; 1033 1034 unsigned char CREN, AFCEN, AFCEXEN; 1035 unsigned char SIG1; 1036 unsigned char TIMINT1, TIMINT2, TIMEXT; 1037 unsigned char S0T, S1T; 1038 unsigned char S2T; 1039/* unsigned char S2T, S3T; */ 1040 unsigned char S4T, S5T; 1041 unsigned char AFCEX_L, AFCEX_H; 1042 unsigned char R; 1043 unsigned char VIRM; 1044 unsigned char ETH, VIA; 1045 unsigned char junk; 1046 1047 int loop; 1048 int ftemp; 1049 int v, vmax, vmin; 1050 int vmax_his, vmin_his; 1051 int swp_freq, prev_swp_freq[20]; 1052 int prev_freq_num; 1053 int signal_dupl; 1054 int afcex_freq; 1055 int signal; 1056 int afcerr; 1057 int temp_freq, delta_freq; 1058 int dagcm[4]; 1059 int smrt_d; 1060/* int freq_err; */ 1061 int n; 1062 int ret = -1; 1063 int sync; 1064 1065 dprintk(verbose, MB86A16_INFO, 1, "freq=%d Mhz, symbrt=%d Ksps", state->frequency, state->srate); 1066 1067 fcp = 3000; 1068 swp_ofs = state->srate / 4; 1069 1070 for (i = 0; i < 60; i++) 1071 V[i] = -1; 1072 1073 for (i = 0; i < 20; i++) 1074 prev_swp_freq[i] = 0; 1075 1076 SIG1MIN = 25; 1077 1078 for (n = 0; ((n < 3) && (ret == -1)); n++) { 1079 SEQ_set(state, 0); 1080 iq_vt_set(state, 0); 1081 1082 CREN = 0; 1083 AFCEN = 0; 1084 AFCEXEN = 1; 1085 TIMINT1 = 0; 1086 TIMINT2 = 1; 1087 TIMEXT = 2; 1088 S1T = 0; 1089 S0T = 0; 1090 1091 if (initial_set(state) < 0) { 1092 dprintk(verbose, MB86A16_ERROR, 1, "initial set failed"); 1093 return -1; 1094 } 1095 if (DAGC_data_set(state, 3, 2) < 0) { 1096 dprintk(verbose, MB86A16_ERROR, 1, "DAGC data set error"); 1097 return -1; 1098 } 1099 if (EN_set(state, CREN, AFCEN) < 0) { 1100 dprintk(verbose, MB86A16_ERROR, 1, "EN set error"); 1101 return -1; /* (0, 0) */ 1102 } 1103 if (AFCEXEN_set(state, AFCEXEN, state->srate) < 0) { 1104 dprintk(verbose, MB86A16_ERROR, 1, "AFCEXEN set error"); 1105 return -1; /* (1, smrt) = (1, symbolrate) */ 1106 } 1107 if (CNTM_set(state, TIMINT1, TIMINT2, TIMEXT) < 0) { 1108 dprintk(verbose, MB86A16_ERROR, 1, "CNTM set error"); 1109 return -1; /* (0, 1, 2) */ 1110 } 1111 if (S01T_set(state, S1T, S0T) < 0) { 1112 dprintk(verbose, MB86A16_ERROR, 1, "S01T set error"); 1113 return -1; /* (0, 0) */ 1114 } 1115 smrt_info_get(state, state->srate); 1116 if (smrt_set(state, state->srate) < 0) { 1117 dprintk(verbose, MB86A16_ERROR, 1, "smrt info get error"); 1118 return -1; 1119 } 1120 1121 R = vco_dev_get(state, state->srate); 1122 if (R == 1) 1123 fOSC_start = state->frequency; 1124 1125 else if (R == 0) { 1126 if (state->frequency % 2 == 0) { 1127 fOSC_start = state->frequency; 1128 } else { 1129 fOSC_start = state->frequency + 1; 1130 if (fOSC_start > 2150) 1131 fOSC_start = state->frequency - 1; 1132 } 1133 } 1134 loop = 1; 1135 ftemp = fOSC_start * 1000; 1136 vmax = 0 ; 1137 while (loop == 1) { 1138 ftemp = ftemp + swp_ofs; 1139 vmax++; 1140 1141 /* Upper bound */ 1142 if (ftemp > 2150000) { 1143 loop = 0; 1144 vmax--; 1145 } else { 1146 if ((ftemp == 2150000) || 1147 (ftemp - state->frequency * 1000 >= fcp + state->srate / 4)) 1148 loop = 0; 1149 } 1150 } 1151 1152 loop = 1; 1153 ftemp = fOSC_start * 1000; 1154 vmin = 0 ; 1155 while (loop == 1) { 1156 ftemp = ftemp - swp_ofs; 1157 vmin--; 1158 1159 /* Lower bound */ 1160 if (ftemp < 950000) { 1161 loop = 0; 1162 vmin++; 1163 } else { 1164 if ((ftemp == 950000) || 1165 (state->frequency * 1000 - ftemp >= fcp + state->srate / 4)) 1166 loop = 0; 1167 } 1168 } 1169 1170 wait_t = (8000 + state->srate / 2) / state->srate; 1171 if (wait_t == 0) 1172 wait_t = 1; 1173 1174 i = 0; 1175 j = 0; 1176 prev_freq_num = 0; 1177 loop = 1; 1178 signal = 0; 1179 vmax_his = 0; 1180 vmin_his = 0; 1181 v = 0; 1182 1183 while (loop == 1) { 1184 swp_info_get(state, fOSC_start, state->srate, 1185 v, R, swp_ofs, &fOSC, 1186 &afcex_freq, &AFCEX_L, &AFCEX_H); 1187 1188 udelay(100); 1189 if (rf_val_set(state, fOSC, state->srate, R) < 0) { 1190 dprintk(verbose, MB86A16_ERROR, 1, "rf val set error"); 1191 return -1; 1192 } 1193 udelay(100); 1194 if (afcex_data_set(state, AFCEX_L, AFCEX_H) < 0) { 1195 dprintk(verbose, MB86A16_ERROR, 1, "afcex data set error"); 1196 return -1; 1197 } 1198 if (srst(state) < 0) { 1199 dprintk(verbose, MB86A16_ERROR, 1, "srst error"); 1200 return -1; 1201 } 1202 msleep_interruptible(wait_t); 1203 1204 if (mb86a16_read(state, 0x37, &SIG1) != 2) { 1205 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 1206 return -1; 1207 } 1208 V[30 + v] = SIG1 ; 1209 swp_freq = swp_freq_calcuation(state, i, v, V, vmax, vmin, 1210 SIG1MIN, fOSC, afcex_freq, 1211 swp_ofs, &SIG1); /* changed */ 1212 1213 signal_dupl = 0; 1214 for (j = 0; j < prev_freq_num; j++) { 1215 if ((ABS(prev_swp_freq[j] - swp_freq)) < (swp_ofs * 3 / 2)) { 1216 signal_dupl = 1; 1217 dprintk(verbose, MB86A16_INFO, 1, "Probably Duplicate Signal, j = %d", j); 1218 } 1219 } 1220 if ((signal_dupl == 0) && (swp_freq > 0) && (ABS(swp_freq - state->frequency * 1000) < fcp + state->srate / 6)) { 1221 dprintk(verbose, MB86A16_DEBUG, 1, "------ Signal detect ------ [swp_freq=[%07d, srate=%05d]]", swp_freq, state->srate); 1222 prev_swp_freq[prev_freq_num] = swp_freq; 1223 prev_freq_num++; 1224 swp_info_get2(state, state->srate, R, swp_freq, 1225 &afcex_freq, &fOSC, 1226 &AFCEX_L, &AFCEX_H); 1227 1228 if (rf_val_set(state, fOSC, state->srate, R) < 0) { 1229 dprintk(verbose, MB86A16_ERROR, 1, "rf val set error"); 1230 return -1; 1231 } 1232 if (afcex_data_set(state, AFCEX_L, AFCEX_H) < 0) { 1233 dprintk(verbose, MB86A16_ERROR, 1, "afcex data set error"); 1234 return -1; 1235 } 1236 signal = signal_det(state, state->srate, &SIG1); 1237 if (signal == 1) { 1238 dprintk(verbose, MB86A16_ERROR, 1, "***** Signal Found *****"); 1239 loop = 0; 1240 } else { 1241 dprintk(verbose, MB86A16_ERROR, 1, "!!!!! No signal !!!!!, try again..."); 1242 smrt_info_get(state, state->srate); 1243 if (smrt_set(state, state->srate) < 0) { 1244 dprintk(verbose, MB86A16_ERROR, 1, "smrt set error"); 1245 return -1; 1246 } 1247 } 1248 } 1249 if (v > vmax) 1250 vmax_his = 1 ; 1251 if (v < vmin) 1252 vmin_his = 1 ; 1253 i++; 1254 1255 if ((i % 2 == 1) && (vmax_his == 1)) 1256 i++; 1257 if ((i % 2 == 0) && (vmin_his == 1)) 1258 i++; 1259 1260 if (i % 2 == 1) 1261 v = (i + 1) / 2; 1262 else 1263 v = -i / 2; 1264 1265 if ((vmax_his == 1) && (vmin_his == 1)) 1266 loop = 0 ; 1267 } 1268 1269 if (signal == 1) { 1270 dprintk(verbose, MB86A16_INFO, 1, " Start Freq Error Check"); 1271 S1T = 7 ; 1272 S0T = 1 ; 1273 CREN = 0 ; 1274 AFCEN = 1 ; 1275 AFCEXEN = 0 ; 1276 1277 if (S01T_set(state, S1T, S0T) < 0) { 1278 dprintk(verbose, MB86A16_ERROR, 1, "S01T set error"); 1279 return -1; 1280 } 1281 smrt_info_get(state, state->srate); 1282 if (smrt_set(state, state->srate) < 0) { 1283 dprintk(verbose, MB86A16_ERROR, 1, "smrt set error"); 1284 return -1; 1285 } 1286 if (EN_set(state, CREN, AFCEN) < 0) { 1287 dprintk(verbose, MB86A16_ERROR, 1, "EN set error"); 1288 return -1; 1289 } 1290 if (AFCEXEN_set(state, AFCEXEN, state->srate) < 0) { 1291 dprintk(verbose, MB86A16_ERROR, 1, "AFCEXEN set error"); 1292 return -1; 1293 } 1294 afcex_info_get(state, afcex_freq, &AFCEX_L, &AFCEX_H); 1295 if (afcofs_data_set(state, AFCEX_L, AFCEX_H) < 0) { 1296 dprintk(verbose, MB86A16_ERROR, 1, "AFCOFS data set error"); 1297 return -1; 1298 } 1299 if (srst(state) < 0) { 1300 dprintk(verbose, MB86A16_ERROR, 1, "srst error"); 1301 return -1; 1302 } 1303 /* delay 4~200 */ 1304 wait_t = 200000 / state->master_clk + 200000 / state->srate; 1305 msleep(wait_t); 1306 afcerr = afcerr_chk(state); 1307 if (afcerr == -1) 1308 return -1; 1309 1310 swp_freq = fOSC * 1000 + afcerr ; 1311 AFCEXEN = 1 ; 1312 if (state->srate >= 1500) 1313 smrt_d = state->srate / 3; 1314 else 1315 smrt_d = state->srate / 2; 1316 smrt_info_get(state, smrt_d); 1317 if (smrt_set(state, smrt_d) < 0) { 1318 dprintk(verbose, MB86A16_ERROR, 1, "smrt set error"); 1319 return -1; 1320 } 1321 if (AFCEXEN_set(state, AFCEXEN, smrt_d) < 0) { 1322 dprintk(verbose, MB86A16_ERROR, 1, "AFCEXEN set error"); 1323 return -1; 1324 } 1325 R = vco_dev_get(state, smrt_d); 1326 if (DAGC_data_set(state, 2, 0) < 0) { 1327 dprintk(verbose, MB86A16_ERROR, 1, "DAGC data set error"); 1328 return -1; 1329 } 1330 for (i = 0; i < 3; i++) { 1331 temp_freq = swp_freq + (i - 1) * state->srate / 8; 1332 swp_info_get2(state, smrt_d, R, temp_freq, &afcex_freq, &fOSC, &AFCEX_L, &AFCEX_H); 1333 if (rf_val_set(state, fOSC, smrt_d, R) < 0) { 1334 dprintk(verbose, MB86A16_ERROR, 1, "rf val set error"); 1335 return -1; 1336 } 1337 if (afcex_data_set(state, AFCEX_L, AFCEX_H) < 0) { 1338 dprintk(verbose, MB86A16_ERROR, 1, "afcex data set error"); 1339 return -1; 1340 } 1341 wait_t = 200000 / state->master_clk + 40000 / smrt_d; 1342 msleep(wait_t); 1343 dagcm[i] = dagcm_val_get(state); 1344 } 1345 if ((dagcm[0] > dagcm[1]) && 1346 (dagcm[0] > dagcm[2]) && 1347 (dagcm[0] - dagcm[1] > 2 * (dagcm[2] - dagcm[1]))) { 1348 1349 temp_freq = swp_freq - 2 * state->srate / 8; 1350 swp_info_get2(state, smrt_d, R, temp_freq, &afcex_freq, &fOSC, &AFCEX_L, &AFCEX_H); 1351 if (rf_val_set(state, fOSC, smrt_d, R) < 0) { 1352 dprintk(verbose, MB86A16_ERROR, 1, "rf val set error"); 1353 return -1; 1354 } 1355 if (afcex_data_set(state, AFCEX_L, AFCEX_H) < 0) { 1356 dprintk(verbose, MB86A16_ERROR, 1, "afcex data set"); 1357 return -1; 1358 } 1359 wait_t = 200000 / state->master_clk + 40000 / smrt_d; 1360 msleep(wait_t); 1361 dagcm[3] = dagcm_val_get(state); 1362 if (dagcm[3] > dagcm[1]) 1363 delta_freq = (dagcm[2] - dagcm[0] + dagcm[1] - dagcm[3]) * state->srate / 300; 1364 else 1365 delta_freq = 0; 1366 } else if ((dagcm[2] > dagcm[1]) && 1367 (dagcm[2] > dagcm[0]) && 1368 (dagcm[2] - dagcm[1] > 2 * (dagcm[0] - dagcm[1]))) { 1369 1370 temp_freq = swp_freq + 2 * state->srate / 8; 1371 swp_info_get2(state, smrt_d, R, temp_freq, &afcex_freq, &fOSC, &AFCEX_L, &AFCEX_H); 1372 if (rf_val_set(state, fOSC, smrt_d, R) < 0) { 1373 dprintk(verbose, MB86A16_ERROR, 1, "rf val set"); 1374 return -1; 1375 } 1376 if (afcex_data_set(state, AFCEX_L, AFCEX_H) < 0) { 1377 dprintk(verbose, MB86A16_ERROR, 1, "afcex data set"); 1378 return -1; 1379 } 1380 wait_t = 200000 / state->master_clk + 40000 / smrt_d; 1381 msleep(wait_t); 1382 dagcm[3] = dagcm_val_get(state); 1383 if (dagcm[3] > dagcm[1]) 1384 delta_freq = (dagcm[2] - dagcm[0] + dagcm[3] - dagcm[1]) * state->srate / 300; 1385 else 1386 delta_freq = 0 ; 1387 1388 } else { 1389 delta_freq = 0 ; 1390 } 1391 dprintk(verbose, MB86A16_INFO, 1, "SWEEP Frequency = %d", swp_freq); 1392 swp_freq += delta_freq; 1393 dprintk(verbose, MB86A16_INFO, 1, "Adjusting .., DELTA Freq = %d, SWEEP Freq=%d", delta_freq, swp_freq); 1394 if (ABS(state->frequency * 1000 - swp_freq) > 3800) { 1395 dprintk(verbose, MB86A16_INFO, 1, "NO -- SIGNAL !"); 1396 } else { 1397 1398 S1T = 0; 1399 S0T = 3; 1400 CREN = 1; 1401 AFCEN = 0; 1402 AFCEXEN = 1; 1403 1404 if (S01T_set(state, S1T, S0T) < 0) { 1405 dprintk(verbose, MB86A16_ERROR, 1, "S01T set error"); 1406 return -1; 1407 } 1408 if (DAGC_data_set(state, 0, 0) < 0) { 1409 dprintk(verbose, MB86A16_ERROR, 1, "DAGC data set error"); 1410 return -1; 1411 } 1412 R = vco_dev_get(state, state->srate); 1413 smrt_info_get(state, state->srate); 1414 if (smrt_set(state, state->srate) < 0) { 1415 dprintk(verbose, MB86A16_ERROR, 1, "smrt set error"); 1416 return -1; 1417 } 1418 if (EN_set(state, CREN, AFCEN) < 0) { 1419 dprintk(verbose, MB86A16_ERROR, 1, "EN set error"); 1420 return -1; 1421 } 1422 if (AFCEXEN_set(state, AFCEXEN, state->srate) < 0) { 1423 dprintk(verbose, MB86A16_ERROR, 1, "AFCEXEN set error"); 1424 return -1; 1425 } 1426 swp_info_get2(state, state->srate, R, swp_freq, &afcex_freq, &fOSC, &AFCEX_L, &AFCEX_H); 1427 if (rf_val_set(state, fOSC, state->srate, R) < 0) { 1428 dprintk(verbose, MB86A16_ERROR, 1, "rf val set error"); 1429 return -1; 1430 } 1431 if (afcex_data_set(state, AFCEX_L, AFCEX_H) < 0) { 1432 dprintk(verbose, MB86A16_ERROR, 1, "afcex data set error"); 1433 return -1; 1434 } 1435 if (srst(state) < 0) { 1436 dprintk(verbose, MB86A16_ERROR, 1, "srst error"); 1437 return -1; 1438 } 1439 wait_t = 7 + (10000 + state->srate / 2) / state->srate; 1440 if (wait_t == 0) 1441 wait_t = 1; 1442 msleep_interruptible(wait_t); 1443 if (mb86a16_read(state, 0x37, &SIG1) != 2) { 1444 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 1445 return -EREMOTEIO; 1446 } 1447 1448 if (SIG1 > 110) { 1449 S2T = 4; S4T = 1; S5T = 6; ETH = 4; VIA = 6; 1450 wait_t = 7 + (917504 + state->srate / 2) / state->srate; 1451 } else if (SIG1 > 105) { 1452 S2T = 4; S4T = 2; S5T = 8; ETH = 7; VIA = 2; 1453 wait_t = 7 + (1048576 + state->srate / 2) / state->srate; 1454 } else if (SIG1 > 85) { 1455 S2T = 5; S4T = 2; S5T = 8; ETH = 7; VIA = 2; 1456 wait_t = 7 + (1310720 + state->srate / 2) / state->srate; 1457 } else if (SIG1 > 65) { 1458 S2T = 6; S4T = 2; S5T = 8; ETH = 7; VIA = 2; 1459 wait_t = 7 + (1572864 + state->srate / 2) / state->srate; 1460 } else { 1461 S2T = 7; S4T = 2; S5T = 8; ETH = 7; VIA = 2; 1462 wait_t = 7 + (2097152 + state->srate / 2) / state->srate; 1463 } 1464 wait_t *= 2; /* FOS */ 1465 S2T_set(state, S2T); 1466 S45T_set(state, S4T, S5T); 1467 Vi_set(state, ETH, VIA); 1468 srst(state); 1469 msleep_interruptible(wait_t); 1470 sync = sync_chk(state, &VIRM); 1471 dprintk(verbose, MB86A16_INFO, 1, "-------- Viterbi=[%d] SYNC=[%d] ---------", VIRM, sync); 1472 if (VIRM) { 1473 if (VIRM == 4) { 1474 /* 5/6 */ 1475 if (SIG1 > 110) 1476 wait_t = (786432 + state->srate / 2) / state->srate; 1477 else 1478 wait_t = (1572864 + state->srate / 2) / state->srate; 1479 if (state->srate < 5000) 1480 /* FIXME ! , should be a long wait ! */ 1481 msleep_interruptible(wait_t); 1482 else 1483 msleep_interruptible(wait_t); 1484 1485 if (sync_chk(state, &junk) == 0) { 1486 iq_vt_set(state, 1); 1487 FEC_srst(state); 1488 } 1489 } 1490 /* 1/2, 2/3, 3/4, 7/8 */ 1491 if (SIG1 > 110) 1492 wait_t = (786432 + state->srate / 2) / state->srate; 1493 else 1494 wait_t = (1572864 + state->srate / 2) / state->srate; 1495 msleep_interruptible(wait_t); 1496 SEQ_set(state, 1); 1497 } else { 1498 dprintk(verbose, MB86A16_INFO, 1, "NO -- SYNC"); 1499 SEQ_set(state, 1); 1500 ret = -1; 1501 } 1502 } 1503 } else { 1504 dprintk(verbose, MB86A16_INFO, 1, "NO -- SIGNAL"); 1505 ret = -1; 1506 } 1507 1508 sync = sync_chk(state, &junk); 1509 if (sync) { 1510 dprintk(verbose, MB86A16_INFO, 1, "******* SYNC *******"); 1511 freqerr_chk(state, state->frequency, state->srate, 1); 1512 ret = 0; 1513 break; 1514 } 1515 } 1516 1517 mb86a16_read(state, 0x15, &agcval); 1518 mb86a16_read(state, 0x26, &cnmval); 1519 dprintk(verbose, MB86A16_INFO, 1, "AGC = %02x CNM = %02x", agcval, cnmval); 1520 1521 return ret; 1522} 1523 1524static int mb86a16_send_diseqc_msg(struct dvb_frontend *fe, 1525 struct dvb_diseqc_master_cmd *cmd) 1526{ 1527 struct mb86a16_state *state = fe->demodulator_priv; 1528 int i; 1529 u8 regs; 1530 1531 if (mb86a16_write(state, MB86A16_DCC1, MB86A16_DCC1_DISTA) < 0) 1532 goto err; 1533 if (mb86a16_write(state, MB86A16_DCCOUT, 0x00) < 0) 1534 goto err; 1535 if (mb86a16_write(state, MB86A16_TONEOUT2, 0x04) < 0) 1536 goto err; 1537 1538 regs = 0x18; 1539 1540 if (cmd->msg_len > 5 || cmd->msg_len < 4) 1541 return -EINVAL; 1542 1543 for (i = 0; i < cmd->msg_len; i++) { 1544 if (mb86a16_write(state, regs, cmd->msg[i]) < 0) 1545 goto err; 1546 1547 regs++; 1548 } 1549 i += 0x90; 1550 1551 msleep_interruptible(10); 1552 1553 if (mb86a16_write(state, MB86A16_DCC1, i) < 0) 1554 goto err; 1555 if (mb86a16_write(state, MB86A16_DCCOUT, MB86A16_DCCOUT_DISEN) < 0) 1556 goto err; 1557 1558 return 0; 1559 1560err: 1561 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 1562 return -EREMOTEIO; 1563} 1564 1565static int mb86a16_send_diseqc_burst(struct dvb_frontend *fe, fe_sec_mini_cmd_t burst) 1566{ 1567 struct mb86a16_state *state = fe->demodulator_priv; 1568 1569 switch (burst) { 1570 case SEC_MINI_A: 1571 if (mb86a16_write(state, MB86A16_DCC1, MB86A16_DCC1_DISTA | 1572 MB86A16_DCC1_TBEN | 1573 MB86A16_DCC1_TBO) < 0) 1574 goto err; 1575 if (mb86a16_write(state, MB86A16_DCCOUT, MB86A16_DCCOUT_DISEN) < 0) 1576 goto err; 1577 break; 1578 case SEC_MINI_B: 1579 if (mb86a16_write(state, MB86A16_DCC1, MB86A16_DCC1_DISTA | 1580 MB86A16_DCC1_TBEN) < 0) 1581 goto err; 1582 if (mb86a16_write(state, MB86A16_DCCOUT, MB86A16_DCCOUT_DISEN) < 0) 1583 goto err; 1584 break; 1585 } 1586 1587 return 0; 1588err: 1589 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 1590 return -EREMOTEIO; 1591} 1592 1593static int mb86a16_set_tone(struct dvb_frontend *fe, fe_sec_tone_mode_t tone) 1594{ 1595 struct mb86a16_state *state = fe->demodulator_priv; 1596 1597 switch (tone) { 1598 case SEC_TONE_ON: 1599 if (mb86a16_write(state, MB86A16_TONEOUT2, 0x00) < 0) 1600 goto err; 1601 if (mb86a16_write(state, MB86A16_DCC1, MB86A16_DCC1_DISTA | 1602 MB86A16_DCC1_CTOE) < 0) 1603 1604 goto err; 1605 if (mb86a16_write(state, MB86A16_DCCOUT, MB86A16_DCCOUT_DISEN) < 0) 1606 goto err; 1607 break; 1608 case SEC_TONE_OFF: 1609 if (mb86a16_write(state, MB86A16_TONEOUT2, 0x04) < 0) 1610 goto err; 1611 if (mb86a16_write(state, MB86A16_DCC1, MB86A16_DCC1_DISTA) < 0) 1612 goto err; 1613 if (mb86a16_write(state, MB86A16_DCCOUT, 0x00) < 0) 1614 goto err; 1615 break; 1616 default: 1617 return -EINVAL; 1618 } 1619 return 0; 1620 1621err: 1622 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 1623 return -EREMOTEIO; 1624} 1625 1626static enum dvbfe_search mb86a16_search(struct dvb_frontend *fe) 1627{ 1628 struct dtv_frontend_properties *p = &fe->dtv_property_cache; 1629 struct mb86a16_state *state = fe->demodulator_priv; 1630 1631 state->frequency = p->frequency / 1000; 1632 state->srate = p->symbol_rate / 1000; 1633 1634 if (!mb86a16_set_fe(state)) { 1635 dprintk(verbose, MB86A16_ERROR, 1, "Successfully acquired LOCK"); 1636 return DVBFE_ALGO_SEARCH_SUCCESS; 1637 } 1638 1639 dprintk(verbose, MB86A16_ERROR, 1, "Lock acquisition failed!"); 1640 return DVBFE_ALGO_SEARCH_FAILED; 1641} 1642 1643static void mb86a16_release(struct dvb_frontend *fe) 1644{ 1645 struct mb86a16_state *state = fe->demodulator_priv; 1646 kfree(state); 1647} 1648 1649static int mb86a16_init(struct dvb_frontend *fe) 1650{ 1651 return 0; 1652} 1653 1654static int mb86a16_sleep(struct dvb_frontend *fe) 1655{ 1656 return 0; 1657} 1658 1659static int mb86a16_read_ber(struct dvb_frontend *fe, u32 *ber) 1660{ 1661 u8 ber_mon, ber_tab, ber_lsb, ber_mid, ber_msb, ber_tim, ber_rst; 1662 u32 timer; 1663 1664 struct mb86a16_state *state = fe->demodulator_priv; 1665 1666 *ber = 0; 1667 if (mb86a16_read(state, MB86A16_BERMON, &ber_mon) != 2) 1668 goto err; 1669 if (mb86a16_read(state, MB86A16_BERTAB, &ber_tab) != 2) 1670 goto err; 1671 if (mb86a16_read(state, MB86A16_BERLSB, &ber_lsb) != 2) 1672 goto err; 1673 if (mb86a16_read(state, MB86A16_BERMID, &ber_mid) != 2) 1674 goto err; 1675 if (mb86a16_read(state, MB86A16_BERMSB, &ber_msb) != 2) 1676 goto err; 1677 /* BER monitor invalid when BER_EN = 0 */ 1678 if (ber_mon & 0x04) { 1679 /* coarse, fast calculation */ 1680 *ber = ber_tab & 0x1f; 1681 dprintk(verbose, MB86A16_DEBUG, 1, "BER coarse=[0x%02x]", *ber); 1682 if (ber_mon & 0x01) { 1683 /* 1684 * BER_SEL = 1, The monitored BER is the estimated 1685 * value with a Reed-Solomon decoder error amount at 1686 * the deinterleaver output. 1687 * monitored BER is expressed as a 20 bit output in total 1688 */ 1689 ber_rst = ber_mon >> 3; 1690 *ber = (((ber_msb << 8) | ber_mid) << 8) | ber_lsb; 1691 if (ber_rst == 0) 1692 timer = 12500000; 1693 if (ber_rst == 1) 1694 timer = 25000000; 1695 if (ber_rst == 2) 1696 timer = 50000000; 1697 if (ber_rst == 3) 1698 timer = 100000000; 1699 1700 *ber /= timer; 1701 dprintk(verbose, MB86A16_DEBUG, 1, "BER fine=[0x%02x]", *ber); 1702 } else { 1703 /* 1704 * BER_SEL = 0, The monitored BER is the estimated 1705 * value with a Viterbi decoder error amount at the 1706 * QPSK demodulator output. 1707 * monitored BER is expressed as a 24 bit output in total 1708 */ 1709 ber_tim = ber_mon >> 1; 1710 *ber = (((ber_msb << 8) | ber_mid) << 8) | ber_lsb; 1711 if (ber_tim == 0) 1712 timer = 16; 1713 if (ber_tim == 1) 1714 timer = 24; 1715 1716 *ber /= 2 ^ timer; 1717 dprintk(verbose, MB86A16_DEBUG, 1, "BER fine=[0x%02x]", *ber); 1718 } 1719 } 1720 return 0; 1721err: 1722 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 1723 return -EREMOTEIO; 1724} 1725 1726static int mb86a16_read_signal_strength(struct dvb_frontend *fe, u16 *strength) 1727{ 1728 u8 agcm = 0; 1729 struct mb86a16_state *state = fe->demodulator_priv; 1730 1731 *strength = 0; 1732 if (mb86a16_read(state, MB86A16_AGCM, &agcm) != 2) { 1733 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 1734 return -EREMOTEIO; 1735 } 1736 1737 *strength = ((0xff - agcm) * 100) / 256; 1738 dprintk(verbose, MB86A16_DEBUG, 1, "Signal strength=[%d %%]", (u8) *strength); 1739 *strength = (0xffff - 0xff) + agcm; 1740 1741 return 0; 1742} 1743 1744struct cnr { 1745 u8 cn_reg; 1746 u8 cn_val; 1747}; 1748 1749static const struct cnr cnr_tab[] = { 1750 { 35, 2 }, 1751 { 40, 3 }, 1752 { 50, 4 }, 1753 { 60, 5 }, 1754 { 70, 6 }, 1755 { 80, 7 }, 1756 { 92, 8 }, 1757 { 103, 9 }, 1758 { 115, 10 }, 1759 { 138, 12 }, 1760 { 162, 15 }, 1761 { 180, 18 }, 1762 { 185, 19 }, 1763 { 189, 20 }, 1764 { 195, 22 }, 1765 { 199, 24 }, 1766 { 201, 25 }, 1767 { 202, 26 }, 1768 { 203, 27 }, 1769 { 205, 28 }, 1770 { 208, 30 } 1771}; 1772 1773static int mb86a16_read_snr(struct dvb_frontend *fe, u16 *snr) 1774{ 1775 struct mb86a16_state *state = fe->demodulator_priv; 1776 int i = 0; 1777 int low_tide = 2, high_tide = 30, q_level; 1778 u8 cn; 1779 1780 *snr = 0; 1781 if (mb86a16_read(state, 0x26, &cn) != 2) { 1782 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 1783 return -EREMOTEIO; 1784 } 1785 1786 for (i = 0; i < ARRAY_SIZE(cnr_tab); i++) { 1787 if (cn < cnr_tab[i].cn_reg) { 1788 *snr = cnr_tab[i].cn_val; 1789 break; 1790 } 1791 } 1792 q_level = (*snr * 100) / (high_tide - low_tide); 1793 dprintk(verbose, MB86A16_ERROR, 1, "SNR (Quality) = [%d dB], Level=%d %%", *snr, q_level); 1794 *snr = (0xffff - 0xff) + *snr; 1795 1796 return 0; 1797} 1798 1799static int mb86a16_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks) 1800{ 1801 u8 dist; 1802 struct mb86a16_state *state = fe->demodulator_priv; 1803 1804 if (mb86a16_read(state, MB86A16_DISTMON, &dist) != 2) { 1805 dprintk(verbose, MB86A16_ERROR, 1, "I2C transfer error"); 1806 return -EREMOTEIO; 1807 } 1808 *ucblocks = dist; 1809 1810 return 0; 1811} 1812 1813static enum dvbfe_algo mb86a16_frontend_algo(struct dvb_frontend *fe) 1814{ 1815 return DVBFE_ALGO_CUSTOM; 1816} 1817 1818static struct dvb_frontend_ops mb86a16_ops = { 1819 .delsys = { SYS_DVBS }, 1820 .info = { 1821 .name = "Fujitsu MB86A16 DVB-S", 1822 .frequency_min = 950000, 1823 .frequency_max = 2150000, 1824 .frequency_stepsize = 3000, 1825 .frequency_tolerance = 0, 1826 .symbol_rate_min = 1000000, 1827 .symbol_rate_max = 45000000, 1828 .symbol_rate_tolerance = 500, 1829 .caps = FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | 1830 FE_CAN_FEC_3_4 | FE_CAN_FEC_5_6 | 1831 FE_CAN_FEC_7_8 | FE_CAN_QPSK | 1832 FE_CAN_FEC_AUTO 1833 }, 1834 .release = mb86a16_release, 1835 1836 .get_frontend_algo = mb86a16_frontend_algo, 1837 .search = mb86a16_search, 1838 .init = mb86a16_init, 1839 .sleep = mb86a16_sleep, 1840 .read_status = mb86a16_read_status, 1841 1842 .read_ber = mb86a16_read_ber, 1843 .read_signal_strength = mb86a16_read_signal_strength, 1844 .read_snr = mb86a16_read_snr, 1845 .read_ucblocks = mb86a16_read_ucblocks, 1846 1847 .diseqc_send_master_cmd = mb86a16_send_diseqc_msg, 1848 .diseqc_send_burst = mb86a16_send_diseqc_burst, 1849 .set_tone = mb86a16_set_tone, 1850}; 1851 1852struct dvb_frontend *mb86a16_attach(const struct mb86a16_config *config, 1853 struct i2c_adapter *i2c_adap) 1854{ 1855 u8 dev_id = 0; 1856 struct mb86a16_state *state = NULL; 1857 1858 state = kmalloc(sizeof(struct mb86a16_state), GFP_KERNEL); 1859 if (state == NULL) 1860 goto error; 1861 1862 state->config = config; 1863 state->i2c_adap = i2c_adap; 1864 1865 mb86a16_read(state, 0x7f, &dev_id); 1866 if (dev_id != 0xfe) 1867 goto error; 1868 1869 memcpy(&state->frontend.ops, &mb86a16_ops, sizeof(struct dvb_frontend_ops)); 1870 state->frontend.demodulator_priv = state; 1871 state->frontend.ops.set_voltage = state->config->set_voltage; 1872 1873 return &state->frontend; 1874error: 1875 kfree(state); 1876 return NULL; 1877} 1878EXPORT_SYMBOL(mb86a16_attach); 1879MODULE_LICENSE("GPL"); 1880MODULE_AUTHOR("Manu Abraham"); 1881