[PATCH v15 7/9] PCI/PORTDRV: Implement generic find device

[Oza Pawandeep]

This patch implements generic pcie_port_find_device() routine.

Signed-off-by: Oza Pawandeep <p...@codeaurora.org>
Reviewed-by: Keith Busch <keith.bu...@intel.com>

diff --git a/drivers/pci/pcie/portdrv.h b/drivers/pci/pcie/portdrv.h
index ba6c963..896608a 100644
--- a/drivers/pci/pcie/portdrv.h
+++ b/drivers/pci/pcie/portdrv.h
@@ -114,4 +114,6 @@ static inline void pcie_pme_interrupt_enable(struct pci_dev 
*dev, bool en) {}
 
 struct pcie_port_service_driver *pcie_port_find_service(struct pci_dev *dev,
                                                        u32 service);
+struct device *pcie_port_find_device(struct pci_dev *dev,
+                                    u32 service);
 #endif /* _PORTDRV_H_ */
diff --git a/drivers/pci/pcie/portdrv_core.c b/drivers/pci/pcie/portdrv_core.c
index d843055..c6147c4 100644
--- a/drivers/pci/pcie/portdrv_core.c
+++ b/drivers/pci/pcie/portdrv_core.c
@@ -20,6 +20,7 @@
 #include "portdrv.h"
 struct portdrv_service_data {
        struct pcie_port_service_driver *drv;
+       struct device *dev;
        u32 service;
 };
 
@@ -415,6 +416,7 @@ static int find_service_iter(struct device *device, void 
*data)
                service_driver = to_service_driver(device->driver);
                if (service_driver->service == service) {
                        pdrvs->drv = service_driver;
+                       pdrvs->dev = device;
                        return 1;
                }
        }
@@ -443,6 +445,27 @@ struct pcie_port_service_driver 
*pcie_port_find_service(struct pci_dev *dev,
 }
 
 /**
+ * pcie_port_find_device - find the struct device
+ * @dev: PCI Express port the service devices associated with
+ * @service: For the service to find
+ *
+ * Find PCI Express port service driver associated with given service
+ */
+struct  device *pcie_port_find_device(struct pci_dev *dev,
+                                     u32 service)
+{
+       struct device *device;
+       struct portdrv_service_data pdrvs;
+
+       pdrvs.dev = NULL;
+       pdrvs.service = service;
+       device_for_each_child(&dev->dev, &pdrvs, find_service_iter);
+
+       device = pdrvs.dev;
+       return device;
+}
+
+/**
  * pcie_port_device_remove - unregister PCI Express port service devices
  * @dev: PCI Express port the service devices to unregister are associated with
  *
-- 
2.7.4