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