root / gdbstub.c @ 80cabfad
History | View | Annotate | Download (14.4 kB)
1 | b4608c04 | bellard | /*
|
---|---|---|---|
2 | b4608c04 | bellard | * gdb server stub
|
3 | b4608c04 | bellard | *
|
4 | b4608c04 | bellard | * Copyright (c) 2003 Fabrice Bellard
|
5 | b4608c04 | bellard | *
|
6 | b4608c04 | bellard | * This library is free software; you can redistribute it and/or
|
7 | b4608c04 | bellard | * modify it under the terms of the GNU Lesser General Public
|
8 | b4608c04 | bellard | * License as published by the Free Software Foundation; either
|
9 | b4608c04 | bellard | * version 2 of the License, or (at your option) any later version.
|
10 | b4608c04 | bellard | *
|
11 | b4608c04 | bellard | * This library is distributed in the hope that it will be useful,
|
12 | b4608c04 | bellard | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
13 | b4608c04 | bellard | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
14 | b4608c04 | bellard | * Lesser General Public License for more details.
|
15 | b4608c04 | bellard | *
|
16 | b4608c04 | bellard | * You should have received a copy of the GNU Lesser General Public
|
17 | b4608c04 | bellard | * License along with this library; if not, write to the Free Software
|
18 | b4608c04 | bellard | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
19 | b4608c04 | bellard | */
|
20 | b4608c04 | bellard | #include <stdlib.h> |
21 | b4608c04 | bellard | #include <stdio.h> |
22 | b4608c04 | bellard | #include <string.h> |
23 | b4608c04 | bellard | #include <unistd.h> |
24 | b4608c04 | bellard | #include <errno.h> |
25 | b4608c04 | bellard | #include <sys/socket.h> |
26 | b4608c04 | bellard | #include <netinet/in.h> |
27 | b4608c04 | bellard | #include <netinet/tcp.h> |
28 | b4608c04 | bellard | #include <signal.h> |
29 | b4608c04 | bellard | |
30 | b4608c04 | bellard | #include "config.h" |
31 | 6180a181 | bellard | #include "cpu.h" |
32 | b4608c04 | bellard | #include "thunk.h" |
33 | 6180a181 | bellard | #include "exec-all.h" |
34 | b4608c04 | bellard | |
35 | 4abe615b | bellard | //#define DEBUG_GDB
|
36 | b4608c04 | bellard | |
37 | b4608c04 | bellard | int gdbstub_fd = -1; |
38 | b4608c04 | bellard | |
39 | b4608c04 | bellard | /* return 0 if OK */
|
40 | b4608c04 | bellard | static int gdbstub_open(int port) |
41 | b4608c04 | bellard | { |
42 | b4608c04 | bellard | struct sockaddr_in sockaddr;
|
43 | b4608c04 | bellard | socklen_t len; |
44 | b4608c04 | bellard | int fd, val, ret;
|
45 | b4608c04 | bellard | |
46 | b4608c04 | bellard | fd = socket(PF_INET, SOCK_STREAM, 0);
|
47 | b4608c04 | bellard | if (fd < 0) { |
48 | b4608c04 | bellard | perror("socket");
|
49 | b4608c04 | bellard | return -1; |
50 | b4608c04 | bellard | } |
51 | b4608c04 | bellard | |
52 | b4608c04 | bellard | /* allow fast reuse */
|
53 | b4608c04 | bellard | val = 1;
|
54 | b4608c04 | bellard | setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, &val, sizeof(val));
|
55 | b4608c04 | bellard | |
56 | b4608c04 | bellard | sockaddr.sin_family = AF_INET; |
57 | b4608c04 | bellard | sockaddr.sin_port = htons(port); |
58 | b4608c04 | bellard | sockaddr.sin_addr.s_addr = 0;
|
59 | b4608c04 | bellard | ret = bind(fd, (struct sockaddr *)&sockaddr, sizeof(sockaddr)); |
60 | b4608c04 | bellard | if (ret < 0) { |
61 | b4608c04 | bellard | perror("bind");
|
62 | b4608c04 | bellard | return -1; |
63 | b4608c04 | bellard | } |
64 | b4608c04 | bellard | ret = listen(fd, 0);
|
65 | b4608c04 | bellard | if (ret < 0) { |
66 | b4608c04 | bellard | perror("listen");
|
67 | b4608c04 | bellard | return -1; |
68 | b4608c04 | bellard | } |
69 | b4608c04 | bellard | |
70 | b4608c04 | bellard | /* now wait for one connection */
|
71 | b4608c04 | bellard | for(;;) {
|
72 | b4608c04 | bellard | len = sizeof(sockaddr);
|
73 | b4608c04 | bellard | gdbstub_fd = accept(fd, (struct sockaddr *)&sockaddr, &len);
|
74 | b4608c04 | bellard | if (gdbstub_fd < 0 && errno != EINTR) { |
75 | b4608c04 | bellard | perror("accept");
|
76 | b4608c04 | bellard | return -1; |
77 | b4608c04 | bellard | } else if (gdbstub_fd >= 0) { |
78 | b4608c04 | bellard | break;
|
79 | b4608c04 | bellard | } |
80 | b4608c04 | bellard | } |
81 | b4608c04 | bellard | |
82 | b4608c04 | bellard | /* set short latency */
|
83 | b4608c04 | bellard | val = 1;
|
84 | b4608c04 | bellard | setsockopt(gdbstub_fd, SOL_TCP, TCP_NODELAY, &val, sizeof(val));
|
85 | b4608c04 | bellard | return 0; |
86 | b4608c04 | bellard | } |
87 | b4608c04 | bellard | |
88 | b4608c04 | bellard | static int get_char(void) |
89 | b4608c04 | bellard | { |
90 | b4608c04 | bellard | uint8_t ch; |
91 | b4608c04 | bellard | int ret;
|
92 | b4608c04 | bellard | |
93 | b4608c04 | bellard | for(;;) {
|
94 | b4608c04 | bellard | ret = read(gdbstub_fd, &ch, 1);
|
95 | b4608c04 | bellard | if (ret < 0) { |
96 | b4608c04 | bellard | if (errno != EINTR && errno != EAGAIN)
|
97 | b4608c04 | bellard | return -1; |
98 | b4608c04 | bellard | } else if (ret == 0) { |
99 | b4608c04 | bellard | return -1; |
100 | b4608c04 | bellard | } else {
|
101 | b4608c04 | bellard | break;
|
102 | b4608c04 | bellard | } |
103 | b4608c04 | bellard | } |
104 | b4608c04 | bellard | return ch;
|
105 | b4608c04 | bellard | } |
106 | b4608c04 | bellard | |
107 | b4608c04 | bellard | static void put_buffer(const uint8_t *buf, int len) |
108 | b4608c04 | bellard | { |
109 | b4608c04 | bellard | int ret;
|
110 | b4608c04 | bellard | |
111 | b4608c04 | bellard | while (len > 0) { |
112 | b4608c04 | bellard | ret = write(gdbstub_fd, buf, len); |
113 | b4608c04 | bellard | if (ret < 0) { |
114 | b4608c04 | bellard | if (errno != EINTR && errno != EAGAIN)
|
115 | b4608c04 | bellard | return;
|
116 | b4608c04 | bellard | } else {
|
117 | b4608c04 | bellard | buf += ret; |
118 | b4608c04 | bellard | len -= ret; |
119 | b4608c04 | bellard | } |
120 | b4608c04 | bellard | } |
121 | b4608c04 | bellard | } |
122 | b4608c04 | bellard | |
123 | b4608c04 | bellard | static inline int fromhex(int v) |
124 | b4608c04 | bellard | { |
125 | b4608c04 | bellard | if (v >= '0' && v <= '9') |
126 | b4608c04 | bellard | return v - '0'; |
127 | b4608c04 | bellard | else if (v >= 'A' && v <= 'F') |
128 | b4608c04 | bellard | return v - 'A' + 10; |
129 | b4608c04 | bellard | else if (v >= 'a' && v <= 'f') |
130 | b4608c04 | bellard | return v - 'a' + 10; |
131 | b4608c04 | bellard | else
|
132 | b4608c04 | bellard | return 0; |
133 | b4608c04 | bellard | } |
134 | b4608c04 | bellard | |
135 | b4608c04 | bellard | static inline int tohex(int v) |
136 | b4608c04 | bellard | { |
137 | b4608c04 | bellard | if (v < 10) |
138 | b4608c04 | bellard | return v + '0'; |
139 | b4608c04 | bellard | else
|
140 | b4608c04 | bellard | return v - 10 + 'a'; |
141 | b4608c04 | bellard | } |
142 | b4608c04 | bellard | |
143 | b4608c04 | bellard | static void memtohex(char *buf, const uint8_t *mem, int len) |
144 | b4608c04 | bellard | { |
145 | b4608c04 | bellard | int i, c;
|
146 | b4608c04 | bellard | char *q;
|
147 | b4608c04 | bellard | q = buf; |
148 | b4608c04 | bellard | for(i = 0; i < len; i++) { |
149 | b4608c04 | bellard | c = mem[i]; |
150 | b4608c04 | bellard | *q++ = tohex(c >> 4);
|
151 | b4608c04 | bellard | *q++ = tohex(c & 0xf);
|
152 | b4608c04 | bellard | } |
153 | b4608c04 | bellard | *q = '\0';
|
154 | b4608c04 | bellard | } |
155 | b4608c04 | bellard | |
156 | b4608c04 | bellard | static void hextomem(uint8_t *mem, const char *buf, int len) |
157 | b4608c04 | bellard | { |
158 | b4608c04 | bellard | int i;
|
159 | b4608c04 | bellard | |
160 | b4608c04 | bellard | for(i = 0; i < len; i++) { |
161 | b4608c04 | bellard | mem[i] = (fromhex(buf[0]) << 4) | fromhex(buf[1]); |
162 | b4608c04 | bellard | buf += 2;
|
163 | b4608c04 | bellard | } |
164 | b4608c04 | bellard | } |
165 | b4608c04 | bellard | |
166 | b4608c04 | bellard | /* return -1 if error or EOF */
|
167 | b4608c04 | bellard | static int get_packet(char *buf, int buf_size) |
168 | b4608c04 | bellard | { |
169 | b4608c04 | bellard | int ch, len, csum, csum1;
|
170 | b4608c04 | bellard | char reply[1]; |
171 | b4608c04 | bellard | |
172 | b4608c04 | bellard | for(;;) {
|
173 | b4608c04 | bellard | for(;;) {
|
174 | b4608c04 | bellard | ch = get_char(); |
175 | b4608c04 | bellard | if (ch < 0) |
176 | b4608c04 | bellard | return -1; |
177 | b4608c04 | bellard | if (ch == '$') |
178 | b4608c04 | bellard | break;
|
179 | b4608c04 | bellard | } |
180 | b4608c04 | bellard | len = 0;
|
181 | b4608c04 | bellard | csum = 0;
|
182 | b4608c04 | bellard | for(;;) {
|
183 | b4608c04 | bellard | ch = get_char(); |
184 | b4608c04 | bellard | if (ch < 0) |
185 | b4608c04 | bellard | return -1; |
186 | b4608c04 | bellard | if (ch == '#') |
187 | b4608c04 | bellard | break;
|
188 | b4608c04 | bellard | if (len > buf_size - 1) |
189 | b4608c04 | bellard | return -1; |
190 | b4608c04 | bellard | buf[len++] = ch; |
191 | b4608c04 | bellard | csum += ch; |
192 | b4608c04 | bellard | } |
193 | b4608c04 | bellard | buf[len] = '\0';
|
194 | b4608c04 | bellard | ch = get_char(); |
195 | b4608c04 | bellard | if (ch < 0) |
196 | b4608c04 | bellard | return -1; |
197 | b4608c04 | bellard | csum1 = fromhex(ch) << 4;
|
198 | b4608c04 | bellard | ch = get_char(); |
199 | b4608c04 | bellard | if (ch < 0) |
200 | b4608c04 | bellard | return -1; |
201 | b4608c04 | bellard | csum1 |= fromhex(ch); |
202 | b4608c04 | bellard | if ((csum & 0xff) != csum1) { |
203 | b4608c04 | bellard | reply[0] = '-'; |
204 | b4608c04 | bellard | put_buffer(reply, 1);
|
205 | b4608c04 | bellard | } else {
|
206 | b4608c04 | bellard | reply[0] = '+'; |
207 | b4608c04 | bellard | put_buffer(reply, 1);
|
208 | b4608c04 | bellard | break;
|
209 | b4608c04 | bellard | } |
210 | b4608c04 | bellard | } |
211 | b4608c04 | bellard | #ifdef DEBUG_GDB
|
212 | b4608c04 | bellard | printf("command='%s'\n", buf);
|
213 | b4608c04 | bellard | #endif
|
214 | b4608c04 | bellard | return len;
|
215 | b4608c04 | bellard | } |
216 | b4608c04 | bellard | |
217 | b4608c04 | bellard | /* return -1 if error, 0 if OK */
|
218 | b4608c04 | bellard | static int put_packet(char *buf) |
219 | b4608c04 | bellard | { |
220 | b4608c04 | bellard | char buf1[3]; |
221 | b4608c04 | bellard | int len, csum, ch, i;
|
222 | b4608c04 | bellard | |
223 | b4608c04 | bellard | #ifdef DEBUG_GDB
|
224 | b4608c04 | bellard | printf("reply='%s'\n", buf);
|
225 | b4608c04 | bellard | #endif
|
226 | b4608c04 | bellard | |
227 | b4608c04 | bellard | for(;;) {
|
228 | b4608c04 | bellard | buf1[0] = '$'; |
229 | b4608c04 | bellard | put_buffer(buf1, 1);
|
230 | b4608c04 | bellard | len = strlen(buf); |
231 | b4608c04 | bellard | put_buffer(buf, len); |
232 | b4608c04 | bellard | csum = 0;
|
233 | b4608c04 | bellard | for(i = 0; i < len; i++) { |
234 | b4608c04 | bellard | csum += buf[i]; |
235 | b4608c04 | bellard | } |
236 | b4608c04 | bellard | buf1[0] = '#'; |
237 | b4608c04 | bellard | buf1[1] = tohex((csum >> 4) & 0xf); |
238 | b4608c04 | bellard | buf1[2] = tohex((csum) & 0xf); |
239 | b4608c04 | bellard | |
240 | b4608c04 | bellard | put_buffer(buf1, 3);
|
241 | b4608c04 | bellard | |
242 | b4608c04 | bellard | ch = get_char(); |
243 | b4608c04 | bellard | if (ch < 0) |
244 | b4608c04 | bellard | return -1; |
245 | b4608c04 | bellard | if (ch == '+') |
246 | b4608c04 | bellard | break;
|
247 | b4608c04 | bellard | } |
248 | b4608c04 | bellard | return 0; |
249 | b4608c04 | bellard | } |
250 | b4608c04 | bellard | |
251 | 6da41eaf | bellard | #if defined(TARGET_I386)
|
252 | 6da41eaf | bellard | |
253 | 6da41eaf | bellard | static void to_le32(uint8_t *p, int v) |
254 | 6da41eaf | bellard | { |
255 | 6da41eaf | bellard | p[0] = v;
|
256 | 6da41eaf | bellard | p[1] = v >> 8; |
257 | 6da41eaf | bellard | p[2] = v >> 16; |
258 | 6da41eaf | bellard | p[3] = v >> 24; |
259 | 6da41eaf | bellard | } |
260 | 6da41eaf | bellard | |
261 | 6da41eaf | bellard | static int cpu_gdb_read_registers(CPUState *env, uint8_t *mem_buf) |
262 | 6da41eaf | bellard | { |
263 | 6da41eaf | bellard | int i, fpus;
|
264 | 6da41eaf | bellard | |
265 | 6da41eaf | bellard | for(i = 0; i < 8; i++) { |
266 | 6da41eaf | bellard | to_le32(mem_buf + i * 4, env->regs[i]);
|
267 | 6da41eaf | bellard | } |
268 | 6da41eaf | bellard | to_le32(mem_buf + 8 * 4, env->eip); |
269 | 6da41eaf | bellard | to_le32(mem_buf + 9 * 4, env->eflags); |
270 | 6da41eaf | bellard | to_le32(mem_buf + 10 * 4, env->segs[R_CS].selector); |
271 | 6da41eaf | bellard | to_le32(mem_buf + 11 * 4, env->segs[R_SS].selector); |
272 | 6da41eaf | bellard | to_le32(mem_buf + 12 * 4, env->segs[R_DS].selector); |
273 | 6da41eaf | bellard | to_le32(mem_buf + 13 * 4, env->segs[R_ES].selector); |
274 | 6da41eaf | bellard | to_le32(mem_buf + 14 * 4, env->segs[R_FS].selector); |
275 | 6da41eaf | bellard | to_le32(mem_buf + 15 * 4, env->segs[R_GS].selector); |
276 | 6da41eaf | bellard | /* XXX: convert floats */
|
277 | 6da41eaf | bellard | for(i = 0; i < 8; i++) { |
278 | 6da41eaf | bellard | memcpy(mem_buf + 16 * 4 + i * 10, &env->fpregs[i], 10); |
279 | 6da41eaf | bellard | } |
280 | 6da41eaf | bellard | to_le32(mem_buf + 36 * 4, env->fpuc); |
281 | 6da41eaf | bellard | fpus = (env->fpus & ~0x3800) | (env->fpstt & 0x7) << 11; |
282 | 6da41eaf | bellard | to_le32(mem_buf + 37 * 4, fpus); |
283 | 6da41eaf | bellard | to_le32(mem_buf + 38 * 4, 0); /* XXX: convert tags */ |
284 | 6da41eaf | bellard | to_le32(mem_buf + 39 * 4, 0); /* fiseg */ |
285 | 6da41eaf | bellard | to_le32(mem_buf + 40 * 4, 0); /* fioff */ |
286 | 6da41eaf | bellard | to_le32(mem_buf + 41 * 4, 0); /* foseg */ |
287 | 6da41eaf | bellard | to_le32(mem_buf + 42 * 4, 0); /* fooff */ |
288 | 6da41eaf | bellard | to_le32(mem_buf + 43 * 4, 0); /* fop */ |
289 | 6da41eaf | bellard | return 44 * 4; |
290 | 6da41eaf | bellard | } |
291 | 6da41eaf | bellard | |
292 | 6da41eaf | bellard | static void cpu_gdb_write_registers(CPUState *env, uint8_t *mem_buf, int size) |
293 | 6da41eaf | bellard | { |
294 | 6da41eaf | bellard | uint32_t *registers = (uint32_t *)mem_buf; |
295 | 6da41eaf | bellard | int i;
|
296 | 6da41eaf | bellard | |
297 | 6da41eaf | bellard | for(i = 0; i < 8; i++) { |
298 | 6da41eaf | bellard | env->regs[i] = tswapl(registers[i]); |
299 | 6da41eaf | bellard | } |
300 | 6da41eaf | bellard | env->eip = registers[8];
|
301 | 6da41eaf | bellard | env->eflags = registers[9];
|
302 | 6da41eaf | bellard | #if defined(CONFIG_USER_ONLY)
|
303 | 6da41eaf | bellard | #define LOAD_SEG(index, sreg)\
|
304 | 6da41eaf | bellard | if (tswapl(registers[index]) != env->segs[sreg].selector)\
|
305 | 6da41eaf | bellard | cpu_x86_load_seg(env, sreg, tswapl(registers[index])); |
306 | 6da41eaf | bellard | LOAD_SEG(10, R_CS);
|
307 | 6da41eaf | bellard | LOAD_SEG(11, R_SS);
|
308 | 6da41eaf | bellard | LOAD_SEG(12, R_DS);
|
309 | 6da41eaf | bellard | LOAD_SEG(13, R_ES);
|
310 | 6da41eaf | bellard | LOAD_SEG(14, R_FS);
|
311 | 6da41eaf | bellard | LOAD_SEG(15, R_GS);
|
312 | 6da41eaf | bellard | #endif
|
313 | 6da41eaf | bellard | } |
314 | 6da41eaf | bellard | |
315 | 9e62fd7f | bellard | #elif defined (TARGET_PPC)
|
316 | 9e62fd7f | bellard | static void to_le32(uint8_t *p, int v) |
317 | 9e62fd7f | bellard | { |
318 | 9e62fd7f | bellard | p[3] = v;
|
319 | 9e62fd7f | bellard | p[2] = v >> 8; |
320 | 9e62fd7f | bellard | p[1] = v >> 16; |
321 | 9e62fd7f | bellard | p[0] = v >> 24; |
322 | 9e62fd7f | bellard | } |
323 | 9e62fd7f | bellard | |
324 | 9e62fd7f | bellard | static int cpu_gdb_read_registers(CPUState *env, uint8_t *mem_buf) |
325 | 9e62fd7f | bellard | { |
326 | 9e62fd7f | bellard | uint32_t tmp; |
327 | 9e62fd7f | bellard | int i;
|
328 | 9e62fd7f | bellard | |
329 | 9e62fd7f | bellard | /* fill in gprs */
|
330 | 9e62fd7f | bellard | for(i = 0; i < 8; i++) { |
331 | 9e62fd7f | bellard | to_le32(mem_buf + i * 4, env->gpr[i]);
|
332 | 9e62fd7f | bellard | } |
333 | 9e62fd7f | bellard | /* fill in fprs */
|
334 | 9e62fd7f | bellard | for (i = 0; i < 32; i++) { |
335 | 9e62fd7f | bellard | to_le32(mem_buf + (i * 2) + 32, *((uint32_t *)&env->fpr[i])); |
336 | 9e62fd7f | bellard | to_le32(mem_buf + (i * 2) + 33, *((uint32_t *)&env->fpr[i] + 1)); |
337 | 9e62fd7f | bellard | } |
338 | 9e62fd7f | bellard | /* nip, msr, ccr, lnk, ctr, xer, mq */
|
339 | 9e62fd7f | bellard | to_le32(mem_buf + 96, tswapl(env->nip));
|
340 | 9e62fd7f | bellard | to_le32(mem_buf + 97, tswapl(_load_msr()));
|
341 | 9e62fd7f | bellard | to_le32(mem_buf + 98, 0); |
342 | 9e62fd7f | bellard | tmp = 0;
|
343 | 9e62fd7f | bellard | for (i = 0; i < 8; i++) |
344 | 9e62fd7f | bellard | tmp |= env->crf[i] << (32 - (i * 4)); |
345 | 9e62fd7f | bellard | to_le32(mem_buf + 98, tmp);
|
346 | 9e62fd7f | bellard | to_le32(mem_buf + 99, tswapl(env->lr));
|
347 | 9e62fd7f | bellard | to_le32(mem_buf + 100, tswapl(env->ctr));
|
348 | 9e62fd7f | bellard | to_le32(mem_buf + 101, tswapl(_load_xer()));
|
349 | 9e62fd7f | bellard | to_le32(mem_buf + 102, 0); |
350 | 9e62fd7f | bellard | |
351 | 9e62fd7f | bellard | return 102; |
352 | 9e62fd7f | bellard | } |
353 | 9e62fd7f | bellard | |
354 | 9e62fd7f | bellard | static void cpu_gdb_write_registers(CPUState *env, uint8_t *mem_buf, int size) |
355 | 9e62fd7f | bellard | { |
356 | 9e62fd7f | bellard | uint32_t *registers = (uint32_t *)mem_buf; |
357 | 9e62fd7f | bellard | int i;
|
358 | 9e62fd7f | bellard | |
359 | 9e62fd7f | bellard | /* fill in gprs */
|
360 | 9e62fd7f | bellard | for (i = 0; i < 32; i++) { |
361 | 9e62fd7f | bellard | env->gpr[i] = tswapl(registers[i]); |
362 | 9e62fd7f | bellard | } |
363 | 9e62fd7f | bellard | /* fill in fprs */
|
364 | 9e62fd7f | bellard | for (i = 0; i < 32; i++) { |
365 | 9e62fd7f | bellard | *((uint32_t *)&env->fpr[i]) = tswapl(registers[(i * 2) + 32]); |
366 | 9e62fd7f | bellard | *((uint32_t *)&env->fpr[i] + 1) = tswapl(registers[(i * 2) + 33]); |
367 | 9e62fd7f | bellard | } |
368 | 9e62fd7f | bellard | /* nip, msr, ccr, lnk, ctr, xer, mq */
|
369 | 9e62fd7f | bellard | env->nip = tswapl(registers[96]);
|
370 | 9e62fd7f | bellard | _store_msr(tswapl(registers[97]));
|
371 | 9e62fd7f | bellard | registers[98] = tswapl(registers[98]); |
372 | 9e62fd7f | bellard | for (i = 0; i < 8; i++) |
373 | 9e62fd7f | bellard | env->crf[i] = (registers[98] >> (32 - (i * 4))) & 0xF; |
374 | 9e62fd7f | bellard | env->lr = tswapl(registers[99]);
|
375 | 9e62fd7f | bellard | env->ctr = tswapl(registers[100]);
|
376 | 9e62fd7f | bellard | _store_xer(tswapl(registers[101]));
|
377 | 9e62fd7f | bellard | } |
378 | 6da41eaf | bellard | #else
|
379 | 6da41eaf | bellard | |
380 | 6da41eaf | bellard | static int cpu_gdb_read_registers(CPUState *env, uint8_t *mem_buf) |
381 | 6da41eaf | bellard | { |
382 | 6da41eaf | bellard | return 0; |
383 | 6da41eaf | bellard | } |
384 | 6da41eaf | bellard | |
385 | 6da41eaf | bellard | static void cpu_gdb_write_registers(CPUState *env, uint8_t *mem_buf, int size) |
386 | 6da41eaf | bellard | { |
387 | 6da41eaf | bellard | } |
388 | 6da41eaf | bellard | |
389 | 6da41eaf | bellard | #endif
|
390 | b4608c04 | bellard | |
391 | b4608c04 | bellard | /* port = 0 means default port */
|
392 | 4c3a88a2 | bellard | int cpu_gdbstub(void *opaque, int (*main_loop)(void *opaque), int port) |
393 | b4608c04 | bellard | { |
394 | b4608c04 | bellard | CPUState *env; |
395 | b4608c04 | bellard | const char *p; |
396 | 6da41eaf | bellard | int ret, ch, reg_size, type;
|
397 | b4608c04 | bellard | char buf[4096]; |
398 | b4608c04 | bellard | uint8_t mem_buf[2000];
|
399 | b4608c04 | bellard | uint32_t *registers; |
400 | b4608c04 | bellard | uint32_t addr, len; |
401 | b4608c04 | bellard | |
402 | b4608c04 | bellard | printf("Waiting gdb connection on port %d\n", port);
|
403 | b4608c04 | bellard | if (gdbstub_open(port) < 0) |
404 | b4608c04 | bellard | return -1; |
405 | b4608c04 | bellard | printf("Connected\n");
|
406 | b4608c04 | bellard | for(;;) {
|
407 | b4608c04 | bellard | ret = get_packet(buf, sizeof(buf));
|
408 | b4608c04 | bellard | if (ret < 0) |
409 | b4608c04 | bellard | break;
|
410 | b4608c04 | bellard | p = buf; |
411 | b4608c04 | bellard | ch = *p++; |
412 | b4608c04 | bellard | switch(ch) {
|
413 | b4608c04 | bellard | case '?': |
414 | b4608c04 | bellard | snprintf(buf, sizeof(buf), "S%02x", SIGTRAP); |
415 | b4608c04 | bellard | put_packet(buf); |
416 | b4608c04 | bellard | break;
|
417 | b4608c04 | bellard | case 'c': |
418 | 4c3a88a2 | bellard | if (*p != '\0') { |
419 | 4c3a88a2 | bellard | addr = strtoul(p, (char **)&p, 16); |
420 | 4c3a88a2 | bellard | env = cpu_gdbstub_get_env(opaque); |
421 | 4c3a88a2 | bellard | #if defined(TARGET_I386)
|
422 | 4c3a88a2 | bellard | env->eip = addr; |
423 | 5be1a8e0 | bellard | #elif defined (TARGET_PPC)
|
424 | 5be1a8e0 | bellard | env->nip = addr; |
425 | 4c3a88a2 | bellard | #endif
|
426 | 4c3a88a2 | bellard | } |
427 | 4c3a88a2 | bellard | ret = main_loop(opaque); |
428 | 4c3a88a2 | bellard | if (ret == EXCP_DEBUG)
|
429 | 4c3a88a2 | bellard | ret = SIGTRAP; |
430 | 4c3a88a2 | bellard | else
|
431 | 4c3a88a2 | bellard | ret = 0;
|
432 | 4c3a88a2 | bellard | snprintf(buf, sizeof(buf), "S%02x", ret); |
433 | b4608c04 | bellard | put_packet(buf); |
434 | b4608c04 | bellard | break;
|
435 | c33a346e | bellard | case 's': |
436 | c33a346e | bellard | env = cpu_gdbstub_get_env(opaque); |
437 | c33a346e | bellard | if (*p != '\0') { |
438 | c33a346e | bellard | addr = strtoul(p, (char **)&p, 16); |
439 | c33a346e | bellard | #if defined(TARGET_I386)
|
440 | c33a346e | bellard | env->eip = addr; |
441 | 5be1a8e0 | bellard | #elif defined (TARGET_PPC)
|
442 | 5be1a8e0 | bellard | env->nip = addr; |
443 | c33a346e | bellard | #endif
|
444 | c33a346e | bellard | } |
445 | c33a346e | bellard | cpu_single_step(env, 1);
|
446 | c33a346e | bellard | ret = main_loop(opaque); |
447 | c33a346e | bellard | cpu_single_step(env, 0);
|
448 | c33a346e | bellard | if (ret == EXCP_DEBUG)
|
449 | c33a346e | bellard | ret = SIGTRAP; |
450 | c33a346e | bellard | else
|
451 | c33a346e | bellard | ret = 0;
|
452 | c33a346e | bellard | snprintf(buf, sizeof(buf), "S%02x", ret); |
453 | c33a346e | bellard | put_packet(buf); |
454 | c33a346e | bellard | break;
|
455 | b4608c04 | bellard | case 'g': |
456 | b4608c04 | bellard | env = cpu_gdbstub_get_env(opaque); |
457 | 6da41eaf | bellard | reg_size = cpu_gdb_read_registers(env, mem_buf); |
458 | 6da41eaf | bellard | memtohex(buf, mem_buf, reg_size); |
459 | b4608c04 | bellard | put_packet(buf); |
460 | b4608c04 | bellard | break;
|
461 | b4608c04 | bellard | case 'G': |
462 | b4608c04 | bellard | env = cpu_gdbstub_get_env(opaque); |
463 | b4608c04 | bellard | registers = (void *)mem_buf;
|
464 | 6da41eaf | bellard | len = strlen(p) / 2;
|
465 | 6da41eaf | bellard | hextomem((uint8_t *)registers, p, len); |
466 | 6da41eaf | bellard | cpu_gdb_write_registers(env, mem_buf, len); |
467 | b4608c04 | bellard | put_packet("OK");
|
468 | b4608c04 | bellard | break;
|
469 | b4608c04 | bellard | case 'm': |
470 | 13eb76e0 | bellard | env = cpu_gdbstub_get_env(opaque); |
471 | b4608c04 | bellard | addr = strtoul(p, (char **)&p, 16); |
472 | b4608c04 | bellard | if (*p == ',') |
473 | b4608c04 | bellard | p++; |
474 | b4608c04 | bellard | len = strtoul(p, NULL, 16); |
475 | 8b1f24b0 | bellard | if (cpu_memory_rw_debug(env, addr, mem_buf, len, 0) != 0) |
476 | b4608c04 | bellard | memset(mem_buf, 0, len);
|
477 | b4608c04 | bellard | memtohex(buf, mem_buf, len); |
478 | b4608c04 | bellard | put_packet(buf); |
479 | b4608c04 | bellard | break;
|
480 | b4608c04 | bellard | case 'M': |
481 | 13eb76e0 | bellard | env = cpu_gdbstub_get_env(opaque); |
482 | b4608c04 | bellard | addr = strtoul(p, (char **)&p, 16); |
483 | b4608c04 | bellard | if (*p == ',') |
484 | b4608c04 | bellard | p++; |
485 | b4608c04 | bellard | len = strtoul(p, (char **)&p, 16); |
486 | b4608c04 | bellard | if (*p == ',') |
487 | b4608c04 | bellard | p++; |
488 | b4608c04 | bellard | hextomem(mem_buf, p, len); |
489 | 8b1f24b0 | bellard | if (cpu_memory_rw_debug(env, addr, mem_buf, len, 1) != 0) |
490 | b4608c04 | bellard | put_packet("ENN");
|
491 | b4608c04 | bellard | else
|
492 | b4608c04 | bellard | put_packet("OK");
|
493 | b4608c04 | bellard | break;
|
494 | 4c3a88a2 | bellard | case 'Z': |
495 | 4c3a88a2 | bellard | type = strtoul(p, (char **)&p, 16); |
496 | 4c3a88a2 | bellard | if (*p == ',') |
497 | 4c3a88a2 | bellard | p++; |
498 | 4c3a88a2 | bellard | addr = strtoul(p, (char **)&p, 16); |
499 | 4c3a88a2 | bellard | if (*p == ',') |
500 | 4c3a88a2 | bellard | p++; |
501 | 4c3a88a2 | bellard | len = strtoul(p, (char **)&p, 16); |
502 | 4c3a88a2 | bellard | if (type == 0 || type == 1) { |
503 | 4c3a88a2 | bellard | env = cpu_gdbstub_get_env(opaque); |
504 | 4c3a88a2 | bellard | if (cpu_breakpoint_insert(env, addr) < 0) |
505 | 4c3a88a2 | bellard | goto breakpoint_error;
|
506 | 4c3a88a2 | bellard | put_packet("OK");
|
507 | 4c3a88a2 | bellard | } else {
|
508 | 4c3a88a2 | bellard | breakpoint_error:
|
509 | 4c3a88a2 | bellard | put_packet("ENN");
|
510 | 4c3a88a2 | bellard | } |
511 | 4c3a88a2 | bellard | break;
|
512 | 4c3a88a2 | bellard | case 'z': |
513 | 4c3a88a2 | bellard | type = strtoul(p, (char **)&p, 16); |
514 | 4c3a88a2 | bellard | if (*p == ',') |
515 | 4c3a88a2 | bellard | p++; |
516 | 4c3a88a2 | bellard | addr = strtoul(p, (char **)&p, 16); |
517 | 4c3a88a2 | bellard | if (*p == ',') |
518 | 4c3a88a2 | bellard | p++; |
519 | 4c3a88a2 | bellard | len = strtoul(p, (char **)&p, 16); |
520 | 4c3a88a2 | bellard | if (type == 0 || type == 1) { |
521 | 4c3a88a2 | bellard | env = cpu_gdbstub_get_env(opaque); |
522 | 4c3a88a2 | bellard | cpu_breakpoint_remove(env, addr); |
523 | 4c3a88a2 | bellard | put_packet("OK");
|
524 | 4c3a88a2 | bellard | } else {
|
525 | 4c3a88a2 | bellard | goto breakpoint_error;
|
526 | 4c3a88a2 | bellard | } |
527 | 4c3a88a2 | bellard | break;
|
528 | 34865134 | bellard | case 'Q': |
529 | 34865134 | bellard | if (!strncmp(p, "Tinit", 5)) { |
530 | 34865134 | bellard | /* init traces */
|
531 | 34865134 | bellard | put_packet("OK");
|
532 | 34865134 | bellard | } else if (!strncmp(p, "TStart", 6)) { |
533 | 34865134 | bellard | /* start log (gdb 'tstart' command) */
|
534 | 6da41eaf | bellard | env = cpu_gdbstub_get_env(opaque); |
535 | 6da41eaf | bellard | tb_flush(env); |
536 | 34865134 | bellard | cpu_set_log(CPU_LOG_ALL); |
537 | 34865134 | bellard | put_packet("OK");
|
538 | 34865134 | bellard | } else if (!strncmp(p, "TStop", 5)) { |
539 | 34865134 | bellard | /* stop log (gdb 'tstop' command) */
|
540 | 34865134 | bellard | cpu_set_log(0);
|
541 | 34865134 | bellard | put_packet("OK");
|
542 | 34865134 | bellard | } else {
|
543 | 34865134 | bellard | goto unknown_command;
|
544 | 34865134 | bellard | } |
545 | 34865134 | bellard | break;
|
546 | b4608c04 | bellard | default:
|
547 | 34865134 | bellard | unknown_command:
|
548 | b4608c04 | bellard | /* put empty packet */
|
549 | b4608c04 | bellard | buf[0] = '\0'; |
550 | b4608c04 | bellard | put_packet(buf); |
551 | b4608c04 | bellard | break;
|
552 | b4608c04 | bellard | } |
553 | b4608c04 | bellard | } |
554 | b4608c04 | bellard | return 0; |
555 | b4608c04 | bellard | } |