Provide access to unfiltered, unmapped headpose for cameni

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]);