If in-kernel KVM support PSCI-0.2 emulation then we should set
KVM_ARM_VCPU_PSCI_0_2 feature for each guest VCPU and also
provide "arm,psci-0.2","arm,psci" as PSCI compatible string.

This patch updates kvm_cpu__arch_init() and setup_fdt() as
per above.

Signed-off-by: Pranavkumar Sawargaonkar <pranavku...@linaro.org>
Signed-off-by: Anup Patel <anup.pa...@linaro.org>
Reviewed-by: Andre Przywara <andre.przyw...@arm.com>
---
 tools/kvm/arm/fdt.c     |   51 ++++++++++++++++++++++++++++++++++++++++++-----
 tools/kvm/arm/kvm-cpu.c |    5 +++++
 2 files changed, 51 insertions(+), 5 deletions(-)

diff --git a/tools/kvm/arm/fdt.c b/tools/kvm/arm/fdt.c
index 186a718..5626931 100644
--- a/tools/kvm/arm/fdt.c
+++ b/tools/kvm/arm/fdt.c
@@ -13,6 +13,7 @@
 #include <linux/byteorder.h>
 #include <linux/kernel.h>
 #include <linux/sizes.h>
+#include <linux/psci.h>
 
 static char kern_cmdline[COMMAND_LINE_SIZE];
 
@@ -84,6 +85,34 @@ static void generate_irq_prop(void *fdt, u8 irq)
        _FDT(fdt_property(fdt, "interrupts", irq_prop, sizeof(irq_prop)));
 }
 
+struct psci_fns {
+       u32 cpu_suspend;
+       u32 cpu_off;
+       u32 cpu_on;
+       u32 migrate;
+};
+
+static struct psci_fns psci_0_1_fns = {
+       .cpu_suspend = KVM_PSCI_FN_CPU_SUSPEND,
+       .cpu_off = KVM_PSCI_FN_CPU_OFF,
+       .cpu_on = KVM_PSCI_FN_CPU_ON,
+       .migrate = KVM_PSCI_FN_MIGRATE,
+};
+
+static struct psci_fns psci_0_2_aarch32_fns = {
+       .cpu_suspend = PSCI_0_2_FN_CPU_SUSPEND,
+       .cpu_off = PSCI_0_2_FN_CPU_OFF,
+       .cpu_on = PSCI_0_2_FN_CPU_ON,
+       .migrate = PSCI_0_2_FN_MIGRATE,
+};
+
+static struct psci_fns psci_0_2_aarch64_fns = {
+       .cpu_suspend = PSCI_0_2_FN64_CPU_SUSPEND,
+       .cpu_off = PSCI_0_2_FN_CPU_OFF,
+       .cpu_on = PSCI_0_2_FN64_CPU_ON,
+       .migrate = PSCI_0_2_FN64_MIGRATE,
+};
+
 static int setup_fdt(struct kvm *kvm)
 {
        struct device_header *dev_hdr;
@@ -93,6 +122,7 @@ static int setup_fdt(struct kvm *kvm)
                cpu_to_fdt64(kvm->arch.memory_guest_start),
                cpu_to_fdt64(kvm->ram_size),
        };
+       struct psci_fns *fns;
        void *fdt               = staging_fdt;
        void *fdt_dest          = guest_flat_to_host(kvm,
                                                     kvm->arch.dtb_guest_start);
@@ -162,12 +192,23 @@ static int setup_fdt(struct kvm *kvm)
 
        /* PSCI firmware */
        _FDT(fdt_begin_node(fdt, "psci"));
-       _FDT(fdt_property_string(fdt, "compatible", "arm,psci"));
+       if (kvm__supports_extension(kvm, KVM_CAP_ARM_PSCI_0_2)) {
+               const char compatible[] = "arm,psci-0.2\0arm,psci";
+               _FDT(fdt_property(fdt, "compatible",
+                                 compatible, sizeof(compatible)));
+               if (kvm->cfg.arch.aarch32_guest)
+                       fns = &psci_0_2_aarch32_fns;
+               else
+                       fns = &psci_0_2_aarch64_fns;
+       } else {
+               _FDT(fdt_property_string(fdt, "compatible", "arm,psci"));
+               fns = &psci_0_1_fns;
+       }
        _FDT(fdt_property_string(fdt, "method", "hvc"));
-       _FDT(fdt_property_cell(fdt, "cpu_suspend", KVM_PSCI_FN_CPU_SUSPEND));
-       _FDT(fdt_property_cell(fdt, "cpu_off", KVM_PSCI_FN_CPU_OFF));
-       _FDT(fdt_property_cell(fdt, "cpu_on", KVM_PSCI_FN_CPU_ON));
-       _FDT(fdt_property_cell(fdt, "migrate", KVM_PSCI_FN_MIGRATE));
+       _FDT(fdt_property_cell(fdt, "cpu_suspend", fns->cpu_suspend));
+       _FDT(fdt_property_cell(fdt, "cpu_off", fns->cpu_off));
+       _FDT(fdt_property_cell(fdt, "cpu_on", fns->cpu_on));
+       _FDT(fdt_property_cell(fdt, "migrate", fns->migrate));
        _FDT(fdt_end_node(fdt));
 
        /* Finalise. */
diff --git a/tools/kvm/arm/kvm-cpu.c b/tools/kvm/arm/kvm-cpu.c
index f165373..ab08815 100644
--- a/tools/kvm/arm/kvm-cpu.c
+++ b/tools/kvm/arm/kvm-cpu.c
@@ -63,6 +63,11 @@ struct kvm_cpu *kvm_cpu__arch_init(struct kvm *kvm, unsigned 
long cpu_id)
        if (vcpu->kvm_run == MAP_FAILED)
                die("unable to mmap vcpu fd");
 
+       /* Set KVM_ARM_VCPU_PSCI_0_2 if available */
+       if (kvm__supports_extension(kvm, KVM_CAP_ARM_PSCI_0_2)) {
+               vcpu_init.features[0] |= (1UL << KVM_ARM_VCPU_PSCI_0_2);
+       }
+
        /*
         * If the preferred target ioctl is successful then
         * use preferred target else try each and every target type
-- 
1.7.9.5

--
To unsubscribe from this list: send the line "unsubscribe kvm" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to