Skip to content
Snippets Groups Projects
Commit 2c492f84 authored by Joan Vallvé Navarro's avatar Joan Vallvé Navarro
Browse files

fixing merge

parent df694526
No related branches found
No related tags found
1 merge request!448Draft: Resolve "Implementation of new nodes creation"
......@@ -170,7 +170,7 @@ void ProcessorTracker::processCapture(CaptureBasePtr _incoming_ptr)
// Update pointers
origin_ptr_ = last_ptr_;
last_ptr_ = incoming_ptr_;
last_frame_ptr_ = frame;
last_frame_ptr_ = keyframe;
incoming_ptr_ = nullptr;
break;
......
......@@ -558,9 +558,9 @@ void SensorBase::printState (bool _metric, bool _state_blocks, std::ostream& _st
_stream << _tabs << " " << key << " [" << (sb->isFixed() ? "Fix" : "Est") << ", "
<< (isStateBlockDynamic(key) ? "Dyn" : "Sta") << "] = ( " << std::setprecision(3)
<< sb->getState().transpose() << " )";
if (params_prior_map_.count(key))
if (features_prior_map_.count(key))
{
auto ftr = params_prior_map_.at(key);
auto ftr = features_prior_map_.at(key);
_stream << " ; mean = ( " << ftr->getMeasurement().transpose() << " )";
_stream << " , std = ( " << ftr->getMeasurementCovariance().diagonal().array().sqrt().transpose() << " )";
}
......
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