xref: /linux/sound/soc/ti/n810.c (revision f7554cb47ef1edf9c0000c5a96897cc9bd1f054b)
1f2055e14SPeter Ujfalusi /*
2f2055e14SPeter Ujfalusi  * n810.c  --  SoC audio for Nokia N810
3f2055e14SPeter Ujfalusi  *
4f2055e14SPeter Ujfalusi  * Copyright (C) 2008 Nokia Corporation
5f2055e14SPeter Ujfalusi  *
6f2055e14SPeter Ujfalusi  * Contact: Jarkko Nikula <jarkko.nikula@bitmer.com>
7f2055e14SPeter Ujfalusi  *
8f2055e14SPeter Ujfalusi  * This program is free software; you can redistribute it and/or
9f2055e14SPeter Ujfalusi  * modify it under the terms of the GNU General Public License
10f2055e14SPeter Ujfalusi  * version 2 as published by the Free Software Foundation.
11f2055e14SPeter Ujfalusi  *
12f2055e14SPeter Ujfalusi  * This program is distributed in the hope that it will be useful, but
13f2055e14SPeter Ujfalusi  * WITHOUT ANY WARRANTY; without even the implied warranty of
14f2055e14SPeter Ujfalusi  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15f2055e14SPeter Ujfalusi  * General Public License for more details.
16f2055e14SPeter Ujfalusi  *
17f2055e14SPeter Ujfalusi  * You should have received a copy of the GNU General Public License
18f2055e14SPeter Ujfalusi  * along with this program; if not, write to the Free Software
19f2055e14SPeter Ujfalusi  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
20f2055e14SPeter Ujfalusi  * 02110-1301 USA
21f2055e14SPeter Ujfalusi  *
22f2055e14SPeter Ujfalusi  */
23f2055e14SPeter Ujfalusi 
24f2055e14SPeter Ujfalusi #include <linux/clk.h>
25f2055e14SPeter Ujfalusi #include <linux/i2c.h>
26f2055e14SPeter Ujfalusi #include <linux/platform_device.h>
27f2055e14SPeter Ujfalusi #include <sound/core.h>
28f2055e14SPeter Ujfalusi #include <sound/pcm.h>
29f2055e14SPeter Ujfalusi #include <sound/soc.h>
30f2055e14SPeter Ujfalusi 
31f2055e14SPeter Ujfalusi #include <asm/mach-types.h>
32f2055e14SPeter Ujfalusi #include <linux/gpio.h>
33f2055e14SPeter Ujfalusi #include <linux/module.h>
34f2055e14SPeter Ujfalusi #include <linux/platform_data/asoc-ti-mcbsp.h>
35f2055e14SPeter Ujfalusi 
36f2055e14SPeter Ujfalusi #include "omap-mcbsp.h"
37f2055e14SPeter Ujfalusi 
38f2055e14SPeter Ujfalusi #define N810_HEADSET_AMP_GPIO	10
39f2055e14SPeter Ujfalusi #define N810_SPEAKER_AMP_GPIO	101
40f2055e14SPeter Ujfalusi 
41f2055e14SPeter Ujfalusi enum {
42f2055e14SPeter Ujfalusi 	N810_JACK_DISABLED,
43f2055e14SPeter Ujfalusi 	N810_JACK_HP,
44f2055e14SPeter Ujfalusi 	N810_JACK_HS,
45f2055e14SPeter Ujfalusi 	N810_JACK_MIC,
46f2055e14SPeter Ujfalusi };
47f2055e14SPeter Ujfalusi 
48f2055e14SPeter Ujfalusi static struct clk *sys_clkout2;
49f2055e14SPeter Ujfalusi static struct clk *sys_clkout2_src;
50f2055e14SPeter Ujfalusi static struct clk *func96m_clk;
51f2055e14SPeter Ujfalusi 
52f2055e14SPeter Ujfalusi static int n810_spk_func;
53f2055e14SPeter Ujfalusi static int n810_jack_func;
54f2055e14SPeter Ujfalusi static int n810_dmic_func;
55f2055e14SPeter Ujfalusi 
56f2055e14SPeter Ujfalusi static void n810_ext_control(struct snd_soc_dapm_context *dapm)
57f2055e14SPeter Ujfalusi {
58f2055e14SPeter Ujfalusi 	int hp = 0, line1l = 0;
59f2055e14SPeter Ujfalusi 
60f2055e14SPeter Ujfalusi 	switch (n810_jack_func) {
61f2055e14SPeter Ujfalusi 	case N810_JACK_HS:
62f2055e14SPeter Ujfalusi 		line1l = 1;
63f2055e14SPeter Ujfalusi 	case N810_JACK_HP:
64f2055e14SPeter Ujfalusi 		hp = 1;
65f2055e14SPeter Ujfalusi 		break;
66f2055e14SPeter Ujfalusi 	case N810_JACK_MIC:
67f2055e14SPeter Ujfalusi 		line1l = 1;
68f2055e14SPeter Ujfalusi 		break;
69f2055e14SPeter Ujfalusi 	}
70f2055e14SPeter Ujfalusi 
71f2055e14SPeter Ujfalusi 	snd_soc_dapm_mutex_lock(dapm);
72f2055e14SPeter Ujfalusi 
73f2055e14SPeter Ujfalusi 	if (n810_spk_func)
74f2055e14SPeter Ujfalusi 		snd_soc_dapm_enable_pin_unlocked(dapm, "Ext Spk");
75f2055e14SPeter Ujfalusi 	else
76f2055e14SPeter Ujfalusi 		snd_soc_dapm_disable_pin_unlocked(dapm, "Ext Spk");
77f2055e14SPeter Ujfalusi 
78f2055e14SPeter Ujfalusi 	if (hp)
79f2055e14SPeter Ujfalusi 		snd_soc_dapm_enable_pin_unlocked(dapm, "Headphone Jack");
80f2055e14SPeter Ujfalusi 	else
81f2055e14SPeter Ujfalusi 		snd_soc_dapm_disable_pin_unlocked(dapm, "Headphone Jack");
82f2055e14SPeter Ujfalusi 	if (line1l)
83f2055e14SPeter Ujfalusi 		snd_soc_dapm_enable_pin_unlocked(dapm, "HS Mic");
84f2055e14SPeter Ujfalusi 	else
85f2055e14SPeter Ujfalusi 		snd_soc_dapm_disable_pin_unlocked(dapm, "HS Mic");
86f2055e14SPeter Ujfalusi 
87f2055e14SPeter Ujfalusi 	if (n810_dmic_func)
88f2055e14SPeter Ujfalusi 		snd_soc_dapm_enable_pin_unlocked(dapm, "DMic");
89f2055e14SPeter Ujfalusi 	else
90f2055e14SPeter Ujfalusi 		snd_soc_dapm_disable_pin_unlocked(dapm, "DMic");
91f2055e14SPeter Ujfalusi 
92f2055e14SPeter Ujfalusi 	snd_soc_dapm_sync_unlocked(dapm);
93f2055e14SPeter Ujfalusi 
94f2055e14SPeter Ujfalusi 	snd_soc_dapm_mutex_unlock(dapm);
95f2055e14SPeter Ujfalusi }
96f2055e14SPeter Ujfalusi 
97f2055e14SPeter Ujfalusi static int n810_startup(struct snd_pcm_substream *substream)
98f2055e14SPeter Ujfalusi {
99f2055e14SPeter Ujfalusi 	struct snd_pcm_runtime *runtime = substream->runtime;
100f2055e14SPeter Ujfalusi 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
101f2055e14SPeter Ujfalusi 
102f2055e14SPeter Ujfalusi 	snd_pcm_hw_constraint_single(runtime, SNDRV_PCM_HW_PARAM_CHANNELS, 2);
103f2055e14SPeter Ujfalusi 
104f2055e14SPeter Ujfalusi 	n810_ext_control(&rtd->card->dapm);
105f2055e14SPeter Ujfalusi 	return clk_prepare_enable(sys_clkout2);
106f2055e14SPeter Ujfalusi }
107f2055e14SPeter Ujfalusi 
108f2055e14SPeter Ujfalusi static void n810_shutdown(struct snd_pcm_substream *substream)
109f2055e14SPeter Ujfalusi {
110f2055e14SPeter Ujfalusi 	clk_disable_unprepare(sys_clkout2);
111f2055e14SPeter Ujfalusi }
112f2055e14SPeter Ujfalusi 
113f2055e14SPeter Ujfalusi static int n810_hw_params(struct snd_pcm_substream *substream,
114f2055e14SPeter Ujfalusi 	struct snd_pcm_hw_params *params)
115f2055e14SPeter Ujfalusi {
116f2055e14SPeter Ujfalusi 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
117f2055e14SPeter Ujfalusi 	struct snd_soc_dai *codec_dai = rtd->codec_dai;
118f2055e14SPeter Ujfalusi 	int err;
119f2055e14SPeter Ujfalusi 
120f2055e14SPeter Ujfalusi 	/* Set the codec system clock for DAC and ADC */
121f2055e14SPeter Ujfalusi 	err = snd_soc_dai_set_sysclk(codec_dai, 0, 12000000,
122f2055e14SPeter Ujfalusi 					    SND_SOC_CLOCK_IN);
123f2055e14SPeter Ujfalusi 
124f2055e14SPeter Ujfalusi 	return err;
125f2055e14SPeter Ujfalusi }
126f2055e14SPeter Ujfalusi 
127f2055e14SPeter Ujfalusi static const struct snd_soc_ops n810_ops = {
128f2055e14SPeter Ujfalusi 	.startup = n810_startup,
129f2055e14SPeter Ujfalusi 	.hw_params = n810_hw_params,
130f2055e14SPeter Ujfalusi 	.shutdown = n810_shutdown,
131f2055e14SPeter Ujfalusi };
132f2055e14SPeter Ujfalusi 
133f2055e14SPeter Ujfalusi static int n810_get_spk(struct snd_kcontrol *kcontrol,
134f2055e14SPeter Ujfalusi 			struct snd_ctl_elem_value *ucontrol)
135f2055e14SPeter Ujfalusi {
136f2055e14SPeter Ujfalusi 	ucontrol->value.enumerated.item[0] = n810_spk_func;
137f2055e14SPeter Ujfalusi 
138f2055e14SPeter Ujfalusi 	return 0;
139f2055e14SPeter Ujfalusi }
140f2055e14SPeter Ujfalusi 
141f2055e14SPeter Ujfalusi static int n810_set_spk(struct snd_kcontrol *kcontrol,
142f2055e14SPeter Ujfalusi 			struct snd_ctl_elem_value *ucontrol)
143f2055e14SPeter Ujfalusi {
144f2055e14SPeter Ujfalusi 	struct snd_soc_card *card =  snd_kcontrol_chip(kcontrol);
145f2055e14SPeter Ujfalusi 
146f2055e14SPeter Ujfalusi 	if (n810_spk_func == ucontrol->value.enumerated.item[0])
147f2055e14SPeter Ujfalusi 		return 0;
148f2055e14SPeter Ujfalusi 
149f2055e14SPeter Ujfalusi 	n810_spk_func = ucontrol->value.enumerated.item[0];
150f2055e14SPeter Ujfalusi 	n810_ext_control(&card->dapm);
151f2055e14SPeter Ujfalusi 
152f2055e14SPeter Ujfalusi 	return 1;
153f2055e14SPeter Ujfalusi }
154f2055e14SPeter Ujfalusi 
155f2055e14SPeter Ujfalusi static int n810_get_jack(struct snd_kcontrol *kcontrol,
156f2055e14SPeter Ujfalusi 			 struct snd_ctl_elem_value *ucontrol)
157f2055e14SPeter Ujfalusi {
158f2055e14SPeter Ujfalusi 	ucontrol->value.enumerated.item[0] = n810_jack_func;
159f2055e14SPeter Ujfalusi 
160f2055e14SPeter Ujfalusi 	return 0;
161f2055e14SPeter Ujfalusi }
162f2055e14SPeter Ujfalusi 
163f2055e14SPeter Ujfalusi static int n810_set_jack(struct snd_kcontrol *kcontrol,
164f2055e14SPeter Ujfalusi 			 struct snd_ctl_elem_value *ucontrol)
165f2055e14SPeter Ujfalusi {
166f2055e14SPeter Ujfalusi 	struct snd_soc_card *card =  snd_kcontrol_chip(kcontrol);
167f2055e14SPeter Ujfalusi 
168f2055e14SPeter Ujfalusi 	if (n810_jack_func == ucontrol->value.enumerated.item[0])
169f2055e14SPeter Ujfalusi 		return 0;
170f2055e14SPeter Ujfalusi 
171f2055e14SPeter Ujfalusi 	n810_jack_func = ucontrol->value.enumerated.item[0];
172f2055e14SPeter Ujfalusi 	n810_ext_control(&card->dapm);
173f2055e14SPeter Ujfalusi 
174f2055e14SPeter Ujfalusi 	return 1;
175f2055e14SPeter Ujfalusi }
176f2055e14SPeter Ujfalusi 
177f2055e14SPeter Ujfalusi static int n810_get_input(struct snd_kcontrol *kcontrol,
178f2055e14SPeter Ujfalusi 			  struct snd_ctl_elem_value *ucontrol)
179f2055e14SPeter Ujfalusi {
180f2055e14SPeter Ujfalusi 	ucontrol->value.enumerated.item[0] = n810_dmic_func;
181f2055e14SPeter Ujfalusi 
182f2055e14SPeter Ujfalusi 	return 0;
183f2055e14SPeter Ujfalusi }
184f2055e14SPeter Ujfalusi 
185f2055e14SPeter Ujfalusi static int n810_set_input(struct snd_kcontrol *kcontrol,
186f2055e14SPeter Ujfalusi 			  struct snd_ctl_elem_value *ucontrol)
187f2055e14SPeter Ujfalusi {
188f2055e14SPeter Ujfalusi 	struct snd_soc_card *card =  snd_kcontrol_chip(kcontrol);
189f2055e14SPeter Ujfalusi 
190f2055e14SPeter Ujfalusi 	if (n810_dmic_func == ucontrol->value.enumerated.item[0])
191f2055e14SPeter Ujfalusi 		return 0;
192f2055e14SPeter Ujfalusi 
193f2055e14SPeter Ujfalusi 	n810_dmic_func = ucontrol->value.enumerated.item[0];
194f2055e14SPeter Ujfalusi 	n810_ext_control(&card->dapm);
195f2055e14SPeter Ujfalusi 
196f2055e14SPeter Ujfalusi 	return 1;
197f2055e14SPeter Ujfalusi }
198f2055e14SPeter Ujfalusi 
199f2055e14SPeter Ujfalusi static int n810_spk_event(struct snd_soc_dapm_widget *w,
200f2055e14SPeter Ujfalusi 			  struct snd_kcontrol *k, int event)
201f2055e14SPeter Ujfalusi {
202f2055e14SPeter Ujfalusi 	if (SND_SOC_DAPM_EVENT_ON(event))
203f2055e14SPeter Ujfalusi 		gpio_set_value(N810_SPEAKER_AMP_GPIO, 1);
204f2055e14SPeter Ujfalusi 	else
205f2055e14SPeter Ujfalusi 		gpio_set_value(N810_SPEAKER_AMP_GPIO, 0);
206f2055e14SPeter Ujfalusi 
207f2055e14SPeter Ujfalusi 	return 0;
208f2055e14SPeter Ujfalusi }
209f2055e14SPeter Ujfalusi 
210f2055e14SPeter Ujfalusi static int n810_jack_event(struct snd_soc_dapm_widget *w,
211f2055e14SPeter Ujfalusi 			   struct snd_kcontrol *k, int event)
212f2055e14SPeter Ujfalusi {
213f2055e14SPeter Ujfalusi 	if (SND_SOC_DAPM_EVENT_ON(event))
214f2055e14SPeter Ujfalusi 		gpio_set_value(N810_HEADSET_AMP_GPIO, 1);
215f2055e14SPeter Ujfalusi 	else
216f2055e14SPeter Ujfalusi 		gpio_set_value(N810_HEADSET_AMP_GPIO, 0);
217f2055e14SPeter Ujfalusi 
218f2055e14SPeter Ujfalusi 	return 0;
219f2055e14SPeter Ujfalusi }
220f2055e14SPeter Ujfalusi 
221f2055e14SPeter Ujfalusi static const struct snd_soc_dapm_widget aic33_dapm_widgets[] = {
222f2055e14SPeter Ujfalusi 	SND_SOC_DAPM_SPK("Ext Spk", n810_spk_event),
223f2055e14SPeter Ujfalusi 	SND_SOC_DAPM_HP("Headphone Jack", n810_jack_event),
224f2055e14SPeter Ujfalusi 	SND_SOC_DAPM_MIC("DMic", NULL),
225f2055e14SPeter Ujfalusi 	SND_SOC_DAPM_MIC("HS Mic", NULL),
226f2055e14SPeter Ujfalusi };
227f2055e14SPeter Ujfalusi 
228f2055e14SPeter Ujfalusi static const struct snd_soc_dapm_route audio_map[] = {
229f2055e14SPeter Ujfalusi 	{"Headphone Jack", NULL, "HPLOUT"},
230f2055e14SPeter Ujfalusi 	{"Headphone Jack", NULL, "HPROUT"},
231f2055e14SPeter Ujfalusi 
232f2055e14SPeter Ujfalusi 	{"Ext Spk", NULL, "LLOUT"},
233f2055e14SPeter Ujfalusi 	{"Ext Spk", NULL, "RLOUT"},
234f2055e14SPeter Ujfalusi 
235f2055e14SPeter Ujfalusi 	{"DMic Rate 64", NULL, "DMic"},
236f2055e14SPeter Ujfalusi 	{"DMic", NULL, "Mic Bias"},
237f2055e14SPeter Ujfalusi 
238f2055e14SPeter Ujfalusi 	/*
239f2055e14SPeter Ujfalusi 	 * Note that the mic bias is coming from Retu/Vilma and we don't have
240f2055e14SPeter Ujfalusi 	 * control over it atm. The analog HS mic is not working. <- TODO
241f2055e14SPeter Ujfalusi 	 */
242f2055e14SPeter Ujfalusi 	{"LINE1L", NULL, "HS Mic"},
243f2055e14SPeter Ujfalusi };
244f2055e14SPeter Ujfalusi 
245f2055e14SPeter Ujfalusi static const char *spk_function[] = {"Off", "On"};
246f2055e14SPeter Ujfalusi static const char *jack_function[] = {"Off", "Headphone", "Headset", "Mic"};
247f2055e14SPeter Ujfalusi static const char *input_function[] = {"ADC", "Digital Mic"};
248f2055e14SPeter Ujfalusi static const struct soc_enum n810_enum[] = {
249f2055e14SPeter Ujfalusi 	SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(spk_function), spk_function),
250f2055e14SPeter Ujfalusi 	SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(jack_function), jack_function),
251f2055e14SPeter Ujfalusi 	SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(input_function), input_function),
252f2055e14SPeter Ujfalusi };
253f2055e14SPeter Ujfalusi 
254f2055e14SPeter Ujfalusi static const struct snd_kcontrol_new aic33_n810_controls[] = {
255f2055e14SPeter Ujfalusi 	SOC_ENUM_EXT("Speaker Function", n810_enum[0],
256f2055e14SPeter Ujfalusi 		     n810_get_spk, n810_set_spk),
257f2055e14SPeter Ujfalusi 	SOC_ENUM_EXT("Jack Function", n810_enum[1],
258f2055e14SPeter Ujfalusi 		     n810_get_jack, n810_set_jack),
259f2055e14SPeter Ujfalusi 	SOC_ENUM_EXT("Input Select",  n810_enum[2],
260f2055e14SPeter Ujfalusi 		     n810_get_input, n810_set_input),
261f2055e14SPeter Ujfalusi };
262f2055e14SPeter Ujfalusi 
263f2055e14SPeter Ujfalusi /* Digital audio interface glue - connects codec <--> CPU */
264*f7554cb4SKuninori Morimoto SND_SOC_DAILINK_DEFS(aic33,
265*f7554cb4SKuninori Morimoto 	DAILINK_COMP_ARRAY(COMP_CPU("48076000.mcbsp")),
266*f7554cb4SKuninori Morimoto 	DAILINK_COMP_ARRAY(COMP_CODEC("tlv320aic3x-codec.1-0018",
267*f7554cb4SKuninori Morimoto 				      "tlv320aic3x-hifi")),
268*f7554cb4SKuninori Morimoto 	DAILINK_COMP_ARRAY(COMP_PLATFORM("48076000.mcbsp")));
269*f7554cb4SKuninori Morimoto 
270f2055e14SPeter Ujfalusi static struct snd_soc_dai_link n810_dai = {
271f2055e14SPeter Ujfalusi 	.name = "TLV320AIC33",
272f2055e14SPeter Ujfalusi 	.stream_name = "AIC33",
273f2055e14SPeter Ujfalusi 	.dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
274f2055e14SPeter Ujfalusi 		   SND_SOC_DAIFMT_CBM_CFM,
275f2055e14SPeter Ujfalusi 	.ops = &n810_ops,
276*f7554cb4SKuninori Morimoto 	SND_SOC_DAILINK_REG(aic33),
277f2055e14SPeter Ujfalusi };
278f2055e14SPeter Ujfalusi 
279f2055e14SPeter Ujfalusi /* Audio machine driver */
280f2055e14SPeter Ujfalusi static struct snd_soc_card snd_soc_n810 = {
281f2055e14SPeter Ujfalusi 	.name = "N810",
282f2055e14SPeter Ujfalusi 	.owner = THIS_MODULE,
283f2055e14SPeter Ujfalusi 	.dai_link = &n810_dai,
284f2055e14SPeter Ujfalusi 	.num_links = 1,
285f2055e14SPeter Ujfalusi 
286f2055e14SPeter Ujfalusi 	.controls = aic33_n810_controls,
287f2055e14SPeter Ujfalusi 	.num_controls = ARRAY_SIZE(aic33_n810_controls),
288f2055e14SPeter Ujfalusi 	.dapm_widgets = aic33_dapm_widgets,
289f2055e14SPeter Ujfalusi 	.num_dapm_widgets = ARRAY_SIZE(aic33_dapm_widgets),
290f2055e14SPeter Ujfalusi 	.dapm_routes = audio_map,
291f2055e14SPeter Ujfalusi 	.num_dapm_routes = ARRAY_SIZE(audio_map),
292f2055e14SPeter Ujfalusi 	.fully_routed = true,
293f2055e14SPeter Ujfalusi };
294f2055e14SPeter Ujfalusi 
295f2055e14SPeter Ujfalusi static struct platform_device *n810_snd_device;
296f2055e14SPeter Ujfalusi 
297f2055e14SPeter Ujfalusi static int __init n810_soc_init(void)
298f2055e14SPeter Ujfalusi {
299f2055e14SPeter Ujfalusi 	int err;
300f2055e14SPeter Ujfalusi 	struct device *dev;
301f2055e14SPeter Ujfalusi 
302f2055e14SPeter Ujfalusi 	if (!of_have_populated_dt() ||
303f2055e14SPeter Ujfalusi 	    (!of_machine_is_compatible("nokia,n810") &&
304f2055e14SPeter Ujfalusi 	     !of_machine_is_compatible("nokia,n810-wimax")))
305f2055e14SPeter Ujfalusi 		return -ENODEV;
306f2055e14SPeter Ujfalusi 
307f2055e14SPeter Ujfalusi 	n810_snd_device = platform_device_alloc("soc-audio", -1);
308f2055e14SPeter Ujfalusi 	if (!n810_snd_device)
309f2055e14SPeter Ujfalusi 		return -ENOMEM;
310f2055e14SPeter Ujfalusi 
311f2055e14SPeter Ujfalusi 	platform_set_drvdata(n810_snd_device, &snd_soc_n810);
312f2055e14SPeter Ujfalusi 	err = platform_device_add(n810_snd_device);
313f2055e14SPeter Ujfalusi 	if (err)
314f2055e14SPeter Ujfalusi 		goto err1;
315f2055e14SPeter Ujfalusi 
316f2055e14SPeter Ujfalusi 	dev = &n810_snd_device->dev;
317f2055e14SPeter Ujfalusi 
318f2055e14SPeter Ujfalusi 	sys_clkout2_src = clk_get(dev, "sys_clkout2_src");
319f2055e14SPeter Ujfalusi 	if (IS_ERR(sys_clkout2_src)) {
320f2055e14SPeter Ujfalusi 		dev_err(dev, "Could not get sys_clkout2_src clock\n");
321f2055e14SPeter Ujfalusi 		err = PTR_ERR(sys_clkout2_src);
322f2055e14SPeter Ujfalusi 		goto err2;
323f2055e14SPeter Ujfalusi 	}
324f2055e14SPeter Ujfalusi 	sys_clkout2 = clk_get(dev, "sys_clkout2");
325f2055e14SPeter Ujfalusi 	if (IS_ERR(sys_clkout2)) {
326f2055e14SPeter Ujfalusi 		dev_err(dev, "Could not get sys_clkout2\n");
327f2055e14SPeter Ujfalusi 		err = PTR_ERR(sys_clkout2);
328f2055e14SPeter Ujfalusi 		goto err3;
329f2055e14SPeter Ujfalusi 	}
330f2055e14SPeter Ujfalusi 	/*
331f2055e14SPeter Ujfalusi 	 * Configure 12 MHz output on SYS_CLKOUT2. Therefore we must use
332f2055e14SPeter Ujfalusi 	 * 96 MHz as its parent in order to get 12 MHz
333f2055e14SPeter Ujfalusi 	 */
334f2055e14SPeter Ujfalusi 	func96m_clk = clk_get(dev, "func_96m_ck");
335f2055e14SPeter Ujfalusi 	if (IS_ERR(func96m_clk)) {
336f2055e14SPeter Ujfalusi 		dev_err(dev, "Could not get func 96M clock\n");
337f2055e14SPeter Ujfalusi 		err = PTR_ERR(func96m_clk);
338f2055e14SPeter Ujfalusi 		goto err4;
339f2055e14SPeter Ujfalusi 	}
340f2055e14SPeter Ujfalusi 	clk_set_parent(sys_clkout2_src, func96m_clk);
341f2055e14SPeter Ujfalusi 	clk_set_rate(sys_clkout2, 12000000);
342f2055e14SPeter Ujfalusi 
343f2055e14SPeter Ujfalusi 	if (WARN_ON((gpio_request(N810_HEADSET_AMP_GPIO, "hs_amp") < 0) ||
344f2055e14SPeter Ujfalusi 		    (gpio_request(N810_SPEAKER_AMP_GPIO, "spk_amp") < 0))) {
345f2055e14SPeter Ujfalusi 		err = -EINVAL;
346f2055e14SPeter Ujfalusi 		goto err4;
347f2055e14SPeter Ujfalusi 	}
348f2055e14SPeter Ujfalusi 
349f2055e14SPeter Ujfalusi 	gpio_direction_output(N810_HEADSET_AMP_GPIO, 0);
350f2055e14SPeter Ujfalusi 	gpio_direction_output(N810_SPEAKER_AMP_GPIO, 0);
351f2055e14SPeter Ujfalusi 
352f2055e14SPeter Ujfalusi 	return 0;
353f2055e14SPeter Ujfalusi err4:
354f2055e14SPeter Ujfalusi 	clk_put(sys_clkout2);
355f2055e14SPeter Ujfalusi err3:
356f2055e14SPeter Ujfalusi 	clk_put(sys_clkout2_src);
357f2055e14SPeter Ujfalusi err2:
358f2055e14SPeter Ujfalusi 	platform_device_del(n810_snd_device);
359f2055e14SPeter Ujfalusi err1:
360f2055e14SPeter Ujfalusi 	platform_device_put(n810_snd_device);
361f2055e14SPeter Ujfalusi 
362f2055e14SPeter Ujfalusi 	return err;
363f2055e14SPeter Ujfalusi }
364f2055e14SPeter Ujfalusi 
365f2055e14SPeter Ujfalusi static void __exit n810_soc_exit(void)
366f2055e14SPeter Ujfalusi {
367f2055e14SPeter Ujfalusi 	gpio_free(N810_SPEAKER_AMP_GPIO);
368f2055e14SPeter Ujfalusi 	gpio_free(N810_HEADSET_AMP_GPIO);
369f2055e14SPeter Ujfalusi 	clk_put(sys_clkout2_src);
370f2055e14SPeter Ujfalusi 	clk_put(sys_clkout2);
371f2055e14SPeter Ujfalusi 	clk_put(func96m_clk);
372f2055e14SPeter Ujfalusi 
373f2055e14SPeter Ujfalusi 	platform_device_unregister(n810_snd_device);
374f2055e14SPeter Ujfalusi }
375f2055e14SPeter Ujfalusi 
376f2055e14SPeter Ujfalusi module_init(n810_soc_init);
377f2055e14SPeter Ujfalusi module_exit(n810_soc_exit);
378f2055e14SPeter Ujfalusi 
379f2055e14SPeter Ujfalusi MODULE_AUTHOR("Jarkko Nikula <jarkko.nikula@bitmer.com>");
380f2055e14SPeter Ujfalusi MODULE_DESCRIPTION("ALSA SoC Nokia N810");
381f2055e14SPeter Ujfalusi MODULE_LICENSE("GPL");
382