162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Tests for prctl(PR_GET_TSC, ...) / prctl(PR_SET_TSC, ...)
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Tests if the control register is updated correctly
662306a36Sopenharmony_ci * at context switches
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci * Warning: this test will cause a very high load for a few seconds
962306a36Sopenharmony_ci *
1062306a36Sopenharmony_ci */
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_ci#include <stdio.h>
1362306a36Sopenharmony_ci#include <stdlib.h>
1462306a36Sopenharmony_ci#include <unistd.h>
1562306a36Sopenharmony_ci#include <signal.h>
1662306a36Sopenharmony_ci#include <inttypes.h>
1762306a36Sopenharmony_ci#include <wait.h>
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_ci#include <sys/prctl.h>
2162306a36Sopenharmony_ci#include <linux/prctl.h>
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ci/* Get/set the process' ability to use the timestamp counter instruction */
2462306a36Sopenharmony_ci#ifndef PR_GET_TSC
2562306a36Sopenharmony_ci#define PR_GET_TSC 25
2662306a36Sopenharmony_ci#define PR_SET_TSC 26
2762306a36Sopenharmony_ci# define PR_TSC_ENABLE		1   /* allow the use of the timestamp counter */
2862306a36Sopenharmony_ci# define PR_TSC_SIGSEGV		2   /* throw a SIGSEGV instead of reading the TSC */
2962306a36Sopenharmony_ci#endif
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_cistatic uint64_t rdtsc(void)
3262306a36Sopenharmony_ci{
3362306a36Sopenharmony_ciuint32_t lo, hi;
3462306a36Sopenharmony_ci/* We cannot use "=A", since this would use %rax on x86_64 */
3562306a36Sopenharmony_ci__asm__ __volatile__ ("rdtsc" : "=a" (lo), "=d" (hi));
3662306a36Sopenharmony_cireturn (uint64_t)hi << 32 | lo;
3762306a36Sopenharmony_ci}
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_cistatic void sigsegv_expect(int sig)
4062306a36Sopenharmony_ci{
4162306a36Sopenharmony_ci	/* */
4262306a36Sopenharmony_ci}
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_cistatic void segvtask(void)
4562306a36Sopenharmony_ci{
4662306a36Sopenharmony_ci	if (prctl(PR_SET_TSC, PR_TSC_SIGSEGV) < 0)
4762306a36Sopenharmony_ci	{
4862306a36Sopenharmony_ci		perror("prctl");
4962306a36Sopenharmony_ci		exit(0);
5062306a36Sopenharmony_ci	}
5162306a36Sopenharmony_ci	signal(SIGSEGV, sigsegv_expect);
5262306a36Sopenharmony_ci	alarm(10);
5362306a36Sopenharmony_ci	rdtsc();
5462306a36Sopenharmony_ci	fprintf(stderr, "FATAL ERROR, rdtsc() succeeded while disabled\n");
5562306a36Sopenharmony_ci	exit(0);
5662306a36Sopenharmony_ci}
5762306a36Sopenharmony_ci
5862306a36Sopenharmony_ci
5962306a36Sopenharmony_cistatic void sigsegv_fail(int sig)
6062306a36Sopenharmony_ci{
6162306a36Sopenharmony_ci	fprintf(stderr, "FATAL ERROR, rdtsc() failed while enabled\n");
6262306a36Sopenharmony_ci	exit(0);
6362306a36Sopenharmony_ci}
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_cistatic void rdtsctask(void)
6662306a36Sopenharmony_ci{
6762306a36Sopenharmony_ci	if (prctl(PR_SET_TSC, PR_TSC_ENABLE) < 0)
6862306a36Sopenharmony_ci	{
6962306a36Sopenharmony_ci		perror("prctl");
7062306a36Sopenharmony_ci		exit(0);
7162306a36Sopenharmony_ci	}
7262306a36Sopenharmony_ci	signal(SIGSEGV, sigsegv_fail);
7362306a36Sopenharmony_ci	alarm(10);
7462306a36Sopenharmony_ci	for(;;) rdtsc();
7562306a36Sopenharmony_ci}
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_ci
7862306a36Sopenharmony_ciint main(void)
7962306a36Sopenharmony_ci{
8062306a36Sopenharmony_ci	int n_tasks = 100, i;
8162306a36Sopenharmony_ci
8262306a36Sopenharmony_ci	fprintf(stderr, "[No further output means we're all right]\n");
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_ci	for (i=0; i<n_tasks; i++)
8562306a36Sopenharmony_ci		if (fork() == 0)
8662306a36Sopenharmony_ci		{
8762306a36Sopenharmony_ci			if (i & 1)
8862306a36Sopenharmony_ci				segvtask();
8962306a36Sopenharmony_ci			else
9062306a36Sopenharmony_ci				rdtsctask();
9162306a36Sopenharmony_ci		}
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_ci	for (i=0; i<n_tasks; i++)
9462306a36Sopenharmony_ci		wait(NULL);
9562306a36Sopenharmony_ci
9662306a36Sopenharmony_ci	exit(0);
9762306a36Sopenharmony_ci}
9862306a36Sopenharmony_ci
99