Since enabling IOPF for devices may lead to a slow ramp up of performance,
we add an ioctl VFIO_IOMMU_ENABLE_IOPF to make it configurable. And the
IOPF enabling of a VFIO device includes setting IOMMU_DEV_FEAT_IOPF and
registering the VFIO IOPF handler.

Note that VFIO_IOMMU_DISABLE_IOPF is not supported since there may be
inflight page faults when disabling.

Signed-off-by: Shenming Lu <lushenm...@huawei.com>
---
 drivers/vfio/vfio_iommu_type1.c | 223 +++++++++++++++++++++++++++++++-
 include/uapi/linux/vfio.h       |   6 +
 2 files changed, 226 insertions(+), 3 deletions(-)

diff --git a/drivers/vfio/vfio_iommu_type1.c b/drivers/vfio/vfio_iommu_type1.c
index 01e296c6dc9e..7df5711e743a 100644
--- a/drivers/vfio/vfio_iommu_type1.c
+++ b/drivers/vfio/vfio_iommu_type1.c
@@ -71,6 +71,7 @@ struct vfio_iommu {
        struct rb_root          dma_list;
        struct blocking_notifier_head notifier;
        struct mmu_notifier     mn;
+       struct mm_struct        *mm;
        unsigned int            dma_avail;
        unsigned int            vaddr_invalid_count;
        uint64_t                pgsize_bitmap;
@@ -81,6 +82,7 @@ struct vfio_iommu {
        bool                    dirty_page_tracking;
        bool                    pinned_page_dirty_scope;
        bool                    container_open;
+       bool                    iopf_enabled;
 };
 
 struct vfio_domain {
@@ -461,6 +463,38 @@ vfio_find_iopf_group(struct iommu_group *iommu_group)
        return node ? iopf_group : NULL;
 }
 
+static void vfio_link_iopf_group(struct vfio_iopf_group *new)
+{
+       struct rb_node **link, *parent = NULL;
+       struct vfio_iopf_group *iopf_group;
+
+       mutex_lock(&iopf_group_list_lock);
+
+       link = &iopf_group_list.rb_node;
+
+       while (*link) {
+               parent = *link;
+               iopf_group = rb_entry(parent, struct vfio_iopf_group, node);
+
+               if (new->iommu_group < iopf_group->iommu_group)
+                       link = &(*link)->rb_left;
+               else
+                       link = &(*link)->rb_right;
+       }
+
+       rb_link_node(&new->node, parent, link);
+       rb_insert_color(&new->node, &iopf_group_list);
+
+       mutex_unlock(&iopf_group_list_lock);
+}
+
+static void vfio_unlink_iopf_group(struct vfio_iopf_group *old)
+{
+       mutex_lock(&iopf_group_list_lock);
+       rb_erase(&old->node, &iopf_group_list);
+       mutex_unlock(&iopf_group_list_lock);
+}
+
 static int vfio_lock_acct(struct vfio_dma *dma, long npage, bool async)
 {
        struct mm_struct *mm;
@@ -2363,6 +2397,68 @@ static void vfio_iommu_iova_insert_copy(struct 
vfio_iommu *iommu,
        list_splice_tail(iova_copy, iova);
 }
 
+static int vfio_dev_domian_nested(struct device *dev, int *nested)
+{
+       struct iommu_domain *domain;
+
+       domain = iommu_get_domain_for_dev(dev);
+       if (!domain)
+               return -ENODEV;
+
+       return iommu_domain_get_attr(domain, DOMAIN_ATTR_NESTING, nested);
+}
+
+static int vfio_iommu_type1_dma_map_iopf(struct iommu_fault *fault, void 
*data);
+
+static int dev_enable_iopf(struct device *dev, void *data)
+{
+       int *enabled_dev_cnt = data;
+       int nested;
+       u32 flags;
+       int ret;
+
+       ret = iommu_dev_enable_feature(dev, IOMMU_DEV_FEAT_IOPF);
+       if (ret)
+               return ret;
+
+       ret = vfio_dev_domian_nested(dev, &nested);
+       if (ret)
+               goto out_disable;
+
+       if (nested)
+               flags = FAULT_REPORT_NESTED_L2;
+       else
+               flags = FAULT_REPORT_FLAT;
+
+       ret = iommu_register_device_fault_handler(dev,
+                               vfio_iommu_type1_dma_map_iopf, flags, dev);
+       if (ret)
+               goto out_disable;
+
+       (*enabled_dev_cnt)++;
+       return 0;
+
+out_disable:
+       iommu_dev_disable_feature(dev, IOMMU_DEV_FEAT_IOPF);
+       return ret;
+}
+
+static int dev_disable_iopf(struct device *dev, void *data)
+{
+       int *enabled_dev_cnt = data;
+
+       if (enabled_dev_cnt && *enabled_dev_cnt <= 0)
+               return -1;
+
+       WARN_ON(iommu_unregister_device_fault_handler(dev));
+       WARN_ON(iommu_dev_disable_feature(dev, IOMMU_DEV_FEAT_IOPF));
+
+       if (enabled_dev_cnt)
+               (*enabled_dev_cnt)--;
+
+       return 0;
+}
+
 static int vfio_iommu_type1_attach_group(void *iommu_data,
                                         struct iommu_group *iommu_group)
 {
@@ -2376,6 +2472,8 @@ static int vfio_iommu_type1_attach_group(void *iommu_data,
        struct iommu_domain_geometry geo;
        LIST_HEAD(iova_copy);
        LIST_HEAD(group_resv_regions);
+       int iopf_enabled_dev_cnt = 0;
+       struct vfio_iopf_group *iopf_group = NULL;
 
        mutex_lock(&iommu->lock);
 
@@ -2453,6 +2551,24 @@ static int vfio_iommu_type1_attach_group(void 
*iommu_data,
        if (ret)
                goto out_domain;
 
+       if (iommu->iopf_enabled) {
+               ret = iommu_group_for_each_dev(iommu_group, 
&iopf_enabled_dev_cnt,
+                                              dev_enable_iopf);
+               if (ret)
+                       goto out_detach;
+
+               iopf_group = kzalloc(sizeof(*iopf_group), GFP_KERNEL);
+               if (!iopf_group) {
+                       ret = -ENOMEM;
+                       goto out_detach;
+               }
+
+               iopf_group->iommu_group = iommu_group;
+               iopf_group->iommu = iommu;
+
+               vfio_link_iopf_group(iopf_group);
+       }
+
        /* Get aperture info */
        iommu_domain_get_attr(domain->domain, DOMAIN_ATTR_GEOMETRY, &geo);
 
@@ -2534,9 +2650,11 @@ static int vfio_iommu_type1_attach_group(void 
*iommu_data,
        vfio_test_domain_fgsp(domain);
 
        /* replay mappings on new domains */
-       ret = vfio_iommu_replay(iommu, domain);
-       if (ret)
-               goto out_detach;
+       if (!iommu->iopf_enabled) {
+               ret = vfio_iommu_replay(iommu, domain);
+               if (ret)
+                       goto out_detach;
+       }
 
        if (resv_msi) {
                ret = iommu_get_msi_cookie(domain->domain, resv_msi_base);
@@ -2567,6 +2685,15 @@ static int vfio_iommu_type1_attach_group(void 
*iommu_data,
        iommu_domain_free(domain->domain);
        vfio_iommu_iova_free(&iova_copy);
        vfio_iommu_resv_free(&group_resv_regions);
+       if (iommu->iopf_enabled) {
+               if (iopf_group) {
+                       vfio_unlink_iopf_group(iopf_group);
+                       kfree(iopf_group);
+               }
+
+               iommu_group_for_each_dev(iommu_group, &iopf_enabled_dev_cnt,
+                                        dev_disable_iopf);
+       }
 out_free:
        kfree(domain);
        kfree(group);
@@ -2728,6 +2855,19 @@ static void vfio_iommu_type1_detach_group(void 
*iommu_data,
                if (!group)
                        continue;
 
+               if (iommu->iopf_enabled) {
+                       struct vfio_iopf_group *iopf_group;
+
+                       iopf_group = vfio_find_iopf_group(iommu_group);
+                       if (!WARN_ON(!iopf_group)) {
+                               vfio_unlink_iopf_group(iopf_group);
+                               kfree(iopf_group);
+                       }
+
+                       iommu_group_for_each_dev(iommu_group, NULL,
+                                                dev_disable_iopf);
+               }
+
                vfio_iommu_detach_group(domain, group);
                update_dirty_scope = !group->pinned_page_dirty_scope;
                list_del(&group->next);
@@ -2846,6 +2986,11 @@ static void vfio_iommu_type1_release(void *iommu_data)
 
        vfio_iommu_iova_free(&iommu->iova_list);
 
+       if (iommu->iopf_enabled) {
+               mmu_notifier_unregister(&iommu->mn, iommu->mm);
+               mmdrop(iommu->mm);
+       }
+
        kfree(iommu);
 }
 
@@ -3441,6 +3586,76 @@ static const struct mmu_notifier_ops 
vfio_iommu_type1_mn_ops = {
        .invalidate_range       = mn_invalidate_range,
 };
 
+static int vfio_iommu_type1_enable_iopf(struct vfio_iommu *iommu)
+{
+       struct vfio_domain *d;
+       struct vfio_group *g;
+       struct vfio_iopf_group *iopf_group;
+       int enabled_dev_cnt = 0;
+       int ret;
+
+       if (!current->mm)
+               return -ENODEV;
+
+       mutex_lock(&iommu->lock);
+
+       mmgrab(current->mm);
+       iommu->mm = current->mm;
+       iommu->mn.ops = &vfio_iommu_type1_mn_ops;
+       ret = mmu_notifier_register(&iommu->mn, current->mm);
+       if (ret)
+               goto out_drop;
+
+       list_for_each_entry(d, &iommu->domain_list, next) {
+               list_for_each_entry(g, &d->group_list, next) {
+                       ret = iommu_group_for_each_dev(g->iommu_group,
+                                       &enabled_dev_cnt, dev_enable_iopf);
+                       if (ret)
+                               goto out_unwind;
+
+                       iopf_group = kzalloc(sizeof(*iopf_group), GFP_KERNEL);
+                       if (!iopf_group) {
+                               ret = -ENOMEM;
+                               goto out_unwind;
+                       }
+
+                       iopf_group->iommu_group = g->iommu_group;
+                       iopf_group->iommu = iommu;
+
+                       vfio_link_iopf_group(iopf_group);
+               }
+       }
+
+       iommu->iopf_enabled = true;
+       goto out_unlock;
+
+out_unwind:
+       list_for_each_entry(d, &iommu->domain_list, next) {
+               list_for_each_entry(g, &d->group_list, next) {
+                       iopf_group = vfio_find_iopf_group(g->iommu_group);
+                       if (iopf_group) {
+                               vfio_unlink_iopf_group(iopf_group);
+                               kfree(iopf_group);
+                       }
+
+                       if (iommu_group_for_each_dev(g->iommu_group,
+                                       &enabled_dev_cnt, dev_disable_iopf))
+                               goto out_unregister;
+               }
+       }
+
+out_unregister:
+       mmu_notifier_unregister(&iommu->mn, current->mm);
+
+out_drop:
+       iommu->mm = NULL;
+       mmdrop(current->mm);
+
+out_unlock:
+       mutex_unlock(&iommu->lock);
+       return ret;
+}
+
 static long vfio_iommu_type1_ioctl(void *iommu_data,
                                   unsigned int cmd, unsigned long arg)
 {
@@ -3457,6 +3672,8 @@ static long vfio_iommu_type1_ioctl(void *iommu_data,
                return vfio_iommu_type1_unmap_dma(iommu, arg);
        case VFIO_IOMMU_DIRTY_PAGES:
                return vfio_iommu_type1_dirty_pages(iommu, arg);
+       case VFIO_IOMMU_ENABLE_IOPF:
+               return vfio_iommu_type1_enable_iopf(iommu);
        default:
                return -ENOTTY;
        }
diff --git a/include/uapi/linux/vfio.h b/include/uapi/linux/vfio.h
index 8ce36c1d53ca..5497036bebdc 100644
--- a/include/uapi/linux/vfio.h
+++ b/include/uapi/linux/vfio.h
@@ -1208,6 +1208,12 @@ struct vfio_iommu_type1_dirty_bitmap_get {
 
 #define VFIO_IOMMU_DIRTY_PAGES             _IO(VFIO_TYPE, VFIO_BASE + 17)
 
+/*
+ * IOCTL to enable IOPF for the container.
+ * Called right after VFIO_SET_IOMMU.
+ */
+#define VFIO_IOMMU_ENABLE_IOPF             _IO(VFIO_TYPE, VFIO_BASE + 18)
+
 /* -------- Additional API for SPAPR TCE (Server POWERPC) IOMMU -------- */
 
 /*
-- 
2.19.1

_______________________________________________
iommu mailing list
iommu@lists.linux-foundation.org
https://lists.linuxfoundation.org/mailman/listinfo/iommu

Reply via email to