]> Git Repo - qemu.git/blame - gdbstub.c
rbd: remove unused constants and fields
[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 }
0d34282f 1288 snprintf(buf, sizeof(buf), "T%02xthread:%02x;", ret, cpu_index(cpu));
425189a8
JK
1289
1290send_packet:
858693c6 1291 put_packet(s, buf);
425189a8
JK
1292
1293 /* disable single step if it was enabled */
3825b28f 1294 cpu_single_step(cpu, 0);
858693c6 1295}
1fddef4b 1296#endif
858693c6 1297
a2d1ebaf
PB
1298/* Send a gdb syscall request.
1299 This accepts limited printf-style format specifiers, specifically:
a87295e8
PB
1300 %x - target_ulong argument printed in hex.
1301 %lx - 64-bit argument printed in hex.
1302 %s - string pointer (target_ulong) and length (int) pair. */
7ccfb2eb 1303void gdb_do_syscall(gdb_syscall_complete_cb cb, const char *fmt, ...)
a2d1ebaf
PB
1304{
1305 va_list va;
a2d1ebaf 1306 char *p;
cdb432b2 1307 char *p_end;
a2d1ebaf 1308 target_ulong addr;
a87295e8 1309 uint64_t i64;
a2d1ebaf
PB
1310 GDBState *s;
1311
880a7578 1312 s = gdbserver_state;
a2d1ebaf
PB
1313 if (!s)
1314 return;
cdb432b2 1315 s->current_syscall_cb = cb;
a2d1ebaf 1316#ifndef CONFIG_USER_ONLY
0461d5a6 1317 vm_stop(RUN_STATE_DEBUG);
a2d1ebaf 1318#endif
a2d1ebaf 1319 va_start(va, fmt);
cdb432b2
MI
1320 p = s->syscall_buf;
1321 p_end = &s->syscall_buf[sizeof(s->syscall_buf)];
a2d1ebaf
PB
1322 *(p++) = 'F';
1323 while (*fmt) {
1324 if (*fmt == '%') {
1325 fmt++;
1326 switch (*fmt++) {
1327 case 'x':
1328 addr = va_arg(va, target_ulong);
cdb432b2 1329 p += snprintf(p, p_end - p, TARGET_FMT_lx, addr);
a2d1ebaf 1330 break;
a87295e8
PB
1331 case 'l':
1332 if (*(fmt++) != 'x')
1333 goto bad_format;
1334 i64 = va_arg(va, uint64_t);
cdb432b2 1335 p += snprintf(p, p_end - p, "%" PRIx64, i64);
a87295e8 1336 break;
a2d1ebaf
PB
1337 case 's':
1338 addr = va_arg(va, target_ulong);
cdb432b2 1339 p += snprintf(p, p_end - p, TARGET_FMT_lx "/%x",
363a37d5 1340 addr, va_arg(va, int));
a2d1ebaf
PB
1341 break;
1342 default:
a87295e8 1343 bad_format:
a2d1ebaf
PB
1344 fprintf(stderr, "gdbstub: Bad syscall format string '%s'\n",
1345 fmt - 1);
1346 break;
1347 }
1348 } else {
1349 *(p++) = *(fmt++);
1350 }
1351 }
8a93e02a 1352 *p = 0;
a2d1ebaf 1353 va_end(va);
a2d1ebaf 1354#ifdef CONFIG_USER_ONLY
cdb432b2 1355 put_packet(s, s->syscall_buf);
2e0f2cfb 1356 gdb_handlesig(s->c_cpu, 0);
a2d1ebaf 1357#else
cdb432b2
MI
1358 /* In this case wait to send the syscall packet until notification that
1359 the CPU has stopped. This must be done because if the packet is sent
1360 now the reply from the syscall request could be received while the CPU
1361 is still in the running state, which can cause packets to be dropped
1362 and state transition 'T' packets to be sent while the syscall is still
1363 being processed. */
2e0f2cfb 1364 cpu_exit(s->c_cpu);
a2d1ebaf
PB
1365#endif
1366}
1367
6a00d601 1368static void gdb_read_byte(GDBState *s, int ch)
858693c6
FB
1369{
1370 int i, csum;
60fe76f3 1371 uint8_t reply;
858693c6 1372
1fddef4b 1373#ifndef CONFIG_USER_ONLY
4046d913
PB
1374 if (s->last_packet_len) {
1375 /* Waiting for a response to the last packet. If we see the start
1376 of a new command then abandon the previous response. */
1377 if (ch == '-') {
1378#ifdef DEBUG_GDB
1379 printf("Got NACK, retransmitting\n");
1380#endif
ffe8ab83 1381 put_buffer(s, (uint8_t *)s->last_packet, s->last_packet_len);
4046d913
PB
1382 }
1383#ifdef DEBUG_GDB
1384 else if (ch == '+')
1385 printf("Got ACK\n");
1386 else
1387 printf("Got '%c' when expecting ACK/NACK\n", ch);
1388#endif
1389 if (ch == '+' || ch == '$')
1390 s->last_packet_len = 0;
1391 if (ch != '$')
1392 return;
1393 }
1354869c 1394 if (runstate_is_running()) {
858693c6
FB
1395 /* when the CPU is running, we cannot do anything except stop
1396 it when receiving a char */
0461d5a6 1397 vm_stop(RUN_STATE_PAUSED);
5fafdf24 1398 } else
1fddef4b 1399#endif
41625033 1400 {
858693c6
FB
1401 switch(s->state) {
1402 case RS_IDLE:
1403 if (ch == '$') {
1404 s->line_buf_index = 0;
1405 s->state = RS_GETLINE;
c33a346e 1406 }
b4608c04 1407 break;
858693c6
FB
1408 case RS_GETLINE:
1409 if (ch == '#') {
1410 s->state = RS_CHKSUM1;
1411 } else if (s->line_buf_index >= sizeof(s->line_buf) - 1) {
1412 s->state = RS_IDLE;
4c3a88a2 1413 } else {
858693c6 1414 s->line_buf[s->line_buf_index++] = ch;
4c3a88a2
FB
1415 }
1416 break;
858693c6
FB
1417 case RS_CHKSUM1:
1418 s->line_buf[s->line_buf_index] = '\0';
1419 s->line_csum = fromhex(ch) << 4;
1420 s->state = RS_CHKSUM2;
1421 break;
1422 case RS_CHKSUM2:
1423 s->line_csum |= fromhex(ch);
1424 csum = 0;
1425 for(i = 0; i < s->line_buf_index; i++) {
1426 csum += s->line_buf[i];
1427 }
1428 if (s->line_csum != (csum & 0xff)) {
60fe76f3
TS
1429 reply = '-';
1430 put_buffer(s, &reply, 1);
858693c6 1431 s->state = RS_IDLE;
4c3a88a2 1432 } else {
60fe76f3
TS
1433 reply = '+';
1434 put_buffer(s, &reply, 1);
880a7578 1435 s->state = gdb_handle_packet(s, s->line_buf);
4c3a88a2
FB
1436 }
1437 break;
a2d1ebaf
PB
1438 default:
1439 abort();
858693c6
FB
1440 }
1441 }
1442}
1443
0e1c9c54 1444/* Tell the remote gdb that the process has exited. */
9349b4f9 1445void gdb_exit(CPUArchState *env, int code)
0e1c9c54
PB
1446{
1447 GDBState *s;
1448 char buf[4];
1449
1450 s = gdbserver_state;
1451 if (!s) {
1452 return;
1453 }
1454#ifdef CONFIG_USER_ONLY
1455 if (gdbserver_fd < 0 || s->fd < 0) {
1456 return;
1457 }
3d0f4418
PB
1458#else
1459 if (!s->chr) {
1460 return;
1461 }
0e1c9c54
PB
1462#endif
1463
1464 snprintf(buf, sizeof(buf), "W%02x", (uint8_t)code);
1465 put_packet(s, buf);
e2af15b2
FC
1466
1467#ifndef CONFIG_USER_ONLY
3d0f4418 1468 qemu_chr_delete(s->chr);
e2af15b2 1469#endif
0e1c9c54
PB
1470}
1471
1fddef4b 1472#ifdef CONFIG_USER_ONLY
ca587a8e
AJ
1473int
1474gdb_queuesig (void)
1475{
1476 GDBState *s;
1477
1478 s = gdbserver_state;
1479
1480 if (gdbserver_fd < 0 || s->fd < 0)
1481 return 0;
1482 else
1483 return 1;
1484}
1485
1fddef4b 1486int
db6b81d4 1487gdb_handlesig(CPUState *cpu, int sig)
1fddef4b 1488{
5ca666c7
AF
1489 GDBState *s;
1490 char buf[256];
1491 int n;
1fddef4b 1492
5ca666c7
AF
1493 s = gdbserver_state;
1494 if (gdbserver_fd < 0 || s->fd < 0) {
1495 return sig;
1496 }
1fddef4b 1497
5ca666c7 1498 /* disable single step if it was enabled */
3825b28f 1499 cpu_single_step(cpu, 0);
bbd77c18 1500 tb_flush(cpu);
1fddef4b 1501
5ca666c7
AF
1502 if (sig != 0) {
1503 snprintf(buf, sizeof(buf), "S%02x", target_signal_to_gdb(sig));
1504 put_packet(s, buf);
1505 }
1506 /* put_packet() might have detected that the peer terminated the
1507 connection. */
1508 if (s->fd < 0) {
1509 return sig;
1510 }
1fddef4b 1511
5ca666c7
AF
1512 sig = 0;
1513 s->state = RS_IDLE;
1514 s->running_state = 0;
1515 while (s->running_state == 0) {
1516 n = read(s->fd, buf, 256);
1517 if (n > 0) {
1518 int i;
1519
1520 for (i = 0; i < n; i++) {
1521 gdb_read_byte(s, buf[i]);
1522 }
1523 } else if (n == 0 || errno != EAGAIN) {
1524 /* XXX: Connection closed. Should probably wait for another
1525 connection before continuing. */
1526 return sig;
1fddef4b 1527 }
5ca666c7
AF
1528 }
1529 sig = s->signal;
1530 s->signal = 0;
1531 return sig;
1fddef4b 1532}
e9009676 1533
ca587a8e 1534/* Tell the remote gdb that the process has exited due to SIG. */
9349b4f9 1535void gdb_signalled(CPUArchState *env, int sig)
ca587a8e 1536{
5ca666c7
AF
1537 GDBState *s;
1538 char buf[4];
ca587a8e 1539
5ca666c7
AF
1540 s = gdbserver_state;
1541 if (gdbserver_fd < 0 || s->fd < 0) {
1542 return;
1543 }
ca587a8e 1544
5ca666c7
AF
1545 snprintf(buf, sizeof(buf), "X%02x", target_signal_to_gdb(sig));
1546 put_packet(s, buf);
ca587a8e 1547}
1fddef4b 1548
880a7578 1549static void gdb_accept(void)
858693c6
FB
1550{
1551 GDBState *s;
1552 struct sockaddr_in sockaddr;
1553 socklen_t len;
bf1c852a 1554 int fd;
858693c6
FB
1555
1556 for(;;) {
1557 len = sizeof(sockaddr);
1558 fd = accept(gdbserver_fd, (struct sockaddr *)&sockaddr, &len);
1559 if (fd < 0 && errno != EINTR) {
1560 perror("accept");
1561 return;
1562 } else if (fd >= 0) {
40ff6d7e
KW
1563#ifndef _WIN32
1564 fcntl(fd, F_SETFD, FD_CLOEXEC);
1565#endif
b4608c04
FB
1566 break;
1567 }
1568 }
858693c6
FB
1569
1570 /* set short latency */
bf1c852a 1571 socket_set_nodelay(fd);
3b46e624 1572
7267c094 1573 s = g_malloc0(sizeof(GDBState));
2e0f2cfb
AF
1574 s->c_cpu = first_cpu;
1575 s->g_cpu = first_cpu;
858693c6 1576 s->fd = fd;
5b50e790 1577 gdb_has_xml = false;
858693c6 1578
880a7578 1579 gdbserver_state = s;
a2d1ebaf 1580
858693c6 1581 fcntl(fd, F_SETFL, O_NONBLOCK);
858693c6
FB
1582}
1583
1584static int gdbserver_open(int port)
1585{
1586 struct sockaddr_in sockaddr;
6669ca13 1587 int fd, ret;
858693c6
FB
1588
1589 fd = socket(PF_INET, SOCK_STREAM, 0);
1590 if (fd < 0) {
1591 perror("socket");
1592 return -1;
1593 }
40ff6d7e
KW
1594#ifndef _WIN32
1595 fcntl(fd, F_SETFD, FD_CLOEXEC);
1596#endif
858693c6 1597
6669ca13 1598 socket_set_fast_reuse(fd);
858693c6
FB
1599
1600 sockaddr.sin_family = AF_INET;
1601 sockaddr.sin_port = htons(port);
1602 sockaddr.sin_addr.s_addr = 0;
1603 ret = bind(fd, (struct sockaddr *)&sockaddr, sizeof(sockaddr));
1604 if (ret < 0) {
1605 perror("bind");
bb16172c 1606 close(fd);
858693c6
FB
1607 return -1;
1608 }
1609 ret = listen(fd, 0);
1610 if (ret < 0) {
1611 perror("listen");
bb16172c 1612 close(fd);
858693c6
FB
1613 return -1;
1614 }
858693c6
FB
1615 return fd;
1616}
1617
1618int gdbserver_start(int port)
1619{
1620 gdbserver_fd = gdbserver_open(port);
1621 if (gdbserver_fd < 0)
1622 return -1;
1623 /* accept connections */
880a7578 1624 gdb_accept();
4046d913
PB
1625 return 0;
1626}
2b1319c8
AJ
1627
1628/* Disable gdb stub for child processes. */
f7ec7f7b 1629void gdbserver_fork(CPUState *cpu)
2b1319c8
AJ
1630{
1631 GDBState *s = gdbserver_state;
75a34036
AF
1632
1633 if (gdbserver_fd < 0 || s->fd < 0) {
1634 return;
1635 }
2b1319c8
AJ
1636 close(s->fd);
1637 s->fd = -1;
b3310ab3 1638 cpu_breakpoint_remove_all(cpu, BP_GDB);
75a34036 1639 cpu_watchpoint_remove_all(cpu, BP_GDB);
2b1319c8 1640}
1fddef4b 1641#else
aa1f17c1 1642static int gdb_chr_can_receive(void *opaque)
4046d913 1643{
56aebc89
PB
1644 /* We can handle an arbitrarily large amount of data.
1645 Pick the maximum packet size, which is as good as anything. */
1646 return MAX_PACKET_LENGTH;
4046d913
PB
1647}
1648
aa1f17c1 1649static void gdb_chr_receive(void *opaque, const uint8_t *buf, int size)
4046d913 1650{
4046d913
PB
1651 int i;
1652
1653 for (i = 0; i < size; i++) {
880a7578 1654 gdb_read_byte(gdbserver_state, buf[i]);
4046d913
PB
1655 }
1656}
1657
1658static void gdb_chr_event(void *opaque, int event)
1659{
1660 switch (event) {
b6b8df56 1661 case CHR_EVENT_OPENED:
0461d5a6 1662 vm_stop(RUN_STATE_PAUSED);
5b50e790 1663 gdb_has_xml = false;
4046d913
PB
1664 break;
1665 default:
1666 break;
1667 }
1668}
1669
8a34a0fb
AL
1670static void gdb_monitor_output(GDBState *s, const char *msg, int len)
1671{
1672 char buf[MAX_PACKET_LENGTH];
1673
1674 buf[0] = 'O';
1675 if (len > (MAX_PACKET_LENGTH/2) - 1)
1676 len = (MAX_PACKET_LENGTH/2) - 1;
1677 memtohex(buf + 1, (uint8_t *)msg, len);
1678 put_packet(s, buf);
1679}
1680
1681static int gdb_monitor_write(CharDriverState *chr, const uint8_t *buf, int len)
1682{
1683 const char *p = (const char *)buf;
1684 int max_sz;
1685
1686 max_sz = (sizeof(gdbserver_state->last_packet) - 2) / 2;
1687 for (;;) {
1688 if (len <= max_sz) {
1689 gdb_monitor_output(gdbserver_state, p, len);
1690 break;
1691 }
1692 gdb_monitor_output(gdbserver_state, p, max_sz);
1693 p += max_sz;
1694 len -= max_sz;
1695 }
1696 return len;
1697}
1698
59030a8c
AL
1699#ifndef _WIN32
1700static void gdb_sigterm_handler(int signal)
1701{
1354869c 1702 if (runstate_is_running()) {
0461d5a6 1703 vm_stop(RUN_STATE_PAUSED);
e07bbac5 1704 }
59030a8c
AL
1705}
1706#endif
1707
1708int gdbserver_start(const char *device)
4046d913
PB
1709{
1710 GDBState *s;
59030a8c 1711 char gdbstub_device_name[128];
36556b20
AL
1712 CharDriverState *chr = NULL;
1713 CharDriverState *mon_chr;
cfc3475a 1714
59030a8c
AL
1715 if (!device)
1716 return -1;
1717 if (strcmp(device, "none") != 0) {
1718 if (strstart(device, "tcp:", NULL)) {
1719 /* enforce required TCP attributes */
1720 snprintf(gdbstub_device_name, sizeof(gdbstub_device_name),
1721 "%s,nowait,nodelay,server", device);
1722 device = gdbstub_device_name;
36556b20 1723 }
59030a8c
AL
1724#ifndef _WIN32
1725 else if (strcmp(device, "stdio") == 0) {
1726 struct sigaction act;
4046d913 1727
59030a8c
AL
1728 memset(&act, 0, sizeof(act));
1729 act.sa_handler = gdb_sigterm_handler;
1730 sigaction(SIGINT, &act, NULL);
1731 }
1732#endif
27143a44 1733 chr = qemu_chr_new("gdb", device, NULL);
36556b20
AL
1734 if (!chr)
1735 return -1;
1736
456d6069 1737 qemu_chr_fe_claim_no_fail(chr);
36556b20
AL
1738 qemu_chr_add_handlers(chr, gdb_chr_can_receive, gdb_chr_receive,
1739 gdb_chr_event, NULL);
cfc3475a
PB
1740 }
1741
36556b20
AL
1742 s = gdbserver_state;
1743 if (!s) {
7267c094 1744 s = g_malloc0(sizeof(GDBState));
36556b20 1745 gdbserver_state = s;
4046d913 1746
36556b20
AL
1747 qemu_add_vm_change_state_handler(gdb_vm_state_change, NULL);
1748
1749 /* Initialize a monitor terminal for gdb */
462efe9e 1750 mon_chr = qemu_chr_alloc();
36556b20
AL
1751 mon_chr->chr_write = gdb_monitor_write;
1752 monitor_init(mon_chr, 0);
1753 } else {
1754 if (s->chr)
70f24fb6 1755 qemu_chr_delete(s->chr);
36556b20
AL
1756 mon_chr = s->mon_chr;
1757 memset(s, 0, sizeof(GDBState));
1758 }
2e0f2cfb
AF
1759 s->c_cpu = first_cpu;
1760 s->g_cpu = first_cpu;
4046d913 1761 s->chr = chr;
36556b20
AL
1762 s->state = chr ? RS_IDLE : RS_INACTIVE;
1763 s->mon_chr = mon_chr;
cdb432b2 1764 s->current_syscall_cb = NULL;
8a34a0fb 1765
b4608c04
FB
1766 return 0;
1767}
4046d913 1768#endif
This page took 0.931937 seconds and 4 git commands to generate.