172d44f31SMarcel Moolenaar /* 272d44f31SMarcel Moolenaar * Copyright (c) 2004 Marcel Moolenaar 372d44f31SMarcel Moolenaar * All rights reserved. 472d44f31SMarcel Moolenaar * 572d44f31SMarcel Moolenaar * Redistribution and use in source and binary forms, with or without 672d44f31SMarcel Moolenaar * modification, are permitted provided that the following conditions 772d44f31SMarcel Moolenaar * are met: 872d44f31SMarcel Moolenaar * 972d44f31SMarcel Moolenaar * 1. Redistributions of source code must retain the above copyright 1072d44f31SMarcel Moolenaar * notice, this list of conditions and the following disclaimer. 1172d44f31SMarcel Moolenaar * 2. Redistributions in binary form must reproduce the above copyright 1272d44f31SMarcel Moolenaar * notice, this list of conditions and the following disclaimer in the 1372d44f31SMarcel Moolenaar * documentation and/or other materials provided with the distribution. 1472d44f31SMarcel Moolenaar * 1572d44f31SMarcel Moolenaar * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR 1672d44f31SMarcel Moolenaar * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 1772d44f31SMarcel Moolenaar * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 1872d44f31SMarcel Moolenaar * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT, 1972d44f31SMarcel Moolenaar * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 2072d44f31SMarcel Moolenaar * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 2172d44f31SMarcel Moolenaar * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 2272d44f31SMarcel Moolenaar * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 2372d44f31SMarcel Moolenaar * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 2472d44f31SMarcel Moolenaar * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 2572d44f31SMarcel Moolenaar */ 2672d44f31SMarcel Moolenaar 2772d44f31SMarcel Moolenaar #include <sys/cdefs.h> 2872d44f31SMarcel Moolenaar __FBSDID("$FreeBSD$"); 2972d44f31SMarcel Moolenaar 3072d44f31SMarcel Moolenaar #include <sys/param.h> 3172d44f31SMarcel Moolenaar #include <sys/systm.h> 3272d44f31SMarcel Moolenaar #include <sys/kdb.h> 3372d44f31SMarcel Moolenaar #include <sys/kernel.h> 3472d44f31SMarcel Moolenaar #include <sys/pcpu.h> 3572d44f31SMarcel Moolenaar #include <sys/proc.h> 3672d44f31SMarcel Moolenaar #include <sys/reboot.h> 3772d44f31SMarcel Moolenaar 3872d44f31SMarcel Moolenaar #include <machine/gdb_machdep.h> 3972d44f31SMarcel Moolenaar #include <machine/kdb.h> 4072d44f31SMarcel Moolenaar 4172d44f31SMarcel Moolenaar #include <gdb/gdb.h> 4272d44f31SMarcel Moolenaar #include <gdb/gdb_int.h> 4372d44f31SMarcel Moolenaar 4472d44f31SMarcel Moolenaar static dbbe_init_f gdb_init; 4572d44f31SMarcel Moolenaar static dbbe_trap_f gdb_trap; 4672d44f31SMarcel Moolenaar 4772d44f31SMarcel Moolenaar KDB_BACKEND(gdb, gdb_init, NULL, gdb_trap); 4872d44f31SMarcel Moolenaar 4972d44f31SMarcel Moolenaar GDB_DBGPORT(null, NULL, NULL, NULL, NULL, NULL, NULL); 5072d44f31SMarcel Moolenaar SET_DECLARE(gdb_dbgport_set, struct gdb_dbgport); 5172d44f31SMarcel Moolenaar 5272d44f31SMarcel Moolenaar struct gdb_dbgport *gdb_cur = NULL; 5372d44f31SMarcel Moolenaar 5472d44f31SMarcel Moolenaar static int 5572d44f31SMarcel Moolenaar gdb_init(void) 5672d44f31SMarcel Moolenaar { 5772d44f31SMarcel Moolenaar struct gdb_dbgport *dp, **iter; 5872d44f31SMarcel Moolenaar int cur_pri, pri; 5972d44f31SMarcel Moolenaar 6072d44f31SMarcel Moolenaar gdb_cur = NULL; 6172d44f31SMarcel Moolenaar cur_pri = -1; 6272d44f31SMarcel Moolenaar SET_FOREACH(iter, gdb_dbgport_set) { 6372d44f31SMarcel Moolenaar dp = *iter; 6472d44f31SMarcel Moolenaar pri = (dp->gdb_probe != NULL) ? dp->gdb_probe() : -1; 6572d44f31SMarcel Moolenaar dp->gdb_active = (pri >= 0) ? 0 : -1; 6672d44f31SMarcel Moolenaar if (pri > cur_pri) { 6772d44f31SMarcel Moolenaar cur_pri = pri; 6872d44f31SMarcel Moolenaar gdb_cur = dp; 6972d44f31SMarcel Moolenaar } 7072d44f31SMarcel Moolenaar } 7172d44f31SMarcel Moolenaar if (gdb_cur != NULL) { 7272d44f31SMarcel Moolenaar printf("GDB: debug ports:"); 7372d44f31SMarcel Moolenaar SET_FOREACH(iter, gdb_dbgport_set) { 7472d44f31SMarcel Moolenaar dp = *iter; 7572d44f31SMarcel Moolenaar if (dp->gdb_active == 0) 7672d44f31SMarcel Moolenaar printf(" %s", dp->gdb_name); 7772d44f31SMarcel Moolenaar } 7872d44f31SMarcel Moolenaar printf("\n"); 7972d44f31SMarcel Moolenaar } else 8072d44f31SMarcel Moolenaar printf("GDB: no debug ports present\n"); 8172d44f31SMarcel Moolenaar if (gdb_cur != NULL) { 8272d44f31SMarcel Moolenaar gdb_cur->gdb_init(); 8372d44f31SMarcel Moolenaar printf("GDB: current port: %s\n", gdb_cur->gdb_name); 8472d44f31SMarcel Moolenaar } 8572d44f31SMarcel Moolenaar if (gdb_cur != NULL) 8672d44f31SMarcel Moolenaar cur_pri = (boothowto & RB_GDB) ? 2 : 0; 8772d44f31SMarcel Moolenaar else 8872d44f31SMarcel Moolenaar cur_pri = -1; 8972d44f31SMarcel Moolenaar return (cur_pri); 9072d44f31SMarcel Moolenaar } 9172d44f31SMarcel Moolenaar 9272d44f31SMarcel Moolenaar static int 9372d44f31SMarcel Moolenaar gdb_trap(int type, int code) 9472d44f31SMarcel Moolenaar { 9572d44f31SMarcel Moolenaar struct thread *thr_iter; 9672d44f31SMarcel Moolenaar 9772d44f31SMarcel Moolenaar /* 9872d44f31SMarcel Moolenaar * Send a T packet. We currently do not support watchpoints (the 9972d44f31SMarcel Moolenaar * awatch, rwatch or watch elements). 10072d44f31SMarcel Moolenaar */ 10172d44f31SMarcel Moolenaar gdb_tx_begin('T'); 10272d44f31SMarcel Moolenaar gdb_tx_hex(gdb_cpu_signal(type, code), 2); 10372d44f31SMarcel Moolenaar gdb_tx_varhex(GDB_REG_PC); 10472d44f31SMarcel Moolenaar gdb_tx_char(':'); 10572d44f31SMarcel Moolenaar gdb_tx_reg(GDB_REG_PC); 10672d44f31SMarcel Moolenaar gdb_tx_char(';'); 10772d44f31SMarcel Moolenaar gdb_tx_str("thread:"); 10872d44f31SMarcel Moolenaar gdb_tx_varhex((long)kdb_thread->td_tid); 10972d44f31SMarcel Moolenaar gdb_tx_char(';'); 11072d44f31SMarcel Moolenaar gdb_tx_end(); /* XXX check error condition. */ 11172d44f31SMarcel Moolenaar 11272d44f31SMarcel Moolenaar thr_iter = NULL; 11372d44f31SMarcel Moolenaar while (gdb_rx_begin() == 0) { 11403e62bf3SMarcel Moolenaar /* printf("GDB: got '%s'\n", gdb_rxp); */ 11572d44f31SMarcel Moolenaar switch (gdb_rx_char()) { 11672d44f31SMarcel Moolenaar case '?': /* Last signal. */ 11772d44f31SMarcel Moolenaar gdb_tx_begin('S'); 11872d44f31SMarcel Moolenaar gdb_tx_hex(gdb_cpu_signal(type, code), 2); 11972d44f31SMarcel Moolenaar gdb_tx_end(); 12072d44f31SMarcel Moolenaar break; 12172d44f31SMarcel Moolenaar case 'c': { /* Continue. */ 12272d44f31SMarcel Moolenaar uintmax_t addr; 123bcc5241cSMarcel Moolenaar register_t pc; 124bcc5241cSMarcel Moolenaar if (!gdb_rx_varhex(&addr)) { 125bcc5241cSMarcel Moolenaar pc = addr; 126bcc5241cSMarcel Moolenaar gdb_cpu_setreg(GDB_REG_PC, &pc); 127bcc5241cSMarcel Moolenaar } 12872d44f31SMarcel Moolenaar kdb_cpu_clear_singlestep(); 12972d44f31SMarcel Moolenaar return (1); 13072d44f31SMarcel Moolenaar } 13172d44f31SMarcel Moolenaar case 'C': { /* Continue with signal. */ 13272d44f31SMarcel Moolenaar uintmax_t addr, sig; 133bcc5241cSMarcel Moolenaar register_t pc; 13472d44f31SMarcel Moolenaar if (!gdb_rx_varhex(&sig) && gdb_rx_char() == ';' && 135bcc5241cSMarcel Moolenaar !gdb_rx_varhex(&addr)) { 136bcc5241cSMarcel Moolenaar pc = addr; 137bcc5241cSMarcel Moolenaar gdb_cpu_setreg(GDB_REG_PC, &pc); 138bcc5241cSMarcel Moolenaar } 13972d44f31SMarcel Moolenaar kdb_cpu_clear_singlestep(); 14072d44f31SMarcel Moolenaar return (1); 14172d44f31SMarcel Moolenaar } 14272d44f31SMarcel Moolenaar case 'g': { /* Read registers. */ 14372d44f31SMarcel Moolenaar size_t r; 14472d44f31SMarcel Moolenaar gdb_tx_begin(0); 14572d44f31SMarcel Moolenaar for (r = 0; r < GDB_NREGS; r++) 14672d44f31SMarcel Moolenaar gdb_tx_reg(r); 14772d44f31SMarcel Moolenaar gdb_tx_end(); 14872d44f31SMarcel Moolenaar break; 14972d44f31SMarcel Moolenaar } 15072d44f31SMarcel Moolenaar case 'G': /* Write registers. */ 15172d44f31SMarcel Moolenaar gdb_tx_err(0); 15272d44f31SMarcel Moolenaar break; 15372d44f31SMarcel Moolenaar case 'H': { /* Set thread. */ 15472d44f31SMarcel Moolenaar intmax_t tid; 15572d44f31SMarcel Moolenaar struct thread *thr; 15672d44f31SMarcel Moolenaar gdb_rx_char(); 15772d44f31SMarcel Moolenaar gdb_rx_varhex(&tid); 15872d44f31SMarcel Moolenaar if (tid > 0) { 15972d44f31SMarcel Moolenaar thr = kdb_thr_lookup(tid); 16072d44f31SMarcel Moolenaar if (thr == NULL) { 16172d44f31SMarcel Moolenaar gdb_tx_err(ENOENT); 16272d44f31SMarcel Moolenaar break; 16372d44f31SMarcel Moolenaar } 16472d44f31SMarcel Moolenaar kdb_thr_select(thr); 16572d44f31SMarcel Moolenaar } 16672d44f31SMarcel Moolenaar gdb_tx_ok(); 16772d44f31SMarcel Moolenaar break; 16872d44f31SMarcel Moolenaar } 16972d44f31SMarcel Moolenaar case 'k': /* Kill request. */ 17072d44f31SMarcel Moolenaar kdb_cpu_clear_singlestep(); 17172d44f31SMarcel Moolenaar return (1); 17272d44f31SMarcel Moolenaar case 'm': { /* Read memory. */ 17372d44f31SMarcel Moolenaar uintmax_t addr, size; 17472d44f31SMarcel Moolenaar if (gdb_rx_varhex(&addr) || gdb_rx_char() != ',' || 17572d44f31SMarcel Moolenaar gdb_rx_varhex(&size)) { 17672d44f31SMarcel Moolenaar gdb_tx_err(EINVAL); 17772d44f31SMarcel Moolenaar break; 17872d44f31SMarcel Moolenaar } 17972d44f31SMarcel Moolenaar gdb_tx_begin(0); 18072d44f31SMarcel Moolenaar if (gdb_tx_mem((char *)(uintptr_t)addr, size)) 18172d44f31SMarcel Moolenaar gdb_tx_end(); 18272d44f31SMarcel Moolenaar else 18372d44f31SMarcel Moolenaar gdb_tx_err(EIO); 18472d44f31SMarcel Moolenaar break; 18572d44f31SMarcel Moolenaar } 18672d44f31SMarcel Moolenaar case 'M': { /* Write memory. */ 18772d44f31SMarcel Moolenaar uintmax_t addr, size; 18872d44f31SMarcel Moolenaar if (gdb_rx_varhex(&addr) || gdb_rx_char() != ',' || 18972d44f31SMarcel Moolenaar gdb_rx_varhex(&size) || gdb_rx_char() != ':') { 19072d44f31SMarcel Moolenaar gdb_tx_err(EINVAL); 19172d44f31SMarcel Moolenaar break; 19272d44f31SMarcel Moolenaar } 19372d44f31SMarcel Moolenaar if (gdb_rx_mem((char *)(uintptr_t)addr, size) == 0) 19472d44f31SMarcel Moolenaar gdb_tx_err(EIO); 19572d44f31SMarcel Moolenaar else 19672d44f31SMarcel Moolenaar gdb_tx_ok(); 19772d44f31SMarcel Moolenaar break; 19872d44f31SMarcel Moolenaar } 19972d44f31SMarcel Moolenaar case 'P': { /* Write register. */ 200bcc5241cSMarcel Moolenaar char *val; 201bcc5241cSMarcel Moolenaar uintmax_t reg; 202bcc5241cSMarcel Moolenaar val = gdb_rxp; 20372d44f31SMarcel Moolenaar if (gdb_rx_varhex(®) || gdb_rx_char() != '=' || 204bcc5241cSMarcel Moolenaar !gdb_rx_mem(val, gdb_cpu_regsz(reg))) { 20572d44f31SMarcel Moolenaar gdb_tx_err(EINVAL); 20672d44f31SMarcel Moolenaar break; 20772d44f31SMarcel Moolenaar } 20872d44f31SMarcel Moolenaar gdb_cpu_setreg(reg, val); 20972d44f31SMarcel Moolenaar gdb_tx_ok(); 21072d44f31SMarcel Moolenaar break; 21172d44f31SMarcel Moolenaar } 21272d44f31SMarcel Moolenaar case 'q': /* General query. */ 21372d44f31SMarcel Moolenaar if (gdb_rx_equal("fThreadInfo")) { 21472d44f31SMarcel Moolenaar thr_iter = kdb_thr_first(); 21572d44f31SMarcel Moolenaar gdb_tx_begin('m'); 21672d44f31SMarcel Moolenaar gdb_tx_hex((long)thr_iter->td_tid, 8); 21772d44f31SMarcel Moolenaar gdb_tx_end(); 21872d44f31SMarcel Moolenaar } else if (gdb_rx_equal("sThreadInfo")) { 21972d44f31SMarcel Moolenaar if (thr_iter == NULL) { 22072d44f31SMarcel Moolenaar gdb_tx_err(ENXIO); 22172d44f31SMarcel Moolenaar break; 22272d44f31SMarcel Moolenaar } 22372d44f31SMarcel Moolenaar thr_iter = kdb_thr_next(thr_iter); 22472d44f31SMarcel Moolenaar if (thr_iter != NULL) { 22572d44f31SMarcel Moolenaar gdb_tx_begin('m'); 22672d44f31SMarcel Moolenaar gdb_tx_hex((long)thr_iter->td_tid, 8); 22772d44f31SMarcel Moolenaar gdb_tx_end(); 22872d44f31SMarcel Moolenaar } else { 22972d44f31SMarcel Moolenaar gdb_tx_begin('l'); 23072d44f31SMarcel Moolenaar gdb_tx_end(); 23172d44f31SMarcel Moolenaar } 23272d44f31SMarcel Moolenaar } else if (!gdb_cpu_query()) 23372d44f31SMarcel Moolenaar gdb_tx_empty(); 23472d44f31SMarcel Moolenaar break; 23572d44f31SMarcel Moolenaar case 's': { /* Step. */ 23672d44f31SMarcel Moolenaar uintmax_t addr; 237bcc5241cSMarcel Moolenaar register_t pc; 238bcc5241cSMarcel Moolenaar if (!gdb_rx_varhex(&addr)) { 239bcc5241cSMarcel Moolenaar pc = addr; 240bcc5241cSMarcel Moolenaar gdb_cpu_setreg(GDB_REG_PC, &pc); 241bcc5241cSMarcel Moolenaar } 24272d44f31SMarcel Moolenaar kdb_cpu_set_singlestep(); 24372d44f31SMarcel Moolenaar return (1); 24472d44f31SMarcel Moolenaar } 24572d44f31SMarcel Moolenaar case 'S': { /* Step with signal. */ 24672d44f31SMarcel Moolenaar uintmax_t addr, sig; 247bcc5241cSMarcel Moolenaar register_t pc; 24872d44f31SMarcel Moolenaar if (!gdb_rx_varhex(&sig) && gdb_rx_char() == ';' && 249bcc5241cSMarcel Moolenaar !gdb_rx_varhex(&addr)) { 250bcc5241cSMarcel Moolenaar pc = addr; 251bcc5241cSMarcel Moolenaar gdb_cpu_setreg(GDB_REG_PC, &pc); 252bcc5241cSMarcel Moolenaar } 25372d44f31SMarcel Moolenaar kdb_cpu_set_singlestep(); 25472d44f31SMarcel Moolenaar return (1); 25572d44f31SMarcel Moolenaar } 25672d44f31SMarcel Moolenaar case 'T': { /* Thread alive. */ 25772d44f31SMarcel Moolenaar intmax_t tid; 25872d44f31SMarcel Moolenaar gdb_rx_varhex(&tid); 25972d44f31SMarcel Moolenaar if (kdb_thr_lookup(tid) != NULL) 26072d44f31SMarcel Moolenaar gdb_tx_ok(); 26172d44f31SMarcel Moolenaar else 26272d44f31SMarcel Moolenaar gdb_tx_err(ENOENT); 26372d44f31SMarcel Moolenaar break; 26472d44f31SMarcel Moolenaar } 26572d44f31SMarcel Moolenaar case -1: 26672d44f31SMarcel Moolenaar /* Empty command. Treat as unknown command. */ 26772d44f31SMarcel Moolenaar /* FALLTHROUGH */ 26872d44f31SMarcel Moolenaar default: 26972d44f31SMarcel Moolenaar /* Unknown command. Send empty response. */ 27072d44f31SMarcel Moolenaar gdb_tx_empty(); 27172d44f31SMarcel Moolenaar break; 27272d44f31SMarcel Moolenaar } 27372d44f31SMarcel Moolenaar } 27472d44f31SMarcel Moolenaar return (0); 27572d44f31SMarcel Moolenaar } 276