针对水下自主航行器(AUV)协同定位受水下未知定常洋流影响的问题,给出一种洋流影响下基于运动矢径的AUV协同定位方法.利用AUV的运动学方程和基于运动矢径的量测方程,建立AUV的导航模型;通过扩展的卡尔曼滤波,设计了协同定位滤波算法;利用该算法对洋流速度进行估计,以补偿AUV定位误差.仿真结果表明,该算法能有效估计未知定常洋流速度的大小,并对AUV定位误差进行实时补偿,显著提高了AUV的定位精度.
In view of the influence of underwater unknown constant currents in autonomous underwater vehicle(AUV) cooperative localization,an AUV cooperative localization method based on motion radius vector in the presence of currents is presented.The model of the system is established by using the AUV kinematic equation and the motion radius vector measurement equation.A cooperative localization filtering algorithm is designed by using extended Kalman filtering(EKF),which is used to estimate the currents speed and compensate the AUV position error.The simulation result shows that the unknown currents speed can be estimated and the localization accuracy is improved effectively.