vl.c 144 KB
Newer Older
1
/*
bellard's avatar
bellard committed
2
 * QEMU System Emulator
3
 * 
4
 * Copyright (c) 2003-2005 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 <netinet/in.h>
bellard's avatar
bellard committed
42
#include <dirent.h>
bellard's avatar
bellard committed
43
#include <netdb.h>
bellard's avatar
bellard committed
44 45
#ifdef _BSD
#include <sys/stat.h>
46
#ifndef __APPLE__
bellard's avatar
bellard committed
47
#include <libutil.h>
48
#endif
bellard's avatar
bellard committed
49
#else
bellard's avatar
bellard committed
50
#ifndef __sun__
bellard's avatar
bellard committed
51 52
#include <linux/if.h>
#include <linux/if_tun.h>
bellard's avatar
bellard committed
53 54
#include <pty.h>
#include <malloc.h>
55
#include <linux/rtc.h>
bellard's avatar
bellard committed
56
#include <linux/ppdev.h>
bellard's avatar
bellard committed
57
#endif
bellard's avatar
bellard committed
58
#endif
bellard's avatar
bellard committed
59
#endif
bellard's avatar
bellard committed
60

bellard's avatar
bellard committed
61 62 63 64
#if defined(CONFIG_SLIRP)
#include "libslirp.h"
#endif

bellard's avatar
bellard committed
65
#ifdef _WIN32
bellard's avatar
bellard committed
66
#include <malloc.h>
bellard's avatar
bellard committed
67 68 69 70 71 72
#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
73 74
#include "qemu_socket.h"

bellard's avatar
bellard committed
75
#ifdef CONFIG_SDL
bellard's avatar
bellard committed
76
#ifdef __APPLE__
77
#include <SDL/SDL.h>
bellard's avatar
bellard committed
78
#endif
bellard's avatar
bellard committed
79
#endif /* CONFIG_SDL */
80

81 82 83 84 85
#ifdef CONFIG_COCOA
#undef main
#define main qemu_main
#endif /* CONFIG_COCOA */

86
#include "disas.h"
bellard's avatar
bellard committed
87

88
#include "exec-all.h"
89

90
#define DEFAULT_NETWORK_SCRIPT "/etc/qemu-ifup"
bellard's avatar
bellard committed
91

92
//#define DEBUG_UNUSED_IOPORT
93
//#define DEBUG_IOPORT
94

95
#if !defined(CONFIG_SOFTMMU)
bellard's avatar
bellard committed
96
#define PHYS_RAM_MAX_SIZE (256 * 1024 * 1024)
97 98 99
#else
#define PHYS_RAM_MAX_SIZE (2047 * 1024 * 1024)
#endif
bellard's avatar
bellard committed
100

bellard's avatar
bellard committed
101 102 103
#ifdef TARGET_PPC
#define DEFAULT_RAM_SIZE 144
#else
104
#define DEFAULT_RAM_SIZE 128
bellard's avatar
bellard committed
105
#endif
106 107
/* in ms */
#define GUI_REFRESH_INTERVAL 30
108

109 110
/* XXX: use a two level table to limit memory usage */
#define MAX_IOPORTS 65536
111

bellard's avatar
bellard committed
112
const char *bios_dir = CONFIG_QEMU_SHAREDIR;
113
char phys_ram_file[1024];
114
void *ioport_opaque[MAX_IOPORTS];
bellard's avatar
bellard committed
115 116
IOPortReadFunc *ioport_read_table[3][MAX_IOPORTS];
IOPortWriteFunc *ioport_write_table[3][MAX_IOPORTS];
117
BlockDriverState *bs_table[MAX_DISKS], *fd_table[MAX_FD];
118
int vga_ram_size;
bellard's avatar
bellard committed
119
int bios_size;
120
static DisplayState display_state;
121
int nographic;
122
const char* keyboard_layout = NULL;
123
int64_t ticks_per_sec;
124
int boot_device = 'c';
bellard's avatar
bellard committed
125
int ram_size;
bellard's avatar
bellard committed
126
int pit_min_timer_count = 0;
127
int nb_nics;
bellard's avatar
bellard committed
128
NICInfo nd_table[MAX_NICS];
129 130
QEMUTimer *gui_timer;
int vm_running;
bellard's avatar
bellard committed
131
int rtc_utc = 1;
132
int cirrus_vga_enabled = 1;
133 134 135 136
#ifdef TARGET_SPARC
int graphic_width = 1024;
int graphic_height = 768;
#else
137 138
int graphic_width = 800;
int graphic_height = 600;
139
#endif
140
int graphic_depth = 15;
bellard's avatar
bellard committed
141
int full_screen = 0;
142
CharDriverState *serial_hds[MAX_SERIAL_PORTS];
143
CharDriverState *parallel_hds[MAX_PARALLEL_PORTS];
144 145 146
#ifdef TARGET_I386
int win2k_install_hack = 0;
#endif
bellard's avatar
bellard committed
147
int usb_enabled = 0;
bellard's avatar
bellard committed
148 149
USBPort *vm_usb_ports[MAX_VM_USB_PORTS];
USBDevice *vm_usb_hub;
bellard's avatar
bellard committed
150
static VLANState *first_vlan;
bellard's avatar
bellard committed
151
int smp_cpus = 1;
bellard's avatar
bellard committed
152
int vnc_display = -1;
bellard's avatar
bellard committed
153
#if defined(TARGET_SPARC)
154
#define MAX_CPUS 16
bellard's avatar
bellard committed
155 156
#elif defined(TARGET_I386)
#define MAX_CPUS 255
157
#else
bellard's avatar
bellard committed
158
#define MAX_CPUS 1
159
#endif
160 161

/***********************************************************/
162 163 164
/* x86 ISA bus support */

target_phys_addr_t isa_mem_base = 0;
bellard's avatar
bellard committed
165
PicState2 *isa_pic;
166

167
uint32_t default_ioport_readb(void *opaque, uint32_t address)
168 169 170 171
{
#ifdef DEBUG_UNUSED_IOPORT
    fprintf(stderr, "inb: port=0x%04x\n", address);
#endif
bellard's avatar
bellard committed
172
    return 0xff;
173 174
}

175
void default_ioport_writeb(void *opaque, uint32_t address, uint32_t data)
176 177 178 179 180 181 182
{
#ifdef DEBUG_UNUSED_IOPORT
    fprintf(stderr, "outb: port=0x%04x data=0x%02x\n", address, data);
#endif
}

/* default is to make two byte accesses */
183
uint32_t default_ioport_readw(void *opaque, uint32_t address)
184 185
{
    uint32_t data;
bellard's avatar
bellard committed
186 187 188
    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;
189 190 191
    return data;
}

192
void default_ioport_writew(void *opaque, uint32_t address, uint32_t data)
193
{
bellard's avatar
bellard committed
194 195 196
    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);
197 198
}

199
uint32_t default_ioport_readl(void *opaque, uint32_t address)
200
{
bellard's avatar
bellard committed
201 202 203 204
#ifdef DEBUG_UNUSED_IOPORT
    fprintf(stderr, "inl: port=0x%04x\n", address);
#endif
    return 0xffffffff;
205 206
}

207
void default_ioport_writel(void *opaque, uint32_t address, uint32_t data)
208
{
bellard's avatar
bellard committed
209 210 211
#ifdef DEBUG_UNUSED_IOPORT
    fprintf(stderr, "outl: port=0x%04x data=0x%02x\n", address, data);
#endif
212 213
}

bellard's avatar
bellard committed
214
void init_ioports(void)
215 216 217
{
    int i;

bellard's avatar
bellard committed
218 219 220 221 222 223 224 225
    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;
    }
226 227
}

bellard's avatar
bellard committed
228
/* size is the word size in byte */
229 230
int register_ioport_read(int start, int length, int size, 
                         IOPortReadFunc *func, void *opaque)
bellard's avatar
bellard committed
231
{
bellard's avatar
bellard committed
232
    int i, bsize;
bellard's avatar
bellard committed
233

234
    if (size == 1) {
bellard's avatar
bellard committed
235
        bsize = 0;
236
    } else if (size == 2) {
bellard's avatar
bellard committed
237
        bsize = 1;
238
    } else if (size == 4) {
bellard's avatar
bellard committed
239
        bsize = 2;
240 241
    } else {
        hw_error("register_ioport_read: invalid size");
bellard's avatar
bellard committed
242
        return -1;
243 244
    }
    for(i = start; i < start + length; i += size) {
bellard's avatar
bellard committed
245
        ioport_read_table[bsize][i] = func;
246 247 248 249
        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
250 251 252
    return 0;
}

bellard's avatar
bellard committed
253
/* size is the word size in byte */
254 255
int register_ioport_write(int start, int length, int size, 
                          IOPortWriteFunc *func, void *opaque)
bellard's avatar
bellard committed
256
{
bellard's avatar
bellard committed
257
    int i, bsize;
bellard's avatar
bellard committed
258

259
    if (size == 1) {
bellard's avatar
bellard committed
260
        bsize = 0;
261
    } else if (size == 2) {
bellard's avatar
bellard committed
262
        bsize = 1;
263
    } else if (size == 4) {
bellard's avatar
bellard committed
264
        bsize = 2;
265 266
    } else {
        hw_error("register_ioport_write: invalid size");
bellard's avatar
bellard committed
267
        return -1;
268 269
    }
    for(i = start; i < start + length; i += size) {
bellard's avatar
bellard committed
270
        ioport_write_table[bsize][i] = func;
271 272 273 274
        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
275 276 277
    return 0;
}

bellard's avatar
bellard committed
278 279 280 281 282 283 284 285 286 287 288 289 290 291 292
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;
    }
}

bellard's avatar
bellard committed
293 294
/***********************************************************/

295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321
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
322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337
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;
}

338
void cpu_outb(CPUState *env, int addr, int val)
339
{
340 341 342 343
#ifdef DEBUG_IOPORT
    if (loglevel & CPU_LOG_IOPORT)
        fprintf(logfile, "outb: %04x %02x\n", addr, val);
#endif    
344
    ioport_write_table[0][addr](ioport_opaque[addr], addr, val);
345 346 347 348
#ifdef USE_KQEMU
    if (env)
        env->last_io_time = cpu_get_time_fast();
#endif
349 350
}

351
void cpu_outw(CPUState *env, int addr, int val)
352
{
353 354 355 356
#ifdef DEBUG_IOPORT
    if (loglevel & CPU_LOG_IOPORT)
        fprintf(logfile, "outw: %04x %04x\n", addr, val);
#endif    
357
    ioport_write_table[1][addr](ioport_opaque[addr], addr, val);
358 359 360 361
#ifdef USE_KQEMU
    if (env)
        env->last_io_time = cpu_get_time_fast();
#endif
362 363
}

364
void cpu_outl(CPUState *env, int addr, int val)
365
{
366 367 368 369
#ifdef DEBUG_IOPORT
    if (loglevel & CPU_LOG_IOPORT)
        fprintf(logfile, "outl: %04x %08x\n", addr, val);
#endif
370
    ioport_write_table[2][addr](ioport_opaque[addr], addr, val);
371 372 373 374
#ifdef USE_KQEMU
    if (env)
        env->last_io_time = cpu_get_time_fast();
#endif
375 376
}

377
int cpu_inb(CPUState *env, int addr)
378
{
379 380 381 382 383
    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);
384 385 386 387
#endif
#ifdef USE_KQEMU
    if (env)
        env->last_io_time = cpu_get_time_fast();
388 389
#endif
    return val;
390 391
}

392
int cpu_inw(CPUState *env, int addr)
393
{
394 395 396 397 398
    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);
399 400 401 402
#endif
#ifdef USE_KQEMU
    if (env)
        env->last_io_time = cpu_get_time_fast();
403 404
#endif
    return val;
405 406
}

407
int cpu_inl(CPUState *env, int addr)
408
{
409 410 411 412 413
    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);
414 415 416 417
#endif
#ifdef USE_KQEMU
    if (env)
        env->last_io_time = cpu_get_time_fast();
418 419
#endif
    return val;
420 421 422 423 424 425
}

/***********************************************************/
void hw_error(const char *fmt, ...)
{
    va_list ap;
bellard's avatar
bellard committed
426
    CPUState *env;
427 428 429 430 431

    va_start(ap, fmt);
    fprintf(stderr, "qemu: hardware error: ");
    vfprintf(stderr, fmt, ap);
    fprintf(stderr, "\n");
bellard's avatar
bellard committed
432 433
    for(env = first_cpu; env != NULL; env = env->next_cpu) {
        fprintf(stderr, "CPU #%d:\n", env->cpu_index);
434
#ifdef TARGET_I386
bellard's avatar
bellard committed
435
        cpu_dump_state(env, stderr, fprintf, X86_DUMP_FPU);
436
#else
bellard's avatar
bellard committed
437
        cpu_dump_state(env, stderr, fprintf, 0);
438
#endif
bellard's avatar
bellard committed
439
    }
440 441 442 443
    va_end(ap);
    abort();
}

bellard's avatar
bellard committed
444 445 446 447 448 449 450
/***********************************************************/
/* 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;
451
static int qemu_put_mouse_event_absolute;
bellard's avatar
bellard committed
452 453 454 455 456 457 458

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

459
void qemu_add_mouse_event_handler(QEMUPutMouseEvent *func, void *opaque, int absolute)
bellard's avatar
bellard committed
460 461 462
{
    qemu_put_mouse_event_opaque = opaque;
    qemu_put_mouse_event = func;
463
    qemu_put_mouse_event_absolute = absolute;
bellard's avatar
bellard committed
464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480
}

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);
    }
}

481 482 483 484 485
int kbd_mouse_is_absolute(void)
{
    return qemu_put_mouse_event_absolute;
}

486 487 488
/***********************************************************/
/* timers */

489 490 491
#if defined(__powerpc__)

static inline uint32_t get_tbl(void) 
492
{
493 494 495
    uint32_t tbl;
    asm volatile("mftb %0" : "=r" (tbl));
    return tbl;
496 497
}

498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519
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)
520 521
{
    int64_t val;
bellard's avatar
bellard committed
522
    asm volatile ("rdtsc" : "=A" (val));
523 524 525
    return val;
}

bellard's avatar
bellard committed
526 527 528 529 530 531 532 533 534 535 536 537 538
#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;
}

bellard's avatar
bellard committed
539 540 541 542 543 544 545 546 547
#elif defined(__ia64)

int64_t cpu_get_real_ticks(void)
{
	int64_t val;
	asm volatile ("mov %0 = ar.itc" : "=r"(val) :: "memory");
	return val;
}

bellard's avatar
bellard committed
548 549 550 551 552 553 554 555 556
#elif defined(__s390__)

int64_t cpu_get_real_ticks(void)
{
    int64_t val;
    asm volatile("stck 0(%1)" : "=m" (val) : "a" (&val) : "cc");
    return val;
}

557 558 559 560
#else
#error unsupported CPU
#endif

561
static int64_t cpu_ticks_prev;
562
static int64_t cpu_ticks_offset;
563
static int cpu_ticks_enabled;
564

565
static inline int64_t cpu_get_ticks(void)
566
{
567 568 569
    if (!cpu_ticks_enabled) {
        return cpu_ticks_offset;
    } else {
570 571 572 573 574 575 576 577 578
        int64_t ticks;
        ticks = cpu_get_real_ticks();
        if (cpu_ticks_prev > ticks) {
            /* Note: non increasing ticks may happen if the host uses
               software suspend */
            cpu_ticks_offset += cpu_ticks_prev - ticks;
        }
        cpu_ticks_prev = ticks;
        return ticks + cpu_ticks_offset;
579
    }
580 581 582 583 584
}

/* enable cpu_get_ticks() */
void cpu_enable_ticks(void)
{
585 586 587 588
    if (!cpu_ticks_enabled) {
        cpu_ticks_offset -= cpu_get_real_ticks();
        cpu_ticks_enabled = 1;
    }
589 590 591 592 593 594
}

/* disable cpu_get_ticks() : the clock is stopped. You must not call
   cpu_get_ticks() after that.  */
void cpu_disable_ticks(void)
{
595 596 597 598
    if (cpu_ticks_enabled) {
        cpu_ticks_offset = cpu_get_ticks();
        cpu_ticks_enabled = 0;
    }
599 600
}

bellard's avatar
bellard committed
601
static int64_t get_clock(void)
602
{
bellard's avatar
bellard committed
603 604 605 606 607
#ifdef _WIN32
    struct _timeb tb;
    _ftime(&tb);
    return ((int64_t)tb.time * 1000 + (int64_t)tb.millitm) * 1000;
#else
608 609 610
    struct timeval tv;
    gettimeofday(&tv, NULL);
    return tv.tv_sec * 1000000LL + tv.tv_usec;
bellard's avatar
bellard committed
611
#endif
612 613
}

614 615 616 617 618
void cpu_calibrate_ticks(void)
{
    int64_t usec, ticks;

    usec = get_clock();
619
    ticks = cpu_get_real_ticks();
bellard's avatar
bellard committed
620 621 622
#ifdef _WIN32
    Sleep(50);
#else
623
    usleep(50 * 1000);
bellard's avatar
bellard committed
624
#endif
625
    usec = get_clock() - usec;
626
    ticks = cpu_get_real_ticks() - ticks;
627 628 629
    ticks_per_sec = (ticks * 1000000LL + (usec >> 1)) / usec;
}

630
/* compute with 96 bit intermediate result: (a*b)/c */
bellard's avatar
bellard committed
631
uint64_t muldiv64(uint64_t a, uint32_t b, uint32_t c)
632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653
{
    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;
}

654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673
#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
674 675 676
#ifdef _WIN32
static MMRESULT timerID;
#else
677 678
/* frequency of the times() clock tick */
static int timer_freq;
bellard's avatar
bellard committed
679
#endif
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 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 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

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;
775
        if (!ts || ts->expire_time > current_time)
776 777 778 779 780 781 782 783 784 785 786 787 788 789
            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
790 791 792
#ifdef _WIN32
        return GetTickCount();
#else
bellard's avatar
bellard committed
793 794 795 796 797 798 799 800 801 802 803
        {
            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;
            }
804
        }
bellard's avatar
bellard committed
805
#endif
806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857
    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
858 859 860 861
#ifdef _WIN32
void CALLBACK host_alarm_handler(UINT uTimerID, UINT uMsg, 
                                 DWORD_PTR dwUser, DWORD_PTR dw1, DWORD_PTR dw2)
#else
862
static void host_alarm_handler(int host_signum)
bellard's avatar
bellard committed
863
#endif
864
{
865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893
#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
894 895 896 897
    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))) {
bellard's avatar
bellard committed
898 899 900 901
        CPUState *env = cpu_single_env;
        if (env) {
            /* stop the currently executing cpu because a timer occured */
            cpu_interrupt(env, CPU_INTERRUPT_EXIT);
902
#ifdef USE_KQEMU
bellard's avatar
bellard committed
903 904 905
            if (env->kqemu_enabled) {
                kqemu_cpu_interrupt(env);
            }
906
#endif
bellard's avatar
bellard committed
907
        }
908 909 910
    }
}

911 912
#ifndef _WIN32

bellard's avatar
BSD fix  
bellard committed
913 914
#if defined(__linux__)

915 916 917
#define RTC_FREQ 1024

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

919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938
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
939 940 941 942 943 944 945 946 947 948
#else

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

#endif /* !defined(__linux__) */

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

950 951 952 953 954
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
955 956 957
#ifdef _WIN32
    {
        int count=0;
958
        timerID = timeSetEvent(1,     // interval (ms)
bellard's avatar
bellard committed
959 960 961 962
                               0,     // resolution
                               host_alarm_handler, // function
                               (DWORD)&count,  // user parameter
                               TIME_PERIODIC | TIME_CALLBACK_FUNCTION);
bellard's avatar
bellard committed
963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978
 	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);
979
       act.sa_flags = 0;
980
#if defined (TARGET_I386) && defined(USE_CODE_COPY)
bellard's avatar
bellard committed
981 982 983 984
        act.sa_flags |= SA_ONSTACK;
#endif
        act.sa_handler = host_alarm_handler;
        sigaction(SIGALRM, &act, NULL);
985

bellard's avatar
bellard committed
986
        itv.it_interval.tv_sec = 0;
bellard's avatar
bellard committed
987
        itv.it_interval.tv_usec = 999; /* for i386 kernel 2.6 to get 1 ms */
bellard's avatar
bellard committed
988 989 990 991 992 993
        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);
994

995
#if defined(__linux__)
996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007
        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
1008
            sigaction(SIGIO, &act, NULL);
1009 1010
            fcntl(rtc_fd, F_SETFL, O_ASYNC);
            fcntl(rtc_fd, F_SETOWN, getpid());
1011 1012 1013
        } else 
#endif /* defined(__linux__) */
        {
1014 1015 1016 1017
        use_itimer:
            pit_min_timer_count = ((uint64_t)itv.it_interval.tv_usec * 
                                   PIT_FREQ) / 1000000;
        }
bellard's avatar
bellard committed
1018
    }
1019 1020 1021
#endif
}

bellard's avatar
bellard committed
1022 1023 1024 1025 1026 1027 1028
void quit_timers(void)
{
#ifdef _WIN32
    timeKillEvent(timerID);
#endif
}

1029
/***********************************************************/
bellard's avatar
bellard committed
1030
/* character device */
1031

bellard's avatar
bellard committed
1032 1033 1034 1035
int qemu_chr_write(CharDriverState *s, const uint8_t *buf, int len)
{
    return s->chr_write(s, buf, len);
}
bellard's avatar
bellard committed
1036

bellard's avatar
bellard committed
1037
int qemu_chr_ioctl(CharDriverState *s, int cmd, void *arg)
bellard's avatar
bellard committed
1038
{
bellard's avatar
bellard committed
1039 1040 1041
    if (!s->chr_ioctl)
        return -ENOTSUP;
    return s->chr_ioctl(s, cmd, arg);
bellard's avatar
bellard committed
1042 1043
}

bellard's avatar
bellard committed
1044
void qemu_chr_printf(CharDriverState *s, const char *fmt, ...)
bellard's avatar
bellard committed
1045
{
bellard's avatar
bellard committed
1046 1047 1048 1049 1050 1051
    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
1052 1053
}

bellard's avatar
bellard committed
1054 1055 1056 1057 1058 1059
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
1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070
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
1071

bellard's avatar
bellard committed
1072
static int null_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
1073
{
bellard's avatar
bellard committed