[deliverable/linux.git] / sound / soc / au1x / dbdma2.c

/*
 * Au12x0/Au1550 PSC ALSA ASoC audio support.
 *
 * (c) 2007-2008 MSC Vertriebsges.m.b.H.,
 *	Manuel Lauss <mano@roarinelk.homelinux.net>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 * DMA glue for Au1x-PSC audio.
 *
 * NOTE: all of these drivers can only work with a SINGLE instance
 *	 of a PSC. Multiple independent audio devices are impossible
 *	 with ASoC v1.
 */


#include <linux/module.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
#include <linux/dma-mapping.h>

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

#include <asm/mach-au1x00/au1000.h>
#include <asm/mach-au1x00/au1xxx_dbdma.h>
#include <asm/mach-au1x00/au1xxx_psc.h>

#include "psc.h"

/*#define PCM_DEBUG*/

#define MSG(x...)	printk(KERN_INFO "au1xpsc_pcm: " x)
#ifdef PCM_DEBUG
#define DBG		MSG
#else
#define DBG(x...)	do {} while (0)
#endif

struct au1xpsc_audio_dmadata {
	/* DDMA control data */
	unsigned int ddma_id;		/* DDMA direction ID for this PSC */
	u32 ddma_chan;			/* DDMA context */

	/* PCM context (for irq handlers) */
	struct snd_pcm_substream *substream;
	unsigned long curr_period;	/* current segment DDMA is working on */
	unsigned long q_period;		/* queue period(s) */
	unsigned long dma_area;		/* address of queued DMA area */
	unsigned long dma_area_s;	/* start address of DMA area */
	unsigned long pos;		/* current byte position being played */
	unsigned long periods;		/* number of SG segments in total */
	unsigned long period_bytes;	/* size in bytes of one SG segment */

	/* runtime data */
	int msbits;
};

/* instance data. There can be only one, MacLeod!!!! */
static struct au1xpsc_audio_dmadata *au1xpsc_audio_pcmdma[2];

/*
 * These settings are somewhat okay, at least on my machine audio plays
 * almost skip-free. Especially the 64kB buffer seems to help a LOT.
 */
#define AU1XPSC_PERIOD_MIN_BYTES	1024
#define AU1XPSC_BUFFER_MIN_BYTES	65536

#define AU1XPSC_PCM_FMTS					\
	(SNDRV_PCM_FMTBIT_S8     | SNDRV_PCM_FMTBIT_U8 |	\
	 SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE |	\
	 SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE |	\
	 SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE |	\
	 SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE |	\
	 0)

/* PCM hardware DMA capabilities - platform specific */
static const struct snd_pcm_hardware au1xpsc_pcm_hardware = {
	.info		  = SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID |
			    SNDRV_PCM_INFO_INTERLEAVED | SNDRV_PCM_INFO_BATCH,
	.formats	  = AU1XPSC_PCM_FMTS,
	.period_bytes_min = AU1XPSC_PERIOD_MIN_BYTES,
	.period_bytes_max = 4096 * 1024 - 1,
	.periods_min	  = 2,
	.periods_max	  = 4096,	/* 2 to as-much-as-you-like */
	.buffer_bytes_max = 4096 * 1024 - 1,
	.fifo_size	  = 16,		/* fifo entries of AC97/I2S PSC */
};

static void au1x_pcm_queue_tx(struct au1xpsc_audio_dmadata *cd)
{
	au1xxx_dbdma_put_source_flags(cd->ddma_chan,
				(void *)phys_to_virt(cd->dma_area),
				cd->period_bytes, DDMA_FLAGS_IE);

	/* update next-to-queue period */
	++cd->q_period;
	cd->dma_area += cd->period_bytes;
	if (cd->q_period >= cd->periods) {
		cd->q_period = 0;
		cd->dma_area = cd->dma_area_s;
	}
}

static void au1x_pcm_queue_rx(struct au1xpsc_audio_dmadata *cd)
{
	au1xxx_dbdma_put_dest_flags(cd->ddma_chan,
				(void *)phys_to_virt(cd->dma_area),
				cd->period_bytes, DDMA_FLAGS_IE);

	/* update next-to-queue period */
	++cd->q_period;
	cd->dma_area += cd->period_bytes;
	if (cd->q_period >= cd->periods) {
		cd->q_period = 0;
		cd->dma_area = cd->dma_area_s;
	}
}

static void au1x_pcm_dmatx_cb(int irq, void *dev_id)
{
	struct au1xpsc_audio_dmadata *cd = dev_id;

	cd->pos += cd->period_bytes;
	if (++cd->curr_period >= cd->periods) {
		cd->pos = 0;
		cd->curr_period = 0;
	}
	snd_pcm_period_elapsed(cd->substream);
	au1x_pcm_queue_tx(cd);
}

static void au1x_pcm_dmarx_cb(int irq, void *dev_id)
{
	struct au1xpsc_audio_dmadata *cd = dev_id;

	cd->pos += cd->period_bytes;
	if (++cd->curr_period >= cd->periods) {
		cd->pos = 0;
		cd->curr_period = 0;
	}
	snd_pcm_period_elapsed(cd->substream);
	au1x_pcm_queue_rx(cd);
}

static void au1x_pcm_dbdma_free(struct au1xpsc_audio_dmadata *pcd)
{
	if (pcd->ddma_chan) {
		au1xxx_dbdma_stop(pcd->ddma_chan);
		au1xxx_dbdma_reset(pcd->ddma_chan);
		au1xxx_dbdma_chan_free(pcd->ddma_chan);
		pcd->ddma_chan = 0;
		pcd->msbits = 0;
	}
}

/* in case of missing DMA ring or changed TX-source / RX-dest bit widths,
 * allocate (or reallocate) a 2-descriptor DMA ring with bit depth according
 * to ALSA-supplied sample depth.  This is due to limitations in the dbdma api
 * (cannot adjust source/dest widths of already allocated descriptor ring).
 */
static int au1x_pcm_dbdma_realloc(struct au1xpsc_audio_dmadata *pcd,
				 int stype, int msbits)
{
	/* DMA only in 8/16/32 bit widths */
	if (msbits == 24)
		msbits = 32;

	/* check current config: correct bits and descriptors allocated? */
	if ((pcd->ddma_chan) && (msbits == pcd->msbits))
		goto out;	/* all ok! */

	au1x_pcm_dbdma_free(pcd);

	if (stype == PCM_RX)
		pcd->ddma_chan = au1xxx_dbdma_chan_alloc(pcd->ddma_id,
					DSCR_CMD0_ALWAYS,
					au1x_pcm_dmarx_cb, (void *)pcd);
	else
		pcd->ddma_chan = au1xxx_dbdma_chan_alloc(DSCR_CMD0_ALWAYS,
					pcd->ddma_id,
					au1x_pcm_dmatx_cb, (void *)pcd);

	if (!pcd->ddma_chan)
		return -ENOMEM;

	au1xxx_dbdma_set_devwidth(pcd->ddma_chan, msbits);
	au1xxx_dbdma_ring_alloc(pcd->ddma_chan, 2);

	pcd->msbits = msbits;

	au1xxx_dbdma_stop(pcd->ddma_chan);
	au1xxx_dbdma_reset(pcd->ddma_chan);

out:
	return 0;
}

static int au1xpsc_pcm_hw_params(struct snd_pcm_substream *substream,
				 struct snd_pcm_hw_params *params)
{
	struct snd_pcm_runtime *runtime = substream->runtime;
	struct au1xpsc_audio_dmadata *pcd;
	int stype, ret;

	ret = snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(params));
	if (ret < 0)
		goto out;

	stype = SUBSTREAM_TYPE(substream);
	pcd = au1xpsc_audio_pcmdma[stype];

	DBG("runtime->dma_area = 0x%08lx dma_addr_t = 0x%08lx dma_size = %d "
	    "runtime->min_align %d\n",
		(unsigned long)runtime->dma_area,
		(unsigned long)runtime->dma_addr, runtime->dma_bytes,
		runtime->min_align);

	DBG("bits %d  frags %d  frag_bytes %d  is_rx %d\n", params->msbits,
		params_periods(params), params_period_bytes(params), stype);

	ret = au1x_pcm_dbdma_realloc(pcd, stype, params->msbits);
	if (ret) {
		MSG("DDMA channel (re)alloc failed!\n");
		goto out;
	}

	pcd->substream = substream;
	pcd->period_bytes = params_period_bytes(params);
	pcd->periods = params_periods(params);
	pcd->dma_area_s = pcd->dma_area = (unsigned long)runtime->dma_addr;
	pcd->q_period = 0;
	pcd->curr_period = 0;
	pcd->pos = 0;

	ret = 0;
out:
	return ret;
}

static int au1xpsc_pcm_hw_free(struct snd_pcm_substream *substream)
{
	snd_pcm_lib_free_pages(substream);
	return 0;
}

static int au1xpsc_pcm_prepare(struct snd_pcm_substream *substream)
{
	struct au1xpsc_audio_dmadata *pcd =
			au1xpsc_audio_pcmdma[SUBSTREAM_TYPE(substream)];

	au1xxx_dbdma_reset(pcd->ddma_chan);

	if (SUBSTREAM_TYPE(substream) == PCM_RX) {
		au1x_pcm_queue_rx(pcd);
		au1x_pcm_queue_rx(pcd);
	} else {
		au1x_pcm_queue_tx(pcd);
		au1x_pcm_queue_tx(pcd);
	}

	return 0;
}

static int au1xpsc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
{
	u32 c = au1xpsc_audio_pcmdma[SUBSTREAM_TYPE(substream)]->ddma_chan;

	switch (cmd) {
	case SNDRV_PCM_TRIGGER_START:
	case SNDRV_PCM_TRIGGER_RESUME:
		au1xxx_dbdma_start(c);
		break;
	case SNDRV_PCM_TRIGGER_STOP:
	case SNDRV_PCM_TRIGGER_SUSPEND:
		au1xxx_dbdma_stop(c);
		break;
	default:
		return -EINVAL;
	}
	return 0;
}

static snd_pcm_uframes_t
au1xpsc_pcm_pointer(struct snd_pcm_substream *substream)
{
	return bytes_to_frames(substream->runtime,
		au1xpsc_audio_pcmdma[SUBSTREAM_TYPE(substream)]->pos);
}

static int au1xpsc_pcm_open(struct snd_pcm_substream *substream)
{
	snd_soc_set_runtime_hwparams(substream, &au1xpsc_pcm_hardware);
	return 0;
}

static int au1xpsc_pcm_close(struct snd_pcm_substream *substream)
{
	au1x_pcm_dbdma_free(au1xpsc_audio_pcmdma[SUBSTREAM_TYPE(substream)]);
	return 0;
}

static struct snd_pcm_ops au1xpsc_pcm_ops = {
	.open		= au1xpsc_pcm_open,
	.close		= au1xpsc_pcm_close,
	.ioctl		= snd_pcm_lib_ioctl,
	.hw_params	= au1xpsc_pcm_hw_params,
	.hw_free	= au1xpsc_pcm_hw_free,
	.prepare	= au1xpsc_pcm_prepare,
	.trigger	= au1xpsc_pcm_trigger,
	.pointer	= au1xpsc_pcm_pointer,
};

static void au1xpsc_pcm_free_dma_buffers(struct snd_pcm *pcm)
{
	snd_pcm_lib_preallocate_free_for_all(pcm);
}

static int au1xpsc_pcm_new(struct snd_card *card,
			   struct snd_soc_dai *dai,
			   struct snd_pcm *pcm)
{
	snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
		card->dev, AU1XPSC_BUFFER_MIN_BYTES, (4096 * 1024) - 1);

	return 0;
}

static int au1xpsc_pcm_probe(struct platform_device *pdev)
{
	struct resource *r;
	int ret;

	if (au1xpsc_audio_pcmdma[PCM_TX] || au1xpsc_audio_pcmdma[PCM_RX])
		return -EBUSY;

	/* TX DMA */
	au1xpsc_audio_pcmdma[PCM_TX]
		= kzalloc(sizeof(struct au1xpsc_audio_dmadata), GFP_KERNEL);
	if (!au1xpsc_audio_pcmdma[PCM_TX])
		return -ENOMEM;

	r = platform_get_resource(pdev, IORESOURCE_DMA, 0);
	if (!r) {
		ret = -ENODEV;
		goto out1;
	}
	(au1xpsc_audio_pcmdma[PCM_TX])->ddma_id = r->start;

	/* RX DMA */
	au1xpsc_audio_pcmdma[PCM_RX]
		= kzalloc(sizeof(struct au1xpsc_audio_dmadata), GFP_KERNEL);
	if (!au1xpsc_audio_pcmdma[PCM_RX])
		return -ENOMEM;

	r = platform_get_resource(pdev, IORESOURCE_DMA, 1);
	if (!r) {
		ret = -ENODEV;
		goto out2;
	}
	(au1xpsc_audio_pcmdma[PCM_RX])->ddma_id = r->start;

	return 0;

out2:
	kfree(au1xpsc_audio_pcmdma[PCM_RX]);
	au1xpsc_audio_pcmdma[PCM_RX] = NULL;
out1:
	kfree(au1xpsc_audio_pcmdma[PCM_TX]);
	au1xpsc_audio_pcmdma[PCM_TX] = NULL;
	return ret;
}

static int au1xpsc_pcm_remove(struct platform_device *pdev)
{
	int i;

	for (i = 0; i < 2; i++) {
		if (au1xpsc_audio_pcmdma[i]) {
			au1x_pcm_dbdma_free(au1xpsc_audio_pcmdma[i]);
			kfree(au1xpsc_audio_pcmdma[i]);
			au1xpsc_audio_pcmdma[i] = NULL;
		}
	}

	return 0;
}

/* au1xpsc audio platform */
struct snd_soc_platform au1xpsc_soc_platform = {
	.name		= "au1xpsc-pcm-dbdma",
	.probe		= au1xpsc_pcm_probe,
	.remove		= au1xpsc_pcm_remove,
	.pcm_ops 	= &au1xpsc_pcm_ops,
	.pcm_new	= au1xpsc_pcm_new,
	.pcm_free	= au1xpsc_pcm_free_dma_buffers,
};
EXPORT_SYMBOL_GPL(au1xpsc_soc_platform);

static int __init au1xpsc_audio_dbdma_init(void)
{
	au1xpsc_audio_pcmdma[PCM_TX] = NULL;
	au1xpsc_audio_pcmdma[PCM_RX] = NULL;
	return snd_soc_register_platform(&au1xpsc_soc_platform);
}

static void __exit au1xpsc_audio_dbdma_exit(void)
{
	snd_soc_unregister_platform(&au1xpsc_soc_platform);
}

module_init(au1xpsc_audio_dbdma_init);
module_exit(au1xpsc_audio_dbdma_exit);

MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("Au12x0/Au1550 PSC Audio DMA driver");
MODULE_AUTHOR("Manuel Lauss <mano@roarinelk.homelinux.net>");
Commit	Line	Data
4a161d23 ML	1	/*
	2	* Au12x0/Au1550 PSC ALSA ASoC audio support.
	3	*
	4	* (c) 2007-2008 MSC Vertriebsges.m.b.H.,
	5	* Manuel Lauss <mano@roarinelk.homelinux.net>
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License version 2 as
	9	* published by the Free Software Foundation.
	10	*
	11	* DMA glue for Au1x-PSC audio.
	12	*
	13	* NOTE: all of these drivers can only work with a SINGLE instance
	14	* of a PSC. Multiple independent audio devices are impossible
	15	* with ASoC v1.
	16	*/
	17
	18
	19	#include <linux/module.h>
	20	#include <linux/init.h>
	21	#include <linux/platform_device.h>
	22	#include <linux/slab.h>
	23	#include <linux/dma-mapping.h>
	24
	25	#include <sound/core.h>
	26	#include <sound/pcm.h>
	27	#include <sound/pcm_params.h>
	28	#include <sound/soc.h>
	29
	30	#include <asm/mach-au1x00/au1000.h>
	31	#include <asm/mach-au1x00/au1xxx_dbdma.h>
	32	#include <asm/mach-au1x00/au1xxx_psc.h>
	33
	34	#include "psc.h"
	35
	36	/#define PCM_DEBUG/
	37
	38	#define MSG(x...) printk(KERN_INFO "au1xpsc_pcm: " x)
	39	#ifdef PCM_DEBUG
	40	#define DBG MSG
	41	#else
	42	#define DBG(x...) do {} while (0)
	43	#endif
	44
	45	struct au1xpsc_audio_dmadata {
	46	/* DDMA control data */
	47	unsigned int ddma_id; /* DDMA direction ID for this PSC */
	48	u32 ddma_chan; /* DDMA context */
	49
	50	/* PCM context (for irq handlers) */
	51	struct snd_pcm_substream *substream;
	52	unsigned long curr_period; /* current segment DDMA is working on */
	53	unsigned long q_period; /* queue period(s) */
	54	unsigned long dma_area; /* address of queued DMA area */
	55	unsigned long dma_area_s; /* start address of DMA area */
	56	unsigned long pos; /* current byte position being played */
	57	unsigned long periods; /* number of SG segments in total */
	58	unsigned long period_bytes; /* size in bytes of one SG segment */
	59
	60	/* runtime data */
	61	int msbits;
	62	};
	63
	64	/* instance data. There can be only one, MacLeod!!!! */
65	static struct au1xpsc_audio_dmadata *au1xpsc_audio_pcmdma[2];
66
67	/*
68	* These settings are somewhat okay, at least on my machine audio plays
69	* almost skip-free. Especially the 64kB buffer seems to help a LOT.
70	*/
71	#define AU1XPSC_PERIOD_MIN_BYTES 1024
72	#define AU1XPSC_BUFFER_MIN_BYTES 65536
73
74	#define AU1XPSC_PCM_FMTS \
75	(SNDRV_PCM_FMTBIT_S8 \| SNDRV_PCM_FMTBIT_U8 \| \
76	SNDRV_PCM_FMTBIT_S16_LE \| SNDRV_PCM_FMTBIT_S16_BE \| \
77	SNDRV_PCM_FMTBIT_U16_LE \| SNDRV_PCM_FMTBIT_U16_BE \| \
78	SNDRV_PCM_FMTBIT_S32_LE \| SNDRV_PCM_FMTBIT_S32_BE \| \
79	SNDRV_PCM_FMTBIT_U32_LE \| SNDRV_PCM_FMTBIT_U32_BE \| \
80	0)
81
82	/* PCM hardware DMA capabilities - platform specific */
83	static const struct snd_pcm_hardware au1xpsc_pcm_hardware = {
84	.info = SNDRV_PCM_INFO_MMAP \| SNDRV_PCM_INFO_MMAP_VALID \|
2008f137	85	SNDRV_PCM_INFO_INTERLEAVED \| SNDRV_PCM_INFO_BATCH,
4a161d23 ML	86	.formats = AU1XPSC_PCM_FMTS,
	87	.period_bytes_min = AU1XPSC_PERIOD_MIN_BYTES,
	88	.period_bytes_max = 4096 * 1024 - 1,
	89	.periods_min = 2,
	90	.periods_max = 4096, /* 2 to as-much-as-you-like */
	91	.buffer_bytes_max = 4096 * 1024 - 1,
	92	.fifo_size = 16, /* fifo entries of AC97/I2S PSC */
	93	};
	94
	95	static void au1x_pcm_queue_tx(struct au1xpsc_audio_dmadata *cd)
	96	{
	97	au1xxx_dbdma_put_source_flags(cd->ddma_chan,
	98	(void *)phys_to_virt(cd->dma_area),
	99	cd->period_bytes, DDMA_FLAGS_IE);
	100
	101	/* update next-to-queue period */
	102	++cd->q_period;
	103	cd->dma_area += cd->period_bytes;
	104	if (cd->q_period >= cd->periods) {
	105	cd->q_period = 0;
	106	cd->dma_area = cd->dma_area_s;
	107	}
	108	}
	109
	110	static void au1x_pcm_queue_rx(struct au1xpsc_audio_dmadata *cd)
	111	{
	112	au1xxx_dbdma_put_dest_flags(cd->ddma_chan,
	113	(void *)phys_to_virt(cd->dma_area),
	114	cd->period_bytes, DDMA_FLAGS_IE);
	115
	116	/* update next-to-queue period */
	117	++cd->q_period;
	118	cd->dma_area += cd->period_bytes;
	119	if (cd->q_period >= cd->periods) {
	120	cd->q_period = 0;
	121	cd->dma_area = cd->dma_area_s;
	122	}
	123	}
	124
	125	static void au1x_pcm_dmatx_cb(int irq, void *dev_id)
	126	{
	127	struct au1xpsc_audio_dmadata *cd = dev_id;
	128
	129	cd->pos += cd->period_bytes;
	130	if (++cd->curr_period >= cd->periods) {
	131	cd->pos = 0;
	132	cd->curr_period = 0;
	133	}
	134	snd_pcm_period_elapsed(cd->substream);
	135	au1x_pcm_queue_tx(cd);
	136	}
	137
	138	static void au1x_pcm_dmarx_cb(int irq, void *dev_id)
	139	{
	140	struct au1xpsc_audio_dmadata *cd = dev_id;
	141
	142	cd->pos += cd->period_bytes;
	143	if (++cd->curr_period >= cd->periods) {
	144	cd->pos = 0;
	145	cd->curr_period = 0;
	146	}
	147	snd_pcm_period_elapsed(cd->substream);
	148	au1x_pcm_queue_rx(cd);
	149	}
150
151	static void au1x_pcm_dbdma_free(struct au1xpsc_audio_dmadata *pcd)
152	{
153	if (pcd->ddma_chan) {
154	au1xxx_dbdma_stop(pcd->ddma_chan);
155	au1xxx_dbdma_reset(pcd->ddma_chan);
156	au1xxx_dbdma_chan_free(pcd->ddma_chan);
157	pcd->ddma_chan = 0;
158	pcd->msbits = 0;
159	}
160	}
161
162	/* in case of missing DMA ring or changed TX-source / RX-dest bit widths,
163	* allocate (or reallocate) a 2-descriptor DMA ring with bit depth according
164	* to ALSA-supplied sample depth. This is due to limitations in the dbdma api
165	* (cannot adjust source/dest widths of already allocated descriptor ring).
166	*/
167	static int au1x_pcm_dbdma_realloc(struct au1xpsc_audio_dmadata *pcd,
168	int stype, int msbits)
169	{
170	/* DMA only in 8/16/32 bit widths */
171	if (msbits == 24)
172	msbits = 32;
173
174	/* check current config: correct bits and descriptors allocated? */
175	if ((pcd->ddma_chan) && (msbits == pcd->msbits))
176	goto out; /* all ok! */
177
178	au1x_pcm_dbdma_free(pcd);
179
180	if (stype == PCM_RX)
181	pcd->ddma_chan = au1xxx_dbdma_chan_alloc(pcd->ddma_id,
182	DSCR_CMD0_ALWAYS,
183	au1x_pcm_dmarx_cb, (void *)pcd);
184	else
185	pcd->ddma_chan = au1xxx_dbdma_chan_alloc(DSCR_CMD0_ALWAYS,
186	pcd->ddma_id,
187	au1x_pcm_dmatx_cb, (void *)pcd);
188
189	if (!pcd->ddma_chan)
c19a28e1	190	return -ENOMEM;
4a161d23 ML	191
	192	au1xxx_dbdma_set_devwidth(pcd->ddma_chan, msbits);
	193	au1xxx_dbdma_ring_alloc(pcd->ddma_chan, 2);
	194
	195	pcd->msbits = msbits;
	196
	197	au1xxx_dbdma_stop(pcd->ddma_chan);
	198	au1xxx_dbdma_reset(pcd->ddma_chan);
	199
	200	out:
	201	return 0;
	202	}
	203
	204	static int au1xpsc_pcm_hw_params(struct snd_pcm_substream *substream,
	205	struct snd_pcm_hw_params *params)
	206	{
	207	struct snd_pcm_runtime *runtime = substream->runtime;
	208	struct au1xpsc_audio_dmadata *pcd;
	209	int stype, ret;
	210
	211	ret = snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(params));
	212	if (ret < 0)
	213	goto out;
	214
	215	stype = SUBSTREAM_TYPE(substream);
	216	pcd = au1xpsc_audio_pcmdma[stype];
	217
	218	DBG("runtime->dma_area = 0x%08lx dma_addr_t = 0x%08lx dma_size = %d "
	219	"runtime->min_align %d\n",
	220	(unsigned long)runtime->dma_area,
	221	(unsigned long)runtime->dma_addr, runtime->dma_bytes,
	222	runtime->min_align);
	223
	224	DBG("bits %d frags %d frag_bytes %d is_rx %d\n", params->msbits,
	225	params_periods(params), params_period_bytes(params), stype);
	226
	227	ret = au1x_pcm_dbdma_realloc(pcd, stype, params->msbits);
	228	if (ret) {
	229	MSG("DDMA channel (re)alloc failed!\n");
	230	goto out;
	231	}
	232
	233	pcd->substream = substream;
	234	pcd->period_bytes = params_period_bytes(params);
	235	pcd->periods = params_periods(params);
	236	pcd->dma_area_s = pcd->dma_area = (unsigned long)runtime->dma_addr;
	237	pcd->q_period = 0;
	238	pcd->curr_period = 0;
	239	pcd->pos = 0;
	240
	241	ret = 0;
	242	out:
	243	return ret;
	244	}
	245
	246	static int au1xpsc_pcm_hw_free(struct snd_pcm_substream *substream)
	247	{
	248	snd_pcm_lib_free_pages(substream);
	249	return 0;
	250	}
	251
	252	static int au1xpsc_pcm_prepare(struct snd_pcm_substream *substream)
	253	{
	254	struct au1xpsc_audio_dmadata *pcd =
255	au1xpsc_audio_pcmdma[SUBSTREAM_TYPE(substream)];
256
257	au1xxx_dbdma_reset(pcd->ddma_chan);
258
259	if (SUBSTREAM_TYPE(substream) == PCM_RX) {
260	au1x_pcm_queue_rx(pcd);
261	au1x_pcm_queue_rx(pcd);
262	} else {
263	au1x_pcm_queue_tx(pcd);
264	au1x_pcm_queue_tx(pcd);
265	}
266
267	return 0;
268	}
269
270	static int au1xpsc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
271	{
272	u32 c = au1xpsc_audio_pcmdma[SUBSTREAM_TYPE(substream)]->ddma_chan;
273
274	switch (cmd) {
275	case SNDRV_PCM_TRIGGER_START:
276	case SNDRV_PCM_TRIGGER_RESUME:
277	au1xxx_dbdma_start(c);
278	break;
279	case SNDRV_PCM_TRIGGER_STOP:
280	case SNDRV_PCM_TRIGGER_SUSPEND:
281	au1xxx_dbdma_stop(c);
282	break;
283	default:
284	return -EINVAL;
285	}
286	return 0;
287	}
288
289	static snd_pcm_uframes_t
290	au1xpsc_pcm_pointer(struct snd_pcm_substream *substream)
291	{
292	return bytes_to_frames(substream->runtime,
293	au1xpsc_audio_pcmdma[SUBSTREAM_TYPE(substream)]->pos);
294	}
295
296	static int au1xpsc_pcm_open(struct snd_pcm_substream *substream)
297	{
298	snd_soc_set_runtime_hwparams(substream, &au1xpsc_pcm_hardware);
299	return 0;
300	}
301
302	static int au1xpsc_pcm_close(struct snd_pcm_substream *substream)
303	{
304	au1x_pcm_dbdma_free(au1xpsc_audio_pcmdma[SUBSTREAM_TYPE(substream)]);
305	return 0;
306	}
307
b2a19d02	308	static struct snd_pcm_ops au1xpsc_pcm_ops = {
4a161d23 ML	309	.open = au1xpsc_pcm_open,
	310	.close = au1xpsc_pcm_close,
	311	.ioctl = snd_pcm_lib_ioctl,
	312	.hw_params = au1xpsc_pcm_hw_params,
	313	.hw_free = au1xpsc_pcm_hw_free,
	314	.prepare = au1xpsc_pcm_prepare,
	315	.trigger = au1xpsc_pcm_trigger,
	316	.pointer = au1xpsc_pcm_pointer,
	317	};
	318
	319	static void au1xpsc_pcm_free_dma_buffers(struct snd_pcm *pcm)
	320	{
	321	snd_pcm_lib_preallocate_free_for_all(pcm);
	322	}
	323
	324	static int au1xpsc_pcm_new(struct snd_card *card,
	325	struct snd_soc_dai *dai,
	326	struct snd_pcm *pcm)
	327	{
	328	snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
	329	card->dev, AU1XPSC_BUFFER_MIN_BYTES, (4096 * 1024) - 1);
	330
	331	return 0;
	332	}
	333
	334	static int au1xpsc_pcm_probe(struct platform_device *pdev)
	335	{
	336	struct resource *r;
	337	int ret;
	338
	339	if (au1xpsc_audio_pcmdma[PCM_TX] \|\| au1xpsc_audio_pcmdma[PCM_RX])
	340	return -EBUSY;
	341
	342	/* TX DMA */
	343	au1xpsc_audio_pcmdma[PCM_TX]
	344	= kzalloc(sizeof(struct au1xpsc_audio_dmadata), GFP_KERNEL);
	345	if (!au1xpsc_audio_pcmdma[PCM_TX])
	346	return -ENOMEM;
	347
	348	r = platform_get_resource(pdev, IORESOURCE_DMA, 0);
	349	if (!r) {
	350	ret = -ENODEV;
	351	goto out1;
	352	}
	353	(au1xpsc_audio_pcmdma[PCM_TX])->ddma_id = r->start;
	354
	355	/* RX DMA */
	356	au1xpsc_audio_pcmdma[PCM_RX]
	357	= kzalloc(sizeof(struct au1xpsc_audio_dmadata), GFP_KERNEL);
	358	if (!au1xpsc_audio_pcmdma[PCM_RX])
	359	return -ENOMEM;
	360
	361	r = platform_get_resource(pdev, IORESOURCE_DMA, 1);
	362	if (!r) {
	363	ret = -ENODEV;
	364	goto out2;
	365	}
	366	(au1xpsc_audio_pcmdma[PCM_RX])->ddma_id = r->start;
	367
	368	return 0;
	369
	370	out2:
	371	kfree(au1xpsc_audio_pcmdma[PCM_RX]);
	372	au1xpsc_audio_pcmdma[PCM_RX] = NULL;
373	out1:
374	kfree(au1xpsc_audio_pcmdma[PCM_TX]);
375	au1xpsc_audio_pcmdma[PCM_TX] = NULL;
376	return ret;
377	}
378
379	static int au1xpsc_pcm_remove(struct platform_device *pdev)
380	{
381	int i;
382
383	for (i = 0; i < 2; i++) {
384	if (au1xpsc_audio_pcmdma[i]) {
385	au1x_pcm_dbdma_free(au1xpsc_audio_pcmdma[i]);
386	kfree(au1xpsc_audio_pcmdma[i]);
387	au1xpsc_audio_pcmdma[i] = NULL;
388	}
389	}
390
391	return 0;
392	}
393
394	/* au1xpsc audio platform */
395	struct snd_soc_platform au1xpsc_soc_platform = {
396	.name = "au1xpsc-pcm-dbdma",
397	.probe = au1xpsc_pcm_probe,
398	.remove = au1xpsc_pcm_remove,
399	.pcm_ops = &au1xpsc_pcm_ops,
400	.pcm_new = au1xpsc_pcm_new,
401	.pcm_free = au1xpsc_pcm_free_dma_buffers,
402	};
403	EXPORT_SYMBOL_GPL(au1xpsc_soc_platform);
404
405	static int __init au1xpsc_audio_dbdma_init(void)
406	{
407	au1xpsc_audio_pcmdma[PCM_TX] = NULL;
408	au1xpsc_audio_pcmdma[PCM_RX] = NULL;
958e792c	409	return snd_soc_register_platform(&au1xpsc_soc_platform);
4a161d23 ML	410	}
	411
	412	static void __exit au1xpsc_audio_dbdma_exit(void)
	413	{
958e792c	414	snd_soc_unregister_platform(&au1xpsc_soc_platform);
4a161d23 ML	415	}
	416
	417	module_init(au1xpsc_audio_dbdma_init);
	418	module_exit(au1xpsc_audio_dbdma_exit);
	419
	420	MODULE_LICENSE("GPL");
	421	MODULE_DESCRIPTION("Au12x0/Au1550 PSC Audio DMA driver");
	422	MODULE_AUTHOR("Manuel Lauss <mano@roarinelk.homelinux.net>");