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