三维纯角度极坐标目标运动分析算法

Three-dimensional bearing-only polar coordinate target motion analysis algorithm

现有纯角度极坐标目标运动分析算法仅适用于二维目标跟踪,无法直接用于三维空间的极坐标目标运动分析,为此提出一种新的三维纯角度极坐标目标运动分析算法。首先建立了三维极坐标伪线性方程,推导加权极坐标伪线性估计器;为减小估计偏差,通过引入工具变量矩阵消除系统矩阵与测量噪声的相关性,设计极坐标加权工具变量估计器。仿真结果表明,该算法在弱可观条件下能够精确估计目标运动参数,可用于三维极坐标目标跟踪初始化,具有很强的实用价值。

The existing polar coordinate bearing-only target motion analysis algorithm is only suitable for two-dimensional target tracking and cannot be directly applied for three-dimensional polar coordinate target motion analysis.Therefore,a new three-dimensional polar coordinate bearing-only target motion analysis algorithm is proposed.Firstly,the pseudo-linear equation of three-dimensional polar coordinates is established;then the weighted pseudo-linear estimator of polar coordinates is derived;finally,in order to reduce the estimation error,the instrumental variable matrix is introduced to eliminate the correlation between the system matrix and the measurement noise,and the polar coordinate weighted instrumental variable estimator is designed.The simulation results show that the algorithm can accurately estimate the target motion parameters under the condition of weak observability,and can be used for three-dimensional polar coordinate target tracking initialization,which has strong practical value.