?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Staging: hv: vmbus: Cleanup some error values in channel.c
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / sound / soc / soc-dapm.c
blob776e6f418306fe004936692fd70dab7c89cdec6d
1 /*
2 * soc-dapm.c -- ALSA SoC Dynamic Audio Power Management
3 *
4 * Copyright 2005 Wolfson Microelectronics PLC.
5 * Author: Liam Girdwood <lrg@slimlogic.co.uk>
6 *
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License as published by the
9 * Free Software Foundation; either version 2 of the License, or (at your
10 * option) any later version.
11 *
12 * Features:
13 * o Changes power status of internal codec blocks depending on the
14 * dynamic configuration of codec internal audio paths and active
15 * DACs/ADCs.
16 * o Platform power domain - can support external components i.e. amps and
17 * mic/meadphone insertion events.
18 * o Automatic Mic Bias support
19 * o Jack insertion power event initiation - e.g. hp insertion will enable
20 * sinks, dacs, etc
21 * o Delayed powerdown of audio susbsystem to reduce pops between a quick
22 * device reopen.
23 *
24 * Todo:
25 * o DAPM power change sequencing - allow for configurable per
26 * codec sequences.
27 * o Support for analogue bias optimisation.
28 * o Support for reduced codec oversampling rates.
29 * o Support for reduced codec bias currents.
30 */
31
32 #include <linux/module.h>
33 #include <linux/moduleparam.h>
34 #include <linux/init.h>
35 #include <linux/async.h>
36 #include <linux/delay.h>
37 #include <linux/pm.h>
38 #include <linux/bitops.h>
39 #include <linux/platform_device.h>
40 #include <linux/jiffies.h>
41 #include <linux/debugfs.h>
42 #include <linux/slab.h>
43 #include <sound/core.h>
44 #include <sound/pcm.h>
45 #include <sound/pcm_params.h>
46 #include <sound/soc.h>
47 #include <sound/initval.h>
48
49 #include <trace/events/asoc.h>
50
51 /* dapm power sequences - make this per codec in the future */
52 static int dapm_up_seq[] = {
53 [snd_soc_dapm_pre] = 0,
54 [snd_soc_dapm_supply] = 1,
55 [snd_soc_dapm_micbias] = 2,
56 [snd_soc_dapm_aif_in] = 3,
57 [snd_soc_dapm_aif_out] = 3,
58 [snd_soc_dapm_mic] = 4,
59 [snd_soc_dapm_mux] = 5,
60 [snd_soc_dapm_virt_mux] = 5,
61 [snd_soc_dapm_value_mux] = 5,
62 [snd_soc_dapm_dac] = 6,
63 [snd_soc_dapm_mixer] = 7,
64 [snd_soc_dapm_mixer_named_ctl] = 7,
65 [snd_soc_dapm_pga] = 8,
66 [snd_soc_dapm_adc] = 9,
67 [snd_soc_dapm_out_drv] = 10,
68 [snd_soc_dapm_hp] = 10,
69 [snd_soc_dapm_spk] = 10,
70 [snd_soc_dapm_post] = 11,
71 };
72
73 static int dapm_down_seq[] = {
74 [snd_soc_dapm_pre] = 0,
75 [snd_soc_dapm_adc] = 1,
76 [snd_soc_dapm_hp] = 2,
77 [snd_soc_dapm_spk] = 2,
78 [snd_soc_dapm_out_drv] = 2,
79 [snd_soc_dapm_pga] = 4,
80 [snd_soc_dapm_mixer_named_ctl] = 5,
81 [snd_soc_dapm_mixer] = 5,
82 [snd_soc_dapm_dac] = 6,
83 [snd_soc_dapm_mic] = 7,
84 [snd_soc_dapm_micbias] = 8,
85 [snd_soc_dapm_mux] = 9,
86 [snd_soc_dapm_virt_mux] = 9,
87 [snd_soc_dapm_value_mux] = 9,
88 [snd_soc_dapm_aif_in] = 10,
89 [snd_soc_dapm_aif_out] = 10,
90 [snd_soc_dapm_supply] = 11,
91 [snd_soc_dapm_post] = 12,
92 };
93
94 static void pop_wait(u32 pop_time)
95 {
96 if (pop_time)
97 schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
98 }
99
100 static void pop_dbg(struct device *dev, u32 pop_time, const char *fmt, ...)
101 {
102 va_list args;
103 char *buf;
104
105 if (!pop_time)
106 return;
107
108 buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
109 if (buf == NULL)
110 return;
111
112 va_start(args, fmt);
113 vsnprintf(buf, PAGE_SIZE, fmt, args);
114 dev_info(dev, "%s", buf);
115 va_end(args);
116
117 kfree(buf);
118 }
119
120 /* create a new dapm widget */
121 static inline struct snd_soc_dapm_widget *dapm_cnew_widget(
122 const struct snd_soc_dapm_widget *_widget)
123 {
124 return kmemdup(_widget, sizeof(*_widget), GFP_KERNEL);
125 }
126
127 /**
128 * snd_soc_dapm_set_bias_level - set the bias level for the system
129 * @dapm: DAPM context
130 * @level: level to configure
131 *
132 * Configure the bias (power) levels for the SoC audio device.
133 *
134 * Returns 0 for success else error.
135 */
136 static int snd_soc_dapm_set_bias_level(struct snd_soc_dapm_context *dapm,
137 enum snd_soc_bias_level level)
138 {
139 struct snd_soc_card *card = dapm->card;
140 int ret = 0;
141
142 switch (level) {
143 case SND_SOC_BIAS_ON:
144 dev_dbg(dapm->dev, "Setting full bias\n");
145 break;
146 case SND_SOC_BIAS_PREPARE:
147 dev_dbg(dapm->dev, "Setting bias prepare\n");
148 break;
149 case SND_SOC_BIAS_STANDBY:
150 dev_dbg(dapm->dev, "Setting standby bias\n");
151 break;
152 case SND_SOC_BIAS_OFF:
153 dev_dbg(dapm->dev, "Setting bias off\n");
154 break;
155 default:
156 dev_err(dapm->dev, "Setting invalid bias %d\n", level);
157 return -EINVAL;
158 }
159
160 trace_snd_soc_bias_level_start(card, level);
161
162 if (card && card->set_bias_level)
163 ret = card->set_bias_level(card, level);
164 if (ret == 0) {
165 if (dapm->codec && dapm->codec->driver->set_bias_level)
166 ret = dapm->codec->driver->set_bias_level(dapm->codec, level);
167 else
168 dapm->bias_level = level;
169 }
170 if (ret == 0) {
171 if (card && card->set_bias_level_post)
172 ret = card->set_bias_level_post(card, level);
173 }
174
175 trace_snd_soc_bias_level_done(card, level);
176
177 return ret;
178 }
179
180 /* set up initial codec paths */
181 static void dapm_set_path_status(struct snd_soc_dapm_widget *w,
182 struct snd_soc_dapm_path *p, int i)
183 {
184 switch (w->id) {
185 case snd_soc_dapm_switch:
186 case snd_soc_dapm_mixer:
187 case snd_soc_dapm_mixer_named_ctl: {
188 int val;
189 struct soc_mixer_control *mc = (struct soc_mixer_control *)
190 w->kcontrol_news[i].private_value;
191 unsigned int reg = mc->reg;
192 unsigned int shift = mc->shift;
193 int max = mc->max;
194 unsigned int mask = (1 << fls(max)) - 1;
195 unsigned int invert = mc->invert;
196
197 val = snd_soc_read(w->codec, reg);
198 val = (val >> shift) & mask;
199
200 if ((invert && !val) || (!invert && val))
201 p->connect = 1;
202 else
203 p->connect = 0;
204 }
205 break;
206 case snd_soc_dapm_mux: {
207 struct soc_enum *e = (struct soc_enum *)
208 w->kcontrol_news[i].private_value;
209 int val, item, bitmask;
210
211 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
212 ;
213 val = snd_soc_read(w->codec, e->reg);
214 item = (val >> e->shift_l) & (bitmask - 1);
215
216 p->connect = 0;
217 for (i = 0; i < e->max; i++) {
218 if (!(strcmp(p->name, e->texts[i])) && item == i)
219 p->connect = 1;
220 }
221 }
222 break;
223 case snd_soc_dapm_virt_mux: {
224 struct soc_enum *e = (struct soc_enum *)
225 w->kcontrol_news[i].private_value;
226
227 p->connect = 0;
228 /* since a virtual mux has no backing registers to
229 * decide which path to connect, it will try to match
230 * with the first enumeration. This is to ensure
231 * that the default mux choice (the first) will be
232 * correctly powered up during initialization.
233 */
234 if (!strcmp(p->name, e->texts[0]))
235 p->connect = 1;
236 }
237 break;
238 case snd_soc_dapm_value_mux: {
239 struct soc_enum *e = (struct soc_enum *)
240 w->kcontrol_news[i].private_value;
241 int val, item;
242
243 val = snd_soc_read(w->codec, e->reg);
244 val = (val >> e->shift_l) & e->mask;
245 for (item = 0; item < e->max; item++) {
246 if (val == e->values[item])
247 break;
248 }
249
250 p->connect = 0;
251 for (i = 0; i < e->max; i++) {
252 if (!(strcmp(p->name, e->texts[i])) && item == i)
253 p->connect = 1;
254 }
255 }
256 break;
257 /* does not effect routing - always connected */
258 case snd_soc_dapm_pga:
259 case snd_soc_dapm_out_drv:
260 case snd_soc_dapm_output:
261 case snd_soc_dapm_adc:
262 case snd_soc_dapm_input:
263 case snd_soc_dapm_dac:
264 case snd_soc_dapm_micbias:
265 case snd_soc_dapm_vmid:
266 case snd_soc_dapm_supply:
267 case snd_soc_dapm_aif_in:
268 case snd_soc_dapm_aif_out:
269 p->connect = 1;
270 break;
271 /* does effect routing - dynamically connected */
272 case snd_soc_dapm_hp:
273 case snd_soc_dapm_mic:
274 case snd_soc_dapm_spk:
275 case snd_soc_dapm_line:
276 case snd_soc_dapm_pre:
277 case snd_soc_dapm_post:
278 p->connect = 0;
279 break;
280 }
281 }
282
283 /* connect mux widget to its interconnecting audio paths */
284 static int dapm_connect_mux(struct snd_soc_dapm_context *dapm,
285 struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
286 struct snd_soc_dapm_path *path, const char *control_name,
287 const struct snd_kcontrol_new *kcontrol)
288 {
289 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
290 int i;
291
292 for (i = 0; i < e->max; i++) {
293 if (!(strcmp(control_name, e->texts[i]))) {
294 list_add(&path->list, &dapm->card->paths);
295 list_add(&path->list_sink, &dest->sources);
296 list_add(&path->list_source, &src->sinks);
297 path->name = (char*)e->texts[i];
298 dapm_set_path_status(dest, path, 0);
299 return 0;
300 }
301 }
302
303 return -ENODEV;
304 }
305
306 /* connect mixer widget to its interconnecting audio paths */
307 static int dapm_connect_mixer(struct snd_soc_dapm_context *dapm,
308 struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
309 struct snd_soc_dapm_path *path, const char *control_name)
310 {
311 int i;
312
313 /* search for mixer kcontrol */
314 for (i = 0; i < dest->num_kcontrols; i++) {
315 if (!strcmp(control_name, dest->kcontrol_news[i].name)) {
316 list_add(&path->list, &dapm->card->paths);
317 list_add(&path->list_sink, &dest->sources);
318 list_add(&path->list_source, &src->sinks);
319 path->name = dest->kcontrol_news[i].name;
320 dapm_set_path_status(dest, path, i);
321 return 0;
322 }
323 }
324 return -ENODEV;
325 }
326
327 static int dapm_is_shared_kcontrol(struct snd_soc_dapm_context *dapm,
328 struct snd_soc_dapm_widget *kcontrolw,
329 const struct snd_kcontrol_new *kcontrol_new,
330 struct snd_kcontrol **kcontrol)
331 {
332 struct snd_soc_dapm_widget *w;
333 int i;
334
335 *kcontrol = NULL;
336
337 list_for_each_entry(w, &dapm->card->widgets, list) {
338 if (w == kcontrolw || w->dapm != kcontrolw->dapm)
339 continue;
340 for (i = 0; i < w->num_kcontrols; i++) {
341 if (&w->kcontrol_news[i] == kcontrol_new) {
342 if (w->kcontrols)
343 *kcontrol = w->kcontrols[i];
344 return 1;
345 }
346 }
347 }
348
349 return 0;
350 }
351
352 /* create new dapm mixer control */
353 static int dapm_new_mixer(struct snd_soc_dapm_context *dapm,
354 struct snd_soc_dapm_widget *w)
355 {
356 int i, ret = 0;
357 size_t name_len, prefix_len;
358 struct snd_soc_dapm_path *path;
359 struct snd_card *card = dapm->card->snd_card;
360 const char *prefix;
361 struct snd_soc_dapm_widget_list *wlist;
362 size_t wlistsize;
363
364 if (dapm->codec)
365 prefix = dapm->codec->name_prefix;
366 else
367 prefix = NULL;
368
369 if (prefix)
370 prefix_len = strlen(prefix) + 1;
371 else
372 prefix_len = 0;
373
374 /* add kcontrol */
375 for (i = 0; i < w->num_kcontrols; i++) {
376
377 /* match name */
378 list_for_each_entry(path, &w->sources, list_sink) {
379
380 /* mixer/mux paths name must match control name */
381 if (path->name != (char *)w->kcontrol_news[i].name)
382 continue;
383
384 wlistsize = sizeof(struct snd_soc_dapm_widget_list) +
385 sizeof(struct snd_soc_dapm_widget *),
386 wlist = kzalloc(wlistsize, GFP_KERNEL);
387 if (wlist == NULL) {
388 dev_err(dapm->dev,
389 "asoc: can't allocate widget list for %s\n",
390 w->name);
391 return -ENOMEM;
392 }
393 wlist->num_widgets = 1;
394 wlist->widgets[0] = w;
395
396 /* add dapm control with long name.
397 * for dapm_mixer this is the concatenation of the
398 * mixer and kcontrol name.
399 * for dapm_mixer_named_ctl this is simply the
400 * kcontrol name.
401 */
402 name_len = strlen(w->kcontrol_news[i].name) + 1;
403 if (w->id != snd_soc_dapm_mixer_named_ctl)
404 name_len += 1 + strlen(w->name);
405
406 path->long_name = kmalloc(name_len, GFP_KERNEL);
407
408 if (path->long_name == NULL) {
409 kfree(wlist);
410 return -ENOMEM;
411 }
412
413 switch (w->id) {
414 default:
415 /* The control will get a prefix from
416 * the control creation process but
417 * we're also using the same prefix
418 * for widgets so cut the prefix off
419 * the front of the widget name.
420 */
421 snprintf(path->long_name, name_len, "%s %s",
422 w->name + prefix_len,
423 w->kcontrol_news[i].name);
424 break;
425 case snd_soc_dapm_mixer_named_ctl:
426 snprintf(path->long_name, name_len, "%s",
427 w->kcontrol_news[i].name);
428 break;
429 }
430
431 path->long_name[name_len - 1] = '\0';
432
433 path->kcontrol = snd_soc_cnew(&w->kcontrol_news[i],
434 wlist, path->long_name,
435 prefix);
436 ret = snd_ctl_add(card, path->kcontrol);
437 if (ret < 0) {
438 dev_err(dapm->dev,
439 "asoc: failed to add dapm kcontrol %s: %d\n",
440 path->long_name, ret);
441 kfree(wlist);
442 kfree(path->long_name);
443 path->long_name = NULL;
444 return ret;
445 }
446 w->kcontrols[i] = path->kcontrol;
447 }
448 }
449 return ret;
450 }
451
452 /* create new dapm mux control */
453 static int dapm_new_mux(struct snd_soc_dapm_context *dapm,
454 struct snd_soc_dapm_widget *w)
455 {
456 struct snd_soc_dapm_path *path = NULL;
457 struct snd_kcontrol *kcontrol;
458 struct snd_card *card = dapm->card->snd_card;
459 const char *prefix;
460 size_t prefix_len;
461 int ret;
462 struct snd_soc_dapm_widget_list *wlist;
463 int shared, wlistentries;
464 size_t wlistsize;
465 char *name;
466
467 if (w->num_kcontrols != 1) {
468 dev_err(dapm->dev,
469 "asoc: mux %s has incorrect number of controls\n",
470 w->name);
471 return -EINVAL;
472 }
473
474 shared = dapm_is_shared_kcontrol(dapm, w, &w->kcontrol_news[0],
475 &kcontrol);
476 if (kcontrol) {
477 wlist = kcontrol->private_data;
478 wlistentries = wlist->num_widgets + 1;
479 } else {
480 wlist = NULL;
481 wlistentries = 1;
482 }
483 wlistsize = sizeof(struct snd_soc_dapm_widget_list) +
484 wlistentries * sizeof(struct snd_soc_dapm_widget *),
485 wlist = krealloc(wlist, wlistsize, GFP_KERNEL);
486 if (wlist == NULL) {
487 dev_err(dapm->dev,
488 "asoc: can't allocate widget list for %s\n", w->name);
489 return -ENOMEM;
490 }
491 wlist->num_widgets = wlistentries;
492 wlist->widgets[wlistentries - 1] = w;
493
494 if (!kcontrol) {
495 if (dapm->codec)
496 prefix = dapm->codec->name_prefix;
497 else
498 prefix = NULL;
499
500 if (shared) {
501 name = w->kcontrol_news[0].name;
502 prefix_len = 0;
503 } else {
504 name = w->name;
505 if (prefix)
506 prefix_len = strlen(prefix) + 1;
507 else
508 prefix_len = 0;
509 }
510
511 /*
512 * The control will get a prefix from the control creation
513 * process but we're also using the same prefix for widgets so
514 * cut the prefix off the front of the widget name.
515 */
516 kcontrol = snd_soc_cnew(&w->kcontrol_news[0], wlist,
517 name + prefix_len, prefix);
518 ret = snd_ctl_add(card, kcontrol);
519 if (ret < 0) {
520 dev_err(dapm->dev,
521 "asoc: failed to add kcontrol %s\n", w->name);
522 kfree(wlist);
523 return ret;
524 }
525 }
526
527 kcontrol->private_data = wlist;
528
529 w->kcontrols[0] = kcontrol;
530
531 list_for_each_entry(path, &w->sources, list_sink)
532 path->kcontrol = kcontrol;
533
534 return 0;
535 }
536
537 /* create new dapm volume control */
538 static int dapm_new_pga(struct snd_soc_dapm_context *dapm,
539 struct snd_soc_dapm_widget *w)
540 {
541 if (w->num_kcontrols)
542 dev_err(w->dapm->dev,
543 "asoc: PGA controls not supported: '%s'\n", w->name);
544
545 return 0;
546 }
547
548 /* reset 'walked' bit for each dapm path */
549 static inline void dapm_clear_walk(struct snd_soc_dapm_context *dapm)
550 {
551 struct snd_soc_dapm_path *p;
552
553 list_for_each_entry(p, &dapm->card->paths, list)
554 p->walked = 0;
555 }
556
557 /* We implement power down on suspend by checking the power state of
558 * the ALSA card - when we are suspending the ALSA state for the card
559 * is set to D3.
560 */
561 static int snd_soc_dapm_suspend_check(struct snd_soc_dapm_widget *widget)
562 {
563 int level = snd_power_get_state(widget->dapm->card->snd_card);
564
565 switch (level) {
566 case SNDRV_CTL_POWER_D3hot:
567 case SNDRV_CTL_POWER_D3cold:
568 if (widget->ignore_suspend)
569 dev_dbg(widget->dapm->dev, "%s ignoring suspend\n",
570 widget->name);
571 return widget->ignore_suspend;
572 default:
573 return 1;
574 }
575 }
576
577 /*
578 * Recursively check for a completed path to an active or physically connected
579 * output widget. Returns number of complete paths.
580 */
581 static int is_connected_output_ep(struct snd_soc_dapm_widget *widget)
582 {
583 struct snd_soc_dapm_path *path;
584 int con = 0;
585
586 if (widget->id == snd_soc_dapm_supply)
587 return 0;
588
589 switch (widget->id) {
590 case snd_soc_dapm_adc:
591 case snd_soc_dapm_aif_out:
592 if (widget->active)
593 return snd_soc_dapm_suspend_check(widget);
594 default:
595 break;
596 }
597
598 if (widget->connected) {
599 /* connected pin ? */
600 if (widget->id == snd_soc_dapm_output && !widget->ext)
601 return snd_soc_dapm_suspend_check(widget);
602
603 /* connected jack or spk ? */
604 if (widget->id == snd_soc_dapm_hp || widget->id == snd_soc_dapm_spk ||
605 (widget->id == snd_soc_dapm_line && !list_empty(&widget->sources)))
606 return snd_soc_dapm_suspend_check(widget);
607 }
608
609 list_for_each_entry(path, &widget->sinks, list_source) {
610 if (path->walked)
611 continue;
612
613 if (path->sink && path->connect) {
614 path->walked = 1;
615 con += is_connected_output_ep(path->sink);
616 }
617 }
618
619 return con;
620 }
621
622 /*
623 * Recursively check for a completed path to an active or physically connected
624 * input widget. Returns number of complete paths.
625 */
626 static int is_connected_input_ep(struct snd_soc_dapm_widget *widget)
627 {
628 struct snd_soc_dapm_path *path;
629 int con = 0;
630
631 if (widget->id == snd_soc_dapm_supply)
632 return 0;
633
634 /* active stream ? */
635 switch (widget->id) {
636 case snd_soc_dapm_dac:
637 case snd_soc_dapm_aif_in:
638 if (widget->active)
639 return snd_soc_dapm_suspend_check(widget);
640 default:
641 break;
642 }
643
644 if (widget->connected) {
645 /* connected pin ? */
646 if (widget->id == snd_soc_dapm_input && !widget->ext)
647 return snd_soc_dapm_suspend_check(widget);
648
649 /* connected VMID/Bias for lower pops */
650 if (widget->id == snd_soc_dapm_vmid)
651 return snd_soc_dapm_suspend_check(widget);
652
653 /* connected jack ? */
654 if (widget->id == snd_soc_dapm_mic ||
655 (widget->id == snd_soc_dapm_line && !list_empty(&widget->sinks)))
656 return snd_soc_dapm_suspend_check(widget);
657 }
658
659 list_for_each_entry(path, &widget->sources, list_sink) {
660 if (path->walked)
661 continue;
662
663 if (path->source && path->connect) {
664 path->walked = 1;
665 con += is_connected_input_ep(path->source);
666 }
667 }
668
669 return con;
670 }
671
672 /*
673 * Handler for generic register modifier widget.
674 */
675 int dapm_reg_event(struct snd_soc_dapm_widget *w,
676 struct snd_kcontrol *kcontrol, int event)
677 {
678 unsigned int val;
679
680 if (SND_SOC_DAPM_EVENT_ON(event))
681 val = w->on_val;
682 else
683 val = w->off_val;
684
685 snd_soc_update_bits(w->codec, -(w->reg + 1),
686 w->mask << w->shift, val << w->shift);
687
688 return 0;
689 }
690 EXPORT_SYMBOL_GPL(dapm_reg_event);
691
692 /* Generic check to see if a widget should be powered.
693 */
694 static int dapm_generic_check_power(struct snd_soc_dapm_widget *w)
695 {
696 int in, out;
697
698 in = is_connected_input_ep(w);
699 dapm_clear_walk(w->dapm);
700 out = is_connected_output_ep(w);
701 dapm_clear_walk(w->dapm);
702 return out != 0 && in != 0;
703 }
704
705 /* Check to see if an ADC has power */
706 static int dapm_adc_check_power(struct snd_soc_dapm_widget *w)
707 {
708 int in;
709
710 if (w->active) {
711 in = is_connected_input_ep(w);
712 dapm_clear_walk(w->dapm);
713 return in != 0;
714 } else {
715 return dapm_generic_check_power(w);
716 }
717 }
718
719 /* Check to see if a DAC has power */
720 static int dapm_dac_check_power(struct snd_soc_dapm_widget *w)
721 {
722 int out;
723
724 if (w->active) {
725 out = is_connected_output_ep(w);
726 dapm_clear_walk(w->dapm);
727 return out != 0;
728 } else {
729 return dapm_generic_check_power(w);
730 }
731 }
732
733 /* Check to see if a power supply is needed */
734 static int dapm_supply_check_power(struct snd_soc_dapm_widget *w)
735 {
736 struct snd_soc_dapm_path *path;
737 int power = 0;
738
739 /* Check if one of our outputs is connected */
740 list_for_each_entry(path, &w->sinks, list_source) {
741 if (path->connected &&
742 !path->connected(path->source, path->sink))
743 continue;
744
745 if (!path->sink)
746 continue;
747
748 if (path->sink->force) {
749 power = 1;
750 break;
751 }
752
753 if (path->sink->power_check &&
754 path->sink->power_check(path->sink)) {
755 power = 1;
756 break;
757 }
758 }
759
760 dapm_clear_walk(w->dapm);
761
762 return power;
763 }
764
765 static int dapm_seq_compare(struct snd_soc_dapm_widget *a,
766 struct snd_soc_dapm_widget *b,
767 bool power_up)
768 {
769 int *sort;
770
771 if (power_up)
772 sort = dapm_up_seq;
773 else
774 sort = dapm_down_seq;
775
776 if (sort[a->id] != sort[b->id])
777 return sort[a->id] - sort[b->id];
778 if (a->subseq != b->subseq) {
779 if (power_up)
780 return a->subseq - b->subseq;
781 else
782 return b->subseq - a->subseq;
783 }
784 if (a->reg != b->reg)
785 return a->reg - b->reg;
786 if (a->dapm != b->dapm)
787 return (unsigned long)a->dapm - (unsigned long)b->dapm;
788
789 return 0;
790 }
791
792 /* Insert a widget in order into a DAPM power sequence. */
793 static void dapm_seq_insert(struct snd_soc_dapm_widget *new_widget,
794 struct list_head *list,
795 bool power_up)
796 {
797 struct snd_soc_dapm_widget *w;
798
799 list_for_each_entry(w, list, power_list)
800 if (dapm_seq_compare(new_widget, w, power_up) < 0) {
801 list_add_tail(&new_widget->power_list, &w->power_list);
802 return;
803 }
804
805 list_add_tail(&new_widget->power_list, list);
806 }
807
808 static void dapm_seq_check_event(struct snd_soc_dapm_context *dapm,
809 struct snd_soc_dapm_widget *w, int event)
810 {
811 struct snd_soc_card *card = dapm->card;
812 const char *ev_name;
813 int power, ret;
814
815 switch (event) {
816 case SND_SOC_DAPM_PRE_PMU:
817 ev_name = "PRE_PMU";
818 power = 1;
819 break;
820 case SND_SOC_DAPM_POST_PMU:
821 ev_name = "POST_PMU";
822 power = 1;
823 break;
824 case SND_SOC_DAPM_PRE_PMD:
825 ev_name = "PRE_PMD";
826 power = 0;
827 break;
828 case SND_SOC_DAPM_POST_PMD:
829 ev_name = "POST_PMD";
830 power = 0;
831 break;
832 default:
833 BUG();
834 return;
835 }
836
837 if (w->power != power)
838 return;
839
840 if (w->event && (w->event_flags & event)) {
841 pop_dbg(dapm->dev, card->pop_time, "pop test : %s %s\n",
842 w->name, ev_name);
843 trace_snd_soc_dapm_widget_event_start(w, event);
844 ret = w->event(w, NULL, event);
845 trace_snd_soc_dapm_widget_event_done(w, event);
846 if (ret < 0)
847 pr_err("%s: %s event failed: %d\n",
848 ev_name, w->name, ret);
849 }
850 }
851
852 /* Apply the coalesced changes from a DAPM sequence */
853 static void dapm_seq_run_coalesced(struct snd_soc_dapm_context *dapm,
854 struct list_head *pending)
855 {
856 struct snd_soc_card *card = dapm->card;
857 struct snd_soc_dapm_widget *w;
858 int reg, power;
859 unsigned int value = 0;
860 unsigned int mask = 0;
861 unsigned int cur_mask;
862
863 reg = list_first_entry(pending, struct snd_soc_dapm_widget,
864 power_list)->reg;
865
866 list_for_each_entry(w, pending, power_list) {
867 cur_mask = 1 << w->shift;
868 BUG_ON(reg != w->reg);
869
870 if (w->invert)
871 power = !w->power;
872 else
873 power = w->power;
874
875 mask |= cur_mask;
876 if (power)
877 value |= cur_mask;
878
879 pop_dbg(dapm->dev, card->pop_time,
880 "pop test : Queue %s: reg=0x%x, 0x%x/0x%x\n",
881 w->name, reg, value, mask);
882
883 /* Check for events */
884 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_PRE_PMU);
885 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_PRE_PMD);
886 }
887
888 if (reg >= 0) {
889 pop_dbg(dapm->dev, card->pop_time,
890 "pop test : Applying 0x%x/0x%x to %x in %dms\n",
891 value, mask, reg, card->pop_time);
892 pop_wait(card->pop_time);
893 snd_soc_update_bits(dapm->codec, reg, mask, value);
894 }
895
896 list_for_each_entry(w, pending, power_list) {
897 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_POST_PMU);
898 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_POST_PMD);
899 }
900 }
901
902 /* Apply a DAPM power sequence.
903 *
904 * We walk over a pre-sorted list of widgets to apply power to. In
905 * order to minimise the number of writes to the device required
906 * multiple widgets will be updated in a single write where possible.
907 * Currently anything that requires more than a single write is not
908 * handled.
909 */
910 static void dapm_seq_run(struct snd_soc_dapm_context *dapm,
911 struct list_head *list, int event, bool power_up)
912 {
913 struct snd_soc_dapm_widget *w, *n;
914 LIST_HEAD(pending);
915 int cur_sort = -1;
916 int cur_subseq = -1;
917 int cur_reg = SND_SOC_NOPM;
918 struct snd_soc_dapm_context *cur_dapm = NULL;
919 int ret, i;
920 int *sort;
921
922 if (power_up)
923 sort = dapm_up_seq;
924 else
925 sort = dapm_down_seq;
926
927 list_for_each_entry_safe(w, n, list, power_list) {
928 ret = 0;
929
930 /* Do we need to apply any queued changes? */
931 if (sort[w->id] != cur_sort || w->reg != cur_reg ||
932 w->dapm != cur_dapm || w->subseq != cur_subseq) {
933 if (!list_empty(&pending))
934 dapm_seq_run_coalesced(cur_dapm, &pending);
935
936 if (cur_dapm && cur_dapm->seq_notifier) {
937 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
938 if (sort[i] == cur_sort)
939 cur_dapm->seq_notifier(cur_dapm,
940 i,
941 cur_subseq);
942 }
943
944 INIT_LIST_HEAD(&pending);
945 cur_sort = -1;
946 cur_subseq = -1;
947 cur_reg = SND_SOC_NOPM;
948 cur_dapm = NULL;
949 }
950
951 switch (w->id) {
952 case snd_soc_dapm_pre:
953 if (!w->event)
954 list_for_each_entry_safe_continue(w, n, list,
955 power_list);
956
957 if (event == SND_SOC_DAPM_STREAM_START)
958 ret = w->event(w,
959 NULL, SND_SOC_DAPM_PRE_PMU);
960 else if (event == SND_SOC_DAPM_STREAM_STOP)
961 ret = w->event(w,
962 NULL, SND_SOC_DAPM_PRE_PMD);
963 break;
964
965 case snd_soc_dapm_post:
966 if (!w->event)
967 list_for_each_entry_safe_continue(w, n, list,
968 power_list);
969
970 if (event == SND_SOC_DAPM_STREAM_START)
971 ret = w->event(w,
972 NULL, SND_SOC_DAPM_POST_PMU);
973 else if (event == SND_SOC_DAPM_STREAM_STOP)
974 ret = w->event(w,
975 NULL, SND_SOC_DAPM_POST_PMD);
976 break;
977
978 default:
979 /* Queue it up for application */
980 cur_sort = sort[w->id];
981 cur_subseq = w->subseq;
982 cur_reg = w->reg;
983 cur_dapm = w->dapm;
984 list_move(&w->power_list, &pending);
985 break;
986 }
987
988 if (ret < 0)
989 dev_err(w->dapm->dev,
990 "Failed to apply widget power: %d\n", ret);
991 }
992
993 if (!list_empty(&pending))
994 dapm_seq_run_coalesced(cur_dapm, &pending);
995
996 if (cur_dapm && cur_dapm->seq_notifier) {
997 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
998 if (sort[i] == cur_sort)
999 cur_dapm->seq_notifier(cur_dapm,
1000 i, cur_subseq);
1001 }
1002 }
1003
1004 static void dapm_widget_update(struct snd_soc_dapm_context *dapm)
1005 {
1006 struct snd_soc_dapm_update *update = dapm->update;
1007 struct snd_soc_dapm_widget *w;
1008 int ret;
1009
1010 if (!update)
1011 return;
1012
1013 w = update->widget;
1014
1015 if (w->event &&
1016 (w->event_flags & SND_SOC_DAPM_PRE_REG)) {
1017 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_PRE_REG);
1018 if (ret != 0)
1019 pr_err("%s DAPM pre-event failed: %d\n",
1020 w->name, ret);
1021 }
1022
1023 ret = snd_soc_update_bits(w->codec, update->reg, update->mask,
1024 update->val);
1025 if (ret < 0)
1026 pr_err("%s DAPM update failed: %d\n", w->name, ret);
1027
1028 if (w->event &&
1029 (w->event_flags & SND_SOC_DAPM_POST_REG)) {
1030 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_POST_REG);
1031 if (ret != 0)
1032 pr_err("%s DAPM post-event failed: %d\n",
1033 w->name, ret);
1034 }
1035 }
1036
1037 /* Async callback run prior to DAPM sequences - brings to _PREPARE if
1038 * they're changing state.
1039 */
1040 static void dapm_pre_sequence_async(void *data, async_cookie_t cookie)
1041 {
1042 struct snd_soc_dapm_context *d = data;
1043 int ret;
1044
1045 if (d->dev_power && d->bias_level == SND_SOC_BIAS_OFF) {
1046 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
1047 if (ret != 0)
1048 dev_err(d->dev,
1049 "Failed to turn on bias: %d\n", ret);
1050 }
1051
1052 /* If we're changing to all on or all off then prepare */
1053 if ((d->dev_power && d->bias_level == SND_SOC_BIAS_STANDBY) ||
1054 (!d->dev_power && d->bias_level == SND_SOC_BIAS_ON)) {
1055 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_PREPARE);
1056 if (ret != 0)
1057 dev_err(d->dev,
1058 "Failed to prepare bias: %d\n", ret);
1059 }
1060 }
1061
1062 /* Async callback run prior to DAPM sequences - brings to their final
1063 * state.
1064 */
1065 static void dapm_post_sequence_async(void *data, async_cookie_t cookie)
1066 {
1067 struct snd_soc_dapm_context *d = data;
1068 int ret;
1069
1070 /* If we just powered the last thing off drop to standby bias */
1071 if (d->bias_level == SND_SOC_BIAS_PREPARE && !d->dev_power) {
1072 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
1073 if (ret != 0)
1074 dev_err(d->dev, "Failed to apply standby bias: %d\n",
1075 ret);
1076 }
1077
1078 /* If we're in standby and can support bias off then do that */
1079 if (d->bias_level == SND_SOC_BIAS_STANDBY && d->idle_bias_off) {
1080 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_OFF);
1081 if (ret != 0)
1082 dev_err(d->dev, "Failed to turn off bias: %d\n", ret);
1083 }
1084
1085 /* If we just powered up then move to active bias */
1086 if (d->bias_level == SND_SOC_BIAS_PREPARE && d->dev_power) {
1087 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_ON);
1088 if (ret != 0)
1089 dev_err(d->dev, "Failed to apply active bias: %d\n",
1090 ret);
1091 }
1092 }
1093
1094 /*
1095 * Scan each dapm widget for complete audio path.
1096 * A complete path is a route that has valid endpoints i.e.:-
1097 *
1098 * o DAC to output pin.
1099 * o Input Pin to ADC.
1100 * o Input pin to Output pin (bypass, sidetone)
1101 * o DAC to ADC (loopback).
1102 */
1103 static int dapm_power_widgets(struct snd_soc_dapm_context *dapm, int event)
1104 {
1105 struct snd_soc_card *card = dapm->card;
1106 struct snd_soc_dapm_widget *w;
1107 struct snd_soc_dapm_context *d;
1108 LIST_HEAD(up_list);
1109 LIST_HEAD(down_list);
1110 LIST_HEAD(async_domain);
1111 int power;
1112
1113 trace_snd_soc_dapm_start(card);
1114
1115 list_for_each_entry(d, &card->dapm_list, list)
1116 if (d->n_widgets || d->codec == NULL)
1117 d->dev_power = 0;
1118
1119 /* Check which widgets we need to power and store them in
1120 * lists indicating if they should be powered up or down.
1121 */
1122 list_for_each_entry(w, &card->widgets, list) {
1123 switch (w->id) {
1124 case snd_soc_dapm_pre:
1125 dapm_seq_insert(w, &down_list, false);
1126 break;
1127 case snd_soc_dapm_post:
1128 dapm_seq_insert(w, &up_list, true);
1129 break;
1130
1131 default:
1132 if (!w->power_check)
1133 continue;
1134
1135 if (!w->force)
1136 power = w->power_check(w);
1137 else
1138 power = 1;
1139 if (power)
1140 w->dapm->dev_power = 1;
1141
1142 if (w->power == power)
1143 continue;
1144
1145 trace_snd_soc_dapm_widget_power(w, power);
1146
1147 if (power)
1148 dapm_seq_insert(w, &up_list, true);
1149 else
1150 dapm_seq_insert(w, &down_list, false);
1151
1152 w->power = power;
1153 break;
1154 }
1155 }
1156
1157 /* If there are no DAPM widgets then try to figure out power from the
1158 * event type.
1159 */
1160 if (!dapm->n_widgets) {
1161 switch (event) {
1162 case SND_SOC_DAPM_STREAM_START:
1163 case SND_SOC_DAPM_STREAM_RESUME:
1164 dapm->dev_power = 1;
1165 break;
1166 case SND_SOC_DAPM_STREAM_STOP:
1167 dapm->dev_power = !!dapm->codec->active;
1168 break;
1169 case SND_SOC_DAPM_STREAM_SUSPEND:
1170 dapm->dev_power = 0;
1171 break;
1172 case SND_SOC_DAPM_STREAM_NOP:
1173 switch (dapm->bias_level) {
1174 case SND_SOC_BIAS_STANDBY:
1175 case SND_SOC_BIAS_OFF:
1176 dapm->dev_power = 0;
1177 break;
1178 default:
1179 dapm->dev_power = 1;
1180 break;
1181 }
1182 break;
1183 default:
1184 break;
1185 }
1186 }
1187
1188 /* Force all contexts in the card to the same bias state */
1189 power = 0;
1190 list_for_each_entry(d, &card->dapm_list, list)
1191 if (d->dev_power)
1192 power = 1;
1193 list_for_each_entry(d, &card->dapm_list, list)
1194 d->dev_power = power;
1195
1196
1197 /* Run all the bias changes in parallel */
1198 list_for_each_entry(d, &dapm->card->dapm_list, list)
1199 async_schedule_domain(dapm_pre_sequence_async, d,
1200 &async_domain);
1201 async_synchronize_full_domain(&async_domain);
1202
1203 /* Power down widgets first; try to avoid amplifying pops. */
1204 dapm_seq_run(dapm, &down_list, event, false);
1205
1206 dapm_widget_update(dapm);
1207
1208 /* Now power up. */
1209 dapm_seq_run(dapm, &up_list, event, true);
1210
1211 /* Run all the bias changes in parallel */
1212 list_for_each_entry(d, &dapm->card->dapm_list, list)
1213 async_schedule_domain(dapm_post_sequence_async, d,
1214 &async_domain);
1215 async_synchronize_full_domain(&async_domain);
1216
1217 pop_dbg(dapm->dev, card->pop_time,
1218 "DAPM sequencing finished, waiting %dms\n", card->pop_time);
1219 pop_wait(card->pop_time);
1220
1221 trace_snd_soc_dapm_done(card);
1222
1223 return 0;
1224 }
1225
1226 #ifdef CONFIG_DEBUG_FS
1227 static int dapm_widget_power_open_file(struct inode *inode, struct file *file)
1228 {
1229 file->private_data = inode->i_private;
1230 return 0;
1231 }
1232
1233 static ssize_t dapm_widget_power_read_file(struct file *file,
1234 char __user *user_buf,
1235 size_t count, loff_t *ppos)
1236 {
1237 struct snd_soc_dapm_widget *w = file->private_data;
1238 char *buf;
1239 int in, out;
1240 ssize_t ret;
1241 struct snd_soc_dapm_path *p = NULL;
1242
1243 buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
1244 if (!buf)
1245 return -ENOMEM;
1246
1247 in = is_connected_input_ep(w);
1248 dapm_clear_walk(w->dapm);
1249 out = is_connected_output_ep(w);
1250 dapm_clear_walk(w->dapm);
1251
1252 ret = snprintf(buf, PAGE_SIZE, "%s: %s in %d out %d",
1253 w->name, w->power ? "On" : "Off", in, out);
1254
1255 if (w->reg >= 0)
1256 ret += snprintf(buf + ret, PAGE_SIZE - ret,
1257 " - R%d(0x%x) bit %d",
1258 w->reg, w->reg, w->shift);
1259
1260 ret += snprintf(buf + ret, PAGE_SIZE - ret, "\n");
1261
1262 if (w->sname)
1263 ret += snprintf(buf + ret, PAGE_SIZE - ret, " stream %s %s\n",
1264 w->sname,
1265 w->active ? "active" : "inactive");
1266
1267 list_for_each_entry(p, &w->sources, list_sink) {
1268 if (p->connected && !p->connected(w, p->sink))
1269 continue;
1270
1271 if (p->connect)
1272 ret += snprintf(buf + ret, PAGE_SIZE - ret,
1273 " in \"%s\" \"%s\"\n",
1274 p->name ? p->name : "static",
1275 p->source->name);
1276 }
1277 list_for_each_entry(p, &w->sinks, list_source) {
1278 if (p->connected && !p->connected(w, p->sink))
1279 continue;
1280
1281 if (p->connect)
1282 ret += snprintf(buf + ret, PAGE_SIZE - ret,
1283 " out \"%s\" \"%s\"\n",
1284 p->name ? p->name : "static",
1285 p->sink->name);
1286 }
1287
1288 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
1289
1290 kfree(buf);
1291 return ret;
1292 }
1293
1294 static const struct file_operations dapm_widget_power_fops = {
1295 .open = dapm_widget_power_open_file,
1296 .read = dapm_widget_power_read_file,
1297 .llseek = default_llseek,
1298 };
1299
1300 static int dapm_bias_open_file(struct inode *inode, struct file *file)
1301 {
1302 file->private_data = inode->i_private;
1303 return 0;
1304 }
1305
1306 static ssize_t dapm_bias_read_file(struct file *file, char __user *user_buf,
1307 size_t count, loff_t *ppos)
1308 {
1309 struct snd_soc_dapm_context *dapm = file->private_data;
1310 char *level;
1311
1312 switch (dapm->bias_level) {
1313 case SND_SOC_BIAS_ON:
1314 level = "On\n";
1315 break;
1316 case SND_SOC_BIAS_PREPARE:
1317 level = "Prepare\n";
1318 break;
1319 case SND_SOC_BIAS_STANDBY:
1320 level = "Standby\n";
1321 break;
1322 case SND_SOC_BIAS_OFF:
1323 level = "Off\n";
1324 break;
1325 default:
1326 BUG();
1327 level = "Unknown\n";
1328 break;
1329 }
1330
1331 return simple_read_from_buffer(user_buf, count, ppos, level,
1332 strlen(level));
1333 }
1334
1335 static const struct file_operations dapm_bias_fops = {
1336 .open = dapm_bias_open_file,
1337 .read = dapm_bias_read_file,
1338 .llseek = default_llseek,
1339 };
1340
1341 void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
1342 struct dentry *parent)
1343 {
1344 struct dentry *d;
1345
1346 dapm->debugfs_dapm = debugfs_create_dir("dapm", parent);
1347
1348 if (!dapm->debugfs_dapm) {
1349 printk(KERN_WARNING
1350 "Failed to create DAPM debugfs directory\n");
1351 return;
1352 }
1353
1354 d = debugfs_create_file("bias_level", 0444,
1355 dapm->debugfs_dapm, dapm,
1356 &dapm_bias_fops);
1357 if (!d)
1358 dev_warn(dapm->dev,
1359 "ASoC: Failed to create bias level debugfs file\n");
1360 }
1361
1362 static void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
1363 {
1364 struct snd_soc_dapm_context *dapm = w->dapm;
1365 struct dentry *d;
1366
1367 if (!dapm->debugfs_dapm || !w->name)
1368 return;
1369
1370 d = debugfs_create_file(w->name, 0444,
1371 dapm->debugfs_dapm, w,
1372 &dapm_widget_power_fops);
1373 if (!d)
1374 dev_warn(w->dapm->dev,
1375 "ASoC: Failed to create %s debugfs file\n",
1376 w->name);
1377 }
1378
1379 static void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
1380 {
1381 debugfs_remove_recursive(dapm->debugfs_dapm);
1382 }
1383
1384 #else
1385 void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
1386 struct dentry *parent)
1387 {
1388 }
1389
1390 static inline void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
1391 {
1392 }
1393
1394 static inline void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
1395 {
1396 }
1397
1398 #endif
1399
1400 /* test and update the power status of a mux widget */
1401 static int dapm_mux_update_power(struct snd_soc_dapm_widget *widget,
1402 struct snd_kcontrol *kcontrol, int change,
1403 int mux, struct soc_enum *e)
1404 {
1405 struct snd_soc_dapm_path *path;
1406 int found = 0;
1407
1408 if (widget->id != snd_soc_dapm_mux &&
1409 widget->id != snd_soc_dapm_virt_mux &&
1410 widget->id != snd_soc_dapm_value_mux)
1411 return -ENODEV;
1412
1413 if (!change)
1414 return 0;
1415
1416 /* find dapm widget path assoc with kcontrol */
1417 list_for_each_entry(path, &widget->dapm->card->paths, list) {
1418 if (path->kcontrol != kcontrol)
1419 continue;
1420
1421 if (!path->name || !e->texts[mux])
1422 continue;
1423
1424 found = 1;
1425 /* we now need to match the string in the enum to the path */
1426 if (!(strcmp(path->name, e->texts[mux])))
1427 path->connect = 1; /* new connection */
1428 else
1429 path->connect = 0; /* old connection must be powered down */
1430 }
1431
1432 if (found)
1433 dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
1434
1435 return 0;
1436 }
1437
1438 /* test and update the power status of a mixer or switch widget */
1439 static int dapm_mixer_update_power(struct snd_soc_dapm_widget *widget,
1440 struct snd_kcontrol *kcontrol, int connect)
1441 {
1442 struct snd_soc_dapm_path *path;
1443 int found = 0;
1444
1445 if (widget->id != snd_soc_dapm_mixer &&
1446 widget->id != snd_soc_dapm_mixer_named_ctl &&
1447 widget->id != snd_soc_dapm_switch)
1448 return -ENODEV;
1449
1450 /* find dapm widget path assoc with kcontrol */
1451 list_for_each_entry(path, &widget->dapm->card->paths, list) {
1452 if (path->kcontrol != kcontrol)
1453 continue;
1454
1455 /* found, now check type */
1456 found = 1;
1457 path->connect = connect;
1458 break;
1459 }
1460
1461 if (found)
1462 dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
1463
1464 return 0;
1465 }
1466
1467 /* show dapm widget status in sys fs */
1468 static ssize_t dapm_widget_show(struct device *dev,
1469 struct device_attribute *attr, char *buf)
1470 {
1471 struct snd_soc_pcm_runtime *rtd =
1472 container_of(dev, struct snd_soc_pcm_runtime, dev);
1473 struct snd_soc_codec *codec =rtd->codec;
1474 struct snd_soc_dapm_widget *w;
1475 int count = 0;
1476 char *state = "not set";
1477
1478 list_for_each_entry(w, &codec->card->widgets, list) {
1479 if (w->dapm != &codec->dapm)
1480 continue;
1481
1482 /* only display widgets that burnm power */
1483 switch (w->id) {
1484 case snd_soc_dapm_hp:
1485 case snd_soc_dapm_mic:
1486 case snd_soc_dapm_spk:
1487 case snd_soc_dapm_line:
1488 case snd_soc_dapm_micbias:
1489 case snd_soc_dapm_dac:
1490 case snd_soc_dapm_adc:
1491 case snd_soc_dapm_pga:
1492 case snd_soc_dapm_out_drv:
1493 case snd_soc_dapm_mixer:
1494 case snd_soc_dapm_mixer_named_ctl:
1495 case snd_soc_dapm_supply:
1496 if (w->name)
1497 count += sprintf(buf + count, "%s: %s\n",
1498 w->name, w->power ? "On":"Off");
1499 break;
1500 default:
1501 break;
1502 }
1503 }
1504
1505 switch (codec->dapm.bias_level) {
1506 case SND_SOC_BIAS_ON:
1507 state = "On";
1508 break;
1509 case SND_SOC_BIAS_PREPARE:
1510 state = "Prepare";
1511 break;
1512 case SND_SOC_BIAS_STANDBY:
1513 state = "Standby";
1514 break;
1515 case SND_SOC_BIAS_OFF:
1516 state = "Off";
1517 break;
1518 }
1519 count += sprintf(buf + count, "PM State: %s\n", state);
1520
1521 return count;
1522 }
1523
1524 static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL);
1525
1526 int snd_soc_dapm_sys_add(struct device *dev)
1527 {
1528 return device_create_file(dev, &dev_attr_dapm_widget);
1529 }
1530
1531 static void snd_soc_dapm_sys_remove(struct device *dev)
1532 {
1533 device_remove_file(dev, &dev_attr_dapm_widget);
1534 }
1535
1536 /* free all dapm widgets and resources */
1537 static void dapm_free_widgets(struct snd_soc_dapm_context *dapm)
1538 {
1539 struct snd_soc_dapm_widget *w, *next_w;
1540 struct snd_soc_dapm_path *p, *next_p;
1541
1542 list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) {
1543 if (w->dapm != dapm)
1544 continue;
1545 list_del(&w->list);
1546 /*
1547 * remove source and sink paths associated to this widget.
1548 * While removing the path, remove reference to it from both
1549 * source and sink widgets so that path is removed only once.
1550 */
1551 list_for_each_entry_safe(p, next_p, &w->sources, list_sink) {
1552 list_del(&p->list_sink);
1553 list_del(&p->list_source);
1554 list_del(&p->list);
1555 kfree(p->long_name);
1556 kfree(p);
1557 }
1558 list_for_each_entry_safe(p, next_p, &w->sinks, list_source) {
1559 list_del(&p->list_sink);
1560 list_del(&p->list_source);
1561 list_del(&p->list);
1562 kfree(p->long_name);
1563 kfree(p);
1564 }
1565 kfree(w->kcontrols);
1566 kfree(w->name);
1567 kfree(w);
1568 }
1569 }
1570
1571 static struct snd_soc_dapm_widget *dapm_find_widget(
1572 struct snd_soc_dapm_context *dapm, const char *pin,
1573 bool search_other_contexts)
1574 {
1575 struct snd_soc_dapm_widget *w;
1576 struct snd_soc_dapm_widget *fallback = NULL;
1577
1578 list_for_each_entry(w, &dapm->card->widgets, list) {
1579 if (!strcmp(w->name, pin)) {
1580 if (w->dapm == dapm)
1581 return w;
1582 else
1583 fallback = w;
1584 }
1585 }
1586
1587 if (search_other_contexts)
1588 return fallback;
1589
1590 return NULL;
1591 }
1592
1593 static int snd_soc_dapm_set_pin(struct snd_soc_dapm_context *dapm,
1594 const char *pin, int status)
1595 {
1596 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
1597
1598 if (!w) {
1599 dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
1600 return -EINVAL;
1601 }
1602
1603 w->connected = status;
1604 if (status == 0)
1605 w->force = 0;
1606
1607 return 0;
1608 }
1609
1610 /**
1611 * snd_soc_dapm_sync - scan and power dapm paths
1612 * @dapm: DAPM context
1613 *
1614 * Walks all dapm audio paths and powers widgets according to their
1615 * stream or path usage.
1616 *
1617 * Returns 0 for success.
1618 */
1619 int snd_soc_dapm_sync(struct snd_soc_dapm_context *dapm)
1620 {
1621 return dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
1622 }
1623 EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
1624
1625 static int snd_soc_dapm_add_route(struct snd_soc_dapm_context *dapm,
1626 const struct snd_soc_dapm_route *route)
1627 {
1628 struct snd_soc_dapm_path *path;
1629 struct snd_soc_dapm_widget *wsource = NULL, *wsink = NULL, *w;
1630 struct snd_soc_dapm_widget *wtsource = NULL, *wtsink = NULL;
1631 const char *sink;
1632 const char *control = route->control;
1633 const char *source;
1634 char prefixed_sink[80];
1635 char prefixed_source[80];
1636 int ret = 0;
1637
1638 if (dapm->codec && dapm->codec->name_prefix) {
1639 snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
1640 dapm->codec->name_prefix, route->sink);
1641 sink = prefixed_sink;
1642 snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
1643 dapm->codec->name_prefix, route->source);
1644 source = prefixed_source;
1645 } else {
1646 sink = route->sink;
1647 source = route->source;
1648 }
1649
1650 /*
1651 * find src and dest widgets over all widgets but favor a widget from
1652 * current DAPM context
1653 */
1654 list_for_each_entry(w, &dapm->card->widgets, list) {
1655 if (!wsink && !(strcmp(w->name, sink))) {
1656 wtsink = w;
1657 if (w->dapm == dapm)
1658 wsink = w;
1659 continue;
1660 }
1661 if (!wsource && !(strcmp(w->name, source))) {
1662 wtsource = w;
1663 if (w->dapm == dapm)
1664 wsource = w;
1665 }
1666 }
1667 /* use widget from another DAPM context if not found from this */
1668 if (!wsink)
1669 wsink = wtsink;
1670 if (!wsource)
1671 wsource = wtsource;
1672
1673 if (wsource == NULL || wsink == NULL)
1674 return -ENODEV;
1675
1676 path = kzalloc(sizeof(struct snd_soc_dapm_path), GFP_KERNEL);
1677 if (!path)
1678 return -ENOMEM;
1679
1680 path->source = wsource;
1681 path->sink = wsink;
1682 path->connected = route->connected;
1683 INIT_LIST_HEAD(&path->list);
1684 INIT_LIST_HEAD(&path->list_source);
1685 INIT_LIST_HEAD(&path->list_sink);
1686
1687 /* check for external widgets */
1688 if (wsink->id == snd_soc_dapm_input) {
1689 if (wsource->id == snd_soc_dapm_micbias ||
1690 wsource->id == snd_soc_dapm_mic ||
1691 wsource->id == snd_soc_dapm_line ||
1692 wsource->id == snd_soc_dapm_output)
1693 wsink->ext = 1;
1694 }
1695 if (wsource->id == snd_soc_dapm_output) {
1696 if (wsink->id == snd_soc_dapm_spk ||
1697 wsink->id == snd_soc_dapm_hp ||
1698 wsink->id == snd_soc_dapm_line ||
1699 wsink->id == snd_soc_dapm_input)
1700 wsource->ext = 1;
1701 }
1702
1703 /* connect static paths */
1704 if (control == NULL) {
1705 list_add(&path->list, &dapm->card->paths);
1706 list_add(&path->list_sink, &wsink->sources);
1707 list_add(&path->list_source, &wsource->sinks);
1708 path->connect = 1;
1709 return 0;
1710 }
1711
1712 /* connect dynamic paths */
1713 switch (wsink->id) {
1714 case snd_soc_dapm_adc:
1715 case snd_soc_dapm_dac:
1716 case snd_soc_dapm_pga:
1717 case snd_soc_dapm_out_drv:
1718 case snd_soc_dapm_input:
1719 case snd_soc_dapm_output:
1720 case snd_soc_dapm_micbias:
1721 case snd_soc_dapm_vmid:
1722 case snd_soc_dapm_pre:
1723 case snd_soc_dapm_post:
1724 case snd_soc_dapm_supply:
1725 case snd_soc_dapm_aif_in:
1726 case snd_soc_dapm_aif_out:
1727 list_add(&path->list, &dapm->card->paths);
1728 list_add(&path->list_sink, &wsink->sources);
1729 list_add(&path->list_source, &wsource->sinks);
1730 path->connect = 1;
1731 return 0;
1732 case snd_soc_dapm_mux:
1733 case snd_soc_dapm_virt_mux:
1734 case snd_soc_dapm_value_mux:
1735 ret = dapm_connect_mux(dapm, wsource, wsink, path, control,
1736 &wsink->kcontrol_news[0]);
1737 if (ret != 0)
1738 goto err;
1739 break;
1740 case snd_soc_dapm_switch:
1741 case snd_soc_dapm_mixer:
1742 case snd_soc_dapm_mixer_named_ctl:
1743 ret = dapm_connect_mixer(dapm, wsource, wsink, path, control);
1744 if (ret != 0)
1745 goto err;
1746 break;
1747 case snd_soc_dapm_hp:
1748 case snd_soc_dapm_mic:
1749 case snd_soc_dapm_line:
1750 case snd_soc_dapm_spk:
1751 list_add(&path->list, &dapm->card->paths);
1752 list_add(&path->list_sink, &wsink->sources);
1753 list_add(&path->list_source, &wsource->sinks);
1754 path->connect = 0;
1755 return 0;
1756 }
1757 return 0;
1758
1759 err:
1760 dev_warn(dapm->dev, "asoc: no dapm match for %s --> %s --> %s\n",
1761 source, control, sink);
1762 kfree(path);
1763 return ret;
1764 }
1765
1766 /**
1767 * snd_soc_dapm_add_routes - Add routes between DAPM widgets
1768 * @dapm: DAPM context
1769 * @route: audio routes
1770 * @num: number of routes
1771 *
1772 * Connects 2 dapm widgets together via a named audio path. The sink is
1773 * the widget receiving the audio signal, whilst the source is the sender
1774 * of the audio signal.
1775 *
1776 * Returns 0 for success else error. On error all resources can be freed
1777 * with a call to snd_soc_card_free().
1778 */
1779 int snd_soc_dapm_add_routes(struct snd_soc_dapm_context *dapm,
1780 const struct snd_soc_dapm_route *route, int num)
1781 {
1782 int i, ret;
1783
1784 for (i = 0; i < num; i++) {
1785 ret = snd_soc_dapm_add_route(dapm, route);
1786 if (ret < 0) {
1787 dev_err(dapm->dev, "Failed to add route %s->%s\n",
1788 route->source, route->sink);
1789 return ret;
1790 }
1791 route++;
1792 }
1793
1794 return 0;
1795 }
1796 EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);
1797
1798 /**
1799 * snd_soc_dapm_new_widgets - add new dapm widgets
1800 * @dapm: DAPM context
1801 *
1802 * Checks the codec for any new dapm widgets and creates them if found.
1803 *
1804 * Returns 0 for success.
1805 */
1806 int snd_soc_dapm_new_widgets(struct snd_soc_dapm_context *dapm)
1807 {
1808 struct snd_soc_dapm_widget *w;
1809 unsigned int val;
1810
1811 list_for_each_entry(w, &dapm->card->widgets, list)
1812 {
1813 if (w->new)
1814 continue;
1815
1816 if (w->num_kcontrols) {
1817 w->kcontrols = kzalloc(w->num_kcontrols *
1818 sizeof(struct snd_kcontrol *),
1819 GFP_KERNEL);
1820 if (!w->kcontrols)
1821 return -ENOMEM;
1822 }
1823
1824 switch(w->id) {
1825 case snd_soc_dapm_switch:
1826 case snd_soc_dapm_mixer:
1827 case snd_soc_dapm_mixer_named_ctl:
1828 w->power_check = dapm_generic_check_power;
1829 dapm_new_mixer(dapm, w);
1830 break;
1831 case snd_soc_dapm_mux:
1832 case snd_soc_dapm_virt_mux:
1833 case snd_soc_dapm_value_mux:
1834 w->power_check = dapm_generic_check_power;
1835 dapm_new_mux(dapm, w);
1836 break;
1837 case snd_soc_dapm_adc:
1838 case snd_soc_dapm_aif_out:
1839 w->power_check = dapm_adc_check_power;
1840 break;
1841 case snd_soc_dapm_dac:
1842 case snd_soc_dapm_aif_in:
1843 w->power_check = dapm_dac_check_power;
1844 break;
1845 case snd_soc_dapm_pga:
1846 case snd_soc_dapm_out_drv:
1847 w->power_check = dapm_generic_check_power;
1848 dapm_new_pga(dapm, w);
1849 break;
1850 case snd_soc_dapm_input:
1851 case snd_soc_dapm_output:
1852 case snd_soc_dapm_micbias:
1853 case snd_soc_dapm_spk:
1854 case snd_soc_dapm_hp:
1855 case snd_soc_dapm_mic:
1856 case snd_soc_dapm_line:
1857 w->power_check = dapm_generic_check_power;
1858 break;
1859 case snd_soc_dapm_supply:
1860 w->power_check = dapm_supply_check_power;
1861 case snd_soc_dapm_vmid:
1862 case snd_soc_dapm_pre:
1863 case snd_soc_dapm_post:
1864 break;
1865 }
1866
1867 /* Read the initial power state from the device */
1868 if (w->reg >= 0) {
1869 val = snd_soc_read(w->codec, w->reg);
1870 val &= 1 << w->shift;
1871 if (w->invert)
1872 val = !val;
1873
1874 if (val)
1875 w->power = 1;
1876 }
1877
1878 w->new = 1;
1879
1880 dapm_debugfs_add_widget(w);
1881 }
1882
1883 dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
1884 return 0;
1885 }
1886 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_widgets);
1887
1888 /**
1889 * snd_soc_dapm_get_volsw - dapm mixer get callback
1890 * @kcontrol: mixer control
1891 * @ucontrol: control element information
1892 *
1893 * Callback to get the value of a dapm mixer control.
1894 *
1895 * Returns 0 for success.
1896 */
1897 int snd_soc_dapm_get_volsw(struct snd_kcontrol *kcontrol,
1898 struct snd_ctl_elem_value *ucontrol)
1899 {
1900 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
1901 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
1902 struct soc_mixer_control *mc =
1903 (struct soc_mixer_control *)kcontrol->private_value;
1904 unsigned int reg = mc->reg;
1905 unsigned int shift = mc->shift;
1906 unsigned int rshift = mc->rshift;
1907 int max = mc->max;
1908 unsigned int invert = mc->invert;
1909 unsigned int mask = (1 << fls(max)) - 1;
1910
1911 ucontrol->value.integer.value[0] =
1912 (snd_soc_read(widget->codec, reg) >> shift) & mask;
1913 if (shift != rshift)
1914 ucontrol->value.integer.value[1] =
1915 (snd_soc_read(widget->codec, reg) >> rshift) & mask;
1916 if (invert) {
1917 ucontrol->value.integer.value[0] =
1918 max - ucontrol->value.integer.value[0];
1919 if (shift != rshift)
1920 ucontrol->value.integer.value[1] =
1921 max - ucontrol->value.integer.value[1];
1922 }
1923
1924 return 0;
1925 }
1926 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);
1927
1928 /**
1929 * snd_soc_dapm_put_volsw - dapm mixer set callback
1930 * @kcontrol: mixer control
1931 * @ucontrol: control element information
1932 *
1933 * Callback to set the value of a dapm mixer control.
1934 *
1935 * Returns 0 for success.
1936 */
1937 int snd_soc_dapm_put_volsw(struct snd_kcontrol *kcontrol,
1938 struct snd_ctl_elem_value *ucontrol)
1939 {
1940 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
1941 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
1942 struct snd_soc_codec *codec = widget->codec;
1943 struct soc_mixer_control *mc =
1944 (struct soc_mixer_control *)kcontrol->private_value;
1945 unsigned int reg = mc->reg;
1946 unsigned int shift = mc->shift;
1947 int max = mc->max;
1948 unsigned int mask = (1 << fls(max)) - 1;
1949 unsigned int invert = mc->invert;
1950 unsigned int val;
1951 int connect, change;
1952 struct snd_soc_dapm_update update;
1953 int wi;
1954
1955 val = (ucontrol->value.integer.value[0] & mask);
1956
1957 if (invert)
1958 val = max - val;
1959 mask = mask << shift;
1960 val = val << shift;
1961
1962 if (val)
1963 /* new connection */
1964 connect = invert ? 0 : 1;
1965 else
1966 /* old connection must be powered down */
1967 connect = invert ? 1 : 0;
1968
1969 mutex_lock(&codec->mutex);
1970
1971 change = snd_soc_test_bits(widget->codec, reg, mask, val);
1972 if (change) {
1973 for (wi = 0; wi < wlist->num_widgets; wi++) {
1974 widget = wlist->widgets[wi];
1975
1976 widget->value = val;
1977
1978 update.kcontrol = kcontrol;
1979 update.widget = widget;
1980 update.reg = reg;
1981 update.mask = mask;
1982 update.val = val;
1983 widget->dapm->update = &update;
1984
1985 dapm_mixer_update_power(widget, kcontrol, connect);
1986
1987 widget->dapm->update = NULL;
1988 }
1989 }
1990
1991 mutex_unlock(&codec->mutex);
1992 return 0;
1993 }
1994 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_volsw);
1995
1996 /**
1997 * snd_soc_dapm_get_enum_double - dapm enumerated double mixer get callback
1998 * @kcontrol: mixer control
1999 * @ucontrol: control element information
2000 *
2001 * Callback to get the value of a dapm enumerated double mixer control.
2002 *
2003 * Returns 0 for success.
2004 */
2005 int snd_soc_dapm_get_enum_double(struct snd_kcontrol *kcontrol,
2006 struct snd_ctl_elem_value *ucontrol)
2007 {
2008 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2009 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2010 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2011 unsigned int val, bitmask;
2012
2013 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2014 ;
2015 val = snd_soc_read(widget->codec, e->reg);
2016 ucontrol->value.enumerated.item[0] = (val >> e->shift_l) & (bitmask - 1);
2017 if (e->shift_l != e->shift_r)
2018 ucontrol->value.enumerated.item[1] =
2019 (val >> e->shift_r) & (bitmask - 1);
2020
2021 return 0;
2022 }
2023 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);
2024
2025 /**
2026 * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
2027 * @kcontrol: mixer control
2028 * @ucontrol: control element information
2029 *
2030 * Callback to set the value of a dapm enumerated double mixer control.
2031 *
2032 * Returns 0 for success.
2033 */
2034 int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
2035 struct snd_ctl_elem_value *ucontrol)
2036 {
2037 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2038 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2039 struct snd_soc_codec *codec = widget->codec;
2040 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2041 unsigned int val, mux, change;
2042 unsigned int mask, bitmask;
2043 struct snd_soc_dapm_update update;
2044 int wi;
2045
2046 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2047 ;
2048 if (ucontrol->value.enumerated.item[0] > e->max - 1)
2049 return -EINVAL;
2050 mux = ucontrol->value.enumerated.item[0];
2051 val = mux << e->shift_l;
2052 mask = (bitmask - 1) << e->shift_l;
2053 if (e->shift_l != e->shift_r) {
2054 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2055 return -EINVAL;
2056 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
2057 mask |= (bitmask - 1) << e->shift_r;
2058 }
2059
2060 mutex_lock(&codec->mutex);
2061
2062 change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
2063 if (change) {
2064 for (wi = 0; wi < wlist->num_widgets; wi++) {
2065 widget = wlist->widgets[wi];
2066
2067 widget->value = val;
2068
2069 update.kcontrol = kcontrol;
2070 update.widget = widget;
2071 update.reg = e->reg;
2072 update.mask = mask;
2073 update.val = val;
2074 widget->dapm->update = &update;
2075
2076 dapm_mux_update_power(widget, kcontrol, change, mux, e);
2077
2078 widget->dapm->update = NULL;
2079 }
2080 }
2081
2082 mutex_unlock(&codec->mutex);
2083 return change;
2084 }
2085 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);
2086
2087 /**
2088 * snd_soc_dapm_get_enum_virt - Get virtual DAPM mux
2089 * @kcontrol: mixer control
2090 * @ucontrol: control element information
2091 *
2092 * Returns 0 for success.
2093 */
2094 int snd_soc_dapm_get_enum_virt(struct snd_kcontrol *kcontrol,
2095 struct snd_ctl_elem_value *ucontrol)
2096 {
2097 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2098 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2099
2100 ucontrol->value.enumerated.item[0] = widget->value;
2101
2102 return 0;
2103 }
2104 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_virt);
2105
2106 /**
2107 * snd_soc_dapm_put_enum_virt - Set virtual DAPM mux
2108 * @kcontrol: mixer control
2109 * @ucontrol: control element information
2110 *
2111 * Returns 0 for success.
2112 */
2113 int snd_soc_dapm_put_enum_virt(struct snd_kcontrol *kcontrol,
2114 struct snd_ctl_elem_value *ucontrol)
2115 {
2116 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2117 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2118 struct snd_soc_codec *codec = widget->codec;
2119 struct soc_enum *e =
2120 (struct soc_enum *)kcontrol->private_value;
2121 int change;
2122 int ret = 0;
2123 int wi;
2124
2125 if (ucontrol->value.enumerated.item[0] >= e->max)
2126 return -EINVAL;
2127
2128 mutex_lock(&codec->mutex);
2129
2130 change = widget->value != ucontrol->value.enumerated.item[0];
2131 if (change) {
2132 for (wi = 0; wi < wlist->num_widgets; wi++) {
2133 widget = wlist->widgets[wi];
2134
2135 widget->value = ucontrol->value.enumerated.item[0];
2136
2137 dapm_mux_update_power(widget, kcontrol, change,
2138 widget->value, e);
2139 }
2140 }
2141
2142 mutex_unlock(&codec->mutex);
2143 return ret;
2144 }
2145 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_virt);
2146
2147 /**
2148 * snd_soc_dapm_get_value_enum_double - dapm semi enumerated double mixer get
2149 * callback
2150 * @kcontrol: mixer control
2151 * @ucontrol: control element information
2152 *
2153 * Callback to get the value of a dapm semi enumerated double mixer control.
2154 *
2155 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2156 * used for handling bitfield coded enumeration for example.
2157 *
2158 * Returns 0 for success.
2159 */
2160 int snd_soc_dapm_get_value_enum_double(struct snd_kcontrol *kcontrol,
2161 struct snd_ctl_elem_value *ucontrol)
2162 {
2163 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2164 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2165 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2166 unsigned int reg_val, val, mux;
2167
2168 reg_val = snd_soc_read(widget->codec, e->reg);
2169 val = (reg_val >> e->shift_l) & e->mask;
2170 for (mux = 0; mux < e->max; mux++) {
2171 if (val == e->values[mux])
2172 break;
2173 }
2174 ucontrol->value.enumerated.item[0] = mux;
2175 if (e->shift_l != e->shift_r) {
2176 val = (reg_val >> e->shift_r) & e->mask;
2177 for (mux = 0; mux < e->max; mux++) {
2178 if (val == e->values[mux])
2179 break;
2180 }
2181 ucontrol->value.enumerated.item[1] = mux;
2182 }
2183
2184 return 0;
2185 }
2186 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_value_enum_double);
2187
2188 /**
2189 * snd_soc_dapm_put_value_enum_double - dapm semi enumerated double mixer set
2190 * callback
2191 * @kcontrol: mixer control
2192 * @ucontrol: control element information
2193 *
2194 * Callback to set the value of a dapm semi enumerated double mixer control.
2195 *
2196 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2197 * used for handling bitfield coded enumeration for example.
2198 *
2199 * Returns 0 for success.
2200 */
2201 int snd_soc_dapm_put_value_enum_double(struct snd_kcontrol *kcontrol,
2202 struct snd_ctl_elem_value *ucontrol)
2203 {
2204 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2205 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2206 struct snd_soc_codec *codec = widget->codec;
2207 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2208 unsigned int val, mux, change;
2209 unsigned int mask;
2210 struct snd_soc_dapm_update update;
2211 int wi;
2212
2213 if (ucontrol->value.enumerated.item[0] > e->max - 1)
2214 return -EINVAL;
2215 mux = ucontrol->value.enumerated.item[0];
2216 val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
2217 mask = e->mask << e->shift_l;
2218 if (e->shift_l != e->shift_r) {
2219 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2220 return -EINVAL;
2221 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
2222 mask |= e->mask << e->shift_r;
2223 }
2224
2225 mutex_lock(&codec->mutex);
2226
2227 change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
2228 if (change) {
2229 for (wi = 0; wi < wlist->num_widgets; wi++) {
2230 widget = wlist->widgets[wi];
2231
2232 widget->value = val;
2233
2234 update.kcontrol = kcontrol;
2235 update.widget = widget;
2236 update.reg = e->reg;
2237 update.mask = mask;
2238 update.val = val;
2239 widget->dapm->update = &update;
2240
2241 dapm_mux_update_power(widget, kcontrol, change, mux, e);
2242
2243 widget->dapm->update = NULL;
2244 }
2245 }
2246
2247 mutex_unlock(&codec->mutex);
2248 return change;
2249 }
2250 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_value_enum_double);
2251
2252 /**
2253 * snd_soc_dapm_info_pin_switch - Info for a pin switch
2254 *
2255 * @kcontrol: mixer control
2256 * @uinfo: control element information
2257 *
2258 * Callback to provide information about a pin switch control.
2259 */
2260 int snd_soc_dapm_info_pin_switch(struct snd_kcontrol *kcontrol,
2261 struct snd_ctl_elem_info *uinfo)
2262 {
2263 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2264 uinfo->count = 1;
2265 uinfo->value.integer.min = 0;
2266 uinfo->value.integer.max = 1;
2267
2268 return 0;
2269 }
2270 EXPORT_SYMBOL_GPL(snd_soc_dapm_info_pin_switch);
2271
2272 /**
2273 * snd_soc_dapm_get_pin_switch - Get information for a pin switch
2274 *
2275 * @kcontrol: mixer control
2276 * @ucontrol: Value
2277 */
2278 int snd_soc_dapm_get_pin_switch(struct snd_kcontrol *kcontrol,
2279 struct snd_ctl_elem_value *ucontrol)
2280 {
2281 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2282 const char *pin = (const char *)kcontrol->private_value;
2283
2284 mutex_lock(&codec->mutex);
2285
2286 ucontrol->value.integer.value[0] =
2287 snd_soc_dapm_get_pin_status(&codec->dapm, pin);
2288
2289 mutex_unlock(&codec->mutex);
2290
2291 return 0;
2292 }
2293 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_switch);
2294
2295 /**
2296 * snd_soc_dapm_put_pin_switch - Set information for a pin switch
2297 *
2298 * @kcontrol: mixer control
2299 * @ucontrol: Value
2300 */
2301 int snd_soc_dapm_put_pin_switch(struct snd_kcontrol *kcontrol,
2302 struct snd_ctl_elem_value *ucontrol)
2303 {
2304 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2305 const char *pin = (const char *)kcontrol->private_value;
2306
2307 mutex_lock(&codec->mutex);
2308
2309 if (ucontrol->value.integer.value[0])
2310 snd_soc_dapm_enable_pin(&codec->dapm, pin);
2311 else
2312 snd_soc_dapm_disable_pin(&codec->dapm, pin);
2313
2314 snd_soc_dapm_sync(&codec->dapm);
2315
2316 mutex_unlock(&codec->mutex);
2317
2318 return 0;
2319 }
2320 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);
2321
2322 /**
2323 * snd_soc_dapm_new_control - create new dapm control
2324 * @dapm: DAPM context
2325 * @widget: widget template
2326 *
2327 * Creates a new dapm control based upon the template.
2328 *
2329 * Returns 0 for success else error.
2330 */
2331 int snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
2332 const struct snd_soc_dapm_widget *widget)
2333 {
2334 struct snd_soc_dapm_widget *w;
2335 size_t name_len;
2336
2337 if ((w = dapm_cnew_widget(widget)) == NULL)
2338 return -ENOMEM;
2339
2340 name_len = strlen(widget->name) + 1;
2341 if (dapm->codec && dapm->codec->name_prefix)
2342 name_len += 1 + strlen(dapm->codec->name_prefix);
2343 w->name = kmalloc(name_len, GFP_KERNEL);
2344 if (w->name == NULL) {
2345 kfree(w);
2346 return -ENOMEM;
2347 }
2348 if (dapm->codec && dapm->codec->name_prefix)
2349 snprintf(w->name, name_len, "%s %s",
2350 dapm->codec->name_prefix, widget->name);
2351 else
2352 snprintf(w->name, name_len, "%s", widget->name);
2353
2354 dapm->n_widgets++;
2355 w->dapm = dapm;
2356 w->codec = dapm->codec;
2357 INIT_LIST_HEAD(&w->sources);
2358 INIT_LIST_HEAD(&w->sinks);
2359 INIT_LIST_HEAD(&w->list);
2360 list_add(&w->list, &dapm->card->widgets);
2361
2362 /* machine layer set ups unconnected pins and insertions */
2363 w->connected = 1;
2364 return 0;
2365 }
2366 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_control);
2367
2368 /**
2369 * snd_soc_dapm_new_controls - create new dapm controls
2370 * @dapm: DAPM context
2371 * @widget: widget array
2372 * @num: number of widgets
2373 *
2374 * Creates new DAPM controls based upon the templates.
2375 *
2376 * Returns 0 for success else error.
2377 */
2378 int snd_soc_dapm_new_controls(struct snd_soc_dapm_context *dapm,
2379 const struct snd_soc_dapm_widget *widget,
2380 int num)
2381 {
2382 int i, ret;
2383
2384 for (i = 0; i < num; i++) {
2385 ret = snd_soc_dapm_new_control(dapm, widget);
2386 if (ret < 0) {
2387 dev_err(dapm->dev,
2388 "ASoC: Failed to create DAPM control %s: %d\n",
2389 widget->name, ret);
2390 return ret;
2391 }
2392 widget++;
2393 }
2394 return 0;
2395 }
2396 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);
2397
2398 static void soc_dapm_stream_event(struct snd_soc_dapm_context *dapm,
2399 const char *stream, int event)
2400 {
2401 struct snd_soc_dapm_widget *w;
2402
2403 list_for_each_entry(w, &dapm->card->widgets, list)
2404 {
2405 if (!w->sname || w->dapm != dapm)
2406 continue;
2407 dev_dbg(w->dapm->dev, "widget %s\n %s stream %s event %d\n",
2408 w->name, w->sname, stream, event);
2409 if (strstr(w->sname, stream)) {
2410 switch(event) {
2411 case SND_SOC_DAPM_STREAM_START:
2412 w->active = 1;
2413 break;
2414 case SND_SOC_DAPM_STREAM_STOP:
2415 w->active = 0;
2416 break;
2417 case SND_SOC_DAPM_STREAM_SUSPEND:
2418 case SND_SOC_DAPM_STREAM_RESUME:
2419 case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
2420 case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
2421 break;
2422 }
2423 }
2424 }
2425
2426 dapm_power_widgets(dapm, event);
2427 }
2428
2429 /**
2430 * snd_soc_dapm_stream_event - send a stream event to the dapm core
2431 * @rtd: PCM runtime data
2432 * @stream: stream name
2433 * @event: stream event
2434 *
2435 * Sends a stream event to the dapm core. The core then makes any
2436 * necessary widget power changes.
2437 *
2438 * Returns 0 for success else error.
2439 */
2440 int snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd,
2441 const char *stream, int event)
2442 {
2443 struct snd_soc_codec *codec = rtd->codec;
2444
2445 if (stream == NULL)
2446 return 0;
2447
2448 mutex_lock(&codec->mutex);
2449 soc_dapm_stream_event(&codec->dapm, stream, event);
2450 mutex_unlock(&codec->mutex);
2451 return 0;
2452 }
2453
2454 /**
2455 * snd_soc_dapm_enable_pin - enable pin.
2456 * @dapm: DAPM context
2457 * @pin: pin name
2458 *
2459 * Enables input/output pin and its parents or children widgets iff there is
2460 * a valid audio route and active audio stream.
2461 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2462 * do any widget power switching.
2463 */
2464 int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin)
2465 {
2466 return snd_soc_dapm_set_pin(dapm, pin, 1);
2467 }
2468 EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
2469
2470 /**
2471 * snd_soc_dapm_force_enable_pin - force a pin to be enabled
2472 * @dapm: DAPM context
2473 * @pin: pin name
2474 *
2475 * Enables input/output pin regardless of any other state. This is
2476 * intended for use with microphone bias supplies used in microphone
2477 * jack detection.
2478 *
2479 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2480 * do any widget power switching.
2481 */
2482 int snd_soc_dapm_force_enable_pin(struct snd_soc_dapm_context *dapm,
2483 const char *pin)
2484 {
2485 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
2486
2487 if (!w) {
2488 dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
2489 return -EINVAL;
2490 }
2491
2492 dev_dbg(w->dapm->dev, "dapm: force enable pin %s\n", pin);
2493 w->connected = 1;
2494 w->force = 1;
2495
2496 return 0;
2497 }
2498 EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin);
2499
2500 /**
2501 * snd_soc_dapm_disable_pin - disable pin.
2502 * @dapm: DAPM context
2503 * @pin: pin name
2504 *
2505 * Disables input/output pin and its parents or children widgets.
2506 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2507 * do any widget power switching.
2508 */
2509 int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm,
2510 const char *pin)
2511 {
2512 return snd_soc_dapm_set_pin(dapm, pin, 0);
2513 }
2514 EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
2515
2516 /**
2517 * snd_soc_dapm_nc_pin - permanently disable pin.
2518 * @dapm: DAPM context
2519 * @pin: pin name
2520 *
2521 * Marks the specified pin as being not connected, disabling it along
2522 * any parent or child widgets. At present this is identical to
2523 * snd_soc_dapm_disable_pin() but in future it will be extended to do
2524 * additional things such as disabling controls which only affect
2525 * paths through the pin.
2526 *
2527 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2528 * do any widget power switching.
2529 */
2530 int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin)
2531 {
2532 return snd_soc_dapm_set_pin(dapm, pin, 0);
2533 }
2534 EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);
2535
2536 /**
2537 * snd_soc_dapm_get_pin_status - get audio pin status
2538 * @dapm: DAPM context
2539 * @pin: audio signal pin endpoint (or start point)
2540 *
2541 * Get audio pin status - connected or disconnected.
2542 *
2543 * Returns 1 for connected otherwise 0.
2544 */
2545 int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm,
2546 const char *pin)
2547 {
2548 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
2549
2550 if (w)
2551 return w->connected;
2552
2553 return 0;
2554 }
2555 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
2556
2557 /**
2558 * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint
2559 * @dapm: DAPM context
2560 * @pin: audio signal pin endpoint (or start point)
2561 *
2562 * Mark the given endpoint or pin as ignoring suspend. When the
2563 * system is disabled a path between two endpoints flagged as ignoring
2564 * suspend will not be disabled. The path must already be enabled via
2565 * normal means at suspend time, it will not be turned on if it was not
2566 * already enabled.
2567 */
2568 int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm,
2569 const char *pin)
2570 {
2571 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, false);
2572
2573 if (!w) {
2574 dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
2575 return -EINVAL;
2576 }
2577
2578 w->ignore_suspend = 1;
2579
2580 return 0;
2581 }
2582 EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend);
2583
2584 /**
2585 * snd_soc_dapm_free - free dapm resources
2586 * @card: SoC device
2587 *
2588 * Free all dapm widgets and resources.
2589 */
2590 void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm)
2591 {
2592 snd_soc_dapm_sys_remove(dapm->dev);
2593 dapm_debugfs_cleanup(dapm);
2594 dapm_free_widgets(dapm);
2595 list_del(&dapm->list);
2596 }
2597 EXPORT_SYMBOL_GPL(snd_soc_dapm_free);
2598
2599 static void soc_dapm_shutdown_codec(struct snd_soc_dapm_context *dapm)
2600 {
2601 struct snd_soc_dapm_widget *w;
2602 LIST_HEAD(down_list);
2603 int powerdown = 0;
2604
2605 list_for_each_entry(w, &dapm->card->widgets, list) {
2606 if (w->dapm != dapm)
2607 continue;
2608 if (w->power) {
2609 dapm_seq_insert(w, &down_list, false);
2610 w->power = 0;
2611 powerdown = 1;
2612 }
2613 }
2614
2615 /* If there were no widgets to power down we're already in
2616 * standby.
2617 */
2618 if (powerdown) {
2619 snd_soc_dapm_set_bias_level(dapm, SND_SOC_BIAS_PREPARE);
2620 dapm_seq_run(dapm, &down_list, 0, false);
2621 snd_soc_dapm_set_bias_level(dapm, SND_SOC_BIAS_STANDBY);
2622 }
2623 }
2624
2625 /*
2626 * snd_soc_dapm_shutdown - callback for system shutdown
2627 */
2628 void snd_soc_dapm_shutdown(struct snd_soc_card *card)
2629 {
2630 struct snd_soc_codec *codec;
2631
2632 list_for_each_entry(codec, &card->codec_dev_list, list) {
2633 soc_dapm_shutdown_codec(&codec->dapm);
2634 snd_soc_dapm_set_bias_level(&codec->dapm, SND_SOC_BIAS_OFF);
2635 }
2636 }
2637
2638 /* Module information */
2639 MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
2640 MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
2641 MODULE_LICENSE("GPL");
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree