[ALSA] hda-codec - Add a delay after power state change
[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         msleep(10); /* partial workaround for "azx_get_response timeout" */
1689
1690         nid = codec->start_nid;
1691         for (i = 0; i < codec->num_nodes; i++, nid++) {
1692                 unsigned int wcaps = get_wcaps(codec, nid);
1693                 if (wcaps & AC_WCAP_POWER) {
1694                         unsigned int wid_type = (wcaps & AC_WCAP_TYPE) >>
1695                                 AC_WCAP_TYPE_SHIFT;
1696                         if (wid_type == AC_WID_PIN) {
1697                                 unsigned int pincap;
1698                                 /*
1699                                  * don't power down the widget if it controls
1700                                  * eapd and EAPD_BTLENABLE is set.
1701                                  */
1702                                 pincap = snd_hda_param_read(codec, nid,
1703                                                             AC_PAR_PIN_CAP);
1704                                 if (pincap & AC_PINCAP_EAPD) {
1705                                         int eapd = snd_hda_codec_read(codec,
1706                                                 nid, 0,
1707                                                 AC_VERB_GET_EAPD_BTLENABLE, 0);
1708                                         eapd &= 0x02;
1709                                         if (power_state == AC_PWRST_D3 && eapd)
1710                                                 continue;
1711                                 }
1712                         }
1713                         snd_hda_codec_write(codec, nid, 0,
1714                                             AC_VERB_SET_POWER_STATE,
1715                                             power_state);
1716                 }
1717         }
1718
1719         if (power_state == AC_PWRST_D0) {
1720                 unsigned long end_time;
1721                 int state;
1722                 msleep(10);
1723                 /* wait until the codec reachs to D0 */
1724                 end_time = jiffies + msecs_to_jiffies(500);
1725                 do {
1726                         state = snd_hda_codec_read(codec, fg, 0,
1727                                                    AC_VERB_GET_POWER_STATE, 0);
1728                         if (state == power_state)
1729                                 break;
1730                         msleep(1);
1731                 } while (time_after_eq(end_time, jiffies));
1732         }
1733 }
1734
1735 #ifdef SND_HDA_NEEDS_RESUME
1736 /*
1737  * call suspend and power-down; used both from PM and power-save
1738  */
1739 static void hda_call_codec_suspend(struct hda_codec *codec)
1740 {
1741         if (codec->patch_ops.suspend)
1742                 codec->patch_ops.suspend(codec, PMSG_SUSPEND);
1743         hda_set_power_state(codec,
1744                             codec->afg ? codec->afg : codec->mfg,
1745                             AC_PWRST_D3);
1746 #ifdef CONFIG_SND_HDA_POWER_SAVE
1747         cancel_delayed_work(&codec->power_work);
1748         codec->power_on = 0;
1749         codec->power_transition = 0;
1750 #endif
1751 }
1752
1753 /*
1754  * kick up codec; used both from PM and power-save
1755  */
1756 static void hda_call_codec_resume(struct hda_codec *codec)
1757 {
1758         hda_set_power_state(codec,
1759                             codec->afg ? codec->afg : codec->mfg,
1760                             AC_PWRST_D0);
1761         if (codec->patch_ops.resume)
1762                 codec->patch_ops.resume(codec);
1763         else {
1764                 if (codec->patch_ops.init)
1765                         codec->patch_ops.init(codec);
1766                 snd_hda_codec_resume_amp(codec);
1767                 snd_hda_codec_resume_cache(codec);
1768         }
1769 }
1770 #endif /* SND_HDA_NEEDS_RESUME */
1771
1772
1773 /**
1774  * snd_hda_build_controls - build mixer controls
1775  * @bus: the BUS
1776  *
1777  * Creates mixer controls for each codec included in the bus.
1778  *
1779  * Returns 0 if successful, otherwise a negative error code.
1780  */
1781 int __devinit snd_hda_build_controls(struct hda_bus *bus)
1782 {
1783         struct hda_codec *codec;
1784
1785         list_for_each_entry(codec, &bus->codec_list, list) {
1786                 int err = 0;
1787                 /* fake as if already powered-on */
1788                 hda_keep_power_on(codec);
1789                 /* then fire up */
1790                 hda_set_power_state(codec,
1791                                     codec->afg ? codec->afg : codec->mfg,
1792                                     AC_PWRST_D0);
1793                 /* continue to initialize... */
1794                 if (codec->patch_ops.init)
1795                         err = codec->patch_ops.init(codec);
1796                 if (!err && codec->patch_ops.build_controls)
1797                         err = codec->patch_ops.build_controls(codec);
1798                 snd_hda_power_down(codec);
1799                 if (err < 0)
1800                         return err;
1801         }
1802
1803         return 0;
1804 }
1805
1806 /*
1807  * stream formats
1808  */
1809 struct hda_rate_tbl {
1810         unsigned int hz;
1811         unsigned int alsa_bits;
1812         unsigned int hda_fmt;
1813 };
1814
1815 static struct hda_rate_tbl rate_bits[] = {
1816         /* rate in Hz, ALSA rate bitmask, HDA format value */
1817
1818         /* autodetected value used in snd_hda_query_supported_pcm */
1819         { 8000, SNDRV_PCM_RATE_8000, 0x0500 }, /* 1/6 x 48 */
1820         { 11025, SNDRV_PCM_RATE_11025, 0x4300 }, /* 1/4 x 44 */
1821         { 16000, SNDRV_PCM_RATE_16000, 0x0200 }, /* 1/3 x 48 */
1822         { 22050, SNDRV_PCM_RATE_22050, 0x4100 }, /* 1/2 x 44 */
1823         { 32000, SNDRV_PCM_RATE_32000, 0x0a00 }, /* 2/3 x 48 */
1824         { 44100, SNDRV_PCM_RATE_44100, 0x4000 }, /* 44 */
1825         { 48000, SNDRV_PCM_RATE_48000, 0x0000 }, /* 48 */
1826         { 88200, SNDRV_PCM_RATE_88200, 0x4800 }, /* 2 x 44 */
1827         { 96000, SNDRV_PCM_RATE_96000, 0x0800 }, /* 2 x 48 */
1828         { 176400, SNDRV_PCM_RATE_176400, 0x5800 },/* 4 x 44 */
1829         { 192000, SNDRV_PCM_RATE_192000, 0x1800 }, /* 4 x 48 */
1830 #define AC_PAR_PCM_RATE_BITS    11
1831         /* up to bits 10, 384kHZ isn't supported properly */
1832
1833         /* not autodetected value */
1834         { 9600, SNDRV_PCM_RATE_KNOT, 0x0400 }, /* 1/5 x 48 */
1835
1836         { 0 } /* terminator */
1837 };
1838
1839 /**
1840  * snd_hda_calc_stream_format - calculate format bitset
1841  * @rate: the sample rate
1842  * @channels: the number of channels
1843  * @format: the PCM format (SNDRV_PCM_FORMAT_XXX)
1844  * @maxbps: the max. bps
1845  *
1846  * Calculate the format bitset from the given rate, channels and th PCM format.
1847  *
1848  * Return zero if invalid.
1849  */
1850 unsigned int snd_hda_calc_stream_format(unsigned int rate,
1851                                         unsigned int channels,
1852                                         unsigned int format,
1853                                         unsigned int maxbps)
1854 {
1855         int i;
1856         unsigned int val = 0;
1857
1858         for (i = 0; rate_bits[i].hz; i++)
1859                 if (rate_bits[i].hz == rate) {
1860                         val = rate_bits[i].hda_fmt;
1861                         break;
1862                 }
1863         if (!rate_bits[i].hz) {
1864                 snd_printdd("invalid rate %d\n", rate);
1865                 return 0;
1866         }
1867
1868         if (channels == 0 || channels > 8) {
1869                 snd_printdd("invalid channels %d\n", channels);
1870                 return 0;
1871         }
1872         val |= channels - 1;
1873
1874         switch (snd_pcm_format_width(format)) {
1875         case 8:  val |= 0x00; break;
1876         case 16: val |= 0x10; break;
1877         case 20:
1878         case 24:
1879         case 32:
1880                 if (maxbps >= 32)
1881                         val |= 0x40;
1882                 else if (maxbps >= 24)
1883                         val |= 0x30;
1884                 else
1885                         val |= 0x20;
1886                 break;
1887         default:
1888                 snd_printdd("invalid format width %d\n",
1889                             snd_pcm_format_width(format));
1890                 return 0;
1891         }
1892
1893         return val;
1894 }
1895
1896 /**
1897  * snd_hda_query_supported_pcm - query the supported PCM rates and formats
1898  * @codec: the HDA codec
1899  * @nid: NID to query
1900  * @ratesp: the pointer to store the detected rate bitflags
1901  * @formatsp: the pointer to store the detected formats
1902  * @bpsp: the pointer to store the detected format widths
1903  *
1904  * Queries the supported PCM rates and formats.  The NULL @ratesp, @formatsp
1905  * or @bsps argument is ignored.
1906  *
1907  * Returns 0 if successful, otherwise a negative error code.
1908  */
1909 int snd_hda_query_supported_pcm(struct hda_codec *codec, hda_nid_t nid,
1910                                 u32 *ratesp, u64 *formatsp, unsigned int *bpsp)
1911 {
1912         int i;
1913         unsigned int val, streams;
1914
1915         val = 0;
1916         if (nid != codec->afg &&
1917             (get_wcaps(codec, nid) & AC_WCAP_FORMAT_OVRD)) {
1918                 val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
1919                 if (val == -1)
1920                         return -EIO;
1921         }
1922         if (!val)
1923                 val = snd_hda_param_read(codec, codec->afg, AC_PAR_PCM);
1924
1925         if (ratesp) {
1926                 u32 rates = 0;
1927                 for (i = 0; i < AC_PAR_PCM_RATE_BITS; i++) {
1928                         if (val & (1 << i))
1929                                 rates |= rate_bits[i].alsa_bits;
1930                 }
1931                 *ratesp = rates;
1932         }
1933
1934         if (formatsp || bpsp) {
1935                 u64 formats = 0;
1936                 unsigned int bps;
1937                 unsigned int wcaps;
1938
1939                 wcaps = get_wcaps(codec, nid);
1940                 streams = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
1941                 if (streams == -1)
1942                         return -EIO;
1943                 if (!streams) {
1944                         streams = snd_hda_param_read(codec, codec->afg,
1945                                                      AC_PAR_STREAM);
1946                         if (streams == -1)
1947                                 return -EIO;
1948                 }
1949
1950                 bps = 0;
1951                 if (streams & AC_SUPFMT_PCM) {
1952                         if (val & AC_SUPPCM_BITS_8) {
1953                                 formats |= SNDRV_PCM_FMTBIT_U8;
1954                                 bps = 8;
1955                         }
1956                         if (val & AC_SUPPCM_BITS_16) {
1957                                 formats |= SNDRV_PCM_FMTBIT_S16_LE;
1958                                 bps = 16;
1959                         }
1960                         if (wcaps & AC_WCAP_DIGITAL) {
1961                                 if (val & AC_SUPPCM_BITS_32)
1962                                         formats |= SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE;
1963                                 if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24))
1964                                         formats |= SNDRV_PCM_FMTBIT_S32_LE;
1965                                 if (val & AC_SUPPCM_BITS_24)
1966                                         bps = 24;
1967                                 else if (val & AC_SUPPCM_BITS_20)
1968                                         bps = 20;
1969                         } else if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24|
1970                                           AC_SUPPCM_BITS_32)) {
1971                                 formats |= SNDRV_PCM_FMTBIT_S32_LE;
1972                                 if (val & AC_SUPPCM_BITS_32)
1973                                         bps = 32;
1974                                 else if (val & AC_SUPPCM_BITS_24)
1975                                         bps = 24;
1976                                 else if (val & AC_SUPPCM_BITS_20)
1977                                         bps = 20;
1978                         }
1979                 }
1980                 else if (streams == AC_SUPFMT_FLOAT32) {
1981                         /* should be exclusive */
1982                         formats |= SNDRV_PCM_FMTBIT_FLOAT_LE;
1983                         bps = 32;
1984                 } else if (streams == AC_SUPFMT_AC3) {
1985                         /* should be exclusive */
1986                         /* temporary hack: we have still no proper support
1987                          * for the direct AC3 stream...
1988                          */
1989                         formats |= SNDRV_PCM_FMTBIT_U8;
1990                         bps = 8;
1991                 }
1992                 if (formatsp)
1993                         *formatsp = formats;
1994                 if (bpsp)
1995                         *bpsp = bps;
1996         }
1997
1998         return 0;
1999 }
2000
2001 /**
2002  * snd_hda_is_supported_format - check whether the given node supports
2003  * the format val
2004  *
2005  * Returns 1 if supported, 0 if not.
2006  */
2007 int snd_hda_is_supported_format(struct hda_codec *codec, hda_nid_t nid,
2008                                 unsigned int format)
2009 {
2010         int i;
2011         unsigned int val = 0, rate, stream;
2012
2013         if (nid != codec->afg &&
2014             (get_wcaps(codec, nid) & AC_WCAP_FORMAT_OVRD)) {
2015                 val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
2016                 if (val == -1)
2017                         return 0;
2018         }
2019         if (!val) {
2020                 val = snd_hda_param_read(codec, codec->afg, AC_PAR_PCM);
2021                 if (val == -1)
2022                         return 0;
2023         }
2024
2025         rate = format & 0xff00;
2026         for (i = 0; i < AC_PAR_PCM_RATE_BITS; i++)
2027                 if (rate_bits[i].hda_fmt == rate) {
2028                         if (val & (1 << i))
2029                                 break;
2030                         return 0;
2031                 }
2032         if (i >= AC_PAR_PCM_RATE_BITS)
2033                 return 0;
2034
2035         stream = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
2036         if (stream == -1)
2037                 return 0;
2038         if (!stream && nid != codec->afg)
2039                 stream = snd_hda_param_read(codec, codec->afg, AC_PAR_STREAM);
2040         if (!stream || stream == -1)
2041                 return 0;
2042
2043         if (stream & AC_SUPFMT_PCM) {
2044                 switch (format & 0xf0) {
2045                 case 0x00:
2046                         if (!(val & AC_SUPPCM_BITS_8))
2047                                 return 0;
2048                         break;
2049                 case 0x10:
2050                         if (!(val & AC_SUPPCM_BITS_16))
2051                                 return 0;
2052                         break;
2053                 case 0x20:
2054                         if (!(val & AC_SUPPCM_BITS_20))
2055                                 return 0;
2056                         break;
2057                 case 0x30:
2058                         if (!(val & AC_SUPPCM_BITS_24))
2059                                 return 0;
2060                         break;
2061                 case 0x40:
2062                         if (!(val & AC_SUPPCM_BITS_32))
2063                                 return 0;
2064                         break;
2065                 default:
2066                         return 0;
2067                 }
2068         } else {
2069                 /* FIXME: check for float32 and AC3? */
2070         }
2071
2072         return 1;
2073 }
2074
2075 /*
2076  * PCM stuff
2077  */
2078 static int hda_pcm_default_open_close(struct hda_pcm_stream *hinfo,
2079                                       struct hda_codec *codec,
2080                                       struct snd_pcm_substream *substream)
2081 {
2082         return 0;
2083 }
2084
2085 static int hda_pcm_default_prepare(struct hda_pcm_stream *hinfo,
2086                                    struct hda_codec *codec,
2087                                    unsigned int stream_tag,
2088                                    unsigned int format,
2089                                    struct snd_pcm_substream *substream)
2090 {
2091         snd_hda_codec_setup_stream(codec, hinfo->nid, stream_tag, 0, format);
2092         return 0;
2093 }
2094
2095 static int hda_pcm_default_cleanup(struct hda_pcm_stream *hinfo,
2096                                    struct hda_codec *codec,
2097                                    struct snd_pcm_substream *substream)
2098 {
2099         snd_hda_codec_setup_stream(codec, hinfo->nid, 0, 0, 0);
2100         return 0;
2101 }
2102
2103 static int __devinit set_pcm_default_values(struct hda_codec *codec,
2104                                             struct hda_pcm_stream *info)
2105 {
2106         /* query support PCM information from the given NID */
2107         if (info->nid && (!info->rates || !info->formats)) {
2108                 snd_hda_query_supported_pcm(codec, info->nid,
2109                                 info->rates ? NULL : &info->rates,
2110                                 info->formats ? NULL : &info->formats,
2111                                 info->maxbps ? NULL : &info->maxbps);
2112         }
2113         if (info->ops.open == NULL)
2114                 info->ops.open = hda_pcm_default_open_close;
2115         if (info->ops.close == NULL)
2116                 info->ops.close = hda_pcm_default_open_close;
2117         if (info->ops.prepare == NULL) {
2118                 snd_assert(info->nid, return -EINVAL);
2119                 info->ops.prepare = hda_pcm_default_prepare;
2120         }
2121         if (info->ops.cleanup == NULL) {
2122                 snd_assert(info->nid, return -EINVAL);
2123                 info->ops.cleanup = hda_pcm_default_cleanup;
2124         }
2125         return 0;
2126 }
2127
2128 /**
2129  * snd_hda_build_pcms - build PCM information
2130  * @bus: the BUS
2131  *
2132  * Create PCM information for each codec included in the bus.
2133  *
2134  * The build_pcms codec patch is requested to set up codec->num_pcms and
2135  * codec->pcm_info properly.  The array is referred by the top-level driver
2136  * to create its PCM instances.
2137  * The allocated codec->pcm_info should be released in codec->patch_ops.free
2138  * callback.
2139  *
2140  * At least, substreams, channels_min and channels_max must be filled for
2141  * each stream.  substreams = 0 indicates that the stream doesn't exist.
2142  * When rates and/or formats are zero, the supported values are queried
2143  * from the given nid.  The nid is used also by the default ops.prepare
2144  * and ops.cleanup callbacks.
2145  *
2146  * The driver needs to call ops.open in its open callback.  Similarly,
2147  * ops.close is supposed to be called in the close callback.
2148  * ops.prepare should be called in the prepare or hw_params callback
2149  * with the proper parameters for set up.
2150  * ops.cleanup should be called in hw_free for clean up of streams.
2151  *
2152  * This function returns 0 if successfull, or a negative error code.
2153  */
2154 int __devinit snd_hda_build_pcms(struct hda_bus *bus)
2155 {
2156         struct hda_codec *codec;
2157
2158         list_for_each_entry(codec, &bus->codec_list, list) {
2159                 unsigned int pcm, s;
2160                 int err;
2161                 if (!codec->patch_ops.build_pcms)
2162                         continue;
2163                 err = codec->patch_ops.build_pcms(codec);
2164                 if (err < 0)
2165                         return err;
2166                 for (pcm = 0; pcm < codec->num_pcms; pcm++) {
2167                         for (s = 0; s < 2; s++) {
2168                                 struct hda_pcm_stream *info;
2169                                 info = &codec->pcm_info[pcm].stream[s];
2170                                 if (!info->substreams)
2171                                         continue;
2172                                 err = set_pcm_default_values(codec, info);
2173                                 if (err < 0)
2174                                         return err;
2175                         }
2176                 }
2177         }
2178         return 0;
2179 }
2180
2181 /**
2182  * snd_hda_check_board_config - compare the current codec with the config table
2183  * @codec: the HDA codec
2184  * @num_configs: number of config enums
2185  * @models: array of model name strings
2186  * @tbl: configuration table, terminated by null entries
2187  *
2188  * Compares the modelname or PCI subsystem id of the current codec with the
2189  * given configuration table.  If a matching entry is found, returns its
2190  * config value (supposed to be 0 or positive).
2191  *
2192  * If no entries are matching, the function returns a negative value.
2193  */
2194 int snd_hda_check_board_config(struct hda_codec *codec,
2195                                int num_configs, const char **models,
2196                                const struct snd_pci_quirk *tbl)
2197 {
2198         if (codec->bus->modelname && models) {
2199                 int i;
2200                 for (i = 0; i < num_configs; i++) {
2201                         if (models[i] &&
2202                             !strcmp(codec->bus->modelname, models[i])) {
2203                                 snd_printd(KERN_INFO "hda_codec: model '%s' is "
2204                                            "selected\n", models[i]);
2205                                 return i;
2206                         }
2207                 }
2208         }
2209
2210         if (!codec->bus->pci || !tbl)
2211                 return -1;
2212
2213         tbl = snd_pci_quirk_lookup(codec->bus->pci, tbl);
2214         if (!tbl)
2215                 return -1;
2216         if (tbl->value >= 0 && tbl->value < num_configs) {
2217 #ifdef CONFIG_SND_DEBUG_DETECT
2218                 char tmp[10];
2219                 const char *model = NULL;
2220                 if (models)
2221                         model = models[tbl->value];
2222                 if (!model) {
2223                         sprintf(tmp, "#%d", tbl->value);
2224                         model = tmp;
2225                 }
2226                 snd_printdd(KERN_INFO "hda_codec: model '%s' is selected "
2227                             "for config %x:%x (%s)\n",
2228                             model, tbl->subvendor, tbl->subdevice,
2229                             (tbl->name ? tbl->name : "Unknown device"));
2230 #endif
2231                 return tbl->value;
2232         }
2233         return -1;
2234 }
2235
2236 /**
2237  * snd_hda_add_new_ctls - create controls from the array
2238  * @codec: the HDA codec
2239  * @knew: the array of struct snd_kcontrol_new
2240  *
2241  * This helper function creates and add new controls in the given array.
2242  * The array must be terminated with an empty entry as terminator.
2243  *
2244  * Returns 0 if successful, or a negative error code.
2245  */
2246 int snd_hda_add_new_ctls(struct hda_codec *codec, struct snd_kcontrol_new *knew)
2247 {
2248         int err;
2249
2250         for (; knew->name; knew++) {
2251                 struct snd_kcontrol *kctl;
2252                 kctl = snd_ctl_new1(knew, codec);
2253                 if (!kctl)
2254                         return -ENOMEM;
2255                 err = snd_ctl_add(codec->bus->card, kctl);
2256                 if (err < 0) {
2257                         if (!codec->addr)
2258                                 return err;
2259                         kctl = snd_ctl_new1(knew, codec);
2260                         if (!kctl)
2261                                 return -ENOMEM;
2262                         kctl->id.device = codec->addr;
2263                         err = snd_ctl_add(codec->bus->card, kctl);
2264                         if (err < 0)
2265                                 return err;
2266                 }
2267         }
2268         return 0;
2269 }
2270
2271 #ifdef CONFIG_SND_HDA_POWER_SAVE
2272 static void hda_set_power_state(struct hda_codec *codec, hda_nid_t fg,
2273                                 unsigned int power_state);
2274
2275 static void hda_power_work(struct work_struct *work)
2276 {
2277         struct hda_codec *codec =
2278                 container_of(work, struct hda_codec, power_work.work);
2279
2280         if (!codec->power_on || codec->power_count) {
2281                 codec->power_transition = 0;
2282                 return;
2283         }
2284
2285         hda_call_codec_suspend(codec);
2286         if (codec->bus->ops.pm_notify)
2287                 codec->bus->ops.pm_notify(codec);
2288 }
2289
2290 static void hda_keep_power_on(struct hda_codec *codec)
2291 {
2292         codec->power_count++;
2293         codec->power_on = 1;
2294 }
2295
2296 void snd_hda_power_up(struct hda_codec *codec)
2297 {
2298         codec->power_count++;
2299         if (codec->power_on || codec->power_transition)
2300                 return;
2301
2302         codec->power_on = 1;
2303         if (codec->bus->ops.pm_notify)
2304                 codec->bus->ops.pm_notify(codec);
2305         hda_call_codec_resume(codec);
2306         cancel_delayed_work(&codec->power_work);
2307         codec->power_transition = 0;
2308 }
2309
2310 void snd_hda_power_down(struct hda_codec *codec)
2311 {
2312         --codec->power_count;
2313         if (!codec->power_on || codec->power_count || codec->power_transition)
2314                 return;
2315         if (power_save) {
2316                 codec->power_transition = 1; /* avoid reentrance */
2317                 schedule_delayed_work(&codec->power_work,
2318                                       msecs_to_jiffies(power_save * 1000));
2319         }
2320 }
2321
2322 int snd_hda_check_amp_list_power(struct hda_codec *codec,
2323                                  struct hda_loopback_check *check,
2324                                  hda_nid_t nid)
2325 {
2326         struct hda_amp_list *p;
2327         int ch, v;
2328
2329         if (!check->amplist)
2330                 return 0;
2331         for (p = check->amplist; p->nid; p++) {
2332                 if (p->nid == nid)
2333                         break;
2334         }
2335         if (!p->nid)
2336                 return 0; /* nothing changed */
2337
2338         for (p = check->amplist; p->nid; p++) {
2339                 for (ch = 0; ch < 2; ch++) {
2340                         v = snd_hda_codec_amp_read(codec, p->nid, ch, p->dir,
2341                                                    p->idx);
2342                         if (!(v & HDA_AMP_MUTE) && v > 0) {
2343                                 if (!check->power_on) {
2344                                         check->power_on = 1;
2345                                         snd_hda_power_up(codec);
2346                                 }
2347                                 return 1;
2348                         }
2349                 }
2350         }
2351         if (check->power_on) {
2352                 check->power_on = 0;
2353                 snd_hda_power_down(codec);
2354         }
2355         return 0;
2356 }
2357 #endif
2358
2359 /*
2360  * Channel mode helper
2361  */
2362 int snd_hda_ch_mode_info(struct hda_codec *codec,
2363                          struct snd_ctl_elem_info *uinfo,
2364                          const struct hda_channel_mode *chmode,
2365                          int num_chmodes)
2366 {
2367         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2368         uinfo->count = 1;
2369         uinfo->value.enumerated.items = num_chmodes;
2370         if (uinfo->value.enumerated.item >= num_chmodes)
2371                 uinfo->value.enumerated.item = num_chmodes - 1;
2372         sprintf(uinfo->value.enumerated.name, "%dch",
2373                 chmode[uinfo->value.enumerated.item].channels);
2374         return 0;
2375 }
2376
2377 int snd_hda_ch_mode_get(struct hda_codec *codec,
2378                         struct snd_ctl_elem_value *ucontrol,
2379                         const struct hda_channel_mode *chmode,
2380                         int num_chmodes,
2381                         int max_channels)
2382 {
2383         int i;
2384
2385         for (i = 0; i < num_chmodes; i++) {
2386                 if (max_channels == chmode[i].channels) {
2387                         ucontrol->value.enumerated.item[0] = i;
2388                         break;
2389                 }
2390         }
2391         return 0;
2392 }
2393
2394 int snd_hda_ch_mode_put(struct hda_codec *codec,
2395                         struct snd_ctl_elem_value *ucontrol,
2396                         const struct hda_channel_mode *chmode,
2397                         int num_chmodes,
2398                         int *max_channelsp)
2399 {
2400         unsigned int mode;
2401
2402         mode = ucontrol->value.enumerated.item[0];
2403         if (mode >= num_chmodes)
2404                 return -EINVAL;
2405         if (*max_channelsp == chmode[mode].channels)
2406                 return 0;
2407         /* change the current channel setting */
2408         *max_channelsp = chmode[mode].channels;
2409         if (chmode[mode].sequence)
2410                 snd_hda_sequence_write_cache(codec, chmode[mode].sequence);
2411         return 1;
2412 }
2413
2414 /*
2415  * input MUX helper
2416  */
2417 int snd_hda_input_mux_info(const struct hda_input_mux *imux,
2418                            struct snd_ctl_elem_info *uinfo)
2419 {
2420         unsigned int index;
2421
2422         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2423         uinfo->count = 1;
2424         uinfo->value.enumerated.items = imux->num_items;
2425         if (!imux->num_items)
2426                 return 0;
2427         index = uinfo->value.enumerated.item;
2428         if (index >= imux->num_items)
2429                 index = imux->num_items - 1;
2430         strcpy(uinfo->value.enumerated.name, imux->items[index].label);
2431         return 0;
2432 }
2433
2434 int snd_hda_input_mux_put(struct hda_codec *codec,
2435                           const struct hda_input_mux *imux,
2436                           struct snd_ctl_elem_value *ucontrol,
2437                           hda_nid_t nid,
2438                           unsigned int *cur_val)
2439 {
2440         unsigned int idx;
2441
2442         if (!imux->num_items)
2443                 return 0;
2444         idx = ucontrol->value.enumerated.item[0];
2445         if (idx >= imux->num_items)
2446                 idx = imux->num_items - 1;
2447         if (*cur_val == idx)
2448                 return 0;
2449         snd_hda_codec_write_cache(codec, nid, 0, AC_VERB_SET_CONNECT_SEL,
2450                                   imux->items[idx].index);
2451         *cur_val = idx;
2452         return 1;
2453 }
2454
2455
2456 /*
2457  * Multi-channel / digital-out PCM helper functions
2458  */
2459
2460 /* setup SPDIF output stream */
2461 static void setup_dig_out_stream(struct hda_codec *codec, hda_nid_t nid,
2462                                  unsigned int stream_tag, unsigned int format)
2463 {
2464         /* turn off SPDIF once; otherwise the IEC958 bits won't be updated */
2465         if (codec->spdif_ctls & AC_DIG1_ENABLE)
2466                 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_1,
2467                                     codec->spdif_ctls & ~AC_DIG1_ENABLE & 0xff);
2468         snd_hda_codec_setup_stream(codec, nid, stream_tag, 0, format);
2469         /* turn on again (if needed) */
2470         if (codec->spdif_ctls & AC_DIG1_ENABLE)
2471                 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_1,
2472                                     codec->spdif_ctls & 0xff);
2473 }
2474
2475 /*
2476  * open the digital out in the exclusive mode
2477  */
2478 int snd_hda_multi_out_dig_open(struct hda_codec *codec,
2479                                struct hda_multi_out *mout)
2480 {
2481         mutex_lock(&codec->spdif_mutex);
2482         if (mout->dig_out_used == HDA_DIG_ANALOG_DUP)
2483                 /* already opened as analog dup; reset it once */
2484                 snd_hda_codec_setup_stream(codec, mout->dig_out_nid, 0, 0, 0);
2485         mout->dig_out_used = HDA_DIG_EXCLUSIVE;
2486         mutex_unlock(&codec->spdif_mutex);
2487         return 0;
2488 }
2489
2490 int snd_hda_multi_out_dig_prepare(struct hda_codec *codec,
2491                                   struct hda_multi_out *mout,
2492                                   unsigned int stream_tag,
2493                                   unsigned int format,
2494                                   struct snd_pcm_substream *substream)
2495 {
2496         mutex_lock(&codec->spdif_mutex);
2497         setup_dig_out_stream(codec, mout->dig_out_nid, stream_tag, format);
2498         mutex_unlock(&codec->spdif_mutex);
2499         return 0;
2500 }
2501
2502 /*
2503  * release the digital out
2504  */
2505 int snd_hda_multi_out_dig_close(struct hda_codec *codec,
2506                                 struct hda_multi_out *mout)
2507 {
2508         mutex_lock(&codec->spdif_mutex);
2509         mout->dig_out_used = 0;
2510         mutex_unlock(&codec->spdif_mutex);
2511         return 0;
2512 }
2513
2514 /*
2515  * set up more restrictions for analog out
2516  */
2517 int snd_hda_multi_out_analog_open(struct hda_codec *codec,
2518                                   struct hda_multi_out *mout,
2519                                   struct snd_pcm_substream *substream)
2520 {
2521         substream->runtime->hw.channels_max = mout->max_channels;
2522         return snd_pcm_hw_constraint_step(substream->runtime, 0,
2523                                           SNDRV_PCM_HW_PARAM_CHANNELS, 2);
2524 }
2525
2526 /*
2527  * set up the i/o for analog out
2528  * when the digital out is available, copy the front out to digital out, too.
2529  */
2530 int snd_hda_multi_out_analog_prepare(struct hda_codec *codec,
2531                                      struct hda_multi_out *mout,
2532                                      unsigned int stream_tag,
2533                                      unsigned int format,
2534                                      struct snd_pcm_substream *substream)
2535 {
2536         hda_nid_t *nids = mout->dac_nids;
2537         int chs = substream->runtime->channels;
2538         int i;
2539
2540         mutex_lock(&codec->spdif_mutex);
2541         if (mout->dig_out_nid && mout->dig_out_used != HDA_DIG_EXCLUSIVE) {
2542                 if (chs == 2 &&
2543                     snd_hda_is_supported_format(codec, mout->dig_out_nid,
2544                                                 format) &&
2545                     !(codec->spdif_status & IEC958_AES0_NONAUDIO)) {
2546                         mout->dig_out_used = HDA_DIG_ANALOG_DUP;
2547                         setup_dig_out_stream(codec, mout->dig_out_nid,
2548                                              stream_tag, format);
2549                 } else {
2550                         mout->dig_out_used = 0;
2551                         snd_hda_codec_setup_stream(codec, mout->dig_out_nid,
2552                                                    0, 0, 0);
2553                 }
2554         }
2555         mutex_unlock(&codec->spdif_mutex);
2556
2557         /* front */
2558         snd_hda_codec_setup_stream(codec, nids[HDA_FRONT], stream_tag,
2559                                    0, format);
2560         if (!mout->no_share_stream &&
2561             mout->hp_nid && mout->hp_nid != nids[HDA_FRONT])
2562                 /* headphone out will just decode front left/right (stereo) */
2563                 snd_hda_codec_setup_stream(codec, mout->hp_nid, stream_tag,
2564                                            0, format);
2565         /* extra outputs copied from front */
2566         for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++)
2567                 if (!mout->no_share_stream && mout->extra_out_nid[i])
2568                         snd_hda_codec_setup_stream(codec,
2569                                                    mout->extra_out_nid[i],
2570                                                    stream_tag, 0, format);
2571
2572         /* surrounds */
2573         for (i = 1; i < mout->num_dacs; i++) {
2574                 if (chs >= (i + 1) * 2) /* independent out */
2575                         snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
2576                                                    i * 2, format);
2577                 else if (!mout->no_share_stream) /* copy front */
2578                         snd_hda_codec_setup_stream(codec, nids[i], stream_tag,
2579                                                    0, format);
2580         }
2581         return 0;
2582 }
2583
2584 /*
2585  * clean up the setting for analog out
2586  */
2587 int snd_hda_multi_out_analog_cleanup(struct hda_codec *codec,
2588                                      struct hda_multi_out *mout)
2589 {
2590         hda_nid_t *nids = mout->dac_nids;
2591         int i;
2592
2593         for (i = 0; i < mout->num_dacs; i++)
2594                 snd_hda_codec_setup_stream(codec, nids[i], 0, 0, 0);
2595         if (mout->hp_nid)
2596                 snd_hda_codec_setup_stream(codec, mout->hp_nid, 0, 0, 0);
2597         for (i = 0; i < ARRAY_SIZE(mout->extra_out_nid); i++)
2598                 if (mout->extra_out_nid[i])
2599                         snd_hda_codec_setup_stream(codec,
2600                                                    mout->extra_out_nid[i],
2601                                                    0, 0, 0);
2602         mutex_lock(&codec->spdif_mutex);
2603         if (mout->dig_out_nid && mout->dig_out_used == HDA_DIG_ANALOG_DUP) {
2604                 snd_hda_codec_setup_stream(codec, mout->dig_out_nid, 0, 0, 0);
2605                 mout->dig_out_used = 0;
2606         }
2607         mutex_unlock(&codec->spdif_mutex);
2608         return 0;
2609 }
2610
2611 /*
2612  * Helper for automatic ping configuration
2613  */
2614
2615 static int is_in_nid_list(hda_nid_t nid, hda_nid_t *list)
2616 {
2617         for (; *list; list++)
2618                 if (*list == nid)
2619                         return 1;
2620         return 0;
2621 }
2622
2623
2624 /*
2625  * Sort an associated group of pins according to their sequence numbers.
2626  */
2627 static void sort_pins_by_sequence(hda_nid_t * pins, short * sequences,
2628                                   int num_pins)
2629 {
2630         int i, j;
2631         short seq;
2632         hda_nid_t nid;
2633         
2634         for (i = 0; i < num_pins; i++) {
2635                 for (j = i + 1; j < num_pins; j++) {
2636                         if (sequences[i] > sequences[j]) {
2637                                 seq = sequences[i];
2638                                 sequences[i] = sequences[j];
2639                                 sequences[j] = seq;
2640                                 nid = pins[i];
2641                                 pins[i] = pins[j];
2642                                 pins[j] = nid;
2643                         }
2644                 }
2645         }
2646 }
2647
2648
2649 /*
2650  * Parse all pin widgets and store the useful pin nids to cfg
2651  *
2652  * The number of line-outs or any primary output is stored in line_outs,
2653  * and the corresponding output pins are assigned to line_out_pins[],
2654  * in the order of front, rear, CLFE, side, ...
2655  *
2656  * If more extra outputs (speaker and headphone) are found, the pins are
2657  * assisnged to hp_pins[] and speaker_pins[], respectively.  If no line-out jack
2658  * is detected, one of speaker of HP pins is assigned as the primary
2659  * output, i.e. to line_out_pins[0].  So, line_outs is always positive
2660  * if any analog output exists.
2661  * 
2662  * The analog input pins are assigned to input_pins array.
2663  * The digital input/output pins are assigned to dig_in_pin and dig_out_pin,
2664  * respectively.
2665  */
2666 int snd_hda_parse_pin_def_config(struct hda_codec *codec,
2667                                  struct auto_pin_cfg *cfg,
2668                                  hda_nid_t *ignore_nids)
2669 {
2670         hda_nid_t nid, nid_start;
2671         int nodes;
2672         short seq, assoc_line_out, assoc_speaker;
2673         short sequences_line_out[ARRAY_SIZE(cfg->line_out_pins)];
2674         short sequences_speaker[ARRAY_SIZE(cfg->speaker_pins)];
2675         short sequences_hp[ARRAY_SIZE(cfg->hp_pins)];
2676
2677         memset(cfg, 0, sizeof(*cfg));
2678
2679         memset(sequences_line_out, 0, sizeof(sequences_line_out));
2680         memset(sequences_speaker, 0, sizeof(sequences_speaker));
2681         memset(sequences_hp, 0, sizeof(sequences_hp));
2682         assoc_line_out = assoc_speaker = 0;
2683
2684         nodes = snd_hda_get_sub_nodes(codec, codec->afg, &nid_start);
2685         for (nid = nid_start; nid < nodes + nid_start; nid++) {
2686                 unsigned int wid_caps = get_wcaps(codec, nid);
2687                 unsigned int wid_type =
2688                         (wid_caps & AC_WCAP_TYPE) >> AC_WCAP_TYPE_SHIFT;
2689                 unsigned int def_conf;
2690                 short assoc, loc;
2691
2692                 /* read all default configuration for pin complex */
2693                 if (wid_type != AC_WID_PIN)
2694                         continue;
2695                 /* ignore the given nids (e.g. pc-beep returns error) */
2696                 if (ignore_nids && is_in_nid_list(nid, ignore_nids))
2697                         continue;
2698
2699                 def_conf = snd_hda_codec_read(codec, nid, 0,
2700                                               AC_VERB_GET_CONFIG_DEFAULT, 0);
2701                 if (get_defcfg_connect(def_conf) == AC_JACK_PORT_NONE)
2702                         continue;
2703                 loc = get_defcfg_location(def_conf);
2704                 switch (get_defcfg_device(def_conf)) {
2705                 case AC_JACK_LINE_OUT:
2706                         seq = get_defcfg_sequence(def_conf);
2707                         assoc = get_defcfg_association(def_conf);
2708                         if (!assoc)
2709                                 continue;
2710                         if (!assoc_line_out)
2711                                 assoc_line_out = assoc;
2712                         else if (assoc_line_out != assoc)
2713                                 continue;
2714                         if (cfg->line_outs >= ARRAY_SIZE(cfg->line_out_pins))
2715                                 continue;
2716                         cfg->line_out_pins[cfg->line_outs] = nid;
2717                         sequences_line_out[cfg->line_outs] = seq;
2718                         cfg->line_outs++;
2719                         break;
2720                 case AC_JACK_SPEAKER:
2721                         seq = get_defcfg_sequence(def_conf);
2722                         assoc = get_defcfg_association(def_conf);
2723                         if (! assoc)
2724                                 continue;
2725                         if (! assoc_speaker)
2726                                 assoc_speaker = assoc;
2727                         else if (assoc_speaker != assoc)
2728                                 continue;
2729                         if (cfg->speaker_outs >= ARRAY_SIZE(cfg->speaker_pins))
2730                                 continue;
2731                         cfg->speaker_pins[cfg->speaker_outs] = nid;
2732                         sequences_speaker[cfg->speaker_outs] = seq;
2733                         cfg->speaker_outs++;
2734                         break;
2735                 case AC_JACK_HP_OUT:
2736                         seq = get_defcfg_sequence(def_conf);
2737                         assoc = get_defcfg_association(def_conf);
2738                         if (cfg->hp_outs >= ARRAY_SIZE(cfg->hp_pins))
2739                                 continue;
2740                         cfg->hp_pins[cfg->hp_outs] = nid;
2741                         sequences_hp[cfg->hp_outs] = (assoc << 4) | seq;
2742                         cfg->hp_outs++;
2743                         break;
2744                 case AC_JACK_MIC_IN: {
2745                         int preferred, alt;
2746                         if (loc == AC_JACK_LOC_FRONT) {
2747                                 preferred = AUTO_PIN_FRONT_MIC;
2748                                 alt = AUTO_PIN_MIC;
2749                         } else {
2750                                 preferred = AUTO_PIN_MIC;
2751                                 alt = AUTO_PIN_FRONT_MIC;
2752                         }
2753                         if (!cfg->input_pins[preferred])
2754                                 cfg->input_pins[preferred] = nid;
2755                         else if (!cfg->input_pins[alt])
2756                                 cfg->input_pins[alt] = nid;
2757                         break;
2758                 }
2759                 case AC_JACK_LINE_IN:
2760                         if (loc == AC_JACK_LOC_FRONT)
2761                                 cfg->input_pins[AUTO_PIN_FRONT_LINE] = nid;
2762                         else
2763                                 cfg->input_pins[AUTO_PIN_LINE] = nid;
2764                         break;
2765                 case AC_JACK_CD:
2766                         cfg->input_pins[AUTO_PIN_CD] = nid;
2767                         break;
2768                 case AC_JACK_AUX:
2769                         cfg->input_pins[AUTO_PIN_AUX] = nid;
2770                         break;
2771                 case AC_JACK_SPDIF_OUT:
2772                         cfg->dig_out_pin = nid;
2773                         break;
2774                 case AC_JACK_SPDIF_IN:
2775                         cfg->dig_in_pin = nid;
2776                         break;
2777                 }
2778         }
2779
2780         /* sort by sequence */
2781         sort_pins_by_sequence(cfg->line_out_pins, sequences_line_out,
2782                               cfg->line_outs);
2783         sort_pins_by_sequence(cfg->speaker_pins, sequences_speaker,
2784                               cfg->speaker_outs);
2785         sort_pins_by_sequence(cfg->hp_pins, sequences_hp,
2786                               cfg->hp_outs);
2787         
2788         /* if we have only one mic, make it AUTO_PIN_MIC */
2789         if (!cfg->input_pins[AUTO_PIN_MIC] &&
2790             cfg->input_pins[AUTO_PIN_FRONT_MIC]) {
2791                 cfg->input_pins[AUTO_PIN_MIC] =
2792                         cfg->input_pins[AUTO_PIN_FRONT_MIC];
2793                 cfg->input_pins[AUTO_PIN_FRONT_MIC] = 0;
2794         }
2795         /* ditto for line-in */
2796         if (!cfg->input_pins[AUTO_PIN_LINE] &&
2797             cfg->input_pins[AUTO_PIN_FRONT_LINE]) {
2798                 cfg->input_pins[AUTO_PIN_LINE] =
2799                         cfg->input_pins[AUTO_PIN_FRONT_LINE];
2800                 cfg->input_pins[AUTO_PIN_FRONT_LINE] = 0;
2801         }
2802
2803         /*
2804          * FIX-UP: if no line-outs are detected, try to use speaker or HP pin
2805          * as a primary output
2806          */
2807         if (!cfg->line_outs) {
2808                 if (cfg->speaker_outs) {
2809                         cfg->line_outs = cfg->speaker_outs;
2810                         memcpy(cfg->line_out_pins, cfg->speaker_pins,
2811                                sizeof(cfg->speaker_pins));
2812                         cfg->speaker_outs = 0;
2813                         memset(cfg->speaker_pins, 0, sizeof(cfg->speaker_pins));
2814                         cfg->line_out_type = AUTO_PIN_SPEAKER_OUT;
2815                 } else if (cfg->hp_outs) {
2816                         cfg->line_outs = cfg->hp_outs;
2817                         memcpy(cfg->line_out_pins, cfg->hp_pins,
2818                                sizeof(cfg->hp_pins));
2819                         cfg->hp_outs = 0;
2820                         memset(cfg->hp_pins, 0, sizeof(cfg->hp_pins));
2821                         cfg->line_out_type = AUTO_PIN_HP_OUT;
2822                 }
2823         }
2824
2825         /* Reorder the surround channels
2826          * ALSA sequence is front/surr/clfe/side
2827          * HDA sequence is:
2828          *    4-ch: front/surr  =>  OK as it is
2829          *    6-ch: front/clfe/surr
2830          *    8-ch: front/clfe/rear/side|fc
2831          */
2832         switch (cfg->line_outs) {
2833         case 3:
2834         case 4:
2835                 nid = cfg->line_out_pins[1];
2836                 cfg->line_out_pins[1] = cfg->line_out_pins[2];
2837                 cfg->line_out_pins[2] = nid;
2838                 break;
2839         }
2840
2841         /*
2842          * debug prints of the parsed results
2843          */
2844         snd_printd("autoconfig: line_outs=%d (0x%x/0x%x/0x%x/0x%x/0x%x)\n",
2845                    cfg->line_outs, cfg->line_out_pins[0], cfg->line_out_pins[1],
2846                    cfg->line_out_pins[2], cfg->line_out_pins[3],
2847                    cfg->line_out_pins[4]);
2848         snd_printd("   speaker_outs=%d (0x%x/0x%x/0x%x/0x%x/0x%x)\n",
2849                    cfg->speaker_outs, cfg->speaker_pins[0],
2850                    cfg->speaker_pins[1], cfg->speaker_pins[2],
2851                    cfg->speaker_pins[3], cfg->speaker_pins[4]);
2852         snd_printd("   hp_outs=%d (0x%x/0x%x/0x%x/0x%x/0x%x)\n",
2853                    cfg->hp_outs, cfg->hp_pins[0],
2854                    cfg->hp_pins[1], cfg->hp_pins[2],
2855                    cfg->hp_pins[3], cfg->hp_pins[4]);
2856         snd_printd("   inputs: mic=0x%x, fmic=0x%x, line=0x%x, fline=0x%x,"
2857                    " cd=0x%x, aux=0x%x\n",
2858                    cfg->input_pins[AUTO_PIN_MIC],
2859                    cfg->input_pins[AUTO_PIN_FRONT_MIC],
2860                    cfg->input_pins[AUTO_PIN_LINE],
2861                    cfg->input_pins[AUTO_PIN_FRONT_LINE],
2862                    cfg->input_pins[AUTO_PIN_CD],
2863                    cfg->input_pins[AUTO_PIN_AUX]);
2864
2865         return 0;
2866 }
2867
2868 /* labels for input pins */
2869 const char *auto_pin_cfg_labels[AUTO_PIN_LAST] = {
2870         "Mic", "Front Mic", "Line", "Front Line", "CD", "Aux"
2871 };
2872
2873
2874 #ifdef CONFIG_PM
2875 /*
2876  * power management
2877  */
2878
2879 /**
2880  * snd_hda_suspend - suspend the codecs
2881  * @bus: the HDA bus
2882  * @state: suspsend state
2883  *
2884  * Returns 0 if successful.
2885  */
2886 int snd_hda_suspend(struct hda_bus *bus, pm_message_t state)
2887 {
2888         struct hda_codec *codec;
2889
2890         list_for_each_entry(codec, &bus->codec_list, list) {
2891 #ifdef CONFIG_SND_HDA_POWER_SAVE
2892                 if (!codec->power_on)
2893                         continue;
2894 #endif
2895                 hda_call_codec_suspend(codec);
2896         }
2897         return 0;
2898 }
2899
2900 /**
2901  * snd_hda_resume - resume the codecs
2902  * @bus: the HDA bus
2903  * @state: resume state
2904  *
2905  * Returns 0 if successful.
2906  *
2907  * This fucntion is defined only when POWER_SAVE isn't set.
2908  * In the power-save mode, the codec is resumed dynamically.
2909  */
2910 int snd_hda_resume(struct hda_bus *bus)
2911 {
2912         struct hda_codec *codec;
2913
2914         list_for_each_entry(codec, &bus->codec_list, list) {
2915                 if (snd_hda_codec_needs_resume(codec))
2916                         hda_call_codec_resume(codec);
2917         }
2918         return 0;
2919 }
2920 #ifdef CONFIG_SND_HDA_POWER_SAVE
2921 int snd_hda_codecs_inuse(struct hda_bus *bus)
2922 {
2923         struct hda_codec *codec;
2924
2925         list_for_each_entry(codec, &bus->codec_list, list) {
2926                 if (snd_hda_codec_needs_resume(codec))
2927                         return 1;
2928         }
2929         return 0;
2930 }
2931 #endif
2932 #endif