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