svn rev.329より移動。

[chnosproject/CHNOSProject.git] / CHNOSProject / chnos / tolset_chn_000 / chnos_009 / chnos / dsctbl.c

diff --git a/CHNOSProject/chnos/tolset_chn_000/chnos_009/chnos/dsctbl.c b/CHNOSProject/chnos/tolset_chn_000/chnos_009/chnos/dsctbl.c
new file mode 100644 (file)
index 0000000..5b41149
--- /dev/null
+++ b/CHNOSProject/chnos/tolset_chn_000/chnos_009/chnos/dsctbl.c
@@ -0,0 +1,190 @@
+\r
+#include "core.h"\r
+\r
+void Initialise_GlobalDescriptorTable(void)\r
+{\r
+       uint i;\r
+\r
+       for(i = 0; i < 8192; i++){\r
+               System_SegmentDescriptor_Set_Absolute(i, 0, 0, 0);\r
+       }\r
+\r
+       System_SegmentDescriptor_Set_Absolute(0x01, 0xffffffff, 0x00000000, AR_DATA32_RW);\r
+       System_SegmentDescriptor_Set_Absolute(0x02, LIMIT_BOOTPACK, ADR_BOOTPACK, AR_CODE32_ER);\r
+\r
+       Load_GDTR(LIMIT_GDT, ADR_GDT);\r
+\r
+       return;\r
+}\r
+\r
+void Initialise_InterruptDescriptorTable(void)\r
+{\r
+       uint i;\r
+\r
+       for(i = 0; i < 256; i++) {\r
+               System_GateDescriptor_Set(i, 0, 0, 0);\r
+       }\r
+\r
+       Load_IDTR(LIMIT_IDT, ADR_IDT);\r
+\r
+       System_GateDescriptor_Set(0x00, (uint)asm_CPU_ExceptionHandler00, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x01, (uint)asm_CPU_ExceptionHandler01, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x02, (uint)asm_CPU_ExceptionHandler02, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x03, (uint)asm_CPU_ExceptionHandler03, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x04, (uint)asm_CPU_ExceptionHandler04, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x05, (uint)asm_CPU_ExceptionHandler05, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x06, (uint)asm_CPU_ExceptionHandler06, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x07, (uint)asm_CPU_ExceptionHandler07, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x08, (uint)asm_CPU_ExceptionHandler08, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x09, (uint)asm_CPU_ExceptionHandler09, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x0a, (uint)asm_CPU_ExceptionHandler0a, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x0b, (uint)asm_CPU_ExceptionHandler0b, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x0c, (uint)asm_CPU_ExceptionHandler0c, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x0d, (uint)asm_CPU_ExceptionHandler0d, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x0e, (uint)asm_CPU_ExceptionHandler0e, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x0f, (uint)asm_CPU_ExceptionHandler0f, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x10, (uint)asm_CPU_ExceptionHandler10, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x11, (uint)asm_CPU_ExceptionHandler11, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x12, (uint)asm_CPU_ExceptionHandler12, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x13, (uint)asm_CPU_ExceptionHandler13, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x14, (uint)asm_CPU_ExceptionHandler14, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x15, (uint)asm_CPU_ExceptionHandler15, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x16, (uint)asm_CPU_ExceptionHandler16, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x17, (uint)asm_CPU_ExceptionHandler17, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x18, (uint)asm_CPU_ExceptionHandler18, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x19, (uint)asm_CPU_ExceptionHandler19, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x1a, (uint)asm_CPU_ExceptionHandler1a, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x1b, (uint)asm_CPU_ExceptionHandler1b, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x1c, (uint)asm_CPU_ExceptionHandler1c, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x1d, (uint)asm_CPU_ExceptionHandler1d, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x1e, (uint)asm_CPU_ExceptionHandler1e, 0x02, AR_INTGATE32);\r
+       System_GateDescriptor_Set(0x1f, (uint)asm_CPU_ExceptionHandler1f, 0x02, AR_INTGATE32);\r
+\r
+       System_GateDescriptor_Set(0x40, (uint)asm_API_Execute, 0x02, AR_INTGATE32 | AR_USER);\r
+\r
+       return;\r
+}\r
+\r
+void SegmentDescriptor_Set(IO_SegmentDescriptor *seg_desc, uint limit, uint base, uint ar)\r
+{\r
+       if(limit > 0xfffff){\r
+               ar |= 0x8000;\r
+               limit = limit >> 12;\r
+       }\r
+       seg_desc->limit_low     = limit & 0xffff;\r
+       seg_desc->base_low      = base & 0xffff;\r
+       seg_desc->base_mid      = (base >> 16) & 0xff;\r
+       seg_desc->access_right  = ar & 0xff;\r
+       seg_desc->limit_high    = ((limit >> 16) & 0x0f) | ((ar >> 8) & 0xf0);\r
+       seg_desc->base_high     = (base >> 24) & 0xff;\r
+\r
+       return;\r
+}\r
+\r
+uint SegmentDescriptor_Get_Base(IO_SegmentDescriptor *seg_desc)\r
+{\r
+       return (seg_desc->base_low | (seg_desc->base_mid << 16) | (seg_desc->base_high << 24));\r
+}\r
+\r
+uint SegmentDescriptor_Get_Limit(IO_SegmentDescriptor *seg_desc)\r
+{\r
+       if((seg_desc->limit_high & 0x80) != 0){\r
+               return ((((seg_desc->limit_low | ((seg_desc->limit_high & 0x0f) << 16))) << 12) | 0xFFF);\r
+       }\r
+\r
+       return (seg_desc->limit_low | ((seg_desc->limit_high & 0x0f) << 16));\r
+}\r
+\r
+uint SegmentDescriptor_Get_AccessRight(IO_SegmentDescriptor *seg_desc)\r
+{\r
+       return (seg_desc->access_right | ((seg_desc->limit_high & 0xf0) << 8)) & 0x7FFF;\r
+}\r
+\r
+void GateDescriptor_Set(IO_GateDescriptor *gate_desc, uint offset, uint selector, uint ar)\r
+{\r
+       gate_desc->offset_low           = offset & 0xffff;\r
+       gate_desc->selector             = selector << 3;\r
+       gate_desc->dw_count             = (ar >> 8) & 0xff;\r
+       gate_desc->access_right = ar & 0xff;\r
+       gate_desc->offset_high          = (offset >> 16) & 0xffff;\r
+\r
+       return;\r
+}\r
+\r
+void System_SegmentDescriptor_Set_Absolute(uint selector, uint limit, uint base, uint ar)\r
+{\r
+       IO_SegmentDescriptor *gdt = (IO_SegmentDescriptor *)ADR_GDT;\r
+\r
+       if(selector >= 8192){\r
+               return;\r
+       }\r
+\r
+       SegmentDescriptor_Set(&gdt[selector], limit, base, ar);\r
+\r
+       return;\r
+}\r
+\r
+uint System_SegmentDescriptor_Get_Base(uint selector)\r
+{\r
+       IO_SegmentDescriptor *gdt = (IO_SegmentDescriptor *)ADR_GDT;\r
+\r
+       if(selector >= 8192){\r
+               return 0;\r
+       }\r
+\r
+       return SegmentDescriptor_Get_Base(&gdt[selector]);\r
+}\r
+\r
+uint System_SegmentDescriptor_Get_Limit(uint selector)\r
+{\r
+       IO_SegmentDescriptor *gdt = (IO_SegmentDescriptor *)ADR_GDT;\r
+\r
+       if(selector >= 8192){\r
+               return 0;\r
+       }\r
+\r
+       return SegmentDescriptor_Get_Limit(&gdt[selector]);\r
+}\r
+\r
+uint System_SegmentDescriptor_Get_AccessRight(uint selector)\r
+{\r
+       IO_SegmentDescriptor *gdt = (IO_SegmentDescriptor *)ADR_GDT;\r
+\r
+       if(selector >= 8192){\r
+               return 0;\r
+       }\r
+\r
+       return SegmentDescriptor_Get_AccessRight(&gdt[selector]);\r
+}\r
+\r
+uint System_SegmentDescriptor_Set(uint limit, int base, int ar)\r
+{\r
+       uint *retaddr;\r
+       uint i;\r
+\r
+       retaddr = &limit;\r
+\r
+       for(i = 1; i < 8192; i++){\r
+               if(System_SegmentDescriptor_Get_Limit(i) == 0){\r
+                       System_SegmentDescriptor_Set_Absolute(i, limit, base, ar);\r
+                       return i;\r
+               }\r
+       }\r
+\r
+       Emergency_Out("[0x%08X]SegDesc_Set Failed.", *(retaddr - 1));\r
+       debug("[0x%08X]SegDesc_Set Failed.", *(retaddr - 1));\r
+       for(;;){\r
+               IO_HLT();\r
+       }\r
+\r
+       return 0;\r
+}\r
+\r
+void System_GateDescriptor_Set(uint irq, uint offset, uint selector, uint ar)\r
+{\r
+       IO_GateDescriptor *idt = (IO_GateDescriptor *)ADR_IDT;\r
+\r
+       GateDescriptor_Set(&idt[irq], offset, selector, ar);\r
+\r
+       return;\r
+}\r