Draft: Implement human grouping

Closes #34

source/armarx/navigation/human/CMakeLists.txt

@@ -22,6 +22,7 @@ armarx_add_library(teb_human
         OrientationDistance.cpp
         CombinedDistance.cpp
         ConvexHullGenerator.cpp
+        MovementDistance.cpp
     HEADERS
         types.h
         aron_conversions.h
@@ -34,4 +35,5 @@ armarx_add_library(teb_human
         CombinedDistance.h
         GroupShapeGenerator.h
         ConvexHullGenerator.h
+        MovementDistance.h
 )