Rev 3108 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 3108 | Rev 4393 | ||
---|---|---|---|
1 | /* |
1 | /* |
2 | * Copyright (c) 2008 Jiri Svoboda |
2 | * Copyright (c) 2008 Jiri Svoboda |
3 | * All rights reserved. |
3 | * All rights reserved. |
4 | * |
4 | * |
5 | * Redistribution and use in source and binary forms, with or without |
5 | * Redistribution and use in source and binary forms, with or without |
6 | * modification, are permitted provided that the following conditions |
6 | * modification, are permitted provided that the following conditions |
7 | * are met: |
7 | * are met: |
8 | * |
8 | * |
9 | * - Redistributions of source code must retain the above copyright |
9 | * - Redistributions of source code must retain the above copyright |
10 | * notice, this list of conditions and the following disclaimer. |
10 | * notice, this list of conditions and the following disclaimer. |
11 | * - Redistributions in binary form must reproduce the above copyright |
11 | * - Redistributions in binary form must reproduce the above copyright |
12 | * notice, this list of conditions and the following disclaimer in the |
12 | * notice, this list of conditions and the following disclaimer in the |
13 | * documentation and/or other materials provided with the distribution. |
13 | * documentation and/or other materials provided with the distribution. |
14 | * - The name of the author may not be used to endorse or promote products |
14 | * - The name of the author may not be used to endorse or promote products |
15 | * derived from this software without specific prior written permission. |
15 | * derived from this software without specific prior written permission. |
16 | * |
16 | * |
17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
27 | */ |
27 | */ |
28 | 28 | ||
29 | /** @addtogroup debug |
29 | /** @addtogroup debug |
30 | * @{ |
30 | * @{ |
31 | */ |
31 | */ |
32 | /** @file |
32 | /** @file |
33 | */ |
33 | */ |
34 | 34 | ||
35 | #include <stdio.h> |
35 | #include <stdio.h> |
36 | #include <stdlib.h> |
36 | #include <stdlib.h> |
37 | #include <sys/types.h> |
37 | #include <sys/types.h> |
38 | #include <bool.h> |
38 | #include <bool.h> |
39 | #include <udebug.h> |
39 | #include <udebug.h> |
40 | 40 | ||
41 | #include <kernel/arch/context_offset.h> |
41 | #include <kernel/arch/context_offset.h> |
42 | 42 | ||
43 | #include "../../../cons.h" |
43 | #include "../../../cons.h" |
44 | #include "../../../main.h" |
44 | #include "../../../main.h" |
45 | #include "../../../include/arch.h" |
45 | #include "../../../include/arch.h" |
46 | 46 | ||
47 | #define OPCODE_INT3 0xCC |
47 | #define OPCODE_INT3 0xCC |
48 | 48 | ||
49 | void arch_dthread_initialize(dthread_t *dt) |
49 | void arch_dthread_initialize(dthread_t *dt) |
50 | { |
50 | { |
51 | dt->arch.singlestep = false; |
51 | dt->arch.singlestep = false; |
52 | } |
52 | } |
53 | 53 | ||
54 | static int _set_trap_flag(dthread_t *dt, bool enable) |
54 | static int _set_trap_flag(dthread_t *dt, bool enable) |
55 | { |
55 | { |
56 | static istate_t istate; |
56 | static istate_t istate; |
57 | int rc; |
57 | int rc; |
58 | 58 | ||
59 | rc = udebug_regs_read(app_phone, dt->hash, &istate); |
59 | rc = udebug_regs_read(app_phone, dt->hash, &istate); |
60 | if (rc < 0) { printf("regs read failed\n"); return -1; } |
60 | if (rc < 0) { printf("regs read failed\n"); return -1; } |
61 | 61 | ||
62 | if (enable) istate.eflags |= 0x0100; /* trap flag */ |
62 | if (enable) istate.eflags |= 0x0100; /* trap flag */ |
63 | else if (!active_bkpt) istate.eflags &= ~0x0100; /* trap flag */ |
63 | else if (!active_bkpt) istate.eflags &= ~0x0100; /* trap flag */ |
64 | 64 | ||
65 | rc = udebug_regs_write(app_phone, dt->hash, &istate); |
65 | rc = udebug_regs_write(app_phone, dt->hash, &istate); |
66 | if (rc < 0) { printf("regs write failed\n"); return -1; } |
66 | if (rc < 0) { printf("regs write failed\n"); return -1; } |
67 | 67 | ||
68 | return 0; |
68 | return 0; |
69 | } |
69 | } |
70 | 70 | ||
71 | int arch_breakpoint_set(breakpoint_t *b) |
71 | int arch_breakpoint_set(breakpoint_t *b) |
72 | { |
72 | { |
73 | char brkp[1]; |
73 | char brkp[1]; |
74 | int rc; |
74 | int rc; |
75 | 75 | ||
76 | rc = udebug_mem_read(app_phone, &b->arch.back, b->addr, 1); |
76 | rc = udebug_mem_read(app_phone, &b->arch.back, b->addr, 1); |
77 | cons_printf("udebug_mem_read() -> %d\n", rc); |
77 | cons_printf("udebug_mem_read() -> %d\n", rc); |
78 | if (rc < 0) return rc; |
78 | if (rc < 0) return rc; |
79 | 79 | ||
80 | brkp[0] = OPCODE_INT3; |
80 | brkp[0] = OPCODE_INT3; |
81 | rc = udebug_mem_write(app_phone, brkp, b->addr, 1); |
81 | rc = udebug_mem_write(app_phone, brkp, b->addr, 1); |
82 | if (rc < 0) return rc; |
82 | if (rc < 0) return rc; |
83 | 83 | ||
84 | cons_printf("udebug_mem_write() -> %d\n", rc); |
84 | cons_printf("udebug_mem_write() -> %d\n", rc); |
85 | return 0; |
85 | return 0; |
86 | } |
86 | } |
87 | 87 | ||
88 | int arch_breakpoint_remove(breakpoint_t *b) |
88 | int arch_breakpoint_remove(breakpoint_t *b) |
89 | { |
89 | { |
90 | int rc; |
90 | int rc; |
91 | 91 | ||
92 | if (b->active) { |
92 | if (b->active) { |
93 | active_bkpt = NULL; |
93 | active_bkpt = NULL; |
94 | } else { |
94 | } else { |
95 | rc = udebug_mem_write(app_phone, &b->arch.back, b->addr, 1); |
95 | rc = udebug_mem_write(app_phone, &b->arch.back, b->addr, 1); |
96 | if (rc < 0) { |
96 | if (rc < 0) { |
97 | cons_printf("error writing mem\n"); |
97 | cons_printf("error writing mem\n"); |
98 | return rc; |
98 | return rc; |
99 | } |
99 | } |
100 | } |
100 | } |
101 | 101 | ||
102 | return 0; |
102 | return 0; |
103 | } |
103 | } |
104 | 104 | ||
105 | void arch_event_breakpoint(thash_t thread_hash) |
105 | void arch_event_breakpoint(thash_t thread_hash) |
106 | { |
106 | { |
107 | static istate_t istate; |
107 | static istate_t istate; |
108 | breakpoint_t *b; |
108 | breakpoint_t *b; |
109 | int rc; |
109 | int rc; |
110 | 110 | ||
111 | rc = udebug_regs_read(app_phone, thread_hash, &istate); |
111 | rc = udebug_regs_read(app_phone, thread_hash, &istate); |
112 | // cons_printf("udebug_regs_read -> %d\n", rc); |
112 | // cons_printf("udebug_regs_read -> %d\n", rc); |
113 | // cons_printf("EIP was 0x%08x\n", istate.eip); |
113 | // cons_printf("EIP was 0x%08x\n", istate.eip); |
114 | int brk_addr = istate.eip - 1; |
114 | int brk_addr = istate.eip - 1; |
115 | 115 | ||
116 | b = breakpoint_find_by_addr(brk_addr); |
116 | b = breakpoint_find_by_addr(brk_addr); |
117 | if (!b) { |
117 | if (!b) { |
118 | cons_printf("unrecognized breakpoint at 0x%x\n", brk_addr); |
118 | cons_printf("unrecognized breakpoint at 0x%x\n", brk_addr); |
119 | return; |
119 | return; |
120 | } |
120 | } |
121 | 121 | ||
122 | istate.eip = brk_addr; |
122 | istate.eip = brk_addr; |
123 | istate.eflags |= 0x0100; /* trap flag */ |
123 | istate.eflags |= 0x0100; /* trap flag */ |
124 | 124 | ||
125 | rc = udebug_regs_write(app_phone, thread_hash, &istate); |
125 | rc = udebug_regs_write(app_phone, thread_hash, &istate); |
126 | if (rc < 0) { cons_printf("error writing regs\n"); return; } |
126 | if (rc < 0) { cons_printf("error writing regs\n"); return; } |
127 | rc = udebug_mem_write(app_phone, &b->arch.back, brk_addr, 1); |
127 | rc = udebug_mem_write(app_phone, &b->arch.back, brk_addr, 1); |
128 | if (rc < 0) { cons_printf("error writing mem\n"); return; } |
128 | if (rc < 0) { cons_printf("error writing mem\n"); return; } |
129 | // cons_printf("udebug_mem_write(phone, 0x%x, 0x%02x, 1) -> %d\n", brk_addr, brk_list[bi].arch.back, rc); |
129 | // cons_printf("udebug_mem_write(phone, 0x%x, 0x%02x, 1) -> %d\n", brk_addr, brk_list[bi].arch.back, rc); |
130 | 130 | ||
131 | b->active = true; |
131 | b->active = true; |
132 | active_bkpt = b; |
132 | active_bkpt = b; |
133 | 133 | ||
134 | breakpoint_hit(b); |
134 | breakpoint_hit(b); |
135 | } |
135 | } |
136 | 136 | ||
137 | void arch_event_trap(dthread_t *dt) |
137 | void arch_event_trap(dthread_t *dt) |
138 | { |
138 | { |
139 | breakpoint_t *b; |
139 | breakpoint_t *b; |
140 | static istate_t istate; |
140 | static istate_t istate; |
141 | unsigned char brkinstr[1]; |
141 | unsigned char brkinstr[1]; |
142 | int rc; |
142 | int rc; |
143 | 143 | ||
144 | // cons_printf("trap event\n"); |
144 | // cons_printf("trap event\n"); |
145 | b = active_bkpt; |
145 | b = active_bkpt; |
146 | 146 | ||
147 | if (b) { |
147 | if (b) { |
148 | brkinstr[0] = OPCODE_INT3; |
148 | brkinstr[0] = OPCODE_INT3; |
149 | rc = udebug_mem_write(app_phone, brkinstr, b->addr, 1); |
149 | rc = udebug_mem_write(app_phone, brkinstr, b->addr, 1); |
150 | // cons_printf("restore breakpoint -> %d\n", rc); |
150 | // cons_printf("restore breakpoint -> %d\n", rc); |
151 | active_bkpt = NULL; |
151 | active_bkpt = NULL; |
152 | } |
152 | } |
153 | 153 | ||
154 | rc = _set_trap_flag(dt, false); |
154 | rc = _set_trap_flag(dt, false); |
155 | dt->arch.singlestep = false; |
155 | dt->arch.singlestep = false; |
156 | 156 | ||
157 | singlestep_hit(); |
157 | singlestep_hit(); |
158 | } |
158 | } |
159 | 159 | ||
160 | void arch_dump_regs(thash_t thash) |
160 | void arch_dump_regs(thash_t thash) |
161 | { |
161 | { |
162 | static istate_t istate; |
162 | static istate_t istate; |
163 | int rc; |
163 | int rc; |
164 | 164 | ||
165 | rc = udebug_regs_read(app_phone, thash, &istate); |
165 | rc = udebug_regs_read(app_phone, thash, &istate); |
166 | if (rc < 0) { cons_printf("Error reading regs\n"); return; } |
166 | if (rc < 0) { cons_printf("Error reading regs\n"); return; } |
167 | 167 | ||
168 | cons_printf( |
168 | cons_printf( |
169 | "eip:%08x eflags:%08x eax:%08x ebx:%08x ecx:%08x edx:%08x\n" |
169 | "eip:%08x eflags:%08x eax:%08x ecx:%08x edx:%08x\n" |
170 | "esi:%08x edi:%08x cs:%04x ds:%04x es:%04x fs:%04x gs:%04x\n", |
170 | "cs:%04x ds:%04x es:%04x fs:%04x gs:%04x\n", |
171 | istate.eip, istate.eflags, istate.eax, istate.ebx, |
171 | istate.eip, istate.eflags, istate.eax, |
172 | istate.ecx, istate.edx, istate.esi, istate.edi, istate.cs, |
172 | istate.ecx, istate.edx, istate.cs, |
173 | istate.ds, istate.es, istate.fs, istate.gs); |
173 | istate.ds, istate.es, istate.fs, istate.gs); |
174 | } |
174 | } |
175 | 175 | ||
176 | void arch_singlestep(dthread_t *dt) |
176 | void arch_singlestep(dthread_t *dt) |
177 | { |
177 | { |
178 | int rc; |
178 | int rc; |
179 | 179 | ||
180 | rc = _set_trap_flag(dt, true); |
180 | rc = _set_trap_flag(dt, true); |
181 | if (rc != 0) return; |
181 | if (rc != 0) return; |
182 | 182 | ||
183 | dthread_resume(dt); |
183 | dthread_resume(dt); |
184 | } |
184 | } |
185 | 185 | ||
186 | /** @} |
186 | /** @} |
187 | */ |
187 | */ |
188 | 188 |