Commit | Line | Data |
---|---|---|
9ac7849e TH |
1 | /* |
2 | * drivers/base/dma-mapping.c - arch-independent dma-mapping routines | |
3 | * | |
4 | * Copyright (c) 2006 SUSE Linux Products GmbH | |
5 | * Copyright (c) 2006 Tejun Heo <teheo@suse.de> | |
6 | * | |
7 | * This file is released under the GPLv2. | |
8 | */ | |
9 | ||
10 | #include <linux/dma-mapping.h> | |
1b6bc32f | 11 | #include <linux/export.h> |
5a0e3ad6 | 12 | #include <linux/gfp.h> |
64ccc9c0 | 13 | #include <asm-generic/dma-coherent.h> |
9ac7849e TH |
14 | |
15 | /* | |
16 | * Managed DMA API | |
17 | */ | |
18 | struct dma_devres { | |
19 | size_t size; | |
20 | void *vaddr; | |
21 | dma_addr_t dma_handle; | |
22 | }; | |
23 | ||
24 | static void dmam_coherent_release(struct device *dev, void *res) | |
25 | { | |
26 | struct dma_devres *this = res; | |
27 | ||
28 | dma_free_coherent(dev, this->size, this->vaddr, this->dma_handle); | |
29 | } | |
30 | ||
31 | static void dmam_noncoherent_release(struct device *dev, void *res) | |
32 | { | |
33 | struct dma_devres *this = res; | |
34 | ||
35 | dma_free_noncoherent(dev, this->size, this->vaddr, this->dma_handle); | |
36 | } | |
37 | ||
38 | static int dmam_match(struct device *dev, void *res, void *match_data) | |
39 | { | |
40 | struct dma_devres *this = res, *match = match_data; | |
41 | ||
42 | if (this->vaddr == match->vaddr) { | |
43 | WARN_ON(this->size != match->size || | |
44 | this->dma_handle != match->dma_handle); | |
45 | return 1; | |
46 | } | |
47 | return 0; | |
48 | } | |
49 | ||
50 | /** | |
51 | * dmam_alloc_coherent - Managed dma_alloc_coherent() | |
52 | * @dev: Device to allocate coherent memory for | |
53 | * @size: Size of allocation | |
54 | * @dma_handle: Out argument for allocated DMA handle | |
55 | * @gfp: Allocation flags | |
56 | * | |
57 | * Managed dma_alloc_coherent(). Memory allocated using this function | |
58 | * will be automatically released on driver detach. | |
59 | * | |
60 | * RETURNS: | |
61 | * Pointer to allocated memory on success, NULL on failure. | |
62 | */ | |
63 | void * dmam_alloc_coherent(struct device *dev, size_t size, | |
64 | dma_addr_t *dma_handle, gfp_t gfp) | |
65 | { | |
66 | struct dma_devres *dr; | |
67 | void *vaddr; | |
68 | ||
69 | dr = devres_alloc(dmam_coherent_release, sizeof(*dr), gfp); | |
70 | if (!dr) | |
71 | return NULL; | |
72 | ||
73 | vaddr = dma_alloc_coherent(dev, size, dma_handle, gfp); | |
74 | if (!vaddr) { | |
75 | devres_free(dr); | |
76 | return NULL; | |
77 | } | |
78 | ||
79 | dr->vaddr = vaddr; | |
80 | dr->dma_handle = *dma_handle; | |
81 | dr->size = size; | |
82 | ||
83 | devres_add(dev, dr); | |
84 | ||
85 | return vaddr; | |
86 | } | |
87 | EXPORT_SYMBOL(dmam_alloc_coherent); | |
88 | ||
89 | /** | |
90 | * dmam_free_coherent - Managed dma_free_coherent() | |
91 | * @dev: Device to free coherent memory for | |
92 | * @size: Size of allocation | |
93 | * @vaddr: Virtual address of the memory to free | |
94 | * @dma_handle: DMA handle of the memory to free | |
95 | * | |
96 | * Managed dma_free_coherent(). | |
97 | */ | |
98 | void dmam_free_coherent(struct device *dev, size_t size, void *vaddr, | |
99 | dma_addr_t dma_handle) | |
100 | { | |
101 | struct dma_devres match_data = { size, vaddr, dma_handle }; | |
102 | ||
103 | dma_free_coherent(dev, size, vaddr, dma_handle); | |
104 | WARN_ON(devres_destroy(dev, dmam_coherent_release, dmam_match, | |
105 | &match_data)); | |
106 | } | |
107 | EXPORT_SYMBOL(dmam_free_coherent); | |
108 | ||
109 | /** | |
110 | * dmam_alloc_non_coherent - Managed dma_alloc_non_coherent() | |
111 | * @dev: Device to allocate non_coherent memory for | |
112 | * @size: Size of allocation | |
113 | * @dma_handle: Out argument for allocated DMA handle | |
114 | * @gfp: Allocation flags | |
115 | * | |
116 | * Managed dma_alloc_non_coherent(). Memory allocated using this | |
117 | * function will be automatically released on driver detach. | |
118 | * | |
119 | * RETURNS: | |
120 | * Pointer to allocated memory on success, NULL on failure. | |
121 | */ | |
122 | void *dmam_alloc_noncoherent(struct device *dev, size_t size, | |
123 | dma_addr_t *dma_handle, gfp_t gfp) | |
124 | { | |
125 | struct dma_devres *dr; | |
126 | void *vaddr; | |
127 | ||
128 | dr = devres_alloc(dmam_noncoherent_release, sizeof(*dr), gfp); | |
129 | if (!dr) | |
130 | return NULL; | |
131 | ||
132 | vaddr = dma_alloc_noncoherent(dev, size, dma_handle, gfp); | |
133 | if (!vaddr) { | |
134 | devres_free(dr); | |
135 | return NULL; | |
136 | } | |
137 | ||
138 | dr->vaddr = vaddr; | |
139 | dr->dma_handle = *dma_handle; | |
140 | dr->size = size; | |
141 | ||
142 | devres_add(dev, dr); | |
143 | ||
144 | return vaddr; | |
145 | } | |
146 | EXPORT_SYMBOL(dmam_alloc_noncoherent); | |
147 | ||
148 | /** | |
149 | * dmam_free_coherent - Managed dma_free_noncoherent() | |
150 | * @dev: Device to free noncoherent memory for | |
151 | * @size: Size of allocation | |
152 | * @vaddr: Virtual address of the memory to free | |
153 | * @dma_handle: DMA handle of the memory to free | |
154 | * | |
155 | * Managed dma_free_noncoherent(). | |
156 | */ | |
157 | void dmam_free_noncoherent(struct device *dev, size_t size, void *vaddr, | |
158 | dma_addr_t dma_handle) | |
159 | { | |
160 | struct dma_devres match_data = { size, vaddr, dma_handle }; | |
161 | ||
162 | dma_free_noncoherent(dev, size, vaddr, dma_handle); | |
163 | WARN_ON(!devres_destroy(dev, dmam_noncoherent_release, dmam_match, | |
164 | &match_data)); | |
165 | } | |
166 | EXPORT_SYMBOL(dmam_free_noncoherent); | |
167 | ||
168 | #ifdef ARCH_HAS_DMA_DECLARE_COHERENT_MEMORY | |
169 | ||
170 | static void dmam_coherent_decl_release(struct device *dev, void *res) | |
171 | { | |
172 | dma_release_declared_memory(dev); | |
173 | } | |
174 | ||
175 | /** | |
176 | * dmam_declare_coherent_memory - Managed dma_declare_coherent_memory() | |
177 | * @dev: Device to declare coherent memory for | |
178 | * @bus_addr: Bus address of coherent memory to be declared | |
179 | * @device_addr: Device address of coherent memory to be declared | |
180 | * @size: Size of coherent memory to be declared | |
181 | * @flags: Flags | |
182 | * | |
183 | * Managed dma_declare_coherent_memory(). | |
184 | * | |
185 | * RETURNS: | |
186 | * 0 on success, -errno on failure. | |
187 | */ | |
188 | int dmam_declare_coherent_memory(struct device *dev, dma_addr_t bus_addr, | |
189 | dma_addr_t device_addr, size_t size, int flags) | |
190 | { | |
191 | void *res; | |
192 | int rc; | |
193 | ||
194 | res = devres_alloc(dmam_coherent_decl_release, 0, GFP_KERNEL); | |
195 | if (!res) | |
196 | return -ENOMEM; | |
197 | ||
198 | rc = dma_declare_coherent_memory(dev, bus_addr, device_addr, size, | |
199 | flags); | |
200 | if (rc == 0) | |
201 | devres_add(dev, res); | |
202 | else | |
203 | devres_free(res); | |
204 | ||
205 | return rc; | |
206 | } | |
207 | EXPORT_SYMBOL(dmam_declare_coherent_memory); | |
208 | ||
209 | /** | |
210 | * dmam_release_declared_memory - Managed dma_release_declared_memory(). | |
211 | * @dev: Device to release declared coherent memory for | |
212 | * | |
213 | * Managed dmam_release_declared_memory(). | |
214 | */ | |
215 | void dmam_release_declared_memory(struct device *dev) | |
216 | { | |
217 | WARN_ON(devres_destroy(dev, dmam_coherent_decl_release, NULL, NULL)); | |
218 | } | |
219 | EXPORT_SYMBOL(dmam_release_declared_memory); | |
220 | ||
c6c22955 MS |
221 | #endif |
222 | ||
d2b7428e MS |
223 | /* |
224 | * Create scatter-list for the already allocated DMA buffer. | |
225 | */ | |
226 | int dma_common_get_sgtable(struct device *dev, struct sg_table *sgt, | |
227 | void *cpu_addr, dma_addr_t handle, size_t size) | |
228 | { | |
229 | struct page *page = virt_to_page(cpu_addr); | |
230 | int ret; | |
231 | ||
232 | ret = sg_alloc_table(sgt, 1, GFP_KERNEL); | |
233 | if (unlikely(ret)) | |
234 | return ret; | |
235 | ||
236 | sg_set_page(sgt->sgl, page, PAGE_ALIGN(size), 0); | |
237 | return 0; | |
238 | } | |
239 | EXPORT_SYMBOL(dma_common_get_sgtable); | |
240 | ||
64ccc9c0 MS |
241 | /* |
242 | * Create userspace mapping for the DMA-coherent memory. | |
243 | */ | |
244 | int dma_common_mmap(struct device *dev, struct vm_area_struct *vma, | |
245 | void *cpu_addr, dma_addr_t dma_addr, size_t size) | |
246 | { | |
247 | int ret = -ENXIO; | |
248 | #ifdef CONFIG_MMU | |
249 | unsigned long user_count = (vma->vm_end - vma->vm_start) >> PAGE_SHIFT; | |
250 | unsigned long count = PAGE_ALIGN(size) >> PAGE_SHIFT; | |
251 | unsigned long pfn = page_to_pfn(virt_to_page(cpu_addr)); | |
252 | unsigned long off = vma->vm_pgoff; | |
253 | ||
254 | vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); | |
255 | ||
256 | if (dma_mmap_from_coherent(dev, vma, cpu_addr, size, &ret)) | |
257 | return ret; | |
258 | ||
259 | if (off < count && user_count <= (count - off)) { | |
260 | ret = remap_pfn_range(vma, vma->vm_start, | |
261 | pfn + off, | |
262 | user_count << PAGE_SHIFT, | |
263 | vma->vm_page_prot); | |
264 | } | |
265 | #endif /* CONFIG_MMU */ | |
266 | ||
267 | return ret; | |
268 | } | |
269 | EXPORT_SYMBOL(dma_common_mmap); |