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