[qemu.git] / elf_ops.h

static void glue(bswap_ehdr, SZ)(struct elfhdr *ehdr)
{
    bswap16s(&ehdr->e_type);			/* Object file type */
    bswap16s(&ehdr->e_machine);		/* Architecture */
    bswap32s(&ehdr->e_version);		/* Object file version */
    bswapSZs(&ehdr->e_entry);		/* Entry point virtual address */
    bswapSZs(&ehdr->e_phoff);		/* Program header table file offset */
    bswapSZs(&ehdr->e_shoff);		/* Section header table file offset */
    bswap32s(&ehdr->e_flags);		/* Processor-specific flags */
    bswap16s(&ehdr->e_ehsize);		/* ELF header size in bytes */
    bswap16s(&ehdr->e_phentsize);		/* Program header table entry size */
    bswap16s(&ehdr->e_phnum);		/* Program header table entry count */
    bswap16s(&ehdr->e_shentsize);		/* Section header table entry size */
    bswap16s(&ehdr->e_shnum);		/* Section header table entry count */
    bswap16s(&ehdr->e_shstrndx);		/* Section header string table index */
}

static void glue(bswap_phdr, SZ)(struct elf_phdr *phdr)
{
    bswap32s(&phdr->p_type);			/* Segment type */
    bswapSZs(&phdr->p_offset);		/* Segment file offset */
    bswapSZs(&phdr->p_vaddr);		/* Segment virtual address */
    bswapSZs(&phdr->p_paddr);		/* Segment physical address */
    bswapSZs(&phdr->p_filesz);		/* Segment size in file */
    bswapSZs(&phdr->p_memsz);		/* Segment size in memory */
    bswap32s(&phdr->p_flags);		/* Segment flags */
    bswapSZs(&phdr->p_align);		/* Segment alignment */
}

static void glue(bswap_shdr, SZ)(struct elf_shdr *shdr)
{
    bswap32s(&shdr->sh_name);
    bswap32s(&shdr->sh_type);
    bswapSZs(&shdr->sh_flags);
    bswapSZs(&shdr->sh_addr);
    bswapSZs(&shdr->sh_offset);
    bswapSZs(&shdr->sh_size);
    bswap32s(&shdr->sh_link);
    bswap32s(&shdr->sh_info);
    bswapSZs(&shdr->sh_addralign);
    bswapSZs(&shdr->sh_entsize);
}

static void glue(bswap_sym, SZ)(struct elf_sym *sym)
{
    bswap32s(&sym->st_name);
    bswapSZs(&sym->st_value);
    bswapSZs(&sym->st_size);
    bswap16s(&sym->st_shndx);
}

static struct elf_shdr *glue(find_section, SZ)(struct elf_shdr *shdr_table,
                                               int n, int type)
{
    int i;
    for(i=0;i<n;i++) {
        if (shdr_table[i].sh_type == type)
            return shdr_table + i;
    }
    return NULL;
}

static int glue(symfind, SZ)(const void *s0, const void *s1)
{
    struct elf_sym *key = (struct elf_sym *)s0;
    struct elf_sym *sym = (struct elf_sym *)s1;
    int result = 0;
    if (key->st_value < sym->st_value) {
        result = -1;
    } else if (key->st_value > sym->st_value + sym->st_size) {
        result = 1;
    }
    return result;
}

static const char *glue(lookup_symbol, SZ)(struct syminfo *s, target_ulong orig_addr)
{
    struct elf_sym *syms = glue(s->disas_symtab.elf, SZ);
    struct elf_sym key;
    struct elf_sym *sym;

    key.st_value = orig_addr;

    sym = bsearch(&key, syms, s->disas_num_syms, sizeof(*syms), glue(symfind, SZ));
    if (sym != 0) {
        return s->disas_strtab + sym->st_name;
    }

    return "";
}

static int glue(symcmp, SZ)(const void *s0, const void *s1)
{
    struct elf_sym *sym0 = (struct elf_sym *)s0;
    struct elf_sym *sym1 = (struct elf_sym *)s1;
    return (sym0->st_value < sym1->st_value)
        ? -1
        : ((sym0->st_value > sym1->st_value) ? 1 : 0);
}

static int glue(load_symbols, SZ)(struct elfhdr *ehdr, int fd, int must_swab)
{
    struct elf_shdr *symtab, *strtab, *shdr_table = NULL;
    struct elf_sym *syms = NULL;
    struct syminfo *s;
    int nsyms, i;
    char *str = NULL;

    shdr_table = load_at(fd, ehdr->e_shoff,
                         sizeof(struct elf_shdr) * ehdr->e_shnum);
    if (!shdr_table)
        return -1;

    if (must_swab) {
        for (i = 0; i < ehdr->e_shnum; i++) {
            glue(bswap_shdr, SZ)(shdr_table + i);
        }
    }

    symtab = glue(find_section, SZ)(shdr_table, ehdr->e_shnum, SHT_SYMTAB);
    if (!symtab)
        goto fail;
    syms = load_at(fd, symtab->sh_offset, symtab->sh_size);
    if (!syms)
        goto fail;

    nsyms = symtab->sh_size / sizeof(struct elf_sym);

    i = 0;
    while (i < nsyms) {
        if (must_swab)
            glue(bswap_sym, SZ)(&syms[i]);
        /* We are only interested in function symbols.
           Throw everything else away.  */
        if (syms[i].st_shndx == SHN_UNDEF ||
                syms[i].st_shndx >= SHN_LORESERVE ||
                ELF_ST_TYPE(syms[i].st_info) != STT_FUNC) {
            nsyms--;
            if (i < nsyms) {
                syms[i] = syms[nsyms];
            }
            continue;
        }
#if defined(TARGET_ARM) || defined (TARGET_MIPS)
        /* The bottom address bit marks a Thumb or MIPS16 symbol.  */
        syms[i].st_value &= ~(target_ulong)1;
#endif
        i++;
    }
    syms = qemu_realloc(syms, nsyms * sizeof(*syms));

    qsort(syms, nsyms, sizeof(*syms), glue(symcmp, SZ));

    /* String table */
    if (symtab->sh_link >= ehdr->e_shnum)
        goto fail;
    strtab = &shdr_table[symtab->sh_link];

    str = load_at(fd, strtab->sh_offset, strtab->sh_size);
    if (!str)
        goto fail;

    /* Commit */
    s = qemu_mallocz(sizeof(*s));
    s->lookup_symbol = glue(lookup_symbol, SZ);
    glue(s->disas_symtab.elf, SZ) = syms;
    s->disas_num_syms = nsyms;
    s->disas_strtab = str;
    s->next = syminfos;
    syminfos = s;
    qemu_free(shdr_table);
    return 0;
 fail:
    qemu_free(syms);
    qemu_free(str);
    qemu_free(shdr_table);
    return -1;
}

static int glue(load_elf, SZ)(int fd, int64_t address_offset,
                              int must_swab, uint64_t *pentry,
                              uint64_t *lowaddr, uint64_t *highaddr)
{
    struct elfhdr ehdr;
    struct elf_phdr *phdr = NULL, *ph;
    int size, i, total_size;
    elf_word mem_size;
    uint64_t addr, low = 0, high = 0;
    uint8_t *data = NULL;

    if (read(fd, &ehdr, sizeof(ehdr)) != sizeof(ehdr))
        goto fail;
    if (must_swab) {
        glue(bswap_ehdr, SZ)(&ehdr);
    }

    if (ELF_MACHINE != ehdr.e_machine)
        goto fail;

    if (pentry)
   	*pentry = (uint64_t)(elf_sword)ehdr.e_entry;

    glue(load_symbols, SZ)(&ehdr, fd, must_swab);

    size = ehdr.e_phnum * sizeof(phdr[0]);
    lseek(fd, ehdr.e_phoff, SEEK_SET);
    phdr = qemu_mallocz(size);
    if (!phdr)
        goto fail;
    if (read(fd, phdr, size) != size)
        goto fail;
    if (must_swab) {
        for(i = 0; i < ehdr.e_phnum; i++) {
            ph = &phdr[i];
            glue(bswap_phdr, SZ)(ph);
        }
    }

    total_size = 0;
    for(i = 0; i < ehdr.e_phnum; i++) {
        ph = &phdr[i];
        if (ph->p_type == PT_LOAD) {
            mem_size = ph->p_memsz;
            /* XXX: avoid allocating */
            data = qemu_mallocz(mem_size);
            if (ph->p_filesz > 0) {
                if (lseek(fd, ph->p_offset, SEEK_SET) < 0)
                    goto fail;
                if (read(fd, data, ph->p_filesz) != ph->p_filesz)
                    goto fail;
            }
            /* address_offset is hack for kernel images that are
               linked at the wrong physical address.  */
            addr = ph->p_paddr + address_offset;

            cpu_physical_memory_write_rom(addr, data, mem_size);

            total_size += mem_size;
            if (!low || addr < low)
                low = addr;
            if (!high || (addr + mem_size) > high)
                high = addr + mem_size;

            qemu_free(data);
            data = NULL;
        }
    }
    qemu_free(phdr);
    if (lowaddr)
        *lowaddr = (uint64_t)(elf_sword)low;
    if (highaddr)
        *highaddr = (uint64_t)(elf_sword)high;
    return total_size;
 fail:
    qemu_free(data);
    qemu_free(phdr);
    return -1;
}
Commit	Line	Data
5fe141fd FB	1	static void glue(bswap_ehdr, SZ)(struct elfhdr *ehdr)
	2	{
	3	bswap16s(&ehdr->e_type); /* Object file type */
	4	bswap16s(&ehdr->e_machine); /* Architecture */
	5	bswap32s(&ehdr->e_version); /* Object file version */
	6	bswapSZs(&ehdr->e_entry); /* Entry point virtual address */
	7	bswapSZs(&ehdr->e_phoff); /* Program header table file offset */
	8	bswapSZs(&ehdr->e_shoff); /* Section header table file offset */
	9	bswap32s(&ehdr->e_flags); /* Processor-specific flags */
	10	bswap16s(&ehdr->e_ehsize); /* ELF header size in bytes */
	11	bswap16s(&ehdr->e_phentsize); /* Program header table entry size */
	12	bswap16s(&ehdr->e_phnum); /* Program header table entry count */
	13	bswap16s(&ehdr->e_shentsize); /* Section header table entry size */
	14	bswap16s(&ehdr->e_shnum); /* Section header table entry count */
	15	bswap16s(&ehdr->e_shstrndx); /* Section header string table index */
	16	}
	17
	18	static void glue(bswap_phdr, SZ)(struct elf_phdr *phdr)
	19	{
	20	bswap32s(&phdr->p_type); /* Segment type */
	21	bswapSZs(&phdr->p_offset); /* Segment file offset */
	22	bswapSZs(&phdr->p_vaddr); /* Segment virtual address */
	23	bswapSZs(&phdr->p_paddr); /* Segment physical address */
	24	bswapSZs(&phdr->p_filesz); /* Segment size in file */
	25	bswapSZs(&phdr->p_memsz); /* Segment size in memory */
	26	bswap32s(&phdr->p_flags); /* Segment flags */
	27	bswapSZs(&phdr->p_align); /* Segment alignment */
	28	}
	29
	30	static void glue(bswap_shdr, SZ)(struct elf_shdr *shdr)
	31	{
	32	bswap32s(&shdr->sh_name);
	33	bswap32s(&shdr->sh_type);
	34	bswapSZs(&shdr->sh_flags);
	35	bswapSZs(&shdr->sh_addr);
	36	bswapSZs(&shdr->sh_offset);
	37	bswapSZs(&shdr->sh_size);
	38	bswap32s(&shdr->sh_link);
	39	bswap32s(&shdr->sh_info);
	40	bswapSZs(&shdr->sh_addralign);
	41	bswapSZs(&shdr->sh_entsize);
	42	}
	43
	44	static void glue(bswap_sym, SZ)(struct elf_sym *sym)
	45	{
	46	bswap32s(&sym->st_name);
	47	bswapSZs(&sym->st_value);
	48	bswapSZs(&sym->st_size);
	49	bswap16s(&sym->st_shndx);
	50	}
	51
5fafdf24	52	static struct elf_shdr glue(find_section, SZ)(struct elf_shdr shdr_table,
5fe141fd FB	53	int n, int type)
	54	{
	55	int i;
	56	for(i=0;i<n;i++) {
	57	if (shdr_table[i].sh_type == type)
	58	return shdr_table + i;
	59	}
	60	return NULL;
	61	}
	62
49918a75 PB	63	static int glue(symfind, SZ)(const void s0, const void s1)
	64	{
	65	struct elf_sym key = (struct elf_sym )s0;
	66	struct elf_sym sym = (struct elf_sym )s1;
	67	int result = 0;
	68	if (key->st_value < sym->st_value) {
	69	result = -1;
	70	} else if (key->st_value > sym->st_value + sym->st_size) {
	71	result = 1;
	72	}
	73	return result;
	74	}
	75
	76	static const char glue(lookup_symbol, SZ)(struct syminfo s, target_ulong orig_addr)
	77	{
	78	struct elf_sym *syms = glue(s->disas_symtab.elf, SZ);
	79	struct elf_sym key;
	80	struct elf_sym *sym;
	81
	82	key.st_value = orig_addr;
	83
	84	sym = bsearch(&key, syms, s->disas_num_syms, sizeof(*syms), glue(symfind, SZ));
	85	if (sym != 0) {
	86	return s->disas_strtab + sym->st_name;
	87	}
	88
	89	return "";
	90	}
	91
	92	static int glue(symcmp, SZ)(const void s0, const void s1)
	93	{
	94	struct elf_sym sym0 = (struct elf_sym )s0;
	95	struct elf_sym sym1 = (struct elf_sym )s1;
	96	return (sym0->st_value < sym1->st_value)
	97	? -1
	98	: ((sym0->st_value > sym1->st_value) ? 1 : 0);
	99	}
	100
5fe141fd FB	101	static int glue(load_symbols, SZ)(struct elfhdr *ehdr, int fd, int must_swab)
	102	{
	103	struct elf_shdr symtab, strtab, *shdr_table = NULL;
	104	struct elf_sym *syms = NULL;
5fe141fd FB	105	struct syminfo *s;
	106	int nsyms, i;
	107	char *str = NULL;
	108
5fafdf24	109	shdr_table = load_at(fd, ehdr->e_shoff,
5fe141fd FB	110	sizeof(struct elf_shdr) * ehdr->e_shnum);
	111	if (!shdr_table)
	112	return -1;
3b46e624	113
5fe141fd FB	114	if (must_swab) {
	115	for (i = 0; i < ehdr->e_shnum; i++) {
	116	glue(bswap_shdr, SZ)(shdr_table + i);
	117	}
	118	}
3b46e624	119
5fe141fd FB	120	symtab = glue(find_section, SZ)(shdr_table, ehdr->e_shnum, SHT_SYMTAB);
	121	if (!symtab)
	122	goto fail;
	123	syms = load_at(fd, symtab->sh_offset, symtab->sh_size);
	124	if (!syms)
	125	goto fail;
	126
	127	nsyms = symtab->sh_size / sizeof(struct elf_sym);
49918a75 PB	128
	129	i = 0;
	130	while (i < nsyms) {
5fe141fd FB	131	if (must_swab)
5fe141fd FB	132	glue(bswap_sym, SZ)(&syms[i]);
49918a75 PB	133	/* We are only interested in function symbols.
	134	Throw everything else away. */
	135	if (syms[i].st_shndx == SHN_UNDEF \|\|
	136	syms[i].st_shndx >= SHN_LORESERVE \|\|
	137	ELF_ST_TYPE(syms[i].st_info) != STT_FUNC) {
	138	nsyms--;
	139	if (i < nsyms) {
	140	syms[i] = syms[nsyms];
	141	}
	142	continue;
	143	}
	144	#if defined(TARGET_ARM) \|\| defined (TARGET_MIPS)
	145	/* The bottom address bit marks a Thumb or MIPS16 symbol. */
	146	syms[i].st_value &= ~(target_ulong)1;
5fe141fd	147	#endif
49918a75	148	i++;
5fe141fd	149	}
49918a75 PB	150	syms = qemu_realloc(syms, nsyms * sizeof(*syms));
	151
	152	qsort(syms, nsyms, sizeof(*syms), glue(symcmp, SZ));
	153
5fe141fd FB	154	/* String table */
	155	if (symtab->sh_link >= ehdr->e_shnum)
	156	goto fail;
	157	strtab = &shdr_table[symtab->sh_link];
	158
	159	str = load_at(fd, strtab->sh_offset, strtab->sh_size);
	160	if (!str)
49918a75	161	goto fail;
5fe141fd FB	162
	163	/* Commit */
	164	s = qemu_mallocz(sizeof(*s));
49918a75 PB	165	s->lookup_symbol = glue(lookup_symbol, SZ);
49918a75 PB	166	glue(s->disas_symtab.elf, SZ) = syms;
5fe141fd FB	167	s->disas_num_syms = nsyms;
	168	s->disas_strtab = str;
	169	s->next = syminfos;
	170	syminfos = s;
	171	qemu_free(shdr_table);
	172	return 0;
	173	fail:
5fe141fd FB	174	qemu_free(syms);
	175	qemu_free(str);
	176	qemu_free(shdr_table);
	177	return -1;
	178	}
	179
83c1f87c	180	static int glue(load_elf, SZ)(int fd, int64_t address_offset,
9596ebb7 PB	181	int must_swab, uint64_t *pentry,
9596ebb7 PB	182	uint64_t lowaddr, uint64_t highaddr)
5fe141fd FB	183	{
	184	struct elfhdr ehdr;
	185	struct elf_phdr phdr = NULL, ph;
	186	int size, i, total_size;
9437454a	187	elf_word mem_size;
eb296a0a	188	uint64_t addr, low = 0, high = 0;
9ee3c029	189	uint8_t *data = NULL;
5fe141fd FB	190
	191	if (read(fd, &ehdr, sizeof(ehdr)) != sizeof(ehdr))
	192	goto fail;
	193	if (must_swab) {
	194	glue(bswap_ehdr, SZ)(&ehdr);
	195	}
	196
9042c0e2 TS	197	if (ELF_MACHINE != ehdr.e_machine)
	198	goto fail;
	199
9ee3c029	200	if (pentry)
82790064	201	*pentry = (uint64_t)(elf_sword)ehdr.e_entry;
9ee3c029	202
5fe141fd FB	203	glue(load_symbols, SZ)(&ehdr, fd, must_swab);
	204
	205	size = ehdr.e_phnum * sizeof(phdr[0]);
	206	lseek(fd, ehdr.e_phoff, SEEK_SET);
	207	phdr = qemu_mallocz(size);
	208	if (!phdr)
	209	goto fail;
	210	if (read(fd, phdr, size) != size)
04d4b0c3	211	goto fail;
5fe141fd FB	212	if (must_swab) {
	213	for(i = 0; i < ehdr.e_phnum; i++) {
	214	ph = &phdr[i];
	215	glue(bswap_phdr, SZ)(ph);
	216	}
	217	}
3b46e624	218
5fe141fd FB	219	total_size = 0;
	220	for(i = 0; i < ehdr.e_phnum; i++) {
	221	ph = &phdr[i];
	222	if (ph->p_type == PT_LOAD) {
	223	mem_size = ph->p_memsz;
	224	/* XXX: avoid allocating */
	225	data = qemu_mallocz(mem_size);
	226	if (ph->p_filesz > 0) {
9ee3c029	227	if (lseek(fd, ph->p_offset, SEEK_SET) < 0)
04d4b0c3	228	goto fail;
5fe141fd	229	if (read(fd, data, ph->p_filesz) != ph->p_filesz)
04d4b0c3	230	goto fail;
5fe141fd	231	}
83c1f87c PB	232	/* address_offset is hack for kernel images that are
	233	linked at the wrong physical address. */
	234	addr = ph->p_paddr + address_offset;
5fe141fd FB	235
	236	cpu_physical_memory_write_rom(addr, data, mem_size);
	237
	238	total_size += mem_size;
74287114 TS	239	if (!low \|\| addr < low)
	240	low = addr;
	241	if (!high \|\| (addr + mem_size) > high)
	242	high = addr + mem_size;
5fe141fd FB	243
5fe141fd FB	244	qemu_free(data);
9ee3c029	245	data = NULL;
5fe141fd FB	246	}
5fe141fd FB	247	}
3aee288b	248	qemu_free(phdr);
74287114	249	if (lowaddr)
82790064	250	*lowaddr = (uint64_t)(elf_sword)low;
74287114	251	if (highaddr)
82790064	252	*highaddr = (uint64_t)(elf_sword)high;
5fe141fd	253	return total_size;
04d4b0c3	254	fail:
9ee3c029	255	qemu_free(data);
5fe141fd FB	256	qemu_free(phdr);
	257	return -1;
	258	}