[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 <linux/dmaengine.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,
	.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--;
		if (!WARN_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;
	dmaengine_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);
		dmaengine_terminate_all(chan);
		/* 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;
		dma_async_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;
	}
	if (WARN_ON(dmadata->dmacount >= NR_DMA_CHAIN)) {
		spin_unlock_irqrestore(&dmadata->dma_lock, flags);
		return;
	}
	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;
		dma_async_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;
	dmaengine_terminate_all(chan);
	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 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(rtd->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;
			dmaengine_terminate_all(chan);
			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,
};

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

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

	.probe = txx9aclc_soc_platform_probe,
};

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