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