hotfix

src/icp.cpp

@@ -218,7 +218,7 @@ icpOutput ICP::align(const LaserScan &_current_ls,
         {
             std::cout << "Invalid result, trying again!" << std::endl;
         }
-        if (_icp_params.verbose and not result.valid and result.attempts < _icp_params.icp_attempts)
+        if (_icp_params.verbose and result.error > _icp_params.restart_threshold_mean_error and result.attempts < _icp_params.icp_attempts)
         {
             std::cout << "Error too big: " << result.error
                       << " ( should be < "