CCCorelib: updated wrong output check. Updated RGBD/MaxOdomCacheSize approach to work properly with Rtabmap/CreateIntermediateNodes=true.

This commit is contained in:
matlabbe
2022-01-28 14:48:32 -05:00
parent 02140f92db
commit 315350dbfc
2 changed files with 3 additions and 4 deletions

View File

@@ -137,15 +137,14 @@ rtabmap::Transform icpCC(
icpTransformation.setNull();
return icpTransformation;
}
else if(finalPointCount < 50)
else if(!transform.R.isValid())
{
std::string msg = uFormat("CCCoreLib has failed: Rejecting transform as finalPointCount %d < 50 ", finalPointCount);
std::string msg = uFormat("CCCoreLib has failed: Rotation matrix is invalid");
UDEBUG(msg.c_str());
if(errorMsg)
{
*errorMsg = msg;
}
icpTransformation.setNull();
return icpTransformation;
}