1 | /*
|
---|
2 | * Copyright (C) 2017 The Contributors
|
---|
3 | *
|
---|
4 | * This program is free software: you can redistribute it and/or modify
|
---|
5 | * it under the terms of the GNU General Public License as published by
|
---|
6 | * the Free Software Foundation, either version 3 of the License, or (at
|
---|
7 | * your option) any later version.
|
---|
8 | *
|
---|
9 | * This program is distributed in the hope that it will be useful, but
|
---|
10 | * WITHOUT ANY WARRANTY; without even the implied warranty of
|
---|
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
---|
12 | * General Public License for more details.
|
---|
13 | *
|
---|
14 | * A copy of the GNU General Public License can be found in the file
|
---|
15 | * "gpl.txt" in the top directory of this repository.
|
---|
16 | */
|
---|
17 |
|
---|
18 | #include <all.h>
|
---|
19 |
|
---|
20 | #define ver(...) _ver(gdb_verbose, 0, __VA_ARGS__)
|
---|
21 | #define ver2(...) _ver(gdb_verbose, 1, __VA_ARGS__)
|
---|
22 | #define ver3(...) _ver(gdb_verbose, 2, __VA_ARGS__)
|
---|
23 |
|
---|
24 | int32_t gdb_verbose = 0;
|
---|
25 |
|
---|
26 | #define PORT 12053
|
---|
27 | #define SZ_BUF 10000
|
---|
28 |
|
---|
29 | #define RES_ERR \
|
---|
30 | ((result_t){ .ok = false })
|
---|
31 |
|
---|
32 | #define RES_OK \
|
---|
33 | ((result_t){ .ok = true })
|
---|
34 |
|
---|
35 | #define RES_DAT(_out, _n_out) \
|
---|
36 | ((result_t){ .ok = true, .out = (uint8_t *)_out, .n_out = (int32_t)_n_out })
|
---|
37 |
|
---|
38 | #define LOCK_NONE 0
|
---|
39 | #define LOCK_REQ 1
|
---|
40 | #define LOCK_ACK 2
|
---|
41 |
|
---|
42 | typedef enum {
|
---|
43 | STATE_HEAD,
|
---|
44 | STATE_DATA,
|
---|
45 | STATE_CHECK_1,
|
---|
46 | STATE_CHECK_2,
|
---|
47 | STATE_ACK
|
---|
48 | } state_t;
|
---|
49 |
|
---|
50 | typedef struct {
|
---|
51 | bool ok;
|
---|
52 | const uint8_t *out;
|
---|
53 | int32_t n_out;
|
---|
54 | } result_t;
|
---|
55 |
|
---|
56 | static TCPsocket lis;
|
---|
57 | static SDLNet_SocketSet set;
|
---|
58 |
|
---|
59 | static state_t state;
|
---|
60 | static SDL_atomic_t lock;
|
---|
61 |
|
---|
62 | void gdb_init(void)
|
---|
63 | {
|
---|
64 | ver("gdb init");
|
---|
65 |
|
---|
66 | IPaddress addr;
|
---|
67 |
|
---|
68 | if (SDLNet_ResolveHost(&addr, NULL, PORT) < 0) {
|
---|
69 | fail("SDLNet_ResolveHost() failed: %s", SDLNet_GetError());
|
---|
70 | }
|
---|
71 |
|
---|
72 | lis = SDLNet_TCP_Open(&addr);
|
---|
73 |
|
---|
74 | if (lis == NULL) {
|
---|
75 | fail("SDLNet_TCP_Open() failed: %s", SDLNet_GetError());
|
---|
76 | }
|
---|
77 |
|
---|
78 | set = SDLNet_AllocSocketSet(2);
|
---|
79 |
|
---|
80 | if (set == NULL) {
|
---|
81 | fail("SDLNet_AllocSocketSet() failed: %s", SDLNet_GetError());
|
---|
82 | }
|
---|
83 |
|
---|
84 | if (SDLNet_TCP_AddSocket(set, lis) < 0) {
|
---|
85 | fail("SDLNet_AddSocket() failed: %s", SDLNet_GetError());
|
---|
86 | }
|
---|
87 |
|
---|
88 | SDL_AtomicSet(&lock, 0);
|
---|
89 | }
|
---|
90 |
|
---|
91 | void gdb_quit(void)
|
---|
92 | {
|
---|
93 | ver("gdb quit");
|
---|
94 |
|
---|
95 | SDLNet_FreeSocketSet(set);
|
---|
96 | SDLNet_TCP_Close(lis);
|
---|
97 | }
|
---|
98 |
|
---|
99 | void gdb_inst(void)
|
---|
100 | {
|
---|
101 | ver3("gdb inst");
|
---|
102 |
|
---|
103 | if (SDL_AtomicGet(&lock) == LOCK_NONE) {
|
---|
104 | return;
|
---|
105 | }
|
---|
106 |
|
---|
107 | if (SDL_UnlockMutex(cpu_mutex) < 0) {
|
---|
108 | fail("SDL_UnlockMutex() failed: %s", SDL_GetError());
|
---|
109 | }
|
---|
110 |
|
---|
111 | ver2("<- lock req");
|
---|
112 | ver2("-> lock ack");
|
---|
113 | SDL_AtomicSet(&lock, LOCK_ACK);
|
---|
114 |
|
---|
115 | while (SDL_AtomicGet(&lock) == LOCK_ACK) {
|
---|
116 | SDL_Delay(100);
|
---|
117 | }
|
---|
118 |
|
---|
119 | ver2("<- lock none");
|
---|
120 |
|
---|
121 | if (SDL_LockMutex(cpu_mutex) < 0) {
|
---|
122 | fail("SDL_LockMutex() failed: %s", SDL_GetError());
|
---|
123 | }
|
---|
124 | }
|
---|
125 |
|
---|
126 | static void lock_cpu(void)
|
---|
127 | {
|
---|
128 | ver2("-> lock req");
|
---|
129 | SDL_AtomicSet(&lock, LOCK_REQ);
|
---|
130 |
|
---|
131 | while (SDL_AtomicGet(&lock) == LOCK_REQ) {
|
---|
132 | SDL_Delay(100);
|
---|
133 | }
|
---|
134 |
|
---|
135 | ver2("<- lock ack");
|
---|
136 | }
|
---|
137 |
|
---|
138 | static void free_cpu(void)
|
---|
139 | {
|
---|
140 | ver2("-> lock none");
|
---|
141 | SDL_AtomicSet(&lock, LOCK_NONE);
|
---|
142 | }
|
---|
143 |
|
---|
144 | static result_t com_reason(void)
|
---|
145 | {
|
---|
146 | return RES_DAT("S0a", 4);
|
---|
147 | }
|
---|
148 |
|
---|
149 | static result_t com_cont(char *req)
|
---|
150 | {
|
---|
151 | return RES_DAT("", 0);
|
---|
152 | }
|
---|
153 |
|
---|
154 | static result_t com_step(char *req)
|
---|
155 | {
|
---|
156 | return RES_DAT("", 0);
|
---|
157 | }
|
---|
158 |
|
---|
159 | static result_t com_rd_reg(void)
|
---|
160 | {
|
---|
161 | static char buf[(8 + 8 + 2) * 8 + 1];
|
---|
162 |
|
---|
163 | if (SDL_LockMutex(cpu_mutex) < 0) {
|
---|
164 | fail("SDL_LockMutex() failed: %s", SDL_GetError());
|
---|
165 | }
|
---|
166 |
|
---|
167 | uint32_t d0 = m68k_get_reg(NULL, M68K_REG_D0);
|
---|
168 | uint32_t d1 = m68k_get_reg(NULL, M68K_REG_D1);
|
---|
169 | uint32_t d2 = m68k_get_reg(NULL, M68K_REG_D2);
|
---|
170 | uint32_t d3 = m68k_get_reg(NULL, M68K_REG_D3);
|
---|
171 | uint32_t d4 = m68k_get_reg(NULL, M68K_REG_D4);
|
---|
172 | uint32_t d5 = m68k_get_reg(NULL, M68K_REG_D5);
|
---|
173 | uint32_t d6 = m68k_get_reg(NULL, M68K_REG_D6);
|
---|
174 | uint32_t d7 = m68k_get_reg(NULL, M68K_REG_D7);
|
---|
175 |
|
---|
176 | uint32_t a0 = m68k_get_reg(NULL, M68K_REG_A0);
|
---|
177 | uint32_t a1 = m68k_get_reg(NULL, M68K_REG_A1);
|
---|
178 | uint32_t a2 = m68k_get_reg(NULL, M68K_REG_A2);
|
---|
179 | uint32_t a3 = m68k_get_reg(NULL, M68K_REG_A3);
|
---|
180 | uint32_t a4 = m68k_get_reg(NULL, M68K_REG_A4);
|
---|
181 | uint32_t a5 = m68k_get_reg(NULL, M68K_REG_A5);
|
---|
182 | uint32_t a6 = m68k_get_reg(NULL, M68K_REG_A6);
|
---|
183 | uint32_t a7 = m68k_get_reg(NULL, M68K_REG_A7);
|
---|
184 |
|
---|
185 | uint32_t ps = m68k_get_reg(NULL, M68K_REG_SR);
|
---|
186 | uint32_t pc = m68k_get_reg(NULL, M68K_REG_PC);
|
---|
187 |
|
---|
188 | if (SDL_UnlockMutex(cpu_mutex) < 0) {
|
---|
189 | fail("SDL_UnlockMutex() failed: %s", SDL_GetError());
|
---|
190 | }
|
---|
191 |
|
---|
192 | sprintf(buf,
|
---|
193 | "%08x%08x%08x%08x%08x%08x%08x%08x"
|
---|
194 | "%08x%08x%08x%08x%08x%08x%08x%08x"
|
---|
195 | "%08x%08x",
|
---|
196 | d0, d1, d2, d3, d4, d5, d6, d7,
|
---|
197 | a0, a1, a2, a3, a4, a5, a6, a7,
|
---|
198 | ps, pc);
|
---|
199 |
|
---|
200 | return RES_DAT(buf, sizeof buf - 1);
|
---|
201 | }
|
---|
202 |
|
---|
203 | static result_t com_wr_reg(char *req)
|
---|
204 | {
|
---|
205 | uint32_t d0, d1, d2, d3, d4, d5, d6, d7;
|
---|
206 | uint32_t a0, a1, a2, a3, a4, a5, a6, a7;
|
---|
207 | uint32_t ps, pc;
|
---|
208 |
|
---|
209 | if (sscanf(req + 1,
|
---|
210 | "%08x%08x%08x%08x%08x%08x%08x%08x"
|
---|
211 | "%08x%08x%08x%08x%08x%08x%08x%08x"
|
---|
212 | "%08x%08x",
|
---|
213 | &d0, &d1, &d2, &d3, &d4, &d5, &d6, &d7,
|
---|
214 | &a0, &a1, &a2, &a3, &a4, &a5, &a6, &a7,
|
---|
215 | &ps, &pc) != 8 + 8 + 2) {
|
---|
216 | return RES_DAT("E01", 3);
|
---|
217 | }
|
---|
218 |
|
---|
219 | if (SDL_LockMutex(cpu_mutex) < 0) {
|
---|
220 | fail("SDL_LockMutex() failed: %s", SDL_GetError());
|
---|
221 | }
|
---|
222 |
|
---|
223 | m68k_set_reg(M68K_REG_D0, d0);
|
---|
224 | m68k_set_reg(M68K_REG_D1, d1);
|
---|
225 | m68k_set_reg(M68K_REG_D2, d2);
|
---|
226 | m68k_set_reg(M68K_REG_D3, d3);
|
---|
227 | m68k_set_reg(M68K_REG_D4, d4);
|
---|
228 | m68k_set_reg(M68K_REG_D5, d5);
|
---|
229 | m68k_set_reg(M68K_REG_D6, d6);
|
---|
230 | m68k_set_reg(M68K_REG_D7, d7);
|
---|
231 |
|
---|
232 | m68k_set_reg(M68K_REG_A0, a0);
|
---|
233 | m68k_set_reg(M68K_REG_A1, a1);
|
---|
234 | m68k_set_reg(M68K_REG_A2, a2);
|
---|
235 | m68k_set_reg(M68K_REG_A3, a3);
|
---|
236 | m68k_set_reg(M68K_REG_A4, a4);
|
---|
237 | m68k_set_reg(M68K_REG_A5, a5);
|
---|
238 | m68k_set_reg(M68K_REG_A6, a6);
|
---|
239 | m68k_set_reg(M68K_REG_A7, a7);
|
---|
240 |
|
---|
241 | m68k_set_reg(M68K_REG_SR, ps);
|
---|
242 | m68k_set_reg(M68K_REG_PC, pc);
|
---|
243 |
|
---|
244 | if (SDL_UnlockMutex(cpu_mutex) < 0) {
|
---|
245 | fail("SDL_UnlockMutex() failed: %s", SDL_GetError());
|
---|
246 | }
|
---|
247 |
|
---|
248 | return RES_DAT("OK", 2);
|
---|
249 | }
|
---|
250 |
|
---|
251 | static result_t com_rd_mem(char *req)
|
---|
252 | {
|
---|
253 | return RES_DAT("", 0);
|
---|
254 | }
|
---|
255 |
|
---|
256 | static result_t com_wr_mem(char *req)
|
---|
257 | {
|
---|
258 | return RES_DAT("", 0);
|
---|
259 | }
|
---|
260 |
|
---|
261 | static result_t handle(char *req)
|
---|
262 | {
|
---|
263 | result_t res;
|
---|
264 |
|
---|
265 | switch (req[0]) {
|
---|
266 | case '?':
|
---|
267 | res = com_reason();
|
---|
268 | break;
|
---|
269 |
|
---|
270 | case 'c':
|
---|
271 | res = com_cont(req);
|
---|
272 | break;
|
---|
273 |
|
---|
274 | case 's':
|
---|
275 | res = com_step(req);
|
---|
276 | break;
|
---|
277 |
|
---|
278 | case 'g':
|
---|
279 | res = com_rd_reg();
|
---|
280 | break;
|
---|
281 |
|
---|
282 | case 'G':
|
---|
283 | res = com_wr_reg(req);
|
---|
284 | break;
|
---|
285 |
|
---|
286 | case 'm':
|
---|
287 | res = com_rd_mem(req);
|
---|
288 | break;
|
---|
289 |
|
---|
290 | case 'M':
|
---|
291 | res = com_wr_mem(req);
|
---|
292 | break;
|
---|
293 |
|
---|
294 | default:
|
---|
295 | res = RES_DAT("", 0);
|
---|
296 | break;
|
---|
297 | }
|
---|
298 |
|
---|
299 | if (!res.ok || res.n_out > SZ_BUF - 5) {
|
---|
300 | fail("unexpected result");
|
---|
301 | }
|
---|
302 |
|
---|
303 | static const uint8_t *hex = (uint8_t *)"0123456789abcdef";
|
---|
304 | static uint8_t buf[SZ_BUF];
|
---|
305 |
|
---|
306 | buf[0] = '$';
|
---|
307 | memcpy(buf + 1, res.out, (size_t)res.n_out);
|
---|
308 |
|
---|
309 | int32_t sum = 0;
|
---|
310 |
|
---|
311 | for (int32_t i = 0; i < res.n_out; ++i) {
|
---|
312 | sum = (sum + res.out[i]) % 256;
|
---|
313 | }
|
---|
314 |
|
---|
315 | buf[res.n_out + 1] = '#';
|
---|
316 | buf[res.n_out + 2] = hex[sum / 16];
|
---|
317 | buf[res.n_out + 3] = hex[sum % 16];
|
---|
318 | buf[res.n_out + 4] = 0;
|
---|
319 |
|
---|
320 | ver2("resp %s", (char *)buf);
|
---|
321 | return RES_DAT(buf, res.n_out + 4);
|
---|
322 | }
|
---|
323 |
|
---|
324 | static int32_t hex_digit(uint8_t byte)
|
---|
325 | {
|
---|
326 | if (byte >= '0' && byte <= '9') {
|
---|
327 | return byte - '0';
|
---|
328 | }
|
---|
329 |
|
---|
330 | if (byte >= 'a' && byte <= 'f') {
|
---|
331 | return 10 + byte - 'a';
|
---|
332 | }
|
---|
333 |
|
---|
334 | if (byte >= 'A' && byte <= 'F') {
|
---|
335 | return 10 + byte - 'A';
|
---|
336 | }
|
---|
337 |
|
---|
338 | return -1;
|
---|
339 | }
|
---|
340 |
|
---|
341 | static result_t input(uint8_t byte)
|
---|
342 | {
|
---|
343 | static int32_t n_buf;
|
---|
344 | static uint8_t buf[SZ_BUF];
|
---|
345 | static int32_t sum;
|
---|
346 | static int32_t check;
|
---|
347 |
|
---|
348 | int32_t hex;
|
---|
349 | result_t res;
|
---|
350 |
|
---|
351 | ver3("input %c st %d n %d", byte, (int32_t)state, n_buf);
|
---|
352 |
|
---|
353 | switch (state) {
|
---|
354 | case STATE_HEAD:
|
---|
355 | if (byte != '$') {
|
---|
356 | err("expected '$'");
|
---|
357 | return RES_ERR;
|
---|
358 | }
|
---|
359 |
|
---|
360 | sum = 0;
|
---|
361 | n_buf = 0;
|
---|
362 | state = STATE_DATA;
|
---|
363 | return RES_OK;
|
---|
364 |
|
---|
365 | case STATE_DATA:
|
---|
366 | if (n_buf == SZ_BUF - 1) {
|
---|
367 | err("packet too long");
|
---|
368 | return RES_ERR;
|
---|
369 | }
|
---|
370 |
|
---|
371 | if (byte == '#') {
|
---|
372 | state = STATE_CHECK_1;
|
---|
373 | return RES_DAT("+", 1);
|
---|
374 | }
|
---|
375 |
|
---|
376 | sum = (sum + byte) % 256;
|
---|
377 | buf[n_buf] = byte;
|
---|
378 | ++n_buf;
|
---|
379 | return RES_OK;
|
---|
380 |
|
---|
381 | case STATE_CHECK_1:
|
---|
382 | hex = hex_digit(byte);
|
---|
383 |
|
---|
384 | if (hex < 0) {
|
---|
385 | err("malformed checksum (0x%02x)", byte);
|
---|
386 | return RES_ERR;
|
---|
387 | }
|
---|
388 |
|
---|
389 | check = hex << 4;
|
---|
390 | state = STATE_CHECK_2;
|
---|
391 | return RES_OK;
|
---|
392 |
|
---|
393 | case STATE_CHECK_2:
|
---|
394 | hex = hex_digit(byte);
|
---|
395 |
|
---|
396 | if (hex < 0) {
|
---|
397 | err("malformed checksum (0x%02x)", byte);
|
---|
398 | return RES_ERR;
|
---|
399 | }
|
---|
400 |
|
---|
401 | check |= hex;
|
---|
402 |
|
---|
403 | if (sum != check) {
|
---|
404 | err("invalid checksum");
|
---|
405 | return RES_ERR;
|
---|
406 | }
|
---|
407 |
|
---|
408 | buf[n_buf] = 0;
|
---|
409 | ver2("pack %s", buf);
|
---|
410 |
|
---|
411 | res = handle((char *)buf);
|
---|
412 |
|
---|
413 | if (!res.ok) {
|
---|
414 | return RES_ERR;
|
---|
415 | }
|
---|
416 |
|
---|
417 | state = STATE_ACK;
|
---|
418 | return RES_DAT(res.out, res.n_out);
|
---|
419 |
|
---|
420 | case STATE_ACK:
|
---|
421 | if (byte != '+') {
|
---|
422 | err("invalid ACK (0x%02x)", byte);
|
---|
423 | return RES_ERR;
|
---|
424 | }
|
---|
425 |
|
---|
426 | state = STATE_HEAD;
|
---|
427 | return RES_OK;
|
---|
428 |
|
---|
429 | default:
|
---|
430 | fail("invalid state");
|
---|
431 | }
|
---|
432 |
|
---|
433 | // not reached, but Eclipse doesn't know
|
---|
434 | return RES_ERR;
|
---|
435 | }
|
---|
436 |
|
---|
437 | static void con_close(TCPsocket con)
|
---|
438 | {
|
---|
439 | if (SDLNet_TCP_DelSocket(set, con) < 0) {
|
---|
440 | fail("SDLNet_TCP_DelSocket() failed: %s", SDLNet_GetError());
|
---|
441 | }
|
---|
442 |
|
---|
443 | SDLNet_TCP_Close(con);
|
---|
444 | free_cpu();
|
---|
445 | }
|
---|
446 |
|
---|
447 | void gdb_loop(void)
|
---|
448 | {
|
---|
449 | inf("entering GDB loop");
|
---|
450 | TCPsocket con = NULL;
|
---|
451 |
|
---|
452 | while (SDL_AtomicGet(&run) != 0) {
|
---|
453 | int32_t n_act = SDLNet_CheckSockets(set, 250);
|
---|
454 |
|
---|
455 | if (n_act < 0) {
|
---|
456 | fail("SDLNet_CheckSockets() failed: %s", SDLNet_GetError());
|
---|
457 | }
|
---|
458 |
|
---|
459 | if (n_act == 0) {
|
---|
460 | continue;
|
---|
461 | }
|
---|
462 |
|
---|
463 | if (SDLNet_SocketReady(lis) != 0) {
|
---|
464 | ver("incoming connection");
|
---|
465 |
|
---|
466 | if (con != NULL) {
|
---|
467 | ver("closing old");
|
---|
468 | con_close(con);
|
---|
469 | }
|
---|
470 |
|
---|
471 | ver("accepting new");
|
---|
472 | con = SDLNet_TCP_Accept(lis);
|
---|
473 |
|
---|
474 | if (con == NULL) {
|
---|
475 | fail("SDLNet_TCP_Accept() failed: %s", SDLNet_GetError());
|
---|
476 | }
|
---|
477 |
|
---|
478 | if (SDLNet_TCP_AddSocket(set, con) < 0) {
|
---|
479 | fail("SDLNet_AddSocket() failed: %s", SDLNet_GetError());
|
---|
480 | }
|
---|
481 |
|
---|
482 | lock_cpu();
|
---|
483 | state = STATE_ACK;
|
---|
484 | continue;
|
---|
485 | }
|
---|
486 |
|
---|
487 | if (con == NULL || SDLNet_SocketReady(con) == 0) {
|
---|
488 | continue;
|
---|
489 | }
|
---|
490 |
|
---|
491 | ver3("reading");
|
---|
492 | uint8_t byte;
|
---|
493 |
|
---|
494 | if (SDLNet_TCP_Recv(con, &byte, 1) < 1) {
|
---|
495 | ver("peer closed");
|
---|
496 | con_close(con);
|
---|
497 | con = NULL;
|
---|
498 | continue;
|
---|
499 | }
|
---|
500 |
|
---|
501 | result_t res = input(byte);
|
---|
502 |
|
---|
503 | if (!res.ok) {
|
---|
504 | err("invalid packet from GDB");
|
---|
505 | con_close(con);
|
---|
506 | con = NULL;
|
---|
507 | continue;
|
---|
508 | }
|
---|
509 |
|
---|
510 | if (res.out == NULL) {
|
---|
511 | continue;
|
---|
512 | }
|
---|
513 |
|
---|
514 | if (SDLNet_TCP_Send(con, res.out, res.n_out) != res.n_out) {
|
---|
515 | err("connection error");
|
---|
516 | con_close(con);
|
---|
517 | con = NULL;
|
---|
518 | continue;
|
---|
519 | }
|
---|
520 | }
|
---|
521 |
|
---|
522 | if (con != NULL) {
|
---|
523 | con_close(con);
|
---|
524 | }
|
---|
525 |
|
---|
526 | inf("leaving GDB loop");
|
---|
527 | }
|
---|