001
002
003
004
005
006
007
008
009
010
011
012
013
014
015
016
017
018 #include "idt.h"
019 #include "irq.h"
020
021 #include <sos/assert.h>
022 #include <drivers/bochs.h>
023 #include <sos/thread.h>
024
025 #include "exception.h"
026
027
028 extern sos_vaddr_t sos_exception_wrapper_array[SOS_EXCEPT_NUM];
029
030
031 sos_exception_handler_t sos_exception_handler_array[SOS_EXCEPT_NUM] =
032 { NULL, };
033
034
035 static const char * sos_x86_exnames[] = {
036 [SOS_EXCEPT_DIVIDE_ERROR] = "Division by zero",
037 [SOS_EXCEPT_DEBUG] = "Debug",
038 [SOS_EXCEPT_NMI_INTERRUPT] = "Non Maskable Interrupt",
039 [SOS_EXCEPT_BREAKPOINT] = "Breakpoint",
040 [SOS_EXCEPT_OVERFLOW] = "Overflow",
041 [SOS_EXCEPT_BOUND_RANGE_EXCEDEED] = "Bound Range Exceeded",
042 [SOS_EXCEPT_INVALID_OPCODE] = "Invalid Opcode",
043 [SOS_EXCEPT_DEVICE_NOT_AVAILABLE] = "Device Unavailable",
044 [SOS_EXCEPT_DOUBLE_FAULT] = "Double Fault",
045 [SOS_EXCEPT_COPROCESSOR_SEGMENT_OVERRUN] = "Coprocessor Segment Overrun",
046 [SOS_EXCEPT_INVALID_TSS] = "Invalid TSS",
047 [SOS_EXCEPT_SEGMENT_NOT_PRESENT] = "Segment Not Present",
048 [SOS_EXCEPT_STACK_SEGMENT_FAULT] = "Stack Segfault",
049 [SOS_EXCEPT_GENERAL_PROTECTION] = "General Protection",
050 [SOS_EXCEPT_PAGE_FAULT] = "Page Fault",
051 [SOS_EXCEPT_INTEL_RESERVED_1] = "INTEL1",
052 [SOS_EXCEPT_FLOATING_POINT_ERROR] = "FP Error",
053 [SOS_EXCEPT_ALIGNEMENT_CHECK] = "Alignment Check",
054 [SOS_EXCEPT_MACHINE_CHECK] = "Machine Check",
055 [SOS_EXCEPT_INTEL_RESERVED_2] = "INTEL2",
056 [SOS_EXCEPT_INTEL_RESERVED_3] = "INTEL3",
057 [SOS_EXCEPT_INTEL_RESERVED_4] = "INTEL4",
058 [SOS_EXCEPT_INTEL_RESERVED_5] = "INTEL5",
059 [SOS_EXCEPT_INTEL_RESERVED_6] = "INTEL6",
060 [SOS_EXCEPT_INTEL_RESERVED_7] = "INTEL7",
061 [SOS_EXCEPT_INTEL_RESERVED_8] = "INTEL8",
062 [SOS_EXCEPT_INTEL_RESERVED_9] = "INTEL9",
063 [SOS_EXCEPT_INTEL_RESERVED_10] = "INTEL10",
064 [SOS_EXCEPT_INTEL_RESERVED_11] = "INTEL11",
065 [SOS_EXCEPT_INTEL_RESERVED_12] = "INTEL12",
066 [SOS_EXCEPT_INTEL_RESERVED_13] = "INTEL13",
067 [SOS_EXCEPT_INTEL_RESERVED_14] = "INTEL14"
068 };
069
070
071
072 static void sos_generic_ex(int exid, struct sos_cpu_state *ctxt)
073 {
074 const char *exname = sos_exception_get_name(exid);
075
076 if (sos_cpu_context_is_in_user_mode(ctxt))
077 {
078
079 sos_bochs_printf("Exception %s in User mode at instruction 0x%x (info=%x)!\n",
080 exname,
081 sos_cpu_context_get_PC(ctxt),
082 (unsigned)sos_cpu_context_get_EX_info(ctxt));
083 sos_bochs_printf("Terminating User thread\n");
084 sos_thread_exit();
085 }
086 else
087 sos_display_fatal_error("Exception %s in Kernel at instruction 0x%x (info=%x)!\n",
088 exname,
089 sos_cpu_context_get_PC(ctxt),
090 (unsigned)sos_cpu_context_get_EX_info(ctxt));
091 }
092
093
094 sos_ret_t sos_exception_subsystem_setup(void)
095 {
096 sos_ret_t retval;
097 int exid;
098
099
100
101 for (exid = 0 ; exid < SOS_EXCEPT_NUM ; exid ++)
102 {
103
104 if (exid == SOS_EXCEPT_DOUBLE_FAULT)
105 continue;
106
107 retval = sos_exception_set_routine(exid, sos_generic_ex);
108 if (SOS_OK != retval)
109 return retval;
110 }
111
112
113
114
115
116
117 return sos_idt_set_handler(SOS_EXCEPT_BASE + SOS_EXCEPT_DOUBLE_FAULT,
118 (sos_vaddr_t) sos_exception_wrapper_array[SOS_EXCEPT_DOUBLE_FAULT],
119 0 );
120 }
121
122
123 sos_ret_t sos_exception_set_routine(int exception_number,
124 sos_exception_handler_t routine)
125 {
126 sos_ret_t retval;
127 sos_ui32_t flags;
128
129 if ((exception_number < 0) || (exception_number >= SOS_EXCEPT_NUM))
130 return -SOS_EINVAL;
131
132
133 if (exception_number == SOS_EXCEPT_DOUBLE_FAULT)
134 return -SOS_ENOSUP;
135
136 sos_disable_IRQs(flags);
137
138 retval = SOS_OK;
139
140
141 sos_exception_handler_array[exception_number] = routine;
142
143
144
145 if (routine != NULL)
146 retval
147 = sos_idt_set_handler(SOS_EXCEPT_BASE + exception_number,
148 (sos_vaddr_t) sos_exception_wrapper_array[exception_number],
149 0 );
150 else
151 retval
152 = sos_idt_set_handler(SOS_EXCEPT_BASE + exception_number,
153 (sos_vaddr_t)NULL ,
154 0 );
155
156 sos_restore_IRQs(flags);
157 return retval;
158 }
159
160
161 sos_exception_handler_t sos_exception_get_routine(int exception_number)
162 {
163 if ((exception_number < 0) || (exception_number >= SOS_EXCEPT_NUM))
164 return NULL;
165
166
167 if (exception_number == SOS_EXCEPT_DOUBLE_FAULT)
168 return NULL;
169
170
171 return sos_exception_handler_array[exception_number];
172 }
173
174
175 const char * sos_exception_get_name(int exception_number)
176 {
177 if ((exception_number < 0) || (exception_number >= SOS_EXCEPT_NUM))
178 return NULL;
179
180 return sos_x86_exnames[exception_number];
181 }