Closed-loop randomized kinodynamic path planning for an autonomous underwater vehicle

Abstract

A randomized kinodynamic path planning algorithm based on the incremental sampling-based method is proposed here as the state-of-the-art in this field applicable in an autonomous underwater vehicle. Designing a feasible path for this vehicle from an initial position and velocity to a target position and velocity in three-dimensional spaces by considering the kinematic constraints such as obstacles avoidance and dynamic constraints such as hard bounds and non-holonomic characteristic of AUV are the main motivation of this research. For this purpose, a closed-loop rapidly-exploring random tree (CL-RRT) algorithm is presented. This CL-RRT consists of three tightly coupled components: a RRT algorithm, three fuzzy proportional-derivative controllers for heading and diving control and a six degree-of-freedom nonlinear AUV model. The branches of CL-RRT are expanded in the configuration space by considering the kinodynamic constraints of AUV. The feasibility of each branch and random offspring vertex in the CL-RRT is checked against the mentioned constraints of AUV. Next, if the planned branch is feasible by the AUV, then the control signals and related vertex are recorded through the path planner to design the final path. This proposed algorithm is implemented on a single board computer (SBC) through the xPC Target and then four test-cases are designed in 3D space. The results of the processor-in-the-loop tests are compared by the conventional RRT and indicate that the proposed CL-RRT not only in a rapid manner plans an initial path, but also the planned path is feasible by the AUV.