updates and fixes

source/Navigation/components/ExampleClient/ExampleClient.cpp

...ce/Navigation/libraries/algorithms/astar/AStarPlanner.cpp

source/Navigation/libraries/core/Trajectory.cpp

source/Navigation/libraries/core/Trajectory.h

source/Navigation/libraries/global_planning/AStar.cpp

source/Navigation/libraries/global_planning/AStar.h

source/Navigation/libraries/server/Navigator.cpp

source/Navigation/libraries/server/Navigator.h

...gation/libraries/server/monitoring/GoalReachedMonitor.cpp

...ation/libraries/trajectory_control/TrajectoryController.h

...ries/trajectory_control/TrajectoryFollowingController.cpp

...raries/trajectory_control/TrajectoryFollowingController.h