163 lines
		
	
	
		
			4.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			163 lines
		
	
	
		
			4.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Copyright (C) 2006 Benjamin Herrenschmidt, IBM Corporation
 | |
|  *
 | |
|  * Provide default implementations of the DMA mapping callbacks for
 | |
|  * directly mapped busses.
 | |
|  */
 | |
| 
 | |
| #include <linux/device.h>
 | |
| #include <linux/dma-mapping.h>
 | |
| #include <linux/dma-debug.h>
 | |
| #include <linux/lmb.h>
 | |
| #include <asm/bug.h>
 | |
| #include <asm/abs_addr.h>
 | |
| 
 | |
| /*
 | |
|  * Generic direct DMA implementation
 | |
|  *
 | |
|  * This implementation supports a per-device offset that can be applied if
 | |
|  * the address at which memory is visible to devices is not 0. Platform code
 | |
|  * can set archdata.dma_data to an unsigned long holding the offset. By
 | |
|  * default the offset is PCI_DRAM_OFFSET.
 | |
|  */
 | |
| 
 | |
| 
 | |
| void *dma_direct_alloc_coherent(struct device *dev, size_t size,
 | |
| 				dma_addr_t *dma_handle, gfp_t flag)
 | |
| {
 | |
| 	void *ret;
 | |
| #ifdef CONFIG_NOT_COHERENT_CACHE
 | |
| 	ret = __dma_alloc_coherent(dev, size, dma_handle, flag);
 | |
| 	if (ret == NULL)
 | |
| 		return NULL;
 | |
| 	*dma_handle += get_dma_offset(dev);
 | |
| 	return ret;
 | |
| #else
 | |
| 	struct page *page;
 | |
| 	int node = dev_to_node(dev);
 | |
| 
 | |
| 	/* ignore region specifiers */
 | |
| 	flag  &= ~(__GFP_HIGHMEM);
 | |
| 
 | |
| 	page = alloc_pages_node(node, flag, get_order(size));
 | |
| 	if (page == NULL)
 | |
| 		return NULL;
 | |
| 	ret = page_address(page);
 | |
| 	memset(ret, 0, size);
 | |
| 	*dma_handle = virt_to_abs(ret) + get_dma_offset(dev);
 | |
| 
 | |
| 	return ret;
 | |
| #endif
 | |
| }
 | |
| 
 | |
| void dma_direct_free_coherent(struct device *dev, size_t size,
 | |
| 			      void *vaddr, dma_addr_t dma_handle)
 | |
| {
 | |
| #ifdef CONFIG_NOT_COHERENT_CACHE
 | |
| 	__dma_free_coherent(size, vaddr);
 | |
| #else
 | |
| 	free_pages((unsigned long)vaddr, get_order(size));
 | |
| #endif
 | |
| }
 | |
| 
 | |
| static int dma_direct_map_sg(struct device *dev, struct scatterlist *sgl,
 | |
| 			     int nents, enum dma_data_direction direction,
 | |
| 			     struct dma_attrs *attrs)
 | |
| {
 | |
| 	struct scatterlist *sg;
 | |
| 	int i;
 | |
| 
 | |
| 	for_each_sg(sgl, sg, nents, i) {
 | |
| 		sg->dma_address = sg_phys(sg) + get_dma_offset(dev);
 | |
| 		sg->dma_length = sg->length;
 | |
| 		__dma_sync_page(sg_page(sg), sg->offset, sg->length, direction);
 | |
| 	}
 | |
| 
 | |
| 	return nents;
 | |
| }
 | |
| 
 | |
| static void dma_direct_unmap_sg(struct device *dev, struct scatterlist *sg,
 | |
| 				int nents, enum dma_data_direction direction,
 | |
| 				struct dma_attrs *attrs)
 | |
| {
 | |
| }
 | |
| 
 | |
| static int dma_direct_dma_supported(struct device *dev, u64 mask)
 | |
| {
 | |
| #ifdef CONFIG_PPC64
 | |
| 	/* Could be improved so platforms can set the limit in case
 | |
| 	 * they have limited DMA windows
 | |
| 	 */
 | |
| 	return mask >= (lmb_end_of_DRAM() - 1);
 | |
| #else
 | |
| 	return 1;
 | |
| #endif
 | |
| }
 | |
| 
 | |
| static inline dma_addr_t dma_direct_map_page(struct device *dev,
 | |
| 					     struct page *page,
 | |
| 					     unsigned long offset,
 | |
| 					     size_t size,
 | |
| 					     enum dma_data_direction dir,
 | |
| 					     struct dma_attrs *attrs)
 | |
| {
 | |
| 	BUG_ON(dir == DMA_NONE);
 | |
| 	__dma_sync_page(page, offset, size, dir);
 | |
| 	return page_to_phys(page) + offset + get_dma_offset(dev);
 | |
| }
 | |
| 
 | |
| static inline void dma_direct_unmap_page(struct device *dev,
 | |
| 					 dma_addr_t dma_address,
 | |
| 					 size_t size,
 | |
| 					 enum dma_data_direction direction,
 | |
| 					 struct dma_attrs *attrs)
 | |
| {
 | |
| }
 | |
| 
 | |
| #ifdef CONFIG_NOT_COHERENT_CACHE
 | |
| static inline void dma_direct_sync_sg(struct device *dev,
 | |
| 		struct scatterlist *sgl, int nents,
 | |
| 		enum dma_data_direction direction)
 | |
| {
 | |
| 	struct scatterlist *sg;
 | |
| 	int i;
 | |
| 
 | |
| 	for_each_sg(sgl, sg, nents, i)
 | |
| 		__dma_sync_page(sg_page(sg), sg->offset, sg->length, direction);
 | |
| }
 | |
| 
 | |
| static inline void dma_direct_sync_single_range(struct device *dev,
 | |
| 		dma_addr_t dma_handle, unsigned long offset, size_t size,
 | |
| 		enum dma_data_direction direction)
 | |
| {
 | |
| 	__dma_sync(bus_to_virt(dma_handle+offset), size, direction);
 | |
| }
 | |
| #endif
 | |
| 
 | |
| struct dma_map_ops dma_direct_ops = {
 | |
| 	.alloc_coherent	= dma_direct_alloc_coherent,
 | |
| 	.free_coherent	= dma_direct_free_coherent,
 | |
| 	.map_sg		= dma_direct_map_sg,
 | |
| 	.unmap_sg	= dma_direct_unmap_sg,
 | |
| 	.dma_supported	= dma_direct_dma_supported,
 | |
| 	.map_page	= dma_direct_map_page,
 | |
| 	.unmap_page	= dma_direct_unmap_page,
 | |
| #ifdef CONFIG_NOT_COHERENT_CACHE
 | |
| 	.sync_single_range_for_cpu 	= dma_direct_sync_single_range,
 | |
| 	.sync_single_range_for_device 	= dma_direct_sync_single_range,
 | |
| 	.sync_sg_for_cpu 		= dma_direct_sync_sg,
 | |
| 	.sync_sg_for_device 		= dma_direct_sync_sg,
 | |
| #endif
 | |
| };
 | |
| EXPORT_SYMBOL(dma_direct_ops);
 | |
| 
 | |
| #define PREALLOC_DMA_DEBUG_ENTRIES (1 << 16)
 | |
| 
 | |
| static int __init dma_init(void)
 | |
| {
 | |
|        dma_debug_init(PREALLOC_DMA_DEBUG_ENTRIES);
 | |
| 
 | |
|        return 0;
 | |
| }
 | |
| fs_initcall(dma_init);
 |