xref: /freebsd/sys/gdb/gdb_main.c (revision 0bd5d367989b3d2de0e8d8ceaa2e31d3f0d96536)
1 /*-
2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3  *
4  * Copyright (c) 2004 Marcel Moolenaar
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  *
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
18  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20  * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
21  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27  */
28 
29 #include <sys/cdefs.h>
30 __FBSDID("$FreeBSD$");
31 
32 #include <sys/param.h>
33 #include <sys/systm.h>
34 #include <sys/kdb.h>
35 #include <sys/kernel.h>
36 #include <sys/pcpu.h>
37 #include <sys/proc.h>
38 #include <sys/reboot.h>
39 #include <sys/sbuf.h>
40 
41 #include <machine/gdb_machdep.h>
42 #include <machine/kdb.h>
43 
44 #include <gdb/gdb.h>
45 #include <gdb/gdb_int.h>
46 
47 static dbbe_init_f gdb_init;
48 static dbbe_trap_f gdb_trap;
49 
50 KDB_BACKEND(gdb, gdb_init, NULL, NULL, gdb_trap);
51 
52 static struct gdb_dbgport null_gdb_dbgport;
53 DATA_SET(gdb_dbgport_set, null_gdb_dbgport);
54 SET_DECLARE(gdb_dbgport_set, struct gdb_dbgport);
55 
56 struct gdb_dbgport *gdb_cur = NULL;
57 int gdb_listening = 0;
58 
59 static unsigned char gdb_bindata[64];
60 
61 static int
62 gdb_init(void)
63 {
64 	struct gdb_dbgport *dp, **iter;
65 	int cur_pri, pri;
66 
67 	gdb_cur = NULL;
68 	cur_pri = -1;
69 	SET_FOREACH(iter, gdb_dbgport_set) {
70 		dp = *iter;
71 		pri = (dp->gdb_probe != NULL) ? dp->gdb_probe() : -1;
72 		dp->gdb_active = (pri >= 0) ? 0 : -1;
73 		if (pri > cur_pri) {
74 			cur_pri = pri;
75 			gdb_cur = dp;
76 		}
77 	}
78 	if (gdb_cur != NULL) {
79 		printf("GDB: debug ports:");
80 		SET_FOREACH(iter, gdb_dbgport_set) {
81 			dp = *iter;
82 			if (dp->gdb_active == 0)
83 				printf(" %s", dp->gdb_name);
84 		}
85 		printf("\n");
86 	} else
87 		printf("GDB: no debug ports present\n");
88 	if (gdb_cur != NULL) {
89 		gdb_cur->gdb_init();
90 		printf("GDB: current port: %s\n", gdb_cur->gdb_name);
91 	}
92 	if (gdb_cur != NULL) {
93 		cur_pri = (boothowto & RB_GDB) ? 2 : 0;
94 		gdb_consinit();
95 	} else
96 		cur_pri = -1;
97 	return (cur_pri);
98 }
99 
100 static void
101 gdb_do_mem_search(void)
102 {
103 	size_t patlen;
104 	intmax_t addr, size;
105 	const unsigned char *found;
106 
107 	if (gdb_rx_varhex(&addr) || gdb_rx_char() != ';' ||
108 	    gdb_rx_varhex(&size) || gdb_rx_char() != ';' ||
109 	    gdb_rx_bindata(gdb_bindata, sizeof(gdb_bindata), &patlen)) {
110 		gdb_tx_err(EINVAL);
111 		return;
112 	}
113 	if (gdb_search_mem((char *)(uintptr_t)addr, size, gdb_bindata,
114 	    patlen, &found)) {
115 		if (found == 0ULL)
116 			gdb_tx_begin('0');
117 		else {
118 			gdb_tx_begin('1');
119 			gdb_tx_char(',');
120 			gdb_tx_hex((intmax_t)(uintptr_t)found, 8);
121 		}
122 		gdb_tx_end();
123 	} else
124 		gdb_tx_err(EIO);
125 }
126 
127 static void
128 gdb_do_threadinfo(struct thread **thr_iter)
129 {
130 	static struct thread * const done_sentinel = (void *)(uintptr_t)1;
131 	static const size_t tidsz_hex = sizeof(lwpid_t) * 2;
132 	size_t tds_sent;
133 
134 	if (*thr_iter == NULL) {
135 		gdb_tx_err(ENXIO);
136 		return;
137 	}
138 
139 	if (*thr_iter == done_sentinel) {
140 		gdb_tx_begin('l');
141 		*thr_iter = NULL;
142 		goto sendit;
143 	}
144 
145 	gdb_tx_begin('m');
146 
147 	for (tds_sent = 0;
148 	    *thr_iter != NULL && gdb_txbuf_has_capacity(tidsz_hex + 1);
149 	    *thr_iter = kdb_thr_next(*thr_iter), tds_sent++) {
150 		if (tds_sent > 0)
151 			gdb_tx_char(',');
152 		gdb_tx_varhex((*thr_iter)->td_tid);
153 	}
154 
155 	/*
156 	 * Can't send EOF and "some" in same packet, so set a sentinel to send
157 	 * EOF when GDB asks us next.
158 	 */
159 	if (*thr_iter == NULL && tds_sent > 0)
160 		*thr_iter = done_sentinel;
161 
162 sendit:
163 	gdb_tx_end();
164 }
165 
166 #define	BIT(n)	(1ull << (n))
167 enum {
168 	GDB_MULTIPROCESS,
169 	GDB_SWBREAK,
170 	GDB_HWBREAK,
171 	GDB_QRELOCINSN,
172 	GDB_FORK_EVENTS,
173 	GDB_VFORK_EVENTS,
174 	GDB_EXEC_EVENTS,
175 	GDB_VCONT_SUPPORTED,
176 	GDB_QTHREADEVENTS,
177 	GDB_NO_RESUMED,
178 };
179 static const char * const gdb_feature_names[] = {
180 	[GDB_MULTIPROCESS] = "multiprocess",
181 	[GDB_SWBREAK] = "swbreak",
182 	[GDB_HWBREAK] = "hwbreak",
183 	[GDB_QRELOCINSN] = "qRelocInsn",
184 	[GDB_FORK_EVENTS] = "fork-events",
185 	[GDB_VFORK_EVENTS] = "vfork-events",
186 	[GDB_EXEC_EVENTS] = "exec-events",
187 	[GDB_VCONT_SUPPORTED] = "vContSupported",
188 	[GDB_QTHREADEVENTS] = "QThreadEvents",
189 	[GDB_NO_RESUMED] = "no-resumed",
190 };
191 static void
192 gdb_do_qsupported(uint32_t *feat)
193 {
194 	char *tok, *delim, ok;
195 	size_t i, toklen;
196 
197 	/* Parse supported host features */
198 	*feat = 0;
199 	if (gdb_rx_char() != ':')
200 		goto error;
201 
202 	while (gdb_rxsz > 0) {
203 		tok = gdb_rxp;
204 		delim = strchrnul(gdb_rxp, ';');
205 		toklen = (delim - tok);
206 
207 		gdb_rxp += toklen;
208 		gdb_rxsz -= toklen;
209 		if (*delim != '\0') {
210 			*delim = '\0';
211 			gdb_rxp += 1;
212 			gdb_rxsz -= 1;
213 		}
214 
215 		if (toklen < 2)
216 			goto error;
217 
218 		ok = tok[toklen - 1];
219 		if (ok != '-' && ok != '+') {
220 			/*
221 			 * GDB only has one KV-pair feature, and we don't
222 			 * support it, so ignore and move on.
223 			 */
224 			if (strchr(tok, '=') != NULL)
225 				continue;
226 			/* Not a KV-pair, and not a +/- flag?  Malformed. */
227 			goto error;
228 		}
229 		if (ok != '+')
230 			continue;
231 		tok[toklen - 1] = '\0';
232 
233 		for (i = 0; i < nitems(gdb_feature_names); i++)
234 			if (strcmp(gdb_feature_names[i], tok) == 0)
235 				break;
236 
237 		if (i == nitems(gdb_feature_names)) {
238 			/* Unknown GDB feature. */
239 			continue;
240 		}
241 
242 		*feat |= BIT(i);
243 	}
244 
245 	/* Send a supported feature list back */
246 	gdb_tx_begin(0);
247 
248 	gdb_tx_str("PacketSize");
249 	gdb_tx_char('=');
250 	/*
251 	 * We don't buffer framing bytes, but we do need to retain a byte for a
252 	 * trailing nul.
253 	 */
254 	gdb_tx_varhex(GDB_BUFSZ + strlen("$#nn") - 1);
255 
256 	gdb_tx_str(";qXfer:threads:read+");
257 
258 	/*
259 	 * Future consideration:
260 	 *   - vCont
261 	 *   - multiprocess
262 	 */
263 	gdb_tx_end();
264 	return;
265 
266 error:
267 	*feat = 0;
268 	gdb_tx_err(EINVAL);
269 }
270 
271 /*
272  * A qXfer_context provides a vaguely generic way to generate a multi-packet
273  * response on the fly, making some assumptions about the size of sbuf writes
274  * vs actual packet length constraints.  A non-byzantine gdb host should allow
275  * hundreds of bytes per packet or more.
276  *
277  * Upper layers are considered responsible for escaping the four forbidden
278  * characters '# $ } *'.
279  */
280 struct qXfer_context {
281 	struct sbuf sb;
282 	size_t last_offset;
283 	bool flushed;
284 	bool lastmessage;
285 	char xfer_buf[GDB_BUFSZ];
286 };
287 
288 static int
289 qXfer_drain(void *v, const char *buf, int len)
290 {
291 	struct qXfer_context *qx;
292 
293 	if (len < 0)
294 		return (-EINVAL);
295 
296 	qx = v;
297 	if (qx->flushed) {
298 		/*
299 		 * Overflow.  We lost some message.  Maybe the packet size is
300 		 * ridiculously small.
301 		 */
302 		printf("%s: Overflow in qXfer detected.\n", __func__);
303 		return (-ENOBUFS);
304 	}
305 
306 	qx->last_offset += len;
307 	qx->flushed = true;
308 
309 	if (qx->lastmessage)
310 		gdb_tx_begin('l');
311 	else
312 		gdb_tx_begin('m');
313 
314 	memcpy(gdb_txp, buf, len);
315 	gdb_txp += len;
316 
317 	gdb_tx_end();
318 	return (len);
319 }
320 
321 static int
322 init_qXfer_ctx(struct qXfer_context *qx, uintmax_t len)
323 {
324 
325 	/* Protocol (max) length field includes framing overhead. */
326 	if (len < sizeof("$m#nn"))
327 		return (ENOSPC);
328 
329 	len -= 4;
330 	len = ummin(len, GDB_BUFSZ - 1);
331 
332 	qx->last_offset = 0;
333 	qx->flushed = false;
334 	qx->lastmessage = false;
335 	sbuf_new(&qx->sb, qx->xfer_buf, len, SBUF_FIXEDLEN);
336 	sbuf_set_drain(&qx->sb, qXfer_drain, qx);
337 	return (0);
338 }
339 
340 /*
341  * dst must be 2x strlen(max_src) + 1.
342  *
343  * Squashes invalid XML characters down to _.  Sorry.  Then escapes for GDB.
344  */
345 static void
346 qXfer_escape_xmlattr_str(char *dst, size_t dstlen, const char *src)
347 {
348 	static const char *forbidden = "#$}*";
349 
350 	size_t i;
351 	char c;
352 
353 	for (i = 0; i < dstlen - 1 && *src != 0; src++, i++) {
354 		c = *src;
355 		/* XML attr filter */
356 		if (c < 32)
357 			c = '_';
358 		/* We assume attributes will be "" quoted. */
359 		if (c == '<' || c == '&' || c == '"')
360 			c = '_';
361 
362 		/* GDB escape. */
363 		if (strchr(forbidden, c) != NULL) {
364 			*dst++ = '}';
365 			c ^= 0x20;
366 		}
367 		*dst++ = c;
368 	}
369 	if (*src != 0)
370 		printf("XXX%s: overflow; API misuse\n", __func__);
371 
372 	*dst = 0;
373 }
374 
375 /*
376  * Dynamically generate qXfer:threads document, one packet at a time.
377  *
378  * The format is loosely described[0], although it does not seem that the
379  * <?xml?> mentioned on that page is required.
380  *
381  * [0]: https://sourceware.org/gdb/current/onlinedocs/gdb/Thread-List-Format.html
382  */
383 static void
384 do_qXfer_threads_read(void)
385 {
386 	/* Kludgy context */
387 	static struct {
388 		struct qXfer_context qXfer;
389 		/* Kludgy state machine */
390 		struct thread *iter;
391 		enum {
392 			XML_START_THREAD,	/* '<thread' */
393 			XML_THREAD_ID,		/* ' id="xxx"' */
394 			XML_THREAD_CORE,	/* ' core="yyy"' */
395 			XML_THREAD_NAME,	/* ' name="zzz"' */
396 			XML_THREAD_EXTRA,	/* '> ...' */
397 			XML_END_THREAD,		/* '</thread>' */
398 			XML_SENT_END_THREADS,	/* '</threads>' */
399 		} next_step;
400 	} ctx;
401 	static char td_name_escape[MAXCOMLEN * 2 + 1];
402 
403 	const char *name_src;
404 	uintmax_t offset, len;
405 	int error;
406 
407 	/* Annex part must be empty. */
408 	if (gdb_rx_char() != ':')
409 		goto misformed_request;
410 
411 	if (gdb_rx_varhex(&offset) != 0 ||
412 	    gdb_rx_char() != ',' ||
413 	    gdb_rx_varhex(&len) != 0)
414 		goto misformed_request;
415 
416 	/*
417 	 * Validate resume xfers.
418 	 */
419 	if (offset != 0) {
420 		if (offset != ctx.qXfer.last_offset) {
421 			printf("%s: Resumed offset %ju != expected %zu\n",
422 			    __func__, offset, ctx.qXfer.last_offset);
423 			error = ESPIPE;
424 			goto request_error;
425 		}
426 		ctx.qXfer.flushed = false;
427 	}
428 
429 	if (offset == 0) {
430 		ctx.iter = kdb_thr_first();
431 		ctx.next_step = XML_START_THREAD;
432 		error = init_qXfer_ctx(&ctx.qXfer, len);
433 		if (error != 0)
434 			goto request_error;
435 
436 		sbuf_cat(&ctx.qXfer.sb, "<threads>");
437 	}
438 
439 	while (!ctx.qXfer.flushed && ctx.iter != NULL) {
440 		switch (ctx.next_step) {
441 		case XML_START_THREAD:
442 			ctx.next_step = XML_THREAD_ID;
443 			sbuf_cat(&ctx.qXfer.sb, "<thread");
444 			continue;
445 
446 		case XML_THREAD_ID:
447 			ctx.next_step = XML_THREAD_CORE;
448 			sbuf_printf(&ctx.qXfer.sb, " id=\"%jx\"",
449 			    (uintmax_t)ctx.iter->td_tid);
450 			continue;
451 
452 		case XML_THREAD_CORE:
453 			ctx.next_step = XML_THREAD_NAME;
454 			if (ctx.iter->td_oncpu != NOCPU) {
455 				sbuf_printf(&ctx.qXfer.sb, " core=\"%d\"",
456 				    ctx.iter->td_oncpu);
457 			}
458 			continue;
459 
460 		case XML_THREAD_NAME:
461 			ctx.next_step = XML_THREAD_EXTRA;
462 
463 			if (ctx.iter->td_name[0] != 0)
464 				name_src = ctx.iter->td_name;
465 			else if (ctx.iter->td_proc != NULL &&
466 			    ctx.iter->td_proc->p_comm[0] != 0)
467 				name_src = ctx.iter->td_proc->p_comm;
468 			else
469 				continue;
470 
471 			qXfer_escape_xmlattr_str(td_name_escape,
472 			    sizeof(td_name_escape), name_src);
473 			sbuf_printf(&ctx.qXfer.sb, " name=\"%s\"",
474 			    td_name_escape);
475 			continue;
476 
477 		case XML_THREAD_EXTRA:
478 			ctx.next_step = XML_END_THREAD;
479 
480 			sbuf_putc(&ctx.qXfer.sb, '>');
481 
482 			if (ctx.iter->td_state == TDS_RUNNING)
483 				sbuf_cat(&ctx.qXfer.sb, "Running");
484 			else if (ctx.iter->td_state == TDS_RUNQ)
485 				sbuf_cat(&ctx.qXfer.sb, "RunQ");
486 			else if (ctx.iter->td_state == TDS_CAN_RUN)
487 				sbuf_cat(&ctx.qXfer.sb, "CanRun");
488 			else if (TD_ON_LOCK(ctx.iter))
489 				sbuf_cat(&ctx.qXfer.sb, "Blocked");
490 			else if (TD_IS_SLEEPING(ctx.iter))
491 				sbuf_cat(&ctx.qXfer.sb, "Sleeping");
492 			else if (TD_IS_SWAPPED(ctx.iter))
493 				sbuf_cat(&ctx.qXfer.sb, "Swapped");
494 			else if (TD_AWAITING_INTR(ctx.iter))
495 				sbuf_cat(&ctx.qXfer.sb, "IthreadWait");
496 			else if (TD_IS_SUSPENDED(ctx.iter))
497 				sbuf_cat(&ctx.qXfer.sb, "Suspended");
498 			else
499 				sbuf_cat(&ctx.qXfer.sb, "???");
500 			continue;
501 
502 		case XML_END_THREAD:
503 			ctx.next_step = XML_START_THREAD;
504 			sbuf_cat(&ctx.qXfer.sb, "</thread>");
505 			ctx.iter = kdb_thr_next(ctx.iter);
506 			continue;
507 
508 		/*
509 		 * This one isn't part of the looping state machine,
510 		 * but GCC complains if you leave an enum value out of the
511 		 * select.
512 		 */
513 		case XML_SENT_END_THREADS:
514 			/* NOTREACHED */
515 			break;
516 		}
517 	}
518 	if (ctx.qXfer.flushed)
519 		return;
520 
521 	if (ctx.next_step != XML_SENT_END_THREADS) {
522 		ctx.next_step = XML_SENT_END_THREADS;
523 		sbuf_cat(&ctx.qXfer.sb, "</threads>");
524 	}
525 	if (ctx.qXfer.flushed)
526 		return;
527 
528 	ctx.qXfer.lastmessage = true;
529 	sbuf_finish(&ctx.qXfer.sb);
530 	sbuf_delete(&ctx.qXfer.sb);
531 	ctx.qXfer.last_offset = 0;
532 	return;
533 
534 misformed_request:
535 	/*
536 	 * GDB "General-Query-Packets.html" qXfer-read anchor specifically
537 	 * documents an E00 code for malformed requests or invalid annex.
538 	 * Non-zero codes indicate invalid offset or "error reading the data."
539 	 */
540 	error = 0;
541 request_error:
542 	gdb_tx_err(error);
543 	return;
544 }
545 
546 /*
547  * A set of standardized transfers from "special data areas."
548  *
549  * We've already matched on "qXfer:" and advanced the rx packet buffer past
550  * that bit.  Parse out the rest of the packet and generate an appropriate
551  * response.
552  */
553 static void
554 do_qXfer(void)
555 {
556 	if (!gdb_rx_equal("threads:"))
557 		goto unrecognized;
558 
559 	if (!gdb_rx_equal("read:"))
560 		goto unrecognized;
561 
562 	do_qXfer_threads_read();
563 	return;
564 
565 unrecognized:
566 	gdb_tx_empty();
567 	return;
568 }
569 
570 static int
571 gdb_trap(int type, int code)
572 {
573 	jmp_buf jb;
574 	struct thread *thr_iter;
575 	void *prev_jb;
576 	uint32_t host_features;
577 
578 	prev_jb = kdb_jmpbuf(jb);
579 	if (setjmp(jb) != 0) {
580 		printf("%s bailing, hopefully back to ddb!\n", __func__);
581 		gdb_listening = 0;
582 		(void)kdb_jmpbuf(prev_jb);
583 		return (1);
584 	}
585 
586 	gdb_listening = 0;
587 	/*
588 	 * Send a T packet. We currently do not support watchpoints (the
589 	 * awatch, rwatch or watch elements).
590 	 */
591 	gdb_tx_begin('T');
592 	gdb_tx_hex(gdb_cpu_signal(type, code), 2);
593 	gdb_tx_varhex(GDB_REG_PC);
594 	gdb_tx_char(':');
595 	gdb_tx_reg(GDB_REG_PC);
596 	gdb_tx_char(';');
597 	gdb_tx_str("thread:");
598 	gdb_tx_varhex((long)kdb_thread->td_tid);
599 	gdb_tx_char(';');
600 	gdb_tx_end();			/* XXX check error condition. */
601 
602 	thr_iter = NULL;
603 	while (gdb_rx_begin() == 0) {
604 		/* printf("GDB: got '%s'\n", gdb_rxp); */
605 		switch (gdb_rx_char()) {
606 		case '?':	/* Last signal. */
607 			gdb_tx_begin('T');
608 			gdb_tx_hex(gdb_cpu_signal(type, code), 2);
609 			gdb_tx_str("thread:");
610 			gdb_tx_varhex((long)kdb_thread->td_tid);
611 			gdb_tx_char(';');
612 			gdb_tx_end();
613 			break;
614 		case 'c': {	/* Continue. */
615 			uintmax_t addr;
616 			register_t pc;
617 			if (!gdb_rx_varhex(&addr)) {
618 				pc = addr;
619 				gdb_cpu_setreg(GDB_REG_PC, &pc);
620 			}
621 			kdb_cpu_clear_singlestep();
622 			gdb_listening = 1;
623 			return (1);
624 		}
625 		case 'C': {	/* Continue with signal. */
626 			uintmax_t addr, sig;
627 			register_t pc;
628 			if (!gdb_rx_varhex(&sig) && gdb_rx_char() == ';' &&
629 			    !gdb_rx_varhex(&addr)) {
630 				pc = addr;
631 				gdb_cpu_setreg(GDB_REG_PC, &pc);
632 			}
633 			kdb_cpu_clear_singlestep();
634 			gdb_listening = 1;
635 			return (1);
636 		}
637 		case 'D': {     /* Detach */
638 			gdb_tx_ok();
639 			kdb_cpu_clear_singlestep();
640 			return (1);
641 		}
642 		case 'g': {	/* Read registers. */
643 			size_t r;
644 			gdb_tx_begin(0);
645 			for (r = 0; r < GDB_NREGS; r++)
646 				gdb_tx_reg(r);
647 			gdb_tx_end();
648 			break;
649 		}
650 		case 'G':	/* Write registers. */
651 			gdb_tx_err(0);
652 			break;
653 		case 'H': {	/* Set thread. */
654 			intmax_t tid;
655 			struct thread *thr;
656 
657 			/* Ignore 'g' (general) or 'c' (continue) flag. */
658 			(void) gdb_rx_char();
659 
660 			if (gdb_rx_varhex(&tid)) {
661 				gdb_tx_err(EINVAL);
662 				break;
663 			}
664 			if (tid > 0) {
665 				thr = kdb_thr_lookup(tid);
666 				if (thr == NULL) {
667 					gdb_tx_err(ENOENT);
668 					break;
669 				}
670 				kdb_thr_select(thr);
671 			}
672 			gdb_tx_ok();
673 			break;
674 		}
675 		case 'k':	/* Kill request. */
676 			kdb_cpu_clear_singlestep();
677 			gdb_listening = 1;
678 			return (1);
679 		case 'm': {	/* Read memory. */
680 			uintmax_t addr, size;
681 			if (gdb_rx_varhex(&addr) || gdb_rx_char() != ',' ||
682 			    gdb_rx_varhex(&size)) {
683 				gdb_tx_err(EINVAL);
684 				break;
685 			}
686 			gdb_tx_begin(0);
687 			if (gdb_tx_mem((char *)(uintptr_t)addr, size))
688 				gdb_tx_end();
689 			else
690 				gdb_tx_err(EIO);
691 			break;
692 		}
693 		case 'M': {	/* Write memory. */
694 			uintmax_t addr, size;
695 			if (gdb_rx_varhex(&addr) || gdb_rx_char() != ',' ||
696 			    gdb_rx_varhex(&size) || gdb_rx_char() != ':') {
697 				gdb_tx_err(EINVAL);
698 				break;
699 			}
700 			if (gdb_rx_mem((char *)(uintptr_t)addr, size) == 0)
701 				gdb_tx_err(EIO);
702 			else
703 				gdb_tx_ok();
704 			break;
705 		}
706 		case 'P': {	/* Write register. */
707 			char *val;
708 			uintmax_t reg;
709 			val = gdb_rxp;
710 			if (gdb_rx_varhex(&reg) || gdb_rx_char() != '=' ||
711 			    !gdb_rx_mem(val, gdb_cpu_regsz(reg))) {
712 				gdb_tx_err(EINVAL);
713 				break;
714 			}
715 			gdb_cpu_setreg(reg, val);
716 			gdb_tx_ok();
717 			break;
718 		}
719 		case 'q':	/* General query. */
720 			if (gdb_rx_equal("C")) {
721 				gdb_tx_begin('Q');
722 				gdb_tx_char('C');
723 				gdb_tx_varhex((long)kdb_thread->td_tid);
724 				gdb_tx_end();
725 			} else if (gdb_rx_equal("Supported")) {
726 				gdb_do_qsupported(&host_features);
727 			} else if (gdb_rx_equal("fThreadInfo")) {
728 				thr_iter = kdb_thr_first();
729 				gdb_do_threadinfo(&thr_iter);
730 			} else if (gdb_rx_equal("sThreadInfo")) {
731 				gdb_do_threadinfo(&thr_iter);
732 			} else if (gdb_rx_equal("Xfer:")) {
733 				do_qXfer();
734 			} else if (gdb_rx_equal("Search:memory:")) {
735 				gdb_do_mem_search();
736 			} else if (!gdb_cpu_query())
737 				gdb_tx_empty();
738 			break;
739 		case 's': {	/* Step. */
740 			uintmax_t addr;
741 			register_t pc;
742 			if (!gdb_rx_varhex(&addr)) {
743 				pc = addr;
744 				gdb_cpu_setreg(GDB_REG_PC, &pc);
745 			}
746 			kdb_cpu_set_singlestep();
747 			gdb_listening = 1;
748 			return (1);
749 		}
750 		case 'S': {	/* Step with signal. */
751 			uintmax_t addr, sig;
752 			register_t pc;
753 			if (!gdb_rx_varhex(&sig) && gdb_rx_char() == ';' &&
754 			    !gdb_rx_varhex(&addr)) {
755 				pc = addr;
756 				gdb_cpu_setreg(GDB_REG_PC, &pc);
757 			}
758 			kdb_cpu_set_singlestep();
759 			gdb_listening = 1;
760 			return (1);
761 		}
762 		case 'T': {	/* Thread alive. */
763 			intmax_t tid;
764 			if (gdb_rx_varhex(&tid)) {
765 				gdb_tx_err(EINVAL);
766 				break;
767 			}
768 			if (kdb_thr_lookup(tid) != NULL)
769 				gdb_tx_ok();
770 			else
771 				gdb_tx_err(ENOENT);
772 			break;
773 		}
774 		case EOF:
775 			/* Empty command. Treat as unknown command. */
776 			/* FALLTHROUGH */
777 		default:
778 			/* Unknown command. Send empty response. */
779 			gdb_tx_empty();
780 			break;
781 		}
782 	}
783 	(void)kdb_jmpbuf(prev_jb);
784 	return (0);
785 }
786