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