]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blob - sound/soc/soc-dapm.c
projects / mirror_ubuntu-bionic-kernel.git / blob
? search:


784534dcc82d7b3c32a2fe81247c389721907ae8
[mirror_ubuntu-bionic-kernel.git] / sound / soc / soc-dapm.c
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/headphone 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 power down of audio subsystem to reduce pops between a quick
22 * device reopen.
23 *
24 */
25
26 #include <linux/module.h>
27 #include <linux/moduleparam.h>
28 #include <linux/init.h>
29 #include <linux/async.h>
30 #include <linux/delay.h>
31 #include <linux/pm.h>
32 #include <linux/bitops.h>
33 #include <linux/platform_device.h>
34 #include <linux/jiffies.h>
35 #include <linux/debugfs.h>
36 #include <linux/pm_runtime.h>
37 #include <linux/regulator/consumer.h>
38 #include <linux/clk.h>
39 #include <linux/slab.h>
40 #include <sound/core.h>
41 #include <sound/pcm.h>
42 #include <sound/pcm_params.h>
43 #include <sound/soc.h>
44 #include <sound/initval.h>
45
46 #include <trace/events/asoc.h>
47
48 #define DAPM_UPDATE_STAT(widget, val) widget->dapm->card->dapm_stats.val++;
49
50 /* dapm power sequences - make this per codec in the future */
51 static int dapm_up_seq[] = {
52 [snd_soc_dapm_pre] = 0,
53 [snd_soc_dapm_supply] = 1,
54 [snd_soc_dapm_regulator_supply] = 1,
55 [snd_soc_dapm_clock_supply] = 1,
56 [snd_soc_dapm_micbias] = 2,
57 [snd_soc_dapm_dai_link] = 2,
58 [snd_soc_dapm_dai] = 3,
59 [snd_soc_dapm_aif_in] = 3,
60 [snd_soc_dapm_aif_out] = 3,
61 [snd_soc_dapm_mic] = 4,
62 [snd_soc_dapm_mux] = 5,
63 [snd_soc_dapm_virt_mux] = 5,
64 [snd_soc_dapm_value_mux] = 5,
65 [snd_soc_dapm_dac] = 6,
66 [snd_soc_dapm_mixer] = 7,
67 [snd_soc_dapm_mixer_named_ctl] = 7,
68 [snd_soc_dapm_pga] = 8,
69 [snd_soc_dapm_adc] = 9,
70 [snd_soc_dapm_out_drv] = 10,
71 [snd_soc_dapm_hp] = 10,
72 [snd_soc_dapm_spk] = 10,
73 [snd_soc_dapm_line] = 10,
74 [snd_soc_dapm_post] = 11,
75 };
76
77 static int dapm_down_seq[] = {
78 [snd_soc_dapm_pre] = 0,
79 [snd_soc_dapm_adc] = 1,
80 [snd_soc_dapm_hp] = 2,
81 [snd_soc_dapm_spk] = 2,
82 [snd_soc_dapm_line] = 2,
83 [snd_soc_dapm_out_drv] = 2,
84 [snd_soc_dapm_pga] = 4,
85 [snd_soc_dapm_mixer_named_ctl] = 5,
86 [snd_soc_dapm_mixer] = 5,
87 [snd_soc_dapm_dac] = 6,
88 [snd_soc_dapm_mic] = 7,
89 [snd_soc_dapm_micbias] = 8,
90 [snd_soc_dapm_mux] = 9,
91 [snd_soc_dapm_virt_mux] = 9,
92 [snd_soc_dapm_value_mux] = 9,
93 [snd_soc_dapm_aif_in] = 10,
94 [snd_soc_dapm_aif_out] = 10,
95 [snd_soc_dapm_dai] = 10,
96 [snd_soc_dapm_dai_link] = 11,
97 [snd_soc_dapm_clock_supply] = 12,
98 [snd_soc_dapm_regulator_supply] = 12,
99 [snd_soc_dapm_supply] = 12,
100 [snd_soc_dapm_post] = 13,
101 };
102
103 static void pop_wait(u32 pop_time)
104 {
105 if (pop_time)
106 schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
107 }
108
109 static void pop_dbg(struct device *dev, u32 pop_time, const char *fmt, ...)
110 {
111 va_list args;
112 char *buf;
113
114 if (!pop_time)
115 return;
116
117 buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
118 if (buf == NULL)
119 return;
120
121 va_start(args, fmt);
122 vsnprintf(buf, PAGE_SIZE, fmt, args);
123 dev_info(dev, "%s", buf);
124 va_end(args);
125
126 kfree(buf);
127 }
128
129 static bool dapm_dirty_widget(struct snd_soc_dapm_widget *w)
130 {
131 return !list_empty(&w->dirty);
132 }
133
134 void dapm_mark_dirty(struct snd_soc_dapm_widget *w, const char *reason)
135 {
136 if (!dapm_dirty_widget(w)) {
137 dev_vdbg(w->dapm->dev, "Marking %s dirty due to %s\n",
138 w->name, reason);
139 list_add_tail(&w->dirty, &w->dapm->card->dapm_dirty);
140 }
141 }
142 EXPORT_SYMBOL_GPL(dapm_mark_dirty);
143
144 void dapm_mark_io_dirty(struct snd_soc_dapm_context *dapm)
145 {
146 struct snd_soc_card *card = dapm->card;
147 struct snd_soc_dapm_widget *w;
148
149 mutex_lock(&card->dapm_mutex);
150
151 list_for_each_entry(w, &card->widgets, list) {
152 switch (w->id) {
153 case snd_soc_dapm_input:
154 case snd_soc_dapm_output:
155 dapm_mark_dirty(w, "Rechecking inputs and outputs");
156 break;
157 default:
158 break;
159 }
160 }
161
162 mutex_unlock(&card->dapm_mutex);
163 }
164 EXPORT_SYMBOL_GPL(dapm_mark_io_dirty);
165
166 /* create a new dapm widget */
167 static inline struct snd_soc_dapm_widget *dapm_cnew_widget(
168 const struct snd_soc_dapm_widget *_widget)
169 {
170 return kmemdup(_widget, sizeof(*_widget), GFP_KERNEL);
171 }
172
173 /* get snd_card from DAPM context */
174 static inline struct snd_card *dapm_get_snd_card(
175 struct snd_soc_dapm_context *dapm)
176 {
177 if (dapm->codec)
178 return dapm->codec->card->snd_card;
179 else if (dapm->platform)
180 return dapm->platform->card->snd_card;
181 else
182 BUG();
183
184 /* unreachable */
185 return NULL;
186 }
187
188 /* get soc_card from DAPM context */
189 static inline struct snd_soc_card *dapm_get_soc_card(
190 struct snd_soc_dapm_context *dapm)
191 {
192 if (dapm->codec)
193 return dapm->codec->card;
194 else if (dapm->platform)
195 return dapm->platform->card;
196 else
197 BUG();
198
199 /* unreachable */
200 return NULL;
201 }
202
203 static void dapm_reset(struct snd_soc_card *card)
204 {
205 struct snd_soc_dapm_widget *w;
206
207 memset(&card->dapm_stats, 0, sizeof(card->dapm_stats));
208
209 list_for_each_entry(w, &card->widgets, list) {
210 w->power_checked = false;
211 w->inputs = -1;
212 w->outputs = -1;
213 }
214 }
215
216 static int soc_widget_read(struct snd_soc_dapm_widget *w, int reg)
217 {
218 if (w->codec)
219 return snd_soc_read(w->codec, reg);
220 else if (w->platform)
221 return snd_soc_platform_read(w->platform, reg);
222
223 dev_err(w->dapm->dev, "ASoC: no valid widget read method\n");
224 return -1;
225 }
226
227 static int soc_widget_write(struct snd_soc_dapm_widget *w, int reg, int val)
228 {
229 if (w->codec)
230 return snd_soc_write(w->codec, reg, val);
231 else if (w->platform)
232 return snd_soc_platform_write(w->platform, reg, val);
233
234 dev_err(w->dapm->dev, "ASoC: no valid widget write method\n");
235 return -1;
236 }
237
238 static inline void soc_widget_lock(struct snd_soc_dapm_widget *w)
239 {
240 if (w->codec && !w->codec->using_regmap)
241 mutex_lock(&w->codec->mutex);
242 else if (w->platform)
243 mutex_lock(&w->platform->mutex);
244 }
245
246 static inline void soc_widget_unlock(struct snd_soc_dapm_widget *w)
247 {
248 if (w->codec && !w->codec->using_regmap)
249 mutex_unlock(&w->codec->mutex);
250 else if (w->platform)
251 mutex_unlock(&w->platform->mutex);
252 }
253
254 static int soc_widget_update_bits_locked(struct snd_soc_dapm_widget *w,
255 unsigned short reg, unsigned int mask, unsigned int value)
256 {
257 bool change;
258 unsigned int old, new;
259 int ret;
260
261 if (w->codec && w->codec->using_regmap) {
262 ret = regmap_update_bits_check(w->codec->control_data,
263 reg, mask, value, &change);
264 if (ret != 0)
265 return ret;
266 } else {
267 soc_widget_lock(w);
268 ret = soc_widget_read(w, reg);
269 if (ret < 0) {
270 soc_widget_unlock(w);
271 return ret;
272 }
273
274 old = ret;
275 new = (old & ~mask) | (value & mask);
276 change = old != new;
277 if (change) {
278 ret = soc_widget_write(w, reg, new);
279 if (ret < 0) {
280 soc_widget_unlock(w);
281 return ret;
282 }
283 }
284 soc_widget_unlock(w);
285 }
286
287 return change;
288 }
289
290 /**
291 * snd_soc_dapm_set_bias_level - set the bias level for the system
292 * @dapm: DAPM context
293 * @level: level to configure
294 *
295 * Configure the bias (power) levels for the SoC audio device.
296 *
297 * Returns 0 for success else error.
298 */
299 static int snd_soc_dapm_set_bias_level(struct snd_soc_dapm_context *dapm,
300 enum snd_soc_bias_level level)
301 {
302 struct snd_soc_card *card = dapm->card;
303 int ret = 0;
304
305 trace_snd_soc_bias_level_start(card, level);
306
307 if (card && card->set_bias_level)
308 ret = card->set_bias_level(card, dapm, level);
309 if (ret != 0)
310 goto out;
311
312 if (dapm->codec) {
313 if (dapm->codec->driver->set_bias_level)
314 ret = dapm->codec->driver->set_bias_level(dapm->codec,
315 level);
316 else
317 dapm->bias_level = level;
318 } else if (!card || dapm != &card->dapm) {
319 dapm->bias_level = level;
320 }
321
322 if (ret != 0)
323 goto out;
324
325 if (card && card->set_bias_level_post)
326 ret = card->set_bias_level_post(card, dapm, level);
327 out:
328 trace_snd_soc_bias_level_done(card, level);
329
330 return ret;
331 }
332
333 /* set up initial codec paths */
334 static void dapm_set_path_status(struct snd_soc_dapm_widget *w,
335 struct snd_soc_dapm_path *p, int i)
336 {
337 switch (w->id) {
338 case snd_soc_dapm_switch:
339 case snd_soc_dapm_mixer:
340 case snd_soc_dapm_mixer_named_ctl: {
341 int val;
342 struct soc_mixer_control *mc = (struct soc_mixer_control *)
343 w->kcontrol_news[i].private_value;
344 unsigned int reg = mc->reg;
345 unsigned int shift = mc->shift;
346 int max = mc->max;
347 unsigned int mask = (1 << fls(max)) - 1;
348 unsigned int invert = mc->invert;
349
350 val = soc_widget_read(w, reg);
351 val = (val >> shift) & mask;
352 if (invert)
353 val = max - val;
354
355 p->connect = !!val;
356 }
357 break;
358 case snd_soc_dapm_mux: {
359 struct soc_enum *e = (struct soc_enum *)
360 w->kcontrol_news[i].private_value;
361 int val, item;
362
363 val = soc_widget_read(w, e->reg);
364 item = (val >> e->shift_l) & e->mask;
365
366 if (item < e->max && !strcmp(p->name, e->texts[item]))
367 p->connect = 1;
368 else
369 p->connect = 0;
370 }
371 break;
372 case snd_soc_dapm_virt_mux: {
373 struct soc_enum *e = (struct soc_enum *)
374 w->kcontrol_news[i].private_value;
375
376 p->connect = 0;
377 /* since a virtual mux has no backing registers to
378 * decide which path to connect, it will try to match
379 * with the first enumeration. This is to ensure
380 * that the default mux choice (the first) will be
381 * correctly powered up during initialization.
382 */
383 if (!strcmp(p->name, e->texts[0]))
384 p->connect = 1;
385 }
386 break;
387 case snd_soc_dapm_value_mux: {
388 struct soc_enum *e = (struct soc_enum *)
389 w->kcontrol_news[i].private_value;
390 int val, item;
391
392 val = soc_widget_read(w, e->reg);
393 val = (val >> e->shift_l) & e->mask;
394 for (item = 0; item < e->max; item++) {
395 if (val == e->values[item])
396 break;
397 }
398
399 if (item < e->max && !strcmp(p->name, e->texts[item]))
400 p->connect = 1;
401 else
402 p->connect = 0;
403 }
404 break;
405 /* does not affect routing - always connected */
406 case snd_soc_dapm_pga:
407 case snd_soc_dapm_out_drv:
408 case snd_soc_dapm_output:
409 case snd_soc_dapm_adc:
410 case snd_soc_dapm_input:
411 case snd_soc_dapm_siggen:
412 case snd_soc_dapm_dac:
413 case snd_soc_dapm_micbias:
414 case snd_soc_dapm_vmid:
415 case snd_soc_dapm_supply:
416 case snd_soc_dapm_regulator_supply:
417 case snd_soc_dapm_clock_supply:
418 case snd_soc_dapm_aif_in:
419 case snd_soc_dapm_aif_out:
420 case snd_soc_dapm_dai:
421 case snd_soc_dapm_hp:
422 case snd_soc_dapm_mic:
423 case snd_soc_dapm_spk:
424 case snd_soc_dapm_line:
425 case snd_soc_dapm_dai_link:
426 p->connect = 1;
427 break;
428 /* does affect routing - dynamically connected */
429 case snd_soc_dapm_pre:
430 case snd_soc_dapm_post:
431 p->connect = 0;
432 break;
433 }
434 }
435
436 /* connect mux widget to its interconnecting audio paths */
437 static int dapm_connect_mux(struct snd_soc_dapm_context *dapm,
438 struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
439 struct snd_soc_dapm_path *path, const char *control_name,
440 const struct snd_kcontrol_new *kcontrol)
441 {
442 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
443 int i;
444
445 for (i = 0; i < e->max; i++) {
446 if (!(strcmp(control_name, e->texts[i]))) {
447 list_add(&path->list, &dapm->card->paths);
448 list_add(&path->list_sink, &dest->sources);
449 list_add(&path->list_source, &src->sinks);
450 path->name = (char*)e->texts[i];
451 dapm_set_path_status(dest, path, 0);
452 return 0;
453 }
454 }
455
456 return -ENODEV;
457 }
458
459 /* connect mixer widget to its interconnecting audio paths */
460 static int dapm_connect_mixer(struct snd_soc_dapm_context *dapm,
461 struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
462 struct snd_soc_dapm_path *path, const char *control_name)
463 {
464 int i;
465
466 /* search for mixer kcontrol */
467 for (i = 0; i < dest->num_kcontrols; i++) {
468 if (!strcmp(control_name, dest->kcontrol_news[i].name)) {
469 list_add(&path->list, &dapm->card->paths);
470 list_add(&path->list_sink, &dest->sources);
471 list_add(&path->list_source, &src->sinks);
472 path->name = dest->kcontrol_news[i].name;
473 dapm_set_path_status(dest, path, i);
474 return 0;
475 }
476 }
477 return -ENODEV;
478 }
479
480 static int dapm_is_shared_kcontrol(struct snd_soc_dapm_context *dapm,
481 struct snd_soc_dapm_widget *kcontrolw,
482 const struct snd_kcontrol_new *kcontrol_new,
483 struct snd_kcontrol **kcontrol)
484 {
485 struct snd_soc_dapm_widget *w;
486 int i;
487
488 *kcontrol = NULL;
489
490 list_for_each_entry(w, &dapm->card->widgets, list) {
491 if (w == kcontrolw || w->dapm != kcontrolw->dapm)
492 continue;
493 for (i = 0; i < w->num_kcontrols; i++) {
494 if (&w->kcontrol_news[i] == kcontrol_new) {
495 if (w->kcontrols)
496 *kcontrol = w->kcontrols[i];
497 return 1;
498 }
499 }
500 }
501
502 return 0;
503 }
504
505 static void dapm_kcontrol_free(struct snd_kcontrol *kctl)
506 {
507 kfree(kctl->private_data);
508 }
509
510 /*
511 * Determine if a kcontrol is shared. If it is, look it up. If it isn't,
512 * create it. Either way, add the widget into the control's widget list
513 */
514 static int dapm_create_or_share_mixmux_kcontrol(struct snd_soc_dapm_widget *w,
515 int kci, struct snd_soc_dapm_path *path)
516 {
517 struct snd_soc_dapm_context *dapm = w->dapm;
518 struct snd_card *card = dapm->card->snd_card;
519 const char *prefix;
520 size_t prefix_len;
521 int shared;
522 struct snd_kcontrol *kcontrol;
523 struct snd_soc_dapm_widget_list *wlist;
524 int wlistentries;
525 size_t wlistsize;
526 bool wname_in_long_name, kcname_in_long_name;
527 size_t name_len;
528 char *long_name;
529 const char *name;
530 int ret;
531
532 if (dapm->codec)
533 prefix = dapm->codec->name_prefix;
534 else
535 prefix = NULL;
536
537 if (prefix)
538 prefix_len = strlen(prefix) + 1;
539 else
540 prefix_len = 0;
541
542 shared = dapm_is_shared_kcontrol(dapm, w, &w->kcontrol_news[kci],
543 &kcontrol);
544
545 if (kcontrol) {
546 wlist = kcontrol->private_data;
547 wlistentries = wlist->num_widgets + 1;
548 } else {
549 wlist = NULL;
550 wlistentries = 1;
551 }
552
553 wlistsize = sizeof(struct snd_soc_dapm_widget_list) +
554 wlistentries * sizeof(struct snd_soc_dapm_widget *);
555 wlist = krealloc(wlist, wlistsize, GFP_KERNEL);
556 if (wlist == NULL) {
557 dev_err(dapm->dev, "ASoC: can't allocate widget list for %s\n",
558 w->name);
559 return -ENOMEM;
560 }
561 wlist->num_widgets = wlistentries;
562 wlist->widgets[wlistentries - 1] = w;
563
564 if (!kcontrol) {
565 if (shared) {
566 wname_in_long_name = false;
567 kcname_in_long_name = true;
568 } else {
569 switch (w->id) {
570 case snd_soc_dapm_switch:
571 case snd_soc_dapm_mixer:
572 wname_in_long_name = true;
573 kcname_in_long_name = true;
574 break;
575 case snd_soc_dapm_mixer_named_ctl:
576 wname_in_long_name = false;
577 kcname_in_long_name = true;
578 break;
579 case snd_soc_dapm_mux:
580 case snd_soc_dapm_virt_mux:
581 case snd_soc_dapm_value_mux:
582 wname_in_long_name = true;
583 kcname_in_long_name = false;
584 break;
585 default:
586 kfree(wlist);
587 return -EINVAL;
588 }
589 }
590
591 if (wname_in_long_name && kcname_in_long_name) {
592 name_len = strlen(w->name) - prefix_len + 1 +
593 strlen(w->kcontrol_news[kci].name) + 1;
594
595 long_name = kmalloc(name_len, GFP_KERNEL);
596 if (long_name == NULL) {
597 kfree(wlist);
598 return -ENOMEM;
599 }
600
601 /*
602 * The control will get a prefix from the control
603 * creation process but we're also using the same
604 * prefix for widgets so cut the prefix off the
605 * front of the widget name.
606 */
607 snprintf(long_name, name_len, "%s %s",
608 w->name + prefix_len,
609 w->kcontrol_news[kci].name);
610 long_name[name_len - 1] = '\0';
611
612 name = long_name;
613 } else if (wname_in_long_name) {
614 long_name = NULL;
615 name = w->name + prefix_len;
616 } else {
617 long_name = NULL;
618 name = w->kcontrol_news[kci].name;
619 }
620
621 kcontrol = snd_soc_cnew(&w->kcontrol_news[kci], wlist, name,
622 prefix);
623 kcontrol->private_free = dapm_kcontrol_free;
624 ret = snd_ctl_add(card, kcontrol);
625 if (ret < 0) {
626 dev_err(dapm->dev,
627 "ASoC: failed to add widget %s dapm kcontrol %s: %d\n",
628 w->name, name, ret);
629 kfree(wlist);
630 kfree(long_name);
631 return ret;
632 }
633
634 path->long_name = long_name;
635 }
636
637 kcontrol->private_data = wlist;
638 w->kcontrols[kci] = kcontrol;
639 path->kcontrol = kcontrol;
640
641 return 0;
642 }
643
644 /* create new dapm mixer control */
645 static int dapm_new_mixer(struct snd_soc_dapm_widget *w)
646 {
647 int i, ret;
648 struct snd_soc_dapm_path *path;
649
650 /* add kcontrol */
651 for (i = 0; i < w->num_kcontrols; i++) {
652 /* match name */
653 list_for_each_entry(path, &w->sources, list_sink) {
654 /* mixer/mux paths name must match control name */
655 if (path->name != (char *)w->kcontrol_news[i].name)
656 continue;
657
658 if (w->kcontrols[i]) {
659 path->kcontrol = w->kcontrols[i];
660 continue;
661 }
662
663 ret = dapm_create_or_share_mixmux_kcontrol(w, i, path);
664 if (ret < 0)
665 return ret;
666 }
667 }
668
669 return 0;
670 }
671
672 /* create new dapm mux control */
673 static int dapm_new_mux(struct snd_soc_dapm_widget *w)
674 {
675 struct snd_soc_dapm_context *dapm = w->dapm;
676 struct snd_soc_dapm_path *path;
677 int ret;
678
679 if (w->num_kcontrols != 1) {
680 dev_err(dapm->dev,
681 "ASoC: mux %s has incorrect number of controls\n",
682 w->name);
683 return -EINVAL;
684 }
685
686 path = list_first_entry(&w->sources, struct snd_soc_dapm_path,
687 list_sink);
688 if (!path) {
689 dev_err(dapm->dev, "ASoC: mux %s has no paths\n", w->name);
690 return -EINVAL;
691 }
692
693 ret = dapm_create_or_share_mixmux_kcontrol(w, 0, path);
694 if (ret < 0)
695 return ret;
696
697 list_for_each_entry(path, &w->sources, list_sink)
698 path->kcontrol = w->kcontrols[0];
699
700 return 0;
701 }
702
703 /* create new dapm volume control */
704 static int dapm_new_pga(struct snd_soc_dapm_widget *w)
705 {
706 if (w->num_kcontrols)
707 dev_err(w->dapm->dev,
708 "ASoC: PGA controls not supported: '%s'\n", w->name);
709
710 return 0;
711 }
712
713 /* reset 'walked' bit for each dapm path */
714 static void dapm_clear_walk_output(struct snd_soc_dapm_context *dapm,
715 struct list_head *sink)
716 {
717 struct snd_soc_dapm_path *p;
718
719 list_for_each_entry(p, sink, list_source) {
720 if (p->walked) {
721 p->walked = 0;
722 dapm_clear_walk_output(dapm, &p->sink->sinks);
723 }
724 }
725 }
726
727 static void dapm_clear_walk_input(struct snd_soc_dapm_context *dapm,
728 struct list_head *source)
729 {
730 struct snd_soc_dapm_path *p;
731
732 list_for_each_entry(p, source, list_sink) {
733 if (p->walked) {
734 p->walked = 0;
735 dapm_clear_walk_input(dapm, &p->source->sources);
736 }
737 }
738 }
739
740
741 /* We implement power down on suspend by checking the power state of
742 * the ALSA card - when we are suspending the ALSA state for the card
743 * is set to D3.
744 */
745 static int snd_soc_dapm_suspend_check(struct snd_soc_dapm_widget *widget)
746 {
747 int level = snd_power_get_state(widget->dapm->card->snd_card);
748
749 switch (level) {
750 case SNDRV_CTL_POWER_D3hot:
751 case SNDRV_CTL_POWER_D3cold:
752 if (widget->ignore_suspend)
753 dev_dbg(widget->dapm->dev, "ASoC: %s ignoring suspend\n",
754 widget->name);
755 return widget->ignore_suspend;
756 default:
757 return 1;
758 }
759 }
760
761 /* add widget to list if it's not already in the list */
762 static int dapm_list_add_widget(struct snd_soc_dapm_widget_list **list,
763 struct snd_soc_dapm_widget *w)
764 {
765 struct snd_soc_dapm_widget_list *wlist;
766 int wlistsize, wlistentries, i;
767
768 if (*list == NULL)
769 return -EINVAL;
770
771 wlist = *list;
772
773 /* is this widget already in the list */
774 for (i = 0; i < wlist->num_widgets; i++) {
775 if (wlist->widgets[i] == w)
776 return 0;
777 }
778
779 /* allocate some new space */
780 wlistentries = wlist->num_widgets + 1;
781 wlistsize = sizeof(struct snd_soc_dapm_widget_list) +
782 wlistentries * sizeof(struct snd_soc_dapm_widget *);
783 *list = krealloc(wlist, wlistsize, GFP_KERNEL);
784 if (*list == NULL) {
785 dev_err(w->dapm->dev, "ASoC: can't allocate widget list for %s\n",
786 w->name);
787 return -ENOMEM;
788 }
789 wlist = *list;
790
791 /* insert the widget */
792 dev_dbg(w->dapm->dev, "ASoC: added %s in widget list pos %d\n",
793 w->name, wlist->num_widgets);
794
795 wlist->widgets[wlist->num_widgets] = w;
796 wlist->num_widgets++;
797 return 1;
798 }
799
800 /*
801 * Recursively check for a completed path to an active or physically connected
802 * output widget. Returns number of complete paths.
803 */
804 static int is_connected_output_ep(struct snd_soc_dapm_widget *widget,
805 struct snd_soc_dapm_widget_list **list)
806 {
807 struct snd_soc_dapm_path *path;
808 int con = 0;
809
810 if (widget->outputs >= 0)
811 return widget->outputs;
812
813 DAPM_UPDATE_STAT(widget, path_checks);
814
815 switch (widget->id) {
816 case snd_soc_dapm_supply:
817 case snd_soc_dapm_regulator_supply:
818 case snd_soc_dapm_clock_supply:
819 return 0;
820 default:
821 break;
822 }
823
824 switch (widget->id) {
825 case snd_soc_dapm_adc:
826 case snd_soc_dapm_aif_out:
827 case snd_soc_dapm_dai:
828 if (widget->active) {
829 widget->outputs = snd_soc_dapm_suspend_check(widget);
830 return widget->outputs;
831 }
832 default:
833 break;
834 }
835
836 if (widget->connected) {
837 /* connected pin ? */
838 if (widget->id == snd_soc_dapm_output && !widget->ext) {
839 widget->outputs = snd_soc_dapm_suspend_check(widget);
840 return widget->outputs;
841 }
842
843 /* connected jack or spk ? */
844 if (widget->id == snd_soc_dapm_hp ||
845 widget->id == snd_soc_dapm_spk ||
846 (widget->id == snd_soc_dapm_line &&
847 !list_empty(&widget->sources))) {
848 widget->outputs = snd_soc_dapm_suspend_check(widget);
849 return widget->outputs;
850 }
851 }
852
853 list_for_each_entry(path, &widget->sinks, list_source) {
854 DAPM_UPDATE_STAT(widget, neighbour_checks);
855
856 if (path->weak)
857 continue;
858
859 if (path->walking)
860 return 1;
861
862 if (path->walked)
863 continue;
864
865 trace_snd_soc_dapm_output_path(widget, path);
866
867 if (path->sink && path->connect) {
868 path->walked = 1;
869 path->walking = 1;
870
871 /* do we need to add this widget to the list ? */
872 if (list) {
873 int err;
874 err = dapm_list_add_widget(list, path->sink);
875 if (err < 0) {
876 dev_err(widget->dapm->dev,
877 "ASoC: could not add widget %s\n",
878 widget->name);
879 path->walking = 0;
880 return con;
881 }
882 }
883
884 con += is_connected_output_ep(path->sink, list);
885
886 path->walking = 0;
887 }
888 }
889
890 widget->outputs = con;
891
892 return con;
893 }
894
895 /*
896 * Recursively check for a completed path to an active or physically connected
897 * input widget. Returns number of complete paths.
898 */
899 static int is_connected_input_ep(struct snd_soc_dapm_widget *widget,
900 struct snd_soc_dapm_widget_list **list)
901 {
902 struct snd_soc_dapm_path *path;
903 int con = 0;
904
905 if (widget->inputs >= 0)
906 return widget->inputs;
907
908 DAPM_UPDATE_STAT(widget, path_checks);
909
910 switch (widget->id) {
911 case snd_soc_dapm_supply:
912 case snd_soc_dapm_regulator_supply:
913 case snd_soc_dapm_clock_supply:
914 return 0;
915 default:
916 break;
917 }
918
919 /* active stream ? */
920 switch (widget->id) {
921 case snd_soc_dapm_dac:
922 case snd_soc_dapm_aif_in:
923 case snd_soc_dapm_dai:
924 if (widget->active) {
925 widget->inputs = snd_soc_dapm_suspend_check(widget);
926 return widget->inputs;
927 }
928 default:
929 break;
930 }
931
932 if (widget->connected) {
933 /* connected pin ? */
934 if (widget->id == snd_soc_dapm_input && !widget->ext) {
935 widget->inputs = snd_soc_dapm_suspend_check(widget);
936 return widget->inputs;
937 }
938
939 /* connected VMID/Bias for lower pops */
940 if (widget->id == snd_soc_dapm_vmid) {
941 widget->inputs = snd_soc_dapm_suspend_check(widget);
942 return widget->inputs;
943 }
944
945 /* connected jack ? */
946 if (widget->id == snd_soc_dapm_mic ||
947 (widget->id == snd_soc_dapm_line &&
948 !list_empty(&widget->sinks))) {
949 widget->inputs = snd_soc_dapm_suspend_check(widget);
950 return widget->inputs;
951 }
952
953 /* signal generator */
954 if (widget->id == snd_soc_dapm_siggen) {
955 widget->inputs = snd_soc_dapm_suspend_check(widget);
956 return widget->inputs;
957 }
958 }
959
960 list_for_each_entry(path, &widget->sources, list_sink) {
961 DAPM_UPDATE_STAT(widget, neighbour_checks);
962
963 if (path->weak)
964 continue;
965
966 if (path->walking)
967 return 1;
968
969 if (path->walked)
970 continue;
971
972 trace_snd_soc_dapm_input_path(widget, path);
973
974 if (path->source && path->connect) {
975 path->walked = 1;
976 path->walking = 1;
977
978 /* do we need to add this widget to the list ? */
979 if (list) {
980 int err;
981 err = dapm_list_add_widget(list, path->source);
982 if (err < 0) {
983 dev_err(widget->dapm->dev,
984 "ASoC: could not add widget %s\n",
985 widget->name);
986 path->walking = 0;
987 return con;
988 }
989 }
990
991 con += is_connected_input_ep(path->source, list);
992
993 path->walking = 0;
994 }
995 }
996
997 widget->inputs = con;
998
999 return con;
1000 }
1001
1002 /**
1003 * snd_soc_dapm_get_connected_widgets - query audio path and it's widgets.
1004 * @dai: the soc DAI.
1005 * @stream: stream direction.
1006 * @list: list of active widgets for this stream.
1007 *
1008 * Queries DAPM graph as to whether an valid audio stream path exists for
1009 * the initial stream specified by name. This takes into account
1010 * current mixer and mux kcontrol settings. Creates list of valid widgets.
1011 *
1012 * Returns the number of valid paths or negative error.
1013 */
1014 int snd_soc_dapm_dai_get_connected_widgets(struct snd_soc_dai *dai, int stream,
1015 struct snd_soc_dapm_widget_list **list)
1016 {
1017 struct snd_soc_card *card = dai->card;
1018 int paths;
1019
1020 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
1021 dapm_reset(card);
1022
1023 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
1024 paths = is_connected_output_ep(dai->playback_widget, list);
1025 dapm_clear_walk_output(&card->dapm,
1026 &dai->playback_widget->sinks);
1027 } else {
1028 paths = is_connected_input_ep(dai->capture_widget, list);
1029 dapm_clear_walk_input(&card->dapm,
1030 &dai->capture_widget->sources);
1031 }
1032
1033 trace_snd_soc_dapm_connected(paths, stream);
1034 mutex_unlock(&card->dapm_mutex);
1035
1036 return paths;
1037 }
1038
1039 /*
1040 * Handler for generic register modifier widget.
1041 */
1042 int dapm_reg_event(struct snd_soc_dapm_widget *w,
1043 struct snd_kcontrol *kcontrol, int event)
1044 {
1045 unsigned int val;
1046
1047 if (SND_SOC_DAPM_EVENT_ON(event))
1048 val = w->on_val;
1049 else
1050 val = w->off_val;
1051
1052 soc_widget_update_bits_locked(w, -(w->reg + 1),
1053 w->mask << w->shift, val << w->shift);
1054
1055 return 0;
1056 }
1057 EXPORT_SYMBOL_GPL(dapm_reg_event);
1058
1059 /*
1060 * Handler for regulator supply widget.
1061 */
1062 int dapm_regulator_event(struct snd_soc_dapm_widget *w,
1063 struct snd_kcontrol *kcontrol, int event)
1064 {
1065 int ret;
1066
1067 if (SND_SOC_DAPM_EVENT_ON(event)) {
1068 if (w->invert & SND_SOC_DAPM_REGULATOR_BYPASS) {
1069 ret = regulator_allow_bypass(w->regulator, false);
1070 if (ret != 0)
1071 dev_warn(w->dapm->dev,
1072 "ASoC: Failed to bypass %s: %d\n",
1073 w->name, ret);
1074 }
1075
1076 return regulator_enable(w->regulator);
1077 } else {
1078 if (w->invert & SND_SOC_DAPM_REGULATOR_BYPASS) {
1079 ret = regulator_allow_bypass(w->regulator, true);
1080 if (ret != 0)
1081 dev_warn(w->dapm->dev,
1082 "ASoC: Failed to unbypass %s: %d\n",
1083 w->name, ret);
1084 }
1085
1086 return regulator_disable_deferred(w->regulator, w->shift);
1087 }
1088 }
1089 EXPORT_SYMBOL_GPL(dapm_regulator_event);
1090
1091 /*
1092 * Handler for clock supply widget.
1093 */
1094 int dapm_clock_event(struct snd_soc_dapm_widget *w,
1095 struct snd_kcontrol *kcontrol, int event)
1096 {
1097 if (!w->clk)
1098 return -EIO;
1099
1100 #ifdef CONFIG_HAVE_CLK
1101 if (SND_SOC_DAPM_EVENT_ON(event)) {
1102 return clk_prepare_enable(w->clk);
1103 } else {
1104 clk_disable_unprepare(w->clk);
1105 return 0;
1106 }
1107 #endif
1108 return 0;
1109 }
1110 EXPORT_SYMBOL_GPL(dapm_clock_event);
1111
1112 static int dapm_widget_power_check(struct snd_soc_dapm_widget *w)
1113 {
1114 if (w->power_checked)
1115 return w->new_power;
1116
1117 if (w->force)
1118 w->new_power = 1;
1119 else
1120 w->new_power = w->power_check(w);
1121
1122 w->power_checked = true;
1123
1124 return w->new_power;
1125 }
1126
1127 /* Generic check to see if a widget should be powered.
1128 */
1129 static int dapm_generic_check_power(struct snd_soc_dapm_widget *w)
1130 {
1131 int in, out;
1132
1133 DAPM_UPDATE_STAT(w, power_checks);
1134
1135 in = is_connected_input_ep(w, NULL);
1136 dapm_clear_walk_input(w->dapm, &w->sources);
1137 out = is_connected_output_ep(w, NULL);
1138 dapm_clear_walk_output(w->dapm, &w->sinks);
1139 return out != 0 && in != 0;
1140 }
1141
1142 static int dapm_dai_check_power(struct snd_soc_dapm_widget *w)
1143 {
1144 DAPM_UPDATE_STAT(w, power_checks);
1145
1146 if (w->active)
1147 return w->active;
1148
1149 return dapm_generic_check_power(w);
1150 }
1151
1152 /* Check to see if an ADC has power */
1153 static int dapm_adc_check_power(struct snd_soc_dapm_widget *w)
1154 {
1155 int in;
1156
1157 DAPM_UPDATE_STAT(w, power_checks);
1158
1159 if (w->active) {
1160 in = is_connected_input_ep(w, NULL);
1161 dapm_clear_walk_input(w->dapm, &w->sources);
1162 return in != 0;
1163 } else {
1164 return dapm_generic_check_power(w);
1165 }
1166 }
1167
1168 /* Check to see if a DAC has power */
1169 static int dapm_dac_check_power(struct snd_soc_dapm_widget *w)
1170 {
1171 int out;
1172
1173 DAPM_UPDATE_STAT(w, power_checks);
1174
1175 if (w->active) {
1176 out = is_connected_output_ep(w, NULL);
1177 dapm_clear_walk_output(w->dapm, &w->sinks);
1178 return out != 0;
1179 } else {
1180 return dapm_generic_check_power(w);
1181 }
1182 }
1183
1184 /* Check to see if a power supply is needed */
1185 static int dapm_supply_check_power(struct snd_soc_dapm_widget *w)
1186 {
1187 struct snd_soc_dapm_path *path;
1188
1189 DAPM_UPDATE_STAT(w, power_checks);
1190
1191 /* Check if one of our outputs is connected */
1192 list_for_each_entry(path, &w->sinks, list_source) {
1193 DAPM_UPDATE_STAT(w, neighbour_checks);
1194
1195 if (path->weak)
1196 continue;
1197
1198 if (path->connected &&
1199 !path->connected(path->source, path->sink))
1200 continue;
1201
1202 if (!path->sink)
1203 continue;
1204
1205 if (dapm_widget_power_check(path->sink))
1206 return 1;
1207 }
1208
1209 return 0;
1210 }
1211
1212 static int dapm_always_on_check_power(struct snd_soc_dapm_widget *w)
1213 {
1214 return 1;
1215 }
1216
1217 static int dapm_seq_compare(struct snd_soc_dapm_widget *a,
1218 struct snd_soc_dapm_widget *b,
1219 bool power_up)
1220 {
1221 int *sort;
1222
1223 if (power_up)
1224 sort = dapm_up_seq;
1225 else
1226 sort = dapm_down_seq;
1227
1228 if (sort[a->id] != sort[b->id])
1229 return sort[a->id] - sort[b->id];
1230 if (a->subseq != b->subseq) {
1231 if (power_up)
1232 return a->subseq - b->subseq;
1233 else
1234 return b->subseq - a->subseq;
1235 }
1236 if (a->reg != b->reg)
1237 return a->reg - b->reg;
1238 if (a->dapm != b->dapm)
1239 return (unsigned long)a->dapm - (unsigned long)b->dapm;
1240
1241 return 0;
1242 }
1243
1244 /* Insert a widget in order into a DAPM power sequence. */
1245 static void dapm_seq_insert(struct snd_soc_dapm_widget *new_widget,
1246 struct list_head *list,
1247 bool power_up)
1248 {
1249 struct snd_soc_dapm_widget *w;
1250
1251 list_for_each_entry(w, list, power_list)
1252 if (dapm_seq_compare(new_widget, w, power_up) < 0) {
1253 list_add_tail(&new_widget->power_list, &w->power_list);
1254 return;
1255 }
1256
1257 list_add_tail(&new_widget->power_list, list);
1258 }
1259
1260 static void dapm_seq_check_event(struct snd_soc_dapm_context *dapm,
1261 struct snd_soc_dapm_widget *w, int event)
1262 {
1263 struct snd_soc_card *card = dapm->card;
1264 const char *ev_name;
1265 int power, ret;
1266
1267 switch (event) {
1268 case SND_SOC_DAPM_PRE_PMU:
1269 ev_name = "PRE_PMU";
1270 power = 1;
1271 break;
1272 case SND_SOC_DAPM_POST_PMU:
1273 ev_name = "POST_PMU";
1274 power = 1;
1275 break;
1276 case SND_SOC_DAPM_PRE_PMD:
1277 ev_name = "PRE_PMD";
1278 power = 0;
1279 break;
1280 case SND_SOC_DAPM_POST_PMD:
1281 ev_name = "POST_PMD";
1282 power = 0;
1283 break;
1284 default:
1285 BUG();
1286 return;
1287 }
1288
1289 if (w->power != power)
1290 return;
1291
1292 if (w->event && (w->event_flags & event)) {
1293 pop_dbg(dapm->dev, card->pop_time, "pop test : %s %s\n",
1294 w->name, ev_name);
1295 trace_snd_soc_dapm_widget_event_start(w, event);
1296 ret = w->event(w, NULL, event);
1297 trace_snd_soc_dapm_widget_event_done(w, event);
1298 if (ret < 0)
1299 dev_err(dapm->dev, "ASoC: %s: %s event failed: %d\n",
1300 ev_name, w->name, ret);
1301 }
1302 }
1303
1304 /* Apply the coalesced changes from a DAPM sequence */
1305 static void dapm_seq_run_coalesced(struct snd_soc_dapm_context *dapm,
1306 struct list_head *pending)
1307 {
1308 struct snd_soc_card *card = dapm->card;
1309 struct snd_soc_dapm_widget *w;
1310 int reg, power;
1311 unsigned int value = 0;
1312 unsigned int mask = 0;
1313 unsigned int cur_mask;
1314
1315 reg = list_first_entry(pending, struct snd_soc_dapm_widget,
1316 power_list)->reg;
1317
1318 list_for_each_entry(w, pending, power_list) {
1319 cur_mask = 1 << w->shift;
1320 BUG_ON(reg != w->reg);
1321
1322 if (w->invert)
1323 power = !w->power;
1324 else
1325 power = w->power;
1326
1327 mask |= cur_mask;
1328 if (power)
1329 value |= cur_mask;
1330
1331 pop_dbg(dapm->dev, card->pop_time,
1332 "pop test : Queue %s: reg=0x%x, 0x%x/0x%x\n",
1333 w->name, reg, value, mask);
1334
1335 /* Check for events */
1336 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_PRE_PMU);
1337 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_PRE_PMD);
1338 }
1339
1340 if (reg >= 0) {
1341 /* Any widget will do, they should all be updating the
1342 * same register.
1343 */
1344 w = list_first_entry(pending, struct snd_soc_dapm_widget,
1345 power_list);
1346
1347 pop_dbg(dapm->dev, card->pop_time,
1348 "pop test : Applying 0x%x/0x%x to %x in %dms\n",
1349 value, mask, reg, card->pop_time);
1350 pop_wait(card->pop_time);
1351 soc_widget_update_bits_locked(w, reg, mask, value);
1352 }
1353
1354 list_for_each_entry(w, pending, power_list) {
1355 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_POST_PMU);
1356 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_POST_PMD);
1357 }
1358 }
1359
1360 /* Apply a DAPM power sequence.
1361 *
1362 * We walk over a pre-sorted list of widgets to apply power to. In
1363 * order to minimise the number of writes to the device required
1364 * multiple widgets will be updated in a single write where possible.
1365 * Currently anything that requires more than a single write is not
1366 * handled.
1367 */
1368 static void dapm_seq_run(struct snd_soc_dapm_context *dapm,
1369 struct list_head *list, int event, bool power_up)
1370 {
1371 struct snd_soc_dapm_widget *w, *n;
1372 LIST_HEAD(pending);
1373 int cur_sort = -1;
1374 int cur_subseq = -1;
1375 int cur_reg = SND_SOC_NOPM;
1376 struct snd_soc_dapm_context *cur_dapm = NULL;
1377 int ret, i;
1378 int *sort;
1379
1380 if (power_up)
1381 sort = dapm_up_seq;
1382 else
1383 sort = dapm_down_seq;
1384
1385 list_for_each_entry_safe(w, n, list, power_list) {
1386 ret = 0;
1387
1388 /* Do we need to apply any queued changes? */
1389 if (sort[w->id] != cur_sort || w->reg != cur_reg ||
1390 w->dapm != cur_dapm || w->subseq != cur_subseq) {
1391 if (!list_empty(&pending))
1392 dapm_seq_run_coalesced(cur_dapm, &pending);
1393
1394 if (cur_dapm && cur_dapm->seq_notifier) {
1395 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
1396 if (sort[i] == cur_sort)
1397 cur_dapm->seq_notifier(cur_dapm,
1398 i,
1399 cur_subseq);
1400 }
1401
1402 INIT_LIST_HEAD(&pending);
1403 cur_sort = -1;
1404 cur_subseq = INT_MIN;
1405 cur_reg = SND_SOC_NOPM;
1406 cur_dapm = NULL;
1407 }
1408
1409 switch (w->id) {
1410 case snd_soc_dapm_pre:
1411 if (!w->event)
1412 list_for_each_entry_safe_continue(w, n, list,
1413 power_list);
1414
1415 if (event == SND_SOC_DAPM_STREAM_START)
1416 ret = w->event(w,
1417 NULL, SND_SOC_DAPM_PRE_PMU);
1418 else if (event == SND_SOC_DAPM_STREAM_STOP)
1419 ret = w->event(w,
1420 NULL, SND_SOC_DAPM_PRE_PMD);
1421 break;
1422
1423 case snd_soc_dapm_post:
1424 if (!w->event)
1425 list_for_each_entry_safe_continue(w, n, list,
1426 power_list);
1427
1428 if (event == SND_SOC_DAPM_STREAM_START)
1429 ret = w->event(w,
1430 NULL, SND_SOC_DAPM_POST_PMU);
1431 else if (event == SND_SOC_DAPM_STREAM_STOP)
1432 ret = w->event(w,
1433 NULL, SND_SOC_DAPM_POST_PMD);
1434 break;
1435
1436 default:
1437 /* Queue it up for application */
1438 cur_sort = sort[w->id];
1439 cur_subseq = w->subseq;
1440 cur_reg = w->reg;
1441 cur_dapm = w->dapm;
1442 list_move(&w->power_list, &pending);
1443 break;
1444 }
1445
1446 if (ret < 0)
1447 dev_err(w->dapm->dev,
1448 "ASoC: Failed to apply widget power: %d\n", ret);
1449 }
1450
1451 if (!list_empty(&pending))
1452 dapm_seq_run_coalesced(cur_dapm, &pending);
1453
1454 if (cur_dapm && cur_dapm->seq_notifier) {
1455 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
1456 if (sort[i] == cur_sort)
1457 cur_dapm->seq_notifier(cur_dapm,
1458 i, cur_subseq);
1459 }
1460 }
1461
1462 static void dapm_widget_update(struct snd_soc_dapm_context *dapm)
1463 {
1464 struct snd_soc_dapm_update *update = dapm->update;
1465 struct snd_soc_dapm_widget *w;
1466 int ret;
1467
1468 if (!update)
1469 return;
1470
1471 w = update->widget;
1472
1473 if (w->event &&
1474 (w->event_flags & SND_SOC_DAPM_PRE_REG)) {
1475 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_PRE_REG);
1476 if (ret != 0)
1477 dev_err(dapm->dev, "ASoC: %s DAPM pre-event failed: %d\n",
1478 w->name, ret);
1479 }
1480
1481 ret = soc_widget_update_bits_locked(w, update->reg, update->mask,
1482 update->val);
1483 if (ret < 0)
1484 dev_err(dapm->dev, "ASoC: %s DAPM update failed: %d\n",
1485 w->name, ret);
1486
1487 if (w->event &&
1488 (w->event_flags & SND_SOC_DAPM_POST_REG)) {
1489 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_POST_REG);
1490 if (ret != 0)
1491 dev_err(dapm->dev, "ASoC: %s DAPM post-event failed: %d\n",
1492 w->name, ret);
1493 }
1494 }
1495
1496 /* Async callback run prior to DAPM sequences - brings to _PREPARE if
1497 * they're changing state.
1498 */
1499 static void dapm_pre_sequence_async(void *data, async_cookie_t cookie)
1500 {
1501 struct snd_soc_dapm_context *d = data;
1502 int ret;
1503
1504 /* If we're off and we're not supposed to be go into STANDBY */
1505 if (d->bias_level == SND_SOC_BIAS_OFF &&
1506 d->target_bias_level != SND_SOC_BIAS_OFF) {
1507 if (d->dev)
1508 pm_runtime_get_sync(d->dev);
1509
1510 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
1511 if (ret != 0)
1512 dev_err(d->dev,
1513 "ASoC: Failed to turn on bias: %d\n", ret);
1514 }
1515
1516 /* Prepare for a STADDBY->ON or ON->STANDBY transition */
1517 if (d->bias_level != d->target_bias_level) {
1518 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_PREPARE);
1519 if (ret != 0)
1520 dev_err(d->dev,
1521 "ASoC: Failed to prepare bias: %d\n", ret);
1522 }
1523 }
1524
1525 /* Async callback run prior to DAPM sequences - brings to their final
1526 * state.
1527 */
1528 static void dapm_post_sequence_async(void *data, async_cookie_t cookie)
1529 {
1530 struct snd_soc_dapm_context *d = data;
1531 int ret;
1532
1533 /* If we just powered the last thing off drop to standby bias */
1534 if (d->bias_level == SND_SOC_BIAS_PREPARE &&
1535 (d->target_bias_level == SND_SOC_BIAS_STANDBY ||
1536 d->target_bias_level == SND_SOC_BIAS_OFF)) {
1537 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
1538 if (ret != 0)
1539 dev_err(d->dev, "ASoC: Failed to apply standby bias: %d\n",
1540 ret);
1541 }
1542
1543 /* If we're in standby and can support bias off then do that */
1544 if (d->bias_level == SND_SOC_BIAS_STANDBY &&
1545 d->target_bias_level == SND_SOC_BIAS_OFF) {
1546 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_OFF);
1547 if (ret != 0)
1548 dev_err(d->dev, "ASoC: Failed to turn off bias: %d\n",
1549 ret);
1550
1551 if (d->dev)
1552 pm_runtime_put(d->dev);
1553 }
1554
1555 /* If we just powered up then move to active bias */
1556 if (d->bias_level == SND_SOC_BIAS_PREPARE &&
1557 d->target_bias_level == SND_SOC_BIAS_ON) {
1558 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_ON);
1559 if (ret != 0)
1560 dev_err(d->dev, "ASoC: Failed to apply active bias: %d\n",
1561 ret);
1562 }
1563 }
1564
1565 static void dapm_widget_set_peer_power(struct snd_soc_dapm_widget *peer,
1566 bool power, bool connect)
1567 {
1568 /* If a connection is being made or broken then that update
1569 * will have marked the peer dirty, otherwise the widgets are
1570 * not connected and this update has no impact. */
1571 if (!connect)
1572 return;
1573
1574 /* If the peer is already in the state we're moving to then we
1575 * won't have an impact on it. */
1576 if (power != peer->power)
1577 dapm_mark_dirty(peer, "peer state change");
1578 }
1579
1580 static void dapm_widget_set_power(struct snd_soc_dapm_widget *w, bool power,
1581 struct list_head *up_list,
1582 struct list_head *down_list)
1583 {
1584 struct snd_soc_dapm_path *path;
1585
1586 if (w->power == power)
1587 return;
1588
1589 trace_snd_soc_dapm_widget_power(w, power);
1590
1591 /* If we changed our power state perhaps our neigbours changed
1592 * also.
1593 */
1594 list_for_each_entry(path, &w->sources, list_sink) {
1595 if (path->source) {
1596 dapm_widget_set_peer_power(path->source, power,
1597 path->connect);
1598 }
1599 }
1600 switch (w->id) {
1601 case snd_soc_dapm_supply:
1602 case snd_soc_dapm_regulator_supply:
1603 case snd_soc_dapm_clock_supply:
1604 /* Supplies can't affect their outputs, only their inputs */
1605 break;
1606 default:
1607 list_for_each_entry(path, &w->sinks, list_source) {
1608 if (path->sink) {
1609 dapm_widget_set_peer_power(path->sink, power,
1610 path->connect);
1611 }
1612 }
1613 break;
1614 }
1615
1616 if (power)
1617 dapm_seq_insert(w, up_list, true);
1618 else
1619 dapm_seq_insert(w, down_list, false);
1620
1621 w->power = power;
1622 }
1623
1624 static void dapm_power_one_widget(struct snd_soc_dapm_widget *w,
1625 struct list_head *up_list,
1626 struct list_head *down_list)
1627 {
1628 int power;
1629
1630 switch (w->id) {
1631 case snd_soc_dapm_pre:
1632 dapm_seq_insert(w, down_list, false);
1633 break;
1634 case snd_soc_dapm_post:
1635 dapm_seq_insert(w, up_list, true);
1636 break;
1637
1638 default:
1639 power = dapm_widget_power_check(w);
1640
1641 dapm_widget_set_power(w, power, up_list, down_list);
1642 break;
1643 }
1644 }
1645
1646 /*
1647 * Scan each dapm widget for complete audio path.
1648 * A complete path is a route that has valid endpoints i.e.:-
1649 *
1650 * o DAC to output pin.
1651 * o Input Pin to ADC.
1652 * o Input pin to Output pin (bypass, sidetone)
1653 * o DAC to ADC (loopback).
1654 */
1655 static int dapm_power_widgets(struct snd_soc_dapm_context *dapm, int event)
1656 {
1657 struct snd_soc_card *card = dapm->card;
1658 struct snd_soc_dapm_widget *w;
1659 struct snd_soc_dapm_context *d;
1660 LIST_HEAD(up_list);
1661 LIST_HEAD(down_list);
1662 ASYNC_DOMAIN_EXCLUSIVE(async_domain);
1663 enum snd_soc_bias_level bias;
1664
1665 trace_snd_soc_dapm_start(card);
1666
1667 list_for_each_entry(d, &card->dapm_list, list) {
1668 if (d->idle_bias_off)
1669 d->target_bias_level = SND_SOC_BIAS_OFF;
1670 else
1671 d->target_bias_level = SND_SOC_BIAS_STANDBY;
1672 }
1673
1674 dapm_reset(card);
1675
1676 /* Check which widgets we need to power and store them in
1677 * lists indicating if they should be powered up or down. We
1678 * only check widgets that have been flagged as dirty but note
1679 * that new widgets may be added to the dirty list while we
1680 * iterate.
1681 */
1682 list_for_each_entry(w, &card->dapm_dirty, dirty) {
1683 dapm_power_one_widget(w, &up_list, &down_list);
1684 }
1685
1686 list_for_each_entry(w, &card->widgets, list) {
1687 switch (w->id) {
1688 case snd_soc_dapm_pre:
1689 case snd_soc_dapm_post:
1690 /* These widgets always need to be powered */
1691 break;
1692 default:
1693 list_del_init(&w->dirty);
1694 break;
1695 }
1696
1697 if (w->power) {
1698 d = w->dapm;
1699
1700 /* Supplies and micbiases only bring the
1701 * context up to STANDBY as unless something
1702 * else is active and passing audio they
1703 * generally don't require full power. Signal
1704 * generators are virtual pins and have no
1705 * power impact themselves.
1706 */
1707 switch (w->id) {
1708 case snd_soc_dapm_siggen:
1709 break;
1710 case snd_soc_dapm_supply:
1711 case snd_soc_dapm_regulator_supply:
1712 case snd_soc_dapm_clock_supply:
1713 case snd_soc_dapm_micbias:
1714 if (d->target_bias_level < SND_SOC_BIAS_STANDBY)
1715 d->target_bias_level = SND_SOC_BIAS_STANDBY;
1716 break;
1717 default:
1718 d->target_bias_level = SND_SOC_BIAS_ON;
1719 break;
1720 }
1721 }
1722
1723 }
1724
1725 /* Force all contexts in the card to the same bias state if
1726 * they're not ground referenced.
1727 */
1728 bias = SND_SOC_BIAS_OFF;
1729 list_for_each_entry(d, &card->dapm_list, list)
1730 if (d->target_bias_level > bias)
1731 bias = d->target_bias_level;
1732 list_for_each_entry(d, &card->dapm_list, list)
1733 if (!d->idle_bias_off)
1734 d->target_bias_level = bias;
1735
1736 trace_snd_soc_dapm_walk_done(card);
1737
1738 /* Run all the bias changes in parallel */
1739 list_for_each_entry(d, &dapm->card->dapm_list, list)
1740 async_schedule_domain(dapm_pre_sequence_async, d,
1741 &async_domain);
1742 async_synchronize_full_domain(&async_domain);
1743
1744 /* Power down widgets first; try to avoid amplifying pops. */
1745 dapm_seq_run(dapm, &down_list, event, false);
1746
1747 dapm_widget_update(dapm);
1748
1749 /* Now power up. */
1750 dapm_seq_run(dapm, &up_list, event, true);
1751
1752 /* Run all the bias changes in parallel */
1753 list_for_each_entry(d, &dapm->card->dapm_list, list)
1754 async_schedule_domain(dapm_post_sequence_async, d,
1755 &async_domain);
1756 async_synchronize_full_domain(&async_domain);
1757
1758 /* do we need to notify any clients that DAPM event is complete */
1759 list_for_each_entry(d, &card->dapm_list, list) {
1760 if (d->stream_event)
1761 d->stream_event(d, event);
1762 }
1763
1764 pop_dbg(dapm->dev, card->pop_time,
1765 "DAPM sequencing finished, waiting %dms\n", card->pop_time);
1766 pop_wait(card->pop_time);
1767
1768 trace_snd_soc_dapm_done(card);
1769
1770 return 0;
1771 }
1772
1773 #ifdef CONFIG_DEBUG_FS
1774 static ssize_t dapm_widget_power_read_file(struct file *file,
1775 char __user *user_buf,
1776 size_t count, loff_t *ppos)
1777 {
1778 struct snd_soc_dapm_widget *w = file->private_data;
1779 char *buf;
1780 int in, out;
1781 ssize_t ret;
1782 struct snd_soc_dapm_path *p = NULL;
1783
1784 buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
1785 if (!buf)
1786 return -ENOMEM;
1787
1788 in = is_connected_input_ep(w, NULL);
1789 dapm_clear_walk_input(w->dapm, &w->sources);
1790 out = is_connected_output_ep(w, NULL);
1791 dapm_clear_walk_output(w->dapm, &w->sinks);
1792
1793 ret = snprintf(buf, PAGE_SIZE, "%s: %s%s in %d out %d",
1794 w->name, w->power ? "On" : "Off",
1795 w->force ? " (forced)" : "", in, out);
1796
1797 if (w->reg >= 0)
1798 ret += snprintf(buf + ret, PAGE_SIZE - ret,
1799 " - R%d(0x%x) bit %d",
1800 w->reg, w->reg, w->shift);
1801
1802 ret += snprintf(buf + ret, PAGE_SIZE - ret, "\n");
1803
1804 if (w->sname)
1805 ret += snprintf(buf + ret, PAGE_SIZE - ret, " stream %s %s\n",
1806 w->sname,
1807 w->active ? "active" : "inactive");
1808
1809 list_for_each_entry(p, &w->sources, list_sink) {
1810 if (p->connected && !p->connected(w, p->sink))
1811 continue;
1812
1813 if (p->connect)
1814 ret += snprintf(buf + ret, PAGE_SIZE - ret,
1815 " in \"%s\" \"%s\"\n",
1816 p->name ? p->name : "static",
1817 p->source->name);
1818 }
1819 list_for_each_entry(p, &w->sinks, list_source) {
1820 if (p->connected && !p->connected(w, p->sink))
1821 continue;
1822
1823 if (p->connect)
1824 ret += snprintf(buf + ret, PAGE_SIZE - ret,
1825 " out \"%s\" \"%s\"\n",
1826 p->name ? p->name : "static",
1827 p->sink->name);
1828 }
1829
1830 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
1831
1832 kfree(buf);
1833 return ret;
1834 }
1835
1836 static const struct file_operations dapm_widget_power_fops = {
1837 .open = simple_open,
1838 .read = dapm_widget_power_read_file,
1839 .llseek = default_llseek,
1840 };
1841
1842 static ssize_t dapm_bias_read_file(struct file *file, char __user *user_buf,
1843 size_t count, loff_t *ppos)
1844 {
1845 struct snd_soc_dapm_context *dapm = file->private_data;
1846 char *level;
1847
1848 switch (dapm->bias_level) {
1849 case SND_SOC_BIAS_ON:
1850 level = "On\n";
1851 break;
1852 case SND_SOC_BIAS_PREPARE:
1853 level = "Prepare\n";
1854 break;
1855 case SND_SOC_BIAS_STANDBY:
1856 level = "Standby\n";
1857 break;
1858 case SND_SOC_BIAS_OFF:
1859 level = "Off\n";
1860 break;
1861 default:
1862 BUG();
1863 level = "Unknown\n";
1864 break;
1865 }
1866
1867 return simple_read_from_buffer(user_buf, count, ppos, level,
1868 strlen(level));
1869 }
1870
1871 static const struct file_operations dapm_bias_fops = {
1872 .open = simple_open,
1873 .read = dapm_bias_read_file,
1874 .llseek = default_llseek,
1875 };
1876
1877 void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
1878 struct dentry *parent)
1879 {
1880 struct dentry *d;
1881
1882 dapm->debugfs_dapm = debugfs_create_dir("dapm", parent);
1883
1884 if (!dapm->debugfs_dapm) {
1885 dev_warn(dapm->dev,
1886 "ASoC: Failed to create DAPM debugfs directory\n");
1887 return;
1888 }
1889
1890 d = debugfs_create_file("bias_level", 0444,
1891 dapm->debugfs_dapm, dapm,
1892 &dapm_bias_fops);
1893 if (!d)
1894 dev_warn(dapm->dev,
1895 "ASoC: Failed to create bias level debugfs file\n");
1896 }
1897
1898 static void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
1899 {
1900 struct snd_soc_dapm_context *dapm = w->dapm;
1901 struct dentry *d;
1902
1903 if (!dapm->debugfs_dapm || !w->name)
1904 return;
1905
1906 d = debugfs_create_file(w->name, 0444,
1907 dapm->debugfs_dapm, w,
1908 &dapm_widget_power_fops);
1909 if (!d)
1910 dev_warn(w->dapm->dev,
1911 "ASoC: Failed to create %s debugfs file\n",
1912 w->name);
1913 }
1914
1915 static void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
1916 {
1917 debugfs_remove_recursive(dapm->debugfs_dapm);
1918 }
1919
1920 #else
1921 void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
1922 struct dentry *parent)
1923 {
1924 }
1925
1926 static inline void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
1927 {
1928 }
1929
1930 static inline void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
1931 {
1932 }
1933
1934 #endif
1935
1936 /* test and update the power status of a mux widget */
1937 static int soc_dapm_mux_update_power(struct snd_soc_dapm_widget *widget,
1938 struct snd_kcontrol *kcontrol, int mux, struct soc_enum *e)
1939 {
1940 struct snd_soc_dapm_path *path;
1941 int found = 0;
1942
1943 if (widget->id != snd_soc_dapm_mux &&
1944 widget->id != snd_soc_dapm_virt_mux &&
1945 widget->id != snd_soc_dapm_value_mux)
1946 return -ENODEV;
1947
1948 /* find dapm widget path assoc with kcontrol */
1949 list_for_each_entry(path, &widget->dapm->card->paths, list) {
1950 if (path->kcontrol != kcontrol)
1951 continue;
1952
1953 if (!path->name || !e->texts[mux])
1954 continue;
1955
1956 found = 1;
1957 /* we now need to match the string in the enum to the path */
1958 if (!(strcmp(path->name, e->texts[mux]))) {
1959 path->connect = 1; /* new connection */
1960 dapm_mark_dirty(path->source, "mux connection");
1961 } else {
1962 if (path->connect)
1963 dapm_mark_dirty(path->source,
1964 "mux disconnection");
1965 path->connect = 0; /* old connection must be powered down */
1966 }
1967 }
1968
1969 if (found) {
1970 dapm_mark_dirty(widget, "mux change");
1971 dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
1972 }
1973
1974 return found;
1975 }
1976
1977 int snd_soc_dapm_mux_update_power(struct snd_soc_dapm_widget *widget,
1978 struct snd_kcontrol *kcontrol, int mux, struct soc_enum *e)
1979 {
1980 struct snd_soc_card *card = widget->dapm->card;
1981 int ret;
1982
1983 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
1984 ret = soc_dapm_mux_update_power(widget, kcontrol, mux, e);
1985 mutex_unlock(&card->dapm_mutex);
1986 if (ret > 0)
1987 soc_dpcm_runtime_update(widget);
1988 return ret;
1989 }
1990 EXPORT_SYMBOL_GPL(snd_soc_dapm_mux_update_power);
1991
1992 /* test and update the power status of a mixer or switch widget */
1993 static int soc_dapm_mixer_update_power(struct snd_soc_dapm_widget *widget,
1994 struct snd_kcontrol *kcontrol, int connect)
1995 {
1996 struct snd_soc_dapm_path *path;
1997 int found = 0;
1998
1999 if (widget->id != snd_soc_dapm_mixer &&
2000 widget->id != snd_soc_dapm_mixer_named_ctl &&
2001 widget->id != snd_soc_dapm_switch)
2002 return -ENODEV;
2003
2004 /* find dapm widget path assoc with kcontrol */
2005 list_for_each_entry(path, &widget->dapm->card->paths, list) {
2006 if (path->kcontrol != kcontrol)
2007 continue;
2008
2009 /* found, now check type */
2010 found = 1;
2011 path->connect = connect;
2012 dapm_mark_dirty(path->source, "mixer connection");
2013 }
2014
2015 if (found) {
2016 dapm_mark_dirty(widget, "mixer update");
2017 dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
2018 }
2019
2020 return found;
2021 }
2022
2023 int snd_soc_dapm_mixer_update_power(struct snd_soc_dapm_widget *widget,
2024 struct snd_kcontrol *kcontrol, int connect)
2025 {
2026 struct snd_soc_card *card = widget->dapm->card;
2027 int ret;
2028
2029 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2030 ret = soc_dapm_mixer_update_power(widget, kcontrol, connect);
2031 mutex_unlock(&card->dapm_mutex);
2032 if (ret > 0)
2033 soc_dpcm_runtime_update(widget);
2034 return ret;
2035 }
2036 EXPORT_SYMBOL_GPL(snd_soc_dapm_mixer_update_power);
2037
2038 /* show dapm widget status in sys fs */
2039 static ssize_t dapm_widget_show(struct device *dev,
2040 struct device_attribute *attr, char *buf)
2041 {
2042 struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
2043 struct snd_soc_codec *codec =rtd->codec;
2044 struct snd_soc_dapm_widget *w;
2045 int count = 0;
2046 char *state = "not set";
2047
2048 list_for_each_entry(w, &codec->card->widgets, list) {
2049 if (w->dapm != &codec->dapm)
2050 continue;
2051
2052 /* only display widgets that burnm power */
2053 switch (w->id) {
2054 case snd_soc_dapm_hp:
2055 case snd_soc_dapm_mic:
2056 case snd_soc_dapm_spk:
2057 case snd_soc_dapm_line:
2058 case snd_soc_dapm_micbias:
2059 case snd_soc_dapm_dac:
2060 case snd_soc_dapm_adc:
2061 case snd_soc_dapm_pga:
2062 case snd_soc_dapm_out_drv:
2063 case snd_soc_dapm_mixer:
2064 case snd_soc_dapm_mixer_named_ctl:
2065 case snd_soc_dapm_supply:
2066 case snd_soc_dapm_regulator_supply:
2067 case snd_soc_dapm_clock_supply:
2068 if (w->name)
2069 count += sprintf(buf + count, "%s: %s\n",
2070 w->name, w->power ? "On":"Off");
2071 break;
2072 default:
2073 break;
2074 }
2075 }
2076
2077 switch (codec->dapm.bias_level) {
2078 case SND_SOC_BIAS_ON:
2079 state = "On";
2080 break;
2081 case SND_SOC_BIAS_PREPARE:
2082 state = "Prepare";
2083 break;
2084 case SND_SOC_BIAS_STANDBY:
2085 state = "Standby";
2086 break;
2087 case SND_SOC_BIAS_OFF:
2088 state = "Off";
2089 break;
2090 }
2091 count += sprintf(buf + count, "PM State: %s\n", state);
2092
2093 return count;
2094 }
2095
2096 static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL);
2097
2098 int snd_soc_dapm_sys_add(struct device *dev)
2099 {
2100 return device_create_file(dev, &dev_attr_dapm_widget);
2101 }
2102
2103 static void snd_soc_dapm_sys_remove(struct device *dev)
2104 {
2105 device_remove_file(dev, &dev_attr_dapm_widget);
2106 }
2107
2108 static void dapm_free_path(struct snd_soc_dapm_path *path)
2109 {
2110 list_del(&path->list_sink);
2111 list_del(&path->list_source);
2112 list_del(&path->list);
2113 kfree(path->long_name);
2114 kfree(path);
2115 }
2116
2117 /* free all dapm widgets and resources */
2118 static void dapm_free_widgets(struct snd_soc_dapm_context *dapm)
2119 {
2120 struct snd_soc_dapm_widget *w, *next_w;
2121 struct snd_soc_dapm_path *p, *next_p;
2122
2123 list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) {
2124 if (w->dapm != dapm)
2125 continue;
2126 list_del(&w->list);
2127 /*
2128 * remove source and sink paths associated to this widget.
2129 * While removing the path, remove reference to it from both
2130 * source and sink widgets so that path is removed only once.
2131 */
2132 list_for_each_entry_safe(p, next_p, &w->sources, list_sink)
2133 dapm_free_path(p);
2134
2135 list_for_each_entry_safe(p, next_p, &w->sinks, list_source)
2136 dapm_free_path(p);
2137
2138 kfree(w->kcontrols);
2139 kfree(w->name);
2140 kfree(w);
2141 }
2142 }
2143
2144 static struct snd_soc_dapm_widget *dapm_find_widget(
2145 struct snd_soc_dapm_context *dapm, const char *pin,
2146 bool search_other_contexts)
2147 {
2148 struct snd_soc_dapm_widget *w;
2149 struct snd_soc_dapm_widget *fallback = NULL;
2150
2151 list_for_each_entry(w, &dapm->card->widgets, list) {
2152 if (!strcmp(w->name, pin)) {
2153 if (w->dapm == dapm)
2154 return w;
2155 else
2156 fallback = w;
2157 }
2158 }
2159
2160 if (search_other_contexts)
2161 return fallback;
2162
2163 return NULL;
2164 }
2165
2166 static int snd_soc_dapm_set_pin(struct snd_soc_dapm_context *dapm,
2167 const char *pin, int status)
2168 {
2169 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
2170
2171 if (!w) {
2172 dev_err(dapm->dev, "ASoC: DAPM unknown pin %s\n", pin);
2173 return -EINVAL;
2174 }
2175
2176 if (w->connected != status)
2177 dapm_mark_dirty(w, "pin configuration");
2178
2179 w->connected = status;
2180 if (status == 0)
2181 w->force = 0;
2182
2183 return 0;
2184 }
2185
2186 /**
2187 * snd_soc_dapm_sync - scan and power dapm paths
2188 * @dapm: DAPM context
2189 *
2190 * Walks all dapm audio paths and powers widgets according to their
2191 * stream or path usage.
2192 *
2193 * Returns 0 for success.
2194 */
2195 int snd_soc_dapm_sync(struct snd_soc_dapm_context *dapm)
2196 {
2197 int ret;
2198
2199 /*
2200 * Suppress early reports (eg, jacks syncing their state) to avoid
2201 * silly DAPM runs during card startup.
2202 */
2203 if (!dapm->card || !dapm->card->instantiated)
2204 return 0;
2205
2206 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2207 ret = dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
2208 mutex_unlock(&dapm->card->dapm_mutex);
2209 return ret;
2210 }
2211 EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
2212
2213 static int snd_soc_dapm_add_route(struct snd_soc_dapm_context *dapm,
2214 const struct snd_soc_dapm_route *route)
2215 {
2216 struct snd_soc_dapm_path *path;
2217 struct snd_soc_dapm_widget *wsource = NULL, *wsink = NULL, *w;
2218 struct snd_soc_dapm_widget *wtsource = NULL, *wtsink = NULL;
2219 const char *sink;
2220 const char *control = route->control;
2221 const char *source;
2222 char prefixed_sink[80];
2223 char prefixed_source[80];
2224 int ret = 0;
2225
2226 if (dapm->codec && dapm->codec->name_prefix) {
2227 snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
2228 dapm->codec->name_prefix, route->sink);
2229 sink = prefixed_sink;
2230 snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
2231 dapm->codec->name_prefix, route->source);
2232 source = prefixed_source;
2233 } else {
2234 sink = route->sink;
2235 source = route->source;
2236 }
2237
2238 /*
2239 * find src and dest widgets over all widgets but favor a widget from
2240 * current DAPM context
2241 */
2242 list_for_each_entry(w, &dapm->card->widgets, list) {
2243 if (!wsink && !(strcmp(w->name, sink))) {
2244 wtsink = w;
2245 if (w->dapm == dapm)
2246 wsink = w;
2247 continue;
2248 }
2249 if (!wsource && !(strcmp(w->name, source))) {
2250 wtsource = w;
2251 if (w->dapm == dapm)
2252 wsource = w;
2253 }
2254 }
2255 /* use widget from another DAPM context if not found from this */
2256 if (!wsink)
2257 wsink = wtsink;
2258 if (!wsource)
2259 wsource = wtsource;
2260
2261 if (wsource == NULL) {
2262 dev_err(dapm->dev, "ASoC: no source widget found for %s\n",
2263 route->source);
2264 return -ENODEV;
2265 }
2266 if (wsink == NULL) {
2267 dev_err(dapm->dev, "ASoC: no sink widget found for %s\n",
2268 route->sink);
2269 return -ENODEV;
2270 }
2271
2272 path = kzalloc(sizeof(struct snd_soc_dapm_path), GFP_KERNEL);
2273 if (!path)
2274 return -ENOMEM;
2275
2276 path->source = wsource;
2277 path->sink = wsink;
2278 path->connected = route->connected;
2279 INIT_LIST_HEAD(&path->list);
2280 INIT_LIST_HEAD(&path->list_source);
2281 INIT_LIST_HEAD(&path->list_sink);
2282
2283 /* check for external widgets */
2284 if (wsink->id == snd_soc_dapm_input) {
2285 if (wsource->id == snd_soc_dapm_micbias ||
2286 wsource->id == snd_soc_dapm_mic ||
2287 wsource->id == snd_soc_dapm_line ||
2288 wsource->id == snd_soc_dapm_output)
2289 wsink->ext = 1;
2290 }
2291 if (wsource->id == snd_soc_dapm_output) {
2292 if (wsink->id == snd_soc_dapm_spk ||
2293 wsink->id == snd_soc_dapm_hp ||
2294 wsink->id == snd_soc_dapm_line ||
2295 wsink->id == snd_soc_dapm_input)
2296 wsource->ext = 1;
2297 }
2298
2299 /* connect static paths */
2300 if (control == NULL) {
2301 list_add(&path->list, &dapm->card->paths);
2302 list_add(&path->list_sink, &wsink->sources);
2303 list_add(&path->list_source, &wsource->sinks);
2304 path->connect = 1;
2305 return 0;
2306 }
2307
2308 /* connect dynamic paths */
2309 switch (wsink->id) {
2310 case snd_soc_dapm_adc:
2311 case snd_soc_dapm_dac:
2312 case snd_soc_dapm_pga:
2313 case snd_soc_dapm_out_drv:
2314 case snd_soc_dapm_input:
2315 case snd_soc_dapm_output:
2316 case snd_soc_dapm_siggen:
2317 case snd_soc_dapm_micbias:
2318 case snd_soc_dapm_vmid:
2319 case snd_soc_dapm_pre:
2320 case snd_soc_dapm_post:
2321 case snd_soc_dapm_supply:
2322 case snd_soc_dapm_regulator_supply:
2323 case snd_soc_dapm_clock_supply:
2324 case snd_soc_dapm_aif_in:
2325 case snd_soc_dapm_aif_out:
2326 case snd_soc_dapm_dai:
2327 case snd_soc_dapm_dai_link:
2328 list_add(&path->list, &dapm->card->paths);
2329 list_add(&path->list_sink, &wsink->sources);
2330 list_add(&path->list_source, &wsource->sinks);
2331 path->connect = 1;
2332 return 0;
2333 case snd_soc_dapm_mux:
2334 case snd_soc_dapm_virt_mux:
2335 case snd_soc_dapm_value_mux:
2336 ret = dapm_connect_mux(dapm, wsource, wsink, path, control,
2337 &wsink->kcontrol_news[0]);
2338 if (ret != 0)
2339 goto err;
2340 break;
2341 case snd_soc_dapm_switch:
2342 case snd_soc_dapm_mixer:
2343 case snd_soc_dapm_mixer_named_ctl:
2344 ret = dapm_connect_mixer(dapm, wsource, wsink, path, control);
2345 if (ret != 0)
2346 goto err;
2347 break;
2348 case snd_soc_dapm_hp:
2349 case snd_soc_dapm_mic:
2350 case snd_soc_dapm_line:
2351 case snd_soc_dapm_spk:
2352 list_add(&path->list, &dapm->card->paths);
2353 list_add(&path->list_sink, &wsink->sources);
2354 list_add(&path->list_source, &wsource->sinks);
2355 path->connect = 0;
2356 return 0;
2357 }
2358
2359 dapm_mark_dirty(wsource, "Route added");
2360 dapm_mark_dirty(wsink, "Route added");
2361
2362 return 0;
2363
2364 err:
2365 dev_warn(dapm->dev, "ASoC: no dapm match for %s --> %s --> %s\n",
2366 source, control, sink);
2367 kfree(path);
2368 return ret;
2369 }
2370
2371 static int snd_soc_dapm_del_route(struct snd_soc_dapm_context *dapm,
2372 const struct snd_soc_dapm_route *route)
2373 {
2374 struct snd_soc_dapm_path *path, *p;
2375 const char *sink;
2376 const char *source;
2377 char prefixed_sink[80];
2378 char prefixed_source[80];
2379
2380 if (route->control) {
2381 dev_err(dapm->dev,
2382 "ASoC: Removal of routes with controls not supported\n");
2383 return -EINVAL;
2384 }
2385
2386 if (dapm->codec && dapm->codec->name_prefix) {
2387 snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
2388 dapm->codec->name_prefix, route->sink);
2389 sink = prefixed_sink;
2390 snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
2391 dapm->codec->name_prefix, route->source);
2392 source = prefixed_source;
2393 } else {
2394 sink = route->sink;
2395 source = route->source;
2396 }
2397
2398 path = NULL;
2399 list_for_each_entry(p, &dapm->card->paths, list) {
2400 if (strcmp(p->source->name, source) != 0)
2401 continue;
2402 if (strcmp(p->sink->name, sink) != 0)
2403 continue;
2404 path = p;
2405 break;
2406 }
2407
2408 if (path) {
2409 dapm_mark_dirty(path->source, "Route removed");
2410 dapm_mark_dirty(path->sink, "Route removed");
2411
2412 dapm_free_path(path);
2413 } else {
2414 dev_warn(dapm->dev, "ASoC: Route %s->%s does not exist\n",
2415 source, sink);
2416 }
2417
2418 return 0;
2419 }
2420
2421 /**
2422 * snd_soc_dapm_add_routes - Add routes between DAPM widgets
2423 * @dapm: DAPM context
2424 * @route: audio routes
2425 * @num: number of routes
2426 *
2427 * Connects 2 dapm widgets together via a named audio path. The sink is
2428 * the widget receiving the audio signal, whilst the source is the sender
2429 * of the audio signal.
2430 *
2431 * Returns 0 for success else error. On error all resources can be freed
2432 * with a call to snd_soc_card_free().
2433 */
2434 int snd_soc_dapm_add_routes(struct snd_soc_dapm_context *dapm,
2435 const struct snd_soc_dapm_route *route, int num)
2436 {
2437 int i, r, ret = 0;
2438
2439 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
2440 for (i = 0; i < num; i++) {
2441 r = snd_soc_dapm_add_route(dapm, route);
2442 if (r < 0) {
2443 dev_err(dapm->dev, "ASoC: Failed to add route %s -> %s -> %s\n",
2444 route->source,
2445 route->control ? route->control : "direct",
2446 route->sink);
2447 ret = r;
2448 }
2449 route++;
2450 }
2451 mutex_unlock(&dapm->card->dapm_mutex);
2452
2453 return ret;
2454 }
2455 EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);
2456
2457 /**
2458 * snd_soc_dapm_del_routes - Remove routes between DAPM widgets
2459 * @dapm: DAPM context
2460 * @route: audio routes
2461 * @num: number of routes
2462 *
2463 * Removes routes from the DAPM context.
2464 */
2465 int snd_soc_dapm_del_routes(struct snd_soc_dapm_context *dapm,
2466 const struct snd_soc_dapm_route *route, int num)
2467 {
2468 int i, ret = 0;
2469
2470 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
2471 for (i = 0; i < num; i++) {
2472 snd_soc_dapm_del_route(dapm, route);
2473 route++;
2474 }
2475 mutex_unlock(&dapm->card->dapm_mutex);
2476
2477 return ret;
2478 }
2479 EXPORT_SYMBOL_GPL(snd_soc_dapm_del_routes);
2480
2481 static int snd_soc_dapm_weak_route(struct snd_soc_dapm_context *dapm,
2482 const struct snd_soc_dapm_route *route)
2483 {
2484 struct snd_soc_dapm_widget *source = dapm_find_widget(dapm,
2485 route->source,
2486 true);
2487 struct snd_soc_dapm_widget *sink = dapm_find_widget(dapm,
2488 route->sink,
2489 true);
2490 struct snd_soc_dapm_path *path;
2491 int count = 0;
2492
2493 if (!source) {
2494 dev_err(dapm->dev, "ASoC: Unable to find source %s for weak route\n",
2495 route->source);
2496 return -ENODEV;
2497 }
2498
2499 if (!sink) {
2500 dev_err(dapm->dev, "ASoC: Unable to find sink %s for weak route\n",
2501 route->sink);
2502 return -ENODEV;
2503 }
2504
2505 if (route->control || route->connected)
2506 dev_warn(dapm->dev, "ASoC: Ignoring control for weak route %s->%s\n",
2507 route->source, route->sink);
2508
2509 list_for_each_entry(path, &source->sinks, list_source) {
2510 if (path->sink == sink) {
2511 path->weak = 1;
2512 count++;
2513 }
2514 }
2515
2516 if (count == 0)
2517 dev_err(dapm->dev, "ASoC: No path found for weak route %s->%s\n",
2518 route->source, route->sink);
2519 if (count > 1)
2520 dev_warn(dapm->dev, "ASoC: %d paths found for weak route %s->%s\n",
2521 count, route->source, route->sink);
2522
2523 return 0;
2524 }
2525
2526 /**
2527 * snd_soc_dapm_weak_routes - Mark routes between DAPM widgets as weak
2528 * @dapm: DAPM context
2529 * @route: audio routes
2530 * @num: number of routes
2531 *
2532 * Mark existing routes matching those specified in the passed array
2533 * as being weak, meaning that they are ignored for the purpose of
2534 * power decisions. The main intended use case is for sidetone paths
2535 * which couple audio between other independent paths if they are both
2536 * active in order to make the combination work better at the user
2537 * level but which aren't intended to be "used".
2538 *
2539 * Note that CODEC drivers should not use this as sidetone type paths
2540 * can frequently also be used as bypass paths.
2541 */
2542 int snd_soc_dapm_weak_routes(struct snd_soc_dapm_context *dapm,
2543 const struct snd_soc_dapm_route *route, int num)
2544 {
2545 int i, err;
2546 int ret = 0;
2547
2548 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
2549 for (i = 0; i < num; i++) {
2550 err = snd_soc_dapm_weak_route(dapm, route);
2551 if (err)
2552 ret = err;
2553 route++;
2554 }
2555 mutex_unlock(&dapm->card->dapm_mutex);
2556
2557 return ret;
2558 }
2559 EXPORT_SYMBOL_GPL(snd_soc_dapm_weak_routes);
2560
2561 /**
2562 * snd_soc_dapm_new_widgets - add new dapm widgets
2563 * @dapm: DAPM context
2564 *
2565 * Checks the codec for any new dapm widgets and creates them if found.
2566 *
2567 * Returns 0 for success.
2568 */
2569 int snd_soc_dapm_new_widgets(struct snd_soc_dapm_context *dapm)
2570 {
2571 struct snd_soc_dapm_widget *w;
2572 unsigned int val;
2573
2574 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
2575
2576 list_for_each_entry(w, &dapm->card->widgets, list)
2577 {
2578 if (w->new)
2579 continue;
2580
2581 if (w->num_kcontrols) {
2582 w->kcontrols = kzalloc(w->num_kcontrols *
2583 sizeof(struct snd_kcontrol *),
2584 GFP_KERNEL);
2585 if (!w->kcontrols) {
2586 mutex_unlock(&dapm->card->dapm_mutex);
2587 return -ENOMEM;
2588 }
2589 }
2590
2591 switch(w->id) {
2592 case snd_soc_dapm_switch:
2593 case snd_soc_dapm_mixer:
2594 case snd_soc_dapm_mixer_named_ctl:
2595 dapm_new_mixer(w);
2596 break;
2597 case snd_soc_dapm_mux:
2598 case snd_soc_dapm_virt_mux:
2599 case snd_soc_dapm_value_mux:
2600 dapm_new_mux(w);
2601 break;
2602 case snd_soc_dapm_pga:
2603 case snd_soc_dapm_out_drv:
2604 dapm_new_pga(w);
2605 break;
2606 default:
2607 break;
2608 }
2609
2610 /* Read the initial power state from the device */
2611 if (w->reg >= 0) {
2612 val = soc_widget_read(w, w->reg);
2613 val &= 1 << w->shift;
2614 if (w->invert)
2615 val = !val;
2616
2617 if (val)
2618 w->power = 1;
2619 }
2620
2621 w->new = 1;
2622
2623 dapm_mark_dirty(w, "new widget");
2624 dapm_debugfs_add_widget(w);
2625 }
2626
2627 dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
2628 mutex_unlock(&dapm->card->dapm_mutex);
2629 return 0;
2630 }
2631 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_widgets);
2632
2633 /**
2634 * snd_soc_dapm_get_volsw - dapm mixer get callback
2635 * @kcontrol: mixer control
2636 * @ucontrol: control element information
2637 *
2638 * Callback to get the value of a dapm mixer control.
2639 *
2640 * Returns 0 for success.
2641 */
2642 int snd_soc_dapm_get_volsw(struct snd_kcontrol *kcontrol,
2643 struct snd_ctl_elem_value *ucontrol)
2644 {
2645 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2646 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2647 struct soc_mixer_control *mc =
2648 (struct soc_mixer_control *)kcontrol->private_value;
2649 unsigned int reg = mc->reg;
2650 unsigned int shift = mc->shift;
2651 int max = mc->max;
2652 unsigned int mask = (1 << fls(max)) - 1;
2653 unsigned int invert = mc->invert;
2654
2655 if (snd_soc_volsw_is_stereo(mc))
2656 dev_warn(widget->dapm->dev,
2657 "ASoC: Control '%s' is stereo, which is not supported\n",
2658 kcontrol->id.name);
2659
2660 ucontrol->value.integer.value[0] =
2661 (snd_soc_read(widget->codec, reg) >> shift) & mask;
2662 if (invert)
2663 ucontrol->value.integer.value[0] =
2664 max - ucontrol->value.integer.value[0];
2665
2666 return 0;
2667 }
2668 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);
2669
2670 /**
2671 * snd_soc_dapm_put_volsw - dapm mixer set callback
2672 * @kcontrol: mixer control
2673 * @ucontrol: control element information
2674 *
2675 * Callback to set the value of a dapm mixer control.
2676 *
2677 * Returns 0 for success.
2678 */
2679 int snd_soc_dapm_put_volsw(struct snd_kcontrol *kcontrol,
2680 struct snd_ctl_elem_value *ucontrol)
2681 {
2682 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2683 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2684 struct snd_soc_codec *codec = widget->codec;
2685 struct snd_soc_card *card = codec->card;
2686 struct soc_mixer_control *mc =
2687 (struct soc_mixer_control *)kcontrol->private_value;
2688 unsigned int reg = mc->reg;
2689 unsigned int shift = mc->shift;
2690 int max = mc->max;
2691 unsigned int mask = (1 << fls(max)) - 1;
2692 unsigned int invert = mc->invert;
2693 unsigned int val;
2694 int connect, change;
2695 struct snd_soc_dapm_update update;
2696 int wi;
2697
2698 if (snd_soc_volsw_is_stereo(mc))
2699 dev_warn(widget->dapm->dev,
2700 "ASoC: Control '%s' is stereo, which is not supported\n",
2701 kcontrol->id.name);
2702
2703 val = (ucontrol->value.integer.value[0] & mask);
2704 connect = !!val;
2705
2706 if (invert)
2707 val = max - val;
2708 mask = mask << shift;
2709 val = val << shift;
2710
2711 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2712
2713 change = snd_soc_test_bits(widget->codec, reg, mask, val);
2714 if (change) {
2715 for (wi = 0; wi < wlist->num_widgets; wi++) {
2716 widget = wlist->widgets[wi];
2717
2718 widget->value = val;
2719
2720 update.kcontrol = kcontrol;
2721 update.widget = widget;
2722 update.reg = reg;
2723 update.mask = mask;
2724 update.val = val;
2725 widget->dapm->update = &update;
2726
2727 soc_dapm_mixer_update_power(widget, kcontrol, connect);
2728
2729 widget->dapm->update = NULL;
2730 }
2731 }
2732
2733 mutex_unlock(&card->dapm_mutex);
2734 return 0;
2735 }
2736 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_volsw);
2737
2738 /**
2739 * snd_soc_dapm_get_enum_double - dapm enumerated double mixer get callback
2740 * @kcontrol: mixer control
2741 * @ucontrol: control element information
2742 *
2743 * Callback to get the value of a dapm enumerated double mixer control.
2744 *
2745 * Returns 0 for success.
2746 */
2747 int snd_soc_dapm_get_enum_double(struct snd_kcontrol *kcontrol,
2748 struct snd_ctl_elem_value *ucontrol)
2749 {
2750 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2751 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2752 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2753 unsigned int val;
2754
2755 val = snd_soc_read(widget->codec, e->reg);
2756 ucontrol->value.enumerated.item[0] = (val >> e->shift_l) & e->mask;
2757 if (e->shift_l != e->shift_r)
2758 ucontrol->value.enumerated.item[1] =
2759 (val >> e->shift_r) & e->mask;
2760
2761 return 0;
2762 }
2763 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);
2764
2765 /**
2766 * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
2767 * @kcontrol: mixer control
2768 * @ucontrol: control element information
2769 *
2770 * Callback to set the value of a dapm enumerated double mixer control.
2771 *
2772 * Returns 0 for success.
2773 */
2774 int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
2775 struct snd_ctl_elem_value *ucontrol)
2776 {
2777 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2778 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2779 struct snd_soc_codec *codec = widget->codec;
2780 struct snd_soc_card *card = codec->card;
2781 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2782 unsigned int val, mux, change;
2783 unsigned int mask;
2784 struct snd_soc_dapm_update update;
2785 int wi;
2786
2787 if (ucontrol->value.enumerated.item[0] > e->max - 1)
2788 return -EINVAL;
2789 mux = ucontrol->value.enumerated.item[0];
2790 val = mux << e->shift_l;
2791 mask = e->mask << e->shift_l;
2792 if (e->shift_l != e->shift_r) {
2793 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2794 return -EINVAL;
2795 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
2796 mask |= e->mask << e->shift_r;
2797 }
2798
2799 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2800
2801 change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
2802 if (change) {
2803 for (wi = 0; wi < wlist->num_widgets; wi++) {
2804 widget = wlist->widgets[wi];
2805
2806 widget->value = val;
2807
2808 update.kcontrol = kcontrol;
2809 update.widget = widget;
2810 update.reg = e->reg;
2811 update.mask = mask;
2812 update.val = val;
2813 widget->dapm->update = &update;
2814
2815 soc_dapm_mux_update_power(widget, kcontrol, mux, e);
2816
2817 widget->dapm->update = NULL;
2818 }
2819 }
2820
2821 mutex_unlock(&card->dapm_mutex);
2822 return change;
2823 }
2824 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);
2825
2826 /**
2827 * snd_soc_dapm_get_enum_virt - Get virtual DAPM mux
2828 * @kcontrol: mixer control
2829 * @ucontrol: control element information
2830 *
2831 * Returns 0 for success.
2832 */
2833 int snd_soc_dapm_get_enum_virt(struct snd_kcontrol *kcontrol,
2834 struct snd_ctl_elem_value *ucontrol)
2835 {
2836 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2837 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2838
2839 ucontrol->value.enumerated.item[0] = widget->value;
2840
2841 return 0;
2842 }
2843 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_virt);
2844
2845 /**
2846 * snd_soc_dapm_put_enum_virt - Set virtual DAPM mux
2847 * @kcontrol: mixer control
2848 * @ucontrol: control element information
2849 *
2850 * Returns 0 for success.
2851 */
2852 int snd_soc_dapm_put_enum_virt(struct snd_kcontrol *kcontrol,
2853 struct snd_ctl_elem_value *ucontrol)
2854 {
2855 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2856 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2857 struct snd_soc_codec *codec = widget->codec;
2858 struct snd_soc_card *card = codec->card;
2859 struct soc_enum *e =
2860 (struct soc_enum *)kcontrol->private_value;
2861 int change;
2862 int ret = 0;
2863 int wi;
2864
2865 if (ucontrol->value.enumerated.item[0] >= e->max)
2866 return -EINVAL;
2867
2868 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2869
2870 change = widget->value != ucontrol->value.enumerated.item[0];
2871 if (change) {
2872 for (wi = 0; wi < wlist->num_widgets; wi++) {
2873 widget = wlist->widgets[wi];
2874
2875 widget->value = ucontrol->value.enumerated.item[0];
2876
2877 soc_dapm_mux_update_power(widget, kcontrol, widget->value, e);
2878 }
2879 }
2880
2881 mutex_unlock(&card->dapm_mutex);
2882 return ret;
2883 }
2884 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_virt);
2885
2886 /**
2887 * snd_soc_dapm_get_value_enum_double - dapm semi enumerated double mixer get
2888 * callback
2889 * @kcontrol: mixer control
2890 * @ucontrol: control element information
2891 *
2892 * Callback to get the value of a dapm semi enumerated double mixer control.
2893 *
2894 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2895 * used for handling bitfield coded enumeration for example.
2896 *
2897 * Returns 0 for success.
2898 */
2899 int snd_soc_dapm_get_value_enum_double(struct snd_kcontrol *kcontrol,
2900 struct snd_ctl_elem_value *ucontrol)
2901 {
2902 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2903 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2904 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2905 unsigned int reg_val, val, mux;
2906
2907 reg_val = snd_soc_read(widget->codec, e->reg);
2908 val = (reg_val >> e->shift_l) & e->mask;
2909 for (mux = 0; mux < e->max; mux++) {
2910 if (val == e->values[mux])
2911 break;
2912 }
2913 ucontrol->value.enumerated.item[0] = mux;
2914 if (e->shift_l != e->shift_r) {
2915 val = (reg_val >> e->shift_r) & e->mask;
2916 for (mux = 0; mux < e->max; mux++) {
2917 if (val == e->values[mux])
2918 break;
2919 }
2920 ucontrol->value.enumerated.item[1] = mux;
2921 }
2922
2923 return 0;
2924 }
2925 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_value_enum_double);
2926
2927 /**
2928 * snd_soc_dapm_put_value_enum_double - dapm semi enumerated double mixer set
2929 * callback
2930 * @kcontrol: mixer control
2931 * @ucontrol: control element information
2932 *
2933 * Callback to set the value of a dapm semi enumerated double mixer control.
2934 *
2935 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2936 * used for handling bitfield coded enumeration for example.
2937 *
2938 * Returns 0 for success.
2939 */
2940 int snd_soc_dapm_put_value_enum_double(struct snd_kcontrol *kcontrol,
2941 struct snd_ctl_elem_value *ucontrol)
2942 {
2943 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2944 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2945 struct snd_soc_codec *codec = widget->codec;
2946 struct snd_soc_card *card = codec->card;
2947 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2948 unsigned int val, mux, change;
2949 unsigned int mask;
2950 struct snd_soc_dapm_update update;
2951 int wi;
2952
2953 if (ucontrol->value.enumerated.item[0] > e->max - 1)
2954 return -EINVAL;
2955 mux = ucontrol->value.enumerated.item[0];
2956 val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
2957 mask = e->mask << e->shift_l;
2958 if (e->shift_l != e->shift_r) {
2959 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2960 return -EINVAL;
2961 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
2962 mask |= e->mask << e->shift_r;
2963 }
2964
2965 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2966
2967 change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
2968 if (change) {
2969 for (wi = 0; wi < wlist->num_widgets; wi++) {
2970 widget = wlist->widgets[wi];
2971
2972 widget->value = val;
2973
2974 update.kcontrol = kcontrol;
2975 update.widget = widget;
2976 update.reg = e->reg;
2977 update.mask = mask;
2978 update.val = val;
2979 widget->dapm->update = &update;
2980
2981 soc_dapm_mux_update_power(widget, kcontrol, mux, e);
2982
2983 widget->dapm->update = NULL;
2984 }
2985 }
2986
2987 mutex_unlock(&card->dapm_mutex);
2988 return change;
2989 }
2990 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_value_enum_double);
2991
2992 /**
2993 * snd_soc_dapm_info_pin_switch - Info for a pin switch
2994 *
2995 * @kcontrol: mixer control
2996 * @uinfo: control element information
2997 *
2998 * Callback to provide information about a pin switch control.
2999 */
3000 int snd_soc_dapm_info_pin_switch(struct snd_kcontrol *kcontrol,
3001 struct snd_ctl_elem_info *uinfo)
3002 {
3003 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
3004 uinfo->count = 1;
3005 uinfo->value.integer.min = 0;
3006 uinfo->value.integer.max = 1;
3007
3008 return 0;
3009 }
3010 EXPORT_SYMBOL_GPL(snd_soc_dapm_info_pin_switch);
3011
3012 /**
3013 * snd_soc_dapm_get_pin_switch - Get information for a pin switch
3014 *
3015 * @kcontrol: mixer control
3016 * @ucontrol: Value
3017 */
3018 int snd_soc_dapm_get_pin_switch(struct snd_kcontrol *kcontrol,
3019 struct snd_ctl_elem_value *ucontrol)
3020 {
3021 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
3022 const char *pin = (const char *)kcontrol->private_value;
3023
3024 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3025
3026 ucontrol->value.integer.value[0] =
3027 snd_soc_dapm_get_pin_status(&card->dapm, pin);
3028
3029 mutex_unlock(&card->dapm_mutex);
3030
3031 return 0;
3032 }
3033 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_switch);
3034
3035 /**
3036 * snd_soc_dapm_put_pin_switch - Set information for a pin switch
3037 *
3038 * @kcontrol: mixer control
3039 * @ucontrol: Value
3040 */
3041 int snd_soc_dapm_put_pin_switch(struct snd_kcontrol *kcontrol,
3042 struct snd_ctl_elem_value *ucontrol)
3043 {
3044 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
3045 const char *pin = (const char *)kcontrol->private_value;
3046
3047 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3048
3049 if (ucontrol->value.integer.value[0])
3050 snd_soc_dapm_enable_pin(&card->dapm, pin);
3051 else
3052 snd_soc_dapm_disable_pin(&card->dapm, pin);
3053
3054 mutex_unlock(&card->dapm_mutex);
3055
3056 snd_soc_dapm_sync(&card->dapm);
3057 return 0;
3058 }
3059 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);
3060
3061 static struct snd_soc_dapm_widget *
3062 snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
3063 const struct snd_soc_dapm_widget *widget)
3064 {
3065 struct snd_soc_dapm_widget *w;
3066 size_t name_len;
3067 int ret;
3068
3069 if ((w = dapm_cnew_widget(widget)) == NULL)
3070 return NULL;
3071
3072 switch (w->id) {
3073 case snd_soc_dapm_regulator_supply:
3074 w->regulator = devm_regulator_get(dapm->dev, w->name);
3075 if (IS_ERR(w->regulator)) {
3076 ret = PTR_ERR(w->regulator);
3077 dev_err(dapm->dev, "ASoC: Failed to request %s: %d\n",
3078 w->name, ret);
3079 return NULL;
3080 }
3081
3082 if (w->invert & SND_SOC_DAPM_REGULATOR_BYPASS) {
3083 ret = regulator_allow_bypass(w->regulator, true);
3084 if (ret != 0)
3085 dev_warn(w->dapm->dev,
3086 "ASoC: Failed to unbypass %s: %d\n",
3087 w->name, ret);
3088 }
3089 break;
3090 case snd_soc_dapm_clock_supply:
3091 #ifdef CONFIG_CLKDEV_LOOKUP
3092 w->clk = devm_clk_get(dapm->dev, w->name);
3093 if (IS_ERR(w->clk)) {
3094 ret = PTR_ERR(w->clk);
3095 dev_err(dapm->dev, "ASoC: Failed to request %s: %d\n",
3096 w->name, ret);
3097 return NULL;
3098 }
3099 #else
3100 return NULL;
3101 #endif
3102 break;
3103 default:
3104 break;
3105 }
3106
3107 name_len = strlen(widget->name) + 1;
3108 if (dapm->codec && dapm->codec->name_prefix)
3109 name_len += 1 + strlen(dapm->codec->name_prefix);
3110 w->name = kmalloc(name_len, GFP_KERNEL);
3111 if (w->name == NULL) {
3112 kfree(w);
3113 return NULL;
3114 }
3115 if (dapm->codec && dapm->codec->name_prefix)
3116 snprintf((char *)w->name, name_len, "%s %s",
3117 dapm->codec->name_prefix, widget->name);
3118 else
3119 snprintf((char *)w->name, name_len, "%s", widget->name);
3120
3121 switch (w->id) {
3122 case snd_soc_dapm_switch:
3123 case snd_soc_dapm_mixer:
3124 case snd_soc_dapm_mixer_named_ctl:
3125 w->power_check = dapm_generic_check_power;
3126 break;
3127 case snd_soc_dapm_mux:
3128 case snd_soc_dapm_virt_mux:
3129 case snd_soc_dapm_value_mux:
3130 w->power_check = dapm_generic_check_power;
3131 break;
3132 case snd_soc_dapm_adc:
3133 case snd_soc_dapm_aif_out:
3134 w->power_check = dapm_adc_check_power;
3135 break;
3136 case snd_soc_dapm_dac:
3137 case snd_soc_dapm_aif_in:
3138 w->power_check = dapm_dac_check_power;
3139 break;
3140 case snd_soc_dapm_pga:
3141 case snd_soc_dapm_out_drv:
3142 case snd_soc_dapm_input:
3143 case snd_soc_dapm_output:
3144 case snd_soc_dapm_micbias:
3145 case snd_soc_dapm_spk:
3146 case snd_soc_dapm_hp:
3147 case snd_soc_dapm_mic:
3148 case snd_soc_dapm_line:
3149 case snd_soc_dapm_dai_link:
3150 w->power_check = dapm_generic_check_power;
3151 break;
3152 case snd_soc_dapm_supply:
3153 case snd_soc_dapm_regulator_supply:
3154 case snd_soc_dapm_clock_supply:
3155 w->power_check = dapm_supply_check_power;
3156 break;
3157 case snd_soc_dapm_dai:
3158 w->power_check = dapm_dai_check_power;
3159 break;
3160 default:
3161 w->power_check = dapm_always_on_check_power;
3162 break;
3163 }
3164
3165 w->dapm = dapm;
3166 w->codec = dapm->codec;
3167 w->platform = dapm->platform;
3168 INIT_LIST_HEAD(&w->sources);
3169 INIT_LIST_HEAD(&w->sinks);
3170 INIT_LIST_HEAD(&w->list);
3171 INIT_LIST_HEAD(&w->dirty);
3172 list_add(&w->list, &dapm->card->widgets);
3173
3174 /* machine layer set ups unconnected pins and insertions */
3175 w->connected = 1;
3176 return w;
3177 }
3178
3179 /**
3180 * snd_soc_dapm_new_controls - create new dapm controls
3181 * @dapm: DAPM context
3182 * @widget: widget array
3183 * @num: number of widgets
3184 *
3185 * Creates new DAPM controls based upon the templates.
3186 *
3187 * Returns 0 for success else error.
3188 */
3189 int snd_soc_dapm_new_controls(struct snd_soc_dapm_context *dapm,
3190 const struct snd_soc_dapm_widget *widget,
3191 int num)
3192 {
3193 struct snd_soc_dapm_widget *w;
3194 int i;
3195 int ret = 0;
3196
3197 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
3198 for (i = 0; i < num; i++) {
3199 w = snd_soc_dapm_new_control(dapm, widget);
3200 if (!w) {
3201 dev_err(dapm->dev,
3202 "ASoC: Failed to create DAPM control %s\n",
3203 widget->name);
3204 ret = -ENOMEM;
3205 break;
3206 }
3207 widget++;
3208 }
3209 mutex_unlock(&dapm->card->dapm_mutex);
3210 return ret;
3211 }
3212 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);
3213
3214 static int snd_soc_dai_link_event(struct snd_soc_dapm_widget *w,
3215 struct snd_kcontrol *kcontrol, int event)
3216 {
3217 struct snd_soc_dapm_path *source_p, *sink_p;
3218 struct snd_soc_dai *source, *sink;
3219 const struct snd_soc_pcm_stream *config = w->params;
3220 struct snd_pcm_substream substream;
3221 struct snd_pcm_hw_params *params = NULL;
3222 u64 fmt;
3223 int ret;
3224
3225 BUG_ON(!config);
3226 BUG_ON(list_empty(&w->sources) || list_empty(&w->sinks));
3227
3228 /* We only support a single source and sink, pick the first */
3229 source_p = list_first_entry(&w->sources, struct snd_soc_dapm_path,
3230 list_sink);
3231 sink_p = list_first_entry(&w->sinks, struct snd_soc_dapm_path,
3232 list_source);
3233
3234 BUG_ON(!source_p || !sink_p);
3235 BUG_ON(!sink_p->source || !source_p->sink);
3236 BUG_ON(!source_p->source || !sink_p->sink);
3237
3238 source = source_p->source->priv;
3239 sink = sink_p->sink->priv;
3240
3241 /* Be a little careful as we don't want to overflow the mask array */
3242 if (config->formats) {
3243 fmt = ffs(config->formats) - 1;
3244 } else {
3245 dev_warn(w->dapm->dev, "ASoC: Invalid format %llx specified\n",
3246 config->formats);
3247 fmt = 0;
3248 }
3249
3250 /* Currently very limited parameter selection */
3251 params = kzalloc(sizeof(*params), GFP_KERNEL);
3252 if (!params) {
3253 ret = -ENOMEM;
3254 goto out;
3255 }
3256 snd_mask_set(hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT), fmt);
3257
3258 hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->min =
3259 config->rate_min;
3260 hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->max =
3261 config->rate_max;
3262
3263 hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->min
3264 = config->channels_min;
3265 hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->max
3266 = config->channels_max;
3267
3268 memset(&substream, 0, sizeof(substream));
3269
3270 switch (event) {
3271 case SND_SOC_DAPM_PRE_PMU:
3272 if (source->driver->ops && source->driver->ops->hw_params) {
3273 substream.stream = SNDRV_PCM_STREAM_CAPTURE;
3274 ret = source->driver->ops->hw_params(&substream,
3275 params, source);
3276 if (ret != 0) {
3277 dev_err(source->dev,
3278 "ASoC: hw_params() failed: %d\n", ret);
3279 goto out;
3280 }
3281 }
3282
3283 if (sink->driver->ops && sink->driver->ops->hw_params) {
3284 substream.stream = SNDRV_PCM_STREAM_PLAYBACK;
3285 ret = sink->driver->ops->hw_params(&substream, params,
3286 sink);
3287 if (ret != 0) {
3288 dev_err(sink->dev,
3289 "ASoC: hw_params() failed: %d\n", ret);
3290 goto out;
3291 }
3292 }
3293 break;
3294
3295 case SND_SOC_DAPM_POST_PMU:
3296 ret = snd_soc_dai_digital_mute(sink, 0,
3297 SNDRV_PCM_STREAM_PLAYBACK);
3298 if (ret != 0 && ret != -ENOTSUPP)
3299 dev_warn(sink->dev, "ASoC: Failed to unmute: %d\n", ret);
3300 ret = 0;
3301 break;
3302
3303 case SND_SOC_DAPM_PRE_PMD:
3304 ret = snd_soc_dai_digital_mute(sink, 1,
3305 SNDRV_PCM_STREAM_PLAYBACK);
3306 if (ret != 0 && ret != -ENOTSUPP)
3307 dev_warn(sink->dev, "ASoC: Failed to mute: %d\n", ret);
3308 ret = 0;
3309 break;
3310
3311 default:
3312 BUG();
3313 return -EINVAL;
3314 }
3315
3316 out:
3317 kfree(params);
3318 return ret;
3319 }
3320
3321 int snd_soc_dapm_new_pcm(struct snd_soc_card *card,
3322 const struct snd_soc_pcm_stream *params,
3323 struct snd_soc_dapm_widget *source,
3324 struct snd_soc_dapm_widget *sink)
3325 {
3326 struct snd_soc_dapm_route routes[2];
3327 struct snd_soc_dapm_widget template;
3328 struct snd_soc_dapm_widget *w;
3329 size_t len;
3330 char *link_name;
3331
3332 len = strlen(source->name) + strlen(sink->name) + 2;
3333 link_name = devm_kzalloc(card->dev, len, GFP_KERNEL);
3334 if (!link_name)
3335 return -ENOMEM;
3336 snprintf(link_name, len, "%s-%s", source->name, sink->name);
3337
3338 memset(&template, 0, sizeof(template));
3339 template.reg = SND_SOC_NOPM;
3340 template.id = snd_soc_dapm_dai_link;
3341 template.name = link_name;
3342 template.event = snd_soc_dai_link_event;
3343 template.event_flags = SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
3344 SND_SOC_DAPM_PRE_PMD;
3345
3346 dev_dbg(card->dev, "ASoC: adding %s widget\n", link_name);
3347
3348 w = snd_soc_dapm_new_control(&card->dapm, &template);
3349 if (!w) {
3350 dev_err(card->dev, "ASoC: Failed to create %s widget\n",
3351 link_name);
3352 return -ENOMEM;
3353 }
3354
3355 w->params = params;
3356
3357 memset(&routes, 0, sizeof(routes));
3358
3359 routes[0].source = source->name;
3360 routes[0].sink = link_name;
3361 routes[1].source = link_name;
3362 routes[1].sink = sink->name;
3363
3364 return snd_soc_dapm_add_routes(&card->dapm, routes,
3365 ARRAY_SIZE(routes));
3366 }
3367
3368 int snd_soc_dapm_new_dai_widgets(struct snd_soc_dapm_context *dapm,
3369 struct snd_soc_dai *dai)
3370 {
3371 struct snd_soc_dapm_widget template;
3372 struct snd_soc_dapm_widget *w;
3373
3374 WARN_ON(dapm->dev != dai->dev);
3375
3376 memset(&template, 0, sizeof(template));
3377 template.reg = SND_SOC_NOPM;
3378
3379 if (dai->driver->playback.stream_name) {
3380 template.id = snd_soc_dapm_dai;
3381 template.name = dai->driver->playback.stream_name;
3382 template.sname = dai->driver->playback.stream_name;
3383
3384 dev_dbg(dai->dev, "ASoC: adding %s widget\n",
3385 template.name);
3386
3387 w = snd_soc_dapm_new_control(dapm, &template);
3388 if (!w) {
3389 dev_err(dapm->dev, "ASoC: Failed to create %s widget\n",
3390 dai->driver->playback.stream_name);
3391 }
3392
3393 w->priv = dai;
3394 dai->playback_widget = w;
3395 }
3396
3397 if (dai->driver->capture.stream_name) {
3398 template.id = snd_soc_dapm_dai;
3399 template.name = dai->driver->capture.stream_name;
3400 template.sname = dai->driver->capture.stream_name;
3401
3402 dev_dbg(dai->dev, "ASoC: adding %s widget\n",
3403 template.name);
3404
3405 w = snd_soc_dapm_new_control(dapm, &template);
3406 if (!w) {
3407 dev_err(dapm->dev, "ASoC: Failed to create %s widget\n",
3408 dai->driver->capture.stream_name);
3409 }
3410
3411 w->priv = dai;
3412 dai->capture_widget = w;
3413 }
3414
3415 return 0;
3416 }
3417
3418 int snd_soc_dapm_link_dai_widgets(struct snd_soc_card *card)
3419 {
3420 struct snd_soc_dapm_widget *dai_w, *w;
3421 struct snd_soc_dai *dai;
3422 struct snd_soc_dapm_route r;
3423
3424 memset(&r, 0, sizeof(r));
3425
3426 /* For each DAI widget... */
3427 list_for_each_entry(dai_w, &card->widgets, list) {
3428 if (dai_w->id != snd_soc_dapm_dai)
3429 continue;
3430
3431 dai = dai_w->priv;
3432
3433 /* ...find all widgets with the same stream and link them */
3434 list_for_each_entry(w, &card->widgets, list) {
3435 if (w->dapm != dai_w->dapm)
3436 continue;
3437
3438 if (w->id == snd_soc_dapm_dai)
3439 continue;
3440
3441 if (!w->sname)
3442 continue;
3443
3444 if (dai->driver->playback.stream_name &&
3445 strstr(w->sname,
3446 dai->driver->playback.stream_name)) {
3447 r.source = dai->playback_widget->name;
3448 r.sink = w->name;
3449 dev_dbg(dai->dev, "%s -> %s\n",
3450 r.source, r.sink);
3451
3452 snd_soc_dapm_add_route(w->dapm, &r);
3453 }
3454
3455 if (dai->driver->capture.stream_name &&
3456 strstr(w->sname,
3457 dai->driver->capture.stream_name)) {
3458 r.source = w->name;
3459 r.sink = dai->capture_widget->name;
3460 dev_dbg(dai->dev, "%s -> %s\n",
3461 r.source, r.sink);
3462
3463 snd_soc_dapm_add_route(w->dapm, &r);
3464 }
3465 }
3466 }
3467
3468 return 0;
3469 }
3470
3471 static void soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream,
3472 int event)
3473 {
3474
3475 struct snd_soc_dapm_widget *w_cpu, *w_codec;
3476 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
3477 struct snd_soc_dai *codec_dai = rtd->codec_dai;
3478
3479 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
3480 w_cpu = cpu_dai->playback_widget;
3481 w_codec = codec_dai->playback_widget;
3482 } else {
3483 w_cpu = cpu_dai->capture_widget;
3484 w_codec = codec_dai->capture_widget;
3485 }
3486
3487 if (w_cpu) {
3488
3489 dapm_mark_dirty(w_cpu, "stream event");
3490
3491 switch (event) {
3492 case SND_SOC_DAPM_STREAM_START:
3493 w_cpu->active = 1;
3494 break;
3495 case SND_SOC_DAPM_STREAM_STOP:
3496 w_cpu->active = 0;
3497 break;
3498 case SND_SOC_DAPM_STREAM_SUSPEND:
3499 case SND_SOC_DAPM_STREAM_RESUME:
3500 case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
3501 case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
3502 break;
3503 }
3504 }
3505
3506 if (w_codec) {
3507
3508 dapm_mark_dirty(w_codec, "stream event");
3509
3510 switch (event) {
3511 case SND_SOC_DAPM_STREAM_START:
3512 w_codec->active = 1;
3513 break;
3514 case SND_SOC_DAPM_STREAM_STOP:
3515 w_codec->active = 0;
3516 break;
3517 case SND_SOC_DAPM_STREAM_SUSPEND:
3518 case SND_SOC_DAPM_STREAM_RESUME:
3519 case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
3520 case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
3521 break;
3522 }
3523 }
3524
3525 dapm_power_widgets(&rtd->card->dapm, event);
3526 }
3527
3528 /**
3529 * snd_soc_dapm_stream_event - send a stream event to the dapm core
3530 * @rtd: PCM runtime data
3531 * @stream: stream name
3532 * @event: stream event
3533 *
3534 * Sends a stream event to the dapm core. The core then makes any
3535 * necessary widget power changes.
3536 *
3537 * Returns 0 for success else error.
3538 */
3539 void snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream,
3540 int event)
3541 {
3542 struct snd_soc_card *card = rtd->card;
3543
3544 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3545 soc_dapm_stream_event(rtd, stream, event);
3546 mutex_unlock(&card->dapm_mutex);
3547 }
3548
3549 /**
3550 * snd_soc_dapm_enable_pin - enable pin.
3551 * @dapm: DAPM context
3552 * @pin: pin name
3553 *
3554 * Enables input/output pin and its parents or children widgets iff there is
3555 * a valid audio route and active audio stream.
3556 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
3557 * do any widget power switching.
3558 */
3559 int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin)
3560 {
3561 return snd_soc_dapm_set_pin(dapm, pin, 1);
3562 }
3563 EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
3564
3565 /**
3566 * snd_soc_dapm_force_enable_pin - force a pin to be enabled
3567 * @dapm: DAPM context
3568 * @pin: pin name
3569 *
3570 * Enables input/output pin regardless of any other state. This is
3571 * intended for use with microphone bias supplies used in microphone
3572 * jack detection.
3573 *
3574 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
3575 * do any widget power switching.
3576 */
3577 int snd_soc_dapm_force_enable_pin(struct snd_soc_dapm_context *dapm,
3578 const char *pin)
3579 {
3580 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
3581
3582 if (!w) {
3583 dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin);
3584 return -EINVAL;
3585 }
3586
3587 dev_dbg(w->dapm->dev, "ASoC: force enable pin %s\n", pin);
3588 w->connected = 1;
3589 w->force = 1;
3590 dapm_mark_dirty(w, "force enable");
3591
3592 return 0;
3593 }
3594 EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin);
3595
3596 /**
3597 * snd_soc_dapm_disable_pin - disable pin.
3598 * @dapm: DAPM context
3599 * @pin: pin name
3600 *
3601 * Disables input/output pin and its parents or children widgets.
3602 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
3603 * do any widget power switching.
3604 */
3605 int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm,
3606 const char *pin)
3607 {
3608 return snd_soc_dapm_set_pin(dapm, pin, 0);
3609 }
3610 EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
3611
3612 /**
3613 * snd_soc_dapm_nc_pin - permanently disable pin.
3614 * @dapm: DAPM context
3615 * @pin: pin name
3616 *
3617 * Marks the specified pin as being not connected, disabling it along
3618 * any parent or child widgets. At present this is identical to
3619 * snd_soc_dapm_disable_pin() but in future it will be extended to do
3620 * additional things such as disabling controls which only affect
3621 * paths through the pin.
3622 *
3623 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
3624 * do any widget power switching.
3625 */
3626 int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin)
3627 {
3628 return snd_soc_dapm_set_pin(dapm, pin, 0);
3629 }
3630 EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);
3631
3632 /**
3633 * snd_soc_dapm_get_pin_status - get audio pin status
3634 * @dapm: DAPM context
3635 * @pin: audio signal pin endpoint (or start point)
3636 *
3637 * Get audio pin status - connected or disconnected.
3638 *
3639 * Returns 1 for connected otherwise 0.
3640 */
3641 int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm,
3642 const char *pin)
3643 {
3644 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
3645
3646 if (w)
3647 return w->connected;
3648
3649 return 0;
3650 }
3651 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
3652
3653 /**
3654 * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint
3655 * @dapm: DAPM context
3656 * @pin: audio signal pin endpoint (or start point)
3657 *
3658 * Mark the given endpoint or pin as ignoring suspend. When the
3659 * system is disabled a path between two endpoints flagged as ignoring
3660 * suspend will not be disabled. The path must already be enabled via
3661 * normal means at suspend time, it will not be turned on if it was not
3662 * already enabled.
3663 */
3664 int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm,
3665 const char *pin)
3666 {
3667 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, false);
3668
3669 if (!w) {
3670 dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin);
3671 return -EINVAL;
3672 }
3673
3674 w->ignore_suspend = 1;
3675
3676 return 0;
3677 }
3678 EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend);
3679
3680 static bool snd_soc_dapm_widget_in_card_paths(struct snd_soc_card *card,
3681 struct snd_soc_dapm_widget *w)
3682 {
3683 struct snd_soc_dapm_path *p;
3684
3685 list_for_each_entry(p, &card->paths, list) {
3686 if ((p->source == w) || (p->sink == w)) {
3687 dev_dbg(card->dev,
3688 "... Path %s(id:%d dapm:%p) - %s(id:%d dapm:%p)\n",
3689 p->source->name, p->source->id, p->source->dapm,
3690 p->sink->name, p->sink->id, p->sink->dapm);
3691
3692 /* Connected to something other than the codec */
3693 if (p->source->dapm != p->sink->dapm)
3694 return true;
3695 /*
3696 * Loopback connection from codec external pin to
3697 * codec external pin
3698 */
3699 if (p->sink->id == snd_soc_dapm_input) {
3700 switch (p->source->id) {
3701 case snd_soc_dapm_output:
3702 case snd_soc_dapm_micbias:
3703 return true;
3704 default:
3705 break;
3706 }
3707 }
3708 }
3709 }
3710
3711 return false;
3712 }
3713
3714 /**
3715 * snd_soc_dapm_auto_nc_codec_pins - call snd_soc_dapm_nc_pin for unused pins
3716 * @codec: The codec whose pins should be processed
3717 *
3718 * Automatically call snd_soc_dapm_nc_pin() for any external pins in the codec
3719 * which are unused. Pins are used if they are connected externally to the
3720 * codec, whether that be to some other device, or a loop-back connection to
3721 * the codec itself.
3722 */
3723 void snd_soc_dapm_auto_nc_codec_pins(struct snd_soc_codec *codec)
3724 {
3725 struct snd_soc_card *card = codec->card;
3726 struct snd_soc_dapm_context *dapm = &codec->dapm;
3727 struct snd_soc_dapm_widget *w;
3728
3729 dev_dbg(codec->dev, "ASoC: Auto NC: DAPMs: card:%p codec:%p\n",
3730 &card->dapm, &codec->dapm);
3731
3732 list_for_each_entry(w, &card->widgets, list) {
3733 if (w->dapm != dapm)
3734 continue;
3735 switch (w->id) {
3736 case snd_soc_dapm_input:
3737 case snd_soc_dapm_output:
3738 case snd_soc_dapm_micbias:
3739 dev_dbg(codec->dev, "ASoC: Auto NC: Checking widget %s\n",
3740 w->name);
3741 if (!snd_soc_dapm_widget_in_card_paths(card, w)) {
3742 dev_dbg(codec->dev,
3743 "... Not in map; disabling\n");
3744 snd_soc_dapm_nc_pin(dapm, w->name);
3745 }
3746 break;
3747 default:
3748 break;
3749 }
3750 }
3751 }
3752
3753 /**
3754 * snd_soc_dapm_free - free dapm resources
3755 * @dapm: DAPM context
3756 *
3757 * Free all dapm widgets and resources.
3758 */
3759 void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm)
3760 {
3761 snd_soc_dapm_sys_remove(dapm->dev);
3762 dapm_debugfs_cleanup(dapm);
3763 dapm_free_widgets(dapm);
3764 list_del(&dapm->list);
3765 }
3766 EXPORT_SYMBOL_GPL(snd_soc_dapm_free);
3767
3768 static void soc_dapm_shutdown_codec(struct snd_soc_dapm_context *dapm)
3769 {
3770 struct snd_soc_card *card = dapm->card;
3771 struct snd_soc_dapm_widget *w;
3772 LIST_HEAD(down_list);
3773 int powerdown = 0;
3774
3775 mutex_lock(&card->dapm_mutex);
3776
3777 list_for_each_entry(w, &dapm->card->widgets, list) {
3778 if (w->dapm != dapm)
3779 continue;
3780 if (w->power) {
3781 dapm_seq_insert(w, &down_list, false);
3782 w->power = 0;
3783 powerdown = 1;
3784 }
3785 }
3786
3787 /* If there were no widgets to power down we're already in
3788 * standby.
3789 */
3790 if (powerdown) {
3791 if (dapm->bias_level == SND_SOC_BIAS_ON)
3792 snd_soc_dapm_set_bias_level(dapm,
3793 SND_SOC_BIAS_PREPARE);
3794 dapm_seq_run(dapm, &down_list, 0, false);
3795 if (dapm->bias_level == SND_SOC_BIAS_PREPARE)
3796 snd_soc_dapm_set_bias_level(dapm,
3797 SND_SOC_BIAS_STANDBY);
3798 }
3799
3800 mutex_unlock(&card->dapm_mutex);
3801 }
3802
3803 /*
3804 * snd_soc_dapm_shutdown - callback for system shutdown
3805 */
3806 void snd_soc_dapm_shutdown(struct snd_soc_card *card)
3807 {
3808 struct snd_soc_codec *codec;
3809
3810 list_for_each_entry(codec, &card->codec_dev_list, card_list) {
3811 soc_dapm_shutdown_codec(&codec->dapm);
3812 if (codec->dapm.bias_level == SND_SOC_BIAS_STANDBY)
3813 snd_soc_dapm_set_bias_level(&codec->dapm,
3814 SND_SOC_BIAS_OFF);
3815 }
3816 }
3817
3818 /* Module information */
3819 MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
3820 MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
3821 MODULE_LICENSE("GPL");
ubuntu-bionic-kernel mirror