Add distance function and start impl (WIP!)

...vigation/components/dynamic_scene_provider/CMakeLists.txt

...tion/components/dynamic_scene_provider/DistanceFunction.h

...ents/dynamic_scene_provider/DistanceFunctionDecorator.cpp

...onents/dynamic_scene_provider/DistanceFunctionDecorator.h

...n/components/dynamic_scene_provider/EuclideanDistance.cpp

...ion/components/dynamic_scene_provider/EuclideanDistance.h

...gation/components/dynamic_scene_provider/HumanGrouper.cpp

...vigation/components/dynamic_scene_provider/HumanGrouper.h

...omponents/dynamic_scene_provider/OrientationDecorator.cpp

.../components/dynamic_scene_provider/OrientationDecorator.h