1 files changed, 6 insertions, 6 deletions
diff --git a/ftnoir_protocol_ft/ftnoir_protocol_ft.cpp b/ftnoir_protocol_ft/ftnoir_protocol_ft.cpp
index d4aa3c49..bb960696 100644
--- a/ftnoir_protocol_ft/ftnoir_protocol_ft.cpp
+++ b/ftnoir_protocol_ft/ftnoir_protocol_ft.cpp
@@ -126,12 +126,12 @@ float headRotZ;
     //
 	// Scale the Raw measurements to the client measurements.
 	//
-    headRotX = getRadsFromDegrees(headpose[Pitch]);
-    headRotY = getRadsFromDegrees(headpose[Yaw]);
-    headRotZ = getRadsFromDegrees(headpose[Roll]);
-    headPosX = headpose[TX] * 10;
-    headPosY = headpose[TY] * 10;
-    headPosZ = headpose[TZ] * 10;
+    headRotX = getRadsFromDegrees(rawheadpose[Pitch]);
+    headRotY = getRadsFromDegrees(rawheadpose[Yaw]);
+    headRotZ = getRadsFromDegrees(rawheadpose[Roll]);
+    headPosX = rawheadpose[TX] * 10;
+    headPosY = rawheadpose[TY] * 10;
+    headPosZ = rawheadpose[TZ] * 10;
 
     virtRotX = getRadsFromDegrees(headpose[Pitch]);
     virtRotY = getRadsFromDegrees(headpose[Yaw]);