add more meaningful error msg

PetervDooren · MatthijsBurgh · commit ddf819559ea9 · 2022-04-01T10:39:44.000+02:00
diff --git a/ed_sensor_integration/src/kinect/fitter.cpp b/ed_sensor_integration/src/kinect/fitter.cpp
@@ -285,7 +285,8 @@ bool Fitter::estimateEntityPoseImp(const FitterData& data, const ed::WorldModel&
     double error_threshold = ERROR_THRESHOLD;
     if (current_optimum->getError() > error_threshold)
     {
-        throw FitterError("Error of best fit exceeds threshold");
+        std::string errormsg = "Error of best fit [" + std::to_string(current_optimum->getError()) + "]exceeds threshold [" + std::to_string(error_threshold) +"]";
+        throw FitterError(errormsg);
     }
 
     // Correct for shape transformation

Original file line number	Diff line number	Diff line change
`@@ -285,7 +285,8 @@ bool Fitter::estimateEntityPoseImp(const FitterData& data, const ed::WorldModel&`
`285`	`285`	`double error_threshold = ERROR_THRESHOLD;`
`286`	`286`	`if (current_optimum->getError() > error_threshold)`
`287`	`287`	`{`
`288`		`- throw FitterError("Error of best fit exceeds threshold");`
	`288`	`+ std::string errormsg = "Error of best fit [" + std::to_string(current_optimum->getError()) + "]exceeds threshold [" + std::to_string(error_threshold) +"]";`
	`289`	`+ throw FitterError(errormsg);`
`289`	`290`	`}`
`290`	`291`
`291`	`292`	`// Correct for shape transformation`