xref: /openbmc/linux/drivers/of/platform.c (revision ef04d280)
1 // SPDX-License-Identifier: GPL-2.0+
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
8  */
9 
10 #define pr_fmt(fmt)	"OF: " fmt
11 
12 #include <linux/errno.h>
13 #include <linux/module.h>
14 #include <linux/amba/bus.h>
15 #include <linux/device.h>
16 #include <linux/dma-mapping.h>
17 #include <linux/slab.h>
18 #include <linux/of_address.h>
19 #include <linux/of_device.h>
20 #include <linux/of_irq.h>
21 #include <linux/of_platform.h>
22 #include <linux/platform_device.h>
23 
24 #include "of_private.h"
25 
26 const struct of_device_id of_default_bus_match_table[] = {
27 	{ .compatible = "simple-bus", },
28 	{ .compatible = "simple-mfd", },
29 	{ .compatible = "isa", },
30 #ifdef CONFIG_ARM_AMBA
31 	{ .compatible = "arm,amba-bus", },
32 #endif /* CONFIG_ARM_AMBA */
33 	{} /* Empty terminated list */
34 };
35 
36 /**
37  * of_find_device_by_node - Find the platform_device associated with a node
38  * @np: Pointer to device tree node
39  *
40  * Takes a reference to the embedded struct device which needs to be dropped
41  * after use.
42  *
43  * Return: platform_device pointer, or NULL if not found
44  */
of_find_device_by_node(struct device_node * np)45 struct platform_device *of_find_device_by_node(struct device_node *np)
46 {
47 	struct device *dev;
48 
49 	dev = bus_find_device_by_of_node(&platform_bus_type, np);
50 	return dev ? to_platform_device(dev) : NULL;
51 }
52 EXPORT_SYMBOL(of_find_device_by_node);
53 
of_device_add(struct platform_device * ofdev)54 int of_device_add(struct platform_device *ofdev)
55 {
56 	BUG_ON(ofdev->dev.of_node == NULL);
57 
58 	/* name and id have to be set so that the platform bus doesn't get
59 	 * confused on matching */
60 	ofdev->name = dev_name(&ofdev->dev);
61 	ofdev->id = PLATFORM_DEVID_NONE;
62 
63 	/*
64 	 * If this device has not binding numa node in devicetree, that is
65 	 * of_node_to_nid returns NUMA_NO_NODE. device_add will assume that this
66 	 * device is on the same node as the parent.
67 	 */
68 	set_dev_node(&ofdev->dev, of_node_to_nid(ofdev->dev.of_node));
69 
70 	return device_add(&ofdev->dev);
71 }
72 
of_device_register(struct platform_device * pdev)73 int of_device_register(struct platform_device *pdev)
74 {
75 	device_initialize(&pdev->dev);
76 	return of_device_add(pdev);
77 }
78 EXPORT_SYMBOL(of_device_register);
79 
of_device_unregister(struct platform_device * ofdev)80 void of_device_unregister(struct platform_device *ofdev)
81 {
82 	device_unregister(&ofdev->dev);
83 }
84 EXPORT_SYMBOL(of_device_unregister);
85 
86 #ifdef CONFIG_OF_ADDRESS
87 static const struct of_device_id of_skipped_node_table[] = {
88 	{ .compatible = "operating-points-v2", },
89 	{} /* Empty terminated list */
90 };
91 
92 /*
93  * The following routines scan a subtree and registers a device for
94  * each applicable node.
95  *
96  * Note: sparc doesn't use these routines because it has a different
97  * mechanism for creating devices from device tree nodes.
98  */
99 
100 /**
101  * of_device_make_bus_id - Use the device node data to assign a unique name
102  * @dev: pointer to device structure that is linked to a device tree node
103  *
104  * This routine will first try using the translated bus address to
105  * derive a unique name. If it cannot, then it will prepend names from
106  * parent nodes until a unique name can be derived.
107  */
of_device_make_bus_id(struct device * dev)108 static void of_device_make_bus_id(struct device *dev)
109 {
110 	struct device_node *node = dev->of_node;
111 	const __be32 *reg;
112 	u64 addr;
113 	u32 mask;
114 
115 	/* Construct the name, using parent nodes if necessary to ensure uniqueness */
116 	while (node->parent) {
117 		/*
118 		 * If the address can be translated, then that is as much
119 		 * uniqueness as we need. Make it the first component and return
120 		 */
121 		reg = of_get_property(node, "reg", NULL);
122 		if (reg && (addr = of_translate_address(node, reg)) != OF_BAD_ADDR) {
123 			if (!of_property_read_u32(node, "mask", &mask))
124 				dev_set_name(dev, dev_name(dev) ? "%llx.%x.%pOFn:%s" : "%llx.%x.%pOFn",
125 					     addr, ffs(mask) - 1, node, dev_name(dev));
126 
127 			else
128 				dev_set_name(dev, dev_name(dev) ? "%llx.%pOFn:%s" : "%llx.%pOFn",
129 					     addr, node, dev_name(dev));
130 			return;
131 		}
132 
133 		/* format arguments only used if dev_name() resolves to NULL */
134 		dev_set_name(dev, dev_name(dev) ? "%s:%s" : "%s",
135 			     kbasename(node->full_name), dev_name(dev));
136 		node = node->parent;
137 	}
138 }
139 
140 /**
141  * of_device_alloc - Allocate and initialize an of_device
142  * @np: device node to assign to device
143  * @bus_id: Name to assign to the device.  May be null to use default name.
144  * @parent: Parent device.
145  */
of_device_alloc(struct device_node * np,const char * bus_id,struct device * parent)146 struct platform_device *of_device_alloc(struct device_node *np,
147 				  const char *bus_id,
148 				  struct device *parent)
149 {
150 	struct platform_device *dev;
151 	int rc, i, num_reg = 0;
152 	struct resource *res;
153 
154 	dev = platform_device_alloc("", PLATFORM_DEVID_NONE);
155 	if (!dev)
156 		return NULL;
157 
158 	/* count the io resources */
159 	num_reg = of_address_count(np);
160 
161 	/* Populate the resource table */
162 	if (num_reg) {
163 		res = kcalloc(num_reg, sizeof(*res), GFP_KERNEL);
164 		if (!res) {
165 			platform_device_put(dev);
166 			return NULL;
167 		}
168 
169 		dev->num_resources = num_reg;
170 		dev->resource = res;
171 		for (i = 0; i < num_reg; i++, res++) {
172 			rc = of_address_to_resource(np, i, res);
173 			WARN_ON(rc);
174 		}
175 	}
176 
177 	/* setup generic device info */
178 	device_set_node(&dev->dev, of_fwnode_handle(of_node_get(np)));
179 	dev->dev.parent = parent ? : &platform_bus;
180 
181 	if (bus_id)
182 		dev_set_name(&dev->dev, "%s", bus_id);
183 	else
184 		of_device_make_bus_id(&dev->dev);
185 
186 	return dev;
187 }
188 EXPORT_SYMBOL(of_device_alloc);
189 
190 /**
191  * of_platform_device_create_pdata - Alloc, initialize and register an of_device
192  * @np: pointer to node to create device for
193  * @bus_id: name to assign device
194  * @platform_data: pointer to populate platform_data pointer with
195  * @parent: Linux device model parent device.
196  *
197  * Return: Pointer to created platform device, or NULL if a device was not
198  * registered.  Unavailable devices will not get registered.
199  */
of_platform_device_create_pdata(struct device_node * np,const char * bus_id,void * platform_data,struct device * parent)200 static struct platform_device *of_platform_device_create_pdata(
201 					struct device_node *np,
202 					const char *bus_id,
203 					void *platform_data,
204 					struct device *parent)
205 {
206 	struct platform_device *dev;
207 
208 	if (!of_device_is_available(np) ||
209 	    of_node_test_and_set_flag(np, OF_POPULATED))
210 		return NULL;
211 
212 	dev = of_device_alloc(np, bus_id, parent);
213 	if (!dev)
214 		goto err_clear_flag;
215 
216 	dev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
217 	if (!dev->dev.dma_mask)
218 		dev->dev.dma_mask = &dev->dev.coherent_dma_mask;
219 	dev->dev.bus = &platform_bus_type;
220 	dev->dev.platform_data = platform_data;
221 	of_msi_configure(&dev->dev, dev->dev.of_node);
222 
223 	if (of_device_add(dev) != 0) {
224 		platform_device_put(dev);
225 		goto err_clear_flag;
226 	}
227 
228 	return dev;
229 
230 err_clear_flag:
231 	of_node_clear_flag(np, OF_POPULATED);
232 	return NULL;
233 }
234 
235 /**
236  * of_platform_device_create - Alloc, initialize and register an of_device
237  * @np: pointer to node to create device for
238  * @bus_id: name to assign device
239  * @parent: Linux device model parent device.
240  *
241  * Return: Pointer to created platform device, or NULL if a device was not
242  * registered.  Unavailable devices will not get registered.
243  */
of_platform_device_create(struct device_node * np,const char * bus_id,struct device * parent)244 struct platform_device *of_platform_device_create(struct device_node *np,
245 					    const char *bus_id,
246 					    struct device *parent)
247 {
248 	return of_platform_device_create_pdata(np, bus_id, NULL, parent);
249 }
250 EXPORT_SYMBOL(of_platform_device_create);
251 
252 #ifdef CONFIG_ARM_AMBA
of_amba_device_create(struct device_node * node,const char * bus_id,void * platform_data,struct device * parent)253 static struct amba_device *of_amba_device_create(struct device_node *node,
254 						 const char *bus_id,
255 						 void *platform_data,
256 						 struct device *parent)
257 {
258 	struct amba_device *dev;
259 	int ret;
260 
261 	pr_debug("Creating amba device %pOF\n", node);
262 
263 	if (!of_device_is_available(node) ||
264 	    of_node_test_and_set_flag(node, OF_POPULATED))
265 		return NULL;
266 
267 	dev = amba_device_alloc(NULL, 0, 0);
268 	if (!dev)
269 		goto err_clear_flag;
270 
271 	/* AMBA devices only support a single DMA mask */
272 	dev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
273 	dev->dev.dma_mask = &dev->dev.coherent_dma_mask;
274 
275 	/* setup generic device info */
276 	device_set_node(&dev->dev, of_fwnode_handle(of_node_get(node)));
277 	dev->dev.parent = parent ? : &platform_bus;
278 	dev->dev.platform_data = platform_data;
279 	if (bus_id)
280 		dev_set_name(&dev->dev, "%s", bus_id);
281 	else
282 		of_device_make_bus_id(&dev->dev);
283 
284 	/* Allow the HW Peripheral ID to be overridden */
285 	of_property_read_u32(node, "arm,primecell-periphid", &dev->periphid);
286 
287 	ret = of_address_to_resource(node, 0, &dev->res);
288 	if (ret) {
289 		pr_err("amba: of_address_to_resource() failed (%d) for %pOF\n",
290 		       ret, node);
291 		goto err_free;
292 	}
293 
294 	ret = amba_device_add(dev, &iomem_resource);
295 	if (ret) {
296 		pr_err("amba_device_add() failed (%d) for %pOF\n",
297 		       ret, node);
298 		goto err_free;
299 	}
300 
301 	return dev;
302 
303 err_free:
304 	amba_device_put(dev);
305 err_clear_flag:
306 	of_node_clear_flag(node, OF_POPULATED);
307 	return NULL;
308 }
309 #else /* CONFIG_ARM_AMBA */
of_amba_device_create(struct device_node * node,const char * bus_id,void * platform_data,struct device * parent)310 static struct amba_device *of_amba_device_create(struct device_node *node,
311 						 const char *bus_id,
312 						 void *platform_data,
313 						 struct device *parent)
314 {
315 	return NULL;
316 }
317 #endif /* CONFIG_ARM_AMBA */
318 
319 /*
320  * of_dev_lookup() - Given a device node, lookup the preferred Linux name
321  */
of_dev_lookup(const struct of_dev_auxdata * lookup,struct device_node * np)322 static const struct of_dev_auxdata *of_dev_lookup(const struct of_dev_auxdata *lookup,
323 				 struct device_node *np)
324 {
325 	const struct of_dev_auxdata *auxdata;
326 	struct resource res;
327 	int compatible = 0;
328 
329 	if (!lookup)
330 		return NULL;
331 
332 	auxdata = lookup;
333 	for (; auxdata->compatible; auxdata++) {
334 		if (!of_device_is_compatible(np, auxdata->compatible))
335 			continue;
336 		compatible++;
337 		if (!of_address_to_resource(np, 0, &res))
338 			if (res.start != auxdata->phys_addr)
339 				continue;
340 		pr_debug("%pOF: devname=%s\n", np, auxdata->name);
341 		return auxdata;
342 	}
343 
344 	if (!compatible)
345 		return NULL;
346 
347 	/* Try compatible match if no phys_addr and name are specified */
348 	auxdata = lookup;
349 	for (; auxdata->compatible; auxdata++) {
350 		if (!of_device_is_compatible(np, auxdata->compatible))
351 			continue;
352 		if (!auxdata->phys_addr && !auxdata->name) {
353 			pr_debug("%pOF: compatible match\n", np);
354 			return auxdata;
355 		}
356 	}
357 
358 	return NULL;
359 }
360 
361 /**
362  * of_platform_bus_create() - Create a device for a node and its children.
363  * @bus: device node of the bus to instantiate
364  * @matches: match table for bus nodes
365  * @lookup: auxdata table for matching id and platform_data with device nodes
366  * @parent: parent for new device, or NULL for top level.
367  * @strict: require compatible property
368  *
369  * Creates a platform_device for the provided device_node, and optionally
370  * recursively create devices for all the child nodes.
371  */
of_platform_bus_create(struct device_node * bus,const struct of_device_id * matches,const struct of_dev_auxdata * lookup,struct device * parent,bool strict)372 static int of_platform_bus_create(struct device_node *bus,
373 				  const struct of_device_id *matches,
374 				  const struct of_dev_auxdata *lookup,
375 				  struct device *parent, bool strict)
376 {
377 	const struct of_dev_auxdata *auxdata;
378 	struct device_node *child;
379 	struct platform_device *dev;
380 	const char *bus_id = NULL;
381 	void *platform_data = NULL;
382 	int rc = 0;
383 
384 	/* Make sure it has a compatible property */
385 	if (strict && (!of_get_property(bus, "compatible", NULL))) {
386 		pr_debug("%s() - skipping %pOF, no compatible prop\n",
387 			 __func__, bus);
388 		return 0;
389 	}
390 
391 	/* Skip nodes for which we don't want to create devices */
392 	if (unlikely(of_match_node(of_skipped_node_table, bus))) {
393 		pr_debug("%s() - skipping %pOF node\n", __func__, bus);
394 		return 0;
395 	}
396 
397 	if (of_node_check_flag(bus, OF_POPULATED_BUS)) {
398 		pr_debug("%s() - skipping %pOF, already populated\n",
399 			__func__, bus);
400 		return 0;
401 	}
402 
403 	auxdata = of_dev_lookup(lookup, bus);
404 	if (auxdata) {
405 		bus_id = auxdata->name;
406 		platform_data = auxdata->platform_data;
407 	}
408 
409 	if (of_device_is_compatible(bus, "arm,primecell")) {
410 		/*
411 		 * Don't return an error here to keep compatibility with older
412 		 * device tree files.
413 		 */
414 		of_amba_device_create(bus, bus_id, platform_data, parent);
415 		return 0;
416 	}
417 
418 	dev = of_platform_device_create_pdata(bus, bus_id, platform_data, parent);
419 	if (!dev || !of_match_node(matches, bus))
420 		return 0;
421 
422 	for_each_child_of_node(bus, child) {
423 		pr_debug("   create child: %pOF\n", child);
424 		rc = of_platform_bus_create(child, matches, lookup, &dev->dev, strict);
425 		if (rc) {
426 			of_node_put(child);
427 			break;
428 		}
429 	}
430 	of_node_set_flag(bus, OF_POPULATED_BUS);
431 	return rc;
432 }
433 
434 /**
435  * of_platform_bus_probe() - Probe the device-tree for platform buses
436  * @root: parent of the first level to probe or NULL for the root of the tree
437  * @matches: match table for bus nodes
438  * @parent: parent to hook devices from, NULL for toplevel
439  *
440  * Note that children of the provided root are not instantiated as devices
441  * unless the specified root itself matches the bus list and is not NULL.
442  */
of_platform_bus_probe(struct device_node * root,const struct of_device_id * matches,struct device * parent)443 int of_platform_bus_probe(struct device_node *root,
444 			  const struct of_device_id *matches,
445 			  struct device *parent)
446 {
447 	struct device_node *child;
448 	int rc = 0;
449 
450 	root = root ? of_node_get(root) : of_find_node_by_path("/");
451 	if (!root)
452 		return -EINVAL;
453 
454 	pr_debug("%s()\n", __func__);
455 	pr_debug(" starting at: %pOF\n", root);
456 
457 	/* Do a self check of bus type, if there's a match, create children */
458 	if (of_match_node(matches, root)) {
459 		rc = of_platform_bus_create(root, matches, NULL, parent, false);
460 	} else for_each_child_of_node(root, child) {
461 		if (!of_match_node(matches, child))
462 			continue;
463 		rc = of_platform_bus_create(child, matches, NULL, parent, false);
464 		if (rc) {
465 			of_node_put(child);
466 			break;
467 		}
468 	}
469 
470 	of_node_put(root);
471 	return rc;
472 }
473 EXPORT_SYMBOL(of_platform_bus_probe);
474 
475 /**
476  * of_platform_populate() - Populate platform_devices from device tree data
477  * @root: parent of the first level to probe or NULL for the root of the tree
478  * @matches: match table, NULL to use the default
479  * @lookup: auxdata table for matching id and platform_data with device nodes
480  * @parent: parent to hook devices from, NULL for toplevel
481  *
482  * Similar to of_platform_bus_probe(), this function walks the device tree
483  * and creates devices from nodes.  It differs in that it follows the modern
484  * convention of requiring all device nodes to have a 'compatible' property,
485  * and it is suitable for creating devices which are children of the root
486  * node (of_platform_bus_probe will only create children of the root which
487  * are selected by the @matches argument).
488  *
489  * New board support should be using this function instead of
490  * of_platform_bus_probe().
491  *
492  * Return: 0 on success, < 0 on failure.
493  */
of_platform_populate(struct device_node * root,const struct of_device_id * matches,const struct of_dev_auxdata * lookup,struct device * parent)494 int of_platform_populate(struct device_node *root,
495 			const struct of_device_id *matches,
496 			const struct of_dev_auxdata *lookup,
497 			struct device *parent)
498 {
499 	struct device_node *child;
500 	int rc = 0;
501 
502 	root = root ? of_node_get(root) : of_find_node_by_path("/");
503 	if (!root)
504 		return -EINVAL;
505 
506 	pr_debug("%s()\n", __func__);
507 	pr_debug(" starting at: %pOF\n", root);
508 
509 	device_links_supplier_sync_state_pause();
510 	for_each_child_of_node(root, child) {
511 		rc = of_platform_bus_create(child, matches, lookup, parent, true);
512 		if (rc) {
513 			of_node_put(child);
514 			break;
515 		}
516 	}
517 	device_links_supplier_sync_state_resume();
518 
519 	of_node_set_flag(root, OF_POPULATED_BUS);
520 
521 	of_node_put(root);
522 	return rc;
523 }
524 EXPORT_SYMBOL_GPL(of_platform_populate);
525 
of_platform_default_populate(struct device_node * root,const struct of_dev_auxdata * lookup,struct device * parent)526 int of_platform_default_populate(struct device_node *root,
527 				 const struct of_dev_auxdata *lookup,
528 				 struct device *parent)
529 {
530 	return of_platform_populate(root, of_default_bus_match_table, lookup,
531 				    parent);
532 }
533 EXPORT_SYMBOL_GPL(of_platform_default_populate);
534 
535 static const struct of_device_id reserved_mem_matches[] = {
536 	{ .compatible = "phram" },
537 	{ .compatible = "qcom,rmtfs-mem" },
538 	{ .compatible = "qcom,cmd-db" },
539 	{ .compatible = "qcom,smem" },
540 	{ .compatible = "ramoops" },
541 	{ .compatible = "nvmem-rmem" },
542 	{ .compatible = "google,open-dice" },
543 	{}
544 };
545 
of_platform_default_populate_init(void)546 static int __init of_platform_default_populate_init(void)
547 {
548 	struct device_node *node;
549 
550 	device_links_supplier_sync_state_pause();
551 
552 	if (!of_have_populated_dt())
553 		return -ENODEV;
554 
555 	if (IS_ENABLED(CONFIG_PPC)) {
556 		struct device_node *boot_display = NULL;
557 		struct platform_device *dev;
558 		int display_number = 0;
559 		int ret;
560 
561 		/* Check if we have a MacOS display without a node spec */
562 		if (of_property_present(of_chosen, "linux,bootx-noscreen")) {
563 			/*
564 			 * The old code tried to work out which node was the MacOS
565 			 * display based on the address. I'm dropping that since the
566 			 * lack of a node spec only happens with old BootX versions
567 			 * (users can update) and with this code, they'll still get
568 			 * a display (just not the palette hacks).
569 			 */
570 			dev = platform_device_alloc("bootx-noscreen", 0);
571 			if (WARN_ON(!dev))
572 				return -ENOMEM;
573 			ret = platform_device_add(dev);
574 			if (WARN_ON(ret)) {
575 				platform_device_put(dev);
576 				return ret;
577 			}
578 		}
579 
580 		/*
581 		 * For OF framebuffers, first create the device for the boot display,
582 		 * then for the other framebuffers. Only fail for the boot display;
583 		 * ignore errors for the rest.
584 		 */
585 		for_each_node_by_type(node, "display") {
586 			if (!of_get_property(node, "linux,opened", NULL) ||
587 			    !of_get_property(node, "linux,boot-display", NULL))
588 				continue;
589 			dev = of_platform_device_create(node, "of-display", NULL);
590 			of_node_put(node);
591 			if (WARN_ON(!dev))
592 				return -ENOMEM;
593 			boot_display = node;
594 			display_number++;
595 			break;
596 		}
597 		for_each_node_by_type(node, "display") {
598 			char buf[14];
599 			const char *of_display_format = "of-display.%d";
600 
601 			if (!of_get_property(node, "linux,opened", NULL) || node == boot_display)
602 				continue;
603 			ret = snprintf(buf, sizeof(buf), of_display_format, display_number++);
604 			if (ret < sizeof(buf))
605 				of_platform_device_create(node, buf, NULL);
606 		}
607 
608 	} else {
609 		/*
610 		 * Handle certain compatibles explicitly, since we don't want to create
611 		 * platform_devices for every node in /reserved-memory with a
612 		 * "compatible",
613 		 */
614 		for_each_matching_node(node, reserved_mem_matches)
615 			of_platform_device_create(node, NULL, NULL);
616 
617 		node = of_find_node_by_path("/firmware");
618 		if (node) {
619 			of_platform_populate(node, NULL, NULL, NULL);
620 			of_node_put(node);
621 		}
622 
623 		node = of_get_compatible_child(of_chosen, "simple-framebuffer");
624 		of_platform_device_create(node, NULL, NULL);
625 		of_node_put(node);
626 
627 		/* Populate everything else. */
628 		of_platform_default_populate(NULL, NULL, NULL);
629 	}
630 
631 	return 0;
632 }
633 arch_initcall_sync(of_platform_default_populate_init);
634 
of_platform_sync_state_init(void)635 static int __init of_platform_sync_state_init(void)
636 {
637 	device_links_supplier_sync_state_resume();
638 	return 0;
639 }
640 late_initcall_sync(of_platform_sync_state_init);
641 
of_platform_device_destroy(struct device * dev,void * data)642 int of_platform_device_destroy(struct device *dev, void *data)
643 {
644 	/* Do not touch devices not populated from the device tree */
645 	if (!dev->of_node || !of_node_check_flag(dev->of_node, OF_POPULATED))
646 		return 0;
647 
648 	/* Recurse for any nodes that were treated as busses */
649 	if (of_node_check_flag(dev->of_node, OF_POPULATED_BUS))
650 		device_for_each_child(dev, NULL, of_platform_device_destroy);
651 
652 	of_node_clear_flag(dev->of_node, OF_POPULATED);
653 	of_node_clear_flag(dev->of_node, OF_POPULATED_BUS);
654 
655 	if (dev->bus == &platform_bus_type)
656 		platform_device_unregister(to_platform_device(dev));
657 #ifdef CONFIG_ARM_AMBA
658 	else if (dev->bus == &amba_bustype)
659 		amba_device_unregister(to_amba_device(dev));
660 #endif
661 
662 	return 0;
663 }
664 EXPORT_SYMBOL_GPL(of_platform_device_destroy);
665 
666 /**
667  * of_platform_depopulate() - Remove devices populated from device tree
668  * @parent: device which children will be removed
669  *
670  * Complementary to of_platform_populate(), this function removes children
671  * of the given device (and, recurrently, their children) that have been
672  * created from their respective device tree nodes (and only those,
673  * leaving others - eg. manually created - unharmed).
674  */
of_platform_depopulate(struct device * parent)675 void of_platform_depopulate(struct device *parent)
676 {
677 	if (parent->of_node && of_node_check_flag(parent->of_node, OF_POPULATED_BUS)) {
678 		device_for_each_child_reverse(parent, NULL, of_platform_device_destroy);
679 		of_node_clear_flag(parent->of_node, OF_POPULATED_BUS);
680 	}
681 }
682 EXPORT_SYMBOL_GPL(of_platform_depopulate);
683 
devm_of_platform_populate_release(struct device * dev,void * res)684 static void devm_of_platform_populate_release(struct device *dev, void *res)
685 {
686 	of_platform_depopulate(*(struct device **)res);
687 }
688 
689 /**
690  * devm_of_platform_populate() - Populate platform_devices from device tree data
691  * @dev: device that requested to populate from device tree data
692  *
693  * Similar to of_platform_populate(), but will automatically call
694  * of_platform_depopulate() when the device is unbound from the bus.
695  *
696  * Return: 0 on success, < 0 on failure.
697  */
devm_of_platform_populate(struct device * dev)698 int devm_of_platform_populate(struct device *dev)
699 {
700 	struct device **ptr;
701 	int ret;
702 
703 	if (!dev)
704 		return -EINVAL;
705 
706 	ptr = devres_alloc(devm_of_platform_populate_release,
707 			   sizeof(*ptr), GFP_KERNEL);
708 	if (!ptr)
709 		return -ENOMEM;
710 
711 	ret = of_platform_populate(dev->of_node, NULL, NULL, dev);
712 	if (ret) {
713 		devres_free(ptr);
714 	} else {
715 		*ptr = dev;
716 		devres_add(dev, ptr);
717 	}
718 
719 	return ret;
720 }
721 EXPORT_SYMBOL_GPL(devm_of_platform_populate);
722 
devm_of_platform_match(struct device * dev,void * res,void * data)723 static int devm_of_platform_match(struct device *dev, void *res, void *data)
724 {
725 	struct device **ptr = res;
726 
727 	if (!ptr) {
728 		WARN_ON(!ptr);
729 		return 0;
730 	}
731 
732 	return *ptr == data;
733 }
734 
735 /**
736  * devm_of_platform_depopulate() - Remove devices populated from device tree
737  * @dev: device that requested to depopulate from device tree data
738  *
739  * Complementary to devm_of_platform_populate(), this function removes children
740  * of the given device (and, recurrently, their children) that have been
741  * created from their respective device tree nodes (and only those,
742  * leaving others - eg. manually created - unharmed).
743  */
devm_of_platform_depopulate(struct device * dev)744 void devm_of_platform_depopulate(struct device *dev)
745 {
746 	int ret;
747 
748 	ret = devres_release(dev, devm_of_platform_populate_release,
749 			     devm_of_platform_match, dev);
750 
751 	WARN_ON(ret);
752 }
753 EXPORT_SYMBOL_GPL(devm_of_platform_depopulate);
754 
755 #ifdef CONFIG_OF_DYNAMIC
of_platform_notify(struct notifier_block * nb,unsigned long action,void * arg)756 static int of_platform_notify(struct notifier_block *nb,
757 				unsigned long action, void *arg)
758 {
759 	struct of_reconfig_data *rd = arg;
760 	struct platform_device *pdev_parent, *pdev;
761 	bool children_left;
762 
763 	switch (of_reconfig_get_state_change(action, rd)) {
764 	case OF_RECONFIG_CHANGE_ADD:
765 		/* verify that the parent is a bus */
766 		if (!of_node_check_flag(rd->dn->parent, OF_POPULATED_BUS))
767 			return NOTIFY_OK;	/* not for us */
768 
769 		/* already populated? (driver using of_populate manually) */
770 		if (of_node_check_flag(rd->dn, OF_POPULATED))
771 			return NOTIFY_OK;
772 
773 		/*
774 		 * Clear the flag before adding the device so that fw_devlink
775 		 * doesn't skip adding consumers to this device.
776 		 */
777 		rd->dn->fwnode.flags &= ~FWNODE_FLAG_NOT_DEVICE;
778 		/* pdev_parent may be NULL when no bus platform device */
779 		pdev_parent = of_find_device_by_node(rd->dn->parent);
780 		pdev = of_platform_device_create(rd->dn, NULL,
781 				pdev_parent ? &pdev_parent->dev : NULL);
782 		platform_device_put(pdev_parent);
783 
784 		if (pdev == NULL) {
785 			pr_err("%s: failed to create for '%pOF'\n",
786 					__func__, rd->dn);
787 			/* of_platform_device_create tosses the error code */
788 			return notifier_from_errno(-EINVAL);
789 		}
790 		break;
791 
792 	case OF_RECONFIG_CHANGE_REMOVE:
793 
794 		/* already depopulated? */
795 		if (!of_node_check_flag(rd->dn, OF_POPULATED))
796 			return NOTIFY_OK;
797 
798 		/* find our device by node */
799 		pdev = of_find_device_by_node(rd->dn);
800 		if (pdev == NULL)
801 			return NOTIFY_OK;	/* no? not meant for us */
802 
803 		/* unregister takes one ref away */
804 		of_platform_device_destroy(&pdev->dev, &children_left);
805 
806 		/* and put the reference of the find */
807 		platform_device_put(pdev);
808 		break;
809 	}
810 
811 	return NOTIFY_OK;
812 }
813 
814 static struct notifier_block platform_of_notifier = {
815 	.notifier_call = of_platform_notify,
816 };
817 
of_platform_register_reconfig_notifier(void)818 void of_platform_register_reconfig_notifier(void)
819 {
820 	WARN_ON(of_reconfig_notifier_register(&platform_of_notifier));
821 }
822 #endif /* CONFIG_OF_DYNAMIC */
823 
824 #endif /* CONFIG_OF_ADDRESS */
825