xref: /linux/drivers/base/memory.c (revision 395f6081bad49f9c54abafebab49ee23aa985bbd)
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Memory subsystem support
4  *
5  * Written by Matt Tolentino <matthew.e.tolentino@intel.com>
6  *            Dave Hansen <haveblue@us.ibm.com>
7  *
8  * This file provides the necessary infrastructure to represent
9  * a SPARSEMEM-memory-model system's physical memory in /sysfs.
10  * All arch-independent code that assumes MEMORY_HOTPLUG requires
11  * SPARSEMEM should be contained here, or in mm/memory_hotplug.c.
12  */
13 
14 #include <linux/module.h>
15 #include <linux/init.h>
16 #include <linux/topology.h>
17 #include <linux/capability.h>
18 #include <linux/device.h>
19 #include <linux/memory.h>
20 #include <linux/memory_hotplug.h>
21 #include <linux/mm.h>
22 #include <linux/stat.h>
23 #include <linux/slab.h>
24 #include <linux/xarray.h>
25 
26 #include <linux/atomic.h>
27 #include <linux/uaccess.h>
28 
29 #define MEMORY_CLASS_NAME	"memory"
30 
31 static const char *const online_type_to_str[] = {
32 	[MMOP_OFFLINE] = "offline",
33 	[MMOP_ONLINE] = "online",
34 	[MMOP_ONLINE_KERNEL] = "online_kernel",
35 	[MMOP_ONLINE_MOVABLE] = "online_movable",
36 };
37 
38 int mhp_online_type_from_str(const char *str)
39 {
40 	int i;
41 
42 	for (i = 0; i < ARRAY_SIZE(online_type_to_str); i++) {
43 		if (sysfs_streq(str, online_type_to_str[i]))
44 			return i;
45 	}
46 	return -EINVAL;
47 }
48 
49 #define to_memory_block(dev) container_of(dev, struct memory_block, dev)
50 
51 static int sections_per_block;
52 
53 static inline unsigned long memory_block_id(unsigned long section_nr)
54 {
55 	return section_nr / sections_per_block;
56 }
57 
58 static inline unsigned long pfn_to_block_id(unsigned long pfn)
59 {
60 	return memory_block_id(pfn_to_section_nr(pfn));
61 }
62 
63 static inline unsigned long phys_to_block_id(unsigned long phys)
64 {
65 	return pfn_to_block_id(PFN_DOWN(phys));
66 }
67 
68 static int memory_subsys_online(struct device *dev);
69 static int memory_subsys_offline(struct device *dev);
70 
71 static struct bus_type memory_subsys = {
72 	.name = MEMORY_CLASS_NAME,
73 	.dev_name = MEMORY_CLASS_NAME,
74 	.online = memory_subsys_online,
75 	.offline = memory_subsys_offline,
76 };
77 
78 /*
79  * Memory blocks are cached in a local radix tree to avoid
80  * a costly linear search for the corresponding device on
81  * the subsystem bus.
82  */
83 static DEFINE_XARRAY(memory_blocks);
84 
85 /*
86  * Memory groups, indexed by memory group id (mgid).
87  */
88 static DEFINE_XARRAY_FLAGS(memory_groups, XA_FLAGS_ALLOC);
89 #define MEMORY_GROUP_MARK_DYNAMIC	XA_MARK_1
90 
91 static BLOCKING_NOTIFIER_HEAD(memory_chain);
92 
93 int register_memory_notifier(struct notifier_block *nb)
94 {
95 	return blocking_notifier_chain_register(&memory_chain, nb);
96 }
97 EXPORT_SYMBOL(register_memory_notifier);
98 
99 void unregister_memory_notifier(struct notifier_block *nb)
100 {
101 	blocking_notifier_chain_unregister(&memory_chain, nb);
102 }
103 EXPORT_SYMBOL(unregister_memory_notifier);
104 
105 static void memory_block_release(struct device *dev)
106 {
107 	struct memory_block *mem = to_memory_block(dev);
108 
109 	kfree(mem);
110 }
111 
112 unsigned long __weak memory_block_size_bytes(void)
113 {
114 	return MIN_MEMORY_BLOCK_SIZE;
115 }
116 EXPORT_SYMBOL_GPL(memory_block_size_bytes);
117 
118 /*
119  * Show the first physical section index (number) of this memory block.
120  */
121 static ssize_t phys_index_show(struct device *dev,
122 			       struct device_attribute *attr, char *buf)
123 {
124 	struct memory_block *mem = to_memory_block(dev);
125 	unsigned long phys_index;
126 
127 	phys_index = mem->start_section_nr / sections_per_block;
128 
129 	return sysfs_emit(buf, "%08lx\n", phys_index);
130 }
131 
132 /*
133  * Legacy interface that we cannot remove. Always indicate "removable"
134  * with CONFIG_MEMORY_HOTREMOVE - bad heuristic.
135  */
136 static ssize_t removable_show(struct device *dev, struct device_attribute *attr,
137 			      char *buf)
138 {
139 	return sysfs_emit(buf, "%d\n", (int)IS_ENABLED(CONFIG_MEMORY_HOTREMOVE));
140 }
141 
142 /*
143  * online, offline, going offline, etc.
144  */
145 static ssize_t state_show(struct device *dev, struct device_attribute *attr,
146 			  char *buf)
147 {
148 	struct memory_block *mem = to_memory_block(dev);
149 	const char *output;
150 
151 	/*
152 	 * We can probably put these states in a nice little array
153 	 * so that they're not open-coded
154 	 */
155 	switch (mem->state) {
156 	case MEM_ONLINE:
157 		output = "online";
158 		break;
159 	case MEM_OFFLINE:
160 		output = "offline";
161 		break;
162 	case MEM_GOING_OFFLINE:
163 		output = "going-offline";
164 		break;
165 	default:
166 		WARN_ON(1);
167 		return sysfs_emit(buf, "ERROR-UNKNOWN-%ld\n", mem->state);
168 	}
169 
170 	return sysfs_emit(buf, "%s\n", output);
171 }
172 
173 int memory_notify(unsigned long val, void *v)
174 {
175 	return blocking_notifier_call_chain(&memory_chain, val, v);
176 }
177 
178 static int memory_block_online(struct memory_block *mem)
179 {
180 	unsigned long start_pfn = section_nr_to_pfn(mem->start_section_nr);
181 	unsigned long nr_pages = PAGES_PER_SECTION * sections_per_block;
182 	unsigned long nr_vmemmap_pages = mem->nr_vmemmap_pages;
183 	struct zone *zone;
184 	int ret;
185 
186 	zone = zone_for_pfn_range(mem->online_type, mem->nid, mem->group,
187 				  start_pfn, nr_pages);
188 
189 	/*
190 	 * Although vmemmap pages have a different lifecycle than the pages
191 	 * they describe (they remain until the memory is unplugged), doing
192 	 * their initialization and accounting at memory onlining/offlining
193 	 * stage helps to keep accounting easier to follow - e.g vmemmaps
194 	 * belong to the same zone as the memory they backed.
195 	 */
196 	if (nr_vmemmap_pages) {
197 		ret = mhp_init_memmap_on_memory(start_pfn, nr_vmemmap_pages, zone);
198 		if (ret)
199 			return ret;
200 	}
201 
202 	ret = online_pages(start_pfn + nr_vmemmap_pages,
203 			   nr_pages - nr_vmemmap_pages, zone, mem->group);
204 	if (ret) {
205 		if (nr_vmemmap_pages)
206 			mhp_deinit_memmap_on_memory(start_pfn, nr_vmemmap_pages);
207 		return ret;
208 	}
209 
210 	/*
211 	 * Account once onlining succeeded. If the zone was unpopulated, it is
212 	 * now already properly populated.
213 	 */
214 	if (nr_vmemmap_pages)
215 		adjust_present_page_count(pfn_to_page(start_pfn), mem->group,
216 					  nr_vmemmap_pages);
217 
218 	mem->zone = zone;
219 	return ret;
220 }
221 
222 static int memory_block_offline(struct memory_block *mem)
223 {
224 	unsigned long start_pfn = section_nr_to_pfn(mem->start_section_nr);
225 	unsigned long nr_pages = PAGES_PER_SECTION * sections_per_block;
226 	unsigned long nr_vmemmap_pages = mem->nr_vmemmap_pages;
227 	int ret;
228 
229 	if (!mem->zone)
230 		return -EINVAL;
231 
232 	/*
233 	 * Unaccount before offlining, such that unpopulated zone and kthreads
234 	 * can properly be torn down in offline_pages().
235 	 */
236 	if (nr_vmemmap_pages)
237 		adjust_present_page_count(pfn_to_page(start_pfn), mem->group,
238 					  -nr_vmemmap_pages);
239 
240 	ret = offline_pages(start_pfn + nr_vmemmap_pages,
241 			    nr_pages - nr_vmemmap_pages, mem->zone, mem->group);
242 	if (ret) {
243 		/* offline_pages() failed. Account back. */
244 		if (nr_vmemmap_pages)
245 			adjust_present_page_count(pfn_to_page(start_pfn),
246 						  mem->group, nr_vmemmap_pages);
247 		return ret;
248 	}
249 
250 	if (nr_vmemmap_pages)
251 		mhp_deinit_memmap_on_memory(start_pfn, nr_vmemmap_pages);
252 
253 	mem->zone = NULL;
254 	return ret;
255 }
256 
257 /*
258  * MEMORY_HOTPLUG depends on SPARSEMEM in mm/Kconfig, so it is
259  * OK to have direct references to sparsemem variables in here.
260  */
261 static int
262 memory_block_action(struct memory_block *mem, unsigned long action)
263 {
264 	int ret;
265 
266 	switch (action) {
267 	case MEM_ONLINE:
268 		ret = memory_block_online(mem);
269 		break;
270 	case MEM_OFFLINE:
271 		ret = memory_block_offline(mem);
272 		break;
273 	default:
274 		WARN(1, KERN_WARNING "%s(%ld, %ld) unknown action: "
275 		     "%ld\n", __func__, mem->start_section_nr, action, action);
276 		ret = -EINVAL;
277 	}
278 
279 	return ret;
280 }
281 
282 static int memory_block_change_state(struct memory_block *mem,
283 		unsigned long to_state, unsigned long from_state_req)
284 {
285 	int ret = 0;
286 
287 	if (mem->state != from_state_req)
288 		return -EINVAL;
289 
290 	if (to_state == MEM_OFFLINE)
291 		mem->state = MEM_GOING_OFFLINE;
292 
293 	ret = memory_block_action(mem, to_state);
294 	mem->state = ret ? from_state_req : to_state;
295 
296 	return ret;
297 }
298 
299 /* The device lock serializes operations on memory_subsys_[online|offline] */
300 static int memory_subsys_online(struct device *dev)
301 {
302 	struct memory_block *mem = to_memory_block(dev);
303 	int ret;
304 
305 	if (mem->state == MEM_ONLINE)
306 		return 0;
307 
308 	/*
309 	 * When called via device_online() without configuring the online_type,
310 	 * we want to default to MMOP_ONLINE.
311 	 */
312 	if (mem->online_type == MMOP_OFFLINE)
313 		mem->online_type = MMOP_ONLINE;
314 
315 	ret = memory_block_change_state(mem, MEM_ONLINE, MEM_OFFLINE);
316 	mem->online_type = MMOP_OFFLINE;
317 
318 	return ret;
319 }
320 
321 static int memory_subsys_offline(struct device *dev)
322 {
323 	struct memory_block *mem = to_memory_block(dev);
324 
325 	if (mem->state == MEM_OFFLINE)
326 		return 0;
327 
328 	return memory_block_change_state(mem, MEM_OFFLINE, MEM_ONLINE);
329 }
330 
331 static ssize_t state_store(struct device *dev, struct device_attribute *attr,
332 			   const char *buf, size_t count)
333 {
334 	const int online_type = mhp_online_type_from_str(buf);
335 	struct memory_block *mem = to_memory_block(dev);
336 	int ret;
337 
338 	if (online_type < 0)
339 		return -EINVAL;
340 
341 	ret = lock_device_hotplug_sysfs();
342 	if (ret)
343 		return ret;
344 
345 	switch (online_type) {
346 	case MMOP_ONLINE_KERNEL:
347 	case MMOP_ONLINE_MOVABLE:
348 	case MMOP_ONLINE:
349 		/* mem->online_type is protected by device_hotplug_lock */
350 		mem->online_type = online_type;
351 		ret = device_online(&mem->dev);
352 		break;
353 	case MMOP_OFFLINE:
354 		ret = device_offline(&mem->dev);
355 		break;
356 	default:
357 		ret = -EINVAL; /* should never happen */
358 	}
359 
360 	unlock_device_hotplug();
361 
362 	if (ret < 0)
363 		return ret;
364 	if (ret)
365 		return -EINVAL;
366 
367 	return count;
368 }
369 
370 /*
371  * Legacy interface that we cannot remove: s390x exposes the storage increment
372  * covered by a memory block, allowing for identifying which memory blocks
373  * comprise a storage increment. Since a memory block spans complete
374  * storage increments nowadays, this interface is basically unused. Other
375  * archs never exposed != 0.
376  */
377 static ssize_t phys_device_show(struct device *dev,
378 				struct device_attribute *attr, char *buf)
379 {
380 	struct memory_block *mem = to_memory_block(dev);
381 	unsigned long start_pfn = section_nr_to_pfn(mem->start_section_nr);
382 
383 	return sysfs_emit(buf, "%d\n",
384 			  arch_get_memory_phys_device(start_pfn));
385 }
386 
387 #ifdef CONFIG_MEMORY_HOTREMOVE
388 static int print_allowed_zone(char *buf, int len, int nid,
389 			      struct memory_group *group,
390 			      unsigned long start_pfn, unsigned long nr_pages,
391 			      int online_type, struct zone *default_zone)
392 {
393 	struct zone *zone;
394 
395 	zone = zone_for_pfn_range(online_type, nid, group, start_pfn, nr_pages);
396 	if (zone == default_zone)
397 		return 0;
398 
399 	return sysfs_emit_at(buf, len, " %s", zone->name);
400 }
401 
402 static ssize_t valid_zones_show(struct device *dev,
403 				struct device_attribute *attr, char *buf)
404 {
405 	struct memory_block *mem = to_memory_block(dev);
406 	unsigned long start_pfn = section_nr_to_pfn(mem->start_section_nr);
407 	unsigned long nr_pages = PAGES_PER_SECTION * sections_per_block;
408 	struct memory_group *group = mem->group;
409 	struct zone *default_zone;
410 	int nid = mem->nid;
411 	int len = 0;
412 
413 	/*
414 	 * Check the existing zone. Make sure that we do that only on the
415 	 * online nodes otherwise the page_zone is not reliable
416 	 */
417 	if (mem->state == MEM_ONLINE) {
418 		/*
419 		 * If !mem->zone, the memory block spans multiple zones and
420 		 * cannot get offlined.
421 		 */
422 		default_zone = mem->zone;
423 		if (!default_zone)
424 			return sysfs_emit(buf, "%s\n", "none");
425 		len += sysfs_emit_at(buf, len, "%s", default_zone->name);
426 		goto out;
427 	}
428 
429 	default_zone = zone_for_pfn_range(MMOP_ONLINE, nid, group,
430 					  start_pfn, nr_pages);
431 
432 	len += sysfs_emit_at(buf, len, "%s", default_zone->name);
433 	len += print_allowed_zone(buf, len, nid, group, start_pfn, nr_pages,
434 				  MMOP_ONLINE_KERNEL, default_zone);
435 	len += print_allowed_zone(buf, len, nid, group, start_pfn, nr_pages,
436 				  MMOP_ONLINE_MOVABLE, default_zone);
437 out:
438 	len += sysfs_emit_at(buf, len, "\n");
439 	return len;
440 }
441 static DEVICE_ATTR_RO(valid_zones);
442 #endif
443 
444 static DEVICE_ATTR_RO(phys_index);
445 static DEVICE_ATTR_RW(state);
446 static DEVICE_ATTR_RO(phys_device);
447 static DEVICE_ATTR_RO(removable);
448 
449 /*
450  * Show the memory block size (shared by all memory blocks).
451  */
452 static ssize_t block_size_bytes_show(struct device *dev,
453 				     struct device_attribute *attr, char *buf)
454 {
455 	return sysfs_emit(buf, "%lx\n", memory_block_size_bytes());
456 }
457 
458 static DEVICE_ATTR_RO(block_size_bytes);
459 
460 /*
461  * Memory auto online policy.
462  */
463 
464 static ssize_t auto_online_blocks_show(struct device *dev,
465 				       struct device_attribute *attr, char *buf)
466 {
467 	return sysfs_emit(buf, "%s\n",
468 			  online_type_to_str[mhp_default_online_type]);
469 }
470 
471 static ssize_t auto_online_blocks_store(struct device *dev,
472 					struct device_attribute *attr,
473 					const char *buf, size_t count)
474 {
475 	const int online_type = mhp_online_type_from_str(buf);
476 
477 	if (online_type < 0)
478 		return -EINVAL;
479 
480 	mhp_default_online_type = online_type;
481 	return count;
482 }
483 
484 static DEVICE_ATTR_RW(auto_online_blocks);
485 
486 /*
487  * Some architectures will have custom drivers to do this, and
488  * will not need to do it from userspace.  The fake hot-add code
489  * as well as ppc64 will do all of their discovery in userspace
490  * and will require this interface.
491  */
492 #ifdef CONFIG_ARCH_MEMORY_PROBE
493 static ssize_t probe_store(struct device *dev, struct device_attribute *attr,
494 			   const char *buf, size_t count)
495 {
496 	u64 phys_addr;
497 	int nid, ret;
498 	unsigned long pages_per_block = PAGES_PER_SECTION * sections_per_block;
499 
500 	ret = kstrtoull(buf, 0, &phys_addr);
501 	if (ret)
502 		return ret;
503 
504 	if (phys_addr & ((pages_per_block << PAGE_SHIFT) - 1))
505 		return -EINVAL;
506 
507 	ret = lock_device_hotplug_sysfs();
508 	if (ret)
509 		return ret;
510 
511 	nid = memory_add_physaddr_to_nid(phys_addr);
512 	ret = __add_memory(nid, phys_addr,
513 			   MIN_MEMORY_BLOCK_SIZE * sections_per_block,
514 			   MHP_NONE);
515 
516 	if (ret)
517 		goto out;
518 
519 	ret = count;
520 out:
521 	unlock_device_hotplug();
522 	return ret;
523 }
524 
525 static DEVICE_ATTR_WO(probe);
526 #endif
527 
528 #ifdef CONFIG_MEMORY_FAILURE
529 /*
530  * Support for offlining pages of memory
531  */
532 
533 /* Soft offline a page */
534 static ssize_t soft_offline_page_store(struct device *dev,
535 				       struct device_attribute *attr,
536 				       const char *buf, size_t count)
537 {
538 	int ret;
539 	u64 pfn;
540 	if (!capable(CAP_SYS_ADMIN))
541 		return -EPERM;
542 	if (kstrtoull(buf, 0, &pfn) < 0)
543 		return -EINVAL;
544 	pfn >>= PAGE_SHIFT;
545 	ret = soft_offline_page(pfn, 0);
546 	return ret == 0 ? count : ret;
547 }
548 
549 /* Forcibly offline a page, including killing processes. */
550 static ssize_t hard_offline_page_store(struct device *dev,
551 				       struct device_attribute *attr,
552 				       const char *buf, size_t count)
553 {
554 	int ret;
555 	u64 pfn;
556 	if (!capable(CAP_SYS_ADMIN))
557 		return -EPERM;
558 	if (kstrtoull(buf, 0, &pfn) < 0)
559 		return -EINVAL;
560 	pfn >>= PAGE_SHIFT;
561 	ret = memory_failure(pfn, 0);
562 	if (ret == -EOPNOTSUPP)
563 		ret = 0;
564 	return ret ? ret : count;
565 }
566 
567 static DEVICE_ATTR_WO(soft_offline_page);
568 static DEVICE_ATTR_WO(hard_offline_page);
569 #endif
570 
571 /* See phys_device_show(). */
572 int __weak arch_get_memory_phys_device(unsigned long start_pfn)
573 {
574 	return 0;
575 }
576 
577 /*
578  * A reference for the returned memory block device is acquired.
579  *
580  * Called under device_hotplug_lock.
581  */
582 static struct memory_block *find_memory_block_by_id(unsigned long block_id)
583 {
584 	struct memory_block *mem;
585 
586 	mem = xa_load(&memory_blocks, block_id);
587 	if (mem)
588 		get_device(&mem->dev);
589 	return mem;
590 }
591 
592 /*
593  * Called under device_hotplug_lock.
594  */
595 struct memory_block *find_memory_block(unsigned long section_nr)
596 {
597 	unsigned long block_id = memory_block_id(section_nr);
598 
599 	return find_memory_block_by_id(block_id);
600 }
601 
602 static struct attribute *memory_memblk_attrs[] = {
603 	&dev_attr_phys_index.attr,
604 	&dev_attr_state.attr,
605 	&dev_attr_phys_device.attr,
606 	&dev_attr_removable.attr,
607 #ifdef CONFIG_MEMORY_HOTREMOVE
608 	&dev_attr_valid_zones.attr,
609 #endif
610 	NULL
611 };
612 
613 static const struct attribute_group memory_memblk_attr_group = {
614 	.attrs = memory_memblk_attrs,
615 };
616 
617 static const struct attribute_group *memory_memblk_attr_groups[] = {
618 	&memory_memblk_attr_group,
619 	NULL,
620 };
621 
622 /*
623  * register_memory - Setup a sysfs device for a memory block
624  */
625 static
626 int register_memory(struct memory_block *memory)
627 {
628 	int ret;
629 
630 	memory->dev.bus = &memory_subsys;
631 	memory->dev.id = memory->start_section_nr / sections_per_block;
632 	memory->dev.release = memory_block_release;
633 	memory->dev.groups = memory_memblk_attr_groups;
634 	memory->dev.offline = memory->state == MEM_OFFLINE;
635 
636 	ret = device_register(&memory->dev);
637 	if (ret) {
638 		put_device(&memory->dev);
639 		return ret;
640 	}
641 	ret = xa_err(xa_store(&memory_blocks, memory->dev.id, memory,
642 			      GFP_KERNEL));
643 	if (ret) {
644 		put_device(&memory->dev);
645 		device_unregister(&memory->dev);
646 	}
647 	return ret;
648 }
649 
650 static struct zone *early_node_zone_for_memory_block(struct memory_block *mem,
651 						     int nid)
652 {
653 	const unsigned long start_pfn = section_nr_to_pfn(mem->start_section_nr);
654 	const unsigned long nr_pages = PAGES_PER_SECTION * sections_per_block;
655 	struct zone *zone, *matching_zone = NULL;
656 	pg_data_t *pgdat = NODE_DATA(nid);
657 	int i;
658 
659 	/*
660 	 * This logic only works for early memory, when the applicable zones
661 	 * already span the memory block. We don't expect overlapping zones on
662 	 * a single node for early memory. So if we're told that some PFNs
663 	 * of a node fall into this memory block, we can assume that all node
664 	 * zones that intersect with the memory block are actually applicable.
665 	 * No need to look at the memmap.
666 	 */
667 	for (i = 0; i < MAX_NR_ZONES; i++) {
668 		zone = pgdat->node_zones + i;
669 		if (!populated_zone(zone))
670 			continue;
671 		if (!zone_intersects(zone, start_pfn, nr_pages))
672 			continue;
673 		if (!matching_zone) {
674 			matching_zone = zone;
675 			continue;
676 		}
677 		/* Spans multiple zones ... */
678 		matching_zone = NULL;
679 		break;
680 	}
681 	return matching_zone;
682 }
683 
684 #ifdef CONFIG_NUMA
685 /**
686  * memory_block_add_nid() - Indicate that system RAM falling into this memory
687  *			    block device (partially) belongs to the given node.
688  * @mem: The memory block device.
689  * @nid: The node id.
690  * @context: The memory initialization context.
691  *
692  * Indicate that system RAM falling into this memory block (partially) belongs
693  * to the given node. If the context indicates ("early") that we are adding the
694  * node during node device subsystem initialization, this will also properly
695  * set/adjust mem->zone based on the zone ranges of the given node.
696  */
697 void memory_block_add_nid(struct memory_block *mem, int nid,
698 			  enum meminit_context context)
699 {
700 	if (context == MEMINIT_EARLY && mem->nid != nid) {
701 		/*
702 		 * For early memory we have to determine the zone when setting
703 		 * the node id and handle multiple nodes spanning a single
704 		 * memory block by indicate via zone == NULL that we're not
705 		 * dealing with a single zone. So if we're setting the node id
706 		 * the first time, determine if there is a single zone. If we're
707 		 * setting the node id a second time to a different node,
708 		 * invalidate the single detected zone.
709 		 */
710 		if (mem->nid == NUMA_NO_NODE)
711 			mem->zone = early_node_zone_for_memory_block(mem, nid);
712 		else
713 			mem->zone = NULL;
714 	}
715 
716 	/*
717 	 * If this memory block spans multiple nodes, we only indicate
718 	 * the last processed node. If we span multiple nodes (not applicable
719 	 * to hotplugged memory), zone == NULL will prohibit memory offlining
720 	 * and consequently unplug.
721 	 */
722 	mem->nid = nid;
723 }
724 #endif
725 
726 static int init_memory_block(unsigned long block_id, unsigned long state,
727 			     unsigned long nr_vmemmap_pages,
728 			     struct memory_group *group)
729 {
730 	struct memory_block *mem;
731 	int ret = 0;
732 
733 	mem = find_memory_block_by_id(block_id);
734 	if (mem) {
735 		put_device(&mem->dev);
736 		return -EEXIST;
737 	}
738 	mem = kzalloc(sizeof(*mem), GFP_KERNEL);
739 	if (!mem)
740 		return -ENOMEM;
741 
742 	mem->start_section_nr = block_id * sections_per_block;
743 	mem->state = state;
744 	mem->nid = NUMA_NO_NODE;
745 	mem->nr_vmemmap_pages = nr_vmemmap_pages;
746 	INIT_LIST_HEAD(&mem->group_next);
747 
748 #ifndef CONFIG_NUMA
749 	if (state == MEM_ONLINE)
750 		/*
751 		 * MEM_ONLINE at this point implies early memory. With NUMA,
752 		 * we'll determine the zone when setting the node id via
753 		 * memory_block_add_nid(). Memory hotplug updated the zone
754 		 * manually when memory onlining/offlining succeeds.
755 		 */
756 		mem->zone = early_node_zone_for_memory_block(mem, NUMA_NO_NODE);
757 #endif /* CONFIG_NUMA */
758 
759 	ret = register_memory(mem);
760 	if (ret)
761 		return ret;
762 
763 	if (group) {
764 		mem->group = group;
765 		list_add(&mem->group_next, &group->memory_blocks);
766 	}
767 
768 	return 0;
769 }
770 
771 static int add_memory_block(unsigned long base_section_nr)
772 {
773 	int section_count = 0;
774 	unsigned long nr;
775 
776 	for (nr = base_section_nr; nr < base_section_nr + sections_per_block;
777 	     nr++)
778 		if (present_section_nr(nr))
779 			section_count++;
780 
781 	if (section_count == 0)
782 		return 0;
783 	return init_memory_block(memory_block_id(base_section_nr),
784 				 MEM_ONLINE, 0,  NULL);
785 }
786 
787 static void unregister_memory(struct memory_block *memory)
788 {
789 	if (WARN_ON_ONCE(memory->dev.bus != &memory_subsys))
790 		return;
791 
792 	WARN_ON(xa_erase(&memory_blocks, memory->dev.id) == NULL);
793 
794 	if (memory->group) {
795 		list_del(&memory->group_next);
796 		memory->group = NULL;
797 	}
798 
799 	/* drop the ref. we got via find_memory_block() */
800 	put_device(&memory->dev);
801 	device_unregister(&memory->dev);
802 }
803 
804 /*
805  * Create memory block devices for the given memory area. Start and size
806  * have to be aligned to memory block granularity. Memory block devices
807  * will be initialized as offline.
808  *
809  * Called under device_hotplug_lock.
810  */
811 int create_memory_block_devices(unsigned long start, unsigned long size,
812 				unsigned long vmemmap_pages,
813 				struct memory_group *group)
814 {
815 	const unsigned long start_block_id = pfn_to_block_id(PFN_DOWN(start));
816 	unsigned long end_block_id = pfn_to_block_id(PFN_DOWN(start + size));
817 	struct memory_block *mem;
818 	unsigned long block_id;
819 	int ret = 0;
820 
821 	if (WARN_ON_ONCE(!IS_ALIGNED(start, memory_block_size_bytes()) ||
822 			 !IS_ALIGNED(size, memory_block_size_bytes())))
823 		return -EINVAL;
824 
825 	for (block_id = start_block_id; block_id != end_block_id; block_id++) {
826 		ret = init_memory_block(block_id, MEM_OFFLINE, vmemmap_pages,
827 					group);
828 		if (ret)
829 			break;
830 	}
831 	if (ret) {
832 		end_block_id = block_id;
833 		for (block_id = start_block_id; block_id != end_block_id;
834 		     block_id++) {
835 			mem = find_memory_block_by_id(block_id);
836 			if (WARN_ON_ONCE(!mem))
837 				continue;
838 			unregister_memory(mem);
839 		}
840 	}
841 	return ret;
842 }
843 
844 /*
845  * Remove memory block devices for the given memory area. Start and size
846  * have to be aligned to memory block granularity. Memory block devices
847  * have to be offline.
848  *
849  * Called under device_hotplug_lock.
850  */
851 void remove_memory_block_devices(unsigned long start, unsigned long size)
852 {
853 	const unsigned long start_block_id = pfn_to_block_id(PFN_DOWN(start));
854 	const unsigned long end_block_id = pfn_to_block_id(PFN_DOWN(start + size));
855 	struct memory_block *mem;
856 	unsigned long block_id;
857 
858 	if (WARN_ON_ONCE(!IS_ALIGNED(start, memory_block_size_bytes()) ||
859 			 !IS_ALIGNED(size, memory_block_size_bytes())))
860 		return;
861 
862 	for (block_id = start_block_id; block_id != end_block_id; block_id++) {
863 		mem = find_memory_block_by_id(block_id);
864 		if (WARN_ON_ONCE(!mem))
865 			continue;
866 		unregister_memory_block_under_nodes(mem);
867 		unregister_memory(mem);
868 	}
869 }
870 
871 /* return true if the memory block is offlined, otherwise, return false */
872 bool is_memblock_offlined(struct memory_block *mem)
873 {
874 	return mem->state == MEM_OFFLINE;
875 }
876 
877 static struct attribute *memory_root_attrs[] = {
878 #ifdef CONFIG_ARCH_MEMORY_PROBE
879 	&dev_attr_probe.attr,
880 #endif
881 
882 #ifdef CONFIG_MEMORY_FAILURE
883 	&dev_attr_soft_offline_page.attr,
884 	&dev_attr_hard_offline_page.attr,
885 #endif
886 
887 	&dev_attr_block_size_bytes.attr,
888 	&dev_attr_auto_online_blocks.attr,
889 	NULL
890 };
891 
892 static const struct attribute_group memory_root_attr_group = {
893 	.attrs = memory_root_attrs,
894 };
895 
896 static const struct attribute_group *memory_root_attr_groups[] = {
897 	&memory_root_attr_group,
898 	NULL,
899 };
900 
901 /*
902  * Initialize the sysfs support for memory devices. At the time this function
903  * is called, we cannot have concurrent creation/deletion of memory block
904  * devices, the device_hotplug_lock is not needed.
905  */
906 void __init memory_dev_init(void)
907 {
908 	int ret;
909 	unsigned long block_sz, nr;
910 
911 	/* Validate the configured memory block size */
912 	block_sz = memory_block_size_bytes();
913 	if (!is_power_of_2(block_sz) || block_sz < MIN_MEMORY_BLOCK_SIZE)
914 		panic("Memory block size not suitable: 0x%lx\n", block_sz);
915 	sections_per_block = block_sz / MIN_MEMORY_BLOCK_SIZE;
916 
917 	ret = subsys_system_register(&memory_subsys, memory_root_attr_groups);
918 	if (ret)
919 		panic("%s() failed to register subsystem: %d\n", __func__, ret);
920 
921 	/*
922 	 * Create entries for memory sections that were found
923 	 * during boot and have been initialized
924 	 */
925 	for (nr = 0; nr <= __highest_present_section_nr;
926 	     nr += sections_per_block) {
927 		ret = add_memory_block(nr);
928 		if (ret)
929 			panic("%s() failed to add memory block: %d\n", __func__,
930 			      ret);
931 	}
932 }
933 
934 /**
935  * walk_memory_blocks - walk through all present memory blocks overlapped
936  *			by the range [start, start + size)
937  *
938  * @start: start address of the memory range
939  * @size: size of the memory range
940  * @arg: argument passed to func
941  * @func: callback for each memory section walked
942  *
943  * This function walks through all present memory blocks overlapped by the
944  * range [start, start + size), calling func on each memory block.
945  *
946  * In case func() returns an error, walking is aborted and the error is
947  * returned.
948  *
949  * Called under device_hotplug_lock.
950  */
951 int walk_memory_blocks(unsigned long start, unsigned long size,
952 		       void *arg, walk_memory_blocks_func_t func)
953 {
954 	const unsigned long start_block_id = phys_to_block_id(start);
955 	const unsigned long end_block_id = phys_to_block_id(start + size - 1);
956 	struct memory_block *mem;
957 	unsigned long block_id;
958 	int ret = 0;
959 
960 	if (!size)
961 		return 0;
962 
963 	for (block_id = start_block_id; block_id <= end_block_id; block_id++) {
964 		mem = find_memory_block_by_id(block_id);
965 		if (!mem)
966 			continue;
967 
968 		ret = func(mem, arg);
969 		put_device(&mem->dev);
970 		if (ret)
971 			break;
972 	}
973 	return ret;
974 }
975 
976 struct for_each_memory_block_cb_data {
977 	walk_memory_blocks_func_t func;
978 	void *arg;
979 };
980 
981 static int for_each_memory_block_cb(struct device *dev, void *data)
982 {
983 	struct memory_block *mem = to_memory_block(dev);
984 	struct for_each_memory_block_cb_data *cb_data = data;
985 
986 	return cb_data->func(mem, cb_data->arg);
987 }
988 
989 /**
990  * for_each_memory_block - walk through all present memory blocks
991  *
992  * @arg: argument passed to func
993  * @func: callback for each memory block walked
994  *
995  * This function walks through all present memory blocks, calling func on
996  * each memory block.
997  *
998  * In case func() returns an error, walking is aborted and the error is
999  * returned.
1000  */
1001 int for_each_memory_block(void *arg, walk_memory_blocks_func_t func)
1002 {
1003 	struct for_each_memory_block_cb_data cb_data = {
1004 		.func = func,
1005 		.arg = arg,
1006 	};
1007 
1008 	return bus_for_each_dev(&memory_subsys, NULL, &cb_data,
1009 				for_each_memory_block_cb);
1010 }
1011 
1012 /*
1013  * This is an internal helper to unify allocation and initialization of
1014  * memory groups. Note that the passed memory group will be copied to a
1015  * dynamically allocated memory group. After this call, the passed
1016  * memory group should no longer be used.
1017  */
1018 static int memory_group_register(struct memory_group group)
1019 {
1020 	struct memory_group *new_group;
1021 	uint32_t mgid;
1022 	int ret;
1023 
1024 	if (!node_possible(group.nid))
1025 		return -EINVAL;
1026 
1027 	new_group = kzalloc(sizeof(group), GFP_KERNEL);
1028 	if (!new_group)
1029 		return -ENOMEM;
1030 	*new_group = group;
1031 	INIT_LIST_HEAD(&new_group->memory_blocks);
1032 
1033 	ret = xa_alloc(&memory_groups, &mgid, new_group, xa_limit_31b,
1034 		       GFP_KERNEL);
1035 	if (ret) {
1036 		kfree(new_group);
1037 		return ret;
1038 	} else if (group.is_dynamic) {
1039 		xa_set_mark(&memory_groups, mgid, MEMORY_GROUP_MARK_DYNAMIC);
1040 	}
1041 	return mgid;
1042 }
1043 
1044 /**
1045  * memory_group_register_static() - Register a static memory group.
1046  * @nid: The node id.
1047  * @max_pages: The maximum number of pages we'll have in this static memory
1048  *	       group.
1049  *
1050  * Register a new static memory group and return the memory group id.
1051  * All memory in the group belongs to a single unit, such as a DIMM. All
1052  * memory belonging to a static memory group is added in one go to be removed
1053  * in one go -- it's static.
1054  *
1055  * Returns an error if out of memory, if the node id is invalid, if no new
1056  * memory groups can be registered, or if max_pages is invalid (0). Otherwise,
1057  * returns the new memory group id.
1058  */
1059 int memory_group_register_static(int nid, unsigned long max_pages)
1060 {
1061 	struct memory_group group = {
1062 		.nid = nid,
1063 		.s = {
1064 			.max_pages = max_pages,
1065 		},
1066 	};
1067 
1068 	if (!max_pages)
1069 		return -EINVAL;
1070 	return memory_group_register(group);
1071 }
1072 EXPORT_SYMBOL_GPL(memory_group_register_static);
1073 
1074 /**
1075  * memory_group_register_dynamic() - Register a dynamic memory group.
1076  * @nid: The node id.
1077  * @unit_pages: Unit in pages in which is memory added/removed in this dynamic
1078  *		memory group.
1079  *
1080  * Register a new dynamic memory group and return the memory group id.
1081  * Memory within a dynamic memory group is added/removed dynamically
1082  * in unit_pages.
1083  *
1084  * Returns an error if out of memory, if the node id is invalid, if no new
1085  * memory groups can be registered, or if unit_pages is invalid (0, not a
1086  * power of two, smaller than a single memory block). Otherwise, returns the
1087  * new memory group id.
1088  */
1089 int memory_group_register_dynamic(int nid, unsigned long unit_pages)
1090 {
1091 	struct memory_group group = {
1092 		.nid = nid,
1093 		.is_dynamic = true,
1094 		.d = {
1095 			.unit_pages = unit_pages,
1096 		},
1097 	};
1098 
1099 	if (!unit_pages || !is_power_of_2(unit_pages) ||
1100 	    unit_pages < PHYS_PFN(memory_block_size_bytes()))
1101 		return -EINVAL;
1102 	return memory_group_register(group);
1103 }
1104 EXPORT_SYMBOL_GPL(memory_group_register_dynamic);
1105 
1106 /**
1107  * memory_group_unregister() - Unregister a memory group.
1108  * @mgid: the memory group id
1109  *
1110  * Unregister a memory group. If any memory block still belongs to this
1111  * memory group, unregistering will fail.
1112  *
1113  * Returns -EINVAL if the memory group id is invalid, returns -EBUSY if some
1114  * memory blocks still belong to this memory group and returns 0 if
1115  * unregistering succeeded.
1116  */
1117 int memory_group_unregister(int mgid)
1118 {
1119 	struct memory_group *group;
1120 
1121 	if (mgid < 0)
1122 		return -EINVAL;
1123 
1124 	group = xa_load(&memory_groups, mgid);
1125 	if (!group)
1126 		return -EINVAL;
1127 	if (!list_empty(&group->memory_blocks))
1128 		return -EBUSY;
1129 	xa_erase(&memory_groups, mgid);
1130 	kfree(group);
1131 	return 0;
1132 }
1133 EXPORT_SYMBOL_GPL(memory_group_unregister);
1134 
1135 /*
1136  * This is an internal helper only to be used in core memory hotplug code to
1137  * lookup a memory group. We don't care about locking, as we don't expect a
1138  * memory group to get unregistered while adding memory to it -- because
1139  * the group and the memory is managed by the same driver.
1140  */
1141 struct memory_group *memory_group_find_by_id(int mgid)
1142 {
1143 	return xa_load(&memory_groups, mgid);
1144 }
1145 
1146 /*
1147  * This is an internal helper only to be used in core memory hotplug code to
1148  * walk all dynamic memory groups excluding a given memory group, either
1149  * belonging to a specific node, or belonging to any node.
1150  */
1151 int walk_dynamic_memory_groups(int nid, walk_memory_groups_func_t func,
1152 			       struct memory_group *excluded, void *arg)
1153 {
1154 	struct memory_group *group;
1155 	unsigned long index;
1156 	int ret = 0;
1157 
1158 	xa_for_each_marked(&memory_groups, index, group,
1159 			   MEMORY_GROUP_MARK_DYNAMIC) {
1160 		if (group == excluded)
1161 			continue;
1162 #ifdef CONFIG_NUMA
1163 		if (nid != NUMA_NO_NODE && group->nid != nid)
1164 			continue;
1165 #endif /* CONFIG_NUMA */
1166 		ret = func(group, arg);
1167 		if (ret)
1168 			break;
1169 	}
1170 	return ret;
1171 }
1172