[linux-2.6-block.git] / sound / soc / at91 / eti_b1_wm8731.c

/*
 * eti_b1_wm8731  --  SoC audio for AT91RM9200-based Endrelia ETI_B1 board.
 *
 * Author:	Frank Mandarino <fmandarino@endrelia.com>
 *		Endrelia Technologies Inc.
 * Created:	Mar 29, 2006
 *
 * Based on corgi.c by:
 *
 * Copyright 2005 Wolfson Microelectronics PLC.
 * Copyright 2005 Openedhand Ltd.
 *
 * Authors: Liam Girdwood <liam.girdwood@wolfsonmicro.com>
 *          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/kernel.h>
#include <linux/clk.h>
#include <linux/timer.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 <mach/hardware.h>
#include <mach/gpio.h>

#include "../codecs/wm8731.h"
#include "at91-pcm.h"
#include "at91-ssc.h"

#if 0
#define	DBG(x...)	printk(KERN_INFO "eti_b1_wm8731: " x)
#else
#define	DBG(x...)
#endif

static struct clk *pck1_clk;
static struct clk *pllb_clk;


static int eti_b1_startup(struct snd_pcm_substream *substream)
{
	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	struct snd_soc_dai *codec_dai = rtd->dai->codec_dai;
	struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
	int ret;

	/* cpu clock is the AT91 master clock sent to the SSC */
	ret = snd_soc_dai_set_sysclk(cpu_dai, AT91_SYSCLK_MCK,
		60000000, SND_SOC_CLOCK_IN);
	if (ret < 0)
		return ret;

	/* codec system clock is supplied by PCK1, set to 12MHz */
	ret = snd_soc_dai_set_sysclk(codec_dai, WM8731_SYSCLK,
		12000000, SND_SOC_CLOCK_IN);
	if (ret < 0)
		return ret;

	/* Start PCK1 clock. */
	clk_enable(pck1_clk);
	DBG("pck1 started\n");

	return 0;
}

static void eti_b1_shutdown(struct snd_pcm_substream *substream)
{
	/* Stop PCK1 clock. */
	clk_disable(pck1_clk);
	DBG("pck1 stopped\n");
}

static int eti_b1_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->dai->codec_dai;
	struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
	int ret;

#ifdef CONFIG_SND_AT91_SOC_ETI_SLAVE
	unsigned int rate;
	int cmr_div, period;

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

	/*
	 * The SSC clock dividers depend on the sample rate.  The CMR.DIV
	 * field divides the system master clock MCK to drive the SSC TK
	 * signal which provides the codec BCLK.  The TCMR.PERIOD and
	 * RCMR.PERIOD fields further divide the BCLK signal to drive
	 * the SSC TF and RF signals which provide the codec DACLRC and
	 * ADCLRC clocks.
	 *
	 * The dividers were determined through trial and error, where a
	 * CMR.DIV value is chosen such that the resulting BCLK value is
	 * divisible, or almost divisible, by (2 * sample rate), and then
	 * the TCMR.PERIOD or RCMR.PERIOD is BCLK / (2 * sample rate) - 1.
	 */
	rate = params_rate(params);

	switch (rate) {
	case 8000:
		cmr_div = 25;	/* BCLK = 60MHz/(2*25) = 1.2MHz */
		period = 74;	/* LRC = BCLK/(2*(74+1)) = 8000Hz */
		break;
	case 32000:
		cmr_div = 7;	/* BCLK = 60MHz/(2*7) ~= 4.28571428MHz */
		period = 66;	/* LRC = BCLK/(2*(66+1)) = 31982.942Hz */
		break;
	case 48000:
		cmr_div = 13;	/* BCLK = 60MHz/(2*13) ~= 2.3076923MHz */
		period = 23;	/* LRC = BCLK/(2*(23+1)) = 48076.923Hz */
		break;
	default:
		printk(KERN_WARNING "unsupported rate %d on ETI-B1 board\n", rate);
		return -EINVAL;
	}

	/* set the MCK divider for BCLK */
	ret = snd_soc_dai_set_clkdiv(cpu_dai, AT91SSC_CMR_DIV, cmr_div);
	if (ret < 0)
		return ret;

	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
		/* set the BCLK divider for DACLRC */
		ret = snd_soc_dai_set_clkdiv(cpu_dai,
						AT91SSC_TCMR_PERIOD, period);
	} else {
		/* set the BCLK divider for ADCLRC */
		ret = snd_soc_dai_set_clkdiv(cpu_dai,
						AT91SSC_RCMR_PERIOD, period);
	}
	if (ret < 0)
		return ret;

#else /* CONFIG_SND_AT91_SOC_ETI_SLAVE */
	/*
	 * Codec in Master Mode.
	 */

	/* set codec DAI configuration */
	ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S |
		SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBM_CFM);
	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_CBM_CFM);
	if (ret < 0)
		return ret;

#endif /* CONFIG_SND_AT91_SOC_ETI_SLAVE */

	return 0;
}

static struct snd_soc_ops eti_b1_ops = {
	.startup = eti_b1_startup,
	.hw_params = eti_b1_hw_params,
	.shutdown = eti_b1_shutdown,
};


static const struct snd_soc_dapm_widget eti_b1_dapm_widgets[] = {
	SND_SOC_DAPM_MIC("Int Mic", NULL),
	SND_SOC_DAPM_SPK("Ext Spk", NULL),
};

static const struct snd_soc_dapm_route intercon[] = {

	/* speaker connected to LHPOUT */
	{"Ext Spk", NULL, "LHPOUT"},

	/* mic is connected to Mic Jack, with WM8731 Mic Bias */
	{"MICIN", NULL, "Mic Bias"},
	{"Mic Bias", NULL, "Int Mic"},
};

/*
 * Logic for a wm8731 as connected on a Endrelia ETI-B1 board.
 */
static int eti_b1_wm8731_init(struct snd_soc_codec *codec)
{
	DBG("eti_b1_wm8731_init() called\n");

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

	/* Set up specific audio path interconnects */
	snd_soc_dapm_add_route(codec, intercon, ARRAY_SIZE(intercon));

	/* not connected */
	snd_soc_dapm_disable_pin(codec, "RLINEIN");
	snd_soc_dapm_disable_pin(codec, "LLINEIN");

	/* always connected */
	snd_soc_dapm_enable_pin(codec, "Int Mic");
	snd_soc_dapm_enable_pin(codec, "Ext Spk");

	snd_soc_dapm_sync(codec);

	return 0;
}

static struct snd_soc_dai_link eti_b1_dai = {
	.name = "WM8731",
	.stream_name = "WM8731 PCM",
	.cpu_dai = &at91_ssc_dai[1],
	.codec_dai = &wm8731_dai,
	.init = eti_b1_wm8731_init,
	.ops = &eti_b1_ops,
};

static struct snd_soc_machine snd_soc_machine_eti_b1 = {
	.name = "ETI_B1_WM8731",
	.dai_link = &eti_b1_dai,
	.num_links = 1,
};

static struct wm8731_setup_data eti_b1_wm8731_setup = {
	.i2c_bus = 0,
	.i2c_address = 0x1a,
};

static struct snd_soc_device eti_b1_snd_devdata = {
	.machine = &snd_soc_machine_eti_b1,
	.platform = &at91_soc_platform,
	.codec_dev = &soc_codec_dev_wm8731,
	.codec_data = &eti_b1_wm8731_setup,
};

static struct platform_device *eti_b1_snd_device;

static int __init eti_b1_init(void)
{
	int ret;
	struct at91_ssc_periph *ssc = eti_b1_dai.cpu_dai->private_data;

	if (!request_mem_region(AT91RM9200_BASE_SSC1, SZ_16K, "soc-audio")) {
		DBG("SSC1 memory region is busy\n");
		return -EBUSY;
	}

	ssc->base = ioremap(AT91RM9200_BASE_SSC1, SZ_16K);
	if (!ssc->base) {
		DBG("SSC1 memory ioremap failed\n");
		ret = -ENOMEM;
		goto fail_release_mem;
	}

	ssc->pid = AT91RM9200_ID_SSC1;

	eti_b1_snd_device = platform_device_alloc("soc-audio", -1);
	if (!eti_b1_snd_device) {
		DBG("platform device allocation failed\n");
		ret = -ENOMEM;
		goto fail_io_unmap;
	}

	platform_set_drvdata(eti_b1_snd_device, &eti_b1_snd_devdata);
	eti_b1_snd_devdata.dev = &eti_b1_snd_device->dev;

	ret = platform_device_add(eti_b1_snd_device);
	if (ret) {
		DBG("platform device add failed\n");
		platform_device_put(eti_b1_snd_device);
		goto fail_io_unmap;
	}

	at91_set_A_periph(AT91_PIN_PB6, 0);	/* TF1 */
	at91_set_A_periph(AT91_PIN_PB7, 0);	/* TK1 */
	at91_set_A_periph(AT91_PIN_PB8, 0);	/* TD1 */
	at91_set_A_periph(AT91_PIN_PB9, 0);	/* RD1 */
/*	at91_set_A_periph(AT91_PIN_PB10, 0);*/	/* RK1 */
	at91_set_A_periph(AT91_PIN_PB11, 0);	/* RF1 */

	/*
	 * Set PCK1 parent to PLLB and its rate to 12 Mhz.
	 */
	pllb_clk = clk_get(NULL, "pllb");
	pck1_clk = clk_get(NULL, "pck1");

	clk_set_parent(pck1_clk, pllb_clk);
	clk_set_rate(pck1_clk, 12000000);

	DBG("MCLK rate %luHz\n", clk_get_rate(pck1_clk));

	/* assign the GPIO pin to PCK1 */
	at91_set_B_periph(AT91_PIN_PA24, 0);

#ifdef CONFIG_SND_AT91_SOC_ETI_SLAVE
	printk(KERN_INFO "eti_b1_wm8731: Codec in Slave Mode\n");
#else
	printk(KERN_INFO "eti_b1_wm8731: Codec in Master Mode\n");
#endif
	return ret;

fail_io_unmap:
	iounmap(ssc->base);
fail_release_mem:
	release_mem_region(AT91RM9200_BASE_SSC1, SZ_16K);
	return ret;
}

static void __exit eti_b1_exit(void)
{
	struct at91_ssc_periph *ssc = eti_b1_dai.cpu_dai->private_data;

	clk_put(pck1_clk);
	clk_put(pllb_clk);

	platform_device_unregister(eti_b1_snd_device);

	iounmap(ssc->base);
	release_mem_region(AT91RM9200_BASE_SSC1, SZ_16K);
}

module_init(eti_b1_init);
module_exit(eti_b1_exit);

/* Module information */
MODULE_AUTHOR("Frank Mandarino <fmandarino@endrelia.com>");
MODULE_DESCRIPTION("ALSA SoC ETI-B1-WM8731");
MODULE_LICENSE("GPL");
Commit	Line	Data
b41bf38a	1	/*
9f0ac6e1	2	* eti_b1_wm8731 -- SoC audio for AT91RM9200-based Endrelia ETI_B1 board.
b41bf38a FM	3	*
	4	* Author: Frank Mandarino <fmandarino@endrelia.com>
	5	* Endrelia Technologies Inc.
	6	* Created: Mar 29, 2006
	7	*
	8	* Based on corgi.c by:
	9	*
	10	* Copyright 2005 Wolfson Microelectronics PLC.
	11	* Copyright 2005 Openedhand Ltd.
	12	*
	13	* Authors: Liam Girdwood <liam.girdwood@wolfsonmicro.com>
	14	* Richard Purdie <richard@openedhand.com>
	15	*
	16	* This program is free software; you can redistribute it and/or modify it
	17	* under the terms of the GNU General Public License as published by the
	18	* Free Software Foundation; either version 2 of the License, or (at your
	19	* option) any later version.
	20	*
b41bf38a FM	21	*/
	22
	23	#include <linux/module.h>
	24	#include <linux/moduleparam.h>
b41bf38a FM	25	#include <linux/kernel.h>
	26	#include <linux/clk.h>
	27	#include <linux/timer.h>
	28	#include <linux/interrupt.h>
	29	#include <linux/platform_device.h>
b41bf38a FM	30	#include <sound/core.h>
	31	#include <sound/pcm.h>
	32	#include <sound/soc.h>
	33	#include <sound/soc-dapm.h>
	34
a09e64fb RK	35	#include <mach/hardware.h>
a09e64fb RK	36	#include <mach/gpio.h>
b41bf38a FM	37
b41bf38a FM	38	#include "../codecs/wm8731.h"
9f0ac6e1	39	#include "at91-pcm.h"
eb831da5	40	#include "at91-ssc.h"
b41bf38a FM	41
b41bf38a FM	42	#if 0
c8044274	43	#define DBG(x...) printk(KERN_INFO "eti_b1_wm8731: " x)
b41bf38a FM	44	#else
	45	#define DBG(x...)
	46	#endif
	47
	48	static struct clk *pck1_clk;
	49	static struct clk *pllb_clk;
	50
c8044274	51
9f0ac6e1	52	static int eti_b1_startup(struct snd_pcm_substream *substream)
b41bf38a	53	{
c8044274	54	struct snd_soc_pcm_runtime *rtd = substream->private_data;
d37ae539 LG	55	struct snd_soc_dai *codec_dai = rtd->dai->codec_dai;
d37ae539 LG	56	struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
c8044274 FM	57	int ret;
	58
	59	/* cpu clock is the AT91 master clock sent to the SSC */
64105cfd	60	ret = snd_soc_dai_set_sysclk(cpu_dai, AT91_SYSCLK_MCK,
c8044274 FM	61	60000000, SND_SOC_CLOCK_IN);
	62	if (ret < 0)
	63	return ret;
	64
	65	/* codec system clock is supplied by PCK1, set to 12MHz */
64105cfd	66	ret = snd_soc_dai_set_sysclk(codec_dai, WM8731_SYSCLK,
c8044274 FM	67	12000000, SND_SOC_CLOCK_IN);
	68	if (ret < 0)
	69	return ret;
	70
b41bf38a FM	71	/* Start PCK1 clock. */
	72	clk_enable(pck1_clk);
	73	DBG("pck1 started\n");
	74
	75	return 0;
	76	}
	77
9f0ac6e1	78	static void eti_b1_shutdown(struct snd_pcm_substream *substream)
b41bf38a FM	79	{
	80	/* Stop PCK1 clock. */
	81	clk_disable(pck1_clk);
	82	DBG("pck1 stopped\n");
	83	}
	84
c8044274 FM	85	static int eti_b1_hw_params(struct snd_pcm_substream *substream,
	86	struct snd_pcm_hw_params *params)
	87	{
	88	struct snd_soc_pcm_runtime *rtd = substream->private_data;
d37ae539 LG	89	struct snd_soc_dai *codec_dai = rtd->dai->codec_dai;
d37ae539 LG	90	struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
c8044274 FM	91	int ret;
	92
	93	#ifdef CONFIG_SND_AT91_SOC_ETI_SLAVE
	94	unsigned int rate;
	95	int cmr_div, period;
	96
	97	/* set codec DAI configuration */
64105cfd	98	ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S \|
c8044274 FM	99	SND_SOC_DAIFMT_NB_NF \| SND_SOC_DAIFMT_CBS_CFS);
	100	if (ret < 0)
	101	return ret;
	102
	103	/* set cpu DAI configuration */
64105cfd	104	ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S \|
c8044274 FM	105	SND_SOC_DAIFMT_NB_NF \| SND_SOC_DAIFMT_CBS_CFS);
	106	if (ret < 0)
	107	return ret;
	108
	109	/*
	110	* The SSC clock dividers depend on the sample rate. The CMR.DIV
	111	* field divides the system master clock MCK to drive the SSC TK
	112	* signal which provides the codec BCLK. The TCMR.PERIOD and
	113	* RCMR.PERIOD fields further divide the BCLK signal to drive
	114	* the SSC TF and RF signals which provide the codec DACLRC and
	115	* ADCLRC clocks.
	116	*
	117	* The dividers were determined through trial and error, where a
	118	* CMR.DIV value is chosen such that the resulting BCLK value is
	119	* divisible, or almost divisible, by (2 * sample rate), and then
	120	* the TCMR.PERIOD or RCMR.PERIOD is BCLK / (2 * sample rate) - 1.
	121	*/
	122	rate = params_rate(params);
	123
	124	switch (rate) {
	125	case 8000:
	126	cmr_div = 25; /* BCLK = 60MHz/(225) = 1.2MHz /
	127	period = 74; /* LRC = BCLK/(2(74+1)) = 8000Hz /
	128	break;
	129	case 32000:
	130	cmr_div = 7; /* BCLK = 60MHz/(27) ~= 4.28571428MHz /
	131	period = 66; /* LRC = BCLK/(2(66+1)) = 31982.942Hz /
	132	break;
	133	case 48000:
	134	cmr_div = 13; /* BCLK = 60MHz/(213) ~= 2.3076923MHz /
	135	period = 23; /* LRC = BCLK/(2(23+1)) = 48076.923Hz /
	136	break;
	137	default:
	138	printk(KERN_WARNING "unsupported rate %d on ETI-B1 board\n", rate);
	139	return -EINVAL;
	140	}
	141
	142	/* set the MCK divider for BCLK */
64105cfd	143	ret = snd_soc_dai_set_clkdiv(cpu_dai, AT91SSC_CMR_DIV, cmr_div);
c8044274 FM	144	if (ret < 0)
	145	return ret;
	146
	147	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
	148	/* set the BCLK divider for DACLRC */
64105cfd	149	ret = snd_soc_dai_set_clkdiv(cpu_dai,
c8044274 FM	150	AT91SSC_TCMR_PERIOD, period);
	151	} else {
	152	/* set the BCLK divider for ADCLRC */
64105cfd	153	ret = snd_soc_dai_set_clkdiv(cpu_dai,
c8044274 FM	154	AT91SSC_RCMR_PERIOD, period);
	155	}
	156	if (ret < 0)
	157	return ret;
	158
	159	#else /* CONFIG_SND_AT91_SOC_ETI_SLAVE */
	160	/*
	161	* Codec in Master Mode.
	162	*/
	163
	164	/* set codec DAI configuration */
64105cfd	165	ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S \|
c8044274 FM	166	SND_SOC_DAIFMT_NB_NF \| SND_SOC_DAIFMT_CBM_CFM);
	167	if (ret < 0)
	168	return ret;
	169
	170	/* set cpu DAI configuration */
64105cfd	171	ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S \|
c8044274 FM	172	SND_SOC_DAIFMT_NB_NF \| SND_SOC_DAIFMT_CBM_CFM);
	173	if (ret < 0)
	174	return ret;
	175
	176	#endif /* CONFIG_SND_AT91_SOC_ETI_SLAVE */
	177
	178	return 0;
	179	}
	180
b41bf38a FM	181	static struct snd_soc_ops eti_b1_ops = {
b41bf38a FM	182	.startup = eti_b1_startup,
c8044274	183	.hw_params = eti_b1_hw_params,
b41bf38a FM	184	.shutdown = eti_b1_shutdown,
	185	};
	186
	187
	188	static const struct snd_soc_dapm_widget eti_b1_dapm_widgets[] = {
	189	SND_SOC_DAPM_MIC("Int Mic", NULL),
	190	SND_SOC_DAPM_SPK("Ext Spk", NULL),
	191	};
	192
51e6a841	193	static const struct snd_soc_dapm_route intercon[] = {
b41bf38a FM	194
	195	/* speaker connected to LHPOUT */
	196	{"Ext Spk", NULL, "LHPOUT"},
	197
	198	/* mic is connected to Mic Jack, with WM8731 Mic Bias */
	199	{"MICIN", NULL, "Mic Bias"},
	200	{"Mic Bias", NULL, "Int Mic"},
b41bf38a FM	201	};
	202
	203	/*
	204	* Logic for a wm8731 as connected on a Endrelia ETI-B1 board.
	205	*/
	206	static int eti_b1_wm8731_init(struct snd_soc_codec *codec)
	207	{
b41bf38a FM	208	DBG("eti_b1_wm8731_init() called\n");
	209
	210	/* Add specific widgets */
51e6a841 MB	211	snd_soc_dapm_new_controls(codec, eti_b1_dapm_widgets,
51e6a841 MB	212	ARRAY_SIZE(eti_b1_dapm_widgets));
b41bf38a FM	213
b41bf38a FM	214	/* Set up specific audio path interconnects */
51e6a841	215	snd_soc_dapm_add_route(codec, intercon, ARRAY_SIZE(intercon));
b41bf38a FM	216
b41bf38a FM	217	/* not connected */
a5302181 LG	218	snd_soc_dapm_disable_pin(codec, "RLINEIN");
a5302181 LG	219	snd_soc_dapm_disable_pin(codec, "LLINEIN");
b41bf38a FM	220
b41bf38a FM	221	/* always connected */
a5302181 LG	222	snd_soc_dapm_enable_pin(codec, "Int Mic");
a5302181 LG	223	snd_soc_dapm_enable_pin(codec, "Ext Spk");
b41bf38a	224
a5302181	225	snd_soc_dapm_sync(codec);
b41bf38a FM	226
	227	return 0;
	228	}
	229
b41bf38a FM	230	static struct snd_soc_dai_link eti_b1_dai = {
b41bf38a FM	231	.name = "WM8731",
eb831da5 FM	232	.stream_name = "WM8731 PCM",
eb831da5 FM	233	.cpu_dai = &at91_ssc_dai[1],
b41bf38a FM	234	.codec_dai = &wm8731_dai,
b41bf38a FM	235	.init = eti_b1_wm8731_init,
c8044274	236	.ops = &eti_b1_ops,
b41bf38a FM	237	};
	238
	239	static struct snd_soc_machine snd_soc_machine_eti_b1 = {
eb831da5	240	.name = "ETI_B1_WM8731",
b41bf38a FM	241	.dai_link = &eti_b1_dai,
b41bf38a FM	242	.num_links = 1,
b41bf38a FM	243	};
	244
	245	static struct wm8731_setup_data eti_b1_wm8731_setup = {
81297c8a	246	.i2c_bus = 0,
b41bf38a FM	247	.i2c_address = 0x1a,
	248	};
	249
	250	static struct snd_soc_device eti_b1_snd_devdata = {
	251	.machine = &snd_soc_machine_eti_b1,
9f0ac6e1	252	.platform = &at91_soc_platform,
b41bf38a FM	253	.codec_dev = &soc_codec_dev_wm8731,
	254	.codec_data = &eti_b1_wm8731_setup,
	255	};
	256
	257	static struct platform_device *eti_b1_snd_device;
	258
	259	static int __init eti_b1_init(void)
	260	{
	261	int ret;
9f0ac6e1 FM	262	struct at91_ssc_periph *ssc = eti_b1_dai.cpu_dai->private_data;
	263
	264	if (!request_mem_region(AT91RM9200_BASE_SSC1, SZ_16K, "soc-audio")) {
	265	DBG("SSC1 memory region is busy\n");
	266	return -EBUSY;
	267	}
	268
	269	ssc->base = ioremap(AT91RM9200_BASE_SSC1, SZ_16K);
	270	if (!ssc->base) {
	271	DBG("SSC1 memory ioremap failed\n");
	272	ret = -ENOMEM;
	273	goto fail_release_mem;
	274	}
	275
	276	ssc->pid = AT91RM9200_ID_SSC1;
b41bf38a FM	277
b41bf38a FM	278	eti_b1_snd_device = platform_device_alloc("soc-audio", -1);
9f0ac6e1 FM	279	if (!eti_b1_snd_device) {
	280	DBG("platform device allocation failed\n");
	281	ret = -ENOMEM;
	282	goto fail_io_unmap;
	283	}
b41bf38a FM	284
	285	platform_set_drvdata(eti_b1_snd_device, &eti_b1_snd_devdata);
	286	eti_b1_snd_devdata.dev = &eti_b1_snd_device->dev;
	287
	288	ret = platform_device_add(eti_b1_snd_device);
	289	if (ret) {
9f0ac6e1	290	DBG("platform device add failed\n");
b41bf38a	291	platform_device_put(eti_b1_snd_device);
9f0ac6e1	292	goto fail_io_unmap;
b41bf38a FM	293	}
b41bf38a FM	294
c21098ea AV	295	at91_set_A_periph(AT91_PIN_PB6, 0); /* TF1 */
	296	at91_set_A_periph(AT91_PIN_PB7, 0); /* TK1 */
	297	at91_set_A_periph(AT91_PIN_PB8, 0); /* TD1 */
	298	at91_set_A_periph(AT91_PIN_PB9, 0); /* RD1 */
	299	/* at91_set_A_periph(AT91_PIN_PB10, 0);/ / RK1 */
	300	at91_set_A_periph(AT91_PIN_PB11, 0); /* RF1 */
b41bf38a FM	301
	302	/*
	303	* Set PCK1 parent to PLLB and its rate to 12 Mhz.
	304	*/
	305	pllb_clk = clk_get(NULL, "pllb");
	306	pck1_clk = clk_get(NULL, "pck1");
	307
	308	clk_set_parent(pck1_clk, pllb_clk);
	309	clk_set_rate(pck1_clk, 12000000);
	310
	311	DBG("MCLK rate %luHz\n", clk_get_rate(pck1_clk));
	312
	313	/* assign the GPIO pin to PCK1 */
	314	at91_set_B_periph(AT91_PIN_PA24, 0);
	315
c8044274 FM	316	#ifdef CONFIG_SND_AT91_SOC_ETI_SLAVE
	317	printk(KERN_INFO "eti_b1_wm8731: Codec in Slave Mode\n");
	318	#else
	319	printk(KERN_INFO "eti_b1_wm8731: Codec in Master Mode\n");
	320	#endif
b41bf38a	321	return ret;
9f0ac6e1 FM	322
	323	fail_io_unmap:
	324	iounmap(ssc->base);
	325	fail_release_mem:
	326	release_mem_region(AT91RM9200_BASE_SSC1, SZ_16K);
	327	return ret;
b41bf38a FM	328	}
	329
	330	static void __exit eti_b1_exit(void)
	331	{
9f0ac6e1 FM	332	struct at91_ssc_periph *ssc = eti_b1_dai.cpu_dai->private_data;
9f0ac6e1 FM	333
b41bf38a FM	334	clk_put(pck1_clk);
	335	clk_put(pllb_clk);
	336
	337	platform_device_unregister(eti_b1_snd_device);
9f0ac6e1 FM	338
	339	iounmap(ssc->base);
	340	release_mem_region(AT91RM9200_BASE_SSC1, SZ_16K);
b41bf38a FM	341	}
	342
	343	module_init(eti_b1_init);
	344	module_exit(eti_b1_exit);
	345
	346	/* Module information */
	347	MODULE_AUTHOR("Frank Mandarino <fmandarino@endrelia.com>");
	348	MODULE_DESCRIPTION("ALSA SoC ETI-B1-WM8731");
	349	MODULE_LICENSE("GPL");