The goal node is mapped to the node nearby the boundary in the eyeshot of the robot,and the best local path is planned,which the robot goes ahead for a step.