blob: 249cd230ad8f13e62aeeb30d18d301ff2e776384 [file] [log] [blame]
Jarkko Nikula49100c92010-05-05 11:14:22 +03001/*
2 * rx51.c -- SoC audio for Nokia RX-51
3 *
4 * Copyright (C) 2008 - 2009 Nokia Corporation
5 *
Peter Ujfalusi0ac3a012011-05-03 18:15:10 +03006 * Contact: Peter Ujfalusi <peter.ujfalusi@ti.com>
Jarkko Nikula49100c92010-05-05 11:14:22 +03007 * Eduardo Valentin <eduardo.valentin@nokia.com>
Jarkko Nikula7ec41ee2011-08-11 15:44:57 +03008 * Jarkko Nikula <jarkko.nikula@bitmer.com>
Jarkko Nikula49100c92010-05-05 11:14:22 +03009 *
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License
12 * version 2 as published by the Free Software Foundation.
13 *
14 * This program is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17 * General Public License for more details.
18 *
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
22 * 02110-1301 USA
23 *
24 */
25
26#include <linux/delay.h>
27#include <linux/gpio.h>
28#include <linux/platform_device.h>
Paul Gortmakerda155d52011-07-15 12:38:28 -040029#include <linux/module.h>
Jarkko Nikula49100c92010-05-05 11:14:22 +030030#include <sound/core.h>
Jarkko Nikula8c523112010-06-21 14:15:00 +030031#include <sound/jack.h>
Jarkko Nikula49100c92010-05-05 11:14:22 +030032#include <sound/pcm.h>
33#include <sound/soc.h>
Arnd Bergmann22037472012-08-24 15:21:06 +020034#include <linux/platform_data/asoc-ti-mcbsp.h>
Jarkko Nikula48529b32011-01-27 16:47:11 +020035#include "../codecs/tpa6130a2.h"
Jarkko Nikula49100c92010-05-05 11:14:22 +030036
37#include <asm/mach-types.h>
38
39#include "omap-mcbsp.h"
Jarkko Nikula49100c92010-05-05 11:14:22 +030040
Jarkko Nikula4eb54702010-06-21 14:14:59 +030041#define RX51_TVOUT_SEL_GPIO 40
Jarkko Nikula8c523112010-06-21 14:15:00 +030042#define RX51_JACK_DETECT_GPIO 177
Jarkko Nikula31164c72011-02-14 17:20:21 +020043#define RX51_ECI_SW_GPIO 182
Jarkko Nikula49100c92010-05-05 11:14:22 +030044/*
45 * REVISIT: TWL4030 GPIO base in RX-51. Now statically defined to 192. This
46 * gpio is reserved in arch/arm/mach-omap2/board-rx51-peripherals.c
47 */
48#define RX51_SPEAKER_AMP_TWL_GPIO (192 + 7)
49
Jarkko Nikula4eb54702010-06-21 14:14:59 +030050enum {
51 RX51_JACK_DISABLED,
Jarkko Nikula48529b32011-01-27 16:47:11 +020052 RX51_JACK_TVOUT, /* tv-out with stereo output */
53 RX51_JACK_HP, /* headphone: stereo output, no mic */
Jarkko Nikula31164c72011-02-14 17:20:21 +020054 RX51_JACK_HS, /* headset: stereo output with mic */
Jarkko Nikula4eb54702010-06-21 14:14:59 +030055};
56
Jarkko Nikula49100c92010-05-05 11:14:22 +030057static int rx51_spk_func;
58static int rx51_dmic_func;
Jarkko Nikula4eb54702010-06-21 14:14:59 +030059static int rx51_jack_func;
Jarkko Nikula49100c92010-05-05 11:14:22 +030060
Liam Girdwood022658b2012-02-03 17:43:09 +000061static void rx51_ext_control(struct snd_soc_dapm_context *dapm)
Jarkko Nikula49100c92010-05-05 11:14:22 +030062{
Jarkko Nikula31164c72011-02-14 17:20:21 +020063 int hp = 0, hs = 0, tvout = 0;
Jarkko Nikula48529b32011-01-27 16:47:11 +020064
65 switch (rx51_jack_func) {
66 case RX51_JACK_TVOUT:
67 tvout = 1;
Jarkko Nikula31164c72011-02-14 17:20:21 +020068 hp = 1;
69 break;
70 case RX51_JACK_HS:
71 hs = 1;
Jarkko Nikula48529b32011-01-27 16:47:11 +020072 case RX51_JACK_HP:
73 hp = 1;
74 break;
75 }
Liam Girdwoodce6120c2010-11-05 15:53:46 +020076
Jarkko Nikula49100c92010-05-05 11:14:22 +030077 if (rx51_spk_func)
Liam Girdwoodce6120c2010-11-05 15:53:46 +020078 snd_soc_dapm_enable_pin(dapm, "Ext Spk");
Jarkko Nikula49100c92010-05-05 11:14:22 +030079 else
Liam Girdwoodce6120c2010-11-05 15:53:46 +020080 snd_soc_dapm_disable_pin(dapm, "Ext Spk");
Jarkko Nikula49100c92010-05-05 11:14:22 +030081 if (rx51_dmic_func)
Liam Girdwoodce6120c2010-11-05 15:53:46 +020082 snd_soc_dapm_enable_pin(dapm, "DMic");
Jarkko Nikula49100c92010-05-05 11:14:22 +030083 else
Liam Girdwoodce6120c2010-11-05 15:53:46 +020084 snd_soc_dapm_disable_pin(dapm, "DMic");
Jarkko Nikula48529b32011-01-27 16:47:11 +020085 if (hp)
86 snd_soc_dapm_enable_pin(dapm, "Headphone Jack");
87 else
88 snd_soc_dapm_disable_pin(dapm, "Headphone Jack");
Jarkko Nikula31164c72011-02-14 17:20:21 +020089 if (hs)
90 snd_soc_dapm_enable_pin(dapm, "HS Mic");
91 else
92 snd_soc_dapm_disable_pin(dapm, "HS Mic");
Jarkko Nikula49100c92010-05-05 11:14:22 +030093
Jarkko Nikula48529b32011-01-27 16:47:11 +020094 gpio_set_value(RX51_TVOUT_SEL_GPIO, tvout);
Jarkko Nikula4eb54702010-06-21 14:14:59 +030095
Liam Girdwoodce6120c2010-11-05 15:53:46 +020096 snd_soc_dapm_sync(dapm);
Jarkko Nikula49100c92010-05-05 11:14:22 +030097}
98
99static int rx51_startup(struct snd_pcm_substream *substream)
100{
101 struct snd_pcm_runtime *runtime = substream->runtime;
102 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwood022658b2012-02-03 17:43:09 +0000103 struct snd_soc_card *card = rtd->card;
Jarkko Nikula49100c92010-05-05 11:14:22 +0300104
105 snd_pcm_hw_constraint_minmax(runtime,
106 SNDRV_PCM_HW_PARAM_CHANNELS, 2, 2);
Liam Girdwood022658b2012-02-03 17:43:09 +0000107 rx51_ext_control(&card->dapm);
Jarkko Nikula49100c92010-05-05 11:14:22 +0300108
109 return 0;
110}
111
112static int rx51_hw_params(struct snd_pcm_substream *substream,
113 struct snd_pcm_hw_params *params)
114{
115 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000116 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Jarkko Nikula49100c92010-05-05 11:14:22 +0300117
118 /* Set the codec system clock for DAC and ADC */
119 return snd_soc_dai_set_sysclk(codec_dai, 0, 19200000,
120 SND_SOC_CLOCK_IN);
121}
122
123static struct snd_soc_ops rx51_ops = {
124 .startup = rx51_startup,
125 .hw_params = rx51_hw_params,
126};
127
128static int rx51_get_spk(struct snd_kcontrol *kcontrol,
129 struct snd_ctl_elem_value *ucontrol)
130{
131 ucontrol->value.integer.value[0] = rx51_spk_func;
132
133 return 0;
134}
135
136static int rx51_set_spk(struct snd_kcontrol *kcontrol,
137 struct snd_ctl_elem_value *ucontrol)
138{
Liam Girdwood022658b2012-02-03 17:43:09 +0000139 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
Jarkko Nikula49100c92010-05-05 11:14:22 +0300140
141 if (rx51_spk_func == ucontrol->value.integer.value[0])
142 return 0;
143
144 rx51_spk_func = ucontrol->value.integer.value[0];
Liam Girdwood022658b2012-02-03 17:43:09 +0000145 rx51_ext_control(&card->dapm);
Jarkko Nikula49100c92010-05-05 11:14:22 +0300146
147 return 1;
148}
149
150static int rx51_spk_event(struct snd_soc_dapm_widget *w,
151 struct snd_kcontrol *k, int event)
152{
153 if (SND_SOC_DAPM_EVENT_ON(event))
Jarkko Nikula4fff7a52010-08-23 10:36:41 +0300154 gpio_set_value_cansleep(RX51_SPEAKER_AMP_TWL_GPIO, 1);
Jarkko Nikula49100c92010-05-05 11:14:22 +0300155 else
Jarkko Nikula4fff7a52010-08-23 10:36:41 +0300156 gpio_set_value_cansleep(RX51_SPEAKER_AMP_TWL_GPIO, 0);
Jarkko Nikula49100c92010-05-05 11:14:22 +0300157
158 return 0;
159}
160
Jarkko Nikula48529b32011-01-27 16:47:11 +0200161static int rx51_hp_event(struct snd_soc_dapm_widget *w,
162 struct snd_kcontrol *k, int event)
163{
164 struct snd_soc_codec *codec = w->dapm->codec;
165
166 if (SND_SOC_DAPM_EVENT_ON(event))
167 tpa6130a2_stereo_enable(codec, 1);
168 else
169 tpa6130a2_stereo_enable(codec, 0);
170
171 return 0;
172}
173
Jarkko Nikula49100c92010-05-05 11:14:22 +0300174static int rx51_get_input(struct snd_kcontrol *kcontrol,
175 struct snd_ctl_elem_value *ucontrol)
176{
177 ucontrol->value.integer.value[0] = rx51_dmic_func;
178
179 return 0;
180}
181
182static int rx51_set_input(struct snd_kcontrol *kcontrol,
183 struct snd_ctl_elem_value *ucontrol)
184{
Liam Girdwood022658b2012-02-03 17:43:09 +0000185 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
Jarkko Nikula49100c92010-05-05 11:14:22 +0300186
187 if (rx51_dmic_func == ucontrol->value.integer.value[0])
188 return 0;
189
190 rx51_dmic_func = ucontrol->value.integer.value[0];
Liam Girdwood022658b2012-02-03 17:43:09 +0000191 rx51_ext_control(&card->dapm);
Jarkko Nikula49100c92010-05-05 11:14:22 +0300192
193 return 1;
194}
195
Jarkko Nikula4eb54702010-06-21 14:14:59 +0300196static int rx51_get_jack(struct snd_kcontrol *kcontrol,
197 struct snd_ctl_elem_value *ucontrol)
198{
199 ucontrol->value.integer.value[0] = rx51_jack_func;
200
201 return 0;
202}
203
204static int rx51_set_jack(struct snd_kcontrol *kcontrol,
205 struct snd_ctl_elem_value *ucontrol)
206{
Liam Girdwood022658b2012-02-03 17:43:09 +0000207 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
Jarkko Nikula4eb54702010-06-21 14:14:59 +0300208
209 if (rx51_jack_func == ucontrol->value.integer.value[0])
210 return 0;
211
212 rx51_jack_func = ucontrol->value.integer.value[0];
Liam Girdwood022658b2012-02-03 17:43:09 +0000213 rx51_ext_control(&card->dapm);
Jarkko Nikula4eb54702010-06-21 14:14:59 +0300214
215 return 1;
216}
217
Jarkko Nikula8c523112010-06-21 14:15:00 +0300218static struct snd_soc_jack rx51_av_jack;
219
220static struct snd_soc_jack_gpio rx51_av_jack_gpios[] = {
221 {
222 .gpio = RX51_JACK_DETECT_GPIO,
223 .name = "avdet-gpio",
Jarkko Nikula17840612011-02-14 17:20:22 +0200224 .report = SND_JACK_HEADSET,
Jarkko Nikula8c523112010-06-21 14:15:00 +0300225 .invert = 1,
226 .debounce_time = 200,
227 },
228};
229
Jarkko Nikula49100c92010-05-05 11:14:22 +0300230static const struct snd_soc_dapm_widget aic34_dapm_widgets[] = {
231 SND_SOC_DAPM_SPK("Ext Spk", rx51_spk_event),
232 SND_SOC_DAPM_MIC("DMic", NULL),
Jarkko Nikula48529b32011-01-27 16:47:11 +0200233 SND_SOC_DAPM_HP("Headphone Jack", rx51_hp_event),
Jarkko Nikula31164c72011-02-14 17:20:21 +0200234 SND_SOC_DAPM_MIC("HS Mic", NULL),
Jarkko Nikula9d7e5842011-02-21 14:57:22 +0200235 SND_SOC_DAPM_LINE("FM Transmitter", NULL),
Jarkko Nikula49100c92010-05-05 11:14:22 +0300236};
237
Jarkko Nikula8cda9752011-01-31 14:43:48 +0200238static const struct snd_soc_dapm_widget aic34_dapm_widgetsb[] = {
239 SND_SOC_DAPM_SPK("Earphone", NULL),
240};
241
Jarkko Nikula49100c92010-05-05 11:14:22 +0300242static const struct snd_soc_dapm_route audio_map[] = {
243 {"Ext Spk", NULL, "HPLOUT"},
244 {"Ext Spk", NULL, "HPROUT"},
Jarkko Nikula48529b32011-01-27 16:47:11 +0200245 {"Headphone Jack", NULL, "LLOUT"},
246 {"Headphone Jack", NULL, "RLOUT"},
Jarkko Nikula9d7e5842011-02-21 14:57:22 +0200247 {"FM Transmitter", NULL, "LLOUT"},
248 {"FM Transmitter", NULL, "RLOUT"},
Jarkko Nikula49100c92010-05-05 11:14:22 +0300249
Hebbar Gururajae2e8bfd2013-01-31 18:23:04 +0530250 {"DMic Rate 64", NULL, "Mic Bias"},
251 {"Mic Bias", NULL, "DMic"},
Jarkko Nikula49100c92010-05-05 11:14:22 +0300252};
253
Jarkko Nikula8cda9752011-01-31 14:43:48 +0200254static const struct snd_soc_dapm_route audio_mapb[] = {
255 {"b LINE2R", NULL, "MONO_LOUT"},
256 {"Earphone", NULL, "b HPLOUT"},
Jarkko Nikula31164c72011-02-14 17:20:21 +0200257
Hebbar Gururajae2e8bfd2013-01-31 18:23:04 +0530258 {"LINE1L", NULL, "b Mic Bias"},
259 {"b Mic Bias", NULL, "HS Mic"}
Jarkko Nikula8cda9752011-01-31 14:43:48 +0200260};
261
Jarkko Nikula49100c92010-05-05 11:14:22 +0300262static const char *spk_function[] = {"Off", "On"};
263static const char *input_function[] = {"ADC", "Digital Mic"};
Jarkko Nikula31164c72011-02-14 17:20:21 +0200264static const char *jack_function[] = {"Off", "TV-OUT", "Headphone", "Headset"};
Jarkko Nikula49100c92010-05-05 11:14:22 +0300265
266static const struct soc_enum rx51_enum[] = {
267 SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(spk_function), spk_function),
268 SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(input_function), input_function),
Jarkko Nikula4eb54702010-06-21 14:14:59 +0300269 SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(jack_function), jack_function),
Jarkko Nikula49100c92010-05-05 11:14:22 +0300270};
271
272static const struct snd_kcontrol_new aic34_rx51_controls[] = {
273 SOC_ENUM_EXT("Speaker Function", rx51_enum[0],
274 rx51_get_spk, rx51_set_spk),
275 SOC_ENUM_EXT("Input Select", rx51_enum[1],
276 rx51_get_input, rx51_set_input),
Jarkko Nikula4eb54702010-06-21 14:14:59 +0300277 SOC_ENUM_EXT("Jack Function", rx51_enum[2],
278 rx51_get_jack, rx51_set_jack),
Jarkko Nikula9d7e5842011-02-21 14:57:22 +0200279 SOC_DAPM_PIN_SWITCH("FM Transmitter"),
Jarkko Nikula49100c92010-05-05 11:14:22 +0300280};
281
Jarkko Nikula8cda9752011-01-31 14:43:48 +0200282static const struct snd_kcontrol_new aic34_rx51_controlsb[] = {
283 SOC_DAPM_PIN_SWITCH("Earphone"),
284};
285
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000286static int rx51_aic34_init(struct snd_soc_pcm_runtime *rtd)
Jarkko Nikula49100c92010-05-05 11:14:22 +0300287{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000288 struct snd_soc_codec *codec = rtd->codec;
Liam Girdwoodce6120c2010-11-05 15:53:46 +0200289 struct snd_soc_dapm_context *dapm = &codec->dapm;
Jarkko Nikula49100c92010-05-05 11:14:22 +0300290 int err;
291
292 /* Set up NC codec pins */
Liam Girdwoodce6120c2010-11-05 15:53:46 +0200293 snd_soc_dapm_nc_pin(dapm, "MIC3L");
294 snd_soc_dapm_nc_pin(dapm, "MIC3R");
295 snd_soc_dapm_nc_pin(dapm, "LINE1R");
Jarkko Nikula49100c92010-05-05 11:14:22 +0300296
297 /* Add RX-51 specific controls */
Liam Girdwood022658b2012-02-03 17:43:09 +0000298 err = snd_soc_add_card_controls(rtd->card, aic34_rx51_controls,
Jarkko Nikula49100c92010-05-05 11:14:22 +0300299 ARRAY_SIZE(aic34_rx51_controls));
300 if (err < 0)
301 return err;
302
303 /* Add RX-51 specific widgets */
Liam Girdwoodce6120c2010-11-05 15:53:46 +0200304 snd_soc_dapm_new_controls(dapm, aic34_dapm_widgets,
Jarkko Nikula49100c92010-05-05 11:14:22 +0300305 ARRAY_SIZE(aic34_dapm_widgets));
306
307 /* Set up RX-51 specific audio path audio_map */
Liam Girdwoodce6120c2010-11-05 15:53:46 +0200308 snd_soc_dapm_add_routes(dapm, audio_map, ARRAY_SIZE(audio_map));
Jarkko Nikula49100c92010-05-05 11:14:22 +0300309
Jarkko Nikula48529b32011-01-27 16:47:11 +0200310 err = tpa6130a2_add_controls(codec);
311 if (err < 0)
312 return err;
313 snd_soc_limit_volume(codec, "TPA6130A2 Headphone Playback Volume", 42);
314
Peter Ujfalusi45656b42012-02-14 18:20:58 +0200315 err = omap_mcbsp_st_add_controls(rtd);
Jarkko Nikulafa4d1f52011-03-09 11:25:00 +0200316 if (err < 0)
317 return err;
318
Jarkko Nikula8c523112010-06-21 14:15:00 +0300319 /* AV jack detection */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000320 err = snd_soc_jack_new(codec, "AV Jack",
Jarkko Nikula17840612011-02-14 17:20:22 +0200321 SND_JACK_HEADSET | SND_JACK_VIDEOOUT,
322 &rx51_av_jack);
Jarkko Nikula8c523112010-06-21 14:15:00 +0300323 if (err)
324 return err;
325 err = snd_soc_jack_add_gpios(&rx51_av_jack,
326 ARRAY_SIZE(rx51_av_jack_gpios),
327 rx51_av_jack_gpios);
328
329 return err;
Jarkko Nikula49100c92010-05-05 11:14:22 +0300330}
331
Jarkko Nikula8cda9752011-01-31 14:43:48 +0200332static int rx51_aic34b_init(struct snd_soc_dapm_context *dapm)
333{
334 int err;
335
Liam Girdwood022658b2012-02-03 17:43:09 +0000336 err = snd_soc_add_card_controls(dapm->card, aic34_rx51_controlsb,
Jarkko Nikula8cda9752011-01-31 14:43:48 +0200337 ARRAY_SIZE(aic34_rx51_controlsb));
338 if (err < 0)
339 return err;
340
341 err = snd_soc_dapm_new_controls(dapm, aic34_dapm_widgetsb,
342 ARRAY_SIZE(aic34_dapm_widgetsb));
343 if (err < 0)
344 return 0;
345
346 return snd_soc_dapm_add_routes(dapm, audio_mapb,
347 ARRAY_SIZE(audio_mapb));
348}
349
Jarkko Nikula49100c92010-05-05 11:14:22 +0300350/* Digital audio interface glue - connects codec <--> CPU */
351static struct snd_soc_dai_link rx51_dai[] = {
352 {
353 .name = "TLV320AIC34",
354 .stream_name = "AIC34",
Peter Ujfalusi45656b42012-02-14 18:20:58 +0200355 .cpu_dai_name = "omap-mcbsp.2",
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000356 .codec_dai_name = "tlv320aic3x-hifi",
357 .platform_name = "omap-pcm-audio",
358 .codec_name = "tlv320aic3x-codec.2-0018",
Jarkko Nikulacf9feff2011-09-30 16:07:45 +0300359 .dai_fmt = SND_SOC_DAIFMT_DSP_A | SND_SOC_DAIFMT_IB_NF |
360 SND_SOC_DAIFMT_CBM_CFM,
Jarkko Nikula49100c92010-05-05 11:14:22 +0300361 .init = rx51_aic34_init,
362 .ops = &rx51_ops,
363 },
364};
365
Axel Lina0e17b42011-12-13 10:13:13 +0800366static struct snd_soc_aux_dev rx51_aux_dev[] = {
Jarkko Nikula8cda9752011-01-31 14:43:48 +0200367 {
368 .name = "TLV320AIC34b",
369 .codec_name = "tlv320aic3x-codec.2-0019",
370 .init = rx51_aic34b_init,
371 },
372};
373
374static struct snd_soc_codec_conf rx51_codec_conf[] = {
375 {
376 .dev_name = "tlv320aic3x-codec.2-0019",
377 .name_prefix = "b",
378 },
379};
380
Jarkko Nikula49100c92010-05-05 11:14:22 +0300381/* Audio card */
382static struct snd_soc_card rx51_sound_card = {
383 .name = "RX-51",
Axel Linb425b882011-12-22 11:08:59 +0800384 .owner = THIS_MODULE,
Jarkko Nikula49100c92010-05-05 11:14:22 +0300385 .dai_link = rx51_dai,
386 .num_links = ARRAY_SIZE(rx51_dai),
Jarkko Nikula8cda9752011-01-31 14:43:48 +0200387 .aux_dev = rx51_aux_dev,
388 .num_aux_devs = ARRAY_SIZE(rx51_aux_dev),
389 .codec_conf = rx51_codec_conf,
390 .num_configs = ARRAY_SIZE(rx51_codec_conf),
Jarkko Nikula49100c92010-05-05 11:14:22 +0300391};
392
393static struct platform_device *rx51_snd_device;
394
395static int __init rx51_soc_init(void)
396{
397 int err;
398
399 if (!machine_is_nokia_rx51())
400 return -ENODEV;
401
Jarkko Nikulad8ec5982011-02-14 17:20:20 +0200402 err = gpio_request_one(RX51_TVOUT_SEL_GPIO,
403 GPIOF_DIR_OUT | GPIOF_INIT_LOW, "tvout_sel");
Jarkko Nikula4eb54702010-06-21 14:14:59 +0300404 if (err)
405 goto err_gpio_tvout_sel;
Jarkko Nikula31164c72011-02-14 17:20:21 +0200406 err = gpio_request_one(RX51_ECI_SW_GPIO,
407 GPIOF_DIR_OUT | GPIOF_INIT_HIGH, "eci_sw");
408 if (err)
409 goto err_gpio_eci_sw;
Jarkko Nikula4eb54702010-06-21 14:14:59 +0300410
Jarkko Nikula49100c92010-05-05 11:14:22 +0300411 rx51_snd_device = platform_device_alloc("soc-audio", -1);
412 if (!rx51_snd_device) {
413 err = -ENOMEM;
414 goto err1;
415 }
416
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000417 platform_set_drvdata(rx51_snd_device, &rx51_sound_card);
Jarkko Nikula49100c92010-05-05 11:14:22 +0300418
419 err = platform_device_add(rx51_snd_device);
420 if (err)
421 goto err2;
422
423 return 0;
424err2:
425 platform_device_put(rx51_snd_device);
426err1:
Jarkko Nikula31164c72011-02-14 17:20:21 +0200427 gpio_free(RX51_ECI_SW_GPIO);
428err_gpio_eci_sw:
Jarkko Nikula4eb54702010-06-21 14:14:59 +0300429 gpio_free(RX51_TVOUT_SEL_GPIO);
430err_gpio_tvout_sel:
Jarkko Nikula49100c92010-05-05 11:14:22 +0300431
432 return err;
433}
434
435static void __exit rx51_soc_exit(void)
436{
Jarkko Nikula8c523112010-06-21 14:15:00 +0300437 snd_soc_jack_free_gpios(&rx51_av_jack, ARRAY_SIZE(rx51_av_jack_gpios),
438 rx51_av_jack_gpios);
439
Jarkko Nikula49100c92010-05-05 11:14:22 +0300440 platform_device_unregister(rx51_snd_device);
Jarkko Nikula31164c72011-02-14 17:20:21 +0200441 gpio_free(RX51_ECI_SW_GPIO);
Jarkko Nikula4eb54702010-06-21 14:14:59 +0300442 gpio_free(RX51_TVOUT_SEL_GPIO);
Jarkko Nikula49100c92010-05-05 11:14:22 +0300443}
444
445module_init(rx51_soc_init);
446module_exit(rx51_soc_exit);
447
448MODULE_AUTHOR("Nokia Corporation");
449MODULE_DESCRIPTION("ALSA SoC Nokia RX-51");
450MODULE_LICENSE("GPL");