xref: /openbmc/linux/arch/powerpc/platforms/pseries/cmm.c (revision 7659f5d6448095ef436891c33bdd7c8500620a00)
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))
41*7659f5d6SDavid Hildenbrand 
4214b8a76bSRobert Jennings #define CMM_MEM_HOTPLUG_PRI	1
4384af458bSBrian King 
4484af458bSBrian King static unsigned int delay = CMM_DEFAULT_DELAY;
4514b8a76bSRobert Jennings static unsigned int hotplug_delay = CMM_HOTPLUG_DELAY;
4684af458bSBrian King static unsigned int oom_kb = CMM_OOM_KB;
4784af458bSBrian King static unsigned int cmm_debug = CMM_DEBUG;
4884af458bSBrian King static unsigned int cmm_disabled = CMM_DISABLE;
4984af458bSBrian King static unsigned long min_mem_mb = CMM_MIN_MEM_MB;
506c9d2909SKay Sievers static struct device cmm_dev;
5184af458bSBrian King 
5284af458bSBrian King MODULE_AUTHOR("Brian King <brking@linux.vnet.ibm.com>");
5384af458bSBrian King MODULE_DESCRIPTION("IBM System p Collaborative Memory Manager");
5484af458bSBrian King MODULE_LICENSE("GPL");
5584af458bSBrian King MODULE_VERSION(CMM_DRIVER_VERSION);
5684af458bSBrian King 
5757ad583fSRussell Currey module_param_named(delay, delay, uint, 0644);
5884af458bSBrian King MODULE_PARM_DESC(delay, "Delay (in seconds) between polls to query hypervisor paging requests. "
5984af458bSBrian King 		 "[Default=" __stringify(CMM_DEFAULT_DELAY) "]");
6057ad583fSRussell Currey module_param_named(hotplug_delay, hotplug_delay, uint, 0644);
61b0b5a765SWei Yongjun MODULE_PARM_DESC(hotplug_delay, "Delay (in seconds) after memory hotplug remove "
6214b8a76bSRobert Jennings 		 "before loaning resumes. "
6314b8a76bSRobert Jennings 		 "[Default=" __stringify(CMM_HOTPLUG_DELAY) "]");
6457ad583fSRussell Currey module_param_named(oom_kb, oom_kb, uint, 0644);
6584af458bSBrian King MODULE_PARM_DESC(oom_kb, "Amount of memory in kb to free on OOM. "
6684af458bSBrian King 		 "[Default=" __stringify(CMM_OOM_KB) "]");
6757ad583fSRussell Currey module_param_named(min_mem_mb, min_mem_mb, ulong, 0644);
6884af458bSBrian King MODULE_PARM_DESC(min_mem_mb, "Minimum amount of memory (in MB) to not balloon. "
6984af458bSBrian King 		 "[Default=" __stringify(CMM_MIN_MEM_MB) "]");
7057ad583fSRussell Currey module_param_named(debug, cmm_debug, uint, 0644);
7184af458bSBrian King MODULE_PARM_DESC(debug, "Enable module debugging logging. Set to 1 to enable. "
7284af458bSBrian King 		 "[Default=" __stringify(CMM_DEBUG) "]");
7384af458bSBrian King 
7484af458bSBrian King #define cmm_dbg(...) if (cmm_debug) { printk(KERN_INFO "cmm: "__VA_ARGS__); }
7584af458bSBrian King 
7684af458bSBrian King static unsigned long loaned_pages;
7784af458bSBrian King static unsigned long loaned_pages_target;
7884af458bSBrian King static unsigned long oom_freed_pages;
7984af458bSBrian King 
804a1745c5SDavid Hildenbrand static LIST_HEAD(cmm_page_list);
8184af458bSBrian King static DEFINE_SPINLOCK(cmm_lock);
8284af458bSBrian King 
8314b8a76bSRobert Jennings static DEFINE_MUTEX(hotplug_mutex);
8414b8a76bSRobert Jennings static int hotplug_occurred; /* protected by the hotplug mutex */
8514b8a76bSRobert Jennings 
8684af458bSBrian King static struct task_struct *cmm_thread_ptr;
8784af458bSBrian King 
884a1745c5SDavid Hildenbrand static long plpar_page_set_loaned(struct page *page)
898f272a5dSMichael Ellerman {
904a1745c5SDavid Hildenbrand 	const unsigned long vpa = page_to_phys(page);
918f272a5dSMichael Ellerman 	unsigned long cmo_page_sz = cmo_get_page_size();
928f272a5dSMichael Ellerman 	long rc = 0;
938f272a5dSMichael Ellerman 	int i;
948f272a5dSMichael Ellerman 
958f272a5dSMichael Ellerman 	for (i = 0; !rc && i < PAGE_SIZE; i += cmo_page_sz)
968f272a5dSMichael Ellerman 		rc = plpar_hcall_norets(H_PAGE_INIT, H_PAGE_SET_LOANED, vpa + i, 0);
978f272a5dSMichael Ellerman 
988f272a5dSMichael Ellerman 	for (i -= cmo_page_sz; rc && i != 0; i -= cmo_page_sz)
998f272a5dSMichael Ellerman 		plpar_hcall_norets(H_PAGE_INIT, H_PAGE_SET_ACTIVE,
1008f272a5dSMichael Ellerman 				   vpa + i - cmo_page_sz, 0);
1018f272a5dSMichael Ellerman 
1028f272a5dSMichael Ellerman 	return rc;
1038f272a5dSMichael Ellerman }
1048f272a5dSMichael Ellerman 
1054a1745c5SDavid Hildenbrand static long plpar_page_set_active(struct page *page)
1068f272a5dSMichael Ellerman {
1074a1745c5SDavid Hildenbrand 	const unsigned long vpa = page_to_phys(page);
1088f272a5dSMichael Ellerman 	unsigned long cmo_page_sz = cmo_get_page_size();
1098f272a5dSMichael Ellerman 	long rc = 0;
1108f272a5dSMichael Ellerman 	int i;
1118f272a5dSMichael Ellerman 
1128f272a5dSMichael Ellerman 	for (i = 0; !rc && i < PAGE_SIZE; i += cmo_page_sz)
1138f272a5dSMichael Ellerman 		rc = plpar_hcall_norets(H_PAGE_INIT, H_PAGE_SET_ACTIVE, vpa + i, 0);
1148f272a5dSMichael Ellerman 
1158f272a5dSMichael Ellerman 	for (i -= cmo_page_sz; rc && i != 0; i -= cmo_page_sz)
1168f272a5dSMichael Ellerman 		plpar_hcall_norets(H_PAGE_INIT, H_PAGE_SET_LOANED,
1178f272a5dSMichael Ellerman 				   vpa + i - cmo_page_sz, 0);
1188f272a5dSMichael Ellerman 
1198f272a5dSMichael Ellerman 	return rc;
1208f272a5dSMichael Ellerman }
1218f272a5dSMichael Ellerman 
12284af458bSBrian King /**
12384af458bSBrian King  * cmm_alloc_pages - Allocate pages and mark them as loaned
12484af458bSBrian King  * @nr:	number of pages to allocate
12584af458bSBrian King  *
12684af458bSBrian King  * Return value:
12784af458bSBrian King  * 	number of pages requested to be allocated which were not
12884af458bSBrian King  **/
12984af458bSBrian King static long cmm_alloc_pages(long nr)
13084af458bSBrian King {
1314a1745c5SDavid Hildenbrand 	struct page *page;
13284af458bSBrian King 	long rc;
13384af458bSBrian King 
13484af458bSBrian King 	cmm_dbg("Begin request for %ld pages\n", nr);
13584af458bSBrian King 
13684af458bSBrian King 	while (nr) {
13714b8a76bSRobert Jennings 		/* Exit if a hotplug operation is in progress or occurred */
13814b8a76bSRobert Jennings 		if (mutex_trylock(&hotplug_mutex)) {
13914b8a76bSRobert Jennings 			if (hotplug_occurred) {
14014b8a76bSRobert Jennings 				mutex_unlock(&hotplug_mutex);
14114b8a76bSRobert Jennings 				break;
14214b8a76bSRobert Jennings 			}
14314b8a76bSRobert Jennings 			mutex_unlock(&hotplug_mutex);
14414b8a76bSRobert Jennings 		} else {
14514b8a76bSRobert Jennings 			break;
14614b8a76bSRobert Jennings 		}
14714b8a76bSRobert Jennings 
1484a1745c5SDavid Hildenbrand 		page = alloc_page(GFP_NOIO | __GFP_NOWARN | __GFP_NORETRY |
1494a1745c5SDavid Hildenbrand 				  __GFP_NOMEMALLOC);
1504a1745c5SDavid Hildenbrand 		if (!page)
15184af458bSBrian King 			break;
15284af458bSBrian King 		spin_lock(&cmm_lock);
1534a1745c5SDavid Hildenbrand 		rc = plpar_page_set_loaned(page);
1544a1745c5SDavid Hildenbrand 		if (rc) {
1555df72bf3SHarvey Harrison 			pr_err("%s: Can not set page to loaned. rc=%ld\n", __func__, rc);
15684af458bSBrian King 			spin_unlock(&cmm_lock);
1574a1745c5SDavid Hildenbrand 			__free_page(page);
15884af458bSBrian King 			break;
15984af458bSBrian King 		}
16084af458bSBrian King 
1614a1745c5SDavid Hildenbrand 		list_add(&page->lru, &cmm_page_list);
16284af458bSBrian King 		loaned_pages++;
163287b8977SDavid Hildenbrand 		adjust_managed_page_count(page, -1);
16484af458bSBrian King 		spin_unlock(&cmm_lock);
16584af458bSBrian King 		nr--;
16684af458bSBrian King 	}
16784af458bSBrian King 
16884af458bSBrian King 	cmm_dbg("End request with %ld pages unfulfilled\n", nr);
16984af458bSBrian King 	return nr;
17084af458bSBrian King }
17184af458bSBrian King 
17284af458bSBrian King /**
17384af458bSBrian King  * cmm_free_pages - Free pages and mark them as active
17484af458bSBrian King  * @nr:	number of pages to free
17584af458bSBrian King  *
17684af458bSBrian King  * Return value:
17784af458bSBrian King  * 	number of pages requested to be freed which were not
17884af458bSBrian King  **/
17984af458bSBrian King static long cmm_free_pages(long nr)
18084af458bSBrian King {
1814a1745c5SDavid Hildenbrand 	struct page *page, *tmp;
18284af458bSBrian King 
18384af458bSBrian King 	cmm_dbg("Begin free of %ld pages.\n", nr);
18484af458bSBrian King 	spin_lock(&cmm_lock);
1854a1745c5SDavid Hildenbrand 	list_for_each_entry_safe(page, tmp, &cmm_page_list, lru) {
1864a1745c5SDavid Hildenbrand 		if (!nr)
18784af458bSBrian King 			break;
1884a1745c5SDavid Hildenbrand 		plpar_page_set_active(page);
1894a1745c5SDavid Hildenbrand 		list_del(&page->lru);
190287b8977SDavid Hildenbrand 		adjust_managed_page_count(page, 1);
1914a1745c5SDavid Hildenbrand 		__free_page(page);
19284af458bSBrian King 		loaned_pages--;
19384af458bSBrian King 		nr--;
19484af458bSBrian King 	}
19584af458bSBrian King 	spin_unlock(&cmm_lock);
19684af458bSBrian King 	cmm_dbg("End request with %ld pages unfulfilled\n", nr);
19784af458bSBrian King 	return nr;
19884af458bSBrian King }
19984af458bSBrian King 
20084af458bSBrian King /**
20184af458bSBrian King  * cmm_oom_notify - OOM notifier
20284af458bSBrian King  * @self:	notifier block struct
20384af458bSBrian King  * @dummy:	not used
20484af458bSBrian King  * @parm:	returned - number of pages freed
20584af458bSBrian King  *
20684af458bSBrian King  * Return value:
20784af458bSBrian King  * 	NOTIFY_OK
20884af458bSBrian King  **/
20984af458bSBrian King static int cmm_oom_notify(struct notifier_block *self,
21084af458bSBrian King 			  unsigned long dummy, void *parm)
21184af458bSBrian King {
21284af458bSBrian King 	unsigned long *freed = parm;
21384af458bSBrian King 	long nr = KB2PAGES(oom_kb);
21484af458bSBrian King 
21584af458bSBrian King 	cmm_dbg("OOM processing started\n");
21684af458bSBrian King 	nr = cmm_free_pages(nr);
21784af458bSBrian King 	loaned_pages_target = loaned_pages;
21884af458bSBrian King 	*freed += KB2PAGES(oom_kb) - nr;
21984af458bSBrian King 	oom_freed_pages += KB2PAGES(oom_kb) - nr;
22084af458bSBrian King 	cmm_dbg("OOM processing complete\n");
22184af458bSBrian King 	return NOTIFY_OK;
22284af458bSBrian King }
22384af458bSBrian King 
22484af458bSBrian King /**
22584af458bSBrian King  * cmm_get_mpp - Read memory performance parameters
22684af458bSBrian King  *
22784af458bSBrian King  * Makes hcall to query the current page loan request from the hypervisor.
22884af458bSBrian King  *
22984af458bSBrian King  * Return value:
23084af458bSBrian King  * 	nothing
23184af458bSBrian King  **/
23284af458bSBrian King static void cmm_get_mpp(void)
23384af458bSBrian King {
23484af458bSBrian King 	int rc;
23584af458bSBrian King 	struct hvcall_mpp_data mpp_data;
2368be8cf5bSBrian King 	signed long active_pages_target, page_loan_request, target;
237ca79b0c2SArun KS 	signed long total_pages = totalram_pages() + loaned_pages;
2388be8cf5bSBrian King 	signed long min_mem_pages = (min_mem_mb * 1024 * 1024) / PAGE_SIZE;
23984af458bSBrian King 
24084af458bSBrian King 	rc = h_get_mpp(&mpp_data);
24184af458bSBrian King 
24284af458bSBrian King 	if (rc != H_SUCCESS)
24384af458bSBrian King 		return;
24484af458bSBrian King 
24584af458bSBrian King 	page_loan_request = div_s64((s64)mpp_data.loan_request, PAGE_SIZE);
2468be8cf5bSBrian King 	target = page_loan_request + (signed long)loaned_pages;
2478be8cf5bSBrian King 
2488be8cf5bSBrian King 	if (target < 0 || total_pages < min_mem_pages)
2498be8cf5bSBrian King 		target = 0;
2508be8cf5bSBrian King 
2518be8cf5bSBrian King 	if (target > oom_freed_pages)
2528be8cf5bSBrian King 		target -= oom_freed_pages;
25384af458bSBrian King 	else
2548be8cf5bSBrian King 		target = 0;
25584af458bSBrian King 
2568be8cf5bSBrian King 	active_pages_target = total_pages - target;
25784af458bSBrian King 
2588be8cf5bSBrian King 	if (min_mem_pages > active_pages_target)
2598be8cf5bSBrian King 		target = total_pages - min_mem_pages;
2608be8cf5bSBrian King 
2618be8cf5bSBrian King 	if (target < 0)
2628be8cf5bSBrian King 		target = 0;
2638be8cf5bSBrian King 
2648be8cf5bSBrian King 	loaned_pages_target = target;
26584af458bSBrian King 
26684af458bSBrian King 	cmm_dbg("delta = %ld, loaned = %lu, target = %lu, oom = %lu, totalram = %lu\n",
26784af458bSBrian King 		page_loan_request, loaned_pages, loaned_pages_target,
268ca79b0c2SArun KS 		oom_freed_pages, totalram_pages());
26984af458bSBrian King }
27084af458bSBrian King 
27184af458bSBrian King static struct notifier_block cmm_oom_nb = {
27284af458bSBrian King 	.notifier_call = cmm_oom_notify
27384af458bSBrian King };
27484af458bSBrian King 
27584af458bSBrian King /**
27684af458bSBrian King  * cmm_thread - CMM task thread
27784af458bSBrian King  * @dummy:	not used
27884af458bSBrian King  *
27984af458bSBrian King  * Return value:
28084af458bSBrian King  * 	0
28184af458bSBrian King  **/
28284af458bSBrian King static int cmm_thread(void *dummy)
28384af458bSBrian King {
28484af458bSBrian King 	unsigned long timeleft;
28584af458bSBrian King 
28684af458bSBrian King 	while (1) {
28784af458bSBrian King 		timeleft = msleep_interruptible(delay * 1000);
28884af458bSBrian King 
28914b8a76bSRobert Jennings 		if (kthread_should_stop() || timeleft)
29084af458bSBrian King 			break;
29114b8a76bSRobert Jennings 
29214b8a76bSRobert Jennings 		if (mutex_trylock(&hotplug_mutex)) {
29314b8a76bSRobert Jennings 			if (hotplug_occurred) {
29414b8a76bSRobert Jennings 				hotplug_occurred = 0;
29514b8a76bSRobert Jennings 				mutex_unlock(&hotplug_mutex);
29614b8a76bSRobert Jennings 				cmm_dbg("Hotplug operation has occurred, "
29714b8a76bSRobert Jennings 						"loaning activity suspended "
29814b8a76bSRobert Jennings 						"for %d seconds.\n",
29914b8a76bSRobert Jennings 						hotplug_delay);
30014b8a76bSRobert Jennings 				timeleft = msleep_interruptible(hotplug_delay *
30114b8a76bSRobert Jennings 						1000);
30214b8a76bSRobert Jennings 				if (kthread_should_stop() || timeleft)
30314b8a76bSRobert Jennings 					break;
30414b8a76bSRobert Jennings 				continue;
30514b8a76bSRobert Jennings 			}
30614b8a76bSRobert Jennings 			mutex_unlock(&hotplug_mutex);
30714b8a76bSRobert Jennings 		} else {
30814b8a76bSRobert Jennings 			cmm_dbg("Hotplug operation in progress, activity "
30914b8a76bSRobert Jennings 					"suspended\n");
31014b8a76bSRobert Jennings 			continue;
31184af458bSBrian King 		}
31284af458bSBrian King 
31384af458bSBrian King 		cmm_get_mpp();
31484af458bSBrian King 
31584af458bSBrian King 		if (loaned_pages_target > loaned_pages) {
31684af458bSBrian King 			if (cmm_alloc_pages(loaned_pages_target - loaned_pages))
31784af458bSBrian King 				loaned_pages_target = loaned_pages;
31884af458bSBrian King 		} else if (loaned_pages_target < loaned_pages)
31984af458bSBrian King 			cmm_free_pages(loaned_pages - loaned_pages_target);
32084af458bSBrian King 	}
32184af458bSBrian King 	return 0;
32284af458bSBrian King }
32384af458bSBrian King 
32484af458bSBrian King #define CMM_SHOW(name, format, args...)			\
3256c9d2909SKay Sievers 	static ssize_t show_##name(struct device *dev,	\
3266c9d2909SKay Sievers 				   struct device_attribute *attr,	\
3273cee67f7SStephen Rothwell 				   char *buf)			\
32884af458bSBrian King 	{							\
32984af458bSBrian King 		return sprintf(buf, format, ##args);		\
33084af458bSBrian King 	}							\
33157ad583fSRussell Currey 	static DEVICE_ATTR(name, 0444, show_##name, NULL)
33284af458bSBrian King 
33384af458bSBrian King CMM_SHOW(loaned_kb, "%lu\n", PAGES2KB(loaned_pages));
33484af458bSBrian King CMM_SHOW(loaned_target_kb, "%lu\n", PAGES2KB(loaned_pages_target));
33584af458bSBrian King 
3366c9d2909SKay Sievers static ssize_t show_oom_pages(struct device *dev,
3376c9d2909SKay Sievers 			      struct device_attribute *attr, char *buf)
33884af458bSBrian King {
33984af458bSBrian King 	return sprintf(buf, "%lu\n", PAGES2KB(oom_freed_pages));
34084af458bSBrian King }
34184af458bSBrian King 
3426c9d2909SKay Sievers static ssize_t store_oom_pages(struct device *dev,
3436c9d2909SKay Sievers 			       struct device_attribute *attr,
34484af458bSBrian King 			       const char *buf, size_t count)
34584af458bSBrian King {
34684af458bSBrian King 	unsigned long val = simple_strtoul (buf, NULL, 10);
34784af458bSBrian King 
34884af458bSBrian King 	if (!capable(CAP_SYS_ADMIN))
34984af458bSBrian King 		return -EPERM;
35084af458bSBrian King 	if (val != 0)
35184af458bSBrian King 		return -EBADMSG;
35284af458bSBrian King 
35384af458bSBrian King 	oom_freed_pages = 0;
35484af458bSBrian King 	return count;
35584af458bSBrian King }
35684af458bSBrian King 
35757ad583fSRussell Currey static DEVICE_ATTR(oom_freed_kb, 0644,
35884af458bSBrian King 		   show_oom_pages, store_oom_pages);
35984af458bSBrian King 
3606c9d2909SKay Sievers static struct device_attribute *cmm_attrs[] = {
3616c9d2909SKay Sievers 	&dev_attr_loaned_kb,
3626c9d2909SKay Sievers 	&dev_attr_loaned_target_kb,
3636c9d2909SKay Sievers 	&dev_attr_oom_freed_kb,
36484af458bSBrian King };
36584af458bSBrian King 
3666c9d2909SKay Sievers static struct bus_type cmm_subsys = {
36784af458bSBrian King 	.name = "cmm",
3686c9d2909SKay Sievers 	.dev_name = "cmm",
36984af458bSBrian King };
37084af458bSBrian King 
3717d821274SDavid Hildenbrand static void cmm_release_device(struct device *dev)
3727d821274SDavid Hildenbrand {
3737d821274SDavid Hildenbrand }
3747d821274SDavid Hildenbrand 
37584af458bSBrian King /**
37684af458bSBrian King  * cmm_sysfs_register - Register with sysfs
37784af458bSBrian King  *
37884af458bSBrian King  * Return value:
37984af458bSBrian King  * 	0 on success / other on failure
38084af458bSBrian King  **/
3816c9d2909SKay Sievers static int cmm_sysfs_register(struct device *dev)
38284af458bSBrian King {
38384af458bSBrian King 	int i, rc;
38484af458bSBrian King 
3856c9d2909SKay Sievers 	if ((rc = subsys_system_register(&cmm_subsys, NULL)))
38684af458bSBrian King 		return rc;
38784af458bSBrian King 
3886c9d2909SKay Sievers 	dev->id = 0;
3896c9d2909SKay Sievers 	dev->bus = &cmm_subsys;
3907d821274SDavid Hildenbrand 	dev->release = cmm_release_device;
39184af458bSBrian King 
3926c9d2909SKay Sievers 	if ((rc = device_register(dev)))
3936c9d2909SKay Sievers 		goto subsys_unregister;
39484af458bSBrian King 
39584af458bSBrian King 	for (i = 0; i < ARRAY_SIZE(cmm_attrs); i++) {
3966c9d2909SKay Sievers 		if ((rc = device_create_file(dev, cmm_attrs[i])))
39784af458bSBrian King 			goto fail;
39884af458bSBrian King 	}
39984af458bSBrian King 
40084af458bSBrian King 	return 0;
40184af458bSBrian King 
40284af458bSBrian King fail:
40384af458bSBrian King 	while (--i >= 0)
4046c9d2909SKay Sievers 		device_remove_file(dev, cmm_attrs[i]);
4056c9d2909SKay Sievers 	device_unregister(dev);
4066c9d2909SKay Sievers subsys_unregister:
4076c9d2909SKay Sievers 	bus_unregister(&cmm_subsys);
40884af458bSBrian King 	return rc;
40984af458bSBrian King }
41084af458bSBrian King 
41184af458bSBrian King /**
41284af458bSBrian King  * cmm_unregister_sysfs - Unregister from sysfs
41384af458bSBrian King  *
41484af458bSBrian King  **/
4156c9d2909SKay Sievers static void cmm_unregister_sysfs(struct device *dev)
41684af458bSBrian King {
41784af458bSBrian King 	int i;
41884af458bSBrian King 
41984af458bSBrian King 	for (i = 0; i < ARRAY_SIZE(cmm_attrs); i++)
4206c9d2909SKay Sievers 		device_remove_file(dev, cmm_attrs[i]);
4216c9d2909SKay Sievers 	device_unregister(dev);
4226c9d2909SKay Sievers 	bus_unregister(&cmm_subsys);
42384af458bSBrian King }
42484af458bSBrian King 
42584af458bSBrian King /**
426fecba962SBrian King  * cmm_reboot_notifier - Make sure pages are not still marked as "loaned"
427fecba962SBrian King  *
428fecba962SBrian King  **/
429fecba962SBrian King static int cmm_reboot_notifier(struct notifier_block *nb,
430fecba962SBrian King 			       unsigned long action, void *unused)
431fecba962SBrian King {
432fecba962SBrian King 	if (action == SYS_RESTART) {
433fecba962SBrian King 		if (cmm_thread_ptr)
434fecba962SBrian King 			kthread_stop(cmm_thread_ptr);
435fecba962SBrian King 		cmm_thread_ptr = NULL;
436fecba962SBrian King 		cmm_free_pages(loaned_pages);
437fecba962SBrian King 	}
438fecba962SBrian King 	return NOTIFY_DONE;
439fecba962SBrian King }
440fecba962SBrian King 
441fecba962SBrian King static struct notifier_block cmm_reboot_nb = {
442fecba962SBrian King 	.notifier_call = cmm_reboot_notifier,
443fecba962SBrian King };
444fecba962SBrian King 
445fecba962SBrian King /**
44614b8a76bSRobert Jennings  * cmm_memory_cb - Handle memory hotplug notifier calls
44714b8a76bSRobert Jennings  * @self:	notifier block struct
44814b8a76bSRobert Jennings  * @action:	action to take
44914b8a76bSRobert Jennings  * @arg:	struct memory_notify data for handler
45014b8a76bSRobert Jennings  *
45114b8a76bSRobert Jennings  * Return value:
45214b8a76bSRobert Jennings  *	NOTIFY_OK or notifier error based on subfunction return value
45314b8a76bSRobert Jennings  *
45414b8a76bSRobert Jennings  **/
45514b8a76bSRobert Jennings static int cmm_memory_cb(struct notifier_block *self,
45614b8a76bSRobert Jennings 			unsigned long action, void *arg)
45714b8a76bSRobert Jennings {
45814b8a76bSRobert Jennings 	int ret = 0;
45914b8a76bSRobert Jennings 
46014b8a76bSRobert Jennings 	switch (action) {
46114b8a76bSRobert Jennings 	case MEM_GOING_OFFLINE:
46214b8a76bSRobert Jennings 		mutex_lock(&hotplug_mutex);
46314b8a76bSRobert Jennings 		hotplug_occurred = 1;
46414b8a76bSRobert Jennings 		break;
46514b8a76bSRobert Jennings 	case MEM_OFFLINE:
46614b8a76bSRobert Jennings 	case MEM_CANCEL_OFFLINE:
46714b8a76bSRobert Jennings 		mutex_unlock(&hotplug_mutex);
46814b8a76bSRobert Jennings 		cmm_dbg("Memory offline operation complete.\n");
46914b8a76bSRobert Jennings 		break;
47014b8a76bSRobert Jennings 	case MEM_GOING_ONLINE:
47114b8a76bSRobert Jennings 	case MEM_ONLINE:
47214b8a76bSRobert Jennings 	case MEM_CANCEL_ONLINE:
47314b8a76bSRobert Jennings 		break;
47414b8a76bSRobert Jennings 	}
47514b8a76bSRobert Jennings 
4767e26065dSPrarit Bhargava 	return notifier_from_errno(ret);
47714b8a76bSRobert Jennings }
47814b8a76bSRobert Jennings 
47914b8a76bSRobert Jennings static struct notifier_block cmm_mem_nb = {
48014b8a76bSRobert Jennings 	.notifier_call = cmm_memory_cb,
48114b8a76bSRobert Jennings 	.priority = CMM_MEM_HOTPLUG_PRI
48214b8a76bSRobert Jennings };
48314b8a76bSRobert Jennings 
48414b8a76bSRobert Jennings /**
48584af458bSBrian King  * cmm_init - Module initialization
48684af458bSBrian King  *
48784af458bSBrian King  * Return value:
48884af458bSBrian King  * 	0 on success / other on failure
48984af458bSBrian King  **/
49084af458bSBrian King static int cmm_init(void)
49184af458bSBrian King {
49268f7a049SDavid Hildenbrand 	int rc;
49384af458bSBrian King 
49484af458bSBrian King 	if (!firmware_has_feature(FW_FEATURE_CMO))
49584af458bSBrian King 		return -EOPNOTSUPP;
49684af458bSBrian King 
49784af458bSBrian King 	if ((rc = register_oom_notifier(&cmm_oom_nb)) < 0)
49884af458bSBrian King 		return rc;
49984af458bSBrian King 
500fecba962SBrian King 	if ((rc = register_reboot_notifier(&cmm_reboot_nb)))
50184af458bSBrian King 		goto out_oom_notifier;
50284af458bSBrian King 
5036c9d2909SKay Sievers 	if ((rc = cmm_sysfs_register(&cmm_dev)))
504fecba962SBrian King 		goto out_reboot_notifier;
505fecba962SBrian King 
506022da223SDavid Hildenbrand 	rc = register_memory_notifier(&cmm_mem_nb);
507022da223SDavid Hildenbrand 	if (rc)
508022da223SDavid Hildenbrand 		goto out_unregister_notifier;
509022da223SDavid Hildenbrand 
51084af458bSBrian King 	if (cmm_disabled)
51168f7a049SDavid Hildenbrand 		return 0;
51284af458bSBrian King 
51384af458bSBrian King 	cmm_thread_ptr = kthread_run(cmm_thread, NULL, "cmmthread");
51484af458bSBrian King 	if (IS_ERR(cmm_thread_ptr)) {
51584af458bSBrian King 		rc = PTR_ERR(cmm_thread_ptr);
51614b8a76bSRobert Jennings 		goto out_unregister_notifier;
51784af458bSBrian King 	}
51884af458bSBrian King 
51968f7a049SDavid Hildenbrand 	return 0;
52014b8a76bSRobert Jennings out_unregister_notifier:
52114b8a76bSRobert Jennings 	unregister_memory_notifier(&cmm_mem_nb);
5226c9d2909SKay Sievers 	cmm_unregister_sysfs(&cmm_dev);
523fecba962SBrian King out_reboot_notifier:
524fecba962SBrian King 	unregister_reboot_notifier(&cmm_reboot_nb);
52584af458bSBrian King out_oom_notifier:
52684af458bSBrian King 	unregister_oom_notifier(&cmm_oom_nb);
52784af458bSBrian King 	return rc;
52884af458bSBrian King }
52984af458bSBrian King 
53084af458bSBrian King /**
53184af458bSBrian King  * cmm_exit - Module exit
53284af458bSBrian King  *
53384af458bSBrian King  * Return value:
53484af458bSBrian King  * 	nothing
53584af458bSBrian King  **/
53684af458bSBrian King static void cmm_exit(void)
53784af458bSBrian King {
53884af458bSBrian King 	if (cmm_thread_ptr)
53984af458bSBrian King 		kthread_stop(cmm_thread_ptr);
54084af458bSBrian King 	unregister_oom_notifier(&cmm_oom_nb);
541fecba962SBrian King 	unregister_reboot_notifier(&cmm_reboot_nb);
54214b8a76bSRobert Jennings 	unregister_memory_notifier(&cmm_mem_nb);
54384af458bSBrian King 	cmm_free_pages(loaned_pages);
5446c9d2909SKay Sievers 	cmm_unregister_sysfs(&cmm_dev);
54584af458bSBrian King }
54684af458bSBrian King 
54784af458bSBrian King /**
54884af458bSBrian King  * cmm_set_disable - Disable/Enable CMM
54984af458bSBrian King  *
55084af458bSBrian King  * Return value:
55184af458bSBrian King  * 	0 on success / other on failure
55284af458bSBrian King  **/
553e4dca7b7SKees Cook static int cmm_set_disable(const char *val, const struct kernel_param *kp)
55484af458bSBrian King {
55584af458bSBrian King 	int disable = simple_strtoul(val, NULL, 10);
55684af458bSBrian King 
55784af458bSBrian King 	if (disable != 0 && disable != 1)
55884af458bSBrian King 		return -EINVAL;
55984af458bSBrian King 
56084af458bSBrian King 	if (disable && !cmm_disabled) {
56184af458bSBrian King 		if (cmm_thread_ptr)
56284af458bSBrian King 			kthread_stop(cmm_thread_ptr);
56384af458bSBrian King 		cmm_thread_ptr = NULL;
56484af458bSBrian King 		cmm_free_pages(loaned_pages);
56584af458bSBrian King 	} else if (!disable && cmm_disabled) {
56684af458bSBrian King 		cmm_thread_ptr = kthread_run(cmm_thread, NULL, "cmmthread");
56784af458bSBrian King 		if (IS_ERR(cmm_thread_ptr))
56884af458bSBrian King 			return PTR_ERR(cmm_thread_ptr);
56984af458bSBrian King 	}
57084af458bSBrian King 
57184af458bSBrian King 	cmm_disabled = disable;
57284af458bSBrian King 	return 0;
57384af458bSBrian King }
57484af458bSBrian King 
57584af458bSBrian King module_param_call(disable, cmm_set_disable, param_get_uint,
57657ad583fSRussell Currey 		  &cmm_disabled, 0644);
57784af458bSBrian King MODULE_PARM_DESC(disable, "Disable CMM. Set to 1 to disable. "
57884af458bSBrian King 		 "[Default=" __stringify(CMM_DISABLE) "]");
57984af458bSBrian King 
58084af458bSBrian King module_init(cmm_init);
58184af458bSBrian King module_exit(cmm_exit);
582