From 32f5ba852014de38b3cd6abdbe9694478dad3ed6 Mon Sep 17 00:00:00 2001
From: iceman1001 <iceman@iuse.se>
Date: Sun, 9 Jun 2019 08:15:31 -0400
Subject: [PATCH] fix: drifting

---
 armsrc/lfsampling.c | 15 +++++++++++++--
 1 file changed, 13 insertions(+), 2 deletions(-)

diff --git a/armsrc/lfsampling.c b/armsrc/lfsampling.c
index aca064ecc..fb52411d4 100644
--- a/armsrc/lfsampling.c
+++ b/armsrc/lfsampling.c
@@ -136,8 +136,19 @@ uint32_t DoAcquisition(uint8_t decimation, uint32_t bits_per_sample, bool averag
     uint32_t sample_total_numbers = 0;
     uint32_t sample_total_saved = 0;
     uint32_t cancel_counter = 0;
-
-    while (!BUTTON_PRESS() && !data_available()) {
+    
+    uint16_t checker=0;
+  
+    while (true) {
+        if ( checker == 1000 ) {
+            if (BUTTON_PRESS() || data_available())
+                break;
+            else
+                checker = 0;
+        } else {
+            ++checker;
+        }
+    
         WDT_HIT();
 
         if (AT91C_BASE_SSC->SSC_SR & AT91C_SSC_RXRDY) {