From: Jules Maselbas <jmaselbas@xxxxxxxxx>
Add support for a watchdog that starts as early as possible in barebox.
So, if there is an issue the board is reset properly.
Signed-off-by: Julian Vetter <jvetter@xxxxxxxxxxxxx>
---
drivers/watchdog/Kconfig | 13 +++++++++++++
drivers/watchdog/kvx_wdt.c | 16 ++++++++++++++++
2 files changed, 29 insertions(+)
diff --git a/drivers/watchdog/Kconfig b/drivers/watchdog/Kconfig
index 762e37c9c2..b1924b5b05 100644
--- a/drivers/watchdog/Kconfig
+++ b/drivers/watchdog/Kconfig
@@ -89,6 +89,19 @@ config WATCHDOG_KVX
help
Add support for the KVX core watchdog.
+if WATCHDOG_KVX
+config WATCHDOG_KVX_EARLY_INIT
+ bool "KVX Core watchdog early init"
+ depends on WATCHDOG_KVX
+ help
+ Activate the watchdog with early initcall
+
+config WATCHDOG_KVX_EARLY_TIMEOUT
+ int "KVX Core watchdog early timeout in cycles"
+ depends on WATCHDOG_KVX_EARLY_INIT
+ default 100000000
+endif
+
config WATCHDOG_BCM2835
bool "Watchdog for BCM283x SoCs"
depends on ARCH_BCM283X || COMPILE_TEST
diff --git a/drivers/watchdog/kvx_wdt.c b/drivers/watchdog/kvx_wdt.c
index be6b08b71c..3e66aa38ba 100644
--- a/drivers/watchdog/kvx_wdt.c
+++ b/drivers/watchdog/kvx_wdt.c
@@ -91,3 +91,19 @@ static struct driver kvx_wdt_driver = {
.of_compatible = DRV_OF_COMPAT(kvx_wdt_of_match),
};
device_platform_driver(kvx_wdt_driver);
+
+#ifdef CONFIG_WATCHDOG_KVX_EARLY_INIT
+static int kvx_wdt_early_init(void)
+{
+ /* Set Start watchdog counting */
+ kvx_sfr_set(WDV, CONFIG_WATCHDOG_KVX_EARLY_TIMEOUT);
+ kvx_sfr_set(WDR, 0);
+
+ /* Start watchdog counting */
+ kvx_sfr_set_field(TCR, WUI, 1);
+ kvx_sfr_set_field(TCR, WCE, 1);
+
+ return 0;
+}
+core_initcall(kvx_wdt_early_init);
+#endif
--
2.34.1
