[mirror_ubuntu-hirsute-kernel.git] / sound / soc / ti / omap3pandora.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * omap3pandora.c  --  SoC audio for Pandora Handheld Console
 *
 * Author: Gražvydas Ignotas <notasas@gmail.com>
 */

#include <linux/clk.h>
#include <linux/platform_device.h>
#include <linux/gpio.h>
#include <linux/delay.h>
#include <linux/regulator/consumer.h>
#include <linux/module.h>

#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/soc.h>

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

#include "omap-mcbsp.h"

#define OMAP3_PANDORA_DAC_POWER_GPIO	118
#define OMAP3_PANDORA_AMP_POWER_GPIO	14

#define PREFIX "ASoC omap3pandora: "

static struct regulator *omap3pandora_dac_reg;

static int omap3pandora_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 = asoc_rtd_to_codec(rtd, 0);
	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
	int ret;

	/* Set the codec system clock for DAC and ADC */
	ret = snd_soc_dai_set_sysclk(codec_dai, 0, 26000000,
					    SND_SOC_CLOCK_IN);
	if (ret < 0) {
		pr_err(PREFIX "can't set codec system clock\n");
		return ret;
	}

	/* Set McBSP clock to external */
	ret = snd_soc_dai_set_sysclk(cpu_dai, OMAP_MCBSP_SYSCLK_CLKS_EXT,
				     256 * params_rate(params),
				     SND_SOC_CLOCK_IN);
	if (ret < 0) {
		pr_err(PREFIX "can't set cpu system clock\n");
		return ret;
	}

	ret = snd_soc_dai_set_clkdiv(cpu_dai, OMAP_MCBSP_CLKGDV, 8);
	if (ret < 0) {
		pr_err(PREFIX "can't set SRG clock divider\n");
		return ret;
	}

	return 0;
}

static int omap3pandora_dac_event(struct snd_soc_dapm_widget *w,
	struct snd_kcontrol *k, int event)
{
	int ret;

	/*
	 * The PCM1773 DAC datasheet requires 1ms delay between switching
	 * VCC power on/off and /PD pin high/low
	 */
	if (SND_SOC_DAPM_EVENT_ON(event)) {
		ret = regulator_enable(omap3pandora_dac_reg);
		if (ret) {
			dev_err(w->dapm->dev, "Failed to power DAC: %d\n", ret);
			return ret;
		}
		mdelay(1);
		gpio_set_value(OMAP3_PANDORA_DAC_POWER_GPIO, 1);
	} else {
		gpio_set_value(OMAP3_PANDORA_DAC_POWER_GPIO, 0);
		mdelay(1);
		regulator_disable(omap3pandora_dac_reg);
	}

	return 0;
}

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

	return 0;
}

/*
 * Audio paths on Pandora board:
 *
 *  |O| ---> PCM DAC +-> AMP -> Headphone Jack
 *  |M|         A    +--------> Line Out
 *  |A| <~~clk~~+
 *  |P| <--- TWL4030 <--------- Line In and MICs
 */
static const struct snd_soc_dapm_widget omap3pandora_dapm_widgets[] = {
	SND_SOC_DAPM_DAC_E("PCM DAC", "HiFi Playback", SND_SOC_NOPM,
			   0, 0, omap3pandora_dac_event,
			   SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
	SND_SOC_DAPM_PGA_E("Headphone Amplifier", SND_SOC_NOPM,
			   0, 0, NULL, 0, omap3pandora_hp_event,
			   SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
	SND_SOC_DAPM_HP("Headphone Jack", NULL),
	SND_SOC_DAPM_LINE("Line Out", NULL),

	SND_SOC_DAPM_MIC("Mic (internal)", NULL),
	SND_SOC_DAPM_MIC("Mic (external)", NULL),
	SND_SOC_DAPM_LINE("Line In", NULL),
};

static const struct snd_soc_dapm_route omap3pandora_map[] = {
	{"PCM DAC", NULL, "APLL Enable"},
	{"Headphone Amplifier", NULL, "PCM DAC"},
	{"Line Out", NULL, "PCM DAC"},
	{"Headphone Jack", NULL, "Headphone Amplifier"},

	{"AUXL", NULL, "Line In"},
	{"AUXR", NULL, "Line In"},

	{"MAINMIC", NULL, "Mic (internal)"},
	{"Mic (internal)", NULL, "Mic Bias 1"},

	{"SUBMIC", NULL, "Mic (external)"},
	{"Mic (external)", NULL, "Mic Bias 2"},
};

static int omap3pandora_out_init(struct snd_soc_pcm_runtime *rtd)
{
	struct snd_soc_dapm_context *dapm = &rtd->card->dapm;

	/* All TWL4030 output pins are floating */
	snd_soc_dapm_nc_pin(dapm, "EARPIECE");
	snd_soc_dapm_nc_pin(dapm, "PREDRIVEL");
	snd_soc_dapm_nc_pin(dapm, "PREDRIVER");
	snd_soc_dapm_nc_pin(dapm, "HSOL");
	snd_soc_dapm_nc_pin(dapm, "HSOR");
	snd_soc_dapm_nc_pin(dapm, "CARKITL");
	snd_soc_dapm_nc_pin(dapm, "CARKITR");
	snd_soc_dapm_nc_pin(dapm, "HFL");
	snd_soc_dapm_nc_pin(dapm, "HFR");
	snd_soc_dapm_nc_pin(dapm, "VIBRA");

	return 0;
}

static int omap3pandora_in_init(struct snd_soc_pcm_runtime *rtd)
{
	struct snd_soc_dapm_context *dapm = &rtd->card->dapm;

	/* Not comnnected */
	snd_soc_dapm_nc_pin(dapm, "HSMIC");
	snd_soc_dapm_nc_pin(dapm, "CARKITMIC");
	snd_soc_dapm_nc_pin(dapm, "DIGIMIC0");
	snd_soc_dapm_nc_pin(dapm, "DIGIMIC1");

	return 0;
}

static const struct snd_soc_ops omap3pandora_ops = {
	.hw_params = omap3pandora_hw_params,
};

/* Digital audio interface glue - connects codec <--> CPU */
SND_SOC_DAILINK_DEFS(out,
	DAILINK_COMP_ARRAY(COMP_CPU("omap-mcbsp.2")),
	DAILINK_COMP_ARRAY(COMP_CODEC("twl4030-codec", "twl4030-hifi")),
	DAILINK_COMP_ARRAY(COMP_PLATFORM("omap-mcbsp.2")));

SND_SOC_DAILINK_DEFS(in,
	DAILINK_COMP_ARRAY(COMP_CPU("omap-mcbsp.4")),
	DAILINK_COMP_ARRAY(COMP_CODEC("twl4030-codec", "twl4030-hifi")),
	DAILINK_COMP_ARRAY(COMP_PLATFORM("omap-mcbsp.4")));

static struct snd_soc_dai_link omap3pandora_dai[] = {
	{
		.name = "PCM1773",
		.stream_name = "HiFi Out",
		.dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
			   SND_SOC_DAIFMT_CBS_CFS,
		.ops = &omap3pandora_ops,
		.init = omap3pandora_out_init,
		SND_SOC_DAILINK_REG(out),
	}, {
		.name = "TWL4030",
		.stream_name = "Line/Mic In",
		.dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
			   SND_SOC_DAIFMT_CBS_CFS,
		.ops = &omap3pandora_ops,
		.init = omap3pandora_in_init,
		SND_SOC_DAILINK_REG(in),
	}
};

/* SoC card */
static struct snd_soc_card snd_soc_card_omap3pandora = {
	.name = "omap3pandora",
	.owner = THIS_MODULE,
	.dai_link = omap3pandora_dai,
	.num_links = ARRAY_SIZE(omap3pandora_dai),

	.dapm_widgets = omap3pandora_dapm_widgets,
	.num_dapm_widgets = ARRAY_SIZE(omap3pandora_dapm_widgets),
	.dapm_routes = omap3pandora_map,
	.num_dapm_routes = ARRAY_SIZE(omap3pandora_map),
};

static struct platform_device *omap3pandora_snd_device;

static int __init omap3pandora_soc_init(void)
{
	int ret;

	if (!machine_is_omap3_pandora())
		return -ENODEV;

	pr_info("OMAP3 Pandora SoC init\n");

	ret = gpio_request(OMAP3_PANDORA_DAC_POWER_GPIO, "dac_power");
	if (ret) {
		pr_err(PREFIX "Failed to get DAC power GPIO\n");
		return ret;
	}

	ret = gpio_direction_output(OMAP3_PANDORA_DAC_POWER_GPIO, 0);
	if (ret) {
		pr_err(PREFIX "Failed to set DAC power GPIO direction\n");
		goto fail0;
	}

	ret = gpio_request(OMAP3_PANDORA_AMP_POWER_GPIO, "amp_power");
	if (ret) {
		pr_err(PREFIX "Failed to get amp power GPIO\n");
		goto fail0;
	}

	ret = gpio_direction_output(OMAP3_PANDORA_AMP_POWER_GPIO, 0);
	if (ret) {
		pr_err(PREFIX "Failed to set amp power GPIO direction\n");
		goto fail1;
	}

	omap3pandora_snd_device = platform_device_alloc("soc-audio", -1);
	if (omap3pandora_snd_device == NULL) {
		pr_err(PREFIX "Platform device allocation failed\n");
		ret = -ENOMEM;
		goto fail1;
	}

	platform_set_drvdata(omap3pandora_snd_device, &snd_soc_card_omap3pandora);

	ret = platform_device_add(omap3pandora_snd_device);
	if (ret) {
		pr_err(PREFIX "Unable to add platform device\n");
		goto fail2;
	}

	omap3pandora_dac_reg = regulator_get(&omap3pandora_snd_device->dev, "vcc");
	if (IS_ERR(omap3pandora_dac_reg)) {
		pr_err(PREFIX "Failed to get DAC regulator from %s: %ld\n",
			dev_name(&omap3pandora_snd_device->dev),
			PTR_ERR(omap3pandora_dac_reg));
		ret = PTR_ERR(omap3pandora_dac_reg);
		goto fail3;
	}

	return 0;

fail3:
	platform_device_del(omap3pandora_snd_device);
fail2:
	platform_device_put(omap3pandora_snd_device);
fail1:
	gpio_free(OMAP3_PANDORA_AMP_POWER_GPIO);
fail0:
	gpio_free(OMAP3_PANDORA_DAC_POWER_GPIO);
	return ret;
}
module_init(omap3pandora_soc_init);

static void __exit omap3pandora_soc_exit(void)
{
	regulator_put(omap3pandora_dac_reg);
	platform_device_unregister(omap3pandora_snd_device);
	gpio_free(OMAP3_PANDORA_AMP_POWER_GPIO);
	gpio_free(OMAP3_PANDORA_DAC_POWER_GPIO);
}
module_exit(omap3pandora_soc_exit);

MODULE_AUTHOR("Grazvydas Ignotas <notasas@gmail.com>");
MODULE_DESCRIPTION("ALSA SoC OMAP3 Pandora");
MODULE_LICENSE("GPL");
Commit	Line	Data
2b27bdcc	1	// SPDX-License-Identifier: GPL-2.0-only
68fb7407 GI	2	/*
	3	* omap3pandora.c -- SoC audio for Pandora Handheld Console
	4	*
	5	* Author: Gražvydas Ignotas <notasas@gmail.com>
68fb7407 GI	6	*/
	7
	8	#include <linux/clk.h>
	9	#include <linux/platform_device.h>
	10	#include <linux/gpio.h>
	11	#include <linux/delay.h>
c50749de	12	#include <linux/regulator/consumer.h>
da155d5b	13	#include <linux/module.h>
68fb7407 GI	14
	15	#include <sound/core.h>
	16	#include <sound/pcm.h>
	17	#include <sound/soc.h>
68fb7407 GI	18
68fb7407 GI	19	#include <asm/mach-types.h>
2203747c	20	#include <linux/platform_data/asoc-ti-mcbsp.h>
68fb7407 GI	21
68fb7407 GI	22	#include "omap-mcbsp.h"
68fb7407 GI	23
	24	#define OMAP3_PANDORA_DAC_POWER_GPIO 118
	25	#define OMAP3_PANDORA_AMP_POWER_GPIO 14
	26
	27	#define PREFIX "ASoC omap3pandora: "
	28
c50749de GI	29	static struct regulator *omap3pandora_dac_reg;
c50749de GI	30
4b94dba0 GI	31	static int omap3pandora_hw_params(struct snd_pcm_substream *substream,
4b94dba0 GI	32	struct snd_pcm_hw_params *params)
68fb7407	33	{
9e5d86fe	34	struct snd_soc_pcm_runtime *rtd = substream->private_data;
2842b871 KM	35	struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
2842b871 KM	36	struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
68fb7407 GI	37	int ret;
68fb7407 GI	38
68fb7407 GI	39	/* Set the codec system clock for DAC and ADC */
	40	ret = snd_soc_dai_set_sysclk(codec_dai, 0, 26000000,
	41	SND_SOC_CLOCK_IN);
	42	if (ret < 0) {
	43	pr_err(PREFIX "can't set codec system clock\n");
	44	return ret;
	45	}
	46
	47	/* Set McBSP clock to external */
9e5d86fe JN	48	ret = snd_soc_dai_set_sysclk(cpu_dai, OMAP_MCBSP_SYSCLK_CLKS_EXT,
	49	256 * params_rate(params),
	50	SND_SOC_CLOCK_IN);
68fb7407 GI	51	if (ret < 0) {
	52	pr_err(PREFIX "can't set cpu system clock\n");
	53	return ret;
	54	}
	55
	56	ret = snd_soc_dai_set_clkdiv(cpu_dai, OMAP_MCBSP_CLKGDV, 8);
	57	if (ret < 0) {
	58	pr_err(PREFIX "can't set SRG clock divider\n");
	59	return ret;
	60	}
	61
	62	return 0;
	63	}
	64
c50749de	65	static int omap3pandora_dac_event(struct snd_soc_dapm_widget *w,
68fb7407 GI	66	struct snd_kcontrol *k, int event)
68fb7407 GI	67	{
dd194b48 MB	68	int ret;
dd194b48 MB	69
c50749de GI	70	/*
	71	* The PCM1773 DAC datasheet requires 1ms delay between switching
	72	* VCC power on/off and /PD pin high/low
	73	*/
68fb7407	74	if (SND_SOC_DAPM_EVENT_ON(event)) {
dd194b48 MB	75	ret = regulator_enable(omap3pandora_dac_reg);
dd194b48 MB	76	if (ret) {
e37e0430	77	dev_err(w->dapm->dev, "Failed to power DAC: %d\n", ret);
dd194b48 MB	78	return ret;
dd194b48 MB	79	}
c50749de	80	mdelay(1);
68fb7407	81	gpio_set_value(OMAP3_PANDORA_DAC_POWER_GPIO, 1);
68fb7407	82	} else {
68fb7407	83	gpio_set_value(OMAP3_PANDORA_DAC_POWER_GPIO, 0);
c50749de GI	84	mdelay(1);
c50749de GI	85	regulator_disable(omap3pandora_dac_reg);
68fb7407 GI	86	}
	87
	88	return 0;
	89	}
	90
c50749de GI	91	static int omap3pandora_hp_event(struct snd_soc_dapm_widget *w,
	92	struct snd_kcontrol *k, int event)
	93	{
	94	if (SND_SOC_DAPM_EVENT_ON(event))
	95	gpio_set_value(OMAP3_PANDORA_AMP_POWER_GPIO, 1);
	96	else
	97	gpio_set_value(OMAP3_PANDORA_AMP_POWER_GPIO, 0);
	98
	99	return 0;
	100	}
	101
68fb7407 GI	102	/*
	103	* Audio paths on Pandora board:
	104	*
	105	* \|O\| ---> PCM DAC +-> AMP -> Headphone Jack
	106	* \|M\| A +--------> Line Out
	107	* \|A\| <~~clk~~+
	108	* \|P\| <--- TWL4030 <--------- Line In and MICs
	109	*/
b2e69054	110	static const struct snd_soc_dapm_widget omap3pandora_dapm_widgets[] = {
c50749de GI	111	SND_SOC_DAPM_DAC_E("PCM DAC", "HiFi Playback", SND_SOC_NOPM,
	112	0, 0, omap3pandora_dac_event,
	113	SND_SOC_DAPM_POST_PMU \| SND_SOC_DAPM_PRE_PMD),
68fb7407 GI	114	SND_SOC_DAPM_PGA_E("Headphone Amplifier", SND_SOC_NOPM,
	115	0, 0, NULL, 0, omap3pandora_hp_event,
	116	SND_SOC_DAPM_POST_PMU \| SND_SOC_DAPM_PRE_PMD),
	117	SND_SOC_DAPM_HP("Headphone Jack", NULL),
	118	SND_SOC_DAPM_LINE("Line Out", NULL),
68fb7407	119
8f008062	120	SND_SOC_DAPM_MIC("Mic (internal)", NULL),
68fb7407 GI	121	SND_SOC_DAPM_MIC("Mic (external)", NULL),
	122	SND_SOC_DAPM_LINE("Line In", NULL),
	123	};
	124
b2e69054	125	static const struct snd_soc_dapm_route omap3pandora_map[] = {
3b9447fb	126	{"PCM DAC", NULL, "APLL Enable"},
68fb7407 GI	127	{"Headphone Amplifier", NULL, "PCM DAC"},
	128	{"Line Out", NULL, "PCM DAC"},
	129	{"Headphone Jack", NULL, "Headphone Amplifier"},
68fb7407	130
8f008062 GI	131	{"AUXL", NULL, "Line In"},
	132	{"AUXR", NULL, "Line In"},
	133
e04d6e55 PU	134	{"MAINMIC", NULL, "Mic (internal)"},
e04d6e55 PU	135	{"Mic (internal)", NULL, "Mic Bias 1"},
8f008062	136
e04d6e55 PU	137	{"SUBMIC", NULL, "Mic (external)"},
e04d6e55 PU	138	{"Mic (external)", NULL, "Mic Bias 2"},
68fb7407 GI	139	};
68fb7407 GI	140
f0fba2ad	141	static int omap3pandora_out_init(struct snd_soc_pcm_runtime *rtd)
68fb7407	142	{
987731bb	143	struct snd_soc_dapm_context *dapm = &rtd->card->dapm;
68fb7407	144
8f008062	145	/* All TWL4030 output pins are floating */
ce6120cc LG	146	snd_soc_dapm_nc_pin(dapm, "EARPIECE");
	147	snd_soc_dapm_nc_pin(dapm, "PREDRIVEL");
	148	snd_soc_dapm_nc_pin(dapm, "PREDRIVER");
	149	snd_soc_dapm_nc_pin(dapm, "HSOL");
	150	snd_soc_dapm_nc_pin(dapm, "HSOR");
	151	snd_soc_dapm_nc_pin(dapm, "CARKITL");
	152	snd_soc_dapm_nc_pin(dapm, "CARKITR");
	153	snd_soc_dapm_nc_pin(dapm, "HFL");
	154	snd_soc_dapm_nc_pin(dapm, "HFR");
	155	snd_soc_dapm_nc_pin(dapm, "VIBRA");
	156
b2e69054	157	return 0;
68fb7407 GI	158	}
68fb7407 GI	159
f0fba2ad	160	static int omap3pandora_in_init(struct snd_soc_pcm_runtime *rtd)
68fb7407	161	{
987731bb	162	struct snd_soc_dapm_context *dapm = &rtd->card->dapm;
68fb7407	163
8f008062	164	/* Not comnnected */
ce6120cc LG	165	snd_soc_dapm_nc_pin(dapm, "HSMIC");
	166	snd_soc_dapm_nc_pin(dapm, "CARKITMIC");
	167	snd_soc_dapm_nc_pin(dapm, "DIGIMIC0");
	168	snd_soc_dapm_nc_pin(dapm, "DIGIMIC1");
7f185340	169
b2e69054	170	return 0;
68fb7407 GI	171	}
68fb7407 GI	172
2261cf1c	173	static const struct snd_soc_ops omap3pandora_ops = {
4b94dba0	174	.hw_params = omap3pandora_hw_params,
68fb7407 GI	175	};
	176
	177	/* Digital audio interface glue - connects codec <--> CPU */
77723f1c KM	178	SND_SOC_DAILINK_DEFS(out,
	179	DAILINK_COMP_ARRAY(COMP_CPU("omap-mcbsp.2")),
	180	DAILINK_COMP_ARRAY(COMP_CODEC("twl4030-codec", "twl4030-hifi")),
	181	DAILINK_COMP_ARRAY(COMP_PLATFORM("omap-mcbsp.2")));
	182
	183	SND_SOC_DAILINK_DEFS(in,
	184	DAILINK_COMP_ARRAY(COMP_CPU("omap-mcbsp.4")),
	185	DAILINK_COMP_ARRAY(COMP_CODEC("twl4030-codec", "twl4030-hifi")),
	186	DAILINK_COMP_ARRAY(COMP_PLATFORM("omap-mcbsp.4")));
	187
68fb7407 GI	188	static struct snd_soc_dai_link omap3pandora_dai[] = {
	189	{
	190	.name = "PCM1773",
	191	.stream_name = "HiFi Out",
cf9feff2 JN	192	.dai_fmt = SND_SOC_DAIFMT_I2S \| SND_SOC_DAIFMT_NB_NF \|
cf9feff2 JN	193	SND_SOC_DAIFMT_CBS_CFS,
4b94dba0	194	.ops = &omap3pandora_ops,
68fb7407	195	.init = omap3pandora_out_init,
77723f1c	196	SND_SOC_DAILINK_REG(out),
68fb7407 GI	197	}, {
	198	.name = "TWL4030",
	199	.stream_name = "Line/Mic In",
cf9feff2 JN	200	.dai_fmt = SND_SOC_DAIFMT_I2S \| SND_SOC_DAIFMT_NB_NF \|
cf9feff2 JN	201	SND_SOC_DAIFMT_CBS_CFS,
4b94dba0	202	.ops = &omap3pandora_ops,
68fb7407	203	.init = omap3pandora_in_init,
77723f1c	204	SND_SOC_DAILINK_REG(in),
68fb7407 GI	205	}
	206	};
	207
	208	/* SoC card */
	209	static struct snd_soc_card snd_soc_card_omap3pandora = {
	210	.name = "omap3pandora",
b425b884	211	.owner = THIS_MODULE,
68fb7407 GI	212	.dai_link = omap3pandora_dai,
68fb7407 GI	213	.num_links = ARRAY_SIZE(omap3pandora_dai),
b2e69054 LPC	214
	215	.dapm_widgets = omap3pandora_dapm_widgets,
	216	.num_dapm_widgets = ARRAY_SIZE(omap3pandora_dapm_widgets),
	217	.dapm_routes = omap3pandora_map,
	218	.num_dapm_routes = ARRAY_SIZE(omap3pandora_map),
68fb7407 GI	219	};
68fb7407 GI	220
68fb7407 GI	221	static struct platform_device *omap3pandora_snd_device;
	222
	223	static int __init omap3pandora_soc_init(void)
	224	{
	225	int ret;
	226
8f008062	227	if (!machine_is_omap3_pandora())
68fb7407	228	return -ENODEV;
8f008062	229
68fb7407 GI	230	pr_info("OMAP3 Pandora SoC init\n");
	231
	232	ret = gpio_request(OMAP3_PANDORA_DAC_POWER_GPIO, "dac_power");
	233	if (ret) {
	234	pr_err(PREFIX "Failed to get DAC power GPIO\n");
	235	return ret;
	236	}
	237
	238	ret = gpio_direction_output(OMAP3_PANDORA_DAC_POWER_GPIO, 0);
	239	if (ret) {
	240	pr_err(PREFIX "Failed to set DAC power GPIO direction\n");
	241	goto fail0;
	242	}
	243
	244	ret = gpio_request(OMAP3_PANDORA_AMP_POWER_GPIO, "amp_power");
	245	if (ret) {
	246	pr_err(PREFIX "Failed to get amp power GPIO\n");
	247	goto fail0;
	248	}
	249
	250	ret = gpio_direction_output(OMAP3_PANDORA_AMP_POWER_GPIO, 0);
	251	if (ret) {
	252	pr_err(PREFIX "Failed to set amp power GPIO direction\n");
	253	goto fail1;
	254	}
	255
	256	omap3pandora_snd_device = platform_device_alloc("soc-audio", -1);
	257	if (omap3pandora_snd_device == NULL) {
	258	pr_err(PREFIX "Platform device allocation failed\n");
	259	ret = -ENOMEM;
	260	goto fail1;
	261	}
	262
f0fba2ad	263	platform_set_drvdata(omap3pandora_snd_device, &snd_soc_card_omap3pandora);
68fb7407 GI	264
	265	ret = platform_device_add(omap3pandora_snd_device);
	266	if (ret) {
	267	pr_err(PREFIX "Unable to add platform device\n");
	268	goto fail2;
	269	}
	270
c50749de GI	271	omap3pandora_dac_reg = regulator_get(&omap3pandora_snd_device->dev, "vcc");
	272	if (IS_ERR(omap3pandora_dac_reg)) {
	273	pr_err(PREFIX "Failed to get DAC regulator from %s: %ld\n",
	274	dev_name(&omap3pandora_snd_device->dev),
	275	PTR_ERR(omap3pandora_dac_reg));
5c12d201	276	ret = PTR_ERR(omap3pandora_dac_reg);
c50749de GI	277	goto fail3;
	278	}
	279
68fb7407 GI	280	return 0;
68fb7407 GI	281
c50749de GI	282	fail3:
c50749de GI	283	platform_device_del(omap3pandora_snd_device);
68fb7407 GI	284	fail2:
	285	platform_device_put(omap3pandora_snd_device);
	286	fail1:
	287	gpio_free(OMAP3_PANDORA_AMP_POWER_GPIO);
	288	fail0:
	289	gpio_free(OMAP3_PANDORA_DAC_POWER_GPIO);
	290	return ret;
	291	}
	292	module_init(omap3pandora_soc_init);
	293
	294	static void __exit omap3pandora_soc_exit(void)
	295	{
c50749de	296	regulator_put(omap3pandora_dac_reg);
68fb7407 GI	297	platform_device_unregister(omap3pandora_snd_device);
	298	gpio_free(OMAP3_PANDORA_AMP_POWER_GPIO);
	299	gpio_free(OMAP3_PANDORA_DAC_POWER_GPIO);
	300	}
	301	module_exit(omap3pandora_soc_exit);
	302
	303	MODULE_AUTHOR("Grazvydas Ignotas <notasas@gmail.com>");
	304	MODULE_DESCRIPTION("ALSA SoC OMAP3 Pandora");
	305	MODULE_LICENSE("GPL");