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