vl.c 123 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 51
#include <linux/if.h>
#include <linux/if_tun.h>
bellard's avatar
bellard committed
52 53
#include <pty.h>
#include <malloc.h>
54
#include <linux/rtc.h>
bellard's avatar
bellard committed
55
#include <linux/ppdev.h>
bellard's avatar
bellard committed
56
#endif
bellard's avatar
bellard committed
57
#endif
bellard's avatar
bellard committed
58

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

bellard's avatar
bellard committed
63
#ifdef _WIN32
bellard's avatar
bellard committed
64
#include <malloc.h>
bellard's avatar
bellard committed
65 66 67 68 69 70
#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
71
#ifdef CONFIG_SDL
bellard's avatar
bellard committed
72
#ifdef __APPLE__
73
#include <SDL/SDL.h>
bellard's avatar
bellard committed
74
#endif
bellard's avatar
bellard committed
75
#endif /* CONFIG_SDL */
76

77 78 79 80 81
#ifdef CONFIG_COCOA
#undef main
#define main qemu_main
#endif /* CONFIG_COCOA */

82
#include "disas.h"
bellard's avatar
bellard committed
83

84
#include "exec-all.h"
85

86
#define DEFAULT_NETWORK_SCRIPT "/etc/qemu-ifup"
bellard's avatar
bellard committed
87

88
//#define DEBUG_UNUSED_IOPORT
89
//#define DEBUG_IOPORT
90

91
#if !defined(CONFIG_SOFTMMU)
bellard's avatar
bellard committed
92
#define PHYS_RAM_MAX_SIZE (256 * 1024 * 1024)
93 94 95
#else
#define PHYS_RAM_MAX_SIZE (2047 * 1024 * 1024)
#endif
bellard's avatar
bellard committed
96

bellard's avatar
bellard committed
97 98 99
#ifdef TARGET_PPC
#define DEFAULT_RAM_SIZE 144
#else
100
#define DEFAULT_RAM_SIZE 128
bellard's avatar
bellard committed
101
#endif
102 103
/* in ms */
#define GUI_REFRESH_INTERVAL 30
104

105 106
/* XXX: use a two level table to limit memory usage */
#define MAX_IOPORTS 65536
107

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

bellard's avatar
bellard committed
279 280 281 282 283 284 285 286 287 288 289 290 291 292 293
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
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 322
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
323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338
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
339 340 341 342 343 344 345 346 347 348 349 350
/* 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;
}

351 352 353 354
/* return the size or -1 if error */
int load_image(const char *filename, uint8_t *addr)
{
    int fd, size;
bellard's avatar
bellard committed
355
    fd = open(filename, O_RDONLY | O_BINARY);
356 357 358 359 360 361 362 363 364 365 366 367
    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;
}

368
void cpu_outb(CPUState *env, int addr, int val)
369
{
370 371 372 373
#ifdef DEBUG_IOPORT
    if (loglevel & CPU_LOG_IOPORT)
        fprintf(logfile, "outb: %04x %02x\n", addr, val);
#endif    
374
    ioport_write_table[0][addr](ioport_opaque[addr], addr, val);
375 376
}

377
void cpu_outw(CPUState *env, int addr, int val)
378
{
379 380 381 382
#ifdef DEBUG_IOPORT
    if (loglevel & CPU_LOG_IOPORT)
        fprintf(logfile, "outw: %04x %04x\n", addr, val);
#endif    
383
    ioport_write_table[1][addr](ioport_opaque[addr], addr, val);
384 385
}

386
void cpu_outl(CPUState *env, int addr, int val)
387
{
388 389 390 391
#ifdef DEBUG_IOPORT
    if (loglevel & CPU_LOG_IOPORT)
        fprintf(logfile, "outl: %04x %08x\n", addr, val);
#endif
392
    ioport_write_table[2][addr](ioport_opaque[addr], addr, val);
393 394
}

395
int cpu_inb(CPUState *env, int addr)
396
{
397 398 399 400 401 402 403
    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;
404 405
}

406
int cpu_inw(CPUState *env, int addr)
407
{
408 409 410 411 412 413 414
    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;
415 416
}

417
int cpu_inl(CPUState *env, int addr)
418
{
419 420 421 422 423 424 425
    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;
426 427 428 429 430 431
}

/***********************************************************/
void hw_error(const char *fmt, ...)
{
    va_list ap;
bellard's avatar
bellard committed
432
    CPUState *env;
433 434 435 436 437

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

bellard's avatar
bellard committed
450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484
/***********************************************************/
/* 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);
    }
}

485 486 487
/***********************************************************/
/* timers */

488 489 490
#if defined(__powerpc__)

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

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

bellard's avatar
bellard committed
525 526 527 528 529 530 531 532 533 534 535 536 537
#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
538 539 540 541 542 543 544 545 546
#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
547 548 549 550 551 552 553 554 555
#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;
}

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

static int64_t cpu_ticks_offset;
561
static int cpu_ticks_enabled;
562

563
static inline int64_t cpu_get_ticks(void)
564
{
565 566 567 568 569
    if (!cpu_ticks_enabled) {
        return cpu_ticks_offset;
    } else {
        return cpu_get_real_ticks() + cpu_ticks_offset;
    }
570 571 572 573 574
}

/* enable cpu_get_ticks() */
void cpu_enable_ticks(void)
{
575 576 577 578
    if (!cpu_ticks_enabled) {
        cpu_ticks_offset -= cpu_get_real_ticks();
        cpu_ticks_enabled = 1;
    }
579 580 581 582 583 584
}

/* disable cpu_get_ticks() : the clock is stopped. You must not call
   cpu_get_ticks() after that.  */
void cpu_disable_ticks(void)
{
585 586 587 588
    if (cpu_ticks_enabled) {
        cpu_ticks_offset = cpu_get_ticks();
        cpu_ticks_enabled = 0;
    }
589 590
}

bellard's avatar
bellard committed
591
static int64_t get_clock(void)
592
{
bellard's avatar
bellard committed
593 594 595 596 597
#ifdef _WIN32
    struct _timeb tb;
    _ftime(&tb);
    return ((int64_t)tb.time * 1000 + (int64_t)tb.millitm) * 1000;
#else
598 599 600
    struct timeval tv;
    gettimeofday(&tv, NULL);
    return tv.tv_sec * 1000000LL + tv.tv_usec;
bellard's avatar
bellard committed
601
#endif
602 603
}

604 605 606 607 608
void cpu_calibrate_ticks(void)
{
    int64_t usec, ticks;

    usec = get_clock();
609
    ticks = cpu_get_real_ticks();
bellard's avatar
bellard committed
610 611 612
#ifdef _WIN32
    Sleep(50);
#else
613
    usleep(50 * 1000);
bellard's avatar
bellard committed
614
#endif
615
    usec = get_clock() - usec;
616
    ticks = cpu_get_real_ticks() - ticks;
617 618 619
    ticks_per_sec = (ticks * 1000000LL + (usec >> 1)) / usec;
}

620
/* compute with 96 bit intermediate result: (a*b)/c */
bellard's avatar
bellard committed
621
uint64_t muldiv64(uint64_t a, uint32_t b, uint32_t c)
622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643
{
    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;
}

644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663
#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
664 665 666
#ifdef _WIN32
static MMRESULT timerID;
#else
667 668
/* frequency of the times() clock tick */
static int timer_freq;
bellard's avatar
bellard committed
669
#endif
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 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

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;
765
        if (!ts || ts->expire_time > current_time)
766 767 768 769 770 771 772 773 774 775 776 777 778 779
            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
780 781 782
#ifdef _WIN32
        return GetTickCount();
#else
bellard's avatar
bellard committed
783 784 785 786 787 788 789 790 791 792 793
        {
            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;
            }
794
        }
bellard's avatar
bellard committed
795
#endif
796 797 798 799 800 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 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847
    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
848 849 850 851
#ifdef _WIN32
void CALLBACK host_alarm_handler(UINT uTimerID, UINT uMsg, 
                                 DWORD_PTR dwUser, DWORD_PTR dw1, DWORD_PTR dw2)
#else
852
static void host_alarm_handler(int host_signum)
bellard's avatar
bellard committed
853
#endif
854
{
855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883
#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
884 885 886 887
    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
888 889 890 891
        CPUState *env = cpu_single_env;
        if (env) {
            /* stop the currently executing cpu because a timer occured */
            cpu_interrupt(env, CPU_INTERRUPT_EXIT);
892
#ifdef USE_KQEMU
bellard's avatar
bellard committed
893 894 895
            if (env->kqemu_enabled) {
                kqemu_cpu_interrupt(env);
            }
896
#endif
bellard's avatar
bellard committed
897
        }
898 899 900
    }
}

901 902
#ifndef _WIN32

bellard's avatar
BSD fix  
bellard committed
903 904
#if defined(__linux__)

905 906 907
#define RTC_FREQ 1024

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

909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928
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
929 930 931 932 933 934 935 936 937 938
#else

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

#endif /* !defined(__linux__) */

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

940 941 942 943 944
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
945 946 947
#ifdef _WIN32
    {
        int count=0;
948
        timerID = timeSetEvent(1,     // interval (ms)
bellard's avatar
bellard committed
949 950 951 952
                               0,     // resolution
                               host_alarm_handler, // function
                               (DWORD)&count,  // user parameter
                               TIME_PERIODIC | TIME_CALLBACK_FUNCTION);
bellard's avatar
bellard committed
953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968
 	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);
969
       act.sa_flags = 0;
970
#if defined (TARGET_I386) && defined(USE_CODE_COPY)
bellard's avatar
bellard committed
971 972 973 974
        act.sa_flags |= SA_ONSTACK;
#endif
        act.sa_handler = host_alarm_handler;
        sigaction(SIGALRM, &act, NULL);
975

bellard's avatar
bellard committed
976
        itv.it_interval.tv_sec = 0;
bellard's avatar
bellard committed
977
        itv.it_interval.tv_usec = 999; /* for i386 kernel 2.6 to get 1 ms */
bellard's avatar
bellard committed
978 979 980 981 982 983
        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);
984

985
#if defined(__linux__)
986 987 988 989 990 991 992 993 994 995 996 997
        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
998
            sigaction(SIGIO, &act, NULL);
999 1000
            fcntl(rtc_fd, F_SETFL, O_ASYNC);
            fcntl(rtc_fd, F_SETOWN, getpid());
1001 1002 1003
        } else 
#endif /* defined(__linux__) */
        {
1004 1005 1006 1007
        use_itimer:
            pit_min_timer_count = ((uint64_t)itv.it_interval.tv_usec * 
                                   PIT_FREQ) / 1000000;
        }
bellard's avatar
bellard committed
1008
    }
1009 1010 1011
#endif
}

bellard's avatar
bellard committed
1012 1013 1014 1015 1016 1017 1018
void quit_timers(void)
{
#ifdef _WIN32
    timeKillEvent(timerID);
#endif
}

1019
/***********************************************************/
bellard's avatar
bellard committed
1020
/* character device */
1021

bellard's avatar
bellard committed
1022 1023 1024 1025
int qemu_chr_write(CharDriverState *s, const uint8_t *buf, int len)
{
    return s->chr_write(s, buf, len);
}
bellard's avatar
bellard committed
1026

bellard's avatar
bellard committed
1027
int qemu_chr_ioctl(CharDriverState *s, int cmd, void *arg)
bellard's avatar
bellard committed
1028
{
bellard's avatar
bellard committed
1029 1030 1031
    if (!s->chr_ioctl)
        return -ENOTSUP;
    return s->chr_ioctl(s, cmd, arg);
bellard's avatar
bellard committed
1032 1033
}

bellard's avatar
bellard committed
1034
void qemu_chr_printf(CharDriverState *s, const char *fmt, ...)
bellard's avatar
bellard committed
1035
{
bellard's avatar
bellard committed
1036 1037 1038 1039 1040 1041
    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
1042 1043
}

bellard's avatar
bellard committed
1044 1045 1046 1047 1048 1049
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
1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060
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
1061

bellard's avatar
bellard committed
1062
static int null_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
1063
{
bellard's avatar
bellard committed
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
    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;
    IOCanRWHandler *fd_can_read; 
    IOReadHandler *fd_read;
    void *fd_opaque;
bellard's avatar
bellard committed
1092
    int max_size;
bellard's avatar
bellard committed
1093 1094 1095 1096 1097 1098 1099
} FDCharDriver;

#define STDIO_MAX_CLIENTS 2

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

bellard's avatar
bellard committed
1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119
static int unix_write(int fd, const uint8_t *buf, int len1)
{
    int ret, len;

    len = len1;
    while (len > 0) {
        ret = write(fd, buf, len);
        if (ret < 0) {
            if (errno != EINTR && errno != EAGAIN)
                return -1;
        } else if (ret == 0) {
            break;
        } else {
            buf += ret;
            len -= ret;
        }
    }
    return len1 - len;
}

bellard's avatar
bellard committed
1120 1121 1122
static int fd_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
{
    FDCharDriver *s = chr->opaque;
bellard's avatar
bellard committed
1123
    return unix_write(s->fd_out, buf, len);
bellard's avatar
bellard committed
1124 1125
}

bellard's avatar
bellard committed
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
static int fd_chr_read_poll(void *opaque)
{
    CharDriverState *chr = opaque;
    FDCharDriver *s = chr->opaque;

    s->max_size = s->fd_can_read(s->fd_opaque);
    return s->max_size;
}

static void fd_chr_read(void *opaque)
{
    CharDriverState *chr = opaque;
    FDCharDriver *s = chr->opaque;
    int size, len;
    uint8_t buf[1024];
    
    len = sizeof(buf);
    if (len > s->max_size)
        len = s->max_size;
    if (len == 0)
        return;
    size = read(s->fd_in, buf, len);
    if (size > 0) {
        s->fd_read(s->fd_opaque, buf, size);
    }
}

bellard's avatar
bellard committed
1153 1154 1155 1156 1157 1158
static void fd_chr_add_read_handler(CharDriverState *chr, 
                                    IOCanRWHandler *fd_can_read, 
                                    IOReadHandler *fd_read, void *opaque)
{
    FDCharDriver *s = chr->opaque;

bellard's avatar
bellard committed
1159
    if (s->fd_in >= 0) {
bellard's avatar
bellard committed
1160 1161 1162
        s->fd_can_read = fd_can_read;
        s->fd_read = fd_read;
        s->fd_opaque = opaque;
bellard's avatar
bellard committed
1163 1164
        if (nographic && s->fd_in == 0) {
        } else {
bellard's avatar
bellard committed
1165 1166
            qemu_set_fd_handler2(s->fd_in, fd_chr_read_poll, 
                                 fd_chr_read, NULL, chr);
bellard's avatar
bellard committed
1167
        }
bellard's avatar
bellard committed
1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192
    }
}

/* 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;
}

bellard's avatar
bellard committed
1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213
CharDriverState *qemu_chr_open_file_out(const char *file_out)
{
    int fd_out;

    fd_out = open(file_out, O_WRONLY | O_TRUNC | O_CREAT | O_BINARY);
    if (fd_out < 0)
        return NULL;
    return qemu_chr_open_fd(-1, fd_out);
}

CharDriverState *qemu_chr_open_pipe(const char *filename)
{
    int fd;

    fd = open(filename, O_RDWR | O_BINARY);
    if (fd < 0)
        return NULL;
    return qemu_chr_open_fd(fd, fd);
}


bellard's avatar
bellard committed
1214 1215 1216 1217 1218
/* for STDIO, we handle the case where several clients use it
   (nographic mode) */

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

bellard's avatar
bellard committed
1219 1220
#define TERM_FIFO_MAX_SIZE 1

bellard's avatar
bellard committed
1221
static int term_got_escape, client_index;
bellard's avatar
bellard committed
1222 1223
static uint8_t term_fifo[TERM_FIFO_MAX_SIZE];
int term_fifo_size;
bellard's avatar
bellard committed
1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291

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;
bellard's avatar
bellard committed
1292 1293
            if (s->fd_can_read(s->fd_opaque) > 0) {
                buf[0] = ch;
bellard's avatar
bellard committed
1294
                s->fd_read(s->fd_opaque, buf, 1);
bellard's avatar
bellard committed
1295 1296 1297
            } else if (term_fifo_size == 0) {
                term_fifo[term_fifo_size++] = ch;
            }
1298
        }
1299 1300 1301
    }
}

bellard's avatar
bellard committed
1302
static int stdio_read_poll(void *opaque)
bellard's avatar
bellard committed
1303
{
bellard's avatar
bellard committed
1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322
    CharDriverState *chr;
    FDCharDriver *s;

    if (client_index < stdio_nb_clients) {
        chr = stdio_clients[client_index];
        s = chr->opaque;
        /* try to flush the queue if needed */
        if (term_fifo_size != 0 && s->fd_can_read(s->fd_opaque) > 0) {
            s->fd_read(s->fd_opaque, term_fifo, 1);
            term_fifo_size = 0;
        }
        /* see if we can absorb more chars */
        if (term_fifo_size == 0)
            return 1;
        else
            return 0;
    } else {
        return 1;
    }
bellard's avatar
bellard committed
1323 1324
}

bellard's avatar
bellard committed
1325
static void stdio_read(void *opaque)
bellard's avatar
bellard committed
1326
{
bellard's avatar
bellard committed
1327 1328 1329 1330 1331 1332
    int size;
    uint8_t buf[1];
    
    size = read(0, buf, 1);
    if (size > 0)
        stdio_received_byte(buf[0]);
bellard's avatar
bellard committed
1333 1334
}

1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371
/* 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
1372 1373 1374 1375 1376 1377 1378 1379 1380
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)
bellard's avatar
bellard committed
1381
            qemu_set_fd_handler2(0, stdio_read_poll, stdio_read, NULL, NULL);
bellard's avatar
bellard committed
1382 1383 1384 1385 1386 1387 1388
        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;
1389 1390 1391 1392
    if (stdio_nb_clients == 1) {
        /* set the terminal in raw mode */
        term_init();
    }
bellard's avatar
bellard committed
1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408
    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);
}
bellard's avatar
bellard committed
1409 1410 1411 1412 1413 1414 1415

static void tty_serial_init(int fd, int speed, 
                            int parity, int data_bits, int stop_bits)
{
    struct termios tty;
    speed_t spd;

bellard's avatar
bellard committed
1416 1417 1418 1419 1420
#if 0
    printf("tty_serial_init: speed=%d parity=%c data=%d stop=%d\n", 
           speed, parity, data_bits, stop_bits);
#endif
    tcgetattr (fd, &tty);
bellard's avatar
bellard committed
1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499

    switch(speed) {
    case 50:
        spd = B50;
        break;
    case 75:
        spd = B75;
        break;
    case 300:
        spd = B300;
        break;
    case 600:
        spd = B600;
        break;
    case 1200:
        spd = B1200;
        break;
    case 2400:
        spd = B2400;
        break;
    case 4800:
        spd = B4800;
        break;
    case 9600:
        spd = B9600;
        break;
    case 19200:
        spd = B19200;
        break;
    case 38400:
        spd = B38400;
        break;
    case 57600:
        spd = B57600;
        break;
    default:
    case 115200:
        spd = B115200;
        break;
    }

    cfsetispeed(&tty, spd);
    cfsetospeed(&tty, spd);

    tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
                          |INLCR|IGNCR|ICRNL|IXON);
    tty.c_oflag |= OPOST;
    tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN|ISIG);
    tty.c_cflag &= ~(CSIZE|PARENB|PARODD|CRTSCTS);
    switch(data_bits) {
    default:
    case 8:
        tty.c_cflag |= CS8;
        break;
    case 7:
        tty.c_cflag |= CS7;
        break;
    case 6:
        tty.c_cflag |= CS6;
        break;
    case 5:
        tty.c_cflag |= CS5;
        break;
    }
    switch(parity) {
    default:
    case 'N':
        break;
    case 'E':
        tty.c_cflag |= PARENB;
        break;
    case 'O':
        tty.c_cflag |= PARENB | PARODD;
        break;
    }
    
    tcsetattr (fd, TCSANOW, &tty);
}

bellard's avatar
bellard committed
1500
static int tty_serial_ioctl(CharDriverState *chr, int cmd, void *arg)
bellard's avatar
bellard committed
1501 1502
{
    FDCharDriver *s = chr->opaque;
bellard's avatar
bellard committed
1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522
    
    switch(cmd) {
    case CHR_IOCTL_SERIAL_SET_PARAMS:
        {
            QEMUSerialSetParams *ssp = arg;
            tty_serial_init(s->fd_in, ssp->speed, ssp->parity, 
                            ssp->data_bits, ssp->stop_bits);
        }
        break;
    case CHR_IOCTL_SERIAL_SET_BREAK:
        {
            int enable = *(int *)arg;
            if (enable)
                tcsendbreak(s->fd_in, 1);
        }
        break;
    default:
        return -ENOTSUP;
    }
    return 0;
bellard's avatar
bellard committed
1523 1524 1525 1526 1527 1528 1529
}

CharDriverState *qemu_chr_open_tty(const char *filename)
{
    CharDriverState *chr;
    int fd;

bellard's avatar
bellard committed
1530
    fd = open(filename, O_RDWR | O_NONBLOCK);
bellard's avatar
bellard committed
1531 1532 1533 1534 1535 1536 1537
    if (fd < 0)
        return NULL;
    fcntl(fd, F_SETFL, O_NONBLOCK);
    tty_serial_init(fd, 115200, 'N', 8, 1);
    chr = qemu_chr_open_fd(fd, fd);
    if (!chr)
        return NULL;
bellard's avatar
bellard committed
1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585