1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38#define pr_fmt(fmt) "cma: " fmt
39
40#ifdef CONFIG_CMA_DEBUG
41#ifndef DEBUG
42# define DEBUG
43#endif
44#endif
45
46#include <asm/page.h>
47
48#include <linux/memblock.h>
49#include <linux/err.h>
50#include <linux/sizes.h>
51#include <linux/dma-map-ops.h>
52#include <linux/cma.h>
53
54#ifdef CONFIG_CMA_SIZE_MBYTES
55#define CMA_SIZE_MBYTES CONFIG_CMA_SIZE_MBYTES
56#else
57#define CMA_SIZE_MBYTES 0
58#endif
59
60struct cma *dma_contiguous_default_area;
61
62
63
64
65
66
67
68
69
70
71
72static const phys_addr_t size_bytes __initconst =
73 (phys_addr_t)CMA_SIZE_MBYTES * SZ_1M;
74static phys_addr_t size_cmdline __initdata = -1;
75static phys_addr_t base_cmdline __initdata;
76static phys_addr_t limit_cmdline __initdata;
77
78static int __init early_cma(char *p)
79{
80 if (!p) {
81 pr_err("Config string not provided\n");
82 return -EINVAL;
83 }
84
85 size_cmdline = memparse(p, &p);
86 if (*p != '@')
87 return 0;
88 base_cmdline = memparse(p + 1, &p);
89 if (*p != '-') {
90 limit_cmdline = base_cmdline + size_cmdline;
91 return 0;
92 }
93 limit_cmdline = memparse(p + 1, &p);
94
95 return 0;
96}
97early_param("cma", early_cma);
98
99#ifdef CONFIG_DMA_PERNUMA_CMA
100
101static struct cma *dma_contiguous_pernuma_area[MAX_NUMNODES];
102static phys_addr_t pernuma_size_bytes __initdata;
103
104static int __init early_cma_pernuma(char *p)
105{
106 pernuma_size_bytes = memparse(p, &p);
107 return 0;
108}
109early_param("cma_pernuma", early_cma_pernuma);
110#endif
111
112#ifdef CONFIG_CMA_SIZE_PERCENTAGE
113
114static phys_addr_t __init __maybe_unused cma_early_percent_memory(void)
115{
116 unsigned long total_pages = PHYS_PFN(memblock_phys_mem_size());
117
118 return (total_pages * CONFIG_CMA_SIZE_PERCENTAGE / 100) << PAGE_SHIFT;
119}
120
121#else
122
123static inline __maybe_unused phys_addr_t cma_early_percent_memory(void)
124{
125 return 0;
126}
127
128#endif
129
130#ifdef CONFIG_DMA_PERNUMA_CMA
131void __init dma_pernuma_cma_reserve(void)
132{
133 int nid;
134
135 if (!pernuma_size_bytes)
136 return;
137
138 for_each_online_node(nid) {
139 int ret;
140 char name[CMA_MAX_NAME];
141 struct cma **cma = &dma_contiguous_pernuma_area[nid];
142
143 snprintf(name, sizeof(name), "pernuma%d", nid);
144 ret = cma_declare_contiguous_nid(0, pernuma_size_bytes, 0, 0,
145 0, false, name, cma, nid);
146 if (ret) {
147 pr_warn("%s: reservation failed: err %d, node %d", __func__,
148 ret, nid);
149 continue;
150 }
151
152 pr_debug("%s: reserved %llu MiB on node %d\n", __func__,
153 (unsigned long long)pernuma_size_bytes / SZ_1M, nid);
154 }
155}
156#endif
157
158
159
160
161
162
163
164
165
166
167void __init dma_contiguous_reserve(phys_addr_t limit)
168{
169 phys_addr_t selected_size = 0;
170 phys_addr_t selected_base = 0;
171 phys_addr_t selected_limit = limit;
172 bool fixed = false;
173
174 pr_debug("%s(limit %08lx)\n", __func__, (unsigned long)limit);
175
176 if (size_cmdline != -1) {
177 selected_size = size_cmdline;
178 selected_base = base_cmdline;
179 selected_limit = min_not_zero(limit_cmdline, limit);
180 if (base_cmdline + size_cmdline == limit_cmdline)
181 fixed = true;
182 } else {
183#ifdef CONFIG_CMA_SIZE_SEL_MBYTES
184 selected_size = size_bytes;
185#elif defined(CONFIG_CMA_SIZE_SEL_PERCENTAGE)
186 selected_size = cma_early_percent_memory();
187#elif defined(CONFIG_CMA_SIZE_SEL_MIN)
188 selected_size = min(size_bytes, cma_early_percent_memory());
189#elif defined(CONFIG_CMA_SIZE_SEL_MAX)
190 selected_size = max(size_bytes, cma_early_percent_memory());
191#endif
192 }
193
194 if (selected_size && !dma_contiguous_default_area) {
195 pr_debug("%s: reserving %ld MiB for global area\n", __func__,
196 (unsigned long)selected_size / SZ_1M);
197
198 dma_contiguous_reserve_area(selected_size, selected_base,
199 selected_limit,
200 &dma_contiguous_default_area,
201 fixed);
202 }
203}
204
205void __weak
206dma_contiguous_early_fixup(phys_addr_t base, unsigned long size)
207{
208}
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227int __init dma_contiguous_reserve_area(phys_addr_t size, phys_addr_t base,
228 phys_addr_t limit, struct cma **res_cma,
229 bool fixed)
230{
231 int ret;
232
233 ret = cma_declare_contiguous(base, size, limit, 0, 0, fixed,
234 "reserved", res_cma);
235 if (ret)
236 return ret;
237
238
239 dma_contiguous_early_fixup(cma_get_base(*res_cma),
240 cma_get_size(*res_cma));
241
242 return 0;
243}
244
245
246
247
248
249
250
251
252
253
254
255
256
257struct page *dma_alloc_from_contiguous(struct device *dev, size_t count,
258 unsigned int align, bool no_warn)
259{
260 if (align > CONFIG_CMA_ALIGNMENT)
261 align = CONFIG_CMA_ALIGNMENT;
262
263 return cma_alloc(dev_get_cma_area(dev), count, align, no_warn);
264}
265
266
267
268
269
270
271
272
273
274
275
276bool dma_release_from_contiguous(struct device *dev, struct page *pages,
277 int count)
278{
279 return cma_release(dev_get_cma_area(dev), pages, count);
280}
281
282static struct page *cma_alloc_aligned(struct cma *cma, size_t size, gfp_t gfp)
283{
284 unsigned int align = min(get_order(size), CONFIG_CMA_ALIGNMENT);
285
286 return cma_alloc(cma, size >> PAGE_SHIFT, align, gfp & __GFP_NOWARN);
287}
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304struct page *dma_alloc_contiguous(struct device *dev, size_t size, gfp_t gfp)
305{
306#ifdef CONFIG_DMA_PERNUMA_CMA
307 int nid = dev_to_node(dev);
308#endif
309
310
311 if (!gfpflags_allow_blocking(gfp))
312 return NULL;
313 if (dev->cma_area)
314 return cma_alloc_aligned(dev->cma_area, size, gfp);
315 if (size <= PAGE_SIZE)
316 return NULL;
317
318#ifdef CONFIG_DMA_PERNUMA_CMA
319 if (nid != NUMA_NO_NODE && !(gfp & (GFP_DMA | GFP_DMA32))) {
320 struct cma *cma = dma_contiguous_pernuma_area[nid];
321 struct page *page;
322
323 if (cma) {
324 page = cma_alloc_aligned(cma, size, gfp);
325 if (page)
326 return page;
327 }
328 }
329#endif
330 if (!dma_contiguous_default_area)
331 return NULL;
332
333 return cma_alloc_aligned(dma_contiguous_default_area, size, gfp);
334}
335
336
337
338
339
340
341
342
343
344
345
346
347void dma_free_contiguous(struct device *dev, struct page *page, size_t size)
348{
349 unsigned int count = PAGE_ALIGN(size) >> PAGE_SHIFT;
350
351
352 if (dev->cma_area) {
353 if (cma_release(dev->cma_area, page, count))
354 return;
355 } else {
356
357
358
359#ifdef CONFIG_DMA_PERNUMA_CMA
360 if (cma_release(dma_contiguous_pernuma_area[page_to_nid(page)],
361 page, count))
362 return;
363#endif
364 if (cma_release(dma_contiguous_default_area, page, count))
365 return;
366 }
367
368
369 __free_pages(page, get_order(size));
370}
371
372
373
374
375#ifdef CONFIG_OF_RESERVED_MEM
376#include <linux/of.h>
377#include <linux/of_fdt.h>
378#include <linux/of_reserved_mem.h>
379
380#undef pr_fmt
381#define pr_fmt(fmt) fmt
382
383static int rmem_cma_device_init(struct reserved_mem *rmem, struct device *dev)
384{
385 dev->cma_area = rmem->priv;
386 return 0;
387}
388
389static void rmem_cma_device_release(struct reserved_mem *rmem,
390 struct device *dev)
391{
392 dev->cma_area = NULL;
393}
394
395static const struct reserved_mem_ops rmem_cma_ops = {
396 .device_init = rmem_cma_device_init,
397 .device_release = rmem_cma_device_release,
398};
399
400static int __init rmem_cma_setup(struct reserved_mem *rmem)
401{
402 phys_addr_t align = PAGE_SIZE << max(MAX_ORDER - 1, pageblock_order);
403 phys_addr_t mask = align - 1;
404 unsigned long node = rmem->fdt_node;
405 bool default_cma = of_get_flat_dt_prop(node, "linux,cma-default", NULL);
406 struct cma *cma;
407 int err;
408
409 if (size_cmdline != -1 && default_cma) {
410 pr_info("Reserved memory: bypass %s node, using cmdline CMA params instead\n",
411 rmem->name);
412 return -EBUSY;
413 }
414
415 if (!of_get_flat_dt_prop(node, "reusable", NULL) ||
416 of_get_flat_dt_prop(node, "no-map", NULL))
417 return -EINVAL;
418
419 if ((rmem->base & mask) || (rmem->size & mask)) {
420 pr_err("Reserved memory: incorrect alignment of CMA region\n");
421 return -EINVAL;
422 }
423
424 err = cma_init_reserved_mem(rmem->base, rmem->size, 0, rmem->name, &cma);
425 if (err) {
426 pr_err("Reserved memory: unable to setup CMA region\n");
427 return err;
428 }
429
430 dma_contiguous_early_fixup(rmem->base, rmem->size);
431
432 if (default_cma)
433 dma_contiguous_default_area = cma;
434
435 rmem->ops = &rmem_cma_ops;
436 rmem->priv = cma;
437
438 pr_info("Reserved memory: created CMA memory pool at %pa, size %ld MiB\n",
439 &rmem->base, (unsigned long)rmem->size / SZ_1M);
440
441 return 0;
442}
443RESERVEDMEM_OF_DECLARE(cma, "shared-dma-pool", rmem_cma_setup);
444#endif
445