In cases where firmware provides PSCI >0.1, it may be prudent to use it as
backend for reset and poweroff. This driver accomplishes this.
Signed-off-by: Ahmad Fatoum <a.fatoum@xxxxxxxxxxxxxx>
---
drivers/misc/Kconfig | 5 +++
drivers/misc/Makefile | 1 +
drivers/misc/psci-sysreset.c | 62 ++++++++++++++++++++++++++++++++++++
3 files changed, 68 insertions(+)
create mode 100644 drivers/misc/psci-sysreset.c
diff --git a/drivers/misc/Kconfig b/drivers/misc/Kconfig
index 0f736f8bded3..0412fcf02aa3 100644
--- a/drivers/misc/Kconfig
+++ b/drivers/misc/Kconfig
@@ -35,4 +35,9 @@ config UBOOTVAR
While it can be used standalone, it is best when coupled
with corresponding filesystem driver.
+config PSCI_SYSRESET
+ bool "PSCI system reset driver"
+ select ARM_PSCI_CLIENT
+ depends on CPU_32v7 || CPU_64v8
+
endmenu
diff --git a/drivers/misc/Makefile b/drivers/misc/Makefile
index bc1c01ea4d67..0ad158b16d1b 100644
--- a/drivers/misc/Makefile
+++ b/drivers/misc/Makefile
@@ -7,3 +7,4 @@ obj-$(CONFIG_SRAM) += sram.o
obj-$(CONFIG_STATE_DRV) += state.o
obj-$(CONFIG_DEV_MEM) += mem.o
obj-$(CONFIG_UBOOTVAR) += ubootvar.o
+obj-$(CONFIG_PSCI_SYSRESET) += psci-sysreset.o
diff --git a/drivers/misc/psci-sysreset.c b/drivers/misc/psci-sysreset.c
new file mode 100644
index 000000000000..d05cbc76f259
--- /dev/null
+++ b/drivers/misc/psci-sysreset.c
@@ -0,0 +1,62 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (C) 2017 Masahiro Yamada <yamada.masahiro@xxxxxxxxxxxxx>
+ * Copyright (C) 2019 Ahmad Fatoum, Pengutronix
+ */
+
+#define pr_fmt(fmt) "psci-sysreset: " fmt
+
+#include <common.h>
+#include <init.h>
+#include <driver.h>
+#include <asm/psci.h>
+#include <poweroff.h>
+#include <restart.h>
+
+static struct restart_handler restart;
+
+static void __noreturn psci_invoke_noreturn(int function)
+{
+ int ret;
+
+ ret = psci_invoke(function, 0, 0, 0, NULL);
+
+ pr_err("psci command failed: %s\n", strerror(-ret));
+ hang();
+}
+
+static void __noreturn psci_poweroff(struct poweroff_handler *handler)
+{
+ psci_invoke_noreturn(ARM_PSCI_0_2_FN_SYSTEM_OFF);
+}
+
+static void __noreturn psci_restart(struct restart_handler *rst)
+{
+ psci_invoke_noreturn(ARM_PSCI_0_2_FN_SYSTEM_RESET);
+}
+
+static int __init psci_sysreset_init(void)
+{
+ int version;
+ int ret;
+
+ version = psci_get_version();
+ if (version < 0)
+ return version;
+
+ if (version < ARM_PSCI_VER(0,2)) {
+ pr_debug("Incompatible PSCI version: not registering reset handler\n");
+ return 0;
+ }
+
+ ret = poweroff_handler_register_fn(psci_poweroff);
+ if (ret)
+ return ret;
+
+ restart.name = "psci";
+ restart.restart = psci_restart;
+ restart.priority = 400;
+
+ return restart_handler_register(&restart);
+}
+device_initcall(psci_sysreset_init);
--
2.24.0.rc1
_______________________________________________
barebox mailing list
barebox@xxxxxxxxxxxxxxxxxxx
http://lists.infradead.org/mailman/listinfo/barebox
