Statistics
| Branch: | Revision:

root / monitor.c @ 9307c4c1

History | View | Annotate | Download (31.3 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

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

    
39
#define printf do_not_use_printf
40

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

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

    
59
typedef struct term_cmd_t {
60
    const char *name;
61
    const char *args_type;
62
    void (*handler)();
63
    const char *params;
64
    const char *help;
65
} term_cmd_t;
66

    
67
static term_cmd_t term_cmds[];
68
static term_cmd_t info_cmds[];
69

    
70
void term_printf(const char *fmt, ...)
71
{
72
    va_list ap;
73
    va_start(ap, fmt);
74
    vprintf(fmt, ap);
75
    va_end(ap);
76
}
77

    
78
void term_flush(void)
79
{
80
    fflush(stdout);
81
}
82

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

    
103
static void help_cmd1(term_cmd_t *cmds, const char *prefix, const char *name)
104
{
105
    term_cmd_t *cmd;
106

    
107
    for(cmd = cmds; cmd->name != NULL; cmd++) {
108
        if (!name || !strcmp(name, cmd->name))
109
            term_printf("%s%s %s -- %s\n", prefix, cmd->name, cmd->params, cmd->help);
110
    }
111
}
112

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

    
130
static void do_help(const char *name)
131
{
132
    help_cmd(name);
133
}
134

    
135
static void do_commit(void)
136
{
137
    int i;
138

    
139
    for (i = 0; i < MAX_DISKS; i++) {
140
        if (bs_table[i])
141
            bdrv_commit(bs_table[i]);
142
    }
143
}
144

    
145
static void do_info(const char *item)
146
{
147
    term_cmd_t *cmd;
148

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

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

    
184
static void do_info_registers(void)
185
{
186
#ifdef TARGET_I386
187
    cpu_dump_state(cpu_single_env, stdout, X86_DUMP_FPU | X86_DUMP_CCOP);
188
#else
189
    cpu_dump_state(cpu_single_env, stdout, 0);
190
#endif
191
}
192

    
193
static void do_quit(void)
194
{
195
    exit(0);
196
}
197

    
198
static int eject_device(BlockDriverState *bs, int force)
199
{
200
    if (bdrv_is_inserted(bs)) {
201
        if (!force) {
202
            if (!bdrv_is_removable(bs)) {
203
                term_printf("device is not removable\n");
204
                return -1;
205
            }
206
            if (bdrv_is_locked(bs)) {
207
                term_printf("device is locked\n");
208
                return -1;
209
            }
210
        }
211
        bdrv_close(bs);
212
    }
213
    return 0;
214
}
215

    
216
static void do_eject(int force, const char *filename)
217
{
218
    BlockDriverState *bs;
219

    
220
    term_printf("%d %s\n", force, filename);
221

    
222
    bs = bdrv_find(filename);
223
    if (!bs) {
224
        term_printf("device not found\n");
225
        return;
226
    }
227
    eject_device(bs, force);
228
}
229

    
230
static void do_change(const char *device, const char *filename)
231
{
232
    BlockDriverState *bs;
233

    
234
    bs = bdrv_find(device);
235
    if (!bs) {
236
        term_printf("device not found\n");
237
        return;
238
    }
239
    if (eject_device(bs, 0) < 0)
240
        return;
241
    bdrv_open(bs, filename, 0);
242
}
243

    
244
static void do_screen_dump(const char *filename)
245
{
246
    vga_screen_dump(filename);
247
}
248

    
249
static void do_log(const char *items)
250
{
251
    int mask;
252
    
253
    if (!strcmp(items, "none")) {
254
        mask = 0;
255
    } else {
256
        mask = cpu_str_to_log_mask(items);
257
        if (!mask) {
258
            help_cmd("log");
259
            return;
260
        }
261
    }
262
    cpu_set_log(mask);
263
}
264

    
265
static void do_savevm(const char *filename)
266
{
267
    if (qemu_savevm(filename) < 0)
268
        term_printf("I/O error when saving VM to '%s'\n", filename);
269
}
270

    
271
static void do_loadvm(const char *filename)
272
{
273
    if (qemu_loadvm(filename) < 0) 
274
        term_printf("I/O error when loading VM from '%s'\n", filename);
275
}
276

    
277
static void do_stop(void)
278
{
279
    vm_stop(EXCP_INTERRUPT);
280
}
281

    
282
static void do_cont(void)
283
{
284
    vm_start();
285
}
286

    
287
#ifdef CONFIG_GDBSTUB
288
static void do_gdbserver(int has_port, int port)
289
{
290
    if (!has_port)
291
        port = DEFAULT_GDBSTUB_PORT;
292
    if (gdbserver_start(port) < 0) {
293
        qemu_printf("Could not open gdbserver socket on port %d\n", port);
294
    } else {
295
        qemu_printf("Waiting gdb connection on port %d\n", port);
296
    }
297
}
298
#endif
299

    
300
static void term_printc(int c)
301
{
302
    term_printf("'");
303
    switch(c) {
304
    case '\'':
305
        term_printf("\\'");
306
        break;
307
    case '\\':
308
        term_printf("\\\\");
309
        break;
310
    case '\n':
311
        term_printf("\\n");
312
        break;
313
    case '\r':
314
        term_printf("\\r");
315
        break;
316
    default:
317
        if (c >= 32 && c <= 126) {
318
            term_printf("%c", c);
319
        } else {
320
            term_printf("\\x%02x", c);
321
        }
322
        break;
323
    }
324
    term_printf("'");
325
}
326

    
327
static void memory_dump(int count, int format, int wsize, 
328
                        target_ulong addr, int is_physical)
329
{
330
    int nb_per_line, l, line_size, i, max_digits, len;
331
    uint8_t buf[16];
332
    uint64_t v;
333

    
334
    if (format == 'i') {
335
        int flags;
336
        flags = 0;
337
#ifdef TARGET_I386
338
        /* we use the current CS size */
339
        if (!(cpu_single_env->segs[R_CS].flags & DESC_B_MASK))
340
            flags = 1;
341
#endif        
342
        monitor_disas(addr, count, is_physical, flags);
343
        return;
344
    }
345

    
346
    len = wsize * count;
347
    if (wsize == 1)
348
        line_size = 8;
349
    else
350
        line_size = 16;
351
    nb_per_line = line_size / wsize;
352
    max_digits = 0;
353

    
354
    switch(format) {
355
    case 'o':
356
        max_digits = (wsize * 8 + 2) / 3;
357
        break;
358
    default:
359
    case 'x':
360
        max_digits = (wsize * 8) / 4;
361
        break;
362
    case 'u':
363
    case 'd':
364
        max_digits = (wsize * 8 * 10 + 32) / 33;
365
        break;
366
    case 'c':
367
        wsize = 1;
368
        break;
369
    }
370

    
371
    while (len > 0) {
372
        term_printf("0x%08x:", addr);
373
        l = len;
374
        if (l > line_size)
375
            l = line_size;
376
        if (is_physical) {
377
            cpu_physical_memory_rw(addr, buf, l, 0);
378
        } else {
379
            cpu_memory_rw_debug(cpu_single_env, addr, buf, l, 0);
380
        }
381
        i = 0; 
382
        while (i < l) {
383
            switch(wsize) {
384
            default:
385
            case 1:
386
                v = ldub_raw(buf + i);
387
                break;
388
            case 2:
389
                v = lduw_raw(buf + i);
390
                break;
391
            case 4:
392
                v = ldl_raw(buf + i);
393
                break;
394
            case 8:
395
                v = ldq_raw(buf + i);
396
                break;
397
            }
398
            term_printf(" ");
399
            switch(format) {
400
            case 'o':
401
                term_printf("%#*llo", max_digits, v);
402
                break;
403
            case 'x':
404
                term_printf("0x%0*llx", max_digits, v);
405
                break;
406
            case 'u':
407
                term_printf("%*llu", max_digits, v);
408
                break;
409
            case 'd':
410
                term_printf("%*lld", max_digits, v);
411
                break;
412
            case 'c':
413
                term_printc(v);
414
                break;
415
            }
416
            i += wsize;
417
        }
418
        term_printf("\n");
419
        addr += l;
420
        len -= l;
421
    }
422
}
423

    
424
static void do_memory_dump(int count, int format, int size, int addr)
425
{
426
    memory_dump(count, format, size, addr, 0);
427
}
428

    
429
static void do_physical_memory_dump(int count, int format, int size, int addr)
430
{
431
    memory_dump(count, format, size, addr, 1);
432
}
433

    
434
static void do_print(int count, int format, int size, int val)
435
{
436
    switch(format) {
437
    case 'o':
438
        term_printf("%#o", val);
439
        break;
440
    case 'x':
441
        term_printf("%#x", val);
442
        break;
443
    case 'u':
444
        term_printf("%u", val);
445
        break;
446
    default:
447
    case 'd':
448
        term_printf("%d", val);
449
        break;
450
    case 'c':
451
        term_printc(val);
452
        break;
453
    }
454
    term_printf("\n");
455
}
456

    
457
static term_cmd_t term_cmds[] = {
458
    { "help|?", "s?", do_help, 
459
      "[cmd]", "show the help" },
460
    { "commit", "", do_commit, 
461
      "", "commit changes to the disk images (if -snapshot is used)" },
462
    { "info", "s?", do_info,
463
      "subcommand", "show various information about the system state" },
464
    { "q|quit", "", do_quit,
465
      "", "quit the emulator" },
466
    { "eject", "-fs", do_eject,
467
      "[-f] device", "eject a removable media (use -f to force it)" },
468
    { "change", "sF", do_change,
469
      "device filename", "change a removable media" },
470
    { "screendump", "F", do_screen_dump, 
471
      "filename", "save screen into PPM image 'filename'" },
472
    { "log", "s", do_log,
473
      "item1[,...]", "activate logging of the specified items to '/tmp/qemu.log'" }, 
474
    { "savevm", "F", do_savevm,
475
      "filename", "save the whole virtual machine state to 'filename'" }, 
476
    { "loadvm", "F", do_loadvm,
477
      "filename", "restore the whole virtual machine state from 'filename'" }, 
478
    { "stop", "", do_stop, 
479
      "", "stop emulation", },
480
    { "c|cont", "", do_cont, 
481
      "", "resume emulation", },
482
#ifdef CONFIG_GDBSTUB
483
    { "gdbserver", "i?", do_gdbserver, 
484
      "[port]", "start gdbserver session (default port=1234)", },
485
#endif
486
    { "x", "/i", do_memory_dump, 
487
      "/fmt addr", "virtual memory dump starting at 'addr'", },
488
    { "xp", "/i", do_physical_memory_dump, 
489
      "/fmt addr", "physical memory dump starting at 'addr'", },
490
    { "p|print", "/i", do_print, 
491
      "/fmt expr", "print expression value (use $reg for CPU register access)", },
492
    { NULL, NULL, }, 
493
};
494

    
495
static term_cmd_t info_cmds[] = {
496
    { "network", "", do_info_network,
497
      "", "show the network state" },
498
    { "block", "", do_info_block,
499
      "", "show the block devices" },
500
    { "registers", "", do_info_registers,
501
      "", "show the cpu registers" },
502
    { NULL, NULL, },
503
};
504

    
505
/*******************************************************************/
506

    
507
static const char *pch;
508
static jmp_buf expr_env;
509

    
510
typedef struct MonitorDef {
511
    const char *name;
512
    int offset;
513
    int (*get_value)(struct MonitorDef *md);
514
} MonitorDef;
515

    
516
static MonitorDef monitor_defs[] = {
517
#ifdef TARGET_I386
518
    { "eax", offsetof(CPUState, regs[0]) },
519
    { "ecx", offsetof(CPUState, regs[1]) },
520
    { "edx", offsetof(CPUState, regs[2]) },
521
    { "ebx", offsetof(CPUState, regs[3]) },
522
    { "esp|sp", offsetof(CPUState, regs[4]) },
523
    { "ebp|fp", offsetof(CPUState, regs[5]) },
524
    { "esi", offsetof(CPUState, regs[6]) },
525
    { "esi", offsetof(CPUState, regs[7]) },
526
    { "eflags", offsetof(CPUState, eflags) },
527
    { "eip|pc", offsetof(CPUState, eip) },
528
#endif
529
    { NULL },
530
};
531

    
532
static void expr_error(const char *fmt) 
533
{
534
    term_printf(fmt);
535
    term_printf("\n");
536
    longjmp(expr_env, 1);
537
}
538

    
539
static int get_monitor_def(int *pval, const char *name)
540
{
541
    MonitorDef *md;
542
    for(md = monitor_defs; md->name != NULL; md++) {
543
        if (compare_cmd(name, md->name)) {
544
            if (md->get_value) {
545
                *pval = md->get_value(md);
546
            } else {
547
                *pval = *(uint32_t *)((uint8_t *)cpu_single_env + md->offset);
548
            }
549
            return 0;
550
        }
551
    }
552
    return -1;
553
}
554

    
555
static void next(void)
556
{
557
    if (pch != '\0') {
558
        pch++;
559
        while (isspace(*pch))
560
            pch++;
561
    }
562
}
563

    
564
static int expr_sum(void);
565

    
566
static int expr_unary(void)
567
{
568
    int n;
569
    char *p;
570

    
571
    switch(*pch) {
572
    case '+':
573
        next();
574
        n = expr_unary();
575
        break;
576
    case '-':
577
        next();
578
        n = -expr_unary();
579
        break;
580
    case '~':
581
        next();
582
        n = ~expr_unary();
583
        break;
584
    case '(':
585
        next();
586
        n = expr_sum();
587
        if (*pch != ')') {
588
            expr_error("')' expected");
589
        }
590
        next();
591
        break;
592
    case '$':
593
        {
594
            char buf[128], *q;
595
            
596
            pch++;
597
            q = buf;
598
            while ((*pch >= 'a' && *pch <= 'z') ||
599
                   (*pch >= 'A' && *pch <= 'Z') ||
600
                   (*pch >= '0' && *pch <= '9') ||
601
                   *pch == '_') {
602
                if ((q - buf) < sizeof(buf) - 1)
603
                    *q++ = *pch;
604
                pch++;
605
            }
606
            while (isspace(*pch))
607
                pch++;
608
            *q = 0;
609
            if (get_monitor_def(&n, buf))
610
                expr_error("unknown register");
611
        }
612
        break;
613
    case '\0':
614
        expr_error("unexpected end of expression");
615
        n = 0;
616
        break;
617
    default:
618
        n = strtoul(pch, &p, 0);
619
        if (pch == p) {
620
            expr_error("invalid char in expression");
621
        }
622
        pch = p;
623
        while (isspace(*pch))
624
            pch++;
625
        break;
626
    }
627
    return n;
628
}
629

    
630

    
631
static int expr_prod(void)
632
{
633
    int val, val2, op;
634

    
635
    val = expr_unary();
636
    for(;;) {
637
        op = *pch;
638
        if (op != '*' && op != '/' && op != '%')
639
            break;
640
        next();
641
        val2 = expr_unary();
642
        switch(op) {
643
        default:
644
        case '*':
645
            val *= val2;
646
            break;
647
        case '/':
648
        case '%':
649
            if (val2 == 0) 
650
                expr_error("divison by zero");
651
            if (op == '/')
652
                val /= val2;
653
            else
654
                val %= val2;
655
            break;
656
        }
657
    }
658
    return val;
659
}
660

    
661
static int expr_logic(void)
662
{
663
    int val, val2, op;
664

    
665
    val = expr_prod();
666
    for(;;) {
667
        op = *pch;
668
        if (op != '&' && op != '|' && op != '^')
669
            break;
670
        next();
671
        val2 = expr_prod();
672
        switch(op) {
673
        default:
674
        case '&':
675
            val &= val2;
676
            break;
677
        case '|':
678
            val |= val2;
679
            break;
680
        case '^':
681
            val ^= val2;
682
            break;
683
        }
684
    }
685
    return val;
686
}
687

    
688
static int expr_sum(void)
689
{
690
    int val, val2, op;
691

    
692
    val = expr_logic();
693
    for(;;) {
694
        op = *pch;
695
        if (op != '+' && op != '-')
696
            break;
697
        next();
698
        val2 = expr_logic();
699
        if (op == '+')
700
            val += val2;
701
        else
702
            val -= val2;
703
    }
704
    return val;
705
}
706

    
707
static int get_expr(int *pval, const char **pp)
708
{
709
    pch = *pp;
710
    if (setjmp(expr_env)) {
711
        *pp = pch;
712
        return -1;
713
    }
714
    while (isspace(*pch))
715
        pch++;
716
    *pval = expr_sum();
717
    *pp = pch;
718
    return 0;
719
}
720

    
721
static int get_str(char *buf, int buf_size, const char **pp)
722
{
723
    const char *p;
724
    char *q;
725
    int c;
726

    
727
    p = *pp;
728
    while (isspace(*p))
729
        p++;
730
    if (*p == '\0') {
731
    fail:
732
        *pp = p;
733
        return -1;
734
    }
735
    q = buf;
736
    if (*p == '\"') {
737
        p++;
738
        while (*p != '\0' && *p != '\"') {
739
            if (*p == '\\') {
740
                p++;
741
                c = *p++;
742
                switch(c) {
743
                case 'n':
744
                    c = '\n';
745
                    break;
746
                case 'r':
747
                    c = '\r';
748
                    break;
749
                case '\\':
750
                case '\'':
751
                case '\"':
752
                    break;
753
                default:
754
                    qemu_printf("unsupported escape code: '\\%c'\n", c);
755
                    goto fail;
756
                }
757
                if ((q - buf) < buf_size - 1) {
758
                    *q++ = c;
759
                }
760
            } else {
761
                if ((q - buf) < buf_size - 1) {
762
                    *q++ = *p;
763
                }
764
                p++;
765
            }
766
        }
767
        if (*p != '\"') {
768
            qemu_printf("untermintated string\n");
769
            goto fail;
770
        }
771
        p++;
772
    } else {
773
        while (*p != '\0' && !isspace(*p)) {
774
            if ((q - buf) < buf_size - 1) {
775
                *q++ = *p;
776
            }
777
            p++;
778
        }
779
        *q = '\0';
780
    }
781
    *pp = p;
782
    return 0;
783
}
784

    
785
static int default_fmt_format = 'x';
786
static int default_fmt_size = 4;
787

    
788
#define MAX_ARGS 16
789

    
790
static void term_handle_command(const char *cmdline)
791
{
792
    const char *p, *pstart, *typestr;
793
    char *q;
794
    int c, nb_args, len, i, has_arg;
795
    term_cmd_t *cmd;
796
    char cmdname[256];
797
    char buf[1024];
798
    void *str_allocated[MAX_ARGS];
799
    void *args[MAX_ARGS];
800

    
801
#ifdef DEBUG
802
    term_printf("command='%s'\n", cmdline);
803
#endif
804
    
805
    /* extract the command name */
806
    p = cmdline;
807
    q = cmdname;
808
    while (isspace(*p))
809
        p++;
810
    if (*p == '\0')
811
        return;
812
    pstart = p;
813
    while (*p != '\0' && *p != '/' && !isspace(*p))
814
        p++;
815
    len = p - pstart;
816
    if (len > sizeof(cmdname) - 1)
817
        len = sizeof(cmdname) - 1;
818
    memcpy(cmdname, pstart, len);
819
    cmdname[len] = '\0';
820
    
821
    /* find the command */
822
    for(cmd = term_cmds; cmd->name != NULL; cmd++) {
823
        if (compare_cmd(cmdname, cmd->name)) 
824
            goto found;
825
    }
826
    term_printf("unknown command: '%s'\n", cmdname);
827
    return;
828
 found:
829

    
830
    for(i = 0; i < MAX_ARGS; i++)
831
        str_allocated[i] = NULL;
832
    
833
    /* parse the parameters */
834
    typestr = cmd->args_type;
835
    nb_args = 0;
836
    for(;;) {
837
        c = *typestr;
838
        if (c == '\0')
839
            break;
840
        typestr++;
841
        switch(c) {
842
        case 'F':
843
        case 's':
844
            {
845
                int ret;
846
                char *str;
847
                
848
                while (isspace(*p)) 
849
                    p++;
850
                if (*typestr == '?') {
851
                    typestr++;
852
                    if (*p == '\0') {
853
                        /* no optional string: NULL argument */
854
                        str = NULL;
855
                        goto add_str;
856
                    }
857
                }
858
                ret = get_str(buf, sizeof(buf), &p);
859
                if (ret < 0) {
860
                    if (c == 'F')
861
                        term_printf("%s: filename expected\n", cmdname);
862
                    else
863
                        term_printf("%s: string expected\n", cmdname);
864
                    goto fail;
865
                }
866
                str = qemu_malloc(strlen(buf) + 1);
867
                strcpy(str, buf);
868
                str_allocated[nb_args] = str;
869
            add_str:
870
                if (nb_args >= MAX_ARGS) {
871
                error_args:
872
                    term_printf("%s: too many arguments\n", cmdname);
873
                    goto fail;
874
                }
875
                args[nb_args++] = str;
876
            }
877
            break;
878
        case '/':
879
            {
880
                int count, format, size;
881
                
882
                while (isspace(*p))
883
                    p++;
884
                if (*p == '/') {
885
                    /* format found */
886
                    p++;
887
                    count = 1;
888
                    if (isdigit(*p)) {
889
                        count = 0;
890
                        while (isdigit(*p)) {
891
                            count = count * 10 + (*p - '0');
892
                            p++;
893
                        }
894
                    }
895
                    size = -1;
896
                    format = -1;
897
                    for(;;) {
898
                        switch(*p) {
899
                        case 'o':
900
                        case 'd':
901
                        case 'u':
902
                        case 'x':
903
                        case 'i':
904
                        case 'c':
905
                            format = *p++;
906
                            break;
907
                        case 'b':
908
                            size = 1;
909
                            p++;
910
                            break;
911
                        case 'h':
912
                            size = 2;
913
                            p++;
914
                            break;
915
                        case 'w':
916
                            size = 4;
917
                            p++;
918
                            break;
919
                        case 'g':
920
                        case 'L':
921
                            size = 8;
922
                            p++;
923
                            break;
924
                        default:
925
                            goto next;
926
                        }
927
                    }
928
                next:
929
                    if (*p != '\0' && !isspace(*p)) {
930
                        term_printf("invalid char in format: '%c'\n", *p);
931
                        goto fail;
932
                    }
933
                    if (size < 0)
934
                        size = default_fmt_size;
935
                    if (format < 0)
936
                        format = default_fmt_format;
937
                    default_fmt_size = size;
938
                    default_fmt_format = format;
939
                } else {
940
                    count = 1;
941
                    format = default_fmt_format;
942
                    size = default_fmt_size;
943
                }
944
                if (nb_args + 3 > MAX_ARGS)
945
                    goto error_args;
946
                args[nb_args++] = (void*)count;
947
                args[nb_args++] = (void*)format;
948
                args[nb_args++] = (void*)size;
949
            }
950
            break;
951
        case 'i':
952
            {
953
                int val;
954
                while (isspace(*p)) 
955
                    p++;
956
                if (*typestr == '?') {
957
                    typestr++;
958
                    if (*p == '\0')
959
                        has_arg = 0;
960
                    else
961
                        has_arg = 1;
962
                    if (nb_args >= MAX_ARGS)
963
                        goto error_args;
964
                    args[nb_args++] = (void *)has_arg;
965
                    if (!has_arg) {
966
                        if (nb_args >= MAX_ARGS)
967
                            goto error_args;
968
                        val = -1;
969
                        goto add_num;
970
                    }
971
                }
972
                if (get_expr(&val, &p))
973
                    goto fail;
974
            add_num:
975
                if (nb_args >= MAX_ARGS)
976
                    goto error_args;
977
                args[nb_args++] = (void *)val;
978
            }
979
            break;
980
        case '-':
981
            {
982
                int has_option;
983
                /* option */
984
                
985
                c = *typestr++;
986
                if (c == '\0')
987
                    goto bad_type;
988
                while (isspace(*p)) 
989
                    p++;
990
                has_option = 0;
991
                if (*p == '-') {
992
                    p++;
993
                    if (*p != c) {
994
                        term_printf("%s: unsupported option -%c\n", 
995
                                    cmdname, *p);
996
                        goto fail;
997
                    }
998
                    p++;
999
                    has_option = 1;
1000
                }
1001
                if (nb_args >= MAX_ARGS)
1002
                    goto error_args;
1003
                args[nb_args++] = (void *)has_option;
1004
            }
1005
            break;
1006
        default:
1007
        bad_type:
1008
            term_printf("%s: unknown type '%c'\n", cmdname, c);
1009
            goto fail;
1010
        }
1011
    }
1012
    /* check that all arguments were parsed */
1013
    while (isspace(*p))
1014
        p++;
1015
    if (*p != '\0') {
1016
        term_printf("%s: extraneous characters at the end of line\n", 
1017
                    cmdname);
1018
        goto fail;
1019
    }
1020

    
1021
    switch(nb_args) {
1022
    case 0:
1023
        cmd->handler();
1024
        break;
1025
    case 1:
1026
        cmd->handler(args[0]);
1027
        break;
1028
    case 2:
1029
        cmd->handler(args[0], args[1]);
1030
        break;
1031
    case 3:
1032
        cmd->handler(args[0], args[1], args[2]);
1033
        break;
1034
    case 4:
1035
        cmd->handler(args[0], args[1], args[2], args[3]);
1036
        break;
1037
    case 5:
1038
        cmd->handler(args[0], args[1], args[2], args[3], args[4]);
1039
        break;
1040
    default:
1041
        term_printf("unsupported number of arguments: %d\n", nb_args);
1042
        goto fail;
1043
    }
1044
 fail:
1045
    for(i = 0; i < MAX_ARGS; i++)
1046
        qemu_free(str_allocated[i]);
1047
    return;
1048
}
1049

    
1050
static void term_show_prompt(void)
1051
{
1052
    term_printf("(qemu) ");
1053
    fflush(stdout);
1054
    term_cmd_buf_index = 0;
1055
    term_cmd_buf_size = 0;
1056
    term_esc_state = IS_NORM;
1057
}
1058

    
1059
static void term_insert_char(int ch)
1060
{
1061
    if (term_cmd_buf_index < TERM_CMD_BUF_SIZE) {
1062
        memmove(term_cmd_buf + term_cmd_buf_index + 1,
1063
                term_cmd_buf + term_cmd_buf_index,
1064
                term_cmd_buf_size - term_cmd_buf_index);
1065
        term_cmd_buf[term_cmd_buf_index] = ch;
1066
        term_cmd_buf_size++;
1067
        term_printf("\033[@%c", ch);
1068
        term_cmd_buf_index++;
1069
        term_flush();
1070
    }
1071
}
1072

    
1073
static void term_backward_char(void)
1074
{
1075
    if (term_cmd_buf_index > 0) {
1076
        term_cmd_buf_index--;
1077
        term_printf("\033[D");
1078
        term_flush();
1079
    }
1080
}
1081

    
1082
static void term_forward_char(void)
1083
{
1084
    if (term_cmd_buf_index < term_cmd_buf_size) {
1085
        term_cmd_buf_index++;
1086
        term_printf("\033[C");
1087
        term_flush();
1088
    }
1089
}
1090

    
1091
static void term_delete_char(void)
1092
{
1093
    if (term_cmd_buf_index < term_cmd_buf_size) {
1094
        memmove(term_cmd_buf + term_cmd_buf_index,
1095
                term_cmd_buf + term_cmd_buf_index + 1,
1096
                term_cmd_buf_size - term_cmd_buf_index - 1);
1097
        term_printf("\033[P");
1098
        term_cmd_buf_size--;
1099
        term_flush();
1100
    }
1101
}
1102

    
1103
static void term_backspace(void)
1104
{
1105
    if (term_cmd_buf_index > 0) {
1106
        term_backward_char();
1107
        term_delete_char();
1108
    }
1109
}
1110

    
1111
static void term_bol(void)
1112
{
1113
    while (term_cmd_buf_index > 0)
1114
        term_backward_char();
1115
}
1116

    
1117
static void term_eol(void)
1118
{
1119
    while (term_cmd_buf_index < term_cmd_buf_size)
1120
        term_forward_char();
1121
}
1122

    
1123
/* return true if command handled */
1124
static void term_handle_byte(int ch)
1125
{
1126
    switch(term_esc_state) {
1127
    case IS_NORM:
1128
        switch(ch) {
1129
        case 1:
1130
            term_bol();
1131
            break;
1132
        case 5:
1133
            term_eol();
1134
            break;
1135
        case 10:
1136
        case 13:
1137
            term_cmd_buf[term_cmd_buf_size] = '\0';
1138
            term_printf("\n");
1139
            term_handle_command(term_cmd_buf);
1140
            term_show_prompt();
1141
            break;
1142
        case 27:
1143
            term_esc_state = IS_ESC;
1144
            break;
1145
        case 127:
1146
        case 8:
1147
            term_backspace();
1148
            break;
1149
        default:
1150
            if (ch >= 32) {
1151
                term_insert_char(ch);
1152
            }
1153
            break;
1154
        }
1155
        break;
1156
    case IS_ESC:
1157
        if (ch == '[') {
1158
            term_esc_state = IS_CSI;
1159
            term_esc_param = 0;
1160
        } else {
1161
            term_esc_state = IS_NORM;
1162
        }
1163
        break;
1164
    case IS_CSI:
1165
        switch(ch) {
1166
        case 'D':
1167
            term_backward_char();
1168
            break;
1169
        case 'C':
1170
            term_forward_char();
1171
            break;
1172
        case '0' ... '9':
1173
            term_esc_param = term_esc_param * 10 + (ch - '0');
1174
            goto the_end;
1175
        case '~':
1176
            switch(term_esc_param) {
1177
            case 1:
1178
                term_bol();
1179
                break;
1180
            case 3:
1181
                term_delete_char();
1182
                break;
1183
            case 4:
1184
                term_eol();
1185
                break;
1186
            }
1187
            break;
1188
        default:
1189
            break;
1190
        }
1191
        term_esc_state = IS_NORM;
1192
    the_end:
1193
        break;
1194
    }
1195
}
1196

    
1197
/*************************************************************/
1198
/* serial console support */
1199

    
1200
#define TERM_ESCAPE 0x01 /* ctrl-a is used for escape */
1201

    
1202
static int term_got_escape, term_command;
1203

    
1204
void term_print_help(void)
1205
{
1206
    term_printf("\n"
1207
                "C-a h    print this help\n"
1208
                "C-a x    exit emulatior\n"
1209
                "C-a s    save disk data back to file (if -snapshot)\n"
1210
                "C-a b    send break (magic sysrq)\n"
1211
                "C-a c    switch between console and monitor\n"
1212
                "C-a C-a  send C-a\n"
1213
                );
1214
}
1215

    
1216
/* called when a char is received */
1217
static void term_received_byte(int ch)
1218
{
1219
    if (!serial_console) {
1220
        /* if no serial console, handle every command */
1221
        term_handle_byte(ch);
1222
    } else {
1223
        if (term_got_escape) {
1224
            term_got_escape = 0;
1225
            switch(ch) {
1226
            case 'h':
1227
                term_print_help();
1228
                break;
1229
            case 'x':
1230
                exit(0);
1231
                break;
1232
            case 's': 
1233
                {
1234
                    int i;
1235
                    for (i = 0; i < MAX_DISKS; i++) {
1236
                        if (bs_table[i])
1237
                            bdrv_commit(bs_table[i]);
1238
                    }
1239
                }
1240
                break;
1241
            case 'b':
1242
                if (serial_console)
1243
                    serial_receive_break(serial_console);
1244
                break;
1245
            case 'c':
1246
                if (!term_command) {
1247
                    term_show_prompt();
1248
                    term_command = 1;
1249
                } else {
1250
                    term_command = 0;
1251
                }
1252
                break;
1253
            case TERM_ESCAPE:
1254
                goto send_char;
1255
            }
1256
        } else if (ch == TERM_ESCAPE) {
1257
            term_got_escape = 1;
1258
        } else {
1259
        send_char:
1260
            if (term_command) {
1261
                term_handle_byte(ch);
1262
            } else {
1263
                if (serial_console)
1264
                    serial_receive_byte(serial_console, ch);
1265
            }
1266
        }
1267
    }
1268
}
1269

    
1270
static int term_can_read(void *opaque)
1271
{
1272
    if (serial_console) {
1273
        return serial_can_receive(serial_console);
1274
    } else {
1275
        return 128;
1276
    }
1277
}
1278

    
1279
static void term_read(void *opaque, const uint8_t *buf, int size)
1280
{
1281
    int i;
1282
    for(i = 0; i < size; i++)
1283
        term_received_byte(buf[i]);
1284
}
1285

    
1286
void monitor_init(void)
1287
{
1288
    if (!serial_console) {
1289
        term_printf("QEMU %s monitor - type 'help' for more information\n",
1290
                    QEMU_VERSION);
1291
        term_show_prompt();
1292
    }
1293
    qemu_add_fd_read_handler(0, term_can_read, term_read, NULL);
1294
}