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