annotate packages/hal/common/current/src/thread-packets.c @ 0:3111d98ba7b3 ecos-v1_1-release

Initial commit of eCos version 1.1
author jlarmour
date Tue, 11 May 1999 11:16:07 +0000
parents
children 443894e2e912
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
2 /*
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
3 * Copyright (c) 1998 Cygnus Support
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
4 *
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
5 * The authors hereby grant permission to use, copy, modify, distribute,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
6 * and license this software and its documentation for any purpose, provided
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
7 * that existing copyright notices are retained in all copies and that this
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
8 * notice is included verbatim in any distributions. No written agreement,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
9 * license, or royalty fee is required for any of the authorized uses.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
10 * Modifications to this software may be copyrighted by their authors
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
11 * and need not follow the licensing terms described here, provided that
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
12 * the new terms are clearly indicated on the first page of each file where
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
13 * they apply.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
14 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
15
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
16 #include <pkgconf/hal.h>
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
17
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
18 #if defined(CYGDBG_HAL_DEBUG_GDB_THREAD_SUPPORT) \
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
19 && defined(CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
20
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
21 /* FIXME: Scan this module for correct sizes of fields in packets */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
22 #define DEBUG_THREADS 1
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
23 #include "cyg/hal/dbg-threads-api.h"
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 /* This file should ALWAYS define debug thread support */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
26 /* Dont include the object in the link if you dont need the support */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
27 /* This is NOT the internal unit debug flag, it is a feature control */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
28 #if defined(DEBUG_THREADS)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
29 #undef DEBUG_THREADS
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
30 #define DEBUG_THREADS 1
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
31 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
32
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
33 #define UNIT_TEST 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
34 #define GDB_MOCKUP 0
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 #define STUB_BUF_MAX 300 /* for range checking of packet lengths */
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 #include "thread-pkts.h"
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 // Use HAL rather than board.h in eCos
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
42 #define PKT_DEBUG 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
43 #include <cyg/hal/hal_stub.h>
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
44 //#include "board.h"
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 #if !defined(PKT_DEBUG)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
47 #define PKT_DEBUG 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
48 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
49 extern void output_string(char * message) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
50
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
51 #if PKT_DEBUG
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
52 void output_threadid(char * title,threadref * ref) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
53 #warning "PKT_DEBUG macros engaged"
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
54 #define PKT_TRACE(title,packet) \
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
55 { output_string(title) ; output_string(packet) ; output_string("\n") ;}
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
56 #else
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
57 #define PKT_TRACE(title,packet) {}
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
58 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
59
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
60
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
61 /* This is going to be irregular because the various implementations
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
62 have adopted different names for registers.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
63 It would be nice to fix them to have a common convention
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
64 _stub_registers
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
65 stub_registers
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
66 alt_stub_registers
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
67 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
68
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
69 extern target_register_t * _registers ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
70 /* A pointer to the current set of registers */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
71 extern target_register_t registers[NUMREGS]; /* The current saved registers */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
72 extern target_register_t alt_registers[NUMREGS] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
73 /* Thread or saved process state */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
74
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
75
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
76 void __stub_copy_registers(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
77 target_register_t * dest,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
78 target_register_t *src
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 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
81 target_register_t * limit ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
82 limit = dest + NUMREGS ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
83
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
84 while (dest < limit) *dest++ = *src++ ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
85 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
86
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
87 extern int stubhex(char ch) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
88
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
89 /* ----- STUB_PACK_NAK ----------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
90 /* Pack an error response into the response packet */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
91
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
92 char * stub_pack_nak(char * outbuf)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
93 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
94 *outbuf++ = 'E' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
95 *outbuf++ = '0' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
96 *outbuf++ = '2' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
97 return outbuf ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
98 } /* stub_pack_nak */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
99
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
100 /* ----- STUB_PACK_ACK -------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
101 /* Pack an OK achnowledgement */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
102 char * stub_pack_ack(char * outbuf)
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 *outbuf++ = 'O' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
105 *outbuf++ = 'K' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
106 return outbuf ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
107 } /* stub_pack_ack */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
108
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
109 /* ------- STUB_UNPACK_INT ------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
110 /* Unpack a few bytes and return its integer value */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
111 /* This is where I wish functions could return several values
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
112 I would also advance the buffer pointer */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
113
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
114 int stub_unpack_int(char * buff,int fieldlength)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
115 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
116 int retval = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
117 int nibble ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
118 while (fieldlength)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
119 { nibble = stubhex(*buff++) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
120 retval |= nibble ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
121 fieldlength-- ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
122 if (fieldlength) retval = retval << 4 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
123 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
124 return retval ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
125 } /* stub_unpack_int */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
126
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
127 static char * unpack_byte(char * buf, int * value)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
128 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
129 *value = stub_unpack_int(buf,2) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
130 return buf + 2 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
131 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
132
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
133 static char * unpack_int(char * buf, int * value)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
134 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
135 *value = stub_unpack_int(buf,8) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
136 return buf + 8 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
137 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
138
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
139 /* We are NOT depending upun extensive libraries */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
140 static int ishex(char ch,int *val)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
141 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
142 if ((ch >= 'a') && (ch <= 'f'))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
143 { *val =ch - 'a' + 10 ; return 1 ; }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
144 if ((ch >= 'A') && (ch <= 'F'))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
145 { *val = ch - 'A' + 10 ; return 1 ;}
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
146 if ((ch >= '0') && (ch <= '9'))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
147 { *val = ch - '0' ; return 1 ; }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
148 return 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
149 } /* ishex */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
150
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
151 static char * unpack_nibble(char * buf,int * val)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
152 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
153 ishex(*buf++,val) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
154 return buf ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
155 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
156
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
157
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
158 static const char hexchars[] = "0123456789abcdef";
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
159
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
160 static char * pack_hex_byte(char * pkt, unsigned char byte)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
161 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
162 *pkt++ = hexchars[(byte >> 4) & 0xf] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
163 *pkt++ = hexchars[(byte & 0xf)] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
164 return pkt ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
165 } /* pack_hex_byte */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
166
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
167 #if 0 // Currenly unused by eCos stub.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
168 /* ---- STUB_PACK_VARLEN_HEX ------------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
169 /* Format a variable length stream of hex bytes */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
170
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
171 static char * pack_varlen_hex(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
172 char * pkt,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
173 unsigned int value)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
174 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
175 int i ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
176 static unsigned char n[8] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
177 if (value == 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 *pkt++ = '0' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
180 return pkt ;
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 else
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 i = 8 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
185 while (i-- >= 0 ) /* unpack nibbles into a char array */
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 n[i] = value & 0x0f ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
188 value = value >> 4 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
189 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
190 i = 0 ; /* we had descrmented it to -1 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
191 while (n[i] == 0 ) i++ ; /* drop leading zeroes */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
192 while (i++ < 8) *pkt++ = hexchars[n[i]] ; /* pack the number */
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 return pkt ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
195 } /* pack_varlen_hex */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
196 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
197
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
198 /* ------ STUB_UNPACK_VARLEN_HEX -------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
199 /* Parse a stream of hex bytes which may be of variable length */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
200 /* return the pointer to the next char */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
201 /* modify a varparm containing the result */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
202 /* A failure would look like a non-increment of the buffer pointer */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
203
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
204 /* This unpacks hex strings that may have been packed using sprintf(%x) */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
205 /* We assume some non-hex delimits them */
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 char * unpack_varlen_hex(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
208 char * buff, /* packet to parse */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
209 int * result)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
210 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
211 int nibble ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
212 int retval ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
213 retval = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
214
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
215 while (ishex(*buff,&nibble))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
216 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
217 buff++ ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
218 retval = retval << 4 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
219 retval |= nibble & 0x0f ;
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 *result = retval ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
222 return buff ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
223 } /* stub_unpack_varlen_int */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
224
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
225
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
226 /* ------ UNPACK_THREADID ------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
227 /* A threadid is a 64 bit quantity */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
228
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
229 #define BUFTHREADIDSIZ 16 /* encode 64 bits in 16 chars of hex */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
230
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
231 static char * unpack_threadid(char * inbuf, threadref * id)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
232 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
233 char * altref ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
234 char * limit = inbuf + BUFTHREADIDSIZ ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
235 int x,y ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
236 altref = (char *) id ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
237
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
238 while (inbuf < limit)
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 x = stubhex(*inbuf++) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
241 y = stubhex(*inbuf++) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
242 *altref++ = (x << 4) | y ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
243 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
244 return inbuf ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
245 } /* unpack_threadid */
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
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 /* Pack an integer use leading zeroes */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
250 static char * pack_int(char * buf,int value)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
251 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
252 buf = pack_hex_byte(buf,(value>> 24)& 0xff) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
253 buf = pack_hex_byte(buf,(value >>16)& 0xff) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
254 buf = pack_hex_byte(buf,(value >>8) & 0x0ff) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
255 buf = pack_hex_byte(buf,(value & 0xff)) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
256 return buf ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
257 } /* pack_int */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
258
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
259
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
260 /* -------- PACK_STRING ---------------------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
261 /* This stupid string better not contain any funny characters */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
262 /* Also, the GDB protocol will not cope with NULLs in the
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
263 string or at the end of it.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
264 While is is posable to encapsulate the protocol in ays that
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
265 preclude filtering for # I am assuming this is a constraint.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
266 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
267
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
268 static char * pack_raw_string(char * pkt,char * string)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
269 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
270 char ch ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
271 while (0 != (ch = *string++)) *pkt++ = ch ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
272 return pkt ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
273 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
274
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
275 static char * pack_string(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
276 char * pkt,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
277 char * string)
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 char ch ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
280 int len = 0;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
281 char *s = string;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
282 while( *s++ ) len++;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
283 if (len > 200 ) len = 200 ; /* Bigger than most GDB packets, junk??? */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
284 pkt = pack_hex_byte(pkt,len) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
285 while (len-- > 0)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
286 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
287 ch = *string++ ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
288 if ((ch == '\0') || (ch == '#')) ch = '*' ; /* Protect encapsulation */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
289 *pkt++ = ch ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
290 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
291 return pkt ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
292 } /* pack_string */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
293
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
294
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
295 /* ----- STUB_PACK_THREADID --------------------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
296 /* Convert a binary 64 bit threadid and pack it into a xmit buffer */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
297 /* Return the advanced buffer pointer */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
298
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
299 static char * pack_threadid(char * pkt, threadref * id)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
300 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
301 char * limit ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
302 unsigned char * altid ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
303 altid = (unsigned char *) id ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
304 limit = pkt + BUFTHREADIDSIZ ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
305 while (pkt < limit) pkt = pack_hex_byte(pkt,*altid++) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
306 return pkt ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
307 } /* stub_pack_threadid */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
308
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
309 /* UNFORTUNATLY, not all ow the extended debugging system has yet been
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
310 converted to 64 but thread referenecces and process identifiers.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
311 These routines do the conversion.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
312 An array of bytes is the correct treatment of an opaque identifier.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
313 ints have endian issues.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
314 */
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 static void int_to_threadref(threadref * id, int value)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
317 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
318 unsigned char * scan ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
319 scan = (unsigned char *) id ;
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 int i = 4 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
322 while (i--) *scan++ = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
323 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
324 *scan++ = (value >> 24) & 0xff ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
325 *scan++ = (value >> 16) & 0xff ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
326 *scan++ = (value >> 8) & 0xff ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
327 *scan++ = (value & 0xff) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
328 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
329
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
330 static int threadref_to_int(threadref * ref)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
331 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
332 int value = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
333 unsigned char * scan ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
334 int i ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
335
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
336 scan = (char *) ref ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
337 scan += 4 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
338 i = 4 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
339 while (i-- > 0) value = (value << 8) | ((*scan++) & 0xff) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
340 return value ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
341 } /* threadref_to_int */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
342
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
343 void copy_threadref(threadref * dest, threadref * src)
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 int i ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
346 unsigned char * csrc, * cdest ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
347 csrc = (unsigned char *) src ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
348 cdest = (unsigned char *) dest ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
349 i = 8 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
350 while (i--) *cdest++ = *csrc++ ;
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
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
353
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
354 int threadmatch(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
355 threadref * dest ,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
356 threadref * src
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
357 )
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
358 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
359 unsigned char * srcp, * destp ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
360 int i , result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
361 srcp = (char *) src ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
362 destp = (char *) dest ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
363 i = 8 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
364 result = 1 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
365 while (i-- > 0 ) result &= (*srcp++ == *destp++) ? 1 : 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
366 return result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
367 } /* threadmatch */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
368
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
369
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
370
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
371 static char * Tpkt_threadtag = "thread:" ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
372
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
373 /* ----- STUB_PACK_TPKT_THREADID ------------------------------------ */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
374 /* retreive, tag and insert a thread identifier into a T packet. */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
375 /* Insert nothing if the thread identifier is not available */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
376
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
377 char * stub_pack_Tpkt_threadid(char * pkt)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
378 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
379 static threadref thread ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
380 int fmt = 0 ; /* old format */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
381 PKT_TRACE("Tpkt-id","---") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
382 if (dbg_currthread(&thread))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
383 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
384 pkt = pack_raw_string(pkt,Tpkt_threadtag) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
385 if (fmt)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
386 pkt = pack_threadid(pkt,&thread) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
387 else
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
388 /* Until GDB lengthens its thread ids, we have to MASH
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
389 the threadid into somthing shorter. PLEASE FIX GDB */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
390 pkt = pack_int(pkt,threadref_to_int(&thread)) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
391 *pkt++ = ';' ; /* terminate variable length int */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
392 *pkt = '\0' ; /* Null terminate to allow string to be printed, no++ */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
393 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
394 PKT_TRACE("packedTpkt","--") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
395 return pkt ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
396 } /* stub_pack_Tpkt_threadid */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
397
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
398
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
399 void stub_pkt_currthread(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
400 char * inbuf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
401 char * outbuf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
402 int bufmax)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
403 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
404 threadref thread ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
405 char * base_out ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
406 base_out = outbuf ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
407
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
408 if (dbg_currthread(&thread))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
409 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
410 *outbuf++ = 'q' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
411 *outbuf++ = 'P' ; /* FIXME: Is this a reasanable code */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
412 outbuf = pack_threadid(outbuf,&thread) ; /* Long form */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
413 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
414 else outbuf = stub_pack_nak(outbuf) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
415 *outbuf = '\0' ; /* terminate response packet */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
416 PKT_TRACE("stub_pkt_currthread(resp) ",base_out) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
417 } /* stub_pkt_currthread */
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 /* ----- STUB_PKT_THREAD_ALIVE --------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
420 /* Answer the thread alive query */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
421
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
422 void stub_pkt_thread_alive(char * inbuf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
423 char * outbuf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
424 int bufmax)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
425 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
426 char * prebuf = inbuf ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
427 int result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
428 threadref thread ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
429 struct cygmon_thread_debug_info info ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
430
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
431 if (prebuf != (inbuf = unpack_varlen_hex(inbuf,&result)))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
432 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
433 int_to_threadref(&thread,result) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
434 /* pack old format into internal format */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
435 if ((dbg_threadinfo(&thread,&info))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
436 && info.context_exists)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
437 { outbuf = stub_pack_ack(outbuf) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
438 *outbuf = '\0' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
439 return ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
440 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
441 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
442 outbuf = stub_pack_nak(outbuf) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
443 *outbuf = '\0' ; /* terminate the response message */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
444 } /* stub_pkt_thread_alive */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
445
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
446
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
447
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
448 /* ----- STUB_PKT_CHANGETHREAD ------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
449 /* Switch the display of registers to that of a saved context */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
450
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
451 /* Changing the context makes NO sense, although the packets define the
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
452 capability. Therefore, the option to change the context back does
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
453 call the function to change registers. Also, there is no
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
454 forced context switch.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
455 'p' - New format, long long threadid, no special cases
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
456 'c' - Old format, id for continue,32 bit threadid max, possably less
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
457 -1 contimue means continue all threads
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
458 'g' - Old Format, id for general use (other than continue)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
459
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
460 replies:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
461 OK for success
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
462 ENN for error
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
463 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
464
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
465 void stub_pkt_changethread(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
466 char * inbuf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
467 char * outbuf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
468 int bufmax)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
469 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
470 threadref id ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
471 int idefined = -1 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
472 char ch ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
473 PKT_TRACE("setthread-pkt ",inbuf) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
474
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
475 /* Parse the incoming packet for a thread identifier */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
476 switch (ch = *inbuf++ ) /* handle various packet formats */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
477 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
478 case 'p' : /* New format: mode:8,threadid:64 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
479 inbuf = unpack_nibble(inbuf,&idefined) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
480 inbuf = unpack_threadid(inbuf,&id) ; /* even if startflag */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
481 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
482 case 'c' : /* old format , specify thread for continue */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
483 outbuf = stub_pack_nak(outbuf) ; /* Not supported */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
484 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
485 case 'g' : /* old format, specify thread for general operations */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
486 /* OLD format: parse a variable length hex string */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
487 /* OLD format consider special thread ids */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
488 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
489 int oldthreadid ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
490 inbuf = unpack_varlen_hex(inbuf,&oldthreadid) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
491 int_to_threadref(&id,oldthreadid) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
492 switch (oldthreadid)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
493 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
494 case 0 : /* pick a thread, any thread */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
495 idefined = 2 ; /* select original interrupted context */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
496 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
497 case -1 : /* all threads */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
498 idefined = 2 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
499 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
500 default :
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
501 idefined = 1 ; /* select the specified thread */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
502 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
503 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
504 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
505 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
506 default:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
507 outbuf = stub_pack_nak(outbuf) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
508 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
509 } /* handle various packet formats */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
510
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
511
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
512 switch (idefined)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
513 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
514 case -1 :
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
515 /* Packet not supported, already NAKed, no further action */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
516 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
517 case 0 :
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
518 /* Switch back to interrupted context */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
519 _registers = &registers[0] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
520 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
521 case 1 :
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
522 /* copy the saved registers into the backup registers */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
523 __stub_copy_registers(alt_registers,registers) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
524 /* The OS will now update the values it has in a saved process context*/
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
525 if (dbg_getthreadreg(&id,NUMREGS,&alt_registers[0]))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
526 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
527 /* switch the registers pointer */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
528 _registers = &alt_registers[0] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
529 outbuf = stub_pack_ack(outbuf) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
530 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
531 else
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
532 outbuf = stub_pack_nak(outbuf) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
533 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
534 case 2 : break ; /* switch to interrupted context */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
535 default:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
536 outbuf = stub_pack_nak(outbuf) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
537 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
538 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
539 *outbuf = '\0' ; /* Terminate response pkt */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
540 } /* stub_pkt-changethread */
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
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
543 /* ---- STUB_PKT_GETTHREADLIST ------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
544 /* Get a portion of the threadlist or process list */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
545 /* This may be part of a multipacket transaction */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
546 /* It would be hard to tell in the response packet the difference
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
547 between the end of list and an error in threadid encoding.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
548 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
549
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
550 void stub_pkt_getthreadlist(char * inbuf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
551 char * outbuf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
552 int bufmax)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
553 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
554 char * count_ptr ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
555 char * done_ptr ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
556 char * limit ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
557 int start_flag , batchsize , result , count ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
558 static threadref lastthread, nextthread ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
559
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
560 #if PKT_DEBUG
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
561 char * r_base = outbuf ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
562 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
563 PKT_TRACE("pkt_getthreadlist: ",inbuf) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
564
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
565 count = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
566 inbuf = unpack_nibble(inbuf,&start_flag) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
567 inbuf = unpack_byte(inbuf,&batchsize) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
568 inbuf = unpack_threadid(inbuf,&lastthread) ; /* even if startflag */
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 /* Start building response packet */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
571 limit = outbuf + (bufmax - BUFTHREADIDSIZ - 10) ; /* id output packing limit */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
572 *outbuf++ = 'Q' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
573 *outbuf++ = 'M' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
574
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
575 /* Default values for count and done fields, save ptr to repatch */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
576 count_ptr = outbuf ; /* save to repatch count */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
577 outbuf = pack_hex_byte(outbuf,0) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
578 done_ptr = outbuf ; /* Backpatched later */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
579 *outbuf++ = '0' ; /* Done = 0 by default */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
580 outbuf = pack_threadid(outbuf,&lastthread) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
581
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
582 /* Loop through the threadid packing */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
583 while ((outbuf < limit) && (count < batchsize))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
584 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
585 result = dbg_threadlist(start_flag,&lastthread,&nextthread) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
586 start_flag = 0 ; /* redundent but effective */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
587 if (!result)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
588 { *done_ptr = '1' ; /* pack the done flag */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
589 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
590 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
591 #if 0 /* DEBUG */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
592 if (threadmatch(&lastthread,&nextthread))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
593 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
594 output_string("FAIL: Threadlist, not incrementing\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
595 *done_ptr = '1' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
596 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
597 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
598 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
599 count++ ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
600 outbuf = pack_threadid(outbuf,&nextthread) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
601 copy_threadref(&lastthread,&nextthread) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
602 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
603 pack_hex_byte(count_ptr,count) ;/* backpatch, Pack the count field */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
604 *outbuf = '\0' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
605 PKT_TRACE("pkt_getthreadlist(resp) ",r_base) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
606 } /* pkt_getthreadlist */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
607
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
608
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
609
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
610
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
611 /* ----- STUB_PKT_GETTHREADINFO ---------------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
612 /* Get the detailed information about a specific thread or process */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
613
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
614 /*
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
615 Encoding:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
616 'Q':8,'P':8,mask:16
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
617
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
618 Mask Fields
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
619 threadid:1, # always request threadid
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
620 context_exists:2,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
621 display:4,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
622 unique_name:8,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
623 more_display:16
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
624 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
625
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
626 void stub_pkt_getthreadinfo(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
627 char * inbuf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
628 char * outbuf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
629 int bufmax)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
630 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
631 int mask ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
632 int result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
633 threadref thread ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
634 struct cygmon_thread_debug_info info ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
635
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
636 info.context_exists = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
637 info.thread_display = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
638 info.unique_thread_name = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
639 info.more_display = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
640
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
641 /* Assume the packet identification chars have already been
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
642 discarded by the packet demultiples routines */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
643 PKT_TRACE("PKT getthreadinfo",inbuf) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
644
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
645 inbuf = unpack_int(inbuf,&mask) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
646 inbuf = unpack_threadid(inbuf,&thread) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
647
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
648 result = dbg_threadinfo(&thread,&info) ; /* Make system call */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
649
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
650 if (result)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
651 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
652 *outbuf++ = 'q' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
653 *outbuf++ = 'p' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
654 outbuf = pack_int(outbuf,mask) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
655 outbuf = pack_threadid(outbuf,&info.thread_id) ; /* echo threadid */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
656 if (mask & 2) /* context-exists */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
657 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
658 outbuf = pack_int(outbuf,2) ; /* tag */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
659 outbuf = pack_hex_byte(outbuf,2) ; /* length */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
660 outbuf = pack_hex_byte(outbuf,info.context_exists) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
661 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
662 if ((mask & 4) && info.thread_display)/* display */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
663 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
664 outbuf = pack_int(outbuf,4) ; /* tag */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
665 outbuf = pack_string(outbuf,info.thread_display) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
666 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
667 if ((mask & 8) && info.unique_thread_name) /* unique_name */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
668 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
669 outbuf = pack_int(outbuf,8) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
670 outbuf = pack_string(outbuf,info.unique_thread_name) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
671 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
672 if ((mask & 16) && info.more_display) /* more display */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
673 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
674 outbuf = pack_int(outbuf,16) ; /* tag 16 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
675 outbuf = pack_string(outbuf,info.more_display) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
676 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
677 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
678 else
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
679 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
680 PKT_TRACE("FAIL: dbg_threadinfo\n", "") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
681 outbuf = stub_pack_nak(outbuf) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
682 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
683 *outbuf = '\0' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
684 } /* stub_pkt_getthreadinfo */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
685
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
686
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
687
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
688
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
689 #if GDB_MOCKUP
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
690 /* ------ MATCHED GDB SIDE PACKET ENCODING AND PARSING ----------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
691
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
692 char * pack_nibble(char * buf, int nibble)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
693 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
694 *buf++ = hexchars[(nibble & 0x0f)] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
695 return buf ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
696 } /* pack_nibble */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
697
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
698 #if 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
699 static char * unpack_short(char * buf,int * value)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
700 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
701 *value = stub_unpack_int(buf,4) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
702 return buf + 4 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
703 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
704
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
705 static char * pack_short(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
706 char * buf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
707 unsigned int value)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
708 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
709 buf = pack_hex_byte(buf,(value >> 8) & 0xff) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
710 buf = pack_hex_byte(buf,(value & 0xff)) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
711 return buf ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
712 } /* pack_short */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
713 #endif
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 /* Generally, I dont bury xmit and receive calls inside packet formatters
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
717 and parsers
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
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
720
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
721
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 /* ----- PACK_SETTHREAD_REQUEST ------------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
724 /* Encoding: ??? decode gdb/remote.c
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
725 'Q':8,'p':8,idefined:8,threadid:32 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
726 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
727
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
728 char * pack_setthread_request(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
729 char * buf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
730 char fmt, /* c,g or, p */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
731 int idformat ,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
732 threadref * threadid )
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 *buf++ = fmt ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
735
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
736 if (fmt == 'p')
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
737 { /* pack the long form */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
738 buf = pack_nibble(buf,idformat) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
739 buf = pack_threadid(buf,threadid) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
740 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
741 else
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
742 { /* pack the shorter form - Serious truncation */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
743 /* There are reserved identifieds 0 , -1 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
744 int quickref = threadref_to_int(threadid) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
745 buf = pack_varlen_hex(buf,quickref) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
746 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
747 *buf++ = '\0' ; /* end_of_packet */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
748 return buf ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
749 } /* pack_setthread_request */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
750
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
751
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
752
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
753 /* -------- PACK_THREADLIST-REQUEST --------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
754 /* Format: i'Q':8,i"L":8,initflag:8,batchsize:16,lastthreadid:32 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
755
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
756
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
757 char * pack_threadlist_request(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
758 char * pkt,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
759 int startflag,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
760 int threadcount,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
761 threadref * nextthread
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
762 )
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
763 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
764 *pkt++ = 'q' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
765 *pkt++ = 'L' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
766 pkt = pack_nibble(pkt,startflag) ; /* initflag 1 bytes */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
767 pkt = pack_hex_byte(pkt,threadcount) ; /* threadcount 2 bytes */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
768 pkt = pack_threadid(pkt,nextthread) ; /* 64 bit thread identifier */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
769 *pkt = '\0' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
770 return pkt ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
771 } /* remote_threadlist_request */
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
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
774
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 /* ---------- PARSE_THREADLIST_RESPONSE ------------------------------------ */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
777 /* Encoding: 'q':8,'M':8,count:16,done:8,argthreadid:64,(threadid:64)* */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
778
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
779 int parse_threadlist_response(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
780 char * pkt,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
781 threadref * original_echo,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
782 threadref * resultlist,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
783 int * doneflag)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
784 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
785 char * limit ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
786 int count, resultcount , done ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
787 resultcount = 0 ;
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 /* assume the 'q' and 'M chars have been stripped */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
790 PKT_TRACE("parse-threadlist-response ",pkt) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
791 limit = pkt + (STUB_BUF_MAX - BUFTHREADIDSIZ) ; /* done parse past here */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
792 pkt = unpack_byte(pkt,&count) ; ; /* count field */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
793 pkt = unpack_nibble(pkt,&done) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
794 /* The first threadid is the argument threadid */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
795 pkt = unpack_threadid(pkt,original_echo) ; /* should match query packet */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
796 while ((count-- > 0) && (pkt < limit))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
797 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
798 pkt = unpack_threadid(pkt,resultlist++) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
799 resultcount++ ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
800 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
801 if (doneflag) *doneflag = done ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
802 return resultcount ; /* successvalue */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
803 } /* parse_threadlist_response */
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 struct gdb_ext_thread_info
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
806 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
807 threadref threadid ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
808 int active ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
809 char display[256] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
810 char shortname[32] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
811 char more_display[256] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
812 } ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
813
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
814
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
815 /* ----- PACK_THREAD_INFO_REQUEST -------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
816
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
817 /*
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
818 threadid:1, # always request threadid
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
819 context_exists:2,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
820 display:4,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
821 unique_name:8,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
822 more_display:16
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
823 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
824
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
825 /* Encoding: 'Q':8,'P':8,mask:32,threadid:64 */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
826
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
827 char * pack_threadinfo_request(char * pkt,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
828 int mode,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
829 threadref * id
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
830 )
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
831 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
832 *pkt++ = 'Q' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
833 *pkt++ = 'P' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
834 pkt = pack_int(pkt,mode) ; /* mode */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
835 pkt = pack_threadid(pkt,id) ; /* threadid */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
836 *pkt = '\0' ; /* terminate */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
837 return pkt ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
838 } /* pack_thread_info_request */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
839
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
840
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
841
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
842 static char * unpack_string(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
843 char * src,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
844 char * dest,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
845 int length)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
846 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
847 while (length--) *dest++ = *src++ ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
848 *dest = '\0' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
849 return src ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
850 } /* unpack_string */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
851
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
852
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
853 void output_threadid(char * title,threadref * ref)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
854 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
855 char hexid[20] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
856 pack_threadid(&hexid[0],ref) ; /* Convert threead id into hex */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
857 hexid[16] = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
858 output_string(title) ; output_string(&hexid[0]) ; output_string("\n");
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
859 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
860
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
861 /* ------ REMOTE_UPK_THREAD_INFO_RESPONSE ------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
862 /* Unpack the response of a detailed thread info packet */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
863 /* Encoding: i'Q':8,i'R':8,argmask:16,threadid:64,(tag:8,length:16,data:x)* */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
864
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
865 #define TAG_THREADID 1
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
866 #define TAG_EXISTS 2
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
867 #define TAG_DISPLAY 4
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
868 #define TAG_THREADNAME 8
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
869 #define TAG_MOREDISPLAY 16
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
870
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
871
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
872 int remote_upk_thread_info_response(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
873 char * pkt,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
874 threadref * expectedref ,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
875 struct gdb_ext_thread_info * info)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
876 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
877 int mask, length ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
878 unsigned int tag ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
879 threadref ref ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
880 char * limit = pkt + 500 ; /* plausable parsing limit */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
881 int retval = 1 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
882
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
883 PKT_TRACE("upk-threadinfo ",pkt) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
884
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
885 /* info->threadid = 0 ; FIXME: implement zero_threadref */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
886 info->active = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
887 info->display[0] = '\0' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
888 info->shortname[0] = '\0' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
889 info->more_display[0] = '\0' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
890
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
891 /* Assume the characters indicating the packet type have been stripped */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
892 pkt = unpack_int(pkt,&mask) ; /* arg mask */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
893 pkt = unpack_threadid(pkt , &ref) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
894
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
895 if (! threadmatch(&ref,expectedref))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
896 { /* This is an answer to a different request */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
897 output_string("FAIL Thread mismatch\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
898 output_threadid("ref ",&ref) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
899 output_threadid("expected ",expectedref) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
900 return 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
901 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
902 copy_threadref(&info->threadid,&ref) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
903
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
904 /* Loop on tagged fields , try to bail if somthing goes wrong */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
905 if (mask==0) output_string("OOPS NO MASK \n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
906
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
907 while ((pkt < limit) && mask && *pkt) /* packets are terminated with nulls */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
908 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
909 pkt = unpack_int(pkt,&tag) ; /* tag */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
910 pkt = unpack_byte(pkt,&length) ; /* length */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
911 if (! (tag & mask)) /* tags out of synch with mask */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
912 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
913 output_string("FAIL: threadinfo tag mismatch\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
914 retval = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
915 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
916 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
917 if (tag == TAG_THREADID)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
918 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
919 output_string("unpack THREADID\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
920 if (length != 16)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
921 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
922 output_string("FAIL: length of threadid is not 16\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
923 retval = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
924 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
925 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
926 pkt = unpack_threadid(pkt,&ref) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
927 mask = mask & ~ TAG_THREADID ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
928 continue ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
929 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
930 if (tag == TAG_EXISTS)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
931 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
932 info->active = stub_unpack_int(pkt,length) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
933 pkt += length ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
934 mask = mask & ~(TAG_EXISTS) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
935 if (length > 8)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
936 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
937 output_string("FAIL: 'exists' length too long\n");
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
938 retval = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
939 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
940 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
941 continue ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
942 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
943 if (tag == TAG_THREADNAME)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
944 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
945 pkt = unpack_string(pkt,&info->shortname[0],length) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
946 mask = mask & ~TAG_THREADNAME ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
947 continue ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
948 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
949 if (tag == TAG_DISPLAY)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
950 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
951 pkt = unpack_string(pkt,&info->display[0],length) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
952 mask = mask & ~TAG_DISPLAY ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
953 continue ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
954 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
955 if (tag == TAG_MOREDISPLAY)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
956 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
957 pkt = unpack_string(pkt,&info->more_display[0],length) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
958 mask = mask & ~TAG_MOREDISPLAY ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
959 continue ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
960 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
961 output_string("FAIL: unknown info tag\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
962 break ; /* Not a tag we know about */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
963 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
964 return retval ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
965 } /* parse-thread_info_response */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
966
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
967
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
968 /* ---- REMOTE_PACK-CURRTHREAD_REQUEST ---------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
969 /* This is a request to emit the T packet */
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 /* FORMAT: 'q':8,'C' */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
972
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
973 char * remote_pack_currthread_request(char * pkt )
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
974 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
975 *pkt++ = 'q' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
976 *pkt++ = 'C' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
977 *pkt = '\0' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
978 return pkt ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
979 } /* remote_pack-currthread_request */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
980
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 /* ------- REMOTE_UPK_CURTHREAD_RESPONSE ----------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
983 /* Unpack the interesting part of a T packet */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
984
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
985
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
986 int remote_upk_currthread_response(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
987 char * pkt,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
988 threadref * ref ) /* Parse a T packet */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
989 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
990 int retval = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
991 PKT_TRACE("upk-currthreadresp ",pkt) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
992
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
993 #if 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
994 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
995 static char threadtag[8] = "thread" ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
996 int retval = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
997 int i , found ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
998 char ch ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
999 int quickid ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1000
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1001 /* Unpack as a t packet */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1002 while (((ch = *pkt++) != ':') /* scan for : thread */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1003 && (ch != '\0')) /* stop at end of packet */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1004
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1005 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1006 found = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1007 i = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1008 while ((ch = *pkt++) == threadtag[i++]) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1009 if (i == 8) /* string match "thread" */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1010 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1011 pkt = unpack_varlen_hex(pkt,&quickid) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1012 retval = 1;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1013 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1014 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1015 retval = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1016 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1017 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1018 #else
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1019 pkt = unpack_threadid(pkt,ref) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1020 retval = 1 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1021 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1022 return retval ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1023 } /* remote_upk_currthread_response */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1024
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1025
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1026 /* -------- REMOTE_UPK-SIMPLE_ACK --------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1027 /* Decode a response which is eother "OK" or "Enn"
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1028 fillin error code, fillin pkfag-1== undef, 0==nak, 1 == ack ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1029 return advanced packet pointer */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1030
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1031
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1032 char * remote_upk_simple_ack(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1033 char * buf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1034 int * pkflag,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1035 int * errcode)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1036 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1037 int lclerr = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1038 char ch = *buf++ ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1039 int retval = -1 ; /* Undefined ACK , a protocol error */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1040 if (ch == 'E') /* NAK */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1041 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1042 buf = unpack_byte(buf,&lclerr) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1043 retval = 0 ; /* transaction failed, explicitly */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1044 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1045 else
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1046 if ((ch == 'O') && (*buf++ == 'K')) /* ACK */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1047 retval = 1 ; /* transaction succeeded */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1048 *pkflag = retval ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1049 *errcode = lclerr ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1050 return buf ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1051 } /* remote-upk_simple_ack */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1052
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1053
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1054 /* -------- PACK_THREADALIVE_REQUEST ------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1055
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1056 char * pack_threadalive_request(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1057 char * buf,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1058 threadref * threadid)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1059 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1060 *buf++ = 'T' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1061 buf = pack_threadid(buf,threadid) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1062 *buf = '\0' ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1063 return buf ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1064 } /* pack_threadalive_request */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1065
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1066 #endif /* GDB_MOCKUP */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1067
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1068 /* ---------------------------------------------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1069 /* UNIT_TESTS SUBSECTION */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1070 /* ---------------------------------------------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1071
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1072
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1073 #if UNIT_TEST
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1074 extern void output_string(char * message) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1075 static char test_req[400] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1076 static char t_response[400] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1077
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1078
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1079
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1080 /* ----- DISPLAY_THREAD_INFO ---------------------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1081 /* Use local cygmon string output utiities */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1082
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1083 void display_thread_info(struct gdb_ext_thread_info * info)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1084 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1085
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1086 output_threadid("Threadid: ",&info->threadid) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1087 /* short name */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1088 output_string("Name: ") ; output_string(info->shortname) ; output_string("\n");
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1089 /* format display state */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1090 output_string("State: ") ; output_string(info->display) ; output_string("\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1091 /* additional data */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1092 output_string("other: ");output_string(info->more_display);
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1093 output_string("\n\n");
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1094 } /* display_thread_info */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1095
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1096
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1097 /* --- CURRTHREAD-TEST -------------------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1098 static int currthread_test(threadref * thread)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1099 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1100 int result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1101 output_string("TEST: currthread\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1102 remote_pack_currthread_request(test_req) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1103 stub_pkt_currthread(test_req+2,t_response,STUB_BUF_MAX) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1104 result = remote_upk_currthread_response(t_response+2,thread) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1105 if (result)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1106 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1107 output_string("PASS getcurthread\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1108 /* FIXME: print the thread */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1109 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1110 else
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1111 output_string("FAIL getcurrthread\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1112 return result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1113 } /* currthread_test */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1114
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1115 /* ------ SETTHREAD_TEST ------------------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1116 /* use a known thread from previous test */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1117
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1118 static int setthread_test(threadref * thread)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1119 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1120 int result, errcode ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1121 output_string("TEST: setthread\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1122
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1123 pack_setthread_request(test_req,'p',1,thread) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1124 stub_pkt_changethread(test_req,t_response,STUB_BUF_MAX) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1125 remote_upk_simple_ack(t_response,&result,&errcode) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1126 switch (result)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1127 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1128 case 0 :
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1129 output_string("FAIL setthread\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1130 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1131 case 1 :
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1132 output_string("PASS setthread\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1133 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1134 default :
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1135 output_string("FAIL setthread -unrecognized response\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1136 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1137 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1138 return result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1139 } /* setthread_test */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1140
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1141
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1142 /* ------ THREADACTIVE_TEST ---------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1143 /* use known thread */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1144 /* pack threadactive packet */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1145 /* process threadactive packet */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1146 /* parse threadactive response */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1147 /* check results */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1148
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1149
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1150 int threadactive_test(threadref * thread)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1151 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1152 int result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1153 int errcode ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1154 output_string("TEST: threadactive\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1155 pack_threadalive_request(test_req,thread) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1156 stub_pkt_thread_alive(test_req+1,t_response,STUB_BUF_MAX);
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1157 remote_upk_simple_ack(t_response,&result,&errcode) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1158 switch (result)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1159 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1160 case 0 :
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1161 output_string("FAIL threadalive\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1162 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1163 case 1 :
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1164 output_string("PASS threadalive\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1165 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1166 default :
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1167 output_string("FAIL threadalive -unrecognized response\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1168 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1169 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1170 return result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1171 } /* threadactive_test */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1172
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1173 /* ------ REMOTE_GET_THREADINFO -------------------------------------- */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1174 int remote_get_threadinfo(
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1175 threadref * threadid,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1176 int fieldset , /* TAG mask */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1177 struct gdb_ext_thread_info * info
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1178 )
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1179 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1180 int result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1181 pack_threadinfo_request(test_req,fieldset,threadid) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1182 stub_pkt_getthreadinfo(test_req+2,t_response,STUB_BUF_MAX) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1183 result = remote_upk_thread_info_response(t_response+2,threadid,info) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1184 return result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1185 } /* remote_get-thrreadinfo */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1186
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1187
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1188 static struct gdb_ext_thread_info test_info ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1189
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1190 static int get_and_display_threadinfo(threadref * thread)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1191 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1192 int mode ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1193 int result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1194 /* output_string("TEST: get and display threadinfo\n") ; */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1195
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1196 mode = TAG_THREADID | TAG_EXISTS | TAG_THREADNAME
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1197 | TAG_MOREDISPLAY | TAG_DISPLAY ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1198 result = remote_get_threadinfo(thread,mode,&test_info) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1199 if (result) display_thread_info(&test_info) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1200 #if 0 /* silent subtest */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1201 if (result)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1202 output_string("PASS: get_and_display threadinfo\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1203 else
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1204 output_string("FAIL: get_and_display threadinfo\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1205 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1206 return result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1207 } /* get-and-display-threadinfo */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1208
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1209
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1210
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1211 /* ----- THREADLIST_TEST ------------------------------------------ */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1212 #define TESTLISTSIZE 16
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1213 #define TLRSIZ 2
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1214 static threadref test_threadlist[TESTLISTSIZE] ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1215
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1216 static int threadlist_test(void)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1217 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1218 int done, i , result_count ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1219 int startflag = 1 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1220 int result = 1 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1221 int loopcount = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1222 static threadref nextthread ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1223 static threadref echo_nextthread ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1224
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1225 output_string("TEST: threadlist\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1226
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1227 done = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1228 while (! done)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1229 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1230 if (loopcount++ > 10)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1231 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1232 result = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1233 output_string("FAIL: Threadlist test -infinite loop-\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1234 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1235 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1236 pack_threadlist_request(test_req,startflag,TLRSIZ,&nextthread) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1237 startflag = 0 ; /* clear for later iterations */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1238 stub_pkt_getthreadlist(test_req+2,t_response,STUB_BUF_MAX);
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1239 result_count = parse_threadlist_response(t_response+2,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1240 &echo_nextthread,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1241 &test_threadlist[0],&done) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1242 if (! threadmatch(&echo_nextthread,&nextthread))
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1243 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1244 output_string("FAIL: threadlist did not echo arg thread\n");
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1245 result = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1246 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1247 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1248 if (result_count <= 0)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1249 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1250 if (done != 0)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1251 { output_string("FAIL threadlist_test, failed to get list");
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1252 result = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1253 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1254 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1255 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1256 if (result_count > TLRSIZ)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1257 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1258 output_string("FAIL: threadlist response longer than requested\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1259 result = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1260 break ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1261 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1262 /* Setup to resume next batch of thread references , set nestthread */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1263 copy_threadref(&nextthread,&test_threadlist[result_count-1]) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1264 /* output_threadid("last-of-batch",&nextthread) ; */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1265 i = 0 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1266 while (result_count--)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1267 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1268 if (0) /* two display alternatives */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1269 output_threadid("truncatedisplay",&test_threadlist[i++]) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1270 else
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1271 get_and_display_threadinfo(&test_threadlist[i++]) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1272 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1273
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1274 }
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1275 if (!result)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1276 output_string("FAIL: threadlist test\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1277 else output_string("PASS: Threadlist test\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1278 return result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1279 } /* threadlist_test */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1280
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1281
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1282 static threadref testthread ;
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
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1285 int test_thread_support(void)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1286 {
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1287 int result = 1 ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1288 output_string("TESTING Thread support infrastructure\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1289 stub_pack_Tpkt_threadid(test_req) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1290 PKT_TRACE("packing the threadid -> ",test_req) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1291 result &= currthread_test(&testthread) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1292 result &= get_and_display_threadinfo(&testthread) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1293 result &= threadlist_test() ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1294 result &= setthread_test(&testthread) ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1295 if (result)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1296 output_string("PASS: UNITTEST Thread support\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1297 else
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1298 output_string("FAIL: UNITTEST Thread support\n") ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1299 return result ;
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1300 } /* test-thread_support */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1301 #endif /* UNIT_TEST */
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1302
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1303 #endif // ifdef CYGDBG_HAL_DEBUG_GDB_THREAD_SUPPORT...