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