Diff: main.cpp

Revision:

203:cb2a3ea31dce

Parent:

202:1baff0df86d1

Child:

204:74714d52a936

--- a/main.cpp	Mon Feb 12 01:13:52 2018 +0000
+++ b/main.cpp	Mon Feb 12 03:41:12 2018 +0000
@@ -133,18 +133,7 @@
     }
         
     /*log data*/
-    if (_ENABLE_LOGGING) {
-        switch (BREMS_mode) {
-        case MODE_RUN:
-            log();
-            break;
-        case MODE_CFG:
-        case MODE_ZERO:
-        case MODE_CHR:
-        default:
-            break;
-        }
-    }
+    if (_ENABLE_LOGGING) log();
     
     /*disable outputs if necessary*/
     if (!control.enabled) {
@@ -182,6 +171,19 @@
 }
 
 void log() {
+    switch (BREMS_mode) {
+    case MODE_RUN:
+        send_packet();
+        break;
+    case MODE_CFG:
+    case MODE_ZERO:
+    case MODE_CHR:
+    default:
+        break;
+    }
+}
+
+void send_packet() {
     float packet[8];
     packet[0] = read.w / 8.0f;
     packet[1] = control.d_ref / 2.0f + 128.0f;