Draft: Implement human grouping

Closes #34

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

@@ -46,9 +46,9 @@ using armarx::navigation::human::Human;
 
 BOOST_AUTO_TEST_CASE(testEuclideanDistance)
 {
-    EuclideanDistance distance = EuclideanDistance();
+    //    EuclideanDistance distance = EuclideanDistance();
 
-    Pose2D pose1 = Pose2D::Identity();
+    //    Pose2D pose1 = Pose2D::Identity();
     //    pose1.translation() = Eigen::Vector2f(3, 4);
     //    pose1.linear() = Eigen::Rotation2Df(1.1).toRotationMatrix();
     //    Human h1 = {.pose = pose1,