[PATCH v2 09/22] fpga: intel: pcie: adds fpga_for_each_port callback for fme device

[Wu Hao]

For FPGA Management Engine (FME), it requires fpga_for_each_port callback
for actions on ports, so export this function from PCIe driver by adding
the callback to the platform data.

Signed-off-by: Tim Whisonant <tim.whison...@intel.com>
Signed-off-by: Enno Luebbers <enno.luebb...@intel.com>
Signed-off-by: Shiva Rao <shiva....@intel.com>
Signed-off-by: Christopher Rauer <christopher.ra...@intel.com>
Signed-off-by: Xiao Guangrong <guangrong.x...@linux.intel.com>
Signed-off-by: Wu Hao <hao...@intel.com>
---
v2: rebased
---
 drivers/fpga/intel-feature-dev.h |  9 +++++++++
 drivers/fpga/intel-pcie.c        | 24 ++++++++++++++++++++++++
 2 files changed, 33 insertions(+)

diff --git a/drivers/fpga/intel-feature-dev.h b/drivers/fpga/intel-feature-dev.h
index d64a51e..06b3fb6 100644
--- a/drivers/fpga/intel-feature-dev.h
+++ b/drivers/fpga/intel-feature-dev.h
@@ -235,6 +235,9 @@ struct feature_platform_data {
        struct platform_device *dev;
        unsigned int disable_count;     /* count for port disable */
 
+       struct platform_device *(*fpga_for_each_port)(struct platform_device *,
+                       void *, int (*match)(struct platform_device *, void *));
+
        int num;                        /* number of features */
        struct feature features[0];
 };
@@ -354,4 +357,10 @@ static inline int fpga_port_reset(struct platform_device 
*pdev)
 
        return pdata->features[index].ioaddr;
 }
+
+static inline struct device *
+fpga_feature_dev_to_pcidev(struct platform_device *dev)
+{
+       return dev->dev.parent->parent;
+}
 #endif
diff --git a/drivers/fpga/intel-pcie.c b/drivers/fpga/intel-pcie.c
index 54c0e3a..86ea5c7 100644
--- a/drivers/fpga/intel-pcie.c
+++ b/drivers/fpga/intel-pcie.c
@@ -209,6 +209,27 @@ static int parse_switch_to(struct build_feature_devs_info 
*binfo, int bar)
        return parse_start_from(binfo, bar);
 }
 
+static struct platform_device *fpga_for_each_port(struct platform_device *pdev,
+                    void *data, int (*match)(struct platform_device *, void *))
+{
+       struct device *pci_dev = fpga_feature_dev_to_pcidev(pdev);
+       struct cci_drvdata *drvdata = dev_get_drvdata(pci_dev);
+       struct feature_platform_data *pdata;
+       struct platform_device *port_dev;
+
+       mutex_lock(&drvdata->lock);
+       list_for_each_entry(pdata, &drvdata->port_dev_list, node) {
+               port_dev = pdata->dev;
+
+               if (match(port_dev, data) && get_device(&port_dev->dev))
+                       goto exit;
+       }
+       port_dev = NULL;
+exit:
+       mutex_unlock(&drvdata->lock);
+       return port_dev;
+}
+
 static struct build_feature_devs_info *
 build_info_alloc_and_init(struct pci_dev *pdev)
 {
@@ -310,6 +331,9 @@ static int build_info_commit_dev(struct 
build_feature_devs_info *binfo)
        if (!pdata)
                return -ENOMEM;
 
+       if (type == FME_ID)
+               pdata->fpga_for_each_port = fpga_for_each_port;
+
        /*
         * the count should be initialized to 0 to make sure
         *__fpga_port_enable() following __fpga_port_disable()
-- 
1.8.3.1