aa5540786111657f88609cedd0b9b388f25d3cb3
[pandora-kernel.git] / sound / pci / hda / hda_codec.c
1 /*
2  * Universal Interface for Intel High Definition Audio Codec
3  *
4  * Copyright (c) 2004 Takashi Iwai <tiwai@suse.de>
5  *
6  *
7  *  This driver is free software; you can redistribute it and/or modify
8  *  it under the terms of the GNU General Public License as published by
9  *  the Free Software Foundation; either version 2 of the License, or
10  *  (at your option) any later version.
11  *
12  *  This driver is distributed in the hope that it will be useful,
13  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
14  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  *  GNU General Public License for more details.
16  *
17  *  You should have received a copy of the GNU General Public License
18  *  along with this program; if not, write to the Free Software
19  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
20  */
21
22 #include <linux/init.h>
23 #include <linux/delay.h>
24 #include <linux/slab.h>
25 #include <linux/pci.h>
26 #include <linux/mutex.h>
27 #include <sound/core.h>
28 #include "hda_codec.h"
29 #include <sound/asoundef.h>
30 #include <sound/tlv.h>
31 #include <sound/initval.h>
32 #include "hda_local.h"
33 #include <sound/hda_hwdep.h>
34
35 /*
36  * vendor / preset table
37  */
38
39 struct hda_vendor_id {
40         unsigned int id;
41         const char *name;
42 };
43
44 /* codec vendor labels */
45 static struct hda_vendor_id hda_vendor_ids[] = {
46         { 0x1002, "ATI" },
47         { 0x1057, "Motorola" },
48         { 0x1095, "Silicon Image" },
49         { 0x10de, "Nvidia" },
50         { 0x10ec, "Realtek" },
51         { 0x1102, "Creative" },
52         { 0x1106, "VIA" },
53         { 0x111d, "IDT" },
54         { 0x11c1, "LSI" },
55         { 0x11d4, "Analog Devices" },
56         { 0x13f6, "C-Media" },
57         { 0x14f1, "Conexant" },
58         { 0x17e8, "Chrontel" },
59         { 0x1854, "LG" },
60         { 0x1aec, "Wolfson Microelectronics" },
61         { 0x434d, "C-Media" },
62         { 0x8086, "Intel" },
63         { 0x8384, "SigmaTel" },
64         {} /* terminator */
65 };
66
67 static DEFINE_MUTEX(preset_mutex);
68 static LIST_HEAD(hda_preset_tables);
69
70 int snd_hda_add_codec_preset(struct hda_codec_preset_list *preset)
71 {
72         mutex_lock(&preset_mutex);
73         list_add_tail(&preset->list, &hda_preset_tables);
74         mutex_unlock(&preset_mutex);
75         return 0;
76 }
77 EXPORT_SYMBOL_HDA(snd_hda_add_codec_preset);
78
79 int snd_hda_delete_codec_preset(struct hda_codec_preset_list *preset)
80 {
81         mutex_lock(&preset_mutex);
82         list_del(&preset->list);
83         mutex_unlock(&preset_mutex);
84         return 0;
85 }
86 EXPORT_SYMBOL_HDA(snd_hda_delete_codec_preset);
87
88 #ifdef CONFIG_SND_HDA_POWER_SAVE
89 static void hda_power_work(struct work_struct *work);
90 static void hda_keep_power_on(struct hda_codec *codec);
91 #else
92 static inline void hda_keep_power_on(struct hda_codec *codec) {}
93 #endif
94
95 const char *snd_hda_get_jack_location(u32 cfg)
96 {
97         static char *bases[7] = {
98                 "N/A", "Rear", "Front", "Left", "Right", "Top", "Bottom",
99         };
100         static unsigned char specials_idx[] = {
101                 0x07, 0x08,
102                 0x17, 0x18, 0x19,
103                 0x37, 0x38
104         };
105         static char *specials[] = {
106                 "Rear Panel", "Drive Bar",
107                 "Riser", "HDMI", "ATAPI",
108                 "Mobile-In", "Mobile-Out"
109         };
110         int i;
111         cfg = (cfg & AC_DEFCFG_LOCATION) >> AC_DEFCFG_LOCATION_SHIFT;
112         if ((cfg & 0x0f) < 7)
113                 return bases[cfg & 0x0f];
114         for (i = 0; i < ARRAY_SIZE(specials_idx); i++) {
115                 if (cfg == specials_idx[i])
116                         return specials[i];
117         }
118         return "UNKNOWN";
119 }
120 EXPORT_SYMBOL_HDA(snd_hda_get_jack_location);
121
122 const char *snd_hda_get_jack_connectivity(u32 cfg)
123 {
124         static char *jack_locations[4] = { "Ext", "Int", "Sep", "Oth" };
125
126         return jack_locations[(cfg >> (AC_DEFCFG_LOCATION_SHIFT + 4)) & 3];
127 }
128 EXPORT_SYMBOL_HDA(snd_hda_get_jack_connectivity);
129
130 const char *snd_hda_get_jack_type(u32 cfg)
131 {
132         static char *jack_types[16] = {
133                 "Line Out", "Speaker", "HP Out", "CD",
134                 "SPDIF Out", "Digital Out", "Modem Line", "Modem Hand",
135                 "Line In", "Aux", "Mic", "Telephony",
136                 "SPDIF In", "Digitial In", "Reserved", "Other"
137         };
138
139         return jack_types[(cfg & AC_DEFCFG_DEVICE)
140                                 >> AC_DEFCFG_DEVICE_SHIFT];
141 }
142 EXPORT_SYMBOL_HDA(snd_hda_get_jack_type);
143
144 /*
145  * Compose a 32bit command word to be sent to the HD-audio controller
146  */
147 static inline unsigned int
148 make_codec_cmd(struct hda_codec *codec, hda_nid_t nid, int direct,
149                unsigned int verb, unsigned int parm)
150 {
151         u32 val;
152
153         if ((codec->addr & ~0xf) || (direct & ~1) || (nid & ~0x7f) ||
154             (verb & ~0xfff) || (parm & ~0xffff)) {
155                 printk(KERN_ERR "hda-codec: out of range cmd %x:%x:%x:%x:%x\n",
156                        codec->addr, direct, nid, verb, parm);
157                 return ~0;
158         }
159
160         val = (u32)codec->addr << 28;
161         val |= (u32)direct << 27;
162         val |= (u32)nid << 20;
163         val |= verb << 8;
164         val |= parm;
165         return val;
166 }
167
168 /*
169  * Send and receive a verb
170  */
171 static int codec_exec_verb(struct hda_codec *codec, unsigned int cmd,
172                            unsigned int *res)
173 {
174         struct hda_bus *bus = codec->bus;
175         int err;
176
177         if (cmd == ~0)
178                 return -1;
179
180         if (res)
181                 *res = -1;
182  again:
183         snd_hda_power_up(codec);
184         mutex_lock(&bus->cmd_mutex);
185         err = bus->ops.command(bus, cmd);
186         if (!err && res)
187                 *res = bus->ops.get_response(bus);
188         mutex_unlock(&bus->cmd_mutex);
189         snd_hda_power_down(codec);
190         if (res && *res == -1 && bus->rirb_error) {
191                 if (bus->response_reset) {
192                         snd_printd("hda_codec: resetting BUS due to "
193                                    "fatal communication error\n");
194                         bus->ops.bus_reset(bus);
195                 }
196                 goto again;
197         }
198         /* clear reset-flag when the communication gets recovered */
199         if (!err)
200                 bus->response_reset = 0;
201         return err;
202 }
203
204 /**
205  * snd_hda_codec_read - send a command and get the response
206  * @codec: the HDA codec
207  * @nid: NID to send the command
208  * @direct: direct flag
209  * @verb: the verb to send
210  * @parm: the parameter for the verb
211  *
212  * Send a single command and read the corresponding response.
213  *
214  * Returns the obtained response value, or -1 for an error.
215  */
216 unsigned int snd_hda_codec_read(struct hda_codec *codec, hda_nid_t nid,
217                                 int direct,
218                                 unsigned int verb, unsigned int parm)
219 {
220         unsigned cmd = make_codec_cmd(codec, nid, direct, verb, parm);
221         unsigned int res;
222         codec_exec_verb(codec, cmd, &res);
223         return res;
224 }
225 EXPORT_SYMBOL_HDA(snd_hda_codec_read);
226
227 /**
228  * snd_hda_codec_write - send a single command without waiting for response
229  * @codec: the HDA codec
230  * @nid: NID to send the command
231  * @direct: direct flag
232  * @verb: the verb to send
233  * @parm: the parameter for the verb
234  *
235  * Send a single command without waiting for response.
236  *
237  * Returns 0 if successful, or a negative error code.
238  */
239 int snd_hda_codec_write(struct hda_codec *codec, hda_nid_t nid, int direct,
240                          unsigned int verb, unsigned int parm)
241 {
242         unsigned int cmd = make_codec_cmd(codec, nid, direct, verb, parm);
243         unsigned int res;
244         return codec_exec_verb(codec, cmd,
245                                codec->bus->sync_write ? &res : NULL);
246 }
247 EXPORT_SYMBOL_HDA(snd_hda_codec_write);
248
249 /**
250  * snd_hda_sequence_write - sequence writes
251  * @codec: the HDA codec
252  * @seq: VERB array to send
253  *
254  * Send the commands sequentially from the given array.
255  * The array must be terminated with NID=0.
256  */
257 void snd_hda_sequence_write(struct hda_codec *codec, const struct hda_verb *seq)
258 {
259         for (; seq->nid; seq++)
260                 snd_hda_codec_write(codec, seq->nid, 0, seq->verb, seq->param);
261 }
262 EXPORT_SYMBOL_HDA(snd_hda_sequence_write);
263
264 /**
265  * snd_hda_get_sub_nodes - get the range of sub nodes
266  * @codec: the HDA codec
267  * @nid: NID to parse
268  * @start_id: the pointer to store the start NID
269  *
270  * Parse the NID and store the start NID of its sub-nodes.
271  * Returns the number of sub-nodes.
272  */
273 int snd_hda_get_sub_nodes(struct hda_codec *codec, hda_nid_t nid,
274                           hda_nid_t *start_id)
275 {
276         unsigned int parm;
277
278         parm = snd_hda_param_read(codec, nid, AC_PAR_NODE_COUNT);
279         if (parm == -1)
280                 return 0;
281         *start_id = (parm >> 16) & 0x7fff;
282         return (int)(parm & 0x7fff);
283 }
284 EXPORT_SYMBOL_HDA(snd_hda_get_sub_nodes);
285
286 /**
287  * snd_hda_get_connections - get connection list
288  * @codec: the HDA codec
289  * @nid: NID to parse
290  * @conn_list: connection list array
291  * @max_conns: max. number of connections to store
292  *
293  * Parses the connection list of the given widget and stores the list
294  * of NIDs.
295  *
296  * Returns the number of connections, or a negative error code.
297  */
298 int snd_hda_get_connections(struct hda_codec *codec, hda_nid_t nid,
299                             hda_nid_t *conn_list, int max_conns)
300 {
301         unsigned int parm;
302         int i, conn_len, conns;
303         unsigned int shift, num_elems, mask;
304         hda_nid_t prev_nid;
305
306         if (snd_BUG_ON(!conn_list || max_conns <= 0))
307                 return -EINVAL;
308
309         if ((get_wcaps(codec, nid) & AC_WCAP_CONN_LIST) == 0) {
310                 snd_printk(KERN_WARNING "hda_codec: "
311                            "connection list not available for 0x%x\n", nid);
312                 return -EINVAL;
313         }
314
315         parm = snd_hda_param_read(codec, nid, AC_PAR_CONNLIST_LEN);
316         if (parm & AC_CLIST_LONG) {
317                 /* long form */
318                 shift = 16;
319                 num_elems = 2;
320         } else {
321                 /* short form */
322                 shift = 8;
323                 num_elems = 4;
324         }
325         conn_len = parm & AC_CLIST_LENGTH;
326         mask = (1 << (shift-1)) - 1;
327
328         if (!conn_len)
329                 return 0; /* no connection */
330
331         if (conn_len == 1) {
332                 /* single connection */
333                 parm = snd_hda_codec_read(codec, nid, 0,
334                                           AC_VERB_GET_CONNECT_LIST, 0);
335                 if (parm == -1 && codec->bus->rirb_error)
336                         return -EIO;
337                 conn_list[0] = parm & mask;
338                 return 1;
339         }
340
341         /* multi connection */
342         conns = 0;
343         prev_nid = 0;
344         for (i = 0; i < conn_len; i++) {
345                 int range_val;
346                 hda_nid_t val, n;
347
348                 if (i % num_elems == 0) {
349                         parm = snd_hda_codec_read(codec, nid, 0,
350                                                   AC_VERB_GET_CONNECT_LIST, i);
351                         if (parm == -1 && codec->bus->rirb_error)
352                                 return -EIO;
353                 }
354                 range_val = !!(parm & (1 << (shift-1))); /* ranges */
355                 val = parm & mask;
356                 if (val == 0) {
357                         snd_printk(KERN_WARNING "hda_codec: "
358                                    "invalid CONNECT_LIST verb %x[%i]:%x\n",
359                                     nid, i, parm);
360                         return 0;
361                 }
362                 parm >>= shift;
363                 if (range_val) {
364                         /* ranges between the previous and this one */
365                         if (!prev_nid || prev_nid >= val) {
366                                 snd_printk(KERN_WARNING "hda_codec: "
367                                            "invalid dep_range_val %x:%x\n",
368                                            prev_nid, val);
369                                 continue;
370                         }
371                         for (n = prev_nid + 1; n <= val; n++) {
372                                 if (conns >= max_conns) {
373                                         snd_printk(KERN_ERR
374                                                    "Too many connections\n");
375                                         return -EINVAL;
376                                 }
377                                 conn_list[conns++] = n;
378                         }
379                 } else {
380                         if (conns >= max_conns) {
381                                 snd_printk(KERN_ERR "Too many connections\n");
382                                 return -EINVAL;
383                         }
384                         conn_list[conns++] = val;
385                 }
386                 prev_nid = val;
387         }
388         return conns;
389 }
390 EXPORT_SYMBOL_HDA(snd_hda_get_connections);
391
392
393 /**
394  * snd_hda_queue_unsol_event - add an unsolicited event to queue
395  * @bus: the BUS
396  * @res: unsolicited event (lower 32bit of RIRB entry)
397  * @res_ex: codec addr and flags (upper 32bit or RIRB entry)
398  *
399  * Adds the given event to the queue.  The events are processed in
400  * the workqueue asynchronously.  Call this function in the interrupt
401  * hanlder when RIRB receives an unsolicited event.
402  *
403  * Returns 0 if successful, or a negative error code.
404  */
405 int snd_hda_queue_unsol_event(struct hda_bus *bus, u32 res, u32 res_ex)
406 {
407         struct hda_bus_unsolicited *unsol;
408         unsigned int wp;
409
410         unsol = bus->unsol;
411         if (!unsol)
412                 return 0;
413
414         wp = (unsol->wp + 1) % HDA_UNSOL_QUEUE_SIZE;
415         unsol->wp = wp;
416
417         wp <<= 1;
418         unsol->queue[wp] = res;
419         unsol->queue[wp + 1] = res_ex;
420
421         queue_work(bus->workq, &unsol->work);
422
423         return 0;
424 }
425 EXPORT_SYMBOL_HDA(snd_hda_queue_unsol_event);
426
427 /*
428  * process queued unsolicited events
429  */
430 static void process_unsol_events(struct work_struct *work)
431 {
432         struct hda_bus_unsolicited *unsol =
433                 container_of(work, struct hda_bus_unsolicited, work);
434         struct hda_bus *bus = unsol->bus;
435         struct hda_codec *codec;
436         unsigned int rp, caddr, res;
437
438         while (unsol->rp != unsol->wp) {
439                 rp = (unsol->rp + 1) % HDA_UNSOL_QUEUE_SIZE;
440                 unsol->rp = rp;
441                 rp <<= 1;
442                 res = unsol->queue[rp];
443                 caddr = unsol->queue[rp + 1];
444                 if (!(caddr & (1 << 4))) /* no unsolicited event? */
445                         continue;
446                 codec = bus->caddr_tbl[caddr & 0x0f];
447                 if (codec && codec->patch_ops.unsol_event)
448                         codec->patch_ops.unsol_event(codec, res);
449         }
450 }
451
452 /*
453  * initialize unsolicited queue
454  */
455 static int init_unsol_queue(struct hda_bus *bus)
456 {
457         struct hda_bus_unsolicited *unsol;
458
459         if (bus->unsol) /* already initialized */
460                 return 0;
461
462         unsol = kzalloc(sizeof(*unsol), GFP_KERNEL);
463         if (!unsol) {
464                 snd_printk(KERN_ERR "hda_codec: "
465                            "can't allocate unsolicited queue\n");
466                 return -ENOMEM;
467         }
468         INIT_WORK(&unsol->work, process_unsol_events);
469         unsol->bus = bus;
470         bus->unsol = unsol;
471         return 0;
472 }
473
474 /*
475  * destructor
476  */
477 static void snd_hda_codec_free(struct hda_codec *codec);
478
479 static int snd_hda_bus_free(struct hda_bus *bus)
480 {
481         struct hda_codec *codec, *n;
482
483         if (!bus)
484                 return 0;
485         if (bus->workq)
486                 flush_workqueue(bus->workq);
487         if (bus->unsol)
488                 kfree(bus->unsol);
489         list_for_each_entry_safe(codec, n, &bus->codec_list, list) {
490                 snd_hda_codec_free(codec);
491         }
492         if (bus->ops.private_free)
493                 bus->ops.private_free(bus);
494         if (bus->workq)
495                 destroy_workqueue(bus->workq);
496         kfree(bus);
497         return 0;
498 }
499
500 static int snd_hda_bus_dev_free(struct snd_device *device)
501 {
502         struct hda_bus *bus = device->device_data;
503         bus->shutdown = 1;
504         return snd_hda_bus_free(bus);
505 }
506
507 #ifdef CONFIG_SND_HDA_HWDEP
508 static int snd_hda_bus_dev_register(struct snd_device *device)
509 {
510         struct hda_bus *bus = device->device_data;
511         struct hda_codec *codec;
512         list_for_each_entry(codec, &bus->codec_list, list) {
513                 snd_hda_hwdep_add_sysfs(codec);
514         }
515         return 0;
516 }
517 #else
518 #define snd_hda_bus_dev_register        NULL
519 #endif
520
521 /**
522  * snd_hda_bus_new - create a HDA bus
523  * @card: the card entry
524  * @temp: the template for hda_bus information
525  * @busp: the pointer to store the created bus instance
526  *
527  * Returns 0 if successful, or a negative error code.
528  */
529 int /*__devinit*/ snd_hda_bus_new(struct snd_card *card,
530                               const struct hda_bus_template *temp,
531                               struct hda_bus **busp)
532 {
533         struct hda_bus *bus;
534         int err;
535         static struct snd_device_ops dev_ops = {
536                 .dev_register = snd_hda_bus_dev_register,
537                 .dev_free = snd_hda_bus_dev_free,
538         };
539
540         if (snd_BUG_ON(!temp))
541                 return -EINVAL;
542         if (snd_BUG_ON(!temp->ops.command || !temp->ops.get_response))
543                 return -EINVAL;
544
545         if (busp)
546                 *busp = NULL;
547
548         bus = kzalloc(sizeof(*bus), GFP_KERNEL);
549         if (bus == NULL) {
550                 snd_printk(KERN_ERR "can't allocate struct hda_bus\n");
551                 return -ENOMEM;
552         }
553
554         bus->card = card;
555         bus->private_data = temp->private_data;
556         bus->pci = temp->pci;
557         bus->modelname = temp->modelname;
558         bus->power_save = temp->power_save;
559         bus->ops = temp->ops;
560
561         mutex_init(&bus->cmd_mutex);
562         INIT_LIST_HEAD(&bus->codec_list);
563
564         snprintf(bus->workq_name, sizeof(bus->workq_name),
565                  "hd-audio%d", card->number);
566         bus->workq = create_singlethread_workqueue(bus->workq_name);
567         if (!bus->workq) {
568                 snd_printk(KERN_ERR "cannot create workqueue %s\n",
569                            bus->workq_name);
570                 kfree(bus);
571                 return -ENOMEM;
572         }
573
574         err = snd_device_new(card, SNDRV_DEV_BUS, bus, &dev_ops);
575         if (err < 0) {
576                 snd_hda_bus_free(bus);
577                 return err;
578         }
579         if (busp)
580                 *busp = bus;
581         return 0;
582 }
583 EXPORT_SYMBOL_HDA(snd_hda_bus_new);
584
585 #ifdef CONFIG_SND_HDA_GENERIC
586 #define is_generic_config(codec) \
587         (codec->modelname && !strcmp(codec->modelname, "generic"))
588 #else
589 #define is_generic_config(codec)        0
590 #endif
591
592 #ifdef MODULE
593 #define HDA_MODREQ_MAX_COUNT    2       /* two request_modules()'s */
594 #else
595 #define HDA_MODREQ_MAX_COUNT    0       /* all presets are statically linked */
596 #endif
597
598 /*
599  * find a matching codec preset
600  */
601 static const struct hda_codec_preset *
602 find_codec_preset(struct hda_codec *codec)
603 {
604         struct hda_codec_preset_list *tbl;
605         const struct hda_codec_preset *preset;
606         int mod_requested = 0;
607
608         if (is_generic_config(codec))
609                 return NULL; /* use the generic parser */
610
611  again:
612         mutex_lock(&preset_mutex);
613         list_for_each_entry(tbl, &hda_preset_tables, list) {
614                 if (!try_module_get(tbl->owner)) {
615                         snd_printk(KERN_ERR "hda_codec: cannot module_get\n");
616                         continue;
617                 }
618                 for (preset = tbl->preset; preset->id; preset++) {
619                         u32 mask = preset->mask;
620                         if (preset->afg && preset->afg != codec->afg)
621                                 continue;
622                         if (preset->mfg && preset->mfg != codec->mfg)
623                                 continue;
624                         if (!mask)
625                                 mask = ~0;
626                         if (preset->id == (codec->vendor_id & mask) &&
627                             (!preset->rev ||
628                              preset->rev == codec->revision_id)) {
629                                 mutex_unlock(&preset_mutex);
630                                 codec->owner = tbl->owner;
631                                 return preset;
632                         }
633                 }
634                 module_put(tbl->owner);
635         }
636         mutex_unlock(&preset_mutex);
637
638         if (mod_requested < HDA_MODREQ_MAX_COUNT) {
639                 char name[32];
640                 if (!mod_requested)
641                         snprintf(name, sizeof(name), "snd-hda-codec-id:%08x",
642                                  codec->vendor_id);
643                 else
644                         snprintf(name, sizeof(name), "snd-hda-codec-id:%04x*",
645                                  (codec->vendor_id >> 16) & 0xffff);
646                 request_module(name);
647                 mod_requested++;
648                 goto again;
649         }
650         return NULL;
651 }
652
653 /*
654  * get_codec_name - store the codec name
655  */
656 static int get_codec_name(struct hda_codec *codec)
657 {
658         const struct hda_vendor_id *c;
659         const char *vendor = NULL;
660         u16 vendor_id = codec->vendor_id >> 16;
661         char tmp[16];
662
663         if (codec->vendor_name)
664                 goto get_chip_name;
665
666         for (c = hda_vendor_ids; c->id; c++) {
667                 if (c->id == vendor_id) {
668                         vendor = c->name;
669                         break;
670                 }
671         }
672         if (!vendor) {
673                 sprintf(tmp, "Generic %04x", vendor_id);
674                 vendor = tmp;
675         }
676         codec->vendor_name = kstrdup(vendor, GFP_KERNEL);
677         if (!codec->vendor_name)
678                 return -ENOMEM;
679
680  get_chip_name:
681         if (codec->chip_name)
682                 return 0;
683
684         if (codec->preset && codec->preset->name)
685                 codec->chip_name = kstrdup(codec->preset->name, GFP_KERNEL);
686         else {
687                 sprintf(tmp, "ID %x", codec->vendor_id & 0xffff);
688                 codec->chip_name = kstrdup(tmp, GFP_KERNEL);
689         }
690         if (!codec->chip_name)
691                 return -ENOMEM;
692         return 0;
693 }
694
695 /*
696  * look for an AFG and MFG nodes
697  */
698 static void /*__devinit*/ setup_fg_nodes(struct hda_codec *codec)
699 {
700         int i, total_nodes, function_id;
701         hda_nid_t nid;
702
703         total_nodes = snd_hda_get_sub_nodes(codec, AC_NODE_ROOT, &nid);
704         for (i = 0; i < total_nodes; i++, nid++) {
705                 function_id = snd_hda_param_read(codec, nid,
706                                                 AC_PAR_FUNCTION_TYPE) & 0xff;
707                 switch (function_id) {
708                 case AC_GRP_AUDIO_FUNCTION:
709                         codec->afg = nid;
710                         codec->function_id = function_id;
711                         break;
712                 case AC_GRP_MODEM_FUNCTION:
713                         codec->mfg = nid;
714                         codec->function_id = function_id;
715                         break;
716                 default:
717                         break;
718                 }
719         }
720 }
721
722 /*
723  * read widget caps for each widget and store in cache
724  */
725 static int read_widget_caps(struct hda_codec *codec, hda_nid_t fg_node)
726 {
727         int i;
728         hda_nid_t nid;
729
730         codec->num_nodes = snd_hda_get_sub_nodes(codec, fg_node,
731                                                  &codec->start_nid);
732         codec->wcaps = kmalloc(codec->num_nodes * 4, GFP_KERNEL);
733         if (!codec->wcaps)
734                 return -ENOMEM;
735         nid = codec->start_nid;
736         for (i = 0; i < codec->num_nodes; i++, nid++)
737                 codec->wcaps[i] = snd_hda_param_read(codec, nid,
738                                                      AC_PAR_AUDIO_WIDGET_CAP);
739         return 0;
740 }
741
742 /* read all pin default configurations and save codec->init_pins */
743 static int read_pin_defaults(struct hda_codec *codec)
744 {
745         int i;
746         hda_nid_t nid = codec->start_nid;
747
748         for (i = 0; i < codec->num_nodes; i++, nid++) {
749                 struct hda_pincfg *pin;
750                 unsigned int wcaps = get_wcaps(codec, nid);
751                 unsigned int wid_type = (wcaps & AC_WCAP_TYPE) >>
752                                 AC_WCAP_TYPE_SHIFT;
753                 if (wid_type != AC_WID_PIN)
754                         continue;
755                 pin = snd_array_new(&codec->init_pins);
756                 if (!pin)
757                         return -ENOMEM;
758                 pin->nid = nid;
759                 pin->cfg = snd_hda_codec_read(codec, nid, 0,
760                                               AC_VERB_GET_CONFIG_DEFAULT, 0);
761         }
762         return 0;
763 }
764
765 /* look up the given pin config list and return the item matching with NID */
766 static struct hda_pincfg *look_up_pincfg(struct hda_codec *codec,
767                                          struct snd_array *array,
768                                          hda_nid_t nid)
769 {
770         int i;
771         for (i = 0; i < array->used; i++) {
772                 struct hda_pincfg *pin = snd_array_elem(array, i);
773                 if (pin->nid == nid)
774                         return pin;
775         }
776         return NULL;
777 }
778
779 /* write a config value for the given NID */
780 static void set_pincfg(struct hda_codec *codec, hda_nid_t nid,
781                        unsigned int cfg)
782 {
783         int i;
784         for (i = 0; i < 4; i++) {
785                 snd_hda_codec_write(codec, nid, 0,
786                                     AC_VERB_SET_CONFIG_DEFAULT_BYTES_0 + i,
787                                     cfg & 0xff);
788                 cfg >>= 8;
789         }
790 }
791
792 /* set the current pin config value for the given NID.
793  * the value is cached, and read via snd_hda_codec_get_pincfg()
794  */
795 int snd_hda_add_pincfg(struct hda_codec *codec, struct snd_array *list,
796                        hda_nid_t nid, unsigned int cfg)
797 {
798         struct hda_pincfg *pin;
799         unsigned int oldcfg;
800
801         oldcfg = snd_hda_codec_get_pincfg(codec, nid);
802         pin = look_up_pincfg(codec, list, nid);
803         if (!pin) {
804                 pin = snd_array_new(list);
805                 if (!pin)
806                         return -ENOMEM;
807                 pin->nid = nid;
808         }
809         pin->cfg = cfg;
810
811         /* change only when needed; e.g. if the pincfg is already present
812          * in user_pins[], don't write it
813          */
814         cfg = snd_hda_codec_get_pincfg(codec, nid);
815         if (oldcfg != cfg)
816                 set_pincfg(codec, nid, cfg);
817         return 0;
818 }
819
820 int snd_hda_codec_set_pincfg(struct hda_codec *codec,
821                              hda_nid_t nid, unsigned int cfg)
822 {
823         return snd_hda_add_pincfg(codec, &codec->driver_pins, nid, cfg);
824 }
825 EXPORT_SYMBOL_HDA(snd_hda_codec_set_pincfg);
826
827 /* get the current pin config value of the given pin NID */
828 unsigned int snd_hda_codec_get_pincfg(struct hda_codec *codec, hda_nid_t nid)
829 {
830         struct hda_pincfg *pin;
831
832 #ifdef CONFIG_SND_HDA_HWDEP
833         pin = look_up_pincfg(codec, &codec->user_pins, nid);
834         if (pin)
835                 return pin->cfg;
836 #endif
837         pin = look_up_pincfg(codec, &codec->driver_pins, nid);
838         if (pin)
839                 return pin->cfg;
840         pin = look_up_pincfg(codec, &codec->init_pins, nid);
841         if (pin)
842                 return pin->cfg;
843         return 0;
844 }
845 EXPORT_SYMBOL_HDA(snd_hda_codec_get_pincfg);
846
847 /* restore all current pin configs */
848 static void restore_pincfgs(struct hda_codec *codec)
849 {
850         int i;
851         for (i = 0; i < codec->init_pins.used; i++) {
852                 struct hda_pincfg *pin = snd_array_elem(&codec->init_pins, i);
853                 set_pincfg(codec, pin->nid,
854                            snd_hda_codec_get_pincfg(codec, pin->nid));
855         }
856 }
857
858 static void init_hda_cache(struct hda_cache_rec *cache,
859                            unsigned int record_size);
860 static void free_hda_cache(struct hda_cache_rec *cache);
861
862 /* restore the initial pin cfgs and release all pincfg lists */
863 static void restore_init_pincfgs(struct hda_codec *codec)
864 {
865         /* first free driver_pins and user_pins, then call restore_pincfg
866          * so that only the values in init_pins are restored
867          */
868         snd_array_free(&codec->driver_pins);
869 #ifdef CONFIG_SND_HDA_HWDEP
870         snd_array_free(&codec->user_pins);
871 #endif
872         restore_pincfgs(codec);
873         snd_array_free(&codec->init_pins);
874 }
875
876 /*
877  * codec destructor
878  */
879 static void snd_hda_codec_free(struct hda_codec *codec)
880 {
881         if (!codec)
882                 return;
883         restore_init_pincfgs(codec);
884 #ifdef CONFIG_SND_HDA_POWER_SAVE
885         cancel_delayed_work(&codec->power_work);
886         flush_workqueue(codec->bus->workq);
887 #endif
888         list_del(&codec->list);
889         snd_array_free(&codec->mixers);
890         codec->bus->caddr_tbl[codec->addr] = NULL;
891         if (codec->patch_ops.free)
892                 codec->patch_ops.free(codec);
893         module_put(codec->owner);
894         free_hda_cache(&codec->amp_cache);
895         free_hda_cache(&codec->cmd_cache);
896         kfree(codec->vendor_name);
897         kfree(codec->chip_name);
898         kfree(codec->modelname);
899         kfree(codec->wcaps);
900         kfree(codec);
901 }
902
903 static void hda_set_power_state(struct hda_codec *codec, hda_nid_t fg,
904                                 unsigned int power_state);
905
906 /**
907  * snd_hda_codec_new - create a HDA codec
908  * @bus: the bus to assign
909  * @codec_addr: the codec address
910  * @codecp: the pointer to store the generated codec
911  *
912  * Returns 0 if successful, or a negative error code.
913  */
914 int /*__devinit*/ snd_hda_codec_new(struct hda_bus *bus, unsigned int codec_addr,
915                                     struct hda_codec **codecp)
916 {
917         struct hda_codec *codec;
918         char component[31];
919         int err;
920
921         if (snd_BUG_ON(!bus))
922                 return -EINVAL;
923         if (snd_BUG_ON(codec_addr > HDA_MAX_CODEC_ADDRESS))
924                 return -EINVAL;
925
926         if (bus->caddr_tbl[codec_addr]) {
927                 snd_printk(KERN_ERR "hda_codec: "
928                            "address 0x%x is already occupied\n", codec_addr);
929                 return -EBUSY;
930         }
931
932         codec = kzalloc(sizeof(*codec), GFP_KERNEL);
933         if (codec == NULL) {
934                 snd_printk(KERN_ERR "can't allocate struct hda_codec\n");
935                 return -ENOMEM;
936         }
937
938         codec->bus = bus;
939         codec->addr = codec_addr;
940         mutex_init(&codec->spdif_mutex);
941         mutex_init(&codec->control_mutex);
942         init_hda_cache(&codec->amp_cache, sizeof(struct hda_amp_info));
943         init_hda_cache(&codec->cmd_cache, sizeof(struct hda_cache_head));
944         snd_array_init(&codec->mixers, sizeof(struct snd_kcontrol *), 32);
945         snd_array_init(&codec->init_pins, sizeof(struct hda_pincfg), 16);
946         snd_array_init(&codec->driver_pins, sizeof(struct hda_pincfg), 16);
947         if (codec->bus->modelname) {
948                 codec->modelname = kstrdup(codec->bus->modelname, GFP_KERNEL);
949                 if (!codec->modelname) {
950                         snd_hda_codec_free(codec);
951                         return -ENODEV;
952                 }
953         }
954
955 #ifdef CONFIG_SND_HDA_POWER_SAVE
956         INIT_DELAYED_WORK(&codec->power_work, hda_power_work);
957         /* snd_hda_codec_new() marks the codec as power-up, and leave it as is.
958          * the caller has to power down appropriatley after initialization
959          * phase.
960          */
961         hda_keep_power_on(codec);
962 #endif
963
964         list_add_tail(&codec->list, &bus->codec_list);
965         bus->caddr_tbl[codec_addr] = codec;
966
967         codec->vendor_id = snd_hda_param_read(codec, AC_NODE_ROOT,
968                                               AC_PAR_VENDOR_ID);
969         if (codec->vendor_id == -1)
970                 /* read again, hopefully the access method was corrected
971                  * in the last read...
972                  */
973                 codec->vendor_id = snd_hda_param_read(codec, AC_NODE_ROOT,
974                                                       AC_PAR_VENDOR_ID);
975         codec->subsystem_id = snd_hda_param_read(codec, AC_NODE_ROOT,
976                                                  AC_PAR_SUBSYSTEM_ID);
977         codec->revision_id = snd_hda_param_read(codec, AC_NODE_ROOT,
978                                                 AC_PAR_REV_ID);
979
980         setup_fg_nodes(codec);
981         if (!codec->afg && !codec->mfg) {
982                 snd_printdd("hda_codec: no AFG or MFG node found\n");
983                 err = -ENODEV;
984                 goto error;
985         }
986
987         err = read_widget_caps(codec, codec->afg ? codec->afg : codec->mfg);
988         if (err < 0) {
989                 snd_printk(KERN_ERR "hda_codec: cannot malloc\n");
990                 goto error;
991         }
992         err = read_pin_defaults(codec);
993         if (err < 0)
994                 goto error;
995
996         if (!codec->subsystem_id) {
997                 hda_nid_t nid = codec->afg ? codec->afg : codec->mfg;
998                 codec->subsystem_id =
999                         snd_hda_codec_read(codec, nid, 0,
1000                                            AC_VERB_GET_SUBSYSTEM_ID, 0);
1001         }
1002
1003         /* power-up all before initialization */
1004         hda_set_power_state(codec,
1005                             codec->afg ? codec->afg : codec->mfg,
1006                             AC_PWRST_D0);
1007
1008         snd_hda_codec_proc_new(codec);
1009
1010         snd_hda_create_hwdep(codec);
1011
1012         sprintf(component, "HDA:%08x,%08x,%08x", codec->vendor_id,
1013                 codec->subsystem_id, codec->revision_id);
1014         snd_component_add(codec->bus->card, component);
1015
1016         if (codecp)
1017                 *codecp = codec;
1018         return 0;
1019
1020  error:
1021         snd_hda_codec_free(codec);
1022         return err;
1023 }
1024 EXPORT_SYMBOL_HDA(snd_hda_codec_new);
1025
1026 int snd_hda_codec_configure(struct hda_codec *codec)
1027 {
1028         int err;
1029
1030         codec->preset = find_codec_preset(codec);
1031         if (!codec->vendor_name || !codec->chip_name) {
1032                 err = get_codec_name(codec);
1033                 if (err < 0)
1034                         return err;
1035         }
1036         /* audio codec should override the mixer name */
1037         if (codec->afg || !*codec->bus->card->mixername)
1038                 snprintf(codec->bus->card->mixername,
1039                          sizeof(codec->bus->card->mixername),
1040                          "%s %s", codec->vendor_name, codec->chip_name);
1041
1042         if (is_generic_config(codec)) {
1043                 err = snd_hda_parse_generic_codec(codec);
1044                 goto patched;
1045         }
1046         if (codec->preset && codec->preset->patch) {
1047                 err = codec->preset->patch(codec);
1048                 goto patched;
1049         }
1050
1051         /* call the default parser */
1052         err = snd_hda_parse_generic_codec(codec);
1053         if (err < 0)
1054                 printk(KERN_ERR "hda-codec: No codec parser is available\n");
1055
1056  patched:
1057         if (!err && codec->patch_ops.unsol_event)
1058                 err = init_unsol_queue(codec->bus);
1059         return err;
1060 }
1061 EXPORT_SYMBOL_HDA(snd_hda_codec_configure);
1062
1063 /**
1064  * snd_hda_codec_setup_stream - set up the codec for streaming
1065  * @codec: the CODEC to set up
1066  * @nid: the NID to set up
1067  * @stream_tag: stream tag to pass, it's between 0x1 and 0xf.
1068  * @channel_id: channel id to pass, zero based.
1069  * @format: stream format.
1070  */
1071 void snd_hda_codec_setup_stream(struct hda_codec *codec, hda_nid_t nid,
1072                                 u32 stream_tag,
1073                                 int channel_id, int format)
1074 {
1075         if (!nid)
1076                 return;
1077
1078         snd_printdd("hda_codec_setup_stream: "
1079                     "NID=0x%x, stream=0x%x, channel=%d, format=0x%x\n",
1080                     nid, stream_tag, channel_id, format);
1081         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_CHANNEL_STREAMID,
1082                             (stream_tag << 4) | channel_id);
1083         msleep(1);
1084         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_STREAM_FORMAT, format);
1085 }
1086 EXPORT_SYMBOL_HDA(snd_hda_codec_setup_stream);
1087
1088 void snd_hda_codec_cleanup_stream(struct hda_codec *codec, hda_nid_t nid)
1089 {
1090         if (!nid)
1091                 return;
1092
1093         snd_printdd("hda_codec_cleanup_stream: NID=0x%x\n", nid);
1094         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_CHANNEL_STREAMID, 0);
1095 #if 0 /* keep the format */
1096         msleep(1);
1097         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_STREAM_FORMAT, 0);
1098 #endif
1099 }
1100 EXPORT_SYMBOL_HDA(snd_hda_codec_cleanup_stream);
1101
1102 /*
1103  * amp access functions
1104  */
1105
1106 /* FIXME: more better hash key? */
1107 #define HDA_HASH_KEY(nid,dir,idx) (u32)((nid) + ((idx) << 16) + ((dir) << 24))
1108 #define HDA_HASH_PINCAP_KEY(nid) (u32)((nid) + (0x02 << 24))
1109 #define HDA_HASH_PARPCM_KEY(nid) (u32)((nid) + (0x03 << 24))
1110 #define HDA_HASH_PARSTR_KEY(nid) (u32)((nid) + (0x04 << 24))
1111 #define INFO_AMP_CAPS   (1<<0)
1112 #define INFO_AMP_VOL(ch)        (1 << (1 + (ch)))
1113
1114 /* initialize the hash table */
1115 static void /*__devinit*/ init_hda_cache(struct hda_cache_rec *cache,
1116                                      unsigned int record_size)
1117 {
1118         memset(cache, 0, sizeof(*cache));
1119         memset(cache->hash, 0xff, sizeof(cache->hash));
1120         snd_array_init(&cache->buf, record_size, 64);
1121 }
1122
1123 static void free_hda_cache(struct hda_cache_rec *cache)
1124 {
1125         snd_array_free(&cache->buf);
1126 }
1127
1128 /* query the hash.  allocate an entry if not found. */
1129 static struct hda_cache_head  *get_alloc_hash(struct hda_cache_rec *cache,
1130                                               u32 key)
1131 {
1132         u16 idx = key % (u16)ARRAY_SIZE(cache->hash);
1133         u16 cur = cache->hash[idx];
1134         struct hda_cache_head *info;
1135
1136         while (cur != 0xffff) {
1137                 info = snd_array_elem(&cache->buf, cur);
1138                 if (info->key == key)
1139                         return info;
1140                 cur = info->next;
1141         }
1142
1143         /* add a new hash entry */
1144         info = snd_array_new(&cache->buf);
1145         if (!info)
1146                 return NULL;
1147         cur = snd_array_index(&cache->buf, info);
1148         info->key = key;
1149         info->val = 0;
1150         info->next = cache->hash[idx];
1151         cache->hash[idx] = cur;
1152
1153         return info;
1154 }
1155
1156 /* query and allocate an amp hash entry */
1157 static inline struct hda_amp_info *
1158 get_alloc_amp_hash(struct hda_codec *codec, u32 key)
1159 {
1160         return (struct hda_amp_info *)get_alloc_hash(&codec->amp_cache, key);
1161 }
1162
1163 /*
1164  * query AMP capabilities for the given widget and direction
1165  */
1166 u32 query_amp_caps(struct hda_codec *codec, hda_nid_t nid, int direction)
1167 {
1168         struct hda_amp_info *info;
1169
1170         info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, 0));
1171         if (!info)
1172                 return 0;
1173         if (!(info->head.val & INFO_AMP_CAPS)) {
1174                 if (!(get_wcaps(codec, nid) & AC_WCAP_AMP_OVRD))
1175                         nid = codec->afg;
1176                 info->amp_caps = snd_hda_param_read(codec, nid,
1177                                                     direction == HDA_OUTPUT ?
1178                                                     AC_PAR_AMP_OUT_CAP :
1179                                                     AC_PAR_AMP_IN_CAP);
1180                 if (info->amp_caps)
1181                         info->head.val |= INFO_AMP_CAPS;
1182         }
1183         return info->amp_caps;
1184 }
1185 EXPORT_SYMBOL_HDA(query_amp_caps);
1186
1187 int snd_hda_override_amp_caps(struct hda_codec *codec, hda_nid_t nid, int dir,
1188                               unsigned int caps)
1189 {
1190         struct hda_amp_info *info;
1191
1192         info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, dir, 0));
1193         if (!info)
1194                 return -EINVAL;
1195         info->amp_caps = caps;
1196         info->head.val |= INFO_AMP_CAPS;
1197         return 0;
1198 }
1199 EXPORT_SYMBOL_HDA(snd_hda_override_amp_caps);
1200
1201 static unsigned int
1202 query_caps_hash(struct hda_codec *codec, hda_nid_t nid, u32 key,
1203                 unsigned int (*func)(struct hda_codec *, hda_nid_t))
1204 {
1205         struct hda_amp_info *info;
1206
1207         info = get_alloc_amp_hash(codec, key);
1208         if (!info)
1209                 return 0;
1210         if (!info->head.val) {
1211                 info->head.val |= INFO_AMP_CAPS;
1212                 info->amp_caps = func(codec, nid);
1213         }
1214         return info->amp_caps;
1215 }
1216
1217 static unsigned int read_pin_cap(struct hda_codec *codec, hda_nid_t nid)
1218 {
1219         return snd_hda_param_read(codec, nid, AC_PAR_PIN_CAP);
1220 }
1221
1222 u32 snd_hda_query_pin_caps(struct hda_codec *codec, hda_nid_t nid)
1223 {
1224         return query_caps_hash(codec, nid, HDA_HASH_PINCAP_KEY(nid),
1225                                read_pin_cap);
1226 }
1227 EXPORT_SYMBOL_HDA(snd_hda_query_pin_caps);
1228
1229 /*
1230  * read the current volume to info
1231  * if the cache exists, read the cache value.
1232  */
1233 static unsigned int get_vol_mute(struct hda_codec *codec,
1234                                  struct hda_amp_info *info, hda_nid_t nid,
1235                                  int ch, int direction, int index)
1236 {
1237         u32 val, parm;
1238
1239         if (info->head.val & INFO_AMP_VOL(ch))
1240                 return info->vol[ch];
1241
1242         parm = ch ? AC_AMP_GET_RIGHT : AC_AMP_GET_LEFT;
1243         parm |= direction == HDA_OUTPUT ? AC_AMP_GET_OUTPUT : AC_AMP_GET_INPUT;
1244         parm |= index;
1245         val = snd_hda_codec_read(codec, nid, 0,
1246                                  AC_VERB_GET_AMP_GAIN_MUTE, parm);
1247         info->vol[ch] = val & 0xff;
1248         info->head.val |= INFO_AMP_VOL(ch);
1249         return info->vol[ch];
1250 }
1251
1252 /*
1253  * write the current volume in info to the h/w and update the cache
1254  */
1255 static void put_vol_mute(struct hda_codec *codec, struct hda_amp_info *info,
1256                          hda_nid_t nid, int ch, int direction, int index,
1257                          int val)
1258 {
1259         u32 parm;
1260
1261         parm = ch ? AC_AMP_SET_RIGHT : AC_AMP_SET_LEFT;
1262         parm |= direction == HDA_OUTPUT ? AC_AMP_SET_OUTPUT : AC_AMP_SET_INPUT;
1263         parm |= index << AC_AMP_SET_INDEX_SHIFT;
1264         parm |= val;
1265         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_AMP_GAIN_MUTE, parm);
1266         info->vol[ch] = val;
1267 }
1268
1269 /*
1270  * read AMP value.  The volume is between 0 to 0x7f, 0x80 = mute bit.
1271  */
1272 int snd_hda_codec_amp_read(struct hda_codec *codec, hda_nid_t nid, int ch,
1273                            int direction, int index)
1274 {
1275         struct hda_amp_info *info;
1276         info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, index));
1277         if (!info)
1278                 return 0;
1279         return get_vol_mute(codec, info, nid, ch, direction, index);
1280 }
1281 EXPORT_SYMBOL_HDA(snd_hda_codec_amp_read);
1282
1283 /*
1284  * update the AMP value, mask = bit mask to set, val = the value
1285  */
1286 int snd_hda_codec_amp_update(struct hda_codec *codec, hda_nid_t nid, int ch,
1287                              int direction, int idx, int mask, int val)
1288 {
1289         struct hda_amp_info *info;
1290
1291         info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, idx));
1292         if (!info)
1293                 return 0;
1294         val &= mask;
1295         val |= get_vol_mute(codec, info, nid, ch, direction, idx) & ~mask;
1296         if (info->vol[ch] == val)
1297                 return 0;
1298         put_vol_mute(codec, info, nid, ch, direction, idx, val);
1299         return 1;
1300 }
1301 EXPORT_SYMBOL_HDA(snd_hda_codec_amp_update);
1302
1303 /*
1304  * update the AMP stereo with the same mask and value
1305  */
1306 int snd_hda_codec_amp_stereo(struct hda_codec *codec, hda_nid_t nid,
1307                              int direction, int idx, int mask, int val)
1308 {
1309         int ch, ret = 0;
1310         for (ch = 0; ch < 2; ch++)
1311                 ret |= snd_hda_codec_amp_update(codec, nid, ch, direction,
1312                                                 idx, mask, val);
1313         return ret;
1314 }
1315 EXPORT_SYMBOL_HDA(snd_hda_codec_amp_stereo);
1316
1317 #ifdef SND_HDA_NEEDS_RESUME
1318 /* resume the all amp commands from the cache */
1319 void snd_hda_codec_resume_amp(struct hda_codec *codec)
1320 {
1321         struct hda_amp_info *buffer = codec->amp_cache.buf.list;
1322         int i;
1323
1324         for (i = 0; i < codec->amp_cache.buf.used; i++, buffer++) {
1325                 u32 key = buffer->head.key;
1326                 hda_nid_t nid;
1327                 unsigned int idx, dir, ch;
1328                 if (!key)
1329                         continue;
1330                 nid = key & 0xff;
1331                 idx = (key >> 16) & 0xff;
1332                 dir = (key >> 24) & 0xff;
1333                 for (ch = 0; ch < 2; ch++) {
1334                         if (!(buffer->head.val & INFO_AMP_VOL(ch)))
1335                                 continue;
1336                         put_vol_mute(codec, buffer, nid, ch, dir, idx,
1337                                      buffer->vol[ch]);
1338                 }
1339         }
1340 }
1341 EXPORT_SYMBOL_HDA(snd_hda_codec_resume_amp);
1342 #endif /* SND_HDA_NEEDS_RESUME */
1343
1344 /* volume */
1345 int snd_hda_mixer_amp_volume_info(struct snd_kcontrol *kcontrol,
1346                                   struct snd_ctl_elem_info *uinfo)
1347 {
1348         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1349         u16 nid = get_amp_nid(kcontrol);
1350         u8 chs = get_amp_channels(kcontrol);
1351         int dir = get_amp_direction(kcontrol);
1352         unsigned int ofs = get_amp_offset(kcontrol);
1353         u32 caps;
1354
1355         caps = query_amp_caps(codec, nid, dir);
1356         /* num steps */
1357         caps = (caps & AC_AMPCAP_NUM_STEPS) >> AC_AMPCAP_NUM_STEPS_SHIFT;
1358         if (!caps) {
1359                 printk(KERN_WARNING "hda_codec: "
1360                        "num_steps = 0 for NID=0x%x (ctl = %s)\n", nid,
1361                        kcontrol->id.name);
1362                 return -EINVAL;
1363         }
1364         if (ofs < caps)
1365                 caps -= ofs;
1366         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1367         uinfo->count = chs == 3 ? 2 : 1;
1368         uinfo->value.integer.min = 0;
1369         uinfo->value.integer.max = caps;
1370         return 0;
1371 }
1372 EXPORT_SYMBOL_HDA(snd_hda_mixer_amp_volume_info);
1373
1374
1375 static inline unsigned int
1376 read_amp_value(struct hda_codec *codec, hda_nid_t nid,
1377                int ch, int dir, int idx, unsigned int ofs)
1378 {
1379         unsigned int val;
1380         val = snd_hda_codec_amp_read(codec, nid, ch, dir, idx);
1381         val &= HDA_AMP_VOLMASK;
1382         if (val >= ofs)
1383                 val -= ofs;
1384         else
1385                 val = 0;
1386         return val;
1387 }
1388
1389 static inline int
1390 update_amp_value(struct hda_codec *codec, hda_nid_t nid,
1391                  int ch, int dir, int idx, unsigned int ofs,
1392                  unsigned int val)
1393 {
1394         if (val > 0)
1395                 val += ofs;
1396         return snd_hda_codec_amp_update(codec, nid, ch, dir, idx,
1397                                         HDA_AMP_VOLMASK, val);
1398 }
1399
1400 int snd_hda_mixer_amp_volume_get(struct snd_kcontrol *kcontrol,
1401                                  struct snd_ctl_elem_value *ucontrol)
1402 {
1403         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1404         hda_nid_t nid = get_amp_nid(kcontrol);
1405         int chs = get_amp_channels(kcontrol);
1406         int dir = get_amp_direction(kcontrol);
1407         int idx = get_amp_index(kcontrol);
1408         unsigned int ofs = get_amp_offset(kcontrol);
1409         long *valp = ucontrol->value.integer.value;
1410
1411         if (chs & 1)
1412                 *valp++ = read_amp_value(codec, nid, 0, dir, idx, ofs);
1413         if (chs & 2)
1414                 *valp = read_amp_value(codec, nid, 1, dir, idx, ofs);
1415         return 0;
1416 }
1417 EXPORT_SYMBOL_HDA(snd_hda_mixer_amp_volume_get);
1418
1419 int snd_hda_mixer_amp_volume_put(struct snd_kcontrol *kcontrol,
1420                                  struct snd_ctl_elem_value *ucontrol)
1421 {
1422         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1423         hda_nid_t nid = get_amp_nid(kcontrol);
1424         int chs = get_amp_channels(kcontrol);
1425         int dir = get_amp_direction(kcontrol);
1426         int idx = get_amp_index(kcontrol);
1427         unsigned int ofs = get_amp_offset(kcontrol);
1428         long *valp = ucontrol->value.integer.value;
1429         int change = 0;
1430
1431         snd_hda_power_up(codec);
1432         if (chs & 1) {
1433                 change = update_amp_value(codec, nid, 0, dir, idx, ofs, *valp);
1434                 valp++;
1435         }
1436         if (chs & 2)
1437                 change |= update_amp_value(codec, nid, 1, dir, idx, ofs, *valp);
1438         snd_hda_power_down(codec);
1439         return change;
1440 }
1441 EXPORT_SYMBOL_HDA(snd_hda_mixer_amp_volume_put);
1442
1443 int snd_hda_mixer_amp_tlv(struct snd_kcontrol *kcontrol, int op_flag,
1444                           unsigned int size, unsigned int __user *_tlv)
1445 {
1446         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1447         hda_nid_t nid = get_amp_nid(kcontrol);
1448         int dir = get_amp_direction(kcontrol);
1449         unsigned int ofs = get_amp_offset(kcontrol);
1450         u32 caps, val1, val2;
1451
1452         if (size < 4 * sizeof(unsigned int))
1453                 return -ENOMEM;
1454         caps = query_amp_caps(codec, nid, dir);
1455         val2 = (caps & AC_AMPCAP_STEP_SIZE) >> AC_AMPCAP_STEP_SIZE_SHIFT;
1456         val2 = (val2 + 1) * 25;
1457         val1 = -((caps & AC_AMPCAP_OFFSET) >> AC_AMPCAP_OFFSET_SHIFT);
1458         val1 += ofs;
1459         val1 = ((int)val1) * ((int)val2);
1460         if (put_user(SNDRV_CTL_TLVT_DB_SCALE, _tlv))
1461                 return -EFAULT;
1462         if (put_user(2 * sizeof(unsigned int), _tlv + 1))
1463                 return -EFAULT;
1464         if (put_user(val1, _tlv + 2))
1465                 return -EFAULT;
1466         if (put_user(val2, _tlv + 3))
1467                 return -EFAULT;
1468         return 0;
1469 }
1470 EXPORT_SYMBOL_HDA(snd_hda_mixer_amp_tlv);
1471
1472 /*
1473  * set (static) TLV for virtual master volume; recalculated as max 0dB
1474  */
1475 void snd_hda_set_vmaster_tlv(struct hda_codec *codec, hda_nid_t nid, int dir,
1476                              unsigned int *tlv)
1477 {
1478         u32 caps;
1479         int nums, step;
1480
1481         caps = query_amp_caps(codec, nid, dir);
1482         nums = (caps & AC_AMPCAP_NUM_STEPS) >> AC_AMPCAP_NUM_STEPS_SHIFT;
1483         step = (caps & AC_AMPCAP_STEP_SIZE) >> AC_AMPCAP_STEP_SIZE_SHIFT;
1484         step = (step + 1) * 25;
1485         tlv[0] = SNDRV_CTL_TLVT_DB_SCALE;
1486         tlv[1] = 2 * sizeof(unsigned int);
1487         tlv[2] = -nums * step;
1488         tlv[3] = step;
1489 }
1490 EXPORT_SYMBOL_HDA(snd_hda_set_vmaster_tlv);
1491
1492 /* find a mixer control element with the given name */
1493 static struct snd_kcontrol *
1494 _snd_hda_find_mixer_ctl(struct hda_codec *codec,
1495                         const char *name, int idx)
1496 {
1497         struct snd_ctl_elem_id id;
1498         memset(&id, 0, sizeof(id));
1499         id.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
1500         id.index = idx;
1501         if (snd_BUG_ON(strlen(name) >= sizeof(id.name)))
1502                 return NULL;
1503         strcpy(id.name, name);
1504         return snd_ctl_find_id(codec->bus->card, &id);
1505 }
1506
1507 struct snd_kcontrol *snd_hda_find_mixer_ctl(struct hda_codec *codec,
1508                                             const char *name)
1509 {
1510         return _snd_hda_find_mixer_ctl(codec, name, 0);
1511 }
1512 EXPORT_SYMBOL_HDA(snd_hda_find_mixer_ctl);
1513
1514 /* Add a control element and assign to the codec */
1515 int snd_hda_ctl_add(struct hda_codec *codec, struct snd_kcontrol *kctl)
1516 {
1517         int err;
1518         struct snd_kcontrol **knewp;
1519
1520         err = snd_ctl_add(codec->bus->card, kctl);
1521         if (err < 0)
1522                 return err;
1523         knewp = snd_array_new(&codec->mixers);
1524         if (!knewp)
1525                 return -ENOMEM;
1526         *knewp = kctl;
1527         return 0;
1528 }
1529 EXPORT_SYMBOL_HDA(snd_hda_ctl_add);
1530
1531 /* Clear all controls assigned to the given codec */
1532 void snd_hda_ctls_clear(struct hda_codec *codec)
1533 {
1534         int i;
1535         struct snd_kcontrol **kctls = codec->mixers.list;
1536         for (i = 0; i < codec->mixers.used; i++)
1537                 snd_ctl_remove(codec->bus->card, kctls[i]);
1538         snd_array_free(&codec->mixers);
1539 }
1540
1541 /* pseudo device locking
1542  * toggle card->shutdown to allow/disallow the device access (as a hack)
1543  */
1544 static int hda_lock_devices(struct snd_card *card)
1545 {
1546         spin_lock(&card->files_lock);
1547         if (card->shutdown) {
1548                 spin_unlock(&card->files_lock);
1549                 return -EINVAL;
1550         }
1551         card->shutdown = 1;
1552         spin_unlock(&card->files_lock);
1553         return 0;
1554 }
1555
1556 static void hda_unlock_devices(struct snd_card *card)
1557 {
1558         spin_lock(&card->files_lock);
1559         card->shutdown = 0;
1560         spin_unlock(&card->files_lock);
1561 }
1562
1563 int snd_hda_codec_reset(struct hda_codec *codec)
1564 {
1565         struct snd_card *card = codec->bus->card;
1566         int i, pcm;
1567
1568         if (hda_lock_devices(card) < 0)
1569                 return -EBUSY;
1570         /* check whether the codec isn't used by any mixer or PCM streams */
1571         if (!list_empty(&card->ctl_files)) {
1572                 hda_unlock_devices(card);
1573                 return -EBUSY;
1574         }
1575         for (pcm = 0; pcm < codec->num_pcms; pcm++) {
1576                 struct hda_pcm *cpcm = &codec->pcm_info[pcm];
1577                 if (!cpcm->pcm)
1578                         continue;
1579                 if (cpcm->pcm->streams[0].substream_opened ||
1580                     cpcm->pcm->streams[1].substream_opened) {
1581                         hda_unlock_devices(card);
1582                         return -EBUSY;
1583                 }
1584         }
1585
1586         /* OK, let it free */
1587
1588 #ifdef CONFIG_SND_HDA_POWER_SAVE
1589         cancel_delayed_work(&codec->power_work);
1590         flush_workqueue(codec->bus->workq);
1591 #endif
1592         snd_hda_ctls_clear(codec);
1593         /* relase PCMs */
1594         for (i = 0; i < codec->num_pcms; i++) {
1595                 if (codec->pcm_info[i].pcm) {
1596                         snd_device_free(card, codec->pcm_info[i].pcm);
1597                         clear_bit(codec->pcm_info[i].device,
1598                                   codec->bus->pcm_dev_bits);
1599                 }
1600         }
1601         if (codec->patch_ops.free)
1602                 codec->patch_ops.free(codec);
1603         codec->proc_widget_hook = NULL;
1604         codec->spec = NULL;
1605         free_hda_cache(&codec->amp_cache);
1606         free_hda_cache(&codec->cmd_cache);
1607         init_hda_cache(&codec->amp_cache, sizeof(struct hda_amp_info));
1608         init_hda_cache(&codec->cmd_cache, sizeof(struct hda_cache_head));
1609         /* free only driver_pins so that init_pins + user_pins are restored */
1610         snd_array_free(&codec->driver_pins);
1611         restore_pincfgs(codec);
1612         codec->num_pcms = 0;
1613         codec->pcm_info = NULL;
1614         codec->preset = NULL;
1615         memset(&codec->patch_ops, 0, sizeof(codec->patch_ops));
1616         codec->slave_dig_outs = NULL;
1617         codec->spdif_status_reset = 0;
1618         module_put(codec->owner);
1619         codec->owner = NULL;
1620
1621         /* allow device access again */
1622         hda_unlock_devices(card);
1623         return 0;
1624 }
1625
1626 /* create a virtual master control and add slaves */
1627 int snd_hda_add_vmaster(struct hda_codec *codec, char *name,
1628                         unsigned int *tlv, const char **slaves)
1629 {
1630         struct snd_kcontrol *kctl;
1631         const char **s;
1632         int err;
1633
1634         for (s = slaves; *s && !snd_hda_find_mixer_ctl(codec, *s); s++)
1635                 ;
1636         if (!*s) {
1637                 snd_printdd("No slave found for %s\n", name);
1638                 return 0;
1639         }
1640         kctl = snd_ctl_make_virtual_master(name, tlv);
1641         if (!kctl)
1642                 return -ENOMEM;
1643         err = snd_hda_ctl_add(codec, kctl);
1644         if (err < 0)
1645                 return err;
1646         
1647         for (s = slaves; *s; s++) {
1648                 struct snd_kcontrol *sctl;
1649                 int i = 0;
1650                 for (;;) {
1651                         sctl = _snd_hda_find_mixer_ctl(codec, *s, i);
1652                         if (!sctl) {
1653                                 if (!i)
1654                                         snd_printdd("Cannot find slave %s, "
1655                                                     "skipped\n", *s);
1656                                 break;
1657                         }
1658                         err = snd_ctl_add_slave(kctl, sctl);
1659                         if (err < 0)
1660                                 return err;
1661                         i++;
1662                 }
1663         }
1664         return 0;
1665 }
1666 EXPORT_SYMBOL_HDA(snd_hda_add_vmaster);
1667
1668 /* switch */
1669 int snd_hda_mixer_amp_switch_info(struct snd_kcontrol *kcontrol,
1670                                   struct snd_ctl_elem_info *uinfo)
1671 {
1672         int chs = get_amp_channels(kcontrol);
1673
1674         uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
1675         uinfo->count = chs == 3 ? 2 : 1;
1676         uinfo->value.integer.min = 0;
1677         uinfo->value.integer.max = 1;
1678         return 0;
1679 }
1680 EXPORT_SYMBOL_HDA(snd_hda_mixer_amp_switch_info);
1681
1682 int snd_hda_mixer_amp_switch_get(struct snd_kcontrol *kcontrol,
1683                                  struct snd_ctl_elem_value *ucontrol)
1684 {
1685         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1686         hda_nid_t nid = get_amp_nid(kcontrol);
1687         int chs = get_amp_channels(kcontrol);
1688         int dir = get_amp_direction(kcontrol);
1689         int idx = get_amp_index(kcontrol);
1690         long *valp = ucontrol->value.integer.value;
1691
1692         if (chs & 1)
1693                 *valp++ = (snd_hda_codec_amp_read(codec, nid, 0, dir, idx) &
1694                            HDA_AMP_MUTE) ? 0 : 1;
1695         if (chs & 2)
1696                 *valp = (snd_hda_codec_amp_read(codec, nid, 1, dir, idx) &
1697                          HDA_AMP_MUTE) ? 0 : 1;
1698         return 0;
1699 }
1700 EXPORT_SYMBOL_HDA(snd_hda_mixer_amp_switch_get);
1701
1702 int snd_hda_mixer_amp_switch_put(struct snd_kcontrol *kcontrol,
1703                                  struct snd_ctl_elem_value *ucontrol)
1704 {
1705         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1706         hda_nid_t nid = get_amp_nid(kcontrol);
1707         int chs = get_amp_channels(kcontrol);
1708         int dir = get_amp_direction(kcontrol);
1709         int idx = get_amp_index(kcontrol);
1710         long *valp = ucontrol->value.integer.value;
1711         int change = 0;
1712
1713         snd_hda_power_up(codec);
1714         if (chs & 1) {
1715                 change = snd_hda_codec_amp_update(codec, nid, 0, dir, idx,
1716                                                   HDA_AMP_MUTE,
1717                                                   *valp ? 0 : HDA_AMP_MUTE);
1718                 valp++;
1719         }
1720         if (chs & 2)
1721                 change |= snd_hda_codec_amp_update(codec, nid, 1, dir, idx,
1722                                                    HDA_AMP_MUTE,
1723                                                    *valp ? 0 : HDA_AMP_MUTE);
1724 #ifdef CONFIG_SND_HDA_POWER_SAVE
1725         if (codec->patch_ops.check_power_status)
1726                 codec->patch_ops.check_power_status(codec, nid);
1727 #endif
1728         snd_hda_power_down(codec);
1729         return change;
1730 }
1731 EXPORT_SYMBOL_HDA(snd_hda_mixer_amp_switch_put);
1732
1733 /*
1734  * bound volume controls
1735  *
1736  * bind multiple volumes (# indices, from 0)
1737  */
1738
1739 #define AMP_VAL_IDX_SHIFT       19
1740 #define AMP_VAL_IDX_MASK        (0x0f<<19)
1741
1742 int snd_hda_mixer_bind_switch_get(struct snd_kcontrol *kcontrol,
1743                                   struct snd_ctl_elem_value *ucontrol)
1744 {
1745         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1746         unsigned long pval;
1747         int err;
1748
1749         mutex_lock(&codec->control_mutex);
1750         pval = kcontrol->private_value;
1751         kcontrol->private_value = pval & ~AMP_VAL_IDX_MASK; /* index 0 */
1752         err = snd_hda_mixer_amp_switch_get(kcontrol, ucontrol);
1753         kcontrol->private_value = pval;
1754         mutex_unlock(&codec->control_mutex);
1755         return err;
1756 }
1757 EXPORT_SYMBOL_HDA(snd_hda_mixer_bind_switch_get);
1758
1759 int snd_hda_mixer_bind_switch_put(struct snd_kcontrol *kcontrol,
1760                                   struct snd_ctl_elem_value *ucontrol)
1761 {
1762         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1763         unsigned long pval;
1764         int i, indices, err = 0, change = 0;
1765
1766         mutex_lock(&codec->control_mutex);
1767         pval = kcontrol->private_value;
1768         indices = (pval & AMP_VAL_IDX_MASK) >> AMP_VAL_IDX_SHIFT;
1769         for (i = 0; i < indices; i++) {
1770                 kcontrol->private_value = (pval & ~AMP_VAL_IDX_MASK) |
1771                         (i << AMP_VAL_IDX_SHIFT);
1772                 err = snd_hda_mixer_amp_switch_put(kcontrol, ucontrol);
1773                 if (err < 0)
1774                         break;
1775                 change |= err;
1776         }
1777         kcontrol->private_value = pval;
1778         mutex_unlock(&codec->control_mutex);
1779         return err < 0 ? err : change;
1780 }
1781 EXPORT_SYMBOL_HDA(snd_hda_mixer_bind_switch_put);
1782
1783 /*
1784  * generic bound volume/swtich controls
1785  */
1786 int snd_hda_mixer_bind_ctls_info(struct snd_kcontrol *kcontrol,
1787                                  struct snd_ctl_elem_info *uinfo)
1788 {
1789         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1790         struct hda_bind_ctls *c;
1791         int err;
1792
1793         mutex_lock(&codec->control_mutex);
1794         c = (struct hda_bind_ctls *)kcontrol->private_value;
1795         kcontrol->private_value = *c->values;
1796         err = c->ops->info(kcontrol, uinfo);
1797         kcontrol->private_value = (long)c;
1798         mutex_unlock(&codec->control_mutex);
1799         return err;
1800 }
1801 EXPORT_SYMBOL_HDA(snd_hda_mixer_bind_ctls_info);
1802
1803 int snd_hda_mixer_bind_ctls_get(struct snd_kcontrol *kcontrol,
1804                                 struct snd_ctl_elem_value *ucontrol)
1805 {
1806         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1807         struct hda_bind_ctls *c;
1808         int err;
1809
1810         mutex_lock(&codec->control_mutex);
1811         c = (struct hda_bind_ctls *)kcontrol->private_value;
1812         kcontrol->private_value = *c->values;
1813         err = c->ops->get(kcontrol, ucontrol);
1814         kcontrol->private_value = (long)c;
1815         mutex_unlock(&codec->control_mutex);
1816         return err;
1817 }
1818 EXPORT_SYMBOL_HDA(snd_hda_mixer_bind_ctls_get);
1819
1820 int snd_hda_mixer_bind_ctls_put(struct snd_kcontrol *kcontrol,
1821                                 struct snd_ctl_elem_value *ucontrol)
1822 {
1823         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1824         struct hda_bind_ctls *c;
1825         unsigned long *vals;
1826         int err = 0, change = 0;
1827
1828         mutex_lock(&codec->control_mutex);
1829         c = (struct hda_bind_ctls *)kcontrol->private_value;
1830         for (vals = c->values; *vals; vals++) {
1831                 kcontrol->private_value = *vals;
1832                 err = c->ops->put(kcontrol, ucontrol);
1833                 if (err < 0)
1834                         break;
1835                 change |= err;
1836         }
1837         kcontrol->private_value = (long)c;
1838         mutex_unlock(&codec->control_mutex);
1839         return err < 0 ? err : change;
1840 }
1841 EXPORT_SYMBOL_HDA(snd_hda_mixer_bind_ctls_put);
1842
1843 int snd_hda_mixer_bind_tlv(struct snd_kcontrol *kcontrol, int op_flag,
1844                            unsigned int size, unsigned int __user *tlv)
1845 {
1846         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1847         struct hda_bind_ctls *c;
1848         int err;
1849
1850         mutex_lock(&codec->control_mutex);
1851         c = (struct hda_bind_ctls *)kcontrol->private_value;
1852         kcontrol->private_value = *c->values;
1853         err = c->ops->tlv(kcontrol, op_flag, size, tlv);
1854         kcontrol->private_value = (long)c;
1855         mutex_unlock(&codec->control_mutex);
1856         return err;
1857 }
1858 EXPORT_SYMBOL_HDA(snd_hda_mixer_bind_tlv);
1859
1860 struct hda_ctl_ops snd_hda_bind_vol = {
1861         .info = snd_hda_mixer_amp_volume_info,
1862         .get = snd_hda_mixer_amp_volume_get,
1863         .put = snd_hda_mixer_amp_volume_put,
1864         .tlv = snd_hda_mixer_amp_tlv
1865 };
1866 EXPORT_SYMBOL_HDA(snd_hda_bind_vol);
1867
1868 struct hda_ctl_ops snd_hda_bind_sw = {
1869         .info = snd_hda_mixer_amp_switch_info,
1870         .get = snd_hda_mixer_amp_switch_get,
1871         .put = snd_hda_mixer_amp_switch_put,
1872         .tlv = snd_hda_mixer_amp_tlv
1873 };
1874 EXPORT_SYMBOL_HDA(snd_hda_bind_sw);
1875
1876 /*
1877  * SPDIF out controls
1878  */
1879
1880 static int snd_hda_spdif_mask_info(struct snd_kcontrol *kcontrol,
1881                                    struct snd_ctl_elem_info *uinfo)
1882 {
1883         uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
1884         uinfo->count = 1;
1885         return 0;
1886 }
1887
1888 static int snd_hda_spdif_cmask_get(struct snd_kcontrol *kcontrol,
1889                                    struct snd_ctl_elem_value *ucontrol)
1890 {
1891         ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
1892                                            IEC958_AES0_NONAUDIO |
1893                                            IEC958_AES0_CON_EMPHASIS_5015 |
1894                                            IEC958_AES0_CON_NOT_COPYRIGHT;
1895         ucontrol->value.iec958.status[1] = IEC958_AES1_CON_CATEGORY |
1896                                            IEC958_AES1_CON_ORIGINAL;
1897         return 0;
1898 }
1899
1900 static int snd_hda_spdif_pmask_get(struct snd_kcontrol *kcontrol,
1901                                    struct snd_ctl_elem_value *ucontrol)
1902 {
1903         ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
1904                                            IEC958_AES0_NONAUDIO |
1905                                            IEC958_AES0_PRO_EMPHASIS_5015;
1906         return 0;
1907 }
1908
1909 static int snd_hda_spdif_default_get(struct snd_kcontrol *kcontrol,
1910                                      struct snd_ctl_elem_value *ucontrol)
1911 {
1912         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1913
1914         ucontrol->value.iec958.status[0] = codec->spdif_status & 0xff;
1915         ucontrol->value.iec958.status[1] = (codec->spdif_status >> 8) & 0xff;
1916         ucontrol->value.iec958.status[2] = (codec->spdif_status >> 16) & 0xff;
1917         ucontrol->value.iec958.status[3] = (codec->spdif_status >> 24) & 0xff;
1918
1919         return 0;
1920 }
1921
1922 /* convert from SPDIF status bits to HDA SPDIF bits
1923  * bit 0 (DigEn) is always set zero (to be filled later)
1924  */
1925 static unsigned short convert_from_spdif_status(unsigned int sbits)
1926 {
1927         unsigned short val = 0;
1928
1929         if (sbits & IEC958_AES0_PROFESSIONAL)
1930                 val |= AC_DIG1_PROFESSIONAL;
1931         if (sbits & IEC958_AES0_NONAUDIO)
1932                 val |= AC_DIG1_NONAUDIO;
1933         if (sbits & IEC958_AES0_PROFESSIONAL) {
1934                 if ((sbits & IEC958_AES0_PRO_EMPHASIS) ==
1935                     IEC958_AES0_PRO_EMPHASIS_5015)
1936                         val |= AC_DIG1_EMPHASIS;
1937         } else {
1938                 if ((sbits & IEC958_AES0_CON_EMPHASIS) ==
1939                     IEC958_AES0_CON_EMPHASIS_5015)
1940                         val |= AC_DIG1_EMPHASIS;
1941                 if (!(sbits & IEC958_AES0_CON_NOT_COPYRIGHT))
1942                         val |= AC_DIG1_COPYRIGHT;
1943                 if (sbits & (IEC958_AES1_CON_ORIGINAL << 8))
1944                         val |= AC_DIG1_LEVEL;
1945                 val |= sbits & (IEC958_AES1_CON_CATEGORY << 8);
1946         }
1947         return val;
1948 }
1949
1950 /* convert to SPDIF status bits from HDA SPDIF bits
1951  */
1952 static unsigned int convert_to_spdif_status(unsigned short val)
1953 {
1954         unsigned int sbits = 0;
1955
1956         if (val & AC_DIG1_NONAUDIO)
1957                 sbits |= IEC958_AES0_NONAUDIO;
1958         if (val & AC_DIG1_PROFESSIONAL)
1959                 sbits |= IEC958_AES0_PROFESSIONAL;
1960         if (sbits & IEC958_AES0_PROFESSIONAL) {
1961                 if (sbits & AC_DIG1_EMPHASIS)
1962                         sbits |= IEC958_AES0_PRO_EMPHASIS_5015;
1963         } else {
1964                 if (val & AC_DIG1_EMPHASIS)
1965                         sbits |= IEC958_AES0_CON_EMPHASIS_5015;
1966                 if (!(val & AC_DIG1_COPYRIGHT))
1967                         sbits |= IEC958_AES0_CON_NOT_COPYRIGHT;
1968                 if (val & AC_DIG1_LEVEL)
1969                         sbits |= (IEC958_AES1_CON_ORIGINAL << 8);
1970                 sbits |= val & (0x7f << 8);
1971         }
1972         return sbits;
1973 }
1974
1975 /* set digital convert verbs both for the given NID and its slaves */
1976 static void set_dig_out(struct hda_codec *codec, hda_nid_t nid,
1977                         int verb, int val)
1978 {
1979         hda_nid_t *d;
1980
1981         snd_hda_codec_write_cache(codec, nid, 0, verb, val);
1982         d = codec->slave_dig_outs;
1983         if (!d)
1984                 return;
1985         for (; *d; d++)
1986                 snd_hda_codec_write_cache(codec, *d, 0, verb, val);
1987 }
1988
1989 static inline void set_dig_out_convert(struct hda_codec *codec, hda_nid_t nid,
1990                                        int dig1, int dig2)
1991 {
1992         if (dig1 != -1)
1993                 set_dig_out(codec, nid, AC_VERB_SET_DIGI_CONVERT_1, dig1);
1994         if (dig2 != -1)
1995                 set_dig_out(codec, nid, AC_VERB_SET_DIGI_CONVERT_2, dig2);
1996 }
1997
1998 static int snd_hda_spdif_default_put(struct snd_kcontrol *kcontrol,
1999                                      struct snd_ctl_elem_value *ucontrol)
2000 {
2001         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2002         hda_nid_t nid = kcontrol->private_value;
2003         unsigned short val;
2004         int change;
2005
2006         mutex_lock(&codec->spdif_mutex);
2007         codec->spdif_status = ucontrol->value.iec958.status[0] |
2008                 ((unsigned int)ucontrol->value.iec958.status[1] << 8) |
2009                 ((unsigned int)ucontrol->value.iec958.status[2] << 16) |
2010                 ((unsigned int)ucontrol->value.iec958.status[3] << 24);
2011         val = convert_from_spdif_status(codec->spdif_status);
2012         val |= codec->spdif_ctls & 1;
2013         change = codec->spdif_ctls != val;
2014         codec->spdif_ctls = val;
2015
2016         if (change)
2017                 set_dig_out_convert(codec, nid, val & 0xff, (val >> 8) & 0xff);
2018
2019         mutex_unlock(&codec->spdif_mutex);
2020         return change;
2021 }
2022
2023 #define snd_hda_spdif_out_switch_info   snd_ctl_boolean_mono_info
2024
2025 static int snd_hda_spdif_out_switch_get(struct snd_kcontrol *kcontrol,
2026                                         struct snd_ctl_elem_value *ucontrol)
2027 {
2028         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2029
2030         ucontrol->value.integer.value[0] = codec->spdif_ctls & AC_DIG1_ENABLE;
2031         return 0;
2032 }
2033
2034 static int snd_hda_spdif_out_switch_put(struct snd_kcontrol *kcontrol,
2035                                         struct snd_ctl_elem_value *ucontrol)
2036 {
2037         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2038         hda_nid_t nid = kcontrol->private_value;
2039         unsigned short val;
2040         int change;
2041
2042         mutex_lock(&codec->spdif_mutex);
2043         val = codec->spdif_ctls & ~AC_DIG1_ENABLE;
2044         if (ucontrol->value.integer.value[0])
2045                 val |= AC_DIG1_ENABLE;
2046         change = codec->spdif_ctls != val;
2047         if (change) {
2048                 codec->spdif_ctls = val;
2049                 set_dig_out_convert(codec, nid, val & 0xff, -1);
2050                 /* unmute amp switch (if any) */
2051                 if ((get_wcaps(codec, nid) & AC_WCAP_OUT_AMP) &&
2052                     (val & AC_DIG1_ENABLE))
2053                         snd_hda_codec_amp_stereo(codec, nid, HDA_OUTPUT, 0,
2054                                                  HDA_AMP_MUTE, 0);
2055         }
2056         mutex_unlock(&codec->spdif_mutex);
2057         return change;
2058 }
2059
2060 static struct snd_kcontrol_new dig_mixes[] = {
2061         {
2062                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
2063                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2064                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,CON_MASK),
2065                 .info = snd_hda_spdif_mask_info,
2066                 .get = snd_hda_spdif_cmask_get,
2067         },
2068         {
2069                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
2070                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2071                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,PRO_MASK),
2072                 .info = snd_hda_spdif_mask_info,
2073                 .get = snd_hda_spdif_pmask_get,
2074         },
2075         {
2076                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2077                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,DEFAULT),
2078                 .info = snd_hda_spdif_mask_info,
2079                 .get = snd_hda_spdif_default_get,
2080                 .put = snd_hda_spdif_default_put,
2081         },
2082         {
2083                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2084                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,SWITCH),
2085                 .info = snd_hda_spdif_out_switch_info,
2086                 .get = snd_hda_spdif_out_switch_get,
2087                 .put = snd_hda_spdif_out_switch_put,
2088         },
2089         { } /* end */
2090 };
2091
2092 #define SPDIF_MAX_IDX   4       /* 4 instances should be enough to probe */
2093
2094 /**
2095  * snd_hda_create_spdif_out_ctls - create Output SPDIF-related controls
2096  * @codec: the HDA codec
2097  * @nid: audio out widget NID
2098  *
2099  * Creates controls related with the SPDIF output.
2100  * Called from each patch supporting the SPDIF out.
2101  *
2102  * Returns 0 if successful, or a negative error code.
2103  */
2104 int snd_hda_create_spdif_out_ctls(struct hda_codec *codec, hda_nid_t nid)
2105 {
2106         int err;
2107         struct snd_kcontrol *kctl;
2108         struct snd_kcontrol_new *dig_mix;
2109         int idx;
2110
2111         for (idx = 0; idx < SPDIF_MAX_IDX; idx++) {
2112                 if (!_snd_hda_find_mixer_ctl(codec, "IEC958 Playback Switch",
2113                                              idx))
2114                         break;
2115         }
2116         if (idx >= SPDIF_MAX_IDX) {
2117                 printk(KERN_ERR "hda_codec: too many IEC958 outputs\n");
2118                 return -EBUSY;
2119         }
2120         for (dig_mix = dig_mixes; dig_mix->name; dig_mix++) {
2121                 kctl = snd_ctl_new1(dig_mix, codec);
2122                 if (!kctl)
2123                         return -ENOMEM;
2124                 kctl->id.index = idx;
2125                 kctl->private_value = nid;
2126                 err = snd_hda_ctl_add(codec, kctl);
2127                 if (err < 0)
2128                         return err;
2129         }
2130         codec->spdif_ctls =
2131                 snd_hda_codec_read(codec, nid, 0,
2132                                    AC_VERB_GET_DIGI_CONVERT_1, 0);
2133         codec->spdif_status = convert_to_spdif_status(codec->spdif_ctls);
2134         return 0;
2135 }
2136 EXPORT_SYMBOL_HDA(snd_hda_create_spdif_out_ctls);
2137
2138 /*
2139  * SPDIF sharing with analog output
2140  */
2141 static int spdif_share_sw_get(struct snd_kcontrol *kcontrol,
2142                               struct snd_ctl_elem_value *ucontrol)
2143 {
2144         struct hda_multi_out *mout = snd_kcontrol_chip(kcontrol);
2145         ucontrol->value.integer.value[0] = mout->share_spdif;
2146         return 0;
2147 }
2148
2149 static int spdif_share_sw_put(struct snd_kcontrol *kcontrol,
2150                               struct snd_ctl_elem_value *ucontrol)
2151 {
2152         struct hda_multi_out *mout = snd_kcontrol_chip(kcontrol);
2153         mout->share_spdif = !!ucontrol->value.integer.value[0];
2154         return 0;
2155 }
2156
2157 static struct snd_kcontrol_new spdif_share_sw = {
2158         .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2159         .name = "IEC958 Default PCM Playback Switch",
2160         .info = snd_ctl_boolean_mono_info,
2161         .get = spdif_share_sw_get,
2162         .put = spdif_share_sw_put,
2163 };
2164
2165 int snd_hda_create_spdif_share_sw(struct hda_codec *codec,
2166                                   struct hda_multi_out *mout)
2167 {
2168         if (!mout->dig_out_nid)
2169                 return 0;
2170         /* ATTENTION: here mout is passed as private_data, instead of codec */
2171         return snd_hda_ctl_add(codec,
2172                            snd_ctl_new1(&spdif_share_sw, mout));
2173 }
2174 EXPORT_SYMBOL_HDA(snd_hda_create_spdif_share_sw);
2175
2176 /*
2177  * SPDIF input
2178  */
2179
2180 #define snd_hda_spdif_in_switch_info    snd_hda_spdif_out_switch_info
2181
2182 static int snd_hda_spdif_in_switch_get(struct snd_kcontrol *kcontrol,
2183                                        struct snd_ctl_elem_value *ucontrol)
2184 {
2185         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2186
2187         ucontrol->value.integer.value[0] = codec->spdif_in_enable;
2188         return 0;
2189 }
2190
2191 static int snd_hda_spdif_in_switch_put(struct snd_kcontrol *kcontrol,
2192                                        struct snd_ctl_elem_value *ucontrol)
2193 {
2194         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2195         hda_nid_t nid = kcontrol->private_value;
2196         unsigned int val = !!ucontrol->value.integer.value[0];
2197         int change;
2198
2199         mutex_lock(&codec->spdif_mutex);
2200         change = codec->spdif_in_enable != val;
2201         if (change) {
2202                 codec->spdif_in_enable = val;
2203                 snd_hda_codec_write_cache(codec, nid, 0,
2204                                           AC_VERB_SET_DIGI_CONVERT_1, val);
2205         }
2206         mutex_unlock(&codec->spdif_mutex);
2207         return change;
2208 }
2209
2210 static int snd_hda_spdif_in_status_get(struct snd_kcontrol *kcontrol,
2211                                        struct snd_ctl_elem_value *ucontrol)
2212 {
2213         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
2214         hda_nid_t nid = kcontrol->private_value;
2215         unsigned short val;
2216         unsigned int sbits;
2217
2218         val = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DIGI_CONVERT_1, 0);
2219         sbits = convert_to_spdif_status(val);
2220         ucontrol->value.iec958.status[0] = sbits;
2221         ucontrol->value.iec958.status[1] = sbits >> 8;
2222         ucontrol->value.iec958.status[2] = sbits >> 16;
2223         ucontrol->value.iec958.status[3] = sbits >> 24;
2224         return 0;
2225 }
2226
2227 static struct snd_kcontrol_new dig_in_ctls[] = {
2228         {
2229                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2230                 .name = SNDRV_CTL_NAME_IEC958("",CAPTURE,SWITCH),
2231                 .info = snd_hda_spdif_in_switch_info,
2232                 .get = snd_hda_spdif_in_switch_get,
2233                 .put = snd_hda_spdif_in_switch_put,
2234         },
2235         {
2236                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
2237                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2238                 .name = SNDRV_CTL_NAME_IEC958("",CAPTURE,DEFAULT),
2239                 .info = snd_hda_spdif_mask_info,
2240                 .get = snd_hda_spdif_in_status_get,
2241         },
2242         { } /* end */
2243 };
2244
2245 /**
2246  * snd_hda_create_spdif_in_ctls - create Input SPDIF-related controls
2247  * @codec: the HDA codec
2248  * @nid: audio in widget NID
2249  *
2250  * Creates controls related with the SPDIF input.
2251  * Called from each patch supporting the SPDIF in.
2252  *
2253  * Returns 0 if successful, or a negative error code.
2254  */
2255 int snd_hda_create_spdif_in_ctls(struct hda_codec *codec, hda_nid_t nid)
2256 {
2257         int err;
2258         struct snd_kcontrol *kctl;
2259         struct snd_kcontrol_new *dig_mix;
2260         int idx;
2261
2262         for (idx = 0; idx < SPDIF_MAX_IDX; idx++) {
2263                 if (!_snd_hda_find_mixer_ctl(codec, "IEC958 Capture Switch",
2264                                              idx))
2265                         break;
2266         }
2267         if (idx >= SPDIF_MAX_IDX) {
2268                 printk(KERN_ERR "hda_codec: too many IEC958 inputs\n");
2269                 return -EBUSY;
2270         }
2271         for (dig_mix = dig_in_ctls; dig_mix->name; dig_mix++) {
2272                 kctl = snd_ctl_new1(dig_mix, codec);
2273                 if (!kctl)
2274                         return -ENOMEM;
2275                 kctl->private_value = nid;
2276                 err = snd_hda_ctl_add(codec, kctl);
2277                 if (err < 0)
2278                         return err;
2279         }
2280         codec->spdif_in_enable =
2281                 snd_hda_codec_read(codec, nid, 0,
2282                                    AC_VERB_GET_DIGI_CONVERT_1, 0) &
2283                 AC_DIG1_ENABLE;
2284         return 0;
2285 }
2286 EXPORT_SYMBOL_HDA(snd_hda_create_spdif_in_ctls);
2287
2288 #ifdef SND_HDA_NEEDS_RESUME
2289 /*
2290  * command cache
2291  */
2292
2293 /* build a 32bit cache key with the widget id and the command parameter */
2294 #define build_cmd_cache_key(nid, verb)  ((verb << 8) | nid)
2295 #define get_cmd_cache_nid(key)          ((key) & 0xff)
2296 #define get_cmd_cache_cmd(key)          (((key) >> 8) & 0xffff)
2297
2298 /**
2299  * snd_hda_codec_write_cache - send a single command with caching
2300  * @codec: the HDA codec
2301  * @nid: NID to send the command
2302  * @direct: direct flag
2303  * @verb: the verb to send
2304  * @parm: the parameter for the verb
2305  *
2306  * Send a single command without waiting for response.
2307  *
2308  * Returns 0 if successful, or a negative error code.
2309  */
2310 int snd_hda_codec_write_cache(struct hda_codec *codec, hda_nid_t nid,
2311                               int direct, unsigned int verb, unsigned int parm)
2312 {
2313         int err = snd_hda_codec_write(codec, nid, direct, verb, parm);
2314         struct hda_cache_head *c;
2315         u32 key;
2316
2317         if (err < 0)
2318                 return err;
2319         /* parm may contain the verb stuff for get/set amp */
2320         verb = verb | (parm >> 8);
2321         parm &= 0xff;
2322         key = build_cmd_cache_key(nid, verb);
2323         mutex_lock(&codec->bus->cmd_mutex);
2324         c = get_alloc_hash(&codec->cmd_cache, key);
2325         if (c)
2326                 c->val = parm;
2327         mutex_unlock(&codec->bus->cmd_mutex);
2328         return 0;
2329 }
2330 EXPORT_SYMBOL_HDA(snd_hda_codec_write_cache);
2331
2332 /* resume the all commands from the cache */
2333 void snd_hda_codec_resume_cache(struct hda_codec *codec)
2334 {
2335         struct hda_cache_head *buffer = codec->cmd_cache.buf.list;
2336         int i;
2337
2338         for (i = 0; i < codec->cmd_cache.buf.used; i++, buffer++) {
2339                 u32 key = buffer->key;
2340                 if (!key)
2341                         continue;
2342                 snd_hda_codec_write(codec, get_cmd_cache_nid(key), 0,
2343                                     get_cmd_cache_cmd(key), buffer->val);
2344         }
2345 }
2346 EXPORT_SYMBOL_HDA(snd_hda_codec_resume_cache);
2347
2348 /**
2349  * snd_hda_sequence_write_cache - sequence writes with caching
2350  * @codec: the HDA codec
2351  * @seq: VERB array to send
2352  *
2353  * Send the commands sequentially from the given array.
2354  * Thte commands are recorded on cache for power-save and resume.
2355  * The array must be terminated with NID=0.
2356  */
2357 void snd_hda_sequence_write_cache(struct hda_codec *codec,
2358                                   const struct hda_verb *seq)
2359 {
2360         for (; seq->nid; seq++)
2361                 snd_hda_codec_write_cache(codec, seq->nid, 0, seq->verb,
2362                                           seq->param);
2363 }
2364 EXPORT_SYMBOL_HDA(snd_hda_sequence_write_cache);
2365 #endif /* SND_HDA_NEEDS_RESUME */
2366
2367 /*
2368  * set power state of the codec
2369  */
2370 static void hda_set_power_state(struct hda_codec *codec, hda_nid_t fg,
2371                                 unsigned int power_state)
2372 {
2373         hda_nid_t nid;
2374         int i;
2375
2376         /* this delay seems necessary to avoid click noise at power-down */
2377         if (power_state == AC_PWRST_D3)
2378                 msleep(100);
2379         snd_hda_codec_read(codec, fg, 0, AC_VERB_SET_POWER_STATE,
2380                             power_state);
2381         /* partial workaround for "azx_get_response timeout" */
2382         if (power_state == AC_PWRST_D0)
2383                 msleep(10);
2384
2385         nid = codec->start_nid;
2386         for (i = 0; i < codec->num_nodes; i++, nid++) {
2387                 unsigned int wcaps = get_wcaps(codec, nid);
2388                 if (wcaps & AC_WCAP_POWER) {
2389                         unsigned int wid_type = (wcaps & AC_WCAP_TYPE) >>
2390                                 AC_WCAP_TYPE_SHIFT;
2391                         if (power_state == AC_PWRST_D3 &&
2392                             wid_type == AC_WID_PIN) {
2393                                 unsigned int pincap;
2394                                 /*
2395                                  * don't power down the widget if it controls
2396                                  * eapd and EAPD_BTLENABLE is set.
2397                                  */
2398                                 pincap = snd_hda_query_pin_caps(codec, nid);
2399                                 if (pincap & AC_PINCAP_EAPD) {
2400                                         int eapd = snd_hda_codec_read(codec,
2401                                                 nid, 0,
2402                                                 AC_VERB_GET_EAPD_BTLENABLE, 0);
2403                                         eapd &= 0x02;
2404                                         if (eapd)
2405                                                 continue;
2406                                 }
2407                         }
2408                         snd_hda_codec_write(codec, nid, 0,
2409                                             AC_VERB_SET_POWER_STATE,
2410                                             power_state);
2411                 }
2412         }
2413
2414         if (power_state == AC_PWRST_D0) {
2415                 unsigned long end_time;
2416                 int state;
2417                 msleep(10);
2418                 /* wait until the codec reachs to D0 */
2419                 end_time = jiffies + msecs_to_jiffies(500);
2420                 do {
2421                         state = snd_hda_codec_read(codec, fg, 0,
2422                                                    AC_VERB_GET_POWER_STATE, 0);
2423                         if (state == power_state)
2424                                 break;
2425                         msleep(1);
2426                 } while (time_after_eq(end_time, jiffies));
2427         }
2428 }
2429
2430 #ifdef CONFIG_SND_HDA_HWDEP
2431 /* execute additional init verbs */
2432 static void hda_exec_init_verbs(struct hda_codec *codec)
2433 {
2434         if (codec->init_verbs.list)
2435                 snd_hda_sequence_write(codec, codec->init_verbs.list);
2436 }
2437 #else
2438 static inline void hda_exec_init_verbs(struct hda_codec *codec) {}
2439 #endif
2440
2441 #ifdef SND_HDA_NEEDS_RESUME
2442 /*
2443  * call suspend and power-down; used both from PM and power-save
2444  */
2445 static void hda_call_codec_suspend(struct hda_codec *codec)
2446 {
2447         if (codec->patch_ops.suspend)
2448                 codec->patch_ops.suspend(codec, PMSG_SUSPEND);
2449         hda_set_power_state(codec,
2450                             codec->afg ? codec->afg : codec->mfg,
2451                             AC_PWRST_D3);
2452 #ifdef CONFIG_SND_HDA_POWER_SAVE
2453         cancel_delayed_work(&codec->power_work);
2454         codec->power_on = 0;
2455         codec->power_transition = 0;
2456 #endif
2457 }
2458
2459 /*
2460  * kick up codec; used both from PM and power-save
2461  */
2462 static void hda_call_codec_resume(struct hda_codec *codec)
2463 {
2464         hda_set_power_state(codec,
2465                             codec->afg ? codec->afg : codec->mfg,
2466                             AC_PWRST_D0);
2467         restore_pincfgs(codec); /* restore all current pin configs */
2468         hda_exec_init_verbs(codec);
2469         if (codec->patch_ops.resume)
2470                 codec->patch_ops.resume(codec);
2471         else {
2472                 if (codec->patch_ops.init)
2473                         codec->patch_ops.init(codec);
2474                 snd_hda_codec_resume_amp(codec);
2475                 snd_hda_codec_resume_cache(codec);
2476         }
2477 }
2478 #endif /* SND_HDA_NEEDS_RESUME */
2479
2480
2481 /**
2482  * snd_hda_build_controls - build mixer controls
2483  * @bus: the BUS
2484  *
2485  * Creates mixer controls for each codec included in the bus.
2486  *
2487  * Returns 0 if successful, otherwise a negative error code.
2488  */
2489 int /*__devinit*/ snd_hda_build_controls(struct hda_bus *bus)
2490 {
2491         struct hda_codec *codec;
2492
2493         list_for_each_entry(codec, &bus->codec_list, list) {
2494                 int err = snd_hda_codec_build_controls(codec);
2495                 if (err < 0) {
2496                         printk(KERN_ERR "hda_codec: cannot build controls"
2497                                "for #%d (error %d)\n", codec->addr, err); 
2498                         err = snd_hda_codec_reset(codec);
2499                         if (err < 0) {
2500                                 printk(KERN_ERR
2501                                        "hda_codec: cannot revert codec\n");
2502                                 return err;
2503                         }
2504                 }
2505         }
2506         return 0;
2507 }
2508 EXPORT_SYMBOL_HDA(snd_hda_build_controls);
2509
2510 int snd_hda_codec_build_controls(struct hda_codec *codec)
2511 {
2512         int err = 0;
2513         hda_exec_init_verbs(codec);
2514         /* continue to initialize... */
2515         if (codec->patch_ops.init)
2516                 err = codec->patch_ops.init(codec);
2517         if (!err && codec->patch_ops.build_controls)
2518                 err = codec->patch_ops.build_controls(codec);
2519         if (err < 0)
2520                 return err;
2521         return 0;
2522 }
2523
2524 /*
2525  * stream formats
2526  */
2527 struct hda_rate_tbl {
2528         unsigned int hz;
2529         unsigned int alsa_bits;
2530         unsigned int hda_fmt;
2531 };
2532
2533 static struct hda_rate_tbl rate_bits[] = {
2534         /* rate in Hz, ALSA rate bitmask, HDA format value */
2535
2536         /* autodetected value used in snd_hda_query_supported_pcm */
2537         { 8000, SNDRV_PCM_RATE_8000, 0x0500 }, /* 1/6 x 48 */
2538         { 11025, SNDRV_PCM_RATE_11025, 0x4300 }, /* 1/4 x 44 */
2539         { 16000, SNDRV_PCM_RATE_16000, 0x0200 }, /* 1/3 x 48 */
2540         { 22050, SNDRV_PCM_RATE_22050, 0x4100 }, /* 1/2 x 44 */
2541         { 32000, SNDRV_PCM_RATE_32000, 0x0a00 }, /* 2/3 x 48 */
2542         { 44100, SNDRV_PCM_RATE_44100, 0x4000 }, /* 44 */
2543         { 48000, SNDRV_PCM_RATE_48000, 0x0000 }, /* 48 */
2544         { 88200, SNDRV_PCM_RATE_88200, 0x4800 }, /* 2 x 44 */
2545         { 96000, SNDRV_PCM_RATE_96000, 0x0800 }, /* 2 x 48 */
2546         { 176400, SNDRV_PCM_RATE_176400, 0x5800 },/* 4 x 44 */
2547         { 192000, SNDRV_PCM_RATE_192000, 0x1800 }, /* 4 x 48 */
2548 #define AC_PAR_PCM_RATE_BITS    11
2549         /* up to bits 10, 384kHZ isn't supported properly */
2550
2551         /* not autodetected value */
2552         { 9600, SNDRV_PCM_RATE_KNOT, 0x0400 }, /* 1/5 x 48 */
2553
2554         { 0 } /* terminator */
2555 };
2556
2557 /**
2558  * snd_hda_calc_stream_format - calculate format bitset
2559  * @rate: the sample rate
2560  * @channels: the number of channels
2561  * @format: the PCM format (SNDRV_PCM_FORMAT_XXX)
2562  * @maxbps: the max. bps
2563  *
2564  * Calculate the format bitset from the given rate, channels and th PCM format.
2565  *
2566  * Return zero if invalid.
2567  */
2568 unsigned int snd_hda_calc_stream_format(unsigned int rate,
2569                                         unsigned int channels,
2570                                         unsigned int format,
2571                                         unsigned int maxbps)
2572 {
2573         int i;
2574         unsigned int val = 0;
2575
2576         for (i = 0; rate_bits[i].hz; i++)
2577                 if (rate_bits[i].hz == rate) {
2578                         val = rate_bits[i].hda_fmt;
2579                         break;
2580                 }
2581         if (!rate_bits[i].hz) {
2582                 snd_printdd("invalid rate %d\n", rate);
2583                 return 0;
2584         }
2585
2586         if (channels == 0 || channels > 8) {
2587                 snd_printdd("invalid channels %d\n", channels);
2588                 return 0;
2589         }
2590         val |= channels - 1;
2591
2592         switch (snd_pcm_format_width(format)) {
2593         case 8:  val |= 0x00; break;
2594         case 16: val |= 0x10; break;
2595         case 20:
2596         case 24:
2597         case 32:
2598                 if (maxbps >= 32 || format == SNDRV_PCM_FORMAT_FLOAT_LE)
2599                         val |= 0x40;
2600                 else if (maxbps >= 24)
2601                         val |= 0x30;
2602                 else
2603                         val |= 0x20;
2604                 break;
2605         default:
2606                 snd_printdd("invalid format width %d\n",
2607                             snd_pcm_format_width(format));
2608                 return 0;
2609         }
2610
2611         return val;
2612 }
2613 EXPORT_SYMBOL_HDA(snd_hda_calc_stream_format);
2614
2615 static unsigned int get_pcm_param(struct hda_codec *codec, hda_nid_t nid)
2616 {
2617         unsigned int val = 0;
2618         if (nid != codec->afg &&
2619             (get_wcaps(codec, nid) & AC_WCAP_FORMAT_OVRD))
2620                 val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
2621         if (!val || val == -1)
2622                 val = snd_hda_param_read(codec, codec->afg, AC_PAR_PCM);
2623         if (!val || val == -1)
2624                 return 0;
2625         return val;
2626 }
2627
2628 static unsigned int query_pcm_param(struct hda_codec *codec, hda_nid_t nid)
2629 {
2630         return query_caps_hash(codec, nid, HDA_HASH_PARPCM_KEY(nid),
2631                                get_pcm_param);
2632 }
2633
2634 static unsigned int get_stream_param(struct hda_codec *codec, hda_nid_t nid)
2635 {
2636         unsigned int streams = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
2637         if (!streams || streams == -1)
2638                 streams = snd_hda_param_read(codec, codec->afg, AC_PAR_STREAM);
2639         if (!streams || streams == -1)
2640                 return 0;
2641         return streams;
2642 }
2643
2644 static unsigned int query_stream_param(struct hda_codec *codec, hda_nid_t nid)
2645 {
2646         return query_caps_hash(codec, nid, HDA_HASH_PARSTR_KEY(nid),
2647                                get_stream_param);
2648 }
2649
2650 /**
2651  * snd_hda_query_supported_pcm - query the supported PCM rates and formats
2652  * @codec: the HDA codec
2653  * @nid: NID to query
2654  * @ratesp: the pointer to store the detected rate bitflags
2655  * @formatsp: the pointer to store the detected formats
2656  * @bpsp: the pointer to store the detected format widths
2657  *
2658  * Queries the supported PCM rates and formats.  The NULL @ratesp, @formatsp
2659  * or @bsps argument is ignored.
2660  *
2661  * Returns 0 if successful, otherwise a negative error code.
2662  */
2663 static int snd_hda_query_supported_pcm(struct hda_codec *codec, hda_nid_t nid,
2664                                 u32 *ratesp, u64 *formatsp, unsigned int *bpsp)
2665 {
2666         unsigned int i, val, wcaps;
2667
2668         wcaps = get_wcaps(codec, nid);
2669         val = query_pcm_param(codec, nid);
2670
2671         if (ratesp) {
2672                 u32 rates = 0;
2673                 for (i = 0; i < AC_PAR_PCM_RATE_BITS; i++) {
2674                         if (val & (1 << i))
2675                                 rates |= rate_bits[i].alsa_bits;
2676                 }
2677                 if (rates == 0) {
2678                         snd_printk(KERN_ERR "hda_codec: rates == 0 "
2679                                    "(nid=0x%x, val=0x%x, ovrd=%i)\n",
2680                                         nid, val,
2681                                         (wcaps & AC_WCAP_FORMAT_OVRD) ? 1 : 0);
2682                         return -EIO;
2683                 }
2684                 *ratesp = rates;
2685         }
2686
2687         if (formatsp || bpsp) {
2688                 u64 formats = 0;
2689                 unsigned int streams, bps;
2690
2691                 streams = query_stream_param(codec, nid);
2692                 if (!streams)
2693                         return -EIO;
2694
2695                 bps = 0;
2696                 if (streams & AC_SUPFMT_PCM) {
2697                         if (val & AC_SUPPCM_BITS_8) {
2698                                 formats |= SNDRV_PCM_FMTBIT_U8;
2699                                 bps = 8;
2700                         }
2701                         if (val & AC_SUPPCM_BITS_16) {
2702                                 formats |= SNDRV_PCM_FMTBIT_S16_LE;
2703                                 bps = 16;
2704                         }
2705                         if (wcaps & AC_WCAP_DIGITAL) {
2706                                 if (val & AC_SUPPCM_BITS_32)
2707                                         formats |= SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE;
2708                                 if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24))
2709                                         formats |= SNDRV_PCM_FMTBIT_S32_LE;
2710                                 if (val & AC_SUPPCM_BITS_24)
2711                                         bps = 24;
2712                                 else if (val & AC_SUPPCM_BITS_20)
2713                                         bps = 20;
2714                         } else if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24|
2715                                           AC_SUPPCM_BITS_32)) {
2716                                 formats |= SNDRV_PCM_FMTBIT_S32_LE;
2717                                 if (val & AC_SUPPCM_BITS_32)
2718                                         bps = 32;
2719                                 else if (val & AC_SUPPCM_BITS_24)
2720                                         bps = 24;
2721                                 else if (val & AC_SUPPCM_BITS_20)
2722                                         bps = 20;
2723                         }
2724                 }
2725                 if (streams & AC_SUPFMT_FLOAT32) {
2726                         formats |= SNDRV_PCM_FMTBIT_FLOAT_LE;
2727                         if (!bps)
2728                                 bps = 32;
2729                 }
2730                 if (streams == AC_SUPFMT_AC3) {
2731                         /* should be exclusive */
2732                         /* temporary hack: we have still no proper support
2733                          * for the direct AC3 stream...
2734                          */
2735                         formats |= SNDRV_PCM_FMTBIT_U8;
2736                         bps = 8;
2737                 }
2738                 if (formats == 0) {
2739                         snd_printk(KERN_ERR "hda_codec: formats == 0 "
2740                                    "(nid=0x%x, val=0x%x, ovrd=%i, "
2741                                    "streams=0x%x)\n",
2742                                         nid, val,
2743                                         (wcaps & AC_WCAP_FORMAT_OVRD) ? 1 : 0,
2744                                         streams);
2745                         return -EIO;
2746                 }
2747                 if (formatsp)
2748                         *formatsp = formats;
2749                 if (bpsp)
2750                         *bpsp = bps;
2751         }
2752
2753         return 0;
2754 }
2755
2756 /**
2757  * snd_hda_is_supported_format - check whether the given node supports
2758  * the format val
2759  *
2760  * Returns 1 if supported, 0 if not.
2761  */
2762 int snd_hda_is_supported_format(struct hda_codec *codec, hda_nid_t nid,
2763                                 unsigned int format)
2764 {
2765         int i;
2766         unsigned int val = 0, rate, stream;
2767
2768         val = query_pcm_param(codec, nid);
2769         if (!val)
2770                 return 0;
2771
2772         rate = format & 0xff00;
2773         for (i = 0; i < AC_PAR_PCM_RATE_BITS; i++)
2774                 if (rate_bits[i].hda_fmt == rate) {
2775                         if (val & (1 << i))
2776                                 break;
2777                         return 0;
2778                 }
2779         if (i >= AC_PAR_PCM_RATE_BITS)
2780                 return 0;
2781
2782         stream = query_stream_param(codec, nid);
2783         if (!stream)
2784                 return 0;
2785
2786         if (stream & AC_SUPFMT_PCM) {
2787                 switch (format & 0xf0) {
2788                 case 0x00:
2789                         if (!(val & AC_SUPPCM_BITS_8))
2790                                 return 0;
2791                         break;
2792                 case 0x10:
2793                         if (!(val & AC_SUPPCM_BITS_16))
2794                                 return 0;
2795                         break;
2796                 case 0x20:
2797                         if (!(val & AC_SUPPCM_BITS_20))
2798                                 return 0;
2799                         break;
2800                 case 0x30:
2801                         if (!(val & AC_SUPPCM_BITS_24))
2802                                 return 0;
2803                         break;
2804                 case 0x40:
2805                         if (!(val & AC_SUPPCM_BITS_32))
2806                                 return 0;
2807                         break;
2808                 default:
2809                         return 0;
2810                 }
2811         } else {
2812                 /* FIXME: check for float32 and AC3? */
2813         }
2814
2815         return 1;
2816 }
2817 EXPORT_SYMBOL_HDA(snd_hda_is_supported_format);
2818
2819 /*
2820  * PCM stuff
2821  */
2822 static int hda_pcm_default_open_close(struct hda_pcm_stream *hinfo,
2823                                       struct hda_codec *codec,
2824                                       struct snd_pcm_substream *substream)
2825 {
2826         return 0;
2827 }
2828
2829 static int hda_pcm_default_prepare(struct hda_pcm_stream *hinfo,
2830                                    struct hda_codec *codec,
2831                                    unsigned int stream_tag,
2832                                    unsigned int format,
2833                                    struct snd_pcm_substream *substream)
2834 {
2835         snd_hda_codec_setup_stream(codec, hinfo->nid, stream_tag, 0, format);
2836         return 0;
2837 }
2838
2839 static int hda_pcm_default_cleanup(struct hda_pcm_stream *hinfo,
2840                                    struct hda_codec *codec,
2841                                    struct snd_pcm_substream *substream)
2842 {
2843         snd_hda_codec_cleanup_stream(codec, hinfo->nid);
2844         return 0;
2845 }
2846
2847 static int set_pcm_default_values(struct hda_codec *codec,
2848                                   struct hda_pcm_stream *info)
2849 {
2850         int err;
2851
2852         /* query support PCM information from the given NID */
2853         if (info->nid && (!info->rates || !info->formats)) {
2854                 err = snd_hda_query_supported_pcm(codec, info->nid,
2855                                 info->rates ? NULL : &info->rates,
2856                                 info->formats ? NULL : &info->formats,
2857                                 info->maxbps ? NULL : &info->maxbps);
2858                 if (err < 0)
2859                         return err;
2860         }
2861         if (info->ops.open == NULL)
2862                 info->ops.open = hda_pcm_default_open_close;
2863         if (info->ops.close == NULL)
2864                 info->ops.close = hda_pcm_default_open_close;
2865         if (info->ops.prepare == NULL) {
2866                 if (snd_BUG_ON(!info->nid))
2867                         return -EINVAL;
2868                 info->ops.prepare = hda_pcm_default_prepare;
2869         }
2870         if (info->ops.cleanup == NULL) {
2871                 if (snd_BUG_ON(!info->nid))
2872                         return -EINVAL;
2873                 info->ops.cleanup = hda_pcm_default_cleanup;
2874         }
2875         return 0;
2876 }
2877
2878 /*
2879  * get the empty PCM device number to assign
2880  */
2881 static int get_empty_pcm_device(struct hda_bus *bus, int type)
2882 {
2883         static const char *dev_name[HDA_PCM_NTYPES] = {
2884                 "Audio", "SPDIF", "HDMI", "Modem"
2885         };
2886         /* starting device index for each PCM type */
2887         static int dev_idx[HDA_PCM_NTYPES] = {
2888                 [HDA_PCM_TYPE_AUDIO] = 0,
2889                 [HDA_PCM_TYPE_SPDIF] = 1,
2890                 [HDA_PCM_TYPE_HDMI] = 3,
2891                 [HDA_PCM_TYPE_MODEM] = 6
2892         };
2893         /* normal audio device indices; not linear to keep compatibility */
2894         static int audio_idx[4] = { 0, 2, 4, 5 };
2895         int i, dev;
2896
2897         switch (type) {
2898         case HDA_PCM_TYPE_AUDIO:
2899                 for (i = 0; i < ARRAY_SIZE(audio_idx); i++) {
2900                         dev = audio_idx[i];
2901                         if (!test_bit(dev, bus->pcm_dev_bits))
2902                                 goto ok;
2903                 }
2904                 snd_printk(KERN_WARNING "Too many audio devices\n");
2905                 return -EAGAIN;
2906         case HDA_PCM_TYPE_SPDIF:
2907         case HDA_PCM_TYPE_HDMI:
2908         case HDA_PCM_TYPE_MODEM:
2909                 dev = dev_idx[type];
2910                 if (test_bit(dev, bus->pcm_dev_bits)) {
2911                         snd_printk(KERN_WARNING "%s already defined\n",
2912                                    dev_name[type]);
2913                         return -EAGAIN;
2914                 }
2915                 break;
2916         default:
2917                 snd_printk(KERN_WARNING "Invalid PCM type %d\n", type);
2918                 return -EINVAL;
2919         }
2920  ok:
2921         set_bit(dev, bus->pcm_dev_bits);
2922         return dev;
2923 }
2924
2925 /*
2926  * attach a new PCM stream
2927  */
2928 static int snd_hda_attach_pcm(struct hda_codec *codec, struct hda_pcm *pcm)
2929 {
2930         struct hda_bus *bus = codec->bus;
2931         struct hda_pcm_stream *info;
2932         int stream, err;
2933
2934         if (snd_BUG_ON(!pcm->name))
2935                 return -EINVAL;
2936         for (stream = 0; stream < 2; stream++) {
2937                 info = &pcm->stream[stream];
2938                 if (info->substreams) {
2939                         err = set_pcm_default_values(codec, info);
2940                         if (err < 0)
2941                                 return err;
2942                 }
2943         }
2944         return bus->ops.attach_pcm(bus, codec, pcm);
2945 }
2946
2947 /* assign all PCMs of the given codec */
2948 int snd_hda_codec_build_pcms(struct hda_codec *codec)
2949 {
2950         unsigned int pcm;
2951         int err;
2952
2953         if (!codec->num_pcms) {
2954                 if (!codec->patch_ops.build_pcms)
2955                         return 0;
2956                 err = codec->patch_ops.build_pcms(codec);
2957                 if (err < 0) {
2958                         printk(KERN_ERR "hda_codec: cannot build PCMs"
2959                                "for #%d (error %d)\n", codec->addr, err); 
2960                         err = snd_hda_codec_reset(codec);
2961                         if (err < 0) {
2962                                 printk(KERN_ERR
2963                                        "hda_codec: cannot revert codec\n");
2964                                 return err;
2965                         }
2966                 }
2967         }
2968         for (pcm = 0; pcm < codec->num_pcms; pcm++) {
2969                 struct hda_pcm *cpcm = &codec->pcm_info[pcm];
2970                 int dev;
2971
2972                 if (!cpcm->stream[0].substreams && !cpcm->stream[1].substreams)
2973                         continue; /* no substreams assigned */
2974
2975                 if (!cpcm->pcm) {
2976                         dev = get_empty_pcm_device(codec->bus, cpcm->pcm_type);
2977                         if (dev < 0)
2978                                 continue; /* no fatal error */
2979                         cpcm->device = dev;
2980                         err = snd_hda_attach_pcm(codec, cpcm);
2981                         if (err < 0) {
2982                                 printk(KERN_ERR "hda_codec: cannot attach "
2983                                        "PCM stream %d for codec #%d\n",
2984                                        dev, codec->addr);
2985                                 continue; /* no fatal error */
2986                         }
2987                 }
2988         }
2989         return 0;
2990 }
2991
2992 /**
2993  * snd_hda_build_pcms - build PCM information
2994  * @bus: the BUS
2995  *
2996  * Create PCM information for each codec included in the bus.
2997  *
2998  * The build_pcms codec patch is requested to set up codec->num_pcms and
2999  * codec->pcm_info properly.  The array is referred by the top-level driver
3000  * to create its PCM instances.
3001  * The allocated codec->pcm_info should be released in codec->patch_ops.free
3002  * callback.
3003  *
3004  * At least, substreams, channels_min and channels_max must be filled for
3005  * each stream.  substreams = 0 indicates that the stream doesn't exist.
3006  * When rates and/or formats are zero, the supported values are queried
3007  * from the given nid.  The nid is used also by the default ops.prepare
3008  * and ops.cleanup callbacks.
3009  *
3010  * The driver needs to call ops.open in its open callback.  Similarly,
3011  * ops.close is supposed to be called in the close callback.
3012  * ops.prepare should be called in the prepare or hw_params callback
3013  * with the proper parameters for set up.
3014  * ops.cleanup should be called in hw_free for clean up of streams.
3015  *
3016  * This function returns 0 if successfull, or a negative error code.
3017  */
3018 int __devinit snd_hda_build_pcms(struct hda_bus *bus)
3019 {
3020         struct hda_codec *codec;
3021
3022         list_for_each_entry(codec, &bus->codec_list, list) {
3023                 int err = snd_hda_codec_build_pcms(codec);
3024                 if (err < 0)
3025                         return err;
3026         }
3027         return 0;
3028 }
3029 EXPORT_SYMBOL_HDA(snd_hda_build_pcms);
3030
3031 /**
3032  * snd_hda_check_board_config - compare the current codec with the config table
3033  * @codec: the HDA codec
3034  * @num_configs: number of config enums
3035  * @models: array of model name strings
3036  * @tbl: configuration table, terminated by null entries
3037  *
3038  * Compares the modelname or PCI subsystem id of the current codec with the
3039  * given configuration table.  If a matching entry is found, returns its
3040  * config value (supposed to be 0 or positive).
3041  *
3042  * If no entries are matching, the function returns a negative value.
3043  */
3044 int snd_hda_check_board_config(struct hda_codec *codec,
3045                                int num_configs, const char **models,
3046                                const struct snd_pci_quirk *tbl)
3047 {
3048         if (codec->modelname && models) {
3049                 int i;
3050                 for (i = 0; i < num_configs; i++) {
3051                         if (models[i] &&
3052                             !strcmp(codec->modelname, models[i])) {
3053                                 snd_printd(KERN_INFO "hda_codec: model '%s' is "
3054                                            "selected\n", models[i]);
3055                                 return i;
3056                         }
3057                 }
3058         }
3059
3060         if (!codec->bus->pci || !tbl)
3061                 return -1;
3062
3063         tbl = snd_pci_quirk_lookup(codec->bus->pci, tbl);
3064         if (!tbl)
3065                 return -1;
3066         if (tbl->value >= 0 && tbl->value < num_configs) {
3067 #ifdef CONFIG_SND_DEBUG_VERBOSE
3068                 char tmp[10];
3069                 const char *model = NULL;
3070                 if (models)
3071                         model = models[tbl->value];
3072                 if (!model) {
3073                         sprintf(tmp, "#%d", tbl->value);
3074                         model = tmp;
3075                 }
3076                 snd_printdd(KERN_INFO "hda_codec: model '%s' is selected "
3077                             "for config %x:%x (%s)\n",
3078                             model, tbl->subvendor, tbl->subdevice,
3079                             (tbl->name ? tbl->name : "Unknown device"));
3080 #endif
3081                 return tbl->value;
3082         }
3083         return -1;
3084 }
3085 EXPORT_SYMBOL_HDA(snd_hda_check_board_config);
3086
3087 /**
3088  * snd_hda_check_board_codec_sid_config - compare the current codec
3089                                           subsystem ID with the
3090                                           config table
3091
3092            This is important for Gateway notebooks with SB450 HDA Audio
3093            where the vendor ID of the PCI device is:
3094                 ATI Technologies Inc SB450 HDA Audio [1002:437b]
3095            and the vendor/subvendor are found only at the codec.
3096
3097  * @codec: the HDA codec
3098  * @num_configs: number of config enums
3099  * @models: array of model name strings
3100  * @tbl: configuration table, terminated by null entries
3101  *
3102  * Compares the modelname or PCI subsystem id of the current codec with the
3103  * given configuration table.  If a matching entry is found, returns its
3104  * config value (supposed to be 0 or positive).
3105  *
3106  * If no entries are matching, the function returns a negative value.
3107  */
3108 int snd_hda_check_board_codec_sid_config(struct hda_codec *codec,
3109                                int num_configs, const char **models,
3110                                const struct snd_pci_quirk *tbl)
3111 {
3112         const struct snd_pci_quirk *q;
3113
3114         /* Search for codec ID */
3115         for (q = tbl; q->subvendor; q++) {
3116                 unsigned long vendorid = (q->subdevice) | (q->subvendor << 16);
3117
3118                 if (vendorid == codec->subsystem_id)
3119                         break;
3120         }
3121
3122         if (!q->subvendor)
3123                 return -1;
3124
3125         tbl = q;
3126
3127         if (tbl->value >= 0 && tbl->value < num_configs) {
3128 #ifdef CONFIG_SND_DEBUG_DETECT
3129                 char tmp[10];
3130                 const char *model = NULL;
3131                 if (models)
3132                         model = models[tbl->value];
3133                 if (!model) {
3134                         sprintf(tmp, "#%d", tbl->value);
3135                         model = tmp;
3136                 }
3137                 snd_printdd(KERN_INFO "hda_codec: model '%s' is selected "
3138                             "for config %x:%x (%s)\n",
3139                             model, tbl->subvendor, tbl->subdevice,
3140                             (tbl->name ? tbl->name : "Unknown device"));
3141 #endif
3142                 return tbl->value;
3143         }
3144         return -1;
3145 }
3146 EXPORT_SYMBOL_HDA(snd_hda_check_board_codec_sid_config);
3147
3148 /**
3149  * snd_hda_add_new_ctls - create controls from the array
3150  * @codec: the HDA codec
3151  * @knew: the array of struct snd_kcontrol_new
3152  *
3153  * This helper function creates and add new controls in the given array.
3154  * The array must be terminated with an empty entry as terminator.
3155  *
3156  * Returns 0 if successful, or a negative error code.
3157  */
3158 int snd_hda_add_new_ctls(struct hda_codec *codec, struct snd_kcontrol_new *knew)
3159 {
3160         int err;
3161
3162         for (; knew->name; knew++) {
3163                 struct snd_kcontrol *kctl;
3164                 kctl = snd_ctl_new1(knew, codec);
3165                 if (!kctl)
3166                         return -ENOMEM;
3167                 err = snd_hda_ctl_add(codec, kctl);
3168                 if (err < 0) {
3169                         if (!codec->addr)
3170                                 return err;
3171                         kctl = snd_ctl_new1(knew, codec);
3172                         if (!kctl)
3173                                 return -ENOMEM;
3174                         kctl->id.device = codec->addr;
3175                         err = snd_hda_ctl_add(codec, kctl);
3176                         if (err < 0)
3177                                 return err;
3178                 }
3179         }
3180         return 0;
3181 }
3182 EXPORT_SYMBOL_HDA(snd_hda_add_new_ctls);
3183
3184 #ifdef CONFIG_SND_HDA_POWER_SAVE
3185 static void hda_set_power_state(struct hda_codec *codec, hda_nid_t fg,
3186                                 unsigned int power_state);
3187
3188 static void hda_power_work(struct work_struct *work)
3189 {
3190         struct hda_codec *codec =
3191                 container_of(work, struct hda_codec, power_work.work);
3192         struct hda_bus *bus = codec->bus;
3193
3194         if (!codec->power_on || codec->power_count) {
3195                 codec->power_transition = 0;
3196                 return;
3197         }
3198
3199         hda_call_codec_suspend(codec);
3200         if (bus->ops.pm_notify)
3201                 bus->ops.pm_notify(bus);
3202 }
3203
3204 static void hda_keep_power_on(struct hda_codec *codec)
3205 {
3206         codec->power_count++;
3207         codec->power_on = 1;
3208 }
3209
3210 void snd_hda_power_up(struct hda_codec *codec)
3211 {
3212         struct hda_bus *bus = codec->bus;
3213
3214         codec->power_count++;
3215         if (codec->power_on || codec->power_transition)
3216                 return;
3217
3218         codec->power_on = 1;
3219         if (bus->ops.pm_notify)
3220                 bus->ops.pm_notify(bus);
3221         hda_call_codec_resume(codec);
3222         cancel_delayed_work(&codec->power_work);
3223         codec->power_transition = 0;
3224 }
3225 EXPORT_SYMBOL_HDA(snd_hda_power_up);
3226
3227 #define power_save(codec)       \
3228         ((codec)->bus->power_save ? *(codec)->bus->power_save : 0)
3229
3230 #define power_save(codec)       \
3231         ((codec)->bus->power_save ? *(codec)->bus->power_save : 0)
3232
3233 void snd_hda_power_down(struct hda_codec *codec)
3234 {
3235         --codec->power_count;
3236         if (!codec->power_on || codec->power_count || codec->power_transition)
3237                 return;
3238         if (power_save(codec)) {
3239                 codec->power_transition = 1; /* avoid reentrance */
3240                 queue_delayed_work(codec->bus->workq, &codec->power_work,
3241                                 msecs_to_jiffies(power_save(codec) * 1000));
3242         }
3243 }
3244 EXPORT_SYMBOL_HDA(snd_hda_power_down);
3245
3246 int snd_hda_check_amp_list_power(struct hda_codec *codec,
3247                                  struct hda_loopback_check *check,
3248                                  hda_nid_t nid)
3249 {
3250         struct hda_amp_list *p;
3251         int ch, v;
3252
3253         if (!check->amplist)
3254                 return 0;
3255         for (p = check->amplist; p->nid; p++) {
3256                 if (p->nid == nid)
3257                         break;
3258         }
3259         if (!p->nid)
3260                 return 0; /* nothing changed */
3261
3262         for (p = check->amplist; p->nid; p++) {
3263                 for (ch = 0; ch < 2; ch++) {
3264                         v = snd_hda_codec_amp_read(codec, p->nid, ch, p->dir,
3265                                                    p->idx);
3266                         if (!(v & HDA_AMP_MUTE) && v > 0) {
3267                                 if (!check->power_on) {
3268                                         check->power_on = 1;
3269                                         snd_hda_power_up(codec);
3270                                 }
3271                                 return 1;
3272                         }
3273                 }
3274         }
3275         if (check->power_on) {
3276                 check->power_on = 0;
3277                 snd_hda_power_down(codec);
3278         }
3279         return 0;
3280 }
3281 EXPORT_SYMBOL_HDA(snd_hda_check_amp_list_power);
3282 #endif
3283
3284 /*
3285  * Channel mode helper
3286  */
3287 int snd_hda_ch_mode_info(struct hda_codec *codec,
3288                          struct snd_ctl_elem_info *uinfo,
3289                          const struct hda_channel_mode *chmode,
3290                          int num_chmodes)
3291 {
3292         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
3293         uinfo->count = 1;
3294         uinfo->value.enumerated.items = num_chmodes;
3295         if (uinfo->value.enumerated.item >= num_chmodes)
3296                 uinfo->value.enumerated.item = num_chmodes - 1;
3297         sprintf(uinfo->value.enumerated.name, "%dch",
3298                 chmode[uinfo->value.enumerated.item].channels);
3299         return 0;
3300 }
3301 EXPORT_SYMBOL_HDA(snd_hda_ch_mode_info);
3302
3303 int snd_hda_ch_mode_get(struct hda_codec *codec,
3304                         struct snd_ctl_elem_value *ucontrol,
3305                         const struct hda_channel_mode *chmode,
3306                         int num_chmodes,
3307                         int max_channels)
3308 {
3309         int i;
3310
3311         for (i = 0; i < num_chmodes; i++) {
3312                 if (max_channels == chmode[i].channels) {
3313                         ucontrol->value.enumerated.item[0] = i;
3314                         break;
3315                 }
3316         }
3317         return 0;
3318 }
3319 EXPORT_SYMBOL_HDA(snd_hda_ch_mode_get);
3320
3321 int snd_hda_ch_mode_put(struct hda_codec *codec,
3322                         struct snd_ctl_elem_value *ucontrol,
3323                         const struct hda_channel_mode *chmode,
3324                         int num_chmodes,
3325                         int *max_channelsp)
3326 {
3327         unsigned int mode;
3328
3329         mode = ucontrol->value.enumerated.item[0];
3330         if (mode >= num_chmodes)
3331                 return -EINVAL;
3332         if (*max_channelsp == chmode[mode].channels)
3333                 return 0;
3334         /* change the current channel setting */
3335         *max_channelsp = chmode[mode].channels;
3336         if (chmode[mode].sequence)
3337                 snd_hda_sequence_write_cache(codec, chmode[mode].sequence);
3338         return 1;
3339 }
3340 EXPORT_SYMBOL_HDA(snd_hda_ch_mode_put);
3341
3342 /*
3343  * input MUX helper
3344  */
3345 int snd_hda_input_mux_info(const struct hda_input_mux *imux,
3346                            struct snd_ctl_elem_info *uinfo)
3347 {
3348         unsigned int index;
3349
3350         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
3351         uinfo->count = 1;
3352         uinfo->value.enumerated.items = imux->num_items;
3353         if (!imux->num_items)
3354                 return 0;
3355         index = uinfo->value.enumerated.item;
3356         if (index >= imux->num_items)
3357                 index = imux->num_items - 1;
3358         strcpy(uinfo->value.enumerated.name, imux->items[index].label);
3359         return 0;
3360 }
3361 EXPORT_SYMBOL_HDA(snd_hda_input_mux_info);
3362
3363 int snd_hda_input_mux_put(struct hda_codec *codec,
3364                           const struct hda_input_mux *imux,
3365                           struct snd_ctl_elem_value *ucontrol,
3366                           hda_nid_t nid,
3367                           unsigned int *cur_val)
3368 {
3369         unsigned int idx;
3370
3371         if (!imux->num_items)
3372                 return 0;
3373         idx = ucontrol->value.enumerated.item[0];
3374         if (idx >= imux->num_items)
3375                 idx = imux->num_items - 1;
3376         if (*cur_val == idx)
3377                 return 0;
3378         snd_hda_codec_write_cache(codec, nid, 0, AC_VERB_SET_CONNECT_SEL,
3379                                   imux->items[idx].index);
3380         *cur_val = idx;
3381         return 1;
3382 }
3383 EXPORT_SYMBOL_HDA(snd_hda_input_mux_put);
3384
3385
3386 /*
3387  * Multi-channel / digital-out PCM helper functions
3388  */
3389
3390 /* setup SPDIF output stream */
3391 static void setup_dig_out_stream(struct hda_codec *codec, hda_nid_t nid,
3392                                  unsigned int stream_tag, unsigned int format)
3393 {
3394         /* turn off SPDIF once; otherwise the IEC958 bits won't be updated */
3395         if (codec->spdif_status_reset && (codec->spdif_ctls & AC_DIG1_ENABLE))
3396                 set_dig_out_convert(codec, nid, 
3397                                     codec->spdif_ctls & ~AC_DIG1_ENABLE & 0xff,
3398                                     -1);
3399         snd_hda_codec_setup_stream(codec, nid, stream_tag, 0, format);
3400         if (codec->slave_dig_outs) {
3401                 hda_nid_t *d;
3402                 for (d = codec->slave_dig_outs; *d; d++)
3403                         snd_hda_codec_setup_stream(codec, *d, stream_tag, 0,
3404                                                    format);
3405         }
3406         /* turn on again (if needed) */
3407         if (codec->spdif_status_reset && (codec->spdif_ctls & AC_DIG1_ENABLE))
3408                 set_dig_out_convert(codec, nid,
3409                                     codec->spdif_ctls & 0xff, -1);
3410 }
3411
3412 static void cleanup_dig_out_stream(struct hda_codec *codec, hda_nid_t nid)
3413 {
3414         snd_hda_codec_cleanup_stream(codec, nid);
3415         if (codec->slave_dig_outs) {
3416                 hda_nid_t *d;
3417                 for (d = codec->slave_dig_outs; *d; d++)
3418                         snd_hda_codec_cleanup_stream(codec, *d);
3419         }
3420 }
3421
3422 /*
3423  * open the digital out in the exclusive mode
3424  */
3425 int snd_hda_multi_out_dig_open(struct hda_codec *codec,
3426                                struct hda_multi_out *mout)
3427 {
3428         mutex_lock(&codec->spdif_mutex);
3429         if (mout->dig_out_used == HDA_DIG_ANALOG_DUP)
3430                 /* already opened as analog dup; reset it once */
3431                 cleanup_dig_out_stream(codec, mout->dig_out_nid);
3432         mout->dig_out_used = HDA_DIG_EXCLUSIVE;
3433         mutex_unlock(&codec->spdif_mutex);
3434         return 0;
3435 }
3436 EXPORT_SYMBOL_HDA(snd_hda_multi_out_dig_open);
3437
3438 int snd_hda_multi_out_dig_prepare(struct hda_codec *codec,
3439                                   struct hda_multi_out *mout,
3440                                   unsigned int stream_tag,
3441                                   unsigned int format,
3442                                   struct snd_pcm_substream *substream)
3443 {
3444         mutex_lock(&codec->spdif_mutex);
3445         setup_dig_out_stream(codec, mout->dig_out_nid, stream_tag, format);
3446         mutex_unlock(&codec->spdif_mutex);
3447         return 0;
3448 }
3449 EXPORT_SYMBOL_HDA(snd_hda_multi_out_dig_prepare);
3450
3451 int snd_hda_multi_out_dig_cleanup(struct hda_codec *codec,
3452                                   struct hda_multi_out *mout)
3453 {
3454         mutex_lock(&codec->spdif_mutex);
3455         cleanup_dig_out_stream(codec, mout->dig_out_nid);
3456         mutex_unlock(&codec->spdif_mutex);
3457         return 0;
3458 }
3459 EXPORT_SYMBOL_HDA(snd_hda_multi_out_dig_cleanup);
3460
3461 /*
3462  * release the digital out
3463  */
3464 int snd_hda_multi_out_dig_close(struct hda_codec *codec,
3465                                 struct hda_multi_out *mout)
3466 {
3467         mutex_lock(&codec->spdif_mutex);
3468         mout->dig_out_used = 0;
3469         mutex_unlock(&codec->spdif_mutex);
3470         return 0;
3471 }
3472 EXPORT_SYMBOL_HDA(snd_hda_multi_out_dig_close);
3473
3474 /*
3475  * set up more restrictions for analog out
3476  */
3477 int snd_hda_multi_out_analog_open(struct hda_codec *codec,
3478                                   struct hda_multi_out *mout,
3479                                   struct snd_pcm_substream *substream,
3480                                   struct hda_pcm_stream *hinfo)
3481 {
3482         struct snd_pcm_runtime *runtime = substream->runtime;
3483         runtime->hw.channels_max = mout->max_channels;
3484         if (mout->dig_out_nid) {
3485                 if (!mout->analog_rates) {
3486                         mout->analog_rates = hinfo->rates;
3487                         mout->analog_formats = hinfo->formats;
3488                         mout->analog_maxbps = hinfo->maxbps;
3489                 } else {
3490                         runtime->hw.rates = mout->analog_rates;
3491                         runtime->hw.formats = mout->analog_formats;
3492                         hinfo->maxbps = mout->analog_maxbps;
3493                 }
3494                 if (!mout->spdif_rates) {
3495                         snd_hda_query_supported_pcm(codec, mout->dig_out_nid,
3496                                                     &mout->spdif_rates,
3497                                                     &mout->spdif_formats,
3498                                                     &mout->spdif_maxbps);
3499                 }
3500                 mutex_lock(&codec->spdif_mutex);
3501                 if (mout->share_spdif) {
3502                         if ((runtime->hw.rates & mout->spdif_rates) &&
3503                             (runtime->hw.formats & mout->spdif_formats)) {
3504                                 runtime->hw.rates &= mout->spdif_rates;
3505                                 runtime->hw.formats &= mout->spdif_formats;
3506                                 if (mout->spdif_maxbps < hinfo->maxbps)
3507                                         hinfo->maxbps = mout->spdif_maxbps;
3508                         } else {
3509                                 mout->share_spdif = 0;
3510                                 /* FIXME: need notify? */
3511                         }
3512                 }
3513                 mutex_unlock(&codec->spdif_mutex);
3514         }
3515         return snd_pcm_hw_constraint_step(substream->runtime, 0,
3516                                           SNDRV_PCM_HW_PARAM_CHANNELS, 2);
3517 }
3518 EXPORT_SYMBOL_HDA(snd_hda_multi_out_analog_open);
3519
3520 /*
3521  * set up the i/o for analog out
3522  * when the digital out is available, copy the front out to digital out, too.
3523  */
3524 int snd_hda_multi_out_analog_prepare(struct hda_codec *codec,
3525                                      struct hda_multi_out *mout,
3526                                      unsigned int stream_tag,
3527                                      unsigned int format,
3528                                      struct snd_pcm_substream *substream)
3529 {
3530         hda_nid_t *nids = mout->dac_nids;
3531         int chs = substream->runtime->channels;
3532         int i;
3533
3534         mutex_lock(&codec->spdif_mutex);
3535         if (mout->dig_out_nid && mout->share_spdif &&
3536             mout->dig_out_used != HDA_DIG_EXCLUSIVE) {
3537                 if (chs == 2 &&
3538                     snd_hda_is_supported_format(codec, mout->dig_out_nid,
3539                                                 format) &&
3540                     !(codec->spdif_status & IEC958_AES0_NONAUDIO)) {
3541                         mout->dig_out_used = HDA_DIG_ANALOG_DUP;
3542                         setup_dig_out_stream(codec, mout->dig_out_nid,
3543                                              stream_tag, format);
3544                 } else {
3545                         mout->dig_out_used = 0;
3546                         cleanup_dig_out_stream(codec, mout->dig_out_nid);
3547                 }
3548         }
3549         mutex_unlock(&codec->spdif_mutex);
3550
3551         /* front */
3552         snd_hda_codec_setup_stream(codec, nids[HDA_FRONT], stream_tag,
3553                                    0, format);
3554         if (!mout->no_share_stream &&
3555             mout->hp_nid && mout->hp_nid != nids[HDA_FRONT])
3556                 /* headphone out will just decode front left/right (stereo) */
3557                 snd_hda_codec_setup_stream(codec, mout->hp_nid, stream_tag,
3558                                            0, format);
3559         /* extra outputs copied from front */
3560         for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++)
3561                 if (!mout->no_share_stream && mout->extra_out_nid[i])
3562                         snd_hda_codec_setup_stream(codec,
3563                                                    mout->extra_out_nid[i],
3564                                                    stream_tag, 0, format);
3565
3566         /* surrounds */
3567         for (i = 1; i < mout->num_dacs; i++) {
3568                 if (chs >= (i + 1) * 2) /* independent out */
3569                         snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
3570                                                    i * 2, format);
3571                 else if (!mout->no_share_stream) /* copy front */
3572                         snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
3573                                                    0, format);
3574         }
3575         return 0;
3576 }
3577 EXPORT_SYMBOL_HDA(snd_hda_multi_out_analog_prepare);
3578
3579 /*
3580  * clean up the setting for analog out
3581  */
3582 int snd_hda_multi_out_analog_cleanup(struct hda_codec *codec,
3583                                      struct hda_multi_out *mout)
3584 {
3585         hda_nid_t *nids = mout->dac_nids;
3586         int i;
3587
3588         for (i = 0; i < mout->num_dacs; i++)
3589                 snd_hda_codec_cleanup_stream(codec, nids[i]);
3590         if (mout->hp_nid)
3591                 snd_hda_codec_cleanup_stream(codec, mout->hp_nid);
3592         for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++)
3593                 if (mout->extra_out_nid[i])
3594                         snd_hda_codec_cleanup_stream(codec,
3595                                                      mout->extra_out_nid[i]);
3596         mutex_lock(&codec->spdif_mutex);
3597         if (mout->dig_out_nid && mout->dig_out_used == HDA_DIG_ANALOG_DUP) {
3598                 cleanup_dig_out_stream(codec, mout->dig_out_nid);
3599                 mout->dig_out_used = 0;
3600         }
3601         mutex_unlock(&codec->spdif_mutex);
3602         return 0;
3603 }
3604 EXPORT_SYMBOL_HDA(snd_hda_multi_out_analog_cleanup);
3605
3606 /*
3607  * Helper for automatic pin configuration
3608  */
3609
3610 static int is_in_nid_list(hda_nid_t nid, hda_nid_t *list)
3611 {
3612         for (; *list; list++)
3613                 if (*list == nid)
3614                         return 1;
3615         return 0;
3616 }
3617
3618
3619 /*
3620  * Sort an associated group of pins according to their sequence numbers.
3621  */
3622 static void sort_pins_by_sequence(hda_nid_t * pins, short * sequences,
3623                                   int num_pins)
3624 {
3625         int i, j;
3626         short seq;