162 lines
3.1 KiB
C
162 lines
3.1 KiB
C
#include <stdbool.h>
|
|
#include <stdint.h>
|
|
|
|
#include <sys/kconfig.h>
|
|
#include <sys/kassert.h>
|
|
#include <sys/kmem.h>
|
|
#include <sys/mp.h>
|
|
#include <sys/irq.h>
|
|
#include <sys/spinlock.h>
|
|
|
|
#include <machine/amd64.h>
|
|
#include <machine/ioapic.h>
|
|
#include <machine/lapic.h>
|
|
#include <machine/trap.h>
|
|
#include <machine/pmap.h>
|
|
|
|
#include <sys/thread.h>
|
|
#include <sys/disk.h>
|
|
#include <sys/diskcache.h>
|
|
#include <sys/vfs.h>
|
|
#include <sys/elf64.h>
|
|
|
|
#include "../dev/console.h"
|
|
|
|
extern void PCI_Init();
|
|
extern void IDE_Init();
|
|
extern void MachineBoot_AddMem();
|
|
|
|
#define GDT_MAX 8
|
|
|
|
static SegmentDescriptor GDT[MAX_CPUS][GDT_MAX];
|
|
static PseudoDescriptor GDTDescriptor[MAX_CPUS];
|
|
static TaskStateSegment64 TSS[MAX_CPUS];
|
|
|
|
static char df_stack[4096];
|
|
|
|
void Machine_GDTInit()
|
|
{
|
|
uint64_t offset;
|
|
uint64_t tmp;
|
|
int c = CPU();
|
|
|
|
kprintf("Initializing GDT... "); // Caused pagefault??
|
|
|
|
GDT[c][0] = 0x0;
|
|
GDT[c][1] = 0x00AF9A000000FFFFULL; /* Kernel CS */
|
|
GDT[c][2] = 0x00CF92000000FFFFULL; /* Kernel DS */
|
|
GDT[c][3] = 0x0;
|
|
|
|
// TSS
|
|
offset = (uint64_t)&TSS[c];
|
|
GDT[c][4] = sizeof(TaskStateSegment64);
|
|
tmp = offset & 0x00FFFFFF;
|
|
GDT[c][4] |= (tmp << 16);
|
|
tmp = offset & 0xFF000000;
|
|
GDT[c][4] |= (tmp << 56);
|
|
GDT[c][4] |= 0x89ULL << 40;
|
|
GDT[c][5] = offset >> 32;
|
|
|
|
GDT[c][6] = 0x00AFFA000000FFFFULL; /* User CS */
|
|
GDT[c][7] = 0x00CFF2000000FFFFULL; /* User DS */
|
|
|
|
GDTDescriptor[c].off = (uint64_t)&GDT[0];
|
|
GDTDescriptor[c].lim = 8*GDT_MAX - 1;
|
|
|
|
lgdt(&GDTDescriptor[c]);
|
|
|
|
kprintf("Done!\n");
|
|
}
|
|
|
|
void Machine_TSSInit()
|
|
{
|
|
int c = CPU();
|
|
|
|
kprintf("Initializing TSS... ");
|
|
|
|
TSS[c]._unused0 = 0;
|
|
TSS[c]._unused1 = 0;
|
|
TSS[c]._unused2 = 0;
|
|
TSS[c]._unused3 = 0;
|
|
TSS[c]._unused4 = 0;
|
|
TSS[c].ist1 = (uint64_t)&df_stack;
|
|
TSS[c].ist2 = 0x0;
|
|
TSS[c].ist3 = 0x0;
|
|
TSS[c].ist4 = 0x0;
|
|
TSS[c].ist5 = 0x0;
|
|
TSS[c].ist6 = 0x0;
|
|
TSS[c].ist7 = 0x0;
|
|
TSS[c].rsp0 = (uint64_t)&df_stack;
|
|
TSS[c].rsp1 = 0;
|
|
TSS[c].rsp2 = 0;
|
|
|
|
ltr(SEL_TSS);
|
|
|
|
kprintf("Done!\n");
|
|
}
|
|
|
|
void Machine_SyscallInit()
|
|
{
|
|
kprintf("Initializing Syscall... ");
|
|
|
|
wrmsr(MSR_STAR, (uint64_t)SEL_KCS << 32 | (uint64_t)SEL_UCS << 48);
|
|
wrmsr(MSR_LSTAR, 0);
|
|
wrmsr(MSR_CSTAR, 0);
|
|
wrmsr(MSR_SFMASK, 0);
|
|
|
|
kprintf("Done!\n");
|
|
}
|
|
|
|
void Machine_EarlyInit()
|
|
{
|
|
Critical_Init();
|
|
Critical_Enter();
|
|
Console_Init();
|
|
PAlloc_Init();
|
|
}
|
|
|
|
void Machine_IdleThread(void *test)
|
|
{
|
|
while (1) { enable_interrupts(); hlt(); }
|
|
}
|
|
|
|
void Machine_Init()
|
|
{
|
|
Machine_GDTInit();
|
|
Machine_TSSInit();
|
|
Trap_Init();
|
|
//Machine_SyscallInit();
|
|
|
|
PAlloc_AddRegion(DMPA2VA(16*1024*1024), 16*1024*1024);
|
|
PMap_Init();
|
|
MachineBoot_AddMem();
|
|
XMem_Init();
|
|
|
|
IRQ_Init();
|
|
LAPIC_Init();
|
|
IOAPIC_Init();
|
|
Thread_Init();
|
|
|
|
PCI_Init();
|
|
IDE_Init();
|
|
DiskCache_Init();
|
|
|
|
Disk *root = Disk_GetByID(0, 0);
|
|
if (!root)
|
|
Panic("No boot disk!");
|
|
VFS_MountRoot(root);
|
|
|
|
Critical_Exit();
|
|
|
|
Thread *thr = Thread_KThreadCreate(&Machine_IdleThread, NULL);
|
|
if (thr == NULL) {
|
|
kprintf("Couldn't create idle thread!\n");
|
|
}
|
|
Thread_SetRunnable(thr);
|
|
|
|
Loader_LoadInit();
|
|
|
|
breakpoint();
|
|
}
|
|
|