Added the plan_executor node and fixed a bug with global_planner