• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  *  Copyright (C) 1993  Linus Torvalds
4  *  Support of BIGMEM added by Gerhard Wichert, Siemens AG, July 1999
5  *  SMP-safe vmalloc/vfree/ioremap, Tigran Aivazian <tigran@veritas.com>, May 2000
6  *  Major rework to support vmap/vunmap, Christoph Hellwig, SGI, August 2002
7  *  Numa awareness, Christoph Lameter, SGI, June 2005
8  *  Improving global KVA allocator, Uladzislau Rezki, Sony, May 2019
9  */
10 
11 #include <linux/vmalloc.h>
12 #include <linux/mm.h>
13 #include <linux/module.h>
14 #include <linux/highmem.h>
15 #include <linux/sched/signal.h>
16 #include <linux/slab.h>
17 #include <linux/spinlock.h>
18 #include <linux/interrupt.h>
19 #include <linux/proc_fs.h>
20 #include <linux/seq_file.h>
21 #include <linux/set_memory.h>
22 #include <linux/debugobjects.h>
23 #include <linux/kallsyms.h>
24 #include <linux/list.h>
25 #include <linux/notifier.h>
26 #include <linux/rbtree.h>
27 #include <linux/xarray.h>
28 #include <linux/rcupdate.h>
29 #include <linux/pfn.h>
30 #include <linux/kmemleak.h>
31 #include <linux/atomic.h>
32 #include <linux/compiler.h>
33 #include <linux/llist.h>
34 #include <linux/bitops.h>
35 #include <linux/rbtree_augmented.h>
36 #include <linux/overflow.h>
37 
38 #include <linux/uaccess.h>
39 #include <asm/tlbflush.h>
40 #include <asm/shmparam.h>
41 
42 #include "internal.h"
43 #include "pgalloc-track.h"
44 
is_vmalloc_addr(const void * x)45 bool is_vmalloc_addr(const void *x)
46 {
47 	unsigned long addr = (unsigned long)x;
48 
49 	return addr >= VMALLOC_START && addr < VMALLOC_END;
50 }
51 EXPORT_SYMBOL(is_vmalloc_addr);
52 
53 struct vfree_deferred {
54 	struct llist_head list;
55 	struct work_struct wq;
56 };
57 static DEFINE_PER_CPU(struct vfree_deferred, vfree_deferred);
58 
59 static void __vunmap(const void *, int);
60 
free_work(struct work_struct * w)61 static void free_work(struct work_struct *w)
62 {
63 	struct vfree_deferred *p = container_of(w, struct vfree_deferred, wq);
64 	struct llist_node *t, *llnode;
65 
66 	llist_for_each_safe(llnode, t, llist_del_all(&p->list))
67 		__vunmap((void *)llnode, 1);
68 }
69 
70 /*** Page table manipulation functions ***/
71 
vunmap_pte_range(pmd_t * pmd,unsigned long addr,unsigned long end,pgtbl_mod_mask * mask)72 static void vunmap_pte_range(pmd_t *pmd, unsigned long addr, unsigned long end,
73 			     pgtbl_mod_mask *mask)
74 {
75 	pte_t *pte;
76 
77 	pte = pte_offset_kernel(pmd, addr);
78 	do {
79 		pte_t ptent = ptep_get_and_clear(&init_mm, addr, pte);
80 		WARN_ON(!pte_none(ptent) && !pte_present(ptent));
81 	} while (pte++, addr += PAGE_SIZE, addr != end);
82 	*mask |= PGTBL_PTE_MODIFIED;
83 }
84 
vunmap_pmd_range(pud_t * pud,unsigned long addr,unsigned long end,pgtbl_mod_mask * mask)85 static void vunmap_pmd_range(pud_t *pud, unsigned long addr, unsigned long end,
86 			     pgtbl_mod_mask *mask)
87 {
88 	pmd_t *pmd;
89 	unsigned long next;
90 	int cleared;
91 
92 	pmd = pmd_offset(pud, addr);
93 	do {
94 		next = pmd_addr_end(addr, end);
95 
96 		cleared = pmd_clear_huge(pmd);
97 		if (cleared || pmd_bad(*pmd))
98 			*mask |= PGTBL_PMD_MODIFIED;
99 
100 		if (cleared)
101 			continue;
102 		if (pmd_none_or_clear_bad(pmd))
103 			continue;
104 		vunmap_pte_range(pmd, addr, next, mask);
105 
106 		cond_resched();
107 	} while (pmd++, addr = next, addr != end);
108 }
109 
vunmap_pud_range(p4d_t * p4d,unsigned long addr,unsigned long end,pgtbl_mod_mask * mask)110 static void vunmap_pud_range(p4d_t *p4d, unsigned long addr, unsigned long end,
111 			     pgtbl_mod_mask *mask)
112 {
113 	pud_t *pud;
114 	unsigned long next;
115 	int cleared;
116 
117 	pud = pud_offset(p4d, addr);
118 	do {
119 		next = pud_addr_end(addr, end);
120 
121 		cleared = pud_clear_huge(pud);
122 		if (cleared || pud_bad(*pud))
123 			*mask |= PGTBL_PUD_MODIFIED;
124 
125 		if (cleared)
126 			continue;
127 		if (pud_none_or_clear_bad(pud))
128 			continue;
129 		vunmap_pmd_range(pud, addr, next, mask);
130 	} while (pud++, addr = next, addr != end);
131 }
132 
vunmap_p4d_range(pgd_t * pgd,unsigned long addr,unsigned long end,pgtbl_mod_mask * mask)133 static void vunmap_p4d_range(pgd_t *pgd, unsigned long addr, unsigned long end,
134 			     pgtbl_mod_mask *mask)
135 {
136 	p4d_t *p4d;
137 	unsigned long next;
138 	int cleared;
139 
140 	p4d = p4d_offset(pgd, addr);
141 	do {
142 		next = p4d_addr_end(addr, end);
143 
144 		cleared = p4d_clear_huge(p4d);
145 		if (cleared || p4d_bad(*p4d))
146 			*mask |= PGTBL_P4D_MODIFIED;
147 
148 		if (cleared)
149 			continue;
150 		if (p4d_none_or_clear_bad(p4d))
151 			continue;
152 		vunmap_pud_range(p4d, addr, next, mask);
153 	} while (p4d++, addr = next, addr != end);
154 }
155 
156 /**
157  * unmap_kernel_range_noflush - unmap kernel VM area
158  * @start: start of the VM area to unmap
159  * @size: size of the VM area to unmap
160  *
161  * Unmap PFN_UP(@size) pages at @addr.  The VM area @addr and @size specify
162  * should have been allocated using get_vm_area() and its friends.
163  *
164  * NOTE:
165  * This function does NOT do any cache flushing.  The caller is responsible
166  * for calling flush_cache_vunmap() on to-be-mapped areas before calling this
167  * function and flush_tlb_kernel_range() after.
168  */
unmap_kernel_range_noflush(unsigned long start,unsigned long size)169 void unmap_kernel_range_noflush(unsigned long start, unsigned long size)
170 {
171 	unsigned long end = start + size;
172 	unsigned long next;
173 	pgd_t *pgd;
174 	unsigned long addr = start;
175 	pgtbl_mod_mask mask = 0;
176 
177 	BUG_ON(addr >= end);
178 	pgd = pgd_offset_k(addr);
179 	do {
180 		next = pgd_addr_end(addr, end);
181 		if (pgd_bad(*pgd))
182 			mask |= PGTBL_PGD_MODIFIED;
183 		if (pgd_none_or_clear_bad(pgd))
184 			continue;
185 		vunmap_p4d_range(pgd, addr, next, &mask);
186 	} while (pgd++, addr = next, addr != end);
187 
188 	if (mask & ARCH_PAGE_TABLE_SYNC_MASK)
189 		arch_sync_kernel_mappings(start, end);
190 }
191 
vmap_pte_range(pmd_t * pmd,unsigned long addr,unsigned long end,pgprot_t prot,struct page ** pages,int * nr,pgtbl_mod_mask * mask)192 static int vmap_pte_range(pmd_t *pmd, unsigned long addr,
193 		unsigned long end, pgprot_t prot, struct page **pages, int *nr,
194 		pgtbl_mod_mask *mask)
195 {
196 	pte_t *pte;
197 
198 	/*
199 	 * nr is a running index into the array which helps higher level
200 	 * callers keep track of where we're up to.
201 	 */
202 
203 	pte = pte_alloc_kernel_track(pmd, addr, mask);
204 	if (!pte)
205 		return -ENOMEM;
206 	do {
207 		struct page *page = pages[*nr];
208 
209 		if (WARN_ON(!pte_none(*pte)))
210 			return -EBUSY;
211 		if (WARN_ON(!page))
212 			return -ENOMEM;
213 		set_pte_at(&init_mm, addr, pte, mk_pte(page, prot));
214 		(*nr)++;
215 	} while (pte++, addr += PAGE_SIZE, addr != end);
216 	*mask |= PGTBL_PTE_MODIFIED;
217 	return 0;
218 }
219 
vmap_pmd_range(pud_t * pud,unsigned long addr,unsigned long end,pgprot_t prot,struct page ** pages,int * nr,pgtbl_mod_mask * mask)220 static int vmap_pmd_range(pud_t *pud, unsigned long addr,
221 		unsigned long end, pgprot_t prot, struct page **pages, int *nr,
222 		pgtbl_mod_mask *mask)
223 {
224 	pmd_t *pmd;
225 	unsigned long next;
226 
227 	pmd = pmd_alloc_track(&init_mm, pud, addr, mask);
228 	if (!pmd)
229 		return -ENOMEM;
230 	do {
231 		next = pmd_addr_end(addr, end);
232 		if (vmap_pte_range(pmd, addr, next, prot, pages, nr, mask))
233 			return -ENOMEM;
234 	} while (pmd++, addr = next, addr != end);
235 	return 0;
236 }
237 
vmap_pud_range(p4d_t * p4d,unsigned long addr,unsigned long end,pgprot_t prot,struct page ** pages,int * nr,pgtbl_mod_mask * mask)238 static int vmap_pud_range(p4d_t *p4d, unsigned long addr,
239 		unsigned long end, pgprot_t prot, struct page **pages, int *nr,
240 		pgtbl_mod_mask *mask)
241 {
242 	pud_t *pud;
243 	unsigned long next;
244 
245 	pud = pud_alloc_track(&init_mm, p4d, addr, mask);
246 	if (!pud)
247 		return -ENOMEM;
248 	do {
249 		next = pud_addr_end(addr, end);
250 		if (vmap_pmd_range(pud, addr, next, prot, pages, nr, mask))
251 			return -ENOMEM;
252 	} while (pud++, addr = next, addr != end);
253 	return 0;
254 }
255 
vmap_p4d_range(pgd_t * pgd,unsigned long addr,unsigned long end,pgprot_t prot,struct page ** pages,int * nr,pgtbl_mod_mask * mask)256 static int vmap_p4d_range(pgd_t *pgd, unsigned long addr,
257 		unsigned long end, pgprot_t prot, struct page **pages, int *nr,
258 		pgtbl_mod_mask *mask)
259 {
260 	p4d_t *p4d;
261 	unsigned long next;
262 
263 	p4d = p4d_alloc_track(&init_mm, pgd, addr, mask);
264 	if (!p4d)
265 		return -ENOMEM;
266 	do {
267 		next = p4d_addr_end(addr, end);
268 		if (vmap_pud_range(p4d, addr, next, prot, pages, nr, mask))
269 			return -ENOMEM;
270 	} while (p4d++, addr = next, addr != end);
271 	return 0;
272 }
273 
274 /**
275  * map_kernel_range_noflush - map kernel VM area with the specified pages
276  * @addr: start of the VM area to map
277  * @size: size of the VM area to map
278  * @prot: page protection flags to use
279  * @pages: pages to map
280  *
281  * Map PFN_UP(@size) pages at @addr.  The VM area @addr and @size specify should
282  * have been allocated using get_vm_area() and its friends.
283  *
284  * NOTE:
285  * This function does NOT do any cache flushing.  The caller is responsible for
286  * calling flush_cache_vmap() on to-be-mapped areas before calling this
287  * function.
288  *
289  * RETURNS:
290  * 0 on success, -errno on failure.
291  */
map_kernel_range_noflush(unsigned long addr,unsigned long size,pgprot_t prot,struct page ** pages)292 int map_kernel_range_noflush(unsigned long addr, unsigned long size,
293 			     pgprot_t prot, struct page **pages)
294 {
295 	unsigned long start = addr;
296 	unsigned long end = addr + size;
297 	unsigned long next;
298 	pgd_t *pgd;
299 	int err = 0;
300 	int nr = 0;
301 	pgtbl_mod_mask mask = 0;
302 
303 	BUG_ON(addr >= end);
304 	pgd = pgd_offset_k(addr);
305 	do {
306 		next = pgd_addr_end(addr, end);
307 		if (pgd_bad(*pgd))
308 			mask |= PGTBL_PGD_MODIFIED;
309 		err = vmap_p4d_range(pgd, addr, next, prot, pages, &nr, &mask);
310 		if (err)
311 			return err;
312 	} while (pgd++, addr = next, addr != end);
313 
314 	if (mask & ARCH_PAGE_TABLE_SYNC_MASK)
315 		arch_sync_kernel_mappings(start, end);
316 
317 	return 0;
318 }
319 
map_kernel_range(unsigned long start,unsigned long size,pgprot_t prot,struct page ** pages)320 int map_kernel_range(unsigned long start, unsigned long size, pgprot_t prot,
321 		struct page **pages)
322 {
323 	int ret;
324 
325 	ret = map_kernel_range_noflush(start, size, prot, pages);
326 	flush_cache_vmap(start, start + size);
327 	return ret;
328 }
329 
is_vmalloc_or_module_addr(const void * x)330 int is_vmalloc_or_module_addr(const void *x)
331 {
332 	/*
333 	 * ARM, x86-64 and sparc64 put modules in a special place,
334 	 * and fall back on vmalloc() if that fails. Others
335 	 * just put it in the vmalloc space.
336 	 */
337 #if defined(CONFIG_MODULES) && defined(MODULES_VADDR)
338 	unsigned long addr = (unsigned long)x;
339 	if (addr >= MODULES_VADDR && addr < MODULES_END)
340 		return 1;
341 #endif
342 	return is_vmalloc_addr(x);
343 }
344 
345 /*
346  * Walk a vmap address to the struct page it maps.
347  */
vmalloc_to_page(const void * vmalloc_addr)348 struct page *vmalloc_to_page(const void *vmalloc_addr)
349 {
350 	unsigned long addr = (unsigned long) vmalloc_addr;
351 	struct page *page = NULL;
352 	pgd_t *pgd = pgd_offset_k(addr);
353 	p4d_t *p4d;
354 	pud_t *pud;
355 	pmd_t *pmd;
356 	pte_t *ptep, pte;
357 
358 	/*
359 	 * XXX we might need to change this if we add VIRTUAL_BUG_ON for
360 	 * architectures that do not vmalloc module space
361 	 */
362 	VIRTUAL_BUG_ON(!is_vmalloc_or_module_addr(vmalloc_addr));
363 
364 	if (pgd_none(*pgd))
365 		return NULL;
366 	p4d = p4d_offset(pgd, addr);
367 	if (p4d_none(*p4d))
368 		return NULL;
369 	pud = pud_offset(p4d, addr);
370 
371 	/*
372 	 * Don't dereference bad PUD or PMD (below) entries. This will also
373 	 * identify huge mappings, which we may encounter on architectures
374 	 * that define CONFIG_HAVE_ARCH_HUGE_VMAP=y. Such regions will be
375 	 * identified as vmalloc addresses by is_vmalloc_addr(), but are
376 	 * not [unambiguously] associated with a struct page, so there is
377 	 * no correct value to return for them.
378 	 */
379 	WARN_ON_ONCE(pud_bad(*pud));
380 	if (pud_none(*pud) || pud_bad(*pud))
381 		return NULL;
382 	pmd = pmd_offset(pud, addr);
383 	WARN_ON_ONCE(pmd_bad(*pmd));
384 	if (pmd_none(*pmd) || pmd_bad(*pmd))
385 		return NULL;
386 
387 	ptep = pte_offset_map(pmd, addr);
388 	pte = *ptep;
389 	if (pte_present(pte))
390 		page = pte_page(pte);
391 	pte_unmap(ptep);
392 	return page;
393 }
394 EXPORT_SYMBOL(vmalloc_to_page);
395 
396 /*
397  * Map a vmalloc()-space virtual address to the physical page frame number.
398  */
vmalloc_to_pfn(const void * vmalloc_addr)399 unsigned long vmalloc_to_pfn(const void *vmalloc_addr)
400 {
401 	return page_to_pfn(vmalloc_to_page(vmalloc_addr));
402 }
403 EXPORT_SYMBOL(vmalloc_to_pfn);
404 
405 
406 /*** Global kva allocator ***/
407 
408 #define DEBUG_AUGMENT_PROPAGATE_CHECK 0
409 #define DEBUG_AUGMENT_LOWEST_MATCH_CHECK 0
410 
411 
412 static DEFINE_SPINLOCK(vmap_area_lock);
413 static DEFINE_SPINLOCK(free_vmap_area_lock);
414 /* Export for kexec only */
415 LIST_HEAD(vmap_area_list);
416 static LLIST_HEAD(vmap_purge_list);
417 static struct rb_root vmap_area_root = RB_ROOT;
418 static bool vmap_initialized __read_mostly;
419 
420 /*
421  * This kmem_cache is used for vmap_area objects. Instead of
422  * allocating from slab we reuse an object from this cache to
423  * make things faster. Especially in "no edge" splitting of
424  * free block.
425  */
426 static struct kmem_cache *vmap_area_cachep;
427 
428 /*
429  * This linked list is used in pair with free_vmap_area_root.
430  * It gives O(1) access to prev/next to perform fast coalescing.
431  */
432 static LIST_HEAD(free_vmap_area_list);
433 
434 /*
435  * This augment red-black tree represents the free vmap space.
436  * All vmap_area objects in this tree are sorted by va->va_start
437  * address. It is used for allocation and merging when a vmap
438  * object is released.
439  *
440  * Each vmap_area node contains a maximum available free block
441  * of its sub-tree, right or left. Therefore it is possible to
442  * find a lowest match of free area.
443  */
444 static struct rb_root free_vmap_area_root = RB_ROOT;
445 
446 /*
447  * Preload a CPU with one object for "no edge" split case. The
448  * aim is to get rid of allocations from the atomic context, thus
449  * to use more permissive allocation masks.
450  */
451 static DEFINE_PER_CPU(struct vmap_area *, ne_fit_preload_node);
452 
453 static __always_inline unsigned long
va_size(struct vmap_area * va)454 va_size(struct vmap_area *va)
455 {
456 	return (va->va_end - va->va_start);
457 }
458 
459 static __always_inline unsigned long
get_subtree_max_size(struct rb_node * node)460 get_subtree_max_size(struct rb_node *node)
461 {
462 	struct vmap_area *va;
463 
464 	va = rb_entry_safe(node, struct vmap_area, rb_node);
465 	return va ? va->subtree_max_size : 0;
466 }
467 
468 /*
469  * Gets called when remove the node and rotate.
470  */
471 static __always_inline unsigned long
compute_subtree_max_size(struct vmap_area * va)472 compute_subtree_max_size(struct vmap_area *va)
473 {
474 	return max3(va_size(va),
475 		get_subtree_max_size(va->rb_node.rb_left),
476 		get_subtree_max_size(va->rb_node.rb_right));
477 }
478 
479 RB_DECLARE_CALLBACKS_MAX(static, free_vmap_area_rb_augment_cb,
480 	struct vmap_area, rb_node, unsigned long, subtree_max_size, va_size)
481 
482 static void purge_vmap_area_lazy(void);
483 static BLOCKING_NOTIFIER_HEAD(vmap_notify_list);
484 static unsigned long lazy_max_pages(void);
485 
486 static atomic_long_t nr_vmalloc_pages;
487 
vmalloc_nr_pages(void)488 unsigned long vmalloc_nr_pages(void)
489 {
490 	return atomic_long_read(&nr_vmalloc_pages);
491 }
492 
__find_vmap_area(unsigned long addr)493 static struct vmap_area *__find_vmap_area(unsigned long addr)
494 {
495 	struct rb_node *n = vmap_area_root.rb_node;
496 
497 	while (n) {
498 		struct vmap_area *va;
499 
500 		va = rb_entry(n, struct vmap_area, rb_node);
501 		if (addr < va->va_start)
502 			n = n->rb_left;
503 		else if (addr >= va->va_end)
504 			n = n->rb_right;
505 		else
506 			return va;
507 	}
508 
509 	return NULL;
510 }
511 
512 /*
513  * This function returns back addresses of parent node
514  * and its left or right link for further processing.
515  *
516  * Otherwise NULL is returned. In that case all further
517  * steps regarding inserting of conflicting overlap range
518  * have to be declined and actually considered as a bug.
519  */
520 static __always_inline struct rb_node **
find_va_links(struct vmap_area * va,struct rb_root * root,struct rb_node * from,struct rb_node ** parent)521 find_va_links(struct vmap_area *va,
522 	struct rb_root *root, struct rb_node *from,
523 	struct rb_node **parent)
524 {
525 	struct vmap_area *tmp_va;
526 	struct rb_node **link;
527 
528 	if (root) {
529 		link = &root->rb_node;
530 		if (unlikely(!*link)) {
531 			*parent = NULL;
532 			return link;
533 		}
534 	} else {
535 		link = &from;
536 	}
537 
538 	/*
539 	 * Go to the bottom of the tree. When we hit the last point
540 	 * we end up with parent rb_node and correct direction, i name
541 	 * it link, where the new va->rb_node will be attached to.
542 	 */
543 	do {
544 		tmp_va = rb_entry(*link, struct vmap_area, rb_node);
545 
546 		/*
547 		 * During the traversal we also do some sanity check.
548 		 * Trigger the BUG() if there are sides(left/right)
549 		 * or full overlaps.
550 		 */
551 		if (va->va_start < tmp_va->va_end &&
552 				va->va_end <= tmp_va->va_start)
553 			link = &(*link)->rb_left;
554 		else if (va->va_end > tmp_va->va_start &&
555 				va->va_start >= tmp_va->va_end)
556 			link = &(*link)->rb_right;
557 		else {
558 			WARN(1, "vmalloc bug: 0x%lx-0x%lx overlaps with 0x%lx-0x%lx\n",
559 				va->va_start, va->va_end, tmp_va->va_start, tmp_va->va_end);
560 
561 			return NULL;
562 		}
563 	} while (*link);
564 
565 	*parent = &tmp_va->rb_node;
566 	return link;
567 }
568 
569 static __always_inline struct list_head *
get_va_next_sibling(struct rb_node * parent,struct rb_node ** link)570 get_va_next_sibling(struct rb_node *parent, struct rb_node **link)
571 {
572 	struct list_head *list;
573 
574 	if (unlikely(!parent))
575 		/*
576 		 * The red-black tree where we try to find VA neighbors
577 		 * before merging or inserting is empty, i.e. it means
578 		 * there is no free vmap space. Normally it does not
579 		 * happen but we handle this case anyway.
580 		 */
581 		return NULL;
582 
583 	list = &rb_entry(parent, struct vmap_area, rb_node)->list;
584 	return (&parent->rb_right == link ? list->next : list);
585 }
586 
587 static __always_inline void
link_va(struct vmap_area * va,struct rb_root * root,struct rb_node * parent,struct rb_node ** link,struct list_head * head)588 link_va(struct vmap_area *va, struct rb_root *root,
589 	struct rb_node *parent, struct rb_node **link, struct list_head *head)
590 {
591 	/*
592 	 * VA is still not in the list, but we can
593 	 * identify its future previous list_head node.
594 	 */
595 	if (likely(parent)) {
596 		head = &rb_entry(parent, struct vmap_area, rb_node)->list;
597 		if (&parent->rb_right != link)
598 			head = head->prev;
599 	}
600 
601 	/* Insert to the rb-tree */
602 	rb_link_node(&va->rb_node, parent, link);
603 	if (root == &free_vmap_area_root) {
604 		/*
605 		 * Some explanation here. Just perform simple insertion
606 		 * to the tree. We do not set va->subtree_max_size to
607 		 * its current size before calling rb_insert_augmented().
608 		 * It is because of we populate the tree from the bottom
609 		 * to parent levels when the node _is_ in the tree.
610 		 *
611 		 * Therefore we set subtree_max_size to zero after insertion,
612 		 * to let __augment_tree_propagate_from() puts everything to
613 		 * the correct order later on.
614 		 */
615 		rb_insert_augmented(&va->rb_node,
616 			root, &free_vmap_area_rb_augment_cb);
617 		va->subtree_max_size = 0;
618 	} else {
619 		rb_insert_color(&va->rb_node, root);
620 	}
621 
622 	/* Address-sort this list */
623 	list_add(&va->list, head);
624 }
625 
626 static __always_inline void
unlink_va(struct vmap_area * va,struct rb_root * root)627 unlink_va(struct vmap_area *va, struct rb_root *root)
628 {
629 	if (WARN_ON(RB_EMPTY_NODE(&va->rb_node)))
630 		return;
631 
632 	if (root == &free_vmap_area_root)
633 		rb_erase_augmented(&va->rb_node,
634 			root, &free_vmap_area_rb_augment_cb);
635 	else
636 		rb_erase(&va->rb_node, root);
637 
638 	list_del(&va->list);
639 	RB_CLEAR_NODE(&va->rb_node);
640 }
641 
642 #if DEBUG_AUGMENT_PROPAGATE_CHECK
643 static void
augment_tree_propagate_check(void)644 augment_tree_propagate_check(void)
645 {
646 	struct vmap_area *va;
647 	unsigned long computed_size;
648 
649 	list_for_each_entry(va, &free_vmap_area_list, list) {
650 		computed_size = compute_subtree_max_size(va);
651 		if (computed_size != va->subtree_max_size)
652 			pr_emerg("tree is corrupted: %lu, %lu\n",
653 				va_size(va), va->subtree_max_size);
654 	}
655 }
656 #endif
657 
658 /*
659  * This function populates subtree_max_size from bottom to upper
660  * levels starting from VA point. The propagation must be done
661  * when VA size is modified by changing its va_start/va_end. Or
662  * in case of newly inserting of VA to the tree.
663  *
664  * It means that __augment_tree_propagate_from() must be called:
665  * - After VA has been inserted to the tree(free path);
666  * - After VA has been shrunk(allocation path);
667  * - After VA has been increased(merging path).
668  *
669  * Please note that, it does not mean that upper parent nodes
670  * and their subtree_max_size are recalculated all the time up
671  * to the root node.
672  *
673  *       4--8
674  *        /\
675  *       /  \
676  *      /    \
677  *    2--2  8--8
678  *
679  * For example if we modify the node 4, shrinking it to 2, then
680  * no any modification is required. If we shrink the node 2 to 1
681  * its subtree_max_size is updated only, and set to 1. If we shrink
682  * the node 8 to 6, then its subtree_max_size is set to 6 and parent
683  * node becomes 4--6.
684  */
685 static __always_inline void
augment_tree_propagate_from(struct vmap_area * va)686 augment_tree_propagate_from(struct vmap_area *va)
687 {
688 	/*
689 	 * Populate the tree from bottom towards the root until
690 	 * the calculated maximum available size of checked node
691 	 * is equal to its current one.
692 	 */
693 	free_vmap_area_rb_augment_cb_propagate(&va->rb_node, NULL);
694 
695 #if DEBUG_AUGMENT_PROPAGATE_CHECK
696 	augment_tree_propagate_check();
697 #endif
698 }
699 
700 static void
insert_vmap_area(struct vmap_area * va,struct rb_root * root,struct list_head * head)701 insert_vmap_area(struct vmap_area *va,
702 	struct rb_root *root, struct list_head *head)
703 {
704 	struct rb_node **link;
705 	struct rb_node *parent;
706 
707 	link = find_va_links(va, root, NULL, &parent);
708 	if (link)
709 		link_va(va, root, parent, link, head);
710 }
711 
712 static void
insert_vmap_area_augment(struct vmap_area * va,struct rb_node * from,struct rb_root * root,struct list_head * head)713 insert_vmap_area_augment(struct vmap_area *va,
714 	struct rb_node *from, struct rb_root *root,
715 	struct list_head *head)
716 {
717 	struct rb_node **link;
718 	struct rb_node *parent;
719 
720 	if (from)
721 		link = find_va_links(va, NULL, from, &parent);
722 	else
723 		link = find_va_links(va, root, NULL, &parent);
724 
725 	if (link) {
726 		link_va(va, root, parent, link, head);
727 		augment_tree_propagate_from(va);
728 	}
729 }
730 
731 /*
732  * Merge de-allocated chunk of VA memory with previous
733  * and next free blocks. If coalesce is not done a new
734  * free area is inserted. If VA has been merged, it is
735  * freed.
736  *
737  * Please note, it can return NULL in case of overlap
738  * ranges, followed by WARN() report. Despite it is a
739  * buggy behaviour, a system can be alive and keep
740  * ongoing.
741  */
742 static __always_inline struct vmap_area *
merge_or_add_vmap_area(struct vmap_area * va,struct rb_root * root,struct list_head * head)743 merge_or_add_vmap_area(struct vmap_area *va,
744 	struct rb_root *root, struct list_head *head)
745 {
746 	struct vmap_area *sibling;
747 	struct list_head *next;
748 	struct rb_node **link;
749 	struct rb_node *parent;
750 	bool merged = false;
751 
752 	/*
753 	 * Find a place in the tree where VA potentially will be
754 	 * inserted, unless it is merged with its sibling/siblings.
755 	 */
756 	link = find_va_links(va, root, NULL, &parent);
757 	if (!link)
758 		return NULL;
759 
760 	/*
761 	 * Get next node of VA to check if merging can be done.
762 	 */
763 	next = get_va_next_sibling(parent, link);
764 	if (unlikely(next == NULL))
765 		goto insert;
766 
767 	/*
768 	 * start            end
769 	 * |                |
770 	 * |<------VA------>|<-----Next----->|
771 	 *                  |                |
772 	 *                  start            end
773 	 */
774 	if (next != head) {
775 		sibling = list_entry(next, struct vmap_area, list);
776 		if (sibling->va_start == va->va_end) {
777 			sibling->va_start = va->va_start;
778 
779 			/* Free vmap_area object. */
780 			kmem_cache_free(vmap_area_cachep, va);
781 
782 			/* Point to the new merged area. */
783 			va = sibling;
784 			merged = true;
785 		}
786 	}
787 
788 	/*
789 	 * start            end
790 	 * |                |
791 	 * |<-----Prev----->|<------VA------>|
792 	 *                  |                |
793 	 *                  start            end
794 	 */
795 	if (next->prev != head) {
796 		sibling = list_entry(next->prev, struct vmap_area, list);
797 		if (sibling->va_end == va->va_start) {
798 			/*
799 			 * If both neighbors are coalesced, it is important
800 			 * to unlink the "next" node first, followed by merging
801 			 * with "previous" one. Otherwise the tree might not be
802 			 * fully populated if a sibling's augmented value is
803 			 * "normalized" because of rotation operations.
804 			 */
805 			if (merged)
806 				unlink_va(va, root);
807 
808 			sibling->va_end = va->va_end;
809 
810 			/* Free vmap_area object. */
811 			kmem_cache_free(vmap_area_cachep, va);
812 
813 			/* Point to the new merged area. */
814 			va = sibling;
815 			merged = true;
816 		}
817 	}
818 
819 insert:
820 	if (!merged)
821 		link_va(va, root, parent, link, head);
822 
823 	/*
824 	 * Last step is to check and update the tree.
825 	 */
826 	augment_tree_propagate_from(va);
827 	return va;
828 }
829 
830 static __always_inline bool
is_within_this_va(struct vmap_area * va,unsigned long size,unsigned long align,unsigned long vstart)831 is_within_this_va(struct vmap_area *va, unsigned long size,
832 	unsigned long align, unsigned long vstart)
833 {
834 	unsigned long nva_start_addr;
835 
836 	if (va->va_start > vstart)
837 		nva_start_addr = ALIGN(va->va_start, align);
838 	else
839 		nva_start_addr = ALIGN(vstart, align);
840 
841 	/* Can be overflowed due to big size or alignment. */
842 	if (nva_start_addr + size < nva_start_addr ||
843 			nva_start_addr < vstart)
844 		return false;
845 
846 	return (nva_start_addr + size <= va->va_end);
847 }
848 
849 /*
850  * Find the first free block(lowest start address) in the tree,
851  * that will accomplish the request corresponding to passing
852  * parameters.
853  */
854 static __always_inline struct vmap_area *
find_vmap_lowest_match(unsigned long size,unsigned long align,unsigned long vstart)855 find_vmap_lowest_match(unsigned long size,
856 	unsigned long align, unsigned long vstart)
857 {
858 	struct vmap_area *va;
859 	struct rb_node *node;
860 	unsigned long length;
861 
862 	/* Start from the root. */
863 	node = free_vmap_area_root.rb_node;
864 
865 	/* Adjust the search size for alignment overhead. */
866 	length = size + align - 1;
867 
868 	while (node) {
869 		va = rb_entry(node, struct vmap_area, rb_node);
870 
871 		if (get_subtree_max_size(node->rb_left) >= length &&
872 				vstart < va->va_start) {
873 			node = node->rb_left;
874 		} else {
875 			if (is_within_this_va(va, size, align, vstart))
876 				return va;
877 
878 			/*
879 			 * Does not make sense to go deeper towards the right
880 			 * sub-tree if it does not have a free block that is
881 			 * equal or bigger to the requested search length.
882 			 */
883 			if (get_subtree_max_size(node->rb_right) >= length) {
884 				node = node->rb_right;
885 				continue;
886 			}
887 
888 			/*
889 			 * OK. We roll back and find the first right sub-tree,
890 			 * that will satisfy the search criteria. It can happen
891 			 * only once due to "vstart" restriction.
892 			 */
893 			while ((node = rb_parent(node))) {
894 				va = rb_entry(node, struct vmap_area, rb_node);
895 				if (is_within_this_va(va, size, align, vstart))
896 					return va;
897 
898 				if (get_subtree_max_size(node->rb_right) >= length &&
899 						vstart <= va->va_start) {
900 					node = node->rb_right;
901 					break;
902 				}
903 			}
904 		}
905 	}
906 
907 	return NULL;
908 }
909 
910 #if DEBUG_AUGMENT_LOWEST_MATCH_CHECK
911 #include <linux/random.h>
912 
913 static struct vmap_area *
find_vmap_lowest_linear_match(unsigned long size,unsigned long align,unsigned long vstart)914 find_vmap_lowest_linear_match(unsigned long size,
915 	unsigned long align, unsigned long vstart)
916 {
917 	struct vmap_area *va;
918 
919 	list_for_each_entry(va, &free_vmap_area_list, list) {
920 		if (!is_within_this_va(va, size, align, vstart))
921 			continue;
922 
923 		return va;
924 	}
925 
926 	return NULL;
927 }
928 
929 static void
find_vmap_lowest_match_check(unsigned long size)930 find_vmap_lowest_match_check(unsigned long size)
931 {
932 	struct vmap_area *va_1, *va_2;
933 	unsigned long vstart;
934 	unsigned int rnd;
935 
936 	get_random_bytes(&rnd, sizeof(rnd));
937 	vstart = VMALLOC_START + rnd;
938 
939 	va_1 = find_vmap_lowest_match(size, 1, vstart);
940 	va_2 = find_vmap_lowest_linear_match(size, 1, vstart);
941 
942 	if (va_1 != va_2)
943 		pr_emerg("not lowest: t: 0x%p, l: 0x%p, v: 0x%lx\n",
944 			va_1, va_2, vstart);
945 }
946 #endif
947 
948 enum fit_type {
949 	NOTHING_FIT = 0,
950 	FL_FIT_TYPE = 1,	/* full fit */
951 	LE_FIT_TYPE = 2,	/* left edge fit */
952 	RE_FIT_TYPE = 3,	/* right edge fit */
953 	NE_FIT_TYPE = 4		/* no edge fit */
954 };
955 
956 static __always_inline enum fit_type
classify_va_fit_type(struct vmap_area * va,unsigned long nva_start_addr,unsigned long size)957 classify_va_fit_type(struct vmap_area *va,
958 	unsigned long nva_start_addr, unsigned long size)
959 {
960 	enum fit_type type;
961 
962 	/* Check if it is within VA. */
963 	if (nva_start_addr < va->va_start ||
964 			nva_start_addr + size > va->va_end)
965 		return NOTHING_FIT;
966 
967 	/* Now classify. */
968 	if (va->va_start == nva_start_addr) {
969 		if (va->va_end == nva_start_addr + size)
970 			type = FL_FIT_TYPE;
971 		else
972 			type = LE_FIT_TYPE;
973 	} else if (va->va_end == nva_start_addr + size) {
974 		type = RE_FIT_TYPE;
975 	} else {
976 		type = NE_FIT_TYPE;
977 	}
978 
979 	return type;
980 }
981 
982 static __always_inline int
adjust_va_to_fit_type(struct vmap_area * va,unsigned long nva_start_addr,unsigned long size,enum fit_type type)983 adjust_va_to_fit_type(struct vmap_area *va,
984 	unsigned long nva_start_addr, unsigned long size,
985 	enum fit_type type)
986 {
987 	struct vmap_area *lva = NULL;
988 
989 	if (type == FL_FIT_TYPE) {
990 		/*
991 		 * No need to split VA, it fully fits.
992 		 *
993 		 * |               |
994 		 * V      NVA      V
995 		 * |---------------|
996 		 */
997 		unlink_va(va, &free_vmap_area_root);
998 		kmem_cache_free(vmap_area_cachep, va);
999 	} else if (type == LE_FIT_TYPE) {
1000 		/*
1001 		 * Split left edge of fit VA.
1002 		 *
1003 		 * |       |
1004 		 * V  NVA  V   R
1005 		 * |-------|-------|
1006 		 */
1007 		va->va_start += size;
1008 	} else if (type == RE_FIT_TYPE) {
1009 		/*
1010 		 * Split right edge of fit VA.
1011 		 *
1012 		 *         |       |
1013 		 *     L   V  NVA  V
1014 		 * |-------|-------|
1015 		 */
1016 		va->va_end = nva_start_addr;
1017 	} else if (type == NE_FIT_TYPE) {
1018 		/*
1019 		 * Split no edge of fit VA.
1020 		 *
1021 		 *     |       |
1022 		 *   L V  NVA  V R
1023 		 * |---|-------|---|
1024 		 */
1025 		lva = __this_cpu_xchg(ne_fit_preload_node, NULL);
1026 		if (unlikely(!lva)) {
1027 			/*
1028 			 * For percpu allocator we do not do any pre-allocation
1029 			 * and leave it as it is. The reason is it most likely
1030 			 * never ends up with NE_FIT_TYPE splitting. In case of
1031 			 * percpu allocations offsets and sizes are aligned to
1032 			 * fixed align request, i.e. RE_FIT_TYPE and FL_FIT_TYPE
1033 			 * are its main fitting cases.
1034 			 *
1035 			 * There are a few exceptions though, as an example it is
1036 			 * a first allocation (early boot up) when we have "one"
1037 			 * big free space that has to be split.
1038 			 *
1039 			 * Also we can hit this path in case of regular "vmap"
1040 			 * allocations, if "this" current CPU was not preloaded.
1041 			 * See the comment in alloc_vmap_area() why. If so, then
1042 			 * GFP_NOWAIT is used instead to get an extra object for
1043 			 * split purpose. That is rare and most time does not
1044 			 * occur.
1045 			 *
1046 			 * What happens if an allocation gets failed. Basically,
1047 			 * an "overflow" path is triggered to purge lazily freed
1048 			 * areas to free some memory, then, the "retry" path is
1049 			 * triggered to repeat one more time. See more details
1050 			 * in alloc_vmap_area() function.
1051 			 */
1052 			lva = kmem_cache_alloc(vmap_area_cachep, GFP_NOWAIT);
1053 			if (!lva)
1054 				return -1;
1055 		}
1056 
1057 		/*
1058 		 * Build the remainder.
1059 		 */
1060 		lva->va_start = va->va_start;
1061 		lva->va_end = nva_start_addr;
1062 
1063 		/*
1064 		 * Shrink this VA to remaining size.
1065 		 */
1066 		va->va_start = nva_start_addr + size;
1067 	} else {
1068 		return -1;
1069 	}
1070 
1071 	if (type != FL_FIT_TYPE) {
1072 		augment_tree_propagate_from(va);
1073 
1074 		if (lva)	/* type == NE_FIT_TYPE */
1075 			insert_vmap_area_augment(lva, &va->rb_node,
1076 				&free_vmap_area_root, &free_vmap_area_list);
1077 	}
1078 
1079 	return 0;
1080 }
1081 
1082 /*
1083  * Returns a start address of the newly allocated area, if success.
1084  * Otherwise a vend is returned that indicates failure.
1085  */
1086 static __always_inline unsigned long
__alloc_vmap_area(unsigned long size,unsigned long align,unsigned long vstart,unsigned long vend)1087 __alloc_vmap_area(unsigned long size, unsigned long align,
1088 	unsigned long vstart, unsigned long vend)
1089 {
1090 	unsigned long nva_start_addr;
1091 	struct vmap_area *va;
1092 	enum fit_type type;
1093 	int ret;
1094 
1095 	va = find_vmap_lowest_match(size, align, vstart);
1096 	if (unlikely(!va))
1097 		return vend;
1098 
1099 	if (va->va_start > vstart)
1100 		nva_start_addr = ALIGN(va->va_start, align);
1101 	else
1102 		nva_start_addr = ALIGN(vstart, align);
1103 
1104 	/* Check the "vend" restriction. */
1105 	if (nva_start_addr + size > vend)
1106 		return vend;
1107 
1108 	/* Classify what we have found. */
1109 	type = classify_va_fit_type(va, nva_start_addr, size);
1110 	if (WARN_ON_ONCE(type == NOTHING_FIT))
1111 		return vend;
1112 
1113 	/* Update the free vmap_area. */
1114 	ret = adjust_va_to_fit_type(va, nva_start_addr, size, type);
1115 	if (ret)
1116 		return vend;
1117 
1118 #if DEBUG_AUGMENT_LOWEST_MATCH_CHECK
1119 	find_vmap_lowest_match_check(size);
1120 #endif
1121 
1122 	return nva_start_addr;
1123 }
1124 
1125 /*
1126  * Free a region of KVA allocated by alloc_vmap_area
1127  */
free_vmap_area(struct vmap_area * va)1128 static void free_vmap_area(struct vmap_area *va)
1129 {
1130 	/*
1131 	 * Remove from the busy tree/list.
1132 	 */
1133 	spin_lock(&vmap_area_lock);
1134 	unlink_va(va, &vmap_area_root);
1135 	spin_unlock(&vmap_area_lock);
1136 
1137 	/*
1138 	 * Insert/Merge it back to the free tree/list.
1139 	 */
1140 	spin_lock(&free_vmap_area_lock);
1141 	merge_or_add_vmap_area(va, &free_vmap_area_root, &free_vmap_area_list);
1142 	spin_unlock(&free_vmap_area_lock);
1143 }
1144 
1145 /*
1146  * Allocate a region of KVA of the specified size and alignment, within the
1147  * vstart and vend.
1148  */
alloc_vmap_area(unsigned long size,unsigned long align,unsigned long vstart,unsigned long vend,int node,gfp_t gfp_mask)1149 static struct vmap_area *alloc_vmap_area(unsigned long size,
1150 				unsigned long align,
1151 				unsigned long vstart, unsigned long vend,
1152 				int node, gfp_t gfp_mask)
1153 {
1154 	struct vmap_area *va, *pva;
1155 	unsigned long addr;
1156 	int purged = 0;
1157 	int ret;
1158 
1159 	BUG_ON(!size);
1160 	BUG_ON(offset_in_page(size));
1161 	BUG_ON(!is_power_of_2(align));
1162 
1163 	if (unlikely(!vmap_initialized))
1164 		return ERR_PTR(-EBUSY);
1165 
1166 	might_sleep();
1167 	gfp_mask = gfp_mask & GFP_RECLAIM_MASK;
1168 
1169 	va = kmem_cache_alloc_node(vmap_area_cachep, gfp_mask, node);
1170 	if (unlikely(!va))
1171 		return ERR_PTR(-ENOMEM);
1172 
1173 	/*
1174 	 * Only scan the relevant parts containing pointers to other objects
1175 	 * to avoid false negatives.
1176 	 */
1177 	kmemleak_scan_area(&va->rb_node, SIZE_MAX, gfp_mask);
1178 
1179 retry:
1180 	/*
1181 	 * Preload this CPU with one extra vmap_area object. It is used
1182 	 * when fit type of free area is NE_FIT_TYPE. Please note, it
1183 	 * does not guarantee that an allocation occurs on a CPU that
1184 	 * is preloaded, instead we minimize the case when it is not.
1185 	 * It can happen because of cpu migration, because there is a
1186 	 * race until the below spinlock is taken.
1187 	 *
1188 	 * The preload is done in non-atomic context, thus it allows us
1189 	 * to use more permissive allocation masks to be more stable under
1190 	 * low memory condition and high memory pressure. In rare case,
1191 	 * if not preloaded, GFP_NOWAIT is used.
1192 	 *
1193 	 * Set "pva" to NULL here, because of "retry" path.
1194 	 */
1195 	pva = NULL;
1196 
1197 	if (!this_cpu_read(ne_fit_preload_node))
1198 		/*
1199 		 * Even if it fails we do not really care about that.
1200 		 * Just proceed as it is. If needed "overflow" path
1201 		 * will refill the cache we allocate from.
1202 		 */
1203 		pva = kmem_cache_alloc_node(vmap_area_cachep, gfp_mask, node);
1204 
1205 	spin_lock(&free_vmap_area_lock);
1206 
1207 	if (pva && __this_cpu_cmpxchg(ne_fit_preload_node, NULL, pva))
1208 		kmem_cache_free(vmap_area_cachep, pva);
1209 
1210 	/*
1211 	 * If an allocation fails, the "vend" address is
1212 	 * returned. Therefore trigger the overflow path.
1213 	 */
1214 	addr = __alloc_vmap_area(size, align, vstart, vend);
1215 	spin_unlock(&free_vmap_area_lock);
1216 
1217 	if (unlikely(addr == vend))
1218 		goto overflow;
1219 
1220 	va->va_start = addr;
1221 	va->va_end = addr + size;
1222 	va->vm = NULL;
1223 
1224 
1225 	spin_lock(&vmap_area_lock);
1226 	insert_vmap_area(va, &vmap_area_root, &vmap_area_list);
1227 	spin_unlock(&vmap_area_lock);
1228 
1229 	BUG_ON(!IS_ALIGNED(va->va_start, align));
1230 	BUG_ON(va->va_start < vstart);
1231 	BUG_ON(va->va_end > vend);
1232 
1233 	ret = kasan_populate_vmalloc(addr, size);
1234 	if (ret) {
1235 		free_vmap_area(va);
1236 		return ERR_PTR(ret);
1237 	}
1238 
1239 	return va;
1240 
1241 overflow:
1242 	if (!purged) {
1243 		purge_vmap_area_lazy();
1244 		purged = 1;
1245 		goto retry;
1246 	}
1247 
1248 	if (gfpflags_allow_blocking(gfp_mask)) {
1249 		unsigned long freed = 0;
1250 		blocking_notifier_call_chain(&vmap_notify_list, 0, &freed);
1251 		if (freed > 0) {
1252 			purged = 0;
1253 			goto retry;
1254 		}
1255 	}
1256 
1257 	if (!(gfp_mask & __GFP_NOWARN) && printk_ratelimit())
1258 		pr_warn("vmap allocation for size %lu failed: use vmalloc=<size> to increase size\n",
1259 			size);
1260 
1261 	kmem_cache_free(vmap_area_cachep, va);
1262 	return ERR_PTR(-EBUSY);
1263 }
1264 
register_vmap_purge_notifier(struct notifier_block * nb)1265 int register_vmap_purge_notifier(struct notifier_block *nb)
1266 {
1267 	return blocking_notifier_chain_register(&vmap_notify_list, nb);
1268 }
1269 EXPORT_SYMBOL_GPL(register_vmap_purge_notifier);
1270 
unregister_vmap_purge_notifier(struct notifier_block * nb)1271 int unregister_vmap_purge_notifier(struct notifier_block *nb)
1272 {
1273 	return blocking_notifier_chain_unregister(&vmap_notify_list, nb);
1274 }
1275 EXPORT_SYMBOL_GPL(unregister_vmap_purge_notifier);
1276 
1277 /*
1278  * lazy_max_pages is the maximum amount of virtual address space we gather up
1279  * before attempting to purge with a TLB flush.
1280  *
1281  * There is a tradeoff here: a larger number will cover more kernel page tables
1282  * and take slightly longer to purge, but it will linearly reduce the number of
1283  * global TLB flushes that must be performed. It would seem natural to scale
1284  * this number up linearly with the number of CPUs (because vmapping activity
1285  * could also scale linearly with the number of CPUs), however it is likely
1286  * that in practice, workloads might be constrained in other ways that mean
1287  * vmap activity will not scale linearly with CPUs. Also, I want to be
1288  * conservative and not introduce a big latency on huge systems, so go with
1289  * a less aggressive log scale. It will still be an improvement over the old
1290  * code, and it will be simple to change the scale factor if we find that it
1291  * becomes a problem on bigger systems.
1292  */
lazy_max_pages(void)1293 static unsigned long lazy_max_pages(void)
1294 {
1295 	unsigned int log;
1296 
1297 	log = fls(num_online_cpus());
1298 
1299 	return log * (32UL * 1024 * 1024 / PAGE_SIZE);
1300 }
1301 
1302 static atomic_long_t vmap_lazy_nr = ATOMIC_LONG_INIT(0);
1303 
1304 /*
1305  * Serialize vmap purging.  There is no actual criticial section protected
1306  * by this look, but we want to avoid concurrent calls for performance
1307  * reasons and to make the pcpu_get_vm_areas more deterministic.
1308  */
1309 static DEFINE_MUTEX(vmap_purge_lock);
1310 
1311 /* for per-CPU blocks */
1312 static void purge_fragmented_blocks_allcpus(void);
1313 
1314 /*
1315  * called before a call to iounmap() if the caller wants vm_area_struct's
1316  * immediately freed.
1317  */
set_iounmap_nonlazy(void)1318 void set_iounmap_nonlazy(void)
1319 {
1320 	atomic_long_set(&vmap_lazy_nr, lazy_max_pages()+1);
1321 }
1322 
1323 /*
1324  * Purges all lazily-freed vmap areas.
1325  */
__purge_vmap_area_lazy(unsigned long start,unsigned long end)1326 static bool __purge_vmap_area_lazy(unsigned long start, unsigned long end)
1327 {
1328 	unsigned long resched_threshold;
1329 	struct llist_node *valist;
1330 	struct vmap_area *va;
1331 	struct vmap_area *n_va;
1332 
1333 	lockdep_assert_held(&vmap_purge_lock);
1334 
1335 	valist = llist_del_all(&vmap_purge_list);
1336 	if (unlikely(valist == NULL))
1337 		return false;
1338 
1339 	/*
1340 	 * TODO: to calculate a flush range without looping.
1341 	 * The list can be up to lazy_max_pages() elements.
1342 	 */
1343 	llist_for_each_entry(va, valist, purge_list) {
1344 		if (va->va_start < start)
1345 			start = va->va_start;
1346 		if (va->va_end > end)
1347 			end = va->va_end;
1348 	}
1349 
1350 	flush_tlb_kernel_range(start, end);
1351 	resched_threshold = lazy_max_pages() << 1;
1352 
1353 	spin_lock(&free_vmap_area_lock);
1354 	llist_for_each_entry_safe(va, n_va, valist, purge_list) {
1355 		unsigned long nr = (va->va_end - va->va_start) >> PAGE_SHIFT;
1356 		unsigned long orig_start = va->va_start;
1357 		unsigned long orig_end = va->va_end;
1358 
1359 		/*
1360 		 * Finally insert or merge lazily-freed area. It is
1361 		 * detached and there is no need to "unlink" it from
1362 		 * anything.
1363 		 */
1364 		va = merge_or_add_vmap_area(va, &free_vmap_area_root,
1365 					    &free_vmap_area_list);
1366 
1367 		if (!va)
1368 			continue;
1369 
1370 		if (is_vmalloc_or_module_addr((void *)orig_start))
1371 			kasan_release_vmalloc(orig_start, orig_end,
1372 					      va->va_start, va->va_end);
1373 
1374 		atomic_long_sub(nr, &vmap_lazy_nr);
1375 
1376 		if (atomic_long_read(&vmap_lazy_nr) < resched_threshold)
1377 			cond_resched_lock(&free_vmap_area_lock);
1378 	}
1379 	spin_unlock(&free_vmap_area_lock);
1380 	return true;
1381 }
1382 
1383 /*
1384  * Kick off a purge of the outstanding lazy areas. Don't bother if somebody
1385  * is already purging.
1386  */
try_purge_vmap_area_lazy(void)1387 static void try_purge_vmap_area_lazy(void)
1388 {
1389 	if (mutex_trylock(&vmap_purge_lock)) {
1390 		__purge_vmap_area_lazy(ULONG_MAX, 0);
1391 		mutex_unlock(&vmap_purge_lock);
1392 	}
1393 }
1394 
1395 /*
1396  * Kick off a purge of the outstanding lazy areas.
1397  */
purge_vmap_area_lazy(void)1398 static void purge_vmap_area_lazy(void)
1399 {
1400 	mutex_lock(&vmap_purge_lock);
1401 	purge_fragmented_blocks_allcpus();
1402 	__purge_vmap_area_lazy(ULONG_MAX, 0);
1403 	mutex_unlock(&vmap_purge_lock);
1404 }
1405 
1406 /*
1407  * Free a vmap area, caller ensuring that the area has been unmapped
1408  * and flush_cache_vunmap had been called for the correct range
1409  * previously.
1410  */
free_vmap_area_noflush(struct vmap_area * va)1411 static void free_vmap_area_noflush(struct vmap_area *va)
1412 {
1413 	unsigned long nr_lazy;
1414 
1415 	spin_lock(&vmap_area_lock);
1416 	unlink_va(va, &vmap_area_root);
1417 	spin_unlock(&vmap_area_lock);
1418 
1419 	nr_lazy = atomic_long_add_return((va->va_end - va->va_start) >>
1420 				PAGE_SHIFT, &vmap_lazy_nr);
1421 
1422 	/* After this point, we may free va at any time */
1423 	llist_add(&va->purge_list, &vmap_purge_list);
1424 
1425 	if (unlikely(nr_lazy > lazy_max_pages()))
1426 		try_purge_vmap_area_lazy();
1427 }
1428 
1429 /*
1430  * Free and unmap a vmap area
1431  */
free_unmap_vmap_area(struct vmap_area * va)1432 static void free_unmap_vmap_area(struct vmap_area *va)
1433 {
1434 	flush_cache_vunmap(va->va_start, va->va_end);
1435 	unmap_kernel_range_noflush(va->va_start, va->va_end - va->va_start);
1436 	if (debug_pagealloc_enabled_static())
1437 		flush_tlb_kernel_range(va->va_start, va->va_end);
1438 
1439 	free_vmap_area_noflush(va);
1440 }
1441 
find_vmap_area(unsigned long addr)1442 static struct vmap_area *find_vmap_area(unsigned long addr)
1443 {
1444 	struct vmap_area *va;
1445 
1446 	spin_lock(&vmap_area_lock);
1447 	va = __find_vmap_area(addr);
1448 	spin_unlock(&vmap_area_lock);
1449 
1450 	return va;
1451 }
1452 
1453 /*** Per cpu kva allocator ***/
1454 
1455 /*
1456  * vmap space is limited especially on 32 bit architectures. Ensure there is
1457  * room for at least 16 percpu vmap blocks per CPU.
1458  */
1459 /*
1460  * If we had a constant VMALLOC_START and VMALLOC_END, we'd like to be able
1461  * to #define VMALLOC_SPACE		(VMALLOC_END-VMALLOC_START). Guess
1462  * instead (we just need a rough idea)
1463  */
1464 #if BITS_PER_LONG == 32
1465 #define VMALLOC_SPACE		(128UL*1024*1024)
1466 #else
1467 #define VMALLOC_SPACE		(128UL*1024*1024*1024)
1468 #endif
1469 
1470 #define VMALLOC_PAGES		(VMALLOC_SPACE / PAGE_SIZE)
1471 #define VMAP_MAX_ALLOC		BITS_PER_LONG	/* 256K with 4K pages */
1472 #define VMAP_BBMAP_BITS_MAX	1024	/* 4MB with 4K pages */
1473 #define VMAP_BBMAP_BITS_MIN	(VMAP_MAX_ALLOC*2)
1474 #define VMAP_MIN(x, y)		((x) < (y) ? (x) : (y)) /* can't use min() */
1475 #define VMAP_MAX(x, y)		((x) > (y) ? (x) : (y)) /* can't use max() */
1476 #define VMAP_BBMAP_BITS		\
1477 		VMAP_MIN(VMAP_BBMAP_BITS_MAX,	\
1478 		VMAP_MAX(VMAP_BBMAP_BITS_MIN,	\
1479 			VMALLOC_PAGES / roundup_pow_of_two(NR_CPUS) / 16))
1480 
1481 #define VMAP_BLOCK_SIZE		(VMAP_BBMAP_BITS * PAGE_SIZE)
1482 
1483 struct vmap_block_queue {
1484 	spinlock_t lock;
1485 	struct list_head free;
1486 };
1487 
1488 struct vmap_block {
1489 	spinlock_t lock;
1490 	struct vmap_area *va;
1491 	unsigned long free, dirty;
1492 	unsigned long dirty_min, dirty_max; /*< dirty range */
1493 	struct list_head free_list;
1494 	struct rcu_head rcu_head;
1495 	struct list_head purge;
1496 };
1497 
1498 /* Queue of free and dirty vmap blocks, for allocation and flushing purposes */
1499 static DEFINE_PER_CPU(struct vmap_block_queue, vmap_block_queue);
1500 
1501 /*
1502  * XArray of vmap blocks, indexed by address, to quickly find a vmap block
1503  * in the free path. Could get rid of this if we change the API to return a
1504  * "cookie" from alloc, to be passed to free. But no big deal yet.
1505  */
1506 static DEFINE_XARRAY(vmap_blocks);
1507 
1508 /*
1509  * We should probably have a fallback mechanism to allocate virtual memory
1510  * out of partially filled vmap blocks. However vmap block sizing should be
1511  * fairly reasonable according to the vmalloc size, so it shouldn't be a
1512  * big problem.
1513  */
1514 
addr_to_vb_idx(unsigned long addr)1515 static unsigned long addr_to_vb_idx(unsigned long addr)
1516 {
1517 	addr -= VMALLOC_START & ~(VMAP_BLOCK_SIZE-1);
1518 	addr /= VMAP_BLOCK_SIZE;
1519 	return addr;
1520 }
1521 
vmap_block_vaddr(unsigned long va_start,unsigned long pages_off)1522 static void *vmap_block_vaddr(unsigned long va_start, unsigned long pages_off)
1523 {
1524 	unsigned long addr;
1525 
1526 	addr = va_start + (pages_off << PAGE_SHIFT);
1527 	BUG_ON(addr_to_vb_idx(addr) != addr_to_vb_idx(va_start));
1528 	return (void *)addr;
1529 }
1530 
1531 /**
1532  * new_vmap_block - allocates new vmap_block and occupies 2^order pages in this
1533  *                  block. Of course pages number can't exceed VMAP_BBMAP_BITS
1534  * @order:    how many 2^order pages should be occupied in newly allocated block
1535  * @gfp_mask: flags for the page level allocator
1536  *
1537  * Return: virtual address in a newly allocated block or ERR_PTR(-errno)
1538  */
new_vmap_block(unsigned int order,gfp_t gfp_mask)1539 static void *new_vmap_block(unsigned int order, gfp_t gfp_mask)
1540 {
1541 	struct vmap_block_queue *vbq;
1542 	struct vmap_block *vb;
1543 	struct vmap_area *va;
1544 	unsigned long vb_idx;
1545 	int node, err;
1546 	void *vaddr;
1547 
1548 	node = numa_node_id();
1549 
1550 	vb = kmalloc_node(sizeof(struct vmap_block),
1551 			gfp_mask & GFP_RECLAIM_MASK, node);
1552 	if (unlikely(!vb))
1553 		return ERR_PTR(-ENOMEM);
1554 
1555 	va = alloc_vmap_area(VMAP_BLOCK_SIZE, VMAP_BLOCK_SIZE,
1556 					VMALLOC_START, VMALLOC_END,
1557 					node, gfp_mask);
1558 	if (IS_ERR(va)) {
1559 		kfree(vb);
1560 		return ERR_CAST(va);
1561 	}
1562 
1563 	vaddr = vmap_block_vaddr(va->va_start, 0);
1564 	spin_lock_init(&vb->lock);
1565 	vb->va = va;
1566 	/* At least something should be left free */
1567 	BUG_ON(VMAP_BBMAP_BITS <= (1UL << order));
1568 	vb->free = VMAP_BBMAP_BITS - (1UL << order);
1569 	vb->dirty = 0;
1570 	vb->dirty_min = VMAP_BBMAP_BITS;
1571 	vb->dirty_max = 0;
1572 	INIT_LIST_HEAD(&vb->free_list);
1573 
1574 	vb_idx = addr_to_vb_idx(va->va_start);
1575 	err = xa_insert(&vmap_blocks, vb_idx, vb, gfp_mask);
1576 	if (err) {
1577 		kfree(vb);
1578 		free_vmap_area(va);
1579 		return ERR_PTR(err);
1580 	}
1581 
1582 	vbq = &get_cpu_var(vmap_block_queue);
1583 	spin_lock(&vbq->lock);
1584 	list_add_tail_rcu(&vb->free_list, &vbq->free);
1585 	spin_unlock(&vbq->lock);
1586 	put_cpu_var(vmap_block_queue);
1587 
1588 	return vaddr;
1589 }
1590 
free_vmap_block(struct vmap_block * vb)1591 static void free_vmap_block(struct vmap_block *vb)
1592 {
1593 	struct vmap_block *tmp;
1594 
1595 	tmp = xa_erase(&vmap_blocks, addr_to_vb_idx(vb->va->va_start));
1596 	BUG_ON(tmp != vb);
1597 
1598 	free_vmap_area_noflush(vb->va);
1599 	kfree_rcu(vb, rcu_head);
1600 }
1601 
purge_fragmented_blocks(int cpu)1602 static void purge_fragmented_blocks(int cpu)
1603 {
1604 	LIST_HEAD(purge);
1605 	struct vmap_block *vb;
1606 	struct vmap_block *n_vb;
1607 	struct vmap_block_queue *vbq = &per_cpu(vmap_block_queue, cpu);
1608 
1609 	rcu_read_lock();
1610 	list_for_each_entry_rcu(vb, &vbq->free, free_list) {
1611 
1612 		if (!(vb->free + vb->dirty == VMAP_BBMAP_BITS && vb->dirty != VMAP_BBMAP_BITS))
1613 			continue;
1614 
1615 		spin_lock(&vb->lock);
1616 		if (vb->free + vb->dirty == VMAP_BBMAP_BITS && vb->dirty != VMAP_BBMAP_BITS) {
1617 			vb->free = 0; /* prevent further allocs after releasing lock */
1618 			vb->dirty = VMAP_BBMAP_BITS; /* prevent purging it again */
1619 			vb->dirty_min = 0;
1620 			vb->dirty_max = VMAP_BBMAP_BITS;
1621 			spin_lock(&vbq->lock);
1622 			list_del_rcu(&vb->free_list);
1623 			spin_unlock(&vbq->lock);
1624 			spin_unlock(&vb->lock);
1625 			list_add_tail(&vb->purge, &purge);
1626 		} else
1627 			spin_unlock(&vb->lock);
1628 	}
1629 	rcu_read_unlock();
1630 
1631 	list_for_each_entry_safe(vb, n_vb, &purge, purge) {
1632 		list_del(&vb->purge);
1633 		free_vmap_block(vb);
1634 	}
1635 }
1636 
purge_fragmented_blocks_allcpus(void)1637 static void purge_fragmented_blocks_allcpus(void)
1638 {
1639 	int cpu;
1640 
1641 	for_each_possible_cpu(cpu)
1642 		purge_fragmented_blocks(cpu);
1643 }
1644 
vb_alloc(unsigned long size,gfp_t gfp_mask)1645 static void *vb_alloc(unsigned long size, gfp_t gfp_mask)
1646 {
1647 	struct vmap_block_queue *vbq;
1648 	struct vmap_block *vb;
1649 	void *vaddr = NULL;
1650 	unsigned int order;
1651 
1652 	BUG_ON(offset_in_page(size));
1653 	BUG_ON(size > PAGE_SIZE*VMAP_MAX_ALLOC);
1654 	if (WARN_ON(size == 0)) {
1655 		/*
1656 		 * Allocating 0 bytes isn't what caller wants since
1657 		 * get_order(0) returns funny result. Just warn and terminate
1658 		 * early.
1659 		 */
1660 		return NULL;
1661 	}
1662 	order = get_order(size);
1663 
1664 	rcu_read_lock();
1665 	vbq = &get_cpu_var(vmap_block_queue);
1666 	list_for_each_entry_rcu(vb, &vbq->free, free_list) {
1667 		unsigned long pages_off;
1668 
1669 		spin_lock(&vb->lock);
1670 		if (vb->free < (1UL << order)) {
1671 			spin_unlock(&vb->lock);
1672 			continue;
1673 		}
1674 
1675 		pages_off = VMAP_BBMAP_BITS - vb->free;
1676 		vaddr = vmap_block_vaddr(vb->va->va_start, pages_off);
1677 		vb->free -= 1UL << order;
1678 		if (vb->free == 0) {
1679 			spin_lock(&vbq->lock);
1680 			list_del_rcu(&vb->free_list);
1681 			spin_unlock(&vbq->lock);
1682 		}
1683 
1684 		spin_unlock(&vb->lock);
1685 		break;
1686 	}
1687 
1688 	put_cpu_var(vmap_block_queue);
1689 	rcu_read_unlock();
1690 
1691 	/* Allocate new block if nothing was found */
1692 	if (!vaddr)
1693 		vaddr = new_vmap_block(order, gfp_mask);
1694 
1695 	return vaddr;
1696 }
1697 
vb_free(unsigned long addr,unsigned long size)1698 static void vb_free(unsigned long addr, unsigned long size)
1699 {
1700 	unsigned long offset;
1701 	unsigned int order;
1702 	struct vmap_block *vb;
1703 
1704 	BUG_ON(offset_in_page(size));
1705 	BUG_ON(size > PAGE_SIZE*VMAP_MAX_ALLOC);
1706 
1707 	flush_cache_vunmap(addr, addr + size);
1708 
1709 	order = get_order(size);
1710 	offset = (addr & (VMAP_BLOCK_SIZE - 1)) >> PAGE_SHIFT;
1711 	vb = xa_load(&vmap_blocks, addr_to_vb_idx(addr));
1712 
1713 	unmap_kernel_range_noflush(addr, size);
1714 
1715 	if (debug_pagealloc_enabled_static())
1716 		flush_tlb_kernel_range(addr, addr + size);
1717 
1718 	spin_lock(&vb->lock);
1719 
1720 	/* Expand dirty range */
1721 	vb->dirty_min = min(vb->dirty_min, offset);
1722 	vb->dirty_max = max(vb->dirty_max, offset + (1UL << order));
1723 
1724 	vb->dirty += 1UL << order;
1725 	if (vb->dirty == VMAP_BBMAP_BITS) {
1726 		BUG_ON(vb->free);
1727 		spin_unlock(&vb->lock);
1728 		free_vmap_block(vb);
1729 	} else
1730 		spin_unlock(&vb->lock);
1731 }
1732 
_vm_unmap_aliases(unsigned long start,unsigned long end,int flush)1733 static void _vm_unmap_aliases(unsigned long start, unsigned long end, int flush)
1734 {
1735 	int cpu;
1736 
1737 	if (unlikely(!vmap_initialized))
1738 		return;
1739 
1740 	might_sleep();
1741 
1742 	for_each_possible_cpu(cpu) {
1743 		struct vmap_block_queue *vbq = &per_cpu(vmap_block_queue, cpu);
1744 		struct vmap_block *vb;
1745 
1746 		rcu_read_lock();
1747 		list_for_each_entry_rcu(vb, &vbq->free, free_list) {
1748 			spin_lock(&vb->lock);
1749 			if (vb->dirty && vb->dirty != VMAP_BBMAP_BITS) {
1750 				unsigned long va_start = vb->va->va_start;
1751 				unsigned long s, e;
1752 
1753 				s = va_start + (vb->dirty_min << PAGE_SHIFT);
1754 				e = va_start + (vb->dirty_max << PAGE_SHIFT);
1755 
1756 				start = min(s, start);
1757 				end   = max(e, end);
1758 
1759 				flush = 1;
1760 			}
1761 			spin_unlock(&vb->lock);
1762 		}
1763 		rcu_read_unlock();
1764 	}
1765 
1766 	mutex_lock(&vmap_purge_lock);
1767 	purge_fragmented_blocks_allcpus();
1768 	if (!__purge_vmap_area_lazy(start, end) && flush)
1769 		flush_tlb_kernel_range(start, end);
1770 	mutex_unlock(&vmap_purge_lock);
1771 }
1772 
1773 /**
1774  * vm_unmap_aliases - unmap outstanding lazy aliases in the vmap layer
1775  *
1776  * The vmap/vmalloc layer lazily flushes kernel virtual mappings primarily
1777  * to amortize TLB flushing overheads. What this means is that any page you
1778  * have now, may, in a former life, have been mapped into kernel virtual
1779  * address by the vmap layer and so there might be some CPUs with TLB entries
1780  * still referencing that page (additional to the regular 1:1 kernel mapping).
1781  *
1782  * vm_unmap_aliases flushes all such lazy mappings. After it returns, we can
1783  * be sure that none of the pages we have control over will have any aliases
1784  * from the vmap layer.
1785  */
vm_unmap_aliases(void)1786 void vm_unmap_aliases(void)
1787 {
1788 	unsigned long start = ULONG_MAX, end = 0;
1789 	int flush = 0;
1790 
1791 	_vm_unmap_aliases(start, end, flush);
1792 }
1793 EXPORT_SYMBOL_GPL(vm_unmap_aliases);
1794 
1795 /**
1796  * vm_unmap_ram - unmap linear kernel address space set up by vm_map_ram
1797  * @mem: the pointer returned by vm_map_ram
1798  * @count: the count passed to that vm_map_ram call (cannot unmap partial)
1799  */
vm_unmap_ram(const void * mem,unsigned int count)1800 void vm_unmap_ram(const void *mem, unsigned int count)
1801 {
1802 	unsigned long size = (unsigned long)count << PAGE_SHIFT;
1803 	unsigned long addr = (unsigned long)mem;
1804 	struct vmap_area *va;
1805 
1806 	might_sleep();
1807 	BUG_ON(!addr);
1808 	BUG_ON(addr < VMALLOC_START);
1809 	BUG_ON(addr > VMALLOC_END);
1810 	BUG_ON(!PAGE_ALIGNED(addr));
1811 
1812 	kasan_poison_vmalloc(mem, size);
1813 
1814 	if (likely(count <= VMAP_MAX_ALLOC)) {
1815 		debug_check_no_locks_freed(mem, size);
1816 		vb_free(addr, size);
1817 		return;
1818 	}
1819 
1820 	va = find_vmap_area(addr);
1821 	BUG_ON(!va);
1822 	debug_check_no_locks_freed((void *)va->va_start,
1823 				    (va->va_end - va->va_start));
1824 	free_unmap_vmap_area(va);
1825 }
1826 EXPORT_SYMBOL(vm_unmap_ram);
1827 
1828 /**
1829  * vm_map_ram - map pages linearly into kernel virtual address (vmalloc space)
1830  * @pages: an array of pointers to the pages to be mapped
1831  * @count: number of pages
1832  * @node: prefer to allocate data structures on this node
1833  *
1834  * If you use this function for less than VMAP_MAX_ALLOC pages, it could be
1835  * faster than vmap so it's good.  But if you mix long-life and short-life
1836  * objects with vm_map_ram(), it could consume lots of address space through
1837  * fragmentation (especially on a 32bit machine).  You could see failures in
1838  * the end.  Please use this function for short-lived objects.
1839  *
1840  * Returns: a pointer to the address that has been mapped, or %NULL on failure
1841  */
vm_map_ram(struct page ** pages,unsigned int count,int node)1842 void *vm_map_ram(struct page **pages, unsigned int count, int node)
1843 {
1844 	unsigned long size = (unsigned long)count << PAGE_SHIFT;
1845 	unsigned long addr;
1846 	void *mem;
1847 
1848 	if (likely(count <= VMAP_MAX_ALLOC)) {
1849 		mem = vb_alloc(size, GFP_KERNEL);
1850 		if (IS_ERR(mem))
1851 			return NULL;
1852 		addr = (unsigned long)mem;
1853 	} else {
1854 		struct vmap_area *va;
1855 		va = alloc_vmap_area(size, PAGE_SIZE,
1856 				VMALLOC_START, VMALLOC_END, node, GFP_KERNEL);
1857 		if (IS_ERR(va))
1858 			return NULL;
1859 
1860 		addr = va->va_start;
1861 		mem = (void *)addr;
1862 	}
1863 
1864 	kasan_unpoison_vmalloc(mem, size);
1865 
1866 	if (map_kernel_range(addr, size, PAGE_KERNEL, pages) < 0) {
1867 		vm_unmap_ram(mem, count);
1868 		return NULL;
1869 	}
1870 	return mem;
1871 }
1872 EXPORT_SYMBOL(vm_map_ram);
1873 
1874 static struct vm_struct *vmlist __initdata;
1875 
1876 /**
1877  * vm_area_add_early - add vmap area early during boot
1878  * @vm: vm_struct to add
1879  *
1880  * This function is used to add fixed kernel vm area to vmlist before
1881  * vmalloc_init() is called.  @vm->addr, @vm->size, and @vm->flags
1882  * should contain proper values and the other fields should be zero.
1883  *
1884  * DO NOT USE THIS FUNCTION UNLESS YOU KNOW WHAT YOU'RE DOING.
1885  */
vm_area_add_early(struct vm_struct * vm)1886 void __init vm_area_add_early(struct vm_struct *vm)
1887 {
1888 	struct vm_struct *tmp, **p;
1889 
1890 	BUG_ON(vmap_initialized);
1891 	for (p = &vmlist; (tmp = *p) != NULL; p = &tmp->next) {
1892 		if (tmp->addr >= vm->addr) {
1893 			BUG_ON(tmp->addr < vm->addr + vm->size);
1894 			break;
1895 		} else
1896 			BUG_ON(tmp->addr + tmp->size > vm->addr);
1897 	}
1898 	vm->next = *p;
1899 	*p = vm;
1900 }
1901 
1902 /**
1903  * vm_area_register_early - register vmap area early during boot
1904  * @vm: vm_struct to register
1905  * @align: requested alignment
1906  *
1907  * This function is used to register kernel vm area before
1908  * vmalloc_init() is called.  @vm->size and @vm->flags should contain
1909  * proper values on entry and other fields should be zero.  On return,
1910  * vm->addr contains the allocated address.
1911  *
1912  * DO NOT USE THIS FUNCTION UNLESS YOU KNOW WHAT YOU'RE DOING.
1913  */
vm_area_register_early(struct vm_struct * vm,size_t align)1914 void __init vm_area_register_early(struct vm_struct *vm, size_t align)
1915 {
1916 	static size_t vm_init_off __initdata;
1917 	unsigned long addr;
1918 
1919 	addr = ALIGN(VMALLOC_START + vm_init_off, align);
1920 	vm_init_off = PFN_ALIGN(addr + vm->size) - VMALLOC_START;
1921 
1922 	vm->addr = (void *)addr;
1923 
1924 	vm_area_add_early(vm);
1925 }
1926 
vmap_init_free_space(void)1927 static void vmap_init_free_space(void)
1928 {
1929 	unsigned long vmap_start = 1;
1930 	const unsigned long vmap_end = ULONG_MAX;
1931 	struct vmap_area *busy, *free;
1932 
1933 	/*
1934 	 *     B     F     B     B     B     F
1935 	 * -|-----|.....|-----|-----|-----|.....|-
1936 	 *  |           The KVA space           |
1937 	 *  |<--------------------------------->|
1938 	 */
1939 	list_for_each_entry(busy, &vmap_area_list, list) {
1940 		if (busy->va_start - vmap_start > 0) {
1941 			free = kmem_cache_zalloc(vmap_area_cachep, GFP_NOWAIT);
1942 			if (!WARN_ON_ONCE(!free)) {
1943 				free->va_start = vmap_start;
1944 				free->va_end = busy->va_start;
1945 
1946 				insert_vmap_area_augment(free, NULL,
1947 					&free_vmap_area_root,
1948 						&free_vmap_area_list);
1949 			}
1950 		}
1951 
1952 		vmap_start = busy->va_end;
1953 	}
1954 
1955 	if (vmap_end - vmap_start > 0) {
1956 		free = kmem_cache_zalloc(vmap_area_cachep, GFP_NOWAIT);
1957 		if (!WARN_ON_ONCE(!free)) {
1958 			free->va_start = vmap_start;
1959 			free->va_end = vmap_end;
1960 
1961 			insert_vmap_area_augment(free, NULL,
1962 				&free_vmap_area_root,
1963 					&free_vmap_area_list);
1964 		}
1965 	}
1966 }
1967 
vmalloc_init(void)1968 void __init vmalloc_init(void)
1969 {
1970 	struct vmap_area *va;
1971 	struct vm_struct *tmp;
1972 	int i;
1973 
1974 	/*
1975 	 * Create the cache for vmap_area objects.
1976 	 */
1977 	vmap_area_cachep = KMEM_CACHE(vmap_area, SLAB_PANIC);
1978 
1979 	for_each_possible_cpu(i) {
1980 		struct vmap_block_queue *vbq;
1981 		struct vfree_deferred *p;
1982 
1983 		vbq = &per_cpu(vmap_block_queue, i);
1984 		spin_lock_init(&vbq->lock);
1985 		INIT_LIST_HEAD(&vbq->free);
1986 		p = &per_cpu(vfree_deferred, i);
1987 		init_llist_head(&p->list);
1988 		INIT_WORK(&p->wq, free_work);
1989 	}
1990 
1991 	/* Import existing vmlist entries. */
1992 	for (tmp = vmlist; tmp; tmp = tmp->next) {
1993 		va = kmem_cache_zalloc(vmap_area_cachep, GFP_NOWAIT);
1994 		if (WARN_ON_ONCE(!va))
1995 			continue;
1996 
1997 		va->va_start = (unsigned long)tmp->addr;
1998 		va->va_end = va->va_start + tmp->size;
1999 		va->vm = tmp;
2000 		insert_vmap_area(va, &vmap_area_root, &vmap_area_list);
2001 	}
2002 
2003 	/*
2004 	 * Now we can initialize a free vmap space.
2005 	 */
2006 	vmap_init_free_space();
2007 	vmap_initialized = true;
2008 }
2009 
2010 /**
2011  * unmap_kernel_range - unmap kernel VM area and flush cache and TLB
2012  * @addr: start of the VM area to unmap
2013  * @size: size of the VM area to unmap
2014  *
2015  * Similar to unmap_kernel_range_noflush() but flushes vcache before
2016  * the unmapping and tlb after.
2017  */
unmap_kernel_range(unsigned long addr,unsigned long size)2018 void unmap_kernel_range(unsigned long addr, unsigned long size)
2019 {
2020 	unsigned long end = addr + size;
2021 
2022 	flush_cache_vunmap(addr, end);
2023 	unmap_kernel_range_noflush(addr, size);
2024 	flush_tlb_kernel_range(addr, end);
2025 }
2026 
setup_vmalloc_vm_locked(struct vm_struct * vm,struct vmap_area * va,unsigned long flags,const void * caller)2027 static inline void setup_vmalloc_vm_locked(struct vm_struct *vm,
2028 	struct vmap_area *va, unsigned long flags, const void *caller)
2029 {
2030 	vm->flags = flags;
2031 	vm->addr = (void *)va->va_start;
2032 	vm->size = va->va_end - va->va_start;
2033 	vm->caller = caller;
2034 	va->vm = vm;
2035 }
2036 
setup_vmalloc_vm(struct vm_struct * vm,struct vmap_area * va,unsigned long flags,const void * caller)2037 static void setup_vmalloc_vm(struct vm_struct *vm, struct vmap_area *va,
2038 			      unsigned long flags, const void *caller)
2039 {
2040 	spin_lock(&vmap_area_lock);
2041 	setup_vmalloc_vm_locked(vm, va, flags, caller);
2042 	spin_unlock(&vmap_area_lock);
2043 }
2044 
clear_vm_uninitialized_flag(struct vm_struct * vm)2045 static void clear_vm_uninitialized_flag(struct vm_struct *vm)
2046 {
2047 	/*
2048 	 * Before removing VM_UNINITIALIZED,
2049 	 * we should make sure that vm has proper values.
2050 	 * Pair with smp_rmb() in show_numa_info().
2051 	 */
2052 	smp_wmb();
2053 	vm->flags &= ~VM_UNINITIALIZED;
2054 }
2055 
__get_vm_area_node(unsigned long size,unsigned long align,unsigned long flags,unsigned long start,unsigned long end,int node,gfp_t gfp_mask,const void * caller)2056 static struct vm_struct *__get_vm_area_node(unsigned long size,
2057 		unsigned long align, unsigned long flags, unsigned long start,
2058 		unsigned long end, int node, gfp_t gfp_mask, const void *caller)
2059 {
2060 	struct vmap_area *va;
2061 	struct vm_struct *area;
2062 	unsigned long requested_size = size;
2063 
2064 	BUG_ON(in_interrupt());
2065 	size = PAGE_ALIGN(size);
2066 	if (unlikely(!size))
2067 		return NULL;
2068 
2069 	if (flags & VM_IOREMAP)
2070 		align = 1ul << clamp_t(int, get_count_order_long(size),
2071 				       PAGE_SHIFT, IOREMAP_MAX_ORDER);
2072 
2073 	area = kzalloc_node(sizeof(*area), gfp_mask & GFP_RECLAIM_MASK, node);
2074 	if (unlikely(!area))
2075 		return NULL;
2076 
2077 	if (!(flags & VM_NO_GUARD))
2078 		size += PAGE_SIZE;
2079 
2080 	va = alloc_vmap_area(size, align, start, end, node, gfp_mask);
2081 	if (IS_ERR(va)) {
2082 		kfree(area);
2083 		return NULL;
2084 	}
2085 
2086 	kasan_unpoison_vmalloc((void *)va->va_start, requested_size);
2087 
2088 	setup_vmalloc_vm(area, va, flags, caller);
2089 
2090 	return area;
2091 }
2092 
__get_vm_area_caller(unsigned long size,unsigned long flags,unsigned long start,unsigned long end,const void * caller)2093 struct vm_struct *__get_vm_area_caller(unsigned long size, unsigned long flags,
2094 				       unsigned long start, unsigned long end,
2095 				       const void *caller)
2096 {
2097 	return __get_vm_area_node(size, 1, flags, start, end, NUMA_NO_NODE,
2098 				  GFP_KERNEL, caller);
2099 }
2100 
2101 /**
2102  * get_vm_area - reserve a contiguous kernel virtual area
2103  * @size:	 size of the area
2104  * @flags:	 %VM_IOREMAP for I/O mappings or VM_ALLOC
2105  *
2106  * Search an area of @size in the kernel virtual mapping area,
2107  * and reserved it for out purposes.  Returns the area descriptor
2108  * on success or %NULL on failure.
2109  *
2110  * Return: the area descriptor on success or %NULL on failure.
2111  */
get_vm_area(unsigned long size,unsigned long flags)2112 struct vm_struct *get_vm_area(unsigned long size, unsigned long flags)
2113 {
2114 	return __get_vm_area_node(size, 1, flags, VMALLOC_START, VMALLOC_END,
2115 				  NUMA_NO_NODE, GFP_KERNEL,
2116 				  __builtin_return_address(0));
2117 }
2118 
get_vm_area_caller(unsigned long size,unsigned long flags,const void * caller)2119 struct vm_struct *get_vm_area_caller(unsigned long size, unsigned long flags,
2120 				const void *caller)
2121 {
2122 	return __get_vm_area_node(size, 1, flags, VMALLOC_START, VMALLOC_END,
2123 				  NUMA_NO_NODE, GFP_KERNEL, caller);
2124 }
2125 
2126 /**
2127  * find_vm_area - find a continuous kernel virtual area
2128  * @addr:	  base address
2129  *
2130  * Search for the kernel VM area starting at @addr, and return it.
2131  * It is up to the caller to do all required locking to keep the returned
2132  * pointer valid.
2133  *
2134  * Return: the area descriptor on success or %NULL on failure.
2135  */
find_vm_area(const void * addr)2136 struct vm_struct *find_vm_area(const void *addr)
2137 {
2138 	struct vmap_area *va;
2139 
2140 	va = find_vmap_area((unsigned long)addr);
2141 	if (!va)
2142 		return NULL;
2143 
2144 	return va->vm;
2145 }
2146 
2147 /**
2148  * remove_vm_area - find and remove a continuous kernel virtual area
2149  * @addr:	    base address
2150  *
2151  * Search for the kernel VM area starting at @addr, and remove it.
2152  * This function returns the found VM area, but using it is NOT safe
2153  * on SMP machines, except for its size or flags.
2154  *
2155  * Return: the area descriptor on success or %NULL on failure.
2156  */
remove_vm_area(const void * addr)2157 struct vm_struct *remove_vm_area(const void *addr)
2158 {
2159 	struct vmap_area *va;
2160 
2161 	might_sleep();
2162 
2163 	spin_lock(&vmap_area_lock);
2164 	va = __find_vmap_area((unsigned long)addr);
2165 	if (va && va->vm) {
2166 		struct vm_struct *vm = va->vm;
2167 
2168 		va->vm = NULL;
2169 		spin_unlock(&vmap_area_lock);
2170 
2171 		kasan_free_shadow(vm);
2172 		free_unmap_vmap_area(va);
2173 
2174 		return vm;
2175 	}
2176 
2177 	spin_unlock(&vmap_area_lock);
2178 	return NULL;
2179 }
2180 
set_area_direct_map(const struct vm_struct * area,int (* set_direct_map)(struct page * page))2181 static inline void set_area_direct_map(const struct vm_struct *area,
2182 				       int (*set_direct_map)(struct page *page))
2183 {
2184 	int i;
2185 
2186 	for (i = 0; i < area->nr_pages; i++)
2187 		if (page_address(area->pages[i]))
2188 			set_direct_map(area->pages[i]);
2189 }
2190 
2191 /* Handle removing and resetting vm mappings related to the vm_struct. */
vm_remove_mappings(struct vm_struct * area,int deallocate_pages)2192 static void vm_remove_mappings(struct vm_struct *area, int deallocate_pages)
2193 {
2194 	unsigned long start = ULONG_MAX, end = 0;
2195 	int flush_reset = area->flags & VM_FLUSH_RESET_PERMS;
2196 	int flush_dmap = 0;
2197 	int i;
2198 
2199 	remove_vm_area(area->addr);
2200 
2201 	/* If this is not VM_FLUSH_RESET_PERMS memory, no need for the below. */
2202 	if (!flush_reset)
2203 		return;
2204 
2205 	/*
2206 	 * If not deallocating pages, just do the flush of the VM area and
2207 	 * return.
2208 	 */
2209 	if (!deallocate_pages) {
2210 		vm_unmap_aliases();
2211 		return;
2212 	}
2213 
2214 	/*
2215 	 * If execution gets here, flush the vm mapping and reset the direct
2216 	 * map. Find the start and end range of the direct mappings to make sure
2217 	 * the vm_unmap_aliases() flush includes the direct map.
2218 	 */
2219 	for (i = 0; i < area->nr_pages; i++) {
2220 		unsigned long addr = (unsigned long)page_address(area->pages[i]);
2221 		if (addr) {
2222 			start = min(addr, start);
2223 			end = max(addr + PAGE_SIZE, end);
2224 			flush_dmap = 1;
2225 		}
2226 	}
2227 
2228 	/*
2229 	 * Set direct map to something invalid so that it won't be cached if
2230 	 * there are any accesses after the TLB flush, then flush the TLB and
2231 	 * reset the direct map permissions to the default.
2232 	 */
2233 	set_area_direct_map(area, set_direct_map_invalid_noflush);
2234 	_vm_unmap_aliases(start, end, flush_dmap);
2235 	set_area_direct_map(area, set_direct_map_default_noflush);
2236 }
2237 
__vunmap(const void * addr,int deallocate_pages)2238 static void __vunmap(const void *addr, int deallocate_pages)
2239 {
2240 	struct vm_struct *area;
2241 
2242 	if (!addr)
2243 		return;
2244 
2245 	if (WARN(!PAGE_ALIGNED(addr), "Trying to vfree() bad address (%p)\n",
2246 			addr))
2247 		return;
2248 
2249 	area = find_vm_area(addr);
2250 	if (unlikely(!area)) {
2251 		WARN(1, KERN_ERR "Trying to vfree() nonexistent vm area (%p)\n",
2252 				addr);
2253 		return;
2254 	}
2255 
2256 	debug_check_no_locks_freed(area->addr, get_vm_area_size(area));
2257 	debug_check_no_obj_freed(area->addr, get_vm_area_size(area));
2258 
2259 	kasan_poison_vmalloc(area->addr, get_vm_area_size(area));
2260 
2261 	vm_remove_mappings(area, deallocate_pages);
2262 
2263 	if (deallocate_pages) {
2264 		int i;
2265 
2266 		for (i = 0; i < area->nr_pages; i++) {
2267 			struct page *page = area->pages[i];
2268 
2269 			BUG_ON(!page);
2270 			__free_pages(page, 0);
2271 		}
2272 		atomic_long_sub(area->nr_pages, &nr_vmalloc_pages);
2273 
2274 		kvfree(area->pages);
2275 	}
2276 
2277 	kfree(area);
2278 	return;
2279 }
2280 
__vfree_deferred(const void * addr)2281 static inline void __vfree_deferred(const void *addr)
2282 {
2283 	/*
2284 	 * Use raw_cpu_ptr() because this can be called from preemptible
2285 	 * context. Preemption is absolutely fine here, because the llist_add()
2286 	 * implementation is lockless, so it works even if we are adding to
2287 	 * another cpu's list. schedule_work() should be fine with this too.
2288 	 */
2289 	struct vfree_deferred *p = raw_cpu_ptr(&vfree_deferred);
2290 
2291 	if (llist_add((struct llist_node *)addr, &p->list))
2292 		schedule_work(&p->wq);
2293 }
2294 
2295 /**
2296  * vfree_atomic - release memory allocated by vmalloc()
2297  * @addr:	  memory base address
2298  *
2299  * This one is just like vfree() but can be called in any atomic context
2300  * except NMIs.
2301  */
vfree_atomic(const void * addr)2302 void vfree_atomic(const void *addr)
2303 {
2304 	BUG_ON(in_nmi());
2305 
2306 	kmemleak_free(addr);
2307 
2308 	if (!addr)
2309 		return;
2310 	__vfree_deferred(addr);
2311 }
2312 
__vfree(const void * addr)2313 static void __vfree(const void *addr)
2314 {
2315 	if (unlikely(in_interrupt()))
2316 		__vfree_deferred(addr);
2317 	else
2318 		__vunmap(addr, 1);
2319 }
2320 
2321 /**
2322  * vfree - Release memory allocated by vmalloc()
2323  * @addr:  Memory base address
2324  *
2325  * Free the virtually continuous memory area starting at @addr, as obtained
2326  * from one of the vmalloc() family of APIs.  This will usually also free the
2327  * physical memory underlying the virtual allocation, but that memory is
2328  * reference counted, so it will not be freed until the last user goes away.
2329  *
2330  * If @addr is NULL, no operation is performed.
2331  *
2332  * Context:
2333  * May sleep if called *not* from interrupt context.
2334  * Must not be called in NMI context (strictly speaking, it could be
2335  * if we have CONFIG_ARCH_HAVE_NMI_SAFE_CMPXCHG, but making the calling
2336  * conventions for vfree() arch-depenedent would be a really bad idea).
2337  */
vfree(const void * addr)2338 void vfree(const void *addr)
2339 {
2340 	BUG_ON(in_nmi());
2341 
2342 	kmemleak_free(addr);
2343 
2344 	might_sleep_if(!in_interrupt());
2345 
2346 	if (!addr)
2347 		return;
2348 
2349 	__vfree(addr);
2350 }
2351 EXPORT_SYMBOL(vfree);
2352 
2353 /**
2354  * vunmap - release virtual mapping obtained by vmap()
2355  * @addr:   memory base address
2356  *
2357  * Free the virtually contiguous memory area starting at @addr,
2358  * which was created from the page array passed to vmap().
2359  *
2360  * Must not be called in interrupt context.
2361  */
vunmap(const void * addr)2362 void vunmap(const void *addr)
2363 {
2364 	BUG_ON(in_interrupt());
2365 	might_sleep();
2366 	if (addr)
2367 		__vunmap(addr, 0);
2368 }
2369 EXPORT_SYMBOL(vunmap);
2370 
2371 /**
2372  * vmap - map an array of pages into virtually contiguous space
2373  * @pages: array of page pointers
2374  * @count: number of pages to map
2375  * @flags: vm_area->flags
2376  * @prot: page protection for the mapping
2377  *
2378  * Maps @count pages from @pages into contiguous kernel virtual space.
2379  * If @flags contains %VM_MAP_PUT_PAGES the ownership of the pages array itself
2380  * (which must be kmalloc or vmalloc memory) and one reference per pages in it
2381  * are transferred from the caller to vmap(), and will be freed / dropped when
2382  * vfree() is called on the return value.
2383  *
2384  * Return: the address of the area or %NULL on failure
2385  */
vmap(struct page ** pages,unsigned int count,unsigned long flags,pgprot_t prot)2386 void *vmap(struct page **pages, unsigned int count,
2387 	   unsigned long flags, pgprot_t prot)
2388 {
2389 	struct vm_struct *area;
2390 	unsigned long size;		/* In bytes */
2391 
2392 	might_sleep();
2393 
2394 	if (count > totalram_pages())
2395 		return NULL;
2396 
2397 	size = (unsigned long)count << PAGE_SHIFT;
2398 	area = get_vm_area_caller(size, flags, __builtin_return_address(0));
2399 	if (!area)
2400 		return NULL;
2401 
2402 	if (map_kernel_range((unsigned long)area->addr, size, pgprot_nx(prot),
2403 			pages) < 0) {
2404 		vunmap(area->addr);
2405 		return NULL;
2406 	}
2407 
2408 	if (flags & VM_MAP_PUT_PAGES) {
2409 		area->pages = pages;
2410 		area->nr_pages = count;
2411 	}
2412 	return area->addr;
2413 }
2414 EXPORT_SYMBOL(vmap);
2415 
2416 #ifdef CONFIG_VMAP_PFN
2417 struct vmap_pfn_data {
2418 	unsigned long	*pfns;
2419 	pgprot_t	prot;
2420 	unsigned int	idx;
2421 };
2422 
vmap_pfn_apply(pte_t * pte,unsigned long addr,void * private)2423 static int vmap_pfn_apply(pte_t *pte, unsigned long addr, void *private)
2424 {
2425 	struct vmap_pfn_data *data = private;
2426 
2427 	if (WARN_ON_ONCE(pfn_valid(data->pfns[data->idx])))
2428 		return -EINVAL;
2429 	*pte = pte_mkspecial(pfn_pte(data->pfns[data->idx++], data->prot));
2430 	return 0;
2431 }
2432 
2433 /**
2434  * vmap_pfn - map an array of PFNs into virtually contiguous space
2435  * @pfns: array of PFNs
2436  * @count: number of pages to map
2437  * @prot: page protection for the mapping
2438  *
2439  * Maps @count PFNs from @pfns into contiguous kernel virtual space and returns
2440  * the start address of the mapping.
2441  */
vmap_pfn(unsigned long * pfns,unsigned int count,pgprot_t prot)2442 void *vmap_pfn(unsigned long *pfns, unsigned int count, pgprot_t prot)
2443 {
2444 	struct vmap_pfn_data data = { .pfns = pfns, .prot = pgprot_nx(prot) };
2445 	struct vm_struct *area;
2446 
2447 	area = get_vm_area_caller(count * PAGE_SIZE, VM_IOREMAP,
2448 			__builtin_return_address(0));
2449 	if (!area)
2450 		return NULL;
2451 	if (apply_to_page_range(&init_mm, (unsigned long)area->addr,
2452 			count * PAGE_SIZE, vmap_pfn_apply, &data)) {
2453 		free_vm_area(area);
2454 		return NULL;
2455 	}
2456 	return area->addr;
2457 }
2458 EXPORT_SYMBOL_GPL(vmap_pfn);
2459 #endif /* CONFIG_VMAP_PFN */
2460 
__vmalloc_area_node(struct vm_struct * area,gfp_t gfp_mask,pgprot_t prot,int node)2461 static void *__vmalloc_area_node(struct vm_struct *area, gfp_t gfp_mask,
2462 				 pgprot_t prot, int node)
2463 {
2464 	const gfp_t nested_gfp = (gfp_mask & GFP_RECLAIM_MASK) | __GFP_ZERO;
2465 	unsigned int nr_pages = get_vm_area_size(area) >> PAGE_SHIFT;
2466 	unsigned long array_size;
2467 	unsigned int i;
2468 	struct page **pages;
2469 
2470 	array_size = (unsigned long)nr_pages * sizeof(struct page *);
2471 	gfp_mask |= __GFP_NOWARN;
2472 	if (!(gfp_mask & (GFP_DMA | GFP_DMA32)))
2473 		gfp_mask |= __GFP_HIGHMEM;
2474 
2475 	/* Please note that the recursion is strictly bounded. */
2476 	if (array_size > PAGE_SIZE) {
2477 		pages = __vmalloc_node(array_size, 1, nested_gfp, node,
2478 					area->caller);
2479 	} else {
2480 		pages = kmalloc_node(array_size, nested_gfp, node);
2481 	}
2482 
2483 	if (!pages) {
2484 		remove_vm_area(area->addr);
2485 		kfree(area);
2486 		return NULL;
2487 	}
2488 
2489 	area->pages = pages;
2490 	area->nr_pages = nr_pages;
2491 
2492 	for (i = 0; i < area->nr_pages; i++) {
2493 		struct page *page;
2494 
2495 		if (node == NUMA_NO_NODE)
2496 			page = alloc_page(gfp_mask);
2497 		else
2498 			page = alloc_pages_node(node, gfp_mask, 0);
2499 
2500 		if (unlikely(!page)) {
2501 			/* Successfully allocated i pages, free them in __vfree() */
2502 			area->nr_pages = i;
2503 			atomic_long_add(area->nr_pages, &nr_vmalloc_pages);
2504 			goto fail;
2505 		}
2506 		area->pages[i] = page;
2507 		if (gfpflags_allow_blocking(gfp_mask))
2508 			cond_resched();
2509 	}
2510 	atomic_long_add(area->nr_pages, &nr_vmalloc_pages);
2511 
2512 	if (map_kernel_range((unsigned long)area->addr, get_vm_area_size(area),
2513 			prot, pages) < 0)
2514 		goto fail;
2515 
2516 	return area->addr;
2517 
2518 fail:
2519 	warn_alloc(gfp_mask, NULL,
2520 			  "vmalloc: allocation failure, allocated %ld of %ld bytes",
2521 			  (area->nr_pages*PAGE_SIZE), area->size);
2522 	__vfree(area->addr);
2523 	return NULL;
2524 }
2525 
2526 /**
2527  * __vmalloc_node_range - allocate virtually contiguous memory
2528  * @size:		  allocation size
2529  * @align:		  desired alignment
2530  * @start:		  vm area range start
2531  * @end:		  vm area range end
2532  * @gfp_mask:		  flags for the page level allocator
2533  * @prot:		  protection mask for the allocated pages
2534  * @vm_flags:		  additional vm area flags (e.g. %VM_NO_GUARD)
2535  * @node:		  node to use for allocation or NUMA_NO_NODE
2536  * @caller:		  caller's return address
2537  *
2538  * Allocate enough pages to cover @size from the page level
2539  * allocator with @gfp_mask flags.  Map them into contiguous
2540  * kernel virtual space, using a pagetable protection of @prot.
2541  *
2542  * Return: the address of the area or %NULL on failure
2543  */
__vmalloc_node_range(unsigned long size,unsigned long align,unsigned long start,unsigned long end,gfp_t gfp_mask,pgprot_t prot,unsigned long vm_flags,int node,const void * caller)2544 void *__vmalloc_node_range(unsigned long size, unsigned long align,
2545 			unsigned long start, unsigned long end, gfp_t gfp_mask,
2546 			pgprot_t prot, unsigned long vm_flags, int node,
2547 			const void *caller)
2548 {
2549 	struct vm_struct *area;
2550 	void *addr;
2551 	unsigned long real_size = size;
2552 
2553 	size = PAGE_ALIGN(size);
2554 	if (!size || (size >> PAGE_SHIFT) > totalram_pages())
2555 		goto fail;
2556 
2557 	area = __get_vm_area_node(real_size, align, VM_ALLOC | VM_UNINITIALIZED |
2558 				vm_flags, start, end, node, gfp_mask, caller);
2559 	if (!area)
2560 		goto fail;
2561 
2562 	addr = __vmalloc_area_node(area, gfp_mask, prot, node);
2563 	if (!addr)
2564 		return NULL;
2565 
2566 	/*
2567 	 * In this function, newly allocated vm_struct has VM_UNINITIALIZED
2568 	 * flag. It means that vm_struct is not fully initialized.
2569 	 * Now, it is fully initialized, so remove this flag here.
2570 	 */
2571 	clear_vm_uninitialized_flag(area);
2572 
2573 	kmemleak_vmalloc(area, size, gfp_mask);
2574 
2575 	return addr;
2576 
2577 fail:
2578 	warn_alloc(gfp_mask, NULL,
2579 			  "vmalloc: allocation failure: %lu bytes", real_size);
2580 	return NULL;
2581 }
2582 
2583 /**
2584  * __vmalloc_node - allocate virtually contiguous memory
2585  * @size:	    allocation size
2586  * @align:	    desired alignment
2587  * @gfp_mask:	    flags for the page level allocator
2588  * @node:	    node to use for allocation or NUMA_NO_NODE
2589  * @caller:	    caller's return address
2590  *
2591  * Allocate enough pages to cover @size from the page level allocator with
2592  * @gfp_mask flags.  Map them into contiguous kernel virtual space.
2593  *
2594  * Reclaim modifiers in @gfp_mask - __GFP_NORETRY, __GFP_RETRY_MAYFAIL
2595  * and __GFP_NOFAIL are not supported
2596  *
2597  * Any use of gfp flags outside of GFP_KERNEL should be consulted
2598  * with mm people.
2599  *
2600  * Return: pointer to the allocated memory or %NULL on error
2601  */
__vmalloc_node(unsigned long size,unsigned long align,gfp_t gfp_mask,int node,const void * caller)2602 void *__vmalloc_node(unsigned long size, unsigned long align,
2603 			    gfp_t gfp_mask, int node, const void *caller)
2604 {
2605 	return __vmalloc_node_range(size, align, VMALLOC_START, VMALLOC_END,
2606 				gfp_mask, PAGE_KERNEL, 0, node, caller);
2607 }
2608 /*
2609  * This is only for performance analysis of vmalloc and stress purpose.
2610  * It is required by vmalloc test module, therefore do not use it other
2611  * than that.
2612  */
2613 #ifdef CONFIG_TEST_VMALLOC_MODULE
2614 EXPORT_SYMBOL_GPL(__vmalloc_node);
2615 #endif
2616 
__vmalloc(unsigned long size,gfp_t gfp_mask)2617 void *__vmalloc(unsigned long size, gfp_t gfp_mask)
2618 {
2619 	return __vmalloc_node(size, 1, gfp_mask, NUMA_NO_NODE,
2620 				__builtin_return_address(0));
2621 }
2622 EXPORT_SYMBOL(__vmalloc);
2623 
2624 /**
2625  * vmalloc - allocate virtually contiguous memory
2626  * @size:    allocation size
2627  *
2628  * Allocate enough pages to cover @size from the page level
2629  * allocator and map them into contiguous kernel virtual space.
2630  *
2631  * For tight control over page level allocator and protection flags
2632  * use __vmalloc() instead.
2633  *
2634  * Return: pointer to the allocated memory or %NULL on error
2635  */
vmalloc(unsigned long size)2636 void *vmalloc(unsigned long size)
2637 {
2638 	return __vmalloc_node(size, 1, GFP_KERNEL, NUMA_NO_NODE,
2639 				__builtin_return_address(0));
2640 }
2641 EXPORT_SYMBOL(vmalloc);
2642 
2643 /**
2644  * vzalloc - allocate virtually contiguous memory with zero fill
2645  * @size:    allocation size
2646  *
2647  * Allocate enough pages to cover @size from the page level
2648  * allocator and map them into contiguous kernel virtual space.
2649  * The memory allocated is set to zero.
2650  *
2651  * For tight control over page level allocator and protection flags
2652  * use __vmalloc() instead.
2653  *
2654  * Return: pointer to the allocated memory or %NULL on error
2655  */
vzalloc(unsigned long size)2656 void *vzalloc(unsigned long size)
2657 {
2658 	return __vmalloc_node(size, 1, GFP_KERNEL | __GFP_ZERO, NUMA_NO_NODE,
2659 				__builtin_return_address(0));
2660 }
2661 EXPORT_SYMBOL(vzalloc);
2662 
2663 /**
2664  * vmalloc_user - allocate zeroed virtually contiguous memory for userspace
2665  * @size: allocation size
2666  *
2667  * The resulting memory area is zeroed so it can be mapped to userspace
2668  * without leaking data.
2669  *
2670  * Return: pointer to the allocated memory or %NULL on error
2671  */
vmalloc_user(unsigned long size)2672 void *vmalloc_user(unsigned long size)
2673 {
2674 	return __vmalloc_node_range(size, SHMLBA,  VMALLOC_START, VMALLOC_END,
2675 				    GFP_KERNEL | __GFP_ZERO, PAGE_KERNEL,
2676 				    VM_USERMAP, NUMA_NO_NODE,
2677 				    __builtin_return_address(0));
2678 }
2679 EXPORT_SYMBOL(vmalloc_user);
2680 
2681 /**
2682  * vmalloc_node - allocate memory on a specific node
2683  * @size:	  allocation size
2684  * @node:	  numa node
2685  *
2686  * Allocate enough pages to cover @size from the page level
2687  * allocator and map them into contiguous kernel virtual space.
2688  *
2689  * For tight control over page level allocator and protection flags
2690  * use __vmalloc() instead.
2691  *
2692  * Return: pointer to the allocated memory or %NULL on error
2693  */
vmalloc_node(unsigned long size,int node)2694 void *vmalloc_node(unsigned long size, int node)
2695 {
2696 	return __vmalloc_node(size, 1, GFP_KERNEL, node,
2697 			__builtin_return_address(0));
2698 }
2699 EXPORT_SYMBOL(vmalloc_node);
2700 
2701 /**
2702  * vzalloc_node - allocate memory on a specific node with zero fill
2703  * @size:	allocation size
2704  * @node:	numa node
2705  *
2706  * Allocate enough pages to cover @size from the page level
2707  * allocator and map them into contiguous kernel virtual space.
2708  * The memory allocated is set to zero.
2709  *
2710  * Return: pointer to the allocated memory or %NULL on error
2711  */
vzalloc_node(unsigned long size,int node)2712 void *vzalloc_node(unsigned long size, int node)
2713 {
2714 	return __vmalloc_node(size, 1, GFP_KERNEL | __GFP_ZERO, node,
2715 				__builtin_return_address(0));
2716 }
2717 EXPORT_SYMBOL(vzalloc_node);
2718 
2719 #if defined(CONFIG_64BIT) && defined(CONFIG_ZONE_DMA32)
2720 #define GFP_VMALLOC32 (GFP_DMA32 | GFP_KERNEL)
2721 #elif defined(CONFIG_64BIT) && defined(CONFIG_ZONE_DMA)
2722 #define GFP_VMALLOC32 (GFP_DMA | GFP_KERNEL)
2723 #else
2724 /*
2725  * 64b systems should always have either DMA or DMA32 zones. For others
2726  * GFP_DMA32 should do the right thing and use the normal zone.
2727  */
2728 #define GFP_VMALLOC32 GFP_DMA32 | GFP_KERNEL
2729 #endif
2730 
2731 /**
2732  * vmalloc_32 - allocate virtually contiguous memory (32bit addressable)
2733  * @size:	allocation size
2734  *
2735  * Allocate enough 32bit PA addressable pages to cover @size from the
2736  * page level allocator and map them into contiguous kernel virtual space.
2737  *
2738  * Return: pointer to the allocated memory or %NULL on error
2739  */
vmalloc_32(unsigned long size)2740 void *vmalloc_32(unsigned long size)
2741 {
2742 	return __vmalloc_node(size, 1, GFP_VMALLOC32, NUMA_NO_NODE,
2743 			__builtin_return_address(0));
2744 }
2745 EXPORT_SYMBOL(vmalloc_32);
2746 
2747 /**
2748  * vmalloc_32_user - allocate zeroed virtually contiguous 32bit memory
2749  * @size:	     allocation size
2750  *
2751  * The resulting memory area is 32bit addressable and zeroed so it can be
2752  * mapped to userspace without leaking data.
2753  *
2754  * Return: pointer to the allocated memory or %NULL on error
2755  */
vmalloc_32_user(unsigned long size)2756 void *vmalloc_32_user(unsigned long size)
2757 {
2758 	return __vmalloc_node_range(size, SHMLBA,  VMALLOC_START, VMALLOC_END,
2759 				    GFP_VMALLOC32 | __GFP_ZERO, PAGE_KERNEL,
2760 				    VM_USERMAP, NUMA_NO_NODE,
2761 				    __builtin_return_address(0));
2762 }
2763 EXPORT_SYMBOL(vmalloc_32_user);
2764 
2765 /*
2766  * small helper routine , copy contents to buf from addr.
2767  * If the page is not present, fill zero.
2768  */
2769 
aligned_vread(char * buf,char * addr,unsigned long count)2770 static int aligned_vread(char *buf, char *addr, unsigned long count)
2771 {
2772 	struct page *p;
2773 	int copied = 0;
2774 
2775 	while (count) {
2776 		unsigned long offset, length;
2777 
2778 		offset = offset_in_page(addr);
2779 		length = PAGE_SIZE - offset;
2780 		if (length > count)
2781 			length = count;
2782 		p = vmalloc_to_page(addr);
2783 		/*
2784 		 * To do safe access to this _mapped_ area, we need
2785 		 * lock. But adding lock here means that we need to add
2786 		 * overhead of vmalloc()/vfree() calles for this _debug_
2787 		 * interface, rarely used. Instead of that, we'll use
2788 		 * kmap() and get small overhead in this access function.
2789 		 */
2790 		if (p) {
2791 			/*
2792 			 * we can expect USER0 is not used (see vread/vwrite's
2793 			 * function description)
2794 			 */
2795 			void *map = kmap_atomic(p);
2796 			memcpy(buf, map + offset, length);
2797 			kunmap_atomic(map);
2798 		} else
2799 			memset(buf, 0, length);
2800 
2801 		addr += length;
2802 		buf += length;
2803 		copied += length;
2804 		count -= length;
2805 	}
2806 	return copied;
2807 }
2808 
aligned_vwrite(char * buf,char * addr,unsigned long count)2809 static int aligned_vwrite(char *buf, char *addr, unsigned long count)
2810 {
2811 	struct page *p;
2812 	int copied = 0;
2813 
2814 	while (count) {
2815 		unsigned long offset, length;
2816 
2817 		offset = offset_in_page(addr);
2818 		length = PAGE_SIZE - offset;
2819 		if (length > count)
2820 			length = count;
2821 		p = vmalloc_to_page(addr);
2822 		/*
2823 		 * To do safe access to this _mapped_ area, we need
2824 		 * lock. But adding lock here means that we need to add
2825 		 * overhead of vmalloc()/vfree() calles for this _debug_
2826 		 * interface, rarely used. Instead of that, we'll use
2827 		 * kmap() and get small overhead in this access function.
2828 		 */
2829 		if (p) {
2830 			/*
2831 			 * we can expect USER0 is not used (see vread/vwrite's
2832 			 * function description)
2833 			 */
2834 			void *map = kmap_atomic(p);
2835 			memcpy(map + offset, buf, length);
2836 			kunmap_atomic(map);
2837 		}
2838 		addr += length;
2839 		buf += length;
2840 		copied += length;
2841 		count -= length;
2842 	}
2843 	return copied;
2844 }
2845 
2846 /**
2847  * vread() - read vmalloc area in a safe way.
2848  * @buf:     buffer for reading data
2849  * @addr:    vm address.
2850  * @count:   number of bytes to be read.
2851  *
2852  * This function checks that addr is a valid vmalloc'ed area, and
2853  * copy data from that area to a given buffer. If the given memory range
2854  * of [addr...addr+count) includes some valid address, data is copied to
2855  * proper area of @buf. If there are memory holes, they'll be zero-filled.
2856  * IOREMAP area is treated as memory hole and no copy is done.
2857  *
2858  * If [addr...addr+count) doesn't includes any intersects with alive
2859  * vm_struct area, returns 0. @buf should be kernel's buffer.
2860  *
2861  * Note: In usual ops, vread() is never necessary because the caller
2862  * should know vmalloc() area is valid and can use memcpy().
2863  * This is for routines which have to access vmalloc area without
2864  * any information, as /dev/kmem.
2865  *
2866  * Return: number of bytes for which addr and buf should be increased
2867  * (same number as @count) or %0 if [addr...addr+count) doesn't
2868  * include any intersection with valid vmalloc area
2869  */
vread(char * buf,char * addr,unsigned long count)2870 long vread(char *buf, char *addr, unsigned long count)
2871 {
2872 	struct vmap_area *va;
2873 	struct vm_struct *vm;
2874 	char *vaddr, *buf_start = buf;
2875 	unsigned long buflen = count;
2876 	unsigned long n;
2877 
2878 	/* Don't allow overflow */
2879 	if ((unsigned long) addr + count < count)
2880 		count = -(unsigned long) addr;
2881 
2882 	spin_lock(&vmap_area_lock);
2883 	list_for_each_entry(va, &vmap_area_list, list) {
2884 		if (!count)
2885 			break;
2886 
2887 		if (!va->vm)
2888 			continue;
2889 
2890 		vm = va->vm;
2891 		vaddr = (char *) vm->addr;
2892 		if (addr >= vaddr + get_vm_area_size(vm))
2893 			continue;
2894 		while (addr < vaddr) {
2895 			if (count == 0)
2896 				goto finished;
2897 			*buf = '\0';
2898 			buf++;
2899 			addr++;
2900 			count--;
2901 		}
2902 		n = vaddr + get_vm_area_size(vm) - addr;
2903 		if (n > count)
2904 			n = count;
2905 		if (!(vm->flags & VM_IOREMAP))
2906 			aligned_vread(buf, addr, n);
2907 		else /* IOREMAP area is treated as memory hole */
2908 			memset(buf, 0, n);
2909 		buf += n;
2910 		addr += n;
2911 		count -= n;
2912 	}
2913 finished:
2914 	spin_unlock(&vmap_area_lock);
2915 
2916 	if (buf == buf_start)
2917 		return 0;
2918 	/* zero-fill memory holes */
2919 	if (buf != buf_start + buflen)
2920 		memset(buf, 0, buflen - (buf - buf_start));
2921 
2922 	return buflen;
2923 }
2924 
2925 /**
2926  * vwrite() - write vmalloc area in a safe way.
2927  * @buf:      buffer for source data
2928  * @addr:     vm address.
2929  * @count:    number of bytes to be read.
2930  *
2931  * This function checks that addr is a valid vmalloc'ed area, and
2932  * copy data from a buffer to the given addr. If specified range of
2933  * [addr...addr+count) includes some valid address, data is copied from
2934  * proper area of @buf. If there are memory holes, no copy to hole.
2935  * IOREMAP area is treated as memory hole and no copy is done.
2936  *
2937  * If [addr...addr+count) doesn't includes any intersects with alive
2938  * vm_struct area, returns 0. @buf should be kernel's buffer.
2939  *
2940  * Note: In usual ops, vwrite() is never necessary because the caller
2941  * should know vmalloc() area is valid and can use memcpy().
2942  * This is for routines which have to access vmalloc area without
2943  * any information, as /dev/kmem.
2944  *
2945  * Return: number of bytes for which addr and buf should be
2946  * increased (same number as @count) or %0 if [addr...addr+count)
2947  * doesn't include any intersection with valid vmalloc area
2948  */
vwrite(char * buf,char * addr,unsigned long count)2949 long vwrite(char *buf, char *addr, unsigned long count)
2950 {
2951 	struct vmap_area *va;
2952 	struct vm_struct *vm;
2953 	char *vaddr;
2954 	unsigned long n, buflen;
2955 	int copied = 0;
2956 
2957 	/* Don't allow overflow */
2958 	if ((unsigned long) addr + count < count)
2959 		count = -(unsigned long) addr;
2960 	buflen = count;
2961 
2962 	spin_lock(&vmap_area_lock);
2963 	list_for_each_entry(va, &vmap_area_list, list) {
2964 		if (!count)
2965 			break;
2966 
2967 		if (!va->vm)
2968 			continue;
2969 
2970 		vm = va->vm;
2971 		vaddr = (char *) vm->addr;
2972 		if (addr >= vaddr + get_vm_area_size(vm))
2973 			continue;
2974 		while (addr < vaddr) {
2975 			if (count == 0)
2976 				goto finished;
2977 			buf++;
2978 			addr++;
2979 			count--;
2980 		}
2981 		n = vaddr + get_vm_area_size(vm) - addr;
2982 		if (n > count)
2983 			n = count;
2984 		if (!(vm->flags & VM_IOREMAP)) {
2985 			aligned_vwrite(buf, addr, n);
2986 			copied++;
2987 		}
2988 		buf += n;
2989 		addr += n;
2990 		count -= n;
2991 	}
2992 finished:
2993 	spin_unlock(&vmap_area_lock);
2994 	if (!copied)
2995 		return 0;
2996 	return buflen;
2997 }
2998 
2999 /**
3000  * remap_vmalloc_range_partial - map vmalloc pages to userspace
3001  * @vma:		vma to cover
3002  * @uaddr:		target user address to start at
3003  * @kaddr:		virtual address of vmalloc kernel memory
3004  * @pgoff:		offset from @kaddr to start at
3005  * @size:		size of map area
3006  *
3007  * Returns:	0 for success, -Exxx on failure
3008  *
3009  * This function checks that @kaddr is a valid vmalloc'ed area,
3010  * and that it is big enough to cover the range starting at
3011  * @uaddr in @vma. Will return failure if that criteria isn't
3012  * met.
3013  *
3014  * Similar to remap_pfn_range() (see mm/memory.c)
3015  */
remap_vmalloc_range_partial(struct vm_area_struct * vma,unsigned long uaddr,void * kaddr,unsigned long pgoff,unsigned long size)3016 int remap_vmalloc_range_partial(struct vm_area_struct *vma, unsigned long uaddr,
3017 				void *kaddr, unsigned long pgoff,
3018 				unsigned long size)
3019 {
3020 	struct vm_struct *area;
3021 	unsigned long off;
3022 	unsigned long end_index;
3023 
3024 	if (check_shl_overflow(pgoff, PAGE_SHIFT, &off))
3025 		return -EINVAL;
3026 
3027 	size = PAGE_ALIGN(size);
3028 
3029 	if (!PAGE_ALIGNED(uaddr) || !PAGE_ALIGNED(kaddr))
3030 		return -EINVAL;
3031 
3032 	area = find_vm_area(kaddr);
3033 	if (!area)
3034 		return -EINVAL;
3035 
3036 	if (!(area->flags & (VM_USERMAP | VM_DMA_COHERENT)))
3037 		return -EINVAL;
3038 
3039 	if (check_add_overflow(size, off, &end_index) ||
3040 	    end_index > get_vm_area_size(area))
3041 		return -EINVAL;
3042 	kaddr += off;
3043 
3044 	do {
3045 		struct page *page = vmalloc_to_page(kaddr);
3046 		int ret;
3047 
3048 		ret = vm_insert_page(vma, uaddr, page);
3049 		if (ret)
3050 			return ret;
3051 
3052 		uaddr += PAGE_SIZE;
3053 		kaddr += PAGE_SIZE;
3054 		size -= PAGE_SIZE;
3055 	} while (size > 0);
3056 
3057 	vma->vm_flags |= VM_DONTEXPAND | VM_DONTDUMP;
3058 
3059 	return 0;
3060 }
3061 EXPORT_SYMBOL(remap_vmalloc_range_partial);
3062 
3063 /**
3064  * remap_vmalloc_range - map vmalloc pages to userspace
3065  * @vma:		vma to cover (map full range of vma)
3066  * @addr:		vmalloc memory
3067  * @pgoff:		number of pages into addr before first page to map
3068  *
3069  * Returns:	0 for success, -Exxx on failure
3070  *
3071  * This function checks that addr is a valid vmalloc'ed area, and
3072  * that it is big enough to cover the vma. Will return failure if
3073  * that criteria isn't met.
3074  *
3075  * Similar to remap_pfn_range() (see mm/memory.c)
3076  */
remap_vmalloc_range(struct vm_area_struct * vma,void * addr,unsigned long pgoff)3077 int remap_vmalloc_range(struct vm_area_struct *vma, void *addr,
3078 						unsigned long pgoff)
3079 {
3080 	return remap_vmalloc_range_partial(vma, vma->vm_start,
3081 					   addr, pgoff,
3082 					   vma->vm_end - vma->vm_start);
3083 }
3084 EXPORT_SYMBOL(remap_vmalloc_range);
3085 
free_vm_area(struct vm_struct * area)3086 void free_vm_area(struct vm_struct *area)
3087 {
3088 	struct vm_struct *ret;
3089 	ret = remove_vm_area(area->addr);
3090 	BUG_ON(ret != area);
3091 	kfree(area);
3092 }
3093 EXPORT_SYMBOL_GPL(free_vm_area);
3094 
3095 #ifdef CONFIG_SMP
node_to_va(struct rb_node * n)3096 static struct vmap_area *node_to_va(struct rb_node *n)
3097 {
3098 	return rb_entry_safe(n, struct vmap_area, rb_node);
3099 }
3100 
3101 /**
3102  * pvm_find_va_enclose_addr - find the vmap_area @addr belongs to
3103  * @addr: target address
3104  *
3105  * Returns: vmap_area if it is found. If there is no such area
3106  *   the first highest(reverse order) vmap_area is returned
3107  *   i.e. va->va_start < addr && va->va_end < addr or NULL
3108  *   if there are no any areas before @addr.
3109  */
3110 static struct vmap_area *
pvm_find_va_enclose_addr(unsigned long addr)3111 pvm_find_va_enclose_addr(unsigned long addr)
3112 {
3113 	struct vmap_area *va, *tmp;
3114 	struct rb_node *n;
3115 
3116 	n = free_vmap_area_root.rb_node;
3117 	va = NULL;
3118 
3119 	while (n) {
3120 		tmp = rb_entry(n, struct vmap_area, rb_node);
3121 		if (tmp->va_start <= addr) {
3122 			va = tmp;
3123 			if (tmp->va_end >= addr)
3124 				break;
3125 
3126 			n = n->rb_right;
3127 		} else {
3128 			n = n->rb_left;
3129 		}
3130 	}
3131 
3132 	return va;
3133 }
3134 
3135 /**
3136  * pvm_determine_end_from_reverse - find the highest aligned address
3137  * of free block below VMALLOC_END
3138  * @va:
3139  *   in - the VA we start the search(reverse order);
3140  *   out - the VA with the highest aligned end address.
3141  *
3142  * Returns: determined end address within vmap_area
3143  */
3144 static unsigned long
pvm_determine_end_from_reverse(struct vmap_area ** va,unsigned long align)3145 pvm_determine_end_from_reverse(struct vmap_area **va, unsigned long align)
3146 {
3147 	unsigned long vmalloc_end = VMALLOC_END & ~(align - 1);
3148 	unsigned long addr;
3149 
3150 	if (likely(*va)) {
3151 		list_for_each_entry_from_reverse((*va),
3152 				&free_vmap_area_list, list) {
3153 			addr = min((*va)->va_end & ~(align - 1), vmalloc_end);
3154 			if ((*va)->va_start < addr)
3155 				return addr;
3156 		}
3157 	}
3158 
3159 	return 0;
3160 }
3161 
3162 /**
3163  * pcpu_get_vm_areas - allocate vmalloc areas for percpu allocator
3164  * @offsets: array containing offset of each area
3165  * @sizes: array containing size of each area
3166  * @nr_vms: the number of areas to allocate
3167  * @align: alignment, all entries in @offsets and @sizes must be aligned to this
3168  *
3169  * Returns: kmalloc'd vm_struct pointer array pointing to allocated
3170  *	    vm_structs on success, %NULL on failure
3171  *
3172  * Percpu allocator wants to use congruent vm areas so that it can
3173  * maintain the offsets among percpu areas.  This function allocates
3174  * congruent vmalloc areas for it with GFP_KERNEL.  These areas tend to
3175  * be scattered pretty far, distance between two areas easily going up
3176  * to gigabytes.  To avoid interacting with regular vmallocs, these
3177  * areas are allocated from top.
3178  *
3179  * Despite its complicated look, this allocator is rather simple. It
3180  * does everything top-down and scans free blocks from the end looking
3181  * for matching base. While scanning, if any of the areas do not fit the
3182  * base address is pulled down to fit the area. Scanning is repeated till
3183  * all the areas fit and then all necessary data structures are inserted
3184  * and the result is returned.
3185  */
pcpu_get_vm_areas(const unsigned long * offsets,const size_t * sizes,int nr_vms,size_t align)3186 struct vm_struct **pcpu_get_vm_areas(const unsigned long *offsets,
3187 				     const size_t *sizes, int nr_vms,
3188 				     size_t align)
3189 {
3190 	const unsigned long vmalloc_start = ALIGN(VMALLOC_START, align);
3191 	const unsigned long vmalloc_end = VMALLOC_END & ~(align - 1);
3192 	struct vmap_area **vas, *va;
3193 	struct vm_struct **vms;
3194 	int area, area2, last_area, term_area;
3195 	unsigned long base, start, size, end, last_end, orig_start, orig_end;
3196 	bool purged = false;
3197 	enum fit_type type;
3198 
3199 	/* verify parameters and allocate data structures */
3200 	BUG_ON(offset_in_page(align) || !is_power_of_2(align));
3201 	for (last_area = 0, area = 0; area < nr_vms; area++) {
3202 		start = offsets[area];
3203 		end = start + sizes[area];
3204 
3205 		/* is everything aligned properly? */
3206 		BUG_ON(!IS_ALIGNED(offsets[area], align));
3207 		BUG_ON(!IS_ALIGNED(sizes[area], align));
3208 
3209 		/* detect the area with the highest address */
3210 		if (start > offsets[last_area])
3211 			last_area = area;
3212 
3213 		for (area2 = area + 1; area2 < nr_vms; area2++) {
3214 			unsigned long start2 = offsets[area2];
3215 			unsigned long end2 = start2 + sizes[area2];
3216 
3217 			BUG_ON(start2 < end && start < end2);
3218 		}
3219 	}
3220 	last_end = offsets[last_area] + sizes[last_area];
3221 
3222 	if (vmalloc_end - vmalloc_start < last_end) {
3223 		WARN_ON(true);
3224 		return NULL;
3225 	}
3226 
3227 	vms = kcalloc(nr_vms, sizeof(vms[0]), GFP_KERNEL);
3228 	vas = kcalloc(nr_vms, sizeof(vas[0]), GFP_KERNEL);
3229 	if (!vas || !vms)
3230 		goto err_free2;
3231 
3232 	for (area = 0; area < nr_vms; area++) {
3233 		vas[area] = kmem_cache_zalloc(vmap_area_cachep, GFP_KERNEL);
3234 		vms[area] = kzalloc(sizeof(struct vm_struct), GFP_KERNEL);
3235 		if (!vas[area] || !vms[area])
3236 			goto err_free;
3237 	}
3238 retry:
3239 	spin_lock(&free_vmap_area_lock);
3240 
3241 	/* start scanning - we scan from the top, begin with the last area */
3242 	area = term_area = last_area;
3243 	start = offsets[area];
3244 	end = start + sizes[area];
3245 
3246 	va = pvm_find_va_enclose_addr(vmalloc_end);
3247 	base = pvm_determine_end_from_reverse(&va, align) - end;
3248 
3249 	while (true) {
3250 		/*
3251 		 * base might have underflowed, add last_end before
3252 		 * comparing.
3253 		 */
3254 		if (base + last_end < vmalloc_start + last_end)
3255 			goto overflow;
3256 
3257 		/*
3258 		 * Fitting base has not been found.
3259 		 */
3260 		if (va == NULL)
3261 			goto overflow;
3262 
3263 		/*
3264 		 * If required width exceeds current VA block, move
3265 		 * base downwards and then recheck.
3266 		 */
3267 		if (base + end > va->va_end) {
3268 			base = pvm_determine_end_from_reverse(&va, align) - end;
3269 			term_area = area;
3270 			continue;
3271 		}
3272 
3273 		/*
3274 		 * If this VA does not fit, move base downwards and recheck.
3275 		 */
3276 		if (base + start < va->va_start) {
3277 			va = node_to_va(rb_prev(&va->rb_node));
3278 			base = pvm_determine_end_from_reverse(&va, align) - end;
3279 			term_area = area;
3280 			continue;
3281 		}
3282 
3283 		/*
3284 		 * This area fits, move on to the previous one.  If
3285 		 * the previous one is the terminal one, we're done.
3286 		 */
3287 		area = (area + nr_vms - 1) % nr_vms;
3288 		if (area == term_area)
3289 			break;
3290 
3291 		start = offsets[area];
3292 		end = start + sizes[area];
3293 		va = pvm_find_va_enclose_addr(base + end);
3294 	}
3295 
3296 	/* we've found a fitting base, insert all va's */
3297 	for (area = 0; area < nr_vms; area++) {
3298 		int ret;
3299 
3300 		start = base + offsets[area];
3301 		size = sizes[area];
3302 
3303 		va = pvm_find_va_enclose_addr(start);
3304 		if (WARN_ON_ONCE(va == NULL))
3305 			/* It is a BUG(), but trigger recovery instead. */
3306 			goto recovery;
3307 
3308 		type = classify_va_fit_type(va, start, size);
3309 		if (WARN_ON_ONCE(type == NOTHING_FIT))
3310 			/* It is a BUG(), but trigger recovery instead. */
3311 			goto recovery;
3312 
3313 		ret = adjust_va_to_fit_type(va, start, size, type);
3314 		if (unlikely(ret))
3315 			goto recovery;
3316 
3317 		/* Allocated area. */
3318 		va = vas[area];
3319 		va->va_start = start;
3320 		va->va_end = start + size;
3321 	}
3322 
3323 	spin_unlock(&free_vmap_area_lock);
3324 
3325 	/* populate the kasan shadow space */
3326 	for (area = 0; area < nr_vms; area++) {
3327 		if (kasan_populate_vmalloc(vas[area]->va_start, sizes[area]))
3328 			goto err_free_shadow;
3329 
3330 		kasan_unpoison_vmalloc((void *)vas[area]->va_start,
3331 				       sizes[area]);
3332 	}
3333 
3334 	/* insert all vm's */
3335 	spin_lock(&vmap_area_lock);
3336 	for (area = 0; area < nr_vms; area++) {
3337 		insert_vmap_area(vas[area], &vmap_area_root, &vmap_area_list);
3338 
3339 		setup_vmalloc_vm_locked(vms[area], vas[area], VM_ALLOC,
3340 				 pcpu_get_vm_areas);
3341 	}
3342 	spin_unlock(&vmap_area_lock);
3343 
3344 	kfree(vas);
3345 	return vms;
3346 
3347 recovery:
3348 	/*
3349 	 * Remove previously allocated areas. There is no
3350 	 * need in removing these areas from the busy tree,
3351 	 * because they are inserted only on the final step
3352 	 * and when pcpu_get_vm_areas() is success.
3353 	 */
3354 	while (area--) {
3355 		orig_start = vas[area]->va_start;
3356 		orig_end = vas[area]->va_end;
3357 		va = merge_or_add_vmap_area(vas[area], &free_vmap_area_root,
3358 					    &free_vmap_area_list);
3359 		if (va)
3360 			kasan_release_vmalloc(orig_start, orig_end,
3361 				va->va_start, va->va_end);
3362 		vas[area] = NULL;
3363 	}
3364 
3365 overflow:
3366 	spin_unlock(&free_vmap_area_lock);
3367 	if (!purged) {
3368 		purge_vmap_area_lazy();
3369 		purged = true;
3370 
3371 		/* Before "retry", check if we recover. */
3372 		for (area = 0; area < nr_vms; area++) {
3373 			if (vas[area])
3374 				continue;
3375 
3376 			vas[area] = kmem_cache_zalloc(
3377 				vmap_area_cachep, GFP_KERNEL);
3378 			if (!vas[area])
3379 				goto err_free;
3380 		}
3381 
3382 		goto retry;
3383 	}
3384 
3385 err_free:
3386 	for (area = 0; area < nr_vms; area++) {
3387 		if (vas[area])
3388 			kmem_cache_free(vmap_area_cachep, vas[area]);
3389 
3390 		kfree(vms[area]);
3391 	}
3392 err_free2:
3393 	kfree(vas);
3394 	kfree(vms);
3395 	return NULL;
3396 
3397 err_free_shadow:
3398 	spin_lock(&free_vmap_area_lock);
3399 	/*
3400 	 * We release all the vmalloc shadows, even the ones for regions that
3401 	 * hadn't been successfully added. This relies on kasan_release_vmalloc
3402 	 * being able to tolerate this case.
3403 	 */
3404 	for (area = 0; area < nr_vms; area++) {
3405 		orig_start = vas[area]->va_start;
3406 		orig_end = vas[area]->va_end;
3407 		va = merge_or_add_vmap_area(vas[area], &free_vmap_area_root,
3408 					    &free_vmap_area_list);
3409 		if (va)
3410 			kasan_release_vmalloc(orig_start, orig_end,
3411 				va->va_start, va->va_end);
3412 		vas[area] = NULL;
3413 		kfree(vms[area]);
3414 	}
3415 	spin_unlock(&free_vmap_area_lock);
3416 	kfree(vas);
3417 	kfree(vms);
3418 	return NULL;
3419 }
3420 
3421 /**
3422  * pcpu_free_vm_areas - free vmalloc areas for percpu allocator
3423  * @vms: vm_struct pointer array returned by pcpu_get_vm_areas()
3424  * @nr_vms: the number of allocated areas
3425  *
3426  * Free vm_structs and the array allocated by pcpu_get_vm_areas().
3427  */
pcpu_free_vm_areas(struct vm_struct ** vms,int nr_vms)3428 void pcpu_free_vm_areas(struct vm_struct **vms, int nr_vms)
3429 {
3430 	int i;
3431 
3432 	for (i = 0; i < nr_vms; i++)
3433 		free_vm_area(vms[i]);
3434 	kfree(vms);
3435 }
3436 #endif	/* CONFIG_SMP */
3437 
3438 #ifdef CONFIG_PROC_FS
s_start(struct seq_file * m,loff_t * pos)3439 static void *s_start(struct seq_file *m, loff_t *pos)
3440 	__acquires(&vmap_purge_lock)
3441 	__acquires(&vmap_area_lock)
3442 {
3443 	mutex_lock(&vmap_purge_lock);
3444 	spin_lock(&vmap_area_lock);
3445 
3446 	return seq_list_start(&vmap_area_list, *pos);
3447 }
3448 
s_next(struct seq_file * m,void * p,loff_t * pos)3449 static void *s_next(struct seq_file *m, void *p, loff_t *pos)
3450 {
3451 	return seq_list_next(p, &vmap_area_list, pos);
3452 }
3453 
s_stop(struct seq_file * m,void * p)3454 static void s_stop(struct seq_file *m, void *p)
3455 	__releases(&vmap_area_lock)
3456 	__releases(&vmap_purge_lock)
3457 {
3458 	spin_unlock(&vmap_area_lock);
3459 	mutex_unlock(&vmap_purge_lock);
3460 }
3461 
show_numa_info(struct seq_file * m,struct vm_struct * v)3462 static void show_numa_info(struct seq_file *m, struct vm_struct *v)
3463 {
3464 	if (IS_ENABLED(CONFIG_NUMA)) {
3465 		unsigned int nr, *counters = m->private;
3466 
3467 		if (!counters)
3468 			return;
3469 
3470 		if (v->flags & VM_UNINITIALIZED)
3471 			return;
3472 		/* Pair with smp_wmb() in clear_vm_uninitialized_flag() */
3473 		smp_rmb();
3474 
3475 		memset(counters, 0, nr_node_ids * sizeof(unsigned int));
3476 
3477 		for (nr = 0; nr < v->nr_pages; nr++)
3478 			counters[page_to_nid(v->pages[nr])]++;
3479 
3480 		for_each_node_state(nr, N_HIGH_MEMORY)
3481 			if (counters[nr])
3482 				seq_printf(m, " N%u=%u", nr, counters[nr]);
3483 	}
3484 }
3485 
show_purge_info(struct seq_file * m)3486 static void show_purge_info(struct seq_file *m)
3487 {
3488 	struct llist_node *head;
3489 	struct vmap_area *va;
3490 
3491 	head = READ_ONCE(vmap_purge_list.first);
3492 	if (head == NULL)
3493 		return;
3494 
3495 	llist_for_each_entry(va, head, purge_list) {
3496 		seq_printf(m, "0x%pK-0x%pK %7ld unpurged vm_area\n",
3497 			(void *)va->va_start, (void *)va->va_end,
3498 			va->va_end - va->va_start);
3499 	}
3500 }
3501 
s_show(struct seq_file * m,void * p)3502 static int s_show(struct seq_file *m, void *p)
3503 {
3504 	struct vmap_area *va;
3505 	struct vm_struct *v;
3506 
3507 	va = list_entry(p, struct vmap_area, list);
3508 
3509 	/*
3510 	 * s_show can encounter race with remove_vm_area, !vm on behalf
3511 	 * of vmap area is being tear down or vm_map_ram allocation.
3512 	 */
3513 	if (!va->vm) {
3514 		seq_printf(m, "0x%pK-0x%pK %7ld vm_map_ram\n",
3515 			(void *)va->va_start, (void *)va->va_end,
3516 			va->va_end - va->va_start);
3517 
3518 		return 0;
3519 	}
3520 
3521 	v = va->vm;
3522 
3523 	seq_printf(m, "0x%pK-0x%pK %7ld",
3524 		v->addr, v->addr + v->size, v->size);
3525 
3526 	if (v->caller)
3527 		seq_printf(m, " %pS", v->caller);
3528 
3529 	if (v->nr_pages)
3530 		seq_printf(m, " pages=%d", v->nr_pages);
3531 
3532 	if (v->phys_addr)
3533 		seq_printf(m, " phys=%pa", &v->phys_addr);
3534 
3535 	if (v->flags & VM_IOREMAP)
3536 		seq_puts(m, " ioremap");
3537 
3538 	if (v->flags & VM_ALLOC)
3539 		seq_puts(m, " vmalloc");
3540 
3541 	if (v->flags & VM_MAP)
3542 		seq_puts(m, " vmap");
3543 
3544 	if (v->flags & VM_USERMAP)
3545 		seq_puts(m, " user");
3546 
3547 	if (v->flags & VM_DMA_COHERENT)
3548 		seq_puts(m, " dma-coherent");
3549 
3550 	if (is_vmalloc_addr(v->pages))
3551 		seq_puts(m, " vpages");
3552 
3553 	show_numa_info(m, v);
3554 	seq_putc(m, '\n');
3555 
3556 	/*
3557 	 * As a final step, dump "unpurged" areas. Note,
3558 	 * that entire "/proc/vmallocinfo" output will not
3559 	 * be address sorted, because the purge list is not
3560 	 * sorted.
3561 	 */
3562 	if (list_is_last(&va->list, &vmap_area_list))
3563 		show_purge_info(m);
3564 
3565 	return 0;
3566 }
3567 
3568 static const struct seq_operations vmalloc_op = {
3569 	.start = s_start,
3570 	.next = s_next,
3571 	.stop = s_stop,
3572 	.show = s_show,
3573 };
3574 
proc_vmalloc_init(void)3575 static int __init proc_vmalloc_init(void)
3576 {
3577 	if (IS_ENABLED(CONFIG_NUMA))
3578 		proc_create_seq_private("vmallocinfo", 0400, NULL,
3579 				&vmalloc_op,
3580 				nr_node_ids * sizeof(unsigned int), NULL);
3581 	else
3582 		proc_create_seq("vmallocinfo", 0400, NULL, &vmalloc_op);
3583 	return 0;
3584 }
3585 module_init(proc_vmalloc_init);
3586 
3587 #endif
3588