1 /* kgdb.c: KGDB support for 64-bit sparc.
3 * Copyright (C) 2008 David S. Miller <davem@davemloft.net>
6 #include <linux/kgdb.h>
7 #include <linux/kdebug.h>
8 #include <linux/ftrace.h>
9 #include <linux/context_tracking.h>
11 #include <asm/cacheflush.h>
12 #include <asm/kdebug.h>
13 #include <asm/ptrace.h>
16 void pt_regs_to_gdb_regs(unsigned long *gdb_regs, struct pt_regs *regs)
18 struct reg_window *win;
22 for (i = 0; i < 15; i++)
23 gdb_regs[GDB_G1 + i] = regs->u_regs[UREG_G1 + i];
25 win = (struct reg_window *) (regs->u_regs[UREG_FP] + STACK_BIAS);
26 for (i = 0; i < 8; i++)
27 gdb_regs[GDB_L0 + i] = win->locals[i];
28 for (i = 0; i < 8; i++)
29 gdb_regs[GDB_I0 + i] = win->ins[i];
31 for (i = GDB_F0; i <= GDB_F62; i++)
34 gdb_regs[GDB_PC] = regs->tpc;
35 gdb_regs[GDB_NPC] = regs->tnpc;
36 gdb_regs[GDB_STATE] = regs->tstate;
37 gdb_regs[GDB_FSR] = 0;
38 gdb_regs[GDB_FPRS] = 0;
39 gdb_regs[GDB_Y] = regs->y;
42 void sleeping_thread_to_gdb_regs(unsigned long *gdb_regs, struct task_struct *p)
44 struct thread_info *t = task_thread_info(p);
45 extern unsigned int switch_to_pc;
46 extern unsigned int ret_from_fork;
47 struct reg_window *win;
48 unsigned long pc, cwp;
51 for (i = GDB_G0; i < GDB_G6; i++)
53 gdb_regs[GDB_G6] = (unsigned long) t;
54 gdb_regs[GDB_G7] = (unsigned long) p;
55 for (i = GDB_O0; i < GDB_SP; i++)
57 gdb_regs[GDB_SP] = t->ksp;
60 win = (struct reg_window *) (t->ksp + STACK_BIAS);
61 for (i = 0; i < 8; i++)
62 gdb_regs[GDB_L0 + i] = win->locals[i];
63 for (i = 0; i < 8; i++)
64 gdb_regs[GDB_I0 + i] = win->ins[i];
66 for (i = GDB_F0; i <= GDB_F62; i++)
70 pc = (unsigned long) &ret_from_fork;
72 pc = (unsigned long) &switch_to_pc;
74 gdb_regs[GDB_PC] = pc;
75 gdb_regs[GDB_NPC] = pc + 4;
77 cwp = __thread_flag_byte_ptr(t)[TI_FLAG_BYTE_CWP];
79 gdb_regs[GDB_STATE] = (TSTATE_PRIV | TSTATE_IE | cwp);
80 gdb_regs[GDB_FSR] = 0;
81 gdb_regs[GDB_FPRS] = 0;
85 void gdb_regs_to_pt_regs(unsigned long *gdb_regs, struct pt_regs *regs)
87 struct reg_window *win;
90 for (i = 0; i < 15; i++)
91 regs->u_regs[UREG_G1 + i] = gdb_regs[GDB_G1 + i];
93 /* If the TSTATE register is changing, we have to preserve
94 * the CWP field, otherwise window save/restore explodes.
96 if (regs->tstate != gdb_regs[GDB_STATE]) {
97 unsigned long cwp = regs->tstate & TSTATE_CWP;
99 regs->tstate = (gdb_regs[GDB_STATE] & ~TSTATE_CWP) | cwp;
102 regs->tpc = gdb_regs[GDB_PC];
103 regs->tnpc = gdb_regs[GDB_NPC];
104 regs->y = gdb_regs[GDB_Y];
106 win = (struct reg_window *) (regs->u_regs[UREG_FP] + STACK_BIAS);
107 for (i = 0; i < 8; i++)
108 win->locals[i] = gdb_regs[GDB_L0 + i];
109 for (i = 0; i < 8; i++)
110 win->ins[i] = gdb_regs[GDB_I0 + i];
114 void __irq_entry smp_kgdb_capture_client(int irq, struct pt_regs *regs)
118 __asm__ __volatile__("rdpr %%pstate, %0\n\t"
119 "wrpr %0, %1, %%pstate"
125 if (atomic_read(&kgdb_active) != -1)
126 kgdb_nmicallback(raw_smp_processor_id(), regs);
128 __asm__ __volatile__("wrpr %0, 0, %%pstate"
133 int kgdb_arch_handle_exception(int e_vector, int signo, int err_code,
134 char *remcomInBuffer, char *remcomOutBuffer,
135 struct pt_regs *linux_regs)
140 switch (remcomInBuffer[0]) {
142 /* try to read optional parameter, pc unchanged if no parm */
143 ptr = &remcomInBuffer[1];
144 if (kgdb_hex2long(&ptr, &addr)) {
145 linux_regs->tpc = addr;
146 linux_regs->tnpc = addr + 4;
152 if (linux_regs->tpc == (unsigned long) arch_kgdb_breakpoint) {
153 linux_regs->tpc = linux_regs->tnpc;
154 linux_regs->tnpc += 4;
161 asmlinkage void kgdb_trap(unsigned long trap_level, struct pt_regs *regs)
163 enum ctx_state prev_state = exception_enter();
166 if (user_mode(regs)) {
167 bad_trap(regs, trap_level);
173 local_irq_save(flags);
174 kgdb_handle_exception(0x172, SIGTRAP, 0, regs);
175 local_irq_restore(flags);
177 exception_exit(prev_state);
180 int kgdb_arch_init(void)
185 void kgdb_arch_exit(void)
189 void kgdb_arch_set_pc(struct pt_regs *regs, unsigned long ip)
192 regs->tnpc = regs->tpc + 4;
195 struct kgdb_arch arch_kgdb_ops = {
196 /* Breakpoint instruction: ta 0x72 */
197 .gdb_bpt_instr = { 0x91, 0xd0, 0x20, 0x72 },