Skip to content
Snippets Groups Projects
Commit 1413ed82 authored by Joan Solà Ortega's avatar Joan Solà Ortega
Browse files

Write solver report at each iteration

parent 37299a3c
No related branches found
No related tags found
2 merge requests!31devel->main,!30Complete UAV identification setup
...@@ -421,10 +421,10 @@ TEST_F(Test_SimulationProblemForceTorqueInertialDynamics_yaml, simulation_online ...@@ -421,10 +421,10 @@ TEST_F(Test_SimulationProblemForceTorqueInertialDynamics_yaml, simulation_online
// solve! // solve!
report = solver->solve(wolf::SolverManager::ReportVerbosity::BRIEF); report = solver->solve(wolf::SolverManager::ReportVerbosity::BRIEF);
// WOLF_INFO(report);
// results of this iteration // results of this iteration
WOLF_INFO("Time : ", t, " s."); WOLF_INFO("Time : ", t, " s.");
WOLF_INFO(report);
WOLF_INFO("Estimated bias : ", S->getStateBlock('I')->getState().transpose(), " m/s2 - rad/s."); 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 inertia : ", S->getStateBlock('i')->getState().transpose(), " m^2 Kg.");
WOLF_INFO("Estimated center of mass: ", S->getStateBlock('C')->getState().transpose(), " m."); WOLF_INFO("Estimated center of mass: ", S->getStateBlock('C')->getState().transpose(), " m.");
...@@ -436,10 +436,10 @@ TEST_F(Test_SimulationProblemForceTorqueInertialDynamics_yaml, simulation_online ...@@ -436,10 +436,10 @@ TEST_F(Test_SimulationProblemForceTorqueInertialDynamics_yaml, simulation_online
report = solver->solve(wolf::SolverManager::ReportVerbosity::BRIEF); report = solver->solve(wolf::SolverManager::ReportVerbosity::BRIEF);
WOLF_INFO(report);
// FINAL RESULTS // FINAL RESULTS
WOLF_INFO(report);
WOLF_INFO("True bias * : ", bias_true.transpose(), " m/s2 - rad/s."); WOLF_INFO("True bias * : ", bias_true.transpose(), " m/s2 - rad/s.");
WOLF_INFO("Guess bias : ", bias_guess.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."); WOLF_INFO("Estimated bias : ", S->getStateBlock('I')->getState().transpose(), " m/s2 - rad/s.");
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment