dmaengine: idxd: fix bus_probe() and bus_remove() for dsa_bus
authorDave Jiang <dave.jiang@intel.com>
Thu, 15 Jul 2021 18:43:55 +0000 (11:43 -0700)
committerVinod Koul <vkoul@kernel.org>
Wed, 21 Jul 2021 04:39:15 +0000 (10:09 +0530)
Current implementation have put all the code that should be in a driver
probe/remove in the bus probe/remove function. Add ->probe() and ->remove()
support for the dsa_drv and move all those code out of bus probe/remove.
The change does not split out the distinction between device sub-driver and
wq sub-driver. It only cleans up the bus calls. The split out will be
addressed in follow on patches.

Reviewed-by: Dan Williams <dan.j.williams@intel.com>
Signed-off-by: Dave Jiang <dave.jiang@intel.com>
Link: https://lore.kernel.org/r/162637463586.744545.5806250155539938643.stgit@djiang5-desk3.ch.intel.com
Signed-off-by: Vinod Koul <vkoul@kernel.org>
drivers/dma/idxd/idxd.h
drivers/dma/idxd/sysfs.c

index 4c3d3eb..493958e 100644 (file)
@@ -51,6 +51,8 @@ enum idxd_type {
 
 struct idxd_device_driver {
        const char *name;
+       int (*probe)(struct idxd_dev *idxd_dev);
+       void (*remove)(struct idxd_dev *idxd_dev);
        struct device_driver drv;
 };
 
@@ -323,19 +325,21 @@ enum idxd_completion_status {
 #define cdev_dev(cdev) &cdev->idxd_dev.conf_dev
 
 #define confdev_to_idxd_dev(dev) container_of(dev, struct idxd_dev, conf_dev)
+#define idxd_dev_to_idxd(idxd_dev) container_of(idxd_dev, struct idxd_device, idxd_dev)
+#define idxd_dev_to_wq(idxd_dev) container_of(idxd_dev, struct idxd_wq, idxd_dev)
 
 static inline struct idxd_device *confdev_to_idxd(struct device *dev)
 {
        struct idxd_dev *idxd_dev = confdev_to_idxd_dev(dev);
 
-       return container_of(idxd_dev, struct idxd_device, idxd_dev);
+       return idxd_dev_to_idxd(idxd_dev);
 }
 
 static inline struct idxd_wq *confdev_to_wq(struct device *dev)
 {
        struct idxd_dev *idxd_dev = confdev_to_idxd_dev(dev);
 
-       return container_of(idxd_dev, struct idxd_wq, idxd_dev);
+       return idxd_dev_to_wq(idxd_dev);
 }
 
 static inline struct idxd_engine *confdev_to_engine(struct device *dev)
@@ -379,24 +383,24 @@ extern struct device_type idxd_wq_device_type;
 extern struct device_type idxd_engine_device_type;
 extern struct device_type idxd_group_device_type;
 
-static inline bool is_dsa_dev(struct device *dev)
+static inline bool is_dsa_dev(struct idxd_dev *idxd_dev)
 {
-       return dev->type == &dsa_device_type;
+       return idxd_dev->type == IDXD_DEV_DSA;
 }
 
-static inline bool is_iax_dev(struct device *dev)
+static inline bool is_iax_dev(struct idxd_dev *idxd_dev)
 {
-       return dev->type == &iax_device_type;
+       return idxd_dev->type == IDXD_DEV_IAX;
 }
 
-static inline bool is_idxd_dev(struct device *dev)
+static inline bool is_idxd_dev(struct idxd_dev *idxd_dev)
 {
-       return is_dsa_dev(dev) || is_iax_dev(dev);
+       return is_dsa_dev(idxd_dev) || is_iax_dev(idxd_dev);
 }
 
-static inline bool is_idxd_wq_dev(struct device *dev)
+static inline bool is_idxd_wq_dev(struct idxd_dev *idxd_dev)
 {
-       return dev->type == &idxd_wq_device_type;
+       return idxd_dev->type == IDXD_DEV_WQ;
 }
 
 static inline bool is_idxd_wq_dmaengine(struct idxd_wq *wq)
index c3c869d..f82416e 100644 (file)
@@ -19,69 +19,80 @@ static char *idxd_wq_type_names[] = {
 static int idxd_config_bus_match(struct device *dev,
                                 struct device_driver *drv)
 {
-       int matched = 0;
+       struct idxd_dev *idxd_dev = confdev_to_idxd_dev(dev);
 
-       if (is_idxd_dev(dev)) {
-               matched = 1;
-       } else if (is_idxd_wq_dev(dev)) {
-               struct idxd_wq *wq = confdev_to_wq(dev);
+       return (is_idxd_dev(idxd_dev) || is_idxd_wq_dev(idxd_dev));
+}
 
-               if (wq->state != IDXD_WQ_DISABLED) {
-                       dev_dbg(dev, "%s not disabled\n", dev_name(dev));
-                       return 0;
-               }
-               matched = 1;
-       }
+static int idxd_config_bus_probe(struct device *dev)
+{
+       struct idxd_device_driver *idxd_drv =
+               container_of(dev->driver, struct idxd_device_driver, drv);
+       struct idxd_dev *idxd_dev = confdev_to_idxd_dev(dev);
 
-       if (matched)
-               dev_dbg(dev, "%s matched\n", dev_name(dev));
+       return idxd_drv->probe(idxd_dev);
+}
 
-       return matched;
+static int idxd_config_bus_remove(struct device *dev)
+{
+       struct idxd_device_driver *idxd_drv =
+               container_of(dev->driver, struct idxd_device_driver, drv);
+       struct idxd_dev *idxd_dev = confdev_to_idxd_dev(dev);
+
+       idxd_drv->remove(idxd_dev);
+       return 0;
 }
 
-static int idxd_config_bus_probe(struct device *dev)
+struct bus_type dsa_bus_type = {
+       .name = "dsa",
+       .match = idxd_config_bus_match,
+       .probe = idxd_config_bus_probe,
+       .remove = idxd_config_bus_remove,
+};
+
+static int idxd_dsa_drv_probe(struct idxd_dev *idxd_dev)
 {
-       int rc = 0;
+       struct device *dev = &idxd_dev->conf_dev;
        unsigned long flags;
+       int rc;
 
-       dev_dbg(dev, "%s called\n", __func__);
-
-       if (is_idxd_dev(dev)) {
-               struct idxd_device *idxd = confdev_to_idxd(dev);
+       if (is_idxd_dev(idxd_dev)) {
+               struct idxd_device *idxd = idxd_dev_to_idxd(idxd_dev);
 
-               if (!try_module_get(THIS_MODULE))
+               if (idxd->state != IDXD_DEV_DISABLED)
                        return -ENXIO;
 
-               /* Perform IDXD configuration and enabling */
+               /* Device configuration */
                spin_lock_irqsave(&idxd->dev_lock, flags);
                if (test_bit(IDXD_FLAG_CONFIGURABLE, &idxd->flags))
                        rc = idxd_device_config(idxd);
                spin_unlock_irqrestore(&idxd->dev_lock, flags);
                if (rc < 0) {
-                       module_put(THIS_MODULE);
-                       dev_warn(dev, "Device config failed: %d\n", rc);
+                       dev_dbg(dev, "Device config failed: %d\n", rc);
                        return rc;
                }
 
-               /* start device */
+               /* Start device */
                rc = idxd_device_enable(idxd);
                if (rc < 0) {
-                       module_put(THIS_MODULE);
                        dev_warn(dev, "Device enable failed: %d\n", rc);
                        return rc;
                }
 
-               dev_info(dev, "Device %s enabled\n", dev_name(dev));
-
+               /* Setup DMA device without channels */
                rc = idxd_register_dma_device(idxd);
                if (rc < 0) {
-                       module_put(THIS_MODULE);
                        dev_dbg(dev, "Failed to register dmaengine device\n");
+                       idxd_device_disable(idxd);
                        return rc;
                }
+
+               dev_info(dev, "Device %s enabled\n", dev_name(dev));
                return 0;
-       } else if (is_idxd_wq_dev(dev)) {
-               struct idxd_wq *wq = confdev_to_wq(dev);
+       }
+
+       if (is_idxd_wq_dev(idxd_dev)) {
+               struct idxd_wq *wq = idxd_dev_to_wq(idxd_dev);
 
                return drv_enable_wq(wq);
        }
@@ -89,21 +100,14 @@ static int idxd_config_bus_probe(struct device *dev)
        return -ENODEV;
 }
 
-static int idxd_config_bus_remove(struct device *dev)
+static void idxd_dsa_drv_remove(struct idxd_dev *idxd_dev)
 {
-       dev_dbg(dev, "%s called for %s\n", __func__, dev_name(dev));
-
-       /* disable workqueue here */
-       if (is_idxd_wq_dev(dev)) {
-               struct idxd_wq *wq = confdev_to_wq(dev);
+       struct device *dev = &idxd_dev->conf_dev;
 
-               drv_disable_wq(wq);
-       } else if (is_idxd_dev(dev)) {
-               struct idxd_device *idxd = confdev_to_idxd(dev);
+       if (is_idxd_dev(idxd_dev)) {
+               struct idxd_device *idxd = idxd_dev_to_idxd(idxd_dev);
                int i;
 
-               dev_dbg(dev, "%s removing dev %s\n", __func__,
-                       dev_name(idxd_confdev(idxd)));
                for (i = 0; i < idxd->max_wqs; i++) {
                        struct idxd_wq *wq = idxd->wqs[i];
 
@@ -118,23 +122,21 @@ static int idxd_config_bus_remove(struct device *dev)
                idxd_device_disable(idxd);
                if (test_bit(IDXD_FLAG_CONFIGURABLE, &idxd->flags))
                        idxd_device_reset(idxd);
-               module_put(THIS_MODULE);
-
-               dev_info(dev, "Device %s disabled\n", dev_name(dev));
+               return;
        }
 
-       return 0;
-}
+       if (is_idxd_wq_dev(idxd_dev)) {
+               struct idxd_wq *wq = idxd_dev_to_wq(idxd_dev);
 
-struct bus_type dsa_bus_type = {
-       .name = "dsa",
-       .match = idxd_config_bus_match,
-       .probe = idxd_config_bus_probe,
-       .remove = idxd_config_bus_remove,
-};
+               drv_disable_wq(wq);
+               return;
+       }
+}
 
 static struct idxd_device_driver dsa_drv = {
        .name = "dsa",
+       .probe = idxd_dsa_drv_probe,
+       .remove = idxd_dsa_drv_remove,
 };
 
 /* IDXD generic driver setup */