[deliverable/linux.git] / sound / soc / samsung / dma.c

/*
 * dma.c  --  ALSA Soc Audio Layer
 *
 * (c) 2006 Wolfson Microelectronics PLC.
 * Graeme Gregory graeme.gregory@wolfsonmicro.com or linux@wolfsonmicro.com
 *
 * Copyright 2004-2005 Simtec Electronics
 *	http://armlinux.simtec.co.uk/
 *	Ben Dooks <ben@simtec.co.uk>
 *
 *  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/slab.h>
#include <linux/dma-mapping.h>

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

#include <asm/dma.h>
#include <mach/hardware.h>
#include <mach/dma.h>

#include "dma.h"

#define ST_RUNNING		(1<<0)
#define ST_OPENED		(1<<1)

static const struct snd_pcm_hardware dma_hardware = {
	.info			= SNDRV_PCM_INFO_INTERLEAVED |
				    SNDRV_PCM_INFO_BLOCK_TRANSFER |
				    SNDRV_PCM_INFO_MMAP |
				    SNDRV_PCM_INFO_MMAP_VALID |
				    SNDRV_PCM_INFO_PAUSE |
				    SNDRV_PCM_INFO_RESUME,
	.formats		= SNDRV_PCM_FMTBIT_S16_LE |
				    SNDRV_PCM_FMTBIT_U16_LE |
				    SNDRV_PCM_FMTBIT_U8 |
				    SNDRV_PCM_FMTBIT_S8,
	.channels_min		= 2,
	.channels_max		= 2,
	.buffer_bytes_max	= 128*1024,
	.period_bytes_min	= PAGE_SIZE,
	.period_bytes_max	= PAGE_SIZE*2,
	.periods_min		= 2,
	.periods_max		= 128,
	.fifo_size		= 32,
};

struct runtime_data {
	spinlock_t lock;
	int state;
	unsigned int dma_loaded;
	unsigned int dma_period;
	dma_addr_t dma_start;
	dma_addr_t dma_pos;
	dma_addr_t dma_end;
	struct s3c_dma_params *params;
};

static void audio_buffdone(void *data);

/* dma_enqueue
 *
 * place a dma buffer onto the queue for the dma system
 * to handle.
 */
static void dma_enqueue(struct snd_pcm_substream *substream)
{
	struct runtime_data *prtd = substream->runtime->private_data;
	dma_addr_t pos = prtd->dma_pos;
	unsigned int limit;
	struct samsung_dma_prep_info dma_info;

	pr_debug("Entered %s\n", __func__);

	limit = (prtd->dma_end - prtd->dma_start) / prtd->dma_period;

	pr_debug("%s: loaded %d, limit %d\n",
				__func__, prtd->dma_loaded, limit);

	dma_info.cap = (samsung_dma_has_circular() ? DMA_CYCLIC : DMA_SLAVE);
	dma_info.direction =
		(substream->stream == SNDRV_PCM_STREAM_PLAYBACK
		? DMA_TO_DEVICE : DMA_FROM_DEVICE);
	dma_info.fp = audio_buffdone;
	dma_info.fp_param = substream;
	dma_info.period = prtd->dma_period;
	dma_info.len = prtd->dma_period*limit;

	while (prtd->dma_loaded < limit) {
		pr_debug("dma_loaded: %d\n", prtd->dma_loaded);

		if ((pos + dma_info.period) > prtd->dma_end) {
			dma_info.period  = prtd->dma_end - pos;
			pr_debug("%s: corrected dma len %ld\n",
					__func__, dma_info.period);
		}

		dma_info.buf = pos;
		prtd->params->ops->prepare(prtd->params->ch, &dma_info);

		prtd->dma_loaded++;
		pos += prtd->dma_period;
		if (pos >= prtd->dma_end)
			pos = prtd->dma_start;
	}

	prtd->dma_pos = pos;
}

static void audio_buffdone(void *data)
{
	struct snd_pcm_substream *substream = data;
	struct runtime_data *prtd = substream->runtime->private_data;

	pr_debug("Entered %s\n", __func__);

	if (prtd->state & ST_RUNNING) {
		prtd->dma_pos += prtd->dma_period;
		if (prtd->dma_pos >= prtd->dma_end)
			prtd->dma_pos = prtd->dma_start;

		if (substream)
			snd_pcm_period_elapsed(substream);

		spin_lock(&prtd->lock);
		if (!samsung_dma_has_circular()) {
			prtd->dma_loaded--;
			dma_enqueue(substream);
		}
		spin_unlock(&prtd->lock);
	}
}

static int dma_hw_params(struct snd_pcm_substream *substream,
	struct snd_pcm_hw_params *params)
{
	struct snd_pcm_runtime *runtime = substream->runtime;
	struct runtime_data *prtd = runtime->private_data;
	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	unsigned long totbytes = params_buffer_bytes(params);
	struct s3c_dma_params *dma =
		snd_soc_dai_get_dma_data(rtd->cpu_dai, substream);
	struct samsung_dma_info dma_info;

	pr_debug("Entered %s\n", __func__);

	/* return if this is a bufferless transfer e.g.
	 * codec <--> BT codec or GSM modem -- lg FIXME */
	if (!dma)
		return 0;

	/* this may get called several times by oss emulation
	 * with different params -HW */
	if (prtd->params == NULL) {
		/* prepare DMA */
		prtd->params = dma;

		pr_debug("params %p, client %p, channel %d\n", prtd->params,
			prtd->params->client, prtd->params->channel);

		prtd->params->ops = samsung_dma_get_ops();

		dma_info.cap = (samsung_dma_has_circular() ?
			DMA_CYCLIC : DMA_SLAVE);
		dma_info.client = prtd->params->client;
		dma_info.direction =
			(substream->stream == SNDRV_PCM_STREAM_PLAYBACK
			? DMA_TO_DEVICE : DMA_FROM_DEVICE);
		dma_info.width = prtd->params->dma_size;
		dma_info.fifo = prtd->params->dma_addr;
		prtd->params->ch = prtd->params->ops->request(
				prtd->params->channel, &dma_info);
	}

	snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer);

	runtime->dma_bytes = totbytes;

	spin_lock_irq(&prtd->lock);
	prtd->dma_loaded = 0;
	prtd->dma_period = params_period_bytes(params);
	prtd->dma_start = runtime->dma_addr;
	prtd->dma_pos = prtd->dma_start;
	prtd->dma_end = prtd->dma_start + totbytes;
	spin_unlock_irq(&prtd->lock);

	return 0;
}

static int dma_hw_free(struct snd_pcm_substream *substream)
{
	struct runtime_data *prtd = substream->runtime->private_data;

	pr_debug("Entered %s\n", __func__);

	/* TODO - do we need to ensure DMA flushed */
	snd_pcm_set_runtime_buffer(substream, NULL);

	if (prtd->params) {
		prtd->params->ops->release(prtd->params->ch,
					prtd->params->client);
		prtd->params = NULL;
	}

	return 0;
}

static int dma_prepare(struct snd_pcm_substream *substream)
{
	struct runtime_data *prtd = substream->runtime->private_data;
	int ret = 0;

	pr_debug("Entered %s\n", __func__);

	/* return if this is a bufferless transfer e.g.
	 * codec <--> BT codec or GSM modem -- lg FIXME */
	if (!prtd->params)
		return 0;

	/* flush the DMA channel */
	prtd->params->ops->flush(prtd->params->ch);

	prtd->dma_loaded = 0;
	prtd->dma_pos = prtd->dma_start;

	/* enqueue dma buffers */
	dma_enqueue(substream);

	return ret;
}

static int dma_trigger(struct snd_pcm_substream *substream, int cmd)
{
	struct runtime_data *prtd = substream->runtime->private_data;
	int ret = 0;

	pr_debug("Entered %s\n", __func__);

	spin_lock(&prtd->lock);

	switch (cmd) {
	case SNDRV_PCM_TRIGGER_START:
	case SNDRV_PCM_TRIGGER_RESUME:
	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
		prtd->state |= ST_RUNNING;
		prtd->params->ops->trigger(prtd->params->ch);
		break;

	case SNDRV_PCM_TRIGGER_STOP:
	case SNDRV_PCM_TRIGGER_SUSPEND:
	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
		prtd->state &= ~ST_RUNNING;
		prtd->params->ops->stop(prtd->params->ch);
		break;

	default:
		ret = -EINVAL;
		break;
	}

	spin_unlock(&prtd->lock);

	return ret;
}

static snd_pcm_uframes_t
dma_pointer(struct snd_pcm_substream *substream)
{
	struct snd_pcm_runtime *runtime = substream->runtime;
	struct runtime_data *prtd = runtime->private_data;
	unsigned long res;

	pr_debug("Entered %s\n", __func__);

	res = prtd->dma_pos - prtd->dma_start;

	pr_debug("Pointer offset: %lu\n", res);

	/* we seem to be getting the odd error from the pcm library due
	 * to out-of-bounds pointers. this is maybe due to the dma engine
	 * not having loaded the new values for the channel before being
	 * called... (todo - fix )
	 */

	if (res >= snd_pcm_lib_buffer_bytes(substream)) {
		if (res == snd_pcm_lib_buffer_bytes(substream))
			res = 0;
	}

	return bytes_to_frames(substream->runtime, res);
}

static int dma_open(struct snd_pcm_substream *substream)
{
	struct snd_pcm_runtime *runtime = substream->runtime;
	struct runtime_data *prtd;

	pr_debug("Entered %s\n", __func__);

	snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
	snd_soc_set_runtime_hwparams(substream, &dma_hardware);

	prtd = kzalloc(sizeof(struct runtime_data), GFP_KERNEL);
	if (prtd == NULL)
		return -ENOMEM;

	spin_lock_init(&prtd->lock);

	runtime->private_data = prtd;
	return 0;
}

static int dma_close(struct snd_pcm_substream *substream)
{
	struct snd_pcm_runtime *runtime = substream->runtime;
	struct runtime_data *prtd = runtime->private_data;

	pr_debug("Entered %s\n", __func__);

	if (!prtd)
		pr_debug("dma_close called with prtd == NULL\n");

	kfree(prtd);

	return 0;
}

static int dma_mmap(struct snd_pcm_substream *substream,
	struct vm_area_struct *vma)
{
	struct snd_pcm_runtime *runtime = substream->runtime;

	pr_debug("Entered %s\n", __func__);

	return dma_mmap_writecombine(substream->pcm->card->dev, vma,
				     runtime->dma_area,
				     runtime->dma_addr,
				     runtime->dma_bytes);
}

static struct snd_pcm_ops dma_ops = {
	.open		= dma_open,
	.close		= dma_close,
	.ioctl		= snd_pcm_lib_ioctl,
	.hw_params	= dma_hw_params,
	.hw_free	= dma_hw_free,
	.prepare	= dma_prepare,
	.trigger	= dma_trigger,
	.pointer	= dma_pointer,
	.mmap		= dma_mmap,
};

static int preallocate_dma_buffer(struct snd_pcm *pcm, int stream)
{
	struct snd_pcm_substream *substream = pcm->streams[stream].substream;
	struct snd_dma_buffer *buf = &substream->dma_buffer;
	size_t size = dma_hardware.buffer_bytes_max;

	pr_debug("Entered %s\n", __func__);

	buf->dev.type = SNDRV_DMA_TYPE_DEV;
	buf->dev.dev = pcm->card->dev;
	buf->private_data = NULL;
	buf->area = dma_alloc_writecombine(pcm->card->dev, size,
					   &buf->addr, GFP_KERNEL);
	if (!buf->area)
		return -ENOMEM;
	buf->bytes = size;
	return 0;
}

static void dma_free_dma_buffers(struct snd_pcm *pcm)
{
	struct snd_pcm_substream *substream;
	struct snd_dma_buffer *buf;
	int stream;

	pr_debug("Entered %s\n", __func__);

	for (stream = 0; stream < 2; stream++) {
		substream = pcm->streams[stream].substream;
		if (!substream)
			continue;

		buf = &substream->dma_buffer;
		if (!buf->area)
			continue;

		dma_free_writecombine(pcm->card->dev, buf->bytes,
				      buf->area, buf->addr);
		buf->area = NULL;
	}
}

static u64 dma_mask = DMA_BIT_MASK(32);

static int dma_new(struct snd_soc_pcm_runtime *rtd)
{
	struct snd_card *card = rtd->card->snd_card;
	struct snd_soc_dai *dai = rtd->cpu_dai;
	struct snd_pcm *pcm = rtd->pcm;
	int ret = 0;

	pr_debug("Entered %s\n", __func__);

	if (!card->dev->dma_mask)
		card->dev->dma_mask = &dma_mask;
	if (!card->dev->coherent_dma_mask)
		card->dev->coherent_dma_mask = 0xffffffff;

	if (dai->driver->playback.channels_min) {
		ret = preallocate_dma_buffer(pcm,
			SNDRV_PCM_STREAM_PLAYBACK);
		if (ret)
			goto out;
	}

	if (dai->driver->capture.channels_min) {
		ret = preallocate_dma_buffer(pcm,
			SNDRV_PCM_STREAM_CAPTURE);
		if (ret)
			goto out;
	}
out:
	return ret;
}

static struct snd_soc_platform_driver samsung_asoc_platform = {
	.ops		= &dma_ops,
	.pcm_new	= dma_new,
	.pcm_free	= dma_free_dma_buffers,
};

static int __devinit samsung_asoc_platform_probe(struct platform_device *pdev)
{
	return snd_soc_register_platform(&pdev->dev, &samsung_asoc_platform);
}

static int __devexit samsung_asoc_platform_remove(struct platform_device *pdev)
{
	snd_soc_unregister_platform(&pdev->dev);
	return 0;
}

static struct platform_driver asoc_dma_driver = {
	.driver = {
		.name = "samsung-audio",
		.owner = THIS_MODULE,
	},

	.probe = samsung_asoc_platform_probe,
	.remove = __devexit_p(samsung_asoc_platform_remove),
};

static int __init samsung_asoc_init(void)
{
	return platform_driver_register(&asoc_dma_driver);
}
module_init(samsung_asoc_init);

static void __exit samsung_asoc_exit(void)
{
	platform_driver_unregister(&asoc_dma_driver);
}
module_exit(samsung_asoc_exit);

MODULE_AUTHOR("Ben Dooks, <ben@simtec.co.uk>");
MODULE_DESCRIPTION("Samsung ASoC DMA Driver");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:samsung-audio");
Commit	Line	Data
c0f41bb1	1	/*
4b640cf3	2	* dma.c -- ALSA Soc Audio Layer
c0f41bb1 BD	3	*
	4	* (c) 2006 Wolfson Microelectronics PLC.
	5	* Graeme Gregory graeme.gregory@wolfsonmicro.com or linux@wolfsonmicro.com
	6	*
c8efef17	7	* Copyright 2004-2005 Simtec Electronics
c0f41bb1 BD	8	* http://armlinux.simtec.co.uk/
	9	* Ben Dooks <ben@simtec.co.uk>
	10	*
	11	* This program is free software; you can redistribute it and/or modify it
	12	* under the terms of the GNU General Public License as published by the
	13	* Free Software Foundation; either version 2 of the License, or (at your
	14	* option) any later version.
c0f41bb1 BD	15	*/
c0f41bb1 BD	16
c0f41bb1 BD	17	#include <linux/slab.h>
	18	#include <linux/dma-mapping.h>
	19
c0f41bb1	20	#include <sound/soc.h>
0378b6ac	21	#include <sound/pcm_params.h>
c0f41bb1 BD	22
c0f41bb1 BD	23	#include <asm/dma.h>
a09e64fb RK	24	#include <mach/hardware.h>
a09e64fb RK	25	#include <mach/dma.h>
c0f41bb1	26
4b640cf3	27	#include "dma.h"
c0f41bb1	28
f7f74181 SY	29	#define ST_RUNNING (1<<0)
	30	#define ST_OPENED (1<<1)
	31
c3f2028b	32	static const struct snd_pcm_hardware dma_hardware = {
c0f41bb1 BD	33	.info = SNDRV_PCM_INFO_INTERLEAVED \|
	34	SNDRV_PCM_INFO_BLOCK_TRANSFER \|
	35	SNDRV_PCM_INFO_MMAP \|
96d90e19 GG	36	SNDRV_PCM_INFO_MMAP_VALID \|
	37	SNDRV_PCM_INFO_PAUSE \|
	38	SNDRV_PCM_INFO_RESUME,
c0f41bb1 BD	39	.formats = SNDRV_PCM_FMTBIT_S16_LE \|
	40	SNDRV_PCM_FMTBIT_U16_LE \|
	41	SNDRV_PCM_FMTBIT_U8 \|
	42	SNDRV_PCM_FMTBIT_S8,
	43	.channels_min = 2,
	44	.channels_max = 2,
	45	.buffer_bytes_max = 128*1024,
	46	.period_bytes_min = PAGE_SIZE,
	47	.period_bytes_max = PAGE_SIZE*2,
	48	.periods_min = 2,
	49	.periods_max = 128,
	50	.fifo_size = 32,
	51	};
	52
c3f2028b	53	struct runtime_data {
c0f41bb1 BD	54	spinlock_t lock;
	55	int state;
	56	unsigned int dma_loaded;
c0f41bb1 BD	57	unsigned int dma_period;
	58	dma_addr_t dma_start;
	59	dma_addr_t dma_pos;
	60	dma_addr_t dma_end;
faa31776	61	struct s3c_dma_params *params;
c0f41bb1 BD	62	};
c0f41bb1 BD	63
344b4c48 BK	64	static void audio_buffdone(void *data);
344b4c48 BK	65
c3f2028b	66	/* dma_enqueue
c0f41bb1 BD	67	*
	68	* place a dma buffer onto the queue for the dma system
	69	* to handle.
344b4c48	70	*/
c3f2028b	71	static void dma_enqueue(struct snd_pcm_substream *substream)
c0f41bb1	72	{
c3f2028b	73	struct runtime_data *prtd = substream->runtime->private_data;
c0f41bb1	74	dma_addr_t pos = prtd->dma_pos;
e3d80248	75	unsigned int limit;
344b4c48	76	struct samsung_dma_prep_info dma_info;
c0f41bb1	77
ee7d4767	78	pr_debug("Entered %s\n", __func__);
c0f41bb1	79
344b4c48	80	limit = (prtd->dma_end - prtd->dma_start) / prtd->dma_period;
e3d80248	81
d3ff5a3e JB	82	pr_debug("%s: loaded %d, limit %d\n",
d3ff5a3e JB	83	__func__, prtd->dma_loaded, limit);
e3d80248	84
344b4c48 BK	85	dma_info.cap = (samsung_dma_has_circular() ? DMA_CYCLIC : DMA_SLAVE);
	86	dma_info.direction =
	87	(substream->stream == SNDRV_PCM_STREAM_PLAYBACK
	88	? DMA_TO_DEVICE : DMA_FROM_DEVICE);
	89	dma_info.fp = audio_buffdone;
	90	dma_info.fp_param = substream;
	91	dma_info.period = prtd->dma_period;
	92	dma_info.len = prtd->dma_period*limit;
c0f41bb1	93
344b4c48	94	while (prtd->dma_loaded < limit) {
ee7d4767	95	pr_debug("dma_loaded: %d\n", prtd->dma_loaded);
c0f41bb1	96
344b4c48 BK	97	if ((pos + dma_info.period) > prtd->dma_end) {
	98	dma_info.period = prtd->dma_end - pos;
	99	pr_debug("%s: corrected dma len %ld\n",
	100	__func__, dma_info.period);
c0f41bb1 BD	101	}
c0f41bb1 BD	102
344b4c48 BK	103	dma_info.buf = pos;
344b4c48 BK	104	prtd->params->ops->prepare(prtd->params->ch, &dma_info);
c0f41bb1	105
344b4c48 BK	106	prtd->dma_loaded++;
	107	pos += prtd->dma_period;
	108	if (pos >= prtd->dma_end)
	109	pos = prtd->dma_start;
c0f41bb1 BD	110	}
	111
	112	prtd->dma_pos = pos;
	113	}
	114
344b4c48	115	static void audio_buffdone(void *data)
c0f41bb1	116	{
344b4c48 BK	117	struct snd_pcm_substream *substream = data;
344b4c48 BK	118	struct runtime_data *prtd = substream->runtime->private_data;
c0f41bb1	119
ee7d4767	120	pr_debug("Entered %s\n", __func__);
c0f41bb1	121
344b4c48 BK	122	if (prtd->state & ST_RUNNING) {
	123	prtd->dma_pos += prtd->dma_period;
	124	if (prtd->dma_pos >= prtd->dma_end)
	125	prtd->dma_pos = prtd->dma_start;
5111c075	126
344b4c48 BK	127	if (substream)
344b4c48 BK	128	snd_pcm_period_elapsed(substream);
c0f41bb1	129
344b4c48 BK	130	spin_lock(&prtd->lock);
	131	if (!samsung_dma_has_circular()) {
	132	prtd->dma_loaded--;
	133	dma_enqueue(substream);
	134	}
	135	spin_unlock(&prtd->lock);
c0f41bb1	136	}
c0f41bb1 BD	137	}
c0f41bb1 BD	138
c3f2028b	139	static int dma_hw_params(struct snd_pcm_substream *substream,
c0f41bb1 BD	140	struct snd_pcm_hw_params *params)
	141	{
	142	struct snd_pcm_runtime *runtime = substream->runtime;
c3f2028b	143	struct runtime_data *prtd = runtime->private_data;
c0f41bb1	144	struct snd_soc_pcm_runtime *rtd = substream->private_data;
c0f41bb1	145	unsigned long totbytes = params_buffer_bytes(params);
5f712b2b	146	struct s3c_dma_params *dma =
f0fba2ad	147	snd_soc_dai_get_dma_data(rtd->cpu_dai, substream);
344b4c48	148	struct samsung_dma_info dma_info;
5f712b2b	149
ee7d4767	150	pr_debug("Entered %s\n", __func__);
c0f41bb1 BD	151
	152	/* return if this is a bufferless transfer e.g.
	153	* codec <--> BT codec or GSM modem -- lg FIXME */
	154	if (!dma)
	155	return 0;
	156
646ab160 HW	157	/* this may get called several times by oss emulation
	158	* with different params -HW */
	159	if (prtd->params == NULL) {
	160	/* prepare DMA */
	161	prtd->params = dma;
c0f41bb1	162
ee7d4767	163	pr_debug("params %p, client %p, channel %d\n", prtd->params,
646ab160	164	prtd->params->client, prtd->params->channel);
c0f41bb1	165
344b4c48 BK	166	prtd->params->ops = samsung_dma_get_ops();
	167
	168	dma_info.cap = (samsung_dma_has_circular() ?
	169	DMA_CYCLIC : DMA_SLAVE);
	170	dma_info.client = prtd->params->client;
	171	dma_info.direction =
	172	(substream->stream == SNDRV_PCM_STREAM_PLAYBACK
	173	? DMA_TO_DEVICE : DMA_FROM_DEVICE);
	174	dma_info.width = prtd->params->dma_size;
	175	dma_info.fifo = prtd->params->dma_addr;
	176	prtd->params->ch = prtd->params->ops->request(
	177	prtd->params->channel, &dma_info);
c0f41bb1 BD	178	}
c0f41bb1 BD	179
c0f41bb1 BD	180	snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer);
	181
	182	runtime->dma_bytes = totbytes;
	183
	184	spin_lock_irq(&prtd->lock);
	185	prtd->dma_loaded = 0;
c0f41bb1 BD	186	prtd->dma_period = params_period_bytes(params);
	187	prtd->dma_start = runtime->dma_addr;
	188	prtd->dma_pos = prtd->dma_start;
	189	prtd->dma_end = prtd->dma_start + totbytes;
	190	spin_unlock_irq(&prtd->lock);
	191
	192	return 0;
	193	}
	194
c3f2028b	195	static int dma_hw_free(struct snd_pcm_substream *substream)
c0f41bb1	196	{
c3f2028b	197	struct runtime_data *prtd = substream->runtime->private_data;
c0f41bb1	198
ee7d4767	199	pr_debug("Entered %s\n", __func__);
c0f41bb1 BD	200
	201	/* TODO - do we need to ensure DMA flushed */
	202	snd_pcm_set_runtime_buffer(substream, NULL);
	203
7f1bc26e	204	if (prtd->params) {
344b4c48 BK	205	prtd->params->ops->release(prtd->params->ch,
344b4c48 BK	206	prtd->params->client);
c0f41bb1 BD	207	prtd->params = NULL;
	208	}
	209
	210	return 0;
	211	}
	212
c3f2028b	213	static int dma_prepare(struct snd_pcm_substream *substream)
c0f41bb1	214	{
c3f2028b	215	struct runtime_data *prtd = substream->runtime->private_data;
c0f41bb1 BD	216	int ret = 0;
c0f41bb1 BD	217
ee7d4767	218	pr_debug("Entered %s\n", __func__);
c0f41bb1 BD	219
	220	/* return if this is a bufferless transfer e.g.
	221	* codec <--> BT codec or GSM modem -- lg FIXME */
	222	if (!prtd->params)
5111c075	223	return 0;
c0f41bb1 BD	224
c0f41bb1 BD	225	/* flush the DMA channel */
344b4c48 BK	226	prtd->params->ops->flush(prtd->params->ch);
344b4c48 BK	227
c0f41bb1 BD	228	prtd->dma_loaded = 0;
	229	prtd->dma_pos = prtd->dma_start;
	230
	231	/* enqueue dma buffers */
c3f2028b	232	dma_enqueue(substream);
c0f41bb1 BD	233
	234	return ret;
	235	}
	236
c3f2028b	237	static int dma_trigger(struct snd_pcm_substream *substream, int cmd)
c0f41bb1	238	{
c3f2028b	239	struct runtime_data *prtd = substream->runtime->private_data;
c0f41bb1 BD	240	int ret = 0;
c0f41bb1 BD	241
ee7d4767	242	pr_debug("Entered %s\n", __func__);
c0f41bb1 BD	243
	244	spin_lock(&prtd->lock);
	245
	246	switch (cmd) {
	247	case SNDRV_PCM_TRIGGER_START:
	248	case SNDRV_PCM_TRIGGER_RESUME:
	249	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
	250	prtd->state \|= ST_RUNNING;
344b4c48	251	prtd->params->ops->trigger(prtd->params->ch);
c0f41bb1 BD	252	break;
	253
	254	case SNDRV_PCM_TRIGGER_STOP:
	255	case SNDRV_PCM_TRIGGER_SUSPEND:
	256	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
	257	prtd->state &= ~ST_RUNNING;
344b4c48	258	prtd->params->ops->stop(prtd->params->ch);
c0f41bb1 BD	259	break;
	260
	261	default:
	262	ret = -EINVAL;
	263	break;
	264	}
	265
	266	spin_unlock(&prtd->lock);
	267
	268	return ret;
	269	}
	270
5111c075	271	static snd_pcm_uframes_t
c3f2028b	272	dma_pointer(struct snd_pcm_substream *substream)
c0f41bb1 BD	273	{
c0f41bb1 BD	274	struct snd_pcm_runtime *runtime = substream->runtime;
c3f2028b	275	struct runtime_data *prtd = runtime->private_data;
c0f41bb1	276	unsigned long res;
c0f41bb1	277
ee7d4767	278	pr_debug("Entered %s\n", __func__);
c0f41bb1	279
344b4c48	280	res = prtd->dma_pos - prtd->dma_start;
c0f41bb1	281
344b4c48	282	pr_debug("Pointer offset: %lu\n", res);
c0f41bb1 BD	283
	284	/* we seem to be getting the odd error from the pcm library due
	285	* to out-of-bounds pointers. this is maybe due to the dma engine
	286	* not having loaded the new values for the channel before being
ceade6c8	287	* called... (todo - fix )
c0f41bb1 BD	288	*/
	289
	290	if (res >= snd_pcm_lib_buffer_bytes(substream)) {
	291	if (res == snd_pcm_lib_buffer_bytes(substream))
	292	res = 0;
	293	}
	294
	295	return bytes_to_frames(substream->runtime, res);
	296	}
	297
c3f2028b	298	static int dma_open(struct snd_pcm_substream *substream)
c0f41bb1 BD	299	{
c0f41bb1 BD	300	struct snd_pcm_runtime *runtime = substream->runtime;
c3f2028b	301	struct runtime_data *prtd;
c0f41bb1	302
ee7d4767	303	pr_debug("Entered %s\n", __func__);
c0f41bb1	304
f61c890e	305	snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
c3f2028b	306	snd_soc_set_runtime_hwparams(substream, &dma_hardware);
c0f41bb1	307
c3f2028b	308	prtd = kzalloc(sizeof(struct runtime_data), GFP_KERNEL);
c0f41bb1 BD	309	if (prtd == NULL)
	310	return -ENOMEM;
	311
c72816b7 ZD	312	spin_lock_init(&prtd->lock);
c72816b7 ZD	313
c0f41bb1 BD	314	runtime->private_data = prtd;
	315	return 0;
	316	}
	317
c3f2028b	318	static int dma_close(struct snd_pcm_substream *substream)
c0f41bb1 BD	319	{
c0f41bb1 BD	320	struct snd_pcm_runtime *runtime = substream->runtime;
c3f2028b	321	struct runtime_data *prtd = runtime->private_data;
c0f41bb1	322
ee7d4767	323	pr_debug("Entered %s\n", __func__);
c0f41bb1	324
5111c075	325	if (!prtd)
c3f2028b	326	pr_debug("dma_close called with prtd == NULL\n");
c0f41bb1	327
5111c075 MB	328	kfree(prtd);
5111c075 MB	329
c0f41bb1 BD	330	return 0;
	331	}
	332
c3f2028b	333	static int dma_mmap(struct snd_pcm_substream *substream,
c0f41bb1 BD	334	struct vm_area_struct *vma)
	335	{
	336	struct snd_pcm_runtime *runtime = substream->runtime;
	337
ee7d4767	338	pr_debug("Entered %s\n", __func__);
c0f41bb1 BD	339
c0f41bb1 BD	340	return dma_mmap_writecombine(substream->pcm->card->dev, vma,
5111c075 MB	341	runtime->dma_area,
	342	runtime->dma_addr,
	343	runtime->dma_bytes);
c0f41bb1 BD	344	}
c0f41bb1 BD	345
c3f2028b JB	346	static struct snd_pcm_ops dma_ops = {
	347	.open = dma_open,
	348	.close = dma_close,
c0f41bb1	349	.ioctl = snd_pcm_lib_ioctl,
c3f2028b JB	350	.hw_params = dma_hw_params,
	351	.hw_free = dma_hw_free,
	352	.prepare = dma_prepare,
	353	.trigger = dma_trigger,
	354	.pointer = dma_pointer,
	355	.mmap = dma_mmap,
c0f41bb1 BD	356	};
c0f41bb1 BD	357
c3f2028b	358	static int preallocate_dma_buffer(struct snd_pcm *pcm, int stream)
c0f41bb1 BD	359	{
	360	struct snd_pcm_substream *substream = pcm->streams[stream].substream;
	361	struct snd_dma_buffer *buf = &substream->dma_buffer;
c3f2028b	362	size_t size = dma_hardware.buffer_bytes_max;
c0f41bb1	363
ee7d4767	364	pr_debug("Entered %s\n", __func__);
c0f41bb1 BD	365
	366	buf->dev.type = SNDRV_DMA_TYPE_DEV;
	367	buf->dev.dev = pcm->card->dev;
	368	buf->private_data = NULL;
	369	buf->area = dma_alloc_writecombine(pcm->card->dev, size,
	370	&buf->addr, GFP_KERNEL);
	371	if (!buf->area)
	372	return -ENOMEM;
	373	buf->bytes = size;
	374	return 0;
	375	}
	376
c3f2028b	377	static void dma_free_dma_buffers(struct snd_pcm *pcm)
c0f41bb1 BD	378	{
	379	struct snd_pcm_substream *substream;
	380	struct snd_dma_buffer *buf;
	381	int stream;
	382
ee7d4767	383	pr_debug("Entered %s\n", __func__);
c0f41bb1 BD	384
	385	for (stream = 0; stream < 2; stream++) {
	386	substream = pcm->streams[stream].substream;
	387	if (!substream)
	388	continue;
	389
	390	buf = &substream->dma_buffer;
	391	if (!buf->area)
	392	continue;
	393
	394	dma_free_writecombine(pcm->card->dev, buf->bytes,
	395	buf->area, buf->addr);
	396	buf->area = NULL;
	397	}
	398	}
	399
c3f2028b	400	static u64 dma_mask = DMA_BIT_MASK(32);
c0f41bb1	401
552d1ef6	402	static int dma_new(struct snd_soc_pcm_runtime *rtd)
c0f41bb1	403	{
552d1ef6 LG	404	struct snd_card *card = rtd->card->snd_card;
	405	struct snd_soc_dai *dai = rtd->cpu_dai;
	406	struct snd_pcm *pcm = rtd->pcm;
c0f41bb1 BD	407	int ret = 0;
c0f41bb1 BD	408
ee7d4767	409	pr_debug("Entered %s\n", __func__);
c0f41bb1 BD	410
c0f41bb1 BD	411	if (!card->dev->dma_mask)
c3f2028b	412	card->dev->dma_mask = &dma_mask;
c0f41bb1 BD	413	if (!card->dev->coherent_dma_mask)
	414	card->dev->coherent_dma_mask = 0xffffffff;
	415
f0fba2ad	416	if (dai->driver->playback.channels_min) {
c3f2028b	417	ret = preallocate_dma_buffer(pcm,
c0f41bb1 BD	418	SNDRV_PCM_STREAM_PLAYBACK);
	419	if (ret)
	420	goto out;
	421	}
	422
f0fba2ad	423	if (dai->driver->capture.channels_min) {
c3f2028b	424	ret = preallocate_dma_buffer(pcm,
c0f41bb1 BD	425	SNDRV_PCM_STREAM_CAPTURE);
	426	if (ret)
	427	goto out;
	428	}
4b640cf3	429	out:
c0f41bb1 BD	430	return ret;
	431	}
	432
c3f2028b JB	433	static struct snd_soc_platform_driver samsung_asoc_platform = {
	434	.ops = &dma_ops,
	435	.pcm_new = dma_new,
	436	.pcm_free = dma_free_dma_buffers,
c0f41bb1	437	};
c0f41bb1	438
c3f2028b	439	static int __devinit samsung_asoc_platform_probe(struct platform_device *pdev)
958e792c	440	{
c3f2028b	441	return snd_soc_register_platform(&pdev->dev, &samsung_asoc_platform);
958e792c	442	}
958e792c	443
c3f2028b	444	static int __devexit samsung_asoc_platform_remove(struct platform_device *pdev)
958e792c	445	{
f0fba2ad LG	446	snd_soc_unregister_platform(&pdev->dev);
	447	return 0;
	448	}
	449
c3f2028b	450	static struct platform_driver asoc_dma_driver = {
f0fba2ad	451	.driver = {
58bb4072	452	.name = "samsung-audio",
f0fba2ad LG	453	.owner = THIS_MODULE,
	454	},
	455
c3f2028b JB	456	.probe = samsung_asoc_platform_probe,
c3f2028b JB	457	.remove = __devexit_p(samsung_asoc_platform_remove),
f0fba2ad LG	458	};
f0fba2ad LG	459
c3f2028b	460	static int __init samsung_asoc_init(void)
f0fba2ad	461	{
c3f2028b	462	return platform_driver_register(&asoc_dma_driver);
f0fba2ad	463	}
c3f2028b	464	module_init(samsung_asoc_init);
f0fba2ad	465
c3f2028b	466	static void __exit samsung_asoc_exit(void)
f0fba2ad	467	{
c3f2028b	468	platform_driver_unregister(&asoc_dma_driver);
958e792c	469	}
c3f2028b	470	module_exit(samsung_asoc_exit);
958e792c	471
c0f41bb1	472	MODULE_AUTHOR("Ben Dooks, <ben@simtec.co.uk>");
c3f2028b	473	MODULE_DESCRIPTION("Samsung ASoC DMA Driver");
c0f41bb1	474	MODULE_LICENSE("GPL");
58bb4072	475	MODULE_ALIAS("platform:samsung-audio");