CN112034445A - 基于毫米波雷达的车辆运动轨迹跟踪方法和系统 - Google Patents
基于毫米波雷达的车辆运动轨迹跟踪方法和系统 Download PDFInfo
- Publication number
- CN112034445A CN112034445A CN202010824302.6A CN202010824302A CN112034445A CN 112034445 A CN112034445 A CN 112034445A CN 202010824302 A CN202010824302 A CN 202010824302A CN 112034445 A CN112034445 A CN 112034445A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- state
- particle
- time
- weight
- 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
Images
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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
- G01S13/50—Systems of measurement based on relative movement of target
- G01S13/58—Velocity or trajectory determination systems; Sense-of-movement determination systems
- G01S13/589—Velocity or trajectory determination systems; Sense-of-movement determination systems measuring the velocity vector
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
- G01S7/41—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00 using analysis of echo signal for target characterisation; Target signature; Target cross-section
- G01S7/415—Identification of targets based on measurements of movement associated with the target
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Computational Mathematics (AREA)
- Mathematical Optimization (AREA)
- Computer Networks & Wireless Communication (AREA)
- Pure & Applied Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Theoretical Computer Science (AREA)
- Computing Systems (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开了一种基于毫米波雷达的车辆运动轨迹跟踪方法和系统,毫米波雷达实时获取车辆与雷达的距离、车辆相对于雷达的方位角和径向速度,其中跟踪方法包括:1、建立车辆状态转移方程和状态观测方程;2、获取车辆初始状态;设置粒子群并初始化每个粒子的状态;3、根据当前时刻毫米波雷达获取到的车辆观测量对粒子群进行第一次更新;4、对粒子群进行重新采样做第二次更新;5、根据第二次更新后的粒子权重和状态,计算当前时刻k车辆的状态估计,得到当前时刻车辆的位置和速度;6、跳转至步骤3进行下一时刻的车辆跟踪。该方法可以显著降低车辆观测数据中具有随机性和间歇性野值对车辆状态估计的影响,具有较强的抗奇异值能力。
Description
技术领域
本发明属于目标跟踪定位技术领域,具体涉及一种车辆行驶中的跟踪方法和系统。
背景技术
随着汽车工业的飞速发展和人民生活水平的提高,汽车已然成为生活中必不可少的一部分,因此日益增加的汽车数量所带来的安全问题就越来越受到人们的关注。为了帮助人们判断行车情况,同时也为自动驾驶护航,高级驾驶辅助系统(Advanced DrivingAssistant System,ADAS)被引入大众的视野。ADAS利用安装在车上各式各样的传感器(如:毫米波雷达、激光雷达、单\双目摄像头以及卫星导航)收集环境信息以分析实时环境,其中车载毫米波雷达不易受到目标表面形状和颜色的影响,也不受天时天候的阻碍,具有环境适应性强,探测性能稳定的特点,是汽车安全技术的研究热点。在车辆A上安装车载毫米波雷达,对毫米波雷达发射波及回波的处理可以获取车辆A周围其他车辆相对于车辆A的大致距离、径向速度和方位角,在复杂的环境中如何利用这三个观测量准确跟踪目标车辆的行进轨迹是一个极富挑战性的研究课题。
考虑到现有毫米波器件、集成技术和相关的信号处理和解决方案尚且没有完全成熟,现有目标跟踪相关技术存在以下问题:传统的目标跟踪一般用卡尔曼滤波实现,这一滤波算法只有针对线性模型且在观测噪声和状态转移噪声均服从高斯分布的时候才是最优的。
大多数应用中针对非线性模型采用扩展卡尔曼滤波算法实现目标跟踪,即在短时间内将模型视为线性模型,然后利用线性卡尔曼滤波算法解决。该方法在做局部线性化时损失了一定的精度,尤其对于非线性度很强的模型,这样的算法往往跟踪效果不佳。
而且,传感器的观测噪声往往不服从高斯分布,其中一种典型的情况就是观测量中存在奇异值(或者叫野值),其分布不满足高斯分布,这样的奇异值可能来源于实时情景中的目标遮挡或车辆突发抖动,针对这种情况,传统滤波算法的跟踪效果较差。
以上所述非线性模型的处理和非高斯观测噪声的存在都对目标跟踪算法提出了巨大的挑战。
发明内容
发明目的:针对现有技术中存在的问题,本发明提供了一种基于毫米波雷达的车辆运动轨迹跟踪方法,该方法可以显著降低车辆观测数据中具有随机性和间歇性野值对车辆状态估计的影响,具有较强的抗奇异值能力。
技术方案:本发明一方面公开了一种基于毫米波雷达的车辆运动轨迹跟踪方法,所述毫米波雷达用于实时获取车辆与雷达的距离、车辆相对于雷达的方位角和径向速度;包括:
(1)建立车辆状态转移方程:
其中为k时刻车辆的状态量,xk、yk表示k时刻车辆相对于雷达的横、纵坐标,表示k时刻车辆相对于雷达的横、纵向速度;f(·)为状态转移函数,A为状态转移矩阵,Δt表示毫米波雷达的观测时间间隔,sk为状态转移噪声,服从零均值、协方差为Q的高斯分布,即
建立车辆状态观测方程:
其中rk、ak、vk分别为k时刻毫米波雷达获取的车辆与雷达的距离、车辆相对于雷达的方位角和径向速度;h(·)为观测函数;ok为观测噪声,服从零均值、协方差为R/Wk的高斯分布,即R为观测噪声协方差常数矩阵;Wk为观测噪声协方差权重矩阵,Wk=diag([wk,1,wk,2,wk,3]),每一权值wk,m均服从Gamma分布,即
(2)给定车辆初始状态的期望<Φ0>;产生包含S个粒子的集合,所述粒子集中第s个粒子在第k时刻的状态用S表示;以<Φ0>为均值,Q为协方差的高斯分布随机初始化粒子群中每一个粒子的状态为及其权重为初始时刻表示为k=0;
(5)根据第二次更新后的粒子权重和状态,计算当前k时刻车辆的状态估计<Φk>,得到当前时刻k车辆相对于毫米波雷达的位置和速度;
(6)跳转至步骤(3)进行下一时刻的车辆跟踪。
将k时刻观测噪声协方差权重矩阵Wk视为时变参数矩阵是,所述步骤(3)可以采用如下步骤对粒子权重做第一次更新:
(3.1)将k时刻观测噪声协方差权重矩阵Wk视为时变参数矩阵,用EM算法估算Wk的估计值<Wk>:
<Wk>=diag([<wk,1>,<wk,2>,<wk,3>]);
(3.2)观测量zk的概率密度函数为:
(3.3)粒子权重第一次更新的递推公式为:
将Wk视为与θk相互独立的变量时,所述步骤(3)可以采用如下步骤对粒子权重做第一次更新:
(3.2′)粒子权重第一次更新的递推公式为:
所述步骤(4)具体包括:
构建累积和序列ψk,ψk=[ψk,0,ψk,1,...,ψk,S],其中ψk,0=0,ψk,S=1;ψk中相邻两个元素构成一个区间,总共有S个区间;
(4.3)构建等差数列D=[d1,d2,…,dS],其中的第s个元素可以表示为:统计数列D中的每一个元素ds,位于ψk所构成的S个区间中的区间序号数,记为Is,s=1,...,S,构成序列I=[I1,I2,…,IS];
所述步骤(5)采用如下方式计算当前时刻k车辆相对于毫米波雷达的状态估计<Φk>:
<Φk>中的元素依次为当前时刻k车辆相对于毫米波雷达的横、纵坐标和横、纵向速度。
本发明还公开了实现上述车辆运动轨迹跟踪方法的系统,包括:
车辆跟踪模型建立模块,用于建立车辆状态转移方程和状态观测方法;
初始化模块,用于获取车辆的初始状态,设置粒子群中粒子的初始状态;
粒子群第一次更新模块,用于根据当前时刻k毫米波雷达获取到的车辆观测量zk对粒子群进行第一次更新;
粒子群第二次更新模块,用于对粒子群进行重新采样做第二次更新;
车辆状态估计模块,用于根据第二次更新后的粒子权重和状态,计算当前时刻k车辆的状态估计,得到当前时刻k车辆的位置和速度。
有益效果:与现有技术相比,本发明公开的车辆运动轨迹跟踪方法具有以下优点:1、本发明通过对车辆状态观测方程中的观测噪声所服从的高斯分布的协方差引入重权值Wk,根据Wk的变化推导出实时观测结果的后验分布,从而引导粒子权重向更稳健的趋势更新,奇异值出现时观测结果对粒子权重计算的贡献会降低,因此估计系统状态时受奇异值影响较小,从而提高了粒子滤波的跟踪性能;2、由于引入权值向量而非单一权值,使得同一时刻毫米波雷达获得的不同维度观测量不会互相影响,某一维度出现的奇异值不会使得其他维度的观测对粒子权重计算的贡献同时受到抑制,进而更进一步地提高了算法的跟踪性能。
附图说明
图1为本发明公开的车辆运动轨迹跟踪方法的流程图;
图2为实施例1中车辆运动轨迹和雷达的理论观测结果图;
图3为实施例1中车辆运动轨迹和观测噪声服从高斯分布时的观测结果图;
图4为实施例1中跟踪轨迹与实际轨迹的对比图;
图5为实施例2中车辆运动轨迹和观测噪声服从t分布时的观测结果图;
图6为实施例2中跟踪轨迹与实际轨迹的对比图;
图7为本发明公开的车辆运动轨迹跟踪系统的组成示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面结合附图对本发明的具体实施案例做说明。
实施例1:
本发明公开了一种基于毫米波雷达的车辆运动轨迹跟踪方法,所述毫米波雷达用于实时获取车辆与雷达的距离、车辆相对于雷达的方位角和径向速度;如图1所示,包括如下步骤:
步骤1、建立车辆状态转移方程:
其中为k时刻车辆的状态量,其维度N=4,即Φk∈R4,xk、yk表示k时刻车辆相对于雷达的横、纵坐标,表示k时刻车辆相对于雷达的横、纵向速度;f(·)为状态转移函数,A为状态转移矩阵,△t表示毫米波雷达的观测时间间隔,本实施例中本例中△t=0.005s,sk为状态转移噪声,sk∈R4,服从零均值、协方差为Q的高斯分布,即
建立车辆状态观测方程:
其中rk、ak、vk分别为k时刻毫米波雷达获取的车辆与雷达的距离、车辆相对于雷达的方位角和径向速度,即观测量的维度M=3,zk∈R3;h(·)为观测函数;ok为观测噪声,服从零均值、协方差为R/Wk的高斯分布,即ok∈R3,R为观测噪声协方差常数矩阵;Wk为观测噪声协方差权重矩阵,R和Q的值可以根据实际情况调整,本实施例中取值为:Q=diag([0.001,0.001,0.1,0.1]),R=diag([10,0.001,2])。
Wk为对角阵,Wk=diag([wk,1,wk,2,wk,3]),每一权值wk,m均服从Gamma分布,即本实施例中vm统一取值2,可以很好地处理经常出现奇异值的情形,如果奇异值出现的概率较小,则可以适当增大vm的值。
步骤2、给定车辆初始状态的期望<Φ0>;设置包括S个粒子的粒子群,所述粒子群中第s个粒子在k时刻的状态为以<Φ0>为均值,Q为协方差的高斯分布随机初始化粒子群中粒子群中每一个粒子的状态为及其权重为<Φ0>为车辆初始状态的期望;初始时刻表示为k=0;
本实施例中,粒子群规模为1000,即S=1000。粒子数量S越大,算法的精度越高,但同时计算量也会相应的增大,影响实时应用,反之粒子数越少则运算量也越少,对硬件计算速度的要求越低。因此得根据实际应用需求权衡S的取值,从而获得计算精度和速度上的最佳平衡。如图2所示,图2-(a)为本实施例中车辆的实际运动轨迹,图2-(b)、图2-(c)、图2-(d)分别为雷达对距离、方位角、径向速度的理想观测结果。
步骤3、令k=k+1,根据当前k时刻毫米波雷达获取到的车辆观测量zk对粒子群进行第一次更新;
根据贝叶斯方法,有如下后验期望计算:
其中Φ0:k表示从初始时刻到第k时刻的车辆状态,q为重要性采样函数。
考虑给定观测z1:k的条件下截止到k时刻的系统状态Φ0:k的完整后验分布,利用模型的Markov性质,可以得到如下后验分布的递推公式:
p(Φ0:k|z1:k)∝p(zk|Φ0:k,z1:k-1)p(Φ0:k|z1:k-1)
=p(zk|Φk,z1:k-1)p(Φk|Φ0:k-1,z1:k-1)p(Φ0:k-1|z1:k-1)
=p(zk|Φk)p(Φk|Φk-1)p(Φ0:k-1|z1:k-1)
因此,粒子的重要性权重可以用下式计算:
根据以上后验期望计算过程,应选取合适的重要性采样分布,如果构造的重要性采样满足下列关系:
那么可以获得以下粒子权重的递推关系式:
本发明中选取重要性采样如下:
那么粒子权重的递推关系式可简化为:
方法A、将Wk视为时变参数矩阵,然后用EM算法估算,似然函数为:
其中δi,m表示向量(zi-h(θi))的第m个元素,计算时用<zi-h(A<θi-1>))代替,而Rm,m代表矩阵R对角线上的第m个元素。另外,<Φ0>表示给定的车辆的初始状态期望,Φ0为车辆的实际初始状态,const表示常数。令<lnp(Φ0:k,z1:k,W1:k)>对wk,m的偏导数为零,则得到wk,m的估算公式如下式,本实施例中vm统一取值为2:
以上<·>表示估计值,而参数矩阵Wk的估计可以由<wk,m>构成:
<Wk>=diag([<wk,1>,<wk,2>,<wk,3>])
方法B、将Wk视为变量,与θk相互独立,则有观测概率密度函数:
其中λm等于矩阵R-1对角线上的第m个元素,等于向量zk,m为zk的第m个元素。另外St(·)表示Student-t分布,Gam(·)表示Gamma分布;Γ(·)是Gamma计算函数的表示。这样便获得了粒子权重的递推公式:
步骤4、对粒子群进行重新采样做第二次更新,具体步骤包括;
构建累积和序列ψk,ψk=[ψk,0,ψk,1,…,ψk,S],其中ψk,0=0,ψk,S=1;ψk中相邻两个元素构成一个区间,总共有S个区间;
以上过程可以解释为:如果重采样前某一个粒子所对应的权重很大,那么它所形成区间[ψk,s-1,ψk,s]相对于其他的区间就更大,因此,等差数列D中元素处于该区间的概率就更大,个数也就更多,那么导致序列I中会有很多元素,其值恰好对应这个大权重粒子,即序列I中等于Is的元素较多,那么重新采样更新粒子的时候,就会有出现更多的粒子等于例如换句话说,就是将这一个大权重粒子复制成多个,相反的,权重小的粒子,就更有可能会被剔除。
采用如下方式计算当前时刻k车辆的状态估计<Φk>:
<Φk>中的元素依次为当前时刻k车辆相对于毫米波雷达的横、纵坐标和横、纵向速度;
步骤6、跳转至步骤3进行下一时刻的车辆跟踪。
本实施例中毫米波雷达的观测量加高斯分布噪声,其能量与协方差矩阵R相对应,雷达的观测结果如图3所示,其中图3-(a)为车辆运动轨迹,图3-(b)、图3-(c)、图3-(d)分别为雷达对距离、方位角、径向速度的实际测量结果。将本发明的跟踪轨迹结果与实际的车辆轨迹进行对比,利用定位的均方误差MSE来评估效果,得到的结果为:
其中Num表示雷达连续观测的次数,<xk>、<yk>表示k时刻算法估计得到的横、纵坐标,xk、yk表示k时刻车辆实际的横、纵坐标。其跟踪轨迹与实际轨迹的对比如图4所示,(a)-(f)分别为车辆实际轨迹与跟踪轨迹的对比、横向距离对比、纵向距离对比、本发明的均方误差、横向速度对比、纵向速度对比。可以看出:本发明公开的方法在观测噪声服从高斯分布的条件下具有很好的跟踪性能。
实施例2:
为了检验本发明公开的方法对奇异值的鲁棒性,在实施例1的基础上将观测噪声由高斯分布换成student-t分布进行仿真实验,具体步骤如下:
首先根据车辆的运动轨迹,计算雷达的理论观测值z;然后利用MATLAB产生自由度为2的t分布随机数r2,并用相应的噪声标准差(即协方差矩阵R对角线上的各个元素)乘以该随机数,叠加到z上作为实际观测结果,如图5所示。最后利用本发明公开的方法跟踪车辆的轨迹,对比结果如图6所示。
将本发明方法的跟踪轨迹结果与实际的车辆轨迹进行对比,利用定位的均方误差MSE来评估效果,得到的结果为:
其中Num表示雷达连续观测的次数,<xk>、<yk>表示k时刻算法估计得到的横、纵坐标,xk、yk表示k时刻车辆实际的横、纵坐标。可以看出:本发明对观测数据中的奇异值具有很强的鲁棒性,可以有效提高系统状态的估计精度,抑制观测数据中的奇异值对系统状态估计的影响。
实施例3:
实现上述车辆运动轨迹跟踪方法的系统如图7所示,包括:
车辆跟踪模型建立模块1,用于建立车辆状态转移方程和状态观测方程;
初始化模块2,用于获取车辆的初始状态,设置粒子群中粒子的初始状态;
粒子群第一次更新模块3,用于根据当前时刻k毫米波雷达获取到的车辆观测量zk对粒子群进行第一次更新;
粒子群第二次更新模块4,用于对粒子群进行重新采样做第二次更新;
车辆状态估计模块5,用于根据第二次更新后的粒子权重和状态,计算当前时刻k车辆的状态估计,得到当前时刻k车辆相对于毫米波雷达的位置和速度。
Claims (10)
1.基于毫米波雷达的车辆运动轨迹跟踪方法,所述毫米波雷达用于实时获取车辆与雷达的距离、车辆相对于雷达的方位角和径向速度;其特征在于,包括:
(1)建立车辆状态转移方程:
其中为k时刻车辆的状态量,xk、yk表示k时刻车辆相对于雷达的横、纵坐标,表示k时刻车辆相对于雷达的横、纵向速度;f(·)为状态转移函数,A为状态转移矩阵,△t表示毫米波雷达的观测时间间隔,sk为状态转移噪声,服从零均值、协方差为Q的高斯分布,即
建立车辆状态观测方程:
其中rk、ak、vk分别为k时刻毫米波雷达获取的车辆与雷达的距离、车辆相对于雷达的方位角和径向速度;h(·)为观测函数;ok为观测噪声,服从零均值、协方差为R/Wk的高斯分布,即R为观测噪声协方差常数矩阵;Wk为观测噪声协方差权重矩阵,Wk=diag([wk,1,wk,2,wk,3]),每一权值wk,m均服从Gamma分布,即
(2)给定车辆初始状态的期望<Φ0>;产生包含S个粒子的集合,所述粒子集中第s个粒子在第k时刻的状态用表示;以<Φ0>为均值,Q为协方差的高斯分布随机初始化粒子群中每一个粒子的状态及其权重为初始时刻表示为k=0;
(5)根据第二次更新后的粒子权重和状态,计算当前时刻k车辆的状态估计<Φk>,得到当前时刻k车辆相对于毫米波雷达的位置和速度;
(6)跳转至步骤(3)进行下一时刻的车辆跟踪。
4.根据权利要求1所述的车辆运动轨迹跟踪方法,其特征在于,所述步骤(4)具体包括:
构建累积和序列ψk,ψk=[ψk,0,ψk,1,...,ψk,S],其中ψk,0=0,ψk,S=1;ψk中相邻两个元素构成一个区间,总共有S个区间;
(4.3)构建等差数列D=[d1,d2,…,dS],其中的第s个元素可以表示为:统计数列D中的每一个元素ds,位于ψk所构成的S个区间中的区间序号数,记为Is,s=1,...,S,构成序列I=[I1,I2,…,IS];
6.基于毫米波雷达的车辆运动轨迹跟踪系统,所述毫米波雷达用于实时获取车辆与雷达的距离、车辆相对于雷达的方位角和径向速度;其特征在于,包括:
车辆跟踪模型建立模块,用于建立车辆状态转移方程和状态观测方法;
初始化模块,用于获取车辆的初始状态,设置粒子群中粒子的初始状态;
粒子群第一次更新模块,用于根据当前时刻k毫米波雷达获取到的车辆观测量zk对粒子群进行第一次更新;
粒子群第二次更新模块,用于对粒子群进行重新采样做第二次更新;
车辆状态估计模块,用于根据第二次更新后的粒子权重和状态,计算当前时刻k车辆的状态估计,得到当前时刻k车辆相对于毫米波雷达的位置和速度。
9.根据权利要求6所述的车辆运动轨迹跟踪系统,其特征在于,粒子群第二次更新模块采用如下步骤对粒子进行第二次更新:
构建累积和序列ψk,ψk=[ψk,0,ψk,1,...,ψk,S],其中ψk,0=0,ψk,S=1;ψk中相邻两个元素构成一个区间,总共有S个区间;
(4.3)构建等差数列D=[d1,d2,…,dS],其中的第s个元素可以表示为:统计数列D中的每一个元素ds,位于ψk所构成的S个区间中的区间序号数,记为Is,s=1,...,S,构成序列I=[I1,I2,…,IS];
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010824302.6A CN112034445B (zh) | 2020-08-17 | 2020-08-17 | 基于毫米波雷达的车辆运动轨迹跟踪方法和系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010824302.6A CN112034445B (zh) | 2020-08-17 | 2020-08-17 | 基于毫米波雷达的车辆运动轨迹跟踪方法和系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112034445A true CN112034445A (zh) | 2020-12-04 |
CN112034445B CN112034445B (zh) | 2022-04-12 |
Family
ID=73578403
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010824302.6A Active CN112034445B (zh) | 2020-08-17 | 2020-08-17 | 基于毫米波雷达的车辆运动轨迹跟踪方法和系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112034445B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113746581A (zh) * | 2021-09-09 | 2021-12-03 | 南京航空航天大学 | 一种基于粒子滤波的三维毫米波波束跟踪方法 |
CN114567726A (zh) * | 2022-02-25 | 2022-05-31 | 苏州安智汽车零部件有限公司 | 一种类人眼自适应消抖前视摄像头 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002099986A (ja) * | 2000-09-22 | 2002-04-05 | Natl Inst For Land & Infrastructure Management Mlit | ミリ波レーダによる走行車両検出方法 |
CN109459750A (zh) * | 2018-10-19 | 2019-03-12 | 吉林大学 | 一种毫米波雷达与深度学习视觉融合的前方多车辆跟踪方法 |
CN109581345A (zh) * | 2018-11-28 | 2019-04-05 | 深圳大学 | 基于毫米波雷达的目标检测与跟踪方法及系统 |
CN109799477A (zh) * | 2018-12-06 | 2019-05-24 | 北京邮电大学 | 一种面向毫米波车联网的序贯车辆指纹定位方法及装置 |
CN110208793A (zh) * | 2019-04-26 | 2019-09-06 | 纵目科技(上海)股份有限公司 | 基于毫米波雷达的辅助驾驶系统、方法、终端和介质 |
CN110888125A (zh) * | 2019-12-05 | 2020-03-17 | 奥特酷智能科技(南京)有限公司 | 一种基于毫米波雷达的自动驾驶车辆定位方法 |
-
2020
- 2020-08-17 CN CN202010824302.6A patent/CN112034445B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002099986A (ja) * | 2000-09-22 | 2002-04-05 | Natl Inst For Land & Infrastructure Management Mlit | ミリ波レーダによる走行車両検出方法 |
CN109459750A (zh) * | 2018-10-19 | 2019-03-12 | 吉林大学 | 一种毫米波雷达与深度学习视觉融合的前方多车辆跟踪方法 |
CN109581345A (zh) * | 2018-11-28 | 2019-04-05 | 深圳大学 | 基于毫米波雷达的目标检测与跟踪方法及系统 |
CN109799477A (zh) * | 2018-12-06 | 2019-05-24 | 北京邮电大学 | 一种面向毫米波车联网的序贯车辆指纹定位方法及装置 |
CN110208793A (zh) * | 2019-04-26 | 2019-09-06 | 纵目科技(上海)股份有限公司 | 基于毫米波雷达的辅助驾驶系统、方法、终端和介质 |
CN110888125A (zh) * | 2019-12-05 | 2020-03-17 | 奥特酷智能科技(南京)有限公司 | 一种基于毫米波雷达的自动驾驶车辆定位方法 |
Non-Patent Citations (1)
Title |
---|
赵望宇 等: "融合毫米波雷达与单目视觉的前车检测与跟踪", 《武汉大学学报(信息科学版)》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113746581A (zh) * | 2021-09-09 | 2021-12-03 | 南京航空航天大学 | 一种基于粒子滤波的三维毫米波波束跟踪方法 |
CN114567726A (zh) * | 2022-02-25 | 2022-05-31 | 苏州安智汽车零部件有限公司 | 一种类人眼自适应消抖前视摄像头 |
Also Published As
Publication number | Publication date |
---|---|
CN112034445B (zh) | 2022-04-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107045125B (zh) | 一种基于预测值量测转换的交互多模型雷达目标跟踪方法 | |
CN110503071B (zh) | 基于变分贝叶斯标签多伯努利叠加模型的多目标跟踪方法 | |
CN109633590B (zh) | 基于gp-vsmm-jpda的扩展目标跟踪方法 | |
CN107688179B (zh) | 基于多普勒信息辅助的综合概率数据互联方法 | |
CN107741745A (zh) | 一种实现移动机器人自主定位与地图构建的方法 | |
CN108896986B (zh) | 一种基于预测值的量测转换序贯滤波机动目标跟踪方法 | |
CN112034445B (zh) | 基于毫米波雷达的车辆运动轨迹跟踪方法和系统 | |
CN110231620B (zh) | 一种噪声相关系统跟踪滤波方法 | |
Agate et al. | Road-constrained target tracking and identification using a particle filter | |
CN108871365B (zh) | 一种航向约束下的状态估计方法及系统 | |
CN116047498A (zh) | 基于最大相关熵扩展卡尔曼滤波的机动目标跟踪方法 | |
CN111189454A (zh) | 基于秩卡尔曼滤波的无人车slam导航方法 | |
CN115204212A (zh) | 一种基于stm-pmbm滤波算法的多目标跟踪方法 | |
CN111259332B (zh) | 一种杂波环境下的模糊数据关联方法及多目标跟踪方法 | |
CN114137562B (zh) | 一种基于改进全局最邻近的多目标跟踪方法 | |
US7928898B2 (en) | Method for determining the kinematic state of an object, by evaluating sensor measured values | |
CN113191427B (zh) | 一种多目标车辆跟踪方法及相关装置 | |
Xia et al. | Extended object tracking using hierarchical truncation measurement model with automotive radar | |
JP3750859B2 (ja) | レーダ追尾装置及びレーダ追尾処理方法 | |
CN111274529B (zh) | 一种鲁棒的高斯逆威沙特phd多扩展目标跟踪算法 | |
CN110007298B (zh) | 一种目标超前预测跟踪方法 | |
CN112285697B (zh) | 一种多传感器多目标空时偏差校准与融合方法 | |
CN109655057A (zh) | 一种六推无人机加速器测量值的滤波优化方法及其系统 | |
CN113030945B (zh) | 一种基于线性序贯滤波的相控阵雷达目标跟踪方法 | |
CN114705223A (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 |