Archipelago » qemu

/*

 * QEMU monitor

 * 

 * Copyright (c) 2003-2004 Fabrice Bellard

 * 

 * Permission is hereby granted, free of charge, to any person obtaining a copy

 * of this software and associated documentation files (the "Software"), to deal

 * in the Software without restriction, including without limitation the rights

 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell

 * copies of the Software, and to permit persons to whom the Software is

 * furnished to do so, subject to the following conditions:

 *

 * The above copyright notice and this permission notice shall be included in

 * all copies or substantial portions of the Software.

 *

 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR

 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,

 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL

 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER

 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,

 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN

 * THE SOFTWARE.

 */

#include "vl.h"

#include "disas.h"

#include <dirent.h>

//#define DEBUG

//#define DEBUG_COMPLETION

#ifndef offsetof

#define offsetof(type, field) ((size_t) &((type *)0)->field)

#endif

/*

 * Supported types:

 * 

 * 'F'          filename

 * 'B'          block device name

 * 's'          string (accept optional quote)

 * 'i'          32 bit integer

 * 'l'          target long (32 or 64 bit)

 * '/'          optional gdb-like print format (like "/10x")

 *

 * '?'          optional type (for 'F', 's' and 'i')

 *

 */

typedef struct term_cmd_t {

    const char *name;

    const char *args_type;

    void (*handler)();

    const char *params;

    const char *help;

} term_cmd_t;

static CharDriverState *monitor_hd;

static term_cmd_t term_cmds[];

static term_cmd_t info_cmds[];

static char term_outbuf[1024];

static int term_outbuf_index;

static void monitor_start_input(void);

CPUState *mon_cpu = NULL;

void term_flush(void)

{

    if (term_outbuf_index > 0) {

        qemu_chr_write(monitor_hd, term_outbuf, term_outbuf_index);

        term_outbuf_index = 0;

    }

}

/* flush at every end of line or if the buffer is full */

void term_puts(const char *str)

{

    int c;

    for(;;) {

        c = *str++;

        if (c == '\0')

            break;

        if (c == '\n')

            term_outbuf[term_outbuf_index++] = '\r';

        term_outbuf[term_outbuf_index++] = c;

        if (term_outbuf_index >= (sizeof(term_outbuf) - 1) ||

            c == '\n')

            term_flush();

    }

}

void term_vprintf(const char *fmt, va_list ap)

{

    char buf[4096];

    vsnprintf(buf, sizeof(buf), fmt, ap);

    term_puts(buf);

}

void term_printf(const char *fmt, ...)

{

    va_list ap;

    va_start(ap, fmt);

    term_vprintf(fmt, ap);

    va_end(ap);

}

static int monitor_fprintf(FILE *stream, const char *fmt, ...)

{

    va_list ap;

    va_start(ap, fmt);

    term_vprintf(fmt, ap);

    va_end(ap);

    return 0;

}

static int compare_cmd(const char *name, const char *list)

{

    const char *p, *pstart;

    int len;

    len = strlen(name);

    p = list;

    for(;;) {

        pstart = p;

        p = strchr(p, '|');

        if (!p)

            p = pstart + strlen(pstart);

        if ((p - pstart) == len && !memcmp(pstart, name, len))

            return 1;

        if (*p == '\0')

            break;

        p++;

    }

    return 0;

}

static void help_cmd1(term_cmd_t *cmds, const char *prefix, const char *name)

{

    term_cmd_t *cmd;

    for(cmd = cmds; cmd->name != NULL; cmd++) {

        if (!name || !strcmp(name, cmd->name))

            term_printf("%s%s %s -- %s\n", prefix, cmd->name, cmd->params, cmd->help);

    }

}

static void help_cmd(const char *name)

{

    if (name && !strcmp(name, "info")) {

        help_cmd1(info_cmds, "info ", NULL);

    } else {

        help_cmd1(term_cmds, "", name);

        if (name && !strcmp(name, "log")) {

            CPULogItem *item;

            term_printf("Log items (comma separated):\n");

            term_printf("%-10s %s\n", "none", "remove all logs");

            for(item = cpu_log_items; item->mask != 0; item++) {

                term_printf("%-10s %s\n", item->name, item->help);

            }

        }

    }

}

static void do_help(const char *name)

{

    help_cmd(name);

}

static void do_commit(const char *device)

{

    int i, all_devices;

    all_devices = !strcmp(device, "all");

    for (i = 0; i < MAX_DISKS; i++) {

        if (bs_table[i]) {

            if (all_devices || 

                !strcmp(bdrv_get_device_name(bs_table[i]), device))

                bdrv_commit(bs_table[i]);

        }

    }

}

static void do_info(const char *item)

{

    term_cmd_t *cmd;

    if (!item)

        goto help;

    for(cmd = info_cmds; cmd->name != NULL; cmd++) {

        if (compare_cmd(item, cmd->name)) 

            goto found;

    }

 help:

    help_cmd("info");

    return;

 found:

    cmd->handler();

}

static void do_info_version(void)

{

  term_printf("%s\n", QEMU_VERSION);

}

static void do_info_block(void)

{

    bdrv_info();

}

/* get the current CPU defined by the user */

int mon_set_cpu(int cpu_index)

{

    CPUState *env;

    for(env = first_cpu; env != NULL; env = env->next_cpu) {

        if (env->cpu_index == cpu_index) {

            mon_cpu = env;

            return 0;

        }

    }

    return -1;

}

CPUState *mon_get_cpu(void)

{

    if (!mon_cpu) {

        mon_set_cpu(0);

    }

    return mon_cpu;

}

static void do_info_registers(void)

{

    CPUState *env;

    env = mon_get_cpu();

    if (!env)

        return;

#ifdef TARGET_I386

    cpu_dump_state(env, NULL, monitor_fprintf,

                   X86_DUMP_FPU);

#else

    cpu_dump_state(env, NULL, monitor_fprintf, 

                   0);

#endif

}

static void do_info_cpus(void)

{

    CPUState *env;

    /* just to set the default cpu if not already done */

    mon_get_cpu();

    for(env = first_cpu; env != NULL; env = env->next_cpu) {

        term_printf("%c CPU #%d:", 

                    (env == mon_cpu) ? '*' : ' ',

                    env->cpu_index);

#if defined(TARGET_I386)

        term_printf(" pc=0x" TARGET_FMT_lx, env->eip + env->segs[R_CS].base);

        if (env->hflags & HF_HALTED_MASK)

            term_printf(" (halted)");

#elif defined(TARGET_PPC)

        term_printf(" nip=0x" TARGET_FMT_lx, env->nip);

        if (env->halted)

            term_printf(" (halted)");

#elif defined(TARGET_SPARC)

        term_printf(" pc=0x" TARGET_FMT_lx " npc=0x" TARGET_FMT_lx, env->pc, env->npc);

        if (env->halted)

            term_printf(" (halted)");

#endif

        term_printf("\n");

    }

}

static void do_cpu_set(int index)

{

    if (mon_set_cpu(index) < 0)

        term_printf("Invalid CPU index\n");

}

static void do_info_jit(void)

{

    dump_exec_info(NULL, monitor_fprintf);

}

static void do_info_history (void)

{

    int i;

    const char *str;

    i = 0;

    for(;;) {

        str = readline_get_history(i);

        if (!str)

            break;

        term_printf("%d: '%s'\n", i, str);

        i++;

    }

}

static void do_quit(void)

{

    exit(0);

}

static int eject_device(BlockDriverState *bs, int force)

{

    if (bdrv_is_inserted(bs)) {

        if (!force) {

            if (!bdrv_is_removable(bs)) {

                term_printf("device is not removable\n");

                return -1;

            }

            if (bdrv_is_locked(bs)) {

                term_printf("device is locked\n");

                return -1;

            }

        }

        bdrv_close(bs);

    }

    return 0;

}

static void do_eject(int force, const char *filename)

{

    BlockDriverState *bs;

    bs = bdrv_find(filename);

    if (!bs) {

        term_printf("device not found\n");

        return;

    }

    eject_device(bs, force);

}

static void do_change(const char *device, const char *filename)

{

    BlockDriverState *bs;

    int i;

    char password[256];

    bs = bdrv_find(device);

    if (!bs) {

        term_printf("device not found\n");

        return;

    }

    if (eject_device(bs, 0) < 0)

        return;

    bdrv_open(bs, filename, 0);

    if (bdrv_is_encrypted(bs)) {

        term_printf("%s is encrypted.\n", device);

        for(i = 0; i < 3; i++) {

            monitor_readline("Password: ", 1, password, sizeof(password));

            if (bdrv_set_key(bs, password) == 0)

                break;

            term_printf("invalid password\n");

        }

    }

}

static void do_screen_dump(const char *filename)

{

    vga_hw_screen_dump(filename);

}

static void do_log(const char *items)

{

    int mask;

    if (!strcmp(items, "none")) {

        mask = 0;

    } else {

        mask = cpu_str_to_log_mask(items);

        if (!mask) {

            help_cmd("log");

            return;

        }

    }

    cpu_set_log(mask);

}

static void do_stop(void)

{

    vm_stop(EXCP_INTERRUPT);

}

static void do_cont(void)

{

    vm_start();

}

#ifdef CONFIG_GDBSTUB

static void do_gdbserver(int has_port, int port)

{

    if (!has_port)

        port = DEFAULT_GDBSTUB_PORT;

    if (gdbserver_start(port) < 0) {

        qemu_printf("Could not open gdbserver socket on port %d\n", port);

    } else {

        qemu_printf("Waiting gdb connection on port %d\n", port);

    }

}

#endif

static void term_printc(int c)

{

    term_printf("'");

    switch(c) {

    case '\'':

        term_printf("\\'");

        break;

    case '\\':

        term_printf("\\\\");

        break;

    case '\n':

        term_printf("\\n");

        break;

    case '\r':

        term_printf("\\r");

        break;

    default:

        if (c >= 32 && c <= 126) {

            term_printf("%c", c);

        } else {

            term_printf("\\x%02x", c);

        }

        break;

    }

    term_printf("'");

}

static void memory_dump(int count, int format, int wsize, 

                        target_ulong addr, int is_physical)

{

    CPUState *env;

    int nb_per_line, l, line_size, i, max_digits, len;

    uint8_t buf[16];

    uint64_t v;

    if (format == 'i') {

        int flags;

        flags = 0;

        env = mon_get_cpu();

        if (!env && !is_physical)

            return;

#ifdef TARGET_I386

        if (wsize == 2) {

            flags = 1;

        } else if (wsize == 4) {

            flags = 0;

        } else {

            /* as default we use the current CS size */

            flags = 0;

            if (env) {

#ifdef TARGET_X86_64

                if ((env->efer & MSR_EFER_LMA) && 

                    (env->segs[R_CS].flags & DESC_L_MASK))

                    flags = 2;

                else

#endif

                if (!(env->segs[R_CS].flags & DESC_B_MASK))

                    flags = 1;

            }

        }

#endif

        monitor_disas(env, addr, count, is_physical, flags);

        return;

    }

    len = wsize * count;

    if (wsize == 1)

        line_size = 8;

    else

        line_size = 16;

    nb_per_line = line_size / wsize;

    max_digits = 0;

    switch(format) {

    case 'o':

        max_digits = (wsize * 8 + 2) / 3;

        break;

    default:

    case 'x':

        max_digits = (wsize * 8) / 4;

        break;

    case 'u':

    case 'd':

        max_digits = (wsize * 8 * 10 + 32) / 33;

        break;

    case 'c':

        wsize = 1;

        break;

    }

    while (len > 0) {

        term_printf(TARGET_FMT_lx ":", addr);

        l = len;

        if (l > line_size)

            l = line_size;

        if (is_physical) {

            cpu_physical_memory_rw(addr, buf, l, 0);

        } else {

            env = mon_get_cpu();

            if (!env)

                break;

            cpu_memory_rw_debug(env, addr, buf, l, 0);

        }

        i = 0; 

        while (i < l) {

            switch(wsize) {

            default:

            case 1:

                v = ldub_raw(buf + i);

                break;

            case 2:

                v = lduw_raw(buf + i);

                break;

            case 4:

                v = (uint32_t)ldl_raw(buf + i);

                break;

            case 8:

                v = ldq_raw(buf + i);

                break;

            }

            term_printf(" ");

            switch(format) {

            case 'o':

                term_printf("%#*" PRIo64, max_digits, v);

                break;

            case 'x':

                term_printf("0x%0*" PRIx64, max_digits, v);

                break;

            case 'u':

                term_printf("%*" PRIu64, max_digits, v);

                break;

            case 'd':

                term_printf("%*" PRId64, max_digits, v);

                break;

            case 'c':

                term_printc(v);

                break;

            }

            i += wsize;

        }

        term_printf("\n");

        addr += l;

        len -= l;

    }

}

#if TARGET_LONG_BITS == 64

#define GET_TLONG(h, l) (((uint64_t)(h) << 32) | (l))

#else

#define GET_TLONG(h, l) (l)

#endif

static void do_memory_dump(int count, int format, int size, 

                           uint32_t addrh, uint32_t addrl)

{

    target_long addr = GET_TLONG(addrh, addrl);

    memory_dump(count, format, size, addr, 0);

}

static void do_physical_memory_dump(int count, int format, int size,

                                    uint32_t addrh, uint32_t addrl)

{

    target_long addr = GET_TLONG(addrh, addrl);

    memory_dump(count, format, size, addr, 1);

}

static void do_print(int count, int format, int size, unsigned int valh, unsigned int vall)

{

    target_long val = GET_TLONG(valh, vall);

#if TARGET_LONG_BITS == 32

    switch(format) {

    case 'o':

        term_printf("%#o", val);

        break;

    case 'x':

        term_printf("%#x", val);

        break;

    case 'u':

        term_printf("%u", val);

        break;

    default:

    case 'd':

        term_printf("%d", val);

        break;

    case 'c':

        term_printc(val);

        break;

    }

#else

    switch(format) {

    case 'o':

        term_printf("%#" PRIo64, val);

        break;

    case 'x':

        term_printf("%#" PRIx64, val);

        break;

    case 'u':

        term_printf("%" PRIu64, val);

        break;

    default:

    case 'd':

        term_printf("%" PRId64, val);

        break;

    case 'c':

        term_printc(val);

        break;

    }

#endif

    term_printf("\n");

}

static void do_sum(uint32_t start, uint32_t size)

{

    uint32_t addr;

    uint8_t buf[1];

    uint16_t sum;

    sum = 0;

    for(addr = start; addr < (start + size); addr++) {

        cpu_physical_memory_rw(addr, buf, 1, 0);

        /* BSD sum algorithm ('sum' Unix command) */

        sum = (sum >> 1) | (sum << 15);

        sum += buf[0];

    }

    term_printf("%05d\n", sum);

}

typedef struct {

    int keycode;

    const char *name;

} KeyDef;

static const KeyDef key_defs[] = {

    { 0x2a, "shift" },

    { 0x36, "shift_r" },

    { 0x38, "alt" },

    { 0xb8, "alt_r" },

    { 0x1d, "ctrl" },

    { 0x9d, "ctrl_r" },

    { 0xdd, "menu" },

    { 0x01, "esc" },

    { 0x02, "1" },

    { 0x03, "2" },

    { 0x04, "3" },

    { 0x05, "4" },

    { 0x06, "5" },

    { 0x07, "6" },

    { 0x08, "7" },

    { 0x09, "8" },

    { 0x0a, "9" },

    { 0x0b, "0" },

    { 0x0c, "minus" },

    { 0x0d, "equal" },

    { 0x0e, "backspace" },

    { 0x0f, "tab" },

    { 0x10, "q" },

    { 0x11, "w" },

    { 0x12, "e" },

    { 0x13, "r" },

    { 0x14, "t" },

    { 0x15, "y" },

    { 0x16, "u" },

    { 0x17, "i" },

    { 0x18, "o" },

    { 0x19, "p" },

    { 0x1c, "ret" },

    { 0x1e, "a" },

    { 0x1f, "s" },

    { 0x20, "d" },

    { 0x21, "f" },

    { 0x22, "g" },

    { 0x23, "h" },

    { 0x24, "j" },

    { 0x25, "k" },

    { 0x26, "l" },

    { 0x2c, "z" },

    { 0x2d, "x" },

    { 0x2e, "c" },

    { 0x2f, "v" },

    { 0x30, "b" },

    { 0x31, "n" },

    { 0x32, "m" },

    { 0x39, "spc" },

    { 0x3a, "caps_lock" },

    { 0x3b, "f1" },

    { 0x3c, "f2" },

    { 0x3d, "f3" },

    { 0x3e, "f4" },

    { 0x3f, "f5" },

    { 0x40, "f6" },

    { 0x41, "f7" },

    { 0x42, "f8" },

    { 0x43, "f9" },

    { 0x44, "f10" },

    { 0x45, "num_lock" },

    { 0x46, "scroll_lock" },

    { 0xb5, "kp_divide" },

    { 0x37, "kp_multiply" },

    { 0x4a, "kp_substract" },

    { 0x4e, "kp_add" },

    { 0x9c, "kp_enter" },

    { 0x53, "kp_decimal" },

    { 0x52, "kp_0" },

    { 0x4f, "kp_1" },

    { 0x50, "kp_2" },

    { 0x51, "kp_3" },

    { 0x4b, "kp_4" },

    { 0x4c, "kp_5" },

    { 0x4d, "kp_6" },

    { 0x47, "kp_7" },

    { 0x48, "kp_8" },

    { 0x49, "kp_9" },

    { 0x56, "<" },

    { 0x57, "f11" },

    { 0x58, "f12" },

    { 0xb7, "print" },

    { 0xc7, "home" },

    { 0xc9, "pgup" },

    { 0xd1, "pgdn" },

    { 0xcf, "end" },

    { 0xcb, "left" },

    { 0xc8, "up" },

    { 0xd0, "down" },

    { 0xcd, "right" },

    { 0xd2, "insert" },

    { 0xd3, "delete" },

    { 0, NULL },

};

static int get_keycode(const char *key)

{

    const KeyDef *p;

    char *endp;

    int ret;

    for(p = key_defs; p->name != NULL; p++) {

        if (!strcmp(key, p->name))

            return p->keycode;

    }

    if (strstart(key, "0x", NULL)) {

        ret = strtoul(key, &endp, 0);

        if (*endp == '\0' && ret >= 0x01 && ret <= 0xff)

            return ret;

    }

    return -1;

}

static void do_send_key(const char *string)

{

    char keybuf[16], *q;

    uint8_t keycodes[16];

    const char *p;

    int nb_keycodes, keycode, i;

    nb_keycodes = 0;

    p = string;

    while (*p != '\0') {

        q = keybuf;

        while (*p != '\0' && *p != '-') {

            if ((q - keybuf) < sizeof(keybuf) - 1) {

                *q++ = *p;

            }

            p++;

        }

        *q = '\0';

        keycode = get_keycode(keybuf);

        if (keycode < 0) {

            term_printf("unknown key: '%s'\n", keybuf);

            return;

        }

        keycodes[nb_keycodes++] = keycode;

        if (*p == '\0')

            break;

        p++;

    }

    /* key down events */

    for(i = 0; i < nb_keycodes; i++) {

        keycode = keycodes[i];

        if (keycode & 0x80)

            kbd_put_keycode(0xe0);

        kbd_put_keycode(keycode & 0x7f);

    }

    /* key up events */

    for(i = nb_keycodes - 1; i >= 0; i--) {

        keycode = keycodes[i];

        if (keycode & 0x80)

            kbd_put_keycode(0xe0);

        kbd_put_keycode(keycode | 0x80);

    }

}

static int mouse_button_state;

static void do_mouse_move(const char *dx_str, const char *dy_str, 

                          const char *dz_str)

{

    int dx, dy, dz;

    dx = strtol(dx_str, NULL, 0);

    dy = strtol(dy_str, NULL, 0);

    dz = 0;