]> git.proxmox.com Git - mirror_ubuntu-hirsute-kernel.git/blame - sound/soc/soc-dapm.c
ASoC: Reduce the number of neigbours we mark dirty when updating power
[mirror_ubuntu-hirsute-kernel.git] / sound / soc / soc-dapm.c
CommitLineData
2b97eabc
RP
1/*
2 * soc-dapm.c -- ALSA SoC Dynamic Audio Power Management
3 *
4 * Copyright 2005 Wolfson Microelectronics PLC.
d331124d 5 * Author: Liam Girdwood <lrg@slimlogic.co.uk>
2b97eabc
RP
6 *
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License as published by the
9 * Free Software Foundation; either version 2 of the License, or (at your
10 * option) any later version.
11 *
2b97eabc
RP
12 * Features:
13 * o Changes power status of internal codec blocks depending on the
14 * dynamic configuration of codec internal audio paths and active
74b8f955 15 * DACs/ADCs.
2b97eabc
RP
16 * o Platform power domain - can support external components i.e. amps and
17 * mic/meadphone insertion events.
18 * o Automatic Mic Bias support
19 * o Jack insertion power event initiation - e.g. hp insertion will enable
20 * sinks, dacs, etc
3a4fa0a2 21 * o Delayed powerdown of audio susbsystem to reduce pops between a quick
2b97eabc
RP
22 * device reopen.
23 *
24 * Todo:
25 * o DAPM power change sequencing - allow for configurable per
26 * codec sequences.
27 * o Support for analogue bias optimisation.
28 * o Support for reduced codec oversampling rates.
29 * o Support for reduced codec bias currents.
30 */
31
32#include <linux/module.h>
33#include <linux/moduleparam.h>
34#include <linux/init.h>
9d0624a7 35#include <linux/async.h>
2b97eabc
RP
36#include <linux/delay.h>
37#include <linux/pm.h>
38#include <linux/bitops.h>
39#include <linux/platform_device.h>
40#include <linux/jiffies.h>
20496ff3 41#include <linux/debugfs.h>
5a0e3ad6 42#include <linux/slab.h>
2b97eabc
RP
43#include <sound/core.h>
44#include <sound/pcm.h>
45#include <sound/pcm_params.h>
ce6120cc 46#include <sound/soc.h>
2b97eabc
RP
47#include <sound/initval.h>
48
84e90930
MB
49#include <trace/events/asoc.h>
50
de02d078
MB
51#define DAPM_UPDATE_STAT(widget, val) widget->dapm->card->dapm_stats.val++;
52
2b97eabc
RP
53/* dapm power sequences - make this per codec in the future */
54static int dapm_up_seq[] = {
38357ab2
MB
55 [snd_soc_dapm_pre] = 0,
56 [snd_soc_dapm_supply] = 1,
57 [snd_soc_dapm_micbias] = 2,
010ff262
MB
58 [snd_soc_dapm_aif_in] = 3,
59 [snd_soc_dapm_aif_out] = 3,
60 [snd_soc_dapm_mic] = 4,
61 [snd_soc_dapm_mux] = 5,
24ff33ac 62 [snd_soc_dapm_virt_mux] = 5,
010ff262
MB
63 [snd_soc_dapm_value_mux] = 5,
64 [snd_soc_dapm_dac] = 6,
65 [snd_soc_dapm_mixer] = 7,
66 [snd_soc_dapm_mixer_named_ctl] = 7,
67 [snd_soc_dapm_pga] = 8,
68 [snd_soc_dapm_adc] = 9,
d88429a6 69 [snd_soc_dapm_out_drv] = 10,
010ff262
MB
70 [snd_soc_dapm_hp] = 10,
71 [snd_soc_dapm_spk] = 10,
72 [snd_soc_dapm_post] = 11,
2b97eabc 73};
ca9c1aae 74
2b97eabc 75static int dapm_down_seq[] = {
38357ab2
MB
76 [snd_soc_dapm_pre] = 0,
77 [snd_soc_dapm_adc] = 1,
78 [snd_soc_dapm_hp] = 2,
1ca04065 79 [snd_soc_dapm_spk] = 2,
d88429a6 80 [snd_soc_dapm_out_drv] = 2,
38357ab2
MB
81 [snd_soc_dapm_pga] = 4,
82 [snd_soc_dapm_mixer_named_ctl] = 5,
e3d4dabd
MB
83 [snd_soc_dapm_mixer] = 5,
84 [snd_soc_dapm_dac] = 6,
85 [snd_soc_dapm_mic] = 7,
86 [snd_soc_dapm_micbias] = 8,
87 [snd_soc_dapm_mux] = 9,
24ff33ac 88 [snd_soc_dapm_virt_mux] = 9,
e3d4dabd 89 [snd_soc_dapm_value_mux] = 9,
010ff262
MB
90 [snd_soc_dapm_aif_in] = 10,
91 [snd_soc_dapm_aif_out] = 10,
92 [snd_soc_dapm_supply] = 11,
93 [snd_soc_dapm_post] = 12,
2b97eabc
RP
94};
95
12ef193d 96static void pop_wait(u32 pop_time)
15e4c72f
MB
97{
98 if (pop_time)
99 schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
100}
101
fd8d3bc0 102static void pop_dbg(struct device *dev, u32 pop_time, const char *fmt, ...)
15e4c72f
MB
103{
104 va_list args;
fd8d3bc0 105 char *buf;
15e4c72f 106
fd8d3bc0
JN
107 if (!pop_time)
108 return;
15e4c72f 109
fd8d3bc0
JN
110 buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
111 if (buf == NULL)
112 return;
15e4c72f 113
fd8d3bc0
JN
114 va_start(args, fmt);
115 vsnprintf(buf, PAGE_SIZE, fmt, args);
9d01df06 116 dev_info(dev, "%s", buf);
15e4c72f 117 va_end(args);
fd8d3bc0
JN
118
119 kfree(buf);
15e4c72f
MB
120}
121
db432b41
MB
122static bool dapm_dirty_widget(struct snd_soc_dapm_widget *w)
123{
124 return !list_empty(&w->dirty);
125}
126
127static void dapm_mark_dirty(struct snd_soc_dapm_widget *w)
128{
129 if (!dapm_dirty_widget(w))
130 list_add_tail(&w->dirty, &w->dapm->card->dapm_dirty);
131}
132
2b97eabc 133/* create a new dapm widget */
88cb4290 134static inline struct snd_soc_dapm_widget *dapm_cnew_widget(
2b97eabc
RP
135 const struct snd_soc_dapm_widget *_widget)
136{
88cb4290 137 return kmemdup(_widget, sizeof(*_widget), GFP_KERNEL);
2b97eabc
RP
138}
139
4805608a
LG
140/* get snd_card from DAPM context */
141static inline struct snd_card *dapm_get_snd_card(
142 struct snd_soc_dapm_context *dapm)
143{
144 if (dapm->codec)
145 return dapm->codec->card->snd_card;
146 else if (dapm->platform)
147 return dapm->platform->card->snd_card;
148 else
149 BUG();
150
151 /* unreachable */
152 return NULL;
153}
154
155/* get soc_card from DAPM context */
156static inline struct snd_soc_card *dapm_get_soc_card(
157 struct snd_soc_dapm_context *dapm)
158{
159 if (dapm->codec)
160 return dapm->codec->card;
161 else if (dapm->platform)
162 return dapm->platform->card;
163 else
164 BUG();
165
166 /* unreachable */
167 return NULL;
168}
169
0445bdf4
LG
170static int soc_widget_read(struct snd_soc_dapm_widget *w, int reg)
171{
172 if (w->codec)
173 return snd_soc_read(w->codec, reg);
b7950641
LG
174 else if (w->platform)
175 return snd_soc_platform_read(w->platform, reg);
176
177 dev_err(w->dapm->dev, "no valid widget read method\n");
178 return -1;
0445bdf4
LG
179}
180
181static int soc_widget_write(struct snd_soc_dapm_widget *w, int reg, int val)
182{
183 if (w->codec)
184 return snd_soc_write(w->codec, reg, val);
b7950641
LG
185 else if (w->platform)
186 return snd_soc_platform_write(w->platform, reg, val);
187
188 dev_err(w->dapm->dev, "no valid widget write method\n");
189 return -1;
0445bdf4
LG
190}
191
192static int soc_widget_update_bits(struct snd_soc_dapm_widget *w,
193 unsigned short reg, unsigned int mask, unsigned int value)
194{
195 int change;
196 unsigned int old, new;
197 int ret;
198
199 ret = soc_widget_read(w, reg);
200 if (ret < 0)
201 return ret;
202
203 old = ret;
204 new = (old & ~mask) | (value & mask);
205 change = old != new;
206 if (change) {
207 ret = soc_widget_write(w, reg, new);
208 if (ret < 0)
209 return ret;
210 }
211
212 return change;
213}
214
452c5eaa
MB
215/**
216 * snd_soc_dapm_set_bias_level - set the bias level for the system
ed5a4c47 217 * @dapm: DAPM context
452c5eaa
MB
218 * @level: level to configure
219 *
220 * Configure the bias (power) levels for the SoC audio device.
221 *
222 * Returns 0 for success else error.
223 */
ed5a4c47 224static int snd_soc_dapm_set_bias_level(struct snd_soc_dapm_context *dapm,
ce6120cc 225 enum snd_soc_bias_level level)
452c5eaa 226{
ed5a4c47 227 struct snd_soc_card *card = dapm->card;
452c5eaa
MB
228 int ret = 0;
229
84e90930
MB
230 trace_snd_soc_bias_level_start(card, level);
231
f0fba2ad 232 if (card && card->set_bias_level)
d4c6005f 233 ret = card->set_bias_level(card, dapm, level);
171ec6b0
MB
234 if (ret != 0)
235 goto out;
236
cc4c670a
MB
237 if (dapm->codec) {
238 if (dapm->codec->driver->set_bias_level)
239 ret = dapm->codec->driver->set_bias_level(dapm->codec,
240 level);
241 else
242 dapm->bias_level = level;
243 }
171ec6b0
MB
244 if (ret != 0)
245 goto out;
246
247 if (card && card->set_bias_level_post)
d4c6005f 248 ret = card->set_bias_level_post(card, dapm, level);
171ec6b0 249out:
84e90930
MB
250 trace_snd_soc_bias_level_done(card, level);
251
452c5eaa
MB
252 return ret;
253}
254
2b97eabc
RP
255/* set up initial codec paths */
256static void dapm_set_path_status(struct snd_soc_dapm_widget *w,
257 struct snd_soc_dapm_path *p, int i)
258{
259 switch (w->id) {
260 case snd_soc_dapm_switch:
ca9c1aae
IM
261 case snd_soc_dapm_mixer:
262 case snd_soc_dapm_mixer_named_ctl: {
2b97eabc 263 int val;
4eaa9819 264 struct soc_mixer_control *mc = (struct soc_mixer_control *)
82cfecdc 265 w->kcontrol_news[i].private_value;
815ecf8d
JS
266 unsigned int reg = mc->reg;
267 unsigned int shift = mc->shift;
4eaa9819 268 int max = mc->max;
815ecf8d
JS
269 unsigned int mask = (1 << fls(max)) - 1;
270 unsigned int invert = mc->invert;
2b97eabc 271
0445bdf4 272 val = soc_widget_read(w, reg);
2b97eabc
RP
273 val = (val >> shift) & mask;
274
275 if ((invert && !val) || (!invert && val))
276 p->connect = 1;
277 else
278 p->connect = 0;
279 }
280 break;
281 case snd_soc_dapm_mux: {
82cfecdc
SW
282 struct soc_enum *e = (struct soc_enum *)
283 w->kcontrol_news[i].private_value;
2b97eabc
RP
284 int val, item, bitmask;
285
f8ba0b7b 286 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
88d96086 287 ;
0445bdf4 288 val = soc_widget_read(w, e->reg);
2b97eabc
RP
289 item = (val >> e->shift_l) & (bitmask - 1);
290
291 p->connect = 0;
f8ba0b7b 292 for (i = 0; i < e->max; i++) {
2b97eabc
RP
293 if (!(strcmp(p->name, e->texts[i])) && item == i)
294 p->connect = 1;
295 }
296 }
297 break;
24ff33ac 298 case snd_soc_dapm_virt_mux: {
82cfecdc
SW
299 struct soc_enum *e = (struct soc_enum *)
300 w->kcontrol_news[i].private_value;
24ff33ac
DP
301
302 p->connect = 0;
303 /* since a virtual mux has no backing registers to
304 * decide which path to connect, it will try to match
305 * with the first enumeration. This is to ensure
306 * that the default mux choice (the first) will be
307 * correctly powered up during initialization.
308 */
309 if (!strcmp(p->name, e->texts[0]))
310 p->connect = 1;
311 }
312 break;
2e72f8e3 313 case snd_soc_dapm_value_mux: {
74155556 314 struct soc_enum *e = (struct soc_enum *)
82cfecdc 315 w->kcontrol_news[i].private_value;
2e72f8e3
PU
316 int val, item;
317
0445bdf4 318 val = soc_widget_read(w, e->reg);
2e72f8e3
PU
319 val = (val >> e->shift_l) & e->mask;
320 for (item = 0; item < e->max; item++) {
321 if (val == e->values[item])
322 break;
323 }
324
325 p->connect = 0;
326 for (i = 0; i < e->max; i++) {
327 if (!(strcmp(p->name, e->texts[i])) && item == i)
328 p->connect = 1;
329 }
330 }
331 break;
56563100 332 /* does not affect routing - always connected */
2b97eabc 333 case snd_soc_dapm_pga:
d88429a6 334 case snd_soc_dapm_out_drv:
2b97eabc
RP
335 case snd_soc_dapm_output:
336 case snd_soc_dapm_adc:
337 case snd_soc_dapm_input:
338 case snd_soc_dapm_dac:
339 case snd_soc_dapm_micbias:
340 case snd_soc_dapm_vmid:
246d0a17 341 case snd_soc_dapm_supply:
010ff262
MB
342 case snd_soc_dapm_aif_in:
343 case snd_soc_dapm_aif_out:
2b97eabc
RP
344 case snd_soc_dapm_hp:
345 case snd_soc_dapm_mic:
346 case snd_soc_dapm_spk:
347 case snd_soc_dapm_line:
56563100
MB
348 p->connect = 1;
349 break;
350 /* does affect routing - dynamically connected */
2b97eabc
RP
351 case snd_soc_dapm_pre:
352 case snd_soc_dapm_post:
353 p->connect = 0;
354 break;
355 }
356}
357
74b8f955 358/* connect mux widget to its interconnecting audio paths */
ce6120cc 359static int dapm_connect_mux(struct snd_soc_dapm_context *dapm,
2b97eabc
RP
360 struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
361 struct snd_soc_dapm_path *path, const char *control_name,
362 const struct snd_kcontrol_new *kcontrol)
363{
364 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
365 int i;
366
f8ba0b7b 367 for (i = 0; i < e->max; i++) {
2b97eabc 368 if (!(strcmp(control_name, e->texts[i]))) {
8ddab3f5 369 list_add(&path->list, &dapm->card->paths);
2b97eabc
RP
370 list_add(&path->list_sink, &dest->sources);
371 list_add(&path->list_source, &src->sinks);
372 path->name = (char*)e->texts[i];
373 dapm_set_path_status(dest, path, 0);
374 return 0;
375 }
376 }
377
378 return -ENODEV;
379}
380
74b8f955 381/* connect mixer widget to its interconnecting audio paths */
ce6120cc 382static int dapm_connect_mixer(struct snd_soc_dapm_context *dapm,
2b97eabc
RP
383 struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
384 struct snd_soc_dapm_path *path, const char *control_name)
385{
386 int i;
387
388 /* search for mixer kcontrol */
389 for (i = 0; i < dest->num_kcontrols; i++) {
82cfecdc 390 if (!strcmp(control_name, dest->kcontrol_news[i].name)) {
8ddab3f5 391 list_add(&path->list, &dapm->card->paths);
2b97eabc
RP
392 list_add(&path->list_sink, &dest->sources);
393 list_add(&path->list_source, &src->sinks);
82cfecdc 394 path->name = dest->kcontrol_news[i].name;
2b97eabc
RP
395 dapm_set_path_status(dest, path, i);
396 return 0;
397 }
398 }
399 return -ENODEV;
400}
401
af46800b 402static int dapm_is_shared_kcontrol(struct snd_soc_dapm_context *dapm,
1007da06 403 struct snd_soc_dapm_widget *kcontrolw,
af46800b
SW
404 const struct snd_kcontrol_new *kcontrol_new,
405 struct snd_kcontrol **kcontrol)
406{
407 struct snd_soc_dapm_widget *w;
408 int i;
409
410 *kcontrol = NULL;
411
412 list_for_each_entry(w, &dapm->card->widgets, list) {
1007da06
SW
413 if (w == kcontrolw || w->dapm != kcontrolw->dapm)
414 continue;
af46800b
SW
415 for (i = 0; i < w->num_kcontrols; i++) {
416 if (&w->kcontrol_news[i] == kcontrol_new) {
417 if (w->kcontrols)
418 *kcontrol = w->kcontrols[i];
419 return 1;
420 }
421 }
422 }
423
424 return 0;
425}
426
2b97eabc 427/* create new dapm mixer control */
4b80b8c2 428static int dapm_new_mixer(struct snd_soc_dapm_widget *w)
2b97eabc 429{
4b80b8c2 430 struct snd_soc_dapm_context *dapm = w->dapm;
2b97eabc 431 int i, ret = 0;
3e5ff4df 432 size_t name_len, prefix_len;
2b97eabc 433 struct snd_soc_dapm_path *path;
12ea2c78 434 struct snd_card *card = dapm->card->snd_card;
efb7ac3f 435 const char *prefix;
fafd2176
SW
436 struct snd_soc_dapm_widget_list *wlist;
437 size_t wlistsize;
efb7ac3f
MB
438
439 if (dapm->codec)
440 prefix = dapm->codec->name_prefix;
441 else
442 prefix = NULL;
2b97eabc 443
3e5ff4df
MB
444 if (prefix)
445 prefix_len = strlen(prefix) + 1;
446 else
447 prefix_len = 0;
448
2b97eabc
RP
449 /* add kcontrol */
450 for (i = 0; i < w->num_kcontrols; i++) {
451
452 /* match name */
453 list_for_each_entry(path, &w->sources, list_sink) {
454
455 /* mixer/mux paths name must match control name */
82cfecdc 456 if (path->name != (char *)w->kcontrol_news[i].name)
2b97eabc
RP
457 continue;
458
82cd8764
LPC
459 if (w->kcontrols[i]) {
460 path->kcontrol = w->kcontrols[i];
461 continue;
462 }
463
fafd2176
SW
464 wlistsize = sizeof(struct snd_soc_dapm_widget_list) +
465 sizeof(struct snd_soc_dapm_widget *),
466 wlist = kzalloc(wlistsize, GFP_KERNEL);
467 if (wlist == NULL) {
468 dev_err(dapm->dev,
469 "asoc: can't allocate widget list for %s\n",
470 w->name);
471 return -ENOMEM;
472 }
473 wlist->num_widgets = 1;
474 wlist->widgets[0] = w;
475
ca9c1aae
IM
476 /* add dapm control with long name.
477 * for dapm_mixer this is the concatenation of the
478 * mixer and kcontrol name.
479 * for dapm_mixer_named_ctl this is simply the
480 * kcontrol name.
481 */
82cfecdc 482 name_len = strlen(w->kcontrol_news[i].name) + 1;
07495f3e 483 if (w->id != snd_soc_dapm_mixer_named_ctl)
ca9c1aae
IM
484 name_len += 1 + strlen(w->name);
485
219b93f5 486 path->long_name = kmalloc(name_len, GFP_KERNEL);
ca9c1aae 487
fafd2176
SW
488 if (path->long_name == NULL) {
489 kfree(wlist);
2b97eabc 490 return -ENOMEM;
fafd2176 491 }
2b97eabc 492
ca9c1aae 493 switch (w->id) {
ca9c1aae 494 default:
3e5ff4df
MB
495 /* The control will get a prefix from
496 * the control creation process but
497 * we're also using the same prefix
498 * for widgets so cut the prefix off
499 * the front of the widget name.
500 */
ca9c1aae 501 snprintf(path->long_name, name_len, "%s %s",
3e5ff4df 502 w->name + prefix_len,
82cfecdc 503 w->kcontrol_news[i].name);
07495f3e 504 break;
ca9c1aae
IM
505 case snd_soc_dapm_mixer_named_ctl:
506 snprintf(path->long_name, name_len, "%s",
82cfecdc 507 w->kcontrol_news[i].name);
07495f3e 508 break;
ca9c1aae
IM
509 }
510
219b93f5
MB
511 path->long_name[name_len - 1] = '\0';
512
fafd2176
SW
513 path->kcontrol = snd_soc_cnew(&w->kcontrol_news[i],
514 wlist, path->long_name,
515 prefix);
ce6120cc 516 ret = snd_ctl_add(card, path->kcontrol);
2b97eabc 517 if (ret < 0) {
f7d41ae8
JN
518 dev_err(dapm->dev,
519 "asoc: failed to add dapm kcontrol %s: %d\n",
520 path->long_name, ret);
fafd2176 521 kfree(wlist);
2b97eabc
RP
522 kfree(path->long_name);
523 path->long_name = NULL;
524 return ret;
525 }
fad59888 526 w->kcontrols[i] = path->kcontrol;
2b97eabc
RP
527 }
528 }
529 return ret;
530}
531
532/* create new dapm mux control */
4b80b8c2 533static int dapm_new_mux(struct snd_soc_dapm_widget *w)
2b97eabc 534{
4b80b8c2 535 struct snd_soc_dapm_context *dapm = w->dapm;
2b97eabc
RP
536 struct snd_soc_dapm_path *path = NULL;
537 struct snd_kcontrol *kcontrol;
12ea2c78 538 struct snd_card *card = dapm->card->snd_card;
efb7ac3f 539 const char *prefix;
3e5ff4df 540 size_t prefix_len;
af46800b 541 int ret;
fafd2176 542 struct snd_soc_dapm_widget_list *wlist;
af46800b 543 int shared, wlistentries;
fafd2176 544 size_t wlistsize;
af46800b 545 char *name;
2b97eabc 546
af46800b
SW
547 if (w->num_kcontrols != 1) {
548 dev_err(dapm->dev,
549 "asoc: mux %s has incorrect number of controls\n",
550 w->name);
2b97eabc
RP
551 return -EINVAL;
552 }
553
1007da06 554 shared = dapm_is_shared_kcontrol(dapm, w, &w->kcontrol_news[0],
af46800b
SW
555 &kcontrol);
556 if (kcontrol) {
557 wlist = kcontrol->private_data;
558 wlistentries = wlist->num_widgets + 1;
559 } else {
560 wlist = NULL;
561 wlistentries = 1;
562 }
fafd2176 563 wlistsize = sizeof(struct snd_soc_dapm_widget_list) +
af46800b
SW
564 wlistentries * sizeof(struct snd_soc_dapm_widget *),
565 wlist = krealloc(wlist, wlistsize, GFP_KERNEL);
fafd2176
SW
566 if (wlist == NULL) {
567 dev_err(dapm->dev,
568 "asoc: can't allocate widget list for %s\n", w->name);
569 return -ENOMEM;
570 }
af46800b
SW
571 wlist->num_widgets = wlistentries;
572 wlist->widgets[wlistentries - 1] = w;
efb7ac3f 573
af46800b
SW
574 if (!kcontrol) {
575 if (dapm->codec)
576 prefix = dapm->codec->name_prefix;
577 else
578 prefix = NULL;
579
580 if (shared) {
581 name = w->kcontrol_news[0].name;
582 prefix_len = 0;
583 } else {
584 name = w->name;
585 if (prefix)
586 prefix_len = strlen(prefix) + 1;
587 else
588 prefix_len = 0;
589 }
3e5ff4df 590
af46800b
SW
591 /*
592 * The control will get a prefix from the control creation
593 * process but we're also using the same prefix for widgets so
594 * cut the prefix off the front of the widget name.
595 */
596 kcontrol = snd_soc_cnew(&w->kcontrol_news[0], wlist,
597 name + prefix_len, prefix);
598 ret = snd_ctl_add(card, kcontrol);
599 if (ret < 0) {
53daf208
MB
600 dev_err(dapm->dev, "failed to add kcontrol %s: %d\n",
601 w->name, ret);
af46800b
SW
602 kfree(wlist);
603 return ret;
604 }
605 }
ce6120cc 606
af46800b 607 kcontrol->private_data = wlist;
2b97eabc 608
fad59888
SW
609 w->kcontrols[0] = kcontrol;
610
2b97eabc
RP
611 list_for_each_entry(path, &w->sources, list_sink)
612 path->kcontrol = kcontrol;
613
af46800b 614 return 0;
2b97eabc
RP
615}
616
617/* create new dapm volume control */
4b80b8c2 618static int dapm_new_pga(struct snd_soc_dapm_widget *w)
2b97eabc 619{
a6c65736 620 if (w->num_kcontrols)
f7d41ae8
JN
621 dev_err(w->dapm->dev,
622 "asoc: PGA controls not supported: '%s'\n", w->name);
2b97eabc 623
a6c65736 624 return 0;
2b97eabc
RP
625}
626
627/* reset 'walked' bit for each dapm path */
ce6120cc 628static inline void dapm_clear_walk(struct snd_soc_dapm_context *dapm)
2b97eabc
RP
629{
630 struct snd_soc_dapm_path *p;
631
8ddab3f5 632 list_for_each_entry(p, &dapm->card->paths, list)
2b97eabc
RP
633 p->walked = 0;
634}
635
9949788b
MB
636/* We implement power down on suspend by checking the power state of
637 * the ALSA card - when we are suspending the ALSA state for the card
638 * is set to D3.
639 */
640static int snd_soc_dapm_suspend_check(struct snd_soc_dapm_widget *widget)
641{
12ea2c78 642 int level = snd_power_get_state(widget->dapm->card->snd_card);
9949788b 643
f0fba2ad 644 switch (level) {
9949788b
MB
645 case SNDRV_CTL_POWER_D3hot:
646 case SNDRV_CTL_POWER_D3cold:
1547aba9 647 if (widget->ignore_suspend)
f7d41ae8
JN
648 dev_dbg(widget->dapm->dev, "%s ignoring suspend\n",
649 widget->name);
1547aba9 650 return widget->ignore_suspend;
9949788b
MB
651 default:
652 return 1;
653 }
654}
655
2b97eabc
RP
656/*
657 * Recursively check for a completed path to an active or physically connected
658 * output widget. Returns number of complete paths.
659 */
660static int is_connected_output_ep(struct snd_soc_dapm_widget *widget)
661{
662 struct snd_soc_dapm_path *path;
663 int con = 0;
664
de02d078
MB
665 DAPM_UPDATE_STAT(widget, path_checks);
666
246d0a17
MB
667 if (widget->id == snd_soc_dapm_supply)
668 return 0;
669
010ff262
MB
670 switch (widget->id) {
671 case snd_soc_dapm_adc:
672 case snd_soc_dapm_aif_out:
673 if (widget->active)
9949788b 674 return snd_soc_dapm_suspend_check(widget);
010ff262
MB
675 default:
676 break;
677 }
2b97eabc
RP
678
679 if (widget->connected) {
680 /* connected pin ? */
681 if (widget->id == snd_soc_dapm_output && !widget->ext)
9949788b 682 return snd_soc_dapm_suspend_check(widget);
2b97eabc
RP
683
684 /* connected jack or spk ? */
685 if (widget->id == snd_soc_dapm_hp || widget->id == snd_soc_dapm_spk ||
eaeae5d9 686 (widget->id == snd_soc_dapm_line && !list_empty(&widget->sources)))
9949788b 687 return snd_soc_dapm_suspend_check(widget);
2b97eabc
RP
688 }
689
690 list_for_each_entry(path, &widget->sinks, list_source) {
e56235e0
MB
691 DAPM_UPDATE_STAT(widget, neighbour_checks);
692
bf3a9e13
MB
693 if (path->weak)
694 continue;
695
2b97eabc
RP
696 if (path->walked)
697 continue;
698
699 if (path->sink && path->connect) {
700 path->walked = 1;
701 con += is_connected_output_ep(path->sink);
702 }
703 }
704
705 return con;
706}
707
708/*
709 * Recursively check for a completed path to an active or physically connected
710 * input widget. Returns number of complete paths.
711 */
712static int is_connected_input_ep(struct snd_soc_dapm_widget *widget)
713{
714 struct snd_soc_dapm_path *path;
715 int con = 0;
716
de02d078
MB
717 DAPM_UPDATE_STAT(widget, path_checks);
718
246d0a17
MB
719 if (widget->id == snd_soc_dapm_supply)
720 return 0;
721
2b97eabc 722 /* active stream ? */
010ff262
MB
723 switch (widget->id) {
724 case snd_soc_dapm_dac:
725 case snd_soc_dapm_aif_in:
726 if (widget->active)
9949788b 727 return snd_soc_dapm_suspend_check(widget);
010ff262
MB
728 default:
729 break;
730 }
2b97eabc
RP
731
732 if (widget->connected) {
733 /* connected pin ? */
734 if (widget->id == snd_soc_dapm_input && !widget->ext)
9949788b 735 return snd_soc_dapm_suspend_check(widget);
2b97eabc
RP
736
737 /* connected VMID/Bias for lower pops */
738 if (widget->id == snd_soc_dapm_vmid)
9949788b 739 return snd_soc_dapm_suspend_check(widget);
2b97eabc
RP
740
741 /* connected jack ? */
eaeae5d9
PU
742 if (widget->id == snd_soc_dapm_mic ||
743 (widget->id == snd_soc_dapm_line && !list_empty(&widget->sinks)))
9949788b 744 return snd_soc_dapm_suspend_check(widget);
2b97eabc
RP
745 }
746
747 list_for_each_entry(path, &widget->sources, list_sink) {
e56235e0
MB
748 DAPM_UPDATE_STAT(widget, neighbour_checks);
749
bf3a9e13
MB
750 if (path->weak)
751 continue;
752
2b97eabc
RP
753 if (path->walked)
754 continue;
755
756 if (path->source && path->connect) {
757 path->walked = 1;
758 con += is_connected_input_ep(path->source);
759 }
760 }
761
762 return con;
763}
764
e2be2ccf
JN
765/*
766 * Handler for generic register modifier widget.
767 */
768int dapm_reg_event(struct snd_soc_dapm_widget *w,
769 struct snd_kcontrol *kcontrol, int event)
770{
771 unsigned int val;
772
773 if (SND_SOC_DAPM_EVENT_ON(event))
774 val = w->on_val;
775 else
776 val = w->off_val;
777
0445bdf4 778 soc_widget_update_bits(w, -(w->reg + 1),
e2be2ccf
JN
779 w->mask << w->shift, val << w->shift);
780
781 return 0;
782}
11589418 783EXPORT_SYMBOL_GPL(dapm_reg_event);
e2be2ccf 784
d805002b
MB
785static int dapm_widget_power_check(struct snd_soc_dapm_widget *w)
786{
787 if (w->force)
788 return 1;
789 else
790 return w->power_check(w);
791}
792
cd0f2d47
MB
793/* Generic check to see if a widget should be powered.
794 */
795static int dapm_generic_check_power(struct snd_soc_dapm_widget *w)
796{
797 int in, out;
798
de02d078
MB
799 DAPM_UPDATE_STAT(w, power_checks);
800
cd0f2d47 801 in = is_connected_input_ep(w);
ce6120cc 802 dapm_clear_walk(w->dapm);
cd0f2d47 803 out = is_connected_output_ep(w);
ce6120cc 804 dapm_clear_walk(w->dapm);
cd0f2d47
MB
805 return out != 0 && in != 0;
806}
807
6ea31b9f
MB
808/* Check to see if an ADC has power */
809static int dapm_adc_check_power(struct snd_soc_dapm_widget *w)
810{
811 int in;
812
de02d078
MB
813 DAPM_UPDATE_STAT(w, power_checks);
814
6ea31b9f
MB
815 if (w->active) {
816 in = is_connected_input_ep(w);
ce6120cc 817 dapm_clear_walk(w->dapm);
6ea31b9f
MB
818 return in != 0;
819 } else {
820 return dapm_generic_check_power(w);
821 }
822}
823
824/* Check to see if a DAC has power */
825static int dapm_dac_check_power(struct snd_soc_dapm_widget *w)
826{
827 int out;
828
de02d078
MB
829 DAPM_UPDATE_STAT(w, power_checks);
830
6ea31b9f
MB
831 if (w->active) {
832 out = is_connected_output_ep(w);
ce6120cc 833 dapm_clear_walk(w->dapm);
6ea31b9f
MB
834 return out != 0;
835 } else {
836 return dapm_generic_check_power(w);
837 }
838}
839
246d0a17
MB
840/* Check to see if a power supply is needed */
841static int dapm_supply_check_power(struct snd_soc_dapm_widget *w)
842{
843 struct snd_soc_dapm_path *path;
844 int power = 0;
845
de02d078
MB
846 DAPM_UPDATE_STAT(w, power_checks);
847
246d0a17
MB
848 /* Check if one of our outputs is connected */
849 list_for_each_entry(path, &w->sinks, list_source) {
a8fdac83
MB
850 DAPM_UPDATE_STAT(w, neighbour_checks);
851
bf3a9e13
MB
852 if (path->weak)
853 continue;
854
215edda3
MB
855 if (path->connected &&
856 !path->connected(path->source, path->sink))
857 continue;
858
3017358a
MB
859 if (!path->sink)
860 continue;
861
d805002b 862 if (dapm_widget_power_check(path->sink)) {
246d0a17
MB
863 power = 1;
864 break;
865 }
866 }
867
ce6120cc 868 dapm_clear_walk(w->dapm);
246d0a17
MB
869
870 return power;
871}
872
35c64bca
MB
873static int dapm_always_on_check_power(struct snd_soc_dapm_widget *w)
874{
875 return 1;
876}
877
38357ab2
MB
878static int dapm_seq_compare(struct snd_soc_dapm_widget *a,
879 struct snd_soc_dapm_widget *b,
828a842f 880 bool power_up)
42aa3418 881{
828a842f
MB
882 int *sort;
883
884 if (power_up)
885 sort = dapm_up_seq;
886 else
887 sort = dapm_down_seq;
888
38357ab2
MB
889 if (sort[a->id] != sort[b->id])
890 return sort[a->id] - sort[b->id];
20e4859d
MB
891 if (a->subseq != b->subseq) {
892 if (power_up)
893 return a->subseq - b->subseq;
894 else
895 return b->subseq - a->subseq;
896 }
b22ead2a
MB
897 if (a->reg != b->reg)
898 return a->reg - b->reg;
84dab567
MB
899 if (a->dapm != b->dapm)
900 return (unsigned long)a->dapm - (unsigned long)b->dapm;
42aa3418 901
38357ab2
MB
902 return 0;
903}
42aa3418 904
38357ab2
MB
905/* Insert a widget in order into a DAPM power sequence. */
906static void dapm_seq_insert(struct snd_soc_dapm_widget *new_widget,
907 struct list_head *list,
828a842f 908 bool power_up)
38357ab2
MB
909{
910 struct snd_soc_dapm_widget *w;
911
912 list_for_each_entry(w, list, power_list)
828a842f 913 if (dapm_seq_compare(new_widget, w, power_up) < 0) {
38357ab2
MB
914 list_add_tail(&new_widget->power_list, &w->power_list);
915 return;
916 }
917
918 list_add_tail(&new_widget->power_list, list);
919}
920
68f89ad8
MB
921static void dapm_seq_check_event(struct snd_soc_dapm_context *dapm,
922 struct snd_soc_dapm_widget *w, int event)
923{
924 struct snd_soc_card *card = dapm->card;
925 const char *ev_name;
926 int power, ret;
927
928 switch (event) {
929 case SND_SOC_DAPM_PRE_PMU:
930 ev_name = "PRE_PMU";
931 power = 1;
932 break;
933 case SND_SOC_DAPM_POST_PMU:
934 ev_name = "POST_PMU";
935 power = 1;
936 break;
937 case SND_SOC_DAPM_PRE_PMD:
938 ev_name = "PRE_PMD";
939 power = 0;
940 break;
941 case SND_SOC_DAPM_POST_PMD:
942 ev_name = "POST_PMD";
943 power = 0;
944 break;
945 default:
946 BUG();
947 return;
948 }
949
950 if (w->power != power)
951 return;
952
953 if (w->event && (w->event_flags & event)) {
954 pop_dbg(dapm->dev, card->pop_time, "pop test : %s %s\n",
955 w->name, ev_name);
84e90930 956 trace_snd_soc_dapm_widget_event_start(w, event);
68f89ad8 957 ret = w->event(w, NULL, event);
84e90930 958 trace_snd_soc_dapm_widget_event_done(w, event);
68f89ad8
MB
959 if (ret < 0)
960 pr_err("%s: %s event failed: %d\n",
961 ev_name, w->name, ret);
962 }
963}
964
b22ead2a 965/* Apply the coalesced changes from a DAPM sequence */
ce6120cc 966static void dapm_seq_run_coalesced(struct snd_soc_dapm_context *dapm,
b22ead2a 967 struct list_head *pending)
163cac06 968{
3a45b867 969 struct snd_soc_card *card = dapm->card;
68f89ad8
MB
970 struct snd_soc_dapm_widget *w;
971 int reg, power;
b22ead2a
MB
972 unsigned int value = 0;
973 unsigned int mask = 0;
974 unsigned int cur_mask;
975
976 reg = list_first_entry(pending, struct snd_soc_dapm_widget,
977 power_list)->reg;
978
979 list_for_each_entry(w, pending, power_list) {
980 cur_mask = 1 << w->shift;
981 BUG_ON(reg != w->reg);
982
983 if (w->invert)
984 power = !w->power;
985 else
986 power = w->power;
987
988 mask |= cur_mask;
989 if (power)
990 value |= cur_mask;
991
fd8d3bc0 992 pop_dbg(dapm->dev, card->pop_time,
b22ead2a
MB
993 "pop test : Queue %s: reg=0x%x, 0x%x/0x%x\n",
994 w->name, reg, value, mask);
81628103 995
68f89ad8
MB
996 /* Check for events */
997 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_PRE_PMU);
998 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_PRE_PMD);
81628103
MB
999 }
1000
1001 if (reg >= 0) {
29376bc7
MB
1002 /* Any widget will do, they should all be updating the
1003 * same register.
1004 */
1005 w = list_first_entry(pending, struct snd_soc_dapm_widget,
1006 power_list);
1007
fd8d3bc0 1008 pop_dbg(dapm->dev, card->pop_time,
81628103 1009 "pop test : Applying 0x%x/0x%x to %x in %dms\n",
3a45b867
JN
1010 value, mask, reg, card->pop_time);
1011 pop_wait(card->pop_time);
0445bdf4 1012 soc_widget_update_bits(w, reg, mask, value);
b22ead2a
MB
1013 }
1014
81628103 1015 list_for_each_entry(w, pending, power_list) {
68f89ad8
MB
1016 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_POST_PMU);
1017 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_POST_PMD);
81628103 1018 }
b22ead2a 1019}
42aa3418 1020
b22ead2a
MB
1021/* Apply a DAPM power sequence.
1022 *
1023 * We walk over a pre-sorted list of widgets to apply power to. In
1024 * order to minimise the number of writes to the device required
1025 * multiple widgets will be updated in a single write where possible.
1026 * Currently anything that requires more than a single write is not
1027 * handled.
1028 */
ce6120cc 1029static void dapm_seq_run(struct snd_soc_dapm_context *dapm,
828a842f 1030 struct list_head *list, int event, bool power_up)
b22ead2a
MB
1031{
1032 struct snd_soc_dapm_widget *w, *n;
1033 LIST_HEAD(pending);
1034 int cur_sort = -1;
20e4859d 1035 int cur_subseq = -1;
b22ead2a 1036 int cur_reg = SND_SOC_NOPM;
7be31be8 1037 struct snd_soc_dapm_context *cur_dapm = NULL;
474b62d6 1038 int ret, i;
828a842f
MB
1039 int *sort;
1040
1041 if (power_up)
1042 sort = dapm_up_seq;
1043 else
1044 sort = dapm_down_seq;
163cac06 1045
b22ead2a
MB
1046 list_for_each_entry_safe(w, n, list, power_list) {
1047 ret = 0;
1048
1049 /* Do we need to apply any queued changes? */
7be31be8 1050 if (sort[w->id] != cur_sort || w->reg != cur_reg ||
20e4859d 1051 w->dapm != cur_dapm || w->subseq != cur_subseq) {
b22ead2a 1052 if (!list_empty(&pending))
7be31be8 1053 dapm_seq_run_coalesced(cur_dapm, &pending);
b22ead2a 1054
474b62d6
MB
1055 if (cur_dapm && cur_dapm->seq_notifier) {
1056 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
1057 if (sort[i] == cur_sort)
1058 cur_dapm->seq_notifier(cur_dapm,
f85a9e0d
MB
1059 i,
1060 cur_subseq);
474b62d6
MB
1061 }
1062
b22ead2a
MB
1063 INIT_LIST_HEAD(&pending);
1064 cur_sort = -1;
b0b3e6f8 1065 cur_subseq = INT_MIN;
b22ead2a 1066 cur_reg = SND_SOC_NOPM;
7be31be8 1067 cur_dapm = NULL;
b22ead2a
MB
1068 }
1069
163cac06
MB
1070 switch (w->id) {
1071 case snd_soc_dapm_pre:
1072 if (!w->event)
b22ead2a
MB
1073 list_for_each_entry_safe_continue(w, n, list,
1074 power_list);
163cac06 1075
b22ead2a 1076 if (event == SND_SOC_DAPM_STREAM_START)
163cac06
MB
1077 ret = w->event(w,
1078 NULL, SND_SOC_DAPM_PRE_PMU);
b22ead2a 1079 else if (event == SND_SOC_DAPM_STREAM_STOP)
163cac06
MB
1080 ret = w->event(w,
1081 NULL, SND_SOC_DAPM_PRE_PMD);
163cac06
MB
1082 break;
1083
1084 case snd_soc_dapm_post:
1085 if (!w->event)
b22ead2a
MB
1086 list_for_each_entry_safe_continue(w, n, list,
1087 power_list);
163cac06 1088
b22ead2a 1089 if (event == SND_SOC_DAPM_STREAM_START)
163cac06
MB
1090 ret = w->event(w,
1091 NULL, SND_SOC_DAPM_POST_PMU);
b22ead2a 1092 else if (event == SND_SOC_DAPM_STREAM_STOP)
163cac06
MB
1093 ret = w->event(w,
1094 NULL, SND_SOC_DAPM_POST_PMD);
163cac06
MB
1095 break;
1096
b22ead2a 1097 default:
81628103
MB
1098 /* Queue it up for application */
1099 cur_sort = sort[w->id];
20e4859d 1100 cur_subseq = w->subseq;
81628103 1101 cur_reg = w->reg;
7be31be8 1102 cur_dapm = w->dapm;
81628103
MB
1103 list_move(&w->power_list, &pending);
1104 break;
163cac06 1105 }
b22ead2a
MB
1106
1107 if (ret < 0)
f7d41ae8
JN
1108 dev_err(w->dapm->dev,
1109 "Failed to apply widget power: %d\n", ret);
6ea31b9f 1110 }
b22ead2a
MB
1111
1112 if (!list_empty(&pending))
28e86808 1113 dapm_seq_run_coalesced(cur_dapm, &pending);
474b62d6
MB
1114
1115 if (cur_dapm && cur_dapm->seq_notifier) {
1116 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
1117 if (sort[i] == cur_sort)
1118 cur_dapm->seq_notifier(cur_dapm,
f85a9e0d 1119 i, cur_subseq);
474b62d6 1120 }
42aa3418
MB
1121}
1122
97404f2e
MB
1123static void dapm_widget_update(struct snd_soc_dapm_context *dapm)
1124{
1125 struct snd_soc_dapm_update *update = dapm->update;
1126 struct snd_soc_dapm_widget *w;
1127 int ret;
1128
1129 if (!update)
1130 return;
1131
1132 w = update->widget;
1133
1134 if (w->event &&
1135 (w->event_flags & SND_SOC_DAPM_PRE_REG)) {
1136 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_PRE_REG);
1137 if (ret != 0)
1138 pr_err("%s DAPM pre-event failed: %d\n",
1139 w->name, ret);
1140 }
1141
1142 ret = snd_soc_update_bits(w->codec, update->reg, update->mask,
1143 update->val);
1144 if (ret < 0)
1145 pr_err("%s DAPM update failed: %d\n", w->name, ret);
1146
1147 if (w->event &&
1148 (w->event_flags & SND_SOC_DAPM_POST_REG)) {
1149 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_POST_REG);
1150 if (ret != 0)
1151 pr_err("%s DAPM post-event failed: %d\n",
1152 w->name, ret);
1153 }
1154}
1155
9d0624a7
MB
1156/* Async callback run prior to DAPM sequences - brings to _PREPARE if
1157 * they're changing state.
1158 */
1159static void dapm_pre_sequence_async(void *data, async_cookie_t cookie)
1160{
1161 struct snd_soc_dapm_context *d = data;
1162 int ret;
1163
56fba41f
MB
1164 /* If we're off and we're not supposed to be go into STANDBY */
1165 if (d->bias_level == SND_SOC_BIAS_OFF &&
1166 d->target_bias_level != SND_SOC_BIAS_OFF) {
9d0624a7
MB
1167 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
1168 if (ret != 0)
1169 dev_err(d->dev,
1170 "Failed to turn on bias: %d\n", ret);
1171 }
1172
56fba41f
MB
1173 /* Prepare for a STADDBY->ON or ON->STANDBY transition */
1174 if (d->bias_level != d->target_bias_level) {
9d0624a7
MB
1175 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_PREPARE);
1176 if (ret != 0)
1177 dev_err(d->dev,
1178 "Failed to prepare bias: %d\n", ret);
1179 }
1180}
1181
1182/* Async callback run prior to DAPM sequences - brings to their final
1183 * state.
1184 */
1185static void dapm_post_sequence_async(void *data, async_cookie_t cookie)
1186{
1187 struct snd_soc_dapm_context *d = data;
1188 int ret;
1189
1190 /* If we just powered the last thing off drop to standby bias */
56fba41f
MB
1191 if (d->bias_level == SND_SOC_BIAS_PREPARE &&
1192 (d->target_bias_level == SND_SOC_BIAS_STANDBY ||
1193 d->target_bias_level == SND_SOC_BIAS_OFF)) {
9d0624a7
MB
1194 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
1195 if (ret != 0)
1196 dev_err(d->dev, "Failed to apply standby bias: %d\n",
1197 ret);
1198 }
97404f2e 1199
9d0624a7 1200 /* If we're in standby and can support bias off then do that */
56fba41f
MB
1201 if (d->bias_level == SND_SOC_BIAS_STANDBY &&
1202 d->target_bias_level == SND_SOC_BIAS_OFF) {
9d0624a7
MB
1203 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_OFF);
1204 if (ret != 0)
1205 dev_err(d->dev, "Failed to turn off bias: %d\n", ret);
1206 }
1207
1208 /* If we just powered up then move to active bias */
56fba41f
MB
1209 if (d->bias_level == SND_SOC_BIAS_PREPARE &&
1210 d->target_bias_level == SND_SOC_BIAS_ON) {
9d0624a7
MB
1211 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_ON);
1212 if (ret != 0)
1213 dev_err(d->dev, "Failed to apply active bias: %d\n",
1214 ret);
1215 }
1216}
97404f2e 1217
fe4fda5d
MB
1218static void dapm_widget_set_peer_power(struct snd_soc_dapm_widget *peer,
1219 bool power, bool connect)
1220{
1221 /* If a connection is being made or broken then that update
1222 * will have marked the peer dirty, otherwise the widgets are
1223 * not connected and this update has no impact. */
1224 if (!connect)
1225 return;
1226
1227 /* If the peer is already in the state we're moving to then we
1228 * won't have an impact on it. */
1229 if (power != peer->power)
1230 dapm_mark_dirty(peer);
1231}
1232
05623c43
MB
1233static void dapm_widget_set_power(struct snd_soc_dapm_widget *w, bool power,
1234 struct list_head *up_list,
1235 struct list_head *down_list)
1236{
db432b41
MB
1237 struct snd_soc_dapm_path *path;
1238
05623c43
MB
1239 if (w->power == power)
1240 return;
1241
1242 trace_snd_soc_dapm_widget_power(w, power);
1243
db432b41 1244 /* If we changed our power state perhaps our neigbours changed
fe4fda5d 1245 * also.
db432b41
MB
1246 */
1247 list_for_each_entry(path, &w->sources, list_sink) {
1248 if (path->source) {
fe4fda5d
MB
1249 dapm_widget_set_peer_power(path->source, power,
1250 path->connect);
db432b41
MB
1251 }
1252 }
1253 list_for_each_entry(path, &w->sinks, list_source) {
1254 if (path->sink) {
fe4fda5d
MB
1255 dapm_widget_set_peer_power(path->sink, power,
1256 path->connect);
db432b41
MB
1257 }
1258 }
1259
05623c43
MB
1260 if (power)
1261 dapm_seq_insert(w, up_list, true);
1262 else
1263 dapm_seq_insert(w, down_list, false);
1264
1265 w->power = power;
1266}
1267
7c81beb0
MB
1268static void dapm_power_one_widget(struct snd_soc_dapm_widget *w,
1269 struct list_head *up_list,
1270 struct list_head *down_list)
1271{
7c81beb0
MB
1272 int power;
1273
1274 switch (w->id) {
1275 case snd_soc_dapm_pre:
1276 dapm_seq_insert(w, down_list, false);
1277 break;
1278 case snd_soc_dapm_post:
1279 dapm_seq_insert(w, up_list, true);
1280 break;
1281
1282 default:
d805002b 1283 power = dapm_widget_power_check(w);
7c81beb0 1284
05623c43 1285 dapm_widget_set_power(w, power, up_list, down_list);
7c81beb0
MB
1286 break;
1287 }
1288}
1289
2b97eabc
RP
1290/*
1291 * Scan each dapm widget for complete audio path.
1292 * A complete path is a route that has valid endpoints i.e.:-
1293 *
1294 * o DAC to output pin.
1295 * o Input Pin to ADC.
1296 * o Input pin to Output pin (bypass, sidetone)
1297 * o DAC to ADC (loopback).
1298 */
ce6120cc 1299static int dapm_power_widgets(struct snd_soc_dapm_context *dapm, int event)
2b97eabc 1300{
12ea2c78 1301 struct snd_soc_card *card = dapm->card;
2b97eabc 1302 struct snd_soc_dapm_widget *w;
7be31be8 1303 struct snd_soc_dapm_context *d;
291f3bbc
MB
1304 LIST_HEAD(up_list);
1305 LIST_HEAD(down_list);
9d0624a7 1306 LIST_HEAD(async_domain);
56fba41f 1307 enum snd_soc_bias_level bias;
6d3ddc81 1308
84e90930
MB
1309 trace_snd_soc_dapm_start(card);
1310
56fba41f
MB
1311 list_for_each_entry(d, &card->dapm_list, list) {
1312 if (d->n_widgets || d->codec == NULL) {
1313 if (d->idle_bias_off)
1314 d->target_bias_level = SND_SOC_BIAS_OFF;
1315 else
1316 d->target_bias_level = SND_SOC_BIAS_STANDBY;
1317 }
1318 }
7be31be8 1319
de02d078
MB
1320 memset(&card->dapm_stats, 0, sizeof(card->dapm_stats));
1321
6d3ddc81 1322 /* Check which widgets we need to power and store them in
db432b41
MB
1323 * lists indicating if they should be powered up or down. We
1324 * only check widgets that have been flagged as dirty but note
1325 * that new widgets may be added to the dirty list while we
1326 * iterate.
6d3ddc81 1327 */
db432b41 1328 list_for_each_entry(w, &card->dapm_dirty, dirty) {
7c81beb0 1329 dapm_power_one_widget(w, &up_list, &down_list);
2b97eabc
RP
1330 }
1331
f9de6d74 1332 list_for_each_entry(w, &card->widgets, list) {
db432b41
MB
1333 list_del_init(&w->dirty);
1334
f9de6d74
MB
1335 if (w->power) {
1336 d = w->dapm;
1337
1338 /* Supplies and micbiases only bring the
1339 * context up to STANDBY as unless something
1340 * else is active and passing audio they
1341 * generally don't require full power.
1342 */
1343 switch (w->id) {
1344 case snd_soc_dapm_supply:
1345 case snd_soc_dapm_micbias:
1346 if (d->target_bias_level < SND_SOC_BIAS_STANDBY)
1347 d->target_bias_level = SND_SOC_BIAS_STANDBY;
1348 break;
1349 default:
1350 d->target_bias_level = SND_SOC_BIAS_ON;
1351 break;
1352 }
1353 }
1354
1355 }
1356
b14b76a5
MB
1357 /* If there are no DAPM widgets then try to figure out power from the
1358 * event type.
1359 */
97c866de 1360 if (!dapm->n_widgets) {
b14b76a5
MB
1361 switch (event) {
1362 case SND_SOC_DAPM_STREAM_START:
1363 case SND_SOC_DAPM_STREAM_RESUME:
56fba41f 1364 dapm->target_bias_level = SND_SOC_BIAS_ON;
b14b76a5 1365 break;
862af8ad 1366 case SND_SOC_DAPM_STREAM_STOP:
56fba41f
MB
1367 if (dapm->codec->active)
1368 dapm->target_bias_level = SND_SOC_BIAS_ON;
1369 else
1370 dapm->target_bias_level = SND_SOC_BIAS_STANDBY;
862af8ad 1371 break;
50b6bce5 1372 case SND_SOC_DAPM_STREAM_SUSPEND:
56fba41f 1373 dapm->target_bias_level = SND_SOC_BIAS_STANDBY;
50b6bce5 1374 break;
b14b76a5 1375 case SND_SOC_DAPM_STREAM_NOP:
56fba41f 1376 dapm->target_bias_level = dapm->bias_level;
50b6bce5 1377 break;
b14b76a5
MB
1378 default:
1379 break;
1380 }
1381 }
1382
85a843c5
MB
1383 /* Force all contexts in the card to the same bias state if
1384 * they're not ground referenced.
1385 */
56fba41f 1386 bias = SND_SOC_BIAS_OFF;
52ba67bf 1387 list_for_each_entry(d, &card->dapm_list, list)
56fba41f
MB
1388 if (d->target_bias_level > bias)
1389 bias = d->target_bias_level;
52ba67bf 1390 list_for_each_entry(d, &card->dapm_list, list)
85a843c5
MB
1391 if (!d->idle_bias_off)
1392 d->target_bias_level = bias;
52ba67bf 1393
de02d078 1394 trace_snd_soc_dapm_walk_done(card);
52ba67bf 1395
9d0624a7
MB
1396 /* Run all the bias changes in parallel */
1397 list_for_each_entry(d, &dapm->card->dapm_list, list)
1398 async_schedule_domain(dapm_pre_sequence_async, d,
1399 &async_domain);
1400 async_synchronize_full_domain(&async_domain);
452c5eaa 1401
6d3ddc81 1402 /* Power down widgets first; try to avoid amplifying pops. */
828a842f 1403 dapm_seq_run(dapm, &down_list, event, false);
2b97eabc 1404
97404f2e
MB
1405 dapm_widget_update(dapm);
1406
6d3ddc81 1407 /* Now power up. */
828a842f 1408 dapm_seq_run(dapm, &up_list, event, true);
2b97eabc 1409
9d0624a7
MB
1410 /* Run all the bias changes in parallel */
1411 list_for_each_entry(d, &dapm->card->dapm_list, list)
1412 async_schedule_domain(dapm_post_sequence_async, d,
1413 &async_domain);
1414 async_synchronize_full_domain(&async_domain);
452c5eaa 1415
fd8d3bc0
JN
1416 pop_dbg(dapm->dev, card->pop_time,
1417 "DAPM sequencing finished, waiting %dms\n", card->pop_time);
3a45b867 1418 pop_wait(card->pop_time);
cb507e7e 1419
84e90930
MB
1420 trace_snd_soc_dapm_done(card);
1421
42aa3418 1422 return 0;
2b97eabc
RP
1423}
1424
79fb9387
MB
1425#ifdef CONFIG_DEBUG_FS
1426static int dapm_widget_power_open_file(struct inode *inode, struct file *file)
1427{
1428 file->private_data = inode->i_private;
1429 return 0;
1430}
1431
1432static ssize_t dapm_widget_power_read_file(struct file *file,
1433 char __user *user_buf,
1434 size_t count, loff_t *ppos)
1435{
1436 struct snd_soc_dapm_widget *w = file->private_data;
1437 char *buf;
1438 int in, out;
1439 ssize_t ret;
1440 struct snd_soc_dapm_path *p = NULL;
1441
1442 buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
1443 if (!buf)
1444 return -ENOMEM;
1445
1446 in = is_connected_input_ep(w);
ce6120cc 1447 dapm_clear_walk(w->dapm);
79fb9387 1448 out = is_connected_output_ep(w);
ce6120cc 1449 dapm_clear_walk(w->dapm);
79fb9387 1450
d033c36a 1451 ret = snprintf(buf, PAGE_SIZE, "%s: %s in %d out %d",
79fb9387
MB
1452 w->name, w->power ? "On" : "Off", in, out);
1453
d033c36a
MB
1454 if (w->reg >= 0)
1455 ret += snprintf(buf + ret, PAGE_SIZE - ret,
1456 " - R%d(0x%x) bit %d",
1457 w->reg, w->reg, w->shift);
1458
1459 ret += snprintf(buf + ret, PAGE_SIZE - ret, "\n");
1460
3eef08ba
MB
1461 if (w->sname)
1462 ret += snprintf(buf + ret, PAGE_SIZE - ret, " stream %s %s\n",
1463 w->sname,
1464 w->active ? "active" : "inactive");
79fb9387
MB
1465
1466 list_for_each_entry(p, &w->sources, list_sink) {
215edda3
MB
1467 if (p->connected && !p->connected(w, p->sink))
1468 continue;
1469
79fb9387
MB
1470 if (p->connect)
1471 ret += snprintf(buf + ret, PAGE_SIZE - ret,
67f5ed6e 1472 " in \"%s\" \"%s\"\n",
79fb9387
MB
1473 p->name ? p->name : "static",
1474 p->source->name);
1475 }
1476 list_for_each_entry(p, &w->sinks, list_source) {
215edda3
MB
1477 if (p->connected && !p->connected(w, p->sink))
1478 continue;
1479
79fb9387
MB
1480 if (p->connect)
1481 ret += snprintf(buf + ret, PAGE_SIZE - ret,
67f5ed6e 1482 " out \"%s\" \"%s\"\n",
79fb9387
MB
1483 p->name ? p->name : "static",
1484 p->sink->name);
1485 }
1486
1487 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
1488
1489 kfree(buf);
1490 return ret;
1491}
1492
1493static const struct file_operations dapm_widget_power_fops = {
1494 .open = dapm_widget_power_open_file,
1495 .read = dapm_widget_power_read_file,
6038f373 1496 .llseek = default_llseek,
79fb9387
MB
1497};
1498
ef49e4fa
MB
1499static int dapm_bias_open_file(struct inode *inode, struct file *file)
1500{
1501 file->private_data = inode->i_private;
1502 return 0;
1503}
1504
1505static ssize_t dapm_bias_read_file(struct file *file, char __user *user_buf,
1506 size_t count, loff_t *ppos)
1507{
1508 struct snd_soc_dapm_context *dapm = file->private_data;
1509 char *level;
1510
1511 switch (dapm->bias_level) {
1512 case SND_SOC_BIAS_ON:
1513 level = "On\n";
1514 break;
1515 case SND_SOC_BIAS_PREPARE:
1516 level = "Prepare\n";
1517 break;
1518 case SND_SOC_BIAS_STANDBY:
1519 level = "Standby\n";
1520 break;
1521 case SND_SOC_BIAS_OFF:
1522 level = "Off\n";
1523 break;
1524 default:
1525 BUG();
1526 level = "Unknown\n";
1527 break;
1528 }
1529
1530 return simple_read_from_buffer(user_buf, count, ppos, level,
1531 strlen(level));
1532}
1533
1534static const struct file_operations dapm_bias_fops = {
1535 .open = dapm_bias_open_file,
1536 .read = dapm_bias_read_file,
1537 .llseek = default_llseek,
1538};
1539
8eecaf62
LPC
1540void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
1541 struct dentry *parent)
79fb9387 1542{
79fb9387
MB
1543 struct dentry *d;
1544
8eecaf62
LPC
1545 dapm->debugfs_dapm = debugfs_create_dir("dapm", parent);
1546
1547 if (!dapm->debugfs_dapm) {
1548 printk(KERN_WARNING
1549 "Failed to create DAPM debugfs directory\n");
79fb9387 1550 return;
8eecaf62 1551 }
79fb9387 1552
ef49e4fa
MB
1553 d = debugfs_create_file("bias_level", 0444,
1554 dapm->debugfs_dapm, dapm,
1555 &dapm_bias_fops);
1556 if (!d)
1557 dev_warn(dapm->dev,
1558 "ASoC: Failed to create bias level debugfs file\n");
d5d1e0be 1559}
ef49e4fa 1560
d5d1e0be
LPC
1561static void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
1562{
1563 struct snd_soc_dapm_context *dapm = w->dapm;
1564 struct dentry *d;
79fb9387 1565
d5d1e0be
LPC
1566 if (!dapm->debugfs_dapm || !w->name)
1567 return;
1568
1569 d = debugfs_create_file(w->name, 0444,
1570 dapm->debugfs_dapm, w,
1571 &dapm_widget_power_fops);
1572 if (!d)
1573 dev_warn(w->dapm->dev,
1574 "ASoC: Failed to create %s debugfs file\n",
1575 w->name);
79fb9387 1576}
d5d1e0be 1577
6c45e126
LPC
1578static void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
1579{
1580 debugfs_remove_recursive(dapm->debugfs_dapm);
1581}
1582
79fb9387 1583#else
8eecaf62
LPC
1584void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
1585 struct dentry *parent)
79fb9387
MB
1586{
1587}
d5d1e0be
LPC
1588
1589static inline void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
1590{
1591}
1592
6c45e126
LPC
1593static inline void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
1594{
1595}
1596
79fb9387
MB
1597#endif
1598
2b97eabc 1599/* test and update the power status of a mux widget */
d9c96cf3 1600static int dapm_mux_update_power(struct snd_soc_dapm_widget *widget,
3a65577d
MB
1601 struct snd_kcontrol *kcontrol, int change,
1602 int mux, struct soc_enum *e)
2b97eabc
RP
1603{
1604 struct snd_soc_dapm_path *path;
1605 int found = 0;
1606
eff317d0 1607 if (widget->id != snd_soc_dapm_mux &&
24ff33ac 1608 widget->id != snd_soc_dapm_virt_mux &&
eff317d0 1609 widget->id != snd_soc_dapm_value_mux)
2b97eabc
RP
1610 return -ENODEV;
1611
3a65577d 1612 if (!change)
2b97eabc
RP
1613 return 0;
1614
1615 /* find dapm widget path assoc with kcontrol */
8ddab3f5 1616 list_for_each_entry(path, &widget->dapm->card->paths, list) {
2b97eabc
RP
1617 if (path->kcontrol != kcontrol)
1618 continue;
1619
cb01e2b9 1620 if (!path->name || !e->texts[mux])
2b97eabc
RP
1621 continue;
1622
1623 found = 1;
1624 /* we now need to match the string in the enum to the path */
db432b41 1625 if (!(strcmp(path->name, e->texts[mux]))) {
2b97eabc 1626 path->connect = 1; /* new connection */
db432b41
MB
1627 dapm_mark_dirty(path->source);
1628 } else {
1629 if (path->connect)
1630 dapm_mark_dirty(path->source);
2b97eabc 1631 path->connect = 0; /* old connection must be powered down */
db432b41 1632 }
2b97eabc
RP
1633 }
1634
db432b41
MB
1635 if (found) {
1636 dapm_mark_dirty(widget);
ce6120cc 1637 dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
db432b41 1638 }
2b97eabc
RP
1639
1640 return 0;
1641}
2b97eabc 1642
1b075e3f 1643/* test and update the power status of a mixer or switch widget */
d9c96cf3 1644static int dapm_mixer_update_power(struct snd_soc_dapm_widget *widget,
283375ce 1645 struct snd_kcontrol *kcontrol, int connect)
2b97eabc
RP
1646{
1647 struct snd_soc_dapm_path *path;
1648 int found = 0;
1649
1b075e3f 1650 if (widget->id != snd_soc_dapm_mixer &&
ca9c1aae 1651 widget->id != snd_soc_dapm_mixer_named_ctl &&
1b075e3f 1652 widget->id != snd_soc_dapm_switch)
2b97eabc
RP
1653 return -ENODEV;
1654
2b97eabc 1655 /* find dapm widget path assoc with kcontrol */
8ddab3f5 1656 list_for_each_entry(path, &widget->dapm->card->paths, list) {
2b97eabc
RP
1657 if (path->kcontrol != kcontrol)
1658 continue;
1659
1660 /* found, now check type */
1661 found = 1;
283375ce 1662 path->connect = connect;
db432b41 1663 dapm_mark_dirty(path->source);
2b97eabc
RP
1664 }
1665
db432b41
MB
1666 if (found) {
1667 dapm_mark_dirty(widget);
ce6120cc 1668 dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
db432b41 1669 }
2b97eabc
RP
1670
1671 return 0;
1672}
2b97eabc
RP
1673
1674/* show dapm widget status in sys fs */
1675static ssize_t dapm_widget_show(struct device *dev,
1676 struct device_attribute *attr, char *buf)
1677{
f0fba2ad
LG
1678 struct snd_soc_pcm_runtime *rtd =
1679 container_of(dev, struct snd_soc_pcm_runtime, dev);
1680 struct snd_soc_codec *codec =rtd->codec;
2b97eabc
RP
1681 struct snd_soc_dapm_widget *w;
1682 int count = 0;
1683 char *state = "not set";
1684
97c866de
JN
1685 list_for_each_entry(w, &codec->card->widgets, list) {
1686 if (w->dapm != &codec->dapm)
1687 continue;
2b97eabc
RP
1688
1689 /* only display widgets that burnm power */
1690 switch (w->id) {
1691 case snd_soc_dapm_hp:
1692 case snd_soc_dapm_mic:
1693 case snd_soc_dapm_spk:
1694 case snd_soc_dapm_line:
1695 case snd_soc_dapm_micbias:
1696 case snd_soc_dapm_dac:
1697 case snd_soc_dapm_adc:
1698 case snd_soc_dapm_pga:
d88429a6 1699 case snd_soc_dapm_out_drv:
2b97eabc 1700 case snd_soc_dapm_mixer:
ca9c1aae 1701 case snd_soc_dapm_mixer_named_ctl:
246d0a17 1702 case snd_soc_dapm_supply:
2b97eabc
RP
1703 if (w->name)
1704 count += sprintf(buf + count, "%s: %s\n",
1705 w->name, w->power ? "On":"Off");
1706 break;
1707 default:
1708 break;
1709 }
1710 }
1711
ce6120cc 1712 switch (codec->dapm.bias_level) {
0be9898a
MB
1713 case SND_SOC_BIAS_ON:
1714 state = "On";
2b97eabc 1715 break;
0be9898a
MB
1716 case SND_SOC_BIAS_PREPARE:
1717 state = "Prepare";
2b97eabc 1718 break;
0be9898a
MB
1719 case SND_SOC_BIAS_STANDBY:
1720 state = "Standby";
2b97eabc 1721 break;
0be9898a
MB
1722 case SND_SOC_BIAS_OFF:
1723 state = "Off";
2b97eabc
RP
1724 break;
1725 }
1726 count += sprintf(buf + count, "PM State: %s\n", state);
1727
1728 return count;
1729}
1730
1731static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL);
1732
1733int snd_soc_dapm_sys_add(struct device *dev)
1734{
12ef193d 1735 return device_create_file(dev, &dev_attr_dapm_widget);
2b97eabc
RP
1736}
1737
1738static void snd_soc_dapm_sys_remove(struct device *dev)
1739{
aef90843 1740 device_remove_file(dev, &dev_attr_dapm_widget);
2b97eabc
RP
1741}
1742
1743/* free all dapm widgets and resources */
ce6120cc 1744static void dapm_free_widgets(struct snd_soc_dapm_context *dapm)
2b97eabc
RP
1745{
1746 struct snd_soc_dapm_widget *w, *next_w;
1747 struct snd_soc_dapm_path *p, *next_p;
1748
97c866de
JN
1749 list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) {
1750 if (w->dapm != dapm)
1751 continue;
2b97eabc 1752 list_del(&w->list);
8ddab3f5
JN
1753 /*
1754 * remove source and sink paths associated to this widget.
1755 * While removing the path, remove reference to it from both
1756 * source and sink widgets so that path is removed only once.
1757 */
1758 list_for_each_entry_safe(p, next_p, &w->sources, list_sink) {
1759 list_del(&p->list_sink);
1760 list_del(&p->list_source);
1761 list_del(&p->list);
1762 kfree(p->long_name);
1763 kfree(p);
1764 }
1765 list_for_each_entry_safe(p, next_p, &w->sinks, list_source) {
1766 list_del(&p->list_sink);
1767 list_del(&p->list_source);
1768 list_del(&p->list);
1769 kfree(p->long_name);
1770 kfree(p);
1771 }
fad59888 1772 kfree(w->kcontrols);
ead9b919 1773 kfree(w->name);
2b97eabc
RP
1774 kfree(w);
1775 }
2b97eabc
RP
1776}
1777
91a5fca4
LPC
1778static struct snd_soc_dapm_widget *dapm_find_widget(
1779 struct snd_soc_dapm_context *dapm, const char *pin,
1780 bool search_other_contexts)
a5302181
LG
1781{
1782 struct snd_soc_dapm_widget *w;
91a5fca4 1783 struct snd_soc_dapm_widget *fallback = NULL;
a5302181 1784
97c866de 1785 list_for_each_entry(w, &dapm->card->widgets, list) {
a5302181 1786 if (!strcmp(w->name, pin)) {
91a5fca4
LPC
1787 if (w->dapm == dapm)
1788 return w;
1789 else
1790 fallback = w;
a5302181
LG
1791 }
1792 }
1793
91a5fca4
LPC
1794 if (search_other_contexts)
1795 return fallback;
1796
1797 return NULL;
1798}
1799
1800static int snd_soc_dapm_set_pin(struct snd_soc_dapm_context *dapm,
1801 const char *pin, int status)
1802{
1803 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
1804
1805 if (!w) {
1806 dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
1807 return -EINVAL;
0d86733c
MB
1808 }
1809
91a5fca4
LPC
1810 w->connected = status;
1811 if (status == 0)
1812 w->force = 0;
db432b41 1813 dapm_mark_dirty(w);
91a5fca4
LPC
1814
1815 return 0;
a5302181
LG
1816}
1817
2b97eabc 1818/**
a5302181 1819 * snd_soc_dapm_sync - scan and power dapm paths
ce6120cc 1820 * @dapm: DAPM context
2b97eabc
RP
1821 *
1822 * Walks all dapm audio paths and powers widgets according to their
1823 * stream or path usage.
1824 *
1825 * Returns 0 for success.
1826 */
ce6120cc 1827int snd_soc_dapm_sync(struct snd_soc_dapm_context *dapm)
2b97eabc 1828{
ce6120cc 1829 return dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
2b97eabc 1830}
a5302181 1831EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
2b97eabc 1832
ce6120cc 1833static int snd_soc_dapm_add_route(struct snd_soc_dapm_context *dapm,
215edda3 1834 const struct snd_soc_dapm_route *route)
2b97eabc
RP
1835{
1836 struct snd_soc_dapm_path *path;
1837 struct snd_soc_dapm_widget *wsource = NULL, *wsink = NULL, *w;
97c866de 1838 struct snd_soc_dapm_widget *wtsource = NULL, *wtsink = NULL;
ead9b919 1839 const char *sink;
215edda3 1840 const char *control = route->control;
ead9b919
JN
1841 const char *source;
1842 char prefixed_sink[80];
1843 char prefixed_source[80];
2b97eabc
RP
1844 int ret = 0;
1845
88e8b9a8 1846 if (dapm->codec && dapm->codec->name_prefix) {
ead9b919
JN
1847 snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
1848 dapm->codec->name_prefix, route->sink);
1849 sink = prefixed_sink;
1850 snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
1851 dapm->codec->name_prefix, route->source);
1852 source = prefixed_source;
1853 } else {
1854 sink = route->sink;
1855 source = route->source;
1856 }
1857
97c866de
JN
1858 /*
1859 * find src and dest widgets over all widgets but favor a widget from
1860 * current DAPM context
1861 */
1862 list_for_each_entry(w, &dapm->card->widgets, list) {
2b97eabc 1863 if (!wsink && !(strcmp(w->name, sink))) {
97c866de
JN
1864 wtsink = w;
1865 if (w->dapm == dapm)
1866 wsink = w;
2b97eabc
RP
1867 continue;
1868 }
1869 if (!wsource && !(strcmp(w->name, source))) {
97c866de
JN
1870 wtsource = w;
1871 if (w->dapm == dapm)
1872 wsource = w;
2b97eabc
RP
1873 }
1874 }
97c866de
JN
1875 /* use widget from another DAPM context if not found from this */
1876 if (!wsink)
1877 wsink = wtsink;
1878 if (!wsource)
1879 wsource = wtsource;
2b97eabc
RP
1880
1881 if (wsource == NULL || wsink == NULL)
1882 return -ENODEV;
1883
1884 path = kzalloc(sizeof(struct snd_soc_dapm_path), GFP_KERNEL);
1885 if (!path)
1886 return -ENOMEM;
1887
1888 path->source = wsource;
1889 path->sink = wsink;
215edda3 1890 path->connected = route->connected;
2b97eabc
RP
1891 INIT_LIST_HEAD(&path->list);
1892 INIT_LIST_HEAD(&path->list_source);
1893 INIT_LIST_HEAD(&path->list_sink);
1894
1895 /* check for external widgets */
1896 if (wsink->id == snd_soc_dapm_input) {
1897 if (wsource->id == snd_soc_dapm_micbias ||
1898 wsource->id == snd_soc_dapm_mic ||
087d53ab
RC
1899 wsource->id == snd_soc_dapm_line ||
1900 wsource->id == snd_soc_dapm_output)
2b97eabc
RP
1901 wsink->ext = 1;
1902 }
1903 if (wsource->id == snd_soc_dapm_output) {
1904 if (wsink->id == snd_soc_dapm_spk ||
1905 wsink->id == snd_soc_dapm_hp ||
1e39221e
SF
1906 wsink->id == snd_soc_dapm_line ||
1907 wsink->id == snd_soc_dapm_input)
2b97eabc
RP
1908 wsource->ext = 1;
1909 }
1910
1911 /* connect static paths */
1912 if (control == NULL) {
8ddab3f5 1913 list_add(&path->list, &dapm->card->paths);
2b97eabc
RP
1914 list_add(&path->list_sink, &wsink->sources);
1915 list_add(&path->list_source, &wsource->sinks);
1916 path->connect = 1;
1917 return 0;
1918 }
1919
1920 /* connect dynamic paths */
dc2bea61 1921 switch (wsink->id) {
2b97eabc
RP
1922 case snd_soc_dapm_adc:
1923 case snd_soc_dapm_dac:
1924 case snd_soc_dapm_pga:
d88429a6 1925 case snd_soc_dapm_out_drv:
2b97eabc
RP
1926 case snd_soc_dapm_input:
1927 case snd_soc_dapm_output:
1928 case snd_soc_dapm_micbias:
1929 case snd_soc_dapm_vmid:
1930 case snd_soc_dapm_pre:
1931 case snd_soc_dapm_post:
246d0a17 1932 case snd_soc_dapm_supply:
010ff262
MB
1933 case snd_soc_dapm_aif_in:
1934 case snd_soc_dapm_aif_out:
8ddab3f5 1935 list_add(&path->list, &dapm->card->paths);
2b97eabc
RP
1936 list_add(&path->list_sink, &wsink->sources);
1937 list_add(&path->list_source, &wsource->sinks);
1938 path->connect = 1;
1939 return 0;
1940 case snd_soc_dapm_mux:
24ff33ac 1941 case snd_soc_dapm_virt_mux:
74155556 1942 case snd_soc_dapm_value_mux:
ce6120cc 1943 ret = dapm_connect_mux(dapm, wsource, wsink, path, control,
82cfecdc 1944 &wsink->kcontrol_news[0]);
2b97eabc
RP
1945 if (ret != 0)
1946 goto err;
1947 break;
1948 case snd_soc_dapm_switch:
1949 case snd_soc_dapm_mixer:
ca9c1aae 1950 case snd_soc_dapm_mixer_named_ctl:
ce6120cc 1951 ret = dapm_connect_mixer(dapm, wsource, wsink, path, control);
2b97eabc
RP
1952 if (ret != 0)
1953 goto err;
1954 break;
1955 case snd_soc_dapm_hp:
1956 case snd_soc_dapm_mic:
1957 case snd_soc_dapm_line:
1958 case snd_soc_dapm_spk:
8ddab3f5 1959 list_add(&path->list, &dapm->card->paths);
2b97eabc
RP
1960 list_add(&path->list_sink, &wsink->sources);
1961 list_add(&path->list_source, &wsource->sinks);
1962 path->connect = 0;
1963 return 0;
1964 }
1965 return 0;
1966
1967err:
f7d41ae8
JN
1968 dev_warn(dapm->dev, "asoc: no dapm match for %s --> %s --> %s\n",
1969 source, control, sink);
2b97eabc
RP
1970 kfree(path);
1971 return ret;
1972}
105f1c28 1973
105f1c28
MB
1974/**
1975 * snd_soc_dapm_add_routes - Add routes between DAPM widgets
ce6120cc 1976 * @dapm: DAPM context
105f1c28
MB
1977 * @route: audio routes
1978 * @num: number of routes
1979 *
1980 * Connects 2 dapm widgets together via a named audio path. The sink is
1981 * the widget receiving the audio signal, whilst the source is the sender
1982 * of the audio signal.
1983 *
1984 * Returns 0 for success else error. On error all resources can be freed
1985 * with a call to snd_soc_card_free().
1986 */
ce6120cc 1987int snd_soc_dapm_add_routes(struct snd_soc_dapm_context *dapm,
105f1c28
MB
1988 const struct snd_soc_dapm_route *route, int num)
1989{
1990 int i, ret;
1991
1992 for (i = 0; i < num; i++) {
ce6120cc 1993 ret = snd_soc_dapm_add_route(dapm, route);
105f1c28 1994 if (ret < 0) {
f7d41ae8
JN
1995 dev_err(dapm->dev, "Failed to add route %s->%s\n",
1996 route->source, route->sink);
105f1c28
MB
1997 return ret;
1998 }
1999 route++;
2000 }
2001
2002 return 0;
2003}
2004EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);
2005
bf3a9e13
MB
2006static int snd_soc_dapm_weak_route(struct snd_soc_dapm_context *dapm,
2007 const struct snd_soc_dapm_route *route)
2008{
2009 struct snd_soc_dapm_widget *source = dapm_find_widget(dapm,
2010 route->source,
2011 true);
2012 struct snd_soc_dapm_widget *sink = dapm_find_widget(dapm,
2013 route->sink,
2014 true);
2015 struct snd_soc_dapm_path *path;
2016 int count = 0;
2017
2018 if (!source) {
2019 dev_err(dapm->dev, "Unable to find source %s for weak route\n",
2020 route->source);
2021 return -ENODEV;
2022 }
2023
2024 if (!sink) {
2025 dev_err(dapm->dev, "Unable to find sink %s for weak route\n",
2026 route->sink);
2027 return -ENODEV;
2028 }
2029
2030 if (route->control || route->connected)
2031 dev_warn(dapm->dev, "Ignoring control for weak route %s->%s\n",
2032 route->source, route->sink);
2033
2034 list_for_each_entry(path, &source->sinks, list_source) {
2035 if (path->sink == sink) {
2036 path->weak = 1;
2037 count++;
2038 }
2039 }
2040
2041 if (count == 0)
2042 dev_err(dapm->dev, "No path found for weak route %s->%s\n",
2043 route->source, route->sink);
2044 if (count > 1)
2045 dev_warn(dapm->dev, "%d paths found for weak route %s->%s\n",
2046 count, route->source, route->sink);
2047
2048 return 0;
2049}
2050
2051/**
2052 * snd_soc_dapm_weak_routes - Mark routes between DAPM widgets as weak
2053 * @dapm: DAPM context
2054 * @route: audio routes
2055 * @num: number of routes
2056 *
2057 * Mark existing routes matching those specified in the passed array
2058 * as being weak, meaning that they are ignored for the purpose of
2059 * power decisions. The main intended use case is for sidetone paths
2060 * which couple audio between other independent paths if they are both
2061 * active in order to make the combination work better at the user
2062 * level but which aren't intended to be "used".
2063 *
2064 * Note that CODEC drivers should not use this as sidetone type paths
2065 * can frequently also be used as bypass paths.
2066 */
2067int snd_soc_dapm_weak_routes(struct snd_soc_dapm_context *dapm,
2068 const struct snd_soc_dapm_route *route, int num)
2069{
2070 int i, err;
2071 int ret = 0;
2072
2073 for (i = 0; i < num; i++) {
2074 err = snd_soc_dapm_weak_route(dapm, route);
2075 if (err)
2076 ret = err;
2077 route++;
2078 }
2079
2080 return ret;
2081}
2082EXPORT_SYMBOL_GPL(snd_soc_dapm_weak_routes);
2083
2b97eabc
RP
2084/**
2085 * snd_soc_dapm_new_widgets - add new dapm widgets
ce6120cc 2086 * @dapm: DAPM context
2b97eabc
RP
2087 *
2088 * Checks the codec for any new dapm widgets and creates them if found.
2089 *
2090 * Returns 0 for success.
2091 */
ce6120cc 2092int snd_soc_dapm_new_widgets(struct snd_soc_dapm_context *dapm)
2b97eabc
RP
2093{
2094 struct snd_soc_dapm_widget *w;
b66a70d5 2095 unsigned int val;
2b97eabc 2096
97c866de 2097 list_for_each_entry(w, &dapm->card->widgets, list)
2b97eabc
RP
2098 {
2099 if (w->new)
2100 continue;
2101
fad59888
SW
2102 if (w->num_kcontrols) {
2103 w->kcontrols = kzalloc(w->num_kcontrols *
2104 sizeof(struct snd_kcontrol *),
2105 GFP_KERNEL);
2106 if (!w->kcontrols)
2107 return -ENOMEM;
2108 }
2109
2b97eabc
RP
2110 switch(w->id) {
2111 case snd_soc_dapm_switch:
2112 case snd_soc_dapm_mixer:
ca9c1aae 2113 case snd_soc_dapm_mixer_named_ctl:
b75576d7 2114 w->power_check = dapm_generic_check_power;
4b80b8c2 2115 dapm_new_mixer(w);
2b97eabc
RP
2116 break;
2117 case snd_soc_dapm_mux:
24ff33ac 2118 case snd_soc_dapm_virt_mux:
2e72f8e3 2119 case snd_soc_dapm_value_mux:
b75576d7 2120 w->power_check = dapm_generic_check_power;
4b80b8c2 2121 dapm_new_mux(w);
2b97eabc
RP
2122 break;
2123 case snd_soc_dapm_adc:
010ff262 2124 case snd_soc_dapm_aif_out:
b75576d7
MB
2125 w->power_check = dapm_adc_check_power;
2126 break;
2b97eabc 2127 case snd_soc_dapm_dac:
010ff262 2128 case snd_soc_dapm_aif_in:
b75576d7
MB
2129 w->power_check = dapm_dac_check_power;
2130 break;
2b97eabc 2131 case snd_soc_dapm_pga:
d88429a6 2132 case snd_soc_dapm_out_drv:
b75576d7 2133 w->power_check = dapm_generic_check_power;
4b80b8c2 2134 dapm_new_pga(w);
2b97eabc
RP
2135 break;
2136 case snd_soc_dapm_input:
2137 case snd_soc_dapm_output:
2138 case snd_soc_dapm_micbias:
2139 case snd_soc_dapm_spk:
2140 case snd_soc_dapm_hp:
2141 case snd_soc_dapm_mic:
2142 case snd_soc_dapm_line:
b75576d7
MB
2143 w->power_check = dapm_generic_check_power;
2144 break;
246d0a17
MB
2145 case snd_soc_dapm_supply:
2146 w->power_check = dapm_supply_check_power;
2b97eabc
RP
2147 case snd_soc_dapm_vmid:
2148 case snd_soc_dapm_pre:
2149 case snd_soc_dapm_post:
2150 break;
2151 }
b66a70d5 2152
35c64bca
MB
2153 if (!w->power_check)
2154 w->power_check = dapm_always_on_check_power;
2155
b66a70d5
MB
2156 /* Read the initial power state from the device */
2157 if (w->reg >= 0) {
0445bdf4 2158 val = soc_widget_read(w, w->reg);
b66a70d5
MB
2159 val &= 1 << w->shift;
2160 if (w->invert)
2161 val = !val;
2162
2163 if (val)
2164 w->power = 1;
2165 }
2166
2b97eabc 2167 w->new = 1;
d5d1e0be 2168
db432b41 2169 list_add(&w->dirty, &(w->dapm->card->dapm_dirty));
d5d1e0be 2170 dapm_debugfs_add_widget(w);
2b97eabc
RP
2171 }
2172
ce6120cc 2173 dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
2b97eabc
RP
2174 return 0;
2175}
2176EXPORT_SYMBOL_GPL(snd_soc_dapm_new_widgets);
2177
2178/**
2179 * snd_soc_dapm_get_volsw - dapm mixer get callback
2180 * @kcontrol: mixer control
ac11a2b3 2181 * @ucontrol: control element information
2b97eabc
RP
2182 *
2183 * Callback to get the value of a dapm mixer control.
2184 *
2185 * Returns 0 for success.
2186 */
2187int snd_soc_dapm_get_volsw(struct snd_kcontrol *kcontrol,
2188 struct snd_ctl_elem_value *ucontrol)
2189{
fafd2176
SW
2190 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2191 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
4eaa9819
JS
2192 struct soc_mixer_control *mc =
2193 (struct soc_mixer_control *)kcontrol->private_value;
815ecf8d
JS
2194 unsigned int reg = mc->reg;
2195 unsigned int shift = mc->shift;
2196 unsigned int rshift = mc->rshift;
4eaa9819 2197 int max = mc->max;
815ecf8d
JS
2198 unsigned int invert = mc->invert;
2199 unsigned int mask = (1 << fls(max)) - 1;
2b97eabc 2200
2b97eabc
RP
2201 ucontrol->value.integer.value[0] =
2202 (snd_soc_read(widget->codec, reg) >> shift) & mask;
2203 if (shift != rshift)
2204 ucontrol->value.integer.value[1] =
2205 (snd_soc_read(widget->codec, reg) >> rshift) & mask;
2206 if (invert) {
2207 ucontrol->value.integer.value[0] =
a7a4ac86 2208 max - ucontrol->value.integer.value[0];
2b97eabc
RP
2209 if (shift != rshift)
2210 ucontrol->value.integer.value[1] =
a7a4ac86 2211 max - ucontrol->value.integer.value[1];
2b97eabc
RP
2212 }
2213
2214 return 0;
2215}
2216EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);
2217
2218/**
2219 * snd_soc_dapm_put_volsw - dapm mixer set callback
2220 * @kcontrol: mixer control
ac11a2b3 2221 * @ucontrol: control element information
2b97eabc
RP
2222 *
2223 * Callback to set the value of a dapm mixer control.
2224 *
2225 * Returns 0 for success.
2226 */
2227int snd_soc_dapm_put_volsw(struct snd_kcontrol *kcontrol,
2228 struct snd_ctl_elem_value *ucontrol)
2229{
fafd2176
SW
2230 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2231 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2232 struct snd_soc_codec *codec = widget->codec;
4eaa9819
JS
2233 struct soc_mixer_control *mc =
2234 (struct soc_mixer_control *)kcontrol->private_value;
815ecf8d
JS
2235 unsigned int reg = mc->reg;
2236 unsigned int shift = mc->shift;
4eaa9819 2237 int max = mc->max;
815ecf8d
JS
2238 unsigned int mask = (1 << fls(max)) - 1;
2239 unsigned int invert = mc->invert;
e9cf7049 2240 unsigned int val;
97404f2e
MB
2241 int connect, change;
2242 struct snd_soc_dapm_update update;
fafd2176 2243 int wi;
2b97eabc
RP
2244
2245 val = (ucontrol->value.integer.value[0] & mask);
2246
2247 if (invert)
a7a4ac86 2248 val = max - val;
e9cf7049 2249 mask = mask << shift;
2b97eabc 2250 val = val << shift;
2b97eabc 2251
fafd2176
SW
2252 if (val)
2253 /* new connection */
2254 connect = invert ? 0 : 1;
2255 else
2256 /* old connection must be powered down */
2257 connect = invert ? 1 : 0;
2258
2259 mutex_lock(&codec->mutex);
2b97eabc 2260
e9cf7049 2261 change = snd_soc_test_bits(widget->codec, reg, mask, val);
97404f2e 2262 if (change) {
fafd2176
SW
2263 for (wi = 0; wi < wlist->num_widgets; wi++) {
2264 widget = wlist->widgets[wi];
283375ce 2265
fafd2176 2266 widget->value = val;
97404f2e 2267
fafd2176
SW
2268 update.kcontrol = kcontrol;
2269 update.widget = widget;
2270 update.reg = reg;
2271 update.mask = mask;
2272 update.val = val;
2273 widget->dapm->update = &update;
97404f2e 2274
fafd2176
SW
2275 dapm_mixer_update_power(widget, kcontrol, connect);
2276
2277 widget->dapm->update = NULL;
2278 }
283375ce
MB
2279 }
2280
fafd2176 2281 mutex_unlock(&codec->mutex);
97404f2e 2282 return 0;
2b97eabc
RP
2283}
2284EXPORT_SYMBOL_GPL(snd_soc_dapm_put_volsw);
2285
2286/**
2287 * snd_soc_dapm_get_enum_double - dapm enumerated double mixer get callback
2288 * @kcontrol: mixer control
ac11a2b3 2289 * @ucontrol: control element information
2b97eabc
RP
2290 *
2291 * Callback to get the value of a dapm enumerated double mixer control.
2292 *
2293 * Returns 0 for success.
2294 */
2295int snd_soc_dapm_get_enum_double(struct snd_kcontrol *kcontrol,
2296 struct snd_ctl_elem_value *ucontrol)
2297{
fafd2176
SW
2298 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2299 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2b97eabc 2300 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
46f5822f 2301 unsigned int val, bitmask;
2b97eabc 2302
f8ba0b7b 2303 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2b97eabc
RP
2304 ;
2305 val = snd_soc_read(widget->codec, e->reg);
2306 ucontrol->value.enumerated.item[0] = (val >> e->shift_l) & (bitmask - 1);
2307 if (e->shift_l != e->shift_r)
2308 ucontrol->value.enumerated.item[1] =
2309 (val >> e->shift_r) & (bitmask - 1);
2310
2311 return 0;
2312}
2313EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);
2314
2315/**
2316 * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
2317 * @kcontrol: mixer control
ac11a2b3 2318 * @ucontrol: control element information
2b97eabc
RP
2319 *
2320 * Callback to set the value of a dapm enumerated double mixer control.
2321 *
2322 * Returns 0 for success.
2323 */
2324int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
2325 struct snd_ctl_elem_value *ucontrol)
2326{
fafd2176
SW
2327 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2328 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2329 struct snd_soc_codec *codec = widget->codec;
2b97eabc 2330 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
3a65577d 2331 unsigned int val, mux, change;
46f5822f 2332 unsigned int mask, bitmask;
97404f2e 2333 struct snd_soc_dapm_update update;
fafd2176 2334 int wi;
2b97eabc 2335
f8ba0b7b 2336 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2b97eabc 2337 ;
f8ba0b7b 2338 if (ucontrol->value.enumerated.item[0] > e->max - 1)
2b97eabc
RP
2339 return -EINVAL;
2340 mux = ucontrol->value.enumerated.item[0];
2341 val = mux << e->shift_l;
2342 mask = (bitmask - 1) << e->shift_l;
2343 if (e->shift_l != e->shift_r) {
f8ba0b7b 2344 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2b97eabc
RP
2345 return -EINVAL;
2346 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
2347 mask |= (bitmask - 1) << e->shift_r;
2348 }
2349
fafd2176
SW
2350 mutex_lock(&codec->mutex);
2351
3a65577d 2352 change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
fafd2176
SW
2353 if (change) {
2354 for (wi = 0; wi < wlist->num_widgets; wi++) {
2355 widget = wlist->widgets[wi];
2356
2357 widget->value = val;
1642e3d4 2358
fafd2176
SW
2359 update.kcontrol = kcontrol;
2360 update.widget = widget;
2361 update.reg = e->reg;
2362 update.mask = mask;
2363 update.val = val;
2364 widget->dapm->update = &update;
1642e3d4 2365
fafd2176 2366 dapm_mux_update_power(widget, kcontrol, change, mux, e);
1642e3d4 2367
fafd2176
SW
2368 widget->dapm->update = NULL;
2369 }
2370 }
2b97eabc 2371
fafd2176 2372 mutex_unlock(&codec->mutex);
97404f2e 2373 return change;
2b97eabc
RP
2374}
2375EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);
2376
d2b247a8
MB
2377/**
2378 * snd_soc_dapm_get_enum_virt - Get virtual DAPM mux
2379 * @kcontrol: mixer control
2380 * @ucontrol: control element information
2381 *
2382 * Returns 0 for success.
2383 */
2384int snd_soc_dapm_get_enum_virt(struct snd_kcontrol *kcontrol,
2385 struct snd_ctl_elem_value *ucontrol)
2386{
fafd2176
SW
2387 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2388 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
d2b247a8
MB
2389
2390 ucontrol->value.enumerated.item[0] = widget->value;
2391
2392 return 0;
2393}
2394EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_virt);
2395
2396/**
2397 * snd_soc_dapm_put_enum_virt - Set virtual DAPM mux
2398 * @kcontrol: mixer control
2399 * @ucontrol: control element information
2400 *
2401 * Returns 0 for success.
2402 */
2403int snd_soc_dapm_put_enum_virt(struct snd_kcontrol *kcontrol,
2404 struct snd_ctl_elem_value *ucontrol)
2405{
fafd2176
SW
2406 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2407 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2408 struct snd_soc_codec *codec = widget->codec;
d2b247a8
MB
2409 struct soc_enum *e =
2410 (struct soc_enum *)kcontrol->private_value;
2411 int change;
2412 int ret = 0;
fafd2176 2413 int wi;
d2b247a8
MB
2414
2415 if (ucontrol->value.enumerated.item[0] >= e->max)
2416 return -EINVAL;
2417
fafd2176 2418 mutex_lock(&codec->mutex);
d2b247a8
MB
2419
2420 change = widget->value != ucontrol->value.enumerated.item[0];
fafd2176
SW
2421 if (change) {
2422 for (wi = 0; wi < wlist->num_widgets; wi++) {
2423 widget = wlist->widgets[wi];
2424
2425 widget->value = ucontrol->value.enumerated.item[0];
2426
2427 dapm_mux_update_power(widget, kcontrol, change,
2428 widget->value, e);
2429 }
2430 }
d2b247a8 2431
fafd2176 2432 mutex_unlock(&codec->mutex);
d2b247a8
MB
2433 return ret;
2434}
2435EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_virt);
2436
2e72f8e3
PU
2437/**
2438 * snd_soc_dapm_get_value_enum_double - dapm semi enumerated double mixer get
2439 * callback
2440 * @kcontrol: mixer control
2441 * @ucontrol: control element information
2442 *
2443 * Callback to get the value of a dapm semi enumerated double mixer control.
2444 *
2445 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2446 * used for handling bitfield coded enumeration for example.
2447 *
2448 * Returns 0 for success.
2449 */
2450int snd_soc_dapm_get_value_enum_double(struct snd_kcontrol *kcontrol,
2451 struct snd_ctl_elem_value *ucontrol)
2452{
fafd2176
SW
2453 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2454 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
74155556 2455 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
46f5822f 2456 unsigned int reg_val, val, mux;
2e72f8e3
PU
2457
2458 reg_val = snd_soc_read(widget->codec, e->reg);
2459 val = (reg_val >> e->shift_l) & e->mask;
2460 for (mux = 0; mux < e->max; mux++) {
2461 if (val == e->values[mux])
2462 break;
2463 }
2464 ucontrol->value.enumerated.item[0] = mux;
2465 if (e->shift_l != e->shift_r) {
2466 val = (reg_val >> e->shift_r) & e->mask;
2467 for (mux = 0; mux < e->max; mux++) {
2468 if (val == e->values[mux])
2469 break;
2470 }
2471 ucontrol->value.enumerated.item[1] = mux;
2472 }
2473
2474 return 0;
2475}
2476EXPORT_SYMBOL_GPL(snd_soc_dapm_get_value_enum_double);
2477
2478/**
2479 * snd_soc_dapm_put_value_enum_double - dapm semi enumerated double mixer set
2480 * callback
2481 * @kcontrol: mixer control
2482 * @ucontrol: control element information
2483 *
2484 * Callback to set the value of a dapm semi enumerated double mixer control.
2485 *
2486 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2487 * used for handling bitfield coded enumeration for example.
2488 *
2489 * Returns 0 for success.
2490 */
2491int snd_soc_dapm_put_value_enum_double(struct snd_kcontrol *kcontrol,
2492 struct snd_ctl_elem_value *ucontrol)
2493{
fafd2176
SW
2494 struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2495 struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2496 struct snd_soc_codec *codec = widget->codec;
74155556 2497 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
3a65577d 2498 unsigned int val, mux, change;
46f5822f 2499 unsigned int mask;
97404f2e 2500 struct snd_soc_dapm_update update;
fafd2176 2501 int wi;
2e72f8e3
PU
2502
2503 if (ucontrol->value.enumerated.item[0] > e->max - 1)
2504 return -EINVAL;
2505 mux = ucontrol->value.enumerated.item[0];
2506 val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
2507 mask = e->mask << e->shift_l;
2508 if (e->shift_l != e->shift_r) {
2509 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2510 return -EINVAL;
2511 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
2512 mask |= e->mask << e->shift_r;
2513 }
2514
fafd2176
SW
2515 mutex_lock(&codec->mutex);
2516
3a65577d 2517 change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
fafd2176
SW
2518 if (change) {
2519 for (wi = 0; wi < wlist->num_widgets; wi++) {
2520 widget = wlist->widgets[wi];
1642e3d4 2521
fafd2176 2522 widget->value = val;
1642e3d4 2523
fafd2176
SW
2524 update.kcontrol = kcontrol;
2525 update.widget = widget;
2526 update.reg = e->reg;
2527 update.mask = mask;
2528 update.val = val;
2529 widget->dapm->update = &update;
1642e3d4 2530
fafd2176
SW
2531 dapm_mux_update_power(widget, kcontrol, change, mux, e);
2532
2533 widget->dapm->update = NULL;
2534 }
2535 }
2e72f8e3 2536
fafd2176 2537 mutex_unlock(&codec->mutex);
97404f2e 2538 return change;
2e72f8e3
PU
2539}
2540EXPORT_SYMBOL_GPL(snd_soc_dapm_put_value_enum_double);
2541
8b37dbd2
MB
2542/**
2543 * snd_soc_dapm_info_pin_switch - Info for a pin switch
2544 *
2545 * @kcontrol: mixer control
2546 * @uinfo: control element information
2547 *
2548 * Callback to provide information about a pin switch control.
2549 */
2550int snd_soc_dapm_info_pin_switch(struct snd_kcontrol *kcontrol,
2551 struct snd_ctl_elem_info *uinfo)
2552{
2553 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2554 uinfo->count = 1;
2555 uinfo->value.integer.min = 0;
2556 uinfo->value.integer.max = 1;
2557
2558 return 0;
2559}
2560EXPORT_SYMBOL_GPL(snd_soc_dapm_info_pin_switch);
2561
2562/**
2563 * snd_soc_dapm_get_pin_switch - Get information for a pin switch
2564 *
2565 * @kcontrol: mixer control
2566 * @ucontrol: Value
2567 */
2568int snd_soc_dapm_get_pin_switch(struct snd_kcontrol *kcontrol,
2569 struct snd_ctl_elem_value *ucontrol)
2570{
2571 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2572 const char *pin = (const char *)kcontrol->private_value;
2573
2574 mutex_lock(&codec->mutex);
2575
2576 ucontrol->value.integer.value[0] =
ce6120cc 2577 snd_soc_dapm_get_pin_status(&codec->dapm, pin);
8b37dbd2
MB
2578
2579 mutex_unlock(&codec->mutex);
2580
2581 return 0;
2582}
2583EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_switch);
2584
2585/**
2586 * snd_soc_dapm_put_pin_switch - Set information for a pin switch
2587 *
2588 * @kcontrol: mixer control
2589 * @ucontrol: Value
2590 */
2591int snd_soc_dapm_put_pin_switch(struct snd_kcontrol *kcontrol,
2592 struct snd_ctl_elem_value *ucontrol)
2593{
2594 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2595 const char *pin = (const char *)kcontrol->private_value;
2596
2597 mutex_lock(&codec->mutex);
2598
2599 if (ucontrol->value.integer.value[0])
ce6120cc 2600 snd_soc_dapm_enable_pin(&codec->dapm, pin);
8b37dbd2 2601 else
ce6120cc 2602 snd_soc_dapm_disable_pin(&codec->dapm, pin);
8b37dbd2 2603
ce6120cc 2604 snd_soc_dapm_sync(&codec->dapm);
8b37dbd2
MB
2605
2606 mutex_unlock(&codec->mutex);
2607
2608 return 0;
2609}
2610EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);
2611
2b97eabc
RP
2612/**
2613 * snd_soc_dapm_new_control - create new dapm control
ce6120cc 2614 * @dapm: DAPM context
2b97eabc
RP
2615 * @widget: widget template
2616 *
2617 * Creates a new dapm control based upon the template.
2618 *
2619 * Returns 0 for success else error.
2620 */
ce6120cc 2621int snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
2b97eabc
RP
2622 const struct snd_soc_dapm_widget *widget)
2623{
2624 struct snd_soc_dapm_widget *w;
ead9b919 2625 size_t name_len;
2b97eabc
RP
2626
2627 if ((w = dapm_cnew_widget(widget)) == NULL)
2628 return -ENOMEM;
2629
ead9b919 2630 name_len = strlen(widget->name) + 1;
88e8b9a8 2631 if (dapm->codec && dapm->codec->name_prefix)
ead9b919
JN
2632 name_len += 1 + strlen(dapm->codec->name_prefix);
2633 w->name = kmalloc(name_len, GFP_KERNEL);
2634 if (w->name == NULL) {
2635 kfree(w);
2636 return -ENOMEM;
2637 }
88e8b9a8 2638 if (dapm->codec && dapm->codec->name_prefix)
ead9b919
JN
2639 snprintf(w->name, name_len, "%s %s",
2640 dapm->codec->name_prefix, widget->name);
2641 else
2642 snprintf(w->name, name_len, "%s", widget->name);
2643
97c866de 2644 dapm->n_widgets++;
ce6120cc
LG
2645 w->dapm = dapm;
2646 w->codec = dapm->codec;
b7950641 2647 w->platform = dapm->platform;
2b97eabc
RP
2648 INIT_LIST_HEAD(&w->sources);
2649 INIT_LIST_HEAD(&w->sinks);
2650 INIT_LIST_HEAD(&w->list);
db432b41 2651 INIT_LIST_HEAD(&w->dirty);
97c866de 2652 list_add(&w->list, &dapm->card->widgets);
2b97eabc
RP
2653
2654 /* machine layer set ups unconnected pins and insertions */
2655 w->connected = 1;
2656 return 0;
2657}
2658EXPORT_SYMBOL_GPL(snd_soc_dapm_new_control);
2659
4ba1327a
MB
2660/**
2661 * snd_soc_dapm_new_controls - create new dapm controls
ce6120cc 2662 * @dapm: DAPM context
4ba1327a
MB
2663 * @widget: widget array
2664 * @num: number of widgets
2665 *
2666 * Creates new DAPM controls based upon the templates.
2667 *
2668 * Returns 0 for success else error.
2669 */
ce6120cc 2670int snd_soc_dapm_new_controls(struct snd_soc_dapm_context *dapm,
4ba1327a
MB
2671 const struct snd_soc_dapm_widget *widget,
2672 int num)
2673{
2674 int i, ret;
2675
2676 for (i = 0; i < num; i++) {
ce6120cc 2677 ret = snd_soc_dapm_new_control(dapm, widget);
b8b33cb5 2678 if (ret < 0) {
f7d41ae8
JN
2679 dev_err(dapm->dev,
2680 "ASoC: Failed to create DAPM control %s: %d\n",
2681 widget->name, ret);
4ba1327a 2682 return ret;
b8b33cb5 2683 }
4ba1327a
MB
2684 widget++;
2685 }
2686 return 0;
2687}
2688EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);
2689
ce6120cc 2690static void soc_dapm_stream_event(struct snd_soc_dapm_context *dapm,
f0fba2ad 2691 const char *stream, int event)
2b97eabc
RP
2692{
2693 struct snd_soc_dapm_widget *w;
2694
97c866de 2695 list_for_each_entry(w, &dapm->card->widgets, list)
2b97eabc 2696 {
97c866de 2697 if (!w->sname || w->dapm != dapm)
2b97eabc 2698 continue;
ee47b364 2699 dev_vdbg(w->dapm->dev, "widget %s\n %s stream %s event %d\n",
f7d41ae8 2700 w->name, w->sname, stream, event);
2b97eabc 2701 if (strstr(w->sname, stream)) {
db432b41 2702 dapm_mark_dirty(w);
2b97eabc
RP
2703 switch(event) {
2704 case SND_SOC_DAPM_STREAM_START:
2705 w->active = 1;
2706 break;
2707 case SND_SOC_DAPM_STREAM_STOP:
2708 w->active = 0;
2709 break;
2710 case SND_SOC_DAPM_STREAM_SUSPEND:
2b97eabc 2711 case SND_SOC_DAPM_STREAM_RESUME:
2b97eabc 2712 case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
2b97eabc
RP
2713 case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
2714 break;
2715 }
2716 }
2717 }
2b97eabc 2718
ce6120cc 2719 dapm_power_widgets(dapm, event);
64a648c2
LG
2720
2721 /* do we need to notify any clients that DAPM stream is complete */
2722 if (dapm->stream_event)
2723 dapm->stream_event(dapm, event);
ce6120cc
LG
2724}
2725
2726/**
2727 * snd_soc_dapm_stream_event - send a stream event to the dapm core
2728 * @rtd: PCM runtime data
2729 * @stream: stream name
2730 * @event: stream event
2731 *
2732 * Sends a stream event to the dapm core. The core then makes any
2733 * necessary widget power changes.
2734 *
2735 * Returns 0 for success else error.
2736 */
2737int snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd,
2738 const char *stream, int event)
2739{
2740 struct snd_soc_codec *codec = rtd->codec;
2741
2742 if (stream == NULL)
2743 return 0;
2744
2745 mutex_lock(&codec->mutex);
2746 soc_dapm_stream_event(&codec->dapm, stream, event);
8e8b2d67 2747 mutex_unlock(&codec->mutex);
2b97eabc
RP
2748 return 0;
2749}
2b97eabc
RP
2750
2751/**
a5302181 2752 * snd_soc_dapm_enable_pin - enable pin.
ce6120cc 2753 * @dapm: DAPM context
a5302181 2754 * @pin: pin name
2b97eabc 2755 *
74b8f955 2756 * Enables input/output pin and its parents or children widgets iff there is
a5302181
LG
2757 * a valid audio route and active audio stream.
2758 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2759 * do any widget power switching.
2b97eabc 2760 */
ce6120cc 2761int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin)
2b97eabc 2762{
ce6120cc 2763 return snd_soc_dapm_set_pin(dapm, pin, 1);
a5302181
LG
2764}
2765EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
2b97eabc 2766
da34183e
MB
2767/**
2768 * snd_soc_dapm_force_enable_pin - force a pin to be enabled
ce6120cc 2769 * @dapm: DAPM context
da34183e
MB
2770 * @pin: pin name
2771 *
2772 * Enables input/output pin regardless of any other state. This is
2773 * intended for use with microphone bias supplies used in microphone
2774 * jack detection.
2775 *
2776 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2777 * do any widget power switching.
2778 */
ce6120cc
LG
2779int snd_soc_dapm_force_enable_pin(struct snd_soc_dapm_context *dapm,
2780 const char *pin)
da34183e 2781{
91a5fca4 2782 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
da34183e 2783
91a5fca4
LPC
2784 if (!w) {
2785 dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
2786 return -EINVAL;
0d86733c
MB
2787 }
2788
91a5fca4
LPC
2789 dev_dbg(w->dapm->dev, "dapm: force enable pin %s\n", pin);
2790 w->connected = 1;
2791 w->force = 1;
db432b41 2792 dapm_mark_dirty(w);
da34183e 2793
91a5fca4 2794 return 0;
da34183e
MB
2795}
2796EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin);
2797
a5302181
LG
2798/**
2799 * snd_soc_dapm_disable_pin - disable pin.
ce6120cc 2800 * @dapm: DAPM context
a5302181
LG
2801 * @pin: pin name
2802 *
74b8f955 2803 * Disables input/output pin and its parents or children widgets.
a5302181
LG
2804 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2805 * do any widget power switching.
2806 */
ce6120cc
LG
2807int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm,
2808 const char *pin)
a5302181 2809{
ce6120cc 2810 return snd_soc_dapm_set_pin(dapm, pin, 0);
2b97eabc 2811}
a5302181 2812EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
2b97eabc 2813
5817b52a
MB
2814/**
2815 * snd_soc_dapm_nc_pin - permanently disable pin.
ce6120cc 2816 * @dapm: DAPM context
5817b52a
MB
2817 * @pin: pin name
2818 *
2819 * Marks the specified pin as being not connected, disabling it along
2820 * any parent or child widgets. At present this is identical to
2821 * snd_soc_dapm_disable_pin() but in future it will be extended to do
2822 * additional things such as disabling controls which only affect
2823 * paths through the pin.
2824 *
2825 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2826 * do any widget power switching.
2827 */
ce6120cc 2828int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin)
5817b52a 2829{
ce6120cc 2830 return snd_soc_dapm_set_pin(dapm, pin, 0);
5817b52a
MB
2831}
2832EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);
2833
eeec12bf 2834/**
a5302181 2835 * snd_soc_dapm_get_pin_status - get audio pin status
ce6120cc 2836 * @dapm: DAPM context
a5302181 2837 * @pin: audio signal pin endpoint (or start point)
eeec12bf 2838 *
a5302181 2839 * Get audio pin status - connected or disconnected.
eeec12bf 2840 *
a5302181 2841 * Returns 1 for connected otherwise 0.
eeec12bf 2842 */
ce6120cc
LG
2843int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm,
2844 const char *pin)
eeec12bf 2845{
91a5fca4 2846 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
eeec12bf 2847
91a5fca4
LPC
2848 if (w)
2849 return w->connected;
a68b38ad 2850
eeec12bf
GG
2851 return 0;
2852}
a5302181 2853EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
eeec12bf 2854
1547aba9
MB
2855/**
2856 * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint
ce6120cc 2857 * @dapm: DAPM context
1547aba9
MB
2858 * @pin: audio signal pin endpoint (or start point)
2859 *
2860 * Mark the given endpoint or pin as ignoring suspend. When the
2861 * system is disabled a path between two endpoints flagged as ignoring
2862 * suspend will not be disabled. The path must already be enabled via
2863 * normal means at suspend time, it will not be turned on if it was not
2864 * already enabled.
2865 */
ce6120cc
LG
2866int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm,
2867 const char *pin)
1547aba9 2868{
91a5fca4 2869 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, false);
1547aba9 2870
91a5fca4
LPC
2871 if (!w) {
2872 dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
2873 return -EINVAL;
1547aba9
MB
2874 }
2875
91a5fca4
LPC
2876 w->ignore_suspend = 1;
2877
2878 return 0;
1547aba9
MB
2879}
2880EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend);
2881
2b97eabc
RP
2882/**
2883 * snd_soc_dapm_free - free dapm resources
728a5222 2884 * @dapm: DAPM context
2b97eabc
RP
2885 *
2886 * Free all dapm widgets and resources.
2887 */
ce6120cc 2888void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm)
2b97eabc 2889{
ce6120cc 2890 snd_soc_dapm_sys_remove(dapm->dev);
6c45e126 2891 dapm_debugfs_cleanup(dapm);
ce6120cc 2892 dapm_free_widgets(dapm);
7be31be8 2893 list_del(&dapm->list);
2b97eabc
RP
2894}
2895EXPORT_SYMBOL_GPL(snd_soc_dapm_free);
2896
ce6120cc 2897static void soc_dapm_shutdown_codec(struct snd_soc_dapm_context *dapm)
51737470 2898{
51737470
MB
2899 struct snd_soc_dapm_widget *w;
2900 LIST_HEAD(down_list);
2901 int powerdown = 0;
2902
97c866de
JN
2903 list_for_each_entry(w, &dapm->card->widgets, list) {
2904 if (w->dapm != dapm)
2905 continue;
51737470 2906 if (w->power) {
828a842f 2907 dapm_seq_insert(w, &down_list, false);
c2caa4da 2908 w->power = 0;
51737470
MB
2909 powerdown = 1;
2910 }
2911 }
2912
2913 /* If there were no widgets to power down we're already in
2914 * standby.
2915 */
2916 if (powerdown) {
ed5a4c47 2917 snd_soc_dapm_set_bias_level(dapm, SND_SOC_BIAS_PREPARE);
828a842f 2918 dapm_seq_run(dapm, &down_list, 0, false);
ed5a4c47 2919 snd_soc_dapm_set_bias_level(dapm, SND_SOC_BIAS_STANDBY);
51737470 2920 }
f0fba2ad
LG
2921}
2922
2923/*
2924 * snd_soc_dapm_shutdown - callback for system shutdown
2925 */
2926void snd_soc_dapm_shutdown(struct snd_soc_card *card)
2927{
2928 struct snd_soc_codec *codec;
2929
ce6120cc
LG
2930 list_for_each_entry(codec, &card->codec_dev_list, list) {
2931 soc_dapm_shutdown_codec(&codec->dapm);
ed5a4c47 2932 snd_soc_dapm_set_bias_level(&codec->dapm, SND_SOC_BIAS_OFF);
ce6120cc 2933 }
51737470
MB
2934}
2935
2b97eabc 2936/* Module information */
d331124d 2937MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
2b97eabc
RP
2938MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
2939MODULE_LICENSE("GPL");