[deliverable/linux.git] / sound / soc / txx9 / txx9aclc.c

/*
 * Generic TXx9 ACLC platform driver
 *
 * Copyright (C) 2009 Atsushi Nemoto
 *
 * Based on RBTX49xx patch from CELF patch archive.
 * (C) Copyright TOSHIBA CORPORATION 2004-2006
 *
 * 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.
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/scatterlist.h>
#include <linux/slab.h>
#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
#include <sound/soc.h>
#include "txx9aclc.h"

static struct txx9aclc_soc_device {
	struct txx9aclc_dmadata dmadata[2];
} txx9aclc_soc_device;

/* REVISIT: How to find txx9aclc_drvdata from snd_ac97? */
static struct txx9aclc_plat_drvdata *txx9aclc_drvdata;

static int txx9aclc_dma_init(struct txx9aclc_soc_device *dev,
			     struct txx9aclc_dmadata *dmadata);

static const struct snd_pcm_hardware txx9aclc_pcm_hardware = {
	/*
	 * REVISIT: SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID
	 * needs more works for noncoherent MIPS.
	 */
	.info		  = SNDRV_PCM_INFO_INTERLEAVED |
			    SNDRV_PCM_INFO_BATCH |
			    SNDRV_PCM_INFO_PAUSE,
#ifdef __BIG_ENDIAN
	.formats	  = SNDRV_PCM_FMTBIT_S16_BE,
#else
	.formats	  = SNDRV_PCM_FMTBIT_S16_LE,
#endif
	.period_bytes_min = 1024,
	.period_bytes_max = 8 * 1024,
	.periods_min	  = 2,
	.periods_max	  = 4096,
	.buffer_bytes_max = 32 * 1024,
};

static int txx9aclc_pcm_hw_params(struct snd_pcm_substream *substream,
				  struct snd_pcm_hw_params *params)
{
	struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream);
	struct snd_pcm_runtime *runtime = substream->runtime;
	struct txx9aclc_dmadata *dmadata = runtime->private_data;
	int ret;

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

	dev_dbg(rtd->platform->dev,
		"runtime->dma_area = %#lx dma_addr = %#lx dma_bytes = %zd "
		"runtime->min_align %ld\n",
		(unsigned long)runtime->dma_area,
		(unsigned long)runtime->dma_addr, runtime->dma_bytes,
		runtime->min_align);
	dev_dbg(rtd->platform->dev,
		"periods %d period_bytes %d stream %d\n",
		params_periods(params), params_period_bytes(params),
		substream->stream);

	dmadata->substream = substream;
	dmadata->pos = 0;
	return 0;
}

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

static int txx9aclc_pcm_prepare(struct snd_pcm_substream *substream)
{
	struct snd_pcm_runtime *runtime = substream->runtime;
	struct txx9aclc_dmadata *dmadata = runtime->private_data;

	dmadata->dma_addr = runtime->dma_addr;
	dmadata->buffer_bytes = snd_pcm_lib_buffer_bytes(substream);
	dmadata->period_bytes = snd_pcm_lib_period_bytes(substream);

	if (dmadata->buffer_bytes == dmadata->period_bytes) {
		dmadata->frag_bytes = dmadata->period_bytes >> 1;
		dmadata->frags = 2;
	} else {
		dmadata->frag_bytes = dmadata->period_bytes;
		dmadata->frags = dmadata->buffer_bytes / dmadata->period_bytes;
	}
	dmadata->frag_count = 0;
	dmadata->pos = 0;
	return 0;
}

static void txx9aclc_dma_complete(void *arg)
{
	struct txx9aclc_dmadata *dmadata = arg;
	unsigned long flags;

	/* dma completion handler cannot submit new operations */
	spin_lock_irqsave(&dmadata->dma_lock, flags);
	if (dmadata->frag_count >= 0) {
		dmadata->dmacount--;
		BUG_ON(dmadata->dmacount < 0);
		tasklet_schedule(&dmadata->tasklet);
	}
	spin_unlock_irqrestore(&dmadata->dma_lock, flags);
}

static struct dma_async_tx_descriptor *
txx9aclc_dma_submit(struct txx9aclc_dmadata *dmadata, dma_addr_t buf_dma_addr)
{
	struct dma_chan *chan = dmadata->dma_chan;
	struct dma_async_tx_descriptor *desc;
	struct scatterlist sg;

	sg_init_table(&sg, 1);
	sg_set_page(&sg, pfn_to_page(PFN_DOWN(buf_dma_addr)),
		    dmadata->frag_bytes, buf_dma_addr & (PAGE_SIZE - 1));
	sg_dma_address(&sg) = buf_dma_addr;
	desc = dmaengine_prep_slave_sg(chan, &sg, 1,
		dmadata->substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
		DMA_MEM_TO_DEV : DMA_DEV_TO_MEM,
		DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
	if (!desc) {
		dev_err(&chan->dev->device, "cannot prepare slave dma\n");
		return NULL;
	}
	desc->callback = txx9aclc_dma_complete;
	desc->callback_param = dmadata;
	desc->tx_submit(desc);
	return desc;
}

#define NR_DMA_CHAIN		2

static void txx9aclc_dma_tasklet(unsigned long data)
{
	struct txx9aclc_dmadata *dmadata = (struct txx9aclc_dmadata *)data;
	struct dma_chan *chan = dmadata->dma_chan;
	struct dma_async_tx_descriptor *desc;
	struct snd_pcm_substream *substream = dmadata->substream;
	u32 ctlbit = substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
		ACCTL_AUDODMA : ACCTL_AUDIDMA;
	int i;
	unsigned long flags;

	spin_lock_irqsave(&dmadata->dma_lock, flags);
	if (dmadata->frag_count < 0) {
		struct txx9aclc_plat_drvdata *drvdata = txx9aclc_drvdata;
		void __iomem *base = drvdata->base;

		spin_unlock_irqrestore(&dmadata->dma_lock, flags);
		chan->device->device_control(chan, DMA_TERMINATE_ALL, 0);
		/* first time */
		for (i = 0; i < NR_DMA_CHAIN; i++) {
			desc = txx9aclc_dma_submit(dmadata,
				dmadata->dma_addr + i * dmadata->frag_bytes);
			if (!desc)
				return;
		}
		dmadata->dmacount = NR_DMA_CHAIN;
		chan->device->device_issue_pending(chan);
		spin_lock_irqsave(&dmadata->dma_lock, flags);
		__raw_writel(ctlbit, base + ACCTLEN);
		dmadata->frag_count = NR_DMA_CHAIN % dmadata->frags;
		spin_unlock_irqrestore(&dmadata->dma_lock, flags);
		return;
	}
	BUG_ON(dmadata->dmacount >= NR_DMA_CHAIN);
	while (dmadata->dmacount < NR_DMA_CHAIN) {
		dmadata->dmacount++;
		spin_unlock_irqrestore(&dmadata->dma_lock, flags);
		desc = txx9aclc_dma_submit(dmadata,
			dmadata->dma_addr +
			dmadata->frag_count * dmadata->frag_bytes);
		if (!desc)
			return;
		chan->device->device_issue_pending(chan);

		spin_lock_irqsave(&dmadata->dma_lock, flags);
		dmadata->frag_count++;
		dmadata->frag_count %= dmadata->frags;
		dmadata->pos += dmadata->frag_bytes;
		dmadata->pos %= dmadata->buffer_bytes;
		if ((dmadata->frag_count * dmadata->frag_bytes) %
		    dmadata->period_bytes == 0)
			snd_pcm_period_elapsed(substream);
	}
	spin_unlock_irqrestore(&dmadata->dma_lock, flags);
}

static int txx9aclc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
{
	struct txx9aclc_dmadata *dmadata = substream->runtime->private_data;
	struct txx9aclc_plat_drvdata *drvdata =txx9aclc_drvdata;
	void __iomem *base = drvdata->base;
	unsigned long flags;
	int ret = 0;
	u32 ctlbit = substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
		ACCTL_AUDODMA : ACCTL_AUDIDMA;

	spin_lock_irqsave(&dmadata->dma_lock, flags);
	switch (cmd) {
	case SNDRV_PCM_TRIGGER_START:
		dmadata->frag_count = -1;
		tasklet_schedule(&dmadata->tasklet);
		break;
	case SNDRV_PCM_TRIGGER_STOP:
	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
	case SNDRV_PCM_TRIGGER_SUSPEND:
		__raw_writel(ctlbit, base + ACCTLDIS);
		break;
	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
	case SNDRV_PCM_TRIGGER_RESUME:
		__raw_writel(ctlbit, base + ACCTLEN);
		break;
	default:
		ret = -EINVAL;
	}
	spin_unlock_irqrestore(&dmadata->dma_lock, flags);
	return ret;
}

static snd_pcm_uframes_t
txx9aclc_pcm_pointer(struct snd_pcm_substream *substream)
{
	struct txx9aclc_dmadata *dmadata = substream->runtime->private_data;

	return bytes_to_frames(substream->runtime, dmadata->pos);
}

static int txx9aclc_pcm_open(struct snd_pcm_substream *substream)
{
	struct txx9aclc_soc_device *dev = &txx9aclc_soc_device;
	struct txx9aclc_dmadata *dmadata = &dev->dmadata[substream->stream];
	int ret;

	ret = snd_soc_set_runtime_hwparams(substream, &txx9aclc_pcm_hardware);
	if (ret)
		return ret;
	/* ensure that buffer size is a multiple of period size */
	ret = snd_pcm_hw_constraint_integer(substream->runtime,
					    SNDRV_PCM_HW_PARAM_PERIODS);
	if (ret < 0)
		return ret;
	substream->runtime->private_data = dmadata;
	return 0;
}

static int txx9aclc_pcm_close(struct snd_pcm_substream *substream)
{
	struct txx9aclc_dmadata *dmadata = substream->runtime->private_data;
	struct dma_chan *chan = dmadata->dma_chan;

	dmadata->frag_count = -1;
	chan->device->device_control(chan, DMA_TERMINATE_ALL, 0);
	return 0;
}

static struct snd_pcm_ops txx9aclc_pcm_ops = {
	.open		= txx9aclc_pcm_open,
	.close		= txx9aclc_pcm_close,
	.ioctl		= snd_pcm_lib_ioctl,
	.hw_params	= txx9aclc_pcm_hw_params,
	.hw_free	= txx9aclc_pcm_hw_free,
	.prepare	= txx9aclc_pcm_prepare,
	.trigger	= txx9aclc_pcm_trigger,
	.pointer	= txx9aclc_pcm_pointer,
};

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

static int txx9aclc_pcm_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;
	struct platform_device *pdev = to_platform_device(dai->platform->dev);
	struct txx9aclc_soc_device *dev;
	struct resource *r;
	int i;
	int ret;

	/* at this point onwards the AC97 component has probed and this will be valid */
	dev = snd_soc_dai_get_drvdata(dai);

	dev->dmadata[0].stream = SNDRV_PCM_STREAM_PLAYBACK;
	dev->dmadata[1].stream = SNDRV_PCM_STREAM_CAPTURE;
	for (i = 0; i < 2; i++) {
		r = platform_get_resource(pdev, IORESOURCE_DMA, i);
		if (!r) {
			ret = -EBUSY;
			goto exit;
		}
		dev->dmadata[i].dma_res = r;
		ret = txx9aclc_dma_init(dev, &dev->dmadata[i]);
		if (ret)
			goto exit;
	}
	return snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
		card->dev, 64 * 1024, 4 * 1024 * 1024);

exit:
	for (i = 0; i < 2; i++) {
		if (dev->dmadata[i].dma_chan)
			dma_release_channel(dev->dmadata[i].dma_chan);
		dev->dmadata[i].dma_chan = NULL;
	}
	return ret;
}

static bool filter(struct dma_chan *chan, void *param)
{
	struct txx9aclc_dmadata *dmadata = param;
	char *devname;
	bool found = false;

	devname = kasprintf(GFP_KERNEL, "%s.%d", dmadata->dma_res->name,
		(int)dmadata->dma_res->start);
	if (strcmp(dev_name(chan->device->dev), devname) == 0) {
		chan->private = &dmadata->dma_slave;
		found = true;
	}
	kfree(devname);
	return found;
}

static int txx9aclc_dma_init(struct txx9aclc_soc_device *dev,
			     struct txx9aclc_dmadata *dmadata)
{
	struct txx9aclc_plat_drvdata *drvdata =txx9aclc_drvdata;
	struct txx9dmac_slave *ds = &dmadata->dma_slave;
	dma_cap_mask_t mask;

	spin_lock_init(&dmadata->dma_lock);

	ds->reg_width = sizeof(u32);
	if (dmadata->stream == SNDRV_PCM_STREAM_PLAYBACK) {
		ds->tx_reg = drvdata->physbase + ACAUDODAT;
		ds->rx_reg = 0;
	} else {
		ds->tx_reg = 0;
		ds->rx_reg = drvdata->physbase + ACAUDIDAT;
	}

	/* Try to grab a DMA channel */
	dma_cap_zero(mask);
	dma_cap_set(DMA_SLAVE, mask);
	dmadata->dma_chan = dma_request_channel(mask, filter, dmadata);
	if (!dmadata->dma_chan) {
		printk(KERN_ERR
			"DMA channel for %s is not available\n",
			dmadata->stream == SNDRV_PCM_STREAM_PLAYBACK ?
			"playback" : "capture");
		return -EBUSY;
	}
	tasklet_init(&dmadata->tasklet, txx9aclc_dma_tasklet,
		     (unsigned long)dmadata);
	return 0;
}

static int txx9aclc_pcm_probe(struct snd_soc_platform *platform)
{
	snd_soc_platform_set_drvdata(platform, &txx9aclc_soc_device);
	return 0;
}

static int txx9aclc_pcm_remove(struct snd_soc_platform *platform)
{
	struct txx9aclc_soc_device *dev = snd_soc_platform_get_drvdata(platform);
	struct txx9aclc_plat_drvdata *drvdata = txx9aclc_drvdata;
	void __iomem *base = drvdata->base;
	int i;

	/* disable all FIFO DMAs */
	__raw_writel(ACCTL_AUDODMA | ACCTL_AUDIDMA, base + ACCTLDIS);
	/* dummy R/W to clear pending DMAREQ if any */
	__raw_writel(__raw_readl(base + ACAUDIDAT), base + ACAUDODAT);

	for (i = 0; i < 2; i++) {
		struct txx9aclc_dmadata *dmadata = &dev->dmadata[i];
		struct dma_chan *chan = dmadata->dma_chan;
		if (chan) {
			dmadata->frag_count = -1;
			chan->device->device_control(chan,
						     DMA_TERMINATE_ALL, 0);
			dma_release_channel(chan);
		}
		dev->dmadata[i].dma_chan = NULL;
	}
	return 0;
}

static struct snd_soc_platform_driver txx9aclc_soc_platform = {
	.probe		= txx9aclc_pcm_probe,
	.remove		= txx9aclc_pcm_remove,
	.ops		= &txx9aclc_pcm_ops,
	.pcm_new	= txx9aclc_pcm_new,
	.pcm_free	= txx9aclc_pcm_free_dma_buffers,
};

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

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

static struct platform_driver txx9aclc_pcm_driver = {
	.driver = {
			.name = "txx9aclc-pcm-audio",
			.owner = THIS_MODULE,
	},

	.probe = txx9aclc_soc_platform_probe,
	.remove = __devexit_p(txx9aclc_soc_platform_remove),
};

module_platform_driver(txx9aclc_pcm_driver);

MODULE_AUTHOR("Atsushi Nemoto <anemo@mba.ocn.ne.jp>");
MODULE_DESCRIPTION("TXx9 ACLC Audio DMA driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
e24805dd AN	1	/*
	2	* Generic TXx9 ACLC platform driver
	3	*
	4	* Copyright (C) 2009 Atsushi Nemoto
	5	*
	6	* Based on RBTX49xx patch from CELF patch archive.
	7	* (C) Copyright TOSHIBA CORPORATION 2004-2006
	8	*
	9	* This program is free software; you can redistribute it and/or modify
	10	* it under the terms of the GNU General Public License version 2 as
	11	* published by the Free Software Foundation.
	12	*/
	13
	14	#include <linux/module.h>
	15	#include <linux/init.h>
	16	#include <linux/platform_device.h>
	17	#include <linux/scatterlist.h>
5a0e3ad6	18	#include <linux/slab.h>
e24805dd AN	19	#include <sound/core.h>
	20	#include <sound/pcm.h>
	21	#include <sound/pcm_params.h>
	22	#include <sound/soc.h>
	23	#include "txx9aclc.h"
	24
f0fba2ad LG	25	static struct txx9aclc_soc_device {
	26	struct txx9aclc_dmadata dmadata[2];
	27	} txx9aclc_soc_device;
	28
	29	/* REVISIT: How to find txx9aclc_drvdata from snd_ac97? */
	30	static struct txx9aclc_plat_drvdata *txx9aclc_drvdata;
	31
	32	static int txx9aclc_dma_init(struct txx9aclc_soc_device *dev,
	33	struct txx9aclc_dmadata *dmadata);
	34
e24805dd AN	35	static const struct snd_pcm_hardware txx9aclc_pcm_hardware = {
	36	/*
	37	* REVISIT: SNDRV_PCM_INFO_MMAP \| SNDRV_PCM_INFO_MMAP_VALID
	38	* needs more works for noncoherent MIPS.
	39	*/
	40	.info = SNDRV_PCM_INFO_INTERLEAVED \|
	41	SNDRV_PCM_INFO_BATCH \|
	42	SNDRV_PCM_INFO_PAUSE,
	43	#ifdef __BIG_ENDIAN
	44	.formats = SNDRV_PCM_FMTBIT_S16_BE,
	45	#else
	46	.formats = SNDRV_PCM_FMTBIT_S16_LE,
	47	#endif
	48	.period_bytes_min = 1024,
	49	.period_bytes_max = 8 * 1024,
	50	.periods_min = 2,
	51	.periods_max = 4096,
	52	.buffer_bytes_max = 32 * 1024,
	53	};
	54
	55	static int txx9aclc_pcm_hw_params(struct snd_pcm_substream *substream,
	56	struct snd_pcm_hw_params *params)
	57	{
	58	struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream);
e24805dd AN	59	struct snd_pcm_runtime *runtime = substream->runtime;
	60	struct txx9aclc_dmadata *dmadata = runtime->private_data;
	61	int ret;
	62
	63	ret = snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(params));
	64	if (ret < 0)
	65	return ret;
	66
f0fba2ad	67	dev_dbg(rtd->platform->dev,
e24805dd AN	68	"runtime->dma_area = %#lx dma_addr = %#lx dma_bytes = %zd "
	69	"runtime->min_align %ld\n",
	70	(unsigned long)runtime->dma_area,
	71	(unsigned long)runtime->dma_addr, runtime->dma_bytes,
	72	runtime->min_align);
f0fba2ad	73	dev_dbg(rtd->platform->dev,
e24805dd AN	74	"periods %d period_bytes %d stream %d\n",
	75	params_periods(params), params_period_bytes(params),
	76	substream->stream);
	77
	78	dmadata->substream = substream;
	79	dmadata->pos = 0;
	80	return 0;
	81	}
	82
	83	static int txx9aclc_pcm_hw_free(struct snd_pcm_substream *substream)
	84	{
	85	return snd_pcm_lib_free_pages(substream);
	86	}
	87
	88	static int txx9aclc_pcm_prepare(struct snd_pcm_substream *substream)
	89	{
	90	struct snd_pcm_runtime *runtime = substream->runtime;
	91	struct txx9aclc_dmadata *dmadata = runtime->private_data;
	92
	93	dmadata->dma_addr = runtime->dma_addr;
	94	dmadata->buffer_bytes = snd_pcm_lib_buffer_bytes(substream);
	95	dmadata->period_bytes = snd_pcm_lib_period_bytes(substream);
	96
	97	if (dmadata->buffer_bytes == dmadata->period_bytes) {
	98	dmadata->frag_bytes = dmadata->period_bytes >> 1;
	99	dmadata->frags = 2;
	100	} else {
	101	dmadata->frag_bytes = dmadata->period_bytes;
	102	dmadata->frags = dmadata->buffer_bytes / dmadata->period_bytes;
	103	}
	104	dmadata->frag_count = 0;
	105	dmadata->pos = 0;
	106	return 0;
	107	}
	108
	109	static void txx9aclc_dma_complete(void *arg)
	110	{
	111	struct txx9aclc_dmadata *dmadata = arg;
	112	unsigned long flags;
	113
	114	/* dma completion handler cannot submit new operations */
	115	spin_lock_irqsave(&dmadata->dma_lock, flags);
	116	if (dmadata->frag_count >= 0) {
	117	dmadata->dmacount--;
	118	BUG_ON(dmadata->dmacount < 0);
	119	tasklet_schedule(&dmadata->tasklet);
	120	}
	121	spin_unlock_irqrestore(&dmadata->dma_lock, flags);
	122	}
	123
	124	static struct dma_async_tx_descriptor *
	125	txx9aclc_dma_submit(struct txx9aclc_dmadata *dmadata, dma_addr_t buf_dma_addr)
	126	{
	127	struct dma_chan *chan = dmadata->dma_chan;
	128	struct dma_async_tx_descriptor *desc;
	129	struct scatterlist sg;
	130
	131	sg_init_table(&sg, 1);
	132	sg_set_page(&sg, pfn_to_page(PFN_DOWN(buf_dma_addr)),
	133	dmadata->frag_bytes, buf_dma_addr & (PAGE_SIZE - 1));
	134	sg_dma_address(&sg) = buf_dma_addr;
16052827	135	desc = dmaengine_prep_slave_sg(chan, &sg, 1,
e24805dd	136	dmadata->substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
35e16581	137	DMA_MEM_TO_DEV : DMA_DEV_TO_MEM,
e24805dd AN	138	DMA_PREP_INTERRUPT \| DMA_CTRL_ACK);
	139	if (!desc) {
	140	dev_err(&chan->dev->device, "cannot prepare slave dma\n");
	141	return NULL;
	142	}
	143	desc->callback = txx9aclc_dma_complete;
	144	desc->callback_param = dmadata;
	145	desc->tx_submit(desc);
	146	return desc;
	147	}
	148
	149	#define NR_DMA_CHAIN 2
	150
	151	static void txx9aclc_dma_tasklet(unsigned long data)
	152	{
	153	struct txx9aclc_dmadata dmadata = (struct txx9aclc_dmadata )data;
	154	struct dma_chan *chan = dmadata->dma_chan;
	155	struct dma_async_tx_descriptor *desc;
	156	struct snd_pcm_substream *substream = dmadata->substream;
	157	u32 ctlbit = substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
	158	ACCTL_AUDODMA : ACCTL_AUDIDMA;
	159	int i;
	160	unsigned long flags;
	161
	162	spin_lock_irqsave(&dmadata->dma_lock, flags);
	163	if (dmadata->frag_count < 0) {
f0fba2ad	164	struct txx9aclc_plat_drvdata *drvdata = txx9aclc_drvdata;
e24805dd AN	165	void __iomem *base = drvdata->base;
	166
	167	spin_unlock_irqrestore(&dmadata->dma_lock, flags);
05827630	168	chan->device->device_control(chan, DMA_TERMINATE_ALL, 0);
e24805dd AN	169	/* first time */
	170	for (i = 0; i < NR_DMA_CHAIN; i++) {
	171	desc = txx9aclc_dma_submit(dmadata,
	172	dmadata->dma_addr + i * dmadata->frag_bytes);
	173	if (!desc)
	174	return;
	175	}
	176	dmadata->dmacount = NR_DMA_CHAIN;
	177	chan->device->device_issue_pending(chan);
	178	spin_lock_irqsave(&dmadata->dma_lock, flags);
	179	__raw_writel(ctlbit, base + ACCTLEN);
	180	dmadata->frag_count = NR_DMA_CHAIN % dmadata->frags;
	181	spin_unlock_irqrestore(&dmadata->dma_lock, flags);
	182	return;
	183	}
	184	BUG_ON(dmadata->dmacount >= NR_DMA_CHAIN);
	185	while (dmadata->dmacount < NR_DMA_CHAIN) {
	186	dmadata->dmacount++;
	187	spin_unlock_irqrestore(&dmadata->dma_lock, flags);
	188	desc = txx9aclc_dma_submit(dmadata,
	189	dmadata->dma_addr +
	190	dmadata->frag_count * dmadata->frag_bytes);
	191	if (!desc)
	192	return;
	193	chan->device->device_issue_pending(chan);
	194
	195	spin_lock_irqsave(&dmadata->dma_lock, flags);
	196	dmadata->frag_count++;
	197	dmadata->frag_count %= dmadata->frags;
	198	dmadata->pos += dmadata->frag_bytes;
	199	dmadata->pos %= dmadata->buffer_bytes;
	200	if ((dmadata->frag_count * dmadata->frag_bytes) %
	201	dmadata->period_bytes == 0)
	202	snd_pcm_period_elapsed(substream);
	203	}
	204	spin_unlock_irqrestore(&dmadata->dma_lock, flags);
	205	}
	206
	207	static int txx9aclc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
	208	{
	209	struct txx9aclc_dmadata *dmadata = substream->runtime->private_data;
f0fba2ad	210	struct txx9aclc_plat_drvdata *drvdata =txx9aclc_drvdata;
e24805dd AN	211	void __iomem *base = drvdata->base;
	212	unsigned long flags;
	213	int ret = 0;
	214	u32 ctlbit = substream->stream == SNDRV_PCM_STREAM_PLAYBACK ?
	215	ACCTL_AUDODMA : ACCTL_AUDIDMA;
	216
	217	spin_lock_irqsave(&dmadata->dma_lock, flags);
	218	switch (cmd) {
	219	case SNDRV_PCM_TRIGGER_START:
	220	dmadata->frag_count = -1;
	221	tasklet_schedule(&dmadata->tasklet);
	222	break;
	223	case SNDRV_PCM_TRIGGER_STOP:
	224	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
	225	case SNDRV_PCM_TRIGGER_SUSPEND:
	226	__raw_writel(ctlbit, base + ACCTLDIS);
	227	break;
	228	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
	229	case SNDRV_PCM_TRIGGER_RESUME:
	230	__raw_writel(ctlbit, base + ACCTLEN);
	231	break;
	232	default:
	233	ret = -EINVAL;
	234	}
	235	spin_unlock_irqrestore(&dmadata->dma_lock, flags);
	236	return ret;
	237	}
	238
	239	static snd_pcm_uframes_t
	240	txx9aclc_pcm_pointer(struct snd_pcm_substream *substream)
	241	{
	242	struct txx9aclc_dmadata *dmadata = substream->runtime->private_data;
	243
	244	return bytes_to_frames(substream->runtime, dmadata->pos);
	245	}
	246
	247	static int txx9aclc_pcm_open(struct snd_pcm_substream *substream)
	248	{
f0fba2ad	249	struct txx9aclc_soc_device *dev = &txx9aclc_soc_device;
e24805dd AN	250	struct txx9aclc_dmadata *dmadata = &dev->dmadata[substream->stream];
	251	int ret;
	252
	253	ret = snd_soc_set_runtime_hwparams(substream, &txx9aclc_pcm_hardware);
	254	if (ret)
	255	return ret;
	256	/* ensure that buffer size is a multiple of period size */
	257	ret = snd_pcm_hw_constraint_integer(substream->runtime,
	258	SNDRV_PCM_HW_PARAM_PERIODS);
	259	if (ret < 0)
	260	return ret;
	261	substream->runtime->private_data = dmadata;
	262	return 0;
	263	}
	264
	265	static int txx9aclc_pcm_close(struct snd_pcm_substream *substream)
	266	{
	267	struct txx9aclc_dmadata *dmadata = substream->runtime->private_data;
	268	struct dma_chan *chan = dmadata->dma_chan;
	269
	270	dmadata->frag_count = -1;
05827630	271	chan->device->device_control(chan, DMA_TERMINATE_ALL, 0);
e24805dd AN	272	return 0;
	273	}
	274
	275	static struct snd_pcm_ops txx9aclc_pcm_ops = {
	276	.open = txx9aclc_pcm_open,
	277	.close = txx9aclc_pcm_close,
	278	.ioctl = snd_pcm_lib_ioctl,
	279	.hw_params = txx9aclc_pcm_hw_params,
	280	.hw_free = txx9aclc_pcm_hw_free,
	281	.prepare = txx9aclc_pcm_prepare,
	282	.trigger = txx9aclc_pcm_trigger,
	283	.pointer = txx9aclc_pcm_pointer,
	284	};
	285
	286	static void txx9aclc_pcm_free_dma_buffers(struct snd_pcm *pcm)
	287	{
	288	snd_pcm_lib_preallocate_free_for_all(pcm);
	289	}
	290
552d1ef6	291	static int txx9aclc_pcm_new(struct snd_soc_pcm_runtime *rtd)
e24805dd	292	{
06132fdf	293	struct snd_card *card = rtd->card->snd_card;
552d1ef6 LG	294	struct snd_soc_dai *dai = rtd->cpu_dai;
552d1ef6 LG	295	struct snd_pcm *pcm = rtd->pcm;
f0fba2ad LG	296	struct platform_device *pdev = to_platform_device(dai->platform->dev);
	297	struct txx9aclc_soc_device *dev;
	298	struct resource *r;
	299	int i;
	300	int ret;
	301
	302	/* at this point onwards the AC97 component has probed and this will be valid */
	303	dev = snd_soc_dai_get_drvdata(dai);
	304
	305	dev->dmadata[0].stream = SNDRV_PCM_STREAM_PLAYBACK;
	306	dev->dmadata[1].stream = SNDRV_PCM_STREAM_CAPTURE;
	307	for (i = 0; i < 2; i++) {
	308	r = platform_get_resource(pdev, IORESOURCE_DMA, i);
	309	if (!r) {
	310	ret = -EBUSY;
	311	goto exit;
	312	}
	313	dev->dmadata[i].dma_res = r;
	314	ret = txx9aclc_dma_init(dev, &dev->dmadata[i]);
	315	if (ret)
	316	goto exit;
	317	}
e24805dd AN	318	return snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
e24805dd AN	319	card->dev, 64 * 1024, 4 * 1024 * 1024);
f0fba2ad LG	320
	321	exit:
	322	for (i = 0; i < 2; i++) {
	323	if (dev->dmadata[i].dma_chan)
	324	dma_release_channel(dev->dmadata[i].dma_chan);
	325	dev->dmadata[i].dma_chan = NULL;
	326	}
	327	return ret;
e24805dd AN	328	}
	329
	330	static bool filter(struct dma_chan chan, void param)
	331	{
	332	struct txx9aclc_dmadata *dmadata = param;
647613e9 AN	333	char *devname;
647613e9 AN	334	bool found = false;
e24805dd	335
647613e9	336	devname = kasprintf(GFP_KERNEL, "%s.%d", dmadata->dma_res->name,
e24805dd AN	337	(int)dmadata->dma_res->start);
	338	if (strcmp(dev_name(chan->device->dev), devname) == 0) {
	339	chan->private = &dmadata->dma_slave;
647613e9	340	found = true;
e24805dd	341	}
647613e9 AN	342	kfree(devname);
647613e9 AN	343	return found;
e24805dd AN	344	}
	345
	346	static int txx9aclc_dma_init(struct txx9aclc_soc_device *dev,
	347	struct txx9aclc_dmadata *dmadata)
	348	{
f0fba2ad	349	struct txx9aclc_plat_drvdata *drvdata =txx9aclc_drvdata;
e24805dd AN	350	struct txx9dmac_slave *ds = &dmadata->dma_slave;
	351	dma_cap_mask_t mask;
	352
	353	spin_lock_init(&dmadata->dma_lock);
	354
	355	ds->reg_width = sizeof(u32);
	356	if (dmadata->stream == SNDRV_PCM_STREAM_PLAYBACK) {
	357	ds->tx_reg = drvdata->physbase + ACAUDODAT;
	358	ds->rx_reg = 0;
	359	} else {
	360	ds->tx_reg = 0;
	361	ds->rx_reg = drvdata->physbase + ACAUDIDAT;
	362	}
	363
	364	/* Try to grab a DMA channel */
	365	dma_cap_zero(mask);
	366	dma_cap_set(DMA_SLAVE, mask);
	367	dmadata->dma_chan = dma_request_channel(mask, filter, dmadata);
	368	if (!dmadata->dma_chan) {
f0fba2ad	369	printk(KERN_ERR
e24805dd AN	370	"DMA channel for %s is not available\n",
	371	dmadata->stream == SNDRV_PCM_STREAM_PLAYBACK ?
	372	"playback" : "capture");
	373	return -EBUSY;
	374	}
	375	tasklet_init(&dmadata->tasklet, txx9aclc_dma_tasklet,
	376	(unsigned long)dmadata);
	377	return 0;
	378	}
	379
f0fba2ad	380	static int txx9aclc_pcm_probe(struct snd_soc_platform *platform)
e24805dd	381	{
f0fba2ad	382	snd_soc_platform_set_drvdata(platform, &txx9aclc_soc_device);
e24805dd	383	return 0;
e24805dd AN	384	}
e24805dd AN	385
f0fba2ad	386	static int txx9aclc_pcm_remove(struct snd_soc_platform *platform)
e24805dd	387	{
f0fba2ad LG	388	struct txx9aclc_soc_device *dev = snd_soc_platform_get_drvdata(platform);
f0fba2ad LG	389	struct txx9aclc_plat_drvdata *drvdata = txx9aclc_drvdata;
e24805dd AN	390	void __iomem *base = drvdata->base;
	391	int i;
	392
	393	/* disable all FIFO DMAs */
	394	__raw_writel(ACCTL_AUDODMA \| ACCTL_AUDIDMA, base + ACCTLDIS);
	395	/* dummy R/W to clear pending DMAREQ if any */
	396	__raw_writel(__raw_readl(base + ACAUDIDAT), base + ACAUDODAT);
	397
	398	for (i = 0; i < 2; i++) {
	399	struct txx9aclc_dmadata *dmadata = &dev->dmadata[i];
	400	struct dma_chan *chan = dmadata->dma_chan;
	401	if (chan) {
	402	dmadata->frag_count = -1;
05827630 LW	403	chan->device->device_control(chan,
05827630 LW	404	DMA_TERMINATE_ALL, 0);
e24805dd AN	405	dma_release_channel(chan);
	406	}
	407	dev->dmadata[i].dma_chan = NULL;
	408	}
	409	return 0;
	410	}
	411
f0fba2ad	412	static struct snd_soc_platform_driver txx9aclc_soc_platform = {
e24805dd AN	413	.probe = txx9aclc_pcm_probe,
e24805dd AN	414	.remove = txx9aclc_pcm_remove,
f0fba2ad	415	.ops = &txx9aclc_pcm_ops,
e24805dd AN	416	.pcm_new = txx9aclc_pcm_new,
	417	.pcm_free = txx9aclc_pcm_free_dma_buffers,
	418	};
e24805dd	419
f0fba2ad	420	static int __devinit txx9aclc_soc_platform_probe(struct platform_device *pdev)
e24805dd	421	{
f0fba2ad	422	return snd_soc_register_platform(&pdev->dev, &txx9aclc_soc_platform);
e24805dd AN	423	}
e24805dd AN	424
f0fba2ad	425	static int __devexit txx9aclc_soc_platform_remove(struct platform_device *pdev)
e24805dd	426	{
f0fba2ad LG	427	snd_soc_unregister_platform(&pdev->dev);
f0fba2ad LG	428	return 0;
e24805dd AN	429	}
e24805dd AN	430
f0fba2ad LG	431	static struct platform_driver txx9aclc_pcm_driver = {
	432	.driver = {
	433	.name = "txx9aclc-pcm-audio",
	434	.owner = THIS_MODULE,
	435	},
	436
	437	.probe = txx9aclc_soc_platform_probe,
	438	.remove = __devexit_p(txx9aclc_soc_platform_remove),
	439	};
	440
33d316cd	441	module_platform_driver(txx9aclc_pcm_driver);
e24805dd AN	442
	443	MODULE_AUTHOR("Atsushi Nemoto <anemo@mba.ocn.ne.jp>");
	444	MODULE_DESCRIPTION("TXx9 ACLC Audio DMA driver");
	445	MODULE_LICENSE("GPL");