Blame view

sound/soc/soc-dapm.c 75.7 KB
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1
2
3
4
  /*
   * soc-dapm.c  --  ALSA SoC Dynamic Audio Power Management
   *
   * Copyright 2005 Wolfson Microelectronics PLC.
d331124dc   Liam Girdwood   ALSA: ASoC: updat...
5
   * Author: Liam Girdwood <lrg@slimlogic.co.uk>
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
6
7
8
9
10
11
   *
   *  This program is free software; you can redistribute  it and/or modify it
   *  under  the terms of  the GNU General  Public License as published by the
   *  Free Software Foundation;  either version 2 of the  License, or (at your
   *  option) any later version.
   *
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
12
13
14
   *  Features:
   *    o Changes power status of internal codec blocks depending on the
   *      dynamic configuration of codec internal audio paths and active
74b8f955a   Mark Brown   ASoC: Apostrophe ...
15
   *      DACs/ADCs.
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
16
17
18
19
20
   *    o Platform power domain - can support external components i.e. amps and
   *      mic/meadphone insertion events.
   *    o Automatic Mic Bias support
   *    o Jack insertion power event initiation - e.g. hp insertion will enable
   *      sinks, dacs, etc
3a4fa0a25   Robert P. J. Day   Fix misspellings ...
21
   *    o Delayed powerdown of audio susbsystem to reduce pops between a quick
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
22
23
24
25
26
27
28
29
30
31
32
33
34
   *      device reopen.
   *
   *  Todo:
   *    o DAPM power change sequencing - allow for configurable per
   *      codec sequences.
   *    o Support for analogue bias optimisation.
   *    o Support for reduced codec oversampling rates.
   *    o Support for reduced codec bias currents.
   */
  
  #include <linux/module.h>
  #include <linux/moduleparam.h>
  #include <linux/init.h>
9d0624a74   Mark Brown   ASoC: Run bias le...
35
  #include <linux/async.h>
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
36
37
38
39
40
  #include <linux/delay.h>
  #include <linux/pm.h>
  #include <linux/bitops.h>
  #include <linux/platform_device.h>
  #include <linux/jiffies.h>
20496ff37   Takashi Iwai   ASoC: add missing...
41
  #include <linux/debugfs.h>
f1aac484f   Mark Brown   ASoC: Take a pm_r...
42
  #include <linux/pm_runtime.h>
5a0e3ad6a   Tejun Heo   include cleanup: ...
43
  #include <linux/slab.h>
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
44
45
46
  #include <sound/core.h>
  #include <sound/pcm.h>
  #include <sound/pcm_params.h>
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
47
  #include <sound/soc.h>
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
48
  #include <sound/initval.h>
84e909303   Mark Brown   ASoC: Add DAPM tr...
49
  #include <trace/events/asoc.h>
de02d0786   Mark Brown   ASoC: Trace and c...
50
  #define DAPM_UPDATE_STAT(widget, val) widget->dapm->card->dapm_stats.val++;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
51
52
  /* dapm power sequences - make this per codec in the future */
  static int dapm_up_seq[] = {
38357ab2c   Mark Brown   ASoC: Sort DAPM p...
53
54
55
  	[snd_soc_dapm_pre] = 0,
  	[snd_soc_dapm_supply] = 1,
  	[snd_soc_dapm_micbias] = 2,
010ff2622   Mark Brown   ASoC: Add input a...
56
57
58
59
  	[snd_soc_dapm_aif_in] = 3,
  	[snd_soc_dapm_aif_out] = 3,
  	[snd_soc_dapm_mic] = 4,
  	[snd_soc_dapm_mux] = 5,
24ff33ac6   Dimitris Papastamos   ASoC: soc-dapm: I...
60
  	[snd_soc_dapm_virt_mux] = 5,
010ff2622   Mark Brown   ASoC: Add input a...
61
62
63
64
65
66
  	[snd_soc_dapm_value_mux] = 5,
  	[snd_soc_dapm_dac] = 6,
  	[snd_soc_dapm_mixer] = 7,
  	[snd_soc_dapm_mixer_named_ctl] = 7,
  	[snd_soc_dapm_pga] = 8,
  	[snd_soc_dapm_adc] = 9,
d88429a69   Olaya, Margarita   ASoC: dapm: Add o...
67
  	[snd_soc_dapm_out_drv] = 10,
010ff2622   Mark Brown   ASoC: Add input a...
68
69
70
  	[snd_soc_dapm_hp] = 10,
  	[snd_soc_dapm_spk] = 10,
  	[snd_soc_dapm_post] = 11,
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
71
  };
ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
72

2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
73
  static int dapm_down_seq[] = {
38357ab2c   Mark Brown   ASoC: Sort DAPM p...
74
75
76
  	[snd_soc_dapm_pre] = 0,
  	[snd_soc_dapm_adc] = 1,
  	[snd_soc_dapm_hp] = 2,
1ca04065c   Mark Brown   ASoC: Power speak...
77
  	[snd_soc_dapm_spk] = 2,
d88429a69   Olaya, Margarita   ASoC: dapm: Add o...
78
  	[snd_soc_dapm_out_drv] = 2,
38357ab2c   Mark Brown   ASoC: Sort DAPM p...
79
80
  	[snd_soc_dapm_pga] = 4,
  	[snd_soc_dapm_mixer_named_ctl] = 5,
e3d4dabd2   Mark Brown   ASoC: Sort specia...
81
82
83
84
85
  	[snd_soc_dapm_mixer] = 5,
  	[snd_soc_dapm_dac] = 6,
  	[snd_soc_dapm_mic] = 7,
  	[snd_soc_dapm_micbias] = 8,
  	[snd_soc_dapm_mux] = 9,
24ff33ac6   Dimitris Papastamos   ASoC: soc-dapm: I...
86
  	[snd_soc_dapm_virt_mux] = 9,
e3d4dabd2   Mark Brown   ASoC: Sort specia...
87
  	[snd_soc_dapm_value_mux] = 9,
010ff2622   Mark Brown   ASoC: Add input a...
88
89
90
91
  	[snd_soc_dapm_aif_in] = 10,
  	[snd_soc_dapm_aif_out] = 10,
  	[snd_soc_dapm_supply] = 11,
  	[snd_soc_dapm_post] = 12,
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
92
  };
12ef193d5   Troy Kisky   ASoC: Allow setti...
93
  static void pop_wait(u32 pop_time)
15e4c72f5   Mark Brown   ALSA: ASoC: Make ...
94
95
96
97
  {
  	if (pop_time)
  		schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
  }
fd8d3bc09   Jarkko Nikula   ASoC: Convert pop...
98
  static void pop_dbg(struct device *dev, u32 pop_time, const char *fmt, ...)
15e4c72f5   Mark Brown   ALSA: ASoC: Make ...
99
100
  {
  	va_list args;
fd8d3bc09   Jarkko Nikula   ASoC: Convert pop...
101
  	char *buf;
15e4c72f5   Mark Brown   ALSA: ASoC: Make ...
102

fd8d3bc09   Jarkko Nikula   ASoC: Convert pop...
103
104
  	if (!pop_time)
  		return;
15e4c72f5   Mark Brown   ALSA: ASoC: Make ...
105

fd8d3bc09   Jarkko Nikula   ASoC: Convert pop...
106
107
108
  	buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
  	if (buf == NULL)
  		return;
15e4c72f5   Mark Brown   ALSA: ASoC: Make ...
109

fd8d3bc09   Jarkko Nikula   ASoC: Convert pop...
110
111
  	va_start(args, fmt);
  	vsnprintf(buf, PAGE_SIZE, fmt, args);
9d01df063   Takashi Iwai   ASoC: don't pass ...
112
  	dev_info(dev, "%s", buf);
15e4c72f5   Mark Brown   ALSA: ASoC: Make ...
113
  	va_end(args);
fd8d3bc09   Jarkko Nikula   ASoC: Convert pop...
114
115
  
  	kfree(buf);
15e4c72f5   Mark Brown   ALSA: ASoC: Make ...
116
  }
db432b414   Mark Brown   ASoC: Do DAPM pow...
117
118
119
120
  static bool dapm_dirty_widget(struct snd_soc_dapm_widget *w)
  {
  	return !list_empty(&w->dirty);
  }
25c77c5fa   Mark Brown   ASoC: Fix DAPM sy...
121
  void dapm_mark_dirty(struct snd_soc_dapm_widget *w, const char *reason)
db432b414   Mark Brown   ASoC: Do DAPM pow...
122
  {
75c1f891b   Mark Brown   ASoC: Add verbose...
123
124
125
126
  	if (!dapm_dirty_widget(w)) {
  		dev_vdbg(w->dapm->dev, "Marking %s dirty due to %s
  ",
  			 w->name, reason);
db432b414   Mark Brown   ASoC: Do DAPM pow...
127
  		list_add_tail(&w->dirty, &w->dapm->card->dapm_dirty);
75c1f891b   Mark Brown   ASoC: Add verbose...
128
  	}
db432b414   Mark Brown   ASoC: Do DAPM pow...
129
  }
25c77c5fa   Mark Brown   ASoC: Fix DAPM sy...
130
  EXPORT_SYMBOL_GPL(dapm_mark_dirty);
db432b414   Mark Brown   ASoC: Do DAPM pow...
131

2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
132
  /* create a new dapm widget */
88cb42901   Takashi Iwai   [ALSA] soc - Clea...
133
  static inline struct snd_soc_dapm_widget *dapm_cnew_widget(
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
134
135
  	const struct snd_soc_dapm_widget *_widget)
  {
88cb42901   Takashi Iwai   [ALSA] soc - Clea...
136
  	return kmemdup(_widget, sizeof(*_widget), GFP_KERNEL);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
137
  }
4805608ac   Liam Girdwood   ASoC: dapm - Add ...
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
  /* get snd_card from DAPM context */
  static inline struct snd_card *dapm_get_snd_card(
  	struct snd_soc_dapm_context *dapm)
  {
  	if (dapm->codec)
  		return dapm->codec->card->snd_card;
  	else if (dapm->platform)
  		return dapm->platform->card->snd_card;
  	else
  		BUG();
  
  	/* unreachable */
  	return NULL;
  }
  
  /* get soc_card from DAPM context */
  static inline struct snd_soc_card *dapm_get_soc_card(
  		struct snd_soc_dapm_context *dapm)
  {
  	if (dapm->codec)
  		return dapm->codec->card;
  	else if (dapm->platform)
  		return dapm->platform->card;
  	else
  		BUG();
  
  	/* unreachable */
  	return NULL;
  }
0445bdf4a   Liam Girdwood   ASoC: dapm - Refa...
167
168
169
170
  static int soc_widget_read(struct snd_soc_dapm_widget *w, int reg)
  {
  	if (w->codec)
  		return snd_soc_read(w->codec, reg);
b79506413   Liam Girdwood   ASoC: core - Add ...
171
172
173
174
175
176
  	else if (w->platform)
  		return snd_soc_platform_read(w->platform, reg);
  
  	dev_err(w->dapm->dev, "no valid widget read method
  ");
  	return -1;
0445bdf4a   Liam Girdwood   ASoC: dapm - Refa...
177
178
179
180
181
182
  }
  
  static int soc_widget_write(struct snd_soc_dapm_widget *w, int reg, int val)
  {
  	if (w->codec)
  		return snd_soc_write(w->codec, reg, val);
b79506413   Liam Girdwood   ASoC: core - Add ...
183
184
185
186
187
188
  	else if (w->platform)
  		return snd_soc_platform_write(w->platform, reg, val);
  
  	dev_err(w->dapm->dev, "no valid widget write method
  ");
  	return -1;
0445bdf4a   Liam Girdwood   ASoC: dapm - Refa...
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
  }
  
  static int soc_widget_update_bits(struct snd_soc_dapm_widget *w,
  	unsigned short reg, unsigned int mask, unsigned int value)
  {
  	int change;
  	unsigned int old, new;
  	int ret;
  
  	ret = soc_widget_read(w, reg);
  	if (ret < 0)
  		return ret;
  
  	old = ret;
  	new = (old & ~mask) | (value & mask);
  	change = old != new;
  	if (change) {
  		ret = soc_widget_write(w, reg, new);
  		if (ret < 0)
  			return ret;
  	}
  
  	return change;
  }
452c5eaa0   Mark Brown   ASoC: Integrate b...
213
214
  /**
   * snd_soc_dapm_set_bias_level - set the bias level for the system
ed5a4c472   Mark Brown   ASoC: Remove card...
215
   * @dapm: DAPM context
452c5eaa0   Mark Brown   ASoC: Integrate b...
216
217
218
219
220
221
   * @level: level to configure
   *
   * Configure the bias (power) levels for the SoC audio device.
   *
   * Returns 0 for success else error.
   */
ed5a4c472   Mark Brown   ASoC: Remove card...
222
  static int snd_soc_dapm_set_bias_level(struct snd_soc_dapm_context *dapm,
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
223
  				       enum snd_soc_bias_level level)
452c5eaa0   Mark Brown   ASoC: Integrate b...
224
  {
ed5a4c472   Mark Brown   ASoC: Remove card...
225
  	struct snd_soc_card *card = dapm->card;
452c5eaa0   Mark Brown   ASoC: Integrate b...
226
  	int ret = 0;
84e909303   Mark Brown   ASoC: Add DAPM tr...
227
  	trace_snd_soc_bias_level_start(card, level);
f0fba2ad1   Liam Girdwood   ASoC: multi-compo...
228
  	if (card && card->set_bias_level)
d4c6005f8   Mark Brown   ASoC: Add context...
229
  		ret = card->set_bias_level(card, dapm, level);
171ec6b08   Mark Brown   ASoC: Simplify lo...
230
231
  	if (ret != 0)
  		goto out;
cc4c670a4   Mark Brown   ASoC: Only provid...
232
233
234
235
236
237
238
  	if (dapm->codec) {
  		if (dapm->codec->driver->set_bias_level)
  			ret = dapm->codec->driver->set_bias_level(dapm->codec,
  								  level);
  		else
  			dapm->bias_level = level;
  	}
171ec6b08   Mark Brown   ASoC: Simplify lo...
239
240
241
242
  	if (ret != 0)
  		goto out;
  
  	if (card && card->set_bias_level_post)
d4c6005f8   Mark Brown   ASoC: Add context...
243
  		ret = card->set_bias_level_post(card, dapm, level);
171ec6b08   Mark Brown   ASoC: Simplify lo...
244
  out:
84e909303   Mark Brown   ASoC: Add DAPM tr...
245
  	trace_snd_soc_bias_level_done(card, level);
452c5eaa0   Mark Brown   ASoC: Integrate b...
246
247
  	return ret;
  }
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
248
249
250
251
252
253
  /* set up initial codec paths */
  static void dapm_set_path_status(struct snd_soc_dapm_widget *w,
  	struct snd_soc_dapm_path *p, int i)
  {
  	switch (w->id) {
  	case snd_soc_dapm_switch:
ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
254
255
  	case snd_soc_dapm_mixer:
  	case snd_soc_dapm_mixer_named_ctl: {
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
256
  		int val;
4eaa9819d   Jon Smirl   ALSA: ASoC: Conve...
257
  		struct soc_mixer_control *mc = (struct soc_mixer_control *)
82cfecdc0   Stephen Warren   ASoC: s/w->kcontr...
258
  			w->kcontrol_news[i].private_value;
815ecf8de   Jon Smirl   ALSA: ASoC: conve...
259
260
  		unsigned int reg = mc->reg;
  		unsigned int shift = mc->shift;
4eaa9819d   Jon Smirl   ALSA: ASoC: Conve...
261
  		int max = mc->max;
815ecf8de   Jon Smirl   ALSA: ASoC: conve...
262
263
  		unsigned int mask = (1 << fls(max)) - 1;
  		unsigned int invert = mc->invert;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
264

0445bdf4a   Liam Girdwood   ASoC: dapm - Refa...
265
  		val = soc_widget_read(w, reg);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
266
267
268
269
270
271
272
273
274
  		val = (val >> shift) & mask;
  
  		if ((invert && !val) || (!invert && val))
  			p->connect = 1;
  		else
  			p->connect = 0;
  	}
  	break;
  	case snd_soc_dapm_mux: {
82cfecdc0   Stephen Warren   ASoC: s/w->kcontr...
275
276
  		struct soc_enum *e = (struct soc_enum *)
  			w->kcontrol_news[i].private_value;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
277
  		int val, item, bitmask;
f8ba0b7bf   Jon Smirl   ALSA: ASoC: Renam...
278
  		for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
88d960864   Mark Brown   ASoC: Indentation...
279
  			;
0445bdf4a   Liam Girdwood   ASoC: dapm - Refa...
280
  		val = soc_widget_read(w, e->reg);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
281
282
283
  		item = (val >> e->shift_l) & (bitmask - 1);
  
  		p->connect = 0;
f8ba0b7bf   Jon Smirl   ALSA: ASoC: Renam...
284
  		for (i = 0; i < e->max; i++) {
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
285
286
287
288
289
  			if (!(strcmp(p->name, e->texts[i])) && item == i)
  				p->connect = 1;
  		}
  	}
  	break;
24ff33ac6   Dimitris Papastamos   ASoC: soc-dapm: I...
290
  	case snd_soc_dapm_virt_mux: {
82cfecdc0   Stephen Warren   ASoC: s/w->kcontr...
291
292
  		struct soc_enum *e = (struct soc_enum *)
  			w->kcontrol_news[i].private_value;
24ff33ac6   Dimitris Papastamos   ASoC: soc-dapm: I...
293
294
295
296
297
298
299
300
301
302
303
304
  
  		p->connect = 0;
  		/* since a virtual mux has no backing registers to
  		 * decide which path to connect, it will try to match
  		 * with the first enumeration.  This is to ensure
  		 * that the default mux choice (the first) will be
  		 * correctly powered up during initialization.
  		 */
  		if (!strcmp(p->name, e->texts[0]))
  			p->connect = 1;
  	}
  	break;
2e72f8e37   Peter Ujfalusi   ASoC: New enum ty...
305
  	case snd_soc_dapm_value_mux: {
741555568   Peter Ujfalusi   ASoC: Merge the s...
306
  		struct soc_enum *e = (struct soc_enum *)
82cfecdc0   Stephen Warren   ASoC: s/w->kcontr...
307
  			w->kcontrol_news[i].private_value;
2e72f8e37   Peter Ujfalusi   ASoC: New enum ty...
308
  		int val, item;
0445bdf4a   Liam Girdwood   ASoC: dapm - Refa...
309
  		val = soc_widget_read(w, e->reg);
2e72f8e37   Peter Ujfalusi   ASoC: New enum ty...
310
311
312
313
314
315
316
317
318
319
320
321
322
  		val = (val >> e->shift_l) & e->mask;
  		for (item = 0; item < e->max; item++) {
  			if (val == e->values[item])
  				break;
  		}
  
  		p->connect = 0;
  		for (i = 0; i < e->max; i++) {
  			if (!(strcmp(p->name, e->texts[i])) && item == i)
  				p->connect = 1;
  		}
  	}
  	break;
565631008   Mark Brown   ASoC: Mark headph...
323
  	/* does not affect routing - always connected */
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
324
  	case snd_soc_dapm_pga:
d88429a69   Olaya, Margarita   ASoC: dapm: Add o...
325
  	case snd_soc_dapm_out_drv:
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
326
327
328
  	case snd_soc_dapm_output:
  	case snd_soc_dapm_adc:
  	case snd_soc_dapm_input:
1ab97c8ca   Mark Brown   ASoC: Add signal ...
329
  	case snd_soc_dapm_siggen:
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
330
331
332
  	case snd_soc_dapm_dac:
  	case snd_soc_dapm_micbias:
  	case snd_soc_dapm_vmid:
246d0a17f   Mark Brown   ASoC: Add power s...
333
  	case snd_soc_dapm_supply:
010ff2622   Mark Brown   ASoC: Add input a...
334
335
  	case snd_soc_dapm_aif_in:
  	case snd_soc_dapm_aif_out:
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
336
337
338
339
  	case snd_soc_dapm_hp:
  	case snd_soc_dapm_mic:
  	case snd_soc_dapm_spk:
  	case snd_soc_dapm_line:
565631008   Mark Brown   ASoC: Mark headph...
340
341
342
  		p->connect = 1;
  	break;
  	/* does affect routing - dynamically connected */
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
343
344
345
346
347
348
  	case snd_soc_dapm_pre:
  	case snd_soc_dapm_post:
  		p->connect = 0;
  	break;
  	}
  }
74b8f955a   Mark Brown   ASoC: Apostrophe ...
349
  /* connect mux widget to its interconnecting audio paths */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
350
  static int dapm_connect_mux(struct snd_soc_dapm_context *dapm,
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
351
352
353
354
355
356
  	struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
  	struct snd_soc_dapm_path *path, const char *control_name,
  	const struct snd_kcontrol_new *kcontrol)
  {
  	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
  	int i;
f8ba0b7bf   Jon Smirl   ALSA: ASoC: Renam...
357
  	for (i = 0; i < e->max; i++) {
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
358
  		if (!(strcmp(control_name, e->texts[i]))) {
8ddab3f51   Jarkko Nikula   ASoC: Move DAPM p...
359
  			list_add(&path->list, &dapm->card->paths);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
360
361
362
363
364
365
366
367
368
369
  			list_add(&path->list_sink, &dest->sources);
  			list_add(&path->list_source, &src->sinks);
  			path->name = (char*)e->texts[i];
  			dapm_set_path_status(dest, path, 0);
  			return 0;
  		}
  	}
  
  	return -ENODEV;
  }
74b8f955a   Mark Brown   ASoC: Apostrophe ...
370
  /* connect mixer widget to its interconnecting audio paths */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
371
  static int dapm_connect_mixer(struct snd_soc_dapm_context *dapm,
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
372
373
374
375
376
377
378
  	struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
  	struct snd_soc_dapm_path *path, const char *control_name)
  {
  	int i;
  
  	/* search for mixer kcontrol */
  	for (i = 0; i < dest->num_kcontrols; i++) {
82cfecdc0   Stephen Warren   ASoC: s/w->kcontr...
379
  		if (!strcmp(control_name, dest->kcontrol_news[i].name)) {
8ddab3f51   Jarkko Nikula   ASoC: Move DAPM p...
380
  			list_add(&path->list, &dapm->card->paths);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
381
382
  			list_add(&path->list_sink, &dest->sources);
  			list_add(&path->list_source, &src->sinks);
82cfecdc0   Stephen Warren   ASoC: s/w->kcontr...
383
  			path->name = dest->kcontrol_news[i].name;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
384
385
386
387
388
389
  			dapm_set_path_status(dest, path, i);
  			return 0;
  		}
  	}
  	return -ENODEV;
  }
af46800b9   Stephen Warren   ASoC: Implement m...
390
  static int dapm_is_shared_kcontrol(struct snd_soc_dapm_context *dapm,
1007da060   Stephen Warren   ASoC: Fix dapm_is...
391
  	struct snd_soc_dapm_widget *kcontrolw,
af46800b9   Stephen Warren   ASoC: Implement m...
392
393
394
395
396
397
398
399
400
  	const struct snd_kcontrol_new *kcontrol_new,
  	struct snd_kcontrol **kcontrol)
  {
  	struct snd_soc_dapm_widget *w;
  	int i;
  
  	*kcontrol = NULL;
  
  	list_for_each_entry(w, &dapm->card->widgets, list) {
1007da060   Stephen Warren   ASoC: Fix dapm_is...
401
402
  		if (w == kcontrolw || w->dapm != kcontrolw->dapm)
  			continue;
af46800b9   Stephen Warren   ASoC: Implement m...
403
404
405
406
407
408
409
410
411
412
413
  		for (i = 0; i < w->num_kcontrols; i++) {
  			if (&w->kcontrol_news[i] == kcontrol_new) {
  				if (w->kcontrols)
  					*kcontrol = w->kcontrols[i];
  				return 1;
  			}
  		}
  	}
  
  	return 0;
  }
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
414
  /* create new dapm mixer control */
4b80b8c2e   Lars-Peter Clausen   ASoC: snd_soc_new...
415
  static int dapm_new_mixer(struct snd_soc_dapm_widget *w)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
416
  {
4b80b8c2e   Lars-Peter Clausen   ASoC: snd_soc_new...
417
  	struct snd_soc_dapm_context *dapm = w->dapm;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
418
  	int i, ret = 0;
3e5ff4dfa   Mark Brown   ASoC: Fix double ...
419
  	size_t name_len, prefix_len;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
420
  	struct snd_soc_dapm_path *path;
12ea2c782   Mark Brown   ASoC: Get the car...
421
  	struct snd_card *card = dapm->card->snd_card;
efb7ac3f9   Mark Brown   ASoC: Fix prefixi...
422
  	const char *prefix;
fafd2176f   Stephen Warren   ASoC: Store a lis...
423
424
  	struct snd_soc_dapm_widget_list *wlist;
  	size_t wlistsize;
efb7ac3f9   Mark Brown   ASoC: Fix prefixi...
425
426
427
428
429
  
  	if (dapm->codec)
  		prefix = dapm->codec->name_prefix;
  	else
  		prefix = NULL;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
430

3e5ff4dfa   Mark Brown   ASoC: Fix double ...
431
432
433
434
  	if (prefix)
  		prefix_len = strlen(prefix) + 1;
  	else
  		prefix_len = 0;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
435
436
437
438
439
440
441
  	/* add kcontrol */
  	for (i = 0; i < w->num_kcontrols; i++) {
  
  		/* match name */
  		list_for_each_entry(path, &w->sources, list_sink) {
  
  			/* mixer/mux paths name must match control name */
82cfecdc0   Stephen Warren   ASoC: s/w->kcontr...
442
  			if (path->name != (char *)w->kcontrol_news[i].name)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
443
  				continue;
82cd87643   Lars-Peter Clausen   ASoC: DAPM: Allow...
444
445
446
447
  			if (w->kcontrols[i]) {
  				path->kcontrol = w->kcontrols[i];
  				continue;
  			}
fafd2176f   Stephen Warren   ASoC: Store a lis...
448
449
450
451
452
453
454
455
456
457
458
459
  			wlistsize = sizeof(struct snd_soc_dapm_widget_list) +
  				    sizeof(struct snd_soc_dapm_widget *),
  			wlist = kzalloc(wlistsize, GFP_KERNEL);
  			if (wlist == NULL) {
  				dev_err(dapm->dev,
  					"asoc: can't allocate widget list for %s
  ",
  					w->name);
  				return -ENOMEM;
  			}
  			wlist->num_widgets = 1;
  			wlist->widgets[0] = w;
ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
460
461
462
463
464
465
  			/* add dapm control with long name.
  			 * for dapm_mixer this is the concatenation of the
  			 * mixer and kcontrol name.
  			 * for dapm_mixer_named_ctl this is simply the
  			 * kcontrol name.
  			 */
82cfecdc0   Stephen Warren   ASoC: s/w->kcontr...
466
  			name_len = strlen(w->kcontrol_news[i].name) + 1;
07495f3e5   Mark Brown   ASoC: Fix memory ...
467
  			if (w->id != snd_soc_dapm_mixer_named_ctl)
ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
468
  				name_len += 1 + strlen(w->name);
219b93f52   Mark Brown   ASoC: Remove DAPM...
469
  			path->long_name = kmalloc(name_len, GFP_KERNEL);
ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
470

fafd2176f   Stephen Warren   ASoC: Store a lis...
471
472
  			if (path->long_name == NULL) {
  				kfree(wlist);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
473
  				return -ENOMEM;
fafd2176f   Stephen Warren   ASoC: Store a lis...
474
  			}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
475

ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
476
  			switch (w->id) {
ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
477
  			default:
3e5ff4dfa   Mark Brown   ASoC: Fix double ...
478
479
480
481
482
483
  				/* The control will get a prefix from
  				 * the control creation process but
  				 * we're also using the same prefix
  				 * for widgets so cut the prefix off
  				 * the front of the widget name.
  				 */
ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
484
  				snprintf(path->long_name, name_len, "%s %s",
3e5ff4dfa   Mark Brown   ASoC: Fix double ...
485
  					 w->name + prefix_len,
82cfecdc0   Stephen Warren   ASoC: s/w->kcontr...
486
  					 w->kcontrol_news[i].name);
07495f3e5   Mark Brown   ASoC: Fix memory ...
487
  				break;
ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
488
489
  			case snd_soc_dapm_mixer_named_ctl:
  				snprintf(path->long_name, name_len, "%s",
82cfecdc0   Stephen Warren   ASoC: s/w->kcontr...
490
  					 w->kcontrol_news[i].name);
07495f3e5   Mark Brown   ASoC: Fix memory ...
491
  				break;
ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
492
  			}
219b93f52   Mark Brown   ASoC: Remove DAPM...
493
  			path->long_name[name_len - 1] = '\0';
fafd2176f   Stephen Warren   ASoC: Store a lis...
494
495
496
  			path->kcontrol = snd_soc_cnew(&w->kcontrol_news[i],
  						      wlist, path->long_name,
  						      prefix);
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
497
  			ret = snd_ctl_add(card, path->kcontrol);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
498
  			if (ret < 0) {
f7d41ae83   Jarkko Nikula   ASoC: Update DAPM...
499
500
501
502
  				dev_err(dapm->dev,
  					"asoc: failed to add dapm kcontrol %s: %d
  ",
  					path->long_name, ret);
fafd2176f   Stephen Warren   ASoC: Store a lis...
503
  				kfree(wlist);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
504
505
506
507
  				kfree(path->long_name);
  				path->long_name = NULL;
  				return ret;
  			}
fad598887   Stephen Warren   ASoC: Add w->kcon...
508
  			w->kcontrols[i] = path->kcontrol;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
509
510
511
512
513
514
  		}
  	}
  	return ret;
  }
  
  /* create new dapm mux control */
4b80b8c2e   Lars-Peter Clausen   ASoC: snd_soc_new...
515
  static int dapm_new_mux(struct snd_soc_dapm_widget *w)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
516
  {
4b80b8c2e   Lars-Peter Clausen   ASoC: snd_soc_new...
517
  	struct snd_soc_dapm_context *dapm = w->dapm;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
518
519
  	struct snd_soc_dapm_path *path = NULL;
  	struct snd_kcontrol *kcontrol;
12ea2c782   Mark Brown   ASoC: Get the car...
520
  	struct snd_card *card = dapm->card->snd_card;
efb7ac3f9   Mark Brown   ASoC: Fix prefixi...
521
  	const char *prefix;
3e5ff4dfa   Mark Brown   ASoC: Fix double ...
522
  	size_t prefix_len;
af46800b9   Stephen Warren   ASoC: Implement m...
523
  	int ret;
fafd2176f   Stephen Warren   ASoC: Store a lis...
524
  	struct snd_soc_dapm_widget_list *wlist;
af46800b9   Stephen Warren   ASoC: Implement m...
525
  	int shared, wlistentries;
fafd2176f   Stephen Warren   ASoC: Store a lis...
526
  	size_t wlistsize;
af46800b9   Stephen Warren   ASoC: Implement m...
527
  	char *name;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
528

af46800b9   Stephen Warren   ASoC: Implement m...
529
530
531
532
533
  	if (w->num_kcontrols != 1) {
  		dev_err(dapm->dev,
  			"asoc: mux %s has incorrect number of controls
  ",
  			w->name);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
534
535
  		return -EINVAL;
  	}
1007da060   Stephen Warren   ASoC: Fix dapm_is...
536
  	shared = dapm_is_shared_kcontrol(dapm, w, &w->kcontrol_news[0],
af46800b9   Stephen Warren   ASoC: Implement m...
537
538
539
540
541
542
543
544
  					 &kcontrol);
  	if (kcontrol) {
  		wlist = kcontrol->private_data;
  		wlistentries = wlist->num_widgets + 1;
  	} else {
  		wlist = NULL;
  		wlistentries = 1;
  	}
fafd2176f   Stephen Warren   ASoC: Store a lis...
545
  	wlistsize = sizeof(struct snd_soc_dapm_widget_list) +
af46800b9   Stephen Warren   ASoC: Implement m...
546
547
  		wlistentries * sizeof(struct snd_soc_dapm_widget *),
  	wlist = krealloc(wlist, wlistsize, GFP_KERNEL);
fafd2176f   Stephen Warren   ASoC: Store a lis...
548
549
550
551
552
553
  	if (wlist == NULL) {
  		dev_err(dapm->dev,
  			"asoc: can't allocate widget list for %s
  ", w->name);
  		return -ENOMEM;
  	}
af46800b9   Stephen Warren   ASoC: Implement m...
554
555
  	wlist->num_widgets = wlistentries;
  	wlist->widgets[wlistentries - 1] = w;
efb7ac3f9   Mark Brown   ASoC: Fix prefixi...
556

af46800b9   Stephen Warren   ASoC: Implement m...
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
  	if (!kcontrol) {
  		if (dapm->codec)
  			prefix = dapm->codec->name_prefix;
  		else
  			prefix = NULL;
  
  		if (shared) {
  			name = w->kcontrol_news[0].name;
  			prefix_len = 0;
  		} else {
  			name = w->name;
  			if (prefix)
  				prefix_len = strlen(prefix) + 1;
  			else
  				prefix_len = 0;
  		}
3e5ff4dfa   Mark Brown   ASoC: Fix double ...
573

af46800b9   Stephen Warren   ASoC: Implement m...
574
575
576
577
578
579
580
581
582
  		/*
  		 * The control will get a prefix from the control creation
  		 * process but we're also using the same prefix for widgets so
  		 * cut the prefix off the front of the widget name.
  		 */
  		kcontrol = snd_soc_cnew(&w->kcontrol_news[0], wlist,
  					name + prefix_len, prefix);
  		ret = snd_ctl_add(card, kcontrol);
  		if (ret < 0) {
53daf2089   Mark Brown   ASoC: Display the...
583
584
585
  			dev_err(dapm->dev, "failed to add kcontrol %s: %d
  ",
  				w->name, ret);
af46800b9   Stephen Warren   ASoC: Implement m...
586
587
588
589
  			kfree(wlist);
  			return ret;
  		}
  	}
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
590

af46800b9   Stephen Warren   ASoC: Implement m...
591
  	kcontrol->private_data = wlist;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
592

fad598887   Stephen Warren   ASoC: Add w->kcon...
593
  	w->kcontrols[0] = kcontrol;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
594
595
  	list_for_each_entry(path, &w->sources, list_sink)
  		path->kcontrol = kcontrol;
af46800b9   Stephen Warren   ASoC: Implement m...
596
  	return 0;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
597
598
599
  }
  
  /* create new dapm volume control */
4b80b8c2e   Lars-Peter Clausen   ASoC: snd_soc_new...
600
  static int dapm_new_pga(struct snd_soc_dapm_widget *w)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
601
  {
a6c65736b   Mark Brown   ASoC: Remove curr...
602
  	if (w->num_kcontrols)
f7d41ae83   Jarkko Nikula   ASoC: Update DAPM...
603
604
605
  		dev_err(w->dapm->dev,
  			"asoc: PGA controls not supported: '%s'
  ", w->name);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
606

a6c65736b   Mark Brown   ASoC: Remove curr...
607
  	return 0;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
608
609
610
  }
  
  /* reset 'walked' bit for each dapm path */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
611
  static inline void dapm_clear_walk(struct snd_soc_dapm_context *dapm)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
612
613
  {
  	struct snd_soc_dapm_path *p;
8ddab3f51   Jarkko Nikula   ASoC: Move DAPM p...
614
  	list_for_each_entry(p, &dapm->card->paths, list)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
615
616
  		p->walked = 0;
  }
9949788b7   Mark Brown   ASoC: Refactor DA...
617
618
619
620
621
622
  /* We implement power down on suspend by checking the power state of
   * the ALSA card - when we are suspending the ALSA state for the card
   * is set to D3.
   */
  static int snd_soc_dapm_suspend_check(struct snd_soc_dapm_widget *widget)
  {
12ea2c782   Mark Brown   ASoC: Get the car...
623
  	int level = snd_power_get_state(widget->dapm->card->snd_card);
9949788b7   Mark Brown   ASoC: Refactor DA...
624

f0fba2ad1   Liam Girdwood   ASoC: multi-compo...
625
  	switch (level) {
9949788b7   Mark Brown   ASoC: Refactor DA...
626
627
  	case SNDRV_CTL_POWER_D3hot:
  	case SNDRV_CTL_POWER_D3cold:
1547aba99   Mark Brown   ASoC: Support lea...
628
  		if (widget->ignore_suspend)
f7d41ae83   Jarkko Nikula   ASoC: Update DAPM...
629
630
631
  			dev_dbg(widget->dapm->dev, "%s ignoring suspend
  ",
  				widget->name);
1547aba99   Mark Brown   ASoC: Support lea...
632
  		return widget->ignore_suspend;
9949788b7   Mark Brown   ASoC: Refactor DA...
633
634
635
636
  	default:
  		return 1;
  	}
  }
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
637
638
639
640
641
642
643
644
  /*
   * Recursively check for a completed path to an active or physically connected
   * output widget. Returns number of complete paths.
   */
  static int is_connected_output_ep(struct snd_soc_dapm_widget *widget)
  {
  	struct snd_soc_dapm_path *path;
  	int con = 0;
024dc0785   Mark Brown   ASoC: Cache conne...
645
646
  	if (widget->outputs >= 0)
  		return widget->outputs;
de02d0786   Mark Brown   ASoC: Trace and c...
647
  	DAPM_UPDATE_STAT(widget, path_checks);
246d0a17f   Mark Brown   ASoC: Add power s...
648
649
  	if (widget->id == snd_soc_dapm_supply)
  		return 0;
010ff2622   Mark Brown   ASoC: Add input a...
650
651
652
  	switch (widget->id) {
  	case snd_soc_dapm_adc:
  	case snd_soc_dapm_aif_out:
024dc0785   Mark Brown   ASoC: Cache conne...
653
654
655
656
  		if (widget->active) {
  			widget->outputs = snd_soc_dapm_suspend_check(widget);
  			return widget->outputs;
  		}
010ff2622   Mark Brown   ASoC: Add input a...
657
658
659
  	default:
  		break;
  	}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
660
661
662
  
  	if (widget->connected) {
  		/* connected pin ? */
024dc0785   Mark Brown   ASoC: Cache conne...
663
664
665
666
  		if (widget->id == snd_soc_dapm_output && !widget->ext) {
  			widget->outputs = snd_soc_dapm_suspend_check(widget);
  			return widget->outputs;
  		}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
667
668
  
  		/* connected jack or spk ? */
024dc0785   Mark Brown   ASoC: Cache conne...
669
670
671
672
673
674
675
  		if (widget->id == snd_soc_dapm_hp ||
  		    widget->id == snd_soc_dapm_spk ||
  		    (widget->id == snd_soc_dapm_line &&
  		     !list_empty(&widget->sources))) {
  			widget->outputs = snd_soc_dapm_suspend_check(widget);
  			return widget->outputs;
  		}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
676
677
678
  	}
  
  	list_for_each_entry(path, &widget->sinks, list_source) {
e56235e09   Mark Brown   ASoC: Add another...
679
  		DAPM_UPDATE_STAT(widget, neighbour_checks);
bf3a9e137   Mark Brown   ASoC: Add weak ro...
680
681
  		if (path->weak)
  			continue;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
682
683
684
685
686
687
688
689
  		if (path->walked)
  			continue;
  
  		if (path->sink && path->connect) {
  			path->walked = 1;
  			con += is_connected_output_ep(path->sink);
  		}
  	}
024dc0785   Mark Brown   ASoC: Cache conne...
690
  	widget->outputs = con;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
691
692
693
694
695
696
697
698
699
700
701
  	return con;
  }
  
  /*
   * Recursively check for a completed path to an active or physically connected
   * input widget. Returns number of complete paths.
   */
  static int is_connected_input_ep(struct snd_soc_dapm_widget *widget)
  {
  	struct snd_soc_dapm_path *path;
  	int con = 0;
024dc0785   Mark Brown   ASoC: Cache conne...
702
703
  	if (widget->inputs >= 0)
  		return widget->inputs;
de02d0786   Mark Brown   ASoC: Trace and c...
704
  	DAPM_UPDATE_STAT(widget, path_checks);
246d0a17f   Mark Brown   ASoC: Add power s...
705
706
  	if (widget->id == snd_soc_dapm_supply)
  		return 0;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
707
  	/* active stream ? */
010ff2622   Mark Brown   ASoC: Add input a...
708
709
710
  	switch (widget->id) {
  	case snd_soc_dapm_dac:
  	case snd_soc_dapm_aif_in:
024dc0785   Mark Brown   ASoC: Cache conne...
711
712
713
714
  		if (widget->active) {
  			widget->inputs = snd_soc_dapm_suspend_check(widget);
  			return widget->inputs;
  		}
010ff2622   Mark Brown   ASoC: Add input a...
715
716
717
  	default:
  		break;
  	}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
718
719
720
  
  	if (widget->connected) {
  		/* connected pin ? */
024dc0785   Mark Brown   ASoC: Cache conne...
721
722
723
724
  		if (widget->id == snd_soc_dapm_input && !widget->ext) {
  			widget->inputs = snd_soc_dapm_suspend_check(widget);
  			return widget->inputs;
  		}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
725
726
  
  		/* connected VMID/Bias for lower pops */
024dc0785   Mark Brown   ASoC: Cache conne...
727
728
729
730
  		if (widget->id == snd_soc_dapm_vmid) {
  			widget->inputs = snd_soc_dapm_suspend_check(widget);
  			return widget->inputs;
  		}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
731
732
  
  		/* connected jack ? */
eaeae5d9b   Peter Ujfalusi   ASoC: Fix SND_SOC...
733
  		if (widget->id == snd_soc_dapm_mic ||
024dc0785   Mark Brown   ASoC: Cache conne...
734
735
736
737
738
  		    (widget->id == snd_soc_dapm_line &&
  		     !list_empty(&widget->sinks))) {
  			widget->inputs = snd_soc_dapm_suspend_check(widget);
  			return widget->inputs;
  		}
1ab97c8ca   Mark Brown   ASoC: Add signal ...
739
740
741
742
743
  		/* signal generator */
  		if (widget->id == snd_soc_dapm_siggen) {
  			widget->inputs = snd_soc_dapm_suspend_check(widget);
  			return widget->inputs;
  		}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
744
745
746
  	}
  
  	list_for_each_entry(path, &widget->sources, list_sink) {
e56235e09   Mark Brown   ASoC: Add another...
747
  		DAPM_UPDATE_STAT(widget, neighbour_checks);
bf3a9e137   Mark Brown   ASoC: Add weak ro...
748
749
  		if (path->weak)
  			continue;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
750
751
752
753
754
755
756
757
  		if (path->walked)
  			continue;
  
  		if (path->source && path->connect) {
  			path->walked = 1;
  			con += is_connected_input_ep(path->source);
  		}
  	}
024dc0785   Mark Brown   ASoC: Cache conne...
758
  	widget->inputs = con;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
759
760
761
762
  	return con;
  }
  
  /*
e2be2ccf9   Jarkko Nikula   ALSA: ASoC: Add s...
763
764
765
766
767
768
769
770
771
772
773
   * Handler for generic register modifier widget.
   */
  int dapm_reg_event(struct snd_soc_dapm_widget *w,
  		   struct snd_kcontrol *kcontrol, int event)
  {
  	unsigned int val;
  
  	if (SND_SOC_DAPM_EVENT_ON(event))
  		val = w->on_val;
  	else
  		val = w->off_val;
0445bdf4a   Liam Girdwood   ASoC: dapm - Refa...
774
  	soc_widget_update_bits(w, -(w->reg + 1),
e2be2ccf9   Jarkko Nikula   ALSA: ASoC: Add s...
775
776
777
778
  			    w->mask << w->shift, val << w->shift);
  
  	return 0;
  }
11589418a   Mark Brown   ALSA: ASoC: Expor...
779
  EXPORT_SYMBOL_GPL(dapm_reg_event);
e2be2ccf9   Jarkko Nikula   ALSA: ASoC: Add s...
780

d805002be   Mark Brown   ASoC: Factor out ...
781
782
  static int dapm_widget_power_check(struct snd_soc_dapm_widget *w)
  {
9b8a83b20   Mark Brown   ASoC: Only run po...
783
784
  	if (w->power_checked)
  		return w->new_power;
d805002be   Mark Brown   ASoC: Factor out ...
785
  	if (w->force)
9b8a83b20   Mark Brown   ASoC: Only run po...
786
  		w->new_power = 1;
d805002be   Mark Brown   ASoC: Factor out ...
787
  	else
9b8a83b20   Mark Brown   ASoC: Only run po...
788
789
790
791
792
  		w->new_power = w->power_check(w);
  
  	w->power_checked = true;
  
  	return w->new_power;
d805002be   Mark Brown   ASoC: Factor out ...
793
  }
cd0f2d473   Mark Brown   ASoC: Factor out ...
794
795
796
797
798
  /* Generic check to see if a widget should be powered.
   */
  static int dapm_generic_check_power(struct snd_soc_dapm_widget *w)
  {
  	int in, out;
de02d0786   Mark Brown   ASoC: Trace and c...
799
  	DAPM_UPDATE_STAT(w, power_checks);
cd0f2d473   Mark Brown   ASoC: Factor out ...
800
  	in = is_connected_input_ep(w);
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
801
  	dapm_clear_walk(w->dapm);
cd0f2d473   Mark Brown   ASoC: Factor out ...
802
  	out = is_connected_output_ep(w);
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
803
  	dapm_clear_walk(w->dapm);
cd0f2d473   Mark Brown   ASoC: Factor out ...
804
805
  	return out != 0 && in != 0;
  }
6ea31b9f0   Mark Brown   ASoC: Factor out ...
806
807
808
809
  /* Check to see if an ADC has power */
  static int dapm_adc_check_power(struct snd_soc_dapm_widget *w)
  {
  	int in;
de02d0786   Mark Brown   ASoC: Trace and c...
810
  	DAPM_UPDATE_STAT(w, power_checks);
6ea31b9f0   Mark Brown   ASoC: Factor out ...
811
812
  	if (w->active) {
  		in = is_connected_input_ep(w);
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
813
  		dapm_clear_walk(w->dapm);
6ea31b9f0   Mark Brown   ASoC: Factor out ...
814
815
816
817
818
819
820
821
822
823
  		return in != 0;
  	} else {
  		return dapm_generic_check_power(w);
  	}
  }
  
  /* Check to see if a DAC has power */
  static int dapm_dac_check_power(struct snd_soc_dapm_widget *w)
  {
  	int out;
de02d0786   Mark Brown   ASoC: Trace and c...
824
  	DAPM_UPDATE_STAT(w, power_checks);
6ea31b9f0   Mark Brown   ASoC: Factor out ...
825
826
  	if (w->active) {
  		out = is_connected_output_ep(w);
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
827
  		dapm_clear_walk(w->dapm);
6ea31b9f0   Mark Brown   ASoC: Factor out ...
828
829
830
831
832
  		return out != 0;
  	} else {
  		return dapm_generic_check_power(w);
  	}
  }
246d0a17f   Mark Brown   ASoC: Add power s...
833
834
835
836
  /* Check to see if a power supply is needed */
  static int dapm_supply_check_power(struct snd_soc_dapm_widget *w)
  {
  	struct snd_soc_dapm_path *path;
246d0a17f   Mark Brown   ASoC: Add power s...
837

de02d0786   Mark Brown   ASoC: Trace and c...
838
  	DAPM_UPDATE_STAT(w, power_checks);
246d0a17f   Mark Brown   ASoC: Add power s...
839
840
  	/* Check if one of our outputs is connected */
  	list_for_each_entry(path, &w->sinks, list_source) {
a8fdac83a   Mark Brown   ASoC: Also count ...
841
  		DAPM_UPDATE_STAT(w, neighbour_checks);
bf3a9e137   Mark Brown   ASoC: Add weak ro...
842
843
  		if (path->weak)
  			continue;
215edda3a   Mark Brown   ASoC: Allow per-r...
844
845
846
  		if (path->connected &&
  		    !path->connected(path->source, path->sink))
  			continue;
3017358a7   Mark Brown   ASoC: Ensure supp...
847
848
  		if (!path->sink)
  			continue;
f68d7e168   Mark Brown   ASoC: Stop checki...
849
850
  		if (dapm_widget_power_check(path->sink))
  			return 1;
246d0a17f   Mark Brown   ASoC: Add power s...
851
  	}
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
852
  	dapm_clear_walk(w->dapm);
246d0a17f   Mark Brown   ASoC: Add power s...
853

f68d7e168   Mark Brown   ASoC: Stop checki...
854
  	return 0;
246d0a17f   Mark Brown   ASoC: Add power s...
855
  }
35c64bcad   Mark Brown   ASoC: Ensure all ...
856
857
858
859
  static int dapm_always_on_check_power(struct snd_soc_dapm_widget *w)
  {
  	return 1;
  }
38357ab2c   Mark Brown   ASoC: Sort DAPM p...
860
861
  static int dapm_seq_compare(struct snd_soc_dapm_widget *a,
  			    struct snd_soc_dapm_widget *b,
828a842f2   Mark Brown   ASoC: Explicitly ...
862
  			    bool power_up)
42aa3418e   Mark Brown   ASoC: Factor out ...
863
  {
828a842f2   Mark Brown   ASoC: Explicitly ...
864
865
866
867
868
869
  	int *sort;
  
  	if (power_up)
  		sort = dapm_up_seq;
  	else
  		sort = dapm_down_seq;
38357ab2c   Mark Brown   ASoC: Sort DAPM p...
870
871
  	if (sort[a->id] != sort[b->id])
  		return sort[a->id] - sort[b->id];
20e4859de   Mark Brown   ASoC: Add support...
872
873
874
875
876
877
  	if (a->subseq != b->subseq) {
  		if (power_up)
  			return a->subseq - b->subseq;
  		else
  			return b->subseq - a->subseq;
  	}
b22ead2a5   Mark Brown   ASoC: Coalesce re...
878
879
  	if (a->reg != b->reg)
  		return a->reg - b->reg;
84dab5671   Mark Brown   ASoC: Use DAPM co...
880
881
  	if (a->dapm != b->dapm)
  		return (unsigned long)a->dapm - (unsigned long)b->dapm;
42aa3418e   Mark Brown   ASoC: Factor out ...
882

38357ab2c   Mark Brown   ASoC: Sort DAPM p...
883
884
  	return 0;
  }
42aa3418e   Mark Brown   ASoC: Factor out ...
885

38357ab2c   Mark Brown   ASoC: Sort DAPM p...
886
887
888
  /* Insert a widget in order into a DAPM power sequence. */
  static void dapm_seq_insert(struct snd_soc_dapm_widget *new_widget,
  			    struct list_head *list,
828a842f2   Mark Brown   ASoC: Explicitly ...
889
  			    bool power_up)
38357ab2c   Mark Brown   ASoC: Sort DAPM p...
890
891
892
893
  {
  	struct snd_soc_dapm_widget *w;
  
  	list_for_each_entry(w, list, power_list)
828a842f2   Mark Brown   ASoC: Explicitly ...
894
  		if (dapm_seq_compare(new_widget, w, power_up) < 0) {
38357ab2c   Mark Brown   ASoC: Sort DAPM p...
895
896
897
898
899
900
  			list_add_tail(&new_widget->power_list, &w->power_list);
  			return;
  		}
  
  	list_add_tail(&new_widget->power_list, list);
  }
68f89ad8c   Mark Brown   ASoC: Factor out ...
901
902
903
904
905
906
907
908
909
910
911
912
913
914
915
916
917
918
919
920
921
922
923
924
925
926
927
928
929
930
931
932
933
934
935
936
  static void dapm_seq_check_event(struct snd_soc_dapm_context *dapm,
  				 struct snd_soc_dapm_widget *w, int event)
  {
  	struct snd_soc_card *card = dapm->card;
  	const char *ev_name;
  	int power, ret;
  
  	switch (event) {
  	case SND_SOC_DAPM_PRE_PMU:
  		ev_name = "PRE_PMU";
  		power = 1;
  		break;
  	case SND_SOC_DAPM_POST_PMU:
  		ev_name = "POST_PMU";
  		power = 1;
  		break;
  	case SND_SOC_DAPM_PRE_PMD:
  		ev_name = "PRE_PMD";
  		power = 0;
  		break;
  	case SND_SOC_DAPM_POST_PMD:
  		ev_name = "POST_PMD";
  		power = 0;
  		break;
  	default:
  		BUG();
  		return;
  	}
  
  	if (w->power != power)
  		return;
  
  	if (w->event && (w->event_flags & event)) {
  		pop_dbg(dapm->dev, card->pop_time, "pop test : %s %s
  ",
  			w->name, ev_name);
84e909303   Mark Brown   ASoC: Add DAPM tr...
937
  		trace_snd_soc_dapm_widget_event_start(w, event);
68f89ad8c   Mark Brown   ASoC: Factor out ...
938
  		ret = w->event(w, NULL, event);
84e909303   Mark Brown   ASoC: Add DAPM tr...
939
  		trace_snd_soc_dapm_widget_event_done(w, event);
68f89ad8c   Mark Brown   ASoC: Factor out ...
940
941
942
943
944
945
  		if (ret < 0)
  			pr_err("%s: %s event failed: %d
  ",
  			       ev_name, w->name, ret);
  	}
  }
b22ead2a5   Mark Brown   ASoC: Coalesce re...
946
  /* Apply the coalesced changes from a DAPM sequence */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
947
  static void dapm_seq_run_coalesced(struct snd_soc_dapm_context *dapm,
b22ead2a5   Mark Brown   ASoC: Coalesce re...
948
  				   struct list_head *pending)
163cac061   Mark Brown   ASoC: Factor out ...
949
  {
3a45b8672   Jarkko Nikula   ASoC: Move pop ti...
950
  	struct snd_soc_card *card = dapm->card;
68f89ad8c   Mark Brown   ASoC: Factor out ...
951
952
  	struct snd_soc_dapm_widget *w;
  	int reg, power;
b22ead2a5   Mark Brown   ASoC: Coalesce re...
953
954
955
956
957
958
959
960
961
962
963
964
965
966
967
968
969
970
971
  	unsigned int value = 0;
  	unsigned int mask = 0;
  	unsigned int cur_mask;
  
  	reg = list_first_entry(pending, struct snd_soc_dapm_widget,
  			       power_list)->reg;
  
  	list_for_each_entry(w, pending, power_list) {
  		cur_mask = 1 << w->shift;
  		BUG_ON(reg != w->reg);
  
  		if (w->invert)
  			power = !w->power;
  		else
  			power = w->power;
  
  		mask |= cur_mask;
  		if (power)
  			value |= cur_mask;
fd8d3bc09   Jarkko Nikula   ASoC: Convert pop...
972
  		pop_dbg(dapm->dev, card->pop_time,
b22ead2a5   Mark Brown   ASoC: Coalesce re...
973
974
975
  			"pop test : Queue %s: reg=0x%x, 0x%x/0x%x
  ",
  			w->name, reg, value, mask);
81628103d   Mark Brown   ASoC: Coalesce po...
976

68f89ad8c   Mark Brown   ASoC: Factor out ...
977
978
979
  		/* Check for events */
  		dapm_seq_check_event(dapm, w, SND_SOC_DAPM_PRE_PMU);
  		dapm_seq_check_event(dapm, w, SND_SOC_DAPM_PRE_PMD);
81628103d   Mark Brown   ASoC: Coalesce po...
980
981
982
  	}
  
  	if (reg >= 0) {
29376bc7e   Mark Brown   ASoC: Fix DAPM se...
983
984
985
986
987
  		/* Any widget will do, they should all be updating the
  		 * same register.
  		 */
  		w = list_first_entry(pending, struct snd_soc_dapm_widget,
  				     power_list);
fd8d3bc09   Jarkko Nikula   ASoC: Convert pop...
988
  		pop_dbg(dapm->dev, card->pop_time,
81628103d   Mark Brown   ASoC: Coalesce po...
989
990
  			"pop test : Applying 0x%x/0x%x to %x in %dms
  ",
3a45b8672   Jarkko Nikula   ASoC: Move pop ti...
991
992
  			value, mask, reg, card->pop_time);
  		pop_wait(card->pop_time);
0445bdf4a   Liam Girdwood   ASoC: dapm - Refa...
993
  		soc_widget_update_bits(w, reg, mask, value);
b22ead2a5   Mark Brown   ASoC: Coalesce re...
994
  	}
81628103d   Mark Brown   ASoC: Coalesce po...
995
  	list_for_each_entry(w, pending, power_list) {
68f89ad8c   Mark Brown   ASoC: Factor out ...
996
997
  		dapm_seq_check_event(dapm, w, SND_SOC_DAPM_POST_PMU);
  		dapm_seq_check_event(dapm, w, SND_SOC_DAPM_POST_PMD);
81628103d   Mark Brown   ASoC: Coalesce po...
998
  	}
b22ead2a5   Mark Brown   ASoC: Coalesce re...
999
  }
42aa3418e   Mark Brown   ASoC: Factor out ...
1000

b22ead2a5   Mark Brown   ASoC: Coalesce re...
1001
1002
1003
1004
1005
1006
1007
1008
  /* Apply a DAPM power sequence.
   *
   * We walk over a pre-sorted list of widgets to apply power to.  In
   * order to minimise the number of writes to the device required
   * multiple widgets will be updated in a single write where possible.
   * Currently anything that requires more than a single write is not
   * handled.
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1009
  static void dapm_seq_run(struct snd_soc_dapm_context *dapm,
828a842f2   Mark Brown   ASoC: Explicitly ...
1010
  			 struct list_head *list, int event, bool power_up)
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1011
1012
1013
1014
  {
  	struct snd_soc_dapm_widget *w, *n;
  	LIST_HEAD(pending);
  	int cur_sort = -1;
20e4859de   Mark Brown   ASoC: Add support...
1015
  	int cur_subseq = -1;
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1016
  	int cur_reg = SND_SOC_NOPM;
7be31be88   Jarkko Nikula   ASoC: Extend DAPM...
1017
  	struct snd_soc_dapm_context *cur_dapm = NULL;
474b62d6e   Mark Brown   ASoC: Provide per...
1018
  	int ret, i;
828a842f2   Mark Brown   ASoC: Explicitly ...
1019
1020
1021
1022
1023
1024
  	int *sort;
  
  	if (power_up)
  		sort = dapm_up_seq;
  	else
  		sort = dapm_down_seq;
163cac061   Mark Brown   ASoC: Factor out ...
1025

b22ead2a5   Mark Brown   ASoC: Coalesce re...
1026
1027
1028
1029
  	list_for_each_entry_safe(w, n, list, power_list) {
  		ret = 0;
  
  		/* Do we need to apply any queued changes? */
7be31be88   Jarkko Nikula   ASoC: Extend DAPM...
1030
  		if (sort[w->id] != cur_sort || w->reg != cur_reg ||
20e4859de   Mark Brown   ASoC: Add support...
1031
  		    w->dapm != cur_dapm || w->subseq != cur_subseq) {
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1032
  			if (!list_empty(&pending))
7be31be88   Jarkko Nikula   ASoC: Extend DAPM...
1033
  				dapm_seq_run_coalesced(cur_dapm, &pending);
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1034

474b62d6e   Mark Brown   ASoC: Provide per...
1035
1036
1037
1038
  			if (cur_dapm && cur_dapm->seq_notifier) {
  				for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
  					if (sort[i] == cur_sort)
  						cur_dapm->seq_notifier(cur_dapm,
f85a9e0d2   Mark Brown   ASoC: Add subsequ...
1039
1040
  								       i,
  								       cur_subseq);
474b62d6e   Mark Brown   ASoC: Provide per...
1041
  			}
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1042
1043
  			INIT_LIST_HEAD(&pending);
  			cur_sort = -1;
b0b3e6f86   Mark Brown   ASoC: Don't use -...
1044
  			cur_subseq = INT_MIN;
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1045
  			cur_reg = SND_SOC_NOPM;
7be31be88   Jarkko Nikula   ASoC: Extend DAPM...
1046
  			cur_dapm = NULL;
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1047
  		}
163cac061   Mark Brown   ASoC: Factor out ...
1048
1049
1050
  		switch (w->id) {
  		case snd_soc_dapm_pre:
  			if (!w->event)
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1051
1052
  				list_for_each_entry_safe_continue(w, n, list,
  								  power_list);
163cac061   Mark Brown   ASoC: Factor out ...
1053

b22ead2a5   Mark Brown   ASoC: Coalesce re...
1054
  			if (event == SND_SOC_DAPM_STREAM_START)
163cac061   Mark Brown   ASoC: Factor out ...
1055
1056
  				ret = w->event(w,
  					       NULL, SND_SOC_DAPM_PRE_PMU);
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1057
  			else if (event == SND_SOC_DAPM_STREAM_STOP)
163cac061   Mark Brown   ASoC: Factor out ...
1058
1059
  				ret = w->event(w,
  					       NULL, SND_SOC_DAPM_PRE_PMD);
163cac061   Mark Brown   ASoC: Factor out ...
1060
1061
1062
1063
  			break;
  
  		case snd_soc_dapm_post:
  			if (!w->event)
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1064
1065
  				list_for_each_entry_safe_continue(w, n, list,
  								  power_list);
163cac061   Mark Brown   ASoC: Factor out ...
1066

b22ead2a5   Mark Brown   ASoC: Coalesce re...
1067
  			if (event == SND_SOC_DAPM_STREAM_START)
163cac061   Mark Brown   ASoC: Factor out ...
1068
1069
  				ret = w->event(w,
  					       NULL, SND_SOC_DAPM_POST_PMU);
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1070
  			else if (event == SND_SOC_DAPM_STREAM_STOP)
163cac061   Mark Brown   ASoC: Factor out ...
1071
1072
  				ret = w->event(w,
  					       NULL, SND_SOC_DAPM_POST_PMD);
163cac061   Mark Brown   ASoC: Factor out ...
1073
  			break;
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1074
  		default:
81628103d   Mark Brown   ASoC: Coalesce po...
1075
1076
  			/* Queue it up for application */
  			cur_sort = sort[w->id];
20e4859de   Mark Brown   ASoC: Add support...
1077
  			cur_subseq = w->subseq;
81628103d   Mark Brown   ASoC: Coalesce po...
1078
  			cur_reg = w->reg;
7be31be88   Jarkko Nikula   ASoC: Extend DAPM...
1079
  			cur_dapm = w->dapm;
81628103d   Mark Brown   ASoC: Coalesce po...
1080
1081
  			list_move(&w->power_list, &pending);
  			break;
163cac061   Mark Brown   ASoC: Factor out ...
1082
  		}
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1083
1084
  
  		if (ret < 0)
f7d41ae83   Jarkko Nikula   ASoC: Update DAPM...
1085
1086
1087
  			dev_err(w->dapm->dev,
  				"Failed to apply widget power: %d
  ", ret);
6ea31b9f0   Mark Brown   ASoC: Factor out ...
1088
  	}
b22ead2a5   Mark Brown   ASoC: Coalesce re...
1089
1090
  
  	if (!list_empty(&pending))
28e868081   Mark Brown   ASoC: Use the cor...
1091
  		dapm_seq_run_coalesced(cur_dapm, &pending);
474b62d6e   Mark Brown   ASoC: Provide per...
1092
1093
1094
1095
1096
  
  	if (cur_dapm && cur_dapm->seq_notifier) {
  		for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
  			if (sort[i] == cur_sort)
  				cur_dapm->seq_notifier(cur_dapm,
f85a9e0d2   Mark Brown   ASoC: Add subsequ...
1097
  						       i, cur_subseq);
474b62d6e   Mark Brown   ASoC: Provide per...
1098
  	}
42aa3418e   Mark Brown   ASoC: Factor out ...
1099
  }
97404f2e0   Mark Brown   ASoC: Do DAPM con...
1100
1101
1102
1103
1104
1105
1106
1107
1108
1109
1110
1111
1112
1113
1114
1115
1116
1117
1118
1119
1120
1121
1122
1123
1124
1125
1126
1127
1128
1129
1130
1131
1132
1133
1134
  static void dapm_widget_update(struct snd_soc_dapm_context *dapm)
  {
  	struct snd_soc_dapm_update *update = dapm->update;
  	struct snd_soc_dapm_widget *w;
  	int ret;
  
  	if (!update)
  		return;
  
  	w = update->widget;
  
  	if (w->event &&
  	    (w->event_flags & SND_SOC_DAPM_PRE_REG)) {
  		ret = w->event(w, update->kcontrol, SND_SOC_DAPM_PRE_REG);
  		if (ret != 0)
  			pr_err("%s DAPM pre-event failed: %d
  ",
  			       w->name, ret);
  	}
  
  	ret = snd_soc_update_bits(w->codec, update->reg, update->mask,
  				  update->val);
  	if (ret < 0)
  		pr_err("%s DAPM update failed: %d
  ", w->name, ret);
  
  	if (w->event &&
  	    (w->event_flags & SND_SOC_DAPM_POST_REG)) {
  		ret = w->event(w, update->kcontrol, SND_SOC_DAPM_POST_REG);
  		if (ret != 0)
  			pr_err("%s DAPM post-event failed: %d
  ",
  			       w->name, ret);
  	}
  }
9d0624a74   Mark Brown   ASoC: Run bias le...
1135
1136
1137
1138
1139
1140
1141
  /* Async callback run prior to DAPM sequences - brings to _PREPARE if
   * they're changing state.
   */
  static void dapm_pre_sequence_async(void *data, async_cookie_t cookie)
  {
  	struct snd_soc_dapm_context *d = data;
  	int ret;
56fba41f8   Mark Brown   ASoC: Specify tar...
1142
1143
1144
  	/* If we're off and we're not supposed to be go into STANDBY */
  	if (d->bias_level == SND_SOC_BIAS_OFF &&
  	    d->target_bias_level != SND_SOC_BIAS_OFF) {
f1aac484f   Mark Brown   ASoC: Take a pm_r...
1145
1146
  		if (d->dev)
  			pm_runtime_get_sync(d->dev);
9d0624a74   Mark Brown   ASoC: Run bias le...
1147
1148
1149
1150
1151
1152
  		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
  		if (ret != 0)
  			dev_err(d->dev,
  				"Failed to turn on bias: %d
  ", ret);
  	}
56fba41f8   Mark Brown   ASoC: Specify tar...
1153
1154
  	/* Prepare for a STADDBY->ON or ON->STANDBY transition */
  	if (d->bias_level != d->target_bias_level) {
9d0624a74   Mark Brown   ASoC: Run bias le...
1155
1156
1157
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
  		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_PREPARE);
  		if (ret != 0)
  			dev_err(d->dev,
  				"Failed to prepare bias: %d
  ", ret);
  	}
  }
  
  /* Async callback run prior to DAPM sequences - brings to their final
   * state.
   */
  static void dapm_post_sequence_async(void *data, async_cookie_t cookie)
  {
  	struct snd_soc_dapm_context *d = data;
  	int ret;
  
  	/* If we just powered the last thing off drop to standby bias */
56fba41f8   Mark Brown   ASoC: Specify tar...
1172
1173
1174
  	if (d->bias_level == SND_SOC_BIAS_PREPARE &&
  	    (d->target_bias_level == SND_SOC_BIAS_STANDBY ||
  	     d->target_bias_level == SND_SOC_BIAS_OFF)) {
9d0624a74   Mark Brown   ASoC: Run bias le...
1175
1176
1177
1178
1179
1180
  		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
  		if (ret != 0)
  			dev_err(d->dev, "Failed to apply standby bias: %d
  ",
  				ret);
  	}
97404f2e0   Mark Brown   ASoC: Do DAPM con...
1181

9d0624a74   Mark Brown   ASoC: Run bias le...
1182
  	/* If we're in standby and can support bias off then do that */
56fba41f8   Mark Brown   ASoC: Specify tar...
1183
1184
  	if (d->bias_level == SND_SOC_BIAS_STANDBY &&
  	    d->target_bias_level == SND_SOC_BIAS_OFF) {
9d0624a74   Mark Brown   ASoC: Run bias le...
1185
1186
1187
1188
  		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_OFF);
  		if (ret != 0)
  			dev_err(d->dev, "Failed to turn off bias: %d
  ", ret);
f1aac484f   Mark Brown   ASoC: Take a pm_r...
1189
1190
1191
  
  		if (d->dev)
  			pm_runtime_put_sync(d->dev);
9d0624a74   Mark Brown   ASoC: Run bias le...
1192
1193
1194
  	}
  
  	/* If we just powered up then move to active bias */
56fba41f8   Mark Brown   ASoC: Specify tar...
1195
1196
  	if (d->bias_level == SND_SOC_BIAS_PREPARE &&
  	    d->target_bias_level == SND_SOC_BIAS_ON) {
9d0624a74   Mark Brown   ASoC: Run bias le...
1197
1198
1199
1200
1201
1202
1203
  		ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_ON);
  		if (ret != 0)
  			dev_err(d->dev, "Failed to apply active bias: %d
  ",
  				ret);
  	}
  }
97404f2e0   Mark Brown   ASoC: Do DAPM con...
1204

fe4fda5d8   Mark Brown   ASoC: Reduce the ...
1205
1206
1207
1208
1209
1210
1211
1212
1213
1214
1215
1216
  static void dapm_widget_set_peer_power(struct snd_soc_dapm_widget *peer,
  				       bool power, bool connect)
  {
  	/* If a connection is being made or broken then that update
  	 * will have marked the peer dirty, otherwise the widgets are
  	 * not connected and this update has no impact. */
  	if (!connect)
  		return;
  
  	/* If the peer is already in the state we're moving to then we
  	 * won't have an impact on it. */
  	if (power != peer->power)
75c1f891b   Mark Brown   ASoC: Add verbose...
1217
  		dapm_mark_dirty(peer, "peer state change");
fe4fda5d8   Mark Brown   ASoC: Reduce the ...
1218
  }
05623c431   Mark Brown   ASoC: Factor writ...
1219
1220
1221
1222
  static void dapm_widget_set_power(struct snd_soc_dapm_widget *w, bool power,
  				  struct list_head *up_list,
  				  struct list_head *down_list)
  {
db432b414   Mark Brown   ASoC: Do DAPM pow...
1223
  	struct snd_soc_dapm_path *path;
05623c431   Mark Brown   ASoC: Factor writ...
1224
1225
1226
1227
  	if (w->power == power)
  		return;
  
  	trace_snd_soc_dapm_widget_power(w, power);
db432b414   Mark Brown   ASoC: Do DAPM pow...
1228
  	/* If we changed our power state perhaps our neigbours changed
fe4fda5d8   Mark Brown   ASoC: Reduce the ...
1229
  	 * also.
db432b414   Mark Brown   ASoC: Do DAPM pow...
1230
1231
1232
  	 */
  	list_for_each_entry(path, &w->sources, list_sink) {
  		if (path->source) {
fe4fda5d8   Mark Brown   ASoC: Reduce the ...
1233
1234
  			dapm_widget_set_peer_power(path->source, power,
  						   path->connect);
db432b414   Mark Brown   ASoC: Do DAPM pow...
1235
1236
  		}
  	}
f3bf3e456   Mark Brown   ASoC: Don't mark ...
1237
1238
1239
1240
1241
1242
1243
1244
1245
1246
  	switch (w->id) {
  	case snd_soc_dapm_supply:
  		/* Supplies can't affect their outputs, only their inputs */
  		break;
  	default:
  		list_for_each_entry(path, &w->sinks, list_source) {
  			if (path->sink) {
  				dapm_widget_set_peer_power(path->sink, power,
  							   path->connect);
  			}
db432b414   Mark Brown   ASoC: Do DAPM pow...
1247
  		}
f3bf3e456   Mark Brown   ASoC: Don't mark ...
1248
  		break;
db432b414   Mark Brown   ASoC: Do DAPM pow...
1249
  	}
05623c431   Mark Brown   ASoC: Factor writ...
1250
1251
1252
1253
1254
1255
1256
  	if (power)
  		dapm_seq_insert(w, up_list, true);
  	else
  		dapm_seq_insert(w, down_list, false);
  
  	w->power = power;
  }
7c81beb04   Mark Brown   ASoC: Factor out ...
1257
1258
1259
1260
  static void dapm_power_one_widget(struct snd_soc_dapm_widget *w,
  				  struct list_head *up_list,
  				  struct list_head *down_list)
  {
7c81beb04   Mark Brown   ASoC: Factor out ...
1261
1262
1263
1264
1265
1266
1267
1268
1269
1270
1271
  	int power;
  
  	switch (w->id) {
  	case snd_soc_dapm_pre:
  		dapm_seq_insert(w, down_list, false);
  		break;
  	case snd_soc_dapm_post:
  		dapm_seq_insert(w, up_list, true);
  		break;
  
  	default:
d805002be   Mark Brown   ASoC: Factor out ...
1272
  		power = dapm_widget_power_check(w);
7c81beb04   Mark Brown   ASoC: Factor out ...
1273

05623c431   Mark Brown   ASoC: Factor writ...
1274
  		dapm_widget_set_power(w, power, up_list, down_list);
7c81beb04   Mark Brown   ASoC: Factor out ...
1275
1276
1277
  		break;
  	}
  }
42aa3418e   Mark Brown   ASoC: Factor out ...
1278
  /*
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1279
1280
1281
1282
1283
1284
1285
1286
   * Scan each dapm widget for complete audio path.
   * A complete path is a route that has valid endpoints i.e.:-
   *
   *  o DAC to output pin.
   *  o Input Pin to ADC.
   *  o Input pin to Output pin (bypass, sidetone)
   *  o DAC to ADC (loopback).
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1287
  static int dapm_power_widgets(struct snd_soc_dapm_context *dapm, int event)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1288
  {
12ea2c782   Mark Brown   ASoC: Get the car...
1289
  	struct snd_soc_card *card = dapm->card;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1290
  	struct snd_soc_dapm_widget *w;
7be31be88   Jarkko Nikula   ASoC: Extend DAPM...
1291
  	struct snd_soc_dapm_context *d;
291f3bbca   Mark Brown   ASoC: Make DAPM p...
1292
1293
  	LIST_HEAD(up_list);
  	LIST_HEAD(down_list);
9d0624a74   Mark Brown   ASoC: Run bias le...
1294
  	LIST_HEAD(async_domain);
56fba41f8   Mark Brown   ASoC: Specify tar...
1295
  	enum snd_soc_bias_level bias;
6d3ddc81f   Mark Brown   ASoC: Split DAPM ...
1296

84e909303   Mark Brown   ASoC: Add DAPM tr...
1297
  	trace_snd_soc_dapm_start(card);
56fba41f8   Mark Brown   ASoC: Specify tar...
1298
1299
1300
1301
1302
1303
1304
1305
  	list_for_each_entry(d, &card->dapm_list, list) {
  		if (d->n_widgets || d->codec == NULL) {
  			if (d->idle_bias_off)
  				d->target_bias_level = SND_SOC_BIAS_OFF;
  			else
  				d->target_bias_level = SND_SOC_BIAS_STANDBY;
  		}
  	}
7be31be88   Jarkko Nikula   ASoC: Extend DAPM...
1306

de02d0786   Mark Brown   ASoC: Trace and c...
1307
  	memset(&card->dapm_stats, 0, sizeof(card->dapm_stats));
9b8a83b20   Mark Brown   ASoC: Only run po...
1308
1309
  	list_for_each_entry(w, &card->widgets, list) {
  		w->power_checked = false;
024dc0785   Mark Brown   ASoC: Cache conne...
1310
1311
  		w->inputs = -1;
  		w->outputs = -1;
9b8a83b20   Mark Brown   ASoC: Only run po...
1312
  	}
6d3ddc81f   Mark Brown   ASoC: Split DAPM ...
1313
  	/* Check which widgets we need to power and store them in
db432b414   Mark Brown   ASoC: Do DAPM pow...
1314
1315
1316
1317
  	 * lists indicating if they should be powered up or down.  We
  	 * only check widgets that have been flagged as dirty but note
  	 * that new widgets may be added to the dirty list while we
  	 * iterate.
6d3ddc81f   Mark Brown   ASoC: Split DAPM ...
1318
  	 */
db432b414   Mark Brown   ASoC: Do DAPM pow...
1319
  	list_for_each_entry(w, &card->dapm_dirty, dirty) {
7c81beb04   Mark Brown   ASoC: Factor out ...
1320
  		dapm_power_one_widget(w, &up_list, &down_list);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1321
  	}
f9de6d741   Mark Brown   ASoC: Move bias l...
1322
  	list_for_each_entry(w, &card->widgets, list) {
db432b414   Mark Brown   ASoC: Do DAPM pow...
1323
  		list_del_init(&w->dirty);
f9de6d741   Mark Brown   ASoC: Move bias l...
1324
1325
1326
1327
1328
1329
1330
1331
1332
1333
1334
1335
1336
1337
1338
1339
1340
1341
1342
1343
1344
  		if (w->power) {
  			d = w->dapm;
  
  			/* Supplies and micbiases only bring the
  			 * context up to STANDBY as unless something
  			 * else is active and passing audio they
  			 * generally don't require full power.
  			 */
  			switch (w->id) {
  			case snd_soc_dapm_supply:
  			case snd_soc_dapm_micbias:
  				if (d->target_bias_level < SND_SOC_BIAS_STANDBY)
  					d->target_bias_level = SND_SOC_BIAS_STANDBY;
  				break;
  			default:
  				d->target_bias_level = SND_SOC_BIAS_ON;
  				break;
  			}
  		}
  
  	}
b14b76a56   Mark Brown   ASoC: Fix handlin...
1345
1346
1347
  	/* If there are no DAPM widgets then try to figure out power from the
  	 * event type.
  	 */
97c866def   Jarkko Nikula   ASoC: Move widget...
1348
  	if (!dapm->n_widgets) {
b14b76a56   Mark Brown   ASoC: Fix handlin...
1349
1350
1351
  		switch (event) {
  		case SND_SOC_DAPM_STREAM_START:
  		case SND_SOC_DAPM_STREAM_RESUME:
56fba41f8   Mark Brown   ASoC: Specify tar...
1352
  			dapm->target_bias_level = SND_SOC_BIAS_ON;
b14b76a56   Mark Brown   ASoC: Fix handlin...
1353
  			break;
862af8adb   Jarkko Nikula   ASoC: Fix bias po...
1354
  		case SND_SOC_DAPM_STREAM_STOP:
56fba41f8   Mark Brown   ASoC: Specify tar...
1355
1356
1357
1358
  			if (dapm->codec->active)
  				dapm->target_bias_level = SND_SOC_BIAS_ON;
  			else
  				dapm->target_bias_level = SND_SOC_BIAS_STANDBY;
862af8adb   Jarkko Nikula   ASoC: Fix bias po...
1359
  			break;
50b6bce59   Mark Brown   ASoC: Fix suspend...
1360
  		case SND_SOC_DAPM_STREAM_SUSPEND:
56fba41f8   Mark Brown   ASoC: Specify tar...
1361
  			dapm->target_bias_level = SND_SOC_BIAS_STANDBY;
50b6bce59   Mark Brown   ASoC: Fix suspend...
1362
  			break;
b14b76a56   Mark Brown   ASoC: Fix handlin...
1363
  		case SND_SOC_DAPM_STREAM_NOP:
56fba41f8   Mark Brown   ASoC: Specify tar...
1364
  			dapm->target_bias_level = dapm->bias_level;
50b6bce59   Mark Brown   ASoC: Fix suspend...
1365
  			break;
b14b76a56   Mark Brown   ASoC: Fix handlin...
1366
1367
1368
1369
  		default:
  			break;
  		}
  	}
85a843c50   Mark Brown   ASoC: Don't force...
1370
1371
1372
  	/* Force all contexts in the card to the same bias state if
  	 * they're not ground referenced.
  	 */
56fba41f8   Mark Brown   ASoC: Specify tar...
1373
  	bias = SND_SOC_BIAS_OFF;
52ba67bf8   Mark Brown   ASoC: Force all D...
1374
  	list_for_each_entry(d, &card->dapm_list, list)
56fba41f8   Mark Brown   ASoC: Specify tar...
1375
1376
  		if (d->target_bias_level > bias)
  			bias = d->target_bias_level;
52ba67bf8   Mark Brown   ASoC: Force all D...
1377
  	list_for_each_entry(d, &card->dapm_list, list)
85a843c50   Mark Brown   ASoC: Don't force...
1378
1379
  		if (!d->idle_bias_off)
  			d->target_bias_level = bias;
52ba67bf8   Mark Brown   ASoC: Force all D...
1380

de02d0786   Mark Brown   ASoC: Trace and c...
1381
  	trace_snd_soc_dapm_walk_done(card);
52ba67bf8   Mark Brown   ASoC: Force all D...
1382

9d0624a74   Mark Brown   ASoC: Run bias le...
1383
1384
1385
1386
1387
  	/* Run all the bias changes in parallel */
  	list_for_each_entry(d, &dapm->card->dapm_list, list)
  		async_schedule_domain(dapm_pre_sequence_async, d,
  					&async_domain);
  	async_synchronize_full_domain(&async_domain);
452c5eaa0   Mark Brown   ASoC: Integrate b...
1388

6d3ddc81f   Mark Brown   ASoC: Split DAPM ...
1389
  	/* Power down widgets first; try to avoid amplifying pops. */
828a842f2   Mark Brown   ASoC: Explicitly ...
1390
  	dapm_seq_run(dapm, &down_list, event, false);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1391

97404f2e0   Mark Brown   ASoC: Do DAPM con...
1392
  	dapm_widget_update(dapm);
6d3ddc81f   Mark Brown   ASoC: Split DAPM ...
1393
  	/* Now power up. */
828a842f2   Mark Brown   ASoC: Explicitly ...
1394
  	dapm_seq_run(dapm, &up_list, event, true);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1395

9d0624a74   Mark Brown   ASoC: Run bias le...
1396
1397
1398
1399
1400
  	/* Run all the bias changes in parallel */
  	list_for_each_entry(d, &dapm->card->dapm_list, list)
  		async_schedule_domain(dapm_post_sequence_async, d,
  					&async_domain);
  	async_synchronize_full_domain(&async_domain);
452c5eaa0   Mark Brown   ASoC: Integrate b...
1401

fd8d3bc09   Jarkko Nikula   ASoC: Convert pop...
1402
1403
1404
  	pop_dbg(dapm->dev, card->pop_time,
  		"DAPM sequencing finished, waiting %dms
  ", card->pop_time);
3a45b8672   Jarkko Nikula   ASoC: Move pop ti...
1405
  	pop_wait(card->pop_time);
cb507e7e7   Mark Brown   ASoC: Add pop del...
1406

84e909303   Mark Brown   ASoC: Add DAPM tr...
1407
  	trace_snd_soc_dapm_done(card);
42aa3418e   Mark Brown   ASoC: Factor out ...
1408
  	return 0;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1409
  }
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1410
1411
1412
1413
1414
1415
1416
1417
1418
1419
1420
1421
1422
1423
1424
1425
1426
1427
1428
1429
1430
1431
  #ifdef CONFIG_DEBUG_FS
  static int dapm_widget_power_open_file(struct inode *inode, struct file *file)
  {
  	file->private_data = inode->i_private;
  	return 0;
  }
  
  static ssize_t dapm_widget_power_read_file(struct file *file,
  					   char __user *user_buf,
  					   size_t count, loff_t *ppos)
  {
  	struct snd_soc_dapm_widget *w = file->private_data;
  	char *buf;
  	int in, out;
  	ssize_t ret;
  	struct snd_soc_dapm_path *p = NULL;
  
  	buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
  	if (!buf)
  		return -ENOMEM;
  
  	in = is_connected_input_ep(w);
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1432
  	dapm_clear_walk(w->dapm);
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1433
  	out = is_connected_output_ep(w);
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1434
  	dapm_clear_walk(w->dapm);
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1435

d033c36ae   Mark Brown   ASoC: Display the...
1436
  	ret = snprintf(buf, PAGE_SIZE, "%s: %s  in %d out %d",
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1437
  		       w->name, w->power ? "On" : "Off", in, out);
d033c36ae   Mark Brown   ASoC: Display the...
1438
1439
1440
1441
1442
1443
1444
  	if (w->reg >= 0)
  		ret += snprintf(buf + ret, PAGE_SIZE - ret,
  				" - R%d(0x%x) bit %d",
  				w->reg, w->reg, w->shift);
  
  	ret += snprintf(buf + ret, PAGE_SIZE - ret, "
  ");
3eef08ba5   Mark Brown   ASoC: Fix display...
1445
1446
1447
1448
1449
  	if (w->sname)
  		ret += snprintf(buf + ret, PAGE_SIZE - ret, " stream %s %s
  ",
  				w->sname,
  				w->active ? "active" : "inactive");
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1450
1451
  
  	list_for_each_entry(p, &w->sources, list_sink) {
215edda3a   Mark Brown   ASoC: Allow per-r...
1452
1453
  		if (p->connected && !p->connected(w, p->sink))
  			continue;
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1454
1455
  		if (p->connect)
  			ret += snprintf(buf + ret, PAGE_SIZE - ret,
67f5ed6e7   Dimitris Papastamos   ASoC: soc-dapm: I...
1456
1457
  					" in  \"%s\" \"%s\"
  ",
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1458
1459
1460
1461
  					p->name ? p->name : "static",
  					p->source->name);
  	}
  	list_for_each_entry(p, &w->sinks, list_source) {
215edda3a   Mark Brown   ASoC: Allow per-r...
1462
1463
  		if (p->connected && !p->connected(w, p->sink))
  			continue;
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1464
1465
  		if (p->connect)
  			ret += snprintf(buf + ret, PAGE_SIZE - ret,
67f5ed6e7   Dimitris Papastamos   ASoC: soc-dapm: I...
1466
1467
  					" out \"%s\" \"%s\"
  ",
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1468
1469
1470
1471
1472
1473
1474
1475
1476
1477
1478
1479
1480
  					p->name ? p->name : "static",
  					p->sink->name);
  	}
  
  	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
  
  	kfree(buf);
  	return ret;
  }
  
  static const struct file_operations dapm_widget_power_fops = {
  	.open = dapm_widget_power_open_file,
  	.read = dapm_widget_power_read_file,
6038f373a   Arnd Bergmann   llseek: automatic...
1481
  	.llseek = default_llseek,
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1482
  };
ef49e4fae   Mark Brown   ASoC: Add bias le...
1483
1484
1485
1486
1487
1488
1489
1490
1491
1492
1493
1494
1495
1496
1497
1498
1499
1500
1501
1502
1503
1504
1505
1506
1507
1508
1509
1510
1511
1512
1513
1514
1515
1516
1517
1518
1519
1520
1521
1522
1523
1524
1525
1526
1527
  static int dapm_bias_open_file(struct inode *inode, struct file *file)
  {
  	file->private_data = inode->i_private;
  	return 0;
  }
  
  static ssize_t dapm_bias_read_file(struct file *file, char __user *user_buf,
  				   size_t count, loff_t *ppos)
  {
  	struct snd_soc_dapm_context *dapm = file->private_data;
  	char *level;
  
  	switch (dapm->bias_level) {
  	case SND_SOC_BIAS_ON:
  		level = "On
  ";
  		break;
  	case SND_SOC_BIAS_PREPARE:
  		level = "Prepare
  ";
  		break;
  	case SND_SOC_BIAS_STANDBY:
  		level = "Standby
  ";
  		break;
  	case SND_SOC_BIAS_OFF:
  		level = "Off
  ";
  		break;
  	default:
  		BUG();
  		level = "Unknown
  ";
  		break;
  	}
  
  	return simple_read_from_buffer(user_buf, count, ppos, level,
  				       strlen(level));
  }
  
  static const struct file_operations dapm_bias_fops = {
  	.open = dapm_bias_open_file,
  	.read = dapm_bias_read_file,
  	.llseek = default_llseek,
  };
8eecaf624   Lars-Peter Clausen   ASoC: Move DAPM d...
1528
1529
  void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
  	struct dentry *parent)
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1530
  {
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1531
  	struct dentry *d;
8eecaf624   Lars-Peter Clausen   ASoC: Move DAPM d...
1532
1533
1534
1535
1536
1537
  	dapm->debugfs_dapm = debugfs_create_dir("dapm", parent);
  
  	if (!dapm->debugfs_dapm) {
  		printk(KERN_WARNING
  		       "Failed to create DAPM debugfs directory
  ");
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1538
  		return;
8eecaf624   Lars-Peter Clausen   ASoC: Move DAPM d...
1539
  	}
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1540

ef49e4fae   Mark Brown   ASoC: Add bias le...
1541
1542
1543
1544
1545
1546
1547
  	d = debugfs_create_file("bias_level", 0444,
  				dapm->debugfs_dapm, dapm,
  				&dapm_bias_fops);
  	if (!d)
  		dev_warn(dapm->dev,
  			 "ASoC: Failed to create bias level debugfs file
  ");
d5d1e0bef   Lars-Peter Clausen   ASoC: Move DAPM w...
1548
  }
ef49e4fae   Mark Brown   ASoC: Add bias le...
1549

d5d1e0bef   Lars-Peter Clausen   ASoC: Move DAPM w...
1550
1551
1552
1553
  static void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
  {
  	struct snd_soc_dapm_context *dapm = w->dapm;
  	struct dentry *d;
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1554

d5d1e0bef   Lars-Peter Clausen   ASoC: Move DAPM w...
1555
1556
1557
1558
1559
1560
1561
1562
1563
1564
1565
  	if (!dapm->debugfs_dapm || !w->name)
  		return;
  
  	d = debugfs_create_file(w->name, 0444,
  				dapm->debugfs_dapm, w,
  				&dapm_widget_power_fops);
  	if (!d)
  		dev_warn(w->dapm->dev,
  			"ASoC: Failed to create %s debugfs file
  ",
  			w->name);
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1566
  }
d5d1e0bef   Lars-Peter Clausen   ASoC: Move DAPM w...
1567

6c45e1265   Lars-Peter Clausen   ASoC: Remove DAPM...
1568
1569
1570
1571
  static void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
  {
  	debugfs_remove_recursive(dapm->debugfs_dapm);
  }
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1572
  #else
8eecaf624   Lars-Peter Clausen   ASoC: Move DAPM d...
1573
1574
  void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
  	struct dentry *parent)
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1575
1576
  {
  }
d5d1e0bef   Lars-Peter Clausen   ASoC: Move DAPM w...
1577
1578
1579
1580
  
  static inline void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
  {
  }
6c45e1265   Lars-Peter Clausen   ASoC: Remove DAPM...
1581
1582
1583
  static inline void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
  {
  }
79fb9387f   Mark Brown   ASoC: Add DAPM wi...
1584
  #endif
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1585
  /* test and update the power status of a mux widget */
d9c96cf35   Adrian Bunk   [ALSA] sound/soc/...
1586
  static int dapm_mux_update_power(struct snd_soc_dapm_widget *widget,
3a65577d2   Mark Brown   ASoC: Push DAPM e...
1587
1588
  				 struct snd_kcontrol *kcontrol, int change,
  				 int mux, struct soc_enum *e)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1589
1590
1591
  {
  	struct snd_soc_dapm_path *path;
  	int found = 0;
eff317d08   Peter Ujfalusi   ASoC: Fix the pow...
1592
  	if (widget->id != snd_soc_dapm_mux &&
24ff33ac6   Dimitris Papastamos   ASoC: soc-dapm: I...
1593
  	    widget->id != snd_soc_dapm_virt_mux &&
eff317d08   Peter Ujfalusi   ASoC: Fix the pow...
1594
  	    widget->id != snd_soc_dapm_value_mux)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1595
  		return -ENODEV;
3a65577d2   Mark Brown   ASoC: Push DAPM e...
1596
  	if (!change)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1597
1598
1599
  		return 0;
  
  	/* find dapm widget path assoc with kcontrol */
8ddab3f51   Jarkko Nikula   ASoC: Move DAPM p...
1600
  	list_for_each_entry(path, &widget->dapm->card->paths, list) {
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1601
1602
  		if (path->kcontrol != kcontrol)
  			continue;
cb01e2b99   Richard Zhao   ALSA: ASoC: add n...
1603
  		if (!path->name || !e->texts[mux])
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1604
1605
1606
1607
  			continue;
  
  		found = 1;
  		/* we now need to match the string in the enum to the path */
db432b414   Mark Brown   ASoC: Do DAPM pow...
1608
  		if (!(strcmp(path->name, e->texts[mux]))) {
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1609
  			path->connect = 1; /* new connection */
75c1f891b   Mark Brown   ASoC: Add verbose...
1610
  			dapm_mark_dirty(path->source, "mux connection");
db432b414   Mark Brown   ASoC: Do DAPM pow...
1611
1612
  		} else {
  			if (path->connect)
75c1f891b   Mark Brown   ASoC: Add verbose...
1613
1614
  				dapm_mark_dirty(path->source,
  						"mux disconnection");
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1615
  			path->connect = 0; /* old connection must be powered down */
db432b414   Mark Brown   ASoC: Do DAPM pow...
1616
  		}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1617
  	}
db432b414   Mark Brown   ASoC: Do DAPM pow...
1618
  	if (found) {
75c1f891b   Mark Brown   ASoC: Add verbose...
1619
  		dapm_mark_dirty(widget, "mux change");
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1620
  		dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
db432b414   Mark Brown   ASoC: Do DAPM pow...
1621
  	}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1622
1623
1624
  
  	return 0;
  }
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1625

1b075e3f7   Milan plzik   [ALSA] soc - Fix ...
1626
  /* test and update the power status of a mixer or switch widget */
d9c96cf35   Adrian Bunk   [ALSA] sound/soc/...
1627
  static int dapm_mixer_update_power(struct snd_soc_dapm_widget *widget,
283375cef   Mark Brown   ASoC: Push regist...
1628
  				   struct snd_kcontrol *kcontrol, int connect)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1629
1630
1631
  {
  	struct snd_soc_dapm_path *path;
  	int found = 0;
1b075e3f7   Milan plzik   [ALSA] soc - Fix ...
1632
  	if (widget->id != snd_soc_dapm_mixer &&
ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
1633
  	    widget->id != snd_soc_dapm_mixer_named_ctl &&
1b075e3f7   Milan plzik   [ALSA] soc - Fix ...
1634
  	    widget->id != snd_soc_dapm_switch)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1635
  		return -ENODEV;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1636
  	/* find dapm widget path assoc with kcontrol */
8ddab3f51   Jarkko Nikula   ASoC: Move DAPM p...
1637
  	list_for_each_entry(path, &widget->dapm->card->paths, list) {
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1638
1639
1640
1641
1642
  		if (path->kcontrol != kcontrol)
  			continue;
  
  		/* found, now check type */
  		found = 1;
283375cef   Mark Brown   ASoC: Push regist...
1643
  		path->connect = connect;
75c1f891b   Mark Brown   ASoC: Add verbose...
1644
  		dapm_mark_dirty(path->source, "mixer connection");
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1645
  	}
db432b414   Mark Brown   ASoC: Do DAPM pow...
1646
  	if (found) {
75c1f891b   Mark Brown   ASoC: Add verbose...
1647
  		dapm_mark_dirty(widget, "mixer update");
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1648
  		dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
db432b414   Mark Brown   ASoC: Do DAPM pow...
1649
  	}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1650
1651
1652
  
  	return 0;
  }
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1653
1654
1655
1656
1657
  
  /* show dapm widget status in sys fs */
  static ssize_t dapm_widget_show(struct device *dev,
  	struct device_attribute *attr, char *buf)
  {
36ae1a96c   Mark Brown   ASoC: Dynamically...
1658
  	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
f0fba2ad1   Liam Girdwood   ASoC: multi-compo...
1659
  	struct snd_soc_codec *codec =rtd->codec;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1660
1661
1662
  	struct snd_soc_dapm_widget *w;
  	int count = 0;
  	char *state = "not set";
97c866def   Jarkko Nikula   ASoC: Move widget...
1663
1664
1665
  	list_for_each_entry(w, &codec->card->widgets, list) {
  		if (w->dapm != &codec->dapm)
  			continue;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1666
1667
1668
1669
1670
1671
1672
1673
1674
1675
1676
  
  		/* only display widgets that burnm power */
  		switch (w->id) {
  		case snd_soc_dapm_hp:
  		case snd_soc_dapm_mic:
  		case snd_soc_dapm_spk:
  		case snd_soc_dapm_line:
  		case snd_soc_dapm_micbias:
  		case snd_soc_dapm_dac:
  		case snd_soc_dapm_adc:
  		case snd_soc_dapm_pga:
d88429a69   Olaya, Margarita   ASoC: dapm: Add o...
1677
  		case snd_soc_dapm_out_drv:
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1678
  		case snd_soc_dapm_mixer:
ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
1679
  		case snd_soc_dapm_mixer_named_ctl:
246d0a17f   Mark Brown   ASoC: Add power s...
1680
  		case snd_soc_dapm_supply:
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1681
1682
1683
1684
1685
1686
1687
1688
1689
  			if (w->name)
  				count += sprintf(buf + count, "%s: %s
  ",
  					w->name, w->power ? "On":"Off");
  		break;
  		default:
  		break;
  		}
  	}
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1690
  	switch (codec->dapm.bias_level) {
0be9898ad   Mark Brown   [ALSA] ASoC: Clar...
1691
1692
  	case SND_SOC_BIAS_ON:
  		state = "On";
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1693
  		break;
0be9898ad   Mark Brown   [ALSA] ASoC: Clar...
1694
1695
  	case SND_SOC_BIAS_PREPARE:
  		state = "Prepare";
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1696
  		break;
0be9898ad   Mark Brown   [ALSA] ASoC: Clar...
1697
1698
  	case SND_SOC_BIAS_STANDBY:
  		state = "Standby";
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1699
  		break;
0be9898ad   Mark Brown   [ALSA] ASoC: Clar...
1700
1701
  	case SND_SOC_BIAS_OFF:
  		state = "Off";
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1702
1703
1704
1705
1706
1707
1708
1709
1710
1711
1712
1713
  		break;
  	}
  	count += sprintf(buf + count, "PM State: %s
  ", state);
  
  	return count;
  }
  
  static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL);
  
  int snd_soc_dapm_sys_add(struct device *dev)
  {
12ef193d5   Troy Kisky   ASoC: Allow setti...
1714
  	return device_create_file(dev, &dev_attr_dapm_widget);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1715
1716
1717
1718
  }
  
  static void snd_soc_dapm_sys_remove(struct device *dev)
  {
aef908434   Mark Brown   ASoC: Make DAPM s...
1719
  	device_remove_file(dev, &dev_attr_dapm_widget);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1720
1721
1722
  }
  
  /* free all dapm widgets and resources */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1723
  static void dapm_free_widgets(struct snd_soc_dapm_context *dapm)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1724
1725
1726
  {
  	struct snd_soc_dapm_widget *w, *next_w;
  	struct snd_soc_dapm_path *p, *next_p;
97c866def   Jarkko Nikula   ASoC: Move widget...
1727
1728
1729
  	list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) {
  		if (w->dapm != dapm)
  			continue;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1730
  		list_del(&w->list);
8ddab3f51   Jarkko Nikula   ASoC: Move DAPM p...
1731
1732
1733
1734
1735
1736
1737
1738
1739
1740
1741
1742
1743
1744
1745
1746
1747
1748
1749
  		/*
  		 * remove source and sink paths associated to this widget.
  		 * While removing the path, remove reference to it from both
  		 * source and sink widgets so that path is removed only once.
  		 */
  		list_for_each_entry_safe(p, next_p, &w->sources, list_sink) {
  			list_del(&p->list_sink);
  			list_del(&p->list_source);
  			list_del(&p->list);
  			kfree(p->long_name);
  			kfree(p);
  		}
  		list_for_each_entry_safe(p, next_p, &w->sinks, list_source) {
  			list_del(&p->list_sink);
  			list_del(&p->list_source);
  			list_del(&p->list);
  			kfree(p->long_name);
  			kfree(p);
  		}
fad598887   Stephen Warren   ASoC: Add w->kcon...
1750
  		kfree(w->kcontrols);
ead9b9199   Jarkko Nikula   ASoC: Add optiona...
1751
  		kfree(w->name);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1752
1753
  		kfree(w);
  	}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1754
  }
91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
1755
1756
1757
  static struct snd_soc_dapm_widget *dapm_find_widget(
  			struct snd_soc_dapm_context *dapm, const char *pin,
  			bool search_other_contexts)
a5302181e   Liam Girdwood   ALSA: asoc: core ...
1758
1759
  {
  	struct snd_soc_dapm_widget *w;
91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
1760
  	struct snd_soc_dapm_widget *fallback = NULL;
a5302181e   Liam Girdwood   ALSA: asoc: core ...
1761

97c866def   Jarkko Nikula   ASoC: Move widget...
1762
  	list_for_each_entry(w, &dapm->card->widgets, list) {
a5302181e   Liam Girdwood   ALSA: asoc: core ...
1763
  		if (!strcmp(w->name, pin)) {
91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
1764
1765
1766
1767
  			if (w->dapm == dapm)
  				return w;
  			else
  				fallback = w;
a5302181e   Liam Girdwood   ALSA: asoc: core ...
1768
1769
  		}
  	}
91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
1770
1771
1772
1773
1774
1775
1776
1777
1778
1779
1780
1781
1782
1783
1784
  	if (search_other_contexts)
  		return fallback;
  
  	return NULL;
  }
  
  static int snd_soc_dapm_set_pin(struct snd_soc_dapm_context *dapm,
  				const char *pin, int status)
  {
  	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
  
  	if (!w) {
  		dev_err(dapm->dev, "dapm: unknown pin %s
  ", pin);
  		return -EINVAL;
0d86733cc   Mark Brown   ASoC: Allow DAPM ...
1785
  	}
91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
1786
1787
1788
  	w->connected = status;
  	if (status == 0)
  		w->force = 0;
75c1f891b   Mark Brown   ASoC: Add verbose...
1789
  	dapm_mark_dirty(w, "pin configuration");
91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
1790
1791
  
  	return 0;
a5302181e   Liam Girdwood   ALSA: asoc: core ...
1792
  }
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1793
  /**
a5302181e   Liam Girdwood   ALSA: asoc: core ...
1794
   * snd_soc_dapm_sync - scan and power dapm paths
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1795
   * @dapm: DAPM context
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1796
1797
1798
1799
1800
1801
   *
   * Walks all dapm audio paths and powers widgets according to their
   * stream or path usage.
   *
   * Returns 0 for success.
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1802
  int snd_soc_dapm_sync(struct snd_soc_dapm_context *dapm)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1803
  {
4f4c00722   Mark Brown   ASoC: Suppress ea...
1804
1805
1806
1807
1808
1809
  	/*
  	 * Suppress early reports (eg, jacks syncing their state) to avoid
  	 * silly DAPM runs during card startup.
  	 */
  	if (!dapm->card || !dapm->card->instantiated)
  		return 0;
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1810
  	return dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1811
  }
a5302181e   Liam Girdwood   ALSA: asoc: core ...
1812
  EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1813

ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1814
  static int snd_soc_dapm_add_route(struct snd_soc_dapm_context *dapm,
215edda3a   Mark Brown   ASoC: Allow per-r...
1815
  				  const struct snd_soc_dapm_route *route)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1816
1817
1818
  {
  	struct snd_soc_dapm_path *path;
  	struct snd_soc_dapm_widget *wsource = NULL, *wsink = NULL, *w;
97c866def   Jarkko Nikula   ASoC: Move widget...
1819
  	struct snd_soc_dapm_widget *wtsource = NULL, *wtsink = NULL;
ead9b9199   Jarkko Nikula   ASoC: Add optiona...
1820
  	const char *sink;
215edda3a   Mark Brown   ASoC: Allow per-r...
1821
  	const char *control = route->control;
ead9b9199   Jarkko Nikula   ASoC: Add optiona...
1822
1823
1824
  	const char *source;
  	char prefixed_sink[80];
  	char prefixed_source[80];
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1825
  	int ret = 0;
88e8b9a84   Mark Brown   ASoC: Check for a...
1826
  	if (dapm->codec && dapm->codec->name_prefix) {
ead9b9199   Jarkko Nikula   ASoC: Add optiona...
1827
1828
1829
1830
1831
1832
1833
1834
1835
1836
  		snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
  			 dapm->codec->name_prefix, route->sink);
  		sink = prefixed_sink;
  		snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
  			 dapm->codec->name_prefix, route->source);
  		source = prefixed_source;
  	} else {
  		sink = route->sink;
  		source = route->source;
  	}
97c866def   Jarkko Nikula   ASoC: Move widget...
1837
1838
1839
1840
1841
  	/*
  	 * find src and dest widgets over all widgets but favor a widget from
  	 * current DAPM context
  	 */
  	list_for_each_entry(w, &dapm->card->widgets, list) {
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1842
  		if (!wsink && !(strcmp(w->name, sink))) {
97c866def   Jarkko Nikula   ASoC: Move widget...
1843
1844
1845
  			wtsink = w;
  			if (w->dapm == dapm)
  				wsink = w;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1846
1847
1848
  			continue;
  		}
  		if (!wsource && !(strcmp(w->name, source))) {
97c866def   Jarkko Nikula   ASoC: Move widget...
1849
1850
1851
  			wtsource = w;
  			if (w->dapm == dapm)
  				wsource = w;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1852
1853
  		}
  	}
97c866def   Jarkko Nikula   ASoC: Move widget...
1854
1855
1856
1857
1858
  	/* use widget from another DAPM context if not found from this */
  	if (!wsink)
  		wsink = wtsink;
  	if (!wsource)
  		wsource = wtsource;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1859
1860
1861
1862
1863
1864
1865
1866
1867
1868
  
  	if (wsource == NULL || wsink == NULL)
  		return -ENODEV;
  
  	path = kzalloc(sizeof(struct snd_soc_dapm_path), GFP_KERNEL);
  	if (!path)
  		return -ENOMEM;
  
  	path->source = wsource;
  	path->sink = wsink;
215edda3a   Mark Brown   ASoC: Allow per-r...
1869
  	path->connected = route->connected;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1870
1871
1872
1873
1874
1875
1876
1877
  	INIT_LIST_HEAD(&path->list);
  	INIT_LIST_HEAD(&path->list_source);
  	INIT_LIST_HEAD(&path->list_sink);
  
  	/* check for external widgets */
  	if (wsink->id == snd_soc_dapm_input) {
  		if (wsource->id == snd_soc_dapm_micbias ||
  			wsource->id == snd_soc_dapm_mic ||
087d53ab1   Rongrong Cao   ASoC: fix checkin...
1878
1879
  			wsource->id == snd_soc_dapm_line ||
  			wsource->id == snd_soc_dapm_output)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1880
1881
1882
1883
1884
  			wsink->ext = 1;
  	}
  	if (wsource->id == snd_soc_dapm_output) {
  		if (wsink->id == snd_soc_dapm_spk ||
  			wsink->id == snd_soc_dapm_hp ||
1e39221eb   Seth Forshee   [ALSA] ASoC DAPM ...
1885
1886
  			wsink->id == snd_soc_dapm_line ||
  			wsink->id == snd_soc_dapm_input)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1887
1888
1889
1890
1891
  			wsource->ext = 1;
  	}
  
  	/* connect static paths */
  	if (control == NULL) {
8ddab3f51   Jarkko Nikula   ASoC: Move DAPM p...
1892
  		list_add(&path->list, &dapm->card->paths);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1893
1894
1895
1896
1897
1898
1899
  		list_add(&path->list_sink, &wsink->sources);
  		list_add(&path->list_source, &wsource->sinks);
  		path->connect = 1;
  		return 0;
  	}
  
  	/* connect dynamic paths */
dc2bea616   Lu Guanqun   ASoC: fix a simpl...
1900
  	switch (wsink->id) {
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1901
1902
1903
  	case snd_soc_dapm_adc:
  	case snd_soc_dapm_dac:
  	case snd_soc_dapm_pga:
d88429a69   Olaya, Margarita   ASoC: dapm: Add o...
1904
  	case snd_soc_dapm_out_drv:
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1905
1906
  	case snd_soc_dapm_input:
  	case snd_soc_dapm_output:
1ab97c8ca   Mark Brown   ASoC: Add signal ...
1907
  	case snd_soc_dapm_siggen:
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1908
1909
1910
1911
  	case snd_soc_dapm_micbias:
  	case snd_soc_dapm_vmid:
  	case snd_soc_dapm_pre:
  	case snd_soc_dapm_post:
246d0a17f   Mark Brown   ASoC: Add power s...
1912
  	case snd_soc_dapm_supply:
010ff2622   Mark Brown   ASoC: Add input a...
1913
1914
  	case snd_soc_dapm_aif_in:
  	case snd_soc_dapm_aif_out:
8ddab3f51   Jarkko Nikula   ASoC: Move DAPM p...
1915
  		list_add(&path->list, &dapm->card->paths);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1916
1917
1918
1919
1920
  		list_add(&path->list_sink, &wsink->sources);
  		list_add(&path->list_source, &wsource->sinks);
  		path->connect = 1;
  		return 0;
  	case snd_soc_dapm_mux:
24ff33ac6   Dimitris Papastamos   ASoC: soc-dapm: I...
1921
  	case snd_soc_dapm_virt_mux:
741555568   Peter Ujfalusi   ASoC: Merge the s...
1922
  	case snd_soc_dapm_value_mux:
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1923
  		ret = dapm_connect_mux(dapm, wsource, wsink, path, control,
82cfecdc0   Stephen Warren   ASoC: s/w->kcontr...
1924
  			&wsink->kcontrol_news[0]);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1925
1926
1927
1928
1929
  		if (ret != 0)
  			goto err;
  		break;
  	case snd_soc_dapm_switch:
  	case snd_soc_dapm_mixer:
ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
1930
  	case snd_soc_dapm_mixer_named_ctl:
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1931
  		ret = dapm_connect_mixer(dapm, wsource, wsink, path, control);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1932
1933
1934
1935
1936
1937
1938
  		if (ret != 0)
  			goto err;
  		break;
  	case snd_soc_dapm_hp:
  	case snd_soc_dapm_mic:
  	case snd_soc_dapm_line:
  	case snd_soc_dapm_spk:
8ddab3f51   Jarkko Nikula   ASoC: Move DAPM p...
1939
  		list_add(&path->list, &dapm->card->paths);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1940
1941
1942
1943
1944
1945
1946
1947
  		list_add(&path->list_sink, &wsink->sources);
  		list_add(&path->list_source, &wsource->sinks);
  		path->connect = 0;
  		return 0;
  	}
  	return 0;
  
  err:
f7d41ae83   Jarkko Nikula   ASoC: Update DAPM...
1948
1949
1950
  	dev_warn(dapm->dev, "asoc: no dapm match for %s --> %s --> %s
  ",
  		 source, control, sink);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
1951
1952
1953
  	kfree(path);
  	return ret;
  }
105f1c284   Mark Brown   [ALSA] soc - DAPM...
1954
1955
  
  /**
105f1c284   Mark Brown   [ALSA] soc - DAPM...
1956
   * snd_soc_dapm_add_routes - Add routes between DAPM widgets
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1957
   * @dapm: DAPM context
105f1c284   Mark Brown   [ALSA] soc - DAPM...
1958
1959
1960
1961
1962
1963
1964
1965
1966
1967
   * @route: audio routes
   * @num: number of routes
   *
   * Connects 2 dapm widgets together via a named audio path. The sink is
   * the widget receiving the audio signal, whilst the source is the sender
   * of the audio signal.
   *
   * Returns 0 for success else error. On error all resources can be freed
   * with a call to snd_soc_card_free().
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1968
  int snd_soc_dapm_add_routes(struct snd_soc_dapm_context *dapm,
105f1c284   Mark Brown   [ALSA] soc - DAPM...
1969
1970
1971
1972
1973
  			    const struct snd_soc_dapm_route *route, int num)
  {
  	int i, ret;
  
  	for (i = 0; i < num; i++) {
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
1974
  		ret = snd_soc_dapm_add_route(dapm, route);
105f1c284   Mark Brown   [ALSA] soc - DAPM...
1975
  		if (ret < 0) {
f7d41ae83   Jarkko Nikula   ASoC: Update DAPM...
1976
1977
1978
  			dev_err(dapm->dev, "Failed to add route %s->%s
  ",
  				route->source, route->sink);
105f1c284   Mark Brown   [ALSA] soc - DAPM...
1979
1980
1981
1982
1983
1984
1985
1986
  			return ret;
  		}
  		route++;
  	}
  
  	return 0;
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);
bf3a9e137   Mark Brown   ASoC: Add weak ro...
1987
1988
1989
1990
1991
1992
1993
1994
1995
1996
1997
1998
1999
2000
2001
2002
2003
2004
2005
2006
2007
2008
2009
2010
2011
2012
2013
2014
2015
2016
2017
2018
2019
2020
2021
2022
2023
2024
2025
2026
2027
2028
2029
2030
2031
2032
2033
2034
2035
2036
2037
2038
2039
2040
2041
2042
2043
2044
2045
2046
2047
2048
2049
2050
2051
2052
2053
2054
2055
2056
2057
2058
2059
2060
2061
2062
2063
2064
2065
2066
2067
2068
  static int snd_soc_dapm_weak_route(struct snd_soc_dapm_context *dapm,
  				   const struct snd_soc_dapm_route *route)
  {
  	struct snd_soc_dapm_widget *source = dapm_find_widget(dapm,
  							      route->source,
  							      true);
  	struct snd_soc_dapm_widget *sink = dapm_find_widget(dapm,
  							    route->sink,
  							    true);
  	struct snd_soc_dapm_path *path;
  	int count = 0;
  
  	if (!source) {
  		dev_err(dapm->dev, "Unable to find source %s for weak route
  ",
  			route->source);
  		return -ENODEV;
  	}
  
  	if (!sink) {
  		dev_err(dapm->dev, "Unable to find sink %s for weak route
  ",
  			route->sink);
  		return -ENODEV;
  	}
  
  	if (route->control || route->connected)
  		dev_warn(dapm->dev, "Ignoring control for weak route %s->%s
  ",
  			 route->source, route->sink);
  
  	list_for_each_entry(path, &source->sinks, list_source) {
  		if (path->sink == sink) {
  			path->weak = 1;
  			count++;
  		}
  	}
  
  	if (count == 0)
  		dev_err(dapm->dev, "No path found for weak route %s->%s
  ",
  			route->source, route->sink);
  	if (count > 1)
  		dev_warn(dapm->dev, "%d paths found for weak route %s->%s
  ",
  			 count, route->source, route->sink);
  
  	return 0;
  }
  
  /**
   * snd_soc_dapm_weak_routes - Mark routes between DAPM widgets as weak
   * @dapm: DAPM context
   * @route: audio routes
   * @num: number of routes
   *
   * Mark existing routes matching those specified in the passed array
   * as being weak, meaning that they are ignored for the purpose of
   * power decisions.  The main intended use case is for sidetone paths
   * which couple audio between other independent paths if they are both
   * active in order to make the combination work better at the user
   * level but which aren't intended to be "used".
   *
   * Note that CODEC drivers should not use this as sidetone type paths
   * can frequently also be used as bypass paths.
   */
  int snd_soc_dapm_weak_routes(struct snd_soc_dapm_context *dapm,
  			     const struct snd_soc_dapm_route *route, int num)
  {
  	int i, err;
  	int ret = 0;
  
  	for (i = 0; i < num; i++) {
  		err = snd_soc_dapm_weak_route(dapm, route);
  		if (err)
  			ret = err;
  		route++;
  	}
  
  	return ret;
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_weak_routes);
105f1c284   Mark Brown   [ALSA] soc - DAPM...
2069
  /**
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2070
   * snd_soc_dapm_new_widgets - add new dapm widgets
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2071
   * @dapm: DAPM context
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2072
2073
2074
2075
2076
   *
   * Checks the codec for any new dapm widgets and creates them if found.
   *
   * Returns 0 for success.
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2077
  int snd_soc_dapm_new_widgets(struct snd_soc_dapm_context *dapm)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2078
2079
  {
  	struct snd_soc_dapm_widget *w;
b66a70d5e   Mark Brown   ASoC: Sync initia...
2080
  	unsigned int val;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2081

97c866def   Jarkko Nikula   ASoC: Move widget...
2082
  	list_for_each_entry(w, &dapm->card->widgets, list)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2083
2084
2085
  	{
  		if (w->new)
  			continue;
fad598887   Stephen Warren   ASoC: Add w->kcon...
2086
2087
2088
2089
2090
2091
2092
  		if (w->num_kcontrols) {
  			w->kcontrols = kzalloc(w->num_kcontrols *
  						sizeof(struct snd_kcontrol *),
  						GFP_KERNEL);
  			if (!w->kcontrols)
  				return -ENOMEM;
  		}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2093
2094
2095
  		switch(w->id) {
  		case snd_soc_dapm_switch:
  		case snd_soc_dapm_mixer:
ca9c1aaec   Ian Molton   ASoC: dapm: Allow...
2096
  		case snd_soc_dapm_mixer_named_ctl:
4b80b8c2e   Lars-Peter Clausen   ASoC: snd_soc_new...
2097
  			dapm_new_mixer(w);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2098
2099
  			break;
  		case snd_soc_dapm_mux:
24ff33ac6   Dimitris Papastamos   ASoC: soc-dapm: I...
2100
  		case snd_soc_dapm_virt_mux:
2e72f8e37   Peter Ujfalusi   ASoC: New enum ty...
2101
  		case snd_soc_dapm_value_mux:
4b80b8c2e   Lars-Peter Clausen   ASoC: snd_soc_new...
2102
  			dapm_new_mux(w);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2103
  			break;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2104
  		case snd_soc_dapm_pga:
d88429a69   Olaya, Margarita   ASoC: dapm: Add o...
2105
  		case snd_soc_dapm_out_drv:
4b80b8c2e   Lars-Peter Clausen   ASoC: snd_soc_new...
2106
  			dapm_new_pga(w);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2107
  			break;
7ca3a18b0   Mark Brown   ASoC: Assign powe...
2108
  		default:
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2109
2110
  			break;
  		}
b66a70d5e   Mark Brown   ASoC: Sync initia...
2111
2112
2113
  
  		/* Read the initial power state from the device */
  		if (w->reg >= 0) {
0445bdf4a   Liam Girdwood   ASoC: dapm - Refa...
2114
  			val = soc_widget_read(w, w->reg);
b66a70d5e   Mark Brown   ASoC: Sync initia...
2115
2116
2117
2118
2119
2120
2121
  			val &= 1 << w->shift;
  			if (w->invert)
  				val = !val;
  
  			if (val)
  				w->power = 1;
  		}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2122
  		w->new = 1;
d5d1e0bef   Lars-Peter Clausen   ASoC: Move DAPM w...
2123

7508b12a8   Mark Brown   ASoC: Use dapm_ma...
2124
  		dapm_mark_dirty(w, "new widget");
d5d1e0bef   Lars-Peter Clausen   ASoC: Move DAPM w...
2125
  		dapm_debugfs_add_widget(w);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2126
  	}
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2127
  	dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2128
2129
2130
2131
2132
2133
2134
  	return 0;
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_new_widgets);
  
  /**
   * snd_soc_dapm_get_volsw - dapm mixer get callback
   * @kcontrol: mixer control
ac11a2b35   Mark Brown   ASoC: Clean up ke...
2135
   * @ucontrol: control element information
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2136
2137
2138
2139
2140
2141
2142
2143
   *
   * Callback to get the value of a dapm mixer control.
   *
   * Returns 0 for success.
   */
  int snd_soc_dapm_get_volsw(struct snd_kcontrol *kcontrol,
  	struct snd_ctl_elem_value *ucontrol)
  {
fafd2176f   Stephen Warren   ASoC: Store a lis...
2144
2145
  	struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
  	struct snd_soc_dapm_widget *widget = wlist->widgets[0];
4eaa9819d   Jon Smirl   ALSA: ASoC: Conve...
2146
2147
  	struct soc_mixer_control *mc =
  		(struct soc_mixer_control *)kcontrol->private_value;
815ecf8de   Jon Smirl   ALSA: ASoC: conve...
2148
2149
2150
  	unsigned int reg = mc->reg;
  	unsigned int shift = mc->shift;
  	unsigned int rshift = mc->rshift;
4eaa9819d   Jon Smirl   ALSA: ASoC: Conve...
2151
  	int max = mc->max;
815ecf8de   Jon Smirl   ALSA: ASoC: conve...
2152
2153
  	unsigned int invert = mc->invert;
  	unsigned int mask = (1 << fls(max)) - 1;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2154

2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2155
2156
2157
2158
2159
2160
2161
  	ucontrol->value.integer.value[0] =
  		(snd_soc_read(widget->codec, reg) >> shift) & mask;
  	if (shift != rshift)
  		ucontrol->value.integer.value[1] =
  			(snd_soc_read(widget->codec, reg) >> rshift) & mask;
  	if (invert) {
  		ucontrol->value.integer.value[0] =
a7a4ac86b   Philipp Zabel   [ALSA] ASoC TLV s...
2162
  			max - ucontrol->value.integer.value[0];
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2163
2164
  		if (shift != rshift)
  			ucontrol->value.integer.value[1] =
a7a4ac86b   Philipp Zabel   [ALSA] ASoC TLV s...
2165
  				max - ucontrol->value.integer.value[1];
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2166
2167
2168
2169
2170
2171
2172
2173
2174
  	}
  
  	return 0;
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);
  
  /**
   * snd_soc_dapm_put_volsw - dapm mixer set callback
   * @kcontrol: mixer control
ac11a2b35   Mark Brown   ASoC: Clean up ke...
2175
   * @ucontrol: control element information
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2176
2177
2178
2179
2180
2181
2182
2183
   *
   * Callback to set the value of a dapm mixer control.
   *
   * Returns 0 for success.
   */
  int snd_soc_dapm_put_volsw(struct snd_kcontrol *kcontrol,
  	struct snd_ctl_elem_value *ucontrol)
  {
fafd2176f   Stephen Warren   ASoC: Store a lis...
2184
2185
2186
  	struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
  	struct snd_soc_dapm_widget *widget = wlist->widgets[0];
  	struct snd_soc_codec *codec = widget->codec;
4eaa9819d   Jon Smirl   ALSA: ASoC: Conve...
2187
2188
  	struct soc_mixer_control *mc =
  		(struct soc_mixer_control *)kcontrol->private_value;
815ecf8de   Jon Smirl   ALSA: ASoC: conve...
2189
2190
  	unsigned int reg = mc->reg;
  	unsigned int shift = mc->shift;
4eaa9819d   Jon Smirl   ALSA: ASoC: Conve...
2191
  	int max = mc->max;
815ecf8de   Jon Smirl   ALSA: ASoC: conve...
2192
2193
  	unsigned int mask = (1 << fls(max)) - 1;
  	unsigned int invert = mc->invert;
e9cf70493   Stephen Warren   ASoC: Fix mask/va...
2194
  	unsigned int val;
97404f2e0   Mark Brown   ASoC: Do DAPM con...
2195
2196
  	int connect, change;
  	struct snd_soc_dapm_update update;
fafd2176f   Stephen Warren   ASoC: Store a lis...
2197
  	int wi;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2198
2199
2200
2201
  
  	val = (ucontrol->value.integer.value[0] & mask);
  
  	if (invert)
a7a4ac86b   Philipp Zabel   [ALSA] ASoC TLV s...
2202
  		val = max - val;
e9cf70493   Stephen Warren   ASoC: Fix mask/va...
2203
  	mask = mask << shift;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2204
  	val = val << shift;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2205

fafd2176f   Stephen Warren   ASoC: Store a lis...
2206
2207
2208
2209
2210
2211
2212
2213
  	if (val)
  		/* new connection */
  		connect = invert ? 0 : 1;
  	else
  		/* old connection must be powered down */
  		connect = invert ? 1 : 0;
  
  	mutex_lock(&codec->mutex);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2214

e9cf70493   Stephen Warren   ASoC: Fix mask/va...
2215
  	change = snd_soc_test_bits(widget->codec, reg, mask, val);
97404f2e0   Mark Brown   ASoC: Do DAPM con...
2216
  	if (change) {
fafd2176f   Stephen Warren   ASoC: Store a lis...
2217
2218
  		for (wi = 0; wi < wlist->num_widgets; wi++) {
  			widget = wlist->widgets[wi];
283375cef   Mark Brown   ASoC: Push regist...
2219

fafd2176f   Stephen Warren   ASoC: Store a lis...
2220
  			widget->value = val;
97404f2e0   Mark Brown   ASoC: Do DAPM con...
2221

fafd2176f   Stephen Warren   ASoC: Store a lis...
2222
2223
2224
2225
2226
2227
  			update.kcontrol = kcontrol;
  			update.widget = widget;
  			update.reg = reg;
  			update.mask = mask;
  			update.val = val;
  			widget->dapm->update = &update;
97404f2e0   Mark Brown   ASoC: Do DAPM con...
2228

fafd2176f   Stephen Warren   ASoC: Store a lis...
2229
2230
2231
2232
  			dapm_mixer_update_power(widget, kcontrol, connect);
  
  			widget->dapm->update = NULL;
  		}
283375cef   Mark Brown   ASoC: Push regist...
2233
  	}
fafd2176f   Stephen Warren   ASoC: Store a lis...
2234
  	mutex_unlock(&codec->mutex);
97404f2e0   Mark Brown   ASoC: Do DAPM con...
2235
  	return 0;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2236
2237
2238
2239
2240
2241
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_put_volsw);
  
  /**
   * snd_soc_dapm_get_enum_double - dapm enumerated double mixer get callback
   * @kcontrol: mixer control
ac11a2b35   Mark Brown   ASoC: Clean up ke...
2242
   * @ucontrol: control element information
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2243
2244
2245
2246
2247
2248
2249
2250
   *
   * Callback to get the value of a dapm enumerated double mixer control.
   *
   * Returns 0 for success.
   */
  int snd_soc_dapm_get_enum_double(struct snd_kcontrol *kcontrol,
  	struct snd_ctl_elem_value *ucontrol)
  {
fafd2176f   Stephen Warren   ASoC: Store a lis...
2251
2252
  	struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
  	struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2253
  	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
46f5822f7   Daniel Ribeiro   ASoC: Allow 32 bi...
2254
  	unsigned int val, bitmask;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2255

f8ba0b7bf   Jon Smirl   ALSA: ASoC: Renam...
2256
  	for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2257
2258
2259
2260
2261
2262
2263
2264
2265
2266
2267
2268
2269
2270
  		;
  	val = snd_soc_read(widget->codec, e->reg);
  	ucontrol->value.enumerated.item[0] = (val >> e->shift_l) & (bitmask - 1);
  	if (e->shift_l != e->shift_r)
  		ucontrol->value.enumerated.item[1] =
  			(val >> e->shift_r) & (bitmask - 1);
  
  	return 0;
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);
  
  /**
   * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
   * @kcontrol: mixer control
ac11a2b35   Mark Brown   ASoC: Clean up ke...
2271
   * @ucontrol: control element information
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2272
2273
2274
2275
2276
2277
2278
2279
   *
   * Callback to set the value of a dapm enumerated double mixer control.
   *
   * Returns 0 for success.
   */
  int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
  	struct snd_ctl_elem_value *ucontrol)
  {
fafd2176f   Stephen Warren   ASoC: Store a lis...
2280
2281
2282
  	struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
  	struct snd_soc_dapm_widget *widget = wlist->widgets[0];
  	struct snd_soc_codec *codec = widget->codec;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2283
  	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
3a65577d2   Mark Brown   ASoC: Push DAPM e...
2284
  	unsigned int val, mux, change;
46f5822f7   Daniel Ribeiro   ASoC: Allow 32 bi...
2285
  	unsigned int mask, bitmask;
97404f2e0   Mark Brown   ASoC: Do DAPM con...
2286
  	struct snd_soc_dapm_update update;
fafd2176f   Stephen Warren   ASoC: Store a lis...
2287
  	int wi;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2288

f8ba0b7bf   Jon Smirl   ALSA: ASoC: Renam...
2289
  	for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2290
  		;
f8ba0b7bf   Jon Smirl   ALSA: ASoC: Renam...
2291
  	if (ucontrol->value.enumerated.item[0] > e->max - 1)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2292
2293
2294
2295
2296
  		return -EINVAL;
  	mux = ucontrol->value.enumerated.item[0];
  	val = mux << e->shift_l;
  	mask = (bitmask - 1) << e->shift_l;
  	if (e->shift_l != e->shift_r) {
f8ba0b7bf   Jon Smirl   ALSA: ASoC: Renam...
2297
  		if (ucontrol->value.enumerated.item[1] > e->max - 1)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2298
2299
2300
2301
  			return -EINVAL;
  		val |= ucontrol->value.enumerated.item[1] << e->shift_r;
  		mask |= (bitmask - 1) << e->shift_r;
  	}
fafd2176f   Stephen Warren   ASoC: Store a lis...
2302
  	mutex_lock(&codec->mutex);
3a65577d2   Mark Brown   ASoC: Push DAPM e...
2303
  	change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
fafd2176f   Stephen Warren   ASoC: Store a lis...
2304
2305
2306
2307
2308
  	if (change) {
  		for (wi = 0; wi < wlist->num_widgets; wi++) {
  			widget = wlist->widgets[wi];
  
  			widget->value = val;
1642e3d42   Mark Brown   ASoC: Simplify co...
2309

fafd2176f   Stephen Warren   ASoC: Store a lis...
2310
2311
2312
2313
2314
2315
  			update.kcontrol = kcontrol;
  			update.widget = widget;
  			update.reg = e->reg;
  			update.mask = mask;
  			update.val = val;
  			widget->dapm->update = &update;
1642e3d42   Mark Brown   ASoC: Simplify co...
2316

fafd2176f   Stephen Warren   ASoC: Store a lis...
2317
  			dapm_mux_update_power(widget, kcontrol, change, mux, e);
1642e3d42   Mark Brown   ASoC: Simplify co...
2318

fafd2176f   Stephen Warren   ASoC: Store a lis...
2319
2320
2321
  			widget->dapm->update = NULL;
  		}
  	}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2322

fafd2176f   Stephen Warren   ASoC: Store a lis...
2323
  	mutex_unlock(&codec->mutex);
97404f2e0   Mark Brown   ASoC: Do DAPM con...
2324
  	return change;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2325
2326
2327
2328
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);
  
  /**
d2b247a8b   Mark Brown   ASoC: Add virtual...
2329
2330
2331
2332
2333
2334
2335
2336
2337
   * snd_soc_dapm_get_enum_virt - Get virtual DAPM mux
   * @kcontrol: mixer control
   * @ucontrol: control element information
   *
   * Returns 0 for success.
   */
  int snd_soc_dapm_get_enum_virt(struct snd_kcontrol *kcontrol,
  			       struct snd_ctl_elem_value *ucontrol)
  {
fafd2176f   Stephen Warren   ASoC: Store a lis...
2338
2339
  	struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
  	struct snd_soc_dapm_widget *widget = wlist->widgets[0];
d2b247a8b   Mark Brown   ASoC: Add virtual...
2340
2341
2342
2343
2344
2345
2346
2347
2348
2349
2350
2351
2352
2353
2354
2355
2356
  
  	ucontrol->value.enumerated.item[0] = widget->value;
  
  	return 0;
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_virt);
  
  /**
   * snd_soc_dapm_put_enum_virt - Set virtual DAPM mux
   * @kcontrol: mixer control
   * @ucontrol: control element information
   *
   * Returns 0 for success.
   */
  int snd_soc_dapm_put_enum_virt(struct snd_kcontrol *kcontrol,
  			       struct snd_ctl_elem_value *ucontrol)
  {
fafd2176f   Stephen Warren   ASoC: Store a lis...
2357
2358
2359
  	struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
  	struct snd_soc_dapm_widget *widget = wlist->widgets[0];
  	struct snd_soc_codec *codec = widget->codec;
d2b247a8b   Mark Brown   ASoC: Add virtual...
2360
2361
2362
2363
  	struct soc_enum *e =
  		(struct soc_enum *)kcontrol->private_value;
  	int change;
  	int ret = 0;
fafd2176f   Stephen Warren   ASoC: Store a lis...
2364
  	int wi;
d2b247a8b   Mark Brown   ASoC: Add virtual...
2365
2366
2367
  
  	if (ucontrol->value.enumerated.item[0] >= e->max)
  		return -EINVAL;
fafd2176f   Stephen Warren   ASoC: Store a lis...
2368
  	mutex_lock(&codec->mutex);
d2b247a8b   Mark Brown   ASoC: Add virtual...
2369
2370
  
  	change = widget->value != ucontrol->value.enumerated.item[0];
fafd2176f   Stephen Warren   ASoC: Store a lis...
2371
2372
2373
2374
2375
2376
2377
2378
2379
2380
  	if (change) {
  		for (wi = 0; wi < wlist->num_widgets; wi++) {
  			widget = wlist->widgets[wi];
  
  			widget->value = ucontrol->value.enumerated.item[0];
  
  			dapm_mux_update_power(widget, kcontrol, change,
  					      widget->value, e);
  		}
  	}
d2b247a8b   Mark Brown   ASoC: Add virtual...
2381

fafd2176f   Stephen Warren   ASoC: Store a lis...
2382
  	mutex_unlock(&codec->mutex);
d2b247a8b   Mark Brown   ASoC: Add virtual...
2383
2384
2385
2386
2387
  	return ret;
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_virt);
  
  /**
2e72f8e37   Peter Ujfalusi   ASoC: New enum ty...
2388
2389
2390
2391
2392
2393
2394
2395
2396
2397
2398
2399
2400
2401
2402
   * snd_soc_dapm_get_value_enum_double - dapm semi enumerated double mixer get
   *					callback
   * @kcontrol: mixer control
   * @ucontrol: control element information
   *
   * Callback to get the value of a dapm semi enumerated double mixer control.
   *
   * Semi enumerated mixer: the enumerated items are referred as values. Can be
   * used for handling bitfield coded enumeration for example.
   *
   * Returns 0 for success.
   */
  int snd_soc_dapm_get_value_enum_double(struct snd_kcontrol *kcontrol,
  	struct snd_ctl_elem_value *ucontrol)
  {
fafd2176f   Stephen Warren   ASoC: Store a lis...
2403
2404
  	struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
  	struct snd_soc_dapm_widget *widget = wlist->widgets[0];
741555568   Peter Ujfalusi   ASoC: Merge the s...
2405
  	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
46f5822f7   Daniel Ribeiro   ASoC: Allow 32 bi...
2406
  	unsigned int reg_val, val, mux;
2e72f8e37   Peter Ujfalusi   ASoC: New enum ty...
2407
2408
2409
2410
2411
2412
2413
2414
2415
2416
2417
2418
2419
2420
2421
2422
2423
2424
2425
2426
2427
2428
2429
2430
2431
2432
2433
2434
2435
2436
2437
2438
2439
2440
2441
2442
2443
  
  	reg_val = snd_soc_read(widget->codec, e->reg);
  	val = (reg_val >> e->shift_l) & e->mask;
  	for (mux = 0; mux < e->max; mux++) {
  		if (val == e->values[mux])
  			break;
  	}
  	ucontrol->value.enumerated.item[0] = mux;
  	if (e->shift_l != e->shift_r) {
  		val = (reg_val >> e->shift_r) & e->mask;
  		for (mux = 0; mux < e->max; mux++) {
  			if (val == e->values[mux])
  				break;
  		}
  		ucontrol->value.enumerated.item[1] = mux;
  	}
  
  	return 0;
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_get_value_enum_double);
  
  /**
   * snd_soc_dapm_put_value_enum_double - dapm semi enumerated double mixer set
   *					callback
   * @kcontrol: mixer control
   * @ucontrol: control element information
   *
   * Callback to set the value of a dapm semi enumerated double mixer control.
   *
   * Semi enumerated mixer: the enumerated items are referred as values. Can be
   * used for handling bitfield coded enumeration for example.
   *
   * Returns 0 for success.
   */
  int snd_soc_dapm_put_value_enum_double(struct snd_kcontrol *kcontrol,
  	struct snd_ctl_elem_value *ucontrol)
  {
fafd2176f   Stephen Warren   ASoC: Store a lis...
2444
2445
2446
  	struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
  	struct snd_soc_dapm_widget *widget = wlist->widgets[0];
  	struct snd_soc_codec *codec = widget->codec;
741555568   Peter Ujfalusi   ASoC: Merge the s...
2447
  	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
3a65577d2   Mark Brown   ASoC: Push DAPM e...
2448
  	unsigned int val, mux, change;
46f5822f7   Daniel Ribeiro   ASoC: Allow 32 bi...
2449
  	unsigned int mask;
97404f2e0   Mark Brown   ASoC: Do DAPM con...
2450
  	struct snd_soc_dapm_update update;
fafd2176f   Stephen Warren   ASoC: Store a lis...
2451
  	int wi;
2e72f8e37   Peter Ujfalusi   ASoC: New enum ty...
2452
2453
2454
2455
2456
2457
2458
2459
2460
2461
2462
2463
  
  	if (ucontrol->value.enumerated.item[0] > e->max - 1)
  		return -EINVAL;
  	mux = ucontrol->value.enumerated.item[0];
  	val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
  	mask = e->mask << e->shift_l;
  	if (e->shift_l != e->shift_r) {
  		if (ucontrol->value.enumerated.item[1] > e->max - 1)
  			return -EINVAL;
  		val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
  		mask |= e->mask << e->shift_r;
  	}
fafd2176f   Stephen Warren   ASoC: Store a lis...
2464
  	mutex_lock(&codec->mutex);
3a65577d2   Mark Brown   ASoC: Push DAPM e...
2465
  	change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
fafd2176f   Stephen Warren   ASoC: Store a lis...
2466
2467
2468
  	if (change) {
  		for (wi = 0; wi < wlist->num_widgets; wi++) {
  			widget = wlist->widgets[wi];
1642e3d42   Mark Brown   ASoC: Simplify co...
2469

fafd2176f   Stephen Warren   ASoC: Store a lis...
2470
  			widget->value = val;
1642e3d42   Mark Brown   ASoC: Simplify co...
2471

fafd2176f   Stephen Warren   ASoC: Store a lis...
2472
2473
2474
2475
2476
2477
  			update.kcontrol = kcontrol;
  			update.widget = widget;
  			update.reg = e->reg;
  			update.mask = mask;
  			update.val = val;
  			widget->dapm->update = &update;
1642e3d42   Mark Brown   ASoC: Simplify co...
2478

fafd2176f   Stephen Warren   ASoC: Store a lis...
2479
2480
2481
2482
2483
  			dapm_mux_update_power(widget, kcontrol, change, mux, e);
  
  			widget->dapm->update = NULL;
  		}
  	}
2e72f8e37   Peter Ujfalusi   ASoC: New enum ty...
2484

fafd2176f   Stephen Warren   ASoC: Store a lis...
2485
  	mutex_unlock(&codec->mutex);
97404f2e0   Mark Brown   ASoC: Do DAPM con...
2486
  	return change;
2e72f8e37   Peter Ujfalusi   ASoC: New enum ty...
2487
2488
2489
2490
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_put_value_enum_double);
  
  /**
8b37dbd2a   Mark Brown   ASoC: Add SND_SOC...
2491
2492
2493
2494
2495
2496
2497
2498
2499
2500
2501
2502
2503
2504
2505
2506
2507
2508
2509
2510
2511
2512
2513
2514
2515
2516
2517
2518
2519
2520
2521
2522
2523
2524
   * snd_soc_dapm_info_pin_switch - Info for a pin switch
   *
   * @kcontrol: mixer control
   * @uinfo: control element information
   *
   * Callback to provide information about a pin switch control.
   */
  int snd_soc_dapm_info_pin_switch(struct snd_kcontrol *kcontrol,
  				 struct snd_ctl_elem_info *uinfo)
  {
  	uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
  	uinfo->count = 1;
  	uinfo->value.integer.min = 0;
  	uinfo->value.integer.max = 1;
  
  	return 0;
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_info_pin_switch);
  
  /**
   * snd_soc_dapm_get_pin_switch - Get information for a pin switch
   *
   * @kcontrol: mixer control
   * @ucontrol: Value
   */
  int snd_soc_dapm_get_pin_switch(struct snd_kcontrol *kcontrol,
  				struct snd_ctl_elem_value *ucontrol)
  {
  	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  	const char *pin = (const char *)kcontrol->private_value;
  
  	mutex_lock(&codec->mutex);
  
  	ucontrol->value.integer.value[0] =
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2525
  		snd_soc_dapm_get_pin_status(&codec->dapm, pin);
8b37dbd2a   Mark Brown   ASoC: Add SND_SOC...
2526
2527
2528
2529
2530
2531
2532
2533
2534
2535
2536
2537
2538
2539
2540
2541
2542
2543
2544
2545
2546
2547
  
  	mutex_unlock(&codec->mutex);
  
  	return 0;
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_switch);
  
  /**
   * snd_soc_dapm_put_pin_switch - Set information for a pin switch
   *
   * @kcontrol: mixer control
   * @ucontrol: Value
   */
  int snd_soc_dapm_put_pin_switch(struct snd_kcontrol *kcontrol,
  				struct snd_ctl_elem_value *ucontrol)
  {
  	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  	const char *pin = (const char *)kcontrol->private_value;
  
  	mutex_lock(&codec->mutex);
  
  	if (ucontrol->value.integer.value[0])
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2548
  		snd_soc_dapm_enable_pin(&codec->dapm, pin);
8b37dbd2a   Mark Brown   ASoC: Add SND_SOC...
2549
  	else
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2550
  		snd_soc_dapm_disable_pin(&codec->dapm, pin);
8b37dbd2a   Mark Brown   ASoC: Add SND_SOC...
2551

ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2552
  	snd_soc_dapm_sync(&codec->dapm);
8b37dbd2a   Mark Brown   ASoC: Add SND_SOC...
2553
2554
2555
2556
2557
2558
2559
2560
  
  	mutex_unlock(&codec->mutex);
  
  	return 0;
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);
  
  /**
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2561
   * snd_soc_dapm_new_control - create new dapm control
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2562
   * @dapm: DAPM context
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2563
2564
2565
2566
2567
2568
   * @widget: widget template
   *
   * Creates a new dapm control based upon the template.
   *
   * Returns 0 for success else error.
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2569
  int snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2570
2571
2572
  	const struct snd_soc_dapm_widget *widget)
  {
  	struct snd_soc_dapm_widget *w;
ead9b9199   Jarkko Nikula   ASoC: Add optiona...
2573
  	size_t name_len;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2574
2575
2576
  
  	if ((w = dapm_cnew_widget(widget)) == NULL)
  		return -ENOMEM;
ead9b9199   Jarkko Nikula   ASoC: Add optiona...
2577
  	name_len = strlen(widget->name) + 1;
88e8b9a84   Mark Brown   ASoC: Check for a...
2578
  	if (dapm->codec && dapm->codec->name_prefix)
ead9b9199   Jarkko Nikula   ASoC: Add optiona...
2579
2580
2581
2582
2583
2584
  		name_len += 1 + strlen(dapm->codec->name_prefix);
  	w->name = kmalloc(name_len, GFP_KERNEL);
  	if (w->name == NULL) {
  		kfree(w);
  		return -ENOMEM;
  	}
88e8b9a84   Mark Brown   ASoC: Check for a...
2585
  	if (dapm->codec && dapm->codec->name_prefix)
ead9b9199   Jarkko Nikula   ASoC: Add optiona...
2586
2587
2588
2589
  		snprintf(w->name, name_len, "%s %s",
  			dapm->codec->name_prefix, widget->name);
  	else
  		snprintf(w->name, name_len, "%s", widget->name);
7ca3a18b0   Mark Brown   ASoC: Assign powe...
2590
2591
2592
2593
2594
2595
2596
2597
2598
2599
2600
2601
2602
2603
2604
2605
2606
2607
2608
2609
2610
2611
2612
2613
2614
2615
2616
2617
2618
2619
2620
2621
2622
2623
2624
2625
2626
  	switch (w->id) {
  	case snd_soc_dapm_switch:
  	case snd_soc_dapm_mixer:
  	case snd_soc_dapm_mixer_named_ctl:
  		w->power_check = dapm_generic_check_power;
  		break;
  	case snd_soc_dapm_mux:
  	case snd_soc_dapm_virt_mux:
  	case snd_soc_dapm_value_mux:
  		w->power_check = dapm_generic_check_power;
  		break;
  	case snd_soc_dapm_adc:
  	case snd_soc_dapm_aif_out:
  		w->power_check = dapm_adc_check_power;
  		break;
  	case snd_soc_dapm_dac:
  	case snd_soc_dapm_aif_in:
  		w->power_check = dapm_dac_check_power;
  		break;
  	case snd_soc_dapm_pga:
  	case snd_soc_dapm_out_drv:
  	case snd_soc_dapm_input:
  	case snd_soc_dapm_output:
  	case snd_soc_dapm_micbias:
  	case snd_soc_dapm_spk:
  	case snd_soc_dapm_hp:
  	case snd_soc_dapm_mic:
  	case snd_soc_dapm_line:
  		w->power_check = dapm_generic_check_power;
  		break;
  	case snd_soc_dapm_supply:
  		w->power_check = dapm_supply_check_power;
  		break;
  	default:
  		w->power_check = dapm_always_on_check_power;
  		break;
  	}
97c866def   Jarkko Nikula   ASoC: Move widget...
2627
  	dapm->n_widgets++;
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2628
2629
  	w->dapm = dapm;
  	w->codec = dapm->codec;
b79506413   Liam Girdwood   ASoC: core - Add ...
2630
  	w->platform = dapm->platform;
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2631
2632
2633
  	INIT_LIST_HEAD(&w->sources);
  	INIT_LIST_HEAD(&w->sinks);
  	INIT_LIST_HEAD(&w->list);
db432b414   Mark Brown   ASoC: Do DAPM pow...
2634
  	INIT_LIST_HEAD(&w->dirty);
97c866def   Jarkko Nikula   ASoC: Move widget...
2635
  	list_add(&w->list, &dapm->card->widgets);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2636
2637
2638
2639
2640
2641
2642
2643
  
  	/* machine layer set ups unconnected pins and insertions */
  	w->connected = 1;
  	return 0;
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_new_control);
  
  /**
4ba1327ab   Mark Brown   [ALSA] soc - DAPM...
2644
   * snd_soc_dapm_new_controls - create new dapm controls
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2645
   * @dapm: DAPM context
4ba1327ab   Mark Brown   [ALSA] soc - DAPM...
2646
2647
2648
2649
2650
2651
2652
   * @widget: widget array
   * @num: number of widgets
   *
   * Creates new DAPM controls based upon the templates.
   *
   * Returns 0 for success else error.
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2653
  int snd_soc_dapm_new_controls(struct snd_soc_dapm_context *dapm,
4ba1327ab   Mark Brown   [ALSA] soc - DAPM...
2654
2655
2656
2657
2658
2659
  	const struct snd_soc_dapm_widget *widget,
  	int num)
  {
  	int i, ret;
  
  	for (i = 0; i < num; i++) {
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2660
  		ret = snd_soc_dapm_new_control(dapm, widget);
b8b33cb56   Mark Brown   ASoC: Complain if...
2661
  		if (ret < 0) {
f7d41ae83   Jarkko Nikula   ASoC: Update DAPM...
2662
2663
2664
2665
  			dev_err(dapm->dev,
  				"ASoC: Failed to create DAPM control %s: %d
  ",
  				widget->name, ret);
4ba1327ab   Mark Brown   [ALSA] soc - DAPM...
2666
  			return ret;
b8b33cb56   Mark Brown   ASoC: Complain if...
2667
  		}
4ba1327ab   Mark Brown   [ALSA] soc - DAPM...
2668
2669
2670
2671
2672
  		widget++;
  	}
  	return 0;
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2673
  static void soc_dapm_stream_event(struct snd_soc_dapm_context *dapm,
f0fba2ad1   Liam Girdwood   ASoC: multi-compo...
2674
  	const char *stream, int event)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2675
2676
  {
  	struct snd_soc_dapm_widget *w;
97c866def   Jarkko Nikula   ASoC: Move widget...
2677
  	list_for_each_entry(w, &dapm->card->widgets, list)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2678
  	{
97c866def   Jarkko Nikula   ASoC: Move widget...
2679
  		if (!w->sname || w->dapm != dapm)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2680
  			continue;
ee47b3648   Liam Girdwood   ASoC: dapm - chan...
2681
2682
2683
  		dev_vdbg(w->dapm->dev, "widget %s
   %s stream %s event %d
  ",
f7d41ae83   Jarkko Nikula   ASoC: Update DAPM...
2684
  			w->name, w->sname, stream, event);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2685
  		if (strstr(w->sname, stream)) {
75c1f891b   Mark Brown   ASoC: Add verbose...
2686
  			dapm_mark_dirty(w, "stream event");
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2687
2688
2689
2690
2691
2692
2693
2694
  			switch(event) {
  			case SND_SOC_DAPM_STREAM_START:
  				w->active = 1;
  				break;
  			case SND_SOC_DAPM_STREAM_STOP:
  				w->active = 0;
  				break;
  			case SND_SOC_DAPM_STREAM_SUSPEND:
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2695
  			case SND_SOC_DAPM_STREAM_RESUME:
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2696
  			case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2697
2698
2699
2700
2701
  			case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
  				break;
  			}
  		}
  	}
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2702

ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2703
  	dapm_power_widgets(dapm, event);
64a648c22   Liam Girdwood   ASoC: dapm - Add ...
2704
2705
2706
2707
  
  	/* do we need to notify any clients that DAPM stream is complete */
  	if (dapm->stream_event)
  		dapm->stream_event(dapm, event);
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2708
2709
2710
2711
2712
2713
2714
2715
2716
2717
2718
2719
2720
2721
2722
2723
2724
2725
2726
2727
2728
2729
2730
  }
  
  /**
   * snd_soc_dapm_stream_event - send a stream event to the dapm core
   * @rtd: PCM runtime data
   * @stream: stream name
   * @event: stream event
   *
   * Sends a stream event to the dapm core. The core then makes any
   * necessary widget power changes.
   *
   * Returns 0 for success else error.
   */
  int snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd,
  	const char *stream, int event)
  {
  	struct snd_soc_codec *codec = rtd->codec;
  
  	if (stream == NULL)
  		return 0;
  
  	mutex_lock(&codec->mutex);
  	soc_dapm_stream_event(&codec->dapm, stream, event);
8e8b2d676   Eero Nurkkala   ASoC: Serialize a...
2731
  	mutex_unlock(&codec->mutex);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2732
2733
  	return 0;
  }
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2734
2735
  
  /**
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2736
   * snd_soc_dapm_enable_pin - enable pin.
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2737
   * @dapm: DAPM context
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2738
   * @pin: pin name
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2739
   *
74b8f955a   Mark Brown   ASoC: Apostrophe ...
2740
   * Enables input/output pin and its parents or children widgets iff there is
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2741
2742
2743
   * a valid audio route and active audio stream.
   * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
   * do any widget power switching.
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2744
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2745
  int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2746
  {
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2747
  	return snd_soc_dapm_set_pin(dapm, pin, 1);
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2748
2749
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2750

a5302181e   Liam Girdwood   ALSA: asoc: core ...
2751
  /**
da34183e6   Mark Brown   ASoC: Allow pins ...
2752
   * snd_soc_dapm_force_enable_pin - force a pin to be enabled
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2753
   * @dapm: DAPM context
da34183e6   Mark Brown   ASoC: Allow pins ...
2754
2755
2756
2757
2758
2759
2760
2761
2762
   * @pin: pin name
   *
   * Enables input/output pin regardless of any other state.  This is
   * intended for use with microphone bias supplies used in microphone
   * jack detection.
   *
   * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
   * do any widget power switching.
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2763
2764
  int snd_soc_dapm_force_enable_pin(struct snd_soc_dapm_context *dapm,
  				  const char *pin)
da34183e6   Mark Brown   ASoC: Allow pins ...
2765
  {
91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
2766
  	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
da34183e6   Mark Brown   ASoC: Allow pins ...
2767

91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
2768
2769
2770
2771
  	if (!w) {
  		dev_err(dapm->dev, "dapm: unknown pin %s
  ", pin);
  		return -EINVAL;
0d86733cc   Mark Brown   ASoC: Allow DAPM ...
2772
  	}
91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
2773
2774
2775
2776
  	dev_dbg(w->dapm->dev, "dapm: force enable pin %s
  ", pin);
  	w->connected = 1;
  	w->force = 1;
75c1f891b   Mark Brown   ASoC: Add verbose...
2777
  	dapm_mark_dirty(w, "force enable");
da34183e6   Mark Brown   ASoC: Allow pins ...
2778

91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
2779
  	return 0;
da34183e6   Mark Brown   ASoC: Allow pins ...
2780
2781
2782
2783
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin);
  
  /**
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2784
   * snd_soc_dapm_disable_pin - disable pin.
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2785
   * @dapm: DAPM context
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2786
2787
   * @pin: pin name
   *
74b8f955a   Mark Brown   ASoC: Apostrophe ...
2788
   * Disables input/output pin and its parents or children widgets.
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2789
2790
2791
   * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
   * do any widget power switching.
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2792
2793
  int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm,
  			     const char *pin)
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2794
  {
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2795
  	return snd_soc_dapm_set_pin(dapm, pin, 0);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2796
  }
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2797
  EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2798
2799
  
  /**
5817b52a2   Mark Brown   ALSA: ASoC: Allow...
2800
   * snd_soc_dapm_nc_pin - permanently disable pin.
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2801
   * @dapm: DAPM context
5817b52a2   Mark Brown   ALSA: ASoC: Allow...
2802
2803
2804
2805
2806
2807
2808
2809
2810
2811
2812
   * @pin: pin name
   *
   * Marks the specified pin as being not connected, disabling it along
   * any parent or child widgets.  At present this is identical to
   * snd_soc_dapm_disable_pin() but in future it will be extended to do
   * additional things such as disabling controls which only affect
   * paths through the pin.
   *
   * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
   * do any widget power switching.
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2813
  int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin)
5817b52a2   Mark Brown   ALSA: ASoC: Allow...
2814
  {
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2815
  	return snd_soc_dapm_set_pin(dapm, pin, 0);
5817b52a2   Mark Brown   ALSA: ASoC: Allow...
2816
2817
2818
2819
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);
  
  /**
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2820
   * snd_soc_dapm_get_pin_status - get audio pin status
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2821
   * @dapm: DAPM context
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2822
   * @pin: audio signal pin endpoint (or start point)
eeec12bf7   Graeme Gregory   [ALSA] soc - DAPM...
2823
   *
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2824
   * Get audio pin status - connected or disconnected.
eeec12bf7   Graeme Gregory   [ALSA] soc - DAPM...
2825
   *
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2826
   * Returns 1 for connected otherwise 0.
eeec12bf7   Graeme Gregory   [ALSA] soc - DAPM...
2827
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2828
2829
  int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm,
  				const char *pin)
eeec12bf7   Graeme Gregory   [ALSA] soc - DAPM...
2830
  {
91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
2831
  	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
eeec12bf7   Graeme Gregory   [ALSA] soc - DAPM...
2832

91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
2833
2834
  	if (w)
  		return w->connected;
a68b38ada   Stephen Warren   ASoC: snd_soc_dap...
2835

eeec12bf7   Graeme Gregory   [ALSA] soc - DAPM...
2836
2837
  	return 0;
  }
a5302181e   Liam Girdwood   ALSA: asoc: core ...
2838
  EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
eeec12bf7   Graeme Gregory   [ALSA] soc - DAPM...
2839
2840
  
  /**
1547aba99   Mark Brown   ASoC: Support lea...
2841
   * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2842
   * @dapm: DAPM context
1547aba99   Mark Brown   ASoC: Support lea...
2843
2844
2845
2846
2847
2848
2849
2850
   * @pin: audio signal pin endpoint (or start point)
   *
   * Mark the given endpoint or pin as ignoring suspend.  When the
   * system is disabled a path between two endpoints flagged as ignoring
   * suspend will not be disabled.  The path must already be enabled via
   * normal means at suspend time, it will not be turned on if it was not
   * already enabled.
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2851
2852
  int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm,
  				const char *pin)
1547aba99   Mark Brown   ASoC: Support lea...
2853
  {
91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
2854
  	struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, false);
1547aba99   Mark Brown   ASoC: Support lea...
2855

91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
2856
2857
2858
2859
  	if (!w) {
  		dev_err(dapm->dev, "dapm: unknown pin %s
  ", pin);
  		return -EINVAL;
1547aba99   Mark Brown   ASoC: Support lea...
2860
  	}
91a5fca4b   Lars-Peter Clausen   ASoC: Add dapm_fi...
2861
2862
2863
  	w->ignore_suspend = 1;
  
  	return 0;
1547aba99   Mark Brown   ASoC: Support lea...
2864
2865
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend);
1633281b7   Stephen Warren   ASoC: Implement f...
2866
2867
2868
2869
2870
2871
2872
2873
2874
2875
2876
2877
2878
2879
2880
2881
2882
2883
2884
2885
2886
2887
2888
2889
2890
2891
2892
2893
2894
2895
2896
2897
2898
2899
2900
2901
2902
2903
2904
2905
2906
2907
2908
2909
2910
2911
2912
2913
2914
  static bool snd_soc_dapm_widget_in_card_paths(struct snd_soc_card *card,
  					      struct snd_soc_dapm_widget *w)
  {
  	struct snd_soc_dapm_path *p;
  
  	list_for_each_entry(p, &card->paths, list) {
  		if ((p->source == w) || (p->sink == w)) {
  			dev_dbg(card->dev,
  			    "... Path %s(id:%d dapm:%p) - %s(id:%d dapm:%p)
  ",
  			    p->source->name, p->source->id, p->source->dapm,
  			    p->sink->name, p->sink->id, p->sink->dapm);
  
  			/* Connected to something other than the codec */
  			if (p->source->dapm != p->sink->dapm)
  				return true;
  			/*
  			 * Loopback connection from codec external pin to
  			 * codec external pin
  			 */
  			if (p->sink->id == snd_soc_dapm_input) {
  				switch (p->source->id) {
  				case snd_soc_dapm_output:
  				case snd_soc_dapm_micbias:
  					return true;
  				default:
  					break;
  				}
  			}
  		}
  	}
  
  	return false;
  }
  
  /**
   * snd_soc_dapm_auto_nc_codec_pins - call snd_soc_dapm_nc_pin for unused pins
   * @codec: The codec whose pins should be processed
   *
   * Automatically call snd_soc_dapm_nc_pin() for any external pins in the codec
   * which are unused. Pins are used if they are connected externally to the
   * codec, whether that be to some other device, or a loop-back connection to
   * the codec itself.
   */
  void snd_soc_dapm_auto_nc_codec_pins(struct snd_soc_codec *codec)
  {
  	struct snd_soc_card *card = codec->card;
  	struct snd_soc_dapm_context *dapm = &codec->dapm;
  	struct snd_soc_dapm_widget *w;
a094b80bb   Mark Brown   ASoC: Log automat...
2915
2916
  	dev_dbg(codec->dev, "Auto NC: DAPMs: card:%p codec:%p
  ",
1633281b7   Stephen Warren   ASoC: Implement f...
2917
2918
2919
2920
2921
2922
2923
2924
2925
  		&card->dapm, &codec->dapm);
  
  	list_for_each_entry(w, &card->widgets, list) {
  		if (w->dapm != dapm)
  			continue;
  		switch (w->id) {
  		case snd_soc_dapm_input:
  		case snd_soc_dapm_output:
  		case snd_soc_dapm_micbias:
a094b80bb   Mark Brown   ASoC: Log automat...
2926
2927
  			dev_dbg(codec->dev, "Auto NC: Checking widget %s
  ",
1633281b7   Stephen Warren   ASoC: Implement f...
2928
2929
  				w->name);
  			if (!snd_soc_dapm_widget_in_card_paths(card, w)) {
a094b80bb   Mark Brown   ASoC: Log automat...
2930
  				dev_dbg(codec->dev,
1633281b7   Stephen Warren   ASoC: Implement f...
2931
2932
2933
2934
2935
2936
2937
2938
2939
2940
  					"... Not in map; disabling
  ");
  				snd_soc_dapm_nc_pin(dapm, w->name);
  			}
  			break;
  		default:
  			break;
  		}
  	}
  }
1547aba99   Mark Brown   ASoC: Support lea...
2941
  /**
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2942
   * snd_soc_dapm_free - free dapm resources
728a52222   Peter Ujfalusi   ASoC: soc-dapm: F...
2943
   * @dapm: DAPM context
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2944
2945
2946
   *
   * Free all dapm widgets and resources.
   */
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2947
  void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm)
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2948
  {
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2949
  	snd_soc_dapm_sys_remove(dapm->dev);
6c45e1265   Lars-Peter Clausen   ASoC: Remove DAPM...
2950
  	dapm_debugfs_cleanup(dapm);
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2951
  	dapm_free_widgets(dapm);
7be31be88   Jarkko Nikula   ASoC: Extend DAPM...
2952
  	list_del(&dapm->list);
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2953
2954
  }
  EXPORT_SYMBOL_GPL(snd_soc_dapm_free);
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2955
  static void soc_dapm_shutdown_codec(struct snd_soc_dapm_context *dapm)
517374704   Mark Brown   ASoC: Add a shutd...
2956
  {
517374704   Mark Brown   ASoC: Add a shutd...
2957
2958
2959
  	struct snd_soc_dapm_widget *w;
  	LIST_HEAD(down_list);
  	int powerdown = 0;
97c866def   Jarkko Nikula   ASoC: Move widget...
2960
2961
2962
  	list_for_each_entry(w, &dapm->card->widgets, list) {
  		if (w->dapm != dapm)
  			continue;
517374704   Mark Brown   ASoC: Add a shutd...
2963
  		if (w->power) {
828a842f2   Mark Brown   ASoC: Explicitly ...
2964
  			dapm_seq_insert(w, &down_list, false);
c2caa4da4   Mark Brown   ASoC: Fix widget ...
2965
  			w->power = 0;
517374704   Mark Brown   ASoC: Add a shutd...
2966
2967
2968
2969
2970
2971
2972
2973
  			powerdown = 1;
  		}
  	}
  
  	/* If there were no widgets to power down we're already in
  	 * standby.
  	 */
  	if (powerdown) {
ed5a4c472   Mark Brown   ASoC: Remove card...
2974
  		snd_soc_dapm_set_bias_level(dapm, SND_SOC_BIAS_PREPARE);
828a842f2   Mark Brown   ASoC: Explicitly ...
2975
  		dapm_seq_run(dapm, &down_list, 0, false);
ed5a4c472   Mark Brown   ASoC: Remove card...
2976
  		snd_soc_dapm_set_bias_level(dapm, SND_SOC_BIAS_STANDBY);
517374704   Mark Brown   ASoC: Add a shutd...
2977
  	}
f0fba2ad1   Liam Girdwood   ASoC: multi-compo...
2978
2979
2980
2981
2982
2983
2984
2985
  }
  
  /*
   * snd_soc_dapm_shutdown - callback for system shutdown
   */
  void snd_soc_dapm_shutdown(struct snd_soc_card *card)
  {
  	struct snd_soc_codec *codec;
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2986
2987
  	list_for_each_entry(codec, &card->codec_dev_list, list) {
  		soc_dapm_shutdown_codec(&codec->dapm);
ed5a4c472   Mark Brown   ASoC: Remove card...
2988
  		snd_soc_dapm_set_bias_level(&codec->dapm, SND_SOC_BIAS_OFF);
ce6120cca   Liam Girdwood   ASoC: Decouple DA...
2989
  	}
517374704   Mark Brown   ASoC: Add a shutd...
2990
  }
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2991
  /* Module information */
d331124dc   Liam Girdwood   ALSA: ASoC: updat...
2992
  MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
2b97eabc0   Richard Purdie   [ALSA] ASoC: dyna...
2993
2994
  MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
  MODULE_LICENSE("GPL");