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