-
Notifications
You must be signed in to change notification settings - Fork 0
/
InitSetup.cpp
237 lines (209 loc) · 6.33 KB
/
InitSetup.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
/* The project is licensed under GNU GPL v3. See $(PROJECT_ROOT)/doc/gpl.txt for more details.
*
* phOS Operating System
* Copyright (C) 2009 Cristian Bidea
*/
#include <phos/InitSetup.hpp>
#define IRQ0 0
#define IRQ1 1
#define IRQ2 2
#define IRQ3 3
#define IRQ4 4
#define IRQ5 5
#define IRQ6 6
#define IRQ7 7
#define IRQ8 8
#define IRQ9 9
#define IRQ10 10
#define IRQ11 11
#define IRQ12 12
#define IRQ13 13
#define IRQ14 14
#define IRQ15 15
#define IRQ16 16
#define IRQ17 17
#define IRQ18 18
#define IRQ19 19
#define IRQ20 20
#define IRQ21 21
#define IRQ22 22
#define IRQ23 23
#define IRQ24 24
#define IRQ25 25
#define IRQ26 26
#define IRQ27 27
#define IRQ28 28
#define IRQ29 29
#define IRQ30 30
#define IRQ31 31
//---------------------------------------------------------------------------
// Local vars
//---------------------------------------------------------------------------
segment_descriptor gdt[5];
gdt_ptr gdt_p;
idt_descriptor idt[256];
idt_ptr idt_p;
u32 tick;
//---------------------------------------------------------------------------
// Extern defines
//---------------------------------------------------------------------------
extern "C" {
extern void asm_init_gdt (u32 ptr);
extern void asm_init_idt (u32 ptr);
extern void isr0 ();
extern void isr1 ();
extern void isr2 ();
extern void isr3 ();
extern void isr4 ();
extern void isr5 ();
extern void isr6 ();
extern void isr7 ();
extern void isr8 ();
extern void isr9 ();
extern void isr10 ();
extern void isr11 ();
extern void isr12 ();
extern void isr13 ();
extern void isr14 ();
extern void isr15 ();
extern void isr16 ();
extern void isr17 ();
extern void isr18 ();
extern void isr19 ();
extern void isr20 ();
extern void isr21 ();
extern void isr22 ();
extern void isr23 ();
extern void isr24 ();
extern void isr25 ();
extern void isr26 ();
extern void isr27 ();
extern void isr28 ();
extern void isr29 ();
extern void isr30 ();
extern void isr31 ();
}
//---------------------------------------------------------------------------
// Forward function declarations
//---------------------------------------------------------------------------
static void idt_set_entry (s32 num, u32 base, u16 sel, u8 flags);
static void gdt_set_entry (s32 num, u32 base, u32 limit, u8 access, u8 flags);
//---------------------------------------------------------------------------
// PUBLIC class functions implementation
//---------------------------------------------------------------------------
void KernelInit::init_tables()
{
init_gdt();
init_idt();
}
void timer_callback(registers_t regs)
{
Video vout;
tick++;
vout.printk("Tick %d\n", tick);
}
void KernelInit::init_timer(u32 freq)
{
RegisterInterruptHandler(IRQ0, &timer_callback);
u32 divisor = 1193180 / freq;
outb(0x43, 0x36);
u8 l = (u8) (divisor & 0xFF);
u8 h = (u8) ((divisor >> 8) & 0xFF);
outb(0x40, l);
outb(0x40, h);
}
void KernelInit::CallIRQHandler(registers_t regs)
{
if (irqHandlers[regs.int_no] != 0)
{
ISRHandlerCallback handler = irqHandlers[regs.int_no];
handler(regs);
}
}
//---------------------------------------------------------------------------
// PRIVATE class functions implementation
//---------------------------------------------------------------------------
void KernelInit::init_gdt()
{
gdt_set_entry(0, 0, 0, 0, 0); // Null segment
gdt_set_entry(1, 0, 0xFFFFFFFF, 0x9A, 0xCF); // Code segment
gdt_set_entry(2, 0, 0xFFFFFFFF, 0x92, 0xCF); // Data segment
gdt_set_entry(3, 0, 0xFFFFFFFF, 0xFA, 0xCF); // User mode code segment
gdt_set_entry(4, 0, 0xFFFFFFFF, 0xF2, 0xCF); // User mode data segment
// set the ptr
gdt_p.limit = sizeof (segment_descriptor) * 5 - 1;
gdt_p.base = (u32)&gdt;
asm_init_gdt ((u32)&gdt_p);
}
void KernelInit::init_idt()
{
idt_p.limit = sizeof(idt_descriptor) * 256 - 1;
idt_p.base = (u32)&idt;
//__builtin_memset(&idt, 0, sizeof(idt_descriptor)*256);
for (int i = 0; i < 256; i++)
{
idt[i].always0 = 0;
idt[i].base_lo = 0;
idt[i].base_hi = 0;
idt[i].sel = 0;
idt[i].flags = 0;
}
idt_set_entry(IRQ0, (u32)isr0, 0x08, 0x8E);
idt_set_entry(IRQ1, (u32)isr1, 0x08, 0x8E);
idt_set_entry(IRQ2, (u32)isr2, 0x08, 0x8E);
idt_set_entry(IRQ3, (u32)isr3, 0x08, 0x8E);
idt_set_entry(IRQ4, (u32)isr4, 0x08, 0x8E);
idt_set_entry(IRQ5, (u32)isr5, 0x08, 0x8E);
idt_set_entry(IRQ6, (u32)isr6, 0x08, 0x8E);
idt_set_entry(IRQ7, (u32)isr7, 0x08, 0x8E);
idt_set_entry(IRQ8, (u32)isr8, 0x08, 0x8E);
idt_set_entry(IRQ9, (u32)isr9, 0x08, 0x8E);
idt_set_entry(IRQ10, (u32)isr10, 0x08, 0x8E);
idt_set_entry(IRQ11, (u32)isr11, 0x08, 0x8E);
idt_set_entry(IRQ12, (u32)isr12, 0x08, 0x8E);
idt_set_entry(IRQ13, (u32)isr13, 0x08, 0x8E);
idt_set_entry(IRQ14, (u32)isr14, 0x08, 0x8E);
idt_set_entry(IRQ15, (u32)isr15, 0x08, 0x8E);
idt_set_entry(IRQ16, (u32)isr16, 0x08, 0x8E);
idt_set_entry(IRQ17, (u32)isr17, 0x08, 0x8E);
idt_set_entry(IRQ18, (u32)isr18, 0x08, 0x8E);
idt_set_entry(IRQ19, (u32)isr19, 0x08, 0x8E);
idt_set_entry(IRQ20, (u32)isr20, 0x08, 0x8E);
idt_set_entry(IRQ21, (u32)isr21, 0x08, 0x8E);
idt_set_entry(IRQ22, (u32)isr22, 0x08, 0x8E);
idt_set_entry(IRQ23, (u32)isr23, 0x08, 0x8E);
idt_set_entry(IRQ24, (u32)isr24, 0x08, 0x8E);
idt_set_entry(IRQ25, (u32)isr25, 0x08, 0x8E);
idt_set_entry(IRQ26, (u32)isr26, 0x08, 0x8E);
idt_set_entry(IRQ27, (u32)isr27, 0x08, 0x8E);
idt_set_entry(IRQ28, (u32)isr28, 0x08, 0x8E);
idt_set_entry(IRQ29, (u32)isr29, 0x08, 0x8E);
idt_set_entry(IRQ30, (u32)isr30, 0x08, 0x8E);
idt_set_entry(IRQ31, (u32)isr31, 0x08, 0x8E);
asm_init_idt((u32)&idt_p);
}
void KernelInit::RegisterInterruptHandler(u8 n, ISRHandlerCallback handler)
{
irqHandlers[n] = handler;
}
//---------------------------------------------------------------------------
// Local functions implementation
//---------------------------------------------------------------------------
static void gdt_set_entry (s32 num, u32 base, u32 limit, u8 access, u8 flags)
{
gdt[num].limit = limit & 0xFFFF;
gdt[num].basel = base & 0xFFFF;
gdt[num].basem = (base >> 16) & 0xFF;
gdt[num].baseh = (base >> 24) & 0xFF;
gdt[num].type = access;
gdt[num].flags = (limit >> 16) & 0xF;
gdt[num].flags |= flags & 0xF0;
}
static void idt_set_entry (s32 num, u32 base, u16 sel, u8 flags)
{
idt[num].base_lo = base & 0xFFFF;
idt[num].base_hi = (base >> 16) & 0xFFFF;
idt[num].sel = sel;
idt[num].always0 = 0;
idt[num].flags = flags;
}