SkyTEM BMAG / Mbed 2 deprecated BMAGThrRev

Bmag incl gps rettelse

Dependencies:   mbed WDT MODSERIAL BME280

Diff: NMEA/NMEA.cpp

Branch:
MbedBMAGThrRev
Revision:
34:c6c5e7ec9163
Parent:
30:072e918663b8
Child:
55:06c5f76e1a8c
Child:
61:52a6d0ffd8e5
--- a/NMEA/NMEA.cpp	Wed Sep 13 07:24:39 2017 +0000
+++ b/NMEA/NMEA.cpp	Mon Sep 25 10:36:34 2017 +0000
@@ -24,6 +24,8 @@
     longitudeDD = 0.0;
     latitudeDD = 0.0;
     
+    cnt_GPRMC = 0;
+    
     north = false;
     south = false;
     east = false;
@@ -106,6 +108,11 @@
     //copy GPRMC string to currentGPRMCString
     if(cstStr.compare(0, 6, rmc) == 0){
         
+        if(cnt_GPRMC > 1000){
+            cnt_GPRMC = 0;    
+        }
+        cnt_GPRMC +=  1;
+        
         //replace current valid rmc string with new valid rmc string
         currentGPRMCString.replace(0, 128, cstStr);