Subversion Repositories HelenOS-historic

Rev

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

Rev 575 Rev 590
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 <interrupt.h>
 29 
#include <interrupt.h>
30 
#include <arch/interrupt.h>
 30 
#include <arch/interrupt.h>
31 
#include <arch/types.h>
 31 
#include <arch/types.h>
32 
#include <arch.h>
 32 
#include <arch.h>
33 
#include <arch/cp0.h>
 33 
#include <arch/cp0.h>
34 
#include <time/clock.h>
 34 
#include <time/clock.h>
35 
#include <panic.h>
 - 
 
36 
#include <print.h>
 - 
 
37 
#include <symtab.h>
 - 
 
38 
#include <arch/drivers/arc.h>
 35 
#include <arch/drivers/arc.h>
39 
 
 36 
 
40 
static void print_regdump(struct exception_regdump *pstate)
 - 
 
41 
{
 - 
 
42 
    char *pcsymbol = "";
 - 
 
43 
    char *rasymbol = "";
 - 
 
44 
 
 - 
 
45 
    char *s = get_symtab_entry(pstate->epc);
 - 
 
46 
    if (s)
 - 
 
47 
        pcsymbol = s;
 - 
 
48 
    s = get_symtab_entry(pstate->ra);
 - 
 
49 
    if (s)
 - 
 
50 
        rasymbol = s;
 - 
 
51 
   
 - 
 
52 
    printf("PC: %X(%s) RA: %X(%s)\n",pstate->epc,pcsymbol,
 - 
 
53 
           pstate->ra,rasymbol);
 - 
 
54 
}
 - 
 
55 
 
 - 
 
56 
/** Disable interrupts.
 37 
/** Disable interrupts.
57 
 *
 38 
 *
58 
 * @return Old interrupt priority level.
 39 
 * @return Old interrupt priority level.
59 
 */
 40 
 */
60 
ipl_t interrupts_disable(void)
 41 
ipl_t interrupts_disable(void)
61 
{
 42 
{
62 
    ipl_t ipl = (ipl_t) cp0_status_read();
 43 
    ipl_t ipl = (ipl_t) cp0_status_read();
63 
    cp0_status_write(ipl & ~cp0_status_ie_enabled_bit);
 44 
    cp0_status_write(ipl & ~cp0_status_ie_enabled_bit);
64 
    return ipl;
 45 
    return ipl;
65 
}
 46 
}
66 
 
 47 
 
67 
/** Enable interrupts.
 48 
/** Enable interrupts.
68 
 *
 49 
 *
69 
 * @return Old interrupt priority level.
 50 
 * @return Old interrupt priority level.
70 
 */
 51 
 */
71 
ipl_t interrupts_enable(void)
 52 
ipl_t interrupts_enable(void)
72 
{
 53 
{
73 
    ipl_t ipl = (ipl_t) cp0_status_read();
 54 
    ipl_t ipl = (ipl_t) cp0_status_read();
74 
    cp0_status_write(ipl | cp0_status_ie_enabled_bit);
 55 
    cp0_status_write(ipl | cp0_status_ie_enabled_bit);
75 
    return ipl;
 56 
    return ipl;
76 
}
 57 
}
77 
 
 58 
 
78 
/** Restore interrupt priority level.
 59 
/** Restore interrupt priority level.
79 
 *
 60 
 *
80 
 * @param ipl Saved interrupt priority level.
 61 
 * @param ipl Saved interrupt priority level.
81 
 */
 62 
 */
82 
void interrupts_restore(ipl_t ipl)
 63 
void interrupts_restore(ipl_t ipl)
83 
{
 64 
{
84 
    cp0_status_write(cp0_status_read() | (ipl & cp0_status_ie_enabled_bit));
 65 
    cp0_status_write(cp0_status_read() | (ipl & cp0_status_ie_enabled_bit));
85 
}
 66 
}
86 
 
 67 
 
87 
/** Read interrupt priority level.
 68 
/** Read interrupt priority level.
88 
 *
 69 
 *
89 
 * @return Current interrupt priority level.
 70 
 * @return Current interrupt priority level.
90 
 */
 71 
 */
91 
ipl_t interrupts_read(void)
 72 
ipl_t interrupts_read(void)
92 
{
 73 
{
93 
    return cp0_status_read();
 74 
    return cp0_status_read();
94 
}
 75 
}
95 
 
 76 
 
96 
static void unhandled_exception(int n, void *stack)
 - 
 
97 
{
 - 
 
98 
    struct exception_regdump *pstate = (struct exception_regdump *)stack;
 - 
 
99 
 
 - 
 
100 
    print_regdump(pstate);
 - 
 
101 
    panic("unhandled interrupt %d\n", n);
 - 
 
102 
}
 - 
 
103 
 
 - 
 
104 
static void timer_exception(int n, void *stack)
 77 
static void timer_exception(int n, void *stack)
105 
{
 78 
{
106 
    cp0_compare_write(cp0_count_read() + cp0_compare_value);
 79 
    cp0_compare_write(cp0_count_read() + cp0_compare_value);
107 
    clock();
 80 
    clock();
108 
}
 81 
}
109 
 
 82 
 
110 
static void swint0(int n, void *stack)
 83 
static void swint0(int n, void *stack)
111 
{
 84 
{
112 
    cp0_cause_write(cp0_cause_read() & ~(1 << 8)); /* clear SW0 interrupt */
 85 
    cp0_cause_write(cp0_cause_read() & ~(1 << 8)); /* clear SW0 interrupt */
113 
}
 86 
}
114 
 
 87 
 
115 
static void swint1(int n, void *stack)
 88 
static void swint1(int n, void *stack)
116 
{
 89 
{
117 
    cp0_cause_write(cp0_cause_read() & ~(1 << 9)); /* clear SW1 interrupt */
 90 
    cp0_cause_write(cp0_cause_read() & ~(1 << 9)); /* clear SW1 interrupt */
118 
}
 91 
}
119 
 
 92 
 
120 
/** Basic exception handler */
 - 
 
121 
void interrupt(struct exception_regdump *pstate)
 - 
 
122 
{
 - 
 
123 
    __u32 cause;
 - 
 
124 
    int i;
 - 
 
125 
   
 - 
 
126 
    /* decode interrupt number and process the interrupt */
 - 
 
127 
    cause = (cp0_cause_read() >> 8) &0xff;
 - 
 
128 
   
 - 
 
129 
    for (i = 0; i < 8; i++)
 - 
 
130 
        if (cause & (1 << i))
 - 
 
131 
            exc_dispatch(i, (void *)pstate);
 - 
 
132 
}
 - 
 
133 
 
 - 
 
134 
/* Initialize basic tables for exception dispatching */
 93 
/* Initialize basic tables for exception dispatching */
135 
void interrupt_init(void)
 94 
void interrupt_init(void)
136 
{
 95 
{
137 
    int i;
 96 
    int i;
138 
 
 97 
 
139 
    for (i=0;i < IVT_ITEMS; i++)
 - 
 
140 
        exc_register(i, "undef", unhandled_exception);
 - 
 
141 
 
 - 
 
142 
    exc_register(TIMER_IRQ, "timer", timer_exception);
 98 
    int_register(TIMER_IRQ, "timer", timer_exception);
143 
    exc_register(0, "swint0", swint0);
 99 
    int_register(0, "swint0", swint0);
144 
    exc_register(1, "swint1", swint1);
 100 
    int_register(1, "swint1", swint1);
145 
}
 101 
}
146 
 
 102