annotate packages/hal/common/current/src/hal_stub.c @ 8:ece80412419a ecos-sw-1999-05-21

Merge from eCos master repository on 1999-05-21-22:05:54-BST
author jlarmour
date Fri, 21 May 1999 15:09:30 +0000
parents d376b777e2ce
children d3fbcdfa1b2f
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 // hal_stub.c
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 // Helper functions for stub, specific to eCos HAL
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 //=============================================================================
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
8 //####COPYRIGHTBEGIN####
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
9 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
10 // -------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
11 // The contents of this file are subject to the Cygnus eCos Public License
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
12 // Version 1.0 (the "License"); you may not use this file except in
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
13 // compliance with the License. You may obtain a copy of the License at
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
14 // http://sourceware.cygnus.com/ecos
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
15 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
16 // Software distributed under the License is distributed on an "AS IS"
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
17 // basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See the
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
18 // License for the specific language governing rights and limitations under
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
19 // the License.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
20 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
21 // The Original Code is eCos - Embedded Cygnus Operating System, released
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
22 // September 30, 1998.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
23 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
24 // The Initial Developer of the Original Code is Cygnus. Portions created
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
25 // by Cygnus are Copyright (C) 1998, 1999 Cygnus Solutions.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
26 // All Rights Reserved.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
27 // -------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
28 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
29 //####COPYRIGHTEND####
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
30 //=============================================================================
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
31 //#####DESCRIPTIONBEGIN####
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
32 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
33 // Author(s): jskov (based on powerpc/cogent hal_stub.c)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
34 // Contributors:jskov
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
35 // Date: 1999-02-12
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
36 // Purpose: Helper functions for stub, specific to eCos HAL
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
37 // Description: Parts of the GDB stub requirements are provided by
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
38 // the eCos HAL, rather than target and/or board specific
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
39 // code.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
40 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
41 //####DESCRIPTIONEND####
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
42 //
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
43 //=============================================================================
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
44
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
45 #include <pkgconf/hal.h>
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
46
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
47 #ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS
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 #include <cyg/hal/hal_stub.h> // Our header
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 #include <cyg/hal/hal_arch.h> // HAL_BREAKINST
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
52 #include <cyg/hal/hal_cache.h> // HAL_xCACHE_x
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
53 #include <cyg/hal/hal_intr.h> // interrupt disable/restore
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
54
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
55 #ifdef CYGDBG_HAL_DEBUG_GDB_THREAD_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
56 #include <cyg/hal/dbg-threads-api.h> // dbg_currthread_id
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
57 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
58
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
59
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
60 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
61 // Extra eCos data.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
62
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
63 // Saved registers.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
64 HAL_SavedRegisters *_hal_registers;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
65 target_register_t * _registers; // Pointer to current set of registers
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
66 target_register_t registers[NUMREGS];
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
67 target_register_t alt_registers[NUMREGS] ; // Thread or saved process state
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 // Interrupt control.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
70 static volatile __PFI __interruptible_control;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
71
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
72 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
73 // Register access
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
74
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
75 // Return the currently-saved value corresponding to register REG of
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
76 // the exception context.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
77 target_register_t
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
78 get_register (regnames_t reg)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
79 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
80 return _registers[reg];
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
81 }
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 // Store VALUE in the register corresponding to WHICH in the exception
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
84 // context.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
85 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
86 put_register (regnames_t which, target_register_t value)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
87 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
88 _registers[which] = value;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
89 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
90
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
91 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
92 // Serial stuff
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
93
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
94 // Write C to the current serial port.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
95 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
96 putDebugChar (int c)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
97 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
98 HAL_STUB_PLATFORM_PUT_CHAR(c);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
99 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
100
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
101 // Read one character from the current serial port.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
102 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
103 getDebugChar (void)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
104 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
105 return HAL_STUB_PLATFORM_GET_CHAR();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
106 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
107
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
108 // Set the baud rate for the current serial port.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
109 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
110 __set_baud_rate (int baud)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
111 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
112 HAL_STUB_PLATFORM_SET_BAUD_RATE(baud);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
113 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
114
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
115 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
116 // GDB interrupt (BREAK) support.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
117
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
118 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
119
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
120 typedef unsigned long t_inst;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
121
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
122 typedef struct
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
123 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
124 t_inst *targetAddr;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
125 t_inst savedInstr;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
126 } instrBuffer;
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 static instrBuffer break_buffer;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
129
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
130 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
131 cyg_hal_gdb_interrupt (target_register_t pc)
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 if (NULL == break_buffer.targetAddr) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
134 break_buffer.targetAddr = (t_inst*) pc;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
135 break_buffer.savedInstr = *(t_inst*)pc;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
136 *(t_inst*)pc = (t_inst)HAL_BREAKINST;
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 __data_cache(CACHE_FLUSH);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
139 __instruction_cache(CACHE_FLUSH);
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 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
142
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
143 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
144 cyg_hal_gdb_remove_break (target_register_t pc)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
145 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
146 if ((t_inst*)pc == break_buffer.targetAddr) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
147 *(t_inst*)pc = break_buffer.savedInstr;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
148 break_buffer.targetAddr = NULL;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
149
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
150 __data_cache(CACHE_FLUSH);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
151 __instruction_cache(CACHE_FLUSH);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
152 return 1;
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 return 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
155 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
156
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
157 #endif // CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
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 // Use this function to disable serial interrupts whenever reply
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
160 // characters are expected from GDB. The reason we want to control
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
161 // whether the target can be interrupted or not is simply that GDB on
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
162 // the host will be sending acknowledge characters/commands while the
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
163 // stub is running - if serial interrupts were still active, the
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
164 // characters would never reach the (polling) getDebugChar.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
165 static void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
166 interruptible(int state)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
167 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
168 static int __interrupts_suspended = 0;
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 if (__interruptible_control) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
171 if (state) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
172 __interrupts_suspended--;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
173 if (0 >= __interrupts_suspended) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
174 __interrupts_suspended = 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
175 __interruptible_control(1);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
176 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
177 } else {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
178 __interrupts_suspended++;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
179 if (1 == __interrupts_suspended)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
180 __interruptible_control(0);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
181 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
182 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
183 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
184
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
185 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
186 // eCos stub entry and exit magic.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
187
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
188 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
189 int cyg_hal_gdb_break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
190 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
191
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
192 // Called at stub *entry*
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
193 static void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
194 handle_exception_cleanup( void )
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 interruptible(0);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
197
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
198 // Expand the HAL_SavedRegisters structure into the GDB register
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
199 // array format.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
200 HAL_GET_GDB_REGISTERS(&registers[0], _hal_registers);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
201 _registers = &registers[0];
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
202
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
203 #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
204 // 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
205 // 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
206 // 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
207 //
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
208 // 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
209 // 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
210 // special.
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
211 HAL_STUB_PLATFORM_STUBS_FIXUP();
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
212 #endif
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
213
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
214 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
215 // FIXME: (there may be a better way to do this)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
216 // If we hit a breakpoint set by the gdb interrupt stub, make it
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
217 // seem like an interrupt rather than having hit a breakpoint.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
218 if (cyg_hal_gdb_remove_break(get_register (PC)))
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
219 cyg_hal_gdb_break = 1;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
220 else
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
221 cyg_hal_gdb_break = 0;
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 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
224
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
225 // Called at stub *exit*
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
226 static void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
227 handle_exception_init( void )
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
228 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
229 // Compact register array again.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
230 HAL_SET_GDB_REGISTERS(_hal_registers, &registers[0]);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
231
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
232 interruptible(1);
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
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
235
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
236 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
237 // Initialization.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
238
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
239 // Signal handler.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
240 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
241 cyg_hal_process_signal (int signal)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
242 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
243 // We don't care about the signal (atm).
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
244 return 0;
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
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
247 // Install the standard set of trap handlers for the stub.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
248 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
249 __install_traps (void)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
250 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
251 // Set signal handling vector so we can treat 'C<signum>' as 'c'.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
252 __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
253 // 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
254 // some platforms.
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
255 __process_exit_vec = &__reset;
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
256
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
257 __cleanup_vec = &handle_exception_cleanup;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
258 __init_vec = &handle_exception_init;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
259
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
260 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
261 // Control of GDB interrupts.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
262 __interruptible_control = HAL_STUB_PLATFORM_INTERRUPTIBLE;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
263 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
264
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
265 // Nothing further to do, handle_exception will be called when an
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
266 // exception occurs.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
267 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
268
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
269 // Initialize the hardware.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
270 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
271 initHardware (void)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
272 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
273 static int initialized = 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
274
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
275 if (!initialized) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
276 initialized = 1;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
277
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
278 // Get serial port initialized.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
279 HAL_STUB_PLATFORM_INIT_SERIAL();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
280
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
281 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
282 // Get interrupt handler initialized.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
283 HAL_STUB_PLATFORM_INIT_BREAK_IRQ();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
284 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
285
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
286 #ifdef CYG_HAL_STARTUP_STUBS
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
287 // There may be extra initialization required when configured
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
288 // for stubs startup.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
289 HAL_STUB_PLATFORM_STUBS_INIT();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
290 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
291 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
292 }
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 // Reset the board.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
295 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
296 __reset (void)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
297 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
298 HAL_STUB_PLATFORM_RESET();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
299 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
300
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 // Breakpoint support.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
303
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
304 #ifndef CYGPKG_HAL_ARM
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
305 // This function will generate a breakpoint exception. It is used at
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
306 // the beginning of a program to sync up with a debugger and can be
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
307 // used otherwise as a quick means to stop program execution and
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
308 // "break" into the debugger.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
309 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
310 breakpoint()
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
311 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
312 HAL_BREAKPOINT(_breakinst);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
313 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
314
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
315 // This function returns the opcode for a 'trap' instruction.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
316 unsigned long
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
317 __break_opcode ()
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
318 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
319 return HAL_BREAKINST;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
320 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
321 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
322
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
323 // FIXME: Add support for multiple breakpoints (libstub/bplist-dynamic.c)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
324 int __set_breakpoint (target_register_t addr) { return 0; }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
325 int __remove_breakpoint (target_register_t addr) { return 0; }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
326
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
327 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
328 // Write the 'T' packet in BUFFER. SIGVAL is the signal the program received.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
329 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
330 __build_t_packet (int sigval, char *buf)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
331 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
332 target_register_t addr;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
333 char *ptr = buf;
6
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents: 2
diff changeset
334 target_register_t sp;
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
335
6
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents: 2
diff changeset
336 sp = (target_register_t) get_register (SP);
2
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 *ptr++ = 'T';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
339 *ptr++ = __tohex (sigval >> 4);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
340 *ptr++ = __tohex (sigval);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
341
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
342 #ifdef CYGDBG_HAL_DEBUG_GDB_THREAD_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
343 // Include thread ID if thread manipulation is required.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
344 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
345 int id;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
346
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
347 *ptr++ = 't';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
348 *ptr++ = 'h';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
349 *ptr++ = 'r';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
350 *ptr++ = 'e';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
351 *ptr++ = 'a';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
352 *ptr++ = 'd';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
353 *ptr++ = ':';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
354
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
355 #if (CYG_BYTEORDER == CYG_MSBFIRST)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
356 id = dbg_currthread_id ();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
357 #else
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
358 // FIXME: Temporary workaround for PR 18903. Thread ID must be
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
359 // big-endian in the T packet.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
360 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
361 unsigned char* bep = (unsigned char*)&id;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
362 int be_id;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
363
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
364 be_id = dbg_currthread_id ();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
365 *bep++ = (be_id >> 24) & 0xff ;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
366 *bep++ = (be_id >> 16) & 0xff ;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
367 *bep++ = (be_id >> 8) & 0xff ;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
368 *bep++ = (be_id & 0xff) ;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
369 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
370 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
371 ptr = __mem2hex((char *)&id, ptr, sizeof(id), 0);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
372 *ptr++ = ';';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
373 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
374 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
375
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
376 *ptr++ = __tohex (PC >> 4);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
377 *ptr++ = __tohex (PC);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
378 *ptr++ = ':';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
379 addr = get_register (PC);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
380 ptr = __mem2hex((char *)&addr, ptr, sizeof(addr), 0);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
381 *ptr++ = ';';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
382
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
383 *ptr++ = __tohex (SP >> 4);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
384 *ptr++ = __tohex (SP);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
385 *ptr++ = ':';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
386 ptr = __mem2hex((char *)&sp, ptr, sizeof(sp), 0);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
387 *ptr++ = ';';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
388
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
389 *ptr++ = 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
390 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
391
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
392
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
393 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
394 // Cache functions.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
395
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
396 // Perform the specified operation on the instruction cache.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
397 // Returns 1 if the cache is enabled, 0 otherwise.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
398 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
399 __instruction_cache (cache_control_t request)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
400 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
401 int state = 1;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
402
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
403 switch (request) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
404 case CACHE_ENABLE:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
405 HAL_ICACHE_ENABLE();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
406 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
407 case CACHE_DISABLE:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
408 HAL_ICACHE_DISABLE();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
409 state = 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
410 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
411 case CACHE_FLUSH:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
412 HAL_ICACHE_SYNC();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
413 HAL_ICACHE_INVALIDATE_ALL();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
414 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
415 case CACHE_NOOP:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
416 /* fall through */
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
417 default:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
418 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
419 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
420
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
421 #ifdef HAL_ICACHE_IS_ENABLED
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
422 HAL_ICACHE_IS_ENABLED(state);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
423 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
424
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
425 return state;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
426 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
427
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
428 // Perform the specified operation on the data cache.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
429 // Returns 1 if the cache is enabled, 0 otherwise.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
430 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
431 __data_cache (cache_control_t request)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
432 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
433 int state = 1;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
434
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
435 switch (request) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
436 case CACHE_ENABLE:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
437 HAL_DCACHE_ENABLE();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
438 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
439 case CACHE_DISABLE:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
440 HAL_DCACHE_DISABLE();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
441 state = 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
442 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
443 case CACHE_FLUSH:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
444 HAL_DCACHE_SYNC();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
445 HAL_DCACHE_INVALIDATE_ALL();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
446 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
447 case CACHE_NOOP:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
448 /* fall through */
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
449 default:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
450 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
451 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
452
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
453 #ifdef HAL_DCACHE_IS_ENABLED
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
454 HAL_DCACHE_IS_ENABLED(state);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
455 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
456
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
457 return state;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
458 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
459
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
460 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
461 // Memory accessor functions.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
462
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
463 void *__mem_fault_handler = (void *)0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
464
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
465 /* These are the "arguments" to __do_read_mem and __do_write_mem,
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
466 which are passed as globals to avoid squeezing them thru
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
467 __set_mem_fault_trap. */
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
468
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
469 static volatile target_register_t memCount;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
470
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
471 static void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
472 __do_copy_mem (unsigned char* src, unsigned char* dst)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
473 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
474 __mem_fault = 1; // Defaults to 'fail'. Is cleared
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
475 // when the copy loop completes.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
476 __mem_fault_handler = &&err;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
477
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
478 while (memCount)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
479 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
480 *dst++ = *src++;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
481 memCount--;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
482 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
483
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
484 __mem_fault = 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
485
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
486 err:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
487 __mem_fault_handler = (void *)0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
488 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
489
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
490 /*
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
491 * __read_mem_safe:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
492 * Get contents of target memory, abort on error.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
493 */
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
494
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
495 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
496 __read_mem_safe (unsigned char *dst, target_register_t src, int count)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
497 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
498 memCount = count;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
499 __do_copy_mem((unsigned char*) src, (unsigned char*) dst);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
500 return count - memCount; // return number of bytes successfully read
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
501 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
502
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
503 /*
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
504 * __write_mem_safe:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
505 * Set contents of target memory, abort on error.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
506 */
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
507
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
508 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
509 __write_mem_safe (unsigned char *src, target_register_t dst, int count)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
510 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
511 memCount = count;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
512 __do_copy_mem((unsigned char*) src, (unsigned char*) dst);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
513 return count - memCount; // return number of bytes successfully written
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
514 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
515
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
516 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
517 // Target extras?!
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
518 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
519 __process_target_query(char * pkt, char * out, int maxOut)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
520 { return 0 ; }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
521 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
522 __process_target_set(char * pkt, char * out, int maxout)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
523 { return 0 ; }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
524 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
525 __process_target_packet(char * pkt, char * out, int maxout)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
526 { return 0 ; }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
527
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
528 // GDB string output, making sure interrupts are disabled.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
529 // This function gets used by some diag output functions.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
530 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
531 hal_output_gdb_string(target_register_t str, int string_len)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
532 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
533 unsigned long __state;
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
534 HAL_DISABLE_INTERRUPTS(__state);
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
535 __output_gdb_string(str, string_len);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
536 HAL_RESTORE_INTERRUPTS(__state);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
537 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
538
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
539 #endif // CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS