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