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