1 files changed, 48 insertions, 2 deletions

diff --git a/NDS.cpp b/NDS.cpp
index f992297..71de789 100644
--- a/NDS.cpp
+++ b/NDS.cpp
@@ -1,15 +1,23 @@
 #include <stdio.h>
 #include "NDS.h"
+#include "ARM.h"
 
 
 namespace NDS
 {
 
-//
+ARM* ARM9;
+ARM* ARM7;
+
+u8 ARM9BIOS[0x1000];
+u8 ARM7BIOS[0x4000];
 
 
 void Init()
 {
+    ARM9 = new ARM(0);
+    ARM7 = new ARM(1);
+
     Reset();
 }
 
@@ -22,12 +30,50 @@ void Reset()
         printf("ARM9 BIOS not found\n");
     else
     {
-        // load BIOS here
+        fseek(f, 0, SEEK_SET);
+        fread(ARM9BIOS, 0x1000, 1, f);
 
+        printf("ARM9 BIOS loaded: %08X\n", ARM9Read32(0xFFFF0000));
         fclose(f);
     }
+
+    f = fopen("bios7.bin", "rb");
+    if (!f)
+        printf("ARM7 BIOS not found\n");
+    else
+    {
+        fseek(f, 0, SEEK_SET);
+        fread(ARM7BIOS, 0x4000, 1, f);
+
+        printf("ARM7 BIOS loaded: %08X\n", ARM7Read32(0x00000000));
+        fclose(f);
+    }
+}
+
+
+u32 ARM9Read32(u32 addr)
+{
+    // implement ARM9y shit here, like memory protection
+
+    if ((addr & 0xFFFFF000) == 0xFFFF0000)
+    {
+        return *(u32*)&ARM9BIOS[addr & 0xFFF];
+    }
+
+    printf("unknown arm9 read32 %08X\n", addr);
+    return 0;
 }
 
+u32 ARM7Read32(u32 addr)
+{
+    if (addr < 0x00004000)
+    {
+        return *(u32*)&ARM7BIOS[addr];
+    }
+
+    printf("unknown arm7 read32 %08X\n", addr);
+    return 0;
+}
 
 template<typename T> T Read(u32 addr)
 {