diff options
| author | Justin Berger <jdavidberger@gmail.com> | 2018-03-23 07:26:31 +0000 |
|---|---|---|
| committer | Justin Berger <jdavidberger@gmail.com> | 2018-03-23 07:26:31 +0000 |
| commit | 50b026760144e76a2e69babe34e6dee0a6a3c9c0 (patch) | |
| tree | 75290f9ba4932ced6b45f2c25739e213837ce75b /src/survive_imu.c | |
| parent | 3272ffe5245c6f39f93572d4059f35953dc38faa (diff) | |
| download | libsurvive-50b026760144e76a2e69babe34e6dee0a6a3c9c0.tar.gz libsurvive-50b026760144e76a2e69babe34e6dee0a6a3c9c0.tar.bz2 | |
Added reset cntr for sba
Diffstat (limited to 'src/survive_imu.c')
| -rw-r--r-- | src/survive_imu.c | 8 |
1 files changed, 4 insertions, 4 deletions
diff --git a/src/survive_imu.c b/src/survive_imu.c index 5197266..297bbac 100644 --- a/src/survive_imu.c +++ b/src/survive_imu.c @@ -30,8 +30,8 @@ static SurvivePose iterate_position(const SurvivePose *pose, const LinmathVec3d LinmathVec3d rAcc = {0}; RotateAccel(rAcc, pose, pIMU->accel); - fprintf(stderr, "r %f %f %f %f\n", pIMU->accel[0], pIMU->accel[1], pIMU->accel[2], quatmagnitude(pIMU->accel)); - fprintf(stderr, "i %f %f %f %f\n", rAcc[0], rAcc[1], rAcc[2], quatmagnitude(rAcc)); + //fprintf(stderr, "r %f %f %f %f\n", pIMU->accel[0], pIMU->accel[1], pIMU->accel[2], quatmagnitude(pIMU->accel)); + //fprintf(stderr, "i %f %f %f %f\n", rAcc[0], rAcc[1], rAcc[2], quatmagnitude(rAcc)); scale3d(rAcc, rAcc, acc_mul); @@ -103,8 +103,8 @@ void survive_imu_tracker_integrate(SurviveObject *so, SurviveIMUTracker *tracker tracker->pose = t_next; - fprintf(stderr, "%f %f %f\n", tracker->current_velocity[0], tracker->current_velocity[1], - tracker->current_velocity[2]); + //fprintf(stderr, "%f %f %f\n", tracker->current_velocity[0], tracker->current_velocity[1], + //tracker->current_velocity[2]); scale3d(tracker->current_velocity, v_next, 1); |