summaryrefslogtreecommitdiff
path: root/src/arch/arm64/armv8
diff options
context:
space:
mode:
authorAaron Durbin <adurbin@chromium.org>2014-11-06 15:17:33 -0600
committerPatrick Georgi <pgeorgi@google.com>2015-04-10 12:01:24 +0200
commit6cdacb37f0e84666831d78f4bf9af2cbc30cbb81 (patch)
tree00b24a90e82dabeabe6f02efacb513ca2da425de /src/arch/arm64/armv8
parent1f4db4046f911b2ed586509de5d8e109b46a9485 (diff)
downloadcoreboot-6cdacb37f0e84666831d78f4bf9af2cbc30cbb81.tar.xz
arm64: secmon: add entry point for turned on CPUs
Newly turned on CPUs need a place to go bring its EL3 state inline with expectations. Plumb this path in for CPUs turning on as well as waking up from a power down state. Some of the infrastructure declarations were moved around for easier consumption in ramstage and secmon. Lastly, a psci_soc_init() is added to inform the SoC of the CPU's entry point as well do any initialization. BUG=chrome-os-partner:32112 BRANCH=None TEST=Built and booted. On entry point not actually utilized. Change-Id: I2af424c2906df159f78ed5e0a26a6bc0ba2ba24f Signed-off-by: Patrick Georgi <pgeorgi@chromium.org> Original-Commit-Id: dbefec678a111e8b42acf2ae162c1ccdd7f9fd40 Original-Change-Id: I7b8c8c828ffb73752ca3ac1117cd895a5aa275d8 Original-Signed-off-by: Aaron Durbin <adurbin@chromium.org> Original-Reviewed-on: https://chromium-review.googlesource.com/228296 Original-Reviewed-by: Furquan Shaikh <furquan@chromium.org> Reviewed-on: http://review.coreboot.org/9422 Reviewed-by: Stefan Reinauer <stefan.reinauer@coreboot.org> Tested-by: build bot (Jenkins)
Diffstat (limited to 'src/arch/arm64/armv8')
-rw-r--r--src/arch/arm64/armv8/secmon/Makefile.inc2
-rw-r--r--src/arch/arm64/armv8/secmon/psci.c11
-rw-r--r--src/arch/arm64/armv8/secmon/secmon_init.c94
3 files changed, 87 insertions, 20 deletions
diff --git a/src/arch/arm64/armv8/secmon/Makefile.inc b/src/arch/arm64/armv8/secmon/Makefile.inc
index 1b774ff7df..5284d39f39 100644
--- a/src/arch/arm64/armv8/secmon/Makefile.inc
+++ b/src/arch/arm64/armv8/secmon/Makefile.inc
@@ -34,6 +34,8 @@ secmon-y += secmon_init.c
secmon-y += psci.c
secmon-y += smc.c
secmon-y += trampoline.S
+secmon-y += ../cache.c
+secmon-y += ../cpu.S
secmon-y += ../exception.c
secmon-y += ../../cpu.c
secmon-y += ../../transition_asm.S ../../transition.c
diff --git a/src/arch/arm64/armv8/secmon/psci.c b/src/arch/arm64/armv8/secmon/psci.c
index f87419dda8..93c5bddcb9 100644
--- a/src/arch/arm64/armv8/secmon/psci.c
+++ b/src/arch/arm64/armv8/secmon/psci.c
@@ -220,6 +220,15 @@ void psci_turn_on_self(const struct cpu_action *action)
psci_schedule_cpu_on(e);
}
+void psci_cpu_entry(void)
+{
+ /*
+ * Just wait for an action to be performed. Only CPU_ON is supported
+ * initially. i.e. no power down then wake.
+ */
+ secmon_wait_for_action();
+}
+
static void psci_cpu_on(struct psci_func *pf)
{
uint64_t entry;
@@ -483,7 +492,7 @@ static int psci_allocate_nodes(void)
return 0;
}
-void psci_init(void)
+void psci_init(uintptr_t cpu_on_entry)
{
struct cpu_action action = {
.run = &psci_link_cpu_info,
diff --git a/src/arch/arm64/armv8/secmon/secmon_init.c b/src/arch/arm64/armv8/secmon/secmon_init.c
index 3405027f2f..63bd4907d9 100644
--- a/src/arch/arm64/armv8/secmon/secmon_init.c
+++ b/src/arch/arm64/armv8/secmon/secmon_init.c
@@ -20,6 +20,7 @@
*/
#include <arch/barrier.h>
+#include <arch/cache.h>
#include <arch/io.h>
#include <arch/exception.h>
#include <arch/lib_helpers.h>
@@ -30,6 +31,74 @@
#include <stddef.h>
#include "secmon.h"
+/* Common CPU state for all CPUs running in secmon. */
+struct cpu_resume_data {
+ uint64_t mair;
+ uint64_t tcr;
+ uint64_t ttbr0;
+ uint64_t scr;
+};
+
+static struct cpu_resume_data resume_data;
+
+static void secmon_init(struct secmon_params *params, int bsp);
+
+static void secmon_init_bsp(void *arg)
+{
+ secmon_init(arg, 1);
+}
+
+static void secmon_init_nonbsp(void *arg)
+{
+ secmon_init(arg, 0);
+}
+
+/*
+ * This variable holds entry point for secmon init code. Once the stacks are
+ * setup by the stage_entry.S, it jumps to c_entry.
+ */
+void (*c_entry[2])(void *) = { &secmon_init_bsp, &secmon_init_nonbsp };
+
+static void cpu_resume(void *unused)
+{
+ uint32_t sctlr;
+
+ /* Re-enable exception vector. */
+ exception_hwinit();
+
+ tlbiall_el3();
+ raw_write_mair_el3(resume_data.mair);
+ raw_write_tcr_el3(resume_data.tcr);
+ raw_write_ttbr0_el3(resume_data.ttbr0);
+ dsb();
+ isb();
+
+ /* Enable MMU */
+ sctlr = raw_read_sctlr_el3();
+ sctlr |= SCTLR_C | SCTLR_M | SCTLR_I;
+ raw_write_sctlr_el3(sctlr);
+ isb();
+
+ raw_write_scr_el3(resume_data.scr);
+ isb();
+
+ psci_cpu_entry();
+}
+
+static void cpu_resume_init(void)
+{
+ /* Change entry points into secmon. */
+ c_entry[0] = c_entry[1] = cpu_resume;
+ dcache_clean_by_mva(&c_entry, sizeof(c_entry));
+
+ /* Back up state. */
+ resume_data.mair = raw_read_mair_el3();
+ resume_data.tcr = raw_read_tcr_el3();
+ resume_data.ttbr0 = raw_read_ttbr0_el3();
+ resume_data.scr = raw_read_scr_el3();
+ dcache_clean_by_mva(&resume_data, sizeof(resume_data));
+}
+
static void start_up_cpu(void *arg)
{
struct secmon_params *params = arg;
@@ -81,7 +150,10 @@ static void secmon_init(struct secmon_params *params, int bsp)
wait_for_all_cpus(params->online_cpus);
smc_init();
- psci_init();
+ psci_init((uintptr_t)arm64_cpu_startup);
+
+ /* Initialize the resume path. */
+ cpu_resume_init();
/* Make sure all non-BSP CPUs take action before the BSP. */
arch_run_on_all_cpus_but_self_async(&action);
@@ -89,27 +161,11 @@ static void secmon_init(struct secmon_params *params, int bsp)
start_up_cpu(params);
printk(BIOS_ERR, "CPU turn on failed for BSP.\n");
- while (1)
- ;
+
+ secmon_wait_for_action();
}
void secmon_wait_for_action(void)
{
arch_cpu_wait_for_action();
}
-
-static void secmon_init_bsp(void *arg)
-{
- secmon_init(arg, 1);
-}
-
-static void secmon_init_nonbsp(void *arg)
-{
- secmon_init(arg, 0);
-}
-
-/*
- * This variable holds entry point for secmon init code. Once the stacks are
- * setup by the stage_entry.S, it jumps to c_entry.
- */
-void (*c_entry[2])(void*) = { &secmon_init_bsp, &secmon_init_nonbsp };