Diff: PROJ515.cpp

Revision:

17:264eb15c8be2

Parent:

14:90590736e700

--- a/PROJ515.cpp	Tue Apr 09 15:59:24 2019 +0000
+++ b/PROJ515.cpp	Tue Apr 23 16:02:34 2019 +0000
@@ -43,7 +43,6 @@
         gps_odom_msg.header.stamp = nh.now();      // Get current time
         
         gps_odom_pub.publish(&gps_odom_msg);       // Publish the Odometry message
-        usbSer.printf("\n>Valid Loc<");            // Print out valid location
     }
 }
 
@@ -101,12 +100,19 @@
 
         if (gpsModule.location.isValid()) {        // If GPS location is Valid
             thread_com.set(PRINT_DATA);            // Set EventFlag to Print Data
-            leds = LEDS_ON;                        // Flash LED bus ON
         }
+        
+        sats_n = gpsModule.satellites.value();     // Aquire satelite number
+        if (sats_n > 0){
+            leds = LEDS_ON;
+            }
 
         if (btn) {                                 // If blue button is pressed
-            sats_n = gpsModule.satellites.value(); // Aquire satelite number
-            usbSer.printf("\nstatChck: %d Satelites", sats_n); // Print Status
+            
+            usbSer.printf("\n\nTimestamp: %d ", nh.now());                  // Print Status: Time Stamp
+            usbSer.printf("\nstatChck: %d Satelites", sats_n);              // Print Status: Satelite Number
+            usbSer.printf("\nstatChck: %f Long", gpsModule.location.lng()); // Print Status: Long
+            usbSer.printf("\nstatChck: %f Lat", gpsModule.location.lat());  // Print Status: Lat
         }
 
     }