Archipelago » qemu

/*

 * QEMU System Emulator

 *

 * Copyright (c) 2003-2008 Fabrice Bellard

 *

 * Permission is hereby granted, free of charge, to any person obtaining a copy

 * of this software and associated documentation files (the "Software"), to deal

 * in the Software without restriction, including without limitation the rights

 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell

 * copies of the Software, and to permit persons to whom the Software is

 * furnished to do so, subject to the following conditions:

 *

 * The above copyright notice and this permission notice shall be included in

 * all copies or substantial portions of the Software.

 *

 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR

 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,

 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL

 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER

 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,

 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN

 * THE SOFTWARE.

 */

#include <unistd.h>

#include <fcntl.h>

#include <signal.h>

#include <time.h>

#include <errno.h>

#include <sys/time.h>

#include <zlib.h>

/* Needed early for CONFIG_BSD etc. */

#include "config-host.h"

#ifndef _WIN32

#include <libgen.h>

#include <pwd.h>

#include <sys/times.h>

#include <sys/wait.h>

#include <termios.h>

#include <sys/mman.h>

#include <sys/ioctl.h>

#include <sys/resource.h>

#include <sys/socket.h>

#include <netinet/in.h>

#include <net/if.h>

#include <arpa/inet.h>

#include <dirent.h>

#include <netdb.h>

#include <sys/select.h>

#ifdef CONFIG_BSD

#include <sys/stat.h>

#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__DragonFly__)

#include <libutil.h>

#else

#include <util.h>

#endif

#else

#ifdef __linux__

#include <pty.h>

#include <malloc.h>

#include <sys/prctl.h>

#include <linux/ppdev.h>

#include <linux/parport.h>

#endif

#ifdef __sun__

#include <sys/stat.h>

#include <sys/ethernet.h>

#include <sys/sockio.h>

#include <netinet/arp.h>

#include <netinet/in.h>

#include <netinet/in_systm.h>

#include <netinet/ip.h>

#include <netinet/ip_icmp.h> // must come after ip.h

#include <netinet/udp.h>

#include <netinet/tcp.h>

#include <net/if.h>

#include <syslog.h>

#include <stropts.h>

/* See MySQL bug #7156 (http://bugs.mysql.com/bug.php?id=7156) for

   discussion about Solaris header problems */

extern int madvise(caddr_t, size_t, int);

#endif

#endif

#endif

#if defined(__OpenBSD__)

#include <util.h>

#endif

#if defined(CONFIG_VDE)

#include <libvdeplug.h>

#endif

#ifdef _WIN32

#include <windows.h>

#endif

#ifdef CONFIG_SDL

#if defined(__APPLE__) || defined(main)

#include <SDL.h>

int qemu_main(int argc, char **argv, char **envp);

int main(int argc, char **argv)

{

    return qemu_main(argc, argv, NULL);

}

#undef main

#define main qemu_main

#endif

#endif /* CONFIG_SDL */

#ifdef CONFIG_COCOA

#undef main

#define main qemu_main

#endif /* CONFIG_COCOA */

#include "hw/hw.h"

#include "hw/boards.h"

#include "hw/usb.h"

#include "hw/pcmcia.h"

#include "hw/pc.h"

#include "hw/audiodev.h"

#include "hw/isa.h"

#include "hw/baum.h"

#include "hw/bt.h"

#include "hw/watchdog.h"

#include "hw/smbios.h"

#include "hw/xen.h"

#include "hw/qdev.h"

#include "hw/loader.h"

#include "bt-host.h"

#include "net.h"

#include "net/slirp.h"

#include "monitor.h"

#include "console.h"

#include "sysemu.h"

#include "gdbstub.h"

#include "qemu-timer.h"

#include "qemu-char.h"

#include "cache-utils.h"

#include "block.h"

#include "block_int.h"

#include "block-migration.h"

#include "dma.h"

#include "audio/audio.h"

#include "migration.h"

#include "kvm.h"

#include "balloon.h"

#include "qemu-option.h"

#include "qemu-config.h"

#include "qemu-objects.h"

#include "disas.h"

#include "exec-all.h"

#include "qemu_socket.h"

#include "slirp/libslirp.h"

#include "qemu-queue.h"

//#define DEBUG_NET

//#define DEBUG_SLIRP

#define DEFAULT_RAM_SIZE 128

#define MAX_VIRTIO_CONSOLES 1

static const char *data_dir;

const char *bios_name = NULL;

/* Note: drives_table[MAX_DRIVES] is a dummy block driver if none available

   to store the VM snapshots */

struct drivelist drives = QTAILQ_HEAD_INITIALIZER(drives);

struct driveoptlist driveopts = QTAILQ_HEAD_INITIALIZER(driveopts);

enum vga_retrace_method vga_retrace_method = VGA_RETRACE_DUMB;

DisplayType display_type = DT_DEFAULT;

const char* keyboard_layout = NULL;

ram_addr_t ram_size;

const char *mem_path = NULL;

#ifdef MAP_POPULATE

int mem_prealloc = 0; /* force preallocation of physical target memory */

#endif

int nb_nics;

NICInfo nd_table[MAX_NICS];

int vm_running;

int autostart;

static int rtc_utc = 1;

static int rtc_date_offset = -1; /* -1 means no change */

QEMUClock *rtc_clock;

int vga_interface_type = VGA_NONE;

#ifdef TARGET_SPARC

int graphic_width = 1024;

int graphic_height = 768;

int graphic_depth = 8;

#else

int graphic_width = 800;

int graphic_height = 600;

int graphic_depth = 15;

#endif

static int full_screen = 0;

#ifdef CONFIG_SDL

static int no_frame = 0;

#endif

int no_quit = 0;

CharDriverState *serial_hds[MAX_SERIAL_PORTS];

CharDriverState *parallel_hds[MAX_PARALLEL_PORTS];

CharDriverState *virtcon_hds[MAX_VIRTIO_CONSOLES];

int win2k_install_hack = 0;

#ifdef TARGET_I386

int rtc_td_hack = 0;

#endif

int usb_enabled = 0;

int singlestep = 0;

int smp_cpus = 1;

int max_cpus = 0;

int smp_cores = 1;

int smp_threads = 1;

const char *vnc_display;

int acpi_enabled = 1;

int no_hpet = 0;

int fd_bootchk = 1;

int no_reboot = 0;

int no_shutdown = 0;

int cursor_hide = 1;

int graphic_rotate = 0;

uint8_t irq0override = 1;

#ifndef _WIN32

int daemonize = 0;

#endif

const char *watchdog;

const char *option_rom[MAX_OPTION_ROMS];

int nb_option_roms;

int semihosting_enabled = 0;

#ifdef TARGET_ARM

int old_param = 0;

#endif

const char *qemu_name;

int alt_grab = 0;

int ctrl_grab = 0;

#if defined(TARGET_SPARC) || defined(TARGET_PPC)

unsigned int nb_prom_envs = 0;

const char *prom_envs[MAX_PROM_ENVS];

#endif

int boot_menu;

int nb_numa_nodes;

uint64_t node_mem[MAX_NODES];

uint64_t node_cpumask[MAX_NODES];

static CPUState *cur_cpu;

static CPUState *next_cpu;

static QEMUTimer *nographic_timer;

uint8_t qemu_uuid[16];

static QEMUBootSetHandler *boot_set_handler;

static void *boot_set_opaque;

int kvm_allowed = 0;

uint32_t xen_domid;

enum xen_mode xen_mode = XEN_EMULATE;

#ifdef SIGRTMIN

#define SIG_IPI (SIGRTMIN+4)

#else

#define SIG_IPI SIGUSR1

#endif

static int default_serial = 1;

static int default_parallel = 1;

static int default_virtcon = 1;

static int default_monitor = 1;

static int default_vga = 1;

static int default_floppy = 1;

static int default_cdrom = 1;

static int default_sdcard = 1;

static struct {

    const char *driver;

    int *flag;

} default_list[] = {

    { .driver = "isa-serial",           .flag = &default_serial    },

    { .driver = "isa-parallel",         .flag = &default_parallel  },

    { .driver = "isa-fdc",              .flag = &default_floppy    },

    { .driver = "ide-drive",            .flag = &default_cdrom     },

    { .driver = "virtio-serial-pci",    .flag = &default_virtcon   },

    { .driver = "virtio-serial-s390",   .flag = &default_virtcon   },

    { .driver = "virtio-serial",        .flag = &default_virtcon   },

    { .driver = "VGA",                  .flag = &default_vga       },

    { .driver = "cirrus-vga",           .flag = &default_vga       },

    { .driver = "vmware-svga",          .flag = &default_vga       },

};

static int default_driver_check(QemuOpts *opts, void *opaque)

{

    const char *driver = qemu_opt_get(opts, "driver");

    int i;

    if (!driver)

        return 0;

    for (i = 0; i < ARRAY_SIZE(default_list); i++) {

        if (strcmp(default_list[i].driver, driver) != 0)

            continue;

        *(default_list[i].flag) = 0;

    }

    return 0;

}

/***********************************************************/

/* x86 ISA bus support */

target_phys_addr_t isa_mem_base = 0;

PicState2 *isa_pic;

/***********************************************************/

void hw_error(const char *fmt, ...)

{

    va_list ap;

    CPUState *env;

    va_start(ap, fmt);

    fprintf(stderr, "qemu: hardware error: ");

    vfprintf(stderr, fmt, ap);

    fprintf(stderr, "\n");

    for(env = first_cpu; env != NULL; env = env->next_cpu) {

        fprintf(stderr, "CPU #%d:\n", env->cpu_index);

#ifdef TARGET_I386

        cpu_dump_state(env, stderr, fprintf, X86_DUMP_FPU);

#else

        cpu_dump_state(env, stderr, fprintf, 0);

#endif

    }

    va_end(ap);

    abort();

}

static void set_proc_name(const char *s)

{

#if defined(__linux__) && defined(PR_SET_NAME)

    char name[16];

    if (!s)

        return;

    name[sizeof(name) - 1] = 0;

    strncpy(name, s, sizeof(name));

    /* Could rewrite argv[0] too, but that's a bit more complicated.

       This simple way is enough for `top'. */

    prctl(PR_SET_NAME, name);

#endif            

}

/***************/

/* ballooning */

static QEMUBalloonEvent *qemu_balloon_event;

void *qemu_balloon_event_opaque;

void qemu_add_balloon_handler(QEMUBalloonEvent *func, void *opaque)

{

    qemu_balloon_event = func;

    qemu_balloon_event_opaque = opaque;

}

int qemu_balloon(ram_addr_t target, MonitorCompletion cb, void *opaque)

{

    if (qemu_balloon_event) {

        qemu_balloon_event(qemu_balloon_event_opaque, target, cb, opaque);

        return 1;

    } else {

        return 0;

    }

}

int qemu_balloon_status(MonitorCompletion cb, void *opaque)

{

    if (qemu_balloon_event) {

        qemu_balloon_event(qemu_balloon_event_opaque, 0, cb, opaque);

        return 1;

    } else {

        return 0;

    }

}

/***********************************************************/

/* real time host monotonic timer */

/* compute with 96 bit intermediate result: (a*b)/c */

uint64_t muldiv64(uint64_t a, uint32_t b, uint32_t c)

{

    union {

        uint64_t ll;

        struct {

#ifdef HOST_WORDS_BIGENDIAN

            uint32_t high, low;

#else

            uint32_t low, high;

#endif

        } l;

    } u, res;

    uint64_t rl, rh;

    u.ll = a;

    rl = (uint64_t)u.l.low * (uint64_t)b;

    rh = (uint64_t)u.l.high * (uint64_t)b;

    rh += (rl >> 32);

    res.l.high = rh / c;

    res.l.low = (((rh % c) << 32) + (rl & 0xffffffff)) / c;

    return res.ll;

}

/***********************************************************/

/* host time/date access */

void qemu_get_timedate(struct tm *tm, int offset)

{

    time_t ti;

    struct tm *ret;

    time(&ti);

    ti += offset;

    if (rtc_date_offset == -1) {

        if (rtc_utc)

            ret = gmtime(&ti);

        else

            ret = localtime(&ti);

    } else {

        ti -= rtc_date_offset;

        ret = gmtime(&ti);

    }

    memcpy(tm, ret, sizeof(struct tm));

}

int qemu_timedate_diff(struct tm *tm)

{

    time_t seconds;

    if (rtc_date_offset == -1)

        if (rtc_utc)

            seconds = mktimegm(tm);

        else

            seconds = mktime(tm);

    else

        seconds = mktimegm(tm) + rtc_date_offset;

    return seconds - time(NULL);

}

void rtc_change_mon_event(struct tm *tm)

{

    QObject *data;

    data = qobject_from_jsonf("{ 'offset': %d }", qemu_timedate_diff(tm));

    monitor_protocol_event(QEVENT_RTC_CHANGE, data);

    qobject_decref(data);

}

static void configure_rtc_date_offset(const char *startdate, int legacy)

{

    time_t rtc_start_date;

    struct tm tm;

    if (!strcmp(startdate, "now") && legacy) {

        rtc_date_offset = -1;

    } else {

        if (sscanf(startdate, "%d-%d-%dT%d:%d:%d",

                   &tm.tm_year,

                   &tm.tm_mon,

                   &tm.tm_mday,

                   &tm.tm_hour,

                   &tm.tm_min,

                   &tm.tm_sec) == 6) {

            /* OK */

        } else if (sscanf(startdate, "%d-%d-%d",

                          &tm.tm_year,

                          &tm.tm_mon,

                          &tm.tm_mday) == 3) {

            tm.tm_hour = 0;

            tm.tm_min = 0;

            tm.tm_sec = 0;

        } else {

            goto date_fail;

        }

        tm.tm_year -= 1900;

        tm.tm_mon--;

        rtc_start_date = mktimegm(&tm);

        if (rtc_start_date == -1) {

        date_fail:

            fprintf(stderr, "Invalid date format. Valid formats are:\n"

                            "'2006-06-17T16:01:21' or '2006-06-17'\n");

            exit(1);

        }

        rtc_date_offset = time(NULL) - rtc_start_date;

    }

}

static void configure_rtc(QemuOpts *opts)

{

    const char *value;

    value = qemu_opt_get(opts, "base");

    if (value) {

        if (!strcmp(value, "utc")) {

            rtc_utc = 1;

        } else if (!strcmp(value, "localtime")) {

            rtc_utc = 0;

        } else {

            configure_rtc_date_offset(value, 0);

        }

    }

    value = qemu_opt_get(opts, "clock");

    if (value) {

        if (!strcmp(value, "host")) {

            rtc_clock = host_clock;

        } else if (!strcmp(value, "vm")) {

            rtc_clock = vm_clock;

        } else {

            fprintf(stderr, "qemu: invalid option value '%s'\n", value);

            exit(1);

        }

    }

#ifdef TARGET_I386

    value = qemu_opt_get(opts, "driftfix");

    if (value) {

        if (!strcmp(value, "slew")) {

            rtc_td_hack = 1;

        } else if (!strcmp(value, "none")) {

            rtc_td_hack = 0;

        } else {

            fprintf(stderr, "qemu: invalid option value '%s'\n", value);

            exit(1);

        }

    }

#endif

}

#ifdef _WIN32

static void socket_cleanup(void)

{

    WSACleanup();

}

static int socket_init(void)

{

    WSADATA Data;

    int ret, err;

    ret = WSAStartup(MAKEWORD(2,2), &Data);

    if (ret != 0) {

        err = WSAGetLastError();

        fprintf(stderr, "WSAStartup: %d\n", err);

        return -1;

    }

    atexit(socket_cleanup);

    return 0;

}

#endif

/***********************************************************/

/* Bluetooth support */

static int nb_hcis;

static int cur_hci;

static struct HCIInfo *hci_table[MAX_NICS];

static struct bt_vlan_s {

    struct bt_scatternet_s net;

    int id;

    struct bt_vlan_s *next;

} *first_bt_vlan;

/* find or alloc a new bluetooth "VLAN" */

static struct bt_scatternet_s *qemu_find_bt_vlan(int id)

{

    struct bt_vlan_s **pvlan, *vlan;

    for (vlan = first_bt_vlan; vlan != NULL; vlan = vlan->next) {

        if (vlan->id == id)

            return &vlan->net;

    }

    vlan = qemu_mallocz(sizeof(struct bt_vlan_s));

    vlan->id = id;

    pvlan = &first_bt_vlan;

    while (*pvlan != NULL)

        pvlan = &(*pvlan)->next;

    *pvlan = vlan;

    return &vlan->net;

}

static void null_hci_send(struct HCIInfo *hci, const uint8_t *data, int len)

{

}

static int null_hci_addr_set(struct HCIInfo *hci, const uint8_t *bd_addr)

{

    return -ENOTSUP;

}

static struct HCIInfo null_hci = {

    .cmd_send = null_hci_send,

    .sco_send = null_hci_send,

    .acl_send = null_hci_send,

    .bdaddr_set = null_hci_addr_set,

};

struct HCIInfo *qemu_next_hci(void)

{

    if (cur_hci == nb_hcis)

        return &null_hci;

    return hci_table[cur_hci++];

}

static struct HCIInfo *hci_init(const char *str)

{

    char *endp;

    struct bt_scatternet_s *vlan = 0;

    if (!strcmp(str, "null"))

        /* null */

        return &null_hci;

    else if (!strncmp(str, "host", 4) && (str[4] == '\0' || str[4] == ':'))

        /* host[:hciN] */

        return bt_host_hci(str[4] ? str + 5 : "hci0");

    else if (!strncmp(str, "hci", 3)) {

        /* hci[,vlan=n] */

        if (str[3]) {

            if (!strncmp(str + 3, ",vlan=", 6)) {

                vlan = qemu_find_bt_vlan(strtol(str + 9, &endp, 0));

                if (*endp)

                    vlan = 0;

            }

        } else

            vlan = qemu_find_bt_vlan(0);

        if (vlan)

           return bt_new_hci(vlan);

    }

    fprintf(stderr, "qemu: Unknown bluetooth HCI `%s'.\n", str);

    return 0;

}

static int bt_hci_parse(const char *str)

{

    struct HCIInfo *hci;

    bdaddr_t bdaddr;

    if (nb_hcis >= MAX_NICS) {

        fprintf(stderr, "qemu: Too many bluetooth HCIs (max %i).\n", MAX_NICS);

        return -1;

    }

    hci = hci_init(str);

    if (!hci)

        return -1;

    bdaddr.b[0] = 0x52;

    bdaddr.b[1] = 0x54;

    bdaddr.b[2] = 0x00;

    bdaddr.b[3] = 0x12;

    bdaddr.b[4] = 0x34;

    bdaddr.b[5] = 0x56 + nb_hcis;

    hci->bdaddr_set(hci, bdaddr.b);

    hci_table[nb_hcis++] = hci;

    return 0;

}

static void bt_vhci_add(int vlan_id)

{

    struct bt_scatternet_s *vlan = qemu_find_bt_vlan(vlan_id);

    if (!vlan->slave)

        fprintf(stderr, "qemu: warning: adding a VHCI to "

                        "an empty scatternet %i\n", vlan_id);

    bt_vhci_init(bt_new_hci(vlan));

}

static struct bt_device_s *bt_device_add(const char *opt)

{

    struct bt_scatternet_s *vlan;

    int vlan_id = 0;

    char *endp = strstr(opt, ",vlan=");

    int len = (endp ? endp - opt : strlen(opt)) + 1;

    char devname[10];

    pstrcpy(devname, MIN(sizeof(devname), len), opt);

    if (endp) {

        vlan_id = strtol(endp + 6, &endp, 0);

        if (*endp) {

            fprintf(stderr, "qemu: unrecognised bluetooth vlan Id\n");

            return 0;

        }

    }

    vlan = qemu_find_bt_vlan(vlan_id);

    if (!vlan->slave)

        fprintf(stderr, "qemu: warning: adding a slave device to "

                        "an empty scatternet %i\n", vlan_id);

    if (!strcmp(devname, "keyboard"))

        return bt_keyboard_init(vlan);

    fprintf(stderr, "qemu: unsupported bluetooth device `%s'\n", devname);

    return 0;

}

static int bt_parse(const char *opt)

{

    const char *endp, *p;

    int vlan;

    if (strstart(opt, "hci", &endp)) {

        if (!*endp || *endp == ',') {

            if (*endp)

                if (!strstart(endp, ",vlan=", 0))

                    opt = endp + 1;

            return bt_hci_parse(opt);

       }

    } else if (strstart(opt, "vhci", &endp)) {

        if (!*endp || *endp == ',') {

            if (*endp) {

                if (strstart(endp, ",vlan=", &p)) {

                    vlan = strtol(p, (char **) &endp, 0);

                    if (*endp) {

                        fprintf(stderr, "qemu: bad scatternet '%s'\n", p);

                        return 1;

                    }

                } else {

                    fprintf(stderr, "qemu: bad parameter '%s'\n", endp + 1);

                    return 1;

                }

            } else

                vlan = 0;

            bt_vhci_add(vlan);

            return 0;

        }

    } else if (strstart(opt, "device:", &endp))

        return !bt_device_add(endp);

    fprintf(stderr, "qemu: bad bluetooth parameter '%s'\n", opt);

    return 1;

}

/***********************************************************/

/* QEMU Block devices */

#define HD_ALIAS "index=%d,media=disk"

#define CDROM_ALIAS "index=2,media=cdrom"

#define FD_ALIAS "index=%d,if=floppy"

#define PFLASH_ALIAS "if=pflash"

#define MTD_ALIAS "if=mtd"

#define SD_ALIAS "index=0,if=sd"

QemuOpts *drive_add(const char *file, const char *fmt, ...)

{

    va_list ap;

    char optstr[1024];

    QemuOpts *opts;

    va_start(ap, fmt);

    vsnprintf(optstr, sizeof(optstr), fmt, ap);

    va_end(ap);

    opts = qemu_opts_parse(&qemu_drive_opts, optstr, 0);

    if (!opts) {

        fprintf(stderr, "%s: huh? duplicate? (%s)\n",

                __FUNCTION__, optstr);

        return NULL;

    }

    if (file)

        qemu_opt_set(opts, "file", file);

    return opts;

}

DriveInfo *drive_get(BlockInterfaceType type, int bus, int unit)

{

    DriveInfo *dinfo;

    /* seek interface, bus and unit */

    QTAILQ_FOREACH(dinfo, &drives, next) {

        if (dinfo->type == type &&

            dinfo->bus == bus &&

            dinfo->unit == unit)

            return dinfo;

    }

    return NULL;

}

DriveInfo *drive_get_by_id(const char *id)

{

    DriveInfo *dinfo;

    QTAILQ_FOREACH(dinfo, &drives, next) {

        if (strcmp(id, dinfo->id))

            continue;

        return dinfo;

    }

    return NULL;

}

int drive_get_max_bus(BlockInterfaceType type)

{

    int max_bus;

    DriveInfo *dinfo;

    max_bus = -1;

    QTAILQ_FOREACH(dinfo, &drives, next) {

        if(dinfo->type == type &&

           dinfo->bus > max_bus)

            max_bus = dinfo->bus;

    }

    return max_bus;

}

const char *drive_get_serial(BlockDriverState *bdrv)

{

    DriveInfo *dinfo;

    QTAILQ_FOREACH(dinfo, &drives, next) {

        if (dinfo->bdrv == bdrv)

            return dinfo->serial;

    }

    return "\0";

}

BlockInterfaceErrorAction drive_get_on_error(

    BlockDriverState *bdrv, int is_read)

{

    DriveInfo *dinfo;

    QTAILQ_FOREACH(dinfo, &drives, next) {

        if (dinfo->bdrv == bdrv)

            return is_read ? dinfo->on_read_error : dinfo->on_write_error;

    }

    return is_read ? BLOCK_ERR_REPORT : BLOCK_ERR_STOP_ENOSPC;

}

static void bdrv_format_print(void *opaque, const char *name)

{

    fprintf(stderr, " %s", name);

}

void drive_uninit(DriveInfo *dinfo)

{

    qemu_opts_del(dinfo->opts);

    bdrv_delete(dinfo->bdrv);

    QTAILQ_REMOVE(&drives, dinfo, next);

    qemu_free(dinfo);

}

static int parse_block_error_action(const char *buf, int is_read)

{

    if (!strcmp(buf, "ignore")) {

        return BLOCK_ERR_IGNORE;

    } else if (!is_read && !strcmp(buf, "enospc")) {

        return BLOCK_ERR_STOP_ENOSPC;

    } else if (!strcmp(buf, "stop")) {

        return BLOCK_ERR_STOP_ANY;

    } else if (!strcmp(buf, "report")) {

        return BLOCK_ERR_REPORT;

    } else {

        fprintf(stderr, "qemu: '%s' invalid %s error action\n",

            buf, is_read ? "read" : "write");

        return -1;

    }

}

DriveInfo *drive_init(QemuOpts *opts, void *opaque,

                      int *fatal_error)

{

    const char *buf;

    const char *file = NULL;

    char devname[128];

    const char *serial;

    const char *mediastr = "";

    BlockInterfaceType type;

    enum { MEDIA_DISK, MEDIA_CDROM } media;

    int bus_id, unit_id;

    int cyls, heads, secs, translation;

    BlockDriver *drv = NULL;

    QEMUMachine *machine = opaque;

    int max_devs;

    int index;

    int cache;

    int aio = 0;

    int ro = 0;

    int bdrv_flags;

    int on_read_error, on_write_error;

    const char *devaddr;

    DriveInfo *dinfo;

    int snapshot = 0;

    *fatal_error = 1;

    translation = BIOS_ATA_TRANSLATION_AUTO;

    cache = 1;

    if (machine && machine->use_scsi) {

        type = IF_SCSI;

        max_devs = MAX_SCSI_DEVS;

        pstrcpy(devname, sizeof(devname), "scsi");

    } else {

        type = IF_IDE;

        max_devs = MAX_IDE_DEVS;

        pstrcpy(devname, sizeof(devname), "ide");

    }

    media = MEDIA_DISK;

    /* extract parameters */

    bus_id  = qemu_opt_get_number(opts, "bus", 0);

    unit_id = qemu_opt_get_number(opts, "unit", -1);

    index   = qemu_opt_get_number(opts, "index", -1);

    cyls  = qemu_opt_get_number(opts, "cyls", 0);

    heads = qemu_opt_get_number(opts, "heads", 0);

    secs  = qemu_opt_get_number(opts, "secs", 0);

    snapshot = qemu_opt_get_bool(opts, "snapshot", 0);

    ro = qemu_opt_get_bool(opts, "readonly", 0);

    file = qemu_opt_get(opts, "file");

    serial = qemu_opt_get(opts, "serial");

    if ((buf = qemu_opt_get(opts, "if")) != NULL) {

        pstrcpy(devname, sizeof(devname), buf);

        if (!strcmp(buf, "ide")) {

            type = IF_IDE;

            max_devs = MAX_IDE_DEVS;

        } else if (!strcmp(buf, "scsi")) {

            type = IF_SCSI;

            max_devs = MAX_SCSI_DEVS;

        } else if (!strcmp(buf, "floppy")) {

            type = IF_FLOPPY;

            max_devs = 0;

        } else if (!strcmp(buf, "pflash")) {

            type = IF_PFLASH;

            max_devs = 0;

        } else if (!strcmp(buf, "mtd")) {

            type = IF_MTD;

            max_devs = 0;

        } else if (!strcmp(buf, "sd")) {

            type = IF_SD;

            max_devs = 0;

        } else if (!strcmp(buf, "virtio")) {

            type = IF_VIRTIO;

            max_devs = 0;

        } else if (!strcmp(buf, "xen")) {

            type = IF_XEN;

            max_devs = 0;

        } else if (!strcmp(buf, "none")) {

            type = IF_NONE;

            max_devs = 0;

        } else {

            fprintf(stderr, "qemu: unsupported bus type '%s'\n", buf);

            return NULL;

        }

    }

    if (cyls || heads || secs) {

        if (cyls < 1 || (type == IF_IDE && cyls > 16383)) {

            fprintf(stderr, "qemu: '%s' invalid physical cyls number\n", buf);

            return NULL;

        }

        if (heads < 1 || (type == IF_IDE && heads > 16)) {

            fprintf(stderr, "qemu: '%s' invalid physical heads number\n", buf);

            return NULL;

        }

        if (secs < 1 || (type == IF_IDE && secs > 63)) {

            fprintf(stderr, "qemu: '%s' invalid physical secs number\n", buf);

            return NULL;

        }

    }

    if ((buf = qemu_opt_get(opts, "trans")) != NULL) {

        if (!cyls) {

            fprintf(stderr,

                    "qemu: '%s' trans must be used with cyls,heads and secs\n",

                    buf);

            return NULL;

        }

        if (!strcmp(buf, "none"))

            translation = BIOS_ATA_TRANSLATION_NONE;

        else if (!strcmp(buf, "lba"))

            translation = BIOS_ATA_TRANSLATION_LBA;

        else if (!strcmp(buf, "auto"))

            translation = BIOS_ATA_TRANSLATION_AUTO;

        else {

            fprintf(stderr, "qemu: '%s' invalid translation type\n", buf);

            return NULL;

        }

    }

    if ((buf = qemu_opt_get(opts, "media")) != NULL) {

        if (!strcmp(buf, "disk")) {

            media = MEDIA_DISK;

        } else if (!strcmp(buf, "cdrom")) {

            if (cyls || secs || heads) {

                fprintf(stderr,

                        "qemu: '%s' invalid physical CHS format\n", buf);

                return NULL;

            }

            media = MEDIA_CDROM;

        } else {

            fprintf(stderr, "qemu: '%s' invalid media\n", buf);

            return NULL;

        }

    }

    if ((buf = qemu_opt_get(opts, "cache")) != NULL) {

        if (!strcmp(buf, "off") || !strcmp(buf, "none"))

            cache = 0;

        else if (!strcmp(buf, "writethrough"))

            cache = 1;

        else if (!strcmp(buf, "writeback"))

            cache = 2;

        else {

           fprintf(stderr, "qemu: invalid cache option\n");

           return NULL;

        }

    }

#ifdef CONFIG_LINUX_AIO

    if ((buf = qemu_opt_get(opts, "aio")) != NULL) {

        if (!strcmp(buf, "threads"))

            aio = 0;

        else if (!strcmp(buf, "native"))

            aio = 1;

        else {

           fprintf(stderr, "qemu: invalid aio option\n");

           return NULL;

        }

    }

#endif

    if ((buf = qemu_opt_get(opts, "format")) != NULL) {

       if (strcmp(buf, "?") == 0) {

            fprintf(stderr, "qemu: Supported formats:");

            bdrv_iterate_format(bdrv_format_print, NULL);

            fprintf(stderr, "\n");

            return NULL;

        }

        drv = bdrv_find_whitelisted_format(buf);

        if (!drv) {

            fprintf(stderr, "qemu: '%s' invalid format\n", buf);

            return NULL;

        }

    }

    on_write_error = BLOCK_ERR_STOP_ENOSPC;

    if ((buf = qemu_opt_get(opts, "werror")) != NULL) {

        if (type != IF_IDE && type != IF_SCSI && type != IF_VIRTIO) {

            fprintf(stderr, "werror is no supported by this format\n");

            return NULL;

        }

        on_write_error = parse_block_error_action(buf, 0);

        if (on_write_error < 0) {

            return NULL;

        }

    }

    on_read_error = BLOCK_ERR_REPORT;

    if ((buf = qemu_opt_get(opts, "rerror")) != NULL) {

        if (type != IF_IDE && type != IF_VIRTIO) {

            fprintf(stderr, "rerror is no supported by this format\n");

            return NULL;

        }

        on_read_error = parse_block_error_action(buf, 1);

        if (on_read_error < 0) {

            return NULL;

        }

    }

    if ((devaddr = qemu_opt_get(opts, "addr")) != NULL) {

        if (type != IF_VIRTIO) {

            fprintf(stderr, "addr is not supported\n");

            return NULL;

        }

    }

    /* compute bus and unit according index */

    if (index != -1) {

        if (bus_id != 0 || unit_id != -1) {

            fprintf(stderr,

                    "qemu: index cannot be used with bus and unit\n");

            return NULL;

        }

        if (max_devs == 0)

        {

            unit_id = index;

            bus_id = 0;

        } else {

            unit_id = index % max_devs;

            bus_id = index / max_devs;

        }

    }

    /* if user doesn't specify a unit_id,

     * try to find the first free

     */

    if (unit_id == -1) {

       unit_id = 0;

       while (drive_get(type, bus_id, unit_id) != NULL) {

           unit_id++;

           if (max_devs && unit_id >= max_devs) {

               unit_id -= max_devs;

               bus_id++;

           }

       }

    }

    /* check unit id */

    if (max_devs && unit_id >= max_devs) {

        fprintf(stderr, "qemu: unit %d too big (max is %d)\n",

                unit_id, max_devs - 1);

        return NULL;

    }

    /*

     * ignore multiple definitions

     */

    if (drive_get(type, bus_id, unit_id) != NULL) {

        *fatal_error = 0;

        return NULL;

    }

    /* init */

    dinfo = qemu_mallocz(sizeof(*dinfo));

    if ((buf = qemu_opts_id(opts)) != NULL) {

        dinfo->id = qemu_strdup(buf);

    } else {

        /* no id supplied -> create one */

        dinfo->id = qemu_mallocz(32);

        if (type == IF_IDE || type == IF_SCSI)

            mediastr = (media == MEDIA_CDROM) ? "-cd" : "-hd";

        if (max_devs)

            snprintf(dinfo->id, 32, "%s%i%s%i",

                     devname, bus_id, mediastr, unit_id);

        else

            snprintf(dinfo->id, 32, "%s%s%i",

                     devname, mediastr, unit_id);

    }

    dinfo->bdrv = bdrv_new(dinfo->id);

    dinfo->devaddr = devaddr;

    dinfo->type = type;

    dinfo->bus = bus_id;

    dinfo->unit = unit_id;

    dinfo->on_read_error = on_read_error;

    dinfo->on_write_error = on_write_error;

    dinfo->opts = opts;

    if (serial)

        strncpy(dinfo->serial, serial, sizeof(serial));

    QTAILQ_INSERT_TAIL(&drives, dinfo, next);

    switch(type) {

    case IF_IDE:

    case IF_SCSI:

    case IF_XEN:

    case IF_NONE:

        switch(media) {

        case MEDIA_DISK:

            if (cyls != 0) {

                bdrv_set_geometry_hint(dinfo->bdrv, cyls, heads, secs);

                bdrv_set_translation_hint(dinfo->bdrv, translation);

            }

            break;

        case MEDIA_CDROM:

            bdrv_set_type_hint(dinfo->bdrv, BDRV_TYPE_CDROM);

            break;

        }

        break;

    case IF_SD:

        /* FIXME: This isn't really a floppy, but it's a reasonable

           approximation.  */

    case IF_FLOPPY:

        bdrv_set_type_hint(dinfo->bdrv, BDRV_TYPE_FLOPPY);

        break;

    case IF_PFLASH:

    case IF_MTD:

        break;

    case IF_VIRTIO:

        /* add virtio block device */

        opts = qemu_opts_create(&qemu_device_opts, NULL, 0);

        qemu_opt_set(opts, "driver", "virtio-blk-pci");

        qemu_opt_set(opts, "drive", dinfo->id);

        if (devaddr)

            qemu_opt_set(opts, "addr", devaddr);

        break;

    case IF_COUNT:

        abort();

    }

    if (!file) {

        *fatal_error = 0;

        return NULL;

    }

    bdrv_flags = 0;

    if (snapshot) {

        bdrv_flags |= BDRV_O_SNAPSHOT;

        cache = 2; /* always use write-back with snapshot */

    }

    if (cache == 0) /* no caching */

        bdrv_flags |= BDRV_O_NOCACHE;

    else if (cache == 2) /* write-back */

        bdrv_flags |= BDRV_O_CACHE_WB;

    if (aio == 1) {

        bdrv_flags |= BDRV_O_NATIVE_AIO;

    } else {

        bdrv_flags &= ~BDRV_O_NATIVE_AIO;

    }

    if (ro == 1) {

        if (type != IF_SCSI && type != IF_VIRTIO && type != IF_FLOPPY) {

            fprintf(stderr, "qemu: readonly flag not supported for drive with this interface\n");

            return NULL;

        }

    }

    /* 

     * cdrom is read-only. Set it now, after above interface checking

     * since readonly attribute not explicitly required, so no error.

     */

    if (media == MEDIA_CDROM) {

        ro = 1;