Skip to content

Commit

Permalink
[pronto_core] Fix for eigen_utils deprecation
Browse files Browse the repository at this point in the history
  • Loading branch information
wxmerkt committed Jun 1, 2021
1 parent 0053b1a commit 0cdb616
Showing 1 changed file with 3 additions and 2 deletions.
5 changes: 3 additions & 2 deletions pronto_core/src/rbis_update_interface.cpp
Original file line number Diff line number Diff line change
@@ -1,4 +1,5 @@
#include "pronto_core/rbis_update_interface.hpp"
#include "pronto_core/rotations.hpp"
#include <iostream>

namespace pronto {
Expand Down Expand Up @@ -39,13 +40,13 @@ void RBISResetUpdate::updateFilter(const RBIS & prior_state, const RBIM & prior_
std::cerr << "?????????????????????" << std::endl;

std::cerr << "Prior gyro bias: " << prior_state.gyroBias().transpose() << std::endl;
Eigen::Vector3d rpy = eigen_utils::getEulerAngles(prior_state.orientation()) * 180.0 / M_PI;
Eigen::Vector3d rpy = rotation::getEulerAngles(prior_state.orientation()) * 180.0 / M_PI;
std::cerr << "Prior accel bias: " << prior_state.accelBias().transpose() << std::endl;
std::cerr << "Prior roll, pitch, yaw [deg]: " << rpy.transpose() << std::endl;

std::cerr << "Posterior gyro bias: " << posterior_state.gyroBias().transpose() << std::endl;
std::cerr << "Posterior accel bias: " << posterior_state.accelBias().transpose() << std::endl;
rpy = eigen_utils::getEulerAngles(posterior_state.orientation()) * 180.0 / M_PI;
rpy = rotation::getEulerAngles(posterior_state.orientation()) * 180.0 / M_PI;
std::cerr << "Posterior roll, pitch, yaw [deg]: " << rpy.transpose() << std::endl;


Expand Down

0 comments on commit 0cdb616

Please sign in to comment.