[db3341e] | 1 | /*
|
---|
| 2 | * Copyright (C) 2001-2004 Jakub Jermar
|
---|
| 3 | * All rights reserved.
|
---|
| 4 | *
|
---|
| 5 | * Redistribution and use in source and binary forms, with or without
|
---|
| 6 | * modification, are permitted provided that the following conditions
|
---|
| 7 | * are met:
|
---|
| 8 | *
|
---|
| 9 | * - Redistributions of source code must retain the above copyright
|
---|
| 10 | * notice, this list of conditions and the following disclaimer.
|
---|
| 11 | * - Redistributions in binary form must reproduce the above copyright
|
---|
| 12 | * notice, this list of conditions and the following disclaimer in the
|
---|
| 13 | * documentation and/or other materials provided with the distribution.
|
---|
| 14 | * - The name of the author may not be used to endorse or promote products
|
---|
| 15 | * derived from this software without specific prior written permission.
|
---|
| 16 | *
|
---|
| 17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
---|
| 18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
---|
| 19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
---|
| 20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
---|
| 21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
---|
| 22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
---|
| 23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
---|
| 24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
---|
| 25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
---|
| 26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
---|
| 27 | */
|
---|
| 28 |
|
---|
| 29 | #include <arch/interrupt.h>
|
---|
| 30 | #include <print.h>
|
---|
| 31 | #include <debug.h>
|
---|
| 32 | #include <panic.h>
|
---|
| 33 | #include <arch/i8259.h>
|
---|
| 34 | #include <func.h>
|
---|
| 35 | #include <cpu.h>
|
---|
| 36 | #include <arch/asm.h>
|
---|
| 37 | #include <mm/tlb.h>
|
---|
[20d50a1] | 38 | #include <mm/as.h>
|
---|
[db3341e] | 39 | #include <arch.h>
|
---|
[ab08b42] | 40 | #include <symtab.h>
|
---|
[3396f59] | 41 | #include <arch/asm.h>
|
---|
[b49f4ae] | 42 | #include <proc/scheduler.h>
|
---|
[1084a784] | 43 | #include <proc/thread.h>
|
---|
[8ec9bae] | 44 |
|
---|
[fb10289b] | 45 | /*
|
---|
[ff4c4f5] | 46 | static void messy_stack_trace(__native *stack)
|
---|
| 47 | {
|
---|
[2c55af3] | 48 | __native *upper_limit = (__native *)(((__native)get_stack_base()) + STACK_SIZE);
|
---|
[ff4c4f5] | 49 | char *symbol;
|
---|
| 50 |
|
---|
| 51 | printf("Stack contents: ");
|
---|
| 52 | while (stack < upper_limit) {
|
---|
| 53 | symbol = get_symtab_entry((__address)*stack);
|
---|
| 54 | if (symbol)
|
---|
| 55 | printf("%s, ", symbol);
|
---|
| 56 | stack++;
|
---|
| 57 | }
|
---|
| 58 | printf("\n");
|
---|
| 59 | }
|
---|
[fb10289b] | 60 | */
|
---|
[fcfac420] | 61 | static void print_info_errcode(int n, void *st)
|
---|
[8ec9bae] | 62 | {
|
---|
| 63 | char *symbol;
|
---|
[fcfac420] | 64 | __native *x = (__native *) st;
|
---|
[8ec9bae] | 65 |
|
---|
| 66 | if (!(symbol=get_symtab_entry(x[1])))
|
---|
| 67 | symbol = "";
|
---|
| 68 |
|
---|
| 69 | printf("-----EXCEPTION(%d) OCCURED----- ( %s )\n",n,__FUNCTION__);
|
---|
| 70 | printf("%%rip: %Q (%s)\n",x[1],symbol);
|
---|
| 71 | printf("ERROR_WORD=%Q\n", x[0]);
|
---|
| 72 | printf("%%rcs=%Q,flags=%Q, %%cr0=%Q\n", x[2], x[3],read_cr0());
|
---|
| 73 | printf("%%rax=%Q, %%rbx=%Q, %%rcx=%Q\n",x[-2],x[-3],x[-4]);
|
---|
| 74 | printf("%%rdx=%Q, %%rsi=%Q, %%rdi=%Q\n",x[-5],x[-6],x[-7]);
|
---|
| 75 | printf("%%r8 =%Q, %%r9 =%Q, %%r10=%Q\n",x[-8],x[-9],x[-10]);
|
---|
| 76 | printf("%%r11=%Q, %%r12=%Q, %%r13=%Q\n",x[-11],x[-12],x[-13]);
|
---|
| 77 | printf("%%r14=%Q, %%r15=%Q, %%rsp=%Q\n",x[-14],x[-15],x);
|
---|
| 78 | printf("%%rbp=%Q\n",x[-1]);
|
---|
| 79 | printf("stack: %Q, %Q, %Q\n", x[5], x[6], x[7]);
|
---|
| 80 | printf(" %Q, %Q, %Q\n", x[8], x[9], x[10]);
|
---|
| 81 | printf(" %Q, %Q, %Q\n", x[11], x[12], x[13]);
|
---|
| 82 | printf(" %Q, %Q, %Q\n", x[14], x[15], x[16]);
|
---|
| 83 | printf(" %Q, %Q, %Q\n", x[17], x[18], x[19]);
|
---|
| 84 | printf(" %Q, %Q, %Q\n", x[20], x[21], x[22]);
|
---|
| 85 | printf(" %Q, %Q, %Q\n", x[23], x[24], x[25]);
|
---|
[fb10289b] | 86 | // messy_stack_trace(&x[5]);
|
---|
[8ec9bae] | 87 | }
|
---|
[db3341e] | 88 |
|
---|
| 89 | /*
|
---|
| 90 | * Interrupt and exception dispatching.
|
---|
| 91 | */
|
---|
| 92 |
|
---|
| 93 | void (* disable_irqs_function)(__u16 irqmask) = NULL;
|
---|
| 94 | void (* enable_irqs_function)(__u16 irqmask) = NULL;
|
---|
| 95 | void (* eoi_function)(void) = NULL;
|
---|
| 96 |
|
---|
[fcfac420] | 97 | void null_interrupt(int n, void *st)
|
---|
[db3341e] | 98 | {
|
---|
[fcfac420] | 99 | __native *stack = (__native *) st;
|
---|
[db3341e] | 100 |
|
---|
[3396f59] | 101 | printf("-----EXCEPTION(%d) OCCURED----- ( %s )\n",n,__FUNCTION__); \
|
---|
[db3341e] | 102 | printf("stack: %L, %L, %L, %L\n", stack[0], stack[1], stack[2], stack[3]);
|
---|
| 103 | panic("unserviced interrupt\n");
|
---|
| 104 | }
|
---|
| 105 |
|
---|
[fcfac420] | 106 | void gp_fault(int n, void *stack)
|
---|
[db3341e] | 107 | {
|
---|
[8ec9bae] | 108 | print_info_errcode(n,stack);
|
---|
[db3341e] | 109 | panic("general protection fault\n");
|
---|
| 110 | }
|
---|
| 111 |
|
---|
[fcfac420] | 112 | void ss_fault(int n, void *stack)
|
---|
[db3341e] | 113 | {
|
---|
[8ec9bae] | 114 | print_info_errcode(n,stack);
|
---|
[db3341e] | 115 | panic("stack fault\n");
|
---|
| 116 | }
|
---|
| 117 |
|
---|
| 118 |
|
---|
[fcfac420] | 119 | void nm_fault(int n, void *stack)
|
---|
[db3341e] | 120 | {
|
---|
[5f85c91] | 121 | #ifdef CONFIG_FPU_LAZY
|
---|
[b49f4ae] | 122 | scheduler_fpu_lazy_request();
|
---|
| 123 | #else
|
---|
| 124 | panic("fpu fault");
|
---|
| 125 | #endif
|
---|
[db3341e] | 126 | }
|
---|
| 127 |
|
---|
[fcfac420] | 128 | void page_fault(int n, void *stack)
|
---|
[db3341e] | 129 | {
|
---|
[20d50a1] | 130 | __address page;
|
---|
| 131 |
|
---|
| 132 | page = read_cr2();
|
---|
| 133 | if (!as_page_fault(page)) {
|
---|
| 134 | print_info_errcode(n,stack);
|
---|
| 135 | printf("Page fault address: %Q\n", page);
|
---|
| 136 | panic("page fault\n");
|
---|
| 137 | }
|
---|
[db3341e] | 138 | }
|
---|
| 139 |
|
---|
[fcfac420] | 140 | void syscall(int n, void *stack)
|
---|
[db3341e] | 141 | {
|
---|
| 142 | printf("cpu%d: syscall\n", CPU->id);
|
---|
| 143 | thread_usleep(1000);
|
---|
| 144 | }
|
---|
| 145 |
|
---|
[fcfac420] | 146 | void tlb_shootdown_ipi(int n, void *stack)
|
---|
[db3341e] | 147 | {
|
---|
| 148 | trap_virtual_eoi();
|
---|
| 149 | tlb_shootdown_ipi_recv();
|
---|
| 150 | }
|
---|
| 151 |
|
---|
[fcfac420] | 152 | void wakeup_ipi(int n, void *stack)
|
---|
[db3341e] | 153 | {
|
---|
| 154 | trap_virtual_eoi();
|
---|
| 155 | }
|
---|
| 156 |
|
---|
| 157 | void trap_virtual_enable_irqs(__u16 irqmask)
|
---|
| 158 | {
|
---|
| 159 | if (enable_irqs_function)
|
---|
| 160 | enable_irqs_function(irqmask);
|
---|
| 161 | else
|
---|
| 162 | panic("no enable_irqs_function\n");
|
---|
| 163 | }
|
---|
| 164 |
|
---|
| 165 | void trap_virtual_disable_irqs(__u16 irqmask)
|
---|
| 166 | {
|
---|
| 167 | if (disable_irqs_function)
|
---|
| 168 | disable_irqs_function(irqmask);
|
---|
| 169 | else
|
---|
| 170 | panic("no disable_irqs_function\n");
|
---|
| 171 | }
|
---|
| 172 |
|
---|
| 173 | void trap_virtual_eoi(void)
|
---|
| 174 | {
|
---|
| 175 | if (eoi_function)
|
---|
| 176 | eoi_function();
|
---|
| 177 | else
|
---|
| 178 | panic("no eoi_function\n");
|
---|
| 179 |
|
---|
| 180 | }
|
---|