platform.c 24.3 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0+
S
Stephen Rothwell 已提交
2 3 4 5 6 7 8
/*
 *    Copyright (C) 2006 Benjamin Herrenschmidt, IBM Corp.
 *			 <benh@kernel.crashing.org>
 *    and		 Arnd Bergmann, IBM Corp.
 *    Merged from powerpc/kernel/of_platform.c and
 *    sparc{,64}/kernel/of_device.c by Stephen Rothwell
 */
9 10 11

#define pr_fmt(fmt)	"OF: " fmt

S
Stephen Rothwell 已提交
12
#include <linux/errno.h>
13
#include <linux/module.h>
14
#include <linux/amba/bus.h>
S
Stephen Rothwell 已提交
15
#include <linux/device.h>
16
#include <linux/dma-mapping.h>
G
Grant Likely 已提交
17
#include <linux/slab.h>
18
#include <linux/of_address.h>
S
Stephen Rothwell 已提交
19
#include <linux/of_device.h>
20
#include <linux/of_iommu.h>
21
#include <linux/of_irq.h>
S
Stephen Rothwell 已提交
22
#include <linux/of_platform.h>
23 24
#include <linux/platform_device.h>

25 26
const struct of_device_id of_default_bus_match_table[] = {
	{ .compatible = "simple-bus", },
27
	{ .compatible = "simple-mfd", },
28
	{ .compatible = "isa", },
29 30 31 32 33 34
#ifdef CONFIG_ARM_AMBA
	{ .compatible = "arm,amba-bus", },
#endif /* CONFIG_ARM_AMBA */
	{} /* Empty terminated list */
};

35 36 37 38 39
static const struct of_device_id of_skipped_node_table[] = {
	{ .compatible = "operating-points-v2", },
	{} /* Empty terminated list */
};

40 41 42 43
/**
 * of_find_device_by_node - Find the platform_device associated with a node
 * @np: Pointer to device tree node
 *
44 45 46
 * Takes a reference to the embedded struct device which needs to be dropped
 * after use.
 *
47 48 49 50 51 52
 * Returns platform_device pointer, or NULL if not found
 */
struct platform_device *of_find_device_by_node(struct device_node *np)
{
	struct device *dev;

53
	dev = bus_find_device_by_of_node(&platform_bus_type, np);
54 55 56 57
	return dev ? to_platform_device(dev) : NULL;
}
EXPORT_SYMBOL(of_find_device_by_node);

58
#ifdef CONFIG_OF_ADDRESS
59 60 61 62 63 64 65 66
/*
 * The following routines scan a subtree and registers a device for
 * each applicable node.
 *
 * Note: sparc doesn't use these routines because it has a different
 * mechanism for creating devices from device tree nodes.
 */

67 68 69 70
/**
 * of_device_make_bus_id - Use the device node data to assign a unique name
 * @dev: pointer to device structure that is linked to a device tree node
 *
71 72 73
 * This routine will first try using the translated bus address to
 * derive a unique name. If it cannot, then it will prepend names from
 * parent nodes until a unique name can be derived.
74
 */
75
static void of_device_make_bus_id(struct device *dev)
76 77
{
	struct device_node *node = dev->of_node;
K
Kim Phillips 已提交
78
	const __be32 *reg;
79 80
	u64 addr;

81 82 83 84 85 86 87 88
	/* Construct the name, using parent nodes if necessary to ensure uniqueness */
	while (node->parent) {
		/*
		 * If the address can be translated, then that is as much
		 * uniqueness as we need. Make it the first component and return
		 */
		reg = of_get_property(node, "reg", NULL);
		if (reg && (addr = of_translate_address(node, reg)) != OF_BAD_ADDR) {
89
			dev_set_name(dev, dev_name(dev) ? "%llx.%pOFn:%s" : "%llx.%pOFn",
90
				     addr, node, dev_name(dev));
91 92 93
			return;
		}

94 95
		/* format arguments only used if dev_name() resolves to NULL */
		dev_set_name(dev, dev_name(dev) ? "%s:%s" : "%s",
96
			     kbasename(node->full_name), dev_name(dev));
97 98
		node = node->parent;
	}
99 100 101 102 103 104 105 106
}

/**
 * of_device_alloc - Allocate and initialize an of_device
 * @np: device node to assign to device
 * @bus_id: Name to assign to the device.  May be null to use default name.
 * @parent: Parent device.
 */
107
struct platform_device *of_device_alloc(struct device_node *np,
108 109 110
				  const char *bus_id,
				  struct device *parent)
{
111
	struct platform_device *dev;
112
	int rc, i, num_reg = 0, num_irq;
113 114
	struct resource *res, temp_res;

115
	dev = platform_device_alloc("", PLATFORM_DEVID_NONE);
116 117 118 119
	if (!dev)
		return NULL;

	/* count the io and irq resources */
120 121
	while (of_address_to_resource(np, num_reg, &temp_res) == 0)
		num_reg++;
122
	num_irq = of_irq_count(np);
123 124 125

	/* Populate the resource table */
	if (num_irq || num_reg) {
K
Kees Cook 已提交
126
		res = kcalloc(num_irq + num_reg, sizeof(*res), GFP_KERNEL);
127 128 129 130 131
		if (!res) {
			platform_device_put(dev);
			return NULL;
		}

132 133 134 135 136 137
		dev->num_resources = num_reg + num_irq;
		dev->resource = res;
		for (i = 0; i < num_reg; i++, res++) {
			rc = of_address_to_resource(np, i, res);
			WARN_ON(rc);
		}
138
		if (of_irq_to_resource_table(np, res, num_irq) != num_irq)
139 140
			pr_debug("not all legacy IRQ resources mapped for %pOFn\n",
				 np);
141
	}
142 143

	dev->dev.of_node = of_node_get(np);
144
	dev->dev.fwnode = &np->fwnode;
145
	dev->dev.parent = parent ? : &platform_bus;
146 147 148 149 150 151 152 153 154 155

	if (bus_id)
		dev_set_name(&dev->dev, "%s", bus_id);
	else
		of_device_make_bus_id(&dev->dev);

	return dev;
}
EXPORT_SYMBOL(of_device_alloc);

156
/**
157
 * of_platform_device_create_pdata - Alloc, initialize and register an of_device
158 159
 * @np: pointer to node to create device for
 * @bus_id: name to assign device
160
 * @platform_data: pointer to populate platform_data pointer with
161
 * @parent: Linux device model parent device.
162 163 164
 *
 * Returns pointer to created platform device, or NULL if a device was not
 * registered.  Unavailable devices will not get registered.
165
 */
166
static struct platform_device *of_platform_device_create_pdata(
167 168 169 170
					struct device_node *np,
					const char *bus_id,
					void *platform_data,
					struct device *parent)
171
{
172
	struct platform_device *dev;
173

174 175
	if (!of_device_is_available(np) ||
	    of_node_test_and_set_flag(np, OF_POPULATED))
176 177
		return NULL;

178 179
	dev = of_device_alloc(np, bus_id, parent);
	if (!dev)
180
		goto err_clear_flag;
181

182 183 184
	dev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
	if (!dev->dev.dma_mask)
		dev->dev.dma_mask = &dev->dev.coherent_dma_mask;
185
	dev->dev.bus = &platform_bus_type;
186
	dev->dev.platform_data = platform_data;
187
	of_msi_configure(&dev->dev, dev->dev.of_node);
188

189 190
	if (of_device_add(dev) != 0) {
		platform_device_put(dev);
191
		goto err_clear_flag;
192 193 194
	}

	return dev;
195 196 197 198

err_clear_flag:
	of_node_clear_flag(np, OF_POPULATED);
	return NULL;
199
}
200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215

/**
 * of_platform_device_create - Alloc, initialize and register an of_device
 * @np: pointer to node to create device for
 * @bus_id: name to assign device
 * @parent: Linux device model parent device.
 *
 * Returns pointer to created platform device, or NULL if a device was not
 * registered.  Unavailable devices will not get registered.
 */
struct platform_device *of_platform_device_create(struct device_node *np,
					    const char *bus_id,
					    struct device *parent)
{
	return of_platform_device_create_pdata(np, bus_id, NULL, parent);
}
216 217
EXPORT_SYMBOL(of_platform_device_create);

218 219 220 221 222 223 224 225 226 227
#ifdef CONFIG_ARM_AMBA
static struct amba_device *of_amba_device_create(struct device_node *node,
						 const char *bus_id,
						 void *platform_data,
						 struct device *parent)
{
	struct amba_device *dev;
	const void *prop;
	int i, ret;

228
	pr_debug("Creating amba device %pOF\n", node);
229

230 231
	if (!of_device_is_available(node) ||
	    of_node_test_and_set_flag(node, OF_POPULATED))
232 233
		return NULL;

234
	dev = amba_device_alloc(NULL, 0, 0);
235
	if (!dev)
236
		goto err_clear_flag;
237

238 239 240 241
	/* AMBA devices only support a single DMA mask */
	dev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
	dev->dev.dma_mask = &dev->dev.coherent_dma_mask;

242 243
	/* setup generic device info */
	dev->dev.of_node = of_node_get(node);
244
	dev->dev.fwnode = &node->fwnode;
245
	dev->dev.parent = parent ? : &platform_bus;
246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261
	dev->dev.platform_data = platform_data;
	if (bus_id)
		dev_set_name(&dev->dev, "%s", bus_id);
	else
		of_device_make_bus_id(&dev->dev);

	/* Allow the HW Peripheral ID to be overridden */
	prop = of_get_property(node, "arm,primecell-periphid", NULL);
	if (prop)
		dev->periphid = of_read_ulong(prop, 1);

	/* Decode the IRQs and address ranges */
	for (i = 0; i < AMBA_NR_IRQS; i++)
		dev->irq[i] = irq_of_parse_and_map(node, i);

	ret = of_address_to_resource(node, 0, &dev->res);
262
	if (ret) {
263 264
		pr_err("amba: of_address_to_resource() failed (%d) for %pOF\n",
		       ret, node);
265
		goto err_free;
266
	}
267

268
	ret = amba_device_add(dev, &iomem_resource);
269
	if (ret) {
270 271
		pr_err("amba_device_add() failed (%d) for %pOF\n",
		       ret, node);
272
		goto err_free;
273
	}
274 275 276 277

	return dev;

err_free:
278
	amba_device_put(dev);
279 280
err_clear_flag:
	of_node_clear_flag(node, OF_POPULATED);
281 282 283 284 285 286 287 288 289 290 291 292
	return NULL;
}
#else /* CONFIG_ARM_AMBA */
static struct amba_device *of_amba_device_create(struct device_node *node,
						 const char *bus_id,
						 void *platform_data,
						 struct device *parent)
{
	return NULL;
}
#endif /* CONFIG_ARM_AMBA */

293 294 295 296 297 298
/**
 * of_devname_lookup() - Given a device node, lookup the preferred Linux name
 */
static const struct of_dev_auxdata *of_dev_lookup(const struct of_dev_auxdata *lookup,
				 struct device_node *np)
{
299
	const struct of_dev_auxdata *auxdata;
300
	struct resource res;
301
	int compatible = 0;
O
Olof Johansson 已提交
302 303 304 305

	if (!lookup)
		return NULL;

306 307 308
	auxdata = lookup;
	for (; auxdata->compatible; auxdata++) {
		if (!of_device_is_compatible(np, auxdata->compatible))
O
Olof Johansson 已提交
309
			continue;
310
		compatible++;
311
		if (!of_address_to_resource(np, 0, &res))
312
			if (res.start != auxdata->phys_addr)
313
				continue;
314
		pr_debug("%pOF: devname=%s\n", np, auxdata->name);
315 316 317 318 319 320 321 322 323 324 325 326
		return auxdata;
	}

	if (!compatible)
		return NULL;

	/* Try compatible match if no phys_addr and name are specified */
	auxdata = lookup;
	for (; auxdata->compatible; auxdata++) {
		if (!of_device_is_compatible(np, auxdata->compatible))
			continue;
		if (!auxdata->phys_addr && !auxdata->name) {
327
			pr_debug("%pOF: compatible match\n", np);
328 329
			return auxdata;
		}
330
	}
O
Olof Johansson 已提交
331

332 333 334
	return NULL;
}

335
/**
336
 * of_platform_bus_create() - Create a device for a node and its children.
337
 * @bus: device node of the bus to instantiate
338
 * @matches: match table for bus nodes
O
Olof Johansson 已提交
339
 * @lookup: auxdata table for matching id and platform_data with device nodes
340
 * @parent: parent for new device, or NULL for top level.
O
Olof Johansson 已提交
341
 * @strict: require compatible property
342 343 344
 *
 * Creates a platform_device for the provided device_node, and optionally
 * recursively create devices for all the child nodes.
345
 */
346
static int of_platform_bus_create(struct device_node *bus,
347
				  const struct of_device_id *matches,
348
				  const struct of_dev_auxdata *lookup,
349
				  struct device *parent, bool strict)
350
{
351
	const struct of_dev_auxdata *auxdata;
352
	struct device_node *child;
353
	struct platform_device *dev;
354 355
	const char *bus_id = NULL;
	void *platform_data = NULL;
356 357
	int rc = 0;

358 359
	/* Make sure it has a compatible property */
	if (strict && (!of_get_property(bus, "compatible", NULL))) {
360 361
		pr_debug("%s() - skipping %pOF, no compatible prop\n",
			 __func__, bus);
362 363 364
		return 0;
	}

365 366 367 368 369 370
	/* Skip nodes for which we don't want to create devices */
	if (unlikely(of_match_node(of_skipped_node_table, bus))) {
		pr_debug("%s() - skipping %pOF node\n", __func__, bus);
		return 0;
	}

371
	if (of_node_check_flag(bus, OF_POPULATED_BUS)) {
372 373
		pr_debug("%s() - skipping %pOF, already populated\n",
			__func__, bus);
374 375 376
		return 0;
	}

377 378 379 380 381 382
	auxdata = of_dev_lookup(lookup, bus);
	if (auxdata) {
		bus_id = auxdata->name;
		platform_data = auxdata->platform_data;
	}

383
	if (of_device_is_compatible(bus, "arm,primecell")) {
384 385 386 387
		/*
		 * Don't return an error here to keep compatibility with older
		 * device tree files.
		 */
388
		of_amba_device_create(bus, bus_id, platform_data, parent);
389 390 391
		return 0;
	}

392
	dev = of_platform_device_create_pdata(bus, bus_id, platform_data, parent);
393 394 395
	if (!dev || !of_match_node(matches, bus))
		return 0;

396
	for_each_child_of_node(bus, child) {
397
		pr_debug("   create child: %pOF\n", child);
398
		rc = of_platform_bus_create(child, matches, lookup, &dev->dev, strict);
399 400 401 402 403
		if (rc) {
			of_node_put(child);
			break;
		}
	}
404
	of_node_set_flag(bus, OF_POPULATED_BUS);
405 406 407 408
	return rc;
}

/**
409
 * of_platform_bus_probe() - Probe the device-tree for platform buses
410
 * @root: parent of the first level to probe or NULL for the root of the tree
411
 * @matches: match table for bus nodes
412 413 414 415 416 417 418 419 420 421 422 423
 * @parent: parent to hook devices from, NULL for toplevel
 *
 * Note that children of the provided root are not instantiated as devices
 * unless the specified root itself matches the bus list and is not NULL.
 */
int of_platform_bus_probe(struct device_node *root,
			  const struct of_device_id *matches,
			  struct device *parent)
{
	struct device_node *child;
	int rc = 0;

424 425
	root = root ? of_node_get(root) : of_find_node_by_path("/");
	if (!root)
426
		return -EINVAL;
427

428
	pr_debug("%s()\n", __func__);
429
	pr_debug(" starting at: %pOF\n", root);
430

431
	/* Do a self check of bus type, if there's a match, create children */
432
	if (of_match_node(matches, root)) {
433
		rc = of_platform_bus_create(root, matches, NULL, parent, false);
434
	} else for_each_child_of_node(root, child) {
435 436
		if (!of_match_node(matches, child))
			continue;
437
		rc = of_platform_bus_create(child, matches, NULL, parent, false);
438 439
		if (rc) {
			of_node_put(child);
440
			break;
441
		}
442
	}
443

444 445 446 447
	of_node_put(root);
	return rc;
}
EXPORT_SYMBOL(of_platform_bus_probe);
448 449 450 451 452

/**
 * of_platform_populate() - Populate platform_devices from device tree data
 * @root: parent of the first level to probe or NULL for the root of the tree
 * @matches: match table, NULL to use the default
453
 * @lookup: auxdata table for matching id and platform_data with device nodes
454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469
 * @parent: parent to hook devices from, NULL for toplevel
 *
 * Similar to of_platform_bus_probe(), this function walks the device tree
 * and creates devices from nodes.  It differs in that it follows the modern
 * convention of requiring all device nodes to have a 'compatible' property,
 * and it is suitable for creating devices which are children of the root
 * node (of_platform_bus_probe will only create children of the root which
 * are selected by the @matches argument).
 *
 * New board support should be using this function instead of
 * of_platform_bus_probe().
 *
 * Returns 0 on success, < 0 on failure.
 */
int of_platform_populate(struct device_node *root,
			const struct of_device_id *matches,
470
			const struct of_dev_auxdata *lookup,
471 472 473 474 475 476 477 478 479
			struct device *parent)
{
	struct device_node *child;
	int rc = 0;

	root = root ? of_node_get(root) : of_find_node_by_path("/");
	if (!root)
		return -EINVAL;

480
	pr_debug("%s()\n", __func__);
481
	pr_debug(" starting at: %pOF\n", root);
482

483
	device_links_supplier_sync_state_pause();
484
	for_each_child_of_node(root, child) {
485
		rc = of_platform_bus_create(child, matches, lookup, parent, true);
486 487
		if (rc) {
			of_node_put(child);
488
			break;
489
		}
490
	}
491 492
	device_links_supplier_sync_state_resume();

493
	of_node_set_flag(root, OF_POPULATED_BUS);
494 495 496 497

	of_node_put(root);
	return rc;
}
498
EXPORT_SYMBOL_GPL(of_platform_populate);
499

500 501 502 503 504 505 506 507 508
int of_platform_default_populate(struct device_node *root,
				 const struct of_dev_auxdata *lookup,
				 struct device *parent)
{
	return of_platform_populate(root, of_default_bus_match_table, lookup,
				    parent);
}
EXPORT_SYMBOL_GPL(of_platform_default_populate);

509
#ifndef CONFIG_PPC
510
static bool of_link_is_valid(struct device_node *con, struct device_node *sup)
511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628
{
	of_node_get(sup);
	/*
	 * Don't allow linking a device node as a consumer of one of its
	 * descendant nodes. By definition, a child node can't be a functional
	 * dependency for the parent node.
	 */
	while (sup) {
		if (sup == con) {
			of_node_put(sup);
			return false;
		}
		sup = of_get_next_parent(sup);
	}
	return true;
}

static int of_link_to_phandle(struct device *dev, struct device_node *sup_np)
{
	struct platform_device *sup_dev;
	u32 dl_flags = DL_FLAG_AUTOPROBE_CONSUMER;
	int ret = 0;

	/*
	 * Since we are trying to create device links, we need to find
	 * the actual device node that owns this supplier phandle.
	 * Often times it's the same node, but sometimes it can be one
	 * of the parents. So walk up the parent till you find a
	 * device.
	 */
	while (sup_np && !of_find_property(sup_np, "compatible", NULL))
		sup_np = of_get_next_parent(sup_np);
	if (!sup_np)
		return 0;

	if (!of_link_is_valid(dev->of_node, sup_np)) {
		of_node_put(sup_np);
		return 0;
	}
	sup_dev = of_find_device_by_node(sup_np);
	of_node_put(sup_np);
	if (!sup_dev)
		return -ENODEV;
	if (!device_link_add(dev, &sup_dev->dev, dl_flags))
		ret = -ENODEV;
	put_device(&sup_dev->dev);
	return ret;
}

static struct device_node *parse_prop_cells(struct device_node *np,
					    const char *prop, int index,
					    const char *binding,
					    const char *cell)
{
	struct of_phandle_args sup_args;

	/* Don't need to check property name for every index. */
	if (!index && strcmp(prop, binding))
		return NULL;

	if (of_parse_phandle_with_args(np, binding, cell, index, &sup_args))
		return NULL;

	return sup_args.np;
}

static struct device_node *parse_clocks(struct device_node *np,
					const char *prop, int index)
{
	return parse_prop_cells(np, prop, index, "clocks", "#clock-cells");
}

static struct device_node *parse_interconnects(struct device_node *np,
					       const char *prop, int index)
{
	return parse_prop_cells(np, prop, index, "interconnects",
				"#interconnect-cells");
}

static int strcmp_suffix(const char *str, const char *suffix)
{
	unsigned int len, suffix_len;

	len = strlen(str);
	suffix_len = strlen(suffix);
	if (len <= suffix_len)
		return -1;
	return strcmp(str + len - suffix_len, suffix);
}

static struct device_node *parse_regulators(struct device_node *np,
					    const char *prop, int index)
{
	if (index || strcmp_suffix(prop, "-supply"))
		return NULL;

	return of_parse_phandle(np, prop, 0);
}

/**
 * struct supplier_bindings - Information for parsing supplier DT binding
 *
 * @parse_prop:		If the function cannot parse the property, return NULL.
 *			Otherwise, return the phandle listed in the property
 *			that corresponds to the index.
 */
struct supplier_bindings {
	struct device_node *(*parse_prop)(struct device_node *np,
					  const char *name, int index);
};

static const struct supplier_bindings bindings[] = {
	{ .parse_prop = parse_clocks, },
	{ .parse_prop = parse_interconnects, },
	{ .parse_prop = parse_regulators, },
	{ },
};

629
static int of_link_property(struct device *dev, struct device_node *con_np,
630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653
			     const char *prop)
{
	struct device_node *phandle;
	const struct supplier_bindings *s = bindings;
	unsigned int i = 0;
	bool done = true, matched = false;

	while (!matched && s->parse_prop) {
		while ((phandle = s->parse_prop(con_np, prop, i))) {
			matched = true;
			i++;
			if (of_link_to_phandle(dev, phandle))
				/*
				 * Don't stop at the first failure. See
				 * Documentation for bus_type.add_links for
				 * more details.
				 */
				done = false;
		}
		s++;
	}
	return done ? 0 : -ENODEV;
}

654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671
static int __of_link_to_suppliers(struct device *dev,
				  struct device_node *con_np)
{
	struct device_node *child;
	struct property *p;
	bool done = true;

	for_each_property_of_node(con_np, p)
		if (of_link_property(dev, con_np, p->name))
			done = false;

	for_each_child_of_node(con_np, child)
		if (__of_link_to_suppliers(dev, child))
			done = false;

	return done ? 0 : -ENODEV;
}

672 673 674 675 676 677 678 679 680
static bool of_devlink;
core_param(of_devlink, of_devlink, bool, 0);

static int of_link_to_suppliers(struct device *dev)
{
	if (!of_devlink)
		return 0;
	if (unlikely(!dev->of_node))
		return 0;
681 682
	if (of_match_node(of_default_bus_match_table, dev->of_node))
		return 0;
683

684
	return __of_link_to_suppliers(dev, dev->of_node);
685 686
}

687
static const struct of_device_id reserved_mem_matches[] = {
688
	{ .compatible = "qcom,rmtfs-mem" },
689
	{ .compatible = "qcom,cmd-db" },
690 691 692 693
	{ .compatible = "ramoops" },
	{}
};

694 695
static int __init of_platform_default_populate_init(void)
{
696 697 698 699 700
	struct device_node *node;

	if (!of_have_populated_dt())
		return -ENODEV;

701
	platform_bus_type.add_links = of_link_to_suppliers;
702
	device_links_supplier_sync_state_pause();
703
	/*
704 705 706
	 * Handle certain compatibles explicitly, since we don't want to create
	 * platform_devices for every node in /reserved-memory with a
	 * "compatible",
707
	 */
708 709
	for_each_matching_node(node, reserved_mem_matches)
		of_platform_device_create(node, NULL, NULL);
710

711
	node = of_find_node_by_path("/firmware");
712
	if (node) {
713
		of_platform_populate(node, NULL, NULL, NULL);
714 715
		of_node_put(node);
	}
716

717 718
	/* Populate everything else. */
	of_platform_default_populate(NULL, NULL, NULL);
719 720 721 722

	return 0;
}
arch_initcall_sync(of_platform_default_populate_init);
723 724 725

static int __init of_platform_sync_state_init(void)
{
726 727
	if (of_have_populated_dt())
		device_links_supplier_sync_state_resume();
728 729 730
	return 0;
}
late_initcall_sync(of_platform_sync_state_init);
731
#endif
732

733
int of_platform_device_destroy(struct device *dev, void *data)
734 735
{
	/* Do not touch devices not populated from the device tree */
736
	if (!dev->of_node || !of_node_check_flag(dev->of_node, OF_POPULATED))
737 738
		return 0;

739 740 741
	/* Recurse for any nodes that were treated as busses */
	if (of_node_check_flag(dev->of_node, OF_POPULATED_BUS))
		device_for_each_child(dev, NULL, of_platform_device_destroy);
742

743 744 745
	of_node_clear_flag(dev->of_node, OF_POPULATED);
	of_node_clear_flag(dev->of_node, OF_POPULATED_BUS);

746 747 748 749 750 751 752 753 754
	if (dev->bus == &platform_bus_type)
		platform_device_unregister(to_platform_device(dev));
#ifdef CONFIG_ARM_AMBA
	else if (dev->bus == &amba_bustype)
		amba_device_unregister(to_amba_device(dev));
#endif

	return 0;
}
755
EXPORT_SYMBOL_GPL(of_platform_device_destroy);
756 757 758

/**
 * of_platform_depopulate() - Remove devices populated from device tree
759
 * @parent: device which children will be removed
760 761 762 763 764 765
 *
 * Complementary to of_platform_populate(), this function removes children
 * of the given device (and, recurrently, their children) that have been
 * created from their respective device tree nodes (and only those,
 * leaving others - eg. manually created - unharmed).
 */
766
void of_platform_depopulate(struct device *parent)
767
{
768 769 770 771
	if (parent->of_node && of_node_check_flag(parent->of_node, OF_POPULATED_BUS)) {
		device_for_each_child(parent, NULL, of_platform_device_destroy);
		of_node_clear_flag(parent->of_node, OF_POPULATED_BUS);
	}
772 773 774
}
EXPORT_SYMBOL_GPL(of_platform_depopulate);

775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845
static void devm_of_platform_populate_release(struct device *dev, void *res)
{
	of_platform_depopulate(*(struct device **)res);
}

/**
 * devm_of_platform_populate() - Populate platform_devices from device tree data
 * @dev: device that requested to populate from device tree data
 *
 * Similar to of_platform_populate(), but will automatically call
 * of_platform_depopulate() when the device is unbound from the bus.
 *
 * Returns 0 on success, < 0 on failure.
 */
int devm_of_platform_populate(struct device *dev)
{
	struct device **ptr;
	int ret;

	if (!dev)
		return -EINVAL;

	ptr = devres_alloc(devm_of_platform_populate_release,
			   sizeof(*ptr), GFP_KERNEL);
	if (!ptr)
		return -ENOMEM;

	ret = of_platform_populate(dev->of_node, NULL, NULL, dev);
	if (ret) {
		devres_free(ptr);
	} else {
		*ptr = dev;
		devres_add(dev, ptr);
	}

	return ret;
}
EXPORT_SYMBOL_GPL(devm_of_platform_populate);

static int devm_of_platform_match(struct device *dev, void *res, void *data)
{
	struct device **ptr = res;

	if (!ptr) {
		WARN_ON(!ptr);
		return 0;
	}

	return *ptr == data;
}

/**
 * devm_of_platform_depopulate() - Remove devices populated from device tree
 * @dev: device that requested to depopulate from device tree data
 *
 * Complementary to devm_of_platform_populate(), this function removes children
 * of the given device (and, recurrently, their children) that have been
 * created from their respective device tree nodes (and only those,
 * leaving others - eg. manually created - unharmed).
 */
void devm_of_platform_depopulate(struct device *dev)
{
	int ret;

	ret = devres_release(dev, devm_of_platform_populate_release,
			     devm_of_platform_match, dev);

	WARN_ON(ret);
}
EXPORT_SYMBOL_GPL(devm_of_platform_depopulate);

846 847 848 849 850 851 852 853 854 855 856 857 858 859
#ifdef CONFIG_OF_DYNAMIC
static int of_platform_notify(struct notifier_block *nb,
				unsigned long action, void *arg)
{
	struct of_reconfig_data *rd = arg;
	struct platform_device *pdev_parent, *pdev;
	bool children_left;

	switch (of_reconfig_get_state_change(action, rd)) {
	case OF_RECONFIG_CHANGE_ADD:
		/* verify that the parent is a bus */
		if (!of_node_check_flag(rd->dn->parent, OF_POPULATED_BUS))
			return NOTIFY_OK;	/* not for us */

860 861 862 863
		/* already populated? (driver using of_populate manually) */
		if (of_node_check_flag(rd->dn, OF_POPULATED))
			return NOTIFY_OK;

864 865 866 867 868 869 870
		/* pdev_parent may be NULL when no bus platform device */
		pdev_parent = of_find_device_by_node(rd->dn->parent);
		pdev = of_platform_device_create(rd->dn, NULL,
				pdev_parent ? &pdev_parent->dev : NULL);
		of_dev_put(pdev_parent);

		if (pdev == NULL) {
871 872
			pr_err("%s: failed to create for '%pOF'\n",
					__func__, rd->dn);
873 874 875 876 877 878
			/* of_platform_device_create tosses the error code */
			return notifier_from_errno(-EINVAL);
		}
		break;

	case OF_RECONFIG_CHANGE_REMOVE:
879 880 881 882 883

		/* already depopulated? */
		if (!of_node_check_flag(rd->dn, OF_POPULATED))
			return NOTIFY_OK;

884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909
		/* find our device by node */
		pdev = of_find_device_by_node(rd->dn);
		if (pdev == NULL)
			return NOTIFY_OK;	/* no? not meant for us */

		/* unregister takes one ref away */
		of_platform_device_destroy(&pdev->dev, &children_left);

		/* and put the reference of the find */
		of_dev_put(pdev);
		break;
	}

	return NOTIFY_OK;
}

static struct notifier_block platform_of_notifier = {
	.notifier_call = of_platform_notify,
};

void of_platform_register_reconfig_notifier(void)
{
	WARN_ON(of_reconfig_notifier_register(&platform_of_notifier));
}
#endif /* CONFIG_OF_DYNAMIC */

910
#endif /* CONFIG_OF_ADDRESS */