Store last time frame was received

2017-10-12 10:45:14 +02:00
parent ff2f0f710a
commit 0071b7880f
3 changed files with 12 additions and 5 deletions
--- a/qsp.cpp
+++ b/qsp.cpp
@@ -194,10 +194,13 @@ void qspDecodeIncomingFrame(QspConfiguration_t *qsp, uint8_t incomingByte, int p
            canTransmit = true;
 #endif

-            switch (frameId)
-            {
+            //Store the last timestamp when frame was received
+            if (frameId < QSP_FRAME_COUNT) {
+                qsp->lastFrameReceivedAt[frameId] = millis();
+            }
+
+            switch (frameId) {
            case QSP_FRAME_RC_DATA:
-                qsp->lastRcFrameReceived = millis();
                qspDecodeRcDataFrame(qsp, ppm);
                break;