vl.c

   1 /*
   2  * QEMU System Emulator
   3  *
   4  * Copyright (c) 2003-2007 Fabrice Bellard
   5  *
   6  * Permission is hereby granted, free of charge, to any person obtaining a copy
   7  * of this software and associated documentation files (the "Software"), to deal
   8  * in the Software without restriction, including without limitation the rights
   9  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  10  * copies of the Software, and to permit persons to whom the Software is
  11  * furnished to do so, subject to the following conditions:
  12  *
  13  * The above copyright notice and this permission notice shall be included in
  14  * all copies or substantial portions of the Software.
  15  *
  16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  21  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  22  * THE SOFTWARE.
  23  */
  24 #include "vl.h"
  25
  26 #include <unistd.h>
  27 #include <fcntl.h>
  28 #include <signal.h>
  29 #include <time.h>
  30 #include <errno.h>
  31 #include <sys/time.h>
  32 #include <zlib.h>
  33
  34 #ifndef _WIN32
  35 #include <sys/times.h>
  36 #include <sys/wait.h>
  37 #include <termios.h>
  38 #include <sys/poll.h>
  39 #include <sys/mman.h>
  40 #include <sys/ioctl.h>
  41 #include <sys/socket.h>
  42 #include <netinet/in.h>
  43 #include <dirent.h>
  44 #include <netdb.h>
  45 #include <sys/select.h>
  46 #include <arpa/inet.h>
  47 #ifdef _BSD
  48 #include <sys/stat.h>
  49 #ifndef __APPLE__
  50 #include <libutil.h>
  51 #endif
  52 #elif defined (__GLIBC__) && defined (__FreeBSD_kernel__)
  53 #include <freebsd/stdlib.h>
  54 #else
  55 #ifndef __sun__
  56 #include <linux/if.h>
  57 #include <linux/if_tun.h>
  58 #include <pty.h>
  59 #include <malloc.h>
  60 #include <linux/rtc.h>
  61
  62 /* For the benefit of older linux systems which don't supply it,
  63    we use a local copy of hpet.h. */
  64 /* #include <linux/hpet.h> */
  65 #include "hpet.h"
  66
  67 #include <linux/ppdev.h>
  68 #include <linux/parport.h>
  69 #else
  70 #include <sys/stat.h>
  71 #include <sys/ethernet.h>
  72 #include <sys/sockio.h>
  73 #include <netinet/arp.h>
  74 #include <netinet/in.h>
  75 #include <netinet/in_systm.h>
  76 #include <netinet/ip.h>
  77 #include <netinet/ip_icmp.h> // must come after ip.h
  78 #include <netinet/udp.h>
  79 #include <netinet/tcp.h>
  80 #include <net/if.h>
  81 #include <syslog.h>
  82 #include <stropts.h>
  83 #endif
  84 #endif
  85 #else
  86 #include <winsock2.h>
  87 int inet_aton(const char *cp, struct in_addr *ia);
  88 #endif
  89
  90 #if defined(CONFIG_SLIRP)
  91 #include "libslirp.h"
  92 #endif
  93
  94 #ifdef _WIN32
  95 #include <malloc.h>
  96 #include <sys/timeb.h>
  97 #include <windows.h>
  98 #define getopt_long_only getopt_long
  99 #define memalign(align, size) malloc(size)
 100 #endif
 101
 102 #include "qemu_socket.h"
 103
 104 #ifdef CONFIG_SDL
 105 #ifdef __APPLE__
 106 #include <SDL/SDL.h>
 107 #endif
 108 #endif /* CONFIG_SDL */
 109
 110 #ifdef CONFIG_COCOA
 111 #undef main
 112 #define main qemu_main
 113 #endif /* CONFIG_COCOA */
 114
 115 #include "disas.h"
 116
 117 #include "exec-all.h"
 118
 119 #define DEFAULT_NETWORK_SCRIPT "/etc/qemu-ifup"
 120 #ifdef __sun__
 121 #define SMBD_COMMAND "/usr/sfw/sbin/smbd"
 122 #else
 123 #define SMBD_COMMAND "/usr/sbin/smbd"
 124 #endif
 125
 126 //#define DEBUG_UNUSED_IOPORT
 127 //#define DEBUG_IOPORT
 128
 129 #define PHYS_RAM_MAX_SIZE (2047 * 1024 * 1024)
 130
 131 #ifdef TARGET_PPC
 132 #define DEFAULT_RAM_SIZE 144
 133 #else
 134 #define DEFAULT_RAM_SIZE 128
 135 #endif
 136 /* in ms */
 137 #define GUI_REFRESH_INTERVAL 30
 138
 139 /* Max number of USB devices that can be specified on the commandline.  */
 140 #define MAX_USB_CMDLINE 8
 141
 142 /* XXX: use a two level table to limit memory usage */
 143 #define MAX_IOPORTS 65536
 144
 145 const char *bios_dir = CONFIG_QEMU_SHAREDIR;
 146 const char *bios_name = NULL;
 147 char phys_ram_file[1024];
 148 void *ioport_opaque[MAX_IOPORTS];
 149 IOPortReadFunc *ioport_read_table[3][MAX_IOPORTS];
 150 IOPortWriteFunc *ioport_write_table[3][MAX_IOPORTS];
 151 /* Note: bs_table[MAX_DISKS] is a dummy block driver if none available
 152    to store the VM snapshots */
 153 BlockDriverState *bs_table[MAX_DISKS + 1], *fd_table[MAX_FD];
 154 BlockDriverState *pflash_table[MAX_PFLASH];
 155 BlockDriverState *sd_bdrv;
 156 BlockDriverState *mtd_bdrv;
 157 /* point to the block driver where the snapshots are managed */
 158 BlockDriverState *bs_snapshots;
 159 int vga_ram_size;
 160 static DisplayState display_state;
 161 int nographic;
 162 const char* keyboard_layout = NULL;
 163 int64_t ticks_per_sec;
 164 int boot_device = 'c';
 165 int ram_size;
 166 int pit_min_timer_count = 0;
 167 int nb_nics;
 168 NICInfo nd_table[MAX_NICS];
 169 int vm_running;
 170 int rtc_utc = 1;
 171 int cirrus_vga_enabled = 1;
 172 int vmsvga_enabled = 0;
 173 #ifdef TARGET_SPARC
 174 int graphic_width = 1024;
 175 int graphic_height = 768;
 176 int graphic_depth = 8;
 177 #else
 178 int graphic_width = 800;
 179 int graphic_height = 600;
 180 int graphic_depth = 15;
 181 #endif
 182 int full_screen = 0;
 183 int no_frame = 0;
 184 int no_quit = 0;
 185 CharDriverState *serial_hds[MAX_SERIAL_PORTS];
 186 CharDriverState *parallel_hds[MAX_PARALLEL_PORTS];
 187 #ifdef TARGET_I386
 188 int win2k_install_hack = 0;
 189 #endif
 190 int usb_enabled = 0;
 191 static VLANState *first_vlan;
 192 int smp_cpus = 1;
 193 const char *vnc_display;
 194 #if defined(TARGET_SPARC)
 195 #define MAX_CPUS 16
 196 #elif defined(TARGET_I386)
 197 #define MAX_CPUS 255
 198 #else
 199 #define MAX_CPUS 1
 200 #endif
 201 int acpi_enabled = 1;
 202 int fd_bootchk = 1;
 203 int no_reboot = 0;
 204 int cursor_hide = 1;
 205 int graphic_rotate = 0;
 206 int daemonize = 0;
 207 const char *option_rom[MAX_OPTION_ROMS];
 208 int nb_option_roms;
 209 int semihosting_enabled = 0;
 210 int autostart = 1;
 211 #ifdef TARGET_ARM
 212 int old_param = 0;
 213 #endif
 214 const char *qemu_name;
 215 int alt_grab = 0;
 216 #ifdef TARGET_SPARC
 217 unsigned int nb_prom_envs = 0;
 218 const char *prom_envs[MAX_PROM_ENVS];
 219 #endif
 220
 221 #define TFR(expr) do { if ((expr) != -1) break; } while (errno == EINTR)
 222
 223 /***********************************************************/
 224 /* x86 ISA bus support */
 225
 226 target_phys_addr_t isa_mem_base = 0;
 227 PicState2 *isa_pic;
 228
 229 uint32_t default_ioport_readb(void *opaque, uint32_t address)
 230 {
 231 #ifdef DEBUG_UNUSED_IOPORT
 232     fprintf(stderr, "unused inb: port=0x%04x\n", address);
 233 #endif
 234     return 0xff;
 235 }
 236
 237 void default_ioport_writeb(void *opaque, uint32_t address, uint32_t data)
 238 {
 239 #ifdef DEBUG_UNUSED_IOPORT
 240     fprintf(stderr, "unused outb: port=0x%04x data=0x%02x\n", address, data);
 241 #endif
 242 }
 243
 244 /* default is to make two byte accesses */
 245 uint32_t default_ioport_readw(void *opaque, uint32_t address)
 246 {
 247     uint32_t data;
 248     data = ioport_read_table[0][address](ioport_opaque[address], address);
 249     address = (address + 1) & (MAX_IOPORTS - 1);
 250     data |= ioport_read_table[0][address](ioport_opaque[address], address) << 8;
 251     return data;
 252 }
 253
 254 void default_ioport_writew(void *opaque, uint32_t address, uint32_t data)
 255 {
 256     ioport_write_table[0][address](ioport_opaque[address], address, data & 0xff);
 257     address = (address + 1) & (MAX_IOPORTS - 1);
 258     ioport_write_table[0][address](ioport_opaque[address], address, (data >> 8) & 0xff);
 259 }
 260
 261 uint32_t default_ioport_readl(void *opaque, uint32_t address)
 262 {
 263 #ifdef DEBUG_UNUSED_IOPORT
 264     fprintf(stderr, "unused inl: port=0x%04x\n", address);
 265 #endif
 266     return 0xffffffff;
 267 }
 268
 269 void default_ioport_writel(void *opaque, uint32_t address, uint32_t data)
 270 {
 271 #ifdef DEBUG_UNUSED_IOPORT
 272     fprintf(stderr, "unused outl: port=0x%04x data=0x%02x\n", address, data);
 273 #endif
 274 }
 275
 276 void init_ioports(void)
 277 {
 278     int i;
 279
 280     for(i = 0; i < MAX_IOPORTS; i++) {
 281         ioport_read_table[0][i] = default_ioport_readb;
 282         ioport_write_table[0][i] = default_ioport_writeb;
 283         ioport_read_table[1][i] = default_ioport_readw;
 284         ioport_write_table[1][i] = default_ioport_writew;
 285         ioport_read_table[2][i] = default_ioport_readl;
 286         ioport_write_table[2][i] = default_ioport_writel;
 287     }
 288 }
 289
 290 /* size is the word size in byte */
 291 int register_ioport_read(int start, int length, int size,
 292                          IOPortReadFunc *func, void *opaque)
 293 {
 294     int i, bsize;
 295
 296     if (size == 1) {
 297         bsize = 0;
 298     } else if (size == 2) {
 299         bsize = 1;
 300     } else if (size == 4) {
 301         bsize = 2;
 302     } else {
 303         hw_error("register_ioport_read: invalid size");
 304         return -1;
 305     }
 306     for(i = start; i < start + length; i += size) {
 307         ioport_read_table[bsize][i] = func;
 308         if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque)
 309             hw_error("register_ioport_read: invalid opaque");
 310         ioport_opaque[i] = opaque;
 311     }
 312     return 0;
 313 }
 314
 315 /* size is the word size in byte */
 316 int register_ioport_write(int start, int length, int size,
 317                           IOPortWriteFunc *func, void *opaque)
 318 {
 319     int i, bsize;
 320
 321     if (size == 1) {
 322         bsize = 0;
 323     } else if (size == 2) {
 324         bsize = 1;
 325     } else if (size == 4) {
 326         bsize = 2;
 327     } else {
 328         hw_error("register_ioport_write: invalid size");
 329         return -1;
 330     }
 331     for(i = start; i < start + length; i += size) {
 332         ioport_write_table[bsize][i] = func;
 333         if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque)
 334             hw_error("register_ioport_write: invalid opaque");
 335         ioport_opaque[i] = opaque;
 336     }
 337     return 0;
 338 }
 339
 340 void isa_unassign_ioport(int start, int length)
 341 {
 342     int i;
 343
 344     for(i = start; i < start + length; i++) {
 345         ioport_read_table[0][i] = default_ioport_readb;
 346         ioport_read_table[1][i] = default_ioport_readw;
 347         ioport_read_table[2][i] = default_ioport_readl;
 348
 349         ioport_write_table[0][i] = default_ioport_writeb;
 350         ioport_write_table[1][i] = default_ioport_writew;
 351         ioport_write_table[2][i] = default_ioport_writel;
 352     }
 353 }
 354
 355 /***********************************************************/
 356
 357 void cpu_outb(CPUState *env, int addr, int val)
 358 {
 359 #ifdef DEBUG_IOPORT
 360     if (loglevel & CPU_LOG_IOPORT)
 361         fprintf(logfile, "outb: %04x %02x\n", addr, val);
 362 #endif
 363     ioport_write_table[0][addr](ioport_opaque[addr], addr, val);
 364 #ifdef USE_KQEMU
 365     if (env)
 366         env->last_io_time = cpu_get_time_fast();
 367 #endif
 368 }
 369
 370 void cpu_outw(CPUState *env, int addr, int val)
 371 {
 372 #ifdef DEBUG_IOPORT
 373     if (loglevel & CPU_LOG_IOPORT)
 374         fprintf(logfile, "outw: %04x %04x\n", addr, val);
 375 #endif
 376     ioport_write_table[1][addr](ioport_opaque[addr], addr, val);
 377 #ifdef USE_KQEMU
 378     if (env)
 379         env->last_io_time = cpu_get_time_fast();
 380 #endif
 381 }
 382
 383 void cpu_outl(CPUState *env, int addr, int val)
 384 {
 385 #ifdef DEBUG_IOPORT
 386     if (loglevel & CPU_LOG_IOPORT)
 387         fprintf(logfile, "outl: %04x %08x\n", addr, val);
 388 #endif
 389     ioport_write_table[2][addr](ioport_opaque[addr], addr, val);
 390 #ifdef USE_KQEMU
 391     if (env)
 392         env->last_io_time = cpu_get_time_fast();
 393 #endif
 394 }
 395
 396 int cpu_inb(CPUState *env, int addr)
 397 {
 398     int val;
 399     val = ioport_read_table[0][addr](ioport_opaque[addr], addr);
 400 #ifdef DEBUG_IOPORT
 401     if (loglevel & CPU_LOG_IOPORT)
 402         fprintf(logfile, "inb : %04x %02x\n", addr, val);
 403 #endif
 404 #ifdef USE_KQEMU
 405     if (env)
 406         env->last_io_time = cpu_get_time_fast();
 407 #endif
 408     return val;
 409 }
 410
 411 int cpu_inw(CPUState *env, int addr)
 412 {
 413     int val;
 414     val = ioport_read_table[1][addr](ioport_opaque[addr], addr);
 415 #ifdef DEBUG_IOPORT
 416     if (loglevel & CPU_LOG_IOPORT)
 417         fprintf(logfile, "inw : %04x %04x\n", addr, val);
 418 #endif
 419 #ifdef USE_KQEMU
 420     if (env)
 421         env->last_io_time = cpu_get_time_fast();
 422 #endif
 423     return val;
 424 }
 425
 426 int cpu_inl(CPUState *env, int addr)
 427 {
 428     int val;
 429     val = ioport_read_table[2][addr](ioport_opaque[addr], addr);
 430 #ifdef DEBUG_IOPORT
 431     if (loglevel & CPU_LOG_IOPORT)
 432         fprintf(logfile, "inl : %04x %08x\n", addr, val);
 433 #endif
 434 #ifdef USE_KQEMU
 435     if (env)
 436         env->last_io_time = cpu_get_time_fast();
 437 #endif
 438     return val;
 439 }
 440
 441 /***********************************************************/
 442 void hw_error(const char *fmt, ...)
 443 {
 444     va_list ap;
 445     CPUState *env;
 446
 447     va_start(ap, fmt);
 448     fprintf(stderr, "qemu: hardware error: ");
 449     vfprintf(stderr, fmt, ap);
 450     fprintf(stderr, "\n");
 451     for(env = first_cpu; env != NULL; env = env->next_cpu) {
 452         fprintf(stderr, "CPU #%d:\n", env->cpu_index);
 453 #ifdef TARGET_I386
 454         cpu_dump_state(env, stderr, fprintf, X86_DUMP_FPU);
 455 #else
 456         cpu_dump_state(env, stderr, fprintf, 0);
 457 #endif
 458     }
 459     va_end(ap);
 460     abort();
 461 }
 462
 463 /***********************************************************/
 464 /* keyboard/mouse */
 465
 466 static QEMUPutKBDEvent *qemu_put_kbd_event;
 467 static void *qemu_put_kbd_event_opaque;
 468 static QEMUPutMouseEntry *qemu_put_mouse_event_head;
 469 static QEMUPutMouseEntry *qemu_put_mouse_event_current;
 470
 471 void qemu_add_kbd_event_handler(QEMUPutKBDEvent *func, void *opaque)
 472 {
 473     qemu_put_kbd_event_opaque = opaque;
 474     qemu_put_kbd_event = func;
 475 }
 476
 477 QEMUPutMouseEntry *qemu_add_mouse_event_handler(QEMUPutMouseEvent *func,
 478                                                 void *opaque, int absolute,
 479                                                 const char *name)
 480 {
 481     QEMUPutMouseEntry *s, *cursor;
 482
 483     s = qemu_mallocz(sizeof(QEMUPutMouseEntry));
 484     if (!s)
 485         return NULL;
 486
 487     s->qemu_put_mouse_event = func;
 488     s->qemu_put_mouse_event_opaque = opaque;
 489     s->qemu_put_mouse_event_absolute = absolute;
 490     s->qemu_put_mouse_event_name = qemu_strdup(name);
 491     s->next = NULL;
 492
 493     if (!qemu_put_mouse_event_head) {
 494         qemu_put_mouse_event_head = qemu_put_mouse_event_current = s;
 495         return s;
 496     }
 497
 498     cursor = qemu_put_mouse_event_head;
 499     while (cursor->next != NULL)
 500         cursor = cursor->next;
 501
 502     cursor->next = s;
 503     qemu_put_mouse_event_current = s;
 504
 505     return s;
 506 }
 507
 508 void qemu_remove_mouse_event_handler(QEMUPutMouseEntry *entry)
 509 {
 510     QEMUPutMouseEntry *prev = NULL, *cursor;
 511
 512     if (!qemu_put_mouse_event_head || entry == NULL)
 513         return;
 514
 515     cursor = qemu_put_mouse_event_head;
 516     while (cursor != NULL && cursor != entry) {
 517         prev = cursor;
 518         cursor = cursor->next;
 519     }
 520
 521     if (cursor == NULL) // does not exist or list empty
 522         return;
 523     else if (prev == NULL) { // entry is head
 524         qemu_put_mouse_event_head = cursor->next;
 525         if (qemu_put_mouse_event_current == entry)
 526             qemu_put_mouse_event_current = cursor->next;
 527         qemu_free(entry->qemu_put_mouse_event_name);
 528         qemu_free(entry);
 529         return;
 530     }
 531
 532     prev->next = entry->next;
 533
 534     if (qemu_put_mouse_event_current == entry)
 535         qemu_put_mouse_event_current = prev;
 536
 537     qemu_free(entry->qemu_put_mouse_event_name);
 538     qemu_free(entry);
 539 }
 540
 541 void kbd_put_keycode(int keycode)
 542 {
 543     if (qemu_put_kbd_event) {
 544         qemu_put_kbd_event(qemu_put_kbd_event_opaque, keycode);
 545     }
 546 }
 547
 548 void kbd_mouse_event(int dx, int dy, int dz, int buttons_state)
 549 {
 550     QEMUPutMouseEvent *mouse_event;
 551     void *mouse_event_opaque;
 552     int width;
 553
 554     if (!qemu_put_mouse_event_current) {
 555         return;
 556     }
 557
 558     mouse_event =
 559         qemu_put_mouse_event_current->qemu_put_mouse_event;
 560     mouse_event_opaque =
 561         qemu_put_mouse_event_current->qemu_put_mouse_event_opaque;
 562
 563     if (mouse_event) {
 564         if (graphic_rotate) {
 565             if (qemu_put_mouse_event_current->qemu_put_mouse_event_absolute)
 566                 width = 0x7fff;
 567             else
 568                 width = graphic_width;
 569             mouse_event(mouse_event_opaque,
 570                                  width - dy, dx, dz, buttons_state);
 571         } else
 572             mouse_event(mouse_event_opaque,
 573                                  dx, dy, dz, buttons_state);
 574     }
 575 }
 576
 577 int kbd_mouse_is_absolute(void)
 578 {
 579     if (!qemu_put_mouse_event_current)
 580         return 0;
 581
 582     return qemu_put_mouse_event_current->qemu_put_mouse_event_absolute;
 583 }
 584
 585 void do_info_mice(void)
 586 {
 587     QEMUPutMouseEntry *cursor;
 588     int index = 0;
 589
 590     if (!qemu_put_mouse_event_head) {
 591         term_printf("No mouse devices connected\n");
 592         return;
 593     }
 594
 595     term_printf("Mouse devices available:\n");
 596     cursor = qemu_put_mouse_event_head;
 597     while (cursor != NULL) {
 598         term_printf("%c Mouse #%d: %s\n",
 599                     (cursor == qemu_put_mouse_event_current ? '*' : ' '),
 600                     index, cursor->qemu_put_mouse_event_name);
 601         index++;
 602         cursor = cursor->next;
 603     }
 604 }
 605
 606 void do_mouse_set(int index)
 607 {
 608     QEMUPutMouseEntry *cursor;
 609     int i = 0;
 610
 611     if (!qemu_put_mouse_event_head) {
 612         term_printf("No mouse devices connected\n");
 613         return;
 614     }
 615
 616     cursor = qemu_put_mouse_event_head;
 617     while (cursor != NULL && index != i) {
 618         i++;
 619         cursor = cursor->next;
 620     }
 621
 622     if (cursor != NULL)
 623         qemu_put_mouse_event_current = cursor;
 624     else
 625         term_printf("Mouse at given index not found\n");
 626 }
 627
 628 /* compute with 96 bit intermediate result: (a*b)/c */
 629 uint64_t muldiv64(uint64_t a, uint32_t b, uint32_t c)
 630 {
 631     union {
 632         uint64_t ll;
 633         struct {
 634 #ifdef WORDS_BIGENDIAN
 635             uint32_t high, low;
 636 #else
 637             uint32_t low, high;
 638 #endif
 639         } l;
 640     } u, res;
 641     uint64_t rl, rh;
 642
 643     u.ll = a;
 644     rl = (uint64_t)u.l.low * (uint64_t)b;
 645     rh = (uint64_t)u.l.high * (uint64_t)b;
 646     rh += (rl >> 32);
 647     res.l.high = rh / c;
 648     res.l.low = (((rh % c) << 32) + (rl & 0xffffffff)) / c;
 649     return res.ll;
 650 }
 651
 652 /***********************************************************/
 653 /* real time host monotonic timer */
 654
 655 #define QEMU_TIMER_BASE 1000000000LL
 656
 657 #ifdef WIN32
 658
 659 static int64_t clock_freq;
 660
 661 static void init_get_clock(void)
 662 {
 663     LARGE_INTEGER freq;
 664     int ret;
 665     ret = QueryPerformanceFrequency(&freq);
 666     if (ret == 0) {
 667         fprintf(stderr, "Could not calibrate ticks\n");
 668         exit(1);
 669     }
 670     clock_freq = freq.QuadPart;
 671 }
 672
 673 static int64_t get_clock(void)
 674 {
 675     LARGE_INTEGER ti;
 676     QueryPerformanceCounter(&ti);
 677     return muldiv64(ti.QuadPart, QEMU_TIMER_BASE, clock_freq);
 678 }
 679
 680 #else
 681
 682 static int use_rt_clock;
 683
 684 static void init_get_clock(void)
 685 {
 686     use_rt_clock = 0;
 687 #if defined(__linux__)
 688     {
 689         struct timespec ts;
 690         if (clock_gettime(CLOCK_MONOTONIC, &ts) == 0) {
 691             use_rt_clock = 1;
 692         }
 693     }
 694 #endif
 695 }
 696
 697 static int64_t get_clock(void)
 698 {
 699 #if defined(__linux__)
 700     if (use_rt_clock) {
 701         struct timespec ts;
 702         clock_gettime(CLOCK_MONOTONIC, &ts);
 703         return ts.tv_sec * 1000000000LL + ts.tv_nsec;
 704     } else
 705 #endif
 706     {
 707         /* XXX: using gettimeofday leads to problems if the date
 708            changes, so it should be avoided. */
 709         struct timeval tv;
 710         gettimeofday(&tv, NULL);
 711         return tv.tv_sec * 1000000000LL + (tv.tv_usec * 1000);
 712     }
 713 }
 714
 715 #endif
 716
 717 /***********************************************************/
 718 /* guest cycle counter */
 719
 720 static int64_t cpu_ticks_prev;
 721 static int64_t cpu_ticks_offset;
 722 static int64_t cpu_clock_offset;
 723 static int cpu_ticks_enabled;
 724
 725 /* return the host CPU cycle counter and handle stop/restart */
 726 int64_t cpu_get_ticks(void)
 727 {
 728     if (!cpu_ticks_enabled) {
 729         return cpu_ticks_offset;
 730     } else {
 731         int64_t ticks;
 732         ticks = cpu_get_real_ticks();
 733         if (cpu_ticks_prev > ticks) {
 734             /* Note: non increasing ticks may happen if the host uses
 735                software suspend */
 736             cpu_ticks_offset += cpu_ticks_prev - ticks;
 737         }
 738         cpu_ticks_prev = ticks;
 739         return ticks + cpu_ticks_offset;
 740     }
 741 }
 742
 743 /* return the host CPU monotonic timer and handle stop/restart */
 744 static int64_t cpu_get_clock(void)
 745 {
 746     int64_t ti;
 747     if (!cpu_ticks_enabled) {
 748         return cpu_clock_offset;
 749     } else {
 750         ti = get_clock();
 751         return ti + cpu_clock_offset;
 752     }
 753 }
 754
 755 /* enable cpu_get_ticks() */
 756 void cpu_enable_ticks(void)
 757 {
 758     if (!cpu_ticks_enabled) {
 759         cpu_ticks_offset -= cpu_get_real_ticks();
 760         cpu_clock_offset -= get_clock();
 761         cpu_ticks_enabled = 1;
 762     }
 763 }
 764
 765 /* disable cpu_get_ticks() : the clock is stopped. You must not call
 766    cpu_get_ticks() after that.  */
 767 void cpu_disable_ticks(void)
 768 {
 769     if (cpu_ticks_enabled) {
 770         cpu_ticks_offset = cpu_get_ticks();
 771         cpu_clock_offset = cpu_get_clock();
 772         cpu_ticks_enabled = 0;
 773     }
 774 }
 775
 776 /***********************************************************/
 777 /* timers */
 778
 779 #define QEMU_TIMER_REALTIME 0
 780 #define QEMU_TIMER_VIRTUAL  1
 781
 782 struct QEMUClock {
 783     int type;
 784     /* XXX: add frequency */
 785 };
 786
 787 struct QEMUTimer {
 788     QEMUClock *clock;
 789     int64_t expire_time;
 790     QEMUTimerCB *cb;
 791     void *opaque;
 792     struct QEMUTimer *next;
 793 };
 794
 795 struct qemu_alarm_timer {
 796     char const *name;
 797     unsigned int flags;
 798
 799     int (*start)(struct qemu_alarm_timer *t);
 800     void (*stop)(struct qemu_alarm_timer *t);
 801     void (*rearm)(struct qemu_alarm_timer *t);
 802     void *priv;
 803 };
 804
 805 #define ALARM_FLAG_DYNTICKS  0x1
 806
 807 static inline int alarm_has_dynticks(struct qemu_alarm_timer *t)
 808 {
 809     return t->flags & ALARM_FLAG_DYNTICKS;
 810 }
 811
 812 static void qemu_rearm_alarm_timer(struct qemu_alarm_timer *t)
 813 {
 814     if (!alarm_has_dynticks(t))
 815         return;
 816
 817     t->rearm(t);
 818 }
 819
 820 /* TODO: MIN_TIMER_REARM_US should be optimized */
 821 #define MIN_TIMER_REARM_US 250
 822
 823 static struct qemu_alarm_timer *alarm_timer;
 824
 825 #ifdef _WIN32
 826
 827 struct qemu_alarm_win32 {
 828     MMRESULT timerId;
 829     HANDLE host_alarm;
 830     unsigned int period;
 831 } alarm_win32_data = {0, NULL, -1};
 832
 833 static int win32_start_timer(struct qemu_alarm_timer *t);
 834 static void win32_stop_timer(struct qemu_alarm_timer *t);
 835 static void win32_rearm_timer(struct qemu_alarm_timer *t);
 836
 837 #else
 838
 839 static int unix_start_timer(struct qemu_alarm_timer *t);
 840 static void unix_stop_timer(struct qemu_alarm_timer *t);
 841
 842 #ifdef __linux__
 843
 844 static int dynticks_start_timer(struct qemu_alarm_timer *t);
 845 static void dynticks_stop_timer(struct qemu_alarm_timer *t);
 846 static void dynticks_rearm_timer(struct qemu_alarm_timer *t);
 847
 848 static int hpet_start_timer(struct qemu_alarm_timer *t);
 849 static void hpet_stop_timer(struct qemu_alarm_timer *t);
 850
 851 static int rtc_start_timer(struct qemu_alarm_timer *t);
 852 static void rtc_stop_timer(struct qemu_alarm_timer *t);
 853
 854 #endif /* __linux__ */
 855
 856 #endif /* _WIN32 */
 857
 858 static struct qemu_alarm_timer alarm_timers[] = {
 859 #ifndef _WIN32
 860 #ifdef __linux__
 861     {"dynticks", ALARM_FLAG_DYNTICKS, dynticks_start_timer,
 862      dynticks_stop_timer, dynticks_rearm_timer, NULL},
 863     /* HPET - if available - is preferred */
 864     {"hpet", 0, hpet_start_timer, hpet_stop_timer, NULL, NULL},
 865     /* ...otherwise try RTC */
 866     {"rtc", 0, rtc_start_timer, rtc_stop_timer, NULL, NULL},
 867 #endif
 868     {"unix", 0, unix_start_timer, unix_stop_timer, NULL, NULL},
 869 #else
 870     {"dynticks", ALARM_FLAG_DYNTICKS, win32_start_timer,
 871      win32_stop_timer, win32_rearm_timer, &alarm_win32_data},
 872     {"win32", 0, win32_start_timer,
 873      win32_stop_timer, NULL, &alarm_win32_data},
 874 #endif
 875     {NULL, }
 876 };
 877
 878 static void show_available_alarms()
 879 {
 880     int i;
 881
 882     printf("Available alarm timers, in order of precedence:\n");
 883     for (i = 0; alarm_timers[i].name; i++)
 884         printf("%s\n", alarm_timers[i].name);
 885 }
 886
 887 static void configure_alarms(char const *opt)
 888 {
 889     int i;
 890     int cur = 0;
 891     int count = (sizeof(alarm_timers) / sizeof(*alarm_timers)) - 1;
 892     char *arg;
 893     char *name;
 894
 895     if (!strcmp(opt, "help")) {
 896         show_available_alarms();
 897         exit(0);
 898     }
 899
 900     arg = strdup(opt);
 901
 902     /* Reorder the array */
 903     name = strtok(arg, ",");
 904     while (name) {
 905         struct qemu_alarm_timer tmp;
 906
 907         for (i = 0; i < count && alarm_timers[i].name; i++) {
 908             if (!strcmp(alarm_timers[i].name, name))
 909                 break;
 910         }
 911
 912         if (i == count) {
 913             fprintf(stderr, "Unknown clock %s\n", name);
 914             goto next;
 915         }
 916
 917         if (i < cur)
 918             /* Ignore */
 919             goto next;
 920
 921         /* Swap */
 922         tmp = alarm_timers[i];
 923         alarm_timers[i] = alarm_timers[cur];
 924         alarm_timers[cur] = tmp;
 925
 926         cur++;
 927 next:
 928         name = strtok(NULL, ",");
 929     }
 930
 931     free(arg);
 932
 933     if (cur) {
 934         /* Disable remaining timers */
 935         for (i = cur; i < count; i++)
 936             alarm_timers[i].name = NULL;
 937     }
 938
 939     /* debug */
 940     show_available_alarms();
 941 }
 942
 943 QEMUClock *rt_clock;
 944 QEMUClock *vm_clock;
 945
 946 static QEMUTimer *active_timers[2];
 947
 948 QEMUClock *qemu_new_clock(int type)
 949 {
 950     QEMUClock *clock;
 951     clock = qemu_mallocz(sizeof(QEMUClock));
 952     if (!clock)
 953         return NULL;
 954     clock->type = type;
 955     return clock;
 956 }
 957
 958 QEMUTimer *qemu_new_timer(QEMUClock *clock, QEMUTimerCB *cb, void *opaque)
 959 {
 960     QEMUTimer *ts;
 961
 962     ts = qemu_mallocz(sizeof(QEMUTimer));
 963     ts->clock = clock;
 964     ts->cb = cb;
 965     ts->opaque = opaque;
 966     return ts;
 967 }
 968
 969 void qemu_free_timer(QEMUTimer *ts)
 970 {
 971     qemu_free(ts);
 972 }
 973
 974 /* stop a timer, but do not dealloc it */
 975 void qemu_del_timer(QEMUTimer *ts)
 976 {
 977     QEMUTimer **pt, *t;
 978
 979     /* NOTE: this code must be signal safe because
 980        qemu_timer_expired() can be called from a signal. */
 981     pt = &active_timers[ts->clock->type];
 982     for(;;) {
 983         t = *pt;
 984         if (!t)
 985             break;
 986         if (t == ts) {
 987             *pt = t->next;
 988             break;
 989         }
 990         pt = &t->next;
 991     }
 992 }
 993
 994 /* modify the current timer so that it will be fired when current_time
 995    >= expire_time. The corresponding callback will be called. */
 996 void qemu_mod_timer(QEMUTimer *ts, int64_t expire_time)
 997 {
 998     QEMUTimer **pt, *t;
 999
1000     qemu_del_timer(ts);
1001
1002     /* add the timer in the sorted list */
1003     /* NOTE: this code must be signal safe because
1004        qemu_timer_expired() can be called from a signal. */
1005     pt = &active_timers[ts->clock->type];
1006     for(;;) {
1007         t = *pt;
1008         if (!t)
1009             break;
1010         if (t->expire_time > expire_time)
1011             break;
1012         pt = &t->next;
1013     }
1014     ts->expire_time = expire_time;
1015     ts->next = *pt;
1016     *pt = ts;
1017 }
1018
1019 int qemu_timer_pending(QEMUTimer *ts)
1020 {
1021     QEMUTimer *t;
1022     for(t = active_timers[ts->clock->type]; t != NULL; t = t->next) {
1023         if (t == ts)
1024             return 1;
1025     }
1026     return 0;
1027 }
1028
1029 static inline int qemu_timer_expired(QEMUTimer *timer_head, int64_t current_time)
1030 {
1031     if (!timer_head)
1032         return 0;
1033     return (timer_head->expire_time <= current_time);
1034 }
1035
1036 static void qemu_run_timers(QEMUTimer **ptimer_head, int64_t current_time)
1037 {
1038     QEMUTimer *ts;
1039
1040     for(;;) {
1041         ts = *ptimer_head;
1042         if (!ts || ts->expire_time > current_time)
1043             break;
1044         /* remove timer from the list before calling the callback */
1045         *ptimer_head = ts->next;
1046         ts->next = NULL;
1047
1048         /* run the callback (the timer list can be modified) */
1049         ts->cb(ts->opaque);
1050     }
1051     qemu_rearm_alarm_timer(alarm_timer);
1052 }
1053
1054 int64_t qemu_get_clock(QEMUClock *clock)
1055 {
1056     switch(clock->type) {
1057     case QEMU_TIMER_REALTIME:
1058         return get_clock() / 1000000;
1059     default:
1060     case QEMU_TIMER_VIRTUAL:
1061         return cpu_get_clock();
1062     }
1063 }
1064
1065 static void init_timers(void)
1066 {
1067     init_get_clock();
1068     ticks_per_sec = QEMU_TIMER_BASE;
1069     rt_clock = qemu_new_clock(QEMU_TIMER_REALTIME);
1070     vm_clock = qemu_new_clock(QEMU_TIMER_VIRTUAL);
1071 }
1072
1073 /* save a timer */
1074 void qemu_put_timer(QEMUFile *f, QEMUTimer *ts)
1075 {
1076     uint64_t expire_time;
1077
1078     if (qemu_timer_pending(ts)) {
1079         expire_time = ts->expire_time;
1080     } else {
1081         expire_time = -1;
1082     }
1083     qemu_put_be64(f, expire_time);
1084 }
1085
1086 void qemu_get_timer(QEMUFile *f, QEMUTimer *ts)
1087 {
1088     uint64_t expire_time;
1089
1090     expire_time = qemu_get_be64(f);
1091     if (expire_time != -1) {
1092         qemu_mod_timer(ts, expire_time);
1093     } else {
1094         qemu_del_timer(ts);
1095     }
1096 }
1097
1098 static void timer_save(QEMUFile *f, void *opaque)
1099 {
1100     if (cpu_ticks_enabled) {
1101         hw_error("cannot save state if virtual timers are running");
1102     }
1103     qemu_put_be64s(f, &cpu_ticks_offset);
1104     qemu_put_be64s(f, &ticks_per_sec);
1105     qemu_put_be64s(f, &cpu_clock_offset);
1106 }
1107
1108 static int timer_load(QEMUFile *f, void *opaque, int version_id)
1109 {
1110     if (version_id != 1 && version_id != 2)
1111         return -EINVAL;
1112     if (cpu_ticks_enabled) {
1113         return -EINVAL;
1114     }
1115     qemu_get_be64s(f, &cpu_ticks_offset);
1116     qemu_get_be64s(f, &ticks_per_sec);
1117     if (version_id == 2) {
1118         qemu_get_be64s(f, &cpu_clock_offset);
1119     }
1120     return 0;
1121 }
1122
1123 #ifdef _WIN32
1124 void CALLBACK host_alarm_handler(UINT uTimerID, UINT uMsg,
1125                                  DWORD_PTR dwUser, DWORD_PTR dw1, DWORD_PTR dw2)
1126 #else
1127 static void host_alarm_handler(int host_signum)
1128 #endif
1129 {
1130 #if 0
1131 #define DISP_FREQ 1000
1132     {
1133         static int64_t delta_min = INT64_MAX;
1134         static int64_t delta_max, delta_cum, last_clock, delta, ti;
1135         static int count;
1136         ti = qemu_get_clock(vm_clock);
1137         if (last_clock != 0) {
1138             delta = ti - last_clock;
1139             if (delta < delta_min)
1140                 delta_min = delta;
1141             if (delta > delta_max)
1142                 delta_max = delta;
1143             delta_cum += delta;
1144             if (++count == DISP_FREQ) {
1145                 printf("timer: min=%" PRId64 " us max=%" PRId64 " us avg=%" PRId64 " us avg_freq=%0.3f Hz\n",
1146                        muldiv64(delta_min, 1000000, ticks_per_sec),
1147                        muldiv64(delta_max, 1000000, ticks_per_sec),
1148                        muldiv64(delta_cum, 1000000 / DISP_FREQ, ticks_per_sec),
1149                        (double)ticks_per_sec / ((double)delta_cum / DISP_FREQ));
1150                 count = 0;
1151                 delta_min = INT64_MAX;
1152                 delta_max = 0;
1153                 delta_cum = 0;
1154             }
1155         }
1156         last_clock = ti;
1157     }
1158 #endif
1159     if (alarm_has_dynticks(alarm_timer) ||
1160         qemu_timer_expired(active_timers[QEMU_TIMER_VIRTUAL],
1161                            qemu_get_clock(vm_clock)) ||
1162         qemu_timer_expired(active_timers[QEMU_TIMER_REALTIME],
1163                            qemu_get_clock(rt_clock))) {
1164 #ifdef _WIN32
1165         struct qemu_alarm_win32 *data = ((struct qemu_alarm_timer*)dwUser)->priv;
1166         SetEvent(data->host_alarm);
1167 #endif
1168         CPUState *env = cpu_single_env;
1169         if (env) {
1170             /* stop the currently executing cpu because a timer occured */
1171             cpu_interrupt(env, CPU_INTERRUPT_EXIT);
1172 #ifdef USE_KQEMU
1173             if (env->kqemu_enabled) {
1174                 kqemu_cpu_interrupt(env);
1175             }
1176 #endif
1177         }
1178     }
1179 }
1180
1181 static uint64_t qemu_next_deadline(void)
1182 {
1183     int64_t nearest_delta_us = INT64_MAX;
1184     int64_t vmdelta_us;
1185
1186     if (active_timers[QEMU_TIMER_REALTIME])
1187         nearest_delta_us = (active_timers[QEMU_TIMER_REALTIME]->expire_time -
1188                             qemu_get_clock(rt_clock))*1000;
1189
1190     if (active_timers[QEMU_TIMER_VIRTUAL]) {
1191         /* round up */
1192         vmdelta_us = (active_timers[QEMU_TIMER_VIRTUAL]->expire_time -
1193                       qemu_get_clock(vm_clock)+999)/1000;
1194         if (vmdelta_us < nearest_delta_us)
1195             nearest_delta_us = vmdelta_us;
1196     }
1197
1198     /* Avoid arming the timer to negative, zero, or too low values */
1199     if (nearest_delta_us <= MIN_TIMER_REARM_US)
1200         nearest_delta_us = MIN_TIMER_REARM_US;
1201
1202     return nearest_delta_us;
1203 }
1204
1205 #ifndef _WIN32
1206
1207 #if defined(__linux__)
1208
1209 #define RTC_FREQ 1024
1210
1211 static void enable_sigio_timer(int fd)
1212 {
1213     struct sigaction act;
1214
1215     /* timer signal */
1216     sigfillset(&act.sa_mask);
1217     act.sa_flags = 0;
1218 #if defined (TARGET_I386) && defined(USE_CODE_COPY)
1219     act.sa_flags |= SA_ONSTACK;
1220 #endif
1221     act.sa_handler = host_alarm_handler;
1222
1223     sigaction(SIGIO, &act, NULL);
1224     fcntl(fd, F_SETFL, O_ASYNC);
1225     fcntl(fd, F_SETOWN, getpid());
1226 }
1227
1228 static int hpet_start_timer(struct qemu_alarm_timer *t)
1229 {
1230     struct hpet_info info;
1231     int r, fd;
1232
1233     fd = open("/dev/hpet", O_RDONLY);
1234     if (fd < 0)
1235         return -1;
1236
1237     /* Set frequency */
1238     r = ioctl(fd, HPET_IRQFREQ, RTC_FREQ);
1239     if (r < 0) {
1240         fprintf(stderr, "Could not configure '/dev/hpet' to have a 1024Hz timer. This is not a fatal\n"
1241                 "error, but for better emulation accuracy type:\n"
1242                 "'echo 1024 > /proc/sys/dev/hpet/max-user-freq' as root.\n");
1243         goto fail;
1244     }
1245
1246     /* Check capabilities */
1247     r = ioctl(fd, HPET_INFO, &info);
1248     if (r < 0)
1249         goto fail;
1250
1251     /* Enable periodic mode */
1252     r = ioctl(fd, HPET_EPI, 0);
1253     if (info.hi_flags && (r < 0))
1254         goto fail;
1255
1256     /* Enable interrupt */
1257     r = ioctl(fd, HPET_IE_ON, 0);
1258     if (r < 0)
1259         goto fail;
1260
1261     enable_sigio_timer(fd);
1262     t->priv = (void *)(long)fd;
1263
1264     return 0;
1265 fail:
1266     close(fd);
1267     return -1;
1268 }
1269
1270 static void hpet_stop_timer(struct qemu_alarm_timer *t)
1271 {
1272     int fd = (long)t->priv;
1273
1274     close(fd);
1275 }
1276
1277 static int rtc_start_timer(struct qemu_alarm_timer *t)
1278 {
1279     int rtc_fd;
1280
1281     TFR(rtc_fd = open("/dev/rtc", O_RDONLY));
1282     if (rtc_fd < 0)
1283         return -1;
1284     if (ioctl(rtc_fd, RTC_IRQP_SET, RTC_FREQ) < 0) {
1285         fprintf(stderr, "Could not configure '/dev/rtc' to have a 1024 Hz timer. This is not a fatal\n"
1286                 "error, but for better emulation accuracy either use a 2.6 host Linux kernel or\n"
1287                 "type 'echo 1024 > /proc/sys/dev/rtc/max-user-freq' as root.\n");
1288         goto fail;
1289     }
1290     if (ioctl(rtc_fd, RTC_PIE_ON, 0) < 0) {
1291     fail:
1292         close(rtc_fd);
1293         return -1;
1294     }
1295
1296     enable_sigio_timer(rtc_fd);
1297
1298     t->priv = (void *)(long)rtc_fd;
1299
1300     return 0;
1301 }
1302
1303 static void rtc_stop_timer(struct qemu_alarm_timer *t)
1304 {
1305     int rtc_fd = (long)t->priv;
1306
1307     close(rtc_fd);
1308 }
1309
1310 static int dynticks_start_timer(struct qemu_alarm_timer *t)
1311 {
1312     struct sigevent ev;
1313     timer_t host_timer;
1314     struct sigaction act;
1315
1316     sigfillset(&act.sa_mask);
1317     act.sa_flags = 0;
1318 #if defined(TARGET_I386) && defined(USE_CODE_COPY)
1319     act.sa_flags |= SA_ONSTACK;
1320 #endif
1321     act.sa_handler = host_alarm_handler;
1322
1323     sigaction(SIGALRM, &act, NULL);
1324
1325     ev.sigev_value.sival_int = 0;
1326     ev.sigev_notify = SIGEV_SIGNAL;
1327     ev.sigev_signo = SIGALRM;
1328
1329     if (timer_create(CLOCK_REALTIME, &ev, &host_timer)) {
1330         perror("timer_create");
1331
1332         /* disable dynticks */
1333         fprintf(stderr, "Dynamic Ticks disabled\n");
1334
1335         return -1;
1336     }
1337
1338     t->priv = (void *)host_timer;
1339
1340     return 0;
1341 }
1342
1343 static void dynticks_stop_timer(struct qemu_alarm_timer *t)
1344 {
1345     timer_t host_timer = (timer_t)t->priv;
1346
1347     timer_delete(host_timer);
1348 }
1349
1350 static void dynticks_rearm_timer(struct qemu_alarm_timer *t)
1351 {
1352     timer_t host_timer = (timer_t)t->priv;
1353     struct itimerspec timeout;
1354     int64_t nearest_delta_us = INT64_MAX;
1355     int64_t current_us;
1356
1357     if (!active_timers[QEMU_TIMER_REALTIME] &&
1358                 !active_timers[QEMU_TIMER_VIRTUAL])
1359             return;
1360
1361     nearest_delta_us = qemu_next_deadline();
1362
1363     /* check whether a timer is already running */
1364     if (timer_gettime(host_timer, &timeout)) {
1365         perror("gettime");
1366         fprintf(stderr, "Internal timer error: aborting\n");
1367         exit(1);
1368     }
1369     current_us = timeout.it_value.tv_sec * 1000000 + timeout.it_value.tv_nsec/1000;
1370     if (current_us && current_us <= nearest_delta_us)
1371         return;
1372
1373     timeout.it_interval.tv_sec = 0;
1374     timeout.it_interval.tv_nsec = 0; /* 0 for one-shot timer */
1375     timeout.it_value.tv_sec =  nearest_delta_us / 1000000;
1376     timeout.it_value.tv_nsec = (nearest_delta_us % 1000000) * 1000;
1377     if (timer_settime(host_timer, 0 /* RELATIVE */, &timeout, NULL)) {
1378         perror("settime");
1379         fprintf(stderr, "Internal timer error: aborting\n");
1380         exit(1);
1381     }
1382 }
1383
1384 #endif /* defined(__linux__) */
1385
1386 static int unix_start_timer(struct qemu_alarm_timer *t)
1387 {
1388     struct sigaction act;
1389     struct itimerval itv;
1390     int err;
1391
1392     /* timer signal */
1393     sigfillset(&act.sa_mask);
1394     act.sa_flags = 0;
1395 #if defined(TARGET_I386) && defined(USE_CODE_COPY)
1396     act.sa_flags |= SA_ONSTACK;
1397 #endif
1398     act.sa_handler = host_alarm_handler;
1399
1400     sigaction(SIGALRM, &act, NULL);
1401
1402     itv.it_interval.tv_sec = 0;
1403     /* for i386 kernel 2.6 to get 1 ms */
1404     itv.it_interval.tv_usec = 999;
1405     itv.it_value.tv_sec = 0;
1406     itv.it_value.tv_usec = 10 * 1000;
1407
1408     err = setitimer(ITIMER_REAL, &itv, NULL);
1409     if (err)
1410         return -1;
1411
1412     return 0;
1413 }
1414
1415 static void unix_stop_timer(struct qemu_alarm_timer *t)
1416 {
1417     struct itimerval itv;
1418
1419     memset(&itv, 0, sizeof(itv));
1420     setitimer(ITIMER_REAL, &itv, NULL);
1421 }
1422
1423 #endif /* !defined(_WIN32) */
1424
1425 #ifdef _WIN32
1426
1427 static int win32_start_timer(struct qemu_alarm_timer *t)
1428 {
1429     TIMECAPS tc;
1430     struct qemu_alarm_win32 *data = t->priv;
1431     UINT flags;
1432
1433     data->host_alarm = CreateEvent(NULL, FALSE, FALSE, NULL);
1434     if (!data->host_alarm) {
1435         perror("Failed CreateEvent");
1436         return -1;
1437     }
1438
1439     memset(&tc, 0, sizeof(tc));
1440     timeGetDevCaps(&tc, sizeof(tc));
1441
1442     if (data->period < tc.wPeriodMin)
1443         data->period = tc.wPeriodMin;
1444
1445     timeBeginPeriod(data->period);
1446
1447     flags = TIME_CALLBACK_FUNCTION;
1448     if (alarm_has_dynticks(t))
1449         flags |= TIME_ONESHOT;
1450     else
1451         flags |= TIME_PERIODIC;
1452
1453     data->timerId = timeSetEvent(1,         // interval (ms)
1454                         data->period,       // resolution
1455                         host_alarm_handler, // function
1456                         (DWORD)t,           // parameter
1457                         flags);
1458
1459     if (!data->timerId) {
1460         perror("Failed to initialize win32 alarm timer");
1461
1462         timeEndPeriod(data->period);
1463         CloseHandle(data->host_alarm);
1464         return -1;
1465     }
1466
1467     qemu_add_wait_object(data->host_alarm, NULL, NULL);
1468
1469     return 0;
1470 }
1471
1472 static void win32_stop_timer(struct qemu_alarm_timer *t)
1473 {
1474     struct qemu_alarm_win32 *data = t->priv;
1475
1476     timeKillEvent(data->timerId);
1477     timeEndPeriod(data->period);
1478
1479     CloseHandle(data->host_alarm);
1480 }
1481
1482 static void win32_rearm_timer(struct qemu_alarm_timer *t)
1483 {
1484     struct qemu_alarm_win32 *data = t->priv;
1485     uint64_t nearest_delta_us;
1486
1487     if (!active_timers[QEMU_TIMER_REALTIME] &&
1488                 !active_timers[QEMU_TIMER_VIRTUAL])
1489             return;
1490
1491     nearest_delta_us = qemu_next_deadline();
1492     nearest_delta_us /= 1000;
1493
1494     timeKillEvent(data->timerId);
1495
1496     data->timerId = timeSetEvent(1,
1497                         data->period,
1498                         host_alarm_handler,
1499                         (DWORD)t,
1500                         TIME_ONESHOT | TIME_PERIODIC);
1501
1502     if (!data->timerId) {
1503         perror("Failed to re-arm win32 alarm timer");
1504
1505         timeEndPeriod(data->period);
1506         CloseHandle(data->host_alarm);
1507         exit(1);
1508     }
1509 }
1510
1511 #endif /* _WIN32 */
1512
1513 static void init_timer_alarm(void)
1514 {
1515     struct qemu_alarm_timer *t;
1516     int i, err = -1;
1517
1518     for (i = 0; alarm_timers[i].name; i++) {
1519         t = &alarm_timers[i];
1520
1521         err = t->start(t);
1522         if (!err)
1523             break;
1524     }
1525
1526     if (err) {
1527         fprintf(stderr, "Unable to find any suitable alarm timer.\n");
1528         fprintf(stderr, "Terminating\n");
1529         exit(1);
1530     }
1531
1532     alarm_timer = t;
1533 }
1534
1535 void quit_timers(void)
1536 {
1537     alarm_timer->stop(alarm_timer);
1538     alarm_timer = NULL;
1539 }
1540
1541 /***********************************************************/
1542 /* character device */
1543
1544 static void qemu_chr_event(CharDriverState *s, int event)
1545 {
1546     if (!s->chr_event)
1547         return;
1548     s->chr_event(s->handler_opaque, event);
1549 }
1550
1551 static void qemu_chr_reset_bh(void *opaque)
1552 {
1553     CharDriverState *s = opaque;
1554     qemu_chr_event(s, CHR_EVENT_RESET);
1555     qemu_bh_delete(s->bh);
1556     s->bh = NULL;
1557 }
1558
1559 void qemu_chr_reset(CharDriverState *s)
1560 {
1561     if (s->bh == NULL) {
1562         s->bh = qemu_bh_new(qemu_chr_reset_bh, s);
1563         qemu_bh_schedule(s->bh);
1564     }
1565 }
1566
1567 int qemu_chr_write(CharDriverState *s, const uint8_t *buf, int len)
1568 {
1569     return s->chr_write(s, buf, len);
1570 }
1571
1572 int qemu_chr_ioctl(CharDriverState *s, int cmd, void *arg)
1573 {
1574     if (!s->chr_ioctl)
1575         return -ENOTSUP;
1576     return s->chr_ioctl(s, cmd, arg);
1577 }
1578
1579 int qemu_chr_can_read(CharDriverState *s)
1580 {
1581     if (!s->chr_can_read)
1582         return 0;
1583     return s->chr_can_read(s->handler_opaque);
1584 }
1585
1586 void qemu_chr_read(CharDriverState *s, uint8_t *buf, int len)
1587 {
1588     s->chr_read(s->handler_opaque, buf, len);
1589 }
1590
1591
1592 void qemu_chr_printf(CharDriverState *s, const char *fmt, ...)
1593 {
1594     char buf[4096];
1595     va_list ap;
1596     va_start(ap, fmt);
1597     vsnprintf(buf, sizeof(buf), fmt, ap);
1598     qemu_chr_write(s, buf, strlen(buf));
1599     va_end(ap);
1600 }
1601
1602 void qemu_chr_send_event(CharDriverState *s, int event)
1603 {
1604     if (s->chr_send_event)
1605         s->chr_send_event(s, event);
1606 }
1607
1608 void qemu_chr_add_handlers(CharDriverState *s,
1609                            IOCanRWHandler *fd_can_read,
1610                            IOReadHandler *fd_read,
1611                            IOEventHandler *fd_event,
1612                            void *opaque)
1613 {
1614     s->chr_can_read = fd_can_read;
1615     s->chr_read = fd_read;
1616     s->chr_event = fd_event;
1617     s->handler_opaque = opaque;
1618     if (s->chr_update_read_handler)
1619         s->chr_update_read_handler(s);
1620 }
1621
1622 static int null_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
1623 {
1624     return len;
1625 }
1626
1627 static CharDriverState *qemu_chr_open_null(void)
1628 {
1629     CharDriverState *chr;
1630
1631     chr = qemu_mallocz(sizeof(CharDriverState));
1632     if (!chr)
1633         return NULL;
1634     chr->chr_write = null_chr_write;
1635     return chr;
1636 }
1637
1638 /* MUX driver for serial I/O splitting */
1639 static int term_timestamps;
1640 static int64_t term_timestamps_start;
1641 #define MAX_MUX 4
1642 typedef struct {
1643     IOCanRWHandler *chr_can_read[MAX_MUX];
1644     IOReadHandler *chr_read[MAX_MUX];
1645     IOEventHandler *chr_event[MAX_MUX];
1646     void *ext_opaque[MAX_MUX];
1647     CharDriverState *drv;
1648     int mux_cnt;
1649     int term_got_escape;
1650     int max_size;
1651 } MuxDriver;
1652
1653
1654 static int mux_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
1655 {
1656     MuxDriver *d = chr->opaque;
1657     int ret;
1658     if (!term_timestamps) {
1659         ret = d->drv->chr_write(d->drv, buf, len);
1660     } else {
1661         int i;
1662
1663         ret = 0;
1664         for(i = 0; i < len; i++) {
1665             ret += d->drv->chr_write(d->drv, buf+i, 1);
1666             if (buf[i] == '\n') {
1667                 char buf1[64];
1668                 int64_t ti;
1669                 int secs;
1670
1671                 ti = get_clock();
1672                 if (term_timestamps_start == -1)
1673                     term_timestamps_start = ti;
1674                 ti -= term_timestamps_start;
1675                 secs = ti / 1000000000;
1676                 snprintf(buf1, sizeof(buf1),
1677                          "[%02d:%02d:%02d.%03d] ",
1678                          secs / 3600,
1679                          (secs / 60) % 60,
1680                          secs % 60,
1681                          (int)((ti / 1000000) % 1000));
1682                 d->drv->chr_write(d->drv, buf1, strlen(buf1));
1683             }
1684         }
1685     }
1686     return ret;
1687 }
1688
1689 static char *mux_help[] = {
1690     "% h    print this help\n\r",
1691     "% x    exit emulator\n\r",
1692     "% s    save disk data back to file (if -snapshot)\n\r",
1693     "% t    toggle console timestamps\n\r"
1694     "% b    send break (magic sysrq)\n\r",
1695     "% c    switch between console and monitor\n\r",
1696     "% %  sends %\n\r",
1697     NULL
1698 };
1699
1700 static int term_escape_char = 0x01; /* ctrl-a is used for escape */
1701 static void mux_print_help(CharDriverState *chr)
1702 {
1703     int i, j;
1704     char ebuf[15] = "Escape-Char";
1705     char cbuf[50] = "\n\r";
1706
1707     if (term_escape_char > 0 && term_escape_char < 26) {
1708         sprintf(cbuf,"\n\r");
1709         sprintf(ebuf,"C-%c", term_escape_char - 1 + 'a');
1710     } else {
1711         sprintf(cbuf,"\n\rEscape-Char set to Ascii: 0x%02x\n\r\n\r", term_escape_char);
1712     }
1713     chr->chr_write(chr, cbuf, strlen(cbuf));
1714     for (i = 0; mux_help[i] != NULL; i++) {
1715         for (j=0; mux_help[i][j] != '\0'; j++) {
1716             if (mux_help[i][j] == '%')
1717                 chr->chr_write(chr, ebuf, strlen(ebuf));
1718             else
1719                 chr->chr_write(chr, &mux_help[i][j], 1);
1720         }
1721     }
1722 }
1723
1724 static int mux_proc_byte(CharDriverState *chr, MuxDriver *d, int ch)
1725 {
1726     if (d->term_got_escape) {
1727         d->term_got_escape = 0;
1728         if (ch == term_escape_char)
1729             goto send_char;
1730         switch(ch) {
1731         case '?':
1732         case 'h':
1733             mux_print_help(chr);
1734             break;
1735         case 'x':
1736             {
1737                  char *term =  "QEMU: Terminated\n\r";
1738                  chr->chr_write(chr,term,strlen(term));
1739                  exit(0);
1740                  break;
1741             }
1742         case 's':
1743             {
1744                 int i;
1745                 for (i = 0; i < MAX_DISKS; i++) {
1746                     if (bs_table[i])
1747                         bdrv_commit(bs_table[i]);
1748                 }
1749                 if (mtd_bdrv)
1750                     bdrv_commit(mtd_bdrv);
1751             }
1752             break;
1753         case 'b':
1754             qemu_chr_event(chr, CHR_EVENT_BREAK);
1755             break;
1756         case 'c':
1757             /* Switch to the next registered device */
1758             chr->focus++;
1759             if (chr->focus >= d->mux_cnt)
1760                 chr->focus = 0;
1761             break;
1762        case 't':
1763            term_timestamps = !term_timestamps;
1764            term_timestamps_start = -1;
1765            break;
1766         }
1767     } else if (ch == term_escape_char) {
1768         d->term_got_escape = 1;
1769     } else {
1770     send_char:
1771         return 1;
1772     }
1773     return 0;
1774 }
1775
1776 static int mux_chr_can_read(void *opaque)
1777 {
1778     CharDriverState *chr = opaque;
1779     MuxDriver *d = chr->opaque;
1780     if (d->chr_can_read[chr->focus])
1781        return d->chr_can_read[chr->focus](d->ext_opaque[chr->focus]);
1782     return 0;
1783 }
1784
1785 static void mux_chr_read(void *opaque, const uint8_t *buf, int size)
1786 {
1787     CharDriverState *chr = opaque;
1788     MuxDriver *d = chr->opaque;
1789     int i;
1790     for(i = 0; i < size; i++)
1791         if (mux_proc_byte(chr, d, buf[i]))
1792             d->chr_read[chr->focus](d->ext_opaque[chr->focus], &buf[i], 1);
1793 }
1794
1795 static void mux_chr_event(void *opaque, int event)
1796 {
1797     CharDriverState *chr = opaque;
1798     MuxDriver *d = chr->opaque;
1799     int i;
1800
1801     /* Send the event to all registered listeners */
1802     for (i = 0; i < d->mux_cnt; i++)
1803         if (d->chr_event[i])
1804             d->chr_event[i](d->ext_opaque[i], event);
1805 }
1806
1807 static void mux_chr_update_read_handler(CharDriverState *chr)
1808 {
1809     MuxDriver *d = chr->opaque;
1810
1811     if (d->mux_cnt >= MAX_MUX) {
1812         fprintf(stderr, "Cannot add I/O handlers, MUX array is full\n");
1813         return;
1814     }
1815     d->ext_opaque[d->mux_cnt] = chr->handler_opaque;
1816     d->chr_can_read[d->mux_cnt] = chr->chr_can_read;
1817     d->chr_read[d->mux_cnt] = chr->chr_read;
1818     d->chr_event[d->mux_cnt] = chr->chr_event;
1819     /* Fix up the real driver with mux routines */
1820     if (d->mux_cnt == 0) {
1821         qemu_chr_add_handlers(d->drv, mux_chr_can_read, mux_chr_read,
1822                               mux_chr_event, chr);
1823     }
1824     chr->focus = d->mux_cnt;
1825     d->mux_cnt++;
1826 }
1827
1828 CharDriverState *qemu_chr_open_mux(CharDriverState *drv)
1829 {
1830     CharDriverState *chr;
1831     MuxDriver *d;
1832
1833     chr = qemu_mallocz(sizeof(CharDriverState));
1834     if (!chr)
1835         return NULL;
1836     d = qemu_mallocz(sizeof(MuxDriver));
1837     if (!d) {
1838         free(chr);
1839         return NULL;
1840     }
1841
1842     chr->opaque = d;
1843     d->drv = drv;
1844     chr->focus = -1;
1845     chr->chr_write = mux_chr_write;
1846     chr->chr_update_read_handler = mux_chr_update_read_handler;
1847     return chr;
1848 }
1849
1850
1851 #ifdef _WIN32
1852
1853 static void socket_cleanup(void)
1854 {
1855     WSACleanup();
1856 }
1857
1858 static int socket_init(void)
1859 {
1860     WSADATA Data;
1861     int ret, err;
1862
1863     ret = WSAStartup(MAKEWORD(2,2), &Data);
1864     if (ret != 0) {
1865         err = WSAGetLastError();
1866         fprintf(stderr, "WSAStartup: %d\n", err);
1867         return -1;
1868     }
1869     atexit(socket_cleanup);
1870     return 0;
1871 }
1872
1873 static int send_all(int fd, const uint8_t *buf, int len1)
1874 {
1875     int ret, len;
1876
1877     len = len1;
1878     while (len > 0) {
1879         ret = send(fd, buf, len, 0);
1880         if (ret < 0) {
1881             int errno;
1882             errno = WSAGetLastError();
1883             if (errno != WSAEWOULDBLOCK) {
1884                 return -1;
1885             }
1886         } else if (ret == 0) {
1887             break;
1888         } else {
1889             buf += ret;
1890             len -= ret;
1891         }
1892     }
1893     return len1 - len;
1894 }
1895
1896 void socket_set_nonblock(int fd)
1897 {
1898     unsigned long opt = 1;
1899     ioctlsocket(fd, FIONBIO, &opt);
1900 }
1901
1902 #else
1903
1904 static int unix_write(int fd, const uint8_t *buf, int len1)
1905 {
1906     int ret, len;
1907
1908     len = len1;
1909     while (len > 0) {
1910         ret = write(fd, buf, len);
1911         if (ret < 0) {
1912             if (errno != EINTR && errno != EAGAIN)
1913                 return -1;
1914         } else if (ret == 0) {
1915             break;
1916         } else {
1917             buf += ret;
1918             len -= ret;
1919         }
1920     }
1921     return len1 - len;
1922 }
1923
1924 static inline int send_all(int fd, const uint8_t *buf, int len1)
1925 {
1926     return unix_write(fd, buf, len1);
1927 }
1928
1929 void socket_set_nonblock(int fd)
1930 {
1931     fcntl(fd, F_SETFL, O_NONBLOCK);
1932 }
1933 #endif /* !_WIN32 */
1934
1935 #ifndef _WIN32
1936
1937 typedef struct {
1938     int fd_in, fd_out;
1939     int max_size;
1940 } FDCharDriver;
1941
1942 #define STDIO_MAX_CLIENTS 1
1943 static int stdio_nb_clients = 0;
1944
1945 static int fd_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
1946 {
1947     FDCharDriver *s = chr->opaque;
1948     return unix_write(s->fd_out, buf, len);
1949 }
1950
1951 static int fd_chr_read_poll(void *opaque)
1952 {
1953     CharDriverState *chr = opaque;
1954     FDCharDriver *s = chr->opaque;
1955
1956     s->max_size = qemu_chr_can_read(chr);
1957     return s->max_size;
1958 }
1959
1960 static void fd_chr_read(void *opaque)
1961 {
1962     CharDriverState *chr = opaque;
1963     FDCharDriver *s = chr->opaque;
1964     int size, len;
1965     uint8_t buf[1024];
1966
1967     len = sizeof(buf);
1968     if (len > s->max_size)
1969         len = s->max_size;
1970     if (len == 0)
1971         return;
1972     size = read(s->fd_in, buf, len);
1973     if (size == 0) {
1974         /* FD has been closed. Remove it from the active list.  */
1975         qemu_set_fd_handler2(s->fd_in, NULL, NULL, NULL, NULL);
1976         return;
1977     }
1978     if (size > 0) {
1979         qemu_chr_read(chr, buf, size);
1980     }
1981 }
1982
1983 static void fd_chr_update_read_handler(CharDriverState *chr)
1984 {
1985     FDCharDriver *s = chr->opaque;
1986
1987     if (s->fd_in >= 0) {
1988         if (nographic && s->fd_in == 0) {
1989         } else {
1990             qemu_set_fd_handler2(s->fd_in, fd_chr_read_poll,
1991                                  fd_chr_read, NULL, chr);
1992         }
1993     }
1994 }
1995
1996 /* open a character device to a unix fd */
1997 static CharDriverState *qemu_chr_open_fd(int fd_in, int fd_out)
1998 {
1999     CharDriverState *chr;
2000     FDCharDriver *s;
2001
2002     chr = qemu_mallocz(sizeof(CharDriverState));
2003     if (!chr)
2004         return NULL;
2005     s = qemu_mallocz(sizeof(FDCharDriver));
2006     if (!s) {
2007         free(chr);
2008         return NULL;
2009     }
2010     s->fd_in = fd_in;
2011     s->fd_out = fd_out;
2012     chr->opaque = s;
2013     chr->chr_write = fd_chr_write;
2014     chr->chr_update_read_handler = fd_chr_update_read_handler;
2015
2016     qemu_chr_reset(chr);
2017
2018     return chr;
2019 }
2020
2021 static CharDriverState *qemu_chr_open_file_out(const char *file_out)
2022 {
2023     int fd_out;
2024
2025     TFR(fd_out = open(file_out, O_WRONLY | O_TRUNC | O_CREAT | O_BINARY, 0666));
2026     if (fd_out < 0)
2027         return NULL;
2028     return qemu_chr_open_fd(-1, fd_out);
2029 }
2030
2031 static CharDriverState *qemu_chr_open_pipe(const char *filename)
2032 {
2033     int fd_in, fd_out;
2034     char filename_in[256], filename_out[256];
2035
2036     snprintf(filename_in, 256, "%s.in", filename);
2037     snprintf(filename_out, 256, "%s.out", filename);
2038     TFR(fd_in = open(filename_in, O_RDWR | O_BINARY));
2039     TFR(fd_out = open(filename_out, O_RDWR | O_BINARY));
2040     if (fd_in < 0 || fd_out < 0) {
2041         if (fd_in >= 0)
2042             close(fd_in);
2043         if (fd_out >= 0)
2044             close(fd_out);
2045         TFR(fd_in = fd_out = open(filename, O_RDWR | O_BINARY));
2046         if (fd_in < 0)
2047             return NULL;
2048     }
2049     return qemu_chr_open_fd(fd_in, fd_out);
2050 }
2051
2052
2053 /* for STDIO, we handle the case where several clients use it
2054    (nographic mode) */
2055
2056 #define TERM_FIFO_MAX_SIZE 1
2057
2058 static uint8_t term_fifo[TERM_FIFO_MAX_SIZE];
2059 static int term_fifo_size;
2060
2061 static int stdio_read_poll(void *opaque)
2062 {
2063     CharDriverState *chr = opaque;
2064
2065     /* try to flush the queue if needed */
2066     if (term_fifo_size != 0 && qemu_chr_can_read(chr) > 0) {
2067         qemu_chr_read(chr, term_fifo, 1);
2068         term_fifo_size = 0;
2069     }
2070     /* see if we can absorb more chars */
2071     if (term_fifo_size == 0)
2072         return 1;
2073     else
2074         return 0;
2075 }
2076
2077 static void stdio_read(void *opaque)
2078 {
2079     int size;
2080     uint8_t buf[1];
2081     CharDriverState *chr = opaque;
2082
2083     size = read(0, buf, 1);
2084     if (size == 0) {
2085         /* stdin has been closed. Remove it from the active list.  */
2086         qemu_set_fd_handler2(0, NULL, NULL, NULL, NULL);
2087         return;
2088     }
2089     if (size > 0) {
2090         if (qemu_chr_can_read(chr) > 0) {
2091             qemu_chr_read(chr, buf, 1);
2092         } else if (term_fifo_size == 0) {
2093             term_fifo[term_fifo_size++] = buf[0];
2094         }
2095     }
2096 }
2097
2098 /* init terminal so that we can grab keys */
2099 static struct termios oldtty;
2100 static int old_fd0_flags;
2101
2102 static void term_exit(void)
2103 {
2104     tcsetattr (0, TCSANOW, &oldtty);
2105     fcntl(0, F_SETFL, old_fd0_flags);
2106 }
2107
2108 static void term_init(void)
2109 {
2110     struct termios tty;
2111
2112     tcgetattr (0, &tty);
2113     oldtty = tty;
2114     old_fd0_flags = fcntl(0, F_GETFL);
2115
2116     tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
2117                           |INLCR|IGNCR|ICRNL|IXON);
2118     tty.c_oflag |= OPOST;
2119     tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN);
2120     /* if graphical mode, we allow Ctrl-C handling */
2121     if (nographic)
2122         tty.c_lflag &= ~ISIG;
2123     tty.c_cflag &= ~(CSIZE|PARENB);
2124     tty.c_cflag |= CS8;
2125     tty.c_cc[VMIN] = 1;
2126     tty.c_cc[VTIME] = 0;
2127
2128     tcsetattr (0, TCSANOW, &tty);
2129
2130     atexit(term_exit);
2131
2132     fcntl(0, F_SETFL, O_NONBLOCK);
2133 }
2134
2135 static CharDriverState *qemu_chr_open_stdio(void)
2136 {
2137     CharDriverState *chr;
2138
2139     if (stdio_nb_clients >= STDIO_MAX_CLIENTS)
2140         return NULL;
2141     chr = qemu_chr_open_fd(0, 1);
2142     qemu_set_fd_handler2(0, stdio_read_poll, stdio_read, NULL, chr);
2143     stdio_nb_clients++;
2144     term_init();
2145
2146     return chr;
2147 }
2148
2149 #if defined(__linux__) || defined(__sun__)
2150 static CharDriverState *qemu_chr_open_pty(void)
2151 {
2152     struct termios tty;
2153     char slave_name[1024];
2154     int master_fd, slave_fd;
2155
2156 #if defined(__linux__)
2157     /* Not satisfying */
2158     if (openpty(&master_fd, &slave_fd, slave_name, NULL, NULL) < 0) {
2159         return NULL;
2160     }
2161 #endif
2162
2163     /* Disabling local echo and line-buffered output */
2164     tcgetattr (master_fd, &tty);
2165     tty.c_lflag &= ~(ECHO|ICANON|ISIG);
2166     tty.c_cc[VMIN] = 1;
2167     tty.c_cc[VTIME] = 0;
2168     tcsetattr (master_fd, TCSAFLUSH, &tty);
2169
2170     fprintf(stderr, "char device redirected to %s\n", slave_name);
2171     return qemu_chr_open_fd(master_fd, master_fd);
2172 }
2173
2174 static void tty_serial_init(int fd, int speed,
2175                             int parity, int data_bits, int stop_bits)
2176 {
2177     struct termios tty;
2178     speed_t spd;
2179
2180 #if 0
2181     printf("tty_serial_init: speed=%d parity=%c data=%d stop=%d\n",
2182            speed, parity, data_bits, stop_bits);
2183 #endif
2184     tcgetattr (fd, &tty);
2185
2186     switch(speed) {
2187     case 50:
2188         spd = B50;
2189         break;
2190     case 75:
2191         spd = B75;
2192         break;
2193     case 300:
2194         spd = B300;
2195         break;
2196     case 600:
2197         spd = B600;
2198         break;
2199     case 1200:
2200         spd = B1200;
2201         break;
2202     case 2400:
2203         spd = B2400;
2204         break;
2205     case 4800:
2206         spd = B4800;
2207         break;
2208     case 9600:
2209         spd = B9600;
2210         break;
2211     case 19200:
2212         spd = B19200;
2213         break;
2214     case 38400:
2215         spd = B38400;
2216         break;
2217     case 57600:
2218         spd = B57600;
2219         break;
2220     default:
2221     case 115200:
2222         spd = B115200;
2223         break;
2224     }
2225
2226     cfsetispeed(&tty, spd);
2227     cfsetospeed(&tty, spd);
2228
2229     tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
2230                           |INLCR|IGNCR|ICRNL|IXON);
2231     tty.c_oflag |= OPOST;
2232     tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN|ISIG);
2233     tty.c_cflag &= ~(CSIZE|PARENB|PARODD|CRTSCTS|CSTOPB);
2234     switch(data_bits) {
2235     default:
2236     case 8:
2237         tty.c_cflag |= CS8;
2238         break;
2239     case 7:
2240         tty.c_cflag |= CS7;
2241         break;
2242     case 6:
2243         tty.c_cflag |= CS6;
2244         break;
2245     case 5:
2246         tty.c_cflag |= CS5;
2247         break;
2248     }
2249     switch(parity) {
2250     default:
2251     case 'N':
2252         break;
2253     case 'E':
2254         tty.c_cflag |= PARENB;
2255         break;
2256     case 'O':
2257         tty.c_cflag |= PARENB | PARODD;
2258         break;
2259     }
2260     if (stop_bits == 2)
2261         tty.c_cflag |= CSTOPB;
2262
2263     tcsetattr (fd, TCSANOW, &tty);
2264 }
2265
2266 static int tty_serial_ioctl(CharDriverState *chr, int cmd, void *arg)
2267 {
2268     FDCharDriver *s = chr->opaque;
2269
2270     switch(cmd) {
2271     case CHR_IOCTL_SERIAL_SET_PARAMS:
2272         {
2273             QEMUSerialSetParams *ssp = arg;
2274             tty_serial_init(s->fd_in, ssp->speed, ssp->parity,
2275                             ssp->data_bits, ssp->stop_bits);
2276         }
2277         break;
2278     case CHR_IOCTL_SERIAL_SET_BREAK:
2279         {
2280             int enable = *(int *)arg;
2281             if (enable)
2282                 tcsendbreak(s->fd_in, 1);
2283         }
2284         break;
2285     default:
2286         return -ENOTSUP;
2287     }
2288     return 0;
2289 }
2290
2291 static CharDriverState *qemu_chr_open_tty(const char *filename)
2292 {
2293     CharDriverState *chr;
2294     int fd;
2295
2296     TFR(fd = open(filename, O_RDWR | O_NONBLOCK));
2297     fcntl(fd, F_SETFL, O_NONBLOCK);
2298     tty_serial_init(fd, 115200, 'N', 8, 1);
2299     chr = qemu_chr_open_fd(fd, fd);
2300     if (!chr) {
2301         close(fd);
2302         return NULL;
2303     }
2304     chr->chr_ioctl = tty_serial_ioctl;
2305     qemu_chr_reset(chr);
2306     return chr;
2307 }
2308 #else  /* ! __linux__ && ! __sun__ */
2309 static CharDriverState *qemu_chr_open_pty(void)
2310 {
2311     return NULL;
2312 }
2313 #endif /* __linux__ || __sun__ */
2314
2315 #if defined(__linux__)
2316 typedef struct {
2317     int fd;
2318     int mode;
2319 } ParallelCharDriver;
2320
2321 static int pp_hw_mode(ParallelCharDriver *s, uint16_t mode)
2322 {
2323     if (s->mode != mode) {
2324         int m = mode;
2325         if (ioctl(s->fd, PPSETMODE, &m) < 0)
2326             return 0;
2327         s->mode = mode;
2328     }
2329     return 1;
2330 }
2331
2332 static int pp_ioctl(CharDriverState *chr, int cmd, void *arg)
2333 {
2334     ParallelCharDriver *drv = chr->opaque;
2335     int fd = drv->fd;
2336     uint8_t b;
2337
2338     switch(cmd) {
2339     case CHR_IOCTL_PP_READ_DATA:
2340         if (ioctl(fd, PPRDATA, &b) < 0)
2341             return -ENOTSUP;
2342         *(uint8_t *)arg = b;
2343         break;
2344     case CHR_IOCTL_PP_WRITE_DATA:
2345         b = *(uint8_t *)arg;
2346         if (ioctl(fd, PPWDATA, &b) < 0)
2347             return -ENOTSUP;
2348         break;
2349     case CHR_IOCTL_PP_READ_CONTROL:
2350         if (ioctl(fd, PPRCONTROL, &b) < 0)
2351             return -ENOTSUP;
2352         /* Linux gives only the lowest bits, and no way to know data
2353            direction! For better compatibility set the fixed upper
2354            bits. */
2355         *(uint8_t *)arg = b | 0xc0;
2356         break;
2357     case CHR_IOCTL_PP_WRITE_CONTROL:
2358         b = *(uint8_t *)arg;
2359         if (ioctl(fd, PPWCONTROL, &b) < 0)
2360             return -ENOTSUP;
2361         break;
2362     case CHR_IOCTL_PP_READ_STATUS:
2363         if (ioctl(fd, PPRSTATUS, &b) < 0)
2364             return -ENOTSUP;
2365         *(uint8_t *)arg = b;
2366         break;
2367     case CHR_IOCTL_PP_EPP_READ_ADDR:
2368         if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
2369             struct ParallelIOArg *parg = arg;
2370             int n = read(fd, parg->buffer, parg->count);
2371             if (n != parg->count) {
2372                 return -EIO;
2373             }
2374         }
2375         break;
2376     case CHR_IOCTL_PP_EPP_READ:
2377         if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
2378             struct ParallelIOArg *parg = arg;
2379             int n = read(fd, parg->buffer, parg->count);
2380             if (n != parg->count) {
2381                 return -EIO;
2382             }
2383         }
2384         break;
2385     case CHR_IOCTL_PP_EPP_WRITE_ADDR:
2386         if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
2387             struct ParallelIOArg *parg = arg;
2388             int n = write(fd, parg->buffer, parg->count);
2389             if (n != parg->count) {
2390                 return -EIO;
2391             }
2392         }
2393         break;
2394     case CHR_IOCTL_PP_EPP_WRITE:
2395         if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
2396             struct ParallelIOArg *parg = arg;
2397             int n = write(fd, parg->buffer, parg->count);
2398             if (n != parg->count) {
2399                 return -EIO;
2400             }
2401         }
2402         break;
2403     default:
2404         return -ENOTSUP;
2405     }
2406     return 0;
2407 }
2408
2409 static void pp_close(CharDriverState *chr)
2410 {
2411     ParallelCharDriver *drv = chr->opaque;
2412     int fd = drv->fd;
2413
2414     pp_hw_mode(drv, IEEE1284_MODE_COMPAT);
2415     ioctl(fd, PPRELEASE);
2416     close(fd);
2417     qemu_free(drv);
2418 }
2419
2420 static CharDriverState *qemu_chr_open_pp(const char *filename)
2421 {
2422     CharDriverState *chr;
2423     ParallelCharDriver *drv;
2424     int fd;
2425
2426     TFR(fd = open(filename, O_RDWR));
2427     if (fd < 0)
2428         return NULL;
2429
2430     if (ioctl(fd, PPCLAIM) < 0) {
2431         close(fd);
2432         return NULL;
2433     }
2434
2435     drv = qemu_mallocz(sizeof(ParallelCharDriver));
2436     if (!drv) {
2437         close(fd);
2438         return NULL;
2439     }
2440     drv->fd = fd;
2441     drv->mode = IEEE1284_MODE_COMPAT;
2442
2443     chr = qemu_mallocz(sizeof(CharDriverState));
2444     if (!chr) {
2445         qemu_free(drv);
2446         close(fd);
2447         return NULL;
2448     }
2449     chr->chr_write = null_chr_write;
2450     chr->chr_ioctl = pp_ioctl;
2451     chr->chr_close = pp_close;
2452     chr->opaque = drv;
2453
2454     qemu_chr_reset(chr);
2455
2456     return chr;
2457 }
2458 #endif /* __linux__ */
2459
2460 #else /* _WIN32 */
2461
2462 typedef struct {
2463     int max_size;
2464     HANDLE hcom, hrecv, hsend;
2465     OVERLAPPED orecv, osend;
2466     BOOL fpipe;
2467     DWORD len;
2468 } WinCharState;
2469
2470 #define NSENDBUF 2048
2471 #define NRECVBUF 2048
2472 #define MAXCONNECT 1
2473 #define NTIMEOUT 5000
2474
2475 static int win_chr_poll(void *opaque);
2476 static int win_chr_pipe_poll(void *opaque);
2477
2478 static void win_chr_close(CharDriverState *chr)
2479 {
2480     WinCharState *s = chr->opaque;
2481
2482     if (s->hsend) {
2483         CloseHandle(s->hsend);
2484         s->hsend = NULL;
2485     }
2486     if (s->hrecv) {
2487         CloseHandle(s->hrecv);
2488         s->hrecv = NULL;
2489     }
2490     if (s->hcom) {
2491         CloseHandle(s->hcom);
2492         s->hcom = NULL;
2493     }
2494     if (s->fpipe)
2495         qemu_del_polling_cb(win_chr_pipe_poll, chr);
2496     else
2497         qemu_del_polling_cb(win_chr_poll, chr);
2498 }
2499
2500 static int win_chr_init(CharDriverState *chr, const char *filename)
2501 {
2502     WinCharState *s = chr->opaque;
2503     COMMCONFIG comcfg;
2504     COMMTIMEOUTS cto = { 0, 0, 0, 0, 0};
2505     COMSTAT comstat;
2506     DWORD size;
2507     DWORD err;
2508
2509     s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
2510     if (!s->hsend) {
2511         fprintf(stderr, "Failed CreateEvent\n");
2512         goto fail;
2513     }
2514     s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
2515     if (!s->hrecv) {
2516         fprintf(stderr, "Failed CreateEvent\n");
2517         goto fail;
2518     }
2519
2520     s->hcom = CreateFile(filename, GENERIC_READ|GENERIC_WRITE, 0, NULL,
2521                       OPEN_EXISTING, FILE_FLAG_OVERLAPPED, 0);
2522     if (s->hcom == INVALID_HANDLE_VALUE) {
2523         fprintf(stderr, "Failed CreateFile (%lu)\n", GetLastError());
2524         s->hcom = NULL;
2525         goto fail;
2526     }
2527
2528     if (!SetupComm(s->hcom, NRECVBUF, NSENDBUF)) {
2529         fprintf(stderr, "Failed SetupComm\n");
2530         goto fail;
2531     }
2532
2533     ZeroMemory(&comcfg, sizeof(COMMCONFIG));
2534     size = sizeof(COMMCONFIG);
2535     GetDefaultCommConfig(filename, &comcfg, &size);
2536     comcfg.dcb.DCBlength = sizeof(DCB);
2537     CommConfigDialog(filename, NULL, &comcfg);
2538
2539     if (!SetCommState(s->hcom, &comcfg.dcb)) {
2540         fprintf(stderr, "Failed SetCommState\n");
2541         goto fail;
2542     }
2543
2544     if (!SetCommMask(s->hcom, EV_ERR)) {
2545         fprintf(stderr, "Failed SetCommMask\n");
2546         goto fail;
2547     }
2548
2549     cto.ReadIntervalTimeout = MAXDWORD;
2550     if (!SetCommTimeouts(s->hcom, &cto)) {
2551         fprintf(stderr, "Failed SetCommTimeouts\n");
2552         goto fail;
2553     }
2554
2555     if (!ClearCommError(s->hcom, &err, &comstat)) {
2556         fprintf(stderr, "Failed ClearCommError\n");
2557         goto fail;
2558     }
2559     qemu_add_polling_cb(win_chr_poll, chr);
2560     return 0;
2561
2562  fail:
2563     win_chr_close(chr);
2564     return -1;
2565 }
2566
2567 static int win_chr_write(CharDriverState *chr, const uint8_t *buf, int len1)
2568 {
2569     WinCharState *s = chr->opaque;
2570     DWORD len, ret, size, err;
2571
2572     len = len1;
2573     ZeroMemory(&s->osend, sizeof(s->osend));
2574     s->osend.hEvent = s->hsend;
2575     while (len > 0) {
2576         if (s->hsend)
2577             ret = WriteFile(s->hcom, buf, len, &size, &s->osend);
2578         else
2579             ret = WriteFile(s->hcom, buf, len, &size, NULL);
2580         if (!ret) {
2581             err = GetLastError();
2582             if (err == ERROR_IO_PENDING) {
2583                 ret = GetOverlappedResult(s->hcom, &s->osend, &size, TRUE);
2584                 if (ret) {
2585                     buf += size;
2586                     len -= size;
2587                 } else {
2588                     break;
2589                 }
2590             } else {
2591                 break;
2592             }
2593         } else {
2594             buf += size;
2595             len -= size;
2596         }
2597     }
2598     return len1 - len;
2599 }
2600
2601 static int win_chr_read_poll(CharDriverState *chr)
2602 {
2603     WinCharState *s = chr->opaque;
2604
2605     s->max_size = qemu_chr_can_read(chr);
2606     return s->max_size;
2607 }
2608
2609 static void win_chr_readfile(CharDriverState *chr)
2610 {
2611     WinCharState *s = chr->opaque;
2612     int ret, err;
2613     uint8_t buf[1024];
2614     DWORD size;
2615
2616     ZeroMemory(&s->orecv, sizeof(s->orecv));
2617     s->orecv.hEvent = s->hrecv;
2618     ret = ReadFile(s->hcom, buf, s->len, &size, &s->orecv);
2619     if (!ret) {
2620         err = GetLastError();
2621         if (err == ERROR_IO_PENDING) {
2622             ret = GetOverlappedResult(s->hcom, &s->orecv, &size, TRUE);
2623         }
2624     }
2625
2626     if (size > 0) {
2627         qemu_chr_read(chr, buf, size);
2628     }
2629 }
2630
2631 static void win_chr_read(CharDriverState *chr)
2632 {
2633     WinCharState *s = chr->opaque;
2634
2635     if (s->len > s->max_size)
2636         s->len = s->max_size;
2637     if (s->len == 0)
2638         return;
2639
2640     win_chr_readfile(chr);
2641 }
2642
2643 static int win_chr_poll(void *opaque)
2644 {
2645     CharDriverState *chr = opaque;
2646     WinCharState *s = chr->opaque;
2647     COMSTAT status;
2648     DWORD comerr;
2649
2650     ClearCommError(s->hcom, &comerr, &status);
2651     if (status.cbInQue > 0) {
2652         s->len = status.cbInQue;
2653         win_chr_read_poll(chr);
2654         win_chr_read(chr);
2655         return 1;
2656     }
2657     return 0;
2658 }
2659
2660 static CharDriverState *qemu_chr_open_win(const char *filename)
2661 {
2662     CharDriverState *chr;
2663     WinCharState *s;
2664
2665     chr = qemu_mallocz(sizeof(CharDriverState));
2666     if (!chr)
2667         return NULL;
2668     s = qemu_mallocz(sizeof(WinCharState));
2669     if (!s) {
2670         free(chr);
2671         return NULL;
2672     }
2673     chr->opaque = s;
2674     chr->chr_write = win_chr_write;
2675     chr->chr_close = win_chr_close;
2676
2677     if (win_chr_init(chr, filename) < 0) {
2678         free(s);
2679         free(chr);
2680         return NULL;
2681     }
2682     qemu_chr_reset(chr);
2683     return chr;
2684 }
2685
2686 static int win_chr_pipe_poll(void *opaque)
2687 {
2688     CharDriverState *chr = opaque;
2689     WinCharState *s = chr->opaque;
2690     DWORD size;
2691
2692     PeekNamedPipe(s->hcom, NULL, 0, NULL, &size, NULL);
2693     if (size > 0) {
2694         s->len = size;
2695         win_chr_read_poll(chr);
2696         win_chr_read(chr);
2697         return 1;
2698     }
2699     return 0;
2700 }
2701
2702 static int win_chr_pipe_init(CharDriverState *chr, const char *filename)
2703 {
2704     WinCharState *s = chr->opaque;
2705     OVERLAPPED ov;
2706     int ret;
2707     DWORD size;
2708     char openname[256];
2709
2710     s->fpipe = TRUE;
2711
2712     s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
2713     if (!s->hsend) {
2714         fprintf(stderr, "Failed CreateEvent\n");
2715         goto fail;
2716     }
2717     s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
2718     if (!s->hrecv) {
2719         fprintf(stderr, "Failed CreateEvent\n");
2720         goto fail;
2721     }
2722
2723     snprintf(openname, sizeof(openname), "\\\\.\\pipe\\%s", filename);
2724     s->hcom = CreateNamedPipe(openname, PIPE_ACCESS_DUPLEX | FILE_FLAG_OVERLAPPED,
2725                               PIPE_TYPE_BYTE | PIPE_READMODE_BYTE |
2726                               PIPE_WAIT,
2727                               MAXCONNECT, NSENDBUF, NRECVBUF, NTIMEOUT, NULL);
2728     if (s->hcom == INVALID_HANDLE_VALUE) {
2729         fprintf(stderr, "Failed CreateNamedPipe (%lu)\n", GetLastError());
2730         s->hcom = NULL;
2731         goto fail;
2732     }
2733
2734     ZeroMemory(&ov, sizeof(ov));
2735     ov.hEvent = CreateEvent(NULL, TRUE, FALSE, NULL);
2736     ret = ConnectNamedPipe(s->hcom, &ov);
2737     if (ret) {
2738         fprintf(stderr, "Failed ConnectNamedPipe\n");
2739         goto fail;
2740     }
2741
2742     ret = GetOverlappedResult(s->hcom, &ov, &size, TRUE);
2743     if (!ret) {
2744         fprintf(stderr, "Failed GetOverlappedResult\n");
2745         if (ov.hEvent) {
2746             CloseHandle(ov.hEvent);
2747             ov.hEvent = NULL;
2748         }
2749         goto fail;
2750     }
2751
2752     if (ov.hEvent) {
2753         CloseHandle(ov.hEvent);
2754         ov.hEvent = NULL;
2755     }
2756     qemu_add_polling_cb(win_chr_pipe_poll, chr);
2757     return 0;
2758
2759  fail:
2760     win_chr_close(chr);
2761     return -1;
2762 }
2763
2764
2765 static CharDriverState *qemu_chr_open_win_pipe(const char *filename)
2766 {
2767     CharDriverState *chr;
2768     WinCharState *s;
2769
2770     chr = qemu_mallocz(sizeof(CharDriverState));
2771     if (!chr)
2772         return NULL;
2773     s = qemu_mallocz(sizeof(WinCharState));
2774     if (!s) {
2775         free(chr);
2776         return NULL;
2777     }
2778     chr->opaque = s;
2779     chr->chr_write = win_chr_write;
2780     chr->chr_close = win_chr_close;
2781
2782     if (win_chr_pipe_init(chr, filename) < 0) {
2783         free(s);
2784         free(chr);
2785         return NULL;
2786     }
2787     qemu_chr_reset(chr);
2788     return chr;
2789 }
2790
2791 static CharDriverState *qemu_chr_open_win_file(HANDLE fd_out)
2792 {
2793     CharDriverState *chr;
2794     WinCharState *s;
2795
2796     chr = qemu_mallocz(sizeof(CharDriverState));
2797     if (!chr)
2798         return NULL;
2799     s = qemu_mallocz(sizeof(WinCharState));
2800     if (!s) {
2801         free(chr);
2802         return NULL;
2803     }
2804     s->hcom = fd_out;
2805     chr->opaque = s;
2806     chr->chr_write = win_chr_write;
2807     qemu_chr_reset(chr);
2808     return chr;
2809 }
2810
2811 static CharDriverState *qemu_chr_open_win_con(const char *filename)
2812 {
2813     return qemu_chr_open_win_file(GetStdHandle(STD_OUTPUT_HANDLE));
2814 }
2815
2816 static CharDriverState *qemu_chr_open_win_file_out(const char *file_out)
2817 {
2818     HANDLE fd_out;
2819
2820     fd_out = CreateFile(file_out, GENERIC_WRITE, FILE_SHARE_READ, NULL,
2821                         OPEN_ALWAYS, FILE_ATTRIBUTE_NORMAL, NULL);
2822     if (fd_out == INVALID_HANDLE_VALUE)
2823         return NULL;
2824
2825     return qemu_chr_open_win_file(fd_out);
2826 }
2827 #endif /* !_WIN32 */
2828
2829 /***********************************************************/
2830 /* UDP Net console */
2831
2832 typedef struct {
2833     int fd;
2834     struct sockaddr_in daddr;
2835     char buf[1024];
2836     int bufcnt;
2837     int bufptr;
2838     int max_size;
2839 } NetCharDriver;
2840
2841 static int udp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
2842 {
2843     NetCharDriver *s = chr->opaque;
2844
2845     return sendto(s->fd, buf, len, 0,
2846                   (struct sockaddr *)&s->daddr, sizeof(struct sockaddr_in));
2847 }
2848
2849 static int udp_chr_read_poll(void *opaque)
2850 {
2851     CharDriverState *chr = opaque;
2852     NetCharDriver *s = chr->opaque;
2853
2854     s->max_size = qemu_chr_can_read(chr);
2855
2856     /* If there were any stray characters in the queue process them
2857      * first
2858      */
2859     while (s->max_size > 0 && s->bufptr < s->bufcnt) {
2860         qemu_chr_read(chr, &s->buf[s->bufptr], 1);
2861         s->bufptr++;
2862         s->max_size = qemu_chr_can_read(chr);
2863     }
2864     return s->max_size;
2865 }
2866
2867 static void udp_chr_read(void *opaque)
2868 {
2869     CharDriverState *chr = opaque;
2870     NetCharDriver *s = chr->opaque;
2871
2872     if (s->max_size == 0)
2873         return;
2874     s->bufcnt = recv(s->fd, s->buf, sizeof(s->buf), 0);
2875     s->bufptr = s->bufcnt;
2876     if (s->bufcnt <= 0)
2877         return;
2878
2879     s->bufptr = 0;
2880     while (s->max_size > 0 && s->bufptr < s->bufcnt) {
2881         qemu_chr_read(chr, &s->buf[s->bufptr], 1);
2882         s->bufptr++;
2883         s->max_size = qemu_chr_can_read(chr);
2884     }
2885 }
2886
2887 static void udp_chr_update_read_handler(CharDriverState *chr)
2888 {
2889     NetCharDriver *s = chr->opaque;
2890
2891     if (s->fd >= 0) {
2892         qemu_set_fd_handler2(s->fd, udp_chr_read_poll,
2893                              udp_chr_read, NULL, chr);
2894     }
2895 }
2896
2897 int parse_host_port(struct sockaddr_in *saddr, const char *str);
2898 #ifndef _WIN32
2899 static int parse_unix_path(struct sockaddr_un *uaddr, const char *str);
2900 #endif
2901 int parse_host_src_port(struct sockaddr_in *haddr,
2902                         struct sockaddr_in *saddr,
2903                         const char *str);
2904
2905 static CharDriverState *qemu_chr_open_udp(const char *def)
2906 {
2907     CharDriverState *chr = NULL;
2908     NetCharDriver *s = NULL;
2909     int fd = -1;
2910     struct sockaddr_in saddr;
2911
2912     chr = qemu_mallocz(sizeof(CharDriverState));
2913     if (!chr)
2914         goto return_err;
2915     s = qemu_mallocz(sizeof(NetCharDriver));
2916     if (!s)
2917         goto return_err;
2918
2919     fd = socket(PF_INET, SOCK_DGRAM, 0);
2920     if (fd < 0) {
2921         perror("socket(PF_INET, SOCK_DGRAM)");
2922         goto return_err;
2923     }
2924
2925     if (parse_host_src_port(&s->daddr, &saddr, def) < 0) {
2926         printf("Could not parse: %s\n", def);
2927         goto return_err;
2928     }
2929
2930     if (bind(fd, (struct sockaddr *)&saddr, sizeof(saddr)) < 0)
2931     {
2932         perror("bind");
2933         goto return_err;
2934     }
2935
2936     s->fd = fd;
2937     s->bufcnt = 0;
2938     s->bufptr = 0;
2939     chr->opaque = s;
2940     chr->chr_write = udp_chr_write;
2941     chr->chr_update_read_handler = udp_chr_update_read_handler;
2942     return chr;
2943
2944 return_err:
2945     if (chr)
2946         free(chr);
2947     if (s)
2948         free(s);
2949     if (fd >= 0)
2950         closesocket(fd);
2951     return NULL;
2952 }
2953
2954 /***********************************************************/
2955 /* TCP Net console */
2956
2957 typedef struct {
2958     int fd, listen_fd;
2959     int connected;
2960     int max_size;
2961     int do_telnetopt;
2962     int do_nodelay;
2963     int is_unix;
2964 } TCPCharDriver;
2965
2966 static void tcp_chr_accept(void *opaque);
2967
2968 static int tcp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
2969 {
2970     TCPCharDriver *s = chr->opaque;
2971     if (s->connected) {
2972         return send_all(s->fd, buf, len);
2973     } else {
2974         /* XXX: indicate an error ? */
2975         return len;
2976     }
2977 }
2978
2979 static int tcp_chr_read_poll(void *opaque)
2980 {
2981     CharDriverState *chr = opaque;
2982     TCPCharDriver *s = chr->opaque;
2983     if (!s->connected)
2984         return 0;
2985     s->max_size = qemu_chr_can_read(chr);
2986     return s->max_size;
2987 }
2988
2989 #define IAC 255
2990 #define IAC_BREAK 243
2991 static void tcp_chr_process_IAC_bytes(CharDriverState *chr,
2992                                       TCPCharDriver *s,
2993                                       char *buf, int *size)
2994 {
2995     /* Handle any telnet client's basic IAC options to satisfy char by
2996      * char mode with no echo.  All IAC options will be removed from
2997      * the buf and the do_telnetopt variable will be used to track the
2998      * state of the width of the IAC information.
2999      *
3000      * IAC commands come in sets of 3 bytes with the exception of the
3001      * "IAC BREAK" command and the double IAC.
3002      */
3003
3004     int i;
3005     int j = 0;
3006
3007     for (i = 0; i < *size; i++) {
3008         if (s->do_telnetopt > 1) {
3009             if ((unsigned char)buf[i] == IAC && s->do_telnetopt == 2) {
3010                 /* Double IAC means send an IAC */
3011                 if (j != i)
3012                     buf[j] = buf[i];
3013                 j++;
3014                 s->do_telnetopt = 1;
3015             } else {
3016                 if ((unsigned char)buf[i] == IAC_BREAK && s->do_telnetopt == 2) {
3017                     /* Handle IAC break commands by sending a serial break */
3018                     qemu_chr_event(chr, CHR_EVENT_BREAK);
3019                     s->do_telnetopt++;
3020                 }
3021                 s->do_telnetopt++;
3022             }
3023             if (s->do_telnetopt >= 4) {
3024                 s->do_telnetopt = 1;
3025             }
3026         } else {
3027             if ((unsigned char)buf[i] == IAC) {
3028                 s->do_telnetopt = 2;
3029             } else {
3030                 if (j != i)
3031                     buf[j] = buf[i];
3032                 j++;
3033             }
3034         }
3035     }
3036     *size = j;
3037 }
3038
3039 static void tcp_chr_read(void *opaque)
3040 {
3041     CharDriverState *chr = opaque;
3042     TCPCharDriver *s = chr->opaque;
3043     uint8_t buf[1024];
3044     int len, size;
3045
3046     if (!s->connected || s->max_size <= 0)
3047         return;
3048     len = sizeof(buf);
3049     if (len > s->max_size)
3050         len = s->max_size;
3051     size = recv(s->fd, buf, len, 0);
3052     if (size == 0) {
3053         /* connection closed */
3054         s->connected = 0;
3055         if (s->listen_fd >= 0) {
3056             qemu_set_fd_handler(s->listen_fd, tcp_chr_accept, NULL, chr);
3057         }
3058         qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
3059         closesocket(s->fd);
3060         s->fd = -1;
3061     } else if (size > 0) {
3062         if (s->do_telnetopt)
3063             tcp_chr_process_IAC_bytes(chr, s, buf, &size);
3064         if (size > 0)
3065             qemu_chr_read(chr, buf, size);
3066     }
3067 }
3068
3069 static void tcp_chr_connect(void *opaque)
3070 {
3071     CharDriverState *chr = opaque;
3072     TCPCharDriver *s = chr->opaque;
3073
3074     s->connected = 1;
3075     qemu_set_fd_handler2(s->fd, tcp_chr_read_poll,
3076                          tcp_chr_read, NULL, chr);
3077     qemu_chr_reset(chr);
3078 }
3079
3080 #define IACSET(x,a,b,c) x[0] = a; x[1] = b; x[2] = c;
3081 static void tcp_chr_telnet_init(int fd)
3082 {
3083     char buf[3];
3084     /* Send the telnet negotion to put telnet in binary, no echo, single char mode */
3085     IACSET(buf, 0xff, 0xfb, 0x01);  /* IAC WILL ECHO */
3086     send(fd, (char *)buf, 3, 0);
3087     IACSET(buf, 0xff, 0xfb, 0x03);  /* IAC WILL Suppress go ahead */
3088     send(fd, (char *)buf, 3, 0);
3089     IACSET(buf, 0xff, 0xfb, 0x00);  /* IAC WILL Binary */
3090     send(fd, (char *)buf, 3, 0);
3091     IACSET(buf, 0xff, 0xfd, 0x00);  /* IAC DO Binary */
3092     send(fd, (char *)buf, 3, 0);
3093 }
3094
3095 static void socket_set_nodelay(int fd)
3096 {
3097     int val = 1;
3098     setsockopt(fd, IPPROTO_TCP, TCP_NODELAY, (char *)&val, sizeof(val));
3099 }
3100
3101 static void tcp_chr_accept(void *opaque)
3102 {
3103     CharDriverState *chr = opaque;
3104     TCPCharDriver *s = chr->opaque;
3105     struct sockaddr_in saddr;
3106 #ifndef _WIN32
3107     struct sockaddr_un uaddr;
3108 #endif
3109     struct sockaddr *addr;
3110     socklen_t len;
3111     int fd;
3112
3113     for(;;) {
3114 #ifndef _WIN32
3115         if (s->is_unix) {
3116             len = sizeof(uaddr);
3117             addr = (struct sockaddr *)&uaddr;
3118         } else
3119 #endif
3120         {
3121             len = sizeof(saddr);
3122             addr = (struct sockaddr *)&saddr;
3123         }
3124         fd = accept(s->listen_fd, addr, &len);
3125         if (fd < 0 && errno != EINTR) {
3126             return;
3127         } else if (fd >= 0) {
3128             if (s->do_telnetopt)
3129                 tcp_chr_telnet_init(fd);
3130             break;
3131         }
3132     }
3133     socket_set_nonblock(fd);
3134     if (s->do_nodelay)
3135         socket_set_nodelay(fd);
3136     s->fd = fd;
3137     qemu_set_fd_handler(s->listen_fd, NULL, NULL, NULL);
3138     tcp_chr_connect(chr);
3139 }
3140
3141 static void tcp_chr_close(CharDriverState *chr)
3142 {
3143     TCPCharDriver *s = chr->opaque;
3144     if (s->fd >= 0)
3145         closesocket(s->fd);
3146     if (s->listen_fd >= 0)
3147         closesocket(s->listen_fd);
3148     qemu_free(s);
3149 }
3150
3151 static CharDriverState *qemu_chr_open_tcp(const char *host_str,
3152                                           int is_telnet,
3153                                           int is_unix)
3154 {
3155     CharDriverState *chr = NULL;
3156     TCPCharDriver *s = NULL;
3157     int fd = -1, ret, err, val;
3158     int is_listen = 0;
3159     int is_waitconnect = 1;
3160     int do_nodelay = 0;
3161     const char *ptr;
3162     struct sockaddr_in saddr;
3163 #ifndef _WIN32
3164     struct sockaddr_un uaddr;
3165 #endif
3166     struct sockaddr *addr;
3167     socklen_t addrlen;
3168
3169 #ifndef _WIN32
3170     if (is_unix) {
3171         addr = (struct sockaddr *)&uaddr;
3172         addrlen = sizeof(uaddr);
3173         if (parse_unix_path(&uaddr, host_str) < 0)
3174             goto fail;
3175     } else
3176 #endif
3177     {
3178         addr = (struct sockaddr *)&saddr;
3179         addrlen = sizeof(saddr);
3180         if (parse_host_port(&saddr, host_str) < 0)
3181             goto fail;
3182     }
3183
3184     ptr = host_str;
3185     while((ptr = strchr(ptr,','))) {
3186         ptr++;
3187         if (!strncmp(ptr,"server",6)) {
3188             is_listen = 1;
3189         } else if (!strncmp(ptr,"nowait",6)) {
3190             is_waitconnect = 0;
3191         } else if (!strncmp(ptr,"nodelay",6)) {
3192             do_nodelay = 1;
3193         } else {
3194             printf("Unknown option: %s\n", ptr);
3195             goto fail;
3196         }
3197     }
3198     if (!is_listen)
3199         is_waitconnect = 0;
3200
3201     chr = qemu_mallocz(sizeof(CharDriverState));
3202     if (!chr)
3203         goto fail;
3204     s = qemu_mallocz(sizeof(TCPCharDriver));
3205     if (!s)
3206         goto fail;
3207
3208 #ifndef _WIN32
3209     if (is_unix)
3210         fd = socket(PF_UNIX, SOCK_STREAM, 0);
3211     else
3212 #endif
3213         fd = socket(PF_INET, SOCK_STREAM, 0);
3214
3215     if (fd < 0)
3216         goto fail;
3217
3218     if (!is_waitconnect)
3219         socket_set_nonblock(fd);
3220
3221     s->connected = 0;
3222     s->fd = -1;
3223     s->listen_fd = -1;
3224     s->is_unix = is_unix;
3225     s->do_nodelay = do_nodelay && !is_unix;
3226
3227     chr->opaque = s;
3228     chr->chr_write = tcp_chr_write;
3229     chr->chr_close = tcp_chr_close;
3230
3231     if (is_listen) {
3232         /* allow fast reuse */
3233 #ifndef _WIN32
3234         if (is_unix) {
3235             char path[109];
3236             strncpy(path, uaddr.sun_path, 108);
3237             path[108] = 0;
3238             unlink(path);
3239         } else
3240 #endif
3241         {
3242             val = 1;
3243             setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, (const char *)&val, sizeof(val));
3244         }
3245
3246         ret = bind(fd, addr, addrlen);
3247         if (ret < 0)
3248             goto fail;
3249
3250         ret = listen(fd, 0);
3251         if (ret < 0)
3252             goto fail;
3253
3254         s->listen_fd = fd;
3255         qemu_set_fd_handler(s->listen_fd, tcp_chr_accept, NULL, chr);
3256         if (is_telnet)
3257             s->do_telnetopt = 1;
3258     } else {
3259         for(;;) {
3260             ret = connect(fd, addr, addrlen);
3261             if (ret < 0) {
3262                 err = socket_error();
3263                 if (err == EINTR || err == EWOULDBLOCK) {
3264                 } else if (err == EINPROGRESS) {
3265                     break;
3266 #ifdef _WIN32
3267                 } else if (err == WSAEALREADY) {
3268                     break;
3269 #endif
3270                 } else {
3271                     goto fail;
3272                 }
3273             } else {
3274                 s->connected = 1;
3275                 break;
3276             }
3277         }
3278         s->fd = fd;
3279         socket_set_nodelay(fd);
3280         if (s->connected)
3281             tcp_chr_connect(chr);
3282         else
3283             qemu_set_fd_handler(s->fd, NULL, tcp_chr_connect, chr);
3284     }
3285
3286     if (is_listen && is_waitconnect) {
3287         printf("QEMU waiting for connection on: %s\n", host_str);
3288         tcp_chr_accept(chr);
3289         socket_set_nonblock(s->listen_fd);
3290     }
3291
3292     return chr;
3293  fail:
3294     if (fd >= 0)
3295         closesocket(fd);
3296     qemu_free(s);
3297     qemu_free(chr);
3298     return NULL;
3299 }
3300
3301 CharDriverState *qemu_chr_open(const char *filename)
3302 {
3303     const char *p;
3304
3305     if (!strcmp(filename, "vc")) {
3306         return text_console_init(&display_state, 0);
3307     } else if (strstart(filename, "vc:", &p)) {
3308         return text_console_init(&display_state, p);
3309     } else if (!strcmp(filename, "null")) {
3310         return qemu_chr_open_null();
3311     } else
3312     if (strstart(filename, "tcp:", &p)) {
3313         return qemu_chr_open_tcp(p, 0, 0);
3314     } else
3315     if (strstart(filename, "telnet:", &p)) {
3316         return qemu_chr_open_tcp(p, 1, 0);
3317     } else
3318     if (strstart(filename, "udp:", &p)) {
3319         return qemu_chr_open_udp(p);
3320     } else
3321     if (strstart(filename, "mon:", &p)) {
3322         CharDriverState *drv = qemu_chr_open(p);
3323         if (drv) {
3324             drv = qemu_chr_open_mux(drv);
3325             monitor_init(drv, !nographic);
3326             return drv;
3327         }
3328         printf("Unable to open driver: %s\n", p);
3329         return 0;
3330     } else
3331 #ifndef _WIN32
3332     if (strstart(filename, "unix:", &p)) {
3333         return qemu_chr_open_tcp(p, 0, 1);
3334     } else if (strstart(filename, "file:", &p)) {
3335         return qemu_chr_open_file_out(p);
3336     } else if (strstart(filename, "pipe:", &p)) {
3337         return qemu_chr_open_pipe(p);
3338     } else if (!strcmp(filename, "pty")) {
3339         return qemu_chr_open_pty();
3340     } else if (!strcmp(filename, "stdio")) {
3341         return qemu_chr_open_stdio();
3342     } else
3343 #if defined(__linux__)
3344     if (strstart(filename, "/dev/parport", NULL)) {
3345         return qemu_chr_open_pp(filename);
3346     } else
3347 #endif
3348 #if defined(__linux__) || defined(__sun__)
3349     if (strstart(filename, "/dev/", NULL)) {
3350         return qemu_chr_open_tty(filename);
3351     } else
3352 #endif
3353 #else /* !_WIN32 */
3354     if (strstart(filename, "COM", NULL)) {
3355         return qemu_chr_open_win(filename);
3356     } else
3357     if (strstart(filename, "pipe:", &p)) {
3358         return qemu_chr_open_win_pipe(p);
3359     } else
3360     if (strstart(filename, "con:", NULL)) {
3361         return qemu_chr_open_win_con(filename);
3362     } else
3363     if (strstart(filename, "file:", &p)) {
3364         return qemu_chr_open_win_file_out(p);
3365     }
3366 #endif
3367     {
3368         return NULL;
3369     }
3370 }
3371
3372 void qemu_chr_close(CharDriverState *chr)
3373 {
3374     if (chr->chr_close)
3375         chr->chr_close(chr);
3376 }
3377
3378 /***********************************************************/
3379 /* network device redirectors */
3380
3381 void hex_dump(FILE *f, const uint8_t *buf, int size)
3382 {
3383     int len, i, j, c;
3384
3385     for(i=0;i<size;i+=16) {
3386         len = size - i;
3387         if (len > 16)
3388             len = 16;
3389         fprintf(f, "%08x ", i);
3390         for(j=0;j<16;j++) {
3391             if (j < len)
3392                 fprintf(f, " %02x", buf[i+j]);
3393             else
3394                 fprintf(f, "   ");
3395         }
3396         fprintf(f, " ");
3397         for(j=0;j<len;j++) {
3398             c = buf[i+j];
3399             if (c < ' ' || c > '~')
3400                 c = '.';
3401             fprintf(f, "%c", c);
3402         }
3403         fprintf(f, "\n");
3404     }
3405 }
3406
3407 static int parse_macaddr(uint8_t *macaddr, const char *p)
3408 {
3409     int i;
3410     for(i = 0; i < 6; i++) {
3411         macaddr[i] = strtol(p, (char **)&p, 16);
3412         if (i == 5) {
3413             if (*p != '\0')
3414                 return -1;
3415         } else {
3416             if (*p != ':')
3417                 return -1;
3418             p++;
3419         }
3420     }
3421     return 0;
3422 }
3423
3424 static int get_str_sep(char *buf, int buf_size, const char **pp, int sep)
3425 {
3426     const char *p, *p1;
3427     int len;
3428     p = *pp;
3429     p1 = strchr(p, sep);
3430     if (!p1)
3431         return -1;
3432     len = p1 - p;
3433     p1++;
3434     if (buf_size > 0) {
3435         if (len > buf_size - 1)
3436             len = buf_size - 1;
3437         memcpy(buf, p, len);
3438         buf[len] = '\0';
3439     }
3440     *pp = p1;
3441     return 0;
3442 }
3443
3444 int parse_host_src_port(struct sockaddr_in *haddr,
3445                         struct sockaddr_in *saddr,
3446                         const char *input_str)
3447 {
3448     char *str = strdup(input_str);
3449     char *host_str = str;
3450     char *src_str;
3451     char *ptr;
3452
3453     /*
3454      * Chop off any extra arguments at the end of the string which
3455      * would start with a comma, then fill in the src port information
3456      * if it was provided else use the "any address" and "any port".
3457      */
3458     if ((ptr = strchr(str,',')))
3459         *ptr = '\0';
3460
3461     if ((src_str = strchr(input_str,'@'))) {
3462         *src_str = '\0';
3463         src_str++;
3464     }
3465
3466     if (parse_host_port(haddr, host_str) < 0)
3467         goto fail;
3468
3469     if (!src_str || *src_str == '\0')
3470         src_str = ":0";
3471
3472     if (parse_host_port(saddr, src_str) < 0)
3473         goto fail;
3474
3475     free(str);
3476     return(0);
3477
3478 fail:
3479     free(str);
3480     return -1;
3481 }
3482
3483 int parse_host_port(struct sockaddr_in *saddr, const char *str)
3484 {
3485     char buf[512];
3486     struct hostent *he;
3487     const char *p, *r;
3488     int port;
3489
3490     p = str;
3491     if (get_str_sep(buf, sizeof(buf), &p, ':') < 0)
3492         return -1;
3493     saddr->sin_family = AF_INET;
3494     if (buf[0] == '\0') {
3495         saddr->sin_addr.s_addr = 0;
3496     } else {
3497         if (isdigit(buf[0])) {
3498             if (!inet_aton(buf, &saddr->sin_addr))
3499                 return -1;
3500         } else {
3501             if ((he = gethostbyname(buf)) == NULL)
3502                 return - 1;
3503             saddr->sin_addr = *(struct in_addr *)he->h_addr;
3504         }
3505     }
3506     port = strtol(p, (char **)&r, 0);
3507     if (r == p)
3508         return -1;
3509     saddr->sin_port = htons(port);
3510     return 0;
3511 }
3512
3513 #ifndef _WIN32
3514 static int parse_unix_path(struct sockaddr_un *uaddr, const char *str)
3515 {
3516     const char *p;
3517     int len;
3518
3519     len = MIN(108, strlen(str));
3520     p = strchr(str, ',');
3521     if (p)
3522         len = MIN(len, p - str);
3523
3524     memset(uaddr, 0, sizeof(*uaddr));
3525
3526     uaddr->sun_family = AF_UNIX;
3527     memcpy(uaddr->sun_path, str, len);
3528
3529     return 0;
3530 }
3531 #endif
3532
3533 /* find or alloc a new VLAN */
3534 VLANState *qemu_find_vlan(int id)
3535 {
3536     VLANState **pvlan, *vlan;
3537     for(vlan = first_vlan; vlan != NULL; vlan = vlan->next) {
3538         if (vlan->id == id)
3539             return vlan;
3540     }
3541     vlan = qemu_mallocz(sizeof(VLANState));
3542     if (!vlan)
3543         return NULL;
3544     vlan->id = id;
3545     vlan->next = NULL;
3546     pvlan = &first_vlan;
3547     while (*pvlan != NULL)
3548         pvlan = &(*pvlan)->next;
3549     *pvlan = vlan;
3550     return vlan;
3551 }
3552
3553 VLANClientState *qemu_new_vlan_client(VLANState *vlan,
3554                                       IOReadHandler *fd_read,
3555                                       IOCanRWHandler *fd_can_read,
3556                                       void *opaque)
3557 {
3558     VLANClientState *vc, **pvc;
3559     vc = qemu_mallocz(sizeof(VLANClientState));
3560     if (!vc)
3561         return NULL;
3562     vc->fd_read = fd_read;
3563     vc->fd_can_read = fd_can_read;
3564     vc->opaque = opaque;
3565     vc->vlan = vlan;
3566
3567     vc->next = NULL;
3568     pvc = &vlan->first_client;
3569     while (*pvc != NULL)
3570         pvc = &(*pvc)->next;
3571     *pvc = vc;
3572     return vc;
3573 }
3574
3575 int qemu_can_send_packet(VLANClientState *vc1)
3576 {
3577     VLANState *vlan = vc1->vlan;
3578     VLANClientState *vc;
3579
3580     for(vc = vlan->first_client; vc != NULL; vc = vc->next) {
3581         if (vc != vc1) {
3582             if (vc->fd_can_read && vc->fd_can_read(vc->opaque))
3583                 return 1;
3584         }
3585     }
3586     return 0;
3587 }
3588
3589 void qemu_send_packet(VLANClientState *vc1, const uint8_t *buf, int size)
3590 {
3591     VLANState *vlan = vc1->vlan;
3592     VLANClientState *vc;
3593
3594 #if 0
3595     printf("vlan %d send:\n", vlan->id);
3596     hex_dump(stdout, buf, size);
3597 #endif
3598     for(vc = vlan->first_client; vc != NULL; vc = vc->next) {
3599         if (vc != vc1) {
3600             vc->fd_read(vc->opaque, buf, size);
3601         }
3602     }
3603 }
3604
3605 #if defined(CONFIG_SLIRP)
3606
3607 /* slirp network adapter */
3608
3609 static int slirp_inited;
3610 static VLANClientState *slirp_vc;
3611
3612 int slirp_can_output(void)
3613 {
3614     return !slirp_vc || qemu_can_send_packet(slirp_vc);
3615 }
3616
3617 void slirp_output(const uint8_t *pkt, int pkt_len)
3618 {
3619 #if 0
3620     printf("slirp output:\n");
3621     hex_dump(stdout, pkt, pkt_len);
3622 #endif
3623     if (!slirp_vc)
3624         return;
3625     qemu_send_packet(slirp_vc, pkt, pkt_len);
3626 }
3627
3628 static void slirp_receive(void *opaque, const uint8_t *buf, int size)
3629 {
3630 #if 0
3631     printf("slirp input:\n");
3632     hex_dump(stdout, buf, size);
3633 #endif
3634     slirp_input(buf, size);
3635 }
3636
3637 static int net_slirp_init(VLANState *vlan)
3638 {
3639     if (!slirp_inited) {
3640         slirp_inited = 1;
3641         slirp_init();
3642     }
3643     slirp_vc = qemu_new_vlan_client(vlan,
3644                                     slirp_receive, NULL, NULL);
3645     snprintf(slirp_vc->info_str, sizeof(slirp_vc->info_str), "user redirector");
3646     return 0;
3647 }
3648
3649 static void net_slirp_redir(const char *redir_str)
3650 {
3651     int is_udp;
3652     char buf[256], *r;
3653     const char *p;
3654     struct in_addr guest_addr;
3655     int host_port, guest_port;
3656
3657     if (!slirp_inited) {
3658         slirp_inited = 1;
3659         slirp_init();
3660     }
3661
3662     p = redir_str;
3663     if (get_str_sep(buf, sizeof(buf), &p, ':') < 0)
3664         goto fail;
3665     if (!strcmp(buf, "tcp")) {
3666         is_udp = 0;
3667     } else if (!strcmp(buf, "udp")) {
3668         is_udp = 1;
3669     } else {
3670         goto fail;
3671     }
3672
3673     if (get_str_sep(buf, sizeof(buf), &p, ':') < 0)
3674         goto fail;
3675     host_port = strtol(buf, &r, 0);
3676     if (r == buf)
3677         goto fail;
3678
3679     if (get_str_sep(buf, sizeof(buf), &p, ':') < 0)
3680         goto fail;
3681     if (buf[0] == '\0') {
3682         pstrcpy(buf, sizeof(buf), "10.0.2.15");
3683     }
3684     if (!inet_aton(buf, &guest_addr))
3685         goto fail;
3686
3687     guest_port = strtol(p, &r, 0);
3688     if (r == p)
3689         goto fail;
3690
3691     if (slirp_redir(is_udp, host_port, guest_addr, guest_port) < 0) {
3692         fprintf(stderr, "qemu: could not set up redirection\n");
3693         exit(1);
3694     }
3695     return;
3696  fail:
3697     fprintf(stderr, "qemu: syntax: -redir [tcp|udp]:host-port:[guest-host]:guest-port\n");
3698     exit(1);
3699 }
3700
3701 #ifndef _WIN32
3702
3703 char smb_dir[1024];
3704
3705 static void smb_exit(void)
3706 {
3707     DIR *d;
3708     struct dirent *de;
3709     char filename[1024];
3710
3711     /* erase all the files in the directory */
3712     d = opendir(smb_dir);
3713     for(;;) {
3714         de = readdir(d);
3715         if (!de)
3716             break;
3717         if (strcmp(de->d_name, ".") != 0 &&
3718             strcmp(de->d_name, "..") != 0) {
3719             snprintf(filename, sizeof(filename), "%s/%s",
3720                      smb_dir, de->d_name);
3721             unlink(filename);
3722         }
3723     }
3724     closedir(d);
3725     rmdir(smb_dir);
3726 }
3727
3728 /* automatic user mode samba server configuration */
3729 void net_slirp_smb(const char *exported_dir)
3730 {
3731     char smb_conf[1024];
3732     char smb_cmdline[1024];
3733     FILE *f;
3734
3735     if (!slirp_inited) {
3736         slirp_inited = 1;
3737         slirp_init();
3738     }
3739
3740     /* XXX: better tmp dir construction */
3741     snprintf(smb_dir, sizeof(smb_dir), "/tmp/qemu-smb.%d", getpid());
3742     if (mkdir(smb_dir, 0700) < 0) {
3743         fprintf(stderr, "qemu: could not create samba server dir '%s'\n", smb_dir);
3744         exit(1);
3745     }
3746     snprintf(smb_conf, sizeof(smb_conf), "%s/%s", smb_dir, "smb.conf");
3747
3748     f = fopen(smb_conf, "w");
3749     if (!f) {
3750         fprintf(stderr, "qemu: could not create samba server configuration file '%s'\n", smb_conf);
3751         exit(1);
3752     }
3753     fprintf(f,
3754             "[global]\n"
3755             "private dir=%s\n"
3756             "smb ports=0\n"
3757             "socket address=127.0.0.1\n"
3758             "pid directory=%s\n"
3759             "lock directory=%s\n"
3760             "log file=%s/log.smbd\n"
3761             "smb passwd file=%s/smbpasswd\n"
3762             "security = share\n"
3763             "[qemu]\n"
3764             "path=%s\n"
3765             "read only=no\n"
3766             "guest ok=yes\n",
3767             smb_dir,
3768             smb_dir,
3769             smb_dir,
3770             smb_dir,
3771             smb_dir,
3772             exported_dir
3773             );
3774     fclose(f);
3775     atexit(smb_exit);
3776
3777     snprintf(smb_cmdline, sizeof(smb_cmdline), "%s -s %s",
3778              SMBD_COMMAND, smb_conf);
3779
3780     slirp_add_exec(0, smb_cmdline, 4, 139);
3781 }
3782
3783 #endif /* !defined(_WIN32) */
3784
3785 #endif /* CONFIG_SLIRP */
3786
3787 #if !defined(_WIN32)
3788
3789 typedef struct TAPState {
3790     VLANClientState *vc;
3791     int fd;
3792 } TAPState;
3793
3794 static void tap_receive(void *opaque, const uint8_t *buf, int size)
3795 {
3796     TAPState *s = opaque;
3797     int ret;
3798     for(;;) {
3799         ret = write(s->fd, buf, size);
3800         if (ret < 0 && (errno == EINTR || errno == EAGAIN)) {
3801         } else {
3802             break;
3803         }
3804     }
3805 }
3806
3807 static void tap_send(void *opaque)
3808 {
3809     TAPState *s = opaque;
3810     uint8_t buf[4096];
3811     int size;
3812
3813 #ifdef __sun__
3814     struct strbuf sbuf;
3815     int f = 0;
3816     sbuf.maxlen = sizeof(buf);
3817     sbuf.buf = buf;
3818     size = getmsg(s->fd, NULL, &sbuf, &f) >=0 ? sbuf.len : -1;
3819 #else
3820     size = read(s->fd, buf, sizeof(buf));
3821 #endif
3822     if (size > 0) {
3823         qemu_send_packet(s->vc, buf, size);
3824     }
3825 }
3826
3827 /* fd support */
3828
3829 static TAPState *net_tap_fd_init(VLANState *vlan, int fd)
3830 {
3831     TAPState *s;
3832
3833     s = qemu_mallocz(sizeof(TAPState));
3834     if (!s)
3835         return NULL;
3836     s->fd = fd;
3837     s->vc = qemu_new_vlan_client(vlan, tap_receive, NULL, s);
3838     qemu_set_fd_handler(s->fd, tap_send, NULL, s);
3839     snprintf(s->vc->info_str, sizeof(s->vc->info_str), "tap: fd=%d", fd);
3840     return s;
3841 }
3842
3843 #if defined (_BSD) || defined (__FreeBSD_kernel__)
3844 static int tap_open(char *ifname, int ifname_size)
3845 {
3846     int fd;
3847     char *dev;
3848     struct stat s;
3849
3850     TFR(fd = open("/dev/tap", O_RDWR));
3851     if (fd < 0) {
3852         fprintf(stderr, "warning: could not open /dev/tap: no virtual network emulation\n");
3853         return -1;
3854     }
3855
3856     fstat(fd, &s);
3857     dev = devname(s.st_rdev, S_IFCHR);
3858     pstrcpy(ifname, ifname_size, dev);
3859
3860     fcntl(fd, F_SETFL, O_NONBLOCK);
3861     return fd;
3862 }
3863 #elif defined(__sun__)
3864 #define TUNNEWPPA       (('T'<<16) | 0x0001)
3865 /*
3866  * Allocate TAP device, returns opened fd.
3867  * Stores dev name in the first arg(must be large enough).
3868  */
3869 int tap_alloc(char *dev)
3870 {
3871     int tap_fd, if_fd, ppa = -1;
3872     static int ip_fd = 0;
3873     char *ptr;
3874
3875     static int arp_fd = 0;
3876     int ip_muxid, arp_muxid;
3877     struct strioctl  strioc_if, strioc_ppa;
3878     int link_type = I_PLINK;;
3879     struct lifreq ifr;
3880     char actual_name[32] = "";
3881
3882     memset(&ifr, 0x0, sizeof(ifr));
3883
3884     if( *dev ){
3885        ptr = dev;
3886        while( *ptr && !isdigit((int)*ptr) ) ptr++;
3887        ppa = atoi(ptr);
3888     }
3889
3890     /* Check if IP device was opened */
3891     if( ip_fd )
3892        close(ip_fd);
3893
3894     TFR(ip_fd = open("/dev/udp", O_RDWR, 0));
3895     if (ip_fd < 0) {
3896        syslog(LOG_ERR, "Can't open /dev/ip (actually /dev/udp)");
3897        return -1;
3898     }
3899
3900     TFR(tap_fd = open("/dev/tap", O_RDWR, 0));
3901     if (tap_fd < 0) {
3902        syslog(LOG_ERR, "Can't open /dev/tap");
3903        return -1;
3904     }
3905
3906     /* Assign a new PPA and get its unit number. */
3907     strioc_ppa.ic_cmd = TUNNEWPPA;
3908     strioc_ppa.ic_timout = 0;
3909     strioc_ppa.ic_len = sizeof(ppa);
3910     strioc_ppa.ic_dp = (char *)&ppa;
3911     if ((ppa = ioctl (tap_fd, I_STR, &strioc_ppa)) < 0)
3912        syslog (LOG_ERR, "Can't assign new interface");
3913
3914     TFR(if_fd = open("/dev/tap", O_RDWR, 0));
3915     if (if_fd < 0) {
3916        syslog(LOG_ERR, "Can't open /dev/tap (2)");
3917        return -1;
3918     }
3919     if(ioctl(if_fd, I_PUSH, "ip") < 0){
3920        syslog(LOG_ERR, "Can't push IP module");
3921        return -1;
3922     }
3923
3924     if (ioctl(if_fd, SIOCGLIFFLAGS, &ifr) < 0)
3925         syslog(LOG_ERR, "Can't get flags\n");
3926
3927     snprintf (actual_name, 32, "tap%d", ppa);
3928     strncpy (ifr.lifr_name, actual_name, sizeof (ifr.lifr_name));
3929
3930     ifr.lifr_ppa = ppa;
3931     /* Assign ppa according to the unit number returned by tun device */
3932
3933     if (ioctl (if_fd, SIOCSLIFNAME, &ifr) < 0)
3934         syslog (LOG_ERR, "Can't set PPA %d", ppa);
3935     if (ioctl(if_fd, SIOCGLIFFLAGS, &ifr) <0)
3936         syslog (LOG_ERR, "Can't get flags\n");
3937     /* Push arp module to if_fd */
3938     if (ioctl (if_fd, I_PUSH, "arp") < 0)
3939         syslog (LOG_ERR, "Can't push ARP module (2)");
3940
3941     /* Push arp module to ip_fd */
3942     if (ioctl (ip_fd, I_POP, NULL) < 0)
3943         syslog (LOG_ERR, "I_POP failed\n");
3944     if (ioctl (ip_fd, I_PUSH, "arp") < 0)
3945         syslog (LOG_ERR, "Can't push ARP module (3)\n");
3946     /* Open arp_fd */
3947     TFR(arp_fd = open ("/dev/tap", O_RDWR, 0));
3948     if (arp_fd < 0)
3949        syslog (LOG_ERR, "Can't open %s\n", "/dev/tap");
3950
3951     /* Set ifname to arp */
3952     strioc_if.ic_cmd = SIOCSLIFNAME;
3953     strioc_if.ic_timout = 0;
3954     strioc_if.ic_len = sizeof(ifr);
3955     strioc_if.ic_dp = (char *)&ifr;
3956     if (ioctl(arp_fd, I_STR, &strioc_if) < 0){
3957         syslog (LOG_ERR, "Can't set ifname to arp\n");
3958     }
3959
3960     if((ip_muxid = ioctl(ip_fd, I_LINK, if_fd)) < 0){
3961        syslog(LOG_ERR, "Can't link TAP device to IP");
3962        return -1;
3963     }
3964
3965     if ((arp_muxid = ioctl (ip_fd, link_type, arp_fd)) < 0)
3966         syslog (LOG_ERR, "Can't link TAP device to ARP");
3967
3968     close (if_fd);
3969
3970     memset(&ifr, 0x0, sizeof(ifr));
3971     strncpy (ifr.lifr_name, actual_name, sizeof (ifr.lifr_name));
3972     ifr.lifr_ip_muxid  = ip_muxid;
3973     ifr.lifr_arp_muxid = arp_muxid;
3974
3975     if (ioctl (ip_fd, SIOCSLIFMUXID, &ifr) < 0)
3976     {
3977       ioctl (ip_fd, I_PUNLINK , arp_muxid);
3978       ioctl (ip_fd, I_PUNLINK, ip_muxid);
3979       syslog (LOG_ERR, "Can't set multiplexor id");
3980     }
3981
3982     sprintf(dev, "tap%d", ppa);
3983     return tap_fd;
3984 }
3985
3986 static int tap_open(char *ifname, int ifname_size)
3987 {
3988     char  dev[10]="";
3989     int fd;
3990     if( (fd = tap_alloc(dev)) < 0 ){
3991        fprintf(stderr, "Cannot allocate TAP device\n");
3992        return -1;
3993     }
3994     pstrcpy(ifname, ifname_size, dev);
3995     fcntl(fd, F_SETFL, O_NONBLOCK);
3996     return fd;
3997 }
3998 #else
3999 static int tap_open(char *ifname, int ifname_size)
4000 {
4001     struct ifreq ifr;
4002     int fd, ret;
4003
4004     TFR(fd = open("/dev/net/tun", O_RDWR));
4005     if (fd < 0) {
4006         fprintf(stderr, "warning: could not open /dev/net/tun: no virtual network emulation\n");
4007         return -1;
4008     }
4009     memset(&ifr, 0, sizeof(ifr));
4010     ifr.ifr_flags = IFF_TAP | IFF_NO_PI;
4011     if (ifname[0] != '\0')
4012         pstrcpy(ifr.ifr_name, IFNAMSIZ, ifname);
4013     else
4014         pstrcpy(ifr.ifr_name, IFNAMSIZ, "tap%d");
4015     ret = ioctl(fd, TUNSETIFF, (void *) &ifr);
4016     if (ret != 0) {
4017         fprintf(stderr, "warning: could not configure /dev/net/tun: no virtual network emulation\n");
4018         close(fd);
4019         return -1;
4020     }
4021     pstrcpy(ifname, ifname_size, ifr.ifr_name);
4022     fcntl(fd, F_SETFL, O_NONBLOCK);
4023     return fd;
4024 }
4025 #endif
4026
4027 static int net_tap_init(VLANState *vlan, const char *ifname1,
4028                         const char *setup_script)
4029 {
4030     TAPState *s;
4031     int pid, status, fd;
4032     char *args[3];
4033     char **parg;
4034     char ifname[128];
4035
4036     if (ifname1 != NULL)
4037         pstrcpy(ifname, sizeof(ifname), ifname1);
4038     else
4039         ifname[0] = '\0';
4040     TFR(fd = tap_open(ifname, sizeof(ifname)));
4041     if (fd < 0)
4042         return -1;
4043
4044     if (!setup_script || !strcmp(setup_script, "no"))
4045         setup_script = "";
4046     if (setup_script[0] != '\0') {
4047         /* try to launch network init script */
4048         pid = fork();
4049         if (pid >= 0) {
4050             if (pid == 0) {
4051                 int open_max = sysconf (_SC_OPEN_MAX), i;
4052                 for (i = 0; i < open_max; i++)
4053                     if (i != STDIN_FILENO &&
4054                         i != STDOUT_FILENO &&
4055                         i != STDERR_FILENO &&
4056                         i != fd)
4057                         close(i);
4058
4059                 parg = args;
4060                 *parg++ = (char *)setup_script;
4061                 *parg++ = ifname;
4062                 *parg++ = NULL;
4063                 execv(setup_script, args);
4064                 _exit(1);
4065             }
4066             while (waitpid(pid, &status, 0) != pid);
4067             if (!WIFEXITED(status) ||
4068                 WEXITSTATUS(status) != 0) {
4069                 fprintf(stderr, "%s: could not launch network script\n",
4070                         setup_script);
4071                 return -1;
4072             }
4073         }
4074     }
4075     s = net_tap_fd_init(vlan, fd);
4076     if (!s)
4077         return -1;
4078     snprintf(s->vc->info_str, sizeof(s->vc->info_str),
4079              "tap: ifname=%s setup_script=%s", ifname, setup_script);
4080     return 0;
4081 }
4082
4083 #endif /* !_WIN32 */
4084
4085 /* network connection */
4086 typedef struct NetSocketState {
4087     VLANClientState *vc;
4088     int fd;
4089     int state; /* 0 = getting length, 1 = getting data */
4090     int index;
4091     int packet_len;
4092     uint8_t buf[4096];
4093     struct sockaddr_in dgram_dst; /* contains inet host and port destination iff connectionless (SOCK_DGRAM) */
4094 } NetSocketState;
4095
4096 typedef struct NetSocketListenState {
4097     VLANState *vlan;
4098     int fd;
4099 } NetSocketListenState;
4100
4101 /* XXX: we consider we can send the whole packet without blocking */
4102 static void net_socket_receive(void *opaque, const uint8_t *buf, int size)
4103 {
4104     NetSocketState *s = opaque;
4105     uint32_t len;
4106     len = htonl(size);
4107
4108     send_all(s->fd, (const uint8_t *)&len, sizeof(len));
4109     send_all(s->fd, buf, size);
4110 }
4111
4112 static void net_socket_receive_dgram(void *opaque, const uint8_t *buf, int size)
4113 {
4114     NetSocketState *s = opaque;
4115     sendto(s->fd, buf, size, 0,
4116            (struct sockaddr *)&s->dgram_dst, sizeof(s->dgram_dst));
4117 }
4118
4119 static void net_socket_send(void *opaque)
4120 {
4121     NetSocketState *s = opaque;
4122     int l, size, err;
4123     uint8_t buf1[4096];
4124     const uint8_t *buf;
4125
4126     size = recv(s->fd, buf1, sizeof(buf1), 0);
4127     if (size < 0) {
4128         err = socket_error();
4129         if (err != EWOULDBLOCK)
4130             goto eoc;
4131     } else if (size == 0) {
4132         /* end of connection */
4133     eoc:
4134         qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
4135         closesocket(s->fd);
4136         return;
4137     }
4138     buf = buf1;
4139     while (size > 0) {
4140         /* reassemble a packet from the network */
4141         switch(s->state) {
4142         case 0:
4143             l = 4 - s->index;
4144             if (l > size)
4145                 l = size;
4146             memcpy(s->buf + s->index, buf, l);
4147             buf += l;
4148             size -= l;
4149             s->index += l;
4150             if (s->index == 4) {
4151                 /* got length */
4152                 s->packet_len = ntohl(*(uint32_t *)s->buf);
4153                 s->index = 0;
4154                 s->state = 1;
4155             }
4156             break;
4157         case 1:
4158             l = s->packet_len - s->index;
4159             if (l > size)
4160                 l = size;
4161             memcpy(s->buf + s->index, buf, l);
4162             s->index += l;
4163             buf += l;
4164             size -= l;
4165             if (s->index >= s->packet_len) {
4166                 qemu_send_packet(s->vc, s->buf, s->packet_len);
4167                 s->index = 0;
4168                 s->state = 0;
4169             }
4170             break;
4171         }
4172     }
4173 }
4174
4175 static void net_socket_send_dgram(void *opaque)
4176 {
4177     NetSocketState *s = opaque;
4178     int size;
4179
4180     size = recv(s->fd, s->buf, sizeof(s->buf), 0);
4181     if (size < 0)
4182         return;
4183     if (size == 0) {
4184         /* end of connection */
4185         qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
4186         return;
4187     }
4188     qemu_send_packet(s->vc, s->buf, size);
4189 }
4190
4191 static int net_socket_mcast_create(struct sockaddr_in *mcastaddr)
4192 {
4193     struct ip_mreq imr;
4194     int fd;
4195     int val, ret;
4196     if (!IN_MULTICAST(ntohl(mcastaddr->sin_addr.s_addr))) {
4197         fprintf(stderr, "qemu: error: specified mcastaddr \"%s\" (0x%08x) does not contain a multicast address\n",
4198                 inet_ntoa(mcastaddr->sin_addr),
4199                 (int)ntohl(mcastaddr->sin_addr.s_addr));
4200         return -1;
4201
4202     }
4203     fd = socket(PF_INET, SOCK_DGRAM, 0);
4204     if (fd < 0) {
4205         perror("socket(PF_INET, SOCK_DGRAM)");
4206         return -1;
4207     }
4208
4209     val = 1;
4210     ret=setsockopt(fd, SOL_SOCKET, SO_REUSEADDR,
4211                    (const char *)&val, sizeof(val));
4212     if (ret < 0) {
4213         perror("setsockopt(SOL_SOCKET, SO_REUSEADDR)");
4214         goto fail;
4215     }
4216
4217     ret = bind(fd, (struct sockaddr *)mcastaddr, sizeof(*mcastaddr));
4218     if (ret < 0) {
4219         perror("bind");
4220         goto fail;
4221     }
4222
4223     /* Add host to multicast group */
4224     imr.imr_multiaddr = mcastaddr->sin_addr;
4225     imr.imr_interface.s_addr = htonl(INADDR_ANY);
4226
4227     ret = setsockopt(fd, IPPROTO_IP, IP_ADD_MEMBERSHIP,
4228                      (const char *)&imr, sizeof(struct ip_mreq));
4229     if (ret < 0) {
4230         perror("setsockopt(IP_ADD_MEMBERSHIP)");
4231         goto fail;
4232     }
4233
4234     /* Force mcast msgs to loopback (eg. several QEMUs in same host */
4235     val = 1;
4236     ret=setsockopt(fd, IPPROTO_IP, IP_MULTICAST_LOOP,
4237                    (const char *)&val, sizeof(val));
4238     if (ret < 0) {
4239         perror("setsockopt(SOL_IP, IP_MULTICAST_LOOP)");
4240         goto fail;
4241     }
4242
4243     socket_set_nonblock(fd);
4244     return fd;
4245 fail:
4246     if (fd >= 0)
4247         closesocket(fd);
4248     return -1;
4249 }
4250
4251 static NetSocketState *net_socket_fd_init_dgram(VLANState *vlan, int fd,
4252                                           int is_connected)
4253 {
4254     struct sockaddr_in saddr;
4255     int newfd;
4256     socklen_t saddr_len;
4257     NetSocketState *s;
4258
4259     /* fd passed: multicast: "learn" dgram_dst address from bound address and save it
4260      * Because this may be "shared" socket from a "master" process, datagrams would be recv()
4261      * by ONLY ONE process: we must "clone" this dgram socket --jjo
4262      */
4263
4264     if (is_connected) {
4265         if (getsockname(fd, (struct sockaddr *) &saddr, &saddr_len) == 0) {
4266             /* must be bound */
4267             if (saddr.sin_addr.s_addr==0) {
4268                 fprintf(stderr, "qemu: error: init_dgram: fd=%d unbound, cannot setup multicast dst addr\n",
4269                         fd);
4270                 return NULL;
4271             }
4272             /* clone dgram socket */
4273             newfd = net_socket_mcast_create(&saddr);
4274             if (newfd < 0) {
4275                 /* error already reported by net_socket_mcast_create() */
4276                 close(fd);
4277                 return NULL;
4278             }
4279             /* clone newfd to fd, close newfd */
4280             dup2(newfd, fd);
4281             close(newfd);
4282
4283         } else {
4284             fprintf(stderr, "qemu: error: init_dgram: fd=%d failed getsockname(): %s\n",
4285                     fd, strerror(errno));
4286             return NULL;
4287         }
4288     }
4289
4290     s = qemu_mallocz(sizeof(NetSocketState));
4291     if (!s)
4292         return NULL;
4293     s->fd = fd;
4294
4295     s->vc = qemu_new_vlan_client(vlan, net_socket_receive_dgram, NULL, s);
4296     qemu_set_fd_handler(s->fd, net_socket_send_dgram, NULL, s);
4297
4298     /* mcast: save bound address as dst */
4299     if (is_connected) s->dgram_dst=saddr;
4300
4301     snprintf(s->vc->info_str, sizeof(s->vc->info_str),
4302             "socket: fd=%d (%s mcast=%s:%d)",
4303             fd, is_connected? "cloned" : "",
4304             inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
4305     return s;
4306 }
4307
4308 static void net_socket_connect(void *opaque)
4309 {
4310     NetSocketState *s = opaque;
4311     qemu_set_fd_handler(s->fd, net_socket_send, NULL, s);
4312 }
4313
4314 static NetSocketState *net_socket_fd_init_stream(VLANState *vlan, int fd,
4315                                           int is_connected)
4316 {
4317     NetSocketState *s;
4318     s = qemu_mallocz(sizeof(NetSocketState));
4319     if (!s)
4320         return NULL;
4321     s->fd = fd;
4322     s->vc = qemu_new_vlan_client(vlan,
4323                                  net_socket_receive, NULL, s);
4324     snprintf(s->vc->info_str, sizeof(s->vc->info_str),
4325              "socket: fd=%d", fd);
4326     if (is_connected) {
4327         net_socket_connect(s);
4328     } else {
4329         qemu_set_fd_handler(s->fd, NULL, net_socket_connect, s);
4330     }
4331     return s;
4332 }
4333
4334 static NetSocketState *net_socket_fd_init(VLANState *vlan, int fd,
4335                                           int is_connected)
4336 {
4337     int so_type=-1, optlen=sizeof(so_type);
4338
4339     if(getsockopt(fd, SOL_SOCKET, SO_TYPE, (char *)&so_type, &optlen)< 0) {
4340         fprintf(stderr, "qemu: error: getsockopt(SO_TYPE) for fd=%d failed\n", fd);
4341         return NULL;
4342     }
4343     switch(so_type) {
4344     case SOCK_DGRAM:
4345         return net_socket_fd_init_dgram(vlan, fd, is_connected);
4346     case SOCK_STREAM:
4347         return net_socket_fd_init_stream(vlan, fd, is_connected);
4348     default:
4349         /* who knows ... this could be a eg. a pty, do warn and continue as stream */
4350         fprintf(stderr, "qemu: warning: socket type=%d for fd=%d is not SOCK_DGRAM or SOCK_STREAM\n", so_type, fd);
4351         return net_socket_fd_init_stream(vlan, fd, is_connected);
4352     }
4353     return NULL;
4354 }
4355
4356 static void net_socket_accept(void *opaque)
4357 {
4358     NetSocketListenState *s = opaque;
4359     NetSocketState *s1;
4360     struct sockaddr_in saddr;
4361     socklen_t len;
4362     int fd;
4363
4364     for(;;) {
4365         len = sizeof(saddr);
4366         fd = accept(s->fd, (struct sockaddr *)&saddr, &len);
4367         if (fd < 0 && errno != EINTR) {
4368             return;
4369         } else if (fd >= 0) {
4370             break;
4371         }
4372     }
4373     s1 = net_socket_fd_init(s->vlan, fd, 1);
4374     if (!s1) {
4375         closesocket(fd);
4376     } else {
4377         snprintf(s1->vc->info_str, sizeof(s1->vc->info_str),
4378                  "socket: connection from %s:%d",
4379                  inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
4380     }
4381 }
4382
4383 static int net_socket_listen_init(VLANState *vlan, const char *host_str)
4384 {
4385     NetSocketListenState *s;
4386     int fd, val, ret;
4387     struct sockaddr_in saddr;
4388
4389     if (parse_host_port(&saddr, host_str) < 0)
4390         return -1;
4391
4392     s = qemu_mallocz(sizeof(NetSocketListenState));
4393     if (!s)
4394         return -1;
4395
4396     fd = socket(PF_INET, SOCK_STREAM, 0);
4397     if (fd < 0) {
4398         perror("socket");
4399         return -1;
4400     }
4401     socket_set_nonblock(fd);
4402
4403     /* allow fast reuse */
4404     val = 1;
4405     setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, (const char *)&val, sizeof(val));
4406
4407     ret = bind(fd, (struct sockaddr *)&saddr, sizeof(saddr));
4408     if (ret < 0) {
4409         perror("bind");
4410         return -1;
4411     }
4412     ret = listen(fd, 0);
4413     if (ret < 0) {
4414         perror("listen");
4415         return -1;
4416     }
4417     s->vlan = vlan;
4418     s->fd = fd;
4419     qemu_set_fd_handler(fd, net_socket_accept, NULL, s);
4420     return 0;
4421 }
4422
4423 static int net_socket_connect_init(VLANState *vlan, const char *host_str)
4424 {
4425     NetSocketState *s;
4426     int fd, connected, ret, err;
4427     struct sockaddr_in saddr;
4428
4429     if (parse_host_port(&saddr, host_str) < 0)
4430         return -1;
4431
4432     fd = socket(PF_INET, SOCK_STREAM, 0);
4433     if (fd < 0) {
4434         perror("socket");
4435         return -1;
4436     }
4437     socket_set_nonblock(fd);
4438
4439     connected = 0;
4440     for(;;) {
4441         ret = connect(fd, (struct sockaddr *)&saddr, sizeof(saddr));
4442         if (ret < 0) {
4443             err = socket_error();
4444             if (err == EINTR || err == EWOULDBLOCK) {
4445             } else if (err == EINPROGRESS) {
4446                 break;
4447 #ifdef _WIN32
4448             } else if (err == WSAEALREADY) {
4449                 break;
4450 #endif
4451             } else {
4452                 perror("connect");
4453                 closesocket(fd);
4454                 return -1;
4455             }
4456         } else {
4457             connected = 1;
4458             break;
4459         }
4460     }
4461     s = net_socket_fd_init(vlan, fd, connected);
4462     if (!s)
4463         return -1;
4464     snprintf(s->vc->info_str, sizeof(s->vc->info_str),
4465              "socket: connect to %s:%d",
4466              inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
4467     return 0;
4468 }
4469
4470 static int net_socket_mcast_init(VLANState *vlan, const char *host_str)
4471 {
4472     NetSocketState *s;
4473     int fd;
4474     struct sockaddr_in saddr;
4475
4476     if (parse_host_port(&saddr, host_str) < 0)
4477         return -1;
4478
4479
4480     fd = net_socket_mcast_create(&saddr);
4481     if (fd < 0)
4482         return -1;
4483
4484     s = net_socket_fd_init(vlan, fd, 0);
4485     if (!s)
4486         return -1;
4487
4488     s->dgram_dst = saddr;
4489
4490     snprintf(s->vc->info_str, sizeof(s->vc->info_str),
4491              "socket: mcast=%s:%d",
4492              inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
4493     return 0;
4494
4495 }
4496
4497 static int get_param_value(char *buf, int buf_size,
4498                            const char *tag, const char *str)
4499 {
4500     const char *p;
4501     char *q;
4502     char option[128];
4503
4504     p = str;
4505     for(;;) {
4506         q = option;
4507         while (*p != '\0' && *p != '=') {
4508             if ((q - option) < sizeof(option) - 1)
4509                 *q++ = *p;
4510             p++;
4511         }
4512         *q = '\0';
4513         if (*p != '=')
4514             break;
4515         p++;
4516         if (!strcmp(tag, option)) {
4517             q = buf;
4518             while (*p != '\0' && *p != ',') {
4519                 if ((q - buf) < buf_size - 1)
4520                     *q++ = *p;
4521                 p++;
4522             }
4523             *q = '\0';
4524             return q - buf;
4525         } else {
4526             while (*p != '\0' && *p != ',') {
4527                 p++;
4528             }
4529         }
4530         if (*p != ',')
4531             break;
4532         p++;
4533     }
4534     return 0;
4535 }
4536
4537 static int net_client_init(const char *str)
4538 {
4539     const char *p;
4540     char *q;
4541     char device[64];
4542     char buf[1024];
4543     int vlan_id, ret;
4544     VLANState *vlan;
4545
4546     p = str;
4547     q = device;
4548     while (*p != '\0' && *p != ',') {
4549         if ((q - device) < sizeof(device) - 1)
4550             *q++ = *p;
4551         p++;
4552     }
4553     *q = '\0';
4554     if (*p == ',')
4555         p++;
4556     vlan_id = 0;
4557     if (get_param_value(buf, sizeof(buf), "vlan", p)) {
4558         vlan_id = strtol(buf, NULL, 0);
4559     }
4560     vlan = qemu_find_vlan(vlan_id);
4561     if (!vlan) {
4562         fprintf(stderr, "Could not create vlan %d\n", vlan_id);
4563         return -1;
4564     }
4565     if (!strcmp(device, "nic")) {
4566         NICInfo *nd;
4567         uint8_t *macaddr;
4568
4569         if (nb_nics >= MAX_NICS) {
4570             fprintf(stderr, "Too Many NICs\n");
4571             return -1;
4572         }
4573         nd = &nd_table[nb_nics];
4574         macaddr = nd->macaddr;
4575         macaddr[0] = 0x52;
4576         macaddr[1] = 0x54;
4577         macaddr[2] = 0x00;
4578         macaddr[3] = 0x12;
4579         macaddr[4] = 0x34;
4580         macaddr[5] = 0x56 + nb_nics;
4581
4582         if (get_param_value(buf, sizeof(buf), "macaddr", p)) {
4583             if (parse_macaddr(macaddr, buf) < 0) {
4584                 fprintf(stderr, "invalid syntax for ethernet address\n");
4585                 return -1;
4586             }
4587         }
4588         if (get_param_value(buf, sizeof(buf), "model", p)) {
4589             nd->model = strdup(buf);
4590         }
4591         nd->vlan = vlan;
4592         nb_nics++;
4593         vlan->nb_guest_devs++;
4594         ret = 0;
4595     } else
4596     if (!strcmp(device, "none")) {
4597         /* does nothing. It is needed to signal that no network cards
4598            are wanted */
4599         ret = 0;
4600     } else
4601 #ifdef CONFIG_SLIRP
4602     if (!strcmp(device, "user")) {
4603         if (get_param_value(buf, sizeof(buf), "hostname", p)) {
4604             pstrcpy(slirp_hostname, sizeof(slirp_hostname), buf);
4605         }
4606         vlan->nb_host_devs++;
4607         ret = net_slirp_init(vlan);
4608     } else
4609 #endif
4610 #ifdef _WIN32
4611     if (!strcmp(device, "tap")) {
4612         char ifname[64];
4613         if (get_param_value(ifname, sizeof(ifname), "ifname", p) <= 0) {
4614             fprintf(stderr, "tap: no interface name\n");
4615             return -1;
4616         }
4617         vlan->nb_host_devs++;
4618         ret = tap_win32_init(vlan, ifname);
4619     } else
4620 #else
4621     if (!strcmp(device, "tap")) {
4622         char ifname[64];
4623         char setup_script[1024];
4624         int fd;
4625         vlan->nb_host_devs++;
4626         if (get_param_value(buf, sizeof(buf), "fd", p) > 0) {
4627             fd = strtol(buf, NULL, 0);
4628             ret = -1;
4629             if (net_tap_fd_init(vlan, fd))
4630                 ret = 0;
4631         } else {
4632             if (get_param_value(ifname, sizeof(ifname), "ifname", p) <= 0) {
4633                 ifname[0] = '\0';
4634             }
4635             if (get_param_value(setup_script, sizeof(setup_script), "script", p) == 0) {
4636                 pstrcpy(setup_script, sizeof(setup_script), DEFAULT_NETWORK_SCRIPT);
4637             }
4638             ret = net_tap_init(vlan, ifname, setup_script);
4639         }
4640     } else
4641 #endif
4642     if (!strcmp(device, "socket")) {
4643         if (get_param_value(buf, sizeof(buf), "fd", p) > 0) {
4644             int fd;
4645             fd = strtol(buf, NULL, 0);
4646             ret = -1;
4647             if (net_socket_fd_init(vlan, fd, 1))
4648                 ret = 0;
4649         } else if (get_param_value(buf, sizeof(buf), "listen", p) > 0) {
4650             ret = net_socket_listen_init(vlan, buf);
4651         } else if (get_param_value(buf, sizeof(buf), "connect", p) > 0) {
4652             ret = net_socket_connect_init(vlan, buf);
4653         } else if (get_param_value(buf, sizeof(buf), "mcast", p) > 0) {
4654             ret = net_socket_mcast_init(vlan, buf);
4655         } else {
4656             fprintf(stderr, "Unknown socket options: %s\n", p);
4657             return -1;
4658         }
4659         vlan->nb_host_devs++;
4660     } else
4661     {
4662         fprintf(stderr, "Unknown network device: %s\n", device);
4663         return -1;
4664     }
4665     if (ret < 0) {
4666         fprintf(stderr, "Could not initialize device '%s'\n", device);
4667     }
4668
4669     return ret;
4670 }
4671
4672 void do_info_network(void)
4673 {
4674     VLANState *vlan;
4675     VLANClientState *vc;
4676
4677     for(vlan = first_vlan; vlan != NULL; vlan = vlan->next) {
4678         term_printf("VLAN %d devices:\n", vlan->id);
4679         for(vc = vlan->first_client; vc != NULL; vc = vc->next)
4680             term_printf("  %s\n", vc->info_str);
4681     }
4682 }
4683
4684 /***********************************************************/
4685 /* USB devices */
4686
4687 static USBPort *used_usb_ports;
4688 static USBPort *free_usb_ports;
4689
4690 /* ??? Maybe change this to register a hub to keep track of the topology.  */
4691 void qemu_register_usb_port(USBPort *port, void *opaque, int index,
4692                             usb_attachfn attach)
4693 {
4694     port->opaque = opaque;
4695     port->index = index;
4696     port->attach = attach;
4697     port->next = free_usb_ports;
4698     free_usb_ports = port;
4699 }
4700
4701 static int usb_device_add(const char *devname)
4702 {
4703     const char *p;
4704     USBDevice *dev;
4705     USBPort *port;
4706
4707     if (!free_usb_ports)
4708         return -1;
4709
4710     if (strstart(devname, "host:", &p)) {
4711         dev = usb_host_device_open(p);
4712     } else if (!strcmp(devname, "mouse")) {
4713         dev = usb_mouse_init();
4714     } else if (!strcmp(devname, "tablet")) {
4715         dev = usb_tablet_init();
4716     } else if (!strcmp(devname, "keyboard")) {
4717         dev = usb_keyboard_init();
4718     } else if (strstart(devname, "disk:", &p)) {
4719         dev = usb_msd_init(p);
4720     } else if (!strcmp(devname, "wacom-tablet")) {
4721         dev = usb_wacom_init();
4722     } else {
4723         return -1;
4724     }
4725     if (!dev)
4726         return -1;
4727
4728     /* Find a USB port to add the device to.  */
4729     port = free_usb_ports;
4730     if (!port->next) {
4731         USBDevice *hub;
4732
4733         /* Create a new hub and chain it on.  */
4734         free_usb_ports = NULL;
4735         port->next = used_usb_ports;
4736         used_usb_ports = port;
4737
4738         hub = usb_hub_init(VM_USB_HUB_SIZE);
4739         usb_attach(port, hub);
4740         port = free_usb_ports;
4741     }
4742
4743     free_usb_ports = port->next;
4744     port->next = used_usb_ports;
4745     used_usb_ports = port;
4746     usb_attach(port, dev);
4747     return 0;
4748 }
4749
4750 static int usb_device_del(const char *devname)
4751 {
4752     USBPort *port;
4753     USBPort **lastp;
4754     USBDevice *dev;
4755     int bus_num, addr;
4756     const char *p;
4757
4758     if (!used_usb_ports)
4759         return -1;
4760
4761     p = strchr(devname, '.');
4762     if (!p)
4763         return -1;
4764     bus_num = strtoul(devname, NULL, 0);
4765     addr = strtoul(p + 1, NULL, 0);
4766     if (bus_num != 0)
4767         return -1;
4768
4769     lastp = &used_usb_ports;
4770     port = used_usb_ports;
4771     while (port && port->dev->addr != addr) {
4772         lastp = &port->next;
4773         port = port->next;
4774     }
4775
4776     if (!port)
4777         return -1;
4778
4779     dev = port->dev;
4780     *lastp = port->next;
4781     usb_attach(port, NULL);
4782     dev->handle_destroy(dev);
4783     port->next = free_usb_ports;
4784     free_usb_ports = port;
4785     return 0;
4786 }
4787
4788 void do_usb_add(const char *devname)
4789 {
4790     int ret;
4791     ret = usb_device_add(devname);
4792     if (ret < 0)
4793         term_printf("Could not add USB device '%s'\n", devname);
4794 }
4795
4796 void do_usb_del(const char *devname)
4797 {
4798     int ret;
4799     ret = usb_device_del(devname);
4800     if (ret < 0)
4801         term_printf("Could not remove USB device '%s'\n", devname);
4802 }
4803
4804 void usb_info(void)
4805 {
4806     USBDevice *dev;
4807     USBPort *port;
4808     const char *speed_str;
4809
4810     if (!usb_enabled) {
4811         term_printf("USB support not enabled\n");
4812         return;
4813     }
4814
4815     for (port = used_usb_ports; port; port = port->next) {
4816         dev = port->dev;
4817         if (!dev)
4818             continue;
4819         switch(dev->speed) {
4820         case USB_SPEED_LOW:
4821             speed_str = "1.5";
4822             break;
4823         case USB_SPEED_FULL:
4824             speed_str = "12";
4825             break;
4826         case USB_SPEED_HIGH:
4827             speed_str = "480";
4828             break;
4829         default:
4830             speed_str = "?";
4831             break;
4832         }
4833         term_printf("  Device %d.%d, Speed %s Mb/s, Product %s\n",
4834                     0, dev->addr, speed_str, dev->devname);
4835     }
4836 }
4837
4838 /***********************************************************/
4839 /* PCMCIA/Cardbus */
4840
4841 static struct pcmcia_socket_entry_s {
4842     struct pcmcia_socket_s *socket;
4843     struct pcmcia_socket_entry_s *next;
4844 } *pcmcia_sockets = 0;
4845
4846 void pcmcia_socket_register(struct pcmcia_socket_s *socket)
4847 {
4848     struct pcmcia_socket_entry_s *entry;
4849
4850     entry = qemu_malloc(sizeof(struct pcmcia_socket_entry_s));
4851     entry->socket = socket;
4852     entry->next = pcmcia_sockets;
4853     pcmcia_sockets = entry;
4854 }
4855
4856 void pcmcia_socket_unregister(struct pcmcia_socket_s *socket)
4857 {
4858     struct pcmcia_socket_entry_s *entry, **ptr;
4859
4860     ptr = &pcmcia_sockets;
4861     for (entry = *ptr; entry; ptr = &entry->next, entry = *ptr)
4862         if (entry->socket == socket) {
4863             *ptr = entry->next;
4864             qemu_free(entry);
4865         }
4866 }
4867
4868 void pcmcia_info(void)
4869 {
4870     struct pcmcia_socket_entry_s *iter;
4871     if (!pcmcia_sockets)
4872         term_printf("No PCMCIA sockets\n");
4873
4874     for (iter = pcmcia_sockets; iter; iter = iter->next)
4875         term_printf("%s: %s\n", iter->socket->slot_string,
4876                     iter->socket->attached ? iter->socket->card_string :
4877                     "Empty");
4878 }
4879
4880 /***********************************************************/
4881 /* dumb display */
4882
4883 static void dumb_update(DisplayState *ds, int x, int y, int w, int h)
4884 {
4885 }
4886
4887 static void dumb_resize(DisplayState *ds, int w, int h)
4888 {
4889 }
4890
4891 static void dumb_refresh(DisplayState *ds)
4892 {
4893 #if defined(CONFIG_SDL)
4894     vga_hw_update();
4895 #endif
4896 }
4897
4898 static void dumb_display_init(DisplayState *ds)
4899 {
4900     ds->data = NULL;
4901     ds->linesize = 0;
4902     ds->depth = 0;
4903     ds->dpy_update = dumb_update;
4904     ds->dpy_resize = dumb_resize;
4905     ds->dpy_refresh = dumb_refresh;
4906 }
4907
4908 /***********************************************************/
4909 /* I/O handling */
4910
4911 #define MAX_IO_HANDLERS 64
4912
4913 typedef struct IOHandlerRecord {
4914     int fd;
4915     IOCanRWHandler *fd_read_poll;
4916     IOHandler *fd_read;
4917     IOHandler *fd_write;
4918     int deleted;
4919     void *opaque;
4920     /* temporary data */
4921     struct pollfd *ufd;
4922     struct IOHandlerRecord *next;
4923 } IOHandlerRecord;
4924
4925 static IOHandlerRecord *first_io_handler;
4926
4927 /* XXX: fd_read_poll should be suppressed, but an API change is
4928    necessary in the character devices to suppress fd_can_read(). */
4929 int qemu_set_fd_handler2(int fd,
4930                          IOCanRWHandler *fd_read_poll,
4931                          IOHandler *fd_read,
4932                          IOHandler *fd_write,
4933                          void *opaque)
4934 {
4935     IOHandlerRecord **pioh, *ioh;
4936
4937     if (!fd_read && !fd_write) {
4938         pioh = &first_io_handler;
4939         for(;;) {
4940             ioh = *pioh;
4941             if (ioh == NULL)
4942                 break;
4943             if (ioh->fd == fd) {
4944                 ioh->deleted = 1;
4945                 break;
4946             }
4947             pioh = &ioh->next;
4948         }
4949     } else {
4950         for(ioh = first_io_handler; ioh != NULL; ioh = ioh->next) {
4951             if (ioh->fd == fd)
4952                 goto found;
4953         }
4954         ioh = qemu_mallocz(sizeof(IOHandlerRecord));
4955         if (!ioh)
4956             return -1;
4957         ioh->next = first_io_handler;
4958         first_io_handler = ioh;
4959     found:
4960         ioh->fd = fd;
4961         ioh->fd_read_poll = fd_read_poll;
4962         ioh->fd_read = fd_read;
4963         ioh->fd_write = fd_write;
4964         ioh->opaque = opaque;
4965         ioh->deleted = 0;
4966     }
4967     return 0;
4968 }
4969
4970 int qemu_set_fd_handler(int fd,
4971                         IOHandler *fd_read,
4972                         IOHandler *fd_write,
4973                         void *opaque)
4974 {
4975     return qemu_set_fd_handler2(fd, NULL, fd_read, fd_write, opaque);
4976 }
4977
4978 /***********************************************************/
4979 /* Polling handling */
4980
4981 typedef struct PollingEntry {
4982     PollingFunc *func;
4983     void *opaque;
4984     struct PollingEntry *next;
4985 } PollingEntry;
4986
4987 static PollingEntry *first_polling_entry;
4988
4989 int qemu_add_polling_cb(PollingFunc *func, void *opaque)
4990 {
4991     PollingEntry **ppe, *pe;
4992     pe = qemu_mallocz(sizeof(PollingEntry));
4993     if (!pe)
4994         return -1;
4995     pe->func = func;
4996     pe->opaque = opaque;
4997     for(ppe = &first_polling_entry; *ppe != NULL; ppe = &(*ppe)->next);
4998     *ppe = pe;
4999     return 0;
5000 }
5001
5002 void qemu_del_polling_cb(PollingFunc *func, void *opaque)
5003 {
5004     PollingEntry **ppe, *pe;
5005     for(ppe = &first_polling_entry; *ppe != NULL; ppe = &(*ppe)->next) {
5006         pe = *ppe;
5007         if (pe->func == func && pe->opaque == opaque) {
5008             *ppe = pe->next;
5009             qemu_free(pe);
5010             break;
5011         }
5012     }
5013 }
5014
5015 #ifdef _WIN32
5016 /***********************************************************/
5017 /* Wait objects support */
5018 typedef struct WaitObjects {
5019     int num;
5020     HANDLE events[MAXIMUM_WAIT_OBJECTS + 1];
5021     WaitObjectFunc *func[MAXIMUM_WAIT_OBJECTS + 1];
5022     void *opaque[MAXIMUM_WAIT_OBJECTS + 1];
5023 } WaitObjects;
5024
5025 static WaitObjects wait_objects = {0};
5026
5027 int qemu_add_wait_object(HANDLE handle, WaitObjectFunc *func, void *opaque)
5028 {
5029     WaitObjects *w = &wait_objects;
5030
5031     if (w->num >= MAXIMUM_WAIT_OBJECTS)
5032         return -1;
5033     w->events[w->num] = handle;
5034     w->func[w->num] = func;
5035     w->opaque[w->num] = opaque;
5036     w->num++;
5037     return 0;
5038 }
5039
5040 void qemu_del_wait_object(HANDLE handle, WaitObjectFunc *func, void *opaque)
5041 {
5042     int i, found;
5043     WaitObjects *w = &wait_objects;
5044
5045     found = 0;
5046     for (i = 0; i < w->num; i++) {
5047         if (w->events[i] == handle)
5048             found = 1;
5049         if (found) {
5050             w->events[i] = w->events[i + 1];
5051             w->func[i] = w->func[i + 1];
5052             w->opaque[i] = w->opaque[i + 1];
5053         }
5054     }
5055     if (found)
5056         w->num--;
5057 }
5058 #endif
5059
5060 /***********************************************************/
5061 /* savevm/loadvm support */
5062
5063 #define IO_BUF_SIZE 32768
5064
5065 struct QEMUFile {
5066     FILE *outfile;
5067     BlockDriverState *bs;
5068     int is_file;
5069     int is_writable;
5070     int64_t base_offset;
5071     int64_t buf_offset; /* start of buffer when writing, end of buffer
5072                            when reading */
5073     int buf_index;
5074     int buf_size; /* 0 when writing */
5075     uint8_t buf[IO_BUF_SIZE];
5076 };
5077
5078 QEMUFile *qemu_fopen(const char *filename, const char *mode)
5079 {
5080     QEMUFile *f;
5081
5082     f = qemu_mallocz(sizeof(QEMUFile));
5083     if (!f)
5084         return NULL;
5085     if (!strcmp(mode, "wb")) {
5086         f->is_writable = 1;
5087     } else if (!strcmp(mode, "rb")) {
5088         f->is_writable = 0;
5089     } else {
5090         goto fail;
5091     }
5092     f->outfile = fopen(filename, mode);
5093     if (!f->outfile)
5094         goto fail;
5095     f->is_file = 1;
5096     return f;
5097  fail:
5098     if (f->outfile)
5099         fclose(f->outfile);
5100     qemu_free(f);
5101     return NULL;
5102 }
5103
5104 QEMUFile *qemu_fopen_bdrv(BlockDriverState *bs, int64_t offset, int is_writable)
5105 {
5106     QEMUFile *f;
5107
5108     f = qemu_mallocz(sizeof(QEMUFile));
5109     if (!f)
5110         return NULL;
5111     f->is_file = 0;
5112     f->bs = bs;
5113     f->is_writable = is_writable;
5114     f->base_offset = offset;
5115     return f;
5116 }
5117
5118 void qemu_fflush(QEMUFile *f)
5119 {
5120     if (!f->is_writable)
5121         return;
5122     if (f->buf_index > 0) {
5123         if (f->is_file) {
5124             fseek(f->outfile, f->buf_offset, SEEK_SET);
5125             fwrite(f->buf, 1, f->buf_index, f->outfile);
5126         } else {
5127             bdrv_pwrite(f->bs, f->base_offset + f->buf_offset,
5128                         f->buf, f->buf_index);
5129         }
5130         f->buf_offset += f->buf_index;
5131         f->buf_index = 0;
5132     }
5133 }
5134
5135 static void qemu_fill_buffer(QEMUFile *f)
5136 {
5137     int len;
5138
5139     if (f->is_writable)
5140         return;
5141     if (f->is_file) {
5142         fseek(f->outfile, f->buf_offset, SEEK_SET);
5143         len = fread(f->buf, 1, IO_BUF_SIZE, f->outfile);
5144         if (len < 0)
5145             len = 0;
5146     } else {
5147         len = bdrv_pread(f->bs, f->base_offset + f->buf_offset,
5148                          f->buf, IO_BUF_SIZE);
5149         if (len < 0)
5150             len = 0;
5151     }
5152     f->buf_index = 0;
5153     f->buf_size = len;
5154     f->buf_offset += len;
5155 }
5156
5157 void qemu_fclose(QEMUFile *f)
5158 {
5159     if (f->is_writable)
5160         qemu_fflush(f);
5161     if (f->is_file) {
5162         fclose(f->outfile);
5163     }
5164     qemu_free(f);
5165 }
5166
5167 void qemu_put_buffer(QEMUFile *f, const uint8_t *buf, int size)
5168 {
5169     int l;
5170     while (size > 0) {
5171         l = IO_BUF_SIZE - f->buf_index;
5172         if (l > size)
5173             l = size;
5174         memcpy(f->buf + f->buf_index, buf, l);
5175         f->buf_index += l;
5176         buf += l;
5177         size -= l;
5178         if (f->buf_index >= IO_BUF_SIZE)
5179             qemu_fflush(f);
5180     }
5181 }
5182
5183 void qemu_put_byte(QEMUFile *f, int v)
5184 {
5185     f->buf[f->buf_index++] = v;
5186     if (f->buf_index >= IO_BUF_SIZE)
5187         qemu_fflush(f);
5188 }
5189
5190 int qemu_get_buffer(QEMUFile *f, uint8_t *buf, int size1)
5191 {
5192     int size, l;
5193
5194     size = size1;
5195     while (size > 0) {
5196         l = f->buf_size - f->buf_index;
5197         if (l == 0) {
5198             qemu_fill_buffer(f);
5199             l = f->buf_size - f->buf_index;
5200             if (l == 0)
5201                 break;
5202         }
5203         if (l > size)
5204             l = size;
5205         memcpy(buf, f->buf + f->buf_index, l);
5206         f->buf_index += l;
5207         buf += l;
5208         size -= l;
5209     }
5210     return size1 - size;
5211 }
5212
5213 int qemu_get_byte(QEMUFile *f)
5214 {
5215     if (f->buf_index >= f->buf_size) {
5216         qemu_fill_buffer(f);
5217         if (f->buf_index >= f->buf_size)
5218             return 0;
5219     }
5220     return f->buf[f->buf_index++];
5221 }
5222
5223 int64_t qemu_ftell(QEMUFile *f)
5224 {
5225     return f->buf_offset - f->buf_size + f->buf_index;
5226 }
5227
5228 int64_t qemu_fseek(QEMUFile *f, int64_t pos, int whence)
5229 {
5230     if (whence == SEEK_SET) {
5231         /* nothing to do */
5232     } else if (whence == SEEK_CUR) {
5233         pos += qemu_ftell(f);
5234     } else {
5235         /* SEEK_END not supported */
5236         return -1;
5237     }
5238     if (f->is_writable) {
5239         qemu_fflush(f);
5240         f->buf_offset = pos;
5241     } else {
5242         f->buf_offset = pos;
5243         f->buf_index = 0;
5244         f->buf_size = 0;
5245     }
5246     return pos;
5247 }
5248
5249 void qemu_put_be16(QEMUFile *f, unsigned int v)
5250 {
5251     qemu_put_byte(f, v >> 8);
5252     qemu_put_byte(f, v);
5253 }
5254
5255 void qemu_put_be32(QEMUFile *f, unsigned int v)
5256 {
5257     qemu_put_byte(f, v >> 24);
5258     qemu_put_byte(f, v >> 16);
5259     qemu_put_byte(f, v >> 8);
5260     qemu_put_byte(f, v);
5261 }
5262
5263 void qemu_put_be64(QEMUFile *f, uint64_t v)
5264 {
5265     qemu_put_be32(f, v >> 32);
5266     qemu_put_be32(f, v);
5267 }
5268
5269 unsigned int qemu_get_be16(QEMUFile *f)
5270 {
5271     unsigned int v;
5272     v = qemu_get_byte(f) << 8;
5273     v |= qemu_get_byte(f);
5274     return v;
5275 }
5276
5277 unsigned int qemu_get_be32(QEMUFile *f)
5278 {
5279     unsigned int v;
5280     v = qemu_get_byte(f) << 24;
5281     v |= qemu_get_byte(f) << 16;
5282     v |= qemu_get_byte(f) << 8;
5283     v |= qemu_get_byte(f);
5284     return v;
5285 }
5286
5287 uint64_t qemu_get_be64(QEMUFile *f)
5288 {
5289     uint64_t v;
5290     v = (uint64_t)qemu_get_be32(f) << 32;
5291     v |= qemu_get_be32(f);
5292     return v;
5293 }
5294
5295 typedef struct SaveStateEntry {
5296     char idstr[256];
5297     int instance_id;
5298     int version_id;
5299     SaveStateHandler *save_state;
5300     LoadStateHandler *load_state;
5301     void *opaque;
5302     struct SaveStateEntry *next;
5303 } SaveStateEntry;
5304
5305 static SaveStateEntry *first_se;
5306
5307 int register_savevm(const char *idstr,
5308                     int instance_id,
5309                     int version_id,
5310                     SaveStateHandler *save_state,
5311                     LoadStateHandler *load_state,
5312                     void *opaque)
5313 {
5314     SaveStateEntry *se, **pse;
5315
5316     se = qemu_malloc(sizeof(SaveStateEntry));
5317     if (!se)
5318         return -1;
5319     pstrcpy(se->idstr, sizeof(se->idstr), idstr);
5320     se->instance_id = instance_id;
5321     se->version_id = version_id;
5322     se->save_state = save_state;
5323     se->load_state = load_state;
5324     se->opaque = opaque;
5325     se->next = NULL;
5326
5327     /* add at the end of list */
5328     pse = &first_se;
5329     while (*pse != NULL)
5330         pse = &(*pse)->next;
5331     *pse = se;
5332     return 0;
5333 }
5334
5335 #define QEMU_VM_FILE_MAGIC   0x5145564d
5336 #define QEMU_VM_FILE_VERSION 0x00000002
5337
5338 int qemu_savevm_state(QEMUFile *f)
5339 {
5340     SaveStateEntry *se;
5341     int len, ret;
5342     int64_t cur_pos, len_pos, total_len_pos;
5343
5344     qemu_put_be32(f, QEMU_VM_FILE_MAGIC);
5345     qemu_put_be32(f, QEMU_VM_FILE_VERSION);
5346     total_len_pos = qemu_ftell(f);
5347     qemu_put_be64(f, 0); /* total size */
5348
5349     for(se = first_se; se != NULL; se = se->next) {
5350         /* ID string */
5351         len = strlen(se->idstr);
5352         qemu_put_byte(f, len);
5353         qemu_put_buffer(f, se->idstr, len);
5354
5355         qemu_put_be32(f, se->instance_id);
5356         qemu_put_be32(f, se->version_id);
5357
5358         /* record size: filled later */
5359         len_pos = qemu_ftell(f);
5360         qemu_put_be32(f, 0);
5361
5362         se->save_state(f, se->opaque);
5363
5364         /* fill record size */
5365         cur_pos = qemu_ftell(f);
5366         len = cur_pos - len_pos - 4;
5367         qemu_fseek(f, len_pos, SEEK_SET);
5368         qemu_put_be32(f, len);
5369         qemu_fseek(f, cur_pos, SEEK_SET);
5370     }
5371     cur_pos = qemu_ftell(f);
5372     qemu_fseek(f, total_len_pos, SEEK_SET);
5373     qemu_put_be64(f, cur_pos - total_len_pos - 8);
5374     qemu_fseek(f, cur_pos, SEEK_SET);
5375
5376     ret = 0;
5377     return ret;
5378 }
5379
5380 static SaveStateEntry *find_se(const char *idstr, int instance_id)
5381 {
5382     SaveStateEntry *se;
5383
5384     for(se = first_se; se != NULL; se = se->next) {
5385         if (!strcmp(se->idstr, idstr) &&
5386             instance_id == se->instance_id)
5387             return se;
5388     }
5389     return NULL;
5390 }
5391
5392 int qemu_loadvm_state(QEMUFile *f)
5393 {
5394     SaveStateEntry *se;
5395     int len, ret, instance_id, record_len, version_id;
5396     int64_t total_len, end_pos, cur_pos;
5397     unsigned int v;
5398     char idstr[256];
5399
5400     v = qemu_get_be32(f);
5401     if (v != QEMU_VM_FILE_MAGIC)
5402         goto fail;
5403     v = qemu_get_be32(f);
5404     if (v != QEMU_VM_FILE_VERSION) {
5405     fail:
5406         ret = -1;
5407         goto the_end;
5408     }
5409     total_len = qemu_get_be64(f);
5410     end_pos = total_len + qemu_ftell(f);
5411     for(;;) {
5412         if (qemu_ftell(f) >= end_pos)
5413             break;
5414         len = qemu_get_byte(f);
5415         qemu_get_buffer(f, idstr, len);
5416         idstr[len] = '\0';
5417         instance_id = qemu_get_be32(f);
5418         version_id = qemu_get_be32(f);
5419         record_len = qemu_get_be32(f);
5420 #if 0
5421         printf("idstr=%s instance=0x%x version=%d len=%d\n",
5422                idstr, instance_id, version_id, record_len);
5423 #endif
5424         cur_pos = qemu_ftell(f);
5425         se = find_se(idstr, instance_id);
5426         if (!se) {
5427             fprintf(stderr, "qemu: warning: instance 0x%x of device '%s' not present in current VM\n",
5428                     instance_id, idstr);
5429         } else {
5430             ret = se->load_state(f, se->opaque, version_id);
5431             if (ret < 0) {
5432                 fprintf(stderr, "qemu: warning: error while loading state for instance 0x%x of device '%s'\n",
5433                         instance_id, idstr);
5434             }
5435         }
5436         /* always seek to exact end of record */
5437         qemu_fseek(f, cur_pos + record_len, SEEK_SET);
5438     }
5439     ret = 0;
5440  the_end:
5441     return ret;
5442 }
5443
5444 /* device can contain snapshots */
5445 static int bdrv_can_snapshot(BlockDriverState *bs)
5446 {
5447     return (bs &&
5448             !bdrv_is_removable(bs) &&
5449             !bdrv_is_read_only(bs));
5450 }
5451
5452 /* device must be snapshots in order to have a reliable snapshot */
5453 static int bdrv_has_snapshot(BlockDriverState *bs)
5454 {
5455     return (bs &&
5456             !bdrv_is_removable(bs) &&
5457             !bdrv_is_read_only(bs));
5458 }
5459
5460 static BlockDriverState *get_bs_snapshots(void)
5461 {
5462     BlockDriverState *bs;
5463     int i;
5464
5465     if (bs_snapshots)
5466         return bs_snapshots;
5467     for(i = 0; i <= MAX_DISKS; i++) {
5468         bs = bs_table[i];
5469         if (bdrv_can_snapshot(bs))
5470             goto ok;
5471     }
5472     return NULL;
5473  ok:
5474     bs_snapshots = bs;
5475     return bs;
5476 }
5477
5478 static int bdrv_snapshot_find(BlockDriverState *bs, QEMUSnapshotInfo *sn_info,
5479                               const char *name)
5480 {
5481     QEMUSnapshotInfo *sn_tab, *sn;
5482     int nb_sns, i, ret;
5483
5484     ret = -ENOENT;
5485     nb_sns = bdrv_snapshot_list(bs, &sn_tab);
5486     if (nb_sns < 0)
5487         return ret;
5488     for(i = 0; i < nb_sns; i++) {
5489         sn = &sn_tab[i];
5490         if (!strcmp(sn->id_str, name) || !strcmp(sn->name, name)) {
5491             *sn_info = *sn;
5492             ret = 0;
5493             break;
5494         }
5495     }
5496     qemu_free(sn_tab);
5497     return ret;
5498 }
5499
5500 void do_savevm(const char *name)
5501 {
5502     BlockDriverState *bs, *bs1;
5503     QEMUSnapshotInfo sn1, *sn = &sn1, old_sn1, *old_sn = &old_sn1;
5504     int must_delete, ret, i;
5505     BlockDriverInfo bdi1, *bdi = &bdi1;
5506     QEMUFile *f;
5507     int saved_vm_running;
5508 #ifdef _WIN32
5509     struct _timeb tb;
5510 #else
5511     struct timeval tv;
5512 #endif
5513
5514     bs = get_bs_snapshots();
5515     if (!bs) {
5516         term_printf("No block device can accept snapshots\n");
5517         return;
5518     }
5519
5520     /* ??? Should this occur after vm_stop?  */
5521     qemu_aio_flush();
5522
5523     saved_vm_running = vm_running;
5524     vm_stop(0);
5525
5526     must_delete = 0;
5527     if (name) {
5528         ret = bdrv_snapshot_find(bs, old_sn, name);
5529         if (ret >= 0) {
5530             must_delete = 1;
5531         }
5532     }
5533     memset(sn, 0, sizeof(*sn));
5534     if (must_delete) {
5535         pstrcpy(sn->name, sizeof(sn->name), old_sn->name);
5536         pstrcpy(sn->id_str, sizeof(sn->id_str), old_sn->id_str);
5537     } else {
5538         if (name)
5539             pstrcpy(sn->name, sizeof(sn->name), name);
5540     }
5541
5542     /* fill auxiliary fields */
5543 #ifdef _WIN32
5544     _ftime(&tb);
5545     sn->date_sec = tb.time;
5546     sn->date_nsec = tb.millitm * 1000000;
5547 #else
5548     gettimeofday(&tv, NULL);
5549     sn->date_sec = tv.tv_sec;
5550     sn->date_nsec = tv.tv_usec * 1000;
5551 #endif
5552     sn->vm_clock_nsec = qemu_get_clock(vm_clock);
5553
5554     if (bdrv_get_info(bs, bdi) < 0 || bdi->vm_state_offset <= 0) {
5555         term_printf("Device %s does not support VM state snapshots\n",
5556                     bdrv_get_device_name(bs));
5557         goto the_end;
5558     }
5559
5560     /* save the VM state */
5561     f = qemu_fopen_bdrv(bs, bdi->vm_state_offset, 1);
5562     if (!f) {
5563         term_printf("Could not open VM state file\n");
5564         goto the_end;
5565     }
5566     ret = qemu_savevm_state(f);
5567     sn->vm_state_size = qemu_ftell(f);
5568     qemu_fclose(f);
5569     if (ret < 0) {
5570         term_printf("Error %d while writing VM\n", ret);
5571         goto the_end;
5572     }
5573
5574     /* create the snapshots */
5575
5576     for(i = 0; i < MAX_DISKS; i++) {
5577         bs1 = bs_table[i];
5578         if (bdrv_has_snapshot(bs1)) {
5579             if (must_delete) {
5580                 ret = bdrv_snapshot_delete(bs1, old_sn->id_str);
5581                 if (ret < 0) {
5582                     term_printf("Error while deleting snapshot on '%s'\n",
5583                                 bdrv_get_device_name(bs1));
5584                 }
5585             }
5586             ret = bdrv_snapshot_create(bs1, sn);
5587             if (ret < 0) {
5588                 term_printf("Error while creating snapshot on '%s'\n",
5589                             bdrv_get_device_name(bs1));
5590             }
5591         }
5592     }
5593
5594  the_end:
5595     if (saved_vm_running)
5596         vm_start();
5597 }
5598
5599 void do_loadvm(const char *name)
5600 {
5601     BlockDriverState *bs, *bs1;
5602     BlockDriverInfo bdi1, *bdi = &bdi1;
5603     QEMUFile *f;
5604     int i, ret;
5605     int saved_vm_running;
5606
5607     bs = get_bs_snapshots();
5608     if (!bs) {
5609         term_printf("No block device supports snapshots\n");
5610         return;
5611     }
5612
5613     /* Flush all IO requests so they don't interfere with the new state.  */
5614     qemu_aio_flush();
5615
5616     saved_vm_running = vm_running;
5617     vm_stop(0);
5618
5619     for(i = 0; i <= MAX_DISKS; i++) {
5620         bs1 = bs_table[i];
5621         if (bdrv_has_snapshot(bs1)) {
5622             ret = bdrv_snapshot_goto(bs1, name);
5623             if (ret < 0) {
5624                 if (bs != bs1)
5625                     term_printf("Warning: ");
5626                 switch(ret) {
5627                 case -ENOTSUP:
5628                     term_printf("Snapshots not supported on device '%s'\n",
5629                                 bdrv_get_device_name(bs1));
5630                     break;
5631                 case -ENOENT:
5632                     term_printf("Could not find snapshot '%s' on device '%s'\n",
5633                                 name, bdrv_get_device_name(bs1));
5634                     break;
5635                 default:
5636                     term_printf("Error %d while activating snapshot on '%s'\n",
5637                                 ret, bdrv_get_device_name(bs1));
5638                     break;
5639                 }
5640                 /* fatal on snapshot block device */
5641                 if (bs == bs1)
5642                     goto the_end;
5643             }
5644         }
5645     }
5646
5647     if (bdrv_get_info(bs, bdi) < 0 || bdi->vm_state_offset <= 0) {
5648         term_printf("Device %s does not support VM state snapshots\n",
5649                     bdrv_get_device_name(bs));
5650         return;
5651     }
5652
5653     /* restore the VM state */
5654     f = qemu_fopen_bdrv(bs, bdi->vm_state_offset, 0);
5655     if (!f) {
5656         term_printf("Could not open VM state file\n");
5657         goto the_end;
5658     }
5659     ret = qemu_loadvm_state(f);
5660     qemu_fclose(f);
5661     if (ret < 0) {
5662         term_printf("Error %d while loading VM state\n", ret);
5663     }
5664  the_end:
5665     if (saved_vm_running)
5666         vm_start();
5667 }
5668
5669 void do_delvm(const char *name)
5670 {
5671     BlockDriverState *bs, *bs1;
5672     int i, ret;
5673
5674     bs = get_bs_snapshots();
5675     if (!bs) {
5676         term_printf("No block device supports snapshots\n");
5677         return;
5678     }
5679
5680     for(i = 0; i <= MAX_DISKS; i++) {
5681         bs1 = bs_table[i];
5682         if (bdrv_has_snapshot(bs1)) {
5683             ret = bdrv_snapshot_delete(bs1, name);
5684             if (ret < 0) {
5685                 if (ret == -ENOTSUP)
5686                     term_printf("Snapshots not supported on device '%s'\n",
5687                                 bdrv_get_device_name(bs1));
5688                 else
5689                     term_printf("Error %d while deleting snapshot on '%s'\n",
5690                                 ret, bdrv_get_device_name(bs1));
5691             }
5692         }
5693     }
5694 }
5695
5696 void do_info_snapshots(void)
5697 {
5698     BlockDriverState *bs, *bs1;
5699     QEMUSnapshotInfo *sn_tab, *sn;
5700     int nb_sns, i;
5701     char buf[256];
5702
5703     bs = get_bs_snapshots();
5704     if (!bs) {
5705         term_printf("No available block device supports snapshots\n");
5706         return;
5707     }
5708     term_printf("Snapshot devices:");
5709     for(i = 0; i <= MAX_DISKS; i++) {
5710         bs1 = bs_table[i];
5711         if (bdrv_has_snapshot(bs1)) {
5712             if (bs == bs1)
5713                 term_printf(" %s", bdrv_get_device_name(bs1));
5714         }
5715     }
5716     term_printf("\n");
5717
5718     nb_sns = bdrv_snapshot_list(bs, &sn_tab);
5719     if (nb_sns < 0) {
5720         term_printf("bdrv_snapshot_list: error %d\n", nb_sns);
5721         return;
5722     }
5723     term_printf("Snapshot list (from %s):\n", bdrv_get_device_name(bs));
5724     term_printf("%s\n", bdrv_snapshot_dump(buf, sizeof(buf), NULL));
5725     for(i = 0; i < nb_sns; i++) {
5726         sn = &sn_tab[i];
5727         term_printf("%s\n", bdrv_snapshot_dump(buf, sizeof(buf), sn));
5728     }
5729     qemu_free(sn_tab);
5730 }
5731
5732 /***********************************************************/
5733 /* cpu save/restore */
5734
5735 #if defined(TARGET_I386)
5736
5737 static void cpu_put_seg(QEMUFile *f, SegmentCache *dt)
5738 {
5739     qemu_put_be32(f, dt->selector);
5740     qemu_put_betl(f, dt->base);
5741     qemu_put_be32(f, dt->limit);
5742     qemu_put_be32(f, dt->flags);
5743 }
5744
5745 static void cpu_get_seg(QEMUFile *f, SegmentCache *dt)
5746 {
5747     dt->selector = qemu_get_be32(f);
5748     dt->base = qemu_get_betl(f);
5749     dt->limit = qemu_get_be32(f);
5750     dt->flags = qemu_get_be32(f);
5751 }
5752
5753 void cpu_save(QEMUFile *f, void *opaque)
5754 {
5755     CPUState *env = opaque;
5756     uint16_t fptag, fpus, fpuc, fpregs_format;
5757     uint32_t hflags;
5758     int i;
5759
5760     for(i = 0; i < CPU_NB_REGS; i++)
5761         qemu_put_betls(f, &env->regs[i]);
5762     qemu_put_betls(f, &env->eip);
5763     qemu_put_betls(f, &env->eflags);
5764     hflags = env->hflags; /* XXX: suppress most of the redundant hflags */
5765     qemu_put_be32s(f, &hflags);
5766
5767     /* FPU */
5768     fpuc = env->fpuc;
5769     fpus = (env->fpus & ~0x3800) | (env->fpstt & 0x7) << 11;
5770     fptag = 0;
5771     for(i = 0; i < 8; i++) {
5772         fptag |= ((!env->fptags[i]) << i);
5773     }
5774
5775     qemu_put_be16s(f, &fpuc);
5776     qemu_put_be16s(f, &fpus);
5777     qemu_put_be16s(f, &fptag);
5778
5779 #ifdef USE_X86LDOUBLE
5780     fpregs_format = 0;
5781 #else
5782     fpregs_format = 1;
5783 #endif
5784     qemu_put_be16s(f, &fpregs_format);
5785
5786     for(i = 0; i < 8; i++) {
5787 #ifdef USE_X86LDOUBLE
5788         {
5789             uint64_t mant;
5790             uint16_t exp;
5791             /* we save the real CPU data (in case of MMX usage only 'mant'
5792                contains the MMX register */
5793             cpu_get_fp80(&mant, &exp, env->fpregs[i].d);
5794             qemu_put_be64(f, mant);
5795             qemu_put_be16(f, exp);
5796         }
5797 #else
5798         /* if we use doubles for float emulation, we save the doubles to
5799            avoid losing information in case of MMX usage. It can give
5800            problems if the image is restored on a CPU where long
5801            doubles are used instead. */
5802         qemu_put_be64(f, env->fpregs[i].mmx.MMX_Q(0));
5803 #endif
5804     }
5805
5806     for(i = 0; i < 6; i++)
5807         cpu_put_seg(f, &env->segs[i]);
5808     cpu_put_seg(f, &env->ldt);
5809     cpu_put_seg(f, &env->tr);
5810     cpu_put_seg(f, &env->gdt);
5811     cpu_put_seg(f, &env->idt);
5812
5813     qemu_put_be32s(f, &env->sysenter_cs);
5814     qemu_put_be32s(f, &env->sysenter_esp);
5815     qemu_put_be32s(f, &env->sysenter_eip);
5816
5817     qemu_put_betls(f, &env->cr[0]);
5818     qemu_put_betls(f, &env->cr[2]);
5819     qemu_put_betls(f, &env->cr[3]);
5820     qemu_put_betls(f, &env->cr[4]);
5821
5822     for(i = 0; i < 8; i++)
5823         qemu_put_betls(f, &env->dr[i]);
5824
5825     /* MMU */
5826     qemu_put_be32s(f, &env->a20_mask);
5827
5828     /* XMM */
5829     qemu_put_be32s(f, &env->mxcsr);
5830     for(i = 0; i < CPU_NB_REGS; i++) {
5831         qemu_put_be64s(f, &env->xmm_regs[i].XMM_Q(0));
5832         qemu_put_be64s(f, &env->xmm_regs[i].XMM_Q(1));
5833     }
5834
5835 #ifdef TARGET_X86_64
5836     qemu_put_be64s(f, &env->efer);
5837     qemu_put_be64s(f, &env->star);
5838     qemu_put_be64s(f, &env->lstar);
5839     qemu_put_be64s(f, &env->cstar);
5840     qemu_put_be64s(f, &env->fmask);
5841     qemu_put_be64s(f, &env->kernelgsbase);
5842 #endif
5843     qemu_put_be32s(f, &env->smbase);
5844 }
5845
5846 #ifdef USE_X86LDOUBLE
5847 /* XXX: add that in a FPU generic layer */
5848 union x86_longdouble {
5849     uint64_t mant;
5850     uint16_t exp;
5851 };
5852
5853 #define MANTD1(fp)      (fp & ((1LL << 52) - 1))
5854 #define EXPBIAS1 1023
5855 #define EXPD1(fp)       ((fp >> 52) & 0x7FF)
5856 #define SIGND1(fp)      ((fp >> 32) & 0x80000000)
5857
5858 static void fp64_to_fp80(union x86_longdouble *p, uint64_t temp)
5859 {
5860     int e;
5861     /* mantissa */
5862     p->mant = (MANTD1(temp) << 11) | (1LL << 63);
5863     /* exponent + sign */
5864     e = EXPD1(temp) - EXPBIAS1 + 16383;
5865     e |= SIGND1(temp) >> 16;
5866     p->exp = e;
5867 }
5868 #endif
5869
5870 int cpu_load(QEMUFile *f, void *opaque, int version_id)
5871 {
5872     CPUState *env = opaque;
5873     int i, guess_mmx;
5874     uint32_t hflags;
5875     uint16_t fpus, fpuc, fptag, fpregs_format;
5876
5877     if (version_id != 3 && version_id != 4)
5878         return -EINVAL;
5879     for(i = 0; i < CPU_NB_REGS; i++)
5880         qemu_get_betls(f, &env->regs[i]);
5881     qemu_get_betls(f, &env->eip);
5882     qemu_get_betls(f, &env->eflags);
5883     qemu_get_be32s(f, &hflags);
5884
5885     qemu_get_be16s(f, &fpuc);
5886     qemu_get_be16s(f, &fpus);
5887     qemu_get_be16s(f, &fptag);
5888     qemu_get_be16s(f, &fpregs_format);
5889
5890     /* NOTE: we cannot always restore the FPU state if the image come
5891        from a host with a different 'USE_X86LDOUBLE' define. We guess
5892        if we are in an MMX state to restore correctly in that case. */
5893     guess_mmx = ((fptag == 0xff) && (fpus & 0x3800) == 0);
5894     for(i = 0; i < 8; i++) {
5895         uint64_t mant;
5896         uint16_t exp;
5897
5898         switch(fpregs_format) {
5899         case 0:
5900             mant = qemu_get_be64(f);
5901             exp = qemu_get_be16(f);
5902 #ifdef USE_X86LDOUBLE
5903             env->fpregs[i].d = cpu_set_fp80(mant, exp);
5904 #else
5905             /* difficult case */
5906             if (guess_mmx)
5907                 env->fpregs[i].mmx.MMX_Q(0) = mant;
5908             else
5909                 env->fpregs[i].d = cpu_set_fp80(mant, exp);
5910 #endif
5911             break;
5912         case 1:
5913             mant = qemu_get_be64(f);
5914 #ifdef USE_X86LDOUBLE
5915             {
5916                 union x86_longdouble *p;
5917                 /* difficult case */
5918                 p = (void *)&env->fpregs[i];
5919                 if (guess_mmx) {
5920                     p->mant = mant;
5921                     p->exp = 0xffff;
5922                 } else {
5923                     fp64_to_fp80(p, mant);
5924                 }
5925             }
5926 #else
5927             env->fpregs[i].mmx.MMX_Q(0) = mant;
5928 #endif
5929             break;
5930         default:
5931             return -EINVAL;
5932         }
5933     }
5934
5935     env->fpuc = fpuc;
5936     /* XXX: restore FPU round state */
5937     env->fpstt = (fpus >> 11) & 7;
5938     env->fpus = fpus & ~0x3800;
5939     fptag ^= 0xff;
5940     for(i = 0; i < 8; i++) {
5941         env->fptags[i] = (fptag >> i) & 1;
5942     }
5943
5944     for(i = 0; i < 6; i++)
5945         cpu_get_seg(f, &env->segs[i]);
5946     cpu_get_seg(f, &env->ldt);
5947     cpu_get_seg(f, &env->tr);
5948     cpu_get_seg(f, &env->gdt);
5949     cpu_get_seg(f, &env->idt);
5950
5951     qemu_get_be32s(f, &env->sysenter_cs);
5952     qemu_get_be32s(f, &env->sysenter_esp);
5953     qemu_get_be32s(f, &env->sysenter_eip);
5954
5955     qemu_get_betls(f, &env->cr[0]);
5956     qemu_get_betls(f, &env->cr[2]);
5957     qemu_get_betls(f, &env->cr[3]);
5958     qemu_get_betls(f, &env->cr[4]);
5959
5960     for(i = 0; i < 8; i++)
5961         qemu_get_betls(f, &env->dr[i]);
5962
5963     /* MMU */
5964     qemu_get_be32s(f, &env->a20_mask);
5965
5966     qemu_get_be32s(f, &env->mxcsr);
5967     for(i = 0; i < CPU_NB_REGS; i++) {
5968         qemu_get_be64s(f, &env->xmm_regs[i].XMM_Q(0));
5969         qemu_get_be64s(f, &env->xmm_regs[i].XMM_Q(1));
5970     }
5971
5972 #ifdef TARGET_X86_64
5973     qemu_get_be64s(f, &env->efer);
5974     qemu_get_be64s(f, &env->star);
5975     qemu_get_be64s(f, &env->lstar);
5976     qemu_get_be64s(f, &env->cstar);
5977     qemu_get_be64s(f, &env->fmask);
5978     qemu_get_be64s(f, &env->kernelgsbase);
5979 #endif
5980     if (version_id >= 4)
5981         qemu_get_be32s(f, &env->smbase);
5982
5983     /* XXX: compute hflags from scratch, except for CPL and IIF */
5984     env->hflags = hflags;
5985     tlb_flush(env, 1);
5986     return 0;
5987 }
5988
5989 #elif defined(TARGET_PPC)
5990 void cpu_save(QEMUFile *f, void *opaque)
5991 {
5992 }
5993
5994 int cpu_load(QEMUFile *f, void *opaque, int version_id)
5995 {
5996     return 0;
5997 }
5998
5999 #elif defined(TARGET_MIPS)
6000 void cpu_save(QEMUFile *f, void *opaque)
6001 {
6002 }
6003
6004 int cpu_load(QEMUFile *f, void *opaque, int version_id)
6005 {
6006     return 0;
6007 }
6008
6009 #elif defined(TARGET_SPARC)
6010 void cpu_save(QEMUFile *f, void *opaque)
6011 {
6012     CPUState *env = opaque;
6013     int i;
6014     uint32_t tmp;
6015
6016     for(i = 0; i < 8; i++)
6017         qemu_put_betls(f, &env->gregs[i]);
6018     for(i = 0; i < NWINDOWS * 16; i++)
6019         qemu_put_betls(f, &env->regbase[i]);
6020
6021     /* FPU */
6022     for(i = 0; i < TARGET_FPREGS; i++) {
6023         union {
6024             float32 f;
6025             uint32_t i;
6026         } u;
6027         u.f = env->fpr[i];
6028         qemu_put_be32(f, u.i);
6029     }
6030
6031     qemu_put_betls(f, &env->pc);
6032     qemu_put_betls(f, &env->npc);
6033     qemu_put_betls(f, &env->y);
6034     tmp = GET_PSR(env);
6035     qemu_put_be32(f, tmp);
6036     qemu_put_betls(f, &env->fsr);
6037     qemu_put_betls(f, &env->tbr);
6038 #ifndef TARGET_SPARC64
6039     qemu_put_be32s(f, &env->wim);
6040     /* MMU */
6041     for(i = 0; i < 16; i++)
6042         qemu_put_be32s(f, &env->mmuregs[i]);
6043 #endif
6044 }
6045
6046 int cpu_load(QEMUFile *f, void *opaque, int version_id)
6047 {
6048     CPUState *env = opaque;
6049     int i;
6050     uint32_t tmp;
6051
6052     for(i = 0; i < 8; i++)
6053         qemu_get_betls(f, &env->gregs[i]);
6054     for(i = 0; i < NWINDOWS * 16; i++)
6055         qemu_get_betls(f, &env->regbase[i]);
6056
6057     /* FPU */
6058     for(i = 0; i < TARGET_FPREGS; i++) {
6059         union {
6060             float32 f;
6061             uint32_t i;
6062         } u;
6063         u.i = qemu_get_be32(f);
6064         env->fpr[i] = u.f;
6065     }
6066
6067     qemu_get_betls(f, &env->pc);
6068     qemu_get_betls(f, &env->npc);
6069     qemu_get_betls(f, &env->y);
6070     tmp = qemu_get_be32(f);
6071     env->cwp = 0; /* needed to ensure that the wrapping registers are
6072                      correctly updated */
6073     PUT_PSR(env, tmp);
6074     qemu_get_betls(f, &env->fsr);
6075     qemu_get_betls(f, &env->tbr);
6076 #ifndef TARGET_SPARC64
6077     qemu_get_be32s(f, &env->wim);
6078     /* MMU */
6079     for(i = 0; i < 16; i++)
6080         qemu_get_be32s(f, &env->mmuregs[i]);
6081 #endif
6082     tlb_flush(env, 1);
6083     return 0;
6084 }
6085
6086 #elif defined(TARGET_ARM)
6087
6088 void cpu_save(QEMUFile *f, void *opaque)
6089 {
6090     int i;
6091     CPUARMState *env = (CPUARMState *)opaque;
6092
6093     for (i = 0; i < 16; i++) {
6094         qemu_put_be32(f, env->regs[i]);
6095     }
6096     qemu_put_be32(f, cpsr_read(env));
6097     qemu_put_be32(f, env->spsr);
6098     for (i = 0; i < 6; i++) {
6099         qemu_put_be32(f, env->banked_spsr[i]);
6100         qemu_put_be32(f, env->banked_r13[i]);
6101         qemu_put_be32(f, env->banked_r14[i]);
6102     }
6103     for (i = 0; i < 5; i++) {
6104         qemu_put_be32(f, env->usr_regs[i]);
6105         qemu_put_be32(f, env->fiq_regs[i]);
6106     }
6107     qemu_put_be32(f, env->cp15.c0_cpuid);
6108     qemu_put_be32(f, env->cp15.c0_cachetype);
6109     qemu_put_be32(f, env->cp15.c1_sys);
6110     qemu_put_be32(f, env->cp15.c1_coproc);
6111     qemu_put_be32(f, env->cp15.c1_xscaleauxcr);
6112     qemu_put_be32(f, env->cp15.c2_base);
6113     qemu_put_be32(f, env->cp15.c2_data);
6114     qemu_put_be32(f, env->cp15.c2_insn);
6115     qemu_put_be32(f, env->cp15.c3);
6116     qemu_put_be32(f, env->cp15.c5_insn);
6117     qemu_put_be32(f, env->cp15.c5_data);
6118     for (i = 0; i < 8; i++) {
6119         qemu_put_be32(f, env->cp15.c6_region[i]);
6120     }
6121     qemu_put_be32(f, env->cp15.c6_insn);
6122     qemu_put_be32(f, env->cp15.c6_data);
6123     qemu_put_be32(f, env->cp15.c9_insn);
6124     qemu_put_be32(f, env->cp15.c9_data);
6125     qemu_put_be32(f, env->cp15.c13_fcse);
6126     qemu_put_be32(f, env->cp15.c13_context);
6127     qemu_put_be32(f, env->cp15.c15_cpar);
6128
6129     qemu_put_be32(f, env->features);
6130
6131     if (arm_feature(env, ARM_FEATURE_VFP)) {
6132         for (i = 0;  i < 16; i++) {
6133             CPU_DoubleU u;
6134             u.d = env->vfp.regs[i];
6135             qemu_put_be32(f, u.l.upper);
6136             qemu_put_be32(f, u.l.lower);
6137         }
6138         for (i = 0; i < 16; i++) {
6139             qemu_put_be32(f, env->vfp.xregs[i]);
6140         }
6141
6142         /* TODO: Should use proper FPSCR access functions.  */
6143         qemu_put_be32(f, env->vfp.vec_len);
6144         qemu_put_be32(f, env->vfp.vec_stride);
6145     }
6146
6147     if (arm_feature(env, ARM_FEATURE_IWMMXT)) {
6148         for (i = 0; i < 16; i++) {
6149             qemu_put_be64(f, env->iwmmxt.regs[i]);
6150         }
6151         for (i = 0; i < 16; i++) {
6152             qemu_put_be32(f, env->iwmmxt.cregs[i]);
6153         }
6154     }
6155 }
6156
6157 int cpu_load(QEMUFile *f, void *opaque, int version_id)
6158 {
6159     CPUARMState *env = (CPUARMState *)opaque;
6160     int i;
6161
6162     if (version_id != 0)
6163         return -EINVAL;
6164
6165     for (i = 0; i < 16; i++) {
6166         env->regs[i] = qemu_get_be32(f);
6167     }
6168     cpsr_write(env, qemu_get_be32(f), 0xffffffff);
6169     env->spsr = qemu_get_be32(f);
6170     for (i = 0; i < 6; i++) {
6171         env->banked_spsr[i] = qemu_get_be32(f);
6172         env->banked_r13[i] = qemu_get_be32(f);
6173         env->banked_r14[i] = qemu_get_be32(f);
6174     }
6175     for (i = 0; i < 5; i++) {
6176         env->usr_regs[i] = qemu_get_be32(f);
6177         env->fiq_regs[i] = qemu_get_be32(f);
6178     }
6179     env->cp15.c0_cpuid = qemu_get_be32(f);
6180     env->cp15.c0_cachetype = qemu_get_be32(f);
6181     env->cp15.c1_sys = qemu_get_be32(f);
6182     env->cp15.c1_coproc = qemu_get_be32(f);
6183     env->cp15.c1_xscaleauxcr = qemu_get_be32(f);
6184     env->cp15.c2_base = qemu_get_be32(f);
6185     env->cp15.c2_data = qemu_get_be32(f);
6186     env->cp15.c2_insn = qemu_get_be32(f);
6187     env->cp15.c3 = qemu_get_be32(f);
6188     env->cp15.c5_insn = qemu_get_be32(f);
6189     env->cp15.c5_data = qemu_get_be32(f);
6190     for (i = 0; i < 8; i++) {
6191         env->cp15.c6_region[i] = qemu_get_be32(f);
6192     }
6193     env->cp15.c6_insn = qemu_get_be32(f);
6194     env->cp15.c6_data = qemu_get_be32(f);
6195     env->cp15.c9_insn = qemu_get_be32(f);
6196     env->cp15.c9_data = qemu_get_be32(f);
6197     env->cp15.c13_fcse = qemu_get_be32(f);
6198     env->cp15.c13_context = qemu_get_be32(f);
6199     env->cp15.c15_cpar = qemu_get_be32(f);
6200
6201     env->features = qemu_get_be32(f);
6202
6203     if (arm_feature(env, ARM_FEATURE_VFP)) {
6204         for (i = 0;  i < 16; i++) {
6205             CPU_DoubleU u;
6206             u.l.upper = qemu_get_be32(f);
6207             u.l.lower = qemu_get_be32(f);
6208             env->vfp.regs[i] = u.d;
6209         }
6210         for (i = 0; i < 16; i++) {
6211             env->vfp.xregs[i] = qemu_get_be32(f);
6212         }
6213
6214         /* TODO: Should use proper FPSCR access functions.  */
6215         env->vfp.vec_len = qemu_get_be32(f);
6216         env->vfp.vec_stride = qemu_get_be32(f);
6217     }
6218
6219     if (arm_feature(env, ARM_FEATURE_IWMMXT)) {
6220         for (i = 0; i < 16; i++) {
6221             env->iwmmxt.regs[i] = qemu_get_be64(f);
6222         }
6223         for (i = 0; i < 16; i++) {
6224             env->iwmmxt.cregs[i] = qemu_get_be32(f);
6225         }
6226     }
6227
6228     return 0;
6229 }
6230
6231 #else
6232
6233 #warning No CPU save/restore functions
6234
6235 #endif
6236
6237 /***********************************************************/
6238 /* ram save/restore */
6239
6240 static int ram_get_page(QEMUFile *f, uint8_t *buf, int len)
6241 {
6242     int v;
6243
6244     v = qemu_get_byte(f);
6245     switch(v) {
6246     case 0:
6247         if (qemu_get_buffer(f, buf, len) != len)
6248             return -EIO;
6249         break;
6250     case 1:
6251         v = qemu_get_byte(f);
6252         memset(buf, v, len);
6253         break;
6254     default:
6255         return -EINVAL;
6256     }
6257     return 0;
6258 }
6259
6260 static int ram_load_v1(QEMUFile *f, void *opaque)
6261 {
6262     int i, ret;
6263
6264     if (qemu_get_be32(f) != phys_ram_size)
6265         return -EINVAL;
6266     for(i = 0; i < phys_ram_size; i+= TARGET_PAGE_SIZE) {
6267         ret = ram_get_page(f, phys_ram_base + i, TARGET_PAGE_SIZE);
6268         if (ret)
6269             return ret;
6270     }
6271     return 0;
6272 }
6273
6274 #define BDRV_HASH_BLOCK_SIZE 1024
6275 #define IOBUF_SIZE 4096
6276 #define RAM_CBLOCK_MAGIC 0xfabe
6277
6278 typedef struct RamCompressState {
6279     z_stream zstream;
6280     QEMUFile *f;
6281     uint8_t buf[IOBUF_SIZE];
6282 } RamCompressState;
6283
6284 static int ram_compress_open(RamCompressState *s, QEMUFile *f)
6285 {
6286     int ret;
6287     memset(s, 0, sizeof(*s));
6288     s->f = f;
6289     ret = deflateInit2(&s->zstream, 1,
6290                        Z_DEFLATED, 15,
6291                        9, Z_DEFAULT_STRATEGY);
6292     if (ret != Z_OK)
6293         return -1;
6294     s->zstream.avail_out = IOBUF_SIZE;
6295     s->zstream.next_out = s->buf;
6296     return 0;
6297 }
6298
6299 static void ram_put_cblock(RamCompressState *s, const uint8_t *buf, int len)
6300 {
6301     qemu_put_be16(s->f, RAM_CBLOCK_MAGIC);
6302     qemu_put_be16(s->f, len);
6303     qemu_put_buffer(s->f, buf, len);
6304 }
6305
6306 static int ram_compress_buf(RamCompressState *s, const uint8_t *buf, int len)
6307 {
6308     int ret;
6309
6310     s->zstream.avail_in = len;
6311     s->zstream.next_in = (uint8_t *)buf;
6312     while (s->zstream.avail_in > 0) {
6313         ret = deflate(&s->zstream, Z_NO_FLUSH);
6314         if (ret != Z_OK)
6315             return -1;
6316         if (s->zstream.avail_out == 0) {
6317             ram_put_cblock(s, s->buf, IOBUF_SIZE);
6318             s->zstream.avail_out = IOBUF_SIZE;
6319             s->zstream.next_out = s->buf;
6320         }
6321     }
6322     return 0;
6323 }
6324
6325 static void ram_compress_close(RamCompressState *s)
6326 {
6327     int len, ret;
6328
6329     /* compress last bytes */
6330     for(;;) {
6331         ret = deflate(&s->zstream, Z_FINISH);
6332         if (ret == Z_OK || ret == Z_STREAM_END) {
6333             len = IOBUF_SIZE - s->zstream.avail_out;
6334             if (len > 0) {
6335                 ram_put_cblock(s, s->buf, len);
6336             }
6337             s->zstream.avail_out = IOBUF_SIZE;
6338             s->zstream.next_out = s->buf;
6339             if (ret == Z_STREAM_END)
6340                 break;
6341         } else {
6342             goto fail;
6343         }
6344     }
6345 fail:
6346     deflateEnd(&s->zstream);
6347 }
6348
6349 typedef struct RamDecompressState {
6350     z_stream zstream;
6351     QEMUFile *f;
6352     uint8_t buf[IOBUF_SIZE];
6353 } RamDecompressState;
6354
6355 static int ram_decompress_open(RamDecompressState *s, QEMUFile *f)
6356 {
6357     int ret;
6358     memset(s, 0, sizeof(*s));
6359     s->f = f;
6360     ret = inflateInit(&s->zstream);
6361     if (ret != Z_OK)
6362         return -1;
6363     return 0;
6364 }
6365
6366 static int ram_decompress_buf(RamDecompressState *s, uint8_t *buf, int len)
6367 {
6368     int ret, clen;
6369
6370     s->zstream.avail_out = len;
6371     s->zstream.next_out = buf;
6372     while (s->zstream.avail_out > 0) {
6373         if (s->zstream.avail_in == 0) {
6374             if (qemu_get_be16(s->f) != RAM_CBLOCK_MAGIC)
6375                 return -1;
6376             clen = qemu_get_be16(s->f);
6377             if (clen > IOBUF_SIZE)
6378                 return -1;
6379             qemu_get_buffer(s->f, s->buf, clen);
6380             s->zstream.avail_in = clen;
6381             s->zstream.next_in = s->buf;
6382         }
6383         ret = inflate(&s->zstream, Z_PARTIAL_FLUSH);
6384         if (ret != Z_OK && ret != Z_STREAM_END) {
6385             return -1;
6386         }
6387     }
6388     return 0;
6389 }
6390
6391 static void ram_decompress_close(RamDecompressState *s)
6392 {
6393     inflateEnd(&s->zstream);
6394 }
6395
6396 static void ram_save(QEMUFile *f, void *opaque)
6397 {
6398     int i;
6399     RamCompressState s1, *s = &s1;
6400     uint8_t buf[10];
6401
6402     qemu_put_be32(f, phys_ram_size);
6403     if (ram_compress_open(s, f) < 0)
6404         return;
6405     for(i = 0; i < phys_ram_size; i+= BDRV_HASH_BLOCK_SIZE) {
6406 #if 0
6407         if (tight_savevm_enabled) {
6408             int64_t sector_num;
6409             int j;
6410
6411             /* find if the memory block is available on a virtual
6412                block device */
6413             sector_num = -1;
6414             for(j = 0; j < MAX_DISKS; j++) {
6415                 if (bs_table[j]) {
6416                     sector_num = bdrv_hash_find(bs_table[j],
6417                                                 phys_ram_base + i, BDRV_HASH_BLOCK_SIZE);
6418                     if (sector_num >= 0)
6419                         break;
6420                 }
6421             }
6422             if (j == MAX_DISKS)
6423                 goto normal_compress;
6424             buf[0] = 1;
6425             buf[1] = j;
6426             cpu_to_be64wu((uint64_t *)(buf + 2), sector_num);
6427             ram_compress_buf(s, buf, 10);
6428         } else
6429 #endif
6430         {
6431             //        normal_compress:
6432             buf[0] = 0;
6433             ram_compress_buf(s, buf, 1);
6434             ram_compress_buf(s, phys_ram_base + i, BDRV_HASH_BLOCK_SIZE);
6435         }
6436     }
6437     ram_compress_close(s);
6438 }
6439
6440 static int ram_load(QEMUFile *f, void *opaque, int version_id)
6441 {
6442     RamDecompressState s1, *s = &s1;
6443     uint8_t buf[10];
6444     int i;
6445
6446     if (version_id == 1)
6447         return ram_load_v1(f, opaque);
6448     if (version_id != 2)
6449         return -EINVAL;
6450     if (qemu_get_be32(f) != phys_ram_size)
6451         return -EINVAL;
6452     if (ram_decompress_open(s, f) < 0)
6453         return -EINVAL;
6454     for(i = 0; i < phys_ram_size; i+= BDRV_HASH_BLOCK_SIZE) {
6455         if (ram_decompress_buf(s, buf, 1) < 0) {
6456             fprintf(stderr, "Error while reading ram block header\n");
6457             goto error;
6458         }
6459         if (buf[0] == 0) {
6460             if (ram_decompress_buf(s, phys_ram_base + i, BDRV_HASH_BLOCK_SIZE) < 0) {
6461                 fprintf(stderr, "Error while reading ram block address=0x%08x", i);
6462                 goto error;
6463             }
6464         } else
6465 #if 0
6466         if (buf[0] == 1) {
6467             int bs_index;
6468             int64_t sector_num;
6469
6470             ram_decompress_buf(s, buf + 1, 9);
6471             bs_index = buf[1];
6472             sector_num = be64_to_cpupu((const uint64_t *)(buf + 2));
6473             if (bs_index >= MAX_DISKS || bs_table[bs_index] == NULL) {
6474                 fprintf(stderr, "Invalid block device index %d\n", bs_index);
6475                 goto error;
6476             }
6477             if (bdrv_read(bs_table[bs_index], sector_num, phys_ram_base + i,
6478                           BDRV_HASH_BLOCK_SIZE / 512) < 0) {
6479                 fprintf(stderr, "Error while reading sector %d:%" PRId64 "\n",
6480                         bs_index, sector_num);
6481                 goto error;
6482             }
6483         } else
6484 #endif
6485         {
6486         error:
6487             printf("Error block header\n");
6488             return -EINVAL;
6489         }
6490     }
6491     ram_decompress_close(s);
6492     return 0;
6493 }
6494
6495 /***********************************************************/
6496 /* bottom halves (can be seen as timers which expire ASAP) */
6497
6498 struct QEMUBH {
6499     QEMUBHFunc *cb;
6500     void *opaque;
6501     int scheduled;
6502     QEMUBH *next;
6503 };
6504
6505 static QEMUBH *first_bh = NULL;
6506
6507 QEMUBH *qemu_bh_new(QEMUBHFunc *cb, void *opaque)
6508 {
6509     QEMUBH *bh;
6510     bh = qemu_mallocz(sizeof(QEMUBH));
6511     if (!bh)
6512         return NULL;
6513     bh->cb = cb;
6514     bh->opaque = opaque;
6515     return bh;
6516 }
6517
6518 int qemu_bh_poll(void)
6519 {
6520     QEMUBH *bh, **pbh;
6521     int ret;
6522
6523     ret = 0;
6524     for(;;) {
6525         pbh = &first_bh;
6526         bh = *pbh;
6527         if (!bh)
6528             break;
6529         ret = 1;
6530         *pbh = bh->next;
6531         bh->scheduled = 0;
6532         bh->cb(bh->opaque);
6533     }
6534     return ret;
6535 }
6536
6537 void qemu_bh_schedule(QEMUBH *bh)
6538 {
6539     CPUState *env = cpu_single_env;
6540     if (bh->scheduled)
6541         return;
6542     bh->scheduled = 1;
6543     bh->next = first_bh;
6544     first_bh = bh;
6545
6546     /* stop the currently executing CPU to execute the BH ASAP */
6547     if (env) {
6548         cpu_interrupt(env, CPU_INTERRUPT_EXIT);
6549     }
6550 }
6551
6552 void qemu_bh_cancel(QEMUBH *bh)
6553 {
6554     QEMUBH **pbh;
6555     if (bh->scheduled) {
6556         pbh = &first_bh;
6557         while (*pbh != bh)
6558             pbh = &(*pbh)->next;
6559         *pbh = bh->next;
6560         bh->scheduled = 0;
6561     }
6562 }
6563
6564 void qemu_bh_delete(QEMUBH *bh)
6565 {
6566     qemu_bh_cancel(bh);
6567     qemu_free(bh);
6568 }
6569
6570 /***********************************************************/
6571 /* machine registration */
6572
6573 QEMUMachine *first_machine = NULL;
6574
6575 int qemu_register_machine(QEMUMachine *m)
6576 {
6577     QEMUMachine **pm;
6578     pm = &first_machine;
6579     while (*pm != NULL)
6580         pm = &(*pm)->next;
6581     m->next = NULL;
6582     *pm = m;
6583     return 0;
6584 }
6585
6586 QEMUMachine *find_machine(const char *name)
6587 {
6588     QEMUMachine *m;
6589
6590     for(m = first_machine; m != NULL; m = m->next) {
6591         if (!strcmp(m->name, name))
6592             return m;
6593     }
6594     return NULL;
6595 }
6596
6597 /***********************************************************/
6598 /* main execution loop */
6599
6600 void gui_update(void *opaque)
6601 {
6602     DisplayState *ds = opaque;
6603     ds->dpy_refresh(ds);
6604     qemu_mod_timer(ds->gui_timer, GUI_REFRESH_INTERVAL + qemu_get_clock(rt_clock));
6605 }
6606
6607 struct vm_change_state_entry {
6608     VMChangeStateHandler *cb;
6609     void *opaque;
6610     LIST_ENTRY (vm_change_state_entry) entries;
6611 };
6612
6613 static LIST_HEAD(vm_change_state_head, vm_change_state_entry) vm_change_state_head;
6614
6615 VMChangeStateEntry *qemu_add_vm_change_state_handler(VMChangeStateHandler *cb,
6616                                                      void *opaque)
6617 {
6618     VMChangeStateEntry *e;
6619
6620     e = qemu_mallocz(sizeof (*e));
6621     if (!e)
6622         return NULL;
6623
6624     e->cb = cb;
6625     e->opaque = opaque;
6626     LIST_INSERT_HEAD(&vm_change_state_head, e, entries);
6627     return e;
6628 }
6629
6630 void qemu_del_vm_change_state_handler(VMChangeStateEntry *e)
6631 {
6632     LIST_REMOVE (e, entries);
6633     qemu_free (e);
6634 }
6635
6636 static void vm_state_notify(int running)
6637 {
6638     VMChangeStateEntry *e;
6639
6640     for (e = vm_change_state_head.lh_first; e; e = e->entries.le_next) {
6641         e->cb(e->opaque, running);
6642     }
6643 }
6644
6645 /* XXX: support several handlers */
6646 static VMStopHandler *vm_stop_cb;
6647 static void *vm_stop_opaque;
6648
6649 int qemu_add_vm_stop_handler(VMStopHandler *cb, void *opaque)
6650 {
6651     vm_stop_cb = cb;
6652     vm_stop_opaque = opaque;
6653     return 0;
6654 }
6655
6656 void qemu_del_vm_stop_handler(VMStopHandler *cb, void *opaque)
6657 {
6658     vm_stop_cb = NULL;
6659 }
6660
6661 void vm_start(void)
6662 {
6663     if (!vm_running) {
6664         cpu_enable_ticks();
6665         vm_running = 1;
6666         vm_state_notify(1);
6667         qemu_rearm_alarm_timer(alarm_timer);
6668     }
6669 }
6670
6671 void vm_stop(int reason)
6672 {
6673     if (vm_running) {
6674         cpu_disable_ticks();
6675         vm_running = 0;
6676         if (reason != 0) {
6677             if (vm_stop_cb) {
6678                 vm_stop_cb(vm_stop_opaque, reason);
6679             }
6680         }
6681         vm_state_notify(0);
6682     }
6683 }
6684
6685 /* reset/shutdown handler */
6686
6687 typedef struct QEMUResetEntry {
6688     QEMUResetHandler *func;
6689     void *opaque;
6690     struct QEMUResetEntry *next;
6691 } QEMUResetEntry;
6692
6693 static QEMUResetEntry *first_reset_entry;
6694 static int reset_requested;
6695 static int shutdown_requested;
6696 static int powerdown_requested;
6697
6698 void qemu_register_reset(QEMUResetHandler *func, void *opaque)
6699 {
6700     QEMUResetEntry **pre, *re;
6701
6702     pre = &first_reset_entry;
6703     while (*pre != NULL)
6704         pre = &(*pre)->next;
6705     re = qemu_mallocz(sizeof(QEMUResetEntry));
6706     re->func = func;
6707     re->opaque = opaque;
6708     re->next = NULL;
6709     *pre = re;
6710 }
6711
6712 static void qemu_system_reset(void)
6713 {
6714     QEMUResetEntry *re;
6715
6716     /* reset all devices */
6717     for(re = first_reset_entry; re != NULL; re = re->next) {
6718         re->func(re->opaque);
6719     }
6720 }
6721
6722 void qemu_system_reset_request(void)
6723 {
6724     if (no_reboot) {
6725         shutdown_requested = 1;
6726     } else {
6727         reset_requested = 1;
6728     }
6729     if (cpu_single_env)
6730         cpu_interrupt(cpu_single_env, CPU_INTERRUPT_EXIT);
6731 }
6732
6733 void qemu_system_shutdown_request(void)
6734 {
6735     shutdown_requested = 1;
6736     if (cpu_single_env)
6737         cpu_interrupt(cpu_single_env, CPU_INTERRUPT_EXIT);
6738 }
6739
6740 void qemu_system_powerdown_request(void)
6741 {
6742     powerdown_requested = 1;
6743     if (cpu_single_env)
6744         cpu_interrupt(cpu_single_env, CPU_INTERRUPT_EXIT);
6745 }
6746
6747 void main_loop_wait(int timeout)
6748 {
6749     IOHandlerRecord *ioh;
6750     fd_set rfds, wfds, xfds;
6751     int ret, nfds;
6752 #ifdef _WIN32
6753     int ret2, i;
6754 #endif
6755     struct timeval tv;
6756     PollingEntry *pe;
6757
6758
6759     /* XXX: need to suppress polling by better using win32 events */
6760     ret = 0;
6761     for(pe = first_polling_entry; pe != NULL; pe = pe->next) {
6762         ret |= pe->func(pe->opaque);
6763     }
6764 #ifdef _WIN32
6765     if (ret == 0) {
6766         int err;
6767         WaitObjects *w = &wait_objects;
6768
6769         ret = WaitForMultipleObjects(w->num, w->events, FALSE, timeout);
6770         if (WAIT_OBJECT_0 + 0 <= ret && ret <= WAIT_OBJECT_0 + w->num - 1) {
6771             if (w->func[ret - WAIT_OBJECT_0])
6772                 w->func[ret - WAIT_OBJECT_0](w->opaque[ret - WAIT_OBJECT_0]);
6773
6774             /* Check for additional signaled events */
6775             for(i = (ret - WAIT_OBJECT_0 + 1); i < w->num; i++) {
6776
6777                 /* Check if event is signaled */
6778                 ret2 = WaitForSingleObject(w->events[i], 0);
6779                 if(ret2 == WAIT_OBJECT_0) {
6780                     if (w->func[i])
6781                         w->func[i](w->opaque[i]);
6782                 } else if (ret2 == WAIT_TIMEOUT) {
6783                 } else {
6784                     err = GetLastError();
6785                     fprintf(stderr, "WaitForSingleObject error %d %d\n", i, err);
6786                 }
6787             }
6788         } else if (ret == WAIT_TIMEOUT) {
6789         } else {
6790             err = GetLastError();
6791             fprintf(stderr, "WaitForMultipleObjects error %d %d\n", ret, err);
6792         }
6793     }
6794 #endif
6795     /* poll any events */
6796     /* XXX: separate device handlers from system ones */
6797     nfds = -1;
6798     FD_ZERO(&rfds);
6799     FD_ZERO(&wfds);
6800     FD_ZERO(&xfds);
6801     for(ioh = first_io_handler; ioh != NULL; ioh = ioh->next) {
6802         if (ioh->deleted)
6803             continue;
6804         if (ioh->fd_read &&
6805             (!ioh->fd_read_poll ||
6806              ioh->fd_read_poll(ioh->opaque) != 0)) {
6807             FD_SET(ioh->fd, &rfds);
6808             if (ioh->fd > nfds)
6809                 nfds = ioh->fd;
6810         }
6811         if (ioh->fd_write) {
6812             FD_SET(ioh->fd, &wfds);
6813             if (ioh->fd > nfds)
6814                 nfds = ioh->fd;
6815         }
6816     }
6817
6818     tv.tv_sec = 0;
6819 #ifdef _WIN32
6820     tv.tv_usec = 0;
6821 #else
6822     tv.tv_usec = timeout * 1000;
6823 #endif
6824 #if defined(CONFIG_SLIRP)
6825     if (slirp_inited) {
6826         slirp_select_fill(&nfds, &rfds, &wfds, &xfds);
6827     }
6828 #endif
6829     ret = select(nfds + 1, &rfds, &wfds, &xfds, &tv);
6830     if (ret > 0) {
6831         IOHandlerRecord **pioh;
6832
6833         for(ioh = first_io_handler; ioh != NULL; ioh = ioh->next) {
6834             if (!ioh->deleted && ioh->fd_read && FD_ISSET(ioh->fd, &rfds)) {
6835                 ioh->fd_read(ioh->opaque);
6836             }
6837             if (!ioh->deleted && ioh->fd_write && FD_ISSET(ioh->fd, &wfds)) {
6838                 ioh->fd_write(ioh->opaque);
6839             }
6840         }
6841
6842         /* remove deleted IO handlers */
6843         pioh = &first_io_handler;
6844         while (*pioh) {
6845             ioh = *pioh;
6846             if (ioh->deleted) {
6847                 *pioh = ioh->next;
6848                 qemu_free(ioh);
6849             } else
6850                 pioh = &ioh->next;
6851         }
6852     }
6853 #if defined(CONFIG_SLIRP)
6854     if (slirp_inited) {
6855         if (ret < 0) {
6856             FD_ZERO(&rfds);
6857             FD_ZERO(&wfds);
6858             FD_ZERO(&xfds);
6859         }
6860         slirp_select_poll(&rfds, &wfds, &xfds);
6861     }
6862 #endif
6863     qemu_aio_poll();
6864
6865     if (vm_running) {
6866         qemu_run_timers(&active_timers[QEMU_TIMER_VIRTUAL],
6867                         qemu_get_clock(vm_clock));
6868         /* run dma transfers, if any */
6869         DMA_run();
6870     }
6871
6872     /* real time timers */
6873     qemu_run_timers(&active_timers[QEMU_TIMER_REALTIME],
6874                     qemu_get_clock(rt_clock));
6875
6876     /* Check bottom-halves last in case any of the earlier events triggered
6877        them.  */
6878     qemu_bh_poll();
6879
6880 }
6881
6882 static CPUState *cur_cpu;
6883
6884 int main_loop(void)
6885 {
6886     int ret, timeout;
6887 #ifdef CONFIG_PROFILER
6888     int64_t ti;
6889 #endif
6890     CPUState *env;
6891
6892     cur_cpu = first_cpu;
6893     for(;;) {
6894         if (vm_running) {
6895
6896             env = cur_cpu;
6897             for(;;) {
6898                 /* get next cpu */
6899                 env = env->next_cpu;
6900                 if (!env)
6901                     env = first_cpu;
6902 #ifdef CONFIG_PROFILER
6903                 ti = profile_getclock();
6904 #endif
6905                 ret = cpu_exec(env);
6906 #ifdef CONFIG_PROFILER
6907                 qemu_time += profile_getclock() - ti;
6908 #endif
6909                 if (ret == EXCP_HLT) {
6910                     /* Give the next CPU a chance to run.  */
6911                     cur_cpu = env;
6912                     continue;
6913                 }
6914                 if (ret != EXCP_HALTED)
6915                     break;
6916                 /* all CPUs are halted ? */
6917                 if (env == cur_cpu)
6918                     break;
6919             }
6920             cur_cpu = env;
6921
6922             if (shutdown_requested) {
6923                 ret = EXCP_INTERRUPT;
6924                 break;
6925             }
6926             if (reset_requested) {
6927                 reset_requested = 0;
6928                 qemu_system_reset();
6929                 ret = EXCP_INTERRUPT;
6930             }
6931             if (powerdown_requested) {
6932                 powerdown_requested = 0;
6933                 qemu_system_powerdown();
6934                 ret = EXCP_INTERRUPT;
6935             }
6936             if (ret == EXCP_DEBUG) {
6937                 vm_stop(EXCP_DEBUG);
6938             }
6939             /* If all cpus are halted then wait until the next IRQ */
6940             /* XXX: use timeout computed from timers */
6941             if (ret == EXCP_HALTED)
6942                 timeout = 10;
6943             else
6944                 timeout = 0;
6945         } else {
6946             timeout = 10;
6947         }
6948 #ifdef CONFIG_PROFILER
6949         ti = profile_getclock();
6950 #endif
6951         main_loop_wait(timeout);
6952 #ifdef CONFIG_PROFILER
6953         dev_time += profile_getclock() - ti;
6954 #endif
6955     }
6956     cpu_disable_ticks();
6957     return ret;
6958 }
6959
6960 static void help(int exitcode)
6961 {
6962     printf("QEMU PC emulator version " QEMU_VERSION ", Copyright (c) 2003-2007 Fabrice Bellard\n"
6963            "usage: %s [options] [disk_image]\n"
6964            "\n"
6965            "'disk_image' is a raw hard image image for IDE hard disk 0\n"
6966            "\n"
6967            "Standard options:\n"
6968            "-M machine      select emulated machine (-M ? for list)\n"
6969            "-cpu cpu        select CPU (-cpu ? for list)\n"
6970            "-fda/-fdb file  use 'file' as floppy disk 0/1 image\n"
6971            "-hda/-hdb file  use 'file' as IDE hard disk 0/1 image\n"
6972            "-hdc/-hdd file  use 'file' as IDE hard disk 2/3 image\n"
6973            "-cdrom file     use 'file' as IDE cdrom image (cdrom is ide1 master)\n"
6974            "-mtdblock file  use 'file' as on-board Flash memory image\n"
6975            "-sd file        use 'file' as SecureDigital card image\n"
6976            "-pflash file    use 'file' as a parallel flash image\n"
6977            "-boot [a|c|d|n] boot on floppy (a), hard disk (c), CD-ROM (d), or network (n)\n"
6978            "-snapshot       write to temporary files instead of disk image files\n"
6979 #ifdef CONFIG_SDL
6980            "-no-frame       open SDL window without a frame and window decorations\n"
6981            "-alt-grab       use Ctrl-Alt-Shift to grab mouse (instead of Ctrl-Alt)\n"
6982            "-no-quit        disable SDL window close capability\n"
6983 #endif
6984 #ifdef TARGET_I386
6985            "-no-fd-bootchk  disable boot signature checking for floppy disks\n"
6986 #endif
6987            "-m megs         set virtual RAM size to megs MB [default=%d]\n"
6988            "-smp n          set the number of CPUs to 'n' [default=1]\n"
6989            "-nographic      disable graphical output and redirect serial I/Os to console\n"
6990            "-portrait       rotate graphical output 90 deg left (only PXA LCD)\n"
6991 #ifndef _WIN32
6992            "-k language     use keyboard layout (for example \"fr\" for French)\n"
6993 #endif
6994 #ifdef HAS_AUDIO
6995            "-audio-help     print list of audio drivers and their options\n"
6996            "-soundhw c1,... enable audio support\n"
6997            "                and only specified sound cards (comma separated list)\n"
6998            "                use -soundhw ? to get the list of supported cards\n"
6999            "                use -soundhw all to enable all of them\n"
7000 #endif
7001            "-localtime      set the real time clock to local time [default=utc]\n"
7002            "-full-screen    start in full screen\n"
7003 #ifdef TARGET_I386
7004            "-win2k-hack     use it when installing Windows 2000 to avoid a disk full bug\n"
7005 #endif
7006            "-usb            enable the USB driver (will be the default soon)\n"
7007            "-usbdevice name add the host or guest USB device 'name'\n"
7008 #if defined(TARGET_PPC) || defined(TARGET_SPARC)
7009            "-g WxH[xDEPTH]  Set the initial graphical resolution and depth\n"
7010 #endif
7011            "-name string    set the name of the guest\n"
7012            "\n"
7013            "Network options:\n"
7014            "-net nic[,vlan=n][,macaddr=addr][,model=type]\n"
7015            "                create a new Network Interface Card and connect it to VLAN 'n'\n"
7016 #ifdef CONFIG_SLIRP
7017            "-net user[,vlan=n][,hostname=host]\n"
7018            "                connect the user mode network stack to VLAN 'n' and send\n"
7019            "                hostname 'host' to DHCP clients\n"
7020 #endif
7021 #ifdef _WIN32
7022            "-net tap[,vlan=n],ifname=name\n"
7023            "                connect the host TAP network interface to VLAN 'n'\n"
7024 #else
7025            "-net tap[,vlan=n][,fd=h][,ifname=name][,script=file]\n"
7026            "                connect the host TAP network interface to VLAN 'n' and use\n"
7027            "                the network script 'file' (default=%s);\n"
7028            "                use 'script=no' to disable script execution;\n"
7029            "                use 'fd=h' to connect to an already opened TAP interface\n"
7030 #endif
7031            "-net socket[,vlan=n][,fd=h][,listen=[host]:port][,connect=host:port]\n"
7032            "                connect the vlan 'n' to another VLAN using a socket connection\n"
7033            "-net socket[,vlan=n][,fd=h][,mcast=maddr:port]\n"
7034            "                connect the vlan 'n' to multicast maddr and port\n"
7035            "-net none       use it alone to have zero network devices; if no -net option\n"
7036            "                is provided, the default is '-net nic -net user'\n"
7037            "\n"
7038 #ifdef CONFIG_SLIRP
7039            "-tftp dir       allow tftp access to files in dir [-net user]\n"
7040            "-bootp file     advertise file in BOOTP replies\n"
7041 #ifndef _WIN32
7042            "-smb dir        allow SMB access to files in 'dir' [-net user]\n"
7043 #endif
7044            "-redir [tcp|udp]:host-port:[guest-host]:guest-port\n"
7045            "                redirect TCP or UDP connections from host to guest [-net user]\n"
7046 #endif
7047            "\n"
7048            "Linux boot specific:\n"
7049            "-kernel bzImage use 'bzImage' as kernel image\n"
7050            "-append cmdline use 'cmdline' as kernel command line\n"
7051            "-initrd file    use 'file' as initial ram disk\n"
7052            "\n"
7053            "Debug/Expert options:\n"
7054            "-monitor dev    redirect the monitor to char device 'dev'\n"
7055            "-serial dev     redirect the serial port to char device 'dev'\n"
7056            "-parallel dev   redirect the parallel port to char device 'dev'\n"
7057            "-pidfile file   Write PID to 'file'\n"
7058            "-S              freeze CPU at startup (use 'c' to start execution)\n"
7059            "-s              wait gdb connection to port\n"
7060            "-p port         set gdb connection port [default=%s]\n"
7061            "-d item1,...    output log to %s (use -d ? for a list of log items)\n"
7062            "-hdachs c,h,s[,t]  force hard disk 0 physical geometry and the optional BIOS\n"
7063            "                translation (t=none or lba) (usually qemu can guess them)\n"
7064            "-L path         set the directory for the BIOS, VGA BIOS and keymaps\n"
7065 #ifdef USE_KQEMU
7066            "-kernel-kqemu   enable KQEMU full virtualization (default is user mode only)\n"
7067            "-no-kqemu       disable KQEMU kernel module usage\n"
7068 #endif
7069 #ifdef USE_CODE_COPY
7070            "-no-code-copy   disable code copy acceleration\n"
7071 #endif
7072 #ifdef TARGET_I386
7073            "-std-vga        simulate a standard VGA card with VESA Bochs Extensions\n"
7074            "                (default is CL-GD5446 PCI VGA)\n"
7075            "-no-acpi        disable ACPI\n"
7076 #endif
7077            "-no-reboot      exit instead of rebooting\n"
7078            "-loadvm file    start right away with a saved state (loadvm in monitor)\n"
7079            "-vnc display    start a VNC server on display\n"
7080 #ifndef _WIN32
7081            "-daemonize      daemonize QEMU after initializing\n"
7082 #endif
7083            "-option-rom rom load a file, rom, into the option ROM space\n"
7084 #ifdef TARGET_SPARC
7085            "-prom-env variable=value  set OpenBIOS nvram variables\n"
7086 #endif
7087            "-clock          force the use of the given methods for timer alarm.\n"
7088            "                To see what timers are available use -clock help\n"
7089            "\n"
7090            "During emulation, the following keys are useful:\n"
7091            "ctrl-alt-f      toggle full screen\n"
7092            "ctrl-alt-n      switch to virtual console 'n'\n"
7093            "ctrl-alt        toggle mouse and keyboard grab\n"
7094            "\n"
7095            "When using -nographic, press 'ctrl-a h' to get some help.\n"
7096            ,
7097            "qemu",
7098            DEFAULT_RAM_SIZE,
7099 #ifndef _WIN32
7100            DEFAULT_NETWORK_SCRIPT,
7101 #endif
7102            DEFAULT_GDBSTUB_PORT,
7103            "/tmp/qemu.log");
7104     exit(exitcode);
7105 }
7106
7107 #define HAS_ARG 0x0001
7108
7109 enum {
7110     QEMU_OPTION_h,
7111
7112     QEMU_OPTION_M,
7113     QEMU_OPTION_cpu,
7114     QEMU_OPTION_fda,
7115     QEMU_OPTION_fdb,
7116     QEMU_OPTION_hda,
7117     QEMU_OPTION_hdb,
7118     QEMU_OPTION_hdc,
7119     QEMU_OPTION_hdd,
7120     QEMU_OPTION_cdrom,
7121     QEMU_OPTION_mtdblock,
7122     QEMU_OPTION_sd,
7123     QEMU_OPTION_pflash,
7124     QEMU_OPTION_boot,
7125     QEMU_OPTION_snapshot,
7126 #ifdef TARGET_I386
7127     QEMU_OPTION_no_fd_bootchk,
7128 #endif
7129     QEMU_OPTION_m,
7130     QEMU_OPTION_nographic,
7131     QEMU_OPTION_portrait,
7132 #ifdef HAS_AUDIO
7133     QEMU_OPTION_audio_help,
7134     QEMU_OPTION_soundhw,
7135 #endif
7136
7137     QEMU_OPTION_net,
7138     QEMU_OPTION_tftp,
7139     QEMU_OPTION_bootp,
7140     QEMU_OPTION_smb,
7141     QEMU_OPTION_redir,
7142
7143     QEMU_OPTION_kernel,
7144     QEMU_OPTION_append,
7145     QEMU_OPTION_initrd,
7146
7147     QEMU_OPTION_S,
7148     QEMU_OPTION_s,
7149     QEMU_OPTION_p,
7150     QEMU_OPTION_d,
7151     QEMU_OPTION_hdachs,
7152     QEMU_OPTION_L,
7153     QEMU_OPTION_bios,
7154     QEMU_OPTION_no_code_copy,
7155     QEMU_OPTION_k,
7156     QEMU_OPTION_localtime,
7157     QEMU_OPTION_cirrusvga,
7158     QEMU_OPTION_vmsvga,
7159     QEMU_OPTION_g,
7160     QEMU_OPTION_std_vga,
7161     QEMU_OPTION_echr,
7162     QEMU_OPTION_monitor,
7163     QEMU_OPTION_serial,
7164     QEMU_OPTION_parallel,
7165     QEMU_OPTION_loadvm,
7166     QEMU_OPTION_full_screen,
7167     QEMU_OPTION_no_frame,
7168     QEMU_OPTION_alt_grab,
7169     QEMU_OPTION_no_quit,
7170     QEMU_OPTION_pidfile,
7171     QEMU_OPTION_no_kqemu,
7172     QEMU_OPTION_kernel_kqemu,
7173     QEMU_OPTION_win2k_hack,
7174     QEMU_OPTION_usb,
7175     QEMU_OPTION_usbdevice,
7176     QEMU_OPTION_smp,
7177     QEMU_OPTION_vnc,
7178     QEMU_OPTION_no_acpi,
7179     QEMU_OPTION_no_reboot,
7180     QEMU_OPTION_show_cursor,
7181     QEMU_OPTION_daemonize,
7182     QEMU_OPTION_option_rom,
7183     QEMU_OPTION_semihosting,
7184     QEMU_OPTION_name,
7185     QEMU_OPTION_prom_env,
7186     QEMU_OPTION_old_param,
7187     QEMU_OPTION_clock,
7188 };
7189
7190 typedef struct QEMUOption {
7191     const char *name;
7192     int flags;
7193     int index;
7194 } QEMUOption;
7195
7196 const QEMUOption qemu_options[] = {
7197     { "h", 0, QEMU_OPTION_h },
7198     { "help", 0, QEMU_OPTION_h },
7199
7200     { "M", HAS_ARG, QEMU_OPTION_M },
7201     { "cpu", HAS_ARG, QEMU_OPTION_cpu },
7202     { "fda", HAS_ARG, QEMU_OPTION_fda },
7203     { "fdb", HAS_ARG, QEMU_OPTION_fdb },
7204     { "hda", HAS_ARG, QEMU_OPTION_hda },
7205     { "hdb", HAS_ARG, QEMU_OPTION_hdb },
7206     { "hdc", HAS_ARG, QEMU_OPTION_hdc },
7207     { "hdd", HAS_ARG, QEMU_OPTION_hdd },
7208     { "cdrom", HAS_ARG, QEMU_OPTION_cdrom },
7209     { "mtdblock", HAS_ARG, QEMU_OPTION_mtdblock },
7210     { "sd", HAS_ARG, QEMU_OPTION_sd },
7211     { "pflash", HAS_ARG, QEMU_OPTION_pflash },
7212     { "boot", HAS_ARG, QEMU_OPTION_boot },
7213     { "snapshot", 0, QEMU_OPTION_snapshot },
7214 #ifdef TARGET_I386
7215     { "no-fd-bootchk", 0, QEMU_OPTION_no_fd_bootchk },
7216 #endif
7217     { "m", HAS_ARG, QEMU_OPTION_m },
7218     { "nographic", 0, QEMU_OPTION_nographic },
7219     { "portrait", 0, QEMU_OPTION_portrait },
7220     { "k", HAS_ARG, QEMU_OPTION_k },
7221 #ifdef HAS_AUDIO
7222     { "audio-help", 0, QEMU_OPTION_audio_help },
7223     { "soundhw", HAS_ARG, QEMU_OPTION_soundhw },
7224 #endif
7225
7226     { "net", HAS_ARG, QEMU_OPTION_net},
7227 #ifdef CONFIG_SLIRP
7228     { "tftp", HAS_ARG, QEMU_OPTION_tftp },
7229     { "bootp", HAS_ARG, QEMU_OPTION_bootp },
7230 #ifndef _WIN32
7231     { "smb", HAS_ARG, QEMU_OPTION_smb },
7232 #endif
7233     { "redir", HAS_ARG, QEMU_OPTION_redir },
7234 #endif
7235
7236     { "kernel", HAS_ARG, QEMU_OPTION_kernel },
7237     { "append", HAS_ARG, QEMU_OPTION_append },
7238     { "initrd", HAS_ARG, QEMU_OPTION_initrd },
7239
7240     { "S", 0, QEMU_OPTION_S },
7241     { "s", 0, QEMU_OPTION_s },
7242     { "p", HAS_ARG, QEMU_OPTION_p },
7243     { "d", HAS_ARG, QEMU_OPTION_d },
7244     { "hdachs", HAS_ARG, QEMU_OPTION_hdachs },
7245     { "L", HAS_ARG, QEMU_OPTION_L },
7246     { "bios", HAS_ARG, QEMU_OPTION_bios },
7247     { "no-code-copy", 0, QEMU_OPTION_no_code_copy },
7248 #ifdef USE_KQEMU
7249     { "no-kqemu", 0, QEMU_OPTION_no_kqemu },
7250     { "kernel-kqemu", 0, QEMU_OPTION_kernel_kqemu },
7251 #endif
7252 #if defined(TARGET_PPC) || defined(TARGET_SPARC)
7253     { "g", 1, QEMU_OPTION_g },
7254 #endif
7255     { "localtime", 0, QEMU_OPTION_localtime },
7256     { "std-vga", 0, QEMU_OPTION_std_vga },
7257     { "echr", HAS_ARG, QEMU_OPTION_echr },
7258     { "monitor", HAS_ARG, QEMU_OPTION_monitor },
7259     { "serial", HAS_ARG, QEMU_OPTION_serial },
7260     { "parallel", HAS_ARG, QEMU_OPTION_parallel },
7261     { "loadvm", HAS_ARG, QEMU_OPTION_loadvm },
7262     { "full-screen", 0, QEMU_OPTION_full_screen },
7263 #ifdef CONFIG_SDL
7264     { "no-frame", 0, QEMU_OPTION_no_frame },
7265     { "alt-grab", 0, QEMU_OPTION_alt_grab },
7266     { "no-quit", 0, QEMU_OPTION_no_quit },
7267 #endif
7268     { "pidfile", HAS_ARG, QEMU_OPTION_pidfile },
7269     { "win2k-hack", 0, QEMU_OPTION_win2k_hack },
7270     { "usbdevice", HAS_ARG, QEMU_OPTION_usbdevice },
7271     { "smp", HAS_ARG, QEMU_OPTION_smp },
7272     { "vnc", HAS_ARG, QEMU_OPTION_vnc },
7273
7274     /* temporary options */
7275     { "usb", 0, QEMU_OPTION_usb },
7276     { "cirrusvga", 0, QEMU_OPTION_cirrusvga },
7277     { "vmwarevga", 0, QEMU_OPTION_vmsvga },
7278     { "no-acpi", 0, QEMU_OPTION_no_acpi },
7279     { "no-reboot", 0, QEMU_OPTION_no_reboot },
7280     { "show-cursor", 0, QEMU_OPTION_show_cursor },
7281     { "daemonize", 0, QEMU_OPTION_daemonize },
7282     { "option-rom", HAS_ARG, QEMU_OPTION_option_rom },
7283 #if defined(TARGET_ARM) || defined(TARGET_M68K)
7284     { "semihosting", 0, QEMU_OPTION_semihosting },
7285 #endif
7286     { "name", HAS_ARG, QEMU_OPTION_name },
7287 #if defined(TARGET_SPARC)
7288     { "prom-env", HAS_ARG, QEMU_OPTION_prom_env },
7289 #endif
7290 #if defined(TARGET_ARM)
7291     { "old-param", 0, QEMU_OPTION_old_param },
7292 #endif
7293     { "clock", HAS_ARG, QEMU_OPTION_clock },
7294     { NULL },
7295 };
7296
7297 #if defined (TARGET_I386) && defined(USE_CODE_COPY)
7298
7299 /* this stack is only used during signal handling */
7300 #define SIGNAL_STACK_SIZE 32768
7301
7302 static uint8_t *signal_stack;
7303
7304 #endif
7305
7306 /* password input */
7307
7308 int qemu_key_check(BlockDriverState *bs, const char *name)
7309 {
7310     char password[256];
7311     int i;
7312
7313     if (!bdrv_is_encrypted(bs))
7314         return 0;
7315
7316     term_printf("%s is encrypted.\n", name);
7317     for(i = 0; i < 3; i++) {
7318         monitor_readline("Password: ", 1, password, sizeof(password));
7319         if (bdrv_set_key(bs, password) == 0)
7320             return 0;
7321         term_printf("invalid password\n");
7322     }
7323     return -EPERM;
7324 }
7325
7326 static BlockDriverState *get_bdrv(int index)
7327 {
7328     BlockDriverState *bs;
7329
7330     if (index < 4) {
7331         bs = bs_table[index];
7332     } else if (index < 6) {
7333         bs = fd_table[index - 4];
7334     } else {
7335         bs = NULL;
7336     }
7337     return bs;
7338 }
7339
7340 static void read_passwords(void)
7341 {
7342     BlockDriverState *bs;
7343     int i;
7344
7345     for(i = 0; i < 6; i++) {
7346         bs = get_bdrv(i);
7347         if (bs)
7348             qemu_key_check(bs, bdrv_get_device_name(bs));
7349     }
7350 }
7351
7352 /* XXX: currently we cannot use simultaneously different CPUs */
7353 void register_machines(void)
7354 {
7355 #if defined(TARGET_I386)
7356     qemu_register_machine(&pc_machine);
7357     qemu_register_machine(&isapc_machine);
7358 #elif defined(TARGET_PPC)
7359     qemu_register_machine(&heathrow_machine);
7360     qemu_register_machine(&core99_machine);
7361     qemu_register_machine(&prep_machine);
7362     qemu_register_machine(&ref405ep_machine);
7363     qemu_register_machine(&taihu_machine);
7364 #elif defined(TARGET_MIPS)
7365     qemu_register_machine(&mips_machine);
7366     qemu_register_machine(&mips_malta_machine);
7367     qemu_register_machine(&mips_pica61_machine);
7368     qemu_register_machine(&mips_mipssim_machine);
7369 #elif defined(TARGET_SPARC)
7370 #ifdef TARGET_SPARC64
7371     qemu_register_machine(&sun4u_machine);
7372 #else
7373     qemu_register_machine(&ss5_machine);
7374     qemu_register_machine(&ss10_machine);
7375 #endif
7376 #elif defined(TARGET_ARM)
7377     qemu_register_machine(&integratorcp_machine);
7378     qemu_register_machine(&versatilepb_machine);
7379     qemu_register_machine(&versatileab_machine);
7380     qemu_register_machine(&realview_machine);
7381     qemu_register_machine(&akitapda_machine);
7382     qemu_register_machine(&spitzpda_machine);
7383     qemu_register_machine(&borzoipda_machine);
7384     qemu_register_machine(&terrierpda_machine);
7385     qemu_register_machine(&palmte_machine);
7386 #elif defined(TARGET_SH4)
7387     qemu_register_machine(&shix_machine);
7388     qemu_register_machine(&r2d_machine);
7389 #elif defined(TARGET_ALPHA)
7390     /* XXX: TODO */
7391 #elif defined(TARGET_M68K)
7392     qemu_register_machine(&mcf5208evb_machine);
7393     qemu_register_machine(&an5206_machine);
7394 #elif defined(TARGET_CRIS)
7395     qemu_register_machine(&bareetraxfs_machine);
7396 #else
7397 #error unsupported CPU
7398 #endif
7399 }
7400
7401 #ifdef HAS_AUDIO
7402 struct soundhw soundhw[] = {
7403 #ifdef HAS_AUDIO_CHOICE
7404 #ifdef TARGET_I386
7405     {
7406         "pcspk",
7407         "PC speaker",
7408         0,
7409         1,
7410         { .init_isa = pcspk_audio_init }
7411     },
7412 #endif
7413     {
7414         "sb16",
7415         "Creative Sound Blaster 16",
7416         0,
7417         1,
7418         { .init_isa = SB16_init }
7419     },
7420
7421 #ifdef CONFIG_ADLIB
7422     {
7423         "adlib",
7424 #ifdef HAS_YMF262
7425         "Yamaha YMF262 (OPL3)",
7426 #else
7427         "Yamaha YM3812 (OPL2)",
7428 #endif
7429         0,
7430         1,
7431         { .init_isa = Adlib_init }
7432     },
7433 #endif
7434
7435 #ifdef CONFIG_GUS
7436     {
7437         "gus",
7438         "Gravis Ultrasound GF1",
7439         0,
7440         1,
7441         { .init_isa = GUS_init }
7442     },
7443 #endif
7444
7445     {
7446         "es1370",
7447         "ENSONIQ AudioPCI ES1370",
7448         0,
7449         0,
7450         { .init_pci = es1370_init }
7451     },
7452 #endif
7453
7454     { NULL, NULL, 0, 0, { NULL } }
7455 };
7456
7457 static void select_soundhw (const char *optarg)
7458 {
7459     struct soundhw *c;
7460
7461     if (*optarg == '?') {
7462     show_valid_cards:
7463
7464         printf ("Valid sound card names (comma separated):\n");
7465         for (c = soundhw; c->name; ++c) {
7466             printf ("%-11s %s\n", c->name, c->descr);
7467         }
7468         printf ("\n-soundhw all will enable all of the above\n");
7469         exit (*optarg != '?');
7470     }
7471     else {
7472         size_t l;
7473         const char *p;
7474         char *e;
7475         int bad_card = 0;
7476
7477         if (!strcmp (optarg, "all")) {
7478             for (c = soundhw; c->name; ++c) {
7479                 c->enabled = 1;
7480             }
7481             return;
7482         }
7483
7484         p = optarg;
7485         while (*p) {
7486             e = strchr (p, ',');
7487             l = !e ? strlen (p) : (size_t) (e - p);
7488
7489             for (c = soundhw; c->name; ++c) {
7490                 if (!strncmp (c->name, p, l)) {
7491                     c->enabled = 1;
7492                     break;
7493                 }
7494             }
7495
7496             if (!c->name) {
7497                 if (l > 80) {
7498                     fprintf (stderr,
7499                              "Unknown sound card name (too big to show)\n");
7500                 }
7501                 else {
7502                     fprintf (stderr, "Unknown sound card name `%.*s'\n",
7503                              (int) l, p);
7504                 }
7505                 bad_card = 1;
7506             }
7507             p += l + (e != NULL);
7508         }
7509
7510         if (bad_card)
7511             goto show_valid_cards;
7512     }
7513 }
7514 #endif
7515
7516 #ifdef _WIN32
7517 static BOOL WINAPI qemu_ctrl_handler(DWORD type)
7518 {
7519     exit(STATUS_CONTROL_C_EXIT);
7520     return TRUE;
7521 }
7522 #endif
7523
7524 #define MAX_NET_CLIENTS 32
7525
7526 int main(int argc, char **argv)
7527 {
7528 #ifdef CONFIG_GDBSTUB
7529     int use_gdbstub;
7530     const char *gdbstub_port;
7531 #endif
7532     int i, cdrom_index, pflash_index;
7533     int snapshot, linux_boot;
7534     const char *initrd_filename;
7535     const char *hd_filename[MAX_DISKS], *fd_filename[MAX_FD];
7536     const char *pflash_filename[MAX_PFLASH];
7537     const char *sd_filename;
7538     const char *mtd_filename;
7539     const char *kernel_filename, *kernel_cmdline;
7540     DisplayState *ds = &display_state;
7541     int cyls, heads, secs, translation;
7542     char net_clients[MAX_NET_CLIENTS][256];
7543     int nb_net_clients;
7544     int optind;
7545     const char *r, *optarg;
7546     CharDriverState *monitor_hd;
7547     char monitor_device[128];
7548     char serial_devices[MAX_SERIAL_PORTS][128];
7549     int serial_device_index;
7550     char parallel_devices[MAX_PARALLEL_PORTS][128];
7551     int parallel_device_index;
7552     const char *loadvm = NULL;
7553     QEMUMachine *machine;
7554     const char *cpu_model;
7555     char usb_devices[MAX_USB_CMDLINE][128];
7556     int usb_devices_index;
7557     int fds[2];
7558     const char *pid_file = NULL;
7559     VLANState *vlan;
7560
7561     LIST_INIT (&vm_change_state_head);
7562 #ifndef _WIN32
7563     {
7564         struct sigaction act;
7565         sigfillset(&act.sa_mask);
7566         act.sa_flags = 0;
7567         act.sa_handler = SIG_IGN;
7568         sigaction(SIGPIPE, &act, NULL);
7569     }
7570 #else
7571     SetConsoleCtrlHandler(qemu_ctrl_handler, TRUE);
7572     /* Note: cpu_interrupt() is currently not SMP safe, so we force
7573        QEMU to run on a single CPU */
7574     {
7575         HANDLE h;
7576         DWORD mask, smask;
7577         int i;
7578         h = GetCurrentProcess();
7579         if (GetProcessAffinityMask(h, &mask, &smask)) {
7580             for(i = 0; i < 32; i++) {
7581                 if (mask & (1 << i))
7582                     break;
7583             }
7584             if (i != 32) {
7585                 mask = 1 << i;
7586                 SetProcessAffinityMask(h, mask);
7587             }
7588         }
7589     }
7590 #endif
7591
7592     register_machines();
7593     machine = first_machine;
7594     cpu_model = NULL;
7595     initrd_filename = NULL;
7596     for(i = 0; i < MAX_FD; i++)
7597         fd_filename[i] = NULL;
7598     for(i = 0; i < MAX_DISKS; i++)
7599         hd_filename[i] = NULL;
7600     for(i = 0; i < MAX_PFLASH; i++)
7601         pflash_filename[i] = NULL;
7602     pflash_index = 0;
7603     sd_filename = NULL;
7604     mtd_filename = NULL;
7605     ram_size = DEFAULT_RAM_SIZE * 1024 * 1024;
7606     vga_ram_size = VGA_RAM_SIZE;
7607 #ifdef CONFIG_GDBSTUB
7608     use_gdbstub = 0;
7609     gdbstub_port = DEFAULT_GDBSTUB_PORT;
7610 #endif
7611     snapshot = 0;
7612     nographic = 0;
7613     kernel_filename = NULL;
7614     kernel_cmdline = "";
7615 #ifdef TARGET_PPC
7616     cdrom_index = 1;
7617 #else
7618     cdrom_index = 2;
7619 #endif
7620     cyls = heads = secs = 0;
7621     translation = BIOS_ATA_TRANSLATION_AUTO;
7622     pstrcpy(monitor_device, sizeof(monitor_device), "vc");
7623
7624     pstrcpy(serial_devices[0], sizeof(serial_devices[0]), "vc");
7625     for(i = 1; i < MAX_SERIAL_PORTS; i++)
7626         serial_devices[i][0] = '\0';
7627     serial_device_index = 0;
7628
7629     pstrcpy(parallel_devices[0], sizeof(parallel_devices[0]), "vc");
7630     for(i = 1; i < MAX_PARALLEL_PORTS; i++)
7631         parallel_devices[i][0] = '\0';
7632     parallel_device_index = 0;
7633
7634     usb_devices_index = 0;
7635
7636     nb_net_clients = 0;
7637
7638     nb_nics = 0;
7639     /* default mac address of the first network interface */
7640
7641     optind = 1;
7642     for(;;) {
7643         if (optind >= argc)
7644             break;
7645         r = argv[optind];
7646         if (r[0] != '-') {
7647             hd_filename[0] = argv[optind++];
7648         } else {
7649             const QEMUOption *popt;
7650
7651             optind++;
7652             /* Treat --foo the same as -foo.  */
7653             if (r[1] == '-')
7654                 r++;
7655             popt = qemu_options;
7656             for(;;) {
7657                 if (!popt->name) {
7658                     fprintf(stderr, "%s: invalid option -- '%s'\n",
7659                             argv[0], r);
7660                     exit(1);
7661                 }
7662                 if (!strcmp(popt->name, r + 1))
7663                     break;
7664                 popt++;
7665             }
7666             if (popt->flags & HAS_ARG) {
7667                 if (optind >= argc) {
7668                     fprintf(stderr, "%s: option '%s' requires an argument\n",
7669                             argv[0], r);
7670                     exit(1);
7671                 }
7672                 optarg = argv[optind++];
7673             } else {
7674                 optarg = NULL;
7675             }
7676
7677             switch(popt->index) {
7678             case QEMU_OPTION_M:
7679                 machine = find_machine(optarg);
7680                 if (!machine) {
7681                     QEMUMachine *m;
7682                     printf("Supported machines are:\n");
7683                     for(m = first_machine; m != NULL; m = m->next) {
7684                         printf("%-10s %s%s\n",
7685                                m->name, m->desc,
7686                                m == first_machine ? " (default)" : "");
7687                     }
7688                     exit(*optarg != '?');
7689                 }
7690                 break;
7691             case QEMU_OPTION_cpu:
7692                 /* hw initialization will check this */
7693                 if (*optarg == '?') {
7694 /* XXX: implement xxx_cpu_list for targets that still miss it */
7695 #if defined(cpu_list)
7696                     cpu_list(stdout, &fprintf);
7697 #endif
7698                     exit(0);
7699                 } else {
7700                     cpu_model = optarg;
7701                 }
7702                 break;
7703             case QEMU_OPTION_initrd:
7704                 initrd_filename = optarg;
7705                 break;
7706             case QEMU_OPTION_hda:
7707             case QEMU_OPTION_hdb:
7708             case QEMU_OPTION_hdc:
7709             case QEMU_OPTION_hdd:
7710                 {
7711                     int hd_index;
7712                     hd_index = popt->index - QEMU_OPTION_hda;
7713                     hd_filename[hd_index] = optarg;
7714                     if (hd_index == cdrom_index)
7715                         cdrom_index = -1;
7716                 }
7717                 break;
7718             case QEMU_OPTION_mtdblock:
7719                 mtd_filename = optarg;
7720                 break;
7721             case QEMU_OPTION_sd:
7722                 sd_filename = optarg;
7723                 break;
7724             case QEMU_OPTION_pflash:
7725                 if (pflash_index >= MAX_PFLASH) {
7726                     fprintf(stderr, "qemu: too many parallel flash images\n");
7727                     exit(1);
7728                 }
7729                 pflash_filename[pflash_index++] = optarg;
7730                 break;
7731             case QEMU_OPTION_snapshot:
7732                 snapshot = 1;
7733                 break;
7734             case QEMU_OPTION_hdachs:
7735                 {
7736                     const char *p;
7737                     p = optarg;
7738                     cyls = strtol(p, (char **)&p, 0);
7739                     if (cyls < 1 || cyls > 16383)
7740                         goto chs_fail;
7741                     if (*p != ',')
7742                         goto chs_fail;
7743                     p++;
7744                     heads = strtol(p, (char **)&p, 0);
7745                     if (heads < 1 || heads > 16)
7746                         goto chs_fail;
7747                     if (*p != ',')
7748                         goto chs_fail;
7749                     p++;
7750                     secs = strtol(p, (char **)&p, 0);
7751                     if (secs < 1 || secs > 63)
7752                         goto chs_fail;
7753                     if (*p == ',') {
7754                         p++;
7755                         if (!strcmp(p, "none"))
7756                             translation = BIOS_ATA_TRANSLATION_NONE;
7757                         else if (!strcmp(p, "lba"))
7758                             translation = BIOS_ATA_TRANSLATION_LBA;
7759                         else if (!strcmp(p, "auto"))
7760                             translation = BIOS_ATA_TRANSLATION_AUTO;
7761                         else
7762                             goto chs_fail;
7763                     } else if (*p != '\0') {
7764                     chs_fail:
7765                         fprintf(stderr, "qemu: invalid physical CHS format\n");
7766                         exit(1);
7767                     }
7768                 }
7769                 break;
7770             case QEMU_OPTION_nographic:
7771                 pstrcpy(serial_devices[0], sizeof(serial_devices[0]), "stdio");
7772                 pstrcpy(parallel_devices[0], sizeof(parallel_devices[0]), "null");
7773                 pstrcpy(monitor_device, sizeof(monitor_device), "stdio");
7774                 nographic = 1;
7775                 break;
7776             case QEMU_OPTION_portrait:
7777                 graphic_rotate = 1;
7778                 break;
7779             case QEMU_OPTION_kernel:
7780                 kernel_filename = optarg;
7781                 break;
7782             case QEMU_OPTION_append:
7783                 kernel_cmdline = optarg;
7784                 break;
7785             case QEMU_OPTION_cdrom:
7786                 if (cdrom_index >= 0) {
7787                     hd_filename[cdrom_index] = optarg;
7788                 }
7789                 break;
7790             case QEMU_OPTION_boot:
7791                 boot_device = optarg[0];
7792                 if (boot_device != 'a' &&
7793 #if defined(TARGET_SPARC) || defined(TARGET_I386)
7794                     // Network boot
7795                     boot_device != 'n' &&
7796 #endif
7797                     boot_device != 'c' && boot_device != 'd') {
7798                     fprintf(stderr, "qemu: invalid boot device '%c'\n", boot_device);
7799                     exit(1);
7800                 }
7801                 break;
7802             case QEMU_OPTION_fda:
7803                 fd_filename[0] = optarg;
7804                 break;
7805             case QEMU_OPTION_fdb:
7806                 fd_filename[1] = optarg;
7807                 break;
7808 #ifdef TARGET_I386
7809             case QEMU_OPTION_no_fd_bootchk:
7810                 fd_bootchk = 0;
7811                 break;
7812 #endif
7813             case QEMU_OPTION_no_code_copy:
7814                 code_copy_enabled = 0;
7815                 break;
7816             case QEMU_OPTION_net:
7817                 if (nb_net_clients >= MAX_NET_CLIENTS) {
7818                     fprintf(stderr, "qemu: too many network clients\n");
7819                     exit(1);
7820                 }
7821                 pstrcpy(net_clients[nb_net_clients],
7822                         sizeof(net_clients[0]),
7823                         optarg);
7824                 nb_net_clients++;
7825                 break;
7826 #ifdef CONFIG_SLIRP
7827             case QEMU_OPTION_tftp:
7828                 tftp_prefix = optarg;
7829                 break;
7830             case QEMU_OPTION_bootp:
7831                 bootp_filename = optarg;
7832                 break;
7833 #ifndef _WIN32
7834             case QEMU_OPTION_smb:
7835                 net_slirp_smb(optarg);
7836                 break;
7837 #endif
7838             case QEMU_OPTION_redir:
7839                 net_slirp_redir(optarg);
7840                 break;
7841 #endif
7842 #ifdef HAS_AUDIO
7843             case QEMU_OPTION_audio_help:
7844                 AUD_help ();
7845                 exit (0);
7846                 break;
7847             case QEMU_OPTION_soundhw:
7848                 select_soundhw (optarg);
7849                 break;
7850 #endif
7851             case QEMU_OPTION_h:
7852                 help(0);
7853                 break;
7854             case QEMU_OPTION_m:
7855                 ram_size = atoi(optarg) * 1024 * 1024;
7856                 if (ram_size <= 0)
7857                     help(1);
7858                 if (ram_size > PHYS_RAM_MAX_SIZE) {
7859                     fprintf(stderr, "qemu: at most %d MB RAM can be simulated\n",
7860                             PHYS_RAM_MAX_SIZE / (1024 * 1024));
7861                     exit(1);
7862                 }
7863                 break;
7864             case QEMU_OPTION_d:
7865                 {
7866                     int mask;
7867                     CPULogItem *item;
7868
7869                     mask = cpu_str_to_log_mask(optarg);
7870                     if (!mask) {
7871                         printf("Log items (comma separated):\n");
7872                     for(item = cpu_log_items; item->mask != 0; item++) {
7873                         printf("%-10s %s\n", item->name, item->help);
7874                     }
7875                     exit(1);
7876                     }
7877                     cpu_set_log(mask);
7878                 }
7879                 break;
7880 #ifdef CONFIG_GDBSTUB
7881             case QEMU_OPTION_s:
7882                 use_gdbstub = 1;
7883                 break;
7884             case QEMU_OPTION_p:
7885                 gdbstub_port = optarg;
7886                 break;
7887 #endif
7888             case QEMU_OPTION_L:
7889                 bios_dir = optarg;
7890                 break;
7891             case QEMU_OPTION_bios:
7892                 bios_name = optarg;
7893                 break;
7894             case QEMU_OPTION_S:
7895                 autostart = 0;
7896                 break;
7897             case QEMU_OPTION_k:
7898                 keyboard_layout = optarg;
7899                 break;
7900             case QEMU_OPTION_localtime:
7901                 rtc_utc = 0;
7902                 break;
7903             case QEMU_OPTION_cirrusvga:
7904                 cirrus_vga_enabled = 1;
7905                 vmsvga_enabled = 0;
7906                 break;
7907             case QEMU_OPTION_vmsvga:
7908                 cirrus_vga_enabled = 0;
7909                 vmsvga_enabled = 1;
7910                 break;
7911             case QEMU_OPTION_std_vga:
7912                 cirrus_vga_enabled = 0;
7913                 vmsvga_enabled = 0;
7914                 break;
7915             case QEMU_OPTION_g:
7916                 {
7917                     const char *p;
7918                     int w, h, depth;
7919                     p = optarg;
7920                     w = strtol(p, (char **)&p, 10);
7921                     if (w <= 0) {
7922                     graphic_error:
7923                         fprintf(stderr, "qemu: invalid resolution or depth\n");
7924                         exit(1);
7925                     }
7926                     if (*p != 'x')
7927                         goto graphic_error;
7928                     p++;
7929                     h = strtol(p, (char **)&p, 10);
7930                     if (h <= 0)
7931                         goto graphic_error;
7932                     if (*p == 'x') {
7933                         p++;
7934                         depth = strtol(p, (char **)&p, 10);
7935                         if (depth != 8 && depth != 15 && depth != 16 &&
7936                             depth != 24 && depth != 32)
7937                             goto graphic_error;
7938                     } else if (*p == '\0') {
7939                         depth = graphic_depth;
7940                     } else {
7941                         goto graphic_error;
7942                     }
7943
7944                     graphic_width = w;
7945                     graphic_height = h;
7946                     graphic_depth = depth;
7947                 }
7948                 break;
7949             case QEMU_OPTION_echr:
7950                 {
7951                     char *r;
7952                     term_escape_char = strtol(optarg, &r, 0);
7953                     if (r == optarg)
7954                         printf("Bad argument to echr\n");
7955                     break;
7956                 }
7957             case QEMU_OPTION_monitor:
7958                 pstrcpy(monitor_device, sizeof(monitor_device), optarg);
7959                 break;
7960             case QEMU_OPTION_serial:
7961                 if (serial_device_index >= MAX_SERIAL_PORTS) {
7962                     fprintf(stderr, "qemu: too many serial ports\n");
7963                     exit(1);
7964                 }
7965                 pstrcpy(serial_devices[serial_device_index],
7966                         sizeof(serial_devices[0]), optarg);
7967                 serial_device_index++;
7968                 break;
7969             case QEMU_OPTION_parallel:
7970                 if (parallel_device_index >= MAX_PARALLEL_PORTS) {
7971                     fprintf(stderr, "qemu: too many parallel ports\n");
7972                     exit(1);
7973                 }
7974                 pstrcpy(parallel_devices[parallel_device_index],
7975                         sizeof(parallel_devices[0]), optarg);
7976                 parallel_device_index++;
7977                 break;
7978             case QEMU_OPTION_loadvm:
7979                 loadvm = optarg;
7980                 break;
7981             case QEMU_OPTION_full_screen:
7982                 full_screen = 1;
7983                 break;
7984 #ifdef CONFIG_SDL
7985             case QEMU_OPTION_no_frame:
7986                 no_frame = 1;
7987                 break;
7988             case QEMU_OPTION_alt_grab:
7989                 alt_grab = 1;
7990                 break;
7991             case QEMU_OPTION_no_quit:
7992                 no_quit = 1;
7993                 break;
7994 #endif
7995             case QEMU_OPTION_pidfile:
7996                 pid_file = optarg;
7997                 break;
7998 #ifdef TARGET_I386
7999             case QEMU_OPTION_win2k_hack:
8000                 win2k_install_hack = 1;
8001                 break;
8002 #endif
8003 #ifdef USE_KQEMU
8004             case QEMU_OPTION_no_kqemu:
8005                 kqemu_allowed = 0;
8006                 break;
8007             case QEMU_OPTION_kernel_kqemu:
8008                 kqemu_allowed = 2;
8009                 break;
8010 #endif
8011             case QEMU_OPTION_usb:
8012                 usb_enabled = 1;
8013                 break;
8014             case QEMU_OPTION_usbdevice:
8015                 usb_enabled = 1;
8016                 if (usb_devices_index >= MAX_USB_CMDLINE) {
8017                     fprintf(stderr, "Too many USB devices\n");
8018                     exit(1);
8019                 }
8020                 pstrcpy(usb_devices[usb_devices_index],
8021                         sizeof(usb_devices[usb_devices_index]),
8022                         optarg);
8023                 usb_devices_index++;
8024                 break;
8025             case QEMU_OPTION_smp:
8026                 smp_cpus = atoi(optarg);
8027                 if (smp_cpus < 1 || smp_cpus > MAX_CPUS) {
8028                     fprintf(stderr, "Invalid number of CPUs\n");
8029                     exit(1);
8030                 }
8031                 break;
8032             case QEMU_OPTION_vnc:
8033                 vnc_display = optarg;
8034                 break;
8035             case QEMU_OPTION_no_acpi:
8036                 acpi_enabled = 0;
8037                 break;
8038             case QEMU_OPTION_no_reboot:
8039                 no_reboot = 1;
8040                 break;
8041             case QEMU_OPTION_show_cursor:
8042                 cursor_hide = 0;
8043                 break;
8044             case QEMU_OPTION_daemonize:
8045                 daemonize = 1;
8046                 break;
8047             case QEMU_OPTION_option_rom:
8048                 if (nb_option_roms >= MAX_OPTION_ROMS) {
8049                     fprintf(stderr, "Too many option ROMs\n");
8050                     exit(1);
8051                 }
8052                 option_rom[nb_option_roms] = optarg;
8053                 nb_option_roms++;
8054                 break;
8055             case QEMU_OPTION_semihosting:
8056                 semihosting_enabled = 1;
8057                 break;
8058             case QEMU_OPTION_name:
8059                 qemu_name = optarg;
8060                 break;
8061 #ifdef TARGET_SPARC
8062             case QEMU_OPTION_prom_env:
8063                 if (nb_prom_envs >= MAX_PROM_ENVS) {
8064                     fprintf(stderr, "Too many prom variables\n");
8065                     exit(1);
8066                 }
8067                 prom_envs[nb_prom_envs] = optarg;
8068                 nb_prom_envs++;
8069                 break;
8070 #endif
8071 #ifdef TARGET_ARM
8072             case QEMU_OPTION_old_param:
8073                 old_param = 1;
8074 #endif
8075             case QEMU_OPTION_clock:
8076                 configure_alarms(optarg);
8077                 break;
8078             }
8079         }
8080     }
8081
8082 #ifndef _WIN32
8083     if (daemonize && !nographic && vnc_display == NULL) {
8084         fprintf(stderr, "Can only daemonize if using -nographic or -vnc\n");
8085         daemonize = 0;
8086     }
8087
8088     if (daemonize) {
8089         pid_t pid;
8090
8091         if (pipe(fds) == -1)
8092             exit(1);
8093
8094         pid = fork();
8095         if (pid > 0) {
8096             uint8_t status;
8097             ssize_t len;
8098
8099             close(fds[1]);
8100
8101         again:
8102             len = read(fds[0], &status, 1);
8103             if (len == -1 && (errno == EINTR))
8104                 goto again;
8105
8106             if (len != 1)
8107                 exit(1);
8108             else if (status == 1) {
8109                 fprintf(stderr, "Could not acquire pidfile\n");
8110                 exit(1);
8111             } else
8112                 exit(0);
8113         } else if (pid < 0)
8114             exit(1);
8115
8116         setsid();
8117
8118         pid = fork();
8119         if (pid > 0)
8120             exit(0);
8121         else if (pid < 0)
8122             exit(1);
8123
8124         umask(027);
8125         chdir("/");
8126
8127         signal(SIGTSTP, SIG_IGN);
8128         signal(SIGTTOU, SIG_IGN);
8129         signal(SIGTTIN, SIG_IGN);
8130     }
8131 #endif
8132
8133     if (pid_file && qemu_create_pidfile(pid_file) != 0) {
8134         if (daemonize) {
8135             uint8_t status = 1;
8136             write(fds[1], &status, 1);
8137         } else
8138             fprintf(stderr, "Could not acquire pid file\n");
8139         exit(1);
8140     }
8141
8142 #ifdef USE_KQEMU
8143     if (smp_cpus > 1)
8144         kqemu_allowed = 0;
8145 #endif
8146     linux_boot = (kernel_filename != NULL);
8147
8148     if (!linux_boot &&
8149         boot_device != 'n' &&
8150         hd_filename[0] == '\0' &&
8151         (cdrom_index >= 0 && hd_filename[cdrom_index] == '\0') &&
8152         fd_filename[0] == '\0')
8153         help(1);
8154
8155     /* boot to floppy or the default cd if no hard disk defined yet */
8156     if (hd_filename[0] == '\0' && boot_device == 'c') {
8157         if (fd_filename[0] != '\0')
8158             boot_device = 'a';
8159         else
8160             boot_device = 'd';
8161     }
8162
8163     setvbuf(stdout, NULL, _IOLBF, 0);
8164
8165     init_timers();
8166     init_timer_alarm();
8167     qemu_aio_init();
8168
8169 #ifdef _WIN32
8170     socket_init();
8171 #endif
8172
8173     /* init network clients */
8174     if (nb_net_clients == 0) {
8175         /* if no clients, we use a default config */
8176         pstrcpy(net_clients[0], sizeof(net_clients[0]),
8177                 "nic");
8178         pstrcpy(net_clients[1], sizeof(net_clients[0]),
8179                 "user");
8180         nb_net_clients = 2;
8181     }
8182
8183     for(i = 0;i < nb_net_clients; i++) {
8184         if (net_client_init(net_clients[i]) < 0)
8185             exit(1);
8186     }
8187     for(vlan = first_vlan; vlan != NULL; vlan = vlan->next) {
8188         if (vlan->nb_guest_devs == 0 && vlan->nb_host_devs == 0)
8189             continue;
8190         if (vlan->nb_guest_devs == 0) {
8191             fprintf(stderr, "Invalid vlan (%d) with no nics\n", vlan->id);
8192             exit(1);
8193         }
8194         if (vlan->nb_host_devs == 0)
8195             fprintf(stderr,
8196                     "Warning: vlan %d is not connected to host network\n",
8197                     vlan->id);
8198     }
8199
8200 #ifdef TARGET_I386
8201     if (boot_device == 'n') {
8202         for (i = 0; i < nb_nics; i++) {
8203             const char *model = nd_table[i].model;
8204             char buf[1024];
8205             if (model == NULL)
8206                 model = "ne2k_pci";
8207             snprintf(buf, sizeof(buf), "%s/pxe-%s.bin", bios_dir, model);
8208             if (get_image_size(buf) > 0) {
8209                 option_rom[nb_option_roms] = strdup(buf);
8210                 nb_option_roms++;
8211                 break;
8212             }
8213         }
8214         if (i == nb_nics) {
8215             fprintf(stderr, "No valid PXE rom found for network device\n");
8216             exit(1);
8217         }
8218     }
8219 #endif
8220
8221     /* init the memory */
8222     phys_ram_size = ram_size + vga_ram_size + MAX_BIOS_SIZE;
8223
8224     phys_ram_base = qemu_vmalloc(phys_ram_size);
8225     if (!phys_ram_base) {
8226         fprintf(stderr, "Could not allocate physical memory\n");
8227         exit(1);
8228     }
8229
8230     /* we always create the cdrom drive, even if no disk is there */
8231     bdrv_init();
8232     if (cdrom_index >= 0) {
8233         bs_table[cdrom_index] = bdrv_new("cdrom");
8234         bdrv_set_type_hint(bs_table[cdrom_index], BDRV_TYPE_CDROM);
8235     }
8236
8237     /* open the virtual block devices */
8238     for(i = 0; i < MAX_DISKS; i++) {
8239         if (hd_filename[i]) {
8240             if (!bs_table[i]) {
8241                 char buf[64];
8242                 snprintf(buf, sizeof(buf), "hd%c", i + 'a');
8243                 bs_table[i] = bdrv_new(buf);
8244             }
8245             if (bdrv_open(bs_table[i], hd_filename[i], snapshot ? BDRV_O_SNAPSHOT : 0) < 0) {
8246                 fprintf(stderr, "qemu: could not open hard disk image '%s'\n",
8247                         hd_filename[i]);
8248                 exit(1);
8249             }
8250             if (i == 0 && cyls != 0) {
8251                 bdrv_set_geometry_hint(bs_table[i], cyls, heads, secs);
8252                 bdrv_set_translation_hint(bs_table[i], translation);
8253             }
8254         }
8255     }
8256
8257     /* we always create at least one floppy disk */
8258     fd_table[0] = bdrv_new("fda");
8259     bdrv_set_type_hint(fd_table[0], BDRV_TYPE_FLOPPY);
8260
8261     for(i = 0; i < MAX_FD; i++) {
8262         if (fd_filename[i]) {
8263             if (!fd_table[i]) {
8264                 char buf[64];
8265                 snprintf(buf, sizeof(buf), "fd%c", i + 'a');
8266                 fd_table[i] = bdrv_new(buf);
8267                 bdrv_set_type_hint(fd_table[i], BDRV_TYPE_FLOPPY);
8268             }
8269             if (fd_filename[i][0] != '\0') {
8270                 if (bdrv_open(fd_table[i], fd_filename[i],
8271                               snapshot ? BDRV_O_SNAPSHOT : 0) < 0) {
8272                     fprintf(stderr, "qemu: could not open floppy disk image '%s'\n",
8273                             fd_filename[i]);
8274                     exit(1);
8275                 }
8276             }
8277         }
8278     }
8279
8280     /* Open the virtual parallel flash block devices */
8281     for(i = 0; i < MAX_PFLASH; i++) {
8282         if (pflash_filename[i]) {
8283             if (!pflash_table[i]) {
8284                 char buf[64];
8285                 snprintf(buf, sizeof(buf), "fl%c", i + 'a');
8286                 pflash_table[i] = bdrv_new(buf);
8287             }
8288             if (bdrv_open(pflash_table[i], pflash_filename[i],
8289                           snapshot ? BDRV_O_SNAPSHOT : 0) < 0) {
8290                 fprintf(stderr, "qemu: could not open flash image '%s'\n",
8291                         pflash_filename[i]);
8292                 exit(1);
8293             }
8294         }
8295     }
8296
8297     sd_bdrv = bdrv_new ("sd");
8298     /* FIXME: This isn't really a floppy, but it's a reasonable
8299        approximation.  */
8300     bdrv_set_type_hint(sd_bdrv, BDRV_TYPE_FLOPPY);
8301     if (sd_filename) {
8302         if (bdrv_open(sd_bdrv, sd_filename,
8303                       snapshot ? BDRV_O_SNAPSHOT : 0) < 0) {
8304             fprintf(stderr, "qemu: could not open SD card image %s\n",
8305                     sd_filename);
8306         } else
8307             qemu_key_check(sd_bdrv, sd_filename);
8308     }
8309
8310     if (mtd_filename) {
8311         mtd_bdrv = bdrv_new ("mtd");
8312         if (bdrv_open(mtd_bdrv, mtd_filename,
8313                       snapshot ? BDRV_O_SNAPSHOT : 0) < 0 ||
8314             qemu_key_check(mtd_bdrv, mtd_filename)) {
8315             fprintf(stderr, "qemu: could not open Flash image %s\n",
8316                     mtd_filename);
8317             bdrv_delete(mtd_bdrv);
8318             mtd_bdrv = 0;
8319         }
8320     }
8321
8322     register_savevm("timer", 0, 2, timer_save, timer_load, NULL);
8323     register_savevm("ram", 0, 2, ram_save, ram_load, NULL);
8324
8325     init_ioports();
8326
8327     /* terminal init */
8328     memset(&display_state, 0, sizeof(display_state));
8329     if (nographic) {
8330         /* nearly nothing to do */
8331         dumb_display_init(ds);
8332     } else if (vnc_display != NULL) {
8333         vnc_display_init(ds);
8334         if (vnc_display_open(ds, vnc_display) < 0)
8335             exit(1);
8336     } else {
8337 #if defined(CONFIG_SDL)
8338         sdl_display_init(ds, full_screen, no_frame);
8339 #elif defined(CONFIG_COCOA)
8340         cocoa_display_init(ds, full_screen);
8341 #endif
8342     }
8343
8344     /* Maintain compatibility with multiple stdio monitors */
8345     if (!strcmp(monitor_device,"stdio")) {
8346         for (i = 0; i < MAX_SERIAL_PORTS; i++) {
8347             if (!strcmp(serial_devices[i],"mon:stdio")) {
8348                 monitor_device[0] = '\0';
8349                 break;
8350             } else if (!strcmp(serial_devices[i],"stdio")) {
8351                 monitor_device[0] = '\0';
8352                 pstrcpy(serial_devices[0], sizeof(serial_devices[0]), "mon:stdio");
8353                 break;
8354             }
8355         }
8356     }
8357     if (monitor_device[0] != '\0') {
8358         monitor_hd = qemu_chr_open(monitor_device);
8359         if (!monitor_hd) {
8360             fprintf(stderr, "qemu: could not open monitor device '%s'\n", monitor_device);
8361             exit(1);
8362         }
8363         monitor_init(monitor_hd, !nographic);
8364     }
8365
8366     for(i = 0; i < MAX_SERIAL_PORTS; i++) {
8367         const char *devname = serial_devices[i];
8368         if (devname[0] != '\0' && strcmp(devname, "none")) {
8369             serial_hds[i] = qemu_chr_open(devname);
8370             if (!serial_hds[i]) {
8371                 fprintf(stderr, "qemu: could not open serial device '%s'\n",
8372                         devname);
8373                 exit(1);
8374             }
8375             if (strstart(devname, "vc", 0))
8376                 qemu_chr_printf(serial_hds[i], "serial%d console\r\n", i);
8377         }
8378     }
8379
8380     for(i = 0; i < MAX_PARALLEL_PORTS; i++) {
8381         const char *devname = parallel_devices[i];
8382         if (devname[0] != '\0' && strcmp(devname, "none")) {
8383             parallel_hds[i] = qemu_chr_open(devname);
8384             if (!parallel_hds[i]) {
8385                 fprintf(stderr, "qemu: could not open parallel device '%s'\n",
8386                         devname);
8387                 exit(1);
8388             }
8389             if (strstart(devname, "vc", 0))
8390                 qemu_chr_printf(parallel_hds[i], "parallel%d console\r\n", i);
8391         }
8392     }
8393
8394     machine->init(ram_size, vga_ram_size, boot_device,
8395                   ds, fd_filename, snapshot,
8396                   kernel_filename, kernel_cmdline, initrd_filename, cpu_model);
8397
8398     /* init USB devices */
8399     if (usb_enabled) {
8400         for(i = 0; i < usb_devices_index; i++) {
8401             if (usb_device_add(usb_devices[i]) < 0) {
8402                 fprintf(stderr, "Warning: could not add USB device %s\n",
8403                         usb_devices[i]);
8404             }
8405         }
8406     }
8407
8408     if (display_state.dpy_refresh) {
8409         display_state.gui_timer = qemu_new_timer(rt_clock, gui_update, &display_state);
8410         qemu_mod_timer(display_state.gui_timer, qemu_get_clock(rt_clock));
8411     }
8412
8413 #ifdef CONFIG_GDBSTUB
8414     if (use_gdbstub) {
8415         /* XXX: use standard host:port notation and modify options
8416            accordingly. */
8417         if (gdbserver_start(gdbstub_port) < 0) {
8418             fprintf(stderr, "qemu: could not open gdbstub device on port '%s'\n",
8419                     gdbstub_port);
8420             exit(1);
8421         }
8422     }
8423 #endif
8424
8425     if (loadvm)
8426         do_loadvm(loadvm);
8427
8428     {
8429         /* XXX: simplify init */
8430         read_passwords();
8431         if (autostart) {
8432             vm_start();
8433         }
8434     }
8435
8436     if (daemonize) {
8437         uint8_t status = 0;
8438         ssize_t len;
8439         int fd;
8440
8441     again1:
8442         len = write(fds[1], &status, 1);
8443         if (len == -1 && (errno == EINTR))
8444             goto again1;
8445
8446         if (len != 1)
8447             exit(1);
8448
8449         TFR(fd = open("/dev/null", O_RDWR));
8450         if (fd == -1)
8451             exit(1);
8452
8453         dup2(fd, 0);
8454         dup2(fd, 1);
8455         dup2(fd, 2);
8456
8457         close(fd);
8458     }
8459
8460     main_loop();
8461     quit_timers();
8462     return 0;
8463 }