Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux

MIPS: jz4740: Remove custom DMA API

Now that all users of the custom jz4740 DMA API have been converted to use
the dmaengine API instead we can remove the custom API and move all the code
talking to the hardware to the dmaengine driver.

Signed-off-by: Lars-Peter Clausen <lars@metafoo.de>
Acked-by: Ralf Baechle <ralf@linux-mips.org>
Signed-off-by: Vinod Koul <vinod.koul@intel.com>

authored by

Lars-Peter Clausen and committed by
Vinod Koul
25ce6c35 cdcb90ad

+222 -401
-56
arch/mips/include/asm/mach-jz4740/dma.h
··· 16 16 #ifndef __ASM_MACH_JZ4740_DMA_H__ 17 17 #define __ASM_MACH_JZ4740_DMA_H__ 18 18 19 - struct jz4740_dma_chan; 20 - 21 19 enum jz4740_dma_request_type { 22 20 JZ4740_DMA_TYPE_AUTO_REQUEST = 8, 23 21 JZ4740_DMA_TYPE_UART_TRANSMIT = 20, ··· 30 32 JZ4740_DMA_TYPE_SADC = 29, 31 33 JZ4740_DMA_TYPE_SLCD = 30, 32 34 }; 33 - 34 - enum jz4740_dma_width { 35 - JZ4740_DMA_WIDTH_32BIT = 0, 36 - JZ4740_DMA_WIDTH_8BIT = 1, 37 - JZ4740_DMA_WIDTH_16BIT = 2, 38 - }; 39 - 40 - enum jz4740_dma_transfer_size { 41 - JZ4740_DMA_TRANSFER_SIZE_4BYTE = 0, 42 - JZ4740_DMA_TRANSFER_SIZE_1BYTE = 1, 43 - JZ4740_DMA_TRANSFER_SIZE_2BYTE = 2, 44 - JZ4740_DMA_TRANSFER_SIZE_16BYTE = 3, 45 - JZ4740_DMA_TRANSFER_SIZE_32BYTE = 4, 46 - }; 47 - 48 - enum jz4740_dma_flags { 49 - JZ4740_DMA_SRC_AUTOINC = 0x2, 50 - JZ4740_DMA_DST_AUTOINC = 0x1, 51 - }; 52 - 53 - enum jz4740_dma_mode { 54 - JZ4740_DMA_MODE_SINGLE = 0, 55 - JZ4740_DMA_MODE_BLOCK = 1, 56 - }; 57 - 58 - struct jz4740_dma_config { 59 - enum jz4740_dma_width src_width; 60 - enum jz4740_dma_width dst_width; 61 - enum jz4740_dma_transfer_size transfer_size; 62 - enum jz4740_dma_request_type request_type; 63 - enum jz4740_dma_flags flags; 64 - enum jz4740_dma_mode mode; 65 - }; 66 - 67 - typedef void (*jz4740_dma_complete_callback_t)(struct jz4740_dma_chan *, int, void *); 68 - 69 - struct jz4740_dma_chan *jz4740_dma_request(void *dev, const char *name); 70 - void jz4740_dma_free(struct jz4740_dma_chan *dma); 71 - 72 - void jz4740_dma_configure(struct jz4740_dma_chan *dma, 73 - const struct jz4740_dma_config *config); 74 - 75 - 76 - void jz4740_dma_enable(struct jz4740_dma_chan *dma); 77 - void jz4740_dma_disable(struct jz4740_dma_chan *dma); 78 - 79 - void jz4740_dma_set_src_addr(struct jz4740_dma_chan *dma, dma_addr_t src); 80 - void jz4740_dma_set_dst_addr(struct jz4740_dma_chan *dma, dma_addr_t dst); 81 - void jz4740_dma_set_transfer_count(struct jz4740_dma_chan *dma, uint32_t count); 82 - 83 - uint32_t jz4740_dma_get_residue(const struct jz4740_dma_chan *dma); 84 - 85 - void jz4740_dma_set_complete_cb(struct jz4740_dma_chan *dma, 86 - jz4740_dma_complete_callback_t cb); 87 35 88 36 #endif /* __ASM_JZ4740_DMA_H__ */
+1 -1
arch/mips/jz4740/Makefile
··· 4 4 5 5 # Object file lists. 6 6 7 - obj-y += prom.o irq.o time.o reset.o setup.o dma.o \ 7 + obj-y += prom.o irq.o time.o reset.o setup.o \ 8 8 gpio.o clock.o platform.o timer.o serial.o 9 9 10 10 obj-$(CONFIG_DEBUG_FS) += clock-debugfs.o
-307
arch/mips/jz4740/dma.c
··· 1 - /* 2 - * Copyright (C) 2010, Lars-Peter Clausen <lars@metafoo.de> 3 - * JZ4740 SoC DMA support 4 - * 5 - * This program is free software; you can redistribute it and/or modify it 6 - * under the terms of the GNU General Public License as published by the 7 - * Free Software Foundation; either version 2 of the License, or (at your 8 - * option) any later version. 9 - * 10 - * You should have received a copy of the GNU General Public License along 11 - * with this program; if not, write to the Free Software Foundation, Inc., 12 - * 675 Mass Ave, Cambridge, MA 02139, USA. 13 - * 14 - */ 15 - 16 - #include <linux/kernel.h> 17 - #include <linux/module.h> 18 - #include <linux/spinlock.h> 19 - #include <linux/clk.h> 20 - #include <linux/interrupt.h> 21 - 22 - #include <linux/dma-mapping.h> 23 - #include <asm/mach-jz4740/dma.h> 24 - #include <asm/mach-jz4740/base.h> 25 - 26 - #define JZ_REG_DMA_SRC_ADDR(x) (0x00 + (x) * 0x20) 27 - #define JZ_REG_DMA_DST_ADDR(x) (0x04 + (x) * 0x20) 28 - #define JZ_REG_DMA_TRANSFER_COUNT(x) (0x08 + (x) * 0x20) 29 - #define JZ_REG_DMA_REQ_TYPE(x) (0x0C + (x) * 0x20) 30 - #define JZ_REG_DMA_STATUS_CTRL(x) (0x10 + (x) * 0x20) 31 - #define JZ_REG_DMA_CMD(x) (0x14 + (x) * 0x20) 32 - #define JZ_REG_DMA_DESC_ADDR(x) (0x18 + (x) * 0x20) 33 - 34 - #define JZ_REG_DMA_CTRL 0x300 35 - #define JZ_REG_DMA_IRQ 0x304 36 - #define JZ_REG_DMA_DOORBELL 0x308 37 - #define JZ_REG_DMA_DOORBELL_SET 0x30C 38 - 39 - #define JZ_DMA_STATUS_CTRL_NO_DESC BIT(31) 40 - #define JZ_DMA_STATUS_CTRL_DESC_INV BIT(6) 41 - #define JZ_DMA_STATUS_CTRL_ADDR_ERR BIT(4) 42 - #define JZ_DMA_STATUS_CTRL_TRANSFER_DONE BIT(3) 43 - #define JZ_DMA_STATUS_CTRL_HALT BIT(2) 44 - #define JZ_DMA_STATUS_CTRL_COUNT_TERMINATE BIT(1) 45 - #define JZ_DMA_STATUS_CTRL_ENABLE BIT(0) 46 - 47 - #define JZ_DMA_CMD_SRC_INC BIT(23) 48 - #define JZ_DMA_CMD_DST_INC BIT(22) 49 - #define JZ_DMA_CMD_RDIL_MASK (0xf << 16) 50 - #define JZ_DMA_CMD_SRC_WIDTH_MASK (0x3 << 14) 51 - #define JZ_DMA_CMD_DST_WIDTH_MASK (0x3 << 12) 52 - #define JZ_DMA_CMD_INTERVAL_LENGTH_MASK (0x7 << 8) 53 - #define JZ_DMA_CMD_BLOCK_MODE BIT(7) 54 - #define JZ_DMA_CMD_DESC_VALID BIT(4) 55 - #define JZ_DMA_CMD_DESC_VALID_MODE BIT(3) 56 - #define JZ_DMA_CMD_VALID_IRQ_ENABLE BIT(2) 57 - #define JZ_DMA_CMD_TRANSFER_IRQ_ENABLE BIT(1) 58 - #define JZ_DMA_CMD_LINK_ENABLE BIT(0) 59 - 60 - #define JZ_DMA_CMD_FLAGS_OFFSET 22 61 - #define JZ_DMA_CMD_RDIL_OFFSET 16 62 - #define JZ_DMA_CMD_SRC_WIDTH_OFFSET 14 63 - #define JZ_DMA_CMD_DST_WIDTH_OFFSET 12 64 - #define JZ_DMA_CMD_TRANSFER_SIZE_OFFSET 8 65 - #define JZ_DMA_CMD_MODE_OFFSET 7 66 - 67 - #define JZ_DMA_CTRL_PRIORITY_MASK (0x3 << 8) 68 - #define JZ_DMA_CTRL_HALT BIT(3) 69 - #define JZ_DMA_CTRL_ADDRESS_ERROR BIT(2) 70 - #define JZ_DMA_CTRL_ENABLE BIT(0) 71 - 72 - 73 - static void __iomem *jz4740_dma_base; 74 - static spinlock_t jz4740_dma_lock; 75 - 76 - static inline uint32_t jz4740_dma_read(size_t reg) 77 - { 78 - return readl(jz4740_dma_base + reg); 79 - } 80 - 81 - static inline void jz4740_dma_write(size_t reg, uint32_t val) 82 - { 83 - writel(val, jz4740_dma_base + reg); 84 - } 85 - 86 - static inline void jz4740_dma_write_mask(size_t reg, uint32_t val, uint32_t mask) 87 - { 88 - uint32_t val2; 89 - val2 = jz4740_dma_read(reg); 90 - val2 &= ~mask; 91 - val2 |= val; 92 - jz4740_dma_write(reg, val2); 93 - } 94 - 95 - struct jz4740_dma_chan { 96 - unsigned int id; 97 - void *dev; 98 - const char *name; 99 - 100 - enum jz4740_dma_flags flags; 101 - uint32_t transfer_shift; 102 - 103 - jz4740_dma_complete_callback_t complete_cb; 104 - 105 - unsigned used:1; 106 - }; 107 - 108 - #define JZ4740_DMA_CHANNEL(_id) { .id = _id } 109 - 110 - struct jz4740_dma_chan jz4740_dma_channels[] = { 111 - JZ4740_DMA_CHANNEL(0), 112 - JZ4740_DMA_CHANNEL(1), 113 - JZ4740_DMA_CHANNEL(2), 114 - JZ4740_DMA_CHANNEL(3), 115 - JZ4740_DMA_CHANNEL(4), 116 - JZ4740_DMA_CHANNEL(5), 117 - }; 118 - 119 - struct jz4740_dma_chan *jz4740_dma_request(void *dev, const char *name) 120 - { 121 - unsigned int i; 122 - struct jz4740_dma_chan *dma = NULL; 123 - 124 - spin_lock(&jz4740_dma_lock); 125 - 126 - for (i = 0; i < ARRAY_SIZE(jz4740_dma_channels); ++i) { 127 - if (!jz4740_dma_channels[i].used) { 128 - dma = &jz4740_dma_channels[i]; 129 - dma->used = 1; 130 - break; 131 - } 132 - } 133 - 134 - spin_unlock(&jz4740_dma_lock); 135 - 136 - if (!dma) 137 - return NULL; 138 - 139 - dma->dev = dev; 140 - dma->name = name; 141 - 142 - return dma; 143 - } 144 - EXPORT_SYMBOL_GPL(jz4740_dma_request); 145 - 146 - void jz4740_dma_configure(struct jz4740_dma_chan *dma, 147 - const struct jz4740_dma_config *config) 148 - { 149 - uint32_t cmd; 150 - 151 - switch (config->transfer_size) { 152 - case JZ4740_DMA_TRANSFER_SIZE_2BYTE: 153 - dma->transfer_shift = 1; 154 - break; 155 - case JZ4740_DMA_TRANSFER_SIZE_4BYTE: 156 - dma->transfer_shift = 2; 157 - break; 158 - case JZ4740_DMA_TRANSFER_SIZE_16BYTE: 159 - dma->transfer_shift = 4; 160 - break; 161 - case JZ4740_DMA_TRANSFER_SIZE_32BYTE: 162 - dma->transfer_shift = 5; 163 - break; 164 - default: 165 - dma->transfer_shift = 0; 166 - break; 167 - } 168 - 169 - cmd = config->flags << JZ_DMA_CMD_FLAGS_OFFSET; 170 - cmd |= config->src_width << JZ_DMA_CMD_SRC_WIDTH_OFFSET; 171 - cmd |= config->dst_width << JZ_DMA_CMD_DST_WIDTH_OFFSET; 172 - cmd |= config->transfer_size << JZ_DMA_CMD_TRANSFER_SIZE_OFFSET; 173 - cmd |= config->mode << JZ_DMA_CMD_MODE_OFFSET; 174 - cmd |= JZ_DMA_CMD_TRANSFER_IRQ_ENABLE; 175 - 176 - jz4740_dma_write(JZ_REG_DMA_CMD(dma->id), cmd); 177 - jz4740_dma_write(JZ_REG_DMA_STATUS_CTRL(dma->id), 0); 178 - jz4740_dma_write(JZ_REG_DMA_REQ_TYPE(dma->id), config->request_type); 179 - } 180 - EXPORT_SYMBOL_GPL(jz4740_dma_configure); 181 - 182 - void jz4740_dma_set_src_addr(struct jz4740_dma_chan *dma, dma_addr_t src) 183 - { 184 - jz4740_dma_write(JZ_REG_DMA_SRC_ADDR(dma->id), src); 185 - } 186 - EXPORT_SYMBOL_GPL(jz4740_dma_set_src_addr); 187 - 188 - void jz4740_dma_set_dst_addr(struct jz4740_dma_chan *dma, dma_addr_t dst) 189 - { 190 - jz4740_dma_write(JZ_REG_DMA_DST_ADDR(dma->id), dst); 191 - } 192 - EXPORT_SYMBOL_GPL(jz4740_dma_set_dst_addr); 193 - 194 - void jz4740_dma_set_transfer_count(struct jz4740_dma_chan *dma, uint32_t count) 195 - { 196 - count >>= dma->transfer_shift; 197 - jz4740_dma_write(JZ_REG_DMA_TRANSFER_COUNT(dma->id), count); 198 - } 199 - EXPORT_SYMBOL_GPL(jz4740_dma_set_transfer_count); 200 - 201 - void jz4740_dma_set_complete_cb(struct jz4740_dma_chan *dma, 202 - jz4740_dma_complete_callback_t cb) 203 - { 204 - dma->complete_cb = cb; 205 - } 206 - EXPORT_SYMBOL_GPL(jz4740_dma_set_complete_cb); 207 - 208 - void jz4740_dma_free(struct jz4740_dma_chan *dma) 209 - { 210 - dma->dev = NULL; 211 - dma->complete_cb = NULL; 212 - dma->used = 0; 213 - } 214 - EXPORT_SYMBOL_GPL(jz4740_dma_free); 215 - 216 - void jz4740_dma_enable(struct jz4740_dma_chan *dma) 217 - { 218 - jz4740_dma_write_mask(JZ_REG_DMA_STATUS_CTRL(dma->id), 219 - JZ_DMA_STATUS_CTRL_NO_DESC | JZ_DMA_STATUS_CTRL_ENABLE, 220 - JZ_DMA_STATUS_CTRL_HALT | JZ_DMA_STATUS_CTRL_NO_DESC | 221 - JZ_DMA_STATUS_CTRL_ENABLE); 222 - 223 - jz4740_dma_write_mask(JZ_REG_DMA_CTRL, 224 - JZ_DMA_CTRL_ENABLE, 225 - JZ_DMA_CTRL_HALT | JZ_DMA_CTRL_ENABLE); 226 - } 227 - EXPORT_SYMBOL_GPL(jz4740_dma_enable); 228 - 229 - void jz4740_dma_disable(struct jz4740_dma_chan *dma) 230 - { 231 - jz4740_dma_write_mask(JZ_REG_DMA_STATUS_CTRL(dma->id), 0, 232 - JZ_DMA_STATUS_CTRL_ENABLE); 233 - } 234 - EXPORT_SYMBOL_GPL(jz4740_dma_disable); 235 - 236 - uint32_t jz4740_dma_get_residue(const struct jz4740_dma_chan *dma) 237 - { 238 - uint32_t residue; 239 - residue = jz4740_dma_read(JZ_REG_DMA_TRANSFER_COUNT(dma->id)); 240 - return residue << dma->transfer_shift; 241 - } 242 - EXPORT_SYMBOL_GPL(jz4740_dma_get_residue); 243 - 244 - static void jz4740_dma_chan_irq(struct jz4740_dma_chan *dma) 245 - { 246 - (void) jz4740_dma_read(JZ_REG_DMA_STATUS_CTRL(dma->id)); 247 - 248 - jz4740_dma_write_mask(JZ_REG_DMA_STATUS_CTRL(dma->id), 0, 249 - JZ_DMA_STATUS_CTRL_ENABLE | JZ_DMA_STATUS_CTRL_TRANSFER_DONE); 250 - 251 - if (dma->complete_cb) 252 - dma->complete_cb(dma, 0, dma->dev); 253 - } 254 - 255 - static irqreturn_t jz4740_dma_irq(int irq, void *dev_id) 256 - { 257 - uint32_t irq_status; 258 - unsigned int i; 259 - 260 - irq_status = readl(jz4740_dma_base + JZ_REG_DMA_IRQ); 261 - 262 - for (i = 0; i < 6; ++i) { 263 - if (irq_status & (1 << i)) 264 - jz4740_dma_chan_irq(&jz4740_dma_channels[i]); 265 - } 266 - 267 - return IRQ_HANDLED; 268 - } 269 - 270 - static int jz4740_dma_init(void) 271 - { 272 - struct clk *clk; 273 - unsigned int ret; 274 - 275 - jz4740_dma_base = ioremap(JZ4740_DMAC_BASE_ADDR, 0x400); 276 - 277 - if (!jz4740_dma_base) 278 - return -EBUSY; 279 - 280 - spin_lock_init(&jz4740_dma_lock); 281 - 282 - clk = clk_get(NULL, "dma"); 283 - if (IS_ERR(clk)) { 284 - ret = PTR_ERR(clk); 285 - printk(KERN_ERR "JZ4740 DMA: Failed to request clock: %d\n", 286 - ret); 287 - goto err_iounmap; 288 - } 289 - 290 - ret = request_irq(JZ4740_IRQ_DMAC, jz4740_dma_irq, 0, "DMA", NULL); 291 - if (ret) { 292 - printk(KERN_ERR "JZ4740 DMA: Failed to request irq: %d\n", ret); 293 - goto err_clkput; 294 - } 295 - 296 - clk_prepare_enable(clk); 297 - 298 - return 0; 299 - 300 - err_clkput: 301 - clk_put(clk); 302 - 303 - err_iounmap: 304 - iounmap(jz4740_dma_base); 305 - return ret; 306 - } 307 - arch_initcall(jz4740_dma_init);
+221 -37
drivers/dma/dma-jz4740.c
··· 22 22 #include <linux/platform_device.h> 23 23 #include <linux/slab.h> 24 24 #include <linux/spinlock.h> 25 + #include <linux/irq.h> 26 + #include <linux/clk.h> 25 27 26 28 #include <asm/mach-jz4740/dma.h> 27 29 28 30 #include "virt-dma.h" 29 31 30 32 #define JZ_DMA_NR_CHANS 6 33 + 34 + #define JZ_REG_DMA_SRC_ADDR(x) (0x00 + (x) * 0x20) 35 + #define JZ_REG_DMA_DST_ADDR(x) (0x04 + (x) * 0x20) 36 + #define JZ_REG_DMA_TRANSFER_COUNT(x) (0x08 + (x) * 0x20) 37 + #define JZ_REG_DMA_REQ_TYPE(x) (0x0C + (x) * 0x20) 38 + #define JZ_REG_DMA_STATUS_CTRL(x) (0x10 + (x) * 0x20) 39 + #define JZ_REG_DMA_CMD(x) (0x14 + (x) * 0x20) 40 + #define JZ_REG_DMA_DESC_ADDR(x) (0x18 + (x) * 0x20) 41 + 42 + #define JZ_REG_DMA_CTRL 0x300 43 + #define JZ_REG_DMA_IRQ 0x304 44 + #define JZ_REG_DMA_DOORBELL 0x308 45 + #define JZ_REG_DMA_DOORBELL_SET 0x30C 46 + 47 + #define JZ_DMA_STATUS_CTRL_NO_DESC BIT(31) 48 + #define JZ_DMA_STATUS_CTRL_DESC_INV BIT(6) 49 + #define JZ_DMA_STATUS_CTRL_ADDR_ERR BIT(4) 50 + #define JZ_DMA_STATUS_CTRL_TRANSFER_DONE BIT(3) 51 + #define JZ_DMA_STATUS_CTRL_HALT BIT(2) 52 + #define JZ_DMA_STATUS_CTRL_COUNT_TERMINATE BIT(1) 53 + #define JZ_DMA_STATUS_CTRL_ENABLE BIT(0) 54 + 55 + #define JZ_DMA_CMD_SRC_INC BIT(23) 56 + #define JZ_DMA_CMD_DST_INC BIT(22) 57 + #define JZ_DMA_CMD_RDIL_MASK (0xf << 16) 58 + #define JZ_DMA_CMD_SRC_WIDTH_MASK (0x3 << 14) 59 + #define JZ_DMA_CMD_DST_WIDTH_MASK (0x3 << 12) 60 + #define JZ_DMA_CMD_INTERVAL_LENGTH_MASK (0x7 << 8) 61 + #define JZ_DMA_CMD_BLOCK_MODE BIT(7) 62 + #define JZ_DMA_CMD_DESC_VALID BIT(4) 63 + #define JZ_DMA_CMD_DESC_VALID_MODE BIT(3) 64 + #define JZ_DMA_CMD_VALID_IRQ_ENABLE BIT(2) 65 + #define JZ_DMA_CMD_TRANSFER_IRQ_ENABLE BIT(1) 66 + #define JZ_DMA_CMD_LINK_ENABLE BIT(0) 67 + 68 + #define JZ_DMA_CMD_FLAGS_OFFSET 22 69 + #define JZ_DMA_CMD_RDIL_OFFSET 16 70 + #define JZ_DMA_CMD_SRC_WIDTH_OFFSET 14 71 + #define JZ_DMA_CMD_DST_WIDTH_OFFSET 12 72 + #define JZ_DMA_CMD_TRANSFER_SIZE_OFFSET 8 73 + #define JZ_DMA_CMD_MODE_OFFSET 7 74 + 75 + #define JZ_DMA_CTRL_PRIORITY_MASK (0x3 << 8) 76 + #define JZ_DMA_CTRL_HALT BIT(3) 77 + #define JZ_DMA_CTRL_ADDRESS_ERROR BIT(2) 78 + #define JZ_DMA_CTRL_ENABLE BIT(0) 79 + 80 + enum jz4740_dma_width { 81 + JZ4740_DMA_WIDTH_32BIT = 0, 82 + JZ4740_DMA_WIDTH_8BIT = 1, 83 + JZ4740_DMA_WIDTH_16BIT = 2, 84 + }; 85 + 86 + enum jz4740_dma_transfer_size { 87 + JZ4740_DMA_TRANSFER_SIZE_4BYTE = 0, 88 + JZ4740_DMA_TRANSFER_SIZE_1BYTE = 1, 89 + JZ4740_DMA_TRANSFER_SIZE_2BYTE = 2, 90 + JZ4740_DMA_TRANSFER_SIZE_16BYTE = 3, 91 + JZ4740_DMA_TRANSFER_SIZE_32BYTE = 4, 92 + }; 93 + 94 + enum jz4740_dma_flags { 95 + JZ4740_DMA_SRC_AUTOINC = 0x2, 96 + JZ4740_DMA_DST_AUTOINC = 0x1, 97 + }; 98 + 99 + enum jz4740_dma_mode { 100 + JZ4740_DMA_MODE_SINGLE = 0, 101 + JZ4740_DMA_MODE_BLOCK = 1, 102 + }; 31 103 32 104 struct jz4740_dma_sg { 33 105 dma_addr_t addr; ··· 118 46 119 47 struct jz4740_dmaengine_chan { 120 48 struct virt_dma_chan vchan; 121 - struct jz4740_dma_chan *jz_chan; 49 + unsigned int id; 122 50 123 51 dma_addr_t fifo_addr; 52 + unsigned int transfer_shift; 124 53 125 54 struct jz4740_dma_desc *desc; 126 55 unsigned int next_sg; ··· 129 56 130 57 struct jz4740_dma_dev { 131 58 struct dma_device ddev; 59 + void __iomem *base; 60 + struct clk *clk; 132 61 133 62 struct jz4740_dmaengine_chan chan[JZ_DMA_NR_CHANS]; 134 63 }; 64 + 65 + static struct jz4740_dma_dev *jz4740_dma_chan_get_dev( 66 + struct jz4740_dmaengine_chan *chan) 67 + { 68 + return container_of(chan->vchan.chan.device, struct jz4740_dma_dev, 69 + ddev); 70 + } 135 71 136 72 static struct jz4740_dmaengine_chan *to_jz4740_dma_chan(struct dma_chan *c) 137 73 { ··· 150 68 static struct jz4740_dma_desc *to_jz4740_dma_desc(struct virt_dma_desc *vdesc) 151 69 { 152 70 return container_of(vdesc, struct jz4740_dma_desc, vdesc); 71 + } 72 + 73 + static inline uint32_t jz4740_dma_read(struct jz4740_dma_dev *dmadev, 74 + unsigned int reg) 75 + { 76 + return readl(dmadev->base + reg); 77 + } 78 + 79 + static inline void jz4740_dma_write(struct jz4740_dma_dev *dmadev, 80 + unsigned reg, uint32_t val) 81 + { 82 + writel(val, dmadev->base + reg); 83 + } 84 + 85 + static inline void jz4740_dma_write_mask(struct jz4740_dma_dev *dmadev, 86 + unsigned int reg, uint32_t val, uint32_t mask) 87 + { 88 + uint32_t tmp; 89 + 90 + tmp = jz4740_dma_read(dmadev, reg); 91 + tmp &= ~mask; 92 + tmp |= val; 93 + jz4740_dma_write(dmadev, reg, tmp); 153 94 } 154 95 155 96 static struct jz4740_dma_desc *jz4740_dma_alloc_desc(unsigned int num_sgs) ··· 213 108 const struct dma_slave_config *config) 214 109 { 215 110 struct jz4740_dmaengine_chan *chan = to_jz4740_dma_chan(c); 216 - struct jz4740_dma_config jzcfg; 111 + struct jz4740_dma_dev *dmadev = jz4740_dma_chan_get_dev(chan); 112 + enum jz4740_dma_width src_width; 113 + enum jz4740_dma_width dst_width; 114 + enum jz4740_dma_transfer_size transfer_size; 115 + enum jz4740_dma_flags flags; 116 + uint32_t cmd; 217 117 218 118 switch (config->direction) { 219 119 case DMA_MEM_TO_DEV: 220 - jzcfg.flags = JZ4740_DMA_SRC_AUTOINC; 221 - jzcfg.transfer_size = jz4740_dma_maxburst(config->dst_maxburst); 120 + flags = JZ4740_DMA_SRC_AUTOINC; 121 + transfer_size = jz4740_dma_maxburst(config->dst_maxburst); 222 122 chan->fifo_addr = config->dst_addr; 223 123 break; 224 124 case DMA_DEV_TO_MEM: 225 - jzcfg.flags = JZ4740_DMA_DST_AUTOINC; 226 - jzcfg.transfer_size = jz4740_dma_maxburst(config->src_maxburst); 125 + flags = JZ4740_DMA_DST_AUTOINC; 126 + transfer_size = jz4740_dma_maxburst(config->src_maxburst); 227 127 chan->fifo_addr = config->src_addr; 228 128 break; 229 129 default: 230 130 return -EINVAL; 231 131 } 232 132 133 + src_width = jz4740_dma_width(config->src_addr_width); 134 + dst_width = jz4740_dma_width(config->dst_addr_width); 233 135 234 - jzcfg.src_width = jz4740_dma_width(config->src_addr_width); 235 - jzcfg.dst_width = jz4740_dma_width(config->dst_addr_width); 236 - jzcfg.mode = JZ4740_DMA_MODE_SINGLE; 237 - jzcfg.request_type = config->slave_id; 136 + switch (transfer_size) { 137 + case JZ4740_DMA_TRANSFER_SIZE_2BYTE: 138 + chan->transfer_shift = 1; 139 + break; 140 + case JZ4740_DMA_TRANSFER_SIZE_4BYTE: 141 + chan->transfer_shift = 2; 142 + break; 143 + case JZ4740_DMA_TRANSFER_SIZE_16BYTE: 144 + chan->transfer_shift = 4; 145 + break; 146 + case JZ4740_DMA_TRANSFER_SIZE_32BYTE: 147 + chan->transfer_shift = 5; 148 + break; 149 + default: 150 + chan->transfer_shift = 0; 151 + break; 152 + } 238 153 239 - jz4740_dma_configure(chan->jz_chan, &jzcfg); 154 + cmd = flags << JZ_DMA_CMD_FLAGS_OFFSET; 155 + cmd |= src_width << JZ_DMA_CMD_SRC_WIDTH_OFFSET; 156 + cmd |= dst_width << JZ_DMA_CMD_DST_WIDTH_OFFSET; 157 + cmd |= transfer_size << JZ_DMA_CMD_TRANSFER_SIZE_OFFSET; 158 + cmd |= JZ4740_DMA_MODE_SINGLE << JZ_DMA_CMD_MODE_OFFSET; 159 + cmd |= JZ_DMA_CMD_TRANSFER_IRQ_ENABLE; 160 + 161 + jz4740_dma_write(dmadev, JZ_REG_DMA_CMD(chan->id), cmd); 162 + jz4740_dma_write(dmadev, JZ_REG_DMA_STATUS_CTRL(chan->id), 0); 163 + jz4740_dma_write(dmadev, JZ_REG_DMA_REQ_TYPE(chan->id), 164 + config->slave_id); 240 165 241 166 return 0; 242 167 } ··· 274 139 static int jz4740_dma_terminate_all(struct dma_chan *c) 275 140 { 276 141 struct jz4740_dmaengine_chan *chan = to_jz4740_dma_chan(c); 142 + struct jz4740_dma_dev *dmadev = jz4740_dma_chan_get_dev(chan); 277 143 unsigned long flags; 278 144 LIST_HEAD(head); 279 145 280 146 spin_lock_irqsave(&chan->vchan.lock, flags); 281 - jz4740_dma_disable(chan->jz_chan); 147 + jz4740_dma_write_mask(dmadev, JZ_REG_DMA_STATUS_CTRL(chan->id), 0, 148 + JZ_DMA_STATUS_CTRL_ENABLE); 282 149 chan->desc = NULL; 283 150 vchan_get_all_descriptors(&chan->vchan, &head); 284 151 spin_unlock_irqrestore(&chan->vchan.lock, flags); ··· 307 170 308 171 static int jz4740_dma_start_transfer(struct jz4740_dmaengine_chan *chan) 309 172 { 173 + struct jz4740_dma_dev *dmadev = jz4740_dma_chan_get_dev(chan); 310 174 dma_addr_t src_addr, dst_addr; 311 175 struct virt_dma_desc *vdesc; 312 176 struct jz4740_dma_sg *sg; 313 177 314 - jz4740_dma_disable(chan->jz_chan); 178 + jz4740_dma_write_mask(dmadev, JZ_REG_DMA_STATUS_CTRL(chan->id), 0, 179 + JZ_DMA_STATUS_CTRL_ENABLE); 315 180 316 181 if (!chan->desc) { 317 182 vdesc = vchan_next_desc(&chan->vchan); ··· 335 196 src_addr = chan->fifo_addr; 336 197 dst_addr = sg->addr; 337 198 } 338 - jz4740_dma_set_src_addr(chan->jz_chan, src_addr); 339 - jz4740_dma_set_dst_addr(chan->jz_chan, dst_addr); 340 - jz4740_dma_set_transfer_count(chan->jz_chan, sg->len); 199 + jz4740_dma_write(dmadev, JZ_REG_DMA_SRC_ADDR(chan->id), src_addr); 200 + jz4740_dma_write(dmadev, JZ_REG_DMA_DST_ADDR(chan->id), dst_addr); 201 + jz4740_dma_write(dmadev, JZ_REG_DMA_TRANSFER_COUNT(chan->id), 202 + sg->len >> chan->transfer_shift); 341 203 342 204 chan->next_sg++; 343 205 344 - jz4740_dma_enable(chan->jz_chan); 206 + jz4740_dma_write_mask(dmadev, JZ_REG_DMA_STATUS_CTRL(chan->id), 207 + JZ_DMA_STATUS_CTRL_NO_DESC | JZ_DMA_STATUS_CTRL_ENABLE, 208 + JZ_DMA_STATUS_CTRL_HALT | JZ_DMA_STATUS_CTRL_NO_DESC | 209 + JZ_DMA_STATUS_CTRL_ENABLE); 210 + 211 + jz4740_dma_write_mask(dmadev, JZ_REG_DMA_CTRL, 212 + JZ_DMA_CTRL_ENABLE, 213 + JZ_DMA_CTRL_HALT | JZ_DMA_CTRL_ENABLE); 345 214 346 215 return 0; 347 216 } 348 217 349 - static void jz4740_dma_complete_cb(struct jz4740_dma_chan *jz_chan, int error, 350 - void *devid) 218 + static void jz4740_dma_chan_irq(struct jz4740_dmaengine_chan *chan) 351 219 { 352 - struct jz4740_dmaengine_chan *chan = devid; 353 - 354 220 spin_lock(&chan->vchan.lock); 355 221 if (chan->desc) { 356 222 if (chan->desc && chan->desc->cyclic) { ··· 369 225 } 370 226 jz4740_dma_start_transfer(chan); 371 227 spin_unlock(&chan->vchan.lock); 228 + } 229 + 230 + static irqreturn_t jz4740_dma_irq(int irq, void *devid) 231 + { 232 + struct jz4740_dma_dev *dmadev = devid; 233 + uint32_t irq_status; 234 + unsigned int i; 235 + 236 + irq_status = readl(dmadev->base + JZ_REG_DMA_IRQ); 237 + 238 + for (i = 0; i < 6; ++i) { 239 + if (irq_status & (1 << i)) { 240 + jz4740_dma_write_mask(dmadev, 241 + JZ_REG_DMA_STATUS_CTRL(i), 0, 242 + JZ_DMA_STATUS_CTRL_ENABLE | 243 + JZ_DMA_STATUS_CTRL_TRANSFER_DONE); 244 + 245 + jz4740_dma_chan_irq(&dmadev->chan[i]); 246 + } 247 + } 248 + 249 + return IRQ_HANDLED; 372 250 } 373 251 374 252 static void jz4740_dma_issue_pending(struct dma_chan *c) ··· 464 298 static size_t jz4740_dma_desc_residue(struct jz4740_dmaengine_chan *chan, 465 299 struct jz4740_dma_desc *desc, unsigned int next_sg) 466 300 { 467 - size_t residue = 0; 301 + struct jz4740_dma_dev *dmadev = jz4740_dma_chan_get_dev(chan); 302 + unsigned int residue, count; 468 303 unsigned int i; 469 304 470 305 residue = 0; ··· 473 306 for (i = next_sg; i < desc->num_sgs; i++) 474 307 residue += desc->sg[i].len; 475 308 476 - if (next_sg != 0) 477 - residue += jz4740_dma_get_residue(chan->jz_chan); 309 + if (next_sg != 0) { 310 + count = jz4740_dma_read(dmadev, 311 + JZ_REG_DMA_TRANSFER_COUNT(chan->id)); 312 + residue += count << chan->transfer_shift; 313 + } 478 314 479 315 return residue; 480 316 } ··· 512 342 513 343 static int jz4740_dma_alloc_chan_resources(struct dma_chan *c) 514 344 { 515 - struct jz4740_dmaengine_chan *chan = to_jz4740_dma_chan(c); 516 - 517 - chan->jz_chan = jz4740_dma_request(chan, NULL); 518 - if (!chan->jz_chan) 519 - return -EBUSY; 520 - 521 - jz4740_dma_set_complete_cb(chan->jz_chan, jz4740_dma_complete_cb); 522 - 523 345 return 0; 524 346 } 525 347 526 348 static void jz4740_dma_free_chan_resources(struct dma_chan *c) 527 349 { 528 - struct jz4740_dmaengine_chan *chan = to_jz4740_dma_chan(c); 529 - 530 - vchan_free_chan_resources(&chan->vchan); 531 - jz4740_dma_free(chan->jz_chan); 532 - chan->jz_chan = NULL; 350 + vchan_free_chan_resources(to_virt_chan(c)); 533 351 } 534 352 535 353 static void jz4740_dma_desc_free(struct virt_dma_desc *vdesc) ··· 531 373 struct jz4740_dma_dev *dmadev; 532 374 struct dma_device *dd; 533 375 unsigned int i; 376 + struct resource *res; 534 377 int ret; 378 + int irq; 535 379 536 380 dmadev = devm_kzalloc(&pdev->dev, sizeof(*dmadev), GFP_KERNEL); 537 381 if (!dmadev) 538 382 return -EINVAL; 539 383 540 384 dd = &dmadev->ddev; 385 + 386 + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 387 + dmadev->base = devm_ioremap_resource(&pdev->dev, res); 388 + if (IS_ERR(dmadev->base)) 389 + return PTR_ERR(dmadev->base); 390 + 391 + dmadev->clk = clk_get(&pdev->dev, "dma"); 392 + if (IS_ERR(dmadev->clk)) 393 + return PTR_ERR(dmadev->clk); 394 + 395 + clk_prepare_enable(dmadev->clk); 541 396 542 397 dma_cap_set(DMA_SLAVE, dd->cap_mask); 543 398 dma_cap_set(DMA_CYCLIC, dd->cap_mask); ··· 567 396 568 397 for (i = 0; i < dd->chancnt; i++) { 569 398 chan = &dmadev->chan[i]; 399 + chan->id = i; 570 400 chan->vchan.desc_free = jz4740_dma_desc_free; 571 401 vchan_init(&chan->vchan, dd); 572 402 } ··· 576 404 if (ret) 577 405 return ret; 578 406 407 + irq = platform_get_irq(pdev, 0); 408 + ret = request_irq(irq, jz4740_dma_irq, 0, dev_name(&pdev->dev), dmadev); 409 + if (ret) 410 + goto err_unregister; 411 + 579 412 platform_set_drvdata(pdev, dmadev); 580 413 581 414 return 0; 415 + 416 + err_unregister: 417 + dma_async_device_unregister(dd); 418 + return ret; 582 419 } 583 420 584 421 static int jz4740_dma_remove(struct platform_device *pdev) 585 422 { 586 423 struct jz4740_dma_dev *dmadev = platform_get_drvdata(pdev); 424 + int irq = platform_get_irq(pdev, 0); 587 425 426 + free_irq(irq, dmadev); 588 427 dma_async_device_unregister(&dmadev->ddev); 428 + clk_disable_unprepare(dmadev->clk); 589 429 590 430 return 0; 591 431 }