hw/s390x/s390-virtio.c - qemu - Git at Google

 /*
  * 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
 #define ZIPL_FILENAME                   "s390-zipl.rom"

 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,
                        const char *firmware)
 {
     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_prop_set_string(dev, "firmware", firmware);
     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);

     /* let's 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, ZIPL_FILENAME);

     /* register hypercalls */
     s390_virtio_register_hcalls();

     /* allocate RAM */
     memory_region_init_ram(ram, NULL, "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);
	/*
	* 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
	#define ZIPL_FILENAME "s390-zipl.rom"

	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,
	const char *firmware)
	{
	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_prop_set_string(dev, "firmware", firmware);
	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);

	/* let's 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, ZIPL_FILENAME);

	/* register hypercalls */
	s390_virtio_register_hcalls();

	/* allocate RAM */
	memory_region_init_ram(ram, NULL, "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);