gdbstub.c 43.2 KB
Newer Older
B
bellard 已提交
1 2
/*
 * gdb server stub
3
 *
B
bellard 已提交
4
 * Copyright (c) 2003-2005 Fabrice Bellard
B
bellard 已提交
5 6 7 8 9 10 11 12 13 14 15 16
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
17
 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
B
bellard 已提交
18
 */
19
#include "config.h"
P
pbrook 已提交
20
#include "qemu-common.h"
B
bellard 已提交
21 22 23 24 25 26 27
#ifdef CONFIG_USER_ONLY
#include <stdlib.h>
#include <stdio.h>
#include <stdarg.h>
#include <string.h>
#include <errno.h>
#include <unistd.h>
28
#include <fcntl.h>
B
bellard 已提交
29 30 31

#include "qemu.h"
#else
32
#include "monitor/monitor.h"
33
#include "sysemu/char.h"
34
#include "sysemu/sysemu.h"
35
#include "exec/gdbstub.h"
B
bellard 已提交
36
#endif
B
bellard 已提交
37

P
pbrook 已提交
38 39
#define MAX_PACKET_LENGTH 4096

40
#include "cpu.h"
41
#include "qemu/sockets.h"
42
#include "sysemu/kvm.h"
43

44 45
static inline int target_memory_rw_debug(CPUState *cpu, target_ulong addr,
                                         uint8_t *buf, int len, bool is_write)
46
{
47 48 49 50 51 52
    CPUClass *cc = CPU_GET_CLASS(cpu);

    if (cc->memory_rw_debug) {
        return cc->memory_rw_debug(cpu, addr, buf, len, is_write);
    }
    return cpu_memory_rw_debug(cpu, addr, buf, len, is_write);
53
}
54 55 56 57

enum {
    GDB_SIGNAL_0 = 0,
    GDB_SIGNAL_INT = 2,
58
    GDB_SIGNAL_QUIT = 3,
59
    GDB_SIGNAL_TRAP = 5,
60 61 62 63
    GDB_SIGNAL_ABRT = 6,
    GDB_SIGNAL_ALRM = 14,
    GDB_SIGNAL_IO = 23,
    GDB_SIGNAL_XCPU = 24,
64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106
    GDB_SIGNAL_UNKNOWN = 143
};

#ifdef CONFIG_USER_ONLY

/* Map target signal numbers to GDB protocol signal numbers and vice
 * versa.  For user emulation's currently supported systems, we can
 * assume most signals are defined.
 */

static int gdb_signal_table[] = {
    0,
    TARGET_SIGHUP,
    TARGET_SIGINT,
    TARGET_SIGQUIT,
    TARGET_SIGILL,
    TARGET_SIGTRAP,
    TARGET_SIGABRT,
    -1, /* SIGEMT */
    TARGET_SIGFPE,
    TARGET_SIGKILL,
    TARGET_SIGBUS,
    TARGET_SIGSEGV,
    TARGET_SIGSYS,
    TARGET_SIGPIPE,
    TARGET_SIGALRM,
    TARGET_SIGTERM,
    TARGET_SIGURG,
    TARGET_SIGSTOP,
    TARGET_SIGTSTP,
    TARGET_SIGCONT,
    TARGET_SIGCHLD,
    TARGET_SIGTTIN,
    TARGET_SIGTTOU,
    TARGET_SIGIO,
    TARGET_SIGXCPU,
    TARGET_SIGXFSZ,
    TARGET_SIGVTALRM,
    TARGET_SIGPROF,
    TARGET_SIGWINCH,
    -1, /* SIGLOST */
    TARGET_SIGUSR1,
    TARGET_SIGUSR2,
B
blueswir1 已提交
107
#ifdef TARGET_SIGPWR
108
    TARGET_SIGPWR,
B
blueswir1 已提交
109 110 111
#else
    -1,
#endif
112 113 114 115 116 117 118 119 120 121 122 123
    -1, /* SIGPOLL */
    -1,
    -1,
    -1,
    -1,
    -1,
    -1,
    -1,
    -1,
    -1,
    -1,
    -1,
B
blueswir1 已提交
124
#ifdef __SIGRTMIN
125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230
    __SIGRTMIN + 1,
    __SIGRTMIN + 2,
    __SIGRTMIN + 3,
    __SIGRTMIN + 4,
    __SIGRTMIN + 5,
    __SIGRTMIN + 6,
    __SIGRTMIN + 7,
    __SIGRTMIN + 8,
    __SIGRTMIN + 9,
    __SIGRTMIN + 10,
    __SIGRTMIN + 11,
    __SIGRTMIN + 12,
    __SIGRTMIN + 13,
    __SIGRTMIN + 14,
    __SIGRTMIN + 15,
    __SIGRTMIN + 16,
    __SIGRTMIN + 17,
    __SIGRTMIN + 18,
    __SIGRTMIN + 19,
    __SIGRTMIN + 20,
    __SIGRTMIN + 21,
    __SIGRTMIN + 22,
    __SIGRTMIN + 23,
    __SIGRTMIN + 24,
    __SIGRTMIN + 25,
    __SIGRTMIN + 26,
    __SIGRTMIN + 27,
    __SIGRTMIN + 28,
    __SIGRTMIN + 29,
    __SIGRTMIN + 30,
    __SIGRTMIN + 31,
    -1, /* SIGCANCEL */
    __SIGRTMIN,
    __SIGRTMIN + 32,
    __SIGRTMIN + 33,
    __SIGRTMIN + 34,
    __SIGRTMIN + 35,
    __SIGRTMIN + 36,
    __SIGRTMIN + 37,
    __SIGRTMIN + 38,
    __SIGRTMIN + 39,
    __SIGRTMIN + 40,
    __SIGRTMIN + 41,
    __SIGRTMIN + 42,
    __SIGRTMIN + 43,
    __SIGRTMIN + 44,
    __SIGRTMIN + 45,
    __SIGRTMIN + 46,
    __SIGRTMIN + 47,
    __SIGRTMIN + 48,
    __SIGRTMIN + 49,
    __SIGRTMIN + 50,
    __SIGRTMIN + 51,
    __SIGRTMIN + 52,
    __SIGRTMIN + 53,
    __SIGRTMIN + 54,
    __SIGRTMIN + 55,
    __SIGRTMIN + 56,
    __SIGRTMIN + 57,
    __SIGRTMIN + 58,
    __SIGRTMIN + 59,
    __SIGRTMIN + 60,
    __SIGRTMIN + 61,
    __SIGRTMIN + 62,
    __SIGRTMIN + 63,
    __SIGRTMIN + 64,
    __SIGRTMIN + 65,
    __SIGRTMIN + 66,
    __SIGRTMIN + 67,
    __SIGRTMIN + 68,
    __SIGRTMIN + 69,
    __SIGRTMIN + 70,
    __SIGRTMIN + 71,
    __SIGRTMIN + 72,
    __SIGRTMIN + 73,
    __SIGRTMIN + 74,
    __SIGRTMIN + 75,
    __SIGRTMIN + 76,
    __SIGRTMIN + 77,
    __SIGRTMIN + 78,
    __SIGRTMIN + 79,
    __SIGRTMIN + 80,
    __SIGRTMIN + 81,
    __SIGRTMIN + 82,
    __SIGRTMIN + 83,
    __SIGRTMIN + 84,
    __SIGRTMIN + 85,
    __SIGRTMIN + 86,
    __SIGRTMIN + 87,
    __SIGRTMIN + 88,
    __SIGRTMIN + 89,
    __SIGRTMIN + 90,
    __SIGRTMIN + 91,
    __SIGRTMIN + 92,
    __SIGRTMIN + 93,
    __SIGRTMIN + 94,
    __SIGRTMIN + 95,
    -1, /* SIGINFO */
    -1, /* UNKNOWN */
    -1, /* DEFAULT */
    -1,
    -1,
    -1,
    -1,
    -1,
    -1
B
blueswir1 已提交
231
#endif
232
};
B
bellard 已提交
233
#else
234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260
/* In system mode we only need SIGINT and SIGTRAP; other signals
   are not yet supported.  */

enum {
    TARGET_SIGINT = 2,
    TARGET_SIGTRAP = 5
};

static int gdb_signal_table[] = {
    -1,
    -1,
    TARGET_SIGINT,
    -1,
    -1,
    TARGET_SIGTRAP
};
#endif

#ifdef CONFIG_USER_ONLY
static int target_signal_to_gdb (int sig)
{
    int i;
    for (i = 0; i < ARRAY_SIZE (gdb_signal_table); i++)
        if (gdb_signal_table[i] == sig)
            return i;
    return GDB_SIGNAL_UNKNOWN;
}
B
bellard 已提交
261
#endif
B
bellard 已提交
262

263 264 265 266 267 268 269 270
static int gdb_signal_to_target (int sig)
{
    if (sig < ARRAY_SIZE (gdb_signal_table))
        return gdb_signal_table[sig];
    else
        return -1;
}

B
bellard 已提交
271
//#define DEBUG_GDB
B
bellard 已提交
272

P
pbrook 已提交
273 274 275 276 277 278 279 280 281
typedef struct GDBRegisterState {
    int base_reg;
    int num_regs;
    gdb_reg_cb get_reg;
    gdb_reg_cb set_reg;
    const char *xml;
    struct GDBRegisterState *next;
} GDBRegisterState;

282
enum RSState {
283
    RS_INACTIVE,
284 285 286 287 288 289
    RS_IDLE,
    RS_GETLINE,
    RS_CHKSUM1,
    RS_CHKSUM2,
};
typedef struct GDBState {
290 291
    CPUState *c_cpu; /* current CPU for step/continue ops */
    CPUState *g_cpu; /* current CPU for other ops */
292
    CPUState *query_cpu; /* for q{f|s}ThreadInfo */
B
bellard 已提交
293
    enum RSState state; /* parsing state */
P
pbrook 已提交
294
    char line_buf[MAX_PACKET_LENGTH];
295 296
    int line_buf_index;
    int line_csum;
P
pbrook 已提交
297
    uint8_t last_packet[MAX_PACKET_LENGTH + 4];
298
    int last_packet_len;
299
    int signal;
B
bellard 已提交
300
#ifdef CONFIG_USER_ONLY
301
    int fd;
B
bellard 已提交
302
    int running_state;
303 304
#else
    CharDriverState *chr;
305
    CharDriverState *mon_chr;
B
bellard 已提交
306
#endif
307 308
    char syscall_buf[256];
    gdb_syscall_complete_cb current_syscall_cb;
309
} GDBState;
B
bellard 已提交
310

311 312 313 314 315
/* By default use no IRQs and no timers while single stepping so as to
 * make single stepping like an ICE HW step.
 */
static int sstep_flags = SSTEP_ENABLE|SSTEP_NOIRQ|SSTEP_NOTIMER;

316 317
static GDBState *gdbserver_state;

318
bool gdb_has_xml;
P
pbrook 已提交
319

B
bellard 已提交
320
#ifdef CONFIG_USER_ONLY
321 322 323
/* XXX: This is not thread safe.  Do we care?  */
static int gdbserver_fd = -1;

324
static int get_char(GDBState *s)
B
bellard 已提交
325 326 327 328 329
{
    uint8_t ch;
    int ret;

    for(;;) {
B
Blue Swirl 已提交
330
        ret = qemu_recv(s->fd, &ch, 1, 0);
B
bellard 已提交
331
        if (ret < 0) {
332 333
            if (errno == ECONNRESET)
                s->fd = -1;
B
bellard 已提交
334 335 336
            if (errno != EINTR && errno != EAGAIN)
                return -1;
        } else if (ret == 0) {
337 338
            close(s->fd);
            s->fd = -1;
B
bellard 已提交
339 340 341 342 343 344 345
            return -1;
        } else {
            break;
        }
    }
    return ch;
}
346
#endif
B
bellard 已提交
347

348
static enum {
P
pbrook 已提交
349 350 351 352 353 354 355 356 357 358
    GDB_SYS_UNKNOWN,
    GDB_SYS_ENABLED,
    GDB_SYS_DISABLED,
} gdb_syscall_mode;

/* If gdb is connected when the first semihosting syscall occurs then use
   remote gdb syscalls.  Otherwise use native file IO.  */
int use_gdb_syscalls(void)
{
    if (gdb_syscall_mode == GDB_SYS_UNKNOWN) {
359 360
        gdb_syscall_mode = (gdbserver_state ? GDB_SYS_ENABLED
                                            : GDB_SYS_DISABLED);
P
pbrook 已提交
361 362 363 364
    }
    return gdb_syscall_mode == GDB_SYS_ENABLED;
}

365 366 367 368 369 370
/* Resume execution.  */
static inline void gdb_continue(GDBState *s)
{
#ifdef CONFIG_USER_ONLY
    s->running_state = 1;
#else
371
    if (!runstate_needs_reset()) {
372 373
        vm_start();
    }
374 375 376
#endif
}

377
static void put_buffer(GDBState *s, const uint8_t *buf, int len)
B
bellard 已提交
378
{
379
#ifdef CONFIG_USER_ONLY
B
bellard 已提交
380 381 382
    int ret;

    while (len > 0) {
B
bellard 已提交
383
        ret = send(s->fd, buf, len, 0);
B
bellard 已提交
384 385 386 387 388 389 390 391
        if (ret < 0) {
            if (errno != EINTR && errno != EAGAIN)
                return;
        } else {
            buf += ret;
            len -= ret;
        }
    }
392
#else
393
    qemu_chr_fe_write(s->chr, buf, len);
394
#endif
B
bellard 已提交
395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440
}

static inline int fromhex(int v)
{
    if (v >= '0' && v <= '9')
        return v - '0';
    else if (v >= 'A' && v <= 'F')
        return v - 'A' + 10;
    else if (v >= 'a' && v <= 'f')
        return v - 'a' + 10;
    else
        return 0;
}

static inline int tohex(int v)
{
    if (v < 10)
        return v + '0';
    else
        return v - 10 + 'a';
}

static void memtohex(char *buf, const uint8_t *mem, int len)
{
    int i, c;
    char *q;
    q = buf;
    for(i = 0; i < len; i++) {
        c = mem[i];
        *q++ = tohex(c >> 4);
        *q++ = tohex(c & 0xf);
    }
    *q = '\0';
}

static void hextomem(uint8_t *mem, const char *buf, int len)
{
    int i;

    for(i = 0; i < len; i++) {
        mem[i] = (fromhex(buf[0]) << 4) | fromhex(buf[1]);
        buf += 2;
    }
}

/* return -1 if error, 0 if OK */
P
pbrook 已提交
441
static int put_packet_binary(GDBState *s, const char *buf, int len)
B
bellard 已提交
442
{
P
pbrook 已提交
443
    int csum, i;
T
ths 已提交
444
    uint8_t *p;
B
bellard 已提交
445 446

    for(;;) {
447 448 449 450
        p = s->last_packet;
        *(p++) = '$';
        memcpy(p, buf, len);
        p += len;
B
bellard 已提交
451 452 453 454
        csum = 0;
        for(i = 0; i < len; i++) {
            csum += buf[i];
        }
455 456 457
        *(p++) = '#';
        *(p++) = tohex((csum >> 4) & 0xf);
        *(p++) = tohex((csum) & 0xf);
B
bellard 已提交
458

459
        s->last_packet_len = p - s->last_packet;
T
ths 已提交
460
        put_buffer(s, (uint8_t *)s->last_packet, s->last_packet_len);
B
bellard 已提交
461

462 463 464
#ifdef CONFIG_USER_ONLY
        i = get_char(s);
        if (i < 0)
B
bellard 已提交
465
            return -1;
466
        if (i == '+')
B
bellard 已提交
467
            break;
468 469 470
#else
        break;
#endif
B
bellard 已提交
471 472 473 474
    }
    return 0;
}

P
pbrook 已提交
475 476 477 478 479 480
/* return -1 if error, 0 if OK */
static int put_packet(GDBState *s, const char *buf)
{
#ifdef DEBUG_GDB
    printf("reply='%s'\n", buf);
#endif
B
bellard 已提交
481

P
pbrook 已提交
482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504
    return put_packet_binary(s, buf, strlen(buf));
}

/* Encode data using the encoding for 'x' packets.  */
static int memtox(char *buf, const char *mem, int len)
{
    char *p = buf;
    char c;

    while (len--) {
        c = *(mem++);
        switch (c) {
        case '#': case '$': case '*': case '}':
            *(p++) = '}';
            *(p++) = c ^ 0x20;
            break;
        default:
            *(p++) = c;
            break;
        }
    }
    return p - buf;
}
505

506 507
static const char *get_feature_xml(const char *p, const char **newp,
                                   CPUClass *cc)
P
pbrook 已提交
508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523
{
    size_t len;
    int i;
    const char *name;
    static char target_xml[1024];

    len = 0;
    while (p[len] && p[len] != ':')
        len++;
    *newp = p + len;

    name = NULL;
    if (strncmp(p, "target.xml", len) == 0) {
        /* Generate the XML description for this CPU.  */
        if (!target_xml[0]) {
            GDBRegisterState *r;
524
            CPUState *cpu = first_cpu;
P
pbrook 已提交
525

B
blueswir1 已提交
526 527 528 529 530
            snprintf(target_xml, sizeof(target_xml),
                     "<?xml version=\"1.0\"?>"
                     "<!DOCTYPE target SYSTEM \"gdb-target.dtd\">"
                     "<target>"
                     "<xi:include href=\"%s\"/>",
531
                     cc->gdb_core_xml_file);
P
pbrook 已提交
532

533
            for (r = cpu->gdb_regs; r; r = r->next) {
534 535 536
                pstrcat(target_xml, sizeof(target_xml), "<xi:include href=\"");
                pstrcat(target_xml, sizeof(target_xml), r->xml);
                pstrcat(target_xml, sizeof(target_xml), "\"/>");
P
pbrook 已提交
537
            }
538
            pstrcat(target_xml, sizeof(target_xml), "</target>");
P
pbrook 已提交
539 540 541 542 543 544 545 546 547 548
        }
        return target_xml;
    }
    for (i = 0; ; i++) {
        name = xml_builtin[i][0];
        if (!name || (strncmp(name, p, len) == 0 && strlen(name) == len))
            break;
    }
    return name ? xml_builtin[i][1] : NULL;
}
549

550
static int gdb_read_register(CPUState *cpu, uint8_t *mem_buf, int reg)
P
pbrook 已提交
551
{
552
    CPUClass *cc = CPU_GET_CLASS(cpu);
553
    CPUArchState *env = cpu->env_ptr;
P
pbrook 已提交
554
    GDBRegisterState *r;
555

556
    if (reg < cc->gdb_num_core_regs) {
557
        return cc->gdb_read_register(cpu, mem_buf, reg);
558
    }
559

560
    for (r = cpu->gdb_regs; r; r = r->next) {
P
pbrook 已提交
561 562 563 564 565
        if (r->base_reg <= reg && reg < r->base_reg + r->num_regs) {
            return r->get_reg(env, mem_buf, reg - r->base_reg);
        }
    }
    return 0;
566 567
}

568
static int gdb_write_register(CPUState *cpu, uint8_t *mem_buf, int reg)
569
{
570
    CPUClass *cc = CPU_GET_CLASS(cpu);
571
    CPUArchState *env = cpu->env_ptr;
P
pbrook 已提交
572
    GDBRegisterState *r;
573

574
    if (reg < cc->gdb_num_core_regs) {
575
        return cc->gdb_write_register(cpu, mem_buf, reg);
576
    }
P
pbrook 已提交
577

578
    for (r = cpu->gdb_regs; r; r = r->next) {
P
pbrook 已提交
579 580 581 582
        if (r->base_reg <= reg && reg < r->base_reg + r->num_regs) {
            return r->set_reg(env, mem_buf, reg - r->base_reg);
        }
    }
B
bellard 已提交
583 584 585
    return 0;
}

P
pbrook 已提交
586 587 588 589 590 591
/* Register a supplemental set of CPU registers.  If g_pos is nonzero it
   specifies the first register number and these registers are included in
   a standard "g" packet.  Direction is relative to gdb, i.e. get_reg is
   gdb reading a CPU register, and set_reg is gdb modifying a CPU register.
 */

592 593 594
void gdb_register_coprocessor(CPUState *cpu,
                              gdb_reg_cb get_reg, gdb_reg_cb set_reg,
                              int num_regs, const char *xml, int g_pos)
B
bellard 已提交
595
{
P
pbrook 已提交
596 597 598
    GDBRegisterState *s;
    GDBRegisterState **p;

599
    p = &cpu->gdb_regs;
P
pbrook 已提交
600 601 602 603 604 605
    while (*p) {
        /* Check for duplicates.  */
        if (strcmp((*p)->xml, xml) == 0)
            return;
        p = &(*p)->next;
    }
S
Stefan Weil 已提交
606 607

    s = g_new0(GDBRegisterState, 1);
608
    s->base_reg = cpu->gdb_num_regs;
S
Stefan Weil 已提交
609 610 611 612 613
    s->num_regs = num_regs;
    s->get_reg = get_reg;
    s->set_reg = set_reg;
    s->xml = xml;

P
pbrook 已提交
614
    /* Add to end of list.  */
615
    cpu->gdb_num_regs += num_regs;
P
pbrook 已提交
616 617 618 619 620
    *p = s;
    if (g_pos) {
        if (g_pos != s->base_reg) {
            fprintf(stderr, "Error: Bad gdb register numbering for '%s'\n"
                    "Expected %d got %d\n", xml, g_pos, s->base_reg);
621 622
        } else {
            cpu->gdb_num_g_regs = cpu->gdb_num_regs;
P
pbrook 已提交
623 624
        }
    }
B
bellard 已提交
625 626
}

627 628 629 630 631 632 633 634
#ifndef CONFIG_USER_ONLY
static const int xlat_gdb_type[] = {
    [GDB_WATCHPOINT_WRITE]  = BP_GDB | BP_MEM_WRITE,
    [GDB_WATCHPOINT_READ]   = BP_GDB | BP_MEM_READ,
    [GDB_WATCHPOINT_ACCESS] = BP_GDB | BP_MEM_ACCESS,
};
#endif

635
static int gdb_breakpoint_insert(target_ulong addr, target_ulong len, int type)
636
{
637
    CPUState *cpu;
638
    CPUArchState *env;
639 640
    int err = 0;

641
    if (kvm_enabled()) {
642
        return kvm_insert_breakpoint(gdbserver_state->c_cpu, addr, len, type);
643
    }
644

645 646 647
    switch (type) {
    case GDB_BREAKPOINT_SW:
    case GDB_BREAKPOINT_HW:
A
Andreas Färber 已提交
648
        CPU_FOREACH(cpu) {
649
            env = cpu->env_ptr;
650 651 652 653 654
            err = cpu_breakpoint_insert(env, addr, BP_GDB, NULL);
            if (err)
                break;
        }
        return err;
655 656 657 658
#ifndef CONFIG_USER_ONLY
    case GDB_WATCHPOINT_WRITE:
    case GDB_WATCHPOINT_READ:
    case GDB_WATCHPOINT_ACCESS:
A
Andreas Färber 已提交
659
        CPU_FOREACH(cpu) {
660
            env = cpu->env_ptr;
661 662 663 664 665 666
            err = cpu_watchpoint_insert(env, addr, len, xlat_gdb_type[type],
                                        NULL);
            if (err)
                break;
        }
        return err;
667 668 669 670 671 672
#endif
    default:
        return -ENOSYS;
    }
}

673
static int gdb_breakpoint_remove(target_ulong addr, target_ulong len, int type)
674
{
675
    CPUState *cpu;
676
    CPUArchState *env;
677 678
    int err = 0;

679
    if (kvm_enabled()) {
680
        return kvm_remove_breakpoint(gdbserver_state->c_cpu, addr, len, type);
681
    }
682

683 684 685
    switch (type) {
    case GDB_BREAKPOINT_SW:
    case GDB_BREAKPOINT_HW:
A
Andreas Färber 已提交
686
        CPU_FOREACH(cpu) {
687
            env = cpu->env_ptr;
688 689 690 691 692
            err = cpu_breakpoint_remove(env, addr, BP_GDB);
            if (err)
                break;
        }
        return err;
693 694 695 696
#ifndef CONFIG_USER_ONLY
    case GDB_WATCHPOINT_WRITE:
    case GDB_WATCHPOINT_READ:
    case GDB_WATCHPOINT_ACCESS:
A
Andreas Färber 已提交
697
        CPU_FOREACH(cpu) {
698
            env = cpu->env_ptr;
699 700 701 702 703
            err = cpu_watchpoint_remove(env, addr, len, xlat_gdb_type[type]);
            if (err)
                break;
        }
        return err;
704 705 706 707 708 709
#endif
    default:
        return -ENOSYS;
    }
}

710
static void gdb_breakpoint_remove_all(void)
711
{
712
    CPUState *cpu;
713
    CPUArchState *env;
714

715
    if (kvm_enabled()) {
716
        kvm_remove_all_breakpoints(gdbserver_state->c_cpu);
717 718 719
        return;
    }

A
Andreas Färber 已提交
720
    CPU_FOREACH(cpu) {
721
        env = cpu->env_ptr;
722
        cpu_breakpoint_remove_all(env, BP_GDB);
723
#ifndef CONFIG_USER_ONLY
724
        cpu_watchpoint_remove_all(env, BP_GDB);
725
#endif
726
    }
727 728
}

A
aurel32 已提交
729 730
static void gdb_set_cpu_pc(GDBState *s, target_ulong pc)
{
731
    CPUState *cpu = s->c_cpu;
732 733 734 735 736
    CPUClass *cc = CPU_GET_CLASS(cpu);

    cpu_synchronize_state(cpu);
    if (cc->set_pc) {
        cc->set_pc(cpu, pc);
N
Nathan Froyd 已提交
737
    }
A
aurel32 已提交
738 739
}

740
static CPUState *find_cpu(uint32_t thread_id)
741
{
742
    CPUState *cpu;
743

A
Andreas Färber 已提交
744
    CPU_FOREACH(cpu) {
745
        if (cpu_index(cpu) == thread_id) {
746
            return cpu;
747
        }
748
    }
749 750

    return NULL;
751 752
}

753
static int gdb_handle_packet(GDBState *s, const char *line_buf)
B
bellard 已提交
754
{
755
    CPUState *cpu;
756
    CPUClass *cc;
B
bellard 已提交
757
    const char *p;
758 759
    uint32_t thread;
    int ch, reg_size, type, res;
P
pbrook 已提交
760 761 762
    char buf[MAX_PACKET_LENGTH];
    uint8_t mem_buf[MAX_PACKET_LENGTH];
    uint8_t *registers;
763
    target_ulong addr, len;
764

765 766 767 768 769 770 771
#ifdef DEBUG_GDB
    printf("command='%s'\n", line_buf);
#endif
    p = line_buf;
    ch = *p++;
    switch(ch) {
    case '?':
B
bellard 已提交
772
        /* TODO: Make this return the correct value for user-mode.  */
773
        snprintf(buf, sizeof(buf), "T%02xthread:%02x;", GDB_SIGNAL_TRAP,
774
                 cpu_index(s->c_cpu));
775
        put_packet(s, buf);
776 777 778 779
        /* Remove all the breakpoints when this query is issued,
         * because gdb is doing and initial connect and the state
         * should be cleaned up.
         */
780
        gdb_breakpoint_remove_all();
781 782 783
        break;
    case 'c':
        if (*p != '\0') {
784
            addr = strtoull(p, (char **)&p, 16);
A
aurel32 已提交
785
            gdb_set_cpu_pc(s, addr);
786
        }
787
        s->signal = 0;
788
        gdb_continue(s);
B
bellard 已提交
789
	return RS_IDLE;
790
    case 'C':
791 792 793
        s->signal = gdb_signal_to_target (strtoul(p, (char **)&p, 16));
        if (s->signal == -1)
            s->signal = 0;
794 795
        gdb_continue(s);
        return RS_IDLE;
J
Jan Kiszka 已提交
796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835
    case 'v':
        if (strncmp(p, "Cont", 4) == 0) {
            int res_signal, res_thread;

            p += 4;
            if (*p == '?') {
                put_packet(s, "vCont;c;C;s;S");
                break;
            }
            res = 0;
            res_signal = 0;
            res_thread = 0;
            while (*p) {
                int action, signal;

                if (*p++ != ';') {
                    res = 0;
                    break;
                }
                action = *p++;
                signal = 0;
                if (action == 'C' || action == 'S') {
                    signal = strtoul(p, (char **)&p, 16);
                } else if (action != 'c' && action != 's') {
                    res = 0;
                    break;
                }
                thread = 0;
                if (*p == ':') {
                    thread = strtoull(p+1, (char **)&p, 16);
                }
                action = tolower(action);
                if (res == 0 || (res == 'c' && action == 's')) {
                    res = action;
                    res_signal = signal;
                    res_thread = thread;
                }
            }
            if (res) {
                if (res_thread != -1 && res_thread != 0) {
836 837
                    cpu = find_cpu(res_thread);
                    if (cpu == NULL) {
J
Jan Kiszka 已提交
838 839 840
                        put_packet(s, "E22");
                        break;
                    }
841
                    s->c_cpu = cpu;
J
Jan Kiszka 已提交
842 843
                }
                if (res == 's') {
844
                    cpu_single_step(s->c_cpu, sstep_flags);
J
Jan Kiszka 已提交
845 846 847 848 849 850 851 852 853
                }
                s->signal = res_signal;
                gdb_continue(s);
                return RS_IDLE;
            }
            break;
        } else {
            goto unknown_command;
        }
854
    case 'k':
855
#ifdef CONFIG_USER_ONLY
856 857 858
        /* Kill the target */
        fprintf(stderr, "\nQEMU: Terminated via GDBstub\n");
        exit(0);
859
#endif
860 861
    case 'D':
        /* Detach packet */
862
        gdb_breakpoint_remove_all();
D
Daniel Gutson 已提交
863
        gdb_syscall_mode = GDB_SYS_DISABLED;
864 865 866
        gdb_continue(s);
        put_packet(s, "OK");
        break;
867 868
    case 's':
        if (*p != '\0') {
869
            addr = strtoull(p, (char **)&p, 16);
A
aurel32 已提交
870
            gdb_set_cpu_pc(s, addr);
871
        }
872
        cpu_single_step(s->c_cpu, sstep_flags);
873
        gdb_continue(s);
B
bellard 已提交
874
	return RS_IDLE;
P
pbrook 已提交
875 876 877 878 879 880 881 882 883 884 885 886 887 888 889
    case 'F':
        {
            target_ulong ret;
            target_ulong err;

            ret = strtoull(p, (char **)&p, 16);
            if (*p == ',') {
                p++;
                err = strtoull(p, (char **)&p, 16);
            } else {
                err = 0;
            }
            if (*p == ',')
                p++;
            type = *p;
890
            if (s->current_syscall_cb) {
891
                s->current_syscall_cb(s->c_cpu, ret, err);
892 893
                s->current_syscall_cb = NULL;
            }
P
pbrook 已提交
894 895 896
            if (type == 'C') {
                put_packet(s, "T02");
            } else {
897
                gdb_continue(s);
P
pbrook 已提交
898 899 900
            }
        }
        break;
901
    case 'g':
902
        cpu_synchronize_state(s->g_cpu);
P
pbrook 已提交
903
        len = 0;
904
        for (addr = 0; addr < s->g_cpu->gdb_num_g_regs; addr++) {
905
            reg_size = gdb_read_register(s->g_cpu, mem_buf + len, addr);
P
pbrook 已提交
906 907 908
            len += reg_size;
        }
        memtohex(buf, mem_buf, len);
909 910 911
        put_packet(s, buf);
        break;
    case 'G':
912
        cpu_synchronize_state(s->g_cpu);
P
pbrook 已提交
913
        registers = mem_buf;
914 915
        len = strlen(p) / 2;
        hextomem((uint8_t *)registers, p, len);
916
        for (addr = 0; addr < s->g_cpu->gdb_num_g_regs && len > 0; addr++) {
917
            reg_size = gdb_write_register(s->g_cpu, registers, addr);
P
pbrook 已提交
918 919 920
            len -= reg_size;
            registers += reg_size;
        }
921 922 923
        put_packet(s, "OK");
        break;
    case 'm':
924
        addr = strtoull(p, (char **)&p, 16);
925 926
        if (*p == ',')
            p++;
927
        len = strtoull(p, NULL, 16);
928
        if (target_memory_rw_debug(s->g_cpu, addr, mem_buf, len, false) != 0) {
929 930 931 932 933
            put_packet (s, "E14");
        } else {
            memtohex(buf, mem_buf, len);
            put_packet(s, buf);
        }
934 935
        break;
    case 'M':
936
        addr = strtoull(p, (char **)&p, 16);
937 938
        if (*p == ',')
            p++;
939
        len = strtoull(p, (char **)&p, 16);
940
        if (*p == ':')
941 942
            p++;
        hextomem(mem_buf, p, len);
943
        if (target_memory_rw_debug(s->g_cpu, addr, mem_buf, len,
944
                                   true) != 0) {
B
bellard 已提交
945
            put_packet(s, "E14");
946
        } else {
947
            put_packet(s, "OK");
948
        }
949
        break;
P
pbrook 已提交
950 951 952 953 954 955 956
    case 'p':
        /* Older gdb are really dumb, and don't use 'g' if 'p' is avaialable.
           This works, but can be very slow.  Anything new enough to
           understand XML also knows how to use this properly.  */
        if (!gdb_has_xml)
            goto unknown_command;
        addr = strtoull(p, (char **)&p, 16);
957
        reg_size = gdb_read_register(s->g_cpu, mem_buf, addr);
P
pbrook 已提交
958 959 960 961 962 963 964 965 966 967 968 969 970 971 972
        if (reg_size) {
            memtohex(buf, mem_buf, reg_size);
            put_packet(s, buf);
        } else {
            put_packet(s, "E14");
        }
        break;
    case 'P':
        if (!gdb_has_xml)
            goto unknown_command;
        addr = strtoull(p, (char **)&p, 16);
        if (*p == '=')
            p++;
        reg_size = strlen(p) / 2;
        hextomem(mem_buf, p, reg_size);
973
        gdb_write_register(s->g_cpu, mem_buf, addr);
P
pbrook 已提交
974 975
        put_packet(s, "OK");
        break;
976 977 978 979 980
    case 'Z':
    case 'z':
        type = strtoul(p, (char **)&p, 16);
        if (*p == ',')
            p++;
981
        addr = strtoull(p, (char **)&p, 16);
982 983
        if (*p == ',')
            p++;
984
        len = strtoull(p, (char **)&p, 16);
985
        if (ch == 'Z')
986
            res = gdb_breakpoint_insert(addr, len, type);
987
        else
988
            res = gdb_breakpoint_remove(addr, len, type);
989 990 991
        if (res >= 0)
             put_packet(s, "OK");
        else if (res == -ENOSYS)
P
pbrook 已提交
992
            put_packet(s, "");
993 994
        else
            put_packet(s, "E22");
995
        break;
996 997 998 999 1000 1001 1002
    case 'H':
        type = *p++;
        thread = strtoull(p, (char **)&p, 16);
        if (thread == -1 || thread == 0) {
            put_packet(s, "OK");
            break;
        }
1003 1004
        cpu = find_cpu(thread);
        if (cpu == NULL) {
1005 1006 1007 1008 1009
            put_packet(s, "E22");
            break;
        }
        switch (type) {
        case 'c':
1010
            s->c_cpu = cpu;
1011 1012 1013
            put_packet(s, "OK");
            break;
        case 'g':
1014
            s->g_cpu = cpu;
1015 1016 1017 1018 1019 1020 1021 1022 1023
            put_packet(s, "OK");
            break;
        default:
             put_packet(s, "E22");
             break;
        }
        break;
    case 'T':
        thread = strtoull(p, (char **)&p, 16);
1024
        cpu = find_cpu(thread);
1025

1026
        if (cpu != NULL) {
1027 1028
            put_packet(s, "OK");
        } else {
1029
            put_packet(s, "E22");
1030
        }
1031
        break;
1032
    case 'q':
1033 1034 1035 1036
    case 'Q':
        /* parse any 'q' packets here */
        if (!strcmp(p,"qemu.sstepbits")) {
            /* Query Breakpoint bit definitions */
B
blueswir1 已提交
1037 1038 1039 1040
            snprintf(buf, sizeof(buf), "ENABLE=%x,NOIRQ=%x,NOTIMER=%x",
                     SSTEP_ENABLE,
                     SSTEP_NOIRQ,
                     SSTEP_NOTIMER);
1041 1042 1043 1044 1045 1046 1047
            put_packet(s, buf);
            break;
        } else if (strncmp(p,"qemu.sstep",10) == 0) {
            /* Display or change the sstep_flags */
            p += 10;
            if (*p != '=') {
                /* Display current setting */
B
blueswir1 已提交
1048
                snprintf(buf, sizeof(buf), "0x%x", sstep_flags);
1049 1050 1051 1052 1053 1054 1055 1056
                put_packet(s, buf);
                break;
            }
            p++;
            type = strtoul(p, (char **)&p, 16);
            sstep_flags = type;
            put_packet(s, "OK");
            break;
1057 1058 1059 1060 1061 1062
        } else if (strcmp(p,"C") == 0) {
            /* "Current thread" remains vague in the spec, so always return
             *  the first CPU (gdb returns the first thread). */
            put_packet(s, "QC1");
            break;
        } else if (strcmp(p,"fThreadInfo") == 0) {
1063
            s->query_cpu = first_cpu;
1064 1065 1066 1067
            goto report_cpuinfo;
        } else if (strcmp(p,"sThreadInfo") == 0) {
        report_cpuinfo:
            if (s->query_cpu) {
1068
                snprintf(buf, sizeof(buf), "m%x", cpu_index(s->query_cpu));
1069
                put_packet(s, buf);
A
Andreas Färber 已提交
1070
                s->query_cpu = CPU_NEXT(s->query_cpu);
1071 1072 1073 1074 1075
            } else
                put_packet(s, "l");
            break;
        } else if (strncmp(p,"ThreadExtraInfo,", 16) == 0) {
            thread = strtoull(p+16, (char **)&p, 16);
1076 1077
            cpu = find_cpu(thread);
            if (cpu != NULL) {
1078
                cpu_synchronize_state(cpu);
1079
                len = snprintf((char *)mem_buf, sizeof(mem_buf),
1080
                               "CPU#%d [%s]", cpu->cpu_index,
1081
                               cpu->halted ? "halted " : "running");
1082 1083 1084
                memtohex(buf, mem_buf, len);
                put_packet(s, buf);
            }
1085
            break;
1086
        }
B
blueswir1 已提交
1087
#ifdef CONFIG_USER_ONLY
1088
        else if (strncmp(p, "Offsets", 7) == 0) {
1089
            TaskState *ts = s->c_cpu->opaque;
1090

B
blueswir1 已提交
1091 1092 1093 1094 1095 1096
            snprintf(buf, sizeof(buf),
                     "Text=" TARGET_ABI_FMT_lx ";Data=" TARGET_ABI_FMT_lx
                     ";Bss=" TARGET_ABI_FMT_lx,
                     ts->info->code_offset,
                     ts->info->data_offset,
                     ts->info->data_offset);
1097 1098 1099
            put_packet(s, buf);
            break;
        }
B
blueswir1 已提交
1100
#else /* !CONFIG_USER_ONLY */
1101 1102 1103 1104 1105 1106 1107 1108 1109 1110
        else if (strncmp(p, "Rcmd,", 5) == 0) {
            int len = strlen(p + 5);

            if ((len % 2) != 0) {
                put_packet(s, "E01");
                break;
            }
            hextomem(mem_buf, p + 5, len);
            len = len / 2;
            mem_buf[len++] = 0;
1111
            qemu_chr_be_write(s->mon_chr, mem_buf, len);
1112 1113 1114
            put_packet(s, "OK");
            break;
        }
B
blueswir1 已提交
1115
#endif /* !CONFIG_USER_ONLY */
P
pbrook 已提交
1116
        if (strncmp(p, "Supported", 9) == 0) {
B
blueswir1 已提交
1117
            snprintf(buf, sizeof(buf), "PacketSize=%x", MAX_PACKET_LENGTH);
1118 1119 1120 1121
            cc = CPU_GET_CLASS(first_cpu);
            if (cc->gdb_core_xml_file != NULL) {
                pstrcat(buf, sizeof(buf), ";qXfer:features:read+");
            }
P
pbrook 已提交
1122 1123 1124 1125 1126 1127 1128
            put_packet(s, buf);
            break;
        }
        if (strncmp(p, "Xfer:features:read:", 19) == 0) {
            const char *xml;
            target_ulong total_len;

1129 1130 1131 1132 1133
            cc = CPU_GET_CLASS(first_cpu);
            if (cc->gdb_core_xml_file == NULL) {
                goto unknown_command;
            }

1134
            gdb_has_xml = true;
P
pbrook 已提交
1135
            p += 19;
1136
            xml = get_feature_xml(p, &p, cc);
P
pbrook 已提交
1137
            if (!xml) {
B
blueswir1 已提交
1138
                snprintf(buf, sizeof(buf), "E00");
P
pbrook 已提交
1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151
                put_packet(s, buf);
                break;
            }

            if (*p == ':')
                p++;
            addr = strtoul(p, (char **)&p, 16);
            if (*p == ',')
                p++;
            len = strtoul(p, (char **)&p, 16);

            total_len = strlen(xml);
            if (addr > total_len) {
B
blueswir1 已提交
1152
                snprintf(buf, sizeof(buf), "E00");
P
pbrook 已提交
1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170
                put_packet(s, buf);
                break;
            }
            if (len > (MAX_PACKET_LENGTH - 5) / 2)
                len = (MAX_PACKET_LENGTH - 5) / 2;
            if (len < total_len - addr) {
                buf[0] = 'm';
                len = memtox(buf + 1, xml + addr, len);
            } else {
                buf[0] = 'l';
                len = memtox(buf + 1, xml + addr, total_len - addr);
            }
            put_packet_binary(s, buf, len + 1);
            break;
        }
        /* Unrecognised 'q' command.  */
        goto unknown_command;

1171
    default:
P
pbrook 已提交
1172
    unknown_command:
1173 1174 1175 1176 1177 1178 1179 1180
        /* put empty packet */
        buf[0] = '\0';
        put_packet(s, buf);
        break;
    }
    return RS_IDLE;
}

1181
void gdb_set_stop_cpu(CPUState *cpu)
1182
{
1183 1184
    gdbserver_state->c_cpu = cpu;
    gdbserver_state->g_cpu = cpu;
1185 1186
}

B
bellard 已提交
1187
#ifndef CONFIG_USER_ONLY
1188
static void gdb_vm_state_change(void *opaque, int running, RunState state)
1189
{
1190
    GDBState *s = gdbserver_state;
1191 1192
    CPUArchState *env = s->c_cpu->env_ptr;
    CPUState *cpu = s->c_cpu;
1193
    char buf[256];
1194
    const char *type;
1195 1196
    int ret;

1197 1198 1199 1200 1201 1202
    if (running || s->state == RS_INACTIVE) {
        return;
    }
    /* Is there a GDB syscall waiting to be sent?  */
    if (s->current_syscall_cb) {
        put_packet(s, s->syscall_buf);
P
pbrook 已提交
1203
        return;
J
Jan Kiszka 已提交
1204
    }
1205
    switch (state) {
1206
    case RUN_STATE_DEBUG:
1207 1208
        if (cpu->watchpoint_hit) {
            switch (cpu->watchpoint_hit->flags & BP_MEM_ACCESS) {
1209
            case BP_MEM_READ:
1210 1211
                type = "r";
                break;
1212
            case BP_MEM_ACCESS:
1213 1214 1215 1216 1217 1218
                type = "a";
                break;
            default:
                type = "";
                break;
            }
1219 1220
            snprintf(buf, sizeof(buf),
                     "T%02xthread:%02x;%swatch:" TARGET_FMT_lx ";",
1221
                     GDB_SIGNAL_TRAP, cpu_index(cpu), type,
1222 1223
                     (target_ulong)cpu->watchpoint_hit->vaddr);
            cpu->watchpoint_hit = NULL;
1224
            goto send_packet;
1225
        }
1226
        tb_flush(env);
1227
        ret = GDB_SIGNAL_TRAP;
1228
        break;
1229
    case RUN_STATE_PAUSED:
1230
        ret = GDB_SIGNAL_INT;
1231
        break;
1232
    case RUN_STATE_SHUTDOWN:
1233 1234
        ret = GDB_SIGNAL_QUIT;
        break;
1235
    case RUN_STATE_IO_ERROR:
1236 1237
        ret = GDB_SIGNAL_IO;
        break;
1238
    case RUN_STATE_WATCHDOG:
1239 1240
        ret = GDB_SIGNAL_ALRM;
        break;
1241
    case RUN_STATE_INTERNAL_ERROR:
1242 1243
        ret = GDB_SIGNAL_ABRT;
        break;
1244 1245
    case RUN_STATE_SAVE_VM:
    case RUN_STATE_RESTORE_VM:
1246
        return;
1247
    case RUN_STATE_FINISH_MIGRATE:
1248 1249 1250 1251 1252
        ret = GDB_SIGNAL_XCPU;
        break;
    default:
        ret = GDB_SIGNAL_UNKNOWN;
        break;
B
bellard 已提交
1253
    }
1254
    snprintf(buf, sizeof(buf), "T%02xthread:%02x;", ret, cpu_index(cpu));
1255 1256

send_packet:
1257
    put_packet(s, buf);
1258 1259

    /* disable single step if it was enabled */
1260
    cpu_single_step(cpu, 0);
1261
}
B
bellard 已提交
1262
#endif
1263

P
pbrook 已提交
1264 1265
/* Send a gdb syscall request.
   This accepts limited printf-style format specifiers, specifically:
P
pbrook 已提交
1266 1267 1268
    %x  - target_ulong argument printed in hex.
    %lx - 64-bit argument printed in hex.
    %s  - string pointer (target_ulong) and length (int) pair.  */
1269
void gdb_do_syscall(gdb_syscall_complete_cb cb, const char *fmt, ...)
P
pbrook 已提交
1270 1271 1272
{
    va_list va;
    char *p;
1273
    char *p_end;
P
pbrook 已提交
1274
    target_ulong addr;
P
pbrook 已提交
1275
    uint64_t i64;
P
pbrook 已提交
1276 1277
    GDBState *s;

1278
    s = gdbserver_state;
P
pbrook 已提交
1279 1280
    if (!s)
        return;
1281
    s->current_syscall_cb = cb;
P
pbrook 已提交
1282
#ifndef CONFIG_USER_ONLY
1283
    vm_stop(RUN_STATE_DEBUG);
P
pbrook 已提交
1284 1285
#endif
    va_start(va, fmt);
1286 1287
    p = s->syscall_buf;
    p_end = &s->syscall_buf[sizeof(s->syscall_buf)];
P
pbrook 已提交
1288 1289 1290 1291 1292 1293 1294
    *(p++) = 'F';
    while (*fmt) {
        if (*fmt == '%') {
            fmt++;
            switch (*fmt++) {
            case 'x':
                addr = va_arg(va, target_ulong);
1295
                p += snprintf(p, p_end - p, TARGET_FMT_lx, addr);
P
pbrook 已提交
1296
                break;
P
pbrook 已提交
1297 1298 1299 1300
            case 'l':
                if (*(fmt++) != 'x')
                    goto bad_format;
                i64 = va_arg(va, uint64_t);
1301
                p += snprintf(p, p_end - p, "%" PRIx64, i64);
P
pbrook 已提交
1302
                break;
P
pbrook 已提交
1303 1304
            case 's':
                addr = va_arg(va, target_ulong);
1305
                p += snprintf(p, p_end - p, TARGET_FMT_lx "/%x",
B
blueswir1 已提交
1306
                              addr, va_arg(va, int));
P
pbrook 已提交
1307 1308
                break;
            default:
P
pbrook 已提交
1309
            bad_format:
P
pbrook 已提交
1310 1311 1312 1313 1314 1315 1316 1317
                fprintf(stderr, "gdbstub: Bad syscall format string '%s'\n",
                        fmt - 1);
                break;
            }
        } else {
            *(p++) = *(fmt++);
        }
    }
P
pbrook 已提交
1318
    *p = 0;
P
pbrook 已提交
1319 1320
    va_end(va);
#ifdef CONFIG_USER_ONLY
1321
    put_packet(s, s->syscall_buf);
1322
    gdb_handlesig(s->c_cpu, 0);
P
pbrook 已提交
1323
#else
1324 1325 1326 1327 1328 1329
    /* In this case wait to send the syscall packet until notification that
       the CPU has stopped.  This must be done because if the packet is sent
       now the reply from the syscall request could be received while the CPU
       is still in the running state, which can cause packets to be dropped
       and state transition 'T' packets to be sent while the syscall is still
       being processed.  */
1330
    cpu_exit(s->c_cpu);
P
pbrook 已提交
1331 1332 1333
#endif
}

B
bellard 已提交
1334
static void gdb_read_byte(GDBState *s, int ch)
1335 1336
{
    int i, csum;
T
ths 已提交
1337
    uint8_t reply;
1338

B
bellard 已提交
1339
#ifndef CONFIG_USER_ONLY
1340 1341 1342 1343 1344 1345 1346
    if (s->last_packet_len) {
        /* Waiting for a response to the last packet.  If we see the start
           of a new command then abandon the previous response.  */
        if (ch == '-') {
#ifdef DEBUG_GDB
            printf("Got NACK, retransmitting\n");
#endif
T
ths 已提交
1347
            put_buffer(s, (uint8_t *)s->last_packet, s->last_packet_len);
1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359
        }
#ifdef DEBUG_GDB
        else if (ch == '+')
            printf("Got ACK\n");
        else
            printf("Got '%c' when expecting ACK/NACK\n", ch);
#endif
        if (ch == '+' || ch == '$')
            s->last_packet_len = 0;
        if (ch != '$')
            return;
    }
1360
    if (runstate_is_running()) {
1361 1362
        /* when the CPU is running, we cannot do anything except stop
           it when receiving a char */
1363
        vm_stop(RUN_STATE_PAUSED);
1364
    } else
B
bellard 已提交
1365
#endif
B
bellard 已提交
1366
    {
1367 1368 1369 1370 1371
        switch(s->state) {
        case RS_IDLE:
            if (ch == '$') {
                s->line_buf_index = 0;
                s->state = RS_GETLINE;
B
bellard 已提交
1372
            }
B
bellard 已提交
1373
            break;
1374 1375 1376 1377 1378
        case RS_GETLINE:
            if (ch == '#') {
            s->state = RS_CHKSUM1;
            } else if (s->line_buf_index >= sizeof(s->line_buf) - 1) {
                s->state = RS_IDLE;
B
bellard 已提交
1379
            } else {
1380
            s->line_buf[s->line_buf_index++] = ch;
B
bellard 已提交
1381 1382
            }
            break;
1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394
        case RS_CHKSUM1:
            s->line_buf[s->line_buf_index] = '\0';
            s->line_csum = fromhex(ch) << 4;
            s->state = RS_CHKSUM2;
            break;
        case RS_CHKSUM2:
            s->line_csum |= fromhex(ch);
            csum = 0;
            for(i = 0; i < s->line_buf_index; i++) {
                csum += s->line_buf[i];
            }
            if (s->line_csum != (csum & 0xff)) {
T
ths 已提交
1395 1396
                reply = '-';
                put_buffer(s, &reply, 1);
1397
                s->state = RS_IDLE;
B
bellard 已提交
1398
            } else {
T
ths 已提交
1399 1400
                reply = '+';
                put_buffer(s, &reply, 1);
1401
                s->state = gdb_handle_packet(s, s->line_buf);
B
bellard 已提交
1402 1403
            }
            break;
P
pbrook 已提交
1404 1405
        default:
            abort();
1406 1407 1408 1409
        }
    }
}

P
Paul Brook 已提交
1410
/* Tell the remote gdb that the process has exited.  */
1411
void gdb_exit(CPUArchState *env, int code)
P
Paul Brook 已提交
1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427
{
  GDBState *s;
  char buf[4];

  s = gdbserver_state;
  if (!s) {
      return;
  }
#ifdef CONFIG_USER_ONLY
  if (gdbserver_fd < 0 || s->fd < 0) {
      return;
  }
#endif

  snprintf(buf, sizeof(buf), "W%02x", (uint8_t)code);
  put_packet(s, buf);
1428 1429 1430

#ifndef CONFIG_USER_ONLY
  if (s->chr) {
1431
      qemu_chr_delete(s->chr);
1432 1433
  }
#endif
P
Paul Brook 已提交
1434 1435
}

B
bellard 已提交
1436
#ifdef CONFIG_USER_ONLY
1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449
int
gdb_queuesig (void)
{
    GDBState *s;

    s = gdbserver_state;

    if (gdbserver_fd < 0 || s->fd < 0)
        return 0;
    else
        return 1;
}

B
bellard 已提交
1450
int
1451
gdb_handlesig(CPUState *cpu, int sig)
B
bellard 已提交
1452
{
1453
    CPUArchState *env = cpu->env_ptr;
1454 1455 1456
    GDBState *s;
    char buf[256];
    int n;
B
bellard 已提交
1457

1458 1459 1460 1461
    s = gdbserver_state;
    if (gdbserver_fd < 0 || s->fd < 0) {
        return sig;
    }
B
bellard 已提交
1462

1463
    /* disable single step if it was enabled */
1464
    cpu_single_step(cpu, 0);
1465
    tb_flush(env);
B
bellard 已提交
1466

1467 1468 1469 1470 1471 1472 1473 1474 1475
    if (sig != 0) {
        snprintf(buf, sizeof(buf), "S%02x", target_signal_to_gdb(sig));
        put_packet(s, buf);
    }
    /* put_packet() might have detected that the peer terminated the
       connection.  */
    if (s->fd < 0) {
        return sig;
    }
B
bellard 已提交
1476

1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491
    sig = 0;
    s->state = RS_IDLE;
    s->running_state = 0;
    while (s->running_state == 0) {
        n = read(s->fd, buf, 256);
        if (n > 0) {
            int i;

            for (i = 0; i < n; i++) {
                gdb_read_byte(s, buf[i]);
            }
        } else if (n == 0 || errno != EAGAIN) {
            /* XXX: Connection closed.  Should probably wait for another
               connection before continuing.  */
            return sig;
B
bellard 已提交
1492
        }
1493 1494 1495 1496
    }
    sig = s->signal;
    s->signal = 0;
    return sig;
B
bellard 已提交
1497
}
1498

1499
/* Tell the remote gdb that the process has exited due to SIG.  */
1500
void gdb_signalled(CPUArchState *env, int sig)
1501
{
1502 1503
    GDBState *s;
    char buf[4];
1504

1505 1506 1507 1508
    s = gdbserver_state;
    if (gdbserver_fd < 0 || s->fd < 0) {
        return;
    }
1509

1510 1511
    snprintf(buf, sizeof(buf), "X%02x", target_signal_to_gdb(sig));
    put_packet(s, buf);
1512
}
B
bellard 已提交
1513

1514
static void gdb_accept(void)
1515 1516 1517 1518
{
    GDBState *s;
    struct sockaddr_in sockaddr;
    socklen_t len;
1519
    int fd;
1520 1521 1522 1523 1524 1525 1526 1527

    for(;;) {
        len = sizeof(sockaddr);
        fd = accept(gdbserver_fd, (struct sockaddr *)&sockaddr, &len);
        if (fd < 0 && errno != EINTR) {
            perror("accept");
            return;
        } else if (fd >= 0) {
K
Kevin Wolf 已提交
1528 1529 1530
#ifndef _WIN32
            fcntl(fd, F_SETFD, FD_CLOEXEC);
#endif
B
bellard 已提交
1531 1532 1533
            break;
        }
    }
1534 1535

    /* set short latency */
1536
    socket_set_nodelay(fd);
1537

1538
    s = g_malloc0(sizeof(GDBState));
1539 1540
    s->c_cpu = first_cpu;
    s->g_cpu = first_cpu;
1541
    s->fd = fd;
1542
    gdb_has_xml = false;
1543

1544
    gdbserver_state = s;
P
pbrook 已提交
1545

1546 1547 1548 1549 1550 1551
    fcntl(fd, F_SETFL, O_NONBLOCK);
}

static int gdbserver_open(int port)
{
    struct sockaddr_in sockaddr;
1552
    int fd, ret;
1553 1554 1555 1556 1557 1558

    fd = socket(PF_INET, SOCK_STREAM, 0);
    if (fd < 0) {
        perror("socket");
        return -1;
    }
K
Kevin Wolf 已提交
1559 1560 1561
#ifndef _WIN32
    fcntl(fd, F_SETFD, FD_CLOEXEC);
#endif
1562

1563
    socket_set_fast_reuse(fd);
1564 1565 1566 1567 1568 1569 1570

    sockaddr.sin_family = AF_INET;
    sockaddr.sin_port = htons(port);
    sockaddr.sin_addr.s_addr = 0;
    ret = bind(fd, (struct sockaddr *)&sockaddr, sizeof(sockaddr));
    if (ret < 0) {
        perror("bind");
1571
        close(fd);
1572 1573 1574 1575 1576
        return -1;
    }
    ret = listen(fd, 0);
    if (ret < 0) {
        perror("listen");
1577
        close(fd);
1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588
        return -1;
    }
    return fd;
}

int gdbserver_start(int port)
{
    gdbserver_fd = gdbserver_open(port);
    if (gdbserver_fd < 0)
        return -1;
    /* accept connections */
1589
    gdb_accept();
1590 1591
    return 0;
}
1592 1593

/* Disable gdb stub for child processes.  */
1594
void gdbserver_fork(CPUArchState *env)
1595 1596
{
    GDBState *s = gdbserver_state;
E
edgar_igl 已提交
1597
    if (gdbserver_fd < 0 || s->fd < 0)
1598 1599 1600 1601 1602 1603
      return;
    close(s->fd);
    s->fd = -1;
    cpu_breakpoint_remove_all(env, BP_GDB);
    cpu_watchpoint_remove_all(env, BP_GDB);
}
B
bellard 已提交
1604
#else
T
ths 已提交
1605
static int gdb_chr_can_receive(void *opaque)
1606
{
P
pbrook 已提交
1607 1608 1609
  /* We can handle an arbitrarily large amount of data.
   Pick the maximum packet size, which is as good as anything.  */
  return MAX_PACKET_LENGTH;
1610 1611
}

T
ths 已提交
1612
static void gdb_chr_receive(void *opaque, const uint8_t *buf, int size)
1613 1614 1615 1616
{
    int i;

    for (i = 0; i < size; i++) {
1617
        gdb_read_byte(gdbserver_state, buf[i]);
1618 1619 1620 1621 1622 1623
    }
}

static void gdb_chr_event(void *opaque, int event)
{
    switch (event) {
1624
    case CHR_EVENT_OPENED:
1625
        vm_stop(RUN_STATE_PAUSED);
1626
        gdb_has_xml = false;
1627 1628 1629 1630 1631 1632
        break;
    default:
        break;
    }
}

1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661
static void gdb_monitor_output(GDBState *s, const char *msg, int len)
{
    char buf[MAX_PACKET_LENGTH];

    buf[0] = 'O';
    if (len > (MAX_PACKET_LENGTH/2) - 1)
        len = (MAX_PACKET_LENGTH/2) - 1;
    memtohex(buf + 1, (uint8_t *)msg, len);
    put_packet(s, buf);
}

static int gdb_monitor_write(CharDriverState *chr, const uint8_t *buf, int len)
{
    const char *p = (const char *)buf;
    int max_sz;

    max_sz = (sizeof(gdbserver_state->last_packet) - 2) / 2;
    for (;;) {
        if (len <= max_sz) {
            gdb_monitor_output(gdbserver_state, p, len);
            break;
        }
        gdb_monitor_output(gdbserver_state, p, max_sz);
        p += max_sz;
        len -= max_sz;
    }
    return len;
}

1662 1663 1664
#ifndef _WIN32
static void gdb_sigterm_handler(int signal)
{
1665
    if (runstate_is_running()) {
1666
        vm_stop(RUN_STATE_PAUSED);
J
Jan Kiszka 已提交
1667
    }
1668 1669 1670 1671
}
#endif

int gdbserver_start(const char *device)
1672 1673
{
    GDBState *s;
1674
    char gdbstub_device_name[128];
1675 1676
    CharDriverState *chr = NULL;
    CharDriverState *mon_chr;
1677

1678 1679 1680 1681 1682 1683 1684 1685
    if (!device)
        return -1;
    if (strcmp(device, "none") != 0) {
        if (strstart(device, "tcp:", NULL)) {
            /* enforce required TCP attributes */
            snprintf(gdbstub_device_name, sizeof(gdbstub_device_name),
                     "%s,nowait,nodelay,server", device);
            device = gdbstub_device_name;
1686
        }
1687 1688 1689
#ifndef _WIN32
        else if (strcmp(device, "stdio") == 0) {
            struct sigaction act;
1690

1691 1692 1693 1694 1695
            memset(&act, 0, sizeof(act));
            act.sa_handler = gdb_sigterm_handler;
            sigaction(SIGINT, &act, NULL);
        }
#endif
1696
        chr = qemu_chr_new("gdb", device, NULL);
1697 1698 1699
        if (!chr)
            return -1;

1700
        qemu_chr_fe_claim_no_fail(chr);
1701 1702
        qemu_chr_add_handlers(chr, gdb_chr_can_receive, gdb_chr_receive,
                              gdb_chr_event, NULL);
1703 1704
    }

1705 1706
    s = gdbserver_state;
    if (!s) {
1707
        s = g_malloc0(sizeof(GDBState));
1708
        gdbserver_state = s;
1709

1710 1711 1712
        qemu_add_vm_change_state_handler(gdb_vm_state_change, NULL);

        /* Initialize a monitor terminal for gdb */
1713
        mon_chr = g_malloc0(sizeof(*mon_chr));
1714 1715 1716 1717
        mon_chr->chr_write = gdb_monitor_write;
        monitor_init(mon_chr, 0);
    } else {
        if (s->chr)
1718
            qemu_chr_delete(s->chr);
1719 1720 1721
        mon_chr = s->mon_chr;
        memset(s, 0, sizeof(GDBState));
    }
1722 1723
    s->c_cpu = first_cpu;
    s->g_cpu = first_cpu;
1724
    s->chr = chr;
1725 1726
    s->state = chr ? RS_IDLE : RS_INACTIVE;
    s->mon_chr = mon_chr;
1727
    s->current_syscall_cb = NULL;
1728

B
bellard 已提交
1729 1730
    return 0;
}
1731
#endif