vaseboot/VasEBoot-core/kern/elfXX.c

int
VasEBoot_elf_is_elfXX (VasEBoot_elf_t elf)
{
  return elf->ehdr.ehdrXX.e_ident[EI_CLASS] == ELFCLASSXX;
}

VasEBoot_err_t
VasEBoot_elfXX_load_phdrs (VasEBoot_elf_t elf)
{
  VasEBoot_ssize_t phdrs_size;

  if (elf->phdrs)
    return VasEBoot_ERR_NONE;

  phdrs_size = (VasEBoot_uint32_t) elf->ehdr.ehdrXX.e_phnum * elf->ehdr.ehdrXX.e_phentsize;

  VasEBoot_dprintf ("elf", "Loading program headers at 0x%llx, size 0x%lx.\n",
		(unsigned long long) elf->ehdr.ehdrXX.e_phoff,
		(unsigned long) phdrs_size);

  elf->phdrs = VasEBoot_malloc (phdrs_size);
  if (! elf->phdrs)
    return VasEBoot_errno;

  if ((VasEBoot_file_seek (elf->file, elf->ehdr.ehdrXX.e_phoff) == (VasEBoot_off_t) -1)
      || (VasEBoot_file_read (elf->file, elf->phdrs, phdrs_size) != phdrs_size))
    {
      if (!VasEBoot_errno)
	VasEBoot_error (VasEBoot_ERR_FILE_READ_ERROR, N_("premature end of file %s"),
		    elf->filename);
      return VasEBoot_errno;
    }

#if VasEBoot_ELF_ENABLE_BI_ENDIAN
  if (elf->ehdr.ehdrXX.e_ident[EI_DATA] == VasEBoot_ELF_OPPOSITE_ENDIANNESS)
    {
      ElfXX_Phdr *phdr;
      for (phdr = elf->phdrs; (char *) phdr < (char *) elf->phdrs + phdrs_size;
	   phdr = (ElfXX_Phdr *) ((char *) phdr + elf->ehdr.ehdrXX.e_phentsize))
	{
	  phdr->p_type = VasEBoot_swap_bytes_wordXX (phdr->p_type);
	  phdr->p_flags = VasEBoot_swap_bytes_wordXX (phdr->p_flags);
          phdr->p_offset = VasEBoot_swap_bytes_offXX (phdr->p_offset);
          phdr->p_vaddr = VasEBoot_swap_bytes_addrXX (phdr->p_vaddr);
          phdr->p_paddr = VasEBoot_swap_bytes_addrXX (phdr->p_paddr);
          phdr->p_filesz = VasEBoot_swap_bytes_XwordXX (phdr->p_filesz);
          phdr->p_memsz = VasEBoot_swap_bytes_XwordXX (phdr->p_memsz);
          phdr->p_align = VasEBoot_swap_bytes_XwordXX (phdr->p_align);
        }
    }
#endif /* VasEBoot_ELF_ENABLE_BI_ENDIAN */

  return VasEBoot_ERR_NONE;
}

/* Calculate the amount of memory spanned by the segments.  */
VasEBoot_size_t
VasEBoot_elfXX_size (VasEBoot_elf_t elf,
		 ElfXX_Addr *base, VasEBoot_uintXX_t *max_align)
{
  ElfXX_Addr segments_start = (ElfXX_Addr) -1;
  ElfXX_Addr segments_end = 0;
  int nr_phdrs = 0;
  VasEBoot_uint32_t curr_align = 1;
  ElfXX_Phdr *phdr;

  /* Run through the program headers to calculate the total memory size we
   * should claim.  */
  FOR_ELFXX_PHDRS (elf, phdr)
    {
      /* Only consider loadable segments.  */
      if (phdr->p_type != PT_LOAD)
	continue;
      nr_phdrs++;
      if (phdr->p_paddr < segments_start)
	segments_start = phdr->p_paddr;
      if (phdr->p_paddr + phdr->p_memsz > segments_end)
	segments_end = phdr->p_paddr + phdr->p_memsz;
      if (curr_align < phdr->p_align)
	curr_align = phdr->p_align;
    }

  if (base)
    *base = 0;

  if (nr_phdrs == 0)
    {
      VasEBoot_error (VasEBoot_ERR_BAD_OS, "no program headers present");
      return 0;
    }

  if (segments_end < segments_start)
    {
      /* Very bad addresses.  */
      VasEBoot_error (VasEBoot_ERR_BAD_OS, "bad program header load addresses");
      return 0;
    }

  if (base)
    *base = segments_start;
  if (max_align)
    *max_align = curr_align;
  return segments_end - segments_start;
}

VasEBoot_err_t
VasEBoot_elfXX_load (VasEBoot_elf_t elf, const char *filename,
		 void *load_offset, enum VasEBoot_elf_load_flags load_flags,
		 VasEBoot_addr_t *base, VasEBoot_size_t *size)
{
  VasEBoot_addr_t load_base = (VasEBoot_addr_t) -1ULL;
  VasEBoot_size_t load_size = 0;
  ElfXX_Phdr *phdr;

  FOR_ELFXX_PHDRS(elf, phdr)
  {
    VasEBoot_addr_t load_addr;

    if (phdr->p_type != PT_LOAD && !((load_flags & VasEBoot_ELF_LOAD_FLAGS_LOAD_PT_DYNAMIC) && phdr->p_type == PT_DYNAMIC))
      continue;

    load_addr = (VasEBoot_addr_t) phdr->p_paddr;
    switch (load_flags & VasEBoot_ELF_LOAD_FLAGS_BITS)
      {
      case VasEBoot_ELF_LOAD_FLAGS_ALL_BITS:
	break;
      case VasEBoot_ELF_LOAD_FLAGS_28BITS:
	load_addr &= 0xFFFFFFF;
	break;
      case VasEBoot_ELF_LOAD_FLAGS_30BITS:
	load_addr &= 0x3FFFFFFF;
	break;
      case VasEBoot_ELF_LOAD_FLAGS_62BITS:
	load_addr &= 0x3FFFFFFFFFFFFFFFULL;
	break;
      }
    load_addr += (VasEBoot_addr_t) load_offset;

    if (load_addr < load_base)
      load_base = load_addr;

    VasEBoot_dprintf ("elf", "Loading segment at 0x%llx, size 0x%llx\n",
		  (unsigned long long) load_addr,
		  (unsigned long long) phdr->p_memsz);

    if (VasEBoot_file_seek (elf->file, phdr->p_offset) == (VasEBoot_off_t) -1)
      return VasEBoot_errno;

    if (phdr->p_filesz)
      {
	VasEBoot_ssize_t read;
	read = VasEBoot_file_read (elf->file, (void *) load_addr, phdr->p_filesz);
	if (read != (VasEBoot_ssize_t) phdr->p_filesz)
	  {
	    if (!VasEBoot_errno)
	      VasEBoot_error (VasEBoot_ERR_FILE_READ_ERROR, N_("premature end of file %s"),
			  filename);
	    return VasEBoot_errno;
	  }
      }

    if (phdr->p_filesz < phdr->p_memsz)
      VasEBoot_memset ((void *) (VasEBoot_addr_t) (load_addr + phdr->p_filesz),
		   0, phdr->p_memsz - phdr->p_filesz);

    load_size += phdr->p_memsz;
  }

  if (base)
    *base = load_base;
  if (size)
    *size = load_size;

  return VasEBoot_errno;
}

static int
VasEBoot_elfXX_check_endianess_and_bswap_ehdr (VasEBoot_elf_t elf)
{
  ElfXX_Ehdr *e = &(elf->ehdr.ehdrXX);
  if (e->e_ident[EI_DATA] == VasEBoot_ELF_NATIVE_ENDIANNESS)
    {
      return 1;
    }

#if VasEBoot_ELF_ENABLE_BI_ENDIAN
  if (e->e_ident[EI_DATA] == VasEBoot_ELF_OPPOSITE_ENDIANNESS)
    {
      e->e_type = VasEBoot_swap_bytes_halfXX (e->e_type);
      e->e_machine = VasEBoot_swap_bytes_halfXX (e->e_machine);
      e->e_version = VasEBoot_swap_bytes_wordXX (e->e_version);
      e->e_entry = VasEBoot_swap_bytes_addrXX (e->e_entry);
      e->e_phoff = VasEBoot_swap_bytes_offXX (e->e_phoff);
      e->e_shoff = VasEBoot_swap_bytes_offXX (e->e_shoff);
      e->e_flags = VasEBoot_swap_bytes_wordXX (e->e_flags);
      e->e_ehsize = VasEBoot_swap_bytes_halfXX (e->e_ehsize);
      e->e_phentsize = VasEBoot_swap_bytes_halfXX (e->e_phentsize);
      e->e_phnum = VasEBoot_swap_bytes_halfXX (e->e_phnum);
      e->e_shentsize = VasEBoot_swap_bytes_halfXX (e->e_shentsize);
      e->e_shnum = VasEBoot_swap_bytes_halfXX (e->e_shnum);
      e->e_shstrndx = VasEBoot_swap_bytes_halfXX (e->e_shstrndx);
      return 1;
    }
#endif /* VasEBoot_ELF_ENABLE_BI_ENDIAN */

  return 0;
}