Add some debug comments

source/armarx/navigation/human/test/human_tracker_test.cpp

@@ -192,16 +192,26 @@ namespace armarx::navigation::human
         const std::vector<CamMm> camMeasurements = generateCamMeasurements(
             initialPosition, endPosition, orientationQuat, timespanMs, cameraSteps);
 
-        int i = 0;
+        //int i = 0;
         for (const CamMm& measurement : camMeasurements)
         {
-            const Eigen::Vector3f mPos = initialPosition + i * posDelta;
-            ARMARX_INFO << "Measurement at position " << mPos.x() << ", " << mPos.y() << ", "
-                        << mPos.z();
+            //ARMARX_INFO << "bla";
+            //const Eigen::Vector3f mPos = initialPosition + i * posDelta;
+            //ARMARX_INFO << "Measurement at position " << mPos.x() << ", " << mPos.y() << ", "
+            //<< mPos.z();
             tracker.update(measurement);
-            const Eigen::Vector2f tPos = tracker.getTrackedHumans().at(0).pose.translation();
-            ARMARX_INFO << "tracker now thinks human is at " << tPos.x() << ", " << tPos.y();
-            i++;
+            //const Eigen::Vector2f tPos = tracker.getTrackedHumans().at(0).pose.translation();
+            //ARMARX_INFO << "tracker now thinks human is at " << tPos.x() << ", " << tPos.y();
+            //i++;
+        }
+
+        ARMARX_INFO << "state after loop:";
+        for (auto& h : tracker.getTrackedHumans())
+        {
+            BOOST_TEST_MESSAGE("-----------");
+            BOOST_TEST_MESSAGE("time: " << h.detectionTime);
+            BOOST_TEST_MESSAGE("pose:\n" << h.pose.matrix());
+            BOOST_TEST_MESSAGE("vel:\n" << h.linearVelocity);
         }
 
         // LASER MEASUREMENT