annotate packages/hal/common/current/src/generic-stub.c @ 208:e0c0827131d1 ecos

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