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