Commit fcc2281b authored by Dave Jiang's avatar Dave Jiang Committed by Vinod Koul

dmaengine: idxd: fix bus_probe() and bus_remove() for dsa_bus

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: default avatarDan Williams <dan.j.williams@intel.com>
Signed-off-by: default avatarDave Jiang <dave.jiang@intel.com>
Link: https://lore.kernel.org/r/162637463586.744545.5806250155539938643.stgit@djiang5-desk3.ch.intel.comSigned-off-by: default avatarVinod Koul <vkoul@kernel.org>
parent 1c264299
...@@ -51,6 +51,8 @@ enum idxd_type { ...@@ -51,6 +51,8 @@ enum idxd_type {
struct idxd_device_driver { struct idxd_device_driver {
const char *name; const char *name;
int (*probe)(struct idxd_dev *idxd_dev);
void (*remove)(struct idxd_dev *idxd_dev);
struct device_driver drv; struct device_driver drv;
}; };
...@@ -323,19 +325,21 @@ enum idxd_completion_status { ...@@ -323,19 +325,21 @@ enum idxd_completion_status {
#define cdev_dev(cdev) &cdev->idxd_dev.conf_dev #define cdev_dev(cdev) &cdev->idxd_dev.conf_dev
#define confdev_to_idxd_dev(dev) container_of(dev, struct 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) static inline struct idxd_device *confdev_to_idxd(struct device *dev)
{ {
struct idxd_dev *idxd_dev = confdev_to_idxd_dev(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) static inline struct idxd_wq *confdev_to_wq(struct device *dev)
{ {
struct idxd_dev *idxd_dev = confdev_to_idxd_dev(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) static inline struct idxd_engine *confdev_to_engine(struct device *dev)
...@@ -379,24 +383,24 @@ extern struct device_type idxd_wq_device_type; ...@@ -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_engine_device_type;
extern struct device_type idxd_group_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) static inline bool is_idxd_wq_dmaengine(struct idxd_wq *wq)
......
...@@ -19,69 +19,80 @@ static char *idxd_wq_type_names[] = { ...@@ -19,69 +19,80 @@ static char *idxd_wq_type_names[] = {
static int idxd_config_bus_match(struct device *dev, static int idxd_config_bus_match(struct device *dev,
struct device_driver *drv) struct device_driver *drv)
{ {
int matched = 0; struct idxd_dev *idxd_dev = confdev_to_idxd_dev(dev);
if (is_idxd_dev(dev)) { return (is_idxd_dev(idxd_dev) || is_idxd_wq_dev(idxd_dev));
matched = 1; }
} else if (is_idxd_wq_dev(dev)) {
struct idxd_wq *wq = confdev_to_wq(dev);
if (wq->state != IDXD_WQ_DISABLED) { static int idxd_config_bus_probe(struct device *dev)
dev_dbg(dev, "%s not disabled\n", dev_name(dev)); {
return 0; struct idxd_device_driver *idxd_drv =
} container_of(dev->driver, struct idxd_device_driver, drv);
matched = 1; struct idxd_dev *idxd_dev = confdev_to_idxd_dev(dev);
}
if (matched) return idxd_drv->probe(idxd_dev);
dev_dbg(dev, "%s matched\n", dev_name(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; unsigned long flags;
int rc;
dev_dbg(dev, "%s called\n", __func__); if (is_idxd_dev(idxd_dev)) {
struct idxd_device *idxd = idxd_dev_to_idxd(idxd_dev);
if (is_idxd_dev(dev)) {
struct idxd_device *idxd = confdev_to_idxd(dev);
if (!try_module_get(THIS_MODULE)) if (idxd->state != IDXD_DEV_DISABLED)
return -ENXIO; return -ENXIO;
/* Perform IDXD configuration and enabling */ /* Device configuration */
spin_lock_irqsave(&idxd->dev_lock, flags); spin_lock_irqsave(&idxd->dev_lock, flags);
if (test_bit(IDXD_FLAG_CONFIGURABLE, &idxd->flags)) if (test_bit(IDXD_FLAG_CONFIGURABLE, &idxd->flags))
rc = idxd_device_config(idxd); rc = idxd_device_config(idxd);
spin_unlock_irqrestore(&idxd->dev_lock, flags); spin_unlock_irqrestore(&idxd->dev_lock, flags);
if (rc < 0) { if (rc < 0) {
module_put(THIS_MODULE); dev_dbg(dev, "Device config failed: %d\n", rc);
dev_warn(dev, "Device config failed: %d\n", rc);
return rc; return rc;
} }
/* start device */ /* Start device */
rc = idxd_device_enable(idxd); rc = idxd_device_enable(idxd);
if (rc < 0) { if (rc < 0) {
module_put(THIS_MODULE);
dev_warn(dev, "Device enable failed: %d\n", rc); dev_warn(dev, "Device enable failed: %d\n", rc);
return rc; return rc;
} }
dev_info(dev, "Device %s enabled\n", dev_name(dev)); /* Setup DMA device without channels */
rc = idxd_register_dma_device(idxd); rc = idxd_register_dma_device(idxd);
if (rc < 0) { if (rc < 0) {
module_put(THIS_MODULE);
dev_dbg(dev, "Failed to register dmaengine device\n"); dev_dbg(dev, "Failed to register dmaengine device\n");
idxd_device_disable(idxd);
return rc; return rc;
} }
dev_info(dev, "Device %s enabled\n", dev_name(dev));
return 0; 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); return drv_enable_wq(wq);
} }
...@@ -89,21 +100,14 @@ static int idxd_config_bus_probe(struct device *dev) ...@@ -89,21 +100,14 @@ static int idxd_config_bus_probe(struct device *dev)
return -ENODEV; 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)); struct device *dev = &idxd_dev->conf_dev;
/* disable workqueue here */
if (is_idxd_wq_dev(dev)) {
struct idxd_wq *wq = confdev_to_wq(dev);
drv_disable_wq(wq); if (is_idxd_dev(idxd_dev)) {
} else if (is_idxd_dev(dev)) { struct idxd_device *idxd = idxd_dev_to_idxd(idxd_dev);
struct idxd_device *idxd = confdev_to_idxd(dev);
int i; int i;
dev_dbg(dev, "%s removing dev %s\n", __func__,
dev_name(idxd_confdev(idxd)));
for (i = 0; i < idxd->max_wqs; i++) { for (i = 0; i < idxd->max_wqs; i++) {
struct idxd_wq *wq = idxd->wqs[i]; struct idxd_wq *wq = idxd->wqs[i];
...@@ -118,23 +122,21 @@ static int idxd_config_bus_remove(struct device *dev) ...@@ -118,23 +122,21 @@ static int idxd_config_bus_remove(struct device *dev)
idxd_device_disable(idxd); idxd_device_disable(idxd);
if (test_bit(IDXD_FLAG_CONFIGURABLE, &idxd->flags)) if (test_bit(IDXD_FLAG_CONFIGURABLE, &idxd->flags))
idxd_device_reset(idxd); idxd_device_reset(idxd);
module_put(THIS_MODULE); return;
dev_info(dev, "Device %s disabled\n", dev_name(dev));
} }
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 = { drv_disable_wq(wq);
.name = "dsa", return;
.match = idxd_config_bus_match, }
.probe = idxd_config_bus_probe, }
.remove = idxd_config_bus_remove,
};
static struct idxd_device_driver dsa_drv = { static struct idxd_device_driver dsa_drv = {
.name = "dsa", .name = "dsa",
.probe = idxd_dsa_drv_probe,
.remove = idxd_dsa_drv_remove,
}; };
/* IDXD generic driver setup */ /* IDXD generic driver setup */
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment