364 lines
11 KiB
Text
364 lines
11 KiB
Text
|
#include <merror.h>
|
||
|
|
#include <mips.h>
|
||
|
|
#include <mips32.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <stdlib.h>
|
||
|
|
#include <elf.h>
|
||
|
|
#include <string.h>
|
||
|
|
#include <stddef.h>
|
||
|
|
|
||
|
|
#include "asm.h"
|
||
|
|
#include "mlimits.h"
|
||
|
|
#include "parse.h"
|
||
|
|
#include "parse_mips32.h"
|
||
|
|
|
||
|
|
extern char *current_file;
|
||
|
|
|
||
|
|
#define SHDR_STRTBL 0
|
||
|
|
#define SHDR_SYMTBL 1
|
||
|
|
#define SHDR_SECTIONS 2
|
||
|
|
|
||
|
|
static int parse_file(struct parser *parser)
|
||
|
|
{
|
||
|
|
while (1) {
|
||
|
|
struct expr expr;
|
||
|
|
if (parser_next(parser, &expr)) {
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (expr.type == EXPR_INS)
|
||
|
|
if (sectbl_push(&parser->sec_tbl,
|
||
|
|
parser->sec_tbl.current, expr.ins))
|
||
|
|
return M_ERROR;
|
||
|
|
}
|
||
|
|
|
||
|
|
for (uint32_t i = 0; i < parser->ref_tbl.count; i++) {
|
||
|
|
struct reference *ref = &parser->ref_tbl.references[i];
|
||
|
|
struct symbol *sym;
|
||
|
|
struct mips32_instruction *ins;
|
||
|
|
|
||
|
|
if (symtbl_find(&parser->sym_tbl, &sym, ref->name)) {
|
||
|
|
ERROR("undefined symbol '%s'", ref->name);
|
||
|
|
return M_ERROR;
|
||
|
|
}
|
||
|
|
|
||
|
|
ins = &ref->section->ins[ref->index].mips32;
|
||
|
|
|
||
|
|
switch (ref->type) {
|
||
|
|
case REF_OFFESET:
|
||
|
|
ins->B_data.offset += sym->position -
|
||
|
|
(ref->section->start + ref->index);
|
||
|
|
break;
|
||
|
|
case REF_TARGET:
|
||
|
|
ins->J_data.target += sym->position;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
};
|
||
|
|
|
||
|
|
return M_SUCCESS;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int assemble_phdr(struct assembler *asm, Elf32_Phdr **res,
|
||
|
|
uint32_t *res2)
|
||
|
|
{
|
||
|
|
struct parser *parser = asm->parser;
|
||
|
|
Elf32_Phdr *phdr = malloc(sizeof(Elf32_Phdr) *
|
||
|
|
parser->sec_tbl.count);
|
||
|
|
size_t ins_sz = sizeof(struct mips32_instruction);
|
||
|
|
|
||
|
|
if (phdr == NULL) {
|
||
|
|
ERROR("cannot alloc");
|
||
|
|
return M_ERROR;;
|
||
|
|
}
|
||
|
|
|
||
|
|
for (uint32_t i = 0; i < parser->sec_tbl.count; i++) {
|
||
|
|
Elf32_Phdr *hdr = &phdr[i];
|
||
|
|
struct section *sec = &parser->sec_tbl.sections[i];
|
||
|
|
|
||
|
|
hdr->p_type = PT_LOAD;
|
||
|
|
hdr->p_flags = PF_X | PF_W | PF_R; // FIXME: this is bad
|
||
|
|
hdr->p_offset = sec->start * ins_sz;
|
||
|
|
hdr->p_vaddr = sec->start * ins_sz;
|
||
|
|
hdr->p_paddr = 0x00;
|
||
|
|
hdr->p_filesz = sec->count * ins_sz;
|
||
|
|
hdr->p_memsz = sec->count * ins_sz;
|
||
|
|
hdr->p_align = sec->alignment;
|
||
|
|
}
|
||
|
|
|
||
|
|
*res = phdr;
|
||
|
|
*res2 = parser->sec_tbl.count;
|
||
|
|
return M_SUCCESS;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int assemble_symtbl(struct assembler *asm, Elf32_Sym **res,
|
||
|
|
uint32_t *res2)
|
||
|
|
{
|
||
|
|
Elf32_Sym *stbl = malloc(sizeof(Elf32_Sym) * asm->parser->sym_tbl
|
||
|
|
.count);
|
||
|
|
|
||
|
|
if (stbl == NULL)
|
||
|
|
return M_ERROR;
|
||
|
|
|
||
|
|
for (uint32_t i = 0; i < asm->parser->sym_tbl.count; i++) {
|
||
|
|
struct symbol *sym = &asm->parser->sym_tbl.symbols[i];
|
||
|
|
size_t str_off;
|
||
|
|
|
||
|
|
if (strtbl_write_str(&asm->str_tbl, sym->name, &str_off)) {
|
||
|
|
free(stbl);
|
||
|
|
return M_ERROR;
|
||
|
|
}
|
||
|
|
|
||
|
|
int viz = STB_LOCAL;
|
||
|
|
switch (sym->flag) {
|
||
|
|
case SYM_LOCAL:
|
||
|
|
viz = STB_LOCAL;
|
||
|
|
break;
|
||
|
|
case SYM_GLOBAL:
|
||
|
|
case SYM_EXTERNAL:
|
||
|
|
viz = STB_GLOBAL;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
stbl[i] = (Elf32_Sym) {
|
||
|
|
.st_name = str_off,
|
||
|
|
.st_value = sym->position,
|
||
|
|
.st_size = 0,
|
||
|
|
.st_info = (unsigned char)
|
||
|
|
ELF32_ST_INFO(SYMINFO_BT_SELF,
|
||
|
|
SYMINFO_FLG_DIRECT),
|
||
|
|
.st_other = (unsigned char)
|
||
|
|
ELF32_ST_VISIBILITY(viz),
|
||
|
|
.st_shndx = 0, // FIXME: specify section
|
||
|
|
};
|
||
|
|
};
|
||
|
|
|
||
|
|
*res = stbl;
|
||
|
|
*res2 = asm->parser->sym_tbl.count;
|
||
|
|
|
||
|
|
return M_SUCCESS;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int assemble_shdr(struct assembler *asm, Elf32_Shdr **res,
|
||
|
|
uint32_t *res2)
|
||
|
|
{
|
||
|
|
uint32_t entries = 2; // str table and sym tabel
|
||
|
|
entries += asm->parser->sec_tbl.count; // sections
|
||
|
|
|
||
|
|
Elf32_Shdr *shdr = malloc(sizeof(Elf32_Shdr) * entries);
|
||
|
|
|
||
|
|
size_t str_off;
|
||
|
|
if (strtbl_write_str(&asm->str_tbl, ".shstrtab", &str_off)) {
|
||
|
|
free(shdr);
|
||
|
|
return M_ERROR;
|
||
|
|
}
|
||
|
|
|
||
|
|
// string table
|
||
|
|
shdr[SHDR_STRTBL] = (Elf32_Shdr) {
|
||
|
|
.sh_name = str_off,
|
||
|
|
.sh_type = SHT_STRTAB,
|
||
|
|
.sh_flags = SHF_STRINGS,
|
||
|
|
.sh_addr = 0,
|
||
|
|
.sh_offset = 0,
|
||
|
|
.sh_size = 0,
|
||
|
|
.sh_link = 0,
|
||
|
|
.sh_info = 0,
|
||
|
|
.sh_addralign = 1,
|
||
|
|
.sh_entsize = 0,
|
||
|
|
};
|
||
|
|
|
||
|
|
if (strtbl_write_str(&asm->str_tbl, ".shsymtab", &str_off)) {
|
||
|
|
free(shdr);
|
||
|
|
return M_ERROR;
|
||
|
|
}
|
||
|
|
|
||
|
|
// symbol table
|
||
|
|
shdr[SHDR_SYMTBL] = (Elf32_Shdr) {
|
||
|
|
.sh_name = str_off,
|
||
|
|
.sh_type = SHT_SYMTAB,
|
||
|
|
.sh_flags = 0,
|
||
|
|
.sh_addr = 0,
|
||
|
|
.sh_offset = 0,
|
||
|
|
.sh_size = 0,
|
||
|
|
.sh_link = 0,
|
||
|
|
.sh_info = 0,
|
||
|
|
.sh_addralign = 1,
|
||
|
|
.sh_entsize = sizeof(Elf32_Sym),
|
||
|
|
};
|
||
|
|
|
||
|
|
// for each section
|
||
|
|
for (uint32_t i = 0; i < asm->parser->sec_tbl.count; i++) {
|
||
|
|
struct section *sec = &asm->parser->sec_tbl.sections[i];
|
||
|
|
char name[MAX_LEX_LENGTH+1] = ".";
|
||
|
|
strcat(name, sec->name);
|
||
|
|
if (strtbl_write_str(&asm->str_tbl, name, &str_off)) {
|
||
|
|
free(shdr);
|
||
|
|
return M_ERROR;
|
||
|
|
}
|
||
|
|
shdr[i+SHDR_SECTIONS] = (Elf32_Shdr) {
|
||
|
|
.sh_name = str_off,
|
||
|
|
.sh_type = SHT_PROGBITS,
|
||
|
|
.sh_flags = SHF_WRITE | SHF_ALLOC | SHF_EXECINSTR,
|
||
|
|
.sh_addr = 0,
|
||
|
|
.sh_offset = 0,
|
||
|
|
.sh_size = 0,
|
||
|
|
.sh_link = 0,
|
||
|
|
.sh_info = 0,
|
||
|
|
.sh_addralign = sec->alignment,
|
||
|
|
.sh_entsize = sizeof(struct mips32_instruction),
|
||
|
|
};
|
||
|
|
}
|
||
|
|
|
||
|
|
*res = shdr;
|
||
|
|
*res2 = entries;
|
||
|
|
|
||
|
|
return M_SUCCESS;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int assemble_file(struct assembler *asm)
|
||
|
|
{
|
||
|
|
Elf32_Phdr *phdr;
|
||
|
|
Elf32_Shdr *shdr;
|
||
|
|
Elf32_Sym *symtbl;
|
||
|
|
uint32_t phdr_len;
|
||
|
|
uint32_t shdr_len;
|
||
|
|
uint32_t symtbl_len;
|
||
|
|
|
||
|
|
if (assemble_symtbl(asm, &symtbl, &symtbl_len))
|
||
|
|
return M_ERROR;
|
||
|
|
|
||
|
|
if (assemble_phdr(asm, &phdr, &phdr_len)) {
|
||
|
|
free(symtbl);
|
||
|
|
return M_ERROR;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (assemble_shdr(asm, &shdr, &shdr_len)) {
|
||
|
|
free(symtbl);
|
||
|
|
free(phdr);
|
||
|
|
return M_ERROR;
|
||
|
|
};
|
||
|
|
|
||
|
|
Elf32_Ehdr ehdr = {
|
||
|
|
.e_ident = {
|
||
|
|
[EI_MAG0] = ELFMAG0,
|
||
|
|
[EI_MAG1] = ELFMAG1,
|
||
|
|
[EI_MAG2] = ELFMAG2,
|
||
|
|
[EI_MAG3] = ELFMAG3,
|
||
|
|
[EI_CLASS] = ELFCLASS32,
|
||
|
|
[EI_DATA] = ELFDATA2LSB,
|
||
|
|
[EI_VERSION] = EV_CURRENT,
|
||
|
|
[EI_OSABI] = ELFOSABI_STANDALONE,
|
||
|
|
[EI_ABIVERSION] = 0x00,
|
||
|
|
[EI_PAD] = 0x00,
|
||
|
|
},
|
||
|
|
.e_type = ET_REL,
|
||
|
|
.e_machine = EM_MIPS,
|
||
|
|
.e_version = EV_CURRENT,
|
||
|
|
.e_entry = 0x00,
|
||
|
|
.e_phoff = 0x00,
|
||
|
|
.e_shoff = 0x00,
|
||
|
|
.e_flags = EF_MIPS_ARCH_32R6,
|
||
|
|
.e_ehsize = sizeof(Elf32_Ehdr),
|
||
|
|
.e_phentsize = 0x20,
|
||
|
|
.e_phnum = phdr_len,
|
||
|
|
.e_shentsize = 0x28,
|
||
|
|
.e_shnum = shdr_len,
|
||
|
|
.e_shstrndx = 0x00, // str table is always inx 0
|
||
|
|
};
|
||
|
|
|
||
|
|
uint32_t ptr = 0;
|
||
|
|
|
||
|
|
// we must now correct offets and sizes inside the ehdr, phdr,
|
||
|
|
// and shdr
|
||
|
|
|
||
|
|
ptr += sizeof(Elf32_Ehdr);
|
||
|
|
|
||
|
|
// phdr
|
||
|
|
ehdr.e_phoff = ptr;
|
||
|
|
ptr += phdr_len * sizeof(Elf32_Phdr);
|
||
|
|
|
||
|
|
// sections
|
||
|
|
for (uint32_t i = 0; i < asm->parser->sec_tbl.count; i++) {
|
||
|
|
phdr[i].p_offset = ptr;
|
||
|
|
phdr[i].p_vaddr = ptr;
|
||
|
|
shdr[i+SHDR_SECTIONS].sh_offset = ptr;
|
||
|
|
shdr[i+SHDR_SECTIONS].sh_size = phdr[i].p_filesz;
|
||
|
|
ptr += phdr[i].p_filesz;
|
||
|
|
}
|
||
|
|
|
||
|
|
// strtbl
|
||
|
|
shdr[SHDR_STRTBL].sh_offset = ptr;
|
||
|
|
shdr[SHDR_STRTBL].sh_size = asm->str_tbl.size;
|
||
|
|
ptr += asm->str_tbl.size;
|
||
|
|
|
||
|
|
// symtbl
|
||
|
|
ehdr.e_shoff = ptr;
|
||
|
|
shdr[SHDR_SYMTBL].sh_offset = ptr;
|
||
|
|
shdr[SHDR_SYMTBL].sh_size = symtbl_len * sizeof(Elf32_Sym);
|
||
|
|
ptr += symtbl_len * sizeof(Elf32_Sym);
|
||
|
|
|
||
|
|
FILE *out = fopen("/home/freya/out.o", "w");
|
||
|
|
|
||
|
|
// ehdr
|
||
|
|
fwrite(&ehdr, sizeof(Elf32_Ehdr), 1, out);
|
||
|
|
|
||
|
|
// phdr
|
||
|
|
fwrite(phdr, sizeof(Elf32_Phdr), phdr_len, out);
|
||
|
|
|
||
|
|
// sections
|
||
|
|
for (uint32_t i = 0; i < asm->parser->sec_tbl.count; i++) {
|
||
|
|
struct section *sec = &asm->parser->sec_tbl.sections[i];
|
||
|
|
for (uint32_t j = 0; j < sec->count; j++) {
|
||
|
|
struct mips32_instruction *ins = &sec->ins[j].mips32;
|
||
|
|
fwrite(ins, sizeof(struct mips32_instruction),
|
||
|
|
1, out);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
// str tbl
|
||
|
|
fwrite(asm->str_tbl.ptr, asm->str_tbl.size, 1, out);
|
||
|
|
|
||
|
|
// sym tbl
|
||
|
|
fwrite(symtbl, sizeof(Elf32_Sym), symtbl_len, out);
|
||
|
|
|
||
|
|
// shdr
|
||
|
|
fwrite(shdr, sizeof(Elf32_Shdr), shdr_len, out);
|
||
|
|
|
||
|
|
fclose(out);
|
||
|
|
|
||
|
|
free(shdr);
|
||
|
|
free(phdr);
|
||
|
|
free(symtbl);
|
||
|
|
|
||
|
|
return M_SUCCESS;
|
||
|
|
}
|
||
|
|
|
||
|
|
int assemble_file_mips32(char *path)
|
||
|
|
{
|
||
|
|
struct lexer lexer;
|
||
|
|
struct parser parser;
|
||
|
|
current_file = path;
|
||
|
|
int res = M_SUCCESS;
|
||
|
|
|
||
|
|
if (lexer_init(current_file, &lexer))
|
||
|
|
return M_ERROR;
|
||
|
|
|
||
|
|
if (mips32_parser_init(&lexer, &parser))
|
||
|
|
return M_ERROR;
|
||
|
|
|
||
|
|
if (res == M_SUCCESS)
|
||
|
|
res = parse_file(&parser);
|
||
|
|
|
||
|
|
struct assembler assembler;
|
||
|
|
assembler.parser = &parser;
|
||
|
|
strtbl_init(&assembler.str_tbl);
|
||
|
|
|
||
|
|
if (res == M_SUCCESS)
|
||
|
|
res = assemble_file(&assembler);
|
||
|
|
|
||
|
|
strtbl_free(&assembler.str_tbl);
|
||
|
|
lexer_free(&lexer);
|
||
|
|
parser_free(&parser);
|
||
|
|
|
||
|
|
return res;
|
||
|
|
}
|