vl.c

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