Subversion Repositories HelenOS

Rev

Rev 1952 | Go to most recent revision | Show entire file | Ignore 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 
 */