dma-ops.c 3.6 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
/* linux/arch/arm/plat-samsung/dma-ops.c
 *
 * Copyright (c) 2011 Samsung Electronics Co., Ltd.
 *		http://www.samsung.com
 *
 * Samsung DMA Operations
 *
 * 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/kernel.h>
#include <linux/errno.h>
#include <linux/amba/pl330.h>
#include <linux/scatterlist.h>
17
#include <linux/export.h>
18 19 20 21

#include <mach/dma.h>

static unsigned samsung_dmadev_request(enum dma_ch dma_ch,
22
				struct samsung_dma_req *param)
23 24
{
	dma_cap_mask_t mask;
25
	void *filter_param;
26 27

	dma_cap_zero(mask);
28
	dma_cap_set(param->cap, mask);
29

30 31 32 33
	/*
	 * If a dma channel property of a device node from device tree is
	 * specified, use that as the fliter parameter.
	 */
34 35 36 37
	filter_param = (dma_ch == DMACH_DT_PROP) ?
		(void *)param->dt_dmach_prop : (void *)dma_ch;
	return (unsigned)dma_request_channel(mask, pl330_filter, filter_param);
}
38

39
static int samsung_dmadev_release(unsigned ch, void *param)
40 41 42 43 44 45 46 47 48 49 50 51 52
{
	dma_release_channel((struct dma_chan *)ch);

	return 0;
}

static int samsung_dmadev_config(unsigned ch,
				struct samsung_dma_config *param)
{
	struct dma_chan *chan = (struct dma_chan *)ch;
	struct dma_slave_config slave_config;

	if (param->direction == DMA_DEV_TO_MEM) {
53
		memset(&slave_config, 0, sizeof(struct dma_slave_config));
54 55 56
		slave_config.direction = param->direction;
		slave_config.src_addr = param->fifo;
		slave_config.src_addr_width = param->width;
57 58
		slave_config.src_maxburst = 1;
		dmaengine_slave_config(chan, &slave_config);
59
	} else if (param->direction == DMA_MEM_TO_DEV) {
60
		memset(&slave_config, 0, sizeof(struct dma_slave_config));
61 62 63
		slave_config.direction = param->direction;
		slave_config.dst_addr = param->fifo;
		slave_config.dst_addr_width = param->width;
64 65
		slave_config.dst_maxburst = 1;
		dmaengine_slave_config(chan, &slave_config);
66 67 68
	} else {
		pr_warn("unsupported direction\n");
		return -EINVAL;
69 70 71 72 73 74
	}

	return 0;
}

static int samsung_dmadev_prepare(unsigned ch,
75
			struct samsung_dma_prep *param)
76 77 78 79 80
{
	struct scatterlist sg;
	struct dma_chan *chan = (struct dma_chan *)ch;
	struct dma_async_tx_descriptor *desc;

81
	switch (param->cap) {
82 83
	case DMA_SLAVE:
		sg_init_table(&sg, 1);
84 85 86 87
		sg_dma_len(&sg) = param->len;
		sg_set_page(&sg, pfn_to_page(PFN_DOWN(param->buf)),
			    param->len, offset_in_page(param->buf));
		sg_dma_address(&sg) = param->buf;
88

89
		desc = dmaengine_prep_slave_sg(chan,
90
			&sg, 1, param->direction, DMA_PREP_INTERRUPT);
91 92
		break;
	case DMA_CYCLIC:
93
		desc = dmaengine_prep_dma_cyclic(chan, param->buf,
94 95
			param->len, param->period, param->direction,
			DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
96 97 98 99 100 101 102 103 104 105 106
		break;
	default:
		dev_err(&chan->dev->device, "unsupported format\n");
		return -EFAULT;
	}

	if (!desc) {
		dev_err(&chan->dev->device, "cannot prepare cyclic dma\n");
		return -EFAULT;
	}

107 108
	desc->callback = param->fp;
	desc->callback_param = param->fp_param;
109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126

	dmaengine_submit((struct dma_async_tx_descriptor *)desc);

	return 0;
}

static inline int samsung_dmadev_trigger(unsigned ch)
{
	dma_async_issue_pending((struct dma_chan *)ch);

	return 0;
}

static inline int samsung_dmadev_flush(unsigned ch)
{
	return dmaengine_terminate_all((struct dma_chan *)ch);
}

127
static struct samsung_dma_ops dmadev_ops = {
128 129
	.request	= samsung_dmadev_request,
	.release	= samsung_dmadev_release,
130
	.config		= samsung_dmadev_config,
131 132 133 134 135 136 137 138 139 140 141 142
	.prepare	= samsung_dmadev_prepare,
	.trigger	= samsung_dmadev_trigger,
	.started	= NULL,
	.flush		= samsung_dmadev_flush,
	.stop		= samsung_dmadev_flush,
};

void *samsung_dmadev_get_ops(void)
{
	return &dmadev_ops;
}
EXPORT_SYMBOL(samsung_dmadev_get_ops);