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