Added Mike's stop() function to arm planner to prevent race condition in bfs.