drivers/media/video/tda9887.c

   1 #include <linux/module.h>
   2 #include <linux/moduleparam.h>
   3 #include <linux/kernel.h>
   4 #include <linux/i2c.h>
   5 #include <linux/types.h>
   6 #include <linux/videodev.h>
   7 #include <linux/init.h>
   8 #include <linux/errno.h>
   9 #include <linux/slab.h>
  10 #include <linux/delay.h>
  11
  12 #include <media/audiochip.h>
  13 #include <media/tuner.h>
  14 #include <media/id.h>
  15
  16 /* Chips:
  17    TDA9885 (PAL, NTSC)
  18    TDA9886 (PAL, SECAM, NTSC)
  19    TDA9887 (PAL, SECAM, NTSC, FM Radio)
  20
  21    found on:
  22    - Pinnacle PCTV (Jul.2002 Version with MT2032, bttv)
  23       TDA9887 (world), TDA9885 (USA)
  24       Note: OP2 of tda988x must be set to 1, else MT2032 is disabled!
  25    - KNC One TV-Station RDS (saa7134)
  26 */
  27
  28
  29 /* Addresses to scan */
  30 static unsigned short normal_i2c[] = {
  31         0x84 >>1,
  32         0x86 >>1,
  33         0x96 >>1,
  34         I2C_CLIENT_END,
  35 };
  36 I2C_CLIENT_INSMOD;
  37
  38 /* insmod options */
  39 static unsigned int debug = 0;
  40 module_param(debug, int, 0644);
  41 MODULE_LICENSE("GPL");
  42
  43 /* ---------------------------------------------------------------------- */
  44
  45 #define UNSET       (-1U)
  46 #define PREFIX      "tda9885/6/7: "
  47 #define dprintk     if (debug) printk
  48
  49 struct tda9887 {
  50         struct i2c_client  client;
  51         v4l2_std_id        std;
  52         unsigned int       radio;
  53         unsigned int       config;
  54         unsigned int       pinnacle_id;
  55         unsigned int       using_v4l2;
  56         unsigned int       radio_mode;
  57 };
  58
  59 struct tvnorm {
  60         v4l2_std_id       std;
  61         char              *name;
  62         unsigned char     b;
  63         unsigned char     c;
  64         unsigned char     e;
  65 };
  66
  67 static struct i2c_driver driver;
  68 static struct i2c_client client_template;
  69
  70 /* ---------------------------------------------------------------------- */
  71
  72 //
  73 // TDA defines
  74 //
  75
  76 //// first reg (b)
  77 #define cVideoTrapBypassOFF     0x00    // bit b0
  78 #define cVideoTrapBypassON      0x01    // bit b0
  79
  80 #define cAutoMuteFmInactive     0x00    // bit b1
  81 #define cAutoMuteFmActive       0x02    // bit b1
  82
  83 #define cIntercarrier           0x00    // bit b2
  84 #define cQSS                    0x04    // bit b2
  85
  86 #define cPositiveAmTV           0x00    // bit b3:4
  87 #define cFmRadio                0x08    // bit b3:4
  88 #define cNegativeFmTV           0x10    // bit b3:4
  89
  90
  91 #define cForcedMuteAudioON      0x20    // bit b5
  92 #define cForcedMuteAudioOFF     0x00    // bit b5
  93
  94 #define cOutputPort1Active      0x00    // bit b6
  95 #define cOutputPort1Inactive    0x40    // bit b6
  96
  97 #define cOutputPort2Active      0x00    // bit b7
  98 #define cOutputPort2Inactive    0x80    // bit b7
  99
 100
 101 //// second reg (c)
 102 #define cDeemphasisOFF          0x00    // bit c5
 103 #define cDeemphasisON           0x20    // bit c5
 104
 105 #define cDeemphasis75           0x00    // bit c6
 106 #define cDeemphasis50           0x40    // bit c6
 107
 108 #define cAudioGain0             0x00    // bit c7
 109 #define cAudioGain6             0x80    // bit c7
 110
 111
 112 //// third reg (e)
 113 #define cAudioIF_4_5             0x00    // bit e0:1
 114 #define cAudioIF_5_5             0x01    // bit e0:1
 115 #define cAudioIF_6_0             0x02    // bit e0:1
 116 #define cAudioIF_6_5             0x03    // bit e0:1
 117
 118
 119 #define cVideoIF_58_75           0x00    // bit e2:4
 120 #define cVideoIF_45_75           0x04    // bit e2:4
 121 #define cVideoIF_38_90           0x08    // bit e2:4
 122 #define cVideoIF_38_00           0x0C    // bit e2:4
 123 #define cVideoIF_33_90           0x10    // bit e2:4
 124 #define cVideoIF_33_40           0x14    // bit e2:4
 125 #define cRadioIF_45_75           0x18    // bit e2:4
 126 #define cRadioIF_38_90           0x1C    // bit e2:4
 127
 128
 129 #define cTunerGainNormal         0x00    // bit e5
 130 #define cTunerGainLow            0x20    // bit e5
 131
 132 #define cGating_18               0x00    // bit e6
 133 #define cGating_36               0x40    // bit e6
 134
 135 #define cAgcOutON                0x80    // bit e7
 136 #define cAgcOutOFF               0x00    // bit e7
 137
 138 /* ---------------------------------------------------------------------- */
 139
 140 static struct tvnorm tvnorms[] = {
 141         {
 142                 .std   = V4L2_STD_PAL_BG,
 143                 .name  = "PAL-BG",
 144                 .b     = ( cNegativeFmTV  |
 145                            cQSS           ),
 146                 .c     = ( cDeemphasisON  |
 147                            cDeemphasis50  ),
 148                 .e     = ( cAudioIF_5_5   |
 149                            cVideoIF_38_90 ),
 150         },{
 151                 .std   = V4L2_STD_PAL_I,
 152                 .name  = "PAL-I",
 153                 .b     = ( cNegativeFmTV  |
 154                            cQSS           ),
 155                 .c     = ( cDeemphasisON  |
 156                            cDeemphasis50  ),
 157                 .e     = ( cAudioIF_6_0   |
 158                            cVideoIF_38_90 ),
 159         },{
 160                 .std   = V4L2_STD_PAL_DK,
 161                 .name  = "PAL-DK",
 162                 .b     = ( cNegativeFmTV  |
 163                            cQSS           ),
 164                 .c     = ( cDeemphasisON  |
 165                            cDeemphasis50  ),
 166                 .e     = ( cAudioIF_6_5   |
 167                            cVideoIF_38_00 ),
 168         },{
 169                 .std   = V4L2_STD_PAL_M | V4L2_STD_PAL_N,
 170                 .name  = "PAL-M/N",
 171                 .b     = ( cNegativeFmTV  |
 172                            cQSS           ),
 173                 .c     = ( cDeemphasisON  |
 174                            cDeemphasis75  ),
 175                 .e     = ( cAudioIF_4_5   |
 176                            cVideoIF_45_75 ),
 177         },{
 178                 .std   = V4L2_STD_SECAM_L,
 179                 .name  = "SECAM-L",
 180                 .b     = ( cPositiveAmTV  |
 181                            cQSS           ),
 182                 .e     = ( cAudioIF_6_5   |
 183                            cVideoIF_38_90 ),
 184         },{
 185                 .std   = V4L2_STD_SECAM_DK,
 186                 .name  = "SECAM-DK",
 187                 .b     = ( cNegativeFmTV  |
 188                            cQSS           ),
 189                 .c     = ( cDeemphasisON  |
 190                            cDeemphasis50  ),
 191                 .e     = ( cAudioIF_6_5   |
 192                            cVideoIF_38_00 ),
 193         },{
 194                 .std   = V4L2_STD_NTSC_M,
 195                 .name  = "NTSC-M",
 196                 .b     = ( cNegativeFmTV  |
 197                            cQSS           ),
 198                 .c     = ( cDeemphasisON  |
 199                            cDeemphasis50  ),
 200                 .e     = ( cGating_36     |
 201                            cAudioIF_4_5   |
 202                            cVideoIF_45_75 ),
 203         },{
 204                 .std   = V4L2_STD_NTSC_M_JP,
 205                 .name  = "NTSC-JP",
 206                 .b     = ( cNegativeFmTV  |
 207                            cQSS           ),
 208                 .c     = ( cDeemphasisON  |
 209                            cDeemphasis50  ),
 210                 .e     = ( cGating_36     |
 211                            cAudioIF_4_5   |
 212                            cVideoIF_58_75 ),
 213         }
 214 };
 215
 216 static struct tvnorm radio_stereo = {
 217         .name = "Radio Stereo",
 218         .b    = ( cFmRadio       |
 219                   cQSS           ),
 220         .c    = ( cDeemphasisOFF |
 221                   cAudioGain6 ),
 222         .e    = ( cAudioIF_5_5   |
 223                   cRadioIF_38_90 ),
 224 };
 225
 226 static struct tvnorm radio_mono = {
 227         .name = "Radio Mono",
 228         .b    = ( cFmRadio       |
 229                   cQSS           ),
 230         .c    = ( cDeemphasisON  |
 231                   cDeemphasis50),
 232         .e    = ( cAudioIF_5_5   |
 233                   cRadioIF_38_90 ),
 234 };
 235
 236 /* ---------------------------------------------------------------------- */
 237
 238 static void dump_read_message(unsigned char *buf)
 239 {
 240         static char *afc[16] = {
 241                 "- 12.5 kHz",
 242                 "- 37.5 kHz",
 243                 "- 62.5 kHz",
 244                 "- 87.5 kHz",
 245                 "-112.5 kHz",
 246                 "-137.5 kHz",
 247                 "-162.5 kHz",
 248                 "-187.5 kHz [min]",
 249                 "+187.5 kHz [max]",
 250                 "+162.5 kHz",
 251                 "+137.5 kHz",
 252                 "+112.5 kHz",
 253                 "+ 87.5 kHz",
 254                 "+ 62.5 kHz",
 255                 "+ 37.5 kHz",
 256                 "+ 12.5 kHz",
 257         };
 258         printk(PREFIX "read: 0x%2x\n", buf[0]);
 259         printk("  after power on : %s\n", (buf[0] & 0x01) ? "yes" : "no");
 260         printk("  afc            : %s\n", afc[(buf[0] >> 1) & 0x0f]);
 261         printk("  fmif level     : %s\n", (buf[0] & 0x20) ? "high" : "low");
 262         printk("  afc window     : %s\n", (buf[0] & 0x40) ? "in" : "out");
 263         printk("  vfi level      : %s\n", (buf[0] & 0x80) ? "high" : "low");
 264 }
 265
 266 static void dump_write_message(unsigned char *buf)
 267 {
 268         static char *sound[4] = {
 269                 "AM/TV",
 270                 "FM/radio",
 271                 "FM/TV",
 272                 "FM/radio"
 273         };
 274         static char *adjust[32] = {
 275                 "-16", "-15", "-14", "-13", "-12", "-11", "-10", "-9",
 276                 "-8",  "-7",  "-6",  "-5",  "-4",  "-3",  "-2",  "-1",
 277                 "0",   "+1",  "+2",  "+3",  "+4",  "+5",  "+6",  "+7",
 278                 "+8",  "+9",  "+10", "+11", "+12", "+13", "+14", "+15"
 279         };
 280         static char *deemph[4] = {
 281                 "no", "no", "75", "50"
 282         };
 283         static char *carrier[4] = {
 284                 "4.5 MHz",
 285                 "5.5 MHz",
 286                 "6.0 MHz",
 287                 "6.5 MHz / AM"
 288         };
 289         static char *vif[8] = {
 290                 "58.75 MHz",
 291                 "45.75 MHz",
 292                 "38.9 MHz",
 293                 "38.0 MHz",
 294                 "33.9 MHz",
 295                 "33.4 MHz",
 296                 "45.75 MHz + pin13",
 297                 "38.9 MHz + pin13",
 298         };
 299         static char *rif[4] = {
 300                 "44 MHz",
 301                 "52 MHz",
 302                 "52 MHz",
 303                 "44 MHz",
 304         };
 305
 306         printk(PREFIX "write: byte B 0x%02x\n",buf[1]);
 307         printk("  B0   video mode      : %s\n",
 308                (buf[1] & 0x01) ? "video trap" : "sound trap");
 309         printk("  B1   auto mute fm    : %s\n",
 310                (buf[1] & 0x02) ? "yes" : "no");
 311         printk("  B2   carrier mode    : %s\n",
 312                (buf[1] & 0x04) ? "QSS" : "Intercarrier");
 313         printk("  B3-4 tv sound/radio  : %s\n",
 314                sound[(buf[1] & 0x18) >> 3]);
 315         printk("  B5   force mute audio: %s\n",
 316                (buf[1] & 0x20) ? "yes" : "no");
 317         printk("  B6   output port 1   : %s\n",
 318                (buf[1] & 0x40) ? "high (inactive)" : "low (active)");
 319         printk("  B7   output port 2   : %s\n",
 320                (buf[1] & 0x80) ? "high (inactive)" : "low (active)");
 321
 322         printk(PREFIX "write: byte C 0x%02x\n",buf[2]);
 323         printk("  C0-4 top adjustment  : %s dB\n", adjust[buf[2] & 0x1f]);
 324         printk("  C5-6 de-emphasis     : %s\n", deemph[(buf[2] & 0x60) >> 5]);
 325         printk("  C7   audio gain      : %s\n",
 326                (buf[2] & 0x80) ? "-6" : "0");
 327
 328         printk(PREFIX "write: byte E 0x%02x\n",buf[3]);
 329         printk("  E0-1 sound carrier   : %s\n",
 330                carrier[(buf[3] & 0x03)]);
 331         printk("  E6   l pll ganting   : %s\n",
 332                (buf[3] & 0x40) ? "36" : "13");
 333
 334         if (buf[1] & 0x08) {
 335                 /* radio */
 336                 printk("  E2-4 video if        : %s\n",
 337                        rif[(buf[3] & 0x0c) >> 2]);
 338                 printk("  E7   vif agc output  : %s\n",
 339                        (buf[3] & 0x80)
 340                        ? ((buf[3] & 0x10) ? "fm-agc radio" : "sif-agc radio")
 341                        : "fm radio carrier afc");
 342         } else {
 343                 /* video */
 344                 printk("  E2-4 video if        : %s\n",
 345                        vif[(buf[3] & 0x1c) >> 2]);
 346                 printk("  E5   tuner gain      : %s\n",
 347                        (buf[3] & 0x80)
 348                        ? ((buf[3] & 0x20) ? "external" : "normal")
 349                        : ((buf[3] & 0x20) ? "minimum"  : "normal"));
 350                 printk("  E7   vif agc output  : %s\n",
 351                        (buf[3] & 0x80)
 352                        ? ((buf[3] & 0x20)
 353                           ? "pin3 port, pin22 vif agc out"
 354                           : "pin22 port, pin3 vif acg ext in")
 355                        : "pin3+pin22 port");
 356         }
 357         printk("--\n");
 358 }
 359
 360 /* ---------------------------------------------------------------------- */
 361
 362 static int tda9887_set_tvnorm(struct tda9887 *t, char *buf)
 363 {
 364         struct tvnorm *norm = NULL;
 365         int i;
 366
 367         if (t->radio) {
 368                 if (t->radio_mode == V4L2_TUNER_MODE_MONO)
 369                         norm = &radio_mono;
 370                 else
 371                         norm = &radio_stereo;
 372         } else {
 373                 for (i = 0; i < ARRAY_SIZE(tvnorms); i++) {
 374                         if (tvnorms[i].std & t->std) {
 375                                 norm = tvnorms+i;
 376                                 break;
 377                         }
 378                 }
 379         }
 380         if (NULL == norm) {
 381                 dprintk(PREFIX "Oops: no tvnorm entry found\n");
 382                 return -1;
 383         }
 384
 385         dprintk(PREFIX "configure for: %s\n",norm->name);
 386         buf[1] = norm->b;
 387         buf[2] = norm->c;
 388         buf[3] = norm->e;
 389         return 0;
 390 }
 391
 392 static unsigned int port1  = UNSET;
 393 static unsigned int port2  = UNSET;
 394 static unsigned int qss    = UNSET;
 395 static unsigned int adjust = 0x10;
 396 module_param(port1, int, 0644);
 397 module_param(port2, int, 0644);
 398 module_param(qss, int, 0644);
 399 module_param(adjust, int, 0644);
 400
 401 static int tda9887_set_insmod(struct tda9887 *t, char *buf)
 402 {
 403         if (UNSET != port1) {
 404                 if (port1)
 405                         buf[1] |= cOutputPort1Inactive;
 406                 else
 407                         buf[1] &= ~cOutputPort1Inactive;
 408         }
 409         if (UNSET != port2) {
 410                 if (port2)
 411                         buf[1] |= cOutputPort2Inactive;
 412                 else
 413                         buf[1] &= ~cOutputPort2Inactive;
 414         }
 415
 416         if (UNSET != qss) {
 417                 if (qss)
 418                         buf[1] |= cQSS;
 419                 else
 420                         buf[1] &= ~cQSS;
 421         }
 422
 423         if (adjust >= 0x00 && adjust < 0x20)
 424                 buf[2] |= adjust;
 425         return 0;
 426 }
 427
 428 static int tda9887_set_config(struct tda9887 *t, char *buf)
 429 {
 430         if (t->config & TDA9887_PORT1_ACTIVE)
 431                 buf[1] &= ~cOutputPort1Inactive;
 432         if (t->config & TDA9887_PORT1_INACTIVE)
 433                 buf[1] |= cOutputPort1Inactive;
 434         if (t->config & TDA9887_PORT2_ACTIVE)
 435                 buf[1] &= ~cOutputPort2Inactive;
 436         if (t->config & TDA9887_PORT2_INACTIVE)
 437                 buf[1] |= cOutputPort2Inactive;
 438
 439         if (t->config & TDA9887_QSS)
 440                 buf[1] |= cQSS;
 441         if (t->config & TDA9887_INTERCARRIER)
 442                 buf[1] &= ~cQSS;
 443
 444         if (t->config & TDA9887_AUTOMUTE)
 445                 buf[1] |= cAutoMuteFmActive;
 446         if (t->config & TDA9887_DEEMPHASIS_MASK) {
 447                 buf[2] &= ~0x60;
 448                 switch (t->config & TDA9887_DEEMPHASIS_MASK) {
 449                 case TDA9887_DEEMPHASIS_NONE:
 450                         buf[2] |= cDeemphasisOFF;
 451                         break;
 452                 case TDA9887_DEEMPHASIS_50:
 453                         buf[2] |= cDeemphasisON | cDeemphasis50;
 454                         break;
 455                 case TDA9887_DEEMPHASIS_75:
 456                         buf[2] |= cDeemphasisON | cDeemphasis75;
 457                         break;
 458                 }
 459         }
 460         return 0;
 461 }
 462
 463 /* ---------------------------------------------------------------------- */
 464
 465 static int tda9887_set_pinnacle(struct tda9887 *t, char *buf)
 466 {
 467         unsigned int bCarrierMode = UNSET;
 468
 469         if (t->std & V4L2_STD_625_50) {
 470                 if ((1 == t->pinnacle_id) || (7 == t->pinnacle_id)) {
 471                         bCarrierMode = cIntercarrier;
 472                 } else {
 473                         bCarrierMode = cQSS;
 474                 }
 475         }
 476         if (t->std & V4L2_STD_525_60) {
 477                 if ((5 == t->pinnacle_id) || (6 == t->pinnacle_id)) {
 478                         bCarrierMode = cIntercarrier;
 479                 } else {
 480                         bCarrierMode = cQSS;
 481                 }
 482         }
 483
 484         if (bCarrierMode != UNSET) {
 485                 buf[1] &= ~0x04;
 486                 buf[1] |= bCarrierMode;
 487         }
 488         return 0;
 489 }
 490
 491 /* ---------------------------------------------------------------------- */
 492
 493 static char pal[] = "-";
 494 module_param_string(pal, pal, sizeof(pal), 0644);
 495 static char secam[] = "-";
 496 module_param_string(secam, secam, sizeof(secam), 0644);
 497
 498 static int tda9887_fixup_std(struct tda9887 *t)
 499 {
 500         /* get more precise norm info from insmod option */
 501         if ((t->std & V4L2_STD_PAL) == V4L2_STD_PAL) {
 502                 switch (pal[0]) {
 503                 case 'b':
 504                 case 'B':
 505                 case 'g':
 506                 case 'G':
 507                         dprintk(PREFIX "insmod fixup: PAL => PAL-BG\n");
 508                         t->std = V4L2_STD_PAL_BG;
 509                         break;
 510                 case 'i':
 511                 case 'I':
 512                         dprintk(PREFIX "insmod fixup: PAL => PAL-I\n");
 513                         t->std = V4L2_STD_PAL_I;
 514                         break;
 515                 case 'd':
 516                 case 'D':
 517                 case 'k':
 518                 case 'K':
 519                         dprintk(PREFIX "insmod fixup: PAL => PAL-DK\n");
 520                         t->std = V4L2_STD_PAL_DK;
 521                         break;
 522                 }
 523         }
 524         if ((t->std & V4L2_STD_SECAM) == V4L2_STD_SECAM) {
 525                 switch (secam[0]) {
 526                 case 'd':
 527                 case 'D':
 528                 case 'k':
 529                 case 'K':
 530                         dprintk(PREFIX "insmod fixup: SECAM => SECAM-DK\n");
 531                         t->std = V4L2_STD_SECAM_DK;
 532                         break;
 533                 case 'l':
 534                 case 'L':
 535                         dprintk(PREFIX "insmod fixup: SECAM => SECAM-L\n");
 536                         t->std = V4L2_STD_SECAM_L;
 537                         break;
 538                 }
 539         }
 540         return 0;
 541 }
 542
 543 static int tda9887_status(struct tda9887 *t)
 544 {
 545         unsigned char buf[1];
 546         int rc;
 547
 548         memset(buf,0,sizeof(buf));
 549         if (1 != (rc = i2c_master_recv(&t->client,buf,1)))
 550                 printk(PREFIX "i2c i/o error: rc == %d (should be 1)\n",rc);
 551         dump_read_message(buf);
 552         return 0;
 553 }
 554
 555 static int tda9887_configure(struct tda9887 *t)
 556 {
 557         unsigned char buf[4];
 558         int rc;
 559
 560         memset(buf,0,sizeof(buf));
 561         tda9887_set_tvnorm(t,buf);
 562
 563         buf[1] |= cOutputPort1Inactive;
 564         buf[1] |= cOutputPort2Inactive;
 565
 566         if (UNSET != t->pinnacle_id) {
 567                 tda9887_set_pinnacle(t,buf);
 568         }
 569         tda9887_set_config(t,buf);
 570         tda9887_set_insmod(t,buf);
 571
 572
 573         dprintk(PREFIX "writing: b=0x%02x c=0x%02x e=0x%02x\n",
 574                 buf[1],buf[2],buf[3]);
 575         if (debug > 1)
 576                 dump_write_message(buf);
 577
 578         if (4 != (rc = i2c_master_send(&t->client,buf,4)))
 579                 printk(PREFIX "i2c i/o error: rc == %d (should be 4)\n",rc);
 580
 581         if (debug > 2) {
 582                 msleep_interruptible(1000);
 583                 tda9887_status(t);
 584         }
 585         return 0;
 586 }
 587
 588 /* ---------------------------------------------------------------------- */
 589
 590 static int tda9887_attach(struct i2c_adapter *adap, int addr, int kind)
 591 {
 592         struct tda9887 *t;
 593
 594         client_template.adapter = adap;
 595         client_template.addr    = addr;
 596
 597         printk(PREFIX "chip found @ 0x%x\n", addr<<1);
 598
 599         if (NULL == (t = kmalloc(sizeof(*t), GFP_KERNEL)))
 600                 return -ENOMEM;
 601         memset(t,0,sizeof(*t));
 602
 603         t->client      = client_template;
 604         t->std         = 0;
 605         t->pinnacle_id = UNSET;
 606         t->radio_mode = V4L2_TUNER_MODE_STEREO;
 607
 608         i2c_set_clientdata(&t->client, t);
 609         i2c_attach_client(&t->client);
 610
 611         return 0;
 612 }
 613
 614 static int tda9887_probe(struct i2c_adapter *adap)
 615 {
 616 #ifdef I2C_CLASS_TV_ANALOG
 617         if (adap->class & I2C_CLASS_TV_ANALOG)
 618                 return i2c_probe(adap, &addr_data, tda9887_attach);
 619 #else
 620         switch (adap->id) {
 621         case I2C_ALGO_BIT | I2C_HW_B_BT848:
 622         case I2C_ALGO_BIT | I2C_HW_B_RIVA:
 623         case I2C_ALGO_SAA7134:
 624                 return i2c_probe(adap, &addr_data, tda9887_attach);
 625                 break;
 626         }
 627 #endif
 628         return 0;
 629 }
 630
 631 static int tda9887_detach(struct i2c_client *client)
 632 {
 633         struct tda9887 *t = i2c_get_clientdata(client);
 634
 635         i2c_detach_client(client);
 636         kfree(t);
 637         return 0;
 638 }
 639
 640 #define SWITCH_V4L2     if (!t->using_v4l2 && debug) \
 641                           printk(PREFIX "switching to v4l2\n"); \
 642                           t->using_v4l2 = 1;
 643 #define CHECK_V4L2      if (t->using_v4l2) { if (debug) \
 644                           printk(PREFIX "ignore v4l1 call\n"); \
 645                           return 0; }
 646
 647 static int
 648 tda9887_command(struct i2c_client *client, unsigned int cmd, void *arg)
 649 {
 650         struct tda9887 *t = i2c_get_clientdata(client);
 651
 652         switch (cmd) {
 653
 654         /* --- configuration --- */
 655         case AUDC_SET_RADIO:
 656                 t->radio = 1;
 657                 tda9887_configure(t);
 658                 break;
 659
 660         case AUDC_CONFIG_PINNACLE:
 661         {
 662                 int *i = arg;
 663
 664                 t->pinnacle_id = *i;
 665                 tda9887_configure(t);
 666                 break;
 667         }
 668         case TDA9887_SET_CONFIG:
 669         {
 670                 int *i = arg;
 671
 672                 t->config = *i;
 673                 tda9887_configure(t);
 674                 break;
 675         }
 676         /* --- v4l ioctls --- */
 677         /* take care: bttv does userspace copying, we'll get a
 678            kernel pointer here... */
 679         case VIDIOCSCHAN:
 680         {
 681                 static const v4l2_std_id map[] = {
 682                         [ VIDEO_MODE_PAL   ] = V4L2_STD_PAL,
 683                         [ VIDEO_MODE_NTSC  ] = V4L2_STD_NTSC_M,
 684                         [ VIDEO_MODE_SECAM ] = V4L2_STD_SECAM,
 685                         [ 4 /* bttv */     ] = V4L2_STD_PAL_M,
 686                         [ 5 /* bttv */     ] = V4L2_STD_PAL_N,
 687                         [ 6 /* bttv */     ] = V4L2_STD_NTSC_M_JP,
 688                 };
 689                 struct video_channel *vc = arg;
 690
 691                 CHECK_V4L2;
 692                 t->radio = 0;
 693                 if (vc->norm < ARRAY_SIZE(map))
 694                         t->std = map[vc->norm];
 695                 tda9887_fixup_std(t);
 696                 tda9887_configure(t);
 697                 break;
 698         }
 699         case VIDIOC_S_STD:
 700         {
 701                 v4l2_std_id *id = arg;
 702
 703                 SWITCH_V4L2;
 704                 t->radio = 0;
 705                 t->std   = *id;
 706                 tda9887_fixup_std(t);
 707                 tda9887_configure(t);
 708                 break;
 709         }
 710         case VIDIOC_S_FREQUENCY:
 711         {
 712                 struct v4l2_frequency *f = arg;
 713
 714                 SWITCH_V4L2;
 715                 if (V4L2_TUNER_ANALOG_TV == f->type) {
 716                         if (t->radio == 0)
 717                                 return 0;
 718                         t->radio = 0;
 719                 }
 720                 if (V4L2_TUNER_RADIO == f->type) {
 721                         if (t->radio == 1)
 722                                 return 0;
 723                         t->radio = 1;
 724                 }
 725                 tda9887_configure(t);
 726                 break;
 727         }
 728         case VIDIOC_G_TUNER:
 729         {
 730                 static int AFC_BITS_2_kHz[] = {
 731                         -12500,  -37500,  -62500,  -97500,
 732                         -112500, -137500, -162500, -187500,
 733                         187500,  162500,  137500,  112500,
 734                         97500 ,  62500,   37500 ,  12500
 735                 };
 736                 struct v4l2_tuner* tuner = arg;
 737
 738                 if (t->radio) {
 739                         __u8 reg = 0;
 740                         tuner->afc=0;
 741                         if (1 == i2c_master_recv(&t->client,&reg,1))
 742                                 tuner->afc = AFC_BITS_2_kHz[(reg>>1)&0x0f];
 743                 }
 744                 break;
 745         }
 746         case VIDIOC_S_TUNER:
 747         {
 748                 struct v4l2_tuner* tuner = arg;
 749
 750                 if (t->radio) {
 751                         t->radio_mode = tuner->audmode;
 752                         tda9887_configure (t);
 753                 }
 754                 break;
 755         }
 756         default:
 757                 /* nothing */
 758                 break;
 759         }
 760         return 0;
 761 }
 762
 763 static int tda9887_suspend(struct device * dev, u32 state, u32 level)
 764 {
 765         dprintk("tda9887: suspend\n");
 766         return 0;
 767 }
 768
 769 static int tda9887_resume(struct device * dev, u32 level)
 770 {
 771         struct i2c_client *c = container_of(dev, struct i2c_client, dev);
 772         struct tda9887 *t = i2c_get_clientdata(c);
 773
 774         dprintk("tda9887: resume\n");
 775         tda9887_configure(t);
 776         return 0;
 777 }
 778
 779 /* ----------------------------------------------------------------------- */
 780
 781 static struct i2c_driver driver = {
 782         .owner          = THIS_MODULE,
 783         .name           = "i2c tda9887 driver",
 784         .id             = -1, /* FIXME */
 785         .flags          = I2C_DF_NOTIFY,
 786         .attach_adapter = tda9887_probe,
 787         .detach_client  = tda9887_detach,
 788         .command        = tda9887_command,
 789         .driver = {
 790                 .suspend = tda9887_suspend,
 791                 .resume  = tda9887_resume,
 792         },
 793 };
 794 static struct i2c_client client_template =
 795 {
 796         I2C_DEVNAME("tda9887"),
 797         .flags     = I2C_CLIENT_ALLOW_USE,
 798         .driver    = &driver,
 799 };
 800
 801 static int __init tda9887_init_module(void)
 802 {
 803         return i2c_add_driver(&driver);
 804 }
 805
 806 static void __exit tda9887_cleanup_module(void)
 807 {
 808         i2c_del_driver(&driver);
 809 }
 810
 811 module_init(tda9887_init_module);
 812 module_exit(tda9887_cleanup_module);
 813
 814 /*
 815  * Overrides for Emacs so that we follow Linus's tabbing style.
 816  * ---------------------------------------------------------------------------
 817  * Local variables:
 818  * c-basic-offset: 8
 819  * End:
 820  */