lpc176x: Enable watchdog

Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
Klipper3d · May 25, 2018 · 65613ae · 65613ae
1 parent 83d3c17
commit 65613ae
Showing 1 changed file with 23 additions and 0 deletions.
diff --git a/src/lpc176x/main.c b/src/lpc176x/main.c
@@ -11,6 +11,29 @@
 DECL_CONSTANT(MCU, "lpc176x");
 
 
+/****************************************************************
+ * watchdog handler
+ ****************************************************************/
+
+void
+watchdog_reset(void)
+{
+    LPC_WDT->WDFEED = 0xaa;
+    LPC_WDT->WDFEED = 0x55;
+}
+DECL_TASK(watchdog_reset);
+
+void
+watchdog_init(void)
+{
+    LPC_WDT->WDTC = 4000000 / 2; // 500ms timeout
+    LPC_WDT->WDCLKSEL = 1<<31; // Lock to internal RC
+    LPC_WDT->WDMOD = 0x03; // select reset and enable
+    watchdog_reset();
+}
+DECL_INIT(watchdog_init);
+
+
 /****************************************************************
  * misc functions
  ****************************************************************/