/* SPDX-License-Identifier: GPL-2.0-only */ #include <sys/types.h> #include <sys/stat.h> #include <fcntl.h> #include <unistd.h> #include <string.h> #include <errno.h> #include "msrtool.h" static int msr_fd[MAX_CORES] = {-1, -1, -1, -1, -1, -1, -1, -1}; int freebsd_probe(const struct sysdef *system) { #ifdef __FreeBSD__ struct stat st; return stat("/dev/cpuctl0", &st) == 0; #else return 0; #endif } int freebsd_open(uint8_t cpu, enum SysModes mode) { #ifdef __FreeBSD__ int flags; char devname[32]; if (cpu >= MAX_CORES) return 0; if (SYS_RDWR == mode) flags = O_RDWR; else if (SYS_WRONLY == mode) flags = O_WRONLY; else flags = O_RDONLY; snprintf(devname, sizeof(devname), "/dev/cpuctl%u", cpu); msr_fd[cpu] = open(devname, flags); if (msr_fd[cpu] < 0) { perror(devname); return 0; } return 1; #else return 0; #endif } int freebsd_close(uint8_t cpu) { if (cpu >= MAX_CORES) return 0; if (msr_fd[cpu] != -1) close(msr_fd[cpu]); msr_fd[cpu] = -1; return 1; } int freebsd_rdmsr(uint8_t cpu, uint32_t addr, struct msr *val) { #ifdef __FreeBSD__ cpuctl_msr_args_t args; if (cpu >= MAX_CORES) return 0; if (msr_fd[cpu] < 0) return 0; args.msr = addr; if (ioctl(msr_fd[cpu], CPUCTL_RDMSR, &args) < 0) { perror("ioctl(CPUCTL_RDMSR)"); return 0; } val->hi = args.data >> 32; val->lo = args.data & 0xffffffff; return 1; #else return 0; #endif }