The algorithm iterates until the robot arrives at the goal node.The path gained is safe and optimal.

• 机器人每前进一步就重复该过程,沿一条全局优化的路径安全地到达终点。