2 * bfin_dma_5xx.c - Blackfin DMA implementation
4 * Copyright 2004-2006 Analog Devices Inc.
5 * Licensed under the GPL-2 or later.
8 #include <linux/errno.h>
9 #include <linux/interrupt.h>
10 #include <linux/kernel.h>
11 #include <linux/module.h>
12 #include <linux/param.h>
13 #include <linux/proc_fs.h>
14 #include <linux/sched.h>
15 #include <linux/seq_file.h>
16 #include <linux/spinlock.h>
18 #include <asm/blackfin.h>
19 #include <asm/cacheflush.h>
21 #include <asm/uaccess.h>
23 /**************************************************************************
25 ***************************************************************************/
27 static struct dma_channel dma_ch
[MAX_DMA_CHANNELS
];
29 /*------------------------------------------------------------------------------
30 * Set the Buffer Clear bit in the Configuration register of specific DMA
31 * channel. This will stop the descriptor based DMA operation.
32 *-----------------------------------------------------------------------------*/
33 static void clear_dma_buffer(unsigned int channel
)
35 dma_ch
[channel
].regs
->cfg
|= RESTART
;
37 dma_ch
[channel
].regs
->cfg
&= ~RESTART
;
40 static int __init
blackfin_dma_init(void)
44 printk(KERN_INFO
"Blackfin DMA Controller\n");
46 for (i
= 0; i
< MAX_DMA_CHANNELS
; i
++) {
47 dma_ch
[i
].chan_status
= DMA_CHANNEL_FREE
;
48 dma_ch
[i
].regs
= dma_io_base_addr
[i
];
49 mutex_init(&(dma_ch
[i
].dmalock
));
51 /* Mark MEMDMA Channel 0 as requested since we're using it internally */
52 request_dma(CH_MEM_STREAM0_DEST
, "Blackfin dma_memcpy");
53 request_dma(CH_MEM_STREAM0_SRC
, "Blackfin dma_memcpy");
55 #if defined(CONFIG_DEB_DMA_URGENT)
56 bfin_write_EBIU_DDRQUE(bfin_read_EBIU_DDRQUE()
57 | DEB1_URGENT
| DEB2_URGENT
| DEB3_URGENT
);
62 arch_initcall(blackfin_dma_init
);
65 static int proc_dma_show(struct seq_file
*m
, void *v
)
69 for (i
= 0; i
< MAX_DMA_CHANNELS
; ++i
)
70 if (dma_ch
[i
].chan_status
!= DMA_CHANNEL_FREE
)
71 seq_printf(m
, "%2d: %s\n", i
, dma_ch
[i
].device_id
);
76 static int proc_dma_open(struct inode
*inode
, struct file
*file
)
78 return single_open(file
, proc_dma_show
, NULL
);
81 static const struct file_operations proc_dma_operations
= {
82 .open
= proc_dma_open
,
85 .release
= single_release
,
88 static int __init
proc_dma_init(void)
90 return proc_create("dma", 0, NULL
, &proc_dma_operations
) != NULL
;
92 late_initcall(proc_dma_init
);
95 /*------------------------------------------------------------------------------
96 * Request the specific DMA channel from the system.
97 *-----------------------------------------------------------------------------*/
98 int request_dma(unsigned int channel
, const char *device_id
)
100 pr_debug("request_dma() : BEGIN \n");
102 if (device_id
== NULL
)
103 printk(KERN_WARNING
"request_dma(%u): no device_id given\n", channel
);
105 #if defined(CONFIG_BF561) && ANOMALY_05000182
106 if (channel
>= CH_IMEM_STREAM0_DEST
&& channel
<= CH_IMEM_STREAM1_DEST
) {
107 if (get_cclk() > 500000000) {
109 "Request IMDMA failed due to ANOMALY 05000182\n");
115 mutex_lock(&(dma_ch
[channel
].dmalock
));
117 if ((dma_ch
[channel
].chan_status
== DMA_CHANNEL_REQUESTED
)
118 || (dma_ch
[channel
].chan_status
== DMA_CHANNEL_ENABLED
)) {
119 mutex_unlock(&(dma_ch
[channel
].dmalock
));
120 pr_debug("DMA CHANNEL IN USE \n");
123 dma_ch
[channel
].chan_status
= DMA_CHANNEL_REQUESTED
;
124 pr_debug("DMA CHANNEL IS ALLOCATED \n");
127 mutex_unlock(&(dma_ch
[channel
].dmalock
));
130 if (channel
>= CH_UART2_RX
&& channel
<= CH_UART3_TX
) {
131 unsigned int per_map
;
132 per_map
= dma_ch
[channel
].regs
->peripheral_map
& 0xFFF;
133 if (strncmp(device_id
, "BFIN_UART", 9) == 0)
134 dma_ch
[channel
].regs
->peripheral_map
= per_map
|
135 ((channel
- CH_UART2_RX
+ 0xC)<<12);
137 dma_ch
[channel
].regs
->peripheral_map
= per_map
|
138 ((channel
- CH_UART2_RX
+ 0x6)<<12);
142 dma_ch
[channel
].device_id
= device_id
;
143 dma_ch
[channel
].irq
= 0;
145 /* This is to be enabled by putting a restriction -
146 * you have to request DMA, before doing any operations on
149 pr_debug("request_dma() : END \n");
152 EXPORT_SYMBOL(request_dma
);
154 int set_dma_callback(unsigned int channel
, irq_handler_t callback
, void *data
)
156 BUG_ON(!(dma_ch
[channel
].chan_status
!= DMA_CHANNEL_FREE
157 && channel
< MAX_DMA_CHANNELS
));
159 if (callback
!= NULL
) {
161 dma_ch
[channel
].irq
= channel2irq(channel
);
162 dma_ch
[channel
].data
= data
;
165 request_irq(dma_ch
[channel
].irq
, callback
, IRQF_DISABLED
,
166 dma_ch
[channel
].device_id
, data
);
169 "Request irq in DMA engine failed.\n");
175 EXPORT_SYMBOL(set_dma_callback
);
177 void free_dma(unsigned int channel
)
179 pr_debug("freedma() : BEGIN \n");
180 BUG_ON(!(dma_ch
[channel
].chan_status
!= DMA_CHANNEL_FREE
181 && channel
< MAX_DMA_CHANNELS
));
184 disable_dma(channel
);
185 clear_dma_buffer(channel
);
187 if (dma_ch
[channel
].irq
)
188 free_irq(dma_ch
[channel
].irq
, dma_ch
[channel
].data
);
190 /* Clear the DMA Variable in the Channel */
191 mutex_lock(&(dma_ch
[channel
].dmalock
));
192 dma_ch
[channel
].chan_status
= DMA_CHANNEL_FREE
;
193 mutex_unlock(&(dma_ch
[channel
].dmalock
));
195 pr_debug("freedma() : END \n");
197 EXPORT_SYMBOL(free_dma
);
199 void dma_enable_irq(unsigned int channel
)
201 pr_debug("dma_enable_irq() : BEGIN \n");
202 enable_irq(dma_ch
[channel
].irq
);
204 EXPORT_SYMBOL(dma_enable_irq
);
206 void dma_disable_irq(unsigned int channel
)
208 pr_debug("dma_disable_irq() : BEGIN \n");
209 disable_irq(dma_ch
[channel
].irq
);
211 EXPORT_SYMBOL(dma_disable_irq
);
213 int dma_channel_active(unsigned int channel
)
215 if (dma_ch
[channel
].chan_status
== DMA_CHANNEL_FREE
) {
221 EXPORT_SYMBOL(dma_channel_active
);
223 /*------------------------------------------------------------------------------
224 * stop the specific DMA channel.
225 *-----------------------------------------------------------------------------*/
226 void disable_dma(unsigned int channel
)
228 pr_debug("stop_dma() : BEGIN \n");
229 dma_ch
[channel
].regs
->cfg
&= ~DMAEN
; /* Clean the enable bit */
231 dma_ch
[channel
].chan_status
= DMA_CHANNEL_REQUESTED
;
232 /* Needs to be enabled Later */
233 pr_debug("stop_dma() : END \n");
236 EXPORT_SYMBOL(disable_dma
);
238 void enable_dma(unsigned int channel
)
240 pr_debug("enable_dma() : BEGIN \n");
241 dma_ch
[channel
].chan_status
= DMA_CHANNEL_ENABLED
;
242 dma_ch
[channel
].regs
->curr_x_count
= 0;
243 dma_ch
[channel
].regs
->curr_y_count
= 0;
245 dma_ch
[channel
].regs
->cfg
|= DMAEN
; /* Set the enable bit */
246 pr_debug("enable_dma() : END \n");
249 EXPORT_SYMBOL(enable_dma
);
251 /*------------------------------------------------------------------------------
252 * Set the Start Address register for the specific DMA channel
253 * This function can be used for register based DMA,
254 * to setup the start address
255 * addr: Starting address of the DMA Data to be transferred.
256 *-----------------------------------------------------------------------------*/
257 void set_dma_start_addr(unsigned int channel
, unsigned long addr
)
259 pr_debug("set_dma_start_addr() : BEGIN \n");
260 dma_ch
[channel
].regs
->start_addr
= addr
;
261 pr_debug("set_dma_start_addr() : END\n");
263 EXPORT_SYMBOL(set_dma_start_addr
);
265 void set_dma_next_desc_addr(unsigned int channel
, unsigned long addr
)
267 pr_debug("set_dma_next_desc_addr() : BEGIN \n");
268 dma_ch
[channel
].regs
->next_desc_ptr
= addr
;
269 pr_debug("set_dma_next_desc_addr() : END\n");
271 EXPORT_SYMBOL(set_dma_next_desc_addr
);
273 void set_dma_curr_desc_addr(unsigned int channel
, unsigned long addr
)
275 pr_debug("set_dma_curr_desc_addr() : BEGIN \n");
276 dma_ch
[channel
].regs
->curr_desc_ptr
= addr
;
277 pr_debug("set_dma_curr_desc_addr() : END\n");
279 EXPORT_SYMBOL(set_dma_curr_desc_addr
);
281 void set_dma_x_count(unsigned int channel
, unsigned short x_count
)
283 dma_ch
[channel
].regs
->x_count
= x_count
;
285 EXPORT_SYMBOL(set_dma_x_count
);
287 void set_dma_y_count(unsigned int channel
, unsigned short y_count
)
289 dma_ch
[channel
].regs
->y_count
= y_count
;
291 EXPORT_SYMBOL(set_dma_y_count
);
293 void set_dma_x_modify(unsigned int channel
, short x_modify
)
295 dma_ch
[channel
].regs
->x_modify
= x_modify
;
297 EXPORT_SYMBOL(set_dma_x_modify
);
299 void set_dma_y_modify(unsigned int channel
, short y_modify
)
301 dma_ch
[channel
].regs
->y_modify
= y_modify
;
303 EXPORT_SYMBOL(set_dma_y_modify
);
305 void set_dma_config(unsigned int channel
, unsigned short config
)
307 dma_ch
[channel
].regs
->cfg
= config
;
309 EXPORT_SYMBOL(set_dma_config
);
312 set_bfin_dma_config(char direction
, char flow_mode
,
313 char intr_mode
, char dma_mode
, char width
, char syncmode
)
315 unsigned short config
;
318 ((direction
<< 1) | (width
<< 2) | (dma_mode
<< 4) |
319 (intr_mode
<< 6) | (flow_mode
<< 12) | (syncmode
<< 5));
322 EXPORT_SYMBOL(set_bfin_dma_config
);
324 void set_dma_sg(unsigned int channel
, struct dmasg
*sg
, int nr_sg
)
326 dma_ch
[channel
].regs
->cfg
|= ((nr_sg
& 0x0F) << 8);
327 dma_ch
[channel
].regs
->next_desc_ptr
= (unsigned int)sg
;
329 EXPORT_SYMBOL(set_dma_sg
);
331 void set_dma_curr_addr(unsigned int channel
, unsigned long addr
)
333 dma_ch
[channel
].regs
->curr_addr_ptr
= addr
;
335 EXPORT_SYMBOL(set_dma_curr_addr
);
337 /*------------------------------------------------------------------------------
338 * Get the DMA status of a specific DMA channel from the system.
339 *-----------------------------------------------------------------------------*/
340 unsigned short get_dma_curr_irqstat(unsigned int channel
)
342 return dma_ch
[channel
].regs
->irq_status
;
344 EXPORT_SYMBOL(get_dma_curr_irqstat
);
346 /*------------------------------------------------------------------------------
347 * Clear the DMA_DONE bit in DMA status. Stop the DMA completion interrupt.
348 *-----------------------------------------------------------------------------*/
349 void clear_dma_irqstat(unsigned int channel
)
351 dma_ch
[channel
].regs
->irq_status
|= 3;
353 EXPORT_SYMBOL(clear_dma_irqstat
);
355 /*------------------------------------------------------------------------------
356 * Get current DMA xcount of a specific DMA channel from the system.
357 *-----------------------------------------------------------------------------*/
358 unsigned short get_dma_curr_xcount(unsigned int channel
)
360 return dma_ch
[channel
].regs
->curr_x_count
;
362 EXPORT_SYMBOL(get_dma_curr_xcount
);
364 /*------------------------------------------------------------------------------
365 * Get current DMA ycount of a specific DMA channel from the system.
366 *-----------------------------------------------------------------------------*/
367 unsigned short get_dma_curr_ycount(unsigned int channel
)
369 return dma_ch
[channel
].regs
->curr_y_count
;
371 EXPORT_SYMBOL(get_dma_curr_ycount
);
373 unsigned long get_dma_next_desc_ptr(unsigned int channel
)
375 return dma_ch
[channel
].regs
->next_desc_ptr
;
377 EXPORT_SYMBOL(get_dma_next_desc_ptr
);
379 unsigned long get_dma_curr_desc_ptr(unsigned int channel
)
381 return dma_ch
[channel
].regs
->curr_desc_ptr
;
383 EXPORT_SYMBOL(get_dma_curr_desc_ptr
);
385 unsigned long get_dma_curr_addr(unsigned int channel
)
387 return dma_ch
[channel
].regs
->curr_addr_ptr
;
389 EXPORT_SYMBOL(get_dma_curr_addr
);
392 # ifndef MAX_DMA_SUSPEND_CHANNELS
393 # define MAX_DMA_SUSPEND_CHANNELS MAX_DMA_CHANNELS
395 int blackfin_dma_suspend(void)
399 for (i
= 0; i
< MAX_DMA_SUSPEND_CHANNELS
; ++i
) {
400 if (dma_ch
[i
].chan_status
== DMA_CHANNEL_ENABLED
) {
401 printk(KERN_ERR
"DMA Channel %d failed to suspend\n", i
);
405 dma_ch
[i
].saved_peripheral_map
= dma_ch
[i
].regs
->peripheral_map
;
411 void blackfin_dma_resume(void)
414 for (i
= 0; i
< MAX_DMA_SUSPEND_CHANNELS
; ++i
)
415 dma_ch
[i
].regs
->peripheral_map
= dma_ch
[i
].saved_peripheral_map
;
420 * blackfin_dma_early_init - minimal DMA init
422 * Setup a few DMA registers so we can safely do DMA transfers early on in
423 * the kernel booting process. Really this just means using dma_memcpy().
425 void __init
blackfin_dma_early_init(void)
427 bfin_write_MDMA_S0_CONFIG(0);
431 * __dma_memcpy - program the MDMA registers
433 * Actually program MDMA0 and wait for the transfer to finish. Disable IRQs
434 * while programming registers so that everything is fully configured. Wait
435 * for DMA to finish with IRQs enabled. If interrupted, the initial DMA_DONE
436 * check will make sure we don't clobber any existing transfer.
438 static void __dma_memcpy(u32 daddr
, s16 dmod
, u32 saddr
, s16 smod
, size_t cnt
, u32 conf
)
440 static DEFINE_SPINLOCK(mdma_lock
);
443 spin_lock_irqsave(&mdma_lock
, flags
);
445 if (bfin_read_MDMA_S0_CONFIG())
446 while (!(bfin_read_MDMA_D0_IRQ_STATUS() & DMA_DONE
))
450 /* For larger bit sizes, we've already divided down cnt so it
451 * is no longer a multiple of 64k. So we have to break down
452 * the limit here so it is a multiple of the incoming size.
453 * There is no limitation here in terms of total size other
454 * than the hardware though as the bits lost in the shift are
455 * made up by MODIFY (== we can hit the whole address space).
456 * X: (2^(16 - 0)) * 1 == (2^(16 - 1)) * 2 == (2^(16 - 2)) * 4
458 u32 shift
= abs(dmod
) >> 1;
459 size_t ycnt
= cnt
>> (16 - shift
);
460 cnt
= 1 << (16 - shift
);
461 bfin_write_MDMA_D0_Y_COUNT(ycnt
);
462 bfin_write_MDMA_S0_Y_COUNT(ycnt
);
463 bfin_write_MDMA_D0_Y_MODIFY(dmod
);
464 bfin_write_MDMA_S0_Y_MODIFY(smod
);
467 bfin_write_MDMA_D0_START_ADDR(daddr
);
468 bfin_write_MDMA_D0_X_COUNT(cnt
);
469 bfin_write_MDMA_D0_X_MODIFY(dmod
);
470 bfin_write_MDMA_D0_IRQ_STATUS(DMA_DONE
| DMA_ERR
);
472 bfin_write_MDMA_S0_START_ADDR(saddr
);
473 bfin_write_MDMA_S0_X_COUNT(cnt
);
474 bfin_write_MDMA_S0_X_MODIFY(smod
);
475 bfin_write_MDMA_S0_IRQ_STATUS(DMA_DONE
| DMA_ERR
);
477 bfin_write_MDMA_S0_CONFIG(DMAEN
| conf
);
478 bfin_write_MDMA_D0_CONFIG(WNR
| DI_EN
| DMAEN
| conf
);
480 spin_unlock_irqrestore(&mdma_lock
, flags
);
484 while (!(bfin_read_MDMA_D0_IRQ_STATUS() & DMA_DONE
))
485 if (bfin_read_MDMA_S0_CONFIG())
490 bfin_write_MDMA_D0_IRQ_STATUS(DMA_DONE
| DMA_ERR
);
492 bfin_write_MDMA_S0_CONFIG(0);
493 bfin_write_MDMA_D0_CONFIG(0);
497 * _dma_memcpy - translate C memcpy settings into MDMA settings
499 * Handle all the high level steps before we touch the MDMA registers. So
500 * handle caching, tweaking of sizes, and formatting of addresses.
502 static void *_dma_memcpy(void *pdst
, const void *psrc
, size_t size
)
506 unsigned long dst
= (unsigned long)pdst
;
507 unsigned long src
= (unsigned long)psrc
;
512 if (bfin_addr_dcachable(src
))
513 blackfin_dcache_flush_range(src
, src
+ size
);
515 if (bfin_addr_dcachable(dst
))
516 blackfin_dcache_invalidate_range(dst
, dst
+ size
);
518 if (dst
% 4 == 0 && src
% 4 == 0 && size
% 4 == 0) {
521 } else if (dst
% 2 == 0 && src
% 2 == 0 && size
% 2 == 0) {
529 /* If the two memory regions have a chance of overlapping, make
530 * sure the memcpy still works as expected. Do this by having the
531 * copy run backwards instead.
544 __dma_memcpy(dst
, mod
, src
, mod
, size
, conf
);
550 * dma_memcpy - DMA memcpy under mutex lock
552 * Do not check arguments before starting the DMA memcpy. Break the transfer
553 * up into two pieces. The first transfer is in multiples of 64k and the
554 * second transfer is the piece smaller than 64k.
556 void *dma_memcpy(void *dst
, const void *src
, size_t size
)
559 bulk
= size
& ~0xffff;
562 _dma_memcpy(dst
, src
, bulk
);
563 _dma_memcpy(dst
+ bulk
, src
+ bulk
, rest
);
566 EXPORT_SYMBOL(dma_memcpy
);
569 * safe_dma_memcpy - DMA memcpy w/argument checking
571 * Verify arguments are safe before heading to dma_memcpy().
573 void *safe_dma_memcpy(void *dst
, const void *src
, size_t size
)
575 if (!access_ok(VERIFY_WRITE
, dst
, size
))
577 if (!access_ok(VERIFY_READ
, src
, size
))
579 return dma_memcpy(dst
, src
, size
);
581 EXPORT_SYMBOL(safe_dma_memcpy
);
583 static void _dma_out(unsigned long addr
, unsigned long buf
, unsigned short len
,
584 u16 size
, u16 dma_size
)
586 blackfin_dcache_flush_range(buf
, buf
+ len
* size
);
587 __dma_memcpy(addr
, 0, buf
, size
, len
, dma_size
);
590 static void _dma_in(unsigned long addr
, unsigned long buf
, unsigned short len
,
591 u16 size
, u16 dma_size
)
593 blackfin_dcache_invalidate_range(buf
, buf
+ len
* size
);
594 __dma_memcpy(buf
, size
, addr
, 0, len
, dma_size
);
597 #define MAKE_DMA_IO(io, bwl, isize, dmasize, cnst) \
598 void dma_##io##s##bwl(unsigned long addr, cnst void *buf, unsigned short len) \
600 _dma_##io(addr, (unsigned long)buf, len, isize, WDSIZE_##dmasize); \
602 EXPORT_SYMBOL(dma_##io##s##bwl)
603 MAKE_DMA_IO(out
, b
, 1, 8, const);
604 MAKE_DMA_IO(in
, b
, 1, 8, );
605 MAKE_DMA_IO(out
, w
, 2, 16, const);
606 MAKE_DMA_IO(in
, w
, 2, 16, );
607 MAKE_DMA_IO(out
, l
, 4, 32, const);
608 MAKE_DMA_IO(in
, l
, 4, 32, );