]> bbs.cooldavid.org Git - net-next-2.6.git/blame - sound/soc/soc-dapm.c
ASoC: Apostrophe patrol
[net-next-2.6.git] / sound / soc / soc-dapm.c
CommitLineData
2b97eabc
RP
1/*
2 * soc-dapm.c -- ALSA SoC Dynamic Audio Power Management
3 *
4 * Copyright 2005 Wolfson Microelectronics PLC.
d331124d 5 * Author: Liam Girdwood <lrg@slimlogic.co.uk>
2b97eabc
RP
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 *
2b97eabc
RP
12 * Features:
13 * o Changes power status of internal codec blocks depending on the
14 * dynamic configuration of codec internal audio paths and active
74b8f955 15 * DACs/ADCs.
2b97eabc
RP
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
3a4fa0a2 21 * o Delayed powerdown of audio susbsystem to reduce pops between a quick
2b97eabc
RP
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/delay.h>
36#include <linux/pm.h>
37#include <linux/bitops.h>
38#include <linux/platform_device.h>
39#include <linux/jiffies.h>
2b97eabc
RP
40#include <sound/core.h>
41#include <sound/pcm.h>
42#include <sound/pcm_params.h>
43#include <sound/soc-dapm.h>
44#include <sound/initval.h>
45
46/* debug */
c1286b86 47#ifdef DEBUG
2b97eabc 48#define dump_dapm(codec, action) dbg_dump_dapm(codec, action)
2b97eabc
RP
49#else
50#define dump_dapm(codec, action)
2b97eabc
RP
51#endif
52
2b97eabc
RP
53/* dapm power sequences - make this per codec in the future */
54static int dapm_up_seq[] = {
246d0a17
MB
55 snd_soc_dapm_pre, snd_soc_dapm_supply, snd_soc_dapm_micbias,
56 snd_soc_dapm_mic, snd_soc_dapm_mux, snd_soc_dapm_value_mux,
57 snd_soc_dapm_dac, snd_soc_dapm_mixer, snd_soc_dapm_mixer_named_ctl,
58 snd_soc_dapm_pga, snd_soc_dapm_adc, snd_soc_dapm_hp, snd_soc_dapm_spk,
59 snd_soc_dapm_post
2b97eabc 60};
ca9c1aae 61
2b97eabc
RP
62static int dapm_down_seq[] = {
63 snd_soc_dapm_pre, snd_soc_dapm_adc, snd_soc_dapm_hp, snd_soc_dapm_spk,
ca9c1aae
IM
64 snd_soc_dapm_pga, snd_soc_dapm_mixer_named_ctl, snd_soc_dapm_mixer,
65 snd_soc_dapm_dac, snd_soc_dapm_mic, snd_soc_dapm_micbias,
246d0a17
MB
66 snd_soc_dapm_mux, snd_soc_dapm_value_mux, snd_soc_dapm_supply,
67 snd_soc_dapm_post
2b97eabc
RP
68};
69
12ef193d 70static void pop_wait(u32 pop_time)
15e4c72f
MB
71{
72 if (pop_time)
73 schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
74}
75
12ef193d 76static void pop_dbg(u32 pop_time, const char *fmt, ...)
15e4c72f
MB
77{
78 va_list args;
79
80 va_start(args, fmt);
81
82 if (pop_time) {
83 vprintk(fmt, args);
12ef193d 84 pop_wait(pop_time);
15e4c72f
MB
85 }
86
87 va_end(args);
88}
89
2b97eabc 90/* create a new dapm widget */
88cb4290 91static inline struct snd_soc_dapm_widget *dapm_cnew_widget(
2b97eabc
RP
92 const struct snd_soc_dapm_widget *_widget)
93{
88cb4290 94 return kmemdup(_widget, sizeof(*_widget), GFP_KERNEL);
2b97eabc
RP
95}
96
452c5eaa
MB
97/**
98 * snd_soc_dapm_set_bias_level - set the bias level for the system
99 * @socdev: audio device
100 * @level: level to configure
101 *
102 * Configure the bias (power) levels for the SoC audio device.
103 *
104 * Returns 0 for success else error.
105 */
106static int snd_soc_dapm_set_bias_level(struct snd_soc_device *socdev,
107 enum snd_soc_bias_level level)
108{
109 struct snd_soc_card *card = socdev->card;
110 struct snd_soc_codec *codec = socdev->card->codec;
111 int ret = 0;
112
f83fba8b
MB
113 switch (level) {
114 case SND_SOC_BIAS_ON:
115 dev_dbg(socdev->dev, "Setting full bias\n");
116 break;
117 case SND_SOC_BIAS_PREPARE:
118 dev_dbg(socdev->dev, "Setting bias prepare\n");
119 break;
120 case SND_SOC_BIAS_STANDBY:
121 dev_dbg(socdev->dev, "Setting standby bias\n");
122 break;
123 case SND_SOC_BIAS_OFF:
124 dev_dbg(socdev->dev, "Setting bias off\n");
125 break;
126 default:
127 dev_err(socdev->dev, "Setting invalid bias %d\n", level);
128 return -EINVAL;
129 }
130
452c5eaa
MB
131 if (card->set_bias_level)
132 ret = card->set_bias_level(card, level);
133 if (ret == 0 && codec->set_bias_level)
134 ret = codec->set_bias_level(codec, level);
135
136 return ret;
137}
138
2b97eabc
RP
139/* set up initial codec paths */
140static void dapm_set_path_status(struct snd_soc_dapm_widget *w,
141 struct snd_soc_dapm_path *p, int i)
142{
143 switch (w->id) {
144 case snd_soc_dapm_switch:
ca9c1aae
IM
145 case snd_soc_dapm_mixer:
146 case snd_soc_dapm_mixer_named_ctl: {
2b97eabc 147 int val;
4eaa9819
JS
148 struct soc_mixer_control *mc = (struct soc_mixer_control *)
149 w->kcontrols[i].private_value;
815ecf8d
JS
150 unsigned int reg = mc->reg;
151 unsigned int shift = mc->shift;
4eaa9819 152 int max = mc->max;
815ecf8d
JS
153 unsigned int mask = (1 << fls(max)) - 1;
154 unsigned int invert = mc->invert;
2b97eabc
RP
155
156 val = snd_soc_read(w->codec, reg);
157 val = (val >> shift) & mask;
158
159 if ((invert && !val) || (!invert && val))
160 p->connect = 1;
161 else
162 p->connect = 0;
163 }
164 break;
165 case snd_soc_dapm_mux: {
166 struct soc_enum *e = (struct soc_enum *)w->kcontrols[i].private_value;
167 int val, item, bitmask;
168
f8ba0b7b 169 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2b97eabc
RP
170 ;
171 val = snd_soc_read(w->codec, e->reg);
172 item = (val >> e->shift_l) & (bitmask - 1);
173
174 p->connect = 0;
f8ba0b7b 175 for (i = 0; i < e->max; i++) {
2b97eabc
RP
176 if (!(strcmp(p->name, e->texts[i])) && item == i)
177 p->connect = 1;
178 }
179 }
180 break;
2e72f8e3 181 case snd_soc_dapm_value_mux: {
74155556 182 struct soc_enum *e = (struct soc_enum *)
2e72f8e3
PU
183 w->kcontrols[i].private_value;
184 int val, item;
185
186 val = snd_soc_read(w->codec, e->reg);
187 val = (val >> e->shift_l) & e->mask;
188 for (item = 0; item < e->max; item++) {
189 if (val == e->values[item])
190 break;
191 }
192
193 p->connect = 0;
194 for (i = 0; i < e->max; i++) {
195 if (!(strcmp(p->name, e->texts[i])) && item == i)
196 p->connect = 1;
197 }
198 }
199 break;
2b97eabc
RP
200 /* does not effect routing - always connected */
201 case snd_soc_dapm_pga:
202 case snd_soc_dapm_output:
203 case snd_soc_dapm_adc:
204 case snd_soc_dapm_input:
205 case snd_soc_dapm_dac:
206 case snd_soc_dapm_micbias:
207 case snd_soc_dapm_vmid:
246d0a17 208 case snd_soc_dapm_supply:
2b97eabc
RP
209 p->connect = 1;
210 break;
211 /* does effect routing - dynamically connected */
212 case snd_soc_dapm_hp:
213 case snd_soc_dapm_mic:
214 case snd_soc_dapm_spk:
215 case snd_soc_dapm_line:
216 case snd_soc_dapm_pre:
217 case snd_soc_dapm_post:
218 p->connect = 0;
219 break;
220 }
221}
222
74b8f955 223/* connect mux widget to its interconnecting audio paths */
2b97eabc
RP
224static int dapm_connect_mux(struct snd_soc_codec *codec,
225 struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
226 struct snd_soc_dapm_path *path, const char *control_name,
227 const struct snd_kcontrol_new *kcontrol)
228{
229 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
230 int i;
231
f8ba0b7b 232 for (i = 0; i < e->max; i++) {
2b97eabc
RP
233 if (!(strcmp(control_name, e->texts[i]))) {
234 list_add(&path->list, &codec->dapm_paths);
235 list_add(&path->list_sink, &dest->sources);
236 list_add(&path->list_source, &src->sinks);
237 path->name = (char*)e->texts[i];
238 dapm_set_path_status(dest, path, 0);
239 return 0;
240 }
241 }
242
243 return -ENODEV;
244}
245
74b8f955 246/* connect mixer widget to its interconnecting audio paths */
2b97eabc
RP
247static int dapm_connect_mixer(struct snd_soc_codec *codec,
248 struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
249 struct snd_soc_dapm_path *path, const char *control_name)
250{
251 int i;
252
253 /* search for mixer kcontrol */
254 for (i = 0; i < dest->num_kcontrols; i++) {
255 if (!strcmp(control_name, dest->kcontrols[i].name)) {
256 list_add(&path->list, &codec->dapm_paths);
257 list_add(&path->list_sink, &dest->sources);
258 list_add(&path->list_source, &src->sinks);
259 path->name = dest->kcontrols[i].name;
260 dapm_set_path_status(dest, path, i);
261 return 0;
262 }
263 }
264 return -ENODEV;
265}
266
267/* update dapm codec register bits */
268static int dapm_update_bits(struct snd_soc_dapm_widget *widget)
269{
270 int change, power;
271 unsigned short old, new;
272 struct snd_soc_codec *codec = widget->codec;
273
274 /* check for valid widgets */
275 if (widget->reg < 0 || widget->id == snd_soc_dapm_input ||
276 widget->id == snd_soc_dapm_output ||
277 widget->id == snd_soc_dapm_hp ||
278 widget->id == snd_soc_dapm_mic ||
279 widget->id == snd_soc_dapm_line ||
280 widget->id == snd_soc_dapm_spk)
281 return 0;
282
283 power = widget->power;
284 if (widget->invert)
285 power = (power ? 0:1);
286
287 old = snd_soc_read(codec, widget->reg);
288 new = (old & ~(0x1 << widget->shift)) | (power << widget->shift);
289
290 change = old != new;
291 if (change) {
12ef193d
TK
292 pop_dbg(codec->pop_time, "pop test %s : %s in %d ms\n",
293 widget->name, widget->power ? "on" : "off",
294 codec->pop_time);
2b97eabc 295 snd_soc_write(codec, widget->reg, new);
12ef193d 296 pop_wait(codec->pop_time);
2b97eabc 297 }
c1286b86
MB
298 pr_debug("reg %x old %x new %x change %d\n", widget->reg,
299 old, new, change);
2b97eabc
RP
300 return change;
301}
302
303/* ramps the volume up or down to minimise pops before or after a
304 * DAPM power event */
305static int dapm_set_pga(struct snd_soc_dapm_widget *widget, int power)
306{
307 const struct snd_kcontrol_new *k = widget->kcontrols;
308
309 if (widget->muted && !power)
310 return 0;
311 if (!widget->muted && power)
312 return 0;
313
314 if (widget->num_kcontrols && k) {
4eaa9819
JS
315 struct soc_mixer_control *mc =
316 (struct soc_mixer_control *)k->private_value;
815ecf8d
JS
317 unsigned int reg = mc->reg;
318 unsigned int shift = mc->shift;
4eaa9819 319 int max = mc->max;
815ecf8d
JS
320 unsigned int mask = (1 << fls(max)) - 1;
321 unsigned int invert = mc->invert;
2b97eabc
RP
322
323 if (power) {
324 int i;
325 /* power up has happended, increase volume to last level */
326 if (invert) {
4eaa9819 327 for (i = max; i > widget->saved_value; i--)
2b97eabc
RP
328 snd_soc_update_bits(widget->codec, reg, mask, i);
329 } else {
330 for (i = 0; i < widget->saved_value; i++)
331 snd_soc_update_bits(widget->codec, reg, mask, i);
332 }
333 widget->muted = 0;
334 } else {
335 /* power down is about to occur, decrease volume to mute */
336 int val = snd_soc_read(widget->codec, reg);
337 int i = widget->saved_value = (val >> shift) & mask;
338 if (invert) {
339 for (; i < mask; i++)
340 snd_soc_update_bits(widget->codec, reg, mask, i);
341 } else {
342 for (; i > 0; i--)
343 snd_soc_update_bits(widget->codec, reg, mask, i);
344 }
345 widget->muted = 1;
346 }
347 }
348 return 0;
349}
350
351/* create new dapm mixer control */
352static int dapm_new_mixer(struct snd_soc_codec *codec,
353 struct snd_soc_dapm_widget *w)
354{
355 int i, ret = 0;
219b93f5 356 size_t name_len;
2b97eabc
RP
357 struct snd_soc_dapm_path *path;
358
359 /* add kcontrol */
360 for (i = 0; i < w->num_kcontrols; i++) {
361
362 /* match name */
363 list_for_each_entry(path, &w->sources, list_sink) {
364
365 /* mixer/mux paths name must match control name */
366 if (path->name != (char*)w->kcontrols[i].name)
367 continue;
368
ca9c1aae
IM
369 /* add dapm control with long name.
370 * for dapm_mixer this is the concatenation of the
371 * mixer and kcontrol name.
372 * for dapm_mixer_named_ctl this is simply the
373 * kcontrol name.
374 */
375 name_len = strlen(w->kcontrols[i].name) + 1;
07495f3e 376 if (w->id != snd_soc_dapm_mixer_named_ctl)
ca9c1aae
IM
377 name_len += 1 + strlen(w->name);
378
219b93f5 379 path->long_name = kmalloc(name_len, GFP_KERNEL);
ca9c1aae 380
2b97eabc
RP
381 if (path->long_name == NULL)
382 return -ENOMEM;
383
ca9c1aae 384 switch (w->id) {
ca9c1aae
IM
385 default:
386 snprintf(path->long_name, name_len, "%s %s",
387 w->name, w->kcontrols[i].name);
07495f3e 388 break;
ca9c1aae
IM
389 case snd_soc_dapm_mixer_named_ctl:
390 snprintf(path->long_name, name_len, "%s",
391 w->kcontrols[i].name);
07495f3e 392 break;
ca9c1aae
IM
393 }
394
219b93f5
MB
395 path->long_name[name_len - 1] = '\0';
396
2b97eabc
RP
397 path->kcontrol = snd_soc_cnew(&w->kcontrols[i], w,
398 path->long_name);
399 ret = snd_ctl_add(codec->card, path->kcontrol);
400 if (ret < 0) {
6553e192
MB
401 printk(KERN_ERR "asoc: failed to add dapm kcontrol %s: %d\n",
402 path->long_name,
403 ret);
2b97eabc
RP
404 kfree(path->long_name);
405 path->long_name = NULL;
406 return ret;
407 }
408 }
409 }
410 return ret;
411}
412
413/* create new dapm mux control */
414static int dapm_new_mux(struct snd_soc_codec *codec,
415 struct snd_soc_dapm_widget *w)
416{
417 struct snd_soc_dapm_path *path = NULL;
418 struct snd_kcontrol *kcontrol;
419 int ret = 0;
420
421 if (!w->num_kcontrols) {
422 printk(KERN_ERR "asoc: mux %s has no controls\n", w->name);
423 return -EINVAL;
424 }
425
426 kcontrol = snd_soc_cnew(&w->kcontrols[0], w, w->name);
427 ret = snd_ctl_add(codec->card, kcontrol);
428 if (ret < 0)
429 goto err;
430
431 list_for_each_entry(path, &w->sources, list_sink)
432 path->kcontrol = kcontrol;
433
434 return ret;
435
436err:
437 printk(KERN_ERR "asoc: failed to add kcontrol %s\n", w->name);
438 return ret;
439}
440
441/* create new dapm volume control */
442static int dapm_new_pga(struct snd_soc_codec *codec,
443 struct snd_soc_dapm_widget *w)
444{
445 struct snd_kcontrol *kcontrol;
446 int ret = 0;
447
448 if (!w->num_kcontrols)
449 return -EINVAL;
450
451 kcontrol = snd_soc_cnew(&w->kcontrols[0], w, w->name);
452 ret = snd_ctl_add(codec->card, kcontrol);
453 if (ret < 0) {
454 printk(KERN_ERR "asoc: failed to add kcontrol %s\n", w->name);
455 return ret;
456 }
457
458 return ret;
459}
460
461/* reset 'walked' bit for each dapm path */
462static inline void dapm_clear_walk(struct snd_soc_codec *codec)
463{
464 struct snd_soc_dapm_path *p;
465
466 list_for_each_entry(p, &codec->dapm_paths, list)
467 p->walked = 0;
468}
469
470/*
471 * Recursively check for a completed path to an active or physically connected
472 * output widget. Returns number of complete paths.
473 */
474static int is_connected_output_ep(struct snd_soc_dapm_widget *widget)
475{
476 struct snd_soc_dapm_path *path;
477 int con = 0;
478
246d0a17
MB
479 if (widget->id == snd_soc_dapm_supply)
480 return 0;
481
2b97eabc
RP
482 if (widget->id == snd_soc_dapm_adc && widget->active)
483 return 1;
484
485 if (widget->connected) {
486 /* connected pin ? */
487 if (widget->id == snd_soc_dapm_output && !widget->ext)
488 return 1;
489
490 /* connected jack or spk ? */
491 if (widget->id == snd_soc_dapm_hp || widget->id == snd_soc_dapm_spk ||
492 widget->id == snd_soc_dapm_line)
493 return 1;
494 }
495
496 list_for_each_entry(path, &widget->sinks, list_source) {
497 if (path->walked)
498 continue;
499
500 if (path->sink && path->connect) {
501 path->walked = 1;
502 con += is_connected_output_ep(path->sink);
503 }
504 }
505
506 return con;
507}
508
509/*
510 * Recursively check for a completed path to an active or physically connected
511 * input widget. Returns number of complete paths.
512 */
513static int is_connected_input_ep(struct snd_soc_dapm_widget *widget)
514{
515 struct snd_soc_dapm_path *path;
516 int con = 0;
517
246d0a17
MB
518 if (widget->id == snd_soc_dapm_supply)
519 return 0;
520
2b97eabc
RP
521 /* active stream ? */
522 if (widget->id == snd_soc_dapm_dac && widget->active)
523 return 1;
524
525 if (widget->connected) {
526 /* connected pin ? */
527 if (widget->id == snd_soc_dapm_input && !widget->ext)
528 return 1;
529
530 /* connected VMID/Bias for lower pops */
531 if (widget->id == snd_soc_dapm_vmid)
532 return 1;
533
534 /* connected jack ? */
535 if (widget->id == snd_soc_dapm_mic || widget->id == snd_soc_dapm_line)
536 return 1;
537 }
538
539 list_for_each_entry(path, &widget->sources, list_sink) {
540 if (path->walked)
541 continue;
542
543 if (path->source && path->connect) {
544 path->walked = 1;
545 con += is_connected_input_ep(path->source);
546 }
547 }
548
549 return con;
550}
551
e2be2ccf
JN
552/*
553 * Handler for generic register modifier widget.
554 */
555int dapm_reg_event(struct snd_soc_dapm_widget *w,
556 struct snd_kcontrol *kcontrol, int event)
557{
558 unsigned int val;
559
560 if (SND_SOC_DAPM_EVENT_ON(event))
561 val = w->on_val;
562 else
563 val = w->off_val;
564
565 snd_soc_update_bits(w->codec, -(w->reg + 1),
566 w->mask << w->shift, val << w->shift);
567
568 return 0;
569}
11589418 570EXPORT_SYMBOL_GPL(dapm_reg_event);
e2be2ccf 571
025756ec
MB
572/* Standard power change method, used to apply power changes to most
573 * widgets.
574 */
575static int dapm_generic_apply_power(struct snd_soc_dapm_widget *w)
576{
577 int ret;
578
579 /* call any power change event handlers */
580 if (w->event)
581 pr_debug("power %s event for %s flags %x\n",
582 w->power ? "on" : "off",
583 w->name, w->event_flags);
584
585 /* power up pre event */
586 if (w->power && w->event &&
587 (w->event_flags & SND_SOC_DAPM_PRE_PMU)) {
588 ret = w->event(w, NULL, SND_SOC_DAPM_PRE_PMU);
589 if (ret < 0)
590 return ret;
591 }
592
593 /* power down pre event */
594 if (!w->power && w->event &&
595 (w->event_flags & SND_SOC_DAPM_PRE_PMD)) {
596 ret = w->event(w, NULL, SND_SOC_DAPM_PRE_PMD);
597 if (ret < 0)
598 return ret;
599 }
600
601 /* Lower PGA volume to reduce pops */
602 if (w->id == snd_soc_dapm_pga && !w->power)
603 dapm_set_pga(w, w->power);
604
605 dapm_update_bits(w);
606
607 /* Raise PGA volume to reduce pops */
608 if (w->id == snd_soc_dapm_pga && w->power)
609 dapm_set_pga(w, w->power);
610
611 /* power up post event */
612 if (w->power && w->event &&
613 (w->event_flags & SND_SOC_DAPM_POST_PMU)) {
614 ret = w->event(w,
615 NULL, SND_SOC_DAPM_POST_PMU);
616 if (ret < 0)
617 return ret;
618 }
619
620 /* power down post event */
621 if (!w->power && w->event &&
622 (w->event_flags & SND_SOC_DAPM_POST_PMD)) {
623 ret = w->event(w, NULL, SND_SOC_DAPM_POST_PMD);
624 if (ret < 0)
625 return ret;
626 }
627
628 return 0;
629}
630
cd0f2d47
MB
631/* Generic check to see if a widget should be powered.
632 */
633static int dapm_generic_check_power(struct snd_soc_dapm_widget *w)
634{
635 int in, out;
636
637 in = is_connected_input_ep(w);
638 dapm_clear_walk(w->codec);
639 out = is_connected_output_ep(w);
640 dapm_clear_walk(w->codec);
641 return out != 0 && in != 0;
642}
643
6ea31b9f
MB
644/* Check to see if an ADC has power */
645static int dapm_adc_check_power(struct snd_soc_dapm_widget *w)
646{
647 int in;
648
649 if (w->active) {
650 in = is_connected_input_ep(w);
651 dapm_clear_walk(w->codec);
652 return in != 0;
653 } else {
654 return dapm_generic_check_power(w);
655 }
656}
657
658/* Check to see if a DAC has power */
659static int dapm_dac_check_power(struct snd_soc_dapm_widget *w)
660{
661 int out;
662
663 if (w->active) {
664 out = is_connected_output_ep(w);
665 dapm_clear_walk(w->codec);
666 return out != 0;
667 } else {
668 return dapm_generic_check_power(w);
669 }
670}
671
246d0a17
MB
672/* Check to see if a power supply is needed */
673static int dapm_supply_check_power(struct snd_soc_dapm_widget *w)
674{
675 struct snd_soc_dapm_path *path;
676 int power = 0;
677
678 /* Check if one of our outputs is connected */
679 list_for_each_entry(path, &w->sinks, list_source) {
680 if (path->sink && path->sink->power_check &&
681 path->sink->power_check(path->sink)) {
682 power = 1;
683 break;
684 }
685 }
686
687 dapm_clear_walk(w->codec);
688
689 return power;
690}
691
42aa3418
MB
692/*
693 * Scan a single DAPM widget for a complete audio path and update the
694 * power status appropriately.
695 */
696static int dapm_power_widget(struct snd_soc_codec *codec, int event,
697 struct snd_soc_dapm_widget *w)
698{
6d3ddc81 699 int ret;
42aa3418 700
6ea31b9f 701 switch (w->id) {
6ea31b9f 702 case snd_soc_dapm_pre:
42aa3418
MB
703 if (!w->event)
704 return 0;
705
706 if (event == SND_SOC_DAPM_STREAM_START) {
707 ret = w->event(w,
708 NULL, SND_SOC_DAPM_PRE_PMU);
709 if (ret < 0)
710 return ret;
711 } else if (event == SND_SOC_DAPM_STREAM_STOP) {
712 ret = w->event(w,
713 NULL, SND_SOC_DAPM_PRE_PMD);
714 if (ret < 0)
715 return ret;
716 }
717 return 0;
6ea31b9f
MB
718
719 case snd_soc_dapm_post:
42aa3418
MB
720 if (!w->event)
721 return 0;
722
723 if (event == SND_SOC_DAPM_STREAM_START) {
724 ret = w->event(w,
725 NULL, SND_SOC_DAPM_POST_PMU);
726 if (ret < 0)
727 return ret;
728 } else if (event == SND_SOC_DAPM_STREAM_STOP) {
729 ret = w->event(w,
730 NULL, SND_SOC_DAPM_POST_PMD);
731 if (ret < 0)
732 return ret;
733 }
734 return 0;
42aa3418 735
6ea31b9f 736 default:
6d3ddc81 737 return dapm_generic_apply_power(w);
6ea31b9f 738 }
42aa3418
MB
739}
740
2b97eabc
RP
741/*
742 * Scan each dapm widget for complete audio path.
743 * A complete path is a route that has valid endpoints i.e.:-
744 *
745 * o DAC to output pin.
746 * o Input Pin to ADC.
747 * o Input pin to Output pin (bypass, sidetone)
748 * o DAC to ADC (loopback).
749 */
d9c96cf3 750static int dapm_power_widgets(struct snd_soc_codec *codec, int event)
2b97eabc 751{
452c5eaa 752 struct snd_soc_device *socdev = codec->socdev;
2b97eabc 753 struct snd_soc_dapm_widget *w;
6d3ddc81
MB
754 int ret = 0;
755 int i, power;
452c5eaa 756 int sys_power = 0;
6d3ddc81
MB
757
758 INIT_LIST_HEAD(&codec->up_list);
759 INIT_LIST_HEAD(&codec->down_list);
760
761 /* Check which widgets we need to power and store them in
762 * lists indicating if they should be powered up or down.
763 */
764 list_for_each_entry(w, &codec->dapm_widgets, list) {
765 switch (w->id) {
766 case snd_soc_dapm_pre:
767 list_add_tail(&codec->down_list, &w->power_list);
768 break;
769 case snd_soc_dapm_post:
770 list_add_tail(&codec->up_list, &w->power_list);
771 break;
772
773 default:
774 if (!w->power_check)
775 continue;
776
777 power = w->power_check(w);
452c5eaa
MB
778 if (power)
779 sys_power = 1;
780
6d3ddc81
MB
781 if (w->power == power)
782 continue;
783
784 if (power)
785 list_add_tail(&w->power_list, &codec->up_list);
786 else
787 list_add_tail(&w->power_list,
788 &codec->down_list);
789
790 w->power = power;
791 break;
792 }
2b97eabc
RP
793 }
794
452c5eaa
MB
795 /* If we're changing to all on or all off then prepare */
796 if ((sys_power && codec->bias_level == SND_SOC_BIAS_STANDBY) ||
797 (!sys_power && codec->bias_level == SND_SOC_BIAS_ON)) {
798 ret = snd_soc_dapm_set_bias_level(socdev,
799 SND_SOC_BIAS_PREPARE);
800 if (ret != 0)
801 pr_err("Failed to prepare bias: %d\n", ret);
802 }
803
6d3ddc81
MB
804 /* Power down widgets first; try to avoid amplifying pops. */
805 for (i = 0; i < ARRAY_SIZE(dapm_down_seq); i++) {
806 list_for_each_entry(w, &codec->down_list, power_list) {
807 /* is widget in stream order */
808 if (w->id != dapm_down_seq[i])
809 continue;
810
811 ret = dapm_power_widget(codec, event, w);
812 if (ret != 0)
813 pr_err("Failed to power down %s: %d\n",
814 w->name, ret);
815 }
816 }
2b97eabc 817
6d3ddc81
MB
818 /* Now power up. */
819 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++) {
820 list_for_each_entry(w, &codec->up_list, power_list) {
2b97eabc 821 /* is widget in stream order */
6d3ddc81 822 if (w->id != dapm_up_seq[i])
2b97eabc
RP
823 continue;
824
42aa3418
MB
825 ret = dapm_power_widget(codec, event, w);
826 if (ret != 0)
6d3ddc81
MB
827 pr_err("Failed to power up %s: %d\n",
828 w->name, ret);
2b97eabc
RP
829 }
830 }
831
452c5eaa
MB
832 /* If we just powered the last thing off drop to standby bias */
833 if (codec->bias_level == SND_SOC_BIAS_PREPARE && !sys_power) {
834 ret = snd_soc_dapm_set_bias_level(socdev,
835 SND_SOC_BIAS_STANDBY);
836 if (ret != 0)
837 pr_err("Failed to apply standby bias: %d\n", ret);
838 }
839
840 /* If we just powered up then move to active bias */
841 if (codec->bias_level == SND_SOC_BIAS_PREPARE && sys_power) {
842 ret = snd_soc_dapm_set_bias_level(socdev,
843 SND_SOC_BIAS_ON);
844 if (ret != 0)
845 pr_err("Failed to apply active bias: %d\n", ret);
846 }
847
42aa3418 848 return 0;
2b97eabc
RP
849}
850
c1286b86 851#ifdef DEBUG
2b97eabc
RP
852static void dbg_dump_dapm(struct snd_soc_codec* codec, const char *action)
853{
854 struct snd_soc_dapm_widget *w;
855 struct snd_soc_dapm_path *p = NULL;
856 int in, out;
857
858 printk("DAPM %s %s\n", codec->name, action);
859
860 list_for_each_entry(w, &codec->dapm_widgets, list) {
861
862 /* only display widgets that effect routing */
863 switch (w->id) {
864 case snd_soc_dapm_pre:
865 case snd_soc_dapm_post:
866 case snd_soc_dapm_vmid:
867 continue;
868 case snd_soc_dapm_mux:
2e72f8e3 869 case snd_soc_dapm_value_mux:
2b97eabc
RP
870 case snd_soc_dapm_output:
871 case snd_soc_dapm_input:
872 case snd_soc_dapm_switch:
873 case snd_soc_dapm_hp:
874 case snd_soc_dapm_mic:
875 case snd_soc_dapm_spk:
876 case snd_soc_dapm_line:
877 case snd_soc_dapm_micbias:
878 case snd_soc_dapm_dac:
879 case snd_soc_dapm_adc:
880 case snd_soc_dapm_pga:
881 case snd_soc_dapm_mixer:
ca9c1aae 882 case snd_soc_dapm_mixer_named_ctl:
246d0a17 883 case snd_soc_dapm_supply:
2b97eabc
RP
884 if (w->name) {
885 in = is_connected_input_ep(w);
886 dapm_clear_walk(w->codec);
887 out = is_connected_output_ep(w);
888 dapm_clear_walk(w->codec);
889 printk("%s: %s in %d out %d\n", w->name,
890 w->power ? "On":"Off",in, out);
891
892 list_for_each_entry(p, &w->sources, list_sink) {
893 if (p->connect)
894 printk(" in %s %s\n", p->name ? p->name : "static",
895 p->source->name);
896 }
897 list_for_each_entry(p, &w->sinks, list_source) {
2b97eabc
RP
898 if (p->connect)
899 printk(" out %s %s\n", p->name ? p->name : "static",
900 p->sink->name);
901 }
902 }
903 break;
904 }
905 }
906}
907#endif
908
909/* test and update the power status of a mux widget */
d9c96cf3
AB
910static int dapm_mux_update_power(struct snd_soc_dapm_widget *widget,
911 struct snd_kcontrol *kcontrol, int mask,
cb01e2b9 912 int mux, int val, struct soc_enum *e)
2b97eabc
RP
913{
914 struct snd_soc_dapm_path *path;
915 int found = 0;
916
eff317d0
PU
917 if (widget->id != snd_soc_dapm_mux &&
918 widget->id != snd_soc_dapm_value_mux)
2b97eabc
RP
919 return -ENODEV;
920
921 if (!snd_soc_test_bits(widget->codec, e->reg, mask, val))
922 return 0;
923
924 /* find dapm widget path assoc with kcontrol */
925 list_for_each_entry(path, &widget->codec->dapm_paths, list) {
926 if (path->kcontrol != kcontrol)
927 continue;
928
cb01e2b9 929 if (!path->name || !e->texts[mux])
2b97eabc
RP
930 continue;
931
932 found = 1;
933 /* we now need to match the string in the enum to the path */
cb01e2b9 934 if (!(strcmp(path->name, e->texts[mux])))
2b97eabc
RP
935 path->connect = 1; /* new connection */
936 else
937 path->connect = 0; /* old connection must be powered down */
938 }
939
3fccd8b1 940 if (found) {
2b97eabc 941 dapm_power_widgets(widget->codec, SND_SOC_DAPM_STREAM_NOP);
3fccd8b1
MB
942 dump_dapm(widget->codec, "mux power update");
943 }
2b97eabc
RP
944
945 return 0;
946}
2b97eabc 947
1b075e3f 948/* test and update the power status of a mixer or switch widget */
d9c96cf3
AB
949static int dapm_mixer_update_power(struct snd_soc_dapm_widget *widget,
950 struct snd_kcontrol *kcontrol, int reg,
951 int val_mask, int val, int invert)
2b97eabc
RP
952{
953 struct snd_soc_dapm_path *path;
954 int found = 0;
955
1b075e3f 956 if (widget->id != snd_soc_dapm_mixer &&
ca9c1aae 957 widget->id != snd_soc_dapm_mixer_named_ctl &&
1b075e3f 958 widget->id != snd_soc_dapm_switch)
2b97eabc
RP
959 return -ENODEV;
960
961 if (!snd_soc_test_bits(widget->codec, reg, val_mask, val))
962 return 0;
963
964 /* find dapm widget path assoc with kcontrol */
965 list_for_each_entry(path, &widget->codec->dapm_paths, list) {
966 if (path->kcontrol != kcontrol)
967 continue;
968
969 /* found, now check type */
970 found = 1;
971 if (val)
972 /* new connection */
973 path->connect = invert ? 0:1;
974 else
975 /* old connection must be powered down */
976 path->connect = invert ? 1:0;
977 break;
978 }
979
3fccd8b1 980 if (found) {
2b97eabc 981 dapm_power_widgets(widget->codec, SND_SOC_DAPM_STREAM_NOP);
3fccd8b1
MB
982 dump_dapm(widget->codec, "mixer power update");
983 }
2b97eabc
RP
984
985 return 0;
986}
2b97eabc
RP
987
988/* show dapm widget status in sys fs */
989static ssize_t dapm_widget_show(struct device *dev,
990 struct device_attribute *attr, char *buf)
991{
992 struct snd_soc_device *devdata = dev_get_drvdata(dev);
6627a653 993 struct snd_soc_codec *codec = devdata->card->codec;
2b97eabc
RP
994 struct snd_soc_dapm_widget *w;
995 int count = 0;
996 char *state = "not set";
997
998 list_for_each_entry(w, &codec->dapm_widgets, list) {
999
1000 /* only display widgets that burnm power */
1001 switch (w->id) {
1002 case snd_soc_dapm_hp:
1003 case snd_soc_dapm_mic:
1004 case snd_soc_dapm_spk:
1005 case snd_soc_dapm_line:
1006 case snd_soc_dapm_micbias:
1007 case snd_soc_dapm_dac:
1008 case snd_soc_dapm_adc:
1009 case snd_soc_dapm_pga:
1010 case snd_soc_dapm_mixer:
ca9c1aae 1011 case snd_soc_dapm_mixer_named_ctl:
246d0a17 1012 case snd_soc_dapm_supply:
2b97eabc
RP
1013 if (w->name)
1014 count += sprintf(buf + count, "%s: %s\n",
1015 w->name, w->power ? "On":"Off");
1016 break;
1017 default:
1018 break;
1019 }
1020 }
1021
0be9898a
MB
1022 switch (codec->bias_level) {
1023 case SND_SOC_BIAS_ON:
1024 state = "On";
2b97eabc 1025 break;
0be9898a
MB
1026 case SND_SOC_BIAS_PREPARE:
1027 state = "Prepare";
2b97eabc 1028 break;
0be9898a
MB
1029 case SND_SOC_BIAS_STANDBY:
1030 state = "Standby";
2b97eabc 1031 break;
0be9898a
MB
1032 case SND_SOC_BIAS_OFF:
1033 state = "Off";
2b97eabc
RP
1034 break;
1035 }
1036 count += sprintf(buf + count, "PM State: %s\n", state);
1037
1038 return count;
1039}
1040
1041static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL);
1042
1043int snd_soc_dapm_sys_add(struct device *dev)
1044{
12ef193d 1045 return device_create_file(dev, &dev_attr_dapm_widget);
2b97eabc
RP
1046}
1047
1048static void snd_soc_dapm_sys_remove(struct device *dev)
1049{
aef90843 1050 device_remove_file(dev, &dev_attr_dapm_widget);
2b97eabc
RP
1051}
1052
1053/* free all dapm widgets and resources */
d9c96cf3 1054static void dapm_free_widgets(struct snd_soc_codec *codec)
2b97eabc
RP
1055{
1056 struct snd_soc_dapm_widget *w, *next_w;
1057 struct snd_soc_dapm_path *p, *next_p;
1058
1059 list_for_each_entry_safe(w, next_w, &codec->dapm_widgets, list) {
1060 list_del(&w->list);
1061 kfree(w);
1062 }
1063
1064 list_for_each_entry_safe(p, next_p, &codec->dapm_paths, list) {
1065 list_del(&p->list);
1066 kfree(p->long_name);
1067 kfree(p);
1068 }
1069}
1070
a5302181 1071static int snd_soc_dapm_set_pin(struct snd_soc_codec *codec,
1649923d 1072 const char *pin, int status)
a5302181
LG
1073{
1074 struct snd_soc_dapm_widget *w;
1075
1076 list_for_each_entry(w, &codec->dapm_widgets, list) {
1077 if (!strcmp(w->name, pin)) {
c1286b86 1078 pr_debug("dapm: %s: pin %s\n", codec->name, pin);
a5302181
LG
1079 w->connected = status;
1080 return 0;
1081 }
1082 }
1083
c1286b86 1084 pr_err("dapm: %s: configuring unknown pin %s\n", codec->name, pin);
a5302181
LG
1085 return -EINVAL;
1086}
1087
2b97eabc 1088/**
a5302181 1089 * snd_soc_dapm_sync - scan and power dapm paths
2b97eabc
RP
1090 * @codec: audio codec
1091 *
1092 * Walks all dapm audio paths and powers widgets according to their
1093 * stream or path usage.
1094 *
1095 * Returns 0 for success.
1096 */
a5302181 1097int snd_soc_dapm_sync(struct snd_soc_codec *codec)
2b97eabc 1098{
3fccd8b1
MB
1099 int ret = dapm_power_widgets(codec, SND_SOC_DAPM_STREAM_NOP);
1100 dump_dapm(codec, "sync");
1101 return ret;
2b97eabc 1102}
a5302181 1103EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
2b97eabc 1104
105f1c28
MB
1105static int snd_soc_dapm_add_route(struct snd_soc_codec *codec,
1106 const char *sink, const char *control, const char *source)
2b97eabc
RP
1107{
1108 struct snd_soc_dapm_path *path;
1109 struct snd_soc_dapm_widget *wsource = NULL, *wsink = NULL, *w;
1110 int ret = 0;
1111
1112 /* find src and dest widgets */
1113 list_for_each_entry(w, &codec->dapm_widgets, list) {
1114
1115 if (!wsink && !(strcmp(w->name, sink))) {
1116 wsink = w;
1117 continue;
1118 }
1119 if (!wsource && !(strcmp(w->name, source))) {
1120 wsource = w;
1121 }
1122 }
1123
1124 if (wsource == NULL || wsink == NULL)
1125 return -ENODEV;
1126
1127 path = kzalloc(sizeof(struct snd_soc_dapm_path), GFP_KERNEL);
1128 if (!path)
1129 return -ENOMEM;
1130
1131 path->source = wsource;
1132 path->sink = wsink;
1133 INIT_LIST_HEAD(&path->list);
1134 INIT_LIST_HEAD(&path->list_source);
1135 INIT_LIST_HEAD(&path->list_sink);
1136
1137 /* check for external widgets */
1138 if (wsink->id == snd_soc_dapm_input) {
1139 if (wsource->id == snd_soc_dapm_micbias ||
1140 wsource->id == snd_soc_dapm_mic ||
1e39221e
SF
1141 wsink->id == snd_soc_dapm_line ||
1142 wsink->id == snd_soc_dapm_output)
2b97eabc
RP
1143 wsink->ext = 1;
1144 }
1145 if (wsource->id == snd_soc_dapm_output) {
1146 if (wsink->id == snd_soc_dapm_spk ||
1147 wsink->id == snd_soc_dapm_hp ||
1e39221e
SF
1148 wsink->id == snd_soc_dapm_line ||
1149 wsink->id == snd_soc_dapm_input)
2b97eabc
RP
1150 wsource->ext = 1;
1151 }
1152
1153 /* connect static paths */
1154 if (control == NULL) {
1155 list_add(&path->list, &codec->dapm_paths);
1156 list_add(&path->list_sink, &wsink->sources);
1157 list_add(&path->list_source, &wsource->sinks);
1158 path->connect = 1;
1159 return 0;
1160 }
1161
1162 /* connect dynamic paths */
1163 switch(wsink->id) {
1164 case snd_soc_dapm_adc:
1165 case snd_soc_dapm_dac:
1166 case snd_soc_dapm_pga:
1167 case snd_soc_dapm_input:
1168 case snd_soc_dapm_output:
1169 case snd_soc_dapm_micbias:
1170 case snd_soc_dapm_vmid:
1171 case snd_soc_dapm_pre:
1172 case snd_soc_dapm_post:
246d0a17 1173 case snd_soc_dapm_supply:
2b97eabc
RP
1174 list_add(&path->list, &codec->dapm_paths);
1175 list_add(&path->list_sink, &wsink->sources);
1176 list_add(&path->list_source, &wsource->sinks);
1177 path->connect = 1;
1178 return 0;
1179 case snd_soc_dapm_mux:
74155556 1180 case snd_soc_dapm_value_mux:
2b97eabc
RP
1181 ret = dapm_connect_mux(codec, wsource, wsink, path, control,
1182 &wsink->kcontrols[0]);
1183 if (ret != 0)
1184 goto err;
1185 break;
1186 case snd_soc_dapm_switch:
1187 case snd_soc_dapm_mixer:
ca9c1aae 1188 case snd_soc_dapm_mixer_named_ctl:
2b97eabc
RP
1189 ret = dapm_connect_mixer(codec, wsource, wsink, path, control);
1190 if (ret != 0)
1191 goto err;
1192 break;
1193 case snd_soc_dapm_hp:
1194 case snd_soc_dapm_mic:
1195 case snd_soc_dapm_line:
1196 case snd_soc_dapm_spk:
1197 list_add(&path->list, &codec->dapm_paths);
1198 list_add(&path->list_sink, &wsink->sources);
1199 list_add(&path->list_source, &wsource->sinks);
1200 path->connect = 0;
1201 return 0;
1202 }
1203 return 0;
1204
1205err:
1206 printk(KERN_WARNING "asoc: no dapm match for %s --> %s --> %s\n", source,
1207 control, sink);
1208 kfree(path);
1209 return ret;
1210}
105f1c28 1211
105f1c28
MB
1212/**
1213 * snd_soc_dapm_add_routes - Add routes between DAPM widgets
1214 * @codec: codec
1215 * @route: audio routes
1216 * @num: number of routes
1217 *
1218 * Connects 2 dapm widgets together via a named audio path. The sink is
1219 * the widget receiving the audio signal, whilst the source is the sender
1220 * of the audio signal.
1221 *
1222 * Returns 0 for success else error. On error all resources can be freed
1223 * with a call to snd_soc_card_free().
1224 */
1225int snd_soc_dapm_add_routes(struct snd_soc_codec *codec,
1226 const struct snd_soc_dapm_route *route, int num)
1227{
1228 int i, ret;
1229
1230 for (i = 0; i < num; i++) {
1231 ret = snd_soc_dapm_add_route(codec, route->sink,
1232 route->control, route->source);
1233 if (ret < 0) {
1234 printk(KERN_ERR "Failed to add route %s->%s\n",
1235 route->source,
1236 route->sink);
1237 return ret;
1238 }
1239 route++;
1240 }
1241
1242 return 0;
1243}
1244EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);
1245
2b97eabc
RP
1246/**
1247 * snd_soc_dapm_new_widgets - add new dapm widgets
1248 * @codec: audio codec
1249 *
1250 * Checks the codec for any new dapm widgets and creates them if found.
1251 *
1252 * Returns 0 for success.
1253 */
1254int snd_soc_dapm_new_widgets(struct snd_soc_codec *codec)
1255{
1256 struct snd_soc_dapm_widget *w;
1257
2b97eabc
RP
1258 list_for_each_entry(w, &codec->dapm_widgets, list)
1259 {
1260 if (w->new)
1261 continue;
1262
1263 switch(w->id) {
1264 case snd_soc_dapm_switch:
1265 case snd_soc_dapm_mixer:
ca9c1aae 1266 case snd_soc_dapm_mixer_named_ctl:
b75576d7 1267 w->power_check = dapm_generic_check_power;
2b97eabc
RP
1268 dapm_new_mixer(codec, w);
1269 break;
1270 case snd_soc_dapm_mux:
2e72f8e3 1271 case snd_soc_dapm_value_mux:
b75576d7 1272 w->power_check = dapm_generic_check_power;
2b97eabc
RP
1273 dapm_new_mux(codec, w);
1274 break;
1275 case snd_soc_dapm_adc:
b75576d7
MB
1276 w->power_check = dapm_adc_check_power;
1277 break;
2b97eabc 1278 case snd_soc_dapm_dac:
b75576d7
MB
1279 w->power_check = dapm_dac_check_power;
1280 break;
2b97eabc 1281 case snd_soc_dapm_pga:
b75576d7 1282 w->power_check = dapm_generic_check_power;
2b97eabc
RP
1283 dapm_new_pga(codec, w);
1284 break;
1285 case snd_soc_dapm_input:
1286 case snd_soc_dapm_output:
1287 case snd_soc_dapm_micbias:
1288 case snd_soc_dapm_spk:
1289 case snd_soc_dapm_hp:
1290 case snd_soc_dapm_mic:
1291 case snd_soc_dapm_line:
b75576d7
MB
1292 w->power_check = dapm_generic_check_power;
1293 break;
246d0a17
MB
1294 case snd_soc_dapm_supply:
1295 w->power_check = dapm_supply_check_power;
2b97eabc
RP
1296 case snd_soc_dapm_vmid:
1297 case snd_soc_dapm_pre:
1298 case snd_soc_dapm_post:
1299 break;
1300 }
1301 w->new = 1;
1302 }
1303
1304 dapm_power_widgets(codec, SND_SOC_DAPM_STREAM_NOP);
2b97eabc
RP
1305 return 0;
1306}
1307EXPORT_SYMBOL_GPL(snd_soc_dapm_new_widgets);
1308
1309/**
1310 * snd_soc_dapm_get_volsw - dapm mixer get callback
1311 * @kcontrol: mixer control
ac11a2b3 1312 * @ucontrol: control element information
2b97eabc
RP
1313 *
1314 * Callback to get the value of a dapm mixer control.
1315 *
1316 * Returns 0 for success.
1317 */
1318int snd_soc_dapm_get_volsw(struct snd_kcontrol *kcontrol,
1319 struct snd_ctl_elem_value *ucontrol)
1320{
1321 struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
4eaa9819
JS
1322 struct soc_mixer_control *mc =
1323 (struct soc_mixer_control *)kcontrol->private_value;
815ecf8d
JS
1324 unsigned int reg = mc->reg;
1325 unsigned int shift = mc->shift;
1326 unsigned int rshift = mc->rshift;
4eaa9819 1327 int max = mc->max;
815ecf8d
JS
1328 unsigned int invert = mc->invert;
1329 unsigned int mask = (1 << fls(max)) - 1;
2b97eabc
RP
1330
1331 /* return the saved value if we are powered down */
1332 if (widget->id == snd_soc_dapm_pga && !widget->power) {
1333 ucontrol->value.integer.value[0] = widget->saved_value;
1334 return 0;
1335 }
1336
1337 ucontrol->value.integer.value[0] =
1338 (snd_soc_read(widget->codec, reg) >> shift) & mask;
1339 if (shift != rshift)
1340 ucontrol->value.integer.value[1] =
1341 (snd_soc_read(widget->codec, reg) >> rshift) & mask;
1342 if (invert) {
1343 ucontrol->value.integer.value[0] =
a7a4ac86 1344 max - ucontrol->value.integer.value[0];
2b97eabc
RP
1345 if (shift != rshift)
1346 ucontrol->value.integer.value[1] =
a7a4ac86 1347 max - ucontrol->value.integer.value[1];
2b97eabc
RP
1348 }
1349
1350 return 0;
1351}
1352EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);
1353
1354/**
1355 * snd_soc_dapm_put_volsw - dapm mixer set callback
1356 * @kcontrol: mixer control
ac11a2b3 1357 * @ucontrol: control element information
2b97eabc
RP
1358 *
1359 * Callback to set the value of a dapm mixer control.
1360 *
1361 * Returns 0 for success.
1362 */
1363int snd_soc_dapm_put_volsw(struct snd_kcontrol *kcontrol,
1364 struct snd_ctl_elem_value *ucontrol)
1365{
1366 struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
4eaa9819
JS
1367 struct soc_mixer_control *mc =
1368 (struct soc_mixer_control *)kcontrol->private_value;
815ecf8d
JS
1369 unsigned int reg = mc->reg;
1370 unsigned int shift = mc->shift;
1371 unsigned int rshift = mc->rshift;
4eaa9819 1372 int max = mc->max;
815ecf8d
JS
1373 unsigned int mask = (1 << fls(max)) - 1;
1374 unsigned int invert = mc->invert;
2b97eabc
RP
1375 unsigned short val, val2, val_mask;
1376 int ret;
1377
1378 val = (ucontrol->value.integer.value[0] & mask);
1379
1380 if (invert)
a7a4ac86 1381 val = max - val;
2b97eabc
RP
1382 val_mask = mask << shift;
1383 val = val << shift;
1384 if (shift != rshift) {
1385 val2 = (ucontrol->value.integer.value[1] & mask);
1386 if (invert)
a7a4ac86 1387 val2 = max - val2;
2b97eabc
RP
1388 val_mask |= mask << rshift;
1389 val |= val2 << rshift;
1390 }
1391
1392 mutex_lock(&widget->codec->mutex);
1393 widget->value = val;
1394
1395 /* save volume value if the widget is powered down */
1396 if (widget->id == snd_soc_dapm_pga && !widget->power) {
1397 widget->saved_value = val;
1398 mutex_unlock(&widget->codec->mutex);
1399 return 1;
1400 }
1401
1402 dapm_mixer_update_power(widget, kcontrol, reg, val_mask, val, invert);
1403 if (widget->event) {
1404 if (widget->event_flags & SND_SOC_DAPM_PRE_REG) {
9af6d956
LG
1405 ret = widget->event(widget, kcontrol,
1406 SND_SOC_DAPM_PRE_REG);
1407 if (ret < 0) {
1408 ret = 1;
2b97eabc 1409 goto out;
9af6d956 1410 }
2b97eabc
RP
1411 }
1412 ret = snd_soc_update_bits(widget->codec, reg, val_mask, val);
1413 if (widget->event_flags & SND_SOC_DAPM_POST_REG)
9af6d956
LG
1414 ret = widget->event(widget, kcontrol,
1415 SND_SOC_DAPM_POST_REG);
2b97eabc
RP
1416 } else
1417 ret = snd_soc_update_bits(widget->codec, reg, val_mask, val);
1418
1419out:
1420 mutex_unlock(&widget->codec->mutex);
1421 return ret;
1422}
1423EXPORT_SYMBOL_GPL(snd_soc_dapm_put_volsw);
1424
1425/**
1426 * snd_soc_dapm_get_enum_double - dapm enumerated double mixer get callback
1427 * @kcontrol: mixer control
ac11a2b3 1428 * @ucontrol: control element information
2b97eabc
RP
1429 *
1430 * Callback to get the value of a dapm enumerated double mixer control.
1431 *
1432 * Returns 0 for success.
1433 */
1434int snd_soc_dapm_get_enum_double(struct snd_kcontrol *kcontrol,
1435 struct snd_ctl_elem_value *ucontrol)
1436{
1437 struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1438 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1439 unsigned short val, bitmask;
1440
f8ba0b7b 1441 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2b97eabc
RP
1442 ;
1443 val = snd_soc_read(widget->codec, e->reg);
1444 ucontrol->value.enumerated.item[0] = (val >> e->shift_l) & (bitmask - 1);
1445 if (e->shift_l != e->shift_r)
1446 ucontrol->value.enumerated.item[1] =
1447 (val >> e->shift_r) & (bitmask - 1);
1448
1449 return 0;
1450}
1451EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);
1452
1453/**
1454 * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
1455 * @kcontrol: mixer control
ac11a2b3 1456 * @ucontrol: control element information
2b97eabc
RP
1457 *
1458 * Callback to set the value of a dapm enumerated double mixer control.
1459 *
1460 * Returns 0 for success.
1461 */
1462int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
1463 struct snd_ctl_elem_value *ucontrol)
1464{
1465 struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1466 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1467 unsigned short val, mux;
1468 unsigned short mask, bitmask;
1469 int ret = 0;
1470
f8ba0b7b 1471 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2b97eabc 1472 ;
f8ba0b7b 1473 if (ucontrol->value.enumerated.item[0] > e->max - 1)
2b97eabc
RP
1474 return -EINVAL;
1475 mux = ucontrol->value.enumerated.item[0];
1476 val = mux << e->shift_l;
1477 mask = (bitmask - 1) << e->shift_l;
1478 if (e->shift_l != e->shift_r) {
f8ba0b7b 1479 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2b97eabc
RP
1480 return -EINVAL;
1481 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
1482 mask |= (bitmask - 1) << e->shift_r;
1483 }
1484
1485 mutex_lock(&widget->codec->mutex);
1486 widget->value = val;
cb01e2b9 1487 dapm_mux_update_power(widget, kcontrol, mask, mux, val, e);
2b97eabc
RP
1488 if (widget->event) {
1489 if (widget->event_flags & SND_SOC_DAPM_PRE_REG) {
9af6d956
LG
1490 ret = widget->event(widget,
1491 kcontrol, SND_SOC_DAPM_PRE_REG);
2b97eabc
RP
1492 if (ret < 0)
1493 goto out;
1494 }
1495 ret = snd_soc_update_bits(widget->codec, e->reg, mask, val);
1496 if (widget->event_flags & SND_SOC_DAPM_POST_REG)
9af6d956
LG
1497 ret = widget->event(widget,
1498 kcontrol, SND_SOC_DAPM_POST_REG);
2b97eabc
RP
1499 } else
1500 ret = snd_soc_update_bits(widget->codec, e->reg, mask, val);
1501
1502out:
1503 mutex_unlock(&widget->codec->mutex);
1504 return ret;
1505}
1506EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);
1507
2e72f8e3
PU
1508/**
1509 * snd_soc_dapm_get_value_enum_double - dapm semi enumerated double mixer get
1510 * callback
1511 * @kcontrol: mixer control
1512 * @ucontrol: control element information
1513 *
1514 * Callback to get the value of a dapm semi enumerated double mixer control.
1515 *
1516 * Semi enumerated mixer: the enumerated items are referred as values. Can be
1517 * used for handling bitfield coded enumeration for example.
1518 *
1519 * Returns 0 for success.
1520 */
1521int snd_soc_dapm_get_value_enum_double(struct snd_kcontrol *kcontrol,
1522 struct snd_ctl_elem_value *ucontrol)
1523{
1524 struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
74155556 1525 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2e72f8e3
PU
1526 unsigned short reg_val, val, mux;
1527
1528 reg_val = snd_soc_read(widget->codec, e->reg);
1529 val = (reg_val >> e->shift_l) & e->mask;
1530 for (mux = 0; mux < e->max; mux++) {
1531 if (val == e->values[mux])
1532 break;
1533 }
1534 ucontrol->value.enumerated.item[0] = mux;
1535 if (e->shift_l != e->shift_r) {
1536 val = (reg_val >> e->shift_r) & e->mask;
1537 for (mux = 0; mux < e->max; mux++) {
1538 if (val == e->values[mux])
1539 break;
1540 }
1541 ucontrol->value.enumerated.item[1] = mux;
1542 }
1543
1544 return 0;
1545}
1546EXPORT_SYMBOL_GPL(snd_soc_dapm_get_value_enum_double);
1547
1548/**
1549 * snd_soc_dapm_put_value_enum_double - dapm semi enumerated double mixer set
1550 * callback
1551 * @kcontrol: mixer control
1552 * @ucontrol: control element information
1553 *
1554 * Callback to set the value of a dapm semi enumerated double mixer control.
1555 *
1556 * Semi enumerated mixer: the enumerated items are referred as values. Can be
1557 * used for handling bitfield coded enumeration for example.
1558 *
1559 * Returns 0 for success.
1560 */
1561int snd_soc_dapm_put_value_enum_double(struct snd_kcontrol *kcontrol,
1562 struct snd_ctl_elem_value *ucontrol)
1563{
1564 struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
74155556 1565 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2e72f8e3
PU
1566 unsigned short val, mux;
1567 unsigned short mask;
1568 int ret = 0;
1569
1570 if (ucontrol->value.enumerated.item[0] > e->max - 1)
1571 return -EINVAL;
1572 mux = ucontrol->value.enumerated.item[0];
1573 val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
1574 mask = e->mask << e->shift_l;
1575 if (e->shift_l != e->shift_r) {
1576 if (ucontrol->value.enumerated.item[1] > e->max - 1)
1577 return -EINVAL;
1578 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
1579 mask |= e->mask << e->shift_r;
1580 }
1581
1582 mutex_lock(&widget->codec->mutex);
1583 widget->value = val;
74155556 1584 dapm_mux_update_power(widget, kcontrol, mask, mux, val, e);
2e72f8e3
PU
1585 if (widget->event) {
1586 if (widget->event_flags & SND_SOC_DAPM_PRE_REG) {
1587 ret = widget->event(widget,
1588 kcontrol, SND_SOC_DAPM_PRE_REG);
1589 if (ret < 0)
1590 goto out;
1591 }
1592 ret = snd_soc_update_bits(widget->codec, e->reg, mask, val);
1593 if (widget->event_flags & SND_SOC_DAPM_POST_REG)
1594 ret = widget->event(widget,
1595 kcontrol, SND_SOC_DAPM_POST_REG);
1596 } else
1597 ret = snd_soc_update_bits(widget->codec, e->reg, mask, val);
1598
1599out:
1600 mutex_unlock(&widget->codec->mutex);
1601 return ret;
1602}
1603EXPORT_SYMBOL_GPL(snd_soc_dapm_put_value_enum_double);
1604
8b37dbd2
MB
1605/**
1606 * snd_soc_dapm_info_pin_switch - Info for a pin switch
1607 *
1608 * @kcontrol: mixer control
1609 * @uinfo: control element information
1610 *
1611 * Callback to provide information about a pin switch control.
1612 */
1613int snd_soc_dapm_info_pin_switch(struct snd_kcontrol *kcontrol,
1614 struct snd_ctl_elem_info *uinfo)
1615{
1616 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
1617 uinfo->count = 1;
1618 uinfo->value.integer.min = 0;
1619 uinfo->value.integer.max = 1;
1620
1621 return 0;
1622}
1623EXPORT_SYMBOL_GPL(snd_soc_dapm_info_pin_switch);
1624
1625/**
1626 * snd_soc_dapm_get_pin_switch - Get information for a pin switch
1627 *
1628 * @kcontrol: mixer control
1629 * @ucontrol: Value
1630 */
1631int snd_soc_dapm_get_pin_switch(struct snd_kcontrol *kcontrol,
1632 struct snd_ctl_elem_value *ucontrol)
1633{
1634 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1635 const char *pin = (const char *)kcontrol->private_value;
1636
1637 mutex_lock(&codec->mutex);
1638
1639 ucontrol->value.integer.value[0] =
1640 snd_soc_dapm_get_pin_status(codec, pin);
1641
1642 mutex_unlock(&codec->mutex);
1643
1644 return 0;
1645}
1646EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_switch);
1647
1648/**
1649 * snd_soc_dapm_put_pin_switch - Set information for a pin switch
1650 *
1651 * @kcontrol: mixer control
1652 * @ucontrol: Value
1653 */
1654int snd_soc_dapm_put_pin_switch(struct snd_kcontrol *kcontrol,
1655 struct snd_ctl_elem_value *ucontrol)
1656{
1657 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1658 const char *pin = (const char *)kcontrol->private_value;
1659
1660 mutex_lock(&codec->mutex);
1661
1662 if (ucontrol->value.integer.value[0])
1663 snd_soc_dapm_enable_pin(codec, pin);
1664 else
1665 snd_soc_dapm_disable_pin(codec, pin);
1666
1667 snd_soc_dapm_sync(codec);
1668
1669 mutex_unlock(&codec->mutex);
1670
1671 return 0;
1672}
1673EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);
1674
2b97eabc
RP
1675/**
1676 * snd_soc_dapm_new_control - create new dapm control
1677 * @codec: audio codec
1678 * @widget: widget template
1679 *
1680 * Creates a new dapm control based upon the template.
1681 *
1682 * Returns 0 for success else error.
1683 */
1684int snd_soc_dapm_new_control(struct snd_soc_codec *codec,
1685 const struct snd_soc_dapm_widget *widget)
1686{
1687 struct snd_soc_dapm_widget *w;
1688
1689 if ((w = dapm_cnew_widget(widget)) == NULL)
1690 return -ENOMEM;
1691
1692 w->codec = codec;
1693 INIT_LIST_HEAD(&w->sources);
1694 INIT_LIST_HEAD(&w->sinks);
1695 INIT_LIST_HEAD(&w->list);
1696 list_add(&w->list, &codec->dapm_widgets);
1697
1698 /* machine layer set ups unconnected pins and insertions */
1699 w->connected = 1;
1700 return 0;
1701}
1702EXPORT_SYMBOL_GPL(snd_soc_dapm_new_control);
1703
4ba1327a
MB
1704/**
1705 * snd_soc_dapm_new_controls - create new dapm controls
1706 * @codec: audio codec
1707 * @widget: widget array
1708 * @num: number of widgets
1709 *
1710 * Creates new DAPM controls based upon the templates.
1711 *
1712 * Returns 0 for success else error.
1713 */
1714int snd_soc_dapm_new_controls(struct snd_soc_codec *codec,
1715 const struct snd_soc_dapm_widget *widget,
1716 int num)
1717{
1718 int i, ret;
1719
1720 for (i = 0; i < num; i++) {
1721 ret = snd_soc_dapm_new_control(codec, widget);
b8b33cb5
MB
1722 if (ret < 0) {
1723 printk(KERN_ERR
1724 "ASoC: Failed to create DAPM control %s: %d\n",
1725 widget->name, ret);
4ba1327a 1726 return ret;
b8b33cb5 1727 }
4ba1327a
MB
1728 widget++;
1729 }
1730 return 0;
1731}
1732EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);
1733
1734
2b97eabc
RP
1735/**
1736 * snd_soc_dapm_stream_event - send a stream event to the dapm core
1737 * @codec: audio codec
1738 * @stream: stream name
1739 * @event: stream event
1740 *
1741 * Sends a stream event to the dapm core. The core then makes any
1742 * necessary widget power changes.
1743 *
1744 * Returns 0 for success else error.
1745 */
1746int snd_soc_dapm_stream_event(struct snd_soc_codec *codec,
1747 char *stream, int event)
1748{
1749 struct snd_soc_dapm_widget *w;
1750
11da21a7
SF
1751 if (stream == NULL)
1752 return 0;
1753
2b97eabc
RP
1754 mutex_lock(&codec->mutex);
1755 list_for_each_entry(w, &codec->dapm_widgets, list)
1756 {
1757 if (!w->sname)
1758 continue;
c1286b86
MB
1759 pr_debug("widget %s\n %s stream %s event %d\n",
1760 w->name, w->sname, stream, event);
2b97eabc
RP
1761 if (strstr(w->sname, stream)) {
1762 switch(event) {
1763 case SND_SOC_DAPM_STREAM_START:
1764 w->active = 1;
1765 break;
1766 case SND_SOC_DAPM_STREAM_STOP:
1767 w->active = 0;
1768 break;
1769 case SND_SOC_DAPM_STREAM_SUSPEND:
1770 if (w->active)
1771 w->suspend = 1;
1772 w->active = 0;
1773 break;
1774 case SND_SOC_DAPM_STREAM_RESUME:
1775 if (w->suspend) {
1776 w->active = 1;
1777 w->suspend = 0;
1778 }
1779 break;
1780 case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
1781 break;
1782 case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
1783 break;
1784 }
1785 }
1786 }
1787 mutex_unlock(&codec->mutex);
1788
1789 dapm_power_widgets(codec, event);
9bf8e7dd 1790 dump_dapm(codec, __func__);
2b97eabc
RP
1791 return 0;
1792}
1793EXPORT_SYMBOL_GPL(snd_soc_dapm_stream_event);
1794
1795/**
a5302181 1796 * snd_soc_dapm_enable_pin - enable pin.
ac11a2b3 1797 * @codec: SoC codec
a5302181 1798 * @pin: pin name
2b97eabc 1799 *
74b8f955 1800 * Enables input/output pin and its parents or children widgets iff there is
a5302181
LG
1801 * a valid audio route and active audio stream.
1802 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
1803 * do any widget power switching.
2b97eabc 1804 */
1649923d 1805int snd_soc_dapm_enable_pin(struct snd_soc_codec *codec, const char *pin)
2b97eabc 1806{
a5302181
LG
1807 return snd_soc_dapm_set_pin(codec, pin, 1);
1808}
1809EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
2b97eabc 1810
a5302181
LG
1811/**
1812 * snd_soc_dapm_disable_pin - disable pin.
1813 * @codec: SoC codec
1814 * @pin: pin name
1815 *
74b8f955 1816 * Disables input/output pin and its parents or children widgets.
a5302181
LG
1817 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
1818 * do any widget power switching.
1819 */
1649923d 1820int snd_soc_dapm_disable_pin(struct snd_soc_codec *codec, const char *pin)
a5302181
LG
1821{
1822 return snd_soc_dapm_set_pin(codec, pin, 0);
2b97eabc 1823}
a5302181 1824EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
2b97eabc 1825
5817b52a
MB
1826/**
1827 * snd_soc_dapm_nc_pin - permanently disable pin.
1828 * @codec: SoC codec
1829 * @pin: pin name
1830 *
1831 * Marks the specified pin as being not connected, disabling it along
1832 * any parent or child widgets. At present this is identical to
1833 * snd_soc_dapm_disable_pin() but in future it will be extended to do
1834 * additional things such as disabling controls which only affect
1835 * paths through the pin.
1836 *
1837 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
1838 * do any widget power switching.
1839 */
1649923d 1840int snd_soc_dapm_nc_pin(struct snd_soc_codec *codec, const char *pin)
5817b52a
MB
1841{
1842 return snd_soc_dapm_set_pin(codec, pin, 0);
1843}
1844EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);
1845
eeec12bf 1846/**
a5302181 1847 * snd_soc_dapm_get_pin_status - get audio pin status
eeec12bf 1848 * @codec: audio codec
a5302181 1849 * @pin: audio signal pin endpoint (or start point)
eeec12bf 1850 *
a5302181 1851 * Get audio pin status - connected or disconnected.
eeec12bf 1852 *
a5302181 1853 * Returns 1 for connected otherwise 0.
eeec12bf 1854 */
1649923d 1855int snd_soc_dapm_get_pin_status(struct snd_soc_codec *codec, const char *pin)
eeec12bf
GG
1856{
1857 struct snd_soc_dapm_widget *w;
1858
1859 list_for_each_entry(w, &codec->dapm_widgets, list) {
a5302181 1860 if (!strcmp(w->name, pin))
eeec12bf
GG
1861 return w->connected;
1862 }
1863
1864 return 0;
1865}
a5302181 1866EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
eeec12bf 1867
2b97eabc
RP
1868/**
1869 * snd_soc_dapm_free - free dapm resources
1870 * @socdev: SoC device
1871 *
1872 * Free all dapm widgets and resources.
1873 */
1874void snd_soc_dapm_free(struct snd_soc_device *socdev)
1875{
6627a653 1876 struct snd_soc_codec *codec = socdev->card->codec;
2b97eabc
RP
1877
1878 snd_soc_dapm_sys_remove(socdev->dev);
1879 dapm_free_widgets(codec);
1880}
1881EXPORT_SYMBOL_GPL(snd_soc_dapm_free);
1882
1883/* Module information */
d331124d 1884MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
2b97eabc
RP
1885MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
1886MODULE_LICENSE("GPL");