1 /*******************************************************************************
2 Copyright (c) 2006-2019 Cadence Design Systems Inc.
3
4 Permission is hereby granted, free of charge, to any person obtaining
5 a copy of this software and associated documentation files (the
6 "Software"), to deal in the Software without restriction, including
7 without limitation the rights to use, copy, modify, merge, publish,
8 distribute, sublicense, and/or sell copies of the Software, and to
9 permit persons to whom the Software is furnished to do so, subject to
10 the following conditions:
11
12 The above copyright notice and this permission notice shall be included
13 in all copies or substantial portions of the Software.
14
15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
16 EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
17 MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
18 IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
19 CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
20 TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
21 SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
22 ******************************************************************************/
23
24 /******************************************************************************
25 Xtensa-specific interrupt and exception functions for RTOS ports.
26 Also see xtensa_intr_asm.S.
27 ******************************************************************************/
28
29 #include <stdlib.h>
30
31 #include <xtensa/config/core.h>
32 #include <xtensa/core-macros.h>
33
34 #include "xtensa_api.h"
35
36
37 #if XCHAL_HAVE_EXCEPTIONS
38
39 /* Handler table is in xtensa_intr_asm.S */
40
41 extern xt_exc_handler _xt_exception_table[XCHAL_EXCCAUSE_NUM];
42
43
44 /*
45 Default handler for unhandled exceptions.
46 */
xt_unhandled_exception(XtExcFrame * frame)47 void xt_unhandled_exception(XtExcFrame *frame)
48 {
49 (void) frame; /* Keep compiler happy */
50 exit(-1);
51 }
52
53
54 /*
55 This function registers a handler for the specified exception.
56 The function returns the address of the previous handler.
57 On error, it returns 0.
58 */
xt_set_exception_handler(uint32_t n,xt_exc_handler f)59 xt_exc_handler xt_set_exception_handler(uint32_t n, xt_exc_handler f)
60 {
61 xt_exc_handler old;
62
63 if (n >= XCHAL_EXCCAUSE_NUM) {
64 return 0; /* invalid exception number */
65 }
66
67 old = _xt_exception_table[n];
68
69 if (f != NULL) {
70 _xt_exception_table[n] = f;
71 }
72 else {
73 _xt_exception_table[n] = &xt_unhandled_exception;
74 }
75
76 return old;
77 }
78
79 #endif
80
81 #if XCHAL_HAVE_INTERRUPTS
82
83 #if XCHAL_HAVE_XEA2
84 /* Defined in xtensa_intr_asm.S */
85 extern uint32_t _xt_intenable;
86 extern uint32_t _xt_vpri_mask;
87 #endif
88
89 /* Handler table is in xtensa_intr_asm.S */
90
91 typedef struct xt_handler_table_entry {
92 void * handler;
93 void * arg;
94 } xt_handler_table_entry;
95
96 #if (XT_USE_INT_WRAPPER || XCHAL_HAVE_XEA3)
97 extern xt_handler_table_entry _xt_interrupt_table[XCHAL_NUM_INTERRUPTS + 1];
98 #else
99 extern xt_handler_table_entry _xt_interrupt_table[XCHAL_NUM_INTERRUPTS];
100 #endif
101
102
103 /*
104 Default handler for unhandled interrupts.
105 */
xt_unhandled_interrupt(void * arg)106 void xt_unhandled_interrupt(void * arg)
107 {
108 (void) arg; /* Keep compiler happy */
109 exit(-1);
110 }
111
112
113 /*
114 This function registers a handler for the specified interrupt. The "arg"
115 parameter specifies the argument to be passed to the handler when it is
116 invoked. The function returns the address of the previous handler.
117 On error, it returns 0.
118 */
xt_set_interrupt_handler(uint32_t n,xt_handler f,void * arg)119 xt_handler xt_set_interrupt_handler(uint32_t n, xt_handler f, void * arg)
120 {
121 xt_handler_table_entry * entry;
122 xt_handler old;
123
124 if (n >= XCHAL_NUM_INTERRUPTS) {
125 return 0; /* invalid interrupt number */
126 }
127
128 #if XCHAL_HAVE_XEA2
129 if (Xthal_intlevel[n] > XCHAL_EXCM_LEVEL) {
130 return 0; /* priority level too high to safely handle in C */
131 }
132 #endif
133
134 #if (XT_USE_INT_WRAPPER || XCHAL_HAVE_XEA3)
135 entry = _xt_interrupt_table + n + 1;
136 #else
137 entry = _xt_interrupt_table + n;
138 #endif
139 old = entry->handler;
140
141 if (f != NULL) {
142 entry->handler = f;
143 entry->arg = arg;
144 }
145 else {
146 entry->handler = &xt_unhandled_interrupt;
147 entry->arg = (void*)n;
148 }
149
150 return old;
151 }
152
153
154 /*
155 This function enables the interrupt whose number is specified as
156 the argument.
157 */
xt_interrupt_enable(uint32_t intnum)158 void xt_interrupt_enable(uint32_t intnum)
159 {
160 #if XCHAL_HAVE_XEA2
161 uint32_t ps = XT_RSIL(15);
162
163 // New INTENABLE = (_xt_intenable | mask) & _xt_vpri_mask.
164 _xt_intenable |= (1 << intnum);
165 XT_WSR_INTENABLE(_xt_intenable & _xt_vpri_mask);
166 XT_WSR_PS(ps);
167 XT_RSYNC();
168 #else
169 xthal_interrupt_enable(intnum);
170 #endif
171 }
172
173
174 /*
175 This function disables the interrupt whose number is specified as
176 the argument.
177 */
xt_interrupt_disable(uint32_t intnum)178 void xt_interrupt_disable(uint32_t intnum)
179 {
180 #if XCHAL_HAVE_XEA2
181 uint32_t ps = XT_RSIL(15);
182
183 // New INTENABLE = (_xt_intenable & ~mask) & _xt_vpri_mask.
184 _xt_intenable &= ~(1 << intnum);
185 XT_WSR_INTENABLE(_xt_intenable & _xt_vpri_mask);
186 XT_WSR_PS(ps);
187 XT_RSYNC();
188 #else
189 xthal_interrupt_disable(intnum);
190 #endif
191 }
192
193
194 /*
195 This function triggers the specified interrupt.
196 */
xt_interrupt_trigger(uint32_t intnum)197 void xt_interrupt_trigger(uint32_t intnum)
198 {
199 xthal_interrupt_trigger(intnum);
200 }
201
202
203 /*
204 This function clears the specified interrupt.
205 */
xt_interrupt_clear(uint32_t intnum)206 void xt_interrupt_clear(uint32_t intnum)
207 {
208 xthal_interrupt_clear(intnum);
209 }
210
211
212 #endif /* XCHAL_HAVE_INTERRUPTS */
213
214
