Merge branch 'vendor/BINUTILS_ALL'
[dragonfly.git] / sys / platform / vkernel / i386 / db_interface.c
1 /*
2  * Mach Operating System
3  * Copyright (c) 1991,1990 Carnegie Mellon University
4  * All Rights Reserved.
5  *
6  * Permission to use, copy, modify and distribute this software and its
7  * documentation is hereby granted, provided that both the copyright
8  * notice and this permission notice appear in all copies of the
9  * software, derivative works or modified versions, and any portions
10  * thereof, and that both notices appear in supporting documentation.
11  *
12  * CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS
13  * CONDITION.  CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND FOR
14  * ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
15  *
16  * Carnegie Mellon requests users of this software to return to
17  *
18  *  Software Distribution Coordinator  or  Software.Distribution@CS.CMU.EDU
19  *  School of Computer Science
20  *  Carnegie Mellon University
21  *  Pittsburgh PA 15213-3890
22  *
23  * any improvements or extensions that they make and grant Carnegie the
24  * rights to redistribute these changes.
25  *
26  * $FreeBSD: src/sys/i386/i386/db_interface.c,v 1.48.2.1 2000/07/07 00:38:46 obrien Exp $
27  * $DragonFly: src/sys/platform/vkernel/i386/db_interface.c,v 1.3 2007/01/09 00:20:17 dillon Exp $
28  */
29
30 /*
31  * Interface to new debugger.
32  */
33 #include <sys/param.h>
34 #include <sys/systm.h>
35 #include <sys/reboot.h>
36 #include <sys/cons.h>
37 #include <sys/vkernel.h>
38 #include <sys/thread.h>
39
40 #include <machine/cpu.h>
41 #include <machine/smp.h>
42 #include <machine/globaldata.h>
43 #include <machine/md_var.h>
44
45 #include <vm/vm.h>
46 #include <vm/pmap.h>
47
48 #include <sys/thread2.h>
49
50 #include <ddb/ddb.h>
51
52 #include <setjmp.h>
53
54 static jmp_buf *db_nofault = 0;
55 extern jmp_buf  db_jmpbuf;
56
57 extern void     gdb_handle_exception (db_regs_t *, int, int);
58
59 int     db_active;
60 db_regs_t ddb_regs;
61
62 static jmp_buf  db_global_jmpbuf;
63 static int      db_global_jmpbuf_valid;
64
65 #ifdef __GNUC__
66 #define rss() ({u_short ss; __asm __volatile("mov %%ss,%0" : "=r" (ss)); ss;})
67 #endif
68
69 /*
70  *  kdb_trap - field a TRACE or BPT trap
71  */
72 int
73 kdb_trap(int type, int code, struct i386_saved_state *regs)
74 {
75         volatile int ddb_mode = !(boothowto & RB_GDB);
76
77         /*
78          * XXX try to do nothing if the console is in graphics mode.
79          * Handle trace traps (and hardware breakpoints...) by ignoring
80          * them except for forgetting about them.  Return 0 for other
81          * traps to say that we haven't done anything.  The trap handler
82          * will usually panic.  We should handle breakpoint traps for
83          * our breakpoints by disarming our breakpoints and fixing up
84          * %eip.
85          */
86         if (cons_unavail && ddb_mode) {
87             if (type == T_TRCTRAP) {
88                 regs->tf_eflags &= ~PSL_T;
89                 return (1);
90             }
91             return (0);
92         }
93
94         switch (type) {
95             case T_BPTFLT:      /* breakpoint */
96             case T_TRCTRAP:     /* debug exception */
97                 break;
98
99             default:
100                 /*
101                  * XXX this is almost useless now.  In most cases,
102                  * trap_fatal() has already printed a much more verbose
103                  * message.  However, it is dangerous to print things in
104                  * trap_fatal() - kprintf() might be reentered and trap.
105                  * The debugger should be given control first.
106                  */
107                 if (ddb_mode)
108                     db_printf("kernel: type %d trap, code=%x\n", type, code);
109
110                 if (db_nofault) {
111                     jmp_buf *no_fault = db_nofault;
112                     db_nofault = 0;
113                     longjmp(*no_fault, 1);
114                 }
115         }
116
117         /*
118          * This handles unexpected traps in ddb commands, including calls to
119          * non-ddb functions.  db_nofault only applies to memory accesses by
120          * internal ddb commands.
121          */
122         if (db_global_jmpbuf_valid)
123             longjmp(db_global_jmpbuf, 1);
124
125         /*
126          * XXX We really should switch to a local stack here.
127          */
128         ddb_regs = *regs;
129
130         /*
131          * If in kernel mode, esp and ss are not saved, so dummy them up.
132          */
133         if (ISPL(regs->tf_cs) == 0) {
134             ddb_regs.tf_esp = (int)&regs->tf_esp;
135             ddb_regs.tf_ss = rss();
136         }
137
138         crit_enter();
139 #ifdef SMP
140         db_printf("\nCPU%d stopping CPUs: 0x%08x\n", 
141             mycpu->gd_cpuid, mycpu->gd_other_cpus);
142
143         /* We stop all CPUs except ourselves (obviously) */
144         stop_cpus(mycpu->gd_other_cpus);
145
146         db_printf(" stopped\n");
147 #endif /* SMP */
148
149         setjmp(db_global_jmpbuf);
150         db_global_jmpbuf_valid = TRUE;
151         db_active++;
152         vcons_set_mode(1);
153         if (ddb_mode) {
154             cndbctl(TRUE);
155             db_trap(type, code);
156             cndbctl(FALSE);
157         } else
158             gdb_handle_exception(&ddb_regs, type, code);
159         db_active--;
160         vcons_set_mode(0);
161         db_global_jmpbuf_valid = FALSE;
162
163 #ifdef SMP
164         db_printf("\nCPU%d restarting CPUs: 0x%016jx\n",
165             mycpu->gd_cpuid, (uintmax_t)stopped_cpus);
166
167         /* Restart all the CPUs we previously stopped */
168         if (stopped_cpus != mycpu->gd_other_cpus) {
169                 db_printf("whoa, other_cpus: 0x%08x, stopped_cpus: 0x%016jx\n",
170                           mycpu->gd_other_cpus, (uintmax_t)stopped_cpus);
171                 panic("stop_cpus() failed");
172         }
173         restart_cpus(stopped_cpus);
174
175         db_printf(" restarted\n");
176 #endif /* SMP */
177         crit_exit();
178
179         regs->tf_eip    = ddb_regs.tf_eip;
180         regs->tf_eflags = ddb_regs.tf_eflags;
181         regs->tf_eax    = ddb_regs.tf_eax;
182         regs->tf_ecx    = ddb_regs.tf_ecx;
183         regs->tf_edx    = ddb_regs.tf_edx;
184         regs->tf_ebx    = ddb_regs.tf_ebx;
185
186         /*
187          * If in user mode, the saved ESP and SS were valid, restore them.
188          */
189         if (ISPL(regs->tf_cs)) {
190             regs->tf_esp = ddb_regs.tf_esp;
191             regs->tf_ss  = ddb_regs.tf_ss & 0xffff;
192         }
193
194         regs->tf_ebp    = ddb_regs.tf_ebp;
195         regs->tf_esi    = ddb_regs.tf_esi;
196         regs->tf_edi    = ddb_regs.tf_edi;
197         regs->tf_es     = ddb_regs.tf_es & 0xffff;
198         regs->tf_fs     = ddb_regs.tf_fs & 0xffff;
199         regs->tf_gs     = ddb_regs.tf_gs & 0xffff;
200         regs->tf_cs     = ddb_regs.tf_cs & 0xffff;
201         regs->tf_ds     = ddb_regs.tf_ds & 0xffff;
202         return (1);
203 }
204
205 /*
206  * Read bytes from kernel address space for debugger.
207  */
208 void
209 db_read_bytes(vm_offset_t addr, size_t size, char *data)
210 {
211         char    *src;
212
213         db_nofault = &db_jmpbuf;
214
215         src = (char *)addr;
216         while (size-- > 0)
217             *data++ = *src++;
218
219         db_nofault = 0;
220 }
221
222 /*
223  * Write bytes to kernel address space for debugger.
224  */
225 void
226 db_write_bytes(vm_offset_t addr, size_t size, char *data)
227 {
228         char    *dst;
229 #if 0
230         vpte_t  *ptep0 = NULL;
231         vpte_t  oldmap0 = 0;
232         vm_offset_t     addr1;
233         vpte_t  *ptep1 = NULL;
234         vpte_t  oldmap1 = 0;
235 #endif
236
237         db_nofault = &db_jmpbuf;
238 #if 0
239         if (addr > trunc_page((vm_offset_t)btext) - size &&
240             addr < round_page((vm_offset_t)etext)) {
241
242             ptep0 = pmap_kpte(addr);
243             oldmap0 = *ptep0;
244             *ptep0 |= VPTE_W;
245
246             /* Map another page if the data crosses a page boundary. */
247             if ((*ptep0 & PG_PS) == 0) {
248                 addr1 = trunc_page(addr + size - 1);
249                 if (trunc_page(addr) != addr1) {
250                     ptep1 = pmap_kpte(addr1);
251                     oldmap1 = *ptep1;
252                     *ptep1 |= VPTE_W;
253                 }
254             } else {
255                 addr1 = trunc_4mpage(addr + size - 1);
256                 if (trunc_4mpage(addr) != addr1) {
257                     ptep1 = pmap_kpte(addr1);
258                     oldmap1 = *ptep1;
259                     *ptep1 |= VPTE_W;
260                 }
261             }
262
263             cpu_invltlb();
264         }
265 #endif
266
267         dst = (char *)addr;
268
269         while (size-- > 0)
270             *dst++ = *data++;
271
272         db_nofault = 0;
273
274 #if 0
275         if (ptep0) {
276             *ptep0 = oldmap0;
277
278             if (ptep1)
279                 *ptep1 = oldmap1;
280
281             cpu_invltlb();
282         }
283 #endif
284 }
285
286 /*
287  * The debugger sometimes needs to know the actual KVM address represented
288  * by the instruction pointer, stack pointer, or base pointer.  Normally
289  * the actual KVM address is simply the contents of the register.  However,
290  * if the debugger is entered from the BIOS or VM86 we need to figure out
291  * the offset from the segment register.
292  */
293 db_addr_t
294 PC_REGS(db_regs_t *regs)
295 {
296     return(regs->tf_eip);
297 }
298
299 db_addr_t
300 SP_REGS(db_regs_t *regs)
301 {
302     return(regs->tf_esp);
303 }
304
305 db_addr_t
306 BP_REGS(db_regs_t *regs)
307 {
308     return(regs->tf_ebp);
309 }
310
311 /*
312  * XXX
313  * Move this to machdep.c and allow it to be called if any debugger is
314  * installed.
315  */
316 void
317 Debugger(const char *msg)
318 {
319         static volatile u_char in_Debugger;
320
321         /*
322          * XXX
323          * Do nothing if the console is in graphics mode.  This is
324          * OK if the call is for the debugger hotkey but not if the call
325          * is a weak form of panicing.
326          */
327         if (cons_unavail && !(boothowto & RB_GDB))
328             return;
329
330         if (!in_Debugger) {
331             in_Debugger = 1;
332             db_printf("Debugger(\"%s\")\n", msg);
333             breakpoint();
334             in_Debugger = 0;
335         }
336 }