[ALSA] Fix the handling of amp cache in hda-codec
[linux-2.6.git] / sound / pci / hda / hda_codec.c
1 /*
2  * Universal Interface for Intel High Definition Audio Codec
3  *
4  * Copyright (c) 2004 Takashi Iwai <tiwai@suse.de>
5  *
6  *
7  *  This driver is free software; you can redistribute it and/or modify
8  *  it under the terms of the GNU General Public License as published by
9  *  the Free Software Foundation; either version 2 of the License, or
10  *  (at your option) any later version.
11  *
12  *  This driver is distributed in the hope that it will be useful,
13  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
14  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  *  GNU General Public License for more details.
16  *
17  *  You should have received a copy of the GNU General Public License
18  *  along with this program; if not, write to the Free Software
19  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
20  */
21
22 #include <sound/driver.h>
23 #include <linux/init.h>
24 #include <linux/delay.h>
25 #include <linux/slab.h>
26 #include <linux/pci.h>
27 #include <linux/moduleparam.h>
28 #include <sound/core.h>
29 #include "hda_codec.h"
30 #include <sound/asoundef.h>
31 #include <sound/initval.h>
32 #include "hda_local.h"
33
34
35 MODULE_AUTHOR("Takashi Iwai <tiwai@suse.de>");
36 MODULE_DESCRIPTION("Universal interface for High Definition Audio Codec");
37 MODULE_LICENSE("GPL");
38
39
40 /*
41  * vendor / preset table
42  */
43
44 struct hda_vendor_id {
45         unsigned int id;
46         const char *name;
47 };
48
49 /* codec vendor labels */
50 static struct hda_vendor_id hda_vendor_ids[] = {
51         { 0x10ec, "Realtek" },
52         { 0x11d4, "Analog Devices" },
53         { 0x13f6, "C-Media" },
54         { 0x434d, "C-Media" },
55         { 0x8384, "SigmaTel" },
56         {} /* terminator */
57 };
58
59 /* codec presets */
60 #include "hda_patch.h"
61
62
63 /**
64  * snd_hda_codec_read - send a command and get the response
65  * @codec: the HDA codec
66  * @nid: NID to send the command
67  * @direct: direct flag
68  * @verb: the verb to send
69  * @parm: the parameter for the verb
70  *
71  * Send a single command and read the corresponding response.
72  *
73  * Returns the obtained response value, or -1 for an error.
74  */
75 unsigned int snd_hda_codec_read(struct hda_codec *codec, hda_nid_t nid, int direct,
76                                 unsigned int verb, unsigned int parm)
77 {
78         unsigned int res;
79         down(&codec->bus->cmd_mutex);
80         if (! codec->bus->ops.command(codec, nid, direct, verb, parm))
81                 res = codec->bus->ops.get_response(codec);
82         else
83                 res = (unsigned int)-1;
84         up(&codec->bus->cmd_mutex);
85         return res;
86 }
87
88 /**
89  * snd_hda_codec_write - send a single command without waiting for response
90  * @codec: the HDA codec
91  * @nid: NID to send the command
92  * @direct: direct flag
93  * @verb: the verb to send
94  * @parm: the parameter for the verb
95  *
96  * Send a single command without waiting for response.
97  *
98  * Returns 0 if successful, or a negative error code.
99  */
100 int snd_hda_codec_write(struct hda_codec *codec, hda_nid_t nid, int direct,
101                          unsigned int verb, unsigned int parm)
102 {
103         int err;
104         down(&codec->bus->cmd_mutex);
105         err = codec->bus->ops.command(codec, nid, direct, verb, parm);
106         up(&codec->bus->cmd_mutex);
107         return err;
108 }
109
110 /**
111  * snd_hda_sequence_write - sequence writes
112  * @codec: the HDA codec
113  * @seq: VERB array to send
114  *
115  * Send the commands sequentially from the given array.
116  * The array must be terminated with NID=0.
117  */
118 void snd_hda_sequence_write(struct hda_codec *codec, const struct hda_verb *seq)
119 {
120         for (; seq->nid; seq++)
121                 snd_hda_codec_write(codec, seq->nid, 0, seq->verb, seq->param);
122 }
123
124 /**
125  * snd_hda_get_sub_nodes - get the range of sub nodes
126  * @codec: the HDA codec
127  * @nid: NID to parse
128  * @start_id: the pointer to store the start NID
129  *
130  * Parse the NID and store the start NID of its sub-nodes.
131  * Returns the number of sub-nodes.
132  */
133 int snd_hda_get_sub_nodes(struct hda_codec *codec, hda_nid_t nid, hda_nid_t *start_id)
134 {
135         unsigned int parm;
136
137         parm = snd_hda_param_read(codec, nid, AC_PAR_NODE_COUNT);
138         *start_id = (parm >> 16) & 0x7fff;
139         return (int)(parm & 0x7fff);
140 }
141
142 /**
143  * snd_hda_get_connections - get connection list
144  * @codec: the HDA codec
145  * @nid: NID to parse
146  * @conn_list: connection list array
147  * @max_conns: max. number of connections to store
148  *
149  * Parses the connection list of the given widget and stores the list
150  * of NIDs.
151  *
152  * Returns the number of connections, or a negative error code.
153  */
154 int snd_hda_get_connections(struct hda_codec *codec, hda_nid_t nid,
155                             hda_nid_t *conn_list, int max_conns)
156 {
157         unsigned int parm;
158         int i, j, conn_len, num_tupples, conns;
159         unsigned int shift, num_elems, mask;
160
161         snd_assert(conn_list && max_conns > 0, return -EINVAL);
162
163         parm = snd_hda_param_read(codec, nid, AC_PAR_CONNLIST_LEN);
164         if (parm & AC_CLIST_LONG) {
165                 /* long form */
166                 shift = 16;
167                 num_elems = 2;
168         } else {
169                 /* short form */
170                 shift = 8;
171                 num_elems = 4;
172         }
173         conn_len = parm & AC_CLIST_LENGTH;
174         num_tupples = num_elems / 2;
175         mask = (1 << (shift-1)) - 1;
176
177         if (! conn_len)
178                 return 0; /* no connection */
179
180         if (conn_len == 1) {
181                 /* single connection */
182                 parm = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_CONNECT_LIST, 0);
183                 conn_list[0] = parm & mask;
184                 return 1;
185         }
186
187         /* multi connection */
188         conns = 0;
189         for (i = 0; i < conn_len; i += num_elems) {
190                 parm = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_CONNECT_LIST, i);
191                 for (j = 0; j < num_tupples; j++) {
192                         int range_val;
193                         hda_nid_t val1, val2, n;
194                         range_val = parm & (1 << (shift-1)); /* ranges */
195                         val1 = parm & mask;
196                         parm >>= shift;
197                         val2 = parm & mask;
198                         parm >>= shift;
199                         if (range_val) {
200                                 /* ranges between val1 and val2 */
201                                 if (val1 > val2) {
202                                         snd_printk(KERN_WARNING "hda_codec: invalid dep_range_val %x:%x\n", val1, val2);
203                                         continue;
204                                 }
205                                 for (n = val1; n <= val2; n++) {
206                                         if (conns >= max_conns)
207                                                 return -EINVAL;
208                                         conn_list[conns++] = n;
209                                 }
210                         } else {
211                                 if (! val1)
212                                         break;
213                                 if (conns >= max_conns)
214                                         return -EINVAL;
215                                 conn_list[conns++] = val1;
216                                 if (! val2)
217                                         break;
218                                 if (conns >= max_conns)
219                                         return -EINVAL;
220                                 conn_list[conns++] = val2;
221                         }
222                 }
223         }
224         return conns;
225 }
226
227
228 /**
229  * snd_hda_queue_unsol_event - add an unsolicited event to queue
230  * @bus: the BUS
231  * @res: unsolicited event (lower 32bit of RIRB entry)
232  * @res_ex: codec addr and flags (upper 32bit or RIRB entry)
233  *
234  * Adds the given event to the queue.  The events are processed in
235  * the workqueue asynchronously.  Call this function in the interrupt
236  * hanlder when RIRB receives an unsolicited event.
237  *
238  * Returns 0 if successful, or a negative error code.
239  */
240 int snd_hda_queue_unsol_event(struct hda_bus *bus, u32 res, u32 res_ex)
241 {
242         struct hda_bus_unsolicited *unsol;
243         unsigned int wp;
244
245         if ((unsol = bus->unsol) == NULL)
246                 return 0;
247
248         wp = (unsol->wp + 1) % HDA_UNSOL_QUEUE_SIZE;
249         unsol->wp = wp;
250
251         wp <<= 1;
252         unsol->queue[wp] = res;
253         unsol->queue[wp + 1] = res_ex;
254
255         queue_work(unsol->workq, &unsol->work);
256
257         return 0;
258 }
259
260 /*
261  * process queueud unsolicited events
262  */
263 static void process_unsol_events(void *data)
264 {
265         struct hda_bus *bus = data;
266         struct hda_bus_unsolicited *unsol = bus->unsol;
267         struct hda_codec *codec;
268         unsigned int rp, caddr, res;
269
270         while (unsol->rp != unsol->wp) {
271                 rp = (unsol->rp + 1) % HDA_UNSOL_QUEUE_SIZE;
272                 unsol->rp = rp;
273                 rp <<= 1;
274                 res = unsol->queue[rp];
275                 caddr = unsol->queue[rp + 1];
276                 if (! (caddr & (1 << 4))) /* no unsolicited event? */
277                         continue;
278                 codec = bus->caddr_tbl[caddr & 0x0f];
279                 if (codec && codec->patch_ops.unsol_event)
280                         codec->patch_ops.unsol_event(codec, res);
281         }
282 }
283
284 /*
285  * initialize unsolicited queue
286  */
287 static int init_unsol_queue(struct hda_bus *bus)
288 {
289         struct hda_bus_unsolicited *unsol;
290
291         unsol = kcalloc(1, sizeof(*unsol), GFP_KERNEL);
292         if (! unsol) {
293                 snd_printk(KERN_ERR "hda_codec: can't allocate unsolicited queue\n");
294                 return -ENOMEM;
295         }
296         unsol->workq = create_workqueue("hda_codec");
297         if (! unsol->workq) {
298                 snd_printk(KERN_ERR "hda_codec: can't create workqueue\n");
299                 kfree(unsol);
300                 return -ENOMEM;
301         }
302         INIT_WORK(&unsol->work, process_unsol_events, bus);
303         bus->unsol = unsol;
304         return 0;
305 }
306
307 /*
308  * destructor
309  */
310 static void snd_hda_codec_free(struct hda_codec *codec);
311
312 static int snd_hda_bus_free(struct hda_bus *bus)
313 {
314         struct list_head *p, *n;
315
316         if (! bus)
317                 return 0;
318         if (bus->unsol) {
319                 destroy_workqueue(bus->unsol->workq);
320                 kfree(bus->unsol);
321         }
322         list_for_each_safe(p, n, &bus->codec_list) {
323                 struct hda_codec *codec = list_entry(p, struct hda_codec, list);
324                 snd_hda_codec_free(codec);
325         }
326         if (bus->ops.private_free)
327                 bus->ops.private_free(bus);
328         kfree(bus);
329         return 0;
330 }
331
332 static int snd_hda_bus_dev_free(snd_device_t *device)
333 {
334         struct hda_bus *bus = device->device_data;
335         return snd_hda_bus_free(bus);
336 }
337
338 /**
339  * snd_hda_bus_new - create a HDA bus
340  * @card: the card entry
341  * @temp: the template for hda_bus information
342  * @busp: the pointer to store the created bus instance
343  *
344  * Returns 0 if successful, or a negative error code.
345  */
346 int snd_hda_bus_new(snd_card_t *card, const struct hda_bus_template *temp,
347                     struct hda_bus **busp)
348 {
349         struct hda_bus *bus;
350         int err;
351         static snd_device_ops_t dev_ops = {
352                 .dev_free = snd_hda_bus_dev_free,
353         };
354
355         snd_assert(temp, return -EINVAL);
356         snd_assert(temp->ops.command && temp->ops.get_response, return -EINVAL);
357
358         if (busp)
359                 *busp = NULL;
360
361         bus = kcalloc(1, sizeof(*bus), GFP_KERNEL);
362         if (bus == NULL) {
363                 snd_printk(KERN_ERR "can't allocate struct hda_bus\n");
364                 return -ENOMEM;
365         }
366
367         bus->card = card;
368         bus->private_data = temp->private_data;
369         bus->pci = temp->pci;
370         bus->modelname = temp->modelname;
371         bus->ops = temp->ops;
372
373         init_MUTEX(&bus->cmd_mutex);
374         INIT_LIST_HEAD(&bus->codec_list);
375
376         init_unsol_queue(bus);
377
378         if ((err = snd_device_new(card, SNDRV_DEV_BUS, bus, &dev_ops)) < 0) {
379                 snd_hda_bus_free(bus);
380                 return err;
381         }
382         if (busp)
383                 *busp = bus;
384         return 0;
385 }
386
387
388 /*
389  * find a matching codec preset
390  */
391 static const struct hda_codec_preset *find_codec_preset(struct hda_codec *codec)
392 {
393         const struct hda_codec_preset **tbl, *preset;
394
395         for (tbl = hda_preset_tables; *tbl; tbl++) {
396                 for (preset = *tbl; preset->id; preset++) {
397                         u32 mask = preset->mask;
398                         if (! mask)
399                                 mask = ~0;
400                         if (preset->id == (codec->vendor_id & mask))
401                                 return preset;
402                 }
403         }
404         return NULL;
405 }
406
407 /*
408  * snd_hda_get_codec_name - store the codec name
409  */
410 void snd_hda_get_codec_name(struct hda_codec *codec,
411                             char *name, int namelen)
412 {
413         const struct hda_vendor_id *c;
414         const char *vendor = NULL;
415         u16 vendor_id = codec->vendor_id >> 16;
416         char tmp[16];
417
418         for (c = hda_vendor_ids; c->id; c++) {
419                 if (c->id == vendor_id) {
420                         vendor = c->name;
421                         break;
422                 }
423         }
424         if (! vendor) {
425                 sprintf(tmp, "Generic %04x", vendor_id);
426                 vendor = tmp;
427         }
428         if (codec->preset && codec->preset->name)
429                 snprintf(name, namelen, "%s %s", vendor, codec->preset->name);
430         else
431                 snprintf(name, namelen, "%s ID %x", vendor, codec->vendor_id & 0xffff);
432 }
433
434 /*
435  * look for an AFG node
436  *
437  * return 0 if not found
438  */
439 static int look_for_afg_node(struct hda_codec *codec)
440 {
441         int i, total_nodes;
442         hda_nid_t nid;
443
444         total_nodes = snd_hda_get_sub_nodes(codec, AC_NODE_ROOT, &nid);
445         for (i = 0; i < total_nodes; i++, nid++) {
446                 if ((snd_hda_param_read(codec, nid, AC_PAR_FUNCTION_TYPE) & 0xff) ==
447                     AC_GRP_AUDIO_FUNCTION)
448                         return nid;
449         }
450         return 0;
451 }
452
453 /*
454  * codec destructor
455  */
456 static void snd_hda_codec_free(struct hda_codec *codec)
457 {
458         if (! codec)
459                 return;
460         list_del(&codec->list);
461         codec->bus->caddr_tbl[codec->addr] = NULL;
462         if (codec->patch_ops.free)
463                 codec->patch_ops.free(codec);
464         kfree(codec);
465 }
466
467 static void init_amp_hash(struct hda_codec *codec);
468
469 /**
470  * snd_hda_codec_new - create a HDA codec
471  * @bus: the bus to assign
472  * @codec_addr: the codec address
473  * @codecp: the pointer to store the generated codec
474  *
475  * Returns 0 if successful, or a negative error code.
476  */
477 int snd_hda_codec_new(struct hda_bus *bus, unsigned int codec_addr,
478                       struct hda_codec **codecp)
479 {
480         struct hda_codec *codec;
481         char component[13];
482         int err;
483
484         snd_assert(bus, return -EINVAL);
485         snd_assert(codec_addr <= HDA_MAX_CODEC_ADDRESS, return -EINVAL);
486
487         if (bus->caddr_tbl[codec_addr]) {
488                 snd_printk(KERN_ERR "hda_codec: address 0x%x is already occupied\n", codec_addr);
489                 return -EBUSY;
490         }
491
492         codec = kcalloc(1, sizeof(*codec), GFP_KERNEL);
493         if (codec == NULL) {
494                 snd_printk(KERN_ERR "can't allocate struct hda_codec\n");
495                 return -ENOMEM;
496         }
497
498         codec->bus = bus;
499         codec->addr = codec_addr;
500         init_MUTEX(&codec->spdif_mutex);
501         init_amp_hash(codec);
502
503         list_add_tail(&codec->list, &bus->codec_list);
504         bus->caddr_tbl[codec_addr] = codec;
505
506         codec->vendor_id = snd_hda_param_read(codec, AC_NODE_ROOT, AC_PAR_VENDOR_ID);
507         codec->subsystem_id = snd_hda_param_read(codec, AC_NODE_ROOT, AC_PAR_SUBSYSTEM_ID);
508         codec->revision_id = snd_hda_param_read(codec, AC_NODE_ROOT, AC_PAR_REV_ID);
509
510         /* FIXME: support for multiple AFGs? */
511         codec->afg = look_for_afg_node(codec);
512         if (! codec->afg) {
513                 snd_printdd("hda_codec: no AFG node found\n");
514                 snd_hda_codec_free(codec);
515                 return -ENODEV;
516         }
517
518         codec->preset = find_codec_preset(codec);
519         if (! *bus->card->mixername)
520                 snd_hda_get_codec_name(codec, bus->card->mixername,
521                                        sizeof(bus->card->mixername));
522
523         if (codec->preset && codec->preset->patch)
524                 err = codec->preset->patch(codec);
525         else
526                 err = snd_hda_parse_generic_codec(codec);
527         if (err < 0) {
528                 snd_hda_codec_free(codec);
529                 return err;
530         }
531
532         snd_hda_codec_proc_new(codec);
533
534         sprintf(component, "HDA:%08x", codec->vendor_id);
535         snd_component_add(codec->bus->card, component);
536
537         if (codecp)
538                 *codecp = codec;
539         return 0;
540 }
541
542 /**
543  * snd_hda_codec_setup_stream - set up the codec for streaming
544  * @codec: the CODEC to set up
545  * @nid: the NID to set up
546  * @stream_tag: stream tag to pass, it's between 0x1 and 0xf.
547  * @channel_id: channel id to pass, zero based.
548  * @format: stream format.
549  */
550 void snd_hda_codec_setup_stream(struct hda_codec *codec, hda_nid_t nid, u32 stream_tag,
551                                 int channel_id, int format)
552 {
553         if (! nid)
554                 return;
555
556         snd_printdd("hda_codec_setup_stream: NID=0x%x, stream=0x%x, channel=%d, format=0x%x\n",
557                     nid, stream_tag, channel_id, format);
558         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_CHANNEL_STREAMID,
559                             (stream_tag << 4) | channel_id);
560         msleep(1);
561         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_STREAM_FORMAT, format);
562 }
563
564
565 /*
566  * amp access functions
567  */
568
569 /* FIXME: more better hash key? */
570 #define HDA_HASH_KEY(nid,dir,idx) (u32)((nid) + ((idx) << 16) + ((dir) << 24))
571 #define INFO_AMP_CAPS   (1<<0)
572 #define INFO_AMP_VOL(ch)        (1 << (1 + (ch)))
573
574 /* initialize the hash table */
575 static void init_amp_hash(struct hda_codec *codec)
576 {
577         memset(codec->amp_hash, 0xff, sizeof(codec->amp_hash));
578         codec->num_amp_entries = 0;
579 }
580
581 /* query the hash.  allocate an entry if not found. */
582 static struct hda_amp_info *get_alloc_amp_hash(struct hda_codec *codec, u32 key)
583 {
584         u16 idx = key % (u16)ARRAY_SIZE(codec->amp_hash);
585         u16 cur = codec->amp_hash[idx];
586         struct hda_amp_info *info;
587
588         while (cur != 0xffff) {
589                 info = &codec->amp_info[cur];
590                 if (info->key == key)
591                         return info;
592                 cur = info->next;
593         }
594
595         /* add a new hash entry */
596         if (codec->num_amp_entries >= ARRAY_SIZE(codec->amp_info)) {
597                 snd_printk(KERN_ERR "hda_codec: Tooooo many amps!\n");
598                 return NULL;
599         }
600         cur = codec->num_amp_entries++;
601         info = &codec->amp_info[cur];
602         info->key = key;
603         info->status = 0; /* not initialized yet */
604         info->next = codec->amp_hash[idx];
605         codec->amp_hash[idx] = cur;
606
607         return info;
608 }
609
610 /*
611  * query AMP capabilities for the given widget and direction
612  */
613 static u32 query_amp_caps(struct hda_codec *codec, hda_nid_t nid, int direction)
614 {
615         struct hda_amp_info *info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, 0));
616
617         if (! info)
618                 return 0;
619         if (! (info->status & INFO_AMP_CAPS)) {
620                 if (!(snd_hda_param_read(codec, nid, AC_PAR_AUDIO_WIDGET_CAP) & AC_WCAP_AMP_OVRD))
621                         nid = codec->afg;
622                 info->amp_caps = snd_hda_param_read(codec, nid, direction == HDA_OUTPUT ?
623                                                     AC_PAR_AMP_OUT_CAP : AC_PAR_AMP_IN_CAP);
624                 info->status |= INFO_AMP_CAPS;
625         }
626         return info->amp_caps;
627 }
628
629 /*
630  * read the current volume to info
631  * if the cache exists, read the cache value.
632  */
633 static unsigned int get_vol_mute(struct hda_codec *codec, struct hda_amp_info *info,
634                          hda_nid_t nid, int ch, int direction, int index)
635 {
636         u32 val, parm;
637
638         if (info->status & INFO_AMP_VOL(ch))
639                 return info->vol[ch];
640
641         parm = ch ? AC_AMP_GET_RIGHT : AC_AMP_GET_LEFT;
642         parm |= direction == HDA_OUTPUT ? AC_AMP_GET_OUTPUT : AC_AMP_GET_INPUT;
643         parm |= index;
644         val = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_AMP_GAIN_MUTE, parm);
645         info->vol[ch] = val & 0xff;
646         info->status |= INFO_AMP_VOL(ch);
647         return info->vol[ch];
648 }
649
650 /*
651  * write the current volume in info to the h/w and update the cache
652  */
653 static void put_vol_mute(struct hda_codec *codec, struct hda_amp_info *info,
654                          hda_nid_t nid, int ch, int direction, int index, int val)
655 {
656         u32 parm;
657
658         parm = ch ? AC_AMP_SET_RIGHT : AC_AMP_SET_LEFT;
659         parm |= direction == HDA_OUTPUT ? AC_AMP_SET_OUTPUT : AC_AMP_SET_INPUT;
660         parm |= index << AC_AMP_SET_INDEX_SHIFT;
661         parm |= val;
662         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_AMP_GAIN_MUTE, parm);
663         info->vol[ch] = val;
664 }
665
666 /*
667  * read AMP value.  The volume is between 0 to 0x7f, 0x80 = mute bit.
668  */
669 static int snd_hda_codec_amp_read(struct hda_codec *codec, hda_nid_t nid, int ch, int direction, int index)
670 {
671         struct hda_amp_info *info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, index));
672         if (! info)
673                 return 0;
674         return get_vol_mute(codec, info, nid, ch, direction, index);
675 }
676
677 /*
678  * update the AMP value, mask = bit mask to set, val = the value
679  */
680 static int snd_hda_codec_amp_update(struct hda_codec *codec, hda_nid_t nid, int ch, int direction, int idx, int mask, int val)
681 {
682         struct hda_amp_info *info = get_alloc_amp_hash(codec, HDA_HASH_KEY(nid, direction, idx));
683
684         if (! info)
685                 return 0;
686         val &= mask;
687         val |= get_vol_mute(codec, info, nid, ch, direction, idx) & ~mask;
688         if (info->vol[ch] == val && ! codec->in_resume)
689                 return 0;
690         put_vol_mute(codec, info, nid, ch, direction, idx, val);
691         return 1;
692 }
693
694
695 /*
696  * AMP control callbacks
697  */
698 /* retrieve parameters from private_value */
699 #define get_amp_nid(kc)         ((kc)->private_value & 0xffff)
700 #define get_amp_channels(kc)    (((kc)->private_value >> 16) & 0x3)
701 #define get_amp_direction(kc)   (((kc)->private_value >> 18) & 0x1)
702 #define get_amp_index(kc)       (((kc)->private_value >> 19) & 0xf)
703
704 /* volume */
705 int snd_hda_mixer_amp_volume_info(snd_kcontrol_t *kcontrol, snd_ctl_elem_info_t *uinfo)
706 {
707         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
708         u16 nid = get_amp_nid(kcontrol);
709         u8 chs = get_amp_channels(kcontrol);
710         int dir = get_amp_direction(kcontrol);
711         u32 caps;
712
713         caps = query_amp_caps(codec, nid, dir);
714         caps = (caps & AC_AMPCAP_NUM_STEPS) >> AC_AMPCAP_NUM_STEPS_SHIFT; /* num steps */
715         if (! caps) {
716                 printk(KERN_WARNING "hda_codec: num_steps = 0 for NID=0x%x\n", nid);
717                 return -EINVAL;
718         }
719         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
720         uinfo->count = chs == 3 ? 2 : 1;
721         uinfo->value.integer.min = 0;
722         uinfo->value.integer.max = caps;
723         return 0;
724 }
725
726 int snd_hda_mixer_amp_volume_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
727 {
728         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
729         hda_nid_t nid = get_amp_nid(kcontrol);
730         int chs = get_amp_channels(kcontrol);
731         int dir = get_amp_direction(kcontrol);
732         int idx = get_amp_index(kcontrol);
733         long *valp = ucontrol->value.integer.value;
734
735         if (chs & 1)
736                 *valp++ = snd_hda_codec_amp_read(codec, nid, 0, dir, idx) & 0x7f;
737         if (chs & 2)
738                 *valp = snd_hda_codec_amp_read(codec, nid, 1, dir, idx) & 0x7f;
739         return 0;
740 }
741
742 int snd_hda_mixer_amp_volume_put(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
743 {
744         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
745         hda_nid_t nid = get_amp_nid(kcontrol);
746         int chs = get_amp_channels(kcontrol);
747         int dir = get_amp_direction(kcontrol);
748         int idx = get_amp_index(kcontrol);
749         long *valp = ucontrol->value.integer.value;
750         int change = 0;
751
752         if (chs & 1)
753                 change = snd_hda_codec_amp_update(codec, nid, 0, dir, idx,
754                                                   0x7f, *valp);
755         if (chs & 2)
756                 change |= snd_hda_codec_amp_update(codec, nid, 1, dir, idx,
757                                                    0x7f, valp[1]);
758         return change;
759 }
760
761 /* switch */
762 int snd_hda_mixer_amp_switch_info(snd_kcontrol_t *kcontrol, snd_ctl_elem_info_t *uinfo)
763 {
764         int chs = get_amp_channels(kcontrol);
765
766         uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
767         uinfo->count = chs == 3 ? 2 : 1;
768         uinfo->value.integer.min = 0;
769         uinfo->value.integer.max = 1;
770         return 0;
771 }
772
773 int snd_hda_mixer_amp_switch_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
774 {
775         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
776         hda_nid_t nid = get_amp_nid(kcontrol);
777         int chs = get_amp_channels(kcontrol);
778         int dir = get_amp_direction(kcontrol);
779         int idx = get_amp_index(kcontrol);
780         long *valp = ucontrol->value.integer.value;
781
782         if (chs & 1)
783                 *valp++ = (snd_hda_codec_amp_read(codec, nid, 0, dir, idx) & 0x80) ? 0 : 1;
784         if (chs & 2)
785                 *valp = (snd_hda_codec_amp_read(codec, nid, 1, dir, idx) & 0x80) ? 0 : 1;
786         return 0;
787 }
788
789 int snd_hda_mixer_amp_switch_put(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
790 {
791         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
792         hda_nid_t nid = get_amp_nid(kcontrol);
793         int chs = get_amp_channels(kcontrol);
794         int dir = get_amp_direction(kcontrol);
795         int idx = get_amp_index(kcontrol);
796         long *valp = ucontrol->value.integer.value;
797         int change = 0;
798
799         if (chs & 1)
800                 change = snd_hda_codec_amp_update(codec, nid, 0, dir, idx,
801                                                   0x80, *valp ? 0 : 0x80);
802         if (chs & 2)
803                 change |= snd_hda_codec_amp_update(codec, nid, 1, dir, idx,
804                                                    0x80, valp[1] ? 0 : 0x80);
805         return change;
806 }
807
808 /*
809  * SPDIF out controls
810  */
811
812 static int snd_hda_spdif_mask_info(snd_kcontrol_t *kcontrol, snd_ctl_elem_info_t *uinfo)
813 {
814         uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
815         uinfo->count = 1;
816         return 0;
817 }
818
819 static int snd_hda_spdif_cmask_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
820 {
821         ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
822                                            IEC958_AES0_NONAUDIO |
823                                            IEC958_AES0_CON_EMPHASIS_5015 |
824                                            IEC958_AES0_CON_NOT_COPYRIGHT;
825         ucontrol->value.iec958.status[1] = IEC958_AES1_CON_CATEGORY |
826                                            IEC958_AES1_CON_ORIGINAL;
827         return 0;
828 }
829
830 static int snd_hda_spdif_pmask_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
831 {
832         ucontrol->value.iec958.status[0] = IEC958_AES0_PROFESSIONAL |
833                                            IEC958_AES0_NONAUDIO |
834                                            IEC958_AES0_PRO_EMPHASIS_5015;
835         return 0;
836 }
837
838 static int snd_hda_spdif_default_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
839 {
840         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
841
842         ucontrol->value.iec958.status[0] = codec->spdif_status & 0xff;
843         ucontrol->value.iec958.status[1] = (codec->spdif_status >> 8) & 0xff;
844         ucontrol->value.iec958.status[2] = (codec->spdif_status >> 16) & 0xff;
845         ucontrol->value.iec958.status[3] = (codec->spdif_status >> 24) & 0xff;
846
847         return 0;
848 }
849
850 /* convert from SPDIF status bits to HDA SPDIF bits
851  * bit 0 (DigEn) is always set zero (to be filled later)
852  */
853 static unsigned short convert_from_spdif_status(unsigned int sbits)
854 {
855         unsigned short val = 0;
856
857         if (sbits & IEC958_AES0_PROFESSIONAL)
858                 val |= 1 << 6;
859         if (sbits & IEC958_AES0_NONAUDIO)
860                 val |= 1 << 5;
861         if (sbits & IEC958_AES0_PROFESSIONAL) {
862                 if ((sbits & IEC958_AES0_PRO_EMPHASIS) == IEC958_AES0_PRO_EMPHASIS_5015)
863                         val |= 1 << 3;
864         } else {
865                 if ((sbits & IEC958_AES0_CON_EMPHASIS) == IEC958_AES0_CON_EMPHASIS_5015)
866                         val |= 1 << 3;
867                 if (! (sbits & IEC958_AES0_CON_NOT_COPYRIGHT))
868                         val |= 1 << 4;
869                 if (sbits & (IEC958_AES1_CON_ORIGINAL << 8))
870                         val |= 1 << 7;
871                 val |= sbits & (IEC958_AES1_CON_CATEGORY << 8);
872         }
873         return val;
874 }
875
876 /* convert to SPDIF status bits from HDA SPDIF bits
877  */
878 static unsigned int convert_to_spdif_status(unsigned short val)
879 {
880         unsigned int sbits = 0;
881
882         if (val & (1 << 5))
883                 sbits |= IEC958_AES0_NONAUDIO;
884         if (val & (1 << 6))
885                 sbits |= IEC958_AES0_PROFESSIONAL;
886         if (sbits & IEC958_AES0_PROFESSIONAL) {
887                 if (sbits & (1 << 3))
888                         sbits |= IEC958_AES0_PRO_EMPHASIS_5015;
889         } else {
890                 if (val & (1 << 3))
891                         sbits |= IEC958_AES0_CON_EMPHASIS_5015;
892                 if (! (val & (1 << 4)))
893                         sbits |= IEC958_AES0_CON_NOT_COPYRIGHT;
894                 if (val & (1 << 7))
895                         sbits |= (IEC958_AES1_CON_ORIGINAL << 8);
896                 sbits |= val & (0x7f << 8);
897         }
898         return sbits;
899 }
900
901 static int snd_hda_spdif_default_put(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
902 {
903         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
904         hda_nid_t nid = kcontrol->private_value;
905         unsigned short val;
906         int change;
907
908         down(&codec->spdif_mutex);
909         codec->spdif_status = ucontrol->value.iec958.status[0] |
910                 ((unsigned int)ucontrol->value.iec958.status[1] << 8) |
911                 ((unsigned int)ucontrol->value.iec958.status[2] << 16) |
912                 ((unsigned int)ucontrol->value.iec958.status[3] << 24);
913         val = convert_from_spdif_status(codec->spdif_status);
914         val |= codec->spdif_ctls & 1;
915         change = codec->spdif_ctls != val;
916         codec->spdif_ctls = val;
917
918         if (change || codec->in_resume) {
919                 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_1, val & 0xff);
920                 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_2, val >> 8);
921         }
922
923         up(&codec->spdif_mutex);
924         return change;
925 }
926
927 static int snd_hda_spdif_out_switch_info(snd_kcontrol_t *kcontrol, snd_ctl_elem_info_t *uinfo)
928 {
929         uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
930         uinfo->count = 1;
931         uinfo->value.integer.min = 0;
932         uinfo->value.integer.max = 1;
933         return 0;
934 }
935
936 static int snd_hda_spdif_out_switch_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
937 {
938         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
939
940         ucontrol->value.integer.value[0] = codec->spdif_ctls & 1;
941         return 0;
942 }
943
944 static int snd_hda_spdif_out_switch_put(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
945 {
946         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
947         hda_nid_t nid = kcontrol->private_value;
948         unsigned short val;
949         int change;
950
951         down(&codec->spdif_mutex);
952         val = codec->spdif_ctls & ~1;
953         if (ucontrol->value.integer.value[0])
954                 val |= 1;
955         change = codec->spdif_ctls != val;
956         if (change || codec->in_resume) {
957                 codec->spdif_ctls = val;
958                 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_1, val & 0xff);
959                 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_AMP_GAIN_MUTE,
960                                     AC_AMP_SET_RIGHT | AC_AMP_SET_LEFT |
961                                     AC_AMP_SET_OUTPUT | ((val & 1) ? 0 : 0x80));
962         }
963         up(&codec->spdif_mutex);
964         return change;
965 }
966
967 static snd_kcontrol_new_t dig_mixes[] = {
968         {
969                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
970                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
971                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,CON_MASK),
972                 .info = snd_hda_spdif_mask_info,
973                 .get = snd_hda_spdif_cmask_get,
974         },
975         {
976                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
977                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
978                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,PRO_MASK),
979                 .info = snd_hda_spdif_mask_info,
980                 .get = snd_hda_spdif_pmask_get,
981         },
982         {
983                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
984                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,DEFAULT),
985                 .info = snd_hda_spdif_mask_info,
986                 .get = snd_hda_spdif_default_get,
987                 .put = snd_hda_spdif_default_put,
988         },
989         {
990                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
991                 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,SWITCH),
992                 .info = snd_hda_spdif_out_switch_info,
993                 .get = snd_hda_spdif_out_switch_get,
994                 .put = snd_hda_spdif_out_switch_put,
995         },
996         { } /* end */
997 };
998
999 /**
1000  * snd_hda_create_spdif_out_ctls - create Output SPDIF-related controls
1001  * @codec: the HDA codec
1002  * @nid: audio out widget NID
1003  *
1004  * Creates controls related with the SPDIF output.
1005  * Called from each patch supporting the SPDIF out.
1006  *
1007  * Returns 0 if successful, or a negative error code.
1008  */
1009 int snd_hda_create_spdif_out_ctls(struct hda_codec *codec, hda_nid_t nid)
1010 {
1011         int err;
1012         snd_kcontrol_t *kctl;
1013         snd_kcontrol_new_t *dig_mix;
1014
1015         for (dig_mix = dig_mixes; dig_mix->name; dig_mix++) {
1016                 kctl = snd_ctl_new1(dig_mix, codec);
1017                 kctl->private_value = nid;
1018                 if ((err = snd_ctl_add(codec->bus->card, kctl)) < 0)
1019                         return err;
1020         }
1021         codec->spdif_ctls = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DIGI_CONVERT, 0);
1022         codec->spdif_status = convert_to_spdif_status(codec->spdif_ctls);
1023         return 0;
1024 }
1025
1026 /*
1027  * SPDIF input
1028  */
1029
1030 #define snd_hda_spdif_in_switch_info    snd_hda_spdif_out_switch_info
1031
1032 static int snd_hda_spdif_in_switch_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
1033 {
1034         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1035
1036         ucontrol->value.integer.value[0] = codec->spdif_in_enable;
1037         return 0;
1038 }
1039
1040 static int snd_hda_spdif_in_switch_put(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
1041 {
1042         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1043         hda_nid_t nid = kcontrol->private_value;
1044         unsigned int val = !!ucontrol->value.integer.value[0];
1045         int change;
1046
1047         down(&codec->spdif_mutex);
1048         change = codec->spdif_in_enable != val;
1049         if (change || codec->in_resume) {
1050                 codec->spdif_in_enable = val;
1051                 snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_DIGI_CONVERT_1, val);
1052         }
1053         up(&codec->spdif_mutex);
1054         return change;
1055 }
1056
1057 static int snd_hda_spdif_in_status_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol)
1058 {
1059         struct hda_codec *codec = snd_kcontrol_chip(kcontrol);
1060         hda_nid_t nid = kcontrol->private_value;
1061         unsigned short val;
1062         unsigned int sbits;
1063
1064         val = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DIGI_CONVERT, 0);
1065         sbits = convert_to_spdif_status(val);
1066         ucontrol->value.iec958.status[0] = sbits;
1067         ucontrol->value.iec958.status[1] = sbits >> 8;
1068         ucontrol->value.iec958.status[2] = sbits >> 16;
1069         ucontrol->value.iec958.status[3] = sbits >> 24;
1070         return 0;
1071 }
1072
1073 static snd_kcontrol_new_t dig_in_ctls[] = {
1074         {
1075                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1076                 .name = SNDRV_CTL_NAME_IEC958("",CAPTURE,SWITCH),
1077                 .info = snd_hda_spdif_in_switch_info,
1078                 .get = snd_hda_spdif_in_switch_get,
1079                 .put = snd_hda_spdif_in_switch_put,
1080         },
1081         {
1082                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
1083                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1084                 .name = SNDRV_CTL_NAME_IEC958("",CAPTURE,DEFAULT),
1085                 .info = snd_hda_spdif_mask_info,
1086                 .get = snd_hda_spdif_in_status_get,
1087         },
1088         { } /* end */
1089 };
1090
1091 /**
1092  * snd_hda_create_spdif_in_ctls - create Input SPDIF-related controls
1093  * @codec: the HDA codec
1094  * @nid: audio in widget NID
1095  *
1096  * Creates controls related with the SPDIF input.
1097  * Called from each patch supporting the SPDIF in.
1098  *
1099  * Returns 0 if successful, or a negative error code.
1100  */
1101 int snd_hda_create_spdif_in_ctls(struct hda_codec *codec, hda_nid_t nid)
1102 {
1103         int err;
1104         snd_kcontrol_t *kctl;
1105         snd_kcontrol_new_t *dig_mix;
1106
1107         for (dig_mix = dig_in_ctls; dig_mix->name; dig_mix++) {
1108                 kctl = snd_ctl_new1(dig_mix, codec);
1109                 kctl->private_value = nid;
1110                 if ((err = snd_ctl_add(codec->bus->card, kctl)) < 0)
1111                         return err;
1112         }
1113         codec->spdif_in_enable = snd_hda_codec_read(codec, nid, 0, AC_VERB_GET_DIGI_CONVERT, 0) & 1;
1114         return 0;
1115 }
1116
1117
1118 /**
1119  * snd_hda_build_controls - build mixer controls
1120  * @bus: the BUS
1121  *
1122  * Creates mixer controls for each codec included in the bus.
1123  *
1124  * Returns 0 if successful, otherwise a negative error code.
1125  */
1126 int snd_hda_build_controls(struct hda_bus *bus)
1127 {
1128         struct list_head *p;
1129
1130         /* build controls */
1131         list_for_each(p, &bus->codec_list) {
1132                 struct hda_codec *codec = list_entry(p, struct hda_codec, list);
1133                 int err;
1134                 if (! codec->patch_ops.build_controls)
1135                         continue;
1136                 err = codec->patch_ops.build_controls(codec);
1137                 if (err < 0)
1138                         return err;
1139         }
1140
1141         /* initialize */
1142         list_for_each(p, &bus->codec_list) {
1143                 struct hda_codec *codec = list_entry(p, struct hda_codec, list);
1144                 int err;
1145                 if (! codec->patch_ops.init)
1146                         continue;
1147                 err = codec->patch_ops.init(codec);
1148                 if (err < 0)
1149                         return err;
1150         }
1151         return 0;
1152 }
1153
1154
1155 /*
1156  * stream formats
1157  */
1158 static unsigned int rate_bits[][3] = {
1159         /* rate in Hz, ALSA rate bitmask, HDA format value */
1160         { 8000, SNDRV_PCM_RATE_8000, 0x0500 }, /* 1/6 x 48 */
1161         { 11025, SNDRV_PCM_RATE_11025, 0x4300 }, /* 1/4 x 44 */
1162         { 16000, SNDRV_PCM_RATE_16000, 0x0200 }, /* 1/3 x 48 */
1163         { 22050, SNDRV_PCM_RATE_22050, 0x4100 }, /* 1/2 x 44 */
1164         { 32000, SNDRV_PCM_RATE_32000, 0x0a00 }, /* 2/3 x 48 */
1165         { 44100, SNDRV_PCM_RATE_44100, 0x4000 }, /* 44 */
1166         { 48000, SNDRV_PCM_RATE_48000, 0x0000 }, /* 48 */
1167         { 88200, SNDRV_PCM_RATE_88200, 0x4800 }, /* 2 x 44 */
1168         { 96000, SNDRV_PCM_RATE_96000, 0x0800 }, /* 2 x 48 */
1169         { 176400, SNDRV_PCM_RATE_176400, 0x5800 },/* 4 x 44 */
1170         { 192000, SNDRV_PCM_RATE_192000, 0x1800 }, /* 4 x 48 */
1171         { 0 }
1172 };
1173
1174 /**
1175  * snd_hda_calc_stream_format - calculate format bitset
1176  * @rate: the sample rate
1177  * @channels: the number of channels
1178  * @format: the PCM format (SNDRV_PCM_FORMAT_XXX)
1179  * @maxbps: the max. bps
1180  *
1181  * Calculate the format bitset from the given rate, channels and th PCM format.
1182  *
1183  * Return zero if invalid.
1184  */
1185 unsigned int snd_hda_calc_stream_format(unsigned int rate,
1186                                         unsigned int channels,
1187                                         unsigned int format,
1188                                         unsigned int maxbps)
1189 {
1190         int i;
1191         unsigned int val = 0;
1192
1193         for (i = 0; rate_bits[i][0]; i++)
1194                 if (rate_bits[i][0] == rate) {
1195                         val = rate_bits[i][2];
1196                         break;
1197                 }
1198         if (! rate_bits[i][0]) {
1199                 snd_printdd("invalid rate %d\n", rate);
1200                 return 0;
1201         }
1202
1203         if (channels == 0 || channels > 8) {
1204                 snd_printdd("invalid channels %d\n", channels);
1205                 return 0;
1206         }
1207         val |= channels - 1;
1208
1209         switch (snd_pcm_format_width(format)) {
1210         case 8:  val |= 0x00; break;
1211         case 16: val |= 0x10; break;
1212         case 20:
1213         case 24:
1214         case 32:
1215                 if (maxbps >= 32)
1216                         val |= 0x40;
1217                 else if (maxbps >= 24)
1218                         val |= 0x30;
1219                 else
1220                         val |= 0x20;
1221                 break;
1222         default:
1223                 snd_printdd("invalid format width %d\n", snd_pcm_format_width(format));
1224                 return 0;
1225         }
1226
1227         return val;
1228 }
1229
1230 /**
1231  * snd_hda_query_supported_pcm - query the supported PCM rates and formats
1232  * @codec: the HDA codec
1233  * @nid: NID to query
1234  * @ratesp: the pointer to store the detected rate bitflags
1235  * @formatsp: the pointer to store the detected formats
1236  * @bpsp: the pointer to store the detected format widths
1237  *
1238  * Queries the supported PCM rates and formats.  The NULL @ratesp, @formatsp
1239  * or @bsps argument is ignored.
1240  *
1241  * Returns 0 if successful, otherwise a negative error code.
1242  */
1243 int snd_hda_query_supported_pcm(struct hda_codec *codec, hda_nid_t nid,
1244                                 u32 *ratesp, u64 *formatsp, unsigned int *bpsp)
1245 {
1246         int i;
1247         unsigned int val, streams;
1248
1249         val = 0;
1250         if (nid != codec->afg &&
1251             snd_hda_param_read(codec, nid, AC_PAR_AUDIO_WIDGET_CAP) & AC_WCAP_FORMAT_OVRD) {
1252                 val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
1253                 if (val == -1)
1254                         return -EIO;
1255         }
1256         if (! val)
1257                 val = snd_hda_param_read(codec, codec->afg, AC_PAR_PCM);
1258
1259         if (ratesp) {
1260                 u32 rates = 0;
1261                 for (i = 0; rate_bits[i][0]; i++) {
1262                         if (val & (1 << i))
1263                                 rates |= rate_bits[i][1];
1264                 }
1265                 *ratesp = rates;
1266         }
1267
1268         if (formatsp || bpsp) {
1269                 u64 formats = 0;
1270                 unsigned int bps;
1271                 unsigned int wcaps;
1272
1273                 wcaps = snd_hda_param_read(codec, nid, AC_PAR_AUDIO_WIDGET_CAP);
1274                 streams = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
1275                 if (streams == -1)
1276                         return -EIO;
1277                 if (! streams) {
1278                         streams = snd_hda_param_read(codec, codec->afg, AC_PAR_STREAM);
1279                         if (streams == -1)
1280                                 return -EIO;
1281                 }
1282
1283                 bps = 0;
1284                 if (streams & AC_SUPFMT_PCM) {
1285                         if (val & AC_SUPPCM_BITS_8) {
1286                                 formats |= SNDRV_PCM_FMTBIT_U8;
1287                                 bps = 8;
1288                         }
1289                         if (val & AC_SUPPCM_BITS_16) {
1290                                 formats |= SNDRV_PCM_FMTBIT_S16_LE;
1291                                 bps = 16;
1292                         }
1293                         if (wcaps & AC_WCAP_DIGITAL) {
1294                                 if (val & AC_SUPPCM_BITS_32)
1295                                         formats |= SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE;
1296                                 if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24))
1297                                         formats |= SNDRV_PCM_FMTBIT_S32_LE;
1298                                 if (val & AC_SUPPCM_BITS_24)
1299                                         bps = 24;
1300                                 else if (val & AC_SUPPCM_BITS_20)
1301                                         bps = 20;
1302                         } else if (val & (AC_SUPPCM_BITS_20|AC_SUPPCM_BITS_24|AC_SUPPCM_BITS_32)) {
1303                                 formats |= SNDRV_PCM_FMTBIT_S32_LE;
1304                                 if (val & AC_SUPPCM_BITS_32)
1305                                         bps = 32;
1306                                 else if (val & AC_SUPPCM_BITS_20)
1307                                         bps = 20;
1308                                 else if (val & AC_SUPPCM_BITS_24)
1309                                         bps = 24;
1310                         }
1311                 }
1312                 else if (streams == AC_SUPFMT_FLOAT32) { /* should be exclusive */
1313                         formats |= SNDRV_PCM_FMTBIT_FLOAT_LE;
1314                         bps = 32;
1315                 } else if (streams == AC_SUPFMT_AC3) { /* should be exclusive */
1316                         /* temporary hack: we have still no proper support
1317                          * for the direct AC3 stream...
1318                          */
1319                         formats |= SNDRV_PCM_FMTBIT_U8;
1320                         bps = 8;
1321                 }
1322                 if (formatsp)
1323                         *formatsp = formats;
1324                 if (bpsp)
1325                         *bpsp = bps;
1326         }
1327
1328         return 0;
1329 }
1330
1331 /**
1332  * snd_hda_is_supported_format - check whether the given node supports the format val
1333  *
1334  * Returns 1 if supported, 0 if not.
1335  */
1336 int snd_hda_is_supported_format(struct hda_codec *codec, hda_nid_t nid,
1337                                 unsigned int format)
1338 {
1339         int i;
1340         unsigned int val = 0, rate, stream;
1341
1342         if (nid != codec->afg &&
1343             snd_hda_param_read(codec, nid, AC_PAR_AUDIO_WIDGET_CAP) & AC_WCAP_FORMAT_OVRD) {
1344                 val = snd_hda_param_read(codec, nid, AC_PAR_PCM);
1345                 if (val == -1)
1346                         return 0;
1347         }
1348         if (! val) {
1349                 val = snd_hda_param_read(codec, codec->afg, AC_PAR_PCM);
1350                 if (val == -1)
1351                         return 0;
1352         }
1353
1354         rate = format & 0xff00;
1355         for (i = 0; rate_bits[i][0]; i++)
1356                 if (rate_bits[i][2] == rate) {
1357                         if (val & (1 << i))
1358                                 break;
1359                         return 0;
1360                 }
1361         if (! rate_bits[i][0])
1362                 return 0;
1363
1364         stream = snd_hda_param_read(codec, nid, AC_PAR_STREAM);
1365         if (stream == -1)
1366                 return 0;
1367         if (! stream && nid != codec->afg)
1368                 stream = snd_hda_param_read(codec, codec->afg, AC_PAR_STREAM);
1369         if (! stream || stream == -1)
1370                 return 0;
1371
1372         if (stream & AC_SUPFMT_PCM) {
1373                 switch (format & 0xf0) {
1374                 case 0x00:
1375                         if (! (val & AC_SUPPCM_BITS_8))
1376                                 return 0;
1377                         break;
1378                 case 0x10:
1379                         if (! (val & AC_SUPPCM_BITS_16))
1380                                 return 0;
1381                         break;
1382                 case 0x20:
1383                         if (! (val & AC_SUPPCM_BITS_20))
1384                                 return 0;
1385                         break;
1386                 case 0x30:
1387                         if (! (val & AC_SUPPCM_BITS_24))
1388                                 return 0;
1389                         break;
1390                 case 0x40:
1391                         if (! (val & AC_SUPPCM_BITS_32))
1392                                 return 0;
1393                         break;
1394                 default:
1395                         return 0;
1396                 }
1397         } else {
1398                 /* FIXME: check for float32 and AC3? */
1399         }
1400
1401         return 1;
1402 }
1403
1404 /*
1405  * PCM stuff
1406  */
1407 static int hda_pcm_default_open_close(struct hda_pcm_stream *hinfo,
1408                                       struct hda_codec *codec,
1409                                       snd_pcm_substream_t *substream)
1410 {
1411         return 0;
1412 }
1413
1414 static int hda_pcm_default_prepare(struct hda_pcm_stream *hinfo,
1415                                    struct hda_codec *codec,
1416                                    unsigned int stream_tag,
1417                                    unsigned int format,
1418                                    snd_pcm_substream_t *substream)
1419 {
1420         snd_hda_codec_setup_stream(codec, hinfo->nid, stream_tag, 0, format);
1421         return 0;
1422 }
1423
1424 static int hda_pcm_default_cleanup(struct hda_pcm_stream *hinfo,
1425                                    struct hda_codec *codec,
1426                                    snd_pcm_substream_t *substream)
1427 {
1428         snd_hda_codec_setup_stream(codec, hinfo->nid, 0, 0, 0);
1429         return 0;
1430 }
1431
1432 static int set_pcm_default_values(struct hda_codec *codec, struct hda_pcm_stream *info)
1433 {
1434         if (info->nid) {
1435                 /* query support PCM information from the given NID */
1436                 if (! info->rates || ! info->formats)
1437                         snd_hda_query_supported_pcm(codec, info->nid,
1438                                                     info->rates ? NULL : &info->rates,
1439                                                     info->formats ? NULL : &info->formats,
1440                                                     info->maxbps ? NULL : &info->maxbps);
1441         }
1442         if (info->ops.open == NULL)
1443                 info->ops.open = hda_pcm_default_open_close;
1444         if (info->ops.close == NULL)
1445                 info->ops.close = hda_pcm_default_open_close;
1446         if (info->ops.prepare == NULL) {
1447                 snd_assert(info->nid, return -EINVAL);
1448                 info->ops.prepare = hda_pcm_default_prepare;
1449         }
1450         if (info->ops.cleanup == NULL) {
1451                 snd_assert(info->nid, return -EINVAL);
1452                 info->ops.cleanup = hda_pcm_default_cleanup;
1453         }
1454         return 0;
1455 }
1456
1457 /**
1458  * snd_hda_build_pcms - build PCM information
1459  * @bus: the BUS
1460  *
1461  * Create PCM information for each codec included in the bus.
1462  *
1463  * The build_pcms codec patch is requested to set up codec->num_pcms and
1464  * codec->pcm_info properly.  The array is referred by the top-level driver
1465  * to create its PCM instances.
1466  * The allocated codec->pcm_info should be released in codec->patch_ops.free
1467  * callback.
1468  *
1469  * At least, substreams, channels_min and channels_max must be filled for
1470  * each stream.  substreams = 0 indicates that the stream doesn't exist.
1471  * When rates and/or formats are zero, the supported values are queried
1472  * from the given nid.  The nid is used also by the default ops.prepare
1473  * and ops.cleanup callbacks.
1474  *
1475  * The driver needs to call ops.open in its open callback.  Similarly,
1476  * ops.close is supposed to be called in the close callback.
1477  * ops.prepare should be called in the prepare or hw_params callback
1478  * with the proper parameters for set up.
1479  * ops.cleanup should be called in hw_free for clean up of streams.
1480  *
1481  * This function returns 0 if successfull, or a negative error code.
1482  */
1483 int snd_hda_build_pcms(struct hda_bus *bus)
1484 {
1485         struct list_head *p;
1486
1487         list_for_each(p, &bus->codec_list) {
1488                 struct hda_codec *codec = list_entry(p, struct hda_codec, list);
1489                 unsigned int pcm, s;
1490                 int err;
1491                 if (! codec->patch_ops.build_pcms)
1492                         continue;
1493                 err = codec->patch_ops.build_pcms(codec);
1494                 if (err < 0)
1495                         return err;
1496                 for (pcm = 0; pcm < codec->num_pcms; pcm++) {
1497                         for (s = 0; s < 2; s++) {
1498                                 struct hda_pcm_stream *info;
1499                                 info = &codec->pcm_info[pcm].stream[s];
1500                                 if (! info->substreams)
1501                                         continue;
1502                                 err = set_pcm_default_values(codec, info);
1503                                 if (err < 0)
1504                                         return err;
1505                         }
1506                 }
1507         }
1508         return 0;
1509 }
1510
1511
1512 /**
1513  * snd_hda_check_board_config - compare the current codec with the config table
1514  * @codec: the HDA codec
1515  * @tbl: configuration table, terminated by null entries
1516  *
1517  * Compares the modelname or PCI subsystem id of the current codec with the
1518  * given configuration table.  If a matching entry is found, returns its
1519  * config value (supposed to be 0 or positive).
1520  *
1521  * If no entries are matching, the function returns a negative value.
1522  */
1523 int snd_hda_check_board_config(struct hda_codec *codec, struct hda_board_config *tbl)
1524 {
1525         struct hda_board_config *c;
1526
1527         if (codec->bus->modelname) {
1528                 for (c = tbl; c->modelname || c->pci_subvendor; c++) {
1529                         if (c->modelname &&
1530                             ! strcmp(codec->bus->modelname, c->modelname)) {
1531                                 snd_printd(KERN_INFO "hda_codec: model '%s' is selected\n", c->modelname);
1532                                 return c->config;
1533                         }
1534                 }
1535         }
1536
1537         if (codec->bus->pci) {
1538                 u16 subsystem_vendor, subsystem_device;
1539                 pci_read_config_word(codec->bus->pci, PCI_SUBSYSTEM_VENDOR_ID, &subsystem_vendor);
1540                 pci_read_config_word(codec->bus->pci, PCI_SUBSYSTEM_ID, &subsystem_device);
1541                 for (c = tbl; c->modelname || c->pci_subvendor; c++) {
1542                         if (c->pci_subvendor == subsystem_vendor &&
1543                             c->pci_subdevice == subsystem_device)
1544                                 return c->config;
1545                 }
1546         }
1547         return -1;
1548 }
1549
1550 /**
1551  * snd_hda_add_new_ctls - create controls from the array
1552  * @codec: the HDA codec
1553  * @knew: the array of snd_kcontrol_new_t
1554  *
1555  * This helper function creates and add new controls in the given array.
1556  * The array must be terminated with an empty entry as terminator.
1557  *
1558  * Returns 0 if successful, or a negative error code.
1559  */
1560 int snd_hda_add_new_ctls(struct hda_codec *codec, snd_kcontrol_new_t *knew)
1561 {
1562         int err;
1563
1564         for (; knew->name; knew++) {
1565                 err = snd_ctl_add(codec->bus->card, snd_ctl_new1(knew, codec));
1566                 if (err < 0)
1567                         return err;
1568         }
1569         return 0;
1570 }
1571
1572
1573 /*
1574  * input MUX helper
1575  */
1576 int snd_hda_input_mux_info(const struct hda_input_mux *imux, snd_ctl_elem_info_t *uinfo)
1577 {
1578         unsigned int index;
1579
1580         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
1581         uinfo->count = 1;
1582         uinfo->value.enumerated.items = imux->num_items;
1583         index = uinfo->value.enumerated.item;
1584         if (index >= imux->num_items)
1585                 index = imux->num_items - 1;
1586         strcpy(uinfo->value.enumerated.name, imux->items[index].label);
1587         return 0;
1588 }
1589
1590 int snd_hda_input_mux_put(struct hda_codec *codec, const struct hda_input_mux *imux,
1591                           snd_ctl_elem_value_t *ucontrol, hda_nid_t nid,
1592                           unsigned int *cur_val)
1593 {
1594         unsigned int idx;
1595
1596         idx = ucontrol->value.enumerated.item[0];
1597         if (idx >= imux->num_items)
1598                 idx = imux->num_items - 1;
1599         if (*cur_val == idx && ! codec->in_resume)
1600                 return 0;
1601         snd_hda_codec_write(codec, nid, 0, AC_VERB_SET_CONNECT_SEL,
1602                             imux->items[idx].index);
1603         *cur_val = idx;
1604         return 1;
1605 }
1606
1607
1608 /*
1609  * Multi-channel / digital-out PCM helper functions
1610  */
1611
1612 /*
1613  * open the digital out in the exclusive mode
1614  */
1615 int snd_hda_multi_out_dig_open(struct hda_codec *codec, struct hda_multi_out *mout)
1616 {
1617         down(&codec->spdif_mutex);
1618         if (mout->dig_out_used) {
1619                 up(&codec->spdif_mutex);
1620                 return -EBUSY; /* already being used */
1621         }
1622         mout->dig_out_used = HDA_DIG_EXCLUSIVE;
1623         up(&codec->spdif_mutex);
1624         return 0;
1625 }
1626
1627 /*
1628  * release the digital out
1629  */
1630 int snd_hda_multi_out_dig_close(struct hda_codec *codec, struct hda_multi_out *mout)
1631 {
1632         down(&codec->spdif_mutex);
1633         mout->dig_out_used = 0;
1634         up(&codec->spdif_mutex);
1635         return 0;
1636 }
1637
1638 /*
1639  * set up more restrictions for analog out
1640  */
1641 int snd_hda_multi_out_analog_open(struct hda_codec *codec, struct hda_multi_out *mout,
1642                                   snd_pcm_substream_t *substream)
1643 {
1644         substream->runtime->hw.channels_max = mout->max_channels;
1645         return snd_pcm_hw_constraint_step(substream->runtime, 0,
1646                                           SNDRV_PCM_HW_PARAM_CHANNELS, 2);
1647 }
1648
1649 /*
1650  * set up the i/o for analog out
1651  * when the digital out is available, copy the front out to digital out, too.
1652  */
1653 int snd_hda_multi_out_analog_prepare(struct hda_codec *codec, struct hda_multi_out *mout,
1654                                      unsigned int stream_tag,
1655                                      unsigned int format,
1656                                      snd_pcm_substream_t *substream)
1657 {
1658         hda_nid_t *nids = mout->dac_nids;
1659         int chs = substream->runtime->channels;
1660         int i;
1661
1662         down(&codec->spdif_mutex);
1663         if (mout->dig_out_nid && mout->dig_out_used != HDA_DIG_EXCLUSIVE) {
1664                 if (chs == 2 &&
1665                     snd_hda_is_supported_format(codec, mout->dig_out_nid, format) &&
1666                     ! (codec->spdif_status & IEC958_AES0_NONAUDIO)) {
1667                         mout->dig_out_used = HDA_DIG_ANALOG_DUP;
1668                         /* setup digital receiver */
1669                         snd_hda_codec_setup_stream(codec, mout->dig_out_nid,
1670                                                    stream_tag, 0, format);
1671                 } else {
1672                         mout->dig_out_used = 0;
1673                         snd_hda_codec_setup_stream(codec, mout->dig_out_nid, 0, 0, 0);
1674                 }
1675         }
1676         up(&codec->spdif_mutex);
1677
1678         /* front */
1679         snd_hda_codec_setup_stream(codec, nids[HDA_FRONT], stream_tag, 0, format);
1680         if (mout->hp_nid)
1681                 /* headphone out will just decode front left/right (stereo) */
1682                 snd_hda_codec_setup_stream(codec, mout->hp_nid, stream_tag, 0, format);
1683         /* surrounds */
1684         for (i = 1; i < mout->num_dacs; i++) {
1685                 if (i == HDA_REAR && chs == 2) /* copy front to rear */
1686                         snd_hda_codec_setup_stream(codec, nids[i], stream_tag, 0, format);
1687                 else if (chs >= (i + 1) * 2) /* independent out */
1688                         snd_hda_codec_setup_stream(codec, nids[i], stream_tag, i * 2,
1689                                                    format);
1690         }
1691         return 0;
1692 }
1693
1694 /*
1695  * clean up the setting for analog out
1696  */
1697 int snd_hda_multi_out_analog_cleanup(struct hda_codec *codec, struct hda_multi_out *mout)
1698 {
1699         hda_nid_t *nids = mout->dac_nids;
1700         int i;
1701
1702         for (i = 0; i < mout->num_dacs; i++)
1703                 snd_hda_codec_setup_stream(codec, nids[i], 0, 0, 0);
1704         if (mout->hp_nid)
1705                 snd_hda_codec_setup_stream(codec, mout->hp_nid, 0, 0, 0);
1706         down(&codec->spdif_mutex);
1707         if (mout->dig_out_nid && mout->dig_out_used == HDA_DIG_ANALOG_DUP) {
1708                 snd_hda_codec_setup_stream(codec, mout->dig_out_nid, 0, 0, 0);
1709                 mout->dig_out_used = 0;
1710         }
1711         up(&codec->spdif_mutex);
1712         return 0;
1713 }
1714
1715 #ifdef CONFIG_PM
1716 /*
1717  * power management
1718  */
1719
1720 /**
1721  * snd_hda_suspend - suspend the codecs
1722  * @bus: the HDA bus
1723  * @state: suspsend state
1724  *
1725  * Returns 0 if successful.
1726  */
1727 int snd_hda_suspend(struct hda_bus *bus, pm_message_t state)
1728 {
1729         struct list_head *p;
1730
1731         /* FIXME: should handle power widget capabilities */
1732         list_for_each(p, &bus->codec_list) {
1733                 struct hda_codec *codec = list_entry(p, struct hda_codec, list);
1734                 if (codec->patch_ops.suspend)
1735                         codec->patch_ops.suspend(codec, state);
1736         }
1737         return 0;
1738 }
1739
1740 /**
1741  * snd_hda_resume - resume the codecs
1742  * @bus: the HDA bus
1743  * @state: resume state
1744  *
1745  * Returns 0 if successful.
1746  */
1747 int snd_hda_resume(struct hda_bus *bus)
1748 {
1749         struct list_head *p;
1750
1751         list_for_each(p, &bus->codec_list) {
1752                 struct hda_codec *codec = list_entry(p, struct hda_codec, list);
1753                 if (codec->patch_ops.resume)
1754                         codec->patch_ops.resume(codec);
1755         }
1756         return 0;
1757 }
1758
1759 /**
1760  * snd_hda_resume_ctls - resume controls in the new control list
1761  * @codec: the HDA codec
1762  * @knew: the array of snd_kcontrol_new_t
1763  *
1764  * This function resumes the mixer controls in the snd_kcontrol_new_t array,
1765  * originally for snd_hda_add_new_ctls().
1766  * The array must be terminated with an empty entry as terminator.
1767  */
1768 int snd_hda_resume_ctls(struct hda_codec *codec, snd_kcontrol_new_t *knew)
1769 {
1770         snd_ctl_elem_value_t *val;
1771
1772         val = kmalloc(sizeof(*val), GFP_KERNEL);
1773         if (! val)
1774                 return -ENOMEM;
1775         codec->in_resume = 1;
1776         for (; knew->name; knew++) {
1777                 int i, count;
1778                 count = knew->count ? knew->count : 1;
1779                 for (i = 0; i < count; i++) {
1780                         memset(val, 0, sizeof(*val));
1781                         val->id.iface = knew->iface;
1782                         val->id.device = knew->device;
1783                         val->id.subdevice = knew->subdevice;
1784                         strcpy(val->id.name, knew->name);
1785                         val->id.index = knew->index ? knew->index : i;
1786                         /* Assume that get callback reads only from cache,
1787                          * not accessing to the real hardware
1788                          */
1789                         if (snd_ctl_elem_read(codec->bus->card, val) < 0)
1790                                 continue;
1791                         snd_ctl_elem_write(codec->bus->card, NULL, val);
1792                 }
1793         }
1794         codec->in_resume = 0;
1795         kfree(val);
1796         return 0;
1797 }
1798
1799 /**
1800  * snd_hda_resume_spdif_out - resume the digital out
1801  * @codec: the HDA codec
1802  */
1803 int snd_hda_resume_spdif_out(struct hda_codec *codec)
1804 {
1805         return snd_hda_resume_ctls(codec, dig_mixes);
1806 }
1807
1808 /**
1809  * snd_hda_resume_spdif_in - resume the digital in
1810  * @codec: the HDA codec
1811  */
1812 int snd_hda_resume_spdif_in(struct hda_codec *codec)
1813 {
1814         return snd_hda_resume_ctls(codec, dig_in_ctls);
1815 }
1816 #endif
1817
1818 /*
1819  * symbols exported for controller modules
1820  */
1821 EXPORT_SYMBOL(snd_hda_codec_read);
1822 EXPORT_SYMBOL(snd_hda_codec_write);
1823 EXPORT_SYMBOL(snd_hda_sequence_write);
1824 EXPORT_SYMBOL(snd_hda_get_sub_nodes);
1825 EXPORT_SYMBOL(snd_hda_queue_unsol_event);
1826 EXPORT_SYMBOL(snd_hda_bus_new);
1827 EXPORT_SYMBOL(snd_hda_codec_new);
1828 EXPORT_SYMBOL(snd_hda_codec_setup_stream);
1829 EXPORT_SYMBOL(snd_hda_calc_stream_format);
1830 EXPORT_SYMBOL(snd_hda_build_pcms);
1831 EXPORT_SYMBOL(snd_hda_build_controls);
1832 #ifdef CONFIG_PM
1833 EXPORT_SYMBOL(snd_hda_suspend);
1834 EXPORT_SYMBOL(snd_hda_resume);
1835 #endif
1836
1837 /*
1838  *  INIT part
1839  */
1840
1841 static int __init alsa_hda_init(void)
1842 {
1843         return 0;
1844 }
1845
1846 static void __exit alsa_hda_exit(void)
1847 {
1848 }
1849
1850 module_init(alsa_hda_init)
1851 module_exit(alsa_hda_exit)