Diff: Logger.cpp

Revision:

30:ed791f1f7f7d

Parent:

29:cb2f55fbfe9c

Child:

31:20a95043adb0

--- a/Logger.cpp	Sat Dec 22 20:28:52 2018 +0000
+++ b/Logger.cpp	Wed Dec 26 19:34:17 2018 +0000
@@ -23,21 +23,34 @@
 }
 
 
-void Logger::log_gps(GpsData gd) {
+void Logger::log_gps(GpsData d) {
     if (enabled()) {
         fprintf(_fp, "G,%llu,%3.9f,%3.9f,%3.1f,%2.1f,%2.1f,%d\n",
-            Kernel::get_ms_count(),
-            gd.latitude, 
-            gd.longitude,
-            gd.course,
-            gd.speed,
-            gd.hdop,
-            gd.svcount
+            d.timestamp,
+            d.latitude, 
+            d.longitude,
+            d.course,
+            d.speed,
+            d.hdop,
+            d.svcount
         );
     }
 }
 
 
+void Logger::log_sensors(SensorData d) {
+    if (enabled()) {
+        fprintf(_fp, "S,%llu,%u,%d,%d,%d\n",
+            d.timestamp,
+            d.encoder, 
+            d.gyro[0],
+            d.gyro[1],
+            d.gyro[2]
+        );       
+    }
+}
+
+
 void Logger::log_estimation() {
     if (enabled()) {
     }