Messages in this thread Patch in this message | | | From | Wu Hao <> | Subject | [PATCH 06/16] fpga: intel: pcie: adds fpga_for_each_port callback for fme device | Date | Thu, 30 Mar 2017 20:08:06 +0800 |
| |
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.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: Xiao Guangrong <guangrong.xiao@linux.intel.com> Signed-off-by: Wu Hao <hao.wu@intel.com> --- 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 d1723ff..38531f8 100644 --- a/drivers/fpga/intel/feature-dev.h +++ b/drivers/fpga/intel/feature-dev.h @@ -221,6 +221,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]; }; @@ -335,6 +338,12 @@ get_feature_ioaddr_by_index(struct device *dev, int index) return pdata->features[index].ioaddr; } +static inline struct device * +fpga_feature_dev_to_pcidev(struct platform_device *dev) +{ + return dev->dev.parent->parent; +} + /* * Wait register's _field to be changed to the given value (_expect's _field) * by polling with given interval and timeout. diff --git a/drivers/fpga/intel/pcie.c b/drivers/fpga/intel/pcie.c index e3440ca..f2b458d 100644 --- a/drivers/fpga/intel/pcie.c +++ b/drivers/fpga/intel/pcie.c @@ -211,6 +211,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) { @@ -312,6 +333,9 @@ build_info_create_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() -- 2.7.4
| |