Add the ability to add and delete a vdpa device.

Examples:
Create a vdpa device of type network named "foo2" from
the parent device vdpasim:

$ vdpa dev add parentdev vdpasim type net name foo2

Delete the vdpa device after its use:
$ vdpa dev del foo2

Signed-off-by: Parav Pandit <pa...@nvidia.com>
Reviewed-by: Eli Cohen <e...@nvidia.com>
Reviewed-by: Jason Wang <jasow...@redhat.com>
---
 drivers/vdpa/vdpa.c       | 149 +++++++++++++++++++++++++++++++++++---
 include/linux/vdpa.h      |   6 ++
 include/uapi/linux/vdpa.h |   5 ++
 3 files changed, 150 insertions(+), 10 deletions(-)

diff --git a/drivers/vdpa/vdpa.c b/drivers/vdpa/vdpa.c
index 273639038851..fcbdc8f10206 100644
--- a/drivers/vdpa/vdpa.c
+++ b/drivers/vdpa/vdpa.c
@@ -136,6 +136,37 @@ static int vdpa_name_match(struct device *dev, const void 
*data)
        return (strcmp(dev_name(&vdev->dev), data) == 0);
 }
 
+static int __vdpa_register_device(struct vdpa_device *vdev)
+{
+       struct device *dev;
+
+       lockdep_assert_held(&vdpa_dev_mutex);
+       dev = bus_find_device(&vdpa_bus, NULL, dev_name(&vdev->dev), 
vdpa_name_match);
+       if (dev) {
+               put_device(dev);
+               return -EEXIST;
+       }
+       return device_add(&vdev->dev);
+}
+
+/**
+ * _vdpa_register_device - register a vDPA device with vdpa lock held
+ * Caller must have a succeed call of vdpa_alloc_device() before.
+ * Caller must invoke this routine as part of parent device dev_add() callback
+ * after setting up valid parentdev for this vdpa device.
+ * @vdev: the vdpa device to be registered to vDPA bus
+ *
+ * Returns an error when fail to add device to vDPA bus
+ */
+int _vdpa_register_device(struct vdpa_device *vdev)
+{
+       if (!vdev->pdev)
+               return -EINVAL;
+
+       return __vdpa_register_device(vdev);
+}
+EXPORT_SYMBOL_GPL(_vdpa_register_device);
+
 /**
  * vdpa_register_device - register a vDPA device
  * Callers must have a succeed call of vdpa_alloc_device() before.
@@ -145,24 +176,28 @@ static int vdpa_name_match(struct device *dev, const void 
*data)
  */
 int vdpa_register_device(struct vdpa_device *vdev)
 {
-       struct device *dev;
        int err;
 
        mutex_lock(&vdpa_dev_mutex);
-       dev = bus_find_device(&vdpa_bus, NULL, dev_name(&vdev->dev), 
vdpa_name_match);
-       if (dev) {
-               put_device(dev);
-               err = -EEXIST;
-               goto name_err;
-       }
-
-       err = device_add(&vdev->dev);
-name_err:
+       err = __vdpa_register_device(vdev);
        mutex_unlock(&vdpa_dev_mutex);
        return err;
 }
 EXPORT_SYMBOL_GPL(vdpa_register_device);
 
+/**
+ * _vdpa_unregister_device - unregister a vDPA device
+ * Caller must invoke this routine as part of parent device dev_del() callback.
+ * @vdev: the vdpa device to be unregisted from vDPA bus
+ */
+void _vdpa_unregister_device(struct vdpa_device *vdev)
+{
+       lockdep_assert_held(&vdpa_dev_mutex);
+       WARN_ON(!vdev->pdev);
+       device_unregister(&vdev->dev);
+}
+EXPORT_SYMBOL_GPL(_vdpa_unregister_device);
+
 /**
  * vdpa_unregister_device - unregister a vDPA device
  * @vdev: the vdpa device to be unregisted from vDPA bus
@@ -221,10 +256,25 @@ int vdpa_parentdev_register(struct vdpa_parent_dev *pdev)
 }
 EXPORT_SYMBOL_GPL(vdpa_parentdev_register);
 
+static int vdpa_match_remove(struct device *dev, void *data)
+{
+       struct vdpa_device *vdev = container_of(dev, struct vdpa_device, dev);
+       struct vdpa_parent_dev *pdev = vdev->pdev;
+
+       if (pdev == data)
+               pdev->ops->dev_del(pdev, vdev);
+       return 0;
+}
+
 void vdpa_parentdev_unregister(struct vdpa_parent_dev *pdev)
 {
        mutex_lock(&vdpa_dev_mutex);
+
        list_del(&pdev->list);
+
+       /* Filter out all the entries belong to this parent device and delete 
it. */
+       bus_for_each_dev(&vdpa_bus, NULL, pdev, vdpa_match_remove);
+
        mutex_unlock(&vdpa_dev_mutex);
 }
 EXPORT_SYMBOL_GPL(vdpa_parentdev_unregister);
@@ -368,9 +418,76 @@ vdpa_nl_cmd_parentdev_get_dumpit(struct sk_buff *msg, 
struct netlink_callback *c
        return msg->len;
 }
 
+static int vdpa_nl_cmd_dev_add_set_doit(struct sk_buff *skb, struct genl_info 
*info)
+{
+       struct vdpa_parent_dev *pdev;
+       struct vdpa_device *vdev;
+       const char *name;
+       u32 device_id;
+       int err = 0;
+
+       if (!info->attrs[VDPA_ATTR_DEV_NAME] || !info->attrs[VDPA_ATTR_DEV_ID])
+               return -EINVAL;
+
+       name = nla_data(info->attrs[VDPA_ATTR_DEV_NAME]);
+       device_id = nla_get_u32(info->attrs[VDPA_ATTR_DEV_ID]);
+
+       mutex_lock(&vdpa_dev_mutex);
+       pdev = vdpa_parentdev_get_from_attr(info->attrs);
+       if (IS_ERR(pdev)) {
+               NL_SET_ERR_MSG_MOD(info->extack, "Fail to find the specified 
parent device");
+               err = PTR_ERR(pdev);
+               goto err;
+       }
+
+       vdev = pdev->ops->dev_add(pdev, name, device_id);
+       if (IS_ERR(vdev))
+               goto err;
+
+err:
+       mutex_unlock(&vdpa_dev_mutex);
+       return err;
+}
+
+static int vdpa_nl_cmd_dev_del_set_doit(struct sk_buff *skb, struct genl_info 
*info)
+{
+       struct vdpa_parent_dev *pdev;
+       struct vdpa_device *vdev;
+       struct device *dev;
+       const char *name;
+       int err = 0;
+
+       if (!info->attrs[VDPA_ATTR_DEV_NAME])
+               return -EINVAL;
+       name = nla_data(info->attrs[VDPA_ATTR_DEV_NAME]);
+
+       mutex_lock(&vdpa_dev_mutex);
+       dev = bus_find_device(&vdpa_bus, NULL, name, vdpa_name_match);
+       if (!dev) {
+               NL_SET_ERR_MSG_MOD(info->extack, "device not found");
+               err = -ENODEV;
+               goto dev_err;
+       }
+       vdev = container_of(dev, struct vdpa_device, dev);
+       if (!vdev->pdev) {
+               NL_SET_ERR_MSG_MOD(info->extack, "Only user created device can 
be deleted by user");
+               err = -EINVAL;
+               goto pdev_err;
+       }
+       pdev = vdev->pdev;
+       pdev->ops->dev_del(pdev, vdev);
+pdev_err:
+       put_device(dev);
+dev_err:
+       mutex_unlock(&vdpa_dev_mutex);
+       return err;
+}
+
 static const struct nla_policy vdpa_nl_policy[VDPA_ATTR_MAX] = {
        [VDPA_ATTR_PARENTDEV_BUS_NAME] = { .type = NLA_NUL_STRING },
        [VDPA_ATTR_PARENTDEV_DEV_NAME] = { .type = NLA_STRING },
+       [VDPA_ATTR_DEV_NAME] = { .type = NLA_STRING },
+       [VDPA_ATTR_DEV_ID] = { .type = NLA_U32 },
 };
 
 static const struct genl_ops vdpa_nl_ops[] = {
@@ -380,6 +497,18 @@ static const struct genl_ops vdpa_nl_ops[] = {
                .doit = vdpa_nl_cmd_parentdev_get_doit,
                .dumpit = vdpa_nl_cmd_parentdev_get_dumpit,
        },
+       {
+               .cmd = VDPA_CMD_DEV_NEW,
+               .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
+               .doit = vdpa_nl_cmd_dev_add_set_doit,
+               .flags = GENL_ADMIN_PERM,
+       },
+       {
+               .cmd = VDPA_CMD_DEV_DEL,
+               .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
+               .doit = vdpa_nl_cmd_dev_del_set_doit,
+               .flags = GENL_ADMIN_PERM,
+       },
 };
 
 static struct genl_family vdpa_nl_family __ro_after_init = {
diff --git a/include/linux/vdpa.h b/include/linux/vdpa.h
index 3d6bc1fb909d..cb5a3d847af3 100644
--- a/include/linux/vdpa.h
+++ b/include/linux/vdpa.h
@@ -45,6 +45,8 @@ struct vdpa_parent_dev;
  * @index: device index
  * @features_valid: were features initialized? for legacy guests
  * @nvqs: maximum number of supported virtqueues
+ * @pdev: parent device pointer; caller must setup when registering device as 
part
+ *       of dev_add() parentdev ops callback before invoking 
_vdpa_register_device().
  */
 struct vdpa_device {
        struct device dev;
@@ -53,6 +55,7 @@ struct vdpa_device {
        unsigned int index;
        bool features_valid;
        int nvqs;
+       struct vdpa_parent_dev *pdev;
 };
 
 /**
@@ -260,6 +263,9 @@ struct vdpa_device *__vdpa_alloc_device(struct device 
*parent,
 int vdpa_register_device(struct vdpa_device *vdev);
 void vdpa_unregister_device(struct vdpa_device *vdev);
 
+int _vdpa_register_device(struct vdpa_device *vdev);
+void _vdpa_unregister_device(struct vdpa_device *vdev);
+
 /**
  * vdpa_driver - operations for a vDPA driver
  * @driver: underlying device driver
diff --git a/include/uapi/linux/vdpa.h b/include/uapi/linux/vdpa.h
index 6d88022f6a95..c528a9cfd6c9 100644
--- a/include/uapi/linux/vdpa.h
+++ b/include/uapi/linux/vdpa.h
@@ -15,6 +15,8 @@ enum vdpa_command {
        VDPA_CMD_UNSPEC,
        VDPA_CMD_PARENTDEV_NEW,
        VDPA_CMD_PARENTDEV_GET,         /* can dump */
+       VDPA_CMD_DEV_NEW,
+       VDPA_CMD_DEV_DEL,
 };
 
 enum vdpa_attr {
@@ -25,6 +27,9 @@ enum vdpa_attr {
        VDPA_ATTR_PARENTDEV_DEV_NAME,           /* string */
        VDPA_ATTR_PARENTDEV_SUPPORTED_CLASSES,  /* u64 */
 
+       VDPA_ATTR_DEV_NAME,                     /* string */
+       VDPA_ATTR_DEV_ID,                       /* u32 */
+
        /* new attributes must be added above here */
        VDPA_ATTR_MAX,
 };
-- 
2.26.2

Reply via email to