]> git.proxmox.com Git - mirror_qemu.git/blame - gdbstub.c
tcg: synchronize exit_request and tcg_current_cpu accesses
[mirror_qemu.git] / gdbstub.c
CommitLineData
b4608c04
FB
1/*
2 * gdb server stub
5fafdf24 3 *
3475187d 4 * Copyright (c) 2003-2005 Fabrice Bellard
b4608c04
FB
5 *
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
8167ee88 17 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
b4608c04 18 */
978efd6a 19#include "config.h"
56aebc89 20#include "qemu-common.h"
1fddef4b
FB
21#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>
978efd6a 28#include <fcntl.h>
1fddef4b
FB
29
30#include "qemu.h"
31#else
83c9089e 32#include "monitor/monitor.h"
dccfcd0e 33#include "sysemu/char.h"
9c17d615 34#include "sysemu/sysemu.h"
022c62cb 35#include "exec/gdbstub.h"
1fddef4b 36#endif
67b915a5 37
56aebc89
PB
38#define MAX_PACKET_LENGTH 4096
39
2b41f10e 40#include "cpu.h"
1de7afc9 41#include "qemu/sockets.h"
9c17d615 42#include "sysemu/kvm.h"
cfe67cef 43#include "exec/semihost.h"
ca587a8e 44
a3919386
JK
45#ifdef CONFIG_USER_ONLY
46#define GDB_ATTACHED "0"
47#else
48#define GDB_ATTACHED "1"
49#endif
50
f3659eee
AF
51static inline int target_memory_rw_debug(CPUState *cpu, target_ulong addr,
52 uint8_t *buf, int len, bool is_write)
44520db1 53{
f3659eee
AF
54 CPUClass *cc = CPU_GET_CLASS(cpu);
55
56 if (cc->memory_rw_debug) {
57 return cc->memory_rw_debug(cpu, addr, buf, len, is_write);
58 }
59 return cpu_memory_rw_debug(cpu, addr, buf, len, is_write);
44520db1 60}
ca587a8e
AJ
61
62enum {
63 GDB_SIGNAL_0 = 0,
64 GDB_SIGNAL_INT = 2,
425189a8 65 GDB_SIGNAL_QUIT = 3,
ca587a8e 66 GDB_SIGNAL_TRAP = 5,
425189a8
JK
67 GDB_SIGNAL_ABRT = 6,
68 GDB_SIGNAL_ALRM = 14,
69 GDB_SIGNAL_IO = 23,
70 GDB_SIGNAL_XCPU = 24,
ca587a8e
AJ
71 GDB_SIGNAL_UNKNOWN = 143
72};
73
74#ifdef CONFIG_USER_ONLY
75
76/* Map target signal numbers to GDB protocol signal numbers and vice
77 * versa. For user emulation's currently supported systems, we can
78 * assume most signals are defined.
79 */
80
81static int gdb_signal_table[] = {
82 0,
83 TARGET_SIGHUP,
84 TARGET_SIGINT,
85 TARGET_SIGQUIT,
86 TARGET_SIGILL,
87 TARGET_SIGTRAP,
88 TARGET_SIGABRT,
89 -1, /* SIGEMT */
90 TARGET_SIGFPE,
91 TARGET_SIGKILL,
92 TARGET_SIGBUS,
93 TARGET_SIGSEGV,
94 TARGET_SIGSYS,
95 TARGET_SIGPIPE,
96 TARGET_SIGALRM,
97 TARGET_SIGTERM,
98 TARGET_SIGURG,
99 TARGET_SIGSTOP,
100 TARGET_SIGTSTP,
101 TARGET_SIGCONT,
102 TARGET_SIGCHLD,
103 TARGET_SIGTTIN,
104 TARGET_SIGTTOU,
105 TARGET_SIGIO,
106 TARGET_SIGXCPU,
107 TARGET_SIGXFSZ,
108 TARGET_SIGVTALRM,
109 TARGET_SIGPROF,
110 TARGET_SIGWINCH,
111 -1, /* SIGLOST */
112 TARGET_SIGUSR1,
113 TARGET_SIGUSR2,
c72d5bf8 114#ifdef TARGET_SIGPWR
ca587a8e 115 TARGET_SIGPWR,
c72d5bf8
BS
116#else
117 -1,
118#endif
ca587a8e
AJ
119 -1, /* SIGPOLL */
120 -1,
121 -1,
122 -1,
123 -1,
124 -1,
125 -1,
126 -1,
127 -1,
128 -1,
129 -1,
130 -1,
c72d5bf8 131#ifdef __SIGRTMIN
ca587a8e
AJ
132 __SIGRTMIN + 1,
133 __SIGRTMIN + 2,
134 __SIGRTMIN + 3,
135 __SIGRTMIN + 4,
136 __SIGRTMIN + 5,
137 __SIGRTMIN + 6,
138 __SIGRTMIN + 7,
139 __SIGRTMIN + 8,
140 __SIGRTMIN + 9,
141 __SIGRTMIN + 10,
142 __SIGRTMIN + 11,
143 __SIGRTMIN + 12,
144 __SIGRTMIN + 13,
145 __SIGRTMIN + 14,
146 __SIGRTMIN + 15,
147 __SIGRTMIN + 16,
148 __SIGRTMIN + 17,
149 __SIGRTMIN + 18,
150 __SIGRTMIN + 19,
151 __SIGRTMIN + 20,
152 __SIGRTMIN + 21,
153 __SIGRTMIN + 22,
154 __SIGRTMIN + 23,
155 __SIGRTMIN + 24,
156 __SIGRTMIN + 25,
157 __SIGRTMIN + 26,
158 __SIGRTMIN + 27,
159 __SIGRTMIN + 28,
160 __SIGRTMIN + 29,
161 __SIGRTMIN + 30,
162 __SIGRTMIN + 31,
163 -1, /* SIGCANCEL */
164 __SIGRTMIN,
165 __SIGRTMIN + 32,
166 __SIGRTMIN + 33,
167 __SIGRTMIN + 34,
168 __SIGRTMIN + 35,
169 __SIGRTMIN + 36,
170 __SIGRTMIN + 37,
171 __SIGRTMIN + 38,
172 __SIGRTMIN + 39,
173 __SIGRTMIN + 40,
174 __SIGRTMIN + 41,
175 __SIGRTMIN + 42,
176 __SIGRTMIN + 43,
177 __SIGRTMIN + 44,
178 __SIGRTMIN + 45,
179 __SIGRTMIN + 46,
180 __SIGRTMIN + 47,
181 __SIGRTMIN + 48,
182 __SIGRTMIN + 49,
183 __SIGRTMIN + 50,
184 __SIGRTMIN + 51,
185 __SIGRTMIN + 52,
186 __SIGRTMIN + 53,
187 __SIGRTMIN + 54,
188 __SIGRTMIN + 55,
189 __SIGRTMIN + 56,
190 __SIGRTMIN + 57,
191 __SIGRTMIN + 58,
192 __SIGRTMIN + 59,
193 __SIGRTMIN + 60,
194 __SIGRTMIN + 61,
195 __SIGRTMIN + 62,
196 __SIGRTMIN + 63,
197 __SIGRTMIN + 64,
198 __SIGRTMIN + 65,
199 __SIGRTMIN + 66,
200 __SIGRTMIN + 67,
201 __SIGRTMIN + 68,
202 __SIGRTMIN + 69,
203 __SIGRTMIN + 70,
204 __SIGRTMIN + 71,
205 __SIGRTMIN + 72,
206 __SIGRTMIN + 73,
207 __SIGRTMIN + 74,
208 __SIGRTMIN + 75,
209 __SIGRTMIN + 76,
210 __SIGRTMIN + 77,
211 __SIGRTMIN + 78,
212 __SIGRTMIN + 79,
213 __SIGRTMIN + 80,
214 __SIGRTMIN + 81,
215 __SIGRTMIN + 82,
216 __SIGRTMIN + 83,
217 __SIGRTMIN + 84,
218 __SIGRTMIN + 85,
219 __SIGRTMIN + 86,
220 __SIGRTMIN + 87,
221 __SIGRTMIN + 88,
222 __SIGRTMIN + 89,
223 __SIGRTMIN + 90,
224 __SIGRTMIN + 91,
225 __SIGRTMIN + 92,
226 __SIGRTMIN + 93,
227 __SIGRTMIN + 94,
228 __SIGRTMIN + 95,
229 -1, /* SIGINFO */
230 -1, /* UNKNOWN */
231 -1, /* DEFAULT */
232 -1,
233 -1,
234 -1,
235 -1,
236 -1,
237 -1
c72d5bf8 238#endif
ca587a8e 239};
8f447cc7 240#else
ca587a8e
AJ
241/* In system mode we only need SIGINT and SIGTRAP; other signals
242 are not yet supported. */
243
244enum {
245 TARGET_SIGINT = 2,
246 TARGET_SIGTRAP = 5
247};
248
249static int gdb_signal_table[] = {
250 -1,
251 -1,
252 TARGET_SIGINT,
253 -1,
254 -1,
255 TARGET_SIGTRAP
256};
257#endif
258
259#ifdef CONFIG_USER_ONLY
260static int target_signal_to_gdb (int sig)
261{
262 int i;
263 for (i = 0; i < ARRAY_SIZE (gdb_signal_table); i++)
264 if (gdb_signal_table[i] == sig)
265 return i;
266 return GDB_SIGNAL_UNKNOWN;
267}
8f447cc7 268#endif
b4608c04 269
ca587a8e
AJ
270static int gdb_signal_to_target (int sig)
271{
272 if (sig < ARRAY_SIZE (gdb_signal_table))
273 return gdb_signal_table[sig];
274 else
275 return -1;
276}
277
4abe615b 278//#define DEBUG_GDB
b4608c04 279
56aebc89
PB
280typedef struct GDBRegisterState {
281 int base_reg;
282 int num_regs;
283 gdb_reg_cb get_reg;
284 gdb_reg_cb set_reg;
285 const char *xml;
286 struct GDBRegisterState *next;
287} GDBRegisterState;
288
858693c6 289enum RSState {
36556b20 290 RS_INACTIVE,
858693c6
FB
291 RS_IDLE,
292 RS_GETLINE,
293 RS_CHKSUM1,
294 RS_CHKSUM2,
295};
858693c6 296typedef struct GDBState {
2e0f2cfb
AF
297 CPUState *c_cpu; /* current CPU for step/continue ops */
298 CPUState *g_cpu; /* current CPU for other ops */
52f34623 299 CPUState *query_cpu; /* for q{f|s}ThreadInfo */
41625033 300 enum RSState state; /* parsing state */
56aebc89 301 char line_buf[MAX_PACKET_LENGTH];
858693c6
FB
302 int line_buf_index;
303 int line_csum;
56aebc89 304 uint8_t last_packet[MAX_PACKET_LENGTH + 4];
4046d913 305 int last_packet_len;
1f487ee9 306 int signal;
41625033 307#ifdef CONFIG_USER_ONLY
4046d913 308 int fd;
41625033 309 int running_state;
4046d913
PB
310#else
311 CharDriverState *chr;
8a34a0fb 312 CharDriverState *mon_chr;
41625033 313#endif
cdb432b2
MI
314 char syscall_buf[256];
315 gdb_syscall_complete_cb current_syscall_cb;
858693c6 316} GDBState;
b4608c04 317
60897d36
EI
318/* By default use no IRQs and no timers while single stepping so as to
319 * make single stepping like an ICE HW step.
320 */
321static int sstep_flags = SSTEP_ENABLE|SSTEP_NOIRQ|SSTEP_NOTIMER;
322
880a7578
AL
323static GDBState *gdbserver_state;
324
5b50e790 325bool gdb_has_xml;
56aebc89 326
1fddef4b 327#ifdef CONFIG_USER_ONLY
4046d913
PB
328/* XXX: This is not thread safe. Do we care? */
329static int gdbserver_fd = -1;
330
858693c6 331static int get_char(GDBState *s)
b4608c04
FB
332{
333 uint8_t ch;
334 int ret;
335
336 for(;;) {
00aa0040 337 ret = qemu_recv(s->fd, &ch, 1, 0);
b4608c04 338 if (ret < 0) {
1f487ee9
EI
339 if (errno == ECONNRESET)
340 s->fd = -1;
b4608c04
FB
341 if (errno != EINTR && errno != EAGAIN)
342 return -1;
343 } else if (ret == 0) {
1f487ee9
EI
344 close(s->fd);
345 s->fd = -1;
b4608c04
FB
346 return -1;
347 } else {
348 break;
349 }
350 }
351 return ch;
352}
4046d913 353#endif
b4608c04 354
654efcf3 355static enum {
a2d1ebaf
PB
356 GDB_SYS_UNKNOWN,
357 GDB_SYS_ENABLED,
358 GDB_SYS_DISABLED,
359} gdb_syscall_mode;
360
a38bb079 361/* Decide if either remote gdb syscalls or native file IO should be used. */
a2d1ebaf
PB
362int use_gdb_syscalls(void)
363{
cfe67cef
LA
364 SemihostingTarget target = semihosting_get_target();
365 if (target == SEMIHOSTING_TARGET_NATIVE) {
a38bb079
LI
366 /* -semihosting-config target=native */
367 return false;
cfe67cef 368 } else if (target == SEMIHOSTING_TARGET_GDB) {
a38bb079
LI
369 /* -semihosting-config target=gdb */
370 return true;
371 }
372
373 /* -semihosting-config target=auto */
374 /* On the first call check if gdb is connected and remember. */
a2d1ebaf 375 if (gdb_syscall_mode == GDB_SYS_UNKNOWN) {
880a7578
AL
376 gdb_syscall_mode = (gdbserver_state ? GDB_SYS_ENABLED
377 : GDB_SYS_DISABLED);
a2d1ebaf
PB
378 }
379 return gdb_syscall_mode == GDB_SYS_ENABLED;
380}
381
ba70a624
EI
382/* Resume execution. */
383static inline void gdb_continue(GDBState *s)
384{
385#ifdef CONFIG_USER_ONLY
386 s->running_state = 1;
387#else
26ac7a31 388 if (!runstate_needs_reset()) {
87f25c12
PB
389 vm_start();
390 }
ba70a624
EI
391#endif
392}
393
858693c6 394static void put_buffer(GDBState *s, const uint8_t *buf, int len)
b4608c04 395{
4046d913 396#ifdef CONFIG_USER_ONLY
b4608c04
FB
397 int ret;
398
399 while (len > 0) {
8f447cc7 400 ret = send(s->fd, buf, len, 0);
b4608c04
FB
401 if (ret < 0) {
402 if (errno != EINTR && errno != EAGAIN)
403 return;
404 } else {
405 buf += ret;
406 len -= ret;
407 }
408 }
4046d913 409#else
2cc6e0a1 410 qemu_chr_fe_write(s->chr, buf, len);
4046d913 411#endif
b4608c04
FB
412}
413
414static inline int fromhex(int v)
415{
416 if (v >= '0' && v <= '9')
417 return v - '0';
418 else if (v >= 'A' && v <= 'F')
419 return v - 'A' + 10;
420 else if (v >= 'a' && v <= 'f')
421 return v - 'a' + 10;
422 else
423 return 0;
424}
425
426static inline int tohex(int v)
427{
428 if (v < 10)
429 return v + '0';
430 else
431 return v - 10 + 'a';
432}
433
434static void memtohex(char *buf, const uint8_t *mem, int len)
435{
436 int i, c;
437 char *q;
438 q = buf;
439 for(i = 0; i < len; i++) {
440 c = mem[i];
441 *q++ = tohex(c >> 4);
442 *q++ = tohex(c & 0xf);
443 }
444 *q = '\0';
445}
446
447static void hextomem(uint8_t *mem, const char *buf, int len)
448{
449 int i;
450
451 for(i = 0; i < len; i++) {
452 mem[i] = (fromhex(buf[0]) << 4) | fromhex(buf[1]);
453 buf += 2;
454 }
455}
456
b4608c04 457/* return -1 if error, 0 if OK */
56aebc89 458static int put_packet_binary(GDBState *s, const char *buf, int len)
b4608c04 459{
56aebc89 460 int csum, i;
60fe76f3 461 uint8_t *p;
b4608c04 462
b4608c04 463 for(;;) {
4046d913
PB
464 p = s->last_packet;
465 *(p++) = '$';
4046d913
PB
466 memcpy(p, buf, len);
467 p += len;
b4608c04
FB
468 csum = 0;
469 for(i = 0; i < len; i++) {
470 csum += buf[i];
471 }
4046d913
PB
472 *(p++) = '#';
473 *(p++) = tohex((csum >> 4) & 0xf);
474 *(p++) = tohex((csum) & 0xf);
b4608c04 475
4046d913 476 s->last_packet_len = p - s->last_packet;
ffe8ab83 477 put_buffer(s, (uint8_t *)s->last_packet, s->last_packet_len);
b4608c04 478
4046d913
PB
479#ifdef CONFIG_USER_ONLY
480 i = get_char(s);
481 if (i < 0)
b4608c04 482 return -1;
4046d913 483 if (i == '+')
b4608c04 484 break;
4046d913
PB
485#else
486 break;
487#endif
b4608c04
FB
488 }
489 return 0;
490}
491
56aebc89
PB
492/* return -1 if error, 0 if OK */
493static int put_packet(GDBState *s, const char *buf)
494{
495#ifdef DEBUG_GDB
496 printf("reply='%s'\n", buf);
497#endif
79808573 498
56aebc89
PB
499 return put_packet_binary(s, buf, strlen(buf));
500}
501
56aebc89
PB
502/* Encode data using the encoding for 'x' packets. */
503static int memtox(char *buf, const char *mem, int len)
504{
505 char *p = buf;
506 char c;
507
508 while (len--) {
509 c = *(mem++);
510 switch (c) {
511 case '#': case '$': case '*': case '}':
512 *(p++) = '}';
513 *(p++) = c ^ 0x20;
514 break;
515 default:
516 *(p++) = c;
517 break;
518 }
519 }
520 return p - buf;
521}
f1ccf904 522
5b24c641
AF
523static const char *get_feature_xml(const char *p, const char **newp,
524 CPUClass *cc)
56aebc89 525{
56aebc89
PB
526 size_t len;
527 int i;
528 const char *name;
529 static char target_xml[1024];
530
531 len = 0;
532 while (p[len] && p[len] != ':')
533 len++;
534 *newp = p + len;
535
536 name = NULL;
537 if (strncmp(p, "target.xml", len) == 0) {
538 /* Generate the XML description for this CPU. */
539 if (!target_xml[0]) {
540 GDBRegisterState *r;
eac8b355 541 CPUState *cpu = first_cpu;
56aebc89 542
5b3715bf
BS
543 snprintf(target_xml, sizeof(target_xml),
544 "<?xml version=\"1.0\"?>"
545 "<!DOCTYPE target SYSTEM \"gdb-target.dtd\">"
546 "<target>"
547 "<xi:include href=\"%s\"/>",
5b24c641 548 cc->gdb_core_xml_file);
56aebc89 549
eac8b355 550 for (r = cpu->gdb_regs; r; r = r->next) {
2dc766da
BS
551 pstrcat(target_xml, sizeof(target_xml), "<xi:include href=\"");
552 pstrcat(target_xml, sizeof(target_xml), r->xml);
553 pstrcat(target_xml, sizeof(target_xml), "\"/>");
56aebc89 554 }
2dc766da 555 pstrcat(target_xml, sizeof(target_xml), "</target>");
56aebc89
PB
556 }
557 return target_xml;
558 }
559 for (i = 0; ; i++) {
560 name = xml_builtin[i][0];
561 if (!name || (strncmp(name, p, len) == 0 && strlen(name) == len))
562 break;
563 }
564 return name ? xml_builtin[i][1] : NULL;
565}
f1ccf904 566
385b9f0e 567static int gdb_read_register(CPUState *cpu, uint8_t *mem_buf, int reg)
56aebc89 568{
a0e372f0 569 CPUClass *cc = CPU_GET_CLASS(cpu);
385b9f0e 570 CPUArchState *env = cpu->env_ptr;
56aebc89 571 GDBRegisterState *r;
f1ccf904 572
a0e372f0 573 if (reg < cc->gdb_num_core_regs) {
5b50e790 574 return cc->gdb_read_register(cpu, mem_buf, reg);
a0e372f0 575 }
f1ccf904 576
eac8b355 577 for (r = cpu->gdb_regs; r; r = r->next) {
56aebc89
PB
578 if (r->base_reg <= reg && reg < r->base_reg + r->num_regs) {
579 return r->get_reg(env, mem_buf, reg - r->base_reg);
580 }
581 }
582 return 0;
f1ccf904
TS
583}
584
385b9f0e 585static int gdb_write_register(CPUState *cpu, uint8_t *mem_buf, int reg)
f1ccf904 586{
a0e372f0 587 CPUClass *cc = CPU_GET_CLASS(cpu);
385b9f0e 588 CPUArchState *env = cpu->env_ptr;
56aebc89 589 GDBRegisterState *r;
f1ccf904 590
a0e372f0 591 if (reg < cc->gdb_num_core_regs) {
5b50e790 592 return cc->gdb_write_register(cpu, mem_buf, reg);
a0e372f0 593 }
56aebc89 594
eac8b355 595 for (r = cpu->gdb_regs; r; r = r->next) {
56aebc89
PB
596 if (r->base_reg <= reg && reg < r->base_reg + r->num_regs) {
597 return r->set_reg(env, mem_buf, reg - r->base_reg);
598 }
599 }
6da41eaf
FB
600 return 0;
601}
602
56aebc89
PB
603/* Register a supplemental set of CPU registers. If g_pos is nonzero it
604 specifies the first register number and these registers are included in
605 a standard "g" packet. Direction is relative to gdb, i.e. get_reg is
606 gdb reading a CPU register, and set_reg is gdb modifying a CPU register.
607 */
608
22169d41
AF
609void gdb_register_coprocessor(CPUState *cpu,
610 gdb_reg_cb get_reg, gdb_reg_cb set_reg,
611 int num_regs, const char *xml, int g_pos)
6da41eaf 612{
56aebc89
PB
613 GDBRegisterState *s;
614 GDBRegisterState **p;
56aebc89 615
eac8b355 616 p = &cpu->gdb_regs;
56aebc89
PB
617 while (*p) {
618 /* Check for duplicates. */
619 if (strcmp((*p)->xml, xml) == 0)
620 return;
621 p = &(*p)->next;
622 }
9643c25f
SW
623
624 s = g_new0(GDBRegisterState, 1);
a0e372f0 625 s->base_reg = cpu->gdb_num_regs;
9643c25f
SW
626 s->num_regs = num_regs;
627 s->get_reg = get_reg;
628 s->set_reg = set_reg;
629 s->xml = xml;
630
56aebc89 631 /* Add to end of list. */
a0e372f0 632 cpu->gdb_num_regs += num_regs;
56aebc89
PB
633 *p = s;
634 if (g_pos) {
635 if (g_pos != s->base_reg) {
636 fprintf(stderr, "Error: Bad gdb register numbering for '%s'\n"
637 "Expected %d got %d\n", xml, g_pos, s->base_reg);
35143f01
AF
638 } else {
639 cpu->gdb_num_g_regs = cpu->gdb_num_regs;
56aebc89
PB
640 }
641 }
6da41eaf
FB
642}
643
a1d1bb31 644#ifndef CONFIG_USER_ONLY
2472b6c0
PM
645/* Translate GDB watchpoint type to a flags value for cpu_watchpoint_* */
646static inline int xlat_gdb_type(CPUState *cpu, int gdbtype)
647{
648 static const int xlat[] = {
649 [GDB_WATCHPOINT_WRITE] = BP_GDB | BP_MEM_WRITE,
650 [GDB_WATCHPOINT_READ] = BP_GDB | BP_MEM_READ,
651 [GDB_WATCHPOINT_ACCESS] = BP_GDB | BP_MEM_ACCESS,
652 };
653
654 CPUClass *cc = CPU_GET_CLASS(cpu);
655 int cputype = xlat[gdbtype];
656
657 if (cc->gdb_stop_before_watchpoint) {
658 cputype |= BP_STOP_BEFORE_ACCESS;
659 }
660 return cputype;
661}
a1d1bb31
AL
662#endif
663
880a7578 664static int gdb_breakpoint_insert(target_ulong addr, target_ulong len, int type)
a1d1bb31 665{
182735ef 666 CPUState *cpu;
880a7578
AL
667 int err = 0;
668
62278814 669 if (kvm_enabled()) {
2e0f2cfb 670 return kvm_insert_breakpoint(gdbserver_state->c_cpu, addr, len, type);
62278814 671 }
e22a25c9 672
a1d1bb31
AL
673 switch (type) {
674 case GDB_BREAKPOINT_SW:
675 case GDB_BREAKPOINT_HW:
bdc44640 676 CPU_FOREACH(cpu) {
b3310ab3
AF
677 err = cpu_breakpoint_insert(cpu, addr, BP_GDB, NULL);
678 if (err) {
880a7578 679 break;
b3310ab3 680 }
880a7578
AL
681 }
682 return err;
a1d1bb31
AL
683#ifndef CONFIG_USER_ONLY
684 case GDB_WATCHPOINT_WRITE:
685 case GDB_WATCHPOINT_READ:
686 case GDB_WATCHPOINT_ACCESS:
bdc44640 687 CPU_FOREACH(cpu) {
2472b6c0
PM
688 err = cpu_watchpoint_insert(cpu, addr, len,
689 xlat_gdb_type(cpu, type), NULL);
690 if (err) {
880a7578 691 break;
2472b6c0 692 }
880a7578
AL
693 }
694 return err;
a1d1bb31
AL
695#endif
696 default:
697 return -ENOSYS;
698 }
699}
700
880a7578 701static int gdb_breakpoint_remove(target_ulong addr, target_ulong len, int type)
a1d1bb31 702{
182735ef 703 CPUState *cpu;
880a7578
AL
704 int err = 0;
705
62278814 706 if (kvm_enabled()) {
2e0f2cfb 707 return kvm_remove_breakpoint(gdbserver_state->c_cpu, addr, len, type);
62278814 708 }
e22a25c9 709
a1d1bb31
AL
710 switch (type) {
711 case GDB_BREAKPOINT_SW:
712 case GDB_BREAKPOINT_HW:
bdc44640 713 CPU_FOREACH(cpu) {
b3310ab3
AF
714 err = cpu_breakpoint_remove(cpu, addr, BP_GDB);
715 if (err) {
880a7578 716 break;
b3310ab3 717 }
880a7578
AL
718 }
719 return err;
a1d1bb31
AL
720#ifndef CONFIG_USER_ONLY
721 case GDB_WATCHPOINT_WRITE:
722 case GDB_WATCHPOINT_READ:
723 case GDB_WATCHPOINT_ACCESS:
bdc44640 724 CPU_FOREACH(cpu) {
2472b6c0
PM
725 err = cpu_watchpoint_remove(cpu, addr, len,
726 xlat_gdb_type(cpu, type));
880a7578
AL
727 if (err)
728 break;
729 }
730 return err;
a1d1bb31
AL
731#endif
732 default:
733 return -ENOSYS;
734 }
735}
736
880a7578 737static void gdb_breakpoint_remove_all(void)
a1d1bb31 738{
182735ef 739 CPUState *cpu;
880a7578 740
e22a25c9 741 if (kvm_enabled()) {
2e0f2cfb 742 kvm_remove_all_breakpoints(gdbserver_state->c_cpu);
e22a25c9
AL
743 return;
744 }
745
bdc44640 746 CPU_FOREACH(cpu) {
b3310ab3 747 cpu_breakpoint_remove_all(cpu, BP_GDB);
a1d1bb31 748#ifndef CONFIG_USER_ONLY
75a34036 749 cpu_watchpoint_remove_all(cpu, BP_GDB);
a1d1bb31 750#endif
880a7578 751 }
a1d1bb31
AL
752}
753
fab9d284
AJ
754static void gdb_set_cpu_pc(GDBState *s, target_ulong pc)
755{
2e0f2cfb 756 CPUState *cpu = s->c_cpu;
f45748f1
AF
757
758 cpu_synchronize_state(cpu);
4a2b24ed 759 cpu_set_pc(cpu, pc);
fab9d284
AJ
760}
761
2e0f2cfb 762static CPUState *find_cpu(uint32_t thread_id)
1e9fa730 763{
0d34282f 764 CPUState *cpu;
1e9fa730 765
bdc44640 766 CPU_FOREACH(cpu) {
aa48dd93 767 if (cpu_index(cpu) == thread_id) {
2e0f2cfb 768 return cpu;
aa48dd93 769 }
1e9fa730 770 }
aa48dd93
AF
771
772 return NULL;
1e9fa730
NF
773}
774
4dabe747
JK
775static int is_query_packet(const char *p, const char *query, char separator)
776{
777 unsigned int query_len = strlen(query);
778
779 return strncmp(p, query, query_len) == 0 &&
780 (p[query_len] == '\0' || p[query_len] == separator);
781}
782
880a7578 783static int gdb_handle_packet(GDBState *s, const char *line_buf)
b4608c04 784{
2e0f2cfb 785 CPUState *cpu;
5b24c641 786 CPUClass *cc;
b4608c04 787 const char *p;
1e9fa730
NF
788 uint32_t thread;
789 int ch, reg_size, type, res;
56aebc89
PB
790 char buf[MAX_PACKET_LENGTH];
791 uint8_t mem_buf[MAX_PACKET_LENGTH];
792 uint8_t *registers;
9d9754a3 793 target_ulong addr, len;
3b46e624 794
858693c6
FB
795#ifdef DEBUG_GDB
796 printf("command='%s'\n", line_buf);
797#endif
798 p = line_buf;
799 ch = *p++;
800 switch(ch) {
801 case '?':
1fddef4b 802 /* TODO: Make this return the correct value for user-mode. */
ca587a8e 803 snprintf(buf, sizeof(buf), "T%02xthread:%02x;", GDB_SIGNAL_TRAP,
2e0f2cfb 804 cpu_index(s->c_cpu));
858693c6 805 put_packet(s, buf);
7d03f82f
EI
806 /* Remove all the breakpoints when this query is issued,
807 * because gdb is doing and initial connect and the state
808 * should be cleaned up.
809 */
880a7578 810 gdb_breakpoint_remove_all();
858693c6
FB
811 break;
812 case 'c':
813 if (*p != '\0') {
9d9754a3 814 addr = strtoull(p, (char **)&p, 16);
fab9d284 815 gdb_set_cpu_pc(s, addr);
858693c6 816 }
ca587a8e 817 s->signal = 0;
ba70a624 818 gdb_continue(s);
41625033 819 return RS_IDLE;
1f487ee9 820 case 'C':
ca587a8e
AJ
821 s->signal = gdb_signal_to_target (strtoul(p, (char **)&p, 16));
822 if (s->signal == -1)
823 s->signal = 0;
1f487ee9
EI
824 gdb_continue(s);
825 return RS_IDLE;
dd32aa10
JK
826 case 'v':
827 if (strncmp(p, "Cont", 4) == 0) {
828 int res_signal, res_thread;
829
830 p += 4;
831 if (*p == '?') {
832 put_packet(s, "vCont;c;C;s;S");
833 break;
834 }
835 res = 0;
836 res_signal = 0;
837 res_thread = 0;
838 while (*p) {
839 int action, signal;
840
841 if (*p++ != ';') {
842 res = 0;
843 break;
844 }
845 action = *p++;
846 signal = 0;
847 if (action == 'C' || action == 'S') {
f17b0690
MS
848 signal = gdb_signal_to_target(strtoul(p, (char **)&p, 16));
849 if (signal == -1) {
850 signal = 0;
851 }
dd32aa10
JK
852 } else if (action != 'c' && action != 's') {
853 res = 0;
854 break;
855 }
856 thread = 0;
857 if (*p == ':') {
858 thread = strtoull(p+1, (char **)&p, 16);
859 }
860 action = tolower(action);
861 if (res == 0 || (res == 'c' && action == 's')) {
862 res = action;
863 res_signal = signal;
864 res_thread = thread;
865 }
866 }
867 if (res) {
868 if (res_thread != -1 && res_thread != 0) {
2e0f2cfb
AF
869 cpu = find_cpu(res_thread);
870 if (cpu == NULL) {
dd32aa10
JK
871 put_packet(s, "E22");
872 break;
873 }
2e0f2cfb 874 s->c_cpu = cpu;
dd32aa10
JK
875 }
876 if (res == 's') {
2e0f2cfb 877 cpu_single_step(s->c_cpu, sstep_flags);
dd32aa10
JK
878 }
879 s->signal = res_signal;
880 gdb_continue(s);
881 return RS_IDLE;
882 }
883 break;
884 } else {
885 goto unknown_command;
886 }
7d03f82f
EI
887 case 'k':
888 /* Kill the target */
889 fprintf(stderr, "\nQEMU: Terminated via GDBstub\n");
890 exit(0);
891 case 'D':
892 /* Detach packet */
880a7578 893 gdb_breakpoint_remove_all();
7ea06da3 894 gdb_syscall_mode = GDB_SYS_DISABLED;
7d03f82f
EI
895 gdb_continue(s);
896 put_packet(s, "OK");
897 break;
858693c6
FB
898 case 's':
899 if (*p != '\0') {
8fac5803 900 addr = strtoull(p, (char **)&p, 16);
fab9d284 901 gdb_set_cpu_pc(s, addr);
858693c6 902 }
2e0f2cfb 903 cpu_single_step(s->c_cpu, sstep_flags);
ba70a624 904 gdb_continue(s);
41625033 905 return RS_IDLE;
a2d1ebaf
PB
906 case 'F':
907 {
908 target_ulong ret;
909 target_ulong err;
910
911 ret = strtoull(p, (char **)&p, 16);
912 if (*p == ',') {
913 p++;
914 err = strtoull(p, (char **)&p, 16);
915 } else {
916 err = 0;
917 }
918 if (*p == ',')
919 p++;
920 type = *p;
cdb432b2 921 if (s->current_syscall_cb) {
2e0f2cfb 922 s->current_syscall_cb(s->c_cpu, ret, err);
cdb432b2
MI
923 s->current_syscall_cb = NULL;
924 }
a2d1ebaf
PB
925 if (type == 'C') {
926 put_packet(s, "T02");
927 } else {
ba70a624 928 gdb_continue(s);
a2d1ebaf
PB
929 }
930 }
931 break;
858693c6 932 case 'g':
2e0f2cfb 933 cpu_synchronize_state(s->g_cpu);
56aebc89 934 len = 0;
35143f01 935 for (addr = 0; addr < s->g_cpu->gdb_num_g_regs; addr++) {
2e0f2cfb 936 reg_size = gdb_read_register(s->g_cpu, mem_buf + len, addr);
56aebc89
PB
937 len += reg_size;
938 }
939 memtohex(buf, mem_buf, len);
858693c6
FB
940 put_packet(s, buf);
941 break;
942 case 'G':
2e0f2cfb 943 cpu_synchronize_state(s->g_cpu);
56aebc89 944 registers = mem_buf;
858693c6
FB
945 len = strlen(p) / 2;
946 hextomem((uint8_t *)registers, p, len);
35143f01 947 for (addr = 0; addr < s->g_cpu->gdb_num_g_regs && len > 0; addr++) {
2e0f2cfb 948 reg_size = gdb_write_register(s->g_cpu, registers, addr);
56aebc89
PB
949 len -= reg_size;
950 registers += reg_size;
951 }
858693c6
FB
952 put_packet(s, "OK");
953 break;
954 case 'm':
9d9754a3 955 addr = strtoull(p, (char **)&p, 16);
858693c6
FB
956 if (*p == ',')
957 p++;
9d9754a3 958 len = strtoull(p, NULL, 16);
2e0f2cfb 959 if (target_memory_rw_debug(s->g_cpu, addr, mem_buf, len, false) != 0) {
6f970bd9
FB
960 put_packet (s, "E14");
961 } else {
962 memtohex(buf, mem_buf, len);
963 put_packet(s, buf);
964 }
858693c6
FB
965 break;
966 case 'M':
9d9754a3 967 addr = strtoull(p, (char **)&p, 16);
858693c6
FB
968 if (*p == ',')
969 p++;
9d9754a3 970 len = strtoull(p, (char **)&p, 16);
b328f873 971 if (*p == ':')
858693c6
FB
972 p++;
973 hextomem(mem_buf, p, len);
2e0f2cfb 974 if (target_memory_rw_debug(s->g_cpu, addr, mem_buf, len,
f3659eee 975 true) != 0) {
905f20b1 976 put_packet(s, "E14");
44520db1 977 } else {
858693c6 978 put_packet(s, "OK");
44520db1 979 }
858693c6 980 break;
56aebc89
PB
981 case 'p':
982 /* Older gdb are really dumb, and don't use 'g' if 'p' is avaialable.
983 This works, but can be very slow. Anything new enough to
984 understand XML also knows how to use this properly. */
985 if (!gdb_has_xml)
986 goto unknown_command;
987 addr = strtoull(p, (char **)&p, 16);
2e0f2cfb 988 reg_size = gdb_read_register(s->g_cpu, mem_buf, addr);
56aebc89
PB
989 if (reg_size) {
990 memtohex(buf, mem_buf, reg_size);
991 put_packet(s, buf);
992 } else {
993 put_packet(s, "E14");
994 }
995 break;
996 case 'P':
997 if (!gdb_has_xml)
998 goto unknown_command;
999 addr = strtoull(p, (char **)&p, 16);
1000 if (*p == '=')
1001 p++;
1002 reg_size = strlen(p) / 2;
1003 hextomem(mem_buf, p, reg_size);
2e0f2cfb 1004 gdb_write_register(s->g_cpu, mem_buf, addr);
56aebc89
PB
1005 put_packet(s, "OK");
1006 break;
858693c6 1007 case 'Z':
858693c6
FB
1008 case 'z':
1009 type = strtoul(p, (char **)&p, 16);
1010 if (*p == ',')
1011 p++;
9d9754a3 1012 addr = strtoull(p, (char **)&p, 16);
858693c6
FB
1013 if (*p == ',')
1014 p++;
9d9754a3 1015 len = strtoull(p, (char **)&p, 16);
a1d1bb31 1016 if (ch == 'Z')
880a7578 1017 res = gdb_breakpoint_insert(addr, len, type);
a1d1bb31 1018 else
880a7578 1019 res = gdb_breakpoint_remove(addr, len, type);
a1d1bb31
AL
1020 if (res >= 0)
1021 put_packet(s, "OK");
1022 else if (res == -ENOSYS)
0f459d16 1023 put_packet(s, "");
a1d1bb31
AL
1024 else
1025 put_packet(s, "E22");
858693c6 1026 break;
880a7578
AL
1027 case 'H':
1028 type = *p++;
1029 thread = strtoull(p, (char **)&p, 16);
1030 if (thread == -1 || thread == 0) {
1031 put_packet(s, "OK");
1032 break;
1033 }
2e0f2cfb
AF
1034 cpu = find_cpu(thread);
1035 if (cpu == NULL) {
880a7578
AL
1036 put_packet(s, "E22");
1037 break;
1038 }
1039 switch (type) {
1040 case 'c':
2e0f2cfb 1041 s->c_cpu = cpu;
880a7578
AL
1042 put_packet(s, "OK");
1043 break;
1044 case 'g':
2e0f2cfb 1045 s->g_cpu = cpu;
880a7578
AL
1046 put_packet(s, "OK");
1047 break;
1048 default:
1049 put_packet(s, "E22");
1050 break;
1051 }
1052 break;
1053 case 'T':
1054 thread = strtoull(p, (char **)&p, 16);
2e0f2cfb 1055 cpu = find_cpu(thread);
1e9fa730 1056
2e0f2cfb 1057 if (cpu != NULL) {
1e9fa730
NF
1058 put_packet(s, "OK");
1059 } else {
880a7578 1060 put_packet(s, "E22");
1e9fa730 1061 }
880a7578 1062 break;
978efd6a 1063 case 'q':
60897d36
EI
1064 case 'Q':
1065 /* parse any 'q' packets here */
1066 if (!strcmp(p,"qemu.sstepbits")) {
1067 /* Query Breakpoint bit definitions */
363a37d5
BS
1068 snprintf(buf, sizeof(buf), "ENABLE=%x,NOIRQ=%x,NOTIMER=%x",
1069 SSTEP_ENABLE,
1070 SSTEP_NOIRQ,
1071 SSTEP_NOTIMER);
60897d36
EI
1072 put_packet(s, buf);
1073 break;
4dabe747 1074 } else if (is_query_packet(p, "qemu.sstep", '=')) {
60897d36
EI
1075 /* Display or change the sstep_flags */
1076 p += 10;
1077 if (*p != '=') {
1078 /* Display current setting */
363a37d5 1079 snprintf(buf, sizeof(buf), "0x%x", sstep_flags);
60897d36
EI
1080 put_packet(s, buf);
1081 break;
1082 }
1083 p++;
1084 type = strtoul(p, (char **)&p, 16);
1085 sstep_flags = type;
1086 put_packet(s, "OK");
1087 break;
880a7578
AL
1088 } else if (strcmp(p,"C") == 0) {
1089 /* "Current thread" remains vague in the spec, so always return
1090 * the first CPU (gdb returns the first thread). */
1091 put_packet(s, "QC1");
1092 break;
1093 } else if (strcmp(p,"fThreadInfo") == 0) {
52f34623 1094 s->query_cpu = first_cpu;
880a7578
AL
1095 goto report_cpuinfo;
1096 } else if (strcmp(p,"sThreadInfo") == 0) {
1097 report_cpuinfo:
1098 if (s->query_cpu) {
52f34623 1099 snprintf(buf, sizeof(buf), "m%x", cpu_index(s->query_cpu));
880a7578 1100 put_packet(s, buf);
bdc44640 1101 s->query_cpu = CPU_NEXT(s->query_cpu);
880a7578
AL
1102 } else
1103 put_packet(s, "l");
1104 break;
1105 } else if (strncmp(p,"ThreadExtraInfo,", 16) == 0) {
1106 thread = strtoull(p+16, (char **)&p, 16);
2e0f2cfb
AF
1107 cpu = find_cpu(thread);
1108 if (cpu != NULL) {
cb446eca 1109 cpu_synchronize_state(cpu);
1e9fa730 1110 len = snprintf((char *)mem_buf, sizeof(mem_buf),
55e5c285 1111 "CPU#%d [%s]", cpu->cpu_index,
259186a7 1112 cpu->halted ? "halted " : "running");
1e9fa730
NF
1113 memtohex(buf, mem_buf, len);
1114 put_packet(s, buf);
1115 }
880a7578 1116 break;
60897d36 1117 }
0b8a988c 1118#ifdef CONFIG_USER_ONLY
070949f3 1119 else if (strcmp(p, "Offsets") == 0) {
0429a971 1120 TaskState *ts = s->c_cpu->opaque;
978efd6a 1121
363a37d5
BS
1122 snprintf(buf, sizeof(buf),
1123 "Text=" TARGET_ABI_FMT_lx ";Data=" TARGET_ABI_FMT_lx
1124 ";Bss=" TARGET_ABI_FMT_lx,
1125 ts->info->code_offset,
1126 ts->info->data_offset,
1127 ts->info->data_offset);
978efd6a
PB
1128 put_packet(s, buf);
1129 break;
1130 }
0b8a988c 1131#else /* !CONFIG_USER_ONLY */
8a34a0fb
AL
1132 else if (strncmp(p, "Rcmd,", 5) == 0) {
1133 int len = strlen(p + 5);
1134
1135 if ((len % 2) != 0) {
1136 put_packet(s, "E01");
1137 break;
1138 }
1139 hextomem(mem_buf, p + 5, len);
1140 len = len / 2;
1141 mem_buf[len++] = 0;
fa5efccb 1142 qemu_chr_be_write(s->mon_chr, mem_buf, len);
8a34a0fb
AL
1143 put_packet(s, "OK");
1144 break;
1145 }
0b8a988c 1146#endif /* !CONFIG_USER_ONLY */
4dabe747 1147 if (is_query_packet(p, "Supported", ':')) {
5b3715bf 1148 snprintf(buf, sizeof(buf), "PacketSize=%x", MAX_PACKET_LENGTH);
5b24c641
AF
1149 cc = CPU_GET_CLASS(first_cpu);
1150 if (cc->gdb_core_xml_file != NULL) {
1151 pstrcat(buf, sizeof(buf), ";qXfer:features:read+");
1152 }
56aebc89
PB
1153 put_packet(s, buf);
1154 break;
1155 }
56aebc89
PB
1156 if (strncmp(p, "Xfer:features:read:", 19) == 0) {
1157 const char *xml;
1158 target_ulong total_len;
1159
5b24c641
AF
1160 cc = CPU_GET_CLASS(first_cpu);
1161 if (cc->gdb_core_xml_file == NULL) {
1162 goto unknown_command;
1163 }
1164
5b50e790 1165 gdb_has_xml = true;
56aebc89 1166 p += 19;
5b24c641 1167 xml = get_feature_xml(p, &p, cc);
56aebc89 1168 if (!xml) {
5b3715bf 1169 snprintf(buf, sizeof(buf), "E00");
56aebc89
PB
1170 put_packet(s, buf);
1171 break;
1172 }
1173
1174 if (*p == ':')
1175 p++;
1176 addr = strtoul(p, (char **)&p, 16);
1177 if (*p == ',')
1178 p++;
1179 len = strtoul(p, (char **)&p, 16);
1180
1181 total_len = strlen(xml);
1182 if (addr > total_len) {
5b3715bf 1183 snprintf(buf, sizeof(buf), "E00");
56aebc89
PB
1184 put_packet(s, buf);
1185 break;
1186 }
1187 if (len > (MAX_PACKET_LENGTH - 5) / 2)
1188 len = (MAX_PACKET_LENGTH - 5) / 2;
1189 if (len < total_len - addr) {
1190 buf[0] = 'm';
1191 len = memtox(buf + 1, xml + addr, len);
1192 } else {
1193 buf[0] = 'l';
1194 len = memtox(buf + 1, xml + addr, total_len - addr);
1195 }
1196 put_packet_binary(s, buf, len + 1);
1197 break;
1198 }
a3919386
JK
1199 if (is_query_packet(p, "Attached", ':')) {
1200 put_packet(s, GDB_ATTACHED);
1201 break;
1202 }
56aebc89
PB
1203 /* Unrecognised 'q' command. */
1204 goto unknown_command;
1205
858693c6 1206 default:
56aebc89 1207 unknown_command:
858693c6
FB
1208 /* put empty packet */
1209 buf[0] = '\0';
1210 put_packet(s, buf);
1211 break;
1212 }
1213 return RS_IDLE;
1214}
1215
64f6b346 1216void gdb_set_stop_cpu(CPUState *cpu)
880a7578 1217{
2e0f2cfb
AF
1218 gdbserver_state->c_cpu = cpu;
1219 gdbserver_state->g_cpu = cpu;
880a7578
AL
1220}
1221
1fddef4b 1222#ifndef CONFIG_USER_ONLY
1dfb4dd9 1223static void gdb_vm_state_change(void *opaque, int running, RunState state)
858693c6 1224{
880a7578 1225 GDBState *s = gdbserver_state;
2e0f2cfb 1226 CPUState *cpu = s->c_cpu;
858693c6 1227 char buf[256];
d6fc1b39 1228 const char *type;
858693c6
FB
1229 int ret;
1230
cdb432b2
MI
1231 if (running || s->state == RS_INACTIVE) {
1232 return;
1233 }
1234 /* Is there a GDB syscall waiting to be sent? */
1235 if (s->current_syscall_cb) {
1236 put_packet(s, s->syscall_buf);
a2d1ebaf 1237 return;
e07bbac5 1238 }
1dfb4dd9 1239 switch (state) {
0461d5a6 1240 case RUN_STATE_DEBUG:
ff4700b0
AF
1241 if (cpu->watchpoint_hit) {
1242 switch (cpu->watchpoint_hit->flags & BP_MEM_ACCESS) {
a1d1bb31 1243 case BP_MEM_READ:
d6fc1b39
AL
1244 type = "r";
1245 break;
a1d1bb31 1246 case BP_MEM_ACCESS:
d6fc1b39
AL
1247 type = "a";
1248 break;
1249 default:
1250 type = "";
1251 break;
1252 }
880a7578
AL
1253 snprintf(buf, sizeof(buf),
1254 "T%02xthread:%02x;%swatch:" TARGET_FMT_lx ";",
0d34282f 1255 GDB_SIGNAL_TRAP, cpu_index(cpu), type,
ff4700b0
AF
1256 (target_ulong)cpu->watchpoint_hit->vaddr);
1257 cpu->watchpoint_hit = NULL;
425189a8 1258 goto send_packet;
6658ffb8 1259 }
bbd77c18 1260 tb_flush(cpu);
ca587a8e 1261 ret = GDB_SIGNAL_TRAP;
425189a8 1262 break;
0461d5a6 1263 case RUN_STATE_PAUSED:
9781e040 1264 ret = GDB_SIGNAL_INT;
425189a8 1265 break;
0461d5a6 1266 case RUN_STATE_SHUTDOWN:
425189a8
JK
1267 ret = GDB_SIGNAL_QUIT;
1268 break;
0461d5a6 1269 case RUN_STATE_IO_ERROR:
425189a8
JK
1270 ret = GDB_SIGNAL_IO;
1271 break;
0461d5a6 1272 case RUN_STATE_WATCHDOG:
425189a8
JK
1273 ret = GDB_SIGNAL_ALRM;
1274 break;
0461d5a6 1275 case RUN_STATE_INTERNAL_ERROR:
425189a8
JK
1276 ret = GDB_SIGNAL_ABRT;
1277 break;
0461d5a6
LC
1278 case RUN_STATE_SAVE_VM:
1279 case RUN_STATE_RESTORE_VM:
425189a8 1280 return;
0461d5a6 1281 case RUN_STATE_FINISH_MIGRATE:
425189a8
JK
1282 ret = GDB_SIGNAL_XCPU;
1283 break;
1284 default:
1285 ret = GDB_SIGNAL_UNKNOWN;
1286 break;
bbeb7b5c 1287 }
226d007d 1288 gdb_set_stop_cpu(cpu);
0d34282f 1289 snprintf(buf, sizeof(buf), "T%02xthread:%02x;", ret, cpu_index(cpu));
425189a8
JK
1290
1291send_packet:
858693c6 1292 put_packet(s, buf);
425189a8
JK
1293
1294 /* disable single step if it was enabled */
3825b28f 1295 cpu_single_step(cpu, 0);
858693c6 1296}
1fddef4b 1297#endif
858693c6 1298
a2d1ebaf
PB
1299/* Send a gdb syscall request.
1300 This accepts limited printf-style format specifiers, specifically:
a87295e8
PB
1301 %x - target_ulong argument printed in hex.
1302 %lx - 64-bit argument printed in hex.
1303 %s - string pointer (target_ulong) and length (int) pair. */
7ccfb2eb 1304void gdb_do_syscall(gdb_syscall_complete_cb cb, const char *fmt, ...)
a2d1ebaf
PB
1305{
1306 va_list va;
a2d1ebaf 1307 char *p;
cdb432b2 1308 char *p_end;
a2d1ebaf 1309 target_ulong addr;
a87295e8 1310 uint64_t i64;
a2d1ebaf
PB
1311 GDBState *s;
1312
880a7578 1313 s = gdbserver_state;
a2d1ebaf
PB
1314 if (!s)
1315 return;
cdb432b2 1316 s->current_syscall_cb = cb;
a2d1ebaf 1317#ifndef CONFIG_USER_ONLY
0461d5a6 1318 vm_stop(RUN_STATE_DEBUG);
a2d1ebaf 1319#endif
a2d1ebaf 1320 va_start(va, fmt);
cdb432b2
MI
1321 p = s->syscall_buf;
1322 p_end = &s->syscall_buf[sizeof(s->syscall_buf)];
a2d1ebaf
PB
1323 *(p++) = 'F';
1324 while (*fmt) {
1325 if (*fmt == '%') {
1326 fmt++;
1327 switch (*fmt++) {
1328 case 'x':
1329 addr = va_arg(va, target_ulong);
cdb432b2 1330 p += snprintf(p, p_end - p, TARGET_FMT_lx, addr);
a2d1ebaf 1331 break;
a87295e8
PB
1332 case 'l':
1333 if (*(fmt++) != 'x')
1334 goto bad_format;
1335 i64 = va_arg(va, uint64_t);
cdb432b2 1336 p += snprintf(p, p_end - p, "%" PRIx64, i64);
a87295e8 1337 break;
a2d1ebaf
PB
1338 case 's':
1339 addr = va_arg(va, target_ulong);
cdb432b2 1340 p += snprintf(p, p_end - p, TARGET_FMT_lx "/%x",
363a37d5 1341 addr, va_arg(va, int));
a2d1ebaf
PB
1342 break;
1343 default:
a87295e8 1344 bad_format:
a2d1ebaf
PB
1345 fprintf(stderr, "gdbstub: Bad syscall format string '%s'\n",
1346 fmt - 1);
1347 break;
1348 }
1349 } else {
1350 *(p++) = *(fmt++);
1351 }
1352 }
8a93e02a 1353 *p = 0;
a2d1ebaf 1354 va_end(va);
a2d1ebaf 1355#ifdef CONFIG_USER_ONLY
cdb432b2 1356 put_packet(s, s->syscall_buf);
2e0f2cfb 1357 gdb_handlesig(s->c_cpu, 0);
a2d1ebaf 1358#else
cdb432b2
MI
1359 /* In this case wait to send the syscall packet until notification that
1360 the CPU has stopped. This must be done because if the packet is sent
1361 now the reply from the syscall request could be received while the CPU
1362 is still in the running state, which can cause packets to be dropped
1363 and state transition 'T' packets to be sent while the syscall is still
1364 being processed. */
2e0f2cfb 1365 cpu_exit(s->c_cpu);
a2d1ebaf
PB
1366#endif
1367}
1368
6a00d601 1369static void gdb_read_byte(GDBState *s, int ch)
858693c6
FB
1370{
1371 int i, csum;
60fe76f3 1372 uint8_t reply;
858693c6 1373
1fddef4b 1374#ifndef CONFIG_USER_ONLY
4046d913
PB
1375 if (s->last_packet_len) {
1376 /* Waiting for a response to the last packet. If we see the start
1377 of a new command then abandon the previous response. */
1378 if (ch == '-') {
1379#ifdef DEBUG_GDB
1380 printf("Got NACK, retransmitting\n");
1381#endif
ffe8ab83 1382 put_buffer(s, (uint8_t *)s->last_packet, s->last_packet_len);
4046d913
PB
1383 }
1384#ifdef DEBUG_GDB
1385 else if (ch == '+')
1386 printf("Got ACK\n");
1387 else
1388 printf("Got '%c' when expecting ACK/NACK\n", ch);
1389#endif
1390 if (ch == '+' || ch == '$')
1391 s->last_packet_len = 0;
1392 if (ch != '$')
1393 return;
1394 }
1354869c 1395 if (runstate_is_running()) {
858693c6
FB
1396 /* when the CPU is running, we cannot do anything except stop
1397 it when receiving a char */
0461d5a6 1398 vm_stop(RUN_STATE_PAUSED);
5fafdf24 1399 } else
1fddef4b 1400#endif
41625033 1401 {
858693c6
FB
1402 switch(s->state) {
1403 case RS_IDLE:
1404 if (ch == '$') {
1405 s->line_buf_index = 0;
1406 s->state = RS_GETLINE;
c33a346e 1407 }
b4608c04 1408 break;
858693c6
FB
1409 case RS_GETLINE:
1410 if (ch == '#') {
1411 s->state = RS_CHKSUM1;
1412 } else if (s->line_buf_index >= sizeof(s->line_buf) - 1) {
1413 s->state = RS_IDLE;
4c3a88a2 1414 } else {
858693c6 1415 s->line_buf[s->line_buf_index++] = ch;
4c3a88a2
FB
1416 }
1417 break;
858693c6
FB
1418 case RS_CHKSUM1:
1419 s->line_buf[s->line_buf_index] = '\0';
1420 s->line_csum = fromhex(ch) << 4;
1421 s->state = RS_CHKSUM2;
1422 break;
1423 case RS_CHKSUM2:
1424 s->line_csum |= fromhex(ch);
1425 csum = 0;
1426 for(i = 0; i < s->line_buf_index; i++) {
1427 csum += s->line_buf[i];
1428 }
1429 if (s->line_csum != (csum & 0xff)) {
60fe76f3
TS
1430 reply = '-';
1431 put_buffer(s, &reply, 1);
858693c6 1432 s->state = RS_IDLE;
4c3a88a2 1433 } else {
60fe76f3
TS
1434 reply = '+';
1435 put_buffer(s, &reply, 1);
880a7578 1436 s->state = gdb_handle_packet(s, s->line_buf);
4c3a88a2
FB
1437 }
1438 break;
a2d1ebaf
PB
1439 default:
1440 abort();
858693c6
FB
1441 }
1442 }
1443}
1444
0e1c9c54 1445/* Tell the remote gdb that the process has exited. */
9349b4f9 1446void gdb_exit(CPUArchState *env, int code)
0e1c9c54
PB
1447{
1448 GDBState *s;
1449 char buf[4];
1450
1451 s = gdbserver_state;
1452 if (!s) {
1453 return;
1454 }
1455#ifdef CONFIG_USER_ONLY
1456 if (gdbserver_fd < 0 || s->fd < 0) {
1457 return;
1458 }
3d0f4418
PB
1459#else
1460 if (!s->chr) {
1461 return;
1462 }
0e1c9c54
PB
1463#endif
1464
1465 snprintf(buf, sizeof(buf), "W%02x", (uint8_t)code);
1466 put_packet(s, buf);
e2af15b2
FC
1467
1468#ifndef CONFIG_USER_ONLY
3d0f4418 1469 qemu_chr_delete(s->chr);
e2af15b2 1470#endif
0e1c9c54
PB
1471}
1472
1fddef4b 1473#ifdef CONFIG_USER_ONLY
ca587a8e
AJ
1474int
1475gdb_queuesig (void)
1476{
1477 GDBState *s;
1478
1479 s = gdbserver_state;
1480
1481 if (gdbserver_fd < 0 || s->fd < 0)
1482 return 0;
1483 else
1484 return 1;
1485}
1486
1fddef4b 1487int
db6b81d4 1488gdb_handlesig(CPUState *cpu, int sig)
1fddef4b 1489{
5ca666c7
AF
1490 GDBState *s;
1491 char buf[256];
1492 int n;
1fddef4b 1493
5ca666c7
AF
1494 s = gdbserver_state;
1495 if (gdbserver_fd < 0 || s->fd < 0) {
1496 return sig;
1497 }
1fddef4b 1498
5ca666c7 1499 /* disable single step if it was enabled */
3825b28f 1500 cpu_single_step(cpu, 0);
bbd77c18 1501 tb_flush(cpu);
1fddef4b 1502
5ca666c7
AF
1503 if (sig != 0) {
1504 snprintf(buf, sizeof(buf), "S%02x", target_signal_to_gdb(sig));
1505 put_packet(s, buf);
1506 }
1507 /* put_packet() might have detected that the peer terminated the
1508 connection. */
1509 if (s->fd < 0) {
1510 return sig;
1511 }
1fddef4b 1512
5ca666c7
AF
1513 sig = 0;
1514 s->state = RS_IDLE;
1515 s->running_state = 0;
1516 while (s->running_state == 0) {
1517 n = read(s->fd, buf, 256);
1518 if (n > 0) {
1519 int i;
1520
1521 for (i = 0; i < n; i++) {
1522 gdb_read_byte(s, buf[i]);
1523 }
1524 } else if (n == 0 || errno != EAGAIN) {
1525 /* XXX: Connection closed. Should probably wait for another
1526 connection before continuing. */
1527 return sig;
1fddef4b 1528 }
5ca666c7
AF
1529 }
1530 sig = s->signal;
1531 s->signal = 0;
1532 return sig;
1fddef4b 1533}
e9009676 1534
ca587a8e 1535/* Tell the remote gdb that the process has exited due to SIG. */
9349b4f9 1536void gdb_signalled(CPUArchState *env, int sig)
ca587a8e 1537{
5ca666c7
AF
1538 GDBState *s;
1539 char buf[4];
ca587a8e 1540
5ca666c7
AF
1541 s = gdbserver_state;
1542 if (gdbserver_fd < 0 || s->fd < 0) {
1543 return;
1544 }
ca587a8e 1545
5ca666c7
AF
1546 snprintf(buf, sizeof(buf), "X%02x", target_signal_to_gdb(sig));
1547 put_packet(s, buf);
ca587a8e 1548}
1fddef4b 1549
880a7578 1550static void gdb_accept(void)
858693c6
FB
1551{
1552 GDBState *s;
1553 struct sockaddr_in sockaddr;
1554 socklen_t len;
bf1c852a 1555 int fd;
858693c6
FB
1556
1557 for(;;) {
1558 len = sizeof(sockaddr);
1559 fd = accept(gdbserver_fd, (struct sockaddr *)&sockaddr, &len);
1560 if (fd < 0 && errno != EINTR) {
1561 perror("accept");
1562 return;
1563 } else if (fd >= 0) {
40ff6d7e
KW
1564#ifndef _WIN32
1565 fcntl(fd, F_SETFD, FD_CLOEXEC);
1566#endif
b4608c04
FB
1567 break;
1568 }
1569 }
858693c6
FB
1570
1571 /* set short latency */
bf1c852a 1572 socket_set_nodelay(fd);
3b46e624 1573
7267c094 1574 s = g_malloc0(sizeof(GDBState));
2e0f2cfb
AF
1575 s->c_cpu = first_cpu;
1576 s->g_cpu = first_cpu;
858693c6 1577 s->fd = fd;
5b50e790 1578 gdb_has_xml = false;
858693c6 1579
880a7578 1580 gdbserver_state = s;
a2d1ebaf 1581
858693c6 1582 fcntl(fd, F_SETFL, O_NONBLOCK);
858693c6
FB
1583}
1584
1585static int gdbserver_open(int port)
1586{
1587 struct sockaddr_in sockaddr;
6669ca13 1588 int fd, ret;
858693c6
FB
1589
1590 fd = socket(PF_INET, SOCK_STREAM, 0);
1591 if (fd < 0) {
1592 perror("socket");
1593 return -1;
1594 }
40ff6d7e
KW
1595#ifndef _WIN32
1596 fcntl(fd, F_SETFD, FD_CLOEXEC);
1597#endif
858693c6 1598
6669ca13 1599 socket_set_fast_reuse(fd);
858693c6
FB
1600
1601 sockaddr.sin_family = AF_INET;
1602 sockaddr.sin_port = htons(port);
1603 sockaddr.sin_addr.s_addr = 0;
1604 ret = bind(fd, (struct sockaddr *)&sockaddr, sizeof(sockaddr));
1605 if (ret < 0) {
1606 perror("bind");
bb16172c 1607 close(fd);
858693c6
FB
1608 return -1;
1609 }
1610 ret = listen(fd, 0);
1611 if (ret < 0) {
1612 perror("listen");
bb16172c 1613 close(fd);
858693c6
FB
1614 return -1;
1615 }
858693c6
FB
1616 return fd;
1617}
1618
1619int gdbserver_start(int port)
1620{
1621 gdbserver_fd = gdbserver_open(port);
1622 if (gdbserver_fd < 0)
1623 return -1;
1624 /* accept connections */
880a7578 1625 gdb_accept();
4046d913
PB
1626 return 0;
1627}
2b1319c8
AJ
1628
1629/* Disable gdb stub for child processes. */
f7ec7f7b 1630void gdbserver_fork(CPUState *cpu)
2b1319c8
AJ
1631{
1632 GDBState *s = gdbserver_state;
75a34036
AF
1633
1634 if (gdbserver_fd < 0 || s->fd < 0) {
1635 return;
1636 }
2b1319c8
AJ
1637 close(s->fd);
1638 s->fd = -1;
b3310ab3 1639 cpu_breakpoint_remove_all(cpu, BP_GDB);
75a34036 1640 cpu_watchpoint_remove_all(cpu, BP_GDB);
2b1319c8 1641}
1fddef4b 1642#else
aa1f17c1 1643static int gdb_chr_can_receive(void *opaque)
4046d913 1644{
56aebc89
PB
1645 /* We can handle an arbitrarily large amount of data.
1646 Pick the maximum packet size, which is as good as anything. */
1647 return MAX_PACKET_LENGTH;
4046d913
PB
1648}
1649
aa1f17c1 1650static void gdb_chr_receive(void *opaque, const uint8_t *buf, int size)
4046d913 1651{
4046d913
PB
1652 int i;
1653
1654 for (i = 0; i < size; i++) {
880a7578 1655 gdb_read_byte(gdbserver_state, buf[i]);
4046d913
PB
1656 }
1657}
1658
1659static void gdb_chr_event(void *opaque, int event)
1660{
1661 switch (event) {
b6b8df56 1662 case CHR_EVENT_OPENED:
0461d5a6 1663 vm_stop(RUN_STATE_PAUSED);
5b50e790 1664 gdb_has_xml = false;
4046d913
PB
1665 break;
1666 default:
1667 break;
1668 }
1669}
1670
8a34a0fb
AL
1671static void gdb_monitor_output(GDBState *s, const char *msg, int len)
1672{
1673 char buf[MAX_PACKET_LENGTH];
1674
1675 buf[0] = 'O';
1676 if (len > (MAX_PACKET_LENGTH/2) - 1)
1677 len = (MAX_PACKET_LENGTH/2) - 1;
1678 memtohex(buf + 1, (uint8_t *)msg, len);
1679 put_packet(s, buf);
1680}
1681
1682static int gdb_monitor_write(CharDriverState *chr, const uint8_t *buf, int len)
1683{
1684 const char *p = (const char *)buf;
1685 int max_sz;
1686
1687 max_sz = (sizeof(gdbserver_state->last_packet) - 2) / 2;
1688 for (;;) {
1689 if (len <= max_sz) {
1690 gdb_monitor_output(gdbserver_state, p, len);
1691 break;
1692 }
1693 gdb_monitor_output(gdbserver_state, p, max_sz);
1694 p += max_sz;
1695 len -= max_sz;
1696 }
1697 return len;
1698}
1699
59030a8c
AL
1700#ifndef _WIN32
1701static void gdb_sigterm_handler(int signal)
1702{
1354869c 1703 if (runstate_is_running()) {
0461d5a6 1704 vm_stop(RUN_STATE_PAUSED);
e07bbac5 1705 }
59030a8c
AL
1706}
1707#endif
1708
1709int gdbserver_start(const char *device)
4046d913
PB
1710{
1711 GDBState *s;
59030a8c 1712 char gdbstub_device_name[128];
36556b20
AL
1713 CharDriverState *chr = NULL;
1714 CharDriverState *mon_chr;
cfc3475a 1715
59030a8c
AL
1716 if (!device)
1717 return -1;
1718 if (strcmp(device, "none") != 0) {
1719 if (strstart(device, "tcp:", NULL)) {
1720 /* enforce required TCP attributes */
1721 snprintf(gdbstub_device_name, sizeof(gdbstub_device_name),
1722 "%s,nowait,nodelay,server", device);
1723 device = gdbstub_device_name;
36556b20 1724 }
59030a8c
AL
1725#ifndef _WIN32
1726 else if (strcmp(device, "stdio") == 0) {
1727 struct sigaction act;
4046d913 1728
59030a8c
AL
1729 memset(&act, 0, sizeof(act));
1730 act.sa_handler = gdb_sigterm_handler;
1731 sigaction(SIGINT, &act, NULL);
1732 }
1733#endif
27143a44 1734 chr = qemu_chr_new("gdb", device, NULL);
36556b20
AL
1735 if (!chr)
1736 return -1;
1737
456d6069 1738 qemu_chr_fe_claim_no_fail(chr);
36556b20
AL
1739 qemu_chr_add_handlers(chr, gdb_chr_can_receive, gdb_chr_receive,
1740 gdb_chr_event, NULL);
cfc3475a
PB
1741 }
1742
36556b20
AL
1743 s = gdbserver_state;
1744 if (!s) {
7267c094 1745 s = g_malloc0(sizeof(GDBState));
36556b20 1746 gdbserver_state = s;
4046d913 1747
36556b20
AL
1748 qemu_add_vm_change_state_handler(gdb_vm_state_change, NULL);
1749
1750 /* Initialize a monitor terminal for gdb */
462efe9e 1751 mon_chr = qemu_chr_alloc();
36556b20
AL
1752 mon_chr->chr_write = gdb_monitor_write;
1753 monitor_init(mon_chr, 0);
1754 } else {
1755 if (s->chr)
70f24fb6 1756 qemu_chr_delete(s->chr);
36556b20
AL
1757 mon_chr = s->mon_chr;
1758 memset(s, 0, sizeof(GDBState));
1759 }
2e0f2cfb
AF
1760 s->c_cpu = first_cpu;
1761 s->g_cpu = first_cpu;
4046d913 1762 s->chr = chr;
36556b20
AL
1763 s->state = chr ? RS_IDLE : RS_INACTIVE;
1764 s->mon_chr = mon_chr;
cdb432b2 1765 s->current_syscall_cb = NULL;
8a34a0fb 1766
b4608c04
FB
1767 return 0;
1768}
4046d913 1769#endif