From 897a368c76faec502227e048de966bcbc9df4079 Mon Sep 17 00:00:00 2001
From: ModuloFS <ModuloFS@freenet.de>
Date: Sun, 29 Oct 2023 11:43:12 +0100
Subject: [PATCH] changed readAInputs() to non blocking code

---
 LinuxCNC_ArduinoConnector.ino | 26 ++++++++++++++++++--------
 1 file changed, 18 insertions(+), 8 deletions(-)

diff --git a/LinuxCNC_ArduinoConnector.ino b/LinuxCNC_ArduinoConnector.ino
index 00d1db4..519a734 100644
--- a/LinuxCNC_ArduinoConnector.ino
+++ b/LinuxCNC_ArduinoConnector.ino
@@ -334,6 +334,7 @@ const int debounceDelay = 50;
 #endif
 #ifdef AINPUTS
   int oldAinput[AInputs];
+  unsigned long sumAinput[AInputs];
 #endif
 #ifdef LPOTIS
   int Lpoti[LPotis];
@@ -420,6 +421,7 @@ void setup() {
   for(int i= 0; i<AInputs;i++){
     pinMode(AInPinmap[i], INPUT);
     oldAinput[i] = -1;
+    sumAinput[i] = 0;
     }
 #endif
 #ifdef OUTPUTS
@@ -662,6 +664,7 @@ void reconnect(){
   #ifdef AINPUTS
     for (int x = 0; x < AInputs; x++){
       oldAinput[x] = -1;
+      sumAinput[x] = 0;
     }
   #endif
   #ifdef LPOTIS
@@ -809,19 +812,26 @@ void readLPoti(){
 
 #ifdef AINPUTS
 void readAInputs(){
-  unsigned long var = 0;
-  
+  static unsigned int samplecount = 0;
+    
    for(int i= 0;i<AInputs; i++){
 
-      for(int d= 0;d<smooth; d++){// take couple samples to denoise signal
-        var = var+ analogRead(AInPinmap[i]);
-      }
-      var = var / smooth;
-      if(oldAinput[i]!= var){
-        oldAinput[i] = var;
+    if (samplecount < smooth) {
+      sumAinput[i] = sumAinput[i] + analogRead(AInPinmap[i]);
+    }
+    else {
+      sumAinput[i] = sumAinput[i] / smooth;
+      if(oldAinput[i]!= sumAinput[i]){
+        oldAinput[i] = sumAinput[i];
         sendData('A',AInPinmap[i],oldAinput[i]);
       }
+      sumAinput[i] = 0;
     }
+   }
+
+  if(samplecount < smooth){ samplecount = samplecount + 1;}
+  else {samplecount = 0;}
+
 }
 #endif
 #ifdef INPUTS