162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * The main purpose of the tests here is to exercise the migration entry code
462306a36Sopenharmony_ci * paths in the kernel.
562306a36Sopenharmony_ci */
662306a36Sopenharmony_ci
762306a36Sopenharmony_ci#include "../kselftest_harness.h"
862306a36Sopenharmony_ci#include <strings.h>
962306a36Sopenharmony_ci#include <pthread.h>
1062306a36Sopenharmony_ci#include <numa.h>
1162306a36Sopenharmony_ci#include <numaif.h>
1262306a36Sopenharmony_ci#include <sys/mman.h>
1362306a36Sopenharmony_ci#include <sys/prctl.h>
1462306a36Sopenharmony_ci#include <sys/types.h>
1562306a36Sopenharmony_ci#include <signal.h>
1662306a36Sopenharmony_ci#include <time.h>
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ci#define TWOMEG (2<<20)
1962306a36Sopenharmony_ci#define RUNTIME (20)
2062306a36Sopenharmony_ci
2162306a36Sopenharmony_ci#define ALIGN(x, a) (((x) + (a - 1)) & (~((a) - 1)))
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ciFIXTURE(migration)
2462306a36Sopenharmony_ci{
2562306a36Sopenharmony_ci	pthread_t *threads;
2662306a36Sopenharmony_ci	pid_t *pids;
2762306a36Sopenharmony_ci	int nthreads;
2862306a36Sopenharmony_ci	int n1;
2962306a36Sopenharmony_ci	int n2;
3062306a36Sopenharmony_ci};
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_ciFIXTURE_SETUP(migration)
3362306a36Sopenharmony_ci{
3462306a36Sopenharmony_ci	int n;
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci	ASSERT_EQ(numa_available(), 0);
3762306a36Sopenharmony_ci	self->nthreads = numa_num_task_cpus() - 1;
3862306a36Sopenharmony_ci	self->n1 = -1;
3962306a36Sopenharmony_ci	self->n2 = -1;
4062306a36Sopenharmony_ci
4162306a36Sopenharmony_ci	for (n = 0; n < numa_max_possible_node(); n++)
4262306a36Sopenharmony_ci		if (numa_bitmask_isbitset(numa_all_nodes_ptr, n)) {
4362306a36Sopenharmony_ci			if (self->n1 == -1) {
4462306a36Sopenharmony_ci				self->n1 = n;
4562306a36Sopenharmony_ci			} else {
4662306a36Sopenharmony_ci				self->n2 = n;
4762306a36Sopenharmony_ci				break;
4862306a36Sopenharmony_ci			}
4962306a36Sopenharmony_ci		}
5062306a36Sopenharmony_ci
5162306a36Sopenharmony_ci	self->threads = malloc(self->nthreads * sizeof(*self->threads));
5262306a36Sopenharmony_ci	ASSERT_NE(self->threads, NULL);
5362306a36Sopenharmony_ci	self->pids = malloc(self->nthreads * sizeof(*self->pids));
5462306a36Sopenharmony_ci	ASSERT_NE(self->pids, NULL);
5562306a36Sopenharmony_ci};
5662306a36Sopenharmony_ci
5762306a36Sopenharmony_ciFIXTURE_TEARDOWN(migration)
5862306a36Sopenharmony_ci{
5962306a36Sopenharmony_ci	free(self->threads);
6062306a36Sopenharmony_ci	free(self->pids);
6162306a36Sopenharmony_ci}
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_ciint migrate(uint64_t *ptr, int n1, int n2)
6462306a36Sopenharmony_ci{
6562306a36Sopenharmony_ci	int ret, tmp;
6662306a36Sopenharmony_ci	int status = 0;
6762306a36Sopenharmony_ci	struct timespec ts1, ts2;
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_ci	if (clock_gettime(CLOCK_MONOTONIC, &ts1))
7062306a36Sopenharmony_ci		return -1;
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_ci	while (1) {
7362306a36Sopenharmony_ci		if (clock_gettime(CLOCK_MONOTONIC, &ts2))
7462306a36Sopenharmony_ci			return -1;
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_ci		if (ts2.tv_sec - ts1.tv_sec >= RUNTIME)
7762306a36Sopenharmony_ci			return 0;
7862306a36Sopenharmony_ci
7962306a36Sopenharmony_ci		ret = move_pages(0, 1, (void **) &ptr, &n2, &status,
8062306a36Sopenharmony_ci				MPOL_MF_MOVE_ALL);
8162306a36Sopenharmony_ci		if (ret) {
8262306a36Sopenharmony_ci			if (ret > 0)
8362306a36Sopenharmony_ci				printf("Didn't migrate %d pages\n", ret);
8462306a36Sopenharmony_ci			else
8562306a36Sopenharmony_ci				perror("Couldn't migrate pages");
8662306a36Sopenharmony_ci			return -2;
8762306a36Sopenharmony_ci		}
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_ci		tmp = n2;
9062306a36Sopenharmony_ci		n2 = n1;
9162306a36Sopenharmony_ci		n1 = tmp;
9262306a36Sopenharmony_ci	}
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_ci	return 0;
9562306a36Sopenharmony_ci}
9662306a36Sopenharmony_ci
9762306a36Sopenharmony_civoid *access_mem(void *ptr)
9862306a36Sopenharmony_ci{
9962306a36Sopenharmony_ci	volatile uint64_t y = 0;
10062306a36Sopenharmony_ci	volatile uint64_t *x = ptr;
10162306a36Sopenharmony_ci
10262306a36Sopenharmony_ci	while (1) {
10362306a36Sopenharmony_ci		pthread_testcancel();
10462306a36Sopenharmony_ci		y += *x;
10562306a36Sopenharmony_ci
10662306a36Sopenharmony_ci		/* Prevent the compiler from optimizing out the writes to y: */
10762306a36Sopenharmony_ci		asm volatile("" : "+r" (y));
10862306a36Sopenharmony_ci	}
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_ci	return NULL;
11162306a36Sopenharmony_ci}
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_ci/*
11462306a36Sopenharmony_ci * Basic migration entry testing. One thread will move pages back and forth
11562306a36Sopenharmony_ci * between nodes whilst other threads try and access them triggering the
11662306a36Sopenharmony_ci * migration entry wait paths in the kernel.
11762306a36Sopenharmony_ci */
11862306a36Sopenharmony_ciTEST_F_TIMEOUT(migration, private_anon, 2*RUNTIME)
11962306a36Sopenharmony_ci{
12062306a36Sopenharmony_ci	uint64_t *ptr;
12162306a36Sopenharmony_ci	int i;
12262306a36Sopenharmony_ci
12362306a36Sopenharmony_ci	if (self->nthreads < 2 || self->n1 < 0 || self->n2 < 0)
12462306a36Sopenharmony_ci		SKIP(return, "Not enough threads or NUMA nodes available");
12562306a36Sopenharmony_ci
12662306a36Sopenharmony_ci	ptr = mmap(NULL, TWOMEG, PROT_READ | PROT_WRITE,
12762306a36Sopenharmony_ci		MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
12862306a36Sopenharmony_ci	ASSERT_NE(ptr, MAP_FAILED);
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_ci	memset(ptr, 0xde, TWOMEG);
13162306a36Sopenharmony_ci	for (i = 0; i < self->nthreads - 1; i++)
13262306a36Sopenharmony_ci		if (pthread_create(&self->threads[i], NULL, access_mem, ptr))
13362306a36Sopenharmony_ci			perror("Couldn't create thread");
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_ci	ASSERT_EQ(migrate(ptr, self->n1, self->n2), 0);
13662306a36Sopenharmony_ci	for (i = 0; i < self->nthreads - 1; i++)
13762306a36Sopenharmony_ci		ASSERT_EQ(pthread_cancel(self->threads[i]), 0);
13862306a36Sopenharmony_ci}
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_ci/*
14162306a36Sopenharmony_ci * Same as the previous test but with shared memory.
14262306a36Sopenharmony_ci */
14362306a36Sopenharmony_ciTEST_F_TIMEOUT(migration, shared_anon, 2*RUNTIME)
14462306a36Sopenharmony_ci{
14562306a36Sopenharmony_ci	pid_t pid;
14662306a36Sopenharmony_ci	uint64_t *ptr;
14762306a36Sopenharmony_ci	int i;
14862306a36Sopenharmony_ci
14962306a36Sopenharmony_ci	if (self->nthreads < 2 || self->n1 < 0 || self->n2 < 0)
15062306a36Sopenharmony_ci		SKIP(return, "Not enough threads or NUMA nodes available");
15162306a36Sopenharmony_ci
15262306a36Sopenharmony_ci	ptr = mmap(NULL, TWOMEG, PROT_READ | PROT_WRITE,
15362306a36Sopenharmony_ci		MAP_SHARED | MAP_ANONYMOUS, -1, 0);
15462306a36Sopenharmony_ci	ASSERT_NE(ptr, MAP_FAILED);
15562306a36Sopenharmony_ci
15662306a36Sopenharmony_ci	memset(ptr, 0xde, TWOMEG);
15762306a36Sopenharmony_ci	for (i = 0; i < self->nthreads - 1; i++) {
15862306a36Sopenharmony_ci		pid = fork();
15962306a36Sopenharmony_ci		if (!pid) {
16062306a36Sopenharmony_ci			prctl(PR_SET_PDEATHSIG, SIGHUP);
16162306a36Sopenharmony_ci			/* Parent may have died before prctl so check now. */
16262306a36Sopenharmony_ci			if (getppid() == 1)
16362306a36Sopenharmony_ci				kill(getpid(), SIGHUP);
16462306a36Sopenharmony_ci			access_mem(ptr);
16562306a36Sopenharmony_ci		} else {
16662306a36Sopenharmony_ci			self->pids[i] = pid;
16762306a36Sopenharmony_ci		}
16862306a36Sopenharmony_ci	}
16962306a36Sopenharmony_ci
17062306a36Sopenharmony_ci	ASSERT_EQ(migrate(ptr, self->n1, self->n2), 0);
17162306a36Sopenharmony_ci	for (i = 0; i < self->nthreads - 1; i++)
17262306a36Sopenharmony_ci		ASSERT_EQ(kill(self->pids[i], SIGTERM), 0);
17362306a36Sopenharmony_ci}
17462306a36Sopenharmony_ci
17562306a36Sopenharmony_ci/*
17662306a36Sopenharmony_ci * Tests the pmd migration entry paths.
17762306a36Sopenharmony_ci */
17862306a36Sopenharmony_ciTEST_F_TIMEOUT(migration, private_anon_thp, 2*RUNTIME)
17962306a36Sopenharmony_ci{
18062306a36Sopenharmony_ci	uint64_t *ptr;
18162306a36Sopenharmony_ci	int i;
18262306a36Sopenharmony_ci
18362306a36Sopenharmony_ci	if (self->nthreads < 2 || self->n1 < 0 || self->n2 < 0)
18462306a36Sopenharmony_ci		SKIP(return, "Not enough threads or NUMA nodes available");
18562306a36Sopenharmony_ci
18662306a36Sopenharmony_ci	ptr = mmap(NULL, 2*TWOMEG, PROT_READ | PROT_WRITE,
18762306a36Sopenharmony_ci		MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
18862306a36Sopenharmony_ci	ASSERT_NE(ptr, MAP_FAILED);
18962306a36Sopenharmony_ci
19062306a36Sopenharmony_ci	ptr = (uint64_t *) ALIGN((uintptr_t) ptr, TWOMEG);
19162306a36Sopenharmony_ci	ASSERT_EQ(madvise(ptr, TWOMEG, MADV_HUGEPAGE), 0);
19262306a36Sopenharmony_ci	memset(ptr, 0xde, TWOMEG);
19362306a36Sopenharmony_ci	for (i = 0; i < self->nthreads - 1; i++)
19462306a36Sopenharmony_ci		if (pthread_create(&self->threads[i], NULL, access_mem, ptr))
19562306a36Sopenharmony_ci			perror("Couldn't create thread");
19662306a36Sopenharmony_ci
19762306a36Sopenharmony_ci	ASSERT_EQ(migrate(ptr, self->n1, self->n2), 0);
19862306a36Sopenharmony_ci	for (i = 0; i < self->nthreads - 1; i++)
19962306a36Sopenharmony_ci		ASSERT_EQ(pthread_cancel(self->threads[i]), 0);
20062306a36Sopenharmony_ci}
20162306a36Sopenharmony_ci
20262306a36Sopenharmony_ciTEST_HARNESS_MAIN
203