xref: /openbmc/linux/arch/powerpc/platforms/pseries/cmm.c (revision 1ef2f06b71792c2efaa4fb4aef8f1fc2a115ee1f)
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))
417659f5d6SDavid 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 
76*1ef2f06bSDavid Hildenbrand static atomic_long_t 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);
162*1ef2f06bSDavid Hildenbrand 		atomic_long_inc(&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);
192*1ef2f06bSDavid Hildenbrand 		atomic_long_dec(&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);
217*1ef2f06bSDavid Hildenbrand 	loaned_pages_target = atomic_long_read(&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 {
234*1ef2f06bSDavid Hildenbrand 	const long __loaned_pages = atomic_long_read(&loaned_pages);
235*1ef2f06bSDavid Hildenbrand 	const long total_pages = totalram_pages() + __loaned_pages;
23684af458bSBrian King 	int rc;
23784af458bSBrian King 	struct hvcall_mpp_data mpp_data;
2388be8cf5bSBrian King 	signed long active_pages_target, page_loan_request, target;
2398be8cf5bSBrian King 	signed long min_mem_pages = (min_mem_mb * 1024 * 1024) / PAGE_SIZE;
24084af458bSBrian King 
24184af458bSBrian King 	rc = h_get_mpp(&mpp_data);
24284af458bSBrian King 
24384af458bSBrian King 	if (rc != H_SUCCESS)
24484af458bSBrian King 		return;
24584af458bSBrian King 
24684af458bSBrian King 	page_loan_request = div_s64((s64)mpp_data.loan_request, PAGE_SIZE);
247*1ef2f06bSDavid Hildenbrand 	target = page_loan_request + __loaned_pages;
2488be8cf5bSBrian King 
2498be8cf5bSBrian King 	if (target < 0 || total_pages < min_mem_pages)
2508be8cf5bSBrian King 		target = 0;
2518be8cf5bSBrian King 
2528be8cf5bSBrian King 	if (target > oom_freed_pages)
2538be8cf5bSBrian King 		target -= oom_freed_pages;
25484af458bSBrian King 	else
2558be8cf5bSBrian King 		target = 0;
25684af458bSBrian King 
2578be8cf5bSBrian King 	active_pages_target = total_pages - target;
25884af458bSBrian King 
2598be8cf5bSBrian King 	if (min_mem_pages > active_pages_target)
2608be8cf5bSBrian King 		target = total_pages - min_mem_pages;
2618be8cf5bSBrian King 
2628be8cf5bSBrian King 	if (target < 0)
2638be8cf5bSBrian King 		target = 0;
2648be8cf5bSBrian King 
2658be8cf5bSBrian King 	loaned_pages_target = target;
26684af458bSBrian King 
26784af458bSBrian King 	cmm_dbg("delta = %ld, loaned = %lu, target = %lu, oom = %lu, totalram = %lu\n",
268*1ef2f06bSDavid Hildenbrand 		page_loan_request, __loaned_pages, loaned_pages_target,
269ca79b0c2SArun KS 		oom_freed_pages, totalram_pages());
27084af458bSBrian King }
27184af458bSBrian King 
27284af458bSBrian King static struct notifier_block cmm_oom_nb = {
27384af458bSBrian King 	.notifier_call = cmm_oom_notify
27484af458bSBrian King };
27584af458bSBrian King 
27684af458bSBrian King /**
27784af458bSBrian King  * cmm_thread - CMM task thread
27884af458bSBrian King  * @dummy:	not used
27984af458bSBrian King  *
28084af458bSBrian King  * Return value:
28184af458bSBrian King  * 	0
28284af458bSBrian King  **/
28384af458bSBrian King static int cmm_thread(void *dummy)
28484af458bSBrian King {
28584af458bSBrian King 	unsigned long timeleft;
286*1ef2f06bSDavid Hildenbrand 	long __loaned_pages;
28784af458bSBrian King 
28884af458bSBrian King 	while (1) {
28984af458bSBrian King 		timeleft = msleep_interruptible(delay * 1000);
29084af458bSBrian King 
29114b8a76bSRobert Jennings 		if (kthread_should_stop() || timeleft)
29284af458bSBrian King 			break;
29314b8a76bSRobert Jennings 
29414b8a76bSRobert Jennings 		if (mutex_trylock(&hotplug_mutex)) {
29514b8a76bSRobert Jennings 			if (hotplug_occurred) {
29614b8a76bSRobert Jennings 				hotplug_occurred = 0;
29714b8a76bSRobert Jennings 				mutex_unlock(&hotplug_mutex);
29814b8a76bSRobert Jennings 				cmm_dbg("Hotplug operation has occurred, "
29914b8a76bSRobert Jennings 						"loaning activity suspended "
30014b8a76bSRobert Jennings 						"for %d seconds.\n",
30114b8a76bSRobert Jennings 						hotplug_delay);
30214b8a76bSRobert Jennings 				timeleft = msleep_interruptible(hotplug_delay *
30314b8a76bSRobert Jennings 						1000);
30414b8a76bSRobert Jennings 				if (kthread_should_stop() || timeleft)
30514b8a76bSRobert Jennings 					break;
30614b8a76bSRobert Jennings 				continue;
30714b8a76bSRobert Jennings 			}
30814b8a76bSRobert Jennings 			mutex_unlock(&hotplug_mutex);
30914b8a76bSRobert Jennings 		} else {
31014b8a76bSRobert Jennings 			cmm_dbg("Hotplug operation in progress, activity "
31114b8a76bSRobert Jennings 					"suspended\n");
31214b8a76bSRobert Jennings 			continue;
31384af458bSBrian King 		}
31484af458bSBrian King 
31584af458bSBrian King 		cmm_get_mpp();
31684af458bSBrian King 
317*1ef2f06bSDavid Hildenbrand 		__loaned_pages = atomic_long_read(&loaned_pages);
318*1ef2f06bSDavid Hildenbrand 		if (loaned_pages_target > __loaned_pages) {
319*1ef2f06bSDavid Hildenbrand 			if (cmm_alloc_pages(loaned_pages_target - __loaned_pages))
320*1ef2f06bSDavid Hildenbrand 				loaned_pages_target = __loaned_pages;
321*1ef2f06bSDavid Hildenbrand 		} else if (loaned_pages_target < __loaned_pages)
322*1ef2f06bSDavid Hildenbrand 			cmm_free_pages(__loaned_pages - loaned_pages_target);
32384af458bSBrian King 	}
32484af458bSBrian King 	return 0;
32584af458bSBrian King }
32684af458bSBrian King 
32784af458bSBrian King #define CMM_SHOW(name, format, args...)			\
3286c9d2909SKay Sievers 	static ssize_t show_##name(struct device *dev,	\
3296c9d2909SKay Sievers 				   struct device_attribute *attr,	\
3303cee67f7SStephen Rothwell 				   char *buf)			\
33184af458bSBrian King 	{							\
33284af458bSBrian King 		return sprintf(buf, format, ##args);		\
33384af458bSBrian King 	}							\
33457ad583fSRussell Currey 	static DEVICE_ATTR(name, 0444, show_##name, NULL)
33584af458bSBrian King 
336*1ef2f06bSDavid Hildenbrand CMM_SHOW(loaned_kb, "%lu\n", PAGES2KB(atomic_long_read(&loaned_pages)));
33784af458bSBrian King CMM_SHOW(loaned_target_kb, "%lu\n", PAGES2KB(loaned_pages_target));
33884af458bSBrian King 
3396c9d2909SKay Sievers static ssize_t show_oom_pages(struct device *dev,
3406c9d2909SKay Sievers 			      struct device_attribute *attr, char *buf)
34184af458bSBrian King {
34284af458bSBrian King 	return sprintf(buf, "%lu\n", PAGES2KB(oom_freed_pages));
34384af458bSBrian King }
34484af458bSBrian King 
3456c9d2909SKay Sievers static ssize_t store_oom_pages(struct device *dev,
3466c9d2909SKay Sievers 			       struct device_attribute *attr,
34784af458bSBrian King 			       const char *buf, size_t count)
34884af458bSBrian King {
34984af458bSBrian King 	unsigned long val = simple_strtoul (buf, NULL, 10);
35084af458bSBrian King 
35184af458bSBrian King 	if (!capable(CAP_SYS_ADMIN))
35284af458bSBrian King 		return -EPERM;
35384af458bSBrian King 	if (val != 0)
35484af458bSBrian King 		return -EBADMSG;
35584af458bSBrian King 
35684af458bSBrian King 	oom_freed_pages = 0;
35784af458bSBrian King 	return count;
35884af458bSBrian King }
35984af458bSBrian King 
36057ad583fSRussell Currey static DEVICE_ATTR(oom_freed_kb, 0644,
36184af458bSBrian King 		   show_oom_pages, store_oom_pages);
36284af458bSBrian King 
3636c9d2909SKay Sievers static struct device_attribute *cmm_attrs[] = {
3646c9d2909SKay Sievers 	&dev_attr_loaned_kb,
3656c9d2909SKay Sievers 	&dev_attr_loaned_target_kb,
3666c9d2909SKay Sievers 	&dev_attr_oom_freed_kb,
36784af458bSBrian King };
36884af458bSBrian King 
3696c9d2909SKay Sievers static struct bus_type cmm_subsys = {
37084af458bSBrian King 	.name = "cmm",
3716c9d2909SKay Sievers 	.dev_name = "cmm",
37284af458bSBrian King };
37384af458bSBrian King 
3747d821274SDavid Hildenbrand static void cmm_release_device(struct device *dev)
3757d821274SDavid Hildenbrand {
3767d821274SDavid Hildenbrand }
3777d821274SDavid Hildenbrand 
37884af458bSBrian King /**
37984af458bSBrian King  * cmm_sysfs_register - Register with sysfs
38084af458bSBrian King  *
38184af458bSBrian King  * Return value:
38284af458bSBrian King  * 	0 on success / other on failure
38384af458bSBrian King  **/
3846c9d2909SKay Sievers static int cmm_sysfs_register(struct device *dev)
38584af458bSBrian King {
38684af458bSBrian King 	int i, rc;
38784af458bSBrian King 
3886c9d2909SKay Sievers 	if ((rc = subsys_system_register(&cmm_subsys, NULL)))
38984af458bSBrian King 		return rc;
39084af458bSBrian King 
3916c9d2909SKay Sievers 	dev->id = 0;
3926c9d2909SKay Sievers 	dev->bus = &cmm_subsys;
3937d821274SDavid Hildenbrand 	dev->release = cmm_release_device;
39484af458bSBrian King 
3956c9d2909SKay Sievers 	if ((rc = device_register(dev)))
3966c9d2909SKay Sievers 		goto subsys_unregister;
39784af458bSBrian King 
39884af458bSBrian King 	for (i = 0; i < ARRAY_SIZE(cmm_attrs); i++) {
3996c9d2909SKay Sievers 		if ((rc = device_create_file(dev, cmm_attrs[i])))
40084af458bSBrian King 			goto fail;
40184af458bSBrian King 	}
40284af458bSBrian King 
40384af458bSBrian King 	return 0;
40484af458bSBrian King 
40584af458bSBrian King fail:
40684af458bSBrian King 	while (--i >= 0)
4076c9d2909SKay Sievers 		device_remove_file(dev, cmm_attrs[i]);
4086c9d2909SKay Sievers 	device_unregister(dev);
4096c9d2909SKay Sievers subsys_unregister:
4106c9d2909SKay Sievers 	bus_unregister(&cmm_subsys);
41184af458bSBrian King 	return rc;
41284af458bSBrian King }
41384af458bSBrian King 
41484af458bSBrian King /**
41584af458bSBrian King  * cmm_unregister_sysfs - Unregister from sysfs
41684af458bSBrian King  *
41784af458bSBrian King  **/
4186c9d2909SKay Sievers static void cmm_unregister_sysfs(struct device *dev)
41984af458bSBrian King {
42084af458bSBrian King 	int i;
42184af458bSBrian King 
42284af458bSBrian King 	for (i = 0; i < ARRAY_SIZE(cmm_attrs); i++)
4236c9d2909SKay Sievers 		device_remove_file(dev, cmm_attrs[i]);
4246c9d2909SKay Sievers 	device_unregister(dev);
4256c9d2909SKay Sievers 	bus_unregister(&cmm_subsys);
42684af458bSBrian King }
42784af458bSBrian King 
42884af458bSBrian King /**
429fecba962SBrian King  * cmm_reboot_notifier - Make sure pages are not still marked as "loaned"
430fecba962SBrian King  *
431fecba962SBrian King  **/
432fecba962SBrian King static int cmm_reboot_notifier(struct notifier_block *nb,
433fecba962SBrian King 			       unsigned long action, void *unused)
434fecba962SBrian King {
435fecba962SBrian King 	if (action == SYS_RESTART) {
436fecba962SBrian King 		if (cmm_thread_ptr)
437fecba962SBrian King 			kthread_stop(cmm_thread_ptr);
438fecba962SBrian King 		cmm_thread_ptr = NULL;
439*1ef2f06bSDavid Hildenbrand 		cmm_free_pages(atomic_long_read(&loaned_pages));
440fecba962SBrian King 	}
441fecba962SBrian King 	return NOTIFY_DONE;
442fecba962SBrian King }
443fecba962SBrian King 
444fecba962SBrian King static struct notifier_block cmm_reboot_nb = {
445fecba962SBrian King 	.notifier_call = cmm_reboot_notifier,
446fecba962SBrian King };
447fecba962SBrian King 
448fecba962SBrian King /**
44914b8a76bSRobert Jennings  * cmm_memory_cb - Handle memory hotplug notifier calls
45014b8a76bSRobert Jennings  * @self:	notifier block struct
45114b8a76bSRobert Jennings  * @action:	action to take
45214b8a76bSRobert Jennings  * @arg:	struct memory_notify data for handler
45314b8a76bSRobert Jennings  *
45414b8a76bSRobert Jennings  * Return value:
45514b8a76bSRobert Jennings  *	NOTIFY_OK or notifier error based on subfunction return value
45614b8a76bSRobert Jennings  *
45714b8a76bSRobert Jennings  **/
45814b8a76bSRobert Jennings static int cmm_memory_cb(struct notifier_block *self,
45914b8a76bSRobert Jennings 			unsigned long action, void *arg)
46014b8a76bSRobert Jennings {
46114b8a76bSRobert Jennings 	int ret = 0;
46214b8a76bSRobert Jennings 
46314b8a76bSRobert Jennings 	switch (action) {
46414b8a76bSRobert Jennings 	case MEM_GOING_OFFLINE:
46514b8a76bSRobert Jennings 		mutex_lock(&hotplug_mutex);
46614b8a76bSRobert Jennings 		hotplug_occurred = 1;
46714b8a76bSRobert Jennings 		break;
46814b8a76bSRobert Jennings 	case MEM_OFFLINE:
46914b8a76bSRobert Jennings 	case MEM_CANCEL_OFFLINE:
47014b8a76bSRobert Jennings 		mutex_unlock(&hotplug_mutex);
47114b8a76bSRobert Jennings 		cmm_dbg("Memory offline operation complete.\n");
47214b8a76bSRobert Jennings 		break;
47314b8a76bSRobert Jennings 	case MEM_GOING_ONLINE:
47414b8a76bSRobert Jennings 	case MEM_ONLINE:
47514b8a76bSRobert Jennings 	case MEM_CANCEL_ONLINE:
47614b8a76bSRobert Jennings 		break;
47714b8a76bSRobert Jennings 	}
47814b8a76bSRobert Jennings 
4797e26065dSPrarit Bhargava 	return notifier_from_errno(ret);
48014b8a76bSRobert Jennings }
48114b8a76bSRobert Jennings 
48214b8a76bSRobert Jennings static struct notifier_block cmm_mem_nb = {
48314b8a76bSRobert Jennings 	.notifier_call = cmm_memory_cb,
48414b8a76bSRobert Jennings 	.priority = CMM_MEM_HOTPLUG_PRI
48514b8a76bSRobert Jennings };
48614b8a76bSRobert Jennings 
48714b8a76bSRobert Jennings /**
48884af458bSBrian King  * cmm_init - Module initialization
48984af458bSBrian King  *
49084af458bSBrian King  * Return value:
49184af458bSBrian King  * 	0 on success / other on failure
49284af458bSBrian King  **/
49384af458bSBrian King static int cmm_init(void)
49484af458bSBrian King {
49568f7a049SDavid Hildenbrand 	int rc;
49684af458bSBrian King 
49784af458bSBrian King 	if (!firmware_has_feature(FW_FEATURE_CMO))
49884af458bSBrian King 		return -EOPNOTSUPP;
49984af458bSBrian King 
50084af458bSBrian King 	if ((rc = register_oom_notifier(&cmm_oom_nb)) < 0)
50184af458bSBrian King 		return rc;
50284af458bSBrian King 
503fecba962SBrian King 	if ((rc = register_reboot_notifier(&cmm_reboot_nb)))
50484af458bSBrian King 		goto out_oom_notifier;
50584af458bSBrian King 
5066c9d2909SKay Sievers 	if ((rc = cmm_sysfs_register(&cmm_dev)))
507fecba962SBrian King 		goto out_reboot_notifier;
508fecba962SBrian King 
509022da223SDavid Hildenbrand 	rc = register_memory_notifier(&cmm_mem_nb);
510022da223SDavid Hildenbrand 	if (rc)
511022da223SDavid Hildenbrand 		goto out_unregister_notifier;
512022da223SDavid Hildenbrand 
51384af458bSBrian King 	if (cmm_disabled)
51468f7a049SDavid Hildenbrand 		return 0;
51584af458bSBrian King 
51684af458bSBrian King 	cmm_thread_ptr = kthread_run(cmm_thread, NULL, "cmmthread");
51784af458bSBrian King 	if (IS_ERR(cmm_thread_ptr)) {
51884af458bSBrian King 		rc = PTR_ERR(cmm_thread_ptr);
51914b8a76bSRobert Jennings 		goto out_unregister_notifier;
52084af458bSBrian King 	}
52184af458bSBrian King 
52268f7a049SDavid Hildenbrand 	return 0;
52314b8a76bSRobert Jennings out_unregister_notifier:
52414b8a76bSRobert Jennings 	unregister_memory_notifier(&cmm_mem_nb);
5256c9d2909SKay Sievers 	cmm_unregister_sysfs(&cmm_dev);
526fecba962SBrian King out_reboot_notifier:
527fecba962SBrian King 	unregister_reboot_notifier(&cmm_reboot_nb);
52884af458bSBrian King out_oom_notifier:
52984af458bSBrian King 	unregister_oom_notifier(&cmm_oom_nb);
53084af458bSBrian King 	return rc;
53184af458bSBrian King }
53284af458bSBrian King 
53384af458bSBrian King /**
53484af458bSBrian King  * cmm_exit - Module exit
53584af458bSBrian King  *
53684af458bSBrian King  * Return value:
53784af458bSBrian King  * 	nothing
53884af458bSBrian King  **/
53984af458bSBrian King static void cmm_exit(void)
54084af458bSBrian King {
54184af458bSBrian King 	if (cmm_thread_ptr)
54284af458bSBrian King 		kthread_stop(cmm_thread_ptr);
54384af458bSBrian King 	unregister_oom_notifier(&cmm_oom_nb);
544fecba962SBrian King 	unregister_reboot_notifier(&cmm_reboot_nb);
54514b8a76bSRobert Jennings 	unregister_memory_notifier(&cmm_mem_nb);
546*1ef2f06bSDavid Hildenbrand 	cmm_free_pages(atomic_long_read(&loaned_pages));
5476c9d2909SKay Sievers 	cmm_unregister_sysfs(&cmm_dev);
54884af458bSBrian King }
54984af458bSBrian King 
55084af458bSBrian King /**
55184af458bSBrian King  * cmm_set_disable - Disable/Enable CMM
55284af458bSBrian King  *
55384af458bSBrian King  * Return value:
55484af458bSBrian King  * 	0 on success / other on failure
55584af458bSBrian King  **/
556e4dca7b7SKees Cook static int cmm_set_disable(const char *val, const struct kernel_param *kp)
55784af458bSBrian King {
55884af458bSBrian King 	int disable = simple_strtoul(val, NULL, 10);
55984af458bSBrian King 
56084af458bSBrian King 	if (disable != 0 && disable != 1)
56184af458bSBrian King 		return -EINVAL;
56284af458bSBrian King 
56384af458bSBrian King 	if (disable && !cmm_disabled) {
56484af458bSBrian King 		if (cmm_thread_ptr)
56584af458bSBrian King 			kthread_stop(cmm_thread_ptr);
56684af458bSBrian King 		cmm_thread_ptr = NULL;
567*1ef2f06bSDavid Hildenbrand 		cmm_free_pages(atomic_long_read(&loaned_pages));
56884af458bSBrian King 	} else if (!disable && cmm_disabled) {
56984af458bSBrian King 		cmm_thread_ptr = kthread_run(cmm_thread, NULL, "cmmthread");
57084af458bSBrian King 		if (IS_ERR(cmm_thread_ptr))
57184af458bSBrian King 			return PTR_ERR(cmm_thread_ptr);
57284af458bSBrian King 	}
57384af458bSBrian King 
57484af458bSBrian King 	cmm_disabled = disable;
57584af458bSBrian King 	return 0;
57684af458bSBrian King }
57784af458bSBrian King 
57884af458bSBrian King module_param_call(disable, cmm_set_disable, param_get_uint,
57957ad583fSRussell Currey 		  &cmm_disabled, 0644);
58084af458bSBrian King MODULE_PARM_DESC(disable, "Disable CMM. Set to 1 to disable. "
58184af458bSBrian King 		 "[Default=" __stringify(CMM_DISABLE) "]");
58284af458bSBrian King 
58384af458bSBrian King module_init(cmm_init);
58484af458bSBrian King module_exit(cmm_exit);
585