Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Contiguous Memory Allocator |
| 3 | * |
| 4 | * Copyright (c) 2010-2011 by Samsung Electronics. |
| 5 | * Copyright IBM Corporation, 2013 |
| 6 | * Copyright LG Electronics Inc., 2014 |
| 7 | * Written by: |
| 8 | * Marek Szyprowski <m.szyprowski@samsung.com> |
| 9 | * Michal Nazarewicz <mina86@mina86.com> |
| 10 | * Aneesh Kumar K.V <aneesh.kumar@linux.vnet.ibm.com> |
| 11 | * Joonsoo Kim <iamjoonsoo.kim@lge.com> |
| 12 | * |
| 13 | * This program is free software; you can redistribute it and/or |
| 14 | * modify it under the terms of the GNU General Public License as |
| 15 | * published by the Free Software Foundation; either version 2 of the |
| 16 | * License or (at your optional) any later version of the license. |
| 17 | */ |
| 18 | |
| 19 | #define pr_fmt(fmt) "cma: " fmt |
| 20 | |
| 21 | #ifdef CONFIG_CMA_DEBUG |
| 22 | #ifndef DEBUG |
| 23 | # define DEBUG |
| 24 | #endif |
| 25 | #endif |
Stefan Strogin | 99e8ea6 | 2015-04-15 16:14:50 -0700 | [diff] [blame] | 26 | #define CREATE_TRACE_POINTS |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 27 | |
| 28 | #include <linux/memblock.h> |
| 29 | #include <linux/err.h> |
| 30 | #include <linux/mm.h> |
| 31 | #include <linux/mutex.h> |
| 32 | #include <linux/sizes.h> |
| 33 | #include <linux/slab.h> |
| 34 | #include <linux/log2.h> |
| 35 | #include <linux/cma.h> |
Marek Szyprowski | f7426b9 | 2014-10-09 15:26:47 -0700 | [diff] [blame] | 36 | #include <linux/highmem.h> |
Thierry Reding | 620951e | 2014-12-12 16:58:31 -0800 | [diff] [blame] | 37 | #include <linux/io.h> |
Stefan Strogin | 99e8ea6 | 2015-04-15 16:14:50 -0700 | [diff] [blame] | 38 | #include <trace/events/cma.h> |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 39 | |
Sasha Levin | 28b24c1 | 2015-04-14 15:44:57 -0700 | [diff] [blame] | 40 | #include "cma.h" |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 41 | |
Sasha Levin | 28b24c1 | 2015-04-14 15:44:57 -0700 | [diff] [blame] | 42 | struct cma cma_areas[MAX_CMA_AREAS]; |
| 43 | unsigned cma_area_count; |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 44 | static DEFINE_MUTEX(cma_mutex); |
| 45 | |
Sasha Levin | ac17382 | 2015-04-14 15:47:04 -0700 | [diff] [blame] | 46 | phys_addr_t cma_get_base(const struct cma *cma) |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 47 | { |
| 48 | return PFN_PHYS(cma->base_pfn); |
| 49 | } |
| 50 | |
Sasha Levin | ac17382 | 2015-04-14 15:47:04 -0700 | [diff] [blame] | 51 | unsigned long cma_get_size(const struct cma *cma) |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 52 | { |
| 53 | return cma->count << PAGE_SHIFT; |
| 54 | } |
| 55 | |
Laura Abbott | f318dd0 | 2017-04-18 11:27:03 -0700 | [diff] [blame] | 56 | const char *cma_get_name(const struct cma *cma) |
| 57 | { |
| 58 | return cma->name ? cma->name : "(undefined)"; |
| 59 | } |
| 60 | |
Sasha Levin | ac17382 | 2015-04-14 15:47:04 -0700 | [diff] [blame] | 61 | static unsigned long cma_bitmap_aligned_mask(const struct cma *cma, |
Doug Berger | e048cb3 | 2017-07-10 15:49:44 -0700 | [diff] [blame] | 62 | unsigned int align_order) |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 63 | { |
Weijie Yang | 68faed6 | 2014-10-13 15:51:03 -0700 | [diff] [blame] | 64 | if (align_order <= cma->order_per_bit) |
| 65 | return 0; |
| 66 | return (1UL << (align_order - cma->order_per_bit)) - 1; |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 67 | } |
| 68 | |
Danesh Petigara | 850fc43 | 2015-03-12 16:25:57 -0700 | [diff] [blame] | 69 | /* |
Doug Berger | e048cb3 | 2017-07-10 15:49:44 -0700 | [diff] [blame] | 70 | * Find the offset of the base PFN from the specified align_order. |
| 71 | * The value returned is represented in order_per_bits. |
Danesh Petigara | 850fc43 | 2015-03-12 16:25:57 -0700 | [diff] [blame] | 72 | */ |
Sasha Levin | ac17382 | 2015-04-14 15:47:04 -0700 | [diff] [blame] | 73 | static unsigned long cma_bitmap_aligned_offset(const struct cma *cma, |
Doug Berger | e048cb3 | 2017-07-10 15:49:44 -0700 | [diff] [blame] | 74 | unsigned int align_order) |
Gregory Fong | b5be83e | 2014-12-12 16:54:48 -0800 | [diff] [blame] | 75 | { |
Doug Berger | e048cb3 | 2017-07-10 15:49:44 -0700 | [diff] [blame] | 76 | return (cma->base_pfn & ((1UL << align_order) - 1)) |
| 77 | >> cma->order_per_bit; |
Gregory Fong | b5be83e | 2014-12-12 16:54:48 -0800 | [diff] [blame] | 78 | } |
| 79 | |
Sasha Levin | ac17382 | 2015-04-14 15:47:04 -0700 | [diff] [blame] | 80 | static unsigned long cma_bitmap_pages_to_bits(const struct cma *cma, |
| 81 | unsigned long pages) |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 82 | { |
| 83 | return ALIGN(pages, 1UL << cma->order_per_bit) >> cma->order_per_bit; |
| 84 | } |
| 85 | |
Sasha Levin | ac17382 | 2015-04-14 15:47:04 -0700 | [diff] [blame] | 86 | static void cma_clear_bitmap(struct cma *cma, unsigned long pfn, |
| 87 | unsigned int count) |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 88 | { |
| 89 | unsigned long bitmap_no, bitmap_count; |
| 90 | |
| 91 | bitmap_no = (pfn - cma->base_pfn) >> cma->order_per_bit; |
| 92 | bitmap_count = cma_bitmap_pages_to_bits(cma, count); |
| 93 | |
| 94 | mutex_lock(&cma->lock); |
| 95 | bitmap_clear(cma->bitmap, bitmap_no, bitmap_count); |
| 96 | mutex_unlock(&cma->lock); |
| 97 | } |
| 98 | |
| 99 | static int __init cma_activate_area(struct cma *cma) |
| 100 | { |
| 101 | int bitmap_size = BITS_TO_LONGS(cma_bitmap_maxno(cma)) * sizeof(long); |
| 102 | unsigned long base_pfn = cma->base_pfn, pfn = base_pfn; |
| 103 | unsigned i = cma->count >> pageblock_order; |
| 104 | struct zone *zone; |
| 105 | |
| 106 | cma->bitmap = kzalloc(bitmap_size, GFP_KERNEL); |
| 107 | |
| 108 | if (!cma->bitmap) |
| 109 | return -ENOMEM; |
| 110 | |
| 111 | WARN_ON_ONCE(!pfn_valid(pfn)); |
| 112 | zone = page_zone(pfn_to_page(pfn)); |
| 113 | |
| 114 | do { |
| 115 | unsigned j; |
| 116 | |
| 117 | base_pfn = pfn; |
| 118 | for (j = pageblock_nr_pages; j; --j, pfn++) { |
| 119 | WARN_ON_ONCE(!pfn_valid(pfn)); |
| 120 | /* |
| 121 | * alloc_contig_range requires the pfn range |
| 122 | * specified to be in the same zone. Make this |
| 123 | * simple by forcing the entire CMA resv range |
| 124 | * to be in the same zone. |
| 125 | */ |
| 126 | if (page_zone(pfn_to_page(pfn)) != zone) |
Anshuman Khandual | e35ef63 | 2017-07-10 15:48:12 -0700 | [diff] [blame] | 127 | goto not_in_zone; |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 128 | } |
| 129 | init_cma_reserved_pageblock(pfn_to_page(base_pfn)); |
| 130 | } while (--i); |
| 131 | |
| 132 | mutex_init(&cma->lock); |
Sasha Levin | 26b02a1 | 2015-04-14 15:44:59 -0700 | [diff] [blame] | 133 | |
| 134 | #ifdef CONFIG_CMA_DEBUGFS |
| 135 | INIT_HLIST_HEAD(&cma->mem_head); |
| 136 | spin_lock_init(&cma->mem_head_lock); |
| 137 | #endif |
| 138 | |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 139 | return 0; |
| 140 | |
Anshuman Khandual | e35ef63 | 2017-07-10 15:48:12 -0700 | [diff] [blame] | 141 | not_in_zone: |
| 142 | pr_err("CMA area %s could not be activated\n", cma->name); |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 143 | kfree(cma->bitmap); |
Laurent Pinchart | f022d8c | 2014-10-24 13:18:39 +0300 | [diff] [blame] | 144 | cma->count = 0; |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 145 | return -EINVAL; |
| 146 | } |
| 147 | |
| 148 | static int __init cma_init_reserved_areas(void) |
| 149 | { |
| 150 | int i; |
| 151 | |
| 152 | for (i = 0; i < cma_area_count; i++) { |
| 153 | int ret = cma_activate_area(&cma_areas[i]); |
| 154 | |
| 155 | if (ret) |
| 156 | return ret; |
| 157 | } |
| 158 | |
| 159 | return 0; |
| 160 | } |
| 161 | core_initcall(cma_init_reserved_areas); |
| 162 | |
| 163 | /** |
Marek Szyprowski | de9e14e | 2014-10-13 15:51:09 -0700 | [diff] [blame] | 164 | * cma_init_reserved_mem() - create custom contiguous area from reserved memory |
| 165 | * @base: Base address of the reserved area |
| 166 | * @size: Size of the reserved area (in bytes), |
| 167 | * @order_per_bit: Order of pages represented by one bit on bitmap. |
| 168 | * @res_cma: Pointer to store the created cma region. |
| 169 | * |
| 170 | * This function creates custom contiguous area from already reserved memory. |
| 171 | */ |
| 172 | int __init cma_init_reserved_mem(phys_addr_t base, phys_addr_t size, |
Sasha Levin | ac17382 | 2015-04-14 15:47:04 -0700 | [diff] [blame] | 173 | unsigned int order_per_bit, |
Laura Abbott | f318dd0 | 2017-04-18 11:27:03 -0700 | [diff] [blame] | 174 | const char *name, |
Sasha Levin | ac17382 | 2015-04-14 15:47:04 -0700 | [diff] [blame] | 175 | struct cma **res_cma) |
Marek Szyprowski | de9e14e | 2014-10-13 15:51:09 -0700 | [diff] [blame] | 176 | { |
| 177 | struct cma *cma; |
| 178 | phys_addr_t alignment; |
| 179 | |
| 180 | /* Sanity checks */ |
| 181 | if (cma_area_count == ARRAY_SIZE(cma_areas)) { |
| 182 | pr_err("Not enough slots for CMA reserved regions!\n"); |
| 183 | return -ENOSPC; |
| 184 | } |
| 185 | |
| 186 | if (!size || !memblock_is_region_reserved(base, size)) |
| 187 | return -EINVAL; |
| 188 | |
Shailendra Verma | 0f96ae2 | 2015-06-24 16:58:03 -0700 | [diff] [blame] | 189 | /* ensure minimal alignment required by mm core */ |
Stephen Rothwell | badbda5 | 2016-05-27 14:27:41 -0700 | [diff] [blame] | 190 | alignment = PAGE_SIZE << |
| 191 | max_t(unsigned long, MAX_ORDER - 1, pageblock_order); |
Marek Szyprowski | de9e14e | 2014-10-13 15:51:09 -0700 | [diff] [blame] | 192 | |
| 193 | /* alignment should be aligned with order_per_bit */ |
| 194 | if (!IS_ALIGNED(alignment >> PAGE_SHIFT, 1 << order_per_bit)) |
| 195 | return -EINVAL; |
| 196 | |
| 197 | if (ALIGN(base, alignment) != base || ALIGN(size, alignment) != size) |
| 198 | return -EINVAL; |
| 199 | |
| 200 | /* |
| 201 | * Each reserved area must be initialised later, when more kernel |
| 202 | * subsystems (like slab allocator) are available. |
| 203 | */ |
| 204 | cma = &cma_areas[cma_area_count]; |
Laura Abbott | f318dd0 | 2017-04-18 11:27:03 -0700 | [diff] [blame] | 205 | if (name) { |
| 206 | cma->name = name; |
| 207 | } else { |
| 208 | cma->name = kasprintf(GFP_KERNEL, "cma%d\n", cma_area_count); |
| 209 | if (!cma->name) |
| 210 | return -ENOMEM; |
| 211 | } |
Marek Szyprowski | de9e14e | 2014-10-13 15:51:09 -0700 | [diff] [blame] | 212 | cma->base_pfn = PFN_DOWN(base); |
| 213 | cma->count = size >> PAGE_SHIFT; |
| 214 | cma->order_per_bit = order_per_bit; |
| 215 | *res_cma = cma; |
| 216 | cma_area_count++; |
George G. Davis | 94737a8 | 2015-02-11 15:26:27 -0800 | [diff] [blame] | 217 | totalcma_pages += (size / PAGE_SIZE); |
Marek Szyprowski | de9e14e | 2014-10-13 15:51:09 -0700 | [diff] [blame] | 218 | |
| 219 | return 0; |
| 220 | } |
| 221 | |
| 222 | /** |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 223 | * cma_declare_contiguous() - reserve custom contiguous area |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 224 | * @base: Base address of the reserved area optional, use 0 for any |
Joonsoo Kim | c1f733a | 2014-08-06 16:05:32 -0700 | [diff] [blame] | 225 | * @size: Size of the reserved area (in bytes), |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 226 | * @limit: End address of the reserved memory (optional, 0 for any). |
| 227 | * @alignment: Alignment for the CMA area, should be power of 2 or zero |
| 228 | * @order_per_bit: Order of pages represented by one bit on bitmap. |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 229 | * @fixed: hint about where to place the reserved area |
Joonsoo Kim | c1f733a | 2014-08-06 16:05:32 -0700 | [diff] [blame] | 230 | * @res_cma: Pointer to store the created cma region. |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 231 | * |
| 232 | * This function reserves memory from early allocator. It should be |
| 233 | * called by arch specific code once the early allocator (memblock or bootmem) |
| 234 | * has been activated and all other subsystems have already allocated/reserved |
| 235 | * memory. This function allows to create custom reserved areas. |
| 236 | * |
| 237 | * If @fixed is true, reserve contiguous area at exactly @base. If false, |
| 238 | * reserve in range from @base to @limit. |
| 239 | */ |
Joonsoo Kim | c1f733a | 2014-08-06 16:05:32 -0700 | [diff] [blame] | 240 | int __init cma_declare_contiguous(phys_addr_t base, |
| 241 | phys_addr_t size, phys_addr_t limit, |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 242 | phys_addr_t alignment, unsigned int order_per_bit, |
Laura Abbott | f318dd0 | 2017-04-18 11:27:03 -0700 | [diff] [blame] | 243 | bool fixed, const char *name, struct cma **res_cma) |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 244 | { |
Marek Szyprowski | f7426b9 | 2014-10-09 15:26:47 -0700 | [diff] [blame] | 245 | phys_addr_t memblock_end = memblock_end_of_DRAM(); |
Joonsoo Kim | 6b101e2 | 2014-12-10 15:41:12 -0800 | [diff] [blame] | 246 | phys_addr_t highmem_start; |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 247 | int ret = 0; |
| 248 | |
Joonsoo Kim | 6b101e2 | 2014-12-10 15:41:12 -0800 | [diff] [blame] | 249 | /* |
Laura Abbott | 2dece44 | 2017-01-10 13:35:41 -0800 | [diff] [blame] | 250 | * We can't use __pa(high_memory) directly, since high_memory |
| 251 | * isn't a valid direct map VA, and DEBUG_VIRTUAL will (validly) |
| 252 | * complain. Find the boundary by adding one to the last valid |
| 253 | * address. |
Joonsoo Kim | 6b101e2 | 2014-12-10 15:41:12 -0800 | [diff] [blame] | 254 | */ |
Laura Abbott | 2dece44 | 2017-01-10 13:35:41 -0800 | [diff] [blame] | 255 | highmem_start = __pa(high_memory - 1) + 1; |
Laurent Pinchart | 56fa4f6 | 2014-10-24 13:18:42 +0300 | [diff] [blame] | 256 | pr_debug("%s(size %pa, base %pa, limit %pa alignment %pa)\n", |
| 257 | __func__, &size, &base, &limit, &alignment); |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 258 | |
| 259 | if (cma_area_count == ARRAY_SIZE(cma_areas)) { |
| 260 | pr_err("Not enough slots for CMA reserved regions!\n"); |
| 261 | return -ENOSPC; |
| 262 | } |
| 263 | |
| 264 | if (!size) |
| 265 | return -EINVAL; |
| 266 | |
| 267 | if (alignment && !is_power_of_2(alignment)) |
| 268 | return -EINVAL; |
| 269 | |
| 270 | /* |
| 271 | * Sanitise input arguments. |
| 272 | * Pages both ends in CMA area could be merged into adjacent unmovable |
| 273 | * migratetype page by page allocator's buddy algorithm. In the case, |
| 274 | * you couldn't get a contiguous memory, which is not what we want. |
| 275 | */ |
Stephen Rothwell | badbda5 | 2016-05-27 14:27:41 -0700 | [diff] [blame] | 276 | alignment = max(alignment, (phys_addr_t)PAGE_SIZE << |
| 277 | max_t(unsigned long, MAX_ORDER - 1, pageblock_order)); |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 278 | base = ALIGN(base, alignment); |
| 279 | size = ALIGN(size, alignment); |
| 280 | limit &= ~(alignment - 1); |
| 281 | |
Laurent Pinchart | 800a85d | 2014-10-24 13:18:40 +0300 | [diff] [blame] | 282 | if (!base) |
| 283 | fixed = false; |
| 284 | |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 285 | /* size should be aligned with order_per_bit */ |
| 286 | if (!IS_ALIGNED(size >> PAGE_SHIFT, 1 << order_per_bit)) |
| 287 | return -EINVAL; |
| 288 | |
Marek Szyprowski | f7426b9 | 2014-10-09 15:26:47 -0700 | [diff] [blame] | 289 | /* |
Laurent Pinchart | 16195dd | 2014-10-24 13:18:41 +0300 | [diff] [blame] | 290 | * If allocating at a fixed base the request region must not cross the |
| 291 | * low/high memory boundary. |
Marek Szyprowski | f7426b9 | 2014-10-09 15:26:47 -0700 | [diff] [blame] | 292 | */ |
Laurent Pinchart | 16195dd | 2014-10-24 13:18:41 +0300 | [diff] [blame] | 293 | if (fixed && base < highmem_start && base + size > highmem_start) { |
Marek Szyprowski | f7426b9 | 2014-10-09 15:26:47 -0700 | [diff] [blame] | 294 | ret = -EINVAL; |
Laurent Pinchart | 56fa4f6 | 2014-10-24 13:18:42 +0300 | [diff] [blame] | 295 | pr_err("Region at %pa defined on low/high memory boundary (%pa)\n", |
| 296 | &base, &highmem_start); |
Marek Szyprowski | f7426b9 | 2014-10-09 15:26:47 -0700 | [diff] [blame] | 297 | goto err; |
| 298 | } |
| 299 | |
Laurent Pinchart | 16195dd | 2014-10-24 13:18:41 +0300 | [diff] [blame] | 300 | /* |
| 301 | * If the limit is unspecified or above the memblock end, its effective |
| 302 | * value will be the memblock end. Set it explicitly to simplify further |
| 303 | * checks. |
| 304 | */ |
| 305 | if (limit == 0 || limit > memblock_end) |
| 306 | limit = memblock_end; |
| 307 | |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 308 | /* Reserve memory */ |
Laurent Pinchart | 800a85d | 2014-10-24 13:18:40 +0300 | [diff] [blame] | 309 | if (fixed) { |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 310 | if (memblock_is_region_reserved(base, size) || |
| 311 | memblock_reserve(base, size) < 0) { |
| 312 | ret = -EBUSY; |
| 313 | goto err; |
| 314 | } |
| 315 | } else { |
Laurent Pinchart | 16195dd | 2014-10-24 13:18:41 +0300 | [diff] [blame] | 316 | phys_addr_t addr = 0; |
| 317 | |
| 318 | /* |
| 319 | * All pages in the reserved area must come from the same zone. |
| 320 | * If the requested region crosses the low/high memory boundary, |
| 321 | * try allocating from high memory first and fall back to low |
| 322 | * memory in case of failure. |
| 323 | */ |
| 324 | if (base < highmem_start && limit > highmem_start) { |
| 325 | addr = memblock_alloc_range(size, alignment, |
Tony Luck | fc6daaf | 2015-06-24 16:58:09 -0700 | [diff] [blame] | 326 | highmem_start, limit, |
| 327 | MEMBLOCK_NONE); |
Laurent Pinchart | 16195dd | 2014-10-24 13:18:41 +0300 | [diff] [blame] | 328 | limit = highmem_start; |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 329 | } |
Laurent Pinchart | 16195dd | 2014-10-24 13:18:41 +0300 | [diff] [blame] | 330 | |
| 331 | if (!addr) { |
| 332 | addr = memblock_alloc_range(size, alignment, base, |
Tony Luck | fc6daaf | 2015-06-24 16:58:09 -0700 | [diff] [blame] | 333 | limit, |
| 334 | MEMBLOCK_NONE); |
Laurent Pinchart | 16195dd | 2014-10-24 13:18:41 +0300 | [diff] [blame] | 335 | if (!addr) { |
| 336 | ret = -ENOMEM; |
| 337 | goto err; |
| 338 | } |
| 339 | } |
| 340 | |
Thierry Reding | 620951e | 2014-12-12 16:58:31 -0800 | [diff] [blame] | 341 | /* |
| 342 | * kmemleak scans/reads tracked objects for pointers to other |
| 343 | * objects but this address isn't mapped and accessible |
| 344 | */ |
Catalin Marinas | 9099dae | 2016-10-11 13:55:11 -0700 | [diff] [blame] | 345 | kmemleak_ignore_phys(addr); |
Laurent Pinchart | 16195dd | 2014-10-24 13:18:41 +0300 | [diff] [blame] | 346 | base = addr; |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 347 | } |
| 348 | |
Laura Abbott | f318dd0 | 2017-04-18 11:27:03 -0700 | [diff] [blame] | 349 | ret = cma_init_reserved_mem(base, size, order_per_bit, name, res_cma); |
Marek Szyprowski | de9e14e | 2014-10-13 15:51:09 -0700 | [diff] [blame] | 350 | if (ret) |
| 351 | goto err; |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 352 | |
Laurent Pinchart | 56fa4f6 | 2014-10-24 13:18:42 +0300 | [diff] [blame] | 353 | pr_info("Reserved %ld MiB at %pa\n", (unsigned long)size / SZ_1M, |
| 354 | &base); |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 355 | return 0; |
| 356 | |
| 357 | err: |
Joonsoo Kim | 0de9d2e | 2014-08-06 16:05:34 -0700 | [diff] [blame] | 358 | pr_err("Failed to reserve %ld MiB\n", (unsigned long)size / SZ_1M); |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 359 | return ret; |
| 360 | } |
| 361 | |
Jaewon Kim | dbe43d4 | 2017-02-24 14:58:50 -0800 | [diff] [blame] | 362 | #ifdef CONFIG_CMA_DEBUG |
| 363 | static void cma_debug_show_areas(struct cma *cma) |
| 364 | { |
| 365 | unsigned long next_zero_bit, next_set_bit; |
| 366 | unsigned long start = 0; |
| 367 | unsigned int nr_zero, nr_total = 0; |
| 368 | |
| 369 | mutex_lock(&cma->lock); |
| 370 | pr_info("number of available pages: "); |
| 371 | for (;;) { |
| 372 | next_zero_bit = find_next_zero_bit(cma->bitmap, cma->count, start); |
| 373 | if (next_zero_bit >= cma->count) |
| 374 | break; |
| 375 | next_set_bit = find_next_bit(cma->bitmap, cma->count, next_zero_bit); |
| 376 | nr_zero = next_set_bit - next_zero_bit; |
| 377 | pr_cont("%s%u@%lu", nr_total ? "+" : "", nr_zero, next_zero_bit); |
| 378 | nr_total += nr_zero; |
| 379 | start = next_zero_bit + nr_zero; |
| 380 | } |
| 381 | pr_cont("=> %u free of %lu total pages\n", nr_total, cma->count); |
| 382 | mutex_unlock(&cma->lock); |
| 383 | } |
| 384 | #else |
| 385 | static inline void cma_debug_show_areas(struct cma *cma) { } |
| 386 | #endif |
| 387 | |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 388 | /** |
| 389 | * cma_alloc() - allocate pages from contiguous area |
| 390 | * @cma: Contiguous memory region for which the allocation is performed. |
| 391 | * @count: Requested number of pages. |
| 392 | * @align: Requested alignment of pages (in PAGE_SIZE order). |
| 393 | * |
| 394 | * This function allocates part of contiguous memory on specific |
| 395 | * contiguous memory area. |
| 396 | */ |
Lucas Stach | e2f466e | 2017-02-24 14:58:41 -0800 | [diff] [blame] | 397 | struct page *cma_alloc(struct cma *cma, size_t count, unsigned int align, |
| 398 | gfp_t gfp_mask) |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 399 | { |
Andrew Morton | 3acaea6 | 2015-11-05 18:50:08 -0800 | [diff] [blame] | 400 | unsigned long mask, offset; |
| 401 | unsigned long pfn = -1; |
| 402 | unsigned long start = 0; |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 403 | unsigned long bitmap_maxno, bitmap_no, bitmap_count; |
| 404 | struct page *page = NULL; |
Jaewon Kim | dbe43d4 | 2017-02-24 14:58:50 -0800 | [diff] [blame] | 405 | int ret = -ENOMEM; |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 406 | |
| 407 | if (!cma || !cma->count) |
| 408 | return NULL; |
| 409 | |
Rohit Vaswani | 67a2e213 | 2015-10-22 13:32:11 -0700 | [diff] [blame] | 410 | pr_debug("%s(cma %p, count %zu, align %d)\n", __func__, (void *)cma, |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 411 | count, align); |
| 412 | |
| 413 | if (!count) |
| 414 | return NULL; |
| 415 | |
| 416 | mask = cma_bitmap_aligned_mask(cma, align); |
Gregory Fong | b5be83e | 2014-12-12 16:54:48 -0800 | [diff] [blame] | 417 | offset = cma_bitmap_aligned_offset(cma, align); |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 418 | bitmap_maxno = cma_bitmap_maxno(cma); |
| 419 | bitmap_count = cma_bitmap_pages_to_bits(cma, count); |
| 420 | |
Shiraz Hashim | 6b36ba5 | 2016-11-10 10:46:16 -0800 | [diff] [blame] | 421 | if (bitmap_count > bitmap_maxno) |
| 422 | return NULL; |
| 423 | |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 424 | for (;;) { |
| 425 | mutex_lock(&cma->lock); |
Gregory Fong | b5be83e | 2014-12-12 16:54:48 -0800 | [diff] [blame] | 426 | bitmap_no = bitmap_find_next_zero_area_off(cma->bitmap, |
| 427 | bitmap_maxno, start, bitmap_count, mask, |
| 428 | offset); |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 429 | if (bitmap_no >= bitmap_maxno) { |
| 430 | mutex_unlock(&cma->lock); |
| 431 | break; |
| 432 | } |
| 433 | bitmap_set(cma->bitmap, bitmap_no, bitmap_count); |
| 434 | /* |
| 435 | * It's safe to drop the lock here. We've marked this region for |
| 436 | * our exclusive use. If the migration fails we will take the |
| 437 | * lock again and unmark it. |
| 438 | */ |
| 439 | mutex_unlock(&cma->lock); |
| 440 | |
| 441 | pfn = cma->base_pfn + (bitmap_no << cma->order_per_bit); |
| 442 | mutex_lock(&cma_mutex); |
Lucas Stach | ca96b62 | 2017-02-24 14:58:37 -0800 | [diff] [blame] | 443 | ret = alloc_contig_range(pfn, pfn + count, MIGRATE_CMA, |
Lucas Stach | e2f466e | 2017-02-24 14:58:41 -0800 | [diff] [blame] | 444 | gfp_mask); |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 445 | mutex_unlock(&cma_mutex); |
| 446 | if (ret == 0) { |
| 447 | page = pfn_to_page(pfn); |
| 448 | break; |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 449 | } |
Joonsoo Kim | b7155e7 | 2014-08-06 16:05:30 -0700 | [diff] [blame] | 450 | |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 451 | cma_clear_bitmap(cma, pfn, count); |
Joonsoo Kim | b7155e7 | 2014-08-06 16:05:30 -0700 | [diff] [blame] | 452 | if (ret != -EBUSY) |
| 453 | break; |
| 454 | |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 455 | pr_debug("%s(): memory range at %p is busy, retrying\n", |
| 456 | __func__, pfn_to_page(pfn)); |
| 457 | /* try again with a bit different memory target */ |
| 458 | start = bitmap_no + mask + 1; |
| 459 | } |
| 460 | |
Andrew Morton | 3acaea6 | 2015-11-05 18:50:08 -0800 | [diff] [blame] | 461 | trace_cma_alloc(pfn, page, count, align); |
Stefan Strogin | 99e8ea6 | 2015-04-15 16:14:50 -0700 | [diff] [blame] | 462 | |
Jaewon Kim | dbe43d4 | 2017-02-24 14:58:50 -0800 | [diff] [blame] | 463 | if (ret) { |
| 464 | pr_info("%s: alloc failed, req-size: %zu pages, ret: %d\n", |
| 465 | __func__, count, ret); |
| 466 | cma_debug_show_areas(cma); |
| 467 | } |
| 468 | |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 469 | pr_debug("%s(): returned %p\n", __func__, page); |
| 470 | return page; |
| 471 | } |
| 472 | |
| 473 | /** |
| 474 | * cma_release() - release allocated pages |
| 475 | * @cma: Contiguous memory region for which the allocation is performed. |
| 476 | * @pages: Allocated pages. |
| 477 | * @count: Number of allocated pages. |
| 478 | * |
| 479 | * This function releases memory allocated by alloc_cma(). |
| 480 | * It returns false when provided pages do not belong to contiguous area and |
| 481 | * true otherwise. |
| 482 | */ |
Sasha Levin | ac17382 | 2015-04-14 15:47:04 -0700 | [diff] [blame] | 483 | bool cma_release(struct cma *cma, const struct page *pages, unsigned int count) |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 484 | { |
| 485 | unsigned long pfn; |
| 486 | |
| 487 | if (!cma || !pages) |
| 488 | return false; |
| 489 | |
| 490 | pr_debug("%s(page %p)\n", __func__, (void *)pages); |
| 491 | |
| 492 | pfn = page_to_pfn(pages); |
| 493 | |
| 494 | if (pfn < cma->base_pfn || pfn >= cma->base_pfn + cma->count) |
| 495 | return false; |
| 496 | |
| 497 | VM_BUG_ON(pfn + count > cma->base_pfn + cma->count); |
| 498 | |
| 499 | free_contig_range(pfn, count); |
| 500 | cma_clear_bitmap(cma, pfn, count); |
Stefan Strogin | 99e8ea6 | 2015-04-15 16:14:50 -0700 | [diff] [blame] | 501 | trace_cma_release(pfn, pages, count); |
Joonsoo Kim | a254129 | 2014-08-06 16:05:25 -0700 | [diff] [blame] | 502 | |
| 503 | return true; |
| 504 | } |
Laura Abbott | e4231bc | 2017-04-18 11:27:04 -0700 | [diff] [blame] | 505 | |
| 506 | int cma_for_each_area(int (*it)(struct cma *cma, void *data), void *data) |
| 507 | { |
| 508 | int i; |
| 509 | |
| 510 | for (i = 0; i < cma_area_count; i++) { |
| 511 | int ret = it(&cma_areas[i], data); |
| 512 | |
| 513 | if (ret) |
| 514 | return ret; |
| 515 | } |
| 516 | |
| 517 | return 0; |
| 518 | } |