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