92 lines
		
	
	
		
			2.2 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			92 lines
		
	
	
		
			2.2 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Copyright (C) 2011 Tobias Klauser <tklauser@distanz.ch>
 | |
|  * Copyright (C) 2009 Wind River Systems Inc
 | |
|  *  Implemented by fredrik.markstrom@gmail.com and ivarholmqvist@gmail.com
 | |
|  *
 | |
|  * Based on DMA code from MIPS.
 | |
|  *
 | |
|  * This file is subject to the terms and conditions of the GNU General Public
 | |
|  * License.  See the file "COPYING" in the main directory of this archive
 | |
|  * for more details.
 | |
|  */
 | |
| 
 | |
| #include <linux/types.h>
 | |
| #include <linux/mm.h>
 | |
| #include <linux/string.h>
 | |
| #include <linux/dma-mapping.h>
 | |
| #include <linux/io.h>
 | |
| #include <linux/cache.h>
 | |
| #include <asm/cacheflush.h>
 | |
| 
 | |
| void arch_sync_dma_for_device(struct device *dev, phys_addr_t paddr,
 | |
| 		size_t size, enum dma_data_direction dir)
 | |
| {
 | |
| 	void *vaddr = phys_to_virt(paddr);
 | |
| 
 | |
| 	switch (dir) {
 | |
| 	case DMA_FROM_DEVICE:
 | |
| 		invalidate_dcache_range((unsigned long)vaddr,
 | |
| 			(unsigned long)(vaddr + size));
 | |
| 		break;
 | |
| 	case DMA_TO_DEVICE:
 | |
| 		/*
 | |
| 		 * We just need to flush the caches here , but Nios2 flush
 | |
| 		 * instruction will do both writeback and invalidate.
 | |
| 		 */
 | |
| 	case DMA_BIDIRECTIONAL: /* flush and invalidate */
 | |
| 		flush_dcache_range((unsigned long)vaddr,
 | |
| 			(unsigned long)(vaddr + size));
 | |
| 		break;
 | |
| 	default:
 | |
| 		BUG();
 | |
| 	}
 | |
| }
 | |
| 
 | |
| void arch_sync_dma_for_cpu(struct device *dev, phys_addr_t paddr,
 | |
| 		size_t size, enum dma_data_direction dir)
 | |
| {
 | |
| 	void *vaddr = phys_to_virt(paddr);
 | |
| 
 | |
| 	switch (dir) {
 | |
| 	case DMA_BIDIRECTIONAL:
 | |
| 	case DMA_FROM_DEVICE:
 | |
| 		invalidate_dcache_range((unsigned long)vaddr,
 | |
| 			(unsigned long)(vaddr + size));
 | |
| 		break;
 | |
| 	case DMA_TO_DEVICE:
 | |
| 		break;
 | |
| 	default:
 | |
| 		BUG();
 | |
| 	}
 | |
| }
 | |
| 
 | |
| void *arch_dma_alloc(struct device *dev, size_t size, dma_addr_t *dma_handle,
 | |
| 		gfp_t gfp, unsigned long attrs)
 | |
| {
 | |
| 	void *ret;
 | |
| 
 | |
| 	/* optimized page clearing */
 | |
| 	gfp |= __GFP_ZERO;
 | |
| 
 | |
| 	if (dev == NULL || (dev->coherent_dma_mask < 0xffffffff))
 | |
| 		gfp |= GFP_DMA;
 | |
| 
 | |
| 	ret = (void *) __get_free_pages(gfp, get_order(size));
 | |
| 	if (ret != NULL) {
 | |
| 		*dma_handle = virt_to_phys(ret);
 | |
| 		flush_dcache_range((unsigned long) ret,
 | |
| 			(unsigned long) ret + size);
 | |
| 		ret = UNCAC_ADDR(ret);
 | |
| 	}
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| void arch_dma_free(struct device *dev, size_t size, void *vaddr,
 | |
| 		dma_addr_t dma_handle, unsigned long attrs)
 | |
| {
 | |
| 	unsigned long addr = (unsigned long) CAC_ADDR((unsigned long) vaddr);
 | |
| 
 | |
| 	free_pages(addr, get_order(size));
 | |
| }
 | 
