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