Subversion Repositories HelenOS

Rev

Rev 75 | Rev 90 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1 jermar 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>
68 decky 31
#include <debug.h>
1 jermar 32
#include <panic.h>
33
#include <arch/i8259.h>
34
#include <func.h>
35
#include <cpu.h>
36
#include <arch/asm.h>
5 jermar 37
#include <mm/tlb.h>
22 jermar 38
#include <arch.h>
1 jermar 39
 
40
/*
41
 * Interrupt and exception dispatching.
42
 */
43
 
44
static iroutine ivt[IVT_ITEMS];
45
 
46
void (* disable_irqs_function)(__u16 irqmask) = NULL;
47
void (* enable_irqs_function)(__u16 irqmask) = NULL;
48
void (* eoi_function)(void) = NULL;
49
 
50
iroutine trap_register(__u8 n, iroutine f)
51
{
68 decky 52
    ASSERT(n < IVT_ITEMS);
53
 
1 jermar 54
    iroutine old;
68 decky 55
 
1 jermar 56
    old = ivt[n];
57
    ivt[n] = f;
68 decky 58
 
59
    return old;
1 jermar 60
}
61
 
62
/*
63
 * Called directly from the assembler code.
64
 * CPU is cpu_priority_high().
65
 */
66
void trap_dispatcher(__u8 n, __u32 stack[])
67
{
68 decky 68
    ASSERT(n < IVT_ITEMS);
69
 
70
    ivt[n](n, stack);
1 jermar 71
}
72
 
73
void null_interrupt(__u8 n, __u32 stack[])
74
{
75
    printf("int %d: null_interrupt\n", n);
76
    printf("stack: %L, %L, %L, %L\n", stack[0], stack[1], stack[2], stack[3]);
77
    panic("unserviced interrupt\n");
78
}
79
 
80
void gp_fault(__u8 n, __u32 stack[])
81
{
82
    printf("stack[0]=%X, %%eip=%X, %%cs=%X, flags=%X\n", stack[0], stack[1], stack[2], stack[3]);
83
    printf("%%eax=%L, %%ebx=%L, %%ecx=%L, %%edx=%L,\n%%edi=%L, %%esi=%L, %%ebp=%L, %%esp=%L\n", stack[-2], stack[-5], stack[-3], stack[-4], stack[-9], stack[-8], stack[-1], stack);
84
    printf("stack: %X, %X, %X, %X\n", stack[4], stack[5], stack[6], stack[7]);
85
    panic("general protection fault\n");
86
}
87
 
84 vana 88
void ss_fault(__u8 n, __u32 stack[])
89
{
90
    printf("stack[0]=%X, %%eip=%X, %%cs=%X, flags=%X\n", stack[0], stack[1], stack[2], stack[3]);
91
    printf("%%eax=%L, %%ebx=%L, %%ecx=%L, %%edx=%L,\n%%edi=%L, %%esi=%L, %%ebp=%L, %%esp=%L\n", stack[-2], stack[-5], stack[-3], stack[-4], stack[-9], stack[-8], stack[-1], stack);
92
    printf("stack: %X, %X, %X, %X\n", stack[4], stack[5], stack[6], stack[7]);
93
    panic("Stack fault\n");
94
}
95
 
96
 
73 vana 97
void nm_fault(__u8 n, __u32 stack[])
98
{
99
 
84 vana 100
//  printf("-1\n");        
101
    reset_TS_flag();
75 vana 102
        if ((CPU->fpu_owner)!=NULL)
73 vana 103
    {  
84 vana 104
//          printf("owner %X\n",(int)(&((CPU->fpu_owner)->saved_fpu_context)));        
105
            fpu_lazy_context_save(&((CPU->fpu_owner)->saved_fpu_context));
106
 
107
//          printf("owner 2\n");
75 vana 108
        (CPU->fpu_owner)->fpu_context_engaged=0; /* Enables migration */
84 vana 109
//          printf("owner 3\n");        
110
 
73 vana 111
    }
84 vana 112
//  printf("0\n");
73 vana 113
    if(THREAD->fpu_context_exists) fpu_lazy_context_restore(&(THREAD->saved_fpu_context));
114
        else {fpu_init();THREAD->fpu_context_exists=1;}
84 vana 115
//  printf("1\n");
75 vana 116
    CPU->fpu_owner=THREAD;
84 vana 117
//  printf("2\n");
73 vana 118
 
84 vana 119
//  printf("3\n");  
73 vana 120
//  panic("#NM fault\n");
121
}
122
 
123
 
124
 
1 jermar 125
void page_fault(__u8 n, __u32 stack[])
126
{
127
    printf("page fault address: %X\n", cpu_read_cr2());
128
    printf("stack[0]=%X, %%eip=%X, %%cs=%X, flags=%X\n", stack[0], stack[1], stack[2], stack[3]);
129
    printf("%%eax=%L, %%ebx=%L, %%ecx=%L, %%edx=%L,\n%%edi=%L, %%esi=%L, %%ebp=%L, %%esp=%L\n", stack[-2], stack[-5], stack[-3], stack[-4], stack[-9], stack[-8], stack[-1], stack);
130
    printf("stack: %X, %X, %X, %X\n", stack[4], stack[5], stack[6], stack[7]);
33 jermar 131
    printf("page fault\n");
132
    cpu_halt();
1 jermar 133
}
134
 
135
void syscall(__u8 n, __u32 stack[])
136
{
22 jermar 137
    printf("cpu%d: syscall\n", CPU->id);
31 jermar 138
    thread_usleep(1000);
1 jermar 139
}
140
 
6 jermar 141
void tlb_shootdown_ipi(__u8 n, __u32 stack[])
5 jermar 142
{
143
    trap_virtual_eoi();
6 jermar 144
    tlb_shootdown_ipi_recv();
5 jermar 145
}
146
 
7 jermar 147
void wakeup_ipi(__u8 n, __u32 stack[])
148
{
149
    trap_virtual_eoi();
150
}
151
 
1 jermar 152
void trap_virtual_enable_irqs(__u16 irqmask)
153
{
154
    if (enable_irqs_function)
155
        enable_irqs_function(irqmask);
156
    else
68 decky 157
        panic("no enable_irqs_function\n");
1 jermar 158
}
159
 
160
void trap_virtual_disable_irqs(__u16 irqmask)
161
{
162
    if (disable_irqs_function)
163
        disable_irqs_function(irqmask);
164
    else
68 decky 165
        panic("no disable_irqs_function\n");
1 jermar 166
}
167
 
168
void trap_virtual_eoi(void)
169
{
170
    if (eoi_function)
171
        eoi_function();
172
    else
68 decky 173
        panic("no eoi_function\n");
1 jermar 174
 
175
}