xref: /openbmc/linux/drivers/of/platform.c (revision ef04d280)
1af6074fcSRob Herring // SPDX-License-Identifier: GPL-2.0+
23f23de10SStephen Rothwell /*
33f23de10SStephen Rothwell  *    Copyright (C) 2006 Benjamin Herrenschmidt, IBM Corp.
43f23de10SStephen Rothwell  *			 <benh@kernel.crashing.org>
53f23de10SStephen Rothwell  *    and		 Arnd Bergmann, IBM Corp.
63f23de10SStephen Rothwell  *    Merged from powerpc/kernel/of_platform.c and
73f23de10SStephen Rothwell  *    sparc{,64}/kernel/of_device.c by Stephen Rothwell
83f23de10SStephen Rothwell  */
9606ad42aSRob Herring 
10606ad42aSRob Herring #define pr_fmt(fmt)	"OF: " fmt
11606ad42aSRob Herring 
123f23de10SStephen Rothwell #include <linux/errno.h>
135c457083SStephen Rothwell #include <linux/module.h>
145de1540bSGrant Likely #include <linux/amba/bus.h>
153f23de10SStephen Rothwell #include <linux/device.h>
165fd200f3SGrant Likely #include <linux/dma-mapping.h>
1750ef5284SGrant Likely #include <linux/slab.h>
189e3288dcSGrant Likely #include <linux/of_address.h>
193f23de10SStephen Rothwell #include <linux/of_device.h>
209e3288dcSGrant Likely #include <linux/of_irq.h>
213f23de10SStephen Rothwell #include <linux/of_platform.h>
22eca39301SGrant Likely #include <linux/platform_device.h>
23eca39301SGrant Likely 
2473aca58bSRob Herring #include "of_private.h"
2573aca58bSRob Herring 
26cbb49c26SGrant Likely const struct of_device_id of_default_bus_match_table[] = {
27cbb49c26SGrant Likely 	{ .compatible = "simple-bus", },
2822869a9eSLinus Walleij 	{ .compatible = "simple-mfd", },
29ecd76edeSPaul Burton 	{ .compatible = "isa", },
30cbb49c26SGrant Likely #ifdef CONFIG_ARM_AMBA
31cbb49c26SGrant Likely 	{ .compatible = "arm,amba-bus", },
32cbb49c26SGrant Likely #endif /* CONFIG_ARM_AMBA */
33cbb49c26SGrant Likely 	{} /* Empty terminated list */
34cbb49c26SGrant Likely };
35cbb49c26SGrant Likely 
36c6085584SJonas Bonn /**
37c6085584SJonas Bonn  * of_find_device_by_node - Find the platform_device associated with a node
38c6085584SJonas Bonn  * @np: Pointer to device tree node
39c6085584SJonas Bonn  *
404fb373dfSJohan Hovold  * Takes a reference to the embedded struct device which needs to be dropped
414fb373dfSJohan Hovold  * after use.
424fb373dfSJohan Hovold  *
438c8239c2SRob Herring  * Return: platform_device pointer, or NULL if not found
44c6085584SJonas Bonn  */
of_find_device_by_node(struct device_node * np)45c6085584SJonas Bonn struct platform_device *of_find_device_by_node(struct device_node *np)
46c6085584SJonas Bonn {
47c6085584SJonas Bonn 	struct device *dev;
48c6085584SJonas Bonn 
49cfba5de9SSuzuki K Poulose 	dev = bus_find_device_by_of_node(&platform_bus_type, np);
50c6085584SJonas Bonn 	return dev ? to_platform_device(dev) : NULL;
51c6085584SJonas Bonn }
52c6085584SJonas Bonn EXPORT_SYMBOL(of_find_device_by_node);
53c6085584SJonas Bonn 
of_device_add(struct platform_device * ofdev)5466a4210bSRob Herring int of_device_add(struct platform_device *ofdev)
5566a4210bSRob Herring {
5666a4210bSRob Herring 	BUG_ON(ofdev->dev.of_node == NULL);
5766a4210bSRob Herring 
5866a4210bSRob Herring 	/* name and id have to be set so that the platform bus doesn't get
5966a4210bSRob Herring 	 * confused on matching */
6066a4210bSRob Herring 	ofdev->name = dev_name(&ofdev->dev);
6166a4210bSRob Herring 	ofdev->id = PLATFORM_DEVID_NONE;
6266a4210bSRob Herring 
6366a4210bSRob Herring 	/*
6466a4210bSRob Herring 	 * If this device has not binding numa node in devicetree, that is
6566a4210bSRob Herring 	 * of_node_to_nid returns NUMA_NO_NODE. device_add will assume that this
6666a4210bSRob Herring 	 * device is on the same node as the parent.
6766a4210bSRob Herring 	 */
6866a4210bSRob Herring 	set_dev_node(&ofdev->dev, of_node_to_nid(ofdev->dev.of_node));
6966a4210bSRob Herring 
7066a4210bSRob Herring 	return device_add(&ofdev->dev);
7166a4210bSRob Herring }
7266a4210bSRob Herring 
of_device_register(struct platform_device * pdev)7366a4210bSRob Herring int of_device_register(struct platform_device *pdev)
7466a4210bSRob Herring {
7566a4210bSRob Herring 	device_initialize(&pdev->dev);
7666a4210bSRob Herring 	return of_device_add(pdev);
7766a4210bSRob Herring }
7866a4210bSRob Herring EXPORT_SYMBOL(of_device_register);
7966a4210bSRob Herring 
of_device_unregister(struct platform_device * ofdev)8066a4210bSRob Herring void of_device_unregister(struct platform_device *ofdev)
8166a4210bSRob Herring {
8266a4210bSRob Herring 	device_unregister(&ofdev->dev);
8366a4210bSRob Herring }
8466a4210bSRob Herring EXPORT_SYMBOL(of_device_unregister);
8566a4210bSRob Herring 
86964dba28SGrant Likely #ifdef CONFIG_OF_ADDRESS
87*ef04d280SViresh Kumar static const struct of_device_id of_skipped_node_table[] = {
88*ef04d280SViresh Kumar 	{ .compatible = "operating-points-v2", },
89*ef04d280SViresh Kumar 	{} /* Empty terminated list */
90*ef04d280SViresh Kumar };
91*ef04d280SViresh Kumar 
925fd200f3SGrant Likely /*
935fd200f3SGrant Likely  * The following routines scan a subtree and registers a device for
945fd200f3SGrant Likely  * each applicable node.
955fd200f3SGrant Likely  *
965fd200f3SGrant Likely  * Note: sparc doesn't use these routines because it has a different
975fd200f3SGrant Likely  * mechanism for creating devices from device tree nodes.
985fd200f3SGrant Likely  */
995fd200f3SGrant Likely 
1005fd200f3SGrant Likely /**
10194c09319SGrant Likely  * of_device_make_bus_id - Use the device node data to assign a unique name
10294c09319SGrant Likely  * @dev: pointer to device structure that is linked to a device tree node
10394c09319SGrant Likely  *
10407e461cdSGrant Likely  * This routine will first try using the translated bus address to
10507e461cdSGrant Likely  * derive a unique name. If it cannot, then it will prepend names from
10607e461cdSGrant Likely  * parent nodes until a unique name can be derived.
10794c09319SGrant Likely  */
of_device_make_bus_id(struct device * dev)108e553f539SFrank Rowand static void of_device_make_bus_id(struct device *dev)
10994c09319SGrant Likely {
11094c09319SGrant Likely 	struct device_node *node = dev->of_node;
11124fb530fSKim Phillips 	const __be32 *reg;
11294c09319SGrant Likely 	u64 addr;
11368d16195SRob Herring 	u32 mask;
11494c09319SGrant Likely 
11507e461cdSGrant Likely 	/* Construct the name, using parent nodes if necessary to ensure uniqueness */
11607e461cdSGrant Likely 	while (node->parent) {
11794c09319SGrant Likely 		/*
11807e461cdSGrant Likely 		 * If the address can be translated, then that is as much
11907e461cdSGrant Likely 		 * uniqueness as we need. Make it the first component and return
12094c09319SGrant Likely 		 */
12194c09319SGrant Likely 		reg = of_get_property(node, "reg", NULL);
12207e461cdSGrant Likely 		if (reg && (addr = of_translate_address(node, reg)) != OF_BAD_ADDR) {
12368d16195SRob Herring 			if (!of_property_read_u32(node, "mask", &mask))
12468d16195SRob Herring 				dev_set_name(dev, dev_name(dev) ? "%llx.%x.%pOFn:%s" : "%llx.%x.%pOFn",
12568d16195SRob Herring 					     addr, ffs(mask) - 1, node, dev_name(dev));
12668d16195SRob Herring 
12768d16195SRob Herring 			else
128a613b26aSRob Herring 				dev_set_name(dev, dev_name(dev) ? "%llx.%pOFn:%s" : "%llx.%pOFn",
129d88590dcSGeert Uytterhoeven 					     addr, node, dev_name(dev));
13094c09319SGrant Likely 			return;
13194c09319SGrant Likely 		}
13294c09319SGrant Likely 
13307e461cdSGrant Likely 		/* format arguments only used if dev_name() resolves to NULL */
13407e461cdSGrant Likely 		dev_set_name(dev, dev_name(dev) ? "%s:%s" : "%s",
13595e6b1faSRob Herring 			     kbasename(node->full_name), dev_name(dev));
13607e461cdSGrant Likely 		node = node->parent;
13707e461cdSGrant Likely 	}
13894c09319SGrant Likely }
13994c09319SGrant Likely 
14094c09319SGrant Likely /**
14194c09319SGrant Likely  * of_device_alloc - Allocate and initialize an of_device
14294c09319SGrant Likely  * @np: device node to assign to device
14394c09319SGrant Likely  * @bus_id: Name to assign to the device.  May be null to use default name.
14494c09319SGrant Likely  * @parent: Parent device.
14594c09319SGrant Likely  */
of_device_alloc(struct device_node * np,const char * bus_id,struct device * parent)14694a0cb1fSGrant Likely struct platform_device *of_device_alloc(struct device_node *np,
14794c09319SGrant Likely 				  const char *bus_id,
14894c09319SGrant Likely 				  struct device *parent)
14994c09319SGrant Likely {
15094a0cb1fSGrant Likely 	struct platform_device *dev;
151a1a2b712SLad Prabhakar 	int rc, i, num_reg = 0;
15232e8f9b3SYang Yingliang 	struct resource *res;
15394c09319SGrant Likely 
1546d7e3bf8SAndy Shevchenko 	dev = platform_device_alloc("", PLATFORM_DEVID_NONE);
1557096d042SGrant Likely 	if (!dev)
1567096d042SGrant Likely 		return NULL;
1577096d042SGrant Likely 
158a1a2b712SLad Prabhakar 	/* count the io resources */
15932e8f9b3SYang Yingliang 	num_reg = of_address_count(np);
160ac80a51eSGrant Likely 
161ac80a51eSGrant Likely 	/* Populate the resource table */
162a1a2b712SLad Prabhakar 	if (num_reg) {
163a1a2b712SLad Prabhakar 		res = kcalloc(num_reg, sizeof(*res), GFP_KERNEL);
1647096d042SGrant Likely 		if (!res) {
1657096d042SGrant Likely 			platform_device_put(dev);
1667096d042SGrant Likely 			return NULL;
1677096d042SGrant Likely 		}
1687096d042SGrant Likely 
169a1a2b712SLad Prabhakar 		dev->num_resources = num_reg;
170ac80a51eSGrant Likely 		dev->resource = res;
171ac80a51eSGrant Likely 		for (i = 0; i < num_reg; i++, res++) {
172ac80a51eSGrant Likely 			rc = of_address_to_resource(np, i, res);
173ac80a51eSGrant Likely 			WARN_ON(rc);
174ac80a51eSGrant Likely 		}
175ac80a51eSGrant Likely 	}
17694c09319SGrant Likely 
1770f8e5651SAndy Shevchenko 	/* setup generic device info */
1787882541cSPeng Fan 	device_set_node(&dev->dev, of_fwnode_handle(of_node_get(np)));
17943c0767eSGrant Likely 	dev->dev.parent = parent ? : &platform_bus;
18094c09319SGrant Likely 
18194c09319SGrant Likely 	if (bus_id)
18294c09319SGrant Likely 		dev_set_name(&dev->dev, "%s", bus_id);
18394c09319SGrant Likely 	else
18494c09319SGrant Likely 		of_device_make_bus_id(&dev->dev);
18594c09319SGrant Likely 
18694c09319SGrant Likely 	return dev;
18794c09319SGrant Likely }
18894c09319SGrant Likely EXPORT_SYMBOL(of_device_alloc);
18994c09319SGrant Likely 
190591c1ee4SSantosh Shilimkar /**
19115c3597dSGrant Likely  * of_platform_device_create_pdata - Alloc, initialize and register an of_device
1925fd200f3SGrant Likely  * @np: pointer to node to create device for
1935fd200f3SGrant Likely  * @bus_id: name to assign device
19415c3597dSGrant Likely  * @platform_data: pointer to populate platform_data pointer with
1955fd200f3SGrant Likely  * @parent: Linux device model parent device.
196cd1e6504SGrant Likely  *
1978c8239c2SRob Herring  * Return: Pointer to created platform device, or NULL if a device was not
198cd1e6504SGrant Likely  * registered.  Unavailable devices will not get registered.
1995fd200f3SGrant Likely  */
of_platform_device_create_pdata(struct device_node * np,const char * bus_id,void * platform_data,struct device * parent)200245d9641SMark Brown static struct platform_device *of_platform_device_create_pdata(
20115c3597dSGrant Likely 					struct device_node *np,
2025fd200f3SGrant Likely 					const char *bus_id,
20315c3597dSGrant Likely 					void *platform_data,
2045fd200f3SGrant Likely 					struct device *parent)
2055fd200f3SGrant Likely {
20694a0cb1fSGrant Likely 	struct platform_device *dev;
2075fd200f3SGrant Likely 
208c6e126deSPawel Moll 	if (!of_device_is_available(np) ||
209c6e126deSPawel Moll 	    of_node_test_and_set_flag(np, OF_POPULATED))
210cd1e6504SGrant Likely 		return NULL;
211cd1e6504SGrant Likely 
2125fd200f3SGrant Likely 	dev = of_device_alloc(np, bus_id, parent);
2135fd200f3SGrant Likely 	if (!dev)
214c6e126deSPawel Moll 		goto err_clear_flag;
2155fd200f3SGrant Likely 
216a5516219SRobin Murphy 	dev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
217a5516219SRobin Murphy 	if (!dev->dev.dma_mask)
218a5516219SRobin Murphy 		dev->dev.dma_mask = &dev->dev.coherent_dma_mask;
219eca39301SGrant Likely 	dev->dev.bus = &platform_bus_type;
22015c3597dSGrant Likely 	dev->dev.platform_data = platform_data;
221c706c239SMarc Zyngier 	of_msi_configure(&dev->dev, dev->dev.of_node);
2225fd200f3SGrant Likely 
2237096d042SGrant Likely 	if (of_device_add(dev) != 0) {
2247096d042SGrant Likely 		platform_device_put(dev);
225c6e126deSPawel Moll 		goto err_clear_flag;
2265fd200f3SGrant Likely 	}
2275fd200f3SGrant Likely 
2285fd200f3SGrant Likely 	return dev;
229c6e126deSPawel Moll 
230c6e126deSPawel Moll err_clear_flag:
231c6e126deSPawel Moll 	of_node_clear_flag(np, OF_POPULATED);
232c6e126deSPawel Moll 	return NULL;
2335fd200f3SGrant Likely }
23415c3597dSGrant Likely 
23515c3597dSGrant Likely /**
23615c3597dSGrant Likely  * of_platform_device_create - Alloc, initialize and register an of_device
23715c3597dSGrant Likely  * @np: pointer to node to create device for
23815c3597dSGrant Likely  * @bus_id: name to assign device
23915c3597dSGrant Likely  * @parent: Linux device model parent device.
24015c3597dSGrant Likely  *
2418c8239c2SRob Herring  * Return: Pointer to created platform device, or NULL if a device was not
24215c3597dSGrant Likely  * registered.  Unavailable devices will not get registered.
24315c3597dSGrant Likely  */
of_platform_device_create(struct device_node * np,const char * bus_id,struct device * parent)24415c3597dSGrant Likely struct platform_device *of_platform_device_create(struct device_node *np,
24515c3597dSGrant Likely 					    const char *bus_id,
24615c3597dSGrant Likely 					    struct device *parent)
24715c3597dSGrant Likely {
24815c3597dSGrant Likely 	return of_platform_device_create_pdata(np, bus_id, NULL, parent);
24915c3597dSGrant Likely }
2505fd200f3SGrant Likely EXPORT_SYMBOL(of_platform_device_create);
2515fd200f3SGrant Likely 
2525de1540bSGrant Likely #ifdef CONFIG_ARM_AMBA
of_amba_device_create(struct device_node * node,const char * bus_id,void * platform_data,struct device * parent)2535de1540bSGrant Likely static struct amba_device *of_amba_device_create(struct device_node *node,
2545de1540bSGrant Likely 						 const char *bus_id,
2555de1540bSGrant Likely 						 void *platform_data,
2565de1540bSGrant Likely 						 struct device *parent)
2575de1540bSGrant Likely {
2585de1540bSGrant Likely 	struct amba_device *dev;
259854f695cSWang Kefeng 	int ret;
2605de1540bSGrant Likely 
2610d638a07SRob Herring 	pr_debug("Creating amba device %pOF\n", node);
2625de1540bSGrant Likely 
263c6e126deSPawel Moll 	if (!of_device_is_available(node) ||
264c6e126deSPawel Moll 	    of_node_test_and_set_flag(node, OF_POPULATED))
2655de1540bSGrant Likely 		return NULL;
2665de1540bSGrant Likely 
267c0f72f8aSRussell King 	dev = amba_device_alloc(NULL, 0, 0);
268606ad42aSRob Herring 	if (!dev)
269c6e126deSPawel Moll 		goto err_clear_flag;
2705de1540bSGrant Likely 
2718c89ef7bSLinus Walleij 	/* AMBA devices only support a single DMA mask */
2728c89ef7bSLinus Walleij 	dev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
2738c89ef7bSLinus Walleij 	dev->dev.dma_mask = &dev->dev.coherent_dma_mask;
2748c89ef7bSLinus Walleij 
2755de1540bSGrant Likely 	/* setup generic device info */
2767882541cSPeng Fan 	device_set_node(&dev->dev, of_fwnode_handle(of_node_get(node)));
27743c0767eSGrant Likely 	dev->dev.parent = parent ? : &platform_bus;
2785de1540bSGrant Likely 	dev->dev.platform_data = platform_data;
2795de1540bSGrant Likely 	if (bus_id)
2805de1540bSGrant Likely 		dev_set_name(&dev->dev, "%s", bus_id);
2815de1540bSGrant Likely 	else
2825de1540bSGrant Likely 		of_device_make_bus_id(&dev->dev);
2835de1540bSGrant Likely 
2845de1540bSGrant Likely 	/* Allow the HW Peripheral ID to be overridden */
28516b0c7caSRob Herring 	of_property_read_u32(node, "arm,primecell-periphid", &dev->periphid);
2865de1540bSGrant Likely 
2875de1540bSGrant Likely 	ret = of_address_to_resource(node, 0, &dev->res);
2882bc552dfSBartlomiej Zolnierkiewicz 	if (ret) {
2890d638a07SRob Herring 		pr_err("amba: of_address_to_resource() failed (%d) for %pOF\n",
2900d638a07SRob Herring 		       ret, node);
2915de1540bSGrant Likely 		goto err_free;
2922bc552dfSBartlomiej Zolnierkiewicz 	}
2935de1540bSGrant Likely 
294c0f72f8aSRussell King 	ret = amba_device_add(dev, &iomem_resource);
2952bc552dfSBartlomiej Zolnierkiewicz 	if (ret) {
2960d638a07SRob Herring 		pr_err("amba_device_add() failed (%d) for %pOF\n",
2970d638a07SRob Herring 		       ret, node);
2985de1540bSGrant Likely 		goto err_free;
2992bc552dfSBartlomiej Zolnierkiewicz 	}
3005de1540bSGrant Likely 
3015de1540bSGrant Likely 	return dev;
3025de1540bSGrant Likely 
3035de1540bSGrant Likely err_free:
304c0f72f8aSRussell King 	amba_device_put(dev);
305c6e126deSPawel Moll err_clear_flag:
306c6e126deSPawel Moll 	of_node_clear_flag(node, OF_POPULATED);
3075de1540bSGrant Likely 	return NULL;
3085de1540bSGrant Likely }
3095de1540bSGrant Likely #else /* CONFIG_ARM_AMBA */
of_amba_device_create(struct device_node * node,const char * bus_id,void * platform_data,struct device * parent)3105de1540bSGrant Likely static struct amba_device *of_amba_device_create(struct device_node *node,
3115de1540bSGrant Likely 						 const char *bus_id,
3125de1540bSGrant Likely 						 void *platform_data,
3135de1540bSGrant Likely 						 struct device *parent)
3145de1540bSGrant Likely {
3155de1540bSGrant Likely 	return NULL;
3165de1540bSGrant Likely }
3175de1540bSGrant Likely #endif /* CONFIG_ARM_AMBA */
3185de1540bSGrant Likely 
319f3896a7eSLee Jones /*
320f9a529b9SQi Zheng  * of_dev_lookup() - Given a device node, lookup the preferred Linux name
32115c3597dSGrant Likely  */
of_dev_lookup(const struct of_dev_auxdata * lookup,struct device_node * np)32215c3597dSGrant Likely static const struct of_dev_auxdata *of_dev_lookup(const struct of_dev_auxdata *lookup,
32315c3597dSGrant Likely 				 struct device_node *np)
32415c3597dSGrant Likely {
325fc5cf80aSTony Lindgren 	const struct of_dev_auxdata *auxdata;
32615c3597dSGrant Likely 	struct resource res;
327fc5cf80aSTony Lindgren 	int compatible = 0;
328303f59d1SOlof Johansson 
329303f59d1SOlof Johansson 	if (!lookup)
330303f59d1SOlof Johansson 		return NULL;
331303f59d1SOlof Johansson 
332fc5cf80aSTony Lindgren 	auxdata = lookup;
333fc5cf80aSTony Lindgren 	for (; auxdata->compatible; auxdata++) {
334fc5cf80aSTony Lindgren 		if (!of_device_is_compatible(np, auxdata->compatible))
33515c3597dSGrant Likely 			continue;
336fc5cf80aSTony Lindgren 		compatible++;
33784774e61SLee Jones 		if (!of_address_to_resource(np, 0, &res))
338fc5cf80aSTony Lindgren 			if (res.start != auxdata->phys_addr)
33915c3597dSGrant Likely 				continue;
3400d638a07SRob Herring 		pr_debug("%pOF: devname=%s\n", np, auxdata->name);
341fc5cf80aSTony Lindgren 		return auxdata;
342fc5cf80aSTony Lindgren 	}
343fc5cf80aSTony Lindgren 
344fc5cf80aSTony Lindgren 	if (!compatible)
345fc5cf80aSTony Lindgren 		return NULL;
346fc5cf80aSTony Lindgren 
347fc5cf80aSTony Lindgren 	/* Try compatible match if no phys_addr and name are specified */
348fc5cf80aSTony Lindgren 	auxdata = lookup;
349fc5cf80aSTony Lindgren 	for (; auxdata->compatible; auxdata++) {
350fc5cf80aSTony Lindgren 		if (!of_device_is_compatible(np, auxdata->compatible))
351fc5cf80aSTony Lindgren 			continue;
352fc5cf80aSTony Lindgren 		if (!auxdata->phys_addr && !auxdata->name) {
3530d638a07SRob Herring 			pr_debug("%pOF: compatible match\n", np);
354fc5cf80aSTony Lindgren 			return auxdata;
355fc5cf80aSTony Lindgren 		}
35615c3597dSGrant Likely 	}
357303f59d1SOlof Johansson 
35815c3597dSGrant Likely 	return NULL;
35915c3597dSGrant Likely }
36015c3597dSGrant Likely 
36115c3597dSGrant Likely /**
36238e9e21dSGrant Likely  * of_platform_bus_create() - Create a device for a node and its children.
3635fd200f3SGrant Likely  * @bus: device node of the bus to instantiate
3641eed4c07SGrant Likely  * @matches: match table for bus nodes
365303f59d1SOlof Johansson  * @lookup: auxdata table for matching id and platform_data with device nodes
36638e9e21dSGrant Likely  * @parent: parent for new device, or NULL for top level.
367303f59d1SOlof Johansson  * @strict: require compatible property
36838e9e21dSGrant Likely  *
36938e9e21dSGrant Likely  * Creates a platform_device for the provided device_node, and optionally
37038e9e21dSGrant Likely  * recursively create devices for all the child nodes.
3715fd200f3SGrant Likely  */
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)37238e9e21dSGrant Likely static int of_platform_bus_create(struct device_node *bus,
3735fd200f3SGrant Likely 				  const struct of_device_id *matches,
37415c3597dSGrant Likely 				  const struct of_dev_auxdata *lookup,
37529d4f8a4SGrant Likely 				  struct device *parent, bool strict)
3765fd200f3SGrant Likely {
37715c3597dSGrant Likely 	const struct of_dev_auxdata *auxdata;
3785fd200f3SGrant Likely 	struct device_node *child;
37994a0cb1fSGrant Likely 	struct platform_device *dev;
38015c3597dSGrant Likely 	const char *bus_id = NULL;
38115c3597dSGrant Likely 	void *platform_data = NULL;
3825fd200f3SGrant Likely 	int rc = 0;
3835fd200f3SGrant Likely 
38429d4f8a4SGrant Likely 	/* Make sure it has a compatible property */
38529d4f8a4SGrant Likely 	if (strict && (!of_get_property(bus, "compatible", NULL))) {
3860d638a07SRob Herring 		pr_debug("%s() - skipping %pOF, no compatible prop\n",
3870d638a07SRob Herring 			 __func__, bus);
38829d4f8a4SGrant Likely 		return 0;
38929d4f8a4SGrant Likely 	}
39029d4f8a4SGrant Likely 
3914550fe63SViresh Kumar 	/* Skip nodes for which we don't want to create devices */
3924550fe63SViresh Kumar 	if (unlikely(of_match_node(of_skipped_node_table, bus))) {
3934550fe63SViresh Kumar 		pr_debug("%s() - skipping %pOF node\n", __func__, bus);
3944550fe63SViresh Kumar 		return 0;
3954550fe63SViresh Kumar 	}
3964550fe63SViresh Kumar 
39744a7185cSKefeng Wang 	if (of_node_check_flag(bus, OF_POPULATED_BUS)) {
3980d638a07SRob Herring 		pr_debug("%s() - skipping %pOF, already populated\n",
3990d638a07SRob Herring 			__func__, bus);
40044a7185cSKefeng Wang 		return 0;
40144a7185cSKefeng Wang 	}
40244a7185cSKefeng Wang 
40315c3597dSGrant Likely 	auxdata = of_dev_lookup(lookup, bus);
40415c3597dSGrant Likely 	if (auxdata) {
40515c3597dSGrant Likely 		bus_id = auxdata->name;
40615c3597dSGrant Likely 		platform_data = auxdata->platform_data;
40715c3597dSGrant Likely 	}
40815c3597dSGrant Likely 
4095de1540bSGrant Likely 	if (of_device_is_compatible(bus, "arm,primecell")) {
4102bc552dfSBartlomiej Zolnierkiewicz 		/*
4112bc552dfSBartlomiej Zolnierkiewicz 		 * Don't return an error here to keep compatibility with older
4122bc552dfSBartlomiej Zolnierkiewicz 		 * device tree files.
4132bc552dfSBartlomiej Zolnierkiewicz 		 */
41415c3597dSGrant Likely 		of_amba_device_create(bus, bus_id, platform_data, parent);
4155de1540bSGrant Likely 		return 0;
4165de1540bSGrant Likely 	}
4175de1540bSGrant Likely 
41815c3597dSGrant Likely 	dev = of_platform_device_create_pdata(bus, bus_id, platform_data, parent);
41938e9e21dSGrant Likely 	if (!dev || !of_match_node(matches, bus))
42038e9e21dSGrant Likely 		return 0;
42138e9e21dSGrant Likely 
4225fd200f3SGrant Likely 	for_each_child_of_node(bus, child) {
4230d638a07SRob Herring 		pr_debug("   create child: %pOF\n", child);
42415c3597dSGrant Likely 		rc = of_platform_bus_create(child, matches, lookup, &dev->dev, strict);
4255fd200f3SGrant Likely 		if (rc) {
4265fd200f3SGrant Likely 			of_node_put(child);
4275fd200f3SGrant Likely 			break;
4285fd200f3SGrant Likely 		}
4295fd200f3SGrant Likely 	}
43075f353b6SGrant Likely 	of_node_set_flag(bus, OF_POPULATED_BUS);
4315fd200f3SGrant Likely 	return rc;
4325fd200f3SGrant Likely }
4335fd200f3SGrant Likely 
4345fd200f3SGrant Likely /**
43538e9e21dSGrant Likely  * of_platform_bus_probe() - Probe the device-tree for platform buses
4365fd200f3SGrant Likely  * @root: parent of the first level to probe or NULL for the root of the tree
4371eed4c07SGrant Likely  * @matches: match table for bus nodes
4385fd200f3SGrant Likely  * @parent: parent to hook devices from, NULL for toplevel
4395fd200f3SGrant Likely  *
4405fd200f3SGrant Likely  * Note that children of the provided root are not instantiated as devices
4415fd200f3SGrant Likely  * unless the specified root itself matches the bus list and is not NULL.
4425fd200f3SGrant Likely  */
of_platform_bus_probe(struct device_node * root,const struct of_device_id * matches,struct device * parent)4435fd200f3SGrant Likely int of_platform_bus_probe(struct device_node *root,
4445fd200f3SGrant Likely 			  const struct of_device_id *matches,
4455fd200f3SGrant Likely 			  struct device *parent)
4465fd200f3SGrant Likely {
4475fd200f3SGrant Likely 	struct device_node *child;
4485fd200f3SGrant Likely 	int rc = 0;
4495fd200f3SGrant Likely 
4501eed4c07SGrant Likely 	root = root ? of_node_get(root) : of_find_node_by_path("/");
4511eed4c07SGrant Likely 	if (!root)
45260d59913SGrant Likely 		return -EINVAL;
4535fd200f3SGrant Likely 
45444a7185cSKefeng Wang 	pr_debug("%s()\n", __func__);
4550d638a07SRob Herring 	pr_debug(" starting at: %pOF\n", root);
4565fd200f3SGrant Likely 
4571eed4c07SGrant Likely 	/* Do a self check of bus type, if there's a match, create children */
4585fd200f3SGrant Likely 	if (of_match_node(matches, root)) {
45915c3597dSGrant Likely 		rc = of_platform_bus_create(root, matches, NULL, parent, false);
46038e9e21dSGrant Likely 	} else for_each_child_of_node(root, child) {
4615fd200f3SGrant Likely 		if (!of_match_node(matches, child))
4625fd200f3SGrant Likely 			continue;
46315c3597dSGrant Likely 		rc = of_platform_bus_create(child, matches, NULL, parent, false);
4647fad948aSJulia Lawall 		if (rc) {
4657fad948aSJulia Lawall 			of_node_put(child);
4665fd200f3SGrant Likely 			break;
4675fd200f3SGrant Likely 		}
4687fad948aSJulia Lawall 	}
46938e9e21dSGrant Likely 
4705fd200f3SGrant Likely 	of_node_put(root);
4715fd200f3SGrant Likely 	return rc;
4725fd200f3SGrant Likely }
4735fd200f3SGrant Likely EXPORT_SYMBOL(of_platform_bus_probe);
47429d4f8a4SGrant Likely 
47529d4f8a4SGrant Likely /**
47629d4f8a4SGrant Likely  * of_platform_populate() - Populate platform_devices from device tree data
47729d4f8a4SGrant Likely  * @root: parent of the first level to probe or NULL for the root of the tree
47829d4f8a4SGrant Likely  * @matches: match table, NULL to use the default
47992039ed1SJavi Merino  * @lookup: auxdata table for matching id and platform_data with device nodes
48029d4f8a4SGrant Likely  * @parent: parent to hook devices from, NULL for toplevel
48129d4f8a4SGrant Likely  *
48229d4f8a4SGrant Likely  * Similar to of_platform_bus_probe(), this function walks the device tree
48329d4f8a4SGrant Likely  * and creates devices from nodes.  It differs in that it follows the modern
48429d4f8a4SGrant Likely  * convention of requiring all device nodes to have a 'compatible' property,
48529d4f8a4SGrant Likely  * and it is suitable for creating devices which are children of the root
48629d4f8a4SGrant Likely  * node (of_platform_bus_probe will only create children of the root which
48729d4f8a4SGrant Likely  * are selected by the @matches argument).
48829d4f8a4SGrant Likely  *
48929d4f8a4SGrant Likely  * New board support should be using this function instead of
49029d4f8a4SGrant Likely  * of_platform_bus_probe().
49129d4f8a4SGrant Likely  *
4928c8239c2SRob Herring  * Return: 0 on success, < 0 on failure.
49329d4f8a4SGrant Likely  */
of_platform_populate(struct device_node * root,const struct of_device_id * matches,const struct of_dev_auxdata * lookup,struct device * parent)49429d4f8a4SGrant Likely int of_platform_populate(struct device_node *root,
49529d4f8a4SGrant Likely 			const struct of_device_id *matches,
49615c3597dSGrant Likely 			const struct of_dev_auxdata *lookup,
49729d4f8a4SGrant Likely 			struct device *parent)
49829d4f8a4SGrant Likely {
49929d4f8a4SGrant Likely 	struct device_node *child;
50029d4f8a4SGrant Likely 	int rc = 0;
50129d4f8a4SGrant Likely 
50229d4f8a4SGrant Likely 	root = root ? of_node_get(root) : of_find_node_by_path("/");
50329d4f8a4SGrant Likely 	if (!root)
50429d4f8a4SGrant Likely 		return -EINVAL;
50529d4f8a4SGrant Likely 
50644a7185cSKefeng Wang 	pr_debug("%s()\n", __func__);
5070d638a07SRob Herring 	pr_debug(" starting at: %pOF\n", root);
50844a7185cSKefeng Wang 
5095e666938SSaravana Kannan 	device_links_supplier_sync_state_pause();
51029d4f8a4SGrant Likely 	for_each_child_of_node(root, child) {
51115c3597dSGrant Likely 		rc = of_platform_bus_create(child, matches, lookup, parent, true);
5127fad948aSJulia Lawall 		if (rc) {
5137fad948aSJulia Lawall 			of_node_put(child);
51429d4f8a4SGrant Likely 			break;
51529d4f8a4SGrant Likely 		}
5167fad948aSJulia Lawall 	}
5175e666938SSaravana Kannan 	device_links_supplier_sync_state_resume();
5185e666938SSaravana Kannan 
5192d0747c4SGrant Likely 	of_node_set_flag(root, OF_POPULATED_BUS);
52029d4f8a4SGrant Likely 
52129d4f8a4SGrant Likely 	of_node_put(root);
52229d4f8a4SGrant Likely 	return rc;
52329d4f8a4SGrant Likely }
524e001f1c8SStephen Warren EXPORT_SYMBOL_GPL(of_platform_populate);
525c6e126deSPawel Moll 
of_platform_default_populate(struct device_node * root,const struct of_dev_auxdata * lookup,struct device * parent)52643443ad6SHauke Mehrtens int of_platform_default_populate(struct device_node *root,
52743443ad6SHauke Mehrtens 				 const struct of_dev_auxdata *lookup,
52843443ad6SHauke Mehrtens 				 struct device *parent)
52943443ad6SHauke Mehrtens {
53043443ad6SHauke Mehrtens 	return of_platform_populate(root, of_default_bus_match_table, lookup,
53143443ad6SHauke Mehrtens 				    parent);
53243443ad6SHauke Mehrtens }
53343443ad6SHauke Mehrtens EXPORT_SYMBOL_GPL(of_platform_default_populate);
53443443ad6SHauke Mehrtens 
535a50ff19dSBjorn Andersson static const struct of_device_id reserved_mem_matches[] = {
5367090d2f1SVincent Whitchurch 	{ .compatible = "phram" },
537d1de6d6cSBjorn Andersson 	{ .compatible = "qcom,rmtfs-mem" },
538312416d9SMahesh Sivasubramanian 	{ .compatible = "qcom,cmd-db" },
539b5af64fcSBjorn Andersson 	{ .compatible = "qcom,smem" },
540a50ff19dSBjorn Andersson 	{ .compatible = "ramoops" },
5415a3fa75aSNicolas Saenz Julienne 	{ .compatible = "nvmem-rmem" },
542f396ededSDavid Brazdil 	{ .compatible = "google,open-dice" },
543a50ff19dSBjorn Andersson 	{}
544a50ff19dSBjorn Andersson };
545a50ff19dSBjorn Andersson 
of_platform_default_populate_init(void)54644a7185cSKefeng Wang static int __init of_platform_default_populate_init(void)
54744a7185cSKefeng Wang {
548529182e2SKees Cook 	struct device_node *node;
549529182e2SKees Cook 
550ee9b280eSSaravana Kannan 	device_links_supplier_sync_state_pause();
551ee9b280eSSaravana Kannan 
552529182e2SKees Cook 	if (!of_have_populated_dt())
553529182e2SKees Cook 		return -ENODEV;
554529182e2SKees Cook 
55552b1b46cSThomas Zimmermann 	if (IS_ENABLED(CONFIG_PPC)) {
55652b1b46cSThomas Zimmermann 		struct device_node *boot_display = NULL;
55752b1b46cSThomas Zimmermann 		struct platform_device *dev;
558241d2fb5SMichal Suchanek 		int display_number = 0;
55952b1b46cSThomas Zimmermann 		int ret;
56052b1b46cSThomas Zimmermann 
56152b1b46cSThomas Zimmermann 		/* Check if we have a MacOS display without a node spec */
5622f0cb475SRob Herring 		if (of_property_present(of_chosen, "linux,bootx-noscreen")) {
56352b1b46cSThomas Zimmermann 			/*
56452b1b46cSThomas Zimmermann 			 * The old code tried to work out which node was the MacOS
56552b1b46cSThomas Zimmermann 			 * display based on the address. I'm dropping that since the
56652b1b46cSThomas Zimmermann 			 * lack of a node spec only happens with old BootX versions
56752b1b46cSThomas Zimmermann 			 * (users can update) and with this code, they'll still get
56852b1b46cSThomas Zimmermann 			 * a display (just not the palette hacks).
56952b1b46cSThomas Zimmermann 			 */
57052b1b46cSThomas Zimmermann 			dev = platform_device_alloc("bootx-noscreen", 0);
57152b1b46cSThomas Zimmermann 			if (WARN_ON(!dev))
57252b1b46cSThomas Zimmermann 				return -ENOMEM;
57352b1b46cSThomas Zimmermann 			ret = platform_device_add(dev);
57452b1b46cSThomas Zimmermann 			if (WARN_ON(ret)) {
57552b1b46cSThomas Zimmermann 				platform_device_put(dev);
57652b1b46cSThomas Zimmermann 				return ret;
57752b1b46cSThomas Zimmermann 			}
57852b1b46cSThomas Zimmermann 		}
57952b1b46cSThomas Zimmermann 
58052b1b46cSThomas Zimmermann 		/*
58152b1b46cSThomas Zimmermann 		 * For OF framebuffers, first create the device for the boot display,
58252b1b46cSThomas Zimmermann 		 * then for the other framebuffers. Only fail for the boot display;
58352b1b46cSThomas Zimmermann 		 * ignore errors for the rest.
58452b1b46cSThomas Zimmermann 		 */
58552b1b46cSThomas Zimmermann 		for_each_node_by_type(node, "display") {
58652b1b46cSThomas Zimmermann 			if (!of_get_property(node, "linux,opened", NULL) ||
58752b1b46cSThomas Zimmermann 			    !of_get_property(node, "linux,boot-display", NULL))
58852b1b46cSThomas Zimmermann 				continue;
5890bb8f49cSRob Herring 			dev = of_platform_device_create(node, "of-display", NULL);
590241d2fb5SMichal Suchanek 			of_node_put(node);
59152b1b46cSThomas Zimmermann 			if (WARN_ON(!dev))
59252b1b46cSThomas Zimmermann 				return -ENOMEM;
59352b1b46cSThomas Zimmermann 			boot_display = node;
594241d2fb5SMichal Suchanek 			display_number++;
59552b1b46cSThomas Zimmermann 			break;
59652b1b46cSThomas Zimmermann 		}
59752b1b46cSThomas Zimmermann 		for_each_node_by_type(node, "display") {
598241d2fb5SMichal Suchanek 			char buf[14];
599241d2fb5SMichal Suchanek 			const char *of_display_format = "of-display.%d";
600241d2fb5SMichal Suchanek 
60152b1b46cSThomas Zimmermann 			if (!of_get_property(node, "linux,opened", NULL) || node == boot_display)
60252b1b46cSThomas Zimmermann 				continue;
603241d2fb5SMichal Suchanek 			ret = snprintf(buf, sizeof(buf), of_display_format, display_number++);
604241d2fb5SMichal Suchanek 			if (ret < sizeof(buf))
605241d2fb5SMichal Suchanek 				of_platform_device_create(node, buf, NULL);
60652b1b46cSThomas Zimmermann 		}
60752b1b46cSThomas Zimmermann 
60852b1b46cSThomas Zimmermann 	} else {
609529182e2SKees Cook 		/*
610a50ff19dSBjorn Andersson 		 * Handle certain compatibles explicitly, since we don't want to create
611a50ff19dSBjorn Andersson 		 * platform_devices for every node in /reserved-memory with a
612a50ff19dSBjorn Andersson 		 * "compatible",
613529182e2SKees Cook 		 */
614a50ff19dSBjorn Andersson 		for_each_matching_node(node, reserved_mem_matches)
615529182e2SKees Cook 			of_platform_device_create(node, NULL, NULL);
616529182e2SKees Cook 
6173aa0582fSSudeep Holla 		node = of_find_node_by_path("/firmware");
618e2105ca8SSudeep Holla 		if (node) {
6193aa0582fSSudeep Holla 			of_platform_populate(node, NULL, NULL, NULL);
620e2105ca8SSudeep Holla 			of_node_put(node);
621e2105ca8SSudeep Holla 		}
6223aa0582fSSudeep Holla 
6232f92ea21SHector Martin 		node = of_get_compatible_child(of_chosen, "simple-framebuffer");
6242f92ea21SHector Martin 		of_platform_device_create(node, NULL, NULL);
6252f92ea21SHector Martin 		of_node_put(node);
6262f92ea21SHector Martin 
627529182e2SKees Cook 		/* Populate everything else. */
62844a7185cSKefeng Wang 		of_platform_default_populate(NULL, NULL, NULL);
62952b1b46cSThomas Zimmermann 	}
63044a7185cSKefeng Wang 
63144a7185cSKefeng Wang 	return 0;
63244a7185cSKefeng Wang }
63344a7185cSKefeng Wang arch_initcall_sync(of_platform_default_populate_init);
6345e666938SSaravana Kannan 
of_platform_sync_state_init(void)6355e666938SSaravana Kannan static int __init of_platform_sync_state_init(void)
6365e666938SSaravana Kannan {
6375e666938SSaravana Kannan 	device_links_supplier_sync_state_resume();
6385e666938SSaravana Kannan 	return 0;
6395e666938SSaravana Kannan }
6405e666938SSaravana Kannan late_initcall_sync(of_platform_sync_state_init);
64144a7185cSKefeng Wang 
of_platform_device_destroy(struct device * dev,void * data)642c2372c20SJan Glauber int of_platform_device_destroy(struct device *dev, void *data)
643c6e126deSPawel Moll {
644c6e126deSPawel Moll 	/* Do not touch devices not populated from the device tree */
64575f353b6SGrant Likely 	if (!dev->of_node || !of_node_check_flag(dev->of_node, OF_POPULATED))
646c6e126deSPawel Moll 		return 0;
647c6e126deSPawel Moll 
64875f353b6SGrant Likely 	/* Recurse for any nodes that were treated as busses */
64975f353b6SGrant Likely 	if (of_node_check_flag(dev->of_node, OF_POPULATED_BUS))
65075f353b6SGrant Likely 		device_for_each_child(dev, NULL, of_platform_device_destroy);
651c6e126deSPawel Moll 
652522811e9SSrinivas Kandagatla 	of_node_clear_flag(dev->of_node, OF_POPULATED);
653522811e9SSrinivas Kandagatla 	of_node_clear_flag(dev->of_node, OF_POPULATED_BUS);
654522811e9SSrinivas Kandagatla 
655c6e126deSPawel Moll 	if (dev->bus == &platform_bus_type)
656c6e126deSPawel Moll 		platform_device_unregister(to_platform_device(dev));
657c6e126deSPawel Moll #ifdef CONFIG_ARM_AMBA
658c6e126deSPawel Moll 	else if (dev->bus == &amba_bustype)
659c6e126deSPawel Moll 		amba_device_unregister(to_amba_device(dev));
660c6e126deSPawel Moll #endif
661c6e126deSPawel Moll 
662c6e126deSPawel Moll 	return 0;
663c6e126deSPawel Moll }
664c2372c20SJan Glauber EXPORT_SYMBOL_GPL(of_platform_device_destroy);
665c6e126deSPawel Moll 
666c6e126deSPawel Moll /**
667c6e126deSPawel Moll  * of_platform_depopulate() - Remove devices populated from device tree
66875f353b6SGrant Likely  * @parent: device which children will be removed
669c6e126deSPawel Moll  *
670c6e126deSPawel Moll  * Complementary to of_platform_populate(), this function removes children
671c6e126deSPawel Moll  * of the given device (and, recurrently, their children) that have been
672c6e126deSPawel Moll  * created from their respective device tree nodes (and only those,
673c6e126deSPawel Moll  * leaving others - eg. manually created - unharmed).
674c6e126deSPawel Moll  */
of_platform_depopulate(struct device * parent)67575f353b6SGrant Likely void of_platform_depopulate(struct device *parent)
676c6e126deSPawel Moll {
6772d0747c4SGrant Likely 	if (parent->of_node && of_node_check_flag(parent->of_node, OF_POPULATED_BUS)) {
67870a29209SThierry Reding 		device_for_each_child_reverse(parent, NULL, of_platform_device_destroy);
6792d0747c4SGrant Likely 		of_node_clear_flag(parent->of_node, OF_POPULATED_BUS);
6802d0747c4SGrant Likely 	}
681c6e126deSPawel Moll }
682c6e126deSPawel Moll EXPORT_SYMBOL_GPL(of_platform_depopulate);
683c6e126deSPawel Moll 
devm_of_platform_populate_release(struct device * dev,void * res)68438b0b219SBenjamin Gaignard static void devm_of_platform_populate_release(struct device *dev, void *res)
68538b0b219SBenjamin Gaignard {
68638b0b219SBenjamin Gaignard 	of_platform_depopulate(*(struct device **)res);
68738b0b219SBenjamin Gaignard }
68838b0b219SBenjamin Gaignard 
68938b0b219SBenjamin Gaignard /**
69038b0b219SBenjamin Gaignard  * devm_of_platform_populate() - Populate platform_devices from device tree data
69138b0b219SBenjamin Gaignard  * @dev: device that requested to populate from device tree data
69238b0b219SBenjamin Gaignard  *
69338b0b219SBenjamin Gaignard  * Similar to of_platform_populate(), but will automatically call
69438b0b219SBenjamin Gaignard  * of_platform_depopulate() when the device is unbound from the bus.
69538b0b219SBenjamin Gaignard  *
6968c8239c2SRob Herring  * Return: 0 on success, < 0 on failure.
69738b0b219SBenjamin Gaignard  */
devm_of_platform_populate(struct device * dev)69838b0b219SBenjamin Gaignard int devm_of_platform_populate(struct device *dev)
69938b0b219SBenjamin Gaignard {
70038b0b219SBenjamin Gaignard 	struct device **ptr;
70138b0b219SBenjamin Gaignard 	int ret;
70238b0b219SBenjamin Gaignard 
70338b0b219SBenjamin Gaignard 	if (!dev)
70438b0b219SBenjamin Gaignard 		return -EINVAL;
70538b0b219SBenjamin Gaignard 
70638b0b219SBenjamin Gaignard 	ptr = devres_alloc(devm_of_platform_populate_release,
70738b0b219SBenjamin Gaignard 			   sizeof(*ptr), GFP_KERNEL);
70838b0b219SBenjamin Gaignard 	if (!ptr)
70938b0b219SBenjamin Gaignard 		return -ENOMEM;
71038b0b219SBenjamin Gaignard 
71138b0b219SBenjamin Gaignard 	ret = of_platform_populate(dev->of_node, NULL, NULL, dev);
71238b0b219SBenjamin Gaignard 	if (ret) {
71338b0b219SBenjamin Gaignard 		devres_free(ptr);
71438b0b219SBenjamin Gaignard 	} else {
71538b0b219SBenjamin Gaignard 		*ptr = dev;
71638b0b219SBenjamin Gaignard 		devres_add(dev, ptr);
71738b0b219SBenjamin Gaignard 	}
71838b0b219SBenjamin Gaignard 
71938b0b219SBenjamin Gaignard 	return ret;
72038b0b219SBenjamin Gaignard }
72138b0b219SBenjamin Gaignard EXPORT_SYMBOL_GPL(devm_of_platform_populate);
72238b0b219SBenjamin Gaignard 
devm_of_platform_match(struct device * dev,void * res,void * data)72338b0b219SBenjamin Gaignard static int devm_of_platform_match(struct device *dev, void *res, void *data)
72438b0b219SBenjamin Gaignard {
72538b0b219SBenjamin Gaignard 	struct device **ptr = res;
72638b0b219SBenjamin Gaignard 
72738b0b219SBenjamin Gaignard 	if (!ptr) {
72838b0b219SBenjamin Gaignard 		WARN_ON(!ptr);
72938b0b219SBenjamin Gaignard 		return 0;
73038b0b219SBenjamin Gaignard 	}
73138b0b219SBenjamin Gaignard 
73238b0b219SBenjamin Gaignard 	return *ptr == data;
73338b0b219SBenjamin Gaignard }
73438b0b219SBenjamin Gaignard 
73538b0b219SBenjamin Gaignard /**
73638b0b219SBenjamin Gaignard  * devm_of_platform_depopulate() - Remove devices populated from device tree
73738b0b219SBenjamin Gaignard  * @dev: device that requested to depopulate from device tree data
73838b0b219SBenjamin Gaignard  *
73938b0b219SBenjamin Gaignard  * Complementary to devm_of_platform_populate(), this function removes children
74038b0b219SBenjamin Gaignard  * of the given device (and, recurrently, their children) that have been
74138b0b219SBenjamin Gaignard  * created from their respective device tree nodes (and only those,
74238b0b219SBenjamin Gaignard  * leaving others - eg. manually created - unharmed).
74338b0b219SBenjamin Gaignard  */
devm_of_platform_depopulate(struct device * dev)74438b0b219SBenjamin Gaignard void devm_of_platform_depopulate(struct device *dev)
74538b0b219SBenjamin Gaignard {
74638b0b219SBenjamin Gaignard 	int ret;
74738b0b219SBenjamin Gaignard 
74838b0b219SBenjamin Gaignard 	ret = devres_release(dev, devm_of_platform_populate_release,
74938b0b219SBenjamin Gaignard 			     devm_of_platform_match, dev);
75038b0b219SBenjamin Gaignard 
75138b0b219SBenjamin Gaignard 	WARN_ON(ret);
75238b0b219SBenjamin Gaignard }
75338b0b219SBenjamin Gaignard EXPORT_SYMBOL_GPL(devm_of_platform_depopulate);
75438b0b219SBenjamin Gaignard 
755801d728cSPantelis Antoniou #ifdef CONFIG_OF_DYNAMIC
of_platform_notify(struct notifier_block * nb,unsigned long action,void * arg)756801d728cSPantelis Antoniou static int of_platform_notify(struct notifier_block *nb,
757801d728cSPantelis Antoniou 				unsigned long action, void *arg)
758801d728cSPantelis Antoniou {
759801d728cSPantelis Antoniou 	struct of_reconfig_data *rd = arg;
760801d728cSPantelis Antoniou 	struct platform_device *pdev_parent, *pdev;
761801d728cSPantelis Antoniou 	bool children_left;
762801d728cSPantelis Antoniou 
763801d728cSPantelis Antoniou 	switch (of_reconfig_get_state_change(action, rd)) {
764801d728cSPantelis Antoniou 	case OF_RECONFIG_CHANGE_ADD:
765801d728cSPantelis Antoniou 		/* verify that the parent is a bus */
766801d728cSPantelis Antoniou 		if (!of_node_check_flag(rd->dn->parent, OF_POPULATED_BUS))
767801d728cSPantelis Antoniou 			return NOTIFY_OK;	/* not for us */
768801d728cSPantelis Antoniou 
76915204ab1SPantelis Antoniou 		/* already populated? (driver using of_populate manually) */
77015204ab1SPantelis Antoniou 		if (of_node_check_flag(rd->dn, OF_POPULATED))
77115204ab1SPantelis Antoniou 			return NOTIFY_OK;
77215204ab1SPantelis Antoniou 
7731a50d940SGeert Uytterhoeven 		/*
7741a50d940SGeert Uytterhoeven 		 * Clear the flag before adding the device so that fw_devlink
7751a50d940SGeert Uytterhoeven 		 * doesn't skip adding consumers to this device.
7761a50d940SGeert Uytterhoeven 		 */
7771a50d940SGeert Uytterhoeven 		rd->dn->fwnode.flags &= ~FWNODE_FLAG_NOT_DEVICE;
778801d728cSPantelis Antoniou 		/* pdev_parent may be NULL when no bus platform device */
779801d728cSPantelis Antoniou 		pdev_parent = of_find_device_by_node(rd->dn->parent);
780801d728cSPantelis Antoniou 		pdev = of_platform_device_create(rd->dn, NULL,
781801d728cSPantelis Antoniou 				pdev_parent ? &pdev_parent->dev : NULL);
78283c4a4eeSRob Herring 		platform_device_put(pdev_parent);
783801d728cSPantelis Antoniou 
784801d728cSPantelis Antoniou 		if (pdev == NULL) {
7850d638a07SRob Herring 			pr_err("%s: failed to create for '%pOF'\n",
7860d638a07SRob Herring 					__func__, rd->dn);
787801d728cSPantelis Antoniou 			/* of_platform_device_create tosses the error code */
788801d728cSPantelis Antoniou 			return notifier_from_errno(-EINVAL);
789801d728cSPantelis Antoniou 		}
790801d728cSPantelis Antoniou 		break;
791801d728cSPantelis Antoniou 
792801d728cSPantelis Antoniou 	case OF_RECONFIG_CHANGE_REMOVE:
79315204ab1SPantelis Antoniou 
79415204ab1SPantelis Antoniou 		/* already depopulated? */
79515204ab1SPantelis Antoniou 		if (!of_node_check_flag(rd->dn, OF_POPULATED))
79615204ab1SPantelis Antoniou 			return NOTIFY_OK;
79715204ab1SPantelis Antoniou 
798801d728cSPantelis Antoniou 		/* find our device by node */
799801d728cSPantelis Antoniou 		pdev = of_find_device_by_node(rd->dn);
800801d728cSPantelis Antoniou 		if (pdev == NULL)
801801d728cSPantelis Antoniou 			return NOTIFY_OK;	/* no? not meant for us */
802801d728cSPantelis Antoniou 
803801d728cSPantelis Antoniou 		/* unregister takes one ref away */
804801d728cSPantelis Antoniou 		of_platform_device_destroy(&pdev->dev, &children_left);
805801d728cSPantelis Antoniou 
806801d728cSPantelis Antoniou 		/* and put the reference of the find */
80783c4a4eeSRob Herring 		platform_device_put(pdev);
808801d728cSPantelis Antoniou 		break;
809801d728cSPantelis Antoniou 	}
810801d728cSPantelis Antoniou 
811801d728cSPantelis Antoniou 	return NOTIFY_OK;
812801d728cSPantelis Antoniou }
813801d728cSPantelis Antoniou 
814801d728cSPantelis Antoniou static struct notifier_block platform_of_notifier = {
815801d728cSPantelis Antoniou 	.notifier_call = of_platform_notify,
816801d728cSPantelis Antoniou };
817801d728cSPantelis Antoniou 
of_platform_register_reconfig_notifier(void)818801d728cSPantelis Antoniou void of_platform_register_reconfig_notifier(void)
819801d728cSPantelis Antoniou {
820801d728cSPantelis Antoniou 	WARN_ON(of_reconfig_notifier_register(&platform_of_notifier));
821801d728cSPantelis Antoniou }
822801d728cSPantelis Antoniou #endif /* CONFIG_OF_DYNAMIC */
823801d728cSPantelis Antoniou 
824964dba28SGrant Likely #endif /* CONFIG_OF_ADDRESS */
825