Complete gtest with a 3rd Capture processed

test/gtest_processor_odom_icp_3d.cpp

@@ -142,21 +142,22 @@ TEST_F(Test_ProcessorOdomIcp3D_yaml, constructor)
     // Load data
     pcl::PointCloud<pcl::PointXYZ>::Ptr pcl_ref1 = pcl::make_shared<pcl::PointCloud<pcl::PointXYZ>>();
     loadData(laser_root_dir + "/test/data/1.pcd", *pcl_ref1);
-
     C0 = std::make_shared<CaptureLaser3d>(0.0, S, pcl_ref1);
-
     C0->process();
-
     P->print(4,1,1,1);
 
     // Load data
     pcl::PointCloud<pcl::PointXYZ>::Ptr pcl_ref2 = pcl::make_shared<pcl::PointCloud<pcl::PointXYZ>>();
     loadData(laser_root_dir + "/test/data/2.pcd", *pcl_ref2);
-
     C1 = std::make_shared<CaptureLaser3d>(1.0, S, pcl_ref2);
-
     C1->process();
+    P->print(4,1,1,1);
 
+    // Load data
+    pcl::PointCloud<pcl::PointXYZ>::Ptr pcl_ref3 = pcl::make_shared<pcl::PointCloud<pcl::PointXYZ>>();
+    loadData(laser_root_dir + "/test/data/2.pcd", *pcl_ref3);
+    C2 = std::make_shared<CaptureLaser3d>(2.0, S, pcl_ref3);
+    C2->process();
     P->print(4,1,1,1);