diff --git a/GPU_version/vio/src/frame_handler_mono.cpp b/GPU_version/vio/src/frame_handler_mono.cpp index c2c92eb..86ac4d2 100644 --- a/GPU_version/vio/src/frame_handler_mono.cpp +++ b/GPU_version/vio/src/frame_handler_mono.cpp @@ -170,7 +170,7 @@ FrameHandlerBase::UpdateResult FrameHandlerMono::processFrame() //assert(new_frame_.get()== nullptr); SparseImgAlignGpu img_align(Config::kltMaxLevel(), Config::kltMinLevel(),30, SparseImgAlignGpu::GaussNewton, false,gpu_fast_); if(img_align.run(last_frame_, new_frame_)==0)return RESULT_FAILURE; - // reprojector_.reprojectMap(new_frame_, overlap_kfs_); + //reprojector_.reprojectMap(new_frame_, overlap_kfs_); // reprojector_.reprojectMap1(new_frame_, last_frame_, overlap_kfs_); reprojector_.reprojectMap2(new_frame_, overlap_kfs_); //assert (false); diff --git a/GPU_version/vio/src/map.cpp b/GPU_version/vio/src/map.cpp index d48d7cd..b4734b3 100644 --- a/GPU_version/vio/src/map.cpp +++ b/GPU_version/vio/src/map.cpp @@ -112,7 +112,6 @@ void Map::getCloseKeyframes( for(auto kf : keyframes_) { // check if kf has overlaping field of view with frame, use therefore KeyPoints - std::cerr<key_pts_.size()<<'\t'; for(auto keypoint : kf->key_pts_) { if(keypoint == nullptr) diff --git a/GPU_version/vio/src/reprojector.cpp b/GPU_version/vio/src/reprojector.cpp index f4dd63c..ea3f03d 100644 --- a/GPU_version/vio/src/reprojector.cpp +++ b/GPU_version/vio/src/reprojector.cpp @@ -72,7 +72,6 @@ void Reprojector::reprojectMap( { resetGrid(); list< pair > close_kfs; - //assert(frame== nullptr); map_.getCloseKeyframes(frame, close_kfs); close_kfs.sort(boost::bind(&std::pair::second, _1) < boost::bind(&std::pair::second, _2)); @@ -114,7 +113,6 @@ void Reprojector::reprojectMap( } for(size_t i=0; i (size_t) Config::maxFts()) @@ -223,7 +221,6 @@ void Reprojector::reprojectMap( std::vector keypoints_kfs; std::vector> keypoints_ref; map_.getCloseKeyframes(frame, close_kfs); - std::cerr<<"close_kfs size : "<::second, _1) < @@ -239,7 +236,6 @@ void Reprojector::reprojectMap( { keypoints_kfs.clear(); FramePtr ref_frame = it_frame->first; - // Try to reproject each mappoint that the other KF observes for(auto it_ftr=ref_frame->fts_.begin(), ite_ftr=ref_frame->fts_.end(); it_ftr!=ite_ftr; ++it_ftr) @@ -247,7 +243,6 @@ void Reprojector::reprojectMap( // check if the feature has a mappoint assigned if((*it_ftr)->point == NULL) continue; - // make sure we project a point only once if((*it_ftr)->point->last_projected_kf_id_ == frame->id_) continue; @@ -257,10 +252,8 @@ void Reprojector::reprojectMap( kp->pt.y = (*it_ftr)->px.y(); keypoints_kfs.push_back(*kp); } - std::cerr<<"keypoints_kfs size : "<point, keypoints_cur[i].pt.x, keypoints_cur[i].pt.y)) { - std::cerr<<"i : "<w2c(point->pos_)); - if(frame->cam_->isInFrame(px.cast(), 3)) // 8px is the patch size in the matcher + if(frame->cam_->isInFrame(px.cast(), 8)) // 8px is the patch size in the matcher { const int k = static_cast(px[1]/grid_.cell_size)*grid_.grid_n_cols + static_cast(px[0]/grid_.cell_size); @@ -409,7 +399,7 @@ bool Reprojector::reprojectPoint(FramePtr frame, Point* point) { if(point) { Vector2d px(x, y); - if (frame->cam_->isInFrame(px.cast(), 3)) // 8px is the patch size in the matcher + if (frame->cam_->isInFrame(px.cast(), 8)) // 8px is the patch size in the matcher { const int k = static_cast(px[1] / grid_.cell_size) * grid_.grid_n_cols + static_cast(px[0] / grid_.cell_size); @@ -420,7 +410,7 @@ bool Reprojector::reprojectPoint(FramePtr frame, Point* point) } else{ Vector2d px(x, y); - if (frame->cam_->isInFrame(px.cast(), 3)) // 8px is the patch size in the matcher + if (frame->cam_->isInFrame(px.cast(), 8)) // 8px is the patch size in the matcher { const int k = static_cast(px[1] / grid_.cell_size) * grid_.grid_n_cols + static_cast(px[0] / grid_.cell_size);