[nostalgia/core/gba] Add wfi functions

src/nostalgia/core/gba/panic.cpp

@@ -6,8 +6,13 @@
  * file, You can obtain one at http://mozilla.org/MPL/2.0/.
  */
 
-#include "../core.hpp"
-#include "../gfx.hpp"
+#include <ox/std/memops.hpp>
+
+#include <nostalgia/core/core.hpp>
+#include <nostalgia/core/gfx.hpp>
+
+#include "addresses.hpp"
+#include "bios.hpp"
 
 namespace ox {
 
@@ -16,15 +21,20 @@ using namespace nostalgia::core;
 void panic(const char*, int, const char *msg, ox::Error err) {
 	oxIgnoreError(initGfx(nullptr));
 	oxIgnoreError(initConsole(nullptr));
+	// enable only BG 0
+	REG_DISPCTL = 0x0100;
+	clearTileLayer(nullptr, 0);
 	ox::BString<23> serr = "Error code: ";
 	serr += err;
-	puts(nullptr, 32 + 0,  1, "SADNESS...");
-	puts(nullptr, 32 + 0,  4, "UNEXPECTED STATE:");
+	puts(nullptr, 32 + 1,  1, "SADNESS...");
+	puts(nullptr, 32 + 1,  4, "UNEXPECTED STATE:");
 	puts(nullptr, 32 + 2,  6, msg);
-	puts(nullptr, 32 + 2,  7, serr.c_str());
-	puts(nullptr, 32 + 0, 10, "PLEASE RESTART THE SYSTEM");
-	// TODO: properly end program execution, this wastes power
-	while (1);
+	puts(nullptr, 32 + 2,  8, serr.c_str());
+	puts(nullptr, 32 + 1, 15, "PLEASE RESTART THE SYSTEM");
+	// disable interrupts and wait for interrupt, halt and stop seem to have
+	// issues in mGBA
+	REG_IME = 0;
+	nostalgia_core_wfi();
 }
 
 }