From: "Yingshiuan Pan" <[email protected]>

Inquire the `capability support` on GenieZone hypervisor.
Example:
`GZVM_CAP_PROTECTED_VM` or `GZVM_CAP_VM_GPA_SIZE`.

Signed-off-by: Yingshiuan Pan <[email protected]>
Signed-off-by: Jerry Wang <[email protected]>
Signed-off-by: kevenny hsieh <[email protected]>
Signed-off-by: Liju Chen <[email protected]>
Signed-off-by: Yi-De Wu <[email protected]>
---
 arch/arm64/geniezone/gzvm_arch_common.h |   2 +
 arch/arm64/geniezone/vm.c               | 122 ++++++++++++++++++++++++
 drivers/virt/geniezone/gzvm_main.c      |  27 ++++++
 drivers/virt/geniezone/gzvm_vm.c        |  21 ++++
 include/linux/gzvm_drv.h                |   6 +-
 include/uapi/linux/gzvm.h               |  31 ++++++
 6 files changed, 208 insertions(+), 1 deletion(-)

diff --git a/arch/arm64/geniezone/gzvm_arch_common.h 
b/arch/arm64/geniezone/gzvm_arch_common.h
index 2f66e496dfae..383af0829f11 100644
--- a/arch/arm64/geniezone/gzvm_arch_common.h
+++ b/arch/arm64/geniezone/gzvm_arch_common.h
@@ -13,6 +13,7 @@ enum {
        GZVM_FUNC_DESTROY_VM = 1,
        GZVM_FUNC_SET_MEMREGION = 4,
        GZVM_FUNC_PROBE = 12,
+       GZVM_FUNC_ENABLE_CAP = 13,
        NR_GZVM_FUNC,
 };
 
@@ -26,6 +27,7 @@ enum {
 #define MT_HVC_GZVM_DESTROY_VM         GZVM_HCALL_ID(GZVM_FUNC_DESTROY_VM)
 #define MT_HVC_GZVM_SET_MEMREGION      GZVM_HCALL_ID(GZVM_FUNC_SET_MEMREGION)
 #define MT_HVC_GZVM_PROBE              GZVM_HCALL_ID(GZVM_FUNC_PROBE)
+#define MT_HVC_GZVM_ENABLE_CAP         GZVM_HCALL_ID(GZVM_FUNC_ENABLE_CAP)
 
 /**
  * gzvm_hypcall_wrapper() - the wrapper for hvc calls
diff --git a/arch/arm64/geniezone/vm.c b/arch/arm64/geniezone/vm.c
index 998d6498ac5e..02f94c86fbf1 100644
--- a/arch/arm64/geniezone/vm.c
+++ b/arch/arm64/geniezone/vm.c
@@ -58,6 +58,40 @@ int gzvm_arch_set_memregion(u16 vm_id, size_t buf_size,
                                    buf_size, region, 0, 0, 0, 0, &res);
 }
 
+static int gzvm_cap_vm_gpa_size(void __user *argp)
+{
+       __u64 value = CONFIG_ARM64_PA_BITS;
+
+       if (copy_to_user(argp, &value, sizeof(__u64)))
+               return -EFAULT;
+
+       return 0;
+}
+
+int gzvm_arch_check_extension(struct gzvm *gzvm, __u64 cap, void __user *argp)
+{
+       int ret;
+
+       switch (cap) {
+       case GZVM_CAP_PROTECTED_VM: {
+               __u64 success = 1;
+
+               if (copy_to_user(argp, &success, sizeof(__u64)))
+                       return -EFAULT;
+
+               return 0;
+       }
+       case GZVM_CAP_VM_GPA_SIZE: {
+               ret = gzvm_cap_vm_gpa_size(argp);
+               return ret;
+       }
+       default:
+               break;
+       }
+
+       return -EOPNOTSUPP;
+}
+
 /**
  * gzvm_arch_create_vm() - create vm
  * @vm_type: VM type. Only supports Linux VM now.
@@ -83,3 +117,91 @@ int gzvm_arch_destroy_vm(u16 vm_id)
        return gzvm_hypcall_wrapper(MT_HVC_GZVM_DESTROY_VM, vm_id, 0, 0, 0, 0,
                                    0, 0, &res);
 }
+
+static int gzvm_vm_arch_enable_cap(struct gzvm *gzvm,
+                                  struct gzvm_enable_cap *cap,
+                                  struct arm_smccc_res *res)
+{
+       return gzvm_hypcall_wrapper(MT_HVC_GZVM_ENABLE_CAP, gzvm->vm_id,
+                                   cap->cap, cap->args[0], cap->args[1],
+                                   cap->args[2], cap->args[3], cap->args[4],
+                                   res);
+}
+
+/**
+ * gzvm_vm_ioctl_get_pvmfw_size() - Get pvmfw size from hypervisor, return
+ *                                 in x1, and return to userspace in args
+ * @gzvm: Pointer to struct gzvm.
+ * @cap: Pointer to struct gzvm_enable_cap.
+ * @argp: Pointer to struct gzvm_enable_cap in user space.
+ *
+ * Return:
+ * * 0                 - Succeed
+ * * -EINVAL           - Hypervisor return invalid results
+ * * -EFAULT           - Fail to copy back to userspace buffer
+ */
+static int gzvm_vm_ioctl_get_pvmfw_size(struct gzvm *gzvm,
+                                       struct gzvm_enable_cap *cap,
+                                       void __user *argp)
+{
+       struct arm_smccc_res res = {0};
+
+       if (gzvm_vm_arch_enable_cap(gzvm, cap, &res) != 0)
+               return -EINVAL;
+
+       cap->args[1] = res.a1;
+       if (copy_to_user(argp, cap, sizeof(*cap)))
+               return -EFAULT;
+
+       return 0;
+}
+
+/**
+ * gzvm_vm_ioctl_cap_pvm() - Proceed GZVM_CAP_PROTECTED_VM's subcommands
+ * @gzvm: Pointer to struct gzvm.
+ * @cap: Pointer to struct gzvm_enable_cap.
+ * @argp: Pointer to struct gzvm_enable_cap in user space.
+ *
+ * Return:
+ * * 0                 - Succeed
+ * * -EINVAL           - Invalid subcommand or arguments
+ */
+static int gzvm_vm_ioctl_cap_pvm(struct gzvm *gzvm,
+                                struct gzvm_enable_cap *cap,
+                                void __user *argp)
+{
+       struct arm_smccc_res res = {0};
+       int ret;
+
+       switch (cap->args[0]) {
+       case GZVM_CAP_PVM_SET_PVMFW_GPA:
+               fallthrough;
+       case GZVM_CAP_PVM_SET_PROTECTED_VM:
+               ret = gzvm_vm_arch_enable_cap(gzvm, cap, &res);
+               return ret;
+       case GZVM_CAP_PVM_GET_PVMFW_SIZE:
+               ret = gzvm_vm_ioctl_get_pvmfw_size(gzvm, cap, argp);
+               return ret;
+       default:
+               break;
+       }
+
+       return -EINVAL;
+}
+
+int gzvm_vm_ioctl_arch_enable_cap(struct gzvm *gzvm,
+                                 struct gzvm_enable_cap *cap,
+                                 void __user *argp)
+{
+       int ret;
+
+       switch (cap->cap) {
+       case GZVM_CAP_PROTECTED_VM:
+               ret = gzvm_vm_ioctl_cap_pvm(gzvm, cap, argp);
+               return ret;
+       default:
+               break;
+       }
+
+       return -EINVAL;
+}
diff --git a/drivers/virt/geniezone/gzvm_main.c 
b/drivers/virt/geniezone/gzvm_main.c
index 4e7d60067c55..30f6c3975026 100644
--- a/drivers/virt/geniezone/gzvm_main.c
+++ b/drivers/virt/geniezone/gzvm_main.c
@@ -41,6 +41,28 @@ int gzvm_err_to_errno(unsigned long err)
        return -EINVAL;
 }
 
+/**
+ * gzvm_dev_ioctl_check_extension() - Check if given capability is support
+ *                                   or not
+ *
+ * @gzvm: Pointer to struct gzvm
+ * @args: Pointer in u64 from userspace
+ *
+ * Return:
+ * * 0                 - Supported, no error
+ * * -EOPNOTSUPP       - Unsupported
+ * * -EFAULT           - Failed to get data from userspace
+ */
+long gzvm_dev_ioctl_check_extension(struct gzvm *gzvm, unsigned long args)
+{
+       __u64 cap;
+       void __user *argp = (void __user *)args;
+
+       if (copy_from_user(&cap, argp, sizeof(uint64_t)))
+               return -EFAULT;
+       return gzvm_arch_check_extension(gzvm, cap, argp);
+}
+
 static long gzvm_dev_ioctl(struct file *filp, unsigned int cmd,
                           unsigned long user_args)
 {
@@ -50,6 +72,11 @@ static long gzvm_dev_ioctl(struct file *filp, unsigned int 
cmd,
        case GZVM_CREATE_VM:
                ret = gzvm_dev_ioctl_create_vm(user_args);
                return ret;
+       case GZVM_CHECK_EXTENSION:
+               if (!user_args)
+                       return -EINVAL;
+               ret = gzvm_dev_ioctl_check_extension(NULL, user_args);
+               return ret;
        default:
                break;
        }
diff --git a/drivers/virt/geniezone/gzvm_vm.c b/drivers/virt/geniezone/gzvm_vm.c
index 326cc9e93d92..ba6bfb7ee6e5 100644
--- a/drivers/virt/geniezone/gzvm_vm.c
+++ b/drivers/virt/geniezone/gzvm_vm.c
@@ -98,6 +98,13 @@ gzvm_vm_ioctl_set_memory_region(struct gzvm *gzvm,
        return register_memslot_addr_range(gzvm, memslot);
 }
 
+static int gzvm_vm_ioctl_enable_cap(struct gzvm *gzvm,
+                                   struct gzvm_enable_cap *cap,
+                                   void __user *argp)
+{
+       return gzvm_vm_ioctl_arch_enable_cap(gzvm, cap, argp);
+}
+
 /* gzvm_vm_ioctl() - Ioctl handler of VM FD */
 static long gzvm_vm_ioctl(struct file *filp, unsigned int ioctl,
                          unsigned long arg)
@@ -107,6 +114,10 @@ static long gzvm_vm_ioctl(struct file *filp, unsigned int 
ioctl,
        struct gzvm *gzvm = filp->private_data;
 
        switch (ioctl) {
+       case GZVM_CHECK_EXTENSION: {
+               ret = gzvm_dev_ioctl_check_extension(gzvm, arg);
+               break;
+       }
        case GZVM_SET_USER_MEMORY_REGION: {
                struct gzvm_userspace_memory_region userspace_mem;
 
@@ -117,6 +128,16 @@ static long gzvm_vm_ioctl(struct file *filp, unsigned int 
ioctl,
                ret = gzvm_vm_ioctl_set_memory_region(gzvm, &userspace_mem);
                break;
        }
+       case GZVM_ENABLE_CAP: {
+               struct gzvm_enable_cap cap;
+
+               if (copy_from_user(&cap, argp, sizeof(cap))) {
+                       ret = -EFAULT;
+                       goto out;
+               }
+               ret = gzvm_vm_ioctl_enable_cap(gzvm, &cap, argp);
+               break;
+       }
        default:
                ret = -ENOTTY;
        }
diff --git a/include/linux/gzvm_drv.h b/include/linux/gzvm_drv.h
index aa1eaf4d43b4..a7d6df29b34e 100644
--- a/include/linux/gzvm_drv.h
+++ b/include/linux/gzvm_drv.h
@@ -73,6 +73,7 @@ struct gzvm {
        u16 vm_id;
 };
 
+long gzvm_dev_ioctl_check_extension(struct gzvm *gzvm, unsigned long args);
 int gzvm_dev_ioctl_create_vm(unsigned long vm_type);
 
 int gzvm_err_to_errno(unsigned long err);
@@ -83,9 +84,12 @@ void gzvm_destroy_all_vms(void);
 int gzvm_arch_probe(void);
 int gzvm_arch_set_memregion(u16 vm_id, size_t buf_size,
                            phys_addr_t region);
+int gzvm_arch_check_extension(struct gzvm *gzvm, __u64 cap, void __user *argp);
 int gzvm_arch_create_vm(unsigned long vm_type);
 int gzvm_arch_destroy_vm(u16 vm_id);
-
+int gzvm_vm_ioctl_arch_enable_cap(struct gzvm *gzvm,
+                                 struct gzvm_enable_cap *cap,
+                                 void __user *argp);
 u64 gzvm_hva_to_pa_arch(u64 hva);
 u64 hva_to_pa_fast(u64 hva);
 u64 hva_to_pa_slow(u64 hva);
diff --git a/include/uapi/linux/gzvm.h b/include/uapi/linux/gzvm.h
index d2d5e6cfc2c9..77a58ee085df 100644
--- a/include/uapi/linux/gzvm.h
+++ b/include/uapi/linux/gzvm.h
@@ -16,12 +16,30 @@
 #include <linux/types.h>
 #include <linux/ioctl.h>
 
+#define GZVM_CAP_VM_GPA_SIZE   0xa5
+#define GZVM_CAP_PROTECTED_VM  0xffbadab1
+
+/* sub-commands put in args[0] for GZVM_CAP_PROTECTED_VM */
+#define GZVM_CAP_PVM_SET_PVMFW_GPA             0
+#define GZVM_CAP_PVM_GET_PVMFW_SIZE            1
+/* GZVM_CAP_PVM_SET_PROTECTED_VM only sets protected but not load pvmfw */
+#define GZVM_CAP_PVM_SET_PROTECTED_VM          2
+
 /* GZVM ioctls */
 #define GZVM_IOC_MAGIC                 0x92    /* gz */
 
 /* ioctls for /dev/gzvm fds */
 #define GZVM_CREATE_VM             _IO(GZVM_IOC_MAGIC,   0x01) /* Returns a 
Geniezone VM fd */
 
+/*
+ * Check if the given capability is supported or not.
+ * The argument is capability. Ex. GZVM_CAP_PROTECTED_VM or 
GZVM_CAP_VM_GPA_SIZE
+ * return is 0 (supported, no error)
+ * return is -EOPNOTSUPP (unsupported)
+ * return is -EFAULT (failed to get the argument from userspace)
+ */
+#define GZVM_CHECK_EXTENSION       _IO(GZVM_IOC_MAGIC,   0x03)
+
 /* ioctls for VM fds */
 /* for GZVM_SET_MEMORY_REGION */
 struct gzvm_memory_region {
@@ -48,4 +66,17 @@ struct gzvm_userspace_memory_region {
 #define GZVM_SET_USER_MEMORY_REGION _IOW(GZVM_IOC_MAGIC, 0x46, \
                                         struct gzvm_userspace_memory_region)
 
+/**
+ * struct gzvm_enable_cap: The `capability support` on GenieZone hypervisor
+ * @cap: `GZVM_CAP_ARM_PROTECTED_VM` or `GZVM_CAP_ARM_VM_IPA_SIZE`
+ * @args: x3-x7 registers can be used for additional args
+ */
+struct gzvm_enable_cap {
+       __u64 cap;
+       __u64 args[5];
+};
+
+#define GZVM_ENABLE_CAP            _IOW(GZVM_IOC_MAGIC,  0xa3, \
+                                       struct gzvm_enable_cap)
+
 #endif /* __GZVM_H__ */
-- 
2.18.0


Reply via email to