From 50b026760144e76a2e69babe34e6dee0a6a3c9c0 Mon Sep 17 00:00:00 2001 From: Justin Berger Date: Fri, 23 Mar 2018 07:26:31 +0000 Subject: Added reset cntr for sba --- src/survive_imu.c | 8 ++++---- 1 file changed, 4 insertions(+), 4 deletions(-) (limited to 'src/survive_imu.c') 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); -- cgit v1.2.3