• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 #include <linux/kernel.h>
2 #include <linux/export.h>
3 #include <linux/of.h>
4 #include <linux/of_address.h>
5 #include <linux/of_pci.h>
6 #include <linux/slab.h>
7 
__of_pci_pci_compare(struct device_node * node,unsigned int data)8 static inline int __of_pci_pci_compare(struct device_node *node,
9 				       unsigned int data)
10 {
11 	int devfn;
12 
13 	devfn = of_pci_get_devfn(node);
14 	if (devfn < 0)
15 		return 0;
16 
17 	return devfn == data;
18 }
19 
of_pci_find_child_device(struct device_node * parent,unsigned int devfn)20 struct device_node *of_pci_find_child_device(struct device_node *parent,
21 					     unsigned int devfn)
22 {
23 	struct device_node *node, *node2;
24 
25 	for_each_child_of_node(parent, node) {
26 		if (__of_pci_pci_compare(node, devfn))
27 			return node;
28 		/*
29 		 * Some OFs create a parent node "multifunc-device" as
30 		 * a fake root for all functions of a multi-function
31 		 * device we go down them as well.
32 		 */
33 		if (!strcmp(node->name, "multifunc-device")) {
34 			for_each_child_of_node(node, node2) {
35 				if (__of_pci_pci_compare(node2, devfn)) {
36 					of_node_put(node);
37 					return node2;
38 				}
39 			}
40 		}
41 	}
42 	return NULL;
43 }
44 EXPORT_SYMBOL_GPL(of_pci_find_child_device);
45 
46 /**
47  * of_pci_get_devfn() - Get device and function numbers for a device node
48  * @np: device node
49  *
50  * Parses a standard 5-cell PCI resource and returns an 8-bit value that can
51  * be passed to the PCI_SLOT() and PCI_FUNC() macros to extract the device
52  * and function numbers respectively. On error a negative error code is
53  * returned.
54  */
of_pci_get_devfn(struct device_node * np)55 int of_pci_get_devfn(struct device_node *np)
56 {
57 	unsigned int size;
58 	const __be32 *reg;
59 
60 	reg = of_get_property(np, "reg", &size);
61 
62 	if (!reg || size < 5 * sizeof(__be32))
63 		return -EINVAL;
64 
65 	return (be32_to_cpup(reg) >> 8) & 0xff;
66 }
67 EXPORT_SYMBOL_GPL(of_pci_get_devfn);
68 
69 /**
70  * of_pci_parse_bus_range() - parse the bus-range property of a PCI device
71  * @node: device node
72  * @res: address to a struct resource to return the bus-range
73  *
74  * Returns 0 on success or a negative error-code on failure.
75  */
of_pci_parse_bus_range(struct device_node * node,struct resource * res)76 int of_pci_parse_bus_range(struct device_node *node, struct resource *res)
77 {
78 	const __be32 *values;
79 	int len;
80 
81 	values = of_get_property(node, "bus-range", &len);
82 	if (!values || len < sizeof(*values) * 2)
83 		return -EINVAL;
84 
85 	res->name = node->name;
86 	res->start = be32_to_cpup(values++);
87 	res->end = be32_to_cpup(values);
88 	res->flags = IORESOURCE_BUS;
89 
90 	return 0;
91 }
92 EXPORT_SYMBOL_GPL(of_pci_parse_bus_range);
93 
94 /**
95  * This function will try to obtain the host bridge domain number by
96  * finding a property called "linux,pci-domain" of the given device node.
97  *
98  * @node: device tree node with the domain information
99  *
100  * Returns the associated domain number from DT in the range [0-0xffff], or
101  * a negative value if the required property is not found.
102  */
of_get_pci_domain_nr(struct device_node * node)103 int of_get_pci_domain_nr(struct device_node *node)
104 {
105 	const __be32 *value;
106 	int len;
107 	u16 domain;
108 
109 	value = of_get_property(node, "linux,pci-domain", &len);
110 	if (!value || len < sizeof(*value))
111 		return -EINVAL;
112 
113 	domain = (u16)be32_to_cpup(value);
114 
115 	return domain;
116 }
117 EXPORT_SYMBOL_GPL(of_get_pci_domain_nr);
118 
119 #if defined(CONFIG_OF_ADDRESS)
120 /**
121  * of_pci_get_host_bridge_resources - Parse PCI host bridge resources from DT
122  * @dev: device node of the host bridge having the range property
123  * @busno: bus number associated with the bridge root bus
124  * @bus_max: maximum number of buses for this bridge
125  * @resources: list where the range of resources will be added after DT parsing
126  * @io_base: pointer to a variable that will contain on return the physical
127  * address for the start of the I/O range. Can be NULL if the caller doesn't
128  * expect IO ranges to be present in the device tree.
129  *
130  * It is the caller's job to free the @resources list.
131  *
132  * This function will parse the "ranges" property of a PCI host bridge device
133  * node and setup the resource mapping based on its content. It is expected
134  * that the property conforms with the Power ePAPR document.
135  *
136  * It returns zero if the range parsing has been successful or a standard error
137  * value if it failed.
138  */
of_pci_get_host_bridge_resources(struct device_node * dev,unsigned char busno,unsigned char bus_max,struct list_head * resources,resource_size_t * io_base)139 int of_pci_get_host_bridge_resources(struct device_node *dev,
140 			unsigned char busno, unsigned char bus_max,
141 			struct list_head *resources, resource_size_t *io_base)
142 {
143 	struct pci_host_bridge_window *window;
144 	struct resource *res;
145 	struct resource *bus_range;
146 	struct of_pci_range range;
147 	struct of_pci_range_parser parser;
148 	char range_type[4];
149 	int err;
150 
151 	if (io_base)
152 		*io_base = (resource_size_t)OF_BAD_ADDR;
153 
154 	bus_range = kzalloc(sizeof(*bus_range), GFP_KERNEL);
155 	if (!bus_range)
156 		return -ENOMEM;
157 
158 	pr_info("PCI host bridge %s ranges:\n", dev->full_name);
159 
160 	err = of_pci_parse_bus_range(dev, bus_range);
161 	if (err) {
162 		bus_range->start = busno;
163 		bus_range->end = bus_max;
164 		bus_range->flags = IORESOURCE_BUS;
165 		pr_info("  No bus range found for %s, using %pR\n",
166 			dev->full_name, bus_range);
167 	} else {
168 		if (bus_range->end > bus_range->start + bus_max)
169 			bus_range->end = bus_range->start + bus_max;
170 	}
171 	pci_add_resource(resources, bus_range);
172 
173 	/* Check for ranges property */
174 	err = of_pci_range_parser_init(&parser, dev);
175 	if (err)
176 		goto parse_failed;
177 
178 	pr_debug("Parsing ranges property...\n");
179 	for_each_of_pci_range(&parser, &range) {
180 		/* Read next ranges element */
181 		if ((range.flags & IORESOURCE_TYPE_BITS) == IORESOURCE_IO)
182 			snprintf(range_type, 4, " IO");
183 		else if ((range.flags & IORESOURCE_TYPE_BITS) == IORESOURCE_MEM)
184 			snprintf(range_type, 4, "MEM");
185 		else
186 			snprintf(range_type, 4, "err");
187 		pr_info("  %s %#010llx..%#010llx -> %#010llx\n", range_type,
188 			range.cpu_addr, range.cpu_addr + range.size - 1,
189 			range.pci_addr);
190 
191 		/*
192 		 * If we failed translation or got a zero-sized region
193 		 * then skip this range
194 		 */
195 		if (range.cpu_addr == OF_BAD_ADDR || range.size == 0)
196 			continue;
197 
198 		res = kzalloc(sizeof(struct resource), GFP_KERNEL);
199 		if (!res) {
200 			err = -ENOMEM;
201 			goto parse_failed;
202 		}
203 
204 		err = of_pci_range_to_resource(&range, dev, res);
205 		if (err)
206 			goto conversion_failed;
207 
208 		if (resource_type(res) == IORESOURCE_IO) {
209 			if (!io_base) {
210 				pr_err("I/O range found for %s. Please provide an io_base pointer to save CPU base address\n",
211 					dev->full_name);
212 				err = -EINVAL;
213 				goto conversion_failed;
214 			}
215 			if (*io_base != (resource_size_t)OF_BAD_ADDR)
216 				pr_warn("More than one I/O resource converted for %s. CPU base address for old range lost!\n",
217 					dev->full_name);
218 			*io_base = range.cpu_addr;
219 		}
220 
221 		pci_add_resource_offset(resources, res,	res->start - range.pci_addr);
222 	}
223 
224 	return 0;
225 
226 conversion_failed:
227 	kfree(res);
228 parse_failed:
229 	list_for_each_entry(window, resources, list)
230 		kfree(window->res);
231 	pci_free_resource_list(resources);
232 	kfree(bus_range);
233 	return err;
234 }
235 EXPORT_SYMBOL_GPL(of_pci_get_host_bridge_resources);
236 #endif /* CONFIG_OF_ADDRESS */
237 
238 #ifdef CONFIG_PCI_MSI
239 
240 static LIST_HEAD(of_pci_msi_chip_list);
241 static DEFINE_MUTEX(of_pci_msi_chip_mutex);
242 
of_pci_msi_chip_add(struct msi_chip * chip)243 int of_pci_msi_chip_add(struct msi_chip *chip)
244 {
245 	if (!of_property_read_bool(chip->of_node, "msi-controller"))
246 		return -EINVAL;
247 
248 	mutex_lock(&of_pci_msi_chip_mutex);
249 	list_add(&chip->list, &of_pci_msi_chip_list);
250 	mutex_unlock(&of_pci_msi_chip_mutex);
251 
252 	return 0;
253 }
254 EXPORT_SYMBOL_GPL(of_pci_msi_chip_add);
255 
of_pci_msi_chip_remove(struct msi_chip * chip)256 void of_pci_msi_chip_remove(struct msi_chip *chip)
257 {
258 	mutex_lock(&of_pci_msi_chip_mutex);
259 	list_del(&chip->list);
260 	mutex_unlock(&of_pci_msi_chip_mutex);
261 }
262 EXPORT_SYMBOL_GPL(of_pci_msi_chip_remove);
263 
of_pci_find_msi_chip_by_node(struct device_node * of_node)264 struct msi_chip *of_pci_find_msi_chip_by_node(struct device_node *of_node)
265 {
266 	struct msi_chip *c;
267 
268 	mutex_lock(&of_pci_msi_chip_mutex);
269 	list_for_each_entry(c, &of_pci_msi_chip_list, list) {
270 		if (c->of_node == of_node) {
271 			mutex_unlock(&of_pci_msi_chip_mutex);
272 			return c;
273 		}
274 	}
275 	mutex_unlock(&of_pci_msi_chip_mutex);
276 
277 	return NULL;
278 }
279 EXPORT_SYMBOL_GPL(of_pci_find_msi_chip_by_node);
280 
281 #endif /* CONFIG_PCI_MSI */
282