com32: make syslinux_dump_*() pure debugging functions
[profile/ivi/syslinux.git] / com32 / mboot / map.c
index 1a788ef..99add30 100644 (file)
@@ -1,7 +1,7 @@
 /* ----------------------------------------------------------------------- *
  *
  *   Copyright 2007-2008 H. Peter Anvin - All Rights Reserved
- *   Copyright 2009 Intel Corporation; author: H. Peter Anvin
+ *   Copyright 2009-2010 Intel Corporation; author: H. Peter Anvin
  *
  *   Permission is hereby granted, free of charge, to any person
  *   obtaining a copy of this software and associated documentation
@@ -36,7 +36,6 @@
 
 static struct syslinux_movelist *ml = NULL;
 static struct syslinux_memmap *mmap = NULL, *amap = NULL;
-static struct multiboot_header *mbh;
 static addr_t mboot_high_water_mark = 0x100000;
 
 /*
@@ -92,30 +91,30 @@ int init_map(void)
        error("Failed to allocate initial memory map!\n");
        return -1;
     }
-#if DEBUG
+
     dprintf("Initial memory map:\n");
-    syslinux_dump_memmap(stdout, mmap);
-#endif
+    syslinux_dump_memmap(mmap);
 
     return 0;
 }
 
-int map_image(void *ptr, size_t len)
+struct multiboot_header *map_image(void *ptr, size_t len)
 {
+    struct multiboot_header *mbh;
     int mbh_len;
     char *cptr = ptr;
     Elf32_Ehdr *eh = ptr;
     Elf32_Phdr *ph;
     Elf32_Shdr *sh;
-    unsigned int i;
+    unsigned int i, mbh_offset;
     uint32_t bad_flags;
 
     /*
      * Search for the multiboot header...
      */
     mbh_len = 0;
-    for (i = 0; i < MULTIBOOT_SEARCH; i += 4) {
-       mbh = (struct multiboot_header *)((char *)ptr + i);
+    for (mbh_offset = 0; mbh_offset < MULTIBOOT_SEARCH; mbh_offset += 4) {
+       mbh = (struct multiboot_header *)((char *)ptr + mbh_offset);
        if (mbh->magic != MULTIBOOT_MAGIC)
            continue;
        if (mbh->magic + mbh->flags + mbh->checksum)
@@ -127,17 +126,17 @@ int map_image(void *ptr, size_t len)
        else
            mbh_len = 12;
 
-       if (i + mbh_len < len)
+       if (mbh_offset + mbh_len > len)
            mbh_len = 0;        /* Invalid... */
        else
            break;              /* Found something... */
     }
 
     if (mbh_len) {
-       bad_flags = mbh->flags & (MULTIBOOT_UNSUPPORTED | MULTIBOOT_VIDEO_MODE);
+       bad_flags = mbh->flags & MULTIBOOT_UNSUPPORTED;
        if (bad_flags) {
            printf("Unsupported Multiboot flags set: %#x\n", bad_flags);
-           return -1;
+           return NULL;
        }
     }
 
@@ -151,6 +150,10 @@ int map_image(void *ptr, size_t len)
        !eh->e_phnum || eh->e_phoff + eh->e_phentsize * eh->e_phnum > len)
        eh = NULL;              /* No valid ELF header found */
 
+    /* Is this a Solaris kernel? */
+    if (!set.solaris && eh && kernel_is_solaris(eh))
+       opt.solaris = true;
+
     /*
      * Note: the Multiboot Specification implies that AOUT_KLUDGE should
      * have precedence over the ELF header.  However, Grub disagrees, and
@@ -165,7 +168,7 @@ int map_image(void *ptr, size_t len)
 
        for (i = 0; i < eh->e_phnum; i++) {
            if (ph->p_type == PT_LOAD || ph->p_type == PT_PHDR) {
-               /* 
+               /*
                 * This loads at p_paddr, which matches Grub.  However, if
                 * e_entry falls within the p_vaddr range of this PHDR, then
                 * adjust it to match the p_paddr range... this is how Grub
@@ -187,13 +190,13 @@ int map_image(void *ptr, size_t len)
                    printf
                        ("Memory segment at 0x%08x (len 0x%08x) is unavailable\n",
                         addr, msize);
-                   return -1;  /* Memory region unavailable */
+                   return NULL;        /* Memory region unavailable */
                }
 
                /* Mark this region as allocated in the available map */
                if (syslinux_add_memmap(&amap, addr, msize, SMT_ALLOC)) {
                    error("Overlapping segments found in ELF header\n");
-                   return -1;
+                   return NULL;
                }
 
                if (ph->p_filesz) {
@@ -201,7 +204,7 @@ int map_image(void *ptr, size_t len)
                    if (syslinux_add_movelist
                        (&ml, addr, (addr_t) cptr + ph->p_offset, dsize)) {
                        error("Failed to map PHDR data\n");
-                       return -1;
+                       return NULL;
                    }
                }
                if (msize > dsize) {
@@ -209,7 +212,7 @@ int map_image(void *ptr, size_t len)
                    if (syslinux_add_memmap
                        (&mmap, addr + dsize, msize - dsize, SMT_ZERO)) {
                        error("Failed to map PHDR zero region\n");
-                       return -1;
+                       return NULL;
                    }
                }
                if (addr + msize > mboot_high_water_mark)
@@ -235,7 +238,7 @@ int map_image(void *ptr, size_t len)
            addr = map_data(sh, len, 4096, MAP_HIGH | MAP_NOPAD);
            if (!addr) {
                error("Failed to map symbol table\n");
-               return -1;
+               return NULL;
            }
 
            mbinfo.flags |= MB_INFO_ELF_SHDR;
@@ -257,7 +260,7 @@ int map_image(void *ptr, size_t len)
                                align, MAP_HIGH);
                if (!addr) {
                    error("Failed to map symbol section\n");
-                   return -1;
+                   return NULL;
                }
                sh[i].sh_addr = addr;
            }
@@ -268,45 +271,56 @@ int map_image(void *ptr, size_t len)
         */
        char *data_ptr;
        addr_t data_len, bss_len;
+       addr_t bss_addr;
 
        regs.eip = mbh->entry_addr;
 
        data_ptr = (char *)mbh - (mbh->header_addr - mbh->load_addr);
-       data_len = mbh->load_end_addr - mbh->load_addr;
-       bss_len = mbh->bss_end_addr - mbh->load_end_addr;
+
+       if (mbh->load_end_addr)
+           data_len = mbh->load_end_addr - mbh->load_addr;
+       else
+           data_len = len - mbh_offset + (mbh->header_addr - mbh->load_addr);
+
+       bss_addr = mbh->load_addr + data_len;
+
+       if (mbh->bss_end_addr)
+           bss_len = mbh->bss_end_addr - mbh->load_end_addr;
+       else
+           bss_len = 0;
 
        if (syslinux_memmap_type(amap, mbh->load_addr, data_len + bss_len)
            != SMT_FREE) {
            printf("Memory segment at 0x%08x (len 0x%08x) is unavailable\n",
                   mbh->load_addr, data_len + bss_len);
-           return -1;          /* Memory region unavailable */
+           return NULL;                /* Memory region unavailable */
        }
        if (syslinux_add_memmap(&amap, mbh->load_addr,
                                data_len + bss_len, SMT_ALLOC)) {
            error("Failed to claim a.out address space!\n");
-           return -1;
+           return NULL;
        }
        if (data_len)
            if (syslinux_add_movelist(&ml, mbh->load_addr, (addr_t) data_ptr,
                                      data_len)) {
                error("Failed to map a.out data\n");
-               return -1;
+               return NULL;
            }
        if (bss_len)
            if (syslinux_add_memmap
-               (&mmap, mbh->load_end_addr, bss_len, SMT_ZERO)) {
+               (&mmap, bss_addr, bss_len, SMT_ZERO)) {
                error("Failed to map a.out bss\n");
-               return -1;
+               return NULL;
            }
-       if (mbh->bss_end_addr > mboot_high_water_mark)
-           mboot_high_water_mark = mbh->bss_end_addr;
+       if (bss_addr + bss_len > mboot_high_water_mark)
+           mboot_high_water_mark = bss_addr + bss_len;
     } else {
        error
            ("Invalid Multiboot image: neither ELF header nor a.out kludge found\n");
-       return -1;
+       return NULL;
     }
 
-    return 0;
+    return mbh;
 }
 
 /*