sysreset: socfpga: gen5: add sysreset driver

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

diff --git a/drivers/sysreset/sysreset_socfpga.c b/drivers/sysreset/sysreset_socfpga.c
new file mode 100644 (file)
index 0000000..d6c26a5
--- /dev/null
+++ b/drivers/sysreset/sysreset_socfpga.c
@@ -0,0 +1,56 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (C) 2019 Pepperl+Fuchs
+ * Simon Goldschmidt <simon.k.r.goldschmidt@gmail.com>
+ */
+
+#include <common.h>
+#include <dm.h>
+#include <errno.h>
+#include <sysreset.h>
+#include <asm/io.h>
+#include <asm/arch/reset_manager.h>
+
+struct socfpga_sysreset_data {
+       struct socfpga_reset_manager *rstmgr_base;
+};
+
+static int socfpga_sysreset_request(struct udevice *dev,
+                                   enum sysreset_t type)
+{
+       struct socfpga_sysreset_data *data = dev_get_priv(dev);
+
+       switch (type) {
+       case SYSRESET_WARM:
+               writel(BIT(RSTMGR_CTRL_SWWARMRSTREQ_LSB),
+                      &data->rstmgr_base->ctrl);
+               break;
+       case SYSRESET_COLD:
+               writel(BIT(RSTMGR_CTRL_SWCOLDRSTREQ_LSB),
+                      &data->rstmgr_base->ctrl);
+               break;
+       default:
+               return -EPROTONOSUPPORT;
+       }
+       return -EINPROGRESS;
+}
+
+static int socfpga_sysreset_probe(struct udevice *dev)
+{
+       struct socfpga_sysreset_data *data = dev_get_priv(dev);
+
+       data->rstmgr_base = devfdt_get_addr_ptr(dev);
+       return 0;
+}
+
+static struct sysreset_ops socfpga_sysreset = {
+       .request = socfpga_sysreset_request,
+};
+
+U_BOOT_DRIVER(sysreset_socfpga) = {
+       .id     = UCLASS_SYSRESET,
+       .name   = "socfpga_sysreset",
+       .priv_auto_alloc_size = sizeof(struct socfpga_sysreset_data),
+       .ops    = &socfpga_sysreset,
+       .probe  = socfpga_sysreset_probe,
+};