1 files changed, 42 insertions, 0 deletions
diff --git a/board/kontron/sl28/psci.c b/board/kontron/sl28/psci.c
new file mode 100644
index 00000000000..19f0ef3b6df
--- /dev/null
+++ b/board/kontron/sl28/psci.c
@@ -0,0 +1,42 @@
+// SPDX-License-Identifier: GPL-2.0+
+
+#include <asm/secure.h>
+#include <asm/psci.h>
+#include <asm/types.h>
+#include <asm/io.h>
+#include <asm/system.h>
+
+#define GPIO2_GPDIR	0x2310000
+#define GPIO2_GPDAT	0x2310008
+#define RSTCR		0x1e60000
+#define RESET_REQ	BIT(1)
+
+u32 __secure psci_version(void)
+{
+	return ARM_PSCI_VER_0_2;
+}
+
+void __secure psci_system_reset(void)
+{
+	writel(RESET_REQ, RSTCR);
+
+	while (1)
+		wfi();
+}
+
+void __secure psci_system_off(void)
+{
+	int i;
+
+	writel(0x02000000, GPIO2_GPDIR);
+	writel(0, GPIO2_GPDAT);
+
+	/* make sure the management controller has sampled the input */
+	for (i = 0; i < (1 << 11); i++)
+		asm("nop");
+
+	writel(RESET_REQ, RSTCR);
+
+	while (1)
+		wfi();
+}