00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018 #include "src/common/shared.hpp"
00019 #include "src/common/bits.hpp"
00020 #include "src/thread/thread.hpp"
00021 #include "src/memory/memset.hpp"
00022 #include "src/memory/align.hpp"
00023 #include "src/memory/heap.hpp"
00024 #include "src/arch/x86/gdt.hpp"
00025 #include "src/arch/x86/interr.hpp"
00026 #include "src/arch/x86/except_c.hpp"
00027 #include "src/arch/x86/irq.hpp"
00028 #include "src/arch/x86/context.hpp"
00029
00030
00031
00032
00033
00034
00035
00038 namespace Thread {
00039
00040
00041 void allocate_context(Thread::thread_t *obj, bool supervisor, uint32 stack, uint32 proc_addr)
00042 {
00043 uint16 data_sel, code_sel;
00044 memset(&obj->context, 0, sizeof(context_t));
00045 obj->context.supervisor=supervisor;
00046
00047 obj->context.ksp=(uint32*) ((char*)Memory::Heap::heap0.malloc(
00048 Arch::x86::Thread::REG_STACK_SIZE, NO_ALIGN, FAC_THREAD|FAC_KSP, NULL)
00049 + Arch::x86::Thread::REG_STACK_SIZE) ;
00050 obj->context.isp=(uint32*) ((char*)Memory::Heap::heap0.malloc(0x14, NO_ALIGN, FAC_THREAD|FAC_ISP, NULL) + 0x14) ;
00051
00052 if (supervisor == true)
00053 {
00054
00055 obj->context.tsp=(uint32*)stack;
00056 data_sel=Arch::x86::GDT::data_sel_kernel;
00057 code_sel=Arch::x86::GDT::code_sel_kernel;
00058 }
00059 else
00060 {
00061 obj->context.tsp=(uint32*) ((char*)Memory::Heap::heap0.malloc(TSP_SIZE,NO_ALIGN, FAC_THREAD|FAC_TSP, NULL) + TSP_SIZE) ;
00062 data_sel=Arch::x86::GDT::data_sel_user;
00063 code_sel=Arch::x86::GDT::code_sel_user;
00064
00065 *(--obj->context.tsp)=data_sel;
00066 *(--obj->context.tsp)=stack;
00067 }
00068
00069 *(--obj->context.tsp)=0x200;
00070 *(--obj->context.tsp)=code_sel;
00071 *(--obj->context.tsp)=proc_addr;
00072 *(--obj->context.ksp)=(uint32)obj->context.tsp;
00073 *(--obj->context.ksp)=0;
00074 *(--obj->context.ksp)=0;
00075 *(--obj->context.ksp)=0;
00076 *(--obj->context.ksp)=0;
00077 *(--obj->context.ksp)=stack;
00078 *(--obj->context.ksp)=0;
00079 *(--obj->context.ksp)=0;
00080 *(--obj->context.ksp)=0;
00081 *(--obj->context.ksp)=data_sel;
00082 *(--obj->context.ksp)=data_sel;
00083 *(--obj->context.ksp)=data_sel;
00084 *(--obj->context.ksp)=data_sel;
00085 }
00086
00087 namespace Scheduler {
00088 extern "C" thread_t volatile *current_thread;
00089 extern bool multitasking_running;
00090 };
00091
00092 };
00093
00094 namespace Arch {
00095 namespace x86 {
00096 namespace Thread {
00097
00098 extern "C" void scheduler_wrapper();
00099
00100
00101 void init(uint32 freq)
00102 {
00103
00104 Interr::kernel_idt.set_int(0x20, &scheduler_wrapper, GDT::code_sel_kernel, Interr::DEF_INT_FLAGS);
00105 Interr::kernel_pic.set_pit_freq(freq);
00106
00107 Interr::kernel_pic.mask_irq_m (bit_set(Interr::kernel_pic.get_irq_mask_m(), 0, 0));
00108
00109 while (1) asm volatile ("sti\nhlt");
00110 }
00111
00112
00113
00114
00115
00116
00117
00118
00119
00120
00121
00122
00123
00124
00125
00126
00127
00128
00129
00130
00131
00132
00133
00134
00135
00136
00137
00138
00139
00140
00141
00142
00143
00144 };
00145 };
00146 };
00147
00148
00149
00150
00151
00152
00153