162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci#include <linux/swap_cgroup.h>
362306a36Sopenharmony_ci#include <linux/vmalloc.h>
462306a36Sopenharmony_ci#include <linux/mm.h>
562306a36Sopenharmony_ci
662306a36Sopenharmony_ci#include <linux/swapops.h> /* depends on mm.h include */
762306a36Sopenharmony_ci
862306a36Sopenharmony_cistatic DEFINE_MUTEX(swap_cgroup_mutex);
962306a36Sopenharmony_cistruct swap_cgroup_ctrl {
1062306a36Sopenharmony_ci	struct page **map;
1162306a36Sopenharmony_ci	unsigned long length;
1262306a36Sopenharmony_ci	spinlock_t	lock;
1362306a36Sopenharmony_ci};
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_cistatic struct swap_cgroup_ctrl swap_cgroup_ctrl[MAX_SWAPFILES];
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_cistruct swap_cgroup {
1862306a36Sopenharmony_ci	unsigned short		id;
1962306a36Sopenharmony_ci};
2062306a36Sopenharmony_ci#define SC_PER_PAGE	(PAGE_SIZE/sizeof(struct swap_cgroup))
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci/*
2362306a36Sopenharmony_ci * SwapCgroup implements "lookup" and "exchange" operations.
2462306a36Sopenharmony_ci * In typical usage, this swap_cgroup is accessed via memcg's charge/uncharge
2562306a36Sopenharmony_ci * against SwapCache. At swap_free(), this is accessed directly from swap.
2662306a36Sopenharmony_ci *
2762306a36Sopenharmony_ci * This means,
2862306a36Sopenharmony_ci *  - we have no race in "exchange" when we're accessed via SwapCache because
2962306a36Sopenharmony_ci *    SwapCache(and its swp_entry) is under lock.
3062306a36Sopenharmony_ci *  - When called via swap_free(), there is no user of this entry and no race.
3162306a36Sopenharmony_ci * Then, we don't need lock around "exchange".
3262306a36Sopenharmony_ci *
3362306a36Sopenharmony_ci * TODO: we can push these buffers out to HIGHMEM.
3462306a36Sopenharmony_ci */
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci/*
3762306a36Sopenharmony_ci * allocate buffer for swap_cgroup.
3862306a36Sopenharmony_ci */
3962306a36Sopenharmony_cistatic int swap_cgroup_prepare(int type)
4062306a36Sopenharmony_ci{
4162306a36Sopenharmony_ci	struct page *page;
4262306a36Sopenharmony_ci	struct swap_cgroup_ctrl *ctrl;
4362306a36Sopenharmony_ci	unsigned long idx, max;
4462306a36Sopenharmony_ci
4562306a36Sopenharmony_ci	ctrl = &swap_cgroup_ctrl[type];
4662306a36Sopenharmony_ci
4762306a36Sopenharmony_ci	for (idx = 0; idx < ctrl->length; idx++) {
4862306a36Sopenharmony_ci		page = alloc_page(GFP_KERNEL | __GFP_ZERO);
4962306a36Sopenharmony_ci		if (!page)
5062306a36Sopenharmony_ci			goto not_enough_page;
5162306a36Sopenharmony_ci		ctrl->map[idx] = page;
5262306a36Sopenharmony_ci
5362306a36Sopenharmony_ci		if (!(idx % SWAP_CLUSTER_MAX))
5462306a36Sopenharmony_ci			cond_resched();
5562306a36Sopenharmony_ci	}
5662306a36Sopenharmony_ci	return 0;
5762306a36Sopenharmony_cinot_enough_page:
5862306a36Sopenharmony_ci	max = idx;
5962306a36Sopenharmony_ci	for (idx = 0; idx < max; idx++)
6062306a36Sopenharmony_ci		__free_page(ctrl->map[idx]);
6162306a36Sopenharmony_ci
6262306a36Sopenharmony_ci	return -ENOMEM;
6362306a36Sopenharmony_ci}
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_cistatic struct swap_cgroup *__lookup_swap_cgroup(struct swap_cgroup_ctrl *ctrl,
6662306a36Sopenharmony_ci						pgoff_t offset)
6762306a36Sopenharmony_ci{
6862306a36Sopenharmony_ci	struct page *mappage;
6962306a36Sopenharmony_ci	struct swap_cgroup *sc;
7062306a36Sopenharmony_ci
7162306a36Sopenharmony_ci	mappage = ctrl->map[offset / SC_PER_PAGE];
7262306a36Sopenharmony_ci	sc = page_address(mappage);
7362306a36Sopenharmony_ci	return sc + offset % SC_PER_PAGE;
7462306a36Sopenharmony_ci}
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_cistatic struct swap_cgroup *lookup_swap_cgroup(swp_entry_t ent,
7762306a36Sopenharmony_ci					struct swap_cgroup_ctrl **ctrlp)
7862306a36Sopenharmony_ci{
7962306a36Sopenharmony_ci	pgoff_t offset = swp_offset(ent);
8062306a36Sopenharmony_ci	struct swap_cgroup_ctrl *ctrl;
8162306a36Sopenharmony_ci
8262306a36Sopenharmony_ci	ctrl = &swap_cgroup_ctrl[swp_type(ent)];
8362306a36Sopenharmony_ci	if (ctrlp)
8462306a36Sopenharmony_ci		*ctrlp = ctrl;
8562306a36Sopenharmony_ci	return __lookup_swap_cgroup(ctrl, offset);
8662306a36Sopenharmony_ci}
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_ci/**
8962306a36Sopenharmony_ci * swap_cgroup_cmpxchg - cmpxchg mem_cgroup's id for this swp_entry.
9062306a36Sopenharmony_ci * @ent: swap entry to be cmpxchged
9162306a36Sopenharmony_ci * @old: old id
9262306a36Sopenharmony_ci * @new: new id
9362306a36Sopenharmony_ci *
9462306a36Sopenharmony_ci * Returns old id at success, 0 at failure.
9562306a36Sopenharmony_ci * (There is no mem_cgroup using 0 as its id)
9662306a36Sopenharmony_ci */
9762306a36Sopenharmony_ciunsigned short swap_cgroup_cmpxchg(swp_entry_t ent,
9862306a36Sopenharmony_ci					unsigned short old, unsigned short new)
9962306a36Sopenharmony_ci{
10062306a36Sopenharmony_ci	struct swap_cgroup_ctrl *ctrl;
10162306a36Sopenharmony_ci	struct swap_cgroup *sc;
10262306a36Sopenharmony_ci	unsigned long flags;
10362306a36Sopenharmony_ci	unsigned short retval;
10462306a36Sopenharmony_ci
10562306a36Sopenharmony_ci	sc = lookup_swap_cgroup(ent, &ctrl);
10662306a36Sopenharmony_ci
10762306a36Sopenharmony_ci	spin_lock_irqsave(&ctrl->lock, flags);
10862306a36Sopenharmony_ci	retval = sc->id;
10962306a36Sopenharmony_ci	if (retval == old)
11062306a36Sopenharmony_ci		sc->id = new;
11162306a36Sopenharmony_ci	else
11262306a36Sopenharmony_ci		retval = 0;
11362306a36Sopenharmony_ci	spin_unlock_irqrestore(&ctrl->lock, flags);
11462306a36Sopenharmony_ci	return retval;
11562306a36Sopenharmony_ci}
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_ci/**
11862306a36Sopenharmony_ci * swap_cgroup_record - record mem_cgroup for a set of swap entries
11962306a36Sopenharmony_ci * @ent: the first swap entry to be recorded into
12062306a36Sopenharmony_ci * @id: mem_cgroup to be recorded
12162306a36Sopenharmony_ci * @nr_ents: number of swap entries to be recorded
12262306a36Sopenharmony_ci *
12362306a36Sopenharmony_ci * Returns old value at success, 0 at failure.
12462306a36Sopenharmony_ci * (Of course, old value can be 0.)
12562306a36Sopenharmony_ci */
12662306a36Sopenharmony_ciunsigned short swap_cgroup_record(swp_entry_t ent, unsigned short id,
12762306a36Sopenharmony_ci				  unsigned int nr_ents)
12862306a36Sopenharmony_ci{
12962306a36Sopenharmony_ci	struct swap_cgroup_ctrl *ctrl;
13062306a36Sopenharmony_ci	struct swap_cgroup *sc;
13162306a36Sopenharmony_ci	unsigned short old;
13262306a36Sopenharmony_ci	unsigned long flags;
13362306a36Sopenharmony_ci	pgoff_t offset = swp_offset(ent);
13462306a36Sopenharmony_ci	pgoff_t end = offset + nr_ents;
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_ci	sc = lookup_swap_cgroup(ent, &ctrl);
13762306a36Sopenharmony_ci
13862306a36Sopenharmony_ci	spin_lock_irqsave(&ctrl->lock, flags);
13962306a36Sopenharmony_ci	old = sc->id;
14062306a36Sopenharmony_ci	for (;;) {
14162306a36Sopenharmony_ci		VM_BUG_ON(sc->id != old);
14262306a36Sopenharmony_ci		sc->id = id;
14362306a36Sopenharmony_ci		offset++;
14462306a36Sopenharmony_ci		if (offset == end)
14562306a36Sopenharmony_ci			break;
14662306a36Sopenharmony_ci		if (offset % SC_PER_PAGE)
14762306a36Sopenharmony_ci			sc++;
14862306a36Sopenharmony_ci		else
14962306a36Sopenharmony_ci			sc = __lookup_swap_cgroup(ctrl, offset);
15062306a36Sopenharmony_ci	}
15162306a36Sopenharmony_ci	spin_unlock_irqrestore(&ctrl->lock, flags);
15262306a36Sopenharmony_ci
15362306a36Sopenharmony_ci	return old;
15462306a36Sopenharmony_ci}
15562306a36Sopenharmony_ci
15662306a36Sopenharmony_ci/**
15762306a36Sopenharmony_ci * lookup_swap_cgroup_id - lookup mem_cgroup id tied to swap entry
15862306a36Sopenharmony_ci * @ent: swap entry to be looked up.
15962306a36Sopenharmony_ci *
16062306a36Sopenharmony_ci * Returns ID of mem_cgroup at success. 0 at failure. (0 is invalid ID)
16162306a36Sopenharmony_ci */
16262306a36Sopenharmony_ciunsigned short lookup_swap_cgroup_id(swp_entry_t ent)
16362306a36Sopenharmony_ci{
16462306a36Sopenharmony_ci	return lookup_swap_cgroup(ent, NULL)->id;
16562306a36Sopenharmony_ci}
16662306a36Sopenharmony_ci
16762306a36Sopenharmony_ciint swap_cgroup_swapon(int type, unsigned long max_pages)
16862306a36Sopenharmony_ci{
16962306a36Sopenharmony_ci	void *array;
17062306a36Sopenharmony_ci	unsigned long length;
17162306a36Sopenharmony_ci	struct swap_cgroup_ctrl *ctrl;
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_ci	if (mem_cgroup_disabled())
17462306a36Sopenharmony_ci		return 0;
17562306a36Sopenharmony_ci
17662306a36Sopenharmony_ci	length = DIV_ROUND_UP(max_pages, SC_PER_PAGE);
17762306a36Sopenharmony_ci
17862306a36Sopenharmony_ci	array = vcalloc(length, sizeof(void *));
17962306a36Sopenharmony_ci	if (!array)
18062306a36Sopenharmony_ci		goto nomem;
18162306a36Sopenharmony_ci
18262306a36Sopenharmony_ci	ctrl = &swap_cgroup_ctrl[type];
18362306a36Sopenharmony_ci	mutex_lock(&swap_cgroup_mutex);
18462306a36Sopenharmony_ci	ctrl->length = length;
18562306a36Sopenharmony_ci	ctrl->map = array;
18662306a36Sopenharmony_ci	spin_lock_init(&ctrl->lock);
18762306a36Sopenharmony_ci	if (swap_cgroup_prepare(type)) {
18862306a36Sopenharmony_ci		/* memory shortage */
18962306a36Sopenharmony_ci		ctrl->map = NULL;
19062306a36Sopenharmony_ci		ctrl->length = 0;
19162306a36Sopenharmony_ci		mutex_unlock(&swap_cgroup_mutex);
19262306a36Sopenharmony_ci		vfree(array);
19362306a36Sopenharmony_ci		goto nomem;
19462306a36Sopenharmony_ci	}
19562306a36Sopenharmony_ci	mutex_unlock(&swap_cgroup_mutex);
19662306a36Sopenharmony_ci
19762306a36Sopenharmony_ci	return 0;
19862306a36Sopenharmony_cinomem:
19962306a36Sopenharmony_ci	pr_info("couldn't allocate enough memory for swap_cgroup\n");
20062306a36Sopenharmony_ci	pr_info("swap_cgroup can be disabled by swapaccount=0 boot option\n");
20162306a36Sopenharmony_ci	return -ENOMEM;
20262306a36Sopenharmony_ci}
20362306a36Sopenharmony_ci
20462306a36Sopenharmony_civoid swap_cgroup_swapoff(int type)
20562306a36Sopenharmony_ci{
20662306a36Sopenharmony_ci	struct page **map;
20762306a36Sopenharmony_ci	unsigned long i, length;
20862306a36Sopenharmony_ci	struct swap_cgroup_ctrl *ctrl;
20962306a36Sopenharmony_ci
21062306a36Sopenharmony_ci	if (mem_cgroup_disabled())
21162306a36Sopenharmony_ci		return;
21262306a36Sopenharmony_ci
21362306a36Sopenharmony_ci	mutex_lock(&swap_cgroup_mutex);
21462306a36Sopenharmony_ci	ctrl = &swap_cgroup_ctrl[type];
21562306a36Sopenharmony_ci	map = ctrl->map;
21662306a36Sopenharmony_ci	length = ctrl->length;
21762306a36Sopenharmony_ci	ctrl->map = NULL;
21862306a36Sopenharmony_ci	ctrl->length = 0;
21962306a36Sopenharmony_ci	mutex_unlock(&swap_cgroup_mutex);
22062306a36Sopenharmony_ci
22162306a36Sopenharmony_ci	if (map) {
22262306a36Sopenharmony_ci		for (i = 0; i < length; i++) {
22362306a36Sopenharmony_ci			struct page *page = map[i];
22462306a36Sopenharmony_ci			if (page)
22562306a36Sopenharmony_ci				__free_page(page);
22662306a36Sopenharmony_ci			if (!(i % SWAP_CLUSTER_MAX))
22762306a36Sopenharmony_ci				cond_resched();
22862306a36Sopenharmony_ci		}
22962306a36Sopenharmony_ci		vfree(map);
23062306a36Sopenharmony_ci	}
23162306a36Sopenharmony_ci}
232