[ALSA] hda-codec - print control name in error messages
[safe/jmp/linux-2.6] / sound / pci / hda / hda_codec.c
1 /*
2  * Universal Interface for Intel High Definition Audio Codec
3  *
4  * Copyright (c) 2004 Takashi Iwai <tiwai@suse.de>
5  *
6  *
7  *  This driver is free software; you can redistribute it and/or modify
8  *  it under the terms of the GNU General Public License as published by
9  *  the Free Software Foundation; either version 2 of the License, or
10  *  (at your option) any later version.
11  *
12  *  This driver is distributed in the hope that it will be useful,
13  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
14  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  *  GNU General Public License for more details.
16  *
17  *  You should have received a copy of the GNU General Public License
18  *  along with this program; if not, write to the Free Software
19  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
20  */
21
22 #include <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 (ctl = %s)\n", nid,
937                        kcontrol->id.name);
938                 return -EINVAL;
939         }
940         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
941         uinfo->count = chs == 3 ? 2 : 1;
942         uinfo->value.integer.min = 0;
943         uinfo->value.integer.max = caps;
944         return 0;
945 }
946
947 int snd_hda_mixer_amp_volume_get(struct snd_kcontrol *kcontrol,
948                                  struct snd_ctl_elem_value *ucontrol)
949 {
950         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
951         hda_nid_t nid = get_amp_nid(kcontrol);
952         int chs = get_amp_channels(kcontrol);
953         int dir = get_amp_direction(kcontrol);
954         int idx = get_amp_index(kcontrol);
955         long *valp = ucontrol->value.integer.value;
956
957         if (chs & 1)
958                 *valp++ = snd_hda_codec_amp_read(codec, nid, 0, dir, idx)
959                         & HDA_AMP_VOLMASK;
960         if (chs & 2)
961                 *valp = snd_hda_codec_amp_read(codec, nid, 1, dir, idx)
962                         & HDA_AMP_VOLMASK;
963         return 0;
964 }
965
966 int snd_hda_mixer_amp_volume_put(struct snd_kcontrol *kcontrol,
967                                  struct snd_ctl_elem_value *ucontrol)
968 {
969         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
970         hda_nid_t nid = get_amp_nid(kcontrol);
971         int chs = get_amp_channels(kcontrol);
972         int dir = get_amp_direction(kcontrol);
973         int idx = get_amp_index(kcontrol);
974         long *valp = ucontrol->value.integer.value;
975         int change = 0;
976
977         snd_hda_power_up(codec);
978         if (chs & 1) {
979                 change = snd_hda_codec_amp_update(codec, nid, 0, dir, idx,
980                                                   0x7f, *valp);
981                 valp++;
982         }
983         if (chs & 2)
984                 change |= snd_hda_codec_amp_update(codec, nid, 1, dir, idx,
985                                                    0x7f, *valp);
986         snd_hda_power_down(codec);
987         return change;
988 }
989
990 int snd_hda_mixer_amp_tlv(struct snd_kcontrol *kcontrol, int op_flag,
991                           unsigned int size, unsigned int __user *_tlv)
992 {
993         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
994         hda_nid_t nid = get_amp_nid(kcontrol);
995         int dir = get_amp_direction(kcontrol);
996         u32 caps, val1, val2;
997
998         if (size < 4 * sizeof(unsigned int))
999                 return -ENOMEM;
1000         caps = query_amp_caps(codec, nid, dir);
1001         val2 = (caps & AC_AMPCAP_STEP_SIZE) >> AC_AMPCAP_STEP_SIZE_SHIFT;
1002         val2 = (val2 + 1) * 25;
1003         val1 = -((caps & AC_AMPCAP_OFFSET) >> AC_AMPCAP_OFFSET_SHIFT);
1004         val1 = ((int)val1) * ((int)val2);
1005         if (put_user(SNDRV_CTL_TLVT_DB_SCALE, _tlv))
1006                 return -EFAULT;
1007         if (put_user(2 * sizeof(unsigned int), _tlv + 1))
1008                 return -EFAULT;
1009         if (put_user(val1, _tlv + 2))
1010                 return -EFAULT;
1011         if (put_user(val2, _tlv + 3))
1012                 return -EFAULT;
1013         return 0;
1014 }
1015
1016 /*
1017  * set (static) TLV for virtual master volume; recalculated as max 0dB
1018  */
1019 void snd_hda_set_vmaster_tlv(struct hda_codec *codec, hda_nid_t nid, int dir,
1020                              unsigned int *tlv)
1021 {
1022         u32 caps;
1023         int nums, step;
1024
1025         caps = query_amp_caps(codec, nid, dir);
1026         nums = (caps & AC_AMPCAP_NUM_STEPS) >> AC_AMPCAP_NUM_STEPS_SHIFT;
1027         step = (caps & AC_AMPCAP_STEP_SIZE) >> AC_AMPCAP_STEP_SIZE_SHIFT;
1028         step = (step + 1) * 25;
1029         tlv[0] = SNDRV_CTL_TLVT_DB_SCALE;
1030         tlv[1] = 2 * sizeof(unsigned int);
1031         tlv[2] = -nums * step;
1032         tlv[3] = step;
1033 }
1034
1035 /* find a mixer control element with the given name */
1036 struct snd_kcontrol *snd_hda_find_mixer_ctl(struct hda_codec *codec,
1037                                             const char *name)
1038 {
1039         struct snd_ctl_elem_id id;
1040         memset(&id, 0, sizeof(id));
1041         id.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
1042         strcpy(id.name, name);
1043         return snd_ctl_find_id(codec->bus->card, &id);
1044 }
1045
1046 /* create a virtual master control and add slaves */
1047 int snd_hda_add_vmaster(struct hda_codec *codec, char *name,
1048                         unsigned int *tlv, const char **slaves)
1049 {
1050         struct snd_kcontrol *kctl;
1051         const char **s;
1052         int err;
1053
1054         kctl = snd_ctl_make_virtual_master(name, tlv);
1055         if (!kctl)
1056                 return -ENOMEM;
1057         err = snd_ctl_add(codec->bus->card, kctl);
1058         if (err < 0)
1059                 return err;
1060         
1061         for (s = slaves; *s; s++) {
1062                 struct snd_kcontrol *sctl;
1063
1064                 sctl = snd_hda_find_mixer_ctl(codec, *s);
1065                 if (!sctl) {
1066                         snd_printdd("Cannot find slave %s, skipped\n", *s);
1067                         continue;
1068                 }
1069                 err = snd_ctl_add_slave(kctl, sctl);
1070                 if (err < 0)
1071                         return err;
1072         }
1073         return 0;
1074 }
1075
1076 /* switch */
1077 int snd_hda_mixer_amp_switch_info(struct snd_kcontrol *kcontrol,
1078                                   struct snd_ctl_elem_info *uinfo)
1079 {
1080         int chs = get_amp_channels(kcontrol);
1081
1082         uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
1083         uinfo->count = chs == 3 ? 2 : 1;
1084         uinfo->value.integer.min = 0;
1085         uinfo->value.integer.max = 1;
1086         return 0;
1087 }
1088
1089 int snd_hda_mixer_amp_switch_get(struct snd_kcontrol *kcontrol,
1090                                  struct snd_ctl_elem_value *ucontrol)
1091 {
1092         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1093         hda_nid_t nid = get_amp_nid(kcontrol);
1094         int chs = get_amp_channels(kcontrol);
1095         int dir = get_amp_direction(kcontrol);
1096         int idx = get_amp_index(kcontrol);
1097         long *valp = ucontrol->value.integer.value;
1098
1099         if (chs & 1)
1100                 *valp++ = (snd_hda_codec_amp_read(codec, nid, 0, dir, idx) &
1101                            HDA_AMP_MUTE) ? 0 : 1;
1102         if (chs & 2)
1103                 *valp = (snd_hda_codec_amp_read(codec, nid, 1, dir, idx) &
1104                          HDA_AMP_MUTE) ? 0 : 1;
1105         return 0;
1106 }
1107
1108 int snd_hda_mixer_amp_switch_put(struct snd_kcontrol *kcontrol,
1109                                  struct snd_ctl_elem_value *ucontrol)
1110 {
1111         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1112         hda_nid_t nid = get_amp_nid(kcontrol);
1113         int chs = get_amp_channels(kcontrol);
1114         int dir = get_amp_direction(kcontrol);
1115         int idx = get_amp_index(kcontrol);
1116         long *valp = ucontrol->value.integer.value;
1117         int change = 0;
1118
1119         snd_hda_power_up(codec);
1120         if (chs & 1) {
1121                 change = snd_hda_codec_amp_update(codec, nid, 0, dir, idx,
1122                                                   HDA_AMP_MUTE,
1123                                                   *valp ? 0 : HDA_AMP_MUTE);
1124                 valp++;
1125         }
1126         if (chs & 2)
1127                 change |= snd_hda_codec_amp_update(codec, nid, 1, dir, idx,
1128                                                    HDA_AMP_MUTE,
1129                                                    *valp ? 0 : HDA_AMP_MUTE);
1130 #ifdef CONFIG_SND_HDA_POWER_SAVE
1131         if (codec->patch_ops.check_power_status)
1132                 codec->patch_ops.check_power_status(codec, nid);
1133 #endif
1134         snd_hda_power_down(codec);
1135         return change;
1136 }
1137
1138 /*
1139  * bound volume controls
1140  *
1141  * bind multiple volumes (# indices, from 0)
1142  */
1143
1144 #define AMP_VAL_IDX_SHIFT       19
1145 #define AMP_VAL_IDX_MASK        (0x0f<<19)
1146
1147 int snd_hda_mixer_bind_switch_get(struct snd_kcontrol *kcontrol,
1148                                   struct snd_ctl_elem_value *ucontrol)
1149 {
1150         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1151         unsigned long pval;
1152         int err;
1153
1154         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1155         pval = kcontrol->private_value;
1156         kcontrol->private_value = pval & ~AMP_VAL_IDX_MASK; /* index 0 */
1157         err = snd_hda_mixer_amp_switch_get(kcontrol, ucontrol);
1158         kcontrol->private_value = pval;
1159         mutex_unlock(&codec->spdif_mutex);
1160         return err;
1161 }
1162
1163 int snd_hda_mixer_bind_switch_put(struct snd_kcontrol *kcontrol,
1164                                   struct snd_ctl_elem_value *ucontrol)
1165 {
1166         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1167         unsigned long pval;
1168         int i, indices, err = 0, change = 0;
1169
1170         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1171         pval = kcontrol->private_value;
1172         indices = (pval & AMP_VAL_IDX_MASK) >> AMP_VAL_IDX_SHIFT;
1173         for (i = 0; i < indices; i++) {
1174                 kcontrol->private_value = (pval & ~AMP_VAL_IDX_MASK) |
1175                         (i << AMP_VAL_IDX_SHIFT);
1176                 err = snd_hda_mixer_amp_switch_put(kcontrol, ucontrol);
1177                 if (err < 0)
1178                         break;
1179                 change |= err;
1180         }
1181         kcontrol->private_value = pval;
1182         mutex_unlock(&codec->spdif_mutex);
1183         return err < 0 ? err : change;
1184 }
1185
1186 /*
1187  * generic bound volume/swtich controls
1188  */
1189 int snd_hda_mixer_bind_ctls_info(struct snd_kcontrol *kcontrol,
1190                                  struct snd_ctl_elem_info *uinfo)
1191 {
1192         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1193         struct hda_bind_ctls *c;
1194         int err;
1195
1196         c = (struct hda_bind_ctls *)kcontrol->private_value;
1197         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1198         kcontrol->private_value = *c->values;
1199         err = c->ops->info(kcontrol, uinfo);
1200         kcontrol->private_value = (long)c;
1201         mutex_unlock(&codec->spdif_mutex);
1202         return err;
1203 }
1204
1205 int snd_hda_mixer_bind_ctls_get(struct snd_kcontrol *kcontrol,
1206                                 struct snd_ctl_elem_value *ucontrol)
1207 {
1208         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1209         struct hda_bind_ctls *c;
1210         int err;
1211
1212         c = (struct hda_bind_ctls *)kcontrol->private_value;
1213         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1214         kcontrol->private_value = *c->values;
1215         err = c->ops->get(kcontrol, ucontrol);
1216         kcontrol->private_value = (long)c;
1217         mutex_unlock(&codec->spdif_mutex);
1218         return err;
1219 }
1220
1221 int snd_hda_mixer_bind_ctls_put(struct snd_kcontrol *kcontrol,
1222                                 struct snd_ctl_elem_value *ucontrol)
1223 {
1224         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1225         struct hda_bind_ctls *c;
1226         unsigned long *vals;
1227         int err = 0, change = 0;
1228
1229         c = (struct hda_bind_ctls *)kcontrol->private_value;
1230         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1231         for (vals = c->values; *vals; vals++) {
1232                 kcontrol->private_value = *vals;
1233                 err = c->ops->put(kcontrol, ucontrol);
1234                 if (err < 0)
1235                         break;
1236                 change |= err;
1237         }
1238         kcontrol->private_value = (long)c;
1239         mutex_unlock(&codec->spdif_mutex);
1240         return err < 0 ? err : change;
1241 }
1242
1243 int snd_hda_mixer_bind_tlv(struct snd_kcontrol *kcontrol, int op_flag,
1244                            unsigned int size, unsigned int __user *tlv)
1245 {
1246         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1247         struct hda_bind_ctls *c;
1248         int err;
1249
1250         c = (struct hda_bind_ctls *)kcontrol->private_value;
1251         mutex_lock(&codec->spdif_mutex); /* reuse spdif_mutex */
1252         kcontrol->private_value = *c->values;
1253         err = c->ops->tlv(kcontrol, op_flag, size, tlv);
1254         kcontrol->private_value = (long)c;
1255         mutex_unlock(&codec->spdif_mutex);
1256         return err;
1257 }
1258
1259 struct hda_ctl_ops snd_hda_bind_vol = {
1260         .info = snd_hda_mixer_amp_volume_info,
1261         .get = snd_hda_mixer_amp_volume_get,
1262         .put = snd_hda_mixer_amp_volume_put,
1263         .tlv = snd_hda_mixer_amp_tlv
1264 };
1265
1266 struct hda_ctl_ops snd_hda_bind_sw = {
1267         .info = snd_hda_mixer_amp_switch_info,
1268         .get = snd_hda_mixer_amp_switch_get,
1269         .put = snd_hda_mixer_amp_switch_put,
1270         .tlv = snd_hda_mixer_amp_tlv
1271 };
1272
1273 /*
1274  * SPDIF out controls
1275  */
1276
1277 static int snd_hda_spdif_mask_info(struct snd_kcontrol *kcontrol,
1278                                    struct snd_ctl_elem_info *uinfo)
1279 {
1280         uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
1281         uinfo->count = 1;
1282         return 0;
1283 }
1284
1285 static int snd_hda_spdif_cmask_get(struct snd_kcontrol *kcontrol,
1286                                    struct snd_ctl_elem_value *ucontrol)
1287 {
1288         ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
1289                                            IEC958_AES0_NONAUDIO |
1290                                            IEC958_AES0_CON_EMPHASIS_5015 |
1291                                            IEC958_AES0_CON_NOT_COPYRIGHT;
1292         ucontrol->value.iec958.status[1] = IEC958_AES1_CON_CATEGORY |
1293                                            IEC958_AES1_CON_ORIGINAL;
1294         return 0;
1295 }
1296
1297 static int snd_hda_spdif_pmask_get(struct snd_kcontrol *kcontrol,
1298                                    struct snd_ctl_elem_value *ucontrol)
1299 {
1300         ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
1301                                            IEC958_AES0_NONAUDIO |
1302                                            IEC958_AES0_PRO_EMPHASIS_5015;
1303         return 0;
1304 }
1305
1306 static int snd_hda_spdif_default_get(struct snd_kcontrol *kcontrol,
1307                                      struct snd_ctl_elem_value *ucontrol)
1308 {
1309         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1310
1311         ucontrol->value.iec958.status[0] = codec->spdif_status & 0xff;
1312         ucontrol->value.iec958.status[1] = (codec->spdif_status >> 8) & 0xff;
1313         ucontrol->value.iec958.status[2] = (codec->spdif_status >> 16) & 0xff;
1314         ucontrol->value.iec958.status[3] = (codec->spdif_status >> 24) & 0xff;
1315
1316         return 0;
1317 }
1318
1319 /* convert from SPDIF status bits to HDA SPDIF bits
1320  * bit 0 (DigEn) is always set zero (to be filled later)
1321  */
1322 static unsigned short convert_from_spdif_status(unsigned int sbits)
1323 {
1324         unsigned short val = 0;
1325
1326         if (sbits & IEC958_AES0_PROFESSIONAL)
1327                 val |= AC_DIG1_PROFESSIONAL;
1328         if (sbits & IEC958_AES0_NONAUDIO)
1329                 val |= AC_DIG1_NONAUDIO;
1330         if (sbits & IEC958_AES0_PROFESSIONAL) {
1331                 if ((sbits & IEC958_AES0_PRO_EMPHASIS) ==
1332                     IEC958_AES0_PRO_EMPHASIS_5015)
1333                         val |= AC_DIG1_EMPHASIS;
1334         } else {
1335                 if ((sbits & IEC958_AES0_CON_EMPHASIS) ==
1336                     IEC958_AES0_CON_EMPHASIS_5015)
1337                         val |= AC_DIG1_EMPHASIS;
1338                 if (!(sbits & IEC958_AES0_CON_NOT_COPYRIGHT))
1339                         val |= AC_DIG1_COPYRIGHT;
1340                 if (sbits & (IEC958_AES1_CON_ORIGINAL << 8))
1341                         val |= AC_DIG1_LEVEL;
1342                 val |= sbits & (IEC958_AES1_CON_CATEGORY << 8);
1343         }
1344         return val;
1345 }
1346
1347 /* convert to SPDIF status bits from HDA SPDIF bits
1348  */
1349 static unsigned int convert_to_spdif_status(unsigned short val)
1350 {
1351         unsigned int sbits = 0;
1352
1353         if (val & AC_DIG1_NONAUDIO)
1354                 sbits |= IEC958_AES0_NONAUDIO;
1355         if (val & AC_DIG1_PROFESSIONAL)
1356                 sbits |= IEC958_AES0_PROFESSIONAL;
1357         if (sbits & IEC958_AES0_PROFESSIONAL) {
1358                 if (sbits & AC_DIG1_EMPHASIS)
1359                         sbits |= IEC958_AES0_PRO_EMPHASIS_5015;
1360         } else {
1361                 if (val & AC_DIG1_EMPHASIS)
1362                         sbits |= IEC958_AES0_CON_EMPHASIS_5015;
1363                 if (!(val & AC_DIG1_COPYRIGHT))
1364                         sbits |= IEC958_AES0_CON_NOT_COPYRIGHT;
1365                 if (val & AC_DIG1_LEVEL)
1366                         sbits |= (IEC958_AES1_CON_ORIGINAL << 8);
1367                 sbits |= val & (0x7f << 8);
1368         }
1369         return sbits;
1370 }
1371
1372 static int snd_hda_spdif_default_put(struct snd_kcontrol *kcontrol,
1373                                      struct snd_ctl_elem_value *ucontrol)
1374 {
1375         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1376         hda_nid_t nid = kcontrol->private_value;
1377         unsigned short val;
1378         int change;
1379
1380         mutex_lock(&codec->spdif_mutex);
1381         codec->spdif_status = ucontrol->value.iec958.status[0] |
1382                 ((unsigned int)ucontrol->value.iec958.status[1] << 8) |
1383                 ((unsigned int)ucontrol->value.iec958.status[2] << 16) |
1384                 ((unsigned int)ucontrol->value.iec958.status[3] << 24);
1385         val = convert_from_spdif_status(codec->spdif_status);
1386         val |= codec->spdif_ctls & 1;
1387         change = codec->spdif_ctls != val;
1388         codec->spdif_ctls = val;
1389
1390         if (change) {
1391                 snd_hda_codec_write_cache(codec, nid, 0,
1392                                           AC_VERB_SET_DIGI_CONVERT_1,
1393                                           val & 0xff);
1394                 snd_hda_codec_write_cache(codec, nid, 0,
1395                                           AC_VERB_SET_DIGI_CONVERT_2,
1396                                           val >> 8);
1397         }
1398
1399         mutex_unlock(&codec->spdif_mutex);
1400         return change;
1401 }
1402
1403 #define snd_hda_spdif_out_switch_info   snd_ctl_boolean_mono_info
1404
1405 static int snd_hda_spdif_out_switch_get(struct snd_kcontrol *kcontrol,
1406                                         struct snd_ctl_elem_value *ucontrol)
1407 {
1408         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1409
1410         ucontrol->value.integer.value[0] = codec->spdif_ctls & AC_DIG1_ENABLE;
1411         return 0;
1412 }
1413
1414 static int snd_hda_spdif_out_switch_put(struct snd_kcontrol *kcontrol,
1415                                         struct snd_ctl_elem_value *ucontrol)
1416 {
1417         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1418         hda_nid_t nid = kcontrol->private_value;
1419         unsigned short val;
1420         int change;
1421
1422         mutex_lock(&codec->spdif_mutex);
1423         val = codec->spdif_ctls & ~AC_DIG1_ENABLE;
1424         if (ucontrol->value.integer.value[0])
1425                 val |= AC_DIG1_ENABLE;
1426         change = codec->spdif_ctls != val;
1427         if (change) {
1428                 codec->spdif_ctls = val;
1429                 snd_hda_codec_write_cache(codec, nid, 0,
1430                                           AC_VERB_SET_DIGI_CONVERT_1,
1431                                           val & 0xff);
1432                 /* unmute amp switch (if any) */
1433                 if ((get_wcaps(codec, nid) & AC_WCAP_OUT_AMP) &&
1434                     (val & AC_DIG1_ENABLE))
1435                         snd_hda_codec_amp_stereo(codec, nid, HDA_OUTPUT, 0,
1436                                                  HDA_AMP_MUTE, 0);
1437         }
1438         mutex_unlock(&codec->spdif_mutex);
1439         return change;
1440 }
1441
1442 static struct snd_kcontrol_new dig_mixes[] = {
1443         {
1444                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
1445                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1446                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,CON_MASK),
1447                 .info = snd_hda_spdif_mask_info,
1448                 .get = snd_hda_spdif_cmask_get,
1449         },
1450         {
1451                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
1452                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1453                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,PRO_MASK),
1454                 .info = snd_hda_spdif_mask_info,
1455                 .get = snd_hda_spdif_pmask_get,
1456         },
1457         {
1458                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1459                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,DEFAULT),
1460                 .info = snd_hda_spdif_mask_info,
1461                 .get = snd_hda_spdif_default_get,
1462                 .put = snd_hda_spdif_default_put,
1463         },
1464         {
1465                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1466                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,SWITCH),
1467                 .info = snd_hda_spdif_out_switch_info,
1468                 .get = snd_hda_spdif_out_switch_get,
1469                 .put = snd_hda_spdif_out_switch_put,
1470         },
1471         { } /* end */
1472 };
1473
1474 /**
1475  * snd_hda_create_spdif_out_ctls - create Output SPDIF-related controls
1476  * @codec: the HDA codec
1477  * @nid: audio out widget NID
1478  *
1479  * Creates controls related with the SPDIF output.
1480  * Called from each patch supporting the SPDIF out.
1481  *
1482  * Returns 0 if successful, or a negative error code.
1483  */
1484 int snd_hda_create_spdif_out_ctls(struct hda_codec *codec, hda_nid_t nid)
1485 {
1486         int err;
1487         struct snd_kcontrol *kctl;
1488         struct snd_kcontrol_new *dig_mix;
1489
1490         for (dig_mix = dig_mixes; dig_mix->name; dig_mix++) {
1491                 kctl = snd_ctl_new1(dig_mix, codec);
1492                 kctl->private_value = nid;
1493                 err = snd_ctl_add(codec->bus->card, kctl);
1494                 if (err < 0)
1495                         return err;
1496         }
1497         codec->spdif_ctls =
1498                 snd_hda_codec_read(codec, nid, 0,
1499                                    AC_VERB_GET_DIGI_CONVERT_1, 0);
1500         codec->spdif_status = convert_to_spdif_status(codec->spdif_ctls);
1501         return 0;
1502 }
1503
1504 /*
1505  * SPDIF input
1506  */
1507
1508 #define snd_hda_spdif_in_switch_info    snd_hda_spdif_out_switch_info
1509
1510 static int snd_hda_spdif_in_switch_get(struct snd_kcontrol *kcontrol,
1511                                        struct snd_ctl_elem_value *ucontrol)
1512 {
1513         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1514
1515         ucontrol->value.integer.value[0] = codec->spdif_in_enable;
1516         return 0;
1517 }
1518
1519 static int snd_hda_spdif_in_switch_put(struct snd_kcontrol *kcontrol,
1520                                        struct snd_ctl_elem_value *ucontrol)
1521 {
1522         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1523         hda_nid_t nid = kcontrol->private_value;
1524         unsigned int val = !!ucontrol->value.integer.value[0];
1525         int change;
1526
1527         mutex_lock(&codec->spdif_mutex);
1528         change = codec->spdif_in_enable != val;
1529         if (change) {
1530                 codec->spdif_in_enable = val;
1531                 snd_hda_codec_write_cache(codec, nid, 0,
1532                                           AC_VERB_SET_DIGI_CONVERT_1, val);
1533         }
1534         mutex_unlock(&codec->spdif_mutex);
1535         return change;
1536 }
1537
1538 static int snd_hda_spdif_in_status_get(struct snd_kcontrol *kcontrol,
1539                                        struct snd_ctl_elem_value *ucontrol)
1540 {
1541         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1542         hda_nid_t nid = kcontrol->private_value;
1543         unsigned short val;
1544         unsigned int sbits;
1545
1546         val = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DIGI_CONVERT_1, 0);
1547         sbits = convert_to_spdif_status(val);
1548         ucontrol->value.iec958.status[0] = sbits;
1549         ucontrol->value.iec958.status[1] = sbits >> 8;
1550         ucontrol->value.iec958.status[2] = sbits >> 16;
1551         ucontrol->value.iec958.status[3] = sbits >> 24;
1552         return 0;
1553 }
1554
1555 static struct snd_kcontrol_new dig_in_ctls[] = {
1556         {
1557                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1558                 .name = SNDRV_CTL_NAME_IEC958("",CAPTURE,SWITCH),
1559                 .info = snd_hda_spdif_in_switch_info,
1560                 .get = snd_hda_spdif_in_switch_get,
1561                 .put = snd_hda_spdif_in_switch_put,
1562         },
1563         {
1564                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
1565                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1566                 .name = SNDRV_CTL_NAME_IEC958("",CAPTURE,DEFAULT),
1567                 .info = snd_hda_spdif_mask_info,
1568                 .get = snd_hda_spdif_in_status_get,
1569         },
1570         { } /* end */
1571 };
1572
1573 /**
1574  * snd_hda_create_spdif_in_ctls - create Input SPDIF-related controls
1575  * @codec: the HDA codec
1576  * @nid: audio in widget NID
1577  *
1578  * Creates controls related with the SPDIF input.
1579  * Called from each patch supporting the SPDIF in.
1580  *
1581  * Returns 0 if successful, or a negative error code.
1582  */
1583 int snd_hda_create_spdif_in_ctls(struct hda_codec *codec, hda_nid_t nid)
1584 {
1585         int err;
1586         struct snd_kcontrol *kctl;
1587         struct snd_kcontrol_new *dig_mix;
1588
1589         for (dig_mix = dig_in_ctls; dig_mix->name; dig_mix++) {
1590                 kctl = snd_ctl_new1(dig_mix, codec);
1591                 kctl->private_value = nid;
1592                 err = snd_ctl_add(codec->bus->card, kctl);
1593                 if (err < 0)
1594                         return err;
1595         }
1596         codec->spdif_in_enable =
1597                 snd_hda_codec_read(codec, nid, 0,
1598                                    AC_VERB_GET_DIGI_CONVERT_1, 0) &
1599                 AC_DIG1_ENABLE;
1600         return 0;
1601 }
1602
1603 #ifdef SND_HDA_NEEDS_RESUME
1604 /*
1605  * command cache
1606  */
1607
1608 /* build a 32bit cache key with the widget id and the command parameter */
1609 #define build_cmd_cache_key(nid, verb)  ((verb << 8) | nid)
1610 #define get_cmd_cache_nid(key)          ((key) & 0xff)
1611 #define get_cmd_cache_cmd(key)          (((key) >> 8) & 0xffff)
1612
1613 /**
1614  * snd_hda_codec_write_cache - send a single command with caching
1615  * @codec: the HDA codec
1616  * @nid: NID to send the command
1617  * @direct: direct flag
1618  * @verb: the verb to send
1619  * @parm: the parameter for the verb
1620  *
1621  * Send a single command without waiting for response.
1622  *
1623  * Returns 0 if successful, or a negative error code.
1624  */
1625 int snd_hda_codec_write_cache(struct hda_codec *codec, hda_nid_t nid,
1626                               int direct, unsigned int verb, unsigned int parm)
1627 {
1628         int err;
1629         snd_hda_power_up(codec);
1630         mutex_lock(&codec->bus->cmd_mutex);
1631         err = codec->bus->ops.command(codec, nid, direct, verb, parm);
1632         if (!err) {
1633                 struct hda_cache_head *c;
1634                 u32 key = build_cmd_cache_key(nid, verb);
1635                 c = get_alloc_hash(&codec->cmd_cache, key);
1636                 if (c)
1637                         c->val = parm;
1638         }
1639         mutex_unlock(&codec->bus->cmd_mutex);
1640         snd_hda_power_down(codec);
1641         return err;
1642 }
1643
1644 /* resume the all commands from the cache */
1645 void snd_hda_codec_resume_cache(struct hda_codec *codec)
1646 {
1647         struct hda_cache_head *buffer = codec->cmd_cache.buffer;
1648         int i;
1649
1650         for (i = 0; i < codec->cmd_cache.size; i++, buffer++) {
1651                 u32 key = buffer->key;
1652                 if (!key)
1653                         continue;
1654                 snd_hda_codec_write(codec, get_cmd_cache_nid(key), 0,
1655                                     get_cmd_cache_cmd(key), buffer->val);
1656         }
1657 }
1658
1659 /**
1660  * snd_hda_sequence_write_cache - sequence writes with caching
1661  * @codec: the HDA codec
1662  * @seq: VERB array to send
1663  *
1664  * Send the commands sequentially from the given array.
1665  * Thte commands are recorded on cache for power-save and resume.
1666  * The array must be terminated with NID=0.
1667  */
1668 void snd_hda_sequence_write_cache(struct hda_codec *codec,
1669                                   const struct hda_verb *seq)
1670 {
1671         for (; seq->nid; seq++)
1672                 snd_hda_codec_write_cache(codec, seq->nid, 0, seq->verb,
1673                                           seq->param);
1674 }
1675 #endif /* SND_HDA_NEEDS_RESUME */
1676
1677 /*
1678  * set power state of the codec
1679  */
1680 static void hda_set_power_state(struct hda_codec *codec, hda_nid_t fg,
1681                                 unsigned int power_state)
1682 {
1683         hda_nid_t nid;
1684         int i;
1685
1686         snd_hda_codec_write(codec, fg, 0, AC_VERB_SET_POWER_STATE,
1687                             power_state);
1688
1689         nid = codec->start_nid;
1690         for (i = 0; i < codec->num_nodes; i++, nid++) {
1691                 unsigned int wcaps = get_wcaps(codec, nid);
1692                 if (wcaps & AC_WCAP_POWER) {
1693                         unsigned int wid_type = (wcaps & AC_WCAP_TYPE) >>
1694                                 AC_WCAP_TYPE_SHIFT;
1695                         if (wid_type == AC_WID_PIN) {
1696                                 unsigned int pincap;
1697                                 /*
1698                                  * don't power down the widget if it controls
1699                                  * eapd and EAPD_BTLENABLE is set.
1700                                  */
1701                                 pincap = snd_hda_param_read(codec, nid,
1702                                                             AC_PAR_PIN_CAP);
1703                                 if (pincap & AC_PINCAP_EAPD) {
1704                                         int eapd = snd_hda_codec_read(codec,
1705                                                 nid, 0,
1706                                                 AC_VERB_GET_EAPD_BTLENABLE, 0);
1707                                         eapd &= 0x02;
1708                                         if (power_state == AC_PWRST_D3 && eapd)
1709                                                 continue;
1710                                 }
1711                         }
1712                         snd_hda_codec_write(codec, nid, 0,
1713                                             AC_VERB_SET_POWER_STATE,
1714                                             power_state);
1715                 }
1716         }
1717
1718         if (power_state == AC_PWRST_D0) {
1719                 unsigned long end_time;
1720                 int state;
1721                 msleep(10);
1722                 /* wait until the codec reachs to D0 */
1723                 end_time = jiffies + msecs_to_jiffies(500);
1724                 do {
1725                         state = snd_hda_codec_read(codec, fg, 0,
1726                                                    AC_VERB_GET_POWER_STATE, 0);
1727                         if (state == power_state)
1728                                 break;
1729                         msleep(1);
1730                 } while (time_after_eq(end_time, jiffies));
1731         }
1732 }
1733
1734 #ifdef SND_HDA_NEEDS_RESUME
1735 /*
1736  * call suspend and power-down; used both from PM and power-save
1737  */
1738 static void hda_call_codec_suspend(struct hda_codec *codec)
1739 {
1740         if (codec->patch_ops.suspend)
1741                 codec->patch_ops.suspend(codec, PMSG_SUSPEND);
1742         hda_set_power_state(codec,
1743                             codec->afg ? codec->afg : codec->mfg,
1744                             AC_PWRST_D3);
1745 #ifdef CONFIG_SND_HDA_POWER_SAVE
1746         cancel_delayed_work(&codec->power_work);
1747         codec->power_on = 0;
1748         codec->power_transition = 0;
1749 #endif
1750 }
1751
1752 /*
1753  * kick up codec; used both from PM and power-save
1754  */
1755 static void hda_call_codec_resume(struct hda_codec *codec)
1756 {
1757         hda_set_power_state(codec,
1758                             codec->afg ? codec->afg : codec->mfg,
1759                             AC_PWRST_D0);
1760         if (codec->patch_ops.resume)
1761                 codec->patch_ops.resume(codec);
1762         else {
1763                 if (codec->patch_ops.init)
1764                         codec->patch_ops.init(codec);
1765                 snd_hda_codec_resume_amp(codec);
1766                 snd_hda_codec_resume_cache(codec);
1767         }
1768 }
1769 #endif /* SND_HDA_NEEDS_RESUME */
1770
1771
1772 /**
1773  * snd_hda_build_controls - build mixer controls
1774  * @bus: the BUS
1775  *
1776  * Creates mixer controls for each codec included in the bus.
1777  *
1778  * Returns 0 if successful, otherwise a negative error code.
1779  */
1780 int __devinit snd_hda_build_controls(struct hda_bus *bus)
1781 {
1782         struct hda_codec *codec;
1783
1784         list_for_each_entry(codec, &bus->codec_list, list) {
1785                 int err = 0;
1786                 /* fake as if already powered-on */
1787                 hda_keep_power_on(codec);
1788                 /* then fire up */
1789                 hda_set_power_state(codec,
1790                                     codec->afg ? codec->afg : codec->mfg,
1791                                     AC_PWRST_D0);
1792                 /* continue to initialize... */
1793                 if (codec->patch_ops.init)
1794                         err = codec->patch_ops.init(codec);
1795                 if (!err && codec->patch_ops.build_controls)
1796                         err = codec->patch_ops.build_controls(codec);
1797                 snd_hda_power_down(codec);
1798                 if (err < 0)
1799                         return err;
1800         }
1801
1802         return 0;
1803 }
1804
1805 /*
1806  * stream formats
1807  */
1808 struct hda_rate_tbl {
1809         unsigned int hz;
1810         unsigned int alsa_bits;
1811         unsigned int hda_fmt;
1812 };
1813
1814 static struct hda_rate_tbl rate_bits[] = {
1815         /* rate in Hz, ALSA rate bitmask, HDA format value */
1816
1817         /* autodetected value used in snd_hda_query_supported_pcm */
1818         { 8000, SNDRV_PCM_RATE_8000, 0x0500 }, /* 1/6 x 48 */
1819         { 11025, SNDRV_PCM_RATE_11025, 0x4300 }, /* 1/4 x 44 */
1820         { 16000, SNDRV_PCM_RATE_16000, 0x0200 }, /* 1/3 x 48 */
1821         { 22050, SNDRV_PCM_RATE_22050, 0x4100 }, /* 1/2 x 44 */
1822         { 32000, SNDRV_PCM_RATE_32000, 0x0a00 }, /* 2/3 x 48 */
1823         { 44100, SNDRV_PCM_RATE_44100, 0x4000 }, /* 44 */
1824         { 48000, SNDRV_PCM_RATE_48000, 0x0000 }, /* 48 */
1825         { 88200, SNDRV_PCM_RATE_88200, 0x4800 }, /* 2 x 44 */
1826         { 96000, SNDRV_PCM_RATE_96000, 0x0800 }, /* 2 x 48 */
1827         { 176400, SNDRV_PCM_RATE_176400, 0x5800 },/* 4 x 44 */
1828         { 192000, SNDRV_PCM_RATE_192000, 0x1800 }, /* 4 x 48 */
1829 #define AC_PAR_PCM_RATE_BITS    11
1830         /* up to bits 10, 384kHZ isn't supported properly */
1831
1832         /* not autodetected value */
1833         { 9600, SNDRV_PCM_RATE_KNOT, 0x0400 }, /* 1/5 x 48 */
1834
1835         { 0 } /* terminator */
1836 };
1837
1838 /**
1839  * snd_hda_calc_stream_format - calculate format bitset
1840  * @rate: the sample rate
1841  * @channels: the number of channels
1842  * @format: the PCM format (SNDRV_PCM_FORMAT_XXX)
1843  * @maxbps: the max. bps
1844  *
1845  * Calculate the format bitset from the given rate, channels and th PCM format.
1846  *
1847  * Return zero if invalid.
1848  */
1849 unsigned int snd_hda_calc_stream_format(unsigned int rate,
1850                                         unsigned int channels,
1851                                         unsigned int format,
1852                                         unsigned int maxbps)
1853 {
1854         int i;
1855         unsigned int val = 0;
1856
1857         for (i = 0; rate_bits[i].hz; i++)
1858                 if (rate_bits[i].hz == rate) {
1859                         val = rate_bits[i].hda_fmt;
1860                         break;
1861                 }
1862         if (!rate_bits[i].hz) {
1863                 snd_printdd("invalid rate %d\n", rate);
1864                 return 0;
1865         }
1866
1867         if (channels == 0 || channels > 8) {
1868                 snd_printdd("invalid channels %d\n", channels);
1869                 return 0;
1870         }
1871         val |= channels - 1;
1872
1873         switch (snd_pcm_format_width(format)) {
1874         case 8:  val |= 0x00; break;
1875         case 16: val |= 0x10; break;
1876         case 20:
1877         case 24:
1878         case 32:
1879                 if (maxbps >= 32)
1880                         val |= 0x40;
1881                 else if (maxbps >= 24)
1882                         val |= 0x30;
1883                 else
1884                         val |= 0x20;
1885                 break;
1886         default:
1887                 snd_printdd("invalid format width %d\n",
1888                             snd_pcm_format_width(format));
1889                 return 0;
1890         }
1891
1892         return val;
1893 }
1894
1895 /**
1896  * snd_hda_query_supported_pcm - query the supported PCM rates and formats
1897  * @codec: the HDA codec
1898  * @nid: NID to query
1899  * @ratesp: the pointer to store the detected rate bitflags
1900  * @formatsp: the pointer to store the detected formats
1901  * @bpsp: the pointer to store the detected format widths
1902  *
1903  * Queries the supported PCM rates and formats.  The NULL @ratesp, @formatsp
1904  * or @bsps argument is ignored.
1905  *
1906  * Returns 0 if successful, otherwise a negative error code.
1907  */
1908 int snd_hda_query_supported_pcm(struct hda_codec *codec, hda_nid_t nid,
1909                                 u32 *ratesp, u64 *formatsp, unsigned int *bpsp)
1910 {
1911         int i;
1912         unsigned int val, streams;
1913
1914         val = 0;
1915         if (nid != codec->afg &&
1916             (get_wcaps(codec, nid) & AC_WCAP_FORMAT_OVRD)) {
1917                 val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
1918                 if (val == -1)
1919                         return -EIO;
1920         }
1921         if (!val)
1922                 val = snd_hda_param_read(codec, codec->afg, AC_PAR_PCM);
1923
1924         if (ratesp) {
1925                 u32 rates = 0;
1926                 for (i = 0; i < AC_PAR_PCM_RATE_BITS; i++) {
1927                         if (val & (1 << i))
1928                                 rates |= rate_bits[i].alsa_bits;
1929                 }
1930                 *ratesp = rates;
1931         }
1932
1933         if (formatsp || bpsp) {
1934                 u64 formats = 0;
1935                 unsigned int bps;
1936                 unsigned int wcaps;
1937
1938                 wcaps = get_wcaps(codec, nid);
1939                 streams = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
1940                 if (streams == -1)
1941                         return -EIO;
1942                 if (!streams) {
1943                         streams = snd_hda_param_read(codec, codec->afg,
1944                                                      AC_PAR_STREAM);
1945                         if (streams == -1)
1946                                 return -EIO;
1947                 }
1948
1949                 bps = 0;
1950                 if (streams & AC_SUPFMT_PCM) {
1951                         if (val & AC_SUPPCM_BITS_8) {
1952                                 formats |= SNDRV_PCM_FMTBIT_U8;
1953                                 bps = 8;
1954                         }
1955                         if (val & AC_SUPPCM_BITS_16) {
1956                                 formats |= SNDRV_PCM_FMTBIT_S16_LE;
1957                                 bps = 16;
1958                         }
1959                         if (wcaps & AC_WCAP_DIGITAL) {
1960                                 if (val & AC_SUPPCM_BITS_32)
1961                                         formats |= SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE;
1962                                 if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24))
1963                                         formats |= SNDRV_PCM_FMTBIT_S32_LE;
1964                                 if (val & AC_SUPPCM_BITS_24)
1965                                         bps = 24;
1966                                 else if (val & AC_SUPPCM_BITS_20)
1967                                         bps = 20;
1968                         } else if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24|
1969                                           AC_SUPPCM_BITS_32)) {
1970                                 formats |= SNDRV_PCM_FMTBIT_S32_LE;
1971                                 if (val & AC_SUPPCM_BITS_32)
1972                                         bps = 32;
1973                                 else if (val & AC_SUPPCM_BITS_24)
1974                                         bps = 24;
1975                                 else if (val & AC_SUPPCM_BITS_20)
1976                                         bps = 20;
1977                         }
1978                 }
1979                 else if (streams == AC_SUPFMT_FLOAT32) {
1980                         /* should be exclusive */
1981                         formats |= SNDRV_PCM_FMTBIT_FLOAT_LE;
1982                         bps = 32;
1983                 } else if (streams == AC_SUPFMT_AC3) {
1984                         /* should be exclusive */
1985                         /* temporary hack: we have still no proper support
1986                          * for the direct AC3 stream...
1987                          */
1988                         formats |= SNDRV_PCM_FMTBIT_U8;
1989                         bps = 8;
1990                 }
1991                 if (formatsp)
1992                         *formatsp = formats;
1993                 if (bpsp)
1994                         *bpsp = bps;
1995         }
1996
1997         return 0;
1998 }
1999
2000 /**
2001  * snd_hda_is_supported_format - check whether the given node supports
2002  * the format val
2003  *
2004  * Returns 1 if supported, 0 if not.
2005  */
2006 int snd_hda_is_supported_format(struct hda_codec *codec, hda_nid_t nid,
2007                                 unsigned int format)
2008 {
2009         int i;
2010         unsigned int val = 0, rate, stream;
2011
2012         if (nid != codec->afg &&
2013             (get_wcaps(codec, nid) & AC_WCAP_FORMAT_OVRD)) {
2014                 val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
2015                 if (val == -1)
2016                         return 0;
2017         }
2018         if (!val) {
2019                 val = snd_hda_param_read(codec, codec->afg, AC_PAR_PCM);
2020                 if (val == -1)
2021                         return 0;
2022         }
2023
2024         rate = format & 0xff00;
2025         for (i = 0; i < AC_PAR_PCM_RATE_BITS; i++)
2026                 if (rate_bits[i].hda_fmt == rate) {
2027                         if (val & (1 << i))
2028                                 break;
2029                         return 0;
2030                 }
2031         if (i >= AC_PAR_PCM_RATE_BITS)
2032                 return 0;
2033
2034         stream = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
2035         if (stream == -1)
2036                 return 0;
2037         if (!stream && nid != codec->afg)
2038                 stream = snd_hda_param_read(codec, codec->afg, AC_PAR_STREAM);
2039         if (!stream || stream == -1)
2040                 return 0;
2041
2042         if (stream & AC_SUPFMT_PCM) {
2043                 switch (format & 0xf0) {
2044                 case 0x00:
2045                         if (!(val & AC_SUPPCM_BITS_8))
2046                                 return 0;
2047                         break;
2048                 case 0x10:
2049                         if (!(val & AC_SUPPCM_BITS_16))
2050                                 return 0;
2051                         break;
2052                 case 0x20:
2053                         if (!(val & AC_SUPPCM_BITS_20))
2054                                 return 0;
2055                         break;
2056                 case 0x30:
2057                         if (!(val & AC_SUPPCM_BITS_24))
2058                                 return 0;
2059                         break;
2060                 case 0x40:
2061                         if (!(val & AC_SUPPCM_BITS_32))
2062                                 return 0;
2063                         break;
2064                 default:
2065                         return 0;
2066                 }
2067         } else {
2068                 /* FIXME: check for float32 and AC3? */
2069         }
2070
2071         return 1;
2072 }
2073
2074 /*
2075  * PCM stuff
2076  */
2077 static int hda_pcm_default_open_close(struct hda_pcm_stream *hinfo,
2078                                       struct hda_codec *codec,
2079                                       struct snd_pcm_substream *substream)
2080 {
2081         return 0;
2082 }
2083
2084 static int hda_pcm_default_prepare(struct hda_pcm_stream *hinfo,
2085                                    struct hda_codec *codec,
2086                                    unsigned int stream_tag,
2087                                    unsigned int format,
2088                                    struct snd_pcm_substream *substream)
2089 {
2090         snd_hda_codec_setup_stream(codec, hinfo->nid, stream_tag, 0, format);
2091         return 0;
2092 }
2093
2094 static int hda_pcm_default_cleanup(struct hda_pcm_stream *hinfo,
2095                                    struct hda_codec *codec,
2096                                    struct snd_pcm_substream *substream)
2097 {
2098         snd_hda_codec_setup_stream(codec, hinfo->nid, 0, 0, 0);
2099         return 0;
2100 }
2101
2102 static int __devinit set_pcm_default_values(struct hda_codec *codec,
2103                                             struct hda_pcm_stream *info)
2104 {
2105         /* query support PCM information from the given NID */
2106         if (info->nid && (!info->rates || !info->formats)) {
2107                 snd_hda_query_supported_pcm(codec, info->nid,
2108                                 info->rates ? NULL : &info->rates,
2109                                 info->formats ? NULL : &info->formats,
2110                                 info->maxbps ? NULL : &info->maxbps);
2111         }
2112         if (info->ops.open == NULL)
2113                 info->ops.open = hda_pcm_default_open_close;
2114         if (info->ops.close == NULL)
2115                 info->ops.close = hda_pcm_default_open_close;
2116         if (info->ops.prepare == NULL) {
2117                 snd_assert(info->nid, return -EINVAL);
2118                 info->ops.prepare = hda_pcm_default_prepare;
2119         }
2120         if (info->ops.cleanup == NULL) {
2121                 snd_assert(info->nid, return -EINVAL);
2122                 info->ops.cleanup = hda_pcm_default_cleanup;
2123         }
2124         return 0;
2125 }
2126
2127 /**
2128  * snd_hda_build_pcms - build PCM information
2129  * @bus: the BUS
2130  *
2131  * Create PCM information for each codec included in the bus.
2132  *
2133  * The build_pcms codec patch is requested to set up codec->num_pcms and
2134  * codec->pcm_info properly.  The array is referred by the top-level driver
2135  * to create its PCM instances.
2136  * The allocated codec->pcm_info should be released in codec->patch_ops.free
2137  * callback.
2138  *
2139  * At least, substreams, channels_min and channels_max must be filled for
2140  * each stream.  substreams = 0 indicates that the stream doesn't exist.
2141  * When rates and/or formats are zero, the supported values are queried
2142  * from the given nid.  The nid is used also by the default ops.prepare
2143  * and ops.cleanup callbacks.
2144  *
2145  * The driver needs to call ops.open in its open callback.  Similarly,
2146  * ops.close is supposed to be called in the close callback.
2147  * ops.prepare should be called in the prepare or hw_params callback
2148  * with the proper parameters for set up.
2149  * ops.cleanup should be called in hw_free for clean up of streams.
2150  *
2151  * This function returns 0 if successfull, or a negative error code.
2152  */
2153 int __devinit snd_hda_build_pcms(struct hda_bus *bus)
2154 {
2155         struct hda_codec *codec;
2156
2157         list_for_each_entry(codec, &bus->codec_list, list) {
2158                 unsigned int pcm, s;
2159                 int err;
2160                 if (!codec->patch_ops.build_pcms)
2161                         continue;
2162                 err = codec->patch_ops.build_pcms(codec);
2163                 if (err < 0)
2164                         return err;
2165                 for (pcm = 0; pcm < codec->num_pcms; pcm++) {
2166                         for (s = 0; s < 2; s++) {
2167                                 struct hda_pcm_stream *info;
2168                                 info = &codec->pcm_info[pcm].stream[s];
2169                                 if (!info->substreams)
2170                                         continue;
2171                                 err = set_pcm_default_values(codec, info);
2172                                 if (err < 0)
2173                                         return err;
2174                         }
2175                 }
2176         }
2177         return 0;
2178 }
2179
2180 /**
2181  * snd_hda_check_board_config - compare the current codec with the config table
2182  * @codec: the HDA codec
2183  * @num_configs: number of config enums
2184  * @models: array of model name strings
2185  * @tbl: configuration table, terminated by null entries
2186  *
2187  * Compares the modelname or PCI subsystem id of the current codec with the
2188  * given configuration table.  If a matching entry is found, returns its
2189  * config value (supposed to be 0 or positive).
2190  *
2191  * If no entries are matching, the function returns a negative value.
2192  */
2193 int snd_hda_check_board_config(struct hda_codec *codec,
2194                                int num_configs, const char **models,
2195                                const struct snd_pci_quirk *tbl)
2196 {
2197         if (codec->bus->modelname && models) {
2198                 int i;
2199                 for (i = 0; i < num_configs; i++) {
2200                         if (models[i] &&
2201                             !strcmp(codec->bus->modelname, models[i])) {
2202                                 snd_printd(KERN_INFO "hda_codec: model '%s' is "
2203                                            "selected\n", models[i]);
2204                                 return i;
2205                         }
2206                 }
2207         }
2208
2209         if (!codec->bus->pci || !tbl)
2210                 return -1;
2211
2212         tbl = snd_pci_quirk_lookup(codec->bus->pci, tbl);
2213         if (!tbl)
2214                 return -1;
2215         if (tbl->value >= 0 && tbl->value < num_configs) {
2216 #ifdef CONFIG_SND_DEBUG_DETECT
2217                 char tmp[10];
2218                 const char *model = NULL;
2219                 if (models)
2220                         model = models[tbl->value];
2221                 if (!model) {
2222                         sprintf(tmp, "#%d", tbl->value);
2223                         model = tmp;
2224                 }
2225                 snd_printdd(KERN_INFO "hda_codec: model '%s' is selected "
2226                             "for config %x:%x (%s)\n",
2227                             model, tbl->subvendor, tbl->subdevice,
2228                             (tbl->name ? tbl->name : "Unknown device"));
2229 #endif
2230                 return tbl->value;
2231         }
2232         return -1;
2233 }
2234
2235 /**
2236  * snd_hda_add_new_ctls - create controls from the array
2237  * @codec: the HDA codec
2238  * @knew: the array of struct snd_kcontrol_new
2239  *
2240  * This helper function creates and add new controls in the given array.
2241  * The array must be terminated with an empty entry as terminator.
2242  *
2243  * Returns 0 if successful, or a negative error code.
2244  */
2245 int snd_hda_add_new_ctls(struct hda_codec *codec, struct snd_kcontrol_new *knew)
2246 {
2247         int err;
2248
2249         for (; knew->name; knew++) {
2250                 struct snd_kcontrol *kctl;
2251                 kctl = snd_ctl_new1(knew, codec);
2252                 if (!kctl)
2253                         return -ENOMEM;
2254                 err = snd_ctl_add(codec->bus->card, kctl);
2255                 if (err < 0) {
2256                         if (!codec->addr)
2257                                 return err;
2258                         kctl = snd_ctl_new1(knew, codec);
2259                         if (!kctl)
2260                                 return -ENOMEM;
2261                         kctl->id.device = codec->addr;
2262                         err = snd_ctl_add(codec->bus->card, kctl);
2263                         if (err < 0)
2264                                 return err;
2265                 }
2266         }
2267         return 0;
2268 }
2269
2270 #ifdef CONFIG_SND_HDA_POWER_SAVE
2271 static void hda_set_power_state(struct hda_codec *codec, hda_nid_t fg,
2272                                 unsigned int power_state);
2273
2274 static void hda_power_work(struct work_struct *work)
2275 {
2276         struct hda_codec *codec =
2277                 container_of(work, struct hda_codec, power_work.work);
2278
2279         if (!codec->power_on || codec->power_count) {
2280                 codec->power_transition = 0;
2281                 return;
2282         }
2283
2284         hda_call_codec_suspend(codec);
2285         if (codec->bus->ops.pm_notify)
2286                 codec->bus->ops.pm_notify(codec);
2287 }
2288
2289 static void hda_keep_power_on(struct hda_codec *codec)
2290 {
2291         codec->power_count++;
2292         codec->power_on = 1;
2293 }
2294
2295 void snd_hda_power_up(struct hda_codec *codec)
2296 {
2297         codec->power_count++;
2298         if (codec->power_on || codec->power_transition)
2299                 return;
2300
2301         codec->power_on = 1;
2302         if (codec->bus->ops.pm_notify)
2303                 codec->bus->ops.pm_notify(codec);
2304         hda_call_codec_resume(codec);
2305         cancel_delayed_work(&codec->power_work);
2306         codec->power_transition = 0;
2307 }
2308
2309 void snd_hda_power_down(struct hda_codec *codec)
2310 {
2311         --codec->power_count;
2312         if (!codec->power_on || codec->power_count || codec->power_transition)
2313                 return;
2314         if (power_save) {
2315                 codec->power_transition = 1; /* avoid reentrance */
2316                 schedule_delayed_work(&codec->power_work,
2317                                       msecs_to_jiffies(power_save * 1000));
2318         }
2319 }
2320
2321 int snd_hda_check_amp_list_power(struct hda_codec *codec,
2322                                  struct hda_loopback_check *check,
2323                                  hda_nid_t nid)
2324 {
2325         struct hda_amp_list *p;
2326         int ch, v;
2327
2328         if (!check->amplist)
2329                 return 0;
2330         for (p = check->amplist; p->nid; p++) {
2331                 if (p->nid == nid)
2332                         break;
2333         }
2334         if (!p->nid)
2335                 return 0; /* nothing changed */
2336
2337         for (p = check->amplist; p->nid; p++) {
2338                 for (ch = 0; ch < 2; ch++) {
2339                         v = snd_hda_codec_amp_read(codec, p->nid, ch, p->dir,
2340                                                    p->idx);
2341                         if (!(v & HDA_AMP_MUTE) && v > 0) {
2342                                 if (!check->power_on) {
2343                                         check->power_on = 1;
2344                                         snd_hda_power_up(codec);
2345                                 }
2346                                 return 1;
2347                         }
2348                 }
2349         }
2350         if (check->power_on) {
2351                 check->power_on = 0;
2352                 snd_hda_power_down(codec);
2353         }
2354         return 0;
2355 }
2356 #endif
2357
2358 /*
2359  * Channel mode helper
2360  */
2361 int snd_hda_ch_mode_info(struct hda_codec *codec,
2362                          struct snd_ctl_elem_info *uinfo,
2363                          const struct hda_channel_mode *chmode,
2364                          int num_chmodes)
2365 {
2366         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2367         uinfo->count = 1;
2368         uinfo->value.enumerated.items = num_chmodes;
2369         if (uinfo->value.enumerated.item >= num_chmodes)
2370                 uinfo->value.enumerated.item = num_chmodes - 1;
2371         sprintf(uinfo->value.enumerated.name, "%dch",
2372                 chmode[uinfo->value.enumerated.item].channels);
2373         return 0;
2374 }
2375
2376 int snd_hda_ch_mode_get(struct hda_codec *codec,
2377                         struct snd_ctl_elem_value *ucontrol,
2378                         const struct hda_channel_mode *chmode,
2379                         int num_chmodes,
2380                         int max_channels)
2381 {
2382         int i;
2383
2384         for (i = 0; i < num_chmodes; i++) {
2385                 if (max_channels == chmode[i].channels) {
2386                         ucontrol->value.enumerated.item[0] = i;
2387                         break;
2388                 }
2389         }
2390         return 0;
2391 }
2392
2393 int snd_hda_ch_mode_put(struct hda_codec *codec,
2394                         struct snd_ctl_elem_value *ucontrol,
2395                         const struct hda_channel_mode *chmode,
2396                         int num_chmodes,
2397                         int *max_channelsp)
2398 {
2399         unsigned int mode;
2400
2401         mode = ucontrol->value.enumerated.item[0];
2402         if (mode >= num_chmodes)
2403                 return -EINVAL;
2404         if (*max_channelsp == chmode[mode].channels)
2405                 return 0;
2406         /* change the current channel setting */
2407         *max_channelsp = chmode[mode].channels;
2408         if (chmode[mode].sequence)
2409                 snd_hda_sequence_write_cache(codec, chmode[mode].sequence);
2410         return 1;
2411 }
2412
2413 /*
2414  * input MUX helper
2415  */
2416 int snd_hda_input_mux_info(const struct hda_input_mux *imux,
2417                            struct snd_ctl_elem_info *uinfo)
2418 {
2419         unsigned int index;
2420
2421         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2422         uinfo->count = 1;
2423         uinfo->value.enumerated.items = imux->num_items;
2424         if (!imux->num_items)
2425                 return 0;
2426         index = uinfo->value.enumerated.item;
2427         if (index >= imux->num_items)
2428                 index = imux->num_items - 1;
2429         strcpy(uinfo->value.enumerated.name, imux->items[index].label);
2430         return 0;
2431 }
2432
2433 int snd_hda_input_mux_put(struct hda_codec *codec,
2434                           const struct hda_input_mux *imux,
2435                           struct snd_ctl_elem_value *ucontrol,
2436                           hda_nid_t nid,
2437                           unsigned int *cur_val)
2438 {
2439         unsigned int idx;
2440
2441         if (!imux->num_items)
2442                 return 0;
2443         idx = ucontrol->value.enumerated.item[0];
2444         if (idx >= imux->num_items)
2445                 idx = imux->num_items - 1;
2446         if (*cur_val == idx)
2447                 return 0;
2448         snd_hda_codec_write_cache(codec, nid, 0, AC_VERB_SET_CONNECT_SEL,
2449                                   imux->items[idx].index);
2450         *cur_val = idx;
2451         return 1;
2452 }
2453
2454
2455 /*
2456  * Multi-channel / digital-out PCM helper functions
2457  */
2458
2459 /* setup SPDIF output stream */
2460 static void setup_dig_out_stream(struct hda_codec *codec, hda_nid_t nid,
2461                                  unsigned int stream_tag, unsigned int format)
2462 {
2463         /* turn off SPDIF once; otherwise the IEC958 bits won't be updated */
2464         if (codec->spdif_ctls & AC_DIG1_ENABLE)
2465                 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_1,
2466                                     codec->spdif_ctls & ~AC_DIG1_ENABLE & 0xff);
2467         snd_hda_codec_setup_stream(codec, nid, stream_tag, 0, format);
2468         /* turn on again (if needed) */
2469         if (codec->spdif_ctls & AC_DIG1_ENABLE)
2470                 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_1,
2471                                     codec->spdif_ctls & 0xff);
2472 }
2473
2474 /*
2475  * open the digital out in the exclusive mode
2476  */
2477 int snd_hda_multi_out_dig_open(struct hda_codec *codec,
2478                                struct hda_multi_out *mout)
2479 {
2480         mutex_lock(&codec->spdif_mutex);
2481         if (mout->dig_out_used == HDA_DIG_ANALOG_DUP)
2482                 /* already opened as analog dup; reset it once */
2483                 snd_hda_codec_setup_stream(codec, mout->dig_out_nid, 0, 0, 0);
2484         mout->dig_out_used = HDA_DIG_EXCLUSIVE;
2485         mutex_unlock(&codec->spdif_mutex);
2486         return 0;
2487 }
2488
2489 int snd_hda_multi_out_dig_prepare(struct hda_codec *codec,
2490                                   struct hda_multi_out *mout,
2491                                   unsigned int stream_tag,
2492                                   unsigned int format,
2493                                   struct snd_pcm_substream *substream)
2494 {
2495         mutex_lock(&codec->spdif_mutex);
2496         setup_dig_out_stream(codec, mout->dig_out_nid, stream_tag, format);
2497         mutex_unlock(&codec->spdif_mutex);
2498         return 0;
2499 }
2500
2501 /*
2502  * release the digital out
2503  */
2504 int snd_hda_multi_out_dig_close(struct hda_codec *codec,
2505                                 struct hda_multi_out *mout)
2506 {
2507         mutex_lock(&codec->spdif_mutex);
2508         mout->dig_out_used = 0;
2509         mutex_unlock(&codec->spdif_mutex);
2510         return 0;
2511 }
2512
2513 /*
2514  * set up more restrictions for analog out
2515  */
2516 int snd_hda_multi_out_analog_open(struct hda_codec *codec,
2517                                   struct hda_multi_out *mout,
2518                                   struct snd_pcm_substream *substream)
2519 {
2520         substream->runtime->hw.channels_max = mout->max_channels;
2521         return snd_pcm_hw_constraint_step(substream->runtime, 0,
2522                                           SNDRV_PCM_HW_PARAM_CHANNELS, 2);
2523 }
2524
2525 /*
2526  * set up the i/o for analog out
2527  * when the digital out is available, copy the front out to digital out, too.
2528  */
2529 int snd_hda_multi_out_analog_prepare(struct hda_codec *codec,
2530                                      struct hda_multi_out *mout,
2531                                      unsigned int stream_tag,
2532                                      unsigned int format,
2533                                      struct snd_pcm_substream *substream)
2534 {
2535         hda_nid_t *nids = mout->dac_nids;
2536         int chs = substream->runtime->channels;
2537         int i;
2538
2539         mutex_lock(&codec->spdif_mutex);
2540         if (mout->dig_out_nid && mout->dig_out_used != HDA_DIG_EXCLUSIVE) {
2541                 if (chs == 2 &&
2542                     snd_hda_is_supported_format(codec, mout->dig_out_nid,
2543                                                 format) &&
2544                     !(codec->spdif_status & IEC958_AES0_NONAUDIO)) {
2545                         mout->dig_out_used = HDA_DIG_ANALOG_DUP;
2546                         setup_dig_out_stream(codec, mout->dig_out_nid,
2547                                              stream_tag, format);
2548                 } else {
2549                         mout->dig_out_used = 0;
2550                         snd_hda_codec_setup_stream(codec, mout->dig_out_nid,
2551                                                    0, 0, 0);
2552                 }
2553         }
2554         mutex_unlock(&codec->spdif_mutex);
2555
2556         /* front */
2557         snd_hda_codec_setup_stream(codec, nids[HDA_FRONT], stream_tag,
2558                                    0, format);
2559         if (!mout->no_share_stream &&
2560             mout->hp_nid && mout->hp_nid != nids[HDA_FRONT])
2561                 /* headphone out will just decode front left/right (stereo) */
2562                 snd_hda_codec_setup_stream(codec, mout->hp_nid, stream_tag,
2563                                            0, format);
2564         /* extra outputs copied from front */
2565         for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++)
2566                 if (!mout->no_share_stream && mout->extra_out_nid[i])
2567                         snd_hda_codec_setup_stream(codec,
2568                                                    mout->extra_out_nid[i],
2569                                                    stream_tag, 0, format);
2570
2571         /* surrounds */
2572         for (i = 1; i < mout->num_dacs; i++) {
2573                 if (chs >= (i + 1) * 2) /* independent out */
2574                         snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
2575                                                    i * 2, format);
2576                 else if (!mout->no_share_stream) /* copy front */
2577                         snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
2578                                                    0, format);
2579         }
2580         return 0;
2581 }
2582
2583 /*
2584  * clean up the setting for analog out
2585  */
2586 int snd_hda_multi_out_analog_cleanup(struct hda_codec *codec,
2587                                      struct hda_multi_out *mout)
2588 {
2589         hda_nid_t *nids = mout->dac_nids;
2590         int i;
2591
2592         for (i = 0; i < mout->num_dacs; i++)
2593                 snd_hda_codec_setup_stream(codec, nids[i], 0, 0, 0);
2594         if (mout->hp_nid)
2595                 snd_hda_codec_setup_stream(codec, mout->hp_nid, 0, 0, 0);
2596         for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++)
2597                 if (mout->extra_out_nid[i])
2598                         snd_hda_codec_setup_stream(codec,
2599                                                    mout->extra_out_nid[i],
2600                                                    0, 0, 0);
2601         mutex_lock(&codec->spdif_mutex);
2602         if (mout->dig_out_nid && mout->dig_out_used == HDA_DIG_ANALOG_DUP) {
2603                 snd_hda_codec_setup_stream(codec, mout->dig_out_nid, 0, 0, 0);
2604                 mout->dig_out_used = 0;
2605         }
2606         mutex_unlock(&codec->spdif_mutex);
2607         return 0;
2608 }
2609
2610 /*
2611  * Helper for automatic ping configuration
2612  */
2613
2614 static int is_in_nid_list(hda_nid_t nid, hda_nid_t *list)
2615 {
2616         for (; *list; list++)
2617                 if (*list == nid)
2618                         return 1;
2619         return 0;
2620 }
2621
2622
2623 /*
2624  * Sort an associated group of pins according to their sequence numbers.
2625  */
2626 static void sort_pins_by_sequence(hda_nid_t * pins, short * sequences,
2627                                   int num_pins)
2628 {
2629         int i, j;
2630         short seq;
2631         hda_nid_t nid;
2632         
2633         for (i = 0; i < num_pins; i++) {
2634                 for (j = i + 1; j < num_pins; j++) {
2635                         if (sequences[i] > sequences[j]) {
2636                                 seq = sequences[i];
2637                                 sequences[i] = sequences[j];
2638                                 sequences[j] = seq;
2639                                 nid = pins[i];
2640                                 pins[i] = pins[j];
2641                                 pins[j] = nid;
2642                         }
2643                 }
2644         }
2645 }
2646
2647
2648 /*
2649  * Parse all pin widgets and store the useful pin nids to cfg
2650  *
2651  * The number of line-outs or any primary output is stored in line_outs,
2652  * and the corresponding output pins are assigned to line_out_pins[],
2653  * in the order of front, rear, CLFE, side, ...
2654  *
2655  * If more extra outputs (speaker and headphone) are found, the pins are
2656  * assisnged to hp_pins[] and speaker_pins[], respectively.  If no line-out jack
2657  * is detected, one of speaker of HP pins is assigned as the primary
2658  * output, i.e. to line_out_pins[0].  So, line_outs is always positive
2659  * if any analog output exists.
2660  * 
2661  * The analog input pins are assigned to input_pins array.
2662  * The digital input/output pins are assigned to dig_in_pin and dig_out_pin,
2663  * respectively.
2664  */
2665 int snd_hda_parse_pin_def_config(struct hda_codec *codec,
2666                                  struct auto_pin_cfg *cfg,
2667                                  hda_nid_t *ignore_nids)
2668 {
2669         hda_nid_t nid, nid_start;
2670         int nodes;
2671         short seq, assoc_line_out, assoc_speaker;
2672         short sequences_line_out[ARRAY_SIZE(cfg->line_out_pins)];
2673         short sequences_speaker[ARRAY_SIZE(cfg->speaker_pins)];
2674         short sequences_hp[ARRAY_SIZE(cfg->hp_pins)];
2675
2676         memset(cfg, 0, sizeof(*cfg));
2677
2678         memset(sequences_line_out, 0, sizeof(sequences_line_out));
2679         memset(sequences_speaker, 0, sizeof(sequences_speaker));
2680         memset(sequences_hp, 0, sizeof(sequences_hp));
2681         assoc_line_out = assoc_speaker = 0;
2682
2683         nodes = snd_hda_get_sub_nodes(codec, codec->afg, &nid_start);
2684         for (nid = nid_start; nid < nodes + nid_start; nid++) {
2685                 unsigned int wid_caps = get_wcaps(codec, nid);
2686                 unsigned int wid_type =
2687                         (wid_caps & AC_WCAP_TYPE) >> AC_WCAP_TYPE_SHIFT;
2688                 unsigned int def_conf;
2689                 short assoc, loc;
2690
2691                 /* read all default configuration for pin complex */
2692                 if (wid_type != AC_WID_PIN)
2693                         continue;
2694                 /* ignore the given nids (e.g. pc-beep returns error) */
2695                 if (ignore_nids && is_in_nid_list(nid, ignore_nids))
2696                         continue;
2697
2698                 def_conf = snd_hda_codec_read(codec, nid, 0,
2699                                               AC_VERB_GET_CONFIG_DEFAULT, 0);
2700                 if (get_defcfg_connect(def_conf) == AC_JACK_PORT_NONE)
2701                         continue;
2702                 loc = get_defcfg_location(def_conf);
2703                 switch (get_defcfg_device(def_conf)) {
2704                 case AC_JACK_LINE_OUT:
2705                         seq = get_defcfg_sequence(def_conf);
2706                         assoc = get_defcfg_association(def_conf);
2707                         if (!assoc)
2708                                 continue;
2709                         if (!assoc_line_out)
2710                                 assoc_line_out = assoc;
2711                         else if (assoc_line_out != assoc)
2712                                 continue;
2713                         if (cfg->line_outs >= ARRAY_SIZE(cfg->line_out_pins))
2714                                 continue;
2715                         cfg->line_out_pins[cfg->line_outs] = nid;
2716                         sequences_line_out[cfg->line_outs] = seq;
2717                         cfg->line_outs++;
2718                         break;
2719                 case AC_JACK_SPEAKER:
2720                         seq = get_defcfg_sequence(def_conf);
2721                         assoc = get_defcfg_association(def_conf);
2722                         if (! assoc)
2723                                 continue;
2724                         if (! assoc_speaker)
2725                                 assoc_speaker = assoc;
2726                         else if (assoc_speaker != assoc)
2727                                 continue;
2728                         if (cfg->speaker_outs >= ARRAY_SIZE(cfg->speaker_pins))
2729                                 continue;
2730                         cfg->speaker_pins[cfg->speaker_outs] = nid;
2731                         sequences_speaker[cfg->speaker_outs] = seq;
2732                         cfg->speaker_outs++;
2733                         break;
2734                 case AC_JACK_HP_OUT:
2735                         seq = get_defcfg_sequence(def_conf);
2736                         assoc = get_defcfg_association(def_conf);
2737                         if (cfg->hp_outs >= ARRAY_SIZE(cfg->hp_pins))
2738                                 continue;
2739                         cfg->hp_pins[cfg->hp_outs] = nid;
2740                         sequences_hp[cfg->hp_outs] = (assoc << 4) | seq;
2741                         cfg->hp_outs++;
2742                         break;
2743                 case AC_JACK_MIC_IN: {
2744                         int preferred, alt;
2745                         if (loc == AC_JACK_LOC_FRONT) {
2746                                 preferred = AUTO_PIN_FRONT_MIC;
2747                                 alt = AUTO_PIN_MIC;
2748                         } else {
2749                                 preferred = AUTO_PIN_MIC;
2750                                 alt = AUTO_PIN_FRONT_MIC;
2751                         }
2752                         if (!cfg->input_pins[preferred])
2753                                 cfg->input_pins[preferred] = nid;
2754                         else if (!cfg->input_pins[alt])
2755                                 cfg->input_pins[alt] = nid;
2756                         break;
2757                 }
2758                 case AC_JACK_LINE_IN:
2759                         if (loc == AC_JACK_LOC_FRONT)
2760                                 cfg->input_pins[AUTO_PIN_FRONT_LINE] = nid;
2761                         else
2762                                 cfg->input_pins[AUTO_PIN_LINE] = nid;
2763                         break;
2764                 case AC_JACK_CD:
2765                         cfg->input_pins[AUTO_PIN_CD] = nid;
2766                         break;
2767                 case AC_JACK_AUX:
2768                         cfg->input_pins[AUTO_PIN_AUX] = nid;
2769                         break;
2770                 case AC_JACK_SPDIF_OUT:
2771                         cfg->dig_out_pin = nid;
2772                         break;
2773                 case AC_JACK_SPDIF_IN:
2774                         cfg->dig_in_pin = nid;
2775                         break;
2776                 }
2777         }
2778
2779         /* sort by sequence */
2780         sort_pins_by_sequence(cfg->line_out_pins, sequences_line_out,
2781                               cfg->line_outs);
2782         sort_pins_by_sequence(cfg->speaker_pins, sequences_speaker,
2783                               cfg->speaker_outs);
2784         sort_pins_by_sequence(cfg->hp_pins, sequences_hp,
2785                               cfg->hp_outs);
2786         
2787         /* if we have only one mic, make it AUTO_PIN_MIC */
2788         if (!cfg->input_pins[AUTO_PIN_MIC] &&
2789             cfg->input_pins[AUTO_PIN_FRONT_MIC]) {
2790                 cfg->input_pins[AUTO_PIN_MIC] =
2791                         cfg->input_pins[AUTO_PIN_FRONT_MIC];
2792                 cfg->input_pins[AUTO_PIN_FRONT_MIC] = 0;
2793         }
2794         /* ditto for line-in */
2795         if (!cfg->input_pins[AUTO_PIN_LINE] &&
2796             cfg->input_pins[AUTO_PIN_FRONT_LINE]) {
2797                 cfg->input_pins[AUTO_PIN_LINE] =
2798                         cfg->input_pins[AUTO_PIN_FRONT_LINE];
2799                 cfg->input_pins[AUTO_PIN_FRONT_LINE] = 0;
2800         }
2801
2802         /*
2803          * FIX-UP: if no line-outs are detected, try to use speaker or HP pin
2804          * as a primary output
2805          */
2806         if (!cfg->line_outs) {
2807                 if (cfg->speaker_outs) {
2808                         cfg->line_outs = cfg->speaker_outs;
2809                         memcpy(cfg->line_out_pins, cfg->speaker_pins,
2810                                sizeof(cfg->speaker_pins));
2811                         cfg->speaker_outs = 0;
2812                         memset(cfg->speaker_pins, 0, sizeof(cfg->speaker_pins));
2813                         cfg->line_out_type = AUTO_PIN_SPEAKER_OUT;
2814                 } else if (cfg->hp_outs) {
2815                         cfg->line_outs = cfg->hp_outs;
2816                         memcpy(cfg->line_out_pins, cfg->hp_pins,
2817                                sizeof(cfg->hp_pins));
2818                         cfg->hp_outs = 0;
2819                         memset(cfg->hp_pins, 0, sizeof(cfg->hp_pins));
2820                         cfg->line_out_type = AUTO_PIN_HP_OUT;
2821                 }
2822         }
2823
2824         /* Reorder the surround channels
2825          * ALSA sequence is front/surr/clfe/side
2826          * HDA sequence is:
2827          *    4-ch: front/surr  =>  OK as it is
2828          *    6-ch: front/clfe/surr
2829          *    8-ch: front/clfe/rear/side|fc
2830          */
2831         switch (cfg->line_outs) {
2832         case 3:
2833         case 4:
2834                 nid = cfg->line_out_pins[1];
2835                 cfg->line_out_pins[1] = cfg->line_out_pins[2];
2836                 cfg->line_out_pins[2] = nid;
2837                 break;
2838         }
2839
2840         /*
2841          * debug prints of the parsed results
2842          */
2843         snd_printd("autoconfig: line_outs=%d (0x%x/0x%x/0x%x/0x%x/0x%x)\n",
2844                    cfg->line_outs, cfg->line_out_pins[0], cfg->line_out_pins[1],
2845                    cfg->line_out_pins[2], cfg->line_out_pins[3],
2846                    cfg->line_out_pins[4]);
2847         snd_printd("   speaker_outs=%d (0x%x/0x%x/0x%x/0x%x/0x%x)\n",
2848                    cfg->speaker_outs, cfg->speaker_pins[0],
2849                    cfg->speaker_pins[1], cfg->speaker_pins[2],
2850                    cfg->speaker_pins[3], cfg->speaker_pins[4]);
2851         snd_printd("   hp_outs=%d (0x%x/0x%x/0x%x/0x%x/0x%x)\n",
2852                    cfg->hp_outs, cfg->hp_pins[0],
2853                    cfg->hp_pins[1], cfg->hp_pins[2],
2854                    cfg->hp_pins[3], cfg->hp_pins[4]);
2855         snd_printd("   inputs: mic=0x%x, fmic=0x%x, line=0x%x, fline=0x%x,"
2856                    " cd=0x%x, aux=0x%x\n",
2857                    cfg->input_pins[AUTO_PIN_MIC],
2858                    cfg->input_pins[AUTO_PIN_FRONT_MIC],
2859                    cfg->input_pins[AUTO_PIN_LINE],
2860                    cfg->input_pins[AUTO_PIN_FRONT_LINE],
2861                    cfg->input_pins[AUTO_PIN_CD],
2862                    cfg->input_pins[AUTO_PIN_AUX]);
2863
2864         return 0;
2865 }
2866
2867 /* labels for input pins */
2868 const char *auto_pin_cfg_labels[AUTO_PIN_LAST] = {
2869         "Mic", "Front Mic", "Line", "Front Line", "CD", "Aux"
2870 };
2871
2872
2873 #ifdef CONFIG_PM
2874 /*
2875  * power management
2876  */
2877
2878 /**
2879  * snd_hda_suspend - suspend the codecs
2880  * @bus: the HDA bus
2881  * @state: suspsend state
2882  *
2883  * Returns 0 if successful.
2884  */
2885 int snd_hda_suspend(struct hda_bus *bus, pm_message_t state)
2886 {
2887         struct hda_codec *codec;
2888
2889         list_for_each_entry(codec, &bus->codec_list, list) {
2890 #ifdef CONFIG_SND_HDA_POWER_SAVE
2891                 if (!codec->power_on)
2892                         continue;
2893 #endif
2894                 hda_call_codec_suspend(codec);
2895         }
2896         return 0;
2897 }
2898
2899 /**
2900  * snd_hda_resume - resume the codecs
2901  * @bus: the HDA bus
2902  * @state: resume state
2903  *
2904  * Returns 0 if successful.
2905  *
2906  * This fucntion is defined only when POWER_SAVE isn't set.
2907  * In the power-save mode, the codec is resumed dynamically.
2908  */
2909 int snd_hda_resume(struct hda_bus *bus)
2910 {
2911         struct hda_codec *codec;
2912
2913         list_for_each_entry(codec, &bus->codec_list, list) {
2914                 if (snd_hda_codec_needs_resume(codec))
2915                         hda_call_codec_resume(codec);
2916         }
2917         return 0;
2918 }
2919 #ifdef CONFIG_SND_HDA_POWER_SAVE
2920 int snd_hda_codecs_inuse(struct hda_bus *bus)
2921 {
2922         struct hda_codec *codec;
2923
2924         list_for_each_entry(codec, &bus->codec_list, list) {
2925                 if (snd_hda_codec_needs_resume(codec))
2926                         return 1;
2927         }
2928         return 0;
2929 }
2930 #endif
2931 #endif