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