Subversion Repositories HelenOS

Rev

Rev 1939 | Rev 2071 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

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