annotate packages/hal/sparclite/arch/current/src/vec_ivsr.S @ 3292:7f8e529b4d82 default tip

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