root / gdbstub.c @ ed23fbd9
History | View | Annotate | Download (40.3 kB)
1 | b4608c04 | bellard | /*
|
---|---|---|---|
2 | b4608c04 | bellard | * gdb server stub
|
3 | 5fafdf24 | ths | *
|
4 | 3475187d | bellard | * Copyright (c) 2003-2005 Fabrice Bellard
|
5 | b4608c04 | bellard | *
|
6 | b4608c04 | bellard | * This library is free software; you can redistribute it and/or
|
7 | b4608c04 | bellard | * modify it under the terms of the GNU Lesser General Public
|
8 | b4608c04 | bellard | * License as published by the Free Software Foundation; either
|
9 | b4608c04 | bellard | * version 2 of the License, or (at your option) any later version.
|
10 | b4608c04 | bellard | *
|
11 | b4608c04 | bellard | * This library is distributed in the hope that it will be useful,
|
12 | b4608c04 | bellard | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
13 | b4608c04 | bellard | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
14 | b4608c04 | bellard | * Lesser General Public License for more details.
|
15 | b4608c04 | bellard | *
|
16 | b4608c04 | bellard | * You should have received a copy of the GNU Lesser General Public
|
17 | b4608c04 | bellard | * License along with this library; if not, write to the Free Software
|
18 | b4608c04 | bellard | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
19 | b4608c04 | bellard | */
|
20 | 978efd6a | pbrook | #include "config.h" |
21 | 1fddef4b | bellard | #ifdef CONFIG_USER_ONLY
|
22 | 1fddef4b | bellard | #include <stdlib.h> |
23 | 1fddef4b | bellard | #include <stdio.h> |
24 | 1fddef4b | bellard | #include <stdarg.h> |
25 | 1fddef4b | bellard | #include <string.h> |
26 | 1fddef4b | bellard | #include <errno.h> |
27 | 1fddef4b | bellard | #include <unistd.h> |
28 | 978efd6a | pbrook | #include <fcntl.h> |
29 | 1fddef4b | bellard | |
30 | 1fddef4b | bellard | #include "qemu.h" |
31 | 1fddef4b | bellard | #else
|
32 | 87ecb68b | pbrook | #include "qemu-common.h" |
33 | 87ecb68b | pbrook | #include "qemu-char.h" |
34 | 87ecb68b | pbrook | #include "sysemu.h" |
35 | 87ecb68b | pbrook | #include "gdbstub.h" |
36 | 1fddef4b | bellard | #endif
|
37 | 67b915a5 | bellard | |
38 | 8f447cc7 | bellard | #include "qemu_socket.h" |
39 | 8f447cc7 | bellard | #ifdef _WIN32
|
40 | 8f447cc7 | bellard | /* XXX: these constants may be independent of the host ones even for Unix */
|
41 | 8f447cc7 | bellard | #ifndef SIGTRAP
|
42 | 8f447cc7 | bellard | #define SIGTRAP 5 |
43 | 8f447cc7 | bellard | #endif
|
44 | 8f447cc7 | bellard | #ifndef SIGINT
|
45 | 8f447cc7 | bellard | #define SIGINT 2 |
46 | 8f447cc7 | bellard | #endif
|
47 | 8f447cc7 | bellard | #else
|
48 | b4608c04 | bellard | #include <signal.h> |
49 | 8f447cc7 | bellard | #endif
|
50 | b4608c04 | bellard | |
51 | 4abe615b | bellard | //#define DEBUG_GDB
|
52 | b4608c04 | bellard | |
53 | 858693c6 | bellard | enum RSState {
|
54 | 858693c6 | bellard | RS_IDLE, |
55 | 858693c6 | bellard | RS_GETLINE, |
56 | 858693c6 | bellard | RS_CHKSUM1, |
57 | 858693c6 | bellard | RS_CHKSUM2, |
58 | a2d1ebaf | pbrook | RS_SYSCALL, |
59 | 858693c6 | bellard | }; |
60 | 858693c6 | bellard | typedef struct GDBState { |
61 | 6a00d601 | bellard | CPUState *env; /* current CPU */
|
62 | 41625033 | bellard | enum RSState state; /* parsing state */ |
63 | 858693c6 | bellard | char line_buf[4096]; |
64 | 858693c6 | bellard | int line_buf_index;
|
65 | 858693c6 | bellard | int line_csum;
|
66 | 60fe76f3 | ths | uint8_t last_packet[4100];
|
67 | 4046d913 | pbrook | int last_packet_len;
|
68 | 1f487ee9 | edgar_igl | int signal;
|
69 | 41625033 | bellard | #ifdef CONFIG_USER_ONLY
|
70 | 4046d913 | pbrook | int fd;
|
71 | 41625033 | bellard | int running_state;
|
72 | 4046d913 | pbrook | #else
|
73 | 4046d913 | pbrook | CharDriverState *chr; |
74 | 41625033 | bellard | #endif
|
75 | 858693c6 | bellard | } GDBState; |
76 | b4608c04 | bellard | |
77 | 60897d36 | edgar_igl | /* By default use no IRQs and no timers while single stepping so as to
|
78 | 60897d36 | edgar_igl | * make single stepping like an ICE HW step.
|
79 | 60897d36 | edgar_igl | */
|
80 | 60897d36 | edgar_igl | static int sstep_flags = SSTEP_ENABLE|SSTEP_NOIRQ|SSTEP_NOTIMER; |
81 | 60897d36 | edgar_igl | |
82 | 1fddef4b | bellard | #ifdef CONFIG_USER_ONLY
|
83 | 4046d913 | pbrook | /* XXX: This is not thread safe. Do we care? */
|
84 | 4046d913 | pbrook | static int gdbserver_fd = -1; |
85 | 4046d913 | pbrook | |
86 | 1fddef4b | bellard | /* XXX: remove this hack. */
|
87 | 1fddef4b | bellard | static GDBState gdbserver_state;
|
88 | 1fddef4b | bellard | |
89 | 858693c6 | bellard | static int get_char(GDBState *s) |
90 | b4608c04 | bellard | { |
91 | b4608c04 | bellard | uint8_t ch; |
92 | b4608c04 | bellard | int ret;
|
93 | b4608c04 | bellard | |
94 | b4608c04 | bellard | for(;;) {
|
95 | 8f447cc7 | bellard | ret = recv(s->fd, &ch, 1, 0); |
96 | b4608c04 | bellard | if (ret < 0) { |
97 | 1f487ee9 | edgar_igl | if (errno == ECONNRESET)
|
98 | 1f487ee9 | edgar_igl | s->fd = -1;
|
99 | b4608c04 | bellard | if (errno != EINTR && errno != EAGAIN)
|
100 | b4608c04 | bellard | return -1; |
101 | b4608c04 | bellard | } else if (ret == 0) { |
102 | 1f487ee9 | edgar_igl | close(s->fd); |
103 | 1f487ee9 | edgar_igl | s->fd = -1;
|
104 | b4608c04 | bellard | return -1; |
105 | b4608c04 | bellard | } else {
|
106 | b4608c04 | bellard | break;
|
107 | b4608c04 | bellard | } |
108 | b4608c04 | bellard | } |
109 | b4608c04 | bellard | return ch;
|
110 | b4608c04 | bellard | } |
111 | 4046d913 | pbrook | #endif
|
112 | b4608c04 | bellard | |
113 | a2d1ebaf | pbrook | /* GDB stub state for use by semihosting syscalls. */
|
114 | a2d1ebaf | pbrook | static GDBState *gdb_syscall_state;
|
115 | a2d1ebaf | pbrook | static gdb_syscall_complete_cb gdb_current_syscall_cb;
|
116 | a2d1ebaf | pbrook | |
117 | a2d1ebaf | pbrook | enum {
|
118 | a2d1ebaf | pbrook | GDB_SYS_UNKNOWN, |
119 | a2d1ebaf | pbrook | GDB_SYS_ENABLED, |
120 | a2d1ebaf | pbrook | GDB_SYS_DISABLED, |
121 | a2d1ebaf | pbrook | } gdb_syscall_mode; |
122 | a2d1ebaf | pbrook | |
123 | a2d1ebaf | pbrook | /* If gdb is connected when the first semihosting syscall occurs then use
|
124 | a2d1ebaf | pbrook | remote gdb syscalls. Otherwise use native file IO. */
|
125 | a2d1ebaf | pbrook | int use_gdb_syscalls(void) |
126 | a2d1ebaf | pbrook | { |
127 | a2d1ebaf | pbrook | if (gdb_syscall_mode == GDB_SYS_UNKNOWN) {
|
128 | a2d1ebaf | pbrook | gdb_syscall_mode = (gdb_syscall_state ? GDB_SYS_ENABLED |
129 | a2d1ebaf | pbrook | : GDB_SYS_DISABLED); |
130 | a2d1ebaf | pbrook | } |
131 | a2d1ebaf | pbrook | return gdb_syscall_mode == GDB_SYS_ENABLED;
|
132 | a2d1ebaf | pbrook | } |
133 | a2d1ebaf | pbrook | |
134 | ba70a624 | edgar_igl | /* Resume execution. */
|
135 | ba70a624 | edgar_igl | static inline void gdb_continue(GDBState *s) |
136 | ba70a624 | edgar_igl | { |
137 | ba70a624 | edgar_igl | #ifdef CONFIG_USER_ONLY
|
138 | ba70a624 | edgar_igl | s->running_state = 1;
|
139 | ba70a624 | edgar_igl | #else
|
140 | ba70a624 | edgar_igl | vm_start(); |
141 | ba70a624 | edgar_igl | #endif
|
142 | ba70a624 | edgar_igl | } |
143 | ba70a624 | edgar_igl | |
144 | 858693c6 | bellard | static void put_buffer(GDBState *s, const uint8_t *buf, int len) |
145 | b4608c04 | bellard | { |
146 | 4046d913 | pbrook | #ifdef CONFIG_USER_ONLY
|
147 | b4608c04 | bellard | int ret;
|
148 | b4608c04 | bellard | |
149 | b4608c04 | bellard | while (len > 0) { |
150 | 8f447cc7 | bellard | ret = send(s->fd, buf, len, 0);
|
151 | b4608c04 | bellard | if (ret < 0) { |
152 | b4608c04 | bellard | if (errno != EINTR && errno != EAGAIN)
|
153 | b4608c04 | bellard | return;
|
154 | b4608c04 | bellard | } else {
|
155 | b4608c04 | bellard | buf += ret; |
156 | b4608c04 | bellard | len -= ret; |
157 | b4608c04 | bellard | } |
158 | b4608c04 | bellard | } |
159 | 4046d913 | pbrook | #else
|
160 | 4046d913 | pbrook | qemu_chr_write(s->chr, buf, len); |
161 | 4046d913 | pbrook | #endif
|
162 | b4608c04 | bellard | } |
163 | b4608c04 | bellard | |
164 | b4608c04 | bellard | static inline int fromhex(int v) |
165 | b4608c04 | bellard | { |
166 | b4608c04 | bellard | if (v >= '0' && v <= '9') |
167 | b4608c04 | bellard | return v - '0'; |
168 | b4608c04 | bellard | else if (v >= 'A' && v <= 'F') |
169 | b4608c04 | bellard | return v - 'A' + 10; |
170 | b4608c04 | bellard | else if (v >= 'a' && v <= 'f') |
171 | b4608c04 | bellard | return v - 'a' + 10; |
172 | b4608c04 | bellard | else
|
173 | b4608c04 | bellard | return 0; |
174 | b4608c04 | bellard | } |
175 | b4608c04 | bellard | |
176 | b4608c04 | bellard | static inline int tohex(int v) |
177 | b4608c04 | bellard | { |
178 | b4608c04 | bellard | if (v < 10) |
179 | b4608c04 | bellard | return v + '0'; |
180 | b4608c04 | bellard | else
|
181 | b4608c04 | bellard | return v - 10 + 'a'; |
182 | b4608c04 | bellard | } |
183 | b4608c04 | bellard | |
184 | b4608c04 | bellard | static void memtohex(char *buf, const uint8_t *mem, int len) |
185 | b4608c04 | bellard | { |
186 | b4608c04 | bellard | int i, c;
|
187 | b4608c04 | bellard | char *q;
|
188 | b4608c04 | bellard | q = buf; |
189 | b4608c04 | bellard | for(i = 0; i < len; i++) { |
190 | b4608c04 | bellard | c = mem[i]; |
191 | b4608c04 | bellard | *q++ = tohex(c >> 4);
|
192 | b4608c04 | bellard | *q++ = tohex(c & 0xf);
|
193 | b4608c04 | bellard | } |
194 | b4608c04 | bellard | *q = '\0';
|
195 | b4608c04 | bellard | } |
196 | b4608c04 | bellard | |
197 | b4608c04 | bellard | static void hextomem(uint8_t *mem, const char *buf, int len) |
198 | b4608c04 | bellard | { |
199 | b4608c04 | bellard | int i;
|
200 | b4608c04 | bellard | |
201 | b4608c04 | bellard | for(i = 0; i < len; i++) { |
202 | b4608c04 | bellard | mem[i] = (fromhex(buf[0]) << 4) | fromhex(buf[1]); |
203 | b4608c04 | bellard | buf += 2;
|
204 | b4608c04 | bellard | } |
205 | b4608c04 | bellard | } |
206 | b4608c04 | bellard | |
207 | b4608c04 | bellard | /* return -1 if error, 0 if OK */
|
208 | 858693c6 | bellard | static int put_packet(GDBState *s, char *buf) |
209 | b4608c04 | bellard | { |
210 | 4046d913 | pbrook | int len, csum, i;
|
211 | 60fe76f3 | ths | uint8_t *p; |
212 | b4608c04 | bellard | |
213 | b4608c04 | bellard | #ifdef DEBUG_GDB
|
214 | b4608c04 | bellard | printf("reply='%s'\n", buf);
|
215 | b4608c04 | bellard | #endif
|
216 | b4608c04 | bellard | |
217 | b4608c04 | bellard | for(;;) {
|
218 | 4046d913 | pbrook | p = s->last_packet; |
219 | 4046d913 | pbrook | *(p++) = '$';
|
220 | b4608c04 | bellard | len = strlen(buf); |
221 | 4046d913 | pbrook | memcpy(p, buf, len); |
222 | 4046d913 | pbrook | p += len; |
223 | b4608c04 | bellard | csum = 0;
|
224 | b4608c04 | bellard | for(i = 0; i < len; i++) { |
225 | b4608c04 | bellard | csum += buf[i]; |
226 | b4608c04 | bellard | } |
227 | 4046d913 | pbrook | *(p++) = '#';
|
228 | 4046d913 | pbrook | *(p++) = tohex((csum >> 4) & 0xf); |
229 | 4046d913 | pbrook | *(p++) = tohex((csum) & 0xf);
|
230 | b4608c04 | bellard | |
231 | 4046d913 | pbrook | s->last_packet_len = p - s->last_packet; |
232 | ffe8ab83 | ths | put_buffer(s, (uint8_t *)s->last_packet, s->last_packet_len); |
233 | b4608c04 | bellard | |
234 | 4046d913 | pbrook | #ifdef CONFIG_USER_ONLY
|
235 | 4046d913 | pbrook | i = get_char(s); |
236 | 4046d913 | pbrook | if (i < 0) |
237 | b4608c04 | bellard | return -1; |
238 | 4046d913 | pbrook | if (i == '+') |
239 | b4608c04 | bellard | break;
|
240 | 4046d913 | pbrook | #else
|
241 | 4046d913 | pbrook | break;
|
242 | 4046d913 | pbrook | #endif
|
243 | b4608c04 | bellard | } |
244 | b4608c04 | bellard | return 0; |
245 | b4608c04 | bellard | } |
246 | b4608c04 | bellard | |
247 | fde3fd61 | edgar_igl | #if defined(TARGET_I386)
|
248 | 79808573 | bellard | |
249 | 79808573 | bellard | #ifdef TARGET_X86_64
|
250 | 79808573 | bellard | static const uint8_t gdb_x86_64_regs[16] = { |
251 | 79808573 | bellard | R_EAX, R_EBX, R_ECX, R_EDX, R_ESI, R_EDI, R_EBP, R_ESP, |
252 | 79808573 | bellard | 8, 9, 10, 11, 12, 13, 14, 15, |
253 | 79808573 | bellard | }; |
254 | 79808573 | bellard | #endif
|
255 | 79808573 | bellard | |
256 | 6da41eaf | bellard | static int cpu_gdb_read_registers(CPUState *env, uint8_t *mem_buf) |
257 | 6da41eaf | bellard | { |
258 | 79808573 | bellard | int i, fpus, nb_regs;
|
259 | 79808573 | bellard | uint8_t *p; |
260 | 5ad265ee | balrog | |
261 | 79808573 | bellard | p = mem_buf; |
262 | 5ad265ee | balrog | #ifdef TARGET_X86_64
|
263 | 5ad265ee | balrog | if (env->hflags & HF_CS64_MASK) {
|
264 | 79808573 | bellard | nb_regs = 16;
|
265 | 79808573 | bellard | for(i = 0; i < 16; i++) { |
266 | 79808573 | bellard | *(uint64_t *)p = tswap64(env->regs[gdb_x86_64_regs[i]]); |
267 | 79808573 | bellard | p += 8;
|
268 | 5ad265ee | balrog | } |
269 | 79808573 | bellard | *(uint64_t *)p = tswap64(env->eip); |
270 | 79808573 | bellard | p += 8;
|
271 | 79808573 | bellard | } else
|
272 | 79808573 | bellard | #endif
|
273 | 79808573 | bellard | { |
274 | 79808573 | bellard | nb_regs = 8;
|
275 | 5ad265ee | balrog | for(i = 0; i < 8; i++) { |
276 | 79808573 | bellard | *(uint32_t *)p = tswap32(env->regs[i]); |
277 | 79808573 | bellard | p += 4;
|
278 | 5ad265ee | balrog | } |
279 | 79808573 | bellard | *(uint32_t *)p = tswap32(env->eip); |
280 | 79808573 | bellard | p += 4;
|
281 | 5ad265ee | balrog | } |
282 | 6da41eaf | bellard | |
283 | 79808573 | bellard | *(uint32_t *)p = tswap32(env->eflags); |
284 | 79808573 | bellard | p += 4;
|
285 | 79808573 | bellard | *(uint32_t *)p = tswap32(env->segs[R_CS].selector); |
286 | 79808573 | bellard | p += 4;
|
287 | 79808573 | bellard | *(uint32_t *)p = tswap32(env->segs[R_SS].selector); |
288 | 79808573 | bellard | p += 4;
|
289 | 79808573 | bellard | *(uint32_t *)p = tswap32(env->segs[R_DS].selector); |
290 | 79808573 | bellard | p += 4;
|
291 | 79808573 | bellard | *(uint32_t *)p = tswap32(env->segs[R_ES].selector); |
292 | 79808573 | bellard | p += 4;
|
293 | 79808573 | bellard | *(uint32_t *)p = tswap32(env->segs[R_FS].selector); |
294 | 79808573 | bellard | p += 4;
|
295 | 79808573 | bellard | *(uint32_t *)p = tswap32(env->segs[R_GS].selector); |
296 | 79808573 | bellard | p += 4;
|
297 | 6da41eaf | bellard | for(i = 0; i < 8; i++) { |
298 | 79808573 | bellard | /* XXX: convert floats */
|
299 | 79808573 | bellard | #ifdef USE_X86LDOUBLE
|
300 | 79808573 | bellard | memcpy(p, &env->fpregs[i], 10);
|
301 | 79808573 | bellard | #else
|
302 | 79808573 | bellard | memset(p, 0, 10); |
303 | 79808573 | bellard | #endif
|
304 | 79808573 | bellard | p += 10;
|
305 | 6da41eaf | bellard | } |
306 | 79808573 | bellard | *(uint32_t *)p = tswap32(env->fpuc); /* fctrl */
|
307 | 79808573 | bellard | p += 4;
|
308 | 6da41eaf | bellard | fpus = (env->fpus & ~0x3800) | (env->fpstt & 0x7) << 11; |
309 | 79808573 | bellard | *(uint32_t *)p = tswap32(fpus); /* fstat */
|
310 | 79808573 | bellard | p += 4;
|
311 | 79808573 | bellard | *(uint32_t *)p = 0; /* ftag */ |
312 | 79808573 | bellard | p += 4;
|
313 | 79808573 | bellard | *(uint32_t *)p = 0; /* fiseg */ |
314 | 79808573 | bellard | p += 4;
|
315 | 79808573 | bellard | *(uint32_t *)p = 0; /* fioff */ |
316 | 79808573 | bellard | p += 4;
|
317 | 79808573 | bellard | *(uint32_t *)p = 0; /* foseg */ |
318 | 79808573 | bellard | p += 4;
|
319 | 79808573 | bellard | *(uint32_t *)p = 0; /* fooff */ |
320 | 79808573 | bellard | p += 4;
|
321 | 79808573 | bellard | *(uint32_t *)p = 0; /* fop */ |
322 | 79808573 | bellard | p += 4;
|
323 | 79808573 | bellard | for(i = 0; i < nb_regs; i++) { |
324 | 79808573 | bellard | *(uint64_t *)p = tswap64(env->xmm_regs[i].XMM_Q(0));
|
325 | 79808573 | bellard | p += 8;
|
326 | 79808573 | bellard | *(uint64_t *)p = tswap64(env->xmm_regs[i].XMM_Q(1));
|
327 | 79808573 | bellard | p += 8;
|
328 | 79808573 | bellard | } |
329 | 79808573 | bellard | *(uint32_t *)p = tswap32(env->mxcsr); |
330 | 79808573 | bellard | p += 4;
|
331 | 79808573 | bellard | return p - mem_buf;
|
332 | 79808573 | bellard | } |
333 | 79808573 | bellard | |
334 | 79808573 | bellard | static inline void cpu_gdb_load_seg(CPUState *env, const uint8_t **pp, |
335 | 79808573 | bellard | int sreg)
|
336 | 79808573 | bellard | { |
337 | 79808573 | bellard | const uint8_t *p;
|
338 | 79808573 | bellard | uint32_t sel; |
339 | 79808573 | bellard | p = *pp; |
340 | 79808573 | bellard | sel = tswap32(*(uint32_t *)p); |
341 | 79808573 | bellard | p += 4;
|
342 | 79808573 | bellard | if (sel != env->segs[sreg].selector) {
|
343 | 79808573 | bellard | #if defined(CONFIG_USER_ONLY)
|
344 | 79808573 | bellard | cpu_x86_load_seg(env, sreg, sel); |
345 | 79808573 | bellard | #else
|
346 | 79808573 | bellard | /* XXX: do it with a debug function which does not raise an
|
347 | 79808573 | bellard | exception */
|
348 | 79808573 | bellard | #endif
|
349 | 79808573 | bellard | } |
350 | 79808573 | bellard | *pp = p; |
351 | 6da41eaf | bellard | } |
352 | 6da41eaf | bellard | |
353 | 6da41eaf | bellard | static void cpu_gdb_write_registers(CPUState *env, uint8_t *mem_buf, int size) |
354 | 6da41eaf | bellard | { |
355 | 79808573 | bellard | const uint8_t *p = mem_buf;
|
356 | 79808573 | bellard | int i, nb_regs;
|
357 | 79808573 | bellard | uint16_t fpus; |
358 | 6da41eaf | bellard | |
359 | 79808573 | bellard | #ifdef TARGET_X86_64
|
360 | 79808573 | bellard | if (env->hflags & HF_CS64_MASK) {
|
361 | 79808573 | bellard | nb_regs = 16;
|
362 | 79808573 | bellard | for(i = 0; i < 16; i++) { |
363 | 79808573 | bellard | env->regs[gdb_x86_64_regs[i]] = tswap64(*(uint64_t *)p); |
364 | 79808573 | bellard | p += 8;
|
365 | 79808573 | bellard | } |
366 | 79808573 | bellard | env->eip = tswap64(*(uint64_t *)p); |
367 | 79808573 | bellard | p += 8;
|
368 | 79808573 | bellard | } else
|
369 | 79808573 | bellard | #endif
|
370 | 79808573 | bellard | { |
371 | 79808573 | bellard | nb_regs = 8;
|
372 | 79808573 | bellard | for(i = 0; i < 8; i++) { |
373 | 79808573 | bellard | env->regs[i] = tswap32(*(uint32_t *)p); |
374 | 79808573 | bellard | p += 4;
|
375 | 79808573 | bellard | } |
376 | 79808573 | bellard | env->eip = tswap32(*(uint32_t *)p); |
377 | 79808573 | bellard | p += 4;
|
378 | 6da41eaf | bellard | } |
379 | 79808573 | bellard | env->eflags = tswap32(*(uint32_t *)p); |
380 | 79808573 | bellard | p += 4;
|
381 | 79808573 | bellard | cpu_gdb_load_seg(env, &p, R_CS); |
382 | 79808573 | bellard | cpu_gdb_load_seg(env, &p, R_SS); |
383 | 79808573 | bellard | cpu_gdb_load_seg(env, &p, R_DS); |
384 | 79808573 | bellard | cpu_gdb_load_seg(env, &p, R_ES); |
385 | 79808573 | bellard | cpu_gdb_load_seg(env, &p, R_FS); |
386 | 79808573 | bellard | cpu_gdb_load_seg(env, &p, R_GS); |
387 | 79808573 | bellard | |
388 | 79808573 | bellard | /* FPU state */
|
389 | 79808573 | bellard | for(i = 0; i < 8; i++) { |
390 | 79808573 | bellard | /* XXX: convert floats */
|
391 | 79808573 | bellard | #ifdef USE_X86LDOUBLE
|
392 | 79808573 | bellard | memcpy(&env->fpregs[i], p, 10);
|
393 | 6da41eaf | bellard | #endif
|
394 | 79808573 | bellard | p += 10;
|
395 | 79808573 | bellard | } |
396 | 79808573 | bellard | env->fpuc = tswap32(*(uint32_t *)p); /* fctrl */
|
397 | 79808573 | bellard | p += 4;
|
398 | 79808573 | bellard | fpus = tswap32(*(uint32_t *)p); |
399 | 79808573 | bellard | p += 4;
|
400 | 79808573 | bellard | env->fpstt = (fpus >> 11) & 7; |
401 | 79808573 | bellard | env->fpus = fpus & ~0x3800;
|
402 | 79808573 | bellard | p += 4 * 6; |
403 | 79808573 | bellard | |
404 | 79808573 | bellard | if (size >= ((p - mem_buf) + 16 * nb_regs + 4)) { |
405 | 79808573 | bellard | /* SSE state */
|
406 | 79808573 | bellard | for(i = 0; i < nb_regs; i++) { |
407 | 79808573 | bellard | env->xmm_regs[i].XMM_Q(0) = tswap64(*(uint64_t *)p);
|
408 | 79808573 | bellard | p += 8;
|
409 | 79808573 | bellard | env->xmm_regs[i].XMM_Q(1) = tswap64(*(uint64_t *)p);
|
410 | 79808573 | bellard | p += 8;
|
411 | 79808573 | bellard | } |
412 | 79808573 | bellard | env->mxcsr = tswap32(*(uint32_t *)p); |
413 | 79808573 | bellard | p += 4;
|
414 | 79808573 | bellard | } |
415 | 6da41eaf | bellard | } |
416 | 6da41eaf | bellard | |
417 | 9e62fd7f | bellard | #elif defined (TARGET_PPC)
|
418 | 9e62fd7f | bellard | static int cpu_gdb_read_registers(CPUState *env, uint8_t *mem_buf) |
419 | 9e62fd7f | bellard | { |
420 | a541f297 | bellard | uint32_t *registers = (uint32_t *)mem_buf, tmp; |
421 | 9e62fd7f | bellard | int i;
|
422 | 9e62fd7f | bellard | |
423 | 9e62fd7f | bellard | /* fill in gprs */
|
424 | a541f297 | bellard | for(i = 0; i < 32; i++) { |
425 | e95c8d51 | bellard | registers[i] = tswapl(env->gpr[i]); |
426 | 9e62fd7f | bellard | } |
427 | 9e62fd7f | bellard | /* fill in fprs */
|
428 | 9e62fd7f | bellard | for (i = 0; i < 32; i++) { |
429 | e95c8d51 | bellard | registers[(i * 2) + 32] = tswapl(*((uint32_t *)&env->fpr[i])); |
430 | e95c8d51 | bellard | registers[(i * 2) + 33] = tswapl(*((uint32_t *)&env->fpr[i] + 1)); |
431 | 9e62fd7f | bellard | } |
432 | 9e62fd7f | bellard | /* nip, msr, ccr, lnk, ctr, xer, mq */
|
433 | e95c8d51 | bellard | registers[96] = tswapl(env->nip);
|
434 | 0411a972 | j_mayer | registers[97] = tswapl(env->msr);
|
435 | 9e62fd7f | bellard | tmp = 0;
|
436 | 9e62fd7f | bellard | for (i = 0; i < 8; i++) |
437 | a541f297 | bellard | tmp |= env->crf[i] << (32 - ((i + 1) * 4)); |
438 | e95c8d51 | bellard | registers[98] = tswapl(tmp);
|
439 | e95c8d51 | bellard | registers[99] = tswapl(env->lr);
|
440 | e95c8d51 | bellard | registers[100] = tswapl(env->ctr);
|
441 | 76a66253 | j_mayer | registers[101] = tswapl(ppc_load_xer(env));
|
442 | e95c8d51 | bellard | registers[102] = 0; |
443 | a541f297 | bellard | |
444 | a541f297 | bellard | return 103 * 4; |
445 | 9e62fd7f | bellard | } |
446 | 9e62fd7f | bellard | |
447 | 9e62fd7f | bellard | static void cpu_gdb_write_registers(CPUState *env, uint8_t *mem_buf, int size) |
448 | 9e62fd7f | bellard | { |
449 | 9e62fd7f | bellard | uint32_t *registers = (uint32_t *)mem_buf; |
450 | 9e62fd7f | bellard | int i;
|
451 | 9e62fd7f | bellard | |
452 | 9e62fd7f | bellard | /* fill in gprs */
|
453 | 9e62fd7f | bellard | for (i = 0; i < 32; i++) { |
454 | e95c8d51 | bellard | env->gpr[i] = tswapl(registers[i]); |
455 | 9e62fd7f | bellard | } |
456 | 9e62fd7f | bellard | /* fill in fprs */
|
457 | 9e62fd7f | bellard | for (i = 0; i < 32; i++) { |
458 | e95c8d51 | bellard | *((uint32_t *)&env->fpr[i]) = tswapl(registers[(i * 2) + 32]); |
459 | e95c8d51 | bellard | *((uint32_t *)&env->fpr[i] + 1) = tswapl(registers[(i * 2) + 33]); |
460 | 9e62fd7f | bellard | } |
461 | 9e62fd7f | bellard | /* nip, msr, ccr, lnk, ctr, xer, mq */
|
462 | e95c8d51 | bellard | env->nip = tswapl(registers[96]);
|
463 | 0411a972 | j_mayer | ppc_store_msr(env, tswapl(registers[97]));
|
464 | e95c8d51 | bellard | registers[98] = tswapl(registers[98]); |
465 | 9e62fd7f | bellard | for (i = 0; i < 8; i++) |
466 | a541f297 | bellard | env->crf[i] = (registers[98] >> (32 - ((i + 1) * 4))) & 0xF; |
467 | e95c8d51 | bellard | env->lr = tswapl(registers[99]);
|
468 | e95c8d51 | bellard | env->ctr = tswapl(registers[100]);
|
469 | 76a66253 | j_mayer | ppc_store_xer(env, tswapl(registers[101]));
|
470 | e95c8d51 | bellard | } |
471 | e95c8d51 | bellard | #elif defined (TARGET_SPARC)
|
472 | 96d19126 | blueswir1 | #ifdef TARGET_ABI32
|
473 | 96d19126 | blueswir1 | #define tswap_abi(val) tswap32(val &0xffffffff) |
474 | 96d19126 | blueswir1 | #else
|
475 | 96d19126 | blueswir1 | #define tswap_abi(val) tswapl(val)
|
476 | 96d19126 | blueswir1 | #endif
|
477 | e95c8d51 | bellard | static int cpu_gdb_read_registers(CPUState *env, uint8_t *mem_buf) |
478 | e95c8d51 | bellard | { |
479 | 96d19126 | blueswir1 | #ifdef TARGET_ABI32
|
480 | 96d19126 | blueswir1 | abi_ulong *registers = (abi_ulong *)mem_buf; |
481 | 96d19126 | blueswir1 | #else
|
482 | 3475187d | bellard | target_ulong *registers = (target_ulong *)mem_buf; |
483 | 96d19126 | blueswir1 | #endif
|
484 | e95c8d51 | bellard | int i;
|
485 | e95c8d51 | bellard | |
486 | e95c8d51 | bellard | /* fill in g0..g7 */
|
487 | 48b2c193 | bellard | for(i = 0; i < 8; i++) { |
488 | 96d19126 | blueswir1 | registers[i] = tswap_abi(env->gregs[i]); |
489 | e95c8d51 | bellard | } |
490 | e95c8d51 | bellard | /* fill in register window */
|
491 | e95c8d51 | bellard | for(i = 0; i < 24; i++) { |
492 | 96d19126 | blueswir1 | registers[i + 8] = tswap_abi(env->regwptr[i]);
|
493 | e95c8d51 | bellard | } |
494 | 96d19126 | blueswir1 | #if !defined(TARGET_SPARC64) || defined(TARGET_ABI32)
|
495 | e95c8d51 | bellard | /* fill in fprs */
|
496 | e95c8d51 | bellard | for (i = 0; i < 32; i++) { |
497 | 96d19126 | blueswir1 | registers[i + 32] = tswap_abi(*((uint32_t *)&env->fpr[i]));
|
498 | e95c8d51 | bellard | } |
499 | e95c8d51 | bellard | /* Y, PSR, WIM, TBR, PC, NPC, FPSR, CPSR */
|
500 | 96d19126 | blueswir1 | registers[64] = tswap_abi(env->y);
|
501 | 3475187d | bellard | { |
502 | 96d19126 | blueswir1 | uint32_t tmp; |
503 | 3475187d | bellard | |
504 | 96d19126 | blueswir1 | tmp = GET_PSR(env); |
505 | 96d19126 | blueswir1 | registers[65] = tswap32(tmp);
|
506 | 3475187d | bellard | } |
507 | 96d19126 | blueswir1 | registers[66] = tswap_abi(env->wim);
|
508 | 96d19126 | blueswir1 | registers[67] = tswap_abi(env->tbr);
|
509 | 96d19126 | blueswir1 | registers[68] = tswap_abi(env->pc);
|
510 | 96d19126 | blueswir1 | registers[69] = tswap_abi(env->npc);
|
511 | 96d19126 | blueswir1 | registers[70] = tswap_abi(env->fsr);
|
512 | e95c8d51 | bellard | registers[71] = 0; /* csr */ |
513 | e95c8d51 | bellard | registers[72] = 0; |
514 | 96d19126 | blueswir1 | return 73 * sizeof(uint32_t); |
515 | 3475187d | bellard | #else
|
516 | 9d9754a3 | bellard | /* fill in fprs */
|
517 | 9d9754a3 | bellard | for (i = 0; i < 64; i += 2) { |
518 | 9d9754a3 | bellard | uint64_t tmp; |
519 | 9d9754a3 | bellard | |
520 | 8979596d | blueswir1 | tmp = ((uint64_t)*(uint32_t *)&env->fpr[i]) << 32;
|
521 | 8979596d | blueswir1 | tmp |= *(uint32_t *)&env->fpr[i + 1];
|
522 | 8979596d | blueswir1 | registers[i / 2 + 32] = tswap64(tmp); |
523 | 3475187d | bellard | } |
524 | 9d9754a3 | bellard | registers[64] = tswapl(env->pc);
|
525 | 9d9754a3 | bellard | registers[65] = tswapl(env->npc);
|
526 | 17d996e1 | blueswir1 | registers[66] = tswapl(((uint64_t)GET_CCR(env) << 32) | |
527 | 17d996e1 | blueswir1 | ((env->asi & 0xff) << 24) | |
528 | 17d996e1 | blueswir1 | ((env->pstate & 0xfff) << 8) | |
529 | 17d996e1 | blueswir1 | GET_CWP64(env)); |
530 | 9d9754a3 | bellard | registers[67] = tswapl(env->fsr);
|
531 | 9d9754a3 | bellard | registers[68] = tswapl(env->fprs);
|
532 | 9d9754a3 | bellard | registers[69] = tswapl(env->y);
|
533 | 9d9754a3 | bellard | return 70 * sizeof(target_ulong); |
534 | 3475187d | bellard | #endif
|
535 | e95c8d51 | bellard | } |
536 | e95c8d51 | bellard | |
537 | e95c8d51 | bellard | static void cpu_gdb_write_registers(CPUState *env, uint8_t *mem_buf, int size) |
538 | e95c8d51 | bellard | { |
539 | 96d19126 | blueswir1 | #ifdef TARGET_ABI32
|
540 | 96d19126 | blueswir1 | abi_ulong *registers = (abi_ulong *)mem_buf; |
541 | 96d19126 | blueswir1 | #else
|
542 | 3475187d | bellard | target_ulong *registers = (target_ulong *)mem_buf; |
543 | 96d19126 | blueswir1 | #endif
|
544 | e95c8d51 | bellard | int i;
|
545 | e95c8d51 | bellard | |
546 | e95c8d51 | bellard | /* fill in g0..g7 */
|
547 | e95c8d51 | bellard | for(i = 0; i < 7; i++) { |
548 | 96d19126 | blueswir1 | env->gregs[i] = tswap_abi(registers[i]); |
549 | e95c8d51 | bellard | } |
550 | e95c8d51 | bellard | /* fill in register window */
|
551 | e95c8d51 | bellard | for(i = 0; i < 24; i++) { |
552 | 96d19126 | blueswir1 | env->regwptr[i] = tswap_abi(registers[i + 8]);
|
553 | e95c8d51 | bellard | } |
554 | 96d19126 | blueswir1 | #if !defined(TARGET_SPARC64) || defined(TARGET_ABI32)
|
555 | e95c8d51 | bellard | /* fill in fprs */
|
556 | e95c8d51 | bellard | for (i = 0; i < 32; i++) { |
557 | 96d19126 | blueswir1 | *((uint32_t *)&env->fpr[i]) = tswap_abi(registers[i + 32]);
|
558 | e95c8d51 | bellard | } |
559 | e95c8d51 | bellard | /* Y, PSR, WIM, TBR, PC, NPC, FPSR, CPSR */
|
560 | 96d19126 | blueswir1 | env->y = tswap_abi(registers[64]);
|
561 | 96d19126 | blueswir1 | PUT_PSR(env, tswap_abi(registers[65]));
|
562 | 96d19126 | blueswir1 | env->wim = tswap_abi(registers[66]);
|
563 | 96d19126 | blueswir1 | env->tbr = tswap_abi(registers[67]);
|
564 | 96d19126 | blueswir1 | env->pc = tswap_abi(registers[68]);
|
565 | 96d19126 | blueswir1 | env->npc = tswap_abi(registers[69]);
|
566 | 96d19126 | blueswir1 | env->fsr = tswap_abi(registers[70]);
|
567 | 3475187d | bellard | #else
|
568 | 9d9754a3 | bellard | for (i = 0; i < 64; i += 2) { |
569 | 8979596d | blueswir1 | uint64_t tmp; |
570 | 8979596d | blueswir1 | |
571 | 8979596d | blueswir1 | tmp = tswap64(registers[i / 2 + 32]); |
572 | 8979596d | blueswir1 | *((uint32_t *)&env->fpr[i]) = tmp >> 32;
|
573 | 8979596d | blueswir1 | *((uint32_t *)&env->fpr[i + 1]) = tmp & 0xffffffff; |
574 | 3475187d | bellard | } |
575 | 9d9754a3 | bellard | env->pc = tswapl(registers[64]);
|
576 | 9d9754a3 | bellard | env->npc = tswapl(registers[65]);
|
577 | 17d996e1 | blueswir1 | { |
578 | 17d996e1 | blueswir1 | uint64_t tmp = tswapl(registers[66]);
|
579 | 17d996e1 | blueswir1 | |
580 | 17d996e1 | blueswir1 | PUT_CCR(env, tmp >> 32);
|
581 | 17d996e1 | blueswir1 | env->asi = (tmp >> 24) & 0xff; |
582 | 17d996e1 | blueswir1 | env->pstate = (tmp >> 8) & 0xfff; |
583 | 17d996e1 | blueswir1 | PUT_CWP64(env, tmp & 0xff);
|
584 | 17d996e1 | blueswir1 | } |
585 | 9d9754a3 | bellard | env->fsr = tswapl(registers[67]);
|
586 | 9d9754a3 | bellard | env->fprs = tswapl(registers[68]);
|
587 | 9d9754a3 | bellard | env->y = tswapl(registers[69]);
|
588 | 3475187d | bellard | #endif
|
589 | 9e62fd7f | bellard | } |
590 | 96d19126 | blueswir1 | #undef tswap_abi
|
591 | 1fddef4b | bellard | #elif defined (TARGET_ARM)
|
592 | 1fddef4b | bellard | static int cpu_gdb_read_registers(CPUState *env, uint8_t *mem_buf) |
593 | 1fddef4b | bellard | { |
594 | 1fddef4b | bellard | int i;
|
595 | 1fddef4b | bellard | uint8_t *ptr; |
596 | 1fddef4b | bellard | |
597 | 1fddef4b | bellard | ptr = mem_buf; |
598 | 1fddef4b | bellard | /* 16 core integer registers (4 bytes each). */
|
599 | 1fddef4b | bellard | for (i = 0; i < 16; i++) |
600 | 1fddef4b | bellard | { |
601 | 1fddef4b | bellard | *(uint32_t *)ptr = tswapl(env->regs[i]); |
602 | 1fddef4b | bellard | ptr += 4;
|
603 | 1fddef4b | bellard | } |
604 | 1fddef4b | bellard | /* 8 FPA registers (12 bytes each), FPS (4 bytes).
|
605 | 1fddef4b | bellard | Not yet implemented. */
|
606 | 1fddef4b | bellard | memset (ptr, 0, 8 * 12 + 4); |
607 | 1fddef4b | bellard | ptr += 8 * 12 + 4; |
608 | 1fddef4b | bellard | /* CPSR (4 bytes). */
|
609 | b5ff1b31 | bellard | *(uint32_t *)ptr = tswapl (cpsr_read(env)); |
610 | 1fddef4b | bellard | ptr += 4;
|
611 | 1fddef4b | bellard | |
612 | 1fddef4b | bellard | return ptr - mem_buf;
|
613 | 1fddef4b | bellard | } |
614 | 6da41eaf | bellard | |
615 | 1fddef4b | bellard | static void cpu_gdb_write_registers(CPUState *env, uint8_t *mem_buf, int size) |
616 | 1fddef4b | bellard | { |
617 | 1fddef4b | bellard | int i;
|
618 | 1fddef4b | bellard | uint8_t *ptr; |
619 | 1fddef4b | bellard | |
620 | 1fddef4b | bellard | ptr = mem_buf; |
621 | 1fddef4b | bellard | /* Core integer registers. */
|
622 | 1fddef4b | bellard | for (i = 0; i < 16; i++) |
623 | 1fddef4b | bellard | { |
624 | 1fddef4b | bellard | env->regs[i] = tswapl(*(uint32_t *)ptr); |
625 | 1fddef4b | bellard | ptr += 4;
|
626 | 1fddef4b | bellard | } |
627 | 1fddef4b | bellard | /* Ignore FPA regs and scr. */
|
628 | 1fddef4b | bellard | ptr += 8 * 12 + 4; |
629 | b5ff1b31 | bellard | cpsr_write (env, tswapl(*(uint32_t *)ptr), 0xffffffff);
|
630 | 1fddef4b | bellard | } |
631 | e6e5906b | pbrook | #elif defined (TARGET_M68K)
|
632 | e6e5906b | pbrook | static int cpu_gdb_read_registers(CPUState *env, uint8_t *mem_buf) |
633 | e6e5906b | pbrook | { |
634 | e6e5906b | pbrook | int i;
|
635 | e6e5906b | pbrook | uint8_t *ptr; |
636 | e6e5906b | pbrook | CPU_DoubleU u; |
637 | e6e5906b | pbrook | |
638 | e6e5906b | pbrook | ptr = mem_buf; |
639 | e6e5906b | pbrook | /* D0-D7 */
|
640 | e6e5906b | pbrook | for (i = 0; i < 8; i++) { |
641 | e6e5906b | pbrook | *(uint32_t *)ptr = tswapl(env->dregs[i]); |
642 | e6e5906b | pbrook | ptr += 4;
|
643 | e6e5906b | pbrook | } |
644 | e6e5906b | pbrook | /* A0-A7 */
|
645 | e6e5906b | pbrook | for (i = 0; i < 8; i++) { |
646 | e6e5906b | pbrook | *(uint32_t *)ptr = tswapl(env->aregs[i]); |
647 | e6e5906b | pbrook | ptr += 4;
|
648 | e6e5906b | pbrook | } |
649 | e6e5906b | pbrook | *(uint32_t *)ptr = tswapl(env->sr); |
650 | e6e5906b | pbrook | ptr += 4;
|
651 | e6e5906b | pbrook | *(uint32_t *)ptr = tswapl(env->pc); |
652 | e6e5906b | pbrook | ptr += 4;
|
653 | e6e5906b | pbrook | /* F0-F7. The 68881/68040 have 12-bit extended precision registers.
|
654 | e6e5906b | pbrook | ColdFire has 8-bit double precision registers. */
|
655 | e6e5906b | pbrook | for (i = 0; i < 8; i++) { |
656 | e6e5906b | pbrook | u.d = env->fregs[i]; |
657 | e6e5906b | pbrook | *(uint32_t *)ptr = tswap32(u.l.upper); |
658 | e6e5906b | pbrook | *(uint32_t *)ptr = tswap32(u.l.lower); |
659 | e6e5906b | pbrook | } |
660 | e6e5906b | pbrook | /* FP control regs (not implemented). */
|
661 | e6e5906b | pbrook | memset (ptr, 0, 3 * 4); |
662 | e6e5906b | pbrook | ptr += 3 * 4; |
663 | e6e5906b | pbrook | |
664 | e6e5906b | pbrook | return ptr - mem_buf;
|
665 | e6e5906b | pbrook | } |
666 | e6e5906b | pbrook | |
667 | e6e5906b | pbrook | static void cpu_gdb_write_registers(CPUState *env, uint8_t *mem_buf, int size) |
668 | e6e5906b | pbrook | { |
669 | e6e5906b | pbrook | int i;
|
670 | e6e5906b | pbrook | uint8_t *ptr; |
671 | e6e5906b | pbrook | CPU_DoubleU u; |
672 | e6e5906b | pbrook | |
673 | e6e5906b | pbrook | ptr = mem_buf; |
674 | e6e5906b | pbrook | /* D0-D7 */
|
675 | e6e5906b | pbrook | for (i = 0; i < 8; i++) { |
676 | e6e5906b | pbrook | env->dregs[i] = tswapl(*(uint32_t *)ptr); |
677 | e6e5906b | pbrook | ptr += 4;
|
678 | e6e5906b | pbrook | } |
679 | e6e5906b | pbrook | /* A0-A7 */
|
680 | e6e5906b | pbrook | for (i = 0; i < 8; i++) { |
681 | e6e5906b | pbrook | env->aregs[i] = tswapl(*(uint32_t *)ptr); |
682 | e6e5906b | pbrook | ptr += 4;
|
683 | e6e5906b | pbrook | } |
684 | e6e5906b | pbrook | env->sr = tswapl(*(uint32_t *)ptr); |
685 | e6e5906b | pbrook | ptr += 4;
|
686 | e6e5906b | pbrook | env->pc = tswapl(*(uint32_t *)ptr); |
687 | e6e5906b | pbrook | ptr += 4;
|
688 | e6e5906b | pbrook | /* F0-F7. The 68881/68040 have 12-bit extended precision registers.
|
689 | e6e5906b | pbrook | ColdFire has 8-bit double precision registers. */
|
690 | e6e5906b | pbrook | for (i = 0; i < 8; i++) { |
691 | 5fafdf24 | ths | u.l.upper = tswap32(*(uint32_t *)ptr); |
692 | e6e5906b | pbrook | u.l.lower = tswap32(*(uint32_t *)ptr); |
693 | e6e5906b | pbrook | env->fregs[i] = u.d; |
694 | e6e5906b | pbrook | } |
695 | e6e5906b | pbrook | /* FP control regs (not implemented). */
|
696 | e6e5906b | pbrook | ptr += 3 * 4; |
697 | e6e5906b | pbrook | } |
698 | 6f970bd9 | bellard | #elif defined (TARGET_MIPS)
|
699 | 6f970bd9 | bellard | static int cpu_gdb_read_registers(CPUState *env, uint8_t *mem_buf) |
700 | 6f970bd9 | bellard | { |
701 | 6f970bd9 | bellard | int i;
|
702 | 6f970bd9 | bellard | uint8_t *ptr; |
703 | 6f970bd9 | bellard | |
704 | 6f970bd9 | bellard | ptr = mem_buf; |
705 | 6f970bd9 | bellard | for (i = 0; i < 32; i++) |
706 | 6f970bd9 | bellard | { |
707 | b5dc7732 | ths | *(target_ulong *)ptr = tswapl(env->active_tc.gpr[i]); |
708 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
709 | 6f970bd9 | bellard | } |
710 | 6f970bd9 | bellard | |
711 | 7ac256b8 | ths | *(target_ulong *)ptr = (int32_t)tswap32(env->CP0_Status); |
712 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
713 | 6f970bd9 | bellard | |
714 | b5dc7732 | ths | *(target_ulong *)ptr = tswapl(env->active_tc.LO[0]);
|
715 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
716 | 6f970bd9 | bellard | |
717 | b5dc7732 | ths | *(target_ulong *)ptr = tswapl(env->active_tc.HI[0]);
|
718 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
719 | 6f970bd9 | bellard | |
720 | 2052caa7 | ths | *(target_ulong *)ptr = tswapl(env->CP0_BadVAddr); |
721 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
722 | 6f970bd9 | bellard | |
723 | 7ac256b8 | ths | *(target_ulong *)ptr = (int32_t)tswap32(env->CP0_Cause); |
724 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
725 | 6f970bd9 | bellard | |
726 | b5dc7732 | ths | *(target_ulong *)ptr = tswapl(env->active_tc.PC); |
727 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
728 | 6f970bd9 | bellard | |
729 | 36d23958 | ths | if (env->CP0_Config1 & (1 << CP0C1_FP)) |
730 | 8e33c08c | ths | { |
731 | 36d23958 | ths | for (i = 0; i < 32; i++) |
732 | 36d23958 | ths | { |
733 | 7ac256b8 | ths | if (env->CP0_Status & (1 << CP0St_FR)) |
734 | 7ac256b8 | ths | *(target_ulong *)ptr = tswapl(env->fpu->fpr[i].d); |
735 | 7ac256b8 | ths | else
|
736 | 7ac256b8 | ths | *(target_ulong *)ptr = tswap32(env->fpu->fpr[i].w[FP_ENDIAN_IDX]); |
737 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
738 | 36d23958 | ths | } |
739 | 8e33c08c | ths | |
740 | 7ac256b8 | ths | *(target_ulong *)ptr = (int32_t)tswap32(env->fpu->fcr31); |
741 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
742 | 8e33c08c | ths | |
743 | 7ac256b8 | ths | *(target_ulong *)ptr = (int32_t)tswap32(env->fpu->fcr0); |
744 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
745 | 36d23958 | ths | } |
746 | 8e33c08c | ths | |
747 | 7ac256b8 | ths | /* "fp", pseudo frame pointer. Not yet implemented in gdb. */
|
748 | 7ac256b8 | ths | *(target_ulong *)ptr = 0;
|
749 | 7ac256b8 | ths | ptr += sizeof(target_ulong);
|
750 | 7ac256b8 | ths | |
751 | 7ac256b8 | ths | /* Registers for embedded use, we just pad them. */
|
752 | 7ac256b8 | ths | for (i = 0; i < 16; i++) |
753 | 7ac256b8 | ths | { |
754 | 7ac256b8 | ths | *(target_ulong *)ptr = 0;
|
755 | 7ac256b8 | ths | ptr += sizeof(target_ulong);
|
756 | 7ac256b8 | ths | } |
757 | 7ac256b8 | ths | |
758 | 7ac256b8 | ths | /* Processor ID. */
|
759 | 7ac256b8 | ths | *(target_ulong *)ptr = (int32_t)tswap32(env->CP0_PRid); |
760 | 7ac256b8 | ths | ptr += sizeof(target_ulong);
|
761 | 6f970bd9 | bellard | |
762 | 6f970bd9 | bellard | return ptr - mem_buf;
|
763 | 6f970bd9 | bellard | } |
764 | 6f970bd9 | bellard | |
765 | 8e33c08c | ths | /* convert MIPS rounding mode in FCR31 to IEEE library */
|
766 | 8e33c08c | ths | static unsigned int ieee_rm[] = |
767 | 8e33c08c | ths | { |
768 | 8e33c08c | ths | float_round_nearest_even, |
769 | 8e33c08c | ths | float_round_to_zero, |
770 | 8e33c08c | ths | float_round_up, |
771 | 8e33c08c | ths | float_round_down |
772 | 8e33c08c | ths | }; |
773 | 8e33c08c | ths | #define RESTORE_ROUNDING_MODE \
|
774 | ead9360e | ths | set_float_rounding_mode(ieee_rm[env->fpu->fcr31 & 3], &env->fpu->fp_status)
|
775 | 8e33c08c | ths | |
776 | 6f970bd9 | bellard | static void cpu_gdb_write_registers(CPUState *env, uint8_t *mem_buf, int size) |
777 | 6f970bd9 | bellard | { |
778 | 6f970bd9 | bellard | int i;
|
779 | 6f970bd9 | bellard | uint8_t *ptr; |
780 | 6f970bd9 | bellard | |
781 | 6f970bd9 | bellard | ptr = mem_buf; |
782 | 6f970bd9 | bellard | for (i = 0; i < 32; i++) |
783 | 6f970bd9 | bellard | { |
784 | b5dc7732 | ths | env->active_tc.gpr[i] = tswapl(*(target_ulong *)ptr); |
785 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
786 | 6f970bd9 | bellard | } |
787 | 6f970bd9 | bellard | |
788 | 2052caa7 | ths | env->CP0_Status = tswapl(*(target_ulong *)ptr); |
789 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
790 | 6f970bd9 | bellard | |
791 | b5dc7732 | ths | env->active_tc.LO[0] = tswapl(*(target_ulong *)ptr);
|
792 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
793 | 6f970bd9 | bellard | |
794 | b5dc7732 | ths | env->active_tc.HI[0] = tswapl(*(target_ulong *)ptr);
|
795 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
796 | 6f970bd9 | bellard | |
797 | 2052caa7 | ths | env->CP0_BadVAddr = tswapl(*(target_ulong *)ptr); |
798 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
799 | 6f970bd9 | bellard | |
800 | 2052caa7 | ths | env->CP0_Cause = tswapl(*(target_ulong *)ptr); |
801 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
802 | 6f970bd9 | bellard | |
803 | b5dc7732 | ths | env->active_tc.PC = tswapl(*(target_ulong *)ptr); |
804 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
805 | 8e33c08c | ths | |
806 | 36d23958 | ths | if (env->CP0_Config1 & (1 << CP0C1_FP)) |
807 | 8e33c08c | ths | { |
808 | 36d23958 | ths | for (i = 0; i < 32; i++) |
809 | 36d23958 | ths | { |
810 | 7ac256b8 | ths | if (env->CP0_Status & (1 << CP0St_FR)) |
811 | 7ac256b8 | ths | env->fpu->fpr[i].d = tswapl(*(target_ulong *)ptr); |
812 | 7ac256b8 | ths | else
|
813 | 7ac256b8 | ths | env->fpu->fpr[i].w[FP_ENDIAN_IDX] = tswapl(*(target_ulong *)ptr); |
814 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
815 | 36d23958 | ths | } |
816 | 8e33c08c | ths | |
817 | 7ac256b8 | ths | env->fpu->fcr31 = tswapl(*(target_ulong *)ptr) & 0xFF83FFFF;
|
818 | 2052caa7 | ths | ptr += sizeof(target_ulong);
|
819 | 8e33c08c | ths | |
820 | 7ac256b8 | ths | /* The remaining registers are assumed to be read-only. */
|
821 | 8e33c08c | ths | |
822 | 36d23958 | ths | /* set rounding mode */
|
823 | 36d23958 | ths | RESTORE_ROUNDING_MODE; |
824 | 8e33c08c | ths | |
825 | 8e33c08c | ths | #ifndef CONFIG_SOFTFLOAT
|
826 | 36d23958 | ths | /* no floating point exception for native float */
|
827 | 36d23958 | ths | SET_FP_ENABLE(env->fcr31, 0);
|
828 | 8e33c08c | ths | #endif
|
829 | 36d23958 | ths | } |
830 | 6f970bd9 | bellard | } |
831 | fdf9b3e8 | bellard | #elif defined (TARGET_SH4)
|
832 | 6ef99fc5 | ths | |
833 | 6ef99fc5 | ths | /* Hint: Use "set architecture sh4" in GDB to see fpu registers */
|
834 | 6ef99fc5 | ths | |
835 | fdf9b3e8 | bellard | static int cpu_gdb_read_registers(CPUState *env, uint8_t *mem_buf) |
836 | fdf9b3e8 | bellard | { |
837 | fdf9b3e8 | bellard | uint32_t *ptr = (uint32_t *)mem_buf; |
838 | fdf9b3e8 | bellard | int i;
|
839 | fdf9b3e8 | bellard | |
840 | fdf9b3e8 | bellard | #define SAVE(x) *ptr++=tswapl(x)
|
841 | 9c2a9ea1 | pbrook | if ((env->sr & (SR_MD | SR_RB)) == (SR_MD | SR_RB)) {
|
842 | 9c2a9ea1 | pbrook | for (i = 0; i < 8; i++) SAVE(env->gregs[i + 16]); |
843 | 9c2a9ea1 | pbrook | } else {
|
844 | 9c2a9ea1 | pbrook | for (i = 0; i < 8; i++) SAVE(env->gregs[i]); |
845 | 9c2a9ea1 | pbrook | } |
846 | 9c2a9ea1 | pbrook | for (i = 8; i < 16; i++) SAVE(env->gregs[i]); |
847 | fdf9b3e8 | bellard | SAVE (env->pc); |
848 | fdf9b3e8 | bellard | SAVE (env->pr); |
849 | fdf9b3e8 | bellard | SAVE (env->gbr); |
850 | fdf9b3e8 | bellard | SAVE (env->vbr); |
851 | fdf9b3e8 | bellard | SAVE (env->mach); |
852 | fdf9b3e8 | bellard | SAVE (env->macl); |
853 | fdf9b3e8 | bellard | SAVE (env->sr); |
854 | 6ef99fc5 | ths | SAVE (env->fpul); |
855 | 6ef99fc5 | ths | SAVE (env->fpscr); |
856 | 6ef99fc5 | ths | for (i = 0; i < 16; i++) |
857 | 6ef99fc5 | ths | SAVE(env->fregs[i + ((env->fpscr & FPSCR_FR) ? 16 : 0)]); |
858 | 6ef99fc5 | ths | SAVE (env->ssr); |
859 | 6ef99fc5 | ths | SAVE (env->spc); |
860 | 6ef99fc5 | ths | for (i = 0; i < 8; i++) SAVE(env->gregs[i]); |
861 | 6ef99fc5 | ths | for (i = 0; i < 8; i++) SAVE(env->gregs[i + 16]); |
862 | fdf9b3e8 | bellard | return ((uint8_t *)ptr - mem_buf);
|
863 | fdf9b3e8 | bellard | } |
864 | fdf9b3e8 | bellard | |
865 | fdf9b3e8 | bellard | static void cpu_gdb_write_registers(CPUState *env, uint8_t *mem_buf, int size) |
866 | fdf9b3e8 | bellard | { |
867 | fdf9b3e8 | bellard | uint32_t *ptr = (uint32_t *)mem_buf; |
868 | fdf9b3e8 | bellard | int i;
|
869 | fdf9b3e8 | bellard | |
870 | fdf9b3e8 | bellard | #define LOAD(x) (x)=*ptr++;
|
871 | 9c2a9ea1 | pbrook | if ((env->sr & (SR_MD | SR_RB)) == (SR_MD | SR_RB)) {
|
872 | 9c2a9ea1 | pbrook | for (i = 0; i < 8; i++) LOAD(env->gregs[i + 16]); |
873 | 9c2a9ea1 | pbrook | } else {
|
874 | 9c2a9ea1 | pbrook | for (i = 0; i < 8; i++) LOAD(env->gregs[i]); |
875 | 9c2a9ea1 | pbrook | } |
876 | 9c2a9ea1 | pbrook | for (i = 8; i < 16; i++) LOAD(env->gregs[i]); |
877 | fdf9b3e8 | bellard | LOAD (env->pc); |
878 | fdf9b3e8 | bellard | LOAD (env->pr); |
879 | fdf9b3e8 | bellard | LOAD (env->gbr); |
880 | fdf9b3e8 | bellard | LOAD (env->vbr); |
881 | fdf9b3e8 | bellard | LOAD (env->mach); |
882 | fdf9b3e8 | bellard | LOAD (env->macl); |
883 | fdf9b3e8 | bellard | LOAD (env->sr); |
884 | 6ef99fc5 | ths | LOAD (env->fpul); |
885 | 6ef99fc5 | ths | LOAD (env->fpscr); |
886 | 6ef99fc5 | ths | for (i = 0; i < 16; i++) |
887 | 6ef99fc5 | ths | LOAD(env->fregs[i + ((env->fpscr & FPSCR_FR) ? 16 : 0)]); |
888 | 6ef99fc5 | ths | LOAD (env->ssr); |
889 | 6ef99fc5 | ths | LOAD (env->spc); |
890 | 6ef99fc5 | ths | for (i = 0; i < 8; i++) LOAD(env->gregs[i]); |
891 | 6ef99fc5 | ths | for (i = 0; i < 8; i++) LOAD(env->gregs[i + 16]); |
892 | fdf9b3e8 | bellard | } |
893 | f1ccf904 | ths | #elif defined (TARGET_CRIS)
|
894 | f1ccf904 | ths | |
895 | f1ccf904 | ths | static int cris_save_32 (unsigned char *d, uint32_t value) |
896 | f1ccf904 | ths | { |
897 | f1ccf904 | ths | *d++ = (value); |
898 | f1ccf904 | ths | *d++ = (value >>= 8);
|
899 | f1ccf904 | ths | *d++ = (value >>= 8);
|
900 | f1ccf904 | ths | *d++ = (value >>= 8);
|
901 | f1ccf904 | ths | return 4; |
902 | f1ccf904 | ths | } |
903 | f1ccf904 | ths | static int cris_save_16 (unsigned char *d, uint32_t value) |
904 | f1ccf904 | ths | { |
905 | f1ccf904 | ths | *d++ = (value); |
906 | f1ccf904 | ths | *d++ = (value >>= 8);
|
907 | f1ccf904 | ths | return 2; |
908 | f1ccf904 | ths | } |
909 | f1ccf904 | ths | static int cris_save_8 (unsigned char *d, uint32_t value) |
910 | f1ccf904 | ths | { |
911 | f1ccf904 | ths | *d++ = (value); |
912 | f1ccf904 | ths | return 1; |
913 | f1ccf904 | ths | } |
914 | f1ccf904 | ths | |
915 | f1ccf904 | ths | /* FIXME: this will bug on archs not supporting unaligned word accesses. */
|
916 | f1ccf904 | ths | static int cpu_gdb_read_registers(CPUState *env, uint8_t *mem_buf) |
917 | f1ccf904 | ths | { |
918 | f1ccf904 | ths | uint8_t *ptr = mem_buf; |
919 | f1ccf904 | ths | uint8_t srs; |
920 | f1ccf904 | ths | int i;
|
921 | f1ccf904 | ths | |
922 | f1ccf904 | ths | for (i = 0; i < 16; i++) |
923 | f1ccf904 | ths | ptr += cris_save_32 (ptr, env->regs[i]); |
924 | f1ccf904 | ths | |
925 | 9004627f | edgar_igl | srs = env->pregs[PR_SRS]; |
926 | f1ccf904 | ths | |
927 | f1ccf904 | ths | ptr += cris_save_8 (ptr, env->pregs[0]);
|
928 | f1ccf904 | ths | ptr += cris_save_8 (ptr, env->pregs[1]);
|
929 | f1ccf904 | ths | ptr += cris_save_32 (ptr, env->pregs[2]);
|
930 | f1ccf904 | ths | ptr += cris_save_8 (ptr, srs); |
931 | f1ccf904 | ths | ptr += cris_save_16 (ptr, env->pregs[4]);
|
932 | f1ccf904 | ths | |
933 | f1ccf904 | ths | for (i = 5; i < 16; i++) |
934 | f1ccf904 | ths | ptr += cris_save_32 (ptr, env->pregs[i]); |
935 | f1ccf904 | ths | |
936 | f1ccf904 | ths | ptr += cris_save_32 (ptr, env->pc); |
937 | f1ccf904 | ths | |
938 | f1ccf904 | ths | for (i = 0; i < 16; i++) |
939 | f1ccf904 | ths | ptr += cris_save_32 (ptr, env->sregs[srs][i]); |
940 | f1ccf904 | ths | |
941 | f1ccf904 | ths | return ((uint8_t *)ptr - mem_buf);
|
942 | f1ccf904 | ths | } |
943 | f1ccf904 | ths | |
944 | f1ccf904 | ths | static void cpu_gdb_write_registers(CPUState *env, uint8_t *mem_buf, int size) |
945 | f1ccf904 | ths | { |
946 | f1ccf904 | ths | uint32_t *ptr = (uint32_t *)mem_buf; |
947 | f1ccf904 | ths | int i;
|
948 | f1ccf904 | ths | |
949 | f1ccf904 | ths | #define LOAD(x) (x)=*ptr++;
|
950 | f1ccf904 | ths | for (i = 0; i < 16; i++) LOAD(env->regs[i]); |
951 | f1ccf904 | ths | LOAD (env->pc); |
952 | f1ccf904 | ths | } |
953 | 1fddef4b | bellard | #else
|
954 | 6da41eaf | bellard | static int cpu_gdb_read_registers(CPUState *env, uint8_t *mem_buf) |
955 | 6da41eaf | bellard | { |
956 | 6da41eaf | bellard | return 0; |
957 | 6da41eaf | bellard | } |
958 | 6da41eaf | bellard | |
959 | 6da41eaf | bellard | static void cpu_gdb_write_registers(CPUState *env, uint8_t *mem_buf, int size) |
960 | 6da41eaf | bellard | { |
961 | 6da41eaf | bellard | } |
962 | 6da41eaf | bellard | |
963 | 6da41eaf | bellard | #endif
|
964 | b4608c04 | bellard | |
965 | 1fddef4b | bellard | static int gdb_handle_packet(GDBState *s, CPUState *env, const char *line_buf) |
966 | b4608c04 | bellard | { |
967 | b4608c04 | bellard | const char *p; |
968 | 858693c6 | bellard | int ch, reg_size, type;
|
969 | b4608c04 | bellard | char buf[4096]; |
970 | f1ccf904 | ths | uint8_t mem_buf[4096];
|
971 | b4608c04 | bellard | uint32_t *registers; |
972 | 9d9754a3 | bellard | target_ulong addr, len; |
973 | 3b46e624 | ths | |
974 | 858693c6 | bellard | #ifdef DEBUG_GDB
|
975 | 858693c6 | bellard | printf("command='%s'\n", line_buf);
|
976 | 858693c6 | bellard | #endif
|
977 | 858693c6 | bellard | p = line_buf; |
978 | 858693c6 | bellard | ch = *p++; |
979 | 858693c6 | bellard | switch(ch) {
|
980 | 858693c6 | bellard | case '?': |
981 | 1fddef4b | bellard | /* TODO: Make this return the correct value for user-mode. */
|
982 | 858693c6 | bellard | snprintf(buf, sizeof(buf), "S%02x", SIGTRAP); |
983 | 858693c6 | bellard | put_packet(s, buf); |
984 | 7d03f82f | edgar_igl | /* Remove all the breakpoints when this query is issued,
|
985 | 7d03f82f | edgar_igl | * because gdb is doing and initial connect and the state
|
986 | 7d03f82f | edgar_igl | * should be cleaned up.
|
987 | 7d03f82f | edgar_igl | */
|
988 | 7d03f82f | edgar_igl | cpu_breakpoint_remove_all(env); |
989 | 7d03f82f | edgar_igl | cpu_watchpoint_remove_all(env); |
990 | 858693c6 | bellard | break;
|
991 | 858693c6 | bellard | case 'c': |
992 | 858693c6 | bellard | if (*p != '\0') { |
993 | 9d9754a3 | bellard | addr = strtoull(p, (char **)&p, 16); |
994 | 4c3a88a2 | bellard | #if defined(TARGET_I386)
|
995 | 858693c6 | bellard | env->eip = addr; |
996 | 5be1a8e0 | bellard | #elif defined (TARGET_PPC)
|
997 | 858693c6 | bellard | env->nip = addr; |
998 | 8d5f07fa | bellard | #elif defined (TARGET_SPARC)
|
999 | 8d5f07fa | bellard | env->pc = addr; |
1000 | 8d5f07fa | bellard | env->npc = addr + 4;
|
1001 | b5ff1b31 | bellard | #elif defined (TARGET_ARM)
|
1002 | b5ff1b31 | bellard | env->regs[15] = addr;
|
1003 | fdf9b3e8 | bellard | #elif defined (TARGET_SH4)
|
1004 | 8fac5803 | ths | env->pc = addr; |
1005 | 8fac5803 | ths | #elif defined (TARGET_MIPS)
|
1006 | b5dc7732 | ths | env->active_tc.PC = addr; |
1007 | f1ccf904 | ths | #elif defined (TARGET_CRIS)
|
1008 | f1ccf904 | ths | env->pc = addr; |
1009 | 4c3a88a2 | bellard | #endif
|
1010 | 858693c6 | bellard | } |
1011 | ba70a624 | edgar_igl | gdb_continue(s); |
1012 | 41625033 | bellard | return RS_IDLE;
|
1013 | 1f487ee9 | edgar_igl | case 'C': |
1014 | 1f487ee9 | edgar_igl | s->signal = strtoul(p, (char **)&p, 16); |
1015 | 1f487ee9 | edgar_igl | gdb_continue(s); |
1016 | 1f487ee9 | edgar_igl | return RS_IDLE;
|
1017 | 7d03f82f | edgar_igl | case 'k': |
1018 | 7d03f82f | edgar_igl | /* Kill the target */
|
1019 | 7d03f82f | edgar_igl | fprintf(stderr, "\nQEMU: Terminated via GDBstub\n");
|
1020 | 7d03f82f | edgar_igl | exit(0);
|
1021 | 7d03f82f | edgar_igl | case 'D': |
1022 | 7d03f82f | edgar_igl | /* Detach packet */
|
1023 | 7d03f82f | edgar_igl | cpu_breakpoint_remove_all(env); |
1024 | 7d03f82f | edgar_igl | cpu_watchpoint_remove_all(env); |
1025 | 7d03f82f | edgar_igl | gdb_continue(s); |
1026 | 7d03f82f | edgar_igl | put_packet(s, "OK");
|
1027 | 7d03f82f | edgar_igl | break;
|
1028 | 858693c6 | bellard | case 's': |
1029 | 858693c6 | bellard | if (*p != '\0') { |
1030 | 8fac5803 | ths | addr = strtoull(p, (char **)&p, 16); |
1031 | c33a346e | bellard | #if defined(TARGET_I386)
|
1032 | 858693c6 | bellard | env->eip = addr; |
1033 | 5be1a8e0 | bellard | #elif defined (TARGET_PPC)
|
1034 | 858693c6 | bellard | env->nip = addr; |
1035 | 8d5f07fa | bellard | #elif defined (TARGET_SPARC)
|
1036 | 8d5f07fa | bellard | env->pc = addr; |
1037 | 8d5f07fa | bellard | env->npc = addr + 4;
|
1038 | b5ff1b31 | bellard | #elif defined (TARGET_ARM)
|
1039 | b5ff1b31 | bellard | env->regs[15] = addr;
|
1040 | fdf9b3e8 | bellard | #elif defined (TARGET_SH4)
|
1041 | 8fac5803 | ths | env->pc = addr; |
1042 | 8fac5803 | ths | #elif defined (TARGET_MIPS)
|
1043 | b5dc7732 | ths | env->active_tc.PC = addr; |
1044 | f1ccf904 | ths | #elif defined (TARGET_CRIS)
|
1045 | f1ccf904 | ths | env->pc = addr; |
1046 | c33a346e | bellard | #endif
|
1047 | 858693c6 | bellard | } |
1048 | 60897d36 | edgar_igl | cpu_single_step(env, sstep_flags); |
1049 | ba70a624 | edgar_igl | gdb_continue(s); |
1050 | 41625033 | bellard | return RS_IDLE;
|
1051 | a2d1ebaf | pbrook | case 'F': |
1052 | a2d1ebaf | pbrook | { |
1053 | a2d1ebaf | pbrook | target_ulong ret; |
1054 | a2d1ebaf | pbrook | target_ulong err; |
1055 | a2d1ebaf | pbrook | |
1056 | a2d1ebaf | pbrook | ret = strtoull(p, (char **)&p, 16); |
1057 | a2d1ebaf | pbrook | if (*p == ',') { |
1058 | a2d1ebaf | pbrook | p++; |
1059 | a2d1ebaf | pbrook | err = strtoull(p, (char **)&p, 16); |
1060 | a2d1ebaf | pbrook | } else {
|
1061 | a2d1ebaf | pbrook | err = 0;
|
1062 | a2d1ebaf | pbrook | } |
1063 | a2d1ebaf | pbrook | if (*p == ',') |
1064 | a2d1ebaf | pbrook | p++; |
1065 | a2d1ebaf | pbrook | type = *p; |
1066 | a2d1ebaf | pbrook | if (gdb_current_syscall_cb)
|
1067 | a2d1ebaf | pbrook | gdb_current_syscall_cb(s->env, ret, err); |
1068 | a2d1ebaf | pbrook | if (type == 'C') { |
1069 | a2d1ebaf | pbrook | put_packet(s, "T02");
|
1070 | a2d1ebaf | pbrook | } else {
|
1071 | ba70a624 | edgar_igl | gdb_continue(s); |
1072 | a2d1ebaf | pbrook | } |
1073 | a2d1ebaf | pbrook | } |
1074 | a2d1ebaf | pbrook | break;
|
1075 | 858693c6 | bellard | case 'g': |
1076 | 858693c6 | bellard | reg_size = cpu_gdb_read_registers(env, mem_buf); |
1077 | 858693c6 | bellard | memtohex(buf, mem_buf, reg_size); |
1078 | 858693c6 | bellard | put_packet(s, buf); |
1079 | 858693c6 | bellard | break;
|
1080 | 858693c6 | bellard | case 'G': |
1081 | 858693c6 | bellard | registers = (void *)mem_buf;
|
1082 | 858693c6 | bellard | len = strlen(p) / 2;
|
1083 | 858693c6 | bellard | hextomem((uint8_t *)registers, p, len); |
1084 | 858693c6 | bellard | cpu_gdb_write_registers(env, mem_buf, len); |
1085 | 858693c6 | bellard | put_packet(s, "OK");
|
1086 | 858693c6 | bellard | break;
|
1087 | 858693c6 | bellard | case 'm': |
1088 | 9d9754a3 | bellard | addr = strtoull(p, (char **)&p, 16); |
1089 | 858693c6 | bellard | if (*p == ',') |
1090 | 858693c6 | bellard | p++; |
1091 | 9d9754a3 | bellard | len = strtoull(p, NULL, 16); |
1092 | 6f970bd9 | bellard | if (cpu_memory_rw_debug(env, addr, mem_buf, len, 0) != 0) { |
1093 | 6f970bd9 | bellard | put_packet (s, "E14");
|
1094 | 6f970bd9 | bellard | } else {
|
1095 | 6f970bd9 | bellard | memtohex(buf, mem_buf, len); |
1096 | 6f970bd9 | bellard | put_packet(s, buf); |
1097 | 6f970bd9 | bellard | } |
1098 | 858693c6 | bellard | break;
|
1099 | 858693c6 | bellard | case 'M': |
1100 | 9d9754a3 | bellard | addr = strtoull(p, (char **)&p, 16); |
1101 | 858693c6 | bellard | if (*p == ',') |
1102 | 858693c6 | bellard | p++; |
1103 | 9d9754a3 | bellard | len = strtoull(p, (char **)&p, 16); |
1104 | b328f873 | bellard | if (*p == ':') |
1105 | 858693c6 | bellard | p++; |
1106 | 858693c6 | bellard | hextomem(mem_buf, p, len); |
1107 | 858693c6 | bellard | if (cpu_memory_rw_debug(env, addr, mem_buf, len, 1) != 0) |
1108 | 905f20b1 | bellard | put_packet(s, "E14");
|
1109 | 858693c6 | bellard | else
|
1110 | 858693c6 | bellard | put_packet(s, "OK");
|
1111 | 858693c6 | bellard | break;
|
1112 | 858693c6 | bellard | case 'Z': |
1113 | 858693c6 | bellard | type = strtoul(p, (char **)&p, 16); |
1114 | 858693c6 | bellard | if (*p == ',') |
1115 | 858693c6 | bellard | p++; |
1116 | 9d9754a3 | bellard | addr = strtoull(p, (char **)&p, 16); |
1117 | 858693c6 | bellard | if (*p == ',') |
1118 | 858693c6 | bellard | p++; |
1119 | 9d9754a3 | bellard | len = strtoull(p, (char **)&p, 16); |
1120 | 0f459d16 | pbrook | switch (type) {
|
1121 | 0f459d16 | pbrook | case 0: |
1122 | 0f459d16 | pbrook | case 1: |
1123 | 858693c6 | bellard | if (cpu_breakpoint_insert(env, addr) < 0) |
1124 | 858693c6 | bellard | goto breakpoint_error;
|
1125 | 858693c6 | bellard | put_packet(s, "OK");
|
1126 | 0f459d16 | pbrook | break;
|
1127 | 6658ffb8 | pbrook | #ifndef CONFIG_USER_ONLY
|
1128 | 0f459d16 | pbrook | case 2: |
1129 | 0f459d16 | pbrook | type = PAGE_WRITE; |
1130 | 0f459d16 | pbrook | goto insert_watchpoint;
|
1131 | 0f459d16 | pbrook | case 3: |
1132 | 0f459d16 | pbrook | type = PAGE_READ; |
1133 | 0f459d16 | pbrook | goto insert_watchpoint;
|
1134 | 0f459d16 | pbrook | case 4: |
1135 | 0f459d16 | pbrook | type = PAGE_READ | PAGE_WRITE; |
1136 | 0f459d16 | pbrook | insert_watchpoint:
|
1137 | 0f459d16 | pbrook | if (cpu_watchpoint_insert(env, addr, type) < 0) |
1138 | 6658ffb8 | pbrook | goto breakpoint_error;
|
1139 | 6658ffb8 | pbrook | put_packet(s, "OK");
|
1140 | 0f459d16 | pbrook | break;
|
1141 | 6658ffb8 | pbrook | #endif
|
1142 | 0f459d16 | pbrook | default:
|
1143 | 0f459d16 | pbrook | put_packet(s, "");
|
1144 | 0f459d16 | pbrook | break;
|
1145 | 858693c6 | bellard | } |
1146 | 858693c6 | bellard | break;
|
1147 | 0f459d16 | pbrook | breakpoint_error:
|
1148 | 0f459d16 | pbrook | put_packet(s, "E22");
|
1149 | 0f459d16 | pbrook | break;
|
1150 | 0f459d16 | pbrook | |
1151 | 858693c6 | bellard | case 'z': |
1152 | 858693c6 | bellard | type = strtoul(p, (char **)&p, 16); |
1153 | 858693c6 | bellard | if (*p == ',') |
1154 | 858693c6 | bellard | p++; |
1155 | 9d9754a3 | bellard | addr = strtoull(p, (char **)&p, 16); |
1156 | 858693c6 | bellard | if (*p == ',') |
1157 | 858693c6 | bellard | p++; |
1158 | 9d9754a3 | bellard | len = strtoull(p, (char **)&p, 16); |
1159 | 858693c6 | bellard | if (type == 0 || type == 1) { |
1160 | 858693c6 | bellard | cpu_breakpoint_remove(env, addr); |
1161 | 858693c6 | bellard | put_packet(s, "OK");
|
1162 | 6658ffb8 | pbrook | #ifndef CONFIG_USER_ONLY
|
1163 | 0f459d16 | pbrook | } else if (type >= 2 || type <= 4) { |
1164 | 6658ffb8 | pbrook | cpu_watchpoint_remove(env, addr); |
1165 | 6658ffb8 | pbrook | put_packet(s, "OK");
|
1166 | 6658ffb8 | pbrook | #endif
|
1167 | 858693c6 | bellard | } else {
|
1168 | 0f459d16 | pbrook | put_packet(s, "");
|
1169 | 858693c6 | bellard | } |
1170 | 858693c6 | bellard | break;
|
1171 | 978efd6a | pbrook | case 'q': |
1172 | 60897d36 | edgar_igl | case 'Q': |
1173 | 60897d36 | edgar_igl | /* parse any 'q' packets here */
|
1174 | 60897d36 | edgar_igl | if (!strcmp(p,"qemu.sstepbits")) { |
1175 | 60897d36 | edgar_igl | /* Query Breakpoint bit definitions */
|
1176 | 363a37d5 | blueswir1 | snprintf(buf, sizeof(buf), "ENABLE=%x,NOIRQ=%x,NOTIMER=%x", |
1177 | 363a37d5 | blueswir1 | SSTEP_ENABLE, |
1178 | 363a37d5 | blueswir1 | SSTEP_NOIRQ, |
1179 | 363a37d5 | blueswir1 | SSTEP_NOTIMER); |
1180 | 60897d36 | edgar_igl | put_packet(s, buf); |
1181 | 60897d36 | edgar_igl | break;
|
1182 | 60897d36 | edgar_igl | } else if (strncmp(p,"qemu.sstep",10) == 0) { |
1183 | 60897d36 | edgar_igl | /* Display or change the sstep_flags */
|
1184 | 60897d36 | edgar_igl | p += 10;
|
1185 | 60897d36 | edgar_igl | if (*p != '=') { |
1186 | 60897d36 | edgar_igl | /* Display current setting */
|
1187 | 363a37d5 | blueswir1 | snprintf(buf, sizeof(buf), "0x%x", sstep_flags); |
1188 | 60897d36 | edgar_igl | put_packet(s, buf); |
1189 | 60897d36 | edgar_igl | break;
|
1190 | 60897d36 | edgar_igl | } |
1191 | 60897d36 | edgar_igl | p++; |
1192 | 60897d36 | edgar_igl | type = strtoul(p, (char **)&p, 16); |
1193 | 60897d36 | edgar_igl | sstep_flags = type; |
1194 | 60897d36 | edgar_igl | put_packet(s, "OK");
|
1195 | 60897d36 | edgar_igl | break;
|
1196 | 60897d36 | edgar_igl | } |
1197 | 60897d36 | edgar_igl | #ifdef CONFIG_LINUX_USER
|
1198 | 60897d36 | edgar_igl | else if (strncmp(p, "Offsets", 7) == 0) { |
1199 | 978efd6a | pbrook | TaskState *ts = env->opaque; |
1200 | 978efd6a | pbrook | |
1201 | 363a37d5 | blueswir1 | snprintf(buf, sizeof(buf),
|
1202 | 363a37d5 | blueswir1 | "Text=" TARGET_ABI_FMT_lx ";Data=" TARGET_ABI_FMT_lx |
1203 | 363a37d5 | blueswir1 | ";Bss=" TARGET_ABI_FMT_lx,
|
1204 | 363a37d5 | blueswir1 | ts->info->code_offset, |
1205 | 363a37d5 | blueswir1 | ts->info->data_offset, |
1206 | 363a37d5 | blueswir1 | ts->info->data_offset); |
1207 | 978efd6a | pbrook | put_packet(s, buf); |
1208 | 978efd6a | pbrook | break;
|
1209 | 978efd6a | pbrook | } |
1210 | 978efd6a | pbrook | #endif
|
1211 | 60897d36 | edgar_igl | /* Fall through. */
|
1212 | 858693c6 | bellard | default:
|
1213 | 858693c6 | bellard | /* put empty packet */
|
1214 | 858693c6 | bellard | buf[0] = '\0'; |
1215 | 858693c6 | bellard | put_packet(s, buf); |
1216 | 858693c6 | bellard | break;
|
1217 | 858693c6 | bellard | } |
1218 | 858693c6 | bellard | return RS_IDLE;
|
1219 | 858693c6 | bellard | } |
1220 | 858693c6 | bellard | |
1221 | 612458f5 | bellard | extern void tb_flush(CPUState *env); |
1222 | 612458f5 | bellard | |
1223 | 1fddef4b | bellard | #ifndef CONFIG_USER_ONLY
|
1224 | 858693c6 | bellard | static void gdb_vm_stopped(void *opaque, int reason) |
1225 | 858693c6 | bellard | { |
1226 | 858693c6 | bellard | GDBState *s = opaque; |
1227 | 858693c6 | bellard | char buf[256]; |
1228 | 858693c6 | bellard | int ret;
|
1229 | 858693c6 | bellard | |
1230 | a2d1ebaf | pbrook | if (s->state == RS_SYSCALL)
|
1231 | a2d1ebaf | pbrook | return;
|
1232 | a2d1ebaf | pbrook | |
1233 | 858693c6 | bellard | /* disable single step if it was enable */
|
1234 | 6a00d601 | bellard | cpu_single_step(s->env, 0);
|
1235 | 858693c6 | bellard | |
1236 | e80cfcfc | bellard | if (reason == EXCP_DEBUG) {
|
1237 | 6658ffb8 | pbrook | if (s->env->watchpoint_hit) {
|
1238 | aa6290b7 | pbrook | snprintf(buf, sizeof(buf), "T%02xwatch:" TARGET_FMT_lx ";", |
1239 | aa6290b7 | pbrook | SIGTRAP, |
1240 | 6658ffb8 | pbrook | s->env->watchpoint[s->env->watchpoint_hit - 1].vaddr);
|
1241 | 6658ffb8 | pbrook | put_packet(s, buf); |
1242 | 6658ffb8 | pbrook | s->env->watchpoint_hit = 0;
|
1243 | 6658ffb8 | pbrook | return;
|
1244 | 6658ffb8 | pbrook | } |
1245 | 6a00d601 | bellard | tb_flush(s->env); |
1246 | 858693c6 | bellard | ret = SIGTRAP; |
1247 | bbeb7b5c | bellard | } else if (reason == EXCP_INTERRUPT) { |
1248 | bbeb7b5c | bellard | ret = SIGINT; |
1249 | bbeb7b5c | bellard | } else {
|
1250 | 858693c6 | bellard | ret = 0;
|
1251 | bbeb7b5c | bellard | } |
1252 | 858693c6 | bellard | snprintf(buf, sizeof(buf), "S%02x", ret); |
1253 | 858693c6 | bellard | put_packet(s, buf); |
1254 | 858693c6 | bellard | } |
1255 | 1fddef4b | bellard | #endif
|
1256 | 858693c6 | bellard | |
1257 | a2d1ebaf | pbrook | /* Send a gdb syscall request.
|
1258 | a2d1ebaf | pbrook | This accepts limited printf-style format specifiers, specifically:
|
1259 | a87295e8 | pbrook | %x - target_ulong argument printed in hex.
|
1260 | a87295e8 | pbrook | %lx - 64-bit argument printed in hex.
|
1261 | a87295e8 | pbrook | %s - string pointer (target_ulong) and length (int) pair. */
|
1262 | a2d1ebaf | pbrook | void gdb_do_syscall(gdb_syscall_complete_cb cb, char *fmt, ...) |
1263 | a2d1ebaf | pbrook | { |
1264 | a2d1ebaf | pbrook | va_list va; |
1265 | a2d1ebaf | pbrook | char buf[256]; |
1266 | a2d1ebaf | pbrook | char *p;
|
1267 | a2d1ebaf | pbrook | target_ulong addr; |
1268 | a87295e8 | pbrook | uint64_t i64; |
1269 | a2d1ebaf | pbrook | GDBState *s; |
1270 | a2d1ebaf | pbrook | |
1271 | a2d1ebaf | pbrook | s = gdb_syscall_state; |
1272 | a2d1ebaf | pbrook | if (!s)
|
1273 | a2d1ebaf | pbrook | return;
|
1274 | a2d1ebaf | pbrook | gdb_current_syscall_cb = cb; |
1275 | a2d1ebaf | pbrook | s->state = RS_SYSCALL; |
1276 | a2d1ebaf | pbrook | #ifndef CONFIG_USER_ONLY
|
1277 | a2d1ebaf | pbrook | vm_stop(EXCP_DEBUG); |
1278 | a2d1ebaf | pbrook | #endif
|
1279 | a2d1ebaf | pbrook | s->state = RS_IDLE; |
1280 | a2d1ebaf | pbrook | va_start(va, fmt); |
1281 | a2d1ebaf | pbrook | p = buf; |
1282 | a2d1ebaf | pbrook | *(p++) = 'F';
|
1283 | a2d1ebaf | pbrook | while (*fmt) {
|
1284 | a2d1ebaf | pbrook | if (*fmt == '%') { |
1285 | a2d1ebaf | pbrook | fmt++; |
1286 | a2d1ebaf | pbrook | switch (*fmt++) {
|
1287 | a2d1ebaf | pbrook | case 'x': |
1288 | a2d1ebaf | pbrook | addr = va_arg(va, target_ulong); |
1289 | 363a37d5 | blueswir1 | p += snprintf(p, &buf[sizeof(buf)] - p, TARGET_FMT_lx, addr);
|
1290 | a2d1ebaf | pbrook | break;
|
1291 | a87295e8 | pbrook | case 'l': |
1292 | a87295e8 | pbrook | if (*(fmt++) != 'x') |
1293 | a87295e8 | pbrook | goto bad_format;
|
1294 | a87295e8 | pbrook | i64 = va_arg(va, uint64_t); |
1295 | 363a37d5 | blueswir1 | p += snprintf(p, &buf[sizeof(buf)] - p, "%" PRIx64, i64); |
1296 | a87295e8 | pbrook | break;
|
1297 | a2d1ebaf | pbrook | case 's': |
1298 | a2d1ebaf | pbrook | addr = va_arg(va, target_ulong); |
1299 | 363a37d5 | blueswir1 | p += snprintf(p, &buf[sizeof(buf)] - p, TARGET_FMT_lx "/%x", |
1300 | 363a37d5 | blueswir1 | addr, va_arg(va, int));
|
1301 | a2d1ebaf | pbrook | break;
|
1302 | a2d1ebaf | pbrook | default:
|
1303 | a87295e8 | pbrook | bad_format:
|
1304 | a2d1ebaf | pbrook | fprintf(stderr, "gdbstub: Bad syscall format string '%s'\n",
|
1305 | a2d1ebaf | pbrook | fmt - 1);
|
1306 | a2d1ebaf | pbrook | break;
|
1307 | a2d1ebaf | pbrook | } |
1308 | a2d1ebaf | pbrook | } else {
|
1309 | a2d1ebaf | pbrook | *(p++) = *(fmt++); |
1310 | a2d1ebaf | pbrook | } |
1311 | a2d1ebaf | pbrook | } |
1312 | 8a93e02a | pbrook | *p = 0;
|
1313 | a2d1ebaf | pbrook | va_end(va); |
1314 | a2d1ebaf | pbrook | put_packet(s, buf); |
1315 | a2d1ebaf | pbrook | #ifdef CONFIG_USER_ONLY
|
1316 | a2d1ebaf | pbrook | gdb_handlesig(s->env, 0);
|
1317 | a2d1ebaf | pbrook | #else
|
1318 | a2d1ebaf | pbrook | cpu_interrupt(s->env, CPU_INTERRUPT_EXIT); |
1319 | a2d1ebaf | pbrook | #endif
|
1320 | a2d1ebaf | pbrook | } |
1321 | a2d1ebaf | pbrook | |
1322 | 6a00d601 | bellard | static void gdb_read_byte(GDBState *s, int ch) |
1323 | 858693c6 | bellard | { |
1324 | 6a00d601 | bellard | CPUState *env = s->env; |
1325 | 858693c6 | bellard | int i, csum;
|
1326 | 60fe76f3 | ths | uint8_t reply; |
1327 | 858693c6 | bellard | |
1328 | 1fddef4b | bellard | #ifndef CONFIG_USER_ONLY
|
1329 | 4046d913 | pbrook | if (s->last_packet_len) {
|
1330 | 4046d913 | pbrook | /* Waiting for a response to the last packet. If we see the start
|
1331 | 4046d913 | pbrook | of a new command then abandon the previous response. */
|
1332 | 4046d913 | pbrook | if (ch == '-') { |
1333 | 4046d913 | pbrook | #ifdef DEBUG_GDB
|
1334 | 4046d913 | pbrook | printf("Got NACK, retransmitting\n");
|
1335 | 4046d913 | pbrook | #endif
|
1336 | ffe8ab83 | ths | put_buffer(s, (uint8_t *)s->last_packet, s->last_packet_len); |
1337 | 4046d913 | pbrook | } |
1338 | 4046d913 | pbrook | #ifdef DEBUG_GDB
|
1339 | 4046d913 | pbrook | else if (ch == '+') |
1340 | 4046d913 | pbrook | printf("Got ACK\n");
|
1341 | 4046d913 | pbrook | else
|
1342 | 4046d913 | pbrook | printf("Got '%c' when expecting ACK/NACK\n", ch);
|
1343 | 4046d913 | pbrook | #endif
|
1344 | 4046d913 | pbrook | if (ch == '+' || ch == '$') |
1345 | 4046d913 | pbrook | s->last_packet_len = 0;
|
1346 | 4046d913 | pbrook | if (ch != '$') |
1347 | 4046d913 | pbrook | return;
|
1348 | 4046d913 | pbrook | } |
1349 | 858693c6 | bellard | if (vm_running) {
|
1350 | 858693c6 | bellard | /* when the CPU is running, we cannot do anything except stop
|
1351 | 858693c6 | bellard | it when receiving a char */
|
1352 | 858693c6 | bellard | vm_stop(EXCP_INTERRUPT); |
1353 | 5fafdf24 | ths | } else
|
1354 | 1fddef4b | bellard | #endif
|
1355 | 41625033 | bellard | { |
1356 | 858693c6 | bellard | switch(s->state) {
|
1357 | 858693c6 | bellard | case RS_IDLE:
|
1358 | 858693c6 | bellard | if (ch == '$') { |
1359 | 858693c6 | bellard | s->line_buf_index = 0;
|
1360 | 858693c6 | bellard | s->state = RS_GETLINE; |
1361 | c33a346e | bellard | } |
1362 | b4608c04 | bellard | break;
|
1363 | 858693c6 | bellard | case RS_GETLINE:
|
1364 | 858693c6 | bellard | if (ch == '#') { |
1365 | 858693c6 | bellard | s->state = RS_CHKSUM1; |
1366 | 858693c6 | bellard | } else if (s->line_buf_index >= sizeof(s->line_buf) - 1) { |
1367 | 858693c6 | bellard | s->state = RS_IDLE; |
1368 | 4c3a88a2 | bellard | } else {
|
1369 | 858693c6 | bellard | s->line_buf[s->line_buf_index++] = ch; |
1370 | 4c3a88a2 | bellard | } |
1371 | 4c3a88a2 | bellard | break;
|
1372 | 858693c6 | bellard | case RS_CHKSUM1:
|
1373 | 858693c6 | bellard | s->line_buf[s->line_buf_index] = '\0';
|
1374 | 858693c6 | bellard | s->line_csum = fromhex(ch) << 4;
|
1375 | 858693c6 | bellard | s->state = RS_CHKSUM2; |
1376 | 858693c6 | bellard | break;
|
1377 | 858693c6 | bellard | case RS_CHKSUM2:
|
1378 | 858693c6 | bellard | s->line_csum |= fromhex(ch); |
1379 | 858693c6 | bellard | csum = 0;
|
1380 | 858693c6 | bellard | for(i = 0; i < s->line_buf_index; i++) { |
1381 | 858693c6 | bellard | csum += s->line_buf[i]; |
1382 | 858693c6 | bellard | } |
1383 | 858693c6 | bellard | if (s->line_csum != (csum & 0xff)) { |
1384 | 60fe76f3 | ths | reply = '-';
|
1385 | 60fe76f3 | ths | put_buffer(s, &reply, 1);
|
1386 | 858693c6 | bellard | s->state = RS_IDLE; |
1387 | 4c3a88a2 | bellard | } else {
|
1388 | 60fe76f3 | ths | reply = '+';
|
1389 | 60fe76f3 | ths | put_buffer(s, &reply, 1);
|
1390 | 1fddef4b | bellard | s->state = gdb_handle_packet(s, env, s->line_buf); |
1391 | 4c3a88a2 | bellard | } |
1392 | 4c3a88a2 | bellard | break;
|
1393 | a2d1ebaf | pbrook | default:
|
1394 | a2d1ebaf | pbrook | abort(); |
1395 | 858693c6 | bellard | } |
1396 | 858693c6 | bellard | } |
1397 | 858693c6 | bellard | } |
1398 | 858693c6 | bellard | |
1399 | 1fddef4b | bellard | #ifdef CONFIG_USER_ONLY
|
1400 | 1fddef4b | bellard | int
|
1401 | 1fddef4b | bellard | gdb_handlesig (CPUState *env, int sig)
|
1402 | 1fddef4b | bellard | { |
1403 | 1fddef4b | bellard | GDBState *s; |
1404 | 1fddef4b | bellard | char buf[256]; |
1405 | 1fddef4b | bellard | int n;
|
1406 | 1fddef4b | bellard | |
1407 | 1fddef4b | bellard | s = &gdbserver_state; |
1408 | 1f487ee9 | edgar_igl | if (gdbserver_fd < 0 || s->fd < 0) |
1409 | 1f487ee9 | edgar_igl | return sig;
|
1410 | 1fddef4b | bellard | |
1411 | 1fddef4b | bellard | /* disable single step if it was enabled */
|
1412 | 1fddef4b | bellard | cpu_single_step(env, 0);
|
1413 | 1fddef4b | bellard | tb_flush(env); |
1414 | 1fddef4b | bellard | |
1415 | 1fddef4b | bellard | if (sig != 0) |
1416 | 1fddef4b | bellard | { |
1417 | 1fddef4b | bellard | snprintf(buf, sizeof(buf), "S%02x", sig); |
1418 | 1fddef4b | bellard | put_packet(s, buf); |
1419 | 1fddef4b | bellard | } |
1420 | 1f487ee9 | edgar_igl | /* put_packet() might have detected that the peer terminated the
|
1421 | 1f487ee9 | edgar_igl | connection. */
|
1422 | 1f487ee9 | edgar_igl | if (s->fd < 0) |
1423 | 1f487ee9 | edgar_igl | return sig;
|
1424 | 1fddef4b | bellard | |
1425 | 1fddef4b | bellard | sig = 0;
|
1426 | 1fddef4b | bellard | s->state = RS_IDLE; |
1427 | 41625033 | bellard | s->running_state = 0;
|
1428 | 41625033 | bellard | while (s->running_state == 0) { |
1429 | 1fddef4b | bellard | n = read (s->fd, buf, 256);
|
1430 | 1fddef4b | bellard | if (n > 0) |
1431 | 1fddef4b | bellard | { |
1432 | 1fddef4b | bellard | int i;
|
1433 | 1fddef4b | bellard | |
1434 | 1fddef4b | bellard | for (i = 0; i < n; i++) |
1435 | 6a00d601 | bellard | gdb_read_byte (s, buf[i]); |
1436 | 1fddef4b | bellard | } |
1437 | 1fddef4b | bellard | else if (n == 0 || errno != EAGAIN) |
1438 | 1fddef4b | bellard | { |
1439 | 1fddef4b | bellard | /* XXX: Connection closed. Should probably wait for annother
|
1440 | 1fddef4b | bellard | connection before continuing. */
|
1441 | 1fddef4b | bellard | return sig;
|
1442 | 1fddef4b | bellard | } |
1443 | 41625033 | bellard | } |
1444 | 1f487ee9 | edgar_igl | sig = s->signal; |
1445 | 1f487ee9 | edgar_igl | s->signal = 0;
|
1446 | 1fddef4b | bellard | return sig;
|
1447 | 1fddef4b | bellard | } |
1448 | e9009676 | bellard | |
1449 | e9009676 | bellard | /* Tell the remote gdb that the process has exited. */
|
1450 | e9009676 | bellard | void gdb_exit(CPUState *env, int code) |
1451 | e9009676 | bellard | { |
1452 | e9009676 | bellard | GDBState *s; |
1453 | e9009676 | bellard | char buf[4]; |
1454 | e9009676 | bellard | |
1455 | e9009676 | bellard | s = &gdbserver_state; |
1456 | 1f487ee9 | edgar_igl | if (gdbserver_fd < 0 || s->fd < 0) |
1457 | 1f487ee9 | edgar_igl | return;
|
1458 | e9009676 | bellard | |
1459 | e9009676 | bellard | snprintf(buf, sizeof(buf), "W%02x", code); |
1460 | e9009676 | bellard | put_packet(s, buf); |
1461 | e9009676 | bellard | } |
1462 | e9009676 | bellard | |
1463 | 1fddef4b | bellard | |
1464 | 7c9d8e07 | bellard | static void gdb_accept(void *opaque) |
1465 | 858693c6 | bellard | { |
1466 | 858693c6 | bellard | GDBState *s; |
1467 | 858693c6 | bellard | struct sockaddr_in sockaddr;
|
1468 | 858693c6 | bellard | socklen_t len; |
1469 | 858693c6 | bellard | int val, fd;
|
1470 | 858693c6 | bellard | |
1471 | 858693c6 | bellard | for(;;) {
|
1472 | 858693c6 | bellard | len = sizeof(sockaddr);
|
1473 | 858693c6 | bellard | fd = accept(gdbserver_fd, (struct sockaddr *)&sockaddr, &len);
|
1474 | 858693c6 | bellard | if (fd < 0 && errno != EINTR) { |
1475 | 858693c6 | bellard | perror("accept");
|
1476 | 858693c6 | bellard | return;
|
1477 | 858693c6 | bellard | } else if (fd >= 0) { |
1478 | b4608c04 | bellard | break;
|
1479 | b4608c04 | bellard | } |
1480 | b4608c04 | bellard | } |
1481 | 858693c6 | bellard | |
1482 | 858693c6 | bellard | /* set short latency */
|
1483 | 858693c6 | bellard | val = 1;
|
1484 | 8f447cc7 | bellard | setsockopt(fd, IPPROTO_TCP, TCP_NODELAY, (char *)&val, sizeof(val)); |
1485 | 3b46e624 | ths | |
1486 | 1fddef4b | bellard | s = &gdbserver_state; |
1487 | 1fddef4b | bellard | memset (s, 0, sizeof (GDBState)); |
1488 | 6a00d601 | bellard | s->env = first_cpu; /* XXX: allow to change CPU */
|
1489 | 858693c6 | bellard | s->fd = fd; |
1490 | 858693c6 | bellard | |
1491 | a2d1ebaf | pbrook | gdb_syscall_state = s; |
1492 | a2d1ebaf | pbrook | |
1493 | 858693c6 | bellard | fcntl(fd, F_SETFL, O_NONBLOCK); |
1494 | 858693c6 | bellard | } |
1495 | 858693c6 | bellard | |
1496 | 858693c6 | bellard | static int gdbserver_open(int port) |
1497 | 858693c6 | bellard | { |
1498 | 858693c6 | bellard | struct sockaddr_in sockaddr;
|
1499 | 858693c6 | bellard | int fd, val, ret;
|
1500 | 858693c6 | bellard | |
1501 | 858693c6 | bellard | fd = socket(PF_INET, SOCK_STREAM, 0);
|
1502 | 858693c6 | bellard | if (fd < 0) { |
1503 | 858693c6 | bellard | perror("socket");
|
1504 | 858693c6 | bellard | return -1; |
1505 | 858693c6 | bellard | } |
1506 | 858693c6 | bellard | |
1507 | 858693c6 | bellard | /* allow fast reuse */
|
1508 | 858693c6 | bellard | val = 1;
|
1509 | 8f447cc7 | bellard | setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, (char *)&val, sizeof(val)); |
1510 | 858693c6 | bellard | |
1511 | 858693c6 | bellard | sockaddr.sin_family = AF_INET; |
1512 | 858693c6 | bellard | sockaddr.sin_port = htons(port); |
1513 | 858693c6 | bellard | sockaddr.sin_addr.s_addr = 0;
|
1514 | 858693c6 | bellard | ret = bind(fd, (struct sockaddr *)&sockaddr, sizeof(sockaddr)); |
1515 | 858693c6 | bellard | if (ret < 0) { |
1516 | 858693c6 | bellard | perror("bind");
|
1517 | 858693c6 | bellard | return -1; |
1518 | 858693c6 | bellard | } |
1519 | 858693c6 | bellard | ret = listen(fd, 0);
|
1520 | 858693c6 | bellard | if (ret < 0) { |
1521 | 858693c6 | bellard | perror("listen");
|
1522 | 858693c6 | bellard | return -1; |
1523 | 858693c6 | bellard | } |
1524 | 858693c6 | bellard | return fd;
|
1525 | 858693c6 | bellard | } |
1526 | 858693c6 | bellard | |
1527 | 858693c6 | bellard | int gdbserver_start(int port) |
1528 | 858693c6 | bellard | { |
1529 | 858693c6 | bellard | gdbserver_fd = gdbserver_open(port); |
1530 | 858693c6 | bellard | if (gdbserver_fd < 0) |
1531 | 858693c6 | bellard | return -1; |
1532 | 858693c6 | bellard | /* accept connections */
|
1533 | 7c9d8e07 | bellard | gdb_accept (NULL);
|
1534 | 4046d913 | pbrook | return 0; |
1535 | 4046d913 | pbrook | } |
1536 | 1fddef4b | bellard | #else
|
1537 | aa1f17c1 | ths | static int gdb_chr_can_receive(void *opaque) |
1538 | 4046d913 | pbrook | { |
1539 | 4046d913 | pbrook | return 1; |
1540 | 4046d913 | pbrook | } |
1541 | 4046d913 | pbrook | |
1542 | aa1f17c1 | ths | static void gdb_chr_receive(void *opaque, const uint8_t *buf, int size) |
1543 | 4046d913 | pbrook | { |
1544 | 4046d913 | pbrook | GDBState *s = opaque; |
1545 | 4046d913 | pbrook | int i;
|
1546 | 4046d913 | pbrook | |
1547 | 4046d913 | pbrook | for (i = 0; i < size; i++) { |
1548 | 4046d913 | pbrook | gdb_read_byte(s, buf[i]); |
1549 | 4046d913 | pbrook | } |
1550 | 4046d913 | pbrook | } |
1551 | 4046d913 | pbrook | |
1552 | 4046d913 | pbrook | static void gdb_chr_event(void *opaque, int event) |
1553 | 4046d913 | pbrook | { |
1554 | 4046d913 | pbrook | switch (event) {
|
1555 | 4046d913 | pbrook | case CHR_EVENT_RESET:
|
1556 | 4046d913 | pbrook | vm_stop(EXCP_INTERRUPT); |
1557 | a2d1ebaf | pbrook | gdb_syscall_state = opaque; |
1558 | 4046d913 | pbrook | break;
|
1559 | 4046d913 | pbrook | default:
|
1560 | 4046d913 | pbrook | break;
|
1561 | 4046d913 | pbrook | } |
1562 | 4046d913 | pbrook | } |
1563 | 4046d913 | pbrook | |
1564 | cfc3475a | pbrook | int gdbserver_start(const char *port) |
1565 | 4046d913 | pbrook | { |
1566 | 4046d913 | pbrook | GDBState *s; |
1567 | cfc3475a | pbrook | char gdbstub_port_name[128]; |
1568 | cfc3475a | pbrook | int port_num;
|
1569 | cfc3475a | pbrook | char *p;
|
1570 | cfc3475a | pbrook | CharDriverState *chr; |
1571 | cfc3475a | pbrook | |
1572 | cfc3475a | pbrook | if (!port || !*port)
|
1573 | cfc3475a | pbrook | return -1; |
1574 | 4046d913 | pbrook | |
1575 | cfc3475a | pbrook | port_num = strtol(port, &p, 10);
|
1576 | cfc3475a | pbrook | if (*p == 0) { |
1577 | cfc3475a | pbrook | /* A numeric value is interpreted as a port number. */
|
1578 | cfc3475a | pbrook | snprintf(gdbstub_port_name, sizeof(gdbstub_port_name),
|
1579 | cfc3475a | pbrook | "tcp::%d,nowait,nodelay,server", port_num);
|
1580 | cfc3475a | pbrook | port = gdbstub_port_name; |
1581 | cfc3475a | pbrook | } |
1582 | cfc3475a | pbrook | |
1583 | cfc3475a | pbrook | chr = qemu_chr_open(port); |
1584 | 4046d913 | pbrook | if (!chr)
|
1585 | 4046d913 | pbrook | return -1; |
1586 | 4046d913 | pbrook | |
1587 | 4046d913 | pbrook | s = qemu_mallocz(sizeof(GDBState));
|
1588 | 4046d913 | pbrook | if (!s) {
|
1589 | 4046d913 | pbrook | return -1; |
1590 | 4046d913 | pbrook | } |
1591 | 4046d913 | pbrook | s->env = first_cpu; /* XXX: allow to change CPU */
|
1592 | 4046d913 | pbrook | s->chr = chr; |
1593 | aa1f17c1 | ths | qemu_chr_add_handlers(chr, gdb_chr_can_receive, gdb_chr_receive, |
1594 | 4046d913 | pbrook | gdb_chr_event, s); |
1595 | 4046d913 | pbrook | qemu_add_vm_stop_handler(gdb_vm_stopped, s); |
1596 | b4608c04 | bellard | return 0; |
1597 | b4608c04 | bellard | } |
1598 | 4046d913 | pbrook | #endif |