+/rtos
git clone https://git.julia.blue/+/rtos
ee4080a
master
1// Based on loader by Martin Ribelotta and Andreas Gerstlauer 2 3#include "OS.h" 4#include "heap.h" 5#include "io.h" 6#include "littlefs.h" 7#include "printf.h" 8#include "std.h" 9#include <stddef.h> 10 11const uint32_t user_process_stack = 1024 ; 12 13#define ERR (msg ) puts(RED "ELF ERROR: " NORMAL msg) 14#define SEGMENT_OFFSET (e ,n ) (e->programHeaderTable + n * sizeof(ProgramHeader)) 15 16typedef struct { 17char ident [16 ]; 18uint16_t type ; 19uint16_t machine ; 20uint32_t version ; 21uint32_t entry ; 22uint32_t phoff ; 23uint32_t shoff ; 24uint32_t flags ; 25uint16_t ehsize ; 26uint16_t phentsize ; 27uint16_t phnum ; 28uint16_t shentsize ; 29uint16_t shnum ; 30uint16_t shstrndx ; 31}Header ; 32 33typedef struct { 34void * data ; 35int segIdx ; 36}Segment ; 37 38typedef struct { 39uint32_t type ; 40uint32_t offset ; 41uint32_t vaddr ; 42uint32_t paddr ; 43uint32_t filesz ; 44uint32_t memsz ; 45uint32_t flags ; 46uint32_t align ; 47}ProgramHeader ; 48 49typedef struct { 50size_t type ; 51uint32_t entry ; 52 53size_t segments ; 54uint32_t programHeaderTable ; 55 56Segment load_text ; 57Segment load_data ; 58}Executable ; 59 60static void free_segment (Segment * s ) { 61if (s -> data ) 62free (s -> data ); 63} 64 65static bool load_segment (Executable * e ,Segment * s ,ProgramHeader * h ) { 66if (!h -> memsz ) { 67printf (" No data for section" ); 68return true; 69 } 70s -> data = malloc (h -> memsz ); 71if (!s -> data ) { 72ERR (" GET MEMORY fail" ); 73return false; 74 } 75if (!littlefs_seek (h -> offset )) { 76ERR (" seek fail" ); 77free_segment (s ); 78return false; 79 } 80if (littlefs_read_buffer (s -> data ,h -> filesz )!= h -> filesz ) { 81ERR (" read data fail" ); 82return false; 83 } 84if (h -> memsz > h -> filesz ) { 85memset ((uint8_t * )s -> data + h -> filesz ,0 ,h -> memsz - h -> filesz ); 86 } 87return true; 88} 89 90static bool read_segment_header (Executable * e ,int n ,ProgramHeader * h ) { 91uint32_t offset = SEGMENT_OFFSET (e ,n ); 92return littlefs_seek (offset )&& 93littlefs_read_buffer (h ,sizeof (ProgramHeader ))== 94sizeof (ProgramHeader ); 95} 96 97static bool init_elf (Executable * e ) { 98memset (e ,0 ,sizeof (Executable )); 99 100Header h ; 101if (littlefs_read_buffer (& h ,sizeof (h ))!= sizeof (h )) { 102return false; 103 } 104 105e -> entry = h .entry ; 106e -> type = h .type ; 107e -> segments = h .phnum ; 108e -> programHeaderTable = h .phoff ; 109 110// TODO: Check that it's actualy an ELF using magic numbers 111return true; 112} 113 114static bool jump_to (uint32_t ofs ,void * text ,void * data ) { 115if (ofs ) { 116return OS_AddProcess ((void (* )(void ))((uint8_t * )text + ofs ),text ,data , 117user_process_stack ,0 ); 118 }else { 119ERR ("No entry defined." ); 120return false; 121 } 122} 123 124// CURSED LINKER HACK (see /userprog/user.ld for details) 125void fix_GOT (Segment * data ) { 126uint32_t * start = data -> data ; 127uint32_t * current = start ; 128uint32_t offset = * current ++ ; 129while (* current != 0xAAAAAAAA ) {* current ++ += (uint32_t )start - offset ; } 130} 131 132bool exec_elf (const char * path ) { 133static Executable exec ;// this is only static to save stack space 134if (!(littlefs_open_file (path , false)&& init_elf (& exec ))) { 135printf ("Invalid elf %s\n\r" ,path ); 136return false; 137 } 138if (exec .type != 2 ) {// 2 == EXEC 139ERR ("Not of type EXEC" ); 140return false; 141 } 142 143bool found_writable = false,found_executable = false; 144for (int n = 0 ;n < exec .segments ;n ++ ) { 145ProgramHeader ph ; 146if (!read_segment_header (& exec ,n ,& ph )) { 147ERR ("Failed to read segment" ); 148return false; 149 } 150if (ph .type != 1 ) {// 1 == LOAD 151printf ("Skipping segment %d\n\r" ,n ); 152continue ; 153 } 154printf ("Examining segment %d\n\r" ,n ); 155 156if (ph .flags & 2 ) {// 2 == W 157if (!load_segment (& exec ,& exec .load_data ,& ph )) { 158return false; 159 } 160exec .load_data .segIdx = n ; 161if (found_writable ) { 162ERR ("Can't handle multiple writable segments" ); 163return false; 164 } 165found_writable = true; 166fix_GOT (& exec .load_data ); 167 }else if (ph .flags & 1 ) {// 1 == X 168if (!load_segment (& exec ,& exec .load_text ,& ph )) { 169return false; 170 } 171exec .load_text .segIdx = n ; 172if (found_executable ) { 173ERR ("Can't handle multiple executable segments" ); 174return false; 175 } 176found_executable = true; 177 }else { 178ERR ("Section wasn't writable or executable" ); 179return false; 180 } 181 } 182bool ret = jump_to (exec .entry ,exec .load_text .data ,exec .load_data .data ); 183littlefs_close_file (); 184return ret ; 185}