sysreset: psci: support system reset in a generic way with PSCI

[oweals/u-boot.git] / drivers / sysreset / sysreset_psci.c

diff --git a/drivers/sysreset/sysreset_psci.c b/drivers/sysreset/sysreset_psci.c
new file mode 100644 (file)
index 0000000..a4911b7
--- /dev/null
+++ b/drivers/sysreset/sysreset_psci.c
@@ -0,0 +1,41 @@
+/*
+ * Copyright (C) 2017 Masahiro Yamada <yamada.masahiro@socionext.com>
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+#include <dm/device.h>
+#include <sysreset.h>
+#include <linux/errno.h>
+#include <linux/psci.h>
+
+static int psci_sysreset_request(struct udevice *dev, enum sysreset_t type)
+{
+       unsigned long function_id;
+
+       switch (type) {
+       case SYSRESET_WARM:
+       case SYSRESET_COLD:
+               function_id = PSCI_0_2_FN_SYSTEM_RESET;
+               break;
+       case SYSRESET_POWER:
+               function_id = PSCI_0_2_FN_SYSTEM_OFF;
+               break;
+       default:
+               return -ENOSYS;
+       }
+
+       invoke_psci_fn(function_id, 0, 0, 0);
+
+       return -EINPROGRESS;
+}
+
+static struct sysreset_ops psci_sysreset_ops = {
+       .request = psci_sysreset_request,
+};
+
+U_BOOT_DRIVER(psci_sysreset) = {
+       .name = "psci-sysreset",
+       .id = UCLASS_SYSRESET,
+       .ops = &psci_sysreset_ops,
+};