[TEMP] Print when optimum is invalid

MatthijsBurgh · MatthijsBurgh · commit 7af2446bcb43 · 2022-04-13T17:15:29.000+02:00
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;
 }

Original file line number	Diff line number	Diff line change
`@@ -377,6 +377,8 @@ std::unique_ptr<OptimalFit> Fitter::findOptimum(const EstimationInputData& input`
`377`	`377`	`}`
`378`	`378`	`if (valid_optimum)`
`379`	`379`	`return current_optimum;`
	`380`	`+`
	`381`	`+ ROS_ERROR_NAMED("fitter", "optimum is invalid");`
`380`	`382`	`std::unique_ptr<OptimalFit> invalid_optimum(new OptimalFit);`
`381`	`383`	`return invalid_optimum;`
`382`	`384`	`}`