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(®) || 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