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 * when set with prctl()
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_ci/* snippet from wikipedia :-) */
3262306a36Sopenharmony_ci
3362306a36Sopenharmony_cistatic uint64_t rdtsc(void)
3462306a36Sopenharmony_ci{
3562306a36Sopenharmony_ciuint32_t lo, hi;
3662306a36Sopenharmony_ci/* We cannot use "=A", since this would use %rax on x86_64 */
3762306a36Sopenharmony_ci__asm__ __volatile__ ("rdtsc" : "=a" (lo), "=d" (hi));
3862306a36Sopenharmony_cireturn (uint64_t)hi << 32 | lo;
3962306a36Sopenharmony_ci}
4062306a36Sopenharmony_ci
4162306a36Sopenharmony_ciint should_segv = 0;
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_cistatic void sigsegv_cb(int sig)
4462306a36Sopenharmony_ci{
4562306a36Sopenharmony_ci	if (!should_segv)
4662306a36Sopenharmony_ci	{
4762306a36Sopenharmony_ci		fprintf(stderr, "FATAL ERROR, rdtsc() failed while enabled\n");
4862306a36Sopenharmony_ci		exit(0);
4962306a36Sopenharmony_ci	}
5062306a36Sopenharmony_ci	if (prctl(PR_SET_TSC, PR_TSC_ENABLE) < 0)
5162306a36Sopenharmony_ci	{
5262306a36Sopenharmony_ci		perror("prctl");
5362306a36Sopenharmony_ci		exit(0);
5462306a36Sopenharmony_ci	}
5562306a36Sopenharmony_ci	should_segv = 0;
5662306a36Sopenharmony_ci
5762306a36Sopenharmony_ci	rdtsc();
5862306a36Sopenharmony_ci}
5962306a36Sopenharmony_ci
6062306a36Sopenharmony_cistatic void task(void)
6162306a36Sopenharmony_ci{
6262306a36Sopenharmony_ci	signal(SIGSEGV, sigsegv_cb);
6362306a36Sopenharmony_ci	alarm(10);
6462306a36Sopenharmony_ci	for(;;)
6562306a36Sopenharmony_ci	{
6662306a36Sopenharmony_ci		rdtsc();
6762306a36Sopenharmony_ci		if (should_segv)
6862306a36Sopenharmony_ci		{
6962306a36Sopenharmony_ci			fprintf(stderr, "FATAL ERROR, rdtsc() succeeded while disabled\n");
7062306a36Sopenharmony_ci			exit(0);
7162306a36Sopenharmony_ci		}
7262306a36Sopenharmony_ci		if (prctl(PR_SET_TSC, PR_TSC_SIGSEGV) < 0)
7362306a36Sopenharmony_ci		{
7462306a36Sopenharmony_ci			perror("prctl");
7562306a36Sopenharmony_ci			exit(0);
7662306a36Sopenharmony_ci		}
7762306a36Sopenharmony_ci		should_segv = 1;
7862306a36Sopenharmony_ci	}
7962306a36Sopenharmony_ci}
8062306a36Sopenharmony_ci
8162306a36Sopenharmony_ci
8262306a36Sopenharmony_ciint main(void)
8362306a36Sopenharmony_ci{
8462306a36Sopenharmony_ci	int n_tasks = 100, i;
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_ci	fprintf(stderr, "[No further output means we're all right]\n");
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_ci	for (i=0; i<n_tasks; i++)
8962306a36Sopenharmony_ci		if (fork() == 0)
9062306a36Sopenharmony_ci			task();
9162306a36Sopenharmony_ci
9262306a36Sopenharmony_ci	for (i=0; i<n_tasks; i++)
9362306a36Sopenharmony_ci		wait(NULL);
9462306a36Sopenharmony_ci
9562306a36Sopenharmony_ci	exit(0);
9662306a36Sopenharmony_ci}
9762306a36Sopenharmony_ci
98