Overhauled global planner to become independent of StatusMessage