Rev 1952 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 1952 | Rev 1959 | ||
---|---|---|---|
Line 48... | Line 48... | ||
48 | #include <proc/task.h> |
48 | #include <proc/task.h> |
49 | #include <synch/spinlock.h> |
49 | #include <synch/spinlock.h> |
50 | #include <arch/ddi/ddi.h> |
50 | #include <arch/ddi/ddi.h> |
51 | #include <ipc/sysipc.h> |
51 | #include <ipc/sysipc.h> |
52 | #include <interrupt.h> |
52 | #include <interrupt.h> |
- | 53 | #include <ddi/irq.h> |
|
53 | 54 | ||
54 | /* |
55 | /* |
55 | * Interrupt and exception dispatching. |
56 | * Interrupt and exception dispatching. |
56 | */ |
57 | */ |
57 | 58 | ||
58 | void (* disable_irqs_function)(uint16_t irqmask) = NULL; |
59 | void (* disable_irqs_function)(uint16_t irqmask) = NULL; |
59 | void (* enable_irqs_function)(uint16_t irqmask) = NULL; |
60 | void (* enable_irqs_function)(uint16_t irqmask) = NULL; |
60 | void (* eoi_function)(void) = NULL; |
61 | void (* eoi_function)(void) = NULL; |
61 | 62 | ||
62 | void PRINT_INFO_ERRCODE(istate_t *istate) |
63 | void decode_istate(istate_t *istate) |
63 | { |
64 | { |
64 | char *symbol = get_symtab_entry(istate->eip); |
65 | char *symbol = get_symtab_entry(istate->eip); |
65 | 66 | ||
66 | if (!symbol) |
67 | if (!symbol) |
67 | symbol = ""; |
68 | symbol = ""; |
Line 80... | Line 81... | ||
80 | #endif |
81 | #endif |
81 | printf("stack: %#x, %#x, %#x, %#x\n", istate->stack[0], istate->stack[1], istate->stack[2], istate->stack[3]); |
82 | printf("stack: %#x, %#x, %#x, %#x\n", istate->stack[0], istate->stack[1], istate->stack[2], istate->stack[3]); |
82 | printf(" %#x, %#x, %#x, %#x\n", istate->stack[4], istate->stack[5], istate->stack[6], istate->stack[7]); |
83 | printf(" %#x, %#x, %#x, %#x\n", istate->stack[4], istate->stack[5], istate->stack[6], istate->stack[7]); |
83 | } |
84 | } |
84 | 85 | ||
- | 86 | static void trap_virtual_eoi(void) |
|
- | 87 | { |
|
- | 88 | if (eoi_function) |
|
- | 89 | eoi_function(); |
|
- | 90 | else |
|
- | 91 | panic("no eoi_function\n"); |
|
- | 92 | ||
- | 93 | } |
|
- | 94 | ||
85 | void null_interrupt(int n, istate_t *istate) |
95 | static void null_interrupt(int n, istate_t *istate) |
86 | { |
96 | { |
87 | fault_if_from_uspace(istate, "unserviced interrupt: %d", n); |
97 | fault_if_from_uspace(istate, "unserviced interrupt: %d", n); |
88 | 98 | ||
89 | PRINT_INFO_ERRCODE(istate); |
99 | decode_istate(istate); |
90 | panic("unserviced interrupt: %d\n", n); |
100 | panic("unserviced interrupt: %d\n", n); |
91 | } |
101 | } |
92 | 102 | ||
93 | /** General Protection Fault. */ |
103 | /** General Protection Fault. */ |
94 | void gp_fault(int n, istate_t *istate) |
104 | static void gp_fault(int n, istate_t *istate) |
95 | { |
105 | { |
96 | if (TASK) { |
106 | if (TASK) { |
97 | count_t ver; |
107 | count_t ver; |
98 | 108 | ||
99 | spinlock_lock(&TASK->lock); |
109 | spinlock_lock(&TASK->lock); |
Line 112... | Line 122... | ||
112 | return; |
122 | return; |
113 | } |
123 | } |
114 | fault_if_from_uspace(istate, "general protection fault"); |
124 | fault_if_from_uspace(istate, "general protection fault"); |
115 | } |
125 | } |
116 | 126 | ||
117 | PRINT_INFO_ERRCODE(istate); |
127 | decode_istate(istate); |
118 | panic("general protection fault\n"); |
128 | panic("general protection fault\n"); |
119 | } |
129 | } |
120 | 130 | ||
121 | void ss_fault(int n, istate_t *istate) |
131 | static void ss_fault(int n, istate_t *istate) |
122 | { |
132 | { |
123 | fault_if_from_uspace(istate, "stack fault"); |
133 | fault_if_from_uspace(istate, "stack fault"); |
124 | 134 | ||
125 | PRINT_INFO_ERRCODE(istate); |
135 | decode_istate(istate); |
126 | panic("stack fault\n"); |
136 | panic("stack fault\n"); |
127 | } |
137 | } |
128 | 138 | ||
129 | void simd_fp_exception(int n, istate_t *istate) |
139 | static void simd_fp_exception(int n, istate_t *istate) |
130 | { |
140 | { |
131 | uint32_t mxcsr; |
141 | uint32_t mxcsr; |
132 | asm |
142 | asm |
133 | ( |
143 | ( |
134 | "stmxcsr %0;\n" |
144 | "stmxcsr %0;\n" |
135 | :"=m"(mxcsr) |
145 | :"=m"(mxcsr) |
136 | ); |
146 | ); |
137 | fault_if_from_uspace(istate, "SIMD FP exception(19), MXCSR: %#zx", |
147 | fault_if_from_uspace(istate, "SIMD FP exception(19), MXCSR: %#zx", |
138 | (unative_t)mxcsr); |
148 | (unative_t)mxcsr); |
139 | 149 | ||
140 | PRINT_INFO_ERRCODE(istate); |
150 | decode_istate(istate); |
141 | printf("MXCSR: %#zx\n",(unative_t)(mxcsr)); |
151 | printf("MXCSR: %#zx\n",(unative_t)(mxcsr)); |
142 | panic("SIMD FP exception(19)\n"); |
152 | panic("SIMD FP exception(19)\n"); |
143 | } |
153 | } |
144 | 154 | ||
145 | void nm_fault(int n, istate_t *istate) |
155 | static void nm_fault(int n, istate_t *istate) |
146 | { |
156 | { |
147 | #ifdef CONFIG_FPU_LAZY |
157 | #ifdef CONFIG_FPU_LAZY |
148 | scheduler_fpu_lazy_request(); |
158 | scheduler_fpu_lazy_request(); |
149 | #else |
159 | #else |
150 | fault_if_from_uspace(istate, "fpu fault"); |
160 | fault_if_from_uspace(istate, "fpu fault"); |
151 | panic("fpu fault"); |
161 | panic("fpu fault"); |
152 | #endif |
162 | #endif |
153 | } |
163 | } |
154 | 164 | ||
- | 165 | #ifdef CONFIG_SMP |
|
155 | void syscall(int n, istate_t *istate) |
166 | static void tlb_shootdown_ipi(int n, istate_t *istate) |
156 | { |
167 | { |
- | 168 | trap_virtual_eoi(); |
|
157 | panic("Obsolete syscall handler."); |
169 | tlb_shootdown_ipi_recv(); |
158 | } |
170 | } |
- | 171 | #endif |
|
159 | 172 | ||
- | 173 | /** Handler of IRQ exceptions */ |
|
160 | void tlb_shootdown_ipi(int n, istate_t *istate) |
174 | static void irq_interrupt(int n, istate_t *istate) |
161 | { |
175 | { |
- | 176 | ASSERT(n >= IVT_IRQBASE); |
|
- | 177 | ||
- | 178 | int inum = n - IVT_IRQBASE; |
|
- | 179 | ASSERT(inum < IRQ_COUNT); |
|
- | 180 | ASSERT((inum != IRQ_PIC_SPUR) && (inum != IRQ_PIC1)); |
|
- | 181 | ||
- | 182 | irq_t *irq = irq_dispatch_and_lock(inum); |
|
- | 183 | if (irq) { |
|
- | 184 | /* |
|
- | 185 | * The IRQ handler was found. |
|
- | 186 | */ |
|
- | 187 | irq->handler(irq, irq->arg); |
|
- | 188 | spinlock_unlock(&irq->lock); |
|
- | 189 | } else { |
|
- | 190 | /* |
|
- | 191 | * Spurious interrupt. |
|
- | 192 | */ |
|
- | 193 | #ifdef CONFIG_DEBUG |
|
- | 194 | printf("cpu%d: spurious interrupt (inum=%d)\n", CPU->id, inum); |
|
- | 195 | #endif |
|
- | 196 | } |
|
162 | trap_virtual_eoi(); |
197 | trap_virtual_eoi(); |
- | 198 | } |
|
- | 199 | ||
163 | tlb_shootdown_ipi_recv(); |
200 | void interrupt_init(void) |
- | 201 | { |
|
- | 202 | int i; |
|
- | 203 | ||
- | 204 | for (i = 0; i < IVT_ITEMS; i++) |
|
- | 205 | exc_register(i, "null", (iroutine) null_interrupt); |
|
- | 206 | ||
- | 207 | for (i = 0; i < IRQ_COUNT; i++) { |
|
- | 208 | if ((i != IRQ_PIC_SPUR) && (i != IRQ_PIC1)) |
|
- | 209 | exc_register(IVT_IRQBASE + i, "irq", (iroutine) irq_interrupt); |
|
- | 210 | } |
|
- | 211 | ||
- | 212 | exc_register(7, "nm_fault", (iroutine) nm_fault); |
|
- | 213 | exc_register(12, "ss_fault", (iroutine) ss_fault); |
|
- | 214 | exc_register(13, "gp_fault", (iroutine) gp_fault); |
|
- | 215 | exc_register(19, "simd_fp", (iroutine) simd_fp_exception); |
|
- | 216 | ||
- | 217 | #ifdef CONFIG_SMP |
|
- | 218 | exc_register(VECTOR_TLB_SHOOTDOWN_IPI, "tlb_shootdown", (iroutine) tlb_shootdown_ipi); |
|
- | 219 | #endif |
|
164 | } |
220 | } |
165 | 221 | ||
166 | void trap_virtual_enable_irqs(uint16_t irqmask) |
222 | void trap_virtual_enable_irqs(uint16_t irqmask) |
167 | { |
223 | { |
168 | if (enable_irqs_function) |
224 | if (enable_irqs_function) |
Line 177... | Line 233... | ||
177 | disable_irqs_function(irqmask); |
233 | disable_irqs_function(irqmask); |
178 | else |
234 | else |
179 | panic("no disable_irqs_function\n"); |
235 | panic("no disable_irqs_function\n"); |
180 | } |
236 | } |
181 | 237 | ||
182 | void trap_virtual_eoi(void) |
- | |
183 | { |
- | |
184 | if (eoi_function) |
- | |
185 | eoi_function(); |
- | |
186 | else |
- | |
187 | panic("no eoi_function\n"); |
- | |
188 | - | ||
189 | } |
- | |
190 | - | ||
191 | /** @} |
238 | /** @} |
192 | */ |
239 | */ |