Statistics
| Branch: | Revision:

root / monitor.c @ 678f2df6

History | View | Annotate | Download (43.9 kB)

1
/*
2
 * QEMU monitor
3
 * 
4
 * Copyright (c) 2003-2004 Fabrice Bellard
5
 * 
6
 * Permission is hereby granted, free of charge, to any person obtaining a copy
7
 * of this software and associated documentation files (the "Software"), to deal
8
 * in the Software without restriction, including without limitation the rights
9
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10
 * copies of the Software, and to permit persons to whom the Software is
11
 * furnished to do so, subject to the following conditions:
12
 *
13
 * The above copyright notice and this permission notice shall be included in
14
 * all copies or substantial portions of the Software.
15
 *
16
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22
 * THE SOFTWARE.
23
 */
24
#include "vl.h"
25
#include "disas.h"
26

    
27
//#define DEBUG
28

    
29
#ifndef offsetof
30
#define offsetof(type, field) ((size_t) &((type *)0)->field)
31
#endif
32

    
33
#define TERM_CMD_BUF_SIZE 4095
34
#define TERM_MAX_CMDS 64
35

    
36
#define IS_NORM 0
37
#define IS_ESC  1
38
#define IS_CSI  2
39

    
40
#define printf do_not_use_printf
41

    
42
static char term_cmd_buf[TERM_CMD_BUF_SIZE + 1];
43
static int term_cmd_buf_index;
44
static int term_cmd_buf_size;
45
static int term_esc_state;
46
static int term_esc_param;
47

    
48
static char *term_history[TERM_MAX_CMDS];
49
static int term_hist_entry;
50

    
51
/*
52
 * Supported types:
53
 * 
54
 * 'F'          filename
55
 * 's'          string (accept optional quote)
56
 * 'i'          integer
57
 * '/'          optional gdb-like print format (like "/10x")
58
 *
59
 * '?'          optional type (for 'F', 's' and 'i')
60
 *
61
 */
62

    
63
typedef struct term_cmd_t {
64
    const char *name;
65
    const char *args_type;
66
    void (*handler)();
67
    const char *params;
68
    const char *help;
69
} term_cmd_t;
70

    
71
static term_cmd_t term_cmds[];
72
static term_cmd_t info_cmds[];
73

    
74
void term_printf(const char *fmt, ...)
75
{
76
    va_list ap;
77
    va_start(ap, fmt);
78
    vprintf(fmt, ap);
79
    va_end(ap);
80
}
81

    
82
void term_flush(void)
83
{
84
    fflush(stdout);
85
}
86

    
87
static int compare_cmd(const char *name, const char *list)
88
{
89
    const char *p, *pstart;
90
    int len;
91
    len = strlen(name);
92
    p = list;
93
    for(;;) {
94
        pstart = p;
95
        p = strchr(p, '|');
96
        if (!p)
97
            p = pstart + strlen(pstart);
98
        if ((p - pstart) == len && !memcmp(pstart, name, len))
99
            return 1;
100
        if (*p == '\0')
101
            break;
102
        p++;
103
    }
104
    return 0;
105
}
106

    
107
static void help_cmd1(term_cmd_t *cmds, const char *prefix, const char *name)
108
{
109
    term_cmd_t *cmd;
110

    
111
    for(cmd = cmds; cmd->name != NULL; cmd++) {
112
        if (!name || !strcmp(name, cmd->name))
113
            term_printf("%s%s %s -- %s\n", prefix, cmd->name, cmd->params, cmd->help);
114
    }
115
}
116

    
117
static void help_cmd(const char *name)
118
{
119
    if (name && !strcmp(name, "info")) {
120
        help_cmd1(info_cmds, "info ", NULL);
121
    } else {
122
        help_cmd1(term_cmds, "", name);
123
        if (name && !strcmp(name, "log")) {
124
            CPULogItem *item;
125
            term_printf("Log items (comma separated):\n");
126
            term_printf("%-10s %s\n", "none", "remove all logs");
127
            for(item = cpu_log_items; item->mask != 0; item++) {
128
                term_printf("%-10s %s\n", item->name, item->help);
129
            }
130
        }
131
    }
132
}
133

    
134
static void do_help(const char *name)
135
{
136
    help_cmd(name);
137
}
138

    
139
static void do_commit(void)
140
{
141
    int i;
142

    
143
    for (i = 0; i < MAX_DISKS; i++) {
144
        if (bs_table[i])
145
            bdrv_commit(bs_table[i]);
146
    }
147
}
148

    
149
static void do_info(const char *item)
150
{
151
    term_cmd_t *cmd;
152

    
153
    if (!item)
154
        goto help;
155
    for(cmd = info_cmds; cmd->name != NULL; cmd++) {
156
        if (compare_cmd(item, cmd->name)) 
157
            goto found;
158
    }
159
 help:
160
    help_cmd("info");
161
    return;
162
 found:
163
    cmd->handler();
164
}
165

    
166
static void do_info_network(void)
167
{
168
    int i, j;
169
    NetDriverState *nd;
170
    
171
    for(i = 0; i < nb_nics; i++) {
172
        nd = &nd_table[i];
173
        term_printf("%d: ifname=%s macaddr=", i, nd->ifname);
174
        for(j = 0; j < 6; j++) {
175
            if (j > 0)
176
                term_printf(":");
177
            term_printf("%02x", nd->macaddr[j]);
178
        }
179
        term_printf("\n");
180
    }
181
}
182
 
183
static void do_info_block(void)
184
{
185
    bdrv_info();
186
}
187

    
188
static void do_info_registers(void)
189
{
190
#ifdef TARGET_I386
191
    cpu_dump_state(cpu_single_env, stdout, X86_DUMP_FPU | X86_DUMP_CCOP);
192
#else
193
    cpu_dump_state(cpu_single_env, stdout, 0);
194
#endif
195
}
196

    
197
static void do_info_history (void)
198
{
199
    int i;
200

    
201
    for (i = 0; i < TERM_MAX_CMDS; i++) {
202
        if (term_history[i] == NULL)
203
            break;
204
        term_printf("%d: '%s'\n", i, term_history[i]);
205
    }
206
}
207

    
208
static void do_quit(void)
209
{
210
    exit(0);
211
}
212

    
213
static int eject_device(BlockDriverState *bs, int force)
214
{
215
    if (bdrv_is_inserted(bs)) {
216
        if (!force) {
217
            if (!bdrv_is_removable(bs)) {
218
                term_printf("device is not removable\n");
219
                return -1;
220
            }
221
            if (bdrv_is_locked(bs)) {
222
                term_printf("device is locked\n");
223
                return -1;
224
            }
225
        }
226
        bdrv_close(bs);
227
    }
228
    return 0;
229
}
230

    
231
static void do_eject(int force, const char *filename)
232
{
233
    BlockDriverState *bs;
234

    
235
    term_printf("%d %s\n", force, filename);
236

    
237
    bs = bdrv_find(filename);
238
    if (!bs) {
239
        term_printf("device not found\n");
240
        return;
241
    }
242
    eject_device(bs, force);
243
}
244

    
245
static void do_change(const char *device, const char *filename)
246
{
247
    BlockDriverState *bs;
248

    
249
    bs = bdrv_find(device);
250
    if (!bs) {
251
        term_printf("device not found\n");
252
        return;
253
    }
254
    if (eject_device(bs, 0) < 0)
255
        return;
256
    bdrv_open(bs, filename, 0);
257
}
258

    
259
static void do_screen_dump(const char *filename)
260
{
261
    vga_screen_dump(filename);
262
}
263

    
264
static void do_log(const char *items)
265
{
266
    int mask;
267
    
268
    if (!strcmp(items, "none")) {
269
        mask = 0;
270
    } else {
271
        mask = cpu_str_to_log_mask(items);
272
        if (!mask) {
273
            help_cmd("log");
274
            return;
275
        }
276
    }
277
    cpu_set_log(mask);
278
}
279

    
280
static void do_savevm(const char *filename)
281
{
282
    if (qemu_savevm(filename) < 0)
283
        term_printf("I/O error when saving VM to '%s'\n", filename);
284
}
285

    
286
static void do_loadvm(const char *filename)
287
{
288
    if (qemu_loadvm(filename) < 0) 
289
        term_printf("I/O error when loading VM from '%s'\n", filename);
290
}
291

    
292
static void do_stop(void)
293
{
294
    vm_stop(EXCP_INTERRUPT);
295
}
296

    
297
static void do_cont(void)
298
{
299
    vm_start();
300
}
301

    
302
#ifdef CONFIG_GDBSTUB
303
static void do_gdbserver(int has_port, int port)
304
{
305
    if (!has_port)
306
        port = DEFAULT_GDBSTUB_PORT;
307
    if (gdbserver_start(port) < 0) {
308
        qemu_printf("Could not open gdbserver socket on port %d\n", port);
309
    } else {
310
        qemu_printf("Waiting gdb connection on port %d\n", port);
311
    }
312
}
313
#endif
314

    
315
static void term_printc(int c)
316
{
317
    term_printf("'");
318
    switch(c) {
319
    case '\'':
320
        term_printf("\\'");
321
        break;
322
    case '\\':
323
        term_printf("\\\\");
324
        break;
325
    case '\n':
326
        term_printf("\\n");
327
        break;
328
    case '\r':
329
        term_printf("\\r");
330
        break;
331
    default:
332
        if (c >= 32 && c <= 126) {
333
            term_printf("%c", c);
334
        } else {
335
            term_printf("\\x%02x", c);
336
        }
337
        break;
338
    }
339
    term_printf("'");
340
}
341

    
342
static void memory_dump(int count, int format, int wsize, 
343
                        target_ulong addr, int is_physical)
344
{
345
    int nb_per_line, l, line_size, i, max_digits, len;
346
    uint8_t buf[16];
347
    uint64_t v;
348

    
349
    if (format == 'i') {
350
        int flags;
351
        flags = 0;
352
#ifdef TARGET_I386
353
        if (wsize == 2) {
354
            flags = 1;
355
        } else if (wsize == 4) {
356
            flags = 0;
357
        } else {
358
            /* as default we use the current CS size */
359
            flags = 0;
360
            if (!(cpu_single_env->segs[R_CS].flags & DESC_B_MASK))
361
                flags = 1;
362
        }
363
#endif
364
        monitor_disas(addr, count, is_physical, flags);
365
        return;
366
    }
367

    
368
    len = wsize * count;
369
    if (wsize == 1)
370
        line_size = 8;
371
    else
372
        line_size = 16;
373
    nb_per_line = line_size / wsize;
374
    max_digits = 0;
375

    
376
    switch(format) {
377
    case 'o':
378
        max_digits = (wsize * 8 + 2) / 3;
379
        break;
380
    default:
381
    case 'x':
382
        max_digits = (wsize * 8) / 4;
383
        break;
384
    case 'u':
385
    case 'd':
386
        max_digits = (wsize * 8 * 10 + 32) / 33;
387
        break;
388
    case 'c':
389
        wsize = 1;
390
        break;
391
    }
392

    
393
    while (len > 0) {
394
        term_printf("0x%08x:", addr);
395
        l = len;
396
        if (l > line_size)
397
            l = line_size;
398
        if (is_physical) {
399
            cpu_physical_memory_rw(addr, buf, l, 0);
400
        } else {
401
            cpu_memory_rw_debug(cpu_single_env, addr, buf, l, 0);
402
        }
403
        i = 0; 
404
        while (i < l) {
405
            switch(wsize) {
406
            default:
407
            case 1:
408
                v = ldub_raw(buf + i);
409
                break;
410
            case 2:
411
                v = lduw_raw(buf + i);
412
                break;
413
            case 4:
414
                v = ldl_raw(buf + i);
415
                break;
416
            case 8:
417
                v = ldq_raw(buf + i);
418
                break;
419
            }
420
            term_printf(" ");
421
            switch(format) {
422
            case 'o':
423
                term_printf("%#*llo", max_digits, v);
424
                break;
425
            case 'x':
426
                term_printf("0x%0*llx", max_digits, v);
427
                break;
428
            case 'u':
429
                term_printf("%*llu", max_digits, v);
430
                break;
431
            case 'd':
432
                term_printf("%*lld", max_digits, v);
433
                break;
434
            case 'c':
435
                term_printc(v);
436
                break;
437
            }
438
            i += wsize;
439
        }
440
        term_printf("\n");
441
        addr += l;
442
        len -= l;
443
    }
444
}
445

    
446
static void do_memory_dump(int count, int format, int size, int addr)
447
{
448
    memory_dump(count, format, size, addr, 0);
449
}
450

    
451
static void do_physical_memory_dump(int count, int format, int size, int addr)
452
{
453
    memory_dump(count, format, size, addr, 1);
454
}
455

    
456
static void do_print(int count, int format, int size, int val)
457
{
458
    switch(format) {
459
    case 'o':
460
        term_printf("%#o", val);
461
        break;
462
    case 'x':
463
        term_printf("%#x", val);
464
        break;
465
    case 'u':
466
        term_printf("%u", val);
467
        break;
468
    default:
469
    case 'd':
470
        term_printf("%d", val);
471
        break;
472
    case 'c':
473
        term_printc(val);
474
        break;
475
    }
476
    term_printf("\n");
477
}
478

    
479
typedef struct {
480
    int keycode;
481
    const char *name;
482
} KeyDef;
483

    
484
static const KeyDef key_defs[] = {
485
    { 0x2a, "shift" },
486
    { 0x36, "shift_r" },
487
    
488
    { 0x38, "alt" },
489
    { 0xb8, "alt_r" },
490
    { 0x1d, "ctrl" },
491
    { 0x9d, "ctrl_r" },
492

    
493
    { 0xdd, "menu" },
494

    
495
    { 0x01, "esc" },
496

    
497
    { 0x02, "1" },
498
    { 0x03, "2" },
499
    { 0x04, "3" },
500
    { 0x05, "4" },
501
    { 0x06, "5" },
502
    { 0x07, "6" },
503
    { 0x08, "7" },
504
    { 0x09, "8" },
505
    { 0x0a, "9" },
506
    { 0x0b, "0" },
507
    { 0x0e, "backspace" },
508

    
509
    { 0x0f, "tab" },
510
    { 0x10, "q" },
511
    { 0x11, "w" },
512
    { 0x12, "e" },
513
    { 0x13, "r" },
514
    { 0x14, "t" },
515
    { 0x15, "y" },
516
    { 0x16, "u" },
517
    { 0x17, "i" },
518
    { 0x18, "o" },
519
    { 0x19, "p" },
520

    
521
    { 0x1c, "ret" },
522

    
523
    { 0x1e, "a" },
524
    { 0x1f, "s" },
525
    { 0x20, "d" },
526
    { 0x21, "f" },
527
    { 0x22, "g" },
528
    { 0x23, "h" },
529
    { 0x24, "j" },
530
    { 0x25, "k" },
531
    { 0x26, "l" },
532

    
533
    { 0x2c, "z" },
534
    { 0x2d, "x" },
535
    { 0x2e, "c" },
536
    { 0x2f, "v" },
537
    { 0x30, "b" },
538
    { 0x31, "n" },
539
    { 0x32, "m" },
540
    
541
    { 0x39, "spc" },
542
    { 0x3a, "caps_lock" },
543
    { 0x3b, "f1" },
544
    { 0x3c, "f2" },
545
    { 0x3d, "f3" },
546
    { 0x3e, "f4" },
547
    { 0x3f, "f5" },
548
    { 0x40, "f6" },
549
    { 0x41, "f7" },
550
    { 0x42, "f8" },
551
    { 0x43, "f9" },
552
    { 0x44, "f10" },
553
    { 0x45, "num_lock" },
554
    { 0x46, "scroll_lock" },
555

    
556
    { 0x56, "<" },
557

    
558
    { 0x57, "f11" },
559
    { 0x58, "f12" },
560

    
561
    { 0xb7, "print" },
562

    
563
    { 0xc7, "home" },
564
    { 0xc9, "pgup" },
565
    { 0xd1, "pgdn" },
566
    { 0xcf, "end" },
567

    
568
    { 0xcb, "left" },
569
    { 0xc8, "up" },
570
    { 0xd0, "down" },
571
    { 0xcd, "right" },
572

    
573
    { 0xd2, "insert" },
574
    { 0xd3, "delete" },
575
    { 0, NULL },
576
};
577

    
578
static int get_keycode(const char *key)
579
{
580
    const KeyDef *p;
581

    
582
    for(p = key_defs; p->name != NULL; p++) {
583
        if (!strcmp(key, p->name))
584
            return p->keycode;
585
    }
586
    return -1;
587
}
588

    
589
static void do_send_key(const char *string)
590
{
591
    char keybuf[16], *q;
592
    uint8_t keycodes[16];
593
    const char *p;
594
    int nb_keycodes, keycode, i;
595
    
596
    nb_keycodes = 0;
597
    p = string;
598
    while (*p != '\0') {
599
        q = keybuf;
600
        while (*p != '\0' && *p != '-') {
601
            if ((q - keybuf) < sizeof(keybuf) - 1) {
602
                *q++ = *p;
603
            }
604
            p++;
605
        }
606
        *q = '\0';
607
        keycode = get_keycode(keybuf);
608
        if (keycode < 0) {
609
            term_printf("unknown key: '%s'\n", keybuf);
610
            return;
611
        }
612
        keycodes[nb_keycodes++] = keycode;
613
        if (*p == '\0')
614
            break;
615
        p++;
616
    }
617
    /* key down events */
618
    for(i = 0; i < nb_keycodes; i++) {
619
        keycode = keycodes[i];
620
        if (keycode & 0x80)
621
            kbd_put_keycode(0xe0);
622
        kbd_put_keycode(keycode & 0x7f);
623
    }
624
    /* key up events */
625
    for(i = nb_keycodes - 1; i >= 0; i--) {
626
        keycode = keycodes[i];
627
        if (keycode & 0x80)
628
            kbd_put_keycode(0xe0);
629
        kbd_put_keycode(keycode | 0x80);
630
    }
631
}
632

    
633
static void do_ioport_read(int count, int format, int size, int addr, int has_index, int index)
634
{
635
    uint32_t val;
636
    int suffix;
637

    
638
    if (has_index) {
639
        cpu_outb(NULL, addr & 0xffff, index & 0xff);
640
        addr++;
641
    }
642
    addr &= 0xffff;
643

    
644
    switch(size) {
645
    default:
646
    case 1:
647
        val = cpu_inb(NULL, addr);
648
        suffix = 'b';
649
        break;
650
    case 2:
651
        val = cpu_inw(NULL, addr);
652
        suffix = 'w';
653
        break;
654
    case 4:
655
        val = cpu_inl(NULL, addr);
656
        suffix = 'l';
657
        break;
658
    }
659
    term_printf("port%c[0x%04x] = %#0*x\n",
660
                suffix, addr, size * 2, val);
661
}
662

    
663
static void do_system_reset(void)
664
{
665
    qemu_system_reset_request();
666
}
667

    
668
static term_cmd_t term_cmds[] = {
669
    { "help|?", "s?", do_help, 
670
      "[cmd]", "show the help" },
671
    { "commit", "", do_commit, 
672
      "", "commit changes to the disk images (if -snapshot is used)" },
673
    { "info", "s?", do_info,
674
      "subcommand", "show various information about the system state" },
675
    { "q|quit", "", do_quit,
676
      "", "quit the emulator" },
677
    { "eject", "-fs", do_eject,
678
      "[-f] device", "eject a removable media (use -f to force it)" },
679
    { "change", "sF", do_change,
680
      "device filename", "change a removable media" },
681
    { "screendump", "F", do_screen_dump, 
682
      "filename", "save screen into PPM image 'filename'" },
683
    { "log", "s", do_log,
684
      "item1[,...]", "activate logging of the specified items to '/tmp/qemu.log'" }, 
685
    { "savevm", "F", do_savevm,
686
      "filename", "save the whole virtual machine state to 'filename'" }, 
687
    { "loadvm", "F", do_loadvm,
688
      "filename", "restore the whole virtual machine state from 'filename'" }, 
689
    { "stop", "", do_stop, 
690
      "", "stop emulation", },
691
    { "c|cont", "", do_cont, 
692
      "", "resume emulation", },
693
#ifdef CONFIG_GDBSTUB
694
    { "gdbserver", "i?", do_gdbserver, 
695
      "[port]", "start gdbserver session (default port=1234)", },
696
#endif
697
    { "x", "/i", do_memory_dump, 
698
      "/fmt addr", "virtual memory dump starting at 'addr'", },
699
    { "xp", "/i", do_physical_memory_dump, 
700
      "/fmt addr", "physical memory dump starting at 'addr'", },
701
    { "p|print", "/i", do_print, 
702
      "/fmt expr", "print expression value (use $reg for CPU register access)", },
703
    { "i", "/ii.", do_ioport_read, 
704
      "/fmt addr", "I/O port read" },
705

    
706
    { "sendkey", "s", do_send_key, 
707
      "keys", "send keys to the VM (e.g. 'sendkey ctrl-alt-f1')" },
708
    { "system_reset", "", do_system_reset, 
709
      "", "reset the system" },
710
    { NULL, NULL, }, 
711
};
712

    
713
static term_cmd_t info_cmds[] = {
714
    { "network", "", do_info_network,
715
      "", "show the network state" },
716
    { "block", "", do_info_block,
717
      "", "show the block devices" },
718
    { "registers", "", do_info_registers,
719
      "", "show the cpu registers" },
720
    { "history", "", do_info_history,
721
      "", "show the command line history", },
722
    { "irq", "", irq_info,
723
      "", "show the interrupts statistics (if available)", },
724
    { "pic", "", pic_info,
725
      "", "show i8259 (PIC) state", },
726
    { "pci", "", pci_info,
727
      "", "show PCI info", },
728
    { NULL, NULL, },
729
};
730

    
731
/*******************************************************************/
732

    
733
static const char *pch;
734
static jmp_buf expr_env;
735

    
736
typedef struct MonitorDef {
737
    const char *name;
738
    int offset;
739
    int (*get_value)(struct MonitorDef *md);
740
} MonitorDef;
741

    
742
#if defined(TARGET_I386)
743
static int monitor_get_pc (struct MonitorDef *md)
744
{
745
    return cpu_single_env->eip + (long)cpu_single_env->segs[R_CS].base;
746
}
747
#endif
748

    
749
#if defined(TARGET_PPC)
750
static int monitor_get_ccr (struct MonitorDef *md)
751
{
752
    unsigned int u;
753
    int i;
754

    
755
    u = 0;
756
    for (i = 0; i < 8; i++)
757
        u |= cpu_single_env->crf[i] << (32 - (4 * i));
758

    
759
    return u;
760
}
761

    
762
static int monitor_get_msr (struct MonitorDef *md)
763
{
764
    return (cpu_single_env->msr[MSR_POW] << MSR_POW) |
765
        (cpu_single_env->msr[MSR_ILE] << MSR_ILE) |
766
        (cpu_single_env->msr[MSR_EE] << MSR_EE) |
767
        (cpu_single_env->msr[MSR_PR] << MSR_PR) |
768
        (cpu_single_env->msr[MSR_FP] << MSR_FP) |
769
        (cpu_single_env->msr[MSR_ME] << MSR_ME) |
770
        (cpu_single_env->msr[MSR_FE0] << MSR_FE0) |
771
        (cpu_single_env->msr[MSR_SE] << MSR_SE) |
772
        (cpu_single_env->msr[MSR_BE] << MSR_BE) |
773
        (cpu_single_env->msr[MSR_FE1] << MSR_FE1) |
774
        (cpu_single_env->msr[MSR_IP] << MSR_IP) |
775
        (cpu_single_env->msr[MSR_IR] << MSR_IR) |
776
        (cpu_single_env->msr[MSR_DR] << MSR_DR) |
777
        (cpu_single_env->msr[MSR_RI] << MSR_RI) |
778
        (cpu_single_env->msr[MSR_LE] << MSR_LE);
779
}
780

    
781
static int monitor_get_xer (struct MonitorDef *md)
782
{
783
    return (cpu_single_env->xer[XER_SO] << XER_SO) |
784
        (cpu_single_env->xer[XER_OV] << XER_OV) |
785
        (cpu_single_env->xer[XER_CA] << XER_CA) |
786
        (cpu_single_env->xer[XER_BC] << XER_BC);
787
}
788

    
789
uint32_t cpu_ppc_load_decr (CPUState *env);
790
static int monitor_get_decr (struct MonitorDef *md)
791
{
792
    return cpu_ppc_load_decr(cpu_single_env);
793
}
794

    
795
uint32_t cpu_ppc_load_tbu (CPUState *env);
796
static int monitor_get_tbu (struct MonitorDef *md)
797
{
798
    return cpu_ppc_load_tbu(cpu_single_env);
799
}
800

    
801
uint32_t cpu_ppc_load_tbl (CPUState *env);
802
static int monitor_get_tbl (struct MonitorDef *md)
803
{
804
    return cpu_ppc_load_tbl(cpu_single_env);
805
}
806
#endif
807

    
808
static MonitorDef monitor_defs[] = {
809
#ifdef TARGET_I386
810

    
811
#define SEG(name, seg) \
812
    { name, offsetof(CPUState, segs[seg].selector) },\
813
    { name ".base", offsetof(CPUState, segs[seg].base) },\
814
    { name ".limit", offsetof(CPUState, segs[seg].limit) },
815

    
816
    { "eax", offsetof(CPUState, regs[0]) },
817
    { "ecx", offsetof(CPUState, regs[1]) },
818
    { "edx", offsetof(CPUState, regs[2]) },
819
    { "ebx", offsetof(CPUState, regs[3]) },
820
    { "esp|sp", offsetof(CPUState, regs[4]) },
821
    { "ebp|fp", offsetof(CPUState, regs[5]) },
822
    { "esi", offsetof(CPUState, regs[6]) },
823
    { "esi", offsetof(CPUState, regs[7]) },
824
    { "eflags", offsetof(CPUState, eflags) },
825
    { "eip", offsetof(CPUState, eip) },
826
    SEG("cs", R_CS)
827
    SEG("ds", R_DS)
828
    SEG("es", R_ES)
829
    SEG("fs", R_FS)
830
    SEG("gs", R_GS)
831
    { "pc", 0, monitor_get_pc, },
832
#elif defined(TARGET_PPC)
833
    { "r0", offsetof(CPUState, gpr[0]) },
834
    { "r1", offsetof(CPUState, gpr[1]) },
835
    { "r2", offsetof(CPUState, gpr[2]) },
836
    { "r3", offsetof(CPUState, gpr[3]) },
837
    { "r4", offsetof(CPUState, gpr[4]) },
838
    { "r5", offsetof(CPUState, gpr[5]) },
839
    { "r6", offsetof(CPUState, gpr[6]) },
840
    { "r7", offsetof(CPUState, gpr[7]) },
841
    { "r8", offsetof(CPUState, gpr[8]) },
842
    { "r9", offsetof(CPUState, gpr[9]) },
843
    { "r10", offsetof(CPUState, gpr[10]) },
844
    { "r11", offsetof(CPUState, gpr[11]) },
845
    { "r12", offsetof(CPUState, gpr[12]) },
846
    { "r13", offsetof(CPUState, gpr[13]) },
847
    { "r14", offsetof(CPUState, gpr[14]) },
848
    { "r15", offsetof(CPUState, gpr[15]) },
849
    { "r16", offsetof(CPUState, gpr[16]) },
850
    { "r17", offsetof(CPUState, gpr[17]) },
851
    { "r18", offsetof(CPUState, gpr[18]) },
852
    { "r19", offsetof(CPUState, gpr[19]) },
853
    { "r20", offsetof(CPUState, gpr[20]) },
854
    { "r21", offsetof(CPUState, gpr[21]) },
855
    { "r22", offsetof(CPUState, gpr[22]) },
856
    { "r23", offsetof(CPUState, gpr[23]) },
857
    { "r24", offsetof(CPUState, gpr[24]) },
858
    { "r25", offsetof(CPUState, gpr[25]) },
859
    { "r26", offsetof(CPUState, gpr[26]) },
860
    { "r27", offsetof(CPUState, gpr[27]) },
861
    { "r28", offsetof(CPUState, gpr[28]) },
862
    { "r29", offsetof(CPUState, gpr[29]) },
863
    { "r30", offsetof(CPUState, gpr[30]) },
864
    { "r31", offsetof(CPUState, gpr[31]) },
865
    { "nip|pc", offsetof(CPUState, nip) },
866
    { "lr", offsetof(CPUState, lr) },
867
    { "ctr", offsetof(CPUState, ctr) },
868
    { "decr", 0, &monitor_get_decr, },
869
    { "ccr", 0, &monitor_get_ccr, },
870
    { "msr", 0, &monitor_get_msr, },
871
    { "xer", 0, &monitor_get_xer, },
872
    { "tbu", 0, &monitor_get_tbu, },
873
    { "tbl", 0, &monitor_get_tbl, },
874
    { "sdr1", offsetof(CPUState, sdr1) },
875
    { "sr0", offsetof(CPUState, sr[0]) },
876
    { "sr1", offsetof(CPUState, sr[1]) },
877
    { "sr2", offsetof(CPUState, sr[2]) },
878
    { "sr3", offsetof(CPUState, sr[3]) },
879
    { "sr4", offsetof(CPUState, sr[4]) },
880
    { "sr5", offsetof(CPUState, sr[5]) },
881
    { "sr6", offsetof(CPUState, sr[6]) },
882
    { "sr7", offsetof(CPUState, sr[7]) },
883
    { "sr8", offsetof(CPUState, sr[8]) },
884
    { "sr9", offsetof(CPUState, sr[9]) },
885
    { "sr10", offsetof(CPUState, sr[10]) },
886
    { "sr11", offsetof(CPUState, sr[11]) },
887
    { "sr12", offsetof(CPUState, sr[12]) },
888
    { "sr13", offsetof(CPUState, sr[13]) },
889
    { "sr14", offsetof(CPUState, sr[14]) },
890
    { "sr15", offsetof(CPUState, sr[15]) },
891
    /* Too lazy to put BATs and SPRs ... */
892
#endif
893
    { NULL },
894
};
895

    
896
static void expr_error(const char *fmt) 
897
{
898
    term_printf(fmt);
899
    term_printf("\n");
900
    longjmp(expr_env, 1);
901
}
902

    
903
static int get_monitor_def(int *pval, const char *name)
904
{
905
    MonitorDef *md;
906
    for(md = monitor_defs; md->name != NULL; md++) {
907
        if (compare_cmd(name, md->name)) {
908
            if (md->get_value) {
909
                *pval = md->get_value(md);
910
            } else {
911
                *pval = *(uint32_t *)((uint8_t *)cpu_single_env + md->offset);
912
            }
913
            return 0;
914
        }
915
    }
916
    return -1;
917
}
918

    
919
static void next(void)
920
{
921
    if (pch != '\0') {
922
        pch++;
923
        while (isspace(*pch))
924
            pch++;
925
    }
926
}
927

    
928
static int expr_sum(void);
929

    
930
static int expr_unary(void)
931
{
932
    int n;
933
    char *p;
934

    
935
    switch(*pch) {
936
    case '+':
937
        next();
938
        n = expr_unary();
939
        break;
940
    case '-':
941
        next();
942
        n = -expr_unary();
943
        break;
944
    case '~':
945
        next();
946
        n = ~expr_unary();
947
        break;
948
    case '(':
949
        next();
950
        n = expr_sum();
951
        if (*pch != ')') {
952
            expr_error("')' expected");
953
        }
954
        next();
955
        break;
956
    case '$':
957
        {
958
            char buf[128], *q;
959
            
960
            pch++;
961
            q = buf;
962
            while ((*pch >= 'a' && *pch <= 'z') ||
963
                   (*pch >= 'A' && *pch <= 'Z') ||
964
                   (*pch >= '0' && *pch <= '9') ||
965
                   *pch == '_' || *pch == '.') {
966
                if ((q - buf) < sizeof(buf) - 1)
967
                    *q++ = *pch;
968
                pch++;
969
            }
970
            while (isspace(*pch))
971
                pch++;
972
            *q = 0;
973
            if (get_monitor_def(&n, buf))
974
                expr_error("unknown register");
975
        }
976
        break;
977
    case '\0':
978
        expr_error("unexpected end of expression");
979
        n = 0;
980
        break;
981
    default:
982
        n = strtoul(pch, &p, 0);
983
        if (pch == p) {
984
            expr_error("invalid char in expression");
985
        }
986
        pch = p;
987
        while (isspace(*pch))
988
            pch++;
989
        break;
990
    }
991
    return n;
992
}
993

    
994

    
995
static int expr_prod(void)
996
{
997
    int val, val2, op;
998

    
999
    val = expr_unary();
1000
    for(;;) {
1001
        op = *pch;
1002
        if (op != '*' && op != '/' && op != '%')
1003
            break;
1004
        next();
1005
        val2 = expr_unary();
1006
        switch(op) {
1007
        default:
1008
        case '*':
1009
            val *= val2;
1010
            break;
1011
        case '/':
1012
        case '%':
1013
            if (val2 == 0) 
1014
                expr_error("division by zero");
1015
            if (op == '/')
1016
                val /= val2;
1017
            else
1018
                val %= val2;
1019
            break;
1020
        }
1021
    }
1022
    return val;
1023
}
1024

    
1025
static int expr_logic(void)
1026
{
1027
    int val, val2, op;
1028

    
1029
    val = expr_prod();
1030
    for(;;) {
1031
        op = *pch;
1032
        if (op != '&' && op != '|' && op != '^')
1033
            break;
1034
        next();
1035
        val2 = expr_prod();
1036
        switch(op) {
1037
        default:
1038
        case '&':
1039
            val &= val2;
1040
            break;
1041
        case '|':
1042
            val |= val2;
1043
            break;
1044
        case '^':
1045
            val ^= val2;
1046
            break;
1047
        }
1048
    }
1049
    return val;
1050
}
1051

    
1052
static int expr_sum(void)
1053
{
1054
    int val, val2, op;
1055

    
1056
    val = expr_logic();
1057
    for(;;) {
1058
        op = *pch;
1059
        if (op != '+' && op != '-')
1060
            break;
1061
        next();
1062
        val2 = expr_logic();
1063
        if (op == '+')
1064
            val += val2;
1065
        else
1066
            val -= val2;
1067
    }
1068
    return val;
1069
}
1070

    
1071
static int get_expr(int *pval, const char **pp)
1072
{
1073
    pch = *pp;
1074
    if (setjmp(expr_env)) {
1075
        *pp = pch;
1076
        return -1;
1077
    }
1078
    while (isspace(*pch))
1079
        pch++;
1080
    *pval = expr_sum();
1081
    *pp = pch;
1082
    return 0;
1083
}
1084

    
1085
static int get_str(char *buf, int buf_size, const char **pp)
1086
{
1087
    const char *p;
1088
    char *q;
1089
    int c;
1090

    
1091
    p = *pp;
1092
    while (isspace(*p))
1093
        p++;
1094
    if (*p == '\0') {
1095
    fail:
1096
        *pp = p;
1097
        return -1;
1098
    }
1099
    q = buf;
1100
    if (*p == '\"') {
1101
        p++;
1102
        while (*p != '\0' && *p != '\"') {
1103
            if (*p == '\\') {
1104
                p++;
1105
                c = *p++;
1106
                switch(c) {
1107
                case 'n':
1108
                    c = '\n';
1109
                    break;
1110
                case 'r':
1111
                    c = '\r';
1112
                    break;
1113
                case '\\':
1114
                case '\'':
1115
                case '\"':
1116
                    break;
1117
                default:
1118
                    qemu_printf("unsupported escape code: '\\%c'\n", c);
1119
                    goto fail;
1120
                }
1121
                if ((q - buf) < buf_size - 1) {
1122
                    *q++ = c;
1123
                }
1124
            } else {
1125
                if ((q - buf) < buf_size - 1) {
1126
                    *q++ = *p;
1127
                }
1128
                p++;
1129
            }
1130
        }
1131
        if (*p != '\"') {
1132
            qemu_printf("unterminated string\n");
1133
            goto fail;
1134
        }
1135
        p++;
1136
    } else {
1137
        while (*p != '\0' && !isspace(*p)) {
1138
            if ((q - buf) < buf_size - 1) {
1139
                *q++ = *p;
1140
            }
1141
            p++;
1142
        }
1143
        *q = '\0';
1144
    }
1145
    *pp = p;
1146
    return 0;
1147
}
1148

    
1149
static int default_fmt_format = 'x';
1150
static int default_fmt_size = 4;
1151

    
1152
#define MAX_ARGS 16
1153

    
1154
static void term_handle_command(const char *cmdline)
1155
{
1156
    const char *p, *pstart, *typestr;
1157
    char *q;
1158
    int c, nb_args, len, i, has_arg;
1159
    term_cmd_t *cmd;
1160
    char cmdname[256];
1161
    char buf[1024];
1162
    void *str_allocated[MAX_ARGS];
1163
    void *args[MAX_ARGS];
1164

    
1165
#ifdef DEBUG
1166
    term_printf("command='%s'\n", cmdline);
1167
#endif
1168
    
1169
    /* extract the command name */
1170
    p = cmdline;
1171
    q = cmdname;
1172
    while (isspace(*p))
1173
        p++;
1174
    if (*p == '\0')
1175
        return;
1176
    pstart = p;
1177
    while (*p != '\0' && *p != '/' && !isspace(*p))
1178
        p++;
1179
    len = p - pstart;
1180
    if (len > sizeof(cmdname) - 1)
1181
        len = sizeof(cmdname) - 1;
1182
    memcpy(cmdname, pstart, len);
1183
    cmdname[len] = '\0';
1184
    
1185
    /* find the command */
1186
    for(cmd = term_cmds; cmd->name != NULL; cmd++) {
1187
        if (compare_cmd(cmdname, cmd->name)) 
1188
            goto found;
1189
    }
1190
    term_printf("unknown command: '%s'\n", cmdname);
1191
    return;
1192
 found:
1193

    
1194
    for(i = 0; i < MAX_ARGS; i++)
1195
        str_allocated[i] = NULL;
1196
    
1197
    /* parse the parameters */
1198
    typestr = cmd->args_type;
1199
    nb_args = 0;
1200
    for(;;) {
1201
        c = *typestr;
1202
        if (c == '\0')
1203
            break;
1204
        typestr++;
1205
        switch(c) {
1206
        case 'F':
1207
        case 's':
1208
            {
1209
                int ret;
1210
                char *str;
1211
                
1212
                while (isspace(*p)) 
1213
                    p++;
1214
                if (*typestr == '?') {
1215
                    typestr++;
1216
                    if (*p == '\0') {
1217
                        /* no optional string: NULL argument */
1218
                        str = NULL;
1219
                        goto add_str;
1220
                    }
1221
                }
1222
                ret = get_str(buf, sizeof(buf), &p);
1223
                if (ret < 0) {
1224
                    if (c == 'F')
1225
                        term_printf("%s: filename expected\n", cmdname);
1226
                    else
1227
                        term_printf("%s: string expected\n", cmdname);
1228
                    goto fail;
1229
                }
1230
                str = qemu_malloc(strlen(buf) + 1);
1231
                strcpy(str, buf);
1232
                str_allocated[nb_args] = str;
1233
            add_str:
1234
                if (nb_args >= MAX_ARGS) {
1235
                error_args:
1236
                    term_printf("%s: too many arguments\n", cmdname);
1237
                    goto fail;
1238
                }
1239
                args[nb_args++] = str;
1240
            }
1241
            break;
1242
        case '/':
1243
            {
1244
                int count, format, size;
1245
                
1246
                while (isspace(*p))
1247
                    p++;
1248
                if (*p == '/') {
1249
                    /* format found */
1250
                    p++;
1251
                    count = 1;
1252
                    if (isdigit(*p)) {
1253
                        count = 0;
1254
                        while (isdigit(*p)) {
1255
                            count = count * 10 + (*p - '0');
1256
                            p++;
1257
                        }
1258
                    }
1259
                    size = -1;
1260
                    format = -1;
1261
                    for(;;) {
1262
                        switch(*p) {
1263
                        case 'o':
1264
                        case 'd':
1265
                        case 'u':
1266
                        case 'x':
1267
                        case 'i':
1268
                        case 'c':
1269
                            format = *p++;
1270
                            break;
1271
                        case 'b':
1272
                            size = 1;
1273
                            p++;
1274
                            break;
1275
                        case 'h':
1276
                            size = 2;
1277
                            p++;
1278
                            break;
1279
                        case 'w':
1280
                            size = 4;
1281
                            p++;
1282
                            break;
1283
                        case 'g':
1284
                        case 'L':
1285
                            size = 8;
1286
                            p++;
1287
                            break;
1288
                        default:
1289
                            goto next;
1290
                        }
1291
                    }
1292
                next:
1293
                    if (*p != '\0' && !isspace(*p)) {
1294
                        term_printf("invalid char in format: '%c'\n", *p);
1295
                        goto fail;
1296
                    }
1297
                    if (format < 0)
1298
                        format = default_fmt_format;
1299
                    if (format != 'i') {
1300
                        /* for 'i', not specifying a size gives -1 as size */
1301
                        if (size < 0)
1302
                            size = default_fmt_size;
1303
                    }
1304
                    default_fmt_size = size;
1305
                    default_fmt_format = format;
1306
                } else {
1307
                    count = 1;
1308
                    format = default_fmt_format;
1309
                    if (format != 'i') {
1310
                        size = default_fmt_size;
1311
                    } else {
1312
                        size = -1;
1313
                    }
1314
                }
1315
                if (nb_args + 3 > MAX_ARGS)
1316
                    goto error_args;
1317
                args[nb_args++] = (void*)count;
1318
                args[nb_args++] = (void*)format;
1319
                args[nb_args++] = (void*)size;
1320
            }
1321
            break;
1322
        case 'i':
1323
            {
1324
                int val;
1325
                while (isspace(*p)) 
1326
                    p++;
1327
                if (*typestr == '?' || *typestr == '.') {
1328
                    typestr++;
1329
                    if (*typestr == '?') {
1330
                        if (*p == '\0')
1331
                            has_arg = 0;
1332
                        else
1333
                            has_arg = 1;
1334
                    } else {
1335
                        if (*p == '.') {
1336
                            p++;
1337
                            while (isspace(*p)) 
1338
                                p++;
1339
                            has_arg = 1;
1340
                        } else {
1341
                            has_arg = 0;
1342
                        }
1343
                    }
1344
                    if (nb_args >= MAX_ARGS)
1345
                        goto error_args;
1346
                    args[nb_args++] = (void *)has_arg;
1347
                    if (!has_arg) {
1348
                        if (nb_args >= MAX_ARGS)
1349
                            goto error_args;
1350
                        val = -1;
1351
                        goto add_num;
1352
                    }
1353
                }
1354
                if (get_expr(&val, &p))
1355
                    goto fail;
1356
            add_num:
1357
                if (nb_args >= MAX_ARGS)
1358
                    goto error_args;
1359
                args[nb_args++] = (void *)val;
1360
            }
1361
            break;
1362
        case '-':
1363
            {
1364
                int has_option;
1365
                /* option */
1366
                
1367
                c = *typestr++;
1368
                if (c == '\0')
1369
                    goto bad_type;
1370
                while (isspace(*p)) 
1371
                    p++;
1372
                has_option = 0;
1373
                if (*p == '-') {
1374
                    p++;
1375
                    if (*p != c) {
1376
                        term_printf("%s: unsupported option -%c\n", 
1377
                                    cmdname, *p);
1378
                        goto fail;
1379
                    }
1380
                    p++;
1381
                    has_option = 1;
1382
                }
1383
                if (nb_args >= MAX_ARGS)
1384
                    goto error_args;
1385
                args[nb_args++] = (void *)has_option;
1386
            }
1387
            break;
1388
        default:
1389
        bad_type:
1390
            term_printf("%s: unknown type '%c'\n", cmdname, c);
1391
            goto fail;
1392
        }
1393
    }
1394
    /* check that all arguments were parsed */
1395
    while (isspace(*p))
1396
        p++;
1397
    if (*p != '\0') {
1398
        term_printf("%s: extraneous characters at the end of line\n", 
1399
                    cmdname);
1400
        goto fail;
1401
    }
1402

    
1403
    switch(nb_args) {
1404
    case 0:
1405
        cmd->handler();
1406
        break;
1407
    case 1:
1408
        cmd->handler(args[0]);
1409
        break;
1410
    case 2:
1411
        cmd->handler(args[0], args[1]);
1412
        break;
1413
    case 3:
1414
        cmd->handler(args[0], args[1], args[2]);
1415
        break;
1416
    case 4:
1417
        cmd->handler(args[0], args[1], args[2], args[3]);
1418
        break;
1419
    case 5:
1420
        cmd->handler(args[0], args[1], args[2], args[3], args[4]);
1421
        break;
1422
    case 6:
1423
        cmd->handler(args[0], args[1], args[2], args[3], args[4], args[5]);
1424
        break;
1425
    default:
1426
        term_printf("unsupported number of arguments: %d\n", nb_args);
1427
        goto fail;
1428
    }
1429
 fail:
1430
    for(i = 0; i < MAX_ARGS; i++)
1431
        qemu_free(str_allocated[i]);
1432
    return;
1433
}
1434

    
1435
static void term_show_prompt(void)
1436
{
1437
    term_printf("(qemu) ");
1438
    fflush(stdout);
1439
    term_cmd_buf_index = 0;
1440
    term_cmd_buf_size = 0;
1441
    term_esc_state = IS_NORM;
1442
}
1443

    
1444
static void term_print_cmdline (const char *cmdline)
1445
{
1446
    term_show_prompt();
1447
    term_printf("%s", cmdline);
1448
    term_flush();
1449
}
1450

    
1451
static void term_insert_char(int ch)
1452
{
1453
    if (term_cmd_buf_index < TERM_CMD_BUF_SIZE) {
1454
        memmove(term_cmd_buf + term_cmd_buf_index + 1,
1455
                term_cmd_buf + term_cmd_buf_index,
1456
                term_cmd_buf_size - term_cmd_buf_index);
1457
        term_cmd_buf[term_cmd_buf_index] = ch;
1458
        term_cmd_buf_size++;
1459
        term_printf("\033[@%c", ch);
1460
        term_cmd_buf_index++;
1461
        term_flush();
1462
    }
1463
}
1464

    
1465
static void term_backward_char(void)
1466
{
1467
    if (term_cmd_buf_index > 0) {
1468
        term_cmd_buf_index--;
1469
        term_printf("\033[D");
1470
        term_flush();
1471
    }
1472
}
1473

    
1474
static void term_forward_char(void)
1475
{
1476
    if (term_cmd_buf_index < term_cmd_buf_size) {
1477
        term_cmd_buf_index++;
1478
        term_printf("\033[C");
1479
        term_flush();
1480
    }
1481
}
1482

    
1483
static void term_delete_char(void)
1484
{
1485
    if (term_cmd_buf_index < term_cmd_buf_size) {
1486
        memmove(term_cmd_buf + term_cmd_buf_index,
1487
                term_cmd_buf + term_cmd_buf_index + 1,
1488
                term_cmd_buf_size - term_cmd_buf_index - 1);
1489
        term_printf("\033[P");
1490
        term_cmd_buf_size--;
1491
        term_flush();
1492
    }
1493
}
1494

    
1495
static void term_backspace(void)
1496
{
1497
    if (term_cmd_buf_index > 0) {
1498
        term_backward_char();
1499
        term_delete_char();
1500
    }
1501
}
1502

    
1503
static void term_bol(void)
1504
{
1505
    while (term_cmd_buf_index > 0)
1506
        term_backward_char();
1507
}
1508

    
1509
static void term_eol(void)
1510
{
1511
    while (term_cmd_buf_index < term_cmd_buf_size)
1512
        term_forward_char();
1513
}
1514

    
1515
static void term_up_char(void)
1516
{
1517
    int idx;
1518

    
1519
    if (term_hist_entry == 0)
1520
        return;
1521
    if (term_hist_entry == -1) {
1522
        /* Find latest entry */
1523
        for (idx = 0; idx < TERM_MAX_CMDS; idx++) {
1524
            if (term_history[idx] == NULL)
1525
                break;
1526
        }
1527
        term_hist_entry = idx;
1528
    }
1529
    term_hist_entry--;
1530
    if (term_hist_entry >= 0) {
1531
        pstrcpy(term_cmd_buf, sizeof(term_cmd_buf), 
1532
                term_history[term_hist_entry]);
1533
        term_printf("\n");
1534
        term_print_cmdline(term_cmd_buf);
1535
        term_cmd_buf_index = term_cmd_buf_size = strlen(term_cmd_buf);
1536
    }
1537
}
1538

    
1539
static void term_down_char(void)
1540
{
1541
    if (term_hist_entry == TERM_MAX_CMDS - 1 || term_hist_entry == -1)
1542
        return;
1543
    if (term_history[++term_hist_entry] != NULL) {
1544
        pstrcpy(term_cmd_buf, sizeof(term_cmd_buf),
1545
                term_history[term_hist_entry]);
1546
    } else {
1547
        term_hist_entry = -1;
1548
    }
1549
    term_printf("\n");
1550
    term_print_cmdline(term_cmd_buf);
1551
    term_cmd_buf_index = term_cmd_buf_size = strlen(term_cmd_buf);
1552
}
1553

    
1554
static void term_hist_add(const char *cmdline)
1555
{
1556
    char *hist_entry, *new_entry;
1557
    int idx;
1558

    
1559
    if (cmdline[0] == '\0')
1560
        return;
1561
    new_entry = NULL;
1562
    if (term_hist_entry != -1) {
1563
        /* We were editing an existing history entry: replace it */
1564
        hist_entry = term_history[term_hist_entry];
1565
        idx = term_hist_entry;
1566
        if (strcmp(hist_entry, cmdline) == 0) {
1567
            goto same_entry;
1568
        }
1569
    }
1570
    /* Search cmdline in history buffers */
1571
    for (idx = 0; idx < TERM_MAX_CMDS; idx++) {
1572
        hist_entry = term_history[idx];
1573
        if (hist_entry == NULL)
1574
            break;
1575
        if (strcmp(hist_entry, cmdline) == 0) {
1576
        same_entry:
1577
            new_entry = hist_entry;
1578
            /* Put this entry at the end of history */
1579
            memmove(&term_history[idx], &term_history[idx + 1],
1580
                    &term_history[TERM_MAX_CMDS] - &term_history[idx + 1]);
1581
            term_history[TERM_MAX_CMDS - 1] = NULL;
1582
            for (; idx < TERM_MAX_CMDS; idx++) {
1583
                if (term_history[idx] == NULL)
1584
                    break;
1585
            }
1586
            break;
1587
        }
1588
    }
1589
    if (idx == TERM_MAX_CMDS) {
1590
        /* Need to get one free slot */
1591
        free(term_history[0]);
1592
        memcpy(term_history, &term_history[1],
1593
               &term_history[TERM_MAX_CMDS] - &term_history[1]);
1594
        term_history[TERM_MAX_CMDS - 1] = NULL;
1595
        idx = TERM_MAX_CMDS - 1;
1596
    }
1597
    if (new_entry == NULL)
1598
        new_entry = strdup(cmdline);
1599
    term_history[idx] = new_entry;
1600
    term_hist_entry = -1;
1601
}
1602

    
1603
/* return true if command handled */
1604
static void term_handle_byte(int ch)
1605
{
1606
    switch(term_esc_state) {
1607
    case IS_NORM:
1608
        switch(ch) {
1609
        case 1:
1610
            term_bol();
1611
            break;
1612
        case 5:
1613
            term_eol();
1614
            break;
1615
        case 10:
1616
        case 13:
1617
            term_cmd_buf[term_cmd_buf_size] = '\0';
1618
            term_hist_add(term_cmd_buf);
1619
            term_printf("\n");
1620
            term_handle_command(term_cmd_buf);
1621
            term_show_prompt();
1622
            break;
1623
        case 27:
1624
            term_esc_state = IS_ESC;
1625
            break;
1626
        case 127:
1627
        case 8:
1628
            term_backspace();
1629
            break;
1630
        case 155:
1631
            term_esc_state = IS_CSI;
1632
            break;
1633
        default:
1634
            if (ch >= 32) {
1635
                term_insert_char(ch);
1636
            }
1637
            break;
1638
        }
1639
        break;
1640
    case IS_ESC:
1641
        if (ch == '[') {
1642
            term_esc_state = IS_CSI;
1643
            term_esc_param = 0;
1644
        } else {
1645
            term_esc_state = IS_NORM;
1646
        }
1647
        break;
1648
    case IS_CSI:
1649
        switch(ch) {
1650
        case 'A':
1651
        case 'F':
1652
            term_up_char();
1653
            break;
1654
        case 'B':
1655
        case 'E':
1656
            term_down_char();
1657
            break;
1658
        case 'D':
1659
            term_backward_char();
1660
            break;
1661
        case 'C':
1662
            term_forward_char();
1663
            break;
1664
        case '0' ... '9':
1665
            term_esc_param = term_esc_param * 10 + (ch - '0');
1666
            goto the_end;
1667
        case '~':
1668
            switch(term_esc_param) {
1669
            case 1:
1670
                term_bol();
1671
                break;
1672
            case 3:
1673
                term_delete_char();
1674
                break;
1675
            case 4:
1676
                term_eol();
1677
                break;
1678
            }
1679
            break;
1680
        default:
1681
            break;
1682
        }
1683
        term_esc_state = IS_NORM;
1684
    the_end:
1685
        break;
1686
    }
1687
}
1688

    
1689
/*************************************************************/
1690
/* serial console support */
1691

    
1692
#define TERM_ESCAPE 0x01 /* ctrl-a is used for escape */
1693

    
1694
static int term_got_escape, term_command;
1695

    
1696
void term_print_help(void)
1697
{
1698
    term_printf("\n"
1699
                "C-a h    print this help\n"
1700
                "C-a x    exit emulatior\n"
1701
                "C-a s    save disk data back to file (if -snapshot)\n"
1702
                "C-a b    send break (magic sysrq)\n"
1703
                "C-a c    switch between console and monitor\n"
1704
                "C-a C-a  send C-a\n"
1705
                );
1706
}
1707

    
1708
/* called when a char is received */
1709
static void term_received_byte(int ch)
1710
{
1711
    if (!serial_console) {
1712
        /* if no serial console, handle every command */
1713
        term_handle_byte(ch);
1714
    } else {
1715
        if (term_got_escape) {
1716
            term_got_escape = 0;
1717
            switch(ch) {
1718
            case 'h':
1719
                term_print_help();
1720
                break;
1721
            case 'x':
1722
                exit(0);
1723
                break;
1724
            case 's': 
1725
                {
1726
                    int i;
1727
                    for (i = 0; i < MAX_DISKS; i++) {
1728
                        if (bs_table[i])
1729
                            bdrv_commit(bs_table[i]);
1730
                    }
1731
                }
1732
                break;
1733
            case 'b':
1734
                if (serial_console)
1735
                    serial_receive_break(serial_console);
1736
                break;
1737
            case 'c':
1738
                if (!term_command) {
1739
                    term_show_prompt();
1740
                    term_command = 1;
1741
                } else {
1742
                    term_command = 0;
1743
                }
1744
                break;
1745
            case TERM_ESCAPE:
1746
                goto send_char;
1747
            }
1748
        } else if (ch == TERM_ESCAPE) {
1749
            term_got_escape = 1;
1750
        } else {
1751
        send_char:
1752
            if (term_command) {
1753
                term_handle_byte(ch);
1754
            } else {
1755
                if (serial_console)
1756
                    serial_receive_byte(serial_console, ch);
1757
            }
1758
        }
1759
    }
1760
}
1761

    
1762
static int term_can_read(void *opaque)
1763
{
1764
    if (serial_console) {
1765
        return serial_can_receive(serial_console);
1766
    } else {
1767
        return 128;
1768
    }
1769
}
1770

    
1771
static void term_read(void *opaque, const uint8_t *buf, int size)
1772
{
1773
    int i;
1774
    for(i = 0; i < size; i++)
1775
        term_received_byte(buf[i]);
1776
}
1777

    
1778
void monitor_init(void)
1779
{
1780
    if (!serial_console) {
1781
        term_printf("QEMU %s monitor - type 'help' for more information\n",
1782
                    QEMU_VERSION);
1783
        term_show_prompt();
1784
    }
1785
    term_hist_entry = -1;
1786
    qemu_add_fd_read_handler(0, term_can_read, term_read, NULL);
1787
}