diff options
| author | cnlohr <lohr85@gmail.com> | 2018-06-23 14:28:20 -0400 |
|---|---|---|
| committer | cnlohr <lohr85@gmail.com> | 2018-06-23 14:28:20 -0400 |
| commit | 217adf4a3fd5621b6499195a882989b24d9ad615 (patch) | |
| tree | 5c289f8a4585b10c779d98ad1cb8b0598acc8592 | |
| parent | e8b268f4c0116b135400ef6cf3dc939481de119b (diff) | |
| download | libsurvive-217adf4a3fd5621b6499195a882989b24d9ad615.tar.gz libsurvive-217adf4a3fd5621b6499195a882989b24d9ad615.tar.bz2 | |
Fix my poser's use.
| -rw-r--r-- | src/poser_charlesrefine.c | 6 |
1 files 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] ); |