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