thermosphere: handle stage2 data aborts, trap gicd accesses

thermosphere/src/data_abort.c

@@ -0,0 +1,61 @@
+/*
+ * Copyright (c) 2019 Atmosphère-NX
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms and conditions of the GNU General Public License,
+ * version 2, as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <string.h>
+#include "data_abort.h"
+#include "sysreg.h"
+#include "debug_log.h"
+#include "irq.h"
+
+// Lower el
+
+void dumpUnhandledDataAbort(DataAbortIss dabtIss, u64 far, const char *msg)
+{
+    DEBUG("Unhandled");
+    DEBUG(" %s ", msg);
+    DEBUG("%s at ", dabtIss.wnr ? "write" : "read");
+    if (dabtIss.fnv) {
+        DEBUG("<unk>");
+    } else {
+        DEBUG("%016llx", far);
+    }
+
+    if (dabtIss.isv) {
+        DEBUG(" size %u Rt=%u", BIT(dabtIss.sas), dabtIss.srt);
+    }
+
+    DEBUG("\n");
+}
+
+void handleLowerElDataAbortException(ExceptionStackFrame *frame, ExceptionSyndromeRegister esr)
+{
+    DataAbortIss dabtIss;
+    memcpy(&dabtIss, &esr, 4);
+
+    u64 far = GET_SYSREG(far_el2);
+
+    if (!dabtIss.isv || dabtIss.fnv) {
+        dumpUnhandledDataAbort(dabtIss, far, "");
+    }
+
+    // TODO
+
+    if ((far & ~0xFFFull) == (uintptr_t)g_irqManager.gic.gicd) {
+        // TODO
+    }
+
+    dumpUnhandledDataAbort(dabtIss, far, "(fallback)");
+}