xref: /optee_os/core/kernel/dt_driver.c (revision 4fc179b6919181df142772f53cc26cd107fed69f)
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:
109*4fc179b6SThomas Perrot 	case DT_DRIVER_GPIO:
110e7a2db34SClément Léger 	case DT_DRIVER_I2C:
111b3a88b52SEtienne Carriere 		return;
112b3a88b52SEtienne Carriere 	default:
113b3a88b52SEtienne Carriere 		assert(0);
114b3a88b52SEtienne Carriere 	}
115b3a88b52SEtienne Carriere }
116b3a88b52SEtienne Carriere 
1173fd340e5SEtienne Carriere /*
1183fd340e5SEtienne Carriere  * Driver provider registering API functions
1193fd340e5SEtienne Carriere  */
1203fd340e5SEtienne Carriere 
1213fd340e5SEtienne Carriere TEE_Result dt_driver_register_provider(const void *fdt, int nodeoffset,
1223fd340e5SEtienne Carriere 				       get_of_device_func get_of_device,
1233fd340e5SEtienne Carriere 				       void *priv, enum dt_driver_type type)
1243fd340e5SEtienne Carriere {
1253fd340e5SEtienne Carriere 	struct dt_driver_provider *prv = NULL;
1263fd340e5SEtienne Carriere 	int provider_cells = 0;
1273fd340e5SEtienne Carriere 	uint32_t phandle = 0;
1283fd340e5SEtienne Carriere 
129b3a88b52SEtienne Carriere 	assert_type_is_valid(type);
130b3a88b52SEtienne Carriere 
1313fd340e5SEtienne Carriere 	provider_cells = fdt_get_dt_driver_cells(fdt, nodeoffset, type);
1323fd340e5SEtienne Carriere 	if (provider_cells < 0) {
1333fd340e5SEtienne Carriere 		DMSG("Failed to find provider cells: %d", provider_cells);
1343fd340e5SEtienne Carriere 		return TEE_ERROR_GENERIC;
1353fd340e5SEtienne Carriere 	}
1363fd340e5SEtienne Carriere 
1373fd340e5SEtienne Carriere 	phandle = fdt_get_phandle(fdt, nodeoffset);
1380f9f9a37SGatien Chevallier 	if (phandle == (uint32_t)-1) {
1393fd340e5SEtienne Carriere 		DMSG("Failed to find provide phandle");
1403fd340e5SEtienne Carriere 		return TEE_ERROR_GENERIC;
1413fd340e5SEtienne Carriere 	}
1423fd340e5SEtienne Carriere 
1433fd340e5SEtienne Carriere 	prv = calloc(1, sizeof(*prv));
1443fd340e5SEtienne Carriere 	if (!prv)
1453fd340e5SEtienne Carriere 		return TEE_ERROR_OUT_OF_MEMORY;
1463fd340e5SEtienne Carriere 
1473fd340e5SEtienne Carriere 	prv->nodeoffset = nodeoffset;
1483fd340e5SEtienne Carriere 	prv->type = type;
1493fd340e5SEtienne Carriere 	prv->provider_cells = provider_cells;
1503fd340e5SEtienne Carriere 	prv->phandle = phandle;
1513fd340e5SEtienne Carriere 	prv->get_of_device = get_of_device;
1523fd340e5SEtienne Carriere 	prv->priv_data = priv;
1533fd340e5SEtienne Carriere 
1543fd340e5SEtienne Carriere 	SLIST_INSERT_HEAD(&dt_driver_provider_list, prv, link);
1553fd340e5SEtienne Carriere 
1563fd340e5SEtienne Carriere 	return TEE_SUCCESS;
1573fd340e5SEtienne Carriere }
1583fd340e5SEtienne Carriere 
1593fd340e5SEtienne Carriere /*
1603fd340e5SEtienne Carriere  * Helper functions for dt_drivers querying driver provider information
1613fd340e5SEtienne Carriere  */
1623fd340e5SEtienne Carriere 
1633fd340e5SEtienne Carriere int fdt_get_dt_driver_cells(const void *fdt, int nodeoffset,
1643fd340e5SEtienne Carriere 			    enum dt_driver_type type)
1653fd340e5SEtienne Carriere {
1663fd340e5SEtienne Carriere 	const char *cells_name = NULL;
1673fd340e5SEtienne Carriere 	const fdt32_t *c = NULL;
1683fd340e5SEtienne Carriere 	int len = 0;
1693fd340e5SEtienne Carriere 
1703fd340e5SEtienne Carriere 	switch (type) {
1713fd340e5SEtienne Carriere 	case DT_DRIVER_CLK:
1723fd340e5SEtienne Carriere 		cells_name = "#clock-cells";
1733fd340e5SEtienne Carriere 		break;
174c78b2c66SEtienne Carriere 	case DT_DRIVER_RSTCTRL:
175c78b2c66SEtienne Carriere 		cells_name = "#reset-cells";
176c78b2c66SEtienne Carriere 		break;
177*4fc179b6SThomas Perrot 	case DT_DRIVER_GPIO:
178*4fc179b6SThomas Perrot 		cells_name = "#gpio-cells";
179*4fc179b6SThomas Perrot 		break;
180e7a2db34SClément Léger 	case DT_DRIVER_I2C:
181e7a2db34SClément Léger 		return 0;
1823fd340e5SEtienne Carriere 	default:
1833fd340e5SEtienne Carriere 		panic();
1843fd340e5SEtienne Carriere 	}
1853fd340e5SEtienne Carriere 
1863fd340e5SEtienne Carriere 	c = fdt_getprop(fdt, nodeoffset, cells_name, &len);
1873fd340e5SEtienne Carriere 	if (!c)
1883fd340e5SEtienne Carriere 		return len;
1893fd340e5SEtienne Carriere 
1903fd340e5SEtienne Carriere 	if (len != sizeof(*c))
1913fd340e5SEtienne Carriere 		return -FDT_ERR_BADNCELLS;
1923fd340e5SEtienne Carriere 
1933fd340e5SEtienne Carriere 	return fdt32_to_cpu(*c);
1943fd340e5SEtienne Carriere }
1953fd340e5SEtienne Carriere 
1963fd340e5SEtienne Carriere unsigned int dt_driver_provider_cells(struct dt_driver_provider *prv)
1973fd340e5SEtienne Carriere {
1983fd340e5SEtienne Carriere 	return prv->provider_cells;
1993fd340e5SEtienne Carriere }
200f498c404SEtienne Carriere 
2018dca59b4SEtienne Carriere struct dt_driver_provider *
2028dca59b4SEtienne Carriere dt_driver_get_provider_by_node(int nodeoffset, enum dt_driver_type type)
203f498c404SEtienne Carriere {
204f498c404SEtienne Carriere 	struct dt_driver_provider *prv = NULL;
205f498c404SEtienne Carriere 
206f498c404SEtienne Carriere 	SLIST_FOREACH(prv, &dt_driver_provider_list, link)
2078dca59b4SEtienne Carriere 		if (prv->nodeoffset == nodeoffset && prv->type == type)
208f498c404SEtienne Carriere 			return prv;
209f498c404SEtienne Carriere 
210f498c404SEtienne Carriere 	return NULL;
211f498c404SEtienne Carriere }
212f498c404SEtienne Carriere 
2138dca59b4SEtienne Carriere struct dt_driver_provider *
2148dca59b4SEtienne Carriere dt_driver_get_provider_by_phandle(uint32_t phandle, enum dt_driver_type type)
215f498c404SEtienne Carriere {
216f498c404SEtienne Carriere 	struct dt_driver_provider *prv = NULL;
217f498c404SEtienne Carriere 
218f498c404SEtienne Carriere 	SLIST_FOREACH(prv, &dt_driver_provider_list, link)
2198dca59b4SEtienne Carriere 		if (prv->phandle == phandle && prv->type == type)
220f498c404SEtienne Carriere 			return prv;
221f498c404SEtienne Carriere 
222f498c404SEtienne Carriere 	return NULL;
223f498c404SEtienne Carriere }
224a22e85b2SEtienne Carriere 
225a22e85b2SEtienne Carriere static void *device_from_provider_prop(struct dt_driver_provider *prv,
22633cc94dfSClément Léger 				       const void *fdt, int phandle_node,
22733cc94dfSClément Léger 				       const uint32_t *prop, TEE_Result *res)
228a22e85b2SEtienne Carriere {
229a22e85b2SEtienne Carriere 	struct dt_driver_phandle_args *pargs = NULL;
230a22e85b2SEtienne Carriere 	unsigned int n = 0;
231a22e85b2SEtienne Carriere 	void *device = NULL;
232a22e85b2SEtienne Carriere 
233a22e85b2SEtienne Carriere 	pargs = calloc(1, prv->provider_cells * sizeof(uint32_t *) +
234a22e85b2SEtienne Carriere 		       sizeof(*pargs));
235d8b14b46SEtienne Carriere 	if (!pargs) {
236d8b14b46SEtienne Carriere 		*res = TEE_ERROR_OUT_OF_MEMORY;
237a22e85b2SEtienne Carriere 		return NULL;
238d8b14b46SEtienne Carriere 	}
239a22e85b2SEtienne Carriere 
24033cc94dfSClément Léger 	pargs->fdt = fdt;
24133cc94dfSClément Léger 	pargs->phandle_node = phandle_node;
242a22e85b2SEtienne Carriere 	pargs->args_count = prv->provider_cells;
243a22e85b2SEtienne Carriere 	for (n = 0; n < prv->provider_cells; n++)
244a22e85b2SEtienne Carriere 		pargs->args[n] = fdt32_to_cpu(prop[n + 1]);
245a22e85b2SEtienne Carriere 
246d8b14b46SEtienne Carriere 	device = prv->get_of_device(pargs, prv->priv_data, res);
247a22e85b2SEtienne Carriere 
248a22e85b2SEtienne Carriere 	free(pargs);
249a22e85b2SEtienne Carriere 
250a22e85b2SEtienne Carriere 	return device;
251a22e85b2SEtienne Carriere }
252a22e85b2SEtienne Carriere 
253e7a2db34SClément Léger void *dt_driver_device_from_parent(const void *fdt, int nodeoffset,
254e7a2db34SClément Léger 				   enum dt_driver_type type, TEE_Result *res)
255e7a2db34SClément Léger {
256e7a2db34SClément Léger 	int parent = -1;
257e7a2db34SClément Léger 	struct dt_driver_provider *prv = NULL;
258e7a2db34SClément Léger 
259e7a2db34SClément Léger 	assert(fdt == get_secure_dt());
260e7a2db34SClément Léger 
261e7a2db34SClément Léger 	parent = fdt_parent_offset(fdt, nodeoffset);
262e7a2db34SClément Léger 	if (parent < 0) {
263e7a2db34SClément Léger 		*res =  TEE_ERROR_GENERIC;
264e7a2db34SClément Léger 		return NULL;
265e7a2db34SClément Léger 	}
266e7a2db34SClément Léger 
267e7a2db34SClément Léger 	prv = dt_driver_get_provider_by_node(parent, type);
268e7a2db34SClément Léger 	if (!prv) {
269e7a2db34SClément Léger 		/* No provider registered yet */
270e7a2db34SClément Léger 		*res = TEE_ERROR_DEFER_DRIVER_INIT;
271e7a2db34SClément Léger 		return NULL;
272e7a2db34SClément Léger 	}
273e7a2db34SClément Léger 
274e7a2db34SClément Léger 	return device_from_provider_prop(prv, fdt, nodeoffset, NULL, res);
275e7a2db34SClément Léger }
276e7a2db34SClément Léger 
277a22e85b2SEtienne Carriere void *dt_driver_device_from_node_idx_prop(const char *prop_name,
278a22e85b2SEtienne Carriere 					  const void *fdt, int nodeoffset,
279d8b14b46SEtienne Carriere 					  unsigned int prop_idx,
2808dca59b4SEtienne Carriere 					  enum dt_driver_type type,
281d8b14b46SEtienne Carriere 					  TEE_Result *res)
282a22e85b2SEtienne Carriere {
283a22e85b2SEtienne Carriere 	int len = 0;
284a22e85b2SEtienne Carriere 	int idx = 0;
285a22e85b2SEtienne Carriere 	int idx32 = 0;
286a22e85b2SEtienne Carriere 	int prv_cells = 0;
28733cc94dfSClément Léger 	int phandle_node = -1;
288a22e85b2SEtienne Carriere 	uint32_t phandle = 0;
289a22e85b2SEtienne Carriere 	const uint32_t *prop = NULL;
290a22e85b2SEtienne Carriere 	struct dt_driver_provider *prv = NULL;
291a22e85b2SEtienne Carriere 
292a22e85b2SEtienne Carriere 	prop = fdt_getprop(fdt, nodeoffset, prop_name, &len);
293d8b14b46SEtienne Carriere 	if (!prop) {
294b17cf5c8SEtienne Carriere 		DMSG("Property %s missing in node %s", prop_name,
295b17cf5c8SEtienne Carriere 		     fdt_get_name(fdt, nodeoffset, NULL));
2960adca93aSGatien Chevallier 		*res = TEE_ERROR_ITEM_NOT_FOUND;
297a22e85b2SEtienne Carriere 		return NULL;
298d8b14b46SEtienne Carriere 	}
299a22e85b2SEtienne Carriere 
300a22e85b2SEtienne Carriere 	while (idx < len) {
301a22e85b2SEtienne Carriere 		idx32 = idx / sizeof(uint32_t);
302a22e85b2SEtienne Carriere 		phandle = fdt32_to_cpu(prop[idx32]);
303f1f7c58eSClément Léger 		if (!phandle) {
304f1f7c58eSClément Léger 			if (!prop_idx)
305f1f7c58eSClément Léger 				break;
306f1f7c58eSClément Léger 			idx += sizeof(phandle);
307f1f7c58eSClément Léger 			prop_idx--;
308f1f7c58eSClément Léger 			continue;
309f1f7c58eSClément Léger 		}
310a22e85b2SEtienne Carriere 
3118dca59b4SEtienne Carriere 		prv = dt_driver_get_provider_by_phandle(phandle, type);
312d8b14b46SEtienne Carriere 		if (!prv) {
313a3f00f7dSEtienne Carriere 			/* No provider registered yet */
314a3f00f7dSEtienne Carriere 			*res = TEE_ERROR_DEFER_DRIVER_INIT;
315a22e85b2SEtienne Carriere 			return NULL;
316d8b14b46SEtienne Carriere 		}
317a22e85b2SEtienne Carriere 
318a22e85b2SEtienne Carriere 		prv_cells = dt_driver_provider_cells(prv);
319a22e85b2SEtienne Carriere 		if (prop_idx) {
320a22e85b2SEtienne Carriere 			prop_idx--;
321a22e85b2SEtienne Carriere 			idx += sizeof(phandle) + prv_cells * sizeof(uint32_t);
322a22e85b2SEtienne Carriere 			continue;
323a22e85b2SEtienne Carriere 		}
324a22e85b2SEtienne Carriere 
32533cc94dfSClément Léger 		return device_from_provider_prop(prv, fdt, phandle_node,
32633cc94dfSClément Léger 						 prop + idx32, res);
327a22e85b2SEtienne Carriere 	}
328a22e85b2SEtienne Carriere 
3290adca93aSGatien Chevallier 	*res = TEE_ERROR_ITEM_NOT_FOUND;
330a22e85b2SEtienne Carriere 	return NULL;
331a22e85b2SEtienne Carriere }
332ef20efc4SEtienne Carriere 
333c9bd3375SEtienne Carriere static void __maybe_unused print_probe_list(const void *fdt __maybe_unused)
334b3a88b52SEtienne Carriere {
335b3a88b52SEtienne Carriere 	struct dt_driver_probe *elt = NULL;
336b3a88b52SEtienne Carriere 	unsigned int count = 0;
337b3a88b52SEtienne Carriere 
338b3a88b52SEtienne Carriere 	TAILQ_FOREACH(elt, &dt_driver_probe_list, link)
339b3a88b52SEtienne Carriere 		count++;
340b3a88b52SEtienne Carriere 
341c9bd3375SEtienne Carriere 	DMSG("Probe list: %u elements", count);
342b3a88b52SEtienne Carriere 	TAILQ_FOREACH(elt, &dt_driver_probe_list, link)
343c9bd3375SEtienne Carriere 		DMSG("|- Driver %s probes on node %s",
344b3a88b52SEtienne Carriere 		     elt->dt_drv->name,
345b3a88b52SEtienne Carriere 		     fdt_get_name(fdt, elt->nodeoffset, NULL));
346b3a88b52SEtienne Carriere 
347c9bd3375SEtienne Carriere 	DMSG("`- Probe list end");
348c9bd3375SEtienne Carriere 
349c9bd3375SEtienne Carriere 	count = 0;
350c9bd3375SEtienne Carriere 	TAILQ_FOREACH(elt, &dt_driver_failed_list, link)
351c9bd3375SEtienne Carriere 		count++;
352c9bd3375SEtienne Carriere 
353c9bd3375SEtienne Carriere 	DMSG("Failed list: %u elements", count);
354c9bd3375SEtienne Carriere 	TAILQ_FOREACH(elt, &dt_driver_failed_list, link)
355c9bd3375SEtienne Carriere 		EMSG("|- Driver %s on node %s failed", elt->dt_drv->name,
356c9bd3375SEtienne Carriere 		     fdt_get_name(fdt, elt->nodeoffset, NULL));
357c9bd3375SEtienne Carriere 
358c9bd3375SEtienne Carriere 	DMSG("`- Failed list end");
359b3a88b52SEtienne Carriere }
360b3a88b52SEtienne Carriere 
361b3a88b52SEtienne Carriere /*
362b3a88b52SEtienne Carriere  * Probe element: push to ready list if succeeds, push to probe list if probe
363b3a88b52SEtienne Carriere  * if deferred, panic with an error trace otherwise.
364b3a88b52SEtienne Carriere  */
365b3a88b52SEtienne Carriere static TEE_Result probe_driver_node(const void *fdt,
366b3a88b52SEtienne Carriere 				    struct dt_driver_probe *elt)
367b3a88b52SEtienne Carriere {
368b3a88b52SEtienne Carriere 	TEE_Result res = TEE_ERROR_GENERIC;
369b3a88b52SEtienne Carriere 	const char __maybe_unused *drv_name = NULL;
370b3a88b52SEtienne Carriere 	const char __maybe_unused *node_name = NULL;
371b3a88b52SEtienne Carriere 
372b3a88b52SEtienne Carriere 	node_name = fdt_get_name(fdt, elt->nodeoffset, NULL);
373b3a88b52SEtienne Carriere 	drv_name = elt->dt_drv->name;
374c4c84e2cSSahil Malhotra 
375c4c84e2cSSahil Malhotra 	if (!elt->dt_drv->probe) {
376c4c84e2cSSahil Malhotra 		DMSG("No probe operator for driver %s, skipped", drv_name);
377c4c84e2cSSahil Malhotra 		return TEE_SUCCESS;
378c4c84e2cSSahil Malhotra 	}
379c4c84e2cSSahil Malhotra 
380b3a88b52SEtienne Carriere 	FMSG("Probing %s on node %s", drv_name, node_name);
381b3a88b52SEtienne Carriere 
382b3a88b52SEtienne Carriere 	res = elt->dt_drv->probe(fdt, elt->nodeoffset, elt->dm->compat_data);
383b3a88b52SEtienne Carriere 	switch (res) {
384b3a88b52SEtienne Carriere 	case TEE_SUCCESS:
385b3a88b52SEtienne Carriere 		TAILQ_INSERT_HEAD(&dt_driver_ready_list, elt, link);
386b3a88b52SEtienne Carriere 
387b3a88b52SEtienne Carriere 		DMSG("element: %s on node %s initialized", drv_name, node_name);
388b3a88b52SEtienne Carriere 		break;
389b3a88b52SEtienne Carriere 	case TEE_ERROR_DEFER_DRIVER_INIT:
390b3a88b52SEtienne Carriere 		elt->deferrals++;
391b3a88b52SEtienne Carriere 		TAILQ_INSERT_TAIL(&dt_driver_probe_list, elt, link);
392b3a88b52SEtienne Carriere 
393b3a88b52SEtienne Carriere 		DMSG("element: %s on node %s deferred %u time(s)", drv_name,
394b3a88b52SEtienne Carriere 		     node_name, elt->deferrals);
395b3a88b52SEtienne Carriere 		break;
39652199c35SVesa Jääskeläinen 	case TEE_ERROR_NODE_DISABLED:
39752199c35SVesa Jääskeläinen 		DMSG("element: %s on node %s is disabled", drv_name, node_name);
39852199c35SVesa Jääskeläinen 		break;
399b3a88b52SEtienne Carriere 	default:
400736cb9e1SEtienne Carriere 		TAILQ_INSERT_HEAD(&dt_driver_failed_list, elt, link);
401736cb9e1SEtienne Carriere 
402736cb9e1SEtienne Carriere 		EMSG("Failed to probe %s on node %s: %#"PRIx32,
403b3a88b52SEtienne Carriere 		     drv_name, node_name, res);
404736cb9e1SEtienne Carriere 		break;
405b3a88b52SEtienne Carriere 	}
406b3a88b52SEtienne Carriere 
407b3a88b52SEtienne Carriere 	return res;
408b3a88b52SEtienne Carriere }
409b3a88b52SEtienne Carriere 
410b3a88b52SEtienne Carriere static TEE_Result alloc_elt_and_probe(const void *fdt, int node,
411b3a88b52SEtienne Carriere 				      const struct dt_driver *dt_drv,
412b3a88b52SEtienne Carriere 				      const struct dt_device_match *dm)
413b3a88b52SEtienne Carriere {
414b3a88b52SEtienne Carriere 	struct dt_driver_probe *elt = NULL;
415b3a88b52SEtienne Carriere 
416b3a88b52SEtienne Carriere 	/* Will be freed when lists are released */
417b3a88b52SEtienne Carriere 	elt = calloc(1, sizeof(*elt));
418b3a88b52SEtienne Carriere 	if (!elt)
419b3a88b52SEtienne Carriere 		return TEE_ERROR_OUT_OF_MEMORY;
420b3a88b52SEtienne Carriere 
421b3a88b52SEtienne Carriere 	elt->nodeoffset = node;
422b3a88b52SEtienne Carriere 	elt->dt_drv = dt_drv;
423b3a88b52SEtienne Carriere 	elt->dm = dm;
424b3a88b52SEtienne Carriere 	elt->type = dt_drv->type;
425b3a88b52SEtienne Carriere 
426b3a88b52SEtienne Carriere 	return probe_driver_node(fdt, elt);
427b3a88b52SEtienne Carriere }
428b3a88b52SEtienne Carriere 
429ef20efc4SEtienne Carriere /* Lookup a compatible driver, possibly of a specific @type, for the FDT node */
430ef20efc4SEtienne Carriere static TEE_Result probe_device_by_compat(const void *fdt, int node,
431ef20efc4SEtienne Carriere 					 const char *compat,
432ef20efc4SEtienne Carriere 					 enum dt_driver_type type)
433ef20efc4SEtienne Carriere {
434ef20efc4SEtienne Carriere 	const struct dt_driver *drv = NULL;
435ef20efc4SEtienne Carriere 	const struct dt_device_match *dm = NULL;
436ef20efc4SEtienne Carriere 
437ef20efc4SEtienne Carriere 	for_each_dt_driver(drv) {
438ef20efc4SEtienne Carriere 		if (drv->type != type)
439ef20efc4SEtienne Carriere 			continue;
440ef20efc4SEtienne Carriere 
441ef20efc4SEtienne Carriere 		for (dm = drv->match_table; dm && dm->compatible; dm++)
442ef20efc4SEtienne Carriere 			if (strcmp(dm->compatible, compat) == 0)
443b3a88b52SEtienne Carriere 				return alloc_elt_and_probe(fdt, node, drv, dm);
444ef20efc4SEtienne Carriere 	}
445ef20efc4SEtienne Carriere 
446ef20efc4SEtienne Carriere 	return TEE_ERROR_ITEM_NOT_FOUND;
447ef20efc4SEtienne Carriere }
448ef20efc4SEtienne Carriere 
449b3a88b52SEtienne Carriere /*
450b3a88b52SEtienne Carriere  * Lookup the best matching compatible driver, possibly of a specific @type,
451b3a88b52SEtienne Carriere  * for the FDT node.
452b3a88b52SEtienne Carriere  */
453ef20efc4SEtienne Carriere TEE_Result dt_driver_probe_device_by_node(const void *fdt, int nodeoffset,
454ef20efc4SEtienne Carriere 					  enum dt_driver_type type)
455ef20efc4SEtienne Carriere {
456ef20efc4SEtienne Carriere 	int idx = 0;
457ef20efc4SEtienne Carriere 	int len = 0;
458ef20efc4SEtienne Carriere 	int count = 0;
459ef20efc4SEtienne Carriere 	const char *compat = NULL;
460ef20efc4SEtienne Carriere 	TEE_Result res = TEE_ERROR_GENERIC;
461ef20efc4SEtienne Carriere 
462b3a88b52SEtienne Carriere 	assert_type_is_valid(type);
463b3a88b52SEtienne Carriere 
464ef20efc4SEtienne Carriere 	count = fdt_stringlist_count(fdt, nodeoffset, "compatible");
465ef20efc4SEtienne Carriere 	if (count < 0)
466ef20efc4SEtienne Carriere 		return TEE_ERROR_ITEM_NOT_FOUND;
467ef20efc4SEtienne Carriere 
468ef20efc4SEtienne Carriere 	for (idx = 0; idx < count; idx++) {
469ef20efc4SEtienne Carriere 		compat = fdt_stringlist_get(fdt, nodeoffset, "compatible",
470ef20efc4SEtienne Carriere 					    idx, &len);
471ef20efc4SEtienne Carriere 		if (!compat)
472ef20efc4SEtienne Carriere 			return TEE_ERROR_GENERIC;
473ef20efc4SEtienne Carriere 
474ef20efc4SEtienne Carriere 		res = probe_device_by_compat(fdt, nodeoffset, compat, type);
475ef20efc4SEtienne Carriere 
476ef20efc4SEtienne Carriere 		if (res != TEE_ERROR_ITEM_NOT_FOUND)
477ef20efc4SEtienne Carriere 			return res;
478ef20efc4SEtienne Carriere 	}
479ef20efc4SEtienne Carriere 
480ef20efc4SEtienne Carriere 	return TEE_ERROR_ITEM_NOT_FOUND;
481ef20efc4SEtienne Carriere }
482b3a88b52SEtienne Carriere 
483b3a88b52SEtienne Carriere static TEE_Result process_probe_list(const void *fdt)
484b3a88b52SEtienne Carriere {
485b3a88b52SEtienne Carriere 	struct dt_driver_probe *elt = NULL;
486b3a88b52SEtienne Carriere 	struct dt_driver_probe *prev = NULL;
487c9bd3375SEtienne Carriere 	static unsigned int __maybe_unused loop_count;
488c9bd3375SEtienne Carriere 	static unsigned int __maybe_unused deferral_loop_count;
489b3a88b52SEtienne Carriere 	bool __maybe_unused one_deferred = false;
490b3a88b52SEtienne Carriere 	bool one_probed_ok = false;
491b3a88b52SEtienne Carriere 
492b3a88b52SEtienne Carriere 	do {
493b3a88b52SEtienne Carriere 		loop_count++;
494b3a88b52SEtienne Carriere 		FMSG("Probe loop %u after %u for deferral(s)", loop_count,
495b3a88b52SEtienne Carriere 		     deferral_loop_count);
496b3a88b52SEtienne Carriere 
497b3a88b52SEtienne Carriere 		/* Hack here for TRACE_DEBUG messages on probe list elements */
498b3a88b52SEtienne Carriere 		if (TRACE_LEVEL >= TRACE_FLOW)
499b3a88b52SEtienne Carriere 			print_probe_list(fdt);
500b3a88b52SEtienne Carriere 
501b3a88b52SEtienne Carriere 		if (TAILQ_EMPTY(&dt_driver_probe_list))
502b3a88b52SEtienne Carriere 			return TEE_SUCCESS;
503b3a88b52SEtienne Carriere 
504b3a88b52SEtienne Carriere 		/*
505b3a88b52SEtienne Carriere 		 * Probe from current end to top. Deferred probed node are
506b3a88b52SEtienne Carriere 		 * pushed back after current tail for the next probe round.
507b3a88b52SEtienne Carriere 		 * Reset probe result flags and see status after probe round.
508b3a88b52SEtienne Carriere 		 */
509b3a88b52SEtienne Carriere 		one_deferred = false;
510b3a88b52SEtienne Carriere 		one_probed_ok = false;
511b3a88b52SEtienne Carriere 		added_node = false;
512b3a88b52SEtienne Carriere 
513b3a88b52SEtienne Carriere 		TAILQ_FOREACH_REVERSE_SAFE(elt, &dt_driver_probe_list,
514b3a88b52SEtienne Carriere 					   dt_driver_probe_head, link, prev) {
515b3a88b52SEtienne Carriere 			TAILQ_REMOVE(&dt_driver_probe_list, elt, link);
516b3a88b52SEtienne Carriere 
517b3a88b52SEtienne Carriere 			switch (probe_driver_node(fdt, elt)) {
518b3a88b52SEtienne Carriere 			case TEE_SUCCESS:
519b3a88b52SEtienne Carriere 				one_probed_ok = true;
520b3a88b52SEtienne Carriere 				break;
521b3a88b52SEtienne Carriere 			case TEE_ERROR_DEFER_DRIVER_INIT:
522b3a88b52SEtienne Carriere 				one_deferred = true;
523b3a88b52SEtienne Carriere 				break;
524b3a88b52SEtienne Carriere 			default:
525736cb9e1SEtienne Carriere 				break;
526b3a88b52SEtienne Carriere 			}
527b3a88b52SEtienne Carriere 		}
528b3a88b52SEtienne Carriere 
529b3a88b52SEtienne Carriere 		if (one_deferred)
530b3a88b52SEtienne Carriere 			deferral_loop_count++;
531b3a88b52SEtienne Carriere 
532b3a88b52SEtienne Carriere 	} while (added_node || one_probed_ok);
533b3a88b52SEtienne Carriere 
534c9bd3375SEtienne Carriere 	DMSG("Unresolved dependencies after %u rounds, %u deferred",
535b3a88b52SEtienne Carriere 	     loop_count, deferral_loop_count);
536b3a88b52SEtienne Carriere 
537c9bd3375SEtienne Carriere 	if (one_deferred)
538c9bd3375SEtienne Carriere 		return TEE_ERROR_DEFER_DRIVER_INIT;
539c9bd3375SEtienne Carriere 	else
540c9bd3375SEtienne Carriere 		return TEE_ERROR_GENERIC;
541b3a88b52SEtienne Carriere }
542b3a88b52SEtienne Carriere 
543b3a88b52SEtienne Carriere static int driver_probe_compare(struct dt_driver_probe *candidate,
544b3a88b52SEtienne Carriere 				struct dt_driver_probe *elt)
545b3a88b52SEtienne Carriere {
546b3a88b52SEtienne Carriere 	if (candidate->nodeoffset != elt->nodeoffset ||
547b3a88b52SEtienne Carriere 	    candidate->type != elt->type)
548b3a88b52SEtienne Carriere 		return 1;
549b3a88b52SEtienne Carriere 
550b3a88b52SEtienne Carriere 	assert(elt->dt_drv == candidate->dt_drv);
551b3a88b52SEtienne Carriere 	return 0;
552b3a88b52SEtienne Carriere }
553b3a88b52SEtienne Carriere 
554b3a88b52SEtienne Carriere /*
555b3a88b52SEtienne Carriere  * Return TEE_SUCCESS if compatible found
556b3a88b52SEtienne Carriere  *	  TEE_ERROR_OUT_OF_MEMORY if heap is exhausted
557b3a88b52SEtienne Carriere  */
558b3a88b52SEtienne Carriere static TEE_Result add_node_to_probe(const void *fdt, int node,
559b3a88b52SEtienne Carriere 				    const struct dt_driver *dt_drv,
560b3a88b52SEtienne Carriere 				    const struct dt_device_match *dm)
561b3a88b52SEtienne Carriere {
562b3a88b52SEtienne Carriere 	const char __maybe_unused *node_name = fdt_get_name(fdt, node, NULL);
563b3a88b52SEtienne Carriere 	const char __maybe_unused *drv_name = dt_drv->name;
564b3a88b52SEtienne Carriere 	struct dt_driver_probe *elt = NULL;
565b3a88b52SEtienne Carriere 	struct dt_driver_probe elt_new = {
566b3a88b52SEtienne Carriere 		.dm = dm,
567b3a88b52SEtienne Carriere 		.dt_drv = dt_drv,
568b3a88b52SEtienne Carriere 		.nodeoffset = node,
569b3a88b52SEtienne Carriere 		.type = dt_drv->type,
570b3a88b52SEtienne Carriere 	};
571b3a88b52SEtienne Carriere 
572b3a88b52SEtienne Carriere 	/* If node/type found in probe list or ready list, nothing to do */
573b3a88b52SEtienne Carriere 	TAILQ_FOREACH(elt, &dt_driver_probe_list, link)
574b3a88b52SEtienne Carriere 		if (!driver_probe_compare(&elt_new, elt))
575b3a88b52SEtienne Carriere 			return TEE_SUCCESS;
576b3a88b52SEtienne Carriere 
577b3a88b52SEtienne Carriere 	TAILQ_FOREACH(elt, &dt_driver_ready_list, link)
578b3a88b52SEtienne Carriere 		if (!driver_probe_compare(&elt_new, elt))
579b3a88b52SEtienne Carriere 			return TEE_SUCCESS;
580b3a88b52SEtienne Carriere 
581b3a88b52SEtienne Carriere 	elt = malloc(sizeof(*elt));
582b3a88b52SEtienne Carriere 	if (!elt)
583b3a88b52SEtienne Carriere 		return TEE_ERROR_OUT_OF_MEMORY;
584b3a88b52SEtienne Carriere 
585b3a88b52SEtienne Carriere 	DMSG("element: %s on node %s", node_name, drv_name);
586b3a88b52SEtienne Carriere 
587b3a88b52SEtienne Carriere 	memcpy(elt, &elt_new, sizeof(*elt));
588b3a88b52SEtienne Carriere 
589b3a88b52SEtienne Carriere 	added_node = true;
590b3a88b52SEtienne Carriere 
591b3a88b52SEtienne Carriere 	TAILQ_INSERT_TAIL(&dt_driver_probe_list, elt, link);
592b3a88b52SEtienne Carriere 
593b3a88b52SEtienne Carriere 	/* Hack here for TRACE_DEBUG messages on current probe list elements */
594b3a88b52SEtienne Carriere 	if (TRACE_LEVEL >= TRACE_FLOW)
595b3a88b52SEtienne Carriere 		print_probe_list(fdt);
596b3a88b52SEtienne Carriere 
597b3a88b52SEtienne Carriere 	return TEE_SUCCESS;
598b3a88b52SEtienne Carriere }
599b3a88b52SEtienne Carriere 
600b3a88b52SEtienne Carriere /*
601b3a88b52SEtienne Carriere  * Add a node to the probe list if a dt_driver matches target compatible.
602b3a88b52SEtienne Carriere  *
603b3a88b52SEtienne Carriere  * If @type is DT_DRIVER_ANY, probe list can hold only 1 driver to probe for
604b3a88b52SEtienne Carriere  * the node. A node may probe several drivers if have a unique driver type.
605b3a88b52SEtienne Carriere  *
606b3a88b52SEtienne Carriere  * Return TEE_SUCCESS if compatible found
607b3a88b52SEtienne Carriere  *	  TEE_ERROR_ITEM_NOT_FOUND if no matching driver
608b3a88b52SEtienne Carriere  *	  TEE_ERROR_OUT_OF_MEMORY if heap is exhausted
609b3a88b52SEtienne Carriere  */
610b3a88b52SEtienne Carriere static TEE_Result add_probe_node_by_compat(const void *fdt, int node,
611b3a88b52SEtienne Carriere 					   const char *compat)
612b3a88b52SEtienne Carriere {
613b3a88b52SEtienne Carriere 	TEE_Result res = TEE_ERROR_ITEM_NOT_FOUND;
614b3a88b52SEtienne Carriere 	const struct dt_driver *dt_drv = NULL;
615b3a88b52SEtienne Carriere 	const struct dt_device_match *dm = NULL;
616b3a88b52SEtienne Carriere 	uint32_t found_types = 0;
617b3a88b52SEtienne Carriere 
618b3a88b52SEtienne Carriere 	for_each_dt_driver(dt_drv) {
619b3a88b52SEtienne Carriere 		for (dm = dt_drv->match_table; dm && dm->compatible; dm++) {
620b3a88b52SEtienne Carriere 			if (strcmp(dm->compatible, compat) == 0) {
621b3a88b52SEtienne Carriere 				assert(dt_drv->type < 32);
622b3a88b52SEtienne Carriere 
623b3a88b52SEtienne Carriere 				res = add_node_to_probe(fdt, node, dt_drv, dm);
624b3a88b52SEtienne Carriere 				if (res)
625b3a88b52SEtienne Carriere 					return res;
626b3a88b52SEtienne Carriere 
627b3a88b52SEtienne Carriere 				if (found_types & BIT(dt_drv->type)) {
628b3a88b52SEtienne Carriere 					EMSG("Driver %s multi hit on type %u",
629b3a88b52SEtienne Carriere 					     dt_drv->name, dt_drv->type);
630b3a88b52SEtienne Carriere 					panic();
631b3a88b52SEtienne Carriere 				}
632b3a88b52SEtienne Carriere 				found_types |= BIT(dt_drv->type);
633b3a88b52SEtienne Carriere 
634b3a88b52SEtienne Carriere 				/* Matching found for this driver, try next */
635b3a88b52SEtienne Carriere 				break;
636b3a88b52SEtienne Carriere 			}
637b3a88b52SEtienne Carriere 		}
638b3a88b52SEtienne Carriere 	}
639b3a88b52SEtienne Carriere 
640b3a88b52SEtienne Carriere 	return res;
641b3a88b52SEtienne Carriere }
642b3a88b52SEtienne Carriere 
643b3a88b52SEtienne Carriere /*
644b3a88b52SEtienne Carriere  * Add the node to the probe list if matching compatible drivers are found.
645b3a88b52SEtienne Carriere  * Follow node's compatible property list ordering to find matching driver.
646b3a88b52SEtienne Carriere  */
647b3a88b52SEtienne Carriere TEE_Result dt_driver_maybe_add_probe_node(const void *fdt, int node)
648b3a88b52SEtienne Carriere {
649b3a88b52SEtienne Carriere 	int idx = 0;
650b3a88b52SEtienne Carriere 	int len = 0;
651b3a88b52SEtienne Carriere 	int count = 0;
652b3a88b52SEtienne Carriere 	const char *compat = NULL;
653b3a88b52SEtienne Carriere 	TEE_Result res = TEE_ERROR_GENERIC;
654b3a88b52SEtienne Carriere 
655f354a5d8SGatien Chevallier 	if (fdt_get_status(fdt, node) == DT_STATUS_DISABLED)
656b3a88b52SEtienne Carriere 		return TEE_SUCCESS;
657b3a88b52SEtienne Carriere 
658b3a88b52SEtienne Carriere 	count = fdt_stringlist_count(fdt, node, "compatible");
659b3a88b52SEtienne Carriere 	if (count < 0)
660b3a88b52SEtienne Carriere 		return TEE_SUCCESS;
661b3a88b52SEtienne Carriere 
662b3a88b52SEtienne Carriere 	for (idx = 0; idx < count; idx++) {
663b3a88b52SEtienne Carriere 		compat = fdt_stringlist_get(fdt, node, "compatible", idx, &len);
664b3a88b52SEtienne Carriere 		assert(compat && len > 0);
665b3a88b52SEtienne Carriere 
666b3a88b52SEtienne Carriere 		res = add_probe_node_by_compat(fdt, node, compat);
667b3a88b52SEtienne Carriere 
668b3a88b52SEtienne Carriere 		/* Stop lookup if something was found */
669b3a88b52SEtienne Carriere 		if (res != TEE_ERROR_ITEM_NOT_FOUND)
670b3a88b52SEtienne Carriere 			return res;
671b3a88b52SEtienne Carriere 	}
672b3a88b52SEtienne Carriere 
673b3a88b52SEtienne Carriere 	return TEE_SUCCESS;
674b3a88b52SEtienne Carriere }
675b3a88b52SEtienne Carriere 
676b3a88b52SEtienne Carriere static void parse_node(const void *fdt, int node)
677b3a88b52SEtienne Carriere {
678b3a88b52SEtienne Carriere 	TEE_Result __maybe_unused res = TEE_ERROR_GENERIC;
679b3a88b52SEtienne Carriere 	int subnode = 0;
680b3a88b52SEtienne Carriere 
681b3a88b52SEtienne Carriere 	fdt_for_each_subnode(subnode, fdt, node) {
682b3a88b52SEtienne Carriere 		res = dt_driver_maybe_add_probe_node(fdt, subnode);
683b3a88b52SEtienne Carriere 		if (res) {
684b3a88b52SEtienne Carriere 			EMSG("Failed on node %s with %#"PRIx32,
685b3a88b52SEtienne Carriere 			     fdt_get_name(fdt, subnode, NULL), res);
686b3a88b52SEtienne Carriere 			panic();
687b3a88b52SEtienne Carriere 		}
688b3a88b52SEtienne Carriere 
689b3a88b52SEtienne Carriere 		/*
690b3a88b52SEtienne Carriere 		 * Rescursively parse the FDT, skipping disabled nodes.
691b3a88b52SEtienne Carriere 		 * FDT is expected reliable and core shall have sufficient
692b3a88b52SEtienne Carriere 		 * stack depth to possibly parse all DT nodes.
693b3a88b52SEtienne Carriere 		 */
694b3a88b52SEtienne Carriere 		if (IS_ENABLED(CFG_DRIVERS_DT_RECURSIVE_PROBE)) {
695f354a5d8SGatien Chevallier 			if (fdt_get_status(fdt, subnode) == DT_STATUS_DISABLED)
696b3a88b52SEtienne Carriere 				continue;
697b3a88b52SEtienne Carriere 
698b3a88b52SEtienne Carriere 			parse_node(fdt, subnode);
699b3a88b52SEtienne Carriere 		}
700b3a88b52SEtienne Carriere 	}
701b3a88b52SEtienne Carriere }
702b3a88b52SEtienne Carriere 
703b3a88b52SEtienne Carriere /*
704b3a88b52SEtienne Carriere  * Parse FDT for nodes and save in probe list the node for which a dt_driver
705b3a88b52SEtienne Carriere  * matches node's compatible property.
706b3a88b52SEtienne Carriere  */
707c9bd3375SEtienne Carriere static TEE_Result probe_dt_drivers_early(void)
708b3a88b52SEtienne Carriere {
709c9bd3375SEtienne Carriere 	TEE_Result res = TEE_ERROR_GENERIC;
710b3a88b52SEtienne Carriere 	const void *fdt = NULL;
711b3a88b52SEtienne Carriere 
712d2289450SVesa Jääskeläinen 	fdt = get_secure_dt();
713d2289450SVesa Jääskeläinen 	if (!fdt)
714b3a88b52SEtienne Carriere 		return TEE_SUCCESS;
715b3a88b52SEtienne Carriere 
716b3a88b52SEtienne Carriere 	parse_node(fdt, fdt_path_offset(fdt, "/"));
717b3a88b52SEtienne Carriere 
718c9bd3375SEtienne Carriere 	res = process_probe_list(fdt);
719c9bd3375SEtienne Carriere 	if (res == TEE_ERROR_DEFER_DRIVER_INIT) {
720c9bd3375SEtienne Carriere 		DMSG("Deferred drivers probing");
721c9bd3375SEtienne Carriere 		print_probe_list(fdt);
722c9bd3375SEtienne Carriere 		res = TEE_SUCCESS;
723b3a88b52SEtienne Carriere 	}
724b3a88b52SEtienne Carriere 
725c9bd3375SEtienne Carriere 	return res;
726c9bd3375SEtienne Carriere }
727c9bd3375SEtienne Carriere 
728c9bd3375SEtienne Carriere static TEE_Result probe_dt_drivers(void)
729c9bd3375SEtienne Carriere {
730c9bd3375SEtienne Carriere 	TEE_Result res = TEE_ERROR_GENERIC;
731c9bd3375SEtienne Carriere 	const void *fdt = NULL;
732c9bd3375SEtienne Carriere 
733d2289450SVesa Jääskeläinen 	fdt = get_secure_dt();
734d2289450SVesa Jääskeläinen 	if (!fdt)
735c9bd3375SEtienne Carriere 		return TEE_SUCCESS;
736c9bd3375SEtienne Carriere 
737c9bd3375SEtienne Carriere 	res = process_probe_list(fdt);
738c9bd3375SEtienne Carriere 	if (res || !TAILQ_EMPTY(&dt_driver_failed_list)) {
739c9bd3375SEtienne Carriere 		EMSG("Probe sequence result: %#"PRIx32, res);
740c9bd3375SEtienne Carriere 		print_probe_list(fdt);
741c9bd3375SEtienne Carriere 	}
742c9bd3375SEtienne Carriere 	if (res)
743c9bd3375SEtienne Carriere 		panic();
744c9bd3375SEtienne Carriere 
745c9bd3375SEtienne Carriere 	return TEE_SUCCESS;
746c9bd3375SEtienne Carriere }
747c9bd3375SEtienne Carriere 
748c9bd3375SEtienne Carriere early_init_late(probe_dt_drivers_early);
749b3a88b52SEtienne Carriere driver_init(probe_dt_drivers);
750ea29d587SEtienne Carriere 
751f21b3ed5SEtienne Carriere static TEE_Result release_probe_lists(void)
752f21b3ed5SEtienne Carriere {
753f21b3ed5SEtienne Carriere 	struct dt_driver_probe *elt = NULL;
754f21b3ed5SEtienne Carriere 	struct dt_driver_probe *next = NULL;
755115944b5SEtienne Carriere 	struct dt_driver_provider *prov = NULL;
756115944b5SEtienne Carriere 	struct dt_driver_provider *next_prov = NULL;
757d2289450SVesa Jääskeläinen 	const void *fdt = NULL;
758f21b3ed5SEtienne Carriere 
759d2289450SVesa Jääskeläinen 	fdt = get_secure_dt();
760d2289450SVesa Jääskeläinen 	if (!fdt)
761f21b3ed5SEtienne Carriere 		return TEE_SUCCESS;
762f21b3ed5SEtienne Carriere 
763f21b3ed5SEtienne Carriere 	assert(fdt && TAILQ_EMPTY(&dt_driver_probe_list));
764f21b3ed5SEtienne Carriere 
765115944b5SEtienne Carriere 	TAILQ_FOREACH_SAFE(elt, &dt_driver_ready_list, link, next)
766f21b3ed5SEtienne Carriere 		free(elt);
767115944b5SEtienne Carriere 
768736cb9e1SEtienne Carriere 	TAILQ_FOREACH_SAFE(elt, &dt_driver_failed_list, link, next)
769736cb9e1SEtienne Carriere 	       free(elt);
770736cb9e1SEtienne Carriere 
771115944b5SEtienne Carriere 	SLIST_FOREACH_SAFE(prov, &dt_driver_provider_list, link, next_prov)
772115944b5SEtienne Carriere 	       free(prov);
773f21b3ed5SEtienne Carriere 
774f21b3ed5SEtienne Carriere 	return TEE_SUCCESS;
775f21b3ed5SEtienne Carriere }
776f21b3ed5SEtienne Carriere 
777f21b3ed5SEtienne Carriere release_init_resource(release_probe_lists);
778f21b3ed5SEtienne Carriere 
779ea29d587SEtienne Carriere /*
780ea29d587SEtienne Carriere  * Simple bus support: handy to parse subnodes
781ea29d587SEtienne Carriere  */
782ea29d587SEtienne Carriere static TEE_Result simple_bus_probe(const void *fdt, int node,
783ea29d587SEtienne Carriere 				   const void *compat_data __unused)
784ea29d587SEtienne Carriere {
785ea29d587SEtienne Carriere 	TEE_Result res = TEE_ERROR_GENERIC;
786ea29d587SEtienne Carriere 	int subnode = 0;
787ea29d587SEtienne Carriere 
788ea29d587SEtienne Carriere 	fdt_for_each_subnode(subnode, fdt, node) {
789ea29d587SEtienne Carriere 		res = dt_driver_maybe_add_probe_node(fdt, subnode);
790ea29d587SEtienne Carriere 		if (res) {
791ea29d587SEtienne Carriere 			EMSG("Failed on node %s with %#"PRIx32,
792ea29d587SEtienne Carriere 			     fdt_get_name(fdt, subnode, NULL), res);
793ea29d587SEtienne Carriere 			panic();
794ea29d587SEtienne Carriere 		}
795ea29d587SEtienne Carriere 	}
796ea29d587SEtienne Carriere 
797ea29d587SEtienne Carriere 	return TEE_SUCCESS;
798ea29d587SEtienne Carriere }
799ea29d587SEtienne Carriere 
800ea29d587SEtienne Carriere static const struct dt_device_match simple_bus_match_table[] = {
801ea29d587SEtienne Carriere 	{ .compatible = "simple-bus" },
802ea29d587SEtienne Carriere 	{ }
803ea29d587SEtienne Carriere };
804ea29d587SEtienne Carriere 
80561bdedeaSJerome Forissier DEFINE_DT_DRIVER(simple_bus_dt_driver) = {
806ea29d587SEtienne Carriere 	.name = "simple-bus",
807ea29d587SEtienne Carriere 	.match_table = simple_bus_match_table,
808ea29d587SEtienne Carriere 	.probe = simple_bus_probe,
809ea29d587SEtienne Carriere };
810