Improve display efficiency

1 files changed, 16 insertions, 5 deletions

diff --git a/nanologger/nanologger.ino b/nanologger/nanologger.ino
index d40b85b..83d439e 100644
--- a/nanologger/nanologger.ino
+++ b/nanologger/nanologger.ino
@@ -33,6 +33,8 @@ static int speed = 0;
 static uint32_t distance = 0;
 static uint16_t fileIndex = 0;
 static uint32_t startTime = 0;
+static uint8_t lastPid = 0;
+static int lastValue = 0;
 
 static byte pidTier1[]= {PID_RPM, PID_SPEED, PID_ENGINE_LOAD, PID_THROTTLE};
 static byte pidTier2[] = {PID_INTAKE_MAP, PID_MAF_FLOW, PID_TIMING_ADVANCE};
@@ -42,6 +44,8 @@ static byte pidTier3[] = {PID_COOLANT_TEMP, PID_INTAKE_TEMP, PID_AMBIENT_TEMP, P
 #define TIER_NUM2 sizeof(pidTier2)
 #define TIER_NUM3 sizeof(pidTier3)
 
+byte pidValue[TIER_NUM1];
+
 class COBDLogger : public COBD, public CDataLogger
 {
 public:
@@ -206,6 +210,13 @@ public:
         initLoggerScreen();
     }
 private:
+    void dataIdleLoop()
+    {
+        if (lastPid) {
+            showLoggerData(lastPid, lastValue);
+            lastPid = 0;
+        }
+    }
 #if USE_MPU6050
     void processAccelerometer()
     {
@@ -219,18 +230,18 @@ private:
         logData(PID_GYRO, data.value.x_gyro, data.value.y_gyro, data.value.z_gyro);
     }
 #endif
-    void logOBDData(byte pid)
+    int logOBDData(byte pid)
     {
-        int value;
+        int value = 0;
         // send a query to OBD adapter for specified OBD-II pid
         if (read(pid, value)) {
             dataTime = millis();
-            showLoggerData(pid, value);
             // log data to SD card
             logData(0x100 | pid, value);
+            lastValue = value;
+            lastPid = pid;
         }
-
-        // if OBD response is very fast, go on processing other data for a while
+        return value;
     }
     void reconnect()
     {