Draft: Implement human grouping

Closes #34

source/armarx/navigation/human/HumanGrouper.cpp

@@ -6,6 +6,7 @@ namespace armarx::navigation::human
     HumanGrouper::HumanGrouper(GroupingSettings settings) : settings(settings)
     {
         this->distanceFunction = new CombinedDistance(settings.maxOrientationInfluence);
+        this->shapeGenerator = NULL; // TODO: implement and use interface
     }
 
     HumanGrouper::~HumanGrouper()
@@ -51,7 +52,10 @@ namespace armarx::navigation::human
             }
         }
 
-        // TODO: shape generation
+        for (human::HumanGroup group : groups)
+        {
+            group.shape = shapeGenerator->createShape(group);
+        }
 
         return groups;
     }