1
0
Fork 0
mirror of https://github.com/tailix/kernel.git synced 2024-12-04 11:34:42 -05:00
kernel/kernelmq/protected.c

172 lines
6.1 KiB
C

#include "protected.h"
#include "config.h"
#include "logger.h"
#include "interrupt.h"
#include "hwint.h"
#include "tss.h"
#include "pic.h"
#include "stdlib.h"
struct GdtPointer {
unsigned short limit;
unsigned int base;
}
__attribute__((packed));
struct IdtPointer {
unsigned short limit;
unsigned int base;
}
__attribute__((packed));
struct GdtEntry {
unsigned short limit_low;
unsigned short base_low;
unsigned char base_middle;
unsigned char access;
unsigned char granularity;
unsigned char base_high;
};
struct IdtEntry {
unsigned short base_lo;
unsigned short sel;
unsigned char always0;
unsigned char flags;
unsigned short base_hi;
};
static struct GdtPointer gdt_pointer;
static struct IdtPointer idt_pointer;
static struct GdtEntry gdt_entries[GDT_SIZE];
static struct IdtEntry idt_entries[IDT_SIZE];
static void gdt_set_gate(int num, unsigned int base, unsigned int limit, unsigned char access, unsigned char gran);
static void idt_set_gate(unsigned char num, unsigned int base, unsigned short sel, unsigned char flags);
void gdt_flush(const struct GdtPointer *pointer);
void idt_flush(const struct IdtPointer *pointer);
void protected_initialize(const struct KernelMQ_Info *const kinfo)
{
pic_remap(32, 40);
pic_disable_all();
logger_info_from("protected", "Setup GDT.");
gdt_set_gate(GDT_NULL_INDEX, 0, 0x00000000, 0, 0);
gdt_set_gate(GDT_KERNEL_CS_INDEX, 0, 0xFFFFFFFF, 0x9A, 0xCF);
gdt_set_gate(GDT_KERNEL_DS_INDEX, 0, 0xFFFFFFFF, 0x92, 0xCF);
gdt_set_gate(GDT_USER_CS_INDEX, 0, 0xFFFFFFFF, 0xFA, 0xCF);
gdt_set_gate(GDT_USER_DS_INDEX, 0, 0xFFFFFFFF, 0xF2, 0xCF);
tss_write_to_gdt(kinfo, &gdt_entries[GDT_TSS_INDEX]);
logger_info_from("protected", "Setup IDT.");
kmemset(idt_entries, 0, sizeof(idt_entries));
idt_set_gate(0, (unsigned int)interrupt_0, 0x08, 0x8E);
idt_set_gate(1, (unsigned int)interrupt_1, 0x08, 0x8E);
idt_set_gate(2, (unsigned int)interrupt_2, 0x08, 0x8E);
idt_set_gate(3, (unsigned int)interrupt_3, 0x08, 0x8E);
idt_set_gate(4, (unsigned int)interrupt_4, 0x08, 0x8E);
idt_set_gate(5, (unsigned int)interrupt_5, 0x08, 0x8E);
idt_set_gate(6, (unsigned int)interrupt_6, 0x08, 0x8E);
idt_set_gate(7, (unsigned int)interrupt_7, 0x08, 0x8E);
idt_set_gate(8, (unsigned int)interrupt_8, 0x08, 0x8E);
idt_set_gate(9, (unsigned int)interrupt_9, 0x08, 0x8E);
idt_set_gate(10, (unsigned int)interrupt_10, 0x08, 0x8E);
idt_set_gate(11, (unsigned int)interrupt_11, 0x08, 0x8E);
idt_set_gate(12, (unsigned int)interrupt_12, 0x08, 0x8E);
idt_set_gate(13, (unsigned int)interrupt_13, 0x08, 0x8E);
idt_set_gate(14, (unsigned int)interrupt_14, 0x08, 0x8E);
idt_set_gate(15, (unsigned int)interrupt_15, 0x08, 0x8E);
idt_set_gate(16, (unsigned int)interrupt_16, 0x08, 0x8E);
idt_set_gate(17, (unsigned int)interrupt_17, 0x08, 0x8E);
idt_set_gate(18, (unsigned int)interrupt_18, 0x08, 0x8E);
idt_set_gate(19, (unsigned int)interrupt_19, 0x08, 0x8E);
idt_set_gate(20, (unsigned int)interrupt_20, 0x08, 0x8E);
idt_set_gate(21, (unsigned int)interrupt_21, 0x08, 0x8E);
idt_set_gate(22, (unsigned int)interrupt_22, 0x08, 0x8E);
idt_set_gate(23, (unsigned int)interrupt_23, 0x08, 0x8E);
idt_set_gate(24, (unsigned int)interrupt_24, 0x08, 0x8E);
idt_set_gate(25, (unsigned int)interrupt_25, 0x08, 0x8E);
idt_set_gate(26, (unsigned int)interrupt_26, 0x08, 0x8E);
idt_set_gate(27, (unsigned int)interrupt_27, 0x08, 0x8E);
idt_set_gate(28, (unsigned int)interrupt_28, 0x08, 0x8E);
idt_set_gate(29, (unsigned int)interrupt_29, 0x08, 0x8E);
idt_set_gate(30, (unsigned int)interrupt_30, 0x08, 0x8E);
idt_set_gate(31, (unsigned int)interrupt_31, 0x08, 0x8E);
// Master PIC
idt_set_gate(32, (unsigned int)interrupt_32, 0x08, 0x8E);
idt_set_gate(33, (unsigned int)interrupt_33, 0x08, 0x8E);
idt_set_gate(34, (unsigned int)interrupt_34, 0x08, 0x8E);
idt_set_gate(35, (unsigned int)interrupt_35, 0x08, 0x8E);
idt_set_gate(36, (unsigned int)interrupt_36, 0x08, 0x8E);
idt_set_gate(37, (unsigned int)interrupt_37, 0x08, 0x8E);
idt_set_gate(38, (unsigned int)interrupt_38, 0x08, 0x8E);
idt_set_gate(39, (unsigned int)interrupt_39, 0x08, 0x8E);
// Slave PIC
idt_set_gate(40, (unsigned int)interrupt_40, 0x08, 0x8E);
idt_set_gate(41, (unsigned int)interrupt_41, 0x08, 0x8E);
idt_set_gate(42, (unsigned int)interrupt_42, 0x08, 0x8E);
idt_set_gate(43, (unsigned int)interrupt_43, 0x08, 0x8E);
idt_set_gate(44, (unsigned int)interrupt_44, 0x08, 0x8E);
idt_set_gate(45, (unsigned int)interrupt_45, 0x08, 0x8E);
idt_set_gate(46, (unsigned int)interrupt_46, 0x08, 0x8E);
idt_set_gate(47, (unsigned int)interrupt_47, 0x08, 0x8E);
idt_set_gate(INT_SYSCALL, (unsigned int)interrupt_0x80, 0x08, 0x8E | 0x60);
logger_info_from("protected", "Load GDT.");
gdt_pointer.limit = sizeof(struct GdtEntry) * GDT_SIZE - 1;
gdt_pointer.base = (unsigned int)&gdt_entries;
gdt_flush(&gdt_pointer);
logger_info_from("protected", "Load IDT.");
idt_pointer.limit = sizeof(struct IdtEntry) * IDT_SIZE - 1;
idt_pointer.base = (unsigned int)&idt_entries;
idt_flush(&idt_pointer);
logger_info_from("protected", "Load TSS.");
tss_flush();
logger_info_from("protected", "Enable interrupts.");
asm volatile ("sti");
}
void gdt_set_gate(int num, unsigned int base, unsigned int limit, unsigned char access, unsigned char gran)
{
gdt_entries[num].base_low = (base & 0xFFFF);
gdt_entries[num].base_middle = (base >> 16) & 0xFF;
gdt_entries[num].base_high = (base >> 24) & 0xFF;
gdt_entries[num].limit_low = (limit & 0xFFFF);
gdt_entries[num].granularity = (limit >> 16) & 0x0F;
gdt_entries[num].granularity |= gran & 0xF0;
gdt_entries[num].access = access;
}
void idt_set_gate(unsigned char num, unsigned int base, unsigned short sel, unsigned char flags)
{
idt_entries[num].base_lo = base & 0xFFFF;
idt_entries[num].base_hi = (base >> 16) & 0xFFFF;
idt_entries[num].sel = sel;
idt_entries[num].always0 = 0;
idt_entries[num].flags = flags;
}