1/*-
2 * Copyright (c) 2015 The FreeBSD Foundation
3 * All rights reserved.
4 *
5 * This software was developed by Semihalf under
6 * the sponsorship of the FreeBSD Foundation.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
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 AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 * SUCH DAMAGE.
28 */
29
30#include "opt_ddb.h"
31
32#include <sys/cdefs.h>
33__FBSDID("$FreeBSD$");
34#include <sys/param.h>
35#include <sys/proc.h>
36#include <sys/kdb.h>
37#include <machine/pcb.h>
38#include <ddb/ddb.h>
39#include <ddb/db_sym.h>
40
41#include <machine/armreg.h>
42#include <machine/debug_monitor.h>
43#include <machine/stack.h>
44
45void
46db_md_list_watchpoints()
47{
48
49	dbg_show_watchpoint();
50}
51
52int
53db_md_clr_watchpoint(db_expr_t addr, db_expr_t size)
54{
55
56	return (dbg_remove_watchpoint(addr, size, DBG_FROM_EL1));
57}
58
59int
60db_md_set_watchpoint(db_expr_t addr, db_expr_t size)
61{
62
63	return (dbg_setup_watchpoint(addr, size, DBG_FROM_EL1,
64	    HW_BREAKPOINT_RW));
65}
66
67static void
68db_stack_trace_cmd(struct unwind_state *frame)
69{
70	c_db_sym_t sym;
71	const char *name;
72	db_expr_t value;
73	db_expr_t offset;
74
75	while (1) {
76		uint64_t pc = frame->pc;
77		int ret;
78
79		ret = unwind_frame(frame);
80		if (ret < 0)
81			break;
82
83		sym = db_search_symbol(pc, DB_STGY_ANY, &offset);
84		if (sym == C_DB_SYM_NULL) {
85			value = 0;
86			name = "(null)";
87		} else
88			db_symbol_values(sym, &name, &value);
89
90		db_printf("%s() at ", name);
91		db_printsym(frame->pc, DB_STGY_PROC);
92		db_printf("\n");
93
94		db_printf("\t pc = 0x%016lx  lr = 0x%016lx\n", pc,
95		    frame->pc);
96		db_printf("\t sp = 0x%016lx  fp = 0x%016lx\n", frame->sp,
97		    frame->fp);
98		/* TODO: Show some more registers */
99		db_printf("\n");
100	}
101}
102
103int
104db_trace_thread(struct thread *thr, int count)
105{
106	struct unwind_state frame;
107	struct pcb *ctx;
108
109	if (thr != curthread) {
110		ctx = kdb_thr_ctx(thr);
111
112		frame.sp = (uint64_t)ctx->pcb_sp;
113		frame.fp = (uint64_t)ctx->pcb_x[29];
114		frame.pc = (uint64_t)ctx->pcb_x[30];
115		db_stack_trace_cmd(&frame);
116	} else
117		db_trace_self();
118	return (0);
119}
120
121void
122db_trace_self(void)
123{
124	struct unwind_state frame;
125	uint64_t sp;
126
127	__asm __volatile("mov %0, sp" : "=&r" (sp));
128
129	frame.sp = sp;
130	frame.fp = (uint64_t)__builtin_frame_address(0);
131	frame.pc = (uint64_t)db_trace_self;
132	db_stack_trace_cmd(&frame);
133}
134