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