From b00a9d7b5c8bcce3d08b663b467f0686dc2466d9 Mon Sep 17 00:00:00 2001 From: Steffen Trumtrar Date: Mon, 10 Jul 2017 12:33:52 +0200 Subject: efi: efi: load state from devicetree Signed-off-by: Steffen Trumtrar Signed-off-by: Lucas Stach --- common/efi/efi.c | 59 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 59 insertions(+) (limited to 'common/efi') diff --git a/common/efi/efi.c b/common/efi/efi.c index f924385958..3423c8acfe 100644 --- a/common/efi/efi.c +++ b/common/efi/efi.c @@ -40,6 +40,8 @@ #include #include #include +#include +#include efi_runtime_services_t *RT; efi_boot_services_t *BS; @@ -384,6 +386,63 @@ static int efi_postcore_init(void) } postcore_initcall(efi_postcore_init); +static int efi_late_init(void) +{ + char *state_desc; + int ret; + + if (!IS_ENABLED(CONFIG_STATE)) + return 0; + + state_desc = xasprintf("/boot/EFI/barebox/state.dtb"); + + if (state_desc) { + void *fdt; + size_t size; + struct device_node *root = NULL; + struct device_node *np = NULL; + struct state *state; + + fdt = read_file(state_desc, &size); + if (!fdt) { + pr_err("unable to read %s: %s\n", state_desc, + strerror(errno)); + return -errno; + } + + if (file_detect_type(fdt, size) != filetype_oftree) { + pr_err("%s is not an oftree file.\n", state_desc); + free(fdt); + return -EINVAL; + } + + root = of_unflatten_dtb(fdt); + + free(fdt); + + if (IS_ERR(root)) + return PTR_ERR(root); + + of_set_root_node(root); + + np = of_find_node_by_alias(root, "state"); + + state = state_new_from_node(np, NULL, 0, 0, false); + if (IS_ERR(state)) + return PTR_ERR(state); + + ret = state_load(state); + if (ret) + pr_warn("Failed to load persistent state, continuing with defaults, %d\n", + ret); + + return 0; + } + + return 0; +} +late_initcall(efi_late_init); + static int do_efiexit(int argc, char *argv[]) { return BS->exit(efi_parent_image, EFI_SUCCESS, 0, NULL); -- cgit v1.2.3