aboutsummaryrefslogtreecommitdiff
path: root/amforth-6.5/avr8/devices/atmega2561/words/no-wdt.asm
diff options
context:
space:
mode:
Diffstat (limited to 'amforth-6.5/avr8/devices/atmega2561/words/no-wdt.asm')
-rw-r--r--amforth-6.5/avr8/devices/atmega2561/words/no-wdt.asm34
1 files changed, 34 insertions, 0 deletions
diff --git a/amforth-6.5/avr8/devices/atmega2561/words/no-wdt.asm b/amforth-6.5/avr8/devices/atmega2561/words/no-wdt.asm
new file mode 100644
index 0000000..ff6ddd1
--- /dev/null
+++ b/amforth-6.5/avr8/devices/atmega2561/words/no-wdt.asm
@@ -0,0 +1,34 @@
+; ( -- )
+; MCU
+; disable watch dog timer at runtime
+VE_NOWDT:
+ .dw $ff04
+ .db "-wdt"
+ .dw VE_HEAD
+ .set VE_HEAD = VE_NOWDT
+XT_NOWDT:
+ .dw PFA_NOWDT
+PFA_NOWDT:
+
+ in temp1,SREG
+ push temp1
+ ; Turn always off global interrupt.
+ cli
+ ; Reset Watchdog Timer
+ wdr
+ ; Clear WDRF in MCUSR
+ in temp1, MCUSR
+ andi temp1, (0xff & (0<<WDRF))
+ out MCUSR, temp1
+ ; Write logical one to WDCE and WDE
+ ; Keep old prescaler setting to prevent unintentional time-out
+ in_ temp1, WDTCSR
+ ori temp1, (1<<WDCE) | (1<<WDE)
+ out_ WDTCSR, temp1
+ ; Turn off WDT
+ ldi temp1, (0<<WDE)
+ out_ WDTCSR, temp1
+ ; restore status register
+ pop temp1
+ out SREG,temp1
+ jmp_ DO_NEXT