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;
 | |
| }
 |