Commit | Line | Data |
---|---|---|
af6074fc | 1 | // SPDX-License-Identifier: GPL-2.0+ |
3f23de10 SR |
2 | /* |
3 | * Copyright (C) 2006 Benjamin Herrenschmidt, IBM Corp. | |
4 | * <benh@kernel.crashing.org> | |
5 | * and Arnd Bergmann, IBM Corp. | |
6 | * Merged from powerpc/kernel/of_platform.c and | |
7 | * sparc{,64}/kernel/of_device.c by Stephen Rothwell | |
3f23de10 | 8 | */ |
606ad42a RH |
9 | |
10 | #define pr_fmt(fmt) "OF: " fmt | |
11 | ||
3f23de10 | 12 | #include <linux/errno.h> |
5c457083 | 13 | #include <linux/module.h> |
5de1540b | 14 | #include <linux/amba/bus.h> |
3f23de10 | 15 | #include <linux/device.h> |
5fd200f3 | 16 | #include <linux/dma-mapping.h> |
50ef5284 | 17 | #include <linux/slab.h> |
9e3288dc | 18 | #include <linux/of_address.h> |
3f23de10 | 19 | #include <linux/of_device.h> |
09515ef5 | 20 | #include <linux/of_iommu.h> |
9e3288dc | 21 | #include <linux/of_irq.h> |
3f23de10 | 22 | #include <linux/of_platform.h> |
eca39301 GL |
23 | #include <linux/platform_device.h> |
24 | ||
cbb49c26 GL |
25 | const struct of_device_id of_default_bus_match_table[] = { |
26 | { .compatible = "simple-bus", }, | |
22869a9e | 27 | { .compatible = "simple-mfd", }, |
ecd76ede | 28 | { .compatible = "isa", }, |
cbb49c26 GL |
29 | #ifdef CONFIG_ARM_AMBA |
30 | { .compatible = "arm,amba-bus", }, | |
31 | #endif /* CONFIG_ARM_AMBA */ | |
32 | {} /* Empty terminated list */ | |
33 | }; | |
34 | ||
4550fe63 VK |
35 | static const struct of_device_id of_skipped_node_table[] = { |
36 | { .compatible = "operating-points-v2", }, | |
37 | {} /* Empty terminated list */ | |
38 | }; | |
39 | ||
c6085584 JB |
40 | /** |
41 | * of_find_device_by_node - Find the platform_device associated with a node | |
42 | * @np: Pointer to device tree node | |
43 | * | |
4fb373df JH |
44 | * Takes a reference to the embedded struct device which needs to be dropped |
45 | * after use. | |
46 | * | |
c6085584 JB |
47 | * Returns platform_device pointer, or NULL if not found |
48 | */ | |
49 | struct platform_device *of_find_device_by_node(struct device_node *np) | |
50 | { | |
51 | struct device *dev; | |
52 | ||
cfba5de9 | 53 | dev = bus_find_device_by_of_node(&platform_bus_type, np); |
c6085584 JB |
54 | return dev ? to_platform_device(dev) : NULL; |
55 | } | |
56 | EXPORT_SYMBOL(of_find_device_by_node); | |
57 | ||
964dba28 | 58 | #ifdef CONFIG_OF_ADDRESS |
5fd200f3 GL |
59 | /* |
60 | * The following routines scan a subtree and registers a device for | |
61 | * each applicable node. | |
62 | * | |
63 | * Note: sparc doesn't use these routines because it has a different | |
64 | * mechanism for creating devices from device tree nodes. | |
65 | */ | |
66 | ||
94c09319 GL |
67 | /** |
68 | * of_device_make_bus_id - Use the device node data to assign a unique name | |
69 | * @dev: pointer to device structure that is linked to a device tree node | |
70 | * | |
07e461cd GL |
71 | * This routine will first try using the translated bus address to |
72 | * derive a unique name. If it cannot, then it will prepend names from | |
73 | * parent nodes until a unique name can be derived. | |
94c09319 | 74 | */ |
e553f539 | 75 | static void of_device_make_bus_id(struct device *dev) |
94c09319 | 76 | { |
94c09319 | 77 | struct device_node *node = dev->of_node; |
24fb530f | 78 | const __be32 *reg; |
94c09319 | 79 | u64 addr; |
94c09319 | 80 | |
07e461cd GL |
81 | /* Construct the name, using parent nodes if necessary to ensure uniqueness */ |
82 | while (node->parent) { | |
83 | /* | |
84 | * If the address can be translated, then that is as much | |
85 | * uniqueness as we need. Make it the first component and return | |
86 | */ | |
87 | reg = of_get_property(node, "reg", NULL); | |
88 | if (reg && (addr = of_translate_address(node, reg)) != OF_BAD_ADDR) { | |
a613b26a | 89 | dev_set_name(dev, dev_name(dev) ? "%llx.%pOFn:%s" : "%llx.%pOFn", |
d88590dc | 90 | addr, node, dev_name(dev)); |
94c09319 GL |
91 | return; |
92 | } | |
94c09319 | 93 | |
07e461cd GL |
94 | /* format arguments only used if dev_name() resolves to NULL */ |
95 | dev_set_name(dev, dev_name(dev) ? "%s:%s" : "%s", | |
95e6b1fa | 96 | kbasename(node->full_name), dev_name(dev)); |
07e461cd GL |
97 | node = node->parent; |
98 | } | |
94c09319 GL |
99 | } |
100 | ||
101 | /** | |
102 | * of_device_alloc - Allocate and initialize an of_device | |
103 | * @np: device node to assign to device | |
104 | * @bus_id: Name to assign to the device. May be null to use default name. | |
105 | * @parent: Parent device. | |
106 | */ | |
94a0cb1f | 107 | struct platform_device *of_device_alloc(struct device_node *np, |
94c09319 GL |
108 | const char *bus_id, |
109 | struct device *parent) | |
110 | { | |
94a0cb1f | 111 | struct platform_device *dev; |
52f6537c | 112 | int rc, i, num_reg = 0, num_irq; |
ac80a51e GL |
113 | struct resource *res, temp_res; |
114 | ||
6d7e3bf8 | 115 | dev = platform_device_alloc("", PLATFORM_DEVID_NONE); |
7096d042 GL |
116 | if (!dev) |
117 | return NULL; | |
118 | ||
119 | /* count the io and irq resources */ | |
d9c6866b RH |
120 | while (of_address_to_resource(np, num_reg, &temp_res) == 0) |
121 | num_reg++; | |
52f6537c | 122 | num_irq = of_irq_count(np); |
ac80a51e | 123 | |
ac80a51e GL |
124 | /* Populate the resource table */ |
125 | if (num_irq || num_reg) { | |
6396bb22 | 126 | res = kcalloc(num_irq + num_reg, sizeof(*res), GFP_KERNEL); |
7096d042 GL |
127 | if (!res) { |
128 | platform_device_put(dev); | |
129 | return NULL; | |
130 | } | |
131 | ||
ac80a51e GL |
132 | dev->num_resources = num_reg + num_irq; |
133 | dev->resource = res; | |
134 | for (i = 0; i < num_reg; i++, res++) { | |
135 | rc = of_address_to_resource(np, i, res); | |
136 | WARN_ON(rc); | |
137 | } | |
9ec36caf | 138 | if (of_irq_to_resource_table(np, res, num_irq) != num_irq) |
a613b26a RH |
139 | pr_debug("not all legacy IRQ resources mapped for %pOFn\n", |
140 | np); | |
ac80a51e | 141 | } |
94c09319 GL |
142 | |
143 | dev->dev.of_node = of_node_get(np); | |
f94277af | 144 | dev->dev.fwnode = &np->fwnode; |
43c0767e | 145 | dev->dev.parent = parent ? : &platform_bus; |
94c09319 GL |
146 | |
147 | if (bus_id) | |
148 | dev_set_name(&dev->dev, "%s", bus_id); | |
149 | else | |
150 | of_device_make_bus_id(&dev->dev); | |
151 | ||
152 | return dev; | |
153 | } | |
154 | EXPORT_SYMBOL(of_device_alloc); | |
155 | ||
5fd200f3 | 156 | /** |
15c3597d | 157 | * of_platform_device_create_pdata - Alloc, initialize and register an of_device |
5fd200f3 GL |
158 | * @np: pointer to node to create device for |
159 | * @bus_id: name to assign device | |
15c3597d | 160 | * @platform_data: pointer to populate platform_data pointer with |
5fd200f3 | 161 | * @parent: Linux device model parent device. |
cd1e6504 GL |
162 | * |
163 | * Returns pointer to created platform device, or NULL if a device was not | |
164 | * registered. Unavailable devices will not get registered. | |
5fd200f3 | 165 | */ |
245d9641 | 166 | static struct platform_device *of_platform_device_create_pdata( |
15c3597d GL |
167 | struct device_node *np, |
168 | const char *bus_id, | |
169 | void *platform_data, | |
170 | struct device *parent) | |
5fd200f3 | 171 | { |
94a0cb1f | 172 | struct platform_device *dev; |
5fd200f3 | 173 | |
c6e126de PM |
174 | if (!of_device_is_available(np) || |
175 | of_node_test_and_set_flag(np, OF_POPULATED)) | |
cd1e6504 GL |
176 | return NULL; |
177 | ||
5fd200f3 GL |
178 | dev = of_device_alloc(np, bus_id, parent); |
179 | if (!dev) | |
c6e126de | 180 | goto err_clear_flag; |
5fd200f3 | 181 | |
a5516219 RM |
182 | dev->dev.coherent_dma_mask = DMA_BIT_MASK(32); |
183 | if (!dev->dev.dma_mask) | |
184 | dev->dev.dma_mask = &dev->dev.coherent_dma_mask; | |
eca39301 | 185 | dev->dev.bus = &platform_bus_type; |
15c3597d | 186 | dev->dev.platform_data = platform_data; |
c706c239 | 187 | of_msi_configure(&dev->dev, dev->dev.of_node); |
5fd200f3 | 188 | |
7096d042 GL |
189 | if (of_device_add(dev) != 0) { |
190 | platform_device_put(dev); | |
c6e126de | 191 | goto err_clear_flag; |
5fd200f3 GL |
192 | } |
193 | ||
194 | return dev; | |
c6e126de PM |
195 | |
196 | err_clear_flag: | |
197 | of_node_clear_flag(np, OF_POPULATED); | |
198 | return NULL; | |
5fd200f3 | 199 | } |
15c3597d GL |
200 | |
201 | /** | |
202 | * of_platform_device_create - Alloc, initialize and register an of_device | |
203 | * @np: pointer to node to create device for | |
204 | * @bus_id: name to assign device | |
205 | * @parent: Linux device model parent device. | |
206 | * | |
207 | * Returns pointer to created platform device, or NULL if a device was not | |
208 | * registered. Unavailable devices will not get registered. | |
209 | */ | |
210 | struct platform_device *of_platform_device_create(struct device_node *np, | |
211 | const char *bus_id, | |
212 | struct device *parent) | |
213 | { | |
214 | return of_platform_device_create_pdata(np, bus_id, NULL, parent); | |
215 | } | |
5fd200f3 GL |
216 | EXPORT_SYMBOL(of_platform_device_create); |
217 | ||
5de1540b GL |
218 | #ifdef CONFIG_ARM_AMBA |
219 | static struct amba_device *of_amba_device_create(struct device_node *node, | |
220 | const char *bus_id, | |
221 | void *platform_data, | |
222 | struct device *parent) | |
223 | { | |
224 | struct amba_device *dev; | |
225 | const void *prop; | |
226 | int i, ret; | |
227 | ||
0d638a07 | 228 | pr_debug("Creating amba device %pOF\n", node); |
5de1540b | 229 | |
c6e126de PM |
230 | if (!of_device_is_available(node) || |
231 | of_node_test_and_set_flag(node, OF_POPULATED)) | |
5de1540b GL |
232 | return NULL; |
233 | ||
c0f72f8a | 234 | dev = amba_device_alloc(NULL, 0, 0); |
606ad42a | 235 | if (!dev) |
c6e126de | 236 | goto err_clear_flag; |
5de1540b | 237 | |
8c89ef7b LW |
238 | /* AMBA devices only support a single DMA mask */ |
239 | dev->dev.coherent_dma_mask = DMA_BIT_MASK(32); | |
240 | dev->dev.dma_mask = &dev->dev.coherent_dma_mask; | |
241 | ||
5de1540b | 242 | /* setup generic device info */ |
5de1540b | 243 | dev->dev.of_node = of_node_get(node); |
f94277af | 244 | dev->dev.fwnode = &node->fwnode; |
43c0767e | 245 | dev->dev.parent = parent ? : &platform_bus; |
5de1540b GL |
246 | dev->dev.platform_data = platform_data; |
247 | if (bus_id) | |
248 | dev_set_name(&dev->dev, "%s", bus_id); | |
249 | else | |
250 | of_device_make_bus_id(&dev->dev); | |
251 | ||
5de1540b GL |
252 | /* Allow the HW Peripheral ID to be overridden */ |
253 | prop = of_get_property(node, "arm,primecell-periphid", NULL); | |
254 | if (prop) | |
255 | dev->periphid = of_read_ulong(prop, 1); | |
256 | ||
257 | /* Decode the IRQs and address ranges */ | |
258 | for (i = 0; i < AMBA_NR_IRQS; i++) | |
259 | dev->irq[i] = irq_of_parse_and_map(node, i); | |
260 | ||
261 | ret = of_address_to_resource(node, 0, &dev->res); | |
2bc552df | 262 | if (ret) { |
0d638a07 RH |
263 | pr_err("amba: of_address_to_resource() failed (%d) for %pOF\n", |
264 | ret, node); | |
5de1540b | 265 | goto err_free; |
2bc552df | 266 | } |
5de1540b | 267 | |
c0f72f8a | 268 | ret = amba_device_add(dev, &iomem_resource); |
2bc552df | 269 | if (ret) { |
0d638a07 RH |
270 | pr_err("amba_device_add() failed (%d) for %pOF\n", |
271 | ret, node); | |
5de1540b | 272 | goto err_free; |
2bc552df | 273 | } |
5de1540b GL |
274 | |
275 | return dev; | |
276 | ||
277 | err_free: | |
c0f72f8a | 278 | amba_device_put(dev); |
c6e126de PM |
279 | err_clear_flag: |
280 | of_node_clear_flag(node, OF_POPULATED); | |
5de1540b GL |
281 | return NULL; |
282 | } | |
283 | #else /* CONFIG_ARM_AMBA */ | |
284 | static struct amba_device *of_amba_device_create(struct device_node *node, | |
285 | const char *bus_id, | |
286 | void *platform_data, | |
287 | struct device *parent) | |
288 | { | |
289 | return NULL; | |
290 | } | |
291 | #endif /* CONFIG_ARM_AMBA */ | |
292 | ||
15c3597d GL |
293 | /** |
294 | * of_devname_lookup() - Given a device node, lookup the preferred Linux name | |
295 | */ | |
296 | static const struct of_dev_auxdata *of_dev_lookup(const struct of_dev_auxdata *lookup, | |
297 | struct device_node *np) | |
298 | { | |
fc5cf80a | 299 | const struct of_dev_auxdata *auxdata; |
15c3597d | 300 | struct resource res; |
fc5cf80a | 301 | int compatible = 0; |
303f59d1 OJ |
302 | |
303 | if (!lookup) | |
304 | return NULL; | |
305 | ||
fc5cf80a TL |
306 | auxdata = lookup; |
307 | for (; auxdata->compatible; auxdata++) { | |
308 | if (!of_device_is_compatible(np, auxdata->compatible)) | |
303f59d1 | 309 | continue; |
fc5cf80a | 310 | compatible++; |
84774e61 | 311 | if (!of_address_to_resource(np, 0, &res)) |
fc5cf80a | 312 | if (res.start != auxdata->phys_addr) |
84774e61 | 313 | continue; |
0d638a07 | 314 | pr_debug("%pOF: devname=%s\n", np, auxdata->name); |
fc5cf80a TL |
315 | return auxdata; |
316 | } | |
317 | ||
318 | if (!compatible) | |
319 | return NULL; | |
320 | ||
321 | /* Try compatible match if no phys_addr and name are specified */ | |
322 | auxdata = lookup; | |
323 | for (; auxdata->compatible; auxdata++) { | |
324 | if (!of_device_is_compatible(np, auxdata->compatible)) | |
325 | continue; | |
326 | if (!auxdata->phys_addr && !auxdata->name) { | |
0d638a07 | 327 | pr_debug("%pOF: compatible match\n", np); |
fc5cf80a TL |
328 | return auxdata; |
329 | } | |
15c3597d | 330 | } |
303f59d1 | 331 | |
15c3597d GL |
332 | return NULL; |
333 | } | |
334 | ||
5fd200f3 | 335 | /** |
38e9e21d | 336 | * of_platform_bus_create() - Create a device for a node and its children. |
5fd200f3 | 337 | * @bus: device node of the bus to instantiate |
1eed4c07 | 338 | * @matches: match table for bus nodes |
303f59d1 | 339 | * @lookup: auxdata table for matching id and platform_data with device nodes |
38e9e21d | 340 | * @parent: parent for new device, or NULL for top level. |
303f59d1 | 341 | * @strict: require compatible property |
38e9e21d GL |
342 | * |
343 | * Creates a platform_device for the provided device_node, and optionally | |
344 | * recursively create devices for all the child nodes. | |
5fd200f3 | 345 | */ |
38e9e21d | 346 | static int of_platform_bus_create(struct device_node *bus, |
5fd200f3 | 347 | const struct of_device_id *matches, |
15c3597d | 348 | const struct of_dev_auxdata *lookup, |
29d4f8a4 | 349 | struct device *parent, bool strict) |
5fd200f3 | 350 | { |
15c3597d | 351 | const struct of_dev_auxdata *auxdata; |
5fd200f3 | 352 | struct device_node *child; |
94a0cb1f | 353 | struct platform_device *dev; |
15c3597d GL |
354 | const char *bus_id = NULL; |
355 | void *platform_data = NULL; | |
5fd200f3 GL |
356 | int rc = 0; |
357 | ||
29d4f8a4 GL |
358 | /* Make sure it has a compatible property */ |
359 | if (strict && (!of_get_property(bus, "compatible", NULL))) { | |
0d638a07 RH |
360 | pr_debug("%s() - skipping %pOF, no compatible prop\n", |
361 | __func__, bus); | |
29d4f8a4 GL |
362 | return 0; |
363 | } | |
364 | ||
4550fe63 VK |
365 | /* Skip nodes for which we don't want to create devices */ |
366 | if (unlikely(of_match_node(of_skipped_node_table, bus))) { | |
367 | pr_debug("%s() - skipping %pOF node\n", __func__, bus); | |
368 | return 0; | |
369 | } | |
370 | ||
44a7185c | 371 | if (of_node_check_flag(bus, OF_POPULATED_BUS)) { |
0d638a07 RH |
372 | pr_debug("%s() - skipping %pOF, already populated\n", |
373 | __func__, bus); | |
44a7185c KW |
374 | return 0; |
375 | } | |
376 | ||
15c3597d GL |
377 | auxdata = of_dev_lookup(lookup, bus); |
378 | if (auxdata) { | |
379 | bus_id = auxdata->name; | |
380 | platform_data = auxdata->platform_data; | |
381 | } | |
382 | ||
5de1540b | 383 | if (of_device_is_compatible(bus, "arm,primecell")) { |
2bc552df BZ |
384 | /* |
385 | * Don't return an error here to keep compatibility with older | |
386 | * device tree files. | |
387 | */ | |
15c3597d | 388 | of_amba_device_create(bus, bus_id, platform_data, parent); |
5de1540b GL |
389 | return 0; |
390 | } | |
391 | ||
15c3597d | 392 | dev = of_platform_device_create_pdata(bus, bus_id, platform_data, parent); |
38e9e21d GL |
393 | if (!dev || !of_match_node(matches, bus)) |
394 | return 0; | |
395 | ||
5fd200f3 | 396 | for_each_child_of_node(bus, child) { |
0d638a07 | 397 | pr_debug(" create child: %pOF\n", child); |
15c3597d | 398 | rc = of_platform_bus_create(child, matches, lookup, &dev->dev, strict); |
5fd200f3 GL |
399 | if (rc) { |
400 | of_node_put(child); | |
401 | break; | |
402 | } | |
403 | } | |
75f353b6 | 404 | of_node_set_flag(bus, OF_POPULATED_BUS); |
5fd200f3 GL |
405 | return rc; |
406 | } | |
407 | ||
408 | /** | |
38e9e21d | 409 | * of_platform_bus_probe() - Probe the device-tree for platform buses |
5fd200f3 | 410 | * @root: parent of the first level to probe or NULL for the root of the tree |
1eed4c07 | 411 | * @matches: match table for bus nodes |
5fd200f3 GL |
412 | * @parent: parent to hook devices from, NULL for toplevel |
413 | * | |
414 | * Note that children of the provided root are not instantiated as devices | |
415 | * unless the specified root itself matches the bus list and is not NULL. | |
416 | */ | |
417 | int of_platform_bus_probe(struct device_node *root, | |
418 | const struct of_device_id *matches, | |
419 | struct device *parent) | |
420 | { | |
421 | struct device_node *child; | |
5fd200f3 GL |
422 | int rc = 0; |
423 | ||
1eed4c07 GL |
424 | root = root ? of_node_get(root) : of_find_node_by_path("/"); |
425 | if (!root) | |
60d59913 | 426 | return -EINVAL; |
5fd200f3 | 427 | |
44a7185c | 428 | pr_debug("%s()\n", __func__); |
0d638a07 | 429 | pr_debug(" starting at: %pOF\n", root); |
5fd200f3 | 430 | |
1eed4c07 | 431 | /* Do a self check of bus type, if there's a match, create children */ |
5fd200f3 | 432 | if (of_match_node(matches, root)) { |
15c3597d | 433 | rc = of_platform_bus_create(root, matches, NULL, parent, false); |
38e9e21d | 434 | } else for_each_child_of_node(root, child) { |
5fd200f3 GL |
435 | if (!of_match_node(matches, child)) |
436 | continue; | |
15c3597d | 437 | rc = of_platform_bus_create(child, matches, NULL, parent, false); |
7fad948a JL |
438 | if (rc) { |
439 | of_node_put(child); | |
5fd200f3 | 440 | break; |
7fad948a | 441 | } |
5fd200f3 | 442 | } |
38e9e21d | 443 | |
5fd200f3 GL |
444 | of_node_put(root); |
445 | return rc; | |
446 | } | |
447 | EXPORT_SYMBOL(of_platform_bus_probe); | |
29d4f8a4 GL |
448 | |
449 | /** | |
450 | * of_platform_populate() - Populate platform_devices from device tree data | |
451 | * @root: parent of the first level to probe or NULL for the root of the tree | |
452 | * @matches: match table, NULL to use the default | |
92039ed1 | 453 | * @lookup: auxdata table for matching id and platform_data with device nodes |
29d4f8a4 GL |
454 | * @parent: parent to hook devices from, NULL for toplevel |
455 | * | |
456 | * Similar to of_platform_bus_probe(), this function walks the device tree | |
457 | * and creates devices from nodes. It differs in that it follows the modern | |
458 | * convention of requiring all device nodes to have a 'compatible' property, | |
459 | * and it is suitable for creating devices which are children of the root | |
460 | * node (of_platform_bus_probe will only create children of the root which | |
461 | * are selected by the @matches argument). | |
462 | * | |
463 | * New board support should be using this function instead of | |
464 | * of_platform_bus_probe(). | |
465 | * | |
466 | * Returns 0 on success, < 0 on failure. | |
467 | */ | |
468 | int of_platform_populate(struct device_node *root, | |
469 | const struct of_device_id *matches, | |
15c3597d | 470 | const struct of_dev_auxdata *lookup, |
29d4f8a4 GL |
471 | struct device *parent) |
472 | { | |
473 | struct device_node *child; | |
474 | int rc = 0; | |
475 | ||
476 | root = root ? of_node_get(root) : of_find_node_by_path("/"); | |
477 | if (!root) | |
478 | return -EINVAL; | |
479 | ||
44a7185c | 480 | pr_debug("%s()\n", __func__); |
0d638a07 | 481 | pr_debug(" starting at: %pOF\n", root); |
44a7185c | 482 | |
5e666938 | 483 | device_links_supplier_sync_state_pause(); |
29d4f8a4 | 484 | for_each_child_of_node(root, child) { |
15c3597d | 485 | rc = of_platform_bus_create(child, matches, lookup, parent, true); |
7fad948a JL |
486 | if (rc) { |
487 | of_node_put(child); | |
29d4f8a4 | 488 | break; |
7fad948a | 489 | } |
29d4f8a4 | 490 | } |
5e666938 SK |
491 | device_links_supplier_sync_state_resume(); |
492 | ||
2d0747c4 | 493 | of_node_set_flag(root, OF_POPULATED_BUS); |
29d4f8a4 GL |
494 | |
495 | of_node_put(root); | |
496 | return rc; | |
497 | } | |
e001f1c8 | 498 | EXPORT_SYMBOL_GPL(of_platform_populate); |
c6e126de | 499 | |
43443ad6 HM |
500 | int of_platform_default_populate(struct device_node *root, |
501 | const struct of_dev_auxdata *lookup, | |
502 | struct device *parent) | |
503 | { | |
504 | return of_platform_populate(root, of_default_bus_match_table, lookup, | |
505 | parent); | |
506 | } | |
507 | EXPORT_SYMBOL_GPL(of_platform_default_populate); | |
508 | ||
fc520f8b | 509 | #ifndef CONFIG_PPC |
a50ff19d | 510 | static const struct of_device_id reserved_mem_matches[] = { |
d1de6d6c | 511 | { .compatible = "qcom,rmtfs-mem" }, |
312416d9 | 512 | { .compatible = "qcom,cmd-db" }, |
a50ff19d BA |
513 | { .compatible = "ramoops" }, |
514 | {} | |
515 | }; | |
516 | ||
44a7185c KW |
517 | static int __init of_platform_default_populate_init(void) |
518 | { | |
529182e2 KC |
519 | struct device_node *node; |
520 | ||
51ba8b3a SK |
521 | device_links_supplier_sync_state_pause(); |
522 | ||
529182e2 KC |
523 | if (!of_have_populated_dt()) |
524 | return -ENODEV; | |
525 | ||
526 | /* | |
a50ff19d BA |
527 | * Handle certain compatibles explicitly, since we don't want to create |
528 | * platform_devices for every node in /reserved-memory with a | |
529 | * "compatible", | |
529182e2 | 530 | */ |
a50ff19d BA |
531 | for_each_matching_node(node, reserved_mem_matches) |
532 | of_platform_device_create(node, NULL, NULL); | |
529182e2 | 533 | |
3aa0582f | 534 | node = of_find_node_by_path("/firmware"); |
e2105ca8 | 535 | if (node) { |
3aa0582f | 536 | of_platform_populate(node, NULL, NULL, NULL); |
e2105ca8 SH |
537 | of_node_put(node); |
538 | } | |
3aa0582f | 539 | |
529182e2 KC |
540 | /* Populate everything else. */ |
541 | of_platform_default_populate(NULL, NULL, NULL); | |
44a7185c KW |
542 | |
543 | return 0; | |
544 | } | |
545 | arch_initcall_sync(of_platform_default_populate_init); | |
5e666938 SK |
546 | |
547 | static int __init of_platform_sync_state_init(void) | |
548 | { | |
51ba8b3a | 549 | device_links_supplier_sync_state_resume(); |
5e666938 SK |
550 | return 0; |
551 | } | |
552 | late_initcall_sync(of_platform_sync_state_init); | |
fc520f8b | 553 | #endif |
44a7185c | 554 | |
c2372c20 | 555 | int of_platform_device_destroy(struct device *dev, void *data) |
c6e126de | 556 | { |
c6e126de | 557 | /* Do not touch devices not populated from the device tree */ |
75f353b6 | 558 | if (!dev->of_node || !of_node_check_flag(dev->of_node, OF_POPULATED)) |
c6e126de | 559 | return 0; |
c6e126de | 560 | |
75f353b6 GL |
561 | /* Recurse for any nodes that were treated as busses */ |
562 | if (of_node_check_flag(dev->of_node, OF_POPULATED_BUS)) | |
563 | device_for_each_child(dev, NULL, of_platform_device_destroy); | |
c6e126de | 564 | |
522811e9 SK |
565 | of_node_clear_flag(dev->of_node, OF_POPULATED); |
566 | of_node_clear_flag(dev->of_node, OF_POPULATED_BUS); | |
567 | ||
c6e126de PM |
568 | if (dev->bus == &platform_bus_type) |
569 | platform_device_unregister(to_platform_device(dev)); | |
570 | #ifdef CONFIG_ARM_AMBA | |
571 | else if (dev->bus == &amba_bustype) | |
572 | amba_device_unregister(to_amba_device(dev)); | |
573 | #endif | |
c6e126de | 574 | |
c6e126de PM |
575 | return 0; |
576 | } | |
c2372c20 | 577 | EXPORT_SYMBOL_GPL(of_platform_device_destroy); |
c6e126de PM |
578 | |
579 | /** | |
580 | * of_platform_depopulate() - Remove devices populated from device tree | |
75f353b6 | 581 | * @parent: device which children will be removed |
c6e126de PM |
582 | * |
583 | * Complementary to of_platform_populate(), this function removes children | |
584 | * of the given device (and, recurrently, their children) that have been | |
585 | * created from their respective device tree nodes (and only those, | |
586 | * leaving others - eg. manually created - unharmed). | |
c6e126de | 587 | */ |
75f353b6 | 588 | void of_platform_depopulate(struct device *parent) |
c6e126de | 589 | { |
2d0747c4 GL |
590 | if (parent->of_node && of_node_check_flag(parent->of_node, OF_POPULATED_BUS)) { |
591 | device_for_each_child(parent, NULL, of_platform_device_destroy); | |
592 | of_node_clear_flag(parent->of_node, OF_POPULATED_BUS); | |
593 | } | |
c6e126de PM |
594 | } |
595 | EXPORT_SYMBOL_GPL(of_platform_depopulate); | |
596 | ||
38b0b219 BG |
597 | static void devm_of_platform_populate_release(struct device *dev, void *res) |
598 | { | |
599 | of_platform_depopulate(*(struct device **)res); | |
600 | } | |
601 | ||
602 | /** | |
603 | * devm_of_platform_populate() - Populate platform_devices from device tree data | |
604 | * @dev: device that requested to populate from device tree data | |
605 | * | |
606 | * Similar to of_platform_populate(), but will automatically call | |
607 | * of_platform_depopulate() when the device is unbound from the bus. | |
608 | * | |
609 | * Returns 0 on success, < 0 on failure. | |
610 | */ | |
611 | int devm_of_platform_populate(struct device *dev) | |
612 | { | |
613 | struct device **ptr; | |
614 | int ret; | |
615 | ||
616 | if (!dev) | |
617 | return -EINVAL; | |
618 | ||
619 | ptr = devres_alloc(devm_of_platform_populate_release, | |
620 | sizeof(*ptr), GFP_KERNEL); | |
621 | if (!ptr) | |
622 | return -ENOMEM; | |
623 | ||
624 | ret = of_platform_populate(dev->of_node, NULL, NULL, dev); | |
625 | if (ret) { | |
626 | devres_free(ptr); | |
627 | } else { | |
628 | *ptr = dev; | |
629 | devres_add(dev, ptr); | |
630 | } | |
631 | ||
632 | return ret; | |
633 | } | |
634 | EXPORT_SYMBOL_GPL(devm_of_platform_populate); | |
635 | ||
636 | static int devm_of_platform_match(struct device *dev, void *res, void *data) | |
637 | { | |
638 | struct device **ptr = res; | |
639 | ||
640 | if (!ptr) { | |
641 | WARN_ON(!ptr); | |
642 | return 0; | |
643 | } | |
644 | ||
645 | return *ptr == data; | |
646 | } | |
647 | ||
648 | /** | |
649 | * devm_of_platform_depopulate() - Remove devices populated from device tree | |
650 | * @dev: device that requested to depopulate from device tree data | |
651 | * | |
652 | * Complementary to devm_of_platform_populate(), this function removes children | |
653 | * of the given device (and, recurrently, their children) that have been | |
654 | * created from their respective device tree nodes (and only those, | |
655 | * leaving others - eg. manually created - unharmed). | |
656 | */ | |
657 | void devm_of_platform_depopulate(struct device *dev) | |
658 | { | |
659 | int ret; | |
660 | ||
661 | ret = devres_release(dev, devm_of_platform_populate_release, | |
662 | devm_of_platform_match, dev); | |
663 | ||
664 | WARN_ON(ret); | |
665 | } | |
666 | EXPORT_SYMBOL_GPL(devm_of_platform_depopulate); | |
667 | ||
801d728c PA |
668 | #ifdef CONFIG_OF_DYNAMIC |
669 | static int of_platform_notify(struct notifier_block *nb, | |
670 | unsigned long action, void *arg) | |
671 | { | |
672 | struct of_reconfig_data *rd = arg; | |
673 | struct platform_device *pdev_parent, *pdev; | |
674 | bool children_left; | |
675 | ||
676 | switch (of_reconfig_get_state_change(action, rd)) { | |
677 | case OF_RECONFIG_CHANGE_ADD: | |
678 | /* verify that the parent is a bus */ | |
679 | if (!of_node_check_flag(rd->dn->parent, OF_POPULATED_BUS)) | |
680 | return NOTIFY_OK; /* not for us */ | |
681 | ||
15204ab1 PA |
682 | /* already populated? (driver using of_populate manually) */ |
683 | if (of_node_check_flag(rd->dn, OF_POPULATED)) | |
684 | return NOTIFY_OK; | |
685 | ||
801d728c PA |
686 | /* pdev_parent may be NULL when no bus platform device */ |
687 | pdev_parent = of_find_device_by_node(rd->dn->parent); | |
688 | pdev = of_platform_device_create(rd->dn, NULL, | |
689 | pdev_parent ? &pdev_parent->dev : NULL); | |
690 | of_dev_put(pdev_parent); | |
691 | ||
692 | if (pdev == NULL) { | |
0d638a07 RH |
693 | pr_err("%s: failed to create for '%pOF'\n", |
694 | __func__, rd->dn); | |
801d728c PA |
695 | /* of_platform_device_create tosses the error code */ |
696 | return notifier_from_errno(-EINVAL); | |
697 | } | |
698 | break; | |
699 | ||
700 | case OF_RECONFIG_CHANGE_REMOVE: | |
15204ab1 PA |
701 | |
702 | /* already depopulated? */ | |
703 | if (!of_node_check_flag(rd->dn, OF_POPULATED)) | |
704 | return NOTIFY_OK; | |
705 | ||
801d728c PA |
706 | /* find our device by node */ |
707 | pdev = of_find_device_by_node(rd->dn); | |
708 | if (pdev == NULL) | |
709 | return NOTIFY_OK; /* no? not meant for us */ | |
710 | ||
711 | /* unregister takes one ref away */ | |
712 | of_platform_device_destroy(&pdev->dev, &children_left); | |
713 | ||
714 | /* and put the reference of the find */ | |
715 | of_dev_put(pdev); | |
716 | break; | |
717 | } | |
718 | ||
719 | return NOTIFY_OK; | |
720 | } | |
721 | ||
722 | static struct notifier_block platform_of_notifier = { | |
723 | .notifier_call = of_platform_notify, | |
724 | }; | |
725 | ||
726 | void of_platform_register_reconfig_notifier(void) | |
727 | { | |
728 | WARN_ON(of_reconfig_notifier_register(&platform_of_notifier)); | |
729 | } | |
730 | #endif /* CONFIG_OF_DYNAMIC */ | |
731 | ||
964dba28 | 732 | #endif /* CONFIG_OF_ADDRESS */ |