hw/intc/arm_gicv3_its_kvm.c - qemu - Git at Google

 /*
  * KVM-based ITS implementation for a GICv3-based system
  *
  * Copyright (c) 2015 Samsung Electronics Co., Ltd.
  * Written by Pavel Fedin <p.fedin@samsung.com>
  *
  * 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.
  *
  * 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 "qemu/osdep.h"
 #include "qapi/error.h"
 #include "hw/intc/arm_gicv3_its_common.h"
 #include "sysemu/sysemu.h"
 #include "sysemu/kvm.h"
 #include "kvm_arm.h"
 #include "migration/blocker.h"

 #define TYPE_KVM_ARM_ITS "arm-its-kvm"
 #define KVM_ARM_ITS(obj) OBJECT_CHECK(GICv3ITSState, (obj), TYPE_KVM_ARM_ITS)
 #define KVM_ARM_ITS_CLASS(klass) \
      OBJECT_CLASS_CHECK(KVMARMITSClass, (klass), TYPE_KVM_ARM_ITS)
 #define KVM_ARM_ITS_GET_CLASS(obj) \
      OBJECT_GET_CLASS(KVMARMITSClass, (obj), TYPE_KVM_ARM_ITS)

 typedef struct KVMARMITSClass {
     GICv3ITSCommonClass parent_class;
     void (*parent_reset)(DeviceState *dev);
 } KVMARMITSClass;


 static int kvm_its_send_msi(GICv3ITSState *s, uint32_t value, uint16_t devid)
 {
     struct kvm_msi msi;

     if (unlikely(!s->translater_gpa_known)) {
         MemoryRegion *mr = &s->iomem_its_translation;
         MemoryRegionSection mrs;

         mrs = memory_region_find(mr, 0, 1);
         memory_region_unref(mrs.mr);
         s->gits_translater_gpa = mrs.offset_within_address_space + 0x40;
         s->translater_gpa_known = true;
     }

     msi.address_lo = extract64(s->gits_translater_gpa, 0, 32);
     msi.address_hi = extract64(s->gits_translater_gpa, 32, 32);
     msi.data = le32_to_cpu(value);
     msi.flags = KVM_MSI_VALID_DEVID;
     msi.devid = devid;
     memset(msi.pad, 0, sizeof(msi.pad));

     return kvm_vm_ioctl(kvm_state, KVM_SIGNAL_MSI, &msi);
 }

 /**
  * vm_change_state_handler - VM change state callback aiming at flushing
  * ITS tables into guest RAM
  *
  * The tables get flushed to guest RAM whenever the VM gets stopped.
  */
 static void vm_change_state_handler(void *opaque, int running,
                                     RunState state)
 {
     GICv3ITSState *s = (GICv3ITSState *)opaque;
     Error *err = NULL;

     if (running) {
         return;
     }

     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_CTRL,
                       KVM_DEV_ARM_ITS_SAVE_TABLES, NULL, true, &err);
     if (err) {
         error_report_err(err);
     }
 }

 static void kvm_arm_its_realize(DeviceState *dev, Error **errp)
 {
     GICv3ITSState *s = ARM_GICV3_ITS_COMMON(dev);
     Error *local_err = NULL;

     s->dev_fd = kvm_create_device(kvm_state, KVM_DEV_TYPE_ARM_VGIC_ITS, false);
     if (s->dev_fd < 0) {
         error_setg_errno(errp, -s->dev_fd, "error creating in-kernel ITS");
         return;
     }

     /* explicit init of the ITS */
     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_CTRL,
                       KVM_DEV_ARM_VGIC_CTRL_INIT, NULL, true, &error_abort);

     /* register the base address */
     kvm_arm_register_device(&s->iomem_its_cntrl, -1, KVM_DEV_ARM_VGIC_GRP_ADDR,
                             KVM_VGIC_ITS_ADDR_TYPE, s->dev_fd);

     gicv3_its_init_mmio(s, NULL);

     if (!kvm_device_check_attr(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
         GITS_CTLR)) {
         error_setg(&s->migration_blocker, "This operating system kernel "
                    "does not support vITS migration");
         migrate_add_blocker(s->migration_blocker, &local_err);
         if (local_err) {
             error_propagate(errp, local_err);
             error_free(s->migration_blocker);
             return;
         }
     } else {
         qemu_add_vm_change_state_handler(vm_change_state_handler, s);
     }

     kvm_msi_use_devid = true;
     kvm_gsi_direct_mapping = false;
     kvm_msi_via_irqfd_allowed = kvm_irqfds_enabled();
 }

 /**
  * kvm_arm_its_pre_save - handles the saving of ITS registers.
  * ITS tables are flushed into guest RAM separately and earlier,
  * through the VM change state handler, since at the moment pre_save()
  * is called, the guest RAM has already been saved.
  */
 static void kvm_arm_its_pre_save(GICv3ITSState *s)
 {
     int i;

     for (i = 0; i < 8; i++) {
         kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                           GITS_BASER + i * 8, &s->baser[i], false,
                           &error_abort);
     }

     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                       GITS_CTLR, &s->ctlr, false, &error_abort);

     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                       GITS_CBASER, &s->cbaser, false, &error_abort);

     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                       GITS_CREADR, &s->creadr, false, &error_abort);

     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                       GITS_CWRITER, &s->cwriter, false, &error_abort);

     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                       GITS_IIDR, &s->iidr, false, &error_abort);
 }

 /**
  * kvm_arm_its_post_load - Restore both the ITS registers and tables
  */
 static void kvm_arm_its_post_load(GICv3ITSState *s)
 {
     int i;

     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                       GITS_IIDR, &s->iidr, true, &error_abort);

     /*
      * must be written before GITS_CREADR since GITS_CBASER write
      * access resets GITS_CREADR.
      */
     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                       GITS_CBASER, &s->cbaser, true, &error_abort);

     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                       GITS_CREADR, &s->creadr, true, &error_abort);

     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                       GITS_CWRITER, &s->cwriter, true, &error_abort);


     for (i = 0; i < 8; i++) {
         kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                           GITS_BASER + i * 8, &s->baser[i], true,
                           &error_abort);
     }

     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_CTRL,
                       KVM_DEV_ARM_ITS_RESTORE_TABLES, NULL, true,
                       &error_abort);

     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                       GITS_CTLR, &s->ctlr, true, &error_abort);
 }

 static void kvm_arm_its_reset(DeviceState *dev)
 {
     GICv3ITSState *s = ARM_GICV3_ITS_COMMON(dev);
     KVMARMITSClass *c = KVM_ARM_ITS_GET_CLASS(s);
     int i;

     c->parent_reset(dev);

     if (kvm_device_check_attr(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_CTRL,
                                KVM_DEV_ARM_ITS_CTRL_RESET)) {
         kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_CTRL,
                           KVM_DEV_ARM_ITS_CTRL_RESET, NULL, true, &error_abort);
         return;
     }

     error_report("ITS KVM: full reset is not supported by the host kernel");

     if (!kvm_device_check_attr(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                                GITS_CTLR)) {
         return;
     }

     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                       GITS_CTLR, &s->ctlr, true, &error_abort);

     kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                       GITS_CBASER, &s->cbaser, true, &error_abort);

     for (i = 0; i < 8; i++) {
         kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
                           GITS_BASER + i * 8, &s->baser[i], true,
                           &error_abort);
     }
 }

 static Property kvm_arm_its_props[] = {
     DEFINE_PROP_LINK("parent-gicv3", GICv3ITSState, gicv3, "kvm-arm-gicv3",
                      GICv3State *),
     DEFINE_PROP_END_OF_LIST(),
 };

 static void kvm_arm_its_class_init(ObjectClass *klass, void *data)
 {
     DeviceClass *dc = DEVICE_CLASS(klass);
     GICv3ITSCommonClass *icc = ARM_GICV3_ITS_COMMON_CLASS(klass);
     KVMARMITSClass *ic = KVM_ARM_ITS_CLASS(klass);

     dc->realize = kvm_arm_its_realize;
     dc->props   = kvm_arm_its_props;
     device_class_set_parent_reset(dc, kvm_arm_its_reset, &ic->parent_reset);
     icc->send_msi = kvm_its_send_msi;
     icc->pre_save = kvm_arm_its_pre_save;
     icc->post_load = kvm_arm_its_post_load;
 }

 static const TypeInfo kvm_arm_its_info = {
     .name = TYPE_KVM_ARM_ITS,
     .parent = TYPE_ARM_GICV3_ITS_COMMON,
     .instance_size = sizeof(GICv3ITSState),
     .class_init = kvm_arm_its_class_init,
     .class_size = sizeof(KVMARMITSClass),
 };

 static void kvm_arm_its_register_types(void)
 {
     type_register_static(&kvm_arm_its_info);
 }

 type_init(kvm_arm_its_register_types)
	/*
	* KVM-based ITS implementation for a GICv3-based system
	*
	* Copyright (c) 2015 Samsung Electronics Co., Ltd.
	* Written by Pavel Fedin <p.fedin@samsung.com>
	*
	* 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.
	*
	* 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 "qemu/osdep.h"
	#include "qapi/error.h"
	#include "hw/intc/arm_gicv3_its_common.h"
	#include "sysemu/sysemu.h"
	#include "sysemu/kvm.h"
	#include "kvm_arm.h"
	#include "migration/blocker.h"

	#define TYPE_KVM_ARM_ITS "arm-its-kvm"
	#define KVM_ARM_ITS(obj) OBJECT_CHECK(GICv3ITSState, (obj), TYPE_KVM_ARM_ITS)
	#define KVM_ARM_ITS_CLASS(klass) \
	OBJECT_CLASS_CHECK(KVMARMITSClass, (klass), TYPE_KVM_ARM_ITS)
	#define KVM_ARM_ITS_GET_CLASS(obj) \
	OBJECT_GET_CLASS(KVMARMITSClass, (obj), TYPE_KVM_ARM_ITS)

	typedef struct KVMARMITSClass {
	GICv3ITSCommonClass parent_class;
	void (parent_reset)(DeviceState dev);
	} KVMARMITSClass;


	static int kvm_its_send_msi(GICv3ITSState *s, uint32_t value, uint16_t devid)
	{
	struct kvm_msi msi;

	if (unlikely(!s->translater_gpa_known)) {
	MemoryRegion *mr = &s->iomem_its_translation;
	MemoryRegionSection mrs;

	mrs = memory_region_find(mr, 0, 1);
	memory_region_unref(mrs.mr);
	s->gits_translater_gpa = mrs.offset_within_address_space + 0x40;
	s->translater_gpa_known = true;
	}

	msi.address_lo = extract64(s->gits_translater_gpa, 0, 32);
	msi.address_hi = extract64(s->gits_translater_gpa, 32, 32);
	msi.data = le32_to_cpu(value);
	msi.flags = KVM_MSI_VALID_DEVID;
	msi.devid = devid;
	memset(msi.pad, 0, sizeof(msi.pad));

	return kvm_vm_ioctl(kvm_state, KVM_SIGNAL_MSI, &msi);
	}

	/**
	* vm_change_state_handler - VM change state callback aiming at flushing
	* ITS tables into guest RAM
	*
	* The tables get flushed to guest RAM whenever the VM gets stopped.
	*/
	static void vm_change_state_handler(void *opaque, int running,
	RunState state)
	{
	GICv3ITSState s = (GICv3ITSState )opaque;
	Error *err = NULL;

	if (running) {
	return;
	}

	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_CTRL,
	KVM_DEV_ARM_ITS_SAVE_TABLES, NULL, true, &err);
	if (err) {
	error_report_err(err);
	}
	}

	static void kvm_arm_its_realize(DeviceState dev, Error *errp)
	{
	GICv3ITSState *s = ARM_GICV3_ITS_COMMON(dev);
	Error *local_err = NULL;

	s->dev_fd = kvm_create_device(kvm_state, KVM_DEV_TYPE_ARM_VGIC_ITS, false);
	if (s->dev_fd < 0) {
	error_setg_errno(errp, -s->dev_fd, "error creating in-kernel ITS");
	return;
	}

	/* explicit init of the ITS */
	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_CTRL,
	KVM_DEV_ARM_VGIC_CTRL_INIT, NULL, true, &error_abort);

	/* register the base address */
	kvm_arm_register_device(&s->iomem_its_cntrl, -1, KVM_DEV_ARM_VGIC_GRP_ADDR,
	KVM_VGIC_ITS_ADDR_TYPE, s->dev_fd);

	gicv3_its_init_mmio(s, NULL);

	if (!kvm_device_check_attr(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_CTLR)) {
	error_setg(&s->migration_blocker, "This operating system kernel "
	"does not support vITS migration");
	migrate_add_blocker(s->migration_blocker, &local_err);
	if (local_err) {
	error_propagate(errp, local_err);
	error_free(s->migration_blocker);
	return;
	}
	} else {
	qemu_add_vm_change_state_handler(vm_change_state_handler, s);
	}

	kvm_msi_use_devid = true;
	kvm_gsi_direct_mapping = false;
	kvm_msi_via_irqfd_allowed = kvm_irqfds_enabled();
	}

	/**
	* kvm_arm_its_pre_save - handles the saving of ITS registers.
	* ITS tables are flushed into guest RAM separately and earlier,
	* through the VM change state handler, since at the moment pre_save()
	* is called, the guest RAM has already been saved.
	*/
	static void kvm_arm_its_pre_save(GICv3ITSState *s)
	{
	int i;

	for (i = 0; i < 8; i++) {
	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_BASER + i * 8, &s->baser[i], false,
	&error_abort);
	}

	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_CTLR, &s->ctlr, false, &error_abort);

	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_CBASER, &s->cbaser, false, &error_abort);

	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_CREADR, &s->creadr, false, &error_abort);

	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_CWRITER, &s->cwriter, false, &error_abort);

	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_IIDR, &s->iidr, false, &error_abort);
	}

	/**
	* kvm_arm_its_post_load - Restore both the ITS registers and tables
	*/
	static void kvm_arm_its_post_load(GICv3ITSState *s)
	{
	int i;

	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_IIDR, &s->iidr, true, &error_abort);

	/*
	* must be written before GITS_CREADR since GITS_CBASER write
	* access resets GITS_CREADR.
	*/
	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_CBASER, &s->cbaser, true, &error_abort);

	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_CREADR, &s->creadr, true, &error_abort);

	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_CWRITER, &s->cwriter, true, &error_abort);


	for (i = 0; i < 8; i++) {
	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_BASER + i * 8, &s->baser[i], true,
	&error_abort);
	}

	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_CTRL,
	KVM_DEV_ARM_ITS_RESTORE_TABLES, NULL, true,
	&error_abort);

	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_CTLR, &s->ctlr, true, &error_abort);
	}

	static void kvm_arm_its_reset(DeviceState *dev)
	{
	GICv3ITSState *s = ARM_GICV3_ITS_COMMON(dev);
	KVMARMITSClass *c = KVM_ARM_ITS_GET_CLASS(s);
	int i;

	c->parent_reset(dev);

	if (kvm_device_check_attr(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_CTRL,
	KVM_DEV_ARM_ITS_CTRL_RESET)) {
	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_CTRL,
	KVM_DEV_ARM_ITS_CTRL_RESET, NULL, true, &error_abort);
	return;
	}

	error_report("ITS KVM: full reset is not supported by the host kernel");

	if (!kvm_device_check_attr(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_CTLR)) {
	return;
	}

	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_CTLR, &s->ctlr, true, &error_abort);

	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_CBASER, &s->cbaser, true, &error_abort);

	for (i = 0; i < 8; i++) {
	kvm_device_access(s->dev_fd, KVM_DEV_ARM_VGIC_GRP_ITS_REGS,
	GITS_BASER + i * 8, &s->baser[i], true,
	&error_abort);
	}
	}

	static Property kvm_arm_its_props[] = {
	DEFINE_PROP_LINK("parent-gicv3", GICv3ITSState, gicv3, "kvm-arm-gicv3",
	GICv3State *),
	DEFINE_PROP_END_OF_LIST(),
	};

	static void kvm_arm_its_class_init(ObjectClass klass, void data)
	{
	DeviceClass *dc = DEVICE_CLASS(klass);
	GICv3ITSCommonClass *icc = ARM_GICV3_ITS_COMMON_CLASS(klass);
	KVMARMITSClass *ic = KVM_ARM_ITS_CLASS(klass);

	dc->realize = kvm_arm_its_realize;
	dc->props = kvm_arm_its_props;
	device_class_set_parent_reset(dc, kvm_arm_its_reset, &ic->parent_reset);
	icc->send_msi = kvm_its_send_msi;
	icc->pre_save = kvm_arm_its_pre_save;
	icc->post_load = kvm_arm_its_post_load;
	}

	static const TypeInfo kvm_arm_its_info = {
	.name = TYPE_KVM_ARM_ITS,
	.parent = TYPE_ARM_GICV3_ITS_COMMON,
	.instance_size = sizeof(GICv3ITSState),
	.class_init = kvm_arm_its_class_init,
	.class_size = sizeof(KVMARMITSClass),
	};

	static void kvm_arm_its_register_types(void)
	{
	type_register_static(&kvm_arm_its_info);
	}

	type_init(kvm_arm_its_register_types)