118 lines
3.3 KiB
C++
118 lines
3.3 KiB
C++
#include <stdint.h>
|
|
#include <stddef.h>
|
|
#include "multiboot.h"
|
|
#include "bootstructure.h"
|
|
#define CHECK_FLAG(flags, bit) ((flags) & (1 <<(bit)))
|
|
|
|
|
|
extern "C" void testLauncher ( unsigned long magic, multiboot_info_t* mbi) {
|
|
|
|
// Create the bootInfoBlock at its location
|
|
BootInfoBlock* BIB = (BootInfoBlock*) BootInfoBlock_pptr;
|
|
|
|
/*
|
|
* Check Multiboot magic number
|
|
*/
|
|
if (magic != MULTIBOOT_BOOTLOADER_MAGIC)
|
|
{
|
|
BIB->MapIsInvalid = true;
|
|
return;
|
|
} else{
|
|
BIB->MapIsInvalid = false;
|
|
}
|
|
|
|
/* is boot device valid ? */
|
|
if (CHECK_FLAG (mbi->flags, 1))
|
|
{
|
|
BIB->bootDeviceID = mbi->boot_device;
|
|
} else{
|
|
BIB->bootDeviceID = 0x11111111;
|
|
}
|
|
|
|
/* Are mods_* valid? */
|
|
if(CHECK_FLAG ( mbi->flags, 3)){
|
|
multiboot_module_t *mod;
|
|
uint32_t i;
|
|
|
|
BIB->GrubModuleCount = mbi->mods_count;
|
|
|
|
|
|
for(i = 0, mod = (multiboot_module_t *) mbi->mods_addr; i < mbi->mods_count; i++ , mod++){
|
|
|
|
}
|
|
}
|
|
|
|
/* Is the symbol table of a.out valid? */
|
|
if (CHECK_FLAG(mbi->flags, 4))
|
|
{
|
|
BIB->ValidSymbolTable = true;
|
|
multiboot_aout_symbol_table_t *multiboot_aout_sym = &(mbi->u.aout_sym);
|
|
|
|
} else{
|
|
BIB->ValidSymbolTable = false;
|
|
}
|
|
|
|
/* Is the section header table of ELF valid? */
|
|
if (CHECK_FLAG(mbi->flags, 5))
|
|
{
|
|
BIB->ValidELFHeader = true;
|
|
multiboot_elf_section_header_table_t *multiboot_elf_sec = &(mbi->u.elf_sec);
|
|
|
|
}else{
|
|
BIB->ValidELFHeader = false;
|
|
}
|
|
/*
|
|
If we got a memory map from our bootloader we
|
|
should be parsing it to find out the memory regions available.
|
|
*/
|
|
if (CHECK_FLAG(mbi->flags, 6))
|
|
{
|
|
BIB->PhysicalMemoryMapAvailable = true;
|
|
BIB->MemoryMap = (MemoryInfoBlock*) MemoryMapHeap_pptr;
|
|
multiboot_memory_map_t *mmap = (multiboot_memory_map_t*) (mbi->mmap_addr) ;
|
|
auto MemoryMapEnd = mbi->mmap_addr + mbi->mmap_length;
|
|
|
|
auto CurrentInfoBlock = BIB->MemoryMap;
|
|
|
|
|
|
while((unsigned long) mmap < MemoryMapEnd){
|
|
|
|
CurrentInfoBlock->Base_addr = mmap->addr;
|
|
CurrentInfoBlock->Memory_Size = mmap->len;
|
|
|
|
|
|
if(mmap->type == MULTIBOOT_MEMORY_AVAILABLE)
|
|
CurrentInfoBlock->type &= 0x1;
|
|
if(mmap->type == MULTIBOOT_MEMORY_ACPI_RECLAIMABLE)
|
|
CurrentInfoBlock->type &= 0x2;
|
|
if(mmap->type == MULTIBOOT_MEMORY_RESERVED)
|
|
CurrentInfoBlock->type &= 0x4;
|
|
if(mmap->type == MULTIBOOT_MEMORY_NVS)
|
|
CurrentInfoBlock->type &= 0x8;
|
|
if(mmap->type == MULTIBOOT_MEMORY_BADRAM)
|
|
CurrentInfoBlock->type &= 0x10;
|
|
|
|
|
|
// continue to the next block
|
|
mmap = (multiboot_memory_map_t *) ((unsigned long) mmap + mmap->size + sizeof(mmap->size));
|
|
|
|
CurrentInfoBlock->next = (MemoryInfoBlock*) ((uint32_t)CurrentInfoBlock) + sizeof(MemoryInfoBlock);
|
|
CurrentInfoBlock = CurrentInfoBlock->next;
|
|
|
|
}
|
|
|
|
CurrentInfoBlock->next = (MemoryInfoBlock*) 0x0;
|
|
|
|
} else
|
|
{
|
|
BIB->PhysicalMemoryMapAvailable = false;
|
|
}
|
|
|
|
/* Draw diagonal blue line */
|
|
if (CHECK_FLAG (mbi->flags, 12)){
|
|
BIB->EnabledVBE = true;
|
|
} else{
|
|
BIB->EnabledVBE;
|
|
}
|
|
}
|