Subversion Repositories HelenOS-historic

Rev

Rev 1196 | Rev 1702 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1196 Rev 1221
1
/*
1
/*
2
 * Copyright (C) 2003-2004 Jakub Jermar
2
 * Copyright (C) 2003-2004 Jakub Jermar
3
 * All rights reserved.
3
 * All rights reserved.
4
 *
4
 *
5
 * Redistribution and use in source and binary forms, with or without
5
 * Redistribution and use in source and binary forms, with or without
6
 * modification, are permitted provided that the following conditions
6
 * modification, are permitted provided that the following conditions
7
 * are met:
7
 * are met:
8
 *
8
 *
9
 * - Redistributions of source code must retain the above copyright
9
 * - Redistributions of source code must retain the above copyright
10
 *   notice, this list of conditions and the following disclaimer.
10
 *   notice, this list of conditions and the following disclaimer.
11
 * - Redistributions in binary form must reproduce the above copyright
11
 * - Redistributions in binary form must reproduce the above copyright
12
 *   notice, this list of conditions and the following disclaimer in the
12
 *   notice, this list of conditions and the following disclaimer in the
13
 *   documentation and/or other materials provided with the distribution.
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
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.
15
 *   derived from this software without specific prior written permission.
16
 *
16
 *
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
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
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
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
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
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
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.
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27
 */
27
 */
28
 
28
 
29
#include <arch/exception.h>
29
#include <arch/exception.h>
30
#include <arch/interrupt.h>
30
#include <arch/interrupt.h>
31
#include <panic.h>
31
#include <panic.h>
32
#include <arch/cp0.h>
32
#include <arch/cp0.h>
33
#include <arch/types.h>
33
#include <arch/types.h>
34
#include <arch.h>
34
#include <arch.h>
35
#include <debug.h>
35
#include <debug.h>
36
#include <proc/thread.h>
36
#include <proc/thread.h>
37
#include <symtab.h>
37
#include <symtab.h>
38
#include <print.h>
38
#include <print.h>
39
#include <interrupt.h>
39
#include <interrupt.h>
40
#include <func.h>
40
#include <func.h>
41
#include <console/kconsole.h>
41
#include <console/kconsole.h>
42
#include <arch/debugger.h>
42
#include <arch/debugger.h>
43
 
43
 
44
static char * exctable[] = {
44
static char * exctable[] = {
45
    "Interrupt","TLB Modified","TLB Invalid","TLB Invalid Store",
45
    "Interrupt","TLB Modified","TLB Invalid","TLB Invalid Store",
46
        "Address Error - load/instr. fetch",
46
        "Address Error - load/instr. fetch",
47
        "Address Error - store",
47
        "Address Error - store",
48
        "Bus Error - fetch instruction",
48
        "Bus Error - fetch instruction",
49
        "Bus Error - data reference",
49
        "Bus Error - data reference",
50
        "Syscall",
50
        "Syscall",
51
        "BreakPoint",
51
        "BreakPoint",
52
        "Reserved Instruction",
52
        "Reserved Instruction",
53
        "Coprocessor Unusable",
53
        "Coprocessor Unusable",
54
        "Arithmetic Overflow",
54
        "Arithmetic Overflow",
55
        "Trap",
55
        "Trap",
56
        "Virtual Coherency - instruction",
56
        "Virtual Coherency - instruction",
57
        "Floating Point",
57
        "Floating Point",
58
        NULL, NULL, NULL, NULL, NULL, NULL, NULL,
58
        NULL, NULL, NULL, NULL, NULL, NULL, NULL,
59
        "WatchHi/WatchLo", /* 23 */
59
        "WatchHi/WatchLo", /* 23 */
60
        NULL, NULL, NULL, NULL, NULL, NULL, NULL,
60
        NULL, NULL, NULL, NULL, NULL, NULL, NULL,
61
        "Virtual Coherency - data",
61
        "Virtual Coherency - data",
62
};
62
};
63
 
63
 
64
static void print_regdump(istate_t *istate)
64
static void print_regdump(istate_t *istate)
65
{
65
{
66
    char *pcsymbol = "";
66
    char *pcsymbol = "";
67
    char *rasymbol = "";
67
    char *rasymbol = "";
68
 
68
 
69
    char *s = get_symtab_entry(istate->epc);
69
    char *s = get_symtab_entry(istate->epc);
70
    if (s)
70
    if (s)
71
        pcsymbol = s;
71
        pcsymbol = s;
72
    s = get_symtab_entry(istate->ra);
72
    s = get_symtab_entry(istate->ra);
73
    if (s)
73
    if (s)
74
        rasymbol = s;
74
        rasymbol = s;
75
   
75
   
76
    printf("PC: %#X(%s) RA: %#X(%s), SP(%P)\n",istate->epc,pcsymbol,
76
    printf("PC: %#x(%s) RA: %#x(%s), SP(%p)\n", istate->epc, pcsymbol, istate->ra, rasymbol, istate->sp);
77
           istate->ra,rasymbol, istate->sp);
-
 
78
}
77
}
79
 
78
 
80
static void unhandled_exception(int n, istate_t *istate)
79
static void unhandled_exception(int n, istate_t *istate)
81
{
80
{
82
    print_regdump(istate);
81
    print_regdump(istate);
83
    panic("unhandled exception %s\n", exctable[n]);
82
    panic("unhandled exception %s\n", exctable[n]);
84
}
83
}
85
 
84
 
86
static void reserved_instr_exception(int n, istate_t *istate)
85
static void reserved_instr_exception(int n, istate_t *istate)
87
{
86
{
88
    if (*((__u32 *)istate->epc) == 0x7c03e83b) {
87
    if (*((__u32 *)istate->epc) == 0x7c03e83b) {
89
        ASSERT(THREAD);
88
        ASSERT(THREAD);
90
        istate->epc += 4;
89
        istate->epc += 4;
91
        istate->v1 = istate->k1;
90
        istate->v1 = istate->k1;
92
    } else
91
    } else
93
        unhandled_exception(n, istate);
92
        unhandled_exception(n, istate);
94
}
93
}
95
 
94
 
96
static void breakpoint_exception(int n, istate_t *istate)
95
static void breakpoint_exception(int n, istate_t *istate)
97
{
96
{
98
#ifdef CONFIG_DEBUG
97
#ifdef CONFIG_DEBUG
99
    debugger_bpoint(istate);
98
    debugger_bpoint(istate);
100
#else
99
#else
101
    /* it is necessary to not re-execute BREAK instruction after
100
    /* it is necessary to not re-execute BREAK instruction after
102
       returning from Exception handler
101
       returning from Exception handler
103
       (see page 138 in R4000 Manual for more information) */
102
       (see page 138 in R4000 Manual for more information) */
104
    istate->epc += 4;
103
    istate->epc += 4;
105
#endif
104
#endif
106
}
105
}
107
 
106
 
108
static void tlbmod_exception(int n, istate_t *istate)
107
static void tlbmod_exception(int n, istate_t *istate)
109
{
108
{
110
    tlb_modified(istate);
109
    tlb_modified(istate);
111
}
110
}
112
 
111
 
113
static void tlbinv_exception(int n, istate_t *istate)
112
static void tlbinv_exception(int n, istate_t *istate)
114
{
113
{
115
    tlb_invalid(istate);
114
    tlb_invalid(istate);
116
}
115
}
117
 
116
 
118
#ifdef CONFIG_FPU_LAZY
117
#ifdef CONFIG_FPU_LAZY
119
static void cpuns_exception(int n, istate_t *istate)
118
static void cpuns_exception(int n, istate_t *istate)
120
{
119
{
121
    if (cp0_cause_coperr(cp0_cause_read()) == fpu_cop_id)
120
    if (cp0_cause_coperr(cp0_cause_read()) == fpu_cop_id)
122
        scheduler_fpu_lazy_request();
121
        scheduler_fpu_lazy_request();
123
    else
122
    else
124
        panic("unhandled Coprocessor Unusable Exception\n");
123
        panic("unhandled Coprocessor Unusable Exception\n");
125
}
124
}
126
#endif
125
#endif
127
 
126
 
128
static void interrupt_exception(int n, istate_t *istate)
127
static void interrupt_exception(int n, istate_t *istate)
129
{
128
{
130
    __u32 cause;
129
    __u32 cause;
131
    int i;
130
    int i;
132
   
131
   
133
    /* decode interrupt number and process the interrupt */
132
    /* decode interrupt number and process the interrupt */
134
    cause = (cp0_cause_read() >> 8) &0xff;
133
    cause = (cp0_cause_read() >> 8) &0xff;
135
   
134
   
136
    for (i = 0; i < 8; i++)
135
    for (i = 0; i < 8; i++)
137
        if (cause & (1 << i))
136
        if (cause & (1 << i))
138
            exc_dispatch(i+INT_OFFSET, istate);
137
            exc_dispatch(i+INT_OFFSET, istate);
139
}
138
}
140
 
139
 
141
/** Handle syscall userspace call */
140
/** Handle syscall userspace call */
142
static void syscall_exception(int n, istate_t *istate)
141
static void syscall_exception(int n, istate_t *istate)
143
{
142
{
144
    panic("Syscall is handled through shortcut");
143
    panic("Syscall is handled through shortcut");
145
}
144
}
146
 
145
 
147
void exception_init(void)
146
void exception_init(void)
148
{
147
{
149
    int i;
148
    int i;
150
 
149
 
151
    /* Clear exception table */
150
    /* Clear exception table */
152
    for (i=0;i < IVT_ITEMS; i++)
151
    for (i=0;i < IVT_ITEMS; i++)
153
        exc_register(i, "undef", (iroutine) unhandled_exception);
152
        exc_register(i, "undef", (iroutine) unhandled_exception);
154
    exc_register(EXC_Bp, "bkpoint", (iroutine) breakpoint_exception);
153
    exc_register(EXC_Bp, "bkpoint", (iroutine) breakpoint_exception);
155
    exc_register(EXC_RI, "resinstr", (iroutine) reserved_instr_exception);
154
    exc_register(EXC_RI, "resinstr", (iroutine) reserved_instr_exception);
156
    exc_register(EXC_Mod, "tlb_mod", (iroutine) tlbmod_exception);
155
    exc_register(EXC_Mod, "tlb_mod", (iroutine) tlbmod_exception);
157
    exc_register(EXC_TLBL, "tlbinvl", (iroutine) tlbinv_exception);
156
    exc_register(EXC_TLBL, "tlbinvl", (iroutine) tlbinv_exception);
158
    exc_register(EXC_TLBS, "tlbinvl", (iroutine) tlbinv_exception);
157
    exc_register(EXC_TLBS, "tlbinvl", (iroutine) tlbinv_exception);
159
    exc_register(EXC_Int, "interrupt", (iroutine) interrupt_exception);
158
    exc_register(EXC_Int, "interrupt", (iroutine) interrupt_exception);
160
#ifdef CONFIG_FPU_LAZY
159
#ifdef CONFIG_FPU_LAZY
161
    exc_register(EXC_CpU, "cpunus", (iroutine) cpuns_exception);
160
    exc_register(EXC_CpU, "cpunus", (iroutine) cpuns_exception);
162
#endif
161
#endif
163
    exc_register(EXC_Sys, "syscall", (iroutine) syscall_exception);
162
    exc_register(EXC_Sys, "syscall", (iroutine) syscall_exception);
164
}
163
}
165
 
164