From 217adf4a3fd5621b6499195a882989b24d9ad615 Mon Sep 17 00:00:00 2001 From: cnlohr Date: Sat, 23 Jun 2018 14:28:20 -0400 Subject: Fix my poser's use. --- src/poser_charlesrefine.c | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/src/poser_charlesrefine.c b/src/poser_charlesrefine.c index b14d882..43558d6 100644 --- a/src/poser_charlesrefine.c +++ b/src/poser_charlesrefine.c @@ -55,9 +55,9 @@ int PoserCharlesRefine(SurviveObject *so, PoserData *pd) { //TODO: Actually do Madgwick's algorithm LinmathQuat applymotion; const SurvivePose * object_pose = &so->OutPose; - imuData->gyro[0] *= 1./1000.; - imuData->gyro[1] *= 1./1000.; - imuData->gyro[2] *= 1./1000.; + imuData->gyro[0] *= 1./so->imu_freq; + imuData->gyro[1] *= 1./so->imu_freq; + imuData->gyro[2] *= 1./so->imu_freq; quatfromeuler( applymotion, imuData->gyro ); //printf( "%f %f %f\n", imuData->gyro [0], imuData->gyro [1], imuData->gyro [2] ); -- cgit v1.2.3