kernel/drivers/media/tuners/tda18271-common.c

   1 /*
   2     tda18271-common.c - driver for the Philips / NXP TDA18271 silicon tuner
   3
   4     Copyright (C) 2007, 2008 Michael Krufky <mkrufky@linuxtv.org>
   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 "tda18271-priv.h"
  22
  23 static int tda18271_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
  24 {
  25         struct tda18271_priv *priv = fe->tuner_priv;
  26         enum tda18271_i2c_gate gate;
  27         int ret = 0;
  28
  29         switch (priv->gate) {
  30         case TDA18271_GATE_DIGITAL:
  31         case TDA18271_GATE_ANALOG:
  32                 gate = priv->gate;
  33                 break;
  34         case TDA18271_GATE_AUTO:
  35         default:
  36                 switch (priv->mode) {
  37                 case TDA18271_DIGITAL:
  38                         gate = TDA18271_GATE_DIGITAL;
  39                         break;
  40                 case TDA18271_ANALOG:
  41                 default:
  42                         gate = TDA18271_GATE_ANALOG;
  43                         break;
  44                 }
  45         }
  46
  47         switch (gate) {
  48         case TDA18271_GATE_ANALOG:
  49                 if (fe->ops.analog_ops.i2c_gate_ctrl)
  50                         ret = fe->ops.analog_ops.i2c_gate_ctrl(fe, enable);
  51                 break;
  52         case TDA18271_GATE_DIGITAL:
  53                 if (fe->ops.i2c_gate_ctrl)
  54                         ret = fe->ops.i2c_gate_ctrl(fe, enable);
  55                 break;
  56         default:
  57                 ret = -EINVAL;
  58                 break;
  59         }
  60
  61         return ret;
  62 };
  63
  64 /*---------------------------------------------------------------------*/
  65
  66 static void tda18271_dump_regs(struct dvb_frontend *fe, int extended)
  67 {
  68         struct tda18271_priv *priv = fe->tuner_priv;
  69         unsigned char *regs = priv->tda18271_regs;
  70
  71         tda_reg("=== TDA18271 REG DUMP ===\n");
  72         tda_reg("ID_BYTE            = 0x%02x\n", 0xff & regs[R_ID]);
  73         tda_reg("THERMO_BYTE        = 0x%02x\n", 0xff & regs[R_TM]);
  74         tda_reg("POWER_LEVEL_BYTE   = 0x%02x\n", 0xff & regs[R_PL]);
  75         tda_reg("EASY_PROG_BYTE_1   = 0x%02x\n", 0xff & regs[R_EP1]);
  76         tda_reg("EASY_PROG_BYTE_2   = 0x%02x\n", 0xff & regs[R_EP2]);
  77         tda_reg("EASY_PROG_BYTE_3   = 0x%02x\n", 0xff & regs[R_EP3]);
  78         tda_reg("EASY_PROG_BYTE_4   = 0x%02x\n", 0xff & regs[R_EP4]);
  79         tda_reg("EASY_PROG_BYTE_5   = 0x%02x\n", 0xff & regs[R_EP5]);
  80         tda_reg("CAL_POST_DIV_BYTE  = 0x%02x\n", 0xff & regs[R_CPD]);
  81         tda_reg("CAL_DIV_BYTE_1     = 0x%02x\n", 0xff & regs[R_CD1]);
  82         tda_reg("CAL_DIV_BYTE_2     = 0x%02x\n", 0xff & regs[R_CD2]);
  83         tda_reg("CAL_DIV_BYTE_3     = 0x%02x\n", 0xff & regs[R_CD3]);
  84         tda_reg("MAIN_POST_DIV_BYTE = 0x%02x\n", 0xff & regs[R_MPD]);
  85         tda_reg("MAIN_DIV_BYTE_1    = 0x%02x\n", 0xff & regs[R_MD1]);
  86         tda_reg("MAIN_DIV_BYTE_2    = 0x%02x\n", 0xff & regs[R_MD2]);
  87         tda_reg("MAIN_DIV_BYTE_3    = 0x%02x\n", 0xff & regs[R_MD3]);
  88
  89         /* only dump extended regs if DBG_ADV is set */
  90         if (!(tda18271_debug & DBG_ADV))
  91                 return;
  92
  93         /* W indicates write-only registers.
  94          * Register dump for write-only registers shows last value written. */
  95
  96         tda_reg("EXTENDED_BYTE_1    = 0x%02x\n", 0xff & regs[R_EB1]);
  97         tda_reg("EXTENDED_BYTE_2    = 0x%02x\n", 0xff & regs[R_EB2]);
  98         tda_reg("EXTENDED_BYTE_3    = 0x%02x\n", 0xff & regs[R_EB3]);
  99         tda_reg("EXTENDED_BYTE_4    = 0x%02x\n", 0xff & regs[R_EB4]);
 100         tda_reg("EXTENDED_BYTE_5    = 0x%02x\n", 0xff & regs[R_EB5]);
 101         tda_reg("EXTENDED_BYTE_6    = 0x%02x\n", 0xff & regs[R_EB6]);
 102         tda_reg("EXTENDED_BYTE_7    = 0x%02x\n", 0xff & regs[R_EB7]);
 103         tda_reg("EXTENDED_BYTE_8    = 0x%02x\n", 0xff & regs[R_EB8]);
 104         tda_reg("EXTENDED_BYTE_9  W = 0x%02x\n", 0xff & regs[R_EB9]);
 105         tda_reg("EXTENDED_BYTE_10   = 0x%02x\n", 0xff & regs[R_EB10]);
 106         tda_reg("EXTENDED_BYTE_11   = 0x%02x\n", 0xff & regs[R_EB11]);
 107         tda_reg("EXTENDED_BYTE_12   = 0x%02x\n", 0xff & regs[R_EB12]);
 108         tda_reg("EXTENDED_BYTE_13   = 0x%02x\n", 0xff & regs[R_EB13]);
 109         tda_reg("EXTENDED_BYTE_14   = 0x%02x\n", 0xff & regs[R_EB14]);
 110         tda_reg("EXTENDED_BYTE_15   = 0x%02x\n", 0xff & regs[R_EB15]);
 111         tda_reg("EXTENDED_BYTE_16 W = 0x%02x\n", 0xff & regs[R_EB16]);
 112         tda_reg("EXTENDED_BYTE_17 W = 0x%02x\n", 0xff & regs[R_EB17]);
 113         tda_reg("EXTENDED_BYTE_18   = 0x%02x\n", 0xff & regs[R_EB18]);
 114         tda_reg("EXTENDED_BYTE_19 W = 0x%02x\n", 0xff & regs[R_EB19]);
 115         tda_reg("EXTENDED_BYTE_20 W = 0x%02x\n", 0xff & regs[R_EB20]);
 116         tda_reg("EXTENDED_BYTE_21   = 0x%02x\n", 0xff & regs[R_EB21]);
 117         tda_reg("EXTENDED_BYTE_22   = 0x%02x\n", 0xff & regs[R_EB22]);
 118         tda_reg("EXTENDED_BYTE_23   = 0x%02x\n", 0xff & regs[R_EB23]);
 119 }
 120
 121 int tda18271_read_regs(struct dvb_frontend *fe)
 122 {
 123         struct tda18271_priv *priv = fe->tuner_priv;
 124         unsigned char *regs = priv->tda18271_regs;
 125         unsigned char buf = 0x00;
 126         int ret;
 127         struct i2c_msg msg[] = {
 128                 { .addr = priv->i2c_props.addr, .flags = 0,
 129                   .buf = &buf, .len = 1 },
 130                 { .addr = priv->i2c_props.addr, .flags = I2C_M_RD,
 131                   .buf = regs, .len = 16 }
 132         };
 133
 134         tda18271_i2c_gate_ctrl(fe, 1);
 135
 136         /* read all registers */
 137         ret = i2c_transfer(priv->i2c_props.adap, msg, 2);
 138
 139         tda18271_i2c_gate_ctrl(fe, 0);
 140
 141         if (ret != 2)
 142                 tda_err("ERROR: i2c_transfer returned: %d\n", ret);
 143
 144         if (tda18271_debug & DBG_REG)
 145                 tda18271_dump_regs(fe, 0);
 146
 147         return (ret == 2 ? 0 : ret);
 148 }
 149
 150 int tda18271_read_extended(struct dvb_frontend *fe)
 151 {
 152         struct tda18271_priv *priv = fe->tuner_priv;
 153         unsigned char *regs = priv->tda18271_regs;
 154         unsigned char regdump[TDA18271_NUM_REGS];
 155         unsigned char buf = 0x00;
 156         int ret, i;
 157         struct i2c_msg msg[] = {
 158                 { .addr = priv->i2c_props.addr, .flags = 0,
 159                   .buf = &buf, .len = 1 },
 160                 { .addr = priv->i2c_props.addr, .flags = I2C_M_RD,
 161                   .buf = regdump, .len = TDA18271_NUM_REGS }
 162         };
 163
 164         tda18271_i2c_gate_ctrl(fe, 1);
 165
 166         /* read all registers */
 167         ret = i2c_transfer(priv->i2c_props.adap, msg, 2);
 168
 169         tda18271_i2c_gate_ctrl(fe, 0);
 170
 171         if (ret != 2)
 172                 tda_err("ERROR: i2c_transfer returned: %d\n", ret);
 173
 174         for (i = 0; i < TDA18271_NUM_REGS; i++) {
 175                 /* don't update write-only registers */
 176                 if ((i != R_EB9)  &&
 177                     (i != R_EB16) &&
 178                     (i != R_EB17) &&
 179                     (i != R_EB19) &&
 180                     (i != R_EB20))
 181                         regs[i] = regdump[i];
 182         }
 183
 184         if (tda18271_debug & DBG_REG)
 185                 tda18271_dump_regs(fe, 1);
 186
 187         return (ret == 2 ? 0 : ret);
 188 }
 189
 190 static int __tda18271_write_regs(struct dvb_frontend *fe, int idx, int len,
 191                         bool lock_i2c)
 192 {
 193         struct tda18271_priv *priv = fe->tuner_priv;
 194         unsigned char *regs = priv->tda18271_regs;
 195         unsigned char buf[TDA18271_NUM_REGS + 1];
 196         struct i2c_msg msg = { .addr = priv->i2c_props.addr, .flags = 0,
 197                                .buf = buf };
 198         int i, ret = 1, max;
 199
 200         BUG_ON((len == 0) || (idx + len > sizeof(buf)));
 201
 202         switch (priv->small_i2c) {
 203         case TDA18271_03_BYTE_CHUNK_INIT:
 204                 max = 3;
 205                 break;
 206         case TDA18271_08_BYTE_CHUNK_INIT:
 207                 max = 8;
 208                 break;
 209         case TDA18271_16_BYTE_CHUNK_INIT:
 210                 max = 16;
 211                 break;
 212         case TDA18271_39_BYTE_CHUNK_INIT:
 213         default:
 214                 max = 39;
 215         }
 216
 217
 218         /*
 219          * If lock_i2c is true, it will take the I2C bus for tda18271 private
 220          * usage during the entire write ops, as otherwise, bad things could
 221          * happen.
 222          * During device init, several write operations will happen. So,
 223          * tda18271_init_regs controls the I2C lock directly,
 224          * disabling lock_i2c here.
 225          */
 226         if (lock_i2c) {
 227                 tda18271_i2c_gate_ctrl(fe, 1);
 228                 i2c_lock_adapter(priv->i2c_props.adap);
 229         }
 230         while (len) {
 231                 if (max > len)
 232                         max = len;
 233
 234                 buf[0] = idx;
 235                 for (i = 1; i <= max; i++)
 236                         buf[i] = regs[idx - 1 + i];
 237
 238                 msg.len = max + 1;
 239
 240                 /* write registers */
 241                 ret = __i2c_transfer(priv->i2c_props.adap, &msg, 1);
 242                 if (ret != 1)
 243                         break;
 244
 245                 idx += max;
 246                 len -= max;
 247         }
 248         if (lock_i2c) {
 249                 i2c_unlock_adapter(priv->i2c_props.adap);
 250                 tda18271_i2c_gate_ctrl(fe, 0);
 251         }
 252
 253         if (ret != 1)
 254                 tda_err("ERROR: idx = 0x%x, len = %d, "
 255                         "i2c_transfer returned: %d\n", idx, max, ret);
 256
 257         return (ret == 1 ? 0 : ret);
 258 }
 259
 260 int tda18271_write_regs(struct dvb_frontend *fe, int idx, int len)
 261 {
 262         return __tda18271_write_regs(fe, idx, len, true);
 263 }
 264
 265 /*---------------------------------------------------------------------*/
 266
 267 static int __tda18271_charge_pump_source(struct dvb_frontend *fe,
 268                                          enum tda18271_pll pll, int force,
 269                                          bool lock_i2c)
 270 {
 271         struct tda18271_priv *priv = fe->tuner_priv;
 272         unsigned char *regs = priv->tda18271_regs;
 273
 274         int r_cp = (pll == TDA18271_CAL_PLL) ? R_EB7 : R_EB4;
 275
 276         regs[r_cp] &= ~0x20;
 277         regs[r_cp] |= ((force & 1) << 5);
 278
 279         return __tda18271_write_regs(fe, r_cp, 1, lock_i2c);
 280 }
 281
 282 int tda18271_charge_pump_source(struct dvb_frontend *fe,
 283                                 enum tda18271_pll pll, int force)
 284 {
 285         return __tda18271_charge_pump_source(fe, pll, force, true);
 286 }
 287
 288
 289 int tda18271_init_regs(struct dvb_frontend *fe)
 290 {
 291         struct tda18271_priv *priv = fe->tuner_priv;
 292         unsigned char *regs = priv->tda18271_regs;
 293
 294         tda_dbg("initializing registers for device @ %d-%04x\n",
 295                 i2c_adapter_id(priv->i2c_props.adap),
 296                 priv->i2c_props.addr);
 297
 298         /*
 299          * Don't let any other I2C transfer to happen at adapter during init,
 300          * as those could cause bad things
 301          */
 302         tda18271_i2c_gate_ctrl(fe, 1);
 303         i2c_lock_adapter(priv->i2c_props.adap);
 304
 305         /* initialize registers */
 306         switch (priv->id) {
 307         case TDA18271HDC1:
 308                 regs[R_ID]   = 0x83;
 309                 break;
 310         case TDA18271HDC2:
 311                 regs[R_ID]   = 0x84;
 312                 break;
 313         }
 314
 315         regs[R_TM]   = 0x08;
 316         regs[R_PL]   = 0x80;
 317         regs[R_EP1]  = 0xc6;
 318         regs[R_EP2]  = 0xdf;
 319         regs[R_EP3]  = 0x16;
 320         regs[R_EP4]  = 0x60;
 321         regs[R_EP5]  = 0x80;
 322         regs[R_CPD]  = 0x80;
 323         regs[R_CD1]  = 0x00;
 324         regs[R_CD2]  = 0x00;
 325         regs[R_CD3]  = 0x00;
 326         regs[R_MPD]  = 0x00;
 327         regs[R_MD1]  = 0x00;
 328         regs[R_MD2]  = 0x00;
 329         regs[R_MD3]  = 0x00;
 330
 331         switch (priv->id) {
 332         case TDA18271HDC1:
 333                 regs[R_EB1]  = 0xff;
 334                 break;
 335         case TDA18271HDC2:
 336                 regs[R_EB1]  = 0xfc;
 337                 break;
 338         }
 339
 340         regs[R_EB2]  = 0x01;
 341         regs[R_EB3]  = 0x84;
 342         regs[R_EB4]  = 0x41;
 343         regs[R_EB5]  = 0x01;
 344         regs[R_EB6]  = 0x84;
 345         regs[R_EB7]  = 0x40;
 346         regs[R_EB8]  = 0x07;
 347         regs[R_EB9]  = 0x00;
 348         regs[R_EB10] = 0x00;
 349         regs[R_EB11] = 0x96;
 350
 351         switch (priv->id) {
 352         case TDA18271HDC1:
 353                 regs[R_EB12] = 0x0f;
 354                 break;
 355         case TDA18271HDC2:
 356                 regs[R_EB12] = 0x33;
 357                 break;
 358         }
 359
 360         regs[R_EB13] = 0xc1;
 361         regs[R_EB14] = 0x00;
 362         regs[R_EB15] = 0x8f;
 363         regs[R_EB16] = 0x00;
 364         regs[R_EB17] = 0x00;
 365
 366         switch (priv->id) {
 367         case TDA18271HDC1:
 368                 regs[R_EB18] = 0x00;
 369                 break;
 370         case TDA18271HDC2:
 371                 regs[R_EB18] = 0x8c;
 372                 break;
 373         }
 374
 375         regs[R_EB19] = 0x00;
 376         regs[R_EB20] = 0x20;
 377
 378         switch (priv->id) {
 379         case TDA18271HDC1:
 380                 regs[R_EB21] = 0x33;
 381                 break;
 382         case TDA18271HDC2:
 383                 regs[R_EB21] = 0xb3;
 384                 break;
 385         }
 386
 387         regs[R_EB22] = 0x48;
 388         regs[R_EB23] = 0xb0;
 389
 390         __tda18271_write_regs(fe, 0x00, TDA18271_NUM_REGS, false);
 391
 392         /* setup agc1 gain */
 393         regs[R_EB17] = 0x00;
 394         __tda18271_write_regs(fe, R_EB17, 1, false);
 395         regs[R_EB17] = 0x03;
 396         __tda18271_write_regs(fe, R_EB17, 1, false);
 397         regs[R_EB17] = 0x43;
 398         __tda18271_write_regs(fe, R_EB17, 1, false);
 399         regs[R_EB17] = 0x4c;
 400         __tda18271_write_regs(fe, R_EB17, 1, false);
 401
 402         /* setup agc2 gain */
 403         if ((priv->id) == TDA18271HDC1) {
 404                 regs[R_EB20] = 0xa0;
 405                 __tda18271_write_regs(fe, R_EB20, 1, false);
 406                 regs[R_EB20] = 0xa7;
 407                 __tda18271_write_regs(fe, R_EB20, 1, false);
 408                 regs[R_EB20] = 0xe7;
 409                 __tda18271_write_regs(fe, R_EB20, 1, false);
 410                 regs[R_EB20] = 0xec;
 411                 __tda18271_write_regs(fe, R_EB20, 1, false);
 412         }
 413
 414         /* image rejection calibration */
 415
 416         /* low-band */
 417         regs[R_EP3] = 0x1f;
 418         regs[R_EP4] = 0x66;
 419         regs[R_EP5] = 0x81;
 420         regs[R_CPD] = 0xcc;
 421         regs[R_CD1] = 0x6c;
 422         regs[R_CD2] = 0x00;
 423         regs[R_CD3] = 0x00;
 424         regs[R_MPD] = 0xcd;
 425         regs[R_MD1] = 0x77;
 426         regs[R_MD2] = 0x08;
 427         regs[R_MD3] = 0x00;
 428
 429         __tda18271_write_regs(fe, R_EP3, 11, false);
 430
 431         if ((priv->id) == TDA18271HDC2) {
 432                 /* main pll cp source on */
 433                 __tda18271_charge_pump_source(fe, TDA18271_MAIN_PLL, 1, false);
 434                 msleep(1);
 435
 436                 /* main pll cp source off */
 437                 __tda18271_charge_pump_source(fe, TDA18271_MAIN_PLL, 0, false);
 438         }
 439
 440         msleep(5); /* pll locking */
 441
 442         /* launch detector */
 443         __tda18271_write_regs(fe, R_EP1, 1, false);
 444         msleep(5); /* wanted low measurement */
 445
 446         regs[R_EP5] = 0x85;
 447         regs[R_CPD] = 0xcb;
 448         regs[R_CD1] = 0x66;
 449         regs[R_CD2] = 0x70;
 450
 451         __tda18271_write_regs(fe, R_EP3, 7, false);
 452         msleep(5); /* pll locking */
 453
 454         /* launch optimization algorithm */
 455         __tda18271_write_regs(fe, R_EP2, 1, false);
 456         msleep(30); /* image low optimization completion */
 457
 458         /* mid-band */
 459         regs[R_EP5] = 0x82;
 460         regs[R_CPD] = 0xa8;
 461         regs[R_CD2] = 0x00;
 462         regs[R_MPD] = 0xa9;
 463         regs[R_MD1] = 0x73;
 464         regs[R_MD2] = 0x1a;
 465
 466         __tda18271_write_regs(fe, R_EP3, 11, false);
 467         msleep(5); /* pll locking */
 468
 469         /* launch detector */
 470         __tda18271_write_regs(fe, R_EP1, 1, false);
 471         msleep(5); /* wanted mid measurement */
 472
 473         regs[R_EP5] = 0x86;
 474         regs[R_CPD] = 0xa8;
 475         regs[R_CD1] = 0x66;
 476         regs[R_CD2] = 0xa0;
 477
 478         __tda18271_write_regs(fe, R_EP3, 7, false);
 479         msleep(5); /* pll locking */
 480
 481         /* launch optimization algorithm */
 482         __tda18271_write_regs(fe, R_EP2, 1, false);
 483         msleep(30); /* image mid optimization completion */
 484
 485         /* high-band */
 486         regs[R_EP5] = 0x83;
 487         regs[R_CPD] = 0x98;
 488         regs[R_CD1] = 0x65;
 489         regs[R_CD2] = 0x00;
 490         regs[R_MPD] = 0x99;
 491         regs[R_MD1] = 0x71;
 492         regs[R_MD2] = 0xcd;
 493
 494         __tda18271_write_regs(fe, R_EP3, 11, false);
 495         msleep(5); /* pll locking */
 496
 497         /* launch detector */
 498         __tda18271_write_regs(fe, R_EP1, 1, false);
 499         msleep(5); /* wanted high measurement */
 500
 501         regs[R_EP5] = 0x87;
 502         regs[R_CD1] = 0x65;
 503         regs[R_CD2] = 0x50;
 504
 505         __tda18271_write_regs(fe, R_EP3, 7, false);
 506         msleep(5); /* pll locking */
 507
 508         /* launch optimization algorithm */
 509         __tda18271_write_regs(fe, R_EP2, 1, false);
 510         msleep(30); /* image high optimization completion */
 511
 512         /* return to normal mode */
 513         regs[R_EP4] = 0x64;
 514         __tda18271_write_regs(fe, R_EP4, 1, false);
 515
 516         /* synchronize */
 517         __tda18271_write_regs(fe, R_EP1, 1, false);
 518
 519         i2c_unlock_adapter(priv->i2c_props.adap);
 520         tda18271_i2c_gate_ctrl(fe, 0);
 521
 522         return 0;
 523 }
 524
 525 /*---------------------------------------------------------------------*/
 526
 527 /*
 528  *  Standby modes, EP3 [7:5]
 529  *
 530  *  | SM  || SM_LT || SM_XT || mode description
 531  *  |=====\\=======\\=======\\===================================
 532  *  |  0  ||   0   ||   0   || normal mode
 533  *  |-----||-------||-------||-----------------------------------
 534  *  |     ||       ||       || standby mode w/ slave tuner output
 535  *  |  1  ||   0   ||   0   || & loop thru & xtal oscillator on
 536  *  |-----||-------||-------||-----------------------------------
 537  *  |  1  ||   1   ||   0   || standby mode w/ xtal oscillator on
 538  *  |-----||-------||-------||-----------------------------------
 539  *  |  1  ||   1   ||   1   || power off
 540  *
 541  */
 542
 543 int tda18271_set_standby_mode(struct dvb_frontend *fe,
 544                               int sm, int sm_lt, int sm_xt)
 545 {
 546         struct tda18271_priv *priv = fe->tuner_priv;
 547         unsigned char *regs = priv->tda18271_regs;
 548
 549         if (tda18271_debug & DBG_ADV)
 550                 tda_dbg("sm = %d, sm_lt = %d, sm_xt = %d\n", sm, sm_lt, sm_xt);
 551
 552         regs[R_EP3]  &= ~0xe0; /* clear sm, sm_lt, sm_xt */
 553         regs[R_EP3]  |= (sm    ? (1 << 7) : 0) |
 554                         (sm_lt ? (1 << 6) : 0) |
 555                         (sm_xt ? (1 << 5) : 0);
 556
 557         return tda18271_write_regs(fe, R_EP3, 1);
 558 }
 559
 560 /*---------------------------------------------------------------------*/
 561
 562 int tda18271_calc_main_pll(struct dvb_frontend *fe, u32 freq)
 563 {
 564         /* sets main post divider & divider bytes, but does not write them */
 565         struct tda18271_priv *priv = fe->tuner_priv;
 566         unsigned char *regs = priv->tda18271_regs;
 567         u8 d, pd;
 568         u32 div;
 569
 570         int ret = tda18271_lookup_pll_map(fe, MAIN_PLL, &freq, &pd, &d);
 571         if (tda_fail(ret))
 572                 goto fail;
 573
 574         regs[R_MPD]   = (0x7f & pd);
 575
 576         div =  ((d * (freq / 1000)) << 7) / 125;
 577
 578         regs[R_MD1]   = 0x7f & (div >> 16);
 579         regs[R_MD2]   = 0xff & (div >> 8);
 580         regs[R_MD3]   = 0xff & div;
 581 fail:
 582         return ret;
 583 }
 584
 585 int tda18271_calc_cal_pll(struct dvb_frontend *fe, u32 freq)
 586 {
 587         /* sets cal post divider & divider bytes, but does not write them */
 588         struct tda18271_priv *priv = fe->tuner_priv;
 589         unsigned char *regs = priv->tda18271_regs;
 590         u8 d, pd;
 591         u32 div;
 592
 593         int ret = tda18271_lookup_pll_map(fe, CAL_PLL, &freq, &pd, &d);
 594         if (tda_fail(ret))
 595                 goto fail;
 596
 597         regs[R_CPD]   = pd;
 598
 599         div =  ((d * (freq / 1000)) << 7) / 125;
 600
 601         regs[R_CD1]   = 0x7f & (div >> 16);
 602         regs[R_CD2]   = 0xff & (div >> 8);
 603         regs[R_CD3]   = 0xff & div;
 604 fail:
 605         return ret;
 606 }
 607
 608 /*---------------------------------------------------------------------*/
 609
 610 int tda18271_calc_bp_filter(struct dvb_frontend *fe, u32 *freq)
 611 {
 612         /* sets bp filter bits, but does not write them */
 613         struct tda18271_priv *priv = fe->tuner_priv;
 614         unsigned char *regs = priv->tda18271_regs;
 615         u8 val;
 616
 617         int ret = tda18271_lookup_map(fe, BP_FILTER, freq, &val);
 618         if (tda_fail(ret))
 619                 goto fail;
 620
 621         regs[R_EP1]  &= ~0x07; /* clear bp filter bits */
 622         regs[R_EP1]  |= (0x07 & val);
 623 fail:
 624         return ret;
 625 }
 626
 627 int tda18271_calc_km(struct dvb_frontend *fe, u32 *freq)
 628 {
 629         /* sets K & M bits, but does not write them */
 630         struct tda18271_priv *priv = fe->tuner_priv;
 631         unsigned char *regs = priv->tda18271_regs;
 632         u8 val;
 633
 634         int ret = tda18271_lookup_map(fe, RF_CAL_KMCO, freq, &val);
 635         if (tda_fail(ret))
 636                 goto fail;
 637
 638         regs[R_EB13] &= ~0x7c; /* clear k & m bits */
 639         regs[R_EB13] |= (0x7c & val);
 640 fail:
 641         return ret;
 642 }
 643
 644 int tda18271_calc_rf_band(struct dvb_frontend *fe, u32 *freq)
 645 {
 646         /* sets rf band bits, but does not write them */
 647         struct tda18271_priv *priv = fe->tuner_priv;
 648         unsigned char *regs = priv->tda18271_regs;
 649         u8 val;
 650
 651         int ret = tda18271_lookup_map(fe, RF_BAND, freq, &val);
 652         if (tda_fail(ret))
 653                 goto fail;
 654
 655         regs[R_EP2]  &= ~0xe0; /* clear rf band bits */
 656         regs[R_EP2]  |= (0xe0 & (val << 5));
 657 fail:
 658         return ret;
 659 }
 660
 661 int tda18271_calc_gain_taper(struct dvb_frontend *fe, u32 *freq)
 662 {
 663         /* sets gain taper bits, but does not write them */
 664         struct tda18271_priv *priv = fe->tuner_priv;
 665         unsigned char *regs = priv->tda18271_regs;
 666         u8 val;
 667
 668         int ret = tda18271_lookup_map(fe, GAIN_TAPER, freq, &val);
 669         if (tda_fail(ret))
 670                 goto fail;
 671
 672         regs[R_EP2]  &= ~0x1f; /* clear gain taper bits */
 673         regs[R_EP2]  |= (0x1f & val);
 674 fail:
 675         return ret;
 676 }
 677
 678 int tda18271_calc_ir_measure(struct dvb_frontend *fe, u32 *freq)
 679 {
 680         /* sets IR Meas bits, but does not write them */
 681         struct tda18271_priv *priv = fe->tuner_priv;
 682         unsigned char *regs = priv->tda18271_regs;
 683         u8 val;
 684
 685         int ret = tda18271_lookup_map(fe, IR_MEASURE, freq, &val);
 686         if (tda_fail(ret))
 687                 goto fail;
 688
 689         regs[R_EP5] &= ~0x07;
 690         regs[R_EP5] |= (0x07 & val);
 691 fail:
 692         return ret;
 693 }
 694
 695 int tda18271_calc_rf_cal(struct dvb_frontend *fe, u32 *freq)
 696 {
 697         /* sets rf cal byte (RFC_Cprog), but does not write it */
 698         struct tda18271_priv *priv = fe->tuner_priv;
 699         unsigned char *regs = priv->tda18271_regs;
 700         u8 val;
 701
 702         int ret = tda18271_lookup_map(fe, RF_CAL, freq, &val);
 703         /* The TDA18271HD/C1 rf_cal map lookup is expected to go out of range
 704          * for frequencies above 61.1 MHz.  In these cases, the internal RF
 705          * tracking filters calibration mechanism is used.
 706          *
 707          * There is no need to warn the user about this.
 708          */
 709         if (ret < 0)
 710                 goto fail;
 711
 712         regs[R_EB14] = val;
 713 fail:
 714         return ret;
 715 }
 716
 717 void _tda_printk(struct tda18271_priv *state, const char *level,
 718                  const char *func, const char *fmt, ...)
 719 {
 720         struct va_format vaf;
 721         va_list args;
 722
 723         va_start(args, fmt);
 724
 725         vaf.fmt = fmt;
 726         vaf.va = &args;
 727
 728         if (state)
 729                 printk("%s%s: [%d-%04x|%c] %pV",
 730                        level, func, i2c_adapter_id(state->i2c_props.adap),
 731                        state->i2c_props.addr,
 732                        (state->role == TDA18271_MASTER) ? 'M' : 'S',
 733                        &vaf);
 734         else
 735                 printk("%s%s: %pV", level, func, &vaf);
 736
 737         va_end(args);
 738 }