[ALSA] hda-intel - Improve HD-audio codec probing robustness
[safe/jmp/linux-2.6] / 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 <sound/driver.h>
23 #include <linux/init.h>
24 #include <linux/delay.h>
25 #include <linux/slab.h>
26 #include <linux/pci.h>
27 #include <linux/mutex.h>
28 #include <sound/core.h>
29 #include "hda_codec.h"
30 #include <sound/asoundef.h>
31 #include <sound/tlv.h>
32 #include <sound/initval.h>
33 #include "hda_local.h"
34 #include <sound/hda_hwdep.h>
35
36 #ifdef CONFIG_SND_HDA_POWER_SAVE
37 /* define this option here to hide as static */
38 static int power_save = 10;
39 module_param(power_save, int, 0644);
40 MODULE_PARM_DESC(power_save, "Automatic power-saving timeout "
41                  "(in second, 0 = disable).");
42 #endif
43
44 /*
45  * vendor / preset table
46  */
47
48 struct hda_vendor_id {
49         unsigned int id;
50         const char *name;
51 };
52
53 /* codec vendor labels */
54 static struct hda_vendor_id hda_vendor_ids[] = {
55         { 0x10ec, "Realtek" },
56         { 0x1057, "Motorola" },
57         { 0x1106, "VIA" },
58         { 0x11d4, "Analog Devices" },
59         { 0x13f6, "C-Media" },
60         { 0x14f1, "Conexant" },
61         { 0x434d, "C-Media" },
62         { 0x8384, "SigmaTel" },
63         {} /* terminator */
64 };
65
66 /* codec presets */
67 #include "hda_patch.h"
68
69
70 #ifdef CONFIG_SND_HDA_POWER_SAVE
71 static void hda_power_work(struct work_struct *work);
72 static void hda_keep_power_on(struct hda_codec *codec);
73 #else
74 static inline void hda_keep_power_on(struct hda_codec *codec) {}
75 #endif
76
77 /**
78  * snd_hda_codec_read - send a command and get the response
79  * @codec: the HDA codec
80  * @nid: NID to send the command
81  * @direct: direct flag
82  * @verb: the verb to send
83  * @parm: the parameter for the verb
84  *
85  * Send a single command and read the corresponding response.
86  *
87  * Returns the obtained response value, or -1 for an error.
88  */
89 unsigned int snd_hda_codec_read(struct hda_codec *codec, hda_nid_t nid,
90                                 int direct,
91                                 unsigned int verb, unsigned int parm)
92 {
93         unsigned int res;
94         snd_hda_power_up(codec);
95         mutex_lock(&codec->bus->cmd_mutex);
96         if (!codec->bus->ops.command(codec, nid, direct, verb, parm))
97                 res = codec->bus->ops.get_response(codec);
98         else
99                 res = (unsigned int)-1;
100         mutex_unlock(&codec->bus->cmd_mutex);
101         snd_hda_power_down(codec);
102         return res;
103 }
104
105 /**
106  * snd_hda_codec_write - send a single command without waiting for response
107  * @codec: the HDA codec
108  * @nid: NID to send the command
109  * @direct: direct flag
110  * @verb: the verb to send
111  * @parm: the parameter for the verb
112  *
113  * Send a single command without waiting for response.
114  *
115  * Returns 0 if successful, or a negative error code.
116  */
117 int snd_hda_codec_write(struct hda_codec *codec, hda_nid_t nid, int direct,
118                          unsigned int verb, unsigned int parm)
119 {
120         int err;
121         snd_hda_power_up(codec);
122         mutex_lock(&codec->bus->cmd_mutex);
123         err = codec->bus->ops.command(codec, nid, direct, verb, parm);
124         mutex_unlock(&codec->bus->cmd_mutex);
125         snd_hda_power_down(codec);
126         return err;
127 }
128
129 /**
130  * snd_hda_sequence_write - sequence writes
131  * @codec: the HDA codec
132  * @seq: VERB array to send
133  *
134  * Send the commands sequentially from the given array.
135  * The array must be terminated with NID=0.
136  */
137 void snd_hda_sequence_write(struct hda_codec *codec, const struct hda_verb *seq)
138 {
139         for (; seq->nid; seq++)
140                 snd_hda_codec_write(codec, seq->nid, 0, seq->verb, seq->param);
141 }
142
143 /**
144  * snd_hda_get_sub_nodes - get the range of sub nodes
145  * @codec: the HDA codec
146  * @nid: NID to parse
147  * @start_id: the pointer to store the start NID
148  *
149  * Parse the NID and store the start NID of its sub-nodes.
150  * Returns the number of sub-nodes.
151  */
152 int snd_hda_get_sub_nodes(struct hda_codec *codec, hda_nid_t nid,
153                           hda_nid_t *start_id)
154 {
155         unsigned int parm;
156
157         parm = snd_hda_param_read(codec, nid, AC_PAR_NODE_COUNT);
158         if (parm == -1)
159                 return 0;
160         *start_id = (parm >> 16) & 0x7fff;
161         return (int)(parm & 0x7fff);
162 }
163
164 /**
165  * snd_hda_get_connections - get connection list
166  * @codec: the HDA codec
167  * @nid: NID to parse
168  * @conn_list: connection list array
169  * @max_conns: max. number of connections to store
170  *
171  * Parses the connection list of the given widget and stores the list
172  * of NIDs.
173  *
174  * Returns the number of connections, or a negative error code.
175  */
176 int snd_hda_get_connections(struct hda_codec *codec, hda_nid_t nid,
177                             hda_nid_t *conn_list, int max_conns)
178 {
179         unsigned int parm;
180         int i, conn_len, conns;
181         unsigned int shift, num_elems, mask;
182         hda_nid_t prev_nid;
183
184         snd_assert(conn_list && max_conns > 0, return -EINVAL);
185
186         parm = snd_hda_param_read(codec, nid, AC_PAR_CONNLIST_LEN);
187         if (parm & AC_CLIST_LONG) {
188                 /* long form */
189                 shift = 16;
190                 num_elems = 2;
191         } else {
192                 /* short form */
193                 shift = 8;
194                 num_elems = 4;
195         }
196         conn_len = parm & AC_CLIST_LENGTH;
197         mask = (1 << (shift-1)) - 1;
198
199         if (!conn_len)
200                 return 0; /* no connection */
201
202         if (conn_len == 1) {
203                 /* single connection */
204                 parm = snd_hda_codec_read(codec, nid, 0,
205                                           AC_VERB_GET_CONNECT_LIST, 0);
206                 conn_list[0] = parm & mask;
207                 return 1;
208         }
209
210         /* multi connection */
211         conns = 0;
212         prev_nid = 0;
213         for (i = 0; i < conn_len; i++) {
214                 int range_val;
215                 hda_nid_t val, n;
216
217                 if (i % num_elems == 0)
218                         parm = snd_hda_codec_read(codec, nid, 0,
219                                                   AC_VERB_GET_CONNECT_LIST, i);
220                 range_val = !!(parm & (1 << (shift-1))); /* ranges */
221                 val = parm & mask;
222                 parm >>= shift;
223                 if (range_val) {
224                         /* ranges between the previous and this one */
225                         if (!prev_nid || prev_nid >= val) {
226                                 snd_printk(KERN_WARNING "hda_codec: "
227                                            "invalid dep_range_val %x:%x\n",
228                                            prev_nid, val);
229                                 continue;
230                         }
231                         for (n = prev_nid + 1; n <= val; n++) {
232                                 if (conns >= max_conns) {
233                                         snd_printk(KERN_ERR
234                                                    "Too many connections\n");
235                                         return -EINVAL;
236                                 }
237                                 conn_list[conns++] = n;
238                         }
239                 } else {
240                         if (conns >= max_conns) {
241                                 snd_printk(KERN_ERR "Too many connections\n");
242                                 return -EINVAL;
243                         }
244                         conn_list[conns++] = val;
245                 }
246                 prev_nid = val;
247         }
248         return conns;
249 }
250
251
252 /**
253  * snd_hda_queue_unsol_event - add an unsolicited event to queue
254  * @bus: the BUS
255  * @res: unsolicited event (lower 32bit of RIRB entry)
256  * @res_ex: codec addr and flags (upper 32bit or RIRB entry)
257  *
258  * Adds the given event to the queue.  The events are processed in
259  * the workqueue asynchronously.  Call this function in the interrupt
260  * hanlder when RIRB receives an unsolicited event.
261  *
262  * Returns 0 if successful, or a negative error code.
263  */
264 int snd_hda_queue_unsol_event(struct hda_bus *bus, u32 res, u32 res_ex)
265 {
266         struct hda_bus_unsolicited *unsol;
267         unsigned int wp;
268
269         unsol = bus->unsol;
270         if (!unsol)
271                 return 0;
272
273         wp = (unsol->wp + 1) % HDA_UNSOL_QUEUE_SIZE;
274         unsol->wp = wp;
275
276         wp <<= 1;
277         unsol->queue[wp] = res;
278         unsol->queue[wp + 1] = res_ex;
279
280         schedule_work(&unsol->work);
281
282         return 0;
283 }
284
285 /*
286  * process queueud unsolicited events
287  */
288 static void process_unsol_events(struct work_struct *work)
289 {
290         struct hda_bus_unsolicited *unsol =
291                 container_of(work, struct hda_bus_unsolicited, work);
292         struct hda_bus *bus = unsol->bus;
293         struct hda_codec *codec;
294         unsigned int rp, caddr, res;
295
296         while (unsol->rp != unsol->wp) {
297                 rp = (unsol->rp + 1) % HDA_UNSOL_QUEUE_SIZE;
298                 unsol->rp = rp;
299                 rp <<= 1;
300                 res = unsol->queue[rp];
301                 caddr = unsol->queue[rp + 1];
302                 if (!(caddr & (1 << 4))) /* no unsolicited event? */
303                         continue;
304                 codec = bus->caddr_tbl[caddr & 0x0f];
305                 if (codec && codec->patch_ops.unsol_event)
306                         codec->patch_ops.unsol_event(codec, res);
307         }
308 }
309
310 /*
311  * initialize unsolicited queue
312  */
313 static int __devinit init_unsol_queue(struct hda_bus *bus)
314 {
315         struct hda_bus_unsolicited *unsol;
316
317         if (bus->unsol) /* already initialized */
318                 return 0;
319
320         unsol = kzalloc(sizeof(*unsol), GFP_KERNEL);
321         if (!unsol) {
322                 snd_printk(KERN_ERR "hda_codec: "
323                            "can't allocate unsolicited queue\n");
324                 return -ENOMEM;
325         }
326         INIT_WORK(&unsol->work, process_unsol_events);
327         unsol->bus = bus;
328         bus->unsol = unsol;
329         return 0;
330 }
331
332 /*
333  * destructor
334  */
335 static void snd_hda_codec_free(struct hda_codec *codec);
336
337 static int snd_hda_bus_free(struct hda_bus *bus)
338 {
339         struct hda_codec *codec, *n;
340
341         if (!bus)
342                 return 0;
343         if (bus->unsol) {
344                 flush_scheduled_work();
345                 kfree(bus->unsol);
346         }
347         list_for_each_entry_safe(codec, n, &bus->codec_list, list) {
348                 snd_hda_codec_free(codec);
349         }
350         if (bus->ops.private_free)
351                 bus->ops.private_free(bus);
352         kfree(bus);
353         return 0;
354 }
355
356 static int snd_hda_bus_dev_free(struct snd_device *device)
357 {
358         struct hda_bus *bus = device->device_data;
359         return snd_hda_bus_free(bus);
360 }
361
362 /**
363  * snd_hda_bus_new - create a HDA bus
364  * @card: the card entry
365  * @temp: the template for hda_bus information
366  * @busp: the pointer to store the created bus instance
367  *
368  * Returns 0 if successful, or a negative error code.
369  */
370 int __devinit snd_hda_bus_new(struct snd_card *card,
371                               const struct hda_bus_template *temp,
372                               struct hda_bus **busp)
373 {
374         struct hda_bus *bus;
375         int err;
376         static struct snd_device_ops dev_ops = {
377                 .dev_free = snd_hda_bus_dev_free,
378         };
379
380         snd_assert(temp, return -EINVAL);
381         snd_assert(temp->ops.command && temp->ops.get_response, return -EINVAL);
382
383         if (busp)
384                 *busp = NULL;
385
386         bus = kzalloc(sizeof(*bus), GFP_KERNEL);
387         if (bus == NULL) {
388                 snd_printk(KERN_ERR "can't allocate struct hda_bus\n");
389                 return -ENOMEM;
390         }
391
392         bus->card = card;
393         bus->private_data = temp->private_data;
394         bus->pci = temp->pci;
395         bus->modelname = temp->modelname;
396         bus->ops = temp->ops;
397
398         mutex_init(&bus->cmd_mutex);
399         INIT_LIST_HEAD(&bus->codec_list);
400
401         err = snd_device_new(card, SNDRV_DEV_BUS, bus, &dev_ops);
402         if (err < 0) {
403                 snd_hda_bus_free(bus);
404                 return err;
405         }
406         if (busp)
407                 *busp = bus;
408         return 0;
409 }
410
411 #ifdef CONFIG_SND_HDA_GENERIC
412 #define is_generic_config(codec) \
413         (codec->bus->modelname && !strcmp(codec->bus->modelname, "generic"))
414 #else
415 #define is_generic_config(codec)        0
416 #endif
417
418 /*
419  * find a matching codec preset
420  */
421 static const struct hda_codec_preset __devinit *
422 find_codec_preset(struct hda_codec *codec)
423 {
424         const struct hda_codec_preset **tbl, *preset;
425
426         if (is_generic_config(codec))
427                 return NULL; /* use the generic parser */
428
429         for (tbl = hda_preset_tables; *tbl; tbl++) {
430                 for (preset = *tbl; preset->id; preset++) {
431                         u32 mask = preset->mask;
432                         if (!mask)
433                                 mask = ~0;
434                         if (preset->id == (codec->vendor_id & mask) &&
435                             (!preset->rev ||
436                              preset->rev == codec->revision_id))
437                                 return preset;
438                 }
439         }
440         return NULL;
441 }
442
443 /*
444  * snd_hda_get_codec_name - store the codec name
445  */
446 void snd_hda_get_codec_name(struct hda_codec *codec,
447                             char *name, int namelen)
448 {
449         const struct hda_vendor_id *c;
450         const char *vendor = NULL;
451         u16 vendor_id = codec->vendor_id >> 16;
452         char tmp[16];
453
454         for (c = hda_vendor_ids; c->id; c++) {
455                 if (c->id == vendor_id) {
456                         vendor = c->name;
457                         break;
458                 }
459         }
460         if (!vendor) {
461                 sprintf(tmp, "Generic %04x", vendor_id);
462                 vendor = tmp;
463         }
464         if (codec->preset && codec->preset->name)
465                 snprintf(name, namelen, "%s %s", vendor, codec->preset->name);
466         else
467                 snprintf(name, namelen, "%s ID %x", vendor,
468                          codec->vendor_id & 0xffff);
469 }
470
471 /*
472  * look for an AFG and MFG nodes
473  */
474 static void __devinit setup_fg_nodes(struct hda_codec *codec)
475 {
476         int i, total_nodes;
477         hda_nid_t nid;
478
479         total_nodes = snd_hda_get_sub_nodes(codec, AC_NODE_ROOT, &nid);
480         for (i = 0; i < total_nodes; i++, nid++) {
481                 unsigned int func;
482                 func = snd_hda_param_read(codec, nid, AC_PAR_FUNCTION_TYPE);
483                 switch (func & 0xff) {
484                 case AC_GRP_AUDIO_FUNCTION:
485                         codec->afg = nid;
486                         break;
487                 case AC_GRP_MODEM_FUNCTION:
488                         codec->mfg = nid;
489                         break;
490                 default:
491                         break;
492                 }
493         }
494 }
495
496 /*
497  * read widget caps for each widget and store in cache
498  */
499 static int read_widget_caps(struct hda_codec *codec, hda_nid_t fg_node)
500 {
501         int i;
502         hda_nid_t nid;
503
504         codec->num_nodes = snd_hda_get_sub_nodes(codec, fg_node,
505                                                  &codec->start_nid);
506         codec->wcaps = kmalloc(codec->num_nodes * 4, GFP_KERNEL);
507         if (!codec->wcaps)
508                 return -ENOMEM;
509         nid = codec->start_nid;
510         for (i = 0; i < codec->num_nodes; i++, nid++)
511                 codec->wcaps[i] = snd_hda_param_read(codec, nid,
512                                                      AC_PAR_AUDIO_WIDGET_CAP);
513         return 0;
514 }
515
516
517 static void init_hda_cache(struct hda_cache_rec *cache,
518                            unsigned int record_size);
519 static void free_hda_cache(struct hda_cache_rec *cache);
520
521 /*
522  * codec destructor
523  */
524 static void snd_hda_codec_free(struct hda_codec *codec)
525 {
526         if (!codec)
527                 return;
528 #ifdef CONFIG_SND_HDA_POWER_SAVE
529         cancel_delayed_work(&codec->power_work);
530         flush_scheduled_work();
531 #endif
532         list_del(&codec->list);
533         codec->bus->caddr_tbl[codec->addr] = NULL;
534         if (codec->patch_ops.free)
535                 codec->patch_ops.free(codec);
536         free_hda_cache(&codec->amp_cache);
537         free_hda_cache(&codec->cmd_cache);
538         kfree(codec->wcaps);
539         kfree(codec);
540 }
541
542 /**
543  * snd_hda_codec_new - create a HDA codec
544  * @bus: the bus to assign
545  * @codec_addr: the codec address
546  * @codecp: the pointer to store the generated codec
547  *
548  * Returns 0 if successful, or a negative error code.
549  */
550 int __devinit snd_hda_codec_new(struct hda_bus *bus, unsigned int codec_addr,
551                                 struct hda_codec **codecp)
552 {
553         struct hda_codec *codec;
554         char component[13];
555         int err;
556
557         snd_assert(bus, return -EINVAL);
558         snd_assert(codec_addr <= HDA_MAX_CODEC_ADDRESS, return -EINVAL);
559
560         if (bus->caddr_tbl[codec_addr]) {
561                 snd_printk(KERN_ERR "hda_codec: "
562                            "address 0x%x is already occupied\n", codec_addr);
563                 return -EBUSY;
564         }
565
566         codec = kzalloc(sizeof(*codec), GFP_KERNEL);
567         if (codec == NULL) {
568                 snd_printk(KERN_ERR "can't allocate struct hda_codec\n");
569                 return -ENOMEM;
570         }
571
572         codec->bus = bus;
573         codec->addr = codec_addr;
574         mutex_init(&codec->spdif_mutex);
575         init_hda_cache(&codec->amp_cache, sizeof(struct hda_amp_info));
576         init_hda_cache(&codec->cmd_cache, sizeof(struct hda_cache_head));
577
578 #ifdef CONFIG_SND_HDA_POWER_SAVE
579         INIT_DELAYED_WORK(&codec->power_work, hda_power_work);
580         /* snd_hda_codec_new() marks the codec as power-up, and leave it as is.
581          * the caller has to power down appropriatley after initialization
582          * phase.
583          */
584         hda_keep_power_on(codec);
585 #endif
586
587         list_add_tail(&codec->list, &bus->codec_list);
588         bus->caddr_tbl[codec_addr] = codec;
589
590         codec->vendor_id = snd_hda_param_read(codec, AC_NODE_ROOT,
591                                               AC_PAR_VENDOR_ID);
592         if (codec->vendor_id == -1)
593                 /* read again, hopefully the access method was corrected
594                  * in the last read...
595                  */
596                 codec->vendor_id = snd_hda_param_read(codec, AC_NODE_ROOT,
597                                                       AC_PAR_VENDOR_ID);
598         codec->subsystem_id = snd_hda_param_read(codec, AC_NODE_ROOT,
599                                                  AC_PAR_SUBSYSTEM_ID);
600         codec->revision_id = snd_hda_param_read(codec, AC_NODE_ROOT,
601                                                 AC_PAR_REV_ID);
602
603         setup_fg_nodes(codec);
604         if (!codec->afg && !codec->mfg) {
605                 snd_printdd("hda_codec: no AFG or MFG node found\n");
606                 snd_hda_codec_free(codec);
607                 return -ENODEV;
608         }
609
610         if (read_widget_caps(codec, codec->afg ? codec->afg : codec->mfg) < 0) {
611                 snd_printk(KERN_ERR "hda_codec: cannot malloc\n");
612                 snd_hda_codec_free(codec);
613                 return -ENOMEM;
614         }
615
616         if (!codec->subsystem_id) {
617                 hda_nid_t nid = codec->afg ? codec->afg : codec->mfg;
618                 codec->subsystem_id =
619                         snd_hda_codec_read(codec, nid, 0,
620                                            AC_VERB_GET_SUBSYSTEM_ID, 0);
621         }
622
623         codec->preset = find_codec_preset(codec);
624         /* audio codec should override the mixer name */
625         if (codec->afg || !*bus->card->mixername)
626                 snd_hda_get_codec_name(codec, bus->card->mixername,
627                                        sizeof(bus->card->mixername));
628
629 #ifdef CONFIG_SND_HDA_GENERIC
630         if (is_generic_config(codec)) {
631                 err = snd_hda_parse_generic_codec(codec);
632                 goto patched;
633         }
634 #endif
635         if (codec->preset && codec->preset->patch) {
636                 err = codec->preset->patch(codec);
637                 goto patched;
638         }
639
640         /* call the default parser */
641 #ifdef CONFIG_SND_HDA_GENERIC
642         err = snd_hda_parse_generic_codec(codec);
643 #else
644         printk(KERN_ERR "hda-codec: No codec parser is available\n");
645         err = -ENODEV;
646 #endif
647
648  patched:
649         if (err < 0) {
650                 snd_hda_codec_free(codec);
651                 return err;
652         }
653
654         if (codec->patch_ops.unsol_event)
655                 init_unsol_queue(bus);
656
657         snd_hda_codec_proc_new(codec);
658 #ifdef CONFIG_SND_HDA_HWDEP
659         snd_hda_create_hwdep(codec);
660 #endif
661
662         sprintf(component, "HDA:%08x", codec->vendor_id);
663         snd_component_add(codec->bus->card, component);
664
665         if (codecp)
666                 *codecp = codec;
667         return 0;
668 }
669
670 /**
671  * snd_hda_codec_setup_stream - set up the codec for streaming
672  * @codec: the CODEC to set up
673  * @nid: the NID to set up
674  * @stream_tag: stream tag to pass, it's between 0x1 and 0xf.
675  * @channel_id: channel id to pass, zero based.
676  * @format: stream format.
677  */
678 void snd_hda_codec_setup_stream(struct hda_codec *codec, hda_nid_t nid,
679                                 u32 stream_tag,
680                                 int channel_id, int format)
681 {
682         if (!nid)
683                 return;
684
685         snd_printdd("hda_codec_setup_stream: "
686                     "NID=0x%x, stream=0x%x, channel=%d, format=0x%x\n",
687                     nid, stream_tag, channel_id, format);
688         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_CHANNEL_STREAMID,
689                             (stream_tag << 4) | channel_id);
690         msleep(1);
691         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_STREAM_FORMAT, format);
692 }
693
694 /*
695  * amp access functions
696  */
697
698 /* FIXME: more better hash key? */
699 #define HDA_HASH_KEY(nid,dir,idx) (u32)((nid) + ((idx) << 16) + ((dir) << 24))
700 #define INFO_AMP_CAPS   (1<<0)
701 #define INFO_AMP_VOL(ch)        (1 << (1 + (ch)))
702
703 /* initialize the hash table */
704 static void __devinit init_hda_cache(struct hda_cache_rec *cache,
705                                      unsigned int record_size)
706 {
707         memset(cache, 0, sizeof(*cache));
708         memset(cache->hash, 0xff, sizeof(cache->hash));
709         cache->record_size = record_size;
710 }
711
712 static void free_hda_cache(struct hda_cache_rec *cache)
713 {
714         kfree(cache->buffer);
715 }
716
717 /* query the hash.  allocate an entry if not found. */
718 static struct hda_cache_head  *get_alloc_hash(struct hda_cache_rec *cache,
719                                               u32 key)
720 {
721         u16 idx = key % (u16)ARRAY_SIZE(cache->hash);
722         u16 cur = cache->hash[idx];
723         struct hda_cache_head *info;
724
725         while (cur != 0xffff) {
726                 info = (struct hda_cache_head *)(cache->buffer +
727                                                  cur * cache->record_size);
728                 if (info->key == key)
729                         return info;
730                 cur = info->next;
731         }
732
733         /* add a new hash entry */
734         if (cache->num_entries >= cache->size) {
735                 /* reallocate the array */
736                 unsigned int new_size = cache->size + 64;
737                 void *new_buffer;
738                 new_buffer = kcalloc(new_size, cache->record_size, GFP_KERNEL);
739                 if (!new_buffer) {
740                         snd_printk(KERN_ERR "hda_codec: "
741                                    "can't malloc amp_info\n");
742                         return NULL;
743                 }
744                 if (cache->buffer) {
745                         memcpy(new_buffer, cache->buffer,
746                                cache->size * cache->record_size);
747                         kfree(cache->buffer);
748                 }
749                 cache->size = new_size;
750                 cache->buffer = new_buffer;
751         }
752         cur = cache->num_entries++;
753         info = (struct hda_cache_head *)(cache->buffer +
754                                          cur * cache->record_size);
755         info->key = key;
756         info->val = 0;
757         info->next = cache->hash[idx];
758         cache->hash[idx] = cur;
759
760         return info;
761 }
762
763 /* query and allocate an amp hash entry */
764 static inline struct hda_amp_info *
765 get_alloc_amp_hash(struct hda_codec *codec, u32 key)
766 {
767         return (struct hda_amp_info *)get_alloc_hash(&codec->amp_cache, key);
768 }
769
770 /*
771  * query AMP capabilities for the given widget and direction
772  */
773 static u32 query_amp_caps(struct hda_codec *codec, hda_nid_t nid, int direction)
774 {
775         struct hda_amp_info *info;
776
777         info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, 0));
778         if (!info)
779                 return 0;
780         if (!(info->head.val & INFO_AMP_CAPS)) {
781                 if (!(get_wcaps(codec, nid) & AC_WCAP_AMP_OVRD))
782                         nid = codec->afg;
783                 info->amp_caps = snd_hda_param_read(codec, nid,
784                                                     direction == HDA_OUTPUT ?
785                                                     AC_PAR_AMP_OUT_CAP :
786                                                     AC_PAR_AMP_IN_CAP);
787                 if (info->amp_caps)
788                         info->head.val |= INFO_AMP_CAPS;
789         }
790         return info->amp_caps;
791 }
792
793 int snd_hda_override_amp_caps(struct hda_codec *codec, hda_nid_t nid, int dir,
794                               unsigned int caps)
795 {
796         struct hda_amp_info *info;
797
798         info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, dir, 0));
799         if (!info)
800                 return -EINVAL;
801         info->amp_caps = caps;
802         info->head.val |= INFO_AMP_CAPS;
803         return 0;
804 }
805
806 /*
807  * read the current volume to info
808  * if the cache exists, read the cache value.
809  */
810 static unsigned int get_vol_mute(struct hda_codec *codec,
811                                  struct hda_amp_info *info, hda_nid_t nid,
812                                  int ch, int direction, int index)
813 {
814         u32 val, parm;
815
816         if (info->head.val & INFO_AMP_VOL(ch))
817                 return info->vol[ch];
818
819         parm = ch ? AC_AMP_GET_RIGHT : AC_AMP_GET_LEFT;
820         parm |= direction == HDA_OUTPUT ? AC_AMP_GET_OUTPUT : AC_AMP_GET_INPUT;
821         parm |= index;
822         val = snd_hda_codec_read(codec, nid, 0,
823                                  AC_VERB_GET_AMP_GAIN_MUTE, parm);
824         info->vol[ch] = val & 0xff;
825         info->head.val |= INFO_AMP_VOL(ch);
826         return info->vol[ch];
827 }
828
829 /*
830  * write the current volume in info to the h/w and update the cache
831  */
832 static void put_vol_mute(struct hda_codec *codec, struct hda_amp_info *info,
833                          hda_nid_t nid, int ch, int direction, int index,
834                          int val)
835 {
836         u32 parm;
837
838         parm = ch ? AC_AMP_SET_RIGHT : AC_AMP_SET_LEFT;
839         parm |= direction == HDA_OUTPUT ? AC_AMP_SET_OUTPUT : AC_AMP_SET_INPUT;
840         parm |= index << AC_AMP_SET_INDEX_SHIFT;
841         parm |= val;
842         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_AMP_GAIN_MUTE, parm);
843         info->vol[ch] = val;
844 }
845
846 /*
847  * read AMP value.  The volume is between 0 to 0x7f, 0x80 = mute bit.
848  */
849 int snd_hda_codec_amp_read(struct hda_codec *codec, hda_nid_t nid, int ch,
850                            int direction, int index)
851 {
852         struct hda_amp_info *info;
853         info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, index));
854         if (!info)
855                 return 0;
856         return get_vol_mute(codec, info, nid, ch, direction, index);
857 }
858
859 /*
860  * update the AMP value, mask = bit mask to set, val = the value
861  */
862 int snd_hda_codec_amp_update(struct hda_codec *codec, hda_nid_t nid, int ch,
863                              int direction, int idx, int mask, int val)
864 {
865         struct hda_amp_info *info;
866
867         info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, idx));
868         if (!info)
869                 return 0;
870         val &= mask;
871         val |= get_vol_mute(codec, info, nid, ch, direction, idx) & ~mask;
872         if (info->vol[ch] == val)
873                 return 0;
874         put_vol_mute(codec, info, nid, ch, direction, idx, val);
875         return 1;
876 }
877
878 /*
879  * update the AMP stereo with the same mask and value
880  */
881 int snd_hda_codec_amp_stereo(struct hda_codec *codec, hda_nid_t nid,
882                              int direction, int idx, int mask, int val)
883 {
884         int ch, ret = 0;
885         for (ch = 0; ch < 2; ch++)
886                 ret |= snd_hda_codec_amp_update(codec, nid, ch, direction,
887                                                 idx, mask, val);
888         return ret;
889 }
890
891 #ifdef SND_HDA_NEEDS_RESUME
892 /* resume the all amp commands from the cache */
893 void snd_hda_codec_resume_amp(struct hda_codec *codec)
894 {
895         struct hda_amp_info *buffer = codec->amp_cache.buffer;
896         int i;
897
898         for (i = 0; i < codec->amp_cache.size; i++, buffer++) {
899                 u32 key = buffer->head.key;
900                 hda_nid_t nid;
901                 unsigned int idx, dir, ch;
902                 if (!key)
903                         continue;
904                 nid = key & 0xff;
905                 idx = (key >> 16) & 0xff;
906                 dir = (key >> 24) & 0xff;
907                 for (ch = 0; ch < 2; ch++) {
908                         if (!(buffer->head.val & INFO_AMP_VOL(ch)))
909                                 continue;
910                         put_vol_mute(codec, buffer, nid, ch, dir, idx,
911                                      buffer->vol[ch]);
912                 }
913         }
914 }
915 #endif /* SND_HDA_NEEDS_RESUME */
916
917 /*
918  * AMP control callbacks
919  */
920 /* retrieve parameters from private_value */
921 #define get_amp_nid(kc)         ((kc)->private_value & 0xffff)
922 #define get_amp_channels(kc)    (((kc)->private_value >> 16) & 0x3)
923 #define get_amp_direction(kc)   (((kc)->private_value >> 18) & 0x1)
924 #define get_amp_index(kc)       (((kc)->private_value >> 19) & 0xf)
925
926 /* volume */
927 int snd_hda_mixer_amp_volume_info(struct snd_kcontrol *kcontrol,
928                                   struct snd_ctl_elem_info *uinfo)
929 {
930         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
931         u16 nid = get_amp_nid(kcontrol);
932         u8 chs = get_amp_channels(kcontrol);
933         int dir = get_amp_direction(kcontrol);
934         u32 caps;
935
936         caps = query_amp_caps(codec, nid, dir);
937         /* num steps */
938         caps = (caps & AC_AMPCAP_NUM_STEPS) >> AC_AMPCAP_NUM_STEPS_SHIFT;
939         if (!caps) {
940                 printk(KERN_WARNING "hda_codec: "
941                        "num_steps = 0 for NID=0x%x\n", nid);
942                 return -EINVAL;
943         }
944         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
945         uinfo->count = chs == 3 ? 2 : 1;
946         uinfo->value.integer.min = 0;
947         uinfo->value.integer.max = caps;
948         return 0;
949 }
950
951 int snd_hda_mixer_amp_volume_get(struct snd_kcontrol *kcontrol,
952                                  struct snd_ctl_elem_value *ucontrol)
953 {
954         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
955         hda_nid_t nid = get_amp_nid(kcontrol);
956         int chs = get_amp_channels(kcontrol);
957         int dir = get_amp_direction(kcontrol);
958         int idx = get_amp_index(kcontrol);
959         long *valp = ucontrol->value.integer.value;
960
961         if (chs & 1)
962                 *valp++ = snd_hda_codec_amp_read(codec, nid, 0, dir, idx)
963                         & HDA_AMP_VOLMASK;
964         if (chs & 2)
965                 *valp = snd_hda_codec_amp_read(codec, nid, 1, dir, idx)
966                         & HDA_AMP_VOLMASK;
967         return 0;
968 }
969
970 int snd_hda_mixer_amp_volume_put(struct snd_kcontrol *kcontrol,
971                                  struct snd_ctl_elem_value *ucontrol)
972 {
973         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
974         hda_nid_t nid = get_amp_nid(kcontrol);
975         int chs = get_amp_channels(kcontrol);
976         int dir = get_amp_direction(kcontrol);
977         int idx = get_amp_index(kcontrol);
978         long *valp = ucontrol->value.integer.value;
979         int change = 0;
980
981         snd_hda_power_up(codec);
982         if (chs & 1) {
983                 change = snd_hda_codec_amp_update(codec, nid, 0, dir, idx,
984                                                   0x7f, *valp);
985                 valp++;
986         }
987         if (chs & 2)
988                 change |= snd_hda_codec_amp_update(codec, nid, 1, dir, idx,
989                                                    0x7f, *valp);
990         snd_hda_power_down(codec);
991         return change;
992 }
993
994 int snd_hda_mixer_amp_tlv(struct snd_kcontrol *kcontrol, int op_flag,
995                           unsigned int size, unsigned int __user *_tlv)
996 {
997         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
998         hda_nid_t nid = get_amp_nid(kcontrol);
999         int dir = get_amp_direction(kcontrol);
1000         u32 caps, val1, val2;
1001
1002         if (size < 4 * sizeof(unsigned int))
1003                 return -ENOMEM;
1004         caps = query_amp_caps(codec, nid, dir);
1005         val2 = (caps & AC_AMPCAP_STEP_SIZE) >> AC_AMPCAP_STEP_SIZE_SHIFT;
1006         val2 = (val2 + 1) * 25;
1007         val1 = -((caps & AC_AMPCAP_OFFSET) >> AC_AMPCAP_OFFSET_SHIFT);
1008         val1 = ((int)val1) * ((int)val2);
1009         if (put_user(SNDRV_CTL_TLVT_DB_SCALE, _tlv))
1010                 return -EFAULT;
1011         if (put_user(2 * sizeof(unsigned int), _tlv + 1))
1012                 return -EFAULT;
1013         if (put_user(val1, _tlv + 2))
1014                 return -EFAULT;
1015         if (put_user(val2, _tlv + 3))
1016                 return -EFAULT;
1017         return 0;
1018 }
1019
1020 /* switch */
1021 int snd_hda_mixer_amp_switch_info(struct snd_kcontrol *kcontrol,
1022                                   struct snd_ctl_elem_info *uinfo)
1023 {
1024         int chs = get_amp_channels(kcontrol);
1025
1026         uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
1027         uinfo->count = chs == 3 ? 2 : 1;
1028         uinfo->value.integer.min = 0;
1029         uinfo->value.integer.max = 1;
1030         return 0;
1031 }
1032
1033 int snd_hda_mixer_amp_switch_get(struct snd_kcontrol *kcontrol,
1034                                  struct snd_ctl_elem_value *ucontrol)
1035 {
1036         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1037         hda_nid_t nid = get_amp_nid(kcontrol);
1038         int chs = get_amp_channels(kcontrol);
1039         int dir = get_amp_direction(kcontrol);
1040         int idx = get_amp_index(kcontrol);
1041         long *valp = ucontrol->value.integer.value;
1042
1043         if (chs & 1)
1044                 *valp++ = (snd_hda_codec_amp_read(codec, nid, 0, dir, idx) &
1045                            HDA_AMP_MUTE) ? 0 : 1;
1046         if (chs & 2)
1047                 *valp = (snd_hda_codec_amp_read(codec, nid, 1, dir, idx) &
1048                          HDA_AMP_MUTE) ? 0 : 1;
1049         return 0;
1050 }
1051
1052 int snd_hda_mixer_amp_switch_put(struct snd_kcontrol *kcontrol,
1053                                  struct snd_ctl_elem_value *ucontrol)
1054 {
1055         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1056         hda_nid_t nid = get_amp_nid(kcontrol);
1057         int chs = get_amp_channels(kcontrol);
1058         int dir = get_amp_direction(kcontrol);
1059         int idx = get_amp_index(kcontrol);
1060         long *valp = ucontrol->value.integer.value;
1061         int change = 0;
1062
1063         snd_hda_power_up(codec);
1064         if (chs & 1) {
1065                 change = snd_hda_codec_amp_update(codec, nid, 0, dir, idx,
1066                                                   HDA_AMP_MUTE,
1067                                                   *valp ? 0 : HDA_AMP_MUTE);
1068                 valp++;
1069         }
1070         if (chs & 2)
1071                 change |= snd_hda_codec_amp_update(codec, nid, 1, dir, idx,
1072                                                    HDA_AMP_MUTE,
1073                                                    *valp ? 0 : HDA_AMP_MUTE);
1074 #ifdef CONFIG_SND_HDA_POWER_SAVE
1075         if (codec->patch_ops.check_power_status)
1076                 codec->patch_ops.check_power_status(codec, nid);
1077 #endif
1078         snd_hda_power_down(codec);
1079         return change;
1080 }
1081
1082 /*
1083  * bound volume controls
1084  *
1085  * bind multiple volumes (# indices, from 0)
1086  */
1087
1088 #define AMP_VAL_IDX_SHIFT       19
1089 #define AMP_VAL_IDX_MASK        (0x0f<<19)
1090
1091 int snd_hda_mixer_bind_switch_get(struct snd_kcontrol *kcontrol,
1092                                   struct snd_ctl_elem_value *ucontrol)
1093 {
1094         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1095         unsigned long pval;
1096         int err;
1097
1098         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1099         pval = kcontrol->private_value;
1100         kcontrol->private_value = pval & ~AMP_VAL_IDX_MASK; /* index 0 */
1101         err = snd_hda_mixer_amp_switch_get(kcontrol, ucontrol);
1102         kcontrol->private_value = pval;
1103         mutex_unlock(&codec->spdif_mutex);
1104         return err;
1105 }
1106
1107 int snd_hda_mixer_bind_switch_put(struct snd_kcontrol *kcontrol,
1108                                   struct snd_ctl_elem_value *ucontrol)
1109 {
1110         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1111         unsigned long pval;
1112         int i, indices, err = 0, change = 0;
1113
1114         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1115         pval = kcontrol->private_value;
1116         indices = (pval & AMP_VAL_IDX_MASK) >> AMP_VAL_IDX_SHIFT;
1117         for (i = 0; i < indices; i++) {
1118                 kcontrol->private_value = (pval & ~AMP_VAL_IDX_MASK) |
1119                         (i << AMP_VAL_IDX_SHIFT);
1120                 err = snd_hda_mixer_amp_switch_put(kcontrol, ucontrol);
1121                 if (err < 0)
1122                         break;
1123                 change |= err;
1124         }
1125         kcontrol->private_value = pval;
1126         mutex_unlock(&codec->spdif_mutex);
1127         return err < 0 ? err : change;
1128 }
1129
1130 /*
1131  * generic bound volume/swtich controls
1132  */
1133 int snd_hda_mixer_bind_ctls_info(struct snd_kcontrol *kcontrol,
1134                                  struct snd_ctl_elem_info *uinfo)
1135 {
1136         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1137         struct hda_bind_ctls *c;
1138         int err;
1139
1140         c = (struct hda_bind_ctls *)kcontrol->private_value;
1141         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1142         kcontrol->private_value = *c->values;
1143         err = c->ops->info(kcontrol, uinfo);
1144         kcontrol->private_value = (long)c;
1145         mutex_unlock(&codec->spdif_mutex);
1146         return err;
1147 }
1148
1149 int snd_hda_mixer_bind_ctls_get(struct snd_kcontrol *kcontrol,
1150                                 struct snd_ctl_elem_value *ucontrol)
1151 {
1152         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1153         struct hda_bind_ctls *c;
1154         int err;
1155
1156         c = (struct hda_bind_ctls *)kcontrol->private_value;
1157         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1158         kcontrol->private_value = *c->values;
1159         err = c->ops->get(kcontrol, ucontrol);
1160         kcontrol->private_value = (long)c;
1161         mutex_unlock(&codec->spdif_mutex);
1162         return err;
1163 }
1164
1165 int snd_hda_mixer_bind_ctls_put(struct snd_kcontrol *kcontrol,
1166                                 struct snd_ctl_elem_value *ucontrol)
1167 {
1168         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1169         struct hda_bind_ctls *c;
1170         unsigned long *vals;
1171         int err = 0, change = 0;
1172
1173         c = (struct hda_bind_ctls *)kcontrol->private_value;
1174         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1175         for (vals = c->values; *vals; vals++) {
1176                 kcontrol->private_value = *vals;
1177                 err = c->ops->put(kcontrol, ucontrol);
1178                 if (err < 0)
1179                         break;
1180                 change |= err;
1181         }
1182         kcontrol->private_value = (long)c;
1183         mutex_unlock(&codec->spdif_mutex);
1184         return err < 0 ? err : change;
1185 }
1186
1187 int snd_hda_mixer_bind_tlv(struct snd_kcontrol *kcontrol, int op_flag,
1188                            unsigned int size, unsigned int __user *tlv)
1189 {
1190         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1191         struct hda_bind_ctls *c;
1192         int err;
1193
1194         c = (struct hda_bind_ctls *)kcontrol->private_value;
1195         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1196         kcontrol->private_value = *c->values;
1197         err = c->ops->tlv(kcontrol, op_flag, size, tlv);
1198         kcontrol->private_value = (long)c;
1199         mutex_unlock(&codec->spdif_mutex);
1200         return err;
1201 }
1202
1203 struct hda_ctl_ops snd_hda_bind_vol = {
1204         .info = snd_hda_mixer_amp_volume_info,
1205         .get = snd_hda_mixer_amp_volume_get,
1206         .put = snd_hda_mixer_amp_volume_put,
1207         .tlv = snd_hda_mixer_amp_tlv
1208 };
1209
1210 struct hda_ctl_ops snd_hda_bind_sw = {
1211         .info = snd_hda_mixer_amp_switch_info,
1212         .get = snd_hda_mixer_amp_switch_get,
1213         .put = snd_hda_mixer_amp_switch_put,
1214         .tlv = snd_hda_mixer_amp_tlv
1215 };
1216
1217 /*
1218  * SPDIF out controls
1219  */
1220
1221 static int snd_hda_spdif_mask_info(struct snd_kcontrol *kcontrol,
1222                                    struct snd_ctl_elem_info *uinfo)
1223 {
1224         uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
1225         uinfo->count = 1;
1226         return 0;
1227 }
1228
1229 static int snd_hda_spdif_cmask_get(struct snd_kcontrol *kcontrol,
1230                                    struct snd_ctl_elem_value *ucontrol)
1231 {
1232         ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
1233                                            IEC958_AES0_NONAUDIO |
1234                                            IEC958_AES0_CON_EMPHASIS_5015 |
1235                                            IEC958_AES0_CON_NOT_COPYRIGHT;
1236         ucontrol->value.iec958.status[1] = IEC958_AES1_CON_CATEGORY |
1237                                            IEC958_AES1_CON_ORIGINAL;
1238         return 0;
1239 }
1240
1241 static int snd_hda_spdif_pmask_get(struct snd_kcontrol *kcontrol,
1242                                    struct snd_ctl_elem_value *ucontrol)
1243 {
1244         ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
1245                                            IEC958_AES0_NONAUDIO |
1246                                            IEC958_AES0_PRO_EMPHASIS_5015;
1247         return 0;
1248 }
1249
1250 static int snd_hda_spdif_default_get(struct snd_kcontrol *kcontrol,
1251                                      struct snd_ctl_elem_value *ucontrol)
1252 {
1253         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1254
1255         ucontrol->value.iec958.status[0] = codec->spdif_status & 0xff;
1256         ucontrol->value.iec958.status[1] = (codec->spdif_status >> 8) & 0xff;
1257         ucontrol->value.iec958.status[2] = (codec->spdif_status >> 16) & 0xff;
1258         ucontrol->value.iec958.status[3] = (codec->spdif_status >> 24) & 0xff;
1259
1260         return 0;
1261 }
1262
1263 /* convert from SPDIF status bits to HDA SPDIF bits
1264  * bit 0 (DigEn) is always set zero (to be filled later)
1265  */
1266 static unsigned short convert_from_spdif_status(unsigned int sbits)
1267 {
1268         unsigned short val = 0;
1269
1270         if (sbits & IEC958_AES0_PROFESSIONAL)
1271                 val |= AC_DIG1_PROFESSIONAL;
1272         if (sbits & IEC958_AES0_NONAUDIO)
1273                 val |= AC_DIG1_NONAUDIO;
1274         if (sbits & IEC958_AES0_PROFESSIONAL) {
1275                 if ((sbits & IEC958_AES0_PRO_EMPHASIS) ==
1276                     IEC958_AES0_PRO_EMPHASIS_5015)
1277                         val |= AC_DIG1_EMPHASIS;
1278         } else {
1279                 if ((sbits & IEC958_AES0_CON_EMPHASIS) ==
1280                     IEC958_AES0_CON_EMPHASIS_5015)
1281                         val |= AC_DIG1_EMPHASIS;
1282                 if (!(sbits & IEC958_AES0_CON_NOT_COPYRIGHT))
1283                         val |= AC_DIG1_COPYRIGHT;
1284                 if (sbits & (IEC958_AES1_CON_ORIGINAL << 8))
1285                         val |= AC_DIG1_LEVEL;
1286                 val |= sbits & (IEC958_AES1_CON_CATEGORY << 8);
1287         }
1288         return val;
1289 }
1290
1291 /* convert to SPDIF status bits from HDA SPDIF bits
1292  */
1293 static unsigned int convert_to_spdif_status(unsigned short val)
1294 {
1295         unsigned int sbits = 0;
1296
1297         if (val & AC_DIG1_NONAUDIO)
1298                 sbits |= IEC958_AES0_NONAUDIO;
1299         if (val & AC_DIG1_PROFESSIONAL)
1300                 sbits |= IEC958_AES0_PROFESSIONAL;
1301         if (sbits & IEC958_AES0_PROFESSIONAL) {
1302                 if (sbits & AC_DIG1_EMPHASIS)
1303                         sbits |= IEC958_AES0_PRO_EMPHASIS_5015;
1304         } else {
1305                 if (val & AC_DIG1_EMPHASIS)
1306                         sbits |= IEC958_AES0_CON_EMPHASIS_5015;
1307                 if (!(val & AC_DIG1_COPYRIGHT))
1308                         sbits |= IEC958_AES0_CON_NOT_COPYRIGHT;
1309                 if (val & AC_DIG1_LEVEL)
1310                         sbits |= (IEC958_AES1_CON_ORIGINAL << 8);
1311                 sbits |= val & (0x7f << 8);
1312         }
1313         return sbits;
1314 }
1315
1316 static int snd_hda_spdif_default_put(struct snd_kcontrol *kcontrol,
1317                                      struct snd_ctl_elem_value *ucontrol)
1318 {
1319         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1320         hda_nid_t nid = kcontrol->private_value;
1321         unsigned short val;
1322         int change;
1323
1324         mutex_lock(&codec->spdif_mutex);
1325         codec->spdif_status = ucontrol->value.iec958.status[0] |
1326                 ((unsigned int)ucontrol->value.iec958.status[1] << 8) |
1327                 ((unsigned int)ucontrol->value.iec958.status[2] << 16) |
1328                 ((unsigned int)ucontrol->value.iec958.status[3] << 24);
1329         val = convert_from_spdif_status(codec->spdif_status);
1330         val |= codec->spdif_ctls & 1;
1331         change = codec->spdif_ctls != val;
1332         codec->spdif_ctls = val;
1333
1334         if (change) {
1335                 snd_hda_codec_write_cache(codec, nid, 0,
1336                                           AC_VERB_SET_DIGI_CONVERT_1,
1337                                           val & 0xff);
1338                 snd_hda_codec_write_cache(codec, nid, 0,
1339                                           AC_VERB_SET_DIGI_CONVERT_2,
1340                                           val >> 8);
1341         }
1342
1343         mutex_unlock(&codec->spdif_mutex);
1344         return change;
1345 }
1346
1347 #define snd_hda_spdif_out_switch_info   snd_ctl_boolean_mono_info
1348
1349 static int snd_hda_spdif_out_switch_get(struct snd_kcontrol *kcontrol,
1350                                         struct snd_ctl_elem_value *ucontrol)
1351 {
1352         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1353
1354         ucontrol->value.integer.value[0] = codec->spdif_ctls & AC_DIG1_ENABLE;
1355         return 0;
1356 }
1357
1358 static int snd_hda_spdif_out_switch_put(struct snd_kcontrol *kcontrol,
1359                                         struct snd_ctl_elem_value *ucontrol)
1360 {
1361         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1362         hda_nid_t nid = kcontrol->private_value;
1363         unsigned short val;
1364         int change;
1365
1366         mutex_lock(&codec->spdif_mutex);
1367         val = codec->spdif_ctls & ~AC_DIG1_ENABLE;
1368         if (ucontrol->value.integer.value[0])
1369                 val |= AC_DIG1_ENABLE;
1370         change = codec->spdif_ctls != val;
1371         if (change) {
1372                 codec->spdif_ctls = val;
1373                 snd_hda_codec_write_cache(codec, nid, 0,
1374                                           AC_VERB_SET_DIGI_CONVERT_1,
1375                                           val & 0xff);
1376                 /* unmute amp switch (if any) */
1377                 if ((get_wcaps(codec, nid) & AC_WCAP_OUT_AMP) &&
1378                     (val & AC_DIG1_ENABLE))
1379                         snd_hda_codec_amp_stereo(codec, nid, HDA_OUTPUT, 0,
1380                                                  HDA_AMP_MUTE, 0);
1381         }
1382         mutex_unlock(&codec->spdif_mutex);
1383         return change;
1384 }
1385
1386 static struct snd_kcontrol_new dig_mixes[] = {
1387         {
1388                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
1389                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1390                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,CON_MASK),
1391                 .info = snd_hda_spdif_mask_info,
1392                 .get = snd_hda_spdif_cmask_get,
1393         },
1394         {
1395                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
1396                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1397                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,PRO_MASK),
1398                 .info = snd_hda_spdif_mask_info,
1399                 .get = snd_hda_spdif_pmask_get,
1400         },
1401         {
1402                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1403                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,DEFAULT),
1404                 .info = snd_hda_spdif_mask_info,
1405                 .get = snd_hda_spdif_default_get,
1406                 .put = snd_hda_spdif_default_put,
1407         },
1408         {
1409                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1410                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,SWITCH),
1411                 .info = snd_hda_spdif_out_switch_info,
1412                 .get = snd_hda_spdif_out_switch_get,
1413                 .put = snd_hda_spdif_out_switch_put,
1414         },
1415         { } /* end */
1416 };
1417
1418 /**
1419  * snd_hda_create_spdif_out_ctls - create Output SPDIF-related controls
1420  * @codec: the HDA codec
1421  * @nid: audio out widget NID
1422  *
1423  * Creates controls related with the SPDIF output.
1424  * Called from each patch supporting the SPDIF out.
1425  *
1426  * Returns 0 if successful, or a negative error code.
1427  */
1428 int snd_hda_create_spdif_out_ctls(struct hda_codec *codec, hda_nid_t nid)
1429 {
1430         int err;
1431         struct snd_kcontrol *kctl;
1432         struct snd_kcontrol_new *dig_mix;
1433
1434         for (dig_mix = dig_mixes; dig_mix->name; dig_mix++) {
1435                 kctl = snd_ctl_new1(dig_mix, codec);
1436                 kctl->private_value = nid;
1437                 err = snd_ctl_add(codec->bus->card, kctl);
1438                 if (err < 0)
1439                         return err;
1440         }
1441         codec->spdif_ctls =
1442                 snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DIGI_CONVERT, 0);
1443         codec->spdif_status = convert_to_spdif_status(codec->spdif_ctls);
1444         return 0;
1445 }
1446
1447 /*
1448  * SPDIF input
1449  */
1450
1451 #define snd_hda_spdif_in_switch_info    snd_hda_spdif_out_switch_info
1452
1453 static int snd_hda_spdif_in_switch_get(struct snd_kcontrol *kcontrol,
1454                                        struct snd_ctl_elem_value *ucontrol)
1455 {
1456         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1457
1458         ucontrol->value.integer.value[0] = codec->spdif_in_enable;
1459         return 0;
1460 }
1461
1462 static int snd_hda_spdif_in_switch_put(struct snd_kcontrol *kcontrol,
1463                                        struct snd_ctl_elem_value *ucontrol)
1464 {
1465         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1466         hda_nid_t nid = kcontrol->private_value;
1467         unsigned int val = !!ucontrol->value.integer.value[0];
1468         int change;
1469
1470         mutex_lock(&codec->spdif_mutex);
1471         change = codec->spdif_in_enable != val;
1472         if (change) {
1473                 codec->spdif_in_enable = val;
1474                 snd_hda_codec_write_cache(codec, nid, 0,
1475                                           AC_VERB_SET_DIGI_CONVERT_1, val);
1476         }
1477         mutex_unlock(&codec->spdif_mutex);
1478         return change;
1479 }
1480
1481 static int snd_hda_spdif_in_status_get(struct snd_kcontrol *kcontrol,
1482                                        struct snd_ctl_elem_value *ucontrol)
1483 {
1484         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1485         hda_nid_t nid = kcontrol->private_value;
1486         unsigned short val;
1487         unsigned int sbits;
1488
1489         val = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DIGI_CONVERT, 0);
1490         sbits = convert_to_spdif_status(val);
1491         ucontrol->value.iec958.status[0] = sbits;
1492         ucontrol->value.iec958.status[1] = sbits >> 8;
1493         ucontrol->value.iec958.status[2] = sbits >> 16;
1494         ucontrol->value.iec958.status[3] = sbits >> 24;
1495         return 0;
1496 }
1497
1498 static struct snd_kcontrol_new dig_in_ctls[] = {
1499         {
1500                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1501                 .name = SNDRV_CTL_NAME_IEC958("",CAPTURE,SWITCH),
1502                 .info = snd_hda_spdif_in_switch_info,
1503                 .get = snd_hda_spdif_in_switch_get,
1504                 .put = snd_hda_spdif_in_switch_put,
1505         },
1506         {
1507                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
1508                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1509                 .name = SNDRV_CTL_NAME_IEC958("",CAPTURE,DEFAULT),
1510                 .info = snd_hda_spdif_mask_info,
1511                 .get = snd_hda_spdif_in_status_get,
1512         },
1513         { } /* end */
1514 };
1515
1516 /**
1517  * snd_hda_create_spdif_in_ctls - create Input SPDIF-related controls
1518  * @codec: the HDA codec
1519  * @nid: audio in widget NID
1520  *
1521  * Creates controls related with the SPDIF input.
1522  * Called from each patch supporting the SPDIF in.
1523  *
1524  * Returns 0 if successful, or a negative error code.
1525  */
1526 int snd_hda_create_spdif_in_ctls(struct hda_codec *codec, hda_nid_t nid)
1527 {
1528         int err;
1529         struct snd_kcontrol *kctl;
1530         struct snd_kcontrol_new *dig_mix;
1531
1532         for (dig_mix = dig_in_ctls; dig_mix->name; dig_mix++) {
1533                 kctl = snd_ctl_new1(dig_mix, codec);
1534                 kctl->private_value = nid;
1535                 err = snd_ctl_add(codec->bus->card, kctl);
1536                 if (err < 0)
1537                         return err;
1538         }
1539         codec->spdif_in_enable =
1540                 snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DIGI_CONVERT, 0) &
1541                 AC_DIG1_ENABLE;
1542         return 0;
1543 }
1544
1545 #ifdef SND_HDA_NEEDS_RESUME
1546 /*
1547  * command cache
1548  */
1549
1550 /* build a 32bit cache key with the widget id and the command parameter */
1551 #define build_cmd_cache_key(nid, verb)  ((verb << 8) | nid)
1552 #define get_cmd_cache_nid(key)          ((key) & 0xff)
1553 #define get_cmd_cache_cmd(key)          (((key) >> 8) & 0xffff)
1554
1555 /**
1556  * snd_hda_codec_write_cache - send a single command with caching
1557  * @codec: the HDA codec
1558  * @nid: NID to send the command
1559  * @direct: direct flag
1560  * @verb: the verb to send
1561  * @parm: the parameter for the verb
1562  *
1563  * Send a single command without waiting for response.
1564  *
1565  * Returns 0 if successful, or a negative error code.
1566  */
1567 int snd_hda_codec_write_cache(struct hda_codec *codec, hda_nid_t nid,
1568                               int direct, unsigned int verb, unsigned int parm)
1569 {
1570         int err;
1571         snd_hda_power_up(codec);
1572         mutex_lock(&codec->bus->cmd_mutex);
1573         err = codec->bus->ops.command(codec, nid, direct, verb, parm);
1574         if (!err) {
1575                 struct hda_cache_head *c;
1576                 u32 key = build_cmd_cache_key(nid, verb);
1577                 c = get_alloc_hash(&codec->cmd_cache, key);
1578                 if (c)
1579                         c->val = parm;
1580         }
1581         mutex_unlock(&codec->bus->cmd_mutex);
1582         snd_hda_power_down(codec);
1583         return err;
1584 }
1585
1586 /* resume the all commands from the cache */
1587 void snd_hda_codec_resume_cache(struct hda_codec *codec)
1588 {
1589         struct hda_cache_head *buffer = codec->cmd_cache.buffer;
1590         int i;
1591
1592         for (i = 0; i < codec->cmd_cache.size; i++, buffer++) {
1593                 u32 key = buffer->key;
1594                 if (!key)
1595                         continue;
1596                 snd_hda_codec_write(codec, get_cmd_cache_nid(key), 0,
1597                                     get_cmd_cache_cmd(key), buffer->val);
1598         }
1599 }
1600
1601 /**
1602  * snd_hda_sequence_write_cache - sequence writes with caching
1603  * @codec: the HDA codec
1604  * @seq: VERB array to send
1605  *
1606  * Send the commands sequentially from the given array.
1607  * Thte commands are recorded on cache for power-save and resume.
1608  * The array must be terminated with NID=0.
1609  */
1610 void snd_hda_sequence_write_cache(struct hda_codec *codec,
1611                                   const struct hda_verb *seq)
1612 {
1613         for (; seq->nid; seq++)
1614                 snd_hda_codec_write_cache(codec, seq->nid, 0, seq->verb,
1615                                           seq->param);
1616 }
1617 #endif /* SND_HDA_NEEDS_RESUME */
1618
1619 /*
1620  * set power state of the codec
1621  */
1622 static void hda_set_power_state(struct hda_codec *codec, hda_nid_t fg,
1623                                 unsigned int power_state)
1624 {
1625         hda_nid_t nid;
1626         int i;
1627
1628         snd_hda_codec_write(codec, fg, 0, AC_VERB_SET_POWER_STATE,
1629                             power_state);
1630
1631         nid = codec->start_nid;
1632         for (i = 0; i < codec->num_nodes; i++, nid++) {
1633                 if (get_wcaps(codec, nid) & AC_WCAP_POWER)
1634                         snd_hda_codec_write(codec, nid, 0,
1635                                             AC_VERB_SET_POWER_STATE,
1636                                             power_state);
1637         }
1638
1639         if (power_state == AC_PWRST_D0) {
1640                 unsigned long end_time;
1641                 int state;
1642                 msleep(10);
1643                 /* wait until the codec reachs to D0 */
1644                 end_time = jiffies + msecs_to_jiffies(500);
1645                 do {
1646                         state = snd_hda_codec_read(codec, fg, 0,
1647                                                    AC_VERB_GET_POWER_STATE, 0);
1648                         if (state == power_state)
1649                                 break;
1650                         msleep(1);
1651                 } while (time_after_eq(end_time, jiffies));
1652         }
1653 }
1654
1655 #ifdef SND_HDA_NEEDS_RESUME
1656 /*
1657  * call suspend and power-down; used both from PM and power-save
1658  */
1659 static void hda_call_codec_suspend(struct hda_codec *codec)
1660 {
1661         if (codec->patch_ops.suspend)
1662                 codec->patch_ops.suspend(codec, PMSG_SUSPEND);
1663         hda_set_power_state(codec,
1664                             codec->afg ? codec->afg : codec->mfg,
1665                             AC_PWRST_D3);
1666 #ifdef CONFIG_SND_HDA_POWER_SAVE
1667         cancel_delayed_work(&codec->power_work);
1668         codec->power_on = 0;
1669         codec->power_transition = 0;
1670 #endif
1671 }
1672
1673 /*
1674  * kick up codec; used both from PM and power-save
1675  */
1676 static void hda_call_codec_resume(struct hda_codec *codec)
1677 {
1678         hda_set_power_state(codec,
1679                             codec->afg ? codec->afg : codec->mfg,
1680                             AC_PWRST_D0);
1681         if (codec->patch_ops.resume)
1682                 codec->patch_ops.resume(codec);
1683         else {
1684                 if (codec->patch_ops.init)
1685                         codec->patch_ops.init(codec);
1686                 snd_hda_codec_resume_amp(codec);
1687                 snd_hda_codec_resume_cache(codec);
1688         }
1689 }
1690 #endif /* SND_HDA_NEEDS_RESUME */
1691
1692
1693 /**
1694  * snd_hda_build_controls - build mixer controls
1695  * @bus: the BUS
1696  *
1697  * Creates mixer controls for each codec included in the bus.
1698  *
1699  * Returns 0 if successful, otherwise a negative error code.
1700  */
1701 int __devinit snd_hda_build_controls(struct hda_bus *bus)
1702 {
1703         struct hda_codec *codec;
1704
1705         list_for_each_entry(codec, &bus->codec_list, list) {
1706                 int err = 0;
1707                 /* fake as if already powered-on */
1708                 hda_keep_power_on(codec);
1709                 /* then fire up */
1710                 hda_set_power_state(codec,
1711                                     codec->afg ? codec->afg : codec->mfg,
1712                                     AC_PWRST_D0);
1713                 /* continue to initialize... */
1714                 if (codec->patch_ops.init)
1715                         err = codec->patch_ops.init(codec);
1716                 if (!err && codec->patch_ops.build_controls)
1717                         err = codec->patch_ops.build_controls(codec);
1718                 snd_hda_power_down(codec);
1719                 if (err < 0)
1720                         return err;
1721         }
1722
1723         return 0;
1724 }
1725
1726 /*
1727  * stream formats
1728  */
1729 struct hda_rate_tbl {
1730         unsigned int hz;
1731         unsigned int alsa_bits;
1732         unsigned int hda_fmt;
1733 };
1734
1735 static struct hda_rate_tbl rate_bits[] = {
1736         /* rate in Hz, ALSA rate bitmask, HDA format value */
1737
1738         /* autodetected value used in snd_hda_query_supported_pcm */
1739         { 8000, SNDRV_PCM_RATE_8000, 0x0500 }, /* 1/6 x 48 */
1740         { 11025, SNDRV_PCM_RATE_11025, 0x4300 }, /* 1/4 x 44 */
1741         { 16000, SNDRV_PCM_RATE_16000, 0x0200 }, /* 1/3 x 48 */
1742         { 22050, SNDRV_PCM_RATE_22050, 0x4100 }, /* 1/2 x 44 */
1743         { 32000, SNDRV_PCM_RATE_32000, 0x0a00 }, /* 2/3 x 48 */
1744         { 44100, SNDRV_PCM_RATE_44100, 0x4000 }, /* 44 */
1745         { 48000, SNDRV_PCM_RATE_48000, 0x0000 }, /* 48 */
1746         { 88200, SNDRV_PCM_RATE_88200, 0x4800 }, /* 2 x 44 */
1747         { 96000, SNDRV_PCM_RATE_96000, 0x0800 }, /* 2 x 48 */
1748         { 176400, SNDRV_PCM_RATE_176400, 0x5800 },/* 4 x 44 */
1749         { 192000, SNDRV_PCM_RATE_192000, 0x1800 }, /* 4 x 48 */
1750 #define AC_PAR_PCM_RATE_BITS    11
1751         /* up to bits 10, 384kHZ isn't supported properly */
1752
1753         /* not autodetected value */
1754         { 9600, SNDRV_PCM_RATE_KNOT, 0x0400 }, /* 1/5 x 48 */
1755
1756         { 0 } /* terminator */
1757 };
1758
1759 /**
1760  * snd_hda_calc_stream_format - calculate format bitset
1761  * @rate: the sample rate
1762  * @channels: the number of channels
1763  * @format: the PCM format (SNDRV_PCM_FORMAT_XXX)
1764  * @maxbps: the max. bps
1765  *
1766  * Calculate the format bitset from the given rate, channels and th PCM format.
1767  *
1768  * Return zero if invalid.
1769  */
1770 unsigned int snd_hda_calc_stream_format(unsigned int rate,
1771                                         unsigned int channels,
1772                                         unsigned int format,
1773                                         unsigned int maxbps)
1774 {
1775         int i;
1776         unsigned int val = 0;
1777
1778         for (i = 0; rate_bits[i].hz; i++)
1779                 if (rate_bits[i].hz == rate) {
1780                         val = rate_bits[i].hda_fmt;
1781                         break;
1782                 }
1783         if (!rate_bits[i].hz) {
1784                 snd_printdd("invalid rate %d\n", rate);
1785                 return 0;
1786         }
1787
1788         if (channels == 0 || channels > 8) {
1789                 snd_printdd("invalid channels %d\n", channels);
1790                 return 0;
1791         }
1792         val |= channels - 1;
1793
1794         switch (snd_pcm_format_width(format)) {
1795         case 8:  val |= 0x00; break;
1796         case 16: val |= 0x10; break;
1797         case 20:
1798         case 24:
1799         case 32:
1800                 if (maxbps >= 32)
1801                         val |= 0x40;
1802                 else if (maxbps >= 24)
1803                         val |= 0x30;
1804                 else
1805                         val |= 0x20;
1806                 break;
1807         default:
1808                 snd_printdd("invalid format width %d\n",
1809                             snd_pcm_format_width(format));
1810                 return 0;
1811         }
1812
1813         return val;
1814 }
1815
1816 /**
1817  * snd_hda_query_supported_pcm - query the supported PCM rates and formats
1818  * @codec: the HDA codec
1819  * @nid: NID to query
1820  * @ratesp: the pointer to store the detected rate bitflags
1821  * @formatsp: the pointer to store the detected formats
1822  * @bpsp: the pointer to store the detected format widths
1823  *
1824  * Queries the supported PCM rates and formats.  The NULL @ratesp, @formatsp
1825  * or @bsps argument is ignored.
1826  *
1827  * Returns 0 if successful, otherwise a negative error code.
1828  */
1829 int snd_hda_query_supported_pcm(struct hda_codec *codec, hda_nid_t nid,
1830                                 u32 *ratesp, u64 *formatsp, unsigned int *bpsp)
1831 {
1832         int i;
1833         unsigned int val, streams;
1834
1835         val = 0;
1836         if (nid != codec->afg &&
1837             (get_wcaps(codec, nid) & AC_WCAP_FORMAT_OVRD)) {
1838                 val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
1839                 if (val == -1)
1840                         return -EIO;
1841         }
1842         if (!val)
1843                 val = snd_hda_param_read(codec, codec->afg, AC_PAR_PCM);
1844
1845         if (ratesp) {
1846                 u32 rates = 0;
1847                 for (i = 0; i < AC_PAR_PCM_RATE_BITS; i++) {
1848                         if (val & (1 << i))
1849                                 rates |= rate_bits[i].alsa_bits;
1850                 }
1851                 *ratesp = rates;
1852         }
1853
1854         if (formatsp || bpsp) {
1855                 u64 formats = 0;
1856                 unsigned int bps;
1857                 unsigned int wcaps;
1858
1859                 wcaps = get_wcaps(codec, nid);
1860                 streams = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
1861                 if (streams == -1)
1862                         return -EIO;
1863                 if (!streams) {
1864                         streams = snd_hda_param_read(codec, codec->afg,
1865                                                      AC_PAR_STREAM);
1866                         if (streams == -1)
1867                                 return -EIO;
1868                 }
1869
1870                 bps = 0;
1871                 if (streams & AC_SUPFMT_PCM) {
1872                         if (val & AC_SUPPCM_BITS_8) {
1873                                 formats |= SNDRV_PCM_FMTBIT_U8;
1874                                 bps = 8;
1875                         }
1876                         if (val & AC_SUPPCM_BITS_16) {
1877                                 formats |= SNDRV_PCM_FMTBIT_S16_LE;
1878                                 bps = 16;
1879                         }
1880                         if (wcaps & AC_WCAP_DIGITAL) {
1881                                 if (val & AC_SUPPCM_BITS_32)
1882                                         formats |= SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE;
1883                                 if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24))
1884                                         formats |= SNDRV_PCM_FMTBIT_S32_LE;
1885                                 if (val & AC_SUPPCM_BITS_24)
1886                                         bps = 24;
1887                                 else if (val & AC_SUPPCM_BITS_20)
1888                                         bps = 20;
1889                         } else if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24|
1890                                           AC_SUPPCM_BITS_32)) {
1891                                 formats |= SNDRV_PCM_FMTBIT_S32_LE;
1892                                 if (val & AC_SUPPCM_BITS_32)
1893                                         bps = 32;
1894                                 else if (val & AC_SUPPCM_BITS_24)
1895                                         bps = 24;
1896                                 else if (val & AC_SUPPCM_BITS_20)
1897                                         bps = 20;
1898                         }
1899                 }
1900                 else if (streams == AC_SUPFMT_FLOAT32) {
1901                         /* should be exclusive */
1902                         formats |= SNDRV_PCM_FMTBIT_FLOAT_LE;
1903                         bps = 32;
1904                 } else if (streams == AC_SUPFMT_AC3) {
1905                         /* should be exclusive */
1906                         /* temporary hack: we have still no proper support
1907                          * for the direct AC3 stream...
1908                          */
1909                         formats |= SNDRV_PCM_FMTBIT_U8;
1910                         bps = 8;
1911                 }
1912                 if (formatsp)
1913                         *formatsp = formats;
1914                 if (bpsp)
1915                         *bpsp = bps;
1916         }
1917
1918         return 0;
1919 }
1920
1921 /**
1922  * snd_hda_is_supported_format - check whether the given node supports
1923  * the format val
1924  *
1925  * Returns 1 if supported, 0 if not.
1926  */
1927 int snd_hda_is_supported_format(struct hda_codec *codec, hda_nid_t nid,
1928                                 unsigned int format)
1929 {
1930         int i;
1931         unsigned int val = 0, rate, stream;
1932
1933         if (nid != codec->afg &&
1934             (get_wcaps(codec, nid) & AC_WCAP_FORMAT_OVRD)) {
1935                 val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
1936                 if (val == -1)
1937                         return 0;
1938         }
1939         if (!val) {
1940                 val = snd_hda_param_read(codec, codec->afg, AC_PAR_PCM);
1941                 if (val == -1)
1942                         return 0;
1943         }
1944
1945         rate = format & 0xff00;
1946         for (i = 0; i < AC_PAR_PCM_RATE_BITS; i++)
1947                 if (rate_bits[i].hda_fmt == rate) {
1948                         if (val & (1 << i))
1949                                 break;
1950                         return 0;
1951                 }
1952         if (i >= AC_PAR_PCM_RATE_BITS)
1953                 return 0;
1954
1955         stream = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
1956         if (stream == -1)
1957                 return 0;
1958         if (!stream && nid != codec->afg)
1959                 stream = snd_hda_param_read(codec, codec->afg, AC_PAR_STREAM);
1960         if (!stream || stream == -1)
1961                 return 0;
1962
1963         if (stream & AC_SUPFMT_PCM) {
1964                 switch (format & 0xf0) {
1965                 case 0x00:
1966                         if (!(val & AC_SUPPCM_BITS_8))
1967                                 return 0;
1968                         break;
1969                 case 0x10:
1970                         if (!(val & AC_SUPPCM_BITS_16))
1971                                 return 0;
1972                         break;
1973                 case 0x20:
1974                         if (!(val & AC_SUPPCM_BITS_20))
1975                                 return 0;
1976                         break;
1977                 case 0x30:
1978                         if (!(val & AC_SUPPCM_BITS_24))
1979                                 return 0;
1980                         break;
1981                 case 0x40:
1982                         if (!(val & AC_SUPPCM_BITS_32))
1983                                 return 0;
1984                         break;
1985                 default:
1986                         return 0;
1987                 }
1988         } else {
1989                 /* FIXME: check for float32 and AC3? */
1990         }
1991
1992         return 1;
1993 }
1994
1995 /*
1996  * PCM stuff
1997  */
1998 static int hda_pcm_default_open_close(struct hda_pcm_stream *hinfo,
1999                                       struct hda_codec *codec,
2000                                       struct snd_pcm_substream *substream)
2001 {
2002         return 0;
2003 }
2004
2005 static int hda_pcm_default_prepare(struct hda_pcm_stream *hinfo,
2006                                    struct hda_codec *codec,
2007                                    unsigned int stream_tag,
2008                                    unsigned int format,
2009                                    struct snd_pcm_substream *substream)
2010 {
2011         snd_hda_codec_setup_stream(codec, hinfo->nid, stream_tag, 0, format);
2012         return 0;
2013 }
2014
2015 static int hda_pcm_default_cleanup(struct hda_pcm_stream *hinfo,
2016                                    struct hda_codec *codec,
2017                                    struct snd_pcm_substream *substream)
2018 {
2019         snd_hda_codec_setup_stream(codec, hinfo->nid, 0, 0, 0);
2020         return 0;
2021 }
2022
2023 static int __devinit set_pcm_default_values(struct hda_codec *codec,
2024                                             struct hda_pcm_stream *info)
2025 {
2026         /* query support PCM information from the given NID */
2027         if (info->nid && (!info->rates || !info->formats)) {
2028                 snd_hda_query_supported_pcm(codec, info->nid,
2029                                 info->rates ? NULL : &info->rates,
2030                                 info->formats ? NULL : &info->formats,
2031                                 info->maxbps ? NULL : &info->maxbps);
2032         }
2033         if (info->ops.open == NULL)
2034                 info->ops.open = hda_pcm_default_open_close;
2035         if (info->ops.close == NULL)
2036                 info->ops.close = hda_pcm_default_open_close;
2037         if (info->ops.prepare == NULL) {
2038                 snd_assert(info->nid, return -EINVAL);
2039                 info->ops.prepare = hda_pcm_default_prepare;
2040         }
2041         if (info->ops.cleanup == NULL) {
2042                 snd_assert(info->nid, return -EINVAL);
2043                 info->ops.cleanup = hda_pcm_default_cleanup;
2044         }
2045         return 0;
2046 }
2047
2048 /**
2049  * snd_hda_build_pcms - build PCM information
2050  * @bus: the BUS
2051  *
2052  * Create PCM information for each codec included in the bus.
2053  *
2054  * The build_pcms codec patch is requested to set up codec->num_pcms and
2055  * codec->pcm_info properly.  The array is referred by the top-level driver
2056  * to create its PCM instances.
2057  * The allocated codec->pcm_info should be released in codec->patch_ops.free
2058  * callback.
2059  *
2060  * At least, substreams, channels_min and channels_max must be filled for
2061  * each stream.  substreams = 0 indicates that the stream doesn't exist.
2062  * When rates and/or formats are zero, the supported values are queried
2063  * from the given nid.  The nid is used also by the default ops.prepare
2064  * and ops.cleanup callbacks.
2065  *
2066  * The driver needs to call ops.open in its open callback.  Similarly,
2067  * ops.close is supposed to be called in the close callback.
2068  * ops.prepare should be called in the prepare or hw_params callback
2069  * with the proper parameters for set up.
2070  * ops.cleanup should be called in hw_free for clean up of streams.
2071  *
2072  * This function returns 0 if successfull, or a negative error code.
2073  */
2074 int __devinit snd_hda_build_pcms(struct hda_bus *bus)
2075 {
2076         struct hda_codec *codec;
2077
2078         list_for_each_entry(codec, &bus->codec_list, list) {
2079                 unsigned int pcm, s;
2080                 int err;
2081                 if (!codec->patch_ops.build_pcms)
2082                         continue;
2083                 err = codec->patch_ops.build_pcms(codec);
2084                 if (err < 0)
2085                         return err;
2086                 for (pcm = 0; pcm < codec->num_pcms; pcm++) {
2087                         for (s = 0; s < 2; s++) {
2088                                 struct hda_pcm_stream *info;
2089                                 info = &codec->pcm_info[pcm].stream[s];
2090                                 if (!info->substreams)
2091                                         continue;
2092                                 err = set_pcm_default_values(codec, info);
2093                                 if (err < 0)
2094                                         return err;
2095                         }
2096                 }
2097         }
2098         return 0;
2099 }
2100
2101 /**
2102  * snd_hda_check_board_config - compare the current codec with the config table
2103  * @codec: the HDA codec
2104  * @num_configs: number of config enums
2105  * @models: array of model name strings
2106  * @tbl: configuration table, terminated by null entries
2107  *
2108  * Compares the modelname or PCI subsystem id of the current codec with the
2109  * given configuration table.  If a matching entry is found, returns its
2110  * config value (supposed to be 0 or positive).
2111  *
2112  * If no entries are matching, the function returns a negative value.
2113  */
2114 int snd_hda_check_board_config(struct hda_codec *codec,
2115                                int num_configs, const char **models,
2116                                const struct snd_pci_quirk *tbl)
2117 {
2118         if (codec->bus->modelname && models) {
2119                 int i;
2120                 for (i = 0; i < num_configs; i++) {
2121                         if (models[i] &&
2122                             !strcmp(codec->bus->modelname, models[i])) {
2123                                 snd_printd(KERN_INFO "hda_codec: model '%s' is "
2124                                            "selected\n", models[i]);
2125                                 return i;
2126                         }
2127                 }
2128         }
2129
2130         if (!codec->bus->pci || !tbl)
2131                 return -1;
2132
2133         tbl = snd_pci_quirk_lookup(codec->bus->pci, tbl);
2134         if (!tbl)
2135                 return -1;
2136         if (tbl->value >= 0 && tbl->value < num_configs) {
2137 #ifdef CONFIG_SND_DEBUG_DETECT
2138                 char tmp[10];
2139                 const char *model = NULL;
2140                 if (models)
2141                         model = models[tbl->value];
2142                 if (!model) {
2143                         sprintf(tmp, "#%d", tbl->value);
2144                         model = tmp;
2145                 }
2146                 snd_printdd(KERN_INFO "hda_codec: model '%s' is selected "
2147                             "for config %x:%x (%s)\n",
2148                             model, tbl->subvendor, tbl->subdevice,
2149                             (tbl->name ? tbl->name : "Unknown device"));
2150 #endif
2151                 return tbl->value;
2152         }
2153         return -1;
2154 }
2155
2156 /**
2157  * snd_hda_add_new_ctls - create controls from the array
2158  * @codec: the HDA codec
2159  * @knew: the array of struct snd_kcontrol_new
2160  *
2161  * This helper function creates and add new controls in the given array.
2162  * The array must be terminated with an empty entry as terminator.
2163  *
2164  * Returns 0 if successful, or a negative error code.
2165  */
2166 int snd_hda_add_new_ctls(struct hda_codec *codec, struct snd_kcontrol_new *knew)
2167 {
2168         int err;
2169
2170         for (; knew->name; knew++) {
2171                 struct snd_kcontrol *kctl;
2172                 kctl = snd_ctl_new1(knew, codec);
2173                 if (!kctl)
2174                         return -ENOMEM;
2175                 err = snd_ctl_add(codec->bus->card, kctl);
2176                 if (err < 0) {
2177                         if (!codec->addr)
2178                                 return err;
2179                         kctl = snd_ctl_new1(knew, codec);
2180                         if (!kctl)
2181                                 return -ENOMEM;
2182                         kctl->id.device = codec->addr;
2183                         err = snd_ctl_add(codec->bus->card, kctl);
2184                         if (err < 0)
2185                                 return err;
2186                 }
2187         }
2188         return 0;
2189 }
2190
2191 #ifdef CONFIG_SND_HDA_POWER_SAVE
2192 static void hda_set_power_state(struct hda_codec *codec, hda_nid_t fg,
2193                                 unsigned int power_state);
2194
2195 static void hda_power_work(struct work_struct *work)
2196 {
2197         struct hda_codec *codec =
2198                 container_of(work, struct hda_codec, power_work.work);
2199
2200         if (!codec->power_on || codec->power_count) {
2201                 codec->power_transition = 0;
2202                 return;
2203         }
2204
2205         hda_call_codec_suspend(codec);
2206         if (codec->bus->ops.pm_notify)
2207                 codec->bus->ops.pm_notify(codec);
2208 }
2209
2210 static void hda_keep_power_on(struct hda_codec *codec)
2211 {
2212         codec->power_count++;
2213         codec->power_on = 1;
2214 }
2215
2216 void snd_hda_power_up(struct hda_codec *codec)
2217 {
2218         codec->power_count++;
2219         if (codec->power_on || codec->power_transition)
2220                 return;
2221
2222         codec->power_on = 1;
2223         if (codec->bus->ops.pm_notify)
2224                 codec->bus->ops.pm_notify(codec);
2225         hda_call_codec_resume(codec);
2226         cancel_delayed_work(&codec->power_work);
2227         codec->power_transition = 0;
2228 }
2229
2230 void snd_hda_power_down(struct hda_codec *codec)
2231 {
2232         --codec->power_count;
2233         if (!codec->power_on || codec->power_count || codec->power_transition)
2234                 return;
2235         if (power_save) {
2236                 codec->power_transition = 1; /* avoid reentrance */
2237                 schedule_delayed_work(&codec->power_work,
2238                                       msecs_to_jiffies(power_save * 1000));
2239         }
2240 }
2241
2242 int snd_hda_check_amp_list_power(struct hda_codec *codec,
2243                                  struct hda_loopback_check *check,
2244                                  hda_nid_t nid)
2245 {
2246         struct hda_amp_list *p;
2247         int ch, v;
2248
2249         if (!check->amplist)
2250                 return 0;
2251         for (p = check->amplist; p->nid; p++) {
2252                 if (p->nid == nid)
2253                         break;
2254         }
2255         if (!p->nid)
2256                 return 0; /* nothing changed */
2257
2258         for (p = check->amplist; p->nid; p++) {
2259                 for (ch = 0; ch < 2; ch++) {
2260                         v = snd_hda_codec_amp_read(codec, p->nid, ch, p->dir,
2261                                                    p->idx);
2262                         if (!(v & HDA_AMP_MUTE) && v > 0) {
2263                                 if (!check->power_on) {
2264                                         check->power_on = 1;
2265                                         snd_hda_power_up(codec);
2266                                 }
2267                                 return 1;
2268                         }
2269                 }
2270         }
2271         if (check->power_on) {
2272                 check->power_on = 0;
2273                 snd_hda_power_down(codec);
2274         }
2275         return 0;
2276 }
2277 #endif
2278
2279 /*
2280  * Channel mode helper
2281  */
2282 int snd_hda_ch_mode_info(struct hda_codec *codec,
2283                          struct snd_ctl_elem_info *uinfo,
2284                          const struct hda_channel_mode *chmode,
2285                          int num_chmodes)
2286 {
2287         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2288         uinfo->count = 1;
2289         uinfo->value.enumerated.items = num_chmodes;
2290         if (uinfo->value.enumerated.item >= num_chmodes)
2291                 uinfo->value.enumerated.item = num_chmodes - 1;
2292         sprintf(uinfo->value.enumerated.name, "%dch",
2293                 chmode[uinfo->value.enumerated.item].channels);
2294         return 0;
2295 }
2296
2297 int snd_hda_ch_mode_get(struct hda_codec *codec,
2298                         struct snd_ctl_elem_value *ucontrol,
2299                         const struct hda_channel_mode *chmode,
2300                         int num_chmodes,
2301                         int max_channels)
2302 {
2303         int i;
2304
2305         for (i = 0; i < num_chmodes; i++) {
2306                 if (max_channels == chmode[i].channels) {
2307                         ucontrol->value.enumerated.item[0] = i;
2308                         break;
2309                 }
2310         }
2311         return 0;
2312 }
2313
2314 int snd_hda_ch_mode_put(struct hda_codec *codec,
2315                         struct snd_ctl_elem_value *ucontrol,
2316                         const struct hda_channel_mode *chmode,
2317                         int num_chmodes,
2318                         int *max_channelsp)
2319 {
2320         unsigned int mode;
2321
2322         mode = ucontrol->value.enumerated.item[0];
2323         snd_assert(mode < num_chmodes, return -EINVAL);
2324         if (*max_channelsp == chmode[mode].channels)
2325                 return 0;
2326         /* change the current channel setting */
2327         *max_channelsp = chmode[mode].channels;
2328         if (chmode[mode].sequence)
2329                 snd_hda_sequence_write_cache(codec, chmode[mode].sequence);
2330         return 1;
2331 }
2332
2333 /*
2334  * input MUX helper
2335  */
2336 int snd_hda_input_mux_info(const struct hda_input_mux *imux,
2337                            struct snd_ctl_elem_info *uinfo)
2338 {
2339         unsigned int index;
2340
2341         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2342         uinfo->count = 1;
2343         uinfo->value.enumerated.items = imux->num_items;
2344         index = uinfo->value.enumerated.item;
2345         if (index >= imux->num_items)
2346                 index = imux->num_items - 1;
2347         strcpy(uinfo->value.enumerated.name, imux->items[index].label);
2348         return 0;
2349 }
2350
2351 int snd_hda_input_mux_put(struct hda_codec *codec,
2352                           const struct hda_input_mux *imux,
2353                           struct snd_ctl_elem_value *ucontrol,
2354                           hda_nid_t nid,
2355                           unsigned int *cur_val)
2356 {
2357         unsigned int idx;
2358
2359         idx = ucontrol->value.enumerated.item[0];
2360         if (idx >= imux->num_items)
2361                 idx = imux->num_items - 1;
2362         if (*cur_val == idx)
2363                 return 0;
2364         snd_hda_codec_write_cache(codec, nid, 0, AC_VERB_SET_CONNECT_SEL,
2365                                   imux->items[idx].index);
2366         *cur_val = idx;
2367         return 1;
2368 }
2369
2370
2371 /*
2372  * Multi-channel / digital-out PCM helper functions
2373  */
2374
2375 /* setup SPDIF output stream */
2376 static void setup_dig_out_stream(struct hda_codec *codec, hda_nid_t nid,
2377                                  unsigned int stream_tag, unsigned int format)
2378 {
2379         /* turn off SPDIF once; otherwise the IEC958 bits won't be updated */
2380         if (codec->spdif_ctls & AC_DIG1_ENABLE)
2381                 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_1,
2382                                     codec->spdif_ctls & ~AC_DIG1_ENABLE & 0xff);
2383         snd_hda_codec_setup_stream(codec, nid, stream_tag, 0, format);
2384         /* turn on again (if needed) */
2385         if (codec->spdif_ctls & AC_DIG1_ENABLE)
2386                 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_1,
2387                                     codec->spdif_ctls & 0xff);
2388 }
2389
2390 /*
2391  * open the digital out in the exclusive mode
2392  */
2393 int snd_hda_multi_out_dig_open(struct hda_codec *codec,
2394                                struct hda_multi_out *mout)
2395 {
2396         mutex_lock(&codec->spdif_mutex);
2397         if (mout->dig_out_used == HDA_DIG_ANALOG_DUP)
2398                 /* already opened as analog dup; reset it once */
2399                 snd_hda_codec_setup_stream(codec, mout->dig_out_nid, 0, 0, 0);
2400         mout->dig_out_used = HDA_DIG_EXCLUSIVE;
2401         mutex_unlock(&codec->spdif_mutex);
2402         return 0;
2403 }
2404
2405 int snd_hda_multi_out_dig_prepare(struct hda_codec *codec,
2406                                   struct hda_multi_out *mout,
2407                                   unsigned int stream_tag,
2408                                   unsigned int format,
2409                                   struct snd_pcm_substream *substream)
2410 {
2411         mutex_lock(&codec->spdif_mutex);
2412         setup_dig_out_stream(codec, mout->dig_out_nid, stream_tag, format);
2413         mutex_unlock(&codec->spdif_mutex);
2414         return 0;
2415 }
2416
2417 /*
2418  * release the digital out
2419  */
2420 int snd_hda_multi_out_dig_close(struct hda_codec *codec,
2421                                 struct hda_multi_out *mout)
2422 {
2423         mutex_lock(&codec->spdif_mutex);
2424         mout->dig_out_used = 0;
2425         mutex_unlock(&codec->spdif_mutex);
2426         return 0;
2427 }
2428
2429 /*
2430  * set up more restrictions for analog out
2431  */
2432 int snd_hda_multi_out_analog_open(struct hda_codec *codec,
2433                                   struct hda_multi_out *mout,
2434                                   struct snd_pcm_substream *substream)
2435 {
2436         substream->runtime->hw.channels_max = mout->max_channels;
2437         return snd_pcm_hw_constraint_step(substream->runtime, 0,
2438                                           SNDRV_PCM_HW_PARAM_CHANNELS, 2);
2439 }
2440
2441 /*
2442  * set up the i/o for analog out
2443  * when the digital out is available, copy the front out to digital out, too.
2444  */
2445 int snd_hda_multi_out_analog_prepare(struct hda_codec *codec,
2446                                      struct hda_multi_out *mout,
2447                                      unsigned int stream_tag,
2448                                      unsigned int format,
2449                                      struct snd_pcm_substream *substream)
2450 {
2451         hda_nid_t *nids = mout->dac_nids;
2452         int chs = substream->runtime->channels;
2453         int i;
2454
2455         mutex_lock(&codec->spdif_mutex);
2456         if (mout->dig_out_nid && mout->dig_out_used != HDA_DIG_EXCLUSIVE) {
2457                 if (chs == 2 &&
2458                     snd_hda_is_supported_format(codec, mout->dig_out_nid,
2459                                                 format) &&
2460                     !(codec->spdif_status & IEC958_AES0_NONAUDIO)) {
2461                         mout->dig_out_used = HDA_DIG_ANALOG_DUP;
2462                         setup_dig_out_stream(codec, mout->dig_out_nid,
2463                                              stream_tag, format);
2464                 } else {
2465                         mout->dig_out_used = 0;
2466                         snd_hda_codec_setup_stream(codec, mout->dig_out_nid,
2467                                                    0, 0, 0);
2468                 }
2469         }
2470         mutex_unlock(&codec->spdif_mutex);
2471
2472         /* front */
2473         snd_hda_codec_setup_stream(codec, nids[HDA_FRONT], stream_tag,
2474                                    0, format);
2475         if (mout->hp_nid && mout->hp_nid != nids[HDA_FRONT])
2476                 /* headphone out will just decode front left/right (stereo) */
2477                 snd_hda_codec_setup_stream(codec, mout->hp_nid, stream_tag,
2478                                            0, format);
2479         /* extra outputs copied from front */
2480         for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++)
2481                 if (mout->extra_out_nid[i])
2482                         snd_hda_codec_setup_stream(codec,
2483                                                    mout->extra_out_nid[i],
2484                                                    stream_tag, 0, format);
2485
2486         /* surrounds */
2487         for (i = 1; i < mout->num_dacs; i++) {
2488                 if (chs >= (i + 1) * 2) /* independent out */
2489                         snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
2490                                                    i * 2, format);
2491                 else /* copy front */
2492                         snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
2493                                                    0, format);
2494         }
2495         return 0;
2496 }
2497
2498 /*
2499  * clean up the setting for analog out
2500  */
2501 int snd_hda_multi_out_analog_cleanup(struct hda_codec *codec,
2502                                      struct hda_multi_out *mout)
2503 {
2504         hda_nid_t *nids = mout->dac_nids;
2505         int i;
2506
2507         for (i = 0; i < mout->num_dacs; i++)
2508                 snd_hda_codec_setup_stream(codec, nids[i], 0, 0, 0);
2509         if (mout->hp_nid)
2510                 snd_hda_codec_setup_stream(codec, mout->hp_nid, 0, 0, 0);
2511         for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++)
2512                 if (mout->extra_out_nid[i])
2513                         snd_hda_codec_setup_stream(codec,
2514                                                    mout->extra_out_nid[i],
2515                                                    0, 0, 0);
2516         mutex_lock(&codec->spdif_mutex);
2517         if (mout->dig_out_nid && mout->dig_out_used == HDA_DIG_ANALOG_DUP) {
2518                 snd_hda_codec_setup_stream(codec, mout->dig_out_nid, 0, 0, 0);
2519                 mout->dig_out_used = 0;
2520         }
2521         mutex_unlock(&codec->spdif_mutex);
2522         return 0;
2523 }
2524
2525 /*
2526  * Helper for automatic ping configuration
2527  */
2528
2529 static int is_in_nid_list(hda_nid_t nid, hda_nid_t *list)
2530 {
2531         for (; *list; list++)
2532                 if (*list == nid)
2533                         return 1;
2534         return 0;
2535 }
2536
2537
2538 /*
2539  * Sort an associated group of pins according to their sequence numbers.
2540  */
2541 static void sort_pins_by_sequence(hda_nid_t * pins, short * sequences,
2542                                   int num_pins)
2543 {
2544         int i, j;
2545         short seq;
2546         hda_nid_t nid;
2547         
2548         for (i = 0; i < num_pins; i++) {
2549                 for (j = i + 1; j < num_pins; j++) {
2550                         if (sequences[i] > sequences[j]) {
2551                                 seq = sequences[i];
2552                                 sequences[i] = sequences[j];
2553                                 sequences[j] = seq;
2554                                 nid = pins[i];
2555                                 pins[i] = pins[j];
2556                                 pins[j] = nid;
2557                         }
2558                 }
2559         }
2560 }
2561
2562
2563 /*
2564  * Parse all pin widgets and store the useful pin nids to cfg
2565  *
2566  * The number of line-outs or any primary output is stored in line_outs,
2567  * and the corresponding output pins are assigned to line_out_pins[],
2568  * in the order of front, rear, CLFE, side, ...
2569  *
2570  * If more extra outputs (speaker and headphone) are found, the pins are
2571  * assisnged to hp_pins[] and speaker_pins[], respectively.  If no line-out jack
2572  * is detected, one of speaker of HP pins is assigned as the primary
2573  * output, i.e. to line_out_pins[0].  So, line_outs is always positive
2574  * if any analog output exists.
2575  * 
2576  * The analog input pins are assigned to input_pins array.
2577  * The digital input/output pins are assigned to dig_in_pin and dig_out_pin,
2578  * respectively.
2579  */
2580 int snd_hda_parse_pin_def_config(struct hda_codec *codec,
2581                                  struct auto_pin_cfg *cfg,
2582                                  hda_nid_t *ignore_nids)
2583 {
2584         hda_nid_t nid, nid_start;
2585         int nodes;
2586         short seq, assoc_line_out, assoc_speaker;
2587         short sequences_line_out[ARRAY_SIZE(cfg->line_out_pins)];
2588         short sequences_speaker[ARRAY_SIZE(cfg->speaker_pins)];
2589
2590         memset(cfg, 0, sizeof(*cfg));
2591
2592         memset(sequences_line_out, 0, sizeof(sequences_line_out));
2593         memset(sequences_speaker, 0, sizeof(sequences_speaker));
2594         assoc_line_out = assoc_speaker = 0;
2595
2596         nodes = snd_hda_get_sub_nodes(codec, codec->afg, &nid_start);
2597         for (nid = nid_start; nid < nodes + nid_start; nid++) {
2598                 unsigned int wid_caps = get_wcaps(codec, nid);
2599                 unsigned int wid_type =
2600                         (wid_caps & AC_WCAP_TYPE) >> AC_WCAP_TYPE_SHIFT;
2601                 unsigned int def_conf;
2602                 short assoc, loc;
2603
2604                 /* read all default configuration for pin complex */
2605                 if (wid_type != AC_WID_PIN)
2606                         continue;
2607                 /* ignore the given nids (e.g. pc-beep returns error) */
2608                 if (ignore_nids && is_in_nid_list(nid, ignore_nids))
2609                         continue;
2610
2611                 def_conf = snd_hda_codec_read(codec, nid, 0,
2612                                               AC_VERB_GET_CONFIG_DEFAULT, 0);
2613                 if (get_defcfg_connect(def_conf) == AC_JACK_PORT_NONE)
2614                         continue;
2615                 loc = get_defcfg_location(def_conf);
2616                 switch (get_defcfg_device(def_conf)) {
2617                 case AC_JACK_LINE_OUT:
2618                         seq = get_defcfg_sequence(def_conf);
2619                         assoc = get_defcfg_association(def_conf);
2620                         if (!assoc)
2621                                 continue;
2622                         if (!assoc_line_out)
2623                                 assoc_line_out = assoc;
2624                         else if (assoc_line_out != assoc)
2625                                 continue;
2626                         if (cfg->line_outs >= ARRAY_SIZE(cfg->line_out_pins))
2627                                 continue;
2628                         cfg->line_out_pins[cfg->line_outs] = nid;
2629                         sequences_line_out[cfg->line_outs] = seq;
2630                         cfg->line_outs++;
2631                         break;
2632                 case AC_JACK_SPEAKER:
2633                         seq = get_defcfg_sequence(def_conf);
2634                         assoc = get_defcfg_association(def_conf);
2635                         if (! assoc)
2636                                 continue;
2637                         if (! assoc_speaker)
2638                                 assoc_speaker = assoc;
2639                         else if (assoc_speaker != assoc)
2640                                 continue;
2641                         if (cfg->speaker_outs >= ARRAY_SIZE(cfg->speaker_pins))
2642                                 continue;
2643                         cfg->speaker_pins[cfg->speaker_outs] = nid;
2644                         sequences_speaker[cfg->speaker_outs] = seq;
2645                         cfg->speaker_outs++;
2646                         break;
2647                 case AC_JACK_HP_OUT:
2648                         if (cfg->hp_outs >= ARRAY_SIZE(cfg->hp_pins))
2649                                 continue;
2650                         cfg->hp_pins[cfg->hp_outs] = nid;
2651                         cfg->hp_outs++;
2652                         break;
2653                 case AC_JACK_MIC_IN: {
2654                         int preferred, alt;
2655                         if (loc == AC_JACK_LOC_FRONT) {
2656                                 preferred = AUTO_PIN_FRONT_MIC;
2657                                 alt = AUTO_PIN_MIC;
2658                         } else {
2659                                 preferred = AUTO_PIN_MIC;
2660                                 alt = AUTO_PIN_FRONT_MIC;
2661                         }
2662                         if (!cfg->input_pins[preferred])
2663                                 cfg->input_pins[preferred] = nid;
2664                         else if (!cfg->input_pins[alt])
2665                                 cfg->input_pins[alt] = nid;
2666                         break;
2667                 }
2668                 case AC_JACK_LINE_IN:
2669                         if (loc == AC_JACK_LOC_FRONT)
2670                                 cfg->input_pins[AUTO_PIN_FRONT_LINE] = nid;
2671                         else
2672                                 cfg->input_pins[AUTO_PIN_LINE] = nid;
2673                         break;
2674                 case AC_JACK_CD:
2675                         cfg->input_pins[AUTO_PIN_CD] = nid;
2676                         break;
2677                 case AC_JACK_AUX:
2678                         cfg->input_pins[AUTO_PIN_AUX] = nid;
2679                         break;
2680                 case AC_JACK_SPDIF_OUT:
2681                         cfg->dig_out_pin = nid;
2682                         break;
2683                 case AC_JACK_SPDIF_IN:
2684                         cfg->dig_in_pin = nid;
2685                         break;
2686                 }
2687         }
2688
2689         /* sort by sequence */
2690         sort_pins_by_sequence(cfg->line_out_pins, sequences_line_out,
2691                               cfg->line_outs);
2692         sort_pins_by_sequence(cfg->speaker_pins, sequences_speaker,
2693                               cfg->speaker_outs);
2694         
2695         /*
2696          * FIX-UP: if no line-outs are detected, try to use speaker or HP pin
2697          * as a primary output
2698          */
2699         if (!cfg->line_outs) {
2700                 if (cfg->speaker_outs) {
2701                         cfg->line_outs = cfg->speaker_outs;
2702                         memcpy(cfg->line_out_pins, cfg->speaker_pins,
2703                                sizeof(cfg->speaker_pins));
2704                         cfg->speaker_outs = 0;
2705                         memset(cfg->speaker_pins, 0, sizeof(cfg->speaker_pins));
2706                         cfg->line_out_type = AUTO_PIN_SPEAKER_OUT;
2707                 } else if (cfg->hp_outs) {
2708                         cfg->line_outs = cfg->hp_outs;
2709                         memcpy(cfg->line_out_pins, cfg->hp_pins,
2710                                sizeof(cfg->hp_pins));
2711                         cfg->hp_outs = 0;
2712                         memset(cfg->hp_pins, 0, sizeof(cfg->hp_pins));
2713                         cfg->line_out_type = AUTO_PIN_HP_OUT;
2714                 }
2715         }
2716
2717         /* Reorder the surround channels
2718          * ALSA sequence is front/surr/clfe/side
2719          * HDA sequence is:
2720          *    4-ch: front/surr  =>  OK as it is
2721          *    6-ch: front/clfe/surr
2722          *    8-ch: front/clfe/rear/side|fc
2723          */
2724         switch (cfg->line_outs) {
2725         case 3:
2726         case 4:
2727                 nid = cfg->line_out_pins[1];
2728                 cfg->line_out_pins[1] = cfg->line_out_pins[2];
2729                 cfg->line_out_pins[2] = nid;
2730                 break;
2731         }
2732
2733         /*
2734          * debug prints of the parsed results
2735          */
2736         snd_printd("autoconfig: line_outs=%d (0x%x/0x%x/0x%x/0x%x/0x%x)\n",
2737                    cfg->line_outs, cfg->line_out_pins[0], cfg->line_out_pins[1],
2738                    cfg->line_out_pins[2], cfg->line_out_pins[3],
2739                    cfg->line_out_pins[4]);
2740         snd_printd("   speaker_outs=%d (0x%x/0x%x/0x%x/0x%x/0x%x)\n",
2741                    cfg->speaker_outs, cfg->speaker_pins[0],
2742                    cfg->speaker_pins[1], cfg->speaker_pins[2],
2743                    cfg->speaker_pins[3], cfg->speaker_pins[4]);
2744         snd_printd("   hp_outs=%d (0x%x/0x%x/0x%x/0x%x/0x%x)\n",
2745                    cfg->hp_outs, cfg->hp_pins[0],
2746                    cfg->hp_pins[1], cfg->hp_pins[2],
2747                    cfg->hp_pins[3], cfg->hp_pins[4]);
2748         snd_printd("   inputs: mic=0x%x, fmic=0x%x, line=0x%x, fline=0x%x,"
2749                    " cd=0x%x, aux=0x%x\n",
2750                    cfg->input_pins[AUTO_PIN_MIC],
2751                    cfg->input_pins[AUTO_PIN_FRONT_MIC],
2752                    cfg->input_pins[AUTO_PIN_LINE],
2753                    cfg->input_pins[AUTO_PIN_FRONT_LINE],
2754                    cfg->input_pins[AUTO_PIN_CD],
2755                    cfg->input_pins[AUTO_PIN_AUX]);
2756
2757         return 0;
2758 }
2759
2760 /* labels for input pins */
2761 const char *auto_pin_cfg_labels[AUTO_PIN_LAST] = {
2762         "Mic", "Front Mic", "Line", "Front Line", "CD", "Aux"
2763 };
2764
2765
2766 #ifdef CONFIG_PM
2767 /*
2768  * power management
2769  */
2770
2771 /**
2772  * snd_hda_suspend - suspend the codecs
2773  * @bus: the HDA bus
2774  * @state: suspsend state
2775  *
2776  * Returns 0 if successful.
2777  */
2778 int snd_hda_suspend(struct hda_bus *bus, pm_message_t state)
2779 {
2780         struct hda_codec *codec;
2781
2782         list_for_each_entry(codec, &bus->codec_list, list) {
2783 #ifdef CONFIG_SND_HDA_POWER_SAVE
2784                 if (!codec->power_on)
2785                         continue;
2786 #endif
2787                 hda_call_codec_suspend(codec);
2788         }
2789         return 0;
2790 }
2791
2792 /**
2793  * snd_hda_resume - resume the codecs
2794  * @bus: the HDA bus
2795  * @state: resume state
2796  *
2797  * Returns 0 if successful.
2798  *
2799  * This fucntion is defined only when POWER_SAVE isn't set.
2800  * In the power-save mode, the codec is resumed dynamically.
2801  */
2802 int snd_hda_resume(struct hda_bus *bus)
2803 {
2804         struct hda_codec *codec;
2805
2806         list_for_each_entry(codec, &bus->codec_list, list) {
2807                 if (snd_hda_codec_needs_resume(codec))
2808                         hda_call_codec_resume(codec);
2809         }
2810         return 0;
2811 }
2812 #ifdef CONFIG_SND_HDA_POWER_SAVE
2813 int snd_hda_codecs_inuse(struct hda_bus *bus)
2814 {
2815         struct hda_codec *codec;
2816
2817         list_for_each_entry(codec, &bus->codec_list, list) {
2818                 if (snd_hda_codec_needs_resume(codec))
2819                         return 1;
2820         }
2821         return 0;
2822 }
2823 #endif
2824 #endif