diff options
| -rw-r--r-- | ftnoir_tracker_hatire/ftnoir_tracker_hat.cpp | 9 |
1 files changed, 6 insertions, 3 deletions
diff --git a/ftnoir_tracker_hatire/ftnoir_tracker_hat.cpp b/ftnoir_tracker_hatire/ftnoir_tracker_hat.cpp index 78535d01..6bacd5f9 100644 --- a/ftnoir_tracker_hatire/ftnoir_tracker_hat.cpp +++ b/ftnoir_tracker_hatire/ftnoir_tracker_hat.cpp @@ -402,19 +402,22 @@ bool FTNoIR_Tracker::GiveHeadPoseData(THeadPoseData *data) } if (new_frame) { #ifdef OPENTRACK_API + + static constexpr double pi = 3.14159265359; + static constexpr double d2r = pi / 180.; if (bEnableYaw) { - if (bInvertYaw ) data[Yaw] = HAT.Rot[iYawAxe] * -1.0f; + if (bInvertYaw ) data[Yaw] = HAT.Rot[iYawAxe] * -1.0f * d2r; else data[Yaw] = HAT.Rot[iYawAxe]; } else data[Yaw] =0; if (bEnablePitch) { - if (bInvertPitch) data[Pitch] = HAT.Rot[iPitchAxe] * -1.0f; + if (bInvertPitch) data[Pitch] = HAT.Rot[iPitchAxe] * -1.0f * d2r; else data[Pitch] = HAT.Rot[iPitchAxe]; } else data[Pitch] = 0; if (bEnableRoll) { - if (bInvertRoll) data[Roll] = HAT.Rot[iRollAxe] * -1.0f; + if (bInvertRoll) data[Roll] = HAT.Rot[iRollAxe] * -1.0f * d2r; else data[Roll] = HAT.Rot[iRollAxe]; } else data[Roll] =0; |