msim done (ish)

1 files changed, 56 insertions, 0 deletions

diff --git a/msim/fault.c b/msim/fault.c
new file mode 100644
index 0000000..88cd340
--- /dev/null
+++ b/msim/fault.c
@@ -0,0 +1,56 @@
+#include "fault.h"
+#include "sim.h"
+#include <signal.h>
+#include <time.h>
+
+static struct simulator *sim;
+
+static void sigsegv_handler(int sig, siginfo_t *info, void *ucontext)
+{
+	(void) sig;
+	(void) ucontext;
+
+	const char *inner = "";
+	switch (info->si_code) {
+	case SEGV_MAPERR:
+		inner = ": address not mapped to object";
+		break;
+	case SEGV_ACCERR:
+		inner = ": invalid premissions for mapped object";
+		break;
+	case SEGV_BNDERR:
+		inner = ": failed address bound checks";
+		break;
+	case SEGV_PKUERR:
+		inner = ": access was denied by memory protection";
+		break;
+	}
+
+	sim_dump(sim, "page fault at %p%s", info->si_addr, inner);
+}
+
+static void sigfpe_handler(int sig, siginfo_t *info, void *ucontext)
+{
+	(void) sig;
+	(void) info;
+	(void) ucontext;
+
+	sim_dump(sim, "floating point exception");
+
+}
+
+void init_handlers(struct simulator *s)
+{
+	struct sigaction act = {0};
+	sim = s;
+
+	/* sigsegv */
+	act.sa_sigaction = sigsegv_handler;
+	act.sa_flags = SA_SIGINFO;
+	sigaction(SIGSEGV, &act, NULL);
+
+	/* sigfpe */
+	act.sa_sigaction = sigfpe_handler;
+	act.sa_flags = SA_SIGINFO;
+	sigaction(SIGFPE, &act, NULL);
+}