Feedback-Dubins-RRT Recovery Path Planning of UUV in an Underwater Obstacle Environment

Figure 1

The geometry of relative positions of the local-level frame map centered at the current vector and the target vector.