Extend the selftest tool to add coverage of testing IOPF handling. This
would include the following tests:

- Allocating and destroying an IOPF-capable HWPT.
- Attaching/detaching/replacing an IOPF-capable HWPT on a device.
- Triggering an IOPF on the mock device.
- Retrieving and responding to the IOPF through the IOPF FD

Signed-off-by: Lu Baolu <[email protected]>
---
 tools/testing/selftests/iommu/iommufd_utils.h | 66 +++++++++++++++++--
 tools/testing/selftests/iommu/iommufd.c       | 24 +++++--
 .../selftests/iommu/iommufd_fail_nth.c        |  2 +-
 3 files changed, 81 insertions(+), 11 deletions(-)

diff --git a/tools/testing/selftests/iommu/iommufd_utils.h 
b/tools/testing/selftests/iommu/iommufd_utils.h
index b75f168fca46..df22c02af997 100644
--- a/tools/testing/selftests/iommu/iommufd_utils.h
+++ b/tools/testing/selftests/iommu/iommufd_utils.h
@@ -103,8 +103,8 @@ static int _test_cmd_mock_domain_replace(int fd, __u32 
stdev_id, __u32 pt_id,
                                                           pt_id, NULL))
 
 static int _test_cmd_hwpt_alloc(int fd, __u32 device_id, __u32 pt_id,
-                               __u32 flags, __u32 *hwpt_id, __u32 hwpt_type,
-                               void *data, size_t data_len)
+                               __u32 flags, __u32 *hwpt_id, __u32 *fault_fd,
+                               __u32 hwpt_type, void *data, size_t data_len)
 {
        struct iommu_hwpt_alloc cmd = {
                .size = sizeof(cmd),
@@ -122,28 +122,39 @@ static int _test_cmd_hwpt_alloc(int fd, __u32 device_id, 
__u32 pt_id,
                return ret;
        if (hwpt_id)
                *hwpt_id = cmd.out_hwpt_id;
+       if (fault_fd)
+               *fault_fd = cmd.out_fault_fd;
+
        return 0;
 }
 
 #define test_cmd_hwpt_alloc(device_id, pt_id, flags, hwpt_id)                \
        ASSERT_EQ(0, _test_cmd_hwpt_alloc(self->fd, device_id, pt_id, flags, \
-                                         hwpt_id, IOMMU_HWPT_TYPE_DEFAULT,  \
+                                         hwpt_id, NULL,                     \
+                                         IOMMU_HWPT_TYPE_DEFAULT,           \
                                          NULL, 0))
 #define test_err_hwpt_alloc(_errno, device_id, pt_id, flags, hwpt_id)         \
        EXPECT_ERRNO(_errno, _test_cmd_hwpt_alloc(self->fd, device_id, pt_id, \
-                                                 flags, hwpt_id,             \
+                                                 flags, hwpt_id, NULL,       \
                                                  IOMMU_HWPT_TYPE_DEFAULT,    \
                                                  NULL, 0))
 
 #define test_cmd_hwpt_alloc_nested(device_id, pt_id, flags, hwpt_id,          \
                                   hwpt_type, data, data_len)                 \
        ASSERT_EQ(0, _test_cmd_hwpt_alloc(self->fd, device_id, pt_id, flags,  \
-                                         hwpt_id, hwpt_type, data, data_len))
+                                         hwpt_id, NULL, hwpt_type, data,     \
+                                         data_len))
 #define test_err_hwpt_alloc_nested(_errno, device_id, pt_id, flags, hwpt_id,  \
                                   hwpt_type, data, data_len)                 \
        EXPECT_ERRNO(_errno,                                                  \
                     _test_cmd_hwpt_alloc(self->fd, device_id, pt_id, flags,  \
-                                         hwpt_id, hwpt_type, data, data_len))
+                                         hwpt_id, NULL, hwpt_type, data,     \
+                                         data_len))
+#define test_cmd_hwpt_alloc_nested_iopf(device_id, pt_id, flags, hwpt_id,     \
+                                       fault_fd, hwpt_type, data, data_len)  \
+       ASSERT_EQ(0, _test_cmd_hwpt_alloc(self->fd, device_id, pt_id, flags,  \
+                                         hwpt_id, fault_fd, hwpt_type, data, \
+                                         data_len))
 
 #define test_cmd_hwpt_check_iotlb(hwpt_id, iotlb_id, expected)                 
\
        ({                                                                     \
@@ -551,3 +562,46 @@ static int _test_cmd_unset_dev_data(int fd, __u32 
device_id)
 #define test_err_unset_dev_data(_errno, device_id) \
        EXPECT_ERRNO(_errno,                       \
                     _test_cmd_unset_dev_data(self->fd, device_id))
+
+static int _test_cmd_trigger_iopf(int fd, __u32 device_id, __u32 fault_fd, 
__u32 hwpt_id)
+{
+       struct iommu_test_cmd trigger_iopf_cmd = {
+               .size = sizeof(trigger_iopf_cmd),
+               .op = IOMMU_TEST_OP_TRIGGER_IOPF,
+               .trigger_iopf = {
+                       .dev_id = device_id,
+                       .pasid = 0x1,
+                       .grpid = 0x2,
+                       .perm = IOMMU_PGFAULT_PERM_READ | 
IOMMU_PGFAULT_PERM_WRITE,
+                       .addr = 0xdeadbeaf,
+               },
+       };
+       struct iommu_hwpt_page_response response = {
+               .size = sizeof(struct iommu_hwpt_page_response),
+               .hwpt_id = hwpt_id,
+               .dev_id = device_id,
+               .pasid = 0x1,
+               .grpid = 0x2,
+               .code = 0,
+       };
+       struct iommu_hwpt_pgfault fault = {};
+       ssize_t bytes;
+       int ret;
+
+       ret = ioctl(fd, _IOMMU_TEST_CMD(IOMMU_TEST_OP_TRIGGER_IOPF), 
&trigger_iopf_cmd);
+       if (ret)
+               return ret;
+
+       bytes = read(fault_fd, &fault, sizeof(fault));
+       if (bytes < 0)
+               return bytes;
+
+       bytes = write(fault_fd, &response, sizeof(response));
+       if (bytes < 0)
+               return bytes;
+
+       return 0;
+}
+
+#define test_cmd_trigger_iopf(device_id, fault_fd, hwpt_id) \
+       ASSERT_EQ(0, _test_cmd_trigger_iopf(self->fd, device_id, fault_fd, 
hwpt_id))
diff --git a/tools/testing/selftests/iommu/iommufd.c 
b/tools/testing/selftests/iommu/iommufd.c
index 7cf06a4635d8..b30b82a72785 100644
--- a/tools/testing/selftests/iommu/iommufd.c
+++ b/tools/testing/selftests/iommu/iommufd.c
@@ -275,11 +275,12 @@ TEST_F(iommufd_ioas, alloc_hwpt_nested)
                .iotlb =  IOMMU_TEST_IOTLB_DEFAULT,
        };
        struct iommu_hwpt_invalidate_selftest inv_reqs[2] = {0};
-       uint32_t nested_hwpt_id[2] = {};
+       uint32_t nested_hwpt_id[3] = {};
        uint32_t num_inv, driver_error;
        uint32_t parent_hwpt_id = 0;
        uint32_t parent_hwpt_id_not_work = 0;
        uint32_t test_hwpt_id = 0;
+       uint32_t fault_fd;
 
        if (self->device_id) {
                /* Negative tests */
@@ -323,7 +324,7 @@ TEST_F(iommufd_ioas, alloc_hwpt_nested)
                                           IOMMU_HWPT_TYPE_SELFTEST,
                                           &data, sizeof(data));
 
-               /* Allocate two nested hwpts sharing one common parent hwpt */
+               /* Allocate nested hwpts sharing one common parent hwpt */
                test_cmd_hwpt_alloc_nested(self->device_id, parent_hwpt_id,
                                           0, &nested_hwpt_id[0],
                                           IOMMU_HWPT_TYPE_SELFTEST,
@@ -332,6 +333,11 @@ TEST_F(iommufd_ioas, alloc_hwpt_nested)
                                           0, &nested_hwpt_id[1],
                                           IOMMU_HWPT_TYPE_SELFTEST,
                                           &data, sizeof(data));
+               test_cmd_hwpt_alloc_nested_iopf(self->device_id, parent_hwpt_id,
+                                               IOMMU_HWPT_ALLOC_IOPF_CAPABLE,
+                                               &nested_hwpt_id[2], &fault_fd,
+                                               IOMMU_HWPT_TYPE_SELFTEST,
+                                               &data, sizeof(data));
                test_cmd_hwpt_check_iotlb_all(nested_hwpt_id[0],
                                              IOMMU_TEST_IOTLB_DEFAULT);
                test_cmd_hwpt_check_iotlb_all(nested_hwpt_id[1],
@@ -418,10 +424,20 @@ TEST_F(iommufd_ioas, alloc_hwpt_nested)
                             _test_ioctl_destroy(self->fd, nested_hwpt_id[1]));
                test_ioctl_destroy(nested_hwpt_id[0]);
 
-               /* Detach from nested_hwpt_id[1] and destroy it */
-               test_cmd_mock_domain_replace(self->stdev_id, parent_hwpt_id);
+               /* Switch from nested_hwpt_id[1] to nested_hwpt_id[2] */
+               test_cmd_mock_domain_replace(self->stdev_id,
+                                            nested_hwpt_id[2]);
+               EXPECT_ERRNO(EBUSY,
+                            _test_ioctl_destroy(self->fd, nested_hwpt_id[2]));
                test_ioctl_destroy(nested_hwpt_id[1]);
 
+               /* Trigger an IOPF on the device */
+               test_cmd_trigger_iopf(self->device_id, fault_fd, 
nested_hwpt_id[2]);
+
+               /* Detach from nested_hwpt_id[2] and destroy it */
+               test_cmd_mock_domain_replace(self->stdev_id, parent_hwpt_id);
+               test_ioctl_destroy(nested_hwpt_id[2]);
+
                /* Detach from the parent hw_pagetable and destroy it */
                test_cmd_mock_domain_replace(self->stdev_id, self->ioas_id);
                test_ioctl_destroy(parent_hwpt_id);
diff --git a/tools/testing/selftests/iommu/iommufd_fail_nth.c 
b/tools/testing/selftests/iommu/iommufd_fail_nth.c
index d3f47f262c04..2b7b582c17c4 100644
--- a/tools/testing/selftests/iommu/iommufd_fail_nth.c
+++ b/tools/testing/selftests/iommu/iommufd_fail_nth.c
@@ -615,7 +615,7 @@ TEST_FAIL_NTH(basic_fail_nth, device)
        if (_test_cmd_get_hw_info(self->fd, idev_id, &info, sizeof(info)))
                return -1;
 
-       if (_test_cmd_hwpt_alloc(self->fd, idev_id, ioas_id, 0, &hwpt_id,
+       if (_test_cmd_hwpt_alloc(self->fd, idev_id, ioas_id, 0, &hwpt_id, NULL,
                                 IOMMU_HWPT_TYPE_DEFAULT, 0, 0))
                return -1;
 
-- 
2.34.1

Reply via email to