Archipelago » qemu

/*

 * QEMU S390 virtio target

 *

 * Copyright (c) 2009 Alexander Graf <agraf@suse.de>

 * Copyright IBM Corp 2012

 *

 * This library is free software; you can redistribute it and/or

 * modify it under the terms of the GNU Lesser General Public

 * License as published by the Free Software Foundation; either

 * version 2 of the License, or (at your option) any later version.

 *

 * This library is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU

 * Lesser General Public License for more details.

 *

 * Contributions after 2012-10-29 are licensed under the terms of the

 * GNU GPL, version 2 or (at your option) any later version.

 *

 * You should have received a copy of the GNU (Lesser) General Public

 * License along with this library; if not, see <http://www.gnu.org/licenses/>.

 */

#include "hw/hw.h"

#include "block/block.h"

#include "sysemu/blockdev.h"

#include "sysemu/sysemu.h"

#include "net/net.h"

#include "hw/boards.h"

#include "monitor/monitor.h"

#include "hw/loader.h"

#include "hw/virtio/virtio.h"

#include "hw/sysbus.h"

#include "sysemu/kvm.h"

#include "exec/address-spaces.h"

#include "hw/s390x/s390-virtio-bus.h"

#include "hw/s390x/sclp.h"

#include "hw/s390x/s390-virtio.h"

//#define DEBUG_S390

#ifdef DEBUG_S390

#define dprintf(fmt, ...) \

    do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)

#else

#define dprintf(fmt, ...) \

    do { } while (0)

#endif

#define MAX_BLK_DEVS                    10

static VirtIOS390Bus *s390_bus;

static S390CPU **ipi_states;

S390CPU *s390_cpu_addr2state(uint16_t cpu_addr)

{

    if (cpu_addr >= smp_cpus) {

        return NULL;

    }

    return ipi_states[cpu_addr];

}

static int s390_virtio_hcall_notify(const uint64_t *args)

{

    uint64_t mem = args[0];

    int r = 0, i;

    if (mem > ram_size) {

        VirtIOS390Device *dev = s390_virtio_bus_find_vring(s390_bus, mem, &i);

        if (dev) {

            virtio_queue_notify(dev->vdev, i);

        } else {

            r = -EINVAL;

        }

    } else {

        /* Early printk */

    }

    return r;

}

static int s390_virtio_hcall_reset(const uint64_t *args)

{

    uint64_t mem = args[0];

    VirtIOS390Device *dev;

    dev = s390_virtio_bus_find_mem(s390_bus, mem);

    if (dev == NULL) {

        return -EINVAL;

    }

    virtio_reset(dev->vdev);

    stb_phys(dev->dev_offs + VIRTIO_DEV_OFFS_STATUS, 0);

    s390_virtio_device_sync(dev);

    s390_virtio_reset_idx(dev);

    return 0;

}

static int s390_virtio_hcall_set_status(const uint64_t *args)

{

    uint64_t mem = args[0];

    int r = 0;

    VirtIOS390Device *dev;

    dev = s390_virtio_bus_find_mem(s390_bus, mem);

    if (dev) {

        s390_virtio_device_update_status(dev);

    } else {

        r = -EINVAL;

    }

    return r;

}

static void s390_virtio_register_hcalls(void)

{

    s390_register_virtio_hypercall(KVM_S390_VIRTIO_NOTIFY,

                                   s390_virtio_hcall_notify);

    s390_register_virtio_hypercall(KVM_S390_VIRTIO_RESET,

                                   s390_virtio_hcall_reset);

    s390_register_virtio_hypercall(KVM_S390_VIRTIO_SET_STATUS,

                                   s390_virtio_hcall_set_status);

}

/*

 * The number of running CPUs. On s390 a shutdown is the state of all CPUs

 * being either stopped or disabled (for interrupts) waiting. We have to

 * track this number to call the shutdown sequence accordingly. This

 * number is modified either on startup or while holding the big qemu lock.

 */

static unsigned s390_running_cpus;

void s390_add_running_cpu(S390CPU *cpu)

{

    CPUState *cs = CPU(cpu);

    CPUS390XState *env = &cpu->env;

    if (cs->halted) {

        s390_running_cpus++;

        cs->halted = 0;

        env->exception_index = -1;

    }

}

unsigned s390_del_running_cpu(S390CPU *cpu)

{

    CPUState *cs = CPU(cpu);

    CPUS390XState *env = &cpu->env;

    if (cs->halted == 0) {

        assert(s390_running_cpus >= 1);

        s390_running_cpus--;

        cs->halted = 1;

        env->exception_index = EXCP_HLT;

    }

    return s390_running_cpus;

}

void s390_init_ipl_dev(const char *kernel_filename,

                       const char *kernel_cmdline,

                       const char *initrd_filename)

{

    DeviceState *dev;

    dev  = qdev_create(NULL, "s390-ipl");

    if (kernel_filename) {

        qdev_prop_set_string(dev, "kernel", kernel_filename);

    }

    if (initrd_filename) {

        qdev_prop_set_string(dev, "initrd", initrd_filename);

    }

    qdev_prop_set_string(dev, "cmdline", kernel_cmdline);

    qdev_init_nofail(dev);

}

void s390_init_cpus(const char *cpu_model, uint8_t *storage_keys)

{

    int i;

    if (cpu_model == NULL) {

        cpu_model = "host";

    }

    ipi_states = g_malloc(sizeof(S390CPU *) * smp_cpus);

    for (i = 0; i < smp_cpus; i++) {

        S390CPU *cpu;

        CPUState *cs;

        cpu = cpu_s390x_init(cpu_model);

        cs = CPU(cpu);

        ipi_states[i] = cpu;

        cs->halted = 1;

        cpu->env.exception_index = EXCP_HLT;

        cpu->env.storage_keys = storage_keys;

    }

}

void s390_create_virtio_net(BusState *bus, const char *name)

{

    int i;

    for (i = 0; i < nb_nics; i++) {

        NICInfo *nd = &nd_table[i];

        DeviceState *dev;

        if (!nd->model) {

            nd->model = g_strdup("virtio");

        }

        if (strcmp(nd->model, "virtio")) {

            fprintf(stderr, "S390 only supports VirtIO nics\n");

            exit(1);

        }

        dev = qdev_create(bus, name);

        qdev_set_nic_properties(dev, nd);

        qdev_init_nofail(dev);

    }

}

/* PC hardware initialisation */

static void s390_init(QEMUMachineInitArgs *args)

{

    ram_addr_t my_ram_size = args->ram_size;

    MemoryRegion *sysmem = get_system_memory();

    MemoryRegion *ram = g_new(MemoryRegion, 1);

    int shift = 0;

    uint8_t *storage_keys;

    void *virtio_region;

    hwaddr virtio_region_len;

    hwaddr virtio_region_start;

    /* s390x ram size detection needs a 16bit multiplier + an increment. So

       guests > 64GB can be specified in 2MB steps etc. */

    while ((my_ram_size >> (20 + shift)) > 65535) {

        shift++;

    }

    my_ram_size = my_ram_size >> (20 + shift) << (20 + shift);

    /* lets propagate the changed ram size into the global variable. */

    ram_size = my_ram_size;

    /* get a BUS */

    s390_bus = s390_virtio_bus_init(&my_ram_size);

    s390_sclp_init();

    s390_init_ipl_dev(args->kernel_filename, args->kernel_cmdline,

                      args->initrd_filename);

    /* register hypercalls */

    s390_virtio_register_hcalls();

    /* allocate RAM */

    memory_region_init_ram(ram, "s390.ram", my_ram_size);

    vmstate_register_ram_global(ram);

    memory_region_add_subregion(sysmem, 0, ram);

    /* clear virtio region */

    virtio_region_len = my_ram_size - ram_size;

    virtio_region_start = ram_size;

    virtio_region = cpu_physical_memory_map(virtio_region_start,

                                            &virtio_region_len, true);

    memset(virtio_region, 0, virtio_region_len);

    cpu_physical_memory_unmap(virtio_region, virtio_region_len, 1,

                              virtio_region_len);

    /* allocate storage keys */

    storage_keys = g_malloc0(my_ram_size / TARGET_PAGE_SIZE);

    /* init CPUs */

    s390_init_cpus(args->cpu_model, storage_keys);

    /* Create VirtIO network adapters */

    s390_create_virtio_net((BusState *)s390_bus, "virtio-net-s390");

}

static QEMUMachine s390_machine = {

    .name = "s390-virtio",

    .alias = "s390",

    .desc = "VirtIO based S390 machine",

    .init = s390_init,

    .block_default_type = IF_VIRTIO,

    .no_cdrom = 1,

    .no_floppy = 1,

    .no_serial = 1,

    .no_parallel = 1,

    .no_sdcard = 1,

    .use_virtcon = 1,

    .max_cpus = 255,

    .is_default = 1,

    DEFAULT_MACHINE_OPTIONS,

};

static void s390_machine_init(void)

{

    qemu_register_machine(&s390_machine);

}

machine_init(s390_machine_init);