diff --git a/test/gtest_simulation_problem_force_torque_inertial_dynamics.cpp b/test/gtest_simulation_problem_force_torque_inertial_dynamics.cpp index 763ecb87472f8703c01f635e56444d52cbe04241..9c0922fe9ccf14a9ff662bad6223a12080bd57b5 100644 --- a/test/gtest_simulation_problem_force_torque_inertial_dynamics.cpp +++ b/test/gtest_simulation_problem_force_torque_inertial_dynamics.cpp @@ -421,10 +421,10 @@ TEST_F(Test_SimulationProblemForceTorqueInertialDynamics_yaml, simulation_online // solve! report = solver->solve(wolf::SolverManager::ReportVerbosity::BRIEF); - // WOLF_INFO(report); - + // results of this iteration WOLF_INFO("Time : ", t, " s."); + WOLF_INFO(report); WOLF_INFO("Estimated bias : ", S->getStateBlock('I')->getState().transpose(), " m/s2 - rad/s."); WOLF_INFO("Estimated inertia : ", S->getStateBlock('i')->getState().transpose(), " m^2 Kg."); WOLF_INFO("Estimated center of mass: ", S->getStateBlock('C')->getState().transpose(), " m."); @@ -436,10 +436,10 @@ TEST_F(Test_SimulationProblemForceTorqueInertialDynamics_yaml, simulation_online report = solver->solve(wolf::SolverManager::ReportVerbosity::BRIEF); - WOLF_INFO(report); // FINAL RESULTS + WOLF_INFO(report); WOLF_INFO("True bias * : ", bias_true.transpose(), " m/s2 - rad/s."); WOLF_INFO("Guess bias : ", bias_guess.transpose(), " m/s2 - rad/s."); WOLF_INFO("Estimated bias : ", S->getStateBlock('I')->getState().transpose(), " m/s2 - rad/s.");