219 lines
		
	
	
		
			5.7 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			219 lines
		
	
	
		
			5.7 KiB
		
	
	
	
		
			C
		
	
	
	
#ifdef BSWAP_NEEDED
 | 
						|
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);
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
static int glue(find_phdr, SZ)(struct elfhdr *ehdr, int fd, struct elf_phdr *phdr, elf_word type)
 | 
						|
{
 | 
						|
    int i, retval;
 | 
						|
 | 
						|
    retval = lseek(fd, ehdr->e_phoff, SEEK_SET);
 | 
						|
    if (retval < 0)
 | 
						|
	return -1;
 | 
						|
 | 
						|
    for (i = 0; i < ehdr->e_phnum; i++) {
 | 
						|
	retval = read(fd, phdr, sizeof(*phdr));
 | 
						|
	if (retval < 0)
 | 
						|
	    return -1;
 | 
						|
	glue(bswap_phdr, SZ)(phdr);
 | 
						|
	if (phdr->p_type == type)
 | 
						|
	    return 0;
 | 
						|
    }
 | 
						|
    return -1;
 | 
						|
}
 | 
						|
 | 
						|
static void * glue(find_shdr, SZ)(struct elfhdr *ehdr, int fd, struct elf_shdr *shdr, elf_word type)
 | 
						|
{
 | 
						|
    int i, retval;
 | 
						|
 | 
						|
    retval = lseek(fd, ehdr->e_shoff, SEEK_SET);
 | 
						|
    if (retval < 0)
 | 
						|
	return NULL;
 | 
						|
 | 
						|
    for (i = 0; i < ehdr->e_shnum; i++) {
 | 
						|
	retval = read(fd, shdr, sizeof(*shdr));
 | 
						|
	if (retval < 0)
 | 
						|
	    return NULL;
 | 
						|
	glue(bswap_shdr, SZ)(shdr);
 | 
						|
	if (shdr->sh_type == type)
 | 
						|
	    return qemu_malloc(shdr->sh_size);
 | 
						|
    }
 | 
						|
    return NULL;
 | 
						|
}
 | 
						|
 | 
						|
static void * glue(find_strtab, SZ)(struct elfhdr *ehdr, int fd, struct elf_shdr *shdr, struct elf_shdr *symtab)
 | 
						|
{
 | 
						|
    int retval;
 | 
						|
 | 
						|
    retval = lseek(fd, ehdr->e_shoff + sizeof(struct elf_shdr) * symtab->sh_link, SEEK_SET);
 | 
						|
    if (retval < 0)
 | 
						|
	return NULL;
 | 
						|
 | 
						|
    retval = read(fd, shdr, sizeof(*shdr));
 | 
						|
    if (retval < 0)
 | 
						|
	return NULL;
 | 
						|
    glue(bswap_shdr, SZ)(shdr);
 | 
						|
    if (shdr->sh_type == SHT_STRTAB)
 | 
						|
	return qemu_malloc(shdr->sh_size);;
 | 
						|
    return NULL;
 | 
						|
}
 | 
						|
 | 
						|
static int glue(read_program, SZ)(int fd, struct elf_phdr *phdr, void *dst, elf_word entry)
 | 
						|
{
 | 
						|
    int retval;
 | 
						|
    retval = lseek(fd, phdr->p_offset + entry - phdr->p_vaddr, SEEK_SET);
 | 
						|
    if (retval < 0)
 | 
						|
	return -1;
 | 
						|
    return read(fd, dst, phdr->p_filesz);
 | 
						|
}
 | 
						|
 | 
						|
static int glue(read_section, SZ)(int fd, struct elf_shdr *s, void *dst)
 | 
						|
{
 | 
						|
    int retval;
 | 
						|
 | 
						|
    retval = lseek(fd, s->sh_offset, SEEK_SET);
 | 
						|
    if (retval < 0)
 | 
						|
	return -1;
 | 
						|
    retval = read(fd, dst, s->sh_size);
 | 
						|
    if (retval < 0)
 | 
						|
	return -1;
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static void * glue(process_section, SZ)(struct elfhdr *ehdr, int fd, struct elf_shdr *shdr, elf_word type)
 | 
						|
{
 | 
						|
    void *dst;
 | 
						|
 | 
						|
    dst = glue(find_shdr, SZ)(ehdr, fd, shdr, type);
 | 
						|
    if (!dst)
 | 
						|
	goto error;
 | 
						|
 | 
						|
    if (glue(read_section, SZ)(fd, shdr, dst))
 | 
						|
	goto error;
 | 
						|
    return dst;
 | 
						|
 error:
 | 
						|
    qemu_free(dst);
 | 
						|
    return NULL;
 | 
						|
}
 | 
						|
 | 
						|
static void * glue(process_strtab, SZ)(struct elfhdr *ehdr, int fd, struct elf_shdr *shdr, struct elf_shdr *symtab)
 | 
						|
{
 | 
						|
    void *dst;
 | 
						|
 | 
						|
    dst = glue(find_strtab, SZ)(ehdr, fd, shdr, symtab);
 | 
						|
    if (!dst)
 | 
						|
	goto error;
 | 
						|
 | 
						|
    if (glue(read_section, SZ)(fd, shdr, dst))
 | 
						|
	goto error;
 | 
						|
    return dst;
 | 
						|
 error:
 | 
						|
    qemu_free(dst);
 | 
						|
    return NULL;
 | 
						|
}
 | 
						|
 | 
						|
static void glue(load_symbols, SZ)(struct elfhdr *ehdr, int fd)
 | 
						|
{
 | 
						|
    struct elf_shdr symtab, strtab;
 | 
						|
    struct elf_sym *syms;
 | 
						|
#if (SZ == 64)
 | 
						|
    struct elf32_sym *syms32;
 | 
						|
#endif
 | 
						|
    struct syminfo *s;
 | 
						|
    int nsyms, i;
 | 
						|
    char *str;
 | 
						|
 | 
						|
    /* Symbol table */
 | 
						|
    syms = glue(process_section, SZ)(ehdr, fd, &symtab, SHT_SYMTAB);
 | 
						|
    if (!syms)
 | 
						|
	return;
 | 
						|
 | 
						|
    nsyms = symtab.sh_size / sizeof(struct elf_sym);
 | 
						|
#if (SZ == 64)
 | 
						|
    syms32 = qemu_mallocz(nsyms * sizeof(struct elf32_sym));
 | 
						|
#endif
 | 
						|
    for (i = 0; i < nsyms; i++) {
 | 
						|
	glue(bswap_sym, SZ)(&syms[i]);
 | 
						|
#if (SZ == 64)
 | 
						|
	syms32[i].st_name = syms[i].st_name;
 | 
						|
	syms32[i].st_info = syms[i].st_info;
 | 
						|
	syms32[i].st_other = syms[i].st_other;
 | 
						|
	syms32[i].st_shndx = syms[i].st_shndx;
 | 
						|
	syms32[i].st_value = syms[i].st_value & 0xffffffff;
 | 
						|
	syms32[i].st_size = syms[i].st_size & 0xffffffff;
 | 
						|
#endif
 | 
						|
    }
 | 
						|
    /* String table */
 | 
						|
    str = glue(process_strtab, SZ)(ehdr, fd, &strtab, &symtab);
 | 
						|
    if (!str)
 | 
						|
	goto error_freesyms;
 | 
						|
 | 
						|
    /* Commit */
 | 
						|
    s = qemu_mallocz(sizeof(*s));
 | 
						|
#if (SZ == 64)
 | 
						|
    s->disas_symtab = syms32;
 | 
						|
    qemu_free(syms);
 | 
						|
#else
 | 
						|
    s->disas_symtab = syms;
 | 
						|
#endif
 | 
						|
    s->disas_num_syms = nsyms;
 | 
						|
    s->disas_strtab = str;
 | 
						|
    s->next = syminfos;
 | 
						|
    syminfos = s;
 | 
						|
    return;
 | 
						|
 error_freesyms:
 | 
						|
#if (SZ == 64)
 | 
						|
    qemu_free(syms32);
 | 
						|
#endif
 | 
						|
    qemu_free(syms);
 | 
						|
    return;
 | 
						|
}
 |