annotate packages/hal/common/current/src/hal_stub.c @ 12:4cc3eff958ab ecos-sw-1999-06-04

Merge from eCos master repository on 1999-06-04-22:24:56-BST
author jlarmour
date Fri, 04 Jun 1999 15:08:16 +0000
parents d3fbcdfa1b2f
children 01ce82f3e11a
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
12
4cc3eff958ab Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents: 10
diff changeset
120 #if (HAL_BREAKINST_SIZE == 2)
4cc3eff958ab Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents: 10
diff changeset
121 typedef cyg_uint16 t_inst;
4cc3eff958ab Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents: 10
diff changeset
122 #elif (HAL_BREAKINST_SIZE == 4)
4cc3eff958ab Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents: 10
diff changeset
123 typedef cyg_uint32 t_inst;
4cc3eff958ab Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents: 10
diff changeset
124 #else
4cc3eff958ab Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents: 10
diff changeset
125 #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
126 #endif
2
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 typedef struct
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 t_inst *targetAddr;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
131 t_inst savedInstr;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
132 } instrBuffer;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
133
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
134 static instrBuffer break_buffer;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
135
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
136 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
137 cyg_hal_gdb_interrupt (target_register_t pc)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
138 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
139 if (NULL == break_buffer.targetAddr) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
140 break_buffer.targetAddr = (t_inst*) pc;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
141 break_buffer.savedInstr = *(t_inst*)pc;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
142 *(t_inst*)pc = (t_inst)HAL_BREAKINST;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
143
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
144 __data_cache(CACHE_FLUSH);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
145 __instruction_cache(CACHE_FLUSH);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
146 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
147 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
148
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
149 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
150 cyg_hal_gdb_remove_break (target_register_t pc)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
151 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
152 if ((t_inst*)pc == break_buffer.targetAddr) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
153 *(t_inst*)pc = break_buffer.savedInstr;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
154 break_buffer.targetAddr = NULL;
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 __data_cache(CACHE_FLUSH);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
157 __instruction_cache(CACHE_FLUSH);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
158 return 1;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
159 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
160 return 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
161 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
162
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
163 #endif // CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
164
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
165 // Use this function to disable serial interrupts whenever reply
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
166 // characters are expected from GDB. The reason we want to control
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
167 // 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
168 // the host will be sending acknowledge characters/commands while the
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
169 // stub is running - if serial interrupts were still active, the
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
170 // characters would never reach the (polling) getDebugChar.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
171 static void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
172 interruptible(int state)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
173 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
174 static int __interrupts_suspended = 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
175
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
176 if (__interruptible_control) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
177 if (state) {
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 (0 >= __interrupts_suspended) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
180 __interrupts_suspended = 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
181 __interruptible_control(1);
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 } else {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
184 __interrupts_suspended++;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
185 if (1 == __interrupts_suspended)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
186 __interruptible_control(0);
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 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
189 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
190
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 // eCos stub entry and exit magic.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
193
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
194 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
195 int cyg_hal_gdb_break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
196 #endif
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 // Called at stub *entry*
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
199 static void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
200 handle_exception_cleanup( void )
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
201 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
202 interruptible(0);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
203
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
204 // Expand the HAL_SavedRegisters structure into the GDB register
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
205 // array format.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
206 HAL_GET_GDB_REGISTERS(&registers[0], _hal_registers);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
207 _registers = &registers[0];
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
208
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
209 #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
210 // 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
211 // 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
212 // 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
213 //
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
214 // 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
215 // 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
216 // special.
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
217 HAL_STUB_PLATFORM_STUBS_FIXUP();
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
218 #endif
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
219
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
220 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
221 // FIXME: (there may be a better way to do this)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
222 // 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
223 // seem like an interrupt rather than having hit a breakpoint.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
224 if (cyg_hal_gdb_remove_break(get_register (PC)))
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
225 cyg_hal_gdb_break = 1;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
226 else
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
227 cyg_hal_gdb_break = 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
228 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
229 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
230
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
231 // Called at stub *exit*
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
232 static void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
233 handle_exception_init( void )
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 // Compact register array again.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
236 HAL_SET_GDB_REGISTERS(_hal_registers, &registers[0]);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
237
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
238 interruptible(1);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
239 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
240
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
241
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 // Initialization.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
244
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
245 // Signal handler.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
246 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
247 cyg_hal_process_signal (int signal)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
248 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
249 // We don't care about the signal (atm).
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
250 return 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
251 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
252
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
253 // Install the standard set of trap handlers for the stub.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
254 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
255 __install_traps (void)
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 // 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
258 __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
259 // 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
260 // some platforms.
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
261 __process_exit_vec = &__reset;
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
262
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
263 __cleanup_vec = &handle_exception_cleanup;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
264 __init_vec = &handle_exception_init;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
265
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
266 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
267 // Control of GDB interrupts.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
268 __interruptible_control = HAL_STUB_PLATFORM_INTERRUPTIBLE;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
269 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
270
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
271 // Nothing further to do, handle_exception will be called when an
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
272 // exception occurs.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
273 }
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 // Initialize the hardware.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
276 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
277 initHardware (void)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
278 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
279 static int initialized = 0;
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 if (!initialized) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
282 initialized = 1;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
283
10
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
284 #ifdef HAL_STUB_PLATFORM_INIT
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
285 // 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
286 HAL_STUB_PLATFORM_INIT();
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
287 #endif
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
288
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
289 // Get serial port initialized.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
290 HAL_STUB_PLATFORM_INIT_SERIAL();
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 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
293 // Get interrupt handler initialized.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
294 HAL_STUB_PLATFORM_INIT_BREAK_IRQ();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
295 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
296
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
297 #ifdef CYG_HAL_STARTUP_STUBS
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
298 // There may be extra initialization required when configured
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
299 // for stubs startup.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
300 HAL_STUB_PLATFORM_STUBS_INIT();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
301 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
302 }
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
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
305 // Reset the board.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
306 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
307 __reset (void)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
308 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
309 HAL_STUB_PLATFORM_RESET();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
310 }
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 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
313 // Breakpoint support.
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 #ifndef CYGPKG_HAL_ARM
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
316 // This function will generate a breakpoint exception. It is used at
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
317 // 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
318 // used otherwise as a quick means to stop program execution and
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
319 // "break" into the debugger.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
320 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
321 breakpoint()
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 HAL_BREAKPOINT(_breakinst);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
324 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
325
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
326 // This function returns the opcode for a 'trap' instruction.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
327 unsigned long
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
328 __break_opcode ()
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
329 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
330 return HAL_BREAKINST;
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 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
333
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
334 // FIXME: Add support for multiple breakpoints (libstub/bplist-dynamic.c)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
335 int __set_breakpoint (target_register_t addr) { return 0; }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
336 int __remove_breakpoint (target_register_t addr) { return 0; }
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 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
339 // 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
340 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
341 __build_t_packet (int sigval, char *buf)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
342 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
343 target_register_t addr;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
344 char *ptr = buf;
6
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents: 2
diff changeset
345 target_register_t sp;
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
346
6
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents: 2
diff changeset
347 sp = (target_register_t) get_register (SP);
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
348
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
349 *ptr++ = 'T';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
350 *ptr++ = __tohex (sigval >> 4);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
351 *ptr++ = __tohex (sigval);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
352
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
353 #ifdef CYGDBG_HAL_DEBUG_GDB_THREAD_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
354 // Include thread ID if thread manipulation is required.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
355 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
356 int id;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
357
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
358 *ptr++ = 't';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
359 *ptr++ = 'h';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
360 *ptr++ = 'r';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
361 *ptr++ = 'e';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
362 *ptr++ = 'a';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
363 *ptr++ = 'd';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
364 *ptr++ = ':';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
365
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
366 #if (CYG_BYTEORDER == CYG_MSBFIRST)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
367 id = dbg_currthread_id ();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
368 #else
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
369 // FIXME: Temporary workaround for PR 18903. Thread ID must be
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
370 // big-endian in the T packet.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
371 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
372 unsigned char* bep = (unsigned char*)&id;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
373 int be_id;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
374
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
375 be_id = dbg_currthread_id ();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
376 *bep++ = (be_id >> 24) & 0xff ;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
377 *bep++ = (be_id >> 16) & 0xff ;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
378 *bep++ = (be_id >> 8) & 0xff ;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
379 *bep++ = (be_id & 0xff) ;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
380 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
381 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
382 ptr = __mem2hex((char *)&id, ptr, sizeof(id), 0);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
383 *ptr++ = ';';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
384 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
385 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
386
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
387 *ptr++ = __tohex (PC >> 4);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
388 *ptr++ = __tohex (PC);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
389 *ptr++ = ':';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
390 addr = get_register (PC);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
391 ptr = __mem2hex((char *)&addr, ptr, sizeof(addr), 0);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
392 *ptr++ = ';';
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 *ptr++ = __tohex (SP >> 4);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
395 *ptr++ = __tohex (SP);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
396 *ptr++ = ':';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
397 ptr = __mem2hex((char *)&sp, ptr, sizeof(sp), 0);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
398 *ptr++ = ';';
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
399
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
400 *ptr++ = 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
401 }
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
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
404 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
405 // Cache functions.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
406
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
407 // Perform the specified operation on the instruction cache.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
408 // Returns 1 if the cache is enabled, 0 otherwise.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
409 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
410 __instruction_cache (cache_control_t request)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
411 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
412 int state = 1;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
413
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
414 switch (request) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
415 case CACHE_ENABLE:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
416 HAL_ICACHE_ENABLE();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
417 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
418 case CACHE_DISABLE:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
419 HAL_ICACHE_DISABLE();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
420 state = 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
421 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
422 case CACHE_FLUSH:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
423 HAL_ICACHE_SYNC();
10
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
424 #ifndef CYGPKG_HAL_MIPS
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
425 // SYNC and INVALIDATE_ALL are the same on the MIPS,
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
426 // so avoid doing it twice.
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
427 HAL_ICACHE_INVALIDATE_ALL();
10
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
428 #endif
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
429 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
430 case CACHE_NOOP:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
431 /* fall through */
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
432 default:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
433 break;
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
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
436 #ifdef HAL_ICACHE_IS_ENABLED
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
437 HAL_ICACHE_IS_ENABLED(state);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
438 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
439
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
440 return state;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
441 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
442
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
443 // Perform the specified operation on the data cache.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
444 // Returns 1 if the cache is enabled, 0 otherwise.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
445 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
446 __data_cache (cache_control_t request)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
447 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
448 int state = 1;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
449
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
450 switch (request) {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
451 case CACHE_ENABLE:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
452 HAL_DCACHE_ENABLE();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
453 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
454 case CACHE_DISABLE:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
455 HAL_DCACHE_DISABLE();
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
456 state = 0;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
457 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
458 case CACHE_FLUSH:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
459 HAL_DCACHE_SYNC();
10
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
460 #ifndef CYGPKG_HAL_MIPS
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
461 // SYNC and INVALIDATE_ALL are the same on the MIPS,
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
462 // so avoid doing it twice.
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
463 HAL_DCACHE_INVALIDATE_ALL();
10
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
464 #endif
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
465 break;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
466 case CACHE_NOOP:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
467 /* fall through */
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
468 default:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
469 break;
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 #ifdef HAL_DCACHE_IS_ENABLED
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
472 HAL_DCACHE_IS_ENABLED(state);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
473 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
474
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
475 return state;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
476 }
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 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
479 // Memory accessor functions.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
480
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
481 void *__mem_fault_handler = (void *)0;
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 /* 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
484 which are passed as globals to avoid squeezing them thru
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
485 __set_mem_fault_trap. */
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
486
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
487 static volatile target_register_t memCount;
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 static void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
490 __do_copy_mem (unsigned char* src, unsigned char* dst)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
491 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
492 __mem_fault = 1; // Defaults to 'fail'. Is cleared
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
493 // when the copy loop completes.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
494 __mem_fault_handler = &&err;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
495
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
496 while (memCount)
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 *dst++ = *src++;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
499 memCount--;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
500 }
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 __mem_fault = 0;
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 err:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
505 __mem_fault_handler = (void *)0;
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 /*
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
509 * __read_mem_safe:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
510 * Get contents of target memory, abort on error.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
511 */
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
512
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
513 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
514 __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
515 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
516 memCount = count;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
517 __do_copy_mem((unsigned char*) src, (unsigned char*) dst);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
518 return count - memCount; // return number of bytes successfully read
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
519 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
520
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
521 /*
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
522 * __write_mem_safe:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
523 * Set contents of target memory, abort on error.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
524 */
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
525
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
526 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
527 __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
528 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
529 memCount = count;
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
530 __do_copy_mem((unsigned char*) src, (unsigned char*) dst);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
531 return count - memCount; // return number of bytes successfully written
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
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
534 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
535 // Target extras?!
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
536 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
537 __process_target_query(char * pkt, char * out, int maxOut)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
538 { return 0 ; }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
539 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
540 __process_target_set(char * pkt, char * out, int maxout)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
541 { return 0 ; }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
542 int
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
543 __process_target_packet(char * pkt, char * out, int maxout)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
544 { return 0 ; }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
545
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
546 // GDB string output, making sure interrupts are disabled.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
547 // This function gets used by some diag output functions.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
548 void
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
549 hal_output_gdb_string(target_register_t str, int string_len)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
550 {
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
551 unsigned long __state;
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 6
diff changeset
552 HAL_DISABLE_INTERRUPTS(__state);
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
553 __output_gdb_string(str, string_len);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
554 HAL_RESTORE_INTERRUPTS(__state);
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
555 }
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
556
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents:
diff changeset
557 #endif // CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS