[GitHub/mt8127/android_kernel_alcatel_ttab.git] / sound / soc / pxa / poodle.c

/*
 * poodle.c  --  SoC audio for Poodle
 *
 * Copyright 2005 Wolfson Microelectronics PLC.
 * Copyright 2005 Openedhand Ltd.
 *
 * Authors: Liam Girdwood <lrg@slimlogic.co.uk>
 *          Richard Purdie <richard@openedhand.com>
 *
 *  This program is free software; you can redistribute  it and/or modify it
 *  under  the terms of  the GNU General  Public License as published by the
 *  Free Software Foundation;  either version 2 of the  License, or (at your
 *  option) any later version.
 *
 */

#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/timer.h>
#include <linux/i2c.h>
#include <linux/interrupt.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 <asm/hardware/locomo.h>
#include <mach/poodle.h>
#include <mach/audio.h>

#include "../codecs/wm8731.h"
#include "pxa2xx-i2s.h"

#define POODLE_HP        1
#define POODLE_HP_OFF    0
#define POODLE_SPK_ON    1
#define POODLE_SPK_OFF   0

 /* audio clock in Hz - rounded from 12.235MHz */
#define POODLE_AUDIO_CLOCK 12288000

static int poodle_jack_func;
static int poodle_spk_func;

static void poodle_ext_control(struct snd_soc_codec *codec)
{
	/* set up jack connection */
	if (poodle_jack_func == POODLE_HP) {
		/* set = unmute headphone */
		locomo_gpio_write(&poodle_locomo_device.dev,
			POODLE_LOCOMO_GPIO_MUTE_L, 1);
		locomo_gpio_write(&poodle_locomo_device.dev,
			POODLE_LOCOMO_GPIO_MUTE_R, 1);
		snd_soc_dapm_enable_pin(codec, "Headphone Jack");
	} else {
		locomo_gpio_write(&poodle_locomo_device.dev,
			POODLE_LOCOMO_GPIO_MUTE_L, 0);
		locomo_gpio_write(&poodle_locomo_device.dev,
			POODLE_LOCOMO_GPIO_MUTE_R, 0);
		snd_soc_dapm_disable_pin(codec, "Headphone Jack");
	}

	/* set the enpoints to their new connetion states */
	if (poodle_spk_func == POODLE_SPK_ON)
		snd_soc_dapm_enable_pin(codec, "Ext Spk");
	else
		snd_soc_dapm_disable_pin(codec, "Ext Spk");

	/* signal a DAPM event */
	snd_soc_dapm_sync(codec);
}

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

	/* check the jack status at stream startup */
	poodle_ext_control(codec);
	return 0;
}

/* we need to unmute the HP at shutdown as the mute burns power on poodle */
static void poodle_shutdown(struct snd_pcm_substream *substream)
{
	/* set = unmute headphone */
	locomo_gpio_write(&poodle_locomo_device.dev,
		POODLE_LOCOMO_GPIO_MUTE_L, 1);
	locomo_gpio_write(&poodle_locomo_device.dev,
		POODLE_LOCOMO_GPIO_MUTE_R, 1);
}

static int poodle_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;
	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
	unsigned int clk = 0;
	int ret = 0;

	switch (params_rate(params)) {
	case 8000:
	case 16000:
	case 48000:
	case 96000:
		clk = 12288000;
		break;
	case 11025:
	case 22050:
	case 44100:
		clk = 11289600;
		break;
	}

	/* set codec DAI configuration */
	ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S |
		SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS);
	if (ret < 0)
		return ret;

	/* set cpu DAI configuration */
	ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S |
		SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS);
	if (ret < 0)
		return ret;

	/* set the codec system clock for DAC and ADC */
	ret = snd_soc_dai_set_sysclk(codec_dai, WM8731_SYSCLK_XTAL, clk,
		SND_SOC_CLOCK_IN);
	if (ret < 0)
		return ret;

	/* set the I2S system clock as input (unused) */
	ret = snd_soc_dai_set_sysclk(cpu_dai, PXA2XX_I2S_SYSCLK, 0,
		SND_SOC_CLOCK_IN);
	if (ret < 0)
		return ret;

	return 0;
}

static struct snd_soc_ops poodle_ops = {
	.startup = poodle_startup,
	.hw_params = poodle_hw_params,
	.shutdown = poodle_shutdown,
};

static int poodle_get_jack(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
{
	ucontrol->value.integer.value[0] = poodle_jack_func;
	return 0;
}

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

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

	poodle_jack_func = ucontrol->value.integer.value[0];
	poodle_ext_control(codec);
	return 1;
}

static int poodle_get_spk(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
{
	ucontrol->value.integer.value[0] = poodle_spk_func;
	return 0;
}

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

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

	poodle_spk_func = ucontrol->value.integer.value[0];
	poodle_ext_control(codec);
	return 1;
}

static int poodle_amp_event(struct snd_soc_dapm_widget *w,
	struct snd_kcontrol *k, int event)
{
	if (SND_SOC_DAPM_EVENT_ON(event))
		locomo_gpio_write(&poodle_locomo_device.dev,
			POODLE_LOCOMO_GPIO_AMP_ON, 0);
	else
		locomo_gpio_write(&poodle_locomo_device.dev,
			POODLE_LOCOMO_GPIO_AMP_ON, 1);

	return 0;
}

/* poodle machine dapm widgets */
static const struct snd_soc_dapm_widget wm8731_dapm_widgets[] = {
SND_SOC_DAPM_HP("Headphone Jack", NULL),
SND_SOC_DAPM_SPK("Ext Spk", poodle_amp_event),
};

/* Corgi machine connections to the codec pins */
static const struct snd_soc_dapm_route audio_map[] = {

	/* headphone connected to LHPOUT1, RHPOUT1 */
	{"Headphone Jack", NULL, "LHPOUT"},
	{"Headphone Jack", NULL, "RHPOUT"},

	/* speaker connected to LOUT, ROUT */
	{"Ext Spk", NULL, "ROUT"},
	{"Ext Spk", NULL, "LOUT"},
};

static const char *jack_function[] = {"Off", "Headphone"};
static const char *spk_function[] = {"Off", "On"};
static const struct soc_enum poodle_enum[] = {
	SOC_ENUM_SINGLE_EXT(2, jack_function),
	SOC_ENUM_SINGLE_EXT(2, spk_function),
};

static const struct snd_kcontrol_new wm8731_poodle_controls[] = {
	SOC_ENUM_EXT("Jack Function", poodle_enum[0], poodle_get_jack,
		poodle_set_jack),
	SOC_ENUM_EXT("Speaker Function", poodle_enum[1], poodle_get_spk,
		poodle_set_spk),
};

/*
 * Logic for a wm8731 as connected on a Sharp SL-C7x0 Device
 */
static int poodle_wm8731_init(struct snd_soc_pcm_runtime *rtd)
{
	struct snd_soc_codec *codec = rtd->codec;
	int err;

	snd_soc_dapm_nc_pin(codec, "LLINEIN");
	snd_soc_dapm_nc_pin(codec, "RLINEIN");
	snd_soc_dapm_enable_pin(codec, "MICIN");

	/* Add poodle specific controls */
	err = snd_soc_add_controls(codec, wm8731_poodle_controls,
				ARRAY_SIZE(wm8731_poodle_controls));
	if (err < 0)
		return err;

	/* Add poodle specific widgets */
	snd_soc_dapm_new_controls(codec, wm8731_dapm_widgets,
				  ARRAY_SIZE(wm8731_dapm_widgets));

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

	snd_soc_dapm_sync(codec);
	return 0;
}

/* poodle digital audio interface glue - connects codec <--> CPU */
static struct snd_soc_dai_link poodle_dai = {
	.name = "WM8731",
	.stream_name = "WM8731",
	.cpu_dai_name = "pxa-i2s",
	.codec_dai_name = "wm8731-hifi",
	.platform_name = "pxa-pcm-audio",
	.codec_name = "wm8731-codec.0-001a",
	.init = poodle_wm8731_init,
	.ops = &poodle_ops,
};

/* poodle audio machine driver */
static struct snd_soc_card snd_soc_poodle = {
	.name = "Poodle",
	.dai_link = &poodle_dai,
	.num_links = 1,
	.owner = THIS_MODULE,
};

static struct platform_device *poodle_snd_device;

static int __init poodle_init(void)
{
	int ret;

	if (!machine_is_poodle())
		return -ENODEV;

	locomo_gpio_set_dir(&poodle_locomo_device.dev,
		POODLE_LOCOMO_GPIO_AMP_ON, 0);
	/* should we mute HP at startup - burning power ?*/
	locomo_gpio_set_dir(&poodle_locomo_device.dev,
		POODLE_LOCOMO_GPIO_MUTE_L, 0);
	locomo_gpio_set_dir(&poodle_locomo_device.dev,
		POODLE_LOCOMO_GPIO_MUTE_R, 0);

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

	platform_set_drvdata(poodle_snd_device, &snd_soc_poodle);
	ret = platform_device_add(poodle_snd_device);

	if (ret)
		platform_device_put(poodle_snd_device);

	return ret;
}

static void __exit poodle_exit(void)
{
	platform_device_unregister(poodle_snd_device);
}

module_init(poodle_init);
module_exit(poodle_exit);

/* Module information */
MODULE_AUTHOR("Richard Purdie");
MODULE_DESCRIPTION("ALSA SoC Poodle");
MODULE_LICENSE("GPL");
Commit	Line	Data
6e24dd93 LG	1	/*
	2	* poodle.c -- SoC audio for Poodle
	3	*
	4	* Copyright 2005 Wolfson Microelectronics PLC.
	5	* Copyright 2005 Openedhand Ltd.
	6	*
d331124d	7	* Authors: Liam Girdwood <lrg@slimlogic.co.uk>
6e24dd93 LG	8	* Richard Purdie <richard@openedhand.com>
	9	*
	10	* This program is free software; you can redistribute it and/or modify it
	11	* under the terms of the GNU General Public License as published by the
	12	* Free Software Foundation; either version 2 of the License, or (at your
	13	* option) any later version.
	14	*
	15	*/
	16
	17	#include <linux/module.h>
	18	#include <linux/moduleparam.h>
	19	#include <linux/timer.h>
fc996757	20	#include <linux/i2c.h>
6e24dd93 LG	21	#include <linux/interrupt.h>
6e24dd93 LG	22	#include <linux/platform_device.h>
6e24dd93 LG	23	#include <sound/core.h>
	24	#include <sound/pcm.h>
	25	#include <sound/soc.h>
	26	#include <sound/soc-dapm.h>
	27
	28	#include <asm/mach-types.h>
	29	#include <asm/hardware/locomo.h>
a09e64fb RK	30	#include <mach/poodle.h>
a09e64fb RK	31	#include <mach/audio.h>
6e24dd93 LG	32
6e24dd93 LG	33	#include "../codecs/wm8731.h"
73f40dc1	34	#include "pxa2xx-i2s.h"
6e24dd93 LG	35
	36	#define POODLE_HP 1
	37	#define POODLE_HP_OFF 0
	38	#define POODLE_SPK_ON 1
	39	#define POODLE_SPK_OFF 0
	40
	41	/* audio clock in Hz - rounded from 12.235MHz */
	42	#define POODLE_AUDIO_CLOCK 12288000
	43
	44	static int poodle_jack_func;
	45	static int poodle_spk_func;
	46
	47	static void poodle_ext_control(struct snd_soc_codec *codec)
	48	{
6e24dd93 LG	49	/* set up jack connection */
	50	if (poodle_jack_func == POODLE_HP) {
	51	/* set = unmute headphone */
	52	locomo_gpio_write(&poodle_locomo_device.dev,
	53	POODLE_LOCOMO_GPIO_MUTE_L, 1);
	54	locomo_gpio_write(&poodle_locomo_device.dev,
	55	POODLE_LOCOMO_GPIO_MUTE_R, 1);
a5302181	56	snd_soc_dapm_enable_pin(codec, "Headphone Jack");
6e24dd93 LG	57	} else {
	58	locomo_gpio_write(&poodle_locomo_device.dev,
	59	POODLE_LOCOMO_GPIO_MUTE_L, 0);
	60	locomo_gpio_write(&poodle_locomo_device.dev,
	61	POODLE_LOCOMO_GPIO_MUTE_R, 0);
a5302181	62	snd_soc_dapm_disable_pin(codec, "Headphone Jack");
6e24dd93 LG	63	}
6e24dd93 LG	64
6e24dd93	65	/* set the enpoints to their new connetion states */
a5302181 LG	66	if (poodle_spk_func == POODLE_SPK_ON)
	67	snd_soc_dapm_enable_pin(codec, "Ext Spk");
	68	else
	69	snd_soc_dapm_disable_pin(codec, "Ext Spk");
6e24dd93 LG	70
6e24dd93 LG	71	/* signal a DAPM event */
a5302181	72	snd_soc_dapm_sync(codec);
6e24dd93 LG	73	}
	74
	75	static int poodle_startup(struct snd_pcm_substream *substream)
	76	{
	77	struct snd_soc_pcm_runtime *rtd = substream->private_data;
f0fba2ad	78	struct snd_soc_codec *codec = rtd->codec;
6e24dd93 LG	79
	80	/* check the jack status at stream startup */
	81	poodle_ext_control(codec);
	82	return 0;
	83	}
	84
	85	/* we need to unmute the HP at shutdown as the mute burns power on poodle */
877db3c1	86	static void poodle_shutdown(struct snd_pcm_substream *substream)
6e24dd93	87	{
6e24dd93 LG	88	/* set = unmute headphone */
	89	locomo_gpio_write(&poodle_locomo_device.dev,
	90	POODLE_LOCOMO_GPIO_MUTE_L, 1);
	91	locomo_gpio_write(&poodle_locomo_device.dev,
	92	POODLE_LOCOMO_GPIO_MUTE_R, 1);
6e24dd93 LG	93	}
6e24dd93 LG	94
73f40dc1 LG	95	static int poodle_hw_params(struct snd_pcm_substream *substream,
	96	struct snd_pcm_hw_params *params)
	97	{
	98	struct snd_soc_pcm_runtime *rtd = substream->private_data;
f0fba2ad LG	99	struct snd_soc_dai *codec_dai = rtd->codec_dai;
f0fba2ad LG	100	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
73f40dc1 LG	101	unsigned int clk = 0;
	102	int ret = 0;
	103
	104	switch (params_rate(params)) {
	105	case 8000:
	106	case 16000:
	107	case 48000:
	108	case 96000:
	109	clk = 12288000;
	110	break;
	111	case 11025:
	112	case 22050:
	113	case 44100:
	114	clk = 11289600;
	115	break;
	116	}
	117
	118	/* set codec DAI configuration */
64105cfd	119	ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S \|
73f40dc1 LG	120	SND_SOC_DAIFMT_NB_NF \| SND_SOC_DAIFMT_CBS_CFS);
	121	if (ret < 0)
	122	return ret;
	123
	124	/* set cpu DAI configuration */
64105cfd	125	ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S \|
73f40dc1 LG	126	SND_SOC_DAIFMT_NB_NF \| SND_SOC_DAIFMT_CBS_CFS);
	127	if (ret < 0)
	128	return ret;
	129
	130	/* set the codec system clock for DAC and ADC */
e7712510	131	ret = snd_soc_dai_set_sysclk(codec_dai, WM8731_SYSCLK_XTAL, clk,
73f40dc1 LG	132	SND_SOC_CLOCK_IN);
	133	if (ret < 0)
	134	return ret;
	135
	136	/* set the I2S system clock as input (unused) */
64105cfd	137	ret = snd_soc_dai_set_sysclk(cpu_dai, PXA2XX_I2S_SYSCLK, 0,
73f40dc1 LG	138	SND_SOC_CLOCK_IN);
	139	if (ret < 0)
	140	return ret;
	141
	142	return 0;
	143	}
	144
6e24dd93 LG	145	static struct snd_soc_ops poodle_ops = {
6e24dd93 LG	146	.startup = poodle_startup,
73f40dc1	147	.hw_params = poodle_hw_params,
6e24dd93 LG	148	.shutdown = poodle_shutdown,
	149	};
	150
	151	static int poodle_get_jack(struct snd_kcontrol *kcontrol,
	152	struct snd_ctl_elem_value *ucontrol)
	153	{
	154	ucontrol->value.integer.value[0] = poodle_jack_func;
	155	return 0;
	156	}
	157
	158	static int poodle_set_jack(struct snd_kcontrol *kcontrol,
	159	struct snd_ctl_elem_value *ucontrol)
	160	{
	161	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
	162
	163	if (poodle_jack_func == ucontrol->value.integer.value[0])
	164	return 0;
	165
	166	poodle_jack_func = ucontrol->value.integer.value[0];
	167	poodle_ext_control(codec);
	168	return 1;
	169	}
	170
	171	static int poodle_get_spk(struct snd_kcontrol *kcontrol,
	172	struct snd_ctl_elem_value *ucontrol)
	173	{
	174	ucontrol->value.integer.value[0] = poodle_spk_func;
	175	return 0;
	176	}
	177
	178	static int poodle_set_spk(struct snd_kcontrol *kcontrol,
	179	struct snd_ctl_elem_value *ucontrol)
	180	{
	181	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
	182
	183	if (poodle_spk_func == ucontrol->value.integer.value[0])
	184	return 0;
	185
	186	poodle_spk_func = ucontrol->value.integer.value[0];
	187	poodle_ext_control(codec);
	188	return 1;
	189	}
	190
338c7ed0 JN	191	static int poodle_amp_event(struct snd_soc_dapm_widget *w,
338c7ed0 JN	192	struct snd_kcontrol *k, int event)
6e24dd93 LG	193	{
	194	if (SND_SOC_DAPM_EVENT_ON(event))
	195	locomo_gpio_write(&poodle_locomo_device.dev,
	196	POODLE_LOCOMO_GPIO_AMP_ON, 0);
	197	else
	198	locomo_gpio_write(&poodle_locomo_device.dev,
	199	POODLE_LOCOMO_GPIO_AMP_ON, 1);
	200
	201	return 0;
	202	}
	203
	204	/* poodle machine dapm widgets */
	205	static const struct snd_soc_dapm_widget wm8731_dapm_widgets[] = {
	206	SND_SOC_DAPM_HP("Headphone Jack", NULL),
	207	SND_SOC_DAPM_SPK("Ext Spk", poodle_amp_event),
	208	};
	209
25191c45 MB	210	/* Corgi machine connections to the codec pins */
25191c45 MB	211	static const struct snd_soc_dapm_route audio_map[] = {
6e24dd93 LG	212
	213	/* headphone connected to LHPOUT1, RHPOUT1 */
	214	{"Headphone Jack", NULL, "LHPOUT"},
	215	{"Headphone Jack", NULL, "RHPOUT"},
	216
	217	/* speaker connected to LOUT, ROUT */
	218	{"Ext Spk", NULL, "ROUT"},
	219	{"Ext Spk", NULL, "LOUT"},
6e24dd93 LG	220	};
	221
	222	static const char *jack_function[] = {"Off", "Headphone"};
	223	static const char *spk_function[] = {"Off", "On"};
	224	static const struct soc_enum poodle_enum[] = {
	225	SOC_ENUM_SINGLE_EXT(2, jack_function),
	226	SOC_ENUM_SINGLE_EXT(2, spk_function),
	227	};
	228
877db3c1	229	static const struct snd_kcontrol_new wm8731_poodle_controls[] = {
6e24dd93 LG	230	SOC_ENUM_EXT("Jack Function", poodle_enum[0], poodle_get_jack,
	231	poodle_set_jack),
	232	SOC_ENUM_EXT("Speaker Function", poodle_enum[1], poodle_get_spk,
	233	poodle_set_spk),
	234	};
	235
	236	/*
	237	* Logic for a wm8731 as connected on a Sharp SL-C7x0 Device
	238	*/
f0fba2ad	239	static int poodle_wm8731_init(struct snd_soc_pcm_runtime *rtd)
6e24dd93	240	{
f0fba2ad	241	struct snd_soc_codec *codec = rtd->codec;
eb5f6d75	242	int err;
6e24dd93	243
35f5e54d MB	244	snd_soc_dapm_nc_pin(codec, "LLINEIN");
35f5e54d MB	245	snd_soc_dapm_nc_pin(codec, "RLINEIN");
a5302181	246	snd_soc_dapm_enable_pin(codec, "MICIN");
6e24dd93 LG	247
6e24dd93 LG	248	/* Add poodle specific controls */
eb5f6d75 PZ	249	err = snd_soc_add_controls(codec, wm8731_poodle_controls,
	250	ARRAY_SIZE(wm8731_poodle_controls));
	251	if (err < 0)
	252	return err;
6e24dd93 LG	253
6e24dd93 LG	254	/* Add poodle specific widgets */
25191c45 MB	255	snd_soc_dapm_new_controls(codec, wm8731_dapm_widgets,
25191c45 MB	256	ARRAY_SIZE(wm8731_dapm_widgets));
6e24dd93 LG	257
6e24dd93 LG	258	/* Set up poodle specific audio path audio_map */
25191c45	259	snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
6e24dd93	260
a5302181	261	snd_soc_dapm_sync(codec);
6e24dd93 LG	262	return 0;
	263	}
	264
6e24dd93 LG	265	/* poodle digital audio interface glue - connects codec <--> CPU */
	266	static struct snd_soc_dai_link poodle_dai = {
	267	.name = "WM8731",
	268	.stream_name = "WM8731",
f0fba2ad	269	.cpu_dai_name = "pxa-i2s",
1593d7dd	270	.codec_dai_name = "wm8731-hifi",
f0fba2ad LG	271	.platform_name = "pxa-pcm-audio",
f0fba2ad LG	272	.codec_name = "wm8731-codec.0-001a",
6e24dd93	273	.init = poodle_wm8731_init,
73f40dc1	274	.ops = &poodle_ops,
6e24dd93 LG	275	};
	276
	277	/* poodle audio machine driver */
87506549	278	static struct snd_soc_card snd_soc_poodle = {
6e24dd93 LG	279	.name = "Poodle",
	280	.dai_link = &poodle_dai,
	281	.num_links = 1,
f0fba2ad	282	.owner = THIS_MODULE,
6e24dd93 LG	283	};
	284
	285	static struct platform_device *poodle_snd_device;
	286
	287	static int __init poodle_init(void)
	288	{
	289	int ret;
	290
	291	if (!machine_is_poodle())
	292	return -ENODEV;
	293
	294	locomo_gpio_set_dir(&poodle_locomo_device.dev,
	295	POODLE_LOCOMO_GPIO_AMP_ON, 0);
	296	/* should we mute HP at startup - burning power ?*/
	297	locomo_gpio_set_dir(&poodle_locomo_device.dev,
	298	POODLE_LOCOMO_GPIO_MUTE_L, 0);
	299	locomo_gpio_set_dir(&poodle_locomo_device.dev,
	300	POODLE_LOCOMO_GPIO_MUTE_R, 0);
	301
	302	poodle_snd_device = platform_device_alloc("soc-audio", -1);
	303	if (!poodle_snd_device)
	304	return -ENOMEM;
	305
f0fba2ad	306	platform_set_drvdata(poodle_snd_device, &snd_soc_poodle);
6e24dd93 LG	307	ret = platform_device_add(poodle_snd_device);
	308
	309	if (ret)
	310	platform_device_put(poodle_snd_device);
	311
	312	return ret;
	313	}
	314
	315	static void __exit poodle_exit(void)
	316	{
	317	platform_device_unregister(poodle_snd_device);
	318	}
	319
	320	module_init(poodle_init);
	321	module_exit(poodle_exit);
	322
	323	/* Module information */
	324	MODULE_AUTHOR("Richard Purdie");
	325	MODULE_DESCRIPTION("ALSA SoC Poodle");
	326	MODULE_LICENSE("GPL");