//
// descriptor_tables.c - Initialises the GDT and IDT, and defines the 
//                       default ISR and IRQ handler.
//                       Based on code from Bran's kernel development tutorials.
//                       Rewritten for JamesM's kernel development tutorials.
//

#include <common.h>
#include <arch/descriptor_tables.h>
#include <arch/vga.h>
#include <arch/isr.h>


// Lets us access our ASM functions from our C code.
extern void gdt_flush(u32int);
extern void idt_flush(u32int);

isr_f isr[48]=
{
	isr0,
	isr1,
	isr2,
	isr3,
	isr4,
	isr5,
	isr6,
	isr7,
	isr8,
	isr9,
	isr10,
	isr11,
	isr12,
	isr13,
	isr14,
	isr15,
	isr16,
	isr17,
	isr18,
	isr19,
	isr20,
	isr21,
	isr22,
	isr23,
	isr24,
	isr25,
	isr26,
	isr27,
	isr28,
	isr29,
	isr30,
	isr31,
	irq0,
	irq1,
	irq2,
	irq3,
	irq4,
	irq5,
	irq6,
	irq7,
	irq8,
	irq9,
	irq10,
	irq11,
	irq12,
	irq13,
	irq14,
	irq15
};

// Internal function prototypes.
static void init_gdt();
static void init_idt();
static void gdt_set_gate(s32int,u32int,u32int,u8int,u8int);
static void idt_set_gate(u8int,u32int,u16int,u8int);
// Initialisation routine - zeroes all the interrupt service routines,
// initialises the GDT and IDT.
void init_descriptor_tables()
{

    // Initialise the global descriptor table.
    init_gdt();
    // Initialise the interrupt descriptor table.
    init_idt();
    
    return;

}

static void init_gdt()
{
	gdt_ptr.limit = (sizeof(gdt_entry_t) * 5) - 1;
	gdt_ptr.base  = (u32int)&gdt_entries;

	gdt_set_gate(0, 0, 0, 0, 0);                // Null segment
	gdt_set_gate(1, 0, 0xFFFFFFFF, 0x9A, 0xCF); // Code segment
	gdt_set_gate(2, 0, 0xFFFFFFFF, 0x92, 0xCF); // Data segment
	gdt_set_gate(3, 0, 0xFFFFFFFF, 0xFA, 0xCF); // User mode code segment
	gdt_set_gate(4, 0, 0xFFFFFFFF, 0xF2, 0xCF); // User mode data segment

	gdt_flush((u32int)&gdt_ptr);
	    
	return;
}

// Set the value of one GDT entry.
static void gdt_set_gate(s32int num, u32int base, u32int limit, u8int access, u8int 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;
    
	return;
}

static void init_idt()
{
    idt_ptr.limit = sizeof(idt_entry_t) * 256 -1;
    idt_ptr.base  = (u32int)&idt_entries;
	int i;
    memset(&idt_entries, 0, sizeof(idt_entry_t)*256);

	for(i=0; i<32;i++)
		idt_set_gate(i, (u32int)isr[i], 0x08, 0x8E);	
		
    idt_flush((u32int)&idt_ptr);
    
  out(0x20, 0x11);
  delay();
  out(0xA0, 0x11);
  delay();
  
  out(0x21, 0x20);
  delay();
  out(0xA1, 0x28);
  delay();
  
  out(0x21, 0x04);
  delay();
  out(0xA1, 0x02);
  delay();
  
  out(0x21, 0x01);
  delay();
  out(0xA1, 0x01);
  delay();
  
  out(0x21, 0x0);
  delay();
  out(0xA1, 0x0);
  delay();
  
  out(0x21, 0xff);
  delay();
  out(0xA1, 0xff);
  delay();
  
  for(i=32; i<48;i++)
		idt_set_gate(i, (u32int)isr[i], 0x08, 0x8E);
for(i=32; i<48;i++)
	register_interrupt_handler(i, &donothing);
	
	return;
		
}

static void idt_set_gate(u8int num, u32int base, u16int sel, u8int 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;
    // We must uncomment the OR below when we get to using user-mode.
    // It sets the interrupt gate's privilege level to 3.
    idt_entries[num].flags   = flags /* | 0x60 */;
    return;
}




