Mercurial > ecos
annotate packages/hal/common/current/src/generic-stub.c @ 208:e0c0827131d1 ecos
Merge from eCos master repository on 2002-05-20-20:11:54-BST
| author | jlarmour |
|---|---|
| date | Mon, 20 May 2002 22:19:26 +0000 |
| parents | ea3f0bd33a73 |
| children | 4882695334f2 |
| rev | line source |
|---|---|
| 2 | 1 #include "board.h" |
| 2 | |
| 3 #ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS | |
| 4 | |
| 5 /* Eventually, this should default to ON */ | |
| 6 #if USE_GDBSTUB_PROTOTYPES | |
| 7 #include "stub-tservice.h" | |
| 8 #include "generic-stub.h" | |
| 9 #else | |
| 10 // Function declarations (prevents compiler warnings) | |
| 11 int stubhex (unsigned char ch); | |
| 12 static void unlock_thread_scheduler (void); | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
13 static uint32 crc32 (target_addr_t mem, int len, uint32 crc); |
| 2 | 14 #endif |
| 15 | |
| 16 #include "thread-pkts.h" | |
| 17 /* Defines function macros if thread support is not selected in board.h */ | |
| 18 | |
|
145
2e9a636d9de9
Merge from eCos master repository on 2000-12-21-14:18:40-GMT
jlarmour
parents:
138
diff
changeset
|
19 #ifdef __ECOS__ |
|
2e9a636d9de9
Merge from eCos master repository on 2000-12-21-14:18:40-GMT
jlarmour
parents:
138
diff
changeset
|
20 char GDB_stubs_version[] CYGBLD_ATTRIB_WEAK = |
|
2e9a636d9de9
Merge from eCos master repository on 2000-12-21-14:18:40-GMT
jlarmour
parents:
138
diff
changeset
|
21 "eCos GDB stubs - built " __DATE__ " / " __TIME__; |
|
2e9a636d9de9
Merge from eCos master repository on 2000-12-21-14:18:40-GMT
jlarmour
parents:
138
diff
changeset
|
22 #endif |
| 2 | 23 |
| 0 | 24 /**************************************************************************** |
| 25 | |
| 2 | 26 THIS SOFTWARE IS NOT COPYRIGHTED |
| 0 | 27 |
| 28 HP offers the following for use in the public domain. HP makes no | |
| 29 warranty with regard to the software or it's performance and the | |
| 30 user accepts the software "AS IS" with all faults. | |
| 31 | |
| 32 HP DISCLAIMS ANY WARRANTIES, EXPRESS OR IMPLIED, WITH REGARD | |
| 33 TO THIS SOFTWARE INCLUDING BUT NOT LIMITED TO THE WARRANTIES | |
| 34 OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. | |
| 35 | |
| 36 ****************************************************************************/ | |
| 37 | |
| 38 /**************************************************************************** | |
| 39 * Header: remcom.c,v 1.34 91/03/09 12:29:49 glenne Exp $ | |
| 40 * | |
| 41 * Module name: remcom.c $ | |
| 42 * Revision: 1.34 $ | |
| 43 * Date: 91/03/09 12:29:49 $ | |
| 44 * Contributor: Lake Stevens Instrument Division$ | |
| 45 * | |
| 46 * Description: low level support for gdb debugger. $ | |
| 47 * | |
| 48 * Considerations: only works on target hardware $ | |
| 49 * | |
| 50 * Written by: Glenn Engel $ | |
| 51 * ModuleState: Experimental $ | |
| 52 * | |
| 53 * NOTES: See Below $ | |
| 54 * | |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
48
diff
changeset
|
55 * Modified for SPARC by Stu Grossman, Red Hat. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
48
diff
changeset
|
56 * Modified for generic CygMON stub support by Bob Manson, Red Hat. |
| 0 | 57 * |
| 58 * To enable debugger support, two things need to happen. One, a | |
| 2 | 59 * call to set_debug_traps () is necessary in order to allow any breakpoints |
| 0 | 60 * or error conditions to be properly intercepted and reported to gdb. |
| 61 * Two, a breakpoint needs to be generated to begin communication. This | |
| 2 | 62 * is most easily accomplished by a call to breakpoint (). Breakpoint () |
| 0 | 63 * simulates a breakpoint by executing a trap #1. |
| 64 * | |
| 65 ************* | |
| 66 * | |
| 67 * The following gdb commands are supported: | |
| 68 * | |
| 69 * command function Return value | |
| 70 * | |
| 71 * g return the value of the CPU registers hex data or ENN | |
| 72 * G set the value of the CPU registers OK or ENN | |
| 73 * | |
| 74 * mAA..AA,LLLL Read LLLL bytes at address AA..AA hex data or ENN | |
| 75 * MAA..AA,LLLL: Write LLLL bytes at address AA.AA OK or ENN | |
| 76 * | |
| 77 * c Resume at current address SNN ( signal NN) | |
| 78 * cAA..AA Continue at address AA..AA SNN | |
| 79 * | |
| 80 * s Step one instruction SNN | |
| 81 * sAA..AA Step one instruction from AA..AA SNN | |
| 82 * | |
| 83 * k kill | |
| 84 * | |
| 85 * ? What was the last sigval ? SNN (signal NN) | |
| 86 * | |
| 2 | 87 * bBB..BB Set baud rate to BB..BB OK or BNN, then sets |
| 88 * baud rate | |
| 0 | 89 * |
| 90 * All commands and responses are sent with a packet which includes a | |
| 91 * checksum. A packet consists of | |
| 92 * | |
| 93 * $<packet info>#<checksum>. | |
| 94 * | |
| 95 * where | |
| 96 * <packet info> :: <characters representing the command or response> | |
| 97 * <checksum> :: < two hex digits computed as modulo 256 sum of <packetinfo>> | |
| 98 * | |
| 99 * When a packet is received, it is first acknowledged with either '+' or '-'. | |
| 100 * '+' indicates a successful transfer. '-' indicates a failed transfer. | |
| 101 * | |
| 102 * Example: | |
| 103 * | |
| 104 * Host: Reply: | |
| 105 * $m0,10#2a +$00010203040506070809101112131415#42 | |
| 106 * | |
| 107 ****************************************************************************/ | |
| 108 | |
|
48
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
109 #ifdef __ECOS__ |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
110 |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
111 // We cannot share memcpy and memset with the rest of the system since |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
112 // the user may want to step through it. |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
113 static inline void* |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
114 _memcpy(void* dest, void* src, int size) |
|
48
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
115 { |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
116 unsigned char* __d = (unsigned char*) dest; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
117 unsigned char* __s = (unsigned char*) src; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
118 |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
119 while(size--) |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
120 *__d++ = *__s++; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
121 |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
122 return dest; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
123 } |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
124 |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
125 static inline void* |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
126 _memset(void* s, int c, int size) |
|
48
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
127 { |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
128 unsigned char* __s = (unsigned char*) s; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
129 unsigned char __c = (unsigned char) c; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
130 |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
131 while(size--) |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
132 *__s++ = __c; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
133 |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
134 return s; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
135 } |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
136 |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
137 #else |
| 2 | 138 #include <string.h> |
| 139 #include <signal.h> | |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
140 #define _memcpy memcpy |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
141 #define _memset memset |
| 2 | 142 #endif // __ECOS__ |
| 0 | 143 |
| 144 /************************************************************************/ | |
| 145 /* BUFMAX defines the maximum number of characters in inbound/outbound buffers*/ | |
| 146 /* at least NUMREGBYTES*2 are needed for register packets */ | |
|
163
0d2b193a635f
Merge from eCos master repository on 2001-06-22-17:38:39-BST
jlarmour
parents:
162
diff
changeset
|
147 #ifdef __ECOS__ |
|
0d2b193a635f
Merge from eCos master repository on 2001-06-22-17:38:39-BST
jlarmour
parents:
162
diff
changeset
|
148 #ifdef NUMREGBYTES |
|
0d2b193a635f
Merge from eCos master repository on 2001-06-22-17:38:39-BST
jlarmour
parents:
162
diff
changeset
|
149 #define BUFMAX (32 + (NUMREGBYTES*2)) |
|
0d2b193a635f
Merge from eCos master repository on 2001-06-22-17:38:39-BST
jlarmour
parents:
162
diff
changeset
|
150 #else |
| 0 | 151 #define BUFMAX 2048 |
|
163
0d2b193a635f
Merge from eCos master repository on 2001-06-22-17:38:39-BST
jlarmour
parents:
162
diff
changeset
|
152 #endif |
|
0d2b193a635f
Merge from eCos master repository on 2001-06-22-17:38:39-BST
jlarmour
parents:
162
diff
changeset
|
153 #else |
|
0d2b193a635f
Merge from eCos master repository on 2001-06-22-17:38:39-BST
jlarmour
parents:
162
diff
changeset
|
154 #define BUFMAX 2048 |
|
0d2b193a635f
Merge from eCos master repository on 2001-06-22-17:38:39-BST
jlarmour
parents:
162
diff
changeset
|
155 #endif |
| 0 | 156 |
| 2 | 157 static int initialized = 0; /* !0 means we've been initialized */ |
| 158 | |
| 0 | 159 static int process_exception (int sigval); |
| 160 static void do_nothing (void); /* and do it gracefully */ | |
| 161 static int syscall_do_nothing (int); | |
| 2 | 162 |
| 163 void __free_program_args (void); | |
| 0 | 164 |
| 165 volatile __PFI __process_exception_vec = process_exception; | |
| 166 volatile __PFV __process_exit_vec = do_nothing; | |
| 167 volatile __PFI __process_syscall_vec = syscall_do_nothing; | |
| 168 volatile __PFI __process_signal_vec = NULL; | |
| 2 | 169 volatile __PFV __init_vec = NULL; |
| 170 volatile __PFV __cleanup_vec = NULL; | |
| 171 | |
| 172 static char *__add_program_arg (int argnum, uint32 arglen); | |
| 0 | 173 |
| 174 static const char hexchars[] = "0123456789abcdef"; | |
| 175 | |
| 2 | 176 static void process_query (char *pkt); |
| 177 static void process_set (char *pkt); | |
| 0 | 178 |
| 179 char | |
| 180 __tohex (int c) | |
| 181 { | |
| 182 return hexchars [c & 15]; | |
| 183 } | |
| 184 | |
| 2 | 185 #define __tohex(c) hexchars[(c) & 15] |
| 0 | 186 |
| 187 #ifndef NUMREGS_GDB | |
| 188 #define NUMREGS_GDB NUMREGS | |
| 189 #endif | |
| 190 | |
| 191 /* One pushback character. */ | |
| 192 int ungot_char = -1; | |
| 193 | |
| 194 static int | |
| 195 readDebugChar (void) | |
| 196 { | |
| 197 if (ungot_char > 0) | |
| 198 { | |
| 199 int result = ungot_char; | |
| 200 ungot_char = -1; | |
| 201 return result; | |
| 202 } | |
| 203 else | |
| 204 return getDebugChar (); | |
| 205 } | |
| 206 | |
| 207 /* Convert ch from a hex digit to an int. */ | |
| 208 | |
| 209 int | |
| 2 | 210 stubhex (ch) |
| 211 unsigned char ch; | |
| 0 | 212 { |
| 213 if (ch >= 'a' && ch <= 'f') | |
| 214 return ch-'a'+10; | |
| 215 if (ch >= '0' && ch <= '9') | |
| 216 return ch-'0'; | |
| 217 if (ch >= 'A' && ch <= 'F') | |
| 218 return ch-'A'+10; | |
| 219 return -1; | |
| 220 } | |
| 221 | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
222 void |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
223 __getpacket (buffer) |
| 2 | 224 char *buffer; |
| 0 | 225 { |
|
184
022f1e506033
Merge from eCos master repository on 2001-10-02-17:59:22-BST
jlarmour
parents:
182
diff
changeset
|
226 struct gdb_packet packet; |
|
022f1e506033
Merge from eCos master repository on 2001-10-02-17:59:22-BST
jlarmour
parents:
182
diff
changeset
|
227 int res; |
| 0 | 228 |
|
184
022f1e506033
Merge from eCos master repository on 2001-10-02-17:59:22-BST
jlarmour
parents:
182
diff
changeset
|
229 packet.state = 0; |
|
022f1e506033
Merge from eCos master repository on 2001-10-02-17:59:22-BST
jlarmour
parents:
182
diff
changeset
|
230 packet.contents = buffer; |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
231 packet.err = 0; |
|
184
022f1e506033
Merge from eCos master repository on 2001-10-02-17:59:22-BST
jlarmour
parents:
182
diff
changeset
|
232 while ((res = __add_char_to_packet (readDebugChar () & 0xff, &packet)) != 1) { |
|
022f1e506033
Merge from eCos master repository on 2001-10-02-17:59:22-BST
jlarmour
parents:
182
diff
changeset
|
233 if (res == -2) { |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
234 putDebugChar ('-'); // Tell host packet was not processed |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
235 // Reset for the next packet |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
236 packet.state = 0; |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
237 packet.err = 0; |
|
184
022f1e506033
Merge from eCos master repository on 2001-10-02-17:59:22-BST
jlarmour
parents:
182
diff
changeset
|
238 } |
| 0 | 239 } |
| 240 } | |
| 241 | |
| 242 int | |
| 2 | 243 __add_char_to_packet (ch, packet) |
| 244 unsigned int ch; | |
| 245 struct gdb_packet *packet; | |
| 0 | 246 { |
| 247 if (packet->state == 0) | |
| 248 { | |
| 249 if (ch == '$') | |
| 2 | 250 { |
| 251 packet->state = 1; | |
| 252 packet->length = 0; | |
| 253 packet->checksum = 0; | |
| 254 packet->xmitcsum = -1; | |
| 255 } | |
| 0 | 256 return 0; |
| 257 } | |
| 258 | |
| 259 if (packet->state == 1) | |
| 260 { | |
|
198
ea3f0bd33a73
Merge from eCos master repository on 2001-12-07-11:40:47-GMT
jlarmour
parents:
196
diff
changeset
|
261 if (packet->length == BUFMAX) |
|
ea3f0bd33a73
Merge from eCos master repository on 2001-12-07-11:40:47-GMT
jlarmour
parents:
196
diff
changeset
|
262 { |
|
ea3f0bd33a73
Merge from eCos master repository on 2001-12-07-11:40:47-GMT
jlarmour
parents:
196
diff
changeset
|
263 packet->state = 0; |
|
ea3f0bd33a73
Merge from eCos master repository on 2001-12-07-11:40:47-GMT
jlarmour
parents:
196
diff
changeset
|
264 packet->err = 1; |
|
ea3f0bd33a73
Merge from eCos master repository on 2001-12-07-11:40:47-GMT
jlarmour
parents:
196
diff
changeset
|
265 } |
|
ea3f0bd33a73
Merge from eCos master repository on 2001-12-07-11:40:47-GMT
jlarmour
parents:
196
diff
changeset
|
266 else if (ch == '#') |
| 2 | 267 { |
| 268 packet->contents[packet->length] = 0; | |
| 269 packet->state = 2; | |
| 270 } | |
|
198
ea3f0bd33a73
Merge from eCos master repository on 2001-12-07-11:40:47-GMT
jlarmour
parents:
196
diff
changeset
|
271 else |
| 2 | 272 { |
|
198
ea3f0bd33a73
Merge from eCos master repository on 2001-12-07-11:40:47-GMT
jlarmour
parents:
196
diff
changeset
|
273 packet->checksum += ch; |
|
ea3f0bd33a73
Merge from eCos master repository on 2001-12-07-11:40:47-GMT
jlarmour
parents:
196
diff
changeset
|
274 packet->contents[packet->length++] = ch; |
| 2 | 275 } |
| 0 | 276 return 0; |
| 277 } | |
| 278 | |
| 279 if (packet->state == 2) | |
| 280 { | |
| 281 packet->xmitcsum = stubhex (ch) << 4; | |
| 282 packet->state = 3; | |
| 283 return 0; | |
| 284 } | |
| 285 | |
| 286 if (packet->state == 3) | |
| 287 { | |
| 2 | 288 packet->xmitcsum |= stubhex (ch); |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
289 if (packet->err) { |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
290 // Packet was too long - just tell the consumer |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
291 return -2; |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
292 } |
| 0 | 293 if ((packet->checksum & 255) != packet->xmitcsum) |
| 2 | 294 { |
| 295 putDebugChar ('-'); /* failed checksum */ | |
| 296 packet->state = 0; | |
| 297 return -1; | |
| 298 } | |
| 0 | 299 else |
| 2 | 300 { |
| 301 putDebugChar ('+'); /* successful transfer */ | |
| 302 /* if a sequence char is present, reply the sequence ID */ | |
| 303 if (packet->contents[2] == ':') | |
| 304 { | |
| 305 uint32 count = packet->length; | |
| 306 uint32 i; | |
| 307 putDebugChar (packet->contents[0]); | |
| 308 putDebugChar (packet->contents[1]); | |
| 309 /* remove sequence chars from buffer */ | |
| 310 for (i=3; i <= count; i++) | |
| 311 packet->contents[i-3] = packet->contents[i]; | |
| 312 } | |
| 313 return 1; | |
| 314 } | |
| 0 | 315 } |
| 316 /* We should never get here. */ | |
| 317 packet->state = 0; | |
| 318 return -1; | |
| 319 } | |
| 320 | |
| 321 /* send the packet in buffer. */ | |
| 322 | |
| 2 | 323 void |
| 324 __putpacket (buffer) | |
| 325 char *buffer; | |
| 0 | 326 { |
| 327 unsigned char checksum; | |
| 2 | 328 uint32 count; |
| 0 | 329 unsigned char ch; |
| 330 | |
| 331 /* $<packet info>#<checksum>. */ | |
| 332 do | |
| 333 { | |
| 334 putDebugChar ('$'); | |
| 335 checksum = 0; | |
| 336 count = 0; | |
| 337 | |
| 338 while ((ch = buffer[count])) | |
| 2 | 339 { |
| 340 putDebugChar (ch); | |
| 341 checksum += ch; | |
| 342 count += 1; | |
| 343 } | |
| 0 | 344 |
| 345 putDebugChar ('#'); | |
| 346 putDebugChar (hexchars[(checksum >> 4) & 0xf]); | |
| 347 putDebugChar (hexchars[checksum & 0xf]); | |
| 348 | |
| 349 } | |
| 350 while ((readDebugChar () & 0x7f) != '+'); | |
| 351 } | |
| 352 | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
353 char __remcomInBuffer[BUFMAX]; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
354 char __remcomOutBuffer[BUFMAX]; |
| 0 | 355 |
| 356 /* Indicate to caller of mem2hex or hex2mem that there has been an | |
| 357 error. */ | |
| 358 volatile int __mem_fault = 0; | |
| 359 | |
| 2 | 360 |
| 361 #ifndef TARGET_HAS_OWN_MEM_FUNCS | |
| 362 /* | |
| 363 * _target_readmem_hook / _target_writemem_hook: | |
| 364 * Allow target to get involved in reading/writing memory. | |
| 365 * | |
| 366 * If these hooks are defined by the target, they will be | |
| 367 * called for each user program memory access. Otherwise, the stub | |
| 368 * will simply dereference a pointer to access user program memory. | |
| 369 */ | |
| 370 | |
| 371 unsigned char (*_target_readmem_hook) (unsigned char* addr); | |
| 372 void (*_target_writemem_hook) (unsigned char* addr, | |
| 373 unsigned char value); | |
| 374 | |
| 375 static unsigned char | |
| 376 get_target_byte (volatile unsigned char *address) | |
| 0 | 377 { |
| 2 | 378 if (_target_readmem_hook) /* target needs to control memory access */ |
| 379 return _target_readmem_hook ((unsigned char *) address); | |
| 380 else | |
| 381 return *address; | |
| 382 } | |
| 383 | |
| 384 static void | |
| 385 put_target_byte (volatile unsigned char *address, unsigned char value) | |
| 386 { | |
| 387 if (_target_writemem_hook) /* target needs to control memory access */ | |
| 388 _target_writemem_hook ((unsigned char *) address, value); | |
| 389 else | |
| 390 *address = value; | |
| 391 } | |
| 392 | |
| 393 /* These are the "arguments" to __do_read_mem and __do_write_mem, | |
| 394 which are passed as globals to avoid squeezing them thru | |
| 395 __set_mem_fault_trap. */ | |
| 396 | |
| 397 static volatile target_register_t memCount; | |
| 398 static volatile unsigned char *memSrc, *memDst; | |
| 0 | 399 |
| 2 | 400 /* |
| 401 * __do_read_mem: | |
| 402 * Copy from target memory to trusted memory. | |
| 403 */ | |
| 404 | |
| 405 static void | |
| 406 __do_read_mem (void) | |
| 407 { | |
| 408 __mem_fault = 0; | |
| 409 while (memCount) | |
| 410 { | |
| 411 unsigned char ch = get_target_byte (memSrc++); | |
| 412 | |
| 413 if (__mem_fault) | |
| 414 return; | |
| 415 *memDst++ = ch; | |
| 416 memCount--; | |
| 417 } | |
| 0 | 418 } |
| 419 | |
| 2 | 420 /* |
| 421 * __do_write_mem: | |
| 422 * Copy from trusted memory to target memory. | |
| 423 */ | |
| 424 | |
| 425 static void | |
| 426 __do_write_mem (void) | |
| 427 { | |
| 428 __mem_fault = 0; | |
| 429 while (memCount) | |
| 430 { | |
| 431 unsigned char ch = *memSrc++; | |
| 432 | |
| 433 put_target_byte (memDst++, ch); | |
| 434 if (__mem_fault) | |
| 435 return; | |
| 436 memCount--; | |
| 437 } | |
| 438 } | |
| 439 | |
| 440 /* | |
| 441 * __read_mem_safe: | |
| 442 * Get contents of target memory, abort on error. | |
| 443 */ | |
| 444 | |
| 0 | 445 int |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
446 __read_mem_safe (void *dst, target_register_t src, int count) |
| 0 | 447 { |
| 2 | 448 memCount = count; |
| 449 memSrc = (unsigned char *) src; | |
| 450 memDst = (unsigned char *) dst; | |
| 451 __set_mem_fault_trap (__do_read_mem); | |
| 452 return count - memCount; /* return number of bytes successfully read */ | |
| 0 | 453 } |
| 454 | |
| 2 | 455 /* |
| 456 * __write_mem_safe: | |
| 457 * Set contents of target memory, abort on error. | |
| 458 */ | |
| 459 | |
| 0 | 460 int |
| 461 __write_mem_safe (unsigned char *src, target_register_t dst, int count) | |
| 462 { | |
| 2 | 463 memCount = count; |
| 464 memSrc = (unsigned char *) src; | |
| 465 memDst = (unsigned char *) dst; | |
| 466 __set_mem_fault_trap (__do_write_mem); | |
| 467 return count - memCount; /* return number of bytes successfully read */ | |
| 0 | 468 } |
| 469 | |
| 2 | 470 #endif /* TARGET_HAS_OWN_MEM_FUNCS */ |
| 471 | |
| 472 /* These are the "arguments" to __mem2hex_helper and __hex2mem_helper, | |
| 473 which are passed as globals to avoid squeezing them thru | |
| 474 __set_mem_fault_trap. */ | |
| 475 | |
| 476 static int hexMemCount; | |
| 477 static char *hexMemSrc, *hexMemDst; | |
| 478 static int may_fault_mode; | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
479 #ifdef TARGET_HAS_HARVARD_MEMORY |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
480 static int progMem; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
481 #endif |
| 2 | 482 |
| 483 /* Hamburger helper? */ | |
| 484 static void | |
| 485 __mem2hex_helper (void) | |
| 486 { | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
487 union { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
488 unsigned long long_val; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
489 unsigned char bytes[sizeof(long)]; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
490 } val; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
491 int len, i; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
492 unsigned char ch; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
493 __mem_fault = 0; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
494 while (hexMemCount > 0) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
495 if (may_fault_mode) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
496 if ((hexMemCount >= sizeof(long)) && |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
497 (((target_register_t)hexMemSrc & (sizeof(long)-1)) == 0)) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
498 // Should be safe to access via a long |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
499 len = sizeof(long); |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
500 } else if ((hexMemCount >= sizeof(short)) && |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
501 (((target_register_t)hexMemSrc & (sizeof(short)-1)) == 0)) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
502 // Should be safe to access via a short |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
503 len = sizeof(short); |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
504 } else { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
505 len = 1; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
506 } |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
507 #ifdef TARGET_HAS_HARVARD_MEMORY |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
508 if (progMem) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
509 __read_progmem_safe(&val.bytes[0], hexMemSrc, len); |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
510 else |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
511 #endif |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
512 __read_mem_safe(&val.bytes[0], hexMemSrc, len); |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
513 } else { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
514 len = 1; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
515 val.bytes[0] = *hexMemSrc; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
516 } |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
517 if (__mem_fault) |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
518 return; |
| 2 | 519 |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
520 for (i = 0; i < len; i++) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
521 ch = val.bytes[i]; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
522 *(hexMemDst++) = hexchars[(ch >> 4) & 0xf]; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
523 if (__mem_fault) |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
524 return; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
525 *(hexMemDst++) = hexchars[ch & 0xf]; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
526 if (__mem_fault) |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
527 return; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
528 } |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
529 hexMemCount -= len; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
530 hexMemSrc += len; |
| 2 | 531 } |
| 532 } | |
| 533 | |
| 534 /* Convert the memory pointed to by MEM into HEX, placing result in BUF. | |
| 535 * Return a pointer to the last char put in buf (NUL). In case of a memory | |
| 536 * fault, return 0. | |
| 0 | 537 * If MAY_FAULT is non-zero, then we will handle memory faults by returning |
| 2 | 538 * a 0 (and assume that MEM is a pointer into the user program), else we |
| 539 * treat a fault like any other fault in the stub (and assume that MEM is | |
| 540 * a pointer into the stub's memory). | |
| 0 | 541 */ |
| 542 | |
| 2 | 543 char * |
| 544 __mem2hex (mem, buf, count, may_fault) | |
| 545 char *mem; | |
| 546 char *buf; | |
| 0 | 547 int count; |
| 548 int may_fault; | |
| 549 { | |
| 2 | 550 hexMemDst = (unsigned char *) buf; |
| 551 hexMemSrc = (unsigned char *) mem; | |
| 552 hexMemCount = count; | |
| 553 may_fault_mode = may_fault; | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
554 #ifdef TARGET_HAS_HARVARD_MEMORY |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
555 progMem = 0; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
556 #endif |
| 2 | 557 |
| 558 if (may_fault) | |
| 0 | 559 { |
| 2 | 560 if (__set_mem_fault_trap (__mem2hex_helper)) |
| 561 return 0; | |
| 0 | 562 } |
| 2 | 563 else |
| 564 __mem2hex_helper (); | |
| 0 | 565 |
| 2 | 566 *hexMemDst = 0; |
| 0 | 567 |
| 2 | 568 return (char *) hexMemDst; |
| 0 | 569 } |
| 570 | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
571 /* Convert the target memory identified by MEM into HEX, placing result in BUF. |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
572 * Return a pointer to the last char put in buf (NUL). In case of a memory |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
573 * fault, return 0. |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
574 */ |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
575 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
576 static char * |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
577 __mem2hex_safe (target_addr_t mem, char *buf, int count) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
578 { |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
579 hexMemDst = (unsigned char *) buf; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
580 hexMemSrc = (unsigned char *) TARGET_ADDR_TO_PTR(mem); |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
581 hexMemCount = count; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
582 may_fault_mode = 1; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
583 #ifdef TARGET_HAS_HARVARD_MEMORY |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
584 progMem = TARGET_ADDR_IS_PROGMEM(mem); |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
585 #endif |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
586 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
587 if (__set_mem_fault_trap (__mem2hex_helper)) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
588 return 0; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
589 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
590 *hexMemDst = 0; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
591 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
592 return (char *) hexMemDst; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
593 } |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
594 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
595 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
596 |
| 2 | 597 static void |
| 598 __hex2mem_helper (void) | |
| 0 | 599 { |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
600 union { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
601 unsigned long long_val; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
602 unsigned char bytes[sizeof(long)]; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
603 } val; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
604 int len, i; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
605 unsigned char ch = '\0'; |
| 0 | 606 |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
607 __mem_fault = 0; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
608 while (hexMemCount > 0 && *hexMemSrc) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
609 if (may_fault_mode) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
610 if ((hexMemCount >= sizeof(long)) && |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
611 (((target_register_t)hexMemDst & (sizeof(long)-1)) == 0)) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
612 len = sizeof(long); |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
613 } else if ((hexMemCount >= sizeof(short)) && |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
614 (((target_register_t)hexMemDst & (sizeof(short)-1)) == 0)) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
615 len = sizeof(short); |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
616 } else { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
617 len = 1; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
618 } |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
619 } else { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
620 len = 1; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
621 } |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
622 |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
623 for (i = 0; i < len; i++) { |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
624 // Check for short data? |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
625 ch = stubhex (*(hexMemSrc++)) << 4; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
626 if (__mem_fault) |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
627 return; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
628 ch |= stubhex (*(hexMemSrc++)); |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
629 if (__mem_fault) |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
630 return; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
631 val.bytes[i] = ch; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
632 } |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
633 |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
634 if (may_fault_mode) { |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
635 #ifdef TARGET_HAS_HARVARD_MEMORY |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
636 if (progMem) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
637 __write_progmem_safe (&val.bytes[0], hexMemDst, len); |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
638 else |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
639 #endif |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
640 __write_mem_safe (&val.bytes[0], hexMemDst, len); |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
641 } else |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
642 *hexMemDst = ch; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
643 |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
644 if (__mem_fault) |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
645 return; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
646 hexMemCount -= len; |
|
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
647 hexMemDst += len; |
| 0 | 648 } |
| 2 | 649 } |
| 650 | |
| 651 /* Convert COUNT bytes of the hex array pointed to by BUF into binary | |
| 652 to be placed in MEM. Return a pointer to the character AFTER the | |
| 653 last byte written. | |
| 654 | |
| 655 If MAY_FAULT is set, we will return a non-zero value if a memory | |
| 656 fault occurs (and we assume that MEM is a pointer into the user | |
| 657 program). Otherwise, we will take a trap just like any other memory | |
| 658 fault (and assume that MEM points into the stub's memory). */ | |
| 0 | 659 |
| 2 | 660 char * |
| 661 __hex2mem (buf, mem, count, may_fault) | |
| 662 char *buf; | |
| 663 char *mem; | |
| 664 int count; | |
| 665 int may_fault; | |
| 666 { | |
| 667 hexMemSrc = (unsigned char *) buf; | |
| 668 hexMemDst = (unsigned char *) mem; | |
| 669 hexMemCount = count; | |
| 670 may_fault_mode = may_fault; | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
671 #ifdef TARGET_HAS_HARVARD_MEMORY |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
672 progMem = 0; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
673 #endif |
| 0 | 674 |
| 2 | 675 if (may_fault) |
| 676 { | |
| 677 if (__set_mem_fault_trap (__hex2mem_helper)) | |
| 678 return 0; | |
| 679 } | |
| 680 else | |
| 681 __hex2mem_helper (); | |
| 682 | |
| 683 return (char *) hexMemDst; | |
| 684 } | |
| 685 | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
686 /* Convert COUNT bytes of the hex array pointed to by BUF into binary |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
687 to be placed in target MEM. Return a pointer to the character AFTER |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
688 the last byte written. |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
689 */ |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
690 char * |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
691 __hex2mem_safe (char *buf, target_addr_t mem, int count) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
692 { |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
693 hexMemSrc = (unsigned char *) buf; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
694 hexMemDst = (unsigned char *) TARGET_ADDR_TO_PTR(mem); |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
695 hexMemCount = count; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
696 may_fault_mode = 1; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
697 #ifdef TARGET_HAS_HARVARD_MEMORY |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
698 progMem = TARGET_ADDR_IS_PROGMEM(mem); |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
699 #endif |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
700 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
701 if (__set_mem_fault_trap (__hex2mem_helper)) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
702 return 0; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
703 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
704 return (char *) hexMemDst; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
705 } |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
706 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
707 |
| 2 | 708 void |
| 709 set_debug_traps (void) | |
| 710 { | |
| 711 __install_traps (); | |
| 712 initialized = 1; /* FIXME: Change this to dbg_stub_initialized */ | |
| 0 | 713 } |
| 714 | |
| 715 /* | |
| 716 * While we find nice hex chars, build an int. | |
| 717 * Return number of chars processed. | |
| 718 */ | |
| 719 | |
| 2 | 720 unsigned int |
| 721 __hexToInt (char **ptr, target_register_t *intValue) | |
| 0 | 722 { |
| 723 int numChars = 0; | |
| 724 int hexValue; | |
| 725 | |
| 726 *intValue = 0; | |
| 727 | |
| 728 while (**ptr) | |
| 729 { | |
| 2 | 730 hexValue = stubhex (**ptr); |
| 0 | 731 if (hexValue < 0) |
| 2 | 732 break; |
| 0 | 733 |
| 734 *intValue = (*intValue << 4) | hexValue; | |
| 735 numChars ++; | |
| 736 | |
| 737 (*ptr)++; | |
| 738 } | |
| 739 | |
| 740 return (numChars); | |
| 741 } | |
| 742 | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
743 /* |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
744 * While we find nice hex chars, build a target memory address. |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
745 * Return number of chars processed. |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
746 */ |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
747 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
748 unsigned int |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
749 __hexToAddr (char **ptr, target_addr_t *val) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
750 { |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
751 int numChars = 0; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
752 int hexValue; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
753 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
754 *val = 0; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
755 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
756 while (**ptr) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
757 { |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
758 hexValue = stubhex (**ptr); |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
759 if (hexValue < 0) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
760 break; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
761 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
762 *val = (*val << 4) | hexValue; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
763 numChars ++; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
764 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
765 (*ptr)++; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
766 } |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
767 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
768 return (numChars); |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
769 } |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
770 |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
771 |
| 0 | 772 /* |
| 773 * Complement of __hexToInt: take an int of size "numBits", | |
| 774 * convert it to a hex string. Return length of (unterminated) output. | |
| 775 */ | |
| 776 | |
| 777 unsigned int | |
| 778 __intToHex (char *ptr, target_register_t intValue, int numBits) | |
| 779 { | |
| 780 int numChars = 0; | |
| 781 | |
| 782 if (intValue == 0) | |
| 783 { | |
| 784 *(ptr++) = '0'; | |
| 785 *(ptr++) = '0'; | |
| 786 return 2; | |
| 787 } | |
| 788 | |
| 789 numBits = (numBits + 7) / 8; | |
| 790 while (numBits) | |
| 791 { | |
| 792 int v = (intValue >> ((numBits - 1) * 8)); | |
| 793 if (v || (numBits == 1)) | |
| 2 | 794 { |
| 795 v = v & 255; | |
| 796 *(ptr++) = __tohex ((v / 16) & 15); | |
| 797 *(ptr++) = __tohex (v & 15); | |
| 798 numChars += 2; | |
| 799 } | |
| 0 | 800 numBits--; |
| 801 } | |
| 802 | |
| 803 return (numChars); | |
| 804 } | |
| 805 | |
| 2 | 806 #if DEBUG_THREADS |
| 807 /* | |
| 808 * Kernel Thread Control | |
| 809 * | |
| 810 * If the current thread is set to other than zero (or minus one), | |
| 811 * then ask the kernel to lock it's scheduler so that only that thread | |
| 812 * can run. | |
| 813 */ | |
| 814 | |
| 815 static unsigned char did_lock_scheduler = 0; | |
| 816 static unsigned char did_disable_interrupts = 0; | |
| 817 | |
| 818 /* Pointer to "kernel call" for scheduler control */ | |
| 819 static int (*schedlock_fn) (int, int, long) = stub_lock_scheduler; | |
| 820 | |
| 821 /* Pointer to target stub call for disabling interrupts. | |
| 822 Target stub will initialize this if it can. */ | |
| 823 int (*__disable_interrupts_hook) (int); /* don't initialize here! */ | |
| 824 #endif | |
| 825 | |
| 826 static void | |
| 827 lock_thread_scheduler (int kind) /* "step" or "continue" */ | |
| 828 { | |
| 829 #if DEBUG_THREADS | |
| 830 int ret = 0; | |
| 831 | |
| 832 /* GDB will signal its desire to run a single thread | |
| 833 by setting _gdb_cont_thread to non-zero / non-negative. */ | |
| 834 if (_gdb_cont_thread <= 0) | |
| 835 return; | |
| 836 | |
| 837 if (schedlock_fn) /* kernel call */ | |
| 838 ret = (*schedlock_fn) (1, kind, _gdb_cont_thread); | |
| 839 | |
| 840 if (ret == 1) | |
| 841 { | |
| 842 did_lock_scheduler = 1; | |
| 843 return; | |
| 844 } | |
| 845 | |
| 846 if (schedlock_fn == 0 || /* no kernel scheduler call */ | |
| 847 ret == -1) /* kernel asks stub to handle it */ | |
| 848 if (__disable_interrupts_hook) /* target stub has capability */ | |
| 849 if ((*__disable_interrupts_hook) (1)) | |
| 850 { | |
| 851 did_disable_interrupts = 1; | |
| 852 return; | |
| 853 } | |
| 854 #endif /* DEBUG_THREADS */ | |
| 855 } | |
| 856 | |
| 857 static void | |
| 858 unlock_thread_scheduler () | |
| 859 { | |
| 860 #if DEBUG_THREADS | |
| 861 if (did_lock_scheduler) | |
| 862 if (schedlock_fn) /* kernel call */ | |
| 863 { | |
| 864 (*schedlock_fn) (0, 0, _gdb_cont_thread); | |
| 865 /* I could check the return value, but | |
| 866 what would I do if it failed??? */ | |
| 867 did_lock_scheduler = 0; | |
| 868 } | |
| 869 if (did_disable_interrupts) | |
| 870 if (__disable_interrupts_hook) /* target stub call */ | |
| 871 { | |
| 872 (*__disable_interrupts_hook) (0); | |
| 873 /* Again, I could check the return value, but | |
| 874 what would I do if it failed??? */ | |
| 875 did_disable_interrupts = 0; | |
| 876 } | |
| 877 #endif /* DEBUG_THREADS */ | |
| 878 } | |
| 879 | |
|
112
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
880 #ifdef CYGPKG_CYGMON |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
112
diff
changeset
|
881 int processing_breakpoint_function = 0; |
|
112
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
882 #endif |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
883 |
| 0 | 884 void |
| 885 __handle_exception (void) | |
| 886 { | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
887 int sigval = 0; |
| 0 | 888 |
| 2 | 889 #ifdef TARGET_HAS_NEXT_STEP |
| 890 if (! __next_step_done ()) | |
| 891 { | |
| 892 __clear_breakpoints (); | |
| 893 __install_breakpoints (); | |
| 894 __single_step (); | |
| 895 return; | |
| 896 } | |
| 897 #endif | |
| 0 | 898 |
| 2 | 899 #ifdef __ECOS__ |
| 900 // We need to unpack the registers before they are accessed. | |
| 901 if (__cleanup_vec != NULL) | |
| 902 __cleanup_vec (); | |
| 0 | 903 |
|
136
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
132
diff
changeset
|
904 #if defined(CYGSEM_REDBOOT_BSP_SYSCALLS) |
|
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
132
diff
changeset
|
905 // Temporary support for gnupro bsp SWIs |
|
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
132
diff
changeset
|
906 if (__is_bsp_syscall()) |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
907 { |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
908 sigval = hal_syscall_handler(); |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
909 if (0 == sigval) |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
910 { |
|
136
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
132
diff
changeset
|
911 if (__init_vec != NULL) |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
912 __init_vec (); |
|
136
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
132
diff
changeset
|
913 return; |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
914 } |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
915 } |
|
136
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
132
diff
changeset
|
916 #endif |
|
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
132
diff
changeset
|
917 |
| 2 | 918 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT |
| 919 // Special case for GDB BREAKs. This flag is set by cyg_stub_cleanup. | |
| 920 if (cyg_hal_gdb_break) { | |
| 921 cyg_hal_gdb_break = 0; | |
| 922 sigval = SIGINT; | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
923 } |
| 2 | 924 #endif |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
925 |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
926 // Only compute sigval if it wasn't already computed (in |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
927 // hal_syscall_handler or as a result of a GDB async break) |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
928 if (0 == sigval) |
| 2 | 929 sigval = __computeSignal (__get_trap_number ()); |
|
136
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
132
diff
changeset
|
930 |
| 2 | 931 #else // __ECOS__ |
| 0 | 932 /* reply to host that an exception has occurred */ |
| 933 sigval = __computeSignal (__get_trap_number ()); | |
| 2 | 934 #endif // __ECOS__ |
| 0 | 935 |
| 936 if (__is_breakpoint_function ()) | |
|
112
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
937 { |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
938 #ifdef CYGPKG_CYGMON |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
939 processing_breakpoint_function = 1; |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
940 #endif |
| 0 | 941 __skipinst (); |
|
112
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
942 } else { |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
943 #ifdef CYGPKG_CYGMON |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
944 processing_breakpoint_function = 0; |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
945 #endif |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
946 } |
| 0 | 947 |
| 2 | 948 #ifndef __ECOS__ |
| 949 if (__cleanup_vec != NULL) | |
| 950 __cleanup_vec (); | |
| 951 #endif // !__ECOS__ | |
| 952 | |
| 953 __clear_breakpoints (); | |
| 954 | |
| 955 /* Undo effect of previous single step. */ | |
| 956 unlock_thread_scheduler (); | |
| 957 __clear_single_step (); | |
| 958 | |
|
48
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
959 #ifdef __ECOS__ |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
960 /* Need to flush the data and instruction cache here, as we may have |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
961 removed a breakpoint in __single_step - and we may be sharing |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
962 some code with the application! */ |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
963 |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
964 __data_cache (CACHE_FLUSH) ; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
965 __instruction_cache (CACHE_FLUSH) ; |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
966 #endif |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
967 |
| 2 | 968 #ifdef SIGSYSCALL |
| 969 if (sigval == SIGSYSCALL) | |
| 0 | 970 { |
| 971 int val; | |
| 972 /* Do the skipinst FIRST. */ | |
| 2 | 973 #ifndef SYSCALL_PC_AFTER_INST |
| 0 | 974 __skipinst (); |
| 2 | 975 #endif |
| 0 | 976 val = __process_syscall_vec (__get_syscall_num ()); |
| 2 | 977 if (val < 0) |
| 978 sigval = -val; | |
| 979 else | |
| 980 sigval = 0; | |
| 0 | 981 } |
| 982 | |
| 983 #endif | |
| 984 | |
| 2 | 985 /* Indirect function call to stub, cygmon monitor or other */ |
| 986 if (sigval != 0) | |
| 987 { | |
| 988 while (__process_exception_vec (sigval)) | |
| 989 { | |
| 990 /* Empty! */ | |
| 991 } | |
| 992 } | |
| 0 | 993 |
| 2 | 994 __install_breakpoints (); |
| 0 | 995 |
| 2 | 996 if (__init_vec != NULL) |
| 997 __init_vec (); | |
| 0 | 998 } |
| 999 | |
| 2 | 1000 /* |
| 1001 * _get_trace_register_hook: | |
| 1002 * This function pointer will be non-zero if the trace component | |
| 1003 * wants to intercept requests for register values. | |
| 1004 * | |
| 1005 * FIXME: evidently I need a new hook for large registers... | |
| 1006 */ | |
| 1007 | |
| 1008 int (*_get_trace_register_hook) (regnames_t, target_register_t *); | |
| 1009 | |
|
46
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1010 void |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1011 stub_format_registers(char *packet, char *ptr) |
|
46
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1012 { |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1013 int regnum; |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1014 int sr = 0, er = NUMREGS_GDB; |
|
46
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1015 |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1016 if (packet[0] == 'p') |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1017 { |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1018 target_register_t regno; |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1019 char *p = &packet[1]; |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1020 if (__hexToInt (&p, ®no)) |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1021 { |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1022 sr = regno; |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1023 er = regno + 1; |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1024 } |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1025 else |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1026 { |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1027 strcpy (ptr, "INVALID"); |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1028 return; |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1029 } |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1030 } |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1031 |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1032 for (regnum = sr; regnum < er; regnum++) |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1033 { |
|
46
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1034 /* We need to compensate for the value offset within the |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1035 register. */ |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1036 char dummyDat[32]; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1037 target_register_t addr; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1038 char *vptr; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1039 int reg_valid = 1; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1040 |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1041 #ifdef TARGET_HAS_LARGE_REGISTERS |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1042 if (sizeof (target_register_t) < REGSIZE (regnum)) { |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1043 get_register_as_bytes (regnum, dummyDat); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1044 vptr = dummyDat; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1045 } else |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1046 #endif |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1047 { |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1048 if (_get_trace_register_hook) |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1049 reg_valid = _get_trace_register_hook (regnum, &addr); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1050 else |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
112
diff
changeset
|
1051 { |
|
46
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1052 addr = get_register (regnum); |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
112
diff
changeset
|
1053 #ifdef CYGHWR_REGISTER_VALIDITY_CHECKING |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
112
diff
changeset
|
1054 reg_valid = get_register_valid (regnum); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
112
diff
changeset
|
1055 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
112
diff
changeset
|
1056 } |
|
46
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1057 vptr = ((char *) &addr); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1058 if (sizeof (addr) > REGSIZE(regnum)) { |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1059 /* May need to cope with endian-ness */ |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1060 |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1061 #if !defined(__LITTLE_ENDIAN__) && !defined(_LITTLE_ENDIAN) |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1062 vptr += sizeof (addr) - REGSIZE (regnum); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1063 #endif |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1064 } else if (sizeof (addr) < REGSIZE (regnum)) { |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1065 int off = REGSIZE (regnum) - sizeof (addr); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1066 int x; |
|
112
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1067 char extend_val = 0; |
|
46
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1068 |
|
121
6bd9d475ed4b
Merge from eCos master repository on 2000-09-04-20:50:20-BST
jlarmour
parents:
115
diff
changeset
|
1069 #ifdef CYGARC_SIGN_EXTEND_REGISTERS |
|
112
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1070 { |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1071 unsigned long bits_in_addr = (sizeof(addr) << 3); // ie Size in bytes * 8 |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1072 target_register_t sign_bit_mask = (1 << (bits_in_addr - 1)); |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1073 if ((addr & sign_bit_mask) == sign_bit_mask) |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1074 extend_val = ~0; |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1075 } |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1076 #endif |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1077 |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1078 #if defined(__LITTLE_ENDIAN__) || defined(_LITTLE_ENDIAN) |
|
46
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1079 for (x = 0; x < off; x++) |
|
112
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1080 dummyDat[x + sizeof(addr)] = extend_val; |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1081 _memcpy (dummyDat, &addr, sizeof (addr)); |
|
112
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1082 #else |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1083 for (x = 0; x < off; x++) |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1084 dummyDat[x] = extend_val; |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1085 _memcpy (dummyDat + off, &addr, sizeof (addr)); |
|
112
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1086 #endif |
|
46
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1087 vptr = dummyDat; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1088 } |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1089 } |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1090 if (reg_valid) { /* we have a valid reg value */ |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1091 ptr = __mem2hex (vptr, ptr, REGSIZE (regnum), 0); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1092 } else { |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1093 /* Trace component returned a failure code. |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1094 This means that the register value is not available. |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1095 We'll fill it with 'x's, and GDB will understand. */ |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1096 _memset (ptr, 'x', 2 * REGSIZE (regnum)); |
|
46
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1097 ptr += 2 * REGSIZE (regnum); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1098 } |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1099 } |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1100 } |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1101 |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1102 void |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1103 stub_update_registers(char *in_ptr, char *out_ptr) |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1104 { |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1105 char *ptr = &in_ptr[1]; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1106 int x; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1107 int sr = 0, er = NUMREGS_GDB; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1108 |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1109 if (*in_ptr == 'P') { |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1110 target_register_t regno; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1111 |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1112 if (__hexToInt (&ptr, ®no) && (*ptr++ == '=')) { |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1113 |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1114 sr = regno; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1115 er = regno + 1; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1116 } else { |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1117 strcpy (out_ptr, "P01"); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1118 return; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1119 } |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1120 } |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1121 |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1122 for (x = sr; x < er; x++) { |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1123 target_register_t value = 0; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1124 char *vptr; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1125 |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1126 #ifdef TARGET_HAS_LARGE_REGISTERS |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1127 if (sizeof (target_register_t) < REGSIZE (x)) { |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1128 char dummyDat [32]; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1129 |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1130 __hex2mem (ptr, dummyDat, REGSIZE (x), 0); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1131 put_register_as_bytes (x, dummyDat); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1132 } else |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1133 #endif |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1134 { |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1135 vptr = ((char *) &value); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1136 #if !defined(__LITTLE_ENDIAN__) && !defined(_LITTLE_ENDIAN) |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1137 vptr += sizeof (value) - REGSIZE (x); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1138 #endif |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1139 __hex2mem (ptr, vptr, REGSIZE (x), 0); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1140 put_register (x, value); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1141 } |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1142 ptr += REGSIZE (x) * 2; |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1143 } |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1144 |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1145 strcpy (out_ptr, "OK"); |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1146 } |
|
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1147 |
| 2 | 1148 int |
| 1149 __process_packet (char *packet) | |
| 0 | 1150 { |
| 2 | 1151 int is_binary = 0; |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1152 #if defined(CYGNUM_HAL_BREAKPOINT_LIST_SIZE) |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1153 int is_Z = 0; |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1154 #endif |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1155 |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1156 __remcomOutBuffer[0] = 0; |
| 0 | 1157 switch (packet[0]) |
| 1158 { | |
| 1159 case '?': | |
| 1160 { | |
| 2 | 1161 int sigval = __computeSignal (__get_trap_number ()); |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1162 __remcomOutBuffer[0] = 'S'; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1163 __remcomOutBuffer[1] = hexchars[(sigval >> 4) & 0xf]; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1164 __remcomOutBuffer[2] = hexchars[sigval & 0xf]; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1165 __remcomOutBuffer[3] = 0; |
| 2 | 1166 break; |
| 0 | 1167 } |
| 1168 | |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
34
diff
changeset
|
1169 #ifdef __ECOS__ |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
34
diff
changeset
|
1170 #if !defined(CYG_HAL_STARTUP_RAM) // Only for ROM based stubs |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1171 #if 0 // Disable to avoid conflict with stub-breakpoint z/Z-packets |
|
78
59d97b6ba612
Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
64
diff
changeset
|
1172 case 'z': |
|
59d97b6ba612
Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
64
diff
changeset
|
1173 /* report IO buffer sizes so download can achieve optimal |
|
59d97b6ba612
Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
64
diff
changeset
|
1174 download speed */ |
|
59d97b6ba612
Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
64
diff
changeset
|
1175 { |
|
59d97b6ba612
Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
64
diff
changeset
|
1176 int i; |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1177 i = __intToHex (__remcomOutBuffer, BUFMAX, 32); |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1178 __remcomOutBuffer[i] = 0; |
|
78
59d97b6ba612
Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
64
diff
changeset
|
1179 break; |
|
59d97b6ba612
Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
64
diff
changeset
|
1180 } |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1181 #endif |
|
78
59d97b6ba612
Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
64
diff
changeset
|
1182 case 'd': |
|
59d97b6ba612
Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
64
diff
changeset
|
1183 /* toggle debug flag */ |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1184 strcpy(__remcomOutBuffer, GDB_stubs_version); |
|
78
59d97b6ba612
Merge from eCos master repository on 2000-03-28-19:50:47-BST
jlarmour
parents:
64
diff
changeset
|
1185 break; |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
34
diff
changeset
|
1186 #endif |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
34
diff
changeset
|
1187 #endif // __ECOS__ |
| 0 | 1188 |
| 1189 case 'q': | |
| 1190 /* general query packet */ | |
| 1191 process_query (&packet[1]); | |
| 1192 break; | |
| 1193 | |
| 1194 case 'Q': | |
| 1195 /* general set packet */ | |
| 1196 process_set (&packet[1]); | |
| 1197 break; | |
| 1198 | |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1199 case 'p': /* return the value of a single CPU register */ |
| 2 | 1200 case 'g': /* return the value of the CPU registers */ |
| 0 | 1201 { |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1202 stub_format_registers(&packet[0], __remcomOutBuffer); |
| 2 | 1203 break; |
| 1204 } | |
| 0 | 1205 |
| 2 | 1206 case 'A': /* set program arguments */ |
| 1207 { | |
|
163
0d2b193a635f
Merge from eCos master repository on 2001-06-22-17:38:39-BST
jlarmour
parents:
162
diff
changeset
|
1208 #ifdef CYGSEM_ECOS_SUPPORTS_PROGRAM_ARGS |
| 2 | 1209 if (packet[1] == '\0') |
| 1210 { | |
| 1211 __free_program_args (); | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1212 strcpy (__remcomOutBuffer, "OK"); |
| 2 | 1213 } |
| 1214 else | |
| 1215 { | |
| 1216 target_register_t arglen, argnum; | |
| 1217 char *ptr = &packet[1]; | |
| 1218 | |
| 1219 while (1) | |
| 1220 { | |
| 1221 if (__hexToInt (&ptr, &arglen) | |
| 1222 && (*ptr++ == ',') | |
| 1223 && __hexToInt (&ptr, &argnum) | |
| 1224 && (*ptr++ == ',')) | |
| 1225 { | |
| 1226 if (arglen > 0) | |
| 1227 { | |
| 1228 char *s = __add_program_arg (argnum, arglen); | |
| 1229 if (s != NULL) | |
| 1230 { | |
| 1231 __hex2mem (ptr, s, arglen, 0); | |
| 1232 } | |
| 1233 ptr += arglen * 2; | |
| 1234 } | |
| 1235 | |
| 1236 if (*ptr == ',') | |
| 1237 ptr++; | |
| 1238 else | |
| 1239 break; | |
| 1240 } | |
| 1241 else | |
| 1242 break; | |
| 1243 } | |
| 1244 if (*ptr == '\0') | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1245 strcpy (__remcomOutBuffer, "OK"); |
| 2 | 1246 else |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1247 strcpy (__remcomOutBuffer, "E01"); |
| 2 | 1248 } |
|
163
0d2b193a635f
Merge from eCos master repository on 2001-06-22-17:38:39-BST
jlarmour
parents:
162
diff
changeset
|
1249 #else |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1250 strcpy (__remcomOutBuffer, "E01"); |
|
163
0d2b193a635f
Merge from eCos master repository on 2001-06-22-17:38:39-BST
jlarmour
parents:
162
diff
changeset
|
1251 #endif |
| 0 | 1252 } |
| 2 | 1253 break; |
| 0 | 1254 |
| 1255 case 'P': | |
| 2 | 1256 case 'G': /* set the value of the CPU registers - return OK */ |
| 0 | 1257 { |
|
46
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1258 char *in_ptr = &packet[0]; |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1259 char *out_ptr = __remcomOutBuffer; |
|
46
797268ecc331
Merge from eCos master repository on 1999-10-19-18:55:31-BST
jlarmour
parents:
38
diff
changeset
|
1260 stub_update_registers(in_ptr, out_ptr); |
| 2 | 1261 break; |
| 0 | 1262 } |
| 1263 | |
| 2 | 1264 case 'm': /* mAA..AA,LLLL Read LLLL bytes at address AA..AA */ |
| 0 | 1265 /* Try to read %x,%x. */ |
| 1266 { | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1267 target_register_t length; |
| 2 | 1268 char *ptr = &packet[1]; |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1269 target_addr_t addr; |
| 0 | 1270 |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1271 if (__hexToAddr (&ptr, &addr) |
| 2 | 1272 && *ptr++ == ',' |
| 1273 && __hexToInt (&ptr, &length)) | |
| 1274 { | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1275 if (__mem2hex_safe (addr, __remcomOutBuffer, length)) |
| 2 | 1276 break; |
| 0 | 1277 |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1278 strcpy (__remcomOutBuffer, "E03"); |
| 2 | 1279 } |
| 1280 else | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1281 strcpy (__remcomOutBuffer, "E01"); |
| 2 | 1282 break; |
| 0 | 1283 } |
| 1284 | |
| 2 | 1285 case 'X': |
| 1286 /* XAA..AA,LLLL: Write LLLL escaped binary bytes at address AA.AA */ | |
| 1287 is_binary = 1; | |
| 1288 /* fall through */ | |
| 0 | 1289 case 'M': /* MAA..AA,LLLL: Write LLLL bytes at address AA.AA return OK */ |
| 1290 /* Try to read '%x,%x:'. */ | |
| 1291 { | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1292 target_register_t length; |
| 2 | 1293 char *ptr = &packet[1], buf[128]; |
| 1294 int i; | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1295 target_addr_t addr; |
| 2 | 1296 |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1297 if (__hexToAddr (&ptr, &addr) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1298 && *ptr++ == ',' |
| 2 | 1299 && __hexToInt (&ptr, &length) |
| 1300 && *ptr++ == ':') | |
| 1301 { | |
|
182
f62680ef1804
Merge from eCos master repository on 2001-09-07-06:43:02-BST
jlarmour
parents:
163
diff
changeset
|
1302 /* GDB sometimes sends an impossible length */ |
|
f62680ef1804
Merge from eCos master repository on 2001-09-07-06:43:02-BST
jlarmour
parents:
163
diff
changeset
|
1303 if (length < 0 || length >= BUFMAX) |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1304 strcpy (__remcomOutBuffer, "E01"); |
|
182
f62680ef1804
Merge from eCos master repository on 2001-09-07-06:43:02-BST
jlarmour
parents:
163
diff
changeset
|
1305 |
|
f62680ef1804
Merge from eCos master repository on 2001-09-07-06:43:02-BST
jlarmour
parents:
163
diff
changeset
|
1306 else if (is_binary) |
| 2 | 1307 { |
| 1308 while (length > 0) | |
| 1309 { | |
| 1310 for (i = 0; i < sizeof(buf) && i < length; i++) | |
| 1311 if ((buf[i] = *ptr++) == 0x7d) | |
| 1312 buf[i] = 0x20 | (*ptr++ & 0xff); | |
| 1313 | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1314 #ifdef TARGET_HAS_HARVARD_MEMORY |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1315 if (TARGET_ADDR_IS_PROGMEM(addr)) { |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1316 if (__write_progmem_safe (buf, (void *)TARGET_ADDR_TO_PTR(addr), i) != i) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1317 break; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1318 } else |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1319 #endif |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1320 if (__write_mem_safe (buf, (void *)TARGET_ADDR_TO_PTR(addr), i) != i) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1321 break; |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1322 |
| 0 | 1323 |
| 2 | 1324 length -= i; |
| 1325 addr += i; | |
| 1326 } | |
| 1327 if (length <= 0) | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1328 strcpy (__remcomOutBuffer, "OK"); |
| 2 | 1329 else |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1330 strcpy (__remcomOutBuffer, "E03"); |
| 2 | 1331 } |
|
182
f62680ef1804
Merge from eCos master repository on 2001-09-07-06:43:02-BST
jlarmour
parents:
163
diff
changeset
|
1332 else |
| 2 | 1333 { |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1334 if (__hex2mem_safe (ptr, addr, length) != NULL) |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1335 strcpy (__remcomOutBuffer, "OK"); |
| 2 | 1336 else |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1337 strcpy (__remcomOutBuffer, "E03"); |
| 2 | 1338 } |
| 1339 } | |
| 1340 else | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1341 strcpy (__remcomOutBuffer, "E02"); |
| 2 | 1342 break; |
| 0 | 1343 } |
| 1344 | |
| 1345 case 'S': | |
| 2 | 1346 case 's': /* sAA..AA Step from address AA..AA (optional) */ |
| 0 | 1347 case 'C': |
| 2 | 1348 case 'c': /* cAA..AA Continue at address AA..AA (optional) */ |
| 0 | 1349 /* try to read optional parameter, pc unchanged if no parm */ |
| 1350 | |
| 1351 { | |
| 2 | 1352 char *ptr = &packet[1]; |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1353 target_addr_t addr; |
| 2 | 1354 target_register_t sigval = 0; |
| 1355 | |
| 1356 if (packet[0] == 'C' || packet[0] == 'S') | |
| 1357 { | |
| 1358 __hexToInt (&ptr, &sigval); | |
| 1359 if (*ptr == ';') | |
| 1360 ptr++; | |
| 1361 } | |
| 0 | 1362 |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1363 if (__hexToAddr (&ptr, &addr)) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1364 set_pc ((target_register_t)TARGET_ADDR_TO_PTR(addr)); |
| 2 | 1365 |
| 1366 /* Need to flush the instruction cache here, as we may have | |
| 1367 deposited a breakpoint, and the icache probably has no way of | |
| 1368 knowing that a data ref to some location may have changed | |
| 1369 something that is in the instruction cache. */ | |
| 1370 | |
| 1371 #ifdef __ECOS__ | |
| 1372 __data_cache (CACHE_FLUSH) ; | |
| 1373 #endif | |
| 1374 __instruction_cache (CACHE_FLUSH) ; | |
| 0 | 1375 |
| 2 | 1376 /* If we have a function to handle signals, call it. */ |
| 1377 if (sigval != 0 && __process_signal_vec != NULL) | |
| 1378 { | |
| 1379 /* If 0 is returned, we either ignored the signal or invoked a user | |
| 1380 handler. Otherwise, the user program should die. */ | |
| 1381 if (! __process_signal_vec (sigval)) | |
| 1382 sigval = 0; | |
| 1383 } | |
| 0 | 1384 |
| 2 | 1385 if (sigval != 0) |
| 1386 { | |
| 1387 sigval = SIGKILL; /* Always nuke the program */ | |
| 1388 __kill_program (sigval); | |
| 1389 return 0; | |
| 1390 } | |
| 0 | 1391 |
|
48
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
1392 #ifdef __ECOS__ |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
1393 // CASE 102327 - watchpoints fight with output, so do not step |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
1394 // through $O packet output routines. |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
1395 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
1396 if ( cyg_hal_gdb_break_is_set() ) { |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
1397 packet[0] = 'c'; // Force it to be a "continue" instead of step. |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
1398 cyg_hal_gdb_running_step = 1; // And tell the hal_stub... |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
1399 } |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
1400 #endif |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
1401 #endif |
|
1370c5e55234
Merge from eCos master repository on 1999-10-25-21:18:27-BST
jlarmour
parents:
46
diff
changeset
|
1402 |
| 2 | 1403 /* Set machine state to force a single step. */ |
| 1404 if (packet[0] == 's' || packet[0] == 'S') | |
| 1405 { | |
| 1406 lock_thread_scheduler (0); /* 0 == single-step */ | |
| 1407 #ifdef __ECOS__ | |
| 1408 // PR 19845 workaround: | |
| 1409 // Make sure the single-step magic affects the correct registers. | |
| 1410 _registers = ®isters[0]; | |
| 1411 #endif | |
| 1412 __single_step (); | |
| 1413 } | |
| 1414 else | |
| 1415 { | |
| 1416 lock_thread_scheduler (1); /* 1 == continue */ | |
| 1417 } | |
| 0 | 1418 |
|
28
18ee5a9c102e
Merge from eCos master repository on 1999-08-09-17:04:48-BST
jlarmour
parents:
2
diff
changeset
|
1419 #ifdef __ECOS__ |
|
18ee5a9c102e
Merge from eCos master repository on 1999-08-09-17:04:48-BST
jlarmour
parents:
2
diff
changeset
|
1420 /* Need to flush the data and instruction cache here, as we may have |
|
18ee5a9c102e
Merge from eCos master repository on 1999-08-09-17:04:48-BST
jlarmour
parents:
2
diff
changeset
|
1421 deposited a breakpoint in __single_step. */ |
|
18ee5a9c102e
Merge from eCos master repository on 1999-08-09-17:04:48-BST
jlarmour
parents:
2
diff
changeset
|
1422 |
|
18ee5a9c102e
Merge from eCos master repository on 1999-08-09-17:04:48-BST
jlarmour
parents:
2
diff
changeset
|
1423 __data_cache (CACHE_FLUSH) ; |
|
18ee5a9c102e
Merge from eCos master repository on 1999-08-09-17:04:48-BST
jlarmour
parents:
2
diff
changeset
|
1424 __instruction_cache (CACHE_FLUSH) ; |
|
138
289bf90c6a9b
Merge from eCos master repository on 2000-11-24-06:43:05-GMT
jlarmour
parents:
136
diff
changeset
|
1425 hal_flush_output(); |
|
28
18ee5a9c102e
Merge from eCos master repository on 1999-08-09-17:04:48-BST
jlarmour
parents:
2
diff
changeset
|
1426 #endif |
|
18ee5a9c102e
Merge from eCos master repository on 1999-08-09-17:04:48-BST
jlarmour
parents:
2
diff
changeset
|
1427 |
| 2 | 1428 return -1; |
| 0 | 1429 } |
| 1430 | |
|
182
f62680ef1804
Merge from eCos master repository on 2001-09-07-06:43:02-BST
jlarmour
parents:
163
diff
changeset
|
1431 case 'D' : /* detach */ |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1432 __putpacket (__remcomOutBuffer); |
|
182
f62680ef1804
Merge from eCos master repository on 2001-09-07-06:43:02-BST
jlarmour
parents:
163
diff
changeset
|
1433 /* fall through */ |
|
f62680ef1804
Merge from eCos master repository on 2001-09-07-06:43:02-BST
jlarmour
parents:
163
diff
changeset
|
1434 case 'k' : /* kill the program */ |
|
138
289bf90c6a9b
Merge from eCos master repository on 2000-11-24-06:43:05-GMT
jlarmour
parents:
136
diff
changeset
|
1435 #ifdef __ECOS__ |
|
289bf90c6a9b
Merge from eCos master repository on 2000-11-24-06:43:05-GMT
jlarmour
parents:
136
diff
changeset
|
1436 hal_flush_output(); |
|
289bf90c6a9b
Merge from eCos master repository on 2000-11-24-06:43:05-GMT
jlarmour
parents:
136
diff
changeset
|
1437 #endif |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1438 #ifdef CYGSEM_REDBOOT_BSP_SYSCALLS_GPROF |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1439 { // Reset the timer to default and cancel any callback |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1440 extern void sys_profile_reset(void); |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1441 sys_profile_reset(); |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1442 } |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1443 #endif // CYGSEM_REDBOOT_BSP_SYSCALLS_GPROF |
| 0 | 1444 __process_exit_vec (); |
|
154
e2d866e32dac
Merge from eCos master repository on 2001-02-26-23:18:05-GMT
jlarmour
parents:
151
diff
changeset
|
1445 return -1; |
| 2 | 1446 |
| 1447 case 'r': /* Reset */ | |
|
162
2395031e7a66
Merge from eCos master repository on 2001-06-15-06:43:03-BST
jlarmour
parents:
156
diff
changeset
|
1448 /* With the next 'k' packet, reset the board */ |
|
2395031e7a66
Merge from eCos master repository on 2001-06-15-06:43:03-BST
jlarmour
parents:
156
diff
changeset
|
1449 __process_exit_vec = &__reset; |
| 0 | 1450 break; |
| 2 | 1451 |
| 0 | 1452 case 'H': |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1453 STUB_PKT_CHANGETHREAD (packet+1, __remcomOutBuffer, 300) ; |
| 0 | 1454 break ; |
| 1455 case 'T' : | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1456 STUB_PKT_THREAD_ALIVE (packet+1, __remcomOutBuffer, 300) ; |
| 0 | 1457 break ; |
| 2 | 1458 case 'B': |
| 1459 /* breakpoint */ | |
| 0 | 1460 { |
| 2 | 1461 target_register_t addr; |
| 1462 char mode; | |
| 1463 char *ptr = &packet[1]; | |
| 1464 if (__hexToInt (&ptr, &addr) && *(ptr++) == ',') | |
| 1465 { | |
| 1466 mode = *(ptr++); | |
| 1467 if (mode == 'C') | |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
145
diff
changeset
|
1468 __remove_breakpoint (addr,0); |
| 2 | 1469 else |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
145
diff
changeset
|
1470 __set_breakpoint (addr,0); |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1471 strcpy (__remcomOutBuffer, "OK"); |
| 2 | 1472 } |
| 1473 else | |
| 1474 { | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1475 strcpy (__remcomOutBuffer, "E01"); |
| 2 | 1476 } |
| 1477 break; | |
| 1478 } | |
| 0 | 1479 |
| 2 | 1480 case 'b': /* bBB... Set baud rate to BB... */ |
| 1481 { | |
| 1482 target_register_t baudrate; | |
| 0 | 1483 |
| 2 | 1484 char *ptr = &packet[1]; |
| 1485 if (!__hexToInt (&ptr, &baudrate)) | |
| 1486 { | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1487 strcpy (__remcomOutBuffer, "B01"); |
| 2 | 1488 break; |
| 1489 } | |
| 1490 | |
| 1491 __putpacket ("OK"); /* Ack before changing speed */ | |
| 1492 __set_baud_rate (baudrate); | |
| 1493 break; | |
| 0 | 1494 } |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1495 |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1496 #if defined(CYGNUM_HAL_BREAKPOINT_LIST_SIZE) && (CYGNUM_HAL_BREAKPOINT_LIST_SIZE > 0) |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1497 case 'Z': |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1498 is_Z = 1; |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1499 case 'z': |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1500 { |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1501 char *ptr = &packet[1]; |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1502 target_register_t ztype, addr, length; |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1503 int err; |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1504 target_addr_t taddr; |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1505 |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1506 if (__hexToInt (&ptr, &ztype) && *(ptr++) == ',') |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1507 { |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1508 if (__hexToAddr (&ptr, &taddr)) |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1509 { |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1510 if (*(ptr++) == ',') |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1511 { |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1512 /* When there is a comma, there must be a length */ |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1513 if (!__hexToInt (&ptr, &length)) |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1514 { |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1515 strcpy (__remcomOutBuffer, "E02"); |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1516 break; |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1517 } |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1518 } |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1519 else |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1520 length = 0; |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1521 |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1522 addr = (target_register_t)TARGET_ADDR_TO_PTR(taddr); |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1523 |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1524 switch (ztype) |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1525 { |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1526 case 0: |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1527 /* sw breakpoint */ |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1528 if (is_Z) |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
145
diff
changeset
|
1529 err = __set_breakpoint(addr,length); |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1530 else |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
145
diff
changeset
|
1531 err = __remove_breakpoint(addr,length); |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1532 if (!err) |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1533 strcpy (__remcomOutBuffer, "OK"); |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1534 else |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1535 strcpy (__remcomOutBuffer, "E02"); |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1536 break; |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1537 case 1: |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1538 /* hw breakpoint */ |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1539 #ifdef HAL_STUB_HW_BREAKPOINT |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1540 if (!HAL_STUB_HW_BREAKPOINT(is_Z, (void *)addr, length)) |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1541 strcpy (__remcomOutBuffer, "OK"); |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1542 else |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1543 #endif |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1544 strcpy (__remcomOutBuffer, "E02"); |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1545 break; |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1546 case 2: |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1547 case 3: |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1548 case 4: |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1549 /* hw watchpoint */ |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1550 #ifdef HAL_STUB_HW_WATCHPOINT |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1551 if (!HAL_STUB_HW_WATCHPOINT(is_Z, (void *)addr, length, ztype)) |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1552 strcpy (__remcomOutBuffer, "OK"); |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1553 else |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1554 #endif |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1555 strcpy (__remcomOutBuffer, "E02"); |
|
132
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1556 break; |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1557 } |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1558 } |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1559 } |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1560 break; |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1561 } |
|
0ae0bc38e387
Merge from eCos master repository on 2000-10-31-00:30:36-GMT
jlarmour
parents:
130
diff
changeset
|
1562 #endif // Z packet support |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1563 #ifdef CYGPKG_HAL_GDB_FILEIO // File I/O over the GDB remote protocol |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1564 case 'F': |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1565 { |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1566 extern void cyg_hal_gdbfileio_process_F_packet( char *, char *); |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1567 cyg_hal_gdbfileio_process_F_packet( packet, __remcomOutBuffer ); |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1568 return -1; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1569 } |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1570 #endif |
| 2 | 1571 default: |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1572 __process_target_packet (packet, __remcomOutBuffer, 300); |
| 2 | 1573 break; |
| 0 | 1574 } |
| 1575 | |
| 1576 /* reply to the request */ | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1577 __putpacket (__remcomOutBuffer); |
| 0 | 1578 return 0; |
| 1579 } | |
| 1580 | |
| 1581 static void | |
| 1582 send_t_packet (int sigval) | |
| 1583 { | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1584 __build_t_packet (sigval, __remcomOutBuffer); |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1585 __putpacket (__remcomOutBuffer); |
| 0 | 1586 } |
| 1587 | |
| 1588 /* | |
| 1589 * This function does all command procesing for interfacing to gdb. | |
| 1590 */ | |
| 1591 | |
| 1592 static int | |
| 1593 process_exception (int sigval) | |
| 1594 { | |
| 1595 int status; | |
| 1596 | |
| 1597 /* Nasty. */ | |
| 1598 if (ungot_char < 0) | |
| 1599 send_t_packet (sigval); | |
| 1600 | |
| 1601 do { | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1602 __getpacket (__remcomInBuffer); |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1603 status = __process_packet (__remcomInBuffer); |
| 0 | 1604 } while (status == 0); |
| 1605 | |
| 1606 if (status < 0) | |
| 1607 return 0; | |
| 1608 else | |
| 1609 return 1; | |
| 1610 } | |
| 1611 | |
| 1612 void | |
| 1613 __send_exit_status (int status) | |
| 1614 { | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1615 __remcomOutBuffer[0] = 'W'; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1616 __remcomOutBuffer[1] = hexchars[(status >> 4) & 0xf]; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1617 __remcomOutBuffer[2] = hexchars[status & 0xf]; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1618 __remcomOutBuffer[3] = 0; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1619 __putpacket (__remcomOutBuffer); |
| 0 | 1620 } |
| 1621 | |
| 2 | 1622 /* Read up to MAXLEN bytes from the remote GDB client, and store in DEST |
| 1623 (which is a pointer in the user program). BLOCK indicates what mode | |
| 1624 is being used; if it is set, we will wait for MAXLEN bytes to be | |
| 1625 entered. Otherwise, the function will return immediately with whatever | |
| 1626 bytes are waiting to be read. | |
| 1627 | |
| 1628 The value returned is the number of bytes read. A -1 indicates that an | |
| 1629 error of some sort occurred. */ | |
| 1630 | |
| 0 | 1631 int |
| 2 | 1632 __get_gdb_input (target_register_t dest, int maxlen, int block) |
| 0 | 1633 { |
| 1634 char buf[4]; | |
| 1635 int len, i; | |
| 2 | 1636 char d; |
| 0 | 1637 |
| 1638 buf[0] = 'I'; | |
| 1639 buf[1] = '0'; | |
| 1640 buf[2] = block ? '0' : '1'; | |
| 1641 buf[3] = 0; | |
| 2 | 1642 __putpacket (buf); |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1643 __getpacket (__remcomInBuffer); |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1644 if (__remcomInBuffer[0] != 'I') |
| 0 | 1645 return -1; |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1646 len = stubhex (__remcomInBuffer[1]) * 16 + stubhex (__remcomInBuffer[2]); |
| 0 | 1647 for (i = 0; i < len; i++) |
| 1648 { | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1649 d = stubhex (__remcomInBuffer[3 + i * 2]) * 16; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1650 d |= stubhex (__remcomInBuffer[3 + i * 2 + 1]); |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
1651 __write_mem_safe (&d, (void *)(dest + i), 1); |
| 0 | 1652 } |
| 2 | 1653 /* Write the trailing \0. */ |
| 1654 d = '\0'; | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
1655 __write_mem_safe (&d, (void *)(dest + i), 1); |
| 0 | 1656 return len; |
| 1657 } | |
| 1658 | |
| 1659 void | |
| 1660 __output_hex_value (target_register_t i) | |
| 1661 { | |
| 1662 char buf[32], *ptr=buf+31; | |
| 1663 unsigned int x; | |
| 1664 | |
| 1665 *ptr = 0; | |
| 2 | 1666 for (x = 0; x < (sizeof (i) * 2); x++) |
| 0 | 1667 { |
| 1668 *(--ptr) = hexchars[i & 15]; | |
| 1669 i = i >> 4; | |
| 1670 } | |
| 1671 while (*ptr) | |
| 1672 { | |
| 1673 putDebugChar (*(ptr++)); | |
| 1674 } | |
| 1675 } | |
| 1676 | |
| 2 | 1677 /* Write the C-style string pointed to by STR to the GDB comm port. */ |
| 1678 void | |
| 1679 __putDebugStr (char *str) | |
| 1680 { | |
| 1681 while (*str) | |
| 1682 { | |
| 1683 putDebugChar (*str); | |
| 1684 str++; | |
| 1685 } | |
| 1686 } | |
| 1687 | |
| 1688 /* Send STRING_LEN bytes of STR to GDB, using 'O' packets. | |
| 1689 STR is assumed to be in the program being debugged. */ | |
| 1690 | |
| 0 | 1691 int |
| 2 | 1692 __output_gdb_string (target_register_t str, int string_len) |
| 0 | 1693 { |
| 2 | 1694 /* We will arbitrarily limit output packets to less than 400 bytes. */ |
| 1695 static char buf[400]; | |
| 0 | 1696 int x; |
| 1697 int len; | |
| 1698 | |
| 1699 if (string_len == 0) | |
| 2 | 1700 { |
| 1701 /* We can't do strlen on a user pointer. */ | |
| 1702 return -1; | |
| 1703 } | |
| 0 | 1704 |
| 2 | 1705 len = string_len; |
| 1706 while (len > 0) | |
| 0 | 1707 { |
| 2 | 1708 int packetlen = ((len < 175) ? len : 175); |
| 1709 buf[0] = 'O'; | |
| 1710 for (x = 0; x < packetlen; x++) | |
| 1711 { | |
| 1712 char c; | |
| 1713 | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
1714 __read_mem_safe (&c, (void *)(str + x), 1); |
| 2 | 1715 buf[x*2+1] = hexchars[(c >> 4) & 0xf]; |
| 1716 buf[x*2+2] = hexchars[c % 16]; | |
| 1717 } | |
| 1718 str += x; | |
| 1719 len -= x; | |
| 1720 buf[x*2+1] = 0; | |
| 1721 __putpacket (buf); | |
| 0 | 1722 } |
| 1723 return string_len; | |
| 1724 } | |
| 1725 | |
| 1726 static void | |
| 1727 do_nothing (void) | |
| 1728 { | |
| 1729 /* mmmm */ | |
| 1730 } | |
| 1731 | |
| 1732 static int | |
| 1733 syscall_do_nothing (int junk) | |
| 1734 { | |
| 1735 return 0; | |
| 1736 } | |
| 1737 | |
| 1738 /* Start the stub running. */ | |
| 1739 void | |
| 2 | 1740 __switch_to_stub (void) |
| 0 | 1741 { |
| 1742 __process_exception_vec = process_exception; | |
|
112
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1743 #ifdef CYGPKG_CYGMON |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1744 // Cygmon will have consumed the '$' character for this packet. |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1745 // Let's put one in the unget buffer. |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1746 // Actually, Cygmon does an unget, but since it uses different |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1747 // unget handling, we need to do this here. |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1748 ungetDebugChar('$'); |
|
02ea4320376c
Merge from eCos master repository on 2000-07-21-21:01:39-BST
jlarmour
parents:
78
diff
changeset
|
1749 #endif |
| 0 | 1750 } |
| 1751 | |
| 2 | 1752 #if ! defined(BOARD_SPECIFIC_STUB_INIT) |
| 1753 void | |
| 1754 initialize_stub (void) | |
| 1755 { | |
| 1756 set_debug_traps (); | |
| 1757 /* FIXME: This function should be renamed to specifically init the | |
| 1758 hardware required by debug operations. If initHardware is implemented at | |
| 1759 all, it should be called before main (). | |
| 1760 */ | |
| 1761 initHardware () ; | |
| 1762 /* This acks any stale packets , NOT an effective solution */ | |
| 1763 putDebugChar ('+'); | |
| 1764 } | |
| 1765 #endif | |
| 1766 | |
| 0 | 1767 void |
| 1768 ungetDebugChar (int c) | |
| 1769 { | |
| 1770 ungot_char = c; | |
| 1771 } | |
| 1772 | |
| 2 | 1773 void |
| 1774 __kill_program (int sigval) | |
| 0 | 1775 { |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1776 __remcomOutBuffer[0] = 'X'; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1777 __remcomOutBuffer[1] = hexchars[(sigval >> 4) & 15]; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1778 __remcomOutBuffer[2] = hexchars[sigval & 15]; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1779 __remcomOutBuffer[3] = 0; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1780 __putpacket (__remcomOutBuffer); |
| 2 | 1781 } |
| 1782 | |
| 1783 #define MAX_ARG_COUNT 20 | |
| 1784 #define MAX_ARGDATA 128 | |
| 1785 | |
| 1786 static char *program_argv [MAX_ARG_COUNT]; | |
| 1787 static int program_argc; | |
| 1788 static int last_program_arg; | |
| 1789 static char program_argstr [MAX_ARGDATA], *argptr; | |
| 1790 static int args_initted = 0; | |
| 1791 | |
| 1792 void | |
| 1793 __free_program_args (void) | |
| 1794 { | |
| 1795 last_program_arg = -1; | |
| 1796 program_argc = 0; | |
| 1797 program_argv [0] = NULL; | |
| 1798 argptr = program_argstr; | |
| 1799 args_initted = 1; | |
| 1800 } | |
| 1801 | |
| 1802 static char * | |
| 1803 __add_program_arg (int argc, uint32 len) | |
| 1804 { | |
| 1805 char *res; | |
| 1806 | |
| 1807 if (! args_initted) | |
| 1808 { | |
| 1809 __free_program_args (); | |
| 1810 } | |
| 1811 | |
| 1812 if ((argc >= (MAX_ARG_COUNT - 1)) | |
| 1813 || ((argptr - program_argstr + len) > MAX_ARGDATA)) | |
| 1814 { | |
| 1815 return NULL; | |
| 1816 } | |
| 1817 | |
| 1818 if (argc != last_program_arg) | |
| 1819 { | |
| 1820 if (argc >= program_argc) | |
| 1821 { | |
| 1822 program_argc = argc + 1; | |
| 1823 program_argv [program_argc] = NULL; | |
| 1824 } | |
| 1825 program_argv [argc] = argptr; | |
| 1826 last_program_arg = argc; | |
| 1827 } | |
| 1828 | |
| 1829 res = argptr; | |
| 1830 argptr += len; | |
| 1831 | |
| 1832 return res; | |
| 1833 } | |
| 1834 | |
| 1835 void | |
| 1836 __set_program_args (int argc, char **argv) | |
| 1837 { | |
| 1838 int x; | |
| 1839 | |
| 1840 __free_program_args (); | |
| 1841 if (argc) | |
| 1842 { | |
| 1843 for (x = 0; x < argc; x++) | |
| 1844 { | |
| 1845 uint32 len = strlen (argv[x])+1; | |
| 1846 char *s = __add_program_arg (x, len); | |
| 1847 | |
| 1848 if (s == NULL) | |
| 1849 return; | |
| 1850 | |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1851 _memcpy (s, argv[x], len); |
| 2 | 1852 } |
| 1853 } | |
| 1854 } | |
| 1855 | |
| 1856 char ** | |
| 1857 __get_program_args (target_register_t argcPtr) | |
| 1858 { | |
| 1859 if (!args_initted) | |
| 1860 { | |
| 1861 __free_program_args (); | |
| 1862 } | |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
1863 __write_mem_safe ((char *) &program_argc, (void *)argcPtr, sizeof (program_argc)); |
| 2 | 1864 return program_argv; |
| 0 | 1865 } |
| 1866 | |
| 1867 /* Table used by the crc32 function to calcuate the checksum. */ | |
| 1868 static uint32 crc32_table[256]; | |
| 1869 static int tableInit = 0; | |
| 1870 | |
| 1871 /* | |
| 1872 Calculate a CRC-32 using LEN bytes of PTR. CRC is the initial CRC | |
| 1873 value. | |
| 1874 PTR is assumed to be a pointer in the user program. */ | |
| 1875 | |
| 1876 static uint32 | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1877 crc32 (target_addr_t mem, int len, uint32 crc) |
| 0 | 1878 { |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1879 unsigned char *ptr = (unsigned char *)TARGET_ADDR_TO_PTR(mem); |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1880 #ifdef TARGET_HAS_HARVARD_MEMORY |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1881 int is_progmem = TARGET_ADDR_IS_PROGMEM(mem); |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1882 #endif |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1883 |
| 0 | 1884 if (! tableInit) |
| 1885 { | |
| 1886 /* Initialize the CRC table and the decoding table. */ | |
| 1887 uint32 i, j; | |
| 1888 uint32 c; | |
| 1889 | |
| 1890 tableInit = 1; | |
| 1891 for (i = 0; i < 256; i++) | |
| 2 | 1892 { |
| 1893 for (c = i << 24, j = 8; j > 0; --j) | |
| 1894 c = c & 0x80000000 ? (c << 1) ^ 0x04c11db7 : (c << 1); | |
| 1895 crc32_table[i] = c; | |
| 1896 } | |
| 0 | 1897 } |
| 1898 | |
| 1899 __mem_fault = 0; | |
| 1900 while (len--) | |
| 1901 { | |
| 1902 unsigned char ch; | |
| 1903 | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1904 #ifdef TARGET_HAS_HARVARD_MEMORY |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1905 if (is_progmem) |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1906 __read_progmem_safe (&ch, (void *)ptr, 1); |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1907 else |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1908 #endif |
|
34
29bc183297e1
Merge from eCos master repository on 1999-09-02-16:26:10-BST
jlarmour
parents:
28
diff
changeset
|
1909 __read_mem_safe (&ch, (void *)ptr, 1); |
| 0 | 1910 if (__mem_fault) |
| 2 | 1911 { |
| 1912 break; | |
| 1913 } | |
| 0 | 1914 crc = (crc << 8) ^ crc32_table[((crc >> 24) ^ ch) & 255]; |
| 1915 ptr++; | |
| 1916 } | |
| 1917 return crc; | |
| 1918 } | |
| 1919 | |
| 1920 /* Handle the 'q' request */ | |
| 1921 | |
| 1922 static void | |
| 1923 process_query (char *pkt) | |
| 1924 { | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1925 __remcomOutBuffer[0] = '\0'; |
| 2 | 1926 #ifdef __ECOS__ |
| 0 | 1927 if ('C' == pkt[0] && |
| 1928 'R' == pkt[1] && | |
| 1929 'C' == pkt[2] && | |
| 1930 ':' == pkt[3]) | |
| 2 | 1931 #else // __ECOS__ |
| 1932 if (strncmp (pkt, "CRC:", 4) == 0) | |
| 1933 #endif // __ECOS__ | |
| 0 | 1934 { |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1935 target_addr_t startmem; |
| 0 | 1936 target_register_t length; |
| 1937 uint32 our_crc; | |
| 1938 | |
| 1939 pkt += 4; | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1940 if (__hexToAddr (&pkt, &startmem) |
| 2 | 1941 && *(pkt++) == ',' |
| 1942 && __hexToInt (&pkt, &length)) | |
| 1943 { | |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
1944 our_crc = crc32 (startmem, length, 0xffffffff); |
| 2 | 1945 if (__mem_fault) |
| 1946 { | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1947 strcpy (__remcomOutBuffer, "E01"); |
| 2 | 1948 } |
| 1949 else | |
| 1950 { | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1951 int numb = __intToHex (__remcomOutBuffer + 1, our_crc, 32); |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1952 __remcomOutBuffer[0] = 'C'; |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1953 __remcomOutBuffer[numb + 1] = 0; |
| 2 | 1954 } |
| 1955 } | |
| 0 | 1956 return; |
| 1957 } | |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1958 #ifdef CYG_HAL_STUB_PROCESS_QUERY |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1959 else if (CYG_HAL_STUB_PROCESS_QUERY (pkt, __remcomOutBuffer, sizeof(__remcomOutBuffer))) |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1960 return; |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1961 #endif |
| 0 | 1962 else |
| 1963 { | |
| 1964 char ch ; | |
| 1965 char * subpkt ; | |
| 1966 ch = *pkt ; | |
| 1967 subpkt = pkt + 1 ; | |
| 1968 switch (ch) | |
| 2 | 1969 { |
| 1970 case 'L' : /* threadlistquery */ | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1971 STUB_PKT_GETTHREADLIST (subpkt, __remcomOutBuffer, 300); |
| 2 | 1972 break ; |
| 1973 case 'P' : /* Thread or process information request */ | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1974 STUB_PKT_GETTHREADINFO (subpkt, __remcomOutBuffer, 300); |
| 2 | 1975 break ; |
| 1976 case 'C' : /* current thread query */ | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1977 STUB_PKT_CURRTHREAD(subpkt, __remcomOutBuffer, sizeof(__remcomOutBuffer)); |
| 2 | 1978 break; |
| 1979 default: | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1980 __process_target_query (pkt, __remcomOutBuffer, 300); |
| 2 | 1981 break ; |
| 1982 } | |
| 0 | 1983 } |
| 1984 } | |
| 1985 | |
| 1986 /* Handle the 'Q' request */ | |
| 1987 | |
| 1988 static void | |
| 1989 process_set (char *pkt) | |
| 1990 { | |
| 1991 char ch ; | |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1992 |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1993 #ifdef CYG_HAL_STUB_PROCESS_SET |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
1994 if (CYG_HAL_STUB_PROCESS_SET (pkt, __remcomOutBuffer, sizeof(__remcomOutBuffer))) |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1995 return; |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1996 #endif |
|
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
184
diff
changeset
|
1997 |
| 0 | 1998 ch = *pkt ; |
| 1999 switch (ch) | |
| 2000 { | |
| 2001 case 'p' : /* Set current process or thread */ | |
| 2002 /* reserve the packet id even if support is not present */ | |
| 2003 /* Dont strip the 'p' off the header, there are several variations of | |
| 2 | 2004 this packet */ |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
2005 STUB_PKT_CHANGETHREAD (pkt, __remcomOutBuffer, 300) ; |
| 0 | 2006 break ; |
| 2007 default: | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
198
diff
changeset
|
2008 __process_target_set (pkt, __remcomOutBuffer, 300); |
| 0 | 2009 break ; |
| 2010 } | |
| 2011 } | |
| 2012 #endif // CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS |
