[发明专利]一种基于序贯处理的主被动航迹运动特征关联方法有效
申请号: | 202010533431.X | 申请日: | 2020-06-12 |
公开(公告)号: | CN111829506B | 公开(公告)日: | 2021-05-14 |
发明(设计)人: | 陆翔;周恒亮;郑庆琳;田田;张宁 | 申请(专利权)人: | 中国船舶重工集团公司第七二四研究所 |
主分类号: | G01C21/00 | 分类号: | G01C21/00 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 210003 *** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 处理 被动 航迹 运动 特征 关联 方法 | ||
1.一种基于序贯处理的主被动航迹运动特征关联方法,其特征在于:
步骤1:观测空间划分为12个扇区;从所述扇区中选择一个扇区,从该扇区内选择一条主动传感器输出的目标航迹和一条被动传感器输出的航迹,组成待关联判决航迹对;
步骤2:选择上述一组待关联判决航迹对,选择待关联判决航迹对中的被动传感器观测到的目标航迹的最近一次观测获得的观测航迹点,记为航迹点P1,并将所述观测航迹点的观测时间作为基准时间,选择主动传感器观测到的航迹中与所述基准时间最接近的观测航迹点,记为航迹点P2,将航迹点P1和航迹点P2构成一组时间预配准航迹点,将航迹点P1的观测时间与航迹点P2的观测时间的差记为Tdelta;记被动传感器观测航迹中记录的观测航迹点的时间间隔为T1,记主动传感器观测航迹中记录的观测航迹点的时间间隔为T2,令Tmax=max(T1,T2);当Tdelta小于2×Tmax时,将航迹点P1和航迹点P2构成一组时间配准航迹点;当Tdelta大于等于2×Tmax时,外推航迹点P2获得航迹点P′2,将航迹点P1和航迹点P′2构成一组时间配准航迹点;所述的外推航迹点P2获得航迹点P2′的方法如下:将航迹点P2前一次观测的航迹点位置向量记为将航迹点P2位置向量记为则外推航迹点P′2的位置向量
步骤3:按照下述公式将主动传感器的观测结果由观测域内极坐标系下距离ρ、方位θ、俯仰表示,转换为转换域内笛卡尔坐标系下x、y、z表示:
其中,
针对第n次观测,按照下述公式,计算主动传感器目标状态估计、主动传感器目标状态估计协方差矩阵:
P(n|n-1)=A(n-1)P(n-1|n-1)AH(n-1)+Q(n)
P(n|n)=[I-K(n)C(n)]P(n|n-1);
其中:
为预先设定的观测扰动量;
K(n)=P(n|n-1)CH(n)[C(n)P(n|n-1)CH(n)]-1;
观测域内主动传感器目标状态估计y(k)及观测域内主动传感器观测结果协方差计算方法如下述公式所示:
y(k)=[g1,g2,g3,g4,g5]′;
其中:
其中表示x、y、z的导数;
将主动传感器目标状态估计记为:
将主动传感器目标状态估计协方差矩阵记为:
步骤4:将被动传感器观测结果表示为其中,Xok为地心-地固坐标系下表示的第k次观测的观测位置,ζ目标为被动传感器状态转移向量在修正极坐标系下的表示,记为:
按照下述公式,计算被动传感器目标状态估计、被动传感器目标状态估计协方差矩阵:
步骤4.1:计算Ei:
步骤4.2:计算Ei,b:
其中:
Wk-1=N(0,Q(T1))
uk-1=Xk-F(T1)Xok-1;
T1为被动传感器观测航迹中记录的观测航迹点的时间间隔;
将笛卡尔坐标系下的坐标转换为修正球坐标系下的坐标;
将修正球坐标系下的坐标转换为笛卡尔坐标系下的坐标;
步骤4.3:计算wi:
其中,k为任意值;
步骤4.4:计算ηk|k-1:
步骤4.5:计算Pk|k-1:
步骤4.6:计算量测预测协方差Sk:
H=[0,0,0,1,1,0];
Sk=HPk|k-1H'+R;
步骤4.7:计算Kk:
Kk=Pk|k-1H'Sk-1;
步骤4.8:计算预处理后被动传感器观测结果ηk|k:
ηk|k=ηk|k-1+kk(zk-Hηk|k-1);
步骤4.9:计算被动传感器观测结果的协方差矩阵Pk|k:
Pk|k=Pk|k-1-kkSkkk';
将被动传感器目标状态估计记为:
将被动传感器目标状态估计协方差矩阵记为:
步骤5:按照下述公式,构造主被动传感器关联判决统计量T:
其中,N为用于关联判决的航迹点的个数,
按照下述公式,设置基于运动特征相关性的关联判决门限λ;
其中p为设定的拒绝域显著水平;
按照下述公式,执行基于运动特征相关性的关联判决,若:
则判断待关联判决航迹对中的两个航迹关联;反之,则判断待关联判决航迹对中的两个航迹不关联。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国船舶重工集团公司第七二四研究所,未经中国船舶重工集团公司第七二四研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010533431.X/1.html,转载请声明来源钻瓜专利网。