annotate packages/hal/common/current/src/generic-stub.c @ 198:ea3f0bd33a73

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