drivers/media/video/tvaudio.c

   1 /*
   2  * Driver for simple i2c audio chips.
   3  *
   4  * Copyright (c) 2000 Gerd Knorr
   5  * based on code by:
   6  *   Eric Sandeen (eric_sandeen@bigfoot.com)
   7  *   Steve VanDeBogart (vandebo@uclink.berkeley.edu)
   8  *   Greg Alexander (galexand@acm.org)
   9  *
  10  * Copyright(c) 2005-2008 Mauro Carvalho Chehab
  11  *      - Some cleanups, code fixes, etc
  12  *      - Convert it to V4L2 API
  13  *
  14  * This code is placed under the terms of the GNU General Public License
  15  *
  16  * OPTIONS:
  17  *   debug - set to 1 if you'd like to see debug messages
  18  *
  19  */
  20
  21 #include <linux/module.h>
  22 #include <linux/kernel.h>
  23 #include <linux/sched.h>
  24 #include <linux/string.h>
  25 #include <linux/timer.h>
  26 #include <linux/delay.h>
  27 #include <linux/errno.h>
  28 #include <linux/slab.h>
  29 #include <linux/videodev2.h>
  30 #include <linux/i2c.h>
  31 #include <linux/init.h>
  32 #include <linux/kthread.h>
  33 #include <linux/freezer.h>
  34
  35 #include <media/tvaudio.h>
  36 #include <media/v4l2-device.h>
  37 #include <media/v4l2-chip-ident.h>
  38
  39 #include <media/i2c-addr.h>
  40
  41 /* ---------------------------------------------------------------------- */
  42 /* insmod args                                                            */
  43
  44 static int debug;       /* insmod parameter */
  45 module_param(debug, int, 0644);
  46
  47 MODULE_DESCRIPTION("device driver for various i2c TV sound decoder / audiomux chips");
  48 MODULE_AUTHOR("Eric Sandeen, Steve VanDeBogart, Greg Alexander, Gerd Knorr");
  49 MODULE_LICENSE("GPL");
  50
  51 #define UNSET    (-1U)
  52
  53 /* ---------------------------------------------------------------------- */
  54 /* our structs                                                            */
  55
  56 #define MAXREGS 256
  57
  58 struct CHIPSTATE;
  59 typedef int  (*getvalue)(int);
  60 typedef int  (*checkit)(struct CHIPSTATE*);
  61 typedef int  (*initialize)(struct CHIPSTATE*);
  62 typedef int  (*getmode)(struct CHIPSTATE*);
  63 typedef void (*setmode)(struct CHIPSTATE*, int mode);
  64
  65 /* i2c command */
  66 typedef struct AUDIOCMD {
  67         int             count;             /* # of bytes to send */
  68         unsigned char   bytes[MAXREGS+1];  /* addr, data, data, ... */
  69 } audiocmd;
  70
  71 /* chip description */
  72 struct CHIPDESC {
  73         char       *name;             /* chip name         */
  74         int        addr_lo, addr_hi;  /* i2c address range */
  75         int        registers;         /* # of registers    */
  76
  77         int        *insmodopt;
  78         checkit    checkit;
  79         initialize initialize;
  80         int        flags;
  81 #define CHIP_HAS_VOLUME      1
  82 #define CHIP_HAS_BASSTREBLE  2
  83 #define CHIP_HAS_INPUTSEL    4
  84 #define CHIP_NEED_CHECKMODE  8
  85
  86         /* various i2c command sequences */
  87         audiocmd   init;
  88
  89         /* which register has which value */
  90         int    leftreg,rightreg,treblereg,bassreg;
  91
  92         /* initialize with (defaults to 65535/65535/32768/32768 */
  93         int    leftinit,rightinit,trebleinit,bassinit;
  94
  95         /* functions to convert the values (v4l -> chip) */
  96         getvalue volfunc,treblefunc,bassfunc;
  97
  98         /* get/set mode */
  99         getmode  getmode;
 100         setmode  setmode;
 101
 102         /* input switch register + values for v4l inputs */
 103         int  inputreg;
 104         int  inputmap[4];
 105         int  inputmute;
 106         int  inputmask;
 107 };
 108
 109 /* current state of the chip */
 110 struct CHIPSTATE {
 111         struct v4l2_subdev sd;
 112
 113         /* chip-specific description - should point to
 114            an entry at CHIPDESC table */
 115         struct CHIPDESC *desc;
 116
 117         /* shadow register set */
 118         audiocmd   shadow;
 119
 120         /* current settings */
 121         __u16 left, right, treble, bass, muted;
 122         int prevmode;
 123         int radio;
 124         int input;
 125
 126         /* thread */
 127         struct task_struct   *thread;
 128         struct timer_list    wt;
 129         int                  audmode;
 130 };
 131
 132 static inline struct CHIPSTATE *to_state(struct v4l2_subdev *sd)
 133 {
 134         return container_of(sd, struct CHIPSTATE, sd);
 135 }
 136
 137
 138 /* ---------------------------------------------------------------------- */
 139 /* i2c I/O functions                                                      */
 140
 141 static int chip_write(struct CHIPSTATE *chip, int subaddr, int val)
 142 {
 143         struct v4l2_subdev *sd = &chip->sd;
 144         struct i2c_client *c = v4l2_get_subdevdata(sd);
 145         unsigned char buffer[2];
 146
 147         if (subaddr < 0) {
 148                 v4l2_dbg(1, debug, sd, "chip_write: 0x%x\n", val);
 149                 chip->shadow.bytes[1] = val;
 150                 buffer[0] = val;
 151                 if (1 != i2c_master_send(c, buffer, 1)) {
 152                         v4l2_warn(sd, "I/O error (write 0x%x)\n", val);
 153                         return -1;
 154                 }
 155         } else {
 156                 if (subaddr + 1 >= ARRAY_SIZE(chip->shadow.bytes)) {
 157                         v4l2_info(sd,
 158                                 "Tried to access a non-existent register: %d\n",
 159                                 subaddr);
 160                         return -EINVAL;
 161                 }
 162
 163                 v4l2_dbg(1, debug, sd, "chip_write: reg%d=0x%x\n",
 164                         subaddr, val);
 165                 chip->shadow.bytes[subaddr+1] = val;
 166                 buffer[0] = subaddr;
 167                 buffer[1] = val;
 168                 if (2 != i2c_master_send(c, buffer, 2)) {
 169                         v4l2_warn(sd, "I/O error (write reg%d=0x%x)\n",
 170                                 subaddr, val);
 171                         return -1;
 172                 }
 173         }
 174         return 0;
 175 }
 176
 177 static int chip_write_masked(struct CHIPSTATE *chip,
 178                              int subaddr, int val, int mask)
 179 {
 180         struct v4l2_subdev *sd = &chip->sd;
 181
 182         if (mask != 0) {
 183                 if (subaddr < 0) {
 184                         val = (chip->shadow.bytes[1] & ~mask) | (val & mask);
 185                 } else {
 186                         if (subaddr + 1 >= ARRAY_SIZE(chip->shadow.bytes)) {
 187                                 v4l2_info(sd,
 188                                         "Tried to access a non-existent register: %d\n",
 189                                         subaddr);
 190                                 return -EINVAL;
 191                         }
 192
 193                         val = (chip->shadow.bytes[subaddr+1] & ~mask) | (val & mask);
 194                 }
 195         }
 196         return chip_write(chip, subaddr, val);
 197 }
 198
 199 static int chip_read(struct CHIPSTATE *chip)
 200 {
 201         struct v4l2_subdev *sd = &chip->sd;
 202         struct i2c_client *c = v4l2_get_subdevdata(sd);
 203         unsigned char buffer;
 204
 205         if (1 != i2c_master_recv(c, &buffer, 1)) {
 206                 v4l2_warn(sd, "I/O error (read)\n");
 207                 return -1;
 208         }
 209         v4l2_dbg(1, debug, sd, "chip_read: 0x%x\n", buffer);
 210         return buffer;
 211 }
 212
 213 static int chip_read2(struct CHIPSTATE *chip, int subaddr)
 214 {
 215         struct v4l2_subdev *sd = &chip->sd;
 216         struct i2c_client *c = v4l2_get_subdevdata(sd);
 217         unsigned char write[1];
 218         unsigned char read[1];
 219         struct i2c_msg msgs[2] = {
 220                 { c->addr, 0,        1, write },
 221                 { c->addr, I2C_M_RD, 1, read  }
 222         };
 223
 224         write[0] = subaddr;
 225
 226         if (2 != i2c_transfer(c->adapter, msgs, 2)) {
 227                 v4l2_warn(sd, "I/O error (read2)\n");
 228                 return -1;
 229         }
 230         v4l2_dbg(1, debug, sd, "chip_read2: reg%d=0x%x\n",
 231                 subaddr, read[0]);
 232         return read[0];
 233 }
 234
 235 static int chip_cmd(struct CHIPSTATE *chip, char *name, audiocmd *cmd)
 236 {
 237         struct v4l2_subdev *sd = &chip->sd;
 238         struct i2c_client *c = v4l2_get_subdevdata(sd);
 239         int i;
 240
 241         if (0 == cmd->count)
 242                 return 0;
 243
 244         if (cmd->count + cmd->bytes[0] - 1 >= ARRAY_SIZE(chip->shadow.bytes)) {
 245                 v4l2_info(sd,
 246                          "Tried to access a non-existent register range: %d to %d\n",
 247                          cmd->bytes[0] + 1, cmd->bytes[0] + cmd->count - 1);
 248                 return -EINVAL;
 249         }
 250
 251         /* FIXME: it seems that the shadow bytes are wrong bellow !*/
 252
 253         /* update our shadow register set; print bytes if (debug > 0) */
 254         v4l2_dbg(1, debug, sd, "chip_cmd(%s): reg=%d, data:",
 255                 name, cmd->bytes[0]);
 256         for (i = 1; i < cmd->count; i++) {
 257                 if (debug)
 258                         printk(KERN_CONT " 0x%x", cmd->bytes[i]);
 259                 chip->shadow.bytes[i+cmd->bytes[0]] = cmd->bytes[i];
 260         }
 261         if (debug)
 262                 printk(KERN_CONT "\n");
 263
 264         /* send data to the chip */
 265         if (cmd->count != i2c_master_send(c, cmd->bytes, cmd->count)) {
 266                 v4l2_warn(sd, "I/O error (%s)\n", name);
 267                 return -1;
 268         }
 269         return 0;
 270 }
 271
 272 /* ---------------------------------------------------------------------- */
 273 /* kernel thread for doing i2c stuff asyncronly
 274  *   right now it is used only to check the audio mode (mono/stereo/whatever)
 275  *   some time after switching to another TV channel, then turn on stereo
 276  *   if available, ...
 277  */
 278
 279 static void chip_thread_wake(unsigned long data)
 280 {
 281         struct CHIPSTATE *chip = (struct CHIPSTATE*)data;
 282         wake_up_process(chip->thread);
 283 }
 284
 285 static int chip_thread(void *data)
 286 {
 287         struct CHIPSTATE *chip = data;
 288         struct CHIPDESC  *desc = chip->desc;
 289         struct v4l2_subdev *sd = &chip->sd;
 290         int mode, selected;
 291
 292         v4l2_dbg(1, debug, sd, "thread started\n");
 293         set_freezable();
 294         for (;;) {
 295                 set_current_state(TASK_INTERRUPTIBLE);
 296                 if (!kthread_should_stop())
 297                         schedule();
 298                 set_current_state(TASK_RUNNING);
 299                 try_to_freeze();
 300                 if (kthread_should_stop())
 301                         break;
 302                 v4l2_dbg(1, debug, sd, "thread wakeup\n");
 303
 304                 /* don't do anything for radio */
 305                 if (chip->radio)
 306                         continue;
 307
 308                 /* have a look what's going on */
 309                 mode = desc->getmode(chip);
 310                 if (mode == chip->prevmode)
 311                         continue;
 312
 313                 /* chip detected a new audio mode - set it */
 314                 v4l2_dbg(1, debug, sd, "thread checkmode\n");
 315
 316                 chip->prevmode = mode;
 317
 318                 selected = V4L2_TUNER_MODE_MONO;
 319                 switch (chip->audmode) {
 320                 case V4L2_TUNER_MODE_MONO:
 321                         if (mode & V4L2_TUNER_SUB_LANG1)
 322                                 selected = V4L2_TUNER_MODE_LANG1;
 323                         break;
 324                 case V4L2_TUNER_MODE_STEREO:
 325                 case V4L2_TUNER_MODE_LANG1:
 326                         if (mode & V4L2_TUNER_SUB_LANG1)
 327                                 selected = V4L2_TUNER_MODE_LANG1;
 328                         else if (mode & V4L2_TUNER_SUB_STEREO)
 329                                 selected = V4L2_TUNER_MODE_STEREO;
 330                         break;
 331                 case V4L2_TUNER_MODE_LANG2:
 332                         if (mode & V4L2_TUNER_SUB_LANG2)
 333                                 selected = V4L2_TUNER_MODE_LANG2;
 334                         else if (mode & V4L2_TUNER_SUB_STEREO)
 335                                 selected = V4L2_TUNER_MODE_STEREO;
 336                         break;
 337                 case V4L2_TUNER_MODE_LANG1_LANG2:
 338                         if (mode & V4L2_TUNER_SUB_LANG2)
 339                                 selected = V4L2_TUNER_MODE_LANG1_LANG2;
 340                         else if (mode & V4L2_TUNER_SUB_STEREO)
 341                                 selected = V4L2_TUNER_MODE_STEREO;
 342                 }
 343                 desc->setmode(chip, selected);
 344
 345                 /* schedule next check */
 346                 mod_timer(&chip->wt, jiffies+msecs_to_jiffies(2000));
 347         }
 348
 349         v4l2_dbg(1, debug, sd, "thread exiting\n");
 350         return 0;
 351 }
 352
 353 /* ---------------------------------------------------------------------- */
 354 /* audio chip descriptions - defines+functions for tda9840                */
 355
 356 #define TDA9840_SW         0x00
 357 #define TDA9840_LVADJ      0x02
 358 #define TDA9840_STADJ      0x03
 359 #define TDA9840_TEST       0x04
 360
 361 #define TDA9840_MONO       0x10
 362 #define TDA9840_STEREO     0x2a
 363 #define TDA9840_DUALA      0x12
 364 #define TDA9840_DUALB      0x1e
 365 #define TDA9840_DUALAB     0x1a
 366 #define TDA9840_DUALBA     0x16
 367 #define TDA9840_EXTERNAL   0x7a
 368
 369 #define TDA9840_DS_DUAL    0x20 /* Dual sound identified          */
 370 #define TDA9840_ST_STEREO  0x40 /* Stereo sound identified        */
 371 #define TDA9840_PONRES     0x80 /* Power-on reset detected if = 1 */
 372
 373 #define TDA9840_TEST_INT1SN 0x1 /* Integration time 0.5s when set */
 374 #define TDA9840_TEST_INTFU 0x02 /* Disables integrator function */
 375
 376 static int tda9840_getmode(struct CHIPSTATE *chip)
 377 {
 378         struct v4l2_subdev *sd = &chip->sd;
 379         int val, mode;
 380
 381         val = chip_read(chip);
 382         mode = V4L2_TUNER_SUB_MONO;
 383         if (val & TDA9840_DS_DUAL)
 384                 mode |= V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
 385         if (val & TDA9840_ST_STEREO)
 386                 mode |= V4L2_TUNER_SUB_STEREO;
 387
 388         v4l2_dbg(1, debug, sd, "tda9840_getmode(): raw chip read: %d, return: %d\n",
 389                 val, mode);
 390         return mode;
 391 }
 392
 393 static void tda9840_setmode(struct CHIPSTATE *chip, int mode)
 394 {
 395         int update = 1;
 396         int t = chip->shadow.bytes[TDA9840_SW + 1] & ~0x7e;
 397
 398         switch (mode) {
 399         case V4L2_TUNER_MODE_MONO:
 400                 t |= TDA9840_MONO;
 401                 break;
 402         case V4L2_TUNER_MODE_STEREO:
 403                 t |= TDA9840_STEREO;
 404                 break;
 405         case V4L2_TUNER_MODE_LANG1:
 406                 t |= TDA9840_DUALA;
 407                 break;
 408         case V4L2_TUNER_MODE_LANG2:
 409                 t |= TDA9840_DUALB;
 410                 break;
 411         case V4L2_TUNER_MODE_LANG1_LANG2:
 412                 t |= TDA9840_DUALAB;
 413                 break;
 414         default:
 415                 update = 0;
 416         }
 417
 418         if (update)
 419                 chip_write(chip, TDA9840_SW, t);
 420 }
 421
 422 static int tda9840_checkit(struct CHIPSTATE *chip)
 423 {
 424         int rc;
 425         rc = chip_read(chip);
 426         /* lower 5 bits should be 0 */
 427         return ((rc & 0x1f) == 0) ? 1 : 0;
 428 }
 429
 430 /* ---------------------------------------------------------------------- */
 431 /* audio chip descriptions - defines+functions for tda985x                */
 432
 433 /* subaddresses for TDA9855 */
 434 #define TDA9855_VR      0x00 /* Volume, right */
 435 #define TDA9855_VL      0x01 /* Volume, left */
 436 #define TDA9855_BA      0x02 /* Bass */
 437 #define TDA9855_TR      0x03 /* Treble */
 438 #define TDA9855_SW      0x04 /* Subwoofer - not connected on DTV2000 */
 439
 440 /* subaddresses for TDA9850 */
 441 #define TDA9850_C4      0x04 /* Control 1 for TDA9850 */
 442
 443 /* subaddesses for both chips */
 444 #define TDA985x_C5      0x05 /* Control 2 for TDA9850, Control 1 for TDA9855 */
 445 #define TDA985x_C6      0x06 /* Control 3 for TDA9850, Control 2 for TDA9855 */
 446 #define TDA985x_C7      0x07 /* Control 4 for TDA9850, Control 3 for TDA9855 */
 447 #define TDA985x_A1      0x08 /* Alignment 1 for both chips */
 448 #define TDA985x_A2      0x09 /* Alignment 2 for both chips */
 449 #define TDA985x_A3      0x0a /* Alignment 3 for both chips */
 450
 451 /* Masks for bits in TDA9855 subaddresses */
 452 /* 0x00 - VR in TDA9855 */
 453 /* 0x01 - VL in TDA9855 */
 454 /* lower 7 bits control gain from -71dB (0x28) to 16dB (0x7f)
 455  * in 1dB steps - mute is 0x27 */
 456
 457
 458 /* 0x02 - BA in TDA9855 */
 459 /* lower 5 bits control bass gain from -12dB (0x06) to 16.5dB (0x19)
 460  * in .5dB steps - 0 is 0x0E */
 461
 462
 463 /* 0x03 - TR in TDA9855 */
 464 /* 4 bits << 1 control treble gain from -12dB (0x3) to 12dB (0xb)
 465  * in 3dB steps - 0 is 0x7 */
 466
 467 /* Masks for bits in both chips' subaddresses */
 468 /* 0x04 - SW in TDA9855, C4/Control 1 in TDA9850 */
 469 /* Unique to TDA9855: */
 470 /* 4 bits << 2 control subwoofer/surround gain from -14db (0x1) to 14db (0xf)
 471  * in 3dB steps - mute is 0x0 */
 472
 473 /* Unique to TDA9850: */
 474 /* lower 4 bits control stereo noise threshold, over which stereo turns off
 475  * set to values of 0x00 through 0x0f for Ster1 through Ster16 */
 476
 477
 478 /* 0x05 - C5 - Control 1 in TDA9855 , Control 2 in TDA9850*/
 479 /* Unique to TDA9855: */
 480 #define TDA9855_MUTE    1<<7 /* GMU, Mute at outputs */
 481 #define TDA9855_AVL     1<<6 /* AVL, Automatic Volume Level */
 482 #define TDA9855_LOUD    1<<5 /* Loudness, 1==off */
 483 #define TDA9855_SUR     1<<3 /* Surround / Subwoofer 1==.5(L-R) 0==.5(L+R) */
 484                              /* Bits 0 to 3 select various combinations
 485                               * of line in and line out, only the
 486                               * interesting ones are defined */
 487 #define TDA9855_EXT     1<<2 /* Selects inputs LIR and LIL.  Pins 41 & 12 */
 488 #define TDA9855_INT     0    /* Selects inputs LOR and LOL.  (internal) */
 489
 490 /* Unique to TDA9850:  */
 491 /* lower 4 bits contol SAP noise threshold, over which SAP turns off
 492  * set to values of 0x00 through 0x0f for SAP1 through SAP16 */
 493
 494
 495 /* 0x06 - C6 - Control 2 in TDA9855, Control 3 in TDA9850 */
 496 /* Common to TDA9855 and TDA9850: */
 497 #define TDA985x_SAP     3<<6 /* Selects SAP output, mute if not received */
 498 #define TDA985x_MONOSAP 2<<6 /* Selects Mono on left, SAP on right */
 499 #define TDA985x_STEREO  1<<6 /* Selects Stereo ouput, mono if not received */
 500 #define TDA985x_MONO    0    /* Forces Mono output */
 501 #define TDA985x_LMU     1<<3 /* Mute (LOR/LOL for 9855, OUTL/OUTR for 9850) */
 502
 503 /* Unique to TDA9855: */
 504 #define TDA9855_TZCM    1<<5 /* If set, don't mute till zero crossing */
 505 #define TDA9855_VZCM    1<<4 /* If set, don't change volume till zero crossing*/
 506 #define TDA9855_LINEAR  0    /* Linear Stereo */
 507 #define TDA9855_PSEUDO  1    /* Pseudo Stereo */
 508 #define TDA9855_SPAT_30 2    /* Spatial Stereo, 30% anti-phase crosstalk */
 509 #define TDA9855_SPAT_50 3    /* Spatial Stereo, 52% anti-phase crosstalk */
 510 #define TDA9855_E_MONO  7    /* Forced mono - mono select elseware, so useless*/
 511
 512 /* 0x07 - C7 - Control 3 in TDA9855, Control 4 in TDA9850 */
 513 /* Common to both TDA9855 and TDA9850: */
 514 /* lower 4 bits control input gain from -3.5dB (0x0) to 4dB (0xF)
 515  * in .5dB steps -  0dB is 0x7 */
 516
 517 /* 0x08, 0x09 - A1 and A2 (read/write) */
 518 /* Common to both TDA9855 and TDA9850: */
 519 /* lower 5 bites are wideband and spectral expander alignment
 520  * from 0x00 to 0x1f - nominal at 0x0f and 0x10 (read/write) */
 521 #define TDA985x_STP     1<<5 /* Stereo Pilot/detect (read-only) */
 522 #define TDA985x_SAPP    1<<6 /* SAP Pilot/detect (read-only) */
 523 #define TDA985x_STS     1<<7 /* Stereo trigger 1= <35mV 0= <30mV (write-only)*/
 524
 525 /* 0x0a - A3 */
 526 /* Common to both TDA9855 and TDA9850: */
 527 /* lower 3 bits control timing current for alignment: -30% (0x0), -20% (0x1),
 528  * -10% (0x2), nominal (0x3), +10% (0x6), +20% (0x5), +30% (0x4) */
 529 #define TDA985x_ADJ     1<<7 /* Stereo adjust on/off (wideband and spectral */
 530
 531 static int tda9855_volume(int val) { return val/0x2e8+0x27; }
 532 static int tda9855_bass(int val)   { return val/0xccc+0x06; }
 533 static int tda9855_treble(int val) { return (val/0x1c71+0x3)<<1; }
 534
 535 static int  tda985x_getmode(struct CHIPSTATE *chip)
 536 {
 537         int mode, val;
 538
 539         /* Add mono mode regardless of SAP and stereo */
 540         /* Allows forced mono */
 541         mode = V4L2_TUNER_SUB_MONO;
 542         val = chip_read(chip);
 543         if (val & TDA985x_STP)
 544                 mode |= V4L2_TUNER_SUB_STEREO;
 545         if (val & TDA985x_SAPP)
 546                 mode |= V4L2_TUNER_SUB_SAP;
 547         return mode;
 548 }
 549
 550 static void tda985x_setmode(struct CHIPSTATE *chip, int mode)
 551 {
 552         int update = 1;
 553         int c6 = chip->shadow.bytes[TDA985x_C6+1] & 0x3f;
 554
 555         switch (mode) {
 556         case V4L2_TUNER_MODE_MONO:
 557                 c6 |= TDA985x_MONO;
 558                 break;
 559         case V4L2_TUNER_MODE_STEREO:
 560         case V4L2_TUNER_MODE_LANG1:
 561                 c6 |= TDA985x_STEREO;
 562                 break;
 563         case V4L2_TUNER_MODE_SAP:
 564                 c6 |= TDA985x_SAP;
 565                 break;
 566         case V4L2_TUNER_MODE_LANG1_LANG2:
 567                 c6 |= TDA985x_MONOSAP;
 568                 break;
 569         default:
 570                 update = 0;
 571         }
 572         if (update)
 573                 chip_write(chip,TDA985x_C6,c6);
 574 }
 575
 576
 577 /* ---------------------------------------------------------------------- */
 578 /* audio chip descriptions - defines+functions for tda9873h               */
 579
 580 /* Subaddresses for TDA9873H */
 581
 582 #define TDA9873_SW      0x00 /* Switching                    */
 583 #define TDA9873_AD      0x01 /* Adjust                       */
 584 #define TDA9873_PT      0x02 /* Port                         */
 585
 586 /* Subaddress 0x00: Switching Data
 587  * B7..B0:
 588  *
 589  * B1, B0: Input source selection
 590  *  0,  0  internal
 591  *  1,  0  external stereo
 592  *  0,  1  external mono
 593  */
 594 #define TDA9873_INP_MASK    3
 595 #define TDA9873_INTERNAL    0
 596 #define TDA9873_EXT_STEREO  2
 597 #define TDA9873_EXT_MONO    1
 598
 599 /*    B3, B2: output signal select
 600  * B4    : transmission mode
 601  *  0, 0, 1   Mono
 602  *  1, 0, 0   Stereo
 603  *  1, 1, 1   Stereo (reversed channel)
 604  *  0, 0, 0   Dual AB
 605  *  0, 0, 1   Dual AA
 606  *  0, 1, 0   Dual BB
 607  *  0, 1, 1   Dual BA
 608  */
 609
 610 #define TDA9873_TR_MASK     (7 << 2)
 611 #define TDA9873_TR_MONO     4
 612 #define TDA9873_TR_STEREO   1 << 4
 613 #define TDA9873_TR_REVERSE  ((1 << 3) | (1 << 2))
 614 #define TDA9873_TR_DUALA    1 << 2
 615 #define TDA9873_TR_DUALB    1 << 3
 616 #define TDA9873_TR_DUALAB   0
 617
 618 /* output level controls
 619  * B5:  output level switch (0 = reduced gain, 1 = normal gain)
 620  * B6:  mute                (1 = muted)
 621  * B7:  auto-mute           (1 = auto-mute enabled)
 622  */
 623
 624 #define TDA9873_GAIN_NORMAL 1 << 5
 625 #define TDA9873_MUTE        1 << 6
 626 #define TDA9873_AUTOMUTE    1 << 7
 627
 628 /* Subaddress 0x01:  Adjust/standard */
 629
 630 /* Lower 4 bits (C3..C0) control stereo adjustment on R channel (-0.6 - +0.7 dB)
 631  * Recommended value is +0 dB
 632  */
 633
 634 #define TDA9873_STEREO_ADJ      0x06 /* 0dB gain */
 635
 636 /* Bits C6..C4 control FM stantard
 637  * C6, C5, C4
 638  *  0,  0,  0   B/G (PAL FM)
 639  *  0,  0,  1   M
 640  *  0,  1,  0   D/K(1)
 641  *  0,  1,  1   D/K(2)
 642  *  1,  0,  0   D/K(3)
 643  *  1,  0,  1   I
 644  */
 645 #define TDA9873_BG              0
 646 #define TDA9873_M       1
 647 #define TDA9873_DK1     2
 648 #define TDA9873_DK2     3
 649 #define TDA9873_DK3     4
 650 #define TDA9873_I       5
 651
 652 /* C7 controls identification response time (1=fast/0=normal)
 653  */
 654 #define TDA9873_IDR_NORM 0
 655 #define TDA9873_IDR_FAST 1 << 7
 656
 657
 658 /* Subaddress 0x02: Port data */
 659
 660 /* E1, E0   free programmable ports P1/P2
 661     0,  0   both ports low
 662     0,  1   P1 high
 663     1,  0   P2 high
 664     1,  1   both ports high
 665 */
 666
 667 #define TDA9873_PORTS    3
 668
 669 /* E2: test port */
 670 #define TDA9873_TST_PORT 1 << 2
 671
 672 /* E5..E3 control mono output channel (together with transmission mode bit B4)
 673  *
 674  * E5 E4 E3 B4     OUTM
 675  *  0  0  0  0     mono
 676  *  0  0  1  0     DUAL B
 677  *  0  1  0  1     mono (from stereo decoder)
 678  */
 679 #define TDA9873_MOUT_MONO   0
 680 #define TDA9873_MOUT_FMONO  0
 681 #define TDA9873_MOUT_DUALA  0
 682 #define TDA9873_MOUT_DUALB  1 << 3
 683 #define TDA9873_MOUT_ST     1 << 4
 684 #define TDA9873_MOUT_EXTM   ((1 << 4) | (1 << 3))
 685 #define TDA9873_MOUT_EXTL   1 << 5
 686 #define TDA9873_MOUT_EXTR   ((1 << 5) | (1 << 3))
 687 #define TDA9873_MOUT_EXTLR  ((1 << 5) | (1 << 4))
 688 #define TDA9873_MOUT_MUTE   ((1 << 5) | (1 << 4) | (1 << 3))
 689
 690 /* Status bits: (chip read) */
 691 #define TDA9873_PONR        0 /* Power-on reset detected if = 1 */
 692 #define TDA9873_STEREO      2 /* Stereo sound is identified     */
 693 #define TDA9873_DUAL        4 /* Dual sound is identified       */
 694
 695 static int tda9873_getmode(struct CHIPSTATE *chip)
 696 {
 697         struct v4l2_subdev *sd = &chip->sd;
 698         int val,mode;
 699
 700         val = chip_read(chip);
 701         mode = V4L2_TUNER_SUB_MONO;
 702         if (val & TDA9873_STEREO)
 703                 mode |= V4L2_TUNER_SUB_STEREO;
 704         if (val & TDA9873_DUAL)
 705                 mode |= V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
 706         v4l2_dbg(1, debug, sd, "tda9873_getmode(): raw chip read: %d, return: %d\n",
 707                 val, mode);
 708         return mode;
 709 }
 710
 711 static void tda9873_setmode(struct CHIPSTATE *chip, int mode)
 712 {
 713         struct v4l2_subdev *sd = &chip->sd;
 714         int sw_data  = chip->shadow.bytes[TDA9873_SW+1] & ~ TDA9873_TR_MASK;
 715         /*      int adj_data = chip->shadow.bytes[TDA9873_AD+1] ; */
 716
 717         if ((sw_data & TDA9873_INP_MASK) != TDA9873_INTERNAL) {
 718                 v4l2_dbg(1, debug, sd, "tda9873_setmode(): external input\n");
 719                 return;
 720         }
 721
 722         v4l2_dbg(1, debug, sd, "tda9873_setmode(): chip->shadow.bytes[%d] = %d\n", TDA9873_SW+1, chip->shadow.bytes[TDA9873_SW+1]);
 723         v4l2_dbg(1, debug, sd, "tda9873_setmode(): sw_data  = %d\n", sw_data);
 724
 725         switch (mode) {
 726         case V4L2_TUNER_MODE_MONO:
 727                 sw_data |= TDA9873_TR_MONO;
 728                 break;
 729         case V4L2_TUNER_MODE_STEREO:
 730                 sw_data |= TDA9873_TR_STEREO;
 731                 break;
 732         case V4L2_TUNER_MODE_LANG1:
 733                 sw_data |= TDA9873_TR_DUALA;
 734                 break;
 735         case V4L2_TUNER_MODE_LANG2:
 736                 sw_data |= TDA9873_TR_DUALB;
 737                 break;
 738         case V4L2_TUNER_MODE_LANG1_LANG2:
 739                 sw_data |= TDA9873_TR_DUALAB;
 740                 break;
 741         default:
 742                 return;
 743         }
 744
 745         chip_write(chip, TDA9873_SW, sw_data);
 746         v4l2_dbg(1, debug, sd, "tda9873_setmode(): req. mode %d; chip_write: %d\n",
 747                 mode, sw_data);
 748 }
 749
 750 static int tda9873_checkit(struct CHIPSTATE *chip)
 751 {
 752         int rc;
 753
 754         if (-1 == (rc = chip_read2(chip,254)))
 755                 return 0;
 756         return (rc & ~0x1f) == 0x80;
 757 }
 758
 759
 760 /* ---------------------------------------------------------------------- */
 761 /* audio chip description - defines+functions for tda9874h and tda9874a   */
 762 /* Dariusz Kowalewski <darekk@automex.pl>                                 */
 763
 764 /* Subaddresses for TDA9874H and TDA9874A (slave rx) */
 765 #define TDA9874A_AGCGR          0x00    /* AGC gain */
 766 #define TDA9874A_GCONR          0x01    /* general config */
 767 #define TDA9874A_MSR            0x02    /* monitor select */
 768 #define TDA9874A_C1FRA          0x03    /* carrier 1 freq. */
 769 #define TDA9874A_C1FRB          0x04    /* carrier 1 freq. */
 770 #define TDA9874A_C1FRC          0x05    /* carrier 1 freq. */
 771 #define TDA9874A_C2FRA          0x06    /* carrier 2 freq. */
 772 #define TDA9874A_C2FRB          0x07    /* carrier 2 freq. */
 773 #define TDA9874A_C2FRC          0x08    /* carrier 2 freq. */
 774 #define TDA9874A_DCR            0x09    /* demodulator config */
 775 #define TDA9874A_FMER           0x0a    /* FM de-emphasis */
 776 #define TDA9874A_FMMR           0x0b    /* FM dematrix */
 777 #define TDA9874A_C1OLAR         0x0c    /* ch.1 output level adj. */
 778 #define TDA9874A_C2OLAR         0x0d    /* ch.2 output level adj. */
 779 #define TDA9874A_NCONR          0x0e    /* NICAM config */
 780 #define TDA9874A_NOLAR          0x0f    /* NICAM output level adj. */
 781 #define TDA9874A_NLELR          0x10    /* NICAM lower error limit */
 782 #define TDA9874A_NUELR          0x11    /* NICAM upper error limit */
 783 #define TDA9874A_AMCONR         0x12    /* audio mute control */
 784 #define TDA9874A_SDACOSR        0x13    /* stereo DAC output select */
 785 #define TDA9874A_AOSR           0x14    /* analog output select */
 786 #define TDA9874A_DAICONR        0x15    /* digital audio interface config */
 787 #define TDA9874A_I2SOSR         0x16    /* I2S-bus output select */
 788 #define TDA9874A_I2SOLAR        0x17    /* I2S-bus output level adj. */
 789 #define TDA9874A_MDACOSR        0x18    /* mono DAC output select (tda9874a) */
 790 #define TDA9874A_ESP            0xFF    /* easy standard progr. (tda9874a) */
 791
 792 /* Subaddresses for TDA9874H and TDA9874A (slave tx) */
 793 #define TDA9874A_DSR            0x00    /* device status */
 794 #define TDA9874A_NSR            0x01    /* NICAM status */
 795 #define TDA9874A_NECR           0x02    /* NICAM error count */
 796 #define TDA9874A_DR1            0x03    /* add. data LSB */
 797 #define TDA9874A_DR2            0x04    /* add. data MSB */
 798 #define TDA9874A_LLRA           0x05    /* monitor level read-out LSB */
 799 #define TDA9874A_LLRB           0x06    /* monitor level read-out MSB */
 800 #define TDA9874A_SIFLR          0x07    /* SIF level */
 801 #define TDA9874A_TR2            252     /* test reg. 2 */
 802 #define TDA9874A_TR1            253     /* test reg. 1 */
 803 #define TDA9874A_DIC            254     /* device id. code */
 804 #define TDA9874A_SIC            255     /* software id. code */
 805
 806
 807 static int tda9874a_mode = 1;           /* 0: A2, 1: NICAM */
 808 static int tda9874a_GCONR = 0xc0;       /* default config. input pin: SIFSEL=0 */
 809 static int tda9874a_NCONR = 0x01;       /* default NICAM config.: AMSEL=0,AMUTE=1 */
 810 static int tda9874a_ESP = 0x07;         /* default standard: NICAM D/K */
 811 static int tda9874a_dic = -1;           /* device id. code */
 812
 813 /* insmod options for tda9874a */
 814 static unsigned int tda9874a_SIF   = UNSET;
 815 static unsigned int tda9874a_AMSEL = UNSET;
 816 static unsigned int tda9874a_STD   = UNSET;
 817 module_param(tda9874a_SIF, int, 0444);
 818 module_param(tda9874a_AMSEL, int, 0444);
 819 module_param(tda9874a_STD, int, 0444);
 820
 821 /*
 822  * initialization table for tda9874 decoder:
 823  *  - carrier 1 freq. registers (3 bytes)
 824  *  - carrier 2 freq. registers (3 bytes)
 825  *  - demudulator config register
 826  *  - FM de-emphasis register (slow identification mode)
 827  * Note: frequency registers must be written in single i2c transfer.
 828  */
 829 static struct tda9874a_MODES {
 830         char *name;
 831         audiocmd cmd;
 832 } tda9874a_modelist[9] = {
 833   {     "A2, B/G", /* default */
 834         { 9, { TDA9874A_C1FRA, 0x72,0x95,0x55, 0x77,0xA0,0x00, 0x00,0x00 }} },
 835   {     "A2, M (Korea)",
 836         { 9, { TDA9874A_C1FRA, 0x5D,0xC0,0x00, 0x62,0x6A,0xAA, 0x20,0x22 }} },
 837   {     "A2, D/K (1)",
 838         { 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x82,0x60,0x00, 0x00,0x00 }} },
 839   {     "A2, D/K (2)",
 840         { 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x8C,0x75,0x55, 0x00,0x00 }} },
 841   {     "A2, D/K (3)",
 842         { 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x77,0xA0,0x00, 0x00,0x00 }} },
 843   {     "NICAM, I",
 844         { 9, { TDA9874A_C1FRA, 0x7D,0x00,0x00, 0x88,0x8A,0xAA, 0x08,0x33 }} },
 845   {     "NICAM, B/G",
 846         { 9, { TDA9874A_C1FRA, 0x72,0x95,0x55, 0x79,0xEA,0xAA, 0x08,0x33 }} },
 847   {     "NICAM, D/K",
 848         { 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x79,0xEA,0xAA, 0x08,0x33 }} },
 849   {     "NICAM, L",
 850         { 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x79,0xEA,0xAA, 0x09,0x33 }} }
 851 };
 852
 853 static int tda9874a_setup(struct CHIPSTATE *chip)
 854 {
 855         struct v4l2_subdev *sd = &chip->sd;
 856
 857         chip_write(chip, TDA9874A_AGCGR, 0x00); /* 0 dB */
 858         chip_write(chip, TDA9874A_GCONR, tda9874a_GCONR);
 859         chip_write(chip, TDA9874A_MSR, (tda9874a_mode) ? 0x03:0x02);
 860         if(tda9874a_dic == 0x11) {
 861                 chip_write(chip, TDA9874A_FMMR, 0x80);
 862         } else { /* dic == 0x07 */
 863                 chip_cmd(chip,"tda9874_modelist",&tda9874a_modelist[tda9874a_STD].cmd);
 864                 chip_write(chip, TDA9874A_FMMR, 0x00);
 865         }
 866         chip_write(chip, TDA9874A_C1OLAR, 0x00); /* 0 dB */
 867         chip_write(chip, TDA9874A_C2OLAR, 0x00); /* 0 dB */
 868         chip_write(chip, TDA9874A_NCONR, tda9874a_NCONR);
 869         chip_write(chip, TDA9874A_NOLAR, 0x00); /* 0 dB */
 870         /* Note: If signal quality is poor you may want to change NICAM */
 871         /* error limit registers (NLELR and NUELR) to some greater values. */
 872         /* Then the sound would remain stereo, but won't be so clear. */
 873         chip_write(chip, TDA9874A_NLELR, 0x14); /* default */
 874         chip_write(chip, TDA9874A_NUELR, 0x50); /* default */
 875
 876         if(tda9874a_dic == 0x11) {
 877                 chip_write(chip, TDA9874A_AMCONR, 0xf9);
 878                 chip_write(chip, TDA9874A_SDACOSR, (tda9874a_mode) ? 0x81:0x80);
 879                 chip_write(chip, TDA9874A_AOSR, 0x80);
 880                 chip_write(chip, TDA9874A_MDACOSR, (tda9874a_mode) ? 0x82:0x80);
 881                 chip_write(chip, TDA9874A_ESP, tda9874a_ESP);
 882         } else { /* dic == 0x07 */
 883                 chip_write(chip, TDA9874A_AMCONR, 0xfb);
 884                 chip_write(chip, TDA9874A_SDACOSR, (tda9874a_mode) ? 0x81:0x80);
 885                 chip_write(chip, TDA9874A_AOSR, 0x00); /* or 0x10 */
 886         }
 887         v4l2_dbg(1, debug, sd, "tda9874a_setup(): %s [0x%02X].\n",
 888                 tda9874a_modelist[tda9874a_STD].name,tda9874a_STD);
 889         return 1;
 890 }
 891
 892 static int tda9874a_getmode(struct CHIPSTATE *chip)
 893 {
 894         struct v4l2_subdev *sd = &chip->sd;
 895         int dsr,nsr,mode;
 896         int necr; /* just for debugging */
 897
 898         mode = V4L2_TUNER_SUB_MONO;
 899
 900         if(-1 == (dsr = chip_read2(chip,TDA9874A_DSR)))
 901                 return mode;
 902         if(-1 == (nsr = chip_read2(chip,TDA9874A_NSR)))
 903                 return mode;
 904         if(-1 == (necr = chip_read2(chip,TDA9874A_NECR)))
 905                 return mode;
 906
 907         /* need to store dsr/nsr somewhere */
 908         chip->shadow.bytes[MAXREGS-2] = dsr;
 909         chip->shadow.bytes[MAXREGS-1] = nsr;
 910
 911         if(tda9874a_mode) {
 912                 /* Note: DSR.RSSF and DSR.AMSTAT bits are also checked.
 913                  * If NICAM auto-muting is enabled, DSR.AMSTAT=1 indicates
 914                  * that sound has (temporarily) switched from NICAM to
 915                  * mono FM (or AM) on 1st sound carrier due to high NICAM bit
 916                  * error count. So in fact there is no stereo in this case :-(
 917                  * But changing the mode to V4L2_TUNER_MODE_MONO would switch
 918                  * external 4052 multiplexer in audio_hook().
 919                  */
 920                 if(nsr & 0x02) /* NSR.S/MB=1 */
 921                         mode |= V4L2_TUNER_SUB_STEREO;
 922                 if(nsr & 0x01) /* NSR.D/SB=1 */
 923                         mode |= V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
 924         } else {
 925                 if(dsr & 0x02) /* DSR.IDSTE=1 */
 926                         mode |= V4L2_TUNER_SUB_STEREO;
 927                 if(dsr & 0x04) /* DSR.IDDUA=1 */
 928                         mode |= V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
 929         }
 930
 931         v4l2_dbg(1, debug, sd, "tda9874a_getmode(): DSR=0x%X, NSR=0x%X, NECR=0x%X, return: %d.\n",
 932                  dsr, nsr, necr, mode);
 933         return mode;
 934 }
 935
 936 static void tda9874a_setmode(struct CHIPSTATE *chip, int mode)
 937 {
 938         struct v4l2_subdev *sd = &chip->sd;
 939
 940         /* Disable/enable NICAM auto-muting (based on DSR.RSSF status bit). */
 941         /* If auto-muting is disabled, we can hear a signal of degrading quality. */
 942         if (tda9874a_mode) {
 943                 if(chip->shadow.bytes[MAXREGS-2] & 0x20) /* DSR.RSSF=1 */
 944                         tda9874a_NCONR &= 0xfe; /* enable */
 945                 else
 946                         tda9874a_NCONR |= 0x01; /* disable */
 947                 chip_write(chip, TDA9874A_NCONR, tda9874a_NCONR);
 948         }
 949
 950         /* Note: TDA9874A supports automatic FM dematrixing (FMMR register)
 951          * and has auto-select function for audio output (AOSR register).
 952          * Old TDA9874H doesn't support these features.
 953          * TDA9874A also has additional mono output pin (OUTM), which
 954          * on same (all?) tv-cards is not used, anyway (as well as MONOIN).
 955          */
 956         if(tda9874a_dic == 0x11) {
 957                 int aosr = 0x80;
 958                 int mdacosr = (tda9874a_mode) ? 0x82:0x80;
 959
 960                 switch(mode) {
 961                 case V4L2_TUNER_MODE_MONO:
 962                 case V4L2_TUNER_MODE_STEREO:
 963                         break;
 964                 case V4L2_TUNER_MODE_LANG1:
 965                         aosr = 0x80; /* auto-select, dual A/A */
 966                         mdacosr = (tda9874a_mode) ? 0x82:0x80;
 967                         break;
 968                 case V4L2_TUNER_MODE_LANG2:
 969                         aosr = 0xa0; /* auto-select, dual B/B */
 970                         mdacosr = (tda9874a_mode) ? 0x83:0x81;
 971                         break;
 972                 case V4L2_TUNER_MODE_LANG1_LANG2:
 973                         aosr = 0x00; /* always route L to L and R to R */
 974                         mdacosr = (tda9874a_mode) ? 0x82:0x80;
 975                         break;
 976                 default:
 977                         return;
 978                 }
 979                 chip_write(chip, TDA9874A_AOSR, aosr);
 980                 chip_write(chip, TDA9874A_MDACOSR, mdacosr);
 981
 982                 v4l2_dbg(1, debug, sd, "tda9874a_setmode(): req. mode %d; AOSR=0x%X, MDACOSR=0x%X.\n",
 983                         mode, aosr, mdacosr);
 984
 985         } else { /* dic == 0x07 */
 986                 int fmmr,aosr;
 987
 988                 switch(mode) {
 989                 case V4L2_TUNER_MODE_MONO:
 990                         fmmr = 0x00; /* mono */
 991                         aosr = 0x10; /* A/A */
 992                         break;
 993                 case V4L2_TUNER_MODE_STEREO:
 994                         if(tda9874a_mode) {
 995                                 fmmr = 0x00;
 996                                 aosr = 0x00; /* handled by NICAM auto-mute */
 997                         } else {
 998                                 fmmr = (tda9874a_ESP == 1) ? 0x05 : 0x04; /* stereo */
 999                                 aosr = 0x00;
1000                         }
1001                         break;
1002                 case V4L2_TUNER_MODE_LANG1:
1003                         fmmr = 0x02; /* dual */
1004                         aosr = 0x10; /* dual A/A */
1005                         break;
1006                 case V4L2_TUNER_MODE_LANG2:
1007                         fmmr = 0x02; /* dual */
1008                         aosr = 0x20; /* dual B/B */
1009                         break;
1010                 case V4L2_TUNER_MODE_LANG1_LANG2:
1011                         fmmr = 0x02; /* dual */
1012                         aosr = 0x00; /* dual A/B */
1013                         break;
1014                 default:
1015                         return;
1016                 }
1017                 chip_write(chip, TDA9874A_FMMR, fmmr);
1018                 chip_write(chip, TDA9874A_AOSR, aosr);
1019
1020                 v4l2_dbg(1, debug, sd, "tda9874a_setmode(): req. mode %d; FMMR=0x%X, AOSR=0x%X.\n",
1021                         mode, fmmr, aosr);
1022         }
1023 }
1024
1025 static int tda9874a_checkit(struct CHIPSTATE *chip)
1026 {
1027         struct v4l2_subdev *sd = &chip->sd;
1028         int dic,sic;    /* device id. and software id. codes */
1029
1030         if(-1 == (dic = chip_read2(chip,TDA9874A_DIC)))
1031                 return 0;
1032         if(-1 == (sic = chip_read2(chip,TDA9874A_SIC)))
1033                 return 0;
1034
1035         v4l2_dbg(1, debug, sd, "tda9874a_checkit(): DIC=0x%X, SIC=0x%X.\n", dic, sic);
1036
1037         if((dic == 0x11)||(dic == 0x07)) {
1038                 v4l2_info(sd, "found tda9874%s.\n", (dic == 0x11) ? "a" : "h");
1039                 tda9874a_dic = dic;     /* remember device id. */
1040                 return 1;
1041         }
1042         return 0;       /* not found */
1043 }
1044
1045 static int tda9874a_initialize(struct CHIPSTATE *chip)
1046 {
1047         if (tda9874a_SIF > 2)
1048                 tda9874a_SIF = 1;
1049         if (tda9874a_STD >= ARRAY_SIZE(tda9874a_modelist))
1050                 tda9874a_STD = 0;
1051         if(tda9874a_AMSEL > 1)
1052                 tda9874a_AMSEL = 0;
1053
1054         if(tda9874a_SIF == 1)
1055                 tda9874a_GCONR = 0xc0;  /* sound IF input 1 */
1056         else
1057                 tda9874a_GCONR = 0xc1;  /* sound IF input 2 */
1058
1059         tda9874a_ESP = tda9874a_STD;
1060         tda9874a_mode = (tda9874a_STD < 5) ? 0 : 1;
1061
1062         if(tda9874a_AMSEL == 0)
1063                 tda9874a_NCONR = 0x01; /* auto-mute: analog mono input */
1064         else
1065                 tda9874a_NCONR = 0x05; /* auto-mute: 1st carrier FM or AM */
1066
1067         tda9874a_setup(chip);
1068         return 0;
1069 }
1070
1071 /* ---------------------------------------------------------------------- */
1072 /* audio chip description - defines+functions for tda9875                 */
1073 /* The TDA9875 is made by Philips Semiconductor
1074  * http://www.semiconductors.philips.com
1075  * TDA9875: I2C-bus controlled DSP audio processor, FM demodulator
1076  *
1077  */
1078
1079 /* subaddresses for TDA9875 */
1080 #define TDA9875_MUT         0x12  /*General mute  (value --> 0b11001100*/
1081 #define TDA9875_CFG         0x01  /* Config register (value --> 0b00000000 */
1082 #define TDA9875_DACOS       0x13  /*DAC i/o select (ADC) 0b0000100*/
1083 #define TDA9875_LOSR        0x16  /*Line output select regirter 0b0100 0001*/
1084
1085 #define TDA9875_CH1V        0x0c  /*Channel 1 volume (mute)*/
1086 #define TDA9875_CH2V        0x0d  /*Channel 2 volume (mute)*/
1087 #define TDA9875_SC1         0x14  /*SCART 1 in (mono)*/
1088 #define TDA9875_SC2         0x15  /*SCART 2 in (mono)*/
1089
1090 #define TDA9875_ADCIS       0x17  /*ADC input select (mono) 0b0110 000*/
1091 #define TDA9875_AER         0x19  /*Audio effect (AVL+Pseudo) 0b0000 0110*/
1092 #define TDA9875_MCS         0x18  /*Main channel select (DAC) 0b0000100*/
1093 #define TDA9875_MVL         0x1a  /* Main volume gauche */
1094 #define TDA9875_MVR         0x1b  /* Main volume droite */
1095 #define TDA9875_MBA         0x1d  /* Main Basse */
1096 #define TDA9875_MTR         0x1e  /* Main treble */
1097 #define TDA9875_ACS         0x1f  /* Auxiliary channel select (FM) 0b0000000*/
1098 #define TDA9875_AVL         0x20  /* Auxiliary volume gauche */
1099 #define TDA9875_AVR         0x21  /* Auxiliary volume droite */
1100 #define TDA9875_ABA         0x22  /* Auxiliary Basse */
1101 #define TDA9875_ATR         0x23  /* Auxiliary treble */
1102
1103 #define TDA9875_MSR         0x02  /* Monitor select register */
1104 #define TDA9875_C1MSB       0x03  /* Carrier 1 (FM) frequency register MSB */
1105 #define TDA9875_C1MIB       0x04  /* Carrier 1 (FM) frequency register (16-8]b */
1106 #define TDA9875_C1LSB       0x05  /* Carrier 1 (FM) frequency register LSB */
1107 #define TDA9875_C2MSB       0x06  /* Carrier 2 (nicam) frequency register MSB */
1108 #define TDA9875_C2MIB       0x07  /* Carrier 2 (nicam) frequency register (16-8]b */
1109 #define TDA9875_C2LSB       0x08  /* Carrier 2 (nicam) frequency register LSB */
1110 #define TDA9875_DCR         0x09  /* Demodulateur configuration regirter*/
1111 #define TDA9875_DEEM        0x0a  /* FM de-emphasis regirter*/
1112 #define TDA9875_FMAT        0x0b  /* FM Matrix regirter*/
1113
1114 /* values */
1115 #define TDA9875_MUTE_ON     0xff /* general mute */
1116 #define TDA9875_MUTE_OFF    0xcc /* general no mute */
1117
1118 static int tda9875_initialize(struct CHIPSTATE *chip)
1119 {
1120         chip_write(chip, TDA9875_CFG, 0xd0); /*reg de config 0 (reset)*/
1121         chip_write(chip, TDA9875_MSR, 0x03);    /* Monitor 0b00000XXX*/
1122         chip_write(chip, TDA9875_C1MSB, 0x00);  /*Car1(FM) MSB XMHz*/
1123         chip_write(chip, TDA9875_C1MIB, 0x00);  /*Car1(FM) MIB XMHz*/
1124         chip_write(chip, TDA9875_C1LSB, 0x00);  /*Car1(FM) LSB XMHz*/
1125         chip_write(chip, TDA9875_C2MSB, 0x00);  /*Car2(NICAM) MSB XMHz*/
1126         chip_write(chip, TDA9875_C2MIB, 0x00);  /*Car2(NICAM) MIB XMHz*/
1127         chip_write(chip, TDA9875_C2LSB, 0x00);  /*Car2(NICAM) LSB XMHz*/
1128         chip_write(chip, TDA9875_DCR, 0x00);    /*Demod config 0x00*/
1129         chip_write(chip, TDA9875_DEEM, 0x44);   /*DE-Emph 0b0100 0100*/
1130         chip_write(chip, TDA9875_FMAT, 0x00);   /*FM Matrix reg 0x00*/
1131         chip_write(chip, TDA9875_SC1, 0x00);    /* SCART 1 (SC1)*/
1132         chip_write(chip, TDA9875_SC2, 0x01);    /* SCART 2 (sc2)*/
1133
1134         chip_write(chip, TDA9875_CH1V, 0x10);  /* Channel volume 1 mute*/
1135         chip_write(chip, TDA9875_CH2V, 0x10);  /* Channel volume 2 mute */
1136         chip_write(chip, TDA9875_DACOS, 0x02); /* sig DAC i/o(in:nicam)*/
1137         chip_write(chip, TDA9875_ADCIS, 0x6f); /* sig ADC input(in:mono)*/
1138         chip_write(chip, TDA9875_LOSR, 0x00);  /* line out (in:mono)*/
1139         chip_write(chip, TDA9875_AER, 0x00);   /*06 Effect (AVL+PSEUDO) */
1140         chip_write(chip, TDA9875_MCS, 0x44);   /* Main ch select (DAC) */
1141         chip_write(chip, TDA9875_MVL, 0x03);   /* Vol Main left 10dB */
1142         chip_write(chip, TDA9875_MVR, 0x03);   /* Vol Main right 10dB*/
1143         chip_write(chip, TDA9875_MBA, 0x00);   /* Main Bass Main 0dB*/
1144         chip_write(chip, TDA9875_MTR, 0x00);   /* Main Treble Main 0dB*/
1145         chip_write(chip, TDA9875_ACS, 0x44);   /* Aux chan select (dac)*/
1146         chip_write(chip, TDA9875_AVL, 0x00);   /* Vol Aux left 0dB*/
1147         chip_write(chip, TDA9875_AVR, 0x00);   /* Vol Aux right 0dB*/
1148         chip_write(chip, TDA9875_ABA, 0x00);   /* Aux Bass Main 0dB*/
1149         chip_write(chip, TDA9875_ATR, 0x00);   /* Aux Aigus Main 0dB*/
1150
1151         chip_write(chip, TDA9875_MUT, 0xcc);   /* General mute  */
1152         return 0;
1153 }
1154
1155 static int tda9875_volume(int val) { return (unsigned char)(val / 602 - 84); }
1156 static int tda9875_bass(int val) { return (unsigned char)(max(-12, val / 2115 - 15)); }
1157 static int tda9875_treble(int val) { return (unsigned char)(val / 2622 - 12); }
1158
1159 /* ----------------------------------------------------------------------- */
1160
1161
1162 /* *********************** *
1163  * i2c interface functions *
1164  * *********************** */
1165
1166 static int tda9875_checkit(struct CHIPSTATE *chip)
1167 {
1168         struct v4l2_subdev *sd = &chip->sd;
1169         int dic, rev;
1170
1171         dic = chip_read2(chip, 254);
1172         rev = chip_read2(chip, 255);
1173
1174         if (dic == 0 || dic == 2) { /* tda9875 and tda9875A */
1175                 v4l2_info(sd, "found tda9875%s rev. %d.\n",
1176                         dic == 0 ? "" : "A", rev);
1177                 return 1;
1178         }
1179         return 0;
1180 }
1181
1182 /* ---------------------------------------------------------------------- */
1183 /* audio chip descriptions - defines+functions for tea6420                */
1184
1185 #define TEA6300_VL         0x00  /* volume left */
1186 #define TEA6300_VR         0x01  /* volume right */
1187 #define TEA6300_BA         0x02  /* bass */
1188 #define TEA6300_TR         0x03  /* treble */
1189 #define TEA6300_FA         0x04  /* fader control */
1190 #define TEA6300_S          0x05  /* switch register */
1191                                  /* values for those registers: */
1192 #define TEA6300_S_SA       0x01  /* stereo A input */
1193 #define TEA6300_S_SB       0x02  /* stereo B */
1194 #define TEA6300_S_SC       0x04  /* stereo C */
1195 #define TEA6300_S_GMU      0x80  /* general mute */
1196
1197 #define TEA6320_V          0x00  /* volume (0-5)/loudness off (6)/zero crossing mute(7) */
1198 #define TEA6320_FFR        0x01  /* fader front right (0-5) */
1199 #define TEA6320_FFL        0x02  /* fader front left (0-5) */
1200 #define TEA6320_FRR        0x03  /* fader rear right (0-5) */
1201 #define TEA6320_FRL        0x04  /* fader rear left (0-5) */
1202 #define TEA6320_BA         0x05  /* bass (0-4) */
1203 #define TEA6320_TR         0x06  /* treble (0-4) */
1204 #define TEA6320_S          0x07  /* switch register */
1205                                  /* values for those registers: */
1206 #define TEA6320_S_SA       0x07  /* stereo A input */
1207 #define TEA6320_S_SB       0x06  /* stereo B */
1208 #define TEA6320_S_SC       0x05  /* stereo C */
1209 #define TEA6320_S_SD       0x04  /* stereo D */
1210 #define TEA6320_S_GMU      0x80  /* general mute */
1211
1212 #define TEA6420_S_SA       0x00  /* stereo A input */
1213 #define TEA6420_S_SB       0x01  /* stereo B */
1214 #define TEA6420_S_SC       0x02  /* stereo C */
1215 #define TEA6420_S_SD       0x03  /* stereo D */
1216 #define TEA6420_S_SE       0x04  /* stereo E */
1217 #define TEA6420_S_GMU      0x05  /* general mute */
1218
1219 static int tea6300_shift10(int val) { return val >> 10; }
1220 static int tea6300_shift12(int val) { return val >> 12; }
1221
1222 /* Assumes 16bit input (values 0x3f to 0x0c are unique, values less than */
1223 /* 0x0c mirror those immediately higher) */
1224 static int tea6320_volume(int val) { return (val / (65535/(63-12)) + 12) & 0x3f; }
1225 static int tea6320_shift11(int val) { return val >> 11; }
1226 static int tea6320_initialize(struct CHIPSTATE * chip)
1227 {
1228         chip_write(chip, TEA6320_FFR, 0x3f);
1229         chip_write(chip, TEA6320_FFL, 0x3f);
1230         chip_write(chip, TEA6320_FRR, 0x3f);
1231         chip_write(chip, TEA6320_FRL, 0x3f);
1232
1233         return 0;
1234 }
1235
1236
1237 /* ---------------------------------------------------------------------- */
1238 /* audio chip descriptions - defines+functions for tda8425                */
1239
1240 #define TDA8425_VL         0x00  /* volume left */
1241 #define TDA8425_VR         0x01  /* volume right */
1242 #define TDA8425_BA         0x02  /* bass */
1243 #define TDA8425_TR         0x03  /* treble */
1244 #define TDA8425_S1         0x08  /* switch functions */
1245                                  /* values for those registers: */
1246 #define TDA8425_S1_OFF     0xEE  /* audio off (mute on) */
1247 #define TDA8425_S1_CH1     0xCE  /* audio channel 1 (mute off) - "linear stereo" mode */
1248 #define TDA8425_S1_CH2     0xCF  /* audio channel 2 (mute off) - "linear stereo" mode */
1249 #define TDA8425_S1_MU      0x20  /* mute bit */
1250 #define TDA8425_S1_STEREO  0x18  /* stereo bits */
1251 #define TDA8425_S1_STEREO_SPATIAL 0x18 /* spatial stereo */
1252 #define TDA8425_S1_STEREO_LINEAR  0x08 /* linear stereo */
1253 #define TDA8425_S1_STEREO_PSEUDO  0x10 /* pseudo stereo */
1254 #define TDA8425_S1_STEREO_MONO    0x00 /* forced mono */
1255 #define TDA8425_S1_ML      0x06        /* language selector */
1256 #define TDA8425_S1_ML_SOUND_A 0x02     /* sound a */
1257 #define TDA8425_S1_ML_SOUND_B 0x04     /* sound b */
1258 #define TDA8425_S1_ML_STEREO  0x06     /* stereo */
1259 #define TDA8425_S1_IS      0x01        /* channel selector */
1260
1261
1262 static int tda8425_shift10(int val) { return (val >> 10) | 0xc0; }
1263 static int tda8425_shift12(int val) { return (val >> 12) | 0xf0; }
1264
1265 static void tda8425_setmode(struct CHIPSTATE *chip, int mode)
1266 {
1267         int s1 = chip->shadow.bytes[TDA8425_S1+1] & 0xe1;
1268
1269         switch (mode) {
1270         case V4L2_TUNER_MODE_LANG1:
1271                 s1 |= TDA8425_S1_ML_SOUND_A;
1272                 s1 |= TDA8425_S1_STEREO_PSEUDO;
1273                 break;
1274         case V4L2_TUNER_MODE_LANG2:
1275                 s1 |= TDA8425_S1_ML_SOUND_B;
1276                 s1 |= TDA8425_S1_STEREO_PSEUDO;
1277                 break;
1278         case V4L2_TUNER_MODE_LANG1_LANG2:
1279                 s1 |= TDA8425_S1_ML_STEREO;
1280                 s1 |= TDA8425_S1_STEREO_LINEAR;
1281                 break;
1282         case V4L2_TUNER_MODE_MONO:
1283                 s1 |= TDA8425_S1_ML_STEREO;
1284                 s1 |= TDA8425_S1_STEREO_MONO;
1285                 break;
1286         case V4L2_TUNER_MODE_STEREO:
1287                 s1 |= TDA8425_S1_ML_STEREO;
1288                 s1 |= TDA8425_S1_STEREO_SPATIAL;
1289                 break;
1290         default:
1291                 return;
1292         }
1293         chip_write(chip,TDA8425_S1,s1);
1294 }
1295
1296
1297 /* ---------------------------------------------------------------------- */
1298 /* audio chip descriptions - defines+functions for pic16c54 (PV951)       */
1299
1300 /* the registers of 16C54, I2C sub address. */
1301 #define PIC16C54_REG_KEY_CODE     0x01         /* Not use. */
1302 #define PIC16C54_REG_MISC         0x02
1303
1304 /* bit definition of the RESET register, I2C data. */
1305 #define PIC16C54_MISC_RESET_REMOTE_CTL 0x01 /* bit 0, Reset to receive the key */
1306                                             /*        code of remote controller */
1307 #define PIC16C54_MISC_MTS_MAIN         0x02 /* bit 1 */
1308 #define PIC16C54_MISC_MTS_SAP          0x04 /* bit 2 */
1309 #define PIC16C54_MISC_MTS_BOTH         0x08 /* bit 3 */
1310 #define PIC16C54_MISC_SND_MUTE         0x10 /* bit 4, Mute Audio(Line-in and Tuner) */
1311 #define PIC16C54_MISC_SND_NOTMUTE      0x20 /* bit 5 */
1312 #define PIC16C54_MISC_SWITCH_TUNER     0x40 /* bit 6    , Switch to Line-in */
1313 #define PIC16C54_MISC_SWITCH_LINE      0x80 /* bit 7    , Switch to Tuner */
1314
1315 /* ---------------------------------------------------------------------- */
1316 /* audio chip descriptions - defines+functions for TA8874Z                */
1317
1318 /* write 1st byte */
1319 #define TA8874Z_LED_STE 0x80
1320 #define TA8874Z_LED_BIL 0x40
1321 #define TA8874Z_LED_EXT 0x20
1322 #define TA8874Z_MONO_SET        0x10
1323 #define TA8874Z_MUTE    0x08
1324 #define TA8874Z_F_MONO  0x04
1325 #define TA8874Z_MODE_SUB        0x02
1326 #define TA8874Z_MODE_MAIN       0x01
1327
1328 /* write 2nd byte */
1329 /*#define TA8874Z_TI    0x80  */ /* test mode */
1330 #define TA8874Z_SEPARATION      0x3f
1331 #define TA8874Z_SEPARATION_DEFAULT      0x10
1332
1333 /* read */
1334 #define TA8874Z_B1      0x80
1335 #define TA8874Z_B0      0x40
1336 #define TA8874Z_CHAG_FLAG       0x20
1337
1338 /*
1339  *        B1 B0
1340  * mono    L  H
1341  * stereo  L  L
1342  * BIL     H  L
1343  */
1344 static int ta8874z_getmode(struct CHIPSTATE *chip)
1345 {
1346         int val, mode;
1347
1348         val = chip_read(chip);
1349         mode = V4L2_TUNER_SUB_MONO;
1350         if (val & TA8874Z_B1){
1351                 mode |= V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
1352         }else if (!(val & TA8874Z_B0)){
1353                 mode |= V4L2_TUNER_SUB_STEREO;
1354         }
1355         /* v4l_dbg(1, debug, chip->c, "ta8874z_getmode(): raw chip read: 0x%02x, return: 0x%02x\n", val, mode); */
1356         return mode;
1357 }
1358
1359 static audiocmd ta8874z_stereo = { 2, {0, TA8874Z_SEPARATION_DEFAULT}};
1360 static audiocmd ta8874z_mono = {2, { TA8874Z_MONO_SET, TA8874Z_SEPARATION_DEFAULT}};
1361 static audiocmd ta8874z_main = {2, { 0, TA8874Z_SEPARATION_DEFAULT}};
1362 static audiocmd ta8874z_sub = {2, { TA8874Z_MODE_SUB, TA8874Z_SEPARATION_DEFAULT}};
1363 static audiocmd ta8874z_both = {2, { TA8874Z_MODE_MAIN | TA8874Z_MODE_SUB, TA8874Z_SEPARATION_DEFAULT}};
1364
1365 static void ta8874z_setmode(struct CHIPSTATE *chip, int mode)
1366 {
1367         struct v4l2_subdev *sd = &chip->sd;
1368         int update = 1;
1369         audiocmd *t = NULL;
1370
1371         v4l2_dbg(1, debug, sd, "ta8874z_setmode(): mode: 0x%02x\n", mode);
1372
1373         switch(mode){
1374         case V4L2_TUNER_MODE_MONO:
1375                 t = &ta8874z_mono;
1376                 break;
1377         case V4L2_TUNER_MODE_STEREO:
1378                 t = &ta8874z_stereo;
1379                 break;
1380         case V4L2_TUNER_MODE_LANG1:
1381                 t = &ta8874z_main;
1382                 break;
1383         case V4L2_TUNER_MODE_LANG2:
1384                 t = &ta8874z_sub;
1385                 break;
1386         case V4L2_TUNER_MODE_LANG1_LANG2:
1387                 t = &ta8874z_both;
1388                 break;
1389         default:
1390                 update = 0;
1391         }
1392
1393         if(update)
1394                 chip_cmd(chip, "TA8874Z", t);
1395 }
1396
1397 static int ta8874z_checkit(struct CHIPSTATE *chip)
1398 {
1399         int rc;
1400         rc = chip_read(chip);
1401         return ((rc & 0x1f) == 0x1f) ? 1 : 0;
1402 }
1403
1404 /* ---------------------------------------------------------------------- */
1405 /* audio chip descriptions - struct CHIPDESC                              */
1406
1407 /* insmod options to enable/disable individual audio chips */
1408 static int tda8425  = 1;
1409 static int tda9840  = 1;
1410 static int tda9850  = 1;
1411 static int tda9855  = 1;
1412 static int tda9873  = 1;
1413 static int tda9874a = 1;
1414 static int tda9875  = 1;
1415 static int tea6300;     /* default 0 - address clash with msp34xx */
1416 static int tea6320;     /* default 0 - address clash with msp34xx */
1417 static int tea6420  = 1;
1418 static int pic16c54 = 1;
1419 static int ta8874z;     /* default 0 - address clash with tda9840 */
1420
1421 module_param(tda8425, int, 0444);
1422 module_param(tda9840, int, 0444);
1423 module_param(tda9850, int, 0444);
1424 module_param(tda9855, int, 0444);
1425 module_param(tda9873, int, 0444);
1426 module_param(tda9874a, int, 0444);
1427 module_param(tda9875, int, 0444);
1428 module_param(tea6300, int, 0444);
1429 module_param(tea6320, int, 0444);
1430 module_param(tea6420, int, 0444);
1431 module_param(pic16c54, int, 0444);
1432 module_param(ta8874z, int, 0444);
1433
1434 static struct CHIPDESC chiplist[] = {
1435         {
1436                 .name       = "tda9840",
1437                 .insmodopt  = &tda9840,
1438                 .addr_lo    = I2C_ADDR_TDA9840 >> 1,
1439                 .addr_hi    = I2C_ADDR_TDA9840 >> 1,
1440                 .registers  = 5,
1441                 .flags      = CHIP_NEED_CHECKMODE,
1442
1443                 /* callbacks */
1444                 .checkit    = tda9840_checkit,
1445                 .getmode    = tda9840_getmode,
1446                 .setmode    = tda9840_setmode,
1447
1448                 .init       = { 2, { TDA9840_TEST, TDA9840_TEST_INT1SN
1449                                 /* ,TDA9840_SW, TDA9840_MONO */} }
1450         },
1451         {
1452                 .name       = "tda9873h",
1453                 .insmodopt  = &tda9873,
1454                 .addr_lo    = I2C_ADDR_TDA985x_L >> 1,
1455                 .addr_hi    = I2C_ADDR_TDA985x_H >> 1,
1456                 .registers  = 3,
1457                 .flags      = CHIP_HAS_INPUTSEL | CHIP_NEED_CHECKMODE,
1458
1459                 /* callbacks */
1460                 .checkit    = tda9873_checkit,
1461                 .getmode    = tda9873_getmode,
1462                 .setmode    = tda9873_setmode,
1463
1464                 .init       = { 4, { TDA9873_SW, 0xa4, 0x06, 0x03 } },
1465                 .inputreg   = TDA9873_SW,
1466                 .inputmute  = TDA9873_MUTE | TDA9873_AUTOMUTE,
1467                 .inputmap   = {0xa0, 0xa2, 0xa0, 0xa0},
1468                 .inputmask  = TDA9873_INP_MASK|TDA9873_MUTE|TDA9873_AUTOMUTE,
1469
1470         },
1471         {
1472                 .name       = "tda9874h/a",
1473                 .insmodopt  = &tda9874a,
1474                 .addr_lo    = I2C_ADDR_TDA9874 >> 1,
1475                 .addr_hi    = I2C_ADDR_TDA9874 >> 1,
1476                 .flags      = CHIP_NEED_CHECKMODE,
1477
1478                 /* callbacks */
1479                 .initialize = tda9874a_initialize,
1480                 .checkit    = tda9874a_checkit,
1481                 .getmode    = tda9874a_getmode,
1482                 .setmode    = tda9874a_setmode,
1483         },
1484         {
1485                 .name       = "tda9875",
1486                 .insmodopt  = &tda9875,
1487                 .addr_lo    = I2C_ADDR_TDA9875 >> 1,
1488                 .addr_hi    = I2C_ADDR_TDA9875 >> 1,
1489                 .flags      = CHIP_HAS_VOLUME | CHIP_HAS_BASSTREBLE,
1490
1491                 /* callbacks */
1492                 .initialize = tda9875_initialize,
1493                 .checkit    = tda9875_checkit,
1494                 .volfunc    = tda9875_volume,
1495                 .bassfunc   = tda9875_bass,
1496                 .treblefunc = tda9875_treble,
1497                 .leftreg    = TDA9875_MVL,
1498                 .rightreg   = TDA9875_MVR,
1499                 .bassreg    = TDA9875_MBA,
1500                 .treblereg  = TDA9875_MTR,
1501                 .leftinit   = 58880,
1502                 .rightinit  = 58880,
1503         },
1504         {
1505                 .name       = "tda9850",
1506                 .insmodopt  = &tda9850,
1507                 .addr_lo    = I2C_ADDR_TDA985x_L >> 1,
1508                 .addr_hi    = I2C_ADDR_TDA985x_H >> 1,
1509                 .registers  = 11,
1510
1511                 .getmode    = tda985x_getmode,
1512                 .setmode    = tda985x_setmode,
1513
1514                 .init       = { 8, { TDA9850_C4, 0x08, 0x08, TDA985x_STEREO, 0x07, 0x10, 0x10, 0x03 } }
1515         },
1516         {
1517                 .name       = "tda9855",
1518                 .insmodopt  = &tda9855,
1519                 .addr_lo    = I2C_ADDR_TDA985x_L >> 1,
1520                 .addr_hi    = I2C_ADDR_TDA985x_H >> 1,
1521                 .registers  = 11,
1522                 .flags      = CHIP_HAS_VOLUME | CHIP_HAS_BASSTREBLE,
1523
1524                 .leftreg    = TDA9855_VL,
1525                 .rightreg   = TDA9855_VR,
1526                 .bassreg    = TDA9855_BA,
1527                 .treblereg  = TDA9855_TR,
1528
1529                 /* callbacks */
1530                 .volfunc    = tda9855_volume,
1531                 .bassfunc   = tda9855_bass,
1532                 .treblefunc = tda9855_treble,
1533                 .getmode    = tda985x_getmode,
1534                 .setmode    = tda985x_setmode,
1535
1536                 .init       = { 12, { 0, 0x6f, 0x6f, 0x0e, 0x07<<1, 0x8<<2,
1537                                     TDA9855_MUTE | TDA9855_AVL | TDA9855_LOUD | TDA9855_INT,
1538                                     TDA985x_STEREO | TDA9855_LINEAR | TDA9855_TZCM | TDA9855_VZCM,
1539                                     0x07, 0x10, 0x10, 0x03 }}
1540         },
1541         {
1542                 .name       = "tea6300",
1543                 .insmodopt  = &tea6300,
1544                 .addr_lo    = I2C_ADDR_TEA6300 >> 1,
1545                 .addr_hi    = I2C_ADDR_TEA6300 >> 1,
1546                 .registers  = 6,
1547                 .flags      = CHIP_HAS_VOLUME | CHIP_HAS_BASSTREBLE | CHIP_HAS_INPUTSEL,
1548
1549                 .leftreg    = TEA6300_VR,
1550                 .rightreg   = TEA6300_VL,
1551                 .bassreg    = TEA6300_BA,
1552                 .treblereg  = TEA6300_TR,
1553
1554                 /* callbacks */
1555                 .volfunc    = tea6300_shift10,
1556                 .bassfunc   = tea6300_shift12,
1557                 .treblefunc = tea6300_shift12,
1558
1559                 .inputreg   = TEA6300_S,
1560                 .inputmap   = { TEA6300_S_SA, TEA6300_S_SB, TEA6300_S_SC },
1561                 .inputmute  = TEA6300_S_GMU,
1562         },
1563         {
1564                 .name       = "tea6320",
1565                 .insmodopt  = &tea6320,
1566                 .addr_lo    = I2C_ADDR_TEA6300 >> 1,
1567                 .addr_hi    = I2C_ADDR_TEA6300 >> 1,
1568                 .registers  = 8,
1569                 .flags      = CHIP_HAS_VOLUME | CHIP_HAS_BASSTREBLE | CHIP_HAS_INPUTSEL,
1570
1571                 .leftreg    = TEA6320_V,
1572                 .rightreg   = TEA6320_V,
1573                 .bassreg    = TEA6320_BA,
1574                 .treblereg  = TEA6320_TR,
1575
1576                 /* callbacks */
1577                 .initialize = tea6320_initialize,
1578                 .volfunc    = tea6320_volume,
1579                 .bassfunc   = tea6320_shift11,
1580                 .treblefunc = tea6320_shift11,
1581
1582                 .inputreg   = TEA6320_S,
1583                 .inputmap   = { TEA6320_S_SA, TEA6420_S_SB, TEA6300_S_SC, TEA6320_S_SD },
1584                 .inputmute  = TEA6300_S_GMU,
1585         },
1586         {
1587                 .name       = "tea6420",
1588                 .insmodopt  = &tea6420,
1589                 .addr_lo    = I2C_ADDR_TEA6420 >> 1,
1590                 .addr_hi    = I2C_ADDR_TEA6420 >> 1,
1591                 .registers  = 1,
1592                 .flags      = CHIP_HAS_INPUTSEL,
1593
1594                 .inputreg   = -1,
1595                 .inputmap   = { TEA6420_S_SA, TEA6420_S_SB, TEA6420_S_SC },
1596                 .inputmute  = TEA6300_S_GMU,
1597         },
1598         {
1599                 .name       = "tda8425",
1600                 .insmodopt  = &tda8425,
1601                 .addr_lo    = I2C_ADDR_TDA8425 >> 1,
1602                 .addr_hi    = I2C_ADDR_TDA8425 >> 1,
1603                 .registers  = 9,
1604                 .flags      = CHIP_HAS_VOLUME | CHIP_HAS_BASSTREBLE | CHIP_HAS_INPUTSEL,
1605
1606                 .leftreg    = TDA8425_VL,
1607                 .rightreg   = TDA8425_VR,
1608                 .bassreg    = TDA8425_BA,
1609                 .treblereg  = TDA8425_TR,
1610
1611                 /* callbacks */
1612                 .volfunc    = tda8425_shift10,
1613                 .bassfunc   = tda8425_shift12,
1614                 .treblefunc = tda8425_shift12,
1615                 .setmode    = tda8425_setmode,
1616
1617                 .inputreg   = TDA8425_S1,
1618                 .inputmap   = { TDA8425_S1_CH1, TDA8425_S1_CH1, TDA8425_S1_CH1 },
1619                 .inputmute  = TDA8425_S1_OFF,
1620
1621         },
1622         {
1623                 .name       = "pic16c54 (PV951)",
1624                 .insmodopt  = &pic16c54,
1625                 .addr_lo    = I2C_ADDR_PIC16C54 >> 1,
1626                 .addr_hi    = I2C_ADDR_PIC16C54>> 1,
1627                 .registers  = 2,
1628                 .flags      = CHIP_HAS_INPUTSEL,
1629
1630                 .inputreg   = PIC16C54_REG_MISC,
1631                 .inputmap   = {PIC16C54_MISC_SND_NOTMUTE|PIC16C54_MISC_SWITCH_TUNER,
1632                              PIC16C54_MISC_SND_NOTMUTE|PIC16C54_MISC_SWITCH_LINE,
1633                              PIC16C54_MISC_SND_NOTMUTE|PIC16C54_MISC_SWITCH_LINE,
1634                              PIC16C54_MISC_SND_MUTE},
1635                 .inputmute  = PIC16C54_MISC_SND_MUTE,
1636         },
1637         {
1638                 .name       = "ta8874z",
1639                 .checkit    = ta8874z_checkit,
1640                 .insmodopt  = &ta8874z,
1641                 .addr_lo    = I2C_ADDR_TDA9840 >> 1,
1642                 .addr_hi    = I2C_ADDR_TDA9840 >> 1,
1643                 .registers  = 2,
1644
1645                 /* callbacks */
1646                 .getmode    = ta8874z_getmode,
1647                 .setmode    = ta8874z_setmode,
1648
1649                 .init       = {2, { TA8874Z_MONO_SET, TA8874Z_SEPARATION_DEFAULT}},
1650         },
1651         { .name = NULL } /* EOF */
1652 };
1653
1654
1655 /* ---------------------------------------------------------------------- */
1656
1657 static int tvaudio_g_ctrl(struct v4l2_subdev *sd,
1658                             struct v4l2_control *ctrl)
1659 {
1660         struct CHIPSTATE *chip = to_state(sd);
1661         struct CHIPDESC *desc = chip->desc;
1662
1663         switch (ctrl->id) {
1664         case V4L2_CID_AUDIO_MUTE:
1665                 if (!(desc->flags & CHIP_HAS_INPUTSEL))
1666                         break;
1667                 ctrl->value=chip->muted;
1668                 return 0;
1669         case V4L2_CID_AUDIO_VOLUME:
1670                 if (!(desc->flags & CHIP_HAS_VOLUME))
1671                         break;
1672                 ctrl->value = max(chip->left,chip->right);
1673                 return 0;
1674         case V4L2_CID_AUDIO_BALANCE:
1675         {
1676                 int volume;
1677                 if (!(desc->flags & CHIP_HAS_VOLUME))
1678                         break;
1679                 volume = max(chip->left,chip->right);
1680                 if (volume)
1681                         ctrl->value=(32768*min(chip->left,chip->right))/volume;
1682                 else
1683                         ctrl->value=32768;
1684                 return 0;
1685         }
1686         case V4L2_CID_AUDIO_BASS:
1687                 if (!(desc->flags & CHIP_HAS_BASSTREBLE))
1688                         break;
1689                 ctrl->value = chip->bass;
1690                 return 0;
1691         case V4L2_CID_AUDIO_TREBLE:
1692                 if (!(desc->flags & CHIP_HAS_BASSTREBLE))
1693                         break;
1694                 ctrl->value = chip->treble;
1695                 return 0;
1696         }
1697         return -EINVAL;
1698 }
1699
1700 static int tvaudio_s_ctrl(struct v4l2_subdev *sd,
1701                             struct v4l2_control *ctrl)
1702 {
1703         struct CHIPSTATE *chip = to_state(sd);
1704         struct CHIPDESC *desc = chip->desc;
1705
1706         switch (ctrl->id) {
1707         case V4L2_CID_AUDIO_MUTE:
1708                 if (!(desc->flags & CHIP_HAS_INPUTSEL))
1709                         break;
1710
1711                 if (ctrl->value < 0 || ctrl->value >= 2)
1712                         return -ERANGE;
1713                 chip->muted = ctrl->value;
1714                 if (chip->muted)
1715                         chip_write_masked(chip,desc->inputreg,desc->inputmute,desc->inputmask);
1716                 else
1717                         chip_write_masked(chip,desc->inputreg,
1718                                         desc->inputmap[chip->input],desc->inputmask);
1719                 return 0;
1720         case V4L2_CID_AUDIO_VOLUME:
1721         {
1722                 int volume,balance;
1723
1724                 if (!(desc->flags & CHIP_HAS_VOLUME))
1725                         break;
1726
1727                 volume = max(chip->left,chip->right);
1728                 if (volume)
1729                         balance=(32768*min(chip->left,chip->right))/volume;
1730                 else
1731                         balance=32768;
1732
1733                 volume=ctrl->value;
1734                 chip->left = (min(65536 - balance,32768) * volume) / 32768;
1735                 chip->right = (min(balance,volume *(__u16)32768)) / 32768;
1736
1737                 chip_write(chip,desc->leftreg,desc->volfunc(chip->left));
1738                 chip_write(chip,desc->rightreg,desc->volfunc(chip->right));
1739
1740                 return 0;
1741         }
1742         case V4L2_CID_AUDIO_BALANCE:
1743         {
1744                 int volume, balance;
1745
1746                 if (!(desc->flags & CHIP_HAS_VOLUME))
1747                         break;
1748
1749                 volume = max(chip->left, chip->right);
1750                 balance = ctrl->value;
1751                 chip->left = (min(65536 - balance, 32768) * volume) / 32768;
1752                 chip->right = (min(balance, volume * (__u16)32768)) / 32768;
1753
1754                 chip_write(chip, desc->leftreg, desc->volfunc(chip->left));
1755                 chip_write(chip, desc->rightreg, desc->volfunc(chip->right));
1756
1757                 return 0;
1758         }
1759         case V4L2_CID_AUDIO_BASS:
1760                 if (!(desc->flags & CHIP_HAS_BASSTREBLE))
1761                         break;
1762                 chip->bass = ctrl->value;
1763                 chip_write(chip,desc->bassreg,desc->bassfunc(chip->bass));
1764
1765                 return 0;
1766         case V4L2_CID_AUDIO_TREBLE:
1767                 if (!(desc->flags & CHIP_HAS_BASSTREBLE))
1768                         break;
1769                 chip->treble = ctrl->value;
1770                 chip_write(chip,desc->treblereg,desc->treblefunc(chip->treble));
1771
1772                 return 0;
1773         }
1774         return -EINVAL;
1775 }
1776
1777
1778 /* ---------------------------------------------------------------------- */
1779 /* video4linux interface                                                  */
1780
1781 static int tvaudio_s_radio(struct v4l2_subdev *sd)
1782 {
1783         struct CHIPSTATE *chip = to_state(sd);
1784
1785         chip->radio = 1;
1786         /* del_timer(&chip->wt); */
1787         return 0;
1788 }
1789
1790 static int tvaudio_queryctrl(struct v4l2_subdev *sd, struct v4l2_queryctrl *qc)
1791 {
1792         struct CHIPSTATE *chip = to_state(sd);
1793         struct CHIPDESC *desc = chip->desc;
1794
1795         switch (qc->id) {
1796         case V4L2_CID_AUDIO_MUTE:
1797                 if (desc->flags & CHIP_HAS_INPUTSEL)
1798                         return v4l2_ctrl_query_fill(qc, 0, 1, 1, 0);
1799                 break;
1800         case V4L2_CID_AUDIO_VOLUME:
1801                 if (desc->flags & CHIP_HAS_VOLUME)
1802                         return v4l2_ctrl_query_fill(qc, 0, 65535, 65535 / 100, 58880);
1803                 break;
1804         case V4L2_CID_AUDIO_BALANCE:
1805                 if (desc->flags & CHIP_HAS_VOLUME)
1806                         return v4l2_ctrl_query_fill(qc, 0, 65535, 65535 / 100, 32768);
1807                 break;
1808         case V4L2_CID_AUDIO_BASS:
1809         case V4L2_CID_AUDIO_TREBLE:
1810                 if (desc->flags & CHIP_HAS_BASSTREBLE)
1811                         return v4l2_ctrl_query_fill(qc, 0, 65535, 65535 / 100, 32768);
1812                 break;
1813         default:
1814                 break;
1815         }
1816         return -EINVAL;
1817 }
1818
1819 static int tvaudio_s_routing(struct v4l2_subdev *sd,
1820                              u32 input, u32 output, u32 config)
1821 {
1822         struct CHIPSTATE *chip = to_state(sd);
1823         struct CHIPDESC *desc = chip->desc;
1824
1825         if (!(desc->flags & CHIP_HAS_INPUTSEL))
1826                 return 0;
1827         if (input >= 4)
1828                 return -EINVAL;
1829         /* There are four inputs: tuner, radio, extern and intern. */
1830         chip->input = input;
1831         if (chip->muted)
1832                 return 0;
1833         chip_write_masked(chip, desc->inputreg,
1834                         desc->inputmap[chip->input], desc->inputmask);
1835         return 0;
1836 }
1837
1838 static int tvaudio_s_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
1839 {
1840         struct CHIPSTATE *chip = to_state(sd);
1841         struct CHIPDESC *desc = chip->desc;
1842
1843         if (!desc->setmode)
1844                 return 0;
1845         if (chip->radio)
1846                 return 0;
1847
1848         switch (vt->audmode) {
1849         case V4L2_TUNER_MODE_MONO:
1850         case V4L2_TUNER_MODE_STEREO:
1851         case V4L2_TUNER_MODE_LANG1:
1852         case V4L2_TUNER_MODE_LANG2:
1853         case V4L2_TUNER_MODE_LANG1_LANG2:
1854                 break;
1855         default:
1856                 return -EINVAL;
1857         }
1858         chip->audmode = vt->audmode;
1859
1860         if (chip->thread)
1861                 wake_up_process(chip->thread);
1862         else
1863                 desc->setmode(chip, vt->audmode);
1864
1865         return 0;
1866 }
1867
1868 static int tvaudio_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
1869 {
1870         struct CHIPSTATE *chip = to_state(sd);
1871         struct CHIPDESC *desc = chip->desc;
1872
1873         if (!desc->getmode)
1874                 return 0;
1875         if (chip->radio)
1876                 return 0;
1877
1878         vt->audmode = chip->audmode;
1879         vt->rxsubchans = desc->getmode(chip);
1880         vt->capability = V4L2_TUNER_CAP_STEREO |
1881                 V4L2_TUNER_CAP_LANG1 | V4L2_TUNER_CAP_LANG2;
1882
1883         return 0;
1884 }
1885
1886 static int tvaudio_s_std(struct v4l2_subdev *sd, v4l2_std_id std)
1887 {
1888         struct CHIPSTATE *chip = to_state(sd);
1889
1890         chip->radio = 0;
1891         return 0;
1892 }
1893
1894 static int tvaudio_s_frequency(struct v4l2_subdev *sd, struct v4l2_frequency *freq)
1895 {
1896         struct CHIPSTATE *chip = to_state(sd);
1897         struct CHIPDESC *desc = chip->desc;
1898
1899         /* For chips that provide getmode and setmode, and doesn't
1900            automatically follows the stereo carrier, a kthread is
1901            created to set the audio standard. In this case, when then
1902            the video channel is changed, tvaudio starts on MONO mode.
1903            After waiting for 2 seconds, the kernel thread is called,
1904            to follow whatever audio standard is pointed by the
1905            audio carrier.
1906          */
1907         if (chip->thread) {
1908                 desc->setmode(chip, V4L2_TUNER_MODE_MONO);
1909                 chip->prevmode = -1; /* reset previous mode */
1910                 mod_timer(&chip->wt, jiffies+msecs_to_jiffies(2000));
1911         }
1912         return 0;
1913 }
1914
1915 static int tvaudio_g_chip_ident(struct v4l2_subdev *sd, struct v4l2_dbg_chip_ident *chip)
1916 {
1917         struct i2c_client *client = v4l2_get_subdevdata(sd);
1918
1919         return v4l2_chip_ident_i2c_client(client, chip, V4L2_IDENT_TVAUDIO, 0);
1920 }
1921
1922 /* ----------------------------------------------------------------------- */
1923
1924 static const struct v4l2_subdev_core_ops tvaudio_core_ops = {
1925         .g_chip_ident = tvaudio_g_chip_ident,
1926         .queryctrl = tvaudio_queryctrl,
1927         .g_ctrl = tvaudio_g_ctrl,
1928         .s_ctrl = tvaudio_s_ctrl,
1929         .s_std = tvaudio_s_std,
1930 };
1931
1932 static const struct v4l2_subdev_tuner_ops tvaudio_tuner_ops = {
1933         .s_radio = tvaudio_s_radio,
1934         .s_frequency = tvaudio_s_frequency,
1935         .s_tuner = tvaudio_s_tuner,
1936         .g_tuner = tvaudio_g_tuner,
1937 };
1938
1939 static const struct v4l2_subdev_audio_ops tvaudio_audio_ops = {
1940         .s_routing = tvaudio_s_routing,
1941 };
1942
1943 static const struct v4l2_subdev_ops tvaudio_ops = {
1944         .core = &tvaudio_core_ops,
1945         .tuner = &tvaudio_tuner_ops,
1946         .audio = &tvaudio_audio_ops,
1947 };
1948
1949 /* ----------------------------------------------------------------------- */
1950
1951
1952 /* i2c registration                                                       */
1953
1954 static int tvaudio_probe(struct i2c_client *client, const struct i2c_device_id *id)
1955 {
1956         struct CHIPSTATE *chip;
1957         struct CHIPDESC  *desc;
1958         struct v4l2_subdev *sd;
1959
1960         if (debug) {
1961                 printk(KERN_INFO "tvaudio: TV audio decoder + audio/video mux driver\n");
1962                 printk(KERN_INFO "tvaudio: known chips: ");
1963                 for (desc = chiplist; desc->name != NULL; desc++)
1964                         printk("%s%s", (desc == chiplist) ? "" : ", ", desc->name);
1965                 printk("\n");
1966         }
1967
1968         chip = kzalloc(sizeof(*chip), GFP_KERNEL);
1969         if (!chip)
1970                 return -ENOMEM;
1971         sd = &chip->sd;
1972         v4l2_i2c_subdev_init(sd, client, &tvaudio_ops);
1973
1974         /* find description for the chip */
1975         v4l2_dbg(1, debug, sd, "chip found @ 0x%x\n", client->addr<<1);
1976         for (desc = chiplist; desc->name != NULL; desc++) {
1977                 if (0 == *(desc->insmodopt))
1978                         continue;
1979                 if (client->addr < desc->addr_lo ||
1980                     client->addr > desc->addr_hi)
1981                         continue;
1982                 if (desc->checkit && !desc->checkit(chip))
1983                         continue;
1984                 break;
1985         }
1986         if (desc->name == NULL) {
1987                 v4l2_dbg(1, debug, sd, "no matching chip description found\n");
1988                 kfree(chip);
1989                 return -EIO;
1990         }
1991         v4l2_info(sd, "%s found @ 0x%x (%s)\n", desc->name, client->addr<<1, client->adapter->name);
1992         if (desc->flags) {
1993                 v4l2_dbg(1, debug, sd, "matches:%s%s%s.\n",
1994                         (desc->flags & CHIP_HAS_VOLUME)     ? " volume"      : "",
1995                         (desc->flags & CHIP_HAS_BASSTREBLE) ? " bass/treble" : "",
1996                         (desc->flags & CHIP_HAS_INPUTSEL)   ? " audiomux"    : "");
1997         }
1998
1999         /* fill required data structures */
2000         if (!id)
2001                 strlcpy(client->name, desc->name, I2C_NAME_SIZE);
2002         chip->desc = desc;
2003         chip->shadow.count = desc->registers+1;
2004         chip->prevmode = -1;
2005         chip->audmode = V4L2_TUNER_MODE_LANG1;
2006
2007         /* initialization  */
2008         if (desc->initialize != NULL)
2009                 desc->initialize(chip);
2010         else
2011                 chip_cmd(chip, "init", &desc->init);
2012
2013         if (desc->flags & CHIP_HAS_VOLUME) {
2014                 if (!desc->volfunc) {
2015                         /* This shouldn't be happen. Warn user, but keep working
2016                            without volume controls
2017                          */
2018                         v4l2_info(sd, "volume callback undefined!\n");
2019                         desc->flags &= ~CHIP_HAS_VOLUME;
2020                 } else {
2021                         chip->left  = desc->leftinit  ? desc->leftinit  : 65535;
2022                         chip->right = desc->rightinit ? desc->rightinit : 65535;
2023                         chip_write(chip, desc->leftreg,
2024                                    desc->volfunc(chip->left));
2025                         chip_write(chip, desc->rightreg,
2026                                    desc->volfunc(chip->right));
2027                 }
2028         }
2029         if (desc->flags & CHIP_HAS_BASSTREBLE) {
2030                 if (!desc->bassfunc || !desc->treblefunc) {
2031                         /* This shouldn't be happen. Warn user, but keep working
2032                            without bass/treble controls
2033                          */
2034                         v4l2_info(sd, "bass/treble callbacks undefined!\n");
2035                         desc->flags &= ~CHIP_HAS_BASSTREBLE;
2036                 } else {
2037                         chip->treble = desc->trebleinit ?
2038                                                 desc->trebleinit : 32768;
2039                         chip->bass   = desc->bassinit   ?
2040                                                 desc->bassinit   : 32768;
2041                         chip_write(chip, desc->bassreg,
2042                                    desc->bassfunc(chip->bass));
2043                         chip_write(chip, desc->treblereg,
2044                                    desc->treblefunc(chip->treble));
2045                 }
2046         }
2047
2048         chip->thread = NULL;
2049         init_timer(&chip->wt);
2050         if (desc->flags & CHIP_NEED_CHECKMODE) {
2051                 if (!desc->getmode || !desc->setmode) {
2052                         /* This shouldn't be happen. Warn user, but keep working
2053                            without kthread
2054                          */
2055                         v4l2_info(sd, "set/get mode callbacks undefined!\n");
2056                         return 0;
2057                 }
2058                 /* start async thread */
2059                 chip->wt.function = chip_thread_wake;
2060                 chip->wt.data     = (unsigned long)chip;
2061                 chip->thread = kthread_run(chip_thread, chip, client->name);
2062                 if (IS_ERR(chip->thread)) {
2063                         v4l2_warn(sd, "failed to create kthread\n");
2064                         chip->thread = NULL;
2065                 }
2066         }
2067         return 0;
2068 }
2069
2070 static int tvaudio_remove(struct i2c_client *client)
2071 {
2072         struct v4l2_subdev *sd = i2c_get_clientdata(client);
2073         struct CHIPSTATE *chip = to_state(sd);
2074
2075         del_timer_sync(&chip->wt);
2076         if (chip->thread) {
2077                 /* shutdown async thread */
2078                 kthread_stop(chip->thread);
2079                 chip->thread = NULL;
2080         }
2081
2082         v4l2_device_unregister_subdev(sd);
2083         kfree(chip);
2084         return 0;
2085 }
2086
2087 /* This driver supports many devices and the idea is to let the driver
2088    detect which device is present. So rather than listing all supported
2089    devices here, we pretend to support a single, fake device type. */
2090 static const struct i2c_device_id tvaudio_id[] = {
2091         { "tvaudio", 0 },
2092         { }
2093 };
2094 MODULE_DEVICE_TABLE(i2c, tvaudio_id);
2095
2096 static struct i2c_driver tvaudio_driver = {
2097         .driver = {
2098                 .owner  = THIS_MODULE,
2099                 .name   = "tvaudio",
2100         },
2101         .probe          = tvaudio_probe,
2102         .remove         = tvaudio_remove,
2103         .id_table       = tvaudio_id,
2104 };
2105
2106 module_i2c_driver(tvaudio_driver);