18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci#include <errno.h>
38c2ecf20Sopenharmony_ci
48c2ecf20Sopenharmony_ci#include <linux/compiler.h>
58c2ecf20Sopenharmony_ci#include <linux/perf_event.h>
68c2ecf20Sopenharmony_ci#include <linux/stddef.h>
78c2ecf20Sopenharmony_ci#include <linux/types.h>
88c2ecf20Sopenharmony_ci
98c2ecf20Sopenharmony_ci#include <asm/barrier.h>
108c2ecf20Sopenharmony_ci
118c2ecf20Sopenharmony_ci#include "event.h"
128c2ecf20Sopenharmony_ci#include "synthetic-events.h"
138c2ecf20Sopenharmony_ci#include "debug.h"
148c2ecf20Sopenharmony_ci#include "tsc.h"
158c2ecf20Sopenharmony_ci
168c2ecf20Sopenharmony_ciu64 perf_time_to_tsc(u64 ns, struct perf_tsc_conversion *tc)
178c2ecf20Sopenharmony_ci{
188c2ecf20Sopenharmony_ci	u64 t, quot, rem;
198c2ecf20Sopenharmony_ci
208c2ecf20Sopenharmony_ci	t = ns - tc->time_zero;
218c2ecf20Sopenharmony_ci	quot = t / tc->time_mult;
228c2ecf20Sopenharmony_ci	rem  = t % tc->time_mult;
238c2ecf20Sopenharmony_ci	return (quot << tc->time_shift) +
248c2ecf20Sopenharmony_ci	       (rem << tc->time_shift) / tc->time_mult;
258c2ecf20Sopenharmony_ci}
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_ciu64 tsc_to_perf_time(u64 cyc, struct perf_tsc_conversion *tc)
288c2ecf20Sopenharmony_ci{
298c2ecf20Sopenharmony_ci	u64 quot, rem;
308c2ecf20Sopenharmony_ci
318c2ecf20Sopenharmony_ci	if (tc->cap_user_time_short)
328c2ecf20Sopenharmony_ci		cyc = tc->time_cycles +
338c2ecf20Sopenharmony_ci			((cyc - tc->time_cycles) & tc->time_mask);
348c2ecf20Sopenharmony_ci
358c2ecf20Sopenharmony_ci	quot = cyc >> tc->time_shift;
368c2ecf20Sopenharmony_ci	rem  = cyc & (((u64)1 << tc->time_shift) - 1);
378c2ecf20Sopenharmony_ci	return tc->time_zero + quot * tc->time_mult +
388c2ecf20Sopenharmony_ci	       ((rem * tc->time_mult) >> tc->time_shift);
398c2ecf20Sopenharmony_ci}
408c2ecf20Sopenharmony_ci
418c2ecf20Sopenharmony_ciint perf_read_tsc_conversion(const struct perf_event_mmap_page *pc,
428c2ecf20Sopenharmony_ci			     struct perf_tsc_conversion *tc)
438c2ecf20Sopenharmony_ci{
448c2ecf20Sopenharmony_ci	u32 seq;
458c2ecf20Sopenharmony_ci	int i = 0;
468c2ecf20Sopenharmony_ci
478c2ecf20Sopenharmony_ci	while (1) {
488c2ecf20Sopenharmony_ci		seq = pc->lock;
498c2ecf20Sopenharmony_ci		rmb();
508c2ecf20Sopenharmony_ci		tc->time_mult = pc->time_mult;
518c2ecf20Sopenharmony_ci		tc->time_shift = pc->time_shift;
528c2ecf20Sopenharmony_ci		tc->time_zero = pc->time_zero;
538c2ecf20Sopenharmony_ci		tc->time_cycles = pc->time_cycles;
548c2ecf20Sopenharmony_ci		tc->time_mask = pc->time_mask;
558c2ecf20Sopenharmony_ci		tc->cap_user_time_zero = pc->cap_user_time_zero;
568c2ecf20Sopenharmony_ci		tc->cap_user_time_short	= pc->cap_user_time_short;
578c2ecf20Sopenharmony_ci		rmb();
588c2ecf20Sopenharmony_ci		if (pc->lock == seq && !(seq & 1))
598c2ecf20Sopenharmony_ci			break;
608c2ecf20Sopenharmony_ci		if (++i > 10000) {
618c2ecf20Sopenharmony_ci			pr_debug("failed to get perf_event_mmap_page lock\n");
628c2ecf20Sopenharmony_ci			return -EINVAL;
638c2ecf20Sopenharmony_ci		}
648c2ecf20Sopenharmony_ci	}
658c2ecf20Sopenharmony_ci
668c2ecf20Sopenharmony_ci	if (!tc->cap_user_time_zero)
678c2ecf20Sopenharmony_ci		return -EOPNOTSUPP;
688c2ecf20Sopenharmony_ci
698c2ecf20Sopenharmony_ci	return 0;
708c2ecf20Sopenharmony_ci}
718c2ecf20Sopenharmony_ci
728c2ecf20Sopenharmony_ciint perf_event__synth_time_conv(const struct perf_event_mmap_page *pc,
738c2ecf20Sopenharmony_ci				struct perf_tool *tool,
748c2ecf20Sopenharmony_ci				perf_event__handler_t process,
758c2ecf20Sopenharmony_ci				struct machine *machine)
768c2ecf20Sopenharmony_ci{
778c2ecf20Sopenharmony_ci	union perf_event event = {
788c2ecf20Sopenharmony_ci		.time_conv = {
798c2ecf20Sopenharmony_ci			.header = {
808c2ecf20Sopenharmony_ci				.type = PERF_RECORD_TIME_CONV,
818c2ecf20Sopenharmony_ci				.size = sizeof(struct perf_record_time_conv),
828c2ecf20Sopenharmony_ci			},
838c2ecf20Sopenharmony_ci		},
848c2ecf20Sopenharmony_ci	};
858c2ecf20Sopenharmony_ci	struct perf_tsc_conversion tc;
868c2ecf20Sopenharmony_ci	int err;
878c2ecf20Sopenharmony_ci
888c2ecf20Sopenharmony_ci	if (!pc)
898c2ecf20Sopenharmony_ci		return 0;
908c2ecf20Sopenharmony_ci	err = perf_read_tsc_conversion(pc, &tc);
918c2ecf20Sopenharmony_ci	if (err == -EOPNOTSUPP)
928c2ecf20Sopenharmony_ci		return 0;
938c2ecf20Sopenharmony_ci	if (err)
948c2ecf20Sopenharmony_ci		return err;
958c2ecf20Sopenharmony_ci
968c2ecf20Sopenharmony_ci	pr_debug2("Synthesizing TSC conversion information\n");
978c2ecf20Sopenharmony_ci
988c2ecf20Sopenharmony_ci	event.time_conv.time_mult  = tc.time_mult;
998c2ecf20Sopenharmony_ci	event.time_conv.time_shift = tc.time_shift;
1008c2ecf20Sopenharmony_ci	event.time_conv.time_zero  = tc.time_zero;
1018c2ecf20Sopenharmony_ci	event.time_conv.time_cycles = tc.time_cycles;
1028c2ecf20Sopenharmony_ci	event.time_conv.time_mask = tc.time_mask;
1038c2ecf20Sopenharmony_ci	event.time_conv.cap_user_time_zero = tc.cap_user_time_zero;
1048c2ecf20Sopenharmony_ci	event.time_conv.cap_user_time_short = tc.cap_user_time_short;
1058c2ecf20Sopenharmony_ci
1068c2ecf20Sopenharmony_ci	return process(tool, &event, NULL, machine);
1078c2ecf20Sopenharmony_ci}
1088c2ecf20Sopenharmony_ci
1098c2ecf20Sopenharmony_ciu64 __weak rdtsc(void)
1108c2ecf20Sopenharmony_ci{
1118c2ecf20Sopenharmony_ci	return 0;
1128c2ecf20Sopenharmony_ci}
113