xref: /openbmc/linux/arch/powerpc/platforms/pseries/cmm.c (revision 287b89773d8172df049f0f4c27946b2ae4ac4b41)
11a59d1b8SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
284af458bSBrian King /*
384af458bSBrian King  * Collaborative memory management interface.
484af458bSBrian King  *
584af458bSBrian King  * Copyright (C) 2008 IBM Corporation
684af458bSBrian King  * Author(s): Brian King (brking@linux.vnet.ibm.com),
784af458bSBrian King  */
884af458bSBrian King 
984af458bSBrian King #include <linux/ctype.h>
1084af458bSBrian King #include <linux/delay.h>
1184af458bSBrian King #include <linux/errno.h>
1284af458bSBrian King #include <linux/fs.h>
135a0e3ad6STejun Heo #include <linux/gfp.h>
1484af458bSBrian King #include <linux/kthread.h>
1584af458bSBrian King #include <linux/module.h>
1684af458bSBrian King #include <linux/oom.h>
17fecba962SBrian King #include <linux/reboot.h>
1884af458bSBrian King #include <linux/sched.h>
1984af458bSBrian King #include <linux/stringify.h>
2084af458bSBrian King #include <linux/swap.h>
216c9d2909SKay Sievers #include <linux/device.h>
2284af458bSBrian King #include <asm/firmware.h>
2384af458bSBrian King #include <asm/hvcall.h>
2484af458bSBrian King #include <asm/mmu.h>
2584af458bSBrian King #include <asm/pgalloc.h>
267c0f6ba6SLinus Torvalds #include <linux/uaccess.h>
2714b8a76bSRobert Jennings #include <linux/memory.h>
28212bebb4SDeepthi Dharwar #include <asm/plpar_wrappers.h>
2984af458bSBrian King 
308f272a5dSMichael Ellerman #include "pseries.h"
318f272a5dSMichael Ellerman 
3284af458bSBrian King #define CMM_DRIVER_VERSION	"1.0.0"
3384af458bSBrian King #define CMM_DEFAULT_DELAY	1
3414b8a76bSRobert Jennings #define CMM_HOTPLUG_DELAY	5
3584af458bSBrian King #define CMM_DEBUG			0
3684af458bSBrian King #define CMM_DISABLE		0
3784af458bSBrian King #define CMM_OOM_KB		1024
3884af458bSBrian King #define CMM_MIN_MEM_MB		256
3984af458bSBrian King #define KB2PAGES(_p)		((_p)>>(PAGE_SHIFT-10))
4084af458bSBrian King #define PAGES2KB(_p)		((_p)<<(PAGE_SHIFT-10))
4114b8a76bSRobert Jennings /*
4214b8a76bSRobert Jennings  * The priority level tries to ensure that this notifier is called as
4314b8a76bSRobert Jennings  * late as possible to reduce thrashing in the shared memory pool.
4414b8a76bSRobert Jennings  */
4514b8a76bSRobert Jennings #define CMM_MEM_HOTPLUG_PRI	1
4614b8a76bSRobert Jennings #define CMM_MEM_ISOLATE_PRI	15
4784af458bSBrian King 
4884af458bSBrian King static unsigned int delay = CMM_DEFAULT_DELAY;
4914b8a76bSRobert Jennings static unsigned int hotplug_delay = CMM_HOTPLUG_DELAY;
5084af458bSBrian King static unsigned int oom_kb = CMM_OOM_KB;
5184af458bSBrian King static unsigned int cmm_debug = CMM_DEBUG;
5284af458bSBrian King static unsigned int cmm_disabled = CMM_DISABLE;
5384af458bSBrian King static unsigned long min_mem_mb = CMM_MIN_MEM_MB;
546c9d2909SKay Sievers static struct device cmm_dev;
5584af458bSBrian King 
5684af458bSBrian King MODULE_AUTHOR("Brian King <brking@linux.vnet.ibm.com>");
5784af458bSBrian King MODULE_DESCRIPTION("IBM System p Collaborative Memory Manager");
5884af458bSBrian King MODULE_LICENSE("GPL");
5984af458bSBrian King MODULE_VERSION(CMM_DRIVER_VERSION);
6084af458bSBrian King 
6157ad583fSRussell Currey module_param_named(delay, delay, uint, 0644);
6284af458bSBrian King MODULE_PARM_DESC(delay, "Delay (in seconds) between polls to query hypervisor paging requests. "
6384af458bSBrian King 		 "[Default=" __stringify(CMM_DEFAULT_DELAY) "]");
6457ad583fSRussell Currey module_param_named(hotplug_delay, hotplug_delay, uint, 0644);
65b0b5a765SWei Yongjun MODULE_PARM_DESC(hotplug_delay, "Delay (in seconds) after memory hotplug remove "
6614b8a76bSRobert Jennings 		 "before loaning resumes. "
6714b8a76bSRobert Jennings 		 "[Default=" __stringify(CMM_HOTPLUG_DELAY) "]");
6857ad583fSRussell Currey module_param_named(oom_kb, oom_kb, uint, 0644);
6984af458bSBrian King MODULE_PARM_DESC(oom_kb, "Amount of memory in kb to free on OOM. "
7084af458bSBrian King 		 "[Default=" __stringify(CMM_OOM_KB) "]");
7157ad583fSRussell Currey module_param_named(min_mem_mb, min_mem_mb, ulong, 0644);
7284af458bSBrian King MODULE_PARM_DESC(min_mem_mb, "Minimum amount of memory (in MB) to not balloon. "
7384af458bSBrian King 		 "[Default=" __stringify(CMM_MIN_MEM_MB) "]");
7457ad583fSRussell Currey module_param_named(debug, cmm_debug, uint, 0644);
7584af458bSBrian King MODULE_PARM_DESC(debug, "Enable module debugging logging. Set to 1 to enable. "
7684af458bSBrian King 		 "[Default=" __stringify(CMM_DEBUG) "]");
7784af458bSBrian King 
7884af458bSBrian King #define cmm_dbg(...) if (cmm_debug) { printk(KERN_INFO "cmm: "__VA_ARGS__); }
7984af458bSBrian King 
8084af458bSBrian King static unsigned long loaned_pages;
8184af458bSBrian King static unsigned long loaned_pages_target;
8284af458bSBrian King static unsigned long oom_freed_pages;
8384af458bSBrian King 
844a1745c5SDavid Hildenbrand static LIST_HEAD(cmm_page_list);
8584af458bSBrian King static DEFINE_SPINLOCK(cmm_lock);
8684af458bSBrian King 
8714b8a76bSRobert Jennings static DEFINE_MUTEX(hotplug_mutex);
8814b8a76bSRobert Jennings static int hotplug_occurred; /* protected by the hotplug mutex */
8914b8a76bSRobert Jennings 
9084af458bSBrian King static struct task_struct *cmm_thread_ptr;
9184af458bSBrian King 
924a1745c5SDavid Hildenbrand static long plpar_page_set_loaned(struct page *page)
938f272a5dSMichael Ellerman {
944a1745c5SDavid Hildenbrand 	const unsigned long vpa = page_to_phys(page);
958f272a5dSMichael Ellerman 	unsigned long cmo_page_sz = cmo_get_page_size();
968f272a5dSMichael Ellerman 	long rc = 0;
978f272a5dSMichael Ellerman 	int i;
988f272a5dSMichael Ellerman 
998f272a5dSMichael Ellerman 	for (i = 0; !rc && i < PAGE_SIZE; i += cmo_page_sz)
1008f272a5dSMichael Ellerman 		rc = plpar_hcall_norets(H_PAGE_INIT, H_PAGE_SET_LOANED, vpa + i, 0);
1018f272a5dSMichael Ellerman 
1028f272a5dSMichael Ellerman 	for (i -= cmo_page_sz; rc && i != 0; i -= cmo_page_sz)
1038f272a5dSMichael Ellerman 		plpar_hcall_norets(H_PAGE_INIT, H_PAGE_SET_ACTIVE,
1048f272a5dSMichael Ellerman 				   vpa + i - cmo_page_sz, 0);
1058f272a5dSMichael Ellerman 
1068f272a5dSMichael Ellerman 	return rc;
1078f272a5dSMichael Ellerman }
1088f272a5dSMichael Ellerman 
1094a1745c5SDavid Hildenbrand static long plpar_page_set_active(struct page *page)
1108f272a5dSMichael Ellerman {
1114a1745c5SDavid Hildenbrand 	const unsigned long vpa = page_to_phys(page);
1128f272a5dSMichael Ellerman 	unsigned long cmo_page_sz = cmo_get_page_size();
1138f272a5dSMichael Ellerman 	long rc = 0;
1148f272a5dSMichael Ellerman 	int i;
1158f272a5dSMichael Ellerman 
1168f272a5dSMichael Ellerman 	for (i = 0; !rc && i < PAGE_SIZE; i += cmo_page_sz)
1178f272a5dSMichael Ellerman 		rc = plpar_hcall_norets(H_PAGE_INIT, H_PAGE_SET_ACTIVE, vpa + i, 0);
1188f272a5dSMichael Ellerman 
1198f272a5dSMichael Ellerman 	for (i -= cmo_page_sz; rc && i != 0; i -= cmo_page_sz)
1208f272a5dSMichael Ellerman 		plpar_hcall_norets(H_PAGE_INIT, H_PAGE_SET_LOANED,
1218f272a5dSMichael Ellerman 				   vpa + i - cmo_page_sz, 0);
1228f272a5dSMichael Ellerman 
1238f272a5dSMichael Ellerman 	return rc;
1248f272a5dSMichael Ellerman }
1258f272a5dSMichael Ellerman 
12684af458bSBrian King /**
12784af458bSBrian King  * cmm_alloc_pages - Allocate pages and mark them as loaned
12884af458bSBrian King  * @nr:	number of pages to allocate
12984af458bSBrian King  *
13084af458bSBrian King  * Return value:
13184af458bSBrian King  * 	number of pages requested to be allocated which were not
13284af458bSBrian King  **/
13384af458bSBrian King static long cmm_alloc_pages(long nr)
13484af458bSBrian King {
1354a1745c5SDavid Hildenbrand 	struct page *page;
13684af458bSBrian King 	long rc;
13784af458bSBrian King 
13884af458bSBrian King 	cmm_dbg("Begin request for %ld pages\n", nr);
13984af458bSBrian King 
14084af458bSBrian King 	while (nr) {
14114b8a76bSRobert Jennings 		/* Exit if a hotplug operation is in progress or occurred */
14214b8a76bSRobert Jennings 		if (mutex_trylock(&hotplug_mutex)) {
14314b8a76bSRobert Jennings 			if (hotplug_occurred) {
14414b8a76bSRobert Jennings 				mutex_unlock(&hotplug_mutex);
14514b8a76bSRobert Jennings 				break;
14614b8a76bSRobert Jennings 			}
14714b8a76bSRobert Jennings 			mutex_unlock(&hotplug_mutex);
14814b8a76bSRobert Jennings 		} else {
14914b8a76bSRobert Jennings 			break;
15014b8a76bSRobert Jennings 		}
15114b8a76bSRobert Jennings 
1524a1745c5SDavid Hildenbrand 		page = alloc_page(GFP_NOIO | __GFP_NOWARN | __GFP_NORETRY |
1534a1745c5SDavid Hildenbrand 				  __GFP_NOMEMALLOC);
1544a1745c5SDavid Hildenbrand 		if (!page)
15584af458bSBrian King 			break;
15684af458bSBrian King 		spin_lock(&cmm_lock);
1574a1745c5SDavid Hildenbrand 		rc = plpar_page_set_loaned(page);
1584a1745c5SDavid Hildenbrand 		if (rc) {
1595df72bf3SHarvey Harrison 			pr_err("%s: Can not set page to loaned. rc=%ld\n", __func__, rc);
16084af458bSBrian King 			spin_unlock(&cmm_lock);
1614a1745c5SDavid Hildenbrand 			__free_page(page);
16284af458bSBrian King 			break;
16384af458bSBrian King 		}
16484af458bSBrian King 
1654a1745c5SDavid Hildenbrand 		list_add(&page->lru, &cmm_page_list);
16684af458bSBrian King 		loaned_pages++;
167*287b8977SDavid Hildenbrand 		adjust_managed_page_count(page, -1);
16884af458bSBrian King 		spin_unlock(&cmm_lock);
16984af458bSBrian King 		nr--;
17084af458bSBrian King 	}
17184af458bSBrian King 
17284af458bSBrian King 	cmm_dbg("End request with %ld pages unfulfilled\n", nr);
17384af458bSBrian King 	return nr;
17484af458bSBrian King }
17584af458bSBrian King 
17684af458bSBrian King /**
17784af458bSBrian King  * cmm_free_pages - Free pages and mark them as active
17884af458bSBrian King  * @nr:	number of pages to free
17984af458bSBrian King  *
18084af458bSBrian King  * Return value:
18184af458bSBrian King  * 	number of pages requested to be freed which were not
18284af458bSBrian King  **/
18384af458bSBrian King static long cmm_free_pages(long nr)
18484af458bSBrian King {
1854a1745c5SDavid Hildenbrand 	struct page *page, *tmp;
18684af458bSBrian King 
18784af458bSBrian King 	cmm_dbg("Begin free of %ld pages.\n", nr);
18884af458bSBrian King 	spin_lock(&cmm_lock);
1894a1745c5SDavid Hildenbrand 	list_for_each_entry_safe(page, tmp, &cmm_page_list, lru) {
1904a1745c5SDavid Hildenbrand 		if (!nr)
19184af458bSBrian King 			break;
1924a1745c5SDavid Hildenbrand 		plpar_page_set_active(page);
1934a1745c5SDavid Hildenbrand 		list_del(&page->lru);
194*287b8977SDavid Hildenbrand 		adjust_managed_page_count(page, 1);
1954a1745c5SDavid Hildenbrand 		__free_page(page);
19684af458bSBrian King 		loaned_pages--;
19784af458bSBrian King 		nr--;
19884af458bSBrian King 	}
19984af458bSBrian King 	spin_unlock(&cmm_lock);
20084af458bSBrian King 	cmm_dbg("End request with %ld pages unfulfilled\n", nr);
20184af458bSBrian King 	return nr;
20284af458bSBrian King }
20384af458bSBrian King 
20484af458bSBrian King /**
20584af458bSBrian King  * cmm_oom_notify - OOM notifier
20684af458bSBrian King  * @self:	notifier block struct
20784af458bSBrian King  * @dummy:	not used
20884af458bSBrian King  * @parm:	returned - number of pages freed
20984af458bSBrian King  *
21084af458bSBrian King  * Return value:
21184af458bSBrian King  * 	NOTIFY_OK
21284af458bSBrian King  **/
21384af458bSBrian King static int cmm_oom_notify(struct notifier_block *self,
21484af458bSBrian King 			  unsigned long dummy, void *parm)
21584af458bSBrian King {
21684af458bSBrian King 	unsigned long *freed = parm;
21784af458bSBrian King 	long nr = KB2PAGES(oom_kb);
21884af458bSBrian King 
21984af458bSBrian King 	cmm_dbg("OOM processing started\n");
22084af458bSBrian King 	nr = cmm_free_pages(nr);
22184af458bSBrian King 	loaned_pages_target = loaned_pages;
22284af458bSBrian King 	*freed += KB2PAGES(oom_kb) - nr;
22384af458bSBrian King 	oom_freed_pages += KB2PAGES(oom_kb) - nr;
22484af458bSBrian King 	cmm_dbg("OOM processing complete\n");
22584af458bSBrian King 	return NOTIFY_OK;
22684af458bSBrian King }
22784af458bSBrian King 
22884af458bSBrian King /**
22984af458bSBrian King  * cmm_get_mpp - Read memory performance parameters
23084af458bSBrian King  *
23184af458bSBrian King  * Makes hcall to query the current page loan request from the hypervisor.
23284af458bSBrian King  *
23384af458bSBrian King  * Return value:
23484af458bSBrian King  * 	nothing
23584af458bSBrian King  **/
23684af458bSBrian King static void cmm_get_mpp(void)
23784af458bSBrian King {
23884af458bSBrian King 	int rc;
23984af458bSBrian King 	struct hvcall_mpp_data mpp_data;
2408be8cf5bSBrian King 	signed long active_pages_target, page_loan_request, target;
241ca79b0c2SArun KS 	signed long total_pages = totalram_pages() + loaned_pages;
2428be8cf5bSBrian King 	signed long min_mem_pages = (min_mem_mb * 1024 * 1024) / PAGE_SIZE;
24384af458bSBrian King 
24484af458bSBrian King 	rc = h_get_mpp(&mpp_data);
24584af458bSBrian King 
24684af458bSBrian King 	if (rc != H_SUCCESS)
24784af458bSBrian King 		return;
24884af458bSBrian King 
24984af458bSBrian King 	page_loan_request = div_s64((s64)mpp_data.loan_request, PAGE_SIZE);
2508be8cf5bSBrian King 	target = page_loan_request + (signed long)loaned_pages;
2518be8cf5bSBrian King 
2528be8cf5bSBrian King 	if (target < 0 || total_pages < min_mem_pages)
2538be8cf5bSBrian King 		target = 0;
2548be8cf5bSBrian King 
2558be8cf5bSBrian King 	if (target > oom_freed_pages)
2568be8cf5bSBrian King 		target -= oom_freed_pages;
25784af458bSBrian King 	else
2588be8cf5bSBrian King 		target = 0;
25984af458bSBrian King 
2608be8cf5bSBrian King 	active_pages_target = total_pages - target;
26184af458bSBrian King 
2628be8cf5bSBrian King 	if (min_mem_pages > active_pages_target)
2638be8cf5bSBrian King 		target = total_pages - min_mem_pages;
2648be8cf5bSBrian King 
2658be8cf5bSBrian King 	if (target < 0)
2668be8cf5bSBrian King 		target = 0;
2678be8cf5bSBrian King 
2688be8cf5bSBrian King 	loaned_pages_target = target;
26984af458bSBrian King 
27084af458bSBrian King 	cmm_dbg("delta = %ld, loaned = %lu, target = %lu, oom = %lu, totalram = %lu\n",
27184af458bSBrian King 		page_loan_request, loaned_pages, loaned_pages_target,
272ca79b0c2SArun KS 		oom_freed_pages, totalram_pages());
27384af458bSBrian King }
27484af458bSBrian King 
27584af458bSBrian King static struct notifier_block cmm_oom_nb = {
27684af458bSBrian King 	.notifier_call = cmm_oom_notify
27784af458bSBrian King };
27884af458bSBrian King 
27984af458bSBrian King /**
28084af458bSBrian King  * cmm_thread - CMM task thread
28184af458bSBrian King  * @dummy:	not used
28284af458bSBrian King  *
28384af458bSBrian King  * Return value:
28484af458bSBrian King  * 	0
28584af458bSBrian King  **/
28684af458bSBrian King static int cmm_thread(void *dummy)
28784af458bSBrian King {
28884af458bSBrian King 	unsigned long timeleft;
28984af458bSBrian King 
29084af458bSBrian King 	while (1) {
29184af458bSBrian King 		timeleft = msleep_interruptible(delay * 1000);
29284af458bSBrian King 
29314b8a76bSRobert Jennings 		if (kthread_should_stop() || timeleft)
29484af458bSBrian King 			break;
29514b8a76bSRobert Jennings 
29614b8a76bSRobert Jennings 		if (mutex_trylock(&hotplug_mutex)) {
29714b8a76bSRobert Jennings 			if (hotplug_occurred) {
29814b8a76bSRobert Jennings 				hotplug_occurred = 0;
29914b8a76bSRobert Jennings 				mutex_unlock(&hotplug_mutex);
30014b8a76bSRobert Jennings 				cmm_dbg("Hotplug operation has occurred, "
30114b8a76bSRobert Jennings 						"loaning activity suspended "
30214b8a76bSRobert Jennings 						"for %d seconds.\n",
30314b8a76bSRobert Jennings 						hotplug_delay);
30414b8a76bSRobert Jennings 				timeleft = msleep_interruptible(hotplug_delay *
30514b8a76bSRobert Jennings 						1000);
30614b8a76bSRobert Jennings 				if (kthread_should_stop() || timeleft)
30714b8a76bSRobert Jennings 					break;
30814b8a76bSRobert Jennings 				continue;
30914b8a76bSRobert Jennings 			}
31014b8a76bSRobert Jennings 			mutex_unlock(&hotplug_mutex);
31114b8a76bSRobert Jennings 		} else {
31214b8a76bSRobert Jennings 			cmm_dbg("Hotplug operation in progress, activity "
31314b8a76bSRobert Jennings 					"suspended\n");
31414b8a76bSRobert Jennings 			continue;
31584af458bSBrian King 		}
31684af458bSBrian King 
31784af458bSBrian King 		cmm_get_mpp();
31884af458bSBrian King 
31984af458bSBrian King 		if (loaned_pages_target > loaned_pages) {
32084af458bSBrian King 			if (cmm_alloc_pages(loaned_pages_target - loaned_pages))
32184af458bSBrian King 				loaned_pages_target = loaned_pages;
32284af458bSBrian King 		} else if (loaned_pages_target < loaned_pages)
32384af458bSBrian King 			cmm_free_pages(loaned_pages - loaned_pages_target);
32484af458bSBrian King 	}
32584af458bSBrian King 	return 0;
32684af458bSBrian King }
32784af458bSBrian King 
32884af458bSBrian King #define CMM_SHOW(name, format, args...)			\
3296c9d2909SKay Sievers 	static ssize_t show_##name(struct device *dev,	\
3306c9d2909SKay Sievers 				   struct device_attribute *attr,	\
3313cee67f7SStephen Rothwell 				   char *buf)			\
33284af458bSBrian King 	{							\
33384af458bSBrian King 		return sprintf(buf, format, ##args);		\
33484af458bSBrian King 	}							\
33557ad583fSRussell Currey 	static DEVICE_ATTR(name, 0444, show_##name, NULL)
33684af458bSBrian King 
33784af458bSBrian King CMM_SHOW(loaned_kb, "%lu\n", PAGES2KB(loaned_pages));
33884af458bSBrian King CMM_SHOW(loaned_target_kb, "%lu\n", PAGES2KB(loaned_pages_target));
33984af458bSBrian King 
3406c9d2909SKay Sievers static ssize_t show_oom_pages(struct device *dev,
3416c9d2909SKay Sievers 			      struct device_attribute *attr, char *buf)
34284af458bSBrian King {
34384af458bSBrian King 	return sprintf(buf, "%lu\n", PAGES2KB(oom_freed_pages));
34484af458bSBrian King }
34584af458bSBrian King 
3466c9d2909SKay Sievers static ssize_t store_oom_pages(struct device *dev,
3476c9d2909SKay Sievers 			       struct device_attribute *attr,
34884af458bSBrian King 			       const char *buf, size_t count)
34984af458bSBrian King {
35084af458bSBrian King 	unsigned long val = simple_strtoul (buf, NULL, 10);
35184af458bSBrian King 
35284af458bSBrian King 	if (!capable(CAP_SYS_ADMIN))
35384af458bSBrian King 		return -EPERM;
35484af458bSBrian King 	if (val != 0)
35584af458bSBrian King 		return -EBADMSG;
35684af458bSBrian King 
35784af458bSBrian King 	oom_freed_pages = 0;
35884af458bSBrian King 	return count;
35984af458bSBrian King }
36084af458bSBrian King 
36157ad583fSRussell Currey static DEVICE_ATTR(oom_freed_kb, 0644,
36284af458bSBrian King 		   show_oom_pages, store_oom_pages);
36384af458bSBrian King 
3646c9d2909SKay Sievers static struct device_attribute *cmm_attrs[] = {
3656c9d2909SKay Sievers 	&dev_attr_loaned_kb,
3666c9d2909SKay Sievers 	&dev_attr_loaned_target_kb,
3676c9d2909SKay Sievers 	&dev_attr_oom_freed_kb,
36884af458bSBrian King };
36984af458bSBrian King 
3706c9d2909SKay Sievers static struct bus_type cmm_subsys = {
37184af458bSBrian King 	.name = "cmm",
3726c9d2909SKay Sievers 	.dev_name = "cmm",
37384af458bSBrian King };
37484af458bSBrian King 
3757d821274SDavid Hildenbrand static void cmm_release_device(struct device *dev)
3767d821274SDavid Hildenbrand {
3777d821274SDavid Hildenbrand }
3787d821274SDavid Hildenbrand 
37984af458bSBrian King /**
38084af458bSBrian King  * cmm_sysfs_register - Register with sysfs
38184af458bSBrian King  *
38284af458bSBrian King  * Return value:
38384af458bSBrian King  * 	0 on success / other on failure
38484af458bSBrian King  **/
3856c9d2909SKay Sievers static int cmm_sysfs_register(struct device *dev)
38684af458bSBrian King {
38784af458bSBrian King 	int i, rc;
38884af458bSBrian King 
3896c9d2909SKay Sievers 	if ((rc = subsys_system_register(&cmm_subsys, NULL)))
39084af458bSBrian King 		return rc;
39184af458bSBrian King 
3926c9d2909SKay Sievers 	dev->id = 0;
3936c9d2909SKay Sievers 	dev->bus = &cmm_subsys;
3947d821274SDavid Hildenbrand 	dev->release = cmm_release_device;
39584af458bSBrian King 
3966c9d2909SKay Sievers 	if ((rc = device_register(dev)))
3976c9d2909SKay Sievers 		goto subsys_unregister;
39884af458bSBrian King 
39984af458bSBrian King 	for (i = 0; i < ARRAY_SIZE(cmm_attrs); i++) {
4006c9d2909SKay Sievers 		if ((rc = device_create_file(dev, cmm_attrs[i])))
40184af458bSBrian King 			goto fail;
40284af458bSBrian King 	}
40384af458bSBrian King 
40484af458bSBrian King 	return 0;
40584af458bSBrian King 
40684af458bSBrian King fail:
40784af458bSBrian King 	while (--i >= 0)
4086c9d2909SKay Sievers 		device_remove_file(dev, cmm_attrs[i]);
4096c9d2909SKay Sievers 	device_unregister(dev);
4106c9d2909SKay Sievers subsys_unregister:
4116c9d2909SKay Sievers 	bus_unregister(&cmm_subsys);
41284af458bSBrian King 	return rc;
41384af458bSBrian King }
41484af458bSBrian King 
41584af458bSBrian King /**
41684af458bSBrian King  * cmm_unregister_sysfs - Unregister from sysfs
41784af458bSBrian King  *
41884af458bSBrian King  **/
4196c9d2909SKay Sievers static void cmm_unregister_sysfs(struct device *dev)
42084af458bSBrian King {
42184af458bSBrian King 	int i;
42284af458bSBrian King 
42384af458bSBrian King 	for (i = 0; i < ARRAY_SIZE(cmm_attrs); i++)
4246c9d2909SKay Sievers 		device_remove_file(dev, cmm_attrs[i]);
4256c9d2909SKay Sievers 	device_unregister(dev);
4266c9d2909SKay Sievers 	bus_unregister(&cmm_subsys);
42784af458bSBrian King }
42884af458bSBrian King 
42984af458bSBrian King /**
430fecba962SBrian King  * cmm_reboot_notifier - Make sure pages are not still marked as "loaned"
431fecba962SBrian King  *
432fecba962SBrian King  **/
433fecba962SBrian King static int cmm_reboot_notifier(struct notifier_block *nb,
434fecba962SBrian King 			       unsigned long action, void *unused)
435fecba962SBrian King {
436fecba962SBrian King 	if (action == SYS_RESTART) {
437fecba962SBrian King 		if (cmm_thread_ptr)
438fecba962SBrian King 			kthread_stop(cmm_thread_ptr);
439fecba962SBrian King 		cmm_thread_ptr = NULL;
440fecba962SBrian King 		cmm_free_pages(loaned_pages);
441fecba962SBrian King 	}
442fecba962SBrian King 	return NOTIFY_DONE;
443fecba962SBrian King }
444fecba962SBrian King 
445fecba962SBrian King static struct notifier_block cmm_reboot_nb = {
446fecba962SBrian King 	.notifier_call = cmm_reboot_notifier,
447fecba962SBrian King };
448fecba962SBrian King 
449fecba962SBrian King /**
45014b8a76bSRobert Jennings  * cmm_count_pages - Count the number of pages loaned in a particular range.
45114b8a76bSRobert Jennings  *
45214b8a76bSRobert Jennings  * @arg: memory_isolate_notify structure with address range and count
45314b8a76bSRobert Jennings  *
45414b8a76bSRobert Jennings  * Return value:
45514b8a76bSRobert Jennings  *      0 on success
45614b8a76bSRobert Jennings  **/
45714b8a76bSRobert Jennings static unsigned long cmm_count_pages(void *arg)
45814b8a76bSRobert Jennings {
45914b8a76bSRobert Jennings 	struct memory_isolate_notify *marg = arg;
4604a1745c5SDavid Hildenbrand 	struct page *page;
46114b8a76bSRobert Jennings 
46214b8a76bSRobert Jennings 	spin_lock(&cmm_lock);
4634a1745c5SDavid Hildenbrand 	list_for_each_entry(page, &cmm_page_list, lru) {
4644a1745c5SDavid Hildenbrand 		if (page_to_pfn(page) >= marg->start_pfn &&
4654a1745c5SDavid Hildenbrand 		    page_to_pfn(page) < marg->start_pfn + marg->nr_pages)
46614b8a76bSRobert Jennings 			marg->pages_found++;
46714b8a76bSRobert Jennings 	}
46814b8a76bSRobert Jennings 	spin_unlock(&cmm_lock);
46914b8a76bSRobert Jennings 	return 0;
47014b8a76bSRobert Jennings }
47114b8a76bSRobert Jennings 
47214b8a76bSRobert Jennings /**
47314b8a76bSRobert Jennings  * cmm_memory_isolate_cb - Handle memory isolation notifier calls
47414b8a76bSRobert Jennings  * @self:	notifier block struct
47514b8a76bSRobert Jennings  * @action:	action to take
47614b8a76bSRobert Jennings  * @arg:	struct memory_isolate_notify data for handler
47714b8a76bSRobert Jennings  *
47814b8a76bSRobert Jennings  * Return value:
47914b8a76bSRobert Jennings  *	NOTIFY_OK or notifier error based on subfunction return value
48014b8a76bSRobert Jennings  **/
48114b8a76bSRobert Jennings static int cmm_memory_isolate_cb(struct notifier_block *self,
48214b8a76bSRobert Jennings 				 unsigned long action, void *arg)
48314b8a76bSRobert Jennings {
48414b8a76bSRobert Jennings 	int ret = 0;
48514b8a76bSRobert Jennings 
48614b8a76bSRobert Jennings 	if (action == MEM_ISOLATE_COUNT)
48714b8a76bSRobert Jennings 		ret = cmm_count_pages(arg);
48814b8a76bSRobert Jennings 
4897e26065dSPrarit Bhargava 	return notifier_from_errno(ret);
49014b8a76bSRobert Jennings }
49114b8a76bSRobert Jennings 
49214b8a76bSRobert Jennings static struct notifier_block cmm_mem_isolate_nb = {
49314b8a76bSRobert Jennings 	.notifier_call = cmm_memory_isolate_cb,
49414b8a76bSRobert Jennings 	.priority = CMM_MEM_ISOLATE_PRI
49514b8a76bSRobert Jennings };
49614b8a76bSRobert Jennings 
49714b8a76bSRobert Jennings /**
49814b8a76bSRobert Jennings  * cmm_mem_going_offline - Unloan pages where memory is to be removed
49914b8a76bSRobert Jennings  * @arg: memory_notify structure with page range to be offlined
50014b8a76bSRobert Jennings  *
50114b8a76bSRobert Jennings  * Return value:
50214b8a76bSRobert Jennings  *	0 on success
50314b8a76bSRobert Jennings  **/
50414b8a76bSRobert Jennings static int cmm_mem_going_offline(void *arg)
50514b8a76bSRobert Jennings {
50614b8a76bSRobert Jennings 	struct memory_notify *marg = arg;
5074a1745c5SDavid Hildenbrand 	struct page *page, *tmp;
50814b8a76bSRobert Jennings 	unsigned long freed = 0;
50914b8a76bSRobert Jennings 
5104a1745c5SDavid Hildenbrand 	cmm_dbg("Memory going offline, searching PFN 0x%lx (%ld pages).\n",
5114a1745c5SDavid Hildenbrand 		marg->start_pfn, marg->nr_pages);
51214b8a76bSRobert Jennings 	spin_lock(&cmm_lock);
51314b8a76bSRobert Jennings 
51414b8a76bSRobert Jennings 	/* Search the page list for pages in the range to be offlined */
5154a1745c5SDavid Hildenbrand 	list_for_each_entry_safe(page, tmp, &cmm_page_list, lru) {
5164a1745c5SDavid Hildenbrand 		if (page_to_pfn(page) < marg->start_pfn ||
5174a1745c5SDavid Hildenbrand 		    page_to_pfn(page) >= marg->start_pfn + marg->nr_pages)
51814b8a76bSRobert Jennings 			continue;
5194a1745c5SDavid Hildenbrand 		plpar_page_set_active(page);
5204a1745c5SDavid Hildenbrand 		list_del(&page->lru);
521*287b8977SDavid Hildenbrand 		adjust_managed_page_count(page, 1);
5224a1745c5SDavid Hildenbrand 		__free_page(page);
52314b8a76bSRobert Jennings 		freed++;
52414b8a76bSRobert Jennings 		loaned_pages--;
52514b8a76bSRobert Jennings 	}
52614b8a76bSRobert Jennings 
52714b8a76bSRobert Jennings 	spin_unlock(&cmm_lock);
52814b8a76bSRobert Jennings 	cmm_dbg("Released %ld pages in the search range.\n", freed);
52914b8a76bSRobert Jennings 
53014b8a76bSRobert Jennings 	return 0;
53114b8a76bSRobert Jennings }
53214b8a76bSRobert Jennings 
53314b8a76bSRobert Jennings /**
53414b8a76bSRobert Jennings  * cmm_memory_cb - Handle memory hotplug notifier calls
53514b8a76bSRobert Jennings  * @self:	notifier block struct
53614b8a76bSRobert Jennings  * @action:	action to take
53714b8a76bSRobert Jennings  * @arg:	struct memory_notify data for handler
53814b8a76bSRobert Jennings  *
53914b8a76bSRobert Jennings  * Return value:
54014b8a76bSRobert Jennings  *	NOTIFY_OK or notifier error based on subfunction return value
54114b8a76bSRobert Jennings  *
54214b8a76bSRobert Jennings  **/
54314b8a76bSRobert Jennings static int cmm_memory_cb(struct notifier_block *self,
54414b8a76bSRobert Jennings 			unsigned long action, void *arg)
54514b8a76bSRobert Jennings {
54614b8a76bSRobert Jennings 	int ret = 0;
54714b8a76bSRobert Jennings 
54814b8a76bSRobert Jennings 	switch (action) {
54914b8a76bSRobert Jennings 	case MEM_GOING_OFFLINE:
55014b8a76bSRobert Jennings 		mutex_lock(&hotplug_mutex);
55114b8a76bSRobert Jennings 		hotplug_occurred = 1;
55214b8a76bSRobert Jennings 		ret = cmm_mem_going_offline(arg);
55314b8a76bSRobert Jennings 		break;
55414b8a76bSRobert Jennings 	case MEM_OFFLINE:
55514b8a76bSRobert Jennings 	case MEM_CANCEL_OFFLINE:
55614b8a76bSRobert Jennings 		mutex_unlock(&hotplug_mutex);
55714b8a76bSRobert Jennings 		cmm_dbg("Memory offline operation complete.\n");
55814b8a76bSRobert Jennings 		break;
55914b8a76bSRobert Jennings 	case MEM_GOING_ONLINE:
56014b8a76bSRobert Jennings 	case MEM_ONLINE:
56114b8a76bSRobert Jennings 	case MEM_CANCEL_ONLINE:
56214b8a76bSRobert Jennings 		break;
56314b8a76bSRobert Jennings 	}
56414b8a76bSRobert Jennings 
5657e26065dSPrarit Bhargava 	return notifier_from_errno(ret);
56614b8a76bSRobert Jennings }
56714b8a76bSRobert Jennings 
56814b8a76bSRobert Jennings static struct notifier_block cmm_mem_nb = {
56914b8a76bSRobert Jennings 	.notifier_call = cmm_memory_cb,
57014b8a76bSRobert Jennings 	.priority = CMM_MEM_HOTPLUG_PRI
57114b8a76bSRobert Jennings };
57214b8a76bSRobert Jennings 
57314b8a76bSRobert Jennings /**
57484af458bSBrian King  * cmm_init - Module initialization
57584af458bSBrian King  *
57684af458bSBrian King  * Return value:
57784af458bSBrian King  * 	0 on success / other on failure
57884af458bSBrian King  **/
57984af458bSBrian King static int cmm_init(void)
58084af458bSBrian King {
58168f7a049SDavid Hildenbrand 	int rc;
58284af458bSBrian King 
58384af458bSBrian King 	if (!firmware_has_feature(FW_FEATURE_CMO))
58484af458bSBrian King 		return -EOPNOTSUPP;
58584af458bSBrian King 
58684af458bSBrian King 	if ((rc = register_oom_notifier(&cmm_oom_nb)) < 0)
58784af458bSBrian King 		return rc;
58884af458bSBrian King 
589fecba962SBrian King 	if ((rc = register_reboot_notifier(&cmm_reboot_nb)))
59084af458bSBrian King 		goto out_oom_notifier;
59184af458bSBrian King 
5926c9d2909SKay Sievers 	if ((rc = cmm_sysfs_register(&cmm_dev)))
593fecba962SBrian King 		goto out_reboot_notifier;
594fecba962SBrian King 
595022da223SDavid Hildenbrand 	rc = register_memory_notifier(&cmm_mem_nb);
596022da223SDavid Hildenbrand 	if (rc)
597022da223SDavid Hildenbrand 		goto out_unregister_notifier;
598022da223SDavid Hildenbrand 
599022da223SDavid Hildenbrand 	rc = register_memory_isolate_notifier(&cmm_mem_isolate_nb);
600022da223SDavid Hildenbrand 	if (rc)
60114b8a76bSRobert Jennings 		goto out_unregister_notifier;
60214b8a76bSRobert Jennings 
60384af458bSBrian King 	if (cmm_disabled)
60468f7a049SDavid Hildenbrand 		return 0;
60584af458bSBrian King 
60684af458bSBrian King 	cmm_thread_ptr = kthread_run(cmm_thread, NULL, "cmmthread");
60784af458bSBrian King 	if (IS_ERR(cmm_thread_ptr)) {
60884af458bSBrian King 		rc = PTR_ERR(cmm_thread_ptr);
60914b8a76bSRobert Jennings 		goto out_unregister_notifier;
61084af458bSBrian King 	}
61184af458bSBrian King 
61268f7a049SDavid Hildenbrand 	return 0;
61314b8a76bSRobert Jennings out_unregister_notifier:
61414b8a76bSRobert Jennings 	unregister_memory_notifier(&cmm_mem_nb);
61514b8a76bSRobert Jennings 	unregister_memory_isolate_notifier(&cmm_mem_isolate_nb);
6166c9d2909SKay Sievers 	cmm_unregister_sysfs(&cmm_dev);
617fecba962SBrian King out_reboot_notifier:
618fecba962SBrian King 	unregister_reboot_notifier(&cmm_reboot_nb);
61984af458bSBrian King out_oom_notifier:
62084af458bSBrian King 	unregister_oom_notifier(&cmm_oom_nb);
62184af458bSBrian King 	return rc;
62284af458bSBrian King }
62384af458bSBrian King 
62484af458bSBrian King /**
62584af458bSBrian King  * cmm_exit - Module exit
62684af458bSBrian King  *
62784af458bSBrian King  * Return value:
62884af458bSBrian King  * 	nothing
62984af458bSBrian King  **/
63084af458bSBrian King static void cmm_exit(void)
63184af458bSBrian King {
63284af458bSBrian King 	if (cmm_thread_ptr)
63384af458bSBrian King 		kthread_stop(cmm_thread_ptr);
63484af458bSBrian King 	unregister_oom_notifier(&cmm_oom_nb);
635fecba962SBrian King 	unregister_reboot_notifier(&cmm_reboot_nb);
63614b8a76bSRobert Jennings 	unregister_memory_notifier(&cmm_mem_nb);
63714b8a76bSRobert Jennings 	unregister_memory_isolate_notifier(&cmm_mem_isolate_nb);
63884af458bSBrian King 	cmm_free_pages(loaned_pages);
6396c9d2909SKay Sievers 	cmm_unregister_sysfs(&cmm_dev);
64084af458bSBrian King }
64184af458bSBrian King 
64284af458bSBrian King /**
64384af458bSBrian King  * cmm_set_disable - Disable/Enable CMM
64484af458bSBrian King  *
64584af458bSBrian King  * Return value:
64684af458bSBrian King  * 	0 on success / other on failure
64784af458bSBrian King  **/
648e4dca7b7SKees Cook static int cmm_set_disable(const char *val, const struct kernel_param *kp)
64984af458bSBrian King {
65084af458bSBrian King 	int disable = simple_strtoul(val, NULL, 10);
65184af458bSBrian King 
65284af458bSBrian King 	if (disable != 0 && disable != 1)
65384af458bSBrian King 		return -EINVAL;
65484af458bSBrian King 
65584af458bSBrian King 	if (disable && !cmm_disabled) {
65684af458bSBrian King 		if (cmm_thread_ptr)
65784af458bSBrian King 			kthread_stop(cmm_thread_ptr);
65884af458bSBrian King 		cmm_thread_ptr = NULL;
65984af458bSBrian King 		cmm_free_pages(loaned_pages);
66084af458bSBrian King 	} else if (!disable && cmm_disabled) {
66184af458bSBrian King 		cmm_thread_ptr = kthread_run(cmm_thread, NULL, "cmmthread");
66284af458bSBrian King 		if (IS_ERR(cmm_thread_ptr))
66384af458bSBrian King 			return PTR_ERR(cmm_thread_ptr);
66484af458bSBrian King 	}
66584af458bSBrian King 
66684af458bSBrian King 	cmm_disabled = disable;
66784af458bSBrian King 	return 0;
66884af458bSBrian King }
66984af458bSBrian King 
67084af458bSBrian King module_param_call(disable, cmm_set_disable, param_get_uint,
67157ad583fSRussell Currey 		  &cmm_disabled, 0644);
67284af458bSBrian King MODULE_PARM_DESC(disable, "Disable CMM. Set to 1 to disable. "
67384af458bSBrian King 		 "[Default=" __stringify(CMM_DISABLE) "]");
67484af458bSBrian King 
67584af458bSBrian King module_init(cmm_init);
67684af458bSBrian King module_exit(cmm_exit);
677