[发明专利]多传感器无源协同测向定位方法

摘要

本发明提出了一种多传感器无源协同测向定位方法。利用本发明可显著地提高在多无源传感器观测值跳变、时间不同步、精度差异大的情况下对目标定位能力，实现对目标高精度协同测向定位。本发明通过下述技术方案予以实现在无源协同测向定位软件中，输入多传感器量测数据，利用预测残差对观测值进行野值判别，采用扩展遗忘因子递推最小二乘滤波算法外推到同一时刻；然后使用量测协方差矩阵计算加权矩阵，构建多传感器的观测线性方程组求解目标位置初始估计值，利用加权高斯牛顿下降法计算增量，并对目标位置进行迭代求解，再对增量的显著性检验统计量进行判决，当判决为估计收敛则退出迭代计算，输出此时迭代估计解作为最终目标定位信息。

主权项

一种多传感器无源协同测向定位方法，其特征在于包括如下步骤：以多传感器数据预处理模块、观测方程构建模块、加权矩阵计算模块、目标初始值估计模块、加权非线性最小二乘估计模块为单元构建多传感器无源协同测向定位软件架构；在无源协同测向定位软件中，输入多传感器量测数据，对多传感器数据进行预处理，通过多传感器数据预处理模块读入多传感器量测数据，计算预测残差v(k)＝z(k)‑H(k)Y(k|k‑1)，v(k)服从均值为零的高斯分布，利用预测残差v(k)对观测值z(k)进行判别野值并剔除野值，若v(k)≤μσ，则判为正常点，若v(k)＞μσ，则判为野值点，野值剔除后采用扩展遗忘因子递推最小二乘滤波算法进行滤波更新，再将每个传感器观测数据统一预测外推到同一时刻，同步多传感器观测数据；然后，利用观测极坐标与直角坐标系的关系，建立多传感器的非线性观测式h(X)；根据每个观测传感器的观测误差构建量测协方差矩阵，计算出加权矩阵和多传感器的观测线性方程组，并采用最小二乘估计方法求解目标位置的初始估计值；采用加权非线性最小二乘估计算法计算量测值残差，把非线性观测式进行泰勒级数展开，利用加权高斯牛顿下降法计算增量，对目标位置进行迭代求解，计算增量的显著性检验统计量，再对检验统计量进行判决，当判决为估计收敛则退出迭代计算，将此时迭代估计解作为最终目标定位信息，通过多传感器协同定位输出此时迭代估计解作为最终目标定位信息，从而实现对目标的协同测向定位，其中，z(k)为传感器第k次观测方位角θ或俯仰角H(k)为量测矩阵，Y(k|k‑1)为第k‑1次滤波值对第k次预测值，μ为常数，σ为传感器观测噪声标准差。