Fixed issue causing trajectory planner returning false to isGoalReach ed even when it's control thread finishes executing
Merge pull request #237 from bosch-ros-pkg/hydro-devel-trajectory-planner-at-goal-fix

Fix for issue where trajectory_planner returns false to isGoalReached() even when internally it is done