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