基于EKF的毫米波雷达多目标跟踪算法研究

2024-01-21 来源：小奈知识网

2021年8月1日第44卷第15期

现代电子技术

ModernElectronicsTechniqueAug.2021Vol.44No.15引用格式：邱成，王浩，刘凤江，等.基于EKF的毫米波雷达多目标跟踪算法研究[J].现代电子技术，2021，44（15）：7⁃11.

DOI：10.16652/j.issn.1004⁃373x.2021.15.002

7基于EKF的毫米波雷达多目标跟踪算法研究

邱

成1，王

浩1，刘凤江2，白冬杰1，云

3.北京华航无线电测量研究所，北京

摘

峰3，李舒悦3，赵

100013）

川3

100076；

（1.北京交通大学机械与电子控制工程学院，北京100044；2.北京精密机电控制设备研究所，北京

要：针对车载毫米波雷达多目标跟踪过程中存在量测数据受噪声影响严重和跟踪目标运动状态为非线性的问题，

提出一种基于扩展卡尔曼滤波器（EKF）的车载毫米波雷达多目标跟踪算法。首先，建立了多目标跟踪过程中跟踪对象的数学模型；其次，介绍了多目标跟踪算法，并具体对扩展卡尔曼滤波器在该算法中的应用进行了详细的推导和研究；最后，开展了车载毫米波雷达多目标跟踪实验，并对跟踪结果作出了深入的理论分析。实验结果表明，该算法可以对车载毫米波雷达探测到的多个目标量测信息进行滤波跟踪。

关键词：多目标跟踪算法；毫米波雷达；数学模型；回波采集；道路环境感知；跟踪实验中图分类号：TN953+.6⁃34

文献标识码：A

文章编号：1004⁃373X（2021）15⁃0007⁃05

Researchonmillimeterwaveradarmulti⁃targettrackingalgorithmbasedonEKF

QIUCheng1，WANGHao1，LIUFengjiang2，BAIDongjie1，YUNFeng3，LIShuyue3，ZHAOChuan3

（1.SchoolofMechanical，ElectronicandControlEngineering，BeijingJiaotongUniversity，Beijing100044，China；2.BeijingResearchInstituteofPreciseMechanicalandElectronicControlEquipment，Beijing100076，China；

3.BeijingHuahangRadioMeasurementInstitute，Beijing100013，China）

Abstract：Sincethemeasureddataareseriouslyaffectedbynoiseandthemotionstateofthetrackedtargetisnonlinearinthemulti⁃targettrackingprocessofvehicle⁃mountedmillimeterwaveradar，amillimeterwaveradarmulti⁃targettrackingalgorithmbasedonextendedKalmanfilter（EKF）isproposed.Themathematicalmodelofthetrackedtargetinthemulti⁃targetdeducedandstudiedindetail.Themulti⁃targettrackingexperimentofthevehicle⁃mountedmillimeterwaveradarwascarriedalgorithmcanperformfilteringtrackingforthemeasuredinformationofthemultipletargetsdetectedbythemillimeterwaveradar.

trackingprocessisestablished.Themulti⁃targettrackingalgorithmisintroduced，andtheapplicationofEKFinthealgorithmisout.Atheoreticalanalysisofthetrackingresultsisperformedthoroughly.Theexperimentalresultsshowthattheproposed

Keywords：multi⁃targettrackingalgorithm；millimeterwaveradar；mathematicalmodel；echoacquisition；road

environmentperception；trackingexperiment

0引言

在车载毫米波雷达对多个目标车辆进行跟踪的过程中，需要从大量的噪声中提取出有效的量测数据。在同样的信噪比下，为了进一步提高跟踪精度，需要根据目标运动特性进行有效滤波。在线性系统中卡尔曼滤波器得到广泛应用，其滤波误差的均方阵可通过算法直接获得，是一种递推最优理论。然而，现实道路状况中，车辆的运行状态多为非线性的，致使卡尔曼滤波器有时难以对目标进行有效滤波。对于非线性滤波问题，至今也没有完善的解决办法。

针对以上分析，本文提出了基于扩展卡尔曼滤波器（ExtendedKalmanFilter，EKF）的毫米波雷达多目标跟踪算法，其主要运用扩展卡尔曼滤波器解决目标车辆非

伴随着大众对汽车主动安全问题的日益重视，车载毫米波雷达多目标跟踪也成为研究热点，其性能直接影响着整个车辆路况环境监测系统的可靠性。近年来，国内外科研人员围绕车载毫米波雷达进行了大量研究[1⁃8]。这些研究成果对车载毫米波雷达的发展起到了积极的推动作用。

收稿日期：2020⁃11⁃13修回日期：2020⁃11⁃27

基金项目：国家自然科学基金（51775033）

现代电子技术

2021年第44卷

线性运动状态的滤波问题，以实现车载毫米波雷达对多面。算法采用EKF状态估计方法，能够在线跟踪多个运动目标，且可以去除静止目标。多目标跟踪算法处理的详细流程如图1所示。

1跟踪对象的数学模型

1）状态方程

当汽车在道路上作匀速直线行驶时，离散系统中tk

时刻目标车辆的运动状态(xk,yk)为：

xk=x0+vxtk=x0+vxkTyk=y0+vytk=y0+vykT

（1）（2）

式中：(x0,y0)为跟踪目标的初始坐标；vx及vy分别为目T为采样时间。标对象沿两个方向的速度；

xk+1=xk+vxT=x0+xkT

按照递推形式改写，式（1），式（2）可以表示为：

（3）（4）（5）

yk+1=yk+vyT=y0+ykT

目标的状态方程可表示为：

X(k+1)=F(k)X(k)+V(k)

X(k)为状态向量；F(k)为转移矩阵；V(k)为系式中：

统过程噪声，并假设目标初始状态、系统过程噪声及量测噪声之间相互独立。

考虑目标运动过程中的控制信号，其状态方程可表示为：

X(k+1)=F(k)X(k)+G(k)u(k)+V(k)（6）

图1多目标跟踪算法处理的详细流程图

扩展卡尔曼滤波的实质是将非线性滤波问题近似转化为线性滤波问题，以此可以参照卡尔曼滤波过程来解决工程上的非线性问题，是应对非线性滤波问题较为可行的方法[9⁃12]。

考虑到实际情况中车载毫米波雷达多目标跟踪对计算量的要求，其计算过程如下：

状态的一步预测：

X(k+1|k)=F(k)X(k|k)协方差的一步预测：量测的一步预测：

（9）

利用增加状态向量维数的方法，可以进一步提高估计的准确性，但也会造成计算量相继变大的缺点。因而，在符合要求的前提下，尽可能选择简易模型。

2）量测方程

雷达对测量过程的假设，用量测方程可表示为：

Z(k)=H(k)X(k)+W(k)

（7）

式中：Z(k)为量测向量；H(k)为量测矩阵；W(k)为量测噪声，通常认为量测噪声服从高斯分布，其协方差用R(k)表示。

假设量测噪声和过程噪声序列互不相关，且系统的初始协方差矩阵为P(0|0)，初始状态估计为X(0|0)。与线性情况类似，假设k时刻的估计为：

X(k|k)≈E[X(k)|Zk]（8）

P(k+1|k)=F(k)P(k|k)FT(k)+Q(k)（10）

(k+1|k)=hk+1,X(k+1|k)Z

量测预测协方差的计算：

[]（11）

它不是一个近似的条件均值，其相伴协方差矩阵为

所以，P(k|k)。因为X(k|k)是非精确的条件均值，P(k|k)是近似的均方误差，而非协方差。但是，通常

S(k+1)=hX(k+1)P(k+1|k)hTX(k+1)+R(k+1)

（12）

增益的计算：

状态的更新：

X(k+1|k+1)=X(k+1|k)+K(k+1)⋅

协方差的更新：

-1

K(k+1)=P(k+1|k)hT(k+1)（13）X(k+1)S

还是称其为协方差。

2多目标跟踪算法

车载毫米波雷达多目标跟踪算法主要包括航迹起

{Z(k+1)-h[k+1,X(k+1|k)]}（14）

始、航迹数据关联、航迹跟踪滤波、航迹管理等几个方

邱成，等：基于EKF的毫米波雷达多目标跟踪算法研究9

P(k+1|k+1)=[I-K(k+1)hX(k+1)]P(k+1|k)⋅

目标，其返回波的能量幅值高于真实目标，致使在跟踪过程中将其当作是静止的车辆目标。

在单个目标车辆驶近雷达之后，将其按照30km/h的速度远离雷达，在此过程对目标车辆进行跟踪，图4为具体跟踪结果。从跟踪结果可以看出，当前算法可以实现对目标的跟踪。在雷达开机过程中，有一未知目标出现在雷达探测范围内，但由于所探测到的不连续点迹未达到跟踪条件，算法未对其进行跟踪。

[I+K(k+1)h

(k+1)]-K(k+1)R(k+1)KT(k+1)

（15）

式中I是与协方差相对应的单位矩阵。

3.1

实验与分析

车载实验所用的毫米波雷达为MFSK雷达，通过工实验情况简介

装安装在实验车辆的尾部。图2给出了毫米波雷达的车载安装图。

图3单车30km/h动态接近回波

采集跟踪结果图

图2毫米波雷达的车载安装图

本实验共设置了4种实验情景，分别就单目标车辆和双目标车辆在远离和接近车载毫米波雷达的过程中进行了回波采集，以获取目标车辆的距离、速度、角度等信息。实验参数设置如表1所示。

表1实验参数设置

实验情景实验情景1实验情景2

目标车辆单车单车双车

实验情景3

双车双车双车

运动状态接近远离接近接近远离远离

间距/m——10201020速度（/km/h）

303030303030图4单车30km/h动态远离回波

采集跟踪结果图

图5和图6为双车以30km/h的车速进行动态接近回波采集，目前算法能够对目标进行跟踪。但由于在跟踪过程中，雷达在部分区域未探测到连续点迹，导致有部分航迹缺失。

图7和图8为双车以30km/h的车速进行动态远离回波采集，目前算法能够对目标进行跟踪。但是，双车间距10m跟踪时，近距离航迹偏离目标实际位置；双车间距20m跟踪时，部分区域未完全形成连续航迹。

以上雷达多目标跟踪结果均表明，扩展卡尔曼滤波器能对目标进行跟踪滤波。但部分区域未形成连续航迹，近距离跟踪时甚至可能会导致目标航迹提前终结。

实验情景4

3.2

单个目标车辆从远处以30km/h的速度向雷达驶

实验结果分析

近，对此过程中的目标车辆进行跟踪，跟踪结果如图3所示。可以看出，当前算法可以实现对目标车辆的跟踪。但在跟踪过程中，位于50m左右的地方存在未知

现代电子技术

2021年第44卷

的值存在较大的误差，而在角度矫正公式中：

参数α及β的大小是依据经验值而定，使得矫正后的角度相比其真实值仍存在较大误差，难以满足要求。

Angle(i)=α*Angle(i)-β

方差和角度测量误差方差的值选取困难，造成量测噪声协方差矩阵的初始状态与其真实值有较大的误差，从而导致预测偏差较大的问题。

1）量测噪声协方差矩阵的计算中，距离测量误差（16）

图8双车（间距20m）30km/动态远离回波

图5双车（间距10m）30km/h动态接近回波

采集跟踪结果图

卡尔曼滤波器的使用过程中，其稳定性和状态估计精度受到了过程中潜在的非线性因素的较大影响，而噪声的统计特性也会对其滤波效果产生影响。在滤波过程中，量测噪声协方差R(k)和过程噪声协方差Q(k)均不发生变化，假设两矩阵预先估计的准确度不高，将会在后续过程引起误差累计，进而影响整个过程，产生滤波发散。

hX(k+1)进行展开，在这个过程中对其高阶项的忽略，

3）扩展卡尔曼协方差矩阵初值选取困难。在扩展

4）运用泰勒级数展开的方法，对雅克比矩阵

也可能是滤波发散的原因。

图6双车（间距20m）30km/h动态接近回波

采集跟踪结果图

4结语

本文针对非线性系统，对扩展卡尔曼滤波算法的滤波过程及其滤波参数计算进行了推导，结合航迹起始、航迹数据关联、航迹管理等算法，提出了一种基于扩展卡尔曼滤波器的车载毫米波雷达多目标跟踪算法，并设计实验对其滤波跟踪效果进行了验证。通过实验结果可知，该算法可以对车载毫米波雷达探测到的目标车辆信息进行跟踪滤波，但仍然存在一些需要完善的地方，这也是下一步的研究内容。

参图7双车（间距10m）30km/h动态远离回波

采集跟踪结果图

考文献[1]KIMDB，HONGSM.Multiple⁃targettrackingandtrackmana⁃gementforanFMCWradarnetwork[J].EURASIPjournalonadvancesinsignalprocessing，2013（1）：1⁃9.接影响量测矩阵。但是由于雷达的测量精度有限，两者

2）在实际的滤波过程中，距离和角度的精度会直

邱成，等：基于EKF的毫米波雷达多目标跟踪算法研究

2014：431⁃438.11

（9）：1⁃20.detectionapplications[J].Sensors（Switzerland），2018，18telligentTransportationSystems.NewYork：IEEEPress，[9]XUYJ.ApplicationofextendedKalmanfilteringalgorithmin[3]ZHAIGY，WUC，WANGYM.Targettrackingbasedonmil⁃limeterwaveradarincomplexscenes[J].Internationaljournalofperformabilityengineering，2018，14（2）：232⁃244.multi⁃sensorinformationfusion[C]//The9thInternationalCon⁃ferenceonComputerScience&Education.NewYork：IEEEPress，2014：687⁃691.[4]SONGXS，DUY.ObstacletrackingbasedonmillimeterwaveandInformatics.NewYork：IEEEPress，2016：531⁃535.radar[C]//The20163rdInternationalConferenceonSystems[10]ILLANGARATHNENC，DINESHCHINTHAKAMKC.Ob⁃

jectsensing，trackingandreconstructingusingextendedKal⁃manfilteralgorithm[C]//201411thInternationalConference

[5]ZHAIGY，WUC，WANGYM.MillimeterwaveradartargettrackingbasedonadaptiveKalmanfilter[C]//2018IEEEIntel⁃453⁃458.ligentVehiclesSymposium.NewYork：IEEEPress，2018：[6]WANGX，CHENGJY.Robustmulti⁃targettrackingalgorithm07].https：//www.researchgate.net/publication/326880204.多目标跟踪算法[J].机电一体化，2017，23（12）：32⁃37.onElectricalEngineering/Electronics，Computer，Telecommu⁃nicationsandInformationTechnology.NewYork：IEEE[11]YAOJ，LIUYC，CHENYY，etal.Multiplemaneuvering

Press，2014：1⁃6.

basedonautomotivemillimeter⁃waveradar[EB/OL].[2018⁃08⁃targettrackingbasedonextendedKalmanfilter[C]//20182018：3763⁃3766.

[7]黄文奎，罗峰，胡凤鉴.一种Kalman最近邻的智能汽车传感器[8]ZINDLERK，GEIßN，DOLLK，etal.Real⁃timeego⁃motionChineseAutomationCongress.NewYork：IEEEPress，[12]LIUGR，ZHOUMZ，WANGLL，etal.Ablindspotdetec⁃

tionandwarningsystembasedonmillimeterwaveradarfordriverassistance[J].Optik⁃internationaljournalforlightandelectronoptics，2017，135：353⁃365.

estimationusingLidarandavehiclemodelbasedextendedKal⁃manfilter[C]//2014IEEE17thInternationalConferenceonIn⁃作者简介：邱

王

成（1973—），男，吉林吉林人，硕士，副教授，研究方向为机电系统建模与先进控制、智能监控技术、嵌入式系统与浩（1996—），男，山东潍坊人，硕士研究生，研究方向为机电系统建模与先进控制、嵌入式系统与智能仪器仪表等。

智能仪器仪表等。

刘凤江（1981—），男，吉林扶余人，硕士，高级工程师，研究方向为伺服系统制造技术等。

白冬杰（1993—），男，山西汾阳人，硕士研究生，研究方向为毫米波雷达多目标跟踪算法、嵌入式系统软件等。云赵

峰（1988—），男，内蒙古呼和浩特人，硕士，高级工程师，研究方向为雷达系统设计、数字信号并行处理技术等。川（1986—），男，江苏南通人，硕士，工程师，研究方向为雷达射频电路及天线等。

李舒悦（1990—），女，河北唐山人，硕士，工程师，研究方向为雷达多目标跟踪算法、电磁跟踪技术等。

因篇幅问题不能全部显示，请点此查看更多更全内容

查看全文

全部栏目

基于EKF的毫米波雷达多目标跟踪算法研究