#include "elf.h"
#include <mem/paging.h>
#include <mem/seg.h>
#include <lib/std.h>
#include <core/sys.h>

int elf_check(uint8_t *data) {
	elf_ehdr *h = (elf_ehdr*)data;
	if (h->e_ident[0] == 0x7F && h->e_ident[1] == 'E' && h->e_ident[2] == 'L' && h->e_ident[3] == 'F') return 0;
	return -1;
}

thread_entry elf_load(uint8_t *data, process* process) {
	elf_ehdr *ehdr = (elf_ehdr*)data;
	elf_phdr *phdr;
	int i;
	size_t dataseg = 0;
	if (elf_check(data)) return 0;

	cli();
	page_directory *r = current_pagedir;
	pagedir_switch(process->pagedir);

	phdr = (elf_phdr*)((uint8_t*)(data + ehdr->e_phoff));
	for (i = 0; i < ehdr->e_phnum; i++) {
		if (phdr[i].p_type == PT_LOAD) {
			(new simpleseg(phdr[i].p_vaddr, phdr[i].p_memsz, (phdr[i].p_flags & PF_W) != 0))->map(process->pagedir, 0);
			memcpy((uint8_t*)phdr[i].p_vaddr, data + phdr[i].p_offset, phdr[i].p_filesz);
			if (phdr[i].p_memsz > phdr[i].p_filesz) {
				memset((uint8_t*)((size_t)phdr[i].p_vaddr + phdr[i].p_filesz), 0, phdr[i].p_memsz - phdr[i].p_filesz);
			}
			if (phdr[i].p_vaddr + phdr[i].p_memsz > dataseg) {
				dataseg = phdr[i].p_vaddr + phdr[i].p_memsz;
				dataseg = (dataseg & 0xFFFFF000) + 0x1000;
			}
		}
	}

	process->data = dataseg;

	pagedir_switch(r);
	sti();

	return (thread_entry)ehdr->e_entry;
}

process* elf_exec(uint8_t *data, int privilege) {
	if (elf_check(data)) return 0;
	
	process* p = new process(0, 0, privilege);

	thread_entry e = elf_load(data, p);

	new thread(p, e, 0, 0);

	return p;
}