diff --git a/compiler-rt/lib/builtins/CMakeLists.txt b/compiler-rt/lib/builtins/CMakeLists.txt --- a/compiler-rt/lib/builtins/CMakeLists.txt +++ b/compiler-rt/lib/builtins/CMakeLists.txt @@ -701,6 +701,7 @@ set(powerpc64le_SOURCES ${powerpc64_SOURCES}) set(riscv_SOURCES + riscv/ifunc_select.c riscv/fp_mode.c riscv/save.S riscv/restore.S diff --git a/compiler-rt/lib/builtins/riscv/ifunc_select.c b/compiler-rt/lib/builtins/riscv/ifunc_select.c new file mode 100644 --- /dev/null +++ b/compiler-rt/lib/builtins/riscv/ifunc_select.c @@ -0,0 +1,242 @@ +//=== ifunc_select.c - Check environment hardware feature -*- C -*-===========// +// +// Part of the LLVM Project, under the Apache License v2.0 with LLVM Exceptions. +// See https://llvm.org/LICENSE.txt for license information. +// SPDX-License-Identifier: Apache-2.0 WITH LLVM-exception +// +//===----------------------------------------------------------------------===// + +static void fillzero(char *s, unsigned size) { + for (int i = 0; i < size; i++) + s[i] = '\0'; +} + +static unsigned strcmp(const char *a, const char *b) { + while (*a != '\0' && *b != '\0') { + if (*a != *b) + return 0; + a++; + b++; + } + if (*a == *b) + return 1; + return 0; +} + +static void strncpy(char *dest, const char *src, unsigned len) { + for (unsigned i = 0; i < len; i++) + dest[i] = src[i]; +} + +static unsigned strlen(char *s) { + int len = 0; + while (*s != '\0') { + len++; + s++; + } + return len; +} + +// TODO: Replace with more efficiency algorithm +static unsigned isPatternInSrc(char *src, char *pattern) { + char buf[1024]; + int lenOfSrc = strlen(src); + int lenOfPattern = strlen(pattern); + for (int i = 0; i + lenOfPattern < lenOfSrc; i++) { + fillzero(buf, 1024); + strncpy(buf, src + i, lenOfPattern); + if (strcmp(buf, pattern)) + return 1; + } + return 0; +} + +static char *tokenize(char *src, char *rst, char delim) { + while (*src != '\0' && *src != delim) { + *rst = *src; + src++; + rst++; + } + if (*src == delim) + src++; + return src; +} + +static long syscall_impl_3_args(long number, long arg1, long arg2, long arg3) { + register long a7 __asm__("a7") = number; + register long a0 __asm__("a0") = arg1; + register long a1 __asm__("a1") = arg2; + register long a2 __asm__("a2") = arg3; + __asm__ __volatile__("ecall\n\t" + : "=r"(a0) + : "r"(a7), "r"(a0), "r"(a1), "r"(a2) + : "memory"); + return a0; +} + +static long syscall_impl_5_args(long number, long arg1, long arg2, long arg3, + long arg4, long arg5) { + register long a7 __asm__("a7") = number; + register long a0 __asm__("a0") = arg1; + register long a1 __asm__("a1") = arg2; + register long a2 __asm__("a2") = arg3; + register long a3 __asm__("a3") = arg4; + register long a4 __asm__("a4") = arg5; + __asm__ __volatile__("ecall\n\t" + : "=r"(a0) + : "r"(a7), "r"(a0), "r"(a1), "r"(a2), "r"(a3), "r"(a4) + : "memory"); + return a0; +} + +static unsigned read(int fd, const void *buf, unsigned count) { + return syscall_impl_3_args(63, fd, (long)buf, count); +} + +static int openat(int dirfd, const char *pathname, int flags) { + return syscall_impl_3_args(56, (long)dirfd, (long)pathname, flags); +} + +static void readUntilNextLine(int fd, char *rst, int len) { + char buf = '\0'; + while (buf != '\n' && read(fd, &buf, 1) != 0 && len > 0) { + *rst = buf; + rst++; + len--; + } +} + +static void __riscv_cpuinfo(char *FeatStr) { + char buf[1024]; + int fd = openat(0, "/proc/cpuinfo", 2); + do { + fillzero(buf, 1024); + readUntilNextLine(fd, buf, 1024); + if (isPatternInSrc(buf, "isa")) { + strncpy(FeatStr, buf, 1024); + return; + } + } while (strlen(buf) != 0); +} + +static void getBasicExtFromHwFeatStr(char *rst, char *src) { + while (*src != 'r') { + src++; + } + + while (*src != '_' && *src != '\0') { + *rst = *src; + rst++; + src++; + } +} + +static unsigned checkFeatStrInHwFeatStr(char *FeatStr, char *HwFeatStr) { + if (strlen(FeatStr) == 1) { + char BasicExt[1024]; + fillzero(BasicExt, 1024); + getBasicExtFromHwFeatStr(BasicExt, HwFeatStr); + return isPatternInSrc(BasicExt, FeatStr); + } + return isPatternInSrc(HwFeatStr, FeatStr); +} + +struct riscv_hwprobe { + long long key; + unsigned long long value; +}; + +#define RISCV_HWPROBE_MAX_KEY 5 +#define RISCV_HWPROBE_KEY_MVENDORID 0 +#define RISCV_HWPROBE_KEY_MARCHID 1 +#define RISCV_HWPROBE_KEY_MIMPID 2 +#define RISCV_HWPROBE_KEY_BASE_BEHAVIOR 3 +#define RISCV_HWPROBE_BASE_BEHAVIOR_IMA (1 << 0) +#define RISCV_HWPROBE_KEY_IMA_EXT_0 4 +#define RISCV_HWPROBE_IMA_FD (1 << 0) +#define RISCV_HWPROBE_IMA_C (1 << 1) +#define RISCV_HWPROBE_IMA_V (1 << 2) +#define RISCV_HWPROBE_EXT_ZBA (1 << 3) +#define RISCV_HWPROBE_EXT_ZBB (1 << 4) +#define RISCV_HWPROBE_EXT_ZBS (1 << 5) +#define RISCV_HWPROBE_KEY_CPUPERF_0 5 +#define RISCV_HWPROBE_MISALIGNED_UNKNOWN (0 << 0) +#define RISCV_HWPROBE_MISALIGNED_EMULATED (1 << 0) +#define RISCV_HWPROBE_MISALIGNED_SLOW (2 << 0) +#define RISCV_HWPROBE_MISALIGNED_FAST (3 << 0) +#define RISCV_HWPROBE_MISALIGNED_UNSUPPORTED (4 << 0) +#define RISCV_HWPROBE_MISALIGNED_MASK (7 << 0) + +/* Size definition for CPU sets. */ +#define __CPU_SETSIZE 1024 +#define __NCPUBITS (8 * sizeof(unsigned long int)) + +/* Data structure to describe CPU mask. */ +typedef struct { + unsigned long int __bits[__CPU_SETSIZE / __NCPUBITS]; +} cpu_set_t; + +static long sys_riscv_hwprobe(struct riscv_hwprobe *pairs, unsigned pair_count, + unsigned cpu_count, cpu_set_t *cpus, + unsigned int flags) { + return syscall_impl_5_args(258, (long)pairs, pair_count, cpu_count, + (long)cpus, flags); +} + +static void intiHwProbe(struct riscv_hwprobe *Hwprobes, int len) { + sys_riscv_hwprobe(Hwprobes, len, 0, 0, 0); +} + +static unsigned checkFeatStrInHwProbe(char *FeatStr, struct riscv_hwprobe Hwprobe) { + if (Hwprobe.key == -1) + return 0; + + if (strcmp(FeatStr, "i")) + return Hwprobe.value & RISCV_HWPROBE_KEY_IMA_EXT_0; + if (strcmp(FeatStr, "m")) + return Hwprobe.value & RISCV_HWPROBE_KEY_IMA_EXT_0; + if (strcmp(FeatStr, "a")) + return Hwprobe.value & RISCV_HWPROBE_KEY_IMA_EXT_0; + if (strcmp(FeatStr, "f")) + return Hwprobe.value & RISCV_HWPROBE_IMA_FD; + if (strcmp(FeatStr, "d")) + return Hwprobe.value & RISCV_HWPROBE_IMA_FD; + if (strcmp(FeatStr, "c")) + return Hwprobe.value & RISCV_HWPROBE_IMA_C; + if (strcmp(FeatStr, "v")) + return Hwprobe.value & RISCV_HWPROBE_IMA_V; + if (strcmp(FeatStr, "zba")) + return Hwprobe.value & RISCV_HWPROBE_EXT_ZBA; + if (strcmp(FeatStr, "zbb")) + return Hwprobe.value & RISCV_HWPROBE_EXT_ZBB; + if (strcmp(FeatStr, "zbs")) + return Hwprobe.value & RISCV_HWPROBE_EXT_ZBS; + + return 0; +} + +unsigned __riscv_ifunc_select(char *FeatStrs) { + // Init Hwprobe + struct riscv_hwprobe HwprobePairs[] = { + {RISCV_HWPROBE_KEY_IMA_EXT_0, 0}, + }; + intiHwProbe(HwprobePairs, 1); + + // Init HwFeatStr from /proc/cpuinfo + char HwFeatStr[1024]; + fillzero(HwFeatStr, 1024); + __riscv_cpuinfo(HwFeatStr); + + // Check each extension whether available + char FeatStr[1024]; + while (*FeatStrs != '\0') { + fillzero(FeatStr, 1024); + FeatStrs = tokenize(FeatStrs, FeatStr, ';'); + if (checkFeatStrInHwProbe(FeatStr, HwprobePairs[0])) + continue; + if (!checkFeatStrInHwFeatStr(FeatStr, HwFeatStr)) + return 0; + } + + return 1; +}