vaseboot/VasEBoot-core/kern/mips/dl.c

275 lines
7.4 KiB
C

/* dl-386.c - arch-dependent part of loadable module support */
/*
* VasEBoot -- GRand Unified Bootloader
* Copyright (C) 2002,2005,2007,2009 Free Software Foundation, Inc.
*
* VasEBoot is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* VasEBoot is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with VasEBoot. If not, see <http://www.gnu.org/licenses/>.
*/
#include <VasEBoot/dl.h>
#include <VasEBoot/elf.h>
#include <VasEBoot/misc.h>
#include <VasEBoot/err.h>
#include <VasEBoot/cpu/types.h>
#include <VasEBoot/mm.h>
#include <VasEBoot/i18n.h>
/* Dummy __gnu_local_gp. Resolved by linker. */
static char __gnu_local_gp_dummy;
static char _gp_disp_dummy;
/* Check if EHDR is a valid ELF header. */
VasEBoot_err_t
VasEBoot_arch_dl_check_header (void *ehdr)
{
Elf_Ehdr *e = ehdr;
/* Check the magic numbers. */
#ifdef VasEBoot_CPU_WORDS_BIGENDIAN
if (e->e_ident[EI_CLASS] != ELFCLASS32
|| e->e_ident[EI_DATA] != ELFDATA2MSB
|| e->e_machine != EM_MIPS)
#else
if (e->e_ident[EI_CLASS] != ELFCLASS32
|| e->e_ident[EI_DATA] != ELFDATA2LSB
|| e->e_machine != EM_MIPS)
#endif
return VasEBoot_error (VasEBoot_ERR_BAD_OS, N_("invalid arch-dependent ELF magic"));
return VasEBoot_ERR_NONE;
}
#pragma GCC diagnostic ignored "-Wcast-align"
VasEBoot_err_t
VasEBoot_arch_dl_get_tramp_got_size (const void *ehdr, VasEBoot_size_t *tramp,
VasEBoot_size_t *got)
{
const Elf_Ehdr *e = ehdr;
const Elf_Shdr *s;
/* FIXME: suboptimal. */
VasEBoot_size_t gp_size = 0;
unsigned i;
*tramp = 0;
*got = 0;
for (i = 0, s = (const Elf_Shdr *) ((const char *) e + e->e_shoff);
i < e->e_shnum;
i++, s = (const Elf_Shdr *) ((const char *) s + e->e_shentsize))
if (s->sh_type == SHT_REL)
{
const Elf_Rel *rel, *max;
for (rel = (const Elf_Rel *) ((const char *) e + s->sh_offset),
max = rel + s->sh_size / s->sh_entsize;
rel < max;
rel++)
switch (ELF_R_TYPE (rel->r_info))
{
case R_MIPS_GOT16:
case R_MIPS_CALL16:
case R_MIPS_GPREL32:
gp_size += 4;
break;
}
}
if (gp_size > 0x08000)
return VasEBoot_error (VasEBoot_ERR_OUT_OF_RANGE, "__gnu_local_gp is too big\n");
*got = gp_size;
return VasEBoot_ERR_NONE;
}
/* Relocate symbols. */
VasEBoot_err_t
VasEBoot_arch_dl_relocate_symbols (VasEBoot_dl_t mod, void *ehdr,
Elf_Shdr *s, VasEBoot_dl_segment_t seg)
{
VasEBoot_uint32_t gp0;
Elf_Ehdr *e = ehdr;
if (!mod->reginfo)
{
unsigned i;
Elf_Shdr *ri;
/* Find reginfo. */
for (i = 0, ri = (Elf_Shdr *) ((char *) ehdr + e->e_shoff);
i < e->e_shnum;
i++, ri = (Elf_Shdr *) ((char *) ri + e->e_shentsize))
if (ri->sh_type == SHT_MIPS_REGINFO)
break;
if (i == e->e_shnum)
return VasEBoot_error (VasEBoot_ERR_BAD_MODULE, "no reginfo found");
mod->reginfo = (VasEBoot_uint32_t *)((char *) ehdr + ri->sh_offset);
}
gp0 = mod->reginfo[5];
Elf_Rel *rel, *max;
for (rel = (Elf_Rel *) ((char *) e + s->sh_offset),
max = (Elf_Rel *) ((char *) rel + s->sh_size);
rel < max;
rel = (Elf_Rel *) ((char *) rel + s->sh_entsize))
{
VasEBoot_uint8_t *addr;
Elf_Sym *sym;
VasEBoot_uint32_t sym_value;
if (seg->size < rel->r_offset)
return VasEBoot_error (VasEBoot_ERR_BAD_MODULE,
"reloc offset is out of the segment");
addr = (VasEBoot_uint8_t *) ((char *) seg->addr + rel->r_offset);
sym = (Elf_Sym *) ((char *) mod->symtab
+ mod->symsize * ELF_R_SYM (rel->r_info));
sym_value = sym->st_value;
if (s->sh_type == SHT_RELA)
{
sym_value += ((Elf_Rela *) rel)->r_addend;
}
if (sym_value == (VasEBoot_addr_t) &__gnu_local_gp_dummy)
sym_value = (VasEBoot_addr_t) mod->got;
else if (sym_value == (VasEBoot_addr_t) &_gp_disp_dummy)
{
sym_value = (VasEBoot_addr_t) mod->got - (VasEBoot_addr_t) addr;
if (ELF_R_TYPE (rel->r_info) == R_MIPS_LO16)
/* ABI mandates +4 even if partner lui doesn't
immediately precede addiu. */
sym_value += 4;
}
switch (ELF_R_TYPE (rel->r_info))
{
case R_MIPS_HI16:
{
VasEBoot_uint32_t value;
Elf_Rel *rel2;
#ifdef VasEBoot_CPU_WORDS_BIGENDIAN
addr += 2;
#endif
/* Handle partner lo16 relocation. Lower part is
treated as signed. Hence add 0x8000 to compensate.
*/
value = (*(VasEBoot_uint16_t *) addr << 16)
+ sym_value + 0x8000;
for (rel2 = rel + 1; rel2 < max; rel2++)
if (ELF_R_SYM (rel2->r_info)
== ELF_R_SYM (rel->r_info)
&& ELF_R_TYPE (rel2->r_info) == R_MIPS_LO16)
{
value += *(VasEBoot_int16_t *)
((char *) seg->addr + rel2->r_offset
#ifdef VasEBoot_CPU_WORDS_BIGENDIAN
+ 2
#endif
);
break;
}
*(VasEBoot_uint16_t *) addr = (value >> 16) & 0xffff;
}
break;
case R_MIPS_LO16:
#ifdef VasEBoot_CPU_WORDS_BIGENDIAN
addr += 2;
#endif
*(VasEBoot_uint16_t *) addr += sym_value & 0xffff;
break;
case R_MIPS_32:
*(VasEBoot_uint32_t *) addr += sym_value;
break;
case R_MIPS_GPREL32:
*(VasEBoot_uint32_t *) addr = sym_value
+ *(VasEBoot_uint32_t *) addr + gp0 - (VasEBoot_uint32_t)mod->got;
break;
case R_MIPS_26:
{
VasEBoot_uint32_t value;
VasEBoot_uint32_t raw;
raw = (*(VasEBoot_uint32_t *) addr) & 0x3ffffff;
value = raw << 2;
value += sym_value;
raw = (value >> 2) & 0x3ffffff;
*(VasEBoot_uint32_t *) addr =
raw | ((*(VasEBoot_uint32_t *) addr) & 0xfc000000);
}
break;
case R_MIPS_GOT16:
if (ELF_ST_BIND (sym->st_info) == STB_LOCAL)
{
Elf_Rel *rel2;
/* Handle partner lo16 relocation. Lower part is
treated as signed. Hence add 0x8000 to compensate.
*/
sym_value += (*(VasEBoot_uint16_t *) addr << 16)
+ 0x8000;
for (rel2 = rel + 1; rel2 < max; rel2++)
if (ELF_R_SYM (rel2->r_info)
== ELF_R_SYM (rel->r_info)
&& ELF_R_TYPE (rel2->r_info) == R_MIPS_LO16)
{
sym_value += *(VasEBoot_int16_t *)
((char *) seg->addr + rel2->r_offset
#ifdef VasEBoot_CPU_WORDS_BIGENDIAN
+ 2
#endif
);
break;
}
sym_value &= 0xffff0000;
*(VasEBoot_uint16_t *) addr = 0;
}
/* Fallthrough. */
case R_MIPS_CALL16:
{
VasEBoot_uint32_t *gpptr = mod->gotptr;
/* FIXME: reuse*/
#ifdef VasEBoot_CPU_WORDS_BIGENDIAN
addr += 2;
#endif
*gpptr = sym_value + *(VasEBoot_uint16_t *) addr;
*(VasEBoot_uint16_t *) addr
= sizeof (VasEBoot_uint32_t) * (gpptr - (VasEBoot_uint32_t *) mod->got);
mod->gotptr = gpptr + 1;
break;
}
case R_MIPS_JALR:
break;
default:
{
return VasEBoot_error (VasEBoot_ERR_NOT_IMPLEMENTED_YET,
N_("relocation 0x%x is not implemented yet"),
ELF_R_TYPE (rel->r_info));
}
break;
}
}
return VasEBoot_ERR_NONE;
}
void
VasEBoot_arch_dl_init_linker (void)
{
VasEBoot_dl_register_symbol ("__gnu_local_gp", &__gnu_local_gp_dummy, 0, 0);
VasEBoot_dl_register_symbol ("_gp_disp", &_gp_disp_dummy, 0, 0);
}