mm/memory_hotplug: track present pages in memory groups
[platform/kernel/linux-rpi.git] / mm / memory_hotplug.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  *  linux/mm/memory_hotplug.c
4  *
5  *  Copyright (C)
6  */
7
8 #include <linux/stddef.h>
9 #include <linux/mm.h>
10 #include <linux/sched/signal.h>
11 #include <linux/swap.h>
12 #include <linux/interrupt.h>
13 #include <linux/pagemap.h>
14 #include <linux/compiler.h>
15 #include <linux/export.h>
16 #include <linux/pagevec.h>
17 #include <linux/writeback.h>
18 #include <linux/slab.h>
19 #include <linux/sysctl.h>
20 #include <linux/cpu.h>
21 #include <linux/memory.h>
22 #include <linux/memremap.h>
23 #include <linux/memory_hotplug.h>
24 #include <linux/highmem.h>
25 #include <linux/vmalloc.h>
26 #include <linux/ioport.h>
27 #include <linux/delay.h>
28 #include <linux/migrate.h>
29 #include <linux/page-isolation.h>
30 #include <linux/pfn.h>
31 #include <linux/suspend.h>
32 #include <linux/mm_inline.h>
33 #include <linux/firmware-map.h>
34 #include <linux/stop_machine.h>
35 #include <linux/hugetlb.h>
36 #include <linux/memblock.h>
37 #include <linux/compaction.h>
38 #include <linux/rmap.h>
39
40 #include <asm/tlbflush.h>
41
42 #include "internal.h"
43 #include "shuffle.h"
44
45
46 /*
47  * memory_hotplug.memmap_on_memory parameter
48  */
49 static bool memmap_on_memory __ro_after_init;
50 #ifdef CONFIG_MHP_MEMMAP_ON_MEMORY
51 module_param(memmap_on_memory, bool, 0444);
52 MODULE_PARM_DESC(memmap_on_memory, "Enable memmap on memory for memory hotplug");
53 #endif
54
55 enum {
56         ONLINE_POLICY_CONTIG_ZONES = 0,
57         ONLINE_POLICY_AUTO_MOVABLE,
58 };
59
60 const char *online_policy_to_str[] = {
61         [ONLINE_POLICY_CONTIG_ZONES] = "contig-zones",
62         [ONLINE_POLICY_AUTO_MOVABLE] = "auto-movable",
63 };
64
65 static int set_online_policy(const char *val, const struct kernel_param *kp)
66 {
67         int ret = sysfs_match_string(online_policy_to_str, val);
68
69         if (ret < 0)
70                 return ret;
71         *((int *)kp->arg) = ret;
72         return 0;
73 }
74
75 static int get_online_policy(char *buffer, const struct kernel_param *kp)
76 {
77         return sprintf(buffer, "%s\n", online_policy_to_str[*((int *)kp->arg)]);
78 }
79
80 /*
81  * memory_hotplug.online_policy: configure online behavior when onlining without
82  * specifying a zone (MMOP_ONLINE)
83  *
84  * "contig-zones": keep zone contiguous
85  * "auto-movable": online memory to ZONE_MOVABLE if the configuration
86  *                 (auto_movable_ratio, auto_movable_numa_aware) allows for it
87  */
88 static int online_policy __read_mostly = ONLINE_POLICY_CONTIG_ZONES;
89 static const struct kernel_param_ops online_policy_ops = {
90         .set = set_online_policy,
91         .get = get_online_policy,
92 };
93 module_param_cb(online_policy, &online_policy_ops, &online_policy, 0644);
94 MODULE_PARM_DESC(online_policy,
95                 "Set the online policy (\"contig-zones\", \"auto-movable\") "
96                 "Default: \"contig-zones\"");
97
98 /*
99  * memory_hotplug.auto_movable_ratio: specify maximum MOVABLE:KERNEL ratio
100  *
101  * The ratio represent an upper limit and the kernel might decide to not
102  * online some memory to ZONE_MOVABLE -- e.g., because hotplugged KERNEL memory
103  * doesn't allow for more MOVABLE memory.
104  */
105 static unsigned int auto_movable_ratio __read_mostly = 301;
106 module_param(auto_movable_ratio, uint, 0644);
107 MODULE_PARM_DESC(auto_movable_ratio,
108                 "Set the maximum ratio of MOVABLE:KERNEL memory in the system "
109                 "in percent for \"auto-movable\" online policy. Default: 301");
110
111 /*
112  * memory_hotplug.auto_movable_numa_aware: consider numa node stats
113  */
114 #ifdef CONFIG_NUMA
115 static bool auto_movable_numa_aware __read_mostly = true;
116 module_param(auto_movable_numa_aware, bool, 0644);
117 MODULE_PARM_DESC(auto_movable_numa_aware,
118                 "Consider numa node stats in addition to global stats in "
119                 "\"auto-movable\" online policy. Default: true");
120 #endif /* CONFIG_NUMA */
121
122 /*
123  * online_page_callback contains pointer to current page onlining function.
124  * Initially it is generic_online_page(). If it is required it could be
125  * changed by calling set_online_page_callback() for callback registration
126  * and restore_online_page_callback() for generic callback restore.
127  */
128
129 static online_page_callback_t online_page_callback = generic_online_page;
130 static DEFINE_MUTEX(online_page_callback_lock);
131
132 DEFINE_STATIC_PERCPU_RWSEM(mem_hotplug_lock);
133
134 void get_online_mems(void)
135 {
136         percpu_down_read(&mem_hotplug_lock);
137 }
138
139 void put_online_mems(void)
140 {
141         percpu_up_read(&mem_hotplug_lock);
142 }
143
144 bool movable_node_enabled = false;
145
146 #ifndef CONFIG_MEMORY_HOTPLUG_DEFAULT_ONLINE
147 int mhp_default_online_type = MMOP_OFFLINE;
148 #else
149 int mhp_default_online_type = MMOP_ONLINE;
150 #endif
151
152 static int __init setup_memhp_default_state(char *str)
153 {
154         const int online_type = mhp_online_type_from_str(str);
155
156         if (online_type >= 0)
157                 mhp_default_online_type = online_type;
158
159         return 1;
160 }
161 __setup("memhp_default_state=", setup_memhp_default_state);
162
163 void mem_hotplug_begin(void)
164 {
165         cpus_read_lock();
166         percpu_down_write(&mem_hotplug_lock);
167 }
168
169 void mem_hotplug_done(void)
170 {
171         percpu_up_write(&mem_hotplug_lock);
172         cpus_read_unlock();
173 }
174
175 u64 max_mem_size = U64_MAX;
176
177 /* add this memory to iomem resource */
178 static struct resource *register_memory_resource(u64 start, u64 size,
179                                                  const char *resource_name)
180 {
181         struct resource *res;
182         unsigned long flags =  IORESOURCE_SYSTEM_RAM | IORESOURCE_BUSY;
183
184         if (strcmp(resource_name, "System RAM"))
185                 flags |= IORESOURCE_SYSRAM_DRIVER_MANAGED;
186
187         if (!mhp_range_allowed(start, size, true))
188                 return ERR_PTR(-E2BIG);
189
190         /*
191          * Make sure value parsed from 'mem=' only restricts memory adding
192          * while booting, so that memory hotplug won't be impacted. Please
193          * refer to document of 'mem=' in kernel-parameters.txt for more
194          * details.
195          */
196         if (start + size > max_mem_size && system_state < SYSTEM_RUNNING)
197                 return ERR_PTR(-E2BIG);
198
199         /*
200          * Request ownership of the new memory range.  This might be
201          * a child of an existing resource that was present but
202          * not marked as busy.
203          */
204         res = __request_region(&iomem_resource, start, size,
205                                resource_name, flags);
206
207         if (!res) {
208                 pr_debug("Unable to reserve System RAM region: %016llx->%016llx\n",
209                                 start, start + size);
210                 return ERR_PTR(-EEXIST);
211         }
212         return res;
213 }
214
215 static void release_memory_resource(struct resource *res)
216 {
217         if (!res)
218                 return;
219         release_resource(res);
220         kfree(res);
221 }
222
223 #ifdef CONFIG_MEMORY_HOTPLUG_SPARSE
224 static int check_pfn_span(unsigned long pfn, unsigned long nr_pages,
225                 const char *reason)
226 {
227         /*
228          * Disallow all operations smaller than a sub-section and only
229          * allow operations smaller than a section for
230          * SPARSEMEM_VMEMMAP. Note that check_hotplug_memory_range()
231          * enforces a larger memory_block_size_bytes() granularity for
232          * memory that will be marked online, so this check should only
233          * fire for direct arch_{add,remove}_memory() users outside of
234          * add_memory_resource().
235          */
236         unsigned long min_align;
237
238         if (IS_ENABLED(CONFIG_SPARSEMEM_VMEMMAP))
239                 min_align = PAGES_PER_SUBSECTION;
240         else
241                 min_align = PAGES_PER_SECTION;
242         if (!IS_ALIGNED(pfn, min_align)
243                         || !IS_ALIGNED(nr_pages, min_align)) {
244                 WARN(1, "Misaligned __%s_pages start: %#lx end: #%lx\n",
245                                 reason, pfn, pfn + nr_pages - 1);
246                 return -EINVAL;
247         }
248         return 0;
249 }
250
251 /*
252  * Return page for the valid pfn only if the page is online. All pfn
253  * walkers which rely on the fully initialized page->flags and others
254  * should use this rather than pfn_valid && pfn_to_page
255  */
256 struct page *pfn_to_online_page(unsigned long pfn)
257 {
258         unsigned long nr = pfn_to_section_nr(pfn);
259         struct dev_pagemap *pgmap;
260         struct mem_section *ms;
261
262         if (nr >= NR_MEM_SECTIONS)
263                 return NULL;
264
265         ms = __nr_to_section(nr);
266         if (!online_section(ms))
267                 return NULL;
268
269         /*
270          * Save some code text when online_section() +
271          * pfn_section_valid() are sufficient.
272          */
273         if (IS_ENABLED(CONFIG_HAVE_ARCH_PFN_VALID) && !pfn_valid(pfn))
274                 return NULL;
275
276         if (!pfn_section_valid(ms, pfn))
277                 return NULL;
278
279         if (!online_device_section(ms))
280                 return pfn_to_page(pfn);
281
282         /*
283          * Slowpath: when ZONE_DEVICE collides with
284          * ZONE_{NORMAL,MOVABLE} within the same section some pfns in
285          * the section may be 'offline' but 'valid'. Only
286          * get_dev_pagemap() can determine sub-section online status.
287          */
288         pgmap = get_dev_pagemap(pfn, NULL);
289         put_dev_pagemap(pgmap);
290
291         /* The presence of a pgmap indicates ZONE_DEVICE offline pfn */
292         if (pgmap)
293                 return NULL;
294
295         return pfn_to_page(pfn);
296 }
297 EXPORT_SYMBOL_GPL(pfn_to_online_page);
298
299 /*
300  * Reasonably generic function for adding memory.  It is
301  * expected that archs that support memory hotplug will
302  * call this function after deciding the zone to which to
303  * add the new pages.
304  */
305 int __ref __add_pages(int nid, unsigned long pfn, unsigned long nr_pages,
306                 struct mhp_params *params)
307 {
308         const unsigned long end_pfn = pfn + nr_pages;
309         unsigned long cur_nr_pages;
310         int err;
311         struct vmem_altmap *altmap = params->altmap;
312
313         if (WARN_ON_ONCE(!params->pgprot.pgprot))
314                 return -EINVAL;
315
316         VM_BUG_ON(!mhp_range_allowed(PFN_PHYS(pfn), nr_pages * PAGE_SIZE, false));
317
318         if (altmap) {
319                 /*
320                  * Validate altmap is within bounds of the total request
321                  */
322                 if (altmap->base_pfn != pfn
323                                 || vmem_altmap_offset(altmap) > nr_pages) {
324                         pr_warn_once("memory add fail, invalid altmap\n");
325                         return -EINVAL;
326                 }
327                 altmap->alloc = 0;
328         }
329
330         err = check_pfn_span(pfn, nr_pages, "add");
331         if (err)
332                 return err;
333
334         for (; pfn < end_pfn; pfn += cur_nr_pages) {
335                 /* Select all remaining pages up to the next section boundary */
336                 cur_nr_pages = min(end_pfn - pfn,
337                                    SECTION_ALIGN_UP(pfn + 1) - pfn);
338                 err = sparse_add_section(nid, pfn, cur_nr_pages, altmap);
339                 if (err)
340                         break;
341                 cond_resched();
342         }
343         vmemmap_populate_print_last();
344         return err;
345 }
346
347 /* find the smallest valid pfn in the range [start_pfn, end_pfn) */
348 static unsigned long find_smallest_section_pfn(int nid, struct zone *zone,
349                                      unsigned long start_pfn,
350                                      unsigned long end_pfn)
351 {
352         for (; start_pfn < end_pfn; start_pfn += PAGES_PER_SUBSECTION) {
353                 if (unlikely(!pfn_to_online_page(start_pfn)))
354                         continue;
355
356                 if (unlikely(pfn_to_nid(start_pfn) != nid))
357                         continue;
358
359                 if (zone != page_zone(pfn_to_page(start_pfn)))
360                         continue;
361
362                 return start_pfn;
363         }
364
365         return 0;
366 }
367
368 /* find the biggest valid pfn in the range [start_pfn, end_pfn). */
369 static unsigned long find_biggest_section_pfn(int nid, struct zone *zone,
370                                     unsigned long start_pfn,
371                                     unsigned long end_pfn)
372 {
373         unsigned long pfn;
374
375         /* pfn is the end pfn of a memory section. */
376         pfn = end_pfn - 1;
377         for (; pfn >= start_pfn; pfn -= PAGES_PER_SUBSECTION) {
378                 if (unlikely(!pfn_to_online_page(pfn)))
379                         continue;
380
381                 if (unlikely(pfn_to_nid(pfn) != nid))
382                         continue;
383
384                 if (zone != page_zone(pfn_to_page(pfn)))
385                         continue;
386
387                 return pfn;
388         }
389
390         return 0;
391 }
392
393 static void shrink_zone_span(struct zone *zone, unsigned long start_pfn,
394                              unsigned long end_pfn)
395 {
396         unsigned long pfn;
397         int nid = zone_to_nid(zone);
398
399         if (zone->zone_start_pfn == start_pfn) {
400                 /*
401                  * If the section is smallest section in the zone, it need
402                  * shrink zone->zone_start_pfn and zone->zone_spanned_pages.
403                  * In this case, we find second smallest valid mem_section
404                  * for shrinking zone.
405                  */
406                 pfn = find_smallest_section_pfn(nid, zone, end_pfn,
407                                                 zone_end_pfn(zone));
408                 if (pfn) {
409                         zone->spanned_pages = zone_end_pfn(zone) - pfn;
410                         zone->zone_start_pfn = pfn;
411                 } else {
412                         zone->zone_start_pfn = 0;
413                         zone->spanned_pages = 0;
414                 }
415         } else if (zone_end_pfn(zone) == end_pfn) {
416                 /*
417                  * If the section is biggest section in the zone, it need
418                  * shrink zone->spanned_pages.
419                  * In this case, we find second biggest valid mem_section for
420                  * shrinking zone.
421                  */
422                 pfn = find_biggest_section_pfn(nid, zone, zone->zone_start_pfn,
423                                                start_pfn);
424                 if (pfn)
425                         zone->spanned_pages = pfn - zone->zone_start_pfn + 1;
426                 else {
427                         zone->zone_start_pfn = 0;
428                         zone->spanned_pages = 0;
429                 }
430         }
431 }
432
433 static void update_pgdat_span(struct pglist_data *pgdat)
434 {
435         unsigned long node_start_pfn = 0, node_end_pfn = 0;
436         struct zone *zone;
437
438         for (zone = pgdat->node_zones;
439              zone < pgdat->node_zones + MAX_NR_ZONES; zone++) {
440                 unsigned long end_pfn = zone_end_pfn(zone);
441
442                 /* No need to lock the zones, they can't change. */
443                 if (!zone->spanned_pages)
444                         continue;
445                 if (!node_end_pfn) {
446                         node_start_pfn = zone->zone_start_pfn;
447                         node_end_pfn = end_pfn;
448                         continue;
449                 }
450
451                 if (end_pfn > node_end_pfn)
452                         node_end_pfn = end_pfn;
453                 if (zone->zone_start_pfn < node_start_pfn)
454                         node_start_pfn = zone->zone_start_pfn;
455         }
456
457         pgdat->node_start_pfn = node_start_pfn;
458         pgdat->node_spanned_pages = node_end_pfn - node_start_pfn;
459 }
460
461 void __ref remove_pfn_range_from_zone(struct zone *zone,
462                                       unsigned long start_pfn,
463                                       unsigned long nr_pages)
464 {
465         const unsigned long end_pfn = start_pfn + nr_pages;
466         struct pglist_data *pgdat = zone->zone_pgdat;
467         unsigned long pfn, cur_nr_pages;
468
469         /* Poison struct pages because they are now uninitialized again. */
470         for (pfn = start_pfn; pfn < end_pfn; pfn += cur_nr_pages) {
471                 cond_resched();
472
473                 /* Select all remaining pages up to the next section boundary */
474                 cur_nr_pages =
475                         min(end_pfn - pfn, SECTION_ALIGN_UP(pfn + 1) - pfn);
476                 page_init_poison(pfn_to_page(pfn),
477                                  sizeof(struct page) * cur_nr_pages);
478         }
479
480 #ifdef CONFIG_ZONE_DEVICE
481         /*
482          * Zone shrinking code cannot properly deal with ZONE_DEVICE. So
483          * we will not try to shrink the zones - which is okay as
484          * set_zone_contiguous() cannot deal with ZONE_DEVICE either way.
485          */
486         if (zone_idx(zone) == ZONE_DEVICE)
487                 return;
488 #endif
489
490         clear_zone_contiguous(zone);
491
492         shrink_zone_span(zone, start_pfn, start_pfn + nr_pages);
493         update_pgdat_span(pgdat);
494
495         set_zone_contiguous(zone);
496 }
497
498 static void __remove_section(unsigned long pfn, unsigned long nr_pages,
499                              unsigned long map_offset,
500                              struct vmem_altmap *altmap)
501 {
502         struct mem_section *ms = __pfn_to_section(pfn);
503
504         if (WARN_ON_ONCE(!valid_section(ms)))
505                 return;
506
507         sparse_remove_section(ms, pfn, nr_pages, map_offset, altmap);
508 }
509
510 /**
511  * __remove_pages() - remove sections of pages
512  * @pfn: starting pageframe (must be aligned to start of a section)
513  * @nr_pages: number of pages to remove (must be multiple of section size)
514  * @altmap: alternative device page map or %NULL if default memmap is used
515  *
516  * Generic helper function to remove section mappings and sysfs entries
517  * for the section of the memory we are removing. Caller needs to make
518  * sure that pages are marked reserved and zones are adjust properly by
519  * calling offline_pages().
520  */
521 void __remove_pages(unsigned long pfn, unsigned long nr_pages,
522                     struct vmem_altmap *altmap)
523 {
524         const unsigned long end_pfn = pfn + nr_pages;
525         unsigned long cur_nr_pages;
526         unsigned long map_offset = 0;
527
528         map_offset = vmem_altmap_offset(altmap);
529
530         if (check_pfn_span(pfn, nr_pages, "remove"))
531                 return;
532
533         for (; pfn < end_pfn; pfn += cur_nr_pages) {
534                 cond_resched();
535                 /* Select all remaining pages up to the next section boundary */
536                 cur_nr_pages = min(end_pfn - pfn,
537                                    SECTION_ALIGN_UP(pfn + 1) - pfn);
538                 __remove_section(pfn, cur_nr_pages, map_offset, altmap);
539                 map_offset = 0;
540         }
541 }
542
543 int set_online_page_callback(online_page_callback_t callback)
544 {
545         int rc = -EINVAL;
546
547         get_online_mems();
548         mutex_lock(&online_page_callback_lock);
549
550         if (online_page_callback == generic_online_page) {
551                 online_page_callback = callback;
552                 rc = 0;
553         }
554
555         mutex_unlock(&online_page_callback_lock);
556         put_online_mems();
557
558         return rc;
559 }
560 EXPORT_SYMBOL_GPL(set_online_page_callback);
561
562 int restore_online_page_callback(online_page_callback_t callback)
563 {
564         int rc = -EINVAL;
565
566         get_online_mems();
567         mutex_lock(&online_page_callback_lock);
568
569         if (online_page_callback == callback) {
570                 online_page_callback = generic_online_page;
571                 rc = 0;
572         }
573
574         mutex_unlock(&online_page_callback_lock);
575         put_online_mems();
576
577         return rc;
578 }
579 EXPORT_SYMBOL_GPL(restore_online_page_callback);
580
581 void generic_online_page(struct page *page, unsigned int order)
582 {
583         /*
584          * Freeing the page with debug_pagealloc enabled will try to unmap it,
585          * so we should map it first. This is better than introducing a special
586          * case in page freeing fast path.
587          */
588         debug_pagealloc_map_pages(page, 1 << order);
589         __free_pages_core(page, order);
590         totalram_pages_add(1UL << order);
591 #ifdef CONFIG_HIGHMEM
592         if (PageHighMem(page))
593                 totalhigh_pages_add(1UL << order);
594 #endif
595 }
596 EXPORT_SYMBOL_GPL(generic_online_page);
597
598 static void online_pages_range(unsigned long start_pfn, unsigned long nr_pages)
599 {
600         const unsigned long end_pfn = start_pfn + nr_pages;
601         unsigned long pfn;
602
603         /*
604          * Online the pages in MAX_ORDER - 1 aligned chunks. The callback might
605          * decide to not expose all pages to the buddy (e.g., expose them
606          * later). We account all pages as being online and belonging to this
607          * zone ("present").
608          * When using memmap_on_memory, the range might not be aligned to
609          * MAX_ORDER_NR_PAGES - 1, but pageblock aligned. __ffs() will detect
610          * this and the first chunk to online will be pageblock_nr_pages.
611          */
612         for (pfn = start_pfn; pfn < end_pfn;) {
613                 int order = min(MAX_ORDER - 1UL, __ffs(pfn));
614
615                 (*online_page_callback)(pfn_to_page(pfn), order);
616                 pfn += (1UL << order);
617         }
618
619         /* mark all involved sections as online */
620         online_mem_sections(start_pfn, end_pfn);
621 }
622
623 /* check which state of node_states will be changed when online memory */
624 static void node_states_check_changes_online(unsigned long nr_pages,
625         struct zone *zone, struct memory_notify *arg)
626 {
627         int nid = zone_to_nid(zone);
628
629         arg->status_change_nid = NUMA_NO_NODE;
630         arg->status_change_nid_normal = NUMA_NO_NODE;
631         arg->status_change_nid_high = NUMA_NO_NODE;
632
633         if (!node_state(nid, N_MEMORY))
634                 arg->status_change_nid = nid;
635         if (zone_idx(zone) <= ZONE_NORMAL && !node_state(nid, N_NORMAL_MEMORY))
636                 arg->status_change_nid_normal = nid;
637 #ifdef CONFIG_HIGHMEM
638         if (zone_idx(zone) <= ZONE_HIGHMEM && !node_state(nid, N_HIGH_MEMORY))
639                 arg->status_change_nid_high = nid;
640 #endif
641 }
642
643 static void node_states_set_node(int node, struct memory_notify *arg)
644 {
645         if (arg->status_change_nid_normal >= 0)
646                 node_set_state(node, N_NORMAL_MEMORY);
647
648         if (arg->status_change_nid_high >= 0)
649                 node_set_state(node, N_HIGH_MEMORY);
650
651         if (arg->status_change_nid >= 0)
652                 node_set_state(node, N_MEMORY);
653 }
654
655 static void __meminit resize_zone_range(struct zone *zone, unsigned long start_pfn,
656                 unsigned long nr_pages)
657 {
658         unsigned long old_end_pfn = zone_end_pfn(zone);
659
660         if (zone_is_empty(zone) || start_pfn < zone->zone_start_pfn)
661                 zone->zone_start_pfn = start_pfn;
662
663         zone->spanned_pages = max(start_pfn + nr_pages, old_end_pfn) - zone->zone_start_pfn;
664 }
665
666 static void __meminit resize_pgdat_range(struct pglist_data *pgdat, unsigned long start_pfn,
667                                      unsigned long nr_pages)
668 {
669         unsigned long old_end_pfn = pgdat_end_pfn(pgdat);
670
671         if (!pgdat->node_spanned_pages || start_pfn < pgdat->node_start_pfn)
672                 pgdat->node_start_pfn = start_pfn;
673
674         pgdat->node_spanned_pages = max(start_pfn + nr_pages, old_end_pfn) - pgdat->node_start_pfn;
675
676 }
677
678 static void section_taint_zone_device(unsigned long pfn)
679 {
680         struct mem_section *ms = __pfn_to_section(pfn);
681
682         ms->section_mem_map |= SECTION_TAINT_ZONE_DEVICE;
683 }
684
685 /*
686  * Associate the pfn range with the given zone, initializing the memmaps
687  * and resizing the pgdat/zone data to span the added pages. After this
688  * call, all affected pages are PG_reserved.
689  *
690  * All aligned pageblocks are initialized to the specified migratetype
691  * (usually MIGRATE_MOVABLE). Besides setting the migratetype, no related
692  * zone stats (e.g., nr_isolate_pageblock) are touched.
693  */
694 void __ref move_pfn_range_to_zone(struct zone *zone, unsigned long start_pfn,
695                                   unsigned long nr_pages,
696                                   struct vmem_altmap *altmap, int migratetype)
697 {
698         struct pglist_data *pgdat = zone->zone_pgdat;
699         int nid = pgdat->node_id;
700
701         clear_zone_contiguous(zone);
702
703         if (zone_is_empty(zone))
704                 init_currently_empty_zone(zone, start_pfn, nr_pages);
705         resize_zone_range(zone, start_pfn, nr_pages);
706         resize_pgdat_range(pgdat, start_pfn, nr_pages);
707
708         /*
709          * Subsection population requires care in pfn_to_online_page().
710          * Set the taint to enable the slow path detection of
711          * ZONE_DEVICE pages in an otherwise  ZONE_{NORMAL,MOVABLE}
712          * section.
713          */
714         if (zone_is_zone_device(zone)) {
715                 if (!IS_ALIGNED(start_pfn, PAGES_PER_SECTION))
716                         section_taint_zone_device(start_pfn);
717                 if (!IS_ALIGNED(start_pfn + nr_pages, PAGES_PER_SECTION))
718                         section_taint_zone_device(start_pfn + nr_pages);
719         }
720
721         /*
722          * TODO now we have a visible range of pages which are not associated
723          * with their zone properly. Not nice but set_pfnblock_flags_mask
724          * expects the zone spans the pfn range. All the pages in the range
725          * are reserved so nobody should be touching them so we should be safe
726          */
727         memmap_init_range(nr_pages, nid, zone_idx(zone), start_pfn, 0,
728                          MEMINIT_HOTPLUG, altmap, migratetype);
729
730         set_zone_contiguous(zone);
731 }
732
733 struct auto_movable_stats {
734         unsigned long kernel_early_pages;
735         unsigned long movable_pages;
736 };
737
738 static void auto_movable_stats_account_zone(struct auto_movable_stats *stats,
739                                             struct zone *zone)
740 {
741         if (zone_idx(zone) == ZONE_MOVABLE) {
742                 stats->movable_pages += zone->present_pages;
743         } else {
744                 stats->kernel_early_pages += zone->present_early_pages;
745 #ifdef CONFIG_CMA
746                 /*
747                  * CMA pages (never on hotplugged memory) behave like
748                  * ZONE_MOVABLE.
749                  */
750                 stats->movable_pages += zone->cma_pages;
751                 stats->kernel_early_pages -= zone->cma_pages;
752 #endif /* CONFIG_CMA */
753         }
754 }
755
756 static bool auto_movable_can_online_movable(int nid, unsigned long nr_pages)
757 {
758         struct auto_movable_stats stats = {};
759         unsigned long kernel_early_pages, movable_pages;
760         pg_data_t *pgdat = NODE_DATA(nid);
761         struct zone *zone;
762         int i;
763
764         /* Walk all relevant zones and collect MOVABLE vs. KERNEL stats. */
765         if (nid == NUMA_NO_NODE) {
766                 /* TODO: cache values */
767                 for_each_populated_zone(zone)
768                         auto_movable_stats_account_zone(&stats, zone);
769         } else {
770                 for (i = 0; i < MAX_NR_ZONES; i++) {
771                         zone = pgdat->node_zones + i;
772                         if (populated_zone(zone))
773                                 auto_movable_stats_account_zone(&stats, zone);
774                 }
775         }
776
777         kernel_early_pages = stats.kernel_early_pages;
778         movable_pages = stats.movable_pages;
779
780         /*
781          * Test if we could online the given number of pages to ZONE_MOVABLE
782          * and still stay in the configured ratio.
783          */
784         movable_pages += nr_pages;
785         return movable_pages <= (auto_movable_ratio * kernel_early_pages) / 100;
786 }
787
788 /*
789  * Returns a default kernel memory zone for the given pfn range.
790  * If no kernel zone covers this pfn range it will automatically go
791  * to the ZONE_NORMAL.
792  */
793 static struct zone *default_kernel_zone_for_pfn(int nid, unsigned long start_pfn,
794                 unsigned long nr_pages)
795 {
796         struct pglist_data *pgdat = NODE_DATA(nid);
797         int zid;
798
799         for (zid = 0; zid <= ZONE_NORMAL; zid++) {
800                 struct zone *zone = &pgdat->node_zones[zid];
801
802                 if (zone_intersects(zone, start_pfn, nr_pages))
803                         return zone;
804         }
805
806         return &pgdat->node_zones[ZONE_NORMAL];
807 }
808
809 /*
810  * Determine to which zone to online memory dynamically based on user
811  * configuration and system stats. We care about the following ratio:
812  *
813  *   MOVABLE : KERNEL
814  *
815  * Whereby MOVABLE is memory in ZONE_MOVABLE and KERNEL is memory in
816  * one of the kernel zones. CMA pages inside one of the kernel zones really
817  * behaves like ZONE_MOVABLE, so we treat them accordingly.
818  *
819  * We don't allow for hotplugged memory in a KERNEL zone to increase the
820  * amount of MOVABLE memory we can have, so we end up with:
821  *
822  *   MOVABLE : KERNEL_EARLY
823  *
824  * Whereby KERNEL_EARLY is memory in one of the kernel zones, available sinze
825  * boot. We base our calculation on KERNEL_EARLY internally, because:
826  *
827  * a) Hotplugged memory in one of the kernel zones can sometimes still get
828  *    hotunplugged, especially when hot(un)plugging individual memory blocks.
829  *    There is no coordination across memory devices, therefore "automatic"
830  *    hotunplugging, as implemented in hypervisors, could result in zone
831  *    imbalances.
832  * b) Early/boot memory in one of the kernel zones can usually not get
833  *    hotunplugged again (e.g., no firmware interface to unplug, fragmented
834  *    with unmovable allocations). While there are corner cases where it might
835  *    still work, it is barely relevant in practice.
836  *
837  * We rely on "present pages" instead of "managed pages", as the latter is
838  * highly unreliable and dynamic in virtualized environments, and does not
839  * consider boot time allocations. For example, memory ballooning adjusts the
840  * managed pages when inflating/deflating the balloon, and balloon compaction
841  * can even migrate inflated pages between zones.
842  *
843  * Using "present pages" is better but some things to keep in mind are:
844  *
845  * a) Some memblock allocations, such as for the crashkernel area, are
846  *    effectively unused by the kernel, yet they account to "present pages".
847  *    Fortunately, these allocations are comparatively small in relevant setups
848  *    (e.g., fraction of system memory).
849  * b) Some hotplugged memory blocks in virtualized environments, esecially
850  *    hotplugged by virtio-mem, look like they are completely present, however,
851  *    only parts of the memory block are actually currently usable.
852  *    "present pages" is an upper limit that can get reached at runtime. As
853  *    we base our calculations on KERNEL_EARLY, this is not an issue.
854  */
855 static struct zone *auto_movable_zone_for_pfn(int nid, unsigned long pfn,
856                                               unsigned long nr_pages)
857 {
858         if (!auto_movable_ratio)
859                 goto kernel_zone;
860
861         if (!auto_movable_can_online_movable(NUMA_NO_NODE, nr_pages))
862                 goto kernel_zone;
863
864 #ifdef CONFIG_NUMA
865         if (auto_movable_numa_aware &&
866             !auto_movable_can_online_movable(nid, nr_pages))
867                 goto kernel_zone;
868 #endif /* CONFIG_NUMA */
869
870         return &NODE_DATA(nid)->node_zones[ZONE_MOVABLE];
871 kernel_zone:
872         return default_kernel_zone_for_pfn(nid, pfn, nr_pages);
873 }
874
875 static inline struct zone *default_zone_for_pfn(int nid, unsigned long start_pfn,
876                 unsigned long nr_pages)
877 {
878         struct zone *kernel_zone = default_kernel_zone_for_pfn(nid, start_pfn,
879                         nr_pages);
880         struct zone *movable_zone = &NODE_DATA(nid)->node_zones[ZONE_MOVABLE];
881         bool in_kernel = zone_intersects(kernel_zone, start_pfn, nr_pages);
882         bool in_movable = zone_intersects(movable_zone, start_pfn, nr_pages);
883
884         /*
885          * We inherit the existing zone in a simple case where zones do not
886          * overlap in the given range
887          */
888         if (in_kernel ^ in_movable)
889                 return (in_kernel) ? kernel_zone : movable_zone;
890
891         /*
892          * If the range doesn't belong to any zone or two zones overlap in the
893          * given range then we use movable zone only if movable_node is
894          * enabled because we always online to a kernel zone by default.
895          */
896         return movable_node_enabled ? movable_zone : kernel_zone;
897 }
898
899 struct zone *zone_for_pfn_range(int online_type, int nid,
900                 unsigned long start_pfn, unsigned long nr_pages)
901 {
902         if (online_type == MMOP_ONLINE_KERNEL)
903                 return default_kernel_zone_for_pfn(nid, start_pfn, nr_pages);
904
905         if (online_type == MMOP_ONLINE_MOVABLE)
906                 return &NODE_DATA(nid)->node_zones[ZONE_MOVABLE];
907
908         if (online_policy == ONLINE_POLICY_AUTO_MOVABLE)
909                 return auto_movable_zone_for_pfn(nid, start_pfn, nr_pages);
910
911         return default_zone_for_pfn(nid, start_pfn, nr_pages);
912 }
913
914 /*
915  * This function should only be called by memory_block_{online,offline},
916  * and {online,offline}_pages.
917  */
918 void adjust_present_page_count(struct page *page, struct memory_group *group,
919                                long nr_pages)
920 {
921         struct zone *zone = page_zone(page);
922         const bool movable = zone_idx(zone) == ZONE_MOVABLE;
923
924         /*
925          * We only support onlining/offlining/adding/removing of complete
926          * memory blocks; therefore, either all is either early or hotplugged.
927          */
928         if (early_section(__pfn_to_section(page_to_pfn(page))))
929                 zone->present_early_pages += nr_pages;
930         zone->present_pages += nr_pages;
931         zone->zone_pgdat->node_present_pages += nr_pages;
932
933         if (group && movable)
934                 group->present_movable_pages += nr_pages;
935         else if (group && !movable)
936                 group->present_kernel_pages += nr_pages;
937 }
938
939 int mhp_init_memmap_on_memory(unsigned long pfn, unsigned long nr_pages,
940                               struct zone *zone)
941 {
942         unsigned long end_pfn = pfn + nr_pages;
943         int ret;
944
945         ret = kasan_add_zero_shadow(__va(PFN_PHYS(pfn)), PFN_PHYS(nr_pages));
946         if (ret)
947                 return ret;
948
949         move_pfn_range_to_zone(zone, pfn, nr_pages, NULL, MIGRATE_UNMOVABLE);
950
951         /*
952          * It might be that the vmemmap_pages fully span sections. If that is
953          * the case, mark those sections online here as otherwise they will be
954          * left offline.
955          */
956         if (nr_pages >= PAGES_PER_SECTION)
957                 online_mem_sections(pfn, ALIGN_DOWN(end_pfn, PAGES_PER_SECTION));
958
959         return ret;
960 }
961
962 void mhp_deinit_memmap_on_memory(unsigned long pfn, unsigned long nr_pages)
963 {
964         unsigned long end_pfn = pfn + nr_pages;
965
966         /*
967          * It might be that the vmemmap_pages fully span sections. If that is
968          * the case, mark those sections offline here as otherwise they will be
969          * left online.
970          */
971         if (nr_pages >= PAGES_PER_SECTION)
972                 offline_mem_sections(pfn, ALIGN_DOWN(end_pfn, PAGES_PER_SECTION));
973
974         /*
975          * The pages associated with this vmemmap have been offlined, so
976          * we can reset its state here.
977          */
978         remove_pfn_range_from_zone(page_zone(pfn_to_page(pfn)), pfn, nr_pages);
979         kasan_remove_zero_shadow(__va(PFN_PHYS(pfn)), PFN_PHYS(nr_pages));
980 }
981
982 int __ref online_pages(unsigned long pfn, unsigned long nr_pages,
983                        struct zone *zone, struct memory_group *group)
984 {
985         unsigned long flags;
986         int need_zonelists_rebuild = 0;
987         const int nid = zone_to_nid(zone);
988         int ret;
989         struct memory_notify arg;
990
991         /*
992          * {on,off}lining is constrained to full memory sections (or more
993          * precisely to memory blocks from the user space POV).
994          * memmap_on_memory is an exception because it reserves initial part
995          * of the physical memory space for vmemmaps. That space is pageblock
996          * aligned.
997          */
998         if (WARN_ON_ONCE(!nr_pages ||
999                          !IS_ALIGNED(pfn, pageblock_nr_pages) ||
1000                          !IS_ALIGNED(pfn + nr_pages, PAGES_PER_SECTION)))
1001                 return -EINVAL;
1002
1003         mem_hotplug_begin();
1004
1005         /* associate pfn range with the zone */
1006         move_pfn_range_to_zone(zone, pfn, nr_pages, NULL, MIGRATE_ISOLATE);
1007
1008         arg.start_pfn = pfn;
1009         arg.nr_pages = nr_pages;
1010         node_states_check_changes_online(nr_pages, zone, &arg);
1011
1012         ret = memory_notify(MEM_GOING_ONLINE, &arg);
1013         ret = notifier_to_errno(ret);
1014         if (ret)
1015                 goto failed_addition;
1016
1017         /*
1018          * Fixup the number of isolated pageblocks before marking the sections
1019          * onlining, such that undo_isolate_page_range() works correctly.
1020          */
1021         spin_lock_irqsave(&zone->lock, flags);
1022         zone->nr_isolate_pageblock += nr_pages / pageblock_nr_pages;
1023         spin_unlock_irqrestore(&zone->lock, flags);
1024
1025         /*
1026          * If this zone is not populated, then it is not in zonelist.
1027          * This means the page allocator ignores this zone.
1028          * So, zonelist must be updated after online.
1029          */
1030         if (!populated_zone(zone)) {
1031                 need_zonelists_rebuild = 1;
1032                 setup_zone_pageset(zone);
1033         }
1034
1035         online_pages_range(pfn, nr_pages);
1036         adjust_present_page_count(pfn_to_page(pfn), group, nr_pages);
1037
1038         node_states_set_node(nid, &arg);
1039         if (need_zonelists_rebuild)
1040                 build_all_zonelists(NULL);
1041
1042         /* Basic onlining is complete, allow allocation of onlined pages. */
1043         undo_isolate_page_range(pfn, pfn + nr_pages, MIGRATE_MOVABLE);
1044
1045         /*
1046          * Freshly onlined pages aren't shuffled (e.g., all pages are placed to
1047          * the tail of the freelist when undoing isolation). Shuffle the whole
1048          * zone to make sure the just onlined pages are properly distributed
1049          * across the whole freelist - to create an initial shuffle.
1050          */
1051         shuffle_zone(zone);
1052
1053         /* reinitialise watermarks and update pcp limits */
1054         init_per_zone_wmark_min();
1055
1056         kswapd_run(nid);
1057         kcompactd_run(nid);
1058
1059         writeback_set_ratelimit();
1060
1061         memory_notify(MEM_ONLINE, &arg);
1062         mem_hotplug_done();
1063         return 0;
1064
1065 failed_addition:
1066         pr_debug("online_pages [mem %#010llx-%#010llx] failed\n",
1067                  (unsigned long long) pfn << PAGE_SHIFT,
1068                  (((unsigned long long) pfn + nr_pages) << PAGE_SHIFT) - 1);
1069         memory_notify(MEM_CANCEL_ONLINE, &arg);
1070         remove_pfn_range_from_zone(zone, pfn, nr_pages);
1071         mem_hotplug_done();
1072         return ret;
1073 }
1074 #endif /* CONFIG_MEMORY_HOTPLUG_SPARSE */
1075
1076 static void reset_node_present_pages(pg_data_t *pgdat)
1077 {
1078         struct zone *z;
1079
1080         for (z = pgdat->node_zones; z < pgdat->node_zones + MAX_NR_ZONES; z++)
1081                 z->present_pages = 0;
1082
1083         pgdat->node_present_pages = 0;
1084 }
1085
1086 /* we are OK calling __meminit stuff here - we have CONFIG_MEMORY_HOTPLUG */
1087 static pg_data_t __ref *hotadd_new_pgdat(int nid)
1088 {
1089         struct pglist_data *pgdat;
1090
1091         pgdat = NODE_DATA(nid);
1092         if (!pgdat) {
1093                 pgdat = arch_alloc_nodedata(nid);
1094                 if (!pgdat)
1095                         return NULL;
1096
1097                 pgdat->per_cpu_nodestats =
1098                         alloc_percpu(struct per_cpu_nodestat);
1099                 arch_refresh_nodedata(nid, pgdat);
1100         } else {
1101                 int cpu;
1102                 /*
1103                  * Reset the nr_zones, order and highest_zoneidx before reuse.
1104                  * Note that kswapd will init kswapd_highest_zoneidx properly
1105                  * when it starts in the near future.
1106                  */
1107                 pgdat->nr_zones = 0;
1108                 pgdat->kswapd_order = 0;
1109                 pgdat->kswapd_highest_zoneidx = 0;
1110                 for_each_online_cpu(cpu) {
1111                         struct per_cpu_nodestat *p;
1112
1113                         p = per_cpu_ptr(pgdat->per_cpu_nodestats, cpu);
1114                         memset(p, 0, sizeof(*p));
1115                 }
1116         }
1117
1118         /* we can use NODE_DATA(nid) from here */
1119         pgdat->node_id = nid;
1120         pgdat->node_start_pfn = 0;
1121
1122         /* init node's zones as empty zones, we don't have any present pages.*/
1123         free_area_init_core_hotplug(nid);
1124
1125         /*
1126          * The node we allocated has no zone fallback lists. For avoiding
1127          * to access not-initialized zonelist, build here.
1128          */
1129         build_all_zonelists(pgdat);
1130
1131         /*
1132          * When memory is hot-added, all the memory is in offline state. So
1133          * clear all zones' present_pages because they will be updated in
1134          * online_pages() and offline_pages().
1135          */
1136         reset_node_managed_pages(pgdat);
1137         reset_node_present_pages(pgdat);
1138
1139         return pgdat;
1140 }
1141
1142 static void rollback_node_hotadd(int nid)
1143 {
1144         pg_data_t *pgdat = NODE_DATA(nid);
1145
1146         arch_refresh_nodedata(nid, NULL);
1147         free_percpu(pgdat->per_cpu_nodestats);
1148         arch_free_nodedata(pgdat);
1149 }
1150
1151
1152 /*
1153  * __try_online_node - online a node if offlined
1154  * @nid: the node ID
1155  * @set_node_online: Whether we want to online the node
1156  * called by cpu_up() to online a node without onlined memory.
1157  *
1158  * Returns:
1159  * 1 -> a new node has been allocated
1160  * 0 -> the node is already online
1161  * -ENOMEM -> the node could not be allocated
1162  */
1163 static int __try_online_node(int nid, bool set_node_online)
1164 {
1165         pg_data_t *pgdat;
1166         int ret = 1;
1167
1168         if (node_online(nid))
1169                 return 0;
1170
1171         pgdat = hotadd_new_pgdat(nid);
1172         if (!pgdat) {
1173                 pr_err("Cannot online node %d due to NULL pgdat\n", nid);
1174                 ret = -ENOMEM;
1175                 goto out;
1176         }
1177
1178         if (set_node_online) {
1179                 node_set_online(nid);
1180                 ret = register_one_node(nid);
1181                 BUG_ON(ret);
1182         }
1183 out:
1184         return ret;
1185 }
1186
1187 /*
1188  * Users of this function always want to online/register the node
1189  */
1190 int try_online_node(int nid)
1191 {
1192         int ret;
1193
1194         mem_hotplug_begin();
1195         ret =  __try_online_node(nid, true);
1196         mem_hotplug_done();
1197         return ret;
1198 }
1199
1200 static int check_hotplug_memory_range(u64 start, u64 size)
1201 {
1202         /* memory range must be block size aligned */
1203         if (!size || !IS_ALIGNED(start, memory_block_size_bytes()) ||
1204             !IS_ALIGNED(size, memory_block_size_bytes())) {
1205                 pr_err("Block size [%#lx] unaligned hotplug range: start %#llx, size %#llx",
1206                        memory_block_size_bytes(), start, size);
1207                 return -EINVAL;
1208         }
1209
1210         return 0;
1211 }
1212
1213 static int online_memory_block(struct memory_block *mem, void *arg)
1214 {
1215         mem->online_type = mhp_default_online_type;
1216         return device_online(&mem->dev);
1217 }
1218
1219 bool mhp_supports_memmap_on_memory(unsigned long size)
1220 {
1221         unsigned long nr_vmemmap_pages = size / PAGE_SIZE;
1222         unsigned long vmemmap_size = nr_vmemmap_pages * sizeof(struct page);
1223         unsigned long remaining_size = size - vmemmap_size;
1224
1225         /*
1226          * Besides having arch support and the feature enabled at runtime, we
1227          * need a few more assumptions to hold true:
1228          *
1229          * a) We span a single memory block: memory onlining/offlinin;g happens
1230          *    in memory block granularity. We don't want the vmemmap of online
1231          *    memory blocks to reside on offline memory blocks. In the future,
1232          *    we might want to support variable-sized memory blocks to make the
1233          *    feature more versatile.
1234          *
1235          * b) The vmemmap pages span complete PMDs: We don't want vmemmap code
1236          *    to populate memory from the altmap for unrelated parts (i.e.,
1237          *    other memory blocks)
1238          *
1239          * c) The vmemmap pages (and thereby the pages that will be exposed to
1240          *    the buddy) have to cover full pageblocks: memory onlining/offlining
1241          *    code requires applicable ranges to be page-aligned, for example, to
1242          *    set the migratetypes properly.
1243          *
1244          * TODO: Although we have a check here to make sure that vmemmap pages
1245          *       fully populate a PMD, it is not the right place to check for
1246          *       this. A much better solution involves improving vmemmap code
1247          *       to fallback to base pages when trying to populate vmemmap using
1248          *       altmap as an alternative source of memory, and we do not exactly
1249          *       populate a single PMD.
1250          */
1251         return memmap_on_memory &&
1252                !hugetlb_free_vmemmap_enabled &&
1253                IS_ENABLED(CONFIG_MHP_MEMMAP_ON_MEMORY) &&
1254                size == memory_block_size_bytes() &&
1255                IS_ALIGNED(vmemmap_size, PMD_SIZE) &&
1256                IS_ALIGNED(remaining_size, (pageblock_nr_pages << PAGE_SHIFT));
1257 }
1258
1259 /*
1260  * NOTE: The caller must call lock_device_hotplug() to serialize hotplug
1261  * and online/offline operations (triggered e.g. by sysfs).
1262  *
1263  * we are OK calling __meminit stuff here - we have CONFIG_MEMORY_HOTPLUG
1264  */
1265 int __ref add_memory_resource(int nid, struct resource *res, mhp_t mhp_flags)
1266 {
1267         struct mhp_params params = { .pgprot = pgprot_mhp(PAGE_KERNEL) };
1268         struct vmem_altmap mhp_altmap = {};
1269         struct memory_group *group = NULL;
1270         u64 start, size;
1271         bool new_node = false;
1272         int ret;
1273
1274         start = res->start;
1275         size = resource_size(res);
1276
1277         ret = check_hotplug_memory_range(start, size);
1278         if (ret)
1279                 return ret;
1280
1281         if (mhp_flags & MHP_NID_IS_MGID) {
1282                 group = memory_group_find_by_id(nid);
1283                 if (!group)
1284                         return -EINVAL;
1285                 nid = group->nid;
1286         }
1287
1288         if (!node_possible(nid)) {
1289                 WARN(1, "node %d was absent from the node_possible_map\n", nid);
1290                 return -EINVAL;
1291         }
1292
1293         mem_hotplug_begin();
1294
1295         if (IS_ENABLED(CONFIG_ARCH_KEEP_MEMBLOCK))
1296                 memblock_add_node(start, size, nid);
1297
1298         ret = __try_online_node(nid, false);
1299         if (ret < 0)
1300                 goto error;
1301         new_node = ret;
1302
1303         /*
1304          * Self hosted memmap array
1305          */
1306         if (mhp_flags & MHP_MEMMAP_ON_MEMORY) {
1307                 if (!mhp_supports_memmap_on_memory(size)) {
1308                         ret = -EINVAL;
1309                         goto error;
1310                 }
1311                 mhp_altmap.free = PHYS_PFN(size);
1312                 mhp_altmap.base_pfn = PHYS_PFN(start);
1313                 params.altmap = &mhp_altmap;
1314         }
1315
1316         /* call arch's memory hotadd */
1317         ret = arch_add_memory(nid, start, size, &params);
1318         if (ret < 0)
1319                 goto error;
1320
1321         /* create memory block devices after memory was added */
1322         ret = create_memory_block_devices(start, size, mhp_altmap.alloc,
1323                                           group);
1324         if (ret) {
1325                 arch_remove_memory(start, size, NULL);
1326                 goto error;
1327         }
1328
1329         if (new_node) {
1330                 /* If sysfs file of new node can't be created, cpu on the node
1331                  * can't be hot-added. There is no rollback way now.
1332                  * So, check by BUG_ON() to catch it reluctantly..
1333                  * We online node here. We can't roll back from here.
1334                  */
1335                 node_set_online(nid);
1336                 ret = __register_one_node(nid);
1337                 BUG_ON(ret);
1338         }
1339
1340         /* link memory sections under this node.*/
1341         link_mem_sections(nid, PFN_DOWN(start), PFN_UP(start + size - 1),
1342                           MEMINIT_HOTPLUG);
1343
1344         /* create new memmap entry */
1345         if (!strcmp(res->name, "System RAM"))
1346                 firmware_map_add_hotplug(start, start + size, "System RAM");
1347
1348         /* device_online() will take the lock when calling online_pages() */
1349         mem_hotplug_done();
1350
1351         /*
1352          * In case we're allowed to merge the resource, flag it and trigger
1353          * merging now that adding succeeded.
1354          */
1355         if (mhp_flags & MHP_MERGE_RESOURCE)
1356                 merge_system_ram_resource(res);
1357
1358         /* online pages if requested */
1359         if (mhp_default_online_type != MMOP_OFFLINE)
1360                 walk_memory_blocks(start, size, NULL, online_memory_block);
1361
1362         return ret;
1363 error:
1364         /* rollback pgdat allocation and others */
1365         if (new_node)
1366                 rollback_node_hotadd(nid);
1367         if (IS_ENABLED(CONFIG_ARCH_KEEP_MEMBLOCK))
1368                 memblock_remove(start, size);
1369         mem_hotplug_done();
1370         return ret;
1371 }
1372
1373 /* requires device_hotplug_lock, see add_memory_resource() */
1374 int __ref __add_memory(int nid, u64 start, u64 size, mhp_t mhp_flags)
1375 {
1376         struct resource *res;
1377         int ret;
1378
1379         res = register_memory_resource(start, size, "System RAM");
1380         if (IS_ERR(res))
1381                 return PTR_ERR(res);
1382
1383         ret = add_memory_resource(nid, res, mhp_flags);
1384         if (ret < 0)
1385                 release_memory_resource(res);
1386         return ret;
1387 }
1388
1389 int add_memory(int nid, u64 start, u64 size, mhp_t mhp_flags)
1390 {
1391         int rc;
1392
1393         lock_device_hotplug();
1394         rc = __add_memory(nid, start, size, mhp_flags);
1395         unlock_device_hotplug();
1396
1397         return rc;
1398 }
1399 EXPORT_SYMBOL_GPL(add_memory);
1400
1401 /*
1402  * Add special, driver-managed memory to the system as system RAM. Such
1403  * memory is not exposed via the raw firmware-provided memmap as system
1404  * RAM, instead, it is detected and added by a driver - during cold boot,
1405  * after a reboot, and after kexec.
1406  *
1407  * Reasons why this memory should not be used for the initial memmap of a
1408  * kexec kernel or for placing kexec images:
1409  * - The booting kernel is in charge of determining how this memory will be
1410  *   used (e.g., use persistent memory as system RAM)
1411  * - Coordination with a hypervisor is required before this memory
1412  *   can be used (e.g., inaccessible parts).
1413  *
1414  * For this memory, no entries in /sys/firmware/memmap ("raw firmware-provided
1415  * memory map") are created. Also, the created memory resource is flagged
1416  * with IORESOURCE_SYSRAM_DRIVER_MANAGED, so in-kernel users can special-case
1417  * this memory as well (esp., not place kexec images onto it).
1418  *
1419  * The resource_name (visible via /proc/iomem) has to have the format
1420  * "System RAM ($DRIVER)".
1421  */
1422 int add_memory_driver_managed(int nid, u64 start, u64 size,
1423                               const char *resource_name, mhp_t mhp_flags)
1424 {
1425         struct resource *res;
1426         int rc;
1427
1428         if (!resource_name ||
1429             strstr(resource_name, "System RAM (") != resource_name ||
1430             resource_name[strlen(resource_name) - 1] != ')')
1431                 return -EINVAL;
1432
1433         lock_device_hotplug();
1434
1435         res = register_memory_resource(start, size, resource_name);
1436         if (IS_ERR(res)) {
1437                 rc = PTR_ERR(res);
1438                 goto out_unlock;
1439         }
1440
1441         rc = add_memory_resource(nid, res, mhp_flags);
1442         if (rc < 0)
1443                 release_memory_resource(res);
1444
1445 out_unlock:
1446         unlock_device_hotplug();
1447         return rc;
1448 }
1449 EXPORT_SYMBOL_GPL(add_memory_driver_managed);
1450
1451 /*
1452  * Platforms should define arch_get_mappable_range() that provides
1453  * maximum possible addressable physical memory range for which the
1454  * linear mapping could be created. The platform returned address
1455  * range must adhere to these following semantics.
1456  *
1457  * - range.start <= range.end
1458  * - Range includes both end points [range.start..range.end]
1459  *
1460  * There is also a fallback definition provided here, allowing the
1461  * entire possible physical address range in case any platform does
1462  * not define arch_get_mappable_range().
1463  */
1464 struct range __weak arch_get_mappable_range(void)
1465 {
1466         struct range mhp_range = {
1467                 .start = 0UL,
1468                 .end = -1ULL,
1469         };
1470         return mhp_range;
1471 }
1472
1473 struct range mhp_get_pluggable_range(bool need_mapping)
1474 {
1475         const u64 max_phys = (1ULL << MAX_PHYSMEM_BITS) - 1;
1476         struct range mhp_range;
1477
1478         if (need_mapping) {
1479                 mhp_range = arch_get_mappable_range();
1480                 if (mhp_range.start > max_phys) {
1481                         mhp_range.start = 0;
1482                         mhp_range.end = 0;
1483                 }
1484                 mhp_range.end = min_t(u64, mhp_range.end, max_phys);
1485         } else {
1486                 mhp_range.start = 0;
1487                 mhp_range.end = max_phys;
1488         }
1489         return mhp_range;
1490 }
1491 EXPORT_SYMBOL_GPL(mhp_get_pluggable_range);
1492
1493 bool mhp_range_allowed(u64 start, u64 size, bool need_mapping)
1494 {
1495         struct range mhp_range = mhp_get_pluggable_range(need_mapping);
1496         u64 end = start + size;
1497
1498         if (start < end && start >= mhp_range.start && (end - 1) <= mhp_range.end)
1499                 return true;
1500
1501         pr_warn("Hotplug memory [%#llx-%#llx] exceeds maximum addressable range [%#llx-%#llx]\n",
1502                 start, end, mhp_range.start, mhp_range.end);
1503         return false;
1504 }
1505
1506 #ifdef CONFIG_MEMORY_HOTREMOVE
1507 /*
1508  * Confirm all pages in a range [start, end) belong to the same zone (skipping
1509  * memory holes). When true, return the zone.
1510  */
1511 struct zone *test_pages_in_a_zone(unsigned long start_pfn,
1512                                   unsigned long end_pfn)
1513 {
1514         unsigned long pfn, sec_end_pfn;
1515         struct zone *zone = NULL;
1516         struct page *page;
1517
1518         for (pfn = start_pfn, sec_end_pfn = SECTION_ALIGN_UP(start_pfn + 1);
1519              pfn < end_pfn;
1520              pfn = sec_end_pfn, sec_end_pfn += PAGES_PER_SECTION) {
1521                 /* Make sure the memory section is present first */
1522                 if (!present_section_nr(pfn_to_section_nr(pfn)))
1523                         continue;
1524                 for (; pfn < sec_end_pfn && pfn < end_pfn;
1525                      pfn += MAX_ORDER_NR_PAGES) {
1526                         /* Check if we got outside of the zone */
1527                         if (zone && !zone_spans_pfn(zone, pfn))
1528                                 return NULL;
1529                         page = pfn_to_page(pfn);
1530                         if (zone && page_zone(page) != zone)
1531                                 return NULL;
1532                         zone = page_zone(page);
1533                 }
1534         }
1535
1536         return zone;
1537 }
1538
1539 /*
1540  * Scan pfn range [start,end) to find movable/migratable pages (LRU pages,
1541  * non-lru movable pages and hugepages). Will skip over most unmovable
1542  * pages (esp., pages that can be skipped when offlining), but bail out on
1543  * definitely unmovable pages.
1544  *
1545  * Returns:
1546  *      0 in case a movable page is found and movable_pfn was updated.
1547  *      -ENOENT in case no movable page was found.
1548  *      -EBUSY in case a definitely unmovable page was found.
1549  */
1550 static int scan_movable_pages(unsigned long start, unsigned long end,
1551                               unsigned long *movable_pfn)
1552 {
1553         unsigned long pfn;
1554
1555         for (pfn = start; pfn < end; pfn++) {
1556                 struct page *page, *head;
1557                 unsigned long skip;
1558
1559                 if (!pfn_valid(pfn))
1560                         continue;
1561                 page = pfn_to_page(pfn);
1562                 if (PageLRU(page))
1563                         goto found;
1564                 if (__PageMovable(page))
1565                         goto found;
1566
1567                 /*
1568                  * PageOffline() pages that are not marked __PageMovable() and
1569                  * have a reference count > 0 (after MEM_GOING_OFFLINE) are
1570                  * definitely unmovable. If their reference count would be 0,
1571                  * they could at least be skipped when offlining memory.
1572                  */
1573                 if (PageOffline(page) && page_count(page))
1574                         return -EBUSY;
1575
1576                 if (!PageHuge(page))
1577                         continue;
1578                 head = compound_head(page);
1579                 /*
1580                  * This test is racy as we hold no reference or lock.  The
1581                  * hugetlb page could have been free'ed and head is no longer
1582                  * a hugetlb page before the following check.  In such unlikely
1583                  * cases false positives and negatives are possible.  Calling
1584                  * code must deal with these scenarios.
1585                  */
1586                 if (HPageMigratable(head))
1587                         goto found;
1588                 skip = compound_nr(head) - (page - head);
1589                 pfn += skip - 1;
1590         }
1591         return -ENOENT;
1592 found:
1593         *movable_pfn = pfn;
1594         return 0;
1595 }
1596
1597 static int
1598 do_migrate_range(unsigned long start_pfn, unsigned long end_pfn)
1599 {
1600         unsigned long pfn;
1601         struct page *page, *head;
1602         int ret = 0;
1603         LIST_HEAD(source);
1604         static DEFINE_RATELIMIT_STATE(migrate_rs, DEFAULT_RATELIMIT_INTERVAL,
1605                                       DEFAULT_RATELIMIT_BURST);
1606
1607         for (pfn = start_pfn; pfn < end_pfn; pfn++) {
1608                 if (!pfn_valid(pfn))
1609                         continue;
1610                 page = pfn_to_page(pfn);
1611                 head = compound_head(page);
1612
1613                 if (PageHuge(page)) {
1614                         pfn = page_to_pfn(head) + compound_nr(head) - 1;
1615                         isolate_huge_page(head, &source);
1616                         continue;
1617                 } else if (PageTransHuge(page))
1618                         pfn = page_to_pfn(head) + thp_nr_pages(page) - 1;
1619
1620                 /*
1621                  * HWPoison pages have elevated reference counts so the migration would
1622                  * fail on them. It also doesn't make any sense to migrate them in the
1623                  * first place. Still try to unmap such a page in case it is still mapped
1624                  * (e.g. current hwpoison implementation doesn't unmap KSM pages but keep
1625                  * the unmap as the catch all safety net).
1626                  */
1627                 if (PageHWPoison(page)) {
1628                         if (WARN_ON(PageLRU(page)))
1629                                 isolate_lru_page(page);
1630                         if (page_mapped(page))
1631                                 try_to_unmap(page, TTU_IGNORE_MLOCK);
1632                         continue;
1633                 }
1634
1635                 if (!get_page_unless_zero(page))
1636                         continue;
1637                 /*
1638                  * We can skip free pages. And we can deal with pages on
1639                  * LRU and non-lru movable pages.
1640                  */
1641                 if (PageLRU(page))
1642                         ret = isolate_lru_page(page);
1643                 else
1644                         ret = isolate_movable_page(page, ISOLATE_UNEVICTABLE);
1645                 if (!ret) { /* Success */
1646                         list_add_tail(&page->lru, &source);
1647                         if (!__PageMovable(page))
1648                                 inc_node_page_state(page, NR_ISOLATED_ANON +
1649                                                     page_is_file_lru(page));
1650
1651                 } else {
1652                         if (__ratelimit(&migrate_rs)) {
1653                                 pr_warn("failed to isolate pfn %lx\n", pfn);
1654                                 dump_page(page, "isolation failed");
1655                         }
1656                 }
1657                 put_page(page);
1658         }
1659         if (!list_empty(&source)) {
1660                 nodemask_t nmask = node_states[N_MEMORY];
1661                 struct migration_target_control mtc = {
1662                         .nmask = &nmask,
1663                         .gfp_mask = GFP_USER | __GFP_MOVABLE | __GFP_RETRY_MAYFAIL,
1664                 };
1665
1666                 /*
1667                  * We have checked that migration range is on a single zone so
1668                  * we can use the nid of the first page to all the others.
1669                  */
1670                 mtc.nid = page_to_nid(list_first_entry(&source, struct page, lru));
1671
1672                 /*
1673                  * try to allocate from a different node but reuse this node
1674                  * if there are no other online nodes to be used (e.g. we are
1675                  * offlining a part of the only existing node)
1676                  */
1677                 node_clear(mtc.nid, nmask);
1678                 if (nodes_empty(nmask))
1679                         node_set(mtc.nid, nmask);
1680                 ret = migrate_pages(&source, alloc_migration_target, NULL,
1681                         (unsigned long)&mtc, MIGRATE_SYNC, MR_MEMORY_HOTPLUG);
1682                 if (ret) {
1683                         list_for_each_entry(page, &source, lru) {
1684                                 if (__ratelimit(&migrate_rs)) {
1685                                         pr_warn("migrating pfn %lx failed ret:%d\n",
1686                                                 page_to_pfn(page), ret);
1687                                         dump_page(page, "migration failure");
1688                                 }
1689                         }
1690                         putback_movable_pages(&source);
1691                 }
1692         }
1693
1694         return ret;
1695 }
1696
1697 static int __init cmdline_parse_movable_node(char *p)
1698 {
1699         movable_node_enabled = true;
1700         return 0;
1701 }
1702 early_param("movable_node", cmdline_parse_movable_node);
1703
1704 /* check which state of node_states will be changed when offline memory */
1705 static void node_states_check_changes_offline(unsigned long nr_pages,
1706                 struct zone *zone, struct memory_notify *arg)
1707 {
1708         struct pglist_data *pgdat = zone->zone_pgdat;
1709         unsigned long present_pages = 0;
1710         enum zone_type zt;
1711
1712         arg->status_change_nid = NUMA_NO_NODE;
1713         arg->status_change_nid_normal = NUMA_NO_NODE;
1714         arg->status_change_nid_high = NUMA_NO_NODE;
1715
1716         /*
1717          * Check whether node_states[N_NORMAL_MEMORY] will be changed.
1718          * If the memory to be offline is within the range
1719          * [0..ZONE_NORMAL], and it is the last present memory there,
1720          * the zones in that range will become empty after the offlining,
1721          * thus we can determine that we need to clear the node from
1722          * node_states[N_NORMAL_MEMORY].
1723          */
1724         for (zt = 0; zt <= ZONE_NORMAL; zt++)
1725                 present_pages += pgdat->node_zones[zt].present_pages;
1726         if (zone_idx(zone) <= ZONE_NORMAL && nr_pages >= present_pages)
1727                 arg->status_change_nid_normal = zone_to_nid(zone);
1728
1729 #ifdef CONFIG_HIGHMEM
1730         /*
1731          * node_states[N_HIGH_MEMORY] contains nodes which
1732          * have normal memory or high memory.
1733          * Here we add the present_pages belonging to ZONE_HIGHMEM.
1734          * If the zone is within the range of [0..ZONE_HIGHMEM), and
1735          * we determine that the zones in that range become empty,
1736          * we need to clear the node for N_HIGH_MEMORY.
1737          */
1738         present_pages += pgdat->node_zones[ZONE_HIGHMEM].present_pages;
1739         if (zone_idx(zone) <= ZONE_HIGHMEM && nr_pages >= present_pages)
1740                 arg->status_change_nid_high = zone_to_nid(zone);
1741 #endif
1742
1743         /*
1744          * We have accounted the pages from [0..ZONE_NORMAL), and
1745          * in case of CONFIG_HIGHMEM the pages from ZONE_HIGHMEM
1746          * as well.
1747          * Here we count the possible pages from ZONE_MOVABLE.
1748          * If after having accounted all the pages, we see that the nr_pages
1749          * to be offlined is over or equal to the accounted pages,
1750          * we know that the node will become empty, and so, we can clear
1751          * it for N_MEMORY as well.
1752          */
1753         present_pages += pgdat->node_zones[ZONE_MOVABLE].present_pages;
1754
1755         if (nr_pages >= present_pages)
1756                 arg->status_change_nid = zone_to_nid(zone);
1757 }
1758
1759 static void node_states_clear_node(int node, struct memory_notify *arg)
1760 {
1761         if (arg->status_change_nid_normal >= 0)
1762                 node_clear_state(node, N_NORMAL_MEMORY);
1763
1764         if (arg->status_change_nid_high >= 0)
1765                 node_clear_state(node, N_HIGH_MEMORY);
1766
1767         if (arg->status_change_nid >= 0)
1768                 node_clear_state(node, N_MEMORY);
1769 }
1770
1771 static int count_system_ram_pages_cb(unsigned long start_pfn,
1772                                      unsigned long nr_pages, void *data)
1773 {
1774         unsigned long *nr_system_ram_pages = data;
1775
1776         *nr_system_ram_pages += nr_pages;
1777         return 0;
1778 }
1779
1780 int __ref offline_pages(unsigned long start_pfn, unsigned long nr_pages,
1781                         struct memory_group *group)
1782 {
1783         const unsigned long end_pfn = start_pfn + nr_pages;
1784         unsigned long pfn, system_ram_pages = 0;
1785         unsigned long flags;
1786         struct zone *zone;
1787         struct memory_notify arg;
1788         int ret, node;
1789         char *reason;
1790
1791         /*
1792          * {on,off}lining is constrained to full memory sections (or more
1793          * precisely to memory blocks from the user space POV).
1794          * memmap_on_memory is an exception because it reserves initial part
1795          * of the physical memory space for vmemmaps. That space is pageblock
1796          * aligned.
1797          */
1798         if (WARN_ON_ONCE(!nr_pages ||
1799                          !IS_ALIGNED(start_pfn, pageblock_nr_pages) ||
1800                          !IS_ALIGNED(start_pfn + nr_pages, PAGES_PER_SECTION)))
1801                 return -EINVAL;
1802
1803         mem_hotplug_begin();
1804
1805         /*
1806          * Don't allow to offline memory blocks that contain holes.
1807          * Consequently, memory blocks with holes can never get onlined
1808          * via the hotplug path - online_pages() - as hotplugged memory has
1809          * no holes. This way, we e.g., don't have to worry about marking
1810          * memory holes PG_reserved, don't need pfn_valid() checks, and can
1811          * avoid using walk_system_ram_range() later.
1812          */
1813         walk_system_ram_range(start_pfn, nr_pages, &system_ram_pages,
1814                               count_system_ram_pages_cb);
1815         if (system_ram_pages != nr_pages) {
1816                 ret = -EINVAL;
1817                 reason = "memory holes";
1818                 goto failed_removal;
1819         }
1820
1821         /* This makes hotplug much easier...and readable.
1822            we assume this for now. .*/
1823         zone = test_pages_in_a_zone(start_pfn, end_pfn);
1824         if (!zone) {
1825                 ret = -EINVAL;
1826                 reason = "multizone range";
1827                 goto failed_removal;
1828         }
1829         node = zone_to_nid(zone);
1830
1831         /*
1832          * Disable pcplists so that page isolation cannot race with freeing
1833          * in a way that pages from isolated pageblock are left on pcplists.
1834          */
1835         zone_pcp_disable(zone);
1836         lru_cache_disable();
1837
1838         /* set above range as isolated */
1839         ret = start_isolate_page_range(start_pfn, end_pfn,
1840                                        MIGRATE_MOVABLE,
1841                                        MEMORY_OFFLINE | REPORT_FAILURE);
1842         if (ret) {
1843                 reason = "failure to isolate range";
1844                 goto failed_removal_pcplists_disabled;
1845         }
1846
1847         arg.start_pfn = start_pfn;
1848         arg.nr_pages = nr_pages;
1849         node_states_check_changes_offline(nr_pages, zone, &arg);
1850
1851         ret = memory_notify(MEM_GOING_OFFLINE, &arg);
1852         ret = notifier_to_errno(ret);
1853         if (ret) {
1854                 reason = "notifier failure";
1855                 goto failed_removal_isolated;
1856         }
1857
1858         do {
1859                 pfn = start_pfn;
1860                 do {
1861                         if (signal_pending(current)) {
1862                                 ret = -EINTR;
1863                                 reason = "signal backoff";
1864                                 goto failed_removal_isolated;
1865                         }
1866
1867                         cond_resched();
1868
1869                         ret = scan_movable_pages(pfn, end_pfn, &pfn);
1870                         if (!ret) {
1871                                 /*
1872                                  * TODO: fatal migration failures should bail
1873                                  * out
1874                                  */
1875                                 do_migrate_range(pfn, end_pfn);
1876                         }
1877                 } while (!ret);
1878
1879                 if (ret != -ENOENT) {
1880                         reason = "unmovable page";
1881                         goto failed_removal_isolated;
1882                 }
1883
1884                 /*
1885                  * Dissolve free hugepages in the memory block before doing
1886                  * offlining actually in order to make hugetlbfs's object
1887                  * counting consistent.
1888                  */
1889                 ret = dissolve_free_huge_pages(start_pfn, end_pfn);
1890                 if (ret) {
1891                         reason = "failure to dissolve huge pages";
1892                         goto failed_removal_isolated;
1893                 }
1894
1895                 ret = test_pages_isolated(start_pfn, end_pfn, MEMORY_OFFLINE);
1896
1897         } while (ret);
1898
1899         /* Mark all sections offline and remove free pages from the buddy. */
1900         __offline_isolated_pages(start_pfn, end_pfn);
1901         pr_debug("Offlined Pages %ld\n", nr_pages);
1902
1903         /*
1904          * The memory sections are marked offline, and the pageblock flags
1905          * effectively stale; nobody should be touching them. Fixup the number
1906          * of isolated pageblocks, memory onlining will properly revert this.
1907          */
1908         spin_lock_irqsave(&zone->lock, flags);
1909         zone->nr_isolate_pageblock -= nr_pages / pageblock_nr_pages;
1910         spin_unlock_irqrestore(&zone->lock, flags);
1911
1912         lru_cache_enable();
1913         zone_pcp_enable(zone);
1914
1915         /* removal success */
1916         adjust_managed_page_count(pfn_to_page(start_pfn), -nr_pages);
1917         adjust_present_page_count(pfn_to_page(start_pfn), group, -nr_pages);
1918
1919         /* reinitialise watermarks and update pcp limits */
1920         init_per_zone_wmark_min();
1921
1922         if (!populated_zone(zone)) {
1923                 zone_pcp_reset(zone);
1924                 build_all_zonelists(NULL);
1925         }
1926
1927         node_states_clear_node(node, &arg);
1928         if (arg.status_change_nid >= 0) {
1929                 kswapd_stop(node);
1930                 kcompactd_stop(node);
1931         }
1932
1933         writeback_set_ratelimit();
1934
1935         memory_notify(MEM_OFFLINE, &arg);
1936         remove_pfn_range_from_zone(zone, start_pfn, nr_pages);
1937         mem_hotplug_done();
1938         return 0;
1939
1940 failed_removal_isolated:
1941         undo_isolate_page_range(start_pfn, end_pfn, MIGRATE_MOVABLE);
1942         memory_notify(MEM_CANCEL_OFFLINE, &arg);
1943 failed_removal_pcplists_disabled:
1944         lru_cache_enable();
1945         zone_pcp_enable(zone);
1946 failed_removal:
1947         pr_debug("memory offlining [mem %#010llx-%#010llx] failed due to %s\n",
1948                  (unsigned long long) start_pfn << PAGE_SHIFT,
1949                  ((unsigned long long) end_pfn << PAGE_SHIFT) - 1,
1950                  reason);
1951         /* pushback to free area */
1952         mem_hotplug_done();
1953         return ret;
1954 }
1955
1956 static int check_memblock_offlined_cb(struct memory_block *mem, void *arg)
1957 {
1958         int ret = !is_memblock_offlined(mem);
1959         int *nid = arg;
1960
1961         *nid = mem->nid;
1962         if (unlikely(ret)) {
1963                 phys_addr_t beginpa, endpa;
1964
1965                 beginpa = PFN_PHYS(section_nr_to_pfn(mem->start_section_nr));
1966                 endpa = beginpa + memory_block_size_bytes() - 1;
1967                 pr_warn("removing memory fails, because memory [%pa-%pa] is onlined\n",
1968                         &beginpa, &endpa);
1969
1970                 return -EBUSY;
1971         }
1972         return 0;
1973 }
1974
1975 static int get_nr_vmemmap_pages_cb(struct memory_block *mem, void *arg)
1976 {
1977         /*
1978          * If not set, continue with the next block.
1979          */
1980         return mem->nr_vmemmap_pages;
1981 }
1982
1983 static int check_cpu_on_node(pg_data_t *pgdat)
1984 {
1985         int cpu;
1986
1987         for_each_present_cpu(cpu) {
1988                 if (cpu_to_node(cpu) == pgdat->node_id)
1989                         /*
1990                          * the cpu on this node isn't removed, and we can't
1991                          * offline this node.
1992                          */
1993                         return -EBUSY;
1994         }
1995
1996         return 0;
1997 }
1998
1999 static int check_no_memblock_for_node_cb(struct memory_block *mem, void *arg)
2000 {
2001         int nid = *(int *)arg;
2002
2003         /*
2004          * If a memory block belongs to multiple nodes, the stored nid is not
2005          * reliable. However, such blocks are always online (e.g., cannot get
2006          * offlined) and, therefore, are still spanned by the node.
2007          */
2008         return mem->nid == nid ? -EEXIST : 0;
2009 }
2010
2011 /**
2012  * try_offline_node
2013  * @nid: the node ID
2014  *
2015  * Offline a node if all memory sections and cpus of the node are removed.
2016  *
2017  * NOTE: The caller must call lock_device_hotplug() to serialize hotplug
2018  * and online/offline operations before this call.
2019  */
2020 void try_offline_node(int nid)
2021 {
2022         pg_data_t *pgdat = NODE_DATA(nid);
2023         int rc;
2024
2025         /*
2026          * If the node still spans pages (especially ZONE_DEVICE), don't
2027          * offline it. A node spans memory after move_pfn_range_to_zone(),
2028          * e.g., after the memory block was onlined.
2029          */
2030         if (pgdat->node_spanned_pages)
2031                 return;
2032
2033         /*
2034          * Especially offline memory blocks might not be spanned by the
2035          * node. They will get spanned by the node once they get onlined.
2036          * However, they link to the node in sysfs and can get onlined later.
2037          */
2038         rc = for_each_memory_block(&nid, check_no_memblock_for_node_cb);
2039         if (rc)
2040                 return;
2041
2042         if (check_cpu_on_node(pgdat))
2043                 return;
2044
2045         /*
2046          * all memory/cpu of this node are removed, we can offline this
2047          * node now.
2048          */
2049         node_set_offline(nid);
2050         unregister_one_node(nid);
2051 }
2052 EXPORT_SYMBOL(try_offline_node);
2053
2054 static int __ref try_remove_memory(u64 start, u64 size)
2055 {
2056         struct vmem_altmap mhp_altmap = {};
2057         struct vmem_altmap *altmap = NULL;
2058         unsigned long nr_vmemmap_pages;
2059         int rc = 0, nid = NUMA_NO_NODE;
2060
2061         BUG_ON(check_hotplug_memory_range(start, size));
2062
2063         /*
2064          * All memory blocks must be offlined before removing memory.  Check
2065          * whether all memory blocks in question are offline and return error
2066          * if this is not the case.
2067          *
2068          * While at it, determine the nid. Note that if we'd have mixed nodes,
2069          * we'd only try to offline the last determined one -- which is good
2070          * enough for the cases we care about.
2071          */
2072         rc = walk_memory_blocks(start, size, &nid, check_memblock_offlined_cb);
2073         if (rc)
2074                 return rc;
2075
2076         /*
2077          * We only support removing memory added with MHP_MEMMAP_ON_MEMORY in
2078          * the same granularity it was added - a single memory block.
2079          */
2080         if (memmap_on_memory) {
2081                 nr_vmemmap_pages = walk_memory_blocks(start, size, NULL,
2082                                                       get_nr_vmemmap_pages_cb);
2083                 if (nr_vmemmap_pages) {
2084                         if (size != memory_block_size_bytes()) {
2085                                 pr_warn("Refuse to remove %#llx - %#llx,"
2086                                         "wrong granularity\n",
2087                                         start, start + size);
2088                                 return -EINVAL;
2089                         }
2090
2091                         /*
2092                          * Let remove_pmd_table->free_hugepage_table do the
2093                          * right thing if we used vmem_altmap when hot-adding
2094                          * the range.
2095                          */
2096                         mhp_altmap.alloc = nr_vmemmap_pages;
2097                         altmap = &mhp_altmap;
2098                 }
2099         }
2100
2101         /* remove memmap entry */
2102         firmware_map_remove(start, start + size, "System RAM");
2103
2104         /*
2105          * Memory block device removal under the device_hotplug_lock is
2106          * a barrier against racing online attempts.
2107          */
2108         remove_memory_block_devices(start, size);
2109
2110         mem_hotplug_begin();
2111
2112         arch_remove_memory(start, size, altmap);
2113
2114         if (IS_ENABLED(CONFIG_ARCH_KEEP_MEMBLOCK)) {
2115                 memblock_free(start, size);
2116                 memblock_remove(start, size);
2117         }
2118
2119         release_mem_region_adjustable(start, size);
2120
2121         if (nid != NUMA_NO_NODE)
2122                 try_offline_node(nid);
2123
2124         mem_hotplug_done();
2125         return 0;
2126 }
2127
2128 /**
2129  * __remove_memory - Remove memory if every memory block is offline
2130  * @start: physical address of the region to remove
2131  * @size: size of the region to remove
2132  *
2133  * NOTE: The caller must call lock_device_hotplug() to serialize hotplug
2134  * and online/offline operations before this call, as required by
2135  * try_offline_node().
2136  */
2137 void __remove_memory(u64 start, u64 size)
2138 {
2139
2140         /*
2141          * trigger BUG() if some memory is not offlined prior to calling this
2142          * function
2143          */
2144         if (try_remove_memory(start, size))
2145                 BUG();
2146 }
2147
2148 /*
2149  * Remove memory if every memory block is offline, otherwise return -EBUSY is
2150  * some memory is not offline
2151  */
2152 int remove_memory(u64 start, u64 size)
2153 {
2154         int rc;
2155
2156         lock_device_hotplug();
2157         rc = try_remove_memory(start, size);
2158         unlock_device_hotplug();
2159
2160         return rc;
2161 }
2162 EXPORT_SYMBOL_GPL(remove_memory);
2163
2164 static int try_offline_memory_block(struct memory_block *mem, void *arg)
2165 {
2166         uint8_t online_type = MMOP_ONLINE_KERNEL;
2167         uint8_t **online_types = arg;
2168         struct page *page;
2169         int rc;
2170
2171         /*
2172          * Sense the online_type via the zone of the memory block. Offlining
2173          * with multiple zones within one memory block will be rejected
2174          * by offlining code ... so we don't care about that.
2175          */
2176         page = pfn_to_online_page(section_nr_to_pfn(mem->start_section_nr));
2177         if (page && zone_idx(page_zone(page)) == ZONE_MOVABLE)
2178                 online_type = MMOP_ONLINE_MOVABLE;
2179
2180         rc = device_offline(&mem->dev);
2181         /*
2182          * Default is MMOP_OFFLINE - change it only if offlining succeeded,
2183          * so try_reonline_memory_block() can do the right thing.
2184          */
2185         if (!rc)
2186                 **online_types = online_type;
2187
2188         (*online_types)++;
2189         /* Ignore if already offline. */
2190         return rc < 0 ? rc : 0;
2191 }
2192
2193 static int try_reonline_memory_block(struct memory_block *mem, void *arg)
2194 {
2195         uint8_t **online_types = arg;
2196         int rc;
2197
2198         if (**online_types != MMOP_OFFLINE) {
2199                 mem->online_type = **online_types;
2200                 rc = device_online(&mem->dev);
2201                 if (rc < 0)
2202                         pr_warn("%s: Failed to re-online memory: %d",
2203                                 __func__, rc);
2204         }
2205
2206         /* Continue processing all remaining memory blocks. */
2207         (*online_types)++;
2208         return 0;
2209 }
2210
2211 /*
2212  * Try to offline and remove memory. Might take a long time to finish in case
2213  * memory is still in use. Primarily useful for memory devices that logically
2214  * unplugged all memory (so it's no longer in use) and want to offline + remove
2215  * that memory.
2216  */
2217 int offline_and_remove_memory(u64 start, u64 size)
2218 {
2219         const unsigned long mb_count = size / memory_block_size_bytes();
2220         uint8_t *online_types, *tmp;
2221         int rc;
2222
2223         if (!IS_ALIGNED(start, memory_block_size_bytes()) ||
2224             !IS_ALIGNED(size, memory_block_size_bytes()) || !size)
2225                 return -EINVAL;
2226
2227         /*
2228          * We'll remember the old online type of each memory block, so we can
2229          * try to revert whatever we did when offlining one memory block fails
2230          * after offlining some others succeeded.
2231          */
2232         online_types = kmalloc_array(mb_count, sizeof(*online_types),
2233                                      GFP_KERNEL);
2234         if (!online_types)
2235                 return -ENOMEM;
2236         /*
2237          * Initialize all states to MMOP_OFFLINE, so when we abort processing in
2238          * try_offline_memory_block(), we'll skip all unprocessed blocks in
2239          * try_reonline_memory_block().
2240          */
2241         memset(online_types, MMOP_OFFLINE, mb_count);
2242
2243         lock_device_hotplug();
2244
2245         tmp = online_types;
2246         rc = walk_memory_blocks(start, size, &tmp, try_offline_memory_block);
2247
2248         /*
2249          * In case we succeeded to offline all memory, remove it.
2250          * This cannot fail as it cannot get onlined in the meantime.
2251          */
2252         if (!rc) {
2253                 rc = try_remove_memory(start, size);
2254                 if (rc)
2255                         pr_err("%s: Failed to remove memory: %d", __func__, rc);
2256         }
2257
2258         /*
2259          * Rollback what we did. While memory onlining might theoretically fail
2260          * (nacked by a notifier), it barely ever happens.
2261          */
2262         if (rc) {
2263                 tmp = online_types;
2264                 walk_memory_blocks(start, size, &tmp,
2265                                    try_reonline_memory_block);
2266         }
2267         unlock_device_hotplug();
2268
2269         kfree(online_types);
2270         return rc;
2271 }
2272 EXPORT_SYMBOL_GPL(offline_and_remove_memory);
2273 #endif /* CONFIG_MEMORY_HOTREMOVE */