Cancel navigation when a new goal is received and navigate to new goal
Merge branch 'master' of https://github.com/tue-robotics/action_server