Commit | Line | Data |
---|---|---|
2d5973cb MS |
1 | /* |
2 | * Microblaze KGDB support | |
3 | * | |
4 | * This file is subject to the terms and conditions of the GNU General Public | |
5 | * License. See the file "COPYING" in the main directory of this archive | |
6 | * for more details. | |
7 | */ | |
8 | ||
9 | #include <linux/kgdb.h> | |
10 | #include <linux/kdebug.h> | |
11 | #include <linux/irq.h> | |
12 | #include <linux/io.h> | |
13 | #include <asm/cacheflush.h> | |
14 | #include <asm/asm-offsets.h> | |
f396a4d2 | 15 | #include <asm/kgdb.h> |
2d5973cb MS |
16 | #include <asm/pvr.h> |
17 | ||
18 | #define GDB_REG 0 | |
19 | #define GDB_PC 32 | |
20 | #define GDB_MSR 33 | |
21 | #define GDB_EAR 34 | |
22 | #define GDB_ESR 35 | |
23 | #define GDB_FSR 36 | |
24 | #define GDB_BTR 37 | |
25 | #define GDB_PVR 38 | |
26 | #define GDB_REDR 50 | |
27 | #define GDB_RPID 51 | |
28 | #define GDB_RZPR 52 | |
29 | #define GDB_RTLBX 53 | |
30 | #define GDB_RTLBSX 54 /* mfs can't read it */ | |
31 | #define GDB_RTLBLO 55 | |
32 | #define GDB_RTLBHI 56 | |
33 | ||
34 | /* keep pvr separately because it is unchangeble */ | |
55ae2f3b | 35 | static struct pvr_s pvr; |
2d5973cb MS |
36 | |
37 | void pt_regs_to_gdb_regs(unsigned long *gdb_regs, struct pt_regs *regs) | |
38 | { | |
e76fdb32 | 39 | unsigned int i; |
2d5973cb MS |
40 | unsigned long *pt_regb = (unsigned long *)regs; |
41 | int temp; | |
e76fdb32 | 42 | |
2d5973cb MS |
43 | /* registers r0 - r31, pc, msr, ear, esr, fsr + do not save pt_mode */ |
44 | for (i = 0; i < (sizeof(struct pt_regs) / 4) - 1; i++) | |
45 | gdb_regs[i] = pt_regb[i]; | |
46 | ||
47 | /* Branch target register can't be changed */ | |
48 | __asm__ __volatile__ ("mfs %0, rbtr;" : "=r"(temp) : ); | |
49 | gdb_regs[GDB_BTR] = temp; | |
50 | ||
51 | /* pvr part - we have 11 pvr regs */ | |
52 | for (i = 0; i < sizeof(struct pvr_s)/4; i++) | |
53 | gdb_regs[GDB_PVR + i] = pvr.pvr[i]; | |
54 | ||
55 | /* read special registers - can't be changed */ | |
56 | __asm__ __volatile__ ("mfs %0, redr;" : "=r"(temp) : ); | |
57 | gdb_regs[GDB_REDR] = temp; | |
58 | __asm__ __volatile__ ("mfs %0, rpid;" : "=r"(temp) : ); | |
59 | gdb_regs[GDB_RPID] = temp; | |
60 | __asm__ __volatile__ ("mfs %0, rzpr;" : "=r"(temp) : ); | |
61 | gdb_regs[GDB_RZPR] = temp; | |
62 | __asm__ __volatile__ ("mfs %0, rtlbx;" : "=r"(temp) : ); | |
63 | gdb_regs[GDB_RTLBX] = temp; | |
64 | __asm__ __volatile__ ("mfs %0, rtlblo;" : "=r"(temp) : ); | |
65 | gdb_regs[GDB_RTLBLO] = temp; | |
66 | __asm__ __volatile__ ("mfs %0, rtlbhi;" : "=r"(temp) : ); | |
67 | gdb_regs[GDB_RTLBHI] = temp; | |
68 | } | |
69 | ||
70 | void gdb_regs_to_pt_regs(unsigned long *gdb_regs, struct pt_regs *regs) | |
71 | { | |
e76fdb32 | 72 | unsigned int i; |
2d5973cb MS |
73 | unsigned long *pt_regb = (unsigned long *)regs; |
74 | ||
75 | /* pt_regs and gdb_regs have the same 37 values. | |
76 | * The rest of gdb_regs are unused and can't be changed. | |
77 | * r0 register value can't be changed too. */ | |
78 | for (i = 1; i < (sizeof(struct pt_regs) / 4) - 1; i++) | |
79 | pt_regb[i] = gdb_regs[i]; | |
80 | } | |
81 | ||
f396a4d2 | 82 | asmlinkage void microblaze_kgdb_break(struct pt_regs *regs) |
2d5973cb MS |
83 | { |
84 | if (kgdb_handle_exception(1, SIGTRAP, 0, regs) != 0) | |
f859f0a2 | 85 | return; |
2d5973cb MS |
86 | |
87 | /* Jump over the first arch_kgdb_breakpoint which is barrier to | |
88 | * get kgdb work. The same solution is used for powerpc */ | |
89 | if (*(u32 *) (regs->pc) == *(u32 *) (&arch_kgdb_ops.gdb_bpt_instr)) | |
90 | regs->pc += BREAK_INSTR_SIZE; | |
91 | } | |
92 | ||
93 | /* untested */ | |
94 | void sleeping_thread_to_gdb_regs(unsigned long *gdb_regs, struct task_struct *p) | |
95 | { | |
e76fdb32 | 96 | unsigned int i; |
2d5973cb MS |
97 | unsigned long *pt_regb = (unsigned long *)(p->thread.regs); |
98 | ||
99 | /* registers r0 - r31, pc, msr, ear, esr, fsr + do not save pt_mode */ | |
100 | for (i = 0; i < (sizeof(struct pt_regs) / 4) - 1; i++) | |
101 | gdb_regs[i] = pt_regb[i]; | |
102 | ||
103 | /* pvr part - we have 11 pvr regs */ | |
104 | for (i = 0; i < sizeof(struct pvr_s)/4; i++) | |
105 | gdb_regs[GDB_PVR + i] = pvr.pvr[i]; | |
106 | } | |
107 | ||
108 | void kgdb_arch_set_pc(struct pt_regs *regs, unsigned long ip) | |
109 | { | |
110 | regs->pc = ip; | |
111 | } | |
112 | ||
113 | int kgdb_arch_handle_exception(int vector, int signo, int err_code, | |
114 | char *remcom_in_buffer, char *remcom_out_buffer, | |
115 | struct pt_regs *regs) | |
116 | { | |
117 | char *ptr; | |
118 | unsigned long address; | |
2d5973cb MS |
119 | |
120 | switch (remcom_in_buffer[0]) { | |
121 | case 'c': | |
122 | /* handle the optional parameter */ | |
123 | ptr = &remcom_in_buffer[1]; | |
124 | if (kgdb_hex2long(&ptr, &address)) | |
125 | regs->pc = address; | |
126 | ||
127 | return 0; | |
128 | } | |
129 | return -1; /* this means that we do not want to exit from the handler */ | |
130 | } | |
131 | ||
132 | int kgdb_arch_init(void) | |
133 | { | |
134 | get_pvr(&pvr); /* Fill PVR structure */ | |
135 | return 0; | |
136 | } | |
137 | ||
138 | void kgdb_arch_exit(void) | |
139 | { | |
140 | /* Nothing to do */ | |
141 | } | |
142 | ||
143 | /* | |
144 | * Global data | |
145 | */ | |
218a12f1 | 146 | struct kgdb_arch arch_kgdb_ops = { |
e4f29092 MS |
147 | #ifdef __MICROBLAZEEL__ |
148 | .gdb_bpt_instr = {0x18, 0x00, 0x0c, 0xba}, /* brki r16, 0x18 */ | |
149 | #else | |
2d5973cb | 150 | .gdb_bpt_instr = {0xba, 0x0c, 0x00, 0x18}, /* brki r16, 0x18 */ |
e4f29092 | 151 | #endif |
2d5973cb | 152 | }; |