From aab002d3092551689ad06d9cdaf1145db2c1a885 Mon Sep 17 00:00:00 2001
From: joanvallve <jvallve@iri.upc.edu>
Date: Tue, 28 Jun 2016 17:41:34 +0200
Subject: [PATCH] delayed time for keyframe vote using origin frame time stamp

---
 src/processor_odom_2D.h | 8 ++++----
 1 file changed, 4 insertions(+), 4 deletions(-)

diff --git a/src/processor_odom_2D.h b/src/processor_odom_2D.h
index c289a4f89..56ded4840 100644
--- a/src/processor_odom_2D.h
+++ b/src/processor_odom_2D.h
@@ -34,17 +34,17 @@ class ProcessorOdom2D : public ProcessorMotion
             //std::cout << "ProcessorOdom2D::voteForKeyFrame: traveled distance " << getBufferPtr()->get().back().delta_integr_.norm() << std::endl;
             if (getBufferPtr()->get().back().delta_integr_.norm() > dist_traveled_th_)
             {
-                std::cout << "ProcessorOdom2D:: VOTE FOR KEY FRAME traveled distance " << getBufferPtr()->get().back().delta_integr_.norm() << std::endl;
+                std::cout << "ProcessorOdom2D:: " << this->id() << "VOTE FOR KEY FRAME traveled distance " << getBufferPtr()->get().back().delta_integr_.norm() << std::endl;
                 return true;
             }
             if (getBufferPtr()->get().back().delta_integr_cov_.determinant() > cov_det_th_)
             {
-                std::cout << "ProcessorOdom2D:: VOTE FOR KEY FRAME covariance det " << getBufferPtr()->get().back().delta_integr_cov_.determinant() << std::endl;
+                std::cout << "ProcessorOdom2D::  " << this->id() << "VOTE FOR KEY FRAME covariance det " << getBufferPtr()->get().back().delta_integr_cov_.determinant() << std::endl;
                 return true;
             }
-            if (getBufferPtr()->get().back().ts_.get() - origin_ptr_->getTimeStamp().get() > elapsed_time_th_)
+            if (getBufferPtr()->get().back().ts_.get() - origin_ptr_->getFramePtr()->getTimeStamp().get() > elapsed_time_th_)
             {
-                std::cout << "ProcessorOdom2D:: VOTE FOR KEY FRAME elapsed time " << getBufferPtr()->get().back().ts_.get() - origin_ptr_->getTimeStamp().get() << std::endl;
+                std::cout << "ProcessorOdom2D::  " << this->id() << "VOTE FOR KEY FRAME elapsed time " << getBufferPtr()->get().back().ts_.get() - origin_ptr_->getFramePtr()->getTimeStamp().get() << std::endl;
                 return true;
             }
             return false;
-- 
GitLab