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