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