until distToDeste (escapeVertex) ≤ distToDest (all neighbors)
(8)
move to the destination(1)Move along the shortest path trajectories until an obstacle is reached, keeping a minimal distance to the obstacle.(2)Generate an escape path using Algorithm 2.(3)Complete the movement to the next obstacle (in case of more than one obstacle) or destination.(4)Repeat 2 and 3 until the final destination is reached.