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; 12372d44f31SMarcel Moolenaar if (!gdb_rx_varhex(&addr)) 12472d44f31SMarcel Moolenaar gdb_cpu_setreg(GDB_REG_PC, addr); 12572d44f31SMarcel Moolenaar kdb_cpu_clear_singlestep(); 12672d44f31SMarcel Moolenaar return (1); 12772d44f31SMarcel Moolenaar } 12872d44f31SMarcel Moolenaar case 'C': { /* Continue with signal. */ 12972d44f31SMarcel Moolenaar uintmax_t addr, sig; 13072d44f31SMarcel Moolenaar if (!gdb_rx_varhex(&sig) && gdb_rx_char() == ';' && 13172d44f31SMarcel Moolenaar !gdb_rx_varhex(&addr)) 13272d44f31SMarcel Moolenaar gdb_cpu_setreg(GDB_REG_PC, addr); 13372d44f31SMarcel Moolenaar kdb_cpu_clear_singlestep(); 13472d44f31SMarcel Moolenaar return (1); 13572d44f31SMarcel Moolenaar } 13672d44f31SMarcel Moolenaar case 'g': { /* Read registers. */ 13772d44f31SMarcel Moolenaar size_t r; 13872d44f31SMarcel Moolenaar gdb_tx_begin(0); 13972d44f31SMarcel Moolenaar for (r = 0; r < GDB_NREGS; r++) 14072d44f31SMarcel Moolenaar gdb_tx_reg(r); 14172d44f31SMarcel Moolenaar gdb_tx_end(); 14272d44f31SMarcel Moolenaar break; 14372d44f31SMarcel Moolenaar } 14472d44f31SMarcel Moolenaar case 'G': /* Write registers. */ 14572d44f31SMarcel Moolenaar gdb_tx_err(0); 14672d44f31SMarcel Moolenaar break; 14772d44f31SMarcel Moolenaar case 'H': { /* Set thread. */ 14872d44f31SMarcel Moolenaar intmax_t tid; 14972d44f31SMarcel Moolenaar struct thread *thr; 15072d44f31SMarcel Moolenaar gdb_rx_char(); 15172d44f31SMarcel Moolenaar gdb_rx_varhex(&tid); 15272d44f31SMarcel Moolenaar if (tid > 0) { 15372d44f31SMarcel Moolenaar thr = kdb_thr_lookup(tid); 15472d44f31SMarcel Moolenaar if (thr == NULL) { 15572d44f31SMarcel Moolenaar gdb_tx_err(ENOENT); 15672d44f31SMarcel Moolenaar break; 15772d44f31SMarcel Moolenaar } 15872d44f31SMarcel Moolenaar kdb_thr_select(thr); 15972d44f31SMarcel Moolenaar } 16072d44f31SMarcel Moolenaar gdb_tx_ok(); 16172d44f31SMarcel Moolenaar break; 16272d44f31SMarcel Moolenaar } 16372d44f31SMarcel Moolenaar case 'k': /* Kill request. */ 16472d44f31SMarcel Moolenaar kdb_cpu_clear_singlestep(); 16572d44f31SMarcel Moolenaar return (1); 16672d44f31SMarcel Moolenaar case 'm': { /* Read memory. */ 16772d44f31SMarcel Moolenaar uintmax_t addr, size; 16872d44f31SMarcel Moolenaar if (gdb_rx_varhex(&addr) || gdb_rx_char() != ',' || 16972d44f31SMarcel Moolenaar gdb_rx_varhex(&size)) { 17072d44f31SMarcel Moolenaar gdb_tx_err(EINVAL); 17172d44f31SMarcel Moolenaar break; 17272d44f31SMarcel Moolenaar } 17372d44f31SMarcel Moolenaar gdb_tx_begin(0); 17472d44f31SMarcel Moolenaar if (gdb_tx_mem((char *)(uintptr_t)addr, size)) 17572d44f31SMarcel Moolenaar gdb_tx_end(); 17672d44f31SMarcel Moolenaar else 17772d44f31SMarcel Moolenaar gdb_tx_err(EIO); 17872d44f31SMarcel Moolenaar break; 17972d44f31SMarcel Moolenaar } 18072d44f31SMarcel Moolenaar case 'M': { /* Write memory. */ 18172d44f31SMarcel Moolenaar uintmax_t addr, size; 18272d44f31SMarcel Moolenaar if (gdb_rx_varhex(&addr) || gdb_rx_char() != ',' || 18372d44f31SMarcel Moolenaar gdb_rx_varhex(&size) || gdb_rx_char() != ':') { 18472d44f31SMarcel Moolenaar gdb_tx_err(EINVAL); 18572d44f31SMarcel Moolenaar break; 18672d44f31SMarcel Moolenaar } 18772d44f31SMarcel Moolenaar if (gdb_rx_mem((char *)(uintptr_t)addr, size) == 0) 18872d44f31SMarcel Moolenaar gdb_tx_err(EIO); 18972d44f31SMarcel Moolenaar else 19072d44f31SMarcel Moolenaar gdb_tx_ok(); 19172d44f31SMarcel Moolenaar break; 19272d44f31SMarcel Moolenaar } 19372d44f31SMarcel Moolenaar case 'P': { /* Write register. */ 19472d44f31SMarcel Moolenaar uintmax_t reg, val; 19572d44f31SMarcel Moolenaar if (gdb_rx_varhex(®) || gdb_rx_char() != '=' || 19672d44f31SMarcel Moolenaar gdb_rx_varhex(&val)) { 19772d44f31SMarcel Moolenaar gdb_tx_err(EINVAL); 19872d44f31SMarcel Moolenaar break; 19972d44f31SMarcel Moolenaar } 20072d44f31SMarcel Moolenaar gdb_cpu_setreg(reg, val); 20172d44f31SMarcel Moolenaar gdb_tx_ok(); 20272d44f31SMarcel Moolenaar break; 20372d44f31SMarcel Moolenaar } 20472d44f31SMarcel Moolenaar case 'q': /* General query. */ 20572d44f31SMarcel Moolenaar if (gdb_rx_equal("fThreadInfo")) { 20672d44f31SMarcel Moolenaar thr_iter = kdb_thr_first(); 20772d44f31SMarcel Moolenaar gdb_tx_begin('m'); 20872d44f31SMarcel Moolenaar gdb_tx_hex((long)thr_iter->td_tid, 8); 20972d44f31SMarcel Moolenaar gdb_tx_end(); 21072d44f31SMarcel Moolenaar } else if (gdb_rx_equal("sThreadInfo")) { 21172d44f31SMarcel Moolenaar if (thr_iter == NULL) { 21272d44f31SMarcel Moolenaar gdb_tx_err(ENXIO); 21372d44f31SMarcel Moolenaar break; 21472d44f31SMarcel Moolenaar } 21572d44f31SMarcel Moolenaar thr_iter = kdb_thr_next(thr_iter); 21672d44f31SMarcel Moolenaar if (thr_iter != NULL) { 21772d44f31SMarcel Moolenaar gdb_tx_begin('m'); 21872d44f31SMarcel Moolenaar gdb_tx_hex((long)thr_iter->td_tid, 8); 21972d44f31SMarcel Moolenaar gdb_tx_end(); 22072d44f31SMarcel Moolenaar } else { 22172d44f31SMarcel Moolenaar gdb_tx_begin('l'); 22272d44f31SMarcel Moolenaar gdb_tx_end(); 22372d44f31SMarcel Moolenaar } 22472d44f31SMarcel Moolenaar } else if (!gdb_cpu_query()) 22572d44f31SMarcel Moolenaar gdb_tx_empty(); 22672d44f31SMarcel Moolenaar break; 22772d44f31SMarcel Moolenaar case 's': { /* Step. */ 22872d44f31SMarcel Moolenaar uintmax_t addr; 22972d44f31SMarcel Moolenaar if (!gdb_rx_varhex(&addr)) 23072d44f31SMarcel Moolenaar gdb_cpu_setreg(GDB_REG_PC, addr); 23172d44f31SMarcel Moolenaar kdb_cpu_set_singlestep(); 23272d44f31SMarcel Moolenaar return (1); 23372d44f31SMarcel Moolenaar } 23472d44f31SMarcel Moolenaar case 'S': { /* Step with signal. */ 23572d44f31SMarcel Moolenaar uintmax_t addr, sig; 23672d44f31SMarcel Moolenaar if (!gdb_rx_varhex(&sig) && gdb_rx_char() == ';' && 23772d44f31SMarcel Moolenaar !gdb_rx_varhex(&addr)) 23872d44f31SMarcel Moolenaar gdb_cpu_setreg(GDB_REG_PC, addr); 23972d44f31SMarcel Moolenaar kdb_cpu_set_singlestep(); 24072d44f31SMarcel Moolenaar return (1); 24172d44f31SMarcel Moolenaar } 24272d44f31SMarcel Moolenaar case 'T': { /* Thread alive. */ 24372d44f31SMarcel Moolenaar intmax_t tid; 24472d44f31SMarcel Moolenaar gdb_rx_varhex(&tid); 24572d44f31SMarcel Moolenaar if (kdb_thr_lookup(tid) != NULL) 24672d44f31SMarcel Moolenaar gdb_tx_ok(); 24772d44f31SMarcel Moolenaar else 24872d44f31SMarcel Moolenaar gdb_tx_err(ENOENT); 24972d44f31SMarcel Moolenaar break; 25072d44f31SMarcel Moolenaar } 25172d44f31SMarcel Moolenaar case -1: 25272d44f31SMarcel Moolenaar /* Empty command. Treat as unknown command. */ 25372d44f31SMarcel Moolenaar /* FALLTHROUGH */ 25472d44f31SMarcel Moolenaar default: 25572d44f31SMarcel Moolenaar /* Unknown command. Send empty response. */ 25672d44f31SMarcel Moolenaar gdb_tx_empty(); 25772d44f31SMarcel Moolenaar break; 25872d44f31SMarcel Moolenaar } 25972d44f31SMarcel Moolenaar } 26072d44f31SMarcel Moolenaar return (0); 26172d44f31SMarcel Moolenaar } 262