[7cc6ac0] | 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 | }
|
---|