-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathinterrupt.c
142 lines (121 loc) · 4.88 KB
/
interrupt.c
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
/*
* interrupt.c -
*/
#include <block.h>
#include <circular_buffer.h>
#include <devices.h>
#include <entry.h>
#include <hardware.h>
#include <interrupt.h>
#include <io.h>
#include <klibc.h>
#include <list.h>
#include <msrs.h>
#include <sched.h>
#include <segment.h>
#include <sys_call_table.h>
#include <types.h>
#include <zeos_interrupt.h>
Gate idt[IDT_ENTRIES];
Register idtR;
char char_map[] = {'\0', '\0', '1', '2', '3', '4', '5', '6', '7', '8',
'9', '0', '\'', '¡', '\0', '\0', 'q', 'w', 'e', 'r',
't', 'y', 'u', 'i', 'o', 'p', '`', '+', '\0', '\0',
'a', 's', 'd', 'f', 'g', 'h', 'j', 'k', 'l', 'ñ',
'\0', 'º', '\0', 'ç', 'z', 'x', 'c', 'v', 'b', 'n',
'm', ',', '.', '-', '\0', '*', '\0', '\0', '\0', '\0',
'\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0',
'\0', '7', '8', '9', '-', '4', '5', '6', '+', '1',
'2', '3', '0', '\0', '\0', '\0', '<', '\0', '\0', '\0',
'\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0'};
void setInterruptHandler(
int vector,
void (*handler)(),
int maxAccessibleFromPL) {
/***********************************************************************/
/* THE INTERRUPTION GATE FLAGS: R1: pg. 5-11 */
/* *************************** */
/* flags = x xx 0x110 000 ????? */
/* | | | */
/* | | \ D = Size of gate: 1 = 32 bits; 0 = 16 bits */
/* | \ DPL = Num. higher PL from which it is accessible */
/* \ P = Segment Present bit */
/***********************************************************************/
Word flags = (Word)(maxAccessibleFromPL << 13);
flags |= 0x8E00; /* P = 1, D = 1, Type = 1110 (Interrupt Gate) */
idt[vector].lowOffset = lowWord((DWord)handler);
idt[vector].segmentSelector = __KERNEL_CS;
idt[vector].flags = flags;
idt[vector].highOffset = highWord((DWord)handler);
}
void setTrapHandler(int vector, void (*handler)(), int maxAccessibleFromPL) {
/***********************************************************************/
/* THE TRAP GATE FLAGS: R1: pg. 5-11 */
/* ******************** */
/* flags = x xx 0x111 000 ????? */
/* | | | */
/* | | \ D = Size of gate: 1 = 32 bits; 0 = 16 bits */
/* | \ DPL = Num. higher PL from which it is accessible */
/* \ P = Segment Present bit */
/***********************************************************************/
Word flags = (Word)(maxAccessibleFromPL << 13);
// flags |= 0x8F00; /* P = 1, D = 1, Type = 1111 (Trap Gate) */
/* Changed to 0x8e00 to convert it to an 'interrupt gate' and so
the system calls will be thread-safe. */
flags |= 0x8E00; /* P = 1, D = 1, Type = 1110 (Interrupt Gate) */
idt[vector].lowOffset = lowWord((DWord)handler);
idt[vector].segmentSelector = __KERNEL_CS;
idt[vector].flags = flags;
idt[vector].highOffset = highWord((DWord)handler);
}
void setIdt() {
/* Program interrups/exception service routines */
idtR.base = (DWord)idt;
idtR.limit = IDT_ENTRIES * sizeof(Gate) - 1;
set_handlers();
/* INITIALIZATION CODE FOR INTERRUPT VECTOR */
setInterruptHandler(14, page_fault_handler_student, 0);
setInterruptHandler(33, keyboard_handler, 0);
setInterruptHandler(32, clock_handler, 0);
setTrapHandler(0x80, system_call_handler, 3);
set_idt_reg(&idtR);
}
void init_fast_syscalls() {
writeMSR(SYSENTER_CS_MSR, __KERNEL_CS);
writeMSR(SYSENTER_ESP_MSR, INITIAL_ESP);
writeMSR(SYSENTER_EIP_MSR, (unsigned long)system_call_handler_sysenter);
}
void page_fault_routine_student(unsigned int eip) {
char eip_hex[30] = "";
k_itoa(eip, eip_hex, 16);
printk("\n\nProcess generates a PAGE FAULT exception at EIP: 0x");
printk(eip_hex);
printk("\n");
for (;;)
;
}
void keyboard_routine() {
unsigned char data = inb(0x60);
if (!(data & (1 << 7))) {
char c = char_map[data];
if (c == '\0')
c = 'C';
add_item(&keyboard_buffer, c);
if (!list_empty(&keyboard_blocked)) {
struct list_head *first = list_first(&keyboard_blocked);
unblock(first);
}
}
}
void clock_routine() {
zeos_show_clock();
++zeos_ticks;
struct list_head *e, *tmp;
list_for_each_safe(e, tmp, &keyboard_blocked) {
struct task_struct *task = list_entry(e, struct task_struct, queue_anchor);
if (--(task->blocked.blocked.keyboard.remaining_ticks) == 0) {
unblock(e);
}
}
schedule();
}