Mercurial > flash_v2
annotate packages/hal/common/current/src/hal_stub.c @ 66:bf00f99aec69 ecos-sw-2000-02-02
Merge from eCos master repository on 2000-02-02-19:16:44-GMT
| author | jlarmour |
|---|---|
| date | Wed, 02 Feb 2000 19:57:02 +0000 |
| parents | c38311975d4f |
| children | c5536bad4c24 |
| rev | line source |
|---|---|
| 2 | 1 //============================================================================= |
| 2 // | |
| 3 // hal_stub.c | |
| 4 // | |
| 5 // Helper functions for stub, specific to eCos HAL | |
| 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): jskov (based on powerpc/cogent hal_stub.c) | |
| 35 // Contributors:jskov | |
| 36 // Date: 1999-02-12 | |
| 37 // Purpose: Helper functions for stub, specific to eCos HAL | |
| 38 // Description: Parts of the GDB stub requirements are provided by | |
| 39 // the eCos HAL, rather than target and/or board specific | |
| 40 // code. | |
| 41 // | |
| 42 //####DESCRIPTIONEND#### | |
| 43 // | |
| 44 //============================================================================= | |
| 45 | |
| 46 #include <pkgconf/hal.h> | |
|
50
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
47 #ifdef CYGPKG_CYGMON |
|
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
48 #include <pkgconf/cygmon.h> |
|
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
49 #endif |
| 2 | 50 |
| 51 #ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS | |
| 52 | |
| 53 #include <cyg/hal/hal_stub.h> // Our header | |
| 54 | |
| 55 #include <cyg/hal/hal_arch.h> // HAL_BREAKINST | |
| 56 #include <cyg/hal/hal_cache.h> // HAL_xCACHE_x | |
| 57 #include <cyg/hal/hal_intr.h> // interrupt disable/restore | |
| 58 | |
| 59 #ifdef CYGDBG_HAL_DEBUG_GDB_THREAD_SUPPORT | |
| 60 #include <cyg/hal/dbg-threads-api.h> // dbg_currthread_id | |
| 61 #endif | |
| 62 | |
| 63 | |
| 64 //----------------------------------------------------------------------------- | |
| 65 // Extra eCos data. | |
| 66 | |
| 67 // Saved registers. | |
| 68 HAL_SavedRegisters *_hal_registers; | |
| 69 target_register_t registers[NUMREGS]; | |
|
14
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
12
diff
changeset
|
70 target_register_t alt_registers[NUMREGS] ; // Thread or saved process state |
|
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
12
diff
changeset
|
71 target_register_t * _registers = registers; // Pointer to current set of registers |
| 2 | 72 |
| 73 // Interrupt control. | |
| 74 static volatile __PFI __interruptible_control; | |
| 75 | |
| 76 //----------------------------------------------------------------------------- | |
| 77 // Register access | |
| 78 | |
| 79 // Return the currently-saved value corresponding to register REG of | |
| 80 // the exception context. | |
| 81 target_register_t | |
| 82 get_register (regnames_t reg) | |
| 83 { | |
| 84 return _registers[reg]; | |
| 85 } | |
| 86 | |
| 87 // Store VALUE in the register corresponding to WHICH in the exception | |
| 88 // context. | |
| 89 void | |
| 90 put_register (regnames_t which, target_register_t value) | |
| 91 { | |
| 92 _registers[which] = value; | |
| 93 } | |
| 94 | |
| 95 //----------------------------------------------------------------------------- | |
| 96 // Serial stuff | |
| 97 | |
| 98 // Write C to the current serial port. | |
| 99 void | |
| 100 putDebugChar (int c) | |
| 101 { | |
| 102 HAL_STUB_PLATFORM_PUT_CHAR(c); | |
| 103 } | |
| 104 | |
| 105 // Read one character from the current serial port. | |
| 106 int | |
| 107 getDebugChar (void) | |
| 108 { | |
| 109 return HAL_STUB_PLATFORM_GET_CHAR(); | |
| 110 } | |
| 111 | |
| 112 // Set the baud rate for the current serial port. | |
| 113 void | |
| 114 __set_baud_rate (int baud) | |
| 115 { | |
| 116 HAL_STUB_PLATFORM_SET_BAUD_RATE(baud); | |
| 117 } | |
| 118 | |
| 119 //----------------------------------------------------------------------------- | |
| 120 // GDB interrupt (BREAK) support. | |
| 121 | |
| 122 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT | |
| 123 | |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
34
diff
changeset
|
124 |
|
30
641b639be825
Merge from eCos master repository on 1999-08-16-22:01:37-BST
jlarmour
parents:
14
diff
changeset
|
125 #if (HAL_BREAKINST_SIZE == 1) |
|
641b639be825
Merge from eCos master repository on 1999-08-16-22:01:37-BST
jlarmour
parents:
14
diff
changeset
|
126 typedef cyg_uint8 t_inst; |
|
641b639be825
Merge from eCos master repository on 1999-08-16-22:01:37-BST
jlarmour
parents:
14
diff
changeset
|
127 #elif (HAL_BREAKINST_SIZE == 2) |
|
12
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
128 typedef cyg_uint16 t_inst; |
|
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
129 #elif (HAL_BREAKINST_SIZE == 4) |
|
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
130 typedef cyg_uint32 t_inst; |
|
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
131 #else |
|
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
132 #error "Don't know how to handle that size" |
|
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
133 #endif |
| 2 | 134 |
| 135 typedef struct | |
| 136 { | |
| 137 t_inst *targetAddr; | |
| 138 t_inst savedInstr; | |
| 139 } instrBuffer; | |
| 140 | |
| 141 static instrBuffer break_buffer; | |
| 142 | |
|
48
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
143 volatile int cyg_hal_gdb_running_step = 0; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
144 |
| 2 | 145 void |
|
50
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
146 cyg_hal_gdb_place_break (target_register_t pc) |
|
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
147 { |
|
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
148 cyg_hal_gdb_interrupt( pc ); // Let's hope this becomes a drop-through: |
|
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
149 } |
|
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
150 |
|
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
151 void |
| 2 | 152 cyg_hal_gdb_interrupt (target_register_t pc) |
| 153 { | |
|
50
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
154 // Clear flag that we Continued instead of Stepping |
|
48
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
155 cyg_hal_gdb_running_step = 0; |
|
50
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
156 // and override existing break? So that a ^C takes effect... |
|
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
157 if (NULL != break_buffer.targetAddr) |
|
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
158 cyg_hal_gdb_remove_break( (target_register_t)break_buffer.targetAddr ); |
|
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
48
diff
changeset
|
159 |
| 2 | 160 if (NULL == break_buffer.targetAddr) { |
| 161 break_buffer.targetAddr = (t_inst*) pc; | |
| 162 break_buffer.savedInstr = *(t_inst*)pc; | |
| 163 *(t_inst*)pc = (t_inst)HAL_BREAKINST; | |
| 164 | |
| 165 __data_cache(CACHE_FLUSH); | |
| 166 __instruction_cache(CACHE_FLUSH); | |
| 167 } | |
| 168 } | |
| 169 | |
| 170 int | |
| 171 cyg_hal_gdb_remove_break (target_register_t pc) | |
| 172 { | |
|
48
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
173 if ( cyg_hal_gdb_running_step ) |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
174 return 0; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
175 |
| 2 | 176 if ((t_inst*)pc == break_buffer.targetAddr) { |
| 177 *(t_inst*)pc = break_buffer.savedInstr; | |
| 178 break_buffer.targetAddr = NULL; | |
| 179 | |
| 180 __data_cache(CACHE_FLUSH); | |
| 181 __instruction_cache(CACHE_FLUSH); | |
| 182 return 1; | |
| 183 } | |
| 184 return 0; | |
| 185 } | |
| 186 | |
|
48
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
187 int |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
188 cyg_hal_gdb_break_is_set (void) |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
189 { |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
190 if (NULL != break_buffer.targetAddr) { |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
191 return 1; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
192 } |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
193 return 0; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
194 } |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
195 |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
34
diff
changeset
|
196 |
| 2 | 197 #endif // CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT |
| 198 | |
| 199 // Use this function to disable serial interrupts whenever reply | |
| 200 // characters are expected from GDB. The reason we want to control | |
| 201 // whether the target can be interrupted or not is simply that GDB on | |
| 202 // the host will be sending acknowledge characters/commands while the | |
| 203 // stub is running - if serial interrupts were still active, the | |
| 204 // characters would never reach the (polling) getDebugChar. | |
| 205 static void | |
| 206 interruptible(int state) | |
| 207 { | |
| 208 static int __interrupts_suspended = 0; | |
| 209 | |
| 210 if (__interruptible_control) { | |
| 211 if (state) { | |
| 212 __interrupts_suspended--; | |
| 213 if (0 >= __interrupts_suspended) { | |
| 214 __interrupts_suspended = 0; | |
| 215 __interruptible_control(1); | |
| 216 } | |
| 217 } else { | |
| 218 __interrupts_suspended++; | |
| 219 if (1 == __interrupts_suspended) | |
| 220 __interruptible_control(0); | |
| 221 } | |
| 222 } | |
| 223 } | |
| 224 | |
| 225 //----------------------------------------------------------------------------- | |
| 226 // eCos stub entry and exit magic. | |
| 227 | |
| 228 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT | |
| 229 int cyg_hal_gdb_break; | |
| 230 #endif | |
| 231 | |
| 232 // Called at stub *entry* | |
| 233 static void | |
| 234 handle_exception_cleanup( void ) | |
| 235 { | |
| 236 interruptible(0); | |
| 237 | |
| 238 // Expand the HAL_SavedRegisters structure into the GDB register | |
| 239 // array format. | |
| 240 HAL_GET_GDB_REGISTERS(®isters[0], _hal_registers); | |
| 241 _registers = ®isters[0]; | |
| 242 | |
|
8
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
243 #ifdef HAL_STUB_PLATFORM_STUBS_FIXUP |
|
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
244 // Some architectures may need to fix the PC in case of a partial |
|
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
245 // or fully executed trap instruction. GDB only takes correct action |
|
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
246 // when the PC is pointing to the breakpoint instruction it set. |
|
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
247 // |
|
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
248 // Most architectures would leave PC pointing at the trap |
|
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
249 // instruction itself though, and so do not need to do anything |
|
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
250 // special. |
|
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
251 HAL_STUB_PLATFORM_STUBS_FIXUP(); |
|
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
252 #endif |
|
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
253 |
| 2 | 254 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT |
|
48
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
255 // If we continued instead of stepping, when there was a break set |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
256 // ie. we were stepping within a critical region, clear the break, and |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
257 // that flag. If we stopped for some other reason, this has no effect. |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
258 if ( cyg_hal_gdb_running_step ) { |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
259 cyg_hal_gdb_running_step = 0; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
260 cyg_hal_gdb_remove_break(get_register (PC)); |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
261 } |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
38
diff
changeset
|
262 |
| 2 | 263 // FIXME: (there may be a better way to do this) |
| 264 // If we hit a breakpoint set by the gdb interrupt stub, make it | |
| 265 // seem like an interrupt rather than having hit a breakpoint. | |
| 266 if (cyg_hal_gdb_remove_break(get_register (PC))) | |
| 267 cyg_hal_gdb_break = 1; | |
| 268 else | |
| 269 cyg_hal_gdb_break = 0; | |
| 270 #endif | |
| 271 } | |
| 272 | |
| 273 // Called at stub *exit* | |
| 274 static void | |
| 275 handle_exception_init( void ) | |
| 276 { | |
| 277 // Compact register array again. | |
| 278 HAL_SET_GDB_REGISTERS(_hal_registers, ®isters[0]); | |
| 279 | |
| 280 interruptible(1); | |
| 281 } | |
| 282 | |
| 283 | |
| 284 //----------------------------------------------------------------------------- | |
| 285 // Initialization. | |
| 286 | |
| 287 // Signal handler. | |
| 288 int | |
| 289 cyg_hal_process_signal (int signal) | |
| 290 { | |
| 291 // We don't care about the signal (atm). | |
| 292 return 0; | |
| 293 } | |
| 294 | |
| 295 // Install the standard set of trap handlers for the stub. | |
| 296 void | |
| 297 __install_traps (void) | |
| 298 { | |
| 299 // Set signal handling vector so we can treat 'C<signum>' as 'c'. | |
| 300 __process_signal_vec = &cyg_hal_process_signal; | |
|
8
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
301 // Set exit vector to reset vector. This will allow automatic reset on |
|
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
302 // some platforms. |
|
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
303 __process_exit_vec = &__reset; |
| 2 | 304 |
| 305 __cleanup_vec = &handle_exception_cleanup; | |
| 306 __init_vec = &handle_exception_init; | |
| 307 | |
| 308 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT | |
| 309 // Control of GDB interrupts. | |
| 310 __interruptible_control = HAL_STUB_PLATFORM_INTERRUPTIBLE; | |
| 311 #endif | |
| 312 | |
| 313 // Nothing further to do, handle_exception will be called when an | |
| 314 // exception occurs. | |
| 315 } | |
| 316 | |
| 317 // Initialize the hardware. | |
| 318 void | |
| 319 initHardware (void) | |
| 320 { | |
| 321 static int initialized = 0; | |
| 322 | |
| 323 if (!initialized) { | |
| 324 initialized = 1; | |
| 325 | |
|
10
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
8
diff
changeset
|
326 #ifdef HAL_STUB_PLATFORM_INIT |
|
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
8
diff
changeset
|
327 // If the platform defines any initialization code, call it here. |
|
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
8
diff
changeset
|
328 HAL_STUB_PLATFORM_INIT(); |
|
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
8
diff
changeset
|
329 #endif |
|
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
8
diff
changeset
|
330 |
| 2 | 331 // Get serial port initialized. |
| 332 HAL_STUB_PLATFORM_INIT_SERIAL(); | |
| 333 | |
| 334 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT | |
| 335 // Get interrupt handler initialized. | |
| 336 HAL_STUB_PLATFORM_INIT_BREAK_IRQ(); | |
| 337 #endif | |
| 338 | |
| 339 #ifdef CYG_HAL_STARTUP_STUBS | |
| 340 // There may be extra initialization required when configured | |
| 341 // for stubs startup. | |
| 342 HAL_STUB_PLATFORM_STUBS_INIT(); | |
| 343 #endif | |
| 344 } | |
| 345 } | |
| 346 | |
| 347 // Reset the board. | |
| 348 void | |
| 349 __reset (void) | |
| 350 { | |
| 351 HAL_STUB_PLATFORM_RESET(); | |
| 352 } | |
| 353 | |
| 354 //----------------------------------------------------------------------------- | |
| 355 // Breakpoint support. | |
| 356 | |
| 357 #ifndef CYGPKG_HAL_ARM | |
| 358 // This function will generate a breakpoint exception. It is used at | |
| 359 // the beginning of a program to sync up with a debugger and can be | |
| 360 // used otherwise as a quick means to stop program execution and | |
| 361 // "break" into the debugger. | |
| 362 void | |
| 363 breakpoint() | |
| 364 { | |
| 365 HAL_BREAKPOINT(_breakinst); | |
| 366 } | |
| 367 | |
| 368 // This function returns the opcode for a 'trap' instruction. | |
| 369 unsigned long | |
| 370 __break_opcode () | |
| 371 { | |
| 372 return HAL_BREAKINST; | |
| 373 } | |
| 374 #endif | |
| 375 | |
| 376 // FIXME: Add support for multiple breakpoints (libstub/bplist-dynamic.c) | |
| 377 int __set_breakpoint (target_register_t addr) { return 0; } | |
| 378 int __remove_breakpoint (target_register_t addr) { return 0; } | |
| 379 | |
| 380 //----------------------------------------------------------------------------- | |
| 381 // Write the 'T' packet in BUFFER. SIGVAL is the signal the program received. | |
| 382 void | |
| 383 __build_t_packet (int sigval, char *buf) | |
| 384 { | |
| 385 target_register_t addr; | |
| 386 char *ptr = buf; | |
|
6
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
387 target_register_t sp; |
| 2 | 388 |
|
6
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
389 sp = (target_register_t) get_register (SP); |
| 2 | 390 |
| 391 *ptr++ = 'T'; | |
| 392 *ptr++ = __tohex (sigval >> 4); | |
| 393 *ptr++ = __tohex (sigval); | |
| 394 | |
| 395 #ifdef CYGDBG_HAL_DEBUG_GDB_THREAD_SUPPORT | |
| 396 // Include thread ID if thread manipulation is required. | |
| 397 { | |
| 398 int id; | |
| 399 | |
| 400 *ptr++ = 't'; | |
| 401 *ptr++ = 'h'; | |
| 402 *ptr++ = 'r'; | |
| 403 *ptr++ = 'e'; | |
| 404 *ptr++ = 'a'; | |
| 405 *ptr++ = 'd'; | |
| 406 *ptr++ = ':'; | |
| 407 | |
| 408 #if (CYG_BYTEORDER == CYG_MSBFIRST) | |
| 409 id = dbg_currthread_id (); | |
| 410 #else | |
| 411 // FIXME: Temporary workaround for PR 18903. Thread ID must be | |
| 412 // big-endian in the T packet. | |
| 413 { | |
| 414 unsigned char* bep = (unsigned char*)&id; | |
| 415 int be_id; | |
| 416 | |
| 417 be_id = dbg_currthread_id (); | |
| 418 *bep++ = (be_id >> 24) & 0xff ; | |
| 419 *bep++ = (be_id >> 16) & 0xff ; | |
| 420 *bep++ = (be_id >> 8) & 0xff ; | |
| 421 *bep++ = (be_id & 0xff) ; | |
| 422 } | |
| 423 #endif | |
| 424 ptr = __mem2hex((char *)&id, ptr, sizeof(id), 0); | |
| 425 *ptr++ = ';'; | |
| 426 } | |
| 427 #endif | |
| 428 | |
| 429 *ptr++ = __tohex (PC >> 4); | |
| 430 *ptr++ = __tohex (PC); | |
| 431 *ptr++ = ':'; | |
| 432 addr = get_register (PC); | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
433 ptr = __mem2hex((char *)&addr, ptr, REGSIZE(PC), 0); |
| 2 | 434 *ptr++ = ';'; |
| 435 | |
| 436 *ptr++ = __tohex (SP >> 4); | |
| 437 *ptr++ = __tohex (SP); | |
| 438 *ptr++ = ':'; | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
439 ptr = __mem2hex((char *)&sp, ptr, REGSIZE(SP), 0); |
| 2 | 440 *ptr++ = ';'; |
| 441 | |
| 442 *ptr++ = 0; | |
| 443 } | |
| 444 | |
| 445 | |
| 446 //----------------------------------------------------------------------------- | |
| 447 // Cache functions. | |
| 448 | |
| 449 // Perform the specified operation on the instruction cache. | |
| 450 // Returns 1 if the cache is enabled, 0 otherwise. | |
| 451 int | |
| 452 __instruction_cache (cache_control_t request) | |
| 453 { | |
| 454 int state = 1; | |
| 455 | |
| 456 switch (request) { | |
| 457 case CACHE_ENABLE: | |
| 458 HAL_ICACHE_ENABLE(); | |
| 459 break; | |
| 460 case CACHE_DISABLE: | |
| 461 HAL_ICACHE_DISABLE(); | |
| 462 state = 0; | |
| 463 break; | |
| 464 case CACHE_FLUSH: | |
| 465 HAL_ICACHE_SYNC(); | |
| 466 break; | |
| 467 case CACHE_NOOP: | |
| 468 /* fall through */ | |
| 469 default: | |
| 470 break; | |
| 471 } | |
| 472 | |
| 473 #ifdef HAL_ICACHE_IS_ENABLED | |
| 474 HAL_ICACHE_IS_ENABLED(state); | |
| 475 #endif | |
| 476 | |
| 477 return state; | |
| 478 } | |
| 479 | |
| 480 // Perform the specified operation on the data cache. | |
| 481 // Returns 1 if the cache is enabled, 0 otherwise. | |
| 482 int | |
| 483 __data_cache (cache_control_t request) | |
| 484 { | |
| 485 int state = 1; | |
| 486 | |
| 487 switch (request) { | |
| 488 case CACHE_ENABLE: | |
| 489 HAL_DCACHE_ENABLE(); | |
| 490 break; | |
| 491 case CACHE_DISABLE: | |
| 492 HAL_DCACHE_DISABLE(); | |
| 493 state = 0; | |
| 494 break; | |
| 495 case CACHE_FLUSH: | |
| 496 HAL_DCACHE_SYNC(); | |
| 497 break; | |
| 498 case CACHE_NOOP: | |
| 499 /* fall through */ | |
| 500 default: | |
| 501 break; | |
| 502 } | |
| 503 #ifdef HAL_DCACHE_IS_ENABLED | |
| 504 HAL_DCACHE_IS_ENABLED(state); | |
| 505 #endif | |
| 506 | |
| 507 return state; | |
| 508 } | |
| 509 | |
| 510 //----------------------------------------------------------------------------- | |
| 511 // Memory accessor functions. | |
| 512 | |
| 513 void *__mem_fault_handler = (void *)0; | |
| 514 | |
| 515 /* These are the "arguments" to __do_read_mem and __do_write_mem, | |
| 516 which are passed as globals to avoid squeezing them thru | |
| 517 __set_mem_fault_trap. */ | |
| 518 | |
| 519 static volatile target_register_t memCount; | |
| 520 | |
| 521 static void | |
| 522 __do_copy_mem (unsigned char* src, unsigned char* dst) | |
| 523 { | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
524 unsigned long *long_dst; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
525 unsigned long *long_src; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
526 unsigned short *short_dst; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
527 unsigned short *short_src; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
528 |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
529 __mem_fault = 1; /* Defaults to 'fail'. Is cleared */ |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
530 /* when the copy loop completes. */ |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
531 __mem_fault_handler = &&err; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
532 |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
533 // See if it's safe to do multi-byte, aligned operations |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
534 while (memCount) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
535 if ((memCount >= sizeof(long)) && |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
536 (((target_register_t)dst & (sizeof(long)-1)) == 0) && |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
537 (((target_register_t)src & (sizeof(long)-1)) == 0)) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
538 |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
539 long_dst = (unsigned long *)dst; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
540 long_src = (unsigned long *)src; |
| 2 | 541 |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
542 *long_dst++ = *long_src++; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
543 memCount -= sizeof(long); |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
544 |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
545 dst = (unsigned char *)long_dst; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
546 src = (unsigned char *)long_src; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
547 } else if ((memCount >= sizeof(short)) && |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
548 (((target_register_t)dst & (sizeof(short)-1)) == 0) && |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
549 (((target_register_t)src & (sizeof(short)-1)) == 0)) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
550 |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
551 short_dst = (unsigned short *)dst; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
552 short_src = (unsigned short *)src; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
553 |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
554 *short_dst++ = *short_src++; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
555 memCount -= sizeof(short); |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
556 |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
557 dst = (unsigned char *)short_dst; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
558 src = (unsigned char *)short_src; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
559 } else { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
560 *dst++ = *src++; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
561 memCount--; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
562 } |
| 2 | 563 } |
| 564 | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
565 __mem_fault = 0; |
| 2 | 566 |
| 567 err: | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
568 __mem_fault_handler = (void *)0; |
| 2 | 569 } |
| 570 | |
| 571 /* | |
| 572 * __read_mem_safe: | |
| 573 * Get contents of target memory, abort on error. | |
| 574 */ | |
| 575 | |
| 576 int | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
577 __read_mem_safe (void *dst, void *src, int count) |
| 2 | 578 { |
| 579 memCount = count; | |
| 580 __do_copy_mem((unsigned char*) src, (unsigned char*) dst); | |
| 581 return count - memCount; // return number of bytes successfully read | |
| 582 } | |
| 583 | |
| 584 /* | |
| 585 * __write_mem_safe: | |
| 586 * Set contents of target memory, abort on error. | |
| 587 */ | |
| 588 | |
| 589 int | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
30
diff
changeset
|
590 __write_mem_safe (void *src, void *dst, int count) |
| 2 | 591 { |
| 592 memCount = count; | |
| 593 __do_copy_mem((unsigned char*) src, (unsigned char*) dst); | |
| 594 return count - memCount; // return number of bytes successfully written | |
| 595 } | |
| 596 | |
| 597 //----------------------------------------------------------------------------- | |
| 598 // Target extras?! | |
| 599 int | |
| 600 __process_target_query(char * pkt, char * out, int maxOut) | |
| 601 { return 0 ; } | |
| 602 int | |
| 603 __process_target_set(char * pkt, char * out, int maxout) | |
| 604 { return 0 ; } | |
| 605 int | |
| 606 __process_target_packet(char * pkt, char * out, int maxout) | |
| 607 { return 0 ; } | |
| 608 | |
| 609 // GDB string output, making sure interrupts are disabled. | |
| 610 // This function gets used by some diag output functions. | |
| 611 void | |
| 612 hal_output_gdb_string(target_register_t str, int string_len) | |
| 613 { | |
| 614 unsigned long __state; | |
|
8
ece80412419a
Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents:
6
diff
changeset
|
615 HAL_DISABLE_INTERRUPTS(__state); |
| 2 | 616 __output_gdb_string(str, string_len); |
| 617 HAL_RESTORE_INTERRUPTS(__state); | |
| 618 } | |
| 619 | |
| 620 #endif // CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS |