diff --git a/src/arch/arm64/armv8/secmon/secmon_init.c b/src/arch/arm64/armv8/secmon/secmon_init.c index fb3422f48b..8fd39176f8 100644 --- a/src/arch/arm64/armv8/secmon/secmon_init.c +++ b/src/arch/arm64/armv8/secmon/secmon_init.c @@ -30,16 +30,21 @@ #include #include "secmon.h" -/* Save initial secmon params per CPU to handle turn up. */ -static struct secmon_params *init_params[CONFIG_MAX_CPUS]; - static void start_up_cpu(void *arg) { - struct secmon_params *params = init_params[cpu_info()->id]; + struct secmon_params *params = arg; + struct cpu_action *action; - if (params == NULL) + if (cpu_is_bsp()) + action = ¶ms->bsp; + else + action = ¶ms->secondary; + + + if (action->run == NULL) psci_turn_off_self(); - psci_turn_on_self(params->entry, params->arg); + + psci_turn_on_self(action->run, action->arg); } static void cpu_init(int bsp) @@ -75,13 +80,12 @@ static void secmon_init(struct secmon_params *params, int bsp) { struct cpu_action action = { .run = start_up_cpu, + .arg = params, }; exception_hwinit(); cpu_init(bsp); - init_params[cpu_info()->id] = params; - if (!cpu_is_bsp()) secmon_wait_for_action(); @@ -94,7 +98,7 @@ static void secmon_init(struct secmon_params *params, int bsp) /* Make sure all non-BSP CPUs take action before the BSP. */ arch_run_on_all_cpus_but_self_async(&action); /* Turn on BSP. */ - start_up_cpu(NULL); + start_up_cpu(params); printk(BIOS_ERR, "CPU turn on failed for BSP.\n"); while (1) diff --git a/src/arch/arm64/armv8/secmon_loader.c b/src/arch/arm64/armv8/secmon_loader.c index 00982289ef..59a6ba7e6d 100644 --- a/src/arch/arm64/armv8/secmon_loader.c +++ b/src/arch/arm64/armv8/secmon_loader.c @@ -79,26 +79,22 @@ static secmon_entry_t secmon_load_rmodule(void) struct secmon_runit { secmon_entry_t entry; - struct secmon_params bsp_params; - struct secmon_params secondary_params; + struct secmon_params params; }; static void secmon_start(void *arg) { uint32_t scr; secmon_entry_t entry; - struct secmon_params *p = NULL; + struct secmon_params *p; struct secmon_runit *r = arg; entry = r->entry; + p = &r->params; - if (cpu_is_bsp()) - p = &r->bsp_params; - else { + /* Obtain secondary entry point for non-BSP CPUs. */ + if (!cpu_is_bsp()) entry = secondary_entry_point(entry); - if (r->secondary_params.entry != NULL) - p = &r->secondary_params; - } printk(BIOS_DEBUG, "CPU%x entering secure monitor %p.\n", cpu_info()->id, entry); @@ -113,9 +109,26 @@ static void secmon_start(void *arg) entry(p); } -void secmon_run(void (*entry)(void *), void *cb_tables) +static void fill_secmon_params(struct secmon_params *p, + void (*bsp_entry)(void *), void *bsp_arg) { const struct spintable_attributes *spin_attrs; + + memset(p, 0, sizeof(*p)); + + spin_attrs = spintable_get_attributes(); + + if (spin_attrs != NULL) { + p->secondary.run = spin_attrs->entry; + p->secondary.arg = spin_attrs->addr; + } + + p->bsp.run = bsp_entry; + p->bsp.arg = bsp_arg; +} + +void secmon_run(void (*entry)(void *), void *cb_tables) +{ static struct secmon_runit runit; struct cpu_action action = { .run = secmon_start, @@ -137,15 +150,7 @@ void secmon_run(void (*entry)(void *), void *cb_tables) printk(BIOS_DEBUG, "ARM64: Loaded the el3 monitor...jumping to %p\n", runit.entry); - runit.bsp_params.entry = entry; - runit.bsp_params.arg = cb_tables; - - spin_attrs = spintable_get_attributes(); - - if (spin_attrs != NULL) { - runit.secondary_params.entry = spin_attrs->entry; - runit.secondary_params.arg = spin_attrs->addr; - } + fill_secmon_params(&runit.params, entry, cb_tables); arch_run_on_all_cpus_but_self_async(&action); secmon_start(&runit); diff --git a/src/arch/arm64/include/armv8/arch/secmon.h b/src/arch/arm64/include/armv8/arch/secmon.h index 12dd8c4334..dc4b2e06ce 100644 --- a/src/arch/arm64/include/armv8/arch/secmon.h +++ b/src/arch/arm64/include/armv8/arch/secmon.h @@ -25,8 +25,8 @@ #if IS_ENABLED(CONFIG_ARCH_USE_SECURE_MONITOR) struct secmon_params { - void (*entry)(void *); - void *arg; + struct cpu_action bsp; + struct cpu_action secondary; }; void secmon_run(void (*entry)(void *), void *arg);