[TEMP] Print when optimum is invalid

tue-robotics · Apr 13, 2022 · 7af2446 · 7af2446
1 parent 7b82885
commit 7af2446
Showing 1 changed file with 2 additions and 0 deletions.
diff --git a/ed_sensor_integration/src/kinect/fitter.cpp b/ed_sensor_integration/src/kinect/fitter.cpp
@@ -377,6 +377,8 @@ std::unique_ptr<OptimalFit> Fitter::findOptimum(const EstimationInputData& input
     }
     if (valid_optimum)
         return current_optimum;
+
+    ROS_ERROR_NAMED("fitter", "optimum is invalid");
     std::unique_ptr<OptimalFit> invalid_optimum(new OptimalFit);
     return invalid_optimum;
 }