Mercurial > flash_v2

annotate packages/hal/sparclite/arch/current/src/vec_ivsr.S @ 1777:c16341b1bac6 default tip

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
* Added execute permissions to files missed in conversion from CVS
author alexs
date Mon, 12 Oct 2009 02:26:09 +0100
parents d2c90368aeef
children
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
1 /*===========================================================================
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
2 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
3 // vec_ivsr.S
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
4 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
5 // SPARClite vectors: interrupt vector service routine
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
6 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
7 //===========================================================================
208
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
8 //####ECOSGPLCOPYRIGHTBEGIN####
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
9 // -------------------------------------------
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
10 // This file is part of eCos, the Embedded Configurable Operating System.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
11 // Copyright (C) 1998, 1999, 2000, 2001, 2002 Red Hat, Inc.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
12 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
13 // eCos is free software; you can redistribute it and/or modify it under
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
14 // the terms of the GNU General Public License as published by the Free
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
15 // Software Foundation; either version 2 or (at your option) any later version.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
16 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
17 // eCos is distributed in the hope that it will be useful, but WITHOUT ANY
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
18 // WARRANTY; without even the implied warranty of MERCHANTABILITY or
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
19 // FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
20 // for more details.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
21 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
22 // You should have received a copy of the GNU General Public License along
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
23 // with eCos; if not, write to the Free Software Foundation, Inc.,
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
24 // 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
25 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
26 // As a special exception, if other files instantiate templates or use macros
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
27 // or inline functions from this file, or you compile this file and link it
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
28 // with other works to produce a work based on this file, this file does not
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
29 // by itself cause the resulting work to be covered by the GNU General Public
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
30 // License. However the source code for this file must still be made available
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
31 // in accordance with section (3) of the GNU General Public License.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
32 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
33 // This exception does not invalidate any other reasons why a work based on
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
34 // this file might be covered by the GNU General Public License.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
35 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
36 // Alternative licenses for eCos may be arranged by contacting Red Hat, Inc.
210
d2c90368aeef Merge from eCos master repository on 2002-05-23-21:39:14-BST
jlarmour
parents: 208
diff changeset
37 // at http://sources.redhat.com/ecos/ecos-license/
208
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
38 // -------------------------------------------
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
39 //####ECOSGPLCOPYRIGHTEND####
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
40 //===========================================================================
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
41 //#####DESCRIPTIONBEGIN####
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
42 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
43 // Author(s): hmt
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
44 // Contributors: hmt
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
45 // Date: 1999-02-20
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
46 // Purpose: SPARClite vector code
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
47 // Description: see vectors.S; this is the default vector service routine
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
48 // for interrupts.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
49 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
50 //####DESCRIPTIONEND####
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
51 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
52 //=========================================================================*/
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
53
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
54 !----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
55
208
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents: 66
diff changeset
56 // .file "vec_ivsr.S"
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
57
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
58 !----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
59
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
60 #include <pkgconf/system.h>
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
61 #include <pkgconf/hal.h>
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
62
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
63 #ifdef CYGPKG_KERNEL
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
64 # include <pkgconf/kernel.h>
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
65 #else
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
66 # undef CYGIMP_HAL_COMMON_INTERRUPTS_USE_INTERRUPT_STACK
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
67 # undef CYGFUN_HAL_COMMON_KERNEL_SUPPORT
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
68 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
69
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
70 !------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
71
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
72 #include <cyg/hal/vectors.h>
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
73
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
74 #define DELAYS_AFTER_WRPSR_SAME_WINDOW
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
75 #define DELAYS_AFTER_WRWIM
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
76
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
77 ! Macro to mark the stack as we descend, for debugging, because it is likely
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
78 ! that actually running the ISR won~t touch the stack, but the memory needs
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
79 ! to be there. Normally blank.
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
80 //#define MARKSTACKUSED st %sp, [ %sp ]
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
81 #define MARKSTACKUSED
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
82
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
83 !------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
84
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
85 .text
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
86
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
87 !---------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
88 ! default interrupt VSR, which calls the appropriate ISR after scheduler
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
89 ! lock and interrupt masking, then interrupt_end(). interrupt_end() must be
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
90 ! called with interrupts enabled, on the original thread stack (no separate
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
91 ! interrupt stack) or with interrupts masked, on the original stack (when
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
92 ! separate interrupt stack is supported).
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
93
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
94 .global hal_default_interrupt_vsr
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
95 hal_default_interrupt_vsr:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
96 ! here,locals have been set up as follows:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
97 ! %l0 = psr (with this CWP/window-level in it)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
98 ! %l1 = pc
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
99 ! %l2 = npc
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
100 ! %l3 = vector number (1-15 for interrupts)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
101 ! and we are in our own register window, though it is likely that
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
102 ! the next one will need to be saved before we can use it:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
103 ! ie. this one is the invalid register window.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
104
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
105 ! must establish a safe stack before re-enabling interrupts + traps
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
106 and %l0, __WINBITS, %l7 ! CWP extracted
40
a3cc6665b684 Merge from eCos master repository on 1999-10-01-07:47:04-BST
jlarmour
parents: 8
diff changeset
107 ! no inc/dec here, so no need for special measures for not-8-windows
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
108 mov 1, %l6
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
109 sll %l6, %l7, %l6 ! 1 << CWP
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
110 rd %wim, %l5
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
111 cmp %l5, %l6 ! are they the same?
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
112 bne 1f ! No, so the stack is OK as is.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
113
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
114 ! now do by hand an overflow trap, effectively
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
115 mov %g1, %l7 ! (DELAY SLOT)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
116 srl %l5, 1, %l5
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
117 sll %l6, __WINSIZE-1, %l6
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
118 or %l6, %l5, %g1 ! new WIM in %g1 so we can get it
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
119 ! within the save:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
120 save ! Slip into next window
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
121 mov %g1, %wim ! Install the new wim
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
122 ! (invalidates current window!)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
123 #ifdef DELAYS_AFTER_WRWIM
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
124 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
125 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
126 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
127 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
128
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
129 std %l0, [%sp + 0 * 4] ! save L & I registers
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
130 std %l2, [%sp + 2 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
131 std %l4, [%sp + 4 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
132 std %l6, [%sp + 6 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
133
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
134 std %i0, [%sp + 8 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
135 std %i2, [%sp + 10 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
136 std %i4, [%sp + 12 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
137 std %i6, [%sp + 14 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
138
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
139 restore ! Go back to trap window.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
140 mov %l7, %g1 ! Restore %g1
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
141
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
142 1: ! now save away the regs we must preserve
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
143 sub %fp, 32 * 4, %sp
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
144 #ifdef CYGDBG_HAL_COMMON_INTERRUPTS_SAVE_MINIMUM_CONTEXT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
145 std %g0, [%sp + 16 * 4] ! save G registers
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
146 std %g2, [%sp + 18 * 4] ! (set %g0 place to 0 to flag special context)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
147 std %g4, [%sp + 20 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
148 std %g6, [%sp + 22 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
149 #else // not CYGDBG_HAL_COMMON_INTERRUPTS_SAVE_MINIMUM_CONTEXT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
150 std %l0, [%sp + 0 * 4] ! save L & I registers
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
151 std %l2, [%sp + 2 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
152 std %l4, [%sp + 4 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
153 std %l6, [%sp + 6 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
154
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
155 std %i0, [%sp + 8 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
156 std %i2, [%sp + 10 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
157 std %i4, [%sp + 12 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
158 std %i6, [%sp + 14 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
159
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
160 st %g1, [%sp + 17 * 4] ! save G registers
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
161 std %g2, [%sp + 18 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
162 std %g4, [%sp + 20 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
163 std %g6, [%sp + 22 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
164
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
165 ! no point whatsoever in saving O registers
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
166
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
167 ! and save the CWP in %g0 save place
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
168 st %l0, [%sp + 16 * 4]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
169 #endif // ! CYGDBG_HAL_COMMON_INTERRUPTS_SAVE_MINIMUM_CONTEXT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
170
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
171 sub %sp, 24 * 4, %sp ! fresh frame including
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
172 ! arg spill area for callees
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
173 MARKSTACKUSED ! kilroy was here
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
174
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
175 #ifdef CYGIMP_HAL_COMMON_INTERRUPTS_USE_INTERRUPT_STACK
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
176 ! we will switch to the interrupt stack unless already running on it
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
177
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
178 .extern cyg_interrupt_stack
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
179 .extern cyg_interrupt_stack_base
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
180 set cyg_interrupt_stack, %g1
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
181 set cyg_interrupt_stack_base, %g2
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
182
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
183 cmp %sp, %g2 ! below base?
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
184 blu 1f ! if so, switch.
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
185 cmp %sp, %g1 ! below top? (DELAY SLOT)
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
186 blu 2f ! if so, DON~T switch.
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
187 nop ! (DELAY SLOT)
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
188 1: ! switch to the interrupt stack
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
189 st %sp, [ %g1 ] ! there is spare above stack
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
190 sub %g1, 24 * 4, %sp ! fresh frame including
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
191 ! arg spill area for callees
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
192 MARKSTACKUSED ! kilroy was here
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
193 2:
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
194 ! continue as before, already in the interrupt stack.
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
195 #endif // CYGIMP_HAL_COMMON_INTERRUPTS_USE_INTERRUPT_STACK
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
196
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
197 #ifdef CYGFUN_HAL_COMMON_KERNEL_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
198 ! Lock the scheduler
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
199 .extern SCHED_LOCK_MANGLED_NAME
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
200 sethi %hi(SCHED_LOCK_MANGLED_NAME), %l7
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
201 ld [ %l7 + %lo(SCHED_LOCK_MANGLED_NAME) ], %l6
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
202 add %l6, 1, %l6
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
203 st %l6, [ %l7 + %lo(SCHED_LOCK_MANGLED_NAME) ]
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
204 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
205
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
206 ! HELP_GDB_WITH_BACKTRACE
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
207 mov %i7, %l5 ! preserve it in l5
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
208 mov %l1, %i7 ! bogus return link here
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
209
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
210 ! and we must preserve the Y register (multiply/divide auxiliary)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
211 ! over these calls; we will keep it in %l4 which is otherwise unused.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
212 rd %y, %l4
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
213
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
214 ! Now we can reenable traps and mask off only lower prio interrupts:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
215 andn %l0, 0xf00, %l7 ! clear PIL field
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
216 or %l7, 0x0e0, %l7 ! and ET (+S,PS)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
217 sll %l3, 8, %l6 ! trap number (1-15) into PIL bitfield
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
218 wr %l7, %l6, %psr ! and enable!
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
219 #ifdef DELAYS_AFTER_WRPSR_SAME_WINDOW
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
220 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
221 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
222 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
223 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
224 ! now call the ISR and so on with the appropriate args:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
225 ! ie.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
226 ! isr_retcode = (*(hal_interrupt_handlers[ vector ]))
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
227 ! ( vector, hal_interrupt_data[ vector ] );
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
228
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
229 ! from hal_arch.h
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
230 !// ISR tables
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
231 !CYG_ADDRESS hal_interrupt_handlers[CYGNUM_HAL_ISR_COUNT];
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
232 !CYG_ADDRWORD hal_interrupt_data[CYGNUM_HAL_ISR_COUNT];
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
233 !CYG_ADDRESS hal_interrupt_objects[CYGNUM_HAL_ISR_COUNT];
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
234
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
235 mov %l3, %o0
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
236 sll %l3, 2, %l3 ! %l3 to a word offset
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
237 sethi %hi(hal_interrupt_data), %l7
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
238 or %l7, %lo(hal_interrupt_data), %l7
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
239 ld [ %l7 + %l3 ], %o1
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
240
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
241 sethi %hi(hal_interrupt_handlers), %l7
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
242 or %l7, %lo(hal_interrupt_handlers), %l7
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
243 ld [ %l7 + %l3 ], %l6
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
244 call %l6
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
245 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
246
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
247 #ifdef CYGFUN_HAL_COMMON_KERNEL_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
248 ! We only need to call _interrupt_end() when there is a kernel
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
249 ! present to do any tidying up.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
250
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
251 #ifdef CYGIMP_HAL_COMMON_INTERRUPTS_USE_INTERRUPT_STACK
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
252 ! now we switch back to the user stack (if we~re at the top
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
253 ! of the interrupt stack).
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
254
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
255 or %l0, 0xfe0, %l7
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
256 wr %l7, %psr ! Interrupts all masked, ET
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
257 #ifdef DELAYS_AFTER_WRPSR_SAME_WINDOW
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
258 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
259 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
260 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
261 #endif
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
262
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
263 .extern cyg_interrupt_stack
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
264 set cyg_interrupt_stack - (24 * 4), %g1
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
265
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
266 cmp %sp, %g1 ! is SP less?
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
267 blu 1f ! if so, do not change back
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
268 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
269 ! switch to the thread stack
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
270 ld [ %g1 + (24 * 4) ], %sp ! there is spare above stack
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
271 1:
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
272
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
273 #else // CYGIMP_HAL_COMMON_INTERRUPTS_USE_INTERRUPT_STACK
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
274 ! First restore the processor interrupt level to that interrupted
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
275 ! (otherwise a task-switch runs at the current PIL) on the assumption
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
276 ! that the ISR dealt with the interrupt source per se, so it is safe
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
277 ! to unmask it, effectively:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
278 or %l0, 0x0e0, %l7 ! original PSR and ET (+S,PS)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
279 wr %l7, %psr ! and enable!
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
280 #ifdef DELAYS_AFTER_WRPSR_SAME_WINDOW
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
281 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
282 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
283 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
284 #endif
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
285 #endif // CYGIMP_HAL_COMMON_INTERRUPTS_USE_INTERRUPT_STACK
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
286
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
287 ! then call interrupt_end( isr_retcode, &intr_object, &regsave )
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
288 ! to unlock the scheduler and do any rescheduling that~s needed.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
289 ! argument 0 (isr_retcode) is already in place in %o0
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
290 sethi %hi(hal_interrupt_objects), %l7
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
291 or %l7, %lo(hal_interrupt_objects), %l7
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
292 ld [ %l7 + %l3 ], %o1
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
293 add %sp, 24 * 4, %o2 ! saved regset (maybe tiny)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
294
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
295 .extern interrupt_end
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
296 call interrupt_end
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
297 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
298 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
299
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
300 ! restore the Y register having done our callouts to C
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
301 wr %l4, %y
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
302
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
303 ! We can reinstall the original CWP here; even if interrupt_end()
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
304 ! performed a reschedule (ie. yield/resume pair) we will be in the
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
305 ! same window. The window is preserved by reschedule precisely
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
306 ! because it is impossible atomically to disable traps here without
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
307 ! involving a CWP living in a register for a time when other
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
308 ! interrupts may occur.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
309
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
310 ! disable traps (using the saved psr is fastest way)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
311 wr %l0, %psr ! restores flags, disables traps, and old PIL
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
312 #ifdef DELAYS_AFTER_WRPSR_SAME_WINDOW
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
313 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
314 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
315 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
316 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
317
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
318 ! HELP_GDB_WITH_BACKTRACE
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
319 mov %l5, %i7 ! restore (unused) return link
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
320
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
321 ! and restore other saved regs
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
322 ! (see CYGDBG_HAL_COMMON_INTERRUPTS_SAVE_MINIMUM_CONTEXT)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
323 add %sp, 24 * 4, %sp ! undo fresh frame
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
324
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
325 ld [%sp + 17 * 4], %g1 ! restore G registers
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
326 ldd [%sp + 18 * 4], %g2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
327 ldd [%sp + 20 * 4], %g4
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
328 ldd [%sp + 22 * 4], %g6
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
329
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
330 ! and do NOT restore any other registers L, I or O
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
331
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
332 ! Now test for window underflow here and fix up if needs be.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
333 !
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
334 ! Why? interrupt_end() might have yielded us, when only
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
335 ! its own frame was restored; its own return to us caused a
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
336 ! window underflow trap, as would our return to interruptee
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
337 ! unless we deal with it now.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
338
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
339 add %l0, 1, %l7 ! interruptee~s CWP plus noise
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
340 and %l7, __WINBITS, %l7 ! CWP only
40
a3cc6665b684 Merge from eCos master repository on 1999-10-01-07:47:04-BST
jlarmour
parents: 8
diff changeset
341 #if 8 == __WINSIZE
a3cc6665b684 Merge from eCos master repository on 1999-10-01-07:47:04-BST
jlarmour
parents: 8
diff changeset
342 ! it is in range already
a3cc6665b684 Merge from eCos master repository on 1999-10-01-07:47:04-BST
jlarmour
parents: 8
diff changeset
343 #else // expect 5 or 6 or 7 windows
a3cc6665b684 Merge from eCos master repository on 1999-10-01-07:47:04-BST
jlarmour
parents: 8
diff changeset
344 cmp %l7, __WINSIZE
a3cc6665b684 Merge from eCos master repository on 1999-10-01-07:47:04-BST
jlarmour
parents: 8
diff changeset
345 bge,a 567f ! taken: do delay slot, handle overflow
a3cc6665b684 Merge from eCos master repository on 1999-10-01-07:47:04-BST
jlarmour
parents: 8
diff changeset
346 mov 0, %l7 ! only if .ge. above
a3cc6665b684 Merge from eCos master repository on 1999-10-01-07:47:04-BST
jlarmour
parents: 8
diff changeset
347 567:
a3cc6665b684 Merge from eCos master repository on 1999-10-01-07:47:04-BST
jlarmour
parents: 8
diff changeset
348 #endif
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
349 mov 1, %l6
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
350 sll %l6, %l7, %l6 ! 1 << CWP
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
351 rd %wim, %l5
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
352 cmp %l5, %l6 ! are they the same?
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
353 bne 2f ! No, so the stack is OK as is.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
354
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
355 ! now do by hand an underflow trap, effectively
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
356 sll %l5, 1, %l5 ! Rotate wim left
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
357 srl %l6, __WINSIZE-1, %l6
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
358 wr %l5, %l6, %wim
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
359 #ifdef DELAYS_AFTER_WRWIM
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
360 nop ! are these delays needed?
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
361 nop ! (following restore uses wim)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
362 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
363 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
364 restore ! Interruptee~s window
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
365 ldd [%sp + 0 * 4], %l0 ! restore L & I registers
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
366 ldd [%sp + 2 * 4], %l2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
367 ldd [%sp + 4 * 4], %l4
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
368 ldd [%sp + 6 * 4], %l6
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
369
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
370 ldd [%sp + 8 * 4], %i0
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
371 ldd [%sp + 10 * 4], %i2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
372 ldd [%sp + 12 * 4], %i4
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
373 ldd [%sp + 14 * 4], %i6
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
374 save ! Back to trap window
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
375
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
376 2: ! restore the condition codes, PSR and PIL and return from trap.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
377 wr %l0, %psr ! restores flags, disables traps, and old PIL
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
378 #ifdef DELAYS_AFTER_WRPSR_SAME_WINDOW
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
379 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
380 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
381 nop
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
382 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
383 jmpl %l1, %g0
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
384 rett %l2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
385
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
386 !----------------------------------------------------------------------------
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
387
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
388 #ifdef CYGIMP_HAL_COMMON_INTERRUPTS_USE_INTERRUPT_STACK
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
389
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
390 ! This routine can only be called from a thread stack, maybe
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
391 ! with interrupts (but not traps) disabled.
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
392 ! It switches to the interrupt stack then calls back to the
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
393 ! kernel to execute DSRs.
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
394
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
395 .global hal_interrupt_stack_call_pending_DSRs
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
396 hal_interrupt_stack_call_pending_DSRs:
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
397 save %sp, -24 * 4, %sp
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
398
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
399 MARKSTACKUSED ! kilroy was here
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
400
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
401 ! be atomic
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
402 rd %psr, %l0
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
403 andn %l0, 0x20, %l1 ! clear ET to disable traps
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
404 wr %l1, %psr ! into the PSR
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
405 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
406 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
407 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
408
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
409 mov %sp, %l7 ! save calling stack location
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
410
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
411 ! now switch stack to the interrupt stack, plus some headroom
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
412 ! for saving a register set if we are interrupted
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
413 .extern cyg_interrupt_stack
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
414 set cyg_interrupt_stack - 4 * 24, %sp
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
415
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
416 MARKSTACKUSED ! kilroy was here
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
417
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
418 ! and enable interrupts unconditionally to call the DSRs
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
419 or %l0, 0x0e0, %l2 ! set ET, S, PS
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
420 andn %l2, 0xf00, %l2 ! PIL to zero
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
421 wr %l2, %psr ! into the PSR
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
422 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
423 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
424 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
425
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
426 .extern cyg_interrupt_call_pending_DSRs
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
427 call cyg_interrupt_call_pending_DSRs
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
428 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
429
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
430 mov %l7, %sp ! restore calling stack
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
431
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
432 wr %l0, %psr ! restore interrupt status
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
433 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
434 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
435 nop
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
436
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
437 ret
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
438 restore
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
439 #endif // CYGIMP_HAL_COMMON_INTERRUPTS_USE_INTERRUPT_STACK
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
440
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
441 !----------------------------------------------------------------------------
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
442
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
443 ! end of vec_ivsr.S