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