improve the local planner and add global planner