efi-boot-shim/include/asm.h
Peter Jones 1b382ef850 shim: Rework pause functions and add read_counter()
Signed-off-by: Peter Jones <pjones@redhat.com>
Upstream-commit-id: fc6b0bca84e
2020-07-23 20:52:12 -04:00

60 lines
1.3 KiB
C

/*
* asm.h
* Copyright 2018 Peter Jones <pjones@redhat.com>
*/
#ifndef SHIM_ASM_H_
#define SHIM_ASM_H_
#define __stringify_1(x...) #x
#define __stringify(x...) __stringify_1(x)
static inline uint64_t read_counter(void)
{
uint64_t val;
#if defined (__x86_64__)
unsigned long low, high;
__asm__ __volatile__("rdtsc" : "=a" (low), "=d" (high));
val = (low) | (high) << 32;
#elif defined(__i386__) || defined(__i686__)
__asm__ __volatile__("rdtsc" : "=A" (val));
#elif defined(__aarch64__)
__asm__ __volatile__ ("mrs %0, pmccntr_el0" : "=r" (val));
#elif defined(__arm__)
__asm__ __volatile__ ("mrc p15, 0, %0, c9, c13, 0" : "=r" (val));
#else
#error unsupported arch
#endif
return val;
}
#if defined(__x86_64__) || defined(__i386__) || defined(__i686__)
static inline void pause(void)
{
__asm__ __volatile__("pause");
}
#elif defined(__aarch64__)
static inline void pause(void)
{
__asm__ __volatile__("wfi");
}
#else
static inline void pause(void)
{
uint64_t a, b;
int x;
extern void msleep(unsigned long msecs);
a = read_counter();
for (x = 0; x < 1000; x++) {
msleep(1000);
b = read_counter();
if (a != b)
break;
}
}
#endif
#endif /* !SHIM_ASM_H_ */
// vim:fenc=utf-8:tw=75:et