This adds 4 test ops for pasid attach/replace/detach testing. There are
ops to attach/detach pasid, and also op to check the attached domain of
a pasid.

Signed-off-by: Yi Liu <yi.l....@intel.com>
---
 drivers/iommu/iommufd/iommufd_test.h | 24 +++++++
 drivers/iommu/iommufd/selftest.c     | 98 ++++++++++++++++++++++++++++
 2 files changed, 122 insertions(+)

diff --git a/drivers/iommu/iommufd/iommufd_test.h 
b/drivers/iommu/iommufd/iommufd_test.h
index 65a363f5e81e..e2ab61251ef9 100644
--- a/drivers/iommu/iommufd/iommufd_test.h
+++ b/drivers/iommu/iommufd/iommufd_test.h
@@ -21,6 +21,10 @@ enum {
        IOMMU_TEST_OP_ACCESS_REPLACE_IOAS,
        IOMMU_TEST_OP_MD_CHECK_IOTLB,
        IOMMU_TEST_OP_DEV_CHECK_DATA,
+       IOMMU_TEST_OP_PASID_ATTACH,
+       IOMMU_TEST_OP_PASID_REPLACE,
+       IOMMU_TEST_OP_PASID_DETACH,
+       IOMMU_TEST_OP_PASID_CHECK_DOMAIN,
 };
 
 enum {
@@ -109,6 +113,26 @@ struct iommu_test_cmd {
                struct {
                        __u32 val;
                } check_dev_data;
+               struct {
+                       __u32 pasid;
+                       __u32 pt_id;
+                       /* @id is stdev_id for IOMMU_TEST_OP_PASID_ATTACH */
+               } pasid_attach;
+               struct {
+                       __u32 pasid;
+                       __u32 pt_id;
+                       /* @id is stdev_id for IOMMU_TEST_OP_PASID_ATTACH */
+               } pasid_replace;
+               struct {
+                       __u32 pasid;
+                       /* @id is stdev_id for IOMMU_TEST_OP_PASID_DETACH */
+               } pasid_detach;
+               struct {
+                       __u32 pasid;
+                       __u32 hwpt_id;
+                       __u64 out_result_ptr;
+                       /* @id is stdev_id for IOMMU_TEST_OP_HWPT_GET_DOMAIN */
+               } pasid_check;
        };
        __u32 last;
 };
diff --git a/drivers/iommu/iommufd/selftest.c b/drivers/iommu/iommufd/selftest.c
index 1f2ce4ffee4e..bfc81615e9f9 100644
--- a/drivers/iommu/iommufd/selftest.c
+++ b/drivers/iommu/iommufd/selftest.c
@@ -1238,6 +1238,96 @@ static_assert((unsigned int)MOCK_ACCESS_RW_WRITE == 
IOMMUFD_ACCESS_RW_WRITE);
 static_assert((unsigned int)MOCK_ACCESS_RW_SLOW_PATH ==
              __IOMMUFD_ACCESS_RW_SLOW_PATH);
 
+static int iommufd_test_pasid_attach(struct iommufd_ucmd *ucmd,
+                                    struct iommu_test_cmd *cmd)
+{
+       struct selftest_obj *sobj;
+       int rc;
+
+       sobj = iommufd_test_get_self_test_device(ucmd->ictx, cmd->id);
+       if (IS_ERR(sobj))
+               return PTR_ERR(sobj);
+
+       rc = iommufd_device_pasid_attach(sobj->idev.idev,
+                                        cmd->pasid_attach.pasid,
+                                        &cmd->pasid_attach.pt_id);
+       iommufd_put_object(&sobj->obj);
+       return rc;
+}
+
+static int iommufd_test_pasid_replace(struct iommufd_ucmd *ucmd,
+                                     struct iommu_test_cmd *cmd)
+{
+       struct selftest_obj *sobj;
+       int rc;
+
+       sobj = iommufd_test_get_self_test_device(ucmd->ictx, cmd->id);
+       if (IS_ERR(sobj))
+               return PTR_ERR(sobj);
+
+       rc = iommufd_device_pasid_replace(sobj->idev.idev,
+                                         cmd->pasid_attach.pasid,
+                                         &cmd->pasid_attach.pt_id);
+       iommufd_put_object(&sobj->obj);
+       return rc;
+}
+
+static int iommufd_test_pasid_detach(struct iommufd_ucmd *ucmd,
+                                    struct iommu_test_cmd *cmd)
+{
+       struct selftest_obj *sobj;
+
+       sobj = iommufd_test_get_self_test_device(ucmd->ictx, cmd->id);
+       if (IS_ERR(sobj))
+               return PTR_ERR(sobj);
+
+       iommufd_device_pasid_detach(sobj->idev.idev,
+                                   cmd->pasid_detach.pasid);
+       iommufd_put_object(&sobj->obj);
+       return 0;
+}
+
+static int iommufd_test_pasid_check_domain(struct iommufd_ucmd *ucmd,
+                                          struct iommu_test_cmd *cmd)
+{
+       struct iommu_domain *attached_domain, *expect_domain = NULL;
+       struct iommufd_hw_pagetable *hwpt = NULL;
+       struct selftest_obj *sobj;
+       struct mock_dev *mdev;
+       bool result;
+       int rc = 0;
+
+       sobj = iommufd_test_get_self_test_device(ucmd->ictx, cmd->id);
+       if (IS_ERR(sobj))
+               return PTR_ERR(sobj);
+
+       mdev = sobj->idev.mock_dev;
+
+       attached_domain = iommu_get_domain_for_dev_pasid(&mdev->dev,
+                                                        
cmd->pasid_check.pasid, 0);
+       if (IS_ERR(attached_domain))
+               attached_domain = NULL;
+
+       if (cmd->pasid_check.hwpt_id) {
+               hwpt = iommufd_get_hwpt(ucmd, cmd->pasid_check.hwpt_id);
+               if (IS_ERR(hwpt)) {
+                       rc = PTR_ERR(hwpt);
+                       goto out_put_dev;
+               }
+               expect_domain = hwpt->domain;
+       }
+
+       result = (attached_domain == expect_domain) ? 1 : 0;
+       if (copy_to_user(u64_to_user_ptr(cmd->pasid_check.out_result_ptr),
+                        &result, sizeof(result)))
+               rc = -EFAULT;
+       if (hwpt)
+               iommufd_put_object(&hwpt->obj);
+out_put_dev:
+       iommufd_put_object(&sobj->obj);
+       return rc;
+}
+
 void iommufd_selftest_destroy(struct iommufd_object *obj)
 {
        struct selftest_obj *sobj = container_of(obj, struct selftest_obj, obj);
@@ -1309,6 +1399,14 @@ int iommufd_test(struct iommufd_ucmd *ucmd)
                        return -EINVAL;
                iommufd_test_memory_limit = cmd->memory_limit.limit;
                return 0;
+       case IOMMU_TEST_OP_PASID_ATTACH:
+               return iommufd_test_pasid_attach(ucmd, cmd);
+       case IOMMU_TEST_OP_PASID_REPLACE:
+               return iommufd_test_pasid_replace(ucmd, cmd);
+       case IOMMU_TEST_OP_PASID_DETACH:
+               return iommufd_test_pasid_detach(ucmd, cmd);
+       case IOMMU_TEST_OP_PASID_CHECK_DOMAIN:
+               return iommufd_test_pasid_check_domain(ucmd, cmd);
        default:
                return -EOPNOTSUPP;
        }
-- 
2.34.1

Reply via email to