From 7efaf720cce1f509dbf5ecf02fc9cd63b03481f0 Mon Sep 17 00:00:00 2001
From: Martin Preuss <martin@aquamaniac.de>
Date: Mon, 25 Aug 2025 10:20:13 +0200
Subject: [PATCH] com2w: work in  COM2W_Run, not in COM2W_Every100ms

---
 avr/modules/com2w/com2w.asm | 29 ++++++++++++++++++++++++++++-
 1 file changed, 28 insertions(+), 1 deletion(-)

diff --git a/avr/modules/com2w/com2w.asm b/avr/modules/com2w/com2w.asm
index 56530ad..a71e181 100644
--- a/avr/modules/com2w/com2w.asm
+++ b/avr/modules/com2w/com2w.asm
@@ -116,7 +116,6 @@ COM2W_Every100ms:
     in r15, SREG
     cli
     rcall NET_Interface_Periodically         ; (R16)
-    rcall com2wSendNextPkg
     out SREG, r15
   pop r15
   ret
@@ -124,6 +123,31 @@ COM2W_Every100ms:
 
 
 
+; ---------------------------------------------------------------------------
+; @routine COM2W_Run @global
+;
+; @clobbers (R16, R17, R18, R20, R22, R24, R25, X)
+
+COM2W_Run:
+  push r15
+    in r15, SREG
+    cli
+    ldi yl, LOW(com2w_iface)
+    ldi yh, HIGH(com2w_iface)
+    rcall com2wSendNextPkg     ; (R16, R17, R18, R20, R22, R24, R25, X)
+    brcs COM2W_Run_ok
+  pop r15
+  clc
+  rjmp COM2W_Run_ret
+COM2W_Run_ok:
+  pop r15
+  sec
+COM2W_Run_ret:
+  ret
+; @end
+
+
+
 ; ---------------------------------------------------------------------------
 ; @routine com2wReceiveNextPkg
 ;
@@ -182,6 +206,9 @@ com2wReceiveNextPkg_copyLoop:
   brcc com2wReceiveNextPkg_eMissed
   ldi r16, NET_IFACE_OFFS_PACKETSIN_LOW
   rcall NET_Interface_IncCounter16                ; (R24, R25)
+#ifdef MODULES_LED_ACTIVITY
+  rcall LedActivity_Trigger                       ; (r16)
+#endif
   sec
   rjmp com2wReceiveNextPkg_end
 com2wReceiveNextPkg_eCrc: