Showing error 1907

User: Jiri Slaby
Error type: Invalid Pointer Dereference
Error type description: A pointer which is invalid is being dereferenced
File location: sound/pci/ac97/ac97_codec.c
Line in file: 2264
Project: Linux Kernel
Project version: 2.6.28
Tools: Smatch (1.59)
Entered: 2013-09-11 08:47:26 UTC


Source:

   1/*
   2 *  Copyright (c) by Jaroslav Kysela <perex@perex.cz>
   3 *  Universal interface for Audio Codec '97
   4 *
   5 *  For more details look to AC '97 component specification revision 2.2
   6 *  by Intel Corporation (http://developer.intel.com).
   7 *
   8 *
   9 *   This program is free software; you can redistribute it and/or modify
  10 *   it under the terms of the GNU General Public License as published by
  11 *   the Free Software Foundation; either version 2 of the License, or
  12 *   (at your option) any later version.
  13 *
  14 *   This program is distributed in the hope that it will be useful,
  15 *   but WITHOUT ANY WARRANTY; without even the implied warranty of
  16 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17 *   GNU General Public License for more details.
  18 *
  19 *   You should have received a copy of the GNU General Public License
  20 *   along with this program; if not, write to the Free Software
  21 *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  22 *
  23 */
  24
  25#include <linux/delay.h>
  26#include <linux/init.h>
  27#include <linux/slab.h>
  28#include <linux/pci.h>
  29#include <linux/moduleparam.h>
  30#include <linux/mutex.h>
  31#include <sound/core.h>
  32#include <sound/pcm.h>
  33#include <sound/tlv.h>
  34#include <sound/ac97_codec.h>
  35#include <sound/asoundef.h>
  36#include <sound/initval.h>
  37#include "ac97_id.h"
  38
  39#include "ac97_patch.c"
  40
  41MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>");
  42MODULE_DESCRIPTION("Universal interface for Audio Codec '97");
  43MODULE_LICENSE("GPL");
  44
  45static int enable_loopback;
  46
  47module_param(enable_loopback, bool, 0444);
  48MODULE_PARM_DESC(enable_loopback, "Enable AC97 ADC/DAC Loopback Control");
  49
  50#ifdef CONFIG_SND_AC97_POWER_SAVE
  51static int power_save = CONFIG_SND_AC97_POWER_SAVE_DEFAULT;
  52module_param(power_save, int, 0644);
  53MODULE_PARM_DESC(power_save, "Automatic power-saving timeout "
  54                 "(in second, 0 = disable).");
  55#endif
  56/*
  57
  58 */
  59
  60struct ac97_codec_id {
  61        unsigned int id;
  62        unsigned int mask;
  63        const char *name;
  64        int (*patch)(struct snd_ac97 *ac97);
  65        int (*mpatch)(struct snd_ac97 *ac97);
  66        unsigned int flags;
  67};
  68
  69static const struct ac97_codec_id snd_ac97_codec_id_vendors[] = {
  70{ 0x41445300, 0xffffff00, "Analog Devices",        NULL,        NULL },
  71{ 0x414b4d00, 0xffffff00, "Asahi Kasei",        NULL,        NULL },
  72{ 0x414c4300, 0xffffff00, "Realtek",                NULL,        NULL },
  73{ 0x414c4700, 0xffffff00, "Realtek",                NULL,        NULL },
  74{ 0x434d4900, 0xffffff00, "C-Media Electronics", NULL,        NULL },
  75{ 0x43525900, 0xffffff00, "Cirrus Logic",        NULL,        NULL },
  76{ 0x43585400, 0xffffff00, "Conexant",           NULL,        NULL },
  77{ 0x44543000, 0xffffff00, "Diamond Technology", NULL,        NULL },
  78{ 0x454d4300, 0xffffff00, "eMicro",                NULL,        NULL },
  79{ 0x45838300, 0xffffff00, "ESS Technology",        NULL,        NULL },
  80{ 0x48525300, 0xffffff00, "Intersil",                NULL,        NULL },
  81{ 0x49434500, 0xffffff00, "ICEnsemble",                NULL,        NULL },
  82{ 0x49544500, 0xffffff00, "ITE Tech.Inc",        NULL,        NULL },
  83{ 0x4e534300, 0xffffff00, "National Semiconductor", NULL, NULL },
  84{ 0x50534300, 0xffffff00, "Philips",                NULL,        NULL },
  85{ 0x53494c00, 0xffffff00, "Silicon Laboratory",        NULL,        NULL },
  86{ 0x54524100, 0xffffff00, "TriTech",                NULL,        NULL },
  87{ 0x54584e00, 0xffffff00, "Texas Instruments",        NULL,        NULL },
  88{ 0x56494100, 0xffffff00, "VIA Technologies",   NULL,        NULL },
  89{ 0x57454300, 0xffffff00, "Winbond",                NULL,        NULL },
  90{ 0x574d4c00, 0xffffff00, "Wolfson",                NULL,        NULL },
  91{ 0x594d4800, 0xffffff00, "Yamaha",                NULL,        NULL },
  92{ 0x83847600, 0xffffff00, "SigmaTel",                NULL,        NULL },
  93{ 0,              0,           NULL,                        NULL,        NULL }
  94};
  95
  96static const struct ac97_codec_id snd_ac97_codec_ids[] = {
  97{ 0x41445303, 0xffffffff, "AD1819",                patch_ad1819,        NULL },
  98{ 0x41445340, 0xffffffff, "AD1881",                patch_ad1881,        NULL },
  99{ 0x41445348, 0xffffffff, "AD1881A",                patch_ad1881,        NULL },
 100{ 0x41445360, 0xffffffff, "AD1885",                patch_ad1885,        NULL },
 101{ 0x41445361, 0xffffffff, "AD1886",                patch_ad1886,        NULL },
 102{ 0x41445362, 0xffffffff, "AD1887",                patch_ad1881,        NULL },
 103{ 0x41445363, 0xffffffff, "AD1886A",                patch_ad1881,        NULL },
 104{ 0x41445368, 0xffffffff, "AD1888",                patch_ad1888,        NULL },
 105{ 0x41445370, 0xffffffff, "AD1980",                patch_ad1980,        NULL },
 106{ 0x41445372, 0xffffffff, "AD1981A",                patch_ad1981a,        NULL },
 107{ 0x41445374, 0xffffffff, "AD1981B",                patch_ad1981b,        NULL },
 108{ 0x41445375, 0xffffffff, "AD1985",                patch_ad1985,        NULL },
 109{ 0x41445378, 0xffffffff, "AD1986",                patch_ad1986,        NULL },
 110{ 0x414b4d00, 0xffffffff, "AK4540",                NULL,                NULL },
 111{ 0x414b4d01, 0xffffffff, "AK4542",                NULL,                NULL },
 112{ 0x414b4d02, 0xffffffff, "AK4543",                NULL,                NULL },
 113{ 0x414b4d06, 0xffffffff, "AK4544A",                NULL,                NULL },
 114{ 0x414b4d07, 0xffffffff, "AK4545",                NULL,                NULL },
 115{ 0x414c4300, 0xffffff00, "ALC100,100P",         NULL,                NULL },
 116{ 0x414c4710, 0xfffffff0, "ALC200,200P",        NULL,                NULL },
 117{ 0x414c4721, 0xffffffff, "ALC650D",                NULL,        NULL }, /* already patched */
 118{ 0x414c4722, 0xffffffff, "ALC650E",                NULL,        NULL }, /* already patched */
 119{ 0x414c4723, 0xffffffff, "ALC650F",                NULL,        NULL }, /* already patched */
 120{ 0x414c4720, 0xfffffff0, "ALC650",                patch_alc650,        NULL },
 121{ 0x414c4730, 0xffffffff, "ALC101",                NULL,                NULL },
 122{ 0x414c4740, 0xfffffff0, "ALC202",                NULL,                NULL },
 123{ 0x414c4750, 0xfffffff0, "ALC250",                NULL,                NULL },
 124{ 0x414c4760, 0xfffffff0, "ALC655",                patch_alc655,        NULL },
 125{ 0x414c4770, 0xfffffff0, "ALC203",                patch_alc203,        NULL },
 126{ 0x414c4781, 0xffffffff, "ALC658D",                NULL,        NULL }, /* already patched */
 127{ 0x414c4780, 0xfffffff0, "ALC658",                patch_alc655,        NULL },
 128{ 0x414c4790, 0xfffffff0, "ALC850",                patch_alc850,        NULL },
 129{ 0x434d4941, 0xffffffff, "CMI9738",                patch_cm9738,        NULL },
 130{ 0x434d4961, 0xffffffff, "CMI9739",                patch_cm9739,        NULL },
 131{ 0x434d4969, 0xffffffff, "CMI9780",                patch_cm9780,        NULL },
 132{ 0x434d4978, 0xffffffff, "CMI9761A",                patch_cm9761,        NULL },
 133{ 0x434d4982, 0xffffffff, "CMI9761B",                patch_cm9761,        NULL },
 134{ 0x434d4983, 0xffffffff, "CMI9761A+",                patch_cm9761,        NULL },
 135{ 0x43525900, 0xfffffff8, "CS4297",                NULL,                NULL },
 136{ 0x43525910, 0xfffffff8, "CS4297A",                patch_cirrus_spdif,        NULL },
 137{ 0x43525920, 0xfffffff8, "CS4298",                patch_cirrus_spdif,                NULL },
 138{ 0x43525928, 0xfffffff8, "CS4294",                NULL,                NULL },
 139{ 0x43525930, 0xfffffff8, "CS4299",                patch_cirrus_cs4299,        NULL },
 140{ 0x43525948, 0xfffffff8, "CS4201",                NULL,                NULL },
 141{ 0x43525958, 0xfffffff8, "CS4205",                patch_cirrus_spdif,        NULL },
 142{ 0x43525960, 0xfffffff8, "CS4291",                NULL,                NULL },
 143{ 0x43525970, 0xfffffff8, "CS4202",                NULL,                NULL },
 144{ 0x43585421, 0xffffffff, "HSD11246",                NULL,                NULL },        // SmartMC II
 145{ 0x43585428, 0xfffffff8, "Cx20468",                patch_conexant,        NULL }, // SmartAMC fixme: the mask might be different
 146{ 0x43585431, 0xffffffff, "Cx20551",           patch_cx20551,  NULL },
 147{ 0x44543031, 0xfffffff0, "DT0398",                NULL,                NULL },
 148{ 0x454d4328, 0xffffffff, "EM28028",                NULL,                NULL },  // same as TR28028?
 149{ 0x45838308, 0xffffffff, "ESS1988",                NULL,                NULL },
 150{ 0x48525300, 0xffffff00, "HMP9701",                NULL,                NULL },
 151{ 0x49434501, 0xffffffff, "ICE1230",                NULL,                NULL },
 152{ 0x49434511, 0xffffffff, "ICE1232",                NULL,                NULL }, // alias VIA VT1611A?
 153{ 0x49434514, 0xffffffff, "ICE1232A",                NULL,                NULL },
 154{ 0x49434551, 0xffffffff, "VT1616",                 patch_vt1616,        NULL }, 
 155{ 0x49434552, 0xffffffff, "VT1616i",                patch_vt1616,        NULL }, // VT1616 compatible (chipset integrated)
 156{ 0x49544520, 0xffffffff, "IT2226E",                NULL,                NULL },
 157{ 0x49544561, 0xffffffff, "IT2646E",                patch_it2646,        NULL },
 158{ 0x4e534300, 0xffffffff, "LM4540,43,45,46,48",        NULL,                NULL }, // only guess --jk
 159{ 0x4e534331, 0xffffffff, "LM4549",                NULL,                NULL },
 160{ 0x4e534350, 0xffffffff, "LM4550",                patch_lm4550,          NULL }, // volume wrap fix 
 161{ 0x50534304, 0xffffffff, "UCB1400",                patch_ucb1400,        NULL },
 162{ 0x53494c20, 0xffffffe0, "Si3036,8",                mpatch_si3036,        mpatch_si3036, AC97_MODEM_PATCH },
 163{ 0x54524102, 0xffffffff, "TR28022",                NULL,                NULL },
 164{ 0x54524103, 0xffffffff, "TR28023",                NULL,                NULL },
 165{ 0x54524106, 0xffffffff, "TR28026",                NULL,                NULL },
 166{ 0x54524108, 0xffffffff, "TR28028",                patch_tritech_tr28028,        NULL }, // added by xin jin [07/09/99]
 167{ 0x54524123, 0xffffffff, "TR28602",                NULL,                NULL }, // only guess --jk [TR28023 = eMicro EM28023 (new CT1297)]
 168{ 0x54584e20, 0xffffffff, "TLC320AD9xC",        NULL,                NULL },
 169{ 0x56494161, 0xffffffff, "VIA1612A",                NULL,                NULL }, // modified ICE1232 with S/PDIF
 170{ 0x56494170, 0xffffffff, "VIA1617A",                patch_vt1617a,        NULL }, // modified VT1616 with S/PDIF
 171{ 0x56494182, 0xffffffff, "VIA1618",                patch_vt1618,   NULL },
 172{ 0x57454301, 0xffffffff, "W83971D",                NULL,                NULL },
 173{ 0x574d4c00, 0xffffffff, "WM9701,WM9701A",        NULL,                NULL },
 174{ 0x574d4C03, 0xffffffff, "WM9703,WM9707,WM9708,WM9717", patch_wolfson03, NULL},
 175{ 0x574d4C04, 0xffffffff, "WM9704M,WM9704Q",        patch_wolfson04, NULL},
 176{ 0x574d4C05, 0xffffffff, "WM9705,WM9710",        patch_wolfson05, NULL},
 177{ 0x574d4C09, 0xffffffff, "WM9709",                NULL,                NULL},
 178{ 0x574d4C12, 0xffffffff, "WM9711,WM9712",        patch_wolfson11, NULL},
 179{ 0x574d4c13, 0xffffffff, "WM9713,WM9714",        patch_wolfson13, NULL, AC97_DEFAULT_POWER_OFF},
 180{ 0x594d4800, 0xffffffff, "YMF743",                patch_yamaha_ymf743,        NULL },
 181{ 0x594d4802, 0xffffffff, "YMF752",                NULL,                NULL },
 182{ 0x594d4803, 0xffffffff, "YMF753",                patch_yamaha_ymf753,        NULL },
 183{ 0x83847600, 0xffffffff, "STAC9700,83,84",        patch_sigmatel_stac9700,        NULL },
 184{ 0x83847604, 0xffffffff, "STAC9701,3,4,5",        NULL,                NULL },
 185{ 0x83847605, 0xffffffff, "STAC9704",                NULL,                NULL },
 186{ 0x83847608, 0xffffffff, "STAC9708,11",        patch_sigmatel_stac9708,        NULL },
 187{ 0x83847609, 0xffffffff, "STAC9721,23",        patch_sigmatel_stac9721,        NULL },
 188{ 0x83847644, 0xffffffff, "STAC9744",                patch_sigmatel_stac9744,        NULL },
 189{ 0x83847650, 0xffffffff, "STAC9750,51",        NULL,                NULL },        // patch?
 190{ 0x83847652, 0xffffffff, "STAC9752,53",        NULL,                NULL }, // patch?
 191{ 0x83847656, 0xffffffff, "STAC9756,57",        patch_sigmatel_stac9756,        NULL },
 192{ 0x83847658, 0xffffffff, "STAC9758,59",        patch_sigmatel_stac9758,        NULL },
 193{ 0x83847666, 0xffffffff, "STAC9766,67",        NULL,                NULL }, // patch?
 194{ 0,               0,          NULL,                        NULL,                NULL }
 195};
 196
 197
 198static void update_power_regs(struct snd_ac97 *ac97);
 199#ifdef CONFIG_SND_AC97_POWER_SAVE
 200#define ac97_is_power_save_mode(ac97) \
 201        ((ac97->scaps & AC97_SCAP_POWER_SAVE) && power_save)
 202#else
 203#define ac97_is_power_save_mode(ac97) 0
 204#endif
 205
 206
 207/*
 208 *  I/O routines
 209 */
 210
 211static int snd_ac97_valid_reg(struct snd_ac97 *ac97, unsigned short reg)
 212{
 213        /* filter some registers for buggy codecs */
 214        switch (ac97->id) {
 215        case AC97_ID_AK4540:
 216        case AC97_ID_AK4542:
 217                if (reg <= 0x1c || reg == 0x20 || reg == 0x26 || reg >= 0x7c)
 218                        return 1;
 219                return 0;
 220        case AC97_ID_AD1819:        /* AD1819 */
 221        case AC97_ID_AD1881:        /* AD1881 */
 222        case AC97_ID_AD1881A:        /* AD1881A */
 223                if (reg >= 0x3a && reg <= 0x6e)        /* 0x59 */
 224                        return 0;
 225                return 1;
 226        case AC97_ID_AD1885:        /* AD1885 */
 227        case AC97_ID_AD1886:        /* AD1886 */
 228        case AC97_ID_AD1886A:        /* AD1886A - !!verify!! --jk */
 229        case AC97_ID_AD1887:        /* AD1887 - !!verify!! --jk */
 230                if (reg == 0x5a)
 231                        return 1;
 232                if (reg >= 0x3c && reg <= 0x6e)        /* 0x59 */
 233                        return 0;
 234                return 1;
 235        case AC97_ID_STAC9700:
 236        case AC97_ID_STAC9704:
 237        case AC97_ID_STAC9705:
 238        case AC97_ID_STAC9708:
 239        case AC97_ID_STAC9721:
 240        case AC97_ID_STAC9744:
 241        case AC97_ID_STAC9756:
 242                if (reg <= 0x3a || reg >= 0x5a)
 243                        return 1;
 244                return 0;
 245        }
 246        return 1;
 247}
 248
 249/**
 250 * snd_ac97_write - write a value on the given register
 251 * @ac97: the ac97 instance
 252 * @reg: the register to change
 253 * @value: the value to set
 254 *
 255 * Writes a value on the given register.  This will invoke the write
 256 * callback directly after the register check.
 257 * This function doesn't change the register cache unlike
 258 * #snd_ca97_write_cache(), so use this only when you don't want to
 259 * reflect the change to the suspend/resume state.
 260 */
 261void snd_ac97_write(struct snd_ac97 *ac97, unsigned short reg, unsigned short value)
 262{
 263        if (!snd_ac97_valid_reg(ac97, reg))
 264                return;
 265        if ((ac97->id & 0xffffff00) == AC97_ID_ALC100) {
 266                /* Fix H/W bug of ALC100/100P */
 267                if (reg == AC97_MASTER || reg == AC97_HEADPHONE)
 268                        ac97->bus->ops->write(ac97, AC97_RESET, 0);        /* reset audio codec */
 269        }
 270        ac97->bus->ops->write(ac97, reg, value);
 271}
 272
 273EXPORT_SYMBOL(snd_ac97_write);
 274
 275/**
 276 * snd_ac97_read - read a value from the given register
 277 * 
 278 * @ac97: the ac97 instance
 279 * @reg: the register to read
 280 *
 281 * Reads a value from the given register.  This will invoke the read
 282 * callback directly after the register check.
 283 *
 284 * Returns the read value.
 285 */
 286unsigned short snd_ac97_read(struct snd_ac97 *ac97, unsigned short reg)
 287{
 288        if (!snd_ac97_valid_reg(ac97, reg))
 289                return 0;
 290        return ac97->bus->ops->read(ac97, reg);
 291}
 292
 293/* read a register - return the cached value if already read */
 294static inline unsigned short snd_ac97_read_cache(struct snd_ac97 *ac97, unsigned short reg)
 295{
 296        if (! test_bit(reg, ac97->reg_accessed)) {
 297                ac97->regs[reg] = ac97->bus->ops->read(ac97, reg);
 298                // set_bit(reg, ac97->reg_accessed);
 299        }
 300        return ac97->regs[reg];
 301}
 302
 303EXPORT_SYMBOL(snd_ac97_read);
 304
 305/**
 306 * snd_ac97_write_cache - write a value on the given register and update the cache
 307 * @ac97: the ac97 instance
 308 * @reg: the register to change
 309 * @value: the value to set
 310 *
 311 * Writes a value on the given register and updates the register
 312 * cache.  The cached values are used for the cached-read and the
 313 * suspend/resume.
 314 */
 315void snd_ac97_write_cache(struct snd_ac97 *ac97, unsigned short reg, unsigned short value)
 316{
 317        if (!snd_ac97_valid_reg(ac97, reg))
 318                return;
 319        mutex_lock(&ac97->reg_mutex);
 320        ac97->regs[reg] = value;
 321        ac97->bus->ops->write(ac97, reg, value);
 322        set_bit(reg, ac97->reg_accessed);
 323        mutex_unlock(&ac97->reg_mutex);
 324}
 325
 326EXPORT_SYMBOL(snd_ac97_write_cache);
 327
 328/**
 329 * snd_ac97_update - update the value on the given register
 330 * @ac97: the ac97 instance
 331 * @reg: the register to change
 332 * @value: the value to set
 333 *
 334 * Compares the value with the register cache and updates the value
 335 * only when the value is changed.
 336 *
 337 * Returns 1 if the value is changed, 0 if no change, or a negative
 338 * code on failure.
 339 */
 340int snd_ac97_update(struct snd_ac97 *ac97, unsigned short reg, unsigned short value)
 341{
 342        int change;
 343
 344        if (!snd_ac97_valid_reg(ac97, reg))
 345                return -EINVAL;
 346        mutex_lock(&ac97->reg_mutex);
 347        change = ac97->regs[reg] != value;
 348        if (change) {
 349                ac97->regs[reg] = value;
 350                ac97->bus->ops->write(ac97, reg, value);
 351        }
 352        set_bit(reg, ac97->reg_accessed);
 353        mutex_unlock(&ac97->reg_mutex);
 354        return change;
 355}
 356
 357EXPORT_SYMBOL(snd_ac97_update);
 358
 359/**
 360 * snd_ac97_update_bits - update the bits on the given register
 361 * @ac97: the ac97 instance
 362 * @reg: the register to change
 363 * @mask: the bit-mask to change
 364 * @value: the value to set
 365 *
 366 * Updates the masked-bits on the given register only when the value
 367 * is changed.
 368 *
 369 * Returns 1 if the bits are changed, 0 if no change, or a negative
 370 * code on failure.
 371 */
 372int snd_ac97_update_bits(struct snd_ac97 *ac97, unsigned short reg, unsigned short mask, unsigned short value)
 373{
 374        int change;
 375
 376        if (!snd_ac97_valid_reg(ac97, reg))
 377                return -EINVAL;
 378        mutex_lock(&ac97->reg_mutex);
 379        change = snd_ac97_update_bits_nolock(ac97, reg, mask, value);
 380        mutex_unlock(&ac97->reg_mutex);
 381        return change;
 382}
 383
 384EXPORT_SYMBOL(snd_ac97_update_bits);
 385
 386/* no lock version - see snd_ac97_updat_bits() */
 387int snd_ac97_update_bits_nolock(struct snd_ac97 *ac97, unsigned short reg,
 388                                unsigned short mask, unsigned short value)
 389{
 390        int change;
 391        unsigned short old, new;
 392
 393        old = snd_ac97_read_cache(ac97, reg);
 394        new = (old & ~mask) | (value & mask);
 395        change = old != new;
 396        if (change) {
 397                ac97->regs[reg] = new;
 398                ac97->bus->ops->write(ac97, reg, new);
 399        }
 400        set_bit(reg, ac97->reg_accessed);
 401        return change;
 402}
 403
 404static int snd_ac97_ad18xx_update_pcm_bits(struct snd_ac97 *ac97, int codec, unsigned short mask, unsigned short value)
 405{
 406        int change;
 407        unsigned short old, new, cfg;
 408
 409        mutex_lock(&ac97->page_mutex);
 410        old = ac97->spec.ad18xx.pcmreg[codec];
 411        new = (old & ~mask) | (value & mask);
 412        change = old != new;
 413        if (change) {
 414                mutex_lock(&ac97->reg_mutex);
 415                cfg = snd_ac97_read_cache(ac97, AC97_AD_SERIAL_CFG);
 416                ac97->spec.ad18xx.pcmreg[codec] = new;
 417                /* select single codec */
 418                ac97->bus->ops->write(ac97, AC97_AD_SERIAL_CFG,
 419                                 (cfg & ~0x7000) |
 420                                 ac97->spec.ad18xx.unchained[codec] | ac97->spec.ad18xx.chained[codec]);
 421                /* update PCM bits */
 422                ac97->bus->ops->write(ac97, AC97_PCM, new);
 423                /* select all codecs */
 424                ac97->bus->ops->write(ac97, AC97_AD_SERIAL_CFG,
 425                                 cfg | 0x7000);
 426                mutex_unlock(&ac97->reg_mutex);
 427        }
 428        mutex_unlock(&ac97->page_mutex);
 429        return change;
 430}
 431
 432/*
 433 * Controls
 434 */
 435
 436static int snd_ac97_info_enum_double(struct snd_kcontrol *kcontrol,
 437                                     struct snd_ctl_elem_info *uinfo)
 438{
 439        struct ac97_enum *e = (struct ac97_enum *)kcontrol->private_value;
 440        
 441        uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
 442        uinfo->count = e->shift_l == e->shift_r ? 1 : 2;
 443        uinfo->value.enumerated.items = e->mask;
 444        
 445        if (uinfo->value.enumerated.item > e->mask - 1)
 446                uinfo->value.enumerated.item = e->mask - 1;
 447        strcpy(uinfo->value.enumerated.name, e->texts[uinfo->value.enumerated.item]);
 448        return 0;
 449}
 450
 451static int snd_ac97_get_enum_double(struct snd_kcontrol *kcontrol,
 452                                    struct snd_ctl_elem_value *ucontrol)
 453{
 454        struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
 455        struct ac97_enum *e = (struct ac97_enum *)kcontrol->private_value;
 456        unsigned short val, bitmask;
 457        
 458        for (bitmask = 1; bitmask < e->mask; bitmask <<= 1)
 459                ;
 460        val = snd_ac97_read_cache(ac97, e->reg);
 461        ucontrol->value.enumerated.item[0] = (val >> e->shift_l) & (bitmask - 1);
 462        if (e->shift_l != e->shift_r)
 463                ucontrol->value.enumerated.item[1] = (val >> e->shift_r) & (bitmask - 1);
 464
 465        return 0;
 466}
 467
 468static int snd_ac97_put_enum_double(struct snd_kcontrol *kcontrol,
 469                                    struct snd_ctl_elem_value *ucontrol)
 470{
 471        struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
 472        struct ac97_enum *e = (struct ac97_enum *)kcontrol->private_value;
 473        unsigned short val;
 474        unsigned short mask, bitmask;
 475        
 476        for (bitmask = 1; bitmask < e->mask; bitmask <<= 1)
 477                ;
 478        if (ucontrol->value.enumerated.item[0] > e->mask - 1)
 479                return -EINVAL;
 480        val = ucontrol->value.enumerated.item[0] << e->shift_l;
 481        mask = (bitmask - 1) << e->shift_l;
 482        if (e->shift_l != e->shift_r) {
 483                if (ucontrol->value.enumerated.item[1] > e->mask - 1)
 484                        return -EINVAL;
 485                val |= ucontrol->value.enumerated.item[1] << e->shift_r;
 486                mask |= (bitmask - 1) << e->shift_r;
 487        }
 488        return snd_ac97_update_bits(ac97, e->reg, mask, val);
 489}
 490
 491/* save/restore ac97 v2.3 paging */
 492static int snd_ac97_page_save(struct snd_ac97 *ac97, int reg, struct snd_kcontrol *kcontrol)
 493{
 494        int page_save = -1;
 495        if ((kcontrol->private_value & (1<<25)) &&
 496            (ac97->ext_id & AC97_EI_REV_MASK) >= AC97_EI_REV_23 &&
 497            (reg >= 0x60 && reg < 0x70)) {
 498                unsigned short page = (kcontrol->private_value >> 26) & 0x0f;
 499                mutex_lock(&ac97->page_mutex); /* lock paging */
 500                page_save = snd_ac97_read(ac97, AC97_INT_PAGING) & AC97_PAGE_MASK;
 501                snd_ac97_update_bits(ac97, AC97_INT_PAGING, AC97_PAGE_MASK, page);
 502        }
 503        return page_save;
 504}
 505
 506static void snd_ac97_page_restore(struct snd_ac97 *ac97, int page_save)
 507{
 508        if (page_save >= 0) {
 509                snd_ac97_update_bits(ac97, AC97_INT_PAGING, AC97_PAGE_MASK, page_save);
 510                mutex_unlock(&ac97->page_mutex); /* unlock paging */
 511        }
 512}
 513
 514/* volume and switch controls */
 515static int snd_ac97_info_volsw(struct snd_kcontrol *kcontrol,
 516                               struct snd_ctl_elem_info *uinfo)
 517{
 518        int mask = (kcontrol->private_value >> 16) & 0xff;
 519        int shift = (kcontrol->private_value >> 8) & 0x0f;
 520        int rshift = (kcontrol->private_value >> 12) & 0x0f;
 521
 522        uinfo->type = mask == 1 ? SNDRV_CTL_ELEM_TYPE_BOOLEAN : SNDRV_CTL_ELEM_TYPE_INTEGER;
 523        uinfo->count = shift == rshift ? 1 : 2;
 524        uinfo->value.integer.min = 0;
 525        uinfo->value.integer.max = mask;
 526        return 0;
 527}
 528
 529static int snd_ac97_get_volsw(struct snd_kcontrol *kcontrol,
 530                              struct snd_ctl_elem_value *ucontrol)
 531{
 532        struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
 533        int reg = kcontrol->private_value & 0xff;
 534        int shift = (kcontrol->private_value >> 8) & 0x0f;
 535        int rshift = (kcontrol->private_value >> 12) & 0x0f;
 536        int mask = (kcontrol->private_value >> 16) & 0xff;
 537        int invert = (kcontrol->private_value >> 24) & 0x01;
 538        int page_save;
 539
 540        page_save = snd_ac97_page_save(ac97, reg, kcontrol);
 541        ucontrol->value.integer.value[0] = (snd_ac97_read_cache(ac97, reg) >> shift) & mask;
 542        if (shift != rshift)
 543                ucontrol->value.integer.value[1] = (snd_ac97_read_cache(ac97, reg) >> rshift) & mask;
 544        if (invert) {
 545                ucontrol->value.integer.value[0] = mask - ucontrol->value.integer.value[0];
 546                if (shift != rshift)
 547                        ucontrol->value.integer.value[1] = mask - ucontrol->value.integer.value[1];
 548        }
 549        snd_ac97_page_restore(ac97, page_save);
 550        return 0;
 551}
 552
 553static int snd_ac97_put_volsw(struct snd_kcontrol *kcontrol,
 554                              struct snd_ctl_elem_value *ucontrol)
 555{
 556        struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
 557        int reg = kcontrol->private_value & 0xff;
 558        int shift = (kcontrol->private_value >> 8) & 0x0f;
 559        int rshift = (kcontrol->private_value >> 12) & 0x0f;
 560        int mask = (kcontrol->private_value >> 16) & 0xff;
 561        int invert = (kcontrol->private_value >> 24) & 0x01;
 562        int err, page_save;
 563        unsigned short val, val2, val_mask;
 564        
 565        page_save = snd_ac97_page_save(ac97, reg, kcontrol);
 566        val = (ucontrol->value.integer.value[0] & mask);
 567        if (invert)
 568                val = mask - val;
 569        val_mask = mask << shift;
 570        val = val << shift;
 571        if (shift != rshift) {
 572                val2 = (ucontrol->value.integer.value[1] & mask);
 573                if (invert)
 574                        val2 = mask - val2;
 575                val_mask |= mask << rshift;
 576                val |= val2 << rshift;
 577        }
 578        err = snd_ac97_update_bits(ac97, reg, val_mask, val);
 579        snd_ac97_page_restore(ac97, page_save);
 580#ifdef CONFIG_SND_AC97_POWER_SAVE
 581        /* check analog mixer power-down */
 582        if ((val_mask & 0x8000) &&
 583            (kcontrol->private_value & (1<<30))) {
 584                if (val & 0x8000)
 585                        ac97->power_up &= ~(1 << (reg>>1));
 586                else
 587                        ac97->power_up |= 1 << (reg>>1);
 588                update_power_regs(ac97);
 589        }
 590#endif
 591        return err;
 592}
 593
 594static const struct snd_kcontrol_new snd_ac97_controls_master_mono[2] = {
 595AC97_SINGLE("Master Mono Playback Switch", AC97_MASTER_MONO, 15, 1, 1),
 596AC97_SINGLE("Master Mono Playback Volume", AC97_MASTER_MONO, 0, 31, 1)
 597};
 598
 599static const struct snd_kcontrol_new snd_ac97_controls_tone[2] = {
 600AC97_SINGLE("Tone Control - Bass", AC97_MASTER_TONE, 8, 15, 1),
 601AC97_SINGLE("Tone Control - Treble", AC97_MASTER_TONE, 0, 15, 1)
 602};
 603
 604static const struct snd_kcontrol_new snd_ac97_controls_pc_beep[2] = {
 605AC97_SINGLE("PC Speaker Playback Switch", AC97_PC_BEEP, 15, 1, 1),
 606AC97_SINGLE("PC Speaker Playback Volume", AC97_PC_BEEP, 1, 15, 1)
 607};
 608
 609static const struct snd_kcontrol_new snd_ac97_controls_mic_boost =
 610        AC97_SINGLE("Mic Boost (+20dB)", AC97_MIC, 6, 1, 0);
 611
 612
 613static const char* std_rec_sel[] = {"Mic", "CD", "Video", "Aux", "Line", "Mix", "Mix Mono", "Phone"};
 614static const char* std_3d_path[] = {"pre 3D", "post 3D"};
 615static const char* std_mix[] = {"Mix", "Mic"};
 616static const char* std_mic[] = {"Mic1", "Mic2"};
 617
 618static const struct ac97_enum std_enum[] = {
 619AC97_ENUM_DOUBLE(AC97_REC_SEL, 8, 0, 8, std_rec_sel),
 620AC97_ENUM_SINGLE(AC97_GENERAL_PURPOSE, 15, 2, std_3d_path),
 621AC97_ENUM_SINGLE(AC97_GENERAL_PURPOSE, 9, 2, std_mix),
 622AC97_ENUM_SINGLE(AC97_GENERAL_PURPOSE, 8, 2, std_mic),
 623};
 624
 625static const struct snd_kcontrol_new snd_ac97_control_capture_src = 
 626AC97_ENUM("Capture Source", std_enum[0]); 
 627
 628static const struct snd_kcontrol_new snd_ac97_control_capture_vol =
 629AC97_DOUBLE("Capture Volume", AC97_REC_GAIN, 8, 0, 15, 0);
 630
 631static const struct snd_kcontrol_new snd_ac97_controls_mic_capture[2] = {
 632AC97_SINGLE("Mic Capture Switch", AC97_REC_GAIN_MIC, 15, 1, 1),
 633AC97_SINGLE("Mic Capture Volume", AC97_REC_GAIN_MIC, 0, 15, 0)
 634};
 635
 636enum {
 637        AC97_GENERAL_PCM_OUT = 0,
 638        AC97_GENERAL_STEREO_ENHANCEMENT,
 639        AC97_GENERAL_3D,
 640        AC97_GENERAL_LOUDNESS,
 641        AC97_GENERAL_MONO,
 642        AC97_GENERAL_MIC,
 643        AC97_GENERAL_LOOPBACK
 644};
 645
 646static const struct snd_kcontrol_new snd_ac97_controls_general[7] = {
 647AC97_ENUM("PCM Out Path & Mute", std_enum[1]),
 648AC97_SINGLE("Simulated Stereo Enhancement", AC97_GENERAL_PURPOSE, 14, 1, 0),
 649AC97_SINGLE("3D Control - Switch", AC97_GENERAL_PURPOSE, 13, 1, 0),
 650AC97_SINGLE("Loudness (bass boost)", AC97_GENERAL_PURPOSE, 12, 1, 0),
 651AC97_ENUM("Mono Output Select", std_enum[2]),
 652AC97_ENUM("Mic Select", std_enum[3]),
 653AC97_SINGLE("ADC/DAC Loopback", AC97_GENERAL_PURPOSE, 7, 1, 0)
 654};
 655
 656static const struct snd_kcontrol_new snd_ac97_controls_3d[2] = {
 657AC97_SINGLE("3D Control - Center", AC97_3D_CONTROL, 8, 15, 0),
 658AC97_SINGLE("3D Control - Depth", AC97_3D_CONTROL, 0, 15, 0)
 659};
 660
 661static const struct snd_kcontrol_new snd_ac97_controls_center[2] = {
 662AC97_SINGLE("Center Playback Switch", AC97_CENTER_LFE_MASTER, 7, 1, 1),
 663AC97_SINGLE("Center Playback Volume", AC97_CENTER_LFE_MASTER, 0, 31, 1)
 664};
 665
 666static const struct snd_kcontrol_new snd_ac97_controls_lfe[2] = {
 667AC97_SINGLE("LFE Playback Switch", AC97_CENTER_LFE_MASTER, 15, 1, 1),
 668AC97_SINGLE("LFE Playback Volume", AC97_CENTER_LFE_MASTER, 8, 31, 1)
 669};
 670
 671static const struct snd_kcontrol_new snd_ac97_control_eapd =
 672AC97_SINGLE("External Amplifier", AC97_POWERDOWN, 15, 1, 1);
 673
 674static const struct snd_kcontrol_new snd_ac97_controls_modem_switches[2] = {
 675AC97_SINGLE("Off-hook Switch", AC97_GPIO_STATUS, 0, 1, 0),
 676AC97_SINGLE("Caller ID Switch", AC97_GPIO_STATUS, 2, 1, 0)
 677};
 678
 679/* change the existing EAPD control as inverted */
 680static void set_inv_eapd(struct snd_ac97 *ac97, struct snd_kcontrol *kctl)
 681{
 682        kctl->private_value = AC97_SINGLE_VALUE(AC97_POWERDOWN, 15, 1, 0);
 683        snd_ac97_update_bits(ac97, AC97_POWERDOWN, (1<<15), (1<<15)); /* EAPD up */
 684        ac97->scaps |= AC97_SCAP_INV_EAPD;
 685}
 686
 687static int snd_ac97_spdif_mask_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo)
 688{
 689        uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
 690        uinfo->count = 1;
 691        return 0;
 692}
 693                        
 694static int snd_ac97_spdif_cmask_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 695{
 696        ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
 697                                           IEC958_AES0_NONAUDIO |
 698                                           IEC958_AES0_CON_EMPHASIS_5015 |
 699                                           IEC958_AES0_CON_NOT_COPYRIGHT;
 700        ucontrol->value.iec958.status[1] = IEC958_AES1_CON_CATEGORY |
 701                                           IEC958_AES1_CON_ORIGINAL;
 702        ucontrol->value.iec958.status[3] = IEC958_AES3_CON_FS;
 703        return 0;
 704}
 705                        
 706static int snd_ac97_spdif_pmask_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 707{
 708        /* FIXME: AC'97 spec doesn't say which bits are used for what */
 709        ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
 710                                           IEC958_AES0_NONAUDIO |
 711                                           IEC958_AES0_PRO_FS |
 712                                           IEC958_AES0_PRO_EMPHASIS_5015;
 713        return 0;
 714}
 715
 716static int snd_ac97_spdif_default_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 717{
 718        struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
 719
 720        mutex_lock(&ac97->reg_mutex);
 721        ucontrol->value.iec958.status[0] = ac97->spdif_status & 0xff;
 722        ucontrol->value.iec958.status[1] = (ac97->spdif_status >> 8) & 0xff;
 723        ucontrol->value.iec958.status[2] = (ac97->spdif_status >> 16) & 0xff;
 724        ucontrol->value.iec958.status[3] = (ac97->spdif_status >> 24) & 0xff;
 725        mutex_unlock(&ac97->reg_mutex);
 726        return 0;
 727}
 728                        
 729static int snd_ac97_spdif_default_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 730{
 731        struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
 732        unsigned int new = 0;
 733        unsigned short val = 0;
 734        int change;
 735
 736        new = val = ucontrol->value.iec958.status[0] & (IEC958_AES0_PROFESSIONAL|IEC958_AES0_NONAUDIO);
 737        if (ucontrol->value.iec958.status[0] & IEC958_AES0_PROFESSIONAL) {
 738                new |= ucontrol->value.iec958.status[0] & (IEC958_AES0_PRO_FS|IEC958_AES0_PRO_EMPHASIS_5015);
 739                switch (new & IEC958_AES0_PRO_FS) {
 740                case IEC958_AES0_PRO_FS_44100: val |= 0<<12; break;
 741                case IEC958_AES0_PRO_FS_48000: val |= 2<<12; break;
 742                case IEC958_AES0_PRO_FS_32000: val |= 3<<12; break;
 743                default:                       val |= 1<<12; break;
 744                }
 745                if ((new & IEC958_AES0_PRO_EMPHASIS) == IEC958_AES0_PRO_EMPHASIS_5015)
 746                        val |= 1<<3;
 747        } else {
 748                new |= ucontrol->value.iec958.status[0] & (IEC958_AES0_CON_EMPHASIS_5015|IEC958_AES0_CON_NOT_COPYRIGHT);
 749                new |= ((ucontrol->value.iec958.status[1] & (IEC958_AES1_CON_CATEGORY|IEC958_AES1_CON_ORIGINAL)) << 8);
 750                new |= ((ucontrol->value.iec958.status[3] & IEC958_AES3_CON_FS) << 24);
 751                if ((new & IEC958_AES0_CON_EMPHASIS) == IEC958_AES0_CON_EMPHASIS_5015)
 752                        val |= 1<<3;
 753                if (!(new & IEC958_AES0_CON_NOT_COPYRIGHT))
 754                        val |= 1<<2;
 755                val |= ((new >> 8) & 0xff) << 4;        // category + original
 756                switch ((new >> 24) & 0xff) {
 757                case IEC958_AES3_CON_FS_44100: val |= 0<<12; break;
 758                case IEC958_AES3_CON_FS_48000: val |= 2<<12; break;
 759                case IEC958_AES3_CON_FS_32000: val |= 3<<12; break;
 760                default:                       val |= 1<<12; break;
 761                }
 762        }
 763
 764        mutex_lock(&ac97->reg_mutex);
 765        change = ac97->spdif_status != new;
 766        ac97->spdif_status = new;
 767
 768        if (ac97->flags & AC97_CS_SPDIF) {
 769                int x = (val >> 12) & 0x03;
 770                switch (x) {
 771                case 0: x = 1; break;  // 44.1
 772                case 2: x = 0; break;  // 48.0
 773                default: x = 0; break; // illegal.
 774                }
 775                change |= snd_ac97_update_bits_nolock(ac97, AC97_CSR_SPDIF, 0x3fff, ((val & 0xcfff) | (x << 12)));
 776        } else if (ac97->flags & AC97_CX_SPDIF) {
 777                int v;
 778                v = new & (IEC958_AES0_CON_EMPHASIS_5015|IEC958_AES0_CON_NOT_COPYRIGHT) ? 0 : AC97_CXR_COPYRGT;
 779                v |= new & IEC958_AES0_NONAUDIO ? AC97_CXR_SPDIF_AC3 : AC97_CXR_SPDIF_PCM;
 780                change |= snd_ac97_update_bits_nolock(ac97, AC97_CXR_AUDIO_MISC, 
 781                                                      AC97_CXR_SPDIF_MASK | AC97_CXR_COPYRGT,
 782                                                      v);
 783        } else if (ac97->id == AC97_ID_YMF743) {
 784                change |= snd_ac97_update_bits_nolock(ac97,
 785                                                      AC97_YMF7X3_DIT_CTRL,
 786                                                      0xff38,
 787                                                      ((val << 4) & 0xff00) |
 788                                                      ((val << 2) & 0x0038));
 789        } else {
 790                unsigned short extst = snd_ac97_read_cache(ac97, AC97_EXTENDED_STATUS);
 791                snd_ac97_update_bits_nolock(ac97, AC97_EXTENDED_STATUS, AC97_EA_SPDIF, 0); /* turn off */
 792
 793                change |= snd_ac97_update_bits_nolock(ac97, AC97_SPDIF, 0x3fff, val);
 794                if (extst & AC97_EA_SPDIF) {
 795                        snd_ac97_update_bits_nolock(ac97, AC97_EXTENDED_STATUS, AC97_EA_SPDIF, AC97_EA_SPDIF); /* turn on again */
 796                }
 797        }
 798        mutex_unlock(&ac97->reg_mutex);
 799
 800        return change;
 801}
 802
 803static int snd_ac97_put_spsa(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 804{
 805        struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
 806        int reg = kcontrol->private_value & 0xff;
 807        int shift = (kcontrol->private_value >> 8) & 0xff;
 808        int mask = (kcontrol->private_value >> 16) & 0xff;
 809        // int invert = (kcontrol->private_value >> 24) & 0xff;
 810        unsigned short value, old, new;
 811        int change;
 812
 813        value = (ucontrol->value.integer.value[0] & mask);
 814
 815        mutex_lock(&ac97->reg_mutex);
 816        mask <<= shift;
 817        value <<= shift;
 818        old = snd_ac97_read_cache(ac97, reg);
 819        new = (old & ~mask) | value;
 820        change = old != new;
 821
 822        if (change) {
 823                unsigned short extst = snd_ac97_read_cache(ac97, AC97_EXTENDED_STATUS);
 824                snd_ac97_update_bits_nolock(ac97, AC97_EXTENDED_STATUS, AC97_EA_SPDIF, 0); /* turn off */
 825                change = snd_ac97_update_bits_nolock(ac97, reg, mask, value);
 826                if (extst & AC97_EA_SPDIF)
 827                        snd_ac97_update_bits_nolock(ac97, AC97_EXTENDED_STATUS, AC97_EA_SPDIF, AC97_EA_SPDIF); /* turn on again */
 828        }
 829        mutex_unlock(&ac97->reg_mutex);
 830        return change;
 831}
 832
 833static const struct snd_kcontrol_new snd_ac97_controls_spdif[5] = {
 834        {
 835                .access = SNDRV_CTL_ELEM_ACCESS_READ,
 836                .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
 837                .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,CON_MASK),
 838                .info = snd_ac97_spdif_mask_info,
 839                .get = snd_ac97_spdif_cmask_get,
 840        },
 841        {
 842                .access = SNDRV_CTL_ELEM_ACCESS_READ,
 843                .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
 844                .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,PRO_MASK),
 845                .info = snd_ac97_spdif_mask_info,
 846                .get = snd_ac97_spdif_pmask_get,
 847        },
 848        {
 849                .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
 850                .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,DEFAULT),
 851                .info = snd_ac97_spdif_mask_info,
 852                .get = snd_ac97_spdif_default_get,
 853                .put = snd_ac97_spdif_default_put,
 854        },
 855
 856        AC97_SINGLE(SNDRV_CTL_NAME_IEC958("",PLAYBACK,SWITCH),AC97_EXTENDED_STATUS, 2, 1, 0),
 857        {
 858                .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
 859                .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,NONE) "AC97-SPSA",
 860                .info = snd_ac97_info_volsw,
 861                .get = snd_ac97_get_volsw,
 862                .put = snd_ac97_put_spsa,
 863                .private_value = AC97_SINGLE_VALUE(AC97_EXTENDED_STATUS, 4, 3, 0)
 864        },
 865};
 866
 867#define AD18XX_PCM_BITS(xname, codec, lshift, rshift, mask) \
 868{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .info = snd_ac97_ad18xx_pcm_info_bits, \
 869  .get = snd_ac97_ad18xx_pcm_get_bits, .put = snd_ac97_ad18xx_pcm_put_bits, \
 870  .private_value = (codec) | ((lshift) << 8) | ((rshift) << 12) | ((mask) << 16) }
 871
 872static int snd_ac97_ad18xx_pcm_info_bits(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo)
 873{
 874        struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
 875        int mask = (kcontrol->private_value >> 16) & 0x0f;
 876        int lshift = (kcontrol->private_value >> 8) & 0x0f;
 877        int rshift = (kcontrol->private_value >> 12) & 0x0f;
 878
 879        uinfo->type = mask == 1 ? SNDRV_CTL_ELEM_TYPE_BOOLEAN : SNDRV_CTL_ELEM_TYPE_INTEGER;
 880        if (lshift != rshift && (ac97->flags & AC97_STEREO_MUTES))
 881                uinfo->count = 2;
 882        else
 883                uinfo->count = 1;
 884        uinfo->value.integer.min = 0;
 885        uinfo->value.integer.max = mask;
 886        return 0;
 887}
 888
 889static int snd_ac97_ad18xx_pcm_get_bits(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 890{
 891        struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
 892        int codec = kcontrol->private_value & 3;
 893        int lshift = (kcontrol->private_value >> 8) & 0x0f;
 894        int rshift = (kcontrol->private_value >> 12) & 0x0f;
 895        int mask = (kcontrol->private_value >> 16) & 0xff;
 896        
 897        ucontrol->value.integer.value[0] = mask - ((ac97->spec.ad18xx.pcmreg[codec] >> lshift) & mask);
 898        if (lshift != rshift && (ac97->flags & AC97_STEREO_MUTES))
 899                ucontrol->value.integer.value[1] = mask - ((ac97->spec.ad18xx.pcmreg[codec] >> rshift) & mask);
 900        return 0;
 901}
 902
 903static int snd_ac97_ad18xx_pcm_put_bits(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 904{
 905        struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
 906        int codec = kcontrol->private_value & 3;
 907        int lshift = (kcontrol->private_value >> 8) & 0x0f;
 908        int rshift = (kcontrol->private_value >> 12) & 0x0f;
 909        int mask = (kcontrol->private_value >> 16) & 0xff;
 910        unsigned short val, valmask;
 911        
 912        val = (mask - (ucontrol->value.integer.value[0] & mask)) << lshift;
 913        valmask = mask << lshift;
 914        if (lshift != rshift && (ac97->flags & AC97_STEREO_MUTES)) {
 915                val |= (mask - (ucontrol->value.integer.value[1] & mask)) << rshift;
 916                valmask |= mask << rshift;
 917        }
 918        return snd_ac97_ad18xx_update_pcm_bits(ac97, codec, valmask, val);
 919}
 920
 921#define AD18XX_PCM_VOLUME(xname, codec) \
 922{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .info = snd_ac97_ad18xx_pcm_info_volume, \
 923  .get = snd_ac97_ad18xx_pcm_get_volume, .put = snd_ac97_ad18xx_pcm_put_volume, \
 924  .private_value = codec }
 925
 926static int snd_ac97_ad18xx_pcm_info_volume(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo)
 927{
 928        uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
 929        uinfo->count = 2;
 930        uinfo->value.integer.min = 0;
 931        uinfo->value.integer.max = 31;
 932        return 0;
 933}
 934
 935static int snd_ac97_ad18xx_pcm_get_volume(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 936{
 937        struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
 938        int codec = kcontrol->private_value & 3;
 939        
 940        mutex_lock(&ac97->page_mutex);
 941        ucontrol->value.integer.value[0] = 31 - ((ac97->spec.ad18xx.pcmreg[codec] >> 0) & 31);
 942        ucontrol->value.integer.value[1] = 31 - ((ac97->spec.ad18xx.pcmreg[codec] >> 8) & 31);
 943        mutex_unlock(&ac97->page_mutex);
 944        return 0;
 945}
 946
 947static int snd_ac97_ad18xx_pcm_put_volume(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
 948{
 949        struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
 950        int codec = kcontrol->private_value & 3;
 951        unsigned short val1, val2;
 952        
 953        val1 = 31 - (ucontrol->value.integer.value[0] & 31);
 954        val2 = 31 - (ucontrol->value.integer.value[1] & 31);
 955        return snd_ac97_ad18xx_update_pcm_bits(ac97, codec, 0x1f1f, (val1 << 8) | val2);
 956}
 957
 958static const struct snd_kcontrol_new snd_ac97_controls_ad18xx_pcm[2] = {
 959AD18XX_PCM_BITS("PCM Playback Switch", 0, 15, 7, 1),
 960AD18XX_PCM_VOLUME("PCM Playback Volume", 0)
 961};
 962
 963static const struct snd_kcontrol_new snd_ac97_controls_ad18xx_surround[2] = {
 964AD18XX_PCM_BITS("Surround Playback Switch", 1, 15, 7, 1),
 965AD18XX_PCM_VOLUME("Surround Playback Volume", 1)
 966};
 967
 968static const struct snd_kcontrol_new snd_ac97_controls_ad18xx_center[2] = {
 969AD18XX_PCM_BITS("Center Playback Switch", 2, 15, 15, 1),
 970AD18XX_PCM_BITS("Center Playback Volume", 2, 8, 8, 31)
 971};
 972
 973static const struct snd_kcontrol_new snd_ac97_controls_ad18xx_lfe[2] = {
 974AD18XX_PCM_BITS("LFE Playback Switch", 2, 7, 7, 1),
 975AD18XX_PCM_BITS("LFE Playback Volume", 2, 0, 0, 31)
 976};
 977
 978/*
 979 *
 980 */
 981
 982static void snd_ac97_powerdown(struct snd_ac97 *ac97);
 983
 984static int snd_ac97_bus_free(struct snd_ac97_bus *bus)
 985{
 986        if (bus) {
 987                snd_ac97_bus_proc_done(bus);
 988                kfree(bus->pcms);
 989                if (bus->private_free)
 990                        bus->private_free(bus);
 991                kfree(bus);
 992        }
 993        return 0;
 994}
 995
 996static int snd_ac97_bus_dev_free(struct snd_device *device)
 997{
 998        struct snd_ac97_bus *bus = device->device_data;
 999        return snd_ac97_bus_free(bus);
1000}
1001
1002static int snd_ac97_free(struct snd_ac97 *ac97)
1003{
1004        if (ac97) {
1005#ifdef CONFIG_SND_AC97_POWER_SAVE
1006                cancel_delayed_work(&ac97->power_work);
1007                flush_scheduled_work();
1008#endif
1009                snd_ac97_proc_done(ac97);
1010                if (ac97->bus)
1011                        ac97->bus->codec[ac97->num] = NULL;
1012                if (ac97->private_free)
1013                        ac97->private_free(ac97);
1014                kfree(ac97);
1015        }
1016        return 0;
1017}
1018
1019static int snd_ac97_dev_free(struct snd_device *device)
1020{
1021        struct snd_ac97 *ac97 = device->device_data;
1022        snd_ac97_powerdown(ac97); /* for avoiding click noises during shut down */
1023        return snd_ac97_free(ac97);
1024}
1025
1026static int snd_ac97_try_volume_mix(struct snd_ac97 * ac97, int reg)
1027{
1028        unsigned short val, mask = 0x8000;
1029
1030        if (! snd_ac97_valid_reg(ac97, reg))
1031                return 0;
1032
1033        switch (reg) {
1034        case AC97_MASTER_TONE:
1035                return ac97->caps & 0x04 ? 1 : 0;
1036        case AC97_HEADPHONE:
1037                return ac97->caps & 0x10 ? 1 : 0;
1038        case AC97_REC_GAIN_MIC:
1039                return ac97->caps & 0x01 ? 1 : 0;
1040        case AC97_3D_CONTROL:
1041                if (ac97->caps & 0x7c00) {
1042                        val = snd_ac97_read(ac97, reg);
1043                        /* if nonzero - fixed and we can't set it */
1044                        return val == 0;
1045                }
1046                return 0;
1047        case AC97_CENTER_LFE_MASTER:        /* center */
1048                if ((ac97->ext_id & AC97_EI_CDAC) == 0)
1049                        return 0;
1050                break;
1051        case AC97_CENTER_LFE_MASTER+1:        /* lfe */
1052                if ((ac97->ext_id & AC97_EI_LDAC) == 0)
1053                        return 0;
1054                reg = AC97_CENTER_LFE_MASTER;
1055                mask = 0x0080;
1056                break;
1057        case AC97_SURROUND_MASTER:
1058                if ((ac97->ext_id & AC97_EI_SDAC) == 0)
1059                        return 0;
1060                break;
1061        }
1062
1063        val = snd_ac97_read(ac97, reg);
1064        if (!(val & mask)) {
1065                /* nothing seems to be here - mute flag is not set */
1066                /* try another test */
1067                snd_ac97_write_cache(ac97, reg, val | mask);
1068                val = snd_ac97_read(ac97, reg);
1069                val = snd_ac97_read(ac97, reg);
1070                if (!(val & mask))
1071                        return 0;        /* nothing here */
1072        }
1073        return 1;                /* success, useable */
1074}
1075
1076static void check_volume_resolution(struct snd_ac97 *ac97, int reg, unsigned char *lo_max, unsigned char *hi_max)
1077{
1078        unsigned short cbit[3] = { 0x20, 0x10, 0x01 };
1079        unsigned char max[3] = { 63, 31, 15 };
1080        int i;
1081
1082        /* first look up the static resolution table */
1083        if (ac97->res_table) {
1084                const struct snd_ac97_res_table *tbl;
1085                for (tbl = ac97->res_table; tbl->reg; tbl++) {
1086                        if (tbl->reg == reg) {
1087                                *lo_max = tbl->bits & 0xff;
1088                                *hi_max = (tbl->bits >> 8) & 0xff;
1089                                return;
1090                        }
1091                }
1092        }
1093
1094        *lo_max = *hi_max = 0;
1095        for (i = 0 ; i < ARRAY_SIZE(cbit); i++) {
1096                unsigned short val;
1097                snd_ac97_write(ac97, reg, 0x8080 | cbit[i] | (cbit[i] << 8));
1098                /* Do the read twice due to buffers on some ac97 codecs.
1099                 * e.g. The STAC9704 returns exactly what you wrote to the register
1100                 * if you read it immediately. This causes the detect routine to fail.
1101                 */
1102                val = snd_ac97_read(ac97, reg);
1103                val = snd_ac97_read(ac97, reg);
1104                if (! *lo_max && (val & 0x7f) == cbit[i])
1105                        *lo_max = max[i];
1106                if (! *hi_max && ((val >> 8) & 0x7f) == cbit[i])
1107                        *hi_max = max[i];
1108                if (*lo_max && *hi_max)
1109                        break;
1110        }
1111}
1112
1113static int snd_ac97_try_bit(struct snd_ac97 * ac97, int reg, int bit)
1114{
1115        unsigned short mask, val, orig, res;
1116
1117        mask = 1 << bit;
1118        orig = snd_ac97_read(ac97, reg);
1119        val = orig ^ mask;
1120        snd_ac97_write(ac97, reg, val);
1121        res = snd_ac97_read(ac97, reg);
1122        snd_ac97_write_cache(ac97, reg, orig);
1123        return res == val;
1124}
1125
1126/* check the volume resolution of center/lfe */
1127static void snd_ac97_change_volume_params2(struct snd_ac97 * ac97, int reg, int shift, unsigned char *max)
1128{
1129        unsigned short val, val1;
1130
1131        *max = 63;
1132        val = 0x8080 | (0x20 << shift);
1133        snd_ac97_write(ac97, reg, val);
1134        val1 = snd_ac97_read(ac97, reg);
1135        if (val != val1) {
1136                *max = 31;
1137        }
1138        /* reset volume to zero */
1139        snd_ac97_write_cache(ac97, reg, 0x8080);
1140}
1141
1142static inline int printable(unsigned int x)
1143{
1144        x &= 0xff;
1145        if (x < ' ' || x >= 0x71) {
1146                if (x <= 0x89)
1147                        return x - 0x71 + 'A';
1148                return '?';
1149        }
1150        return x;
1151}
1152
1153static struct snd_kcontrol *snd_ac97_cnew(const struct snd_kcontrol_new *_template,
1154                                          struct snd_ac97 * ac97)
1155{
1156        struct snd_kcontrol_new template;
1157        memcpy(&template, _template, sizeof(template));
1158        template.index = ac97->num;
1159        return snd_ctl_new1(&template, ac97);
1160}
1161
1162/*
1163 * create mute switch(es) for normal stereo controls
1164 */
1165static int snd_ac97_cmute_new_stereo(struct snd_card *card, char *name, int reg,
1166                                     int check_stereo, int check_amix,
1167                                     struct snd_ac97 *ac97)
1168{
1169        struct snd_kcontrol *kctl;
1170        int err;
1171        unsigned short val, val1, mute_mask;
1172
1173        if (! snd_ac97_valid_reg(ac97, reg))
1174                return 0;
1175
1176        mute_mask = 0x8000;
1177        val = snd_ac97_read(ac97, reg);
1178        if (check_stereo || (ac97->flags & AC97_STEREO_MUTES)) {
1179                /* check whether both mute bits work */
1180                val1 = val | 0x8080;
1181                snd_ac97_write(ac97, reg, val1);
1182                if (val1 == snd_ac97_read(ac97, reg))
1183                        mute_mask = 0x8080;
1184        }
1185        if (mute_mask == 0x8080) {
1186                struct snd_kcontrol_new tmp = AC97_DOUBLE(name, reg, 15, 7, 1, 1);
1187                if (check_amix)
1188                        tmp.private_value |= (1 << 30);
1189                tmp.index = ac97->num;
1190                kctl = snd_ctl_new1(&tmp, ac97);
1191        } else {
1192                struct snd_kcontrol_new tmp = AC97_SINGLE(name, reg, 15, 1, 1);
1193                if (check_amix)
1194                        tmp.private_value |= (1 << 30);
1195                tmp.index = ac97->num;
1196                kctl = snd_ctl_new1(&tmp, ac97);
1197        }
1198        err = snd_ctl_add(card, kctl);
1199        if (err < 0)
1200                return err;
1201        /* mute as default */
1202        snd_ac97_write_cache(ac97, reg, val | mute_mask);
1203        return 0;
1204}
1205
1206/*
1207 * set dB information
1208 */
1209static const DECLARE_TLV_DB_SCALE(db_scale_4bit, -4500, 300, 0);
1210static const DECLARE_TLV_DB_SCALE(db_scale_5bit, -4650, 150, 0);
1211static const DECLARE_TLV_DB_SCALE(db_scale_6bit, -9450, 150, 0);
1212static const DECLARE_TLV_DB_SCALE(db_scale_5bit_12db_max, -3450, 150, 0);
1213static const DECLARE_TLV_DB_SCALE(db_scale_rec_gain, 0, 150, 0);
1214
1215static const unsigned int *find_db_scale(unsigned int maxval)
1216{
1217        switch (maxval) {
1218        case 0x0f: return db_scale_4bit;
1219        case 0x1f: return db_scale_5bit;
1220        case 0x3f: return db_scale_6bit;
1221        }
1222        return NULL;
1223}
1224
1225static void set_tlv_db_scale(struct snd_kcontrol *kctl, const unsigned int *tlv)
1226{
1227        kctl->tlv.p = tlv;
1228        if (tlv)
1229                kctl->vd[0].access |= SNDRV_CTL_ELEM_ACCESS_TLV_READ;
1230}
1231
1232/*
1233 * create a volume for normal stereo/mono controls
1234 */
1235static int snd_ac97_cvol_new(struct snd_card *card, char *name, int reg, unsigned int lo_max,
1236                             unsigned int hi_max, struct snd_ac97 *ac97)
1237{
1238        int err;
1239        struct snd_kcontrol *kctl;
1240
1241        if (! snd_ac97_valid_reg(ac97, reg))
1242                return 0;
1243        if (hi_max) {
1244                /* invert */
1245                struct snd_kcontrol_new tmp = AC97_DOUBLE(name, reg, 8, 0, lo_max, 1);
1246                tmp.index = ac97->num;
1247                kctl = snd_ctl_new1(&tmp, ac97);
1248        } else {
1249                /* invert */
1250                struct snd_kcontrol_new tmp = AC97_SINGLE(name, reg, 0, lo_max, 1);
1251                tmp.index = ac97->num;
1252                kctl = snd_ctl_new1(&tmp, ac97);
1253        }
1254        if (reg >= AC97_PHONE && reg <= AC97_PCM)
1255                set_tlv_db_scale(kctl, db_scale_5bit_12db_max);
1256        else
1257                set_tlv_db_scale(kctl, find_db_scale(lo_max));
1258        err = snd_ctl_add(card, kctl);
1259        if (err < 0)
1260                return err;
1261        snd_ac97_write_cache(ac97, reg,
1262                             (snd_ac97_read(ac97, reg) & 0x8080) |
1263                             lo_max | (hi_max << 8));
1264        return 0;
1265}
1266
1267/*
1268 * create a mute-switch and a volume for normal stereo/mono controls
1269 */
1270static int snd_ac97_cmix_new_stereo(struct snd_card *card, const char *pfx,
1271                                    int reg, int check_stereo, int check_amix,
1272                                    struct snd_ac97 *ac97)
1273{
1274        int err;
1275        char name[44];
1276        unsigned char lo_max, hi_max;
1277
1278        if (! snd_ac97_valid_reg(ac97, reg))
1279                return 0;
1280
1281        if (snd_ac97_try_bit(ac97, reg, 15)) {
1282                sprintf(name, "%s Switch", pfx);
1283                if ((err = snd_ac97_cmute_new_stereo(card, name, reg,
1284                                                     check_stereo, check_amix,
1285                                                     ac97)) < 0)
1286                        return err;
1287        }
1288        check_volume_resolution(ac97, reg, &lo_max, &hi_max);
1289        if (lo_max) {
1290                sprintf(name, "%s Volume", pfx);
1291                if ((err = snd_ac97_cvol_new(card, name, reg, lo_max, hi_max, ac97)) < 0)
1292                        return err;
1293        }
1294        return 0;
1295}
1296
1297#define snd_ac97_cmix_new(card, pfx, reg, acheck, ac97) \
1298        snd_ac97_cmix_new_stereo(card, pfx, reg, 0, acheck, ac97)
1299#define snd_ac97_cmute_new(card, name, reg, acheck, ac97) \
1300        snd_ac97_cmute_new_stereo(card, name, reg, 0, acheck, ac97)
1301
1302static unsigned int snd_ac97_determine_spdif_rates(struct snd_ac97 *ac97);
1303
1304static int snd_ac97_mixer_build(struct snd_ac97 * ac97)
1305{
1306        struct snd_card *card = ac97->bus->card;
1307        struct snd_kcontrol *kctl;
1308        int err;
1309        unsigned int idx;
1310        unsigned char max;
1311
1312        /* build master controls */
1313        /* AD claims to remove this control from AD1887, although spec v2.2 does not allow this */
1314        if (snd_ac97_try_volume_mix(ac97, AC97_MASTER)) {
1315                if (ac97->flags & AC97_HAS_NO_MASTER_VOL)
1316                        err = snd_ac97_cmute_new(card, "Master Playback Switch",
1317                                                 AC97_MASTER, 0, ac97);
1318                else
1319                        err = snd_ac97_cmix_new(card, "Master Playback",
1320                                                AC97_MASTER, 0, ac97);
1321                if (err < 0)
1322                        return err;
1323        }
1324
1325        ac97->regs[AC97_CENTER_LFE_MASTER] = 0x8080;
1326
1327        /* build center controls */
1328        if ((snd_ac97_try_volume_mix(ac97, AC97_CENTER_LFE_MASTER)) 
1329                && !(ac97->flags & AC97_AD_MULTI)) {
1330                if ((err = snd_ctl_add(card, snd_ac97_cnew(&snd_ac97_controls_center[0], ac97))) < 0)
1331                        return err;
1332                if ((err = snd_ctl_add(card, kctl = snd_ac97_cnew(&snd_ac97_controls_center[1], ac97))) < 0)
1333                        return err;
1334                snd_ac97_change_volume_params2(ac97, AC97_CENTER_LFE_MASTER, 0, &max);
1335                kctl->private_value &= ~(0xff << 16);
1336                kctl->private_value |= (int)max << 16;
1337                set_tlv_db_scale(kctl, find_db_scale(max));
1338                snd_ac97_write_cache(ac97, AC97_CENTER_LFE_MASTER, ac97->regs[AC97_CENTER_LFE_MASTER] | max);
1339        }
1340
1341        /* build LFE controls */
1342        if ((snd_ac97_try_volume_mix(ac97, AC97_CENTER_LFE_MASTER+1))
1343                && !(ac97->flags & AC97_AD_MULTI)) {
1344                if ((err = snd_ctl_add(card, snd_ac97_cnew(&snd_ac97_controls_lfe[0], ac97))) < 0)
1345                        return err;
1346                if ((err = snd_ctl_add(card, kctl = snd_ac97_cnew(&snd_ac97_controls_lfe[1], ac97))) < 0)
1347                        return err;
1348                snd_ac97_change_volume_params2(ac97, AC97_CENTER_LFE_MASTER, 8, &max);
1349                kctl->private_value &= ~(0xff << 16);
1350                kctl->private_value |= (int)max << 16;
1351                set_tlv_db_scale(kctl, find_db_scale(max));
1352                snd_ac97_write_cache(ac97, AC97_CENTER_LFE_MASTER, ac97->regs[AC97_CENTER_LFE_MASTER] | max << 8);
1353        }
1354
1355        /* build surround controls */
1356        if ((snd_ac97_try_volume_mix(ac97, AC97_SURROUND_MASTER)) 
1357                && !(ac97->flags & AC97_AD_MULTI)) {
1358                /* Surround Master (0x38) is with stereo mutes */
1359                if ((err = snd_ac97_cmix_new_stereo(card, "Surround Playback",
1360                                                    AC97_SURROUND_MASTER, 1, 0,
1361                                                    ac97)) < 0)
1362                        return err;
1363        }
1364
1365        /* build headphone controls */
1366        if (snd_ac97_try_volume_mix(ac97, AC97_HEADPHONE)) {
1367                if ((err = snd_ac97_cmix_new(card, "Headphone Playback",
1368                                             AC97_HEADPHONE, 0, ac97)) < 0)
1369                        return err;
1370        }
1371        
1372        /* build master mono controls */
1373        if (snd_ac97_try_volume_mix(ac97, AC97_MASTER_MONO)) {
1374                if ((err = snd_ac97_cmix_new(card, "Master Mono Playback",
1375                                             AC97_MASTER_MONO, 0, ac97)) < 0)
1376                        return err;
1377        }
1378        
1379        /* build master tone controls */
1380        if (!(ac97->flags & AC97_HAS_NO_TONE)) {
1381                if (snd_ac97_try_volume_mix(ac97, AC97_MASTER_TONE)) {
1382                        for (idx = 0; idx < 2; idx++) {
1383                                if ((err = snd_ctl_add(card, kctl = snd_ac97_cnew(&snd_ac97_controls_tone[idx], ac97))) < 0)
1384                                        return err;
1385                                if (ac97->id == AC97_ID_YMF743 ||
1386                                    ac97->id == AC97_ID_YMF753) {
1387                                        kctl->private_value &= ~(0xff << 16);
1388                                        kctl->private_value |= 7 << 16;
1389                                }
1390                        }
1391                        snd_ac97_write_cache(ac97, AC97_MASTER_TONE, 0x0f0f);
1392                }
1393        }
1394        
1395        /* build PC Speaker controls */
1396        if (!(ac97->flags & AC97_HAS_NO_PC_BEEP) && 
1397                ((ac97->flags & AC97_HAS_PC_BEEP) ||
1398            snd_ac97_try_volume_mix(ac97, AC97_PC_BEEP))) {
1399                for (idx = 0; idx < 2; idx++)
1400                        if ((err = snd_ctl_add(card, kctl = snd_ac97_cnew(&snd_ac97_controls_pc_beep[idx], ac97))) < 0)
1401                                return err;
1402                set_tlv_db_scale(kctl, db_scale_4bit);
1403                snd_ac97_write_cache(ac97, AC97_PC_BEEP,
1404                                     snd_ac97_read(ac97, AC97_PC_BEEP) | 0x801e);
1405        }
1406        
1407        /* build Phone controls */
1408        if (!(ac97->flags & AC97_HAS_NO_PHONE)) {
1409                if (snd_ac97_try_volume_mix(ac97, AC97_PHONE)) {
1410                        if ((err = snd_ac97_cmix_new(card, "Phone Playback",
1411                                                     AC97_PHONE, 1, ac97)) < 0)
1412                                return err;
1413                }
1414        }
1415        
1416        /* build MIC controls */
1417        if (!(ac97->flags & AC97_HAS_NO_MIC)) {
1418                if (snd_ac97_try_volume_mix(ac97, AC97_MIC)) {
1419                        if ((err = snd_ac97_cmix_new(card, "Mic Playback",
1420                                                     AC97_MIC, 1, ac97)) < 0)
1421                                return err;
1422                        if ((err = snd_ctl_add(card, snd_ac97_cnew(&snd_ac97_controls_mic_boost, ac97))) < 0)
1423                                return err;
1424                }
1425        }
1426
1427        /* build Line controls */
1428        if (snd_ac97_try_volume_mix(ac97, AC97_LINE)) {
1429                if ((err = snd_ac97_cmix_new(card, "Line Playback",
1430                                             AC97_LINE, 1, ac97)) < 0)
1431                        return err;
1432        }
1433        
1434        /* build CD controls */
1435        if (!(ac97->flags & AC97_HAS_NO_CD)) {
1436                if (snd_ac97_try_volume_mix(ac97, AC97_CD)) {
1437                        if ((err = snd_ac97_cmix_new(card, "CD Playback",
1438                                                     AC97_CD, 1, ac97)) < 0)
1439                                return err;
1440                }
1441        }
1442        
1443        /* build Video controls */
1444        if (!(ac97->flags & AC97_HAS_NO_VIDEO)) {
1445                if (snd_ac97_try_volume_mix(ac97, AC97_VIDEO)) {
1446                        if ((err = snd_ac97_cmix_new(card, "Video Playback",
1447                                                     AC97_VIDEO, 1, ac97)) < 0)
1448                                return err;
1449                }
1450        }
1451
1452        /* build Aux controls */
1453        if (!(ac97->flags & AC97_HAS_NO_AUX)) {
1454                if (snd_ac97_try_volume_mix(ac97, AC97_AUX)) {
1455                        if ((err = snd_ac97_cmix_new(card, "Aux Playback",
1456                                                     AC97_AUX, 1, ac97)) < 0)
1457                                return err;
1458                }
1459        }
1460
1461        /* build PCM controls */
1462        if (ac97->flags & AC97_AD_MULTI) {
1463                unsigned short init_val;
1464                if (ac97->flags & AC97_STEREO_MUTES)
1465                        init_val = 0x9f9f;
1466                else
1467                        init_val = 0x9f1f;
1468                for (idx = 0; idx < 2; idx++)
1469                        if ((err = snd_ctl_add(card, kctl = snd_ac97_cnew(&snd_ac97_controls_ad18xx_pcm[idx], ac97))) < 0)
1470                                return err;
1471                set_tlv_db_scale(kctl, db_scale_5bit);
1472                ac97->spec.ad18xx.pcmreg[0] = init_val;
1473                if (ac97->scaps & AC97_SCAP_SURROUND_DAC) {
1474                        for (idx = 0; idx < 2; idx++)
1475                                if ((err = snd_ctl_add(card, kctl = snd_ac97_cnew(&snd_ac97_controls_ad18xx_surround[idx], ac97))) < 0)
1476                                        return err;
1477                        set_tlv_db_scale(kctl, db_scale_5bit);
1478                        ac97->spec.ad18xx.pcmreg[1] = init_val;
1479                }
1480                if (ac97->scaps & AC97_SCAP_CENTER_LFE_DAC) {
1481                        for (idx = 0; idx < 2; idx++)
1482                                if ((err = snd_ctl_add(card, kctl = snd_ac97_cnew(&snd_ac97_controls_ad18xx_center[idx], ac97))) < 0)
1483                                        return err;
1484                        set_tlv_db_scale(kctl, db_scale_5bit);
1485                        for (idx = 0; idx < 2; idx++)
1486                                if ((err = snd_ctl_add(card, kctl = snd_ac97_cnew(&snd_ac97_controls_ad18xx_lfe[idx], ac97))) < 0)
1487                                        return err;
1488                        set_tlv_db_scale(kctl, db_scale_5bit);
1489                        ac97->spec.ad18xx.pcmreg[2] = init_val;
1490                }
1491                snd_ac97_write_cache(ac97, AC97_PCM, init_val);
1492        } else {
1493                if (!(ac97->flags & AC97_HAS_NO_STD_PCM)) {
1494                        if (ac97->flags & AC97_HAS_NO_PCM_VOL)
1495                                err = snd_ac97_cmute_new(card,
1496                                                         "PCM Playback Switch",
1497                                                         AC97_PCM, 0, ac97);
1498                        else
1499                                err = snd_ac97_cmix_new(card, "PCM Playback",
1500                                                        AC97_PCM, 0, ac97);
1501                        if (err < 0)
1502                                return err;
1503                }
1504        }
1505
1506        /* build Capture controls */
1507        if (!(ac97->flags & AC97_HAS_NO_REC_GAIN)) {
1508                if ((err = snd_ctl_add(card, snd_ac97_cnew(&snd_ac97_control_capture_src, ac97))) < 0)
1509                        return err;
1510                if (snd_ac97_try_bit(ac97, AC97_REC_GAIN, 15)) {
1511                        err = snd_ac97_cmute_new(card, "Capture Switch",
1512                                                 AC97_REC_GAIN, 0, ac97);
1513                        if (err < 0)
1514                                return err;
1515                }
1516                if ((err = snd_ctl_add(card, kctl = snd_ac97_cnew(&snd_ac97_control_capture_vol, ac97))) < 0)
1517                        return err;
1518                set_tlv_db_scale(kctl, db_scale_rec_gain);
1519                snd_ac97_write_cache(ac97, AC97_REC_SEL, 0x0000);
1520                snd_ac97_write_cache(ac97, AC97_REC_GAIN, 0x0000);
1521        }
1522        /* build MIC Capture controls */
1523        if (snd_ac97_try_volume_mix(ac97, AC97_REC_GAIN_MIC)) {
1524                for (idx = 0; idx < 2; idx++)
1525                        if ((err = snd_ctl_add(card, kctl = snd_ac97_cnew(&snd_ac97_controls_mic_capture[idx], ac97))) < 0)
1526                                return err;
1527                set_tlv_db_scale(kctl, db_scale_rec_gain);
1528                snd_ac97_write_cache(ac97, AC97_REC_GAIN_MIC, 0x0000);
1529        }
1530
1531        /* build PCM out path & mute control */
1532        if (snd_ac97_try_bit(ac97, AC97_GENERAL_PURPOSE, 15)) {
1533                if ((err = snd_ctl_add(card, snd_ac97_cnew(&snd_ac97_controls_general[AC97_GENERAL_PCM_OUT], ac97))) < 0)
1534                        return err;
1535        }
1536
1537        /* build Simulated Stereo Enhancement control */
1538        if (ac97->caps & 0x0008) {
1539                if ((err = snd_ctl_add(card, snd_ac97_cnew(&snd_ac97_controls_general[AC97_GENERAL_STEREO_ENHANCEMENT], ac97))) < 0)
1540                        return err;
1541        }
1542
1543        /* build 3D Stereo Enhancement control */
1544        if (snd_ac97_try_bit(ac97, AC97_GENERAL_PURPOSE, 13)) {
1545                if ((err = snd_ctl_add(card, snd_ac97_cnew(&snd_ac97_controls_general[AC97_GENERAL_3D], ac97))) < 0)
1546                        return err;
1547        }
1548
1549        /* build Loudness control */
1550        if (ac97->caps & 0x0020) {
1551                if ((err = snd_ctl_add(card, snd_ac97_cnew(&snd_ac97_controls_general[AC97_GENERAL_LOUDNESS], ac97))) < 0)
1552                        return err;
1553        }
1554
1555        /* build Mono output select control */
1556        if (snd_ac97_try_bit(ac97, AC97_GENERAL_PURPOSE, 9)) {
1557                if ((err = snd_ctl_add(card, snd_ac97_cnew(&snd_ac97_controls_general[AC97_GENERAL_MONO], ac97))) < 0)
1558                        return err;
1559        }
1560
1561        /* build Mic select control */
1562        if (snd_ac97_try_bit(ac97, AC97_GENERAL_PURPOSE, 8)) {
1563                if ((err = snd_ctl_add(card, snd_ac97_cnew(&snd_ac97_controls_general[AC97_GENERAL_MIC], ac97))) < 0)
1564                        return err;
1565        }
1566
1567        /* build ADC/DAC loopback control */
1568        if (enable_loopback && snd_ac97_try_bit(ac97, AC97_GENERAL_PURPOSE, 7)) {
1569                if ((err = snd_ctl_add(card, snd_ac97_cnew(&snd_ac97_controls_general[AC97_GENERAL_LOOPBACK], ac97))) < 0)
1570                        return err;
1571        }
1572
1573        snd_ac97_update_bits(ac97, AC97_GENERAL_PURPOSE, ~AC97_GP_DRSS_MASK, 0x0000);
1574
1575        /* build 3D controls */
1576        if (ac97->build_ops->build_3d) {
1577                ac97->build_ops->build_3d(ac97);
1578        } else {
1579                if (snd_ac97_try_volume_mix(ac97, AC97_3D_CONTROL)) {
1580                        unsigned short val;
1581                        val = 0x0707;
1582                        snd_ac97_write(ac97, AC97_3D_CONTROL, val);
1583                        val = snd_ac97_read(ac97, AC97_3D_CONTROL);
1584                        val = val == 0x0606;
1585                        if ((err = snd_ctl_add(card, kctl = snd_ac97_cnew(&snd_ac97_controls_3d[0], ac97))) < 0)
1586                                return err;
1587                        if (val)
1588                                kctl->private_value = AC97_3D_CONTROL | (9 << 8) | (7 << 16);
1589                        if ((err = snd_ctl_add(card, kctl = snd_ac97_cnew(&snd_ac97_controls_3d[1], ac97))) < 0)
1590                                return err;
1591                        if (val)
1592                                kctl->private_value = AC97_3D_CONTROL | (1 << 8) | (7 << 16);
1593                        snd_ac97_write_cache(ac97, AC97_3D_CONTROL, 0x0000);
1594                }
1595        }
1596
1597        /* build S/PDIF controls */
1598
1599        /* Hack for ASUS P5P800-VM, which does not indicate S/PDIF capability */
1600        if (ac97->subsystem_vendor == 0x1043 &&
1601            ac97->subsystem_device == 0x810f)
1602                ac97->ext_id |= AC97_EI_SPDIF;
1603
1604        if ((ac97->ext_id & AC97_EI_SPDIF) && !(ac97->scaps & AC97_SCAP_NO_SPDIF)) {
1605                if (ac97->build_ops->build_spdif) {
1606                        if ((err = ac97->build_ops->build_spdif(ac97)) < 0)
1607                                return err;
1608                } else {
1609                        for (idx = 0; idx < 5; idx++)
1610                                if ((err = snd_ctl_add(card, snd_ac97_cnew(&snd_ac97_controls_spdif[idx], ac97))) < 0)
1611                                        return err;
1612                        if (ac97->build_ops->build_post_spdif) {
1613                                if ((err = ac97->build_ops->build_post_spdif(ac97)) < 0)
1614                                        return err;
1615                        }
1616                        /* set default PCM S/PDIF params */
1617                        /* consumer,PCM audio,no copyright,no preemphasis,PCM coder,original,48000Hz */
1618                        snd_ac97_write_cache(ac97, AC97_SPDIF, 0x2a20);
1619                        ac97->rates[AC97_RATES_SPDIF] = snd_ac97_determine_spdif_rates(ac97);
1620                }
1621                ac97->spdif_status = SNDRV_PCM_DEFAULT_CON_SPDIF;
1622        }
1623        
1624        /* build chip specific controls */
1625        if (ac97->build_ops->build_specific)
1626                if ((err = ac97->build_ops->build_specific(ac97)) < 0)
1627                        return err;
1628
1629        if (snd_ac97_try_bit(ac97, AC97_POWERDOWN, 15)) {
1630                kctl = snd_ac97_cnew(&snd_ac97_control_eapd, ac97);
1631                if (! kctl)
1632                        return -ENOMEM;
1633                if (ac97->scaps & AC97_SCAP_INV_EAPD)
1634                        set_inv_eapd(ac97, kctl);
1635                if ((err = snd_ctl_add(card, kctl)) < 0)
1636                        return err;
1637        }
1638
1639        return 0;
1640}
1641
1642static int snd_ac97_modem_build(struct snd_card *card, struct snd_ac97 * ac97)
1643{
1644        int err, idx;
1645
1646        //printk("AC97_GPIO_CFG = %x\n",snd_ac97_read(ac97,AC97_GPIO_CFG));
1647        snd_ac97_write(ac97, AC97_GPIO_CFG, 0xffff & ~(AC97_GPIO_LINE1_OH));
1648        snd_ac97_write(ac97, AC97_GPIO_POLARITY, 0xffff & ~(AC97_GPIO_LINE1_OH));
1649        snd_ac97_write(ac97, AC97_GPIO_STICKY, 0xffff);
1650        snd_ac97_write(ac97, AC97_GPIO_WAKEUP, 0x0);
1651        snd_ac97_write(ac97, AC97_MISC_AFE, 0x0);
1652
1653        /* build modem switches */
1654        for (idx = 0; idx < ARRAY_SIZE(snd_ac97_controls_modem_switches); idx++)
1655                if ((err = snd_ctl_add(card, snd_ctl_new1(&snd_ac97_controls_modem_switches[idx], ac97))) < 0)
1656                        return err;
1657
1658        /* build chip specific controls */
1659        if (ac97->build_ops->build_specific)
1660                if ((err = ac97->build_ops->build_specific(ac97)) < 0)
1661                        return err;
1662
1663        return 0;
1664}
1665
1666static int snd_ac97_test_rate(struct snd_ac97 *ac97, int reg, int shadow_reg, int rate)
1667{
1668        unsigned short val;
1669        unsigned int tmp;
1670
1671        tmp = ((unsigned int)rate * ac97->bus->clock) / 48000;
1672        snd_ac97_write_cache(ac97, reg, tmp & 0xffff);
1673        if (shadow_reg)
1674                snd_ac97_write_cache(ac97, shadow_reg, tmp & 0xffff);
1675        val = snd_ac97_read(ac97, reg);
1676        return val == (tmp & 0xffff);
1677}
1678
1679static void snd_ac97_determine_rates(struct snd_ac97 *ac97, int reg, int shadow_reg, unsigned int *r_result)
1680{
1681        unsigned int result = 0;
1682        unsigned short saved;
1683
1684        if (ac97->bus->no_vra) {
1685                *r_result = SNDRV_PCM_RATE_48000;
1686                if ((ac97->flags & AC97_DOUBLE_RATE) &&
1687                    reg == AC97_PCM_FRONT_DAC_RATE)
1688                        *r_result |= SNDRV_PCM_RATE_96000;
1689                return;
1690        }
1691
1692        saved = snd_ac97_read(ac97, reg);
1693        if ((ac97->ext_id & AC97_EI_DRA) && reg == AC97_PCM_FRONT_DAC_RATE)
1694                snd_ac97_update_bits(ac97, AC97_EXTENDED_STATUS,
1695                                     AC97_EA_DRA, 0);
1696        /* test a non-standard rate */
1697        if (snd_ac97_test_rate(ac97, reg, shadow_reg, 11000))
1698                result |= SNDRV_PCM_RATE_CONTINUOUS;
1699        /* let's try to obtain standard rates */
1700        if (snd_ac97_test_rate(ac97, reg, shadow_reg, 8000))
1701                result |= SNDRV_PCM_RATE_8000;
1702        if (snd_ac97_test_rate(ac97, reg, shadow_reg, 11025))
1703                result |= SNDRV_PCM_RATE_11025;
1704        if (snd_ac97_test_rate(ac97, reg, shadow_reg, 16000))
1705                result |= SNDRV_PCM_RATE_16000;
1706        if (snd_ac97_test_rate(ac97, reg, shadow_reg, 22050))
1707                result |= SNDRV_PCM_RATE_22050;
1708        if (snd_ac97_test_rate(ac97, reg, shadow_reg, 32000))
1709                result |= SNDRV_PCM_RATE_32000;
1710        if (snd_ac97_test_rate(ac97, reg, shadow_reg, 44100))
1711                result |= SNDRV_PCM_RATE_44100;
1712        if (snd_ac97_test_rate(ac97, reg, shadow_reg, 48000))
1713                result |= SNDRV_PCM_RATE_48000;
1714        if ((ac97->flags & AC97_DOUBLE_RATE) &&
1715            reg == AC97_PCM_FRONT_DAC_RATE) {
1716                /* test standard double rates */
1717                snd_ac97_update_bits(ac97, AC97_EXTENDED_STATUS,
1718                                     AC97_EA_DRA, AC97_EA_DRA);
1719                if (snd_ac97_test_rate(ac97, reg, shadow_reg, 64000 / 2))
1720                        result |= SNDRV_PCM_RATE_64000;
1721                if (snd_ac97_test_rate(ac97, reg, shadow_reg, 88200 / 2))
1722                        result |= SNDRV_PCM_RATE_88200;
1723                if (snd_ac97_test_rate(ac97, reg, shadow_reg, 96000 / 2))
1724                        result |= SNDRV_PCM_RATE_96000;
1725                /* some codecs don't support variable double rates */
1726                if (!snd_ac97_test_rate(ac97, reg, shadow_reg, 76100 / 2))
1727                        result &= ~SNDRV_PCM_RATE_CONTINUOUS;
1728                snd_ac97_update_bits(ac97, AC97_EXTENDED_STATUS,
1729                                     AC97_EA_DRA, 0);
1730        }
1731        /* restore the default value */
1732        snd_ac97_write_cache(ac97, reg, saved);
1733        if (shadow_reg)
1734                snd_ac97_write_cache(ac97, shadow_reg, saved);
1735        *r_result = result;
1736}
1737
1738/* check AC97_SPDIF register to accept which sample rates */
1739static unsigned int snd_ac97_determine_spdif_rates(struct snd_ac97 *ac97)
1740{
1741        unsigned int result = 0;
1742        int i;
1743        static unsigned short ctl_bits[] = {
1744                AC97_SC_SPSR_44K, AC97_SC_SPSR_32K, AC97_SC_SPSR_48K
1745        };
1746        static unsigned int rate_bits[] = {
1747                SNDRV_PCM_RATE_44100, SNDRV_PCM_RATE_32000, SNDRV_PCM_RATE_48000
1748        };
1749
1750        for (i = 0; i < (int)ARRAY_SIZE(ctl_bits); i++) {
1751                snd_ac97_update_bits(ac97, AC97_SPDIF, AC97_SC_SPSR_MASK, ctl_bits[i]);
1752                if ((snd_ac97_read(ac97, AC97_SPDIF) & AC97_SC_SPSR_MASK) == ctl_bits[i])
1753                        result |= rate_bits[i];
1754        }
1755        return result;
1756}
1757
1758/* look for the codec id table matching with the given id */
1759static const struct ac97_codec_id *look_for_codec_id(const struct ac97_codec_id *table,
1760                                                     unsigned int id)
1761{
1762        const struct ac97_codec_id *pid;
1763
1764        for (pid = table; pid->id; pid++)
1765                if (pid->id == (id & pid->mask))
1766                        return pid;
1767        return NULL;
1768}
1769
1770void snd_ac97_get_name(struct snd_ac97 *ac97, unsigned int id, char *name, int modem)
1771{
1772        const struct ac97_codec_id *pid;
1773
1774        sprintf(name, "0x%x %c%c%c", id,
1775                printable(id >> 24),
1776                printable(id >> 16),
1777                printable(id >> 8));
1778        pid = look_for_codec_id(snd_ac97_codec_id_vendors, id);
1779        if (! pid)
1780                return;
1781
1782        strcpy(name, pid->name);
1783        if (ac97 && pid->patch) {
1784                if ((modem && (pid->flags & AC97_MODEM_PATCH)) ||
1785                    (! modem && ! (pid->flags & AC97_MODEM_PATCH)))
1786                        pid->patch(ac97);
1787        } 
1788
1789        pid = look_for_codec_id(snd_ac97_codec_ids, id);
1790        if (pid) {
1791                strcat(name, " ");
1792                strcat(name, pid->name);
1793                if (pid->mask != 0xffffffff)
1794                        sprintf(name + strlen(name), " rev %d", id & ~pid->mask);
1795                if (ac97 && pid->patch) {
1796                        if ((modem && (pid->flags & AC97_MODEM_PATCH)) ||
1797                            (! modem && ! (pid->flags & AC97_MODEM_PATCH)))
1798                                pid->patch(ac97);
1799                }
1800        } else
1801                sprintf(name + strlen(name), " id %x", id & 0xff);
1802}
1803
1804/**
1805 * snd_ac97_get_short_name - retrieve codec name
1806 * @ac97: the codec instance
1807 *
1808 * Returns the short identifying name of the codec.
1809 */
1810const char *snd_ac97_get_short_name(struct snd_ac97 *ac97)
1811{
1812        const struct ac97_codec_id *pid;
1813
1814        for (pid = snd_ac97_codec_ids; pid->id; pid++)
1815                if (pid->id == (ac97->id & pid->mask))
1816                        return pid->name;
1817        return "unknown codec";
1818}
1819
1820EXPORT_SYMBOL(snd_ac97_get_short_name);
1821
1822/* wait for a while until registers are accessible after RESET
1823 * return 0 if ok, negative not ready
1824 */
1825static int ac97_reset_wait(struct snd_ac97 *ac97, int timeout, int with_modem)
1826{
1827        unsigned long end_time;
1828        unsigned short val;
1829
1830        end_time = jiffies + timeout;
1831        do {
1832                
1833                /* use preliminary reads to settle the communication */
1834                snd_ac97_read(ac97, AC97_RESET);
1835                snd_ac97_read(ac97, AC97_VENDOR_ID1);
1836                snd_ac97_read(ac97, AC97_VENDOR_ID2);
1837                /* modem? */
1838                if (with_modem) {
1839                        val = snd_ac97_read(ac97, AC97_EXTENDED_MID);
1840                        if (val != 0xffff && (val & 1) != 0)
1841                                return 0;
1842                }
1843                if (ac97->scaps & AC97_SCAP_DETECT_BY_VENDOR) {
1844                        /* probably only Xbox issue - all registers are read as zero */
1845                        val = snd_ac97_read(ac97, AC97_VENDOR_ID1);
1846                        if (val != 0 && val != 0xffff)
1847                                return 0;
1848                } else {
1849                        /* because the PCM or MASTER volume registers can be modified,
1850                         * the REC_GAIN register is used for tests
1851                         */
1852                        /* test if we can write to the record gain volume register */
1853                        snd_ac97_write_cache(ac97, AC97_REC_GAIN, 0x8a05);
1854                        if ((snd_ac97_read(ac97, AC97_REC_GAIN) & 0x7fff) == 0x0a05)
1855                                return 0;
1856                }
1857                schedule_timeout_uninterruptible(1);
1858        } while (time_after_eq(end_time, jiffies));
1859        return -ENODEV;
1860}
1861
1862/**
1863 * snd_ac97_bus - create an AC97 bus component
1864 * @card: the card instance
1865 * @num: the bus number
1866 * @ops: the bus callbacks table
1867 * @private_data: private data pointer for the new instance
1868 * @rbus: the pointer to store the new AC97 bus instance.
1869 *
1870 * Creates an AC97 bus component.  An struct snd_ac97_bus instance is newly
1871 * allocated and initialized.
1872 *
1873 * The ops table must include valid callbacks (at least read and
1874 * write).  The other callbacks, wait and reset, are not mandatory.
1875 * 
1876 * The clock is set to 48000.  If another clock is needed, set
1877 * (*rbus)->clock manually.
1878 *
1879 * The AC97 bus instance is registered as a low-level device, so you don't
1880 * have to release it manually.
1881 *
1882 * Returns zero if successful, or a negative error code on failure.
1883 */
1884int snd_ac97_bus(struct snd_card *card, int num, struct snd_ac97_bus_ops *ops,
1885                 void *private_data, struct snd_ac97_bus **rbus)
1886{
1887        int err;
1888        struct snd_ac97_bus *bus;
1889        static struct snd_device_ops dev_ops = {
1890                .dev_free =        snd_ac97_bus_dev_free,
1891        };
1892
1893        if (snd_BUG_ON(!card))
1894                return -EINVAL;
1895        bus = kzalloc(sizeof(*bus), GFP_KERNEL);
1896        if (bus == NULL)
1897                return -ENOMEM;
1898        bus->card = card;
1899        bus->num = num;
1900        bus->ops = ops;
1901        bus->private_data = private_data;
1902        bus->clock = 48000;
1903        spin_lock_init(&bus->bus_lock);
1904        snd_ac97_bus_proc_init(bus);
1905        if ((err = snd_device_new(card, SNDRV_DEV_BUS, bus, &dev_ops)) < 0) {
1906                snd_ac97_bus_free(bus);
1907                return err;
1908        }
1909        if (rbus)
1910                *rbus = bus;
1911        return 0;
1912}
1913
1914EXPORT_SYMBOL(snd_ac97_bus);
1915
1916/* stop no dev release warning */
1917static void ac97_device_release(struct device * dev)
1918{
1919}
1920
1921/* register ac97 codec to bus */
1922static int snd_ac97_dev_register(struct snd_device *device)
1923{
1924        struct snd_ac97 *ac97 = device->device_data;
1925        int err;
1926
1927        ac97->dev.bus = &ac97_bus_type;
1928        ac97->dev.parent = ac97->bus->card->dev;
1929        ac97->dev.release = ac97_device_release;
1930        dev_set_name(&ac97->dev, "%d-%d:%s",
1931                     ac97->bus->card->number, ac97->num,
1932                     snd_ac97_get_short_name(ac97));
1933        if ((err = device_register(&ac97->dev)) < 0) {
1934                snd_printk(KERN_ERR "Can't register ac97 bus\n");
1935                ac97->dev.bus = NULL;
1936                return err;
1937        }
1938        return 0;
1939}
1940
1941/* disconnect ac97 codec */
1942static int snd_ac97_dev_disconnect(struct snd_device *device)
1943{
1944        struct snd_ac97 *ac97 = device->device_data;
1945        if (ac97->dev.bus)
1946                device_unregister(&ac97->dev);
1947        return 0;
1948}
1949
1950/* build_ops to do nothing */
1951static struct snd_ac97_build_ops null_build_ops;
1952
1953#ifdef CONFIG_SND_AC97_POWER_SAVE
1954static void do_update_power(struct work_struct *work)
1955{
1956        update_power_regs(
1957                container_of(work, struct snd_ac97, power_work.work));
1958}
1959#endif
1960
1961/**
1962 * snd_ac97_mixer - create an Codec97 component
1963 * @bus: the AC97 bus which codec is attached to
1964 * @template: the template of ac97, including index, callbacks and
1965 *         the private data.
1966 * @rac97: the pointer to store the new ac97 instance.
1967 *
1968 * Creates an Codec97 component.  An struct snd_ac97 instance is newly
1969 * allocated and initialized from the template.  The codec
1970 * is then initialized by the standard procedure.
1971 *
1972 * The template must include the codec number (num) and address (addr),
1973 * and the private data (private_data).
1974 * 
1975 * The ac97 instance is registered as a low-level device, so you don't
1976 * have to release it manually.
1977 *
1978 * Returns zero if successful, or a negative error code on failure.
1979 */
1980int snd_ac97_mixer(struct snd_ac97_bus *bus, struct snd_ac97_template *template, struct snd_ac97 **rac97)
1981{
1982        int err;
1983        struct snd_ac97 *ac97;
1984        struct snd_card *card;
1985        char name[64];
1986        unsigned long end_time;
1987        unsigned int reg;
1988        const struct ac97_codec_id *pid;
1989        static struct snd_device_ops ops = {
1990                .dev_free =        snd_ac97_dev_free,
1991                .dev_register =        snd_ac97_dev_register,
1992                .dev_disconnect =        snd_ac97_dev_disconnect,
1993        };
1994
1995        if (rac97)
1996                *rac97 = NULL;
1997        if (snd_BUG_ON(!bus || !template))
1998                return -EINVAL;
1999        if (snd_BUG_ON(template->num >= 4))
2000                return -EINVAL;
2001        if (bus->codec[template->num])
2002                return -EBUSY;
2003
2004        card = bus->card;
2005        ac97 = kzalloc(sizeof(*ac97), GFP_KERNEL);
2006        if (ac97 == NULL)
2007                return -ENOMEM;
2008        ac97->private_data = template->private_data;
2009        ac97->private_free = template->private_free;
2010        ac97->bus = bus;
2011        ac97->pci = template->pci;
2012        ac97->num = template->num;
2013        ac97->addr = template->addr;
2014        ac97->scaps = template->scaps;
2015        ac97->res_table = template->res_table;
2016        bus->codec[ac97->num] = ac97;
2017        mutex_init(&ac97->reg_mutex);
2018        mutex_init(&ac97->page_mutex);
2019#ifdef CONFIG_SND_AC97_POWER_SAVE
2020        INIT_DELAYED_WORK(&ac97->power_work, do_update_power);
2021#endif
2022
2023#ifdef CONFIG_PCI
2024        if (ac97->pci) {
2025                pci_read_config_word(ac97->pci, PCI_SUBSYSTEM_VENDOR_ID, &ac97->subsystem_vendor);
2026                pci_read_config_word(ac97->pci, PCI_SUBSYSTEM_ID, &ac97->subsystem_device);
2027        }
2028#endif
2029        if (bus->ops->reset) {
2030                bus->ops->reset(ac97);
2031                goto __access_ok;
2032        }
2033
2034        ac97->id = snd_ac97_read(ac97, AC97_VENDOR_ID1) << 16;
2035        ac97->id |= snd_ac97_read(ac97, AC97_VENDOR_ID2);
2036        if (ac97->id && ac97->id != (unsigned int)-1) {
2037                pid = look_for_codec_id(snd_ac97_codec_ids, ac97->id);
2038                if (pid && (pid->flags & AC97_DEFAULT_POWER_OFF))
2039                        goto __access_ok;
2040        }
2041
2042        /* reset to defaults */
2043        if (!(ac97->scaps & AC97_SCAP_SKIP_AUDIO))
2044                snd_ac97_write(ac97, AC97_RESET, 0);
2045        if (!(ac97->scaps & AC97_SCAP_SKIP_MODEM))
2046                snd_ac97_write(ac97, AC97_EXTENDED_MID, 0);
2047        if (bus->ops->wait)
2048                bus->ops->wait(ac97);
2049        else {
2050                udelay(50);
2051                if (ac97->scaps & AC97_SCAP_SKIP_AUDIO)
2052                        err = ac97_reset_wait(ac97, msecs_to_jiffies(500), 1);
2053                else {
2054                        err = ac97_reset_wait(ac97, msecs_to_jiffies(500), 0);
2055                        if (err < 0)
2056                                err = ac97_reset_wait(ac97,
2057                                                      msecs_to_jiffies(500), 1);
2058                }
2059                if (err < 0) {
2060                        snd_printk(KERN_WARNING "AC'97 %d does not respond - RESET\n", ac97->num);
2061                        /* proceed anyway - it's often non-critical */
2062                }
2063        }
2064      __access_ok:
2065        ac97->id = snd_ac97_read(ac97, AC97_VENDOR_ID1) << 16;
2066        ac97->id |= snd_ac97_read(ac97, AC97_VENDOR_ID2);
2067        if (! (ac97->scaps & AC97_SCAP_DETECT_BY_VENDOR) &&
2068            (ac97->id == 0x00000000 || ac97->id == 0xffffffff)) {
2069                snd_printk(KERN_ERR "AC'97 %d access is not valid [0x%x], removing mixer.\n", ac97->num, ac97->id);
2070                snd_ac97_free(ac97);
2071                return -EIO;
2072        }
2073        pid = look_for_codec_id(snd_ac97_codec_ids, ac97->id);
2074        if (pid)
2075                ac97->flags |= pid->flags;
2076        
2077        /* test for AC'97 */
2078        if (!(ac97->scaps & AC97_SCAP_SKIP_AUDIO) && !(ac97->scaps & AC97_SCAP_AUDIO)) {
2079                /* test if we can write to the record gain volume register */
2080                snd_ac97_write_cache(ac97, AC97_REC_GAIN, 0x8a06);
2081                if (((err = snd_ac97_read(ac97, AC97_REC_GAIN)) & 0x7fff) == 0x0a06)
2082                        ac97->scaps |= AC97_SCAP_AUDIO;
2083        }
2084        if (ac97->scaps & AC97_SCAP_AUDIO) {
2085                ac97->caps = snd_ac97_read(ac97, AC97_RESET);
2086                ac97->ext_id = snd_ac97_read(ac97, AC97_EXTENDED_ID);
2087                if (ac97->ext_id == 0xffff)        /* invalid combination */
2088                        ac97->ext_id = 0;
2089        }
2090
2091        /* test for MC'97 */
2092        if (!(ac97->scaps & AC97_SCAP_SKIP_MODEM) && !(ac97->scaps & AC97_SCAP_MODEM)) {
2093                ac97->ext_mid = snd_ac97_read(ac97, AC97_EXTENDED_MID);
2094                if (ac97->ext_mid == 0xffff)        /* invalid combination */
2095                        ac97->ext_mid = 0;
2096                if (ac97->ext_mid & 1)
2097                        ac97->scaps |= AC97_SCAP_MODEM;
2098        }
2099
2100        if (!ac97_is_audio(ac97) && !ac97_is_modem(ac97)) {
2101                if (!(ac97->scaps & (AC97_SCAP_SKIP_AUDIO|AC97_SCAP_SKIP_MODEM)))
2102                        snd_printk(KERN_ERR "AC'97 %d access error (not audio or modem codec)\n", ac97->num);
2103                snd_ac97_free(ac97);
2104                return -EACCES;
2105        }
2106
2107        if (bus->ops->reset) // FIXME: always skipping?
2108                goto __ready_ok;
2109
2110        /* FIXME: add powerdown control */
2111        if (ac97_is_audio(ac97)) {
2112                /* nothing should be in powerdown mode */
2113                snd_ac97_write_cache(ac97, AC97_POWERDOWN, 0);
2114                if (! (ac97->flags & AC97_DEFAULT_POWER_OFF)) {
2115                        snd_ac97_write_cache(ac97, AC97_RESET, 0); /* reset to defaults */
2116                        udelay(100);
2117                        snd_ac97_write_cache(ac97, AC97_POWERDOWN, 0);
2118                }
2119                /* nothing should be in powerdown mode */
2120                snd_ac97_write_cache(ac97, AC97_GENERAL_PURPOSE, 0);
2121                end_time = jiffies + msecs_to_jiffies(100);
2122                do {
2123                        if ((snd_ac97_read(ac97, AC97_POWERDOWN) & 0x0f) == 0x0f)
2124                                goto __ready_ok;
2125                        schedule_timeout_uninterruptible(1);
2126                } while (time_after_eq(end_time, jiffies));
2127                snd_printk(KERN_WARNING "AC'97 %d analog subsections not ready\n", ac97->num);
2128        }
2129
2130        /* FIXME: add powerdown control */
2131        if (ac97_is_modem(ac97)) {
2132                unsigned char tmp;
2133
2134                /* nothing should be in powerdown mode */
2135                /* note: it's important to set the rate at first */
2136                tmp = AC97_MEA_GPIO;
2137                if (ac97->ext_mid & AC97_MEI_LINE1) {
2138                        snd_ac97_write_cache(ac97, AC97_LINE1_RATE, 8000);
2139                        tmp |= AC97_MEA_ADC1 | AC97_MEA_DAC1;
2140                }
2141                if (ac97->ext_mid & AC97_MEI_LINE2) {
2142                        snd_ac97_write_cache(ac97, AC97_LINE2_RATE, 8000);
2143                        tmp |= AC97_MEA_ADC2 | AC97_MEA_DAC2;
2144                }
2145                if (ac97->ext_mid & AC97_MEI_HANDSET) {
2146                        snd_ac97_write_cache(ac97, AC97_HANDSET_RATE, 8000);
2147                        tmp |= AC97_MEA_HADC | AC97_MEA_HDAC;
2148                }
2149                snd_ac97_write_cache(ac97, AC97_EXTENDED_MSTATUS, 0);
2150                udelay(100);
2151                /* nothing should be in powerdown mode */
2152                snd_ac97_write_cache(ac97, AC97_EXTENDED_MSTATUS, 0);
2153                end_time = jiffies + msecs_to_jiffies(100);
2154                do {
2155                        if ((snd_ac97_read(ac97, AC97_EXTENDED_MSTATUS) & tmp) == tmp)
2156                                goto __ready_ok;
2157                        schedule_timeout_uninterruptible(1);
2158                } while (time_after_eq(end_time, jiffies));
2159                snd_printk(KERN_WARNING "MC'97 %d converters and GPIO not ready (0x%x)\n", ac97->num, snd_ac97_read(ac97, AC97_EXTENDED_MSTATUS));
2160        }
2161        
2162      __ready_ok:
2163        if (ac97_is_audio(ac97))
2164                ac97->addr = (ac97->ext_id & AC97_EI_ADDR_MASK) >> AC97_EI_ADDR_SHIFT;
2165        else
2166                ac97->addr = (ac97->ext_mid & AC97_MEI_ADDR_MASK) >> AC97_MEI_ADDR_SHIFT;
2167        if (ac97->ext_id & 0x01c9) {        /* L/R, MIC, SDAC, LDAC VRA support */
2168                reg = snd_ac97_read(ac97, AC97_EXTENDED_STATUS);
2169                reg |= ac97->ext_id & 0x01c0; /* LDAC/SDAC/CDAC */
2170                if (! bus->no_vra)
2171                        reg |= ac97->ext_id & 0x0009; /* VRA/VRM */
2172                snd_ac97_write_cache(ac97, AC97_EXTENDED_STATUS, reg);
2173        }
2174        if ((ac97->ext_id & AC97_EI_DRA) && bus->dra) {
2175                /* Intel controllers require double rate data to be put in
2176                 * slots 7+8, so let's hope the codec supports it. */
2177                snd_ac97_update_bits(ac97, AC97_GENERAL_PURPOSE, AC97_GP_DRSS_MASK, AC97_GP_DRSS_78);
2178                if ((snd_ac97_read(ac97, AC97_GENERAL_PURPOSE) & AC97_GP_DRSS_MASK) == AC97_GP_DRSS_78)
2179                        ac97->flags |= AC97_DOUBLE_RATE;
2180                /* restore to slots 10/11 to avoid the confliction with surrounds */
2181                snd_ac97_update_bits(ac97, AC97_GENERAL_PURPOSE, AC97_GP_DRSS_MASK, 0);
2182        }
2183        if (ac97->ext_id & AC97_EI_VRA) {        /* VRA support */
2184                snd_ac97_determine_rates(ac97, AC97_PCM_FRONT_DAC_RATE, 0, &ac97->rates[AC97_RATES_FRONT_DAC]);
2185                snd_ac97_determine_rates(ac97, AC97_PCM_LR_ADC_RATE, 0, &ac97->rates[AC97_RATES_ADC]);
2186        } else {
2187                ac97->rates[AC97_RATES_FRONT_DAC] = SNDRV_PCM_RATE_48000;
2188                if (ac97->flags & AC97_DOUBLE_RATE)
2189                        ac97->rates[AC97_RATES_FRONT_DAC] |= SNDRV_PCM_RATE_96000;
2190                ac97->rates[AC97_RATES_ADC] = SNDRV_PCM_RATE_48000;
2191        }
2192        if (ac97->ext_id & AC97_EI_SPDIF) {
2193                /* codec specific code (patch) should override these values */
2194                ac97->rates[AC97_RATES_SPDIF] = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_32000;
2195        }
2196        if (ac97->ext_id & AC97_EI_VRM) {        /* MIC VRA support */
2197                snd_ac97_determine_rates(ac97, AC97_PCM_MIC_ADC_RATE, 0, &ac97->rates[AC97_RATES_MIC_ADC]);
2198        } else {
2199                ac97->rates[AC97_RATES_MIC_ADC] = SNDRV_PCM_RATE_48000;
2200        }
2201        if (ac97->ext_id & AC97_EI_SDAC) {        /* SDAC support */
2202                snd_ac97_determine_rates(ac97, AC97_PCM_SURR_DAC_RATE, AC97_PCM_FRONT_DAC_RATE, &ac97->rates[AC97_RATES_SURR_DAC]);
2203                ac97->scaps |= AC97_SCAP_SURROUND_DAC;
2204        }
2205        if (ac97->ext_id & AC97_EI_LDAC) {        /* LDAC support */
2206                snd_ac97_determine_rates(ac97, AC97_PCM_LFE_DAC_RATE, AC97_PCM_FRONT_DAC_RATE, &ac97->rates[AC97_RATES_LFE_DAC]);
2207                ac97->scaps |= AC97_SCAP_CENTER_LFE_DAC;
2208        }
2209        /* additional initializations */
2210        if (bus->ops->init)
2211                bus->ops->init(ac97);
2212        snd_ac97_get_name(ac97, ac97->id, name, !ac97_is_audio(ac97));
2213        snd_ac97_get_name(NULL, ac97->id, name, !ac97_is_audio(ac97));  // ac97->id might be changed in the special setup code
2214        if (! ac97->build_ops)
2215                ac97->build_ops = &null_build_ops;
2216
2217        if (ac97_is_audio(ac97)) {
2218                char comp[16];
2219                if (card->mixername[0] == '\0') {
2220                        strcpy(card->mixername, name);
2221                } else {
2222                        if (strlen(card->mixername) + 1 + strlen(name) + 1 <= sizeof(card->mixername)) {
2223                                strcat(card->mixername, ",");
2224                                strcat(card->mixername, name);
2225                        }
2226                }
2227                sprintf(comp, "AC97a:%08x", ac97->id);
2228                if ((err = snd_component_add(card, comp)) < 0) {
2229                        snd_ac97_free(ac97);
2230                        return err;
2231                }
2232                if (snd_ac97_mixer_build(ac97) < 0) {
2233                        snd_ac97_free(ac97);
2234                        return -ENOMEM;
2235                }
2236        }
2237        if (ac97_is_modem(ac97)) {
2238                char comp[16];
2239                if (card->mixername[0] == '\0') {
2240                        strcpy(card->mixername, name);
2241                } else {
2242                        if (strlen(card->mixername) + 1 + strlen(name) + 1 <= sizeof(card->mixername)) {
2243                                strcat(card->mixername, ",");
2244                                strcat(card->mixername, name);
2245                        }
2246                }
2247                sprintf(comp, "AC97m:%08x", ac97->id);
2248                if ((err = snd_component_add(card, comp)) < 0) {
2249                        snd_ac97_free(ac97);
2250                        return err;
2251                }
2252                if (snd_ac97_modem_build(card, ac97) < 0) {
2253                        snd_ac97_free(ac97);
2254                        return -ENOMEM;
2255                }
2256        }
2257        if (ac97_is_audio(ac97))
2258                update_power_regs(ac97);
2259        snd_ac97_proc_init(ac97);
2260        if ((err = snd_device_new(card, SNDRV_DEV_CODEC, ac97, &ops)) < 0) {
2261                snd_ac97_free(ac97);
2262                return err;
2263        }
2264        *rac97 = ac97;
2265        return 0;
2266}
2267
2268EXPORT_SYMBOL(snd_ac97_mixer);
2269
2270/*
2271 * Power down the chip.
2272 *
2273 * MASTER and HEADPHONE registers are muted but the register cache values
2274 * are not changed, so that the values can be restored in snd_ac97_resume().
2275 */
2276static void snd_ac97_powerdown(struct snd_ac97 *ac97)
2277{
2278        unsigned short power;
2279
2280        if (ac97_is_audio(ac97)) {
2281                /* some codecs have stereo mute bits */
2282                snd_ac97_write(ac97, AC97_MASTER, 0x9f9f);
2283                snd_ac97_write(ac97, AC97_HEADPHONE, 0x9f9f);
2284        }
2285
2286        /* surround, CLFE, mic powerdown */
2287        power = ac97->regs[AC97_EXTENDED_STATUS];
2288        if (ac97->scaps & AC97_SCAP_SURROUND_DAC)
2289                power |= AC97_EA_PRJ;
2290        if (ac97->scaps & AC97_SCAP_CENTER_LFE_DAC)
2291                power |= AC97_EA_PRI | AC97_EA_PRK;
2292        power |= AC97_EA_PRL;
2293        snd_ac97_write(ac97, AC97_EXTENDED_STATUS, power);
2294
2295        /* powerdown external amplifier */
2296        if (ac97->scaps & AC97_SCAP_INV_EAPD)
2297                power = ac97->regs[AC97_POWERDOWN] & ~AC97_PD_EAPD;
2298        else if (! (ac97->scaps & AC97_SCAP_EAPD_LED))
2299                power = ac97->regs[AC97_POWERDOWN] | AC97_PD_EAPD;
2300        power |= AC97_PD_PR6;        /* Headphone amplifier powerdown */
2301        power |= AC97_PD_PR0 | AC97_PD_PR1;        /* ADC & DAC powerdown */
2302        snd_ac97_write(ac97, AC97_POWERDOWN, power);
2303        udelay(100);
2304        power |= AC97_PD_PR2;        /* Analog Mixer powerdown (Vref on) */
2305        snd_ac97_write(ac97, AC97_POWERDOWN, power);
2306        if (ac97_is_power_save_mode(ac97)) {
2307                power |= AC97_PD_PR3;        /* Analog Mixer powerdown */
2308                snd_ac97_write(ac97, AC97_POWERDOWN, power);
2309                udelay(100);
2310                /* AC-link powerdown, internal Clk disable */
2311                /* FIXME: this may cause click noises on some boards */
2312                power |= AC97_PD_PR4 | AC97_PD_PR5;
2313                snd_ac97_write(ac97, AC97_POWERDOWN, power);
2314        }
2315}
2316
2317
2318struct ac97_power_reg {
2319        unsigned short reg;
2320        unsigned short power_reg;
2321        unsigned short mask;
2322};
2323
2324enum { PWIDX_ADC, PWIDX_FRONT, PWIDX_CLFE, PWIDX_SURR, PWIDX_MIC, PWIDX_SIZE };
2325
2326static struct ac97_power_reg power_regs[PWIDX_SIZE] = {
2327        [PWIDX_ADC] = { AC97_PCM_LR_ADC_RATE, AC97_POWERDOWN, AC97_PD_PR0},
2328        [PWIDX_FRONT] = { AC97_PCM_FRONT_DAC_RATE, AC97_POWERDOWN, AC97_PD_PR1},
2329        [PWIDX_CLFE] = { AC97_PCM_LFE_DAC_RATE, AC97_EXTENDED_STATUS,
2330                         AC97_EA_PRI | AC97_EA_PRK},
2331        [PWIDX_SURR] = { AC97_PCM_SURR_DAC_RATE, AC97_EXTENDED_STATUS,
2332                         AC97_EA_PRJ},
2333        [PWIDX_MIC] = { AC97_PCM_MIC_ADC_RATE, AC97_EXTENDED_STATUS,
2334                        AC97_EA_PRL},
2335};
2336
2337#ifdef CONFIG_SND_AC97_POWER_SAVE
2338/**
2339 * snd_ac97_update_power - update the powerdown register
2340 * @ac97: the codec instance
2341 * @reg: the rate register, e.g. AC97_PCM_FRONT_DAC_RATE
2342 * @powerup: non-zero when power up the part
2343 *
2344 * Update the AC97 powerdown register bits of the given part.
2345 */
2346int snd_ac97_update_power(struct snd_ac97 *ac97, int reg, int powerup)
2347{
2348        int i;
2349
2350        if (! ac97)
2351                return 0;
2352
2353        if (reg) {
2354                /* SPDIF requires DAC power, too */
2355                if (reg == AC97_SPDIF)
2356                        reg = AC97_PCM_FRONT_DAC_RATE;
2357                for (i = 0; i < PWIDX_SIZE; i++) {
2358                        if (power_regs[i].reg == reg) {
2359                                if (powerup)
2360                                        ac97->power_up |= (1 << i);
2361                                else
2362                                        ac97->power_up &= ~(1 << i);
2363                                break;
2364                        }
2365                }
2366        }
2367
2368        if (ac97_is_power_save_mode(ac97) && !powerup)
2369                /* adjust power-down bits after two seconds delay
2370                 * (for avoiding loud click noises for many (OSS) apps
2371                 *  that open/close frequently)
2372                 */
2373                schedule_delayed_work(&ac97->power_work,
2374                                      msecs_to_jiffies(power_save * 1000));
2375        else {
2376                cancel_delayed_work(&ac97->power_work);
2377                update_power_regs(ac97);
2378        }
2379
2380        return 0;
2381}
2382
2383EXPORT_SYMBOL(snd_ac97_update_power);
2384#endif /* CONFIG_SND_AC97_POWER_SAVE */
2385
2386static void update_power_regs(struct snd_ac97 *ac97)
2387{
2388        unsigned int power_up, bits;
2389        int i;
2390
2391        power_up = (1 << PWIDX_FRONT) | (1 << PWIDX_ADC);
2392        power_up |= (1 << PWIDX_MIC);
2393        if (ac97->scaps & AC97_SCAP_SURROUND_DAC)
2394                power_up |= (1 << PWIDX_SURR);
2395        if (ac97->scaps & AC97_SCAP_CENTER_LFE_DAC)
2396                power_up |= (1 << PWIDX_CLFE);
2397#ifdef CONFIG_SND_AC97_POWER_SAVE
2398        if (ac97_is_power_save_mode(ac97))
2399                power_up = ac97->power_up;
2400#endif
2401        if (power_up) {
2402                if (ac97->regs[AC97_POWERDOWN] & AC97_PD_PR2) {
2403                        /* needs power-up analog mix and vref */
2404                        snd_ac97_update_bits(ac97, AC97_POWERDOWN,
2405                                             AC97_PD_PR3, 0);
2406                        msleep(1);
2407                        snd_ac97_update_bits(ac97, AC97_POWERDOWN,
2408                                             AC97_PD_PR2, 0);
2409                }
2410        }
2411        for (i = 0; i < PWIDX_SIZE; i++) {
2412                if (power_up & (1 << i))
2413                        bits = 0;
2414                else
2415                        bits = power_regs[i].mask;
2416                snd_ac97_update_bits(ac97, power_regs[i].power_reg,
2417                                     power_regs[i].mask, bits);
2418        }
2419        if (! power_up) {
2420                if (! (ac97->regs[AC97_POWERDOWN] & AC97_PD_PR2)) {
2421                        /* power down analog mix and vref */
2422                        snd_ac97_update_bits(ac97, AC97_POWERDOWN,
2423                                             AC97_PD_PR2, AC97_PD_PR2);
2424                        snd_ac97_update_bits(ac97, AC97_POWERDOWN,
2425                                             AC97_PD_PR3, AC97_PD_PR3);
2426                }
2427        }
2428}
2429
2430
2431#ifdef CONFIG_PM
2432/**
2433 * snd_ac97_suspend - General suspend function for AC97 codec
2434 * @ac97: the ac97 instance
2435 *
2436 * Suspends the codec, power down the chip.
2437 */
2438void snd_ac97_suspend(struct snd_ac97 *ac97)
2439{
2440        if (! ac97)
2441                return;
2442        if (ac97->build_ops->suspend)
2443                ac97->build_ops->suspend(ac97);
2444#ifdef CONFIG_SND_AC97_POWER_SAVE
2445        cancel_delayed_work(&ac97->power_work);
2446        flush_scheduled_work();
2447#endif
2448        snd_ac97_powerdown(ac97);
2449}
2450
2451EXPORT_SYMBOL(snd_ac97_suspend);
2452
2453/*
2454 * restore ac97 status
2455 */
2456static void snd_ac97_restore_status(struct snd_ac97 *ac97)
2457{
2458        int i;
2459
2460        for (i = 2; i < 0x7c ; i += 2) {
2461                if (i == AC97_POWERDOWN || i == AC97_EXTENDED_ID)
2462                        continue;
2463                /* restore only accessible registers
2464                 * some chip (e.g. nm256) may hang up when unsupported registers
2465                 * are accessed..!
2466                 */
2467                if (test_bit(i, ac97->reg_accessed)) {
2468                        snd_ac97_write(ac97, i, ac97->regs[i]);
2469                        snd_ac97_read(ac97, i);
2470                }
2471        }
2472}
2473
2474/*
2475 * restore IEC958 status
2476 */
2477static void snd_ac97_restore_iec958(struct snd_ac97 *ac97)
2478{
2479        if (ac97->ext_id & AC97_EI_SPDIF) {
2480                if (ac97->regs[AC97_EXTENDED_STATUS] & AC97_EA_SPDIF) {
2481                        /* reset spdif status */
2482                        snd_ac97_update_bits(ac97, AC97_EXTENDED_STATUS, AC97_EA_SPDIF, 0);
2483                        snd_ac97_write(ac97, AC97_EXTENDED_STATUS, ac97->regs[AC97_EXTENDED_STATUS]);
2484                        if (ac97->flags & AC97_CS_SPDIF)
2485                                snd_ac97_write(ac97, AC97_CSR_SPDIF, ac97->regs[AC97_CSR_SPDIF]);
2486                        else
2487                                snd_ac97_write(ac97, AC97_SPDIF, ac97->regs[AC97_SPDIF]);
2488                        snd_ac97_update_bits(ac97, AC97_EXTENDED_STATUS, AC97_EA_SPDIF, AC97_EA_SPDIF); /* turn on again */
2489                }
2490        }
2491}
2492
2493/**
2494 * snd_ac97_resume - General resume function for AC97 codec
2495 * @ac97: the ac97 instance
2496 *
2497 * Do the standard resume procedure, power up and restoring the
2498 * old register values.
2499 */
2500void snd_ac97_resume(struct snd_ac97 *ac97)
2501{
2502        unsigned long end_time;
2503
2504        if (! ac97)
2505                return;
2506
2507        if (ac97->bus->ops->reset) {
2508                ac97->bus->ops->reset(ac97);
2509                goto  __reset_ready;
2510        }
2511
2512        snd_ac97_write(ac97, AC97_POWERDOWN, 0);
2513        if (! (ac97->flags & AC97_DEFAULT_POWER_OFF)) {
2514                if (!(ac97->scaps & AC97_SCAP_SKIP_AUDIO))
2515                        snd_ac97_write(ac97, AC97_RESET, 0);
2516                else if (!(ac97->scaps & AC97_SCAP_SKIP_MODEM))
2517                        snd_ac97_write(ac97, AC97_EXTENDED_MID, 0);
2518                udelay(100);
2519                snd_ac97_write(ac97, AC97_POWERDOWN, 0);
2520        }
2521        snd_ac97_write(ac97, AC97_GENERAL_PURPOSE, 0);
2522
2523        snd_ac97_write(ac97, AC97_POWERDOWN, ac97->regs[AC97_POWERDOWN]);
2524        if (ac97_is_audio(ac97)) {
2525                ac97->bus->ops->write(ac97, AC97_MASTER, 0x8101);
2526                end_time = jiffies + msecs_to_jiffies(100);
2527                do {
2528                        if (snd_ac97_read(ac97, AC97_MASTER) == 0x8101)
2529                                break;
2530                        schedule_timeout_uninterruptible(1);
2531                } while (time_after_eq(end_time, jiffies));
2532                /* FIXME: extra delay */
2533                ac97->bus->ops->write(ac97, AC97_MASTER, 0x8000);
2534                if (snd_ac97_read(ac97, AC97_MASTER) != 0x8000)
2535                        msleep(250);
2536        } else {
2537                end_time = jiffies + msecs_to_jiffies(100);
2538                do {
2539                        unsigned short val = snd_ac97_read(ac97, AC97_EXTENDED_MID);
2540                        if (val != 0xffff && (val & 1) != 0)
2541                                break;
2542                        schedule_timeout_uninterruptible(1);
2543                } while (time_after_eq(end_time, jiffies));
2544        }
2545__reset_ready:
2546
2547        if (ac97->bus->ops->init)
2548                ac97->bus->ops->init(ac97);
2549
2550        if (ac97->build_ops->resume)
2551                ac97->build_ops->resume(ac97);
2552        else {
2553                snd_ac97_restore_status(ac97);
2554                snd_ac97_restore_iec958(ac97);
2555        }
2556}
2557
2558EXPORT_SYMBOL(snd_ac97_resume);
2559#endif
2560
2561
2562/*
2563 * Hardware tuning
2564 */
2565static void set_ctl_name(char *dst, const char *src, const char *suffix)
2566{
2567        if (suffix)
2568                sprintf(dst, "%s %s", src, suffix);
2569        else
2570                strcpy(dst, src);
2571}        
2572
2573/* remove the control with the given name and optional suffix */
2574static int snd_ac97_remove_ctl(struct snd_ac97 *ac97, const char *name,
2575                               const char *suffix)
2576{
2577        struct snd_ctl_elem_id id;
2578        memset(&id, 0, sizeof(id));
2579        set_ctl_name(id.name, name, suffix);
2580        id.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
2581        return snd_ctl_remove_id(ac97->bus->card, &id);
2582}
2583
2584static struct snd_kcontrol *ctl_find(struct snd_ac97 *ac97, const char *name, const char *suffix)
2585{
2586        struct snd_ctl_elem_id sid;
2587        memset(&sid, 0, sizeof(sid));
2588        set_ctl_name(sid.name, name, suffix);
2589        sid.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
2590        return snd_ctl_find_id(ac97->bus->card, &sid);
2591}
2592
2593/* rename the control with the given name and optional suffix */
2594static int snd_ac97_rename_ctl(struct snd_ac97 *ac97, const char *src,
2595                               const char *dst, const char *suffix)
2596{
2597        struct snd_kcontrol *kctl = ctl_find(ac97, src, suffix);
2598        if (kctl) {
2599                set_ctl_name(kctl->id.name, dst, suffix);
2600                return 0;
2601        }
2602        return -ENOENT;
2603}
2604
2605/* rename both Volume and Switch controls - don't check the return value */
2606static void snd_ac97_rename_vol_ctl(struct snd_ac97 *ac97, const char *src,
2607                                    const char *dst)
2608{
2609        snd_ac97_rename_ctl(ac97, src, dst, "Switch");
2610        snd_ac97_rename_ctl(ac97, src, dst, "Volume");
2611}
2612
2613/* swap controls */
2614static int snd_ac97_swap_ctl(struct snd_ac97 *ac97, const char *s1,
2615                             const char *s2, const char *suffix)
2616{
2617        struct snd_kcontrol *kctl1, *kctl2;
2618        kctl1 = ctl_find(ac97, s1, suffix);
2619        kctl2 = ctl_find(ac97, s2, suffix);
2620        if (kctl1 && kctl2) {
2621                set_ctl_name(kctl1->id.name, s2, suffix);
2622                set_ctl_name(kctl2->id.name, s1, suffix);
2623                return 0;
2624        }
2625        return -ENOENT;
2626}
2627
2628#if 1
2629/* bind hp and master controls instead of using only hp control */
2630static int bind_hp_volsw_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
2631{
2632        int err = snd_ac97_put_volsw(kcontrol, ucontrol);
2633        if (err > 0) {
2634                unsigned long priv_saved = kcontrol->private_value;
2635                kcontrol->private_value = (kcontrol->private_value & ~0xff) | AC97_HEADPHONE;
2636                snd_ac97_put_volsw(kcontrol, ucontrol);
2637                kcontrol->private_value = priv_saved;
2638        }
2639        return err;
2640}
2641
2642/* ac97 tune: bind Master and Headphone controls */
2643static int tune_hp_only(struct snd_ac97 *ac97)
2644{
2645        struct snd_kcontrol *msw = ctl_find(ac97, "Master Playback Switch", NULL);
2646        struct snd_kcontrol *mvol = ctl_find(ac97, "Master Playback Volume", NULL);
2647        if (! msw || ! mvol)
2648                return -ENOENT;
2649        msw->put = bind_hp_volsw_put;
2650        mvol->put = bind_hp_volsw_put;
2651        snd_ac97_remove_ctl(ac97, "Headphone Playback", "Switch");
2652        snd_ac97_remove_ctl(ac97, "Headphone Playback", "Volume");
2653        return 0;
2654}
2655
2656#else
2657/* ac97 tune: use Headphone control as master */
2658static int tune_hp_only(struct snd_ac97 *ac97)
2659{
2660        if (ctl_find(ac97, "Headphone Playback Switch", NULL) == NULL)
2661                return -ENOENT;
2662        snd_ac97_remove_ctl(ac97, "Master Playback", "Switch");
2663        snd_ac97_remove_ctl(ac97, "Master Playback", "Volume");
2664        snd_ac97_rename_vol_ctl(ac97, "Headphone Playback", "Master Playback");
2665        return 0;
2666}
2667#endif
2668
2669/* ac97 tune: swap Headphone and Master controls */
2670static int tune_swap_hp(struct snd_ac97 *ac97)
2671{
2672        if (ctl_find(ac97, "Headphone Playback Switch", NULL) == NULL)
2673                return -ENOENT;
2674        snd_ac97_rename_vol_ctl(ac97, "Master Playback", "Line-Out Playback");
2675        snd_ac97_rename_vol_ctl(ac97, "Headphone Playback", "Master Playback");
2676        return 0;
2677}
2678
2679/* ac97 tune: swap Surround and Master controls */
2680static int tune_swap_surround(struct snd_ac97 *ac97)
2681{
2682        if (snd_ac97_swap_ctl(ac97, "Master Playback", "Surround Playback", "Switch") ||
2683            snd_ac97_swap_ctl(ac97, "Master Playback", "Surround Playback", "Volume"))
2684                return -ENOENT;
2685        return 0;
2686}
2687
2688/* ac97 tune: set up mic sharing for AD codecs */
2689static int tune_ad_sharing(struct snd_ac97 *ac97)
2690{
2691        unsigned short scfg;
2692        if ((ac97->id & 0xffffff00) != 0x41445300) {
2693                snd_printk(KERN_ERR "ac97_quirk AD_SHARING is only for AD codecs\n");
2694                return -EINVAL;
2695        }
2696        /* Turn on OMS bit to route microphone to back panel */
2697        scfg = snd_ac97_read(ac97, AC97_AD_SERIAL_CFG);
2698        snd_ac97_write_cache(ac97, AC97_AD_SERIAL_CFG, scfg | 0x0200);
2699        return 0;
2700}
2701
2702static const struct snd_kcontrol_new snd_ac97_alc_jack_detect = 
2703AC97_SINGLE("Jack Detect", AC97_ALC650_CLOCK, 5, 1, 0);
2704
2705/* ac97 tune: set up ALC jack-select */
2706static int tune_alc_jack(struct snd_ac97 *ac97)
2707{
2708        if ((ac97->id & 0xffffff00) != 0x414c4700) {
2709                snd_printk(KERN_ERR "ac97_quirk ALC_JACK is only for Realtek codecs\n");
2710                return -EINVAL;
2711        }
2712        snd_ac97_update_bits(ac97, 0x7a, 0x20, 0x20); /* select jack detect function */
2713        snd_ac97_update_bits(ac97, 0x7a, 0x01, 0x01); /* Line-out auto mute */
2714        if (ac97->id == AC97_ID_ALC658D)
2715                snd_ac97_update_bits(ac97, 0x74, 0x0800, 0x0800);
2716        return snd_ctl_add(ac97->bus->card, snd_ac97_cnew(&snd_ac97_alc_jack_detect, ac97));
2717}
2718
2719/* ac97 tune: inversed EAPD bit */
2720static int tune_inv_eapd(struct snd_ac97 *ac97)
2721{
2722        struct snd_kcontrol *kctl = ctl_find(ac97, "External Amplifier", NULL);
2723        if (! kctl)
2724                return -ENOENT;
2725        set_inv_eapd(ac97, kctl);
2726        return 0;
2727}
2728
2729static int master_mute_sw_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
2730{
2731        int err = snd_ac97_put_volsw(kcontrol, ucontrol);
2732        if (err > 0) {
2733                struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
2734                int shift = (kcontrol->private_value >> 8) & 0x0f;
2735                int rshift = (kcontrol->private_value >> 12) & 0x0f;
2736                unsigned short mask;
2737                if (shift != rshift)
2738                        mask = 0x8080;
2739                else
2740                        mask = 0x8000;
2741                snd_ac97_update_bits(ac97, AC97_POWERDOWN, 0x8000,
2742                                     (ac97->regs[AC97_MASTER] & mask) == mask ?
2743                                     0x8000 : 0);
2744        }
2745        return err;
2746}
2747
2748/* ac97 tune: EAPD controls mute LED bound with the master mute */
2749static int tune_mute_led(struct snd_ac97 *ac97)
2750{
2751        struct snd_kcontrol *msw = ctl_find(ac97, "Master Playback Switch", NULL);
2752        if (! msw)
2753                return -ENOENT;
2754        msw->put = master_mute_sw_put;
2755        snd_ac97_remove_ctl(ac97, "External Amplifier", NULL);
2756        snd_ac97_update_bits(ac97, AC97_POWERDOWN, 0x8000, 0x8000); /* mute LED on */
2757        ac97->scaps |= AC97_SCAP_EAPD_LED;
2758        return 0;
2759}
2760
2761static int hp_master_mute_sw_put(struct snd_kcontrol *kcontrol,
2762                                 struct snd_ctl_elem_value *ucontrol)
2763{
2764        int err = bind_hp_volsw_put(kcontrol, ucontrol);
2765        if (err > 0) {
2766                struct snd_ac97 *ac97 = snd_kcontrol_chip(kcontrol);
2767                int shift = (kcontrol->private_value >> 8) & 0x0f;
2768                int rshift = (kcontrol->private_value >> 12) & 0x0f;
2769                unsigned short mask;
2770                if (shift != rshift)
2771                        mask = 0x8080;
2772                else
2773                        mask = 0x8000;
2774                snd_ac97_update_bits(ac97, AC97_POWERDOWN, 0x8000,
2775                                     (ac97->regs[AC97_MASTER] & mask) == mask ?
2776                                     0x8000 : 0);
2777        }
2778        return err;
2779}
2780
2781static int tune_hp_mute_led(struct snd_ac97 *ac97)
2782{
2783        struct snd_kcontrol *msw = ctl_find(ac97, "Master Playback Switch", NULL);
2784        struct snd_kcontrol *mvol = ctl_find(ac97, "Master Playback Volume", NULL);
2785        if (! msw || ! mvol)
2786                return -ENOENT;
2787        msw->put = hp_master_mute_sw_put;
2788        mvol->put = bind_hp_volsw_put;
2789        snd_ac97_remove_ctl(ac97, "External Amplifier", NULL);
2790        snd_ac97_remove_ctl(ac97, "Headphone Playback", "Switch");
2791        snd_ac97_remove_ctl(ac97, "Headphone Playback", "Volume");
2792        snd_ac97_update_bits(ac97, AC97_POWERDOWN, 0x8000, 0x8000); /* mute LED on */
2793        return 0;
2794}
2795
2796struct quirk_table {
2797        const char *name;
2798        int (*func)(struct snd_ac97 *);
2799};
2800
2801static struct quirk_table applicable_quirks[] = {
2802        { "none", NULL },
2803        { "hp_only", tune_hp_only },
2804        { "swap_hp", tune_swap_hp },
2805        { "swap_surround", tune_swap_surround },
2806        { "ad_sharing", tune_ad_sharing },
2807        { "alc_jack", tune_alc_jack },
2808        { "inv_eapd", tune_inv_eapd },
2809        { "mute_led", tune_mute_led },
2810        { "hp_mute_led", tune_hp_mute_led },
2811};
2812
2813/* apply the quirk with the given type */
2814static int apply_quirk(struct snd_ac97 *ac97, int type)
2815{
2816        if (type <= 0)
2817                return 0;
2818        else if (type >= ARRAY_SIZE(applicable_quirks))
2819                return -EINVAL;
2820        if (applicable_quirks[type].func)
2821                return applicable_quirks[type].func(ac97);
2822        return 0;
2823}
2824
2825/* apply the quirk with the given name */
2826static int apply_quirk_str(struct snd_ac97 *ac97, const char *typestr)
2827{
2828        int i;
2829        struct quirk_table *q;
2830
2831        for (i = 0; i < ARRAY_SIZE(applicable_quirks); i++) {
2832                q = &applicable_quirks[i];
2833                if (q->name && ! strcmp(typestr, q->name))
2834                        return apply_quirk(ac97, i);
2835        }
2836        /* for compatibility, accept the numbers, too */
2837        if (*typestr >= '0' && *typestr <= '9')
2838                return apply_quirk(ac97, (int)simple_strtoul(typestr, NULL, 10));
2839        return -EINVAL;
2840}
2841
2842/**
2843 * snd_ac97_tune_hardware - tune up the hardware
2844 * @ac97: the ac97 instance
2845 * @quirk: quirk list
2846 * @override: explicit quirk value (overrides the list if non-NULL)
2847 *
2848 * Do some workaround for each pci device, such as renaming of the
2849 * headphone (true line-out) control as "Master".
2850 * The quirk-list must be terminated with a zero-filled entry.
2851 *
2852 * Returns zero if successful, or a negative error code on failure.
2853 */
2854
2855int snd_ac97_tune_hardware(struct snd_ac97 *ac97, struct ac97_quirk *quirk, const char *override)
2856{
2857        int result;
2858
2859        /* quirk overriden? */
2860        if (override && strcmp(override, "-1") && strcmp(override, "default")) {
2861                result = apply_quirk_str(ac97, override);
2862                if (result < 0)
2863                        snd_printk(KERN_ERR "applying quirk type %s failed (%d)\n", override, result);
2864                return result;
2865        }
2866
2867        if (! quirk)
2868                return -EINVAL;
2869
2870        for (; quirk->subvendor; quirk++) {
2871                if (quirk->subvendor != ac97->subsystem_vendor)
2872                        continue;
2873                if ((! quirk->mask && quirk->subdevice == ac97->subsystem_device) ||
2874                    quirk->subdevice == (quirk->mask & ac97->subsystem_device)) {
2875                        if (quirk->codec_id && quirk->codec_id != ac97->id)
2876                                continue;
2877                        snd_printdd("ac97 quirk for %s (%04x:%04x)\n", quirk->name, ac97->subsystem_vendor, ac97->subsystem_device);
2878                        result = apply_quirk(ac97, quirk->type);
2879                        if (result < 0)
2880                                snd_printk(KERN_ERR "applying quirk type %d for %s failed (%d)\n", quirk->type, quirk->name, result);
2881                        return result;
2882                }
2883        }
2884        return 0;
2885}
2886
2887EXPORT_SYMBOL(snd_ac97_tune_hardware);
2888
2889/*
2890 *  INIT part
2891 */
2892
2893static int __init alsa_ac97_init(void)
2894{
2895        return 0;
2896}
2897
2898static void __exit alsa_ac97_exit(void)
2899{
2900}
2901
2902module_init(alsa_ac97_init)
2903module_exit(alsa_ac97_exit)