err.no Git - linux-2.6/blob - drivers/media/video/tda9887.c

   1 #include <linux/module.h>
   2 #include <linux/kernel.h>
   3 #include <linux/i2c.h>
   4 #include <linux/types.h>
   5 #include <linux/init.h>
   6 #include <linux/errno.h>
   7 #include <linux/slab.h>
   8 #include <linux/delay.h>
   9 #include <linux/videodev.h>
  10 #include <media/v4l2-common.h>
  11 #include <media/tuner.h>
  12 #include "tuner-driver.h"
  13
  14
  15 /* Chips:
  16    TDA9885 (PAL, NTSC)
  17    TDA9886 (PAL, SECAM, NTSC)
  18    TDA9887 (PAL, SECAM, NTSC, FM Radio)
  19
  20    Used as part of several tuners
  21 */
  22
  23 #define tda9887_info(fmt, arg...) do {\
  24         printk(KERN_INFO "%s %d-%04x: " fmt, priv->t->i2c.name, \
  25                         i2c_adapter_id(priv->t->i2c.adapter), priv->t->i2c.addr , ##arg); } while (0)
  26 #define tda9887_dbg(fmt, arg...) do {\
  27         if (tuner_debug) \
  28                 printk(KERN_INFO "%s %d-%04x: " fmt, priv->t->i2c.name, \
  29                         i2c_adapter_id(priv->t->i2c.adapter), priv->t->i2c.addr , ##arg); } while (0)
  30
  31 struct tda9887_priv {
  32         struct tuner_i2c_props i2c_props;
  33
  34         unsigned char      data[4];
  35
  36         struct tuner *t;
  37 };
  38
  39 /* ---------------------------------------------------------------------- */
  40
  41 #define UNSET       (-1U)
  42
  43 struct tvnorm {
  44         v4l2_std_id       std;
  45         char              *name;
  46         unsigned char     b;
  47         unsigned char     c;
  48         unsigned char     e;
  49 };
  50
  51 /* ---------------------------------------------------------------------- */
  52
  53 //
  54 // TDA defines
  55 //
  56
  57 //// first reg (b)
  58 #define cVideoTrapBypassOFF     0x00    // bit b0
  59 #define cVideoTrapBypassON      0x01    // bit b0
  60
  61 #define cAutoMuteFmInactive     0x00    // bit b1
  62 #define cAutoMuteFmActive       0x02    // bit b1
  63
  64 #define cIntercarrier           0x00    // bit b2
  65 #define cQSS                    0x04    // bit b2
  66
  67 #define cPositiveAmTV           0x00    // bit b3:4
  68 #define cFmRadio                0x08    // bit b3:4
  69 #define cNegativeFmTV           0x10    // bit b3:4
  70
  71
  72 #define cForcedMuteAudioON      0x20    // bit b5
  73 #define cForcedMuteAudioOFF     0x00    // bit b5
  74
  75 #define cOutputPort1Active      0x00    // bit b6
  76 #define cOutputPort1Inactive    0x40    // bit b6
  77
  78 #define cOutputPort2Active      0x00    // bit b7
  79 #define cOutputPort2Inactive    0x80    // bit b7
  80
  81
  82 //// second reg (c)
  83 #define cDeemphasisOFF          0x00    // bit c5
  84 #define cDeemphasisON           0x20    // bit c5
  85
  86 #define cDeemphasis75           0x00    // bit c6
  87 #define cDeemphasis50           0x40    // bit c6
  88
  89 #define cAudioGain0             0x00    // bit c7
  90 #define cAudioGain6             0x80    // bit c7
  91
  92 #define cTopMask                0x1f    // bit c0:4
  93 #define cTopDefault             0x10    // bit c0:4
  94
  95 //// third reg (e)
  96 #define cAudioIF_4_5             0x00    // bit e0:1
  97 #define cAudioIF_5_5             0x01    // bit e0:1
  98 #define cAudioIF_6_0             0x02    // bit e0:1
  99 #define cAudioIF_6_5             0x03    // bit e0:1
 100
 101
 102 #define cVideoIFMask            0x1c    // bit e2:4
 103 /* Video IF selection in TV Mode (bit B3=0) */
 104 #define cVideoIF_58_75           0x00    // bit e2:4
 105 #define cVideoIF_45_75           0x04    // bit e2:4
 106 #define cVideoIF_38_90           0x08    // bit e2:4
 107 #define cVideoIF_38_00           0x0C    // bit e2:4
 108 #define cVideoIF_33_90           0x10    // bit e2:4
 109 #define cVideoIF_33_40           0x14    // bit e2:4
 110 #define cRadioIF_45_75           0x18    // bit e2:4
 111 #define cRadioIF_38_90           0x1C    // bit e2:4
 112
 113 /* IF1 selection in Radio Mode (bit B3=1) */
 114 #define cRadioIF_33_30          0x00    // bit e2,4 (also 0x10,0x14)
 115 #define cRadioIF_41_30          0x04    // bit e2,4
 116
 117 /* Output of AFC pin in radio mode when bit E7=1 */
 118 #define cRadioAGC_SIF           0x00    // bit e3
 119 #define cRadioAGC_FM            0x08    // bit e3
 120
 121 #define cTunerGainNormal         0x00    // bit e5
 122 #define cTunerGainLow            0x20    // bit e5
 123
 124 #define cGating_18               0x00    // bit e6
 125 #define cGating_36               0x40    // bit e6
 126
 127 #define cAgcOutON                0x80    // bit e7
 128 #define cAgcOutOFF               0x00    // bit e7
 129
 130 /* ---------------------------------------------------------------------- */
 131
 132 static struct tvnorm tvnorms[] = {
 133         {
 134                 .std   = V4L2_STD_PAL_BG | V4L2_STD_PAL_H | V4L2_STD_PAL_N,
 135                 .name  = "PAL-BGHN",
 136                 .b     = ( cNegativeFmTV  |
 137                            cQSS           ),
 138                 .c     = ( cDeemphasisON  |
 139                            cDeemphasis50  |
 140                            cTopDefault),
 141                 .e     = ( cGating_36     |
 142                            cAudioIF_5_5   |
 143                            cVideoIF_38_90 ),
 144         },{
 145                 .std   = V4L2_STD_PAL_I,
 146                 .name  = "PAL-I",
 147                 .b     = ( cNegativeFmTV  |
 148                            cQSS           ),
 149                 .c     = ( cDeemphasisON  |
 150                            cDeemphasis50  |
 151                            cTopDefault),
 152                 .e     = ( cGating_36     |
 153                            cAudioIF_6_0   |
 154                            cVideoIF_38_90 ),
 155         },{
 156                 .std   = V4L2_STD_PAL_DK,
 157                 .name  = "PAL-DK",
 158                 .b     = ( cNegativeFmTV  |
 159                            cQSS           ),
 160                 .c     = ( cDeemphasisON  |
 161                            cDeemphasis50  |
 162                            cTopDefault),
 163                 .e     = ( cGating_36     |
 164                            cAudioIF_6_5   |
 165                            cVideoIF_38_90 ),
 166         },{
 167                 .std   = V4L2_STD_PAL_M | V4L2_STD_PAL_Nc,
 168                 .name  = "PAL-M/Nc",
 169                 .b     = ( cNegativeFmTV  |
 170                            cQSS           ),
 171                 .c     = ( cDeemphasisON  |
 172                            cDeemphasis75  |
 173                            cTopDefault),
 174                 .e     = ( cGating_36     |
 175                            cAudioIF_4_5   |
 176                            cVideoIF_45_75 ),
 177         },{
 178                 .std   = V4L2_STD_SECAM_B | V4L2_STD_SECAM_G | V4L2_STD_SECAM_H,
 179                 .name  = "SECAM-BGH",
 180                 .b     = ( cPositiveAmTV  |
 181                            cQSS           ),
 182                 .c     = ( cTopDefault),
 183                 .e     = ( cGating_36     |
 184                            cAudioIF_5_5   |
 185                            cVideoIF_38_90 ),
 186         },{
 187                 .std   = V4L2_STD_SECAM_L,
 188                 .name  = "SECAM-L",
 189                 .b     = ( cPositiveAmTV  |
 190                            cQSS           ),
 191                 .c     = ( cTopDefault),
 192                 .e     = ( cGating_36     |
 193                            cAudioIF_6_5   |
 194                            cVideoIF_38_90 ),
 195         },{
 196                 .std   = V4L2_STD_SECAM_LC,
 197                 .name  = "SECAM-L'",
 198                 .b     = ( cOutputPort2Inactive |
 199                            cPositiveAmTV  |
 200                            cQSS           ),
 201                 .c     = ( cTopDefault),
 202                 .e     = ( cGating_36     |
 203                            cAudioIF_6_5   |
 204                            cVideoIF_33_90 ),
 205         },{
 206                 .std   = V4L2_STD_SECAM_DK,
 207                 .name  = "SECAM-DK",
 208                 .b     = ( cNegativeFmTV  |
 209                            cQSS           ),
 210                 .c     = ( cDeemphasisON  |
 211                            cDeemphasis50  |
 212                            cTopDefault),
 213                 .e     = ( cGating_36     |
 214                            cAudioIF_6_5   |
 215                            cVideoIF_38_90 ),
 216         },{
 217                 .std   = V4L2_STD_NTSC_M | V4L2_STD_NTSC_M_KR,
 218                 .name  = "NTSC-M",
 219                 .b     = ( cNegativeFmTV  |
 220                            cQSS           ),
 221                 .c     = ( cDeemphasisON  |
 222                            cDeemphasis75  |
 223                            cTopDefault),
 224                 .e     = ( cGating_36     |
 225                            cAudioIF_4_5   |
 226                            cVideoIF_45_75 ),
 227         },{
 228                 .std   = V4L2_STD_NTSC_M_JP,
 229                 .name  = "NTSC-M-JP",
 230                 .b     = ( cNegativeFmTV  |
 231                            cQSS           ),
 232                 .c     = ( cDeemphasisON  |
 233                            cDeemphasis50  |
 234                            cTopDefault),
 235                 .e     = ( cGating_36     |
 236                            cAudioIF_4_5   |
 237                            cVideoIF_58_75 ),
 238         }
 239 };
 240
 241 static struct tvnorm radio_stereo = {
 242         .name = "Radio Stereo",
 243         .b    = ( cFmRadio       |
 244                   cQSS           ),
 245         .c    = ( cDeemphasisOFF |
 246                   cAudioGain6    |
 247                   cTopDefault),
 248         .e    = ( cTunerGainLow  |
 249                   cAudioIF_5_5   |
 250                   cRadioIF_38_90 ),
 251 };
 252
 253 static struct tvnorm radio_mono = {
 254         .name = "Radio Mono",
 255         .b    = ( cFmRadio       |
 256                   cQSS           ),
 257         .c    = ( cDeemphasisON  |
 258                   cDeemphasis75  |
 259                   cTopDefault),
 260         .e    = ( cTunerGainLow  |
 261                   cAudioIF_5_5   |
 262                   cRadioIF_38_90 ),
 263 };
 264
 265 /* ---------------------------------------------------------------------- */
 266
 267 static void dump_read_message(struct dvb_frontend *fe, unsigned char *buf)
 268 {
 269         struct tda9887_priv *priv = fe->analog_demod_priv;
 270
 271         static char *afc[16] = {
 272                 "- 12.5 kHz",
 273                 "- 37.5 kHz",
 274                 "- 62.5 kHz",
 275                 "- 87.5 kHz",
 276                 "-112.5 kHz",
 277                 "-137.5 kHz",
 278                 "-162.5 kHz",
 279                 "-187.5 kHz [min]",
 280                 "+187.5 kHz [max]",
 281                 "+162.5 kHz",
 282                 "+137.5 kHz",
 283                 "+112.5 kHz",
 284                 "+ 87.5 kHz",
 285                 "+ 62.5 kHz",
 286                 "+ 37.5 kHz",
 287                 "+ 12.5 kHz",
 288         };
 289         tda9887_info("read: 0x%2x\n", buf[0]);
 290         tda9887_info("  after power on : %s\n", (buf[0] & 0x01) ? "yes" : "no");
 291         tda9887_info("  afc            : %s\n", afc[(buf[0] >> 1) & 0x0f]);
 292         tda9887_info("  fmif level     : %s\n", (buf[0] & 0x20) ? "high" : "low");
 293         tda9887_info("  afc window     : %s\n", (buf[0] & 0x40) ? "in" : "out");
 294         tda9887_info("  vfi level      : %s\n", (buf[0] & 0x80) ? "high" : "low");
 295 }
 296
 297 static void dump_write_message(struct dvb_frontend *fe, unsigned char *buf)
 298 {
 299         struct tda9887_priv *priv = fe->analog_demod_priv;
 300
 301         static char *sound[4] = {
 302                 "AM/TV",
 303                 "FM/radio",
 304                 "FM/TV",
 305                 "FM/radio"
 306         };
 307         static char *adjust[32] = {
 308                 "-16", "-15", "-14", "-13", "-12", "-11", "-10", "-9",
 309                 "-8",  "-7",  "-6",  "-5",  "-4",  "-3",  "-2",  "-1",
 310                 "0",   "+1",  "+2",  "+3",  "+4",  "+5",  "+6",  "+7",
 311                 "+8",  "+9",  "+10", "+11", "+12", "+13", "+14", "+15"
 312         };
 313         static char *deemph[4] = {
 314                 "no", "no", "75", "50"
 315         };
 316         static char *carrier[4] = {
 317                 "4.5 MHz",
 318                 "5.5 MHz",
 319                 "6.0 MHz",
 320                 "6.5 MHz / AM"
 321         };
 322         static char *vif[8] = {
 323                 "58.75 MHz",
 324                 "45.75 MHz",
 325                 "38.9 MHz",
 326                 "38.0 MHz",
 327                 "33.9 MHz",
 328                 "33.4 MHz",
 329                 "45.75 MHz + pin13",
 330                 "38.9 MHz + pin13",
 331         };
 332         static char *rif[4] = {
 333                 "44 MHz",
 334                 "52 MHz",
 335                 "52 MHz",
 336                 "44 MHz",
 337         };
 338
 339         tda9887_info("write: byte B 0x%02x\n",buf[1]);
 340         tda9887_info("  B0   video mode      : %s\n",
 341                (buf[1] & 0x01) ? "video trap" : "sound trap");
 342         tda9887_info("  B1   auto mute fm    : %s\n",
 343                (buf[1] & 0x02) ? "yes" : "no");
 344         tda9887_info("  B2   carrier mode    : %s\n",
 345                (buf[1] & 0x04) ? "QSS" : "Intercarrier");
 346         tda9887_info("  B3-4 tv sound/radio  : %s\n",
 347                sound[(buf[1] & 0x18) >> 3]);
 348         tda9887_info("  B5   force mute audio: %s\n",
 349                (buf[1] & 0x20) ? "yes" : "no");
 350         tda9887_info("  B6   output port 1   : %s\n",
 351                (buf[1] & 0x40) ? "high (inactive)" : "low (active)");
 352         tda9887_info("  B7   output port 2   : %s\n",
 353                (buf[1] & 0x80) ? "high (inactive)" : "low (active)");
 354
 355         tda9887_info("write: byte C 0x%02x\n",buf[2]);
 356         tda9887_info("  C0-4 top adjustment  : %s dB\n", adjust[buf[2] & 0x1f]);
 357         tda9887_info("  C5-6 de-emphasis     : %s\n", deemph[(buf[2] & 0x60) >> 5]);
 358         tda9887_info("  C7   audio gain      : %s\n",
 359                (buf[2] & 0x80) ? "-6" : "0");
 360
 361         tda9887_info("write: byte E 0x%02x\n",buf[3]);
 362         tda9887_info("  E0-1 sound carrier   : %s\n",
 363                carrier[(buf[3] & 0x03)]);
 364         tda9887_info("  E6   l pll gating   : %s\n",
 365                (buf[3] & 0x40) ? "36" : "13");
 366
 367         if (buf[1] & 0x08) {
 368                 /* radio */
 369                 tda9887_info("  E2-4 video if        : %s\n",
 370                        rif[(buf[3] & 0x0c) >> 2]);
 371                 tda9887_info("  E7   vif agc output  : %s\n",
 372                        (buf[3] & 0x80)
 373                        ? ((buf[3] & 0x10) ? "fm-agc radio" : "sif-agc radio")
 374                        : "fm radio carrier afc");
 375         } else {
 376                 /* video */
 377                 tda9887_info("  E2-4 video if        : %s\n",
 378                        vif[(buf[3] & 0x1c) >> 2]);
 379                 tda9887_info("  E5   tuner gain      : %s\n",
 380                        (buf[3] & 0x80)
 381                        ? ((buf[3] & 0x20) ? "external" : "normal")
 382                        : ((buf[3] & 0x20) ? "minimum"  : "normal"));
 383                 tda9887_info("  E7   vif agc output  : %s\n",
 384                        (buf[3] & 0x80)
 385                        ? ((buf[3] & 0x20)
 386                           ? "pin3 port, pin22 vif agc out"
 387                           : "pin22 port, pin3 vif acg ext in")
 388                        : "pin3+pin22 port");
 389         }
 390         tda9887_info("--\n");
 391 }
 392
 393 /* ---------------------------------------------------------------------- */
 394
 395 static int tda9887_set_tvnorm(struct dvb_frontend *fe)
 396 {
 397         struct tda9887_priv *priv = fe->analog_demod_priv;
 398         struct tuner *t = priv->t;
 399         struct tvnorm *norm = NULL;
 400         char *buf = priv->data;
 401         int i;
 402
 403         if (t->mode == V4L2_TUNER_RADIO) {
 404                 if (t->audmode == V4L2_TUNER_MODE_MONO)
 405                         norm = &radio_mono;
 406                 else
 407                         norm = &radio_stereo;
 408         } else {
 409                 for (i = 0; i < ARRAY_SIZE(tvnorms); i++) {
 410                         if (tvnorms[i].std & t->std) {
 411                                 norm = tvnorms+i;
 412                                 break;
 413                         }
 414                 }
 415         }
 416         if (NULL == norm) {
 417                 tda9887_dbg("Unsupported tvnorm entry - audio muted\n");
 418                 return -1;
 419         }
 420
 421         tda9887_dbg("configure for: %s\n",norm->name);
 422         buf[1] = norm->b;
 423         buf[2] = norm->c;
 424         buf[3] = norm->e;
 425         return 0;
 426 }
 427
 428 static unsigned int port1  = UNSET;
 429 static unsigned int port2  = UNSET;
 430 static unsigned int qss    = UNSET;
 431 static unsigned int adjust = UNSET;
 432
 433 module_param(port1, int, 0644);
 434 module_param(port2, int, 0644);
 435 module_param(qss, int, 0644);
 436 module_param(adjust, int, 0644);
 437
 438 static int tda9887_set_insmod(struct dvb_frontend *fe)
 439 {
 440         struct tda9887_priv *priv = fe->analog_demod_priv;
 441         char *buf = priv->data;
 442
 443         if (UNSET != port1) {
 444                 if (port1)
 445                         buf[1] |= cOutputPort1Inactive;
 446                 else
 447                         buf[1] &= ~cOutputPort1Inactive;
 448         }
 449         if (UNSET != port2) {
 450                 if (port2)
 451                         buf[1] |= cOutputPort2Inactive;
 452                 else
 453                         buf[1] &= ~cOutputPort2Inactive;
 454         }
 455
 456         if (UNSET != qss) {
 457                 if (qss)
 458                         buf[1] |= cQSS;
 459                 else
 460                         buf[1] &= ~cQSS;
 461         }
 462
 463         if (adjust >= 0x00 && adjust < 0x20) {
 464                 buf[2] &= ~cTopMask;
 465                 buf[2] |= adjust;
 466         }
 467         return 0;
 468 }
 469
 470 static int tda9887_set_config(struct dvb_frontend *fe)
 471 {
 472         struct tda9887_priv *priv = fe->analog_demod_priv;
 473         struct tuner *t = priv->t;
 474         char *buf = priv->data;
 475
 476         if (t->tda9887_config & TDA9887_PORT1_ACTIVE)
 477                 buf[1] &= ~cOutputPort1Inactive;
 478         if (t->tda9887_config & TDA9887_PORT1_INACTIVE)
 479                 buf[1] |= cOutputPort1Inactive;
 480         if (t->tda9887_config & TDA9887_PORT2_ACTIVE)
 481                 buf[1] &= ~cOutputPort2Inactive;
 482         if (t->tda9887_config & TDA9887_PORT2_INACTIVE)
 483                 buf[1] |= cOutputPort2Inactive;
 484
 485         if (t->tda9887_config & TDA9887_QSS)
 486                 buf[1] |= cQSS;
 487         if (t->tda9887_config & TDA9887_INTERCARRIER)
 488                 buf[1] &= ~cQSS;
 489
 490         if (t->tda9887_config & TDA9887_AUTOMUTE)
 491                 buf[1] |= cAutoMuteFmActive;
 492         if (t->tda9887_config & TDA9887_DEEMPHASIS_MASK) {
 493                 buf[2] &= ~0x60;
 494                 switch (t->tda9887_config & TDA9887_DEEMPHASIS_MASK) {
 495                 case TDA9887_DEEMPHASIS_NONE:
 496                         buf[2] |= cDeemphasisOFF;
 497                         break;
 498                 case TDA9887_DEEMPHASIS_50:
 499                         buf[2] |= cDeemphasisON | cDeemphasis50;
 500                         break;
 501                 case TDA9887_DEEMPHASIS_75:
 502                         buf[2] |= cDeemphasisON | cDeemphasis75;
 503                         break;
 504                 }
 505         }
 506         if (t->tda9887_config & TDA9887_TOP_SET) {
 507                 buf[2] &= ~cTopMask;
 508                 buf[2] |= (t->tda9887_config >> 8) & cTopMask;
 509         }
 510         if ((t->tda9887_config & TDA9887_INTERCARRIER_NTSC) && (t->std & V4L2_STD_NTSC))
 511                 buf[1] &= ~cQSS;
 512         if (t->tda9887_config & TDA9887_GATING_18)
 513                 buf[3] &= ~cGating_36;
 514
 515         if (t->mode == V4L2_TUNER_RADIO) {
 516                 if (t->tda9887_config & TDA9887_RIF_41_3) {
 517                         buf[3] &= ~cVideoIFMask;
 518                         buf[3] |= cRadioIF_41_30;
 519                 }
 520                 if (t->tda9887_config & TDA9887_GAIN_NORMAL)
 521                         buf[3] &= ~cTunerGainLow;
 522         }
 523
 524         return 0;
 525 }
 526
 527 /* ---------------------------------------------------------------------- */
 528
 529 static int tda9887_status(struct dvb_frontend *fe)
 530 {
 531         struct tda9887_priv *priv = fe->analog_demod_priv;
 532         unsigned char buf[1];
 533         int rc;
 534
 535         memset(buf,0,sizeof(buf));
 536         if (1 != (rc = tuner_i2c_xfer_recv(&priv->i2c_props,buf,1)))
 537                 tda9887_info("i2c i/o error: rc == %d (should be 1)\n",rc);
 538         dump_read_message(fe, buf);
 539         return 0;
 540 }
 541
 542 static void tda9887_configure(struct dvb_frontend *fe)
 543 {
 544         struct tda9887_priv *priv = fe->analog_demod_priv;
 545         struct tuner *t = priv->t;
 546         int rc;
 547
 548         memset(priv->data,0,sizeof(priv->data));
 549         tda9887_set_tvnorm(fe);
 550
 551         /* A note on the port settings:
 552            These settings tend to depend on the specifics of the board.
 553            By default they are set to inactive (bit value 1) by this driver,
 554            overwriting any changes made by the tvnorm. This means that it
 555            is the responsibility of the module using the tda9887 to set
 556            these values in case of changes in the tvnorm.
 557            In many cases port 2 should be made active (0) when selecting
 558            SECAM-L, and port 2 should remain inactive (1) for SECAM-L'.
 559
 560            For the other standards the tda9887 application note says that
 561            the ports should be set to active (0), but, again, that may
 562            differ depending on the precise hardware configuration.
 563          */
 564         priv->data[1] |= cOutputPort1Inactive;
 565         priv->data[1] |= cOutputPort2Inactive;
 566
 567         tda9887_set_config(fe);
 568         tda9887_set_insmod(fe);
 569
 570         if (t->mode == T_STANDBY) {
 571                 priv->data[1] |= cForcedMuteAudioON;
 572         }
 573
 574         tda9887_dbg("writing: b=0x%02x c=0x%02x e=0x%02x\n",
 575                 priv->data[1],priv->data[2],priv->data[3]);
 576         if (tuner_debug > 1)
 577                 dump_write_message(fe, priv->data);
 578
 579         if (4 != (rc = tuner_i2c_xfer_send(&priv->i2c_props,priv->data,4)))
 580                 tda9887_info("i2c i/o error: rc == %d (should be 4)\n",rc);
 581
 582         if (tuner_debug > 2) {
 583                 msleep_interruptible(1000);
 584                 tda9887_status(fe);
 585         }
 586 }
 587
 588 /* ---------------------------------------------------------------------- */
 589
 590 static void tda9887_tuner_status(struct dvb_frontend *fe)
 591 {
 592         struct tda9887_priv *priv = fe->analog_demod_priv;
 593         tda9887_info("Data bytes: b=0x%02x c=0x%02x e=0x%02x\n", priv->data[1], priv->data[2], priv->data[3]);
 594 }
 595
 596 static int tda9887_get_afc(struct dvb_frontend *fe)
 597 {
 598         struct tda9887_priv *priv = fe->analog_demod_priv;
 599         static int AFC_BITS_2_kHz[] = {
 600                 -12500,  -37500,  -62500,  -97500,
 601                 -112500, -137500, -162500, -187500,
 602                 187500,  162500,  137500,  112500,
 603                 97500 ,  62500,   37500 ,  12500
 604         };
 605         int afc=0;
 606         __u8 reg = 0;
 607
 608         if (1 == tuner_i2c_xfer_recv(&priv->i2c_props,&reg,1))
 609                 afc = AFC_BITS_2_kHz[(reg>>1)&0x0f];
 610
 611         return afc;
 612 }
 613
 614 static void tda9887_standby(struct dvb_frontend *fe)
 615 {
 616         tda9887_configure(fe);
 617 }
 618
 619 static void tda9887_set_freq(struct dvb_frontend *fe, unsigned int freq)
 620 {
 621         tda9887_configure(fe);
 622 }
 623
 624 static void tda9887_release(struct dvb_frontend *fe)
 625 {
 626         kfree(fe->analog_demod_priv);
 627         fe->analog_demod_priv = NULL;
 628 }
 629
 630 static struct analog_tuner_ops tda9887_tuner_ops = {
 631         .set_tv_freq    = tda9887_set_freq,
 632         .set_radio_freq = tda9887_set_freq,
 633         .standby        = tda9887_standby,
 634         .tuner_status   = tda9887_tuner_status,
 635         .get_afc        = tda9887_get_afc,
 636         .release        = tda9887_release,
 637 };
 638
 639 int tda9887_tuner_init(struct tuner *t)
 640 {
 641         struct tda9887_priv *priv = NULL;
 642
 643         priv = kzalloc(sizeof(struct tda9887_priv), GFP_KERNEL);
 644         if (priv == NULL)
 645                 return -ENOMEM;
 646         t->fe.analog_demod_priv = priv;
 647
 648         priv->i2c_props.addr = t->i2c.addr;
 649         priv->i2c_props.adap = t->i2c.adapter;
 650         priv->t = t;
 651
 652         strlcpy(t->i2c.name, "tda9887", sizeof(t->i2c.name));
 653
 654         tda9887_info("tda988[5/6/7] found @ 0x%x (%s)\n", t->i2c.addr,
 655                                                 t->i2c.driver->driver.name);
 656
 657         t->fe.ops.analog_demod_ops = &tda9887_tuner_ops;
 658
 659         return 0;
 660 }
 661
 662 /*
 663  * Overrides for Emacs so that we follow Linus's tabbing style.
 664  * ---------------------------------------------------------------------------
 665  * Local variables:
 666  * c-basic-offset: 8
 667  * End:
 668  */