Draft: Implement human grouping

Closes #34

source/armarx/navigation/components/navigation_memory/Component.cpp

@@ -421,13 +421,11 @@ namespace armarx::navigation::components::navigation_memory
     void
     Component::visuRun()
     {
-        memory::Visu visu{
-            arviz,
-            workingMemory().getCoreSegment(navigation::location::coreSegmentID),
-            workingMemory().getCoreSegment(navigation::graph::coreSegmentID),
-            workingMemory().getCoreSegment(memory::constants::CostmapCoreSegmentName),
-            workingMemory().getCoreSegment(memory::constants::HumanCoreSegmentName),
-            workingMemory().getCoreSegment(memory::constants::HumanGroupCoreSegmentName)};
+        memory::Visu visu{arviz,
+                          workingMemory().getCoreSegment(navigation::location::coreSegmentID),
+                          workingMemory().getCoreSegment(navigation::graph::coreSegmentID),
+                          workingMemory().getCoreSegment(memory::constants::CostmapCoreSegmentName),
+                          workingMemory().getCoreSegment(memory::constants::HumanCoreSegmentName)};
 
 
         Properties::LocationGraph p;
@@ -460,6 +458,9 @@ namespace armarx::navigation::components::navigation_memory
             // Humans
             visu.drawHumans(layers, p.visuHumans, p.visuTransparent);
 
+            // Groups
+            visu.drawHumanGroups(layers, p.visuHumanGroups);
+
             arviz.commit(layers);
 
             metronome.waitForNextTick();