From 171d26adc85fd54dda10ccdde6bffbdb81e73f3c Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Joan=20Sol=C3=A0?= <jsola@iri.upc.edu>
Date: Sun, 16 Dec 2018 20:33:59 +0100
Subject: [PATCH] Clear TODOs and other obsolete pending tasks

---
 .gitignore                               |  1 +
 src/examples/test_map_yaml.cpp           |  2 +-
 src/examples/test_yaml.cpp               | 42 ++++++++++++------------
 src/landmark_AHP.h                       |  4 +--
 src/processor_tracker_feature_corner.cpp |  1 -
 src/test/gtest_odom_2D.cpp               |  2 +-
 6 files changed, 26 insertions(+), 26 deletions(-)

diff --git a/.gitignore b/.gitignore
index dc88af0b4..2e5e67470 100644
--- a/.gitignore
+++ b/.gitignore
@@ -26,3 +26,4 @@ src/examples/map_polyline_example_write.yaml
 src/CMakeCache.txt
 
 src/CMakeFiles/cmake.check_cache
+src/examples/map_apriltag_save.yaml
diff --git a/src/examples/test_map_yaml.cpp b/src/examples/test_map_yaml.cpp
index 049e3dbc0..80273a384 100644
--- a/src/examples/test_map_yaml.cpp
+++ b/src/examples/test_map_yaml.cpp
@@ -75,7 +75,7 @@ int main()
     std::string wolf_config     = wolf_root + "/src/examples";
     std::cout << "\nWolf directory for configuration files: " << wolf_config << std::endl;
 
-    ProblemPtr problem = Problem::create(FRM_PO_2D);
+    ProblemPtr problem = Problem::create("PO 2D");
     filename = wolf_config + "/map_polyline_example.yaml";
     std::cout << "Reading map from file: " << filename << std::endl;
     problem->loadMap(filename);
diff --git a/src/examples/test_yaml.cpp b/src/examples/test_yaml.cpp
index 2ca6eb55e..56a33fe1d 100644
--- a/src/examples/test_yaml.cpp
+++ b/src/examples/test_yaml.cpp
@@ -71,27 +71,27 @@ int main()
 
 
 
-    // Processor Image parameters
-
-    ProcessorParamsImage p;
-
-    Node params = YAML::LoadFile(wolf_root + "/src/examples/processor_image_feature.yaml");
-
-    if (params["processor type"])
-    {
-        Node as = params["active search"];
-        p.active_search.grid_width      = as["grid width"].as<unsigned int>();
-        p.active_search.grid_height     = as["grid height"].as<unsigned int>();
-        p.active_search.separation      = as["separation"].as<unsigned int>();
-
-        Node img = params["image"];
-        p.image.width                   = img["width"].as<unsigned int>();
-        p.image.height                  = img["height"].as<unsigned int>();
-
-        Node alg = params["algorithm"];
-        p.max_new_features            = alg["maximum new features"].as<unsigned int>();
-        p.min_features_for_keyframe   = alg["minimum features for new keyframe"].as<unsigned int>();
-    }
+//    // Processor Image parameters
+//
+//    ProcessorParamsImage p;
+//
+//    Node params = YAML::LoadFile(wolf_root + "/src/examples/processor_image_feature.yaml");
+//
+//    if (params["processor type"])
+//    {
+//        Node as = params["active search"];
+//        p.active_search.grid_width      = as["grid width"].as<unsigned int>();
+//        p.active_search.grid_height     = as["grid height"].as<unsigned int>();
+//        p.active_search.separation      = as["separation"].as<unsigned int>();
+//
+//        Node img = params["image"];
+//        p.image.width                   = img["width"].as<unsigned int>();
+//        p.image.height                  = img["height"].as<unsigned int>();
+//
+//        Node alg = params["algorithm"];
+//        p.max_new_features            = alg["maximum new features"].as<unsigned int>();
+//        p.min_features_for_keyframe   = alg["minimum features for new keyframe"].as<unsigned int>();
+//    }
 
 
     return 0;
diff --git a/src/landmark_AHP.h b/src/landmark_AHP.h
index ad55a0724..e8d695b19 100644
--- a/src/landmark_AHP.h
+++ b/src/landmark_AHP.h
@@ -20,8 +20,8 @@ class LandmarkAHP : public LandmarkBase
 {
     protected:
         cv::Mat cv_descriptor_;
-        FrameBasePtr anchor_frame_; // TODO check pointer type
-        SensorBasePtr anchor_sensor_; // TODO check pointer type
+        FrameBasePtr anchor_frame_;
+        SensorBasePtr anchor_sensor_;
 
     public:
         LandmarkAHP(Eigen::Vector4s _position_homogeneous, FrameBasePtr _anchor_frame, SensorBasePtr _anchor_sensor, cv::Mat _2D_descriptor);
diff --git a/src/processor_tracker_feature_corner.cpp b/src/processor_tracker_feature_corner.cpp
index 3b0ac96a2..5876bdd2b 100644
--- a/src/processor_tracker_feature_corner.cpp
+++ b/src/processor_tracker_feature_corner.cpp
@@ -176,7 +176,6 @@ void ProcessorTrackerFeatureCorner::extractCorners(CaptureLaser2DPtr _capture_la
         measurement.head(2) = corner.pt_.head(2);
         measurement(2) = corner.orientation_;
         measurement(3) = corner.aperture_;
-        // TODO: maybe in line object?
         Scalar L1 = corner.line_1_.length();
         Scalar L2 = corner.line_2_.length();
         Scalar cov_angle_line1 = 12 * corner.line_1_.error_
diff --git a/src/test/gtest_odom_2D.cpp b/src/test/gtest_odom_2D.cpp
index ef833a48a..0ee5206e8 100644
--- a/src/test/gtest_odom_2D.cpp
+++ b/src/test/gtest_odom_2D.cpp
@@ -453,7 +453,7 @@ TEST(Odom2D, KF_callback)
 
     // check the split KF
     ASSERT_POSE2D_APPROX(keyframe_1->getState()                  , integrated_pose_vector[m_split], 1e-6);
-    ASSERT_MATRIX_APPROX(problem->getFrameCovariance(keyframe_1) , integrated_cov_vector [m_split], 1e-6); // FIXME test does not pass
+    ASSERT_MATRIX_APPROX(problem->getFrameCovariance(keyframe_1) , integrated_cov_vector [m_split], 1e-6);
 
     // check other KF in the future of the split KF
     ASSERT_POSE2D_APPROX(problem->getLastKeyFramePtr()->getState() , integrated_pose_vector[n_split], 1e-6);
-- 
GitLab