HEADmaster

1 files changed, 131 insertions, 0 deletions

diff --git a/kernel/idt.c b/kernel/idt.c
new file mode 100644
index 0000000..01cee06
--- /dev/null
+++ b/kernel/idt.c
@@ -0,0 +1,131 @@
+#include "idt.h"
+#include "memops.h"
+#include "interrupts/generic.h"
+#include "asm_inline.h"
+#include "kprintf.h"
+
+extern void asm_generic_interrupt();
+
+idt_load idt_l;
+__attribute__((aligned(0x08)))
+uint64_t idt[512] = {0};
+
+#define VNM(x) vector##x
+
+void fill_idt();
+
+void init_idt()
+{
+    /*
+    for(int i = 0; i < 512; i+=2)
+    {
+        gate g = {
+            // .target_offset = (uint64_t)asm_generic_interrupt,
+            .target_offset = (uint64_t)vector1,
+            .target_selector = 0x8,
+            .ist = 0x0,
+            .type = INT_INT,
+            .dpl = 0x0,
+            .p = true
+        };
+
+        uint64_t converted_gate[2];
+
+        make_int_gate(&g, converted_gate);
+
+        kmemcpy(&converted_gate, &idt[i], 2*sizeof(uint64_t));
+    }
+    */
+
+    fill_idt();
+
+    /*
+    kprintf("IDT ADDR: %p\n", idt);
+    kprintf("INTERRUPT ADDR: %p\n", asm_generic_interrupt);
+    */
+
+    idt_l.size = 256 * 2 * sizeof(uint64_t) - 1;
+    idt_l.ptr = (uint64_t)(idt);
+
+    lidt(&idt_l);
+}
+
+void make_call_gate(gate* g, uint64_t* rg)
+{
+    uint32_t* srg = (uint32_t*)rg;
+    // lower 64
+    rg[0] = 0x0;
+    rg[1] = 0x0;
+
+    srg[0] |= g->target_offset & 0xFFFF;
+    srg[0] |= (g->target_selector & 0xFFFF) << 16;
+
+    // srg[1] |= (g->ist & 0xFF);
+    srg[1] |= (g->type & 0xFF ) << 8;
+    srg[1] |= (g->dpl & 0xFF) << 13;
+    srg[1] |= (g->p & 0xF) << 15; // <- this +16 (next field side is 61, so I did this wrong) <- this should offset by 47, to end in 48
+    srg[1] |= ((g->target_offset >> 16) & 0xFFFF) << 16;
+
+    srg[2] |= ((g->target_offset >> 32) & 0xFFFFFFFF);
+}
+
+void make_int_gate(gate* g, uint64_t* rg)
+{
+    uint32_t* srg = (uint32_t*)rg;
+    // lower 64
+    rg[0] = 0x0;
+    rg[1] = 0x0;
+
+    srg[0] |= g->target_offset & 0xFFFF;
+    srg[0] |= (g->target_selector & 0xFFFF) << 16;
+
+    srg[1] |= (g->ist & 0xFF);
+    srg[1] |= (g->type & 0xFF ) << 8;
+    srg[1] |= (g->dpl & 0xFF) << 13;
+    srg[1] |= (g->p & 0xF) << 15; // <- this +16 (next field side is 61, so I did this wrong) <- this should offset by 47, to end in 48
+    // srg[1] |= ((g->target_offset >> 16) & 0xFFFF) << 16;
+    srg[1] |= g->target_offset & 0xFFFF0000;
+
+    srg[2] |= ((g->target_offset >> 32) & 0xFFFFFFFF);
+}
+
+#define MKI(x) make_gate((uint64_t) vector##x, x)
+
+void make_gate(uint64_t vector, uint32_t i)
+{
+    gate g = {
+        // .target_offset = (uint64_t)asm_generic_interrupt,
+        .target_offset = vector,
+        .target_selector = 0x8,
+        .ist = 0x0,
+        .type = INT_INT,
+        .dpl = 0x0,
+        .p = true
+    };
+
+    uint64_t converted_gate[2];
+
+    make_int_gate(&g, converted_gate);
+
+    kmemcpy(&converted_gate, &idt[2*i], 2*sizeof(uint64_t));
+}
+
+void fill_idt()
+{
+    MKI(0); MKI(1); MKI(2); MKI(3); MKI(4); MKI(5); MKI(6); MKI(7); MKI(8); MKI(9); MKI(10); MKI(11); MKI(12); MKI(13); MKI(14); MKI(15); 
+    MKI(16); MKI(17); MKI(18); MKI(19); MKI(20); MKI(21); MKI(22); MKI(23); MKI(24); MKI(25); MKI(26); MKI(27); MKI(28); MKI(29); MKI(30); MKI(31); 
+    MKI(32); MKI(33); MKI(34); MKI(35); MKI(36); MKI(37); MKI(38); MKI(39); MKI(40); MKI(41); MKI(42); MKI(43); MKI(44); MKI(45); MKI(46); MKI(47); 
+    MKI(48); MKI(49); MKI(50); MKI(51); MKI(52); MKI(53); MKI(54); MKI(55); MKI(56); MKI(57); MKI(58); MKI(59); MKI(60); MKI(61); MKI(62); MKI(63); 
+    MKI(64); MKI(65); MKI(66); MKI(67); MKI(68); MKI(69); MKI(70); MKI(71); MKI(72); MKI(73); MKI(74); MKI(75); MKI(76); MKI(77); MKI(78); MKI(79); 
+    MKI(80); MKI(81); MKI(82); MKI(83); MKI(84); MKI(85); MKI(86); MKI(87); MKI(88); MKI(89); MKI(90); MKI(91); MKI(92); MKI(93); MKI(94); MKI(95); 
+    MKI(96); MKI(97); MKI(98); MKI(99); MKI(100); MKI(101); MKI(102); MKI(103); MKI(104); MKI(105); MKI(106); MKI(107); MKI(108); MKI(109); MKI(110); MKI(111); 
+    MKI(112); MKI(113); MKI(114); MKI(115); MKI(116); MKI(117); MKI(118); MKI(119); MKI(120); MKI(121); MKI(122); MKI(123); MKI(124); MKI(125); MKI(126); MKI(127); 
+    MKI(128); MKI(129); MKI(130); MKI(131); MKI(132); MKI(133); MKI(134); MKI(135); MKI(136); MKI(137); MKI(138); MKI(139); MKI(140); MKI(141); MKI(142); MKI(143); 
+    MKI(144); MKI(145); MKI(146); MKI(147); MKI(148); MKI(149); MKI(150); MKI(151); MKI(152); MKI(153); MKI(154); MKI(155); MKI(156); MKI(157); MKI(158); MKI(159); 
+    MKI(160); MKI(161); MKI(162); MKI(163); MKI(164); MKI(165); MKI(166); MKI(167); MKI(168); MKI(169); MKI(170); MKI(171); MKI(172); MKI(173); MKI(174); MKI(175); 
+    MKI(176); MKI(177); MKI(178); MKI(179); MKI(180); MKI(181); MKI(182); MKI(183); MKI(184); MKI(185); MKI(186); MKI(187); MKI(188); MKI(189); MKI(190); MKI(191); 
+    MKI(192); MKI(193); MKI(194); MKI(195); MKI(196); MKI(197); MKI(198); MKI(199); MKI(200); MKI(201); MKI(202); MKI(203); MKI(204); MKI(205); MKI(206); MKI(207); 
+    MKI(208); MKI(209); MKI(210); MKI(211); MKI(212); MKI(213); MKI(214); MKI(215); MKI(216); MKI(217); MKI(218); MKI(219); MKI(220); MKI(221); MKI(222); MKI(223); 
+    MKI(224); MKI(225); MKI(226); MKI(227); MKI(228); MKI(229); MKI(230); MKI(231); MKI(232); MKI(233); MKI(234); MKI(235); MKI(236); MKI(237); MKI(238); MKI(239); 
+    MKI(240); MKI(241); MKI(242); MKI(243); MKI(244); MKI(245); MKI(246); MKI(247); MKI(248); MKI(249); MKI(250); MKI(251); MKI(252); MKI(253); MKI(254); MKI(255); 
+}