draft: fixes for global planning

source/armarx/navigation/client/ice_conversions.cpp

source/armarx/navigation/components/Navigator/CMakeLists.txt

source/armarx/navigation/components/Navigator/Navigator.cpp

source/armarx/navigation/components/Navigator/Navigator.h

source/armarx/navigation/core/Trajectory.cpp

source/armarx/navigation/core/Trajectory.h

source/armarx/navigation/core/types.h

source/armarx/navigation/global_planning/AStar.cpp

source/armarx/navigation/global_planning/GlobalPlanner.h

source/armarx/navigation/local_planning/LocalPlanner.h

source/armarx/navigation/safety_control/SafetyController.h

source/armarx/navigation/server/GraphBuilder.cpp

source/armarx/navigation/server/GraphBuilder.h

source/armarx/navigation/server/Navigator.cpp

...arx/navigation/server/introspection/ArvizIntrospector.cpp

...rmarx/navigation/server/introspection/ArvizIntrospector.h

...x/navigation/server/introspection/IntrospectorInterface.h

...rx/navigation/server/introspection/MemoryIntrospector.cpp

...marx/navigation/server/introspection/MemoryIntrospector.h

...rmarx/navigation/server/monitoring/GoalReachedMonitor.cpp