1 files changed, 75 insertions, 0 deletions
diff --git a/roms/openbios/libopenbios/bootcode_load.c b/roms/openbios/libopenbios/bootcode_load.c
new file mode 100644
index 000000000..f3a535ce7
--- /dev/null
+++ b/roms/openbios/libopenbios/bootcode_load.c
@@ -0,0 +1,75 @@
+/* 
+ * Raw bootcode loader (CHRP/Apple %BOOT)
+ * Written by Mark Cave-Ayland 2013
+ */
+
+#include "config.h"
+#include "kernel/kernel.h"
+#include "libopenbios/bindings.h"
+#include "libopenbios/bootcode_load.h"
+#include "libc/diskio.h"
+#include "drivers/drivers.h"
+#define printf printk
+#define debug printk
+
+#define OLDWORLD_BOOTCODE_BASEADDR	(0x3f4000)
+
+int 
+bootcode_load(ihandle_t dev)
+{
+    int retval = -1, count = 0, fd;
+    unsigned long bootcode, loadbase, offset;
+
+    /* Mark the saved-program-state as invalid */
+    feval("0 state-valid !");
+
+    fd = open_ih(dev);
+    if (fd == -1) {
+        goto out;
+    }
+
+    /* Default to loading at load-base */
+    fword("load-base");
+    loadbase = POP();
+    
+#ifdef CONFIG_PPC
+    /* ...except that QUIK (the only known user of %BOOT to date) is built
+       with a hard-coded address of 0x3f4000. Let's just use this for the
+       moment on both New World and Old World Macs, allowing QUIK to also
+       work under a New World Mac. If we find another user of %BOOT we can
+       rethink this later. PReP machines should be left unaffected. */
+    if (is_apple()) {
+        loadbase = OLDWORLD_BOOTCODE_BASEADDR;
+    }
+#endif
+    
+    bootcode = loadbase;
+    offset = 0;
+    
+    while(1) {
+        if (seek_io(fd, offset) == -1)
+            break;
+        count = read_io(fd, (void *)bootcode, 512);
+        offset += count;
+        bootcode += count;
+    }
+
+    /* If we didn't read anything then exit */
+    if (!count) {
+        goto out;
+    }
+    
+    /* Initialise saved-program-state */
+    PUSH(loadbase);
+    feval("saved-program-state >sps.entry !");
+    PUSH(offset);
+    feval("saved-program-state >sps.file-size !");
+    feval("bootcode saved-program-state >sps.file-type !");
+
+    feval("-1 state-valid !");
+
+out:
+    close_io(fd);
+    return retval;
+}
+