Mercurial > flash_v2
annotate packages/hal/arm/arch/current/src/hal_misc.c @ 110:84e4bde58b26 ecos-sw-2000-07-14
Merge from eCos master repository on 2000-07-14-22:00:02-BST
| author | jlarmour |
|---|---|
| date | Mon, 17 Jul 2000 14:42:27 +0000 |
| parents | 95f3e12a6327 |
| children | 6ed91473a1cd |
| rev | line source |
|---|---|
| 2 | 1 /*========================================================================== |
| 2 // | |
| 3 // hal_misc.c | |
| 4 // | |
| 5 // HAL miscellaneous functions | |
| 6 // | |
| 7 //========================================================================== | |
| 8 //####COPYRIGHTBEGIN#### | |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
9 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
10 // ------------------------------------------- |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
11 // The contents of this file are subject to the Red Hat eCos Public License |
|
66
bf00f99aec69
Merge from eCos master repository on 2000-02-02-19:16:44-GMT
jlarmour
parents:
64
diff
changeset
|
12 // Version 1.1 (the "License"); you may not use this file except in |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
13 // compliance with the License. You may obtain a copy of the License at |
|
66
bf00f99aec69
Merge from eCos master repository on 2000-02-02-19:16:44-GMT
jlarmour
parents:
64
diff
changeset
|
14 // http://www.redhat.com/ |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
15 // |
|
66
bf00f99aec69
Merge from eCos master repository on 2000-02-02-19:16:44-GMT
jlarmour
parents:
64
diff
changeset
|
16 // Software distributed under the License is distributed on an "AS IS" |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
17 // basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See the |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
18 // License for the specific language governing rights and limitations under |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
19 // the License. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
20 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
21 // The Original Code is eCos - Embedded Configurable Operating System, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
22 // released September 30, 1998. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
23 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
24 // The Initial Developer of the Original Code is Red Hat. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
25 // Portions created by Red Hat are |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
26 // Copyright (C) 1998, 1999, 2000 Red Hat, Inc. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
27 // All Rights Reserved. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
28 // ------------------------------------------- |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
29 // |
| 2 | 30 //####COPYRIGHTEND#### |
| 31 //========================================================================== | |
| 32 //#####DESCRIPTIONBEGIN#### | |
| 33 // | |
| 34 // Author(s): nickg, gthomas | |
| 35 // Contributors: nickg, gthomas | |
| 36 // Date: 1999-02-20 | |
| 37 // Purpose: HAL miscellaneous functions | |
| 38 // Description: This file contains miscellaneous functions provided by the | |
| 39 // HAL. | |
| 40 // | |
| 41 //####DESCRIPTIONEND#### | |
| 42 // | |
| 43 //=========================================================================*/ | |
| 44 | |
| 45 #include <pkgconf/hal.h> | |
| 46 #include <pkgconf/hal_arm.h> | |
| 47 #ifdef CYGPKG_KERNEL | |
| 48 #include <pkgconf/kernel.h> | |
| 49 #endif | |
|
50
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
38
diff
changeset
|
50 #ifdef CYGPKG_CYGMON |
|
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
38
diff
changeset
|
51 #include <pkgconf/cygmon.h> |
|
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
38
diff
changeset
|
52 #endif |
| 2 | 53 |
| 54 #include <cyg/infra/cyg_type.h> | |
| 55 #include <cyg/infra/cyg_trac.h> // tracing macros | |
| 56 #include <cyg/infra/cyg_ass.h> // assertion macros | |
| 57 | |
| 58 #include <cyg/hal/hal_arch.h> // HAL header | |
| 59 #include <cyg/hal/hal_intr.h> // HAL header | |
| 60 | |
| 61 externC void diag_printf(const char *fmt, ...); | |
| 62 | |
| 63 /*------------------------------------------------------------------------*/ | |
| 64 /* First level C exception handler. */ | |
| 65 | |
| 66 externC void __handle_exception (void); | |
| 67 | |
| 68 externC HAL_SavedRegisters *_hal_registers; | |
| 69 extern void *__mem_fault_handler; | |
| 70 | |
| 71 #ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS | |
| 72 /* Force exception handling into the GDB stubs. This is done by taking over | |
| 73 the exception vectors while executing in the stubs. This allows for the | |
| 74 debugged program to handle exceptions itself, except while the GDB | |
| 75 processing is underway. The only vector that can't be handled this way | |
| 76 is the illegal instruction vector which is used for breakpoint/single-step | |
| 77 and must be maintained by the stubs at all times. | |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
28
diff
changeset
|
78 Note: the interrupt vectors are _not_ preempted as the stubs probably can't |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
28
diff
changeset
|
79 handle them properly. |
| 2 | 80 */ |
| 81 | |
| 82 #define ARM_VECTORS 8 | |
| 83 extern unsigned long vectors[]; // exception vectors as defined by the stubs | |
|
110
84e4bde58b26
Merge from eCos master repository on 2000-07-14-22:00:02-BST
jlarmour
parents:
103
diff
changeset
|
84 |
|
84e4bde58b26
Merge from eCos master repository on 2000-07-14-22:00:02-BST
jlarmour
parents:
103
diff
changeset
|
85 #if !defined(CYGPKG_CYGMON) |
| 2 | 86 static unsigned long *hardware_vectors = (unsigned long *)0x20; |
| 87 static unsigned long hold_vectors[ARM_VECTORS]; | |
| 88 static int exception_level; | |
| 89 | |
| 90 static void | |
| 91 __take_over_debug_traps(void) | |
| 92 { | |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
28
diff
changeset
|
93 hold_vectors[CYGNUM_HAL_VECTOR_ABORT_PREFETCH] = hardware_vectors[CYGNUM_HAL_VECTOR_ABORT_PREFETCH]; |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
28
diff
changeset
|
94 hardware_vectors[CYGNUM_HAL_VECTOR_ABORT_PREFETCH] = vectors[CYGNUM_HAL_VECTOR_ABORT_PREFETCH]; |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
28
diff
changeset
|
95 hold_vectors[CYGNUM_HAL_VECTOR_ABORT_DATA] = hardware_vectors[CYGNUM_HAL_VECTOR_ABORT_DATA]; |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
28
diff
changeset
|
96 hardware_vectors[CYGNUM_HAL_VECTOR_ABORT_DATA] = vectors[CYGNUM_HAL_VECTOR_ABORT_DATA]; |
| 2 | 97 } |
| 98 | |
| 99 static void | |
| 100 __restore_debug_traps(void) | |
| 101 { | |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
28
diff
changeset
|
102 hardware_vectors[CYGNUM_HAL_VECTOR_ABORT_PREFETCH] = hold_vectors[CYGNUM_HAL_VECTOR_ABORT_PREFETCH]; |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
28
diff
changeset
|
103 hardware_vectors[CYGNUM_HAL_VECTOR_ABORT_DATA] = hold_vectors[CYGNUM_HAL_VECTOR_ABORT_DATA]; |
| 2 | 104 } |
|
110
84e4bde58b26
Merge from eCos master repository on 2000-07-14-22:00:02-BST
jlarmour
parents:
103
diff
changeset
|
105 #endif // !CYGPKG_CYGMON |
| 2 | 106 #endif |
| 107 | |
| 108 void | |
| 109 exception_handler(HAL_SavedRegisters *regs) | |
| 110 { | |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
50
diff
changeset
|
111 #if defined(CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS) && !defined(CYGPKG_CYGMON) |
| 2 | 112 if (__mem_fault_handler && |
| 113 regs->vector == CYGNUM_HAL_EXCEPTION_DATA_ACCESS) { | |
| 114 regs->pc = (unsigned long)__mem_fault_handler; | |
| 115 return; // Caught an exception inside stubs | |
| 116 } | |
| 117 | |
| 118 if (++exception_level == 1) __take_over_debug_traps(); | |
| 119 | |
| 120 _hal_registers = regs; | |
| 121 __handle_exception(); | |
| 122 | |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
28
diff
changeset
|
123 if (--exception_level == 0) __restore_debug_traps(); |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
28
diff
changeset
|
124 |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
28
diff
changeset
|
125 #elif defined(CYGPKG_KERNEL_EXCEPTIONS) |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
28
diff
changeset
|
126 |
| 2 | 127 // We should decode the vector and pass a more appropriate |
| 128 // value as the second argument. For now we simply pass a | |
| 129 // pointer to the saved registers. We should also divert | |
| 130 // breakpoint and other debug vectors into the debug stubs. | |
| 131 | |
| 132 cyg_hal_deliver_exception( regs->vector, (CYG_ADDRWORD)regs ); | |
| 133 | |
| 134 #else | |
| 135 | |
| 136 CYG_FAIL("Exception!!!"); | |
| 137 | |
| 138 #endif | |
| 139 | |
| 140 return; | |
| 141 } | |
| 142 | |
| 143 /*------------------------------------------------------------------------*/ | |
| 144 /* C++ support - run initial constructors */ | |
| 145 | |
| 146 #ifdef CYGSEM_HAL_STOP_CONSTRUCTORS_ON_FLAG | |
| 147 cyg_bool cyg_hal_stop_constructors; | |
| 148 #endif | |
| 149 | |
| 150 typedef void (*pfunc) (void); | |
| 151 extern pfunc __CTOR_LIST__[]; | |
| 152 extern pfunc __CTOR_END__[]; | |
| 153 | |
| 154 void | |
| 155 cyg_hal_invoke_constructors (void) | |
| 156 { | |
| 157 | |
| 158 #ifdef CYGSEM_HAL_STOP_CONSTRUCTORS_ON_FLAG | |
| 159 static pfunc *p = &__CTOR_END__[-1]; | |
| 160 | |
| 161 cyg_hal_stop_constructors = 0; | |
| 162 for (; p >= __CTOR_LIST__; p--) { | |
| 163 (*p) (); | |
| 164 if (cyg_hal_stop_constructors) { | |
| 165 p--; | |
| 166 break; | |
| 167 } | |
| 168 } | |
| 169 #else | |
| 170 pfunc *p; | |
| 171 | |
| 172 for (p = &__CTOR_END__[-1]; p >= __CTOR_LIST__; p--) | |
| 173 (*p) (); | |
| 174 #endif | |
| 175 } | |
| 176 | |
| 177 /*------------------------------------------------------------------------*/ | |
|
110
84e4bde58b26
Merge from eCos master repository on 2000-07-14-22:00:02-BST
jlarmour
parents:
103
diff
changeset
|
178 /* Architecture default ISR */ |
| 2 | 179 |
|
103
95f3e12a6327
Merge from eCos master repository on 2000-06-23-16:41:10-BST
jlarmour
parents:
76
diff
changeset
|
180 externC cyg_uint32 |
|
95f3e12a6327
Merge from eCos master repository on 2000-06-23-16:41:10-BST
jlarmour
parents:
76
diff
changeset
|
181 hal_arch_default_isr(CYG_ADDRWORD vector, CYG_ADDRWORD data) |
|
95f3e12a6327
Merge from eCos master repository on 2000-06-23-16:41:10-BST
jlarmour
parents:
76
diff
changeset
|
182 { |
|
95f3e12a6327
Merge from eCos master repository on 2000-06-23-16:41:10-BST
jlarmour
parents:
76
diff
changeset
|
183 CYG_TRACE1(true, "Interrupt: %d", vector); |
|
95f3e12a6327
Merge from eCos master repository on 2000-06-23-16:41:10-BST
jlarmour
parents:
76
diff
changeset
|
184 |
|
95f3e12a6327
Merge from eCos master repository on 2000-06-23-16:41:10-BST
jlarmour
parents:
76
diff
changeset
|
185 diag_printf("Spurious Interrupt!!! - vector: %d, data: %x\n", vector, |
|
95f3e12a6327
Merge from eCos master repository on 2000-06-23-16:41:10-BST
jlarmour
parents:
76
diff
changeset
|
186 data); |
|
95f3e12a6327
Merge from eCos master repository on 2000-06-23-16:41:10-BST
jlarmour
parents:
76
diff
changeset
|
187 CYG_FAIL("Spurious Interrupt!!!"); |
|
95f3e12a6327
Merge from eCos master repository on 2000-06-23-16:41:10-BST
jlarmour
parents:
76
diff
changeset
|
188 return 0; |
|
95f3e12a6327
Merge from eCos master repository on 2000-06-23-16:41:10-BST
jlarmour
parents:
76
diff
changeset
|
189 } |
| 2 | 190 |
| 191 /*------------------------------------------------------------------------*/ | |
| 192 /* Idle thread action */ | |
| 193 | |
| 194 void | |
| 195 hal_idle_thread_action( cyg_uint32 count ) | |
| 196 { | |
| 197 } | |
| 198 | |
| 199 /*-------------------------------------------------------------------------*/ | |
| 200 /* Misc functions */ | |
| 201 | |
| 202 #ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS | |
| 203 /* This function will generate a breakpoint exception. It is used at the | |
| 204 beginning of a program to sync up with a debugger and can be used | |
| 205 otherwise as a quick means to stop program execution and "break" into | |
| 206 the debugger. */ | |
| 207 | |
| 208 void | |
| 209 breakpoint(void) | |
| 210 { | |
| 211 HAL_BREAKPOINT(breakinst); | |
| 212 } | |
| 213 | |
| 214 | |
| 215 /* This function returns the opcode for a 'trap' instruction. */ | |
| 216 | |
| 217 unsigned long | |
| 218 __break_opcode (void) | |
| 219 { | |
| 220 return HAL_BREAKINST; | |
| 221 } | |
| 222 #endif | |
| 223 | |
| 224 int | |
| 225 hal_lsbindex(int mask) | |
| 226 { | |
| 227 int i; | |
| 228 for (i = 0; i < 32; i++) { | |
| 229 if (mask & (1<<i)) return (i); | |
| 230 } | |
| 231 return (-1); | |
| 232 } | |
| 233 | |
| 234 int | |
| 235 hal_msbindex(int mask) | |
| 236 { | |
| 237 int i; | |
| 238 for (i = 32; i >= 0; i++) { | |
| 239 if (mask & (1<<i)) return (i); | |
| 240 } | |
| 241 return (-1); | |
| 242 } | |
| 243 | |
| 244 #ifdef CYGHWR_HAL_ARM_DUMP_EXCEPTIONS | |
| 245 void | |
| 246 dump_frame(unsigned char *frame) | |
| 247 { | |
| 248 HAL_SavedRegisters *rp = (HAL_SavedRegisters *)frame; | |
| 249 int i; | |
|
76
435cced73e2f
eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST
jlarmour
parents:
66
diff
changeset
|
250 diag_dump_buf(frame, 128); |
| 2 | 251 diag_printf("Registers:\n"); |
| 252 for (i = 0; i <= 10; i++) { | |
| 253 if ((i == 0) || (i == 6)) diag_printf("R%d: ", i); | |
| 254 diag_printf("%08X ", rp->d[i]); | |
| 255 if ((i == 5) || (i == 10)) diag_printf("\n"); | |
| 256 } | |
| 257 diag_printf("FP: %08X, SP: %08X, LR: %08X, PC: %08X, PSR: %08X\n", | |
| 258 rp->fp, rp->sp, rp->lr, rp->pc, rp->cpsr); | |
| 259 } | |
| 260 #endif | |
| 261 | |
| 262 #if 0 | |
| 263 void | |
| 264 show_frame_in(HAL_SavedRegisters *frame) | |
| 265 { | |
| 266 int old; | |
| 267 HAL_DISABLE_INTERRUPTS(old); | |
| 268 diag_printf("[IN] IRQ Frame:\n"); | |
| 269 dump_frame((unsigned char *)frame); | |
| 270 HAL_RESTORE_INTERRUPTS(old); | |
| 271 } | |
| 272 | |
| 273 void | |
| 274 show_frame_out(HAL_SavedRegisters *frame) | |
| 275 { | |
| 276 int old; | |
| 277 HAL_DISABLE_INTERRUPTS(old); | |
| 278 diag_printf("[OUT] IRQ Frame:\n"); | |
| 279 dump_frame((unsigned char *)frame); | |
| 280 HAL_RESTORE_INTERRUPTS(old); | |
| 281 } | |
| 282 #endif | |
| 283 | |
| 284 #ifdef CYGHWR_HAL_ARM_DUMP_EXCEPTIONS | |
| 285 // Debug routines | |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
2
diff
changeset
|
286 void cyg_hal_report_undefined_instruction(HAL_SavedRegisters *frame) |
| 2 | 287 { |
| 288 int old; | |
| 289 HAL_DISABLE_INTERRUPTS(old); | |
| 290 diag_printf("[UNDEFINED INSTRUCTION] Frame:\n"); | |
| 291 dump_frame((unsigned char *)frame); | |
| 292 HAL_RESTORE_INTERRUPTS(old); | |
| 293 } | |
| 294 | |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
2
diff
changeset
|
295 void cyg_hal_report_software_interrupt(HAL_SavedRegisters *frame) |
| 2 | 296 { |
| 297 int old; | |
| 298 HAL_DISABLE_INTERRUPTS(old); | |
| 299 diag_printf("[SOFTWARE INTERRUPT] Frame:\n"); | |
| 300 dump_frame((unsigned char *)frame); | |
| 301 HAL_RESTORE_INTERRUPTS(old); | |
| 302 } | |
| 303 | |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
2
diff
changeset
|
304 void cyg_hal_report_abort_prefetch(HAL_SavedRegisters *frame) |
| 2 | 305 { |
| 306 int old; | |
| 307 HAL_DISABLE_INTERRUPTS(old); | |
| 308 diag_printf("[ABORT PREFETCH] Frame:\n"); | |
| 309 dump_frame((unsigned char *)frame); | |
| 310 HAL_RESTORE_INTERRUPTS(old); | |
| 311 } | |
| 312 | |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
2
diff
changeset
|
313 void cyg_hal_report_abort_data(HAL_SavedRegisters *frame) |
| 2 | 314 { |
| 315 int old; | |
| 316 HAL_DISABLE_INTERRUPTS(old); | |
| 317 diag_printf("[ABORT DATA] Frame:\n"); | |
| 318 dump_frame((unsigned char *)frame); | |
| 319 HAL_RESTORE_INTERRUPTS(old); | |
| 320 } | |
| 321 | |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
2
diff
changeset
|
322 void cyg_hal_report_exception_handler_returned(HAL_SavedRegisters *frame) |
| 2 | 323 { |
| 324 int old; | |
| 325 HAL_DISABLE_INTERRUPTS(old); | |
| 326 diag_printf("Exception handler returned!\n"); | |
| 327 dump_frame((unsigned char *)frame); | |
| 328 HAL_RESTORE_INTERRUPTS(old); | |
| 329 } | |
| 330 #endif | |
| 331 | |
| 332 /*------------------------------------------------------------------------*/ | |
| 333 // EOF hal_misc.c |