162306a36Sopenharmony_ci#include <fcntl.h>
262306a36Sopenharmony_ci#include <errno.h>
362306a36Sopenharmony_ci#include <stdio.h>
462306a36Sopenharmony_ci#include <stdlib.h>
562306a36Sopenharmony_ci#include <unistd.h>
662306a36Sopenharmony_ci#include <dirent.h>
762306a36Sopenharmony_ci#include <sys/ioctl.h>
862306a36Sopenharmony_ci#include <sys/mman.h>
962306a36Sopenharmony_ci#include <sys/stat.h>
1062306a36Sopenharmony_ci#include <sys/types.h>
1162306a36Sopenharmony_ci#include <pthread.h>
1262306a36Sopenharmony_ci#include <assert.h>
1362306a36Sopenharmony_ci#include <mm/gup_test.h>
1462306a36Sopenharmony_ci#include "../kselftest.h"
1562306a36Sopenharmony_ci#include "vm_util.h"
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#define MB (1UL << 20)
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_ci/* Just the flags we need, copied from mm.h: */
2062306a36Sopenharmony_ci#define FOLL_WRITE	0x01	/* check pte is writable */
2162306a36Sopenharmony_ci#define FOLL_TOUCH	0x02	/* mark page accessed */
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ci#define GUP_TEST_FILE "/sys/kernel/debug/gup_test"
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_cistatic unsigned long cmd = GUP_FAST_BENCHMARK;
2662306a36Sopenharmony_cistatic int gup_fd, repeats = 1;
2762306a36Sopenharmony_cistatic unsigned long size = 128 * MB;
2862306a36Sopenharmony_ci/* Serialize prints */
2962306a36Sopenharmony_cistatic pthread_mutex_t print_mutex = PTHREAD_MUTEX_INITIALIZER;
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_cistatic char *cmd_to_str(unsigned long cmd)
3262306a36Sopenharmony_ci{
3362306a36Sopenharmony_ci	switch (cmd) {
3462306a36Sopenharmony_ci	case GUP_FAST_BENCHMARK:
3562306a36Sopenharmony_ci		return "GUP_FAST_BENCHMARK";
3662306a36Sopenharmony_ci	case PIN_FAST_BENCHMARK:
3762306a36Sopenharmony_ci		return "PIN_FAST_BENCHMARK";
3862306a36Sopenharmony_ci	case PIN_LONGTERM_BENCHMARK:
3962306a36Sopenharmony_ci		return "PIN_LONGTERM_BENCHMARK";
4062306a36Sopenharmony_ci	case GUP_BASIC_TEST:
4162306a36Sopenharmony_ci		return "GUP_BASIC_TEST";
4262306a36Sopenharmony_ci	case PIN_BASIC_TEST:
4362306a36Sopenharmony_ci		return "PIN_BASIC_TEST";
4462306a36Sopenharmony_ci	case DUMP_USER_PAGES_TEST:
4562306a36Sopenharmony_ci		return "DUMP_USER_PAGES_TEST";
4662306a36Sopenharmony_ci	}
4762306a36Sopenharmony_ci	return "Unknown command";
4862306a36Sopenharmony_ci}
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_civoid *gup_thread(void *data)
5162306a36Sopenharmony_ci{
5262306a36Sopenharmony_ci	struct gup_test gup = *(struct gup_test *)data;
5362306a36Sopenharmony_ci	int i;
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ci	/* Only report timing information on the *_BENCHMARK commands: */
5662306a36Sopenharmony_ci	if ((cmd == PIN_FAST_BENCHMARK) || (cmd == GUP_FAST_BENCHMARK) ||
5762306a36Sopenharmony_ci	     (cmd == PIN_LONGTERM_BENCHMARK)) {
5862306a36Sopenharmony_ci		for (i = 0; i < repeats; i++) {
5962306a36Sopenharmony_ci			gup.size = size;
6062306a36Sopenharmony_ci			if (ioctl(gup_fd, cmd, &gup))
6162306a36Sopenharmony_ci				perror("ioctl"), exit(1);
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_ci			pthread_mutex_lock(&print_mutex);
6462306a36Sopenharmony_ci			printf("%s: Time: get:%lld put:%lld us",
6562306a36Sopenharmony_ci			       cmd_to_str(cmd), gup.get_delta_usec,
6662306a36Sopenharmony_ci			       gup.put_delta_usec);
6762306a36Sopenharmony_ci			if (gup.size != size)
6862306a36Sopenharmony_ci				printf(", truncated (size: %lld)", gup.size);
6962306a36Sopenharmony_ci			printf("\n");
7062306a36Sopenharmony_ci			pthread_mutex_unlock(&print_mutex);
7162306a36Sopenharmony_ci		}
7262306a36Sopenharmony_ci	} else {
7362306a36Sopenharmony_ci		gup.size = size;
7462306a36Sopenharmony_ci		if (ioctl(gup_fd, cmd, &gup)) {
7562306a36Sopenharmony_ci			perror("ioctl");
7662306a36Sopenharmony_ci			exit(1);
7762306a36Sopenharmony_ci		}
7862306a36Sopenharmony_ci
7962306a36Sopenharmony_ci		pthread_mutex_lock(&print_mutex);
8062306a36Sopenharmony_ci		printf("%s: done\n", cmd_to_str(cmd));
8162306a36Sopenharmony_ci		if (gup.size != size)
8262306a36Sopenharmony_ci			printf("Truncated (size: %lld)\n", gup.size);
8362306a36Sopenharmony_ci		pthread_mutex_unlock(&print_mutex);
8462306a36Sopenharmony_ci	}
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_ci	return NULL;
8762306a36Sopenharmony_ci}
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_ciint main(int argc, char **argv)
9062306a36Sopenharmony_ci{
9162306a36Sopenharmony_ci	struct gup_test gup = { 0 };
9262306a36Sopenharmony_ci	int filed, i, opt, nr_pages = 1, thp = -1, write = 1, nthreads = 1, ret;
9362306a36Sopenharmony_ci	int flags = MAP_PRIVATE, touch = 0;
9462306a36Sopenharmony_ci	char *file = "/dev/zero";
9562306a36Sopenharmony_ci	pthread_t *tid;
9662306a36Sopenharmony_ci	char *p;
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_ci	while ((opt = getopt(argc, argv, "m:r:n:F:f:abcj:tTLUuwWSHpz")) != -1) {
9962306a36Sopenharmony_ci		switch (opt) {
10062306a36Sopenharmony_ci		case 'a':
10162306a36Sopenharmony_ci			cmd = PIN_FAST_BENCHMARK;
10262306a36Sopenharmony_ci			break;
10362306a36Sopenharmony_ci		case 'b':
10462306a36Sopenharmony_ci			cmd = PIN_BASIC_TEST;
10562306a36Sopenharmony_ci			break;
10662306a36Sopenharmony_ci		case 'L':
10762306a36Sopenharmony_ci			cmd = PIN_LONGTERM_BENCHMARK;
10862306a36Sopenharmony_ci			break;
10962306a36Sopenharmony_ci		case 'c':
11062306a36Sopenharmony_ci			cmd = DUMP_USER_PAGES_TEST;
11162306a36Sopenharmony_ci			/*
11262306a36Sopenharmony_ci			 * Dump page 0 (index 1). May be overridden later, by
11362306a36Sopenharmony_ci			 * user's non-option arguments.
11462306a36Sopenharmony_ci			 *
11562306a36Sopenharmony_ci			 * .which_pages is zero-based, so that zero can mean "do
11662306a36Sopenharmony_ci			 * nothing".
11762306a36Sopenharmony_ci			 */
11862306a36Sopenharmony_ci			gup.which_pages[0] = 1;
11962306a36Sopenharmony_ci			break;
12062306a36Sopenharmony_ci		case 'p':
12162306a36Sopenharmony_ci			/* works only with DUMP_USER_PAGES_TEST */
12262306a36Sopenharmony_ci			gup.test_flags |= GUP_TEST_FLAG_DUMP_PAGES_USE_PIN;
12362306a36Sopenharmony_ci			break;
12462306a36Sopenharmony_ci		case 'F':
12562306a36Sopenharmony_ci			/* strtol, so you can pass flags in hex form */
12662306a36Sopenharmony_ci			gup.gup_flags = strtol(optarg, 0, 0);
12762306a36Sopenharmony_ci			break;
12862306a36Sopenharmony_ci		case 'j':
12962306a36Sopenharmony_ci			nthreads = atoi(optarg);
13062306a36Sopenharmony_ci			break;
13162306a36Sopenharmony_ci		case 'm':
13262306a36Sopenharmony_ci			size = atoi(optarg) * MB;
13362306a36Sopenharmony_ci			break;
13462306a36Sopenharmony_ci		case 'r':
13562306a36Sopenharmony_ci			repeats = atoi(optarg);
13662306a36Sopenharmony_ci			break;
13762306a36Sopenharmony_ci		case 'n':
13862306a36Sopenharmony_ci			nr_pages = atoi(optarg);
13962306a36Sopenharmony_ci			break;
14062306a36Sopenharmony_ci		case 't':
14162306a36Sopenharmony_ci			thp = 1;
14262306a36Sopenharmony_ci			break;
14362306a36Sopenharmony_ci		case 'T':
14462306a36Sopenharmony_ci			thp = 0;
14562306a36Sopenharmony_ci			break;
14662306a36Sopenharmony_ci		case 'U':
14762306a36Sopenharmony_ci			cmd = GUP_BASIC_TEST;
14862306a36Sopenharmony_ci			break;
14962306a36Sopenharmony_ci		case 'u':
15062306a36Sopenharmony_ci			cmd = GUP_FAST_BENCHMARK;
15162306a36Sopenharmony_ci			break;
15262306a36Sopenharmony_ci		case 'w':
15362306a36Sopenharmony_ci			write = 1;
15462306a36Sopenharmony_ci			break;
15562306a36Sopenharmony_ci		case 'W':
15662306a36Sopenharmony_ci			write = 0;
15762306a36Sopenharmony_ci			break;
15862306a36Sopenharmony_ci		case 'f':
15962306a36Sopenharmony_ci			file = optarg;
16062306a36Sopenharmony_ci			break;
16162306a36Sopenharmony_ci		case 'S':
16262306a36Sopenharmony_ci			flags &= ~MAP_PRIVATE;
16362306a36Sopenharmony_ci			flags |= MAP_SHARED;
16462306a36Sopenharmony_ci			break;
16562306a36Sopenharmony_ci		case 'H':
16662306a36Sopenharmony_ci			flags |= (MAP_HUGETLB | MAP_ANONYMOUS);
16762306a36Sopenharmony_ci			break;
16862306a36Sopenharmony_ci		case 'z':
16962306a36Sopenharmony_ci			/* fault pages in gup, do not fault in userland */
17062306a36Sopenharmony_ci			touch = 1;
17162306a36Sopenharmony_ci			break;
17262306a36Sopenharmony_ci		default:
17362306a36Sopenharmony_ci			return -1;
17462306a36Sopenharmony_ci		}
17562306a36Sopenharmony_ci	}
17662306a36Sopenharmony_ci
17762306a36Sopenharmony_ci	if (optind < argc) {
17862306a36Sopenharmony_ci		int extra_arg_count = 0;
17962306a36Sopenharmony_ci		/*
18062306a36Sopenharmony_ci		 * For example:
18162306a36Sopenharmony_ci		 *
18262306a36Sopenharmony_ci		 *   ./gup_test -c 0 1 0x1001
18362306a36Sopenharmony_ci		 *
18462306a36Sopenharmony_ci		 * ...to dump pages 0, 1, and 4097
18562306a36Sopenharmony_ci		 */
18662306a36Sopenharmony_ci
18762306a36Sopenharmony_ci		while ((optind < argc) &&
18862306a36Sopenharmony_ci		       (extra_arg_count < GUP_TEST_MAX_PAGES_TO_DUMP)) {
18962306a36Sopenharmony_ci			/*
19062306a36Sopenharmony_ci			 * Do the 1-based indexing here, so that the user can
19162306a36Sopenharmony_ci			 * use normal 0-based indexing on the command line.
19262306a36Sopenharmony_ci			 */
19362306a36Sopenharmony_ci			long page_index = strtol(argv[optind], 0, 0) + 1;
19462306a36Sopenharmony_ci
19562306a36Sopenharmony_ci			gup.which_pages[extra_arg_count] = page_index;
19662306a36Sopenharmony_ci			extra_arg_count++;
19762306a36Sopenharmony_ci			optind++;
19862306a36Sopenharmony_ci		}
19962306a36Sopenharmony_ci	}
20062306a36Sopenharmony_ci
20162306a36Sopenharmony_ci	filed = open(file, O_RDWR|O_CREAT);
20262306a36Sopenharmony_ci	if (filed < 0) {
20362306a36Sopenharmony_ci		perror("open");
20462306a36Sopenharmony_ci		exit(filed);
20562306a36Sopenharmony_ci	}
20662306a36Sopenharmony_ci
20762306a36Sopenharmony_ci	gup.nr_pages_per_call = nr_pages;
20862306a36Sopenharmony_ci	if (write)
20962306a36Sopenharmony_ci		gup.gup_flags |= FOLL_WRITE;
21062306a36Sopenharmony_ci
21162306a36Sopenharmony_ci	gup_fd = open(GUP_TEST_FILE, O_RDWR);
21262306a36Sopenharmony_ci	if (gup_fd == -1) {
21362306a36Sopenharmony_ci		switch (errno) {
21462306a36Sopenharmony_ci		case EACCES:
21562306a36Sopenharmony_ci			if (getuid())
21662306a36Sopenharmony_ci				printf("Please run this test as root\n");
21762306a36Sopenharmony_ci			break;
21862306a36Sopenharmony_ci		case ENOENT:
21962306a36Sopenharmony_ci			if (opendir("/sys/kernel/debug") == NULL) {
22062306a36Sopenharmony_ci				printf("mount debugfs at /sys/kernel/debug\n");
22162306a36Sopenharmony_ci				break;
22262306a36Sopenharmony_ci			}
22362306a36Sopenharmony_ci			printf("check if CONFIG_GUP_TEST is enabled in kernel config\n");
22462306a36Sopenharmony_ci			break;
22562306a36Sopenharmony_ci		default:
22662306a36Sopenharmony_ci			perror("failed to open " GUP_TEST_FILE);
22762306a36Sopenharmony_ci			break;
22862306a36Sopenharmony_ci		}
22962306a36Sopenharmony_ci		exit(KSFT_SKIP);
23062306a36Sopenharmony_ci	}
23162306a36Sopenharmony_ci
23262306a36Sopenharmony_ci	p = mmap(NULL, size, PROT_READ | PROT_WRITE, flags, filed, 0);
23362306a36Sopenharmony_ci	if (p == MAP_FAILED) {
23462306a36Sopenharmony_ci		perror("mmap");
23562306a36Sopenharmony_ci		exit(1);
23662306a36Sopenharmony_ci	}
23762306a36Sopenharmony_ci	gup.addr = (unsigned long)p;
23862306a36Sopenharmony_ci
23962306a36Sopenharmony_ci	if (thp == 1)
24062306a36Sopenharmony_ci		madvise(p, size, MADV_HUGEPAGE);
24162306a36Sopenharmony_ci	else if (thp == 0)
24262306a36Sopenharmony_ci		madvise(p, size, MADV_NOHUGEPAGE);
24362306a36Sopenharmony_ci
24462306a36Sopenharmony_ci	/*
24562306a36Sopenharmony_ci	 * FOLL_TOUCH, in gup_test, is used as an either/or case: either
24662306a36Sopenharmony_ci	 * fault pages in from the kernel via FOLL_TOUCH, or fault them
24762306a36Sopenharmony_ci	 * in here, from user space. This allows comparison of performance
24862306a36Sopenharmony_ci	 * between those two cases.
24962306a36Sopenharmony_ci	 */
25062306a36Sopenharmony_ci	if (touch) {
25162306a36Sopenharmony_ci		gup.gup_flags |= FOLL_TOUCH;
25262306a36Sopenharmony_ci	} else {
25362306a36Sopenharmony_ci		for (; (unsigned long)p < gup.addr + size; p += psize())
25462306a36Sopenharmony_ci			p[0] = 0;
25562306a36Sopenharmony_ci	}
25662306a36Sopenharmony_ci
25762306a36Sopenharmony_ci	tid = malloc(sizeof(pthread_t) * nthreads);
25862306a36Sopenharmony_ci	assert(tid);
25962306a36Sopenharmony_ci	for (i = 0; i < nthreads; i++) {
26062306a36Sopenharmony_ci		ret = pthread_create(&tid[i], NULL, gup_thread, &gup);
26162306a36Sopenharmony_ci		assert(ret == 0);
26262306a36Sopenharmony_ci	}
26362306a36Sopenharmony_ci	for (i = 0; i < nthreads; i++) {
26462306a36Sopenharmony_ci		ret = pthread_join(tid[i], NULL);
26562306a36Sopenharmony_ci		assert(ret == 0);
26662306a36Sopenharmony_ci	}
26762306a36Sopenharmony_ci	free(tid);
26862306a36Sopenharmony_ci
26962306a36Sopenharmony_ci	return 0;
27062306a36Sopenharmony_ci}
271