xref: /optee_os/core/kernel/dt_driver.c (revision f354a5d8f98eb3bc8f3360eccd7405144266b5b4)
18c0c44c9SEtienne Carriere // SPDX-License-Identifier: BSD-2-Clause
28c0c44c9SEtienne Carriere /*
38c0c44c9SEtienne Carriere  * Copyright (c) 2021, Linaro Limited
48c0c44c9SEtienne Carriere  * Copyright (c) 2021, Bootlin
5b3a88b52SEtienne Carriere  * Copyright (c) 2021, Linaro Limited
6b3a88b52SEtienne Carriere  * Copyright (c) 2021, STMicroelectronics
78c0c44c9SEtienne Carriere  */
88c0c44c9SEtienne Carriere 
9b3a88b52SEtienne Carriere #include <assert.h>
10b3a88b52SEtienne Carriere #include <config.h>
113fd340e5SEtienne Carriere #include <initcall.h>
12b3a88b52SEtienne Carriere #include <kernel/boot.h>
133fd340e5SEtienne Carriere #include <kernel/dt.h>
148c0c44c9SEtienne Carriere #include <kernel/dt_driver.h>
153fd340e5SEtienne Carriere #include <libfdt.h>
163fd340e5SEtienne Carriere #include <malloc.h>
178c0c44c9SEtienne Carriere #include <sys/queue.h>
18b3a88b52SEtienne Carriere #include <tee_api_defines_extensions.h>
193fd340e5SEtienne Carriere #include <tee_api_types.h>
208c0c44c9SEtienne Carriere 
21704f6eddSEtienne Carriere /*
22b3a88b52SEtienne Carriere  * struct dt_driver_probe - Node instance in secure FDT to probe a driver for
23b3a88b52SEtienne Carriere  *
24b3a88b52SEtienne Carriere  * @link: List hook
25b3a88b52SEtienne Carriere  * @nodeoffset: Node offset of device referenced in the FDT
26b3a88b52SEtienne Carriere  * @type: One of DT_DRIVER_* or DT_DRIVER_NOTYPE.
27b3a88b52SEtienne Carriere  * @deferrals: Driver probe deferrals count
28b3a88b52SEtienne Carriere  * @dt_drv: Matching driver to probe if found or NULL
29b3a88b52SEtienne Carriere  * @dm: Matching reference if applicable or NULL
30b3a88b52SEtienne Carriere  */
31b3a88b52SEtienne Carriere struct dt_driver_probe {
32b3a88b52SEtienne Carriere 	int nodeoffset;
33b3a88b52SEtienne Carriere 	enum dt_driver_type type;
34b3a88b52SEtienne Carriere 	unsigned int deferrals;
35b3a88b52SEtienne Carriere 	const struct dt_driver *dt_drv;
36b3a88b52SEtienne Carriere 	const struct dt_device_match *dm;
37b3a88b52SEtienne Carriere 	TAILQ_ENTRY(dt_driver_probe) link;
38b3a88b52SEtienne Carriere };
39b3a88b52SEtienne Carriere 
40b3a88b52SEtienne Carriere /*
41704f6eddSEtienne Carriere  * struct dt_driver_provider - DT related info on probed device
42704f6eddSEtienne Carriere  *
43704f6eddSEtienne Carriere  * Saves information on the probed device so that device
44704f6eddSEtienne Carriere  * drivers can get resources from DT phandle and related arguments.
45704f6eddSEtienne Carriere  *
46704f6eddSEtienne Carriere  * @nodeoffset: Node offset of device referenced in the FDT
47704f6eddSEtienne Carriere  * @type: One of DT_DRIVER_* or DT_DRIVER_NOTYPE.
48704f6eddSEtienne Carriere  * @provider_cells: Cells count in the FDT used by the driver's references
49704f6eddSEtienne Carriere  * @get_of_device: Function to get driver's device ref from phandle data
50704f6eddSEtienne Carriere  * @priv_data: Driver private data passed as @get_of_device argument
51704f6eddSEtienne Carriere  * @link: Reference in DT driver providers list
52704f6eddSEtienne Carriere  */
53704f6eddSEtienne Carriere struct dt_driver_provider {
54704f6eddSEtienne Carriere 	int nodeoffset;
55704f6eddSEtienne Carriere 	enum dt_driver_type type;
56704f6eddSEtienne Carriere 	unsigned int provider_cells;
57704f6eddSEtienne Carriere 	uint32_t phandle;
58704f6eddSEtienne Carriere 	get_of_device_func get_of_device;
59704f6eddSEtienne Carriere 	void *priv_data;
60704f6eddSEtienne Carriere 	SLIST_ENTRY(dt_driver_provider) link;
61704f6eddSEtienne Carriere };
62704f6eddSEtienne Carriere 
63b3a88b52SEtienne Carriere /*
64b3a88b52SEtienne Carriere  * Device driver providers are able to provide a driver specific instance
65b3a88b52SEtienne Carriere  * related to device phandle arguments found in the secure embedded FDT.
66b3a88b52SEtienne Carriere  */
67704f6eddSEtienne Carriere static SLIST_HEAD(, dt_driver_provider) dt_driver_provider_list =
688c0c44c9SEtienne Carriere 	SLIST_HEAD_INITIALIZER(dt_driver_provider_list);
693fd340e5SEtienne Carriere 
70b3a88b52SEtienne Carriere /* FDT nodes for which a matching driver is to be probed */
71b3a88b52SEtienne Carriere static TAILQ_HEAD(dt_driver_probe_head, dt_driver_probe) dt_driver_probe_list =
72b3a88b52SEtienne Carriere 	TAILQ_HEAD_INITIALIZER(dt_driver_probe_list);
73b3a88b52SEtienne Carriere 
74b3a88b52SEtienne Carriere /* FDT nodes for which a matching driver has been successfully probed */
75b3a88b52SEtienne Carriere static TAILQ_HEAD(, dt_driver_probe) dt_driver_ready_list =
76b3a88b52SEtienne Carriere 	TAILQ_HEAD_INITIALIZER(dt_driver_ready_list);
77b3a88b52SEtienne Carriere 
78736cb9e1SEtienne Carriere /* List of the nodes for which a compatible driver but reported a failure */
79736cb9e1SEtienne Carriere static TAILQ_HEAD(, dt_driver_probe) dt_driver_failed_list =
80736cb9e1SEtienne Carriere 	TAILQ_HEAD_INITIALIZER(dt_driver_failed_list);
81736cb9e1SEtienne Carriere 
82b3a88b52SEtienne Carriere /* Flag enabled when a new node (possibly typed) is added in the probe list */
83b3a88b52SEtienne Carriere static bool added_node;
84b3a88b52SEtienne Carriere 
853de8f0deSEtienne Carriere /* Resolve drivers dependencies on core crypto layer */
863de8f0deSEtienne Carriere static bool tee_crypt_is_ready;
873de8f0deSEtienne Carriere 
883de8f0deSEtienne Carriere void dt_driver_crypt_init_complete(void)
893de8f0deSEtienne Carriere {
903de8f0deSEtienne Carriere 	assert(!tee_crypt_is_ready);
913de8f0deSEtienne Carriere 	tee_crypt_is_ready = true;
923de8f0deSEtienne Carriere }
933de8f0deSEtienne Carriere 
943de8f0deSEtienne Carriere TEE_Result dt_driver_get_crypto(void)
953de8f0deSEtienne Carriere {
963de8f0deSEtienne Carriere 	if (tee_crypt_is_ready)
973de8f0deSEtienne Carriere 		return TEE_SUCCESS;
983de8f0deSEtienne Carriere 	else
993de8f0deSEtienne Carriere 		return TEE_ERROR_DEFER_DRIVER_INIT;
1003de8f0deSEtienne Carriere }
1013de8f0deSEtienne Carriere 
102b3a88b52SEtienne Carriere static void assert_type_is_valid(enum dt_driver_type type)
103b3a88b52SEtienne Carriere {
104b3a88b52SEtienne Carriere 	switch (type) {
105b3a88b52SEtienne Carriere 	case DT_DRIVER_NOTYPE:
106b3a88b52SEtienne Carriere 	case DT_DRIVER_CLK:
107c78b2c66SEtienne Carriere 	case DT_DRIVER_RSTCTRL:
108c78b2c66SEtienne Carriere 	case DT_DRIVER_UART:
109e7a2db34SClément Léger 	case DT_DRIVER_I2C:
110b3a88b52SEtienne Carriere 		return;
111b3a88b52SEtienne Carriere 	default:
112b3a88b52SEtienne Carriere 		assert(0);
113b3a88b52SEtienne Carriere 	}
114b3a88b52SEtienne Carriere }
115b3a88b52SEtienne Carriere 
1163fd340e5SEtienne Carriere /*
1173fd340e5SEtienne Carriere  * Driver provider registering API functions
1183fd340e5SEtienne Carriere  */
1193fd340e5SEtienne Carriere 
1203fd340e5SEtienne Carriere TEE_Result dt_driver_register_provider(const void *fdt, int nodeoffset,
1213fd340e5SEtienne Carriere 				       get_of_device_func get_of_device,
1223fd340e5SEtienne Carriere 				       void *priv, enum dt_driver_type type)
1233fd340e5SEtienne Carriere {
1243fd340e5SEtienne Carriere 	struct dt_driver_provider *prv = NULL;
1253fd340e5SEtienne Carriere 	int provider_cells = 0;
1263fd340e5SEtienne Carriere 	uint32_t phandle = 0;
1273fd340e5SEtienne Carriere 
128b3a88b52SEtienne Carriere 	assert_type_is_valid(type);
129b3a88b52SEtienne Carriere 
1303fd340e5SEtienne Carriere 	provider_cells = fdt_get_dt_driver_cells(fdt, nodeoffset, type);
1313fd340e5SEtienne Carriere 	if (provider_cells < 0) {
1323fd340e5SEtienne Carriere 		DMSG("Failed to find provider cells: %d", provider_cells);
1333fd340e5SEtienne Carriere 		return TEE_ERROR_GENERIC;
1343fd340e5SEtienne Carriere 	}
1353fd340e5SEtienne Carriere 
1363fd340e5SEtienne Carriere 	phandle = fdt_get_phandle(fdt, nodeoffset);
1370f9f9a37SGatien Chevallier 	if (phandle == (uint32_t)-1) {
1383fd340e5SEtienne Carriere 		DMSG("Failed to find provide phandle");
1393fd340e5SEtienne Carriere 		return TEE_ERROR_GENERIC;
1403fd340e5SEtienne Carriere 	}
1413fd340e5SEtienne Carriere 
1423fd340e5SEtienne Carriere 	prv = calloc(1, sizeof(*prv));
1433fd340e5SEtienne Carriere 	if (!prv)
1443fd340e5SEtienne Carriere 		return TEE_ERROR_OUT_OF_MEMORY;
1453fd340e5SEtienne Carriere 
1463fd340e5SEtienne Carriere 	prv->nodeoffset = nodeoffset;
1473fd340e5SEtienne Carriere 	prv->type = type;
1483fd340e5SEtienne Carriere 	prv->provider_cells = provider_cells;
1493fd340e5SEtienne Carriere 	prv->phandle = phandle;
1503fd340e5SEtienne Carriere 	prv->get_of_device = get_of_device;
1513fd340e5SEtienne Carriere 	prv->priv_data = priv;
1523fd340e5SEtienne Carriere 
1533fd340e5SEtienne Carriere 	SLIST_INSERT_HEAD(&dt_driver_provider_list, prv, link);
1543fd340e5SEtienne Carriere 
1553fd340e5SEtienne Carriere 	return TEE_SUCCESS;
1563fd340e5SEtienne Carriere }
1573fd340e5SEtienne Carriere 
1583fd340e5SEtienne Carriere /*
1593fd340e5SEtienne Carriere  * Helper functions for dt_drivers querying driver provider information
1603fd340e5SEtienne Carriere  */
1613fd340e5SEtienne Carriere 
1623fd340e5SEtienne Carriere int fdt_get_dt_driver_cells(const void *fdt, int nodeoffset,
1633fd340e5SEtienne Carriere 			    enum dt_driver_type type)
1643fd340e5SEtienne Carriere {
1653fd340e5SEtienne Carriere 	const char *cells_name = NULL;
1663fd340e5SEtienne Carriere 	const fdt32_t *c = NULL;
1673fd340e5SEtienne Carriere 	int len = 0;
1683fd340e5SEtienne Carriere 
1693fd340e5SEtienne Carriere 	switch (type) {
1703fd340e5SEtienne Carriere 	case DT_DRIVER_CLK:
1713fd340e5SEtienne Carriere 		cells_name = "#clock-cells";
1723fd340e5SEtienne Carriere 		break;
173c78b2c66SEtienne Carriere 	case DT_DRIVER_RSTCTRL:
174c78b2c66SEtienne Carriere 		cells_name = "#reset-cells";
175c78b2c66SEtienne Carriere 		break;
176e7a2db34SClément Léger 	case DT_DRIVER_I2C:
177e7a2db34SClément Léger 		return 0;
1783fd340e5SEtienne Carriere 	default:
1793fd340e5SEtienne Carriere 		panic();
1803fd340e5SEtienne Carriere 	}
1813fd340e5SEtienne Carriere 
1823fd340e5SEtienne Carriere 	c = fdt_getprop(fdt, nodeoffset, cells_name, &len);
1833fd340e5SEtienne Carriere 	if (!c)
1843fd340e5SEtienne Carriere 		return len;
1853fd340e5SEtienne Carriere 
1863fd340e5SEtienne Carriere 	if (len != sizeof(*c))
1873fd340e5SEtienne Carriere 		return -FDT_ERR_BADNCELLS;
1883fd340e5SEtienne Carriere 
1893fd340e5SEtienne Carriere 	return fdt32_to_cpu(*c);
1903fd340e5SEtienne Carriere }
1913fd340e5SEtienne Carriere 
1923fd340e5SEtienne Carriere unsigned int dt_driver_provider_cells(struct dt_driver_provider *prv)
1933fd340e5SEtienne Carriere {
1943fd340e5SEtienne Carriere 	return prv->provider_cells;
1953fd340e5SEtienne Carriere }
196f498c404SEtienne Carriere 
1978dca59b4SEtienne Carriere struct dt_driver_provider *
1988dca59b4SEtienne Carriere dt_driver_get_provider_by_node(int nodeoffset, enum dt_driver_type type)
199f498c404SEtienne Carriere {
200f498c404SEtienne Carriere 	struct dt_driver_provider *prv = NULL;
201f498c404SEtienne Carriere 
202f498c404SEtienne Carriere 	SLIST_FOREACH(prv, &dt_driver_provider_list, link)
2038dca59b4SEtienne Carriere 		if (prv->nodeoffset == nodeoffset && prv->type == type)
204f498c404SEtienne Carriere 			return prv;
205f498c404SEtienne Carriere 
206f498c404SEtienne Carriere 	return NULL;
207f498c404SEtienne Carriere }
208f498c404SEtienne Carriere 
2098dca59b4SEtienne Carriere struct dt_driver_provider *
2108dca59b4SEtienne Carriere dt_driver_get_provider_by_phandle(uint32_t phandle, enum dt_driver_type type)
211f498c404SEtienne Carriere {
212f498c404SEtienne Carriere 	struct dt_driver_provider *prv = NULL;
213f498c404SEtienne Carriere 
214f498c404SEtienne Carriere 	SLIST_FOREACH(prv, &dt_driver_provider_list, link)
2158dca59b4SEtienne Carriere 		if (prv->phandle == phandle && prv->type == type)
216f498c404SEtienne Carriere 			return prv;
217f498c404SEtienne Carriere 
218f498c404SEtienne Carriere 	return NULL;
219f498c404SEtienne Carriere }
220a22e85b2SEtienne Carriere 
221a22e85b2SEtienne Carriere static void *device_from_provider_prop(struct dt_driver_provider *prv,
22233cc94dfSClément Léger 				       const void *fdt, int phandle_node,
22333cc94dfSClément Léger 				       const uint32_t *prop, TEE_Result *res)
224a22e85b2SEtienne Carriere {
225a22e85b2SEtienne Carriere 	struct dt_driver_phandle_args *pargs = NULL;
226a22e85b2SEtienne Carriere 	unsigned int n = 0;
227a22e85b2SEtienne Carriere 	void *device = NULL;
228a22e85b2SEtienne Carriere 
229a22e85b2SEtienne Carriere 	pargs = calloc(1, prv->provider_cells * sizeof(uint32_t *) +
230a22e85b2SEtienne Carriere 		       sizeof(*pargs));
231d8b14b46SEtienne Carriere 	if (!pargs) {
232d8b14b46SEtienne Carriere 		*res = TEE_ERROR_OUT_OF_MEMORY;
233a22e85b2SEtienne Carriere 		return NULL;
234d8b14b46SEtienne Carriere 	}
235a22e85b2SEtienne Carriere 
23633cc94dfSClément Léger 	pargs->fdt = fdt;
23733cc94dfSClément Léger 	pargs->phandle_node = phandle_node;
238a22e85b2SEtienne Carriere 	pargs->args_count = prv->provider_cells;
239a22e85b2SEtienne Carriere 	for (n = 0; n < prv->provider_cells; n++)
240a22e85b2SEtienne Carriere 		pargs->args[n] = fdt32_to_cpu(prop[n + 1]);
241a22e85b2SEtienne Carriere 
242d8b14b46SEtienne Carriere 	device = prv->get_of_device(pargs, prv->priv_data, res);
243a22e85b2SEtienne Carriere 
244a22e85b2SEtienne Carriere 	free(pargs);
245a22e85b2SEtienne Carriere 
246a22e85b2SEtienne Carriere 	return device;
247a22e85b2SEtienne Carriere }
248a22e85b2SEtienne Carriere 
249e7a2db34SClément Léger void *dt_driver_device_from_parent(const void *fdt, int nodeoffset,
250e7a2db34SClément Léger 				   enum dt_driver_type type, TEE_Result *res)
251e7a2db34SClément Léger {
252e7a2db34SClément Léger 	int parent = -1;
253e7a2db34SClément Léger 	struct dt_driver_provider *prv = NULL;
254e7a2db34SClément Léger 
255e7a2db34SClément Léger 	assert(fdt == get_secure_dt());
256e7a2db34SClément Léger 
257e7a2db34SClément Léger 	parent = fdt_parent_offset(fdt, nodeoffset);
258e7a2db34SClément Léger 	if (parent < 0) {
259e7a2db34SClément Léger 		*res =  TEE_ERROR_GENERIC;
260e7a2db34SClément Léger 		return NULL;
261e7a2db34SClément Léger 	}
262e7a2db34SClément Léger 
263e7a2db34SClément Léger 	prv = dt_driver_get_provider_by_node(parent, type);
264e7a2db34SClément Léger 	if (!prv) {
265e7a2db34SClément Léger 		/* No provider registered yet */
266e7a2db34SClément Léger 		*res = TEE_ERROR_DEFER_DRIVER_INIT;
267e7a2db34SClément Léger 		return NULL;
268e7a2db34SClément Léger 	}
269e7a2db34SClément Léger 
270e7a2db34SClément Léger 	return device_from_provider_prop(prv, fdt, nodeoffset, NULL, res);
271e7a2db34SClément Léger }
272e7a2db34SClément Léger 
273a22e85b2SEtienne Carriere void *dt_driver_device_from_node_idx_prop(const char *prop_name,
274a22e85b2SEtienne Carriere 					  const void *fdt, int nodeoffset,
275d8b14b46SEtienne Carriere 					  unsigned int prop_idx,
2768dca59b4SEtienne Carriere 					  enum dt_driver_type type,
277d8b14b46SEtienne Carriere 					  TEE_Result *res)
278a22e85b2SEtienne Carriere {
279a22e85b2SEtienne Carriere 	int len = 0;
280a22e85b2SEtienne Carriere 	int idx = 0;
281a22e85b2SEtienne Carriere 	int idx32 = 0;
282a22e85b2SEtienne Carriere 	int prv_cells = 0;
28333cc94dfSClément Léger 	int phandle_node = -1;
284a22e85b2SEtienne Carriere 	uint32_t phandle = 0;
285a22e85b2SEtienne Carriere 	const uint32_t *prop = NULL;
286a22e85b2SEtienne Carriere 	struct dt_driver_provider *prv = NULL;
287a22e85b2SEtienne Carriere 
288a22e85b2SEtienne Carriere 	prop = fdt_getprop(fdt, nodeoffset, prop_name, &len);
289d8b14b46SEtienne Carriere 	if (!prop) {
290b17cf5c8SEtienne Carriere 		DMSG("Property %s missing in node %s", prop_name,
291b17cf5c8SEtienne Carriere 		     fdt_get_name(fdt, nodeoffset, NULL));
2920adca93aSGatien Chevallier 		*res = TEE_ERROR_ITEM_NOT_FOUND;
293a22e85b2SEtienne Carriere 		return NULL;
294d8b14b46SEtienne Carriere 	}
295a22e85b2SEtienne Carriere 
296a22e85b2SEtienne Carriere 	while (idx < len) {
297a22e85b2SEtienne Carriere 		idx32 = idx / sizeof(uint32_t);
298a22e85b2SEtienne Carriere 		phandle = fdt32_to_cpu(prop[idx32]);
299f1f7c58eSClément Léger 		if (!phandle) {
300f1f7c58eSClément Léger 			if (!prop_idx)
301f1f7c58eSClément Léger 				break;
302f1f7c58eSClément Léger 			idx += sizeof(phandle);
303f1f7c58eSClément Léger 			prop_idx--;
304f1f7c58eSClément Léger 			continue;
305f1f7c58eSClément Léger 		}
306a22e85b2SEtienne Carriere 
3078dca59b4SEtienne Carriere 		prv = dt_driver_get_provider_by_phandle(phandle, type);
308d8b14b46SEtienne Carriere 		if (!prv) {
309a3f00f7dSEtienne Carriere 			/* No provider registered yet */
310a3f00f7dSEtienne Carriere 			*res = TEE_ERROR_DEFER_DRIVER_INIT;
311a22e85b2SEtienne Carriere 			return NULL;
312d8b14b46SEtienne Carriere 		}
313a22e85b2SEtienne Carriere 
314a22e85b2SEtienne Carriere 		prv_cells = dt_driver_provider_cells(prv);
315a22e85b2SEtienne Carriere 		if (prop_idx) {
316a22e85b2SEtienne Carriere 			prop_idx--;
317a22e85b2SEtienne Carriere 			idx += sizeof(phandle) + prv_cells * sizeof(uint32_t);
318a22e85b2SEtienne Carriere 			continue;
319a22e85b2SEtienne Carriere 		}
320a22e85b2SEtienne Carriere 
32133cc94dfSClément Léger 		return device_from_provider_prop(prv, fdt, phandle_node,
32233cc94dfSClément Léger 						 prop + idx32, res);
323a22e85b2SEtienne Carriere 	}
324a22e85b2SEtienne Carriere 
3250adca93aSGatien Chevallier 	*res = TEE_ERROR_ITEM_NOT_FOUND;
326a22e85b2SEtienne Carriere 	return NULL;
327a22e85b2SEtienne Carriere }
328ef20efc4SEtienne Carriere 
329c9bd3375SEtienne Carriere static void __maybe_unused print_probe_list(const void *fdt __maybe_unused)
330b3a88b52SEtienne Carriere {
331b3a88b52SEtienne Carriere 	struct dt_driver_probe *elt = NULL;
332b3a88b52SEtienne Carriere 	unsigned int count = 0;
333b3a88b52SEtienne Carriere 
334b3a88b52SEtienne Carriere 	TAILQ_FOREACH(elt, &dt_driver_probe_list, link)
335b3a88b52SEtienne Carriere 		count++;
336b3a88b52SEtienne Carriere 
337c9bd3375SEtienne Carriere 	DMSG("Probe list: %u elements", count);
338b3a88b52SEtienne Carriere 	TAILQ_FOREACH(elt, &dt_driver_probe_list, link)
339c9bd3375SEtienne Carriere 		DMSG("|- Driver %s probes on node %s",
340b3a88b52SEtienne Carriere 		     elt->dt_drv->name,
341b3a88b52SEtienne Carriere 		     fdt_get_name(fdt, elt->nodeoffset, NULL));
342b3a88b52SEtienne Carriere 
343c9bd3375SEtienne Carriere 	DMSG("`- Probe list end");
344c9bd3375SEtienne Carriere 
345c9bd3375SEtienne Carriere 	count = 0;
346c9bd3375SEtienne Carriere 	TAILQ_FOREACH(elt, &dt_driver_failed_list, link)
347c9bd3375SEtienne Carriere 		count++;
348c9bd3375SEtienne Carriere 
349c9bd3375SEtienne Carriere 	DMSG("Failed list: %u elements", count);
350c9bd3375SEtienne Carriere 	TAILQ_FOREACH(elt, &dt_driver_failed_list, link)
351c9bd3375SEtienne Carriere 		EMSG("|- Driver %s on node %s failed", elt->dt_drv->name,
352c9bd3375SEtienne Carriere 		     fdt_get_name(fdt, elt->nodeoffset, NULL));
353c9bd3375SEtienne Carriere 
354c9bd3375SEtienne Carriere 	DMSG("`- Failed list end");
355b3a88b52SEtienne Carriere }
356b3a88b52SEtienne Carriere 
357b3a88b52SEtienne Carriere /*
358b3a88b52SEtienne Carriere  * Probe element: push to ready list if succeeds, push to probe list if probe
359b3a88b52SEtienne Carriere  * if deferred, panic with an error trace otherwise.
360b3a88b52SEtienne Carriere  */
361b3a88b52SEtienne Carriere static TEE_Result probe_driver_node(const void *fdt,
362b3a88b52SEtienne Carriere 				    struct dt_driver_probe *elt)
363b3a88b52SEtienne Carriere {
364b3a88b52SEtienne Carriere 	TEE_Result res = TEE_ERROR_GENERIC;
365b3a88b52SEtienne Carriere 	const char __maybe_unused *drv_name = NULL;
366b3a88b52SEtienne Carriere 	const char __maybe_unused *node_name = NULL;
367b3a88b52SEtienne Carriere 
368b3a88b52SEtienne Carriere 	node_name = fdt_get_name(fdt, elt->nodeoffset, NULL);
369b3a88b52SEtienne Carriere 	drv_name = elt->dt_drv->name;
370c4c84e2cSSahil Malhotra 
371c4c84e2cSSahil Malhotra 	if (!elt->dt_drv->probe) {
372c4c84e2cSSahil Malhotra 		DMSG("No probe operator for driver %s, skipped", drv_name);
373c4c84e2cSSahil Malhotra 		return TEE_SUCCESS;
374c4c84e2cSSahil Malhotra 	}
375c4c84e2cSSahil Malhotra 
376b3a88b52SEtienne Carriere 	FMSG("Probing %s on node %s", drv_name, node_name);
377b3a88b52SEtienne Carriere 
378b3a88b52SEtienne Carriere 	res = elt->dt_drv->probe(fdt, elt->nodeoffset, elt->dm->compat_data);
379b3a88b52SEtienne Carriere 	switch (res) {
380b3a88b52SEtienne Carriere 	case TEE_SUCCESS:
381b3a88b52SEtienne Carriere 		TAILQ_INSERT_HEAD(&dt_driver_ready_list, elt, link);
382b3a88b52SEtienne Carriere 
383b3a88b52SEtienne Carriere 		DMSG("element: %s on node %s initialized", drv_name, node_name);
384b3a88b52SEtienne Carriere 		break;
385b3a88b52SEtienne Carriere 	case TEE_ERROR_DEFER_DRIVER_INIT:
386b3a88b52SEtienne Carriere 		elt->deferrals++;
387b3a88b52SEtienne Carriere 		TAILQ_INSERT_TAIL(&dt_driver_probe_list, elt, link);
388b3a88b52SEtienne Carriere 
389b3a88b52SEtienne Carriere 		DMSG("element: %s on node %s deferred %u time(s)", drv_name,
390b3a88b52SEtienne Carriere 		     node_name, elt->deferrals);
391b3a88b52SEtienne Carriere 		break;
39252199c35SVesa Jääskeläinen 	case TEE_ERROR_NODE_DISABLED:
39352199c35SVesa Jääskeläinen 		DMSG("element: %s on node %s is disabled", drv_name, node_name);
39452199c35SVesa Jääskeläinen 		break;
395b3a88b52SEtienne Carriere 	default:
396736cb9e1SEtienne Carriere 		TAILQ_INSERT_HEAD(&dt_driver_failed_list, elt, link);
397736cb9e1SEtienne Carriere 
398736cb9e1SEtienne Carriere 		EMSG("Failed to probe %s on node %s: %#"PRIx32,
399b3a88b52SEtienne Carriere 		     drv_name, node_name, res);
400736cb9e1SEtienne Carriere 		break;
401b3a88b52SEtienne Carriere 	}
402b3a88b52SEtienne Carriere 
403b3a88b52SEtienne Carriere 	return res;
404b3a88b52SEtienne Carriere }
405b3a88b52SEtienne Carriere 
406b3a88b52SEtienne Carriere static TEE_Result alloc_elt_and_probe(const void *fdt, int node,
407b3a88b52SEtienne Carriere 				      const struct dt_driver *dt_drv,
408b3a88b52SEtienne Carriere 				      const struct dt_device_match *dm)
409b3a88b52SEtienne Carriere {
410b3a88b52SEtienne Carriere 	struct dt_driver_probe *elt = NULL;
411b3a88b52SEtienne Carriere 
412b3a88b52SEtienne Carriere 	/* Will be freed when lists are released */
413b3a88b52SEtienne Carriere 	elt = calloc(1, sizeof(*elt));
414b3a88b52SEtienne Carriere 	if (!elt)
415b3a88b52SEtienne Carriere 		return TEE_ERROR_OUT_OF_MEMORY;
416b3a88b52SEtienne Carriere 
417b3a88b52SEtienne Carriere 	elt->nodeoffset = node;
418b3a88b52SEtienne Carriere 	elt->dt_drv = dt_drv;
419b3a88b52SEtienne Carriere 	elt->dm = dm;
420b3a88b52SEtienne Carriere 	elt->type = dt_drv->type;
421b3a88b52SEtienne Carriere 
422b3a88b52SEtienne Carriere 	return probe_driver_node(fdt, elt);
423b3a88b52SEtienne Carriere }
424b3a88b52SEtienne Carriere 
425ef20efc4SEtienne Carriere /* Lookup a compatible driver, possibly of a specific @type, for the FDT node */
426ef20efc4SEtienne Carriere static TEE_Result probe_device_by_compat(const void *fdt, int node,
427ef20efc4SEtienne Carriere 					 const char *compat,
428ef20efc4SEtienne Carriere 					 enum dt_driver_type type)
429ef20efc4SEtienne Carriere {
430ef20efc4SEtienne Carriere 	const struct dt_driver *drv = NULL;
431ef20efc4SEtienne Carriere 	const struct dt_device_match *dm = NULL;
432ef20efc4SEtienne Carriere 
433ef20efc4SEtienne Carriere 	for_each_dt_driver(drv) {
434ef20efc4SEtienne Carriere 		if (drv->type != type)
435ef20efc4SEtienne Carriere 			continue;
436ef20efc4SEtienne Carriere 
437ef20efc4SEtienne Carriere 		for (dm = drv->match_table; dm && dm->compatible; dm++)
438ef20efc4SEtienne Carriere 			if (strcmp(dm->compatible, compat) == 0)
439b3a88b52SEtienne Carriere 				return alloc_elt_and_probe(fdt, node, drv, dm);
440ef20efc4SEtienne Carriere 	}
441ef20efc4SEtienne Carriere 
442ef20efc4SEtienne Carriere 	return TEE_ERROR_ITEM_NOT_FOUND;
443ef20efc4SEtienne Carriere }
444ef20efc4SEtienne Carriere 
445b3a88b52SEtienne Carriere /*
446b3a88b52SEtienne Carriere  * Lookup the best matching compatible driver, possibly of a specific @type,
447b3a88b52SEtienne Carriere  * for the FDT node.
448b3a88b52SEtienne Carriere  */
449ef20efc4SEtienne Carriere TEE_Result dt_driver_probe_device_by_node(const void *fdt, int nodeoffset,
450ef20efc4SEtienne Carriere 					  enum dt_driver_type type)
451ef20efc4SEtienne Carriere {
452ef20efc4SEtienne Carriere 	int idx = 0;
453ef20efc4SEtienne Carriere 	int len = 0;
454ef20efc4SEtienne Carriere 	int count = 0;
455ef20efc4SEtienne Carriere 	const char *compat = NULL;
456ef20efc4SEtienne Carriere 	TEE_Result res = TEE_ERROR_GENERIC;
457ef20efc4SEtienne Carriere 
458b3a88b52SEtienne Carriere 	assert_type_is_valid(type);
459b3a88b52SEtienne Carriere 
460ef20efc4SEtienne Carriere 	count = fdt_stringlist_count(fdt, nodeoffset, "compatible");
461ef20efc4SEtienne Carriere 	if (count < 0)
462ef20efc4SEtienne Carriere 		return TEE_ERROR_ITEM_NOT_FOUND;
463ef20efc4SEtienne Carriere 
464ef20efc4SEtienne Carriere 	for (idx = 0; idx < count; idx++) {
465ef20efc4SEtienne Carriere 		compat = fdt_stringlist_get(fdt, nodeoffset, "compatible",
466ef20efc4SEtienne Carriere 					    idx, &len);
467ef20efc4SEtienne Carriere 		if (!compat)
468ef20efc4SEtienne Carriere 			return TEE_ERROR_GENERIC;
469ef20efc4SEtienne Carriere 
470ef20efc4SEtienne Carriere 		res = probe_device_by_compat(fdt, nodeoffset, compat, type);
471ef20efc4SEtienne Carriere 
472ef20efc4SEtienne Carriere 		if (res != TEE_ERROR_ITEM_NOT_FOUND)
473ef20efc4SEtienne Carriere 			return res;
474ef20efc4SEtienne Carriere 	}
475ef20efc4SEtienne Carriere 
476ef20efc4SEtienne Carriere 	return TEE_ERROR_ITEM_NOT_FOUND;
477ef20efc4SEtienne Carriere }
478b3a88b52SEtienne Carriere 
479b3a88b52SEtienne Carriere static TEE_Result process_probe_list(const void *fdt)
480b3a88b52SEtienne Carriere {
481b3a88b52SEtienne Carriere 	struct dt_driver_probe *elt = NULL;
482b3a88b52SEtienne Carriere 	struct dt_driver_probe *prev = NULL;
483c9bd3375SEtienne Carriere 	static unsigned int __maybe_unused loop_count;
484c9bd3375SEtienne Carriere 	static unsigned int __maybe_unused deferral_loop_count;
485b3a88b52SEtienne Carriere 	bool __maybe_unused one_deferred = false;
486b3a88b52SEtienne Carriere 	bool one_probed_ok = false;
487b3a88b52SEtienne Carriere 
488b3a88b52SEtienne Carriere 	do {
489b3a88b52SEtienne Carriere 		loop_count++;
490b3a88b52SEtienne Carriere 		FMSG("Probe loop %u after %u for deferral(s)", loop_count,
491b3a88b52SEtienne Carriere 		     deferral_loop_count);
492b3a88b52SEtienne Carriere 
493b3a88b52SEtienne Carriere 		/* Hack here for TRACE_DEBUG messages on probe list elements */
494b3a88b52SEtienne Carriere 		if (TRACE_LEVEL >= TRACE_FLOW)
495b3a88b52SEtienne Carriere 			print_probe_list(fdt);
496b3a88b52SEtienne Carriere 
497b3a88b52SEtienne Carriere 		if (TAILQ_EMPTY(&dt_driver_probe_list))
498b3a88b52SEtienne Carriere 			return TEE_SUCCESS;
499b3a88b52SEtienne Carriere 
500b3a88b52SEtienne Carriere 		/*
501b3a88b52SEtienne Carriere 		 * Probe from current end to top. Deferred probed node are
502b3a88b52SEtienne Carriere 		 * pushed back after current tail for the next probe round.
503b3a88b52SEtienne Carriere 		 * Reset probe result flags and see status after probe round.
504b3a88b52SEtienne Carriere 		 */
505b3a88b52SEtienne Carriere 		one_deferred = false;
506b3a88b52SEtienne Carriere 		one_probed_ok = false;
507b3a88b52SEtienne Carriere 		added_node = false;
508b3a88b52SEtienne Carriere 
509b3a88b52SEtienne Carriere 		TAILQ_FOREACH_REVERSE_SAFE(elt, &dt_driver_probe_list,
510b3a88b52SEtienne Carriere 					   dt_driver_probe_head, link, prev) {
511b3a88b52SEtienne Carriere 			TAILQ_REMOVE(&dt_driver_probe_list, elt, link);
512b3a88b52SEtienne Carriere 
513b3a88b52SEtienne Carriere 			switch (probe_driver_node(fdt, elt)) {
514b3a88b52SEtienne Carriere 			case TEE_SUCCESS:
515b3a88b52SEtienne Carriere 				one_probed_ok = true;
516b3a88b52SEtienne Carriere 				break;
517b3a88b52SEtienne Carriere 			case TEE_ERROR_DEFER_DRIVER_INIT:
518b3a88b52SEtienne Carriere 				one_deferred = true;
519b3a88b52SEtienne Carriere 				break;
520b3a88b52SEtienne Carriere 			default:
521736cb9e1SEtienne Carriere 				break;
522b3a88b52SEtienne Carriere 			}
523b3a88b52SEtienne Carriere 		}
524b3a88b52SEtienne Carriere 
525b3a88b52SEtienne Carriere 		if (one_deferred)
526b3a88b52SEtienne Carriere 			deferral_loop_count++;
527b3a88b52SEtienne Carriere 
528b3a88b52SEtienne Carriere 	} while (added_node || one_probed_ok);
529b3a88b52SEtienne Carriere 
530c9bd3375SEtienne Carriere 	DMSG("Unresolved dependencies after %u rounds, %u deferred",
531b3a88b52SEtienne Carriere 	     loop_count, deferral_loop_count);
532b3a88b52SEtienne Carriere 
533c9bd3375SEtienne Carriere 	if (one_deferred)
534c9bd3375SEtienne Carriere 		return TEE_ERROR_DEFER_DRIVER_INIT;
535c9bd3375SEtienne Carriere 	else
536c9bd3375SEtienne Carriere 		return TEE_ERROR_GENERIC;
537b3a88b52SEtienne Carriere }
538b3a88b52SEtienne Carriere 
539b3a88b52SEtienne Carriere static int driver_probe_compare(struct dt_driver_probe *candidate,
540b3a88b52SEtienne Carriere 				struct dt_driver_probe *elt)
541b3a88b52SEtienne Carriere {
542b3a88b52SEtienne Carriere 	if (candidate->nodeoffset != elt->nodeoffset ||
543b3a88b52SEtienne Carriere 	    candidate->type != elt->type)
544b3a88b52SEtienne Carriere 		return 1;
545b3a88b52SEtienne Carriere 
546b3a88b52SEtienne Carriere 	assert(elt->dt_drv == candidate->dt_drv);
547b3a88b52SEtienne Carriere 	return 0;
548b3a88b52SEtienne Carriere }
549b3a88b52SEtienne Carriere 
550b3a88b52SEtienne Carriere /*
551b3a88b52SEtienne Carriere  * Return TEE_SUCCESS if compatible found
552b3a88b52SEtienne Carriere  *	  TEE_ERROR_OUT_OF_MEMORY if heap is exhausted
553b3a88b52SEtienne Carriere  */
554b3a88b52SEtienne Carriere static TEE_Result add_node_to_probe(const void *fdt, int node,
555b3a88b52SEtienne Carriere 				    const struct dt_driver *dt_drv,
556b3a88b52SEtienne Carriere 				    const struct dt_device_match *dm)
557b3a88b52SEtienne Carriere {
558b3a88b52SEtienne Carriere 	const char __maybe_unused *node_name = fdt_get_name(fdt, node, NULL);
559b3a88b52SEtienne Carriere 	const char __maybe_unused *drv_name = dt_drv->name;
560b3a88b52SEtienne Carriere 	struct dt_driver_probe *elt = NULL;
561b3a88b52SEtienne Carriere 	struct dt_driver_probe elt_new = {
562b3a88b52SEtienne Carriere 		.dm = dm,
563b3a88b52SEtienne Carriere 		.dt_drv = dt_drv,
564b3a88b52SEtienne Carriere 		.nodeoffset = node,
565b3a88b52SEtienne Carriere 		.type = dt_drv->type,
566b3a88b52SEtienne Carriere 	};
567b3a88b52SEtienne Carriere 
568b3a88b52SEtienne Carriere 	/* If node/type found in probe list or ready list, nothing to do */
569b3a88b52SEtienne Carriere 	TAILQ_FOREACH(elt, &dt_driver_probe_list, link)
570b3a88b52SEtienne Carriere 		if (!driver_probe_compare(&elt_new, elt))
571b3a88b52SEtienne Carriere 			return TEE_SUCCESS;
572b3a88b52SEtienne Carriere 
573b3a88b52SEtienne Carriere 	TAILQ_FOREACH(elt, &dt_driver_ready_list, link)
574b3a88b52SEtienne Carriere 		if (!driver_probe_compare(&elt_new, elt))
575b3a88b52SEtienne Carriere 			return TEE_SUCCESS;
576b3a88b52SEtienne Carriere 
577b3a88b52SEtienne Carriere 	elt = malloc(sizeof(*elt));
578b3a88b52SEtienne Carriere 	if (!elt)
579b3a88b52SEtienne Carriere 		return TEE_ERROR_OUT_OF_MEMORY;
580b3a88b52SEtienne Carriere 
581b3a88b52SEtienne Carriere 	DMSG("element: %s on node %s", node_name, drv_name);
582b3a88b52SEtienne Carriere 
583b3a88b52SEtienne Carriere 	memcpy(elt, &elt_new, sizeof(*elt));
584b3a88b52SEtienne Carriere 
585b3a88b52SEtienne Carriere 	added_node = true;
586b3a88b52SEtienne Carriere 
587b3a88b52SEtienne Carriere 	TAILQ_INSERT_TAIL(&dt_driver_probe_list, elt, link);
588b3a88b52SEtienne Carriere 
589b3a88b52SEtienne Carriere 	/* Hack here for TRACE_DEBUG messages on current probe list elements */
590b3a88b52SEtienne Carriere 	if (TRACE_LEVEL >= TRACE_FLOW)
591b3a88b52SEtienne Carriere 		print_probe_list(fdt);
592b3a88b52SEtienne Carriere 
593b3a88b52SEtienne Carriere 	return TEE_SUCCESS;
594b3a88b52SEtienne Carriere }
595b3a88b52SEtienne Carriere 
596b3a88b52SEtienne Carriere /*
597b3a88b52SEtienne Carriere  * Add a node to the probe list if a dt_driver matches target compatible.
598b3a88b52SEtienne Carriere  *
599b3a88b52SEtienne Carriere  * If @type is DT_DRIVER_ANY, probe list can hold only 1 driver to probe for
600b3a88b52SEtienne Carriere  * the node. A node may probe several drivers if have a unique driver type.
601b3a88b52SEtienne Carriere  *
602b3a88b52SEtienne Carriere  * Return TEE_SUCCESS if compatible found
603b3a88b52SEtienne Carriere  *	  TEE_ERROR_ITEM_NOT_FOUND if no matching driver
604b3a88b52SEtienne Carriere  *	  TEE_ERROR_OUT_OF_MEMORY if heap is exhausted
605b3a88b52SEtienne Carriere  */
606b3a88b52SEtienne Carriere static TEE_Result add_probe_node_by_compat(const void *fdt, int node,
607b3a88b52SEtienne Carriere 					   const char *compat)
608b3a88b52SEtienne Carriere {
609b3a88b52SEtienne Carriere 	TEE_Result res = TEE_ERROR_ITEM_NOT_FOUND;
610b3a88b52SEtienne Carriere 	const struct dt_driver *dt_drv = NULL;
611b3a88b52SEtienne Carriere 	const struct dt_device_match *dm = NULL;
612b3a88b52SEtienne Carriere 	uint32_t found_types = 0;
613b3a88b52SEtienne Carriere 
614b3a88b52SEtienne Carriere 	for_each_dt_driver(dt_drv) {
615b3a88b52SEtienne Carriere 		for (dm = dt_drv->match_table; dm && dm->compatible; dm++) {
616b3a88b52SEtienne Carriere 			if (strcmp(dm->compatible, compat) == 0) {
617b3a88b52SEtienne Carriere 				assert(dt_drv->type < 32);
618b3a88b52SEtienne Carriere 
619b3a88b52SEtienne Carriere 				res = add_node_to_probe(fdt, node, dt_drv, dm);
620b3a88b52SEtienne Carriere 				if (res)
621b3a88b52SEtienne Carriere 					return res;
622b3a88b52SEtienne Carriere 
623b3a88b52SEtienne Carriere 				if (found_types & BIT(dt_drv->type)) {
624b3a88b52SEtienne Carriere 					EMSG("Driver %s multi hit on type %u",
625b3a88b52SEtienne Carriere 					     dt_drv->name, dt_drv->type);
626b3a88b52SEtienne Carriere 					panic();
627b3a88b52SEtienne Carriere 				}
628b3a88b52SEtienne Carriere 				found_types |= BIT(dt_drv->type);
629b3a88b52SEtienne Carriere 
630b3a88b52SEtienne Carriere 				/* Matching found for this driver, try next */
631b3a88b52SEtienne Carriere 				break;
632b3a88b52SEtienne Carriere 			}
633b3a88b52SEtienne Carriere 		}
634b3a88b52SEtienne Carriere 	}
635b3a88b52SEtienne Carriere 
636b3a88b52SEtienne Carriere 	return res;
637b3a88b52SEtienne Carriere }
638b3a88b52SEtienne Carriere 
639b3a88b52SEtienne Carriere /*
640b3a88b52SEtienne Carriere  * Add the node to the probe list if matching compatible drivers are found.
641b3a88b52SEtienne Carriere  * Follow node's compatible property list ordering to find matching driver.
642b3a88b52SEtienne Carriere  */
643b3a88b52SEtienne Carriere TEE_Result dt_driver_maybe_add_probe_node(const void *fdt, int node)
644b3a88b52SEtienne Carriere {
645b3a88b52SEtienne Carriere 	int idx = 0;
646b3a88b52SEtienne Carriere 	int len = 0;
647b3a88b52SEtienne Carriere 	int count = 0;
648b3a88b52SEtienne Carriere 	const char *compat = NULL;
649b3a88b52SEtienne Carriere 	TEE_Result res = TEE_ERROR_GENERIC;
650b3a88b52SEtienne Carriere 
651*f354a5d8SGatien Chevallier 	if (fdt_get_status(fdt, node) == DT_STATUS_DISABLED)
652b3a88b52SEtienne Carriere 		return TEE_SUCCESS;
653b3a88b52SEtienne Carriere 
654b3a88b52SEtienne Carriere 	count = fdt_stringlist_count(fdt, node, "compatible");
655b3a88b52SEtienne Carriere 	if (count < 0)
656b3a88b52SEtienne Carriere 		return TEE_SUCCESS;
657b3a88b52SEtienne Carriere 
658b3a88b52SEtienne Carriere 	for (idx = 0; idx < count; idx++) {
659b3a88b52SEtienne Carriere 		compat = fdt_stringlist_get(fdt, node, "compatible", idx, &len);
660b3a88b52SEtienne Carriere 		assert(compat && len > 0);
661b3a88b52SEtienne Carriere 
662b3a88b52SEtienne Carriere 		res = add_probe_node_by_compat(fdt, node, compat);
663b3a88b52SEtienne Carriere 
664b3a88b52SEtienne Carriere 		/* Stop lookup if something was found */
665b3a88b52SEtienne Carriere 		if (res != TEE_ERROR_ITEM_NOT_FOUND)
666b3a88b52SEtienne Carriere 			return res;
667b3a88b52SEtienne Carriere 	}
668b3a88b52SEtienne Carriere 
669b3a88b52SEtienne Carriere 	return TEE_SUCCESS;
670b3a88b52SEtienne Carriere }
671b3a88b52SEtienne Carriere 
672b3a88b52SEtienne Carriere static void parse_node(const void *fdt, int node)
673b3a88b52SEtienne Carriere {
674b3a88b52SEtienne Carriere 	TEE_Result __maybe_unused res = TEE_ERROR_GENERIC;
675b3a88b52SEtienne Carriere 	int subnode = 0;
676b3a88b52SEtienne Carriere 
677b3a88b52SEtienne Carriere 	fdt_for_each_subnode(subnode, fdt, node) {
678b3a88b52SEtienne Carriere 		res = dt_driver_maybe_add_probe_node(fdt, subnode);
679b3a88b52SEtienne Carriere 		if (res) {
680b3a88b52SEtienne Carriere 			EMSG("Failed on node %s with %#"PRIx32,
681b3a88b52SEtienne Carriere 			     fdt_get_name(fdt, subnode, NULL), res);
682b3a88b52SEtienne Carriere 			panic();
683b3a88b52SEtienne Carriere 		}
684b3a88b52SEtienne Carriere 
685b3a88b52SEtienne Carriere 		/*
686b3a88b52SEtienne Carriere 		 * Rescursively parse the FDT, skipping disabled nodes.
687b3a88b52SEtienne Carriere 		 * FDT is expected reliable and core shall have sufficient
688b3a88b52SEtienne Carriere 		 * stack depth to possibly parse all DT nodes.
689b3a88b52SEtienne Carriere 		 */
690b3a88b52SEtienne Carriere 		if (IS_ENABLED(CFG_DRIVERS_DT_RECURSIVE_PROBE)) {
691*f354a5d8SGatien Chevallier 			if (fdt_get_status(fdt, subnode) == DT_STATUS_DISABLED)
692b3a88b52SEtienne Carriere 				continue;
693b3a88b52SEtienne Carriere 
694b3a88b52SEtienne Carriere 			parse_node(fdt, subnode);
695b3a88b52SEtienne Carriere 		}
696b3a88b52SEtienne Carriere 	}
697b3a88b52SEtienne Carriere }
698b3a88b52SEtienne Carriere 
699b3a88b52SEtienne Carriere /*
700b3a88b52SEtienne Carriere  * Parse FDT for nodes and save in probe list the node for which a dt_driver
701b3a88b52SEtienne Carriere  * matches node's compatible property.
702b3a88b52SEtienne Carriere  */
703c9bd3375SEtienne Carriere static TEE_Result probe_dt_drivers_early(void)
704b3a88b52SEtienne Carriere {
705c9bd3375SEtienne Carriere 	TEE_Result res = TEE_ERROR_GENERIC;
706b3a88b52SEtienne Carriere 	const void *fdt = NULL;
707b3a88b52SEtienne Carriere 
708d2289450SVesa Jääskeläinen 	fdt = get_secure_dt();
709d2289450SVesa Jääskeläinen 	if (!fdt)
710b3a88b52SEtienne Carriere 		return TEE_SUCCESS;
711b3a88b52SEtienne Carriere 
712b3a88b52SEtienne Carriere 	parse_node(fdt, fdt_path_offset(fdt, "/"));
713b3a88b52SEtienne Carriere 
714c9bd3375SEtienne Carriere 	res = process_probe_list(fdt);
715c9bd3375SEtienne Carriere 	if (res == TEE_ERROR_DEFER_DRIVER_INIT) {
716c9bd3375SEtienne Carriere 		DMSG("Deferred drivers probing");
717c9bd3375SEtienne Carriere 		print_probe_list(fdt);
718c9bd3375SEtienne Carriere 		res = TEE_SUCCESS;
719b3a88b52SEtienne Carriere 	}
720b3a88b52SEtienne Carriere 
721c9bd3375SEtienne Carriere 	return res;
722c9bd3375SEtienne Carriere }
723c9bd3375SEtienne Carriere 
724c9bd3375SEtienne Carriere static TEE_Result probe_dt_drivers(void)
725c9bd3375SEtienne Carriere {
726c9bd3375SEtienne Carriere 	TEE_Result res = TEE_ERROR_GENERIC;
727c9bd3375SEtienne Carriere 	const void *fdt = NULL;
728c9bd3375SEtienne Carriere 
729d2289450SVesa Jääskeläinen 	fdt = get_secure_dt();
730d2289450SVesa Jääskeläinen 	if (!fdt)
731c9bd3375SEtienne Carriere 		return TEE_SUCCESS;
732c9bd3375SEtienne Carriere 
733c9bd3375SEtienne Carriere 	res = process_probe_list(fdt);
734c9bd3375SEtienne Carriere 	if (res || !TAILQ_EMPTY(&dt_driver_failed_list)) {
735c9bd3375SEtienne Carriere 		EMSG("Probe sequence result: %#"PRIx32, res);
736c9bd3375SEtienne Carriere 		print_probe_list(fdt);
737c9bd3375SEtienne Carriere 	}
738c9bd3375SEtienne Carriere 	if (res)
739c9bd3375SEtienne Carriere 		panic();
740c9bd3375SEtienne Carriere 
741c9bd3375SEtienne Carriere 	return TEE_SUCCESS;
742c9bd3375SEtienne Carriere }
743c9bd3375SEtienne Carriere 
744c9bd3375SEtienne Carriere early_init_late(probe_dt_drivers_early);
745b3a88b52SEtienne Carriere driver_init(probe_dt_drivers);
746ea29d587SEtienne Carriere 
747f21b3ed5SEtienne Carriere static TEE_Result release_probe_lists(void)
748f21b3ed5SEtienne Carriere {
749f21b3ed5SEtienne Carriere 	struct dt_driver_probe *elt = NULL;
750f21b3ed5SEtienne Carriere 	struct dt_driver_probe *next = NULL;
751115944b5SEtienne Carriere 	struct dt_driver_provider *prov = NULL;
752115944b5SEtienne Carriere 	struct dt_driver_provider *next_prov = NULL;
753d2289450SVesa Jääskeläinen 	const void *fdt = NULL;
754f21b3ed5SEtienne Carriere 
755d2289450SVesa Jääskeläinen 	fdt = get_secure_dt();
756d2289450SVesa Jääskeläinen 	if (!fdt)
757f21b3ed5SEtienne Carriere 		return TEE_SUCCESS;
758f21b3ed5SEtienne Carriere 
759f21b3ed5SEtienne Carriere 	assert(fdt && TAILQ_EMPTY(&dt_driver_probe_list));
760f21b3ed5SEtienne Carriere 
761115944b5SEtienne Carriere 	TAILQ_FOREACH_SAFE(elt, &dt_driver_ready_list, link, next)
762f21b3ed5SEtienne Carriere 		free(elt);
763115944b5SEtienne Carriere 
764736cb9e1SEtienne Carriere 	TAILQ_FOREACH_SAFE(elt, &dt_driver_failed_list, link, next)
765736cb9e1SEtienne Carriere 	       free(elt);
766736cb9e1SEtienne Carriere 
767115944b5SEtienne Carriere 	SLIST_FOREACH_SAFE(prov, &dt_driver_provider_list, link, next_prov)
768115944b5SEtienne Carriere 	       free(prov);
769f21b3ed5SEtienne Carriere 
770f21b3ed5SEtienne Carriere 	return TEE_SUCCESS;
771f21b3ed5SEtienne Carriere }
772f21b3ed5SEtienne Carriere 
773f21b3ed5SEtienne Carriere release_init_resource(release_probe_lists);
774f21b3ed5SEtienne Carriere 
775ea29d587SEtienne Carriere /*
776ea29d587SEtienne Carriere  * Simple bus support: handy to parse subnodes
777ea29d587SEtienne Carriere  */
778ea29d587SEtienne Carriere static TEE_Result simple_bus_probe(const void *fdt, int node,
779ea29d587SEtienne Carriere 				   const void *compat_data __unused)
780ea29d587SEtienne Carriere {
781ea29d587SEtienne Carriere 	TEE_Result res = TEE_ERROR_GENERIC;
782ea29d587SEtienne Carriere 	int subnode = 0;
783ea29d587SEtienne Carriere 
784ea29d587SEtienne Carriere 	fdt_for_each_subnode(subnode, fdt, node) {
785ea29d587SEtienne Carriere 		res = dt_driver_maybe_add_probe_node(fdt, subnode);
786ea29d587SEtienne Carriere 		if (res) {
787ea29d587SEtienne Carriere 			EMSG("Failed on node %s with %#"PRIx32,
788ea29d587SEtienne Carriere 			     fdt_get_name(fdt, subnode, NULL), res);
789ea29d587SEtienne Carriere 			panic();
790ea29d587SEtienne Carriere 		}
791ea29d587SEtienne Carriere 	}
792ea29d587SEtienne Carriere 
793ea29d587SEtienne Carriere 	return TEE_SUCCESS;
794ea29d587SEtienne Carriere }
795ea29d587SEtienne Carriere 
796ea29d587SEtienne Carriere static const struct dt_device_match simple_bus_match_table[] = {
797ea29d587SEtienne Carriere 	{ .compatible = "simple-bus" },
798ea29d587SEtienne Carriere 	{ }
799ea29d587SEtienne Carriere };
800ea29d587SEtienne Carriere 
80161bdedeaSJerome Forissier DEFINE_DT_DRIVER(simple_bus_dt_driver) = {
802ea29d587SEtienne Carriere 	.name = "simple-bus",
803ea29d587SEtienne Carriere 	.match_table = simple_bus_match_table,
804ea29d587SEtienne Carriere 	.probe = simple_bus_probe,
805ea29d587SEtienne Carriere };
806