blob: 67b032ca1601f7d16ac6dc190d3ec5ca3192e1ca [file] [log] [blame]
Kuninori Morimotoc01f3af2018-07-02 06:24:31 +00001// SPDX-License-Identifier: GPL-2.0+
2//
3// soc-dapm.c -- ALSA SoC Dynamic Audio Power Management
4//
5// Copyright 2005 Wolfson Microelectronics PLC.
6// Author: Liam Girdwood <lrg@slimlogic.co.uk>
7//
8// Features:
9// o Changes power status of internal codec blocks depending on the
10// dynamic configuration of codec internal audio paths and active
11// DACs/ADCs.
12// o Platform power domain - can support external components i.e. amps and
13// mic/headphone insertion events.
14// o Automatic Mic Bias support
15// o Jack insertion power event initiation - e.g. hp insertion will enable
16// sinks, dacs, etc
17// o Delayed power down of audio subsystem to reduce pops between a quick
18// device reopen.
Richard Purdie2b97eab2006-10-06 18:32:18 +020019
20#include <linux/module.h>
Richard Purdie2b97eab2006-10-06 18:32:18 +020021#include <linux/init.h>
Mark Brown9d0624a2011-02-18 11:49:43 -080022#include <linux/async.h>
Richard Purdie2b97eab2006-10-06 18:32:18 +020023#include <linux/delay.h>
24#include <linux/pm.h>
25#include <linux/bitops.h>
26#include <linux/platform_device.h>
27#include <linux/jiffies.h>
Takashi Iwai20496ff2009-08-24 09:40:34 +020028#include <linux/debugfs.h>
Mark Brownf1aac482011-12-05 15:17:06 +000029#include <linux/pm_runtime.h>
Mark Brown62ea8742012-01-21 21:14:48 +000030#include <linux/regulator/consumer.h>
Srinivas Kandagatla5b2d15b2018-03-10 02:37:27 +000031#include <linux/pinctrl/consumer.h>
Ola Liljad7e7eb92012-05-24 15:26:25 +020032#include <linux/clk.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090033#include <linux/slab.h>
Richard Purdie2b97eab2006-10-06 18:32:18 +020034#include <sound/core.h>
35#include <sound/pcm.h>
36#include <sound/pcm_params.h>
Liam Girdwoodce6120c2010-11-05 15:53:46 +020037#include <sound/soc.h>
Richard Purdie2b97eab2006-10-06 18:32:18 +020038#include <sound/initval.h>
39
Mark Brown84e90932010-11-04 00:07:02 -040040#include <trace/events/asoc.h>
41
Mark Brownde02d072011-09-20 21:43:24 +010042#define DAPM_UPDATE_STAT(widget, val) widget->dapm->card->dapm_stats.val++;
43
Lars-Peter Clausena3423b02015-08-11 21:38:00 +020044#define SND_SOC_DAPM_DIR_REVERSE(x) ((x == SND_SOC_DAPM_DIR_IN) ? \
45 SND_SOC_DAPM_DIR_OUT : SND_SOC_DAPM_DIR_IN)
46
47#define snd_soc_dapm_for_each_direction(dir) \
48 for ((dir) = SND_SOC_DAPM_DIR_IN; (dir) <= SND_SOC_DAPM_DIR_OUT; \
49 (dir)++)
50
Lars-Peter Clausen57295072013-08-05 11:27:31 +020051static int snd_soc_dapm_add_path(struct snd_soc_dapm_context *dapm,
52 struct snd_soc_dapm_widget *wsource, struct snd_soc_dapm_widget *wsink,
53 const char *control,
54 int (*connected)(struct snd_soc_dapm_widget *source,
55 struct snd_soc_dapm_widget *sink));
Vladimir Zapolskiy5353f652015-06-02 00:57:53 +030056
Liam Girdwoodcc76e7d2015-06-04 15:13:09 +010057struct snd_soc_dapm_widget *
Lars-Peter Clausen57295072013-08-05 11:27:31 +020058snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
59 const struct snd_soc_dapm_widget *widget);
60
Liam Girdwood02aa78a2015-05-25 18:21:17 +010061struct snd_soc_dapm_widget *
62snd_soc_dapm_new_control_unlocked(struct snd_soc_dapm_context *dapm,
Richard Purdie2b97eab2006-10-06 18:32:18 +020063 const struct snd_soc_dapm_widget *widget);
64
Richard Purdie2b97eab2006-10-06 18:32:18 +020065/* dapm power sequences - make this per codec in the future */
66static int dapm_up_seq[] = {
Pierre-Louis Bossartf13d4b52019-02-05 10:22:28 -060067 [snd_soc_dapm_pre] = 1,
68 [snd_soc_dapm_regulator_supply] = 2,
69 [snd_soc_dapm_pinctrl] = 2,
70 [snd_soc_dapm_clock_supply] = 2,
71 [snd_soc_dapm_supply] = 3,
72 [snd_soc_dapm_micbias] = 4,
73 [snd_soc_dapm_vmid] = 4,
74 [snd_soc_dapm_dai_link] = 3,
75 [snd_soc_dapm_dai_in] = 5,
76 [snd_soc_dapm_dai_out] = 5,
77 [snd_soc_dapm_aif_in] = 5,
78 [snd_soc_dapm_aif_out] = 5,
79 [snd_soc_dapm_mic] = 6,
80 [snd_soc_dapm_siggen] = 6,
81 [snd_soc_dapm_input] = 6,
82 [snd_soc_dapm_output] = 6,
83 [snd_soc_dapm_mux] = 7,
84 [snd_soc_dapm_demux] = 7,
85 [snd_soc_dapm_dac] = 8,
86 [snd_soc_dapm_switch] = 9,
87 [snd_soc_dapm_mixer] = 9,
88 [snd_soc_dapm_mixer_named_ctl] = 9,
89 [snd_soc_dapm_pga] = 10,
90 [snd_soc_dapm_buffer] = 10,
91 [snd_soc_dapm_scheduler] = 10,
92 [snd_soc_dapm_effect] = 10,
93 [snd_soc_dapm_src] = 10,
94 [snd_soc_dapm_asrc] = 10,
95 [snd_soc_dapm_encoder] = 10,
96 [snd_soc_dapm_decoder] = 10,
97 [snd_soc_dapm_adc] = 11,
98 [snd_soc_dapm_out_drv] = 12,
99 [snd_soc_dapm_hp] = 12,
100 [snd_soc_dapm_spk] = 12,
101 [snd_soc_dapm_line] = 12,
102 [snd_soc_dapm_sink] = 12,
103 [snd_soc_dapm_kcontrol] = 13,
104 [snd_soc_dapm_post] = 14,
Richard Purdie2b97eab2006-10-06 18:32:18 +0200105};
Ian Moltonca9c1aa2009-01-06 20:11:51 +0000106
Richard Purdie2b97eab2006-10-06 18:32:18 +0200107static int dapm_down_seq[] = {
Pierre-Louis Bossartf13d4b52019-02-05 10:22:28 -0600108 [snd_soc_dapm_pre] = 1,
109 [snd_soc_dapm_kcontrol] = 2,
110 [snd_soc_dapm_adc] = 3,
111 [snd_soc_dapm_hp] = 4,
112 [snd_soc_dapm_spk] = 4,
113 [snd_soc_dapm_line] = 4,
114 [snd_soc_dapm_out_drv] = 4,
115 [snd_soc_dapm_sink] = 4,
116 [snd_soc_dapm_pga] = 5,
117 [snd_soc_dapm_buffer] = 5,
118 [snd_soc_dapm_scheduler] = 5,
119 [snd_soc_dapm_effect] = 5,
120 [snd_soc_dapm_src] = 5,
121 [snd_soc_dapm_asrc] = 5,
122 [snd_soc_dapm_encoder] = 5,
123 [snd_soc_dapm_decoder] = 5,
124 [snd_soc_dapm_switch] = 6,
125 [snd_soc_dapm_mixer_named_ctl] = 6,
126 [snd_soc_dapm_mixer] = 6,
127 [snd_soc_dapm_dac] = 7,
128 [snd_soc_dapm_mic] = 8,
129 [snd_soc_dapm_siggen] = 8,
130 [snd_soc_dapm_input] = 8,
131 [snd_soc_dapm_output] = 8,
132 [snd_soc_dapm_micbias] = 9,
133 [snd_soc_dapm_vmid] = 9,
134 [snd_soc_dapm_mux] = 10,
135 [snd_soc_dapm_demux] = 10,
136 [snd_soc_dapm_aif_in] = 11,
137 [snd_soc_dapm_aif_out] = 11,
138 [snd_soc_dapm_dai_in] = 11,
139 [snd_soc_dapm_dai_out] = 11,
140 [snd_soc_dapm_dai_link] = 12,
141 [snd_soc_dapm_supply] = 13,
142 [snd_soc_dapm_clock_supply] = 14,
143 [snd_soc_dapm_pinctrl] = 14,
144 [snd_soc_dapm_regulator_supply] = 14,
145 [snd_soc_dapm_post] = 15,
Richard Purdie2b97eab2006-10-06 18:32:18 +0200146};
147
Mark Brownf9fa2b12014-03-06 16:49:11 +0800148static void dapm_assert_locked(struct snd_soc_dapm_context *dapm)
149{
150 if (dapm->card && dapm->card->instantiated)
151 lockdep_assert_held(&dapm->card->dapm_mutex);
152}
153
Troy Kisky12ef1932008-10-13 17:42:14 -0700154static void pop_wait(u32 pop_time)
Mark Brown15e4c72f2008-07-02 11:51:20 +0100155{
156 if (pop_time)
157 schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
158}
159
Mathieu Malaterre595d2f72019-01-23 20:41:30 +0100160__printf(3, 4)
Jarkko Nikulafd8d3bc2010-11-09 14:40:28 +0200161static void pop_dbg(struct device *dev, u32 pop_time, const char *fmt, ...)
Mark Brown15e4c72f2008-07-02 11:51:20 +0100162{
163 va_list args;
Jarkko Nikulafd8d3bc2010-11-09 14:40:28 +0200164 char *buf;
165
166 if (!pop_time)
167 return;
168
169 buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
170 if (buf == NULL)
171 return;
Mark Brown15e4c72f2008-07-02 11:51:20 +0100172
173 va_start(args, fmt);
Jarkko Nikulafd8d3bc2010-11-09 14:40:28 +0200174 vsnprintf(buf, PAGE_SIZE, fmt, args);
Takashi Iwai9d01df02010-12-22 14:08:40 +0100175 dev_info(dev, "%s", buf);
Mark Brown15e4c72f2008-07-02 11:51:20 +0100176 va_end(args);
Jarkko Nikulafd8d3bc2010-11-09 14:40:28 +0200177
178 kfree(buf);
Mark Brown15e4c72f2008-07-02 11:51:20 +0100179}
180
Mark Browndb432b42011-10-03 21:06:40 +0100181static bool dapm_dirty_widget(struct snd_soc_dapm_widget *w)
182{
183 return !list_empty(&w->dirty);
184}
185
Mark Brown492c0a12014-03-06 16:15:48 +0800186static void dapm_mark_dirty(struct snd_soc_dapm_widget *w, const char *reason)
Mark Browndb432b42011-10-03 21:06:40 +0100187{
Mark Brownf9fa2b12014-03-06 16:49:11 +0800188 dapm_assert_locked(w->dapm);
189
Mark Brown75c1f892011-10-04 22:28:08 +0100190 if (!dapm_dirty_widget(w)) {
191 dev_vdbg(w->dapm->dev, "Marking %s dirty due to %s\n",
192 w->name, reason);
Mark Browndb432b42011-10-03 21:06:40 +0100193 list_add_tail(&w->dirty, &w->dapm->card->dapm_dirty);
Mark Brown75c1f892011-10-04 22:28:08 +0100194 }
Mark Browndb432b42011-10-03 21:06:40 +0100195}
196
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200197/*
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200198 * Common implementation for dapm_widget_invalidate_input_paths() and
199 * dapm_widget_invalidate_output_paths(). The function is inlined since the
200 * combined size of the two specialized functions is only marginally larger then
201 * the size of the generic function and at the same time the fast path of the
202 * specialized functions is significantly smaller than the generic function.
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200203 */
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200204static __always_inline void dapm_widget_invalidate_paths(
205 struct snd_soc_dapm_widget *w, enum snd_soc_dapm_direction dir)
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200206{
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200207 enum snd_soc_dapm_direction rdir = SND_SOC_DAPM_DIR_REVERSE(dir);
208 struct snd_soc_dapm_widget *node;
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200209 struct snd_soc_dapm_path *p;
210 LIST_HEAD(list);
211
212 dapm_assert_locked(w->dapm);
213
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200214 if (w->endpoints[dir] == -1)
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200215 return;
216
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200217 list_add_tail(&w->work_list, &list);
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200218 w->endpoints[dir] = -1;
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200219
220 list_for_each_entry(w, &list, work_list) {
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200221 snd_soc_dapm_widget_for_each_path(w, dir, p) {
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200222 if (p->is_supply || p->weak || !p->connect)
223 continue;
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200224 node = p->node[rdir];
225 if (node->endpoints[dir] != -1) {
226 node->endpoints[dir] = -1;
227 list_add_tail(&node->work_list, &list);
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200228 }
229 }
230 }
231}
232
233/*
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200234 * dapm_widget_invalidate_input_paths() - Invalidate the cached number of
235 * input paths
236 * @w: The widget for which to invalidate the cached number of input paths
237 *
238 * Resets the cached number of inputs for the specified widget and all widgets
239 * that can be reached via outcoming paths from the widget.
240 *
241 * This function must be called if the number of output paths for a widget might
242 * have changed. E.g. if the source state of a widget changes or a path is added
243 * or activated with the widget as the sink.
244 */
245static void dapm_widget_invalidate_input_paths(struct snd_soc_dapm_widget *w)
246{
247 dapm_widget_invalidate_paths(w, SND_SOC_DAPM_DIR_IN);
248}
249
250/*
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200251 * dapm_widget_invalidate_output_paths() - Invalidate the cached number of
252 * output paths
253 * @w: The widget for which to invalidate the cached number of output paths
254 *
255 * Resets the cached number of outputs for the specified widget and all widgets
256 * that can be reached via incoming paths from the widget.
257 *
258 * This function must be called if the number of output paths for a widget might
259 * have changed. E.g. if the sink state of a widget changes or a path is added
260 * or activated with the widget as the source.
261 */
262static void dapm_widget_invalidate_output_paths(struct snd_soc_dapm_widget *w)
263{
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200264 dapm_widget_invalidate_paths(w, SND_SOC_DAPM_DIR_OUT);
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200265}
266
267/*
268 * dapm_path_invalidate() - Invalidates the cached number of inputs and outputs
269 * for the widgets connected to a path
270 * @p: The path to invalidate
271 *
272 * Resets the cached number of inputs for the sink of the path and the cached
273 * number of outputs for the source of the path.
274 *
275 * This function must be called when a path is added, removed or the connected
276 * state changes.
277 */
278static void dapm_path_invalidate(struct snd_soc_dapm_path *p)
279{
280 /*
281 * Weak paths or supply paths do not influence the number of input or
282 * output paths of their neighbors.
283 */
284 if (p->weak || p->is_supply)
285 return;
286
287 /*
288 * The number of connected endpoints is the sum of the number of
289 * connected endpoints of all neighbors. If a node with 0 connected
290 * endpoints is either connected or disconnected that sum won't change,
291 * so there is no need to re-check the path.
292 */
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200293 if (p->source->endpoints[SND_SOC_DAPM_DIR_IN] != 0)
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200294 dapm_widget_invalidate_input_paths(p->sink);
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200295 if (p->sink->endpoints[SND_SOC_DAPM_DIR_OUT] != 0)
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200296 dapm_widget_invalidate_output_paths(p->source);
297}
298
Lars-Peter Clausen8be4da22014-10-25 17:42:01 +0200299void dapm_mark_endpoints_dirty(struct snd_soc_card *card)
Mark Browne2d32ff2012-08-31 17:38:32 -0700300{
Mark Browne2d32ff2012-08-31 17:38:32 -0700301 struct snd_soc_dapm_widget *w;
302
303 mutex_lock(&card->dapm_mutex);
304
305 list_for_each_entry(w, &card->widgets, list) {
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200306 if (w->is_ep) {
Lars-Peter Clausen8be4da22014-10-25 17:42:01 +0200307 dapm_mark_dirty(w, "Rechecking endpoints");
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200308 if (w->is_ep & SND_SOC_DAPM_EP_SINK)
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200309 dapm_widget_invalidate_output_paths(w);
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200310 if (w->is_ep & SND_SOC_DAPM_EP_SOURCE)
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +0200311 dapm_widget_invalidate_input_paths(w);
312 }
Mark Browne2d32ff2012-08-31 17:38:32 -0700313 }
314
315 mutex_unlock(&card->dapm_mutex);
316}
Lars-Peter Clausen8be4da22014-10-25 17:42:01 +0200317EXPORT_SYMBOL_GPL(dapm_mark_endpoints_dirty);
Mark Browne2d32ff2012-08-31 17:38:32 -0700318
Richard Purdie2b97eab2006-10-06 18:32:18 +0200319/* create a new dapm widget */
Takashi Iwai88cb4292007-02-05 14:56:20 +0100320static inline struct snd_soc_dapm_widget *dapm_cnew_widget(
Richard Purdie2b97eab2006-10-06 18:32:18 +0200321 const struct snd_soc_dapm_widget *_widget)
322{
Pierre-Louis Bossart199ed3e2019-02-01 11:05:12 -0600323 struct snd_soc_dapm_widget *w;
324
325 w = kmemdup(_widget, sizeof(*_widget), GFP_KERNEL);
326 if (!w)
327 return NULL;
328
329 /*
330 * w->name is duplicated in caller, but w->sname isn't.
331 * Duplicate it here if defined
332 */
333 if (_widget->sname) {
334 w->sname = kstrdup_const(_widget->sname, GFP_KERNEL);
Dan Carpentera6d9cef2019-02-19 15:04:27 +0300335 if (!w->sname) {
336 kfree(w);
Pierre-Louis Bossart199ed3e2019-02-01 11:05:12 -0600337 return NULL;
Dan Carpentera6d9cef2019-02-19 15:04:27 +0300338 }
Pierre-Louis Bossart199ed3e2019-02-01 11:05:12 -0600339 }
340 return w;
Richard Purdie2b97eab2006-10-06 18:32:18 +0200341}
342
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200343struct dapm_kcontrol_data {
Lars-Peter Clausencf7c1de2013-07-29 17:13:59 +0200344 unsigned int value;
Lars-Peter Clausen57295072013-08-05 11:27:31 +0200345 struct snd_soc_dapm_widget *widget;
Lars-Peter Clausen5106b922013-07-29 17:14:00 +0200346 struct list_head paths;
Lars-Peter Clausen2c75bdf2013-08-01 14:08:07 +0200347 struct snd_soc_dapm_widget_list *wlist;
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200348};
349
350static int dapm_kcontrol_data_alloc(struct snd_soc_dapm_widget *widget,
Lars-Peter Clausen41d80022016-02-03 21:59:50 +0100351 struct snd_kcontrol *kcontrol, const char *ctrl_name)
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200352{
353 struct dapm_kcontrol_data *data;
Lars-Peter Clausen57295072013-08-05 11:27:31 +0200354 struct soc_mixer_control *mc;
Charles Keepax561ed682015-05-01 12:37:26 +0100355 struct soc_enum *e;
Charles Keepax773da9b2015-05-01 12:37:25 +0100356 const char *name;
357 int ret;
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200358
Lars-Peter Clausen2c75bdf2013-08-01 14:08:07 +0200359 data = kzalloc(sizeof(*data), GFP_KERNEL);
Charles Keepax40b7bea2015-05-01 12:37:24 +0100360 if (!data)
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200361 return -ENOMEM;
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200362
Lars-Peter Clausen5106b922013-07-29 17:14:00 +0200363 INIT_LIST_HEAD(&data->paths);
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200364
Lars-Peter Clausen57295072013-08-05 11:27:31 +0200365 switch (widget->id) {
366 case snd_soc_dapm_switch:
367 case snd_soc_dapm_mixer:
368 case snd_soc_dapm_mixer_named_ctl:
369 mc = (struct soc_mixer_control *)kcontrol->private_value;
370
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +0800371 if (mc->autodisable && snd_soc_volsw_is_stereo(mc))
372 dev_warn(widget->dapm->dev,
373 "ASoC: Unsupported stereo autodisable control '%s'\n",
374 ctrl_name);
375
Lars-Peter Clausen57295072013-08-05 11:27:31 +0200376 if (mc->autodisable) {
377 struct snd_soc_dapm_widget template;
378
Lars-Peter Clausen41d80022016-02-03 21:59:50 +0100379 name = kasprintf(GFP_KERNEL, "%s %s", ctrl_name,
Charles Keepax773da9b2015-05-01 12:37:25 +0100380 "Autodisable");
381 if (!name) {
382 ret = -ENOMEM;
383 goto err_data;
384 }
385
Lars-Peter Clausen57295072013-08-05 11:27:31 +0200386 memset(&template, 0, sizeof(template));
387 template.reg = mc->reg;
388 template.mask = (1 << fls(mc->max)) - 1;
389 template.shift = mc->shift;
390 if (mc->invert)
391 template.off_val = mc->max;
392 else
393 template.off_val = 0;
394 template.on_val = template.off_val;
395 template.id = snd_soc_dapm_kcontrol;
Charles Keepax773da9b2015-05-01 12:37:25 +0100396 template.name = name;
Lars-Peter Clausen57295072013-08-05 11:27:31 +0200397
Lars-Peter Clausen2daabd72013-08-30 17:39:33 +0200398 data->value = template.on_val;
399
Liam Girdwood02aa78a2015-05-25 18:21:17 +0100400 data->widget =
401 snd_soc_dapm_new_control_unlocked(widget->dapm,
Lars-Peter Clausen57295072013-08-05 11:27:31 +0200402 &template);
Lars-Peter Clausene18077b2015-07-08 21:59:59 +0200403 kfree(name);
Linus Walleij37e1df82017-01-13 10:23:52 +0100404 if (IS_ERR(data->widget)) {
405 ret = PTR_ERR(data->widget);
406 goto err_data;
407 }
Lars-Peter Clausen57295072013-08-05 11:27:31 +0200408 }
409 break;
Lars-Peter Clausend714f972015-05-01 18:02:43 +0200410 case snd_soc_dapm_demux:
Charles Keepax561ed682015-05-01 12:37:26 +0100411 case snd_soc_dapm_mux:
412 e = (struct soc_enum *)kcontrol->private_value;
413
414 if (e->autodisable) {
415 struct snd_soc_dapm_widget template;
416
Lars-Peter Clausen41d80022016-02-03 21:59:50 +0100417 name = kasprintf(GFP_KERNEL, "%s %s", ctrl_name,
Charles Keepax561ed682015-05-01 12:37:26 +0100418 "Autodisable");
419 if (!name) {
420 ret = -ENOMEM;
421 goto err_data;
422 }
423
424 memset(&template, 0, sizeof(template));
425 template.reg = e->reg;
426 template.mask = e->mask << e->shift_l;
427 template.shift = e->shift_l;
428 template.off_val = snd_soc_enum_item_to_val(e, 0);
429 template.on_val = template.off_val;
430 template.id = snd_soc_dapm_kcontrol;
431 template.name = name;
Lars-Peter Clausen57295072013-08-05 11:27:31 +0200432
433 data->value = template.on_val;
434
Charles Keepaxffacb482015-06-26 10:39:43 +0100435 data->widget = snd_soc_dapm_new_control_unlocked(
436 widget->dapm, &template);
Lars-Peter Clausene18077b2015-07-08 21:59:59 +0200437 kfree(name);
Linus Walleij37e1df82017-01-13 10:23:52 +0100438 if (IS_ERR(data->widget)) {
439 ret = PTR_ERR(data->widget);
440 goto err_data;
441 }
Charles Keepax561ed682015-05-01 12:37:26 +0100442
443 snd_soc_dapm_add_path(widget->dapm, data->widget,
444 widget, NULL, NULL);
Lars-Peter Clausen57295072013-08-05 11:27:31 +0200445 }
446 break;
447 default:
448 break;
449 }
450
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200451 kcontrol->private_data = data;
452
453 return 0;
Charles Keepax773da9b2015-05-01 12:37:25 +0100454
Charles Keepax773da9b2015-05-01 12:37:25 +0100455err_data:
456 kfree(data);
457 return ret;
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200458}
459
460static void dapm_kcontrol_free(struct snd_kcontrol *kctl)
461{
462 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kctl);
Srinivas Kandagatlaff2faf12018-06-04 12:13:26 +0100463
464 list_del(&data->paths);
Lars-Peter Clausen2c75bdf2013-08-01 14:08:07 +0200465 kfree(data->wlist);
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200466 kfree(data);
467}
468
469static struct snd_soc_dapm_widget_list *dapm_kcontrol_get_wlist(
470 const struct snd_kcontrol *kcontrol)
471{
472 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);
473
Lars-Peter Clausen2c75bdf2013-08-01 14:08:07 +0200474 return data->wlist;
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200475}
476
477static int dapm_kcontrol_add_widget(struct snd_kcontrol *kcontrol,
478 struct snd_soc_dapm_widget *widget)
479{
480 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);
Lars-Peter Clausen2c75bdf2013-08-01 14:08:07 +0200481 struct snd_soc_dapm_widget_list *new_wlist;
482 unsigned int n;
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200483
Lars-Peter Clausen2c75bdf2013-08-01 14:08:07 +0200484 if (data->wlist)
485 n = data->wlist->num_widgets + 1;
486 else
487 n = 1;
488
489 new_wlist = krealloc(data->wlist,
490 sizeof(*new_wlist) + sizeof(widget) * n, GFP_KERNEL);
491 if (!new_wlist)
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200492 return -ENOMEM;
493
Lars-Peter Clausen2c75bdf2013-08-01 14:08:07 +0200494 new_wlist->widgets[n - 1] = widget;
495 new_wlist->num_widgets = n;
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200496
Lars-Peter Clausen2c75bdf2013-08-01 14:08:07 +0200497 data->wlist = new_wlist;
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200498
499 return 0;
500}
501
Lars-Peter Clausen5106b922013-07-29 17:14:00 +0200502static void dapm_kcontrol_add_path(const struct snd_kcontrol *kcontrol,
503 struct snd_soc_dapm_path *path)
504{
505 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);
506
507 list_add_tail(&path->list_kcontrol, &data->paths);
Lars-Peter Clausen57295072013-08-05 11:27:31 +0200508}
509
510static bool dapm_kcontrol_is_powered(const struct snd_kcontrol *kcontrol)
511{
512 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);
513
514 if (!data->widget)
515 return true;
516
517 return data->widget->power;
Lars-Peter Clausen5106b922013-07-29 17:14:00 +0200518}
519
520static struct list_head *dapm_kcontrol_get_path_list(
521 const struct snd_kcontrol *kcontrol)
522{
523 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);
524
525 return &data->paths;
526}
527
528#define dapm_kcontrol_for_each_path(path, kcontrol) \
529 list_for_each_entry(path, dapm_kcontrol_get_path_list(kcontrol), \
530 list_kcontrol)
531
Subhransu S. Prusty5dc0158a2014-09-19 16:46:05 +0530532unsigned int dapm_kcontrol_get_value(const struct snd_kcontrol *kcontrol)
Lars-Peter Clausencf7c1de2013-07-29 17:13:59 +0200533{
534 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);
535
536 return data->value;
537}
Subhransu S. Prusty5dc0158a2014-09-19 16:46:05 +0530538EXPORT_SYMBOL_GPL(dapm_kcontrol_get_value);
Lars-Peter Clausencf7c1de2013-07-29 17:13:59 +0200539
540static bool dapm_kcontrol_set_value(const struct snd_kcontrol *kcontrol,
541 unsigned int value)
542{
543 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol);
544
545 if (data->value == value)
546 return false;
547
Lars-Peter Clausen57295072013-08-05 11:27:31 +0200548 if (data->widget)
549 data->widget->on_val = value;
550
Lars-Peter Clausencf7c1de2013-07-29 17:13:59 +0200551 data->value = value;
552
553 return true;
554}
555
Lars-Peter Clauseneee5d7f2013-07-29 17:13:57 +0200556/**
Mythri P K93e39a12015-10-20 22:30:08 +0530557 * snd_soc_dapm_kcontrol_widget() - Returns the widget associated to a
558 * kcontrol
559 * @kcontrol: The kcontrol
560 */
561struct snd_soc_dapm_widget *snd_soc_dapm_kcontrol_widget(
562 struct snd_kcontrol *kcontrol)
563{
564 return dapm_kcontrol_get_wlist(kcontrol)->widgets[0];
565}
566EXPORT_SYMBOL_GPL(snd_soc_dapm_kcontrol_widget);
567
568/**
Lars-Peter Clausence0fc932014-06-16 18:13:06 +0200569 * snd_soc_dapm_kcontrol_dapm() - Returns the dapm context associated to a
570 * kcontrol
571 * @kcontrol: The kcontrol
572 *
573 * Note: This function must only be used on kcontrols that are known to have
574 * been registered for a CODEC. Otherwise the behaviour is undefined.
575 */
576struct snd_soc_dapm_context *snd_soc_dapm_kcontrol_dapm(
577 struct snd_kcontrol *kcontrol)
578{
579 return dapm_kcontrol_get_wlist(kcontrol)->widgets[0]->dapm;
580}
581EXPORT_SYMBOL_GPL(snd_soc_dapm_kcontrol_dapm);
582
Liam Girdwood6c120e12012-02-15 15:15:34 +0000583static void dapm_reset(struct snd_soc_card *card)
584{
585 struct snd_soc_dapm_widget *w;
586
Mark Brownf9fa2b12014-03-06 16:49:11 +0800587 lockdep_assert_held(&card->dapm_mutex);
588
Liam Girdwood6c120e12012-02-15 15:15:34 +0000589 memset(&card->dapm_stats, 0, sizeof(card->dapm_stats));
590
591 list_for_each_entry(w, &card->widgets, list) {
Lars-Peter Clausen39eb5fd2013-07-29 17:14:03 +0200592 w->new_power = w->power;
Liam Girdwood6c120e12012-02-15 15:15:34 +0000593 w->power_checked = false;
Liam Girdwood6c120e12012-02-15 15:15:34 +0000594 }
595}
596
Lars-Peter Clausen94f99c82014-06-16 18:13:01 +0200597static const char *soc_dapm_prefix(struct snd_soc_dapm_context *dapm)
598{
599 if (!dapm->component)
600 return NULL;
601 return dapm->component->name_prefix;
602}
603
Lars-Peter Clausence0fc932014-06-16 18:13:06 +0200604static int soc_dapm_read(struct snd_soc_dapm_context *dapm, int reg,
Arun Shamanna Lakshmif7d3c172014-01-14 15:31:54 -0800605 unsigned int *value)
Liam Girdwood0445bdf2011-06-13 19:37:36 +0100606{
Lars-Peter Clausence0fc932014-06-16 18:13:06 +0200607 if (!dapm->component)
Lars-Peter Clausene2c330b2014-04-22 13:23:13 +0200608 return -EIO;
Lars-Peter Clausence0fc932014-06-16 18:13:06 +0200609 return snd_soc_component_read(dapm->component, reg, value);
Liam Girdwood0445bdf2011-06-13 19:37:36 +0100610}
611
Lars-Peter Clausence0fc932014-06-16 18:13:06 +0200612static int soc_dapm_update_bits(struct snd_soc_dapm_context *dapm,
Bard Liao34775012014-04-17 20:12:56 +0800613 int reg, unsigned int mask, unsigned int value)
Liam Girdwood0445bdf2011-06-13 19:37:36 +0100614{
Lars-Peter Clausence0fc932014-06-16 18:13:06 +0200615 if (!dapm->component)
Lars-Peter Clausene2c330b2014-04-22 13:23:13 +0200616 return -EIO;
Mark Brownfcf6c5e2014-12-15 13:08:48 +0000617 return snd_soc_component_update_bits(dapm->component, reg,
618 mask, value);
Liam Girdwood49575fb52012-03-06 18:16:19 +0000619}
620
Lars-Peter Clausence0fc932014-06-16 18:13:06 +0200621static int soc_dapm_test_bits(struct snd_soc_dapm_context *dapm,
622 int reg, unsigned int mask, unsigned int value)
623{
624 if (!dapm->component)
625 return -EIO;
626 return snd_soc_component_test_bits(dapm->component, reg, mask, value);
627}
628
Mark Browneb270e92013-10-09 13:52:52 +0100629static void soc_dapm_async_complete(struct snd_soc_dapm_context *dapm)
630{
Lars-Peter Clausene2c330b2014-04-22 13:23:13 +0200631 if (dapm->component)
632 snd_soc_component_async_complete(dapm->component);
Liam Girdwood0445bdf2011-06-13 19:37:36 +0100633}
634
Charles Keepax45a110a2015-05-11 13:50:30 +0100635static struct snd_soc_dapm_widget *
636dapm_wcache_lookup(struct snd_soc_dapm_wcache *wcache, const char *name)
637{
638 struct snd_soc_dapm_widget *w = wcache->widget;
639 struct list_head *wlist;
640 const int depth = 2;
641 int i = 0;
642
643 if (w) {
644 wlist = &w->dapm->card->widgets;
645
646 list_for_each_entry_from(w, wlist, list) {
647 if (!strcmp(name, w->name))
648 return w;
649
650 if (++i == depth)
651 break;
652 }
653 }
654
655 return NULL;
656}
657
658static inline void dapm_wcache_update(struct snd_soc_dapm_wcache *wcache,
659 struct snd_soc_dapm_widget *w)
660{
661 wcache->widget = w;
662}
663
Mark Brown452c5ea2009-05-17 21:41:23 +0100664/**
Lars-Peter Clausenfa880772015-04-27 22:13:23 +0200665 * snd_soc_dapm_force_bias_level() - Sets the DAPM bias level
666 * @dapm: The DAPM context for which to set the level
667 * @level: The level to set
668 *
669 * Forces the DAPM bias level to a specific state. It will call the bias level
670 * callback of DAPM context with the specified level. This will even happen if
671 * the context is already at the same level. Furthermore it will not go through
672 * the normal bias level sequencing, meaning any intermediate states between the
673 * current and the target state will not be entered.
674 *
675 * Note that the change in bias level is only temporary and the next time
676 * snd_soc_dapm_sync() is called the state will be set to the level as
677 * determined by the DAPM core. The function is mainly intended to be used to
678 * used during probe or resume from suspend to power up the device so
679 * initialization can be done, before the DAPM core takes over.
680 */
681int snd_soc_dapm_force_bias_level(struct snd_soc_dapm_context *dapm,
682 enum snd_soc_bias_level level)
683{
684 int ret = 0;
685
686 if (dapm->set_bias_level)
687 ret = dapm->set_bias_level(dapm, level);
688
Lars-Peter Clausenf4bf8d72015-04-27 22:13:25 +0200689 if (ret == 0)
690 dapm->bias_level = level;
691
Lars-Peter Clausenfa880772015-04-27 22:13:23 +0200692 return ret;
693}
694EXPORT_SYMBOL_GPL(snd_soc_dapm_force_bias_level);
695
Mark Brown452c5ea2009-05-17 21:41:23 +0100696/**
697 * snd_soc_dapm_set_bias_level - set the bias level for the system
Mark Browned5a4c42011-02-18 11:12:42 -0800698 * @dapm: DAPM context
Mark Brown452c5ea2009-05-17 21:41:23 +0100699 * @level: level to configure
700 *
701 * Configure the bias (power) levels for the SoC audio device.
702 *
703 * Returns 0 for success else error.
704 */
Mark Browned5a4c42011-02-18 11:12:42 -0800705static int snd_soc_dapm_set_bias_level(struct snd_soc_dapm_context *dapm,
Liam Girdwoodce6120c2010-11-05 15:53:46 +0200706 enum snd_soc_bias_level level)
Mark Brown452c5ea2009-05-17 21:41:23 +0100707{
Mark Browned5a4c42011-02-18 11:12:42 -0800708 struct snd_soc_card *card = dapm->card;
Mark Brown452c5ea2009-05-17 21:41:23 +0100709 int ret = 0;
710
Mark Brown84e90932010-11-04 00:07:02 -0400711 trace_snd_soc_bias_level_start(card, level);
712
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000713 if (card && card->set_bias_level)
Mark Brownd4c60052011-06-06 19:13:23 +0100714 ret = card->set_bias_level(card, dapm, level);
Mark Brown171ec6b2011-06-06 18:15:19 +0100715 if (ret != 0)
716 goto out;
Mark Brown452c5ea2009-05-17 21:41:23 +0100717
Lars-Peter Clausenfa880772015-04-27 22:13:23 +0200718 if (!card || dapm != &card->dapm)
719 ret = snd_soc_dapm_force_bias_level(dapm, level);
Liam Girdwood41231282012-07-06 16:56:16 +0100720
Mark Brown171ec6b2011-06-06 18:15:19 +0100721 if (ret != 0)
722 goto out;
723
724 if (card && card->set_bias_level_post)
Mark Brownd4c60052011-06-06 19:13:23 +0100725 ret = card->set_bias_level_post(card, dapm, level);
Mark Brown171ec6b2011-06-06 18:15:19 +0100726out:
Mark Brown84e90932010-11-04 00:07:02 -0400727 trace_snd_soc_bias_level_done(card, level);
728
Mark Brown452c5ea2009-05-17 21:41:23 +0100729 return ret;
730}
731
Mark Brown74b8f952009-06-06 11:26:15 +0100732/* connect mux widget to its interconnecting audio paths */
Liam Girdwoodce6120c2010-11-05 15:53:46 +0200733static int dapm_connect_mux(struct snd_soc_dapm_context *dapm,
Lars-Peter Clausend714f972015-05-01 18:02:43 +0200734 struct snd_soc_dapm_path *path, const char *control_name,
735 struct snd_soc_dapm_widget *w)
Richard Purdie2b97eab2006-10-06 18:32:18 +0200736{
Lars-Peter Clausend714f972015-05-01 18:02:43 +0200737 const struct snd_kcontrol_new *kcontrol = &w->kcontrol_news[0];
Richard Purdie2b97eab2006-10-06 18:32:18 +0200738 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Lars-Peter Clausen234c0b82014-02-28 08:31:12 +0100739 unsigned int val, item;
Richard Purdie2b97eab2006-10-06 18:32:18 +0200740 int i;
741
Lars-Peter Clausen234c0b82014-02-28 08:31:12 +0100742 if (e->reg != SND_SOC_NOPM) {
Lars-Peter Clausence0fc932014-06-16 18:13:06 +0200743 soc_dapm_read(dapm, e->reg, &val);
Lars-Peter Clausen234c0b82014-02-28 08:31:12 +0100744 val = (val >> e->shift_l) & e->mask;
745 item = snd_soc_enum_val_to_item(e, val);
746 } else {
747 /* since a virtual mux has no backing registers to
748 * decide which path to connect, it will try to match
749 * with the first enumeration. This is to ensure
750 * that the default mux choice (the first) will be
751 * correctly powered up during initialization.
752 */
753 item = 0;
754 }
755
Xie Yishengf9e0b4a2018-05-31 19:11:23 +0800756 i = match_string(e->texts, e->items, control_name);
757 if (i < 0)
758 return -ENODEV;
Richard Purdie2b97eab2006-10-06 18:32:18 +0200759
Xie Yishengf9e0b4a2018-05-31 19:11:23 +0800760 path->name = e->texts[i];
761 path->connect = (i == item);
762 return 0;
763
Richard Purdie2b97eab2006-10-06 18:32:18 +0200764}
765
Lars-Peter Clausen234c0b82014-02-28 08:31:12 +0100766/* set up initial codec paths */
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +0800767static void dapm_set_mixer_path_status(struct snd_soc_dapm_path *p, int i,
768 int nth_path)
Lars-Peter Clausen234c0b82014-02-28 08:31:12 +0100769{
770 struct soc_mixer_control *mc = (struct soc_mixer_control *)
Lars-Peter Clausen5fe5b762014-10-25 17:41:58 +0200771 p->sink->kcontrol_news[i].private_value;
Lars-Peter Clausen234c0b82014-02-28 08:31:12 +0100772 unsigned int reg = mc->reg;
773 unsigned int shift = mc->shift;
774 unsigned int max = mc->max;
775 unsigned int mask = (1 << fls(max)) - 1;
776 unsigned int invert = mc->invert;
777 unsigned int val;
778
779 if (reg != SND_SOC_NOPM) {
Lars-Peter Clausen5fe5b762014-10-25 17:41:58 +0200780 soc_dapm_read(p->sink->dapm, reg, &val);
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +0800781 /*
782 * The nth_path argument allows this function to know
783 * which path of a kcontrol it is setting the initial
784 * status for. Ideally this would support any number
785 * of paths and channels. But since kcontrols only come
786 * in mono and stereo variants, we are limited to 2
787 * channels.
788 *
789 * The following code assumes for stereo controls the
790 * first path is the left channel, and all remaining
791 * paths are the right channel.
792 */
793 if (snd_soc_volsw_is_stereo(mc) && nth_path > 0) {
794 if (reg != mc->rreg)
795 soc_dapm_read(p->sink->dapm, mc->rreg, &val);
796 val = (val >> mc->rshift) & mask;
797 } else {
798 val = (val >> shift) & mask;
799 }
Lars-Peter Clausen234c0b82014-02-28 08:31:12 +0100800 if (invert)
801 val = max - val;
802 p->connect = !!val;
803 } else {
804 p->connect = 0;
805 }
806}
807
Mark Brown74b8f952009-06-06 11:26:15 +0100808/* connect mixer widget to its interconnecting audio paths */
Liam Girdwoodce6120c2010-11-05 15:53:46 +0200809static int dapm_connect_mixer(struct snd_soc_dapm_context *dapm,
Richard Purdie2b97eab2006-10-06 18:32:18 +0200810 struct snd_soc_dapm_path *path, const char *control_name)
811{
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +0800812 int i, nth_path = 0;
Richard Purdie2b97eab2006-10-06 18:32:18 +0200813
814 /* search for mixer kcontrol */
Lars-Peter Clausen5fe5b762014-10-25 17:41:58 +0200815 for (i = 0; i < path->sink->num_kcontrols; i++) {
816 if (!strcmp(control_name, path->sink->kcontrol_news[i].name)) {
817 path->name = path->sink->kcontrol_news[i].name;
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +0800818 dapm_set_mixer_path_status(path, i, nth_path++);
Richard Purdie2b97eab2006-10-06 18:32:18 +0200819 return 0;
820 }
821 }
822 return -ENODEV;
823}
824
Stephen Warrenaf468002011-04-28 17:38:01 -0600825static int dapm_is_shared_kcontrol(struct snd_soc_dapm_context *dapm,
Stephen Warren1007da02011-05-26 09:57:33 -0600826 struct snd_soc_dapm_widget *kcontrolw,
Stephen Warrenaf468002011-04-28 17:38:01 -0600827 const struct snd_kcontrol_new *kcontrol_new,
828 struct snd_kcontrol **kcontrol)
829{
830 struct snd_soc_dapm_widget *w;
831 int i;
832
833 *kcontrol = NULL;
834
835 list_for_each_entry(w, &dapm->card->widgets, list) {
Stephen Warren1007da02011-05-26 09:57:33 -0600836 if (w == kcontrolw || w->dapm != kcontrolw->dapm)
837 continue;
Stephen Warrenaf468002011-04-28 17:38:01 -0600838 for (i = 0; i < w->num_kcontrols; i++) {
839 if (&w->kcontrol_news[i] == kcontrol_new) {
840 if (w->kcontrols)
841 *kcontrol = w->kcontrols[i];
842 return 1;
843 }
844 }
845 }
846
847 return 0;
848}
849
Stephen Warren85762e72013-03-29 15:40:10 -0600850/*
851 * Determine if a kcontrol is shared. If it is, look it up. If it isn't,
852 * create it. Either way, add the widget into the control's widget list
853 */
Jeeja KP19a2557b2015-10-20 22:30:06 +0530854static int dapm_create_or_share_kcontrol(struct snd_soc_dapm_widget *w,
Mark Brown946d92a2013-08-12 23:28:42 +0100855 int kci)
Richard Purdie2b97eab2006-10-06 18:32:18 +0200856{
Lars-Peter Clausen4b80b8c2011-06-09 13:22:36 +0200857 struct snd_soc_dapm_context *dapm = w->dapm;
Mark Brown12ea2c72011-03-02 18:17:32 +0000858 struct snd_card *card = dapm->card->snd_card;
Mark Brownefb7ac32011-03-08 17:23:24 +0000859 const char *prefix;
Stephen Warren85762e72013-03-29 15:40:10 -0600860 size_t prefix_len;
861 int shared;
862 struct snd_kcontrol *kcontrol;
Stephen Warren85762e72013-03-29 15:40:10 -0600863 bool wname_in_long_name, kcname_in_long_name;
Daniel Macke5092c92014-10-07 13:41:24 +0200864 char *long_name = NULL;
Stephen Warren85762e72013-03-29 15:40:10 -0600865 const char *name;
Daniel Macke5092c92014-10-07 13:41:24 +0200866 int ret = 0;
Mark Brownefb7ac32011-03-08 17:23:24 +0000867
Lars-Peter Clausen94f99c82014-06-16 18:13:01 +0200868 prefix = soc_dapm_prefix(dapm);
Mark Brown3e5ff4d2011-03-09 11:33:09 +0000869 if (prefix)
870 prefix_len = strlen(prefix) + 1;
871 else
872 prefix_len = 0;
873
Stephen Warren85762e72013-03-29 15:40:10 -0600874 shared = dapm_is_shared_kcontrol(dapm, w, &w->kcontrol_news[kci],
875 &kcontrol);
876
Stephen Warren85762e72013-03-29 15:40:10 -0600877 if (!kcontrol) {
878 if (shared) {
879 wname_in_long_name = false;
880 kcname_in_long_name = true;
881 } else {
882 switch (w->id) {
883 case snd_soc_dapm_switch:
884 case snd_soc_dapm_mixer:
Jeeja KP19a2557b2015-10-20 22:30:06 +0530885 case snd_soc_dapm_pga:
Chen-Yu Tsaia3930ed2016-08-27 19:28:00 +0800886 case snd_soc_dapm_out_drv:
Stephen Warren85762e72013-03-29 15:40:10 -0600887 wname_in_long_name = true;
888 kcname_in_long_name = true;
889 break;
890 case snd_soc_dapm_mixer_named_ctl:
891 wname_in_long_name = false;
892 kcname_in_long_name = true;
893 break;
Lars-Peter Clausend714f972015-05-01 18:02:43 +0200894 case snd_soc_dapm_demux:
Stephen Warren85762e72013-03-29 15:40:10 -0600895 case snd_soc_dapm_mux:
Stephen Warren85762e72013-03-29 15:40:10 -0600896 wname_in_long_name = true;
897 kcname_in_long_name = false;
898 break;
899 default:
Stephen Warren85762e72013-03-29 15:40:10 -0600900 return -EINVAL;
901 }
902 }
903
904 if (wname_in_long_name && kcname_in_long_name) {
Stephen Warren85762e72013-03-29 15:40:10 -0600905 /*
906 * The control will get a prefix from the control
907 * creation process but we're also using the same
908 * prefix for widgets so cut the prefix off the
909 * front of the widget name.
910 */
Lars-Peter Clausen2b581072013-05-14 11:05:32 +0200911 long_name = kasprintf(GFP_KERNEL, "%s %s",
Stephen Warren85762e72013-03-29 15:40:10 -0600912 w->name + prefix_len,
913 w->kcontrol_news[kci].name);
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200914 if (long_name == NULL)
Lars-Peter Clausen2b581072013-05-14 11:05:32 +0200915 return -ENOMEM;
Stephen Warren85762e72013-03-29 15:40:10 -0600916
917 name = long_name;
918 } else if (wname_in_long_name) {
919 long_name = NULL;
920 name = w->name + prefix_len;
921 } else {
922 long_name = NULL;
923 name = w->kcontrol_news[kci].name;
924 }
925
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200926 kcontrol = snd_soc_cnew(&w->kcontrol_news[kci], NULL, name,
Stephen Warren85762e72013-03-29 15:40:10 -0600927 prefix);
Daniel Macke5092c92014-10-07 13:41:24 +0200928 if (!kcontrol) {
929 ret = -ENOMEM;
930 goto exit_free;
931 }
932
Lars-Peter Clausen9356e9d2013-08-01 14:08:06 +0200933 kcontrol->private_free = dapm_kcontrol_free;
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200934
Lars-Peter Clausen41d80022016-02-03 21:59:50 +0100935 ret = dapm_kcontrol_data_alloc(w, kcontrol, name);
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200936 if (ret) {
937 snd_ctl_free_one(kcontrol);
Daniel Macke5092c92014-10-07 13:41:24 +0200938 goto exit_free;
Lars-Peter Clausene84357f2013-07-29 17:13:58 +0200939 }
940
Stephen Warren85762e72013-03-29 15:40:10 -0600941 ret = snd_ctl_add(card, kcontrol);
942 if (ret < 0) {
943 dev_err(dapm->dev,
944 "ASoC: failed to add widget %s dapm kcontrol %s: %d\n",
945 w->name, name, ret);
Daniel Macke5092c92014-10-07 13:41:24 +0200946 goto exit_free;
Stephen Warren85762e72013-03-29 15:40:10 -0600947 }
Stephen Warren85762e72013-03-29 15:40:10 -0600948 }
949
Lars-Peter Clausen2c75bdf2013-08-01 14:08:07 +0200950 ret = dapm_kcontrol_add_widget(kcontrol, w);
Daniel Macke5092c92014-10-07 13:41:24 +0200951 if (ret == 0)
952 w->kcontrols[kci] = kcontrol;
Lars-Peter Clausen2c75bdf2013-08-01 14:08:07 +0200953
Daniel Macke5092c92014-10-07 13:41:24 +0200954exit_free:
955 kfree(long_name);
Stephen Warren85762e72013-03-29 15:40:10 -0600956
Daniel Macke5092c92014-10-07 13:41:24 +0200957 return ret;
Stephen Warren85762e72013-03-29 15:40:10 -0600958}
959
960/* create new dapm mixer control */
961static int dapm_new_mixer(struct snd_soc_dapm_widget *w)
962{
963 int i, ret;
964 struct snd_soc_dapm_path *path;
Charles Keepax561ed682015-05-01 12:37:26 +0100965 struct dapm_kcontrol_data *data;
Stephen Warren85762e72013-03-29 15:40:10 -0600966
Richard Purdie2b97eab2006-10-06 18:32:18 +0200967 /* add kcontrol */
968 for (i = 0; i < w->num_kcontrols; i++) {
Richard Purdie2b97eab2006-10-06 18:32:18 +0200969 /* match name */
Lars-Peter Clausene63bfd42015-07-26 19:05:00 +0200970 snd_soc_dapm_widget_for_each_source_path(w, path) {
Richard Purdie2b97eab2006-10-06 18:32:18 +0200971 /* mixer/mux paths name must match control name */
Stephen Warren82cfecd2011-04-28 17:37:58 -0600972 if (path->name != (char *)w->kcontrol_news[i].name)
Richard Purdie2b97eab2006-10-06 18:32:18 +0200973 continue;
974
Charles Keepax561ed682015-05-01 12:37:26 +0100975 if (!w->kcontrols[i]) {
Jeeja KP19a2557b2015-10-20 22:30:06 +0530976 ret = dapm_create_or_share_kcontrol(w, i);
Charles Keepax561ed682015-05-01 12:37:26 +0100977 if (ret < 0)
978 return ret;
Lars-Peter Clausen82cd8762011-08-15 20:15:21 +0200979 }
980
Mark Brown946d92a2013-08-12 23:28:42 +0100981 dapm_kcontrol_add_path(w->kcontrols[i], path);
Charles Keepax561ed682015-05-01 12:37:26 +0100982
983 data = snd_kcontrol_chip(w->kcontrols[i]);
984 if (data->widget)
985 snd_soc_dapm_add_path(data->widget->dapm,
986 data->widget,
987 path->source,
988 NULL, NULL);
Richard Purdie2b97eab2006-10-06 18:32:18 +0200989 }
990 }
Stephen Warren85762e72013-03-29 15:40:10 -0600991
992 return 0;
Richard Purdie2b97eab2006-10-06 18:32:18 +0200993}
994
995/* create new dapm mux control */
Lars-Peter Clausen4b80b8c2011-06-09 13:22:36 +0200996static int dapm_new_mux(struct snd_soc_dapm_widget *w)
Richard Purdie2b97eab2006-10-06 18:32:18 +0200997{
Lars-Peter Clausen4b80b8c2011-06-09 13:22:36 +0200998 struct snd_soc_dapm_context *dapm = w->dapm;
Lars-Peter Clausena3423b02015-08-11 21:38:00 +0200999 enum snd_soc_dapm_direction dir;
Stephen Warren85762e72013-03-29 15:40:10 -06001000 struct snd_soc_dapm_path *path;
Lars-Peter Clausend714f972015-05-01 18:02:43 +02001001 const char *type;
Stephen Warrenaf468002011-04-28 17:38:01 -06001002 int ret;
Richard Purdie2b97eab2006-10-06 18:32:18 +02001003
Lars-Peter Clausend714f972015-05-01 18:02:43 +02001004 switch (w->id) {
1005 case snd_soc_dapm_mux:
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001006 dir = SND_SOC_DAPM_DIR_OUT;
Lars-Peter Clausend714f972015-05-01 18:02:43 +02001007 type = "mux";
1008 break;
1009 case snd_soc_dapm_demux:
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001010 dir = SND_SOC_DAPM_DIR_IN;
Lars-Peter Clausend714f972015-05-01 18:02:43 +02001011 type = "demux";
1012 break;
1013 default:
1014 return -EINVAL;
1015 }
1016
Stephen Warrenaf468002011-04-28 17:38:01 -06001017 if (w->num_kcontrols != 1) {
1018 dev_err(dapm->dev,
Lars-Peter Clausend714f972015-05-01 18:02:43 +02001019 "ASoC: %s %s has incorrect number of controls\n", type,
Stephen Warrenaf468002011-04-28 17:38:01 -06001020 w->name);
Richard Purdie2b97eab2006-10-06 18:32:18 +02001021 return -EINVAL;
1022 }
1023
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001024 if (list_empty(&w->edges[dir])) {
Lars-Peter Clausend714f972015-05-01 18:02:43 +02001025 dev_err(dapm->dev, "ASoC: %s %s has no paths\n", type, w->name);
Stephen Warren85762e72013-03-29 15:40:10 -06001026 return -EINVAL;
Stephen Warrenaf468002011-04-28 17:38:01 -06001027 }
Liam Girdwoodce6120c2010-11-05 15:53:46 +02001028
Jeeja KP19a2557b2015-10-20 22:30:06 +05301029 ret = dapm_create_or_share_kcontrol(w, 0);
Stephen Warren85762e72013-03-29 15:40:10 -06001030 if (ret < 0)
1031 return ret;
Stephen Warrenfad59882011-04-28 17:37:59 -06001032
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001033 snd_soc_dapm_widget_for_each_path(w, dir, path) {
1034 if (path->name)
1035 dapm_kcontrol_add_path(w->kcontrols[0], path);
Lars-Peter Clausen98407ef2014-10-25 17:41:57 +02001036 }
Richard Purdie2b97eab2006-10-06 18:32:18 +02001037
Stephen Warrenaf468002011-04-28 17:38:01 -06001038 return 0;
Richard Purdie2b97eab2006-10-06 18:32:18 +02001039}
1040
1041/* create new dapm volume control */
Lars-Peter Clausen4b80b8c2011-06-09 13:22:36 +02001042static int dapm_new_pga(struct snd_soc_dapm_widget *w)
Richard Purdie2b97eab2006-10-06 18:32:18 +02001043{
Jeeja KP19a2557b2015-10-20 22:30:06 +05301044 int i, ret;
1045
1046 for (i = 0; i < w->num_kcontrols; i++) {
1047 ret = dapm_create_or_share_kcontrol(w, i);
1048 if (ret < 0)
1049 return ret;
1050 }
Richard Purdie2b97eab2006-10-06 18:32:18 +02001051
Mark Browna6c65732010-03-03 17:45:21 +00001052 return 0;
Richard Purdie2b97eab2006-10-06 18:32:18 +02001053}
1054
Nikesh Oswalc6615082015-02-02 17:06:44 +00001055/* create new dapm dai link control */
1056static int dapm_new_dai_link(struct snd_soc_dapm_widget *w)
1057{
1058 int i, ret;
1059 struct snd_kcontrol *kcontrol;
1060 struct snd_soc_dapm_context *dapm = w->dapm;
1061 struct snd_card *card = dapm->card->snd_card;
Charles Keepax243bcfa2018-09-05 15:21:02 +01001062 struct snd_soc_pcm_runtime *rtd = w->priv;
Nikesh Oswalc6615082015-02-02 17:06:44 +00001063
1064 /* create control for links with > 1 config */
Charles Keepax243bcfa2018-09-05 15:21:02 +01001065 if (rtd->dai_link->num_params <= 1)
Nikesh Oswalc6615082015-02-02 17:06:44 +00001066 return 0;
1067
1068 /* add kcontrol */
1069 for (i = 0; i < w->num_kcontrols; i++) {
1070 kcontrol = snd_soc_cnew(&w->kcontrol_news[i], w,
1071 w->name, NULL);
1072 ret = snd_ctl_add(card, kcontrol);
1073 if (ret < 0) {
1074 dev_err(dapm->dev,
1075 "ASoC: failed to add widget %s dapm kcontrol %s: %d\n",
1076 w->name, w->kcontrol_news[i].name, ret);
1077 return ret;
1078 }
1079 kcontrol->private_data = w;
1080 w->kcontrols[i] = kcontrol;
1081 }
1082
1083 return 0;
1084}
1085
Mark Brown9949788b2010-05-07 20:24:05 +01001086/* We implement power down on suspend by checking the power state of
1087 * the ALSA card - when we are suspending the ALSA state for the card
1088 * is set to D3.
1089 */
1090static int snd_soc_dapm_suspend_check(struct snd_soc_dapm_widget *widget)
1091{
Mark Brown12ea2c72011-03-02 18:17:32 +00001092 int level = snd_power_get_state(widget->dapm->card->snd_card);
Mark Brown9949788b2010-05-07 20:24:05 +01001093
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001094 switch (level) {
Mark Brown9949788b2010-05-07 20:24:05 +01001095 case SNDRV_CTL_POWER_D3hot:
1096 case SNDRV_CTL_POWER_D3cold:
Mark Brown1547aba2010-05-07 21:11:40 +01001097 if (widget->ignore_suspend)
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00001098 dev_dbg(widget->dapm->dev, "ASoC: %s ignoring suspend\n",
Jarkko Nikulaf7d41ae2010-11-09 14:40:27 +02001099 widget->name);
Mark Brown1547aba2010-05-07 21:11:40 +01001100 return widget->ignore_suspend;
Mark Brown9949788b2010-05-07 20:24:05 +01001101 default:
1102 return 1;
1103 }
1104}
1105
Lars-Peter Clausen1ce43ac2015-07-26 19:04:59 +02001106static int dapm_widget_list_create(struct snd_soc_dapm_widget_list **list,
1107 struct list_head *widgets)
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001108{
Lars-Peter Clausen1ce43ac2015-07-26 19:04:59 +02001109 struct snd_soc_dapm_widget *w;
1110 struct list_head *it;
1111 unsigned int size = 0;
1112 unsigned int i = 0;
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001113
Lars-Peter Clausen1ce43ac2015-07-26 19:04:59 +02001114 list_for_each(it, widgets)
1115 size++;
1116
Kees Cookacafe7e2018-05-08 13:45:50 -07001117 *list = kzalloc(struct_size(*list, widgets, size), GFP_KERNEL);
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001118 if (*list == NULL)
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001119 return -ENOMEM;
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001120
Lars-Peter Clausen1ce43ac2015-07-26 19:04:59 +02001121 list_for_each_entry(w, widgets, work_list)
1122 (*list)->widgets[i++] = w;
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001123
Lars-Peter Clausen1ce43ac2015-07-26 19:04:59 +02001124 (*list)->num_widgets = i;
1125
1126 return 0;
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001127}
1128
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001129/*
1130 * Common implementation for is_connected_output_ep() and
1131 * is_connected_input_ep(). The function is inlined since the combined size of
1132 * the two specialized functions is only marginally larger then the size of the
1133 * generic function and at the same time the fast path of the specialized
1134 * functions is significantly smaller than the generic function.
1135 */
1136static __always_inline int is_connected_ep(struct snd_soc_dapm_widget *widget,
1137 struct list_head *list, enum snd_soc_dapm_direction dir,
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001138 int (*fn)(struct snd_soc_dapm_widget *, struct list_head *,
1139 bool (*custom_stop_condition)(struct snd_soc_dapm_widget *,
1140 enum snd_soc_dapm_direction)),
1141 bool (*custom_stop_condition)(struct snd_soc_dapm_widget *,
1142 enum snd_soc_dapm_direction))
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001143{
1144 enum snd_soc_dapm_direction rdir = SND_SOC_DAPM_DIR_REVERSE(dir);
Richard Purdie2b97eab2006-10-06 18:32:18 +02001145 struct snd_soc_dapm_path *path;
1146 int con = 0;
1147
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001148 if (widget->endpoints[dir] >= 0)
1149 return widget->endpoints[dir];
Mark Brown024dc072011-10-09 11:52:05 +01001150
Mark Brownde02d072011-09-20 21:43:24 +01001151 DAPM_UPDATE_STAT(widget, path_checks);
1152
Lars-Peter Clausen1ce43ac2015-07-26 19:04:59 +02001153 /* do we need to add this widget to the list ? */
1154 if (list)
1155 list_add_tail(&widget->work_list, list);
1156
Jeeja KP09464972016-06-15 11:16:55 +05301157 if (custom_stop_condition && custom_stop_condition(widget, dir)) {
1158 widget->endpoints[dir] = 1;
1159 return widget->endpoints[dir];
1160 }
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001161
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001162 if ((widget->is_ep & SND_SOC_DAPM_DIR_TO_EP(dir)) && widget->connected) {
1163 widget->endpoints[dir] = snd_soc_dapm_suspend_check(widget);
1164 return widget->endpoints[dir];
Richard Purdie2b97eab2006-10-06 18:32:18 +02001165 }
Richard Purdie2b97eab2006-10-06 18:32:18 +02001166
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001167 snd_soc_dapm_widget_for_each_path(widget, rdir, path) {
Mark Browne56235e02011-09-21 18:19:14 +01001168 DAPM_UPDATE_STAT(widget, neighbour_checks);
Richard Purdie2b97eab2006-10-06 18:32:18 +02001169
Lars-Peter Clausenc1862c82014-10-25 17:42:00 +02001170 if (path->weak || path->is_supply)
Mark Brownbf3a9e12011-06-13 16:42:29 +01001171 continue;
1172
Mark Brown8af294b2013-02-22 17:48:15 +00001173 if (path->walking)
1174 return 1;
1175
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001176 trace_snd_soc_dapm_path(widget, dir, path);
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001177
Lars-Peter Clausen7ddd4cd2014-10-20 19:36:34 +02001178 if (path->connect) {
Mark Brown8af294b2013-02-22 17:48:15 +00001179 path->walking = 1;
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001180 con += fn(path->node[dir], list, custom_stop_condition);
Mark Brown8af294b2013-02-22 17:48:15 +00001181 path->walking = 0;
Richard Purdie2b97eab2006-10-06 18:32:18 +02001182 }
1183 }
1184
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001185 widget->endpoints[dir] = con;
Mark Brown024dc072011-10-09 11:52:05 +01001186
Richard Purdie2b97eab2006-10-06 18:32:18 +02001187 return con;
Richard Purdie2b97eab2006-10-06 18:32:18 +02001188}
1189
1190/*
1191 * Recursively check for a completed path to an active or physically connected
1192 * output widget. Returns number of complete paths.
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001193 *
1194 * Optionally, can be supplied with a function acting as a stopping condition.
1195 * This function takes the dapm widget currently being examined and the walk
1196 * direction as an arguments, it should return true if the walk should be
1197 * stopped and false otherwise.
Richard Purdie2b97eab2006-10-06 18:32:18 +02001198 */
1199static int is_connected_output_ep(struct snd_soc_dapm_widget *widget,
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001200 struct list_head *list,
1201 bool (*custom_stop_condition)(struct snd_soc_dapm_widget *i,
1202 enum snd_soc_dapm_direction))
Richard Purdie2b97eab2006-10-06 18:32:18 +02001203{
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001204 return is_connected_ep(widget, list, SND_SOC_DAPM_DIR_OUT,
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001205 is_connected_output_ep, custom_stop_condition);
Richard Purdie2b97eab2006-10-06 18:32:18 +02001206}
1207
1208/*
1209 * Recursively check for a completed path to an active or physically connected
1210 * input widget. Returns number of complete paths.
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001211 *
1212 * Optionally, can be supplied with a function acting as a stopping condition.
1213 * This function takes the dapm widget currently being examined and the walk
1214 * direction as an arguments, it should return true if the walk should be
1215 * stopped and false otherwise.
Richard Purdie2b97eab2006-10-06 18:32:18 +02001216 */
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001217static int is_connected_input_ep(struct snd_soc_dapm_widget *widget,
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001218 struct list_head *list,
1219 bool (*custom_stop_condition)(struct snd_soc_dapm_widget *i,
1220 enum snd_soc_dapm_direction))
Richard Purdie2b97eab2006-10-06 18:32:18 +02001221{
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001222 return is_connected_ep(widget, list, SND_SOC_DAPM_DIR_IN,
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001223 is_connected_input_ep, custom_stop_condition);
Richard Purdie2b97eab2006-10-06 18:32:18 +02001224}
1225
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001226/**
1227 * snd_soc_dapm_get_connected_widgets - query audio path and it's widgets.
1228 * @dai: the soc DAI.
1229 * @stream: stream direction.
1230 * @list: list of active widgets for this stream.
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001231 * @custom_stop_condition: (optional) a function meant to stop the widget graph
1232 * walk based on custom logic.
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001233 *
Peter Meerwald-Stadlerc8046002016-08-16 16:56:17 +02001234 * Queries DAPM graph as to whether a valid audio stream path exists for
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001235 * the initial stream specified by name. This takes into account
1236 * current mixer and mux kcontrol settings. Creates list of valid widgets.
1237 *
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001238 * Optionally, can be supplied with a function acting as a stopping condition.
1239 * This function takes the dapm widget currently being examined and the walk
1240 * direction as an arguments, it should return true if the walk should be
1241 * stopped and false otherwise.
1242 *
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001243 * Returns the number of valid paths or negative error.
1244 */
1245int snd_soc_dapm_dai_get_connected_widgets(struct snd_soc_dai *dai, int stream,
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001246 struct snd_soc_dapm_widget_list **list,
1247 bool (*custom_stop_condition)(struct snd_soc_dapm_widget *,
1248 enum snd_soc_dapm_direction))
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001249{
Lars-Peter Clausen313665b2014-11-04 11:30:58 +01001250 struct snd_soc_card *card = dai->component->card;
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +02001251 struct snd_soc_dapm_widget *w;
Lars-Peter Clausen1ce43ac2015-07-26 19:04:59 +02001252 LIST_HEAD(widgets);
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001253 int paths;
Lars-Peter Clausen1ce43ac2015-07-26 19:04:59 +02001254 int ret;
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001255
1256 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +02001257
1258 /*
1259 * For is_connected_{output,input}_ep fully discover the graph we need
1260 * to reset the cached number of inputs and outputs.
1261 */
1262 list_for_each_entry(w, &card->widgets, list) {
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02001263 w->endpoints[SND_SOC_DAPM_DIR_IN] = -1;
1264 w->endpoints[SND_SOC_DAPM_DIR_OUT] = -1;
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +02001265 }
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001266
Lars-Peter Clausen130897a2014-10-20 19:36:39 +02001267 if (stream == SNDRV_PCM_STREAM_PLAYBACK)
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001268 paths = is_connected_output_ep(dai->playback_widget, &widgets,
1269 custom_stop_condition);
Lars-Peter Clausen130897a2014-10-20 19:36:39 +02001270 else
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001271 paths = is_connected_input_ep(dai->capture_widget, &widgets,
1272 custom_stop_condition);
Lars-Peter Clausen1ce43ac2015-07-26 19:04:59 +02001273
1274 /* Drop starting point */
1275 list_del(widgets.next);
1276
1277 ret = dapm_widget_list_create(list, &widgets);
1278 if (ret)
Lars-Peter Clausen30abbe72015-08-11 21:37:59 +02001279 paths = ret;
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001280
1281 trace_snd_soc_dapm_connected(paths, stream);
Liam Girdwoodec2e3032012-04-18 11:41:11 +01001282 mutex_unlock(&card->dapm_mutex);
1283
1284 return paths;
1285}
1286
Richard Purdie2b97eab2006-10-06 18:32:18 +02001287/*
Mark Brown62ea8742012-01-21 21:14:48 +00001288 * Handler for regulator supply widget.
1289 */
1290int dapm_regulator_event(struct snd_soc_dapm_widget *w,
1291 struct snd_kcontrol *kcontrol, int event)
1292{
Mark Brownc05b84d2012-09-07 12:57:11 +08001293 int ret;
1294
Mark Browneb270e92013-10-09 13:52:52 +01001295 soc_dapm_async_complete(w->dapm);
1296
Mark Brownc05b84d2012-09-07 12:57:11 +08001297 if (SND_SOC_DAPM_EVENT_ON(event)) {
Lars-Peter Clausende9ba982013-07-29 17:14:01 +02001298 if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) {
Mark Brown8784c772013-01-10 19:33:47 +00001299 ret = regulator_allow_bypass(w->regulator, false);
Mark Brownc05b84d2012-09-07 12:57:11 +08001300 if (ret != 0)
1301 dev_warn(w->dapm->dev,
Charles Keepax30686c32014-02-18 16:05:27 +00001302 "ASoC: Failed to unbypass %s: %d\n",
Mark Brownc05b84d2012-09-07 12:57:11 +08001303 w->name, ret);
1304 }
1305
Liam Girdwooda3cc0562012-03-09 17:20:16 +00001306 return regulator_enable(w->regulator);
Mark Brownc05b84d2012-09-07 12:57:11 +08001307 } else {
Lars-Peter Clausende9ba982013-07-29 17:14:01 +02001308 if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) {
Mark Brown8784c772013-01-10 19:33:47 +00001309 ret = regulator_allow_bypass(w->regulator, true);
Mark Brownc05b84d2012-09-07 12:57:11 +08001310 if (ret != 0)
1311 dev_warn(w->dapm->dev,
Charles Keepax30686c32014-02-18 16:05:27 +00001312 "ASoC: Failed to bypass %s: %d\n",
Mark Brownc05b84d2012-09-07 12:57:11 +08001313 w->name, ret);
1314 }
1315
Liam Girdwooda3cc0562012-03-09 17:20:16 +00001316 return regulator_disable_deferred(w->regulator, w->shift);
Mark Brownc05b84d2012-09-07 12:57:11 +08001317 }
Mark Brown62ea8742012-01-21 21:14:48 +00001318}
1319EXPORT_SYMBOL_GPL(dapm_regulator_event);
1320
Ola Liljad7e7eb92012-05-24 15:26:25 +02001321/*
Srinivas Kandagatla5b2d15b2018-03-10 02:37:27 +00001322 * Handler for pinctrl widget.
1323 */
1324int dapm_pinctrl_event(struct snd_soc_dapm_widget *w,
1325 struct snd_kcontrol *kcontrol, int event)
1326{
1327 struct snd_soc_dapm_pinctrl_priv *priv = w->priv;
1328 struct pinctrl *p = w->pinctrl;
1329 struct pinctrl_state *s;
1330
1331 if (!p || !priv)
1332 return -EIO;
1333
1334 if (SND_SOC_DAPM_EVENT_ON(event))
1335 s = pinctrl_lookup_state(p, priv->active_state);
1336 else
1337 s = pinctrl_lookup_state(p, priv->sleep_state);
1338
1339 if (IS_ERR(s))
1340 return PTR_ERR(s);
1341
1342 return pinctrl_select_state(p, s);
1343}
1344EXPORT_SYMBOL_GPL(dapm_pinctrl_event);
1345
1346/*
Ola Liljad7e7eb92012-05-24 15:26:25 +02001347 * Handler for clock supply widget.
1348 */
1349int dapm_clock_event(struct snd_soc_dapm_widget *w,
1350 struct snd_kcontrol *kcontrol, int event)
1351{
1352 if (!w->clk)
1353 return -EIO;
1354
Mark Browneb270e92013-10-09 13:52:52 +01001355 soc_dapm_async_complete(w->dapm);
1356
Ola Liljad7e7eb92012-05-24 15:26:25 +02001357 if (SND_SOC_DAPM_EVENT_ON(event)) {
Fabio Baltieri37c1b922013-04-30 16:09:52 +02001358 return clk_prepare_enable(w->clk);
Ola Liljad7e7eb92012-05-24 15:26:25 +02001359 } else {
Fabio Baltieri37c1b922013-04-30 16:09:52 +02001360 clk_disable_unprepare(w->clk);
Ola Liljad7e7eb92012-05-24 15:26:25 +02001361 return 0;
1362 }
Charles Keepaxd78b1e432018-08-28 14:35:02 +01001363
Marek Belisko98b3cf12012-07-12 23:00:16 +02001364 return 0;
Ola Liljad7e7eb92012-05-24 15:26:25 +02001365}
1366EXPORT_SYMBOL_GPL(dapm_clock_event);
1367
Mark Brownd805002b2011-09-28 18:28:23 +01001368static int dapm_widget_power_check(struct snd_soc_dapm_widget *w)
1369{
Mark Brown9b8a83b2011-10-04 22:15:59 +01001370 if (w->power_checked)
1371 return w->new_power;
1372
Mark Brownd805002b2011-09-28 18:28:23 +01001373 if (w->force)
Mark Brown9b8a83b2011-10-04 22:15:59 +01001374 w->new_power = 1;
Mark Brownd805002b2011-09-28 18:28:23 +01001375 else
Mark Brown9b8a83b2011-10-04 22:15:59 +01001376 w->new_power = w->power_check(w);
1377
1378 w->power_checked = true;
1379
1380 return w->new_power;
Mark Brownd805002b2011-09-28 18:28:23 +01001381}
1382
Peter Meerwald-Stadlerc8046002016-08-16 16:56:17 +02001383/* Generic check to see if a widget should be powered. */
Mark Browncd0f2d42009-04-20 16:56:59 +01001384static int dapm_generic_check_power(struct snd_soc_dapm_widget *w)
1385{
1386 int in, out;
1387
Mark Brownde02d072011-09-20 21:43:24 +01001388 DAPM_UPDATE_STAT(w, power_checks);
1389
Piotr Stankiewicz67420642016-05-13 17:03:55 +01001390 in = is_connected_input_ep(w, NULL, NULL);
1391 out = is_connected_output_ep(w, NULL, NULL);
Mark Browncd0f2d42009-04-20 16:56:59 +01001392 return out != 0 && in != 0;
1393}
1394
Mark Brown246d0a12009-04-22 18:24:55 +01001395/* Check to see if a power supply is needed */
1396static int dapm_supply_check_power(struct snd_soc_dapm_widget *w)
1397{
1398 struct snd_soc_dapm_path *path;
Mark Brown246d0a12009-04-22 18:24:55 +01001399
Mark Brownde02d072011-09-20 21:43:24 +01001400 DAPM_UPDATE_STAT(w, power_checks);
1401
Mark Brown246d0a12009-04-22 18:24:55 +01001402 /* Check if one of our outputs is connected */
Lars-Peter Clausene63bfd42015-07-26 19:05:00 +02001403 snd_soc_dapm_widget_for_each_sink_path(w, path) {
Mark Browna8fdac82011-09-28 18:20:26 +01001404 DAPM_UPDATE_STAT(w, neighbour_checks);
1405
Mark Brownbf3a9e12011-06-13 16:42:29 +01001406 if (path->weak)
1407 continue;
1408
Mark Brown215edda2009-09-08 18:59:05 +01001409 if (path->connected &&
1410 !path->connected(path->source, path->sink))
1411 continue;
1412
Mark Brownf68d7e12011-10-04 22:57:50 +01001413 if (dapm_widget_power_check(path->sink))
1414 return 1;
Mark Brown246d0a12009-04-22 18:24:55 +01001415 }
1416
Mark Brownf68d7e12011-10-04 22:57:50 +01001417 return 0;
Mark Brown246d0a12009-04-22 18:24:55 +01001418}
1419
Mark Brown35c64bc2011-09-28 18:23:53 +01001420static int dapm_always_on_check_power(struct snd_soc_dapm_widget *w)
1421{
Charles Keepax20bb0182015-12-02 10:22:16 +00001422 return w->connected;
Mark Brown35c64bc2011-09-28 18:23:53 +01001423}
1424
Mark Brown38357ab2009-06-06 19:03:23 +01001425static int dapm_seq_compare(struct snd_soc_dapm_widget *a,
1426 struct snd_soc_dapm_widget *b,
Mark Brown828a8422011-01-15 13:14:30 +00001427 bool power_up)
Mark Brown42aa3412009-03-01 19:21:10 +00001428{
Mark Brown828a8422011-01-15 13:14:30 +00001429 int *sort;
1430
Pierre-Louis Bossartf13d4b52019-02-05 10:22:28 -06001431 BUILD_BUG_ON(ARRAY_SIZE(dapm_up_seq) != SND_SOC_DAPM_TYPE_COUNT);
1432 BUILD_BUG_ON(ARRAY_SIZE(dapm_down_seq) != SND_SOC_DAPM_TYPE_COUNT);
1433
Mark Brown828a8422011-01-15 13:14:30 +00001434 if (power_up)
1435 sort = dapm_up_seq;
1436 else
1437 sort = dapm_down_seq;
1438
Pierre-Louis Bossartf13d4b52019-02-05 10:22:28 -06001439 WARN_ONCE(sort[a->id] == 0, "offset a->id %d not initialized\n", a->id);
1440 WARN_ONCE(sort[b->id] == 0, "offset b->id %d not initialized\n", b->id);
1441
Mark Brown38357ab2009-06-06 19:03:23 +01001442 if (sort[a->id] != sort[b->id])
1443 return sort[a->id] - sort[b->id];
Mark Brown20e48592011-01-15 13:40:50 +00001444 if (a->subseq != b->subseq) {
1445 if (power_up)
1446 return a->subseq - b->subseq;
1447 else
1448 return b->subseq - a->subseq;
1449 }
Mark Brownb22ead22009-06-07 12:51:26 +01001450 if (a->reg != b->reg)
1451 return a->reg - b->reg;
Mark Brown84dab562010-11-12 15:28:42 +00001452 if (a->dapm != b->dapm)
1453 return (unsigned long)a->dapm - (unsigned long)b->dapm;
Mark Brown42aa3412009-03-01 19:21:10 +00001454
Mark Brown38357ab2009-06-06 19:03:23 +01001455 return 0;
1456}
Mark Brown42aa3412009-03-01 19:21:10 +00001457
Mark Brown38357ab2009-06-06 19:03:23 +01001458/* Insert a widget in order into a DAPM power sequence. */
1459static void dapm_seq_insert(struct snd_soc_dapm_widget *new_widget,
1460 struct list_head *list,
Mark Brown828a8422011-01-15 13:14:30 +00001461 bool power_up)
Mark Brown38357ab2009-06-06 19:03:23 +01001462{
1463 struct snd_soc_dapm_widget *w;
1464
1465 list_for_each_entry(w, list, power_list)
Mark Brown828a8422011-01-15 13:14:30 +00001466 if (dapm_seq_compare(new_widget, w, power_up) < 0) {
Mark Brown38357ab2009-06-06 19:03:23 +01001467 list_add_tail(&new_widget->power_list, &w->power_list);
1468 return;
Mark Brown42aa3412009-03-01 19:21:10 +00001469 }
Mark Brown6ea31b92009-04-20 17:15:41 +01001470
Mark Brown38357ab2009-06-06 19:03:23 +01001471 list_add_tail(&new_widget->power_list, list);
1472}
Mark Brown42aa3412009-03-01 19:21:10 +00001473
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001474static void dapm_seq_check_event(struct snd_soc_card *card,
Mark Brown68f89ad2010-11-03 23:51:49 -04001475 struct snd_soc_dapm_widget *w, int event)
1476{
Mark Brown68f89ad2010-11-03 23:51:49 -04001477 const char *ev_name;
1478 int power, ret;
1479
1480 switch (event) {
1481 case SND_SOC_DAPM_PRE_PMU:
1482 ev_name = "PRE_PMU";
1483 power = 1;
1484 break;
1485 case SND_SOC_DAPM_POST_PMU:
1486 ev_name = "POST_PMU";
1487 power = 1;
1488 break;
1489 case SND_SOC_DAPM_PRE_PMD:
1490 ev_name = "PRE_PMD";
1491 power = 0;
1492 break;
1493 case SND_SOC_DAPM_POST_PMD:
1494 ev_name = "POST_PMD";
1495 power = 0;
1496 break;
Mark Brown80114122013-02-25 15:14:19 +00001497 case SND_SOC_DAPM_WILL_PMU:
1498 ev_name = "WILL_PMU";
1499 power = 1;
1500 break;
1501 case SND_SOC_DAPM_WILL_PMD:
1502 ev_name = "WILL_PMD";
1503 power = 0;
1504 break;
Mark Brown68f89ad2010-11-03 23:51:49 -04001505 default:
Takashi Iwaia6ed0602013-11-06 11:07:19 +01001506 WARN(1, "Unknown event %d\n", event);
Mark Brown68f89ad2010-11-03 23:51:49 -04001507 return;
1508 }
1509
Lars-Peter Clausen39eb5fd2013-07-29 17:14:03 +02001510 if (w->new_power != power)
Mark Brown68f89ad2010-11-03 23:51:49 -04001511 return;
1512
1513 if (w->event && (w->event_flags & event)) {
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001514 pop_dbg(w->dapm->dev, card->pop_time, "pop test : %s %s\n",
Mark Brown68f89ad2010-11-03 23:51:49 -04001515 w->name, ev_name);
Mark Browneb270e92013-10-09 13:52:52 +01001516 soc_dapm_async_complete(w->dapm);
Mark Brown84e90932010-11-04 00:07:02 -04001517 trace_snd_soc_dapm_widget_event_start(w, event);
Mark Brown68f89ad2010-11-03 23:51:49 -04001518 ret = w->event(w, NULL, event);
Mark Brown84e90932010-11-04 00:07:02 -04001519 trace_snd_soc_dapm_widget_event_done(w, event);
Mark Brown68f89ad2010-11-03 23:51:49 -04001520 if (ret < 0)
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001521 dev_err(w->dapm->dev, "ASoC: %s: %s event failed: %d\n",
Mark Brown68f89ad2010-11-03 23:51:49 -04001522 ev_name, w->name, ret);
1523 }
1524}
1525
Mark Brownb22ead22009-06-07 12:51:26 +01001526/* Apply the coalesced changes from a DAPM sequence */
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001527static void dapm_seq_run_coalesced(struct snd_soc_card *card,
Mark Brownb22ead22009-06-07 12:51:26 +01001528 struct list_head *pending)
Mark Brown163cac02009-06-07 10:12:52 +01001529{
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02001530 struct snd_soc_dapm_context *dapm;
Mark Brown68f89ad2010-11-03 23:51:49 -04001531 struct snd_soc_dapm_widget *w;
Lars-Peter Clausende9ba982013-07-29 17:14:01 +02001532 int reg;
Mark Brownb22ead22009-06-07 12:51:26 +01001533 unsigned int value = 0;
1534 unsigned int mask = 0;
Mark Brownb22ead22009-06-07 12:51:26 +01001535
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02001536 w = list_first_entry(pending, struct snd_soc_dapm_widget, power_list);
1537 reg = w->reg;
1538 dapm = w->dapm;
Mark Brownb22ead22009-06-07 12:51:26 +01001539
1540 list_for_each_entry(w, pending, power_list) {
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02001541 WARN_ON(reg != w->reg || dapm != w->dapm);
Lars-Peter Clausen39eb5fd2013-07-29 17:14:03 +02001542 w->power = w->new_power;
Mark Brownb22ead22009-06-07 12:51:26 +01001543
Lars-Peter Clausende9ba982013-07-29 17:14:01 +02001544 mask |= w->mask << w->shift;
1545 if (w->power)
1546 value |= w->on_val << w->shift;
Mark Brownb22ead22009-06-07 12:51:26 +01001547 else
Lars-Peter Clausende9ba982013-07-29 17:14:01 +02001548 value |= w->off_val << w->shift;
Mark Brownb22ead22009-06-07 12:51:26 +01001549
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02001550 pop_dbg(dapm->dev, card->pop_time,
Mark Brownb22ead22009-06-07 12:51:26 +01001551 "pop test : Queue %s: reg=0x%x, 0x%x/0x%x\n",
1552 w->name, reg, value, mask);
Mark Brown81628102009-06-07 13:21:24 +01001553
Mark Brown68f89ad2010-11-03 23:51:49 -04001554 /* Check for events */
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001555 dapm_seq_check_event(card, w, SND_SOC_DAPM_PRE_PMU);
1556 dapm_seq_check_event(card, w, SND_SOC_DAPM_PRE_PMD);
Mark Brownb22ead22009-06-07 12:51:26 +01001557 }
1558
Mark Brown81628102009-06-07 13:21:24 +01001559 if (reg >= 0) {
Mark Brown29376bc2011-06-19 13:49:28 +01001560 /* Any widget will do, they should all be updating the
1561 * same register.
1562 */
Mark Brown29376bc2011-06-19 13:49:28 +01001563
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02001564 pop_dbg(dapm->dev, card->pop_time,
Mark Brown81628102009-06-07 13:21:24 +01001565 "pop test : Applying 0x%x/0x%x to %x in %dms\n",
Jarkko Nikula3a45b862010-11-05 20:35:21 +02001566 value, mask, reg, card->pop_time);
1567 pop_wait(card->pop_time);
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02001568 soc_dapm_update_bits(dapm, reg, mask, value);
Mark Brown81628102009-06-07 13:21:24 +01001569 }
1570
1571 list_for_each_entry(w, pending, power_list) {
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001572 dapm_seq_check_event(card, w, SND_SOC_DAPM_POST_PMU);
1573 dapm_seq_check_event(card, w, SND_SOC_DAPM_POST_PMD);
Mark Brown42aa3412009-03-01 19:21:10 +00001574 }
Mark Brown42aa3412009-03-01 19:21:10 +00001575}
1576
Mark Brownb22ead22009-06-07 12:51:26 +01001577/* Apply a DAPM power sequence.
1578 *
1579 * We walk over a pre-sorted list of widgets to apply power to. In
1580 * order to minimise the number of writes to the device required
1581 * multiple widgets will be updated in a single write where possible.
1582 * Currently anything that requires more than a single write is not
1583 * handled.
1584 */
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001585static void dapm_seq_run(struct snd_soc_card *card,
1586 struct list_head *list, int event, bool power_up)
Mark Brownb22ead22009-06-07 12:51:26 +01001587{
1588 struct snd_soc_dapm_widget *w, *n;
Mark Browneb270e92013-10-09 13:52:52 +01001589 struct snd_soc_dapm_context *d;
Mark Brownb22ead22009-06-07 12:51:26 +01001590 LIST_HEAD(pending);
1591 int cur_sort = -1;
Mark Brown20e48592011-01-15 13:40:50 +00001592 int cur_subseq = -1;
Mark Brownb22ead22009-06-07 12:51:26 +01001593 int cur_reg = SND_SOC_NOPM;
Jarkko Nikula7be31be82010-12-14 12:18:32 +02001594 struct snd_soc_dapm_context *cur_dapm = NULL;
Mark Brown474b62d2011-01-18 16:14:44 +00001595 int ret, i;
Mark Brown828a8422011-01-15 13:14:30 +00001596 int *sort;
1597
1598 if (power_up)
1599 sort = dapm_up_seq;
1600 else
1601 sort = dapm_down_seq;
Mark Brown163cac02009-06-07 10:12:52 +01001602
Mark Brownb22ead22009-06-07 12:51:26 +01001603 list_for_each_entry_safe(w, n, list, power_list) {
1604 ret = 0;
1605
1606 /* Do we need to apply any queued changes? */
Jarkko Nikula7be31be82010-12-14 12:18:32 +02001607 if (sort[w->id] != cur_sort || w->reg != cur_reg ||
Mark Brown20e48592011-01-15 13:40:50 +00001608 w->dapm != cur_dapm || w->subseq != cur_subseq) {
Mark Brownb22ead22009-06-07 12:51:26 +01001609 if (!list_empty(&pending))
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001610 dapm_seq_run_coalesced(card, &pending);
Mark Brownb22ead22009-06-07 12:51:26 +01001611
Mark Brown474b62d2011-01-18 16:14:44 +00001612 if (cur_dapm && cur_dapm->seq_notifier) {
1613 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
1614 if (sort[i] == cur_sort)
1615 cur_dapm->seq_notifier(cur_dapm,
Mark Brownf85a9e02011-01-26 21:41:28 +00001616 i,
1617 cur_subseq);
Mark Brown474b62d2011-01-18 16:14:44 +00001618 }
1619
Mark Browneb270e92013-10-09 13:52:52 +01001620 if (cur_dapm && w->dapm != cur_dapm)
1621 soc_dapm_async_complete(cur_dapm);
1622
Mark Brownb22ead22009-06-07 12:51:26 +01001623 INIT_LIST_HEAD(&pending);
1624 cur_sort = -1;
Mark Brownb0b3e6f2011-07-16 10:55:08 +09001625 cur_subseq = INT_MIN;
Mark Brownb22ead22009-06-07 12:51:26 +01001626 cur_reg = SND_SOC_NOPM;
Jarkko Nikula7be31be82010-12-14 12:18:32 +02001627 cur_dapm = NULL;
Mark Brownb22ead22009-06-07 12:51:26 +01001628 }
1629
Mark Brown163cac02009-06-07 10:12:52 +01001630 switch (w->id) {
1631 case snd_soc_dapm_pre:
1632 if (!w->event)
Mark Brownb22ead22009-06-07 12:51:26 +01001633 list_for_each_entry_safe_continue(w, n, list,
1634 power_list);
Mark Brown163cac02009-06-07 10:12:52 +01001635
Mark Brownb22ead22009-06-07 12:51:26 +01001636 if (event == SND_SOC_DAPM_STREAM_START)
Mark Brown163cac02009-06-07 10:12:52 +01001637 ret = w->event(w,
1638 NULL, SND_SOC_DAPM_PRE_PMU);
Mark Brownb22ead22009-06-07 12:51:26 +01001639 else if (event == SND_SOC_DAPM_STREAM_STOP)
Mark Brown163cac02009-06-07 10:12:52 +01001640 ret = w->event(w,
1641 NULL, SND_SOC_DAPM_PRE_PMD);
Mark Brown163cac02009-06-07 10:12:52 +01001642 break;
1643
1644 case snd_soc_dapm_post:
1645 if (!w->event)
Mark Brownb22ead22009-06-07 12:51:26 +01001646 list_for_each_entry_safe_continue(w, n, list,
1647 power_list);
Mark Brown163cac02009-06-07 10:12:52 +01001648
Mark Brownb22ead22009-06-07 12:51:26 +01001649 if (event == SND_SOC_DAPM_STREAM_START)
Mark Brown163cac02009-06-07 10:12:52 +01001650 ret = w->event(w,
1651 NULL, SND_SOC_DAPM_POST_PMU);
Mark Brownb22ead22009-06-07 12:51:26 +01001652 else if (event == SND_SOC_DAPM_STREAM_STOP)
Mark Brown163cac02009-06-07 10:12:52 +01001653 ret = w->event(w,
1654 NULL, SND_SOC_DAPM_POST_PMD);
Mark Brownb22ead22009-06-07 12:51:26 +01001655 break;
1656
Mark Brown163cac02009-06-07 10:12:52 +01001657 default:
Mark Brown81628102009-06-07 13:21:24 +01001658 /* Queue it up for application */
1659 cur_sort = sort[w->id];
Mark Brown20e48592011-01-15 13:40:50 +00001660 cur_subseq = w->subseq;
Mark Brown81628102009-06-07 13:21:24 +01001661 cur_reg = w->reg;
Jarkko Nikula7be31be82010-12-14 12:18:32 +02001662 cur_dapm = w->dapm;
Mark Brown81628102009-06-07 13:21:24 +01001663 list_move(&w->power_list, &pending);
1664 break;
Mark Brown163cac02009-06-07 10:12:52 +01001665 }
Mark Brownb22ead22009-06-07 12:51:26 +01001666
1667 if (ret < 0)
Jarkko Nikulaf7d41ae2010-11-09 14:40:27 +02001668 dev_err(w->dapm->dev,
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00001669 "ASoC: Failed to apply widget power: %d\n", ret);
Mark Brown163cac02009-06-07 10:12:52 +01001670 }
Mark Brownb22ead22009-06-07 12:51:26 +01001671
1672 if (!list_empty(&pending))
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001673 dapm_seq_run_coalesced(card, &pending);
Mark Brown474b62d2011-01-18 16:14:44 +00001674
1675 if (cur_dapm && cur_dapm->seq_notifier) {
1676 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
1677 if (sort[i] == cur_sort)
1678 cur_dapm->seq_notifier(cur_dapm,
Mark Brownf85a9e02011-01-26 21:41:28 +00001679 i, cur_subseq);
Mark Brown474b62d2011-01-18 16:14:44 +00001680 }
Mark Browneb270e92013-10-09 13:52:52 +01001681
1682 list_for_each_entry(d, &card->dapm_list, list) {
1683 soc_dapm_async_complete(d);
1684 }
Mark Brown163cac02009-06-07 10:12:52 +01001685}
1686
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001687static void dapm_widget_update(struct snd_soc_card *card)
Mark Brown97404f22010-12-14 16:13:57 +00001688{
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001689 struct snd_soc_dapm_update *update = card->update;
Lars-Peter Clausence6cfaf2013-07-24 15:27:37 +02001690 struct snd_soc_dapm_widget_list *wlist;
1691 struct snd_soc_dapm_widget *w = NULL;
1692 unsigned int wi;
Mark Brown97404f22010-12-14 16:13:57 +00001693 int ret;
1694
Lars-Peter Clausen57295072013-08-05 11:27:31 +02001695 if (!update || !dapm_kcontrol_is_powered(update->kcontrol))
Mark Brown97404f22010-12-14 16:13:57 +00001696 return;
1697
Lars-Peter Clausene84357f2013-07-29 17:13:58 +02001698 wlist = dapm_kcontrol_get_wlist(update->kcontrol);
Mark Brown97404f22010-12-14 16:13:57 +00001699
Lars-Peter Clausence6cfaf2013-07-24 15:27:37 +02001700 for (wi = 0; wi < wlist->num_widgets; wi++) {
1701 w = wlist->widgets[wi];
1702
1703 if (w->event && (w->event_flags & SND_SOC_DAPM_PRE_REG)) {
1704 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_PRE_REG);
1705 if (ret != 0)
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001706 dev_err(w->dapm->dev, "ASoC: %s DAPM pre-event failed: %d\n",
Lars-Peter Clausence6cfaf2013-07-24 15:27:37 +02001707 w->name, ret);
1708 }
Mark Brown97404f22010-12-14 16:13:57 +00001709 }
1710
Lars-Peter Clausence6cfaf2013-07-24 15:27:37 +02001711 if (!w)
1712 return;
1713
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02001714 ret = soc_dapm_update_bits(w->dapm, update->reg, update->mask,
1715 update->val);
Mark Brown97404f22010-12-14 16:13:57 +00001716 if (ret < 0)
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001717 dev_err(w->dapm->dev, "ASoC: %s DAPM update failed: %d\n",
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00001718 w->name, ret);
Mark Brown97404f22010-12-14 16:13:57 +00001719
Chen-Yu Tsaie411b0b2016-11-02 15:35:58 +08001720 if (update->has_second_set) {
1721 ret = soc_dapm_update_bits(w->dapm, update->reg2,
1722 update->mask2, update->val2);
1723 if (ret < 0)
1724 dev_err(w->dapm->dev,
1725 "ASoC: %s DAPM update failed: %d\n",
1726 w->name, ret);
1727 }
1728
Lars-Peter Clausence6cfaf2013-07-24 15:27:37 +02001729 for (wi = 0; wi < wlist->num_widgets; wi++) {
1730 w = wlist->widgets[wi];
1731
1732 if (w->event && (w->event_flags & SND_SOC_DAPM_POST_REG)) {
1733 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_POST_REG);
1734 if (ret != 0)
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001735 dev_err(w->dapm->dev, "ASoC: %s DAPM post-event failed: %d\n",
Lars-Peter Clausence6cfaf2013-07-24 15:27:37 +02001736 w->name, ret);
1737 }
Mark Brown97404f22010-12-14 16:13:57 +00001738 }
1739}
1740
Mark Brown9d0624a2011-02-18 11:49:43 -08001741/* Async callback run prior to DAPM sequences - brings to _PREPARE if
1742 * they're changing state.
1743 */
1744static void dapm_pre_sequence_async(void *data, async_cookie_t cookie)
1745{
1746 struct snd_soc_dapm_context *d = data;
1747 int ret;
Mark Brown97404f22010-12-14 16:13:57 +00001748
Peter Meerwald-Stadlerc8046002016-08-16 16:56:17 +02001749 /* If we're off and we're not supposed to go into STANDBY */
Mark Brown56fba412011-06-04 11:25:10 +01001750 if (d->bias_level == SND_SOC_BIAS_OFF &&
1751 d->target_bias_level != SND_SOC_BIAS_OFF) {
Mark Brownf1aac482011-12-05 15:17:06 +00001752 if (d->dev)
1753 pm_runtime_get_sync(d->dev);
1754
Mark Brown9d0624a2011-02-18 11:49:43 -08001755 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
1756 if (ret != 0)
1757 dev_err(d->dev,
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00001758 "ASoC: Failed to turn on bias: %d\n", ret);
Mark Brown9d0624a2011-02-18 11:49:43 -08001759 }
1760
Lars-Peter Clausence85a4d2014-05-06 10:32:15 +02001761 /* Prepare for a transition to ON or away from ON */
1762 if ((d->target_bias_level == SND_SOC_BIAS_ON &&
1763 d->bias_level != SND_SOC_BIAS_ON) ||
1764 (d->target_bias_level != SND_SOC_BIAS_ON &&
1765 d->bias_level == SND_SOC_BIAS_ON)) {
Mark Brown9d0624a2011-02-18 11:49:43 -08001766 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_PREPARE);
1767 if (ret != 0)
1768 dev_err(d->dev,
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00001769 "ASoC: Failed to prepare bias: %d\n", ret);
Mark Brown9d0624a2011-02-18 11:49:43 -08001770 }
1771}
1772
1773/* Async callback run prior to DAPM sequences - brings to their final
1774 * state.
1775 */
1776static void dapm_post_sequence_async(void *data, async_cookie_t cookie)
1777{
1778 struct snd_soc_dapm_context *d = data;
1779 int ret;
1780
1781 /* If we just powered the last thing off drop to standby bias */
Mark Brown56fba412011-06-04 11:25:10 +01001782 if (d->bias_level == SND_SOC_BIAS_PREPARE &&
1783 (d->target_bias_level == SND_SOC_BIAS_STANDBY ||
1784 d->target_bias_level == SND_SOC_BIAS_OFF)) {
Mark Brown9d0624a2011-02-18 11:49:43 -08001785 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
1786 if (ret != 0)
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00001787 dev_err(d->dev, "ASoC: Failed to apply standby bias: %d\n",
Mark Brown9d0624a2011-02-18 11:49:43 -08001788 ret);
1789 }
1790
1791 /* If we're in standby and can support bias off then do that */
Mark Brown56fba412011-06-04 11:25:10 +01001792 if (d->bias_level == SND_SOC_BIAS_STANDBY &&
1793 d->target_bias_level == SND_SOC_BIAS_OFF) {
Mark Brown9d0624a2011-02-18 11:49:43 -08001794 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_OFF);
1795 if (ret != 0)
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00001796 dev_err(d->dev, "ASoC: Failed to turn off bias: %d\n",
1797 ret);
Mark Brownf1aac482011-12-05 15:17:06 +00001798
1799 if (d->dev)
Mark Brownfb644e92012-01-25 19:53:58 +00001800 pm_runtime_put(d->dev);
Mark Brown9d0624a2011-02-18 11:49:43 -08001801 }
1802
1803 /* If we just powered up then move to active bias */
Mark Brown56fba412011-06-04 11:25:10 +01001804 if (d->bias_level == SND_SOC_BIAS_PREPARE &&
1805 d->target_bias_level == SND_SOC_BIAS_ON) {
Mark Brown9d0624a2011-02-18 11:49:43 -08001806 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_ON);
1807 if (ret != 0)
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00001808 dev_err(d->dev, "ASoC: Failed to apply active bias: %d\n",
Mark Brown9d0624a2011-02-18 11:49:43 -08001809 ret);
1810 }
1811}
Mark Brown97404f22010-12-14 16:13:57 +00001812
Mark Brownfe4fda52011-10-03 22:36:57 +01001813static void dapm_widget_set_peer_power(struct snd_soc_dapm_widget *peer,
1814 bool power, bool connect)
1815{
1816 /* If a connection is being made or broken then that update
1817 * will have marked the peer dirty, otherwise the widgets are
1818 * not connected and this update has no impact. */
1819 if (!connect)
1820 return;
1821
1822 /* If the peer is already in the state we're moving to then we
1823 * won't have an impact on it. */
1824 if (power != peer->power)
Mark Brown75c1f892011-10-04 22:28:08 +01001825 dapm_mark_dirty(peer, "peer state change");
Mark Brownfe4fda52011-10-03 22:36:57 +01001826}
1827
Mark Brown05623c42011-09-28 17:02:31 +01001828static void dapm_widget_set_power(struct snd_soc_dapm_widget *w, bool power,
1829 struct list_head *up_list,
1830 struct list_head *down_list)
1831{
Mark Browndb432b42011-10-03 21:06:40 +01001832 struct snd_soc_dapm_path *path;
1833
Mark Brown05623c42011-09-28 17:02:31 +01001834 if (w->power == power)
1835 return;
1836
1837 trace_snd_soc_dapm_widget_power(w, power);
1838
Mark Browndb432b42011-10-03 21:06:40 +01001839 /* If we changed our power state perhaps our neigbours changed
Mark Brownfe4fda52011-10-03 22:36:57 +01001840 * also.
Mark Browndb432b42011-10-03 21:06:40 +01001841 */
Lars-Peter Clausene63bfd42015-07-26 19:05:00 +02001842 snd_soc_dapm_widget_for_each_source_path(w, path)
Lars-Peter Clausen7ddd4cd2014-10-20 19:36:34 +02001843 dapm_widget_set_peer_power(path->source, power, path->connect);
1844
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02001845 /* Supplies can't affect their outputs, only their inputs */
1846 if (!w->is_supply) {
Lars-Peter Clausene63bfd42015-07-26 19:05:00 +02001847 snd_soc_dapm_widget_for_each_sink_path(w, path)
Lars-Peter Clausen7ddd4cd2014-10-20 19:36:34 +02001848 dapm_widget_set_peer_power(path->sink, power,
1849 path->connect);
Mark Browndb432b42011-10-03 21:06:40 +01001850 }
1851
Mark Brown05623c42011-09-28 17:02:31 +01001852 if (power)
1853 dapm_seq_insert(w, up_list, true);
1854 else
1855 dapm_seq_insert(w, down_list, false);
Mark Brown05623c42011-09-28 17:02:31 +01001856}
1857
Mark Brown7c81beb2011-09-20 22:22:32 +01001858static void dapm_power_one_widget(struct snd_soc_dapm_widget *w,
1859 struct list_head *up_list,
1860 struct list_head *down_list)
1861{
Mark Brown7c81beb2011-09-20 22:22:32 +01001862 int power;
1863
1864 switch (w->id) {
1865 case snd_soc_dapm_pre:
1866 dapm_seq_insert(w, down_list, false);
1867 break;
1868 case snd_soc_dapm_post:
1869 dapm_seq_insert(w, up_list, true);
1870 break;
1871
1872 default:
Mark Brownd805002b2011-09-28 18:28:23 +01001873 power = dapm_widget_power_check(w);
Mark Brown7c81beb2011-09-20 22:22:32 +01001874
Mark Brown05623c42011-09-28 17:02:31 +01001875 dapm_widget_set_power(w, power, up_list, down_list);
Mark Brown7c81beb2011-09-20 22:22:32 +01001876 break;
1877 }
1878}
1879
Lars-Peter Clausen86dbf2a2014-09-04 19:44:06 +02001880static bool dapm_idle_bias_off(struct snd_soc_dapm_context *dapm)
1881{
1882 if (dapm->idle_bias_off)
1883 return true;
1884
1885 switch (snd_power_get_state(dapm->card->snd_card)) {
1886 case SNDRV_CTL_POWER_D3hot:
1887 case SNDRV_CTL_POWER_D3cold:
1888 return dapm->suspend_bias_off;
1889 default:
1890 break;
1891 }
1892
1893 return false;
1894}
1895
Mark Brown42aa3412009-03-01 19:21:10 +00001896/*
Richard Purdie2b97eab2006-10-06 18:32:18 +02001897 * Scan each dapm widget for complete audio path.
1898 * A complete path is a route that has valid endpoints i.e.:-
1899 *
1900 * o DAC to output pin.
Peter Meerwald-Stadlerc8046002016-08-16 16:56:17 +02001901 * o Input pin to ADC.
Richard Purdie2b97eab2006-10-06 18:32:18 +02001902 * o Input pin to Output pin (bypass, sidetone)
1903 * o DAC to ADC (loopback).
1904 */
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02001905static int dapm_power_widgets(struct snd_soc_card *card, int event)
Richard Purdie2b97eab2006-10-06 18:32:18 +02001906{
1907 struct snd_soc_dapm_widget *w;
Jarkko Nikula7be31be82010-12-14 12:18:32 +02001908 struct snd_soc_dapm_context *d;
Mark Brown291f3bb2009-06-07 13:57:17 +01001909 LIST_HEAD(up_list);
1910 LIST_HEAD(down_list);
Dan Williams2955b472012-07-09 19:33:25 -07001911 ASYNC_DOMAIN_EXCLUSIVE(async_domain);
Mark Brown56fba412011-06-04 11:25:10 +01001912 enum snd_soc_bias_level bias;
Richard Purdie2b97eab2006-10-06 18:32:18 +02001913
Mark Brownf9fa2b12014-03-06 16:49:11 +08001914 lockdep_assert_held(&card->dapm_mutex);
1915
Mark Brown84e90932010-11-04 00:07:02 -04001916 trace_snd_soc_dapm_start(card);
1917
Mark Brown56fba412011-06-04 11:25:10 +01001918 list_for_each_entry(d, &card->dapm_list, list) {
Lars-Peter Clausen86dbf2a2014-09-04 19:44:06 +02001919 if (dapm_idle_bias_off(d))
Mark Brown497098be2012-03-08 15:06:09 +00001920 d->target_bias_level = SND_SOC_BIAS_OFF;
1921 else
1922 d->target_bias_level = SND_SOC_BIAS_STANDBY;
Mark Brown56fba412011-06-04 11:25:10 +01001923 }
Jarkko Nikula7be31be82010-12-14 12:18:32 +02001924
Liam Girdwood6c120e12012-02-15 15:15:34 +00001925 dapm_reset(card);
Mark Brown9b8a83b2011-10-04 22:15:59 +01001926
Mark Brown6d3ddc82009-05-16 17:47:29 +01001927 /* Check which widgets we need to power and store them in
Mark Browndb432b42011-10-03 21:06:40 +01001928 * lists indicating if they should be powered up or down. We
1929 * only check widgets that have been flagged as dirty but note
1930 * that new widgets may be added to the dirty list while we
1931 * iterate.
Mark Brown6d3ddc82009-05-16 17:47:29 +01001932 */
Mark Browndb432b42011-10-03 21:06:40 +01001933 list_for_each_entry(w, &card->dapm_dirty, dirty) {
Mark Brown7c81beb2011-09-20 22:22:32 +01001934 dapm_power_one_widget(w, &up_list, &down_list);
Richard Purdie2b97eab2006-10-06 18:32:18 +02001935 }
1936
Mark Brownf9de6d72011-09-28 17:19:47 +01001937 list_for_each_entry(w, &card->widgets, list) {
Mark Brown0ff97eb2012-07-20 17:29:34 +01001938 switch (w->id) {
1939 case snd_soc_dapm_pre:
1940 case snd_soc_dapm_post:
1941 /* These widgets always need to be powered */
1942 break;
1943 default:
1944 list_del_init(&w->dirty);
1945 break;
1946 }
Mark Browndb432b42011-10-03 21:06:40 +01001947
Lars-Peter Clausen39eb5fd2013-07-29 17:14:03 +02001948 if (w->new_power) {
Mark Brownf9de6d72011-09-28 17:19:47 +01001949 d = w->dapm;
1950
1951 /* Supplies and micbiases only bring the
1952 * context up to STANDBY as unless something
1953 * else is active and passing audio they
Mark Brownafe62362012-01-25 19:55:22 +00001954 * generally don't require full power. Signal
1955 * generators are virtual pins and have no
1956 * power impact themselves.
Mark Brownf9de6d72011-09-28 17:19:47 +01001957 */
1958 switch (w->id) {
Mark Brownafe62362012-01-25 19:55:22 +00001959 case snd_soc_dapm_siggen:
Lars-Peter Clausenda83fea2013-10-05 19:26:17 +02001960 case snd_soc_dapm_vmid:
Mark Brownafe62362012-01-25 19:55:22 +00001961 break;
Mark Brownf9de6d72011-09-28 17:19:47 +01001962 case snd_soc_dapm_supply:
Mark Brown62ea8742012-01-21 21:14:48 +00001963 case snd_soc_dapm_regulator_supply:
Srinivas Kandagatla5b2d15b2018-03-10 02:37:27 +00001964 case snd_soc_dapm_pinctrl:
Ola Liljad7e7eb92012-05-24 15:26:25 +02001965 case snd_soc_dapm_clock_supply:
Mark Brownf9de6d72011-09-28 17:19:47 +01001966 case snd_soc_dapm_micbias:
1967 if (d->target_bias_level < SND_SOC_BIAS_STANDBY)
1968 d->target_bias_level = SND_SOC_BIAS_STANDBY;
1969 break;
1970 default:
1971 d->target_bias_level = SND_SOC_BIAS_ON;
1972 break;
1973 }
1974 }
1975
1976 }
1977
Mark Brown85a843c2011-09-21 21:29:47 +01001978 /* Force all contexts in the card to the same bias state if
1979 * they're not ground referenced.
1980 */
Mark Brown56fba412011-06-04 11:25:10 +01001981 bias = SND_SOC_BIAS_OFF;
Mark Brown52ba67b2011-04-04 21:05:11 +09001982 list_for_each_entry(d, &card->dapm_list, list)
Mark Brown56fba412011-06-04 11:25:10 +01001983 if (d->target_bias_level > bias)
1984 bias = d->target_bias_level;
Mark Brown52ba67b2011-04-04 21:05:11 +09001985 list_for_each_entry(d, &card->dapm_list, list)
Lars-Peter Clausen86dbf2a2014-09-04 19:44:06 +02001986 if (!dapm_idle_bias_off(d))
Mark Brown85a843c2011-09-21 21:29:47 +01001987 d->target_bias_level = bias;
Mark Brown52ba67b2011-04-04 21:05:11 +09001988
Mark Brownde02d072011-09-20 21:43:24 +01001989 trace_snd_soc_dapm_walk_done(card);
Mark Brown52ba67b2011-04-04 21:05:11 +09001990
Xiang Xiao17282ba2014-03-02 00:04:03 +08001991 /* Run card bias changes at first */
1992 dapm_pre_sequence_async(&card->dapm, 0);
1993 /* Run other bias changes in parallel */
1994 list_for_each_entry(d, &card->dapm_list, list) {
Jon Huntere03546d2018-08-17 16:35:43 +01001995 if (d != &card->dapm && d->bias_level != d->target_bias_level)
Xiang Xiao17282ba2014-03-02 00:04:03 +08001996 async_schedule_domain(dapm_pre_sequence_async, d,
1997 &async_domain);
1998 }
Mark Brown9d0624a2011-02-18 11:49:43 -08001999 async_synchronize_full_domain(&async_domain);
Mark Brown452c5ea2009-05-17 21:41:23 +01002000
Lars-Peter Clausencf1f7c62013-05-23 00:12:53 +02002001 list_for_each_entry(w, &down_list, power_list) {
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02002002 dapm_seq_check_event(card, w, SND_SOC_DAPM_WILL_PMD);
Mark Brown80114122013-02-25 15:14:19 +00002003 }
2004
Lars-Peter Clausencf1f7c62013-05-23 00:12:53 +02002005 list_for_each_entry(w, &up_list, power_list) {
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02002006 dapm_seq_check_event(card, w, SND_SOC_DAPM_WILL_PMU);
Mark Brown80114122013-02-25 15:14:19 +00002007 }
2008
Mark Brown6d3ddc82009-05-16 17:47:29 +01002009 /* Power down widgets first; try to avoid amplifying pops. */
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02002010 dapm_seq_run(card, &down_list, event, false);
Mark Brown6d3ddc82009-05-16 17:47:29 +01002011
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02002012 dapm_widget_update(card);
Mark Brown97404f22010-12-14 16:13:57 +00002013
Mark Brown6d3ddc82009-05-16 17:47:29 +01002014 /* Now power up. */
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02002015 dapm_seq_run(card, &up_list, event, true);
Richard Purdie2b97eab2006-10-06 18:32:18 +02002016
Mark Brown9d0624a2011-02-18 11:49:43 -08002017 /* Run all the bias changes in parallel */
Xiang Xiao17282ba2014-03-02 00:04:03 +08002018 list_for_each_entry(d, &card->dapm_list, list) {
Jon Huntere03546d2018-08-17 16:35:43 +01002019 if (d != &card->dapm && d->bias_level != d->target_bias_level)
Xiang Xiao17282ba2014-03-02 00:04:03 +08002020 async_schedule_domain(dapm_post_sequence_async, d,
2021 &async_domain);
2022 }
Mark Brown9d0624a2011-02-18 11:49:43 -08002023 async_synchronize_full_domain(&async_domain);
Xiang Xiao17282ba2014-03-02 00:04:03 +08002024 /* Run card bias changes at last */
2025 dapm_post_sequence_async(&card->dapm, 0);
Mark Brown452c5ea2009-05-17 21:41:23 +01002026
Liam Girdwood8078d872012-02-15 15:15:35 +00002027 /* do we need to notify any clients that DAPM event is complete */
2028 list_for_each_entry(d, &card->dapm_list, list) {
2029 if (d->stream_event)
2030 d->stream_event(d, event);
2031 }
2032
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02002033 pop_dbg(card->dev, card->pop_time,
Jarkko Nikulafd8d3bc2010-11-09 14:40:28 +02002034 "DAPM sequencing finished, waiting %dms\n", card->pop_time);
Jarkko Nikula3a45b862010-11-05 20:35:21 +02002035 pop_wait(card->pop_time);
Mark Browncb507e72009-07-08 18:54:57 +01002036
Mark Brown84e90932010-11-04 00:07:02 -04002037 trace_snd_soc_dapm_done(card);
2038
Mark Brown42aa3412009-03-01 19:21:10 +00002039 return 0;
Richard Purdie2b97eab2006-10-06 18:32:18 +02002040}
2041
Mark Brown79fb9382009-08-21 16:38:13 +01002042#ifdef CONFIG_DEBUG_FS
Mark Brown79fb9382009-08-21 16:38:13 +01002043static ssize_t dapm_widget_power_read_file(struct file *file,
2044 char __user *user_buf,
2045 size_t count, loff_t *ppos)
2046{
2047 struct snd_soc_dapm_widget *w = file->private_data;
Lars-Peter Clausene50b1e02015-07-06 17:01:24 +02002048 struct snd_soc_card *card = w->dapm->card;
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002049 enum snd_soc_dapm_direction dir, rdir;
Mark Brown79fb9382009-08-21 16:38:13 +01002050 char *buf;
2051 int in, out;
2052 ssize_t ret;
2053 struct snd_soc_dapm_path *p = NULL;
2054
2055 buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
2056 if (!buf)
2057 return -ENOMEM;
2058
Lars-Peter Clausene50b1e02015-07-06 17:01:24 +02002059 mutex_lock(&card->dapm_mutex);
2060
Lars-Peter Clausenc1862c82014-10-25 17:42:00 +02002061 /* Supply widgets are not handled by is_connected_{input,output}_ep() */
2062 if (w->is_supply) {
2063 in = 0;
2064 out = 0;
2065 } else {
Piotr Stankiewicz67420642016-05-13 17:03:55 +01002066 in = is_connected_input_ep(w, NULL, NULL);
2067 out = is_connected_output_ep(w, NULL, NULL);
Lars-Peter Clausenc1862c82014-10-25 17:42:00 +02002068 }
Mark Brown79fb9382009-08-21 16:38:13 +01002069
Silvio Cesaree581e152019-01-12 16:28:43 +01002070 ret = scnprintf(buf, PAGE_SIZE, "%s: %s%s in %d out %d",
Mark Brownf13ebad2012-03-03 18:01:01 +00002071 w->name, w->power ? "On" : "Off",
2072 w->force ? " (forced)" : "", in, out);
Mark Brown79fb9382009-08-21 16:38:13 +01002073
Mark Brownd033c362009-12-04 15:25:56 +00002074 if (w->reg >= 0)
Silvio Cesaree581e152019-01-12 16:28:43 +01002075 ret += scnprintf(buf + ret, PAGE_SIZE - ret,
Lars-Peter Clausende9ba982013-07-29 17:14:01 +02002076 " - R%d(0x%x) mask 0x%x",
2077 w->reg, w->reg, w->mask << w->shift);
Mark Brownd033c362009-12-04 15:25:56 +00002078
Silvio Cesaree581e152019-01-12 16:28:43 +01002079 ret += scnprintf(buf + ret, PAGE_SIZE - ret, "\n");
Mark Brownd033c362009-12-04 15:25:56 +00002080
Mark Brown3eef08b2009-09-14 16:49:00 +01002081 if (w->sname)
Silvio Cesaree581e152019-01-12 16:28:43 +01002082 ret += scnprintf(buf + ret, PAGE_SIZE - ret, " stream %s %s\n",
Mark Brown3eef08b2009-09-14 16:49:00 +01002083 w->sname,
2084 w->active ? "active" : "inactive");
Mark Brown79fb9382009-08-21 16:38:13 +01002085
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002086 snd_soc_dapm_for_each_direction(dir) {
2087 rdir = SND_SOC_DAPM_DIR_REVERSE(dir);
2088 snd_soc_dapm_widget_for_each_path(w, dir, p) {
KaiChieh Chuang28735af2018-02-05 13:00:00 +08002089 if (p->connected && !p->connected(p->source, p->sink))
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002090 continue;
Mark Brown215edda2009-09-08 18:59:05 +01002091
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002092 if (!p->connect)
2093 continue;
Mark Brown215edda2009-09-08 18:59:05 +01002094
Silvio Cesaree581e152019-01-12 16:28:43 +01002095 ret += scnprintf(buf + ret, PAGE_SIZE - ret,
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002096 " %s \"%s\" \"%s\"\n",
2097 (rdir == SND_SOC_DAPM_DIR_IN) ? "in" : "out",
Mark Brown79fb9382009-08-21 16:38:13 +01002098 p->name ? p->name : "static",
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002099 p->node[rdir]->name);
2100 }
Mark Brown79fb9382009-08-21 16:38:13 +01002101 }
2102
Lars-Peter Clausene50b1e02015-07-06 17:01:24 +02002103 mutex_unlock(&card->dapm_mutex);
2104
Mark Brown79fb9382009-08-21 16:38:13 +01002105 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
2106
2107 kfree(buf);
2108 return ret;
2109}
2110
2111static const struct file_operations dapm_widget_power_fops = {
Stephen Boyd234e3402012-04-05 14:25:11 -07002112 .open = simple_open,
Mark Brown79fb9382009-08-21 16:38:13 +01002113 .read = dapm_widget_power_read_file,
Arnd Bergmann6038f372010-08-15 18:52:59 +02002114 .llseek = default_llseek,
Mark Brown79fb9382009-08-21 16:38:13 +01002115};
2116
Mark Brownef49e4f2011-04-04 20:48:13 +09002117static ssize_t dapm_bias_read_file(struct file *file, char __user *user_buf,
2118 size_t count, loff_t *ppos)
2119{
2120 struct snd_soc_dapm_context *dapm = file->private_data;
2121 char *level;
2122
2123 switch (dapm->bias_level) {
2124 case SND_SOC_BIAS_ON:
2125 level = "On\n";
2126 break;
2127 case SND_SOC_BIAS_PREPARE:
2128 level = "Prepare\n";
2129 break;
2130 case SND_SOC_BIAS_STANDBY:
2131 level = "Standby\n";
2132 break;
2133 case SND_SOC_BIAS_OFF:
2134 level = "Off\n";
2135 break;
2136 default:
Takashi Iwaia6ed0602013-11-06 11:07:19 +01002137 WARN(1, "Unknown bias_level %d\n", dapm->bias_level);
Mark Brownef49e4f2011-04-04 20:48:13 +09002138 level = "Unknown\n";
2139 break;
2140 }
2141
2142 return simple_read_from_buffer(user_buf, count, ppos, level,
2143 strlen(level));
2144}
2145
2146static const struct file_operations dapm_bias_fops = {
Stephen Boyd234e3402012-04-05 14:25:11 -07002147 .open = simple_open,
Mark Brownef49e4f2011-04-04 20:48:13 +09002148 .read = dapm_bias_read_file,
2149 .llseek = default_llseek,
2150};
2151
Lars-Peter Clausen8eecaf62011-04-30 19:45:48 +02002152void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
2153 struct dentry *parent)
Mark Brown79fb9382009-08-21 16:38:13 +01002154{
Mark Brown79fb9382009-08-21 16:38:13 +01002155 struct dentry *d;
2156
Lars-Peter Clausen6553bf062015-04-09 10:52:38 +02002157 if (!parent)
2158 return;
2159
Lars-Peter Clausen8eecaf62011-04-30 19:45:48 +02002160 dapm->debugfs_dapm = debugfs_create_dir("dapm", parent);
2161
2162 if (!dapm->debugfs_dapm) {
Liam Girdwoodf1e90af2012-03-06 18:13:25 +00002163 dev_warn(dapm->dev,
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00002164 "ASoC: Failed to create DAPM debugfs directory\n");
Mark Brown79fb9382009-08-21 16:38:13 +01002165 return;
Lars-Peter Clausen8eecaf62011-04-30 19:45:48 +02002166 }
Mark Brown79fb9382009-08-21 16:38:13 +01002167
Mark Brownef49e4f2011-04-04 20:48:13 +09002168 d = debugfs_create_file("bias_level", 0444,
2169 dapm->debugfs_dapm, dapm,
2170 &dapm_bias_fops);
2171 if (!d)
2172 dev_warn(dapm->dev,
2173 "ASoC: Failed to create bias level debugfs file\n");
Mark Brown79fb9382009-08-21 16:38:13 +01002174}
Lars-Peter Clausend5d1e0b2011-04-30 19:45:49 +02002175
2176static void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
2177{
2178 struct snd_soc_dapm_context *dapm = w->dapm;
2179 struct dentry *d;
2180
2181 if (!dapm->debugfs_dapm || !w->name)
2182 return;
2183
2184 d = debugfs_create_file(w->name, 0444,
2185 dapm->debugfs_dapm, w,
2186 &dapm_widget_power_fops);
2187 if (!d)
2188 dev_warn(w->dapm->dev,
2189 "ASoC: Failed to create %s debugfs file\n",
2190 w->name);
2191}
2192
Lars-Peter Clausen6c45e122011-04-30 19:45:50 +02002193static void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
2194{
2195 debugfs_remove_recursive(dapm->debugfs_dapm);
2196}
2197
Mark Brown79fb9382009-08-21 16:38:13 +01002198#else
Lars-Peter Clausen8eecaf62011-04-30 19:45:48 +02002199void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
2200 struct dentry *parent)
Mark Brown79fb9382009-08-21 16:38:13 +01002201{
2202}
Lars-Peter Clausend5d1e0b2011-04-30 19:45:49 +02002203
2204static inline void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
2205{
2206}
2207
Lars-Peter Clausen6c45e122011-04-30 19:45:50 +02002208static inline void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
2209{
2210}
2211
Mark Brown79fb9382009-08-21 16:38:13 +01002212#endif
2213
Lars-Peter Clausen4a201942014-10-25 17:41:56 +02002214/*
2215 * soc_dapm_connect_path() - Connects or disconnects a path
2216 * @path: The path to update
2217 * @connect: The new connect state of the path. True if the path is connected,
Peter Meerwald-Stadlerc8046002016-08-16 16:56:17 +02002218 * false if it is disconnected.
Lars-Peter Clausen4a201942014-10-25 17:41:56 +02002219 * @reason: The reason why the path changed (for debugging only)
2220 */
2221static void soc_dapm_connect_path(struct snd_soc_dapm_path *path,
2222 bool connect, const char *reason)
2223{
2224 if (path->connect == connect)
2225 return;
2226
2227 path->connect = connect;
2228 dapm_mark_dirty(path->source, reason);
2229 dapm_mark_dirty(path->sink, reason);
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +02002230 dapm_path_invalidate(path);
Lars-Peter Clausen4a201942014-10-25 17:41:56 +02002231}
2232
Richard Purdie2b97eab2006-10-06 18:32:18 +02002233/* test and update the power status of a mux widget */
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02002234static int soc_dapm_mux_update_power(struct snd_soc_card *card,
Liam Girdwood40f02cd2012-02-06 16:05:14 +00002235 struct snd_kcontrol *kcontrol, int mux, struct soc_enum *e)
Richard Purdie2b97eab2006-10-06 18:32:18 +02002236{
2237 struct snd_soc_dapm_path *path;
2238 int found = 0;
Lars-Peter Clausen4a201942014-10-25 17:41:56 +02002239 bool connect;
Richard Purdie2b97eab2006-10-06 18:32:18 +02002240
Mark Brownf9fa2b12014-03-06 16:49:11 +08002241 lockdep_assert_held(&card->dapm_mutex);
2242
Richard Purdie2b97eab2006-10-06 18:32:18 +02002243 /* find dapm widget path assoc with kcontrol */
Lars-Peter Clausen5106b922013-07-29 17:14:00 +02002244 dapm_kcontrol_for_each_path(path, kcontrol) {
Richard Purdie2b97eab2006-10-06 18:32:18 +02002245 found = 1;
2246 /* we now need to match the string in the enum to the path */
Lars-Peter Clausen4a201942014-10-25 17:41:56 +02002247 if (!(strcmp(path->name, e->texts[mux])))
2248 connect = true;
2249 else
2250 connect = false;
2251
2252 soc_dapm_connect_path(path, connect, "mux update");
Richard Purdie2b97eab2006-10-06 18:32:18 +02002253 }
2254
Lars-Peter Clausence6cfaf2013-07-24 15:27:37 +02002255 if (found)
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02002256 dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP);
Richard Purdie2b97eab2006-10-06 18:32:18 +02002257
Liam Girdwood618dae12012-04-25 12:12:51 +01002258 return found;
Richard Purdie2b97eab2006-10-06 18:32:18 +02002259}
Liam Girdwood4edbb3452012-03-07 10:38:27 +00002260
Lars-Peter Clausence6cfaf2013-07-24 15:27:37 +02002261int snd_soc_dapm_mux_update_power(struct snd_soc_dapm_context *dapm,
Lars-Peter Clausen6b3fc032013-07-24 15:27:38 +02002262 struct snd_kcontrol *kcontrol, int mux, struct soc_enum *e,
2263 struct snd_soc_dapm_update *update)
Liam Girdwood4edbb3452012-03-07 10:38:27 +00002264{
Lars-Peter Clausence6cfaf2013-07-24 15:27:37 +02002265 struct snd_soc_card *card = dapm->card;
Liam Girdwood4edbb3452012-03-07 10:38:27 +00002266 int ret;
2267
Liam Girdwood3cd04342012-03-09 12:02:08 +00002268 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
Lars-Peter Clausen564c65042013-07-29 17:13:55 +02002269 card->update = update;
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02002270 ret = soc_dapm_mux_update_power(card, kcontrol, mux, e);
Lars-Peter Clausen564c65042013-07-29 17:13:55 +02002271 card->update = NULL;
Liam Girdwood4edbb3452012-03-07 10:38:27 +00002272 mutex_unlock(&card->dapm_mutex);
Liam Girdwood618dae12012-04-25 12:12:51 +01002273 if (ret > 0)
Lars-Peter Clausenc3f48ae2013-07-24 15:27:36 +02002274 soc_dpcm_runtime_update(card);
Liam Girdwood4edbb3452012-03-07 10:38:27 +00002275 return ret;
2276}
Liam Girdwood40f02cd2012-02-06 16:05:14 +00002277EXPORT_SYMBOL_GPL(snd_soc_dapm_mux_update_power);
Richard Purdie2b97eab2006-10-06 18:32:18 +02002278
Milan plzik1b075e32008-01-10 14:39:46 +01002279/* test and update the power status of a mixer or switch widget */
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02002280static int soc_dapm_mixer_update_power(struct snd_soc_card *card,
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08002281 struct snd_kcontrol *kcontrol,
2282 int connect, int rconnect)
Richard Purdie2b97eab2006-10-06 18:32:18 +02002283{
2284 struct snd_soc_dapm_path *path;
2285 int found = 0;
2286
Mark Brownf9fa2b12014-03-06 16:49:11 +08002287 lockdep_assert_held(&card->dapm_mutex);
2288
Richard Purdie2b97eab2006-10-06 18:32:18 +02002289 /* find dapm widget path assoc with kcontrol */
Lars-Peter Clausen5106b922013-07-29 17:14:00 +02002290 dapm_kcontrol_for_each_path(path, kcontrol) {
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08002291 /*
2292 * Ideally this function should support any number of
2293 * paths and channels. But since kcontrols only come
2294 * in mono and stereo variants, we are limited to 2
2295 * channels.
2296 *
2297 * The following code assumes for stereo controls the
2298 * first path (when 'found == 0') is the left channel,
2299 * and all remaining paths (when 'found == 1') are the
2300 * right channel.
2301 *
2302 * A stereo control is signified by a valid 'rconnect'
2303 * value, either 0 for unconnected, or >= 0 for connected.
2304 * This is chosen instead of using snd_soc_volsw_is_stereo,
2305 * so that the behavior of snd_soc_dapm_mixer_update_power
2306 * doesn't change even when the kcontrol passed in is
2307 * stereo.
2308 *
2309 * It passes 'connect' as the path connect status for
2310 * the left channel, and 'rconnect' for the right
2311 * channel.
2312 */
2313 if (found && rconnect >= 0)
2314 soc_dapm_connect_path(path, rconnect, "mixer update");
2315 else
2316 soc_dapm_connect_path(path, connect, "mixer update");
Richard Purdie2b97eab2006-10-06 18:32:18 +02002317 found = 1;
Richard Purdie2b97eab2006-10-06 18:32:18 +02002318 }
2319
Lars-Peter Clausence6cfaf2013-07-24 15:27:37 +02002320 if (found)
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02002321 dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP);
Richard Purdie2b97eab2006-10-06 18:32:18 +02002322
Liam Girdwood618dae12012-04-25 12:12:51 +01002323 return found;
Richard Purdie2b97eab2006-10-06 18:32:18 +02002324}
Liam Girdwood4edbb3452012-03-07 10:38:27 +00002325
Lars-Peter Clausence6cfaf2013-07-24 15:27:37 +02002326int snd_soc_dapm_mixer_update_power(struct snd_soc_dapm_context *dapm,
Lars-Peter Clausen6b3fc032013-07-24 15:27:38 +02002327 struct snd_kcontrol *kcontrol, int connect,
2328 struct snd_soc_dapm_update *update)
Liam Girdwood4edbb3452012-03-07 10:38:27 +00002329{
Lars-Peter Clausence6cfaf2013-07-24 15:27:37 +02002330 struct snd_soc_card *card = dapm->card;
Liam Girdwood4edbb3452012-03-07 10:38:27 +00002331 int ret;
2332
Liam Girdwood3cd04342012-03-09 12:02:08 +00002333 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
Lars-Peter Clausen564c65042013-07-29 17:13:55 +02002334 card->update = update;
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08002335 ret = soc_dapm_mixer_update_power(card, kcontrol, connect, -1);
Lars-Peter Clausen564c65042013-07-29 17:13:55 +02002336 card->update = NULL;
Liam Girdwood4edbb3452012-03-07 10:38:27 +00002337 mutex_unlock(&card->dapm_mutex);
Liam Girdwood618dae12012-04-25 12:12:51 +01002338 if (ret > 0)
Lars-Peter Clausenc3f48ae2013-07-24 15:27:36 +02002339 soc_dpcm_runtime_update(card);
Liam Girdwood4edbb3452012-03-07 10:38:27 +00002340 return ret;
2341}
Liam Girdwood40f02cd2012-02-06 16:05:14 +00002342EXPORT_SYMBOL_GPL(snd_soc_dapm_mixer_update_power);
Richard Purdie2b97eab2006-10-06 18:32:18 +02002343
Lars-Peter Clausenb3c25fb2015-07-06 15:38:10 +02002344static ssize_t dapm_widget_show_component(struct snd_soc_component *cmpnt,
2345 char *buf)
Richard Purdie2b97eab2006-10-06 18:32:18 +02002346{
Lars-Peter Clausenb3c25fb2015-07-06 15:38:10 +02002347 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(cmpnt);
Richard Purdie2b97eab2006-10-06 18:32:18 +02002348 struct snd_soc_dapm_widget *w;
2349 int count = 0;
2350 char *state = "not set";
2351
Mark Brown47325072016-03-18 12:04:23 +00002352 /* card won't be set for the dummy component, as a spot fix
2353 * we're checking for that case specifically here but in future
2354 * we will ensure that the dummy component looks like others.
2355 */
2356 if (!cmpnt->card)
2357 return 0;
2358
Lars-Peter Clausenb3c25fb2015-07-06 15:38:10 +02002359 list_for_each_entry(w, &cmpnt->card->widgets, list) {
2360 if (w->dapm != dapm)
Jarkko Nikula97c866d2010-12-14 12:18:31 +02002361 continue;
Richard Purdie2b97eab2006-10-06 18:32:18 +02002362
Peter Meerwald-Stadlerc8046002016-08-16 16:56:17 +02002363 /* only display widgets that burn power */
Richard Purdie2b97eab2006-10-06 18:32:18 +02002364 switch (w->id) {
2365 case snd_soc_dapm_hp:
2366 case snd_soc_dapm_mic:
2367 case snd_soc_dapm_spk:
2368 case snd_soc_dapm_line:
2369 case snd_soc_dapm_micbias:
2370 case snd_soc_dapm_dac:
2371 case snd_soc_dapm_adc:
2372 case snd_soc_dapm_pga:
Olaya, Margaritad88429a2010-12-10 21:11:44 -06002373 case snd_soc_dapm_out_drv:
Richard Purdie2b97eab2006-10-06 18:32:18 +02002374 case snd_soc_dapm_mixer:
Ian Moltonca9c1aa2009-01-06 20:11:51 +00002375 case snd_soc_dapm_mixer_named_ctl:
Mark Brown246d0a12009-04-22 18:24:55 +01002376 case snd_soc_dapm_supply:
Mark Brown62ea8742012-01-21 21:14:48 +00002377 case snd_soc_dapm_regulator_supply:
Srinivas Kandagatla5b2d15b2018-03-10 02:37:27 +00002378 case snd_soc_dapm_pinctrl:
Ola Liljad7e7eb92012-05-24 15:26:25 +02002379 case snd_soc_dapm_clock_supply:
Richard Purdie2b97eab2006-10-06 18:32:18 +02002380 if (w->name)
2381 count += sprintf(buf + count, "%s: %s\n",
2382 w->name, w->power ? "On":"Off");
2383 break;
2384 default:
2385 break;
2386 }
2387 }
2388
Lars-Peter Clausenb3c25fb2015-07-06 15:38:10 +02002389 switch (snd_soc_dapm_get_bias_level(dapm)) {
Mark Brown0be98982008-05-19 12:31:28 +02002390 case SND_SOC_BIAS_ON:
2391 state = "On";
Richard Purdie2b97eab2006-10-06 18:32:18 +02002392 break;
Mark Brown0be98982008-05-19 12:31:28 +02002393 case SND_SOC_BIAS_PREPARE:
2394 state = "Prepare";
Richard Purdie2b97eab2006-10-06 18:32:18 +02002395 break;
Mark Brown0be98982008-05-19 12:31:28 +02002396 case SND_SOC_BIAS_STANDBY:
2397 state = "Standby";
Richard Purdie2b97eab2006-10-06 18:32:18 +02002398 break;
Mark Brown0be98982008-05-19 12:31:28 +02002399 case SND_SOC_BIAS_OFF:
2400 state = "Off";
Richard Purdie2b97eab2006-10-06 18:32:18 +02002401 break;
2402 }
2403 count += sprintf(buf + count, "PM State: %s\n", state);
2404
2405 return count;
2406}
2407
Benoit Cousson44ba2642014-07-08 23:19:36 +02002408/* show dapm widget status in sys fs */
2409static ssize_t dapm_widget_show(struct device *dev,
2410 struct device_attribute *attr, char *buf)
2411{
2412 struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
Kuninori Morimoto0b7990e2018-09-03 02:12:56 +00002413 struct snd_soc_dai *codec_dai;
Benoit Cousson44ba2642014-07-08 23:19:36 +02002414 int i, count = 0;
2415
Lars-Peter Clausene50b1e02015-07-06 17:01:24 +02002416 mutex_lock(&rtd->card->dapm_mutex);
2417
Kuninori Morimoto0b7990e2018-09-03 02:12:56 +00002418 for_each_rtd_codec_dai(rtd, i, codec_dai) {
2419 struct snd_soc_component *cmpnt = codec_dai->component;
Lars-Peter Clausenb3c25fb2015-07-06 15:38:10 +02002420
2421 count += dapm_widget_show_component(cmpnt, buf + count);
Benoit Cousson44ba2642014-07-08 23:19:36 +02002422 }
2423
Lars-Peter Clausene50b1e02015-07-06 17:01:24 +02002424 mutex_unlock(&rtd->card->dapm_mutex);
2425
Benoit Cousson44ba2642014-07-08 23:19:36 +02002426 return count;
2427}
2428
Joe Perchesc828a892017-12-19 10:15:08 -08002429static DEVICE_ATTR_RO(dapm_widget);
Richard Purdie2b97eab2006-10-06 18:32:18 +02002430
Takashi Iwaid29697d2015-01-30 20:16:37 +01002431struct attribute *soc_dapm_dev_attrs[] = {
2432 &dev_attr_dapm_widget.attr,
2433 NULL
2434};
Richard Purdie2b97eab2006-10-06 18:32:18 +02002435
Lars-Peter Clausen88722932013-06-14 13:16:53 +02002436static void dapm_free_path(struct snd_soc_dapm_path *path)
2437{
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002438 list_del(&path->list_node[SND_SOC_DAPM_DIR_IN]);
2439 list_del(&path->list_node[SND_SOC_DAPM_DIR_OUT]);
Lars-Peter Clausen5106b922013-07-29 17:14:00 +02002440 list_del(&path->list_kcontrol);
Lars-Peter Clausen88722932013-06-14 13:16:53 +02002441 list_del(&path->list);
Lars-Peter Clausen88722932013-06-14 13:16:53 +02002442 kfree(path);
2443}
2444
Lars-Peter Clausenb97e2692015-07-21 18:11:07 +02002445void snd_soc_dapm_free_widget(struct snd_soc_dapm_widget *w)
2446{
2447 struct snd_soc_dapm_path *p, *next_p;
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002448 enum snd_soc_dapm_direction dir;
Lars-Peter Clausenb97e2692015-07-21 18:11:07 +02002449
2450 list_del(&w->list);
2451 /*
2452 * remove source and sink paths associated to this widget.
2453 * While removing the path, remove reference to it from both
2454 * source and sink widgets so that path is removed only once.
2455 */
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002456 snd_soc_dapm_for_each_direction(dir) {
2457 snd_soc_dapm_widget_for_each_path_safe(w, dir, p, next_p)
2458 dapm_free_path(p);
2459 }
Lars-Peter Clausenb97e2692015-07-21 18:11:07 +02002460
2461 kfree(w->kcontrols);
Lars-Peter Clausen48068962015-07-21 18:11:08 +02002462 kfree_const(w->name);
Pierre-Louis Bossart199ed3e2019-02-01 11:05:12 -06002463 kfree_const(w->sname);
Lars-Peter Clausenb97e2692015-07-21 18:11:07 +02002464 kfree(w);
2465}
2466
Jyri Sarhafd589a12015-11-10 18:12:42 +02002467void snd_soc_dapm_reset_cache(struct snd_soc_dapm_context *dapm)
2468{
2469 dapm->path_sink_cache.widget = NULL;
2470 dapm->path_source_cache.widget = NULL;
2471}
2472
Richard Purdie2b97eab2006-10-06 18:32:18 +02002473/* free all dapm widgets and resources */
Liam Girdwoodce6120c2010-11-05 15:53:46 +02002474static void dapm_free_widgets(struct snd_soc_dapm_context *dapm)
Richard Purdie2b97eab2006-10-06 18:32:18 +02002475{
2476 struct snd_soc_dapm_widget *w, *next_w;
Richard Purdie2b97eab2006-10-06 18:32:18 +02002477
Jarkko Nikula97c866d2010-12-14 12:18:31 +02002478 list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) {
2479 if (w->dapm != dapm)
2480 continue;
Lars-Peter Clausenb97e2692015-07-21 18:11:07 +02002481 snd_soc_dapm_free_widget(w);
Richard Purdie2b97eab2006-10-06 18:32:18 +02002482 }
Jyri Sarhafd589a12015-11-10 18:12:42 +02002483 snd_soc_dapm_reset_cache(dapm);
Richard Purdie2b97eab2006-10-06 18:32:18 +02002484}
2485
Lars-Peter Clausen91a5fca2011-04-27 18:34:31 +02002486static struct snd_soc_dapm_widget *dapm_find_widget(
2487 struct snd_soc_dapm_context *dapm, const char *pin,
2488 bool search_other_contexts)
2489{
2490 struct snd_soc_dapm_widget *w;
2491 struct snd_soc_dapm_widget *fallback = NULL;
2492
2493 list_for_each_entry(w, &dapm->card->widgets, list) {
2494 if (!strcmp(w->name, pin)) {
2495 if (w->dapm == dapm)
2496 return w;
2497 else
2498 fallback = w;
2499 }
2500 }
2501
2502 if (search_other_contexts)
2503 return fallback;
2504
2505 return NULL;
2506}
2507
Liam Girdwoodce6120c2010-11-05 15:53:46 +02002508static int snd_soc_dapm_set_pin(struct snd_soc_dapm_context *dapm,
Mark Brown16499232009-01-07 18:25:13 +00002509 const char *pin, int status)
Liam Girdwooda5302182008-07-07 13:35:17 +01002510{
Lars-Peter Clausen91a5fca2011-04-27 18:34:31 +02002511 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
Liam Girdwooda5302182008-07-07 13:35:17 +01002512
Mark Brownf9fa2b12014-03-06 16:49:11 +08002513 dapm_assert_locked(dapm);
2514
Lars-Peter Clausen91a5fca2011-04-27 18:34:31 +02002515 if (!w) {
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00002516 dev_err(dapm->dev, "ASoC: DAPM unknown pin %s\n", pin);
Lars-Peter Clausen91a5fca2011-04-27 18:34:31 +02002517 return -EINVAL;
Liam Girdwooda5302182008-07-07 13:35:17 +01002518 }
2519
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +02002520 if (w->connected != status) {
Mark Brown1a8b2d92012-02-16 11:50:07 -08002521 dapm_mark_dirty(w, "pin configuration");
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +02002522 dapm_widget_invalidate_input_paths(w);
2523 dapm_widget_invalidate_output_paths(w);
2524 }
Mark Brown1a8b2d92012-02-16 11:50:07 -08002525
Lars-Peter Clausen91a5fca2011-04-27 18:34:31 +02002526 w->connected = status;
2527 if (status == 0)
2528 w->force = 0;
Mark Brown0d867332011-04-06 11:38:14 +09002529
Lars-Peter Clausen91a5fca2011-04-27 18:34:31 +02002530 return 0;
Liam Girdwooda5302182008-07-07 13:35:17 +01002531}
2532
Richard Purdie2b97eab2006-10-06 18:32:18 +02002533/**
Charles Keepax3eb29df2014-02-18 15:22:15 +00002534 * snd_soc_dapm_sync_unlocked - scan and power dapm paths
2535 * @dapm: DAPM context
2536 *
2537 * Walks all dapm audio paths and powers widgets according to their
2538 * stream or path usage.
2539 *
2540 * Requires external locking.
2541 *
2542 * Returns 0 for success.
2543 */
2544int snd_soc_dapm_sync_unlocked(struct snd_soc_dapm_context *dapm)
2545{
2546 /*
2547 * Suppress early reports (eg, jacks syncing their state) to avoid
2548 * silly DAPM runs during card startup.
2549 */
2550 if (!dapm->card || !dapm->card->instantiated)
2551 return 0;
2552
2553 return dapm_power_widgets(dapm->card, SND_SOC_DAPM_STREAM_NOP);
2554}
2555EXPORT_SYMBOL_GPL(snd_soc_dapm_sync_unlocked);
2556
2557/**
Liam Girdwooda5302182008-07-07 13:35:17 +01002558 * snd_soc_dapm_sync - scan and power dapm paths
Liam Girdwoodce6120c2010-11-05 15:53:46 +02002559 * @dapm: DAPM context
Richard Purdie2b97eab2006-10-06 18:32:18 +02002560 *
2561 * Walks all dapm audio paths and powers widgets according to their
2562 * stream or path usage.
2563 *
2564 * Returns 0 for success.
2565 */
Liam Girdwoodce6120c2010-11-05 15:53:46 +02002566int snd_soc_dapm_sync(struct snd_soc_dapm_context *dapm)
Richard Purdie2b97eab2006-10-06 18:32:18 +02002567{
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00002568 int ret;
2569
Liam Girdwood3cd04342012-03-09 12:02:08 +00002570 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
Charles Keepax3eb29df2014-02-18 15:22:15 +00002571 ret = snd_soc_dapm_sync_unlocked(dapm);
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00002572 mutex_unlock(&dapm->card->dapm_mutex);
2573 return ret;
Richard Purdie2b97eab2006-10-06 18:32:18 +02002574}
Liam Girdwooda5302182008-07-07 13:35:17 +01002575EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
Richard Purdie2b97eab2006-10-06 18:32:18 +02002576
Charles Keepax078a85f2019-01-31 13:30:18 +00002577static int dapm_update_dai_chan(struct snd_soc_dapm_path *p,
2578 struct snd_soc_dapm_widget *w,
2579 int channels)
2580{
2581 switch (w->id) {
2582 case snd_soc_dapm_aif_out:
2583 case snd_soc_dapm_aif_in:
2584 break;
2585 default:
2586 return 0;
2587 }
2588
2589 dev_dbg(w->dapm->dev, "%s DAI route %s -> %s\n",
2590 w->channel < channels ? "Connecting" : "Disconnecting",
2591 p->source->name, p->sink->name);
2592
2593 if (w->channel < channels)
2594 soc_dapm_connect_path(p, true, "dai update");
2595 else
2596 soc_dapm_connect_path(p, false, "dai update");
2597
2598 return 0;
2599}
2600
2601static int dapm_update_dai_unlocked(struct snd_pcm_substream *substream,
2602 struct snd_pcm_hw_params *params,
2603 struct snd_soc_dai *dai)
2604{
2605 int dir = substream->stream;
2606 int channels = params_channels(params);
2607 struct snd_soc_dapm_path *p;
2608 struct snd_soc_dapm_widget *w;
2609 int ret;
2610
2611 if (dir == SNDRV_PCM_STREAM_PLAYBACK)
2612 w = dai->playback_widget;
2613 else
2614 w = dai->capture_widget;
2615
Charles Keepaxcf17a5f2019-02-06 11:13:59 +00002616 if (!w)
2617 return 0;
2618
Charles Keepax078a85f2019-01-31 13:30:18 +00002619 dev_dbg(dai->dev, "Update DAI routes for %s %s\n", dai->name,
2620 dir == SNDRV_PCM_STREAM_PLAYBACK ? "playback" : "capture");
2621
2622 snd_soc_dapm_widget_for_each_sink_path(w, p) {
2623 ret = dapm_update_dai_chan(p, p->sink, channels);
2624 if (ret < 0)
2625 return ret;
2626 }
2627
2628 snd_soc_dapm_widget_for_each_source_path(w, p) {
2629 ret = dapm_update_dai_chan(p, p->source, channels);
2630 if (ret < 0)
2631 return ret;
2632 }
2633
2634 return 0;
2635}
2636
2637int snd_soc_dapm_update_dai(struct snd_pcm_substream *substream,
2638 struct snd_pcm_hw_params *params,
2639 struct snd_soc_dai *dai)
2640{
2641 struct snd_soc_pcm_runtime *rtd = substream->private_data;
2642 int ret;
2643
2644 mutex_lock_nested(&rtd->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
2645 ret = dapm_update_dai_unlocked(substream, params, dai);
2646 mutex_unlock(&rtd->card->dapm_mutex);
2647
2648 return ret;
2649}
2650EXPORT_SYMBOL_GPL(snd_soc_dapm_update_dai);
2651
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02002652/*
2653 * dapm_update_widget_flags() - Re-compute widget sink and source flags
2654 * @w: The widget for which to update the flags
2655 *
2656 * Some widgets have a dynamic category which depends on which neighbors they
2657 * are connected to. This function update the category for these widgets.
2658 *
2659 * This function must be called whenever a path is added or removed to a widget.
2660 */
2661static void dapm_update_widget_flags(struct snd_soc_dapm_widget *w)
2662{
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002663 enum snd_soc_dapm_direction dir;
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02002664 struct snd_soc_dapm_path *p;
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002665 unsigned int ep;
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02002666
2667 switch (w->id) {
2668 case snd_soc_dapm_input:
Peter Meerwald-Stadlerc8046002016-08-16 16:56:17 +02002669 /* On a fully routed card an input is never a source */
Lars-Peter Clausen86d75002014-12-21 11:05:44 +01002670 if (w->dapm->card->fully_routed)
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002671 return;
2672 ep = SND_SOC_DAPM_EP_SOURCE;
Lars-Peter Clausene63bfd42015-07-26 19:05:00 +02002673 snd_soc_dapm_widget_for_each_source_path(w, p) {
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02002674 if (p->source->id == snd_soc_dapm_micbias ||
2675 p->source->id == snd_soc_dapm_mic ||
2676 p->source->id == snd_soc_dapm_line ||
2677 p->source->id == snd_soc_dapm_output) {
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002678 ep = 0;
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02002679 break;
2680 }
2681 }
2682 break;
2683 case snd_soc_dapm_output:
Lars-Peter Clausen86d75002014-12-21 11:05:44 +01002684 /* On a fully routed card a output is never a sink */
2685 if (w->dapm->card->fully_routed)
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002686 return;
2687 ep = SND_SOC_DAPM_EP_SINK;
Lars-Peter Clausene63bfd42015-07-26 19:05:00 +02002688 snd_soc_dapm_widget_for_each_sink_path(w, p) {
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02002689 if (p->sink->id == snd_soc_dapm_spk ||
2690 p->sink->id == snd_soc_dapm_hp ||
2691 p->sink->id == snd_soc_dapm_line ||
2692 p->sink->id == snd_soc_dapm_input) {
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002693 ep = 0;
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02002694 break;
2695 }
2696 }
2697 break;
2698 case snd_soc_dapm_line:
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002699 ep = 0;
2700 snd_soc_dapm_for_each_direction(dir) {
2701 if (!list_empty(&w->edges[dir]))
2702 ep |= SND_SOC_DAPM_DIR_TO_EP(dir);
2703 }
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02002704 break;
2705 default:
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002706 return;
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02002707 }
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002708
2709 w->is_ep = ep;
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02002710}
2711
Lars-Peter Clausend714f972015-05-01 18:02:43 +02002712static int snd_soc_dapm_check_dynamic_path(struct snd_soc_dapm_context *dapm,
2713 struct snd_soc_dapm_widget *source, struct snd_soc_dapm_widget *sink,
2714 const char *control)
2715{
2716 bool dynamic_source = false;
2717 bool dynamic_sink = false;
2718
2719 if (!control)
2720 return 0;
2721
2722 switch (source->id) {
2723 case snd_soc_dapm_demux:
2724 dynamic_source = true;
2725 break;
2726 default:
2727 break;
2728 }
2729
2730 switch (sink->id) {
2731 case snd_soc_dapm_mux:
2732 case snd_soc_dapm_switch:
2733 case snd_soc_dapm_mixer:
2734 case snd_soc_dapm_mixer_named_ctl:
2735 dynamic_sink = true;
2736 break;
2737 default:
2738 break;
2739 }
2740
2741 if (dynamic_source && dynamic_sink) {
2742 dev_err(dapm->dev,
2743 "Direct connection between demux and mixer/mux not supported for path %s -> [%s] -> %s\n",
2744 source->name, control, sink->name);
2745 return -EINVAL;
2746 } else if (!dynamic_source && !dynamic_sink) {
2747 dev_err(dapm->dev,
2748 "Control not supported for path %s -> [%s] -> %s\n",
2749 source->name, control, sink->name);
2750 return -EINVAL;
2751 }
2752
2753 return 0;
2754}
2755
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002756static int snd_soc_dapm_add_path(struct snd_soc_dapm_context *dapm,
2757 struct snd_soc_dapm_widget *wsource, struct snd_soc_dapm_widget *wsink,
2758 const char *control,
2759 int (*connected)(struct snd_soc_dapm_widget *source,
2760 struct snd_soc_dapm_widget *sink))
Richard Purdie2b97eab2006-10-06 18:32:18 +02002761{
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002762 struct snd_soc_dapm_widget *widgets[2];
2763 enum snd_soc_dapm_direction dir;
Richard Purdie2b97eab2006-10-06 18:32:18 +02002764 struct snd_soc_dapm_path *path;
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002765 int ret;
Richard Purdie2b97eab2006-10-06 18:32:18 +02002766
Lars-Peter Clausene409dfb2014-10-25 17:42:02 +02002767 if (wsink->is_supply && !wsource->is_supply) {
2768 dev_err(dapm->dev,
2769 "Connecting non-supply widget to supply widget is not supported (%s -> %s)\n",
2770 wsource->name, wsink->name);
2771 return -EINVAL;
2772 }
2773
2774 if (connected && !wsource->is_supply) {
2775 dev_err(dapm->dev,
2776 "connected() callback only supported for supply widgets (%s -> %s)\n",
2777 wsource->name, wsink->name);
2778 return -EINVAL;
2779 }
2780
2781 if (wsource->is_supply && control) {
2782 dev_err(dapm->dev,
2783 "Conditional paths are not supported for supply widgets (%s -> [%s] -> %s)\n",
2784 wsource->name, control, wsink->name);
2785 return -EINVAL;
2786 }
2787
Lars-Peter Clausend714f972015-05-01 18:02:43 +02002788 ret = snd_soc_dapm_check_dynamic_path(dapm, wsource, wsink, control);
2789 if (ret)
2790 return ret;
2791
Richard Purdie2b97eab2006-10-06 18:32:18 +02002792 path = kzalloc(sizeof(struct snd_soc_dapm_path), GFP_KERNEL);
2793 if (!path)
2794 return -ENOMEM;
2795
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002796 path->node[SND_SOC_DAPM_DIR_IN] = wsource;
2797 path->node[SND_SOC_DAPM_DIR_OUT] = wsink;
2798 widgets[SND_SOC_DAPM_DIR_IN] = wsource;
2799 widgets[SND_SOC_DAPM_DIR_OUT] = wsink;
2800
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002801 path->connected = connected;
Richard Purdie2b97eab2006-10-06 18:32:18 +02002802 INIT_LIST_HEAD(&path->list);
Mark Brown69c2d342013-08-13 00:20:36 +01002803 INIT_LIST_HEAD(&path->list_kcontrol);
Richard Purdie2b97eab2006-10-06 18:32:18 +02002804
Lars-Peter Clausenc1862c82014-10-25 17:42:00 +02002805 if (wsource->is_supply || wsink->is_supply)
2806 path->is_supply = 1;
2807
Richard Purdie2b97eab2006-10-06 18:32:18 +02002808 /* connect static paths */
2809 if (control == NULL) {
Richard Purdie2b97eab2006-10-06 18:32:18 +02002810 path->connect = 1;
Lars-Peter Clausen5fe5b762014-10-25 17:41:58 +02002811 } else {
Lars-Peter Clausend714f972015-05-01 18:02:43 +02002812 switch (wsource->id) {
2813 case snd_soc_dapm_demux:
2814 ret = dapm_connect_mux(dapm, path, control, wsource);
2815 if (ret)
2816 goto err;
2817 break;
2818 default:
2819 break;
2820 }
2821
Lars-Peter Clausen5fe5b762014-10-25 17:41:58 +02002822 switch (wsink->id) {
2823 case snd_soc_dapm_mux:
Lars-Peter Clausend714f972015-05-01 18:02:43 +02002824 ret = dapm_connect_mux(dapm, path, control, wsink);
Lars-Peter Clausen5fe5b762014-10-25 17:41:58 +02002825 if (ret != 0)
2826 goto err;
2827 break;
2828 case snd_soc_dapm_switch:
2829 case snd_soc_dapm_mixer:
2830 case snd_soc_dapm_mixer_named_ctl:
2831 ret = dapm_connect_mixer(dapm, path, control);
2832 if (ret != 0)
2833 goto err;
2834 break;
2835 default:
Lars-Peter Clausend714f972015-05-01 18:02:43 +02002836 break;
Lars-Peter Clausen5fe5b762014-10-25 17:41:58 +02002837 }
Richard Purdie2b97eab2006-10-06 18:32:18 +02002838 }
2839
Lars-Peter Clausen5fe5b762014-10-25 17:41:58 +02002840 list_add(&path->list, &dapm->card->paths);
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002841 snd_soc_dapm_for_each_direction(dir)
2842 list_add(&path->list_node[dir], &widgets[dir]->edges[dir]);
Lars-Peter Clausen5fe5b762014-10-25 17:41:58 +02002843
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02002844 snd_soc_dapm_for_each_direction(dir) {
2845 dapm_update_widget_flags(widgets[dir]);
2846 dapm_mark_dirty(widgets[dir], "Route added");
2847 }
Mark Brownfabd0382012-07-05 17:20:06 +01002848
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +02002849 if (dapm->card->instantiated && path->connect)
2850 dapm_path_invalidate(path);
2851
Richard Purdie2b97eab2006-10-06 18:32:18 +02002852 return 0;
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002853err:
2854 kfree(path);
2855 return ret;
2856}
Richard Purdie2b97eab2006-10-06 18:32:18 +02002857
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002858static int snd_soc_dapm_add_route(struct snd_soc_dapm_context *dapm,
Lars-Peter Clausena4e91542014-05-07 16:20:25 +02002859 const struct snd_soc_dapm_route *route)
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002860{
2861 struct snd_soc_dapm_widget *wsource = NULL, *wsink = NULL, *w;
2862 struct snd_soc_dapm_widget *wtsource = NULL, *wtsink = NULL;
2863 const char *sink;
2864 const char *source;
2865 char prefixed_sink[80];
2866 char prefixed_source[80];
Lars-Peter Clausen94f99c82014-06-16 18:13:01 +02002867 const char *prefix;
Zhiwei Jiang411db2a2019-01-31 19:30:05 +08002868 unsigned int sink_ref = 0;
2869 unsigned int source_ref = 0;
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002870 int ret;
2871
Lars-Peter Clausen94f99c82014-06-16 18:13:01 +02002872 prefix = soc_dapm_prefix(dapm);
2873 if (prefix) {
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002874 snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
Lars-Peter Clausen94f99c82014-06-16 18:13:01 +02002875 prefix, route->sink);
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002876 sink = prefixed_sink;
2877 snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
Lars-Peter Clausen94f99c82014-06-16 18:13:01 +02002878 prefix, route->source);
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002879 source = prefixed_source;
2880 } else {
2881 sink = route->sink;
2882 source = route->source;
2883 }
2884
Charles Keepax45a110a2015-05-11 13:50:30 +01002885 wsource = dapm_wcache_lookup(&dapm->path_source_cache, source);
2886 wsink = dapm_wcache_lookup(&dapm->path_sink_cache, sink);
2887
2888 if (wsink && wsource)
2889 goto skip_search;
2890
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002891 /*
2892 * find src and dest widgets over all widgets but favor a widget from
2893 * current DAPM context
2894 */
2895 list_for_each_entry(w, &dapm->card->widgets, list) {
2896 if (!wsink && !(strcmp(w->name, sink))) {
2897 wtsink = w;
Charles Keepax70c75102015-05-07 11:33:58 +01002898 if (w->dapm == dapm) {
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002899 wsink = w;
Charles Keepax70c75102015-05-07 11:33:58 +01002900 if (wsource)
2901 break;
2902 }
Zhiwei Jiang411db2a2019-01-31 19:30:05 +08002903 sink_ref++;
2904 if (sink_ref > 1)
2905 dev_warn(dapm->dev,
2906 "ASoC: sink widget %s overwritten\n",
2907 w->name);
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002908 continue;
2909 }
2910 if (!wsource && !(strcmp(w->name, source))) {
2911 wtsource = w;
Charles Keepax70c75102015-05-07 11:33:58 +01002912 if (w->dapm == dapm) {
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002913 wsource = w;
Charles Keepax70c75102015-05-07 11:33:58 +01002914 if (wsink)
2915 break;
2916 }
Zhiwei Jiang411db2a2019-01-31 19:30:05 +08002917 source_ref++;
2918 if (source_ref > 1)
2919 dev_warn(dapm->dev,
2920 "ASoC: source widget %s overwritten\n",
2921 w->name);
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002922 }
2923 }
2924 /* use widget from another DAPM context if not found from this */
2925 if (!wsink)
2926 wsink = wtsink;
2927 if (!wsource)
2928 wsource = wtsource;
2929
2930 if (wsource == NULL) {
2931 dev_err(dapm->dev, "ASoC: no source widget found for %s\n",
2932 route->source);
2933 return -ENODEV;
2934 }
2935 if (wsink == NULL) {
2936 dev_err(dapm->dev, "ASoC: no sink widget found for %s\n",
2937 route->sink);
2938 return -ENODEV;
2939 }
2940
Charles Keepax45a110a2015-05-11 13:50:30 +01002941skip_search:
2942 dapm_wcache_update(&dapm->path_sink_cache, wsink);
2943 dapm_wcache_update(&dapm->path_source_cache, wsource);
2944
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002945 ret = snd_soc_dapm_add_path(dapm, wsource, wsink, route->control,
2946 route->connected);
2947 if (ret)
2948 goto err;
2949
2950 return 0;
Richard Purdie2b97eab2006-10-06 18:32:18 +02002951err:
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00002952 dev_warn(dapm->dev, "ASoC: no dapm match for %s --> %s --> %s\n",
Lars-Peter Clausen25536282013-07-29 17:14:02 +02002953 source, route->control, sink);
Richard Purdie2b97eab2006-10-06 18:32:18 +02002954 return ret;
2955}
Mark Brown105f1c22008-05-13 14:52:19 +02002956
Mark Brownefcc3c62012-07-05 17:24:19 +01002957static int snd_soc_dapm_del_route(struct snd_soc_dapm_context *dapm,
2958 const struct snd_soc_dapm_route *route)
2959{
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02002960 struct snd_soc_dapm_widget *wsource, *wsink;
Mark Brownefcc3c62012-07-05 17:24:19 +01002961 struct snd_soc_dapm_path *path, *p;
2962 const char *sink;
2963 const char *source;
2964 char prefixed_sink[80];
2965 char prefixed_source[80];
Lars-Peter Clausen94f99c82014-06-16 18:13:01 +02002966 const char *prefix;
Mark Brownefcc3c62012-07-05 17:24:19 +01002967
2968 if (route->control) {
2969 dev_err(dapm->dev,
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00002970 "ASoC: Removal of routes with controls not supported\n");
Mark Brownefcc3c62012-07-05 17:24:19 +01002971 return -EINVAL;
2972 }
2973
Lars-Peter Clausen94f99c82014-06-16 18:13:01 +02002974 prefix = soc_dapm_prefix(dapm);
2975 if (prefix) {
Mark Brownefcc3c62012-07-05 17:24:19 +01002976 snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
Lars-Peter Clausen94f99c82014-06-16 18:13:01 +02002977 prefix, route->sink);
Mark Brownefcc3c62012-07-05 17:24:19 +01002978 sink = prefixed_sink;
2979 snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
Lars-Peter Clausen94f99c82014-06-16 18:13:01 +02002980 prefix, route->source);
Mark Brownefcc3c62012-07-05 17:24:19 +01002981 source = prefixed_source;
2982 } else {
2983 sink = route->sink;
2984 source = route->source;
2985 }
2986
2987 path = NULL;
2988 list_for_each_entry(p, &dapm->card->paths, list) {
2989 if (strcmp(p->source->name, source) != 0)
2990 continue;
2991 if (strcmp(p->sink->name, sink) != 0)
2992 continue;
2993 path = p;
2994 break;
2995 }
2996
2997 if (path) {
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02002998 wsource = path->source;
2999 wsink = path->sink;
3000
3001 dapm_mark_dirty(wsource, "Route removed");
3002 dapm_mark_dirty(wsink, "Route removed");
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +02003003 if (path->connect)
3004 dapm_path_invalidate(path);
Mark Brownefcc3c62012-07-05 17:24:19 +01003005
Lars-Peter Clausen88722932013-06-14 13:16:53 +02003006 dapm_free_path(path);
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02003007
3008 /* Update any path related flags */
3009 dapm_update_widget_flags(wsource);
3010 dapm_update_widget_flags(wsink);
Mark Brownefcc3c62012-07-05 17:24:19 +01003011 } else {
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00003012 dev_warn(dapm->dev, "ASoC: Route %s->%s does not exist\n",
Mark Brownefcc3c62012-07-05 17:24:19 +01003013 source, sink);
3014 }
3015
3016 return 0;
3017}
3018
Mark Brown105f1c22008-05-13 14:52:19 +02003019/**
Mark Brown105f1c22008-05-13 14:52:19 +02003020 * snd_soc_dapm_add_routes - Add routes between DAPM widgets
Liam Girdwoodce6120c2010-11-05 15:53:46 +02003021 * @dapm: DAPM context
Mark Brown105f1c22008-05-13 14:52:19 +02003022 * @route: audio routes
3023 * @num: number of routes
3024 *
3025 * Connects 2 dapm widgets together via a named audio path. The sink is
3026 * the widget receiving the audio signal, whilst the source is the sender
3027 * of the audio signal.
3028 *
3029 * Returns 0 for success else error. On error all resources can be freed
3030 * with a call to snd_soc_card_free().
3031 */
Liam Girdwoodce6120c2010-11-05 15:53:46 +02003032int snd_soc_dapm_add_routes(struct snd_soc_dapm_context *dapm,
Mark Brown105f1c22008-05-13 14:52:19 +02003033 const struct snd_soc_dapm_route *route, int num)
3034{
Mark Brown62d4a4b2012-06-22 12:21:49 +01003035 int i, r, ret = 0;
Mark Brown105f1c22008-05-13 14:52:19 +02003036
Stuart Hendersonf19c1812017-09-21 11:02:12 +01003037 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
Mark Brown105f1c22008-05-13 14:52:19 +02003038 for (i = 0; i < num; i++) {
Lars-Peter Clausena4e91542014-05-07 16:20:25 +02003039 r = snd_soc_dapm_add_route(dapm, route);
Mark Brown62d4a4b2012-06-22 12:21:49 +01003040 if (r < 0) {
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00003041 dev_err(dapm->dev, "ASoC: Failed to add route %s -> %s -> %s\n",
3042 route->source,
3043 route->control ? route->control : "direct",
3044 route->sink);
Mark Brown62d4a4b2012-06-22 12:21:49 +01003045 ret = r;
Mark Brown105f1c22008-05-13 14:52:19 +02003046 }
3047 route++;
3048 }
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00003049 mutex_unlock(&dapm->card->dapm_mutex);
Mark Brown105f1c22008-05-13 14:52:19 +02003050
Dan Carpenter60884c22012-04-13 22:25:43 +03003051 return ret;
Mark Brown105f1c22008-05-13 14:52:19 +02003052}
3053EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);
3054
Mark Brownefcc3c62012-07-05 17:24:19 +01003055/**
3056 * snd_soc_dapm_del_routes - Remove routes between DAPM widgets
3057 * @dapm: DAPM context
3058 * @route: audio routes
3059 * @num: number of routes
3060 *
3061 * Removes routes from the DAPM context.
3062 */
3063int snd_soc_dapm_del_routes(struct snd_soc_dapm_context *dapm,
3064 const struct snd_soc_dapm_route *route, int num)
3065{
Rajan Vajae066ea22016-02-11 11:23:35 +05303066 int i;
Mark Brownefcc3c62012-07-05 17:24:19 +01003067
Stuart Hendersonf19c1812017-09-21 11:02:12 +01003068 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
Mark Brownefcc3c62012-07-05 17:24:19 +01003069 for (i = 0; i < num; i++) {
3070 snd_soc_dapm_del_route(dapm, route);
3071 route++;
3072 }
3073 mutex_unlock(&dapm->card->dapm_mutex);
3074
Rajan Vajae066ea22016-02-11 11:23:35 +05303075 return 0;
Mark Brownefcc3c62012-07-05 17:24:19 +01003076}
3077EXPORT_SYMBOL_GPL(snd_soc_dapm_del_routes);
3078
Mark Brownbf3a9e12011-06-13 16:42:29 +01003079static int snd_soc_dapm_weak_route(struct snd_soc_dapm_context *dapm,
3080 const struct snd_soc_dapm_route *route)
3081{
3082 struct snd_soc_dapm_widget *source = dapm_find_widget(dapm,
3083 route->source,
3084 true);
3085 struct snd_soc_dapm_widget *sink = dapm_find_widget(dapm,
3086 route->sink,
3087 true);
3088 struct snd_soc_dapm_path *path;
3089 int count = 0;
3090
3091 if (!source) {
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00003092 dev_err(dapm->dev, "ASoC: Unable to find source %s for weak route\n",
Mark Brownbf3a9e12011-06-13 16:42:29 +01003093 route->source);
3094 return -ENODEV;
3095 }
3096
3097 if (!sink) {
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00003098 dev_err(dapm->dev, "ASoC: Unable to find sink %s for weak route\n",
Mark Brownbf3a9e12011-06-13 16:42:29 +01003099 route->sink);
3100 return -ENODEV;
3101 }
3102
3103 if (route->control || route->connected)
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00003104 dev_warn(dapm->dev, "ASoC: Ignoring control for weak route %s->%s\n",
Mark Brownbf3a9e12011-06-13 16:42:29 +01003105 route->source, route->sink);
3106
Lars-Peter Clausene63bfd42015-07-26 19:05:00 +02003107 snd_soc_dapm_widget_for_each_sink_path(source, path) {
Mark Brownbf3a9e12011-06-13 16:42:29 +01003108 if (path->sink == sink) {
3109 path->weak = 1;
3110 count++;
3111 }
3112 }
3113
3114 if (count == 0)
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00003115 dev_err(dapm->dev, "ASoC: No path found for weak route %s->%s\n",
Mark Brownbf3a9e12011-06-13 16:42:29 +01003116 route->source, route->sink);
3117 if (count > 1)
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00003118 dev_warn(dapm->dev, "ASoC: %d paths found for weak route %s->%s\n",
Mark Brownbf3a9e12011-06-13 16:42:29 +01003119 count, route->source, route->sink);
3120
3121 return 0;
3122}
3123
3124/**
3125 * snd_soc_dapm_weak_routes - Mark routes between DAPM widgets as weak
3126 * @dapm: DAPM context
3127 * @route: audio routes
3128 * @num: number of routes
3129 *
3130 * Mark existing routes matching those specified in the passed array
3131 * as being weak, meaning that they are ignored for the purpose of
3132 * power decisions. The main intended use case is for sidetone paths
3133 * which couple audio between other independent paths if they are both
3134 * active in order to make the combination work better at the user
3135 * level but which aren't intended to be "used".
3136 *
3137 * Note that CODEC drivers should not use this as sidetone type paths
3138 * can frequently also be used as bypass paths.
3139 */
3140int snd_soc_dapm_weak_routes(struct snd_soc_dapm_context *dapm,
3141 const struct snd_soc_dapm_route *route, int num)
3142{
3143 int i, err;
3144 int ret = 0;
3145
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00003146 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
Mark Brownbf3a9e12011-06-13 16:42:29 +01003147 for (i = 0; i < num; i++) {
3148 err = snd_soc_dapm_weak_route(dapm, route);
3149 if (err)
3150 ret = err;
3151 route++;
3152 }
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00003153 mutex_unlock(&dapm->card->dapm_mutex);
Mark Brownbf3a9e12011-06-13 16:42:29 +01003154
3155 return ret;
3156}
3157EXPORT_SYMBOL_GPL(snd_soc_dapm_weak_routes);
3158
Mark Brown105f1c22008-05-13 14:52:19 +02003159/**
Richard Purdie2b97eab2006-10-06 18:32:18 +02003160 * snd_soc_dapm_new_widgets - add new dapm widgets
Jonathan Corbet628536e2015-08-25 01:14:48 -06003161 * @card: card to be checked for new dapm widgets
Richard Purdie2b97eab2006-10-06 18:32:18 +02003162 *
3163 * Checks the codec for any new dapm widgets and creates them if found.
3164 *
3165 * Returns 0 for success.
3166 */
Lars-Peter Clausen824ef822013-08-27 15:51:01 +02003167int snd_soc_dapm_new_widgets(struct snd_soc_card *card)
Richard Purdie2b97eab2006-10-06 18:32:18 +02003168{
3169 struct snd_soc_dapm_widget *w;
Mark Brownb66a70d2011-02-09 18:04:11 +00003170 unsigned int val;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003171
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02003172 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00003173
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02003174 list_for_each_entry(w, &card->widgets, list)
Richard Purdie2b97eab2006-10-06 18:32:18 +02003175 {
3176 if (w->new)
3177 continue;
3178
Stephen Warrenfad59882011-04-28 17:37:59 -06003179 if (w->num_kcontrols) {
Kees Cook6396bb22018-06-12 14:03:40 -07003180 w->kcontrols = kcalloc(w->num_kcontrols,
Stephen Warrenfad59882011-04-28 17:37:59 -06003181 sizeof(struct snd_kcontrol *),
3182 GFP_KERNEL);
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00003183 if (!w->kcontrols) {
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02003184 mutex_unlock(&card->dapm_mutex);
Stephen Warrenfad59882011-04-28 17:37:59 -06003185 return -ENOMEM;
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00003186 }
Stephen Warrenfad59882011-04-28 17:37:59 -06003187 }
3188
Richard Purdie2b97eab2006-10-06 18:32:18 +02003189 switch(w->id) {
3190 case snd_soc_dapm_switch:
3191 case snd_soc_dapm_mixer:
Ian Moltonca9c1aa2009-01-06 20:11:51 +00003192 case snd_soc_dapm_mixer_named_ctl:
Lars-Peter Clausen4b80b8c2011-06-09 13:22:36 +02003193 dapm_new_mixer(w);
Richard Purdie2b97eab2006-10-06 18:32:18 +02003194 break;
3195 case snd_soc_dapm_mux:
Lars-Peter Clausend714f972015-05-01 18:02:43 +02003196 case snd_soc_dapm_demux:
Lars-Peter Clausen4b80b8c2011-06-09 13:22:36 +02003197 dapm_new_mux(w);
Richard Purdie2b97eab2006-10-06 18:32:18 +02003198 break;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003199 case snd_soc_dapm_pga:
Olaya, Margaritad88429a2010-12-10 21:11:44 -06003200 case snd_soc_dapm_out_drv:
Lars-Peter Clausen4b80b8c2011-06-09 13:22:36 +02003201 dapm_new_pga(w);
Richard Purdie2b97eab2006-10-06 18:32:18 +02003202 break;
Nikesh Oswalc6615082015-02-02 17:06:44 +00003203 case snd_soc_dapm_dai_link:
3204 dapm_new_dai_link(w);
3205 break;
Mark Brown7ca3a182011-10-08 14:04:50 +01003206 default:
Richard Purdie2b97eab2006-10-06 18:32:18 +02003207 break;
3208 }
Mark Brownb66a70d2011-02-09 18:04:11 +00003209
3210 /* Read the initial power state from the device */
3211 if (w->reg >= 0) {
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02003212 soc_dapm_read(w->dapm, w->reg, &val);
Arun Shamanna Lakshmif7d3c172014-01-14 15:31:54 -08003213 val = val >> w->shift;
Lars-Peter Clausende9ba982013-07-29 17:14:01 +02003214 val &= w->mask;
3215 if (val == w->on_val)
Mark Brownb66a70d2011-02-09 18:04:11 +00003216 w->power = 1;
3217 }
3218
Richard Purdie2b97eab2006-10-06 18:32:18 +02003219 w->new = 1;
Lars-Peter Clausend5d1e0b2011-04-30 19:45:49 +02003220
Mark Brown7508b122011-10-05 12:09:12 +01003221 dapm_mark_dirty(w, "new widget");
Lars-Peter Clausend5d1e0b2011-04-30 19:45:49 +02003222 dapm_debugfs_add_widget(w);
Richard Purdie2b97eab2006-10-06 18:32:18 +02003223 }
3224
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02003225 dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP);
3226 mutex_unlock(&card->dapm_mutex);
Richard Purdie2b97eab2006-10-06 18:32:18 +02003227 return 0;
3228}
3229EXPORT_SYMBOL_GPL(snd_soc_dapm_new_widgets);
3230
3231/**
3232 * snd_soc_dapm_get_volsw - dapm mixer get callback
3233 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00003234 * @ucontrol: control element information
Richard Purdie2b97eab2006-10-06 18:32:18 +02003235 *
3236 * Callback to get the value of a dapm mixer control.
3237 *
3238 * Returns 0 for success.
3239 */
3240int snd_soc_dapm_get_volsw(struct snd_kcontrol *kcontrol,
3241 struct snd_ctl_elem_value *ucontrol)
3242{
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02003243 struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
3244 struct snd_soc_card *card = dapm->card;
Jon Smirl4eaa9812008-07-29 11:42:26 +01003245 struct soc_mixer_control *mc =
3246 (struct soc_mixer_control *)kcontrol->private_value;
Lars-Peter Clausen249ce132013-10-06 13:43:49 +02003247 int reg = mc->reg;
Jon Smirl815ecf8d2008-07-29 10:22:24 -04003248 unsigned int shift = mc->shift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01003249 int max = mc->max;
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003250 unsigned int width = fls(max);
Jon Smirl815ecf8d2008-07-29 10:22:24 -04003251 unsigned int mask = (1 << fls(max)) - 1;
Benoît Thébaudeauda602ab2012-07-03 20:18:17 +02003252 unsigned int invert = mc->invert;
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003253 unsigned int reg_val, val, rval = 0;
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02003254 int ret = 0;
Benoît Thébaudeauda602ab2012-07-03 20:18:17 +02003255
Lars-Peter Clausen57295072013-08-05 11:27:31 +02003256 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02003257 if (dapm_kcontrol_is_powered(kcontrol) && reg != SND_SOC_NOPM) {
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003258 ret = soc_dapm_read(dapm, reg, &reg_val);
3259 val = (reg_val >> shift) & mask;
3260
3261 if (ret == 0 && reg != mc->rreg)
3262 ret = soc_dapm_read(dapm, mc->rreg, &reg_val);
3263
3264 if (snd_soc_volsw_is_stereo(mc))
3265 rval = (reg_val >> mc->rshift) & mask;
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02003266 } else {
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003267 reg_val = dapm_kcontrol_get_value(kcontrol);
3268 val = reg_val & mask;
3269
3270 if (snd_soc_volsw_is_stereo(mc))
3271 rval = (reg_val >> width) & mask;
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02003272 }
Lars-Peter Clausen57295072013-08-05 11:27:31 +02003273 mutex_unlock(&card->dapm_mutex);
3274
Chen-Yu Tsai01ad5e72016-08-27 19:27:58 +08003275 if (ret)
3276 return ret;
3277
Benoît Thébaudeauda602ab2012-07-03 20:18:17 +02003278 if (invert)
Lars-Peter Clausen57295072013-08-05 11:27:31 +02003279 ucontrol->value.integer.value[0] = max - val;
3280 else
3281 ucontrol->value.integer.value[0] = val;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003282
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003283 if (snd_soc_volsw_is_stereo(mc)) {
3284 if (invert)
3285 ucontrol->value.integer.value[1] = max - rval;
3286 else
3287 ucontrol->value.integer.value[1] = rval;
3288 }
3289
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02003290 return ret;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003291}
3292EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);
3293
3294/**
3295 * snd_soc_dapm_put_volsw - dapm mixer set callback
3296 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00003297 * @ucontrol: control element information
Richard Purdie2b97eab2006-10-06 18:32:18 +02003298 *
3299 * Callback to set the value of a dapm mixer control.
3300 *
3301 * Returns 0 for success.
3302 */
3303int snd_soc_dapm_put_volsw(struct snd_kcontrol *kcontrol,
3304 struct snd_ctl_elem_value *ucontrol)
3305{
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02003306 struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
3307 struct snd_soc_card *card = dapm->card;
Jon Smirl4eaa9812008-07-29 11:42:26 +01003308 struct soc_mixer_control *mc =
3309 (struct soc_mixer_control *)kcontrol->private_value;
Lars-Peter Clausen249ce132013-10-06 13:43:49 +02003310 int reg = mc->reg;
Jon Smirl815ecf8d2008-07-29 10:22:24 -04003311 unsigned int shift = mc->shift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01003312 int max = mc->max;
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003313 unsigned int width = fls(max);
3314 unsigned int mask = (1 << width) - 1;
Jon Smirl815ecf8d2008-07-29 10:22:24 -04003315 unsigned int invert = mc->invert;
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003316 unsigned int val, rval = 0;
3317 int connect, rconnect = -1, change, reg_change = 0;
Fabio Estevam33d92452018-02-14 13:39:05 -02003318 struct snd_soc_dapm_update update = {};
Nenghua Cao52765972013-12-13 20:13:49 +08003319 int ret = 0;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003320
3321 val = (ucontrol->value.integer.value[0] & mask);
Benoît Thébaudeau8a720712012-06-18 22:41:28 +02003322 connect = !!val;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003323
3324 if (invert)
Philipp Zabela7a4ac82008-01-10 14:37:42 +01003325 val = max - val;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003326
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003327 if (snd_soc_volsw_is_stereo(mc)) {
3328 rval = (ucontrol->value.integer.value[1] & mask);
3329 rconnect = !!rval;
3330 if (invert)
3331 rval = max - rval;
3332 }
3333
Liam Girdwood3cd04342012-03-09 12:02:08 +00003334 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
Richard Purdie2b97eab2006-10-06 18:32:18 +02003335
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003336 /* This assumes field width < (bits in unsigned int / 2) */
3337 if (width > sizeof(unsigned int) * 8 / 2)
3338 dev_warn(dapm->dev,
3339 "ASoC: control %s field width limit exceeded\n",
3340 kcontrol->id.name);
3341 change = dapm_kcontrol_set_value(kcontrol, val | (rval << width));
Mark Brown283375c2009-12-07 18:09:03 +00003342
Jarkko Nikula18626c72014-06-09 14:20:29 +03003343 if (reg != SND_SOC_NOPM) {
Jarkko Nikula18626c72014-06-09 14:20:29 +03003344 val = val << shift;
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003345 rval = rval << mc->rshift;
Lars-Peter Clausenc9e065c2014-05-04 19:17:05 +02003346
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003347 reg_change = soc_dapm_test_bits(dapm, reg, mask << shift, val);
3348
3349 if (snd_soc_volsw_is_stereo(mc))
3350 reg_change |= soc_dapm_test_bits(dapm, mc->rreg,
3351 mask << mc->rshift,
3352 rval);
Jarkko Nikula18626c72014-06-09 14:20:29 +03003353 }
3354
3355 if (change || reg_change) {
3356 if (reg_change) {
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003357 if (snd_soc_volsw_is_stereo(mc)) {
3358 update.has_second_set = true;
3359 update.reg2 = mc->rreg;
3360 update.mask2 = mask << mc->rshift;
3361 update.val2 = rval;
3362 }
Jarkko Nikula18626c72014-06-09 14:20:29 +03003363 update.kcontrol = kcontrol;
3364 update.reg = reg;
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003365 update.mask = mask << shift;
Jarkko Nikula18626c72014-06-09 14:20:29 +03003366 update.val = val;
3367 card->update = &update;
Lars-Peter Clausen249ce132013-10-06 13:43:49 +02003368 }
Jarkko Nikula18626c72014-06-09 14:20:29 +03003369 change |= reg_change;
Mark Brown97404f22010-12-14 16:13:57 +00003370
Chen-Yu Tsaie7aa4502016-11-02 15:35:59 +08003371 ret = soc_dapm_mixer_update_power(card, kcontrol, connect,
3372 rconnect);
Mark Brown97404f22010-12-14 16:13:57 +00003373
Lars-Peter Clausen564c65042013-07-29 17:13:55 +02003374 card->update = NULL;
Mark Brown283375c2009-12-07 18:09:03 +00003375 }
3376
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00003377 mutex_unlock(&card->dapm_mutex);
Nenghua Cao52765972013-12-13 20:13:49 +08003378
3379 if (ret > 0)
3380 soc_dpcm_runtime_update(card);
3381
Lars-Peter Clausen56a67832013-07-24 15:27:35 +02003382 return change;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003383}
3384EXPORT_SYMBOL_GPL(snd_soc_dapm_put_volsw);
3385
3386/**
3387 * snd_soc_dapm_get_enum_double - dapm enumerated double mixer get callback
3388 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00003389 * @ucontrol: control element information
Richard Purdie2b97eab2006-10-06 18:32:18 +02003390 *
3391 * Callback to get the value of a dapm enumerated double mixer control.
3392 *
3393 * Returns 0 for success.
3394 */
3395int snd_soc_dapm_get_enum_double(struct snd_kcontrol *kcontrol,
3396 struct snd_ctl_elem_value *ucontrol)
3397{
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02003398 struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
Charles Keepax561ed682015-05-01 12:37:26 +01003399 struct snd_soc_card *card = dapm->card;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003400 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Lars-Peter Clausen3727b492014-02-28 08:31:04 +01003401 unsigned int reg_val, val;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003402
Charles Keepax561ed682015-05-01 12:37:26 +01003403 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3404 if (e->reg != SND_SOC_NOPM && dapm_kcontrol_is_powered(kcontrol)) {
Geert Uytterhoeven69128312014-08-08 17:29:35 +02003405 int ret = soc_dapm_read(dapm, e->reg, &reg_val);
Charles Keepax964a0b82015-05-08 10:50:10 +01003406 if (ret) {
3407 mutex_unlock(&card->dapm_mutex);
Geert Uytterhoeven69128312014-08-08 17:29:35 +02003408 return ret;
Charles Keepax964a0b82015-05-08 10:50:10 +01003409 }
Geert Uytterhoeven69128312014-08-08 17:29:35 +02003410 } else {
Lars-Peter Clausen236aaa62014-02-28 08:31:11 +01003411 reg_val = dapm_kcontrol_get_value(kcontrol);
Geert Uytterhoeven69128312014-08-08 17:29:35 +02003412 }
Charles Keepax561ed682015-05-01 12:37:26 +01003413 mutex_unlock(&card->dapm_mutex);
Lars-Peter Clausen236aaa62014-02-28 08:31:11 +01003414
Lars-Peter Clausen3727b492014-02-28 08:31:04 +01003415 val = (reg_val >> e->shift_l) & e->mask;
3416 ucontrol->value.enumerated.item[0] = snd_soc_enum_val_to_item(e, val);
3417 if (e->shift_l != e->shift_r) {
3418 val = (reg_val >> e->shift_r) & e->mask;
3419 val = snd_soc_enum_val_to_item(e, val);
3420 ucontrol->value.enumerated.item[1] = val;
3421 }
Richard Purdie2b97eab2006-10-06 18:32:18 +02003422
Geert Uytterhoeven69128312014-08-08 17:29:35 +02003423 return 0;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003424}
3425EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);
3426
3427/**
3428 * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
3429 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00003430 * @ucontrol: control element information
Richard Purdie2b97eab2006-10-06 18:32:18 +02003431 *
3432 * Callback to set the value of a dapm enumerated double mixer control.
3433 *
3434 * Returns 0 for success.
3435 */
3436int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
3437 struct snd_ctl_elem_value *ucontrol)
3438{
Lars-Peter Clausence0fc932014-06-16 18:13:06 +02003439 struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
3440 struct snd_soc_card *card = dapm->card;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003441 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Lars-Peter Clausen3727b492014-02-28 08:31:04 +01003442 unsigned int *item = ucontrol->value.enumerated.item;
Charles Keepax561ed682015-05-01 12:37:26 +01003443 unsigned int val, change, reg_change = 0;
Lars-Peter Clausen86767b72012-09-14 13:57:27 +02003444 unsigned int mask;
Fabio Estevam33d92452018-02-14 13:39:05 -02003445 struct snd_soc_dapm_update update = {};
Nenghua Cao52765972013-12-13 20:13:49 +08003446 int ret = 0;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003447
Lars-Peter Clausen3727b492014-02-28 08:31:04 +01003448 if (item[0] >= e->items)
Richard Purdie2b97eab2006-10-06 18:32:18 +02003449 return -EINVAL;
Lars-Peter Clausen3727b492014-02-28 08:31:04 +01003450
3451 val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l;
Lars-Peter Clausen86767b72012-09-14 13:57:27 +02003452 mask = e->mask << e->shift_l;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003453 if (e->shift_l != e->shift_r) {
Lars-Peter Clausen3727b492014-02-28 08:31:04 +01003454 if (item[1] > e->items)
Richard Purdie2b97eab2006-10-06 18:32:18 +02003455 return -EINVAL;
Chen-Yu Tsai071133a2016-08-27 19:27:59 +08003456 val |= snd_soc_enum_item_to_val(e, item[1]) << e->shift_r;
Lars-Peter Clausen86767b72012-09-14 13:57:27 +02003457 mask |= e->mask << e->shift_r;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003458 }
3459
Liam Girdwood3cd04342012-03-09 12:02:08 +00003460 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
Stephen Warrenfafd2172011-04-28 17:38:00 -06003461
Charles Keepax561ed682015-05-01 12:37:26 +01003462 change = dapm_kcontrol_set_value(kcontrol, val);
Mark Brown97404f22010-12-14 16:13:57 +00003463
Charles Keepax561ed682015-05-01 12:37:26 +01003464 if (e->reg != SND_SOC_NOPM)
3465 reg_change = soc_dapm_test_bits(dapm, e->reg, mask, val);
3466
3467 if (change || reg_change) {
3468 if (reg_change) {
Lars-Peter Clausen236aaa62014-02-28 08:31:11 +01003469 update.kcontrol = kcontrol;
3470 update.reg = e->reg;
3471 update.mask = mask;
3472 update.val = val;
3473 card->update = &update;
3474 }
Charles Keepax561ed682015-05-01 12:37:26 +01003475 change |= reg_change;
Mark Brown3a655772009-10-05 17:23:30 +01003476
Lars-Peter Clausen3727b492014-02-28 08:31:04 +01003477 ret = soc_dapm_mux_update_power(card, kcontrol, item[0], e);
Mark Brown1642e3d2009-10-05 16:24:26 +01003478
Lars-Peter Clausen564c65042013-07-29 17:13:55 +02003479 card->update = NULL;
Stephen Warrenfafd2172011-04-28 17:38:00 -06003480 }
3481
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00003482 mutex_unlock(&card->dapm_mutex);
Nenghua Cao52765972013-12-13 20:13:49 +08003483
3484 if (ret > 0)
3485 soc_dpcm_runtime_update(card);
3486
Mark Brown97404f22010-12-14 16:13:57 +00003487 return change;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003488}
3489EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);
3490
3491/**
Mark Brown8b37dbd2009-02-28 21:14:20 +00003492 * snd_soc_dapm_info_pin_switch - Info for a pin switch
3493 *
3494 * @kcontrol: mixer control
3495 * @uinfo: control element information
3496 *
3497 * Callback to provide information about a pin switch control.
3498 */
3499int snd_soc_dapm_info_pin_switch(struct snd_kcontrol *kcontrol,
3500 struct snd_ctl_elem_info *uinfo)
3501{
3502 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
3503 uinfo->count = 1;
3504 uinfo->value.integer.min = 0;
3505 uinfo->value.integer.max = 1;
3506
3507 return 0;
3508}
3509EXPORT_SYMBOL_GPL(snd_soc_dapm_info_pin_switch);
3510
3511/**
3512 * snd_soc_dapm_get_pin_switch - Get information for a pin switch
3513 *
3514 * @kcontrol: mixer control
3515 * @ucontrol: Value
3516 */
3517int snd_soc_dapm_get_pin_switch(struct snd_kcontrol *kcontrol,
3518 struct snd_ctl_elem_value *ucontrol)
3519{
Mark Brown48a8c392012-02-14 17:11:15 -08003520 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
Mark Brown8b37dbd2009-02-28 21:14:20 +00003521 const char *pin = (const char *)kcontrol->private_value;
3522
Liam Girdwood3cd04342012-03-09 12:02:08 +00003523 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
Mark Brown8b37dbd2009-02-28 21:14:20 +00003524
3525 ucontrol->value.integer.value[0] =
Mark Brown48a8c392012-02-14 17:11:15 -08003526 snd_soc_dapm_get_pin_status(&card->dapm, pin);
Mark Brown8b37dbd2009-02-28 21:14:20 +00003527
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00003528 mutex_unlock(&card->dapm_mutex);
Mark Brown8b37dbd2009-02-28 21:14:20 +00003529
3530 return 0;
3531}
3532EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_switch);
3533
3534/**
3535 * snd_soc_dapm_put_pin_switch - Set information for a pin switch
3536 *
3537 * @kcontrol: mixer control
3538 * @ucontrol: Value
3539 */
3540int snd_soc_dapm_put_pin_switch(struct snd_kcontrol *kcontrol,
3541 struct snd_ctl_elem_value *ucontrol)
3542{
Mark Brown48a8c392012-02-14 17:11:15 -08003543 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
Mark Brown8b37dbd2009-02-28 21:14:20 +00003544 const char *pin = (const char *)kcontrol->private_value;
3545
Mark Brown8b37dbd2009-02-28 21:14:20 +00003546 if (ucontrol->value.integer.value[0])
Mark Brown48a8c392012-02-14 17:11:15 -08003547 snd_soc_dapm_enable_pin(&card->dapm, pin);
Mark Brown8b37dbd2009-02-28 21:14:20 +00003548 else
Mark Brown48a8c392012-02-14 17:11:15 -08003549 snd_soc_dapm_disable_pin(&card->dapm, pin);
Mark Brown8b37dbd2009-02-28 21:14:20 +00003550
Mark Brown48a8c392012-02-14 17:11:15 -08003551 snd_soc_dapm_sync(&card->dapm);
Mark Brown8b37dbd2009-02-28 21:14:20 +00003552 return 0;
3553}
3554EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);
3555
Liam Girdwoodcc76e7d2015-06-04 15:13:09 +01003556struct snd_soc_dapm_widget *
Liam Girdwood02aa78a2015-05-25 18:21:17 +01003557snd_soc_dapm_new_control_unlocked(struct snd_soc_dapm_context *dapm,
Mark Brown5ba06fc2012-02-16 11:07:13 -08003558 const struct snd_soc_dapm_widget *widget)
Richard Purdie2b97eab2006-10-06 18:32:18 +02003559{
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02003560 enum snd_soc_dapm_direction dir;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003561 struct snd_soc_dapm_widget *w;
Lars-Peter Clausen94f99c82014-06-16 18:13:01 +02003562 const char *prefix;
Mark Brown62ea8742012-01-21 21:14:48 +00003563 int ret;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003564
3565 if ((w = dapm_cnew_widget(widget)) == NULL)
Charles Keepax3bbf5d32018-09-05 15:20:58 +01003566 return ERR_PTR(-ENOMEM);
Richard Purdie2b97eab2006-10-06 18:32:18 +02003567
Mark Brown62ea8742012-01-21 21:14:48 +00003568 switch (w->id) {
3569 case snd_soc_dapm_regulator_supply:
Liam Girdwooda3cc0562012-03-09 17:20:16 +00003570 w->regulator = devm_regulator_get(dapm->dev, w->name);
3571 if (IS_ERR(w->regulator)) {
3572 ret = PTR_ERR(w->regulator);
Charles Keepax3bbf5d32018-09-05 15:20:58 +01003573 goto request_failed;
Mark Brown62ea8742012-01-21 21:14:48 +00003574 }
Mark Brown8784c772013-01-10 19:33:47 +00003575
Lars-Peter Clausende9ba982013-07-29 17:14:01 +02003576 if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) {
Mark Brown8784c772013-01-10 19:33:47 +00003577 ret = regulator_allow_bypass(w->regulator, true);
3578 if (ret != 0)
Charles Keepax3bbf5d32018-09-05 15:20:58 +01003579 dev_warn(dapm->dev,
Charles Keepax30686c32014-02-18 16:05:27 +00003580 "ASoC: Failed to bypass %s: %d\n",
Mark Brown8784c772013-01-10 19:33:47 +00003581 w->name, ret);
3582 }
Mark Brown62ea8742012-01-21 21:14:48 +00003583 break;
Srinivas Kandagatla5b2d15b2018-03-10 02:37:27 +00003584 case snd_soc_dapm_pinctrl:
3585 w->pinctrl = devm_pinctrl_get(dapm->dev);
Charles Keepaxa5cd7e92018-08-28 14:35:03 +01003586 if (IS_ERR(w->pinctrl)) {
Srinivas Kandagatla5b2d15b2018-03-10 02:37:27 +00003587 ret = PTR_ERR(w->pinctrl);
Charles Keepax3bbf5d32018-09-05 15:20:58 +01003588 goto request_failed;
Srinivas Kandagatla5b2d15b2018-03-10 02:37:27 +00003589 }
3590 break;
Ola Liljad7e7eb92012-05-24 15:26:25 +02003591 case snd_soc_dapm_clock_supply:
Mark Brown695594f12012-06-04 08:14:13 +01003592 w->clk = devm_clk_get(dapm->dev, w->name);
Ola Liljad7e7eb92012-05-24 15:26:25 +02003593 if (IS_ERR(w->clk)) {
3594 ret = PTR_ERR(w->clk);
Charles Keepax3bbf5d32018-09-05 15:20:58 +01003595 goto request_failed;
Ola Liljad7e7eb92012-05-24 15:26:25 +02003596 }
3597 break;
Mark Brown62ea8742012-01-21 21:14:48 +00003598 default:
3599 break;
3600 }
Richard Purdie2b97eab2006-10-06 18:32:18 +02003601
Lars-Peter Clausen94f99c82014-06-16 18:13:01 +02003602 prefix = soc_dapm_prefix(dapm);
Lars-Peter Clausena798c242015-07-21 11:51:35 +02003603 if (prefix)
Lars-Peter Clausen94f99c82014-06-16 18:13:01 +02003604 w->name = kasprintf(GFP_KERNEL, "%s %s", prefix, widget->name);
Lars-Peter Clausena798c242015-07-21 11:51:35 +02003605 else
Lars-Peter Clausen48068962015-07-21 18:11:08 +02003606 w->name = kstrdup_const(widget->name, GFP_KERNEL);
Jarkko Nikulaead9b912010-11-13 20:40:44 +02003607 if (w->name == NULL) {
Pierre-Louis Bossart199ed3e2019-02-01 11:05:12 -06003608 kfree_const(w->sname);
Jarkko Nikulaead9b912010-11-13 20:40:44 +02003609 kfree(w);
Charles Keepax3bbf5d32018-09-05 15:20:58 +01003610 return ERR_PTR(-ENOMEM);
Jarkko Nikulaead9b912010-11-13 20:40:44 +02003611 }
Jarkko Nikulaead9b912010-11-13 20:40:44 +02003612
Mark Brown7ca3a182011-10-08 14:04:50 +01003613 switch (w->id) {
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02003614 case snd_soc_dapm_mic:
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02003615 w->is_ep = SND_SOC_DAPM_EP_SOURCE;
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02003616 w->power_check = dapm_generic_check_power;
3617 break;
Lars-Peter Clausen86d75002014-12-21 11:05:44 +01003618 case snd_soc_dapm_input:
3619 if (!dapm->card->fully_routed)
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02003620 w->is_ep = SND_SOC_DAPM_EP_SOURCE;
Lars-Peter Clausen86d75002014-12-21 11:05:44 +01003621 w->power_check = dapm_generic_check_power;
3622 break;
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02003623 case snd_soc_dapm_spk:
3624 case snd_soc_dapm_hp:
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02003625 w->is_ep = SND_SOC_DAPM_EP_SINK;
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02003626 w->power_check = dapm_generic_check_power;
3627 break;
Lars-Peter Clausen86d75002014-12-21 11:05:44 +01003628 case snd_soc_dapm_output:
3629 if (!dapm->card->fully_routed)
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02003630 w->is_ep = SND_SOC_DAPM_EP_SINK;
Lars-Peter Clausen86d75002014-12-21 11:05:44 +01003631 w->power_check = dapm_generic_check_power;
3632 break;
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02003633 case snd_soc_dapm_vmid:
3634 case snd_soc_dapm_siggen:
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02003635 w->is_ep = SND_SOC_DAPM_EP_SOURCE;
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02003636 w->power_check = dapm_always_on_check_power;
3637 break;
Vinod Koul56b44372015-11-23 21:22:30 +05303638 case snd_soc_dapm_sink:
3639 w->is_ep = SND_SOC_DAPM_EP_SINK;
3640 w->power_check = dapm_always_on_check_power;
3641 break;
3642
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02003643 case snd_soc_dapm_mux:
Lars-Peter Clausend714f972015-05-01 18:02:43 +02003644 case snd_soc_dapm_demux:
Mark Brown7ca3a182011-10-08 14:04:50 +01003645 case snd_soc_dapm_switch:
3646 case snd_soc_dapm_mixer:
3647 case snd_soc_dapm_mixer_named_ctl:
Mark Brown63c69a62013-07-18 22:03:01 +01003648 case snd_soc_dapm_adc:
3649 case snd_soc_dapm_aif_out:
3650 case snd_soc_dapm_dac:
3651 case snd_soc_dapm_aif_in:
Mark Brown7ca3a182011-10-08 14:04:50 +01003652 case snd_soc_dapm_pga:
3653 case snd_soc_dapm_out_drv:
Mark Brown7ca3a182011-10-08 14:04:50 +01003654 case snd_soc_dapm_micbias:
Mark Brown7ca3a182011-10-08 14:04:50 +01003655 case snd_soc_dapm_line:
Mark Brownc74184e2012-04-04 22:12:09 +01003656 case snd_soc_dapm_dai_link:
Lars-Peter Clausencdef2ad2014-10-20 19:36:38 +02003657 case snd_soc_dapm_dai_out:
3658 case snd_soc_dapm_dai_in:
Mark Brown7ca3a182011-10-08 14:04:50 +01003659 w->power_check = dapm_generic_check_power;
3660 break;
3661 case snd_soc_dapm_supply:
Mark Brown62ea8742012-01-21 21:14:48 +00003662 case snd_soc_dapm_regulator_supply:
Srinivas Kandagatla5b2d15b2018-03-10 02:37:27 +00003663 case snd_soc_dapm_pinctrl:
Ola Liljad7e7eb92012-05-24 15:26:25 +02003664 case snd_soc_dapm_clock_supply:
Lars-Peter Clausen57295072013-08-05 11:27:31 +02003665 case snd_soc_dapm_kcontrol:
Lars-Peter Clausen6dd98b02014-10-25 17:41:59 +02003666 w->is_supply = 1;
Mark Brown7ca3a182011-10-08 14:04:50 +01003667 w->power_check = dapm_supply_check_power;
3668 break;
3669 default:
3670 w->power_check = dapm_always_on_check_power;
3671 break;
3672 }
3673
Liam Girdwoodce6120c2010-11-05 15:53:46 +02003674 w->dapm = dapm;
Richard Purdie2b97eab2006-10-06 18:32:18 +02003675 INIT_LIST_HEAD(&w->list);
Mark Browndb432b42011-10-03 21:06:40 +01003676 INIT_LIST_HEAD(&w->dirty);
Lars-Peter Clausen92fa1242015-05-01 18:02:42 +02003677 list_add_tail(&w->list, &dapm->card->widgets);
Richard Purdie2b97eab2006-10-06 18:32:18 +02003678
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02003679 snd_soc_dapm_for_each_direction(dir) {
3680 INIT_LIST_HEAD(&w->edges[dir]);
3681 w->endpoints[dir] = -1;
3682 }
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +02003683
Peter Meerwald-Stadlerc8046002016-08-16 16:56:17 +02003684 /* machine layer sets up unconnected pins and insertions */
Richard Purdie2b97eab2006-10-06 18:32:18 +02003685 w->connected = 1;
Mark Brown5ba06fc2012-02-16 11:07:13 -08003686 return w;
Charles Keepax3bbf5d32018-09-05 15:20:58 +01003687
3688request_failed:
3689 if (ret != -EPROBE_DEFER)
3690 dev_err(dapm->dev, "ASoC: Failed to request %s: %d\n",
3691 w->name, ret);
3692
3693 return ERR_PTR(ret);
Richard Purdie2b97eab2006-10-06 18:32:18 +02003694}
Richard Purdie2b97eab2006-10-06 18:32:18 +02003695
3696/**
Charles Keepax94e630a2018-09-05 15:20:59 +01003697 * snd_soc_dapm_new_control - create new dapm control
3698 * @dapm: DAPM context
3699 * @widget: widget template
3700 *
3701 * Creates new DAPM control based upon a template.
3702 *
3703 * Returns a widget pointer on success or an error pointer on failure
3704 */
3705struct snd_soc_dapm_widget *
3706snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
3707 const struct snd_soc_dapm_widget *widget)
3708{
3709 struct snd_soc_dapm_widget *w;
3710
3711 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3712 w = snd_soc_dapm_new_control_unlocked(dapm, widget);
3713 mutex_unlock(&dapm->card->dapm_mutex);
3714
3715 return w;
3716}
3717EXPORT_SYMBOL_GPL(snd_soc_dapm_new_control);
3718
3719/**
Mark Brown4ba13272008-05-13 14:51:19 +02003720 * snd_soc_dapm_new_controls - create new dapm controls
Liam Girdwoodce6120c2010-11-05 15:53:46 +02003721 * @dapm: DAPM context
Mark Brown4ba13272008-05-13 14:51:19 +02003722 * @widget: widget array
3723 * @num: number of widgets
3724 *
3725 * Creates new DAPM controls based upon the templates.
3726 *
3727 * Returns 0 for success else error.
3728 */
Liam Girdwoodce6120c2010-11-05 15:53:46 +02003729int snd_soc_dapm_new_controls(struct snd_soc_dapm_context *dapm,
Mark Brown4ba13272008-05-13 14:51:19 +02003730 const struct snd_soc_dapm_widget *widget,
3731 int num)
3732{
Mark Brown5ba06fc2012-02-16 11:07:13 -08003733 struct snd_soc_dapm_widget *w;
3734 int i;
Dan Carpenter60884c22012-04-13 22:25:43 +03003735 int ret = 0;
Mark Brown4ba13272008-05-13 14:51:19 +02003736
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00003737 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT);
Mark Brown4ba13272008-05-13 14:51:19 +02003738 for (i = 0; i < num; i++) {
Liam Girdwood02aa78a2015-05-25 18:21:17 +01003739 w = snd_soc_dapm_new_control_unlocked(dapm, widget);
Linus Walleij37e1df82017-01-13 10:23:52 +01003740 if (IS_ERR(w)) {
3741 ret = PTR_ERR(w);
Dan Carpenter60884c22012-04-13 22:25:43 +03003742 break;
Mark Brownb8b33cb2008-12-18 11:19:30 +00003743 }
Mark Brown4ba13272008-05-13 14:51:19 +02003744 widget++;
3745 }
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00003746 mutex_unlock(&dapm->card->dapm_mutex);
Dan Carpenter60884c22012-04-13 22:25:43 +03003747 return ret;
Mark Brown4ba13272008-05-13 14:51:19 +02003748}
3749EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);
3750
Mark Brownc74184e2012-04-04 22:12:09 +01003751static int snd_soc_dai_link_event(struct snd_soc_dapm_widget *w,
3752 struct snd_kcontrol *kcontrol, int event)
3753{
Charles Keepax4a75aae2018-09-05 15:21:01 +01003754 struct snd_soc_dapm_path *path;
Mark Brownc74184e2012-04-04 22:12:09 +01003755 struct snd_soc_dai *source, *sink;
Charles Keepax249dc492018-08-15 13:11:35 +01003756 struct snd_soc_pcm_runtime *rtd = w->priv;
Charles Keepax243bcfa2018-09-05 15:21:02 +01003757 const struct snd_soc_pcm_stream *config;
Mark Brownc74184e2012-04-04 22:12:09 +01003758 struct snd_pcm_substream substream;
Mark Brown9747cec2012-04-26 19:12:21 +01003759 struct snd_pcm_hw_params *params = NULL;
Nicolin Chen8053f212016-07-26 14:55:51 -07003760 struct snd_pcm_runtime *runtime = NULL;
Takashi Iwai3ba66fe2018-07-25 22:43:26 +02003761 unsigned int fmt;
Charles Keepaxfc269c02018-09-06 17:41:55 +01003762 int ret = 0;
Mark Brownc74184e2012-04-04 22:12:09 +01003763
Charles Keepax243bcfa2018-09-05 15:21:02 +01003764 config = rtd->dai_link->params + rtd->params_select;
3765
Takashi Iwaibf4edea2013-11-07 18:38:47 +01003766 if (WARN_ON(!config) ||
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02003767 WARN_ON(list_empty(&w->edges[SND_SOC_DAPM_DIR_OUT]) ||
3768 list_empty(&w->edges[SND_SOC_DAPM_DIR_IN])))
Takashi Iwaibf4edea2013-11-07 18:38:47 +01003769 return -EINVAL;
Mark Brownc74184e2012-04-04 22:12:09 +01003770
Mark Brownc74184e2012-04-04 22:12:09 +01003771 /* Be a little careful as we don't want to overflow the mask array */
3772 if (config->formats) {
3773 fmt = ffs(config->formats) - 1;
3774 } else {
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00003775 dev_warn(w->dapm->dev, "ASoC: Invalid format %llx specified\n",
Mark Brownc74184e2012-04-04 22:12:09 +01003776 config->formats);
3777 fmt = 0;
3778 }
3779
3780 /* Currently very limited parameter selection */
Mark Brown9747cec2012-04-26 19:12:21 +01003781 params = kzalloc(sizeof(*params), GFP_KERNEL);
3782 if (!params) {
3783 ret = -ENOMEM;
3784 goto out;
3785 }
3786 snd_mask_set(hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT), fmt);
Mark Brownc74184e2012-04-04 22:12:09 +01003787
Mark Brown9747cec2012-04-26 19:12:21 +01003788 hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->min =
Mark Brownc74184e2012-04-04 22:12:09 +01003789 config->rate_min;
Mark Brown9747cec2012-04-26 19:12:21 +01003790 hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->max =
Mark Brownc74184e2012-04-04 22:12:09 +01003791 config->rate_max;
3792
Mark Brown9747cec2012-04-26 19:12:21 +01003793 hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->min
Mark Brownc74184e2012-04-04 22:12:09 +01003794 = config->channels_min;
Mark Brown9747cec2012-04-26 19:12:21 +01003795 hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->max
Mark Brownc74184e2012-04-04 22:12:09 +01003796 = config->channels_max;
3797
3798 memset(&substream, 0, sizeof(substream));
3799
Nicolin Chen8053f212016-07-26 14:55:51 -07003800 /* Allocate a dummy snd_pcm_runtime for startup() and other ops() */
3801 runtime = kzalloc(sizeof(*runtime), GFP_KERNEL);
3802 if (!runtime) {
3803 ret = -ENOMEM;
3804 goto out;
3805 }
3806 substream.runtime = runtime;
Charles Keepax249dc492018-08-15 13:11:35 +01003807 substream.private_data = rtd;
Nicolin Chen8053f212016-07-26 14:55:51 -07003808
Mark Brownc74184e2012-04-04 22:12:09 +01003809 switch (event) {
3810 case SND_SOC_DAPM_PRE_PMU:
Benoit Cousson93e69582014-07-08 23:19:38 +02003811 substream.stream = SNDRV_PCM_STREAM_CAPTURE;
Charles Keepax4a75aae2018-09-05 15:21:01 +01003812 snd_soc_dapm_widget_for_each_source_path(w, path) {
3813 source = path->source->priv;
3814
3815 if (source->driver->ops->startup) {
3816 ret = source->driver->ops->startup(&substream,
3817 source);
3818 if (ret < 0) {
3819 dev_err(source->dev,
3820 "ASoC: startup() failed: %d\n",
3821 ret);
3822 goto out;
3823 }
3824 source->active++;
Jeeja KP9b8ef9f2015-10-20 22:30:07 +05303825 }
Charles Keepax4a75aae2018-09-05 15:21:01 +01003826 ret = soc_dai_hw_params(&substream, params, source);
3827 if (ret < 0)
3828 goto out;
Charles Keepax078a85f2019-01-31 13:30:18 +00003829
3830 dapm_update_dai_unlocked(&substream, params, source);
Jeeja KP9b8ef9f2015-10-20 22:30:07 +05303831 }
Mark Brownc74184e2012-04-04 22:12:09 +01003832
Benoit Cousson93e69582014-07-08 23:19:38 +02003833 substream.stream = SNDRV_PCM_STREAM_PLAYBACK;
Charles Keepax4a75aae2018-09-05 15:21:01 +01003834 snd_soc_dapm_widget_for_each_sink_path(w, path) {
3835 sink = path->sink->priv;
3836
3837 if (sink->driver->ops->startup) {
3838 ret = sink->driver->ops->startup(&substream,
3839 sink);
3840 if (ret < 0) {
3841 dev_err(sink->dev,
3842 "ASoC: startup() failed: %d\n",
3843 ret);
3844 goto out;
3845 }
3846 sink->active++;
Jeeja KP9b8ef9f2015-10-20 22:30:07 +05303847 }
Charles Keepax4a75aae2018-09-05 15:21:01 +01003848 ret = soc_dai_hw_params(&substream, params, sink);
3849 if (ret < 0)
3850 goto out;
Charles Keepax078a85f2019-01-31 13:30:18 +00003851
3852 dapm_update_dai_unlocked(&substream, params, sink);
Jeeja KP9b8ef9f2015-10-20 22:30:07 +05303853 }
Mark Brownc74184e2012-04-04 22:12:09 +01003854 break;
3855
3856 case SND_SOC_DAPM_POST_PMU:
Charles Keepax4a75aae2018-09-05 15:21:01 +01003857 snd_soc_dapm_widget_for_each_sink_path(w, path) {
3858 sink = path->sink->priv;
3859
3860 ret = snd_soc_dai_digital_mute(sink, 0,
3861 SNDRV_PCM_STREAM_PLAYBACK);
3862 if (ret != 0 && ret != -ENOTSUPP)
3863 dev_warn(sink->dev,
3864 "ASoC: Failed to unmute: %d\n", ret);
3865 ret = 0;
3866 }
Mark Brownc74184e2012-04-04 22:12:09 +01003867 break;
3868
3869 case SND_SOC_DAPM_PRE_PMD:
Charles Keepax4a75aae2018-09-05 15:21:01 +01003870 snd_soc_dapm_widget_for_each_sink_path(w, path) {
3871 sink = path->sink->priv;
Jeeja KP9b8ef9f2015-10-20 22:30:07 +05303872
Charles Keepax4a75aae2018-09-05 15:21:01 +01003873 ret = snd_soc_dai_digital_mute(sink, 1,
3874 SNDRV_PCM_STREAM_PLAYBACK);
3875 if (ret != 0 && ret != -ENOTSUPP)
3876 dev_warn(sink->dev,
3877 "ASoC: Failed to mute: %d\n", ret);
3878 ret = 0;
Jeeja KP9b8ef9f2015-10-20 22:30:07 +05303879 }
3880
Charles Keepax3c01b0e2018-10-11 17:28:28 +01003881 substream.stream = SNDRV_PCM_STREAM_CAPTURE;
Charles Keepax4a75aae2018-09-05 15:21:01 +01003882 snd_soc_dapm_widget_for_each_source_path(w, path) {
3883 source = path->source->priv;
3884
Charles Keepax3c01b0e2018-10-11 17:28:28 +01003885 if (source->driver->ops->hw_free)
3886 source->driver->ops->hw_free(&substream,
3887 source);
3888
Charles Keepax4a75aae2018-09-05 15:21:01 +01003889 source->active--;
Charles Keepax3c01b0e2018-10-11 17:28:28 +01003890 if (source->driver->ops->shutdown)
Charles Keepax4a75aae2018-09-05 15:21:01 +01003891 source->driver->ops->shutdown(&substream,
3892 source);
Charles Keepax4a75aae2018-09-05 15:21:01 +01003893 }
3894
Charles Keepax3c01b0e2018-10-11 17:28:28 +01003895 substream.stream = SNDRV_PCM_STREAM_PLAYBACK;
Charles Keepax4a75aae2018-09-05 15:21:01 +01003896 snd_soc_dapm_widget_for_each_sink_path(w, path) {
3897 sink = path->sink->priv;
3898
Charles Keepax3c01b0e2018-10-11 17:28:28 +01003899 if (sink->driver->ops->hw_free)
3900 sink->driver->ops->hw_free(&substream, sink);
3901
Charles Keepax4a75aae2018-09-05 15:21:01 +01003902 sink->active--;
Charles Keepax3c01b0e2018-10-11 17:28:28 +01003903 if (sink->driver->ops->shutdown)
Charles Keepax4a75aae2018-09-05 15:21:01 +01003904 sink->driver->ops->shutdown(&substream, sink);
Jeeja KP9b8ef9f2015-10-20 22:30:07 +05303905 }
Mark Brownc74184e2012-04-04 22:12:09 +01003906 break;
3907
3908 default:
Takashi Iwaia6ed0602013-11-06 11:07:19 +01003909 WARN(1, "Unknown event %d\n", event);
Sudip Mukherjee75881df2015-09-10 18:01:44 +05303910 ret = -EINVAL;
Mark Brownc74184e2012-04-04 22:12:09 +01003911 }
3912
Mark Brown9747cec2012-04-26 19:12:21 +01003913out:
Nicolin Chen8053f212016-07-26 14:55:51 -07003914 kfree(runtime);
Mark Brown9747cec2012-04-26 19:12:21 +01003915 kfree(params);
3916 return ret;
Mark Brownc74184e2012-04-04 22:12:09 +01003917}
3918
Nikesh Oswalc6615082015-02-02 17:06:44 +00003919static int snd_soc_dapm_dai_link_get(struct snd_kcontrol *kcontrol,
3920 struct snd_ctl_elem_value *ucontrol)
3921{
3922 struct snd_soc_dapm_widget *w = snd_kcontrol_chip(kcontrol);
Charles Keepax243bcfa2018-09-05 15:21:02 +01003923 struct snd_soc_pcm_runtime *rtd = w->priv;
Nikesh Oswalc6615082015-02-02 17:06:44 +00003924
Charles Keepax243bcfa2018-09-05 15:21:02 +01003925 ucontrol->value.enumerated.item[0] = rtd->params_select;
Nikesh Oswalc6615082015-02-02 17:06:44 +00003926
3927 return 0;
3928}
3929
3930static int snd_soc_dapm_dai_link_put(struct snd_kcontrol *kcontrol,
3931 struct snd_ctl_elem_value *ucontrol)
3932{
3933 struct snd_soc_dapm_widget *w = snd_kcontrol_chip(kcontrol);
Charles Keepax243bcfa2018-09-05 15:21:02 +01003934 struct snd_soc_pcm_runtime *rtd = w->priv;
Nikesh Oswalc6615082015-02-02 17:06:44 +00003935
3936 /* Can't change the config when widget is already powered */
3937 if (w->power)
3938 return -EBUSY;
3939
Charles Keepax243bcfa2018-09-05 15:21:02 +01003940 if (ucontrol->value.enumerated.item[0] == rtd->params_select)
Nikesh Oswalc6615082015-02-02 17:06:44 +00003941 return 0;
3942
Charles Keepax243bcfa2018-09-05 15:21:02 +01003943 if (ucontrol->value.enumerated.item[0] >= rtd->dai_link->num_params)
Nikesh Oswalc6615082015-02-02 17:06:44 +00003944 return -EINVAL;
3945
Charles Keepax243bcfa2018-09-05 15:21:02 +01003946 rtd->params_select = ucontrol->value.enumerated.item[0];
Nikesh Oswalc6615082015-02-02 17:06:44 +00003947
3948 return 0;
3949}
3950
Arnd Bergmannc42c5ac2017-10-10 11:20:11 +02003951static void
anish kumar19ad6832017-09-28 21:52:39 -07003952snd_soc_dapm_free_kcontrol(struct snd_soc_card *card,
3953 unsigned long *private_value,
3954 int num_params,
3955 const char **w_param_text)
Mark Brownc74184e2012-04-04 22:12:09 +01003956{
anish kumar19ad6832017-09-28 21:52:39 -07003957 int count;
3958
3959 devm_kfree(card->dev, (void *)*private_value);
Pankaj Bharadiyacacea3a2019-03-22 18:00:09 +05303960
3961 if (!w_param_text)
3962 return;
3963
anish kumar19ad6832017-09-28 21:52:39 -07003964 for (count = 0 ; count < num_params; count++)
3965 devm_kfree(card->dev, (void *)w_param_text[count]);
3966 devm_kfree(card->dev, w_param_text);
3967}
3968
3969static struct snd_kcontrol_new *
3970snd_soc_dapm_alloc_kcontrol(struct snd_soc_card *card,
3971 char *link_name,
3972 const struct snd_soc_pcm_stream *params,
3973 int num_params, const char **w_param_text,
3974 unsigned long *private_value)
3975{
Nikesh Oswalc6615082015-02-02 17:06:44 +00003976 struct soc_enum w_param_enum[] = {
3977 SOC_ENUM_SINGLE(0, 0, 0, NULL),
3978 };
3979 struct snd_kcontrol_new kcontrol_dai_link[] = {
3980 SOC_ENUM_EXT(NULL, w_param_enum[0],
3981 snd_soc_dapm_dai_link_get,
3982 snd_soc_dapm_dai_link_put),
3983 };
anish kumar19ad6832017-09-28 21:52:39 -07003984 struct snd_kcontrol_new *kcontrol_news;
Nikesh Oswalc6615082015-02-02 17:06:44 +00003985 const struct snd_soc_pcm_stream *config = params;
anish kumar19ad6832017-09-28 21:52:39 -07003986 int count;
Mark Brownc74184e2012-04-04 22:12:09 +01003987
Nikesh Oswalc6615082015-02-02 17:06:44 +00003988 for (count = 0 ; count < num_params; count++) {
3989 if (!config->stream_name) {
3990 dev_warn(card->dapm.dev,
3991 "ASoC: anonymous config %d for dai link %s\n",
3992 count, link_name);
Nikesh Oswalc6615082015-02-02 17:06:44 +00003993 w_param_text[count] =
Charles Keepax46172b62015-03-25 11:22:35 +00003994 devm_kasprintf(card->dev, GFP_KERNEL,
3995 "Anonymous Configuration %d",
3996 count);
Nikesh Oswalc6615082015-02-02 17:06:44 +00003997 } else {
3998 w_param_text[count] = devm_kmemdup(card->dev,
3999 config->stream_name,
4000 strlen(config->stream_name) + 1,
4001 GFP_KERNEL);
Nikesh Oswalc6615082015-02-02 17:06:44 +00004002 }
anish kumar19ad6832017-09-28 21:52:39 -07004003 if (!w_param_text[count])
4004 goto outfree_w_param;
Nikesh Oswalc6615082015-02-02 17:06:44 +00004005 config++;
4006 }
anish kumar19ad6832017-09-28 21:52:39 -07004007
Nikesh Oswalc6615082015-02-02 17:06:44 +00004008 w_param_enum[0].items = num_params;
4009 w_param_enum[0].texts = w_param_text;
Mark Brownc74184e2012-04-04 22:12:09 +01004010
anish kumar19ad6832017-09-28 21:52:39 -07004011 *private_value =
4012 (unsigned long) devm_kmemdup(card->dev,
4013 (void *)(kcontrol_dai_link[0].private_value),
4014 sizeof(struct soc_enum), GFP_KERNEL);
4015 if (!*private_value) {
4016 dev_err(card->dev, "ASoC: Failed to create control for %s widget\n",
4017 link_name);
4018 goto outfree_w_param;
4019 }
4020 kcontrol_dai_link[0].private_value = *private_value;
4021 /* duplicate kcontrol_dai_link on heap so that memory persists */
4022 kcontrol_news = devm_kmemdup(card->dev, &kcontrol_dai_link[0],
4023 sizeof(struct snd_kcontrol_new),
4024 GFP_KERNEL);
4025 if (!kcontrol_news) {
4026 dev_err(card->dev, "ASoC: Failed to create control for %s widget\n",
4027 link_name);
4028 goto outfree_w_param;
4029 }
4030 return kcontrol_news;
4031
4032outfree_w_param:
4033 snd_soc_dapm_free_kcontrol(card, private_value, num_params, w_param_text);
4034 return NULL;
4035}
4036
Charles Keepax778ff5b2018-09-05 15:21:00 +01004037static struct snd_soc_dapm_widget *
4038snd_soc_dapm_new_dai(struct snd_soc_card *card, struct snd_soc_pcm_runtime *rtd,
4039 struct snd_soc_dapm_widget *source,
4040 struct snd_soc_dapm_widget *sink)
anish kumar19ad6832017-09-28 21:52:39 -07004041{
4042 struct snd_soc_dapm_widget template;
4043 struct snd_soc_dapm_widget *w;
4044 const char **w_param_text;
4045 unsigned long private_value;
4046 char *link_name;
4047 int ret;
4048
4049 link_name = devm_kasprintf(card->dev, GFP_KERNEL, "%s-%s",
4050 source->name, sink->name);
4051 if (!link_name)
Charles Keepax778ff5b2018-09-05 15:21:00 +01004052 return ERR_PTR(-ENOMEM);
anish kumar19ad6832017-09-28 21:52:39 -07004053
Mark Brownc74184e2012-04-04 22:12:09 +01004054 memset(&template, 0, sizeof(template));
4055 template.reg = SND_SOC_NOPM;
4056 template.id = snd_soc_dapm_dai_link;
4057 template.name = link_name;
4058 template.event = snd_soc_dai_link_event;
4059 template.event_flags = SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
4060 SND_SOC_DAPM_PRE_PMD;
anish kumar19ad6832017-09-28 21:52:39 -07004061 template.kcontrol_news = NULL;
Mark Brownc74184e2012-04-04 22:12:09 +01004062
anish kumar19ad6832017-09-28 21:52:39 -07004063 /* allocate memory for control, only in case of multiple configs */
Charles Keepax778ff5b2018-09-05 15:21:00 +01004064 if (rtd->dai_link->num_params > 1) {
4065 w_param_text = devm_kcalloc(card->dev,
4066 rtd->dai_link->num_params,
4067 sizeof(char *), GFP_KERNEL);
anish kumar19ad6832017-09-28 21:52:39 -07004068 if (!w_param_text) {
4069 ret = -ENOMEM;
4070 goto param_fail;
4071 }
4072
4073 template.num_kcontrols = 1;
4074 template.kcontrol_news =
4075 snd_soc_dapm_alloc_kcontrol(card,
Charles Keepax778ff5b2018-09-05 15:21:00 +01004076 link_name,
4077 rtd->dai_link->params,
4078 rtd->dai_link->num_params,
anish kumar19ad6832017-09-28 21:52:39 -07004079 w_param_text, &private_value);
4080 if (!template.kcontrol_news) {
4081 ret = -ENOMEM;
4082 goto param_fail;
4083 }
Arnd Bergmann667ebc92017-10-10 11:20:10 +02004084 } else {
4085 w_param_text = NULL;
anish kumar19ad6832017-09-28 21:52:39 -07004086 }
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00004087 dev_dbg(card->dev, "ASoC: adding %s widget\n", link_name);
Mark Brownc74184e2012-04-04 22:12:09 +01004088
Liam Girdwood02aa78a2015-05-25 18:21:17 +01004089 w = snd_soc_dapm_new_control_unlocked(&card->dapm, &template);
Dan Carpenter2e558a82018-09-07 22:40:33 +03004090 if (IS_ERR(w)) {
4091 ret = PTR_ERR(w);
Linus Walleij37e1df82017-01-13 10:23:52 +01004092 goto outfree_kcontrol_news;
Dan Carpenter2e558a82018-09-07 22:40:33 +03004093 }
Mark Brownc74184e2012-04-04 22:12:09 +01004094
Charles Keepax249dc492018-08-15 13:11:35 +01004095 w->priv = rtd;
Mark Brownc74184e2012-04-04 22:12:09 +01004096
Charles Keepax778ff5b2018-09-05 15:21:00 +01004097 return w;
Nikesh Oswalc6615082015-02-02 17:06:44 +00004098
Nikesh Oswalc6615082015-02-02 17:06:44 +00004099outfree_kcontrol_news:
4100 devm_kfree(card->dev, (void *)template.kcontrol_news);
Charles Keepax778ff5b2018-09-05 15:21:00 +01004101 snd_soc_dapm_free_kcontrol(card, &private_value,
4102 rtd->dai_link->num_params, w_param_text);
anish kumar19ad6832017-09-28 21:52:39 -07004103param_fail:
Nikesh Oswalc6615082015-02-02 17:06:44 +00004104 devm_kfree(card->dev, link_name);
Charles Keepax778ff5b2018-09-05 15:21:00 +01004105 return ERR_PTR(ret);
Mark Brownc74184e2012-04-04 22:12:09 +01004106}
4107
Mark Brown888df392012-02-16 19:37:51 -08004108int snd_soc_dapm_new_dai_widgets(struct snd_soc_dapm_context *dapm,
4109 struct snd_soc_dai *dai)
Richard Purdie2b97eab2006-10-06 18:32:18 +02004110{
Mark Brown888df392012-02-16 19:37:51 -08004111 struct snd_soc_dapm_widget template;
Richard Purdie2b97eab2006-10-06 18:32:18 +02004112 struct snd_soc_dapm_widget *w;
4113
Mark Brown888df392012-02-16 19:37:51 -08004114 WARN_ON(dapm->dev != dai->dev);
4115
4116 memset(&template, 0, sizeof(template));
4117 template.reg = SND_SOC_NOPM;
4118
4119 if (dai->driver->playback.stream_name) {
Mark Brown46162742013-06-05 19:36:11 +01004120 template.id = snd_soc_dapm_dai_in;
Mark Brown888df392012-02-16 19:37:51 -08004121 template.name = dai->driver->playback.stream_name;
4122 template.sname = dai->driver->playback.stream_name;
4123
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00004124 dev_dbg(dai->dev, "ASoC: adding %s widget\n",
Mark Brown888df392012-02-16 19:37:51 -08004125 template.name);
4126
Liam Girdwood02aa78a2015-05-25 18:21:17 +01004127 w = snd_soc_dapm_new_control_unlocked(dapm, &template);
Charles Keepax3bbf5d32018-09-05 15:20:58 +01004128 if (IS_ERR(w))
4129 return PTR_ERR(w);
Mark Brown888df392012-02-16 19:37:51 -08004130
4131 w->priv = dai;
4132 dai->playback_widget = w;
4133 }
4134
4135 if (dai->driver->capture.stream_name) {
Mark Brown46162742013-06-05 19:36:11 +01004136 template.id = snd_soc_dapm_dai_out;
Mark Brown888df392012-02-16 19:37:51 -08004137 template.name = dai->driver->capture.stream_name;
4138 template.sname = dai->driver->capture.stream_name;
4139
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00004140 dev_dbg(dai->dev, "ASoC: adding %s widget\n",
Mark Brown888df392012-02-16 19:37:51 -08004141 template.name);
4142
Liam Girdwood02aa78a2015-05-25 18:21:17 +01004143 w = snd_soc_dapm_new_control_unlocked(dapm, &template);
Charles Keepax3bbf5d32018-09-05 15:20:58 +01004144 if (IS_ERR(w))
4145 return PTR_ERR(w);
Mark Brown888df392012-02-16 19:37:51 -08004146
4147 w->priv = dai;
4148 dai->capture_widget = w;
4149 }
4150
4151 return 0;
4152}
4153
4154int snd_soc_dapm_link_dai_widgets(struct snd_soc_card *card)
4155{
4156 struct snd_soc_dapm_widget *dai_w, *w;
Lars-Peter Clausen0f9bd7b2014-05-07 16:20:28 +02004157 struct snd_soc_dapm_widget *src, *sink;
Mark Brown888df392012-02-16 19:37:51 -08004158 struct snd_soc_dai *dai;
Mark Brown888df392012-02-16 19:37:51 -08004159
4160 /* For each DAI widget... */
4161 list_for_each_entry(dai_w, &card->widgets, list) {
Mark Brown46162742013-06-05 19:36:11 +01004162 switch (dai_w->id) {
4163 case snd_soc_dapm_dai_in:
4164 case snd_soc_dapm_dai_out:
4165 break;
4166 default:
Richard Purdie2b97eab2006-10-06 18:32:18 +02004167 continue;
Mark Brown46162742013-06-05 19:36:11 +01004168 }
Mark Brown888df392012-02-16 19:37:51 -08004169
Liam Girdwoode01b4f62018-06-14 20:26:42 +01004170 /* let users know there is no DAI to link */
4171 if (!dai_w->priv) {
4172 dev_dbg(card->dev, "dai widget %s has no DAI\n",
4173 dai_w->name);
4174 continue;
4175 }
4176
Mark Brown888df392012-02-16 19:37:51 -08004177 dai = dai_w->priv;
4178
4179 /* ...find all widgets with the same stream and link them */
4180 list_for_each_entry(w, &card->widgets, list) {
4181 if (w->dapm != dai_w->dapm)
4182 continue;
4183
Mark Brown46162742013-06-05 19:36:11 +01004184 switch (w->id) {
4185 case snd_soc_dapm_dai_in:
4186 case snd_soc_dapm_dai_out:
Mark Brown888df392012-02-16 19:37:51 -08004187 continue;
Mark Brown46162742013-06-05 19:36:11 +01004188 default:
4189 break;
4190 }
Mark Brown888df392012-02-16 19:37:51 -08004191
Lars-Peter Clausena798c242015-07-21 11:51:35 +02004192 if (!w->sname || !strstr(w->sname, dai_w->sname))
Mark Brown888df392012-02-16 19:37:51 -08004193 continue;
4194
Lars-Peter Clausen0f9bd7b2014-05-07 16:20:28 +02004195 if (dai_w->id == snd_soc_dapm_dai_in) {
4196 src = dai_w;
4197 sink = w;
4198 } else {
4199 src = w;
4200 sink = dai_w;
Mark Brown888df392012-02-16 19:37:51 -08004201 }
Lars-Peter Clausen0f9bd7b2014-05-07 16:20:28 +02004202 dev_dbg(dai->dev, "%s -> %s\n", src->name, sink->name);
4203 snd_soc_dapm_add_path(w->dapm, src, sink, NULL, NULL);
Richard Purdie2b97eab2006-10-06 18:32:18 +02004204 }
4205 }
Richard Purdie2b97eab2006-10-06 18:32:18 +02004206
Mark Brown888df392012-02-16 19:37:51 -08004207 return 0;
4208}
Liam Girdwood64a648c2011-07-25 11:15:15 +01004209
Benoit Cousson44ba2642014-07-08 23:19:36 +02004210static void dapm_connect_dai_link_widgets(struct snd_soc_card *card,
4211 struct snd_soc_pcm_runtime *rtd)
Liam Girdwoodb893ea52014-01-08 10:40:19 +00004212{
Benoit Cousson44ba2642014-07-08 23:19:36 +02004213 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
Kuninori Morimoto0b7990e2018-09-03 02:12:56 +00004214 struct snd_soc_dai *codec_dai;
Charles Keepax778ff5b2018-09-05 15:21:00 +01004215 struct snd_soc_dapm_widget *playback = NULL, *capture = NULL;
4216 struct snd_soc_dapm_widget *codec, *playback_cpu, *capture_cpu;
Liam Girdwoodb893ea52014-01-08 10:40:19 +00004217 int i;
4218
Charles Keepax778ff5b2018-09-05 15:21:00 +01004219 if (rtd->dai_link->params) {
Charles Keepax778ff5b2018-09-05 15:21:00 +01004220 playback_cpu = cpu_dai->capture_widget;
4221 capture_cpu = cpu_dai->playback_widget;
4222 } else {
4223 playback = cpu_dai->playback_widget;
4224 capture = cpu_dai->capture_widget;
4225 playback_cpu = playback;
4226 capture_cpu = capture;
4227 }
4228
Kuninori Morimoto0b7990e2018-09-03 02:12:56 +00004229 for_each_rtd_codec_dai(rtd, i, codec_dai) {
Liam Girdwoodb893ea52014-01-08 10:40:19 +00004230
Liam Girdwoodb893ea52014-01-08 10:40:19 +00004231 /* connect BE DAI playback if widgets are valid */
Charles Keepax778ff5b2018-09-05 15:21:00 +01004232 codec = codec_dai->playback_widget;
Liam Girdwoodb893ea52014-01-08 10:40:19 +00004233
Charles Keepax778ff5b2018-09-05 15:21:00 +01004234 if (playback_cpu && codec) {
4235 if (!playback) {
4236 playback = snd_soc_dapm_new_dai(card, rtd,
4237 playback_cpu,
4238 codec);
Charles Keepaxe36a1d02018-09-10 15:28:39 +01004239 if (IS_ERR(playback)) {
4240 dev_err(rtd->dev,
4241 "ASoC: Failed to create DAI %s: %ld\n",
4242 codec_dai->name,
4243 PTR_ERR(playback));
4244 continue;
4245 }
Charles Keepax778ff5b2018-09-05 15:21:00 +01004246
4247 snd_soc_dapm_add_path(&card->dapm, playback_cpu,
4248 playback, NULL, NULL);
4249 }
4250
4251 dev_dbg(rtd->dev, "connected DAI link %s:%s -> %s:%s\n",
4252 cpu_dai->component->name, playback_cpu->name,
4253 codec_dai->component->name, codec->name);
4254
4255 snd_soc_dapm_add_path(&card->dapm, playback, codec,
4256 NULL, NULL);
Liam Girdwoodb893ea52014-01-08 10:40:19 +00004257 }
Charles Keepaxe36a1d02018-09-10 15:28:39 +01004258 }
Liam Girdwoodb893ea52014-01-08 10:40:19 +00004259
Charles Keepaxe36a1d02018-09-10 15:28:39 +01004260 for_each_rtd_codec_dai(rtd, i, codec_dai) {
Liam Girdwoodb893ea52014-01-08 10:40:19 +00004261 /* connect BE DAI capture if widgets are valid */
Charles Keepax778ff5b2018-09-05 15:21:00 +01004262 codec = codec_dai->capture_widget;
Liam Girdwoodb893ea52014-01-08 10:40:19 +00004263
Charles Keepax778ff5b2018-09-05 15:21:00 +01004264 if (codec && capture_cpu) {
4265 if (!capture) {
4266 capture = snd_soc_dapm_new_dai(card, rtd,
4267 codec,
4268 capture_cpu);
Charles Keepaxe36a1d02018-09-10 15:28:39 +01004269 if (IS_ERR(capture)) {
4270 dev_err(rtd->dev,
4271 "ASoC: Failed to create DAI %s: %ld\n",
4272 codec_dai->name,
4273 PTR_ERR(capture));
4274 continue;
4275 }
Charles Keepax778ff5b2018-09-05 15:21:00 +01004276
4277 snd_soc_dapm_add_path(&card->dapm, capture,
4278 capture_cpu, NULL, NULL);
4279 }
4280
4281 dev_dbg(rtd->dev, "connected DAI link %s:%s -> %s:%s\n",
4282 codec_dai->component->name, codec->name,
4283 cpu_dai->component->name, capture_cpu->name);
4284
4285 snd_soc_dapm_add_path(&card->dapm, codec, capture,
4286 NULL, NULL);
Liam Girdwoodb893ea52014-01-08 10:40:19 +00004287 }
Liam Girdwoodb893ea52014-01-08 10:40:19 +00004288 }
4289}
Liam Girdwoodb893ea52014-01-08 10:40:19 +00004290
Lars-Peter Clausenc471fdd2014-04-29 14:51:22 +02004291static void soc_dapm_dai_stream_event(struct snd_soc_dai *dai, int stream,
4292 int event)
4293{
4294 struct snd_soc_dapm_widget *w;
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02004295 unsigned int ep;
Lars-Peter Clausenc471fdd2014-04-29 14:51:22 +02004296
4297 if (stream == SNDRV_PCM_STREAM_PLAYBACK)
4298 w = dai->playback_widget;
4299 else
4300 w = dai->capture_widget;
4301
4302 if (w) {
4303 dapm_mark_dirty(w, "stream event");
4304
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02004305 if (w->id == snd_soc_dapm_dai_in) {
4306 ep = SND_SOC_DAPM_EP_SOURCE;
4307 dapm_widget_invalidate_input_paths(w);
4308 } else {
4309 ep = SND_SOC_DAPM_EP_SINK;
4310 dapm_widget_invalidate_output_paths(w);
4311 }
4312
Lars-Peter Clausenc471fdd2014-04-29 14:51:22 +02004313 switch (event) {
4314 case SND_SOC_DAPM_STREAM_START:
4315 w->active = 1;
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02004316 w->is_ep = ep;
Lars-Peter Clausenc471fdd2014-04-29 14:51:22 +02004317 break;
4318 case SND_SOC_DAPM_STREAM_STOP:
4319 w->active = 0;
Lars-Peter Clausena3423b02015-08-11 21:38:00 +02004320 w->is_ep = 0;
Lars-Peter Clausenc471fdd2014-04-29 14:51:22 +02004321 break;
4322 case SND_SOC_DAPM_STREAM_SUSPEND:
4323 case SND_SOC_DAPM_STREAM_RESUME:
4324 case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
4325 case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
4326 break;
4327 }
Liam Girdwoodb893ea52014-01-08 10:40:19 +00004328 }
4329}
4330
Benoit Cousson44ba2642014-07-08 23:19:36 +02004331void snd_soc_dapm_connect_dai_link_widgets(struct snd_soc_card *card)
4332{
Mengdong Lin1a497982015-11-18 02:34:11 -05004333 struct snd_soc_pcm_runtime *rtd;
Benoit Cousson44ba2642014-07-08 23:19:36 +02004334
4335 /* for each BE DAI link... */
Kuninori Morimotobcb1fd12018-09-18 01:29:35 +00004336 for_each_card_rtds(card, rtd) {
Benoit Cousson44ba2642014-07-08 23:19:36 +02004337 /*
4338 * dynamic FE links have no fixed DAI mapping.
4339 * CODEC<->CODEC links have no direct connection.
4340 */
Charles Keepax778ff5b2018-09-05 15:21:00 +01004341 if (rtd->dai_link->dynamic)
Benoit Cousson44ba2642014-07-08 23:19:36 +02004342 continue;
4343
4344 dapm_connect_dai_link_widgets(card, rtd);
4345 }
4346}
4347
Liam Girdwoodd9b09512012-03-07 16:32:59 +00004348static void soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream,
4349 int event)
Richard Purdie2b97eab2006-10-06 18:32:18 +02004350{
Kuninori Morimoto0b7990e2018-09-03 02:12:56 +00004351 struct snd_soc_dai *codec_dai;
Benoit Cousson44ba2642014-07-08 23:19:36 +02004352 int i;
4353
Lars-Peter Clausenc471fdd2014-04-29 14:51:22 +02004354 soc_dapm_dai_stream_event(rtd->cpu_dai, stream, event);
Kuninori Morimoto0b7990e2018-09-03 02:12:56 +00004355 for_each_rtd_codec_dai(rtd, i, codec_dai)
4356 soc_dapm_dai_stream_event(codec_dai, stream, event);
Liam Girdwoodd9b09512012-03-07 16:32:59 +00004357
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02004358 dapm_power_widgets(rtd->card, event);
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004359}
4360
4361/**
4362 * snd_soc_dapm_stream_event - send a stream event to the dapm core
4363 * @rtd: PCM runtime data
4364 * @stream: stream name
4365 * @event: stream event
4366 *
4367 * Sends a stream event to the dapm core. The core then makes any
4368 * necessary widget power changes.
4369 *
4370 * Returns 0 for success else error.
4371 */
Liam Girdwoodd9b09512012-03-07 16:32:59 +00004372void snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream,
4373 int event)
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004374{
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00004375 struct snd_soc_card *card = rtd->card;
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004376
Liam Girdwood3cd04342012-03-09 12:02:08 +00004377 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
Liam Girdwoodd9b09512012-03-07 16:32:59 +00004378 soc_dapm_stream_event(rtd, stream, event);
Liam Girdwooda73fb2d2012-03-07 10:38:26 +00004379 mutex_unlock(&card->dapm_mutex);
Richard Purdie2b97eab2006-10-06 18:32:18 +02004380}
Richard Purdie2b97eab2006-10-06 18:32:18 +02004381
4382/**
Charles Keepax11391102014-02-18 15:22:14 +00004383 * snd_soc_dapm_enable_pin_unlocked - enable pin.
4384 * @dapm: DAPM context
4385 * @pin: pin name
4386 *
4387 * Enables input/output pin and its parents or children widgets iff there is
4388 * a valid audio route and active audio stream.
4389 *
4390 * Requires external locking.
4391 *
4392 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
4393 * do any widget power switching.
4394 */
4395int snd_soc_dapm_enable_pin_unlocked(struct snd_soc_dapm_context *dapm,
4396 const char *pin)
4397{
4398 return snd_soc_dapm_set_pin(dapm, pin, 1);
4399}
4400EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin_unlocked);
4401
4402/**
Liam Girdwooda5302182008-07-07 13:35:17 +01004403 * snd_soc_dapm_enable_pin - enable pin.
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004404 * @dapm: DAPM context
Liam Girdwooda5302182008-07-07 13:35:17 +01004405 * @pin: pin name
Richard Purdie2b97eab2006-10-06 18:32:18 +02004406 *
Mark Brown74b8f952009-06-06 11:26:15 +01004407 * Enables input/output pin and its parents or children widgets iff there is
Liam Girdwooda5302182008-07-07 13:35:17 +01004408 * a valid audio route and active audio stream.
Charles Keepax11391102014-02-18 15:22:14 +00004409 *
Liam Girdwooda5302182008-07-07 13:35:17 +01004410 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
4411 * do any widget power switching.
Richard Purdie2b97eab2006-10-06 18:32:18 +02004412 */
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004413int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin)
Richard Purdie2b97eab2006-10-06 18:32:18 +02004414{
Charles Keepax11391102014-02-18 15:22:14 +00004415 int ret;
4416
4417 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
4418
4419 ret = snd_soc_dapm_set_pin(dapm, pin, 1);
4420
4421 mutex_unlock(&dapm->card->dapm_mutex);
4422
4423 return ret;
Richard Purdie2b97eab2006-10-06 18:32:18 +02004424}
Liam Girdwooda5302182008-07-07 13:35:17 +01004425EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
Richard Purdie2b97eab2006-10-06 18:32:18 +02004426
4427/**
Charles Keepax11391102014-02-18 15:22:14 +00004428 * snd_soc_dapm_force_enable_pin_unlocked - force a pin to be enabled
4429 * @dapm: DAPM context
4430 * @pin: pin name
4431 *
4432 * Enables input/output pin regardless of any other state. This is
4433 * intended for use with microphone bias supplies used in microphone
4434 * jack detection.
4435 *
4436 * Requires external locking.
4437 *
4438 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
4439 * do any widget power switching.
4440 */
4441int snd_soc_dapm_force_enable_pin_unlocked(struct snd_soc_dapm_context *dapm,
4442 const char *pin)
4443{
4444 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
4445
4446 if (!w) {
4447 dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin);
4448 return -EINVAL;
4449 }
4450
4451 dev_dbg(w->dapm->dev, "ASoC: force enable pin %s\n", pin);
Lars-Peter Clausen92a99ea2014-10-25 17:42:03 +02004452 if (!w->connected) {
4453 /*
4454 * w->force does not affect the number of input or output paths,
4455 * so we only have to recheck if w->connected is changed
4456 */
4457 dapm_widget_invalidate_input_paths(w);
4458 dapm_widget_invalidate_output_paths(w);
4459 w->connected = 1;
4460 }
Charles Keepax11391102014-02-18 15:22:14 +00004461 w->force = 1;
4462 dapm_mark_dirty(w, "force enable");
4463
4464 return 0;
4465}
4466EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin_unlocked);
4467
4468/**
Mark Brownda341832010-03-15 19:23:37 +00004469 * snd_soc_dapm_force_enable_pin - force a pin to be enabled
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004470 * @dapm: DAPM context
Mark Brownda341832010-03-15 19:23:37 +00004471 * @pin: pin name
4472 *
4473 * Enables input/output pin regardless of any other state. This is
4474 * intended for use with microphone bias supplies used in microphone
4475 * jack detection.
4476 *
4477 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
4478 * do any widget power switching.
4479 */
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004480int snd_soc_dapm_force_enable_pin(struct snd_soc_dapm_context *dapm,
4481 const char *pin)
Mark Brownda341832010-03-15 19:23:37 +00004482{
Charles Keepax11391102014-02-18 15:22:14 +00004483 int ret;
Mark Brownda341832010-03-15 19:23:37 +00004484
Charles Keepax11391102014-02-18 15:22:14 +00004485 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
Mark Brownda341832010-03-15 19:23:37 +00004486
Charles Keepax11391102014-02-18 15:22:14 +00004487 ret = snd_soc_dapm_force_enable_pin_unlocked(dapm, pin);
Mark Brown0d867332011-04-06 11:38:14 +09004488
Charles Keepax11391102014-02-18 15:22:14 +00004489 mutex_unlock(&dapm->card->dapm_mutex);
4490
4491 return ret;
Mark Brownda341832010-03-15 19:23:37 +00004492}
4493EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin);
4494
4495/**
Charles Keepax11391102014-02-18 15:22:14 +00004496 * snd_soc_dapm_disable_pin_unlocked - disable pin.
4497 * @dapm: DAPM context
4498 * @pin: pin name
4499 *
4500 * Disables input/output pin and its parents or children widgets.
4501 *
4502 * Requires external locking.
4503 *
4504 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
4505 * do any widget power switching.
4506 */
4507int snd_soc_dapm_disable_pin_unlocked(struct snd_soc_dapm_context *dapm,
4508 const char *pin)
4509{
4510 return snd_soc_dapm_set_pin(dapm, pin, 0);
4511}
4512EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin_unlocked);
4513
4514/**
Liam Girdwooda5302182008-07-07 13:35:17 +01004515 * snd_soc_dapm_disable_pin - disable pin.
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004516 * @dapm: DAPM context
Liam Girdwooda5302182008-07-07 13:35:17 +01004517 * @pin: pin name
Graeme Gregoryeeec12b2008-04-30 19:27:40 +02004518 *
Mark Brown74b8f952009-06-06 11:26:15 +01004519 * Disables input/output pin and its parents or children widgets.
Charles Keepax11391102014-02-18 15:22:14 +00004520 *
Liam Girdwooda5302182008-07-07 13:35:17 +01004521 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
4522 * do any widget power switching.
Graeme Gregoryeeec12b2008-04-30 19:27:40 +02004523 */
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004524int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm,
4525 const char *pin)
Liam Girdwooda5302182008-07-07 13:35:17 +01004526{
Charles Keepax11391102014-02-18 15:22:14 +00004527 int ret;
4528
4529 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
4530
4531 ret = snd_soc_dapm_set_pin(dapm, pin, 0);
4532
4533 mutex_unlock(&dapm->card->dapm_mutex);
4534
4535 return ret;
Liam Girdwooda5302182008-07-07 13:35:17 +01004536}
4537EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
4538
4539/**
Charles Keepax11391102014-02-18 15:22:14 +00004540 * snd_soc_dapm_nc_pin_unlocked - permanently disable pin.
4541 * @dapm: DAPM context
4542 * @pin: pin name
4543 *
4544 * Marks the specified pin as being not connected, disabling it along
4545 * any parent or child widgets. At present this is identical to
4546 * snd_soc_dapm_disable_pin() but in future it will be extended to do
4547 * additional things such as disabling controls which only affect
4548 * paths through the pin.
4549 *
4550 * Requires external locking.
4551 *
4552 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
4553 * do any widget power switching.
4554 */
4555int snd_soc_dapm_nc_pin_unlocked(struct snd_soc_dapm_context *dapm,
4556 const char *pin)
4557{
4558 return snd_soc_dapm_set_pin(dapm, pin, 0);
4559}
4560EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin_unlocked);
4561
4562/**
Mark Brown5817b522008-09-24 11:23:11 +01004563 * snd_soc_dapm_nc_pin - permanently disable pin.
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004564 * @dapm: DAPM context
Mark Brown5817b522008-09-24 11:23:11 +01004565 * @pin: pin name
4566 *
4567 * Marks the specified pin as being not connected, disabling it along
4568 * any parent or child widgets. At present this is identical to
4569 * snd_soc_dapm_disable_pin() but in future it will be extended to do
4570 * additional things such as disabling controls which only affect
4571 * paths through the pin.
4572 *
4573 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
4574 * do any widget power switching.
4575 */
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004576int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin)
Mark Brown5817b522008-09-24 11:23:11 +01004577{
Charles Keepax11391102014-02-18 15:22:14 +00004578 int ret;
4579
4580 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
4581
4582 ret = snd_soc_dapm_set_pin(dapm, pin, 0);
4583
4584 mutex_unlock(&dapm->card->dapm_mutex);
4585
4586 return ret;
Mark Brown5817b522008-09-24 11:23:11 +01004587}
4588EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);
4589
4590/**
Liam Girdwooda5302182008-07-07 13:35:17 +01004591 * snd_soc_dapm_get_pin_status - get audio pin status
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004592 * @dapm: DAPM context
Liam Girdwooda5302182008-07-07 13:35:17 +01004593 * @pin: audio signal pin endpoint (or start point)
4594 *
4595 * Get audio pin status - connected or disconnected.
4596 *
4597 * Returns 1 for connected otherwise 0.
4598 */
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004599int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm,
4600 const char *pin)
Graeme Gregoryeeec12b2008-04-30 19:27:40 +02004601{
Lars-Peter Clausen91a5fca2011-04-27 18:34:31 +02004602 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
Graeme Gregoryeeec12b2008-04-30 19:27:40 +02004603
Lars-Peter Clausen91a5fca2011-04-27 18:34:31 +02004604 if (w)
4605 return w->connected;
Stephen Warrena68b38a2011-04-19 15:25:11 -06004606
Graeme Gregoryeeec12b2008-04-30 19:27:40 +02004607 return 0;
4608}
Liam Girdwooda5302182008-07-07 13:35:17 +01004609EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
Graeme Gregoryeeec12b2008-04-30 19:27:40 +02004610
4611/**
Mark Brown1547aba2010-05-07 21:11:40 +01004612 * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004613 * @dapm: DAPM context
Mark Brown1547aba2010-05-07 21:11:40 +01004614 * @pin: audio signal pin endpoint (or start point)
4615 *
4616 * Mark the given endpoint or pin as ignoring suspend. When the
4617 * system is disabled a path between two endpoints flagged as ignoring
4618 * suspend will not be disabled. The path must already be enabled via
4619 * normal means at suspend time, it will not be turned on if it was not
4620 * already enabled.
4621 */
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004622int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm,
4623 const char *pin)
Mark Brown1547aba2010-05-07 21:11:40 +01004624{
Lars-Peter Clausen91a5fca2011-04-27 18:34:31 +02004625 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, false);
Mark Brown1547aba2010-05-07 21:11:40 +01004626
Lars-Peter Clausen91a5fca2011-04-27 18:34:31 +02004627 if (!w) {
Liam Girdwood30a6a1a2012-11-19 14:39:12 +00004628 dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin);
Lars-Peter Clausen91a5fca2011-04-27 18:34:31 +02004629 return -EINVAL;
Mark Brown1547aba2010-05-07 21:11:40 +01004630 }
4631
Lars-Peter Clausen91a5fca2011-04-27 18:34:31 +02004632 w->ignore_suspend = 1;
4633
4634 return 0;
Mark Brown1547aba2010-05-07 21:11:40 +01004635}
4636EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend);
4637
Lars-Peter Clausencdc45082014-10-20 19:36:33 +02004638/**
Richard Purdie2b97eab2006-10-06 18:32:18 +02004639 * snd_soc_dapm_free - free dapm resources
Peter Ujfalusi728a5222011-08-26 16:33:52 +03004640 * @dapm: DAPM context
Richard Purdie2b97eab2006-10-06 18:32:18 +02004641 *
4642 * Free all dapm widgets and resources.
4643 */
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004644void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm)
Richard Purdie2b97eab2006-10-06 18:32:18 +02004645{
Lars-Peter Clausen6c45e122011-04-30 19:45:50 +02004646 dapm_debugfs_cleanup(dapm);
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004647 dapm_free_widgets(dapm);
Jarkko Nikula7be31be82010-12-14 12:18:32 +02004648 list_del(&dapm->list);
Richard Purdie2b97eab2006-10-06 18:32:18 +02004649}
4650EXPORT_SYMBOL_GPL(snd_soc_dapm_free);
4651
Xiang Xiao57996352014-03-02 00:04:02 +08004652static void soc_dapm_shutdown_dapm(struct snd_soc_dapm_context *dapm)
Mark Brown51737472009-06-22 13:16:51 +01004653{
Liam Girdwood01005a72012-07-06 16:57:05 +01004654 struct snd_soc_card *card = dapm->card;
Mark Brown51737472009-06-22 13:16:51 +01004655 struct snd_soc_dapm_widget *w;
4656 LIST_HEAD(down_list);
4657 int powerdown = 0;
4658
Liam Girdwood01005a72012-07-06 16:57:05 +01004659 mutex_lock(&card->dapm_mutex);
4660
Jarkko Nikula97c866d2010-12-14 12:18:31 +02004661 list_for_each_entry(w, &dapm->card->widgets, list) {
4662 if (w->dapm != dapm)
4663 continue;
Mark Brown51737472009-06-22 13:16:51 +01004664 if (w->power) {
Mark Brown828a8422011-01-15 13:14:30 +00004665 dapm_seq_insert(w, &down_list, false);
Mark Brownc2caa4d2009-06-26 15:36:56 +01004666 w->power = 0;
Mark Brown51737472009-06-22 13:16:51 +01004667 powerdown = 1;
4668 }
4669 }
4670
4671 /* If there were no widgets to power down we're already in
4672 * standby.
4673 */
4674 if (powerdown) {
Mark Brown7679e422012-02-22 15:52:56 +00004675 if (dapm->bias_level == SND_SOC_BIAS_ON)
4676 snd_soc_dapm_set_bias_level(dapm,
4677 SND_SOC_BIAS_PREPARE);
Lars-Peter Clausen95dd5cd2013-07-29 17:13:56 +02004678 dapm_seq_run(card, &down_list, 0, false);
Mark Brown7679e422012-02-22 15:52:56 +00004679 if (dapm->bias_level == SND_SOC_BIAS_PREPARE)
4680 snd_soc_dapm_set_bias_level(dapm,
4681 SND_SOC_BIAS_STANDBY);
Mark Brown51737472009-06-22 13:16:51 +01004682 }
Liam Girdwood01005a72012-07-06 16:57:05 +01004683
4684 mutex_unlock(&card->dapm_mutex);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00004685}
Mark Brown51737472009-06-22 13:16:51 +01004686
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00004687/*
4688 * snd_soc_dapm_shutdown - callback for system shutdown
4689 */
4690void snd_soc_dapm_shutdown(struct snd_soc_card *card)
4691{
Xiang Xiao57996352014-03-02 00:04:02 +08004692 struct snd_soc_dapm_context *dapm;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00004693
Xiang Xiao57996352014-03-02 00:04:02 +08004694 list_for_each_entry(dapm, &card->dapm_list, list) {
Xiang Xiao17282ba2014-03-02 00:04:03 +08004695 if (dapm != &card->dapm) {
4696 soc_dapm_shutdown_dapm(dapm);
4697 if (dapm->bias_level == SND_SOC_BIAS_STANDBY)
4698 snd_soc_dapm_set_bias_level(dapm,
4699 SND_SOC_BIAS_OFF);
4700 }
Liam Girdwoodce6120c2010-11-05 15:53:46 +02004701 }
Xiang Xiao17282ba2014-03-02 00:04:03 +08004702
4703 soc_dapm_shutdown_dapm(&card->dapm);
4704 if (card->dapm.bias_level == SND_SOC_BIAS_STANDBY)
4705 snd_soc_dapm_set_bias_level(&card->dapm,
4706 SND_SOC_BIAS_OFF);
Mark Brown51737472009-06-22 13:16:51 +01004707}
4708
Richard Purdie2b97eab2006-10-06 18:32:18 +02004709/* Module information */
Liam Girdwoodd3311242008-10-12 13:17:36 +01004710MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
Richard Purdie2b97eab2006-10-06 18:32:18 +02004711MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
4712MODULE_LICENSE("GPL");