Merge branch 'x86-urgent-for-linus' of git://git.kernel.org/pub/scm/linux/kernel...
[sfrench/cifs-2.6.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/meadphone 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 powerdown of audio susbsystem to reduce pops between a quick
22  *      device reopen.
23  *
24  *  Todo:
25  *    o DAPM power change sequencing - allow for configurable per
26  *      codec sequences.
27  *    o Support for analogue bias optimisation.
28  *    o Support for reduced codec oversampling rates.
29  *    o Support for reduced codec bias currents.
30  */
31
32 #include <linux/module.h>
33 #include <linux/moduleparam.h>
34 #include <linux/init.h>
35 #include <linux/async.h>
36 #include <linux/delay.h>
37 #include <linux/pm.h>
38 #include <linux/bitops.h>
39 #include <linux/platform_device.h>
40 #include <linux/jiffies.h>
41 #include <linux/debugfs.h>
42 #include <linux/slab.h>
43 #include <sound/core.h>
44 #include <sound/pcm.h>
45 #include <sound/pcm_params.h>
46 #include <sound/soc.h>
47 #include <sound/initval.h>
48
49 #include <trace/events/asoc.h>
50
51 /* dapm power sequences - make this per codec in the future */
52 static int dapm_up_seq[] = {
53         [snd_soc_dapm_pre] = 0,
54         [snd_soc_dapm_supply] = 1,
55         [snd_soc_dapm_micbias] = 2,
56         [snd_soc_dapm_aif_in] = 3,
57         [snd_soc_dapm_aif_out] = 3,
58         [snd_soc_dapm_mic] = 4,
59         [snd_soc_dapm_mux] = 5,
60         [snd_soc_dapm_virt_mux] = 5,
61         [snd_soc_dapm_value_mux] = 5,
62         [snd_soc_dapm_dac] = 6,
63         [snd_soc_dapm_mixer] = 7,
64         [snd_soc_dapm_mixer_named_ctl] = 7,
65         [snd_soc_dapm_pga] = 8,
66         [snd_soc_dapm_adc] = 9,
67         [snd_soc_dapm_out_drv] = 10,
68         [snd_soc_dapm_hp] = 10,
69         [snd_soc_dapm_spk] = 10,
70         [snd_soc_dapm_post] = 11,
71 };
72
73 static int dapm_down_seq[] = {
74         [snd_soc_dapm_pre] = 0,
75         [snd_soc_dapm_adc] = 1,
76         [snd_soc_dapm_hp] = 2,
77         [snd_soc_dapm_spk] = 2,
78         [snd_soc_dapm_out_drv] = 2,
79         [snd_soc_dapm_pga] = 4,
80         [snd_soc_dapm_mixer_named_ctl] = 5,
81         [snd_soc_dapm_mixer] = 5,
82         [snd_soc_dapm_dac] = 6,
83         [snd_soc_dapm_mic] = 7,
84         [snd_soc_dapm_micbias] = 8,
85         [snd_soc_dapm_mux] = 9,
86         [snd_soc_dapm_virt_mux] = 9,
87         [snd_soc_dapm_value_mux] = 9,
88         [snd_soc_dapm_aif_in] = 10,
89         [snd_soc_dapm_aif_out] = 10,
90         [snd_soc_dapm_supply] = 11,
91         [snd_soc_dapm_post] = 12,
92 };
93
94 static void pop_wait(u32 pop_time)
95 {
96         if (pop_time)
97                 schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
98 }
99
100 static void pop_dbg(struct device *dev, u32 pop_time, const char *fmt, ...)
101 {
102         va_list args;
103         char *buf;
104
105         if (!pop_time)
106                 return;
107
108         buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
109         if (buf == NULL)
110                 return;
111
112         va_start(args, fmt);
113         vsnprintf(buf, PAGE_SIZE, fmt, args);
114         dev_info(dev, "%s", buf);
115         va_end(args);
116
117         kfree(buf);
118 }
119
120 /* create a new dapm widget */
121 static inline struct snd_soc_dapm_widget *dapm_cnew_widget(
122         const struct snd_soc_dapm_widget *_widget)
123 {
124         return kmemdup(_widget, sizeof(*_widget), GFP_KERNEL);
125 }
126
127 /**
128  * snd_soc_dapm_set_bias_level - set the bias level for the system
129  * @dapm: DAPM context
130  * @level: level to configure
131  *
132  * Configure the bias (power) levels for the SoC audio device.
133  *
134  * Returns 0 for success else error.
135  */
136 static int snd_soc_dapm_set_bias_level(struct snd_soc_dapm_context *dapm,
137                                        enum snd_soc_bias_level level)
138 {
139         struct snd_soc_card *card = dapm->card;
140         int ret = 0;
141
142         switch (level) {
143         case SND_SOC_BIAS_ON:
144                 dev_dbg(dapm->dev, "Setting full bias\n");
145                 break;
146         case SND_SOC_BIAS_PREPARE:
147                 dev_dbg(dapm->dev, "Setting bias prepare\n");
148                 break;
149         case SND_SOC_BIAS_STANDBY:
150                 dev_dbg(dapm->dev, "Setting standby bias\n");
151                 break;
152         case SND_SOC_BIAS_OFF:
153                 dev_dbg(dapm->dev, "Setting bias off\n");
154                 break;
155         default:
156                 dev_err(dapm->dev, "Setting invalid bias %d\n", level);
157                 return -EINVAL;
158         }
159
160         trace_snd_soc_bias_level_start(card, level);
161
162         if (card && card->set_bias_level)
163                 ret = card->set_bias_level(card, level);
164         if (ret == 0) {
165                 if (dapm->codec && dapm->codec->driver->set_bias_level)
166                         ret = dapm->codec->driver->set_bias_level(dapm->codec, level);
167                 else
168                         dapm->bias_level = level;
169         }
170         if (ret == 0) {
171                 if (card && card->set_bias_level_post)
172                         ret = card->set_bias_level_post(card, level);
173         }
174
175         trace_snd_soc_bias_level_done(card, level);
176
177         return ret;
178 }
179
180 /* set up initial codec paths */
181 static void dapm_set_path_status(struct snd_soc_dapm_widget *w,
182         struct snd_soc_dapm_path *p, int i)
183 {
184         switch (w->id) {
185         case snd_soc_dapm_switch:
186         case snd_soc_dapm_mixer:
187         case snd_soc_dapm_mixer_named_ctl: {
188                 int val;
189                 struct soc_mixer_control *mc = (struct soc_mixer_control *)
190                         w->kcontrol_news[i].private_value;
191                 unsigned int reg = mc->reg;
192                 unsigned int shift = mc->shift;
193                 int max = mc->max;
194                 unsigned int mask = (1 << fls(max)) - 1;
195                 unsigned int invert = mc->invert;
196
197                 val = snd_soc_read(w->codec, reg);
198                 val = (val >> shift) & mask;
199
200                 if ((invert && !val) || (!invert && val))
201                         p->connect = 1;
202                 else
203                         p->connect = 0;
204         }
205         break;
206         case snd_soc_dapm_mux: {
207                 struct soc_enum *e = (struct soc_enum *)
208                         w->kcontrol_news[i].private_value;
209                 int val, item, bitmask;
210
211                 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
212                 ;
213                 val = snd_soc_read(w->codec, e->reg);
214                 item = (val >> e->shift_l) & (bitmask - 1);
215
216                 p->connect = 0;
217                 for (i = 0; i < e->max; i++) {
218                         if (!(strcmp(p->name, e->texts[i])) && item == i)
219                                 p->connect = 1;
220                 }
221         }
222         break;
223         case snd_soc_dapm_virt_mux: {
224                 struct soc_enum *e = (struct soc_enum *)
225                         w->kcontrol_news[i].private_value;
226
227                 p->connect = 0;
228                 /* since a virtual mux has no backing registers to
229                  * decide which path to connect, it will try to match
230                  * with the first enumeration.  This is to ensure
231                  * that the default mux choice (the first) will be
232                  * correctly powered up during initialization.
233                  */
234                 if (!strcmp(p->name, e->texts[0]))
235                         p->connect = 1;
236         }
237         break;
238         case snd_soc_dapm_value_mux: {
239                 struct soc_enum *e = (struct soc_enum *)
240                         w->kcontrol_news[i].private_value;
241                 int val, item;
242
243                 val = snd_soc_read(w->codec, e->reg);
244                 val = (val >> e->shift_l) & e->mask;
245                 for (item = 0; item < e->max; item++) {
246                         if (val == e->values[item])
247                                 break;
248                 }
249
250                 p->connect = 0;
251                 for (i = 0; i < e->max; i++) {
252                         if (!(strcmp(p->name, e->texts[i])) && item == i)
253                                 p->connect = 1;
254                 }
255         }
256         break;
257         /* does not effect routing - always connected */
258         case snd_soc_dapm_pga:
259         case snd_soc_dapm_out_drv:
260         case snd_soc_dapm_output:
261         case snd_soc_dapm_adc:
262         case snd_soc_dapm_input:
263         case snd_soc_dapm_dac:
264         case snd_soc_dapm_micbias:
265         case snd_soc_dapm_vmid:
266         case snd_soc_dapm_supply:
267         case snd_soc_dapm_aif_in:
268         case snd_soc_dapm_aif_out:
269                 p->connect = 1;
270         break;
271         /* does effect routing - dynamically connected */
272         case snd_soc_dapm_hp:
273         case snd_soc_dapm_mic:
274         case snd_soc_dapm_spk:
275         case snd_soc_dapm_line:
276         case snd_soc_dapm_pre:
277         case snd_soc_dapm_post:
278                 p->connect = 0;
279         break;
280         }
281 }
282
283 /* connect mux widget to its interconnecting audio paths */
284 static int dapm_connect_mux(struct snd_soc_dapm_context *dapm,
285         struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
286         struct snd_soc_dapm_path *path, const char *control_name,
287         const struct snd_kcontrol_new *kcontrol)
288 {
289         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
290         int i;
291
292         for (i = 0; i < e->max; i++) {
293                 if (!(strcmp(control_name, e->texts[i]))) {
294                         list_add(&path->list, &dapm->card->paths);
295                         list_add(&path->list_sink, &dest->sources);
296                         list_add(&path->list_source, &src->sinks);
297                         path->name = (char*)e->texts[i];
298                         dapm_set_path_status(dest, path, 0);
299                         return 0;
300                 }
301         }
302
303         return -ENODEV;
304 }
305
306 /* connect mixer widget to its interconnecting audio paths */
307 static int dapm_connect_mixer(struct snd_soc_dapm_context *dapm,
308         struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
309         struct snd_soc_dapm_path *path, const char *control_name)
310 {
311         int i;
312
313         /* search for mixer kcontrol */
314         for (i = 0; i < dest->num_kcontrols; i++) {
315                 if (!strcmp(control_name, dest->kcontrol_news[i].name)) {
316                         list_add(&path->list, &dapm->card->paths);
317                         list_add(&path->list_sink, &dest->sources);
318                         list_add(&path->list_source, &src->sinks);
319                         path->name = dest->kcontrol_news[i].name;
320                         dapm_set_path_status(dest, path, i);
321                         return 0;
322                 }
323         }
324         return -ENODEV;
325 }
326
327 static int dapm_is_shared_kcontrol(struct snd_soc_dapm_context *dapm,
328         const struct snd_kcontrol_new *kcontrol_new,
329         struct snd_kcontrol **kcontrol)
330 {
331         struct snd_soc_dapm_widget *w;
332         int i;
333
334         *kcontrol = NULL;
335
336         list_for_each_entry(w, &dapm->card->widgets, list) {
337                 for (i = 0; i < w->num_kcontrols; i++) {
338                         if (&w->kcontrol_news[i] == kcontrol_new) {
339                                 if (w->kcontrols)
340                                         *kcontrol = w->kcontrols[i];
341                                 return 1;
342                         }
343                 }
344         }
345
346         return 0;
347 }
348
349 /* create new dapm mixer control */
350 static int dapm_new_mixer(struct snd_soc_dapm_context *dapm,
351         struct snd_soc_dapm_widget *w)
352 {
353         int i, ret = 0;
354         size_t name_len, prefix_len;
355         struct snd_soc_dapm_path *path;
356         struct snd_card *card = dapm->card->snd_card;
357         const char *prefix;
358         struct snd_soc_dapm_widget_list *wlist;
359         size_t wlistsize;
360
361         if (dapm->codec)
362                 prefix = dapm->codec->name_prefix;
363         else
364                 prefix = NULL;
365
366         if (prefix)
367                 prefix_len = strlen(prefix) + 1;
368         else
369                 prefix_len = 0;
370
371         /* add kcontrol */
372         for (i = 0; i < w->num_kcontrols; i++) {
373
374                 /* match name */
375                 list_for_each_entry(path, &w->sources, list_sink) {
376
377                         /* mixer/mux paths name must match control name */
378                         if (path->name != (char *)w->kcontrol_news[i].name)
379                                 continue;
380
381                         wlistsize = sizeof(struct snd_soc_dapm_widget_list) +
382                                     sizeof(struct snd_soc_dapm_widget *),
383                         wlist = kzalloc(wlistsize, GFP_KERNEL);
384                         if (wlist == NULL) {
385                                 dev_err(dapm->dev,
386                                         "asoc: can't allocate widget list for %s\n",
387                                         w->name);
388                                 return -ENOMEM;
389                         }
390                         wlist->num_widgets = 1;
391                         wlist->widgets[0] = w;
392
393                         /* add dapm control with long name.
394                          * for dapm_mixer this is the concatenation of the
395                          * mixer and kcontrol name.
396                          * for dapm_mixer_named_ctl this is simply the
397                          * kcontrol name.
398                          */
399                         name_len = strlen(w->kcontrol_news[i].name) + 1;
400                         if (w->id != snd_soc_dapm_mixer_named_ctl)
401                                 name_len += 1 + strlen(w->name);
402
403                         path->long_name = kmalloc(name_len, GFP_KERNEL);
404
405                         if (path->long_name == NULL) {
406                                 kfree(wlist);
407                                 return -ENOMEM;
408                         }
409
410                         switch (w->id) {
411                         default:
412                                 /* The control will get a prefix from
413                                  * the control creation process but
414                                  * we're also using the same prefix
415                                  * for widgets so cut the prefix off
416                                  * the front of the widget name.
417                                  */
418                                 snprintf(path->long_name, name_len, "%s %s",
419                                          w->name + prefix_len,
420                                          w->kcontrol_news[i].name);
421                                 break;
422                         case snd_soc_dapm_mixer_named_ctl:
423                                 snprintf(path->long_name, name_len, "%s",
424                                          w->kcontrol_news[i].name);
425                                 break;
426                         }
427
428                         path->long_name[name_len - 1] = '\0';
429
430                         path->kcontrol = snd_soc_cnew(&w->kcontrol_news[i],
431                                                       wlist, path->long_name,
432                                                       prefix);
433                         ret = snd_ctl_add(card, path->kcontrol);
434                         if (ret < 0) {
435                                 dev_err(dapm->dev,
436                                         "asoc: failed to add dapm kcontrol %s: %d\n",
437                                         path->long_name, ret);
438                                 kfree(wlist);
439                                 kfree(path->long_name);
440                                 path->long_name = NULL;
441                                 return ret;
442                         }
443                         w->kcontrols[i] = path->kcontrol;
444                 }
445         }
446         return ret;
447 }
448
449 /* create new dapm mux control */
450 static int dapm_new_mux(struct snd_soc_dapm_context *dapm,
451         struct snd_soc_dapm_widget *w)
452 {
453         struct snd_soc_dapm_path *path = NULL;
454         struct snd_kcontrol *kcontrol;
455         struct snd_card *card = dapm->card->snd_card;
456         const char *prefix;
457         size_t prefix_len;
458         int ret;
459         struct snd_soc_dapm_widget_list *wlist;
460         int shared, wlistentries;
461         size_t wlistsize;
462         char *name;
463
464         if (w->num_kcontrols != 1) {
465                 dev_err(dapm->dev,
466                         "asoc: mux %s has incorrect number of controls\n",
467                         w->name);
468                 return -EINVAL;
469         }
470
471         shared = dapm_is_shared_kcontrol(dapm, &w->kcontrol_news[0],
472                                          &kcontrol);
473         if (kcontrol) {
474                 wlist = kcontrol->private_data;
475                 wlistentries = wlist->num_widgets + 1;
476         } else {
477                 wlist = NULL;
478                 wlistentries = 1;
479         }
480         wlistsize = sizeof(struct snd_soc_dapm_widget_list) +
481                 wlistentries * sizeof(struct snd_soc_dapm_widget *),
482         wlist = krealloc(wlist, wlistsize, GFP_KERNEL);
483         if (wlist == NULL) {
484                 dev_err(dapm->dev,
485                         "asoc: can't allocate widget list for %s\n", w->name);
486                 return -ENOMEM;
487         }
488         wlist->num_widgets = wlistentries;
489         wlist->widgets[wlistentries - 1] = w;
490
491         if (!kcontrol) {
492                 if (dapm->codec)
493                         prefix = dapm->codec->name_prefix;
494                 else
495                         prefix = NULL;
496
497                 if (shared) {
498                         name = w->kcontrol_news[0].name;
499                         prefix_len = 0;
500                 } else {
501                         name = w->name;
502                         if (prefix)
503                                 prefix_len = strlen(prefix) + 1;
504                         else
505                                 prefix_len = 0;
506                 }
507
508                 /*
509                  * The control will get a prefix from the control creation
510                  * process but we're also using the same prefix for widgets so
511                  * cut the prefix off the front of the widget name.
512                  */
513                 kcontrol = snd_soc_cnew(&w->kcontrol_news[0], wlist,
514                                         name + prefix_len, prefix);
515                 ret = snd_ctl_add(card, kcontrol);
516                 if (ret < 0) {
517                         dev_err(dapm->dev,
518                                 "asoc: failed to add kcontrol %s\n", w->name);
519                         kfree(wlist);
520                         return ret;
521                 }
522         }
523
524         kcontrol->private_data = wlist;
525
526         w->kcontrols[0] = kcontrol;
527
528         list_for_each_entry(path, &w->sources, list_sink)
529                 path->kcontrol = kcontrol;
530
531         return 0;
532 }
533
534 /* create new dapm volume control */
535 static int dapm_new_pga(struct snd_soc_dapm_context *dapm,
536         struct snd_soc_dapm_widget *w)
537 {
538         if (w->num_kcontrols)
539                 dev_err(w->dapm->dev,
540                         "asoc: PGA controls not supported: '%s'\n", w->name);
541
542         return 0;
543 }
544
545 /* reset 'walked' bit for each dapm path */
546 static inline void dapm_clear_walk(struct snd_soc_dapm_context *dapm)
547 {
548         struct snd_soc_dapm_path *p;
549
550         list_for_each_entry(p, &dapm->card->paths, list)
551                 p->walked = 0;
552 }
553
554 /* We implement power down on suspend by checking the power state of
555  * the ALSA card - when we are suspending the ALSA state for the card
556  * is set to D3.
557  */
558 static int snd_soc_dapm_suspend_check(struct snd_soc_dapm_widget *widget)
559 {
560         int level = snd_power_get_state(widget->dapm->card->snd_card);
561
562         switch (level) {
563         case SNDRV_CTL_POWER_D3hot:
564         case SNDRV_CTL_POWER_D3cold:
565                 if (widget->ignore_suspend)
566                         dev_dbg(widget->dapm->dev, "%s ignoring suspend\n",
567                                 widget->name);
568                 return widget->ignore_suspend;
569         default:
570                 return 1;
571         }
572 }
573
574 /*
575  * Recursively check for a completed path to an active or physically connected
576  * output widget. Returns number of complete paths.
577  */
578 static int is_connected_output_ep(struct snd_soc_dapm_widget *widget)
579 {
580         struct snd_soc_dapm_path *path;
581         int con = 0;
582
583         if (widget->id == snd_soc_dapm_supply)
584                 return 0;
585
586         switch (widget->id) {
587         case snd_soc_dapm_adc:
588         case snd_soc_dapm_aif_out:
589                 if (widget->active)
590                         return snd_soc_dapm_suspend_check(widget);
591         default:
592                 break;
593         }
594
595         if (widget->connected) {
596                 /* connected pin ? */
597                 if (widget->id == snd_soc_dapm_output && !widget->ext)
598                         return snd_soc_dapm_suspend_check(widget);
599
600                 /* connected jack or spk ? */
601                 if (widget->id == snd_soc_dapm_hp || widget->id == snd_soc_dapm_spk ||
602                     (widget->id == snd_soc_dapm_line && !list_empty(&widget->sources)))
603                         return snd_soc_dapm_suspend_check(widget);
604         }
605
606         list_for_each_entry(path, &widget->sinks, list_source) {
607                 if (path->walked)
608                         continue;
609
610                 if (path->sink && path->connect) {
611                         path->walked = 1;
612                         con += is_connected_output_ep(path->sink);
613                 }
614         }
615
616         return con;
617 }
618
619 /*
620  * Recursively check for a completed path to an active or physically connected
621  * input widget. Returns number of complete paths.
622  */
623 static int is_connected_input_ep(struct snd_soc_dapm_widget *widget)
624 {
625         struct snd_soc_dapm_path *path;
626         int con = 0;
627
628         if (widget->id == snd_soc_dapm_supply)
629                 return 0;
630
631         /* active stream ? */
632         switch (widget->id) {
633         case snd_soc_dapm_dac:
634         case snd_soc_dapm_aif_in:
635                 if (widget->active)
636                         return snd_soc_dapm_suspend_check(widget);
637         default:
638                 break;
639         }
640
641         if (widget->connected) {
642                 /* connected pin ? */
643                 if (widget->id == snd_soc_dapm_input && !widget->ext)
644                         return snd_soc_dapm_suspend_check(widget);
645
646                 /* connected VMID/Bias for lower pops */
647                 if (widget->id == snd_soc_dapm_vmid)
648                         return snd_soc_dapm_suspend_check(widget);
649
650                 /* connected jack ? */
651                 if (widget->id == snd_soc_dapm_mic ||
652                     (widget->id == snd_soc_dapm_line && !list_empty(&widget->sinks)))
653                         return snd_soc_dapm_suspend_check(widget);
654         }
655
656         list_for_each_entry(path, &widget->sources, list_sink) {
657                 if (path->walked)
658                         continue;
659
660                 if (path->source && path->connect) {
661                         path->walked = 1;
662                         con += is_connected_input_ep(path->source);
663                 }
664         }
665
666         return con;
667 }
668
669 /*
670  * Handler for generic register modifier widget.
671  */
672 int dapm_reg_event(struct snd_soc_dapm_widget *w,
673                    struct snd_kcontrol *kcontrol, int event)
674 {
675         unsigned int val;
676
677         if (SND_SOC_DAPM_EVENT_ON(event))
678                 val = w->on_val;
679         else
680                 val = w->off_val;
681
682         snd_soc_update_bits(w->codec, -(w->reg + 1),
683                             w->mask << w->shift, val << w->shift);
684
685         return 0;
686 }
687 EXPORT_SYMBOL_GPL(dapm_reg_event);
688
689 /* Generic check to see if a widget should be powered.
690  */
691 static int dapm_generic_check_power(struct snd_soc_dapm_widget *w)
692 {
693         int in, out;
694
695         in = is_connected_input_ep(w);
696         dapm_clear_walk(w->dapm);
697         out = is_connected_output_ep(w);
698         dapm_clear_walk(w->dapm);
699         return out != 0 && in != 0;
700 }
701
702 /* Check to see if an ADC has power */
703 static int dapm_adc_check_power(struct snd_soc_dapm_widget *w)
704 {
705         int in;
706
707         if (w->active) {
708                 in = is_connected_input_ep(w);
709                 dapm_clear_walk(w->dapm);
710                 return in != 0;
711         } else {
712                 return dapm_generic_check_power(w);
713         }
714 }
715
716 /* Check to see if a DAC has power */
717 static int dapm_dac_check_power(struct snd_soc_dapm_widget *w)
718 {
719         int out;
720
721         if (w->active) {
722                 out = is_connected_output_ep(w);
723                 dapm_clear_walk(w->dapm);
724                 return out != 0;
725         } else {
726                 return dapm_generic_check_power(w);
727         }
728 }
729
730 /* Check to see if a power supply is needed */
731 static int dapm_supply_check_power(struct snd_soc_dapm_widget *w)
732 {
733         struct snd_soc_dapm_path *path;
734         int power = 0;
735
736         /* Check if one of our outputs is connected */
737         list_for_each_entry(path, &w->sinks, list_source) {
738                 if (path->connected &&
739                     !path->connected(path->source, path->sink))
740                         continue;
741
742                 if (!path->sink)
743                         continue;
744
745                 if (path->sink->force) {
746                         power = 1;
747                         break;
748                 }
749
750                 if (path->sink->power_check &&
751                     path->sink->power_check(path->sink)) {
752                         power = 1;
753                         break;
754                 }
755         }
756
757         dapm_clear_walk(w->dapm);
758
759         return power;
760 }
761
762 static int dapm_seq_compare(struct snd_soc_dapm_widget *a,
763                             struct snd_soc_dapm_widget *b,
764                             bool power_up)
765 {
766         int *sort;
767
768         if (power_up)
769                 sort = dapm_up_seq;
770         else
771                 sort = dapm_down_seq;
772
773         if (sort[a->id] != sort[b->id])
774                 return sort[a->id] - sort[b->id];
775         if (a->subseq != b->subseq) {
776                 if (power_up)
777                         return a->subseq - b->subseq;
778                 else
779                         return b->subseq - a->subseq;
780         }
781         if (a->reg != b->reg)
782                 return a->reg - b->reg;
783         if (a->dapm != b->dapm)
784                 return (unsigned long)a->dapm - (unsigned long)b->dapm;
785
786         return 0;
787 }
788
789 /* Insert a widget in order into a DAPM power sequence. */
790 static void dapm_seq_insert(struct snd_soc_dapm_widget *new_widget,
791                             struct list_head *list,
792                             bool power_up)
793 {
794         struct snd_soc_dapm_widget *w;
795
796         list_for_each_entry(w, list, power_list)
797                 if (dapm_seq_compare(new_widget, w, power_up) < 0) {
798                         list_add_tail(&new_widget->power_list, &w->power_list);
799                         return;
800                 }
801
802         list_add_tail(&new_widget->power_list, list);
803 }
804
805 static void dapm_seq_check_event(struct snd_soc_dapm_context *dapm,
806                                  struct snd_soc_dapm_widget *w, int event)
807 {
808         struct snd_soc_card *card = dapm->card;
809         const char *ev_name;
810         int power, ret;
811
812         switch (event) {
813         case SND_SOC_DAPM_PRE_PMU:
814                 ev_name = "PRE_PMU";
815                 power = 1;
816                 break;
817         case SND_SOC_DAPM_POST_PMU:
818                 ev_name = "POST_PMU";
819                 power = 1;
820                 break;
821         case SND_SOC_DAPM_PRE_PMD:
822                 ev_name = "PRE_PMD";
823                 power = 0;
824                 break;
825         case SND_SOC_DAPM_POST_PMD:
826                 ev_name = "POST_PMD";
827                 power = 0;
828                 break;
829         default:
830                 BUG();
831                 return;
832         }
833
834         if (w->power != power)
835                 return;
836
837         if (w->event && (w->event_flags & event)) {
838                 pop_dbg(dapm->dev, card->pop_time, "pop test : %s %s\n",
839                         w->name, ev_name);
840                 trace_snd_soc_dapm_widget_event_start(w, event);
841                 ret = w->event(w, NULL, event);
842                 trace_snd_soc_dapm_widget_event_done(w, event);
843                 if (ret < 0)
844                         pr_err("%s: %s event failed: %d\n",
845                                ev_name, w->name, ret);
846         }
847 }
848
849 /* Apply the coalesced changes from a DAPM sequence */
850 static void dapm_seq_run_coalesced(struct snd_soc_dapm_context *dapm,
851                                    struct list_head *pending)
852 {
853         struct snd_soc_card *card = dapm->card;
854         struct snd_soc_dapm_widget *w;
855         int reg, power;
856         unsigned int value = 0;
857         unsigned int mask = 0;
858         unsigned int cur_mask;
859
860         reg = list_first_entry(pending, struct snd_soc_dapm_widget,
861                                power_list)->reg;
862
863         list_for_each_entry(w, pending, power_list) {
864                 cur_mask = 1 << w->shift;
865                 BUG_ON(reg != w->reg);
866
867                 if (w->invert)
868                         power = !w->power;
869                 else
870                         power = w->power;
871
872                 mask |= cur_mask;
873                 if (power)
874                         value |= cur_mask;
875
876                 pop_dbg(dapm->dev, card->pop_time,
877                         "pop test : Queue %s: reg=0x%x, 0x%x/0x%x\n",
878                         w->name, reg, value, mask);
879
880                 /* Check for events */
881                 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_PRE_PMU);
882                 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_PRE_PMD);
883         }
884
885         if (reg >= 0) {
886                 pop_dbg(dapm->dev, card->pop_time,
887                         "pop test : Applying 0x%x/0x%x to %x in %dms\n",
888                         value, mask, reg, card->pop_time);
889                 pop_wait(card->pop_time);
890                 snd_soc_update_bits(dapm->codec, reg, mask, value);
891         }
892
893         list_for_each_entry(w, pending, power_list) {
894                 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_POST_PMU);
895                 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_POST_PMD);
896         }
897 }
898
899 /* Apply a DAPM power sequence.
900  *
901  * We walk over a pre-sorted list of widgets to apply power to.  In
902  * order to minimise the number of writes to the device required
903  * multiple widgets will be updated in a single write where possible.
904  * Currently anything that requires more than a single write is not
905  * handled.
906  */
907 static void dapm_seq_run(struct snd_soc_dapm_context *dapm,
908                          struct list_head *list, int event, bool power_up)
909 {
910         struct snd_soc_dapm_widget *w, *n;
911         LIST_HEAD(pending);
912         int cur_sort = -1;
913         int cur_subseq = -1;
914         int cur_reg = SND_SOC_NOPM;
915         struct snd_soc_dapm_context *cur_dapm = NULL;
916         int ret, i;
917         int *sort;
918
919         if (power_up)
920                 sort = dapm_up_seq;
921         else
922                 sort = dapm_down_seq;
923
924         list_for_each_entry_safe(w, n, list, power_list) {
925                 ret = 0;
926
927                 /* Do we need to apply any queued changes? */
928                 if (sort[w->id] != cur_sort || w->reg != cur_reg ||
929                     w->dapm != cur_dapm || w->subseq != cur_subseq) {
930                         if (!list_empty(&pending))
931                                 dapm_seq_run_coalesced(cur_dapm, &pending);
932
933                         if (cur_dapm && cur_dapm->seq_notifier) {
934                                 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
935                                         if (sort[i] == cur_sort)
936                                                 cur_dapm->seq_notifier(cur_dapm,
937                                                                        i,
938                                                                        cur_subseq);
939                         }
940
941                         INIT_LIST_HEAD(&pending);
942                         cur_sort = -1;
943                         cur_subseq = -1;
944                         cur_reg = SND_SOC_NOPM;
945                         cur_dapm = NULL;
946                 }
947
948                 switch (w->id) {
949                 case snd_soc_dapm_pre:
950                         if (!w->event)
951                                 list_for_each_entry_safe_continue(w, n, list,
952                                                                   power_list);
953
954                         if (event == SND_SOC_DAPM_STREAM_START)
955                                 ret = w->event(w,
956                                                NULL, SND_SOC_DAPM_PRE_PMU);
957                         else if (event == SND_SOC_DAPM_STREAM_STOP)
958                                 ret = w->event(w,
959                                                NULL, SND_SOC_DAPM_PRE_PMD);
960                         break;
961
962                 case snd_soc_dapm_post:
963                         if (!w->event)
964                                 list_for_each_entry_safe_continue(w, n, list,
965                                                                   power_list);
966
967                         if (event == SND_SOC_DAPM_STREAM_START)
968                                 ret = w->event(w,
969                                                NULL, SND_SOC_DAPM_POST_PMU);
970                         else if (event == SND_SOC_DAPM_STREAM_STOP)
971                                 ret = w->event(w,
972                                                NULL, SND_SOC_DAPM_POST_PMD);
973                         break;
974
975                 default:
976                         /* Queue it up for application */
977                         cur_sort = sort[w->id];
978                         cur_subseq = w->subseq;
979                         cur_reg = w->reg;
980                         cur_dapm = w->dapm;
981                         list_move(&w->power_list, &pending);
982                         break;
983                 }
984
985                 if (ret < 0)
986                         dev_err(w->dapm->dev,
987                                 "Failed to apply widget power: %d\n", ret);
988         }
989
990         if (!list_empty(&pending))
991                 dapm_seq_run_coalesced(cur_dapm, &pending);
992
993         if (cur_dapm && cur_dapm->seq_notifier) {
994                 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
995                         if (sort[i] == cur_sort)
996                                 cur_dapm->seq_notifier(cur_dapm,
997                                                        i, cur_subseq);
998         }
999 }
1000
1001 static void dapm_widget_update(struct snd_soc_dapm_context *dapm)
1002 {
1003         struct snd_soc_dapm_update *update = dapm->update;
1004         struct snd_soc_dapm_widget *w;
1005         int ret;
1006
1007         if (!update)
1008                 return;
1009
1010         w = update->widget;
1011
1012         if (w->event &&
1013             (w->event_flags & SND_SOC_DAPM_PRE_REG)) {
1014                 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_PRE_REG);
1015                 if (ret != 0)
1016                         pr_err("%s DAPM pre-event failed: %d\n",
1017                                w->name, ret);
1018         }
1019
1020         ret = snd_soc_update_bits(w->codec, update->reg, update->mask,
1021                                   update->val);
1022         if (ret < 0)
1023                 pr_err("%s DAPM update failed: %d\n", w->name, ret);
1024
1025         if (w->event &&
1026             (w->event_flags & SND_SOC_DAPM_POST_REG)) {
1027                 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_POST_REG);
1028                 if (ret != 0)
1029                         pr_err("%s DAPM post-event failed: %d\n",
1030                                w->name, ret);
1031         }
1032 }
1033
1034 /* Async callback run prior to DAPM sequences - brings to _PREPARE if
1035  * they're changing state.
1036  */
1037 static void dapm_pre_sequence_async(void *data, async_cookie_t cookie)
1038 {
1039         struct snd_soc_dapm_context *d = data;
1040         int ret;
1041
1042         if (d->dev_power && d->bias_level == SND_SOC_BIAS_OFF) {
1043                 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
1044                 if (ret != 0)
1045                         dev_err(d->dev,
1046                                 "Failed to turn on bias: %d\n", ret);
1047         }
1048
1049         /* If we're changing to all on or all off then prepare */
1050         if ((d->dev_power && d->bias_level == SND_SOC_BIAS_STANDBY) ||
1051             (!d->dev_power && d->bias_level == SND_SOC_BIAS_ON)) {
1052                 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_PREPARE);
1053                 if (ret != 0)
1054                         dev_err(d->dev,
1055                                 "Failed to prepare bias: %d\n", ret);
1056         }
1057 }
1058
1059 /* Async callback run prior to DAPM sequences - brings to their final
1060  * state.
1061  */
1062 static void dapm_post_sequence_async(void *data, async_cookie_t cookie)
1063 {
1064         struct snd_soc_dapm_context *d = data;
1065         int ret;
1066
1067         /* If we just powered the last thing off drop to standby bias */
1068         if (d->bias_level == SND_SOC_BIAS_PREPARE && !d->dev_power) {
1069                 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
1070                 if (ret != 0)
1071                         dev_err(d->dev, "Failed to apply standby bias: %d\n",
1072                                 ret);
1073         }
1074
1075         /* If we're in standby and can support bias off then do that */
1076         if (d->bias_level == SND_SOC_BIAS_STANDBY && d->idle_bias_off) {
1077                 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_OFF);
1078                 if (ret != 0)
1079                         dev_err(d->dev, "Failed to turn off bias: %d\n", ret);
1080         }
1081
1082         /* If we just powered up then move to active bias */
1083         if (d->bias_level == SND_SOC_BIAS_PREPARE && d->dev_power) {
1084                 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_ON);
1085                 if (ret != 0)
1086                         dev_err(d->dev, "Failed to apply active bias: %d\n",
1087                                 ret);
1088         }
1089 }
1090
1091 /*
1092  * Scan each dapm widget for complete audio path.
1093  * A complete path is a route that has valid endpoints i.e.:-
1094  *
1095  *  o DAC to output pin.
1096  *  o Input Pin to ADC.
1097  *  o Input pin to Output pin (bypass, sidetone)
1098  *  o DAC to ADC (loopback).
1099  */
1100 static int dapm_power_widgets(struct snd_soc_dapm_context *dapm, int event)
1101 {
1102         struct snd_soc_card *card = dapm->card;
1103         struct snd_soc_dapm_widget *w;
1104         struct snd_soc_dapm_context *d;
1105         LIST_HEAD(up_list);
1106         LIST_HEAD(down_list);
1107         LIST_HEAD(async_domain);
1108         int power;
1109
1110         trace_snd_soc_dapm_start(card);
1111
1112         list_for_each_entry(d, &card->dapm_list, list)
1113                 if (d->n_widgets || d->codec == NULL)
1114                         d->dev_power = 0;
1115
1116         /* Check which widgets we need to power and store them in
1117          * lists indicating if they should be powered up or down.
1118          */
1119         list_for_each_entry(w, &card->widgets, list) {
1120                 switch (w->id) {
1121                 case snd_soc_dapm_pre:
1122                         dapm_seq_insert(w, &down_list, false);
1123                         break;
1124                 case snd_soc_dapm_post:
1125                         dapm_seq_insert(w, &up_list, true);
1126                         break;
1127
1128                 default:
1129                         if (!w->power_check)
1130                                 continue;
1131
1132                         if (!w->force)
1133                                 power = w->power_check(w);
1134                         else
1135                                 power = 1;
1136                         if (power)
1137                                 w->dapm->dev_power = 1;
1138
1139                         if (w->power == power)
1140                                 continue;
1141
1142                         trace_snd_soc_dapm_widget_power(w, power);
1143
1144                         if (power)
1145                                 dapm_seq_insert(w, &up_list, true);
1146                         else
1147                                 dapm_seq_insert(w, &down_list, false);
1148
1149                         w->power = power;
1150                         break;
1151                 }
1152         }
1153
1154         /* If there are no DAPM widgets then try to figure out power from the
1155          * event type.
1156          */
1157         if (!dapm->n_widgets) {
1158                 switch (event) {
1159                 case SND_SOC_DAPM_STREAM_START:
1160                 case SND_SOC_DAPM_STREAM_RESUME:
1161                         dapm->dev_power = 1;
1162                         break;
1163                 case SND_SOC_DAPM_STREAM_STOP:
1164                         dapm->dev_power = !!dapm->codec->active;
1165                         break;
1166                 case SND_SOC_DAPM_STREAM_SUSPEND:
1167                         dapm->dev_power = 0;
1168                         break;
1169                 case SND_SOC_DAPM_STREAM_NOP:
1170                         switch (dapm->bias_level) {
1171                                 case SND_SOC_BIAS_STANDBY:
1172                                 case SND_SOC_BIAS_OFF:
1173                                         dapm->dev_power = 0;
1174                                         break;
1175                                 default:
1176                                         dapm->dev_power = 1;
1177                                         break;
1178                         }
1179                         break;
1180                 default:
1181                         break;
1182                 }
1183         }
1184
1185         /* Force all contexts in the card to the same bias state */
1186         power = 0;
1187         list_for_each_entry(d, &card->dapm_list, list)
1188                 if (d->dev_power)
1189                         power = 1;
1190         list_for_each_entry(d, &card->dapm_list, list)
1191                 d->dev_power = power;
1192
1193
1194         /* Run all the bias changes in parallel */
1195         list_for_each_entry(d, &dapm->card->dapm_list, list)
1196                 async_schedule_domain(dapm_pre_sequence_async, d,
1197                                         &async_domain);
1198         async_synchronize_full_domain(&async_domain);
1199
1200         /* Power down widgets first; try to avoid amplifying pops. */
1201         dapm_seq_run(dapm, &down_list, event, false);
1202
1203         dapm_widget_update(dapm);
1204
1205         /* Now power up. */
1206         dapm_seq_run(dapm, &up_list, event, true);
1207
1208         /* Run all the bias changes in parallel */
1209         list_for_each_entry(d, &dapm->card->dapm_list, list)
1210                 async_schedule_domain(dapm_post_sequence_async, d,
1211                                         &async_domain);
1212         async_synchronize_full_domain(&async_domain);
1213
1214         pop_dbg(dapm->dev, card->pop_time,
1215                 "DAPM sequencing finished, waiting %dms\n", card->pop_time);
1216         pop_wait(card->pop_time);
1217
1218         trace_snd_soc_dapm_done(card);
1219
1220         return 0;
1221 }
1222
1223 #ifdef CONFIG_DEBUG_FS
1224 static int dapm_widget_power_open_file(struct inode *inode, struct file *file)
1225 {
1226         file->private_data = inode->i_private;
1227         return 0;
1228 }
1229
1230 static ssize_t dapm_widget_power_read_file(struct file *file,
1231                                            char __user *user_buf,
1232                                            size_t count, loff_t *ppos)
1233 {
1234         struct snd_soc_dapm_widget *w = file->private_data;
1235         char *buf;
1236         int in, out;
1237         ssize_t ret;
1238         struct snd_soc_dapm_path *p = NULL;
1239
1240         buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
1241         if (!buf)
1242                 return -ENOMEM;
1243
1244         in = is_connected_input_ep(w);
1245         dapm_clear_walk(w->dapm);
1246         out = is_connected_output_ep(w);
1247         dapm_clear_walk(w->dapm);
1248
1249         ret = snprintf(buf, PAGE_SIZE, "%s: %s  in %d out %d",
1250                        w->name, w->power ? "On" : "Off", in, out);
1251
1252         if (w->reg >= 0)
1253                 ret += snprintf(buf + ret, PAGE_SIZE - ret,
1254                                 " - R%d(0x%x) bit %d",
1255                                 w->reg, w->reg, w->shift);
1256
1257         ret += snprintf(buf + ret, PAGE_SIZE - ret, "\n");
1258
1259         if (w->sname)
1260                 ret += snprintf(buf + ret, PAGE_SIZE - ret, " stream %s %s\n",
1261                                 w->sname,
1262                                 w->active ? "active" : "inactive");
1263
1264         list_for_each_entry(p, &w->sources, list_sink) {
1265                 if (p->connected && !p->connected(w, p->sink))
1266                         continue;
1267
1268                 if (p->connect)
1269                         ret += snprintf(buf + ret, PAGE_SIZE - ret,
1270                                         " in  \"%s\" \"%s\"\n",
1271                                         p->name ? p->name : "static",
1272                                         p->source->name);
1273         }
1274         list_for_each_entry(p, &w->sinks, list_source) {
1275                 if (p->connected && !p->connected(w, p->sink))
1276                         continue;
1277
1278                 if (p->connect)
1279                         ret += snprintf(buf + ret, PAGE_SIZE - ret,
1280                                         " out \"%s\" \"%s\"\n",
1281                                         p->name ? p->name : "static",
1282                                         p->sink->name);
1283         }
1284
1285         ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
1286
1287         kfree(buf);
1288         return ret;
1289 }
1290
1291 static const struct file_operations dapm_widget_power_fops = {
1292         .open = dapm_widget_power_open_file,
1293         .read = dapm_widget_power_read_file,
1294         .llseek = default_llseek,
1295 };
1296
1297 static int dapm_bias_open_file(struct inode *inode, struct file *file)
1298 {
1299         file->private_data = inode->i_private;
1300         return 0;
1301 }
1302
1303 static ssize_t dapm_bias_read_file(struct file *file, char __user *user_buf,
1304                                    size_t count, loff_t *ppos)
1305 {
1306         struct snd_soc_dapm_context *dapm = file->private_data;
1307         char *level;
1308
1309         switch (dapm->bias_level) {
1310         case SND_SOC_BIAS_ON:
1311                 level = "On\n";
1312                 break;
1313         case SND_SOC_BIAS_PREPARE:
1314                 level = "Prepare\n";
1315                 break;
1316         case SND_SOC_BIAS_STANDBY:
1317                 level = "Standby\n";
1318                 break;
1319         case SND_SOC_BIAS_OFF:
1320                 level = "Off\n";
1321                 break;
1322         default:
1323                 BUG();
1324                 level = "Unknown\n";
1325                 break;
1326         }
1327
1328         return simple_read_from_buffer(user_buf, count, ppos, level,
1329                                        strlen(level));
1330 }
1331
1332 static const struct file_operations dapm_bias_fops = {
1333         .open = dapm_bias_open_file,
1334         .read = dapm_bias_read_file,
1335         .llseek = default_llseek,
1336 };
1337
1338 void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
1339         struct dentry *parent)
1340 {
1341         struct dentry *d;
1342
1343         dapm->debugfs_dapm = debugfs_create_dir("dapm", parent);
1344
1345         if (!dapm->debugfs_dapm) {
1346                 printk(KERN_WARNING
1347                        "Failed to create DAPM debugfs directory\n");
1348                 return;
1349         }
1350
1351         d = debugfs_create_file("bias_level", 0444,
1352                                 dapm->debugfs_dapm, dapm,
1353                                 &dapm_bias_fops);
1354         if (!d)
1355                 dev_warn(dapm->dev,
1356                          "ASoC: Failed to create bias level debugfs file\n");
1357 }
1358
1359 static void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
1360 {
1361         struct snd_soc_dapm_context *dapm = w->dapm;
1362         struct dentry *d;
1363
1364         if (!dapm->debugfs_dapm || !w->name)
1365                 return;
1366
1367         d = debugfs_create_file(w->name, 0444,
1368                                 dapm->debugfs_dapm, w,
1369                                 &dapm_widget_power_fops);
1370         if (!d)
1371                 dev_warn(w->dapm->dev,
1372                         "ASoC: Failed to create %s debugfs file\n",
1373                         w->name);
1374 }
1375
1376 static void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
1377 {
1378         debugfs_remove_recursive(dapm->debugfs_dapm);
1379 }
1380
1381 #else
1382 void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
1383         struct dentry *parent)
1384 {
1385 }
1386
1387 static inline void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
1388 {
1389 }
1390
1391 static inline void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
1392 {
1393 }
1394
1395 #endif
1396
1397 /* test and update the power status of a mux widget */
1398 static int dapm_mux_update_power(struct snd_soc_dapm_widget *widget,
1399                                  struct snd_kcontrol *kcontrol, int change,
1400                                  int mux, struct soc_enum *e)
1401 {
1402         struct snd_soc_dapm_path *path;
1403         int found = 0;
1404
1405         if (widget->id != snd_soc_dapm_mux &&
1406             widget->id != snd_soc_dapm_virt_mux &&
1407             widget->id != snd_soc_dapm_value_mux)
1408                 return -ENODEV;
1409
1410         if (!change)
1411                 return 0;
1412
1413         /* find dapm widget path assoc with kcontrol */
1414         list_for_each_entry(path, &widget->dapm->card->paths, list) {
1415                 if (path->kcontrol != kcontrol)
1416                         continue;
1417
1418                 if (!path->name || !e->texts[mux])
1419                         continue;
1420
1421                 found = 1;
1422                 /* we now need to match the string in the enum to the path */
1423                 if (!(strcmp(path->name, e->texts[mux])))
1424                         path->connect = 1; /* new connection */
1425                 else
1426                         path->connect = 0; /* old connection must be powered down */
1427         }
1428
1429         if (found)
1430                 dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
1431
1432         return 0;
1433 }
1434
1435 /* test and update the power status of a mixer or switch widget */
1436 static int dapm_mixer_update_power(struct snd_soc_dapm_widget *widget,
1437                                    struct snd_kcontrol *kcontrol, int connect)
1438 {
1439         struct snd_soc_dapm_path *path;
1440         int found = 0;
1441
1442         if (widget->id != snd_soc_dapm_mixer &&
1443             widget->id != snd_soc_dapm_mixer_named_ctl &&
1444             widget->id != snd_soc_dapm_switch)
1445                 return -ENODEV;
1446
1447         /* find dapm widget path assoc with kcontrol */
1448         list_for_each_entry(path, &widget->dapm->card->paths, list) {
1449                 if (path->kcontrol != kcontrol)
1450                         continue;
1451
1452                 /* found, now check type */
1453                 found = 1;
1454                 path->connect = connect;
1455                 break;
1456         }
1457
1458         if (found)
1459                 dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
1460
1461         return 0;
1462 }
1463
1464 /* show dapm widget status in sys fs */
1465 static ssize_t dapm_widget_show(struct device *dev,
1466         struct device_attribute *attr, char *buf)
1467 {
1468         struct snd_soc_pcm_runtime *rtd =
1469                         container_of(dev, struct snd_soc_pcm_runtime, dev);
1470         struct snd_soc_codec *codec =rtd->codec;
1471         struct snd_soc_dapm_widget *w;
1472         int count = 0;
1473         char *state = "not set";
1474
1475         list_for_each_entry(w, &codec->card->widgets, list) {
1476                 if (w->dapm != &codec->dapm)
1477                         continue;
1478
1479                 /* only display widgets that burnm power */
1480                 switch (w->id) {
1481                 case snd_soc_dapm_hp:
1482                 case snd_soc_dapm_mic:
1483                 case snd_soc_dapm_spk:
1484                 case snd_soc_dapm_line:
1485                 case snd_soc_dapm_micbias:
1486                 case snd_soc_dapm_dac:
1487                 case snd_soc_dapm_adc:
1488                 case snd_soc_dapm_pga:
1489                 case snd_soc_dapm_out_drv:
1490                 case snd_soc_dapm_mixer:
1491                 case snd_soc_dapm_mixer_named_ctl:
1492                 case snd_soc_dapm_supply:
1493                         if (w->name)
1494                                 count += sprintf(buf + count, "%s: %s\n",
1495                                         w->name, w->power ? "On":"Off");
1496                 break;
1497                 default:
1498                 break;
1499                 }
1500         }
1501
1502         switch (codec->dapm.bias_level) {
1503         case SND_SOC_BIAS_ON:
1504                 state = "On";
1505                 break;
1506         case SND_SOC_BIAS_PREPARE:
1507                 state = "Prepare";
1508                 break;
1509         case SND_SOC_BIAS_STANDBY:
1510                 state = "Standby";
1511                 break;
1512         case SND_SOC_BIAS_OFF:
1513                 state = "Off";
1514                 break;
1515         }
1516         count += sprintf(buf + count, "PM State: %s\n", state);
1517
1518         return count;
1519 }
1520
1521 static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL);
1522
1523 int snd_soc_dapm_sys_add(struct device *dev)
1524 {
1525         return device_create_file(dev, &dev_attr_dapm_widget);
1526 }
1527
1528 static void snd_soc_dapm_sys_remove(struct device *dev)
1529 {
1530         device_remove_file(dev, &dev_attr_dapm_widget);
1531 }
1532
1533 /* free all dapm widgets and resources */
1534 static void dapm_free_widgets(struct snd_soc_dapm_context *dapm)
1535 {
1536         struct snd_soc_dapm_widget *w, *next_w;
1537         struct snd_soc_dapm_path *p, *next_p;
1538
1539         list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) {
1540                 if (w->dapm != dapm)
1541                         continue;
1542                 list_del(&w->list);
1543                 /*
1544                  * remove source and sink paths associated to this widget.
1545                  * While removing the path, remove reference to it from both
1546                  * source and sink widgets so that path is removed only once.
1547                  */
1548                 list_for_each_entry_safe(p, next_p, &w->sources, list_sink) {
1549                         list_del(&p->list_sink);
1550                         list_del(&p->list_source);
1551                         list_del(&p->list);
1552                         kfree(p->long_name);
1553                         kfree(p);
1554                 }
1555                 list_for_each_entry_safe(p, next_p, &w->sinks, list_source) {
1556                         list_del(&p->list_sink);
1557                         list_del(&p->list_source);
1558                         list_del(&p->list);
1559                         kfree(p->long_name);
1560                         kfree(p);
1561                 }
1562                 kfree(w->kcontrols);
1563                 kfree(w->name);
1564                 kfree(w);
1565         }
1566 }
1567
1568 static struct snd_soc_dapm_widget *dapm_find_widget(
1569                         struct snd_soc_dapm_context *dapm, const char *pin,
1570                         bool search_other_contexts)
1571 {
1572         struct snd_soc_dapm_widget *w;
1573         struct snd_soc_dapm_widget *fallback = NULL;
1574
1575         list_for_each_entry(w, &dapm->card->widgets, list) {
1576                 if (!strcmp(w->name, pin)) {
1577                         if (w->dapm == dapm)
1578                                 return w;
1579                         else
1580                                 fallback = w;
1581                 }
1582         }
1583
1584         if (search_other_contexts)
1585                 return fallback;
1586
1587         return NULL;
1588 }
1589
1590 static int snd_soc_dapm_set_pin(struct snd_soc_dapm_context *dapm,
1591                                 const char *pin, int status)
1592 {
1593         struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
1594
1595         if (!w) {
1596                 dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
1597                 return -EINVAL;
1598         }
1599
1600         w->connected = status;
1601         if (status == 0)
1602                 w->force = 0;
1603
1604         return 0;
1605 }
1606
1607 /**
1608  * snd_soc_dapm_sync - scan and power dapm paths
1609  * @dapm: DAPM context
1610  *
1611  * Walks all dapm audio paths and powers widgets according to their
1612  * stream or path usage.
1613  *
1614  * Returns 0 for success.
1615  */
1616 int snd_soc_dapm_sync(struct snd_soc_dapm_context *dapm)
1617 {
1618         return dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
1619 }
1620 EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
1621
1622 static int snd_soc_dapm_add_route(struct snd_soc_dapm_context *dapm,
1623                                   const struct snd_soc_dapm_route *route)
1624 {
1625         struct snd_soc_dapm_path *path;
1626         struct snd_soc_dapm_widget *wsource = NULL, *wsink = NULL, *w;
1627         struct snd_soc_dapm_widget *wtsource = NULL, *wtsink = NULL;
1628         const char *sink;
1629         const char *control = route->control;
1630         const char *source;
1631         char prefixed_sink[80];
1632         char prefixed_source[80];
1633         int ret = 0;
1634
1635         if (dapm->codec && dapm->codec->name_prefix) {
1636                 snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
1637                          dapm->codec->name_prefix, route->sink);
1638                 sink = prefixed_sink;
1639                 snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
1640                          dapm->codec->name_prefix, route->source);
1641                 source = prefixed_source;
1642         } else {
1643                 sink = route->sink;
1644                 source = route->source;
1645         }
1646
1647         /*
1648          * find src and dest widgets over all widgets but favor a widget from
1649          * current DAPM context
1650          */
1651         list_for_each_entry(w, &dapm->card->widgets, list) {
1652                 if (!wsink && !(strcmp(w->name, sink))) {
1653                         wtsink = w;
1654                         if (w->dapm == dapm)
1655                                 wsink = w;
1656                         continue;
1657                 }
1658                 if (!wsource && !(strcmp(w->name, source))) {
1659                         wtsource = w;
1660                         if (w->dapm == dapm)
1661                                 wsource = w;
1662                 }
1663         }
1664         /* use widget from another DAPM context if not found from this */
1665         if (!wsink)
1666                 wsink = wtsink;
1667         if (!wsource)
1668                 wsource = wtsource;
1669
1670         if (wsource == NULL || wsink == NULL)
1671                 return -ENODEV;
1672
1673         path = kzalloc(sizeof(struct snd_soc_dapm_path), GFP_KERNEL);
1674         if (!path)
1675                 return -ENOMEM;
1676
1677         path->source = wsource;
1678         path->sink = wsink;
1679         path->connected = route->connected;
1680         INIT_LIST_HEAD(&path->list);
1681         INIT_LIST_HEAD(&path->list_source);
1682         INIT_LIST_HEAD(&path->list_sink);
1683
1684         /* check for external widgets */
1685         if (wsink->id == snd_soc_dapm_input) {
1686                 if (wsource->id == snd_soc_dapm_micbias ||
1687                         wsource->id == snd_soc_dapm_mic ||
1688                         wsource->id == snd_soc_dapm_line ||
1689                         wsource->id == snd_soc_dapm_output)
1690                         wsink->ext = 1;
1691         }
1692         if (wsource->id == snd_soc_dapm_output) {
1693                 if (wsink->id == snd_soc_dapm_spk ||
1694                         wsink->id == snd_soc_dapm_hp ||
1695                         wsink->id == snd_soc_dapm_line ||
1696                         wsink->id == snd_soc_dapm_input)
1697                         wsource->ext = 1;
1698         }
1699
1700         /* connect static paths */
1701         if (control == NULL) {
1702                 list_add(&path->list, &dapm->card->paths);
1703                 list_add(&path->list_sink, &wsink->sources);
1704                 list_add(&path->list_source, &wsource->sinks);
1705                 path->connect = 1;
1706                 return 0;
1707         }
1708
1709         /* connect dynamic paths */
1710         switch (wsink->id) {
1711         case snd_soc_dapm_adc:
1712         case snd_soc_dapm_dac:
1713         case snd_soc_dapm_pga:
1714         case snd_soc_dapm_out_drv:
1715         case snd_soc_dapm_input:
1716         case snd_soc_dapm_output:
1717         case snd_soc_dapm_micbias:
1718         case snd_soc_dapm_vmid:
1719         case snd_soc_dapm_pre:
1720         case snd_soc_dapm_post:
1721         case snd_soc_dapm_supply:
1722         case snd_soc_dapm_aif_in:
1723         case snd_soc_dapm_aif_out:
1724                 list_add(&path->list, &dapm->card->paths);
1725                 list_add(&path->list_sink, &wsink->sources);
1726                 list_add(&path->list_source, &wsource->sinks);
1727                 path->connect = 1;
1728                 return 0;
1729         case snd_soc_dapm_mux:
1730         case snd_soc_dapm_virt_mux:
1731         case snd_soc_dapm_value_mux:
1732                 ret = dapm_connect_mux(dapm, wsource, wsink, path, control,
1733                         &wsink->kcontrol_news[0]);
1734                 if (ret != 0)
1735                         goto err;
1736                 break;
1737         case snd_soc_dapm_switch:
1738         case snd_soc_dapm_mixer:
1739         case snd_soc_dapm_mixer_named_ctl:
1740                 ret = dapm_connect_mixer(dapm, wsource, wsink, path, control);
1741                 if (ret != 0)
1742                         goto err;
1743                 break;
1744         case snd_soc_dapm_hp:
1745         case snd_soc_dapm_mic:
1746         case snd_soc_dapm_line:
1747         case snd_soc_dapm_spk:
1748                 list_add(&path->list, &dapm->card->paths);
1749                 list_add(&path->list_sink, &wsink->sources);
1750                 list_add(&path->list_source, &wsource->sinks);
1751                 path->connect = 0;
1752                 return 0;
1753         }
1754         return 0;
1755
1756 err:
1757         dev_warn(dapm->dev, "asoc: no dapm match for %s --> %s --> %s\n",
1758                  source, control, sink);
1759         kfree(path);
1760         return ret;
1761 }
1762
1763 /**
1764  * snd_soc_dapm_add_routes - Add routes between DAPM widgets
1765  * @dapm: DAPM context
1766  * @route: audio routes
1767  * @num: number of routes
1768  *
1769  * Connects 2 dapm widgets together via a named audio path. The sink is
1770  * the widget receiving the audio signal, whilst the source is the sender
1771  * of the audio signal.
1772  *
1773  * Returns 0 for success else error. On error all resources can be freed
1774  * with a call to snd_soc_card_free().
1775  */
1776 int snd_soc_dapm_add_routes(struct snd_soc_dapm_context *dapm,
1777                             const struct snd_soc_dapm_route *route, int num)
1778 {
1779         int i, ret;
1780
1781         for (i = 0; i < num; i++) {
1782                 ret = snd_soc_dapm_add_route(dapm, route);
1783                 if (ret < 0) {
1784                         dev_err(dapm->dev, "Failed to add route %s->%s\n",
1785                                 route->source, route->sink);
1786                         return ret;
1787                 }
1788                 route++;
1789         }
1790
1791         return 0;
1792 }
1793 EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);
1794
1795 /**
1796  * snd_soc_dapm_new_widgets - add new dapm widgets
1797  * @dapm: DAPM context
1798  *
1799  * Checks the codec for any new dapm widgets and creates them if found.
1800  *
1801  * Returns 0 for success.
1802  */
1803 int snd_soc_dapm_new_widgets(struct snd_soc_dapm_context *dapm)
1804 {
1805         struct snd_soc_dapm_widget *w;
1806         unsigned int val;
1807
1808         list_for_each_entry(w, &dapm->card->widgets, list)
1809         {
1810                 if (w->new)
1811                         continue;
1812
1813                 if (w->num_kcontrols) {
1814                         w->kcontrols = kzalloc(w->num_kcontrols *
1815                                                 sizeof(struct snd_kcontrol *),
1816                                                 GFP_KERNEL);
1817                         if (!w->kcontrols)
1818                                 return -ENOMEM;
1819                 }
1820
1821                 switch(w->id) {
1822                 case snd_soc_dapm_switch:
1823                 case snd_soc_dapm_mixer:
1824                 case snd_soc_dapm_mixer_named_ctl:
1825                         w->power_check = dapm_generic_check_power;
1826                         dapm_new_mixer(dapm, w);
1827                         break;
1828                 case snd_soc_dapm_mux:
1829                 case snd_soc_dapm_virt_mux:
1830                 case snd_soc_dapm_value_mux:
1831                         w->power_check = dapm_generic_check_power;
1832                         dapm_new_mux(dapm, w);
1833                         break;
1834                 case snd_soc_dapm_adc:
1835                 case snd_soc_dapm_aif_out:
1836                         w->power_check = dapm_adc_check_power;
1837                         break;
1838                 case snd_soc_dapm_dac:
1839                 case snd_soc_dapm_aif_in:
1840                         w->power_check = dapm_dac_check_power;
1841                         break;
1842                 case snd_soc_dapm_pga:
1843                 case snd_soc_dapm_out_drv:
1844                         w->power_check = dapm_generic_check_power;
1845                         dapm_new_pga(dapm, w);
1846                         break;
1847                 case snd_soc_dapm_input:
1848                 case snd_soc_dapm_output:
1849                 case snd_soc_dapm_micbias:
1850                 case snd_soc_dapm_spk:
1851                 case snd_soc_dapm_hp:
1852                 case snd_soc_dapm_mic:
1853                 case snd_soc_dapm_line:
1854                         w->power_check = dapm_generic_check_power;
1855                         break;
1856                 case snd_soc_dapm_supply:
1857                         w->power_check = dapm_supply_check_power;
1858                 case snd_soc_dapm_vmid:
1859                 case snd_soc_dapm_pre:
1860                 case snd_soc_dapm_post:
1861                         break;
1862                 }
1863
1864                 /* Read the initial power state from the device */
1865                 if (w->reg >= 0) {
1866                         val = snd_soc_read(w->codec, w->reg);
1867                         val &= 1 << w->shift;
1868                         if (w->invert)
1869                                 val = !val;
1870
1871                         if (val)
1872                                 w->power = 1;
1873                 }
1874
1875                 w->new = 1;
1876
1877                 dapm_debugfs_add_widget(w);
1878         }
1879
1880         dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
1881         return 0;
1882 }
1883 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_widgets);
1884
1885 /**
1886  * snd_soc_dapm_get_volsw - dapm mixer get callback
1887  * @kcontrol: mixer control
1888  * @ucontrol: control element information
1889  *
1890  * Callback to get the value of a dapm mixer control.
1891  *
1892  * Returns 0 for success.
1893  */
1894 int snd_soc_dapm_get_volsw(struct snd_kcontrol *kcontrol,
1895         struct snd_ctl_elem_value *ucontrol)
1896 {
1897         struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
1898         struct snd_soc_dapm_widget *widget = wlist->widgets[0];
1899         struct soc_mixer_control *mc =
1900                 (struct soc_mixer_control *)kcontrol->private_value;
1901         unsigned int reg = mc->reg;
1902         unsigned int shift = mc->shift;
1903         unsigned int rshift = mc->rshift;
1904         int max = mc->max;
1905         unsigned int invert = mc->invert;
1906         unsigned int mask = (1 << fls(max)) - 1;
1907
1908         ucontrol->value.integer.value[0] =
1909                 (snd_soc_read(widget->codec, reg) >> shift) & mask;
1910         if (shift != rshift)
1911                 ucontrol->value.integer.value[1] =
1912                         (snd_soc_read(widget->codec, reg) >> rshift) & mask;
1913         if (invert) {
1914                 ucontrol->value.integer.value[0] =
1915                         max - ucontrol->value.integer.value[0];
1916                 if (shift != rshift)
1917                         ucontrol->value.integer.value[1] =
1918                                 max - ucontrol->value.integer.value[1];
1919         }
1920
1921         return 0;
1922 }
1923 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);
1924
1925 /**
1926  * snd_soc_dapm_put_volsw - dapm mixer set callback
1927  * @kcontrol: mixer control
1928  * @ucontrol: control element information
1929  *
1930  * Callback to set the value of a dapm mixer control.
1931  *
1932  * Returns 0 for success.
1933  */
1934 int snd_soc_dapm_put_volsw(struct snd_kcontrol *kcontrol,
1935         struct snd_ctl_elem_value *ucontrol)
1936 {
1937         struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
1938         struct snd_soc_dapm_widget *widget = wlist->widgets[0];
1939         struct snd_soc_codec *codec = widget->codec;
1940         struct soc_mixer_control *mc =
1941                 (struct soc_mixer_control *)kcontrol->private_value;
1942         unsigned int reg = mc->reg;
1943         unsigned int shift = mc->shift;
1944         int max = mc->max;
1945         unsigned int mask = (1 << fls(max)) - 1;
1946         unsigned int invert = mc->invert;
1947         unsigned int val;
1948         int connect, change;
1949         struct snd_soc_dapm_update update;
1950         int wi;
1951
1952         val = (ucontrol->value.integer.value[0] & mask);
1953
1954         if (invert)
1955                 val = max - val;
1956         mask = mask << shift;
1957         val = val << shift;
1958
1959         if (val)
1960                 /* new connection */
1961                 connect = invert ? 0 : 1;
1962         else
1963                 /* old connection must be powered down */
1964                 connect = invert ? 1 : 0;
1965
1966         mutex_lock(&codec->mutex);
1967
1968         change = snd_soc_test_bits(widget->codec, reg, mask, val);
1969         if (change) {
1970                 for (wi = 0; wi < wlist->num_widgets; wi++) {
1971                         widget = wlist->widgets[wi];
1972
1973                         widget->value = val;
1974
1975                         update.kcontrol = kcontrol;
1976                         update.widget = widget;
1977                         update.reg = reg;
1978                         update.mask = mask;
1979                         update.val = val;
1980                         widget->dapm->update = &update;
1981
1982                         dapm_mixer_update_power(widget, kcontrol, connect);
1983
1984                         widget->dapm->update = NULL;
1985                 }
1986         }
1987
1988         mutex_unlock(&codec->mutex);
1989         return 0;
1990 }
1991 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_volsw);
1992
1993 /**
1994  * snd_soc_dapm_get_enum_double - dapm enumerated double mixer get callback
1995  * @kcontrol: mixer control
1996  * @ucontrol: control element information
1997  *
1998  * Callback to get the value of a dapm enumerated double mixer control.
1999  *
2000  * Returns 0 for success.
2001  */
2002 int snd_soc_dapm_get_enum_double(struct snd_kcontrol *kcontrol,
2003         struct snd_ctl_elem_value *ucontrol)
2004 {
2005         struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2006         struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2007         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2008         unsigned int val, bitmask;
2009
2010         for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2011                 ;
2012         val = snd_soc_read(widget->codec, e->reg);
2013         ucontrol->value.enumerated.item[0] = (val >> e->shift_l) & (bitmask - 1);
2014         if (e->shift_l != e->shift_r)
2015                 ucontrol->value.enumerated.item[1] =
2016                         (val >> e->shift_r) & (bitmask - 1);
2017
2018         return 0;
2019 }
2020 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);
2021
2022 /**
2023  * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
2024  * @kcontrol: mixer control
2025  * @ucontrol: control element information
2026  *
2027  * Callback to set the value of a dapm enumerated double mixer control.
2028  *
2029  * Returns 0 for success.
2030  */
2031 int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
2032         struct snd_ctl_elem_value *ucontrol)
2033 {
2034         struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2035         struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2036         struct snd_soc_codec *codec = widget->codec;
2037         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2038         unsigned int val, mux, change;
2039         unsigned int mask, bitmask;
2040         struct snd_soc_dapm_update update;
2041         int wi;
2042
2043         for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2044                 ;
2045         if (ucontrol->value.enumerated.item[0] > e->max - 1)
2046                 return -EINVAL;
2047         mux = ucontrol->value.enumerated.item[0];
2048         val = mux << e->shift_l;
2049         mask = (bitmask - 1) << e->shift_l;
2050         if (e->shift_l != e->shift_r) {
2051                 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2052                         return -EINVAL;
2053                 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
2054                 mask |= (bitmask - 1) << e->shift_r;
2055         }
2056
2057         mutex_lock(&codec->mutex);
2058
2059         change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
2060         if (change) {
2061                 for (wi = 0; wi < wlist->num_widgets; wi++) {
2062                         widget = wlist->widgets[wi];
2063
2064                         widget->value = val;
2065
2066                         update.kcontrol = kcontrol;
2067                         update.widget = widget;
2068                         update.reg = e->reg;
2069                         update.mask = mask;
2070                         update.val = val;
2071                         widget->dapm->update = &update;
2072
2073                         dapm_mux_update_power(widget, kcontrol, change, mux, e);
2074
2075                         widget->dapm->update = NULL;
2076                 }
2077         }
2078
2079         mutex_unlock(&codec->mutex);
2080         return change;
2081 }
2082 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);
2083
2084 /**
2085  * snd_soc_dapm_get_enum_virt - Get virtual DAPM mux
2086  * @kcontrol: mixer control
2087  * @ucontrol: control element information
2088  *
2089  * Returns 0 for success.
2090  */
2091 int snd_soc_dapm_get_enum_virt(struct snd_kcontrol *kcontrol,
2092                                struct snd_ctl_elem_value *ucontrol)
2093 {
2094         struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2095         struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2096
2097         ucontrol->value.enumerated.item[0] = widget->value;
2098
2099         return 0;
2100 }
2101 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_virt);
2102
2103 /**
2104  * snd_soc_dapm_put_enum_virt - Set virtual DAPM mux
2105  * @kcontrol: mixer control
2106  * @ucontrol: control element information
2107  *
2108  * Returns 0 for success.
2109  */
2110 int snd_soc_dapm_put_enum_virt(struct snd_kcontrol *kcontrol,
2111                                struct snd_ctl_elem_value *ucontrol)
2112 {
2113         struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2114         struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2115         struct snd_soc_codec *codec = widget->codec;
2116         struct soc_enum *e =
2117                 (struct soc_enum *)kcontrol->private_value;
2118         int change;
2119         int ret = 0;
2120         int wi;
2121
2122         if (ucontrol->value.enumerated.item[0] >= e->max)
2123                 return -EINVAL;
2124
2125         mutex_lock(&codec->mutex);
2126
2127         change = widget->value != ucontrol->value.enumerated.item[0];
2128         if (change) {
2129                 for (wi = 0; wi < wlist->num_widgets; wi++) {
2130                         widget = wlist->widgets[wi];
2131
2132                         widget->value = ucontrol->value.enumerated.item[0];
2133
2134                         dapm_mux_update_power(widget, kcontrol, change,
2135                                               widget->value, e);
2136                 }
2137         }
2138
2139         mutex_unlock(&codec->mutex);
2140         return ret;
2141 }
2142 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_virt);
2143
2144 /**
2145  * snd_soc_dapm_get_value_enum_double - dapm semi enumerated double mixer get
2146  *                                      callback
2147  * @kcontrol: mixer control
2148  * @ucontrol: control element information
2149  *
2150  * Callback to get the value of a dapm semi enumerated double mixer control.
2151  *
2152  * Semi enumerated mixer: the enumerated items are referred as values. Can be
2153  * used for handling bitfield coded enumeration for example.
2154  *
2155  * Returns 0 for success.
2156  */
2157 int snd_soc_dapm_get_value_enum_double(struct snd_kcontrol *kcontrol,
2158         struct snd_ctl_elem_value *ucontrol)
2159 {
2160         struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2161         struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2162         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2163         unsigned int reg_val, val, mux;
2164
2165         reg_val = snd_soc_read(widget->codec, e->reg);
2166         val = (reg_val >> e->shift_l) & e->mask;
2167         for (mux = 0; mux < e->max; mux++) {
2168                 if (val == e->values[mux])
2169                         break;
2170         }
2171         ucontrol->value.enumerated.item[0] = mux;
2172         if (e->shift_l != e->shift_r) {
2173                 val = (reg_val >> e->shift_r) & e->mask;
2174                 for (mux = 0; mux < e->max; mux++) {
2175                         if (val == e->values[mux])
2176                                 break;
2177                 }
2178                 ucontrol->value.enumerated.item[1] = mux;
2179         }
2180
2181         return 0;
2182 }
2183 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_value_enum_double);
2184
2185 /**
2186  * snd_soc_dapm_put_value_enum_double - dapm semi enumerated double mixer set
2187  *                                      callback
2188  * @kcontrol: mixer control
2189  * @ucontrol: control element information
2190  *
2191  * Callback to set the value of a dapm semi enumerated double mixer control.
2192  *
2193  * Semi enumerated mixer: the enumerated items are referred as values. Can be
2194  * used for handling bitfield coded enumeration for example.
2195  *
2196  * Returns 0 for success.
2197  */
2198 int snd_soc_dapm_put_value_enum_double(struct snd_kcontrol *kcontrol,
2199         struct snd_ctl_elem_value *ucontrol)
2200 {
2201         struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol);
2202         struct snd_soc_dapm_widget *widget = wlist->widgets[0];
2203         struct snd_soc_codec *codec = widget->codec;
2204         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2205         unsigned int val, mux, change;
2206         unsigned int mask;
2207         struct snd_soc_dapm_update update;
2208         int wi;
2209
2210         if (ucontrol->value.enumerated.item[0] > e->max - 1)
2211                 return -EINVAL;
2212         mux = ucontrol->value.enumerated.item[0];
2213         val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
2214         mask = e->mask << e->shift_l;
2215         if (e->shift_l != e->shift_r) {
2216                 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2217                         return -EINVAL;
2218                 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
2219                 mask |= e->mask << e->shift_r;
2220         }
2221
2222         mutex_lock(&codec->mutex);
2223
2224         change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
2225         if (change) {
2226                 for (wi = 0; wi < wlist->num_widgets; wi++) {
2227                         widget = wlist->widgets[wi];
2228
2229                         widget->value = val;
2230
2231                         update.kcontrol = kcontrol;
2232                         update.widget = widget;
2233                         update.reg = e->reg;
2234                         update.mask = mask;
2235                         update.val = val;
2236                         widget->dapm->update = &update;
2237
2238                         dapm_mux_update_power(widget, kcontrol, change, mux, e);
2239
2240                         widget->dapm->update = NULL;
2241                 }
2242         }
2243
2244         mutex_unlock(&codec->mutex);
2245         return change;
2246 }
2247 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_value_enum_double);
2248
2249 /**
2250  * snd_soc_dapm_info_pin_switch - Info for a pin switch
2251  *
2252  * @kcontrol: mixer control
2253  * @uinfo: control element information
2254  *
2255  * Callback to provide information about a pin switch control.
2256  */
2257 int snd_soc_dapm_info_pin_switch(struct snd_kcontrol *kcontrol,
2258                                  struct snd_ctl_elem_info *uinfo)
2259 {
2260         uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2261         uinfo->count = 1;
2262         uinfo->value.integer.min = 0;
2263         uinfo->value.integer.max = 1;
2264
2265         return 0;
2266 }
2267 EXPORT_SYMBOL_GPL(snd_soc_dapm_info_pin_switch);
2268
2269 /**
2270  * snd_soc_dapm_get_pin_switch - Get information for a pin switch
2271  *
2272  * @kcontrol: mixer control
2273  * @ucontrol: Value
2274  */
2275 int snd_soc_dapm_get_pin_switch(struct snd_kcontrol *kcontrol,
2276                                 struct snd_ctl_elem_value *ucontrol)
2277 {
2278         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2279         const char *pin = (const char *)kcontrol->private_value;
2280
2281         mutex_lock(&codec->mutex);
2282
2283         ucontrol->value.integer.value[0] =
2284                 snd_soc_dapm_get_pin_status(&codec->dapm, pin);
2285
2286         mutex_unlock(&codec->mutex);
2287
2288         return 0;
2289 }
2290 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_switch);
2291
2292 /**
2293  * snd_soc_dapm_put_pin_switch - Set information for a pin switch
2294  *
2295  * @kcontrol: mixer control
2296  * @ucontrol: Value
2297  */
2298 int snd_soc_dapm_put_pin_switch(struct snd_kcontrol *kcontrol,
2299                                 struct snd_ctl_elem_value *ucontrol)
2300 {
2301         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2302         const char *pin = (const char *)kcontrol->private_value;
2303
2304         mutex_lock(&codec->mutex);
2305
2306         if (ucontrol->value.integer.value[0])
2307                 snd_soc_dapm_enable_pin(&codec->dapm, pin);
2308         else
2309                 snd_soc_dapm_disable_pin(&codec->dapm, pin);
2310
2311         snd_soc_dapm_sync(&codec->dapm);
2312
2313         mutex_unlock(&codec->mutex);
2314
2315         return 0;
2316 }
2317 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);
2318
2319 /**
2320  * snd_soc_dapm_new_control - create new dapm control
2321  * @dapm: DAPM context
2322  * @widget: widget template
2323  *
2324  * Creates a new dapm control based upon the template.
2325  *
2326  * Returns 0 for success else error.
2327  */
2328 int snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
2329         const struct snd_soc_dapm_widget *widget)
2330 {
2331         struct snd_soc_dapm_widget *w;
2332         size_t name_len;
2333
2334         if ((w = dapm_cnew_widget(widget)) == NULL)
2335                 return -ENOMEM;
2336
2337         name_len = strlen(widget->name) + 1;
2338         if (dapm->codec && dapm->codec->name_prefix)
2339                 name_len += 1 + strlen(dapm->codec->name_prefix);
2340         w->name = kmalloc(name_len, GFP_KERNEL);
2341         if (w->name == NULL) {
2342                 kfree(w);
2343                 return -ENOMEM;
2344         }
2345         if (dapm->codec && dapm->codec->name_prefix)
2346                 snprintf(w->name, name_len, "%s %s",
2347                         dapm->codec->name_prefix, widget->name);
2348         else
2349                 snprintf(w->name, name_len, "%s", widget->name);
2350
2351         dapm->n_widgets++;
2352         w->dapm = dapm;
2353         w->codec = dapm->codec;
2354         INIT_LIST_HEAD(&w->sources);
2355         INIT_LIST_HEAD(&w->sinks);
2356         INIT_LIST_HEAD(&w->list);
2357         list_add(&w->list, &dapm->card->widgets);
2358
2359         /* machine layer set ups unconnected pins and insertions */
2360         w->connected = 1;
2361         return 0;
2362 }
2363 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_control);
2364
2365 /**
2366  * snd_soc_dapm_new_controls - create new dapm controls
2367  * @dapm: DAPM context
2368  * @widget: widget array
2369  * @num: number of widgets
2370  *
2371  * Creates new DAPM controls based upon the templates.
2372  *
2373  * Returns 0 for success else error.
2374  */
2375 int snd_soc_dapm_new_controls(struct snd_soc_dapm_context *dapm,
2376         const struct snd_soc_dapm_widget *widget,
2377         int num)
2378 {
2379         int i, ret;
2380
2381         for (i = 0; i < num; i++) {
2382                 ret = snd_soc_dapm_new_control(dapm, widget);
2383                 if (ret < 0) {
2384                         dev_err(dapm->dev,
2385                                 "ASoC: Failed to create DAPM control %s: %d\n",
2386                                 widget->name, ret);
2387                         return ret;
2388                 }
2389                 widget++;
2390         }
2391         return 0;
2392 }
2393 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);
2394
2395 static void soc_dapm_stream_event(struct snd_soc_dapm_context *dapm,
2396         const char *stream, int event)
2397 {
2398         struct snd_soc_dapm_widget *w;
2399
2400         list_for_each_entry(w, &dapm->card->widgets, list)
2401         {
2402                 if (!w->sname || w->dapm != dapm)
2403                         continue;
2404                 dev_dbg(w->dapm->dev, "widget %s\n %s stream %s event %d\n",
2405                         w->name, w->sname, stream, event);
2406                 if (strstr(w->sname, stream)) {
2407                         switch(event) {
2408                         case SND_SOC_DAPM_STREAM_START:
2409                                 w->active = 1;
2410                                 break;
2411                         case SND_SOC_DAPM_STREAM_STOP:
2412                                 w->active = 0;
2413                                 break;
2414                         case SND_SOC_DAPM_STREAM_SUSPEND:
2415                         case SND_SOC_DAPM_STREAM_RESUME:
2416                         case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
2417                         case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
2418                                 break;
2419                         }
2420                 }
2421         }
2422
2423         dapm_power_widgets(dapm, event);
2424 }
2425
2426 /**
2427  * snd_soc_dapm_stream_event - send a stream event to the dapm core
2428  * @rtd: PCM runtime data
2429  * @stream: stream name
2430  * @event: stream event
2431  *
2432  * Sends a stream event to the dapm core. The core then makes any
2433  * necessary widget power changes.
2434  *
2435  * Returns 0 for success else error.
2436  */
2437 int snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd,
2438         const char *stream, int event)
2439 {
2440         struct snd_soc_codec *codec = rtd->codec;
2441
2442         if (stream == NULL)
2443                 return 0;
2444
2445         mutex_lock(&codec->mutex);
2446         soc_dapm_stream_event(&codec->dapm, stream, event);
2447         mutex_unlock(&codec->mutex);
2448         return 0;
2449 }
2450
2451 /**
2452  * snd_soc_dapm_enable_pin - enable pin.
2453  * @dapm: DAPM context
2454  * @pin: pin name
2455  *
2456  * Enables input/output pin and its parents or children widgets iff there is
2457  * a valid audio route and active audio stream.
2458  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2459  * do any widget power switching.
2460  */
2461 int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin)
2462 {
2463         return snd_soc_dapm_set_pin(dapm, pin, 1);
2464 }
2465 EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
2466
2467 /**
2468  * snd_soc_dapm_force_enable_pin - force a pin to be enabled
2469  * @dapm: DAPM context
2470  * @pin: pin name
2471  *
2472  * Enables input/output pin regardless of any other state.  This is
2473  * intended for use with microphone bias supplies used in microphone
2474  * jack detection.
2475  *
2476  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2477  * do any widget power switching.
2478  */
2479 int snd_soc_dapm_force_enable_pin(struct snd_soc_dapm_context *dapm,
2480                                   const char *pin)
2481 {
2482         struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
2483
2484         if (!w) {
2485                 dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
2486                 return -EINVAL;
2487         }
2488
2489         dev_dbg(w->dapm->dev, "dapm: force enable pin %s\n", pin);
2490         w->connected = 1;
2491         w->force = 1;
2492
2493         return 0;
2494 }
2495 EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin);
2496
2497 /**
2498  * snd_soc_dapm_disable_pin - disable pin.
2499  * @dapm: DAPM context
2500  * @pin: pin name
2501  *
2502  * Disables input/output pin and its parents or children widgets.
2503  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2504  * do any widget power switching.
2505  */
2506 int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm,
2507                              const char *pin)
2508 {
2509         return snd_soc_dapm_set_pin(dapm, pin, 0);
2510 }
2511 EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
2512
2513 /**
2514  * snd_soc_dapm_nc_pin - permanently disable pin.
2515  * @dapm: DAPM context
2516  * @pin: pin name
2517  *
2518  * Marks the specified pin as being not connected, disabling it along
2519  * any parent or child widgets.  At present this is identical to
2520  * snd_soc_dapm_disable_pin() but in future it will be extended to do
2521  * additional things such as disabling controls which only affect
2522  * paths through the pin.
2523  *
2524  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2525  * do any widget power switching.
2526  */
2527 int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin)
2528 {
2529         return snd_soc_dapm_set_pin(dapm, pin, 0);
2530 }
2531 EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);
2532
2533 /**
2534  * snd_soc_dapm_get_pin_status - get audio pin status
2535  * @dapm: DAPM context
2536  * @pin: audio signal pin endpoint (or start point)
2537  *
2538  * Get audio pin status - connected or disconnected.
2539  *
2540  * Returns 1 for connected otherwise 0.
2541  */
2542 int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm,
2543                                 const char *pin)
2544 {
2545         struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
2546
2547         if (w)
2548                 return w->connected;
2549
2550         return 0;
2551 }
2552 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
2553
2554 /**
2555  * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint
2556  * @dapm: DAPM context
2557  * @pin: audio signal pin endpoint (or start point)
2558  *
2559  * Mark the given endpoint or pin as ignoring suspend.  When the
2560  * system is disabled a path between two endpoints flagged as ignoring
2561  * suspend will not be disabled.  The path must already be enabled via
2562  * normal means at suspend time, it will not be turned on if it was not
2563  * already enabled.
2564  */
2565 int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm,
2566                                 const char *pin)
2567 {
2568         struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, false);
2569
2570         if (!w) {
2571                 dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
2572                 return -EINVAL;
2573         }
2574
2575         w->ignore_suspend = 1;
2576
2577         return 0;
2578 }
2579 EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend);
2580
2581 /**
2582  * snd_soc_dapm_free - free dapm resources
2583  * @card: SoC device
2584  *
2585  * Free all dapm widgets and resources.
2586  */
2587 void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm)
2588 {
2589         snd_soc_dapm_sys_remove(dapm->dev);
2590         dapm_debugfs_cleanup(dapm);
2591         dapm_free_widgets(dapm);
2592         list_del(&dapm->list);
2593 }
2594 EXPORT_SYMBOL_GPL(snd_soc_dapm_free);
2595
2596 static void soc_dapm_shutdown_codec(struct snd_soc_dapm_context *dapm)
2597 {
2598         struct snd_soc_dapm_widget *w;
2599         LIST_HEAD(down_list);
2600         int powerdown = 0;
2601
2602         list_for_each_entry(w, &dapm->card->widgets, list) {
2603                 if (w->dapm != dapm)
2604                         continue;
2605                 if (w->power) {
2606                         dapm_seq_insert(w, &down_list, false);
2607                         w->power = 0;
2608                         powerdown = 1;
2609                 }
2610         }
2611
2612         /* If there were no widgets to power down we're already in
2613          * standby.
2614          */
2615         if (powerdown) {
2616                 snd_soc_dapm_set_bias_level(dapm, SND_SOC_BIAS_PREPARE);
2617                 dapm_seq_run(dapm, &down_list, 0, false);
2618                 snd_soc_dapm_set_bias_level(dapm, SND_SOC_BIAS_STANDBY);
2619         }
2620 }
2621
2622 /*
2623  * snd_soc_dapm_shutdown - callback for system shutdown
2624  */
2625 void snd_soc_dapm_shutdown(struct snd_soc_card *card)
2626 {
2627         struct snd_soc_codec *codec;
2628
2629         list_for_each_entry(codec, &card->codec_dev_list, list) {
2630                 soc_dapm_shutdown_codec(&codec->dapm);
2631                 snd_soc_dapm_set_bias_level(&codec->dapm, SND_SOC_BIAS_OFF);
2632         }
2633 }
2634
2635 /* Module information */
2636 MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
2637 MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
2638 MODULE_LICENSE("GPL");