[linux.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 <[email protected]>
 */

#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/consumer.h>
#include <linux/module.h>
#include <linux/platform_data/asoc-ti-mcbsp.h>

#include "omap-mcbsp.h"

static struct gpio_desc *n810_headset_amp;
static struct gpio_desc *n810_speaker_amp;

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;
		fallthrough;
	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 = snd_soc_substream_to_rtd(substream);

	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 = snd_soc_substream_to_rtd(substream);
	struct snd_soc_dai *codec_dai = snd_soc_rtd_to_codec(rtd, 0);
	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))
		gpiod_set_value(n810_speaker_amp, 1);
	else
		gpiod_set_value(n810_speaker_amp, 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))
		gpiod_set_value(n810_headset_amp, 1);
	else
		gpiod_set_value(n810_headset_amp, 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 */
SND_SOC_DAILINK_DEFS(aic33,
	DAILINK_COMP_ARRAY(COMP_CPU("48076000.mcbsp")),
	DAILINK_COMP_ARRAY(COMP_CODEC("tlv320aic3x-codec.1-0018",
				      "tlv320aic3x-hifi")),
	DAILINK_COMP_ARRAY(COMP_PLATFORM("48076000.mcbsp")));

static struct snd_soc_dai_link n810_dai = {
	.name = "TLV320AIC33",
	.stream_name = "AIC33",
	.dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
		   SND_SOC_DAIFMT_CBM_CFM,
	.ops = &n810_ops,
	SND_SOC_DAILINK_REG(aic33),
};

/* 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);

	n810_headset_amp = devm_gpiod_get(&n810_snd_device->dev,
					  "headphone", GPIOD_OUT_LOW);
	if (IS_ERR(n810_headset_amp)) {
		err = PTR_ERR(n810_headset_amp);
		goto err4;
	}

	n810_speaker_amp = devm_gpiod_get(&n810_snd_device->dev,
					  "speaker", GPIOD_OUT_LOW);
	if (IS_ERR(n810_speaker_amp)) {
		err = PTR_ERR(n810_speaker_amp);
		goto err4;
	}

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