gdb_main.c revision 138253
1131899Smarcel/*
2131899Smarcel * Copyright (c) 2004 Marcel Moolenaar
3131899Smarcel * All rights reserved.
4131899Smarcel *
5131899Smarcel * Redistribution and use in source and binary forms, with or without
6131899Smarcel * modification, are permitted provided that the following conditions
7131899Smarcel * are met:
8131899Smarcel *
9131899Smarcel * 1. Redistributions of source code must retain the above copyright
10131899Smarcel *    notice, this list of conditions and the following disclaimer.
11131899Smarcel * 2. Redistributions in binary form must reproduce the above copyright
12131899Smarcel *    notice, this list of conditions and the following disclaimer in the
13131899Smarcel *    documentation and/or other materials provided with the distribution.
14131899Smarcel *
15131899Smarcel * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
16131899Smarcel * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17131899Smarcel * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18131899Smarcel * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
19131899Smarcel * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20131899Smarcel * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21131899Smarcel * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22131899Smarcel * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23131899Smarcel * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24131899Smarcel * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25131899Smarcel */
26131899Smarcel
27131899Smarcel#include <sys/cdefs.h>
28131899Smarcel__FBSDID("$FreeBSD: head/sys/gdb/gdb_main.c 138253 2004-12-01 06:40:35Z marcel $");
29131899Smarcel
30131899Smarcel#include <sys/param.h>
31131899Smarcel#include <sys/systm.h>
32131899Smarcel#include <sys/kdb.h>
33131899Smarcel#include <sys/kernel.h>
34131899Smarcel#include <sys/pcpu.h>
35131899Smarcel#include <sys/proc.h>
36131899Smarcel#include <sys/reboot.h>
37131899Smarcel
38131899Smarcel#include <machine/gdb_machdep.h>
39131899Smarcel#include <machine/kdb.h>
40131899Smarcel
41131899Smarcel#include <gdb/gdb.h>
42131899Smarcel#include <gdb/gdb_int.h>
43131899Smarcel
44131899Smarcelstatic dbbe_init_f gdb_init;
45131899Smarcelstatic dbbe_trap_f gdb_trap;
46131899Smarcel
47131899SmarcelKDB_BACKEND(gdb, gdb_init, NULL, gdb_trap);
48131899Smarcel
49131899SmarcelGDB_DBGPORT(null, NULL, NULL, NULL, NULL, NULL, NULL);
50131899SmarcelSET_DECLARE(gdb_dbgport_set, struct gdb_dbgport);
51131899Smarcel
52131899Smarcelstruct gdb_dbgport *gdb_cur = NULL;
53131899Smarcel
54131899Smarcelstatic int
55131899Smarcelgdb_init(void)
56131899Smarcel{
57131899Smarcel	struct gdb_dbgport *dp, **iter;
58131899Smarcel	int cur_pri, pri;
59131899Smarcel
60131899Smarcel	gdb_cur = NULL;
61131899Smarcel	cur_pri = -1;
62131899Smarcel	SET_FOREACH(iter, gdb_dbgport_set) {
63131899Smarcel		dp = *iter;
64131899Smarcel		pri = (dp->gdb_probe != NULL) ? dp->gdb_probe() : -1;
65131899Smarcel		dp->gdb_active = (pri >= 0) ? 0 : -1;
66131899Smarcel		if (pri > cur_pri) {
67131899Smarcel			cur_pri = pri;
68131899Smarcel			gdb_cur = dp;
69131899Smarcel		}
70131899Smarcel	}
71131899Smarcel	if (gdb_cur != NULL) {
72131899Smarcel		printf("GDB: debug ports:");
73131899Smarcel		SET_FOREACH(iter, gdb_dbgport_set) {
74131899Smarcel			dp = *iter;
75131899Smarcel			if (dp->gdb_active == 0)
76131899Smarcel				printf(" %s", dp->gdb_name);
77131899Smarcel		}
78131899Smarcel		printf("\n");
79131899Smarcel	} else
80131899Smarcel		printf("GDB: no debug ports present\n");
81131899Smarcel	if (gdb_cur != NULL) {
82131899Smarcel		gdb_cur->gdb_init();
83131899Smarcel		printf("GDB: current port: %s\n", gdb_cur->gdb_name);
84131899Smarcel	}
85131899Smarcel	if (gdb_cur != NULL)
86131899Smarcel		cur_pri = (boothowto & RB_GDB) ? 2 : 0;
87131899Smarcel	else
88131899Smarcel		cur_pri = -1;
89131899Smarcel	return (cur_pri);
90131899Smarcel}
91131899Smarcel
92131899Smarcelstatic int
93131899Smarcelgdb_trap(int type, int code)
94131899Smarcel{
95131899Smarcel	struct thread *thr_iter;
96131899Smarcel
97131899Smarcel	/*
98131899Smarcel	 * Send a T packet. We currently do not support watchpoints (the
99131899Smarcel	 * awatch, rwatch or watch elements).
100131899Smarcel	 */
101131899Smarcel	gdb_tx_begin('T');
102131899Smarcel	gdb_tx_hex(gdb_cpu_signal(type, code), 2);
103131899Smarcel	gdb_tx_varhex(GDB_REG_PC);
104131899Smarcel	gdb_tx_char(':');
105131899Smarcel	gdb_tx_reg(GDB_REG_PC);
106131899Smarcel	gdb_tx_char(';');
107131899Smarcel	gdb_tx_str("thread:");
108131899Smarcel	gdb_tx_varhex((long)kdb_thread->td_tid);
109131899Smarcel	gdb_tx_char(';');
110131899Smarcel	gdb_tx_end();			/* XXX check error condition. */
111131899Smarcel
112131899Smarcel	thr_iter = NULL;
113131899Smarcel	while (gdb_rx_begin() == 0) {
114133446Smarcel		/* printf("GDB: got '%s'\n", gdb_rxp); */
115131899Smarcel		switch (gdb_rx_char()) {
116131899Smarcel		case '?':	/* Last signal. */
117131899Smarcel			gdb_tx_begin('S');
118131899Smarcel			gdb_tx_hex(gdb_cpu_signal(type, code), 2);
119131899Smarcel			gdb_tx_end();
120131899Smarcel			break;
121131899Smarcel		case 'c': {	/* Continue. */
122131899Smarcel			uintmax_t addr;
123138253Smarcel			register_t pc;
124138253Smarcel			if (!gdb_rx_varhex(&addr)) {
125138253Smarcel				pc = addr;
126138253Smarcel				gdb_cpu_setreg(GDB_REG_PC, &pc);
127138253Smarcel			}
128131899Smarcel			kdb_cpu_clear_singlestep();
129131899Smarcel			return (1);
130131899Smarcel		}
131131899Smarcel		case 'C': {	/* Continue with signal. */
132131899Smarcel			uintmax_t addr, sig;
133138253Smarcel			register_t pc;
134131899Smarcel			if (!gdb_rx_varhex(&sig) && gdb_rx_char() == ';' &&
135138253Smarcel			    !gdb_rx_varhex(&addr)) {
136138253Smarcel				pc = addr;
137138253Smarcel				gdb_cpu_setreg(GDB_REG_PC, &pc);
138138253Smarcel			}
139131899Smarcel			kdb_cpu_clear_singlestep();
140131899Smarcel			return (1);
141131899Smarcel		}
142131899Smarcel		case 'g': {	/* Read registers. */
143131899Smarcel			size_t r;
144131899Smarcel			gdb_tx_begin(0);
145131899Smarcel			for (r = 0; r < GDB_NREGS; r++)
146131899Smarcel				gdb_tx_reg(r);
147131899Smarcel			gdb_tx_end();
148131899Smarcel			break;
149131899Smarcel		}
150131899Smarcel		case 'G':	/* Write registers. */
151131899Smarcel			gdb_tx_err(0);
152131899Smarcel			break;
153131899Smarcel		case 'H': {	/* Set thread. */
154131899Smarcel			intmax_t tid;
155131899Smarcel			struct thread *thr;
156131899Smarcel			gdb_rx_char();
157131899Smarcel			gdb_rx_varhex(&tid);
158131899Smarcel			if (tid > 0) {
159131899Smarcel				thr = kdb_thr_lookup(tid);
160131899Smarcel				if (thr == NULL) {
161131899Smarcel					gdb_tx_err(ENOENT);
162131899Smarcel					break;
163131899Smarcel				}
164131899Smarcel				kdb_thr_select(thr);
165131899Smarcel			}
166131899Smarcel			gdb_tx_ok();
167131899Smarcel			break;
168131899Smarcel		}
169131899Smarcel		case 'k':	/* Kill request. */
170131899Smarcel			kdb_cpu_clear_singlestep();
171131899Smarcel			return (1);
172131899Smarcel		case 'm': {	/* Read memory. */
173131899Smarcel			uintmax_t addr, size;
174131899Smarcel			if (gdb_rx_varhex(&addr) || gdb_rx_char() != ',' ||
175131899Smarcel			    gdb_rx_varhex(&size)) {
176131899Smarcel				gdb_tx_err(EINVAL);
177131899Smarcel				break;
178131899Smarcel			}
179131899Smarcel			gdb_tx_begin(0);
180131899Smarcel			if (gdb_tx_mem((char *)(uintptr_t)addr, size))
181131899Smarcel				gdb_tx_end();
182131899Smarcel			else
183131899Smarcel				gdb_tx_err(EIO);
184131899Smarcel			break;
185131899Smarcel		}
186131899Smarcel		case 'M': {	/* Write memory. */
187131899Smarcel			uintmax_t addr, size;
188131899Smarcel			if (gdb_rx_varhex(&addr) || gdb_rx_char() != ',' ||
189131899Smarcel			    gdb_rx_varhex(&size) || gdb_rx_char() != ':') {
190131899Smarcel				gdb_tx_err(EINVAL);
191131899Smarcel				break;
192131899Smarcel			}
193131899Smarcel			if (gdb_rx_mem((char *)(uintptr_t)addr, size) == 0)
194131899Smarcel				gdb_tx_err(EIO);
195131899Smarcel			else
196131899Smarcel				gdb_tx_ok();
197131899Smarcel			break;
198131899Smarcel		}
199131899Smarcel		case 'P': {	/* Write register. */
200138253Smarcel			char *val;
201138253Smarcel			uintmax_t reg;
202138253Smarcel			val = gdb_rxp;
203131899Smarcel			if (gdb_rx_varhex(&reg) || gdb_rx_char() != '=' ||
204138253Smarcel			    !gdb_rx_mem(val, gdb_cpu_regsz(reg))) {
205131899Smarcel				gdb_tx_err(EINVAL);
206131899Smarcel				break;
207131899Smarcel			}
208131899Smarcel			gdb_cpu_setreg(reg, val);
209131899Smarcel			gdb_tx_ok();
210131899Smarcel			break;
211131899Smarcel		}
212131899Smarcel		case 'q':	/* General query. */
213131899Smarcel			if (gdb_rx_equal("fThreadInfo")) {
214131899Smarcel				thr_iter = kdb_thr_first();
215131899Smarcel				gdb_tx_begin('m');
216131899Smarcel				gdb_tx_hex((long)thr_iter->td_tid, 8);
217131899Smarcel				gdb_tx_end();
218131899Smarcel			} else if (gdb_rx_equal("sThreadInfo")) {
219131899Smarcel				if (thr_iter == NULL) {
220131899Smarcel					gdb_tx_err(ENXIO);
221131899Smarcel					break;
222131899Smarcel				}
223131899Smarcel				thr_iter = kdb_thr_next(thr_iter);
224131899Smarcel				if (thr_iter != NULL) {
225131899Smarcel					gdb_tx_begin('m');
226131899Smarcel					gdb_tx_hex((long)thr_iter->td_tid, 8);
227131899Smarcel					gdb_tx_end();
228131899Smarcel				} else {
229131899Smarcel					gdb_tx_begin('l');
230131899Smarcel					gdb_tx_end();
231131899Smarcel				}
232131899Smarcel			} else if (!gdb_cpu_query())
233131899Smarcel				gdb_tx_empty();
234131899Smarcel			break;
235131899Smarcel		case 's': {	/* Step. */
236131899Smarcel			uintmax_t addr;
237138253Smarcel			register_t pc;
238138253Smarcel			if (!gdb_rx_varhex(&addr)) {
239138253Smarcel				pc = addr;
240138253Smarcel				gdb_cpu_setreg(GDB_REG_PC, &pc);
241138253Smarcel			}
242131899Smarcel			kdb_cpu_set_singlestep();
243131899Smarcel			return (1);
244131899Smarcel		}
245131899Smarcel		case 'S': {	/* Step with signal. */
246131899Smarcel			uintmax_t addr, sig;
247138253Smarcel			register_t pc;
248131899Smarcel			if (!gdb_rx_varhex(&sig) && gdb_rx_char() == ';' &&
249138253Smarcel			    !gdb_rx_varhex(&addr)) {
250138253Smarcel				pc = addr;
251138253Smarcel				gdb_cpu_setreg(GDB_REG_PC, &pc);
252138253Smarcel			}
253131899Smarcel			kdb_cpu_set_singlestep();
254131899Smarcel			return (1);
255131899Smarcel		}
256131899Smarcel		case 'T': {	/* Thread alive. */
257131899Smarcel			intmax_t tid;
258131899Smarcel			gdb_rx_varhex(&tid);
259131899Smarcel			if (kdb_thr_lookup(tid) != NULL)
260131899Smarcel				gdb_tx_ok();
261131899Smarcel			else
262131899Smarcel				gdb_tx_err(ENOENT);
263131899Smarcel			break;
264131899Smarcel		}
265131899Smarcel		case -1:
266131899Smarcel			/* Empty command. Treat as unknown command. */
267131899Smarcel			/* FALLTHROUGH */
268131899Smarcel		default:
269131899Smarcel			/* Unknown command. Send empty response. */
270131899Smarcel			gdb_tx_empty();
271131899Smarcel			break;
272131899Smarcel		}
273131899Smarcel	}
274131899Smarcel	return (0);
275131899Smarcel}
276