[mirror_ubuntu-focal-kernel.git] / sound / soc / ti / n810.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * n810.c  --  SoC audio for Nokia N810
 *
 * Copyright (C) 2008 Nokia Corporation
 *
 * Contact: Jarkko Nikula <jarkko.nikula@bitmer.com>
 */

#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, "HS Mic");
	else
		snd_soc_dapm_disable_pin_unlocked(dapm, "HS Mic");

	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_single(runtime, SNDRV_PCM_HW_PARAM_CHANNELS, 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 const 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.enumerated.item[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.enumerated.item[0])
		return 0;

	n810_spk_func = ucontrol->value.enumerated.item[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.enumerated.item[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.enumerated.item[0])
		return 0;

	n810_jack_func = ucontrol->value.enumerated.item[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.enumerated.item[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.enumerated.item[0])
		return 0;

	n810_dmic_func = ucontrol->value.enumerated.item[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),
	SND_SOC_DAPM_MIC("HS Mic", 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, "DMic"},
	{"DMic", NULL, "Mic Bias"},

	/*
	 * Note that the mic bias is coming from Retu/Vilma and we don't have
	 * control over it atm. The analog HS mic is not working. <- TODO
	 */
	{"LINE1L", NULL, "HS Mic"},
};

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