blob: 0176b3f80ed3e380dab0590dee941cdee2e6d08b [file] [log] [blame]
bellardb4608c02003-06-27 17:34:32 +00001/*
2 * gdb server stub
ths5fafdf22007-09-16 21:08:06 +00003 *
bellard34751872005-07-02 14:31:34 +00004 * Copyright (c) 2003-2005 Fabrice Bellard
bellardb4608c02003-06-27 17:34:32 +00005 *
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2 of the License, or (at your option) any later version.
10 *
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
15 *
16 * You should have received a copy of the GNU Lesser General Public
Blue Swirl8167ee82009-07-16 20:47:01 +000017 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
bellardb4608c02003-06-27 17:34:32 +000018 */
pbrook978efd62006-06-17 18:30:42 +000019#include "config.h"
pbrook56aebc82008-10-11 17:55:29 +000020#include "qemu-common.h"
bellard1fddef42005-04-17 19:16:13 +000021#ifdef CONFIG_USER_ONLY
22#include <stdlib.h>
23#include <stdio.h>
24#include <stdarg.h>
25#include <string.h>
26#include <errno.h>
27#include <unistd.h>
pbrook978efd62006-06-17 18:30:42 +000028#include <fcntl.h>
bellard1fddef42005-04-17 19:16:13 +000029
30#include "qemu.h"
31#else
Paolo Bonzini83c90892012-12-17 18:19:49 +010032#include "monitor/monitor.h"
Paolo Bonzinidccfcd02013-04-08 16:55:25 +020033#include "sysemu/char.h"
Paolo Bonzini9c17d612012-12-17 18:20:04 +010034#include "sysemu/sysemu.h"
Paolo Bonzini022c62c2012-12-17 18:19:49 +010035#include "exec/gdbstub.h"
bellard1fddef42005-04-17 19:16:13 +000036#endif
bellard67b915a2004-03-31 23:37:16 +000037
pbrook56aebc82008-10-11 17:55:29 +000038#define MAX_PACKET_LENGTH 4096
39
Blue Swirl2b41f102011-06-19 20:38:22 +000040#include "cpu.h"
Paolo Bonzini1de7afc2012-12-17 18:20:00 +010041#include "qemu/sockets.h"
Paolo Bonzini9c17d612012-12-17 18:20:04 +010042#include "sysemu/kvm.h"
aurel32ca587a82008-12-18 22:44:13 +000043
Andreas Färberf3659ee2013-06-27 19:09:09 +020044static inline int target_memory_rw_debug(CPUState *cpu, target_ulong addr,
45 uint8_t *buf, int len, bool is_write)
Fabien Chouteau44520db2011-09-08 12:48:16 +020046{
Andreas Färberf3659ee2013-06-27 19:09:09 +020047 CPUClass *cc = CPU_GET_CLASS(cpu);
48
49 if (cc->memory_rw_debug) {
50 return cc->memory_rw_debug(cpu, addr, buf, len, is_write);
51 }
52 return cpu_memory_rw_debug(cpu, addr, buf, len, is_write);
Fabien Chouteau44520db2011-09-08 12:48:16 +020053}
aurel32ca587a82008-12-18 22:44:13 +000054
55enum {
56 GDB_SIGNAL_0 = 0,
57 GDB_SIGNAL_INT = 2,
Jan Kiszka425189a2011-03-22 11:02:09 +010058 GDB_SIGNAL_QUIT = 3,
aurel32ca587a82008-12-18 22:44:13 +000059 GDB_SIGNAL_TRAP = 5,
Jan Kiszka425189a2011-03-22 11:02:09 +010060 GDB_SIGNAL_ABRT = 6,
61 GDB_SIGNAL_ALRM = 14,
62 GDB_SIGNAL_IO = 23,
63 GDB_SIGNAL_XCPU = 24,
aurel32ca587a82008-12-18 22:44:13 +000064 GDB_SIGNAL_UNKNOWN = 143
65};
66
67#ifdef CONFIG_USER_ONLY
68
69/* Map target signal numbers to GDB protocol signal numbers and vice
70 * versa. For user emulation's currently supported systems, we can
71 * assume most signals are defined.
72 */
73
74static int gdb_signal_table[] = {
75 0,
76 TARGET_SIGHUP,
77 TARGET_SIGINT,
78 TARGET_SIGQUIT,
79 TARGET_SIGILL,
80 TARGET_SIGTRAP,
81 TARGET_SIGABRT,
82 -1, /* SIGEMT */
83 TARGET_SIGFPE,
84 TARGET_SIGKILL,
85 TARGET_SIGBUS,
86 TARGET_SIGSEGV,
87 TARGET_SIGSYS,
88 TARGET_SIGPIPE,
89 TARGET_SIGALRM,
90 TARGET_SIGTERM,
91 TARGET_SIGURG,
92 TARGET_SIGSTOP,
93 TARGET_SIGTSTP,
94 TARGET_SIGCONT,
95 TARGET_SIGCHLD,
96 TARGET_SIGTTIN,
97 TARGET_SIGTTOU,
98 TARGET_SIGIO,
99 TARGET_SIGXCPU,
100 TARGET_SIGXFSZ,
101 TARGET_SIGVTALRM,
102 TARGET_SIGPROF,
103 TARGET_SIGWINCH,
104 -1, /* SIGLOST */
105 TARGET_SIGUSR1,
106 TARGET_SIGUSR2,
blueswir1c72d5bf2009-01-15 17:27:45 +0000107#ifdef TARGET_SIGPWR
aurel32ca587a82008-12-18 22:44:13 +0000108 TARGET_SIGPWR,
blueswir1c72d5bf2009-01-15 17:27:45 +0000109#else
110 -1,
111#endif
aurel32ca587a82008-12-18 22:44:13 +0000112 -1, /* SIGPOLL */
113 -1,
114 -1,
115 -1,
116 -1,
117 -1,
118 -1,
119 -1,
120 -1,
121 -1,
122 -1,
123 -1,
blueswir1c72d5bf2009-01-15 17:27:45 +0000124#ifdef __SIGRTMIN
aurel32ca587a82008-12-18 22:44:13 +0000125 __SIGRTMIN + 1,
126 __SIGRTMIN + 2,
127 __SIGRTMIN + 3,
128 __SIGRTMIN + 4,
129 __SIGRTMIN + 5,
130 __SIGRTMIN + 6,
131 __SIGRTMIN + 7,
132 __SIGRTMIN + 8,
133 __SIGRTMIN + 9,
134 __SIGRTMIN + 10,
135 __SIGRTMIN + 11,
136 __SIGRTMIN + 12,
137 __SIGRTMIN + 13,
138 __SIGRTMIN + 14,
139 __SIGRTMIN + 15,
140 __SIGRTMIN + 16,
141 __SIGRTMIN + 17,
142 __SIGRTMIN + 18,
143 __SIGRTMIN + 19,
144 __SIGRTMIN + 20,
145 __SIGRTMIN + 21,
146 __SIGRTMIN + 22,
147 __SIGRTMIN + 23,
148 __SIGRTMIN + 24,
149 __SIGRTMIN + 25,
150 __SIGRTMIN + 26,
151 __SIGRTMIN + 27,
152 __SIGRTMIN + 28,
153 __SIGRTMIN + 29,
154 __SIGRTMIN + 30,
155 __SIGRTMIN + 31,
156 -1, /* SIGCANCEL */
157 __SIGRTMIN,
158 __SIGRTMIN + 32,
159 __SIGRTMIN + 33,
160 __SIGRTMIN + 34,
161 __SIGRTMIN + 35,
162 __SIGRTMIN + 36,
163 __SIGRTMIN + 37,
164 __SIGRTMIN + 38,
165 __SIGRTMIN + 39,
166 __SIGRTMIN + 40,
167 __SIGRTMIN + 41,
168 __SIGRTMIN + 42,
169 __SIGRTMIN + 43,
170 __SIGRTMIN + 44,
171 __SIGRTMIN + 45,
172 __SIGRTMIN + 46,
173 __SIGRTMIN + 47,
174 __SIGRTMIN + 48,
175 __SIGRTMIN + 49,
176 __SIGRTMIN + 50,
177 __SIGRTMIN + 51,
178 __SIGRTMIN + 52,
179 __SIGRTMIN + 53,
180 __SIGRTMIN + 54,
181 __SIGRTMIN + 55,
182 __SIGRTMIN + 56,
183 __SIGRTMIN + 57,
184 __SIGRTMIN + 58,
185 __SIGRTMIN + 59,
186 __SIGRTMIN + 60,
187 __SIGRTMIN + 61,
188 __SIGRTMIN + 62,
189 __SIGRTMIN + 63,
190 __SIGRTMIN + 64,
191 __SIGRTMIN + 65,
192 __SIGRTMIN + 66,
193 __SIGRTMIN + 67,
194 __SIGRTMIN + 68,
195 __SIGRTMIN + 69,
196 __SIGRTMIN + 70,
197 __SIGRTMIN + 71,
198 __SIGRTMIN + 72,
199 __SIGRTMIN + 73,
200 __SIGRTMIN + 74,
201 __SIGRTMIN + 75,
202 __SIGRTMIN + 76,
203 __SIGRTMIN + 77,
204 __SIGRTMIN + 78,
205 __SIGRTMIN + 79,
206 __SIGRTMIN + 80,
207 __SIGRTMIN + 81,
208 __SIGRTMIN + 82,
209 __SIGRTMIN + 83,
210 __SIGRTMIN + 84,
211 __SIGRTMIN + 85,
212 __SIGRTMIN + 86,
213 __SIGRTMIN + 87,
214 __SIGRTMIN + 88,
215 __SIGRTMIN + 89,
216 __SIGRTMIN + 90,
217 __SIGRTMIN + 91,
218 __SIGRTMIN + 92,
219 __SIGRTMIN + 93,
220 __SIGRTMIN + 94,
221 __SIGRTMIN + 95,
222 -1, /* SIGINFO */
223 -1, /* UNKNOWN */
224 -1, /* DEFAULT */
225 -1,
226 -1,
227 -1,
228 -1,
229 -1,
230 -1
blueswir1c72d5bf2009-01-15 17:27:45 +0000231#endif
aurel32ca587a82008-12-18 22:44:13 +0000232};
bellard8f447cc2006-06-14 15:21:14 +0000233#else
aurel32ca587a82008-12-18 22:44:13 +0000234/* In system mode we only need SIGINT and SIGTRAP; other signals
235 are not yet supported. */
236
237enum {
238 TARGET_SIGINT = 2,
239 TARGET_SIGTRAP = 5
240};
241
242static int gdb_signal_table[] = {
243 -1,
244 -1,
245 TARGET_SIGINT,
246 -1,
247 -1,
248 TARGET_SIGTRAP
249};
bellard8f447cc2006-06-14 15:21:14 +0000250#endif
bellardb4608c02003-06-27 17:34:32 +0000251
aurel32ca587a82008-12-18 22:44:13 +0000252#ifdef CONFIG_USER_ONLY
253static int target_signal_to_gdb (int sig)
254{
255 int i;
256 for (i = 0; i < ARRAY_SIZE (gdb_signal_table); i++)
257 if (gdb_signal_table[i] == sig)
258 return i;
259 return GDB_SIGNAL_UNKNOWN;
260}
261#endif
262
263static int gdb_signal_to_target (int sig)
264{
265 if (sig < ARRAY_SIZE (gdb_signal_table))
266 return gdb_signal_table[sig];
267 else
268 return -1;
269}
270
bellard4abe6152003-07-26 18:01:58 +0000271//#define DEBUG_GDB
bellardb4608c02003-06-27 17:34:32 +0000272
pbrook56aebc82008-10-11 17:55:29 +0000273typedef struct GDBRegisterState {
274 int base_reg;
275 int num_regs;
276 gdb_reg_cb get_reg;
277 gdb_reg_cb set_reg;
278 const char *xml;
279 struct GDBRegisterState *next;
280} GDBRegisterState;
281
bellard858693c2004-03-31 18:52:07 +0000282enum RSState {
aliguori36556b22009-03-28 18:05:53 +0000283 RS_INACTIVE,
bellard858693c2004-03-31 18:52:07 +0000284 RS_IDLE,
285 RS_GETLINE,
286 RS_CHKSUM1,
287 RS_CHKSUM2,
288};
bellard858693c2004-03-31 18:52:07 +0000289typedef struct GDBState {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200290 CPUState *c_cpu; /* current CPU for step/continue ops */
291 CPUState *g_cpu; /* current CPU for other ops */
Andreas Färber52f34622013-06-27 13:44:40 +0200292 CPUState *query_cpu; /* for q{f|s}ThreadInfo */
bellard41625032005-04-24 10:07:11 +0000293 enum RSState state; /* parsing state */
pbrook56aebc82008-10-11 17:55:29 +0000294 char line_buf[MAX_PACKET_LENGTH];
bellard858693c2004-03-31 18:52:07 +0000295 int line_buf_index;
296 int line_csum;
pbrook56aebc82008-10-11 17:55:29 +0000297 uint8_t last_packet[MAX_PACKET_LENGTH + 4];
pbrook4046d912007-01-28 01:53:16 +0000298 int last_packet_len;
edgar_igl1f487ee2008-05-17 22:20:53 +0000299 int signal;
bellard41625032005-04-24 10:07:11 +0000300#ifdef CONFIG_USER_ONLY
pbrook4046d912007-01-28 01:53:16 +0000301 int fd;
bellard41625032005-04-24 10:07:11 +0000302 int running_state;
pbrook4046d912007-01-28 01:53:16 +0000303#else
304 CharDriverState *chr;
aliguori8a34a0f2009-03-05 23:01:55 +0000305 CharDriverState *mon_chr;
bellard41625032005-04-24 10:07:11 +0000306#endif
Meador Ingecdb432b2012-03-15 17:49:45 +0000307 char syscall_buf[256];
308 gdb_syscall_complete_cb current_syscall_cb;
bellard858693c2004-03-31 18:52:07 +0000309} GDBState;
bellardb4608c02003-06-27 17:34:32 +0000310
edgar_igl60897d32008-05-09 08:25:14 +0000311/* By default use no IRQs and no timers while single stepping so as to
312 * make single stepping like an ICE HW step.
313 */
314static int sstep_flags = SSTEP_ENABLE|SSTEP_NOIRQ|SSTEP_NOTIMER;
315
aliguori880a7572008-11-18 20:30:24 +0000316static GDBState *gdbserver_state;
317
Andreas Färber5b50e792013-06-29 04:18:45 +0200318bool gdb_has_xml;
pbrook56aebc82008-10-11 17:55:29 +0000319
bellard1fddef42005-04-17 19:16:13 +0000320#ifdef CONFIG_USER_ONLY
pbrook4046d912007-01-28 01:53:16 +0000321/* XXX: This is not thread safe. Do we care? */
322static int gdbserver_fd = -1;
323
bellard858693c2004-03-31 18:52:07 +0000324static int get_char(GDBState *s)
bellardb4608c02003-06-27 17:34:32 +0000325{
326 uint8_t ch;
327 int ret;
328
329 for(;;) {
Blue Swirl00aa0042011-07-23 20:04:29 +0000330 ret = qemu_recv(s->fd, &ch, 1, 0);
bellardb4608c02003-06-27 17:34:32 +0000331 if (ret < 0) {
edgar_igl1f487ee2008-05-17 22:20:53 +0000332 if (errno == ECONNRESET)
333 s->fd = -1;
bellardb4608c02003-06-27 17:34:32 +0000334 if (errno != EINTR && errno != EAGAIN)
335 return -1;
336 } else if (ret == 0) {
edgar_igl1f487ee2008-05-17 22:20:53 +0000337 close(s->fd);
338 s->fd = -1;
bellardb4608c02003-06-27 17:34:32 +0000339 return -1;
340 } else {
341 break;
342 }
343 }
344 return ch;
345}
pbrook4046d912007-01-28 01:53:16 +0000346#endif
bellardb4608c02003-06-27 17:34:32 +0000347
blueswir1654efcf2009-04-18 07:29:59 +0000348static enum {
pbrooka2d1eba2007-01-28 03:10:55 +0000349 GDB_SYS_UNKNOWN,
350 GDB_SYS_ENABLED,
351 GDB_SYS_DISABLED,
352} gdb_syscall_mode;
353
354/* If gdb is connected when the first semihosting syscall occurs then use
355 remote gdb syscalls. Otherwise use native file IO. */
356int use_gdb_syscalls(void)
357{
358 if (gdb_syscall_mode == GDB_SYS_UNKNOWN) {
aliguori880a7572008-11-18 20:30:24 +0000359 gdb_syscall_mode = (gdbserver_state ? GDB_SYS_ENABLED
360 : GDB_SYS_DISABLED);
pbrooka2d1eba2007-01-28 03:10:55 +0000361 }
362 return gdb_syscall_mode == GDB_SYS_ENABLED;
363}
364
edgar_iglba70a622008-03-14 06:10:42 +0000365/* Resume execution. */
366static inline void gdb_continue(GDBState *s)
367{
368#ifdef CONFIG_USER_ONLY
369 s->running_state = 1;
370#else
Paolo Bonzini26ac7a32013-06-03 17:06:54 +0200371 if (!runstate_needs_reset()) {
Paolo Bonzini87f25c12013-05-30 13:20:40 +0200372 vm_start();
373 }
edgar_iglba70a622008-03-14 06:10:42 +0000374#endif
375}
376
bellard858693c2004-03-31 18:52:07 +0000377static void put_buffer(GDBState *s, const uint8_t *buf, int len)
bellardb4608c02003-06-27 17:34:32 +0000378{
pbrook4046d912007-01-28 01:53:16 +0000379#ifdef CONFIG_USER_ONLY
bellardb4608c02003-06-27 17:34:32 +0000380 int ret;
381
382 while (len > 0) {
bellard8f447cc2006-06-14 15:21:14 +0000383 ret = send(s->fd, buf, len, 0);
bellardb4608c02003-06-27 17:34:32 +0000384 if (ret < 0) {
385 if (errno != EINTR && errno != EAGAIN)
386 return;
387 } else {
388 buf += ret;
389 len -= ret;
390 }
391 }
pbrook4046d912007-01-28 01:53:16 +0000392#else
Anthony Liguori2cc6e0a2011-08-15 11:17:28 -0500393 qemu_chr_fe_write(s->chr, buf, len);
pbrook4046d912007-01-28 01:53:16 +0000394#endif
bellardb4608c02003-06-27 17:34:32 +0000395}
396
397static inline int fromhex(int v)
398{
399 if (v >= '0' && v <= '9')
400 return v - '0';
401 else if (v >= 'A' && v <= 'F')
402 return v - 'A' + 10;
403 else if (v >= 'a' && v <= 'f')
404 return v - 'a' + 10;
405 else
406 return 0;
407}
408
409static inline int tohex(int v)
410{
411 if (v < 10)
412 return v + '0';
413 else
414 return v - 10 + 'a';
415}
416
417static void memtohex(char *buf, const uint8_t *mem, int len)
418{
419 int i, c;
420 char *q;
421 q = buf;
422 for(i = 0; i < len; i++) {
423 c = mem[i];
424 *q++ = tohex(c >> 4);
425 *q++ = tohex(c & 0xf);
426 }
427 *q = '\0';
428}
429
430static void hextomem(uint8_t *mem, const char *buf, int len)
431{
432 int i;
433
434 for(i = 0; i < len; i++) {
435 mem[i] = (fromhex(buf[0]) << 4) | fromhex(buf[1]);
436 buf += 2;
437 }
438}
439
bellardb4608c02003-06-27 17:34:32 +0000440/* return -1 if error, 0 if OK */
pbrook56aebc82008-10-11 17:55:29 +0000441static int put_packet_binary(GDBState *s, const char *buf, int len)
bellardb4608c02003-06-27 17:34:32 +0000442{
pbrook56aebc82008-10-11 17:55:29 +0000443 int csum, i;
ths60fe76f2007-12-16 03:02:09 +0000444 uint8_t *p;
bellardb4608c02003-06-27 17:34:32 +0000445
bellardb4608c02003-06-27 17:34:32 +0000446 for(;;) {
pbrook4046d912007-01-28 01:53:16 +0000447 p = s->last_packet;
448 *(p++) = '$';
pbrook4046d912007-01-28 01:53:16 +0000449 memcpy(p, buf, len);
450 p += len;
bellardb4608c02003-06-27 17:34:32 +0000451 csum = 0;
452 for(i = 0; i < len; i++) {
453 csum += buf[i];
454 }
pbrook4046d912007-01-28 01:53:16 +0000455 *(p++) = '#';
456 *(p++) = tohex((csum >> 4) & 0xf);
457 *(p++) = tohex((csum) & 0xf);
bellardb4608c02003-06-27 17:34:32 +0000458
pbrook4046d912007-01-28 01:53:16 +0000459 s->last_packet_len = p - s->last_packet;
thsffe8ab82007-12-16 03:16:05 +0000460 put_buffer(s, (uint8_t *)s->last_packet, s->last_packet_len);
bellardb4608c02003-06-27 17:34:32 +0000461
pbrook4046d912007-01-28 01:53:16 +0000462#ifdef CONFIG_USER_ONLY
463 i = get_char(s);
464 if (i < 0)
bellardb4608c02003-06-27 17:34:32 +0000465 return -1;
pbrook4046d912007-01-28 01:53:16 +0000466 if (i == '+')
bellardb4608c02003-06-27 17:34:32 +0000467 break;
pbrook4046d912007-01-28 01:53:16 +0000468#else
469 break;
470#endif
bellardb4608c02003-06-27 17:34:32 +0000471 }
472 return 0;
473}
474
pbrook56aebc82008-10-11 17:55:29 +0000475/* return -1 if error, 0 if OK */
476static int put_packet(GDBState *s, const char *buf)
477{
478#ifdef DEBUG_GDB
479 printf("reply='%s'\n", buf);
480#endif
481
482 return put_packet_binary(s, buf, strlen(buf));
483}
484
pbrook56aebc82008-10-11 17:55:29 +0000485/* Encode data using the encoding for 'x' packets. */
486static int memtox(char *buf, const char *mem, int len)
487{
488 char *p = buf;
489 char c;
490
491 while (len--) {
492 c = *(mem++);
493 switch (c) {
494 case '#': case '$': case '*': case '}':
495 *(p++) = '}';
496 *(p++) = c ^ 0x20;
497 break;
498 default:
499 *(p++) = c;
500 break;
501 }
502 }
503 return p - buf;
504}
505
Andreas Färber5b24c642013-07-07 15:08:22 +0200506static const char *get_feature_xml(const char *p, const char **newp,
507 CPUClass *cc)
pbrook56aebc82008-10-11 17:55:29 +0000508{
pbrook56aebc82008-10-11 17:55:29 +0000509 size_t len;
510 int i;
511 const char *name;
512 static char target_xml[1024];
513
514 len = 0;
515 while (p[len] && p[len] != ':')
516 len++;
517 *newp = p + len;
518
519 name = NULL;
520 if (strncmp(p, "target.xml", len) == 0) {
521 /* Generate the XML description for this CPU. */
522 if (!target_xml[0]) {
523 GDBRegisterState *r;
Andreas Färbereac8b352013-06-28 21:11:37 +0200524 CPUState *cpu = first_cpu;
pbrook56aebc82008-10-11 17:55:29 +0000525
blueswir15b3715b2008-10-25 11:18:12 +0000526 snprintf(target_xml, sizeof(target_xml),
527 "<?xml version=\"1.0\"?>"
528 "<!DOCTYPE target SYSTEM \"gdb-target.dtd\">"
529 "<target>"
530 "<xi:include href=\"%s\"/>",
Andreas Färber5b24c642013-07-07 15:08:22 +0200531 cc->gdb_core_xml_file);
pbrook56aebc82008-10-11 17:55:29 +0000532
Andreas Färbereac8b352013-06-28 21:11:37 +0200533 for (r = cpu->gdb_regs; r; r = r->next) {
blueswir12dc766d2009-04-13 16:06:19 +0000534 pstrcat(target_xml, sizeof(target_xml), "<xi:include href=\"");
535 pstrcat(target_xml, sizeof(target_xml), r->xml);
536 pstrcat(target_xml, sizeof(target_xml), "\"/>");
pbrook56aebc82008-10-11 17:55:29 +0000537 }
blueswir12dc766d2009-04-13 16:06:19 +0000538 pstrcat(target_xml, sizeof(target_xml), "</target>");
pbrook56aebc82008-10-11 17:55:29 +0000539 }
540 return target_xml;
541 }
542 for (i = 0; ; i++) {
543 name = xml_builtin[i][0];
544 if (!name || (strncmp(name, p, len) == 0 && strlen(name) == len))
545 break;
546 }
547 return name ? xml_builtin[i][1] : NULL;
548}
pbrook56aebc82008-10-11 17:55:29 +0000549
Andreas Färber385b9f02013-06-27 18:25:36 +0200550static int gdb_read_register(CPUState *cpu, uint8_t *mem_buf, int reg)
pbrook56aebc82008-10-11 17:55:29 +0000551{
Andreas Färbera0e372f2013-06-28 23:18:47 +0200552 CPUClass *cc = CPU_GET_CLASS(cpu);
Andreas Färber385b9f02013-06-27 18:25:36 +0200553 CPUArchState *env = cpu->env_ptr;
pbrook56aebc82008-10-11 17:55:29 +0000554 GDBRegisterState *r;
555
Andreas Färbera0e372f2013-06-28 23:18:47 +0200556 if (reg < cc->gdb_num_core_regs) {
Andreas Färber5b50e792013-06-29 04:18:45 +0200557 return cc->gdb_read_register(cpu, mem_buf, reg);
Andreas Färbera0e372f2013-06-28 23:18:47 +0200558 }
pbrook56aebc82008-10-11 17:55:29 +0000559
Andreas Färbereac8b352013-06-28 21:11:37 +0200560 for (r = cpu->gdb_regs; r; r = r->next) {
pbrook56aebc82008-10-11 17:55:29 +0000561 if (r->base_reg <= reg && reg < r->base_reg + r->num_regs) {
562 return r->get_reg(env, mem_buf, reg - r->base_reg);
563 }
564 }
565 return 0;
566}
567
Andreas Färber385b9f02013-06-27 18:25:36 +0200568static int gdb_write_register(CPUState *cpu, uint8_t *mem_buf, int reg)
pbrook56aebc82008-10-11 17:55:29 +0000569{
Andreas Färbera0e372f2013-06-28 23:18:47 +0200570 CPUClass *cc = CPU_GET_CLASS(cpu);
Andreas Färber385b9f02013-06-27 18:25:36 +0200571 CPUArchState *env = cpu->env_ptr;
pbrook56aebc82008-10-11 17:55:29 +0000572 GDBRegisterState *r;
573
Andreas Färbera0e372f2013-06-28 23:18:47 +0200574 if (reg < cc->gdb_num_core_regs) {
Andreas Färber5b50e792013-06-29 04:18:45 +0200575 return cc->gdb_write_register(cpu, mem_buf, reg);
Andreas Färbera0e372f2013-06-28 23:18:47 +0200576 }
pbrook56aebc82008-10-11 17:55:29 +0000577
Andreas Färbereac8b352013-06-28 21:11:37 +0200578 for (r = cpu->gdb_regs; r; r = r->next) {
pbrook56aebc82008-10-11 17:55:29 +0000579 if (r->base_reg <= reg && reg < r->base_reg + r->num_regs) {
580 return r->set_reg(env, mem_buf, reg - r->base_reg);
581 }
582 }
583 return 0;
584}
585
586/* Register a supplemental set of CPU registers. If g_pos is nonzero it
587 specifies the first register number and these registers are included in
588 a standard "g" packet. Direction is relative to gdb, i.e. get_reg is
589 gdb reading a CPU register, and set_reg is gdb modifying a CPU register.
590 */
591
Andreas Färber22169d42013-06-28 21:27:39 +0200592void gdb_register_coprocessor(CPUState *cpu,
593 gdb_reg_cb get_reg, gdb_reg_cb set_reg,
594 int num_regs, const char *xml, int g_pos)
pbrook56aebc82008-10-11 17:55:29 +0000595{
596 GDBRegisterState *s;
597 GDBRegisterState **p;
pbrook56aebc82008-10-11 17:55:29 +0000598
Andreas Färbereac8b352013-06-28 21:11:37 +0200599 p = &cpu->gdb_regs;
pbrook56aebc82008-10-11 17:55:29 +0000600 while (*p) {
601 /* Check for duplicates. */
602 if (strcmp((*p)->xml, xml) == 0)
603 return;
604 p = &(*p)->next;
605 }
Stefan Weil9643c252011-10-18 22:25:38 +0200606
607 s = g_new0(GDBRegisterState, 1);
Andreas Färbera0e372f2013-06-28 23:18:47 +0200608 s->base_reg = cpu->gdb_num_regs;
Stefan Weil9643c252011-10-18 22:25:38 +0200609 s->num_regs = num_regs;
610 s->get_reg = get_reg;
611 s->set_reg = set_reg;
612 s->xml = xml;
613
pbrook56aebc82008-10-11 17:55:29 +0000614 /* Add to end of list. */
Andreas Färbera0e372f2013-06-28 23:18:47 +0200615 cpu->gdb_num_regs += num_regs;
pbrook56aebc82008-10-11 17:55:29 +0000616 *p = s;
617 if (g_pos) {
618 if (g_pos != s->base_reg) {
619 fprintf(stderr, "Error: Bad gdb register numbering for '%s'\n"
620 "Expected %d got %d\n", xml, g_pos, s->base_reg);
Andreas Färber35143f02013-08-12 18:09:47 +0200621 } else {
622 cpu->gdb_num_g_regs = cpu->gdb_num_regs;
pbrook56aebc82008-10-11 17:55:29 +0000623 }
624 }
625}
626
aliguoria1d1bb32008-11-18 20:07:32 +0000627#ifndef CONFIG_USER_ONLY
628static const int xlat_gdb_type[] = {
629 [GDB_WATCHPOINT_WRITE] = BP_GDB | BP_MEM_WRITE,
630 [GDB_WATCHPOINT_READ] = BP_GDB | BP_MEM_READ,
631 [GDB_WATCHPOINT_ACCESS] = BP_GDB | BP_MEM_ACCESS,
632};
633#endif
634
aliguori880a7572008-11-18 20:30:24 +0000635static int gdb_breakpoint_insert(target_ulong addr, target_ulong len, int type)
aliguoria1d1bb32008-11-18 20:07:32 +0000636{
Andreas Färber182735e2013-05-29 22:29:20 +0200637 CPUState *cpu;
Andreas Färber9349b4f2012-03-14 01:38:32 +0100638 CPUArchState *env;
aliguori880a7572008-11-18 20:30:24 +0000639 int err = 0;
640
Andreas Färber62278812013-06-27 17:12:06 +0200641 if (kvm_enabled()) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200642 return kvm_insert_breakpoint(gdbserver_state->c_cpu, addr, len, type);
Andreas Färber62278812013-06-27 17:12:06 +0200643 }
aliguorie22a25c2009-03-12 20:12:48 +0000644
aliguoria1d1bb32008-11-18 20:07:32 +0000645 switch (type) {
646 case GDB_BREAKPOINT_SW:
647 case GDB_BREAKPOINT_HW:
Andreas Färberbdc44642013-06-24 23:50:24 +0200648 CPU_FOREACH(cpu) {
Andreas Färber182735e2013-05-29 22:29:20 +0200649 env = cpu->env_ptr;
aliguori880a7572008-11-18 20:30:24 +0000650 err = cpu_breakpoint_insert(env, addr, BP_GDB, NULL);
651 if (err)
652 break;
653 }
654 return err;
aliguoria1d1bb32008-11-18 20:07:32 +0000655#ifndef CONFIG_USER_ONLY
656 case GDB_WATCHPOINT_WRITE:
657 case GDB_WATCHPOINT_READ:
658 case GDB_WATCHPOINT_ACCESS:
Andreas Färberbdc44642013-06-24 23:50:24 +0200659 CPU_FOREACH(cpu) {
Andreas Färber182735e2013-05-29 22:29:20 +0200660 env = cpu->env_ptr;
aliguori880a7572008-11-18 20:30:24 +0000661 err = cpu_watchpoint_insert(env, addr, len, xlat_gdb_type[type],
662 NULL);
663 if (err)
664 break;
665 }
666 return err;
aliguoria1d1bb32008-11-18 20:07:32 +0000667#endif
668 default:
669 return -ENOSYS;
670 }
671}
672
aliguori880a7572008-11-18 20:30:24 +0000673static int gdb_breakpoint_remove(target_ulong addr, target_ulong len, int type)
aliguoria1d1bb32008-11-18 20:07:32 +0000674{
Andreas Färber182735e2013-05-29 22:29:20 +0200675 CPUState *cpu;
Andreas Färber9349b4f2012-03-14 01:38:32 +0100676 CPUArchState *env;
aliguori880a7572008-11-18 20:30:24 +0000677 int err = 0;
678
Andreas Färber62278812013-06-27 17:12:06 +0200679 if (kvm_enabled()) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200680 return kvm_remove_breakpoint(gdbserver_state->c_cpu, addr, len, type);
Andreas Färber62278812013-06-27 17:12:06 +0200681 }
aliguorie22a25c2009-03-12 20:12:48 +0000682
aliguoria1d1bb32008-11-18 20:07:32 +0000683 switch (type) {
684 case GDB_BREAKPOINT_SW:
685 case GDB_BREAKPOINT_HW:
Andreas Färberbdc44642013-06-24 23:50:24 +0200686 CPU_FOREACH(cpu) {
Andreas Färber182735e2013-05-29 22:29:20 +0200687 env = cpu->env_ptr;
aliguori880a7572008-11-18 20:30:24 +0000688 err = cpu_breakpoint_remove(env, addr, BP_GDB);
689 if (err)
690 break;
691 }
692 return err;
aliguoria1d1bb32008-11-18 20:07:32 +0000693#ifndef CONFIG_USER_ONLY
694 case GDB_WATCHPOINT_WRITE:
695 case GDB_WATCHPOINT_READ:
696 case GDB_WATCHPOINT_ACCESS:
Andreas Färberbdc44642013-06-24 23:50:24 +0200697 CPU_FOREACH(cpu) {
Andreas Färber182735e2013-05-29 22:29:20 +0200698 env = cpu->env_ptr;
aliguori880a7572008-11-18 20:30:24 +0000699 err = cpu_watchpoint_remove(env, addr, len, xlat_gdb_type[type]);
700 if (err)
701 break;
702 }
703 return err;
aliguoria1d1bb32008-11-18 20:07:32 +0000704#endif
705 default:
706 return -ENOSYS;
707 }
708}
709
aliguori880a7572008-11-18 20:30:24 +0000710static void gdb_breakpoint_remove_all(void)
aliguoria1d1bb32008-11-18 20:07:32 +0000711{
Andreas Färber182735e2013-05-29 22:29:20 +0200712 CPUState *cpu;
Andreas Färber9349b4f2012-03-14 01:38:32 +0100713 CPUArchState *env;
aliguori880a7572008-11-18 20:30:24 +0000714
aliguorie22a25c2009-03-12 20:12:48 +0000715 if (kvm_enabled()) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200716 kvm_remove_all_breakpoints(gdbserver_state->c_cpu);
aliguorie22a25c2009-03-12 20:12:48 +0000717 return;
718 }
719
Andreas Färberbdc44642013-06-24 23:50:24 +0200720 CPU_FOREACH(cpu) {
Andreas Färber182735e2013-05-29 22:29:20 +0200721 env = cpu->env_ptr;
aliguori880a7572008-11-18 20:30:24 +0000722 cpu_breakpoint_remove_all(env, BP_GDB);
aliguoria1d1bb32008-11-18 20:07:32 +0000723#ifndef CONFIG_USER_ONLY
aliguori880a7572008-11-18 20:30:24 +0000724 cpu_watchpoint_remove_all(env, BP_GDB);
aliguoria1d1bb32008-11-18 20:07:32 +0000725#endif
aliguori880a7572008-11-18 20:30:24 +0000726 }
aliguoria1d1bb32008-11-18 20:07:32 +0000727}
728
aurel32fab9d282009-04-08 21:29:37 +0000729static void gdb_set_cpu_pc(GDBState *s, target_ulong pc)
730{
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200731 CPUState *cpu = s->c_cpu;
Andreas Färberf45748f2013-06-21 19:09:18 +0200732 CPUClass *cc = CPU_GET_CLASS(cpu);
733
734 cpu_synchronize_state(cpu);
735 if (cc->set_pc) {
736 cc->set_pc(cpu, pc);
Nathan Froydff1d1972009-12-08 08:06:30 -0800737 }
aurel32fab9d282009-04-08 21:29:37 +0000738}
739
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200740static CPUState *find_cpu(uint32_t thread_id)
Nathan Froyd1e9fa732009-06-03 11:33:08 -0700741{
Andreas Färber0d342822012-12-17 07:12:13 +0100742 CPUState *cpu;
Nathan Froyd1e9fa732009-06-03 11:33:08 -0700743
Andreas Färberbdc44642013-06-24 23:50:24 +0200744 CPU_FOREACH(cpu) {
Andreas Färberaa48dd92013-07-09 20:50:52 +0200745 if (cpu_index(cpu) == thread_id) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200746 return cpu;
Andreas Färberaa48dd92013-07-09 20:50:52 +0200747 }
Nathan Froyd1e9fa732009-06-03 11:33:08 -0700748 }
Andreas Färberaa48dd92013-07-09 20:50:52 +0200749
750 return NULL;
Nathan Froyd1e9fa732009-06-03 11:33:08 -0700751}
752
aliguori880a7572008-11-18 20:30:24 +0000753static int gdb_handle_packet(GDBState *s, const char *line_buf)
bellardb4608c02003-06-27 17:34:32 +0000754{
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200755 CPUState *cpu;
Andreas Färber5b24c642013-07-07 15:08:22 +0200756 CPUClass *cc;
bellardb4608c02003-06-27 17:34:32 +0000757 const char *p;
Nathan Froyd1e9fa732009-06-03 11:33:08 -0700758 uint32_t thread;
759 int ch, reg_size, type, res;
pbrook56aebc82008-10-11 17:55:29 +0000760 char buf[MAX_PACKET_LENGTH];
761 uint8_t mem_buf[MAX_PACKET_LENGTH];
762 uint8_t *registers;
bellard9d9754a2006-06-25 15:32:37 +0000763 target_ulong addr, len;
ths3b46e622007-09-17 08:09:54 +0000764
bellard858693c2004-03-31 18:52:07 +0000765#ifdef DEBUG_GDB
766 printf("command='%s'\n", line_buf);
bellard4c3a88a2003-07-26 12:06:08 +0000767#endif
bellard858693c2004-03-31 18:52:07 +0000768 p = line_buf;
769 ch = *p++;
770 switch(ch) {
771 case '?':
bellard1fddef42005-04-17 19:16:13 +0000772 /* TODO: Make this return the correct value for user-mode. */
aurel32ca587a82008-12-18 22:44:13 +0000773 snprintf(buf, sizeof(buf), "T%02xthread:%02x;", GDB_SIGNAL_TRAP,
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200774 cpu_index(s->c_cpu));
bellard858693c2004-03-31 18:52:07 +0000775 put_packet(s, buf);
edgar_igl7d03f822008-05-17 18:58:29 +0000776 /* Remove all the breakpoints when this query is issued,
777 * because gdb is doing and initial connect and the state
778 * should be cleaned up.
779 */
aliguori880a7572008-11-18 20:30:24 +0000780 gdb_breakpoint_remove_all();
bellard858693c2004-03-31 18:52:07 +0000781 break;
782 case 'c':
783 if (*p != '\0') {
bellard9d9754a2006-06-25 15:32:37 +0000784 addr = strtoull(p, (char **)&p, 16);
aurel32fab9d282009-04-08 21:29:37 +0000785 gdb_set_cpu_pc(s, addr);
bellard858693c2004-03-31 18:52:07 +0000786 }
aurel32ca587a82008-12-18 22:44:13 +0000787 s->signal = 0;
edgar_iglba70a622008-03-14 06:10:42 +0000788 gdb_continue(s);
bellard41625032005-04-24 10:07:11 +0000789 return RS_IDLE;
edgar_igl1f487ee2008-05-17 22:20:53 +0000790 case 'C':
aurel32ca587a82008-12-18 22:44:13 +0000791 s->signal = gdb_signal_to_target (strtoul(p, (char **)&p, 16));
792 if (s->signal == -1)
793 s->signal = 0;
edgar_igl1f487ee2008-05-17 22:20:53 +0000794 gdb_continue(s);
795 return RS_IDLE;
Jan Kiszkadd32aa12009-06-27 09:53:51 +0200796 case 'v':
797 if (strncmp(p, "Cont", 4) == 0) {
798 int res_signal, res_thread;
799
800 p += 4;
801 if (*p == '?') {
802 put_packet(s, "vCont;c;C;s;S");
803 break;
804 }
805 res = 0;
806 res_signal = 0;
807 res_thread = 0;
808 while (*p) {
809 int action, signal;
810
811 if (*p++ != ';') {
812 res = 0;
813 break;
814 }
815 action = *p++;
816 signal = 0;
817 if (action == 'C' || action == 'S') {
818 signal = strtoul(p, (char **)&p, 16);
819 } else if (action != 'c' && action != 's') {
820 res = 0;
821 break;
822 }
823 thread = 0;
824 if (*p == ':') {
825 thread = strtoull(p+1, (char **)&p, 16);
826 }
827 action = tolower(action);
828 if (res == 0 || (res == 'c' && action == 's')) {
829 res = action;
830 res_signal = signal;
831 res_thread = thread;
832 }
833 }
834 if (res) {
835 if (res_thread != -1 && res_thread != 0) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200836 cpu = find_cpu(res_thread);
837 if (cpu == NULL) {
Jan Kiszkadd32aa12009-06-27 09:53:51 +0200838 put_packet(s, "E22");
839 break;
840 }
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200841 s->c_cpu = cpu;
Jan Kiszkadd32aa12009-06-27 09:53:51 +0200842 }
843 if (res == 's') {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200844 cpu_single_step(s->c_cpu, sstep_flags);
Jan Kiszkadd32aa12009-06-27 09:53:51 +0200845 }
846 s->signal = res_signal;
847 gdb_continue(s);
848 return RS_IDLE;
849 }
850 break;
851 } else {
852 goto unknown_command;
853 }
edgar_igl7d03f822008-05-17 18:58:29 +0000854 case 'k':
Jan Kiszka00e94db2012-03-06 18:32:35 +0100855#ifdef CONFIG_USER_ONLY
edgar_igl7d03f822008-05-17 18:58:29 +0000856 /* Kill the target */
857 fprintf(stderr, "\nQEMU: Terminated via GDBstub\n");
858 exit(0);
Jan Kiszka00e94db2012-03-06 18:32:35 +0100859#endif
edgar_igl7d03f822008-05-17 18:58:29 +0000860 case 'D':
861 /* Detach packet */
aliguori880a7572008-11-18 20:30:24 +0000862 gdb_breakpoint_remove_all();
Daniel Gutson7ea06da2010-02-26 14:13:50 -0300863 gdb_syscall_mode = GDB_SYS_DISABLED;
edgar_igl7d03f822008-05-17 18:58:29 +0000864 gdb_continue(s);
865 put_packet(s, "OK");
866 break;
bellard858693c2004-03-31 18:52:07 +0000867 case 's':
868 if (*p != '\0') {
ths8fac5802007-07-12 10:05:07 +0000869 addr = strtoull(p, (char **)&p, 16);
aurel32fab9d282009-04-08 21:29:37 +0000870 gdb_set_cpu_pc(s, addr);
bellard858693c2004-03-31 18:52:07 +0000871 }
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200872 cpu_single_step(s->c_cpu, sstep_flags);
edgar_iglba70a622008-03-14 06:10:42 +0000873 gdb_continue(s);
bellard41625032005-04-24 10:07:11 +0000874 return RS_IDLE;
pbrooka2d1eba2007-01-28 03:10:55 +0000875 case 'F':
876 {
877 target_ulong ret;
878 target_ulong err;
879
880 ret = strtoull(p, (char **)&p, 16);
881 if (*p == ',') {
882 p++;
883 err = strtoull(p, (char **)&p, 16);
884 } else {
885 err = 0;
886 }
887 if (*p == ',')
888 p++;
889 type = *p;
Meador Ingecdb432b2012-03-15 17:49:45 +0000890 if (s->current_syscall_cb) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200891 s->current_syscall_cb(s->c_cpu, ret, err);
Meador Ingecdb432b2012-03-15 17:49:45 +0000892 s->current_syscall_cb = NULL;
893 }
pbrooka2d1eba2007-01-28 03:10:55 +0000894 if (type == 'C') {
895 put_packet(s, "T02");
896 } else {
edgar_iglba70a622008-03-14 06:10:42 +0000897 gdb_continue(s);
pbrooka2d1eba2007-01-28 03:10:55 +0000898 }
899 }
900 break;
bellard858693c2004-03-31 18:52:07 +0000901 case 'g':
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200902 cpu_synchronize_state(s->g_cpu);
pbrook56aebc82008-10-11 17:55:29 +0000903 len = 0;
Andreas Färber35143f02013-08-12 18:09:47 +0200904 for (addr = 0; addr < s->g_cpu->gdb_num_g_regs; addr++) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200905 reg_size = gdb_read_register(s->g_cpu, mem_buf + len, addr);
pbrook56aebc82008-10-11 17:55:29 +0000906 len += reg_size;
907 }
908 memtohex(buf, mem_buf, len);
bellard858693c2004-03-31 18:52:07 +0000909 put_packet(s, buf);
910 break;
911 case 'G':
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200912 cpu_synchronize_state(s->g_cpu);
pbrook56aebc82008-10-11 17:55:29 +0000913 registers = mem_buf;
bellard858693c2004-03-31 18:52:07 +0000914 len = strlen(p) / 2;
915 hextomem((uint8_t *)registers, p, len);
Andreas Färber35143f02013-08-12 18:09:47 +0200916 for (addr = 0; addr < s->g_cpu->gdb_num_g_regs && len > 0; addr++) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200917 reg_size = gdb_write_register(s->g_cpu, registers, addr);
pbrook56aebc82008-10-11 17:55:29 +0000918 len -= reg_size;
919 registers += reg_size;
920 }
bellard858693c2004-03-31 18:52:07 +0000921 put_packet(s, "OK");
922 break;
923 case 'm':
bellard9d9754a2006-06-25 15:32:37 +0000924 addr = strtoull(p, (char **)&p, 16);
bellard858693c2004-03-31 18:52:07 +0000925 if (*p == ',')
926 p++;
bellard9d9754a2006-06-25 15:32:37 +0000927 len = strtoull(p, NULL, 16);
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200928 if (target_memory_rw_debug(s->g_cpu, addr, mem_buf, len, false) != 0) {
bellard6f970bd2005-12-05 19:55:19 +0000929 put_packet (s, "E14");
930 } else {
931 memtohex(buf, mem_buf, len);
932 put_packet(s, buf);
933 }
bellard858693c2004-03-31 18:52:07 +0000934 break;
935 case 'M':
bellard9d9754a2006-06-25 15:32:37 +0000936 addr = strtoull(p, (char **)&p, 16);
bellard858693c2004-03-31 18:52:07 +0000937 if (*p == ',')
938 p++;
bellard9d9754a2006-06-25 15:32:37 +0000939 len = strtoull(p, (char **)&p, 16);
bellardb328f872005-01-17 22:03:16 +0000940 if (*p == ':')
bellard858693c2004-03-31 18:52:07 +0000941 p++;
942 hextomem(mem_buf, p, len);
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200943 if (target_memory_rw_debug(s->g_cpu, addr, mem_buf, len,
Andreas Färberf3659ee2013-06-27 19:09:09 +0200944 true) != 0) {
bellard905f20b2005-04-26 21:09:55 +0000945 put_packet(s, "E14");
Fabien Chouteau44520db2011-09-08 12:48:16 +0200946 } else {
bellard858693c2004-03-31 18:52:07 +0000947 put_packet(s, "OK");
Fabien Chouteau44520db2011-09-08 12:48:16 +0200948 }
bellard858693c2004-03-31 18:52:07 +0000949 break;
pbrook56aebc82008-10-11 17:55:29 +0000950 case 'p':
951 /* Older gdb are really dumb, and don't use 'g' if 'p' is avaialable.
952 This works, but can be very slow. Anything new enough to
953 understand XML also knows how to use this properly. */
954 if (!gdb_has_xml)
955 goto unknown_command;
956 addr = strtoull(p, (char **)&p, 16);
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200957 reg_size = gdb_read_register(s->g_cpu, mem_buf, addr);
pbrook56aebc82008-10-11 17:55:29 +0000958 if (reg_size) {
959 memtohex(buf, mem_buf, reg_size);
960 put_packet(s, buf);
961 } else {
962 put_packet(s, "E14");
963 }
964 break;
965 case 'P':
966 if (!gdb_has_xml)
967 goto unknown_command;
968 addr = strtoull(p, (char **)&p, 16);
969 if (*p == '=')
970 p++;
971 reg_size = strlen(p) / 2;
972 hextomem(mem_buf, p, reg_size);
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200973 gdb_write_register(s->g_cpu, mem_buf, addr);
pbrook56aebc82008-10-11 17:55:29 +0000974 put_packet(s, "OK");
975 break;
bellard858693c2004-03-31 18:52:07 +0000976 case 'Z':
bellard858693c2004-03-31 18:52:07 +0000977 case 'z':
978 type = strtoul(p, (char **)&p, 16);
979 if (*p == ',')
980 p++;
bellard9d9754a2006-06-25 15:32:37 +0000981 addr = strtoull(p, (char **)&p, 16);
bellard858693c2004-03-31 18:52:07 +0000982 if (*p == ',')
983 p++;
bellard9d9754a2006-06-25 15:32:37 +0000984 len = strtoull(p, (char **)&p, 16);
aliguoria1d1bb32008-11-18 20:07:32 +0000985 if (ch == 'Z')
aliguori880a7572008-11-18 20:30:24 +0000986 res = gdb_breakpoint_insert(addr, len, type);
aliguoria1d1bb32008-11-18 20:07:32 +0000987 else
aliguori880a7572008-11-18 20:30:24 +0000988 res = gdb_breakpoint_remove(addr, len, type);
aliguoria1d1bb32008-11-18 20:07:32 +0000989 if (res >= 0)
990 put_packet(s, "OK");
991 else if (res == -ENOSYS)
pbrook0f459d12008-06-09 00:20:13 +0000992 put_packet(s, "");
aliguoria1d1bb32008-11-18 20:07:32 +0000993 else
994 put_packet(s, "E22");
bellard858693c2004-03-31 18:52:07 +0000995 break;
aliguori880a7572008-11-18 20:30:24 +0000996 case 'H':
997 type = *p++;
998 thread = strtoull(p, (char **)&p, 16);
999 if (thread == -1 || thread == 0) {
1000 put_packet(s, "OK");
1001 break;
1002 }
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001003 cpu = find_cpu(thread);
1004 if (cpu == NULL) {
aliguori880a7572008-11-18 20:30:24 +00001005 put_packet(s, "E22");
1006 break;
1007 }
1008 switch (type) {
1009 case 'c':
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001010 s->c_cpu = cpu;
aliguori880a7572008-11-18 20:30:24 +00001011 put_packet(s, "OK");
1012 break;
1013 case 'g':
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001014 s->g_cpu = cpu;
aliguori880a7572008-11-18 20:30:24 +00001015 put_packet(s, "OK");
1016 break;
1017 default:
1018 put_packet(s, "E22");
1019 break;
1020 }
1021 break;
1022 case 'T':
1023 thread = strtoull(p, (char **)&p, 16);
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001024 cpu = find_cpu(thread);
Nathan Froyd1e9fa732009-06-03 11:33:08 -07001025
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001026 if (cpu != NULL) {
Nathan Froyd1e9fa732009-06-03 11:33:08 -07001027 put_packet(s, "OK");
1028 } else {
aliguori880a7572008-11-18 20:30:24 +00001029 put_packet(s, "E22");
Nathan Froyd1e9fa732009-06-03 11:33:08 -07001030 }
aliguori880a7572008-11-18 20:30:24 +00001031 break;
pbrook978efd62006-06-17 18:30:42 +00001032 case 'q':
edgar_igl60897d32008-05-09 08:25:14 +00001033 case 'Q':
1034 /* parse any 'q' packets here */
1035 if (!strcmp(p,"qemu.sstepbits")) {
1036 /* Query Breakpoint bit definitions */
blueswir1363a37d2008-08-21 17:58:08 +00001037 snprintf(buf, sizeof(buf), "ENABLE=%x,NOIRQ=%x,NOTIMER=%x",
1038 SSTEP_ENABLE,
1039 SSTEP_NOIRQ,
1040 SSTEP_NOTIMER);
edgar_igl60897d32008-05-09 08:25:14 +00001041 put_packet(s, buf);
1042 break;
1043 } else if (strncmp(p,"qemu.sstep",10) == 0) {
1044 /* Display or change the sstep_flags */
1045 p += 10;
1046 if (*p != '=') {
1047 /* Display current setting */
blueswir1363a37d2008-08-21 17:58:08 +00001048 snprintf(buf, sizeof(buf), "0x%x", sstep_flags);
edgar_igl60897d32008-05-09 08:25:14 +00001049 put_packet(s, buf);
1050 break;
1051 }
1052 p++;
1053 type = strtoul(p, (char **)&p, 16);
1054 sstep_flags = type;
1055 put_packet(s, "OK");
1056 break;
aliguori880a7572008-11-18 20:30:24 +00001057 } else if (strcmp(p,"C") == 0) {
1058 /* "Current thread" remains vague in the spec, so always return
1059 * the first CPU (gdb returns the first thread). */
1060 put_packet(s, "QC1");
1061 break;
1062 } else if (strcmp(p,"fThreadInfo") == 0) {
Andreas Färber52f34622013-06-27 13:44:40 +02001063 s->query_cpu = first_cpu;
aliguori880a7572008-11-18 20:30:24 +00001064 goto report_cpuinfo;
1065 } else if (strcmp(p,"sThreadInfo") == 0) {
1066 report_cpuinfo:
1067 if (s->query_cpu) {
Andreas Färber52f34622013-06-27 13:44:40 +02001068 snprintf(buf, sizeof(buf), "m%x", cpu_index(s->query_cpu));
aliguori880a7572008-11-18 20:30:24 +00001069 put_packet(s, buf);
Andreas Färberbdc44642013-06-24 23:50:24 +02001070 s->query_cpu = CPU_NEXT(s->query_cpu);
aliguori880a7572008-11-18 20:30:24 +00001071 } else
1072 put_packet(s, "l");
1073 break;
1074 } else if (strncmp(p,"ThreadExtraInfo,", 16) == 0) {
1075 thread = strtoull(p+16, (char **)&p, 16);
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001076 cpu = find_cpu(thread);
1077 if (cpu != NULL) {
Andreas Färbercb446ec2013-05-01 14:24:52 +02001078 cpu_synchronize_state(cpu);
Nathan Froyd1e9fa732009-06-03 11:33:08 -07001079 len = snprintf((char *)mem_buf, sizeof(mem_buf),
Andreas Färber55e5c282012-12-17 06:18:02 +01001080 "CPU#%d [%s]", cpu->cpu_index,
Andreas Färber259186a2013-01-17 18:51:17 +01001081 cpu->halted ? "halted " : "running");
Nathan Froyd1e9fa732009-06-03 11:33:08 -07001082 memtohex(buf, mem_buf, len);
1083 put_packet(s, buf);
1084 }
aliguori880a7572008-11-18 20:30:24 +00001085 break;
edgar_igl60897d32008-05-09 08:25:14 +00001086 }
blueswir10b8a9882009-03-07 10:51:36 +00001087#ifdef CONFIG_USER_ONLY
edgar_igl60897d32008-05-09 08:25:14 +00001088 else if (strncmp(p, "Offsets", 7) == 0) {
Andreas Färber0429a972013-08-26 18:14:44 +02001089 TaskState *ts = s->c_cpu->opaque;
pbrook978efd62006-06-17 18:30:42 +00001090
blueswir1363a37d2008-08-21 17:58:08 +00001091 snprintf(buf, sizeof(buf),
1092 "Text=" TARGET_ABI_FMT_lx ";Data=" TARGET_ABI_FMT_lx
1093 ";Bss=" TARGET_ABI_FMT_lx,
1094 ts->info->code_offset,
1095 ts->info->data_offset,
1096 ts->info->data_offset);
pbrook978efd62006-06-17 18:30:42 +00001097 put_packet(s, buf);
1098 break;
1099 }
blueswir10b8a9882009-03-07 10:51:36 +00001100#else /* !CONFIG_USER_ONLY */
aliguori8a34a0f2009-03-05 23:01:55 +00001101 else if (strncmp(p, "Rcmd,", 5) == 0) {
1102 int len = strlen(p + 5);
1103
1104 if ((len % 2) != 0) {
1105 put_packet(s, "E01");
1106 break;
1107 }
1108 hextomem(mem_buf, p + 5, len);
1109 len = len / 2;
1110 mem_buf[len++] = 0;
Anthony Liguorifa5efcc2011-08-15 11:17:30 -05001111 qemu_chr_be_write(s->mon_chr, mem_buf, len);
aliguori8a34a0f2009-03-05 23:01:55 +00001112 put_packet(s, "OK");
1113 break;
1114 }
blueswir10b8a9882009-03-07 10:51:36 +00001115#endif /* !CONFIG_USER_ONLY */
pbrook56aebc82008-10-11 17:55:29 +00001116 if (strncmp(p, "Supported", 9) == 0) {
blueswir15b3715b2008-10-25 11:18:12 +00001117 snprintf(buf, sizeof(buf), "PacketSize=%x", MAX_PACKET_LENGTH);
Andreas Färber5b24c642013-07-07 15:08:22 +02001118 cc = CPU_GET_CLASS(first_cpu);
1119 if (cc->gdb_core_xml_file != NULL) {
1120 pstrcat(buf, sizeof(buf), ";qXfer:features:read+");
1121 }
pbrook56aebc82008-10-11 17:55:29 +00001122 put_packet(s, buf);
1123 break;
1124 }
pbrook56aebc82008-10-11 17:55:29 +00001125 if (strncmp(p, "Xfer:features:read:", 19) == 0) {
1126 const char *xml;
1127 target_ulong total_len;
1128
Andreas Färber5b24c642013-07-07 15:08:22 +02001129 cc = CPU_GET_CLASS(first_cpu);
1130 if (cc->gdb_core_xml_file == NULL) {
1131 goto unknown_command;
1132 }
1133
Andreas Färber5b50e792013-06-29 04:18:45 +02001134 gdb_has_xml = true;
pbrook56aebc82008-10-11 17:55:29 +00001135 p += 19;
Andreas Färber5b24c642013-07-07 15:08:22 +02001136 xml = get_feature_xml(p, &p, cc);
pbrook56aebc82008-10-11 17:55:29 +00001137 if (!xml) {
blueswir15b3715b2008-10-25 11:18:12 +00001138 snprintf(buf, sizeof(buf), "E00");
pbrook56aebc82008-10-11 17:55:29 +00001139 put_packet(s, buf);
1140 break;
1141 }
1142
1143 if (*p == ':')
1144 p++;
1145 addr = strtoul(p, (char **)&p, 16);
1146 if (*p == ',')
1147 p++;
1148 len = strtoul(p, (char **)&p, 16);
1149
1150 total_len = strlen(xml);
1151 if (addr > total_len) {
blueswir15b3715b2008-10-25 11:18:12 +00001152 snprintf(buf, sizeof(buf), "E00");
pbrook56aebc82008-10-11 17:55:29 +00001153 put_packet(s, buf);
1154 break;
1155 }
1156 if (len > (MAX_PACKET_LENGTH - 5) / 2)
1157 len = (MAX_PACKET_LENGTH - 5) / 2;
1158 if (len < total_len - addr) {
1159 buf[0] = 'm';
1160 len = memtox(buf + 1, xml + addr, len);
1161 } else {
1162 buf[0] = 'l';
1163 len = memtox(buf + 1, xml + addr, total_len - addr);
1164 }
1165 put_packet_binary(s, buf, len + 1);
1166 break;
1167 }
pbrook56aebc82008-10-11 17:55:29 +00001168 /* Unrecognised 'q' command. */
1169 goto unknown_command;
1170
bellard858693c2004-03-31 18:52:07 +00001171 default:
pbrook56aebc82008-10-11 17:55:29 +00001172 unknown_command:
bellard858693c2004-03-31 18:52:07 +00001173 /* put empty packet */
1174 buf[0] = '\0';
1175 put_packet(s, buf);
1176 break;
1177 }
1178 return RS_IDLE;
1179}
1180
Andreas Färber64f6b342013-05-27 02:06:09 +02001181void gdb_set_stop_cpu(CPUState *cpu)
aliguori880a7572008-11-18 20:30:24 +00001182{
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001183 gdbserver_state->c_cpu = cpu;
1184 gdbserver_state->g_cpu = cpu;
aliguori880a7572008-11-18 20:30:24 +00001185}
1186
bellard1fddef42005-04-17 19:16:13 +00001187#ifndef CONFIG_USER_ONLY
Luiz Capitulino1dfb4dd2011-07-29 14:26:33 -03001188static void gdb_vm_state_change(void *opaque, int running, RunState state)
bellard858693c2004-03-31 18:52:07 +00001189{
aliguori880a7572008-11-18 20:30:24 +00001190 GDBState *s = gdbserver_state;
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001191 CPUArchState *env = s->c_cpu->env_ptr;
1192 CPUState *cpu = s->c_cpu;
bellard858693c2004-03-31 18:52:07 +00001193 char buf[256];
aliguorid6fc1b32008-11-18 19:55:44 +00001194 const char *type;
bellard858693c2004-03-31 18:52:07 +00001195 int ret;
1196
Meador Ingecdb432b2012-03-15 17:49:45 +00001197 if (running || s->state == RS_INACTIVE) {
1198 return;
1199 }
1200 /* Is there a GDB syscall waiting to be sent? */
1201 if (s->current_syscall_cb) {
1202 put_packet(s, s->syscall_buf);
pbrooka2d1eba2007-01-28 03:10:55 +00001203 return;
Jan Kiszkae07bbac2011-02-09 16:29:40 +01001204 }
Luiz Capitulino1dfb4dd2011-07-29 14:26:33 -03001205 switch (state) {
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001206 case RUN_STATE_DEBUG:
Andreas Färberff4700b2013-08-26 18:23:18 +02001207 if (cpu->watchpoint_hit) {
1208 switch (cpu->watchpoint_hit->flags & BP_MEM_ACCESS) {
aliguoria1d1bb32008-11-18 20:07:32 +00001209 case BP_MEM_READ:
aliguorid6fc1b32008-11-18 19:55:44 +00001210 type = "r";
1211 break;
aliguoria1d1bb32008-11-18 20:07:32 +00001212 case BP_MEM_ACCESS:
aliguorid6fc1b32008-11-18 19:55:44 +00001213 type = "a";
1214 break;
1215 default:
1216 type = "";
1217 break;
1218 }
aliguori880a7572008-11-18 20:30:24 +00001219 snprintf(buf, sizeof(buf),
1220 "T%02xthread:%02x;%swatch:" TARGET_FMT_lx ";",
Andreas Färber0d342822012-12-17 07:12:13 +01001221 GDB_SIGNAL_TRAP, cpu_index(cpu), type,
Andreas Färberff4700b2013-08-26 18:23:18 +02001222 (target_ulong)cpu->watchpoint_hit->vaddr);
1223 cpu->watchpoint_hit = NULL;
Jan Kiszka425189a2011-03-22 11:02:09 +01001224 goto send_packet;
pbrook6658ffb2007-03-16 23:58:11 +00001225 }
Jan Kiszka425189a2011-03-22 11:02:09 +01001226 tb_flush(env);
aurel32ca587a82008-12-18 22:44:13 +00001227 ret = GDB_SIGNAL_TRAP;
Jan Kiszka425189a2011-03-22 11:02:09 +01001228 break;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001229 case RUN_STATE_PAUSED:
aliguori9781e042009-01-22 17:15:29 +00001230 ret = GDB_SIGNAL_INT;
Jan Kiszka425189a2011-03-22 11:02:09 +01001231 break;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001232 case RUN_STATE_SHUTDOWN:
Jan Kiszka425189a2011-03-22 11:02:09 +01001233 ret = GDB_SIGNAL_QUIT;
1234 break;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001235 case RUN_STATE_IO_ERROR:
Jan Kiszka425189a2011-03-22 11:02:09 +01001236 ret = GDB_SIGNAL_IO;
1237 break;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001238 case RUN_STATE_WATCHDOG:
Jan Kiszka425189a2011-03-22 11:02:09 +01001239 ret = GDB_SIGNAL_ALRM;
1240 break;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001241 case RUN_STATE_INTERNAL_ERROR:
Jan Kiszka425189a2011-03-22 11:02:09 +01001242 ret = GDB_SIGNAL_ABRT;
1243 break;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001244 case RUN_STATE_SAVE_VM:
1245 case RUN_STATE_RESTORE_VM:
Jan Kiszka425189a2011-03-22 11:02:09 +01001246 return;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001247 case RUN_STATE_FINISH_MIGRATE:
Jan Kiszka425189a2011-03-22 11:02:09 +01001248 ret = GDB_SIGNAL_XCPU;
1249 break;
1250 default:
1251 ret = GDB_SIGNAL_UNKNOWN;
1252 break;
bellardbbeb7b52006-04-23 18:42:15 +00001253 }
Andreas Färber0d342822012-12-17 07:12:13 +01001254 snprintf(buf, sizeof(buf), "T%02xthread:%02x;", ret, cpu_index(cpu));
Jan Kiszka425189a2011-03-22 11:02:09 +01001255
1256send_packet:
bellard858693c2004-03-31 18:52:07 +00001257 put_packet(s, buf);
Jan Kiszka425189a2011-03-22 11:02:09 +01001258
1259 /* disable single step if it was enabled */
Andreas Färber3825b282013-06-24 18:41:06 +02001260 cpu_single_step(cpu, 0);
bellard858693c2004-03-31 18:52:07 +00001261}
bellard1fddef42005-04-17 19:16:13 +00001262#endif
bellard858693c2004-03-31 18:52:07 +00001263
pbrooka2d1eba2007-01-28 03:10:55 +00001264/* Send a gdb syscall request.
1265 This accepts limited printf-style format specifiers, specifically:
pbrooka87295e2007-05-26 15:09:38 +00001266 %x - target_ulong argument printed in hex.
1267 %lx - 64-bit argument printed in hex.
1268 %s - string pointer (target_ulong) and length (int) pair. */
blueswir17ccfb2e2008-09-14 06:45:34 +00001269void gdb_do_syscall(gdb_syscall_complete_cb cb, const char *fmt, ...)
pbrooka2d1eba2007-01-28 03:10:55 +00001270{
1271 va_list va;
pbrooka2d1eba2007-01-28 03:10:55 +00001272 char *p;
Meador Ingecdb432b2012-03-15 17:49:45 +00001273 char *p_end;
pbrooka2d1eba2007-01-28 03:10:55 +00001274 target_ulong addr;
pbrooka87295e2007-05-26 15:09:38 +00001275 uint64_t i64;
pbrooka2d1eba2007-01-28 03:10:55 +00001276 GDBState *s;
1277
aliguori880a7572008-11-18 20:30:24 +00001278 s = gdbserver_state;
pbrooka2d1eba2007-01-28 03:10:55 +00001279 if (!s)
1280 return;
Meador Ingecdb432b2012-03-15 17:49:45 +00001281 s->current_syscall_cb = cb;
pbrooka2d1eba2007-01-28 03:10:55 +00001282#ifndef CONFIG_USER_ONLY
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001283 vm_stop(RUN_STATE_DEBUG);
pbrooka2d1eba2007-01-28 03:10:55 +00001284#endif
pbrooka2d1eba2007-01-28 03:10:55 +00001285 va_start(va, fmt);
Meador Ingecdb432b2012-03-15 17:49:45 +00001286 p = s->syscall_buf;
1287 p_end = &s->syscall_buf[sizeof(s->syscall_buf)];
pbrooka2d1eba2007-01-28 03:10:55 +00001288 *(p++) = 'F';
1289 while (*fmt) {
1290 if (*fmt == '%') {
1291 fmt++;
1292 switch (*fmt++) {
1293 case 'x':
1294 addr = va_arg(va, target_ulong);
Meador Ingecdb432b2012-03-15 17:49:45 +00001295 p += snprintf(p, p_end - p, TARGET_FMT_lx, addr);
pbrooka2d1eba2007-01-28 03:10:55 +00001296 break;
pbrooka87295e2007-05-26 15:09:38 +00001297 case 'l':
1298 if (*(fmt++) != 'x')
1299 goto bad_format;
1300 i64 = va_arg(va, uint64_t);
Meador Ingecdb432b2012-03-15 17:49:45 +00001301 p += snprintf(p, p_end - p, "%" PRIx64, i64);
pbrooka87295e2007-05-26 15:09:38 +00001302 break;
pbrooka2d1eba2007-01-28 03:10:55 +00001303 case 's':
1304 addr = va_arg(va, target_ulong);
Meador Ingecdb432b2012-03-15 17:49:45 +00001305 p += snprintf(p, p_end - p, TARGET_FMT_lx "/%x",
blueswir1363a37d2008-08-21 17:58:08 +00001306 addr, va_arg(va, int));
pbrooka2d1eba2007-01-28 03:10:55 +00001307 break;
1308 default:
pbrooka87295e2007-05-26 15:09:38 +00001309 bad_format:
pbrooka2d1eba2007-01-28 03:10:55 +00001310 fprintf(stderr, "gdbstub: Bad syscall format string '%s'\n",
1311 fmt - 1);
1312 break;
1313 }
1314 } else {
1315 *(p++) = *(fmt++);
1316 }
1317 }
pbrook8a93e022007-08-06 13:19:15 +00001318 *p = 0;
pbrooka2d1eba2007-01-28 03:10:55 +00001319 va_end(va);
pbrooka2d1eba2007-01-28 03:10:55 +00001320#ifdef CONFIG_USER_ONLY
Meador Ingecdb432b2012-03-15 17:49:45 +00001321 put_packet(s, s->syscall_buf);
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001322 gdb_handlesig(s->c_cpu, 0);
pbrooka2d1eba2007-01-28 03:10:55 +00001323#else
Meador Ingecdb432b2012-03-15 17:49:45 +00001324 /* In this case wait to send the syscall packet until notification that
1325 the CPU has stopped. This must be done because if the packet is sent
1326 now the reply from the syscall request could be received while the CPU
1327 is still in the running state, which can cause packets to be dropped
1328 and state transition 'T' packets to be sent while the syscall is still
1329 being processed. */
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001330 cpu_exit(s->c_cpu);
pbrooka2d1eba2007-01-28 03:10:55 +00001331#endif
1332}
1333
bellard6a00d602005-11-21 23:25:50 +00001334static void gdb_read_byte(GDBState *s, int ch)
bellard858693c2004-03-31 18:52:07 +00001335{
1336 int i, csum;
ths60fe76f2007-12-16 03:02:09 +00001337 uint8_t reply;
bellard858693c2004-03-31 18:52:07 +00001338
bellard1fddef42005-04-17 19:16:13 +00001339#ifndef CONFIG_USER_ONLY
pbrook4046d912007-01-28 01:53:16 +00001340 if (s->last_packet_len) {
1341 /* Waiting for a response to the last packet. If we see the start
1342 of a new command then abandon the previous response. */
1343 if (ch == '-') {
1344#ifdef DEBUG_GDB
1345 printf("Got NACK, retransmitting\n");
1346#endif
thsffe8ab82007-12-16 03:16:05 +00001347 put_buffer(s, (uint8_t *)s->last_packet, s->last_packet_len);
pbrook4046d912007-01-28 01:53:16 +00001348 }
1349#ifdef DEBUG_GDB
1350 else if (ch == '+')
1351 printf("Got ACK\n");
1352 else
1353 printf("Got '%c' when expecting ACK/NACK\n", ch);
1354#endif
1355 if (ch == '+' || ch == '$')
1356 s->last_packet_len = 0;
1357 if (ch != '$')
1358 return;
1359 }
Luiz Capitulino13548692011-07-29 15:36:43 -03001360 if (runstate_is_running()) {
bellard858693c2004-03-31 18:52:07 +00001361 /* when the CPU is running, we cannot do anything except stop
1362 it when receiving a char */
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001363 vm_stop(RUN_STATE_PAUSED);
ths5fafdf22007-09-16 21:08:06 +00001364 } else
bellard1fddef42005-04-17 19:16:13 +00001365#endif
bellard41625032005-04-24 10:07:11 +00001366 {
bellard858693c2004-03-31 18:52:07 +00001367 switch(s->state) {
1368 case RS_IDLE:
1369 if (ch == '$') {
1370 s->line_buf_index = 0;
1371 s->state = RS_GETLINE;
bellard4c3a88a2003-07-26 12:06:08 +00001372 }
1373 break;
bellard858693c2004-03-31 18:52:07 +00001374 case RS_GETLINE:
1375 if (ch == '#') {
1376 s->state = RS_CHKSUM1;
1377 } else if (s->line_buf_index >= sizeof(s->line_buf) - 1) {
1378 s->state = RS_IDLE;
1379 } else {
1380 s->line_buf[s->line_buf_index++] = ch;
1381 }
1382 break;
1383 case RS_CHKSUM1:
1384 s->line_buf[s->line_buf_index] = '\0';
1385 s->line_csum = fromhex(ch) << 4;
1386 s->state = RS_CHKSUM2;
1387 break;
1388 case RS_CHKSUM2:
1389 s->line_csum |= fromhex(ch);
1390 csum = 0;
1391 for(i = 0; i < s->line_buf_index; i++) {
1392 csum += s->line_buf[i];
1393 }
1394 if (s->line_csum != (csum & 0xff)) {
ths60fe76f2007-12-16 03:02:09 +00001395 reply = '-';
1396 put_buffer(s, &reply, 1);
bellard858693c2004-03-31 18:52:07 +00001397 s->state = RS_IDLE;
1398 } else {
ths60fe76f2007-12-16 03:02:09 +00001399 reply = '+';
1400 put_buffer(s, &reply, 1);
aliguori880a7572008-11-18 20:30:24 +00001401 s->state = gdb_handle_packet(s, s->line_buf);
bellard858693c2004-03-31 18:52:07 +00001402 }
bellardb4608c02003-06-27 17:34:32 +00001403 break;
pbrooka2d1eba2007-01-28 03:10:55 +00001404 default:
1405 abort();
bellardb4608c02003-06-27 17:34:32 +00001406 }
1407 }
bellard858693c2004-03-31 18:52:07 +00001408}
1409
Paul Brook0e1c9c52010-06-16 13:03:51 +01001410/* Tell the remote gdb that the process has exited. */
Andreas Färber9349b4f2012-03-14 01:38:32 +01001411void gdb_exit(CPUArchState *env, int code)
Paul Brook0e1c9c52010-06-16 13:03:51 +01001412{
1413 GDBState *s;
1414 char buf[4];
1415
1416 s = gdbserver_state;
1417 if (!s) {
1418 return;
1419 }
1420#ifdef CONFIG_USER_ONLY
1421 if (gdbserver_fd < 0 || s->fd < 0) {
1422 return;
1423 }
1424#endif
1425
1426 snprintf(buf, sizeof(buf), "W%02x", (uint8_t)code);
1427 put_packet(s, buf);
Fabien Chouteaue2af15b2011-01-13 12:46:57 +01001428
1429#ifndef CONFIG_USER_ONLY
1430 if (s->chr) {
Anthony Liguori70f24fb2011-08-15 11:17:38 -05001431 qemu_chr_delete(s->chr);
Fabien Chouteaue2af15b2011-01-13 12:46:57 +01001432 }
1433#endif
Paul Brook0e1c9c52010-06-16 13:03:51 +01001434}
1435
bellard1fddef42005-04-17 19:16:13 +00001436#ifdef CONFIG_USER_ONLY
1437int
aurel32ca587a82008-12-18 22:44:13 +00001438gdb_queuesig (void)
1439{
1440 GDBState *s;
1441
1442 s = gdbserver_state;
1443
1444 if (gdbserver_fd < 0 || s->fd < 0)
1445 return 0;
1446 else
1447 return 1;
1448}
1449
1450int
Andreas Färberdb6b81d2013-06-27 19:49:31 +02001451gdb_handlesig(CPUState *cpu, int sig)
bellard1fddef42005-04-17 19:16:13 +00001452{
Andreas Färberdb6b81d2013-06-27 19:49:31 +02001453 CPUArchState *env = cpu->env_ptr;
Andreas Färber5ca666c2013-06-24 19:20:57 +02001454 GDBState *s;
1455 char buf[256];
1456 int n;
bellard1fddef42005-04-17 19:16:13 +00001457
Andreas Färber5ca666c2013-06-24 19:20:57 +02001458 s = gdbserver_state;
1459 if (gdbserver_fd < 0 || s->fd < 0) {
1460 return sig;
bellard1fddef42005-04-17 19:16:13 +00001461 }
1462
Andreas Färber5ca666c2013-06-24 19:20:57 +02001463 /* disable single step if it was enabled */
Andreas Färber3825b282013-06-24 18:41:06 +02001464 cpu_single_step(cpu, 0);
Andreas Färber5ca666c2013-06-24 19:20:57 +02001465 tb_flush(env);
bellard1fddef42005-04-17 19:16:13 +00001466
Andreas Färber5ca666c2013-06-24 19:20:57 +02001467 if (sig != 0) {
1468 snprintf(buf, sizeof(buf), "S%02x", target_signal_to_gdb(sig));
1469 put_packet(s, buf);
1470 }
1471 /* put_packet() might have detected that the peer terminated the
1472 connection. */
1473 if (s->fd < 0) {
1474 return sig;
1475 }
1476
1477 sig = 0;
1478 s->state = RS_IDLE;
1479 s->running_state = 0;
1480 while (s->running_state == 0) {
1481 n = read(s->fd, buf, 256);
1482 if (n > 0) {
1483 int i;
1484
1485 for (i = 0; i < n; i++) {
1486 gdb_read_byte(s, buf[i]);
1487 }
1488 } else if (n == 0 || errno != EAGAIN) {
1489 /* XXX: Connection closed. Should probably wait for another
1490 connection before continuing. */
1491 return sig;
bellard1fddef42005-04-17 19:16:13 +00001492 }
Andreas Färber5ca666c2013-06-24 19:20:57 +02001493 }
1494 sig = s->signal;
1495 s->signal = 0;
1496 return sig;
bellard1fddef42005-04-17 19:16:13 +00001497}
bellarde9009672005-04-26 20:42:36 +00001498
aurel32ca587a82008-12-18 22:44:13 +00001499/* Tell the remote gdb that the process has exited due to SIG. */
Andreas Färber9349b4f2012-03-14 01:38:32 +01001500void gdb_signalled(CPUArchState *env, int sig)
aurel32ca587a82008-12-18 22:44:13 +00001501{
Andreas Färber5ca666c2013-06-24 19:20:57 +02001502 GDBState *s;
1503 char buf[4];
aurel32ca587a82008-12-18 22:44:13 +00001504
Andreas Färber5ca666c2013-06-24 19:20:57 +02001505 s = gdbserver_state;
1506 if (gdbserver_fd < 0 || s->fd < 0) {
1507 return;
1508 }
aurel32ca587a82008-12-18 22:44:13 +00001509
Andreas Färber5ca666c2013-06-24 19:20:57 +02001510 snprintf(buf, sizeof(buf), "X%02x", target_signal_to_gdb(sig));
1511 put_packet(s, buf);
aurel32ca587a82008-12-18 22:44:13 +00001512}
bellard1fddef42005-04-17 19:16:13 +00001513
aliguori880a7572008-11-18 20:30:24 +00001514static void gdb_accept(void)
bellard858693c2004-03-31 18:52:07 +00001515{
1516 GDBState *s;
1517 struct sockaddr_in sockaddr;
1518 socklen_t len;
MORITA Kazutakabf1c8522013-02-22 12:39:50 +09001519 int fd;
bellard858693c2004-03-31 18:52:07 +00001520
1521 for(;;) {
1522 len = sizeof(sockaddr);
1523 fd = accept(gdbserver_fd, (struct sockaddr *)&sockaddr, &len);
1524 if (fd < 0 && errno != EINTR) {
1525 perror("accept");
1526 return;
1527 } else if (fd >= 0) {
Kevin Wolf40ff6d72009-12-02 12:24:42 +01001528#ifndef _WIN32
1529 fcntl(fd, F_SETFD, FD_CLOEXEC);
1530#endif
bellard858693c2004-03-31 18:52:07 +00001531 break;
1532 }
1533 }
1534
1535 /* set short latency */
MORITA Kazutakabf1c8522013-02-22 12:39:50 +09001536 socket_set_nodelay(fd);
ths3b46e622007-09-17 08:09:54 +00001537
Anthony Liguori7267c092011-08-20 22:09:37 -05001538 s = g_malloc0(sizeof(GDBState));
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001539 s->c_cpu = first_cpu;
1540 s->g_cpu = first_cpu;
bellard858693c2004-03-31 18:52:07 +00001541 s->fd = fd;
Andreas Färber5b50e792013-06-29 04:18:45 +02001542 gdb_has_xml = false;
bellard858693c2004-03-31 18:52:07 +00001543
aliguori880a7572008-11-18 20:30:24 +00001544 gdbserver_state = s;
pbrooka2d1eba2007-01-28 03:10:55 +00001545
bellard858693c2004-03-31 18:52:07 +00001546 fcntl(fd, F_SETFL, O_NONBLOCK);
bellard858693c2004-03-31 18:52:07 +00001547}
1548
1549static int gdbserver_open(int port)
1550{
1551 struct sockaddr_in sockaddr;
Sebastian Ottlik6669ca12013-10-02 12:23:13 +02001552 int fd, ret;
bellard858693c2004-03-31 18:52:07 +00001553
1554 fd = socket(PF_INET, SOCK_STREAM, 0);
1555 if (fd < 0) {
1556 perror("socket");
1557 return -1;
1558 }
Kevin Wolf40ff6d72009-12-02 12:24:42 +01001559#ifndef _WIN32
1560 fcntl(fd, F_SETFD, FD_CLOEXEC);
1561#endif
bellard858693c2004-03-31 18:52:07 +00001562
Sebastian Ottlik6669ca12013-10-02 12:23:13 +02001563 socket_set_fast_reuse(fd);
bellard858693c2004-03-31 18:52:07 +00001564
1565 sockaddr.sin_family = AF_INET;
1566 sockaddr.sin_port = htons(port);
1567 sockaddr.sin_addr.s_addr = 0;
1568 ret = bind(fd, (struct sockaddr *)&sockaddr, sizeof(sockaddr));
1569 if (ret < 0) {
1570 perror("bind");
Peter Maydellbb161722011-12-24 23:37:24 +00001571 close(fd);
bellard858693c2004-03-31 18:52:07 +00001572 return -1;
1573 }
1574 ret = listen(fd, 0);
1575 if (ret < 0) {
1576 perror("listen");
Peter Maydellbb161722011-12-24 23:37:24 +00001577 close(fd);
bellard858693c2004-03-31 18:52:07 +00001578 return -1;
1579 }
bellard858693c2004-03-31 18:52:07 +00001580 return fd;
1581}
1582
1583int gdbserver_start(int port)
1584{
1585 gdbserver_fd = gdbserver_open(port);
1586 if (gdbserver_fd < 0)
1587 return -1;
1588 /* accept connections */
aliguori880a7572008-11-18 20:30:24 +00001589 gdb_accept();
bellardb4608c02003-06-27 17:34:32 +00001590 return 0;
1591}
aurel322b1319c2008-12-18 22:44:04 +00001592
1593/* Disable gdb stub for child processes. */
Andreas Färber9349b4f2012-03-14 01:38:32 +01001594void gdbserver_fork(CPUArchState *env)
aurel322b1319c2008-12-18 22:44:04 +00001595{
1596 GDBState *s = gdbserver_state;
edgar_igl9f6164d2009-01-07 10:22:28 +00001597 if (gdbserver_fd < 0 || s->fd < 0)
aurel322b1319c2008-12-18 22:44:04 +00001598 return;
1599 close(s->fd);
1600 s->fd = -1;
1601 cpu_breakpoint_remove_all(env, BP_GDB);
1602 cpu_watchpoint_remove_all(env, BP_GDB);
1603}
pbrook4046d912007-01-28 01:53:16 +00001604#else
thsaa1f17c2007-07-11 22:48:58 +00001605static int gdb_chr_can_receive(void *opaque)
pbrook4046d912007-01-28 01:53:16 +00001606{
pbrook56aebc82008-10-11 17:55:29 +00001607 /* We can handle an arbitrarily large amount of data.
1608 Pick the maximum packet size, which is as good as anything. */
1609 return MAX_PACKET_LENGTH;
pbrook4046d912007-01-28 01:53:16 +00001610}
1611
thsaa1f17c2007-07-11 22:48:58 +00001612static void gdb_chr_receive(void *opaque, const uint8_t *buf, int size)
pbrook4046d912007-01-28 01:53:16 +00001613{
pbrook4046d912007-01-28 01:53:16 +00001614 int i;
1615
1616 for (i = 0; i < size; i++) {
aliguori880a7572008-11-18 20:30:24 +00001617 gdb_read_byte(gdbserver_state, buf[i]);
pbrook4046d912007-01-28 01:53:16 +00001618 }
1619}
1620
1621static void gdb_chr_event(void *opaque, int event)
1622{
1623 switch (event) {
Amit Shahb6b8df52009-10-07 18:31:16 +05301624 case CHR_EVENT_OPENED:
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001625 vm_stop(RUN_STATE_PAUSED);
Andreas Färber5b50e792013-06-29 04:18:45 +02001626 gdb_has_xml = false;
pbrook4046d912007-01-28 01:53:16 +00001627 break;
1628 default:
1629 break;
1630 }
1631}
1632
aliguori8a34a0f2009-03-05 23:01:55 +00001633static void gdb_monitor_output(GDBState *s, const char *msg, int len)
1634{
1635 char buf[MAX_PACKET_LENGTH];
1636
1637 buf[0] = 'O';
1638 if (len > (MAX_PACKET_LENGTH/2) - 1)
1639 len = (MAX_PACKET_LENGTH/2) - 1;
1640 memtohex(buf + 1, (uint8_t *)msg, len);
1641 put_packet(s, buf);
1642}
1643
1644static int gdb_monitor_write(CharDriverState *chr, const uint8_t *buf, int len)
1645{
1646 const char *p = (const char *)buf;
1647 int max_sz;
1648
1649 max_sz = (sizeof(gdbserver_state->last_packet) - 2) / 2;
1650 for (;;) {
1651 if (len <= max_sz) {
1652 gdb_monitor_output(gdbserver_state, p, len);
1653 break;
1654 }
1655 gdb_monitor_output(gdbserver_state, p, max_sz);
1656 p += max_sz;
1657 len -= max_sz;
1658 }
1659 return len;
1660}
1661
aliguori59030a82009-04-05 18:43:41 +00001662#ifndef _WIN32
1663static void gdb_sigterm_handler(int signal)
1664{
Luiz Capitulino13548692011-07-29 15:36:43 -03001665 if (runstate_is_running()) {
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001666 vm_stop(RUN_STATE_PAUSED);
Jan Kiszkae07bbac2011-02-09 16:29:40 +01001667 }
aliguori59030a82009-04-05 18:43:41 +00001668}
1669#endif
1670
1671int gdbserver_start(const char *device)
pbrook4046d912007-01-28 01:53:16 +00001672{
1673 GDBState *s;
aliguori59030a82009-04-05 18:43:41 +00001674 char gdbstub_device_name[128];
aliguori36556b22009-03-28 18:05:53 +00001675 CharDriverState *chr = NULL;
1676 CharDriverState *mon_chr;
pbrook4046d912007-01-28 01:53:16 +00001677
aliguori59030a82009-04-05 18:43:41 +00001678 if (!device)
1679 return -1;
1680 if (strcmp(device, "none") != 0) {
1681 if (strstart(device, "tcp:", NULL)) {
1682 /* enforce required TCP attributes */
1683 snprintf(gdbstub_device_name, sizeof(gdbstub_device_name),
1684 "%s,nowait,nodelay,server", device);
1685 device = gdbstub_device_name;
aliguori36556b22009-03-28 18:05:53 +00001686 }
aliguori59030a82009-04-05 18:43:41 +00001687#ifndef _WIN32
1688 else if (strcmp(device, "stdio") == 0) {
1689 struct sigaction act;
pbrookcfc34752007-02-22 01:48:01 +00001690
aliguori59030a82009-04-05 18:43:41 +00001691 memset(&act, 0, sizeof(act));
1692 act.sa_handler = gdb_sigterm_handler;
1693 sigaction(SIGINT, &act, NULL);
1694 }
1695#endif
Anthony Liguori27143a42011-08-15 11:17:36 -05001696 chr = qemu_chr_new("gdb", device, NULL);
aliguori36556b22009-03-28 18:05:53 +00001697 if (!chr)
1698 return -1;
1699
Hans de Goede456d6062013-03-27 20:29:40 +01001700 qemu_chr_fe_claim_no_fail(chr);
aliguori36556b22009-03-28 18:05:53 +00001701 qemu_chr_add_handlers(chr, gdb_chr_can_receive, gdb_chr_receive,
1702 gdb_chr_event, NULL);
pbrookcfc34752007-02-22 01:48:01 +00001703 }
1704
aliguori36556b22009-03-28 18:05:53 +00001705 s = gdbserver_state;
1706 if (!s) {
Anthony Liguori7267c092011-08-20 22:09:37 -05001707 s = g_malloc0(sizeof(GDBState));
aliguori36556b22009-03-28 18:05:53 +00001708 gdbserver_state = s;
pbrook4046d912007-01-28 01:53:16 +00001709
aliguori36556b22009-03-28 18:05:53 +00001710 qemu_add_vm_change_state_handler(gdb_vm_state_change, NULL);
1711
1712 /* Initialize a monitor terminal for gdb */
Anthony Liguori7267c092011-08-20 22:09:37 -05001713 mon_chr = g_malloc0(sizeof(*mon_chr));
aliguori36556b22009-03-28 18:05:53 +00001714 mon_chr->chr_write = gdb_monitor_write;
1715 monitor_init(mon_chr, 0);
1716 } else {
1717 if (s->chr)
Anthony Liguori70f24fb2011-08-15 11:17:38 -05001718 qemu_chr_delete(s->chr);
aliguori36556b22009-03-28 18:05:53 +00001719 mon_chr = s->mon_chr;
1720 memset(s, 0, sizeof(GDBState));
1721 }
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001722 s->c_cpu = first_cpu;
1723 s->g_cpu = first_cpu;
pbrook4046d912007-01-28 01:53:16 +00001724 s->chr = chr;
aliguori36556b22009-03-28 18:05:53 +00001725 s->state = chr ? RS_IDLE : RS_INACTIVE;
1726 s->mon_chr = mon_chr;
Meador Ingecdb432b2012-03-15 17:49:45 +00001727 s->current_syscall_cb = NULL;
aliguori8a34a0f2009-03-05 23:01:55 +00001728
pbrook4046d912007-01-28 01:53:16 +00001729 return 0;
1730}
1731#endif