xref: /freebsd/sys/gdb/gdb_main.c (revision 7029da5c36f2d3cf6bb6c81bf551229f416399e8)
1fa521b03SWarner Losh /*-
2497b6b2aSPedro F. Giffuni  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3497b6b2aSPedro F. Giffuni  *
472d44f31SMarcel Moolenaar  * Copyright (c) 2004 Marcel Moolenaar
572d44f31SMarcel Moolenaar  * All rights reserved.
672d44f31SMarcel Moolenaar  *
772d44f31SMarcel Moolenaar  * Redistribution and use in source and binary forms, with or without
872d44f31SMarcel Moolenaar  * modification, are permitted provided that the following conditions
972d44f31SMarcel Moolenaar  * are met:
1072d44f31SMarcel Moolenaar  *
1172d44f31SMarcel Moolenaar  * 1. Redistributions of source code must retain the above copyright
1272d44f31SMarcel Moolenaar  *    notice, this list of conditions and the following disclaimer.
1372d44f31SMarcel Moolenaar  * 2. Redistributions in binary form must reproduce the above copyright
1472d44f31SMarcel Moolenaar  *    notice, this list of conditions and the following disclaimer in the
1572d44f31SMarcel Moolenaar  *    documentation and/or other materials provided with the distribution.
1672d44f31SMarcel Moolenaar  *
1772d44f31SMarcel Moolenaar  * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
1872d44f31SMarcel Moolenaar  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
1972d44f31SMarcel Moolenaar  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
2072d44f31SMarcel Moolenaar  * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
2172d44f31SMarcel Moolenaar  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
2272d44f31SMarcel Moolenaar  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
2372d44f31SMarcel Moolenaar  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
2472d44f31SMarcel Moolenaar  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
2572d44f31SMarcel Moolenaar  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
2672d44f31SMarcel Moolenaar  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
2772d44f31SMarcel Moolenaar  */
2872d44f31SMarcel Moolenaar 
2972d44f31SMarcel Moolenaar #include <sys/cdefs.h>
3072d44f31SMarcel Moolenaar __FBSDID("$FreeBSD$");
3172d44f31SMarcel Moolenaar 
3272d44f31SMarcel Moolenaar #include <sys/param.h>
3372d44f31SMarcel Moolenaar #include <sys/systm.h>
3472d44f31SMarcel Moolenaar #include <sys/kdb.h>
3572d44f31SMarcel Moolenaar #include <sys/kernel.h>
3672d44f31SMarcel Moolenaar #include <sys/pcpu.h>
3772d44f31SMarcel Moolenaar #include <sys/proc.h>
3872d44f31SMarcel Moolenaar #include <sys/reboot.h>
395555afa1SConrad Meyer #include <sys/sbuf.h>
4072d44f31SMarcel Moolenaar 
4172d44f31SMarcel Moolenaar #include <machine/gdb_machdep.h>
4272d44f31SMarcel Moolenaar #include <machine/kdb.h>
4372d44f31SMarcel Moolenaar 
4472d44f31SMarcel Moolenaar #include <gdb/gdb.h>
4572d44f31SMarcel Moolenaar #include <gdb/gdb_int.h>
4672d44f31SMarcel Moolenaar 
47*7029da5cSPawel Biernacki SYSCTL_NODE(_debug, OID_AUTO, gdb, CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
48*7029da5cSPawel Biernacki     "GDB settings");
4910f6c05cSConrad Meyer 
5072d44f31SMarcel Moolenaar static dbbe_init_f gdb_init;
5172d44f31SMarcel Moolenaar static dbbe_trap_f gdb_trap;
5272d44f31SMarcel Moolenaar 
5328926c57SJohn Baldwin KDB_BACKEND(gdb, gdb_init, NULL, NULL, gdb_trap);
5472d44f31SMarcel Moolenaar 
55e8d86c0eSPoul-Henning Kamp static struct gdb_dbgport null_gdb_dbgport;
56e8d86c0eSPoul-Henning Kamp DATA_SET(gdb_dbgport_set, null_gdb_dbgport);
5772d44f31SMarcel Moolenaar SET_DECLARE(gdb_dbgport_set, struct gdb_dbgport);
5872d44f31SMarcel Moolenaar 
5972d44f31SMarcel Moolenaar struct gdb_dbgport *gdb_cur = NULL;
607d0c6c9fSSam Leffler int gdb_listening = 0;
616310546dSConrad Meyer bool gdb_ackmode = true;
6272d44f31SMarcel Moolenaar 
6327ecc2adSBenno Rice static unsigned char gdb_bindata[64];
6427ecc2adSBenno Rice 
65dda17b36SConrad Meyer #ifdef DDB
66dda17b36SConrad Meyer bool gdb_return_to_ddb = false;
67dda17b36SConrad Meyer #endif
68dda17b36SConrad Meyer 
6972d44f31SMarcel Moolenaar static int
7072d44f31SMarcel Moolenaar gdb_init(void)
7172d44f31SMarcel Moolenaar {
7272d44f31SMarcel Moolenaar 	struct gdb_dbgport *dp, **iter;
7372d44f31SMarcel Moolenaar 	int cur_pri, pri;
7472d44f31SMarcel Moolenaar 
7572d44f31SMarcel Moolenaar 	gdb_cur = NULL;
7672d44f31SMarcel Moolenaar 	cur_pri = -1;
7772d44f31SMarcel Moolenaar 	SET_FOREACH(iter, gdb_dbgport_set) {
7872d44f31SMarcel Moolenaar 		dp = *iter;
7972d44f31SMarcel Moolenaar 		pri = (dp->gdb_probe != NULL) ? dp->gdb_probe() : -1;
8072d44f31SMarcel Moolenaar 		dp->gdb_active = (pri >= 0) ? 0 : -1;
8172d44f31SMarcel Moolenaar 		if (pri > cur_pri) {
8272d44f31SMarcel Moolenaar 			cur_pri = pri;
8372d44f31SMarcel Moolenaar 			gdb_cur = dp;
8472d44f31SMarcel Moolenaar 		}
8572d44f31SMarcel Moolenaar 	}
8672d44f31SMarcel Moolenaar 	if (gdb_cur != NULL) {
8772d44f31SMarcel Moolenaar 		printf("GDB: debug ports:");
8872d44f31SMarcel Moolenaar 		SET_FOREACH(iter, gdb_dbgport_set) {
8972d44f31SMarcel Moolenaar 			dp = *iter;
9072d44f31SMarcel Moolenaar 			if (dp->gdb_active == 0)
9172d44f31SMarcel Moolenaar 				printf(" %s", dp->gdb_name);
9272d44f31SMarcel Moolenaar 		}
9372d44f31SMarcel Moolenaar 		printf("\n");
9472d44f31SMarcel Moolenaar 	} else
9572d44f31SMarcel Moolenaar 		printf("GDB: no debug ports present\n");
9672d44f31SMarcel Moolenaar 	if (gdb_cur != NULL) {
9772d44f31SMarcel Moolenaar 		gdb_cur->gdb_init();
9872d44f31SMarcel Moolenaar 		printf("GDB: current port: %s\n", gdb_cur->gdb_name);
9972d44f31SMarcel Moolenaar 	}
1007d0c6c9fSSam Leffler 	if (gdb_cur != NULL) {
10172d44f31SMarcel Moolenaar 		cur_pri = (boothowto & RB_GDB) ? 2 : 0;
1027d0c6c9fSSam Leffler 		gdb_consinit();
1037d0c6c9fSSam Leffler 	} else
10472d44f31SMarcel Moolenaar 		cur_pri = -1;
10572d44f31SMarcel Moolenaar 	return (cur_pri);
10672d44f31SMarcel Moolenaar }
10772d44f31SMarcel Moolenaar 
1088a7a6571SRyan Libby static void
1098a7a6571SRyan Libby gdb_do_mem_search(void)
1108a7a6571SRyan Libby {
1118a7a6571SRyan Libby 	size_t patlen;
1128a7a6571SRyan Libby 	intmax_t addr, size;
1138a7a6571SRyan Libby 	const unsigned char *found;
1148a7a6571SRyan Libby 
1158a7a6571SRyan Libby 	if (gdb_rx_varhex(&addr) || gdb_rx_char() != ';' ||
1168a7a6571SRyan Libby 	    gdb_rx_varhex(&size) || gdb_rx_char() != ';' ||
1178a7a6571SRyan Libby 	    gdb_rx_bindata(gdb_bindata, sizeof(gdb_bindata), &patlen)) {
1188a7a6571SRyan Libby 		gdb_tx_err(EINVAL);
1198a7a6571SRyan Libby 		return;
1208a7a6571SRyan Libby 	}
1218a7a6571SRyan Libby 	if (gdb_search_mem((char *)(uintptr_t)addr, size, gdb_bindata,
1228a7a6571SRyan Libby 	    patlen, &found)) {
1238a7a6571SRyan Libby 		if (found == 0ULL)
1248a7a6571SRyan Libby 			gdb_tx_begin('0');
1258a7a6571SRyan Libby 		else {
1268a7a6571SRyan Libby 			gdb_tx_begin('1');
1278a7a6571SRyan Libby 			gdb_tx_char(',');
1288a7a6571SRyan Libby 			gdb_tx_hex((intmax_t)(uintptr_t)found, 8);
1298a7a6571SRyan Libby 		}
1308a7a6571SRyan Libby 		gdb_tx_end();
1318a7a6571SRyan Libby 	} else
1328a7a6571SRyan Libby 		gdb_tx_err(EIO);
1338a7a6571SRyan Libby }
1348a7a6571SRyan Libby 
135130ef1adSConrad Meyer static void
136130ef1adSConrad Meyer gdb_do_threadinfo(struct thread **thr_iter)
137130ef1adSConrad Meyer {
138130ef1adSConrad Meyer 	static struct thread * const done_sentinel = (void *)(uintptr_t)1;
139130ef1adSConrad Meyer 	static const size_t tidsz_hex = sizeof(lwpid_t) * 2;
140130ef1adSConrad Meyer 	size_t tds_sent;
141130ef1adSConrad Meyer 
142130ef1adSConrad Meyer 	if (*thr_iter == NULL) {
143130ef1adSConrad Meyer 		gdb_tx_err(ENXIO);
144130ef1adSConrad Meyer 		return;
145130ef1adSConrad Meyer 	}
146130ef1adSConrad Meyer 
147130ef1adSConrad Meyer 	if (*thr_iter == done_sentinel) {
148130ef1adSConrad Meyer 		gdb_tx_begin('l');
149130ef1adSConrad Meyer 		*thr_iter = NULL;
150130ef1adSConrad Meyer 		goto sendit;
151130ef1adSConrad Meyer 	}
152130ef1adSConrad Meyer 
153130ef1adSConrad Meyer 	gdb_tx_begin('m');
154130ef1adSConrad Meyer 
155130ef1adSConrad Meyer 	for (tds_sent = 0;
156130ef1adSConrad Meyer 	    *thr_iter != NULL && gdb_txbuf_has_capacity(tidsz_hex + 1);
157130ef1adSConrad Meyer 	    *thr_iter = kdb_thr_next(*thr_iter), tds_sent++) {
158130ef1adSConrad Meyer 		if (tds_sent > 0)
159130ef1adSConrad Meyer 			gdb_tx_char(',');
160130ef1adSConrad Meyer 		gdb_tx_varhex((*thr_iter)->td_tid);
161130ef1adSConrad Meyer 	}
162130ef1adSConrad Meyer 
163130ef1adSConrad Meyer 	/*
164130ef1adSConrad Meyer 	 * Can't send EOF and "some" in same packet, so set a sentinel to send
165130ef1adSConrad Meyer 	 * EOF when GDB asks us next.
166130ef1adSConrad Meyer 	 */
167130ef1adSConrad Meyer 	if (*thr_iter == NULL && tds_sent > 0)
168130ef1adSConrad Meyer 		*thr_iter = done_sentinel;
169130ef1adSConrad Meyer 
170130ef1adSConrad Meyer sendit:
171130ef1adSConrad Meyer 	gdb_tx_end();
172130ef1adSConrad Meyer }
173130ef1adSConrad Meyer 
174c4fbbfaaSConrad Meyer #define	BIT(n)	(1ull << (n))
175c4fbbfaaSConrad Meyer enum {
176c4fbbfaaSConrad Meyer 	GDB_MULTIPROCESS,
177c4fbbfaaSConrad Meyer 	GDB_SWBREAK,
178c4fbbfaaSConrad Meyer 	GDB_HWBREAK,
179c4fbbfaaSConrad Meyer 	GDB_QRELOCINSN,
180c4fbbfaaSConrad Meyer 	GDB_FORK_EVENTS,
181c4fbbfaaSConrad Meyer 	GDB_VFORK_EVENTS,
182c4fbbfaaSConrad Meyer 	GDB_EXEC_EVENTS,
183c4fbbfaaSConrad Meyer 	GDB_VCONT_SUPPORTED,
184c4fbbfaaSConrad Meyer 	GDB_QTHREADEVENTS,
185c4fbbfaaSConrad Meyer 	GDB_NO_RESUMED,
186c4fbbfaaSConrad Meyer };
187c4fbbfaaSConrad Meyer static const char * const gdb_feature_names[] = {
188c4fbbfaaSConrad Meyer 	[GDB_MULTIPROCESS] = "multiprocess",
189c4fbbfaaSConrad Meyer 	[GDB_SWBREAK] = "swbreak",
190c4fbbfaaSConrad Meyer 	[GDB_HWBREAK] = "hwbreak",
191c4fbbfaaSConrad Meyer 	[GDB_QRELOCINSN] = "qRelocInsn",
192c4fbbfaaSConrad Meyer 	[GDB_FORK_EVENTS] = "fork-events",
193c4fbbfaaSConrad Meyer 	[GDB_VFORK_EVENTS] = "vfork-events",
194c4fbbfaaSConrad Meyer 	[GDB_EXEC_EVENTS] = "exec-events",
195c4fbbfaaSConrad Meyer 	[GDB_VCONT_SUPPORTED] = "vContSupported",
196c4fbbfaaSConrad Meyer 	[GDB_QTHREADEVENTS] = "QThreadEvents",
197c4fbbfaaSConrad Meyer 	[GDB_NO_RESUMED] = "no-resumed",
198c4fbbfaaSConrad Meyer };
199c4fbbfaaSConrad Meyer static void
200c4fbbfaaSConrad Meyer gdb_do_qsupported(uint32_t *feat)
201c4fbbfaaSConrad Meyer {
202c4fbbfaaSConrad Meyer 	char *tok, *delim, ok;
203c4fbbfaaSConrad Meyer 	size_t i, toklen;
204c4fbbfaaSConrad Meyer 
205c4fbbfaaSConrad Meyer 	/* Parse supported host features */
206c4fbbfaaSConrad Meyer 	*feat = 0;
207c4fbbfaaSConrad Meyer 	if (gdb_rx_char() != ':')
208c4fbbfaaSConrad Meyer 		goto error;
209c4fbbfaaSConrad Meyer 
210c4fbbfaaSConrad Meyer 	while (gdb_rxsz > 0) {
211c4fbbfaaSConrad Meyer 		tok = gdb_rxp;
212c4fbbfaaSConrad Meyer 		delim = strchrnul(gdb_rxp, ';');
213c4fbbfaaSConrad Meyer 		toklen = (delim - tok);
214c4fbbfaaSConrad Meyer 
215c4fbbfaaSConrad Meyer 		gdb_rxp += toklen;
216c4fbbfaaSConrad Meyer 		gdb_rxsz -= toklen;
217c4fbbfaaSConrad Meyer 		if (*delim != '\0') {
218c4fbbfaaSConrad Meyer 			*delim = '\0';
219c4fbbfaaSConrad Meyer 			gdb_rxp += 1;
220c4fbbfaaSConrad Meyer 			gdb_rxsz -= 1;
221c4fbbfaaSConrad Meyer 		}
222c4fbbfaaSConrad Meyer 
223c4fbbfaaSConrad Meyer 		if (toklen < 2)
224c4fbbfaaSConrad Meyer 			goto error;
225c4fbbfaaSConrad Meyer 
226c4fbbfaaSConrad Meyer 		ok = tok[toklen - 1];
227c4fbbfaaSConrad Meyer 		if (ok != '-' && ok != '+') {
228c4fbbfaaSConrad Meyer 			/*
229c4fbbfaaSConrad Meyer 			 * GDB only has one KV-pair feature, and we don't
230c4fbbfaaSConrad Meyer 			 * support it, so ignore and move on.
231c4fbbfaaSConrad Meyer 			 */
232c4fbbfaaSConrad Meyer 			if (strchr(tok, '=') != NULL)
233c4fbbfaaSConrad Meyer 				continue;
234c4fbbfaaSConrad Meyer 			/* Not a KV-pair, and not a +/- flag?  Malformed. */
235c4fbbfaaSConrad Meyer 			goto error;
236c4fbbfaaSConrad Meyer 		}
237c4fbbfaaSConrad Meyer 		if (ok != '+')
238c4fbbfaaSConrad Meyer 			continue;
239c4fbbfaaSConrad Meyer 		tok[toklen - 1] = '\0';
240c4fbbfaaSConrad Meyer 
241c4fbbfaaSConrad Meyer 		for (i = 0; i < nitems(gdb_feature_names); i++)
242c4fbbfaaSConrad Meyer 			if (strcmp(gdb_feature_names[i], tok) == 0)
243c4fbbfaaSConrad Meyer 				break;
244c4fbbfaaSConrad Meyer 
245c4fbbfaaSConrad Meyer 		if (i == nitems(gdb_feature_names)) {
246c4fbbfaaSConrad Meyer 			/* Unknown GDB feature. */
247c4fbbfaaSConrad Meyer 			continue;
248c4fbbfaaSConrad Meyer 		}
249c4fbbfaaSConrad Meyer 
250c4fbbfaaSConrad Meyer 		*feat |= BIT(i);
251c4fbbfaaSConrad Meyer 	}
252c4fbbfaaSConrad Meyer 
253c4fbbfaaSConrad Meyer 	/* Send a supported feature list back */
254c4fbbfaaSConrad Meyer 	gdb_tx_begin(0);
255c4fbbfaaSConrad Meyer 
256c4fbbfaaSConrad Meyer 	gdb_tx_str("PacketSize");
257c4fbbfaaSConrad Meyer 	gdb_tx_char('=');
258c4fbbfaaSConrad Meyer 	/*
259c4fbbfaaSConrad Meyer 	 * We don't buffer framing bytes, but we do need to retain a byte for a
260c4fbbfaaSConrad Meyer 	 * trailing nul.
261c4fbbfaaSConrad Meyer 	 */
262c4fbbfaaSConrad Meyer 	gdb_tx_varhex(GDB_BUFSZ + strlen("$#nn") - 1);
263c4fbbfaaSConrad Meyer 
2645555afa1SConrad Meyer 	gdb_tx_str(";qXfer:threads:read+");
2655555afa1SConrad Meyer 
266c4fbbfaaSConrad Meyer 	/*
2676310546dSConrad Meyer 	 * If the debugport is a reliable transport, request No Ack mode from
2686310546dSConrad Meyer 	 * the server.  The server may or may not choose to enter No Ack mode.
2696310546dSConrad Meyer 	 * https://sourceware.org/gdb/onlinedocs/gdb/Packet-Acknowledgment.html
2706310546dSConrad Meyer 	 */
2716310546dSConrad Meyer 	if (gdb_cur->gdb_dbfeatures & GDB_DBGP_FEAT_RELIABLE)
2726310546dSConrad Meyer 		gdb_tx_str(";QStartNoAckMode+");
2736310546dSConrad Meyer 
2746310546dSConrad Meyer 	/*
275c4fbbfaaSConrad Meyer 	 * Future consideration:
276c4fbbfaaSConrad Meyer 	 *   - vCont
277c4fbbfaaSConrad Meyer 	 *   - multiprocess
278c4fbbfaaSConrad Meyer 	 */
279c4fbbfaaSConrad Meyer 	gdb_tx_end();
280c4fbbfaaSConrad Meyer 	return;
281c4fbbfaaSConrad Meyer 
282c4fbbfaaSConrad Meyer error:
283c4fbbfaaSConrad Meyer 	*feat = 0;
284c4fbbfaaSConrad Meyer 	gdb_tx_err(EINVAL);
285c4fbbfaaSConrad Meyer }
286c4fbbfaaSConrad Meyer 
2875555afa1SConrad Meyer /*
2885555afa1SConrad Meyer  * A qXfer_context provides a vaguely generic way to generate a multi-packet
2895555afa1SConrad Meyer  * response on the fly, making some assumptions about the size of sbuf writes
2905555afa1SConrad Meyer  * vs actual packet length constraints.  A non-byzantine gdb host should allow
2915555afa1SConrad Meyer  * hundreds of bytes per packet or more.
2925555afa1SConrad Meyer  *
2935555afa1SConrad Meyer  * Upper layers are considered responsible for escaping the four forbidden
2945555afa1SConrad Meyer  * characters '# $ } *'.
2955555afa1SConrad Meyer  */
2965555afa1SConrad Meyer struct qXfer_context {
2975555afa1SConrad Meyer 	struct sbuf sb;
2985555afa1SConrad Meyer 	size_t last_offset;
2995555afa1SConrad Meyer 	bool flushed;
3005555afa1SConrad Meyer 	bool lastmessage;
3015555afa1SConrad Meyer 	char xfer_buf[GDB_BUFSZ];
3025555afa1SConrad Meyer };
3035555afa1SConrad Meyer 
3045555afa1SConrad Meyer static int
3055555afa1SConrad Meyer qXfer_drain(void *v, const char *buf, int len)
3065555afa1SConrad Meyer {
3075555afa1SConrad Meyer 	struct qXfer_context *qx;
3085555afa1SConrad Meyer 
3095555afa1SConrad Meyer 	if (len < 0)
3105555afa1SConrad Meyer 		return (-EINVAL);
3115555afa1SConrad Meyer 
3125555afa1SConrad Meyer 	qx = v;
3135555afa1SConrad Meyer 	if (qx->flushed) {
3145555afa1SConrad Meyer 		/*
3155555afa1SConrad Meyer 		 * Overflow.  We lost some message.  Maybe the packet size is
3165555afa1SConrad Meyer 		 * ridiculously small.
3175555afa1SConrad Meyer 		 */
3185555afa1SConrad Meyer 		printf("%s: Overflow in qXfer detected.\n", __func__);
3195555afa1SConrad Meyer 		return (-ENOBUFS);
3205555afa1SConrad Meyer 	}
3215555afa1SConrad Meyer 
3225555afa1SConrad Meyer 	qx->last_offset += len;
3235555afa1SConrad Meyer 	qx->flushed = true;
3245555afa1SConrad Meyer 
3255555afa1SConrad Meyer 	if (qx->lastmessage)
3265555afa1SConrad Meyer 		gdb_tx_begin('l');
3275555afa1SConrad Meyer 	else
3285555afa1SConrad Meyer 		gdb_tx_begin('m');
3295555afa1SConrad Meyer 
3305555afa1SConrad Meyer 	memcpy(gdb_txp, buf, len);
3315555afa1SConrad Meyer 	gdb_txp += len;
3325555afa1SConrad Meyer 
3335555afa1SConrad Meyer 	gdb_tx_end();
3345555afa1SConrad Meyer 	return (len);
3355555afa1SConrad Meyer }
3365555afa1SConrad Meyer 
3375555afa1SConrad Meyer static int
3385555afa1SConrad Meyer init_qXfer_ctx(struct qXfer_context *qx, uintmax_t len)
3395555afa1SConrad Meyer {
3405555afa1SConrad Meyer 
3415555afa1SConrad Meyer 	/* Protocol (max) length field includes framing overhead. */
3425555afa1SConrad Meyer 	if (len < sizeof("$m#nn"))
3435555afa1SConrad Meyer 		return (ENOSPC);
3445555afa1SConrad Meyer 
3455555afa1SConrad Meyer 	len -= 4;
3465555afa1SConrad Meyer 	len = ummin(len, GDB_BUFSZ - 1);
3475555afa1SConrad Meyer 
3485555afa1SConrad Meyer 	qx->last_offset = 0;
3495555afa1SConrad Meyer 	qx->flushed = false;
3505555afa1SConrad Meyer 	qx->lastmessage = false;
3515555afa1SConrad Meyer 	sbuf_new(&qx->sb, qx->xfer_buf, len, SBUF_FIXEDLEN);
3525555afa1SConrad Meyer 	sbuf_set_drain(&qx->sb, qXfer_drain, qx);
3535555afa1SConrad Meyer 	return (0);
3545555afa1SConrad Meyer }
3555555afa1SConrad Meyer 
3565555afa1SConrad Meyer /*
3575555afa1SConrad Meyer  * dst must be 2x strlen(max_src) + 1.
3585555afa1SConrad Meyer  *
3595555afa1SConrad Meyer  * Squashes invalid XML characters down to _.  Sorry.  Then escapes for GDB.
3605555afa1SConrad Meyer  */
3615555afa1SConrad Meyer static void
3625555afa1SConrad Meyer qXfer_escape_xmlattr_str(char *dst, size_t dstlen, const char *src)
3635555afa1SConrad Meyer {
3645555afa1SConrad Meyer 	static const char *forbidden = "#$}*";
3655555afa1SConrad Meyer 
3665555afa1SConrad Meyer 	size_t i;
3675555afa1SConrad Meyer 	char c;
3685555afa1SConrad Meyer 
3695555afa1SConrad Meyer 	for (i = 0; i < dstlen - 1 && *src != 0; src++, i++) {
3705555afa1SConrad Meyer 		c = *src;
3715555afa1SConrad Meyer 		/* XML attr filter */
3725555afa1SConrad Meyer 		if (c < 32)
3735555afa1SConrad Meyer 			c = '_';
3745555afa1SConrad Meyer 		/* We assume attributes will be "" quoted. */
3755555afa1SConrad Meyer 		if (c == '<' || c == '&' || c == '"')
3765555afa1SConrad Meyer 			c = '_';
3775555afa1SConrad Meyer 
3785555afa1SConrad Meyer 		/* GDB escape. */
3795555afa1SConrad Meyer 		if (strchr(forbidden, c) != NULL) {
3805555afa1SConrad Meyer 			*dst++ = '}';
3815555afa1SConrad Meyer 			c ^= 0x20;
3825555afa1SConrad Meyer 		}
3835555afa1SConrad Meyer 		*dst++ = c;
3845555afa1SConrad Meyer 	}
3855555afa1SConrad Meyer 	if (*src != 0)
3865555afa1SConrad Meyer 		printf("XXX%s: overflow; API misuse\n", __func__);
3875555afa1SConrad Meyer 
3885555afa1SConrad Meyer 	*dst = 0;
3895555afa1SConrad Meyer }
3905555afa1SConrad Meyer 
3915555afa1SConrad Meyer /*
3925555afa1SConrad Meyer  * Dynamically generate qXfer:threads document, one packet at a time.
3935555afa1SConrad Meyer  *
3945555afa1SConrad Meyer  * The format is loosely described[0], although it does not seem that the
3955555afa1SConrad Meyer  * <?xml?> mentioned on that page is required.
3965555afa1SConrad Meyer  *
3975555afa1SConrad Meyer  * [0]: https://sourceware.org/gdb/current/onlinedocs/gdb/Thread-List-Format.html
3985555afa1SConrad Meyer  */
3995555afa1SConrad Meyer static void
4005555afa1SConrad Meyer do_qXfer_threads_read(void)
4015555afa1SConrad Meyer {
4025555afa1SConrad Meyer 	/* Kludgy context */
4035555afa1SConrad Meyer 	static struct {
4045555afa1SConrad Meyer 		struct qXfer_context qXfer;
4055555afa1SConrad Meyer 		/* Kludgy state machine */
4065555afa1SConrad Meyer 		struct thread *iter;
4075555afa1SConrad Meyer 		enum {
4085555afa1SConrad Meyer 			XML_START_THREAD,	/* '<thread' */
4095555afa1SConrad Meyer 			XML_THREAD_ID,		/* ' id="xxx"' */
4105555afa1SConrad Meyer 			XML_THREAD_CORE,	/* ' core="yyy"' */
4115555afa1SConrad Meyer 			XML_THREAD_NAME,	/* ' name="zzz"' */
4125555afa1SConrad Meyer 			XML_THREAD_EXTRA,	/* '> ...' */
4135555afa1SConrad Meyer 			XML_END_THREAD,		/* '</thread>' */
4145555afa1SConrad Meyer 			XML_SENT_END_THREADS,	/* '</threads>' */
4155555afa1SConrad Meyer 		} next_step;
4165555afa1SConrad Meyer 	} ctx;
4175555afa1SConrad Meyer 	static char td_name_escape[MAXCOMLEN * 2 + 1];
4185555afa1SConrad Meyer 
4195555afa1SConrad Meyer 	const char *name_src;
4205555afa1SConrad Meyer 	uintmax_t offset, len;
4215555afa1SConrad Meyer 	int error;
4225555afa1SConrad Meyer 
4235555afa1SConrad Meyer 	/* Annex part must be empty. */
4245555afa1SConrad Meyer 	if (gdb_rx_char() != ':')
4255555afa1SConrad Meyer 		goto misformed_request;
4265555afa1SConrad Meyer 
4275555afa1SConrad Meyer 	if (gdb_rx_varhex(&offset) != 0 ||
4285555afa1SConrad Meyer 	    gdb_rx_char() != ',' ||
4295555afa1SConrad Meyer 	    gdb_rx_varhex(&len) != 0)
4305555afa1SConrad Meyer 		goto misformed_request;
4315555afa1SConrad Meyer 
4325555afa1SConrad Meyer 	/*
4335555afa1SConrad Meyer 	 * Validate resume xfers.
4345555afa1SConrad Meyer 	 */
4355555afa1SConrad Meyer 	if (offset != 0) {
4365555afa1SConrad Meyer 		if (offset != ctx.qXfer.last_offset) {
437acef7371SConrad Meyer 			printf("%s: Resumed offset %ju != expected %zu\n",
4385555afa1SConrad Meyer 			    __func__, offset, ctx.qXfer.last_offset);
4395555afa1SConrad Meyer 			error = ESPIPE;
4405555afa1SConrad Meyer 			goto request_error;
4415555afa1SConrad Meyer 		}
4425555afa1SConrad Meyer 		ctx.qXfer.flushed = false;
4435555afa1SConrad Meyer 	}
4445555afa1SConrad Meyer 
4455555afa1SConrad Meyer 	if (offset == 0) {
4465555afa1SConrad Meyer 		ctx.iter = kdb_thr_first();
4475555afa1SConrad Meyer 		ctx.next_step = XML_START_THREAD;
4485555afa1SConrad Meyer 		error = init_qXfer_ctx(&ctx.qXfer, len);
4495555afa1SConrad Meyer 		if (error != 0)
4505555afa1SConrad Meyer 			goto request_error;
4515555afa1SConrad Meyer 
4525555afa1SConrad Meyer 		sbuf_cat(&ctx.qXfer.sb, "<threads>");
4535555afa1SConrad Meyer 	}
4545555afa1SConrad Meyer 
4555555afa1SConrad Meyer 	while (!ctx.qXfer.flushed && ctx.iter != NULL) {
4565555afa1SConrad Meyer 		switch (ctx.next_step) {
4575555afa1SConrad Meyer 		case XML_START_THREAD:
4585555afa1SConrad Meyer 			ctx.next_step = XML_THREAD_ID;
4595555afa1SConrad Meyer 			sbuf_cat(&ctx.qXfer.sb, "<thread");
4605555afa1SConrad Meyer 			continue;
4615555afa1SConrad Meyer 
4625555afa1SConrad Meyer 		case XML_THREAD_ID:
4635555afa1SConrad Meyer 			ctx.next_step = XML_THREAD_CORE;
4645555afa1SConrad Meyer 			sbuf_printf(&ctx.qXfer.sb, " id=\"%jx\"",
4655555afa1SConrad Meyer 			    (uintmax_t)ctx.iter->td_tid);
4665555afa1SConrad Meyer 			continue;
4675555afa1SConrad Meyer 
4685555afa1SConrad Meyer 		case XML_THREAD_CORE:
4695555afa1SConrad Meyer 			ctx.next_step = XML_THREAD_NAME;
4705555afa1SConrad Meyer 			if (ctx.iter->td_oncpu != NOCPU) {
4715555afa1SConrad Meyer 				sbuf_printf(&ctx.qXfer.sb, " core=\"%d\"",
4725555afa1SConrad Meyer 				    ctx.iter->td_oncpu);
4735555afa1SConrad Meyer 			}
4745555afa1SConrad Meyer 			continue;
4755555afa1SConrad Meyer 
4765555afa1SConrad Meyer 		case XML_THREAD_NAME:
4775555afa1SConrad Meyer 			ctx.next_step = XML_THREAD_EXTRA;
4785555afa1SConrad Meyer 
4795555afa1SConrad Meyer 			if (ctx.iter->td_name[0] != 0)
4805555afa1SConrad Meyer 				name_src = ctx.iter->td_name;
4815555afa1SConrad Meyer 			else if (ctx.iter->td_proc != NULL &&
4825555afa1SConrad Meyer 			    ctx.iter->td_proc->p_comm[0] != 0)
4835555afa1SConrad Meyer 				name_src = ctx.iter->td_proc->p_comm;
4845555afa1SConrad Meyer 			else
4855555afa1SConrad Meyer 				continue;
4865555afa1SConrad Meyer 
4875555afa1SConrad Meyer 			qXfer_escape_xmlattr_str(td_name_escape,
4885555afa1SConrad Meyer 			    sizeof(td_name_escape), name_src);
4895555afa1SConrad Meyer 			sbuf_printf(&ctx.qXfer.sb, " name=\"%s\"",
4905555afa1SConrad Meyer 			    td_name_escape);
4915555afa1SConrad Meyer 			continue;
4925555afa1SConrad Meyer 
4935555afa1SConrad Meyer 		case XML_THREAD_EXTRA:
4945555afa1SConrad Meyer 			ctx.next_step = XML_END_THREAD;
4955555afa1SConrad Meyer 
4965555afa1SConrad Meyer 			sbuf_putc(&ctx.qXfer.sb, '>');
4975555afa1SConrad Meyer 
4985555afa1SConrad Meyer 			if (ctx.iter->td_state == TDS_RUNNING)
4995555afa1SConrad Meyer 				sbuf_cat(&ctx.qXfer.sb, "Running");
5005555afa1SConrad Meyer 			else if (ctx.iter->td_state == TDS_RUNQ)
5015555afa1SConrad Meyer 				sbuf_cat(&ctx.qXfer.sb, "RunQ");
5025555afa1SConrad Meyer 			else if (ctx.iter->td_state == TDS_CAN_RUN)
5035555afa1SConrad Meyer 				sbuf_cat(&ctx.qXfer.sb, "CanRun");
5045555afa1SConrad Meyer 			else if (TD_ON_LOCK(ctx.iter))
5055555afa1SConrad Meyer 				sbuf_cat(&ctx.qXfer.sb, "Blocked");
5065555afa1SConrad Meyer 			else if (TD_IS_SLEEPING(ctx.iter))
5075555afa1SConrad Meyer 				sbuf_cat(&ctx.qXfer.sb, "Sleeping");
5085555afa1SConrad Meyer 			else if (TD_IS_SWAPPED(ctx.iter))
5095555afa1SConrad Meyer 				sbuf_cat(&ctx.qXfer.sb, "Swapped");
5105555afa1SConrad Meyer 			else if (TD_AWAITING_INTR(ctx.iter))
5115555afa1SConrad Meyer 				sbuf_cat(&ctx.qXfer.sb, "IthreadWait");
5125555afa1SConrad Meyer 			else if (TD_IS_SUSPENDED(ctx.iter))
5135555afa1SConrad Meyer 				sbuf_cat(&ctx.qXfer.sb, "Suspended");
5145555afa1SConrad Meyer 			else
5155555afa1SConrad Meyer 				sbuf_cat(&ctx.qXfer.sb, "???");
5165555afa1SConrad Meyer 			continue;
5175555afa1SConrad Meyer 
5185555afa1SConrad Meyer 		case XML_END_THREAD:
5195555afa1SConrad Meyer 			ctx.next_step = XML_START_THREAD;
5205555afa1SConrad Meyer 			sbuf_cat(&ctx.qXfer.sb, "</thread>");
5215555afa1SConrad Meyer 			ctx.iter = kdb_thr_next(ctx.iter);
5225555afa1SConrad Meyer 			continue;
5235555afa1SConrad Meyer 
5245555afa1SConrad Meyer 		/*
5255555afa1SConrad Meyer 		 * This one isn't part of the looping state machine,
5265555afa1SConrad Meyer 		 * but GCC complains if you leave an enum value out of the
5275555afa1SConrad Meyer 		 * select.
5285555afa1SConrad Meyer 		 */
5295555afa1SConrad Meyer 		case XML_SENT_END_THREADS:
5305555afa1SConrad Meyer 			/* NOTREACHED */
5315555afa1SConrad Meyer 			break;
5325555afa1SConrad Meyer 		}
5335555afa1SConrad Meyer 	}
5345555afa1SConrad Meyer 	if (ctx.qXfer.flushed)
5355555afa1SConrad Meyer 		return;
5365555afa1SConrad Meyer 
5375555afa1SConrad Meyer 	if (ctx.next_step != XML_SENT_END_THREADS) {
5385555afa1SConrad Meyer 		ctx.next_step = XML_SENT_END_THREADS;
5395555afa1SConrad Meyer 		sbuf_cat(&ctx.qXfer.sb, "</threads>");
5405555afa1SConrad Meyer 	}
5415555afa1SConrad Meyer 	if (ctx.qXfer.flushed)
5425555afa1SConrad Meyer 		return;
5435555afa1SConrad Meyer 
5445555afa1SConrad Meyer 	ctx.qXfer.lastmessage = true;
5455555afa1SConrad Meyer 	sbuf_finish(&ctx.qXfer.sb);
5465555afa1SConrad Meyer 	sbuf_delete(&ctx.qXfer.sb);
5475555afa1SConrad Meyer 	ctx.qXfer.last_offset = 0;
5485555afa1SConrad Meyer 	return;
5495555afa1SConrad Meyer 
5505555afa1SConrad Meyer misformed_request:
5515555afa1SConrad Meyer 	/*
5525555afa1SConrad Meyer 	 * GDB "General-Query-Packets.html" qXfer-read anchor specifically
5535555afa1SConrad Meyer 	 * documents an E00 code for malformed requests or invalid annex.
5545555afa1SConrad Meyer 	 * Non-zero codes indicate invalid offset or "error reading the data."
5555555afa1SConrad Meyer 	 */
5565555afa1SConrad Meyer 	error = 0;
5575555afa1SConrad Meyer request_error:
5585555afa1SConrad Meyer 	gdb_tx_err(error);
5595555afa1SConrad Meyer 	return;
5605555afa1SConrad Meyer }
5615555afa1SConrad Meyer 
5625555afa1SConrad Meyer /*
5635555afa1SConrad Meyer  * A set of standardized transfers from "special data areas."
5645555afa1SConrad Meyer  *
5655555afa1SConrad Meyer  * We've already matched on "qXfer:" and advanced the rx packet buffer past
5665555afa1SConrad Meyer  * that bit.  Parse out the rest of the packet and generate an appropriate
5675555afa1SConrad Meyer  * response.
5685555afa1SConrad Meyer  */
5695555afa1SConrad Meyer static void
5705555afa1SConrad Meyer do_qXfer(void)
5715555afa1SConrad Meyer {
5725555afa1SConrad Meyer 	if (!gdb_rx_equal("threads:"))
5735555afa1SConrad Meyer 		goto unrecognized;
5745555afa1SConrad Meyer 
5755555afa1SConrad Meyer 	if (!gdb_rx_equal("read:"))
5765555afa1SConrad Meyer 		goto unrecognized;
5775555afa1SConrad Meyer 
5785555afa1SConrad Meyer 	do_qXfer_threads_read();
5795555afa1SConrad Meyer 	return;
5805555afa1SConrad Meyer 
5815555afa1SConrad Meyer unrecognized:
5825555afa1SConrad Meyer 	gdb_tx_empty();
5835555afa1SConrad Meyer 	return;
5845555afa1SConrad Meyer }
5855555afa1SConrad Meyer 
586dda17b36SConrad Meyer static void
587dda17b36SConrad Meyer gdb_handle_detach(void)
588dda17b36SConrad Meyer {
589dda17b36SConrad Meyer 	kdb_cpu_clear_singlestep();
590dda17b36SConrad Meyer 	gdb_listening = 0;
591dda17b36SConrad Meyer 
592dda17b36SConrad Meyer 	if (gdb_cur->gdb_dbfeatures & GDB_DBGP_FEAT_WANTTERM)
593dda17b36SConrad Meyer 		gdb_cur->gdb_term();
594dda17b36SConrad Meyer 
595dda17b36SConrad Meyer #ifdef DDB
596dda17b36SConrad Meyer 	if (!gdb_return_to_ddb)
597dda17b36SConrad Meyer 		return;
598dda17b36SConrad Meyer 
599dda17b36SConrad Meyer 	gdb_return_to_ddb = false;
600dda17b36SConrad Meyer 
601dda17b36SConrad Meyer 	if (kdb_dbbe_select("ddb") != 0)
602dda17b36SConrad Meyer 		printf("The ddb backend could not be selected.\n");
603dda17b36SConrad Meyer #endif
604dda17b36SConrad Meyer }
605dda17b36SConrad Meyer 
60672d44f31SMarcel Moolenaar static int
60772d44f31SMarcel Moolenaar gdb_trap(int type, int code)
60872d44f31SMarcel Moolenaar {
6093a5d3671SMatthew D Fleming 	jmp_buf jb;
61072d44f31SMarcel Moolenaar 	struct thread *thr_iter;
6113a5d3671SMatthew D Fleming 	void *prev_jb;
612c4fbbfaaSConrad Meyer 	uint32_t host_features;
6133a5d3671SMatthew D Fleming 
6143a5d3671SMatthew D Fleming 	prev_jb = kdb_jmpbuf(jb);
6153a5d3671SMatthew D Fleming 	if (setjmp(jb) != 0) {
6163a5d3671SMatthew D Fleming 		printf("%s bailing, hopefully back to ddb!\n", __func__);
6173a5d3671SMatthew D Fleming 		gdb_listening = 0;
6183a5d3671SMatthew D Fleming 		(void)kdb_jmpbuf(prev_jb);
6193a5d3671SMatthew D Fleming 		return (1);
6203a5d3671SMatthew D Fleming 	}
62172d44f31SMarcel Moolenaar 
6227d0c6c9fSSam Leffler 	gdb_listening = 0;
6236310546dSConrad Meyer 	gdb_ackmode = true;
6246310546dSConrad Meyer 
62572d44f31SMarcel Moolenaar 	/*
62672d44f31SMarcel Moolenaar 	 * Send a T packet. We currently do not support watchpoints (the
62772d44f31SMarcel Moolenaar 	 * awatch, rwatch or watch elements).
62872d44f31SMarcel Moolenaar 	 */
62972d44f31SMarcel Moolenaar 	gdb_tx_begin('T');
63072d44f31SMarcel Moolenaar 	gdb_tx_hex(gdb_cpu_signal(type, code), 2);
63172d44f31SMarcel Moolenaar 	gdb_tx_varhex(GDB_REG_PC);
63272d44f31SMarcel Moolenaar 	gdb_tx_char(':');
63372d44f31SMarcel Moolenaar 	gdb_tx_reg(GDB_REG_PC);
63472d44f31SMarcel Moolenaar 	gdb_tx_char(';');
63572d44f31SMarcel Moolenaar 	gdb_tx_str("thread:");
63672d44f31SMarcel Moolenaar 	gdb_tx_varhex((long)kdb_thread->td_tid);
63772d44f31SMarcel Moolenaar 	gdb_tx_char(';');
63872d44f31SMarcel Moolenaar 	gdb_tx_end();			/* XXX check error condition. */
63972d44f31SMarcel Moolenaar 
64072d44f31SMarcel Moolenaar 	thr_iter = NULL;
64172d44f31SMarcel Moolenaar 	while (gdb_rx_begin() == 0) {
64203e62bf3SMarcel Moolenaar 		/* printf("GDB: got '%s'\n", gdb_rxp); */
64372d44f31SMarcel Moolenaar 		switch (gdb_rx_char()) {
64472d44f31SMarcel Moolenaar 		case '?':	/* Last signal. */
64576c8c090SConrad Meyer 			gdb_tx_begin('T');
64672d44f31SMarcel Moolenaar 			gdb_tx_hex(gdb_cpu_signal(type, code), 2);
64776c8c090SConrad Meyer 			gdb_tx_str("thread:");
64876c8c090SConrad Meyer 			gdb_tx_varhex((long)kdb_thread->td_tid);
64976c8c090SConrad Meyer 			gdb_tx_char(';');
65072d44f31SMarcel Moolenaar 			gdb_tx_end();
65172d44f31SMarcel Moolenaar 			break;
65272d44f31SMarcel Moolenaar 		case 'c': {	/* Continue. */
65372d44f31SMarcel Moolenaar 			uintmax_t addr;
654bcc5241cSMarcel Moolenaar 			register_t pc;
655bcc5241cSMarcel Moolenaar 			if (!gdb_rx_varhex(&addr)) {
656bcc5241cSMarcel Moolenaar 				pc = addr;
657bcc5241cSMarcel Moolenaar 				gdb_cpu_setreg(GDB_REG_PC, &pc);
658bcc5241cSMarcel Moolenaar 			}
65972d44f31SMarcel Moolenaar 			kdb_cpu_clear_singlestep();
6607d0c6c9fSSam Leffler 			gdb_listening = 1;
66172d44f31SMarcel Moolenaar 			return (1);
66272d44f31SMarcel Moolenaar 		}
66372d44f31SMarcel Moolenaar 		case 'C': {	/* Continue with signal. */
66472d44f31SMarcel Moolenaar 			uintmax_t addr, sig;
665bcc5241cSMarcel Moolenaar 			register_t pc;
66672d44f31SMarcel Moolenaar 			if (!gdb_rx_varhex(&sig) && gdb_rx_char() == ';' &&
667bcc5241cSMarcel Moolenaar 			    !gdb_rx_varhex(&addr)) {
668bcc5241cSMarcel Moolenaar 				pc = addr;
669bcc5241cSMarcel Moolenaar 				gdb_cpu_setreg(GDB_REG_PC, &pc);
670bcc5241cSMarcel Moolenaar 			}
67172d44f31SMarcel Moolenaar 			kdb_cpu_clear_singlestep();
6727d0c6c9fSSam Leffler 			gdb_listening = 1;
67372d44f31SMarcel Moolenaar 			return (1);
67472d44f31SMarcel Moolenaar 		}
675d412b2deSPeter Grehan 		case 'D': {     /* Detach */
676d412b2deSPeter Grehan 			gdb_tx_ok();
677dda17b36SConrad Meyer 			gdb_handle_detach();
678d412b2deSPeter Grehan 			return (1);
679d412b2deSPeter Grehan 		}
68072d44f31SMarcel Moolenaar 		case 'g': {	/* Read registers. */
68172d44f31SMarcel Moolenaar 			size_t r;
68272d44f31SMarcel Moolenaar 			gdb_tx_begin(0);
68372d44f31SMarcel Moolenaar 			for (r = 0; r < GDB_NREGS; r++)
68472d44f31SMarcel Moolenaar 				gdb_tx_reg(r);
68572d44f31SMarcel Moolenaar 			gdb_tx_end();
68672d44f31SMarcel Moolenaar 			break;
68772d44f31SMarcel Moolenaar 		}
68872d44f31SMarcel Moolenaar 		case 'G':	/* Write registers. */
68972d44f31SMarcel Moolenaar 			gdb_tx_err(0);
69072d44f31SMarcel Moolenaar 			break;
69172d44f31SMarcel Moolenaar 		case 'H': {	/* Set thread. */
69272d44f31SMarcel Moolenaar 			intmax_t tid;
69372d44f31SMarcel Moolenaar 			struct thread *thr;
6945df6fa43SConrad Meyer 
6955df6fa43SConrad Meyer 			/* Ignore 'g' (general) or 'c' (continue) flag. */
6965df6fa43SConrad Meyer 			(void) gdb_rx_char();
6975df6fa43SConrad Meyer 
6984af77eceSSam Leffler 			if (gdb_rx_varhex(&tid)) {
6994af77eceSSam Leffler 				gdb_tx_err(EINVAL);
7004af77eceSSam Leffler 				break;
7014af77eceSSam Leffler 			}
70272d44f31SMarcel Moolenaar 			if (tid > 0) {
70372d44f31SMarcel Moolenaar 				thr = kdb_thr_lookup(tid);
70472d44f31SMarcel Moolenaar 				if (thr == NULL) {
70572d44f31SMarcel Moolenaar 					gdb_tx_err(ENOENT);
70672d44f31SMarcel Moolenaar 					break;
70772d44f31SMarcel Moolenaar 				}
70872d44f31SMarcel Moolenaar 				kdb_thr_select(thr);
70972d44f31SMarcel Moolenaar 			}
71072d44f31SMarcel Moolenaar 			gdb_tx_ok();
71172d44f31SMarcel Moolenaar 			break;
71272d44f31SMarcel Moolenaar 		}
71372d44f31SMarcel Moolenaar 		case 'k':	/* Kill request. */
714dda17b36SConrad Meyer 			gdb_handle_detach();
71572d44f31SMarcel Moolenaar 			return (1);
71672d44f31SMarcel Moolenaar 		case 'm': {	/* Read memory. */
71772d44f31SMarcel Moolenaar 			uintmax_t addr, size;
71872d44f31SMarcel Moolenaar 			if (gdb_rx_varhex(&addr) || gdb_rx_char() != ',' ||
71972d44f31SMarcel Moolenaar 			    gdb_rx_varhex(&size)) {
72072d44f31SMarcel Moolenaar 				gdb_tx_err(EINVAL);
72172d44f31SMarcel Moolenaar 				break;
72272d44f31SMarcel Moolenaar 			}
72372d44f31SMarcel Moolenaar 			gdb_tx_begin(0);
72472d44f31SMarcel Moolenaar 			if (gdb_tx_mem((char *)(uintptr_t)addr, size))
72572d44f31SMarcel Moolenaar 				gdb_tx_end();
72672d44f31SMarcel Moolenaar 			else
72772d44f31SMarcel Moolenaar 				gdb_tx_err(EIO);
72872d44f31SMarcel Moolenaar 			break;
72972d44f31SMarcel Moolenaar 		}
73072d44f31SMarcel Moolenaar 		case 'M': {	/* Write memory. */
73172d44f31SMarcel Moolenaar 			uintmax_t addr, size;
73272d44f31SMarcel Moolenaar 			if (gdb_rx_varhex(&addr) || gdb_rx_char() != ',' ||
73372d44f31SMarcel Moolenaar 			    gdb_rx_varhex(&size) || gdb_rx_char() != ':') {
73472d44f31SMarcel Moolenaar 				gdb_tx_err(EINVAL);
73572d44f31SMarcel Moolenaar 				break;
73672d44f31SMarcel Moolenaar 			}
73772d44f31SMarcel Moolenaar 			if (gdb_rx_mem((char *)(uintptr_t)addr, size) == 0)
73872d44f31SMarcel Moolenaar 				gdb_tx_err(EIO);
73972d44f31SMarcel Moolenaar 			else
74072d44f31SMarcel Moolenaar 				gdb_tx_ok();
74172d44f31SMarcel Moolenaar 			break;
74272d44f31SMarcel Moolenaar 		}
74372d44f31SMarcel Moolenaar 		case 'P': {	/* Write register. */
744bcc5241cSMarcel Moolenaar 			char *val;
745bcc5241cSMarcel Moolenaar 			uintmax_t reg;
746bcc5241cSMarcel Moolenaar 			val = gdb_rxp;
74772d44f31SMarcel Moolenaar 			if (gdb_rx_varhex(&reg) || gdb_rx_char() != '=' ||
748bcc5241cSMarcel Moolenaar 			    !gdb_rx_mem(val, gdb_cpu_regsz(reg))) {
74972d44f31SMarcel Moolenaar 				gdb_tx_err(EINVAL);
75072d44f31SMarcel Moolenaar 				break;
75172d44f31SMarcel Moolenaar 			}
75272d44f31SMarcel Moolenaar 			gdb_cpu_setreg(reg, val);
75372d44f31SMarcel Moolenaar 			gdb_tx_ok();
75472d44f31SMarcel Moolenaar 			break;
75572d44f31SMarcel Moolenaar 		}
75672d44f31SMarcel Moolenaar 		case 'q':	/* General query. */
7573bbe6e64SConrad Meyer 			if (gdb_rx_equal("C")) {
7583bbe6e64SConrad Meyer 				gdb_tx_begin('Q');
7593bbe6e64SConrad Meyer 				gdb_tx_char('C');
7603bbe6e64SConrad Meyer 				gdb_tx_varhex((long)kdb_thread->td_tid);
7613bbe6e64SConrad Meyer 				gdb_tx_end();
762c4fbbfaaSConrad Meyer 			} else if (gdb_rx_equal("Supported")) {
763c4fbbfaaSConrad Meyer 				gdb_do_qsupported(&host_features);
7643bbe6e64SConrad Meyer 			} else if (gdb_rx_equal("fThreadInfo")) {
76572d44f31SMarcel Moolenaar 				thr_iter = kdb_thr_first();
766130ef1adSConrad Meyer 				gdb_do_threadinfo(&thr_iter);
76772d44f31SMarcel Moolenaar 			} else if (gdb_rx_equal("sThreadInfo")) {
768130ef1adSConrad Meyer 				gdb_do_threadinfo(&thr_iter);
7695555afa1SConrad Meyer 			} else if (gdb_rx_equal("Xfer:")) {
7705555afa1SConrad Meyer 				do_qXfer();
77127ecc2adSBenno Rice 			} else if (gdb_rx_equal("Search:memory:")) {
7728a7a6571SRyan Libby 				gdb_do_mem_search();
773fa76c6f9SLeandro Lupori #ifdef __powerpc__
774fa76c6f9SLeandro Lupori 			} else if (gdb_rx_equal("Offsets")) {
775fa76c6f9SLeandro Lupori 				gdb_cpu_do_offsets();
776fa76c6f9SLeandro Lupori #endif
77772d44f31SMarcel Moolenaar 			} else if (!gdb_cpu_query())
77872d44f31SMarcel Moolenaar 				gdb_tx_empty();
77972d44f31SMarcel Moolenaar 			break;
7806310546dSConrad Meyer 		case 'Q':
7816310546dSConrad Meyer 			if (gdb_rx_equal("StartNoAckMode")) {
7826310546dSConrad Meyer 				if ((gdb_cur->gdb_dbfeatures &
7836310546dSConrad Meyer 				    GDB_DBGP_FEAT_RELIABLE) == 0) {
7846310546dSConrad Meyer 					/*
7856310546dSConrad Meyer 					 * Shouldn't happen if we didn't
7866310546dSConrad Meyer 					 * advertise support.  Reject.
7876310546dSConrad Meyer 					 */
7886310546dSConrad Meyer 					gdb_tx_empty();
7896310546dSConrad Meyer 					break;
7906310546dSConrad Meyer 				}
7916310546dSConrad Meyer 				gdb_ackmode = false;
7926310546dSConrad Meyer 				gdb_tx_ok();
7936310546dSConrad Meyer 			} else
7946310546dSConrad Meyer 				gdb_tx_empty();
7956310546dSConrad Meyer 			break;
79672d44f31SMarcel Moolenaar 		case 's': {	/* Step. */
79772d44f31SMarcel Moolenaar 			uintmax_t addr;
798bcc5241cSMarcel Moolenaar 			register_t pc;
799bcc5241cSMarcel Moolenaar 			if (!gdb_rx_varhex(&addr)) {
800bcc5241cSMarcel Moolenaar 				pc = addr;
801bcc5241cSMarcel Moolenaar 				gdb_cpu_setreg(GDB_REG_PC, &pc);
802bcc5241cSMarcel Moolenaar 			}
80372d44f31SMarcel Moolenaar 			kdb_cpu_set_singlestep();
8047d0c6c9fSSam Leffler 			gdb_listening = 1;
80572d44f31SMarcel Moolenaar 			return (1);
80672d44f31SMarcel Moolenaar 		}
80772d44f31SMarcel Moolenaar 		case 'S': {	/* Step with signal. */
80872d44f31SMarcel Moolenaar 			uintmax_t addr, sig;
809bcc5241cSMarcel Moolenaar 			register_t pc;
81072d44f31SMarcel Moolenaar 			if (!gdb_rx_varhex(&sig) && gdb_rx_char() == ';' &&
811bcc5241cSMarcel Moolenaar 			    !gdb_rx_varhex(&addr)) {
812bcc5241cSMarcel Moolenaar 				pc = addr;
813bcc5241cSMarcel Moolenaar 				gdb_cpu_setreg(GDB_REG_PC, &pc);
814bcc5241cSMarcel Moolenaar 			}
81572d44f31SMarcel Moolenaar 			kdb_cpu_set_singlestep();
8167d0c6c9fSSam Leffler 			gdb_listening = 1;
81772d44f31SMarcel Moolenaar 			return (1);
81872d44f31SMarcel Moolenaar 		}
81972d44f31SMarcel Moolenaar 		case 'T': {	/* Thread alive. */
82072d44f31SMarcel Moolenaar 			intmax_t tid;
8214af77eceSSam Leffler 			if (gdb_rx_varhex(&tid)) {
8224af77eceSSam Leffler 				gdb_tx_err(EINVAL);
8234af77eceSSam Leffler 				break;
8244af77eceSSam Leffler 			}
82572d44f31SMarcel Moolenaar 			if (kdb_thr_lookup(tid) != NULL)
82672d44f31SMarcel Moolenaar 				gdb_tx_ok();
82772d44f31SMarcel Moolenaar 			else
82872d44f31SMarcel Moolenaar 				gdb_tx_err(ENOENT);
82972d44f31SMarcel Moolenaar 			break;
83072d44f31SMarcel Moolenaar 		}
8315df6fa43SConrad Meyer 		case EOF:
83272d44f31SMarcel Moolenaar 			/* Empty command. Treat as unknown command. */
83372d44f31SMarcel Moolenaar 			/* FALLTHROUGH */
83472d44f31SMarcel Moolenaar 		default:
83572d44f31SMarcel Moolenaar 			/* Unknown command. Send empty response. */
83672d44f31SMarcel Moolenaar 			gdb_tx_empty();
83772d44f31SMarcel Moolenaar 			break;
83872d44f31SMarcel Moolenaar 		}
83972d44f31SMarcel Moolenaar 	}
8403a5d3671SMatthew D Fleming 	(void)kdb_jmpbuf(prev_jb);
84172d44f31SMarcel Moolenaar 	return (0);
84272d44f31SMarcel Moolenaar }
843