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