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 * when set with prctl()
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_ci/* snippet from wikipedia :-) */
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_cistatic uint64_t rdtsc(void)
348c2ecf20Sopenharmony_ci{
358c2ecf20Sopenharmony_ciuint32_t lo, hi;
368c2ecf20Sopenharmony_ci/* We cannot use "=A", since this would use %rax on x86_64 */
378c2ecf20Sopenharmony_ci__asm__ __volatile__ ("rdtsc" : "=a" (lo), "=d" (hi));
388c2ecf20Sopenharmony_cireturn (uint64_t)hi << 32 | lo;
398c2ecf20Sopenharmony_ci}
408c2ecf20Sopenharmony_ci
418c2ecf20Sopenharmony_ciint should_segv = 0;
428c2ecf20Sopenharmony_ci
438c2ecf20Sopenharmony_cistatic void sigsegv_cb(int sig)
448c2ecf20Sopenharmony_ci{
458c2ecf20Sopenharmony_ci	if (!should_segv)
468c2ecf20Sopenharmony_ci	{
478c2ecf20Sopenharmony_ci		fprintf(stderr, "FATAL ERROR, rdtsc() failed while enabled\n");
488c2ecf20Sopenharmony_ci		exit(0);
498c2ecf20Sopenharmony_ci	}
508c2ecf20Sopenharmony_ci	if (prctl(PR_SET_TSC, PR_TSC_ENABLE) < 0)
518c2ecf20Sopenharmony_ci	{
528c2ecf20Sopenharmony_ci		perror("prctl");
538c2ecf20Sopenharmony_ci		exit(0);
548c2ecf20Sopenharmony_ci	}
558c2ecf20Sopenharmony_ci	should_segv = 0;
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_ci	rdtsc();
588c2ecf20Sopenharmony_ci}
598c2ecf20Sopenharmony_ci
608c2ecf20Sopenharmony_cistatic void task(void)
618c2ecf20Sopenharmony_ci{
628c2ecf20Sopenharmony_ci	signal(SIGSEGV, sigsegv_cb);
638c2ecf20Sopenharmony_ci	alarm(10);
648c2ecf20Sopenharmony_ci	for(;;)
658c2ecf20Sopenharmony_ci	{
668c2ecf20Sopenharmony_ci		rdtsc();
678c2ecf20Sopenharmony_ci		if (should_segv)
688c2ecf20Sopenharmony_ci		{
698c2ecf20Sopenharmony_ci			fprintf(stderr, "FATAL ERROR, rdtsc() succeeded while disabled\n");
708c2ecf20Sopenharmony_ci			exit(0);
718c2ecf20Sopenharmony_ci		}
728c2ecf20Sopenharmony_ci		if (prctl(PR_SET_TSC, PR_TSC_SIGSEGV) < 0)
738c2ecf20Sopenharmony_ci		{
748c2ecf20Sopenharmony_ci			perror("prctl");
758c2ecf20Sopenharmony_ci			exit(0);
768c2ecf20Sopenharmony_ci		}
778c2ecf20Sopenharmony_ci		should_segv = 1;
788c2ecf20Sopenharmony_ci	}
798c2ecf20Sopenharmony_ci}
808c2ecf20Sopenharmony_ci
818c2ecf20Sopenharmony_ci
828c2ecf20Sopenharmony_ciint main(void)
838c2ecf20Sopenharmony_ci{
848c2ecf20Sopenharmony_ci	int n_tasks = 100, i;
858c2ecf20Sopenharmony_ci
868c2ecf20Sopenharmony_ci	fprintf(stderr, "[No further output means we're allright]\n");
878c2ecf20Sopenharmony_ci
888c2ecf20Sopenharmony_ci	for (i=0; i<n_tasks; i++)
898c2ecf20Sopenharmony_ci		if (fork() == 0)
908c2ecf20Sopenharmony_ci			task();
918c2ecf20Sopenharmony_ci
928c2ecf20Sopenharmony_ci	for (i=0; i<n_tasks; i++)
938c2ecf20Sopenharmony_ci		wait(NULL);
948c2ecf20Sopenharmony_ci
958c2ecf20Sopenharmony_ci	exit(0);
968c2ecf20Sopenharmony_ci}
978c2ecf20Sopenharmony_ci
98