vl.c 86.1 KB
Newer Older
1
/*
bellard's avatar
bellard committed
2
 * QEMU System Emulator
3
 * 
bellard's avatar
bellard committed
4
 * Copyright (c) 2003-2004 Fabrice Bellard
5
 * 
bellard's avatar
bellard committed
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22
 * 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.
23
 */
bellard's avatar
bellard committed
24 25
#include "vl.h"

26 27 28 29 30
#include <unistd.h>
#include <fcntl.h>
#include <signal.h>
#include <time.h>
#include <errno.h>
bellard's avatar
bellard committed
31 32 33 34
#include <sys/time.h>

#ifndef _WIN32
#include <sys/times.h>
bellard's avatar
bellard committed
35
#include <sys/wait.h>
bellard's avatar
bellard committed
36 37 38
#include <termios.h>
#include <sys/poll.h>
#include <sys/mman.h>
bellard's avatar
bellard committed
39 40
#include <sys/ioctl.h>
#include <sys/socket.h>
bellard's avatar
bellard committed
41
#include <dirent.h>
bellard's avatar
bellard committed
42 43
#ifdef _BSD
#include <sys/stat.h>
44
#ifndef __APPLE__
bellard's avatar
bellard committed
45
#include <libutil.h>
46
#endif
bellard's avatar
bellard committed
47
#else
bellard's avatar
bellard committed
48 49
#include <linux/if.h>
#include <linux/if_tun.h>
bellard's avatar
bellard committed
50 51
#include <pty.h>
#include <malloc.h>
52
#include <linux/rtc.h>
bellard's avatar
bellard committed
53
#endif
bellard's avatar
bellard committed
54
#endif
bellard's avatar
bellard committed
55

bellard's avatar
bellard committed
56 57 58 59
#if defined(CONFIG_SLIRP)
#include "libslirp.h"
#endif

bellard's avatar
bellard committed
60
#ifdef _WIN32
bellard's avatar
bellard committed
61
#include <malloc.h>
bellard's avatar
bellard committed
62 63 64 65 66 67
#include <sys/timeb.h>
#include <windows.h>
#define getopt_long_only getopt_long
#define memalign(align, size) malloc(size)
#endif

bellard's avatar
bellard committed
68
#ifdef CONFIG_SDL
bellard's avatar
bellard committed
69
#ifdef __APPLE__
70
#include <SDL/SDL.h>
bellard's avatar
bellard committed
71
#endif
bellard's avatar
bellard committed
72
#endif /* CONFIG_SDL */
73 74

#include "disas.h"
bellard's avatar
bellard committed
75

76
#include "exec-all.h"
77

78 79
//#define DO_TB_FLUSH

80
#define DEFAULT_NETWORK_SCRIPT "/etc/qemu-ifup"
bellard's avatar
bellard committed
81

82
//#define DEBUG_UNUSED_IOPORT
83
//#define DEBUG_IOPORT
84

85
#if !defined(CONFIG_SOFTMMU)
bellard's avatar
bellard committed
86
#define PHYS_RAM_MAX_SIZE (256 * 1024 * 1024)
87 88 89
#else
#define PHYS_RAM_MAX_SIZE (2047 * 1024 * 1024)
#endif
bellard's avatar
bellard committed
90

bellard's avatar
bellard committed
91 92 93
#ifdef TARGET_PPC
#define DEFAULT_RAM_SIZE 144
#else
94
#define DEFAULT_RAM_SIZE 128
bellard's avatar
bellard committed
95
#endif
96 97
/* in ms */
#define GUI_REFRESH_INTERVAL 30
98

99 100
/* XXX: use a two level table to limit memory usage */
#define MAX_IOPORTS 65536
101

bellard's avatar
bellard committed
102
const char *bios_dir = CONFIG_QEMU_SHAREDIR;
103
char phys_ram_file[1024];
104 105
CPUState *global_env;
CPUState *cpu_single_env;
106
void *ioport_opaque[MAX_IOPORTS];
bellard's avatar
bellard committed
107 108
IOPortReadFunc *ioport_read_table[3][MAX_IOPORTS];
IOPortWriteFunc *ioport_write_table[3][MAX_IOPORTS];
109
BlockDriverState *bs_table[MAX_DISKS], *fd_table[MAX_FD];
110
int vga_ram_size;
bellard's avatar
bellard committed
111
int bios_size;
112
static DisplayState display_state;
113
int nographic;
114
int64_t ticks_per_sec;
115
int boot_device = 'c';
bellard's avatar
bellard committed
116
int ram_size;
bellard's avatar
bellard committed
117 118
static char network_script[1024];
int pit_min_timer_count = 0;
119 120
int nb_nics;
NetDriverState nd_table[MAX_NICS];
121 122
QEMUTimer *gui_timer;
int vm_running;
bellard's avatar
bellard committed
123
int audio_enabled = 0;
124
int pci_enabled = 1;
bellard's avatar
bellard committed
125
int prep_enabled = 0;
bellard's avatar
bellard committed
126
int rtc_utc = 1;
127 128 129
int cirrus_vga_enabled = 1;
int graphic_width = 800;
int graphic_height = 600;
130
int graphic_depth = 15;
bellard's avatar
bellard committed
131
TextConsole *vga_console;
132
CharDriverState *serial_hds[MAX_SERIAL_PORTS];
133 134

/***********************************************************/
135 136 137
/* x86 ISA bus support */

target_phys_addr_t isa_mem_base = 0;
138

139
uint32_t default_ioport_readb(void *opaque, uint32_t address)
140 141 142 143
{
#ifdef DEBUG_UNUSED_IOPORT
    fprintf(stderr, "inb: port=0x%04x\n", address);
#endif
bellard's avatar
bellard committed
144
    return 0xff;
145 146
}

147
void default_ioport_writeb(void *opaque, uint32_t address, uint32_t data)
148 149 150 151 152 153 154
{
#ifdef DEBUG_UNUSED_IOPORT
    fprintf(stderr, "outb: port=0x%04x data=0x%02x\n", address, data);
#endif
}

/* default is to make two byte accesses */
155
uint32_t default_ioport_readw(void *opaque, uint32_t address)
156 157
{
    uint32_t data;
bellard's avatar
bellard committed
158 159 160
    data = ioport_read_table[0][address](ioport_opaque[address], address);
    address = (address + 1) & (MAX_IOPORTS - 1);
    data |= ioport_read_table[0][address](ioport_opaque[address], address) << 8;
161 162 163
    return data;
}

164
void default_ioport_writew(void *opaque, uint32_t address, uint32_t data)
165
{
bellard's avatar
bellard committed
166 167 168
    ioport_write_table[0][address](ioport_opaque[address], address, data & 0xff);
    address = (address + 1) & (MAX_IOPORTS - 1);
    ioport_write_table[0][address](ioport_opaque[address], address, (data >> 8) & 0xff);
169 170
}

171
uint32_t default_ioport_readl(void *opaque, uint32_t address)
172
{
bellard's avatar
bellard committed
173 174 175 176
#ifdef DEBUG_UNUSED_IOPORT
    fprintf(stderr, "inl: port=0x%04x\n", address);
#endif
    return 0xffffffff;
177 178
}

179
void default_ioport_writel(void *opaque, uint32_t address, uint32_t data)
180
{
bellard's avatar
bellard committed
181 182 183
#ifdef DEBUG_UNUSED_IOPORT
    fprintf(stderr, "outl: port=0x%04x data=0x%02x\n", address, data);
#endif
184 185
}

bellard's avatar
bellard committed
186
void init_ioports(void)
187 188 189
{
    int i;

bellard's avatar
bellard committed
190 191 192 193 194 195 196 197
    for(i = 0; i < MAX_IOPORTS; i++) {
        ioport_read_table[0][i] = default_ioport_readb;
        ioport_write_table[0][i] = default_ioport_writeb;
        ioport_read_table[1][i] = default_ioport_readw;
        ioport_write_table[1][i] = default_ioport_writew;
        ioport_read_table[2][i] = default_ioport_readl;
        ioport_write_table[2][i] = default_ioport_writel;
    }
198 199
}

bellard's avatar
bellard committed
200
/* size is the word size in byte */
201 202
int register_ioport_read(int start, int length, int size, 
                         IOPortReadFunc *func, void *opaque)
bellard's avatar
bellard committed
203
{
bellard's avatar
bellard committed
204
    int i, bsize;
bellard's avatar
bellard committed
205

206
    if (size == 1) {
bellard's avatar
bellard committed
207
        bsize = 0;
208
    } else if (size == 2) {
bellard's avatar
bellard committed
209
        bsize = 1;
210
    } else if (size == 4) {
bellard's avatar
bellard committed
211
        bsize = 2;
212 213
    } else {
        hw_error("register_ioport_read: invalid size");
bellard's avatar
bellard committed
214
        return -1;
215 216
    }
    for(i = start; i < start + length; i += size) {
bellard's avatar
bellard committed
217
        ioport_read_table[bsize][i] = func;
218 219 220 221
        if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque)
            hw_error("register_ioport_read: invalid opaque");
        ioport_opaque[i] = opaque;
    }
bellard's avatar
bellard committed
222 223 224
    return 0;
}

bellard's avatar
bellard committed
225
/* size is the word size in byte */
226 227
int register_ioport_write(int start, int length, int size, 
                          IOPortWriteFunc *func, void *opaque)
bellard's avatar
bellard committed
228
{
bellard's avatar
bellard committed
229
    int i, bsize;
bellard's avatar
bellard committed
230

231
    if (size == 1) {
bellard's avatar
bellard committed
232
        bsize = 0;
233
    } else if (size == 2) {
bellard's avatar
bellard committed
234
        bsize = 1;
235
    } else if (size == 4) {
bellard's avatar
bellard committed
236
        bsize = 2;
237 238
    } else {
        hw_error("register_ioport_write: invalid size");
bellard's avatar
bellard committed
239
        return -1;
240 241
    }
    for(i = start; i < start + length; i += size) {
bellard's avatar
bellard committed
242
        ioport_write_table[bsize][i] = func;
243 244 245 246
        if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque)
            hw_error("register_ioport_read: invalid opaque");
        ioport_opaque[i] = opaque;
    }
bellard's avatar
bellard committed
247 248 249
    return 0;
}

bellard's avatar
bellard committed
250 251 252 253 254 255 256 257 258 259 260 261 262 263 264
void isa_unassign_ioport(int start, int length)
{
    int i;

    for(i = start; i < start + length; i++) {
        ioport_read_table[0][i] = default_ioport_readb;
        ioport_read_table[1][i] = default_ioport_readw;
        ioport_read_table[2][i] = default_ioport_readl;

        ioport_write_table[0][i] = default_ioport_writeb;
        ioport_write_table[1][i] = default_ioport_writew;
        ioport_write_table[2][i] = default_ioport_writel;
    }
}

265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291
void pstrcpy(char *buf, int buf_size, const char *str)
{
    int c;
    char *q = buf;

    if (buf_size <= 0)
        return;

    for(;;) {
        c = *str++;
        if (c == 0 || q >= buf + buf_size - 1)
            break;
        *q++ = c;
    }
    *q = '\0';
}

/* strcat and truncate. */
char *pstrcat(char *buf, int buf_size, const char *s)
{
    int len;
    len = strlen(buf);
    if (len < buf_size) 
        pstrcpy(buf + len, buf_size - len, s);
    return buf;
}

bellard's avatar
bellard committed
292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307
int strstart(const char *str, const char *val, const char **ptr)
{
    const char *p, *q;
    p = str;
    q = val;
    while (*q != '\0') {
        if (*p != *q)
            return 0;
        p++;
        q++;
    }
    if (ptr)
        *ptr = p;
    return 1;
}

bellard's avatar
bellard committed
308 309 310 311 312 313 314 315 316 317 318 319
/* return the size or -1 if error */
int get_image_size(const char *filename)
{
    int fd, size;
    fd = open(filename, O_RDONLY | O_BINARY);
    if (fd < 0)
        return -1;
    size = lseek(fd, 0, SEEK_END);
    close(fd);
    return size;
}

320 321 322 323
/* return the size or -1 if error */
int load_image(const char *filename, uint8_t *addr)
{
    int fd, size;
bellard's avatar
bellard committed
324
    fd = open(filename, O_RDONLY | O_BINARY);
325 326 327 328 329 330 331 332 333 334 335 336
    if (fd < 0)
        return -1;
    size = lseek(fd, 0, SEEK_END);
    lseek(fd, 0, SEEK_SET);
    if (read(fd, addr, size) != size) {
        close(fd);
        return -1;
    }
    close(fd);
    return size;
}

337
void cpu_outb(CPUState *env, int addr, int val)
338
{
339 340 341 342
#ifdef DEBUG_IOPORT
    if (loglevel & CPU_LOG_IOPORT)
        fprintf(logfile, "outb: %04x %02x\n", addr, val);
#endif    
343
    ioport_write_table[0][addr](ioport_opaque[addr], addr, val);
344 345
}

346
void cpu_outw(CPUState *env, int addr, int val)
347
{
348 349 350 351
#ifdef DEBUG_IOPORT
    if (loglevel & CPU_LOG_IOPORT)
        fprintf(logfile, "outw: %04x %04x\n", addr, val);
#endif    
352
    ioport_write_table[1][addr](ioport_opaque[addr], addr, val);
353 354
}

355
void cpu_outl(CPUState *env, int addr, int val)
356
{
357 358 359 360
#ifdef DEBUG_IOPORT
    if (loglevel & CPU_LOG_IOPORT)
        fprintf(logfile, "outl: %04x %08x\n", addr, val);
#endif
361
    ioport_write_table[2][addr](ioport_opaque[addr], addr, val);
362 363
}

364
int cpu_inb(CPUState *env, int addr)
365
{
366 367 368 369 370 371 372
    int val;
    val = ioport_read_table[0][addr](ioport_opaque[addr], addr);
#ifdef DEBUG_IOPORT
    if (loglevel & CPU_LOG_IOPORT)
        fprintf(logfile, "inb : %04x %02x\n", addr, val);
#endif
    return val;
373 374
}

375
int cpu_inw(CPUState *env, int addr)
376
{
377 378 379 380 381 382 383
    int val;
    val = ioport_read_table[1][addr](ioport_opaque[addr], addr);
#ifdef DEBUG_IOPORT
    if (loglevel & CPU_LOG_IOPORT)
        fprintf(logfile, "inw : %04x %04x\n", addr, val);
#endif
    return val;
384 385
}

386
int cpu_inl(CPUState *env, int addr)
387
{
388 389 390 391 392 393 394
    int val;
    val = ioport_read_table[2][addr](ioport_opaque[addr], addr);
#ifdef DEBUG_IOPORT
    if (loglevel & CPU_LOG_IOPORT)
        fprintf(logfile, "inl : %04x %08x\n", addr, val);
#endif
    return val;
395 396 397 398 399 400 401 402 403 404 405 406 407
}

/***********************************************************/
void hw_error(const char *fmt, ...)
{
    va_list ap;

    va_start(ap, fmt);
    fprintf(stderr, "qemu: hardware error: ");
    vfprintf(stderr, fmt, ap);
    fprintf(stderr, "\n");
#ifdef TARGET_I386
    cpu_x86_dump_state(global_env, stderr, X86_DUMP_FPU | X86_DUMP_CCOP);
408 409
#else
    cpu_dump_state(global_env, stderr, 0);
410 411 412 413 414
#endif
    va_end(ap);
    abort();
}

bellard's avatar
bellard committed
415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449
/***********************************************************/
/* keyboard/mouse */

static QEMUPutKBDEvent *qemu_put_kbd_event;
static void *qemu_put_kbd_event_opaque;
static QEMUPutMouseEvent *qemu_put_mouse_event;
static void *qemu_put_mouse_event_opaque;

void qemu_add_kbd_event_handler(QEMUPutKBDEvent *func, void *opaque)
{
    qemu_put_kbd_event_opaque = opaque;
    qemu_put_kbd_event = func;
}

void qemu_add_mouse_event_handler(QEMUPutMouseEvent *func, void *opaque)
{
    qemu_put_mouse_event_opaque = opaque;
    qemu_put_mouse_event = func;
}

void kbd_put_keycode(int keycode)
{
    if (qemu_put_kbd_event) {
        qemu_put_kbd_event(qemu_put_kbd_event_opaque, keycode);
    }
}

void kbd_mouse_event(int dx, int dy, int dz, int buttons_state)
{
    if (qemu_put_mouse_event) {
        qemu_put_mouse_event(qemu_put_mouse_event_opaque, 
                             dx, dy, dz, buttons_state);
    }
}

450 451 452
/***********************************************************/
/* timers */

453 454 455
#if defined(__powerpc__)

static inline uint32_t get_tbl(void) 
456
{
457 458 459
    uint32_t tbl;
    asm volatile("mftb %0" : "=r" (tbl));
    return tbl;
460 461
}

462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483
static inline uint32_t get_tbu(void) 
{
	uint32_t tbl;
	asm volatile("mftbu %0" : "=r" (tbl));
	return tbl;
}

int64_t cpu_get_real_ticks(void)
{
    uint32_t l, h, h1;
    /* NOTE: we test if wrapping has occurred */
    do {
        h = get_tbu();
        l = get_tbl();
        h1 = get_tbu();
    } while (h != h1);
    return ((int64_t)h << 32) | l;
}

#elif defined(__i386__)

int64_t cpu_get_real_ticks(void)
484 485
{
    int64_t val;
bellard's avatar
bellard committed
486
    asm volatile ("rdtsc" : "=A" (val));
487 488 489
    return val;
}

bellard's avatar
bellard committed
490 491 492 493 494 495 496 497 498 499 500 501 502
#elif defined(__x86_64__)

int64_t cpu_get_real_ticks(void)
{
    uint32_t low,high;
    int64_t val;
    asm volatile("rdtsc" : "=a" (low), "=d" (high));
    val = high;
    val <<= 32;
    val |= low;
    return val;
}

503 504 505 506 507
#else
#error unsupported CPU
#endif

static int64_t cpu_ticks_offset;
508
static int cpu_ticks_enabled;
509

510
static inline int64_t cpu_get_ticks(void)
511
{
512 513 514 515 516
    if (!cpu_ticks_enabled) {
        return cpu_ticks_offset;
    } else {
        return cpu_get_real_ticks() + cpu_ticks_offset;
    }
517 518 519 520 521
}

/* enable cpu_get_ticks() */
void cpu_enable_ticks(void)
{
522 523 524 525
    if (!cpu_ticks_enabled) {
        cpu_ticks_offset -= cpu_get_real_ticks();
        cpu_ticks_enabled = 1;
    }
526 527 528 529 530 531
}

/* disable cpu_get_ticks() : the clock is stopped. You must not call
   cpu_get_ticks() after that.  */
void cpu_disable_ticks(void)
{
532 533 534 535
    if (cpu_ticks_enabled) {
        cpu_ticks_offset = cpu_get_ticks();
        cpu_ticks_enabled = 0;
    }
536 537
}

bellard's avatar
bellard committed
538
static int64_t get_clock(void)
539
{
bellard's avatar
bellard committed
540 541 542 543 544
#ifdef _WIN32
    struct _timeb tb;
    _ftime(&tb);
    return ((int64_t)tb.time * 1000 + (int64_t)tb.millitm) * 1000;
#else
545 546 547
    struct timeval tv;
    gettimeofday(&tv, NULL);
    return tv.tv_sec * 1000000LL + tv.tv_usec;
bellard's avatar
bellard committed
548
#endif
549 550
}

551 552 553 554 555
void cpu_calibrate_ticks(void)
{
    int64_t usec, ticks;

    usec = get_clock();
556
    ticks = cpu_get_real_ticks();
bellard's avatar
bellard committed
557 558 559
#ifdef _WIN32
    Sleep(50);
#else
560
    usleep(50 * 1000);
bellard's avatar
bellard committed
561
#endif
562
    usec = get_clock() - usec;
563
    ticks = cpu_get_real_ticks() - ticks;
564 565 566
    ticks_per_sec = (ticks * 1000000LL + (usec >> 1)) / usec;
}

567
/* compute with 96 bit intermediate result: (a*b)/c */
bellard's avatar
bellard committed
568
uint64_t muldiv64(uint64_t a, uint32_t b, uint32_t c)
569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590
{
    union {
        uint64_t ll;
        struct {
#ifdef WORDS_BIGENDIAN
            uint32_t high, low;
#else
            uint32_t low, high;
#endif            
        } l;
    } u, res;
    uint64_t rl, rh;

    u.ll = a;
    rl = (uint64_t)u.l.low * (uint64_t)b;
    rh = (uint64_t)u.l.high * (uint64_t)b;
    rh += (rl >> 32);
    res.l.high = rh / c;
    res.l.low = (((rh % c) << 32) + (rl & 0xffffffff)) / c;
    return res.ll;
}

591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610
#define QEMU_TIMER_REALTIME 0
#define QEMU_TIMER_VIRTUAL  1

struct QEMUClock {
    int type;
    /* XXX: add frequency */
};

struct QEMUTimer {
    QEMUClock *clock;
    int64_t expire_time;
    QEMUTimerCB *cb;
    void *opaque;
    struct QEMUTimer *next;
};

QEMUClock *rt_clock;
QEMUClock *vm_clock;

static QEMUTimer *active_timers[2];
bellard's avatar
bellard committed
611 612 613
#ifdef _WIN32
static MMRESULT timerID;
#else
614 615
/* frequency of the times() clock tick */
static int timer_freq;
bellard's avatar
bellard committed
616
#endif
617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726

QEMUClock *qemu_new_clock(int type)
{
    QEMUClock *clock;
    clock = qemu_mallocz(sizeof(QEMUClock));
    if (!clock)
        return NULL;
    clock->type = type;
    return clock;
}

QEMUTimer *qemu_new_timer(QEMUClock *clock, QEMUTimerCB *cb, void *opaque)
{
    QEMUTimer *ts;

    ts = qemu_mallocz(sizeof(QEMUTimer));
    ts->clock = clock;
    ts->cb = cb;
    ts->opaque = opaque;
    return ts;
}

void qemu_free_timer(QEMUTimer *ts)
{
    qemu_free(ts);
}

/* stop a timer, but do not dealloc it */
void qemu_del_timer(QEMUTimer *ts)
{
    QEMUTimer **pt, *t;

    /* NOTE: this code must be signal safe because
       qemu_timer_expired() can be called from a signal. */
    pt = &active_timers[ts->clock->type];
    for(;;) {
        t = *pt;
        if (!t)
            break;
        if (t == ts) {
            *pt = t->next;
            break;
        }
        pt = &t->next;
    }
}

/* modify the current timer so that it will be fired when current_time
   >= expire_time. The corresponding callback will be called. */
void qemu_mod_timer(QEMUTimer *ts, int64_t expire_time)
{
    QEMUTimer **pt, *t;

    qemu_del_timer(ts);

    /* add the timer in the sorted list */
    /* NOTE: this code must be signal safe because
       qemu_timer_expired() can be called from a signal. */
    pt = &active_timers[ts->clock->type];
    for(;;) {
        t = *pt;
        if (!t)
            break;
        if (t->expire_time > expire_time) 
            break;
        pt = &t->next;
    }
    ts->expire_time = expire_time;
    ts->next = *pt;
    *pt = ts;
}

int qemu_timer_pending(QEMUTimer *ts)
{
    QEMUTimer *t;
    for(t = active_timers[ts->clock->type]; t != NULL; t = t->next) {
        if (t == ts)
            return 1;
    }
    return 0;
}

static inline int qemu_timer_expired(QEMUTimer *timer_head, int64_t current_time)
{
    if (!timer_head)
        return 0;
    return (timer_head->expire_time <= current_time);
}

static void qemu_run_timers(QEMUTimer **ptimer_head, int64_t current_time)
{
    QEMUTimer *ts;
    
    for(;;) {
        ts = *ptimer_head;
        if (ts->expire_time > current_time)
            break;
        /* remove timer from the list before calling the callback */
        *ptimer_head = ts->next;
        ts->next = NULL;
        
        /* run the callback (the timer list can be modified) */
        ts->cb(ts->opaque);
    }
}

int64_t qemu_get_clock(QEMUClock *clock)
{
    switch(clock->type) {
    case QEMU_TIMER_REALTIME:
bellard's avatar
bellard committed
727 728 729
#ifdef _WIN32
        return GetTickCount();
#else
bellard's avatar
bellard committed
730 731 732 733 734 735 736 737 738 739 740
        {
            struct tms tp;

            /* Note that using gettimeofday() is not a good solution
               for timers because its value change when the date is
               modified. */
            if (timer_freq == 100) {
                return times(&tp) * 10;
            } else {
                return ((int64_t)times(&tp) * 1000) / timer_freq;
            }
741
        }
bellard's avatar
bellard committed
742
#endif
743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794
    default:
    case QEMU_TIMER_VIRTUAL:
        return cpu_get_ticks();
    }
}

/* save a timer */
void qemu_put_timer(QEMUFile *f, QEMUTimer *ts)
{
    uint64_t expire_time;

    if (qemu_timer_pending(ts)) {
        expire_time = ts->expire_time;
    } else {
        expire_time = -1;
    }
    qemu_put_be64(f, expire_time);
}

void qemu_get_timer(QEMUFile *f, QEMUTimer *ts)
{
    uint64_t expire_time;

    expire_time = qemu_get_be64(f);
    if (expire_time != -1) {
        qemu_mod_timer(ts, expire_time);
    } else {
        qemu_del_timer(ts);
    }
}

static void timer_save(QEMUFile *f, void *opaque)
{
    if (cpu_ticks_enabled) {
        hw_error("cannot save state if virtual timers are running");
    }
    qemu_put_be64s(f, &cpu_ticks_offset);
    qemu_put_be64s(f, &ticks_per_sec);
}

static int timer_load(QEMUFile *f, void *opaque, int version_id)
{
    if (version_id != 1)
        return -EINVAL;
    if (cpu_ticks_enabled) {
        return -EINVAL;
    }
    qemu_get_be64s(f, &cpu_ticks_offset);
    qemu_get_be64s(f, &ticks_per_sec);
    return 0;
}

bellard's avatar
bellard committed
795 796 797 798
#ifdef _WIN32
void CALLBACK host_alarm_handler(UINT uTimerID, UINT uMsg, 
                                 DWORD_PTR dwUser, DWORD_PTR dw1, DWORD_PTR dw2)
#else
799
static void host_alarm_handler(int host_signum)
bellard's avatar
bellard committed
800
#endif
801
{
802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830
#if 0
#define DISP_FREQ 1000
    {
        static int64_t delta_min = INT64_MAX;
        static int64_t delta_max, delta_cum, last_clock, delta, ti;
        static int count;
        ti = qemu_get_clock(vm_clock);
        if (last_clock != 0) {
            delta = ti - last_clock;
            if (delta < delta_min)
                delta_min = delta;
            if (delta > delta_max)
                delta_max = delta;
            delta_cum += delta;
            if (++count == DISP_FREQ) {
                printf("timer: min=%lld us max=%lld us avg=%lld us avg_freq=%0.3f Hz\n",
                       muldiv64(delta_min, 1000000, ticks_per_sec),
                       muldiv64(delta_max, 1000000, ticks_per_sec),
                       muldiv64(delta_cum, 1000000 / DISP_FREQ, ticks_per_sec),
                       (double)ticks_per_sec / ((double)delta_cum / DISP_FREQ));
                count = 0;
                delta_min = INT64_MAX;
                delta_max = 0;
                delta_cum = 0;
            }
        }
        last_clock = ti;
    }
#endif
831 832 833 834 835 836 837 838 839
    if (qemu_timer_expired(active_timers[QEMU_TIMER_VIRTUAL],
                           qemu_get_clock(vm_clock)) ||
        qemu_timer_expired(active_timers[QEMU_TIMER_REALTIME],
                           qemu_get_clock(rt_clock))) {
        /* stop the cpu because a timer occured */
        cpu_interrupt(global_env, CPU_INTERRUPT_EXIT);
    }
}

840 841
#ifndef _WIN32

bellard's avatar
BSD fix  
bellard committed
842 843
#if defined(__linux__)

844 845 846
#define RTC_FREQ 1024

static int rtc_fd;
bellard's avatar
BSD fix  
bellard committed
847

848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867
static int start_rtc_timer(void)
{
    rtc_fd = open("/dev/rtc", O_RDONLY);
    if (rtc_fd < 0)
        return -1;
    if (ioctl(rtc_fd, RTC_IRQP_SET, RTC_FREQ) < 0) {
        fprintf(stderr, "Could not configure '/dev/rtc' to have a 1024 Hz timer. This is not a fatal\n"
                "error, but for better emulation accuracy either use a 2.6 host Linux kernel or\n"
                "type 'echo 1024 > /proc/sys/dev/rtc/max-user-freq' as root.\n");
        goto fail;
    }
    if (ioctl(rtc_fd, RTC_PIE_ON, 0) < 0) {
    fail:
        close(rtc_fd);
        return -1;
    }
    pit_min_timer_count = PIT_FREQ / RTC_FREQ;
    return 0;
}

bellard's avatar
BSD fix  
bellard committed
868 869 870 871 872 873 874 875 876 877
#else

static int start_rtc_timer(void)
{
    return -1;
}

#endif /* !defined(__linux__) */

#endif /* !defined(_WIN32) */
878

879 880 881 882 883
static void init_timers(void)
{
    rt_clock = qemu_new_clock(QEMU_TIMER_REALTIME);
    vm_clock = qemu_new_clock(QEMU_TIMER_VIRTUAL);

bellard's avatar
bellard committed
884 885 886
#ifdef _WIN32
    {
        int count=0;
bellard's avatar
bellard committed
887 888 889 890 891
        timerID = timeSetEvent(10,    // interval (ms)
                               0,     // resolution
                               host_alarm_handler, // function
                               (DWORD)&count,  // user parameter
                               TIME_PERIODIC | TIME_CALLBACK_FUNCTION);
bellard's avatar
bellard committed
892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908
 	if( !timerID ) {
            perror("failed timer alarm");
            exit(1);
 	}
    }
    pit_min_timer_count = ((uint64_t)10000 * PIT_FREQ) / 1000000;
#else
    {
        struct sigaction act;
        struct itimerval itv;
        
        /* get times() syscall frequency */
        timer_freq = sysconf(_SC_CLK_TCK);
        
        /* timer signal */
        sigfillset(&act.sa_mask);
        act.sa_flags = 0;
909
#if defined (TARGET_I386) && defined(USE_CODE_COPY)
bellard's avatar
bellard committed
910 911 912 913
        act.sa_flags |= SA_ONSTACK;
#endif
        act.sa_handler = host_alarm_handler;
        sigaction(SIGALRM, &act, NULL);
914

bellard's avatar
bellard committed
915 916 917 918 919 920 921 922
        itv.it_interval.tv_sec = 0;
        itv.it_interval.tv_usec = 1000;
        itv.it_value.tv_sec = 0;
        itv.it_value.tv_usec = 10 * 1000;
        setitimer(ITIMER_REAL, &itv, NULL);
        /* we probe the tick duration of the kernel to inform the user if
           the emulated kernel requested a too high timer frequency */
        getitimer(ITIMER_REAL, &itv);
923

924
#if defined(__linux__)
925 926 927 928 929 930 931 932 933 934 935 936
        if (itv.it_interval.tv_usec > 1000) {
            /* try to use /dev/rtc to have a faster timer */
            if (start_rtc_timer() < 0)
                goto use_itimer;
            /* disable itimer */
            itv.it_interval.tv_sec = 0;
            itv.it_interval.tv_usec = 0;
            itv.it_value.tv_sec = 0;
            itv.it_value.tv_usec = 0;
            setitimer(ITIMER_REAL, &itv, NULL);

            /* use the RTC */
bellard's avatar
bellard committed
937
            sigaction(SIGIO, &act, NULL);
938 939
            fcntl(rtc_fd, F_SETFL, O_ASYNC);
            fcntl(rtc_fd, F_SETOWN, getpid());
940 941 942
        } else 
#endif /* defined(__linux__) */
        {
943 944 945 946
        use_itimer:
            pit_min_timer_count = ((uint64_t)itv.it_interval.tv_usec * 
                                   PIT_FREQ) / 1000000;
        }
bellard's avatar
bellard committed
947
    }
948 949 950
#endif
}

bellard's avatar
bellard committed
951 952 953 954 955 956 957
void quit_timers(void)
{
#ifdef _WIN32
    timeKillEvent(timerID);
#endif
}

958
/***********************************************************/
bellard's avatar
bellard committed
959
/* character device */
960

bellard's avatar
bellard committed
961 962 963 964
int qemu_chr_write(CharDriverState *s, const uint8_t *buf, int len)
{
    return s->chr_write(s, buf, len);
}
bellard's avatar
bellard committed
965

bellard's avatar
bellard committed
966
void qemu_chr_printf(CharDriverState *s, const char *fmt, ...)
bellard's avatar
bellard committed
967
{
bellard's avatar
bellard committed
968 969 970 971 972 973
    char buf[4096];
    va_list ap;
    va_start(ap, fmt);
    vsnprintf(buf, sizeof(buf), fmt, ap);
    qemu_chr_write(s, buf, strlen(buf));
    va_end(ap);
bellard's avatar
bellard committed
974 975
}

bellard's avatar
bellard committed
976 977 978 979 980 981
void qemu_chr_send_event(CharDriverState *s, int event)
{
    if (s->chr_send_event)
        s->chr_send_event(s, event);
}

bellard's avatar
bellard committed
982 983 984 985 986 987 988 989 990 991 992
void qemu_chr_add_read_handler(CharDriverState *s, 
                               IOCanRWHandler *fd_can_read, 
                               IOReadHandler *fd_read, void *opaque)
{
    s->chr_add_read_handler(s, fd_can_read, fd_read, opaque);
}
             
void qemu_chr_add_event_handler(CharDriverState *s, IOEventHandler *chr_event)
{
    s->chr_event = chr_event;
}
bellard's avatar
bellard committed
993

bellard's avatar
bellard committed
994
static int null_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
995
{
bellard's avatar
bellard committed
996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047
    return len;
}

static void null_chr_add_read_handler(CharDriverState *chr, 
                                    IOCanRWHandler *fd_can_read, 
                                    IOReadHandler *fd_read, void *opaque)
{
}

CharDriverState *qemu_chr_open_null(void)
{
    CharDriverState *chr;

    chr = qemu_mallocz(sizeof(CharDriverState));
    if (!chr)
        return NULL;
    chr->chr_write = null_chr_write;
    chr->chr_add_read_handler = null_chr_add_read_handler;
    return chr;
}

#ifndef _WIN32

typedef struct {
    int fd_in, fd_out;
    /* for nographic stdio only */
    IOCanRWHandler *fd_can_read; 
    IOReadHandler *fd_read;
    void *fd_opaque;
} FDCharDriver;

#define STDIO_MAX_CLIENTS 2

static int stdio_nb_clients;
static CharDriverState *stdio_clients[STDIO_MAX_CLIENTS];

static int fd_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
{
    FDCharDriver *s = chr->opaque;
    return write(s->fd_out, buf, len);
}

static void fd_chr_add_read_handler(CharDriverState *chr, 
                                    IOCanRWHandler *fd_can_read, 
                                    IOReadHandler *fd_read, void *opaque)
{
    FDCharDriver *s = chr->opaque;

    if (nographic && s->fd_in == 0) {
        s->fd_can_read = fd_can_read;
        s->fd_read = fd_read;
        s->fd_opaque = opaque;
bellard's avatar
bellard committed
1048
    } else {
bellard's avatar
bellard committed
1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153
        qemu_add_fd_read_handler(s->fd_in, fd_can_read, fd_read, opaque);
    }
}

/* open a character device to a unix fd */
CharDriverState *qemu_chr_open_fd(int fd_in, int fd_out)
{
    CharDriverState *chr;
    FDCharDriver *s;

    chr = qemu_mallocz(sizeof(CharDriverState));
    if (!chr)
        return NULL;
    s = qemu_mallocz(sizeof(FDCharDriver));
    if (!s) {
        free(chr);
        return NULL;
    }
    s->fd_in = fd_in;
    s->fd_out = fd_out;
    chr->opaque = s;
    chr->chr_write = fd_chr_write;
    chr->chr_add_read_handler = fd_chr_add_read_handler;
    return chr;
}

/* for STDIO, we handle the case where several clients use it
   (nographic mode) */

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

static int term_got_escape, client_index;

void term_print_help(void)
{
    printf("\n"
           "C-a h    print this help\n"
           "C-a x    exit emulator\n"
           "C-a s    save disk data back to file (if -snapshot)\n"
           "C-a b    send break (magic sysrq)\n"
           "C-a c    switch between console and monitor\n"
           "C-a C-a  send C-a\n"
           );
}

/* called when a char is received */
static void stdio_received_byte(int ch)
{
    if (term_got_escape) {
        term_got_escape = 0;
        switch(ch) {
        case 'h':
            term_print_help();
            break;
        case 'x':
            exit(0);
            break;
        case 's': 
            {
                int i;
                for (i = 0; i < MAX_DISKS; i++) {
                    if (bs_table[i])
                        bdrv_commit(bs_table[i]);
                }
            }
            break;
        case 'b':
            if (client_index < stdio_nb_clients) {
                CharDriverState *chr;
                FDCharDriver *s;

                chr = stdio_clients[client_index];
                s = chr->opaque;
                chr->chr_event(s->fd_opaque, CHR_EVENT_BREAK);
            }
            break;
        case 'c':
            client_index++;
            if (client_index >= stdio_nb_clients)
                client_index = 0;
            if (client_index == 0) {
                /* send a new line in the monitor to get the prompt */
                ch = '\r';
                goto send_char;
            }
            break;
        case TERM_ESCAPE:
            goto send_char;
        }
    } else if (ch == TERM_ESCAPE) {
        term_got_escape = 1;
    } else {
    send_char:
        if (client_index < stdio_nb_clients) {
            uint8_t buf[1];
            CharDriverState *chr;
            FDCharDriver *s;
            
            chr = stdio_clients[client_index];
            s = chr->opaque;
            buf[0] = ch;
            /* XXX: should queue the char if the device is not
               ready */
            if (s->fd_can_read(s->fd_opaque) > 0) 
                s->fd_read(s->fd_opaque, buf, 1);
1154
        }
1155 1156 1157
    }
}

bellard's avatar
bellard committed
1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170
static int stdio_can_read(void *opaque)
{
    /* XXX: not strictly correct */
    return 1;
}

static void stdio_read(void *opaque, const uint8_t *buf, int size)
{
    int i;
    for(i = 0; i < size; i++)
        stdio_received_byte(buf[i]);
}

1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207
/* init terminal so that we can grab keys */
static struct termios oldtty;
static int old_fd0_flags;

static void term_exit(void)
{
    tcsetattr (0, TCSANOW, &oldtty);
    fcntl(0, F_SETFL, old_fd0_flags);
}

static void term_init(void)
{
    struct termios tty;

    tcgetattr (0, &tty);
    oldtty = tty;
    old_fd0_flags = fcntl(0, F_GETFL);

    tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
                          |INLCR|IGNCR|ICRNL|IXON);
    tty.c_oflag |= OPOST;
    tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN);
    /* if graphical mode, we allow Ctrl-C handling */
    if (nographic)
        tty.c_lflag &= ~ISIG;
    tty.c_cflag &= ~(CSIZE|PARENB);
    tty.c_cflag |= CS8;
    tty.c_cc[VMIN] = 1;
    tty.c_cc[VTIME] = 0;
    
    tcsetattr (0, TCSANOW, &tty);

    atexit(term_exit);

    fcntl(0, F_SETFL, O_NONBLOCK);
}

bellard's avatar
bellard committed
1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224
CharDriverState *qemu_chr_open_stdio(void)
{
    CharDriverState *chr;

    if (nographic) {
        if (stdio_nb_clients >= STDIO_MAX_CLIENTS)
            return NULL;
        chr = qemu_chr_open_fd(0, 1);
        if (stdio_nb_clients == 0)
            qemu_add_fd_read_handler(0, stdio_can_read, stdio_read, NULL);
        client_index = stdio_nb_clients;
    } else {
        if (stdio_nb_clients != 0)
            return NULL;
        chr = qemu_chr_open_fd(0, 1);
    }
    stdio_clients[stdio_nb_clients++] = chr;
1225 1226 1227 1228
    if (stdio_nb_clients == 1) {
        /* set the terminal in raw mode */
        term_init();
    }
bellard's avatar
bellard committed
1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249
    return chr;
}

#if defined(__linux__)
CharDriverState *qemu_chr_open_pty(void)
{
    char slave_name[1024];
    int master_fd, slave_fd;
    
    /* Not satisfying */
    if (openpty(&master_fd, &slave_fd, slave_name, NULL, NULL) < 0) {
        return NULL;
    }
    fprintf(stderr, "char device redirected to %s\n", slave_name);
    return qemu_chr_open_fd(master_fd, master_fd);
}
#else
CharDriverState *qemu_chr_open_pty(void)
{
    return NULL;
}
bellard's avatar
bellard committed
1250 1251
#endif

bellard's avatar
bellard committed
1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272
#endif /* !defined(_WIN32) */

CharDriverState *qemu_chr_open(const char *filename)
{
    if (!strcmp(filename, "vc")) {
        return text_console_init(&display_state);
    } else if (!strcmp(filename, "null")) {
        return qemu_chr_open_null();
    } else 
#ifndef _WIN32
    if (!strcmp(filename, "pty")) {
        return qemu_chr_open_pty();
    } else if (!strcmp(filename, "stdio")) {
        return qemu_chr_open_stdio();
    } else 
#endif
    {
        return NULL;
    }
}

bellard's avatar
bellard committed
1273
/***********************************************************/
bellard's avatar
bellard committed
1274
/* Linux network device redirectors */
1275

bellard's avatar
bellard committed
1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305
void hex_dump(FILE *f, const uint8_t *buf, int size)
{
    int len, i, j, c;

    for(i=0;i<size;i+=16) {
        len = size - i;
        if (len > 16)
            len = 16;
        fprintf(f, "%08x ", i);
        for(j=0;j<16;j++) {
            if (j < len)
                fprintf(f, " %02x", buf[i+j]);
            else
                fprintf(f, "   ");
        }
        fprintf(f, " ");
        for(j=0;j<len;j++) {
            c = buf[i+j];
            if (c < ' ' || c > '~')
                c = '.';
            fprintf(f, "%c", c);
        }
        fprintf(f, "\n");
    }
}

void qemu_send_packet(NetDriverState *nd, const uint8_t *buf, int size)
{
    nd->send_packet(nd, buf, size);
}
bellard's avatar
bellard committed
1306

bellard's avatar
bellard committed
1307 1308
void qemu_add_read_packet(NetDriverState *nd, IOCanRWHandler *fd_can_read, 
                          IOReadHandler *fd_read, void *opaque)
bellard's avatar
bellard committed
1309
{
bellard's avatar
bellard committed
1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329
    nd->add_read_packet(nd, fd_can_read, fd_read, opaque);
}

/* dummy network adapter */

static void dummy_send_packet(NetDriverState *nd, const uint8_t *buf, int size)
{
}

static void dummy_add_read_packet(NetDriverState *nd, 
                                  IOCanRWHandler *fd_can_read, 
                                  IOReadHandler *fd_read, void *opaque)
{
}

static int net_dummy_init(NetDriverState *nd)
{
    nd->send_packet = dummy_send_packet;
    nd->add_read_packet = dummy_add_read_packet;
    pstrcpy(nd->ifname, sizeof(nd->ifname), "dummy");
bellard's avatar
bellard committed
1330 1331 1332
    return 0;
}

<