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