com2w: work in COM2W_Run, not in COM2W_Every100ms

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: