18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Tests for prctl(PR_GET_TSC, ...) / prctl(PR_SET_TSC, ...)
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Tests if the control register is updated correctly
68c2ecf20Sopenharmony_ci * at context switches
78c2ecf20Sopenharmony_ci *
88c2ecf20Sopenharmony_ci * Warning: this test will cause a very high load for a few seconds
98c2ecf20Sopenharmony_ci *
108c2ecf20Sopenharmony_ci */
118c2ecf20Sopenharmony_ci
128c2ecf20Sopenharmony_ci#include <stdio.h>
138c2ecf20Sopenharmony_ci#include <stdlib.h>
148c2ecf20Sopenharmony_ci#include <unistd.h>
158c2ecf20Sopenharmony_ci#include <signal.h>
168c2ecf20Sopenharmony_ci#include <inttypes.h>
178c2ecf20Sopenharmony_ci#include <wait.h>
188c2ecf20Sopenharmony_ci
198c2ecf20Sopenharmony_ci
208c2ecf20Sopenharmony_ci#include <sys/prctl.h>
218c2ecf20Sopenharmony_ci#include <linux/prctl.h>
228c2ecf20Sopenharmony_ci
238c2ecf20Sopenharmony_ci/* Get/set the process' ability to use the timestamp counter instruction */
248c2ecf20Sopenharmony_ci#ifndef PR_GET_TSC
258c2ecf20Sopenharmony_ci#define PR_GET_TSC 25
268c2ecf20Sopenharmony_ci#define PR_SET_TSC 26
278c2ecf20Sopenharmony_ci# define PR_TSC_ENABLE		1   /* allow the use of the timestamp counter */
288c2ecf20Sopenharmony_ci# define PR_TSC_SIGSEGV		2   /* throw a SIGSEGV instead of reading the TSC */
298c2ecf20Sopenharmony_ci#endif
308c2ecf20Sopenharmony_ci
318c2ecf20Sopenharmony_cistatic uint64_t rdtsc(void)
328c2ecf20Sopenharmony_ci{
338c2ecf20Sopenharmony_ciuint32_t lo, hi;
348c2ecf20Sopenharmony_ci/* We cannot use "=A", since this would use %rax on x86_64 */
358c2ecf20Sopenharmony_ci__asm__ __volatile__ ("rdtsc" : "=a" (lo), "=d" (hi));
368c2ecf20Sopenharmony_cireturn (uint64_t)hi << 32 | lo;
378c2ecf20Sopenharmony_ci}
388c2ecf20Sopenharmony_ci
398c2ecf20Sopenharmony_cistatic void sigsegv_expect(int sig)
408c2ecf20Sopenharmony_ci{
418c2ecf20Sopenharmony_ci	/* */
428c2ecf20Sopenharmony_ci}
438c2ecf20Sopenharmony_ci
448c2ecf20Sopenharmony_cistatic void segvtask(void)
458c2ecf20Sopenharmony_ci{
468c2ecf20Sopenharmony_ci	if (prctl(PR_SET_TSC, PR_TSC_SIGSEGV) < 0)
478c2ecf20Sopenharmony_ci	{
488c2ecf20Sopenharmony_ci		perror("prctl");
498c2ecf20Sopenharmony_ci		exit(0);
508c2ecf20Sopenharmony_ci	}
518c2ecf20Sopenharmony_ci	signal(SIGSEGV, sigsegv_expect);
528c2ecf20Sopenharmony_ci	alarm(10);
538c2ecf20Sopenharmony_ci	rdtsc();
548c2ecf20Sopenharmony_ci	fprintf(stderr, "FATAL ERROR, rdtsc() succeeded while disabled\n");
558c2ecf20Sopenharmony_ci	exit(0);
568c2ecf20Sopenharmony_ci}
578c2ecf20Sopenharmony_ci
588c2ecf20Sopenharmony_ci
598c2ecf20Sopenharmony_cistatic void sigsegv_fail(int sig)
608c2ecf20Sopenharmony_ci{
618c2ecf20Sopenharmony_ci	fprintf(stderr, "FATAL ERROR, rdtsc() failed while enabled\n");
628c2ecf20Sopenharmony_ci	exit(0);
638c2ecf20Sopenharmony_ci}
648c2ecf20Sopenharmony_ci
658c2ecf20Sopenharmony_cistatic void rdtsctask(void)
668c2ecf20Sopenharmony_ci{
678c2ecf20Sopenharmony_ci	if (prctl(PR_SET_TSC, PR_TSC_ENABLE) < 0)
688c2ecf20Sopenharmony_ci	{
698c2ecf20Sopenharmony_ci		perror("prctl");
708c2ecf20Sopenharmony_ci		exit(0);
718c2ecf20Sopenharmony_ci	}
728c2ecf20Sopenharmony_ci	signal(SIGSEGV, sigsegv_fail);
738c2ecf20Sopenharmony_ci	alarm(10);
748c2ecf20Sopenharmony_ci	for(;;) rdtsc();
758c2ecf20Sopenharmony_ci}
768c2ecf20Sopenharmony_ci
778c2ecf20Sopenharmony_ci
788c2ecf20Sopenharmony_ciint main(void)
798c2ecf20Sopenharmony_ci{
808c2ecf20Sopenharmony_ci	int n_tasks = 100, i;
818c2ecf20Sopenharmony_ci
828c2ecf20Sopenharmony_ci	fprintf(stderr, "[No further output means we're allright]\n");
838c2ecf20Sopenharmony_ci
848c2ecf20Sopenharmony_ci	for (i=0; i<n_tasks; i++)
858c2ecf20Sopenharmony_ci		if (fork() == 0)
868c2ecf20Sopenharmony_ci		{
878c2ecf20Sopenharmony_ci			if (i & 1)
888c2ecf20Sopenharmony_ci				segvtask();
898c2ecf20Sopenharmony_ci			else
908c2ecf20Sopenharmony_ci				rdtsctask();
918c2ecf20Sopenharmony_ci		}
928c2ecf20Sopenharmony_ci
938c2ecf20Sopenharmony_ci	for (i=0; i<n_tasks; i++)
948c2ecf20Sopenharmony_ci		wait(NULL);
958c2ecf20Sopenharmony_ci
968c2ecf20Sopenharmony_ci	exit(0);
978c2ecf20Sopenharmony_ci}
988c2ecf20Sopenharmony_ci
99