During the operation of an underwater tracked vehicle on a soft substrate, the instantaneous center of rotation (ICR) no longer coincides with the geometric center after the longitudinal offset is accounted for by the external environment. Due to this, designing an underwater trajectory tracking system based on a kinematic model is a challenging task. In order to achieve the high-precision trajectory tracking control of underwater tracked vehicles, this paper proposes a trajectory tracking algorithm based on the kinematic model of tracked vehicles. First, an inverse tangent algorithm is proposed to address the problem that the front viewpoint of the Stanley algorithm may not be on the target path and cause deviation. Second, by using the inverse tangent algorithm to introduce the target bow angle, as well as combining the mechanisms by which biological endocrine hormones are regulated with the advantages of single-neuron proportional–integral–derivative (PID), a composite endocrine intelligent control law is proposed for the design of the lateral control law of an underwater tracked vehicle; a longitudinal control law is designed based on the longitudinal offset of the ICR obtained by the estimation of the unscented Kalman filter as a means of compensating for longitudinal errors. Finally, a kinematic model is used in order to determine the desired drive wheel speed of the underwater tracked vehicle. The method is compared with the method without longitudinal deviation compensation, then with the methods presented in related literature, and finally, a certain degree of experimental validation is carried out. These results validate the effectiveness of the proposed method.
Read full abstract