Sebastian Andrzej Siewior | 04bea68 | 2011-01-24 09:58:55 +0530 | [diff] [blame] | 1 | #include <linux/kernel.h> |
Paul Gortmaker | 9775913 | 2011-05-27 17:06:52 -0400 | [diff] [blame] | 2 | #include <linux/export.h> |
Grant Likely | a642285 | 2011-07-23 23:52:48 -0600 | [diff] [blame] | 3 | #include <linux/of.h> |
Sebastian Andrzej Siewior | 04bea68 | 2011-01-24 09:58:55 +0530 | [diff] [blame] | 4 | #include <linux/of_pci.h> |
Sebastian Andrzej Siewior | 04bea68 | 2011-01-24 09:58:55 +0530 | [diff] [blame] | 5 | #include <asm/prom.h> |
| 6 | |
Benjamin Herrenschmidt | 98d9f30c8 | 2011-04-11 11:37:07 +1000 | [diff] [blame] | 7 | static inline int __of_pci_pci_compare(struct device_node *node, |
| 8 | unsigned int devfn) |
Sebastian Andrzej Siewior | 04bea68 | 2011-01-24 09:58:55 +0530 | [diff] [blame] | 9 | { |
Benjamin Herrenschmidt | 98d9f30c8 | 2011-04-11 11:37:07 +1000 | [diff] [blame] | 10 | unsigned int size; |
| 11 | const __be32 *reg = of_get_property(node, "reg", &size); |
Sebastian Andrzej Siewior | 04bea68 | 2011-01-24 09:58:55 +0530 | [diff] [blame] | 12 | |
Benjamin Herrenschmidt | 98d9f30c8 | 2011-04-11 11:37:07 +1000 | [diff] [blame] | 13 | if (!reg || size < 5 * sizeof(__be32)) |
| 14 | return 0; |
| 15 | return ((be32_to_cpup(®[0]) >> 8) & 0xff) == devfn; |
Sebastian Andrzej Siewior | 04bea68 | 2011-01-24 09:58:55 +0530 | [diff] [blame] | 16 | } |
Benjamin Herrenschmidt | 98d9f30c8 | 2011-04-11 11:37:07 +1000 | [diff] [blame] | 17 | |
| 18 | struct device_node *of_pci_find_child_device(struct device_node *parent, |
| 19 | unsigned int devfn) |
| 20 | { |
| 21 | struct device_node *node, *node2; |
| 22 | |
| 23 | for_each_child_of_node(parent, node) { |
| 24 | if (__of_pci_pci_compare(node, devfn)) |
| 25 | return node; |
| 26 | /* |
| 27 | * Some OFs create a parent node "multifunc-device" as |
| 28 | * a fake root for all functions of a multi-function |
| 29 | * device we go down them as well. |
| 30 | */ |
| 31 | if (!strcmp(node->name, "multifunc-device")) { |
| 32 | for_each_child_of_node(node, node2) { |
| 33 | if (__of_pci_pci_compare(node2, devfn)) { |
| 34 | of_node_put(node); |
| 35 | return node2; |
| 36 | } |
| 37 | } |
| 38 | } |
| 39 | } |
| 40 | return NULL; |
| 41 | } |
| 42 | EXPORT_SYMBOL_GPL(of_pci_find_child_device); |