don't increment dataid twice

1 files changed, 1 insertions, 1 deletions

diff --git a/ftnoir_protocol_ft/ftnoir_protocol_ft.cpp b/ftnoir_protocol_ft/ftnoir_protocol_ft.cpp
index 08d41897..312cf127 100644
--- a/ftnoir_protocol_ft/ftnoir_protocol_ft.cpp
+++ b/ftnoir_protocol_ft/ftnoir_protocol_ft.cpp
@@ -71,7 +71,7 @@ void FTNoIR_Protocol::pose(const double* headpose) {
     pMemData->data.Pitch = pitch;
     pMemData->data.Roll = roll;
 
-    pMemData->data.X1 = ++pMemData->data.DataID;
+    pMemData->data.X1 = pMemData->data.DataID;
     pMemData->data.X2 = 0;
     pMemData->data.X3 = 0;
     pMemData->data.X4 = 0;