wip: some packets are being exchanged, after about 3 packets they fail (WDT)

1 files changed, 8 insertions, 0 deletions

diff --git a/util.c b/util.c
index ddfdf04..fa208a5 100644
--- a/util.c
+++ b/util.c
@@ -8,3 +8,11 @@ void wdt_init(void)
 	WDTCSR |= (1 << WDCE) | (1 << WDE);
 	WDTCSR = (1 << WDE) | (1 << WDP3) | (1 << WDP0);
 }
+
+void wdt_stop(void)
+{
+	wdt_reset();
+	MCUSR &= ~(1<<WDRF);
+	WDTCSR |= (1<<WDCE) | (1<<WDE);
+	WDTCSR = 0x00;
+}