fpga: dfl: add feature device infrastructure

This patch abstracts the common operations of the sub features and defines
the feature_ops data structure, including init, uinit and ioctl function
pointers. And this patch adds some common helper functions for FME and AFU
drivers, e.g. dfl_feature_dev_use_begin/end which are used to ensure
exclusive usage of the feature device file.

Signed-off-by: Tim Whisonant <tim.whisonant@intel.com>
Signed-off-by: Enno Luebbers <enno.luebbers@intel.com>
Signed-off-by: Shiva Rao <shiva.rao@intel.com>
Signed-off-by: Christopher Rauer <christopher.rauer@intel.com>
Signed-off-by: Kang Luwei <luwei.kang@intel.com>
Signed-off-by: Zhang Yi <yi.z.zhang@intel.com>
Signed-off-by: Xiao Guangrong <guangrong.xiao@linux.intel.com>
Signed-off-by: Wu Hao <hao.wu@intel.com>
Acked-by: Alan Tull <atull@kernel.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>

1 files changed, 71 insertions, 0 deletions

diff --git a/drivers/fpga/dfl.c b/drivers/fpga/dfl.c
index 68e0b45617b2..e2c72c5dd9e6 100644
--- a/drivers/fpga/dfl.c
+++ b/drivers/fpga/dfl.c
@@ -136,6 +136,77 @@ static enum dfl_id_type dfh_id_to_type(u32 id)
         return DFL_ID_MAX;
 }
 
+/**
+ * dfl_fpga_dev_feature_uinit - uinit for sub features of dfl feature device
+ * @pdev: feature device.
+ */
+void dfl_fpga_dev_feature_uinit(struct platform_device *pdev)
+{
+        struct dfl_feature_platform_data *pdata = dev_get_platdata(&pdev->dev);
+        struct dfl_feature *feature;
+
+        dfl_fpga_dev_for_each_feature(pdata, feature)
+                if (feature->ops) {
+                        feature->ops->uinit(pdev, feature);
+                        feature->ops = NULL;
+                }
+}
+EXPORT_SYMBOL_GPL(dfl_fpga_dev_feature_uinit);
+
+static int dfl_feature_instance_init(struct platform_device *pdev,
+                                     struct dfl_feature_platform_data *pdata,
+                                     struct dfl_feature *feature,
+                                     struct dfl_feature_driver *drv)
+{
+        int ret;
+
+        ret = drv->ops->init(pdev, feature);
+        if (ret)
+                return ret;
+
+        feature->ops = drv->ops;
+
+        return ret;
+}
+
+/**
+ * dfl_fpga_dev_feature_init - init for sub features of dfl feature device
+ * @pdev: feature device.
+ * @feature_drvs: drvs for sub features.
+ *
+ * This function will match sub features with given feature drvs list and
+ * use matched drv to init related sub feature.
+ *
+ * Return: 0 on success, negative error code otherwise.
+ */
+int dfl_fpga_dev_feature_init(struct platform_device *pdev,
+                              struct dfl_feature_driver *feature_drvs)
+{
+        struct dfl_feature_platform_data *pdata = dev_get_platdata(&pdev->dev);
+        struct dfl_feature_driver *drv = feature_drvs;
+        struct dfl_feature *feature;
+        int ret;
+
+        while (drv->ops) {
+                dfl_fpga_dev_for_each_feature(pdata, feature) {
+                        /* match feature and drv using id */
+                        if (feature->id == drv->id) {
+                                ret = dfl_feature_instance_init(pdev, pdata,
+                                                                feature, drv);
+                                if (ret)
+                                        goto exit;
+                        }
+                }
+                drv++;
+        }
+
+        return 0;
+exit:
+        dfl_fpga_dev_feature_uinit(pdev);
+        return ret;
+}
+EXPORT_SYMBOL_GPL(dfl_fpga_dev_feature_init);
+
 static void dfl_chardev_uinit(void)
 {
         int i;