From bafb9c289a99292768f685191f2fdb7f7ef74e58 Mon Sep 17 00:00:00 2001
From: Martin Preuss <martin@aquamaniac.de>
Date: Sun, 5 Jul 2026 23:15:31 +0200
Subject: [PATCH] avr: fixed HW code for tn861.

---
 avr/devices/all/hw_tn861.asm | 13 ++++++++-----
 1 file changed, 8 insertions(+), 5 deletions(-)

diff --git a/avr/devices/all/hw_tn861.asm b/avr/devices/all/hw_tn861.asm
index e6cea14..7f0a2ce 100644
--- a/avr/devices/all/hw_tn861.asm
+++ b/avr/devices/all/hw_tn861.asm
@@ -72,8 +72,9 @@ systemSleep:
   ; only modify SE, SM1 and SM0
   cli
   in r16, MCUCR
-  cbr r16, (1<<SE) | (1<<SM1) | (1<<SM0)
-  out MCUCR, r16
+;  cbr r16, (1<<SE) | (1<<SM1) | (1<<SM0)
+;  out MCUCR, r16
+  cbr r16, (1<<SM1) | (1<<SM0)
   sbr r16, (1<<SE) | (0<<SM1) | (0<<SM0)  ; sleep mode "idle", enable
   out MCUCR, r16
   sei                        ; make sure interrupts really are enabled
@@ -125,10 +126,12 @@ systemSetupTimer0:            ; setup timer for IRQ every 100ms
 .endif
 
 
-  ldi r16, (1<<OCF0A)             ; clear pending interrupts
+  in r16, TIFR
+  sbr r16, (1<<OCF0A)             ; clear pending interrupts
   out TIFR, r16
-  
-  ldi r16, (1<<OCIE0A)            ; Timer/Counter0 Output Compare Match A Interrupt Enable
+
+  in r16, TIMSK
+  sbr r16, (1<<OCIE0A)            ; Timer/Counter0 Output Compare Match A Interrupt Enable
   out TIMSK, r16
  
   sec