Liveness-Based RRT Algorithm for Autonomous Underwater Vehicles Motion Planning

Algorithm 3

Update liveness algorithm.

Require: Near set threshold ; Three nodes set

  (1)

  (2) for do

  (3)       

  (4) end for

  (5)

  (6)

  (7) for do

  (8)       

  (9) end for