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