From f0a3c9df44fbc9f977b453fe3de29ef2773e155d Mon Sep 17 00:00:00 2001
From: Martin Krauser <martin.krauser@gmail.com>
Date: Fri, 4 Mar 2022 14:07:54 +0100
Subject: [PATCH] add time info to accel msg

---
 osc32bt/osc32bt.ino | 14 +++++++-------
 1 file changed, 7 insertions(+), 7 deletions(-)

diff --git a/osc32bt/osc32bt.ino b/osc32bt/osc32bt.ino
index 2fade66..e0c74b8 100644
--- a/osc32bt/osc32bt.ino
+++ b/osc32bt/osc32bt.ino
@@ -58,6 +58,7 @@ uint8_t devStatus;      // return status after each device operation (0 = succes
 uint16_t packetSize;    // expected DMP packet size (default is 42 bytes)
 uint16_t fifoCount;     // count of all bytes currently in FIFO
 uint8_t fifoBuffer[64]; // FIFO storage buffer
+uint32_t time = 0;
 
 // orientation/motion vars
 Quaternion q;           // [w, x, y, z]         quaternion container
@@ -173,12 +174,7 @@ void loop() {
     qmsg.add(q.x);
     qmsg.add(q.y);
     qmsg.add(q.z);
-
-    qmsg.add(diff.w);
-    qmsg.add(diff.x);
-    qmsg.add(diff.y);
-    qmsg.add(diff.z);
-
+    
     SLIPBTSerial.beginPacket();
     qmsg.send(SLIPBTSerial);
     SLIPBTSerial.endPacket();
@@ -237,10 +233,14 @@ void loop() {
 
 #endif
 
-    // Send (accel) over serial
+    // Send (accel) and time elapsed over serial
+    int prevTime = time;
+    time = millis();
     msg.add(AcX);
     msg.add(AcY);
     msg.add(AcZ);
+    msg.add(time - prevTime);
+
     
     SLIPSerial.beginPacket();
     msg.send(SLIPSerial);