[deliverable/linux.git] / sound / soc / omap / n810.c

/*
 * n810.c  --  SoC audio for Nokia N810
 *
 * Copyright (C) 2008 Nokia Corporation
 *
 * Contact: Jarkko Nikula <jarkko.nikula@nokia.com>
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * version 2 as published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
 * 02110-1301 USA
 *
 */

#include <linux/clk.h>
#include <linux/platform_device.h>
#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/soc.h>
#include <sound/soc-dapm.h>

#include <asm/mach-types.h>
#include <mach/hardware.h>
#include <linux/gpio.h>
#include <mach/mcbsp.h>

#include "omap-mcbsp.h"
#include "omap-pcm.h"
#include "../codecs/tlv320aic3x.h"

#define N810_HEADSET_AMP_GPIO	10
#define N810_SPEAKER_AMP_GPIO	101

static struct clk *sys_clkout2;
static struct clk *sys_clkout2_src;
static struct clk *func96m_clk;

static int n810_spk_func;
static int n810_jack_func;
static int n810_dmic_func;

static void n810_ext_control(struct snd_soc_codec *codec)
{
	if (n810_spk_func)
		snd_soc_dapm_enable_pin(codec, "Ext Spk");
	else
		snd_soc_dapm_disable_pin(codec, "Ext Spk");

	if (n810_jack_func)
		snd_soc_dapm_enable_pin(codec, "Headphone Jack");
	else
		snd_soc_dapm_disable_pin(codec, "Headphone Jack");

	if (n810_dmic_func)
		snd_soc_dapm_enable_pin(codec, "DMic");
	else
		snd_soc_dapm_disable_pin(codec, "DMic");

	snd_soc_dapm_sync(codec);
}

static int n810_startup(struct snd_pcm_substream *substream)
{
	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	struct snd_soc_codec *codec = rtd->socdev->codec;

	n810_ext_control(codec);
	return clk_enable(sys_clkout2);
}

static void n810_shutdown(struct snd_pcm_substream *substream)
{
	clk_disable(sys_clkout2);
}

static int n810_hw_params(struct snd_pcm_substream *substream,
	struct snd_pcm_hw_params *params)
{
	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	struct snd_soc_dai *codec_dai = rtd->dai->codec_dai;
	struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
	int err;

	/* Set codec DAI configuration */
	err = snd_soc_dai_set_fmt(codec_dai,
					 SND_SOC_DAIFMT_I2S |
					 SND_SOC_DAIFMT_NB_NF |
					 SND_SOC_DAIFMT_CBM_CFM);
	if (err < 0)
		return err;

	/* Set cpu DAI configuration */
	err = snd_soc_dai_set_fmt(cpu_dai,
				       SND_SOC_DAIFMT_I2S |
				       SND_SOC_DAIFMT_NB_NF |
				       SND_SOC_DAIFMT_CBM_CFM);
	if (err < 0)
		return err;

	/* Set the codec system clock for DAC and ADC */
	err = snd_soc_dai_set_sysclk(codec_dai, 0, 12000000,
					    SND_SOC_CLOCK_IN);

	return err;
}

static struct snd_soc_ops n810_ops = {
	.startup = n810_startup,
	.hw_params = n810_hw_params,
	.shutdown = n810_shutdown,
};

static int n810_get_spk(struct snd_kcontrol *kcontrol,
			struct snd_ctl_elem_value *ucontrol)
{
	ucontrol->value.integer.value[0] = n810_spk_func;

	return 0;
}

static int n810_set_spk(struct snd_kcontrol *kcontrol,
			struct snd_ctl_elem_value *ucontrol)
{
	struct snd_soc_codec *codec =  snd_kcontrol_chip(kcontrol);

	if (n810_spk_func == ucontrol->value.integer.value[0])
		return 0;

	n810_spk_func = ucontrol->value.integer.value[0];
	n810_ext_control(codec);

	return 1;
}

static int n810_get_jack(struct snd_kcontrol *kcontrol,
			 struct snd_ctl_elem_value *ucontrol)
{
	ucontrol->value.integer.value[0] = n810_jack_func;

	return 0;
}

static int n810_set_jack(struct snd_kcontrol *kcontrol,
			 struct snd_ctl_elem_value *ucontrol)
{
	struct snd_soc_codec *codec =  snd_kcontrol_chip(kcontrol);

	if (n810_jack_func == ucontrol->value.integer.value[0])
		return 0;

	n810_jack_func = ucontrol->value.integer.value[0];
	n810_ext_control(codec);

	return 1;
}

static int n810_get_input(struct snd_kcontrol *kcontrol,
			  struct snd_ctl_elem_value *ucontrol)
{
	ucontrol->value.integer.value[0] = n810_dmic_func;

	return 0;
}

static int n810_set_input(struct snd_kcontrol *kcontrol,
			  struct snd_ctl_elem_value *ucontrol)
{
	struct snd_soc_codec *codec =  snd_kcontrol_chip(kcontrol);

	if (n810_dmic_func == ucontrol->value.integer.value[0])
		return 0;

	n810_dmic_func = ucontrol->value.integer.value[0];
	n810_ext_control(codec);

	return 1;
}

static int n810_spk_event(struct snd_soc_dapm_widget *w,
			  struct snd_kcontrol *k, int event)
{
	if (SND_SOC_DAPM_EVENT_ON(event))
		gpio_set_value(N810_SPEAKER_AMP_GPIO, 1);
	else
		gpio_set_value(N810_SPEAKER_AMP_GPIO, 0);

	return 0;
}

static int n810_jack_event(struct snd_soc_dapm_widget *w,
			   struct snd_kcontrol *k, int event)
{
	if (SND_SOC_DAPM_EVENT_ON(event))
		gpio_set_value(N810_HEADSET_AMP_GPIO, 1);
	else
		gpio_set_value(N810_HEADSET_AMP_GPIO, 0);

	return 0;
}

static const struct snd_soc_dapm_widget aic33_dapm_widgets[] = {
	SND_SOC_DAPM_SPK("Ext Spk", n810_spk_event),
	SND_SOC_DAPM_HP("Headphone Jack", n810_jack_event),
	SND_SOC_DAPM_MIC("DMic", NULL),
};

static const struct snd_soc_dapm_route audio_map[] = {
	{"Headphone Jack", NULL, "HPLOUT"},
	{"Headphone Jack", NULL, "HPROUT"},

	{"Ext Spk", NULL, "LLOUT"},
	{"Ext Spk", NULL, "RLOUT"},

	{"DMic Rate 64", NULL, "Mic Bias 2V"},
	{"Mic Bias 2V", NULL, "DMic"},
};

static const char *spk_function[] = {"Off", "On"};
static const char *jack_function[] = {"Off", "Headphone"};
static const char *input_function[] = {"ADC", "Digital Mic"};
static const struct soc_enum n810_enum[] = {
	SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(spk_function), spk_function),
	SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(jack_function), jack_function),
	SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(input_function), input_function),
};

static const struct snd_kcontrol_new aic33_n810_controls[] = {
	SOC_ENUM_EXT("Speaker Function", n810_enum[0],
		     n810_get_spk, n810_set_spk),
	SOC_ENUM_EXT("Jack Function", n810_enum[1],
		     n810_get_jack, n810_set_jack),
	SOC_ENUM_EXT("Input Select",  n810_enum[2],
		     n810_get_input, n810_set_input),
};

static int n810_aic33_init(struct snd_soc_codec *codec)
{
	int i, err;

	/* Not connected */
	snd_soc_dapm_disable_pin(codec, "MONO_LOUT");
	snd_soc_dapm_disable_pin(codec, "HPLCOM");
	snd_soc_dapm_disable_pin(codec, "HPRCOM");

	/* Add N810 specific controls */
	for (i = 0; i < ARRAY_SIZE(aic33_n810_controls); i++) {
		err = snd_ctl_add(codec->card,
			snd_soc_cnew(&aic33_n810_controls[i], codec, NULL));
		if (err < 0)
			return err;
	}

	/* Add N810 specific widgets */
	snd_soc_dapm_new_controls(codec, aic33_dapm_widgets,
				  ARRAY_SIZE(aic33_dapm_widgets));

	/* Set up N810 specific audio path audio_map */
	snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));

	snd_soc_dapm_sync(codec);

	return 0;
}

/* Digital audio interface glue - connects codec <--> CPU */
static struct snd_soc_dai_link n810_dai = {
	.name = "TLV320AIC33",
	.stream_name = "AIC33",
	.cpu_dai = &omap_mcbsp_dai[0],
	.codec_dai = &aic3x_dai,
	.init = n810_aic33_init,
	.ops = &n810_ops,
};

/* Audio machine driver */
static struct snd_soc_machine snd_soc_machine_n810 = {
	.name = "N810",
	.dai_link = &n810_dai,
	.num_links = 1,
};

/* Audio private data */
static struct aic3x_setup_data n810_aic33_setup = {
	.i2c_bus = 2,
	.i2c_address = 0x18,
	.gpio_func[0] = AIC3X_GPIO1_FUNC_DISABLED,
	.gpio_func[1] = AIC3X_GPIO2_FUNC_DIGITAL_MIC_INPUT,
};

/* Audio subsystem */
static struct snd_soc_device n810_snd_devdata = {
	.machine = &snd_soc_machine_n810,
	.platform = &omap_soc_platform,
	.codec_dev = &soc_codec_dev_aic3x,
	.codec_data = &n810_aic33_setup,
};

static struct platform_device *n810_snd_device;

static int __init n810_soc_init(void)
{
	int err;
	struct device *dev;

	if (!(machine_is_nokia_n810() || machine_is_nokia_n810_wimax()))
		return -ENODEV;

	n810_snd_device = platform_device_alloc("soc-audio", -1);
	if (!n810_snd_device)
		return -ENOMEM;

	platform_set_drvdata(n810_snd_device, &n810_snd_devdata);
	n810_snd_devdata.dev = &n810_snd_device->dev;
	*(unsigned int *)n810_dai.cpu_dai->private_data = 1; /* McBSP2 */
	err = platform_device_add(n810_snd_device);
	if (err)
		goto err1;

	dev = &n810_snd_device->dev;

	sys_clkout2_src = clk_get(dev, "sys_clkout2_src");
	if (IS_ERR(sys_clkout2_src)) {
		dev_err(dev, "Could not get sys_clkout2_src clock\n");
		err = PTR_ERR(sys_clkout2_src);
		goto err2;
	}
	sys_clkout2 = clk_get(dev, "sys_clkout2");
	if (IS_ERR(sys_clkout2)) {
		dev_err(dev, "Could not get sys_clkout2\n");
		err = PTR_ERR(sys_clkout2);
		goto err3;
	}
	/*
	 * Configure 12 MHz output on SYS_CLKOUT2. Therefore we must use
	 * 96 MHz as its parent in order to get 12 MHz
	 */
	func96m_clk = clk_get(dev, "func_96m_ck");
	if (IS_ERR(func96m_clk)) {
		dev_err(dev, "Could not get func 96M clock\n");
		err = PTR_ERR(func96m_clk);
		goto err4;
	}
	clk_set_parent(sys_clkout2_src, func96m_clk);
	clk_set_rate(sys_clkout2, 12000000);

	if (gpio_request(N810_HEADSET_AMP_GPIO, "hs_amp") < 0)
		BUG();
	if (gpio_request(N810_SPEAKER_AMP_GPIO, "spk_amp") < 0)
		BUG();
	gpio_direction_output(N810_HEADSET_AMP_GPIO, 0);
	gpio_direction_output(N810_SPEAKER_AMP_GPIO, 0);

	return 0;
err4:
	clk_put(sys_clkout2);
err3:
	clk_put(sys_clkout2_src);
err2:
	platform_device_del(n810_snd_device);
err1:
	platform_device_put(n810_snd_device);

	return err;
}

static void __exit n810_soc_exit(void)
{
	gpio_free(N810_SPEAKER_AMP_GPIO);
	gpio_free(N810_HEADSET_AMP_GPIO);
	clk_put(sys_clkout2_src);
	clk_put(sys_clkout2);
	clk_put(func96m_clk);

	platform_device_unregister(n810_snd_device);
}

module_init(n810_soc_init);
module_exit(n810_soc_exit);

MODULE_AUTHOR("Jarkko Nikula <jarkko.nikula@nokia.com>");
MODULE_DESCRIPTION("ALSA SoC Nokia N810");
MODULE_LICENSE("GPL");
Commit	Line	Data
2e74796a JN	1	/*
	2	* n810.c -- SoC audio for Nokia N810
	3	*
	4	* Copyright (C) 2008 Nokia Corporation
	5	*
	6	* Contact: Jarkko Nikula <jarkko.nikula@nokia.com>
	7	*
	8	* This program is free software; you can redistribute it and/or
	9	* modify it under the terms of the GNU General Public License
	10	* version 2 as published by the Free Software Foundation.
	11	*
	12	* This program is distributed in the hope that it will be useful, but
	13	* WITHOUT ANY WARRANTY; without even the implied warranty of
	14	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	15	* General Public License for more details.
	16	*
	17	* You should have received a copy of the GNU General Public License
	18	* along with this program; if not, write to the Free Software
	19	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
	20	* 02110-1301 USA
	21	*
	22	*/
	23
	24	#include <linux/clk.h>
	25	#include <linux/platform_device.h>
	26	#include <sound/core.h>
	27	#include <sound/pcm.h>
	28	#include <sound/soc.h>
	29	#include <sound/soc-dapm.h>
	30
	31	#include <asm/mach-types.h>
a09e64fb	32	#include <mach/hardware.h>
f99a633a	33	#include <linux/gpio.h>
a09e64fb	34	#include <mach/mcbsp.h>
2e74796a JN	35
	36	#include "omap-mcbsp.h"
	37	#include "omap-pcm.h"
	38	#include "../codecs/tlv320aic3x.h"
	39
f99a633a JN	40	#define N810_HEADSET_AMP_GPIO 10
f99a633a JN	41	#define N810_SPEAKER_AMP_GPIO 101
2e74796a JN	42
	43	static struct clk *sys_clkout2;
	44	static struct clk *sys_clkout2_src;
	45	static struct clk *func96m_clk;
	46
	47	static int n810_spk_func;
	48	static int n810_jack_func;
90b9e476	49	static int n810_dmic_func;
2e74796a JN	50
	51	static void n810_ext_control(struct snd_soc_codec *codec)
	52	{
a5302181 LG	53	if (n810_spk_func)
	54	snd_soc_dapm_enable_pin(codec, "Ext Spk");
	55	else
	56	snd_soc_dapm_disable_pin(codec, "Ext Spk");
	57
	58	if (n810_jack_func)
	59	snd_soc_dapm_enable_pin(codec, "Headphone Jack");
	60	else
	61	snd_soc_dapm_disable_pin(codec, "Headphone Jack");
	62
	63	if (n810_dmic_func)
	64	snd_soc_dapm_enable_pin(codec, "DMic");
	65	else
ac8615ba	66	snd_soc_dapm_disable_pin(codec, "DMic");
2e74796a	67
a5302181	68	snd_soc_dapm_sync(codec);
2e74796a JN	69	}
	70
	71	static int n810_startup(struct snd_pcm_substream *substream)
	72	{
	73	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	74	struct snd_soc_codec *codec = rtd->socdev->codec;
	75
	76	n810_ext_control(codec);
	77	return clk_enable(sys_clkout2);
	78	}
	79
	80	static void n810_shutdown(struct snd_pcm_substream *substream)
	81	{
	82	clk_disable(sys_clkout2);
	83	}
	84
	85	static int n810_hw_params(struct snd_pcm_substream *substream,
	86	struct snd_pcm_hw_params *params)
	87	{
	88	struct snd_soc_pcm_runtime *rtd = substream->private_data;
8687eb8b LG	89	struct snd_soc_dai *codec_dai = rtd->dai->codec_dai;
8687eb8b LG	90	struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
2e74796a JN	91	int err;
	92
	93	/* Set codec DAI configuration */
64105cfd	94	err = snd_soc_dai_set_fmt(codec_dai,
2e74796a JN	95	SND_SOC_DAIFMT_I2S \|
	96	SND_SOC_DAIFMT_NB_NF \|
	97	SND_SOC_DAIFMT_CBM_CFM);
	98	if (err < 0)
	99	return err;
	100
	101	/* Set cpu DAI configuration */
64105cfd	102	err = snd_soc_dai_set_fmt(cpu_dai,
2e74796a JN	103	SND_SOC_DAIFMT_I2S \|
	104	SND_SOC_DAIFMT_NB_NF \|
	105	SND_SOC_DAIFMT_CBM_CFM);
	106	if (err < 0)
	107	return err;
	108
	109	/* Set the codec system clock for DAC and ADC */
64105cfd	110	err = snd_soc_dai_set_sysclk(codec_dai, 0, 12000000,
2e74796a JN	111	SND_SOC_CLOCK_IN);
	112
	113	return err;
	114	}
	115
	116	static struct snd_soc_ops n810_ops = {
	117	.startup = n810_startup,
	118	.hw_params = n810_hw_params,
	119	.shutdown = n810_shutdown,
	120	};
	121
	122	static int n810_get_spk(struct snd_kcontrol *kcontrol,
	123	struct snd_ctl_elem_value *ucontrol)
	124	{
	125	ucontrol->value.integer.value[0] = n810_spk_func;
	126
	127	return 0;
	128	}
	129
	130	static int n810_set_spk(struct snd_kcontrol *kcontrol,
	131	struct snd_ctl_elem_value *ucontrol)
	132	{
	133	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
	134
	135	if (n810_spk_func == ucontrol->value.integer.value[0])
	136	return 0;
	137
	138	n810_spk_func = ucontrol->value.integer.value[0];
	139	n810_ext_control(codec);
	140
	141	return 1;
	142	}
	143
	144	static int n810_get_jack(struct snd_kcontrol *kcontrol,
	145	struct snd_ctl_elem_value *ucontrol)
	146	{
	147	ucontrol->value.integer.value[0] = n810_jack_func;
	148
	149	return 0;
	150	}
	151
	152	static int n810_set_jack(struct snd_kcontrol *kcontrol,
	153	struct snd_ctl_elem_value *ucontrol)
	154	{
	155	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
	156
	157	if (n810_jack_func == ucontrol->value.integer.value[0])
	158	return 0;
	159
	160	n810_jack_func = ucontrol->value.integer.value[0];
	161	n810_ext_control(codec);
	162
	163	return 1;
	164	}
	165
90b9e476 JN	166	static int n810_get_input(struct snd_kcontrol *kcontrol,
	167	struct snd_ctl_elem_value *ucontrol)
	168	{
	169	ucontrol->value.integer.value[0] = n810_dmic_func;
	170
	171	return 0;
	172	}
	173
	174	static int n810_set_input(struct snd_kcontrol *kcontrol,
	175	struct snd_ctl_elem_value *ucontrol)
	176	{
	177	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
	178
	179	if (n810_dmic_func == ucontrol->value.integer.value[0])
	180	return 0;
	181
	182	n810_dmic_func = ucontrol->value.integer.value[0];
	183	n810_ext_control(codec);
	184
	185	return 1;
	186	}
	187
2e74796a JN	188	static int n810_spk_event(struct snd_soc_dapm_widget *w,
	189	struct snd_kcontrol *k, int event)
	190	{
	191	if (SND_SOC_DAPM_EVENT_ON(event))
f99a633a	192	gpio_set_value(N810_SPEAKER_AMP_GPIO, 1);
2e74796a	193	else
f99a633a	194	gpio_set_value(N810_SPEAKER_AMP_GPIO, 0);
2e74796a JN	195
	196	return 0;
	197	}
	198
	199	static int n810_jack_event(struct snd_soc_dapm_widget *w,
	200	struct snd_kcontrol *k, int event)
	201	{
	202	if (SND_SOC_DAPM_EVENT_ON(event))
f99a633a	203	gpio_set_value(N810_HEADSET_AMP_GPIO, 1);
2e74796a	204	else
f99a633a	205	gpio_set_value(N810_HEADSET_AMP_GPIO, 0);
2e74796a JN	206
	207	return 0;
	208	}
	209
	210	static const struct snd_soc_dapm_widget aic33_dapm_widgets[] = {
	211	SND_SOC_DAPM_SPK("Ext Spk", n810_spk_event),
	212	SND_SOC_DAPM_HP("Headphone Jack", n810_jack_event),
90b9e476	213	SND_SOC_DAPM_MIC("DMic", NULL),
2e74796a JN	214	};
2e74796a JN	215
1a250598	216	static const struct snd_soc_dapm_route audio_map[] = {
2e74796a JN	217	{"Headphone Jack", NULL, "HPLOUT"},
	218	{"Headphone Jack", NULL, "HPROUT"},
	219
	220	{"Ext Spk", NULL, "LLOUT"},
	221	{"Ext Spk", NULL, "RLOUT"},
90b9e476 JN	222
	223	{"DMic Rate 64", NULL, "Mic Bias 2V"},
	224	{"Mic Bias 2V", NULL, "DMic"},
2e74796a JN	225	};
	226
	227	static const char *spk_function[] = {"Off", "On"};
	228	static const char *jack_function[] = {"Off", "Headphone"};
90b9e476	229	static const char *input_function[] = {"ADC", "Digital Mic"};
2e74796a	230	static const struct soc_enum n810_enum[] = {
3c172791 JN	231	SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(spk_function), spk_function),
3c172791 JN	232	SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(jack_function), jack_function),
90b9e476	233	SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(input_function), input_function),
2e74796a JN	234	};
	235
	236	static const struct snd_kcontrol_new aic33_n810_controls[] = {
	237	SOC_ENUM_EXT("Speaker Function", n810_enum[0],
	238	n810_get_spk, n810_set_spk),
	239	SOC_ENUM_EXT("Jack Function", n810_enum[1],
	240	n810_get_jack, n810_set_jack),
90b9e476 JN	241	SOC_ENUM_EXT("Input Select", n810_enum[2],
90b9e476 JN	242	n810_get_input, n810_set_input),
2e74796a JN	243	};
	244
	245	static int n810_aic33_init(struct snd_soc_codec *codec)
	246	{
	247	int i, err;
	248
	249	/* Not connected */
a5302181 LG	250	snd_soc_dapm_disable_pin(codec, "MONO_LOUT");
	251	snd_soc_dapm_disable_pin(codec, "HPLCOM");
	252	snd_soc_dapm_disable_pin(codec, "HPRCOM");
2e74796a JN	253
	254	/* Add N810 specific controls */
	255	for (i = 0; i < ARRAY_SIZE(aic33_n810_controls); i++) {
	256	err = snd_ctl_add(codec->card,
	257	snd_soc_cnew(&aic33_n810_controls[i], codec, NULL));
	258	if (err < 0)
	259	return err;
	260	}
	261
	262	/* Add N810 specific widgets */
1a250598 MB	263	snd_soc_dapm_new_controls(codec, aic33_dapm_widgets,
1a250598 MB	264	ARRAY_SIZE(aic33_dapm_widgets));
2e74796a JN	265
2e74796a JN	266	/* Set up N810 specific audio path audio_map */
1a250598	267	snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
2e74796a	268
a5302181	269	snd_soc_dapm_sync(codec);
2e74796a JN	270
	271	return 0;
	272	}
	273
	274	/* Digital audio interface glue - connects codec <--> CPU */
	275	static struct snd_soc_dai_link n810_dai = {
	276	.name = "TLV320AIC33",
	277	.stream_name = "AIC33",
	278	.cpu_dai = &omap_mcbsp_dai[0],
	279	.codec_dai = &aic3x_dai,
	280	.init = n810_aic33_init,
	281	.ops = &n810_ops,
	282	};
	283
	284	/* Audio machine driver */
	285	static struct snd_soc_machine snd_soc_machine_n810 = {
	286	.name = "N810",
	287	.dai_link = &n810_dai,
	288	.num_links = 1,
	289	};
	290
	291	/* Audio private data */
	292	static struct aic3x_setup_data n810_aic33_setup = {
ba8ed121	293	.i2c_bus = 2,
2e74796a	294	.i2c_address = 0x18,
90b9e476 JN	295	.gpio_func[0] = AIC3X_GPIO1_FUNC_DISABLED,
90b9e476 JN	296	.gpio_func[1] = AIC3X_GPIO2_FUNC_DIGITAL_MIC_INPUT,
2e74796a JN	297	};
	298
	299	/* Audio subsystem */
	300	static struct snd_soc_device n810_snd_devdata = {
	301	.machine = &snd_soc_machine_n810,
	302	.platform = &omap_soc_platform,
	303	.codec_dev = &soc_codec_dev_aic3x,
	304	.codec_data = &n810_aic33_setup,
	305	};
	306
	307	static struct platform_device *n810_snd_device;
	308
	309	static int __init n810_soc_init(void)
	310	{
	311	int err;
	312	struct device *dev;
	313
6e132fa6	314	if (!(machine_is_nokia_n810() \|\| machine_is_nokia_n810_wimax()))
2e74796a JN	315	return -ENODEV;
	316
	317	n810_snd_device = platform_device_alloc("soc-audio", -1);
	318	if (!n810_snd_device)
	319	return -ENOMEM;
	320
	321	platform_set_drvdata(n810_snd_device, &n810_snd_devdata);
	322	n810_snd_devdata.dev = &n810_snd_device->dev;
	323	(unsigned int )n810_dai.cpu_dai->private_data = 1; /* McBSP2 */
	324	err = platform_device_add(n810_snd_device);
	325	if (err)
	326	goto err1;
	327
	328	dev = &n810_snd_device->dev;
	329
	330	sys_clkout2_src = clk_get(dev, "sys_clkout2_src");
	331	if (IS_ERR(sys_clkout2_src)) {
	332	dev_err(dev, "Could not get sys_clkout2_src clock\n");
e784539f JN	333	err = PTR_ERR(sys_clkout2_src);
e784539f JN	334	goto err2;
2e74796a JN	335	}
	336	sys_clkout2 = clk_get(dev, "sys_clkout2");
	337	if (IS_ERR(sys_clkout2)) {
	338	dev_err(dev, "Could not get sys_clkout2\n");
e784539f JN	339	err = PTR_ERR(sys_clkout2);
e784539f JN	340	goto err3;
2e74796a JN	341	}
	342	/*
	343	* Configure 12 MHz output on SYS_CLKOUT2. Therefore we must use
	344	* 96 MHz as its parent in order to get 12 MHz
	345	*/
	346	func96m_clk = clk_get(dev, "func_96m_ck");
	347	if (IS_ERR(func96m_clk)) {
	348	dev_err(dev, "Could not get func 96M clock\n");
e784539f JN	349	err = PTR_ERR(func96m_clk);
e784539f JN	350	goto err4;
2e74796a JN	351	}
	352	clk_set_parent(sys_clkout2_src, func96m_clk);
	353	clk_set_rate(sys_clkout2, 12000000);
	354
f99a633a	355	if (gpio_request(N810_HEADSET_AMP_GPIO, "hs_amp") < 0)
2e74796a	356	BUG();
f99a633a	357	if (gpio_request(N810_SPEAKER_AMP_GPIO, "spk_amp") < 0)
2e74796a	358	BUG();
f99a633a JN	359	gpio_direction_output(N810_HEADSET_AMP_GPIO, 0);
f99a633a JN	360	gpio_direction_output(N810_SPEAKER_AMP_GPIO, 0);
2e74796a JN	361
2e74796a JN	362	return 0;
e784539f	363	err4:
2e74796a	364	clk_put(sys_clkout2);
e784539f JN	365	err3:
	366	clk_put(sys_clkout2_src);
	367	err2:
2e74796a JN	368	platform_device_del(n810_snd_device);
	369	err1:
	370	platform_device_put(n810_snd_device);
	371
	372	return err;
2e74796a JN	373	}
	374
	375	static void __exit n810_soc_exit(void)
	376	{
f99a633a JN	377	gpio_free(N810_SPEAKER_AMP_GPIO);
f99a633a JN	378	gpio_free(N810_HEADSET_AMP_GPIO);
e784539f JN	379	clk_put(sys_clkout2_src);
	380	clk_put(sys_clkout2);
	381	clk_put(func96m_clk);
f99a633a	382
2e74796a JN	383	platform_device_unregister(n810_snd_device);
	384	}
	385
	386	module_init(n810_soc_init);
	387	module_exit(n810_soc_exit);
	388
	389	MODULE_AUTHOR("Jarkko Nikula <jarkko.nikula@nokia.com>");
	390	MODULE_DESCRIPTION("ALSA SoC Nokia N810");
	391	MODULE_LICENSE("GPL");