xref: /openbmc/linux/sound/soc/soc-core.c (revision 07c84d0409f3551b79d676630d8ee76bb551598d)
1db2a4165SFrank Mandarino /*
2db2a4165SFrank Mandarino  * soc-core.c  --  ALSA SoC Audio Layer
3db2a4165SFrank Mandarino  *
4db2a4165SFrank Mandarino  * Copyright 2005 Wolfson Microelectronics PLC.
50664d888SLiam Girdwood  * Copyright 2005 Openedhand Ltd.
60664d888SLiam Girdwood  *
7d331124dSLiam Girdwood  * Author: Liam Girdwood <lrg@slimlogic.co.uk>
80664d888SLiam Girdwood  *         with code, comments and ideas from :-
90664d888SLiam Girdwood  *         Richard Purdie <richard@openedhand.com>
10db2a4165SFrank Mandarino  *
11db2a4165SFrank Mandarino  *  This program is free software; you can redistribute  it and/or modify it
12db2a4165SFrank Mandarino  *  under  the terms of  the GNU General  Public License as published by the
13db2a4165SFrank Mandarino  *  Free Software Foundation;  either version 2 of the  License, or (at your
14db2a4165SFrank Mandarino  *  option) any later version.
15db2a4165SFrank Mandarino  *
16db2a4165SFrank Mandarino  *  TODO:
17db2a4165SFrank Mandarino  *   o Add hw rules to enforce rates, etc.
18db2a4165SFrank Mandarino  *   o More testing with other codecs/machines.
19db2a4165SFrank Mandarino  *   o Add more codecs and platforms to ensure good API coverage.
20db2a4165SFrank Mandarino  *   o Support TDM on PCM and I2S
21db2a4165SFrank Mandarino  */
22db2a4165SFrank Mandarino 
23db2a4165SFrank Mandarino #include <linux/module.h>
24db2a4165SFrank Mandarino #include <linux/moduleparam.h>
25db2a4165SFrank Mandarino #include <linux/init.h>
26db2a4165SFrank Mandarino #include <linux/delay.h>
27db2a4165SFrank Mandarino #include <linux/pm.h>
28db2a4165SFrank Mandarino #include <linux/bitops.h>
2912ef193dSTroy Kisky #include <linux/debugfs.h>
30db2a4165SFrank Mandarino #include <linux/platform_device.h>
31db2a4165SFrank Mandarino #include <sound/core.h>
32db2a4165SFrank Mandarino #include <sound/pcm.h>
33db2a4165SFrank Mandarino #include <sound/pcm_params.h>
34db2a4165SFrank Mandarino #include <sound/soc.h>
35db2a4165SFrank Mandarino #include <sound/soc-dapm.h>
36db2a4165SFrank Mandarino #include <sound/initval.h>
37db2a4165SFrank Mandarino 
38db2a4165SFrank Mandarino static DEFINE_MUTEX(pcm_mutex);
39db2a4165SFrank Mandarino static DEFINE_MUTEX(io_mutex);
40db2a4165SFrank Mandarino static DECLARE_WAIT_QUEUE_HEAD(soc_pm_waitq);
41db2a4165SFrank Mandarino 
42384c89e2SMark Brown #ifdef CONFIG_DEBUG_FS
43384c89e2SMark Brown static struct dentry *debugfs_root;
44384c89e2SMark Brown #endif
45384c89e2SMark Brown 
46db2a4165SFrank Mandarino /*
47db2a4165SFrank Mandarino  * This is a timeout to do a DAPM powerdown after a stream is closed().
48db2a4165SFrank Mandarino  * It can be used to eliminate pops between different playback streams, e.g.
49db2a4165SFrank Mandarino  * between two audio tracks.
50db2a4165SFrank Mandarino  */
51db2a4165SFrank Mandarino static int pmdown_time = 5000;
52db2a4165SFrank Mandarino module_param(pmdown_time, int, 0);
53db2a4165SFrank Mandarino MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
54db2a4165SFrank Mandarino 
55965ac42cSLiam Girdwood /*
56965ac42cSLiam Girdwood  * This function forces any delayed work to be queued and run.
57965ac42cSLiam Girdwood  */
58965ac42cSLiam Girdwood static int run_delayed_work(struct delayed_work *dwork)
59965ac42cSLiam Girdwood {
60965ac42cSLiam Girdwood 	int ret;
61965ac42cSLiam Girdwood 
62965ac42cSLiam Girdwood 	/* cancel any work waiting to be queued. */
63965ac42cSLiam Girdwood 	ret = cancel_delayed_work(dwork);
64965ac42cSLiam Girdwood 
65965ac42cSLiam Girdwood 	/* if there was any work waiting then we run it now and
66965ac42cSLiam Girdwood 	 * wait for it's completion */
67965ac42cSLiam Girdwood 	if (ret) {
68965ac42cSLiam Girdwood 		schedule_delayed_work(dwork, 0);
69965ac42cSLiam Girdwood 		flush_scheduled_work();
70965ac42cSLiam Girdwood 	}
71965ac42cSLiam Girdwood 	return ret;
72965ac42cSLiam Girdwood }
73965ac42cSLiam Girdwood 
74db2a4165SFrank Mandarino #ifdef CONFIG_SND_SOC_AC97_BUS
75db2a4165SFrank Mandarino /* unregister ac97 codec */
76db2a4165SFrank Mandarino static int soc_ac97_dev_unregister(struct snd_soc_codec *codec)
77db2a4165SFrank Mandarino {
78db2a4165SFrank Mandarino 	if (codec->ac97->dev.bus)
79db2a4165SFrank Mandarino 		device_unregister(&codec->ac97->dev);
80db2a4165SFrank Mandarino 	return 0;
81db2a4165SFrank Mandarino }
82db2a4165SFrank Mandarino 
83db2a4165SFrank Mandarino /* stop no dev release warning */
84db2a4165SFrank Mandarino static void soc_ac97_device_release(struct device *dev){}
85db2a4165SFrank Mandarino 
86db2a4165SFrank Mandarino /* register ac97 codec to bus */
87db2a4165SFrank Mandarino static int soc_ac97_dev_register(struct snd_soc_codec *codec)
88db2a4165SFrank Mandarino {
89db2a4165SFrank Mandarino 	int err;
90db2a4165SFrank Mandarino 
91db2a4165SFrank Mandarino 	codec->ac97->dev.bus = &ac97_bus_type;
92db2a4165SFrank Mandarino 	codec->ac97->dev.parent = NULL;
93db2a4165SFrank Mandarino 	codec->ac97->dev.release = soc_ac97_device_release;
94db2a4165SFrank Mandarino 
95bb072bf0SKay Sievers 	dev_set_name(&codec->ac97->dev, "%d-%d:%s",
96db2a4165SFrank Mandarino 		     codec->card->number, 0, codec->name);
97db2a4165SFrank Mandarino 	err = device_register(&codec->ac97->dev);
98db2a4165SFrank Mandarino 	if (err < 0) {
99db2a4165SFrank Mandarino 		snd_printk(KERN_ERR "Can't register ac97 bus\n");
100db2a4165SFrank Mandarino 		codec->ac97->dev.bus = NULL;
101db2a4165SFrank Mandarino 		return err;
102db2a4165SFrank Mandarino 	}
103db2a4165SFrank Mandarino 	return 0;
104db2a4165SFrank Mandarino }
105db2a4165SFrank Mandarino #endif
106db2a4165SFrank Mandarino 
107db2a4165SFrank Mandarino /*
108db2a4165SFrank Mandarino  * Called by ALSA when a PCM substream is opened, the runtime->hw record is
109db2a4165SFrank Mandarino  * then initialized and any private data can be allocated. This also calls
110db2a4165SFrank Mandarino  * startup for the cpu DAI, platform, machine and codec DAI.
111db2a4165SFrank Mandarino  */
112db2a4165SFrank Mandarino static int soc_pcm_open(struct snd_pcm_substream *substream)
113db2a4165SFrank Mandarino {
114db2a4165SFrank Mandarino 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
115db2a4165SFrank Mandarino 	struct snd_soc_device *socdev = rtd->socdev;
11687689d56SMark Brown 	struct snd_soc_card *card = socdev->card;
117db2a4165SFrank Mandarino 	struct snd_pcm_runtime *runtime = substream->runtime;
118cb666e5bSLiam Girdwood 	struct snd_soc_dai_link *machine = rtd->dai;
11987689d56SMark Brown 	struct snd_soc_platform *platform = card->platform;
1203c4b266fSLiam Girdwood 	struct snd_soc_dai *cpu_dai = machine->cpu_dai;
1213c4b266fSLiam Girdwood 	struct snd_soc_dai *codec_dai = machine->codec_dai;
122db2a4165SFrank Mandarino 	int ret = 0;
123db2a4165SFrank Mandarino 
124db2a4165SFrank Mandarino 	mutex_lock(&pcm_mutex);
125db2a4165SFrank Mandarino 
126db2a4165SFrank Mandarino 	/* startup the audio subsystem */
127cb666e5bSLiam Girdwood 	if (cpu_dai->ops.startup) {
128dee89c4dSMark Brown 		ret = cpu_dai->ops.startup(substream, cpu_dai);
129db2a4165SFrank Mandarino 		if (ret < 0) {
130db2a4165SFrank Mandarino 			printk(KERN_ERR "asoc: can't open interface %s\n",
131cb666e5bSLiam Girdwood 				cpu_dai->name);
132db2a4165SFrank Mandarino 			goto out;
133db2a4165SFrank Mandarino 		}
134db2a4165SFrank Mandarino 	}
135db2a4165SFrank Mandarino 
136db2a4165SFrank Mandarino 	if (platform->pcm_ops->open) {
137db2a4165SFrank Mandarino 		ret = platform->pcm_ops->open(substream);
138db2a4165SFrank Mandarino 		if (ret < 0) {
139db2a4165SFrank Mandarino 			printk(KERN_ERR "asoc: can't open platform %s\n", platform->name);
140db2a4165SFrank Mandarino 			goto platform_err;
141db2a4165SFrank Mandarino 		}
142db2a4165SFrank Mandarino 	}
143db2a4165SFrank Mandarino 
144cb666e5bSLiam Girdwood 	if (codec_dai->ops.startup) {
145dee89c4dSMark Brown 		ret = codec_dai->ops.startup(substream, codec_dai);
146cb666e5bSLiam Girdwood 		if (ret < 0) {
147cb666e5bSLiam Girdwood 			printk(KERN_ERR "asoc: can't open codec %s\n",
148cb666e5bSLiam Girdwood 				codec_dai->name);
149cb666e5bSLiam Girdwood 			goto codec_dai_err;
150cb666e5bSLiam Girdwood 		}
151cb666e5bSLiam Girdwood 	}
152cb666e5bSLiam Girdwood 
153db2a4165SFrank Mandarino 	if (machine->ops && machine->ops->startup) {
154db2a4165SFrank Mandarino 		ret = machine->ops->startup(substream);
155db2a4165SFrank Mandarino 		if (ret < 0) {
156db2a4165SFrank Mandarino 			printk(KERN_ERR "asoc: %s startup failed\n", machine->name);
157db2a4165SFrank Mandarino 			goto machine_err;
158db2a4165SFrank Mandarino 		}
159db2a4165SFrank Mandarino 	}
160db2a4165SFrank Mandarino 
161db2a4165SFrank Mandarino 	/* Check that the codec and cpu DAI's are compatible */
162db2a4165SFrank Mandarino 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
163db2a4165SFrank Mandarino 		runtime->hw.rate_min =
1643ff3f64bSMark Brown 			max(codec_dai->playback.rate_min,
1653ff3f64bSMark Brown 			    cpu_dai->playback.rate_min);
166db2a4165SFrank Mandarino 		runtime->hw.rate_max =
1673ff3f64bSMark Brown 			min(codec_dai->playback.rate_max,
1683ff3f64bSMark Brown 			    cpu_dai->playback.rate_max);
169db2a4165SFrank Mandarino 		runtime->hw.channels_min =
170cb666e5bSLiam Girdwood 			max(codec_dai->playback.channels_min,
171cb666e5bSLiam Girdwood 				cpu_dai->playback.channels_min);
172db2a4165SFrank Mandarino 		runtime->hw.channels_max =
173cb666e5bSLiam Girdwood 			min(codec_dai->playback.channels_max,
174cb666e5bSLiam Girdwood 				cpu_dai->playback.channels_max);
175cb666e5bSLiam Girdwood 		runtime->hw.formats =
176cb666e5bSLiam Girdwood 			codec_dai->playback.formats & cpu_dai->playback.formats;
177cb666e5bSLiam Girdwood 		runtime->hw.rates =
178cb666e5bSLiam Girdwood 			codec_dai->playback.rates & cpu_dai->playback.rates;
179db2a4165SFrank Mandarino 	} else {
180db2a4165SFrank Mandarino 		runtime->hw.rate_min =
1813ff3f64bSMark Brown 			max(codec_dai->capture.rate_min,
1823ff3f64bSMark Brown 			    cpu_dai->capture.rate_min);
183db2a4165SFrank Mandarino 		runtime->hw.rate_max =
1843ff3f64bSMark Brown 			min(codec_dai->capture.rate_max,
1853ff3f64bSMark Brown 			    cpu_dai->capture.rate_max);
186db2a4165SFrank Mandarino 		runtime->hw.channels_min =
187cb666e5bSLiam Girdwood 			max(codec_dai->capture.channels_min,
188cb666e5bSLiam Girdwood 				cpu_dai->capture.channels_min);
189db2a4165SFrank Mandarino 		runtime->hw.channels_max =
190cb666e5bSLiam Girdwood 			min(codec_dai->capture.channels_max,
191cb666e5bSLiam Girdwood 				cpu_dai->capture.channels_max);
192cb666e5bSLiam Girdwood 		runtime->hw.formats =
193cb666e5bSLiam Girdwood 			codec_dai->capture.formats & cpu_dai->capture.formats;
194cb666e5bSLiam Girdwood 		runtime->hw.rates =
195cb666e5bSLiam Girdwood 			codec_dai->capture.rates & cpu_dai->capture.rates;
196db2a4165SFrank Mandarino 	}
197db2a4165SFrank Mandarino 
198db2a4165SFrank Mandarino 	snd_pcm_limit_hw_rates(runtime);
199db2a4165SFrank Mandarino 	if (!runtime->hw.rates) {
200db2a4165SFrank Mandarino 		printk(KERN_ERR "asoc: %s <-> %s No matching rates\n",
201cb666e5bSLiam Girdwood 			codec_dai->name, cpu_dai->name);
202cb666e5bSLiam Girdwood 		goto machine_err;
203db2a4165SFrank Mandarino 	}
204db2a4165SFrank Mandarino 	if (!runtime->hw.formats) {
205db2a4165SFrank Mandarino 		printk(KERN_ERR "asoc: %s <-> %s No matching formats\n",
206cb666e5bSLiam Girdwood 			codec_dai->name, cpu_dai->name);
207cb666e5bSLiam Girdwood 		goto machine_err;
208db2a4165SFrank Mandarino 	}
209db2a4165SFrank Mandarino 	if (!runtime->hw.channels_min || !runtime->hw.channels_max) {
210db2a4165SFrank Mandarino 		printk(KERN_ERR "asoc: %s <-> %s No matching channels\n",
211cb666e5bSLiam Girdwood 			codec_dai->name, cpu_dai->name);
212cb666e5bSLiam Girdwood 		goto machine_err;
213db2a4165SFrank Mandarino 	}
214db2a4165SFrank Mandarino 
215f24368c2SMark Brown 	pr_debug("asoc: %s <-> %s info:\n", codec_dai->name, cpu_dai->name);
216f24368c2SMark Brown 	pr_debug("asoc: rate mask 0x%x\n", runtime->hw.rates);
217f24368c2SMark Brown 	pr_debug("asoc: min ch %d max ch %d\n", runtime->hw.channels_min,
218b5c5fd24SLiam Girdwood 		 runtime->hw.channels_max);
219f24368c2SMark Brown 	pr_debug("asoc: min rate %d max rate %d\n", runtime->hw.rate_min,
220b5c5fd24SLiam Girdwood 		 runtime->hw.rate_max);
221db2a4165SFrank Mandarino 
222db2a4165SFrank Mandarino 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
223cb666e5bSLiam Girdwood 		cpu_dai->playback.active = codec_dai->playback.active = 1;
224db2a4165SFrank Mandarino 	else
225cb666e5bSLiam Girdwood 		cpu_dai->capture.active = codec_dai->capture.active = 1;
226cb666e5bSLiam Girdwood 	cpu_dai->active = codec_dai->active = 1;
227cb666e5bSLiam Girdwood 	cpu_dai->runtime = runtime;
228db2a4165SFrank Mandarino 	socdev->codec->active++;
229db2a4165SFrank Mandarino 	mutex_unlock(&pcm_mutex);
230db2a4165SFrank Mandarino 	return 0;
231db2a4165SFrank Mandarino 
232cb666e5bSLiam Girdwood machine_err:
233db2a4165SFrank Mandarino 	if (machine->ops && machine->ops->shutdown)
234db2a4165SFrank Mandarino 		machine->ops->shutdown(substream);
235db2a4165SFrank Mandarino 
236cb666e5bSLiam Girdwood codec_dai_err:
237db2a4165SFrank Mandarino 	if (platform->pcm_ops->close)
238db2a4165SFrank Mandarino 		platform->pcm_ops->close(substream);
239db2a4165SFrank Mandarino 
240db2a4165SFrank Mandarino platform_err:
241cb666e5bSLiam Girdwood 	if (cpu_dai->ops.shutdown)
242dee89c4dSMark Brown 		cpu_dai->ops.shutdown(substream, cpu_dai);
243db2a4165SFrank Mandarino out:
244db2a4165SFrank Mandarino 	mutex_unlock(&pcm_mutex);
245db2a4165SFrank Mandarino 	return ret;
246db2a4165SFrank Mandarino }
247db2a4165SFrank Mandarino 
248db2a4165SFrank Mandarino /*
2493a4fa0a2SRobert P. J. Day  * Power down the audio subsystem pmdown_time msecs after close is called.
250db2a4165SFrank Mandarino  * This is to ensure there are no pops or clicks in between any music tracks
251db2a4165SFrank Mandarino  * due to DAPM power cycling.
252db2a4165SFrank Mandarino  */
2534484bb2eSAndrew Morton static void close_delayed_work(struct work_struct *work)
254db2a4165SFrank Mandarino {
2556308419aSMark Brown 	struct snd_soc_card *card = container_of(work, struct snd_soc_card,
2566308419aSMark Brown 						 delayed_work.work);
2576308419aSMark Brown 	struct snd_soc_device *socdev = card->socdev;
258db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = socdev->codec;
2593c4b266fSLiam Girdwood 	struct snd_soc_dai *codec_dai;
260db2a4165SFrank Mandarino 	int i;
261db2a4165SFrank Mandarino 
262db2a4165SFrank Mandarino 	mutex_lock(&pcm_mutex);
263db2a4165SFrank Mandarino 	for (i = 0; i < codec->num_dai; i++) {
264db2a4165SFrank Mandarino 		codec_dai = &codec->dai[i];
265db2a4165SFrank Mandarino 
266f24368c2SMark Brown 		pr_debug("pop wq checking: %s status: %s waiting: %s\n",
267db2a4165SFrank Mandarino 			 codec_dai->playback.stream_name,
268db2a4165SFrank Mandarino 			 codec_dai->playback.active ? "active" : "inactive",
269db2a4165SFrank Mandarino 			 codec_dai->pop_wait ? "yes" : "no");
270db2a4165SFrank Mandarino 
271db2a4165SFrank Mandarino 		/* are we waiting on this codec DAI stream */
272db2a4165SFrank Mandarino 		if (codec_dai->pop_wait == 1) {
273db2a4165SFrank Mandarino 
2740be9898aSMark Brown 			/* Reduce power if no longer active */
2753c1c47e0SLiam Girdwood 			if (codec->active == 0) {
276f24368c2SMark Brown 				pr_debug("pop wq D1 %s %s\n", codec->name,
2773c1c47e0SLiam Girdwood 					 codec_dai->playback.stream_name);
2780be9898aSMark Brown 				snd_soc_dapm_set_bias_level(socdev,
2790be9898aSMark Brown 					SND_SOC_BIAS_PREPARE);
2803c1c47e0SLiam Girdwood 			}
2813c1c47e0SLiam Girdwood 
282db2a4165SFrank Mandarino 			codec_dai->pop_wait = 0;
2830b4d221bSLiam Girdwood 			snd_soc_dapm_stream_event(codec,
2840b4d221bSLiam Girdwood 				codec_dai->playback.stream_name,
285db2a4165SFrank Mandarino 				SND_SOC_DAPM_STREAM_STOP);
286db2a4165SFrank Mandarino 
2870be9898aSMark Brown 			/* Fall into standby if no longer active */
288db2a4165SFrank Mandarino 			if (codec->active == 0) {
289f24368c2SMark Brown 				pr_debug("pop wq D3 %s %s\n", codec->name,
290db2a4165SFrank Mandarino 					 codec_dai->playback.stream_name);
2910be9898aSMark Brown 				snd_soc_dapm_set_bias_level(socdev,
2920be9898aSMark Brown 					SND_SOC_BIAS_STANDBY);
293db2a4165SFrank Mandarino 			}
294db2a4165SFrank Mandarino 		}
295db2a4165SFrank Mandarino 	}
296db2a4165SFrank Mandarino 	mutex_unlock(&pcm_mutex);
297db2a4165SFrank Mandarino }
298db2a4165SFrank Mandarino 
299db2a4165SFrank Mandarino /*
300db2a4165SFrank Mandarino  * Called by ALSA when a PCM substream is closed. Private data can be
301db2a4165SFrank Mandarino  * freed here. The cpu DAI, codec DAI, machine and platform are also
302db2a4165SFrank Mandarino  * shutdown.
303db2a4165SFrank Mandarino  */
304db2a4165SFrank Mandarino static int soc_codec_close(struct snd_pcm_substream *substream)
305db2a4165SFrank Mandarino {
306db2a4165SFrank Mandarino 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
307db2a4165SFrank Mandarino 	struct snd_soc_device *socdev = rtd->socdev;
3086308419aSMark Brown 	struct snd_soc_card *card = socdev->card;
309cb666e5bSLiam Girdwood 	struct snd_soc_dai_link *machine = rtd->dai;
31087689d56SMark Brown 	struct snd_soc_platform *platform = card->platform;
3113c4b266fSLiam Girdwood 	struct snd_soc_dai *cpu_dai = machine->cpu_dai;
3123c4b266fSLiam Girdwood 	struct snd_soc_dai *codec_dai = machine->codec_dai;
313db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = socdev->codec;
314db2a4165SFrank Mandarino 
315db2a4165SFrank Mandarino 	mutex_lock(&pcm_mutex);
316db2a4165SFrank Mandarino 
317db2a4165SFrank Mandarino 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
318cb666e5bSLiam Girdwood 		cpu_dai->playback.active = codec_dai->playback.active = 0;
319db2a4165SFrank Mandarino 	else
320cb666e5bSLiam Girdwood 		cpu_dai->capture.active = codec_dai->capture.active = 0;
321db2a4165SFrank Mandarino 
322cb666e5bSLiam Girdwood 	if (codec_dai->playback.active == 0 &&
323cb666e5bSLiam Girdwood 		codec_dai->capture.active == 0) {
324cb666e5bSLiam Girdwood 		cpu_dai->active = codec_dai->active = 0;
325db2a4165SFrank Mandarino 	}
326db2a4165SFrank Mandarino 	codec->active--;
327db2a4165SFrank Mandarino 
3286010b2daSMark Brown 	/* Muting the DAC suppresses artifacts caused during digital
3296010b2daSMark Brown 	 * shutdown, for example from stopping clocks.
3306010b2daSMark Brown 	 */
3316010b2daSMark Brown 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
3326010b2daSMark Brown 		snd_soc_dai_digital_mute(codec_dai, 1);
3336010b2daSMark Brown 
334cb666e5bSLiam Girdwood 	if (cpu_dai->ops.shutdown)
335dee89c4dSMark Brown 		cpu_dai->ops.shutdown(substream, cpu_dai);
336db2a4165SFrank Mandarino 
337cb666e5bSLiam Girdwood 	if (codec_dai->ops.shutdown)
338dee89c4dSMark Brown 		codec_dai->ops.shutdown(substream, codec_dai);
339db2a4165SFrank Mandarino 
340db2a4165SFrank Mandarino 	if (machine->ops && machine->ops->shutdown)
341db2a4165SFrank Mandarino 		machine->ops->shutdown(substream);
342db2a4165SFrank Mandarino 
343db2a4165SFrank Mandarino 	if (platform->pcm_ops->close)
344db2a4165SFrank Mandarino 		platform->pcm_ops->close(substream);
345cb666e5bSLiam Girdwood 	cpu_dai->runtime = NULL;
346db2a4165SFrank Mandarino 
347db2a4165SFrank Mandarino 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
348db2a4165SFrank Mandarino 		/* start delayed pop wq here for playback streams */
349cb666e5bSLiam Girdwood 		codec_dai->pop_wait = 1;
3506308419aSMark Brown 		schedule_delayed_work(&card->delayed_work,
351db2a4165SFrank Mandarino 			msecs_to_jiffies(pmdown_time));
352db2a4165SFrank Mandarino 	} else {
353db2a4165SFrank Mandarino 		/* capture streams can be powered down now */
354cb666e5bSLiam Girdwood 		snd_soc_dapm_stream_event(codec,
3550b4d221bSLiam Girdwood 			codec_dai->capture.stream_name,
3560b4d221bSLiam Girdwood 			SND_SOC_DAPM_STREAM_STOP);
357db2a4165SFrank Mandarino 
3580b4d221bSLiam Girdwood 		if (codec->active == 0 && codec_dai->pop_wait == 0)
3590be9898aSMark Brown 			snd_soc_dapm_set_bias_level(socdev,
3600be9898aSMark Brown 						SND_SOC_BIAS_STANDBY);
361db2a4165SFrank Mandarino 	}
362db2a4165SFrank Mandarino 
363db2a4165SFrank Mandarino 	mutex_unlock(&pcm_mutex);
364db2a4165SFrank Mandarino 	return 0;
365db2a4165SFrank Mandarino }
366db2a4165SFrank Mandarino 
367db2a4165SFrank Mandarino /*
368db2a4165SFrank Mandarino  * Called by ALSA when the PCM substream is prepared, can set format, sample
369db2a4165SFrank Mandarino  * rate, etc.  This function is non atomic and can be called multiple times,
370db2a4165SFrank Mandarino  * it can refer to the runtime info.
371db2a4165SFrank Mandarino  */
372db2a4165SFrank Mandarino static int soc_pcm_prepare(struct snd_pcm_substream *substream)
373db2a4165SFrank Mandarino {
374db2a4165SFrank Mandarino 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
375db2a4165SFrank Mandarino 	struct snd_soc_device *socdev = rtd->socdev;
3766308419aSMark Brown 	struct snd_soc_card *card = socdev->card;
377cb666e5bSLiam Girdwood 	struct snd_soc_dai_link *machine = rtd->dai;
37887689d56SMark Brown 	struct snd_soc_platform *platform = card->platform;
3793c4b266fSLiam Girdwood 	struct snd_soc_dai *cpu_dai = machine->cpu_dai;
3803c4b266fSLiam Girdwood 	struct snd_soc_dai *codec_dai = machine->codec_dai;
381db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = socdev->codec;
382db2a4165SFrank Mandarino 	int ret = 0;
383db2a4165SFrank Mandarino 
384db2a4165SFrank Mandarino 	mutex_lock(&pcm_mutex);
385cb666e5bSLiam Girdwood 
386cb666e5bSLiam Girdwood 	if (machine->ops && machine->ops->prepare) {
387cb666e5bSLiam Girdwood 		ret = machine->ops->prepare(substream);
388cb666e5bSLiam Girdwood 		if (ret < 0) {
389cb666e5bSLiam Girdwood 			printk(KERN_ERR "asoc: machine prepare error\n");
390cb666e5bSLiam Girdwood 			goto out;
391cb666e5bSLiam Girdwood 		}
392cb666e5bSLiam Girdwood 	}
393cb666e5bSLiam Girdwood 
394db2a4165SFrank Mandarino 	if (platform->pcm_ops->prepare) {
395db2a4165SFrank Mandarino 		ret = platform->pcm_ops->prepare(substream);
396a71a468aSLiam Girdwood 		if (ret < 0) {
397a71a468aSLiam Girdwood 			printk(KERN_ERR "asoc: platform prepare error\n");
398db2a4165SFrank Mandarino 			goto out;
399db2a4165SFrank Mandarino 		}
400a71a468aSLiam Girdwood 	}
401db2a4165SFrank Mandarino 
402cb666e5bSLiam Girdwood 	if (codec_dai->ops.prepare) {
403dee89c4dSMark Brown 		ret = codec_dai->ops.prepare(substream, codec_dai);
404a71a468aSLiam Girdwood 		if (ret < 0) {
405a71a468aSLiam Girdwood 			printk(KERN_ERR "asoc: codec DAI prepare error\n");
406db2a4165SFrank Mandarino 			goto out;
407db2a4165SFrank Mandarino 		}
408a71a468aSLiam Girdwood 	}
409db2a4165SFrank Mandarino 
410cb666e5bSLiam Girdwood 	if (cpu_dai->ops.prepare) {
411dee89c4dSMark Brown 		ret = cpu_dai->ops.prepare(substream, cpu_dai);
412cb666e5bSLiam Girdwood 		if (ret < 0) {
413cb666e5bSLiam Girdwood 			printk(KERN_ERR "asoc: cpu DAI prepare error\n");
414cb666e5bSLiam Girdwood 			goto out;
415cb666e5bSLiam Girdwood 		}
416cb666e5bSLiam Girdwood 	}
417db2a4165SFrank Mandarino 
418d45f6219SMark Brown 	/* cancel any delayed stream shutdown that is pending */
419d45f6219SMark Brown 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
420d45f6219SMark Brown 	    codec_dai->pop_wait) {
421cb666e5bSLiam Girdwood 		codec_dai->pop_wait = 0;
4226308419aSMark Brown 		cancel_delayed_work(&card->delayed_work);
423db2a4165SFrank Mandarino 	}
424db2a4165SFrank Mandarino 
425d45f6219SMark Brown 	/* do we need to power up codec */
426d45f6219SMark Brown 	if (codec->bias_level != SND_SOC_BIAS_ON) {
4270be9898aSMark Brown 		snd_soc_dapm_set_bias_level(socdev,
4280be9898aSMark Brown 					    SND_SOC_BIAS_PREPARE);
429db2a4165SFrank Mandarino 
430db2a4165SFrank Mandarino 		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
431db2a4165SFrank Mandarino 			snd_soc_dapm_stream_event(codec,
432cb666e5bSLiam Girdwood 					codec_dai->playback.stream_name,
433db2a4165SFrank Mandarino 					SND_SOC_DAPM_STREAM_START);
434db2a4165SFrank Mandarino 		else
435db2a4165SFrank Mandarino 			snd_soc_dapm_stream_event(codec,
436cb666e5bSLiam Girdwood 					codec_dai->capture.stream_name,
437db2a4165SFrank Mandarino 					SND_SOC_DAPM_STREAM_START);
438db2a4165SFrank Mandarino 
4390be9898aSMark Brown 		snd_soc_dapm_set_bias_level(socdev, SND_SOC_BIAS_ON);
4408c6529dbSLiam Girdwood 		snd_soc_dai_digital_mute(codec_dai, 0);
441db2a4165SFrank Mandarino 
442db2a4165SFrank Mandarino 	} else {
443db2a4165SFrank Mandarino 		/* codec already powered - power on widgets */
444db2a4165SFrank Mandarino 		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
445db2a4165SFrank Mandarino 			snd_soc_dapm_stream_event(codec,
446cb666e5bSLiam Girdwood 					codec_dai->playback.stream_name,
447db2a4165SFrank Mandarino 					SND_SOC_DAPM_STREAM_START);
448db2a4165SFrank Mandarino 		else
449db2a4165SFrank Mandarino 			snd_soc_dapm_stream_event(codec,
450cb666e5bSLiam Girdwood 					codec_dai->capture.stream_name,
451db2a4165SFrank Mandarino 					SND_SOC_DAPM_STREAM_START);
4528c6529dbSLiam Girdwood 
4538c6529dbSLiam Girdwood 		snd_soc_dai_digital_mute(codec_dai, 0);
454db2a4165SFrank Mandarino 	}
455db2a4165SFrank Mandarino 
456db2a4165SFrank Mandarino out:
457db2a4165SFrank Mandarino 	mutex_unlock(&pcm_mutex);
458db2a4165SFrank Mandarino 	return ret;
459db2a4165SFrank Mandarino }
460db2a4165SFrank Mandarino 
461db2a4165SFrank Mandarino /*
462db2a4165SFrank Mandarino  * Called by ALSA when the hardware params are set by application. This
463db2a4165SFrank Mandarino  * function can also be called multiple times and can allocate buffers
464db2a4165SFrank Mandarino  * (using snd_pcm_lib_* ). It's non-atomic.
465db2a4165SFrank Mandarino  */
466db2a4165SFrank Mandarino static int soc_pcm_hw_params(struct snd_pcm_substream *substream,
467db2a4165SFrank Mandarino 				struct snd_pcm_hw_params *params)
468db2a4165SFrank Mandarino {
469db2a4165SFrank Mandarino 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
470db2a4165SFrank Mandarino 	struct snd_soc_device *socdev = rtd->socdev;
471cb666e5bSLiam Girdwood 	struct snd_soc_dai_link *machine = rtd->dai;
47287689d56SMark Brown 	struct snd_soc_card *card = socdev->card;
47387689d56SMark Brown 	struct snd_soc_platform *platform = card->platform;
4743c4b266fSLiam Girdwood 	struct snd_soc_dai *cpu_dai = machine->cpu_dai;
4753c4b266fSLiam Girdwood 	struct snd_soc_dai *codec_dai = machine->codec_dai;
476db2a4165SFrank Mandarino 	int ret = 0;
477db2a4165SFrank Mandarino 
478db2a4165SFrank Mandarino 	mutex_lock(&pcm_mutex);
479db2a4165SFrank Mandarino 
480cb666e5bSLiam Girdwood 	if (machine->ops && machine->ops->hw_params) {
481cb666e5bSLiam Girdwood 		ret = machine->ops->hw_params(substream, params);
482cb666e5bSLiam Girdwood 		if (ret < 0) {
483cb666e5bSLiam Girdwood 			printk(KERN_ERR "asoc: machine hw_params failed\n");
484db2a4165SFrank Mandarino 			goto out;
485db2a4165SFrank Mandarino 		}
486cb666e5bSLiam Girdwood 	}
487db2a4165SFrank Mandarino 
488cb666e5bSLiam Girdwood 	if (codec_dai->ops.hw_params) {
489dee89c4dSMark Brown 		ret = codec_dai->ops.hw_params(substream, params, codec_dai);
490db2a4165SFrank Mandarino 		if (ret < 0) {
491db2a4165SFrank Mandarino 			printk(KERN_ERR "asoc: can't set codec %s hw params\n",
492cb666e5bSLiam Girdwood 				codec_dai->name);
493cb666e5bSLiam Girdwood 			goto codec_err;
494db2a4165SFrank Mandarino 		}
495db2a4165SFrank Mandarino 	}
496db2a4165SFrank Mandarino 
497cb666e5bSLiam Girdwood 	if (cpu_dai->ops.hw_params) {
498dee89c4dSMark Brown 		ret = cpu_dai->ops.hw_params(substream, params, cpu_dai);
499db2a4165SFrank Mandarino 		if (ret < 0) {
5003ff3f64bSMark Brown 			printk(KERN_ERR "asoc: interface %s hw params failed\n",
501cb666e5bSLiam Girdwood 				cpu_dai->name);
502db2a4165SFrank Mandarino 			goto interface_err;
503db2a4165SFrank Mandarino 		}
504db2a4165SFrank Mandarino 	}
505db2a4165SFrank Mandarino 
506db2a4165SFrank Mandarino 	if (platform->pcm_ops->hw_params) {
507db2a4165SFrank Mandarino 		ret = platform->pcm_ops->hw_params(substream, params);
508db2a4165SFrank Mandarino 		if (ret < 0) {
5093ff3f64bSMark Brown 			printk(KERN_ERR "asoc: platform %s hw params failed\n",
510db2a4165SFrank Mandarino 				platform->name);
511db2a4165SFrank Mandarino 			goto platform_err;
512db2a4165SFrank Mandarino 		}
513db2a4165SFrank Mandarino 	}
514db2a4165SFrank Mandarino 
515db2a4165SFrank Mandarino out:
516db2a4165SFrank Mandarino 	mutex_unlock(&pcm_mutex);
517db2a4165SFrank Mandarino 	return ret;
518db2a4165SFrank Mandarino 
519db2a4165SFrank Mandarino platform_err:
520cb666e5bSLiam Girdwood 	if (cpu_dai->ops.hw_free)
521dee89c4dSMark Brown 		cpu_dai->ops.hw_free(substream, cpu_dai);
522db2a4165SFrank Mandarino 
523db2a4165SFrank Mandarino interface_err:
524cb666e5bSLiam Girdwood 	if (codec_dai->ops.hw_free)
525dee89c4dSMark Brown 		codec_dai->ops.hw_free(substream, codec_dai);
526cb666e5bSLiam Girdwood 
527cb666e5bSLiam Girdwood codec_err:
528cb666e5bSLiam Girdwood 	if (machine->ops && machine->ops->hw_free)
529cb666e5bSLiam Girdwood 		machine->ops->hw_free(substream);
530db2a4165SFrank Mandarino 
531db2a4165SFrank Mandarino 	mutex_unlock(&pcm_mutex);
532db2a4165SFrank Mandarino 	return ret;
533db2a4165SFrank Mandarino }
534db2a4165SFrank Mandarino 
535db2a4165SFrank Mandarino /*
536db2a4165SFrank Mandarino  * Free's resources allocated by hw_params, can be called multiple times
537db2a4165SFrank Mandarino  */
538db2a4165SFrank Mandarino static int soc_pcm_hw_free(struct snd_pcm_substream *substream)
539db2a4165SFrank Mandarino {
540db2a4165SFrank Mandarino 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
541db2a4165SFrank Mandarino 	struct snd_soc_device *socdev = rtd->socdev;
542cb666e5bSLiam Girdwood 	struct snd_soc_dai_link *machine = rtd->dai;
54387689d56SMark Brown 	struct snd_soc_card *card = socdev->card;
54487689d56SMark Brown 	struct snd_soc_platform *platform = card->platform;
5453c4b266fSLiam Girdwood 	struct snd_soc_dai *cpu_dai = machine->cpu_dai;
5463c4b266fSLiam Girdwood 	struct snd_soc_dai *codec_dai = machine->codec_dai;
547db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = socdev->codec;
548db2a4165SFrank Mandarino 
549db2a4165SFrank Mandarino 	mutex_lock(&pcm_mutex);
550db2a4165SFrank Mandarino 
551db2a4165SFrank Mandarino 	/* apply codec digital mute */
5528c6529dbSLiam Girdwood 	if (!codec->active)
5538c6529dbSLiam Girdwood 		snd_soc_dai_digital_mute(codec_dai, 1);
554db2a4165SFrank Mandarino 
555db2a4165SFrank Mandarino 	/* free any machine hw params */
556db2a4165SFrank Mandarino 	if (machine->ops && machine->ops->hw_free)
557db2a4165SFrank Mandarino 		machine->ops->hw_free(substream);
558db2a4165SFrank Mandarino 
559db2a4165SFrank Mandarino 	/* free any DMA resources */
560db2a4165SFrank Mandarino 	if (platform->pcm_ops->hw_free)
561db2a4165SFrank Mandarino 		platform->pcm_ops->hw_free(substream);
562db2a4165SFrank Mandarino 
563db2a4165SFrank Mandarino 	/* now free hw params for the DAI's  */
564cb666e5bSLiam Girdwood 	if (codec_dai->ops.hw_free)
565dee89c4dSMark Brown 		codec_dai->ops.hw_free(substream, codec_dai);
566db2a4165SFrank Mandarino 
567cb666e5bSLiam Girdwood 	if (cpu_dai->ops.hw_free)
568dee89c4dSMark Brown 		cpu_dai->ops.hw_free(substream, cpu_dai);
569db2a4165SFrank Mandarino 
570db2a4165SFrank Mandarino 	mutex_unlock(&pcm_mutex);
571db2a4165SFrank Mandarino 	return 0;
572db2a4165SFrank Mandarino }
573db2a4165SFrank Mandarino 
574db2a4165SFrank Mandarino static int soc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
575db2a4165SFrank Mandarino {
576db2a4165SFrank Mandarino 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
577db2a4165SFrank Mandarino 	struct snd_soc_device *socdev = rtd->socdev;
57887689d56SMark Brown 	struct snd_soc_card *card= socdev->card;
579cb666e5bSLiam Girdwood 	struct snd_soc_dai_link *machine = rtd->dai;
58087689d56SMark Brown 	struct snd_soc_platform *platform = card->platform;
5813c4b266fSLiam Girdwood 	struct snd_soc_dai *cpu_dai = machine->cpu_dai;
5823c4b266fSLiam Girdwood 	struct snd_soc_dai *codec_dai = machine->codec_dai;
583db2a4165SFrank Mandarino 	int ret;
584db2a4165SFrank Mandarino 
585cb666e5bSLiam Girdwood 	if (codec_dai->ops.trigger) {
586dee89c4dSMark Brown 		ret = codec_dai->ops.trigger(substream, cmd, codec_dai);
587db2a4165SFrank Mandarino 		if (ret < 0)
588db2a4165SFrank Mandarino 			return ret;
589db2a4165SFrank Mandarino 	}
590db2a4165SFrank Mandarino 
591db2a4165SFrank Mandarino 	if (platform->pcm_ops->trigger) {
592db2a4165SFrank Mandarino 		ret = platform->pcm_ops->trigger(substream, cmd);
593db2a4165SFrank Mandarino 		if (ret < 0)
594db2a4165SFrank Mandarino 			return ret;
595db2a4165SFrank Mandarino 	}
596db2a4165SFrank Mandarino 
597cb666e5bSLiam Girdwood 	if (cpu_dai->ops.trigger) {
598dee89c4dSMark Brown 		ret = cpu_dai->ops.trigger(substream, cmd, cpu_dai);
599db2a4165SFrank Mandarino 		if (ret < 0)
600db2a4165SFrank Mandarino 			return ret;
601db2a4165SFrank Mandarino 	}
602db2a4165SFrank Mandarino 	return 0;
603db2a4165SFrank Mandarino }
604db2a4165SFrank Mandarino 
605db2a4165SFrank Mandarino /* ASoC PCM operations */
606db2a4165SFrank Mandarino static struct snd_pcm_ops soc_pcm_ops = {
607db2a4165SFrank Mandarino 	.open		= soc_pcm_open,
608db2a4165SFrank Mandarino 	.close		= soc_codec_close,
609db2a4165SFrank Mandarino 	.hw_params	= soc_pcm_hw_params,
610db2a4165SFrank Mandarino 	.hw_free	= soc_pcm_hw_free,
611db2a4165SFrank Mandarino 	.prepare	= soc_pcm_prepare,
612db2a4165SFrank Mandarino 	.trigger	= soc_pcm_trigger,
613db2a4165SFrank Mandarino };
614db2a4165SFrank Mandarino 
615db2a4165SFrank Mandarino #ifdef CONFIG_PM
616db2a4165SFrank Mandarino /* powers down audio subsystem for suspend */
617db2a4165SFrank Mandarino static int soc_suspend(struct platform_device *pdev, pm_message_t state)
618db2a4165SFrank Mandarino {
619db2a4165SFrank Mandarino 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
62087506549SMark Brown 	struct snd_soc_card *card = socdev->card;
62187689d56SMark Brown 	struct snd_soc_platform *platform = card->platform;
622db2a4165SFrank Mandarino 	struct snd_soc_codec_device *codec_dev = socdev->codec_dev;
623db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = socdev->codec;
624db2a4165SFrank Mandarino 	int i;
625db2a4165SFrank Mandarino 
6266ed25978SAndy Green 	/* Due to the resume being scheduled into a workqueue we could
6276ed25978SAndy Green 	* suspend before that's finished - wait for it to complete.
6286ed25978SAndy Green 	 */
6296ed25978SAndy Green 	snd_power_lock(codec->card);
6306ed25978SAndy Green 	snd_power_wait(codec->card, SNDRV_CTL_POWER_D0);
6316ed25978SAndy Green 	snd_power_unlock(codec->card);
6326ed25978SAndy Green 
6336ed25978SAndy Green 	/* we're going to block userspace touching us until resume completes */
6346ed25978SAndy Green 	snd_power_change_state(codec->card, SNDRV_CTL_POWER_D3hot);
6356ed25978SAndy Green 
636db2a4165SFrank Mandarino 	/* mute any active DAC's */
637dee89c4dSMark Brown 	for (i = 0; i < card->num_links; i++) {
638dee89c4dSMark Brown 		struct snd_soc_dai *dai = card->dai_link[i].codec_dai;
639dee89c4dSMark Brown 		if (dai->ops.digital_mute && dai->playback.active)
640dee89c4dSMark Brown 			dai->ops.digital_mute(dai, 1);
641db2a4165SFrank Mandarino 	}
642db2a4165SFrank Mandarino 
6434ccab3e7SLiam Girdwood 	/* suspend all pcms */
64487506549SMark Brown 	for (i = 0; i < card->num_links; i++)
64587506549SMark Brown 		snd_pcm_suspend_all(card->dai_link[i].pcm);
6464ccab3e7SLiam Girdwood 
64787506549SMark Brown 	if (card->suspend_pre)
64887506549SMark Brown 		card->suspend_pre(pdev, state);
649db2a4165SFrank Mandarino 
65087506549SMark Brown 	for (i = 0; i < card->num_links; i++) {
65187506549SMark Brown 		struct snd_soc_dai  *cpu_dai = card->dai_link[i].cpu_dai;
6523ba9e10aSMark Brown 		if (cpu_dai->suspend && !cpu_dai->ac97_control)
653db2a4165SFrank Mandarino 			cpu_dai->suspend(pdev, cpu_dai);
654db2a4165SFrank Mandarino 		if (platform->suspend)
655*07c84d04SMark Brown 			platform->suspend(cpu_dai);
656db2a4165SFrank Mandarino 	}
657db2a4165SFrank Mandarino 
658db2a4165SFrank Mandarino 	/* close any waiting streams and save state */
6596308419aSMark Brown 	run_delayed_work(&card->delayed_work);
6600be9898aSMark Brown 	codec->suspend_bias_level = codec->bias_level;
661db2a4165SFrank Mandarino 
662db2a4165SFrank Mandarino 	for (i = 0; i < codec->num_dai; i++) {
663db2a4165SFrank Mandarino 		char *stream = codec->dai[i].playback.stream_name;
664db2a4165SFrank Mandarino 		if (stream != NULL)
665db2a4165SFrank Mandarino 			snd_soc_dapm_stream_event(codec, stream,
666db2a4165SFrank Mandarino 				SND_SOC_DAPM_STREAM_SUSPEND);
667db2a4165SFrank Mandarino 		stream = codec->dai[i].capture.stream_name;
668db2a4165SFrank Mandarino 		if (stream != NULL)
669db2a4165SFrank Mandarino 			snd_soc_dapm_stream_event(codec, stream,
670db2a4165SFrank Mandarino 				SND_SOC_DAPM_STREAM_SUSPEND);
671db2a4165SFrank Mandarino 	}
672db2a4165SFrank Mandarino 
673db2a4165SFrank Mandarino 	if (codec_dev->suspend)
674db2a4165SFrank Mandarino 		codec_dev->suspend(pdev, state);
675db2a4165SFrank Mandarino 
67687506549SMark Brown 	for (i = 0; i < card->num_links; i++) {
67787506549SMark Brown 		struct snd_soc_dai *cpu_dai = card->dai_link[i].cpu_dai;
6783ba9e10aSMark Brown 		if (cpu_dai->suspend && cpu_dai->ac97_control)
679db2a4165SFrank Mandarino 			cpu_dai->suspend(pdev, cpu_dai);
680db2a4165SFrank Mandarino 	}
681db2a4165SFrank Mandarino 
68287506549SMark Brown 	if (card->suspend_post)
68387506549SMark Brown 		card->suspend_post(pdev, state);
684db2a4165SFrank Mandarino 
685db2a4165SFrank Mandarino 	return 0;
686db2a4165SFrank Mandarino }
687db2a4165SFrank Mandarino 
6886ed25978SAndy Green /* deferred resume work, so resume can complete before we finished
6896ed25978SAndy Green  * setting our codec back up, which can be very slow on I2C
6906ed25978SAndy Green  */
6916ed25978SAndy Green static void soc_resume_deferred(struct work_struct *work)
692db2a4165SFrank Mandarino {
6936308419aSMark Brown 	struct snd_soc_card *card = container_of(work,
6946308419aSMark Brown 						 struct snd_soc_card,
6956ed25978SAndy Green 						 deferred_resume_work);
6966308419aSMark Brown 	struct snd_soc_device *socdev = card->socdev;
69787689d56SMark Brown 	struct snd_soc_platform *platform = card->platform;
698db2a4165SFrank Mandarino 	struct snd_soc_codec_device *codec_dev = socdev->codec_dev;
699db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = socdev->codec;
7006ed25978SAndy Green 	struct platform_device *pdev = to_platform_device(socdev->dev);
701db2a4165SFrank Mandarino 	int i;
702db2a4165SFrank Mandarino 
7036ed25978SAndy Green 	/* our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
7046ed25978SAndy Green 	 * so userspace apps are blocked from touching us
7056ed25978SAndy Green 	 */
7066ed25978SAndy Green 
707fde22f27SMark Brown 	dev_dbg(socdev->dev, "starting resume work\n");
7086ed25978SAndy Green 
70987506549SMark Brown 	if (card->resume_pre)
71087506549SMark Brown 		card->resume_pre(pdev);
711db2a4165SFrank Mandarino 
71287506549SMark Brown 	for (i = 0; i < card->num_links; i++) {
71387506549SMark Brown 		struct snd_soc_dai *cpu_dai = card->dai_link[i].cpu_dai;
7143ba9e10aSMark Brown 		if (cpu_dai->resume && cpu_dai->ac97_control)
715db2a4165SFrank Mandarino 			cpu_dai->resume(pdev, cpu_dai);
716db2a4165SFrank Mandarino 	}
717db2a4165SFrank Mandarino 
718db2a4165SFrank Mandarino 	if (codec_dev->resume)
719db2a4165SFrank Mandarino 		codec_dev->resume(pdev);
720db2a4165SFrank Mandarino 
721db2a4165SFrank Mandarino 	for (i = 0; i < codec->num_dai; i++) {
722db2a4165SFrank Mandarino 		char *stream = codec->dai[i].playback.stream_name;
723db2a4165SFrank Mandarino 		if (stream != NULL)
724db2a4165SFrank Mandarino 			snd_soc_dapm_stream_event(codec, stream,
725db2a4165SFrank Mandarino 				SND_SOC_DAPM_STREAM_RESUME);
726db2a4165SFrank Mandarino 		stream = codec->dai[i].capture.stream_name;
727db2a4165SFrank Mandarino 		if (stream != NULL)
728db2a4165SFrank Mandarino 			snd_soc_dapm_stream_event(codec, stream,
729db2a4165SFrank Mandarino 				SND_SOC_DAPM_STREAM_RESUME);
730db2a4165SFrank Mandarino 	}
731db2a4165SFrank Mandarino 
7323ff3f64bSMark Brown 	/* unmute any active DACs */
733dee89c4dSMark Brown 	for (i = 0; i < card->num_links; i++) {
734dee89c4dSMark Brown 		struct snd_soc_dai *dai = card->dai_link[i].codec_dai;
735dee89c4dSMark Brown 		if (dai->ops.digital_mute && dai->playback.active)
736dee89c4dSMark Brown 			dai->ops.digital_mute(dai, 0);
737db2a4165SFrank Mandarino 	}
738db2a4165SFrank Mandarino 
73987506549SMark Brown 	for (i = 0; i < card->num_links; i++) {
74087506549SMark Brown 		struct snd_soc_dai *cpu_dai = card->dai_link[i].cpu_dai;
7413ba9e10aSMark Brown 		if (cpu_dai->resume && !cpu_dai->ac97_control)
742db2a4165SFrank Mandarino 			cpu_dai->resume(pdev, cpu_dai);
743db2a4165SFrank Mandarino 		if (platform->resume)
744*07c84d04SMark Brown 			platform->resume(cpu_dai);
745db2a4165SFrank Mandarino 	}
746db2a4165SFrank Mandarino 
74787506549SMark Brown 	if (card->resume_post)
74887506549SMark Brown 		card->resume_post(pdev);
749db2a4165SFrank Mandarino 
750fde22f27SMark Brown 	dev_dbg(socdev->dev, "resume work completed\n");
7516ed25978SAndy Green 
7526ed25978SAndy Green 	/* userspace can access us now we are back as we were before */
7536ed25978SAndy Green 	snd_power_change_state(codec->card, SNDRV_CTL_POWER_D0);
7546ed25978SAndy Green }
7556ed25978SAndy Green 
7566ed25978SAndy Green /* powers up audio subsystem after a suspend */
7576ed25978SAndy Green static int soc_resume(struct platform_device *pdev)
7586ed25978SAndy Green {
7596ed25978SAndy Green 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
7606308419aSMark Brown 	struct snd_soc_card *card = socdev->card;
7616ed25978SAndy Green 
762fde22f27SMark Brown 	dev_dbg(socdev->dev, "scheduling resume work\n");
7636ed25978SAndy Green 
7646308419aSMark Brown 	if (!schedule_work(&card->deferred_resume_work))
765fde22f27SMark Brown 		dev_err(socdev->dev, "resume work item may be lost\n");
7666ed25978SAndy Green 
767db2a4165SFrank Mandarino 	return 0;
768db2a4165SFrank Mandarino }
769db2a4165SFrank Mandarino 
770db2a4165SFrank Mandarino #else
771db2a4165SFrank Mandarino #define soc_suspend	NULL
772db2a4165SFrank Mandarino #define soc_resume	NULL
773db2a4165SFrank Mandarino #endif
774db2a4165SFrank Mandarino 
775db2a4165SFrank Mandarino /* probes a new socdev */
776db2a4165SFrank Mandarino static int soc_probe(struct platform_device *pdev)
777db2a4165SFrank Mandarino {
778db2a4165SFrank Mandarino 	int ret = 0, i;
779db2a4165SFrank Mandarino 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
78087506549SMark Brown 	struct snd_soc_card *card = socdev->card;
78187689d56SMark Brown 	struct snd_soc_platform *platform = card->platform;
782db2a4165SFrank Mandarino 	struct snd_soc_codec_device *codec_dev = socdev->codec_dev;
783db2a4165SFrank Mandarino 
7846308419aSMark Brown 	/* Bodge while we push things out of socdev */
7856308419aSMark Brown 	card->socdev = socdev;
7866308419aSMark Brown 
78787506549SMark Brown 	if (card->probe) {
78887506549SMark Brown 		ret = card->probe(pdev);
789db2a4165SFrank Mandarino 		if (ret < 0)
790db2a4165SFrank Mandarino 			return ret;
791db2a4165SFrank Mandarino 	}
792db2a4165SFrank Mandarino 
79387506549SMark Brown 	for (i = 0; i < card->num_links; i++) {
79487506549SMark Brown 		struct snd_soc_dai *cpu_dai = card->dai_link[i].cpu_dai;
795db2a4165SFrank Mandarino 		if (cpu_dai->probe) {
796bdb92876SMark Brown 			ret = cpu_dai->probe(pdev, cpu_dai);
797db2a4165SFrank Mandarino 			if (ret < 0)
798db2a4165SFrank Mandarino 				goto cpu_dai_err;
799db2a4165SFrank Mandarino 		}
800db2a4165SFrank Mandarino 	}
801db2a4165SFrank Mandarino 
802db2a4165SFrank Mandarino 	if (codec_dev->probe) {
803db2a4165SFrank Mandarino 		ret = codec_dev->probe(pdev);
804db2a4165SFrank Mandarino 		if (ret < 0)
805db2a4165SFrank Mandarino 			goto cpu_dai_err;
806db2a4165SFrank Mandarino 	}
807db2a4165SFrank Mandarino 
808db2a4165SFrank Mandarino 	if (platform->probe) {
809db2a4165SFrank Mandarino 		ret = platform->probe(pdev);
810db2a4165SFrank Mandarino 		if (ret < 0)
811db2a4165SFrank Mandarino 			goto platform_err;
812db2a4165SFrank Mandarino 	}
813db2a4165SFrank Mandarino 
814db2a4165SFrank Mandarino 	/* DAPM stream work */
8156308419aSMark Brown 	INIT_DELAYED_WORK(&card->delayed_work, close_delayed_work);
8161301a964SRandy Dunlap #ifdef CONFIG_PM
8176ed25978SAndy Green 	/* deferred resume work */
8186308419aSMark Brown 	INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
8191301a964SRandy Dunlap #endif
8206ed25978SAndy Green 
821db2a4165SFrank Mandarino 	return 0;
822db2a4165SFrank Mandarino 
823db2a4165SFrank Mandarino platform_err:
824db2a4165SFrank Mandarino 	if (codec_dev->remove)
825db2a4165SFrank Mandarino 		codec_dev->remove(pdev);
826db2a4165SFrank Mandarino 
827db2a4165SFrank Mandarino cpu_dai_err:
82818b9b3d9SLiam Girdwood 	for (i--; i >= 0; i--) {
82987506549SMark Brown 		struct snd_soc_dai *cpu_dai = card->dai_link[i].cpu_dai;
830db2a4165SFrank Mandarino 		if (cpu_dai->remove)
831bdb92876SMark Brown 			cpu_dai->remove(pdev, cpu_dai);
832db2a4165SFrank Mandarino 	}
833db2a4165SFrank Mandarino 
83487506549SMark Brown 	if (card->remove)
83587506549SMark Brown 		card->remove(pdev);
836db2a4165SFrank Mandarino 
837db2a4165SFrank Mandarino 	return ret;
838db2a4165SFrank Mandarino }
839db2a4165SFrank Mandarino 
840db2a4165SFrank Mandarino /* removes a socdev */
841db2a4165SFrank Mandarino static int soc_remove(struct platform_device *pdev)
842db2a4165SFrank Mandarino {
843db2a4165SFrank Mandarino 	int i;
844db2a4165SFrank Mandarino 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
84587506549SMark Brown 	struct snd_soc_card *card = socdev->card;
84687689d56SMark Brown 	struct snd_soc_platform *platform = card->platform;
847db2a4165SFrank Mandarino 	struct snd_soc_codec_device *codec_dev = socdev->codec_dev;
848db2a4165SFrank Mandarino 
8496308419aSMark Brown 	run_delayed_work(&card->delayed_work);
850965ac42cSLiam Girdwood 
851db2a4165SFrank Mandarino 	if (platform->remove)
852db2a4165SFrank Mandarino 		platform->remove(pdev);
853db2a4165SFrank Mandarino 
854db2a4165SFrank Mandarino 	if (codec_dev->remove)
855db2a4165SFrank Mandarino 		codec_dev->remove(pdev);
856db2a4165SFrank Mandarino 
85787506549SMark Brown 	for (i = 0; i < card->num_links; i++) {
85887506549SMark Brown 		struct snd_soc_dai *cpu_dai = card->dai_link[i].cpu_dai;
859db2a4165SFrank Mandarino 		if (cpu_dai->remove)
860bdb92876SMark Brown 			cpu_dai->remove(pdev, cpu_dai);
861db2a4165SFrank Mandarino 	}
862db2a4165SFrank Mandarino 
86387506549SMark Brown 	if (card->remove)
86487506549SMark Brown 		card->remove(pdev);
865db2a4165SFrank Mandarino 
866db2a4165SFrank Mandarino 	return 0;
867db2a4165SFrank Mandarino }
868db2a4165SFrank Mandarino 
869db2a4165SFrank Mandarino /* ASoC platform driver */
870db2a4165SFrank Mandarino static struct platform_driver soc_driver = {
871db2a4165SFrank Mandarino 	.driver		= {
872db2a4165SFrank Mandarino 		.name		= "soc-audio",
8738b45a209SKay Sievers 		.owner		= THIS_MODULE,
874db2a4165SFrank Mandarino 	},
875db2a4165SFrank Mandarino 	.probe		= soc_probe,
876db2a4165SFrank Mandarino 	.remove		= soc_remove,
877db2a4165SFrank Mandarino 	.suspend	= soc_suspend,
878db2a4165SFrank Mandarino 	.resume		= soc_resume,
879db2a4165SFrank Mandarino };
880db2a4165SFrank Mandarino 
881db2a4165SFrank Mandarino /* create a new pcm */
882db2a4165SFrank Mandarino static int soc_new_pcm(struct snd_soc_device *socdev,
883db2a4165SFrank Mandarino 	struct snd_soc_dai_link *dai_link, int num)
884db2a4165SFrank Mandarino {
885db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = socdev->codec;
88687689d56SMark Brown 	struct snd_soc_card *card = socdev->card;
88787689d56SMark Brown 	struct snd_soc_platform *platform = card->platform;
8883c4b266fSLiam Girdwood 	struct snd_soc_dai *codec_dai = dai_link->codec_dai;
8893c4b266fSLiam Girdwood 	struct snd_soc_dai *cpu_dai = dai_link->cpu_dai;
890db2a4165SFrank Mandarino 	struct snd_soc_pcm_runtime *rtd;
891db2a4165SFrank Mandarino 	struct snd_pcm *pcm;
892db2a4165SFrank Mandarino 	char new_name[64];
893db2a4165SFrank Mandarino 	int ret = 0, playback = 0, capture = 0;
894db2a4165SFrank Mandarino 
895db2a4165SFrank Mandarino 	rtd = kzalloc(sizeof(struct snd_soc_pcm_runtime), GFP_KERNEL);
896db2a4165SFrank Mandarino 	if (rtd == NULL)
897db2a4165SFrank Mandarino 		return -ENOMEM;
898cb666e5bSLiam Girdwood 
899cb666e5bSLiam Girdwood 	rtd->dai = dai_link;
900db2a4165SFrank Mandarino 	rtd->socdev = socdev;
901cb666e5bSLiam Girdwood 	codec_dai->codec = socdev->codec;
902db2a4165SFrank Mandarino 
903db2a4165SFrank Mandarino 	/* check client and interface hw capabilities */
9043ba9e10aSMark Brown 	sprintf(new_name, "%s %s-%d", dai_link->stream_name, codec_dai->name,
9053ba9e10aSMark Brown 		num);
906db2a4165SFrank Mandarino 
907db2a4165SFrank Mandarino 	if (codec_dai->playback.channels_min)
908db2a4165SFrank Mandarino 		playback = 1;
909db2a4165SFrank Mandarino 	if (codec_dai->capture.channels_min)
910db2a4165SFrank Mandarino 		capture = 1;
911db2a4165SFrank Mandarino 
912db2a4165SFrank Mandarino 	ret = snd_pcm_new(codec->card, new_name, codec->pcm_devs++, playback,
913db2a4165SFrank Mandarino 		capture, &pcm);
914db2a4165SFrank Mandarino 	if (ret < 0) {
9153ff3f64bSMark Brown 		printk(KERN_ERR "asoc: can't create pcm for codec %s\n",
9163ff3f64bSMark Brown 			codec->name);
917db2a4165SFrank Mandarino 		kfree(rtd);
918db2a4165SFrank Mandarino 		return ret;
919db2a4165SFrank Mandarino 	}
920db2a4165SFrank Mandarino 
9214ccab3e7SLiam Girdwood 	dai_link->pcm = pcm;
922db2a4165SFrank Mandarino 	pcm->private_data = rtd;
92387689d56SMark Brown 	soc_pcm_ops.mmap = platform->pcm_ops->mmap;
92487689d56SMark Brown 	soc_pcm_ops.pointer = platform->pcm_ops->pointer;
92587689d56SMark Brown 	soc_pcm_ops.ioctl = platform->pcm_ops->ioctl;
92687689d56SMark Brown 	soc_pcm_ops.copy = platform->pcm_ops->copy;
92787689d56SMark Brown 	soc_pcm_ops.silence = platform->pcm_ops->silence;
92887689d56SMark Brown 	soc_pcm_ops.ack = platform->pcm_ops->ack;
92987689d56SMark Brown 	soc_pcm_ops.page = platform->pcm_ops->page;
930db2a4165SFrank Mandarino 
931db2a4165SFrank Mandarino 	if (playback)
932db2a4165SFrank Mandarino 		snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &soc_pcm_ops);
933db2a4165SFrank Mandarino 
934db2a4165SFrank Mandarino 	if (capture)
935db2a4165SFrank Mandarino 		snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &soc_pcm_ops);
936db2a4165SFrank Mandarino 
93787689d56SMark Brown 	ret = platform->pcm_new(codec->card, codec_dai, pcm);
938db2a4165SFrank Mandarino 	if (ret < 0) {
939db2a4165SFrank Mandarino 		printk(KERN_ERR "asoc: platform pcm constructor failed\n");
940db2a4165SFrank Mandarino 		kfree(rtd);
941db2a4165SFrank Mandarino 		return ret;
942db2a4165SFrank Mandarino 	}
943db2a4165SFrank Mandarino 
94487689d56SMark Brown 	pcm->private_free = platform->pcm_free;
945db2a4165SFrank Mandarino 	printk(KERN_INFO "asoc: %s <-> %s mapping ok\n", codec_dai->name,
946db2a4165SFrank Mandarino 		cpu_dai->name);
947db2a4165SFrank Mandarino 	return ret;
948db2a4165SFrank Mandarino }
949db2a4165SFrank Mandarino 
950db2a4165SFrank Mandarino /* codec register dump */
95112ef193dSTroy Kisky static ssize_t soc_codec_reg_show(struct snd_soc_device *devdata, char *buf)
952db2a4165SFrank Mandarino {
953db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = devdata->codec;
954db2a4165SFrank Mandarino 	int i, step = 1, count = 0;
955db2a4165SFrank Mandarino 
956db2a4165SFrank Mandarino 	if (!codec->reg_cache_size)
957db2a4165SFrank Mandarino 		return 0;
958db2a4165SFrank Mandarino 
959db2a4165SFrank Mandarino 	if (codec->reg_cache_step)
960db2a4165SFrank Mandarino 		step = codec->reg_cache_step;
961db2a4165SFrank Mandarino 
962db2a4165SFrank Mandarino 	count += sprintf(buf, "%s registers\n", codec->name);
96358cd33c0SMark Brown 	for (i = 0; i < codec->reg_cache_size; i += step) {
96458cd33c0SMark Brown 		count += sprintf(buf + count, "%2x: ", i);
96558cd33c0SMark Brown 		if (count >= PAGE_SIZE - 1)
96658cd33c0SMark Brown 			break;
96758cd33c0SMark Brown 
96858cd33c0SMark Brown 		if (codec->display_register)
96958cd33c0SMark Brown 			count += codec->display_register(codec, buf + count,
97058cd33c0SMark Brown 							 PAGE_SIZE - count, i);
97158cd33c0SMark Brown 		else
97258cd33c0SMark Brown 			count += snprintf(buf + count, PAGE_SIZE - count,
97358cd33c0SMark Brown 					  "%4x", codec->read(codec, i));
97458cd33c0SMark Brown 
97558cd33c0SMark Brown 		if (count >= PAGE_SIZE - 1)
97658cd33c0SMark Brown 			break;
97758cd33c0SMark Brown 
97858cd33c0SMark Brown 		count += snprintf(buf + count, PAGE_SIZE - count, "\n");
97958cd33c0SMark Brown 		if (count >= PAGE_SIZE - 1)
98058cd33c0SMark Brown 			break;
98158cd33c0SMark Brown 	}
98258cd33c0SMark Brown 
98358cd33c0SMark Brown 	/* Truncate count; min() would cause a warning */
98458cd33c0SMark Brown 	if (count >= PAGE_SIZE)
98558cd33c0SMark Brown 		count = PAGE_SIZE - 1;
986db2a4165SFrank Mandarino 
987db2a4165SFrank Mandarino 	return count;
988db2a4165SFrank Mandarino }
98912ef193dSTroy Kisky static ssize_t codec_reg_show(struct device *dev,
99012ef193dSTroy Kisky 	struct device_attribute *attr, char *buf)
99112ef193dSTroy Kisky {
99212ef193dSTroy Kisky 	struct snd_soc_device *devdata = dev_get_drvdata(dev);
99312ef193dSTroy Kisky 	return soc_codec_reg_show(devdata, buf);
99412ef193dSTroy Kisky }
99512ef193dSTroy Kisky 
996db2a4165SFrank Mandarino static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
997db2a4165SFrank Mandarino 
99812ef193dSTroy Kisky #ifdef CONFIG_DEBUG_FS
99912ef193dSTroy Kisky static int codec_reg_open_file(struct inode *inode, struct file *file)
100012ef193dSTroy Kisky {
100112ef193dSTroy Kisky 	file->private_data = inode->i_private;
100212ef193dSTroy Kisky 	return 0;
100312ef193dSTroy Kisky }
100412ef193dSTroy Kisky 
100512ef193dSTroy Kisky static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf,
100612ef193dSTroy Kisky 			       size_t count, loff_t *ppos)
100712ef193dSTroy Kisky {
100812ef193dSTroy Kisky 	ssize_t ret;
1009384c89e2SMark Brown 	struct snd_soc_codec *codec = file->private_data;
1010384c89e2SMark Brown 	struct device *card_dev = codec->card->dev;
1011384c89e2SMark Brown 	struct snd_soc_device *devdata = card_dev->driver_data;
101212ef193dSTroy Kisky 	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
101312ef193dSTroy Kisky 	if (!buf)
101412ef193dSTroy Kisky 		return -ENOMEM;
101512ef193dSTroy Kisky 	ret = soc_codec_reg_show(devdata, buf);
101612ef193dSTroy Kisky 	if (ret >= 0)
101712ef193dSTroy Kisky 		ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
101812ef193dSTroy Kisky 	kfree(buf);
101912ef193dSTroy Kisky 	return ret;
102012ef193dSTroy Kisky }
102112ef193dSTroy Kisky 
102212ef193dSTroy Kisky static ssize_t codec_reg_write_file(struct file *file,
102312ef193dSTroy Kisky 		const char __user *user_buf, size_t count, loff_t *ppos)
102412ef193dSTroy Kisky {
102512ef193dSTroy Kisky 	char buf[32];
102612ef193dSTroy Kisky 	int buf_size;
102712ef193dSTroy Kisky 	char *start = buf;
102812ef193dSTroy Kisky 	unsigned long reg, value;
102912ef193dSTroy Kisky 	int step = 1;
1030384c89e2SMark Brown 	struct snd_soc_codec *codec = file->private_data;
103112ef193dSTroy Kisky 
103212ef193dSTroy Kisky 	buf_size = min(count, (sizeof(buf)-1));
103312ef193dSTroy Kisky 	if (copy_from_user(buf, user_buf, buf_size))
103412ef193dSTroy Kisky 		return -EFAULT;
103512ef193dSTroy Kisky 	buf[buf_size] = 0;
103612ef193dSTroy Kisky 
103712ef193dSTroy Kisky 	if (codec->reg_cache_step)
103812ef193dSTroy Kisky 		step = codec->reg_cache_step;
103912ef193dSTroy Kisky 
104012ef193dSTroy Kisky 	while (*start == ' ')
104112ef193dSTroy Kisky 		start++;
104212ef193dSTroy Kisky 	reg = simple_strtoul(start, &start, 16);
104312ef193dSTroy Kisky 	if ((reg >= codec->reg_cache_size) || (reg % step))
104412ef193dSTroy Kisky 		return -EINVAL;
104512ef193dSTroy Kisky 	while (*start == ' ')
104612ef193dSTroy Kisky 		start++;
104712ef193dSTroy Kisky 	if (strict_strtoul(start, 16, &value))
104812ef193dSTroy Kisky 		return -EINVAL;
104912ef193dSTroy Kisky 	codec->write(codec, reg, value);
105012ef193dSTroy Kisky 	return buf_size;
105112ef193dSTroy Kisky }
105212ef193dSTroy Kisky 
105312ef193dSTroy Kisky static const struct file_operations codec_reg_fops = {
105412ef193dSTroy Kisky 	.open = codec_reg_open_file,
105512ef193dSTroy Kisky 	.read = codec_reg_read_file,
105612ef193dSTroy Kisky 	.write = codec_reg_write_file,
105712ef193dSTroy Kisky };
105812ef193dSTroy Kisky 
1059384c89e2SMark Brown static void soc_init_codec_debugfs(struct snd_soc_codec *codec)
106012ef193dSTroy Kisky {
1061384c89e2SMark Brown 	codec->debugfs_reg = debugfs_create_file("codec_reg", 0644,
1062384c89e2SMark Brown 						 debugfs_root, codec,
1063384c89e2SMark Brown 						 &codec_reg_fops);
1064384c89e2SMark Brown 	if (!codec->debugfs_reg)
1065384c89e2SMark Brown 		printk(KERN_WARNING
1066384c89e2SMark Brown 		       "ASoC: Failed to create codec register debugfs file\n");
106712ef193dSTroy Kisky 
1068384c89e2SMark Brown 	codec->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0744,
1069384c89e2SMark Brown 						     debugfs_root,
1070384c89e2SMark Brown 						     &codec->pop_time);
1071384c89e2SMark Brown 	if (!codec->debugfs_pop_time)
1072384c89e2SMark Brown 		printk(KERN_WARNING
1073384c89e2SMark Brown 		       "Failed to create pop time debugfs file\n");
107412ef193dSTroy Kisky }
107512ef193dSTroy Kisky 
1076384c89e2SMark Brown static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
107712ef193dSTroy Kisky {
1078384c89e2SMark Brown 	debugfs_remove(codec->debugfs_pop_time);
1079384c89e2SMark Brown 	debugfs_remove(codec->debugfs_reg);
108012ef193dSTroy Kisky }
108112ef193dSTroy Kisky 
108212ef193dSTroy Kisky #else
108312ef193dSTroy Kisky 
1084384c89e2SMark Brown static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec)
108512ef193dSTroy Kisky {
108612ef193dSTroy Kisky }
108712ef193dSTroy Kisky 
1088384c89e2SMark Brown static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
108912ef193dSTroy Kisky {
109012ef193dSTroy Kisky }
109112ef193dSTroy Kisky #endif
109212ef193dSTroy Kisky 
1093db2a4165SFrank Mandarino /**
1094db2a4165SFrank Mandarino  * snd_soc_new_ac97_codec - initailise AC97 device
1095db2a4165SFrank Mandarino  * @codec: audio codec
1096db2a4165SFrank Mandarino  * @ops: AC97 bus operations
1097db2a4165SFrank Mandarino  * @num: AC97 codec number
1098db2a4165SFrank Mandarino  *
1099db2a4165SFrank Mandarino  * Initialises AC97 codec resources for use by ad-hoc devices only.
1100db2a4165SFrank Mandarino  */
1101db2a4165SFrank Mandarino int snd_soc_new_ac97_codec(struct snd_soc_codec *codec,
1102db2a4165SFrank Mandarino 	struct snd_ac97_bus_ops *ops, int num)
1103db2a4165SFrank Mandarino {
1104db2a4165SFrank Mandarino 	mutex_lock(&codec->mutex);
1105db2a4165SFrank Mandarino 
1106db2a4165SFrank Mandarino 	codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL);
1107db2a4165SFrank Mandarino 	if (codec->ac97 == NULL) {
1108db2a4165SFrank Mandarino 		mutex_unlock(&codec->mutex);
1109db2a4165SFrank Mandarino 		return -ENOMEM;
1110db2a4165SFrank Mandarino 	}
1111db2a4165SFrank Mandarino 
1112db2a4165SFrank Mandarino 	codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL);
1113db2a4165SFrank Mandarino 	if (codec->ac97->bus == NULL) {
1114db2a4165SFrank Mandarino 		kfree(codec->ac97);
1115db2a4165SFrank Mandarino 		codec->ac97 = NULL;
1116db2a4165SFrank Mandarino 		mutex_unlock(&codec->mutex);
1117db2a4165SFrank Mandarino 		return -ENOMEM;
1118db2a4165SFrank Mandarino 	}
1119db2a4165SFrank Mandarino 
1120db2a4165SFrank Mandarino 	codec->ac97->bus->ops = ops;
1121db2a4165SFrank Mandarino 	codec->ac97->num = num;
1122db2a4165SFrank Mandarino 	mutex_unlock(&codec->mutex);
1123db2a4165SFrank Mandarino 	return 0;
1124db2a4165SFrank Mandarino }
1125db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec);
1126db2a4165SFrank Mandarino 
1127db2a4165SFrank Mandarino /**
1128db2a4165SFrank Mandarino  * snd_soc_free_ac97_codec - free AC97 codec device
1129db2a4165SFrank Mandarino  * @codec: audio codec
1130db2a4165SFrank Mandarino  *
1131db2a4165SFrank Mandarino  * Frees AC97 codec device resources.
1132db2a4165SFrank Mandarino  */
1133db2a4165SFrank Mandarino void snd_soc_free_ac97_codec(struct snd_soc_codec *codec)
1134db2a4165SFrank Mandarino {
1135db2a4165SFrank Mandarino 	mutex_lock(&codec->mutex);
1136db2a4165SFrank Mandarino 	kfree(codec->ac97->bus);
1137db2a4165SFrank Mandarino 	kfree(codec->ac97);
1138db2a4165SFrank Mandarino 	codec->ac97 = NULL;
1139db2a4165SFrank Mandarino 	mutex_unlock(&codec->mutex);
1140db2a4165SFrank Mandarino }
1141db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec);
1142db2a4165SFrank Mandarino 
1143db2a4165SFrank Mandarino /**
1144db2a4165SFrank Mandarino  * snd_soc_update_bits - update codec register bits
1145db2a4165SFrank Mandarino  * @codec: audio codec
1146db2a4165SFrank Mandarino  * @reg: codec register
1147db2a4165SFrank Mandarino  * @mask: register mask
1148db2a4165SFrank Mandarino  * @value: new value
1149db2a4165SFrank Mandarino  *
1150db2a4165SFrank Mandarino  * Writes new register value.
1151db2a4165SFrank Mandarino  *
1152db2a4165SFrank Mandarino  * Returns 1 for change else 0.
1153db2a4165SFrank Mandarino  */
1154db2a4165SFrank Mandarino int snd_soc_update_bits(struct snd_soc_codec *codec, unsigned short reg,
1155db2a4165SFrank Mandarino 				unsigned short mask, unsigned short value)
1156db2a4165SFrank Mandarino {
1157db2a4165SFrank Mandarino 	int change;
1158db2a4165SFrank Mandarino 	unsigned short old, new;
1159db2a4165SFrank Mandarino 
1160db2a4165SFrank Mandarino 	mutex_lock(&io_mutex);
1161db2a4165SFrank Mandarino 	old = snd_soc_read(codec, reg);
1162db2a4165SFrank Mandarino 	new = (old & ~mask) | value;
1163db2a4165SFrank Mandarino 	change = old != new;
1164db2a4165SFrank Mandarino 	if (change)
1165db2a4165SFrank Mandarino 		snd_soc_write(codec, reg, new);
1166db2a4165SFrank Mandarino 
1167db2a4165SFrank Mandarino 	mutex_unlock(&io_mutex);
1168db2a4165SFrank Mandarino 	return change;
1169db2a4165SFrank Mandarino }
1170db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_update_bits);
1171db2a4165SFrank Mandarino 
1172db2a4165SFrank Mandarino /**
1173db2a4165SFrank Mandarino  * snd_soc_test_bits - test register for change
1174db2a4165SFrank Mandarino  * @codec: audio codec
1175db2a4165SFrank Mandarino  * @reg: codec register
1176db2a4165SFrank Mandarino  * @mask: register mask
1177db2a4165SFrank Mandarino  * @value: new value
1178db2a4165SFrank Mandarino  *
1179db2a4165SFrank Mandarino  * Tests a register with a new value and checks if the new value is
1180db2a4165SFrank Mandarino  * different from the old value.
1181db2a4165SFrank Mandarino  *
1182db2a4165SFrank Mandarino  * Returns 1 for change else 0.
1183db2a4165SFrank Mandarino  */
1184db2a4165SFrank Mandarino int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg,
1185db2a4165SFrank Mandarino 				unsigned short mask, unsigned short value)
1186db2a4165SFrank Mandarino {
1187db2a4165SFrank Mandarino 	int change;
1188db2a4165SFrank Mandarino 	unsigned short old, new;
1189db2a4165SFrank Mandarino 
1190db2a4165SFrank Mandarino 	mutex_lock(&io_mutex);
1191db2a4165SFrank Mandarino 	old = snd_soc_read(codec, reg);
1192db2a4165SFrank Mandarino 	new = (old & ~mask) | value;
1193db2a4165SFrank Mandarino 	change = old != new;
1194db2a4165SFrank Mandarino 	mutex_unlock(&io_mutex);
1195db2a4165SFrank Mandarino 
1196db2a4165SFrank Mandarino 	return change;
1197db2a4165SFrank Mandarino }
1198db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_test_bits);
1199db2a4165SFrank Mandarino 
1200db2a4165SFrank Mandarino /**
1201db2a4165SFrank Mandarino  * snd_soc_new_pcms - create new sound card and pcms
1202db2a4165SFrank Mandarino  * @socdev: the SoC audio device
1203db2a4165SFrank Mandarino  *
1204db2a4165SFrank Mandarino  * Create a new sound card based upon the codec and interface pcms.
1205db2a4165SFrank Mandarino  *
1206db2a4165SFrank Mandarino  * Returns 0 for success, else error.
1207db2a4165SFrank Mandarino  */
1208db2a4165SFrank Mandarino int snd_soc_new_pcms(struct snd_soc_device *socdev, int idx, const char *xid)
1209db2a4165SFrank Mandarino {
1210db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = socdev->codec;
121187506549SMark Brown 	struct snd_soc_card *card = socdev->card;
1212db2a4165SFrank Mandarino 	int ret = 0, i;
1213db2a4165SFrank Mandarino 
1214db2a4165SFrank Mandarino 	mutex_lock(&codec->mutex);
1215db2a4165SFrank Mandarino 
1216db2a4165SFrank Mandarino 	/* register a sound card */
1217db2a4165SFrank Mandarino 	codec->card = snd_card_new(idx, xid, codec->owner, 0);
1218db2a4165SFrank Mandarino 	if (!codec->card) {
1219db2a4165SFrank Mandarino 		printk(KERN_ERR "asoc: can't create sound card for codec %s\n",
1220db2a4165SFrank Mandarino 			codec->name);
1221db2a4165SFrank Mandarino 		mutex_unlock(&codec->mutex);
1222db2a4165SFrank Mandarino 		return -ENODEV;
1223db2a4165SFrank Mandarino 	}
1224db2a4165SFrank Mandarino 
1225db2a4165SFrank Mandarino 	codec->card->dev = socdev->dev;
1226db2a4165SFrank Mandarino 	codec->card->private_data = codec;
1227db2a4165SFrank Mandarino 	strncpy(codec->card->driver, codec->name, sizeof(codec->card->driver));
1228db2a4165SFrank Mandarino 
1229db2a4165SFrank Mandarino 	/* create the pcms */
123087506549SMark Brown 	for (i = 0; i < card->num_links; i++) {
123187506549SMark Brown 		ret = soc_new_pcm(socdev, &card->dai_link[i], i);
1232db2a4165SFrank Mandarino 		if (ret < 0) {
1233db2a4165SFrank Mandarino 			printk(KERN_ERR "asoc: can't create pcm %s\n",
123487506549SMark Brown 				card->dai_link[i].stream_name);
1235db2a4165SFrank Mandarino 			mutex_unlock(&codec->mutex);
1236db2a4165SFrank Mandarino 			return ret;
1237db2a4165SFrank Mandarino 		}
1238db2a4165SFrank Mandarino 	}
1239db2a4165SFrank Mandarino 
1240db2a4165SFrank Mandarino 	mutex_unlock(&codec->mutex);
1241db2a4165SFrank Mandarino 	return ret;
1242db2a4165SFrank Mandarino }
1243db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_new_pcms);
1244db2a4165SFrank Mandarino 
1245db2a4165SFrank Mandarino /**
1246968a6025SMark Brown  * snd_soc_init_card - register sound card
1247db2a4165SFrank Mandarino  * @socdev: the SoC audio device
1248db2a4165SFrank Mandarino  *
1249db2a4165SFrank Mandarino  * Register a SoC sound card. Also registers an AC97 device if the
1250db2a4165SFrank Mandarino  * codec is AC97 for ad hoc devices.
1251db2a4165SFrank Mandarino  *
1252db2a4165SFrank Mandarino  * Returns 0 for success, else error.
1253db2a4165SFrank Mandarino  */
1254968a6025SMark Brown int snd_soc_init_card(struct snd_soc_device *socdev)
1255db2a4165SFrank Mandarino {
1256db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = socdev->codec;
125787506549SMark Brown 	struct snd_soc_card *card = socdev->card;
125812e74f7dSLiam Girdwood 	int ret = 0, i, ac97 = 0, err = 0;
1259db2a4165SFrank Mandarino 
126087506549SMark Brown 	for (i = 0; i < card->num_links; i++) {
126187506549SMark Brown 		if (card->dai_link[i].init) {
126287506549SMark Brown 			err = card->dai_link[i].init(codec);
126312e74f7dSLiam Girdwood 			if (err < 0) {
126412e74f7dSLiam Girdwood 				printk(KERN_ERR "asoc: failed to init %s\n",
126587506549SMark Brown 					card->dai_link[i].stream_name);
126612e74f7dSLiam Girdwood 				continue;
126712e74f7dSLiam Girdwood 			}
126812e74f7dSLiam Girdwood 		}
12693ba9e10aSMark Brown 		if (card->dai_link[i].codec_dai->ac97_control)
1270db2a4165SFrank Mandarino 			ac97 = 1;
1271db2a4165SFrank Mandarino 	}
1272db2a4165SFrank Mandarino 	snprintf(codec->card->shortname, sizeof(codec->card->shortname),
127387506549SMark Brown 		 "%s",  card->name);
1274db2a4165SFrank Mandarino 	snprintf(codec->card->longname, sizeof(codec->card->longname),
127587506549SMark Brown 		 "%s (%s)", card->name, codec->name);
1276db2a4165SFrank Mandarino 
1277db2a4165SFrank Mandarino 	ret = snd_card_register(codec->card);
1278db2a4165SFrank Mandarino 	if (ret < 0) {
12793ff3f64bSMark Brown 		printk(KERN_ERR "asoc: failed to register soundcard for %s\n",
1280db2a4165SFrank Mandarino 				codec->name);
128112e74f7dSLiam Girdwood 		goto out;
1282db2a4165SFrank Mandarino 	}
1283db2a4165SFrank Mandarino 
128408c8efe6SMark Brown 	mutex_lock(&codec->mutex);
1285db2a4165SFrank Mandarino #ifdef CONFIG_SND_SOC_AC97_BUS
128612e74f7dSLiam Girdwood 	if (ac97) {
128712e74f7dSLiam Girdwood 		ret = soc_ac97_dev_register(codec);
128812e74f7dSLiam Girdwood 		if (ret < 0) {
128912e74f7dSLiam Girdwood 			printk(KERN_ERR "asoc: AC97 device register failed\n");
129012e74f7dSLiam Girdwood 			snd_card_free(codec->card);
129108c8efe6SMark Brown 			mutex_unlock(&codec->mutex);
129212e74f7dSLiam Girdwood 			goto out;
129312e74f7dSLiam Girdwood 		}
129412e74f7dSLiam Girdwood 	}
1295db2a4165SFrank Mandarino #endif
1296db2a4165SFrank Mandarino 
129712e74f7dSLiam Girdwood 	err = snd_soc_dapm_sys_add(socdev->dev);
129812e74f7dSLiam Girdwood 	if (err < 0)
129912e74f7dSLiam Girdwood 		printk(KERN_WARNING "asoc: failed to add dapm sysfs entries\n");
130012e74f7dSLiam Girdwood 
130112e74f7dSLiam Girdwood 	err = device_create_file(socdev->dev, &dev_attr_codec_reg);
130212e74f7dSLiam Girdwood 	if (err < 0)
13033ff3f64bSMark Brown 		printk(KERN_WARNING "asoc: failed to add codec sysfs files\n");
130408c8efe6SMark Brown 
1305384c89e2SMark Brown 	soc_init_codec_debugfs(socdev->codec);
1306db2a4165SFrank Mandarino 	mutex_unlock(&codec->mutex);
130708c8efe6SMark Brown 
130808c8efe6SMark Brown out:
1309db2a4165SFrank Mandarino 	return ret;
1310db2a4165SFrank Mandarino }
1311968a6025SMark Brown EXPORT_SYMBOL_GPL(snd_soc_init_card);
1312db2a4165SFrank Mandarino 
1313db2a4165SFrank Mandarino /**
1314db2a4165SFrank Mandarino  * snd_soc_free_pcms - free sound card and pcms
1315db2a4165SFrank Mandarino  * @socdev: the SoC audio device
1316db2a4165SFrank Mandarino  *
1317db2a4165SFrank Mandarino  * Frees sound card and pcms associated with the socdev.
1318db2a4165SFrank Mandarino  * Also unregister the codec if it is an AC97 device.
1319db2a4165SFrank Mandarino  */
1320db2a4165SFrank Mandarino void snd_soc_free_pcms(struct snd_soc_device *socdev)
1321db2a4165SFrank Mandarino {
1322db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = socdev->codec;
1323a68660e0SLiam Girdwood #ifdef CONFIG_SND_SOC_AC97_BUS
13243c4b266fSLiam Girdwood 	struct snd_soc_dai *codec_dai;
1325a68660e0SLiam Girdwood 	int i;
1326a68660e0SLiam Girdwood #endif
1327db2a4165SFrank Mandarino 
1328db2a4165SFrank Mandarino 	mutex_lock(&codec->mutex);
1329384c89e2SMark Brown 	soc_cleanup_codec_debugfs(socdev->codec);
1330db2a4165SFrank Mandarino #ifdef CONFIG_SND_SOC_AC97_BUS
1331a68660e0SLiam Girdwood 	for (i = 0; i < codec->num_dai; i++) {
1332a68660e0SLiam Girdwood 		codec_dai = &codec->dai[i];
13333ba9e10aSMark Brown 		if (codec_dai->ac97_control && codec->ac97) {
1334db2a4165SFrank Mandarino 			soc_ac97_dev_unregister(codec);
1335a68660e0SLiam Girdwood 			goto free_card;
1336a68660e0SLiam Girdwood 		}
1337a68660e0SLiam Girdwood 	}
1338a68660e0SLiam Girdwood free_card:
1339db2a4165SFrank Mandarino #endif
1340db2a4165SFrank Mandarino 
1341db2a4165SFrank Mandarino 	if (codec->card)
1342db2a4165SFrank Mandarino 		snd_card_free(codec->card);
1343db2a4165SFrank Mandarino 	device_remove_file(socdev->dev, &dev_attr_codec_reg);
1344db2a4165SFrank Mandarino 	mutex_unlock(&codec->mutex);
1345db2a4165SFrank Mandarino }
1346db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_free_pcms);
1347db2a4165SFrank Mandarino 
1348db2a4165SFrank Mandarino /**
1349db2a4165SFrank Mandarino  * snd_soc_set_runtime_hwparams - set the runtime hardware parameters
1350db2a4165SFrank Mandarino  * @substream: the pcm substream
1351db2a4165SFrank Mandarino  * @hw: the hardware parameters
1352db2a4165SFrank Mandarino  *
1353db2a4165SFrank Mandarino  * Sets the substream runtime hardware parameters.
1354db2a4165SFrank Mandarino  */
1355db2a4165SFrank Mandarino int snd_soc_set_runtime_hwparams(struct snd_pcm_substream *substream,
1356db2a4165SFrank Mandarino 	const struct snd_pcm_hardware *hw)
1357db2a4165SFrank Mandarino {
1358db2a4165SFrank Mandarino 	struct snd_pcm_runtime *runtime = substream->runtime;
1359db2a4165SFrank Mandarino 	runtime->hw.info = hw->info;
1360db2a4165SFrank Mandarino 	runtime->hw.formats = hw->formats;
1361db2a4165SFrank Mandarino 	runtime->hw.period_bytes_min = hw->period_bytes_min;
1362db2a4165SFrank Mandarino 	runtime->hw.period_bytes_max = hw->period_bytes_max;
1363db2a4165SFrank Mandarino 	runtime->hw.periods_min = hw->periods_min;
1364db2a4165SFrank Mandarino 	runtime->hw.periods_max = hw->periods_max;
1365db2a4165SFrank Mandarino 	runtime->hw.buffer_bytes_max = hw->buffer_bytes_max;
1366db2a4165SFrank Mandarino 	runtime->hw.fifo_size = hw->fifo_size;
1367db2a4165SFrank Mandarino 	return 0;
1368db2a4165SFrank Mandarino }
1369db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_set_runtime_hwparams);
1370db2a4165SFrank Mandarino 
1371db2a4165SFrank Mandarino /**
1372db2a4165SFrank Mandarino  * snd_soc_cnew - create new control
1373db2a4165SFrank Mandarino  * @_template: control template
1374db2a4165SFrank Mandarino  * @data: control private data
1375db2a4165SFrank Mandarino  * @lnng_name: control long name
1376db2a4165SFrank Mandarino  *
1377db2a4165SFrank Mandarino  * Create a new mixer control from a template control.
1378db2a4165SFrank Mandarino  *
1379db2a4165SFrank Mandarino  * Returns 0 for success, else error.
1380db2a4165SFrank Mandarino  */
1381db2a4165SFrank Mandarino struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
1382db2a4165SFrank Mandarino 	void *data, char *long_name)
1383db2a4165SFrank Mandarino {
1384db2a4165SFrank Mandarino 	struct snd_kcontrol_new template;
1385db2a4165SFrank Mandarino 
1386db2a4165SFrank Mandarino 	memcpy(&template, _template, sizeof(template));
1387db2a4165SFrank Mandarino 	if (long_name)
1388db2a4165SFrank Mandarino 		template.name = long_name;
1389db2a4165SFrank Mandarino 	template.index = 0;
1390db2a4165SFrank Mandarino 
1391db2a4165SFrank Mandarino 	return snd_ctl_new1(&template, data);
1392db2a4165SFrank Mandarino }
1393db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_cnew);
1394db2a4165SFrank Mandarino 
1395db2a4165SFrank Mandarino /**
1396db2a4165SFrank Mandarino  * snd_soc_info_enum_double - enumerated double mixer info callback
1397db2a4165SFrank Mandarino  * @kcontrol: mixer control
1398db2a4165SFrank Mandarino  * @uinfo: control element information
1399db2a4165SFrank Mandarino  *
1400db2a4165SFrank Mandarino  * Callback to provide information about a double enumerated
1401db2a4165SFrank Mandarino  * mixer control.
1402db2a4165SFrank Mandarino  *
1403db2a4165SFrank Mandarino  * Returns 0 for success.
1404db2a4165SFrank Mandarino  */
1405db2a4165SFrank Mandarino int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol,
1406db2a4165SFrank Mandarino 	struct snd_ctl_elem_info *uinfo)
1407db2a4165SFrank Mandarino {
1408db2a4165SFrank Mandarino 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1409db2a4165SFrank Mandarino 
1410db2a4165SFrank Mandarino 	uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
1411db2a4165SFrank Mandarino 	uinfo->count = e->shift_l == e->shift_r ? 1 : 2;
1412f8ba0b7bSJon Smirl 	uinfo->value.enumerated.items = e->max;
1413db2a4165SFrank Mandarino 
1414f8ba0b7bSJon Smirl 	if (uinfo->value.enumerated.item > e->max - 1)
1415f8ba0b7bSJon Smirl 		uinfo->value.enumerated.item = e->max - 1;
1416db2a4165SFrank Mandarino 	strcpy(uinfo->value.enumerated.name,
1417db2a4165SFrank Mandarino 		e->texts[uinfo->value.enumerated.item]);
1418db2a4165SFrank Mandarino 	return 0;
1419db2a4165SFrank Mandarino }
1420db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_enum_double);
1421db2a4165SFrank Mandarino 
1422db2a4165SFrank Mandarino /**
1423db2a4165SFrank Mandarino  * snd_soc_get_enum_double - enumerated double mixer get callback
1424db2a4165SFrank Mandarino  * @kcontrol: mixer control
1425db2a4165SFrank Mandarino  * @uinfo: control element information
1426db2a4165SFrank Mandarino  *
1427db2a4165SFrank Mandarino  * Callback to get the value of a double enumerated mixer.
1428db2a4165SFrank Mandarino  *
1429db2a4165SFrank Mandarino  * Returns 0 for success.
1430db2a4165SFrank Mandarino  */
1431db2a4165SFrank Mandarino int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol,
1432db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
1433db2a4165SFrank Mandarino {
1434db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1435db2a4165SFrank Mandarino 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1436db2a4165SFrank Mandarino 	unsigned short val, bitmask;
1437db2a4165SFrank Mandarino 
1438f8ba0b7bSJon Smirl 	for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
1439db2a4165SFrank Mandarino 		;
1440db2a4165SFrank Mandarino 	val = snd_soc_read(codec, e->reg);
14413ff3f64bSMark Brown 	ucontrol->value.enumerated.item[0]
14423ff3f64bSMark Brown 		= (val >> e->shift_l) & (bitmask - 1);
1443db2a4165SFrank Mandarino 	if (e->shift_l != e->shift_r)
1444db2a4165SFrank Mandarino 		ucontrol->value.enumerated.item[1] =
1445db2a4165SFrank Mandarino 			(val >> e->shift_r) & (bitmask - 1);
1446db2a4165SFrank Mandarino 
1447db2a4165SFrank Mandarino 	return 0;
1448db2a4165SFrank Mandarino }
1449db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_get_enum_double);
1450db2a4165SFrank Mandarino 
1451db2a4165SFrank Mandarino /**
1452db2a4165SFrank Mandarino  * snd_soc_put_enum_double - enumerated double mixer put callback
1453db2a4165SFrank Mandarino  * @kcontrol: mixer control
1454db2a4165SFrank Mandarino  * @uinfo: control element information
1455db2a4165SFrank Mandarino  *
1456db2a4165SFrank Mandarino  * Callback to set the value of a double enumerated mixer.
1457db2a4165SFrank Mandarino  *
1458db2a4165SFrank Mandarino  * Returns 0 for success.
1459db2a4165SFrank Mandarino  */
1460db2a4165SFrank Mandarino int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol,
1461db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
1462db2a4165SFrank Mandarino {
1463db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1464db2a4165SFrank Mandarino 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1465db2a4165SFrank Mandarino 	unsigned short val;
1466db2a4165SFrank Mandarino 	unsigned short mask, bitmask;
1467db2a4165SFrank Mandarino 
1468f8ba0b7bSJon Smirl 	for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
1469db2a4165SFrank Mandarino 		;
1470f8ba0b7bSJon Smirl 	if (ucontrol->value.enumerated.item[0] > e->max - 1)
1471db2a4165SFrank Mandarino 		return -EINVAL;
1472db2a4165SFrank Mandarino 	val = ucontrol->value.enumerated.item[0] << e->shift_l;
1473db2a4165SFrank Mandarino 	mask = (bitmask - 1) << e->shift_l;
1474db2a4165SFrank Mandarino 	if (e->shift_l != e->shift_r) {
1475f8ba0b7bSJon Smirl 		if (ucontrol->value.enumerated.item[1] > e->max - 1)
1476db2a4165SFrank Mandarino 			return -EINVAL;
1477db2a4165SFrank Mandarino 		val |= ucontrol->value.enumerated.item[1] << e->shift_r;
1478db2a4165SFrank Mandarino 		mask |= (bitmask - 1) << e->shift_r;
1479db2a4165SFrank Mandarino 	}
1480db2a4165SFrank Mandarino 
1481db2a4165SFrank Mandarino 	return snd_soc_update_bits(codec, e->reg, mask, val);
1482db2a4165SFrank Mandarino }
1483db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
1484db2a4165SFrank Mandarino 
1485db2a4165SFrank Mandarino /**
1486db2a4165SFrank Mandarino  * snd_soc_info_enum_ext - external enumerated single mixer info callback
1487db2a4165SFrank Mandarino  * @kcontrol: mixer control
1488db2a4165SFrank Mandarino  * @uinfo: control element information
1489db2a4165SFrank Mandarino  *
1490db2a4165SFrank Mandarino  * Callback to provide information about an external enumerated
1491db2a4165SFrank Mandarino  * single mixer.
1492db2a4165SFrank Mandarino  *
1493db2a4165SFrank Mandarino  * Returns 0 for success.
1494db2a4165SFrank Mandarino  */
1495db2a4165SFrank Mandarino int snd_soc_info_enum_ext(struct snd_kcontrol *kcontrol,
1496db2a4165SFrank Mandarino 	struct snd_ctl_elem_info *uinfo)
1497db2a4165SFrank Mandarino {
1498db2a4165SFrank Mandarino 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1499db2a4165SFrank Mandarino 
1500db2a4165SFrank Mandarino 	uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
1501db2a4165SFrank Mandarino 	uinfo->count = 1;
1502f8ba0b7bSJon Smirl 	uinfo->value.enumerated.items = e->max;
1503db2a4165SFrank Mandarino 
1504f8ba0b7bSJon Smirl 	if (uinfo->value.enumerated.item > e->max - 1)
1505f8ba0b7bSJon Smirl 		uinfo->value.enumerated.item = e->max - 1;
1506db2a4165SFrank Mandarino 	strcpy(uinfo->value.enumerated.name,
1507db2a4165SFrank Mandarino 		e->texts[uinfo->value.enumerated.item]);
1508db2a4165SFrank Mandarino 	return 0;
1509db2a4165SFrank Mandarino }
1510db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_enum_ext);
1511db2a4165SFrank Mandarino 
1512db2a4165SFrank Mandarino /**
1513db2a4165SFrank Mandarino  * snd_soc_info_volsw_ext - external single mixer info callback
1514db2a4165SFrank Mandarino  * @kcontrol: mixer control
1515db2a4165SFrank Mandarino  * @uinfo: control element information
1516db2a4165SFrank Mandarino  *
1517db2a4165SFrank Mandarino  * Callback to provide information about a single external mixer control.
1518db2a4165SFrank Mandarino  *
1519db2a4165SFrank Mandarino  * Returns 0 for success.
1520db2a4165SFrank Mandarino  */
1521db2a4165SFrank Mandarino int snd_soc_info_volsw_ext(struct snd_kcontrol *kcontrol,
1522db2a4165SFrank Mandarino 	struct snd_ctl_elem_info *uinfo)
1523db2a4165SFrank Mandarino {
1524a7a4ac86SPhilipp Zabel 	int max = kcontrol->private_value;
1525db2a4165SFrank Mandarino 
1526a7a4ac86SPhilipp Zabel 	if (max == 1)
1527a7a4ac86SPhilipp Zabel 		uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
1528a7a4ac86SPhilipp Zabel 	else
1529a7a4ac86SPhilipp Zabel 		uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1530a7a4ac86SPhilipp Zabel 
1531db2a4165SFrank Mandarino 	uinfo->count = 1;
1532db2a4165SFrank Mandarino 	uinfo->value.integer.min = 0;
1533a7a4ac86SPhilipp Zabel 	uinfo->value.integer.max = max;
1534db2a4165SFrank Mandarino 	return 0;
1535db2a4165SFrank Mandarino }
1536db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_volsw_ext);
1537db2a4165SFrank Mandarino 
1538db2a4165SFrank Mandarino /**
1539db2a4165SFrank Mandarino  * snd_soc_info_volsw - single mixer info callback
1540db2a4165SFrank Mandarino  * @kcontrol: mixer control
1541db2a4165SFrank Mandarino  * @uinfo: control element information
1542db2a4165SFrank Mandarino  *
1543db2a4165SFrank Mandarino  * Callback to provide information about a single mixer control.
1544db2a4165SFrank Mandarino  *
1545db2a4165SFrank Mandarino  * Returns 0 for success.
1546db2a4165SFrank Mandarino  */
1547db2a4165SFrank Mandarino int snd_soc_info_volsw(struct snd_kcontrol *kcontrol,
1548db2a4165SFrank Mandarino 	struct snd_ctl_elem_info *uinfo)
1549db2a4165SFrank Mandarino {
15504eaa9819SJon Smirl 	struct soc_mixer_control *mc =
15514eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
15524eaa9819SJon Smirl 	int max = mc->max;
1553762b8df7SMark Brown 	unsigned int shift = mc->shift;
1554815ecf8dSJon Smirl 	unsigned int rshift = mc->rshift;
1555db2a4165SFrank Mandarino 
1556a7a4ac86SPhilipp Zabel 	if (max == 1)
1557a7a4ac86SPhilipp Zabel 		uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
1558a7a4ac86SPhilipp Zabel 	else
1559a7a4ac86SPhilipp Zabel 		uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1560a7a4ac86SPhilipp Zabel 
1561db2a4165SFrank Mandarino 	uinfo->count = shift == rshift ? 1 : 2;
1562db2a4165SFrank Mandarino 	uinfo->value.integer.min = 0;
1563a7a4ac86SPhilipp Zabel 	uinfo->value.integer.max = max;
1564db2a4165SFrank Mandarino 	return 0;
1565db2a4165SFrank Mandarino }
1566db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
1567db2a4165SFrank Mandarino 
1568db2a4165SFrank Mandarino /**
1569db2a4165SFrank Mandarino  * snd_soc_get_volsw - single mixer get callback
1570db2a4165SFrank Mandarino  * @kcontrol: mixer control
1571db2a4165SFrank Mandarino  * @uinfo: control element information
1572db2a4165SFrank Mandarino  *
1573db2a4165SFrank Mandarino  * Callback to get the value of a single mixer control.
1574db2a4165SFrank Mandarino  *
1575db2a4165SFrank Mandarino  * Returns 0 for success.
1576db2a4165SFrank Mandarino  */
1577db2a4165SFrank Mandarino int snd_soc_get_volsw(struct snd_kcontrol *kcontrol,
1578db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
1579db2a4165SFrank Mandarino {
15804eaa9819SJon Smirl 	struct soc_mixer_control *mc =
15814eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
1582db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1583815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
1584815ecf8dSJon Smirl 	unsigned int shift = mc->shift;
1585815ecf8dSJon Smirl 	unsigned int rshift = mc->rshift;
15864eaa9819SJon Smirl 	int max = mc->max;
1587815ecf8dSJon Smirl 	unsigned int mask = (1 << fls(max)) - 1;
1588815ecf8dSJon Smirl 	unsigned int invert = mc->invert;
1589db2a4165SFrank Mandarino 
1590db2a4165SFrank Mandarino 	ucontrol->value.integer.value[0] =
1591db2a4165SFrank Mandarino 		(snd_soc_read(codec, reg) >> shift) & mask;
1592db2a4165SFrank Mandarino 	if (shift != rshift)
1593db2a4165SFrank Mandarino 		ucontrol->value.integer.value[1] =
1594db2a4165SFrank Mandarino 			(snd_soc_read(codec, reg) >> rshift) & mask;
1595db2a4165SFrank Mandarino 	if (invert) {
1596db2a4165SFrank Mandarino 		ucontrol->value.integer.value[0] =
1597a7a4ac86SPhilipp Zabel 			max - ucontrol->value.integer.value[0];
1598db2a4165SFrank Mandarino 		if (shift != rshift)
1599db2a4165SFrank Mandarino 			ucontrol->value.integer.value[1] =
1600a7a4ac86SPhilipp Zabel 				max - ucontrol->value.integer.value[1];
1601db2a4165SFrank Mandarino 	}
1602db2a4165SFrank Mandarino 
1603db2a4165SFrank Mandarino 	return 0;
1604db2a4165SFrank Mandarino }
1605db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_get_volsw);
1606db2a4165SFrank Mandarino 
1607db2a4165SFrank Mandarino /**
1608db2a4165SFrank Mandarino  * snd_soc_put_volsw - single mixer put callback
1609db2a4165SFrank Mandarino  * @kcontrol: mixer control
1610db2a4165SFrank Mandarino  * @uinfo: control element information
1611db2a4165SFrank Mandarino  *
1612db2a4165SFrank Mandarino  * Callback to set the value of a single mixer control.
1613db2a4165SFrank Mandarino  *
1614db2a4165SFrank Mandarino  * Returns 0 for success.
1615db2a4165SFrank Mandarino  */
1616db2a4165SFrank Mandarino int snd_soc_put_volsw(struct snd_kcontrol *kcontrol,
1617db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
1618db2a4165SFrank Mandarino {
16194eaa9819SJon Smirl 	struct soc_mixer_control *mc =
16204eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
1621db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1622815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
1623815ecf8dSJon Smirl 	unsigned int shift = mc->shift;
1624815ecf8dSJon Smirl 	unsigned int rshift = mc->rshift;
16254eaa9819SJon Smirl 	int max = mc->max;
1626815ecf8dSJon Smirl 	unsigned int mask = (1 << fls(max)) - 1;
1627815ecf8dSJon Smirl 	unsigned int invert = mc->invert;
1628db2a4165SFrank Mandarino 	unsigned short val, val2, val_mask;
1629db2a4165SFrank Mandarino 
1630db2a4165SFrank Mandarino 	val = (ucontrol->value.integer.value[0] & mask);
1631db2a4165SFrank Mandarino 	if (invert)
1632a7a4ac86SPhilipp Zabel 		val = max - val;
1633db2a4165SFrank Mandarino 	val_mask = mask << shift;
1634db2a4165SFrank Mandarino 	val = val << shift;
1635db2a4165SFrank Mandarino 	if (shift != rshift) {
1636db2a4165SFrank Mandarino 		val2 = (ucontrol->value.integer.value[1] & mask);
1637db2a4165SFrank Mandarino 		if (invert)
1638a7a4ac86SPhilipp Zabel 			val2 = max - val2;
1639db2a4165SFrank Mandarino 		val_mask |= mask << rshift;
1640db2a4165SFrank Mandarino 		val |= val2 << rshift;
1641db2a4165SFrank Mandarino 	}
1642a7a4ac86SPhilipp Zabel 	return snd_soc_update_bits(codec, reg, val_mask, val);
1643db2a4165SFrank Mandarino }
1644db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_put_volsw);
1645db2a4165SFrank Mandarino 
1646db2a4165SFrank Mandarino /**
1647db2a4165SFrank Mandarino  * snd_soc_info_volsw_2r - double mixer info callback
1648db2a4165SFrank Mandarino  * @kcontrol: mixer control
1649db2a4165SFrank Mandarino  * @uinfo: control element information
1650db2a4165SFrank Mandarino  *
1651db2a4165SFrank Mandarino  * Callback to provide information about a double mixer control that
1652db2a4165SFrank Mandarino  * spans 2 codec registers.
1653db2a4165SFrank Mandarino  *
1654db2a4165SFrank Mandarino  * Returns 0 for success.
1655db2a4165SFrank Mandarino  */
1656db2a4165SFrank Mandarino int snd_soc_info_volsw_2r(struct snd_kcontrol *kcontrol,
1657db2a4165SFrank Mandarino 	struct snd_ctl_elem_info *uinfo)
1658db2a4165SFrank Mandarino {
16594eaa9819SJon Smirl 	struct soc_mixer_control *mc =
16604eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
16614eaa9819SJon Smirl 	int max = mc->max;
1662db2a4165SFrank Mandarino 
1663a7a4ac86SPhilipp Zabel 	if (max == 1)
1664a7a4ac86SPhilipp Zabel 		uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
1665a7a4ac86SPhilipp Zabel 	else
1666a7a4ac86SPhilipp Zabel 		uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1667a7a4ac86SPhilipp Zabel 
1668db2a4165SFrank Mandarino 	uinfo->count = 2;
1669db2a4165SFrank Mandarino 	uinfo->value.integer.min = 0;
1670a7a4ac86SPhilipp Zabel 	uinfo->value.integer.max = max;
1671db2a4165SFrank Mandarino 	return 0;
1672db2a4165SFrank Mandarino }
1673db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_volsw_2r);
1674db2a4165SFrank Mandarino 
1675db2a4165SFrank Mandarino /**
1676db2a4165SFrank Mandarino  * snd_soc_get_volsw_2r - double mixer get callback
1677db2a4165SFrank Mandarino  * @kcontrol: mixer control
1678db2a4165SFrank Mandarino  * @uinfo: control element information
1679db2a4165SFrank Mandarino  *
1680db2a4165SFrank Mandarino  * Callback to get the value of a double mixer control that spans 2 registers.
1681db2a4165SFrank Mandarino  *
1682db2a4165SFrank Mandarino  * Returns 0 for success.
1683db2a4165SFrank Mandarino  */
1684db2a4165SFrank Mandarino int snd_soc_get_volsw_2r(struct snd_kcontrol *kcontrol,
1685db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
1686db2a4165SFrank Mandarino {
16874eaa9819SJon Smirl 	struct soc_mixer_control *mc =
16884eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
1689db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1690815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
1691815ecf8dSJon Smirl 	unsigned int reg2 = mc->rreg;
1692815ecf8dSJon Smirl 	unsigned int shift = mc->shift;
16934eaa9819SJon Smirl 	int max = mc->max;
1694815ecf8dSJon Smirl 	unsigned int mask = (1<<fls(max))-1;
1695815ecf8dSJon Smirl 	unsigned int invert = mc->invert;
1696db2a4165SFrank Mandarino 
1697db2a4165SFrank Mandarino 	ucontrol->value.integer.value[0] =
1698db2a4165SFrank Mandarino 		(snd_soc_read(codec, reg) >> shift) & mask;
1699db2a4165SFrank Mandarino 	ucontrol->value.integer.value[1] =
1700db2a4165SFrank Mandarino 		(snd_soc_read(codec, reg2) >> shift) & mask;
1701db2a4165SFrank Mandarino 	if (invert) {
1702db2a4165SFrank Mandarino 		ucontrol->value.integer.value[0] =
1703a7a4ac86SPhilipp Zabel 			max - ucontrol->value.integer.value[0];
1704db2a4165SFrank Mandarino 		ucontrol->value.integer.value[1] =
1705a7a4ac86SPhilipp Zabel 			max - ucontrol->value.integer.value[1];
1706db2a4165SFrank Mandarino 	}
1707db2a4165SFrank Mandarino 
1708db2a4165SFrank Mandarino 	return 0;
1709db2a4165SFrank Mandarino }
1710db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_get_volsw_2r);
1711db2a4165SFrank Mandarino 
1712db2a4165SFrank Mandarino /**
1713db2a4165SFrank Mandarino  * snd_soc_put_volsw_2r - double mixer set callback
1714db2a4165SFrank Mandarino  * @kcontrol: mixer control
1715db2a4165SFrank Mandarino  * @uinfo: control element information
1716db2a4165SFrank Mandarino  *
1717db2a4165SFrank Mandarino  * Callback to set the value of a double mixer control that spans 2 registers.
1718db2a4165SFrank Mandarino  *
1719db2a4165SFrank Mandarino  * Returns 0 for success.
1720db2a4165SFrank Mandarino  */
1721db2a4165SFrank Mandarino int snd_soc_put_volsw_2r(struct snd_kcontrol *kcontrol,
1722db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
1723db2a4165SFrank Mandarino {
17244eaa9819SJon Smirl 	struct soc_mixer_control *mc =
17254eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
1726db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1727815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
1728815ecf8dSJon Smirl 	unsigned int reg2 = mc->rreg;
1729815ecf8dSJon Smirl 	unsigned int shift = mc->shift;
17304eaa9819SJon Smirl 	int max = mc->max;
1731815ecf8dSJon Smirl 	unsigned int mask = (1 << fls(max)) - 1;
1732815ecf8dSJon Smirl 	unsigned int invert = mc->invert;
1733db2a4165SFrank Mandarino 	int err;
1734db2a4165SFrank Mandarino 	unsigned short val, val2, val_mask;
1735db2a4165SFrank Mandarino 
1736db2a4165SFrank Mandarino 	val_mask = mask << shift;
1737db2a4165SFrank Mandarino 	val = (ucontrol->value.integer.value[0] & mask);
1738db2a4165SFrank Mandarino 	val2 = (ucontrol->value.integer.value[1] & mask);
1739db2a4165SFrank Mandarino 
1740db2a4165SFrank Mandarino 	if (invert) {
1741a7a4ac86SPhilipp Zabel 		val = max - val;
1742a7a4ac86SPhilipp Zabel 		val2 = max - val2;
1743db2a4165SFrank Mandarino 	}
1744db2a4165SFrank Mandarino 
1745db2a4165SFrank Mandarino 	val = val << shift;
1746db2a4165SFrank Mandarino 	val2 = val2 << shift;
1747db2a4165SFrank Mandarino 
17483ff3f64bSMark Brown 	err = snd_soc_update_bits(codec, reg, val_mask, val);
17493ff3f64bSMark Brown 	if (err < 0)
1750db2a4165SFrank Mandarino 		return err;
1751db2a4165SFrank Mandarino 
1752db2a4165SFrank Mandarino 	err = snd_soc_update_bits(codec, reg2, val_mask, val2);
1753db2a4165SFrank Mandarino 	return err;
1754db2a4165SFrank Mandarino }
1755db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r);
1756db2a4165SFrank Mandarino 
1757e13ac2e9SMark Brown /**
1758e13ac2e9SMark Brown  * snd_soc_info_volsw_s8 - signed mixer info callback
1759e13ac2e9SMark Brown  * @kcontrol: mixer control
1760e13ac2e9SMark Brown  * @uinfo: control element information
1761e13ac2e9SMark Brown  *
1762e13ac2e9SMark Brown  * Callback to provide information about a signed mixer control.
1763e13ac2e9SMark Brown  *
1764e13ac2e9SMark Brown  * Returns 0 for success.
1765e13ac2e9SMark Brown  */
1766e13ac2e9SMark Brown int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol,
1767e13ac2e9SMark Brown 	struct snd_ctl_elem_info *uinfo)
1768e13ac2e9SMark Brown {
17694eaa9819SJon Smirl 	struct soc_mixer_control *mc =
17704eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
17714eaa9819SJon Smirl 	int max = mc->max;
17724eaa9819SJon Smirl 	int min = mc->min;
1773e13ac2e9SMark Brown 
1774e13ac2e9SMark Brown 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1775e13ac2e9SMark Brown 	uinfo->count = 2;
1776e13ac2e9SMark Brown 	uinfo->value.integer.min = 0;
1777e13ac2e9SMark Brown 	uinfo->value.integer.max = max-min;
1778e13ac2e9SMark Brown 	return 0;
1779e13ac2e9SMark Brown }
1780e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8);
1781e13ac2e9SMark Brown 
1782e13ac2e9SMark Brown /**
1783e13ac2e9SMark Brown  * snd_soc_get_volsw_s8 - signed mixer get callback
1784e13ac2e9SMark Brown  * @kcontrol: mixer control
1785e13ac2e9SMark Brown  * @uinfo: control element information
1786e13ac2e9SMark Brown  *
1787e13ac2e9SMark Brown  * Callback to get the value of a signed mixer control.
1788e13ac2e9SMark Brown  *
1789e13ac2e9SMark Brown  * Returns 0 for success.
1790e13ac2e9SMark Brown  */
1791e13ac2e9SMark Brown int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol,
1792e13ac2e9SMark Brown 	struct snd_ctl_elem_value *ucontrol)
1793e13ac2e9SMark Brown {
17944eaa9819SJon Smirl 	struct soc_mixer_control *mc =
17954eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
1796e13ac2e9SMark Brown 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1797815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
17984eaa9819SJon Smirl 	int min = mc->min;
1799e13ac2e9SMark Brown 	int val = snd_soc_read(codec, reg);
1800e13ac2e9SMark Brown 
1801e13ac2e9SMark Brown 	ucontrol->value.integer.value[0] =
1802e13ac2e9SMark Brown 		((signed char)(val & 0xff))-min;
1803e13ac2e9SMark Brown 	ucontrol->value.integer.value[1] =
1804e13ac2e9SMark Brown 		((signed char)((val >> 8) & 0xff))-min;
1805e13ac2e9SMark Brown 	return 0;
1806e13ac2e9SMark Brown }
1807e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8);
1808e13ac2e9SMark Brown 
1809e13ac2e9SMark Brown /**
1810e13ac2e9SMark Brown  * snd_soc_put_volsw_sgn - signed mixer put callback
1811e13ac2e9SMark Brown  * @kcontrol: mixer control
1812e13ac2e9SMark Brown  * @uinfo: control element information
1813e13ac2e9SMark Brown  *
1814e13ac2e9SMark Brown  * Callback to set the value of a signed mixer control.
1815e13ac2e9SMark Brown  *
1816e13ac2e9SMark Brown  * Returns 0 for success.
1817e13ac2e9SMark Brown  */
1818e13ac2e9SMark Brown int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol,
1819e13ac2e9SMark Brown 	struct snd_ctl_elem_value *ucontrol)
1820e13ac2e9SMark Brown {
18214eaa9819SJon Smirl 	struct soc_mixer_control *mc =
18224eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
1823e13ac2e9SMark Brown 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1824815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
18254eaa9819SJon Smirl 	int min = mc->min;
1826e13ac2e9SMark Brown 	unsigned short val;
1827e13ac2e9SMark Brown 
1828e13ac2e9SMark Brown 	val = (ucontrol->value.integer.value[0]+min) & 0xff;
1829e13ac2e9SMark Brown 	val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8;
1830e13ac2e9SMark Brown 
1831e13ac2e9SMark Brown 	return snd_soc_update_bits(codec, reg, 0xffff, val);
1832e13ac2e9SMark Brown }
1833e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8);
1834e13ac2e9SMark Brown 
18358c6529dbSLiam Girdwood /**
18368c6529dbSLiam Girdwood  * snd_soc_dai_set_sysclk - configure DAI system or master clock.
18378c6529dbSLiam Girdwood  * @dai: DAI
18388c6529dbSLiam Girdwood  * @clk_id: DAI specific clock ID
18398c6529dbSLiam Girdwood  * @freq: new clock frequency in Hz
18408c6529dbSLiam Girdwood  * @dir: new clock direction - input/output.
18418c6529dbSLiam Girdwood  *
18428c6529dbSLiam Girdwood  * Configures the DAI master (MCLK) or system (SYSCLK) clocking.
18438c6529dbSLiam Girdwood  */
18448c6529dbSLiam Girdwood int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
18458c6529dbSLiam Girdwood 	unsigned int freq, int dir)
18468c6529dbSLiam Girdwood {
1847dee89c4dSMark Brown 	if (dai->ops.set_sysclk)
1848dee89c4dSMark Brown 		return dai->ops.set_sysclk(dai, clk_id, freq, dir);
18498c6529dbSLiam Girdwood 	else
18508c6529dbSLiam Girdwood 		return -EINVAL;
18518c6529dbSLiam Girdwood }
18528c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk);
18538c6529dbSLiam Girdwood 
18548c6529dbSLiam Girdwood /**
18558c6529dbSLiam Girdwood  * snd_soc_dai_set_clkdiv - configure DAI clock dividers.
18568c6529dbSLiam Girdwood  * @dai: DAI
18578c6529dbSLiam Girdwood  * @clk_id: DAI specific clock divider ID
18588c6529dbSLiam Girdwood  * @div: new clock divisor.
18598c6529dbSLiam Girdwood  *
18608c6529dbSLiam Girdwood  * Configures the clock dividers. This is used to derive the best DAI bit and
18618c6529dbSLiam Girdwood  * frame clocks from the system or master clock. It's best to set the DAI bit
18628c6529dbSLiam Girdwood  * and frame clocks as low as possible to save system power.
18638c6529dbSLiam Girdwood  */
18648c6529dbSLiam Girdwood int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai,
18658c6529dbSLiam Girdwood 	int div_id, int div)
18668c6529dbSLiam Girdwood {
1867dee89c4dSMark Brown 	if (dai->ops.set_clkdiv)
1868dee89c4dSMark Brown 		return dai->ops.set_clkdiv(dai, div_id, div);
18698c6529dbSLiam Girdwood 	else
18708c6529dbSLiam Girdwood 		return -EINVAL;
18718c6529dbSLiam Girdwood }
18728c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_clkdiv);
18738c6529dbSLiam Girdwood 
18748c6529dbSLiam Girdwood /**
18758c6529dbSLiam Girdwood  * snd_soc_dai_set_pll - configure DAI PLL.
18768c6529dbSLiam Girdwood  * @dai: DAI
18778c6529dbSLiam Girdwood  * @pll_id: DAI specific PLL ID
18788c6529dbSLiam Girdwood  * @freq_in: PLL input clock frequency in Hz
18798c6529dbSLiam Girdwood  * @freq_out: requested PLL output clock frequency in Hz
18808c6529dbSLiam Girdwood  *
18818c6529dbSLiam Girdwood  * Configures and enables PLL to generate output clock based on input clock.
18828c6529dbSLiam Girdwood  */
18838c6529dbSLiam Girdwood int snd_soc_dai_set_pll(struct snd_soc_dai *dai,
18848c6529dbSLiam Girdwood 	int pll_id, unsigned int freq_in, unsigned int freq_out)
18858c6529dbSLiam Girdwood {
1886dee89c4dSMark Brown 	if (dai->ops.set_pll)
1887dee89c4dSMark Brown 		return dai->ops.set_pll(dai, pll_id, freq_in, freq_out);
18888c6529dbSLiam Girdwood 	else
18898c6529dbSLiam Girdwood 		return -EINVAL;
18908c6529dbSLiam Girdwood }
18918c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll);
18928c6529dbSLiam Girdwood 
18938c6529dbSLiam Girdwood /**
18948c6529dbSLiam Girdwood  * snd_soc_dai_set_fmt - configure DAI hardware audio format.
18958c6529dbSLiam Girdwood  * @dai: DAI
18968c6529dbSLiam Girdwood  * @fmt: SND_SOC_DAIFMT_ format value.
18978c6529dbSLiam Girdwood  *
18988c6529dbSLiam Girdwood  * Configures the DAI hardware format and clocking.
18998c6529dbSLiam Girdwood  */
19008c6529dbSLiam Girdwood int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
19018c6529dbSLiam Girdwood {
1902dee89c4dSMark Brown 	if (dai->ops.set_fmt)
1903dee89c4dSMark Brown 		return dai->ops.set_fmt(dai, fmt);
19048c6529dbSLiam Girdwood 	else
19058c6529dbSLiam Girdwood 		return -EINVAL;
19068c6529dbSLiam Girdwood }
19078c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt);
19088c6529dbSLiam Girdwood 
19098c6529dbSLiam Girdwood /**
19108c6529dbSLiam Girdwood  * snd_soc_dai_set_tdm_slot - configure DAI TDM.
19118c6529dbSLiam Girdwood  * @dai: DAI
19128c6529dbSLiam Girdwood  * @mask: DAI specific mask representing used slots.
19138c6529dbSLiam Girdwood  * @slots: Number of slots in use.
19148c6529dbSLiam Girdwood  *
19158c6529dbSLiam Girdwood  * Configures a DAI for TDM operation. Both mask and slots are codec and DAI
19168c6529dbSLiam Girdwood  * specific.
19178c6529dbSLiam Girdwood  */
19188c6529dbSLiam Girdwood int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai,
19198c6529dbSLiam Girdwood 	unsigned int mask, int slots)
19208c6529dbSLiam Girdwood {
1921dee89c4dSMark Brown 	if (dai->ops.set_sysclk)
1922dee89c4dSMark Brown 		return dai->ops.set_tdm_slot(dai, mask, slots);
19238c6529dbSLiam Girdwood 	else
19248c6529dbSLiam Girdwood 		return -EINVAL;
19258c6529dbSLiam Girdwood }
19268c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot);
19278c6529dbSLiam Girdwood 
19288c6529dbSLiam Girdwood /**
19298c6529dbSLiam Girdwood  * snd_soc_dai_set_tristate - configure DAI system or master clock.
19308c6529dbSLiam Girdwood  * @dai: DAI
19318c6529dbSLiam Girdwood  * @tristate: tristate enable
19328c6529dbSLiam Girdwood  *
19338c6529dbSLiam Girdwood  * Tristates the DAI so that others can use it.
19348c6529dbSLiam Girdwood  */
19358c6529dbSLiam Girdwood int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate)
19368c6529dbSLiam Girdwood {
1937dee89c4dSMark Brown 	if (dai->ops.set_sysclk)
1938dee89c4dSMark Brown 		return dai->ops.set_tristate(dai, tristate);
19398c6529dbSLiam Girdwood 	else
19408c6529dbSLiam Girdwood 		return -EINVAL;
19418c6529dbSLiam Girdwood }
19428c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_tristate);
19438c6529dbSLiam Girdwood 
19448c6529dbSLiam Girdwood /**
19458c6529dbSLiam Girdwood  * snd_soc_dai_digital_mute - configure DAI system or master clock.
19468c6529dbSLiam Girdwood  * @dai: DAI
19478c6529dbSLiam Girdwood  * @mute: mute enable
19488c6529dbSLiam Girdwood  *
19498c6529dbSLiam Girdwood  * Mutes the DAI DAC.
19508c6529dbSLiam Girdwood  */
19518c6529dbSLiam Girdwood int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute)
19528c6529dbSLiam Girdwood {
1953dee89c4dSMark Brown 	if (dai->ops.digital_mute)
1954dee89c4dSMark Brown 		return dai->ops.digital_mute(dai, mute);
19558c6529dbSLiam Girdwood 	else
19568c6529dbSLiam Girdwood 		return -EINVAL;
19578c6529dbSLiam Girdwood }
19588c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute);
19598c6529dbSLiam Girdwood 
1960db2a4165SFrank Mandarino static int __devinit snd_soc_init(void)
1961db2a4165SFrank Mandarino {
1962384c89e2SMark Brown #ifdef CONFIG_DEBUG_FS
1963384c89e2SMark Brown 	debugfs_root = debugfs_create_dir("asoc", NULL);
1964384c89e2SMark Brown 	if (IS_ERR(debugfs_root) || !debugfs_root) {
1965384c89e2SMark Brown 		printk(KERN_WARNING
1966384c89e2SMark Brown 		       "ASoC: Failed to create debugfs directory\n");
1967384c89e2SMark Brown 		debugfs_root = NULL;
1968384c89e2SMark Brown 	}
1969384c89e2SMark Brown #endif
1970384c89e2SMark Brown 
1971db2a4165SFrank Mandarino 	return platform_driver_register(&soc_driver);
1972db2a4165SFrank Mandarino }
1973db2a4165SFrank Mandarino 
19747d8c16a6SMark Brown static void __exit snd_soc_exit(void)
1975db2a4165SFrank Mandarino {
1976384c89e2SMark Brown #ifdef CONFIG_DEBUG_FS
1977384c89e2SMark Brown 	debugfs_remove_recursive(debugfs_root);
1978384c89e2SMark Brown #endif
1979db2a4165SFrank Mandarino 	platform_driver_unregister(&soc_driver);
1980db2a4165SFrank Mandarino }
1981db2a4165SFrank Mandarino 
1982db2a4165SFrank Mandarino module_init(snd_soc_init);
1983db2a4165SFrank Mandarino module_exit(snd_soc_exit);
1984db2a4165SFrank Mandarino 
1985db2a4165SFrank Mandarino /* Module information */
1986d331124dSLiam Girdwood MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
1987db2a4165SFrank Mandarino MODULE_DESCRIPTION("ALSA SoC Core");
1988db2a4165SFrank Mandarino MODULE_LICENSE("GPL");
19898b45a209SKay Sievers MODULE_ALIAS("platform:soc-audio");
1990