blob: 1517563abe148ded59a8410035d50284259726d8 [file] [log] [blame]
bellardb4608c02003-06-27 17:34:32 +00001/*
2 * gdb server stub
ths5fafdf22007-09-16 21:08:06 +00003 *
bellard34751872005-07-02 14:31:34 +00004 * Copyright (c) 2003-2005 Fabrice Bellard
bellardb4608c02003-06-27 17:34:32 +00005 *
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2 of the License, or (at your option) any later version.
10 *
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
15 *
16 * You should have received a copy of the GNU Lesser General Public
Blue Swirl8167ee82009-07-16 20:47:01 +000017 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
bellardb4608c02003-06-27 17:34:32 +000018 */
Peter Maydelld38ea872016-01-29 17:50:05 +000019#include "qemu/osdep.h"
Markus Armbrusterda34e652016-03-14 09:01:28 +010020#include "qapi/error.h"
Ziyue Yang508b4ec2017-01-18 16:02:41 +080021#include "qemu/error-report.h"
Veronia Bahaaf348b6d2016-03-20 19:16:19 +020022#include "qemu/cutils.h"
Doug Gale5c9522b2017-12-02 20:30:37 -050023#include "trace-root.h"
Veronia Bahaaf348b6d2016-03-20 19:16:19 +020024#ifdef CONFIG_USER_ONLY
bellard1fddef42005-04-17 19:16:13 +000025#include "qemu.h"
26#else
Paolo Bonzini83c90892012-12-17 18:19:49 +010027#include "monitor/monitor.h"
Marc-André Lureau8228e352017-01-26 17:19:46 +040028#include "chardev/char.h"
Marc-André Lureau4d43a602017-01-26 18:26:44 +040029#include "chardev/char-fe.h"
Paolo Bonzini9c17d612012-12-17 18:20:04 +010030#include "sysemu/sysemu.h"
Paolo Bonzini022c62c2012-12-17 18:19:49 +010031#include "exec/gdbstub.h"
Luc Michel8f468632019-01-07 15:23:45 +000032#include "hw/cpu/cluster.h"
bellard1fddef42005-04-17 19:16:13 +000033#endif
bellard67b915a2004-03-31 23:37:16 +000034
pbrook56aebc82008-10-11 17:55:29 +000035#define MAX_PACKET_LENGTH 4096
36
Paolo Bonzini1de7afc2012-12-17 18:20:00 +010037#include "qemu/sockets.h"
Vincent Palatinb3946622017-01-10 11:59:55 +010038#include "sysemu/hw_accel.h"
Paolo Bonzini9c17d612012-12-17 18:20:04 +010039#include "sysemu/kvm.h"
Leon Alraecfe67ce2015-06-19 14:17:45 +010040#include "exec/semihost.h"
Paolo Bonzini63c91552016-03-15 13:18:37 +010041#include "exec/exec-all.h"
aurel32ca587a82008-12-18 22:44:13 +000042
Jan Kiszkaa3919382015-02-07 09:38:44 +010043#ifdef CONFIG_USER_ONLY
44#define GDB_ATTACHED "0"
45#else
46#define GDB_ATTACHED "1"
47#endif
48
Andreas Färberf3659ee2013-06-27 19:09:09 +020049static inline int target_memory_rw_debug(CPUState *cpu, target_ulong addr,
50 uint8_t *buf, int len, bool is_write)
Fabien Chouteau44520db2011-09-08 12:48:16 +020051{
Andreas Färberf3659ee2013-06-27 19:09:09 +020052 CPUClass *cc = CPU_GET_CLASS(cpu);
53
54 if (cc->memory_rw_debug) {
55 return cc->memory_rw_debug(cpu, addr, buf, len, is_write);
56 }
57 return cpu_memory_rw_debug(cpu, addr, buf, len, is_write);
Fabien Chouteau44520db2011-09-08 12:48:16 +020058}
aurel32ca587a82008-12-18 22:44:13 +000059
Alex Bennéed2a6c852017-07-12 11:52:14 +010060/* Return the GDB index for a given vCPU state.
61 *
62 * For user mode this is simply the thread id. In system mode GDB
63 * numbers CPUs from 1 as 0 is reserved as an "any cpu" index.
64 */
65static inline int cpu_gdb_index(CPUState *cpu)
66{
67#if defined(CONFIG_USER_ONLY)
Alex Bennéebd88c782017-07-12 11:52:15 +010068 TaskState *ts = (TaskState *) cpu->opaque;
69 return ts->ts_tid;
Alex Bennéed2a6c852017-07-12 11:52:14 +010070#else
71 return cpu->cpu_index + 1;
72#endif
73}
74
aurel32ca587a82008-12-18 22:44:13 +000075enum {
76 GDB_SIGNAL_0 = 0,
77 GDB_SIGNAL_INT = 2,
Jan Kiszka425189a2011-03-22 11:02:09 +010078 GDB_SIGNAL_QUIT = 3,
aurel32ca587a82008-12-18 22:44:13 +000079 GDB_SIGNAL_TRAP = 5,
Jan Kiszka425189a2011-03-22 11:02:09 +010080 GDB_SIGNAL_ABRT = 6,
81 GDB_SIGNAL_ALRM = 14,
82 GDB_SIGNAL_IO = 23,
83 GDB_SIGNAL_XCPU = 24,
aurel32ca587a82008-12-18 22:44:13 +000084 GDB_SIGNAL_UNKNOWN = 143
85};
86
87#ifdef CONFIG_USER_ONLY
88
89/* Map target signal numbers to GDB protocol signal numbers and vice
90 * versa. For user emulation's currently supported systems, we can
91 * assume most signals are defined.
92 */
93
94static int gdb_signal_table[] = {
95 0,
96 TARGET_SIGHUP,
97 TARGET_SIGINT,
98 TARGET_SIGQUIT,
99 TARGET_SIGILL,
100 TARGET_SIGTRAP,
101 TARGET_SIGABRT,
102 -1, /* SIGEMT */
103 TARGET_SIGFPE,
104 TARGET_SIGKILL,
105 TARGET_SIGBUS,
106 TARGET_SIGSEGV,
107 TARGET_SIGSYS,
108 TARGET_SIGPIPE,
109 TARGET_SIGALRM,
110 TARGET_SIGTERM,
111 TARGET_SIGURG,
112 TARGET_SIGSTOP,
113 TARGET_SIGTSTP,
114 TARGET_SIGCONT,
115 TARGET_SIGCHLD,
116 TARGET_SIGTTIN,
117 TARGET_SIGTTOU,
118 TARGET_SIGIO,
119 TARGET_SIGXCPU,
120 TARGET_SIGXFSZ,
121 TARGET_SIGVTALRM,
122 TARGET_SIGPROF,
123 TARGET_SIGWINCH,
124 -1, /* SIGLOST */
125 TARGET_SIGUSR1,
126 TARGET_SIGUSR2,
blueswir1c72d5bf2009-01-15 17:27:45 +0000127#ifdef TARGET_SIGPWR
aurel32ca587a82008-12-18 22:44:13 +0000128 TARGET_SIGPWR,
blueswir1c72d5bf2009-01-15 17:27:45 +0000129#else
130 -1,
131#endif
aurel32ca587a82008-12-18 22:44:13 +0000132 -1, /* SIGPOLL */
133 -1,
134 -1,
135 -1,
136 -1,
137 -1,
138 -1,
139 -1,
140 -1,
141 -1,
142 -1,
143 -1,
blueswir1c72d5bf2009-01-15 17:27:45 +0000144#ifdef __SIGRTMIN
aurel32ca587a82008-12-18 22:44:13 +0000145 __SIGRTMIN + 1,
146 __SIGRTMIN + 2,
147 __SIGRTMIN + 3,
148 __SIGRTMIN + 4,
149 __SIGRTMIN + 5,
150 __SIGRTMIN + 6,
151 __SIGRTMIN + 7,
152 __SIGRTMIN + 8,
153 __SIGRTMIN + 9,
154 __SIGRTMIN + 10,
155 __SIGRTMIN + 11,
156 __SIGRTMIN + 12,
157 __SIGRTMIN + 13,
158 __SIGRTMIN + 14,
159 __SIGRTMIN + 15,
160 __SIGRTMIN + 16,
161 __SIGRTMIN + 17,
162 __SIGRTMIN + 18,
163 __SIGRTMIN + 19,
164 __SIGRTMIN + 20,
165 __SIGRTMIN + 21,
166 __SIGRTMIN + 22,
167 __SIGRTMIN + 23,
168 __SIGRTMIN + 24,
169 __SIGRTMIN + 25,
170 __SIGRTMIN + 26,
171 __SIGRTMIN + 27,
172 __SIGRTMIN + 28,
173 __SIGRTMIN + 29,
174 __SIGRTMIN + 30,
175 __SIGRTMIN + 31,
176 -1, /* SIGCANCEL */
177 __SIGRTMIN,
178 __SIGRTMIN + 32,
179 __SIGRTMIN + 33,
180 __SIGRTMIN + 34,
181 __SIGRTMIN + 35,
182 __SIGRTMIN + 36,
183 __SIGRTMIN + 37,
184 __SIGRTMIN + 38,
185 __SIGRTMIN + 39,
186 __SIGRTMIN + 40,
187 __SIGRTMIN + 41,
188 __SIGRTMIN + 42,
189 __SIGRTMIN + 43,
190 __SIGRTMIN + 44,
191 __SIGRTMIN + 45,
192 __SIGRTMIN + 46,
193 __SIGRTMIN + 47,
194 __SIGRTMIN + 48,
195 __SIGRTMIN + 49,
196 __SIGRTMIN + 50,
197 __SIGRTMIN + 51,
198 __SIGRTMIN + 52,
199 __SIGRTMIN + 53,
200 __SIGRTMIN + 54,
201 __SIGRTMIN + 55,
202 __SIGRTMIN + 56,
203 __SIGRTMIN + 57,
204 __SIGRTMIN + 58,
205 __SIGRTMIN + 59,
206 __SIGRTMIN + 60,
207 __SIGRTMIN + 61,
208 __SIGRTMIN + 62,
209 __SIGRTMIN + 63,
210 __SIGRTMIN + 64,
211 __SIGRTMIN + 65,
212 __SIGRTMIN + 66,
213 __SIGRTMIN + 67,
214 __SIGRTMIN + 68,
215 __SIGRTMIN + 69,
216 __SIGRTMIN + 70,
217 __SIGRTMIN + 71,
218 __SIGRTMIN + 72,
219 __SIGRTMIN + 73,
220 __SIGRTMIN + 74,
221 __SIGRTMIN + 75,
222 __SIGRTMIN + 76,
223 __SIGRTMIN + 77,
224 __SIGRTMIN + 78,
225 __SIGRTMIN + 79,
226 __SIGRTMIN + 80,
227 __SIGRTMIN + 81,
228 __SIGRTMIN + 82,
229 __SIGRTMIN + 83,
230 __SIGRTMIN + 84,
231 __SIGRTMIN + 85,
232 __SIGRTMIN + 86,
233 __SIGRTMIN + 87,
234 __SIGRTMIN + 88,
235 __SIGRTMIN + 89,
236 __SIGRTMIN + 90,
237 __SIGRTMIN + 91,
238 __SIGRTMIN + 92,
239 __SIGRTMIN + 93,
240 __SIGRTMIN + 94,
241 __SIGRTMIN + 95,
242 -1, /* SIGINFO */
243 -1, /* UNKNOWN */
244 -1, /* DEFAULT */
245 -1,
246 -1,
247 -1,
248 -1,
249 -1,
250 -1
blueswir1c72d5bf2009-01-15 17:27:45 +0000251#endif
aurel32ca587a82008-12-18 22:44:13 +0000252};
bellard8f447cc2006-06-14 15:21:14 +0000253#else
aurel32ca587a82008-12-18 22:44:13 +0000254/* In system mode we only need SIGINT and SIGTRAP; other signals
255 are not yet supported. */
256
257enum {
258 TARGET_SIGINT = 2,
259 TARGET_SIGTRAP = 5
260};
261
262static int gdb_signal_table[] = {
263 -1,
264 -1,
265 TARGET_SIGINT,
266 -1,
267 -1,
268 TARGET_SIGTRAP
269};
bellard8f447cc2006-06-14 15:21:14 +0000270#endif
bellardb4608c02003-06-27 17:34:32 +0000271
aurel32ca587a82008-12-18 22:44:13 +0000272#ifdef CONFIG_USER_ONLY
273static int target_signal_to_gdb (int sig)
274{
275 int i;
276 for (i = 0; i < ARRAY_SIZE (gdb_signal_table); i++)
277 if (gdb_signal_table[i] == sig)
278 return i;
279 return GDB_SIGNAL_UNKNOWN;
280}
281#endif
282
283static int gdb_signal_to_target (int sig)
284{
285 if (sig < ARRAY_SIZE (gdb_signal_table))
286 return gdb_signal_table[sig];
287 else
288 return -1;
289}
290
pbrook56aebc82008-10-11 17:55:29 +0000291typedef struct GDBRegisterState {
292 int base_reg;
293 int num_regs;
294 gdb_reg_cb get_reg;
295 gdb_reg_cb set_reg;
296 const char *xml;
297 struct GDBRegisterState *next;
298} GDBRegisterState;
299
Luc Michel8f468632019-01-07 15:23:45 +0000300typedef struct GDBProcess {
301 uint32_t pid;
302 bool attached;
Luc Michelc145eea2019-01-07 15:23:46 +0000303
304 char target_xml[1024];
Luc Michel8f468632019-01-07 15:23:45 +0000305} GDBProcess;
306
bellard858693c2004-03-31 18:52:07 +0000307enum RSState {
aliguori36556b22009-03-28 18:05:53 +0000308 RS_INACTIVE,
bellard858693c2004-03-31 18:52:07 +0000309 RS_IDLE,
310 RS_GETLINE,
Doug Gale4bf43122017-05-01 12:22:10 -0400311 RS_GETLINE_ESC,
312 RS_GETLINE_RLE,
bellard858693c2004-03-31 18:52:07 +0000313 RS_CHKSUM1,
314 RS_CHKSUM2,
315};
bellard858693c2004-03-31 18:52:07 +0000316typedef struct GDBState {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200317 CPUState *c_cpu; /* current CPU for step/continue ops */
318 CPUState *g_cpu; /* current CPU for other ops */
Andreas Färber52f34622013-06-27 13:44:40 +0200319 CPUState *query_cpu; /* for q{f|s}ThreadInfo */
bellard41625032005-04-24 10:07:11 +0000320 enum RSState state; /* parsing state */
pbrook56aebc82008-10-11 17:55:29 +0000321 char line_buf[MAX_PACKET_LENGTH];
bellard858693c2004-03-31 18:52:07 +0000322 int line_buf_index;
Doug Gale4bf43122017-05-01 12:22:10 -0400323 int line_sum; /* running checksum */
324 int line_csum; /* checksum at the end of the packet */
pbrook56aebc82008-10-11 17:55:29 +0000325 uint8_t last_packet[MAX_PACKET_LENGTH + 4];
pbrook4046d912007-01-28 01:53:16 +0000326 int last_packet_len;
edgar_igl1f487ee2008-05-17 22:20:53 +0000327 int signal;
bellard41625032005-04-24 10:07:11 +0000328#ifdef CONFIG_USER_ONLY
pbrook4046d912007-01-28 01:53:16 +0000329 int fd;
bellard41625032005-04-24 10:07:11 +0000330 int running_state;
pbrook4046d912007-01-28 01:53:16 +0000331#else
Marc-André Lureau32a6ebe2016-10-22 12:52:52 +0300332 CharBackend chr;
Marc-André Lureau0ec7b3e2016-12-07 16:20:22 +0300333 Chardev *mon_chr;
bellard41625032005-04-24 10:07:11 +0000334#endif
Luc Michel8f468632019-01-07 15:23:45 +0000335 bool multiprocess;
336 GDBProcess *processes;
337 int process_num;
Meador Ingecdb432b2012-03-15 17:49:45 +0000338 char syscall_buf[256];
339 gdb_syscall_complete_cb current_syscall_cb;
bellard858693c2004-03-31 18:52:07 +0000340} GDBState;
bellardb4608c02003-06-27 17:34:32 +0000341
edgar_igl60897d32008-05-09 08:25:14 +0000342/* By default use no IRQs and no timers while single stepping so as to
343 * make single stepping like an ICE HW step.
344 */
345static int sstep_flags = SSTEP_ENABLE|SSTEP_NOIRQ|SSTEP_NOTIMER;
346
aliguori880a7572008-11-18 20:30:24 +0000347static GDBState *gdbserver_state;
348
Andreas Färber5b50e792013-06-29 04:18:45 +0200349bool gdb_has_xml;
pbrook56aebc82008-10-11 17:55:29 +0000350
bellard1fddef42005-04-17 19:16:13 +0000351#ifdef CONFIG_USER_ONLY
pbrook4046d912007-01-28 01:53:16 +0000352/* XXX: This is not thread safe. Do we care? */
353static int gdbserver_fd = -1;
354
bellard858693c2004-03-31 18:52:07 +0000355static int get_char(GDBState *s)
bellardb4608c02003-06-27 17:34:32 +0000356{
357 uint8_t ch;
358 int ret;
359
360 for(;;) {
Blue Swirl00aa0042011-07-23 20:04:29 +0000361 ret = qemu_recv(s->fd, &ch, 1, 0);
bellardb4608c02003-06-27 17:34:32 +0000362 if (ret < 0) {
edgar_igl1f487ee2008-05-17 22:20:53 +0000363 if (errno == ECONNRESET)
364 s->fd = -1;
Peter Wu5819e3e2016-06-05 16:35:48 +0200365 if (errno != EINTR)
bellardb4608c02003-06-27 17:34:32 +0000366 return -1;
367 } else if (ret == 0) {
edgar_igl1f487ee2008-05-17 22:20:53 +0000368 close(s->fd);
369 s->fd = -1;
bellardb4608c02003-06-27 17:34:32 +0000370 return -1;
371 } else {
372 break;
373 }
374 }
375 return ch;
376}
pbrook4046d912007-01-28 01:53:16 +0000377#endif
bellardb4608c02003-06-27 17:34:32 +0000378
blueswir1654efcf2009-04-18 07:29:59 +0000379static enum {
pbrooka2d1eba2007-01-28 03:10:55 +0000380 GDB_SYS_UNKNOWN,
381 GDB_SYS_ENABLED,
382 GDB_SYS_DISABLED,
383} gdb_syscall_mode;
384
Liviu Ionescua38bb072014-12-11 12:07:48 +0000385/* Decide if either remote gdb syscalls or native file IO should be used. */
pbrooka2d1eba2007-01-28 03:10:55 +0000386int use_gdb_syscalls(void)
387{
Leon Alraecfe67ce2015-06-19 14:17:45 +0100388 SemihostingTarget target = semihosting_get_target();
389 if (target == SEMIHOSTING_TARGET_NATIVE) {
Liviu Ionescua38bb072014-12-11 12:07:48 +0000390 /* -semihosting-config target=native */
391 return false;
Leon Alraecfe67ce2015-06-19 14:17:45 +0100392 } else if (target == SEMIHOSTING_TARGET_GDB) {
Liviu Ionescua38bb072014-12-11 12:07:48 +0000393 /* -semihosting-config target=gdb */
394 return true;
395 }
396
397 /* -semihosting-config target=auto */
398 /* On the first call check if gdb is connected and remember. */
pbrooka2d1eba2007-01-28 03:10:55 +0000399 if (gdb_syscall_mode == GDB_SYS_UNKNOWN) {
aliguori880a7572008-11-18 20:30:24 +0000400 gdb_syscall_mode = (gdbserver_state ? GDB_SYS_ENABLED
401 : GDB_SYS_DISABLED);
pbrooka2d1eba2007-01-28 03:10:55 +0000402 }
403 return gdb_syscall_mode == GDB_SYS_ENABLED;
404}
405
edgar_iglba70a622008-03-14 06:10:42 +0000406/* Resume execution. */
407static inline void gdb_continue(GDBState *s)
408{
Doug Gale5c9522b2017-12-02 20:30:37 -0500409
edgar_iglba70a622008-03-14 06:10:42 +0000410#ifdef CONFIG_USER_ONLY
411 s->running_state = 1;
Doug Gale5c9522b2017-12-02 20:30:37 -0500412 trace_gdbstub_op_continue();
edgar_iglba70a622008-03-14 06:10:42 +0000413#else
Paolo Bonzini26ac7a32013-06-03 17:06:54 +0200414 if (!runstate_needs_reset()) {
Doug Gale5c9522b2017-12-02 20:30:37 -0500415 trace_gdbstub_op_continue();
Paolo Bonzini87f25c12013-05-30 13:20:40 +0200416 vm_start();
417 }
edgar_iglba70a622008-03-14 06:10:42 +0000418#endif
419}
420
Claudio Imbrenda544177a2017-02-14 18:07:48 +0100421/*
422 * Resume execution, per CPU actions. For user-mode emulation it's
423 * equivalent to gdb_continue.
424 */
425static int gdb_continue_partial(GDBState *s, char *newstates)
426{
427 CPUState *cpu;
428 int res = 0;
429#ifdef CONFIG_USER_ONLY
430 /*
431 * This is not exactly accurate, but it's an improvement compared to the
432 * previous situation, where only one CPU would be single-stepped.
433 */
434 CPU_FOREACH(cpu) {
435 if (newstates[cpu->cpu_index] == 's') {
Doug Gale5c9522b2017-12-02 20:30:37 -0500436 trace_gdbstub_op_stepping(cpu->cpu_index);
Claudio Imbrenda544177a2017-02-14 18:07:48 +0100437 cpu_single_step(cpu, sstep_flags);
438 }
439 }
440 s->running_state = 1;
441#else
442 int flag = 0;
443
444 if (!runstate_needs_reset()) {
445 if (vm_prepare_start()) {
446 return 0;
447 }
448
449 CPU_FOREACH(cpu) {
450 switch (newstates[cpu->cpu_index]) {
451 case 0:
452 case 1:
453 break; /* nothing to do here */
454 case 's':
Doug Gale5c9522b2017-12-02 20:30:37 -0500455 trace_gdbstub_op_stepping(cpu->cpu_index);
Claudio Imbrenda544177a2017-02-14 18:07:48 +0100456 cpu_single_step(cpu, sstep_flags);
457 cpu_resume(cpu);
458 flag = 1;
459 break;
460 case 'c':
Doug Gale5c9522b2017-12-02 20:30:37 -0500461 trace_gdbstub_op_continue_cpu(cpu->cpu_index);
Claudio Imbrenda544177a2017-02-14 18:07:48 +0100462 cpu_resume(cpu);
463 flag = 1;
464 break;
465 default:
466 res = -1;
467 break;
468 }
469 }
470 }
471 if (flag) {
472 qemu_clock_enable(QEMU_CLOCK_VIRTUAL, true);
473 }
474#endif
475 return res;
476}
477
bellard858693c2004-03-31 18:52:07 +0000478static void put_buffer(GDBState *s, const uint8_t *buf, int len)
bellardb4608c02003-06-27 17:34:32 +0000479{
pbrook4046d912007-01-28 01:53:16 +0000480#ifdef CONFIG_USER_ONLY
bellardb4608c02003-06-27 17:34:32 +0000481 int ret;
482
483 while (len > 0) {
bellard8f447cc2006-06-14 15:21:14 +0000484 ret = send(s->fd, buf, len, 0);
bellardb4608c02003-06-27 17:34:32 +0000485 if (ret < 0) {
Peter Wu5819e3e2016-06-05 16:35:48 +0200486 if (errno != EINTR)
bellardb4608c02003-06-27 17:34:32 +0000487 return;
488 } else {
489 buf += ret;
490 len -= ret;
491 }
492 }
pbrook4046d912007-01-28 01:53:16 +0000493#else
Daniel P. Berrange6ab3fc32016-09-06 14:56:04 +0100494 /* XXX this blocks entire thread. Rewrite to use
495 * qemu_chr_fe_write and background I/O callbacks */
Marc-André Lureau5345fdb2016-10-22 12:52:55 +0300496 qemu_chr_fe_write_all(&s->chr, buf, len);
pbrook4046d912007-01-28 01:53:16 +0000497#endif
bellardb4608c02003-06-27 17:34:32 +0000498}
499
500static inline int fromhex(int v)
501{
502 if (v >= '0' && v <= '9')
503 return v - '0';
504 else if (v >= 'A' && v <= 'F')
505 return v - 'A' + 10;
506 else if (v >= 'a' && v <= 'f')
507 return v - 'a' + 10;
508 else
509 return 0;
510}
511
512static inline int tohex(int v)
513{
514 if (v < 10)
515 return v + '0';
516 else
517 return v - 10 + 'a';
518}
519
Philippe Mathieu-Daudé90057742018-04-08 11:59:33 -0300520/* writes 2*len+1 bytes in buf */
bellardb4608c02003-06-27 17:34:32 +0000521static void memtohex(char *buf, const uint8_t *mem, int len)
522{
523 int i, c;
524 char *q;
525 q = buf;
526 for(i = 0; i < len; i++) {
527 c = mem[i];
528 *q++ = tohex(c >> 4);
529 *q++ = tohex(c & 0xf);
530 }
531 *q = '\0';
532}
533
534static void hextomem(uint8_t *mem, const char *buf, int len)
535{
536 int i;
537
538 for(i = 0; i < len; i++) {
539 mem[i] = (fromhex(buf[0]) << 4) | fromhex(buf[1]);
540 buf += 2;
541 }
542}
543
Doug Gale5c9522b2017-12-02 20:30:37 -0500544static void hexdump(const char *buf, int len,
545 void (*trace_fn)(size_t ofs, char const *text))
546{
547 char line_buffer[3 * 16 + 4 + 16 + 1];
548
549 size_t i;
550 for (i = 0; i < len || (i & 0xF); ++i) {
551 size_t byte_ofs = i & 15;
552
553 if (byte_ofs == 0) {
554 memset(line_buffer, ' ', 3 * 16 + 4 + 16);
555 line_buffer[3 * 16 + 4 + 16] = 0;
556 }
557
558 size_t col_group = (i >> 2) & 3;
559 size_t hex_col = byte_ofs * 3 + col_group;
560 size_t txt_col = 3 * 16 + 4 + byte_ofs;
561
562 if (i < len) {
563 char value = buf[i];
564
565 line_buffer[hex_col + 0] = tohex((value >> 4) & 0xF);
566 line_buffer[hex_col + 1] = tohex((value >> 0) & 0xF);
567 line_buffer[txt_col + 0] = (value >= ' ' && value < 127)
568 ? value
569 : '.';
570 }
571
572 if (byte_ofs == 0xF)
573 trace_fn(i & -16, line_buffer);
574 }
575}
576
bellardb4608c02003-06-27 17:34:32 +0000577/* return -1 if error, 0 if OK */
Doug Gale5c9522b2017-12-02 20:30:37 -0500578static int put_packet_binary(GDBState *s, const char *buf, int len, bool dump)
bellardb4608c02003-06-27 17:34:32 +0000579{
pbrook56aebc82008-10-11 17:55:29 +0000580 int csum, i;
ths60fe76f2007-12-16 03:02:09 +0000581 uint8_t *p;
bellardb4608c02003-06-27 17:34:32 +0000582
Doug Gale5c9522b2017-12-02 20:30:37 -0500583 if (dump && trace_event_get_state_backends(TRACE_GDBSTUB_IO_BINARYREPLY)) {
584 hexdump(buf, len, trace_gdbstub_io_binaryreply);
585 }
586
bellardb4608c02003-06-27 17:34:32 +0000587 for(;;) {
pbrook4046d912007-01-28 01:53:16 +0000588 p = s->last_packet;
589 *(p++) = '$';
pbrook4046d912007-01-28 01:53:16 +0000590 memcpy(p, buf, len);
591 p += len;
bellardb4608c02003-06-27 17:34:32 +0000592 csum = 0;
593 for(i = 0; i < len; i++) {
594 csum += buf[i];
595 }
pbrook4046d912007-01-28 01:53:16 +0000596 *(p++) = '#';
597 *(p++) = tohex((csum >> 4) & 0xf);
598 *(p++) = tohex((csum) & 0xf);
bellardb4608c02003-06-27 17:34:32 +0000599
pbrook4046d912007-01-28 01:53:16 +0000600 s->last_packet_len = p - s->last_packet;
thsffe8ab82007-12-16 03:16:05 +0000601 put_buffer(s, (uint8_t *)s->last_packet, s->last_packet_len);
bellardb4608c02003-06-27 17:34:32 +0000602
pbrook4046d912007-01-28 01:53:16 +0000603#ifdef CONFIG_USER_ONLY
604 i = get_char(s);
605 if (i < 0)
bellardb4608c02003-06-27 17:34:32 +0000606 return -1;
pbrook4046d912007-01-28 01:53:16 +0000607 if (i == '+')
bellardb4608c02003-06-27 17:34:32 +0000608 break;
pbrook4046d912007-01-28 01:53:16 +0000609#else
610 break;
611#endif
bellardb4608c02003-06-27 17:34:32 +0000612 }
613 return 0;
614}
615
pbrook56aebc82008-10-11 17:55:29 +0000616/* return -1 if error, 0 if OK */
617static int put_packet(GDBState *s, const char *buf)
618{
Doug Gale5c9522b2017-12-02 20:30:37 -0500619 trace_gdbstub_io_reply(buf);
pbrook56aebc82008-10-11 17:55:29 +0000620
Doug Gale5c9522b2017-12-02 20:30:37 -0500621 return put_packet_binary(s, buf, strlen(buf), false);
pbrook56aebc82008-10-11 17:55:29 +0000622}
623
pbrook56aebc82008-10-11 17:55:29 +0000624/* Encode data using the encoding for 'x' packets. */
625static int memtox(char *buf, const char *mem, int len)
626{
627 char *p = buf;
628 char c;
629
630 while (len--) {
631 c = *(mem++);
632 switch (c) {
633 case '#': case '$': case '*': case '}':
634 *(p++) = '}';
635 *(p++) = c ^ 0x20;
636 break;
637 default:
638 *(p++) = c;
639 break;
640 }
641 }
642 return p - buf;
643}
644
Luc Michel1a227332019-01-07 15:23:45 +0000645static uint32_t gdb_get_cpu_pid(const GDBState *s, CPUState *cpu)
646{
647#ifndef CONFIG_USER_ONLY
648 gchar *path, *name = NULL;
649 Object *obj;
650 CPUClusterState *cluster;
651 uint32_t ret;
652
653 path = object_get_canonical_path(OBJECT(cpu));
654
655 if (path == NULL) {
656 /* Return the default process' PID */
657 ret = s->processes[s->process_num - 1].pid;
658 goto out;
659 }
660
661 name = object_get_canonical_path_component(OBJECT(cpu));
662 assert(name != NULL);
663
664 /*
665 * Retrieve the CPU parent path by removing the last '/' and the CPU name
666 * from the CPU canonical path.
667 */
668 path[strlen(path) - strlen(name) - 1] = '\0';
669
670 obj = object_resolve_path_type(path, TYPE_CPU_CLUSTER, NULL);
671
672 if (obj == NULL) {
673 /* Return the default process' PID */
674 ret = s->processes[s->process_num - 1].pid;
675 goto out;
676 }
677
678 cluster = CPU_CLUSTER(obj);
679 ret = cluster->cluster_id + 1;
680
681out:
682 g_free(name);
683 g_free(path);
684
685 return ret;
686
687#else
688 /* TODO: In user mode, we should use the task state PID */
689 return s->processes[s->process_num - 1].pid;
690#endif
691}
692
Luc Michel7d8c87d2019-01-07 15:23:45 +0000693static GDBProcess *gdb_get_process(const GDBState *s, uint32_t pid)
694{
695 int i;
696
697 if (!pid) {
698 /* 0 means any process, we take the first one */
699 return &s->processes[0];
700 }
701
702 for (i = 0; i < s->process_num; i++) {
703 if (s->processes[i].pid == pid) {
704 return &s->processes[i];
705 }
706 }
707
708 return NULL;
709}
710
711static GDBProcess *gdb_get_cpu_process(const GDBState *s, CPUState *cpu)
712{
713 return gdb_get_process(s, gdb_get_cpu_pid(s, cpu));
714}
715
716static CPUState *find_cpu(uint32_t thread_id)
717{
718 CPUState *cpu;
719
720 CPU_FOREACH(cpu) {
721 if (cpu_gdb_index(cpu) == thread_id) {
722 return cpu;
723 }
724 }
725
726 return NULL;
727}
728
Luc Michele40e5202019-01-07 15:23:46 +0000729static CPUState *get_first_cpu_in_process(const GDBState *s,
730 GDBProcess *process)
731{
732 CPUState *cpu;
733
734 CPU_FOREACH(cpu) {
735 if (gdb_get_cpu_pid(s, cpu) == process->pid) {
736 return cpu;
737 }
738 }
739
740 return NULL;
741}
742
743static CPUState *gdb_next_cpu_in_process(const GDBState *s, CPUState *cpu)
744{
745 uint32_t pid = gdb_get_cpu_pid(s, cpu);
746 cpu = CPU_NEXT(cpu);
747
748 while (cpu) {
749 if (gdb_get_cpu_pid(s, cpu) == pid) {
750 break;
751 }
752
753 cpu = CPU_NEXT(cpu);
754 }
755
756 return cpu;
757}
758
Luc Michel7d8c87d2019-01-07 15:23:45 +0000759static CPUState *gdb_get_cpu(const GDBState *s, uint32_t pid, uint32_t tid)
760{
761 GDBProcess *process;
762 CPUState *cpu;
763
764 if (!tid) {
765 /* 0 means any thread, we take the first one */
766 tid = 1;
767 }
768
769 cpu = find_cpu(tid);
770
771 if (cpu == NULL) {
772 return NULL;
773 }
774
775 process = gdb_get_cpu_process(s, cpu);
776
777 if (process->pid != pid) {
778 return NULL;
779 }
780
781 if (!process->attached) {
782 return NULL;
783 }
784
785 return cpu;
786}
787
Luc Michele40e5202019-01-07 15:23:46 +0000788/* Return the cpu following @cpu, while ignoring unattached processes. */
789static CPUState *gdb_next_attached_cpu(const GDBState *s, CPUState *cpu)
790{
791 cpu = CPU_NEXT(cpu);
792
793 while (cpu) {
794 if (gdb_get_cpu_process(s, cpu)->attached) {
795 break;
796 }
797
798 cpu = CPU_NEXT(cpu);
799 }
800
801 return cpu;
802}
803
804/* Return the first attached cpu */
805static CPUState *gdb_first_attached_cpu(const GDBState *s)
806{
807 CPUState *cpu = first_cpu;
808 GDBProcess *process = gdb_get_cpu_process(s, cpu);
809
810 if (!process->attached) {
811 return gdb_next_attached_cpu(s, cpu);
812 }
813
814 return cpu;
815}
816
Luc Michelc145eea2019-01-07 15:23:46 +0000817static const char *get_feature_xml(const GDBState *s, const char *p,
818 const char **newp, GDBProcess *process)
pbrook56aebc82008-10-11 17:55:29 +0000819{
pbrook56aebc82008-10-11 17:55:29 +0000820 size_t len;
821 int i;
822 const char *name;
Luc Michelc145eea2019-01-07 15:23:46 +0000823 CPUState *cpu = get_first_cpu_in_process(s, process);
824 CPUClass *cc = CPU_GET_CLASS(cpu);
pbrook56aebc82008-10-11 17:55:29 +0000825
826 len = 0;
827 while (p[len] && p[len] != ':')
828 len++;
829 *newp = p + len;
830
831 name = NULL;
832 if (strncmp(p, "target.xml", len) == 0) {
Luc Michelc145eea2019-01-07 15:23:46 +0000833 char *buf = process->target_xml;
834 const size_t buf_sz = sizeof(process->target_xml);
pbrook56aebc82008-10-11 17:55:29 +0000835
Luc Michelc145eea2019-01-07 15:23:46 +0000836 /* Generate the XML description for this CPU. */
837 if (!buf[0]) {
838 GDBRegisterState *r;
839
840 pstrcat(buf, buf_sz,
David Hildenbrandb3820e62015-12-03 13:14:41 +0100841 "<?xml version=\"1.0\"?>"
842 "<!DOCTYPE target SYSTEM \"gdb-target.dtd\">"
843 "<target>");
844 if (cc->gdb_arch_name) {
845 gchar *arch = cc->gdb_arch_name(cpu);
Luc Michelc145eea2019-01-07 15:23:46 +0000846 pstrcat(buf, buf_sz, "<architecture>");
847 pstrcat(buf, buf_sz, arch);
848 pstrcat(buf, buf_sz, "</architecture>");
David Hildenbrandb3820e62015-12-03 13:14:41 +0100849 g_free(arch);
850 }
Luc Michelc145eea2019-01-07 15:23:46 +0000851 pstrcat(buf, buf_sz, "<xi:include href=\"");
852 pstrcat(buf, buf_sz, cc->gdb_core_xml_file);
853 pstrcat(buf, buf_sz, "\"/>");
Andreas Färbereac8b352013-06-28 21:11:37 +0200854 for (r = cpu->gdb_regs; r; r = r->next) {
Luc Michelc145eea2019-01-07 15:23:46 +0000855 pstrcat(buf, buf_sz, "<xi:include href=\"");
856 pstrcat(buf, buf_sz, r->xml);
857 pstrcat(buf, buf_sz, "\"/>");
pbrook56aebc82008-10-11 17:55:29 +0000858 }
Luc Michelc145eea2019-01-07 15:23:46 +0000859 pstrcat(buf, buf_sz, "</target>");
pbrook56aebc82008-10-11 17:55:29 +0000860 }
Luc Michelc145eea2019-01-07 15:23:46 +0000861 return buf;
pbrook56aebc82008-10-11 17:55:29 +0000862 }
Abdallah Bouassida200bf5b2018-05-18 17:48:07 +0100863 if (cc->gdb_get_dynamic_xml) {
Abdallah Bouassida200bf5b2018-05-18 17:48:07 +0100864 char *xmlname = g_strndup(p, len);
865 const char *xml = cc->gdb_get_dynamic_xml(cpu, xmlname);
866
867 g_free(xmlname);
868 if (xml) {
869 return xml;
870 }
871 }
pbrook56aebc82008-10-11 17:55:29 +0000872 for (i = 0; ; i++) {
873 name = xml_builtin[i][0];
874 if (!name || (strncmp(name, p, len) == 0 && strlen(name) == len))
875 break;
876 }
877 return name ? xml_builtin[i][1] : NULL;
878}
pbrook56aebc82008-10-11 17:55:29 +0000879
Andreas Färber385b9f02013-06-27 18:25:36 +0200880static int gdb_read_register(CPUState *cpu, uint8_t *mem_buf, int reg)
pbrook56aebc82008-10-11 17:55:29 +0000881{
Andreas Färbera0e372f2013-06-28 23:18:47 +0200882 CPUClass *cc = CPU_GET_CLASS(cpu);
Andreas Färber385b9f02013-06-27 18:25:36 +0200883 CPUArchState *env = cpu->env_ptr;
pbrook56aebc82008-10-11 17:55:29 +0000884 GDBRegisterState *r;
885
Andreas Färbera0e372f2013-06-28 23:18:47 +0200886 if (reg < cc->gdb_num_core_regs) {
Andreas Färber5b50e792013-06-29 04:18:45 +0200887 return cc->gdb_read_register(cpu, mem_buf, reg);
Andreas Färbera0e372f2013-06-28 23:18:47 +0200888 }
pbrook56aebc82008-10-11 17:55:29 +0000889
Andreas Färbereac8b352013-06-28 21:11:37 +0200890 for (r = cpu->gdb_regs; r; r = r->next) {
pbrook56aebc82008-10-11 17:55:29 +0000891 if (r->base_reg <= reg && reg < r->base_reg + r->num_regs) {
892 return r->get_reg(env, mem_buf, reg - r->base_reg);
893 }
894 }
895 return 0;
896}
897
Andreas Färber385b9f02013-06-27 18:25:36 +0200898static int gdb_write_register(CPUState *cpu, uint8_t *mem_buf, int reg)
pbrook56aebc82008-10-11 17:55:29 +0000899{
Andreas Färbera0e372f2013-06-28 23:18:47 +0200900 CPUClass *cc = CPU_GET_CLASS(cpu);
Andreas Färber385b9f02013-06-27 18:25:36 +0200901 CPUArchState *env = cpu->env_ptr;
pbrook56aebc82008-10-11 17:55:29 +0000902 GDBRegisterState *r;
903
Andreas Färbera0e372f2013-06-28 23:18:47 +0200904 if (reg < cc->gdb_num_core_regs) {
Andreas Färber5b50e792013-06-29 04:18:45 +0200905 return cc->gdb_write_register(cpu, mem_buf, reg);
Andreas Färbera0e372f2013-06-28 23:18:47 +0200906 }
pbrook56aebc82008-10-11 17:55:29 +0000907
Andreas Färbereac8b352013-06-28 21:11:37 +0200908 for (r = cpu->gdb_regs; r; r = r->next) {
pbrook56aebc82008-10-11 17:55:29 +0000909 if (r->base_reg <= reg && reg < r->base_reg + r->num_regs) {
910 return r->set_reg(env, mem_buf, reg - r->base_reg);
911 }
912 }
913 return 0;
914}
915
916/* Register a supplemental set of CPU registers. If g_pos is nonzero it
917 specifies the first register number and these registers are included in
918 a standard "g" packet. Direction is relative to gdb, i.e. get_reg is
919 gdb reading a CPU register, and set_reg is gdb modifying a CPU register.
920 */
921
Andreas Färber22169d42013-06-28 21:27:39 +0200922void gdb_register_coprocessor(CPUState *cpu,
923 gdb_reg_cb get_reg, gdb_reg_cb set_reg,
924 int num_regs, const char *xml, int g_pos)
pbrook56aebc82008-10-11 17:55:29 +0000925{
926 GDBRegisterState *s;
927 GDBRegisterState **p;
pbrook56aebc82008-10-11 17:55:29 +0000928
Andreas Färbereac8b352013-06-28 21:11:37 +0200929 p = &cpu->gdb_regs;
pbrook56aebc82008-10-11 17:55:29 +0000930 while (*p) {
931 /* Check for duplicates. */
932 if (strcmp((*p)->xml, xml) == 0)
933 return;
934 p = &(*p)->next;
935 }
Stefan Weil9643c252011-10-18 22:25:38 +0200936
937 s = g_new0(GDBRegisterState, 1);
Andreas Färbera0e372f2013-06-28 23:18:47 +0200938 s->base_reg = cpu->gdb_num_regs;
Stefan Weil9643c252011-10-18 22:25:38 +0200939 s->num_regs = num_regs;
940 s->get_reg = get_reg;
941 s->set_reg = set_reg;
942 s->xml = xml;
943
pbrook56aebc82008-10-11 17:55:29 +0000944 /* Add to end of list. */
Andreas Färbera0e372f2013-06-28 23:18:47 +0200945 cpu->gdb_num_regs += num_regs;
pbrook56aebc82008-10-11 17:55:29 +0000946 *p = s;
947 if (g_pos) {
948 if (g_pos != s->base_reg) {
Ziyue Yang7ae6c572017-01-18 16:03:29 +0800949 error_report("Error: Bad gdb register numbering for '%s', "
950 "expected %d got %d", xml, g_pos, s->base_reg);
Andreas Färber35143f02013-08-12 18:09:47 +0200951 } else {
952 cpu->gdb_num_g_regs = cpu->gdb_num_regs;
pbrook56aebc82008-10-11 17:55:29 +0000953 }
954 }
955}
956
aliguoria1d1bb32008-11-18 20:07:32 +0000957#ifndef CONFIG_USER_ONLY
Peter Maydell2472b6c2014-09-12 19:04:17 +0100958/* Translate GDB watchpoint type to a flags value for cpu_watchpoint_* */
959static inline int xlat_gdb_type(CPUState *cpu, int gdbtype)
960{
961 static const int xlat[] = {
962 [GDB_WATCHPOINT_WRITE] = BP_GDB | BP_MEM_WRITE,
963 [GDB_WATCHPOINT_READ] = BP_GDB | BP_MEM_READ,
964 [GDB_WATCHPOINT_ACCESS] = BP_GDB | BP_MEM_ACCESS,
965 };
966
967 CPUClass *cc = CPU_GET_CLASS(cpu);
968 int cputype = xlat[gdbtype];
969
970 if (cc->gdb_stop_before_watchpoint) {
971 cputype |= BP_STOP_BEFORE_ACCESS;
972 }
973 return cputype;
974}
aliguoria1d1bb32008-11-18 20:07:32 +0000975#endif
976
aliguori880a7572008-11-18 20:30:24 +0000977static int gdb_breakpoint_insert(target_ulong addr, target_ulong len, int type)
aliguoria1d1bb32008-11-18 20:07:32 +0000978{
Andreas Färber182735e2013-05-29 22:29:20 +0200979 CPUState *cpu;
aliguori880a7572008-11-18 20:30:24 +0000980 int err = 0;
981
Andreas Färber62278812013-06-27 17:12:06 +0200982 if (kvm_enabled()) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +0200983 return kvm_insert_breakpoint(gdbserver_state->c_cpu, addr, len, type);
Andreas Färber62278812013-06-27 17:12:06 +0200984 }
aliguorie22a25c2009-03-12 20:12:48 +0000985
aliguoria1d1bb32008-11-18 20:07:32 +0000986 switch (type) {
987 case GDB_BREAKPOINT_SW:
988 case GDB_BREAKPOINT_HW:
Andreas Färberbdc44642013-06-24 23:50:24 +0200989 CPU_FOREACH(cpu) {
Andreas Färberb3310ab2013-09-02 17:26:20 +0200990 err = cpu_breakpoint_insert(cpu, addr, BP_GDB, NULL);
991 if (err) {
aliguori880a7572008-11-18 20:30:24 +0000992 break;
Andreas Färberb3310ab2013-09-02 17:26:20 +0200993 }
aliguori880a7572008-11-18 20:30:24 +0000994 }
995 return err;
aliguoria1d1bb32008-11-18 20:07:32 +0000996#ifndef CONFIG_USER_ONLY
997 case GDB_WATCHPOINT_WRITE:
998 case GDB_WATCHPOINT_READ:
999 case GDB_WATCHPOINT_ACCESS:
Andreas Färberbdc44642013-06-24 23:50:24 +02001000 CPU_FOREACH(cpu) {
Peter Maydell2472b6c2014-09-12 19:04:17 +01001001 err = cpu_watchpoint_insert(cpu, addr, len,
1002 xlat_gdb_type(cpu, type), NULL);
1003 if (err) {
aliguori880a7572008-11-18 20:30:24 +00001004 break;
Peter Maydell2472b6c2014-09-12 19:04:17 +01001005 }
aliguori880a7572008-11-18 20:30:24 +00001006 }
1007 return err;
aliguoria1d1bb32008-11-18 20:07:32 +00001008#endif
1009 default:
1010 return -ENOSYS;
1011 }
1012}
1013
aliguori880a7572008-11-18 20:30:24 +00001014static int gdb_breakpoint_remove(target_ulong addr, target_ulong len, int type)
aliguoria1d1bb32008-11-18 20:07:32 +00001015{
Andreas Färber182735e2013-05-29 22:29:20 +02001016 CPUState *cpu;
aliguori880a7572008-11-18 20:30:24 +00001017 int err = 0;
1018
Andreas Färber62278812013-06-27 17:12:06 +02001019 if (kvm_enabled()) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001020 return kvm_remove_breakpoint(gdbserver_state->c_cpu, addr, len, type);
Andreas Färber62278812013-06-27 17:12:06 +02001021 }
aliguorie22a25c2009-03-12 20:12:48 +00001022
aliguoria1d1bb32008-11-18 20:07:32 +00001023 switch (type) {
1024 case GDB_BREAKPOINT_SW:
1025 case GDB_BREAKPOINT_HW:
Andreas Färberbdc44642013-06-24 23:50:24 +02001026 CPU_FOREACH(cpu) {
Andreas Färberb3310ab2013-09-02 17:26:20 +02001027 err = cpu_breakpoint_remove(cpu, addr, BP_GDB);
1028 if (err) {
aliguori880a7572008-11-18 20:30:24 +00001029 break;
Andreas Färberb3310ab2013-09-02 17:26:20 +02001030 }
aliguori880a7572008-11-18 20:30:24 +00001031 }
1032 return err;
aliguoria1d1bb32008-11-18 20:07:32 +00001033#ifndef CONFIG_USER_ONLY
1034 case GDB_WATCHPOINT_WRITE:
1035 case GDB_WATCHPOINT_READ:
1036 case GDB_WATCHPOINT_ACCESS:
Andreas Färberbdc44642013-06-24 23:50:24 +02001037 CPU_FOREACH(cpu) {
Peter Maydell2472b6c2014-09-12 19:04:17 +01001038 err = cpu_watchpoint_remove(cpu, addr, len,
1039 xlat_gdb_type(cpu, type));
aliguori880a7572008-11-18 20:30:24 +00001040 if (err)
1041 break;
1042 }
1043 return err;
aliguoria1d1bb32008-11-18 20:07:32 +00001044#endif
1045 default:
1046 return -ENOSYS;
1047 }
1048}
1049
Luc Michel546f3c62019-01-07 15:23:46 +00001050static inline void gdb_cpu_breakpoint_remove_all(CPUState *cpu)
1051{
1052 cpu_breakpoint_remove_all(cpu, BP_GDB);
1053#ifndef CONFIG_USER_ONLY
1054 cpu_watchpoint_remove_all(cpu, BP_GDB);
1055#endif
1056}
1057
1058static void gdb_process_breakpoint_remove_all(const GDBState *s, GDBProcess *p)
1059{
1060 CPUState *cpu = get_first_cpu_in_process(s, p);
1061
1062 while (cpu) {
1063 gdb_cpu_breakpoint_remove_all(cpu);
1064 cpu = gdb_next_cpu_in_process(s, cpu);
1065 }
1066}
1067
aliguori880a7572008-11-18 20:30:24 +00001068static void gdb_breakpoint_remove_all(void)
aliguoria1d1bb32008-11-18 20:07:32 +00001069{
Andreas Färber182735e2013-05-29 22:29:20 +02001070 CPUState *cpu;
aliguori880a7572008-11-18 20:30:24 +00001071
aliguorie22a25c2009-03-12 20:12:48 +00001072 if (kvm_enabled()) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001073 kvm_remove_all_breakpoints(gdbserver_state->c_cpu);
aliguorie22a25c2009-03-12 20:12:48 +00001074 return;
1075 }
1076
Andreas Färberbdc44642013-06-24 23:50:24 +02001077 CPU_FOREACH(cpu) {
Luc Michel546f3c62019-01-07 15:23:46 +00001078 gdb_cpu_breakpoint_remove_all(cpu);
aliguori880a7572008-11-18 20:30:24 +00001079 }
aliguoria1d1bb32008-11-18 20:07:32 +00001080}
1081
aurel32fab9d282009-04-08 21:29:37 +00001082static void gdb_set_cpu_pc(GDBState *s, target_ulong pc)
1083{
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001084 CPUState *cpu = s->c_cpu;
Andreas Färberf45748f2013-06-21 19:09:18 +02001085
1086 cpu_synchronize_state(cpu);
Peter Crosthwaite4a2b24e2015-06-23 20:19:21 -07001087 cpu_set_pc(cpu, pc);
aurel32fab9d282009-04-08 21:29:37 +00001088}
1089
Luc Michel1a227332019-01-07 15:23:45 +00001090static char *gdb_fmt_thread_id(const GDBState *s, CPUState *cpu,
1091 char *buf, size_t buf_size)
1092{
1093 if (s->multiprocess) {
1094 snprintf(buf, buf_size, "p%02x.%02x",
1095 gdb_get_cpu_pid(s, cpu), cpu_gdb_index(cpu));
1096 } else {
1097 snprintf(buf, buf_size, "%02x", cpu_gdb_index(cpu));
1098 }
1099
1100 return buf;
1101}
1102
Luc Michel7d8c87d2019-01-07 15:23:45 +00001103typedef enum GDBThreadIdKind {
1104 GDB_ONE_THREAD = 0,
1105 GDB_ALL_THREADS, /* One process, all threads */
1106 GDB_ALL_PROCESSES,
1107 GDB_READ_THREAD_ERR
1108} GDBThreadIdKind;
1109
1110static GDBThreadIdKind read_thread_id(const char *buf, const char **end_buf,
1111 uint32_t *pid, uint32_t *tid)
1112{
1113 unsigned long p, t;
1114 int ret;
1115
1116 if (*buf == 'p') {
1117 buf++;
1118 ret = qemu_strtoul(buf, &buf, 16, &p);
1119
1120 if (ret) {
1121 return GDB_READ_THREAD_ERR;
1122 }
1123
1124 /* Skip '.' */
1125 buf++;
1126 } else {
1127 p = 1;
1128 }
1129
1130 ret = qemu_strtoul(buf, &buf, 16, &t);
1131
1132 if (ret) {
1133 return GDB_READ_THREAD_ERR;
1134 }
1135
1136 *end_buf = buf;
1137
1138 if (p == -1) {
1139 return GDB_ALL_PROCESSES;
1140 }
1141
1142 if (pid) {
1143 *pid = p;
1144 }
1145
1146 if (t == -1) {
1147 return GDB_ALL_THREADS;
1148 }
1149
1150 if (tid) {
1151 *tid = t;
1152 }
1153
1154 return GDB_ONE_THREAD;
1155}
1156
Jan Kiszka4dabe742015-02-07 09:38:43 +01001157static int is_query_packet(const char *p, const char *query, char separator)
1158{
1159 unsigned int query_len = strlen(query);
1160
1161 return strncmp(p, query, query_len) == 0 &&
1162 (p[query_len] == '\0' || p[query_len] == separator);
1163}
1164
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001165/**
1166 * gdb_handle_vcont - Parses and handles a vCont packet.
1167 * returns -ENOTSUP if a command is unsupported, -EINVAL or -ERANGE if there is
1168 * a format error, 0 on success.
1169 */
1170static int gdb_handle_vcont(GDBState *s, const char *p)
1171{
Luc Michele40e5202019-01-07 15:23:46 +00001172 int res, signal = 0;
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001173 char cur_action;
1174 char *newstates;
1175 unsigned long tmp;
Luc Michele40e5202019-01-07 15:23:46 +00001176 uint32_t pid, tid;
1177 GDBProcess *process;
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001178 CPUState *cpu;
1179#ifdef CONFIG_USER_ONLY
1180 int max_cpus = 1; /* global variable max_cpus exists only in system mode */
1181
1182 CPU_FOREACH(cpu) {
1183 max_cpus = max_cpus <= cpu->cpu_index ? cpu->cpu_index + 1 : max_cpus;
1184 }
1185#endif
1186 /* uninitialised CPUs stay 0 */
1187 newstates = g_new0(char, max_cpus);
1188
1189 /* mark valid CPUs with 1 */
1190 CPU_FOREACH(cpu) {
1191 newstates[cpu->cpu_index] = 1;
1192 }
1193
1194 /*
1195 * res keeps track of what error we are returning, with -ENOTSUP meaning
1196 * that the command is unknown or unsupported, thus returning an empty
1197 * packet, while -EINVAL and -ERANGE cause an E22 packet, due to invalid,
1198 * or incorrect parameters passed.
1199 */
1200 res = 0;
1201 while (*p) {
1202 if (*p++ != ';') {
1203 res = -ENOTSUP;
1204 goto out;
1205 }
1206
1207 cur_action = *p++;
1208 if (cur_action == 'C' || cur_action == 'S') {
Peter Maydell95a5bef2017-07-20 17:31:30 +01001209 cur_action = qemu_tolower(cur_action);
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001210 res = qemu_strtoul(p + 1, &p, 16, &tmp);
1211 if (res) {
1212 goto out;
1213 }
1214 signal = gdb_signal_to_target(tmp);
1215 } else if (cur_action != 'c' && cur_action != 's') {
1216 /* unknown/invalid/unsupported command */
1217 res = -ENOTSUP;
1218 goto out;
1219 }
Luc Michele40e5202019-01-07 15:23:46 +00001220
1221 if (*p++ != ':') {
1222 res = -ENOTSUP;
1223 goto out;
1224 }
1225
1226 switch (read_thread_id(p, &p, &pid, &tid)) {
1227 case GDB_READ_THREAD_ERR:
1228 res = -EINVAL;
1229 goto out;
1230
1231 case GDB_ALL_PROCESSES:
1232 cpu = gdb_first_attached_cpu(s);
1233 while (cpu) {
1234 if (newstates[cpu->cpu_index] == 1) {
1235 newstates[cpu->cpu_index] = cur_action;
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001236 }
Luc Michele40e5202019-01-07 15:23:46 +00001237
1238 cpu = gdb_next_attached_cpu(s, cpu);
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001239 }
Luc Michele40e5202019-01-07 15:23:46 +00001240 break;
1241
1242 case GDB_ALL_THREADS:
1243 process = gdb_get_process(s, pid);
1244
1245 if (!process->attached) {
1246 res = -EINVAL;
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001247 goto out;
1248 }
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001249
Luc Michele40e5202019-01-07 15:23:46 +00001250 cpu = get_first_cpu_in_process(s, process);
1251 while (cpu) {
1252 if (newstates[cpu->cpu_index] == 1) {
1253 newstates[cpu->cpu_index] = cur_action;
1254 }
1255
1256 cpu = gdb_next_cpu_in_process(s, cpu);
1257 }
1258 break;
1259
1260 case GDB_ONE_THREAD:
1261 cpu = gdb_get_cpu(s, pid, tid);
Alex Bennée5a6a1ad2017-07-12 11:52:16 +01001262
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001263 /* invalid CPU/thread specified */
Alex Bennée5a6a1ad2017-07-12 11:52:16 +01001264 if (!cpu) {
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001265 res = -EINVAL;
1266 goto out;
1267 }
Alex Bennée5a6a1ad2017-07-12 11:52:16 +01001268
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001269 /* only use if no previous match occourred */
1270 if (newstates[cpu->cpu_index] == 1) {
1271 newstates[cpu->cpu_index] = cur_action;
1272 }
Luc Michele40e5202019-01-07 15:23:46 +00001273 break;
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001274 }
1275 }
1276 s->signal = signal;
1277 gdb_continue_partial(s, newstates);
1278
1279out:
1280 g_free(newstates);
1281
1282 return res;
1283}
1284
aliguori880a7572008-11-18 20:30:24 +00001285static int gdb_handle_packet(GDBState *s, const char *line_buf)
bellardb4608c02003-06-27 17:34:32 +00001286{
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001287 CPUState *cpu;
Luc Michelc145eea2019-01-07 15:23:46 +00001288 GDBProcess *process;
Andreas Färber5b24c642013-07-07 15:08:22 +02001289 CPUClass *cc;
bellardb4608c02003-06-27 17:34:32 +00001290 const char *p;
Luc Michel7d8c87d2019-01-07 15:23:45 +00001291 uint32_t pid, tid;
Nathan Froyd1e9fa732009-06-03 11:33:08 -07001292 int ch, reg_size, type, res;
pbrook56aebc82008-10-11 17:55:29 +00001293 uint8_t mem_buf[MAX_PACKET_LENGTH];
Philippe Mathieu-Daudé90057742018-04-08 11:59:33 -03001294 char buf[sizeof(mem_buf) + 1 /* trailing NUL */];
Luc Michel1a227332019-01-07 15:23:45 +00001295 char thread_id[16];
pbrook56aebc82008-10-11 17:55:29 +00001296 uint8_t *registers;
bellard9d9754a2006-06-25 15:32:37 +00001297 target_ulong addr, len;
Luc Michel7d8c87d2019-01-07 15:23:45 +00001298 GDBThreadIdKind thread_kind;
ths3b46e622007-09-17 08:09:54 +00001299
Doug Gale5c9522b2017-12-02 20:30:37 -05001300 trace_gdbstub_io_command(line_buf);
Alex Bennée118e2262017-07-12 11:52:13 +01001301
bellard858693c2004-03-31 18:52:07 +00001302 p = line_buf;
1303 ch = *p++;
1304 switch(ch) {
Luc Michel53fd6552019-01-07 15:23:46 +00001305 case '!':
1306 put_packet(s, "OK");
1307 break;
bellard858693c2004-03-31 18:52:07 +00001308 case '?':
bellard1fddef42005-04-17 19:16:13 +00001309 /* TODO: Make this return the correct value for user-mode. */
Luc Michel1a227332019-01-07 15:23:45 +00001310 snprintf(buf, sizeof(buf), "T%02xthread:%s;", GDB_SIGNAL_TRAP,
1311 gdb_fmt_thread_id(s, s->c_cpu, thread_id, sizeof(thread_id)));
bellard858693c2004-03-31 18:52:07 +00001312 put_packet(s, buf);
edgar_igl7d03f822008-05-17 18:58:29 +00001313 /* Remove all the breakpoints when this query is issued,
1314 * because gdb is doing and initial connect and the state
1315 * should be cleaned up.
1316 */
aliguori880a7572008-11-18 20:30:24 +00001317 gdb_breakpoint_remove_all();
bellard858693c2004-03-31 18:52:07 +00001318 break;
1319 case 'c':
1320 if (*p != '\0') {
bellard9d9754a2006-06-25 15:32:37 +00001321 addr = strtoull(p, (char **)&p, 16);
aurel32fab9d282009-04-08 21:29:37 +00001322 gdb_set_cpu_pc(s, addr);
bellard858693c2004-03-31 18:52:07 +00001323 }
aurel32ca587a82008-12-18 22:44:13 +00001324 s->signal = 0;
edgar_iglba70a622008-03-14 06:10:42 +00001325 gdb_continue(s);
Doug Gale5c9522b2017-12-02 20:30:37 -05001326 return RS_IDLE;
edgar_igl1f487ee2008-05-17 22:20:53 +00001327 case 'C':
aurel32ca587a82008-12-18 22:44:13 +00001328 s->signal = gdb_signal_to_target (strtoul(p, (char **)&p, 16));
1329 if (s->signal == -1)
1330 s->signal = 0;
edgar_igl1f487ee2008-05-17 22:20:53 +00001331 gdb_continue(s);
1332 return RS_IDLE;
Jan Kiszkadd32aa12009-06-27 09:53:51 +02001333 case 'v':
1334 if (strncmp(p, "Cont", 4) == 0) {
Jan Kiszkadd32aa12009-06-27 09:53:51 +02001335 p += 4;
1336 if (*p == '?') {
1337 put_packet(s, "vCont;c;C;s;S");
1338 break;
1339 }
Jan Kiszkadd32aa12009-06-27 09:53:51 +02001340
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001341 res = gdb_handle_vcont(s, p);
1342
Jan Kiszkadd32aa12009-06-27 09:53:51 +02001343 if (res) {
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001344 if ((res == -EINVAL) || (res == -ERANGE)) {
1345 put_packet(s, "E22");
1346 break;
Jan Kiszkadd32aa12009-06-27 09:53:51 +02001347 }
Claudio Imbrenda544177a2017-02-14 18:07:48 +01001348 goto unknown_command;
Jan Kiszkadd32aa12009-06-27 09:53:51 +02001349 }
1350 break;
Luc Michel3f940dc2019-01-07 15:23:46 +00001351 } else if (strncmp(p, "Attach;", 7) == 0) {
1352 unsigned long pid;
1353
1354 p += 7;
1355
1356 if (qemu_strtoul(p, &p, 16, &pid)) {
1357 put_packet(s, "E22");
1358 break;
1359 }
1360
1361 process = gdb_get_process(s, pid);
1362
1363 if (process == NULL) {
1364 put_packet(s, "E22");
1365 break;
1366 }
1367
1368 cpu = get_first_cpu_in_process(s, process);
1369
1370 if (cpu == NULL) {
1371 /* Refuse to attach an empty process */
1372 put_packet(s, "E22");
1373 break;
1374 }
1375
1376 process->attached = true;
1377
1378 s->g_cpu = cpu;
1379 s->c_cpu = cpu;
1380
1381 snprintf(buf, sizeof(buf), "T%02xthread:%s;", GDB_SIGNAL_TRAP,
1382 gdb_fmt_thread_id(s, cpu, thread_id, sizeof(thread_id)));
1383
1384 put_packet(s, buf);
1385 break;
Jan Kiszkadd32aa12009-06-27 09:53:51 +02001386 } else {
1387 goto unknown_command;
1388 }
edgar_igl7d03f822008-05-17 18:58:29 +00001389 case 'k':
1390 /* Kill the target */
Ziyue Yang7ae6c572017-01-18 16:03:29 +08001391 error_report("QEMU: Terminated via GDBstub");
edgar_igl7d03f822008-05-17 18:58:29 +00001392 exit(0);
1393 case 'D':
1394 /* Detach packet */
Luc Michel546f3c62019-01-07 15:23:46 +00001395 pid = 1;
1396
1397 if (s->multiprocess) {
1398 unsigned long lpid;
1399 if (*p != ';') {
1400 put_packet(s, "E22");
1401 break;
1402 }
1403
1404 if (qemu_strtoul(p + 1, &p, 16, &lpid)) {
1405 put_packet(s, "E22");
1406 break;
1407 }
1408
1409 pid = lpid;
1410 }
1411
1412 process = gdb_get_process(s, pid);
1413 gdb_process_breakpoint_remove_all(s, process);
1414 process->attached = false;
1415
1416 if (pid == gdb_get_cpu_pid(s, s->c_cpu)) {
1417 s->c_cpu = gdb_first_attached_cpu(s);
1418 }
1419
1420 if (pid == gdb_get_cpu_pid(s, s->g_cpu)) {
1421 s->g_cpu = gdb_first_attached_cpu(s);
1422 }
1423
1424 if (s->c_cpu == NULL) {
1425 /* No more process attached */
1426 gdb_syscall_mode = GDB_SYS_DISABLED;
1427 gdb_continue(s);
1428 }
edgar_igl7d03f822008-05-17 18:58:29 +00001429 put_packet(s, "OK");
1430 break;
bellard858693c2004-03-31 18:52:07 +00001431 case 's':
1432 if (*p != '\0') {
ths8fac5802007-07-12 10:05:07 +00001433 addr = strtoull(p, (char **)&p, 16);
aurel32fab9d282009-04-08 21:29:37 +00001434 gdb_set_cpu_pc(s, addr);
bellard858693c2004-03-31 18:52:07 +00001435 }
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001436 cpu_single_step(s->c_cpu, sstep_flags);
edgar_iglba70a622008-03-14 06:10:42 +00001437 gdb_continue(s);
Doug Gale5c9522b2017-12-02 20:30:37 -05001438 return RS_IDLE;
pbrooka2d1eba2007-01-28 03:10:55 +00001439 case 'F':
1440 {
1441 target_ulong ret;
1442 target_ulong err;
1443
1444 ret = strtoull(p, (char **)&p, 16);
1445 if (*p == ',') {
1446 p++;
1447 err = strtoull(p, (char **)&p, 16);
1448 } else {
1449 err = 0;
1450 }
1451 if (*p == ',')
1452 p++;
1453 type = *p;
Meador Ingecdb432b2012-03-15 17:49:45 +00001454 if (s->current_syscall_cb) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001455 s->current_syscall_cb(s->c_cpu, ret, err);
Meador Ingecdb432b2012-03-15 17:49:45 +00001456 s->current_syscall_cb = NULL;
1457 }
pbrooka2d1eba2007-01-28 03:10:55 +00001458 if (type == 'C') {
1459 put_packet(s, "T02");
1460 } else {
edgar_iglba70a622008-03-14 06:10:42 +00001461 gdb_continue(s);
pbrooka2d1eba2007-01-28 03:10:55 +00001462 }
1463 }
1464 break;
bellard858693c2004-03-31 18:52:07 +00001465 case 'g':
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001466 cpu_synchronize_state(s->g_cpu);
pbrook56aebc82008-10-11 17:55:29 +00001467 len = 0;
Andreas Färber35143f02013-08-12 18:09:47 +02001468 for (addr = 0; addr < s->g_cpu->gdb_num_g_regs; addr++) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001469 reg_size = gdb_read_register(s->g_cpu, mem_buf + len, addr);
pbrook56aebc82008-10-11 17:55:29 +00001470 len += reg_size;
1471 }
1472 memtohex(buf, mem_buf, len);
bellard858693c2004-03-31 18:52:07 +00001473 put_packet(s, buf);
1474 break;
1475 case 'G':
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001476 cpu_synchronize_state(s->g_cpu);
pbrook56aebc82008-10-11 17:55:29 +00001477 registers = mem_buf;
bellard858693c2004-03-31 18:52:07 +00001478 len = strlen(p) / 2;
1479 hextomem((uint8_t *)registers, p, len);
Andreas Färber35143f02013-08-12 18:09:47 +02001480 for (addr = 0; addr < s->g_cpu->gdb_num_g_regs && len > 0; addr++) {
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001481 reg_size = gdb_write_register(s->g_cpu, registers, addr);
pbrook56aebc82008-10-11 17:55:29 +00001482 len -= reg_size;
1483 registers += reg_size;
1484 }
bellard858693c2004-03-31 18:52:07 +00001485 put_packet(s, "OK");
1486 break;
1487 case 'm':
bellard9d9754a2006-06-25 15:32:37 +00001488 addr = strtoull(p, (char **)&p, 16);
bellard858693c2004-03-31 18:52:07 +00001489 if (*p == ',')
1490 p++;
bellard9d9754a2006-06-25 15:32:37 +00001491 len = strtoull(p, NULL, 16);
Kevin Wolf5accecb2015-10-13 09:38:50 +02001492
1493 /* memtohex() doubles the required space */
1494 if (len > MAX_PACKET_LENGTH / 2) {
1495 put_packet (s, "E22");
1496 break;
1497 }
1498
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001499 if (target_memory_rw_debug(s->g_cpu, addr, mem_buf, len, false) != 0) {
bellard6f970bd2005-12-05 19:55:19 +00001500 put_packet (s, "E14");
1501 } else {
1502 memtohex(buf, mem_buf, len);
1503 put_packet(s, buf);
1504 }
bellard858693c2004-03-31 18:52:07 +00001505 break;
1506 case 'M':
bellard9d9754a2006-06-25 15:32:37 +00001507 addr = strtoull(p, (char **)&p, 16);
bellard858693c2004-03-31 18:52:07 +00001508 if (*p == ',')
1509 p++;
bellard9d9754a2006-06-25 15:32:37 +00001510 len = strtoull(p, (char **)&p, 16);
bellardb328f872005-01-17 22:03:16 +00001511 if (*p == ':')
bellard858693c2004-03-31 18:52:07 +00001512 p++;
Kevin Wolf5accecb2015-10-13 09:38:50 +02001513
1514 /* hextomem() reads 2*len bytes */
1515 if (len > strlen(p) / 2) {
1516 put_packet (s, "E22");
1517 break;
1518 }
bellard858693c2004-03-31 18:52:07 +00001519 hextomem(mem_buf, p, len);
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001520 if (target_memory_rw_debug(s->g_cpu, addr, mem_buf, len,
Andreas Färberf3659ee2013-06-27 19:09:09 +02001521 true) != 0) {
bellard905f20b2005-04-26 21:09:55 +00001522 put_packet(s, "E14");
Fabien Chouteau44520db2011-09-08 12:48:16 +02001523 } else {
bellard858693c2004-03-31 18:52:07 +00001524 put_packet(s, "OK");
Fabien Chouteau44520db2011-09-08 12:48:16 +02001525 }
bellard858693c2004-03-31 18:52:07 +00001526 break;
pbrook56aebc82008-10-11 17:55:29 +00001527 case 'p':
1528 /* Older gdb are really dumb, and don't use 'g' if 'p' is avaialable.
1529 This works, but can be very slow. Anything new enough to
1530 understand XML also knows how to use this properly. */
1531 if (!gdb_has_xml)
1532 goto unknown_command;
1533 addr = strtoull(p, (char **)&p, 16);
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001534 reg_size = gdb_read_register(s->g_cpu, mem_buf, addr);
pbrook56aebc82008-10-11 17:55:29 +00001535 if (reg_size) {
1536 memtohex(buf, mem_buf, reg_size);
1537 put_packet(s, buf);
1538 } else {
1539 put_packet(s, "E14");
1540 }
1541 break;
1542 case 'P':
1543 if (!gdb_has_xml)
1544 goto unknown_command;
1545 addr = strtoull(p, (char **)&p, 16);
1546 if (*p == '=')
1547 p++;
1548 reg_size = strlen(p) / 2;
1549 hextomem(mem_buf, p, reg_size);
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001550 gdb_write_register(s->g_cpu, mem_buf, addr);
pbrook56aebc82008-10-11 17:55:29 +00001551 put_packet(s, "OK");
1552 break;
bellard858693c2004-03-31 18:52:07 +00001553 case 'Z':
bellard858693c2004-03-31 18:52:07 +00001554 case 'z':
1555 type = strtoul(p, (char **)&p, 16);
1556 if (*p == ',')
1557 p++;
bellard9d9754a2006-06-25 15:32:37 +00001558 addr = strtoull(p, (char **)&p, 16);
bellard858693c2004-03-31 18:52:07 +00001559 if (*p == ',')
1560 p++;
bellard9d9754a2006-06-25 15:32:37 +00001561 len = strtoull(p, (char **)&p, 16);
aliguoria1d1bb32008-11-18 20:07:32 +00001562 if (ch == 'Z')
aliguori880a7572008-11-18 20:30:24 +00001563 res = gdb_breakpoint_insert(addr, len, type);
aliguoria1d1bb32008-11-18 20:07:32 +00001564 else
aliguori880a7572008-11-18 20:30:24 +00001565 res = gdb_breakpoint_remove(addr, len, type);
aliguoria1d1bb32008-11-18 20:07:32 +00001566 if (res >= 0)
1567 put_packet(s, "OK");
1568 else if (res == -ENOSYS)
pbrook0f459d12008-06-09 00:20:13 +00001569 put_packet(s, "");
aliguoria1d1bb32008-11-18 20:07:32 +00001570 else
1571 put_packet(s, "E22");
bellard858693c2004-03-31 18:52:07 +00001572 break;
aliguori880a7572008-11-18 20:30:24 +00001573 case 'H':
1574 type = *p++;
Luc Michel7d8c87d2019-01-07 15:23:45 +00001575
1576 thread_kind = read_thread_id(p, &p, &pid, &tid);
1577 if (thread_kind == GDB_READ_THREAD_ERR) {
1578 put_packet(s, "E22");
1579 break;
1580 }
1581
1582 if (thread_kind != GDB_ONE_THREAD) {
aliguori880a7572008-11-18 20:30:24 +00001583 put_packet(s, "OK");
1584 break;
1585 }
Luc Michel7d8c87d2019-01-07 15:23:45 +00001586 cpu = gdb_get_cpu(s, pid, tid);
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001587 if (cpu == NULL) {
aliguori880a7572008-11-18 20:30:24 +00001588 put_packet(s, "E22");
1589 break;
1590 }
1591 switch (type) {
1592 case 'c':
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001593 s->c_cpu = cpu;
aliguori880a7572008-11-18 20:30:24 +00001594 put_packet(s, "OK");
1595 break;
1596 case 'g':
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001597 s->g_cpu = cpu;
aliguori880a7572008-11-18 20:30:24 +00001598 put_packet(s, "OK");
1599 break;
1600 default:
1601 put_packet(s, "E22");
1602 break;
1603 }
1604 break;
1605 case 'T':
Luc Michel7d8c87d2019-01-07 15:23:45 +00001606 thread_kind = read_thread_id(p, &p, &pid, &tid);
1607 if (thread_kind == GDB_READ_THREAD_ERR) {
1608 put_packet(s, "E22");
1609 break;
1610 }
1611 cpu = gdb_get_cpu(s, pid, tid);
Nathan Froyd1e9fa732009-06-03 11:33:08 -07001612
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001613 if (cpu != NULL) {
Nathan Froyd1e9fa732009-06-03 11:33:08 -07001614 put_packet(s, "OK");
1615 } else {
aliguori880a7572008-11-18 20:30:24 +00001616 put_packet(s, "E22");
Nathan Froyd1e9fa732009-06-03 11:33:08 -07001617 }
aliguori880a7572008-11-18 20:30:24 +00001618 break;
pbrook978efd62006-06-17 18:30:42 +00001619 case 'q':
edgar_igl60897d32008-05-09 08:25:14 +00001620 case 'Q':
1621 /* parse any 'q' packets here */
1622 if (!strcmp(p,"qemu.sstepbits")) {
1623 /* Query Breakpoint bit definitions */
blueswir1363a37d2008-08-21 17:58:08 +00001624 snprintf(buf, sizeof(buf), "ENABLE=%x,NOIRQ=%x,NOTIMER=%x",
1625 SSTEP_ENABLE,
1626 SSTEP_NOIRQ,
1627 SSTEP_NOTIMER);
edgar_igl60897d32008-05-09 08:25:14 +00001628 put_packet(s, buf);
1629 break;
Jan Kiszka4dabe742015-02-07 09:38:43 +01001630 } else if (is_query_packet(p, "qemu.sstep", '=')) {
edgar_igl60897d32008-05-09 08:25:14 +00001631 /* Display or change the sstep_flags */
1632 p += 10;
1633 if (*p != '=') {
1634 /* Display current setting */
blueswir1363a37d2008-08-21 17:58:08 +00001635 snprintf(buf, sizeof(buf), "0x%x", sstep_flags);
edgar_igl60897d32008-05-09 08:25:14 +00001636 put_packet(s, buf);
1637 break;
1638 }
1639 p++;
1640 type = strtoul(p, (char **)&p, 16);
1641 sstep_flags = type;
1642 put_packet(s, "OK");
1643 break;
aliguori880a7572008-11-18 20:30:24 +00001644 } else if (strcmp(p,"C") == 0) {
Luc Michel8dbbe9a2019-01-07 15:23:46 +00001645 /*
1646 * "Current thread" remains vague in the spec, so always return
1647 * the first thread of the current process (gdb returns the
1648 * first thread).
1649 */
1650 cpu = get_first_cpu_in_process(s, gdb_get_cpu_process(s, s->g_cpu));
1651 snprintf(buf, sizeof(buf), "QC%s",
1652 gdb_fmt_thread_id(s, cpu, thread_id, sizeof(thread_id)));
1653 put_packet(s, buf);
aliguori880a7572008-11-18 20:30:24 +00001654 break;
1655 } else if (strcmp(p,"fThreadInfo") == 0) {
Luc Michel7cf48f62019-01-07 15:23:46 +00001656 s->query_cpu = gdb_first_attached_cpu(s);
aliguori880a7572008-11-18 20:30:24 +00001657 goto report_cpuinfo;
1658 } else if (strcmp(p,"sThreadInfo") == 0) {
1659 report_cpuinfo:
1660 if (s->query_cpu) {
Luc Michel7cf48f62019-01-07 15:23:46 +00001661 snprintf(buf, sizeof(buf), "m%s",
1662 gdb_fmt_thread_id(s, s->query_cpu,
1663 thread_id, sizeof(thread_id)));
aliguori880a7572008-11-18 20:30:24 +00001664 put_packet(s, buf);
Luc Michel7cf48f62019-01-07 15:23:46 +00001665 s->query_cpu = gdb_next_attached_cpu(s, s->query_cpu);
aliguori880a7572008-11-18 20:30:24 +00001666 } else
1667 put_packet(s, "l");
1668 break;
1669 } else if (strncmp(p,"ThreadExtraInfo,", 16) == 0) {
Luc Michel7cf48f62019-01-07 15:23:46 +00001670 if (read_thread_id(p + 16, &p, &pid, &tid) == GDB_READ_THREAD_ERR) {
1671 put_packet(s, "E22");
1672 break;
1673 }
1674 cpu = gdb_get_cpu(s, pid, tid);
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001675 if (cpu != NULL) {
Andreas Färbercb446ec2013-05-01 14:24:52 +02001676 cpu_synchronize_state(cpu);
Luc Michel7cf48f62019-01-07 15:23:46 +00001677
1678 if (s->multiprocess && (s->process_num > 1)) {
1679 /* Print the CPU model and name in multiprocess mode */
1680 ObjectClass *oc = object_get_class(OBJECT(cpu));
1681 const char *cpu_model = object_class_get_name(oc);
1682 char *cpu_name =
1683 object_get_canonical_path_component(OBJECT(cpu));
1684 len = snprintf((char *)mem_buf, sizeof(buf) / 2,
1685 "%s %s [%s]", cpu_model, cpu_name,
1686 cpu->halted ? "halted " : "running");
1687 g_free(cpu_name);
1688 } else {
1689 /* memtohex() doubles the required space */
1690 len = snprintf((char *)mem_buf, sizeof(buf) / 2,
1691 "CPU#%d [%s]", cpu->cpu_index,
1692 cpu->halted ? "halted " : "running");
1693 }
Doug Gale5c9522b2017-12-02 20:30:37 -05001694 trace_gdbstub_op_extra_info((char *)mem_buf);
Nathan Froyd1e9fa732009-06-03 11:33:08 -07001695 memtohex(buf, mem_buf, len);
1696 put_packet(s, buf);
1697 }
aliguori880a7572008-11-18 20:30:24 +00001698 break;
edgar_igl60897d32008-05-09 08:25:14 +00001699 }
blueswir10b8a9882009-03-07 10:51:36 +00001700#ifdef CONFIG_USER_ONLY
Jan Kiszka070949f2015-02-07 09:38:42 +01001701 else if (strcmp(p, "Offsets") == 0) {
Andreas Färber0429a972013-08-26 18:14:44 +02001702 TaskState *ts = s->c_cpu->opaque;
pbrook978efd62006-06-17 18:30:42 +00001703
blueswir1363a37d2008-08-21 17:58:08 +00001704 snprintf(buf, sizeof(buf),
1705 "Text=" TARGET_ABI_FMT_lx ";Data=" TARGET_ABI_FMT_lx
1706 ";Bss=" TARGET_ABI_FMT_lx,
1707 ts->info->code_offset,
1708 ts->info->data_offset,
1709 ts->info->data_offset);
pbrook978efd62006-06-17 18:30:42 +00001710 put_packet(s, buf);
1711 break;
1712 }
blueswir10b8a9882009-03-07 10:51:36 +00001713#else /* !CONFIG_USER_ONLY */
aliguori8a34a0f2009-03-05 23:01:55 +00001714 else if (strncmp(p, "Rcmd,", 5) == 0) {
1715 int len = strlen(p + 5);
1716
1717 if ((len % 2) != 0) {
1718 put_packet(s, "E01");
1719 break;
1720 }
aliguori8a34a0f2009-03-05 23:01:55 +00001721 len = len / 2;
Kevin Wolf5accecb2015-10-13 09:38:50 +02001722 hextomem(mem_buf, p + 5, len);
aliguori8a34a0f2009-03-05 23:01:55 +00001723 mem_buf[len++] = 0;
Anthony Liguorifa5efcc2011-08-15 11:17:30 -05001724 qemu_chr_be_write(s->mon_chr, mem_buf, len);
aliguori8a34a0f2009-03-05 23:01:55 +00001725 put_packet(s, "OK");
1726 break;
1727 }
blueswir10b8a9882009-03-07 10:51:36 +00001728#endif /* !CONFIG_USER_ONLY */
Jan Kiszka4dabe742015-02-07 09:38:43 +01001729 if (is_query_packet(p, "Supported", ':')) {
blueswir15b3715b2008-10-25 11:18:12 +00001730 snprintf(buf, sizeof(buf), "PacketSize=%x", MAX_PACKET_LENGTH);
Andreas Färber5b24c642013-07-07 15:08:22 +02001731 cc = CPU_GET_CLASS(first_cpu);
1732 if (cc->gdb_core_xml_file != NULL) {
1733 pstrcat(buf, sizeof(buf), ";qXfer:features:read+");
1734 }
pbrook56aebc82008-10-11 17:55:29 +00001735 put_packet(s, buf);
1736 break;
1737 }
pbrook56aebc82008-10-11 17:55:29 +00001738 if (strncmp(p, "Xfer:features:read:", 19) == 0) {
1739 const char *xml;
1740 target_ulong total_len;
1741
Luc Michelc145eea2019-01-07 15:23:46 +00001742 process = gdb_get_cpu_process(s, s->g_cpu);
1743 cc = CPU_GET_CLASS(s->g_cpu);
Andreas Färber5b24c642013-07-07 15:08:22 +02001744 if (cc->gdb_core_xml_file == NULL) {
1745 goto unknown_command;
1746 }
1747
Andreas Färber5b50e792013-06-29 04:18:45 +02001748 gdb_has_xml = true;
pbrook56aebc82008-10-11 17:55:29 +00001749 p += 19;
Luc Michelc145eea2019-01-07 15:23:46 +00001750 xml = get_feature_xml(s, p, &p, process);
pbrook56aebc82008-10-11 17:55:29 +00001751 if (!xml) {
blueswir15b3715b2008-10-25 11:18:12 +00001752 snprintf(buf, sizeof(buf), "E00");
pbrook56aebc82008-10-11 17:55:29 +00001753 put_packet(s, buf);
1754 break;
1755 }
1756
1757 if (*p == ':')
1758 p++;
1759 addr = strtoul(p, (char **)&p, 16);
1760 if (*p == ',')
1761 p++;
1762 len = strtoul(p, (char **)&p, 16);
1763
1764 total_len = strlen(xml);
1765 if (addr > total_len) {
blueswir15b3715b2008-10-25 11:18:12 +00001766 snprintf(buf, sizeof(buf), "E00");
pbrook56aebc82008-10-11 17:55:29 +00001767 put_packet(s, buf);
1768 break;
1769 }
1770 if (len > (MAX_PACKET_LENGTH - 5) / 2)
1771 len = (MAX_PACKET_LENGTH - 5) / 2;
1772 if (len < total_len - addr) {
1773 buf[0] = 'm';
1774 len = memtox(buf + 1, xml + addr, len);
1775 } else {
1776 buf[0] = 'l';
1777 len = memtox(buf + 1, xml + addr, total_len - addr);
1778 }
Doug Gale5c9522b2017-12-02 20:30:37 -05001779 put_packet_binary(s, buf, len + 1, true);
pbrook56aebc82008-10-11 17:55:29 +00001780 break;
1781 }
Jan Kiszkaa3919382015-02-07 09:38:44 +01001782 if (is_query_packet(p, "Attached", ':')) {
1783 put_packet(s, GDB_ATTACHED);
1784 break;
1785 }
pbrook56aebc82008-10-11 17:55:29 +00001786 /* Unrecognised 'q' command. */
1787 goto unknown_command;
1788
bellard858693c2004-03-31 18:52:07 +00001789 default:
pbrook56aebc82008-10-11 17:55:29 +00001790 unknown_command:
bellard858693c2004-03-31 18:52:07 +00001791 /* put empty packet */
1792 buf[0] = '\0';
1793 put_packet(s, buf);
1794 break;
1795 }
1796 return RS_IDLE;
1797}
1798
Andreas Färber64f6b342013-05-27 02:06:09 +02001799void gdb_set_stop_cpu(CPUState *cpu)
aliguori880a7572008-11-18 20:30:24 +00001800{
Luc Michel160d8582019-01-07 15:23:46 +00001801 GDBProcess *p = gdb_get_cpu_process(gdbserver_state, cpu);
1802
1803 if (!p->attached) {
1804 /*
1805 * Having a stop CPU corresponding to a process that is not attached
1806 * confuses GDB. So we ignore the request.
1807 */
1808 return;
1809 }
1810
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001811 gdbserver_state->c_cpu = cpu;
1812 gdbserver_state->g_cpu = cpu;
aliguori880a7572008-11-18 20:30:24 +00001813}
1814
bellard1fddef42005-04-17 19:16:13 +00001815#ifndef CONFIG_USER_ONLY
Luiz Capitulino1dfb4dd2011-07-29 14:26:33 -03001816static void gdb_vm_state_change(void *opaque, int running, RunState state)
bellard858693c2004-03-31 18:52:07 +00001817{
aliguori880a7572008-11-18 20:30:24 +00001818 GDBState *s = gdbserver_state;
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001819 CPUState *cpu = s->c_cpu;
bellard858693c2004-03-31 18:52:07 +00001820 char buf[256];
Luc Michel95567c22019-01-07 15:23:46 +00001821 char thread_id[16];
aliguorid6fc1b32008-11-18 19:55:44 +00001822 const char *type;
bellard858693c2004-03-31 18:52:07 +00001823 int ret;
1824
Meador Ingecdb432b2012-03-15 17:49:45 +00001825 if (running || s->state == RS_INACTIVE) {
1826 return;
1827 }
1828 /* Is there a GDB syscall waiting to be sent? */
1829 if (s->current_syscall_cb) {
1830 put_packet(s, s->syscall_buf);
pbrooka2d1eba2007-01-28 03:10:55 +00001831 return;
Jan Kiszkae07bbac2011-02-09 16:29:40 +01001832 }
Luc Michel95567c22019-01-07 15:23:46 +00001833
1834 if (cpu == NULL) {
1835 /* No process attached */
1836 return;
1837 }
1838
1839 gdb_fmt_thread_id(s, cpu, thread_id, sizeof(thread_id));
1840
Luiz Capitulino1dfb4dd2011-07-29 14:26:33 -03001841 switch (state) {
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001842 case RUN_STATE_DEBUG:
Andreas Färberff4700b2013-08-26 18:23:18 +02001843 if (cpu->watchpoint_hit) {
1844 switch (cpu->watchpoint_hit->flags & BP_MEM_ACCESS) {
aliguoria1d1bb32008-11-18 20:07:32 +00001845 case BP_MEM_READ:
aliguorid6fc1b32008-11-18 19:55:44 +00001846 type = "r";
1847 break;
aliguoria1d1bb32008-11-18 20:07:32 +00001848 case BP_MEM_ACCESS:
aliguorid6fc1b32008-11-18 19:55:44 +00001849 type = "a";
1850 break;
1851 default:
1852 type = "";
1853 break;
1854 }
Doug Gale5c9522b2017-12-02 20:30:37 -05001855 trace_gdbstub_hit_watchpoint(type, cpu_gdb_index(cpu),
1856 (target_ulong)cpu->watchpoint_hit->vaddr);
aliguori880a7572008-11-18 20:30:24 +00001857 snprintf(buf, sizeof(buf),
Luc Michel95567c22019-01-07 15:23:46 +00001858 "T%02xthread:%s;%swatch:" TARGET_FMT_lx ";",
1859 GDB_SIGNAL_TRAP, thread_id, type,
Andreas Färberff4700b2013-08-26 18:23:18 +02001860 (target_ulong)cpu->watchpoint_hit->vaddr);
1861 cpu->watchpoint_hit = NULL;
Jan Kiszka425189a2011-03-22 11:02:09 +01001862 goto send_packet;
Doug Gale5c9522b2017-12-02 20:30:37 -05001863 } else {
1864 trace_gdbstub_hit_break();
pbrook6658ffb2007-03-16 23:58:11 +00001865 }
Peter Crosthwaitebbd77c12015-06-23 19:31:15 -07001866 tb_flush(cpu);
aurel32ca587a82008-12-18 22:44:13 +00001867 ret = GDB_SIGNAL_TRAP;
Jan Kiszka425189a2011-03-22 11:02:09 +01001868 break;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001869 case RUN_STATE_PAUSED:
Doug Gale5c9522b2017-12-02 20:30:37 -05001870 trace_gdbstub_hit_paused();
aliguori9781e042009-01-22 17:15:29 +00001871 ret = GDB_SIGNAL_INT;
Jan Kiszka425189a2011-03-22 11:02:09 +01001872 break;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001873 case RUN_STATE_SHUTDOWN:
Doug Gale5c9522b2017-12-02 20:30:37 -05001874 trace_gdbstub_hit_shutdown();
Jan Kiszka425189a2011-03-22 11:02:09 +01001875 ret = GDB_SIGNAL_QUIT;
1876 break;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001877 case RUN_STATE_IO_ERROR:
Doug Gale5c9522b2017-12-02 20:30:37 -05001878 trace_gdbstub_hit_io_error();
Jan Kiszka425189a2011-03-22 11:02:09 +01001879 ret = GDB_SIGNAL_IO;
1880 break;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001881 case RUN_STATE_WATCHDOG:
Doug Gale5c9522b2017-12-02 20:30:37 -05001882 trace_gdbstub_hit_watchdog();
Jan Kiszka425189a2011-03-22 11:02:09 +01001883 ret = GDB_SIGNAL_ALRM;
1884 break;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001885 case RUN_STATE_INTERNAL_ERROR:
Doug Gale5c9522b2017-12-02 20:30:37 -05001886 trace_gdbstub_hit_internal_error();
Jan Kiszka425189a2011-03-22 11:02:09 +01001887 ret = GDB_SIGNAL_ABRT;
1888 break;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001889 case RUN_STATE_SAVE_VM:
1890 case RUN_STATE_RESTORE_VM:
Jan Kiszka425189a2011-03-22 11:02:09 +01001891 return;
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001892 case RUN_STATE_FINISH_MIGRATE:
Jan Kiszka425189a2011-03-22 11:02:09 +01001893 ret = GDB_SIGNAL_XCPU;
1894 break;
1895 default:
Doug Gale5c9522b2017-12-02 20:30:37 -05001896 trace_gdbstub_hit_unknown(state);
Jan Kiszka425189a2011-03-22 11:02:09 +01001897 ret = GDB_SIGNAL_UNKNOWN;
1898 break;
bellardbbeb7b52006-04-23 18:42:15 +00001899 }
Jan Kiszka226d0072015-07-24 18:52:31 +02001900 gdb_set_stop_cpu(cpu);
Luc Michel95567c22019-01-07 15:23:46 +00001901 snprintf(buf, sizeof(buf), "T%02xthread:%s;", ret, thread_id);
Jan Kiszka425189a2011-03-22 11:02:09 +01001902
1903send_packet:
bellard858693c2004-03-31 18:52:07 +00001904 put_packet(s, buf);
Jan Kiszka425189a2011-03-22 11:02:09 +01001905
1906 /* disable single step if it was enabled */
Andreas Färber3825b282013-06-24 18:41:06 +02001907 cpu_single_step(cpu, 0);
bellard858693c2004-03-31 18:52:07 +00001908}
bellard1fddef42005-04-17 19:16:13 +00001909#endif
bellard858693c2004-03-31 18:52:07 +00001910
pbrooka2d1eba2007-01-28 03:10:55 +00001911/* Send a gdb syscall request.
1912 This accepts limited printf-style format specifiers, specifically:
pbrooka87295e2007-05-26 15:09:38 +00001913 %x - target_ulong argument printed in hex.
1914 %lx - 64-bit argument printed in hex.
1915 %s - string pointer (target_ulong) and length (int) pair. */
Peter Maydell19239b32015-09-07 10:39:27 +01001916void gdb_do_syscallv(gdb_syscall_complete_cb cb, const char *fmt, va_list va)
pbrooka2d1eba2007-01-28 03:10:55 +00001917{
pbrooka2d1eba2007-01-28 03:10:55 +00001918 char *p;
Meador Ingecdb432b2012-03-15 17:49:45 +00001919 char *p_end;
pbrooka2d1eba2007-01-28 03:10:55 +00001920 target_ulong addr;
pbrooka87295e2007-05-26 15:09:38 +00001921 uint64_t i64;
pbrooka2d1eba2007-01-28 03:10:55 +00001922 GDBState *s;
1923
aliguori880a7572008-11-18 20:30:24 +00001924 s = gdbserver_state;
pbrooka2d1eba2007-01-28 03:10:55 +00001925 if (!s)
1926 return;
Meador Ingecdb432b2012-03-15 17:49:45 +00001927 s->current_syscall_cb = cb;
pbrooka2d1eba2007-01-28 03:10:55 +00001928#ifndef CONFIG_USER_ONLY
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03001929 vm_stop(RUN_STATE_DEBUG);
pbrooka2d1eba2007-01-28 03:10:55 +00001930#endif
Meador Ingecdb432b2012-03-15 17:49:45 +00001931 p = s->syscall_buf;
1932 p_end = &s->syscall_buf[sizeof(s->syscall_buf)];
pbrooka2d1eba2007-01-28 03:10:55 +00001933 *(p++) = 'F';
1934 while (*fmt) {
1935 if (*fmt == '%') {
1936 fmt++;
1937 switch (*fmt++) {
1938 case 'x':
1939 addr = va_arg(va, target_ulong);
Meador Ingecdb432b2012-03-15 17:49:45 +00001940 p += snprintf(p, p_end - p, TARGET_FMT_lx, addr);
pbrooka2d1eba2007-01-28 03:10:55 +00001941 break;
pbrooka87295e2007-05-26 15:09:38 +00001942 case 'l':
1943 if (*(fmt++) != 'x')
1944 goto bad_format;
1945 i64 = va_arg(va, uint64_t);
Meador Ingecdb432b2012-03-15 17:49:45 +00001946 p += snprintf(p, p_end - p, "%" PRIx64, i64);
pbrooka87295e2007-05-26 15:09:38 +00001947 break;
pbrooka2d1eba2007-01-28 03:10:55 +00001948 case 's':
1949 addr = va_arg(va, target_ulong);
Meador Ingecdb432b2012-03-15 17:49:45 +00001950 p += snprintf(p, p_end - p, TARGET_FMT_lx "/%x",
blueswir1363a37d2008-08-21 17:58:08 +00001951 addr, va_arg(va, int));
pbrooka2d1eba2007-01-28 03:10:55 +00001952 break;
1953 default:
pbrooka87295e2007-05-26 15:09:38 +00001954 bad_format:
Ziyue Yang7ae6c572017-01-18 16:03:29 +08001955 error_report("gdbstub: Bad syscall format string '%s'",
1956 fmt - 1);
pbrooka2d1eba2007-01-28 03:10:55 +00001957 break;
1958 }
1959 } else {
1960 *(p++) = *(fmt++);
1961 }
1962 }
pbrook8a93e022007-08-06 13:19:15 +00001963 *p = 0;
pbrooka2d1eba2007-01-28 03:10:55 +00001964#ifdef CONFIG_USER_ONLY
Meador Ingecdb432b2012-03-15 17:49:45 +00001965 put_packet(s, s->syscall_buf);
Peter Maydell4f710862018-05-15 19:19:58 +01001966 /* Return control to gdb for it to process the syscall request.
1967 * Since the protocol requires that gdb hands control back to us
1968 * using a "here are the results" F packet, we don't need to check
1969 * gdb_handlesig's return value (which is the signal to deliver if
1970 * execution was resumed via a continue packet).
1971 */
Andreas Färber2e0f2cf2013-06-27 19:19:39 +02001972 gdb_handlesig(s->c_cpu, 0);
pbrooka2d1eba2007-01-28 03:10:55 +00001973#else
Meador Ingecdb432b2012-03-15 17:49:45 +00001974 /* In this case wait to send the syscall packet until notification that
1975 the CPU has stopped. This must be done because if the packet is sent
1976 now the reply from the syscall request could be received while the CPU
1977 is still in the running state, which can cause packets to be dropped
1978 and state transition 'T' packets to be sent while the syscall is still
1979 being processed. */
Paolo Bonzini9102ded2015-08-18 06:52:09 -07001980 qemu_cpu_kick(s->c_cpu);
pbrooka2d1eba2007-01-28 03:10:55 +00001981#endif
1982}
1983
Peter Maydell19239b32015-09-07 10:39:27 +01001984void gdb_do_syscall(gdb_syscall_complete_cb cb, const char *fmt, ...)
1985{
1986 va_list va;
1987
1988 va_start(va, fmt);
1989 gdb_do_syscallv(cb, fmt, va);
1990 va_end(va);
1991}
1992
bellard6a00d602005-11-21 23:25:50 +00001993static void gdb_read_byte(GDBState *s, int ch)
bellard858693c2004-03-31 18:52:07 +00001994{
ths60fe76f2007-12-16 03:02:09 +00001995 uint8_t reply;
bellard858693c2004-03-31 18:52:07 +00001996
bellard1fddef42005-04-17 19:16:13 +00001997#ifndef CONFIG_USER_ONLY
pbrook4046d912007-01-28 01:53:16 +00001998 if (s->last_packet_len) {
1999 /* Waiting for a response to the last packet. If we see the start
2000 of a new command then abandon the previous response. */
2001 if (ch == '-') {
Doug Gale5c9522b2017-12-02 20:30:37 -05002002 trace_gdbstub_err_got_nack();
thsffe8ab82007-12-16 03:16:05 +00002003 put_buffer(s, (uint8_t *)s->last_packet, s->last_packet_len);
Alex Bennée118e2262017-07-12 11:52:13 +01002004 } else if (ch == '+') {
Doug Gale5c9522b2017-12-02 20:30:37 -05002005 trace_gdbstub_io_got_ack();
Alex Bennée118e2262017-07-12 11:52:13 +01002006 } else {
Doug Gale5c9522b2017-12-02 20:30:37 -05002007 trace_gdbstub_io_got_unexpected((uint8_t)ch);
pbrook4046d912007-01-28 01:53:16 +00002008 }
Alex Bennée118e2262017-07-12 11:52:13 +01002009
pbrook4046d912007-01-28 01:53:16 +00002010 if (ch == '+' || ch == '$')
2011 s->last_packet_len = 0;
2012 if (ch != '$')
2013 return;
2014 }
Luiz Capitulino13548692011-07-29 15:36:43 -03002015 if (runstate_is_running()) {
bellard858693c2004-03-31 18:52:07 +00002016 /* when the CPU is running, we cannot do anything except stop
2017 it when receiving a char */
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03002018 vm_stop(RUN_STATE_PAUSED);
ths5fafdf22007-09-16 21:08:06 +00002019 } else
bellard1fddef42005-04-17 19:16:13 +00002020#endif
bellard41625032005-04-24 10:07:11 +00002021 {
bellard858693c2004-03-31 18:52:07 +00002022 switch(s->state) {
2023 case RS_IDLE:
2024 if (ch == '$') {
Doug Gale4bf43122017-05-01 12:22:10 -04002025 /* start of command packet */
bellard858693c2004-03-31 18:52:07 +00002026 s->line_buf_index = 0;
Doug Gale4bf43122017-05-01 12:22:10 -04002027 s->line_sum = 0;
bellard858693c2004-03-31 18:52:07 +00002028 s->state = RS_GETLINE;
Doug Gale4bf43122017-05-01 12:22:10 -04002029 } else {
Doug Gale5c9522b2017-12-02 20:30:37 -05002030 trace_gdbstub_err_garbage((uint8_t)ch);
bellard4c3a88a2003-07-26 12:06:08 +00002031 }
2032 break;
bellard858693c2004-03-31 18:52:07 +00002033 case RS_GETLINE:
Doug Gale4bf43122017-05-01 12:22:10 -04002034 if (ch == '}') {
2035 /* start escape sequence */
2036 s->state = RS_GETLINE_ESC;
2037 s->line_sum += ch;
2038 } else if (ch == '*') {
2039 /* start run length encoding sequence */
2040 s->state = RS_GETLINE_RLE;
2041 s->line_sum += ch;
2042 } else if (ch == '#') {
2043 /* end of command, start of checksum*/
2044 s->state = RS_CHKSUM1;
bellard858693c2004-03-31 18:52:07 +00002045 } else if (s->line_buf_index >= sizeof(s->line_buf) - 1) {
Doug Gale5c9522b2017-12-02 20:30:37 -05002046 trace_gdbstub_err_overrun();
bellard858693c2004-03-31 18:52:07 +00002047 s->state = RS_IDLE;
2048 } else {
Doug Gale4bf43122017-05-01 12:22:10 -04002049 /* unescaped command character */
2050 s->line_buf[s->line_buf_index++] = ch;
2051 s->line_sum += ch;
2052 }
2053 break;
2054 case RS_GETLINE_ESC:
2055 if (ch == '#') {
2056 /* unexpected end of command in escape sequence */
2057 s->state = RS_CHKSUM1;
2058 } else if (s->line_buf_index >= sizeof(s->line_buf) - 1) {
2059 /* command buffer overrun */
Doug Gale5c9522b2017-12-02 20:30:37 -05002060 trace_gdbstub_err_overrun();
Doug Gale4bf43122017-05-01 12:22:10 -04002061 s->state = RS_IDLE;
2062 } else {
2063 /* parse escaped character and leave escape state */
2064 s->line_buf[s->line_buf_index++] = ch ^ 0x20;
2065 s->line_sum += ch;
2066 s->state = RS_GETLINE;
2067 }
2068 break;
2069 case RS_GETLINE_RLE:
2070 if (ch < ' ') {
2071 /* invalid RLE count encoding */
Doug Gale5c9522b2017-12-02 20:30:37 -05002072 trace_gdbstub_err_invalid_repeat((uint8_t)ch);
Doug Gale4bf43122017-05-01 12:22:10 -04002073 s->state = RS_GETLINE;
2074 } else {
2075 /* decode repeat length */
2076 int repeat = (unsigned char)ch - ' ' + 3;
2077 if (s->line_buf_index + repeat >= sizeof(s->line_buf) - 1) {
2078 /* that many repeats would overrun the command buffer */
Doug Gale5c9522b2017-12-02 20:30:37 -05002079 trace_gdbstub_err_overrun();
Doug Gale4bf43122017-05-01 12:22:10 -04002080 s->state = RS_IDLE;
2081 } else if (s->line_buf_index < 1) {
2082 /* got a repeat but we have nothing to repeat */
Doug Gale5c9522b2017-12-02 20:30:37 -05002083 trace_gdbstub_err_invalid_rle();
Doug Gale4bf43122017-05-01 12:22:10 -04002084 s->state = RS_GETLINE;
2085 } else {
2086 /* repeat the last character */
2087 memset(s->line_buf + s->line_buf_index,
2088 s->line_buf[s->line_buf_index - 1], repeat);
2089 s->line_buf_index += repeat;
2090 s->line_sum += ch;
2091 s->state = RS_GETLINE;
2092 }
bellard858693c2004-03-31 18:52:07 +00002093 }
2094 break;
2095 case RS_CHKSUM1:
Doug Gale4bf43122017-05-01 12:22:10 -04002096 /* get high hex digit of checksum */
2097 if (!isxdigit(ch)) {
Doug Gale5c9522b2017-12-02 20:30:37 -05002098 trace_gdbstub_err_checksum_invalid((uint8_t)ch);
Doug Gale4bf43122017-05-01 12:22:10 -04002099 s->state = RS_GETLINE;
2100 break;
2101 }
bellard858693c2004-03-31 18:52:07 +00002102 s->line_buf[s->line_buf_index] = '\0';
2103 s->line_csum = fromhex(ch) << 4;
2104 s->state = RS_CHKSUM2;
2105 break;
2106 case RS_CHKSUM2:
Doug Gale4bf43122017-05-01 12:22:10 -04002107 /* get low hex digit of checksum */
2108 if (!isxdigit(ch)) {
Doug Gale5c9522b2017-12-02 20:30:37 -05002109 trace_gdbstub_err_checksum_invalid((uint8_t)ch);
Doug Gale4bf43122017-05-01 12:22:10 -04002110 s->state = RS_GETLINE;
2111 break;
bellard858693c2004-03-31 18:52:07 +00002112 }
Doug Gale4bf43122017-05-01 12:22:10 -04002113 s->line_csum |= fromhex(ch);
2114
2115 if (s->line_csum != (s->line_sum & 0xff)) {
Doug Gale5c9522b2017-12-02 20:30:37 -05002116 trace_gdbstub_err_checksum_incorrect(s->line_sum, s->line_csum);
Doug Gale4bf43122017-05-01 12:22:10 -04002117 /* send NAK reply */
ths60fe76f2007-12-16 03:02:09 +00002118 reply = '-';
2119 put_buffer(s, &reply, 1);
bellard858693c2004-03-31 18:52:07 +00002120 s->state = RS_IDLE;
2121 } else {
Doug Gale4bf43122017-05-01 12:22:10 -04002122 /* send ACK reply */
ths60fe76f2007-12-16 03:02:09 +00002123 reply = '+';
2124 put_buffer(s, &reply, 1);
aliguori880a7572008-11-18 20:30:24 +00002125 s->state = gdb_handle_packet(s, s->line_buf);
bellard858693c2004-03-31 18:52:07 +00002126 }
bellardb4608c02003-06-27 17:34:32 +00002127 break;
pbrooka2d1eba2007-01-28 03:10:55 +00002128 default:
2129 abort();
bellardb4608c02003-06-27 17:34:32 +00002130 }
2131 }
bellard858693c2004-03-31 18:52:07 +00002132}
2133
Paul Brook0e1c9c52010-06-16 13:03:51 +01002134/* Tell the remote gdb that the process has exited. */
Andreas Färber9349b4f2012-03-14 01:38:32 +01002135void gdb_exit(CPUArchState *env, int code)
Paul Brook0e1c9c52010-06-16 13:03:51 +01002136{
2137 GDBState *s;
2138 char buf[4];
2139
2140 s = gdbserver_state;
2141 if (!s) {
2142 return;
2143 }
2144#ifdef CONFIG_USER_ONLY
2145 if (gdbserver_fd < 0 || s->fd < 0) {
2146 return;
2147 }
2148#endif
2149
Doug Gale5c9522b2017-12-02 20:30:37 -05002150 trace_gdbstub_op_exiting((uint8_t)code);
2151
Paul Brook0e1c9c52010-06-16 13:03:51 +01002152 snprintf(buf, sizeof(buf), "W%02x", (uint8_t)code);
2153 put_packet(s, buf);
Fabien Chouteaue2af15b2011-01-13 12:46:57 +01002154
2155#ifndef CONFIG_USER_ONLY
Marc-André Lureau1ce26102017-01-27 00:49:13 +04002156 qemu_chr_fe_deinit(&s->chr, true);
Fabien Chouteaue2af15b2011-01-13 12:46:57 +01002157#endif
Paul Brook0e1c9c52010-06-16 13:03:51 +01002158}
2159
Luc Michel8f468632019-01-07 15:23:45 +00002160/*
2161 * Create the process that will contain all the "orphan" CPUs (that are not
2162 * part of a CPU cluster). Note that if this process contains no CPUs, it won't
2163 * be attachable and thus will be invisible to the user.
2164 */
2165static void create_default_process(GDBState *s)
2166{
2167 GDBProcess *process;
2168 int max_pid = 0;
2169
2170 if (s->process_num) {
2171 max_pid = s->processes[s->process_num - 1].pid;
2172 }
2173
2174 s->processes = g_renew(GDBProcess, s->processes, ++s->process_num);
2175 process = &s->processes[s->process_num - 1];
2176
2177 /* We need an available PID slot for this process */
2178 assert(max_pid < UINT32_MAX);
2179
2180 process->pid = max_pid + 1;
2181 process->attached = false;
Luc Michelc145eea2019-01-07 15:23:46 +00002182 process->target_xml[0] = '\0';
Luc Michel8f468632019-01-07 15:23:45 +00002183}
2184
bellard1fddef42005-04-17 19:16:13 +00002185#ifdef CONFIG_USER_ONLY
2186int
Andreas Färberdb6b81d2013-06-27 19:49:31 +02002187gdb_handlesig(CPUState *cpu, int sig)
bellard1fddef42005-04-17 19:16:13 +00002188{
Andreas Färber5ca666c2013-06-24 19:20:57 +02002189 GDBState *s;
2190 char buf[256];
2191 int n;
bellard1fddef42005-04-17 19:16:13 +00002192
Andreas Färber5ca666c2013-06-24 19:20:57 +02002193 s = gdbserver_state;
2194 if (gdbserver_fd < 0 || s->fd < 0) {
2195 return sig;
bellard1fddef42005-04-17 19:16:13 +00002196 }
2197
Andreas Färber5ca666c2013-06-24 19:20:57 +02002198 /* disable single step if it was enabled */
Andreas Färber3825b282013-06-24 18:41:06 +02002199 cpu_single_step(cpu, 0);
Peter Crosthwaitebbd77c12015-06-23 19:31:15 -07002200 tb_flush(cpu);
bellard1fddef42005-04-17 19:16:13 +00002201
Andreas Färber5ca666c2013-06-24 19:20:57 +02002202 if (sig != 0) {
2203 snprintf(buf, sizeof(buf), "S%02x", target_signal_to_gdb(sig));
2204 put_packet(s, buf);
2205 }
2206 /* put_packet() might have detected that the peer terminated the
2207 connection. */
2208 if (s->fd < 0) {
2209 return sig;
2210 }
2211
2212 sig = 0;
2213 s->state = RS_IDLE;
2214 s->running_state = 0;
2215 while (s->running_state == 0) {
2216 n = read(s->fd, buf, 256);
2217 if (n > 0) {
2218 int i;
2219
2220 for (i = 0; i < n; i++) {
2221 gdb_read_byte(s, buf[i]);
2222 }
Peter Wu5819e3e2016-06-05 16:35:48 +02002223 } else {
Andreas Färber5ca666c2013-06-24 19:20:57 +02002224 /* XXX: Connection closed. Should probably wait for another
2225 connection before continuing. */
Peter Wu5819e3e2016-06-05 16:35:48 +02002226 if (n == 0) {
2227 close(s->fd);
2228 }
2229 s->fd = -1;
Andreas Färber5ca666c2013-06-24 19:20:57 +02002230 return sig;
bellard1fddef42005-04-17 19:16:13 +00002231 }
Andreas Färber5ca666c2013-06-24 19:20:57 +02002232 }
2233 sig = s->signal;
2234 s->signal = 0;
2235 return sig;
bellard1fddef42005-04-17 19:16:13 +00002236}
bellarde9009672005-04-26 20:42:36 +00002237
aurel32ca587a82008-12-18 22:44:13 +00002238/* Tell the remote gdb that the process has exited due to SIG. */
Andreas Färber9349b4f2012-03-14 01:38:32 +01002239void gdb_signalled(CPUArchState *env, int sig)
aurel32ca587a82008-12-18 22:44:13 +00002240{
Andreas Färber5ca666c2013-06-24 19:20:57 +02002241 GDBState *s;
2242 char buf[4];
aurel32ca587a82008-12-18 22:44:13 +00002243
Andreas Färber5ca666c2013-06-24 19:20:57 +02002244 s = gdbserver_state;
2245 if (gdbserver_fd < 0 || s->fd < 0) {
2246 return;
2247 }
aurel32ca587a82008-12-18 22:44:13 +00002248
Andreas Färber5ca666c2013-06-24 19:20:57 +02002249 snprintf(buf, sizeof(buf), "X%02x", target_signal_to_gdb(sig));
2250 put_packet(s, buf);
aurel32ca587a82008-12-18 22:44:13 +00002251}
bellard1fddef42005-04-17 19:16:13 +00002252
Peter Maydell2f652222018-05-14 18:30:44 +01002253static bool gdb_accept(void)
bellard858693c2004-03-31 18:52:07 +00002254{
2255 GDBState *s;
2256 struct sockaddr_in sockaddr;
2257 socklen_t len;
MORITA Kazutakabf1c8522013-02-22 12:39:50 +09002258 int fd;
bellard858693c2004-03-31 18:52:07 +00002259
2260 for(;;) {
2261 len = sizeof(sockaddr);
2262 fd = accept(gdbserver_fd, (struct sockaddr *)&sockaddr, &len);
2263 if (fd < 0 && errno != EINTR) {
2264 perror("accept");
Peter Maydell2f652222018-05-14 18:30:44 +01002265 return false;
bellard858693c2004-03-31 18:52:07 +00002266 } else if (fd >= 0) {
Peter Maydellf5bdd782018-05-14 18:30:43 +01002267 qemu_set_cloexec(fd);
bellard858693c2004-03-31 18:52:07 +00002268 break;
2269 }
2270 }
2271
2272 /* set short latency */
Peter Maydell2f652222018-05-14 18:30:44 +01002273 if (socket_set_nodelay(fd)) {
2274 perror("setsockopt");
Philippe Mathieu-Daudéead75d82018-05-24 19:34:58 -03002275 close(fd);
Peter Maydell2f652222018-05-14 18:30:44 +01002276 return false;
2277 }
ths3b46e622007-09-17 08:09:54 +00002278
Anthony Liguori7267c092011-08-20 22:09:37 -05002279 s = g_malloc0(sizeof(GDBState));
Luc Michel8f468632019-01-07 15:23:45 +00002280 create_default_process(s);
Luc Michel970ed902019-01-07 15:23:46 +00002281 s->processes[0].attached = true;
2282 s->c_cpu = gdb_first_attached_cpu(s);
2283 s->g_cpu = s->c_cpu;
bellard858693c2004-03-31 18:52:07 +00002284 s->fd = fd;
Andreas Färber5b50e792013-06-29 04:18:45 +02002285 gdb_has_xml = false;
bellard858693c2004-03-31 18:52:07 +00002286
aliguori880a7572008-11-18 20:30:24 +00002287 gdbserver_state = s;
Peter Maydell2f652222018-05-14 18:30:44 +01002288 return true;
bellard858693c2004-03-31 18:52:07 +00002289}
2290
2291static int gdbserver_open(int port)
2292{
2293 struct sockaddr_in sockaddr;
Sebastian Ottlik6669ca12013-10-02 12:23:13 +02002294 int fd, ret;
bellard858693c2004-03-31 18:52:07 +00002295
2296 fd = socket(PF_INET, SOCK_STREAM, 0);
2297 if (fd < 0) {
2298 perror("socket");
2299 return -1;
2300 }
Peter Maydellf5bdd782018-05-14 18:30:43 +01002301 qemu_set_cloexec(fd);
bellard858693c2004-03-31 18:52:07 +00002302
Sebastian Ottlik6669ca12013-10-02 12:23:13 +02002303 socket_set_fast_reuse(fd);
bellard858693c2004-03-31 18:52:07 +00002304
2305 sockaddr.sin_family = AF_INET;
2306 sockaddr.sin_port = htons(port);
2307 sockaddr.sin_addr.s_addr = 0;
2308 ret = bind(fd, (struct sockaddr *)&sockaddr, sizeof(sockaddr));
2309 if (ret < 0) {
2310 perror("bind");
Peter Maydellbb161722011-12-24 23:37:24 +00002311 close(fd);
bellard858693c2004-03-31 18:52:07 +00002312 return -1;
2313 }
Peter Wu96165b92016-05-04 11:32:17 +02002314 ret = listen(fd, 1);
bellard858693c2004-03-31 18:52:07 +00002315 if (ret < 0) {
2316 perror("listen");
Peter Maydellbb161722011-12-24 23:37:24 +00002317 close(fd);
bellard858693c2004-03-31 18:52:07 +00002318 return -1;
2319 }
bellard858693c2004-03-31 18:52:07 +00002320 return fd;
2321}
2322
2323int gdbserver_start(int port)
2324{
2325 gdbserver_fd = gdbserver_open(port);
2326 if (gdbserver_fd < 0)
2327 return -1;
2328 /* accept connections */
Peter Maydell2f652222018-05-14 18:30:44 +01002329 if (!gdb_accept()) {
2330 close(gdbserver_fd);
2331 gdbserver_fd = -1;
2332 return -1;
2333 }
bellardb4608c02003-06-27 17:34:32 +00002334 return 0;
2335}
aurel322b1319c2008-12-18 22:44:04 +00002336
2337/* Disable gdb stub for child processes. */
Peter Crosthwaitef7ec7f72015-06-23 19:31:16 -07002338void gdbserver_fork(CPUState *cpu)
aurel322b1319c2008-12-18 22:44:04 +00002339{
2340 GDBState *s = gdbserver_state;
Andreas Färber75a34032013-09-02 16:57:02 +02002341
2342 if (gdbserver_fd < 0 || s->fd < 0) {
2343 return;
2344 }
aurel322b1319c2008-12-18 22:44:04 +00002345 close(s->fd);
2346 s->fd = -1;
Andreas Färberb3310ab2013-09-02 17:26:20 +02002347 cpu_breakpoint_remove_all(cpu, BP_GDB);
Andreas Färber75a34032013-09-02 16:57:02 +02002348 cpu_watchpoint_remove_all(cpu, BP_GDB);
aurel322b1319c2008-12-18 22:44:04 +00002349}
pbrook4046d912007-01-28 01:53:16 +00002350#else
thsaa1f17c2007-07-11 22:48:58 +00002351static int gdb_chr_can_receive(void *opaque)
pbrook4046d912007-01-28 01:53:16 +00002352{
pbrook56aebc82008-10-11 17:55:29 +00002353 /* We can handle an arbitrarily large amount of data.
2354 Pick the maximum packet size, which is as good as anything. */
2355 return MAX_PACKET_LENGTH;
pbrook4046d912007-01-28 01:53:16 +00002356}
2357
thsaa1f17c2007-07-11 22:48:58 +00002358static void gdb_chr_receive(void *opaque, const uint8_t *buf, int size)
pbrook4046d912007-01-28 01:53:16 +00002359{
pbrook4046d912007-01-28 01:53:16 +00002360 int i;
2361
2362 for (i = 0; i < size; i++) {
aliguori880a7572008-11-18 20:30:24 +00002363 gdb_read_byte(gdbserver_state, buf[i]);
pbrook4046d912007-01-28 01:53:16 +00002364 }
2365}
2366
2367static void gdb_chr_event(void *opaque, int event)
2368{
Luc Michel970ed902019-01-07 15:23:46 +00002369 int i;
2370 GDBState *s = (GDBState *) opaque;
2371
pbrook4046d912007-01-28 01:53:16 +00002372 switch (event) {
Amit Shahb6b8df52009-10-07 18:31:16 +05302373 case CHR_EVENT_OPENED:
Luc Michel970ed902019-01-07 15:23:46 +00002374 /* Start with first process attached, others detached */
2375 for (i = 0; i < s->process_num; i++) {
2376 s->processes[i].attached = !i;
2377 }
2378
2379 s->c_cpu = gdb_first_attached_cpu(s);
2380 s->g_cpu = s->c_cpu;
2381
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03002382 vm_stop(RUN_STATE_PAUSED);
Andreas Färber5b50e792013-06-29 04:18:45 +02002383 gdb_has_xml = false;
pbrook4046d912007-01-28 01:53:16 +00002384 break;
2385 default:
2386 break;
2387 }
2388}
2389
aliguori8a34a0f2009-03-05 23:01:55 +00002390static void gdb_monitor_output(GDBState *s, const char *msg, int len)
2391{
2392 char buf[MAX_PACKET_LENGTH];
2393
2394 buf[0] = 'O';
2395 if (len > (MAX_PACKET_LENGTH/2) - 1)
2396 len = (MAX_PACKET_LENGTH/2) - 1;
2397 memtohex(buf + 1, (uint8_t *)msg, len);
2398 put_packet(s, buf);
2399}
2400
Marc-André Lureau0ec7b3e2016-12-07 16:20:22 +03002401static int gdb_monitor_write(Chardev *chr, const uint8_t *buf, int len)
aliguori8a34a0f2009-03-05 23:01:55 +00002402{
2403 const char *p = (const char *)buf;
2404 int max_sz;
2405
2406 max_sz = (sizeof(gdbserver_state->last_packet) - 2) / 2;
2407 for (;;) {
2408 if (len <= max_sz) {
2409 gdb_monitor_output(gdbserver_state, p, len);
2410 break;
2411 }
2412 gdb_monitor_output(gdbserver_state, p, max_sz);
2413 p += max_sz;
2414 len -= max_sz;
2415 }
2416 return len;
2417}
2418
aliguori59030a82009-04-05 18:43:41 +00002419#ifndef _WIN32
2420static void gdb_sigterm_handler(int signal)
2421{
Luiz Capitulino13548692011-07-29 15:36:43 -03002422 if (runstate_is_running()) {
Luiz Capitulino0461d5a2011-09-30 14:45:27 -03002423 vm_stop(RUN_STATE_PAUSED);
Jan Kiszkae07bbac2011-02-09 16:29:40 +01002424 }
aliguori59030a82009-04-05 18:43:41 +00002425}
2426#endif
2427
Marc-André Lureau777357d2016-12-07 18:39:10 +03002428static void gdb_monitor_open(Chardev *chr, ChardevBackend *backend,
2429 bool *be_opened, Error **errp)
2430{
2431 *be_opened = false;
2432}
2433
2434static void char_gdb_class_init(ObjectClass *oc, void *data)
2435{
2436 ChardevClass *cc = CHARDEV_CLASS(oc);
2437
2438 cc->internal = true;
2439 cc->open = gdb_monitor_open;
2440 cc->chr_write = gdb_monitor_write;
2441}
2442
2443#define TYPE_CHARDEV_GDB "chardev-gdb"
2444
2445static const TypeInfo char_gdb_type_info = {
2446 .name = TYPE_CHARDEV_GDB,
2447 .parent = TYPE_CHARDEV,
2448 .class_init = char_gdb_class_init,
2449};
2450
Luc Michel8f468632019-01-07 15:23:45 +00002451static int find_cpu_clusters(Object *child, void *opaque)
2452{
2453 if (object_dynamic_cast(child, TYPE_CPU_CLUSTER)) {
2454 GDBState *s = (GDBState *) opaque;
2455 CPUClusterState *cluster = CPU_CLUSTER(child);
2456 GDBProcess *process;
2457
2458 s->processes = g_renew(GDBProcess, s->processes, ++s->process_num);
2459
2460 process = &s->processes[s->process_num - 1];
2461
2462 /*
2463 * GDB process IDs -1 and 0 are reserved. To avoid subtle errors at
2464 * runtime, we enforce here that the machine does not use a cluster ID
2465 * that would lead to PID 0.
2466 */
2467 assert(cluster->cluster_id != UINT32_MAX);
2468 process->pid = cluster->cluster_id + 1;
2469 process->attached = false;
Luc Michelc145eea2019-01-07 15:23:46 +00002470 process->target_xml[0] = '\0';
Luc Michel8f468632019-01-07 15:23:45 +00002471
2472 return 0;
2473 }
2474
2475 return object_child_foreach(child, find_cpu_clusters, opaque);
2476}
2477
2478static int pid_order(const void *a, const void *b)
2479{
2480 GDBProcess *pa = (GDBProcess *) a;
2481 GDBProcess *pb = (GDBProcess *) b;
2482
2483 if (pa->pid < pb->pid) {
2484 return -1;
2485 } else if (pa->pid > pb->pid) {
2486 return 1;
2487 } else {
2488 return 0;
2489 }
2490}
2491
2492static void create_processes(GDBState *s)
2493{
2494 object_child_foreach(object_get_root(), find_cpu_clusters, s);
2495
2496 if (s->processes) {
2497 /* Sort by PID */
2498 qsort(s->processes, s->process_num, sizeof(s->processes[0]), pid_order);
2499 }
2500
2501 create_default_process(s);
2502}
2503
2504static void cleanup_processes(GDBState *s)
2505{
2506 g_free(s->processes);
2507 s->process_num = 0;
2508 s->processes = NULL;
2509}
2510
aliguori59030a82009-04-05 18:43:41 +00002511int gdbserver_start(const char *device)
pbrook4046d912007-01-28 01:53:16 +00002512{
Doug Gale5c9522b2017-12-02 20:30:37 -05002513 trace_gdbstub_op_start(device);
2514
pbrook4046d912007-01-28 01:53:16 +00002515 GDBState *s;
aliguori59030a82009-04-05 18:43:41 +00002516 char gdbstub_device_name[128];
Marc-André Lureau0ec7b3e2016-12-07 16:20:22 +03002517 Chardev *chr = NULL;
2518 Chardev *mon_chr;
pbrook4046d912007-01-28 01:53:16 +00002519
Ziyue Yang508b4ec2017-01-18 16:02:41 +08002520 if (!first_cpu) {
2521 error_report("gdbstub: meaningless to attach gdb to a "
2522 "machine without any CPU.");
2523 return -1;
2524 }
2525
aliguori59030a82009-04-05 18:43:41 +00002526 if (!device)
2527 return -1;
2528 if (strcmp(device, "none") != 0) {
2529 if (strstart(device, "tcp:", NULL)) {
2530 /* enforce required TCP attributes */
2531 snprintf(gdbstub_device_name, sizeof(gdbstub_device_name),
2532 "%s,nowait,nodelay,server", device);
2533 device = gdbstub_device_name;
aliguori36556b22009-03-28 18:05:53 +00002534 }
aliguori59030a82009-04-05 18:43:41 +00002535#ifndef _WIN32
2536 else if (strcmp(device, "stdio") == 0) {
2537 struct sigaction act;
pbrookcfc34752007-02-22 01:48:01 +00002538
aliguori59030a82009-04-05 18:43:41 +00002539 memset(&act, 0, sizeof(act));
2540 act.sa_handler = gdb_sigterm_handler;
2541 sigaction(SIGINT, &act, NULL);
2542 }
2543#endif
Marc-André Lureau95e30b22018-08-22 19:19:42 +02002544 /*
2545 * FIXME: it's a bit weird to allow using a mux chardev here
2546 * and implicitly setup a monitor. We may want to break this.
2547 */
2548 chr = qemu_chr_new_noreplay("gdb", device, true);
aliguori36556b22009-03-28 18:05:53 +00002549 if (!chr)
2550 return -1;
pbrookcfc34752007-02-22 01:48:01 +00002551 }
2552
aliguori36556b22009-03-28 18:05:53 +00002553 s = gdbserver_state;
2554 if (!s) {
Anthony Liguori7267c092011-08-20 22:09:37 -05002555 s = g_malloc0(sizeof(GDBState));
aliguori36556b22009-03-28 18:05:53 +00002556 gdbserver_state = s;
pbrook4046d912007-01-28 01:53:16 +00002557
aliguori36556b22009-03-28 18:05:53 +00002558 qemu_add_vm_change_state_handler(gdb_vm_state_change, NULL);
2559
2560 /* Initialize a monitor terminal for gdb */
Marc-André Lureau777357d2016-12-07 18:39:10 +03002561 mon_chr = qemu_chardev_new(NULL, TYPE_CHARDEV_GDB,
2562 NULL, &error_abort);
aliguori36556b22009-03-28 18:05:53 +00002563 monitor_init(mon_chr, 0);
2564 } else {
Marc-André Lureau1ce26102017-01-27 00:49:13 +04002565 qemu_chr_fe_deinit(&s->chr, true);
aliguori36556b22009-03-28 18:05:53 +00002566 mon_chr = s->mon_chr;
Luc Michel8f468632019-01-07 15:23:45 +00002567 cleanup_processes(s);
aliguori36556b22009-03-28 18:05:53 +00002568 memset(s, 0, sizeof(GDBState));
Marc-André Lureau32a6ebe2016-10-22 12:52:52 +03002569 s->mon_chr = mon_chr;
aliguori36556b22009-03-28 18:05:53 +00002570 }
Luc Michel8f468632019-01-07 15:23:45 +00002571
2572 create_processes(s);
2573
Marc-André Lureau32a6ebe2016-10-22 12:52:52 +03002574 if (chr) {
2575 qemu_chr_fe_init(&s->chr, chr, &error_abort);
Marc-André Lureau5345fdb2016-10-22 12:52:55 +03002576 qemu_chr_fe_set_handlers(&s->chr, gdb_chr_can_receive, gdb_chr_receive,
Luc Michel970ed902019-01-07 15:23:46 +00002577 gdb_chr_event, NULL, s, NULL, true);
Marc-André Lureau32a6ebe2016-10-22 12:52:52 +03002578 }
aliguori36556b22009-03-28 18:05:53 +00002579 s->state = chr ? RS_IDLE : RS_INACTIVE;
2580 s->mon_chr = mon_chr;
Meador Ingecdb432b2012-03-15 17:49:45 +00002581 s->current_syscall_cb = NULL;
aliguori8a34a0f2009-03-05 23:01:55 +00002582
pbrook4046d912007-01-28 01:53:16 +00002583 return 0;
2584}
Marc-André Lureau777357d2016-12-07 18:39:10 +03002585
KONRAD Frederic1bb982b2018-03-20 10:39:33 +01002586void gdbserver_cleanup(void)
2587{
2588 if (gdbserver_state) {
2589 put_packet(gdbserver_state, "W00");
2590 }
2591}
2592
Marc-André Lureau777357d2016-12-07 18:39:10 +03002593static void register_types(void)
2594{
2595 type_register_static(&char_gdb_type_info);
2596}
2597
2598type_init(register_types);
pbrook4046d912007-01-28 01:53:16 +00002599#endif