driver/base/memory.c: validate memory block size early
[linux-2.6-microblaze.git] / drivers / base / memory.c
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/mutex.h>
23 #include <linux/stat.h>
24 #include <linux/slab.h>
25
26 #include <linux/atomic.h>
27 #include <linux/uaccess.h>
28
29 static DEFINE_MUTEX(mem_sysfs_mutex);
30
31 #define MEMORY_CLASS_NAME       "memory"
32
33 #define to_memory_block(dev) container_of(dev, struct memory_block, dev)
34
35 static int sections_per_block;
36
37 static inline unsigned long base_memory_block_id(unsigned long section_nr)
38 {
39         return section_nr / sections_per_block;
40 }
41
42 static inline unsigned long pfn_to_block_id(unsigned long pfn)
43 {
44         return base_memory_block_id(pfn_to_section_nr(pfn));
45 }
46
47 static inline unsigned long phys_to_block_id(unsigned long phys)
48 {
49         return pfn_to_block_id(PFN_DOWN(phys));
50 }
51
52 static int memory_subsys_online(struct device *dev);
53 static int memory_subsys_offline(struct device *dev);
54
55 static struct bus_type memory_subsys = {
56         .name = MEMORY_CLASS_NAME,
57         .dev_name = MEMORY_CLASS_NAME,
58         .online = memory_subsys_online,
59         .offline = memory_subsys_offline,
60 };
61
62 static BLOCKING_NOTIFIER_HEAD(memory_chain);
63
64 int register_memory_notifier(struct notifier_block *nb)
65 {
66         return blocking_notifier_chain_register(&memory_chain, nb);
67 }
68 EXPORT_SYMBOL(register_memory_notifier);
69
70 void unregister_memory_notifier(struct notifier_block *nb)
71 {
72         blocking_notifier_chain_unregister(&memory_chain, nb);
73 }
74 EXPORT_SYMBOL(unregister_memory_notifier);
75
76 static ATOMIC_NOTIFIER_HEAD(memory_isolate_chain);
77
78 int register_memory_isolate_notifier(struct notifier_block *nb)
79 {
80         return atomic_notifier_chain_register(&memory_isolate_chain, nb);
81 }
82 EXPORT_SYMBOL(register_memory_isolate_notifier);
83
84 void unregister_memory_isolate_notifier(struct notifier_block *nb)
85 {
86         atomic_notifier_chain_unregister(&memory_isolate_chain, nb);
87 }
88 EXPORT_SYMBOL(unregister_memory_isolate_notifier);
89
90 static void memory_block_release(struct device *dev)
91 {
92         struct memory_block *mem = to_memory_block(dev);
93
94         kfree(mem);
95 }
96
97 unsigned long __weak memory_block_size_bytes(void)
98 {
99         return MIN_MEMORY_BLOCK_SIZE;
100 }
101 EXPORT_SYMBOL_GPL(memory_block_size_bytes);
102
103 /*
104  * Show the first physical section index (number) of this memory block.
105  */
106 static ssize_t phys_index_show(struct device *dev,
107                                struct device_attribute *attr, char *buf)
108 {
109         struct memory_block *mem = to_memory_block(dev);
110         unsigned long phys_index;
111
112         phys_index = mem->start_section_nr / sections_per_block;
113         return sprintf(buf, "%08lx\n", phys_index);
114 }
115
116 /*
117  * Show whether the memory block is likely to be offlineable (or is already
118  * offline). Once offline, the memory block could be removed. The return
119  * value does, however, not indicate that there is a way to remove the
120  * memory block.
121  */
122 static ssize_t removable_show(struct device *dev, struct device_attribute *attr,
123                               char *buf)
124 {
125         struct memory_block *mem = to_memory_block(dev);
126         unsigned long pfn;
127         int ret = 1, i;
128
129         if (mem->state != MEM_ONLINE)
130                 goto out;
131
132         for (i = 0; i < sections_per_block; i++) {
133                 if (!present_section_nr(mem->start_section_nr + i))
134                         continue;
135                 pfn = section_nr_to_pfn(mem->start_section_nr + i);
136                 ret &= is_mem_section_removable(pfn, PAGES_PER_SECTION);
137         }
138
139 out:
140         return sprintf(buf, "%d\n", ret);
141 }
142
143 /*
144  * online, offline, going offline, etc.
145  */
146 static ssize_t state_show(struct device *dev, struct device_attribute *attr,
147                           char *buf)
148 {
149         struct memory_block *mem = to_memory_block(dev);
150         ssize_t len = 0;
151
152         /*
153          * We can probably put these states in a nice little array
154          * so that they're not open-coded
155          */
156         switch (mem->state) {
157         case MEM_ONLINE:
158                 len = sprintf(buf, "online\n");
159                 break;
160         case MEM_OFFLINE:
161                 len = sprintf(buf, "offline\n");
162                 break;
163         case MEM_GOING_OFFLINE:
164                 len = sprintf(buf, "going-offline\n");
165                 break;
166         default:
167                 len = sprintf(buf, "ERROR-UNKNOWN-%ld\n",
168                                 mem->state);
169                 WARN_ON(1);
170                 break;
171         }
172
173         return len;
174 }
175
176 int memory_notify(unsigned long val, void *v)
177 {
178         return blocking_notifier_call_chain(&memory_chain, val, v);
179 }
180
181 int memory_isolate_notify(unsigned long val, void *v)
182 {
183         return atomic_notifier_call_chain(&memory_isolate_chain, val, v);
184 }
185
186 /*
187  * The probe routines leave the pages uninitialized, just as the bootmem code
188  * does. Make sure we do not access them, but instead use only information from
189  * within sections.
190  */
191 static bool pages_correctly_probed(unsigned long start_pfn)
192 {
193         unsigned long section_nr = pfn_to_section_nr(start_pfn);
194         unsigned long section_nr_end = section_nr + sections_per_block;
195         unsigned long pfn = start_pfn;
196
197         /*
198          * memmap between sections is not contiguous except with
199          * SPARSEMEM_VMEMMAP. We lookup the page once per section
200          * and assume memmap is contiguous within each section
201          */
202         for (; section_nr < section_nr_end; section_nr++) {
203                 if (WARN_ON_ONCE(!pfn_valid(pfn)))
204                         return false;
205
206                 if (!present_section_nr(section_nr)) {
207                         pr_warn("section %ld pfn[%lx, %lx) not present\n",
208                                 section_nr, pfn, pfn + PAGES_PER_SECTION);
209                         return false;
210                 } else if (!valid_section_nr(section_nr)) {
211                         pr_warn("section %ld pfn[%lx, %lx) no valid memmap\n",
212                                 section_nr, pfn, pfn + PAGES_PER_SECTION);
213                         return false;
214                 } else if (online_section_nr(section_nr)) {
215                         pr_warn("section %ld pfn[%lx, %lx) is already online\n",
216                                 section_nr, pfn, pfn + PAGES_PER_SECTION);
217                         return false;
218                 }
219                 pfn += PAGES_PER_SECTION;
220         }
221
222         return true;
223 }
224
225 /*
226  * MEMORY_HOTPLUG depends on SPARSEMEM in mm/Kconfig, so it is
227  * OK to have direct references to sparsemem variables in here.
228  */
229 static int
230 memory_block_action(unsigned long start_section_nr, unsigned long action,
231                     int online_type)
232 {
233         unsigned long start_pfn;
234         unsigned long nr_pages = PAGES_PER_SECTION * sections_per_block;
235         int ret;
236
237         start_pfn = section_nr_to_pfn(start_section_nr);
238
239         switch (action) {
240         case MEM_ONLINE:
241                 if (!pages_correctly_probed(start_pfn))
242                         return -EBUSY;
243
244                 ret = online_pages(start_pfn, nr_pages, online_type);
245                 break;
246         case MEM_OFFLINE:
247                 ret = offline_pages(start_pfn, nr_pages);
248                 break;
249         default:
250                 WARN(1, KERN_WARNING "%s(%ld, %ld) unknown action: "
251                      "%ld\n", __func__, start_section_nr, action, action);
252                 ret = -EINVAL;
253         }
254
255         return ret;
256 }
257
258 static int memory_block_change_state(struct memory_block *mem,
259                 unsigned long to_state, unsigned long from_state_req)
260 {
261         int ret = 0;
262
263         if (mem->state != from_state_req)
264                 return -EINVAL;
265
266         if (to_state == MEM_OFFLINE)
267                 mem->state = MEM_GOING_OFFLINE;
268
269         ret = memory_block_action(mem->start_section_nr, to_state,
270                                 mem->online_type);
271
272         mem->state = ret ? from_state_req : to_state;
273
274         return ret;
275 }
276
277 /* The device lock serializes operations on memory_subsys_[online|offline] */
278 static int memory_subsys_online(struct device *dev)
279 {
280         struct memory_block *mem = to_memory_block(dev);
281         int ret;
282
283         if (mem->state == MEM_ONLINE)
284                 return 0;
285
286         /*
287          * If we are called from state_store(), online_type will be
288          * set >= 0 Otherwise we were called from the device online
289          * attribute and need to set the online_type.
290          */
291         if (mem->online_type < 0)
292                 mem->online_type = MMOP_ONLINE_KEEP;
293
294         ret = memory_block_change_state(mem, MEM_ONLINE, MEM_OFFLINE);
295
296         /* clear online_type */
297         mem->online_type = -1;
298
299         return ret;
300 }
301
302 static int memory_subsys_offline(struct device *dev)
303 {
304         struct memory_block *mem = to_memory_block(dev);
305
306         if (mem->state == MEM_OFFLINE)
307                 return 0;
308
309         /* Can't offline block with non-present sections */
310         if (mem->section_count != sections_per_block)
311                 return -EINVAL;
312
313         return memory_block_change_state(mem, MEM_OFFLINE, MEM_ONLINE);
314 }
315
316 static ssize_t state_store(struct device *dev, struct device_attribute *attr,
317                            const char *buf, size_t count)
318 {
319         struct memory_block *mem = to_memory_block(dev);
320         int ret, online_type;
321
322         ret = lock_device_hotplug_sysfs();
323         if (ret)
324                 return ret;
325
326         if (sysfs_streq(buf, "online_kernel"))
327                 online_type = MMOP_ONLINE_KERNEL;
328         else if (sysfs_streq(buf, "online_movable"))
329                 online_type = MMOP_ONLINE_MOVABLE;
330         else if (sysfs_streq(buf, "online"))
331                 online_type = MMOP_ONLINE_KEEP;
332         else if (sysfs_streq(buf, "offline"))
333                 online_type = MMOP_OFFLINE;
334         else {
335                 ret = -EINVAL;
336                 goto err;
337         }
338
339         switch (online_type) {
340         case MMOP_ONLINE_KERNEL:
341         case MMOP_ONLINE_MOVABLE:
342         case MMOP_ONLINE_KEEP:
343                 /* mem->online_type is protected by device_hotplug_lock */
344                 mem->online_type = online_type;
345                 ret = device_online(&mem->dev);
346                 break;
347         case MMOP_OFFLINE:
348                 ret = device_offline(&mem->dev);
349                 break;
350         default:
351                 ret = -EINVAL; /* should never happen */
352         }
353
354 err:
355         unlock_device_hotplug();
356
357         if (ret < 0)
358                 return ret;
359         if (ret)
360                 return -EINVAL;
361
362         return count;
363 }
364
365 /*
366  * phys_device is a bad name for this.  What I really want
367  * is a way to differentiate between memory ranges that
368  * are part of physical devices that constitute
369  * a complete removable unit or fru.
370  * i.e. do these ranges belong to the same physical device,
371  * s.t. if I offline all of these sections I can then
372  * remove the physical device?
373  */
374 static ssize_t phys_device_show(struct device *dev,
375                                 struct device_attribute *attr, char *buf)
376 {
377         struct memory_block *mem = to_memory_block(dev);
378         return sprintf(buf, "%d\n", mem->phys_device);
379 }
380
381 #ifdef CONFIG_MEMORY_HOTREMOVE
382 static void print_allowed_zone(char *buf, int nid, unsigned long start_pfn,
383                 unsigned long nr_pages, int online_type,
384                 struct zone *default_zone)
385 {
386         struct zone *zone;
387
388         zone = zone_for_pfn_range(online_type, nid, start_pfn, nr_pages);
389         if (zone != default_zone) {
390                 strcat(buf, " ");
391                 strcat(buf, zone->name);
392         }
393 }
394
395 static ssize_t valid_zones_show(struct device *dev,
396                                 struct device_attribute *attr, char *buf)
397 {
398         struct memory_block *mem = to_memory_block(dev);
399         unsigned long start_pfn = section_nr_to_pfn(mem->start_section_nr);
400         unsigned long nr_pages = PAGES_PER_SECTION * sections_per_block;
401         unsigned long valid_start_pfn, valid_end_pfn;
402         struct zone *default_zone;
403         int nid;
404
405         /*
406          * Check the existing zone. Make sure that we do that only on the
407          * online nodes otherwise the page_zone is not reliable
408          */
409         if (mem->state == MEM_ONLINE) {
410                 /*
411                  * The block contains more than one zone can not be offlined.
412                  * This can happen e.g. for ZONE_DMA and ZONE_DMA32
413                  */
414                 if (!test_pages_in_a_zone(start_pfn, start_pfn + nr_pages,
415                                           &valid_start_pfn, &valid_end_pfn))
416                         return sprintf(buf, "none\n");
417                 start_pfn = valid_start_pfn;
418                 strcat(buf, page_zone(pfn_to_page(start_pfn))->name);
419                 goto out;
420         }
421
422         nid = mem->nid;
423         default_zone = zone_for_pfn_range(MMOP_ONLINE_KEEP, nid, start_pfn, nr_pages);
424         strcat(buf, default_zone->name);
425
426         print_allowed_zone(buf, nid, start_pfn, nr_pages, MMOP_ONLINE_KERNEL,
427                         default_zone);
428         print_allowed_zone(buf, nid, start_pfn, nr_pages, MMOP_ONLINE_MOVABLE,
429                         default_zone);
430 out:
431         strcat(buf, "\n");
432
433         return strlen(buf);
434 }
435 static DEVICE_ATTR_RO(valid_zones);
436 #endif
437
438 static DEVICE_ATTR_RO(phys_index);
439 static DEVICE_ATTR_RW(state);
440 static DEVICE_ATTR_RO(phys_device);
441 static DEVICE_ATTR_RO(removable);
442
443 /*
444  * Show the memory block size (shared by all memory blocks).
445  */
446 static ssize_t block_size_bytes_show(struct device *dev,
447                                      struct device_attribute *attr, char *buf)
448 {
449         return sprintf(buf, "%lx\n", memory_block_size_bytes());
450 }
451
452 static DEVICE_ATTR_RO(block_size_bytes);
453
454 /*
455  * Memory auto online policy.
456  */
457
458 static ssize_t auto_online_blocks_show(struct device *dev,
459                                        struct device_attribute *attr, char *buf)
460 {
461         if (memhp_auto_online)
462                 return sprintf(buf, "online\n");
463         else
464                 return sprintf(buf, "offline\n");
465 }
466
467 static ssize_t auto_online_blocks_store(struct device *dev,
468                                         struct device_attribute *attr,
469                                         const char *buf, size_t count)
470 {
471         if (sysfs_streq(buf, "online"))
472                 memhp_auto_online = true;
473         else if (sysfs_streq(buf, "offline"))
474                 memhp_auto_online = false;
475         else
476                 return -EINVAL;
477
478         return count;
479 }
480
481 static DEVICE_ATTR_RW(auto_online_blocks);
482
483 /*
484  * Some architectures will have custom drivers to do this, and
485  * will not need to do it from userspace.  The fake hot-add code
486  * as well as ppc64 will do all of their discovery in userspace
487  * and will require this interface.
488  */
489 #ifdef CONFIG_ARCH_MEMORY_PROBE
490 static ssize_t probe_store(struct device *dev, struct device_attribute *attr,
491                            const char *buf, size_t count)
492 {
493         u64 phys_addr;
494         int nid, ret;
495         unsigned long pages_per_block = PAGES_PER_SECTION * sections_per_block;
496
497         ret = kstrtoull(buf, 0, &phys_addr);
498         if (ret)
499                 return ret;
500
501         if (phys_addr & ((pages_per_block << PAGE_SHIFT) - 1))
502                 return -EINVAL;
503
504         ret = lock_device_hotplug_sysfs();
505         if (ret)
506                 return ret;
507
508         nid = memory_add_physaddr_to_nid(phys_addr);
509         ret = __add_memory(nid, phys_addr,
510                            MIN_MEMORY_BLOCK_SIZE * sections_per_block);
511
512         if (ret)
513                 goto out;
514
515         ret = count;
516 out:
517         unlock_device_hotplug();
518         return ret;
519 }
520
521 static DEVICE_ATTR_WO(probe);
522 #endif
523
524 #ifdef CONFIG_MEMORY_FAILURE
525 /*
526  * Support for offlining pages of memory
527  */
528
529 /* Soft offline a page */
530 static ssize_t soft_offline_page_store(struct device *dev,
531                                        struct device_attribute *attr,
532                                        const char *buf, size_t count)
533 {
534         int ret;
535         u64 pfn;
536         if (!capable(CAP_SYS_ADMIN))
537                 return -EPERM;
538         if (kstrtoull(buf, 0, &pfn) < 0)
539                 return -EINVAL;
540         pfn >>= PAGE_SHIFT;
541         if (!pfn_valid(pfn))
542                 return -ENXIO;
543         ret = soft_offline_page(pfn_to_page(pfn), 0);
544         return ret == 0 ? count : ret;
545 }
546
547 /* Forcibly offline a page, including killing processes. */
548 static ssize_t hard_offline_page_store(struct device *dev,
549                                        struct device_attribute *attr,
550                                        const char *buf, size_t count)
551 {
552         int ret;
553         u64 pfn;
554         if (!capable(CAP_SYS_ADMIN))
555                 return -EPERM;
556         if (kstrtoull(buf, 0, &pfn) < 0)
557                 return -EINVAL;
558         pfn >>= PAGE_SHIFT;
559         ret = memory_failure(pfn, 0);
560         return ret ? ret : count;
561 }
562
563 static DEVICE_ATTR_WO(soft_offline_page);
564 static DEVICE_ATTR_WO(hard_offline_page);
565 #endif
566
567 /*
568  * Note that phys_device is optional.  It is here to allow for
569  * differentiation between which *physical* devices each
570  * section belongs to...
571  */
572 int __weak arch_get_memory_phys_device(unsigned long start_pfn)
573 {
574         return 0;
575 }
576
577 /* A reference for the returned memory block device is acquired. */
578 static struct memory_block *find_memory_block_by_id(unsigned long block_id)
579 {
580         struct device *dev;
581
582         dev = subsys_find_device_by_id(&memory_subsys, block_id, NULL);
583         return dev ? to_memory_block(dev) : NULL;
584 }
585
586 /*
587  * For now, we have a linear search to go find the appropriate
588  * memory_block corresponding to a particular phys_index. If
589  * this gets to be a real problem, we can always use a radix
590  * tree or something here.
591  *
592  * This could be made generic for all device subsystems.
593  */
594 struct memory_block *find_memory_block(struct mem_section *section)
595 {
596         unsigned long block_id = base_memory_block_id(__section_nr(section));
597
598         return find_memory_block_by_id(block_id);
599 }
600
601 static struct attribute *memory_memblk_attrs[] = {
602         &dev_attr_phys_index.attr,
603         &dev_attr_state.attr,
604         &dev_attr_phys_device.attr,
605         &dev_attr_removable.attr,
606 #ifdef CONFIG_MEMORY_HOTREMOVE
607         &dev_attr_valid_zones.attr,
608 #endif
609         NULL
610 };
611
612 static struct attribute_group memory_memblk_attr_group = {
613         .attrs = memory_memblk_attrs,
614 };
615
616 static const struct attribute_group *memory_memblk_attr_groups[] = {
617         &memory_memblk_attr_group,
618         NULL,
619 };
620
621 /*
622  * register_memory - Setup a sysfs device for a memory block
623  */
624 static
625 int register_memory(struct memory_block *memory)
626 {
627         int ret;
628
629         memory->dev.bus = &memory_subsys;
630         memory->dev.id = memory->start_section_nr / sections_per_block;
631         memory->dev.release = memory_block_release;
632         memory->dev.groups = memory_memblk_attr_groups;
633         memory->dev.offline = memory->state == MEM_OFFLINE;
634
635         ret = device_register(&memory->dev);
636         if (ret)
637                 put_device(&memory->dev);
638
639         return ret;
640 }
641
642 static int init_memory_block(struct memory_block **memory,
643                              unsigned long block_id, unsigned long state)
644 {
645         struct memory_block *mem;
646         unsigned long start_pfn;
647         int ret = 0;
648
649         mem = find_memory_block_by_id(block_id);
650         if (mem) {
651                 put_device(&mem->dev);
652                 return -EEXIST;
653         }
654         mem = kzalloc(sizeof(*mem), GFP_KERNEL);
655         if (!mem)
656                 return -ENOMEM;
657
658         mem->start_section_nr = block_id * sections_per_block;
659         mem->end_section_nr = mem->start_section_nr + sections_per_block - 1;
660         mem->state = state;
661         start_pfn = section_nr_to_pfn(mem->start_section_nr);
662         mem->phys_device = arch_get_memory_phys_device(start_pfn);
663         mem->nid = NUMA_NO_NODE;
664
665         ret = register_memory(mem);
666
667         *memory = mem;
668         return ret;
669 }
670
671 static int add_memory_block(unsigned long base_section_nr)
672 {
673         int ret, section_count = 0;
674         struct memory_block *mem;
675         unsigned long nr;
676
677         for (nr = base_section_nr; nr < base_section_nr + sections_per_block;
678              nr++)
679                 if (present_section_nr(nr))
680                         section_count++;
681
682         if (section_count == 0)
683                 return 0;
684         ret = init_memory_block(&mem, base_memory_block_id(base_section_nr),
685                                 MEM_ONLINE);
686         if (ret)
687                 return ret;
688         mem->section_count = section_count;
689         return 0;
690 }
691
692 static void unregister_memory(struct memory_block *memory)
693 {
694         if (WARN_ON_ONCE(memory->dev.bus != &memory_subsys))
695                 return;
696
697         /* drop the ref. we got via find_memory_block() */
698         put_device(&memory->dev);
699         device_unregister(&memory->dev);
700 }
701
702 /*
703  * Create memory block devices for the given memory area. Start and size
704  * have to be aligned to memory block granularity. Memory block devices
705  * will be initialized as offline.
706  */
707 int create_memory_block_devices(unsigned long start, unsigned long size)
708 {
709         const unsigned long start_block_id = pfn_to_block_id(PFN_DOWN(start));
710         unsigned long end_block_id = pfn_to_block_id(PFN_DOWN(start + size));
711         struct memory_block *mem;
712         unsigned long block_id;
713         int ret = 0;
714
715         if (WARN_ON_ONCE(!IS_ALIGNED(start, memory_block_size_bytes()) ||
716                          !IS_ALIGNED(size, memory_block_size_bytes())))
717                 return -EINVAL;
718
719         mutex_lock(&mem_sysfs_mutex);
720         for (block_id = start_block_id; block_id != end_block_id; block_id++) {
721                 ret = init_memory_block(&mem, block_id, MEM_OFFLINE);
722                 if (ret)
723                         break;
724                 mem->section_count = sections_per_block;
725         }
726         if (ret) {
727                 end_block_id = block_id;
728                 for (block_id = start_block_id; block_id != end_block_id;
729                      block_id++) {
730                         mem = find_memory_block_by_id(block_id);
731                         mem->section_count = 0;
732                         unregister_memory(mem);
733                 }
734         }
735         mutex_unlock(&mem_sysfs_mutex);
736         return ret;
737 }
738
739 /*
740  * Remove memory block devices for the given memory area. Start and size
741  * have to be aligned to memory block granularity. Memory block devices
742  * have to be offline.
743  */
744 void remove_memory_block_devices(unsigned long start, unsigned long size)
745 {
746         const unsigned long start_block_id = pfn_to_block_id(PFN_DOWN(start));
747         const unsigned long end_block_id = pfn_to_block_id(PFN_DOWN(start + size));
748         struct memory_block *mem;
749         unsigned long block_id;
750
751         if (WARN_ON_ONCE(!IS_ALIGNED(start, memory_block_size_bytes()) ||
752                          !IS_ALIGNED(size, memory_block_size_bytes())))
753                 return;
754
755         mutex_lock(&mem_sysfs_mutex);
756         for (block_id = start_block_id; block_id != end_block_id; block_id++) {
757                 mem = find_memory_block_by_id(block_id);
758                 if (WARN_ON_ONCE(!mem))
759                         continue;
760                 mem->section_count = 0;
761                 unregister_memory_block_under_nodes(mem);
762                 unregister_memory(mem);
763         }
764         mutex_unlock(&mem_sysfs_mutex);
765 }
766
767 /* return true if the memory block is offlined, otherwise, return false */
768 bool is_memblock_offlined(struct memory_block *mem)
769 {
770         return mem->state == MEM_OFFLINE;
771 }
772
773 static struct attribute *memory_root_attrs[] = {
774 #ifdef CONFIG_ARCH_MEMORY_PROBE
775         &dev_attr_probe.attr,
776 #endif
777
778 #ifdef CONFIG_MEMORY_FAILURE
779         &dev_attr_soft_offline_page.attr,
780         &dev_attr_hard_offline_page.attr,
781 #endif
782
783         &dev_attr_block_size_bytes.attr,
784         &dev_attr_auto_online_blocks.attr,
785         NULL
786 };
787
788 static struct attribute_group memory_root_attr_group = {
789         .attrs = memory_root_attrs,
790 };
791
792 static const struct attribute_group *memory_root_attr_groups[] = {
793         &memory_root_attr_group,
794         NULL,
795 };
796
797 /*
798  * Initialize the sysfs support for memory devices...
799  */
800 void __init memory_dev_init(void)
801 {
802         int ret;
803         int err;
804         unsigned long block_sz, nr;
805
806         /* Validate the configured memory block size */
807         block_sz = memory_block_size_bytes();
808         if (!is_power_of_2(block_sz) || block_sz < MIN_MEMORY_BLOCK_SIZE)
809                 panic("Memory block size not suitable: 0x%lx\n", block_sz);
810         sections_per_block = block_sz / MIN_MEMORY_BLOCK_SIZE;
811
812         ret = subsys_system_register(&memory_subsys, memory_root_attr_groups);
813         if (ret)
814                 goto out;
815
816         /*
817          * Create entries for memory sections that were found
818          * during boot and have been initialized
819          */
820         mutex_lock(&mem_sysfs_mutex);
821         for (nr = 0; nr <= __highest_present_section_nr;
822              nr += sections_per_block) {
823                 err = add_memory_block(nr);
824                 if (!ret)
825                         ret = err;
826         }
827         mutex_unlock(&mem_sysfs_mutex);
828
829 out:
830         if (ret)
831                 panic("%s() failed: %d\n", __func__, ret);
832 }
833
834 /**
835  * walk_memory_blocks - walk through all present memory blocks overlapped
836  *                      by the range [start, start + size)
837  *
838  * @start: start address of the memory range
839  * @size: size of the memory range
840  * @arg: argument passed to func
841  * @func: callback for each memory section walked
842  *
843  * This function walks through all present memory blocks overlapped by the
844  * range [start, start + size), calling func on each memory block.
845  *
846  * In case func() returns an error, walking is aborted and the error is
847  * returned.
848  */
849 int walk_memory_blocks(unsigned long start, unsigned long size,
850                        void *arg, walk_memory_blocks_func_t func)
851 {
852         const unsigned long start_block_id = phys_to_block_id(start);
853         const unsigned long end_block_id = phys_to_block_id(start + size - 1);
854         struct memory_block *mem;
855         unsigned long block_id;
856         int ret = 0;
857
858         if (!size)
859                 return 0;
860
861         for (block_id = start_block_id; block_id <= end_block_id; block_id++) {
862                 mem = find_memory_block_by_id(block_id);
863                 if (!mem)
864                         continue;
865
866                 ret = func(mem, arg);
867                 put_device(&mem->dev);
868                 if (ret)
869                         break;
870         }
871         return ret;
872 }