[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@bitmer.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/i2c.h>
#include <linux/platform_device.h>
#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/soc.h>

#include <asm/mach-types.h>
#include <linux/gpio.h>
#include <linux/module.h>
#include <linux/platform_data/asoc-ti-mcbsp.h>

#include "omap-mcbsp.h"

#define N810_HEADSET_AMP_GPIO	10
#define N810_SPEAKER_AMP_GPIO	101

enum {
	N810_JACK_DISABLED,
	N810_JACK_HP,
	N810_JACK_HS,
	N810_JACK_MIC,
};

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_dapm_context *dapm)
{
	int hp = 0, line1l = 0;

	switch (n810_jack_func) {
	case N810_JACK_HS:
		line1l = 1;
	case N810_JACK_HP:
		hp = 1;
		break;
	case N810_JACK_MIC:
		line1l = 1;
		break;
	}

	snd_soc_dapm_mutex_lock(dapm);

	if (n810_spk_func)
		snd_soc_dapm_enable_pin_unlocked(dapm, "Ext Spk");
	else
		snd_soc_dapm_disable_pin_unlocked(dapm, "Ext Spk");

	if (hp)
		snd_soc_dapm_enable_pin_unlocked(dapm, "Headphone Jack");
	else
		snd_soc_dapm_disable_pin_unlocked(dapm, "Headphone Jack");
	if (line1l)
		snd_soc_dapm_enable_pin_unlocked(dapm, "LINE1L");
	else
		snd_soc_dapm_disable_pin_unlocked(dapm, "LINE1L");

	if (n810_dmic_func)
		snd_soc_dapm_enable_pin_unlocked(dapm, "DMic");
	else
		snd_soc_dapm_disable_pin_unlocked(dapm, "DMic");

	snd_soc_dapm_sync_unlocked(dapm);

	snd_soc_dapm_mutex_unlock(dapm);
}

static int n810_startup(struct snd_pcm_substream *substream)
{
	struct snd_pcm_runtime *runtime = substream->runtime;
	struct snd_soc_pcm_runtime *rtd = substream->private_data;

	snd_pcm_hw_constraint_minmax(runtime,
				     SNDRV_PCM_HW_PARAM_CHANNELS, 2, 2);

	n810_ext_control(&rtd->card->dapm);
	return clk_prepare_enable(sys_clkout2);
}

static void n810_shutdown(struct snd_pcm_substream *substream)
{
	clk_disable_unprepare(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->codec_dai;
	int 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_card *card =  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(&card->dapm);

	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_card *card =  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(&card->dapm);

	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_card *card =  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(&card->dapm);

	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"},
	{"Mic Bias", NULL, "DMic"},
};

static const char *spk_function[] = {"Off", "On"};
static const char *jack_function[] = {"Off", "Headphone", "Headset", "Mic"};
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),
};

/* Digital audio interface glue - connects codec <--> CPU */
static struct snd_soc_dai_link n810_dai = {
	.name = "TLV320AIC33",
	.stream_name = "AIC33",
	.cpu_dai_name = "omap-mcbsp.2",
	.platform_name = "omap-mcbsp.2",
	.codec_name = "tlv320aic3x-codec.2-0018",
	.codec_dai_name = "tlv320aic3x-hifi",
	.dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
		   SND_SOC_DAIFMT_CBM_CFM,
	.ops = &n810_ops,
};

/* Audio machine driver */
static struct snd_soc_card snd_soc_n810 = {
	.name = "N810",
	.owner = THIS_MODULE,
	.dai_link = &n810_dai,
	.num_links = 1,

	.controls = aic33_n810_controls,
	.num_controls = ARRAY_SIZE(aic33_n810_controls),
	.dapm_widgets = aic33_dapm_widgets,
	.num_dapm_widgets = ARRAY_SIZE(aic33_dapm_widgets),
	.dapm_routes = audio_map,
	.num_dapm_routes = ARRAY_SIZE(audio_map),
	.fully_routed = true,
};

static struct platform_device *n810_snd_device;

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

	if (!of_have_populated_dt() ||
	    (!of_machine_is_compatible("nokia,n810") &&
	     !of_machine_is_compatible("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, &snd_soc_n810);
	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 (WARN_ON((gpio_request(N810_HEADSET_AMP_GPIO, "hs_amp") < 0) ||
		    (gpio_request(N810_SPEAKER_AMP_GPIO, "spk_amp") < 0))) {
		err = -EINVAL;
		goto err4;
	}

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