diff --git a/src/loop_closure_base_2d.cpp b/src/loop_closure_base_2d.cpp index aae465d1b95b012999039e2ca6f7c051ddfbdab4..5274d2035510c60269a58e158bd9577b73ebc100 100644 --- a/src/loop_closure_base_2d.cpp +++ b/src/loop_closure_base_2d.cpp @@ -19,12 +19,7 @@ namespace laserscanutils{ return NewScene; } */ - std::shared_ptr<falkolib::LaserScan> loopClosureBase2d::convert2LaserScanFALKO(LaserScan &scan,LaserScanParams &scanParams){ - auto scanFALKO=std::make_shared<falkolib::LaserScan>(scanParams.angle_min_, scanParams.angle_max_, scan.ranges_raw_.size()); - std::vector<double> doubleRanges(scan.ranges_raw_.begin(), scan.ranges_raw_.end()); - ((*scanFALKO).fromRanges)(doubleRanges); - return scanFALKO; - } + //void findLoopClosure(std::list<cornerScene>& scenes, const cornerScene newScene){} diff --git a/src/loop_closure_base_2d.h b/src/loop_closure_base_2d.h index 97965a453329427a51e89e0b0cbabb0e0e518ba9..cc50265a95ee9dd34557745d1e21b252db026c2b 100644 --- a/src/loop_closure_base_2d.h +++ b/src/loop_closure_base_2d.h @@ -59,11 +59,6 @@ public: **/ virtual std::shared_ptr<sceneFalko<falkolib::BSC>> extractScene(LaserScan &scan,LaserScanParams &scanParams){} - /** \brief Convert scans from laserscanutils::LaserScan to falkolib::LaserScan object - **/ - std::shared_ptr<falkolib::LaserScan> convert2LaserScanFALKO(LaserScan &scan,LaserScanParams &scanParams); - - }; } /* namespace laserscanutils */ diff --git a/src/loop_closure_falko.cpp b/src/loop_closure_falko.cpp index dadc9a1083eeb0ab59aa178a782f1f08767dd6b6..6bb979f84d32f8d48ae7a9515dc05f5ccdc07fe2 100644 --- a/src/loop_closure_falko.cpp +++ b/src/loop_closure_falko.cpp @@ -36,6 +36,14 @@ namespace laserscanutils{ template <typename D,typename Extr, typename M> loopClosureFalko<D,Extr,M>::~loopClosureFalko(){} + template <typename D,typename Extr, typename M> + std::shared_ptr<falkolib::LaserScan> loopClosureFalko<D,Extr, M>::convert2LaserScanFALKO(LaserScan &scan,LaserScanParams &scanParams){ + auto scanFALKO=std::make_shared<falkolib::LaserScan>(scanParams.angle_min_, scanParams.angle_max_, scan.ranges_raw_.size()); + std::vector<double> doubleRanges(scan.ranges_raw_.begin(), scan.ranges_raw_.end()); + ((*scanFALKO).fromRanges)(doubleRanges); + return scanFALKO; + } + template <typename D,typename Extr, typename M> std::shared_ptr<sceneFalko<D>> loopClosureFalko<D,Extr, M>::extractScene(LaserScan &scan,LaserScanParams &scanParams){ auto newScene=std::make_shared<sceneFalko<D>>(); diff --git a/src/loop_closure_falko.h b/src/loop_closure_falko.h index e75c91d3cf01ad4447db0519f7c82db07733e373..620c6389303d45fcf78513c56e6f8808bb74b0f6 100644 --- a/src/loop_closure_falko.h +++ b/src/loop_closure_falko.h @@ -68,6 +68,10 @@ public: **/ std::shared_ptr<sceneFalko<D>> extractScene(LaserScan &scan,LaserScanParams &scanParams) override; + /** \brief Convert scans from laserscanutils::LaserScan to falkolib::LaserScan object + **/ + std::shared_ptr<falkolib::LaserScan> convert2LaserScanFALKO(LaserScan &scan,LaserScanParams &scanParams); + }; } /* namespace laserscanutils */ diff --git a/test/gtest_loop_closure_base_2d.cpp b/test/gtest_loop_closure_base_2d.cpp index b3439228d46b2fd879af19c3ca3bccedbef355c2..e6ee4e141707c7e7730e5a440bd58793858e56aa 100644 --- a/test/gtest_loop_closure_base_2d.cpp +++ b/test/gtest_loop_closure_base_2d.cpp @@ -36,7 +36,7 @@ TEST(loop_closure_falko, extractScene) // PRINTF("All good at TestTest::DummyTestExample !\n"); } -TEST(loop_closure_base_2d, convert2laserScanFalko) +TEST(loop_closure_falko, convert2laserScanFalko) { int scanSize = 1440; @@ -50,9 +50,9 @@ TEST(loop_closure_base_2d, convert2laserScanFalko) scan.ranges_raw_.push_back(testRanges1[i]); } - loopClosureBase2d LCBase; + loopClosureFalko<bsc, bscExtractor, NNMatcher> LCFalko; - std::shared_ptr<falkolib::LaserScan> scanFALKO=LCBase.convert2LaserScanFALKO(scan, laserParams); + std::shared_ptr<falkolib::LaserScan> scanFALKO=LCFalko.convert2LaserScanFALKO(scan, laserParams); int firstPoint = ((*scanFALKO).ranges)[0];