CN108717174A - 基于信息论的预测快速协方差交互融合无源协同定位方法 - Google Patents
基于信息论的预测快速协方差交互融合无源协同定位方法 Download PDFInfo
- Publication number
- CN108717174A CN108717174A CN201810288483.8A CN201810288483A CN108717174A CN 108717174 A CN108717174 A CN 108717174A CN 201810288483 A CN201810288483 A CN 201810288483A CN 108717174 A CN108717174 A CN 108717174A
- Authority
- CN
- China
- Prior art keywords
- indicate
- covariance
- frame
- kth
- state
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0257—Hybrid positioning
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明提出一种基于信息论的预测快速协方差交互融合无源协同定位方法。该方法首先构建两个接收站一个外辐射源的无源协同定位系统的数学模型。第二,两个接收站分别通过扩展卡尔曼滤波算法对目标状态分别进行预测更新。第三,根据信息理论优化准则,并将原先的融合状态估计考虑在内,可得到各个误差协方差之间的K‑L散度(Kullback‑Leibler Divergence),并提出预测快速协方差交互融合算法权值的闭式解的计算方法。最后,提出了预测快速协方差交互融合算法得到目标的状态估计。本发明能够在多接收站一个外辐射源的无源协同定位环境下,改善融合效果,提高目标跟踪精度,算法复杂度低。
Description
技术领域
本发明属于目标检测跟踪领域,涉及一种基于信息论的预测快速协方差交互融合无源协同定位方法(Information-theoretic criterion based predicted fastcovariance intersection algorithm in Passive Coherent Location,IT-PFCI-PCL)。
背景技术
无源协同定位(Passive Coherent Location,PCL)指的是雷达本身不发射电磁波,借助非合作外辐射源(如手机通信基站,数字电视信号基站等)发射的电磁波来检测跟踪目标。与传统的有源雷达相比,PCL系统部署灵活,低成本,抗干扰能力强,具有较强的生存能力。除此外,PCL系统利用双、多基站的空间分布性大幅提高了系统对低空和隐身目标的探测性能,受到了国内外学者的广泛关注。
与此同时,为了更加精确的实现跟踪定位,基于无源协同定位系统的航迹融合技术显得尤为重要。因此,寻找高效、实时可实现的基于无源协同定位系统的航迹融合算法具有较高的技术价值。集中式融合(centralized track fusion,CTF)计算复杂度高,对通信带宽的要求高。而信息矩阵融合(information matrix fusion,IMF)方法的跟踪精度有待提高。为了解决PCL系统中的航迹融合问题,本发明针对局部估计误差之间的互协方差未知的情况,提出了基于信息论的预测快速协方差交互融合无源协同定位方法(Information-theoretic criterion based predicted fast covariance intersection algorithminPassive Coherent Location,IT-PFCI-PCL)。本发明根据一种新的信息理论优化准则,得到权值有一个封闭解,并且将原先的融合状态估计和误差协方差考虑在内,通过预测协方差交互融合算法进行融合,得到目标状态。因为它不涉及非线性代价函数的优化,节省了大量的计算,而且本发明能够很好的应用于无源协同定位系统中。
发明内容
本发明的目的是针对无源协同定位系统的航迹融合问题,考虑局部估计误差之间的互协方差未知的情况,提出一种基于信息论的预测快速协方差交互融合无源协同定位方法,包括以下步骤:
步骤1:构建两个接收站、一个外辐射源的无源协同定位系统的数学模型。
步骤2:两个接收站分别通过扩展卡尔曼滤波算法对目标状态进行预测更新。
步骤3:根据信息理论优化准则,将原先的融合状态估计和误差协方差考虑在内,得到各个误差协方差之间的K-L散度(Kullback-Leibler Divergence),从而得到预测快速协方差交互融合算法权值的闭式解。
步骤4:通过预测快速协方差交互融合算法得到目标的状态。
在PCL系统中,集中式融合计算复杂度高,对通信带宽的要求高。而信息矩阵融合算法的跟踪精度有待提高。本发明能够在多接收站一个外辐射源的无源协同定位环境下,改善融合效果,提高目标跟踪精度,算法复杂度低。
附图说明
图1为本发明的流程图。
图2为PCL系统示意图。
图3为位置估计的均方根误差。
图4为速度估计的均方根误差。
具体实施方式
下面结合图1对本发明做进一步的分析。
具体算法步骤如下:
步骤1具体建立了二维空间中的两个接收站一个外辐射源的无源协同定位系统的数学模型。
考虑如图2所示的两个接收站和一个外辐射源的PCL系统,R1和R2分别表示接收站1和接收站2,T表示外辐射源,O表示目标,rOR1表示O与R1间的距离,rOR2表示O与R2间的距离,rOT表示O与T间的距离,rR1T表示R1与T间的距离,rR2T表示R2与T间的距离。
首先建立目标运动模型,记目标在第k帧的状态可以为:其中[x(k),y(k)]和分别表示第k帧目标在x,y方向的位置和速度。假设目标运动模型如下:
X(k)=FX(k-1)+V(k) (1)
式中为目标的状态转移矩阵,t表示采样间隔,V(k)~N(0,Q(k))为目标过程噪声,Q(k)为目标过程噪声协方差。
PCL系统中两个接收站的量测模型分别为:
其中:
式中,[xR1(k),yR1(k)],[xR2(k),yR2(k)]和[xT(k),yT(k)]分别表示R1,R2和T在第k帧的位置。量测噪声w1(k),w2(k)分别服从协方差为和的零均值高斯分布。
步骤2具体为两个接收站分别通过扩展卡尔曼滤波算法对目标状态进行预测更新。
在扩展卡尔曼滤波算法中,以接收站R1举例说明,只要给定初始状态和初始误差协方差就可以递推计算每一帧的状态估计值和误差协方差值。具体的递推过程如下:
1)状态一步预测方程:
其中表示接收站R1在第k-1帧对目标的状态一步预测,表示接收站R1在第k-1帧对目标的状态估计。
2)量测一步预测方程:
其中表示在第k-1帧接收站R1对目标状态一步预测的量测一步预测,而
3)新息和误差协方差预测:
其中Ψ(k)表示在第k帧的新息,表示在第k-1帧的预测误差协方差,表示在第k-1帧的误差协方差。FT表示状态转移矩阵F的转置,G表示噪声输入分布矩阵,GT表示噪声输入分布矩阵G的转置。
4)雅可比矩阵:
其中H(k)表示在第k帧的雅可比矩阵,表示当时,h1(k)对X(k)的微分。
5)新息协方差:
其中S(k)表示在第k帧的新息协方差,H(k)T表示雅可比矩阵H(k)的转置。
6)滤波增益:
其中W(k)表示在第k帧的滤波增益。
7)状态更新:
其中表示在第k帧接收站R1对目标状态更新后的状态估计值。
8)误差协方差更新:
其中表示在第k帧更新后的误差协方差值。W(k)T表示滤波增益W(k)的转置。
接收站R2的扩展卡尔曼滤波同公式(6)-(14),最终得到两个接收站分别对目标的状态更新和误差协方差更新
步骤3具体考虑原先融合航迹的状态估计和误差协方差,根据信息理论优化准则,得到各个误差协方差之间的K-L散度(Kullback-Leibler Divergence),从而得到预测快速协方差交互融合算法权值的闭式解。
由步骤2得到的两个接收站在第k帧的状态估计分别为误差协方差分别为假设为第k-1帧融合航迹的预测状态,PFCI(k|k-1)为第k-1帧融合航迹的预测误差协方差。在本发明中,当进行航迹融合时,考虑前一帧融合航迹的状态估计和误差协方差,则接收站1和2在第k帧的权值ω1(k|k),ω2(k|k)以及在第k-1帧融合航迹的预测权值ωF(k|k-1)分别如下:
其中:
式中D(PA,PB)表示两个误差协方差PA,PB之间的K-L散度:
其中:tr(·)表示求秩,表示PB的逆,表示PB行列式与PA行列式之比的自然对数,C1为常数。两个状态估计和之间的状态估计误差定义如下:
而:
其中表示状态估计误差的转置。
步骤(4)、通过预测协方差交互融合算法得到目标的状态。
将融合航迹中预测融合状态估计和预测误差协方差考虑在内,得到融合状态估计和误差协方差矩阵估计PFCI(k|k)如下:
ω1(k)+ω2(k)+ωF(k|k-1)=1 (27)
对本发明所提方法在无源协同定位系统中进行了仿真,如图3所示,可以看出三种方法的目标位置估计RMSE都收敛,且IT-PFCI-PCL融合方法的目标位置估计的均方根误差RMSE较信息矩阵融合与集中式融合低。如图4所示,IT-PFCI-PCL融合方法的目标速度估计的均方根误差RMSE较信息矩阵融合与集中式融合低。即在PCL系统中,IT-PFCI-PCL融合方法比信息矩阵融合与集中式融合精确度更高。
Claims (1)
1.基于信息论的预测快速协方差交互融合无源协同定位方法,其特征在于包括以下步骤:
步骤(1):构建两个接收站、一个外辐射源的无源协同定位系统的数学模型;
假定R1和R2分别表示接收站1和接收站2,T表示外辐射源,O表示目标,rOR1表示O与R1间的距离,rOR2表示O与R2间的距离,rOT表示O与T间的距离,rR1T表示R1与T间的距离,rR2T表示R2与T间的距离;
首先建立目标运动模型,记目标在第k帧的状态可以为:其中[x(k),y(k)]和分别表示第k帧目标在x,y方向的位置和速度;假设目标运动模型如下:
X(k)=FX(k-1)+V(k) (1)
式中为目标的状态转移矩阵,t表示采样间隔,V(k)~N(0,Q(k))为目标过程噪声,Q(k)为目标过程噪声协方差;
PCL系统中两个接收站的量测模型分别为:
其中:
式中,[xR1(k),yR1(k)],[xR2(k),yR2(k)]和[xT(k),yT(k)]分别表示R1,R2和T在第k帧的位置;量测噪声w1(k),w2(k)分别服从协方差为和的零均值高斯分布;
步骤(2):两个接收站分别通过扩展卡尔曼滤波算法对目标状态进行预测更新,具体是:
2.1 状态一步预测方程:
其中表示接收站R1在第k-1帧对目标的状态一步预测,表示接收站R1在第k-1帧对目标的状态估计;
2.2 量测一步预测方程:
其中表示在第k-1帧接收站R1对目标状态一步预测的量测一步预测,而
2.3 新息和误差协方差预测:
其中Ψ(k)表示在第k帧的新息,表示在第k-1帧的预测误差协方差,表示在第k-1帧的误差协方差;FT表示状态转移矩阵F的转置,G表示噪声输入分布矩阵,GT表示噪声输入分布矩阵G的转置;
2.4 雅可比矩阵:
其中H(k)表示在第k帧的雅可比矩阵,表示当时,h1(k)对X(k)的微分;
2.5 新息协方差:
其中S(k)表示在第k帧的新息协方差,H(k)T表示雅可比矩阵H(k)的转置;
2.6 滤波增益:
其中W(k)表示在第k帧的滤波增益;
2.7 状态更新:
其中表示在第k帧接收站R1对目标状态更新后的状态估计值;
2.8 误差协方差更新:
其中表示在第k帧更新后的误差协方差值;W(k)T表示滤波增益W(k)的转置;
根据步骤2.1-2.2获得接收站R1每一帧的状态估计值和误差协方差值;
接收站R2的扩展卡尔曼滤波参考上述接收站R1计算过程,最终得到两个接收站分别对目标的状态估计和误差协方差
步骤(3):考虑原先融合航迹的状态估计和误差协方差,根据信息理论优化准则,得到各个误差协方差之间的K-L散度(Kullback-Leibler Divergence),从而得到预测快速协方差交互融合算法权值的闭式解;
由步骤2得到的两个接收站在第k帧的状态估计分别为误差协方差分别为假设为第k-1帧融合航迹的预测状态,PFCI(k|k-1)为第k-1帧融合航迹的预测误差协方差;当进行航迹融合时,考虑前一帧融合航迹的状态估计和误差协方差,则接收站1和2在第k帧的权值ω1(k|k),ω2(k|k)以及在第k-1帧融合航迹的预测权值ωF(k|k-1)分别如下:
其中:
式中D(PA,PB)表示两个误差协方差PA,PB之间的K-L散度:
其中:tr(·)表示求秩,表示PB的逆,表示PB行列式与PA行列式之比的自然对数,C1为常数;两个状态估计和之间的状态估计误差定义如下:
而:
其中表示状态估计误差的转置;
步骤(4):通过预测协方差交互融合算法得到目标的状态,具体是:
将融合航迹中预测融合状态估计和预测误差协方差考虑在内,得到融合状态估计和误差协方差矩阵估计PFCI(k|k)如下:
ω1(k)+ω2(k)+ωF(k|k-1)=1 (27)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810288483.8A CN108717174B (zh) | 2018-04-03 | 2018-04-03 | 基于信息论的预测快速协方差交互融合无源协同定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810288483.8A CN108717174B (zh) | 2018-04-03 | 2018-04-03 | 基于信息论的预测快速协方差交互融合无源协同定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108717174A true CN108717174A (zh) | 2018-10-30 |
CN108717174B CN108717174B (zh) | 2020-11-06 |
Family
ID=63898659
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810288483.8A Active CN108717174B (zh) | 2018-04-03 | 2018-04-03 | 基于信息论的预测快速协方差交互融合无源协同定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108717174B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109656271A (zh) * | 2018-12-27 | 2019-04-19 | 杭州电子科技大学 | 一种基于数据关联思想的航迹软关联方法 |
CN110109162A (zh) * | 2019-03-26 | 2019-08-09 | 西安开阳微电子有限公司 | 一种gnss接收机自适应的卡尔曼滤波定位解算方法 |
CN110412531A (zh) * | 2019-07-10 | 2019-11-05 | 杭州电子科技大学 | 杂波情况下基于幅值信息的接收站路径优化方法 |
CN113008235A (zh) * | 2021-02-07 | 2021-06-22 | 西北工业大学 | 基于矩阵k-l散度的多源导航信息融合方法 |
CN114143804A (zh) * | 2021-02-02 | 2022-03-04 | 浙江机电职业技术学院 | 最大化测量信息增益的接收站路径优化方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104833949A (zh) * | 2015-05-11 | 2015-08-12 | 西北工业大学 | 一种基于改进距离参数化的多无人机协同无源定位方法 |
CN106526559A (zh) * | 2016-09-30 | 2017-03-22 | 杭州电子科技大学 | 一种基于bcd‑vsmm机动目标无源协同定位方法 |
WO2018024751A1 (fr) * | 2016-08-02 | 2018-02-08 | Thales | Systeme et procede global de geolocalisation a partir de mesures de distances et de positions d'ancres imprecises |
-
2018
- 2018-04-03 CN CN201810288483.8A patent/CN108717174B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104833949A (zh) * | 2015-05-11 | 2015-08-12 | 西北工业大学 | 一种基于改进距离参数化的多无人机协同无源定位方法 |
WO2018024751A1 (fr) * | 2016-08-02 | 2018-02-08 | Thales | Systeme et procede global de geolocalisation a partir de mesures de distances et de positions d'ancres imprecises |
CN106526559A (zh) * | 2016-09-30 | 2017-03-22 | 杭州电子科技大学 | 一种基于bcd‑vsmm机动目标无源协同定位方法 |
Non-Patent Citations (2)
Title |
---|
张沛男等: "基于DP-SA的机载外辐射源无源协同定位", 《航空学报》 * |
杨胜伟等: "基于FCD-VSMM的强机动目标无源协同定位算法", 《杭州电子科技大学学报(自然科学版)》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109656271A (zh) * | 2018-12-27 | 2019-04-19 | 杭州电子科技大学 | 一种基于数据关联思想的航迹软关联方法 |
CN109656271B (zh) * | 2018-12-27 | 2021-11-02 | 杭州电子科技大学 | 一种基于数据关联思想的航迹软关联方法 |
CN110109162A (zh) * | 2019-03-26 | 2019-08-09 | 西安开阳微电子有限公司 | 一种gnss接收机自适应的卡尔曼滤波定位解算方法 |
CN110109162B (zh) * | 2019-03-26 | 2021-06-11 | 西安开阳微电子有限公司 | 一种gnss接收机自适应的卡尔曼滤波定位解算方法 |
CN110412531A (zh) * | 2019-07-10 | 2019-11-05 | 杭州电子科技大学 | 杂波情况下基于幅值信息的接收站路径优化方法 |
CN110412531B (zh) * | 2019-07-10 | 2020-11-06 | 杭州电子科技大学 | 杂波情况下基于幅值信息的接收站路径优化方法 |
CN114143804A (zh) * | 2021-02-02 | 2022-03-04 | 浙江机电职业技术学院 | 最大化测量信息增益的接收站路径优化方法 |
CN113008235A (zh) * | 2021-02-07 | 2021-06-22 | 西北工业大学 | 基于矩阵k-l散度的多源导航信息融合方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108717174B (zh) | 2020-11-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108717174A (zh) | 基于信息论的预测快速协方差交互融合无源协同定位方法 | |
Hammes et al. | Robust mobile terminal tracking in NLOS environments based on data association | |
CN102622520B (zh) | 一种机动目标跟踪的分布式多模型估计融合方法 | |
CN112073895A (zh) | 一种基于csi高精度人员定位跟踪方法 | |
CN109782267B (zh) | 航迹关联方法及车载雷达 | |
CN105093198B (zh) | 一种分布式外辐射源雷达组网探测的航迹融合方法 | |
KR101628154B1 (ko) | 수신 신호 세기를 이용한 다중 표적 추적 방법 | |
CN101975575A (zh) | 基于粒子滤波的被动传感器多目标跟踪方法 | |
CN106526559A (zh) | 一种基于bcd‑vsmm机动目标无源协同定位方法 | |
Aernouts et al. | Combining TDoA and AoA with a particle filter in an outdoor LoRaWAN network | |
Liang et al. | Multi-Bernoulli filter for target tracking with multi-static Doppler only measurement | |
WO2016095694A1 (zh) | 一种存在传感器误差的改进源定位算法 | |
KR101627419B1 (ko) | 이동 노드의 위치 추정 방법 및 그 장치 | |
CN108871365A (zh) | 一种航向约束下的状态估计方法及系统 | |
Yin et al. | A novel distributed sensor fusion algorithm for RSSI-based location estimation using the unscented kalman filter | |
CN103476110A (zh) | 节点自定位与目标跟踪同时进行的分布式算法 | |
CN109239704A (zh) | 一种基于序贯滤波交互式多模型的自适应采样方法 | |
CN116630370A (zh) | 多模型pbp-tpmb机动扩展目标跟踪方法 | |
Ulmschneider et al. | Cooperative Estimation of Maps of Physical and Virtual Radio Transmitters | |
Gao et al. | An improved localization method in cyber-social environments with obstacles | |
CN111679270B (zh) | 一种反射点不确定场景下多路径融合目标检测算法 | |
Li et al. | An improved target tracking algorithm based on extended kalman filter for uav | |
Schlupkothen et al. | Multiple particle filtering for tracking wireless agents via Monte Carlo likelihood approximation | |
Thulasiraman et al. | Mobility estimation using an extended Kalman filter for unmanned ground vehicle networks | |
Lamberti et al. | Sequential Markov Chain Monte Carlo for multi-target tracking with correlated RSS measurements |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |