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