diff --git a/src/processor/processor_visual_odometry.cpp b/src/processor/processor_visual_odometry.cpp index 70b46d44968869e60a2004102f6c65cbddf448f2..44688712b2cfdf5644ecf07471cdff6ac27f8250 100644 --- a/src/processor/processor_visual_odometry.cpp +++ b/src/processor/processor_visual_odometry.cpp @@ -355,12 +355,6 @@ void ProcessorVisualOdometry::establishFactors() continue; } - // Add factors from all KFs of this track to the new lmk - WOLF_INFO("\n\nHEY") - WOLF_INFO(feat_pi->getFrame()->getStateVector().transpose()) - WOLF_INFO(lmk->getStateVector().transpose()) - WOLF_INFO(getSensor()->getStateVector().transpose()) - for (auto feat_kf: track_kf) { LandmarkHpPtr lmk_hp = std::dynamic_pointer_cast<LandmarkHp>(lmk);