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