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