From e84c05235c60ae40e82c0a4064bf3276b5194175 Mon Sep 17 00:00:00 2001
From: gfuse <majidgeravand68@gmail.com>
Date: Mon, 30 Aug 2021 19:22:42 +0200
Subject: [PATCH] working version 30th

---
 GPU_version/vio/include/vio/ukf.h   | 2 +-
 GPU_version/vio/src/reprojector.cpp | 1 +
 2 files changed, 2 insertions(+), 1 deletion(-)

diff --git a/GPU_version/vio/include/vio/ukf.h b/GPU_version/vio/include/vio/ukf.h
index 8f5f49c..cf70bd2 100644
--- a/GPU_version/vio/include/vio/ukf.h
+++ b/GPU_version/vio/include/vio/ukf.h
@@ -129,7 +129,7 @@ public:
         while(lock)usleep(5);
         lock=true;
         roll=roll+M_PI;
-        if(filter_->predict_up)filter_->correct(-z,-y,roll,match,1e-9*time.toNSec());
+        if(filter_->predict_up)filter_->correct(z,y,roll,match,1e-9*time.toNSec());
         lock=false;
         double roll_f;
         roll_f=filter_->state_(2)+M_PI;
diff --git a/GPU_version/vio/src/reprojector.cpp b/GPU_version/vio/src/reprojector.cpp
index 647f863..156aa1f 100644
--- a/GPU_version/vio/src/reprojector.cpp
+++ b/GPU_version/vio/src/reprojector.cpp
@@ -222,6 +222,7 @@ void Reprojector::reprojectMap(
         extractor->compute(frame->img(), keypoints_cur, descriptors_cur);
         list< pair<FramePtr,double> > close_kfs;
         map_.getCloseKeyframes(frame, close_kfs);
+        std::cerr<<close_kfs.size()<<'\n';
         close_kfs.sort(boost::bind(&std::pair<FramePtr, double>::second, _1) <
                        boost::bind(&std::pair<FramePtr, double>::second, _2));
         size_t n = 0;