From 1893d50908470593d68c35ea3aebe399fc00a841 Mon Sep 17 00:00:00 2001
From: Martin Preuss <martin@aquamaniac.de>
Date: Sat, 22 Apr 2023 16:38:03 +0200
Subject: [PATCH] avr: minor changes to watchdogOn (not used, yet).

---
 avr/common/watchdog.asm | 10 ++++++++--
 1 file changed, 8 insertions(+), 2 deletions(-)

diff --git a/avr/common/watchdog.asm b/avr/common/watchdog.asm
index 1398b83..26616c6 100644
--- a/avr/common/watchdog.asm
+++ b/avr/common/watchdog.asm
@@ -17,8 +17,11 @@
 
 
 watchdogOn:
-  in r16, WDTCSR
-  ori r16, (1<<WDE) | (1<<WDP0) ; about 32ms period
+  ldi r16, (1<<WDE) | (1<<WDP0) ; about 32ms period
+  out WDTCSR, r16
+  ldi r16, (1<<WDP0) ; about 32ms period
+  out WDTCSR, r16
+  ori r16, (1<<WDE)
   out WDTCSR, r16
   ret
 
@@ -26,6 +29,9 @@ watchdogOn:
 
 watchdogOff:
   wdr                   ; reset WDT
+  ldi r16, (0<<WDRF)    ; clear WDRF bit in MCUSR
+  out MCUSR, r16
+
   in  r16, WDTCSR
   ori r16, (1<<WDCE)|(1<<WDE)
   push r15