Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 1 | /* |
| 2 | * rx51.c -- SoC audio for Nokia RX-51 |
| 3 | * |
| 4 | * Copyright (C) 2008 - 2009 Nokia Corporation |
| 5 | * |
| 6 | * Contact: Peter Ujfalusi <peter.ujfalusi@nokia.com> |
| 7 | * Eduardo Valentin <eduardo.valentin@nokia.com> |
| 8 | * Jarkko Nikula <jhnikula@gmail.com> |
| 9 | * |
| 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> |
| 29 | #include <sound/core.h> |
Jarkko Nikula | 8c52311 | 2010-06-21 14:15:00 +0300 | [diff] [blame] | 30 | #include <sound/jack.h> |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 31 | #include <sound/pcm.h> |
| 32 | #include <sound/soc.h> |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 33 | #include <plat/mcbsp.h> |
Jarkko Nikula | 48529b3 | 2011-01-27 16:47:11 +0200 | [diff] [blame^] | 34 | #include "../codecs/tpa6130a2.h" |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 35 | |
| 36 | #include <asm/mach-types.h> |
| 37 | |
| 38 | #include "omap-mcbsp.h" |
| 39 | #include "omap-pcm.h" |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 40 | |
Jarkko Nikula | 4eb54703 | 2010-06-21 14:14:59 +0300 | [diff] [blame] | 41 | #define RX51_TVOUT_SEL_GPIO 40 |
Jarkko Nikula | 8c52311 | 2010-06-21 14:15:00 +0300 | [diff] [blame] | 42 | #define RX51_JACK_DETECT_GPIO 177 |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 43 | /* |
| 44 | * REVISIT: TWL4030 GPIO base in RX-51. Now statically defined to 192. This |
| 45 | * gpio is reserved in arch/arm/mach-omap2/board-rx51-peripherals.c |
| 46 | */ |
| 47 | #define RX51_SPEAKER_AMP_TWL_GPIO (192 + 7) |
| 48 | |
Jarkko Nikula | 4eb54703 | 2010-06-21 14:14:59 +0300 | [diff] [blame] | 49 | enum { |
| 50 | RX51_JACK_DISABLED, |
Jarkko Nikula | 48529b3 | 2011-01-27 16:47:11 +0200 | [diff] [blame^] | 51 | RX51_JACK_TVOUT, /* tv-out with stereo output */ |
| 52 | RX51_JACK_HP, /* headphone: stereo output, no mic */ |
Jarkko Nikula | 4eb54703 | 2010-06-21 14:14:59 +0300 | [diff] [blame] | 53 | }; |
| 54 | |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 55 | static int rx51_spk_func; |
| 56 | static int rx51_dmic_func; |
Jarkko Nikula | 4eb54703 | 2010-06-21 14:14:59 +0300 | [diff] [blame] | 57 | static int rx51_jack_func; |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 58 | |
| 59 | static void rx51_ext_control(struct snd_soc_codec *codec) |
| 60 | { |
Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 61 | struct snd_soc_dapm_context *dapm = &codec->dapm; |
Jarkko Nikula | 48529b3 | 2011-01-27 16:47:11 +0200 | [diff] [blame^] | 62 | int hp = 0, tvout = 0; |
| 63 | |
| 64 | switch (rx51_jack_func) { |
| 65 | case RX51_JACK_TVOUT: |
| 66 | tvout = 1; |
| 67 | case RX51_JACK_HP: |
| 68 | hp = 1; |
| 69 | break; |
| 70 | } |
Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 71 | |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 72 | if (rx51_spk_func) |
Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 73 | snd_soc_dapm_enable_pin(dapm, "Ext Spk"); |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 74 | else |
Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 75 | snd_soc_dapm_disable_pin(dapm, "Ext Spk"); |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 76 | if (rx51_dmic_func) |
Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 77 | snd_soc_dapm_enable_pin(dapm, "DMic"); |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 78 | else |
Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 79 | snd_soc_dapm_disable_pin(dapm, "DMic"); |
Jarkko Nikula | 48529b3 | 2011-01-27 16:47:11 +0200 | [diff] [blame^] | 80 | if (hp) |
| 81 | snd_soc_dapm_enable_pin(dapm, "Headphone Jack"); |
| 82 | else |
| 83 | snd_soc_dapm_disable_pin(dapm, "Headphone Jack"); |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 84 | |
Jarkko Nikula | 48529b3 | 2011-01-27 16:47:11 +0200 | [diff] [blame^] | 85 | gpio_set_value(RX51_TVOUT_SEL_GPIO, tvout); |
Jarkko Nikula | 4eb54703 | 2010-06-21 14:14:59 +0300 | [diff] [blame] | 86 | |
Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 87 | snd_soc_dapm_sync(dapm); |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 88 | } |
| 89 | |
| 90 | static int rx51_startup(struct snd_pcm_substream *substream) |
| 91 | { |
| 92 | struct snd_pcm_runtime *runtime = substream->runtime; |
| 93 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 94 | struct snd_soc_codec *codec = rtd->codec; |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 95 | |
| 96 | snd_pcm_hw_constraint_minmax(runtime, |
| 97 | SNDRV_PCM_HW_PARAM_CHANNELS, 2, 2); |
| 98 | rx51_ext_control(codec); |
| 99 | |
| 100 | return 0; |
| 101 | } |
| 102 | |
| 103 | static int rx51_hw_params(struct snd_pcm_substream *substream, |
| 104 | struct snd_pcm_hw_params *params) |
| 105 | { |
| 106 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 107 | struct snd_soc_dai *codec_dai = rtd->codec_dai; |
| 108 | struct snd_soc_dai *cpu_dai = rtd->cpu_dai; |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 109 | int err; |
| 110 | |
| 111 | /* Set codec DAI configuration */ |
| 112 | err = snd_soc_dai_set_fmt(codec_dai, |
| 113 | SND_SOC_DAIFMT_DSP_A | |
| 114 | SND_SOC_DAIFMT_IB_NF | |
| 115 | SND_SOC_DAIFMT_CBM_CFM); |
| 116 | if (err < 0) |
| 117 | return err; |
| 118 | |
| 119 | /* Set cpu DAI configuration */ |
| 120 | err = snd_soc_dai_set_fmt(cpu_dai, |
| 121 | SND_SOC_DAIFMT_DSP_A | |
| 122 | SND_SOC_DAIFMT_IB_NF | |
| 123 | SND_SOC_DAIFMT_CBM_CFM); |
| 124 | if (err < 0) |
| 125 | return err; |
| 126 | |
| 127 | /* Set the codec system clock for DAC and ADC */ |
| 128 | return snd_soc_dai_set_sysclk(codec_dai, 0, 19200000, |
| 129 | SND_SOC_CLOCK_IN); |
| 130 | } |
| 131 | |
| 132 | static struct snd_soc_ops rx51_ops = { |
| 133 | .startup = rx51_startup, |
| 134 | .hw_params = rx51_hw_params, |
| 135 | }; |
| 136 | |
| 137 | static int rx51_get_spk(struct snd_kcontrol *kcontrol, |
| 138 | struct snd_ctl_elem_value *ucontrol) |
| 139 | { |
| 140 | ucontrol->value.integer.value[0] = rx51_spk_func; |
| 141 | |
| 142 | return 0; |
| 143 | } |
| 144 | |
| 145 | static int rx51_set_spk(struct snd_kcontrol *kcontrol, |
| 146 | struct snd_ctl_elem_value *ucontrol) |
| 147 | { |
| 148 | struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); |
| 149 | |
| 150 | if (rx51_spk_func == ucontrol->value.integer.value[0]) |
| 151 | return 0; |
| 152 | |
| 153 | rx51_spk_func = ucontrol->value.integer.value[0]; |
| 154 | rx51_ext_control(codec); |
| 155 | |
| 156 | return 1; |
| 157 | } |
| 158 | |
| 159 | static int rx51_spk_event(struct snd_soc_dapm_widget *w, |
| 160 | struct snd_kcontrol *k, int event) |
| 161 | { |
| 162 | if (SND_SOC_DAPM_EVENT_ON(event)) |
Jarkko Nikula | 4fff7a5 | 2010-08-23 10:36:41 +0300 | [diff] [blame] | 163 | gpio_set_value_cansleep(RX51_SPEAKER_AMP_TWL_GPIO, 1); |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 164 | else |
Jarkko Nikula | 4fff7a5 | 2010-08-23 10:36:41 +0300 | [diff] [blame] | 165 | gpio_set_value_cansleep(RX51_SPEAKER_AMP_TWL_GPIO, 0); |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 166 | |
| 167 | return 0; |
| 168 | } |
| 169 | |
Jarkko Nikula | 48529b3 | 2011-01-27 16:47:11 +0200 | [diff] [blame^] | 170 | static int rx51_hp_event(struct snd_soc_dapm_widget *w, |
| 171 | struct snd_kcontrol *k, int event) |
| 172 | { |
| 173 | struct snd_soc_codec *codec = w->dapm->codec; |
| 174 | |
| 175 | if (SND_SOC_DAPM_EVENT_ON(event)) |
| 176 | tpa6130a2_stereo_enable(codec, 1); |
| 177 | else |
| 178 | tpa6130a2_stereo_enable(codec, 0); |
| 179 | |
| 180 | return 0; |
| 181 | } |
| 182 | |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 183 | static int rx51_get_input(struct snd_kcontrol *kcontrol, |
| 184 | struct snd_ctl_elem_value *ucontrol) |
| 185 | { |
| 186 | ucontrol->value.integer.value[0] = rx51_dmic_func; |
| 187 | |
| 188 | return 0; |
| 189 | } |
| 190 | |
| 191 | static int rx51_set_input(struct snd_kcontrol *kcontrol, |
| 192 | struct snd_ctl_elem_value *ucontrol) |
| 193 | { |
| 194 | struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); |
| 195 | |
| 196 | if (rx51_dmic_func == ucontrol->value.integer.value[0]) |
| 197 | return 0; |
| 198 | |
| 199 | rx51_dmic_func = ucontrol->value.integer.value[0]; |
| 200 | rx51_ext_control(codec); |
| 201 | |
| 202 | return 1; |
| 203 | } |
| 204 | |
Jarkko Nikula | 4eb54703 | 2010-06-21 14:14:59 +0300 | [diff] [blame] | 205 | static int rx51_get_jack(struct snd_kcontrol *kcontrol, |
| 206 | struct snd_ctl_elem_value *ucontrol) |
| 207 | { |
| 208 | ucontrol->value.integer.value[0] = rx51_jack_func; |
| 209 | |
| 210 | return 0; |
| 211 | } |
| 212 | |
| 213 | static int rx51_set_jack(struct snd_kcontrol *kcontrol, |
| 214 | struct snd_ctl_elem_value *ucontrol) |
| 215 | { |
| 216 | struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); |
| 217 | |
| 218 | if (rx51_jack_func == ucontrol->value.integer.value[0]) |
| 219 | return 0; |
| 220 | |
| 221 | rx51_jack_func = ucontrol->value.integer.value[0]; |
| 222 | rx51_ext_control(codec); |
| 223 | |
| 224 | return 1; |
| 225 | } |
| 226 | |
Jarkko Nikula | 8c52311 | 2010-06-21 14:15:00 +0300 | [diff] [blame] | 227 | static struct snd_soc_jack rx51_av_jack; |
| 228 | |
| 229 | static struct snd_soc_jack_gpio rx51_av_jack_gpios[] = { |
| 230 | { |
| 231 | .gpio = RX51_JACK_DETECT_GPIO, |
| 232 | .name = "avdet-gpio", |
| 233 | .report = SND_JACK_VIDEOOUT, |
| 234 | .invert = 1, |
| 235 | .debounce_time = 200, |
| 236 | }, |
| 237 | }; |
| 238 | |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 239 | static const struct snd_soc_dapm_widget aic34_dapm_widgets[] = { |
| 240 | SND_SOC_DAPM_SPK("Ext Spk", rx51_spk_event), |
| 241 | SND_SOC_DAPM_MIC("DMic", NULL), |
Jarkko Nikula | 48529b3 | 2011-01-27 16:47:11 +0200 | [diff] [blame^] | 242 | SND_SOC_DAPM_HP("Headphone Jack", rx51_hp_event), |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 243 | }; |
| 244 | |
| 245 | static const struct snd_soc_dapm_route audio_map[] = { |
| 246 | {"Ext Spk", NULL, "HPLOUT"}, |
| 247 | {"Ext Spk", NULL, "HPROUT"}, |
Jarkko Nikula | 48529b3 | 2011-01-27 16:47:11 +0200 | [diff] [blame^] | 248 | {"Headphone Jack", NULL, "LLOUT"}, |
| 249 | {"Headphone Jack", NULL, "RLOUT"}, |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 250 | |
| 251 | {"DMic Rate 64", NULL, "Mic Bias 2V"}, |
| 252 | {"Mic Bias 2V", NULL, "DMic"}, |
| 253 | }; |
| 254 | |
| 255 | static const char *spk_function[] = {"Off", "On"}; |
| 256 | static const char *input_function[] = {"ADC", "Digital Mic"}; |
Jarkko Nikula | 48529b3 | 2011-01-27 16:47:11 +0200 | [diff] [blame^] | 257 | static const char *jack_function[] = {"Off", "TV-OUT", "Headphone"}; |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 258 | |
| 259 | static const struct soc_enum rx51_enum[] = { |
| 260 | SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(spk_function), spk_function), |
| 261 | SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(input_function), input_function), |
Jarkko Nikula | 4eb54703 | 2010-06-21 14:14:59 +0300 | [diff] [blame] | 262 | SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(jack_function), jack_function), |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 263 | }; |
| 264 | |
| 265 | static const struct snd_kcontrol_new aic34_rx51_controls[] = { |
| 266 | SOC_ENUM_EXT("Speaker Function", rx51_enum[0], |
| 267 | rx51_get_spk, rx51_set_spk), |
| 268 | SOC_ENUM_EXT("Input Select", rx51_enum[1], |
| 269 | rx51_get_input, rx51_set_input), |
Jarkko Nikula | 4eb54703 | 2010-06-21 14:14:59 +0300 | [diff] [blame] | 270 | SOC_ENUM_EXT("Jack Function", rx51_enum[2], |
| 271 | rx51_get_jack, rx51_set_jack), |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 272 | }; |
| 273 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 274 | static int rx51_aic34_init(struct snd_soc_pcm_runtime *rtd) |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 275 | { |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 276 | struct snd_soc_codec *codec = rtd->codec; |
Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 277 | struct snd_soc_dapm_context *dapm = &codec->dapm; |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 278 | int err; |
| 279 | |
| 280 | /* Set up NC codec pins */ |
Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 281 | snd_soc_dapm_nc_pin(dapm, "MIC3L"); |
| 282 | snd_soc_dapm_nc_pin(dapm, "MIC3R"); |
| 283 | snd_soc_dapm_nc_pin(dapm, "LINE1R"); |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 284 | |
| 285 | /* Add RX-51 specific controls */ |
| 286 | err = snd_soc_add_controls(codec, aic34_rx51_controls, |
| 287 | ARRAY_SIZE(aic34_rx51_controls)); |
| 288 | if (err < 0) |
| 289 | return err; |
| 290 | |
| 291 | /* Add RX-51 specific widgets */ |
Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 292 | snd_soc_dapm_new_controls(dapm, aic34_dapm_widgets, |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 293 | ARRAY_SIZE(aic34_dapm_widgets)); |
| 294 | |
| 295 | /* Set up RX-51 specific audio path audio_map */ |
Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 296 | snd_soc_dapm_add_routes(dapm, audio_map, ARRAY_SIZE(audio_map)); |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 297 | |
Jarkko Nikula | 48529b3 | 2011-01-27 16:47:11 +0200 | [diff] [blame^] | 298 | err = tpa6130a2_add_controls(codec); |
| 299 | if (err < 0) |
| 300 | return err; |
| 301 | snd_soc_limit_volume(codec, "TPA6130A2 Headphone Playback Volume", 42); |
| 302 | |
Liam Girdwood | ce6120c | 2010-11-05 15:53:46 +0200 | [diff] [blame] | 303 | snd_soc_dapm_sync(dapm); |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 304 | |
Jarkko Nikula | 8c52311 | 2010-06-21 14:15:00 +0300 | [diff] [blame] | 305 | /* AV jack detection */ |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 306 | err = snd_soc_jack_new(codec, "AV Jack", |
Jarkko Nikula | 8c52311 | 2010-06-21 14:15:00 +0300 | [diff] [blame] | 307 | SND_JACK_VIDEOOUT, &rx51_av_jack); |
| 308 | if (err) |
| 309 | return err; |
| 310 | err = snd_soc_jack_add_gpios(&rx51_av_jack, |
| 311 | ARRAY_SIZE(rx51_av_jack_gpios), |
| 312 | rx51_av_jack_gpios); |
| 313 | |
| 314 | return err; |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 315 | } |
| 316 | |
| 317 | /* Digital audio interface glue - connects codec <--> CPU */ |
| 318 | static struct snd_soc_dai_link rx51_dai[] = { |
| 319 | { |
| 320 | .name = "TLV320AIC34", |
| 321 | .stream_name = "AIC34", |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 322 | .cpu_dai_name = "omap-mcbsp-dai.1", |
| 323 | .codec_dai_name = "tlv320aic3x-hifi", |
| 324 | .platform_name = "omap-pcm-audio", |
| 325 | .codec_name = "tlv320aic3x-codec.2-0018", |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 326 | .init = rx51_aic34_init, |
| 327 | .ops = &rx51_ops, |
| 328 | }, |
| 329 | }; |
| 330 | |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 331 | /* Audio card */ |
| 332 | static struct snd_soc_card rx51_sound_card = { |
| 333 | .name = "RX-51", |
| 334 | .dai_link = rx51_dai, |
| 335 | .num_links = ARRAY_SIZE(rx51_dai), |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 336 | }; |
| 337 | |
| 338 | static struct platform_device *rx51_snd_device; |
| 339 | |
| 340 | static int __init rx51_soc_init(void) |
| 341 | { |
| 342 | int err; |
| 343 | |
| 344 | if (!machine_is_nokia_rx51()) |
| 345 | return -ENODEV; |
| 346 | |
Jarkko Nikula | 4eb54703 | 2010-06-21 14:14:59 +0300 | [diff] [blame] | 347 | err = gpio_request(RX51_TVOUT_SEL_GPIO, "tvout_sel"); |
| 348 | if (err) |
| 349 | goto err_gpio_tvout_sel; |
| 350 | gpio_direction_output(RX51_TVOUT_SEL_GPIO, 0); |
| 351 | |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 352 | rx51_snd_device = platform_device_alloc("soc-audio", -1); |
| 353 | if (!rx51_snd_device) { |
| 354 | err = -ENOMEM; |
| 355 | goto err1; |
| 356 | } |
| 357 | |
Liam Girdwood | f0fba2a | 2010-03-17 20:15:21 +0000 | [diff] [blame] | 358 | platform_set_drvdata(rx51_snd_device, &rx51_sound_card); |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 359 | |
| 360 | err = platform_device_add(rx51_snd_device); |
| 361 | if (err) |
| 362 | goto err2; |
| 363 | |
| 364 | return 0; |
| 365 | err2: |
| 366 | platform_device_put(rx51_snd_device); |
| 367 | err1: |
Jarkko Nikula | 4eb54703 | 2010-06-21 14:14:59 +0300 | [diff] [blame] | 368 | gpio_free(RX51_TVOUT_SEL_GPIO); |
| 369 | err_gpio_tvout_sel: |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 370 | |
| 371 | return err; |
| 372 | } |
| 373 | |
| 374 | static void __exit rx51_soc_exit(void) |
| 375 | { |
Jarkko Nikula | 8c52311 | 2010-06-21 14:15:00 +0300 | [diff] [blame] | 376 | snd_soc_jack_free_gpios(&rx51_av_jack, ARRAY_SIZE(rx51_av_jack_gpios), |
| 377 | rx51_av_jack_gpios); |
| 378 | |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 379 | platform_device_unregister(rx51_snd_device); |
Jarkko Nikula | 4eb54703 | 2010-06-21 14:14:59 +0300 | [diff] [blame] | 380 | gpio_free(RX51_TVOUT_SEL_GPIO); |
Jarkko Nikula | 49100c9 | 2010-05-05 11:14:22 +0300 | [diff] [blame] | 381 | } |
| 382 | |
| 383 | module_init(rx51_soc_init); |
| 384 | module_exit(rx51_soc_exit); |
| 385 | |
| 386 | MODULE_AUTHOR("Nokia Corporation"); |
| 387 | MODULE_DESCRIPTION("ALSA SoC Nokia RX-51"); |
| 388 | MODULE_LICENSE("GPL"); |