diff options
Diffstat (limited to 'drivers/of/of_pci.c')
-rw-r--r-- | drivers/of/of_pci.c | 59 |
1 files changed, 54 insertions, 5 deletions
diff --git a/drivers/of/of_pci.c b/drivers/of/of_pci.c index 13e37e2d8ec1..42c687a820ac 100644 --- a/drivers/of/of_pci.c +++ b/drivers/of/of_pci.c | |||
@@ -5,14 +5,15 @@ | |||
5 | #include <asm/prom.h> | 5 | #include <asm/prom.h> |
6 | 6 | ||
7 | static inline int __of_pci_pci_compare(struct device_node *node, | 7 | static inline int __of_pci_pci_compare(struct device_node *node, |
8 | unsigned int devfn) | 8 | unsigned int data) |
9 | { | 9 | { |
10 | unsigned int size; | 10 | int devfn; |
11 | const __be32 *reg = of_get_property(node, "reg", &size); | ||
12 | 11 | ||
13 | if (!reg || size < 5 * sizeof(__be32)) | 12 | devfn = of_pci_get_devfn(node); |
13 | if (devfn < 0) | ||
14 | return 0; | 14 | return 0; |
15 | return ((be32_to_cpup(®[0]) >> 8) & 0xff) == devfn; | 15 | |
16 | return devfn == data; | ||
16 | } | 17 | } |
17 | 18 | ||
18 | struct device_node *of_pci_find_child_device(struct device_node *parent, | 19 | struct device_node *of_pci_find_child_device(struct device_node *parent, |
@@ -40,3 +41,51 @@ struct device_node *of_pci_find_child_device(struct device_node *parent, | |||
40 | return NULL; | 41 | return NULL; |
41 | } | 42 | } |
42 | EXPORT_SYMBOL_GPL(of_pci_find_child_device); | 43 | EXPORT_SYMBOL_GPL(of_pci_find_child_device); |
44 | |||
45 | /** | ||
46 | * of_pci_get_devfn() - Get device and function numbers for a device node | ||
47 | * @np: device node | ||
48 | * | ||
49 | * Parses a standard 5-cell PCI resource and returns an 8-bit value that can | ||
50 | * be passed to the PCI_SLOT() and PCI_FUNC() macros to extract the device | ||
51 | * and function numbers respectively. On error a negative error code is | ||
52 | * returned. | ||
53 | */ | ||
54 | int of_pci_get_devfn(struct device_node *np) | ||
55 | { | ||
56 | unsigned int size; | ||
57 | const __be32 *reg; | ||
58 | |||
59 | reg = of_get_property(np, "reg", &size); | ||
60 | |||
61 | if (!reg || size < 5 * sizeof(__be32)) | ||
62 | return -EINVAL; | ||
63 | |||
64 | return (be32_to_cpup(reg) >> 8) & 0xff; | ||
65 | } | ||
66 | EXPORT_SYMBOL_GPL(of_pci_get_devfn); | ||
67 | |||
68 | /** | ||
69 | * of_pci_parse_bus_range() - parse the bus-range property of a PCI device | ||
70 | * @node: device node | ||
71 | * @res: address to a struct resource to return the bus-range | ||
72 | * | ||
73 | * Returns 0 on success or a negative error-code on failure. | ||
74 | */ | ||
75 | int of_pci_parse_bus_range(struct device_node *node, struct resource *res) | ||
76 | { | ||
77 | const __be32 *values; | ||
78 | int len; | ||
79 | |||
80 | values = of_get_property(node, "bus-range", &len); | ||
81 | if (!values || len < sizeof(*values) * 2) | ||
82 | return -EINVAL; | ||
83 | |||
84 | res->name = node->name; | ||
85 | res->start = be32_to_cpup(values++); | ||
86 | res->end = be32_to_cpup(values); | ||
87 | res->flags = IORESOURCE_BUS; | ||
88 | |||
89 | return 0; | ||
90 | } | ||
91 | EXPORT_SYMBOL_GPL(of_pci_parse_bus_range); | ||