| 1 |
/* |
| 2 |
* Copyright (c) 2019-2022, Arm Limited. All rights reserved. |
| 3 |
* |
| 4 |
* SPDX-License-Identifier: BSD-3-Clause |
| 5 |
*/ |
| 6 |
|
| 7 |
#include <assert.h> |
| 8 |
|
| 9 |
#include <common/debug.h> |
| 10 |
#include <common/fdt_wrappers.h> |
| 11 |
#include <lib/fconf/fconf.h> |
| 12 |
#include <lib/fconf/fconf_dyn_cfg_getter.h> |
| 13 |
#include <libfdt.h> |
| 14 |
#include <plat/common/platform.h> |
| 15 |
#include <platform_def.h> |
| 16 |
|
| 17 |
int fconf_load_config(unsigned int image_id) |
| 18 |
{ |
| 19 |
int err; |
| 20 |
const struct dyn_cfg_dtb_info_t *config_info; |
| 21 |
|
| 22 |
assert((image_id == FW_CONFIG_ID) || (image_id == TB_FW_CONFIG_ID)); |
| 23 |
|
| 24 |
image_info_t config_image_info = { |
| 25 |
.h.type = (uint8_t)PARAM_IMAGE_BINARY, |
| 26 |
.h.version = (uint8_t)VERSION_2, |
| 27 |
.h.size = (uint16_t)sizeof(image_info_t), |
| 28 |
.h.attr = 0 |
| 29 |
}; |
| 30 |
|
| 31 |
config_info = FCONF_GET_PROPERTY(dyn_cfg, dtb, image_id); |
| 32 |
assert(config_info != NULL); |
| 33 |
|
| 34 |
config_image_info.image_base = config_info->config_addr; |
| 35 |
config_image_info.image_max_size = config_info->config_max_size; |
| 36 |
|
| 37 |
VERBOSE("FCONF: Loading config with image ID: %u\n", image_id); |
| 38 |
err = load_auth_image(image_id, &config_image_info); |
| 39 |
if (err != 0) { |
| 40 |
VERBOSE("Failed to load config %u\n", image_id); |
| 41 |
return err; |
| 42 |
} |
| 43 |
|
| 44 |
INFO("FCONF: Config file with image ID:%u loaded at address = 0x%lx\n", |
| 45 |
image_id, config_image_info.image_base); |
| 46 |
|
| 47 |
return 0; |
| 48 |
} |
| 49 |
|
| 50 |
void fconf_populate(const char *config_type, uintptr_t config) |
| 51 |
{ |
| 52 |
assert(config != 0UL); |
| 53 |
|
| 54 |
/* Check if the pointer to DTB is correct */ |
| 55 |
if (fdt_check_header((void *)config) != 0) { |
| 56 |
ERROR("FCONF: Invalid DTB file passed for %s\n", config_type); |
| 57 |
panic(); |
| 58 |
} |
| 59 |
|
| 60 |
INFO("FCONF: Reading %s firmware configuration file from: 0x%lx\n", config_type, config); |
| 61 |
|
| 62 |
/* Go through all registered populate functions */ |
| 63 |
IMPORT_SYM(struct fconf_populator *, __FCONF_POPULATOR_START__, start); |
| 64 |
IMPORT_SYM(struct fconf_populator *, __FCONF_POPULATOR_END__, end); |
| 65 |
const struct fconf_populator *populator; |
| 66 |
|
| 67 |
for (populator = start; populator != end; populator++) { |
| 68 |
assert((populator->info != NULL) && (populator->populate != NULL)); |
| 69 |
|
| 70 |
if (strcmp(populator->config_type, config_type) == 0) { |
| 71 |
INFO("FCONF: Reading firmware configuration information for: %s\n", populator->info); |
| 72 |
if (populator->populate(config) != 0) { |
| 73 |
/* TODO: handle property miss */ |
| 74 |
panic(); |
| 75 |
} |
| 76 |
} |
| 77 |
} |
| 78 |
} |