1
2
3
4
5
6
7
8
9
10
11
12#include <linux/types.h>
13#include <linux/slab.h>
14#include <linux/dma-mapping.h>
15#include <linux/list.h>
16#include <linux/pci.h>
17#include <linux/highmem.h>
18#include <asm/io.h>
19
20void *dma_alloc_coherent(struct device *hwdev, size_t size, dma_addr_t *dma_handle, int gfp)
21{
22 void *ret;
23
24 ret = consistent_alloc(gfp, size, dma_handle);
25 if (ret)
26 memset(ret, 0, size);
27
28 return ret;
29}
30
31void dma_free_coherent(struct device *hwdev, size_t size, void *vaddr, dma_addr_t dma_handle)
32{
33 consistent_free(vaddr);
34}
35
36
37
38
39
40
41
42
43dma_addr_t dma_map_single(struct device *dev, void *ptr, size_t size,
44 enum dma_data_direction direction)
45{
46 if (direction == DMA_NONE)
47 BUG();
48
49 frv_cache_wback_inv((unsigned long) ptr, (unsigned long) ptr + size);
50
51 return virt_to_bus(ptr);
52}
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70int dma_map_sg(struct device *dev, struct scatterlist *sg, int nents,
71 enum dma_data_direction direction)
72{
73 unsigned long dampr2;
74 void *vaddr;
75 int i;
76
77 if (direction == DMA_NONE)
78 BUG();
79
80 dampr2 = __get_DAMPR(2);
81
82 for (i = 0; i < nents; i++) {
83 vaddr = kmap_atomic(sg[i].page, __KM_CACHE);
84
85 frv_dcache_writeback((unsigned long) vaddr,
86 (unsigned long) vaddr + PAGE_SIZE);
87
88 }
89
90 kunmap_atomic(vaddr, __KM_CACHE);
91 if (dampr2) {
92 __set_DAMPR(2, dampr2);
93 __set_IAMPR(2, dampr2);
94 }
95
96 return nents;
97}
98
99dma_addr_t dma_map_page(struct device *dev, struct page *page, unsigned long offset,
100 size_t size, enum dma_data_direction direction)
101{
102 BUG_ON(direction == DMA_NONE);
103 flush_dcache_page(page);
104 return (dma_addr_t) page_to_phys(page) + offset;
105}
106