From d28f6fd44e2d22d8fb9ad4a18dfaad7677ad465d Mon Sep 17 00:00:00 2001 From: Mike Turvey Date: Thu, 1 Jun 2017 10:58:00 -0700 Subject: Display Lighthouse Poses in calibrate.c --- src/poser_turveytori.c | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) (limited to 'src') diff --git a/src/poser_turveytori.c b/src/poser_turveytori.c index 86b763b..3f0a0d5 100644 --- a/src/poser_turveytori.c +++ b/src/poser_turveytori.c @@ -1366,7 +1366,7 @@ static Point SolveForLighthouse(FLT posOut[3], FLT quatOut[4], TrackedObject *ob wcPos[2] += so->ctx->bsd[lh].Pose.Pos[2]; FLT newOrientation[4]; - //quatrotateabout(newOrientation, rotQuat, so->ctx->bsd[lh].Pose.Rot); // turns the wrong way + quatrotateabout(newOrientation, rotQuat, so->ctx->bsd[lh].Pose.Rot); // turns the wrong way //quatrotateabout(newOrientation, so->ctx->bsd[lh].Pose.Rot, rotQuat); // turns the wrong way FLT invRot[4]; @@ -1382,7 +1382,7 @@ static Point SolveForLighthouse(FLT posOut[3], FLT quatOut[4], TrackedObject *ob //FLT invRot[4]; //quatgetreciprocal(invRot, rotQuat); - quatrotateabout(newOrientation, invRot, invPoseRot); // turns correctly, rotations aligned <-- This seems to be the best. + //quatrotateabout(newOrientation, invRot, invPoseRot); // turns correctly, rotations aligned <-- This seems to be the best. //quatrotateabout(newOrientation, invPoseRot, invRot); // turns correctly, rotations aligned, (x & y flipped?) so->OutPose.Pos[0] = wcPos[0]; -- cgit v1.2.3