|  | #include <stdlib.h> | 
|  | #include <fcntl.h> | 
|  | #include <string.h> | 
|  | #include <sys/stat.h> | 
|  | #include <sys/mman.h> | 
|  |  | 
|  | #include "symbol_table.h" | 
|  | #include "utility.h" | 
|  |  | 
|  | #include <linux/elf.h> | 
|  |  | 
|  | // Compare func for qsort | 
|  | static int qcompar(const void *a, const void *b) | 
|  | { | 
|  | return ((struct symbol*)a)->addr - ((struct symbol*)b)->addr; | 
|  | } | 
|  |  | 
|  | // Compare func for bsearch | 
|  | static int bcompar(const void *addr, const void *element) | 
|  | { | 
|  | struct symbol *symbol = (struct symbol*)element; | 
|  |  | 
|  | if((unsigned int)addr < symbol->addr) { | 
|  | return -1; | 
|  | } | 
|  |  | 
|  | if((unsigned int)addr - symbol->addr >= symbol->size) { | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | *  Create a symbol table from a given file | 
|  | * | 
|  | *  Parameters: | 
|  | *      filename - Filename to process | 
|  | * | 
|  | *  Returns: | 
|  | *      A newly-allocated SymbolTable structure, or NULL if error. | 
|  | *      Free symbol table with symbol_table_free() | 
|  | */ | 
|  | struct symbol_table *symbol_table_create(const char *filename) | 
|  | { | 
|  | struct symbol_table *table = NULL; | 
|  |  | 
|  | // Open the file, and map it into memory | 
|  | struct stat sb; | 
|  | int length; | 
|  | char *base; | 
|  |  | 
|  | XLOG2("Creating symbol table for %s\n", filename); | 
|  | int fd = open(filename, O_RDONLY); | 
|  |  | 
|  | if(fd < 0) { | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | fstat(fd, &sb); | 
|  | length = sb.st_size; | 
|  |  | 
|  | base = mmap(NULL, length, PROT_READ, MAP_PRIVATE, fd, 0); | 
|  |  | 
|  | if(!base) { | 
|  | goto out_close; | 
|  | } | 
|  |  | 
|  | // Parse the file header | 
|  | Elf32_Ehdr *hdr = (Elf32_Ehdr*)base; | 
|  | Elf32_Shdr *shdr = (Elf32_Shdr*)(base + hdr->e_shoff); | 
|  |  | 
|  | // Search for the dynamic symbols section | 
|  | int sym_idx = -1; | 
|  | int dynsym_idx = -1; | 
|  | int i; | 
|  |  | 
|  | for(i = 0; i < hdr->e_shnum; i++) { | 
|  | if(shdr[i].sh_type == SHT_SYMTAB ) { | 
|  | sym_idx = i; | 
|  | } | 
|  | if(shdr[i].sh_type == SHT_DYNSYM ) { | 
|  | dynsym_idx = i; | 
|  | } | 
|  | } | 
|  | if ((dynsym_idx == -1) && (sym_idx == -1)) { | 
|  | goto out_unmap; | 
|  | } | 
|  |  | 
|  | table = malloc(sizeof(struct symbol_table)); | 
|  | if(!table) { | 
|  | goto out_unmap; | 
|  | } | 
|  | table->name = strdup(filename); | 
|  | table->num_symbols = 0; | 
|  |  | 
|  | Elf32_Sym *dynsyms = NULL; | 
|  | Elf32_Sym *syms = NULL; | 
|  | int dynnumsyms = 0; | 
|  | int numsyms = 0; | 
|  | char *dynstr = NULL; | 
|  | char *str = NULL; | 
|  |  | 
|  | if (dynsym_idx != -1) { | 
|  | dynsyms = (Elf32_Sym*)(base + shdr[dynsym_idx].sh_offset); | 
|  | dynnumsyms = shdr[dynsym_idx].sh_size / shdr[dynsym_idx].sh_entsize; | 
|  | int dynstr_idx = shdr[dynsym_idx].sh_link; | 
|  | dynstr = base + shdr[dynstr_idx].sh_offset; | 
|  | } | 
|  |  | 
|  | if (sym_idx != -1) { | 
|  | syms = (Elf32_Sym*)(base + shdr[sym_idx].sh_offset); | 
|  | numsyms = shdr[sym_idx].sh_size / shdr[sym_idx].sh_entsize; | 
|  | int str_idx = shdr[sym_idx].sh_link; | 
|  | str = base + shdr[str_idx].sh_offset; | 
|  | } | 
|  |  | 
|  | int symbol_count = 0; | 
|  | int dynsymbol_count = 0; | 
|  |  | 
|  | if (dynsym_idx != -1) { | 
|  | // Iterate through the dynamic symbol table, and count how many symbols | 
|  | // are actually defined | 
|  | for(i = 0; i < dynnumsyms; i++) { | 
|  | if(dynsyms[i].st_shndx != SHN_UNDEF) { | 
|  | dynsymbol_count++; | 
|  | } | 
|  | } | 
|  | XLOG2("Dynamic Symbol count: %d\n", dynsymbol_count); | 
|  | } | 
|  |  | 
|  | if (sym_idx != -1) { | 
|  | // Iterate through the symbol table, and count how many symbols | 
|  | // are actually defined | 
|  | for(i = 0; i < numsyms; i++) { | 
|  | if((syms[i].st_shndx != SHN_UNDEF) && | 
|  | (strlen(str+syms[i].st_name)) && | 
|  | (syms[i].st_value != 0) && (syms[i].st_size != 0)) { | 
|  | symbol_count++; | 
|  | } | 
|  | } | 
|  | XLOG2("Symbol count: %d\n", symbol_count); | 
|  | } | 
|  |  | 
|  | // Now, create an entry in our symbol table structure for each symbol... | 
|  | table->num_symbols += symbol_count + dynsymbol_count; | 
|  | table->symbols = malloc(table->num_symbols * sizeof(struct symbol)); | 
|  | if(!table->symbols) { | 
|  | free(table); | 
|  | table = NULL; | 
|  | goto out_unmap; | 
|  | } | 
|  |  | 
|  |  | 
|  | int j = 0; | 
|  | if (dynsym_idx != -1) { | 
|  | // ...and populate them | 
|  | for(i = 0; i < dynnumsyms; i++) { | 
|  | if(dynsyms[i].st_shndx != SHN_UNDEF) { | 
|  | table->symbols[j].name = strdup(dynstr + dynsyms[i].st_name); | 
|  | table->symbols[j].addr = dynsyms[i].st_value; | 
|  | table->symbols[j].size = dynsyms[i].st_size; | 
|  | XLOG2("name: %s, addr: %x, size: %x\n", | 
|  | table->symbols[j].name, table->symbols[j].addr, table->symbols[j].size); | 
|  | j++; | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | if (sym_idx != -1) { | 
|  | // ...and populate them | 
|  | for(i = 0; i < numsyms; i++) { | 
|  | if((syms[i].st_shndx != SHN_UNDEF) && | 
|  | (strlen(str+syms[i].st_name)) && | 
|  | (syms[i].st_value != 0) && (syms[i].st_size != 0)) { | 
|  | table->symbols[j].name = strdup(str + syms[i].st_name); | 
|  | table->symbols[j].addr = syms[i].st_value; | 
|  | table->symbols[j].size = syms[i].st_size; | 
|  | XLOG2("name: %s, addr: %x, size: %x\n", | 
|  | table->symbols[j].name, table->symbols[j].addr, table->symbols[j].size); | 
|  | j++; | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | // Sort the symbol table entries, so they can be bsearched later | 
|  | qsort(table->symbols, table->num_symbols, sizeof(struct symbol), qcompar); | 
|  |  | 
|  | out_unmap: | 
|  | munmap(base, length); | 
|  |  | 
|  | out_close: | 
|  | close(fd); | 
|  |  | 
|  | out: | 
|  | return table; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Free a symbol table | 
|  | * | 
|  | * Parameters: | 
|  | *     table - Table to free | 
|  | */ | 
|  | void symbol_table_free(struct symbol_table *table) | 
|  | { | 
|  | int i; | 
|  |  | 
|  | if(!table) { | 
|  | return; | 
|  | } | 
|  |  | 
|  | for(i=0; i<table->num_symbols; i++) { | 
|  | free(table->symbols[i].name); | 
|  | } | 
|  |  | 
|  | free(table->symbols); | 
|  | free(table); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Search for an address in the symbol table | 
|  | * | 
|  | * Parameters: | 
|  | *      table - Table to search in | 
|  | *      addr - Address to search for. | 
|  | * | 
|  | * Returns: | 
|  | *      A pointer to the Symbol structure corresponding to the | 
|  | *      symbol which contains this address, or NULL if no symbol | 
|  | *      contains it. | 
|  | */ | 
|  | const struct symbol *symbol_table_lookup(struct symbol_table *table, unsigned int addr) | 
|  | { | 
|  | if(!table) { | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | return bsearch((void*)addr, table->symbols, table->num_symbols, sizeof(struct symbol), bcompar); | 
|  | } |