116 lines
2.5 KiB
C
116 lines
2.5 KiB
C
#include <stdint.h>
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
|
|
#ifndef _WIN32
|
|
#include <unistd.h>
|
|
#include <fcntl.h>
|
|
#endif
|
|
|
|
#include "umka.h"
|
|
|
|
#define MSR_IA32_DEBUGCTLMSR 0x1d9
|
|
#define MSR_IA32_LASTBRANCHFROMIP 0x1db
|
|
#define MSR_IA32_LASTBRANCHTOIP 0x1dc
|
|
|
|
int covfd, msrfd;
|
|
|
|
uint64_t rdmsr(uint32_t reg)
|
|
{
|
|
uint64_t data = 0;
|
|
|
|
#ifndef _WIN32
|
|
if (pread(msrfd, &data, sizeof data, reg) != sizeof data) {
|
|
perror("rdmsr: pread");
|
|
exit(1);
|
|
}
|
|
#else
|
|
printf("STUB: %s:%d", __FILE__, __LINE__);
|
|
#endif
|
|
|
|
return data;
|
|
}
|
|
|
|
void wrmsr(uint32_t reg, uint64_t data)
|
|
{
|
|
#ifndef _WIN32
|
|
int fd;
|
|
fd = open("/dev/cpu/0/msr", O_WRONLY);
|
|
if (fd < 0) {
|
|
perror("wrmsr: open");
|
|
exit(1);
|
|
}
|
|
|
|
if (pwrite(fd, &data, sizeof data, reg) != sizeof data) {
|
|
perror("wrmsr: pwrite");
|
|
exit(1);
|
|
}
|
|
|
|
close(fd);
|
|
#else
|
|
printf("STUB: %s:%d", __FILE__, __LINE__);
|
|
#endif
|
|
}
|
|
|
|
void handle_sigtrap() {
|
|
#ifndef _WIN32
|
|
uint64_t from = rdmsr(MSR_IA32_LASTBRANCHFROMIP);
|
|
uint64_t to = rdmsr(MSR_IA32_LASTBRANCHTOIP);
|
|
|
|
if ((from >= (uintptr_t)coverage_begin && from < (uintptr_t)coverage_end) ||
|
|
(to >= (uintptr_t)coverage_begin && to < (uintptr_t)coverage_end)) {
|
|
write(covfd, &from, 4);
|
|
write(covfd, &to, 4);
|
|
}
|
|
|
|
wrmsr(MSR_IA32_DEBUGCTLMSR, 3);
|
|
#else
|
|
printf("STUB: %s:%d", __FILE__, __LINE__);
|
|
#endif
|
|
}
|
|
|
|
uint32_t set_eflags_tf(uint32_t tf);
|
|
|
|
void trace_lbr_begin() {
|
|
#ifndef _WIN32
|
|
struct sigaction action;
|
|
action.sa_sigaction = &handle_sigtrap;
|
|
action.sa_flags = SA_SIGINFO;
|
|
sigaction(SIGTRAP, &action, NULL);
|
|
|
|
wrmsr(MSR_IA32_DEBUGCTLMSR, 3);
|
|
msrfd = open("/dev/cpu/0/msr", O_RDONLY);
|
|
if (msrfd < 0) {
|
|
perror("rdmsr: open");
|
|
exit(1);
|
|
}
|
|
char coverage_filename[32];
|
|
sprintf(coverage_filename, "coverage.%i", getpid());
|
|
covfd = open(coverage_filename, O_WRONLY | O_CREAT | O_TRUNC, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP | S_IROTH | S_IWOTH | S_IWOTH);
|
|
void *coverage_begin_addr = coverage_begin;
|
|
void *coverage_end_addr = coverage_end;
|
|
write(covfd, &coverage_begin_addr, 4);
|
|
write(covfd, &coverage_end_addr, 4);
|
|
#else
|
|
printf("STUB: %s:%d", __FILE__, __LINE__);
|
|
#endif
|
|
}
|
|
|
|
void trace_lbr_end() {
|
|
#ifndef _WIN32
|
|
wrmsr(MSR_IA32_DEBUGCTLMSR, 0);
|
|
close(msrfd);
|
|
close(covfd);
|
|
#else
|
|
printf("STUB: %s:%d", __FILE__, __LINE__);
|
|
#endif
|
|
}
|
|
|
|
uint32_t trace_lbr_pause(void) {
|
|
return set_eflags_tf(0u);
|
|
}
|
|
|
|
void trace_lbr_resume(uint32_t value) {
|
|
set_eflags_tf(value);
|
|
}
|