| 摘要: |
| 采用最小二乘(LS)拟和法进行主动全向浮标目标定位时容易受测量误差的影响，为此提出一种基于总体最小二乘法(TLS)的定位算法，首先对主动全向浮标的定位方程和测速方程进行变换形成线性的量测方程，然后利用潜艇测距误差和浮标定位误差的随机性，基于总体最小二乘法对量测方程进行递归解算，解算过程根据潜艇运动的物理限制，取运动模型的状态预测值作为递归过程的初值，最终实现了测量误差平滑化和航迹的整体优化。仿真结果显示算法较之最小二乘法具有更好的抑制噪声能力和机动目标跟踪能力。 |
| 关键词: 主动全向声呐浮标 目标定位 机动目标跟踪 量测误差 总体最小二乘法 |
| DOI： |
|
| 基金项目: |
|
| TLS-based target positioning and tracking for active omni-directional sonobuoys |
| LI Tao,QU Yepin,MEI Fenghua |
| () |
| Abstract: |
| When using Least Square(LS) methods for active omni-directional sonobuoys target positioning， the result is often influenced by measurement errors.This paper proposes a new target positioning and tracking algorithm based on Total LS(TLS) algorithm. First,active omni-directional sonobuoy positioning equation is transformed to linear equation,then TLS algorithm is used to solve equation groups recursively by utilizing the randomicity of distance measurement errors and sonbuoy positioning errors.According to the physical constrains of submarine movement,the forecasted value of submarine moving model is chosen as the initial value of recursive process. This method smoothes the measurement error and achieves total optimal results. The simulation results indicate that this algorithm acquires excellent noise-resistance performance and mobile target tracking capabilities in contrast to LS method. |
| Key words: active omni-directional sonobuoy target positioning mobile target tracking measurement error total least square algorithm |
