Skip to content
Snippets Groups Projects
Commit 4a1c9d35 authored by Joaquim Casals Buñuel's avatar Joaquim Casals Buñuel
Browse files

getLastKeyFrame -> getLastFrame

parent caee51b8
No related branches found
No related tags found
3 merge requests!5After cmake and const refactor,!3new release,!1WIP: Resolve "Adapt to std::set and std::map instead of std::list in wolf nodes"
......@@ -79,11 +79,11 @@ void SubscriberImu::publishBias() const
// Fill PoseStamped msg
geometry_msgs::Vector3 accel_bias_msg, gyro_bias_msg;
if (not sensor_ptr_->getProblem()->getTrajectory()->getLastKeyFrame() or
not sensor_ptr_->getProblem()->getTrajectory()->getLastKeyFrame()->getCaptureOf(sensor_ptr_))
if (not sensor_ptr_->getProblem()->getTrajectory()->getLastFrame() or
not sensor_ptr_->getProblem()->getTrajectory()->getLastFrame()->getCaptureOf(sensor_ptr_))
return;
Eigen::Vector6d bias = sensor_ptr_->getProblem()->getTrajectory()->getLastKeyFrame()->getCaptureOf(sensor_ptr_)->getStateBlock('I')->getState();
Eigen::Vector6d bias = sensor_ptr_->getProblem()->getTrajectory()->getLastFrame()->getCaptureOf(sensor_ptr_)->getStateBlock('I')->getState();
//Eigen::Vector3d accel_bias = //sensor_ptr_->getIntrinsic()->getState().head(3);
//Eigen::Vector3d gyro_bias = //sensor_ptr_->getIntrinsic()->getState().tail(3);
......
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