CN113219406A - 一种基于扩展卡尔曼滤波的直接跟踪方法 - Google Patents

一种基于扩展卡尔曼滤波的直接跟踪方法 Download PDF

Info

Publication number
CN113219406A
CN113219406A CN202110474005.8A CN202110474005A CN113219406A CN 113219406 A CN113219406 A CN 113219406A CN 202110474005 A CN202110474005 A CN 202110474005A CN 113219406 A CN113219406 A CN 113219406A
Authority
CN
China
Prior art keywords
target
state
matrix
vector
prediction
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
Application number
CN202110474005.8A
Other languages
English (en)
Other versions
CN113219406B (zh
Inventor
周瑶
许文杰
李万春
高林
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
University of Electronic Science and Technology of China
Original Assignee
University of Electronic Science and Technology of China
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by University of Electronic Science and Technology of China filed Critical University of Electronic Science and Technology of China
Priority to CN202110474005.8A priority Critical patent/CN113219406B/zh
Publication of CN113219406A publication Critical patent/CN113219406A/zh
Application granted granted Critical
Publication of CN113219406B publication Critical patent/CN113219406B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-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/0294Trajectory determination or predictive filtering, e.g. target tracking or Kalman filtering

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

本发明属于目标定位技术领域,具体涉及一种基于扩展卡尔曼滤波的直接跟踪方法。本发明的方案将目标状态(位置,速度)进行初始化作为输入,在满足可观测性的条件下,利用扩展卡尔曼滤波器进行状态更新,从而实现了从接收到的源信号中估计源位置的直接目标追踪。本发明可以准确估计出目标的位置和速度,方法简单,效果良好。

Description

一种基于扩展卡尔曼滤波的直接跟踪方法
技术领域
本发明属于目标定位技术领域,具体涉及一种基于扩展卡尔曼滤波的直接跟踪方法。
背景技术
卡尔曼滤波(Kalman filtering)是一种利用线性系统状态方程,通过系统输入输出观测数据,对系统状态进行最优估计的算法。虽然状态方程是线性模型,但测量模型是目标的非线性函数。扩展卡尔曼滤波(extended Kalman filtering)可以对非线性函数进行线性逼近,然后利用线性系统卡尔曼滤波的基本方程实现状态估计,采用扩展卡尔曼滤波跟踪目标状态。
使用传感器阵列的跟踪算法大多基于从传感器阵列获取的测量快拍块所产生的协方差。但是这些算法存在着一个显著的缺点,即计算复杂度很大,因为它需要在每次采样时处理一块测量,利用单快拍会极大地减小计算量。传统的定位方法使用两步方法,第一步测量到达时差(TDOA)和到达频率差(FDOA),第二步使用这些中间测量进行定位。由于差分时延和差分多普勒估计都是在第一步忽略了所有测量值必须与单点发射机地理位置一致的约束条件下得到的,因此两步方法不能保证很好的定位效果。因此,从TDOA/FDOA测量获得的位置线不能保证在单个位置相交。运动目标的定位是一个更加困难的任务,因为它不仅需要估计x和y两个定位参数,而且还需要估计速度和速度参数。结果表明,在两步法中,需要四维网格搜索来提供测量值。这种搜索算法计算量大,难以实时实现。另外,在利用扩展卡尔曼滤波器先跟踪波达方向(DOA)再跟踪纯方位目标的两步方法中。从状态方程和观测方程可以看出,与一步法相比,二步法不仅增加了噪声,而且损失了更多的信息。一些直接跟踪算法被提出,即直接从接收到的源信号中估计源位置,观测量是信号而不是二步法中的角度等。
发明内容
针对上述问题,本发明提出了一种基于扩展卡尔曼滤波的单目标直接跟踪方法。
本发明采用的技术方案是:
将M个均匀分布,间距为d的传感器阵列接收到的信号作为量测,对目标状态(位置,速度)进行初始化作为输入,在满足可观测性的条件下,利用扩展卡尔曼滤波器进行状态更新,从而实现了从接收到的源信号中估计源位置的直接目标追踪。
基于卡尔曼滤波的单目标直接跟踪方法,包括以下步骤:
S1、忽略多普勒效应、衰落效应和多径信号,均匀线阵接收到的目标信号用以下矢量形式表示:
z(t)=As(t)+n(t)
z(t)=[z1(t),z2(t),…zM(t)]T是M×1维阵列信号向量,s(t)是1×1维空间信号,n(t)=[n1(t),n2(t),…nM(t)]T是M×1维噪声向量。A=a(θ(t))是M×1维空间阵列流形矢量,其中,
a(θ(t))=[1 u u2…uM-1]T
上式中,
Figure BDA0003046406740000021
为了把信号和位置联系起来,我们将接收信号角度θ(t)写为
Figure BDA0003046406740000022
λ是波长,采样间隔是满足Nyquist定理的T,所以将采样后的测量表示为z(n)=z(nT),n=1,2,3…,为了方便,之后内容中的nT写为k,代表采样后的值。
在笛卡尔坐标系下目标的位置表示为(xt,yt),目标速度表示为
Figure BDA0003046406740000023
其中右上标t用来表示目标状态变量。相应地,观测传感器的位置和速度分别表示为(xo,yo)和
Figure BDA0003046406740000024
用右上标o来表示观测传感器状态。基于扩展卡尔曼滤波的直接跟踪问题就是估计
Figure BDA0003046406740000025
Figure BDA0003046406740000026
上标∧代表的是估计值。
S2、下面利用卡尔曼滤波的方法进行目标跟踪。
S21、x(k|k),x(k|k-1),k=0,1,2,3…,分别代表目标状态和目标状态预测值,P(k|k),P(k|k-1),k=0,1,2,3…,分别代表误差自相关矩阵和误差自相关矩阵预测值,首先对目标状态x和误差自相关矩阵P进行初始化:
Figure BDA0003046406740000027
Figure BDA0003046406740000031
其中,
θ=初始方位角
R=初始距离
Figure BDA0003046406740000032
Figure BDA0003046406740000033
然而,初始速度为零将导致强烈的发散行为。为了避免这种发散行为,将初始速度估计值设置为观测器的初始速度估计值。
Figure BDA0003046406740000034
S22、通过执行以下步骤获得预测状态x(k|k-1)和预测误差自相关矩阵P(k|k-1):
x(k|k-1)=Fx(k-1|k-1)
P(k|k-1)=FP(k-1|k-1)FT+GQGT
其中,
Figure BDA0003046406740000035
是状态转移矩阵。Q是系统状态噪声的自相关矩阵,G是状态噪声输入矩阵。
然后,利用预测状态能够获得预测阵列信号,阵列流形矢量A的预测值写为
Figure BDA0003046406740000041
空间信号s(k)的预测值
Figure BDA0003046406740000048
可以通过最大似然的方法获得:
Figure BDA0003046406740000042
Figure BDA0003046406740000043
其中z(k),k=1,2,3…代表接收信号的采样值。
最后,预测阵列信号写为:
Figure BDA0003046406740000044
S23、通过执行以下步骤获得新的状态x(k|k)和协方差P(k|k):
线性化测量模型如下:
z(k+1)=Hx(k)+w(k)
其中,w(k)是测量噪声,x(k)是目标状态向量,H是观测矩阵。
Figure BDA0003046406740000045
对状态向量求导获得的雅可比矩阵为H:
Figure BDA0003046406740000046
其中real(),imag()分别代表取实部、取虚部,
Figure BDA0003046406740000047
代表取偏导。
进一步可以写成:
Figure BDA0003046406740000051
其中,
Figure BDA0003046406740000052
Figure BDA0003046406740000053
Figure BDA0003046406740000054
Figure BDA0003046406740000055
卡尔曼增益矩阵K变为
Figure BDA0003046406740000056
其中,
Qe(k)=Q+H(k)P(k|k-1)HT(k)
其中,目标状态的更新如下:
Figure BDA0003046406740000057
相应地,误差自相关矩阵由下式给出
Figure BDA0003046406740000061
对上面的预测和更新过程进行k次,从而得到了k次目标的状态,实现目标的跟踪。
本发明的有益效果为可以准确估计出目标的状态,即位置和速度,方法简单,效果良好。
附图说明
图1为基于扩展卡尔曼的直接跟踪方法的仿真场景和一次目标典型跟踪轨迹图;
图2为SNR=6dB时目标位置误差和速度均方根误差图;
图3为SNR=0、2、4、6、8dB时目标位置误差和速度均方根误差图;
具体实施方式
下面结合实施例对本发明进行详细的描述:
采用500次蒙特卡罗模拟一个简单的跟踪场景。定义一个由M=10个均匀分布的传感器组成的阵列,信号功率
Figure BDA0003046406740000062
传感器距离d=1.5,载频fc=100MHz,考虑采样频率fs=200mHz,时间间隔ΔT=1分钟。我们在每个实验中模拟100步。
跟踪场景描述如下。观测传感器的轨迹可以分为三个阶段。一是匀速运动34分钟;第二,在五分钟内转动150°;第三,接下来的几分钟是匀速运动。观察者以3knots的恒定速度移动,而目标的速度为2knots(1knot=1.852km/h=0.514m/s)。初始距离5千米,方位80°,运动方向为140°。目标始终匀速运动,运动方向为-160°。
将目标的状态和误差自相关矩阵初始化为
Figure BDA0003046406740000063
Figure BDA0003046406740000064
对初始化目标状态(位置,速度)作为输入,利用扩展卡尔曼滤波器进行状态更新,从而实现从接收到的源信号中估计源位置的直接目标追踪。
单目标追踪效果:
为了验证目标跟踪特性,图1将一次目标追踪轨迹与原始目标轨迹画在一起,可以看出,在经过一段路程后,它们的轨迹基本重合,实现了目标跟踪。为了比较不同信噪比下估计误差的差异,图3选取SNR=0、2、4、6、8dB的不同值来描述不同情况下位置误差和速度误差的均方根(RMS),在50步的时候,均方根误差值非常小,位置和速度估计都能获得比较理想的估计。
通过对初始化目标状态(位置,速度)作为输入,利用扩展卡尔曼滤波器进行状态更新。由跟踪轨迹图和位置、速度均方根误差可以说明最终融合定位跟踪结果的准确性,也证实了本发明所提的基于扩展卡尔曼滤波的直接跟踪方法的有效性。

Claims (1)

1.一种基于扩展卡尔曼滤波的直接跟踪方法,采用M个均匀分布、间距为d的传感器阵列接收目标信号,其特征在于,所述直接跟踪方法包括以下步骤:
S1、忽略多普勒效应、衰落效应和多径信号,传感器阵列接收到的数据的矢量形式为:
z(t)=As(t)+n(t)
其中,z(t)=[z1(t),z2(t),…zM(t)]T是M×1维阵列信号向量,s(t)是1×1维空间信号,n(t)=[n1(t),n2(t),…nM(t)]T是M×1维噪声向量,A=a(θ(t))是M×1维空间阵列流形矢量,并且:
a(θ(t))=[1 u u2 … uM-1]T
其中
Figure FDA0003046406730000011
θ为方位角,λ是波长,令θ(t)为
Figure FDA0003046406730000012
其中,目标的位置为(xt,yt),传感器阵列的位置为(xo,yo),设置采样间隔为T,对传感器阵列接收到的数据进行采样得到采样数据为z(n)=z(nT);
S2、基于卡尔曼滤波的方法进行目标跟踪:
S21、令x(k|k)和x(k|k-1)分别代表目标状态和目标状态预测值,P(k|k)和P(k|k-1)分别代表误差自相关矩阵和误差自相关矩阵预测值,k=0,1,2,3…;对目标状态x和误差自相关矩阵P进行初始化,目标状态为目标的位置和速度:
Figure FDA0003046406730000013
Figure FDA0003046406730000014
其中,R为初始距离,目标的位置表示为
Figure FDA0003046406730000015
传感器阵列的速度表示为
Figure FDA0003046406730000016
Figure FDA0003046406730000017
为初始距离误差,
Figure FDA0003046406730000018
为初始速度误差;
S22、计算预测状态x(k|k-1)和协方差P(k|k-1):
x(k|k-1)=Fx(k-1|k-1)
P(k|k-1)=FP(k-1|k-1)FT+GQGT
其中,F是状态转移矩阵,Q是系统状态噪声的自相关矩阵,G是状态噪声输入矩阵;
利用预测状态获得预测阵列信号
Figure FDA0003046406730000021
Figure FDA0003046406730000022
其中,
Figure FDA0003046406730000023
Figure FDA0003046406730000024
其中z(k)代表接收信号的采样值,带上标∧的表示是估计值;
S23、线性化测量模型如下:
z(k+1)=Hx(k)+w(k)
其中,w(k)是测量噪声,x(k)是目标状态向量,H是观测矩阵,通过
Figure FDA0003046406730000025
对状态向量求导获得的雅可比矩阵为H:
Figure FDA0003046406730000026
其中real(),imag()分别代表取实部、取虚部,
Figure FDA0003046406730000027
代表取偏导;
进一步表示为:
Figure FDA0003046406730000031
其中,
Figure FDA0003046406730000032
Figure FDA0003046406730000033
Figure FDA0003046406730000034
Figure FDA0003046406730000035
卡尔曼增益矩阵K为:
Figure FDA0003046406730000036
Qe(k)=Q+H(k)P(k|k-1)HT(k)
目标状态的更新如下:
Figure FDA0003046406730000037
误差自相关矩阵更新如下:
Figure FDA0003046406730000038
对预测和更新过程进行k次,从而得到了k次目标的状态,实现目标的跟踪。
CN202110474005.8A 2021-04-29 2021-04-29 一种基于扩展卡尔曼滤波的直接跟踪方法 Active CN113219406B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110474005.8A CN113219406B (zh) 2021-04-29 2021-04-29 一种基于扩展卡尔曼滤波的直接跟踪方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110474005.8A CN113219406B (zh) 2021-04-29 2021-04-29 一种基于扩展卡尔曼滤波的直接跟踪方法

Publications (2)

Publication Number Publication Date
CN113219406A true CN113219406A (zh) 2021-08-06
CN113219406B CN113219406B (zh) 2022-08-05

Family

ID=77090187

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110474005.8A Active CN113219406B (zh) 2021-04-29 2021-04-29 一种基于扩展卡尔曼滤波的直接跟踪方法

Country Status (1)

Country Link
CN (1) CN113219406B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115932907A (zh) * 2022-12-16 2023-04-07 南京航空航天大学 基于卡尔曼滤波器和粒子群优化的单目标直接跟踪方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016061705A (ja) * 2014-09-19 2016-04-25 三菱電機株式会社 目標追尾装置
CN110471029A (zh) * 2019-08-16 2019-11-19 天津大学 一种基于扩展卡尔曼滤波的单站无源定位方法及装置
CN110503071A (zh) * 2019-08-29 2019-11-26 电子科技大学 基于变分贝叶斯标签多伯努利叠加模型的多目标跟踪方法
CN111708013A (zh) * 2020-07-01 2020-09-25 哈尔滨工业大学 一种距离坐标系目标跟踪滤波方法
CN111736144A (zh) * 2020-07-06 2020-10-02 哈尔滨工业大学 一种仅用距离观测的机动转弯目标状态估计方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016061705A (ja) * 2014-09-19 2016-04-25 三菱電機株式会社 目標追尾装置
CN110471029A (zh) * 2019-08-16 2019-11-19 天津大学 一种基于扩展卡尔曼滤波的单站无源定位方法及装置
CN110503071A (zh) * 2019-08-29 2019-11-26 电子科技大学 基于变分贝叶斯标签多伯努利叠加模型的多目标跟踪方法
CN111708013A (zh) * 2020-07-01 2020-09-25 哈尔滨工业大学 一种距离坐标系目标跟踪滤波方法
CN111736144A (zh) * 2020-07-06 2020-10-02 哈尔滨工业大学 一种仅用距离观测的机动转弯目标状态估计方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
孟祥飞: "基于扩展卡尔曼滤波算法的无源定位效果分析", 《电子科技》 *
张丽艳: "基于推广卡尔曼滤波的无源定位系统仿真", 《大连铁道学院学报》 *
李万春: "外辐射源定位跟踪技术的研究", 《中国博士学位论文全文数据库 信息科技辑》 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115932907A (zh) * 2022-12-16 2023-04-07 南京航空航天大学 基于卡尔曼滤波器和粒子群优化的单目标直接跟踪方法
CN115932907B (zh) * 2022-12-16 2024-02-13 南京航空航天大学 基于卡尔曼滤波器和粒子群优化的单目标直接跟踪方法

Also Published As

Publication number Publication date
CN113219406B (zh) 2022-08-05

Similar Documents

Publication Publication Date Title
CN105549049B (zh) 一种应用于gps导航的自适应卡尔曼滤波算法
CN107045125B (zh) 一种基于预测值量测转换的交互多模型雷达目标跟踪方法
CN108318856B (zh) 一种异构网络下快速精准的目标定位与跟踪方法
CN107102292B (zh) 一种基于贝叶斯方法的目标方位跟踪方法
CN110503071A (zh) 基于变分贝叶斯标签多伯努利叠加模型的多目标跟踪方法
CN102338870B (zh) 一种采用前向散射雷达的三维目标跟踪方法
CN110779519B (zh) 一种具有全局收敛性的水下航行器单信标定位方法
CN110209180B (zh) 一种基于HuberM-Cubature卡尔曼滤波的无人水下航行器目标跟踪方法
CN108663654B (zh) 一种基于连续量子鸽群的360度全方位动态测向方法
CN110794409A (zh) 一种可估计未知有效声速的水下单信标定位方法
CN108717174B (zh) 基于信息论的预测快速协方差交互融合无源协同定位方法
CN105044667A (zh) 一种运动目标的双星跟踪方法、装置和系统
CN108983169B (zh) 一种基于数字高程模型的米波雷达地形修正方法
CN104316945A (zh) 一种基于高阶累积量和无迹卡尔曼滤波的卫星干扰源三星定位方法
CN113219406B (zh) 一种基于扩展卡尔曼滤波的直接跟踪方法
CN111273269B (zh) 基于ipso-bp的频率分集阵列的雷达目标定位方法
CN110728026B (zh) 一种基于角速度量测的末端弹道目标被动跟踪方法
CN110595470A (zh) 一种基于外定界椭球集员估计的纯方位目标跟踪方法
CN109917330A (zh) 一种存在相位误差时基于稀疏正交匹配追踪理论的到达角估计方法
CN111190173B (zh) 一种基于预测值量测转换的相控阵雷达目标跟踪方法
Li et al. An improved target tracking algorithm based on extended kalman filter for uav
CN113923590A (zh) 一种锚节点位置不确定情况下的toa定位方法
CN112684411A (zh) 一种基于改进到达频率差的水下目标定位方法
CN115932907B (zh) 基于卡尔曼滤波器和粒子群优化的单目标直接跟踪方法
CN112241583A (zh) 一种最小化后验距离的传感器路径优化方法

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