thermosphere: refactor exception handlers & add stolen time/emulated ptimer logic

thermosphere/src/initSystem.c

@@ -0,0 +1,60 @@
+/*
+ * 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 "core_ctx.h"
+#include "platform/memory_map_mmu_cfg.h"
+#include "sysreg.h"
+#include "utils.h"
+
+extern u8 __bss_start__[], __end__[], __temp_bss_start__[], __temp_bss_end__[];
+extern const u32 __vectors_start__[];
+
+static void initSysregs(void)
+{
+    // Set VBAR
+    SET_SYSREG(vbar_el2, (uintptr_t)__vectors_start__);
+
+    // Set system to sane defaults, aarch64 for el1, mmu&caches initially disabled for EL1, etc.
+    SET_SYSREG(hcr_el2,     0x80000000);
+    SET_SYSREG(dacr32_el2,  0xFFFFFFFF); // unused
+    SET_SYSREG(sctlr_el1,   0x00C50838);
+
+    SET_SYSREG(mdcr_el2,    0x00000000);
+    SET_SYSREG(mdscr_el1,   0x00000000);
+
+    SET_SYSREG(cntvoff_el2, 0x00000000);
+}
+
+void initSystem(u32 coreId, bool isBootCore, u64 argument)
+{
+    coreCtxInit(coreId, isBootCore, argument);
+    initSysregs();
+
+    __dsb_sy();
+    __isb();
+
+    if (isBootCore) {
+        if (!currentCoreCtx->warmboot) {
+            memset(__bss_start__, 0, __end__ - __bss_start__);
+        }
+
+        memset(__temp_bss_start__, 0, __temp_bss_end__ - __temp_bss_start__);
+    }
+
+    configureMemoryMapEnableMmu();
+    configureMemoryMapEnableStage2();
+}