From a2ba45f43ae02b1e39b1816fe9c1c70c54a7f046 Mon Sep 17 00:00:00 2001 From: cnlohr Date: Sat, 10 Mar 2018 23:57:58 -0500 Subject: Switch from pos,quat to pose. Also change initialization order. --- src/poser_turveytori.c | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) (limited to 'src/poser_turveytori.c') diff --git a/src/poser_turveytori.c b/src/poser_turveytori.c index 94d572e..4398b66 100644 --- a/src/poser_turveytori.c +++ b/src/poser_turveytori.c @@ -1616,7 +1616,7 @@ static void QuickPose(SurviveObject *so, int lh) if (sensorCount > 4) { - FLT pos[3], quat[4]; + FLT pose[7]; // TODO: This countdown stuff is a total hack! // it basically ignores all the logic to find the most reliable data points @@ -1637,12 +1637,12 @@ static void QuickPose(SurviveObject *so, int lh) - SolveForLighthouse(pos, quat, to, so, 0, lh, 0); + SolveForLighthouse(&pose[0], &pose[3], to, so, 0, lh, 0); //printf("P&O: [% 08.8f,% 08.8f,% 08.8f] [% 08.8f,% 08.8f,% 08.8f,% 08.8f]\n", pos[0], pos[1], pos[2], quat[0], quat[1], quat[2], quat[3]); if (so->ctx->rawposeproc) { - so->ctx->rawposeproc(so, lh, pos, quat); + so->ctx->rawposeproc(so, lh, pose); } if (ttDebug) printf("!\n"); -- cgit v1.2.3