基于TLS的主动全向声呐浮标目标定位与跟踪

采用最小二乘(LS)拟和法进行主动全向浮标目标定位时容易受测量误差的影响,为此提出一种基于总体最小二乘法(TLS)的定位算法,首先对主动全向浮标的定位方程和测速方程进行变换形成线性的量测方程,然后利用潜艇测距误差和浮标定位误差的随机性,基于总体最小二乘法对量测方程进行递归解算,解算过程根据潜艇运动的物理限制,取运动模型的状态预测值作为递归过程的初值,最终实现了测量误差平滑化和航迹的整体优化。仿真结果显示算法较之最小二乘法具有更好的抑制噪声能力和机动目标跟踪能力。