Debug CI test failure

PointCloudLibrary · Sep 25, 2023 · f9ead32 · f9ead32
1 parent 2b1d8ca
commit f9ead32
Showing 1 changed file with 6 additions and 1 deletion.
diff --git a/test/registration/test_registration.cpp b/test/registration/test_registration.cpp
@@ -594,6 +594,7 @@ TEST (PCL, GeneralizedIterativeClosestPoint6D)
   copyPointCloud (cloud_with_color, *src_full);
   PointCloud<PointT>::Ptr tgt_full (new PointCloud<PointT>);
   sampleRandomTransform (delta_transform, M_PI/0.1, .03);
+  std::cout << "ground truth transformation:" << std::endl << delta_transform.matrix() << std::endl;
   pcl::transformPointCloud (cloud_with_color, *tgt_full, delta_transform);
   PointCloud<PointT> output;
 
@@ -606,6 +607,7 @@ TEST (PCL, GeneralizedIterativeClosestPoint6D)
   sor.filter (*src);
   sor.setInputCloud (tgt_full);
   sor.filter (*tgt);
+  std::cout << "src->size()=" << src->size() << " tgt->size()=" << tgt->size() << std::endl;
 
   GeneralizedIterativeClosestPoint6D reg;
   reg.setInputSource (src);
@@ -616,7 +618,10 @@ TEST (PCL, GeneralizedIterativeClosestPoint6D)
   // Register
   reg.align (output);
   EXPECT_EQ (output.size (), src->size ());
-  EXPECT_LT (reg.getFitnessScore (), 0.003);
+  std::cout << "final transformation:" << std::endl << reg.getFinalTransformation() << std::endl;
+  const double fitscore = reg.getFitnessScore ();
+  std::cout << "fitness score=" << fitscore << std::endl;
+  EXPECT_LT (fitscore, 0.003);
 
   // Check again, for all possible caching schemes
   for (int iter = 0; iter < 4; iter++)