Add qemu 2.4.0

[kvmfornfv.git] / qemu / roms / openbios / libopenbios / xcoff_load.c

diff --git a/qemu/roms/openbios/libopenbios/xcoff_load.c b/qemu/roms/openbios/libopenbios/xcoff_load.c
new file mode 100644 (file)
index 0000000..0dcb28c
--- /dev/null
+++ b/qemu/roms/openbios/libopenbios/xcoff_load.c
@@ -0,0 +1,147 @@
+/*
+ *
+ *       <xcoff_load.c>
+ *
+ *       XCOFF file loader
+ *
+ *   Copyright (C) 2009 Laurent Vivier (Laurent@vivier.eu)
+ *
+ *   from original XCOFF loader by Steven Noonan <steven@uplinklabs.net>
+ *
+ *   This program is free software; you can redistribute it and/or
+ *   modify it under the terms of the GNU General Public License
+ *   version 2
+ *
+ */
+
+#include "config.h"
+#include "libopenbios/bindings.h"
+#include "libopenbios/xcoff_load.h"
+
+#include "arch/common/xcoff.h"
+
+#ifdef CONFIG_PPC
+extern void             flush_icache_range( char *start, char *stop );
+#endif
+
+//#define DEBUG_XCOFF
+
+#ifdef DEBUG_XCOFF
+#define DPRINTF(fmt, args...) \
+    do { printk("%s: " fmt, __func__ , ##args); } while (0)
+#else
+#define DPRINTF(fmt, args...) \
+    do { } while (0)
+#endif
+
+int 
+is_xcoff(COFF_filehdr_t *fhdr)
+{
+       return (fhdr->f_magic == U802WRMAGIC
+            || fhdr->f_magic == U802ROMAGIC
+           || fhdr->f_magic == U802TOCMAGIC
+           || fhdr->f_magic == U802TOMAGIC);
+}
+
+int 
+xcoff_load(struct sys_info *info, const char *filename)
+{
+       // Currently not implemented
+       return LOADER_NOT_SUPPORT;
+}
+
+void
+xcoff_init_program(void)
+{
+       char *base;
+       COFF_filehdr_t *fhdr;
+       COFF_aouthdr_t *ahdr;
+       COFF_scnhdr_t *shdr;
+       uint32_t offset;
+       size_t total_size = 0;
+       int i;
+
+       feval("0 state-valid !");
+
+       feval("load-base");
+       base = (char*)cell2pointer(POP());
+
+       fhdr = (COFF_filehdr_t*)base;
+
+       /* Is it an XCOFF file ? */
+       if (!is_xcoff(fhdr)) {
+               DPRINTF("Not a XCOFF file %02x\n", fhdr->f_magic);
+               return;
+       }
+
+       /* Is it executable ? */
+       if (fhdr->f_magic != 0x01DF &&
+           (fhdr->f_flags & COFF_F_EXEC) == 0) {
+               DPRINTF("Not an executable XCOFF file %02x\n", fhdr->f_flags);
+               return;
+       }
+
+       /* Optional header is a.out ? */
+       if (fhdr->f_opthdr != sizeof(COFF_aouthdr_t)) {
+               DPRINTF("AOUT optional error size mismatch in XCOFF file\n");
+               return;
+       }
+
+        ahdr = (COFF_aouthdr_t*)(base + sizeof(COFF_filehdr_t));
+
+       /* check a.out magic number */
+       if (ahdr->magic != AOUT_MAGIC) {
+               DPRINTF("Invalid AOUT optional header\n");
+               return;
+       }
+
+       offset = sizeof(COFF_filehdr_t) + sizeof(COFF_aouthdr_t);
+
+       DPRINTF("XCOFF file with %d sections\n", fhdr->f_nscns);
+
+       for (i = 0; i < fhdr->f_nscns; i++) {
+
+               DPRINTF("Read header at offset %0x\n", offset);
+
+               shdr = (COFF_scnhdr_t*)(base + offset);
+
+               DPRINTF("Initializing '%s' section from %0x %0x to %0x (%0x)\n",
+                       shdr->s_name, offset, shdr->s_scnptr,
+                       shdr->s_vaddr, shdr->s_size);
+
+               if (strcmp(shdr->s_name, ".text") == 0) {
+
+                       memcpy((char*)(uintptr_t)shdr->s_vaddr, base + shdr->s_scnptr,
+                              shdr->s_size);
+                       total_size += shdr->s_size;
+#ifdef CONFIG_PPC
+                       flush_icache_range((char*)(uintptr_t)shdr->s_vaddr,
+                                        (char*)(uintptr_t)(shdr->s_vaddr + shdr->s_size));
+#endif
+               } else if (strcmp(shdr->s_name, ".data") == 0) {
+
+                       memcpy((char*)(uintptr_t)shdr->s_vaddr, base + shdr->s_scnptr,
+                              shdr->s_size);
+                       total_size += shdr->s_size;
+
+               } else if (strcmp(shdr->s_name, ".bss") == 0) {
+
+                       memset((void *)(uintptr_t)shdr->s_vaddr, 0, shdr->s_size);
+                       total_size += shdr->s_size;
+               } else {
+                       DPRINTF("    Skip '%s' section\n", shdr->s_name);
+               }
+               offset += sizeof(COFF_scnhdr_t);
+       }
+
+       DPRINTF("XCOFF entry point: %x\n", *(uint32_t*)ahdr->entry);
+
+       // Initialise saved-program-state
+       PUSH(*(uint32_t*)(uintptr_t)ahdr->entry);
+       feval("saved-program-state >sps.entry !");
+       PUSH(total_size);
+       feval("saved-program-state >sps.file-size !");
+       feval("xcoff saved-program-state >sps.file-type !");
+
+       feval("-1 state-valid !");
+}