CN110673134B - 一种雷达远近交替测距模式下航迹跟踪优化方法 - Google Patents
一种雷达远近交替测距模式下航迹跟踪优化方法 Download PDFInfo
- Publication number
- CN110673134B CN110673134B CN201910991897.1A CN201910991897A CN110673134B CN 110673134 B CN110673134 B CN 110673134B CN 201910991897 A CN201910991897 A CN 201910991897A CN 110673134 B CN110673134 B CN 110673134B
- Authority
- CN
- China
- Prior art keywords
- track
- point
- ranging mode
- ranging
- matrix
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 238000005457 optimization Methods 0.000 title claims abstract description 10
- 239000011159 matrix material Substances 0.000 claims description 58
- 238000005259 measurement Methods 0.000 claims description 46
- 230000007704 transition Effects 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 4
- 230000009466 transformation Effects 0.000 claims description 3
- 238000001914 filtration Methods 0.000 abstract description 5
- 230000000694 effects Effects 0.000 abstract description 3
- 238000009499 grossing Methods 0.000 abstract description 3
- 238000001514 detection method Methods 0.000 abstract description 2
- 238000012216 screening Methods 0.000 abstract description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
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/66—Radar-tracking systems; Analogous systems
- G01S13/72—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
- G01S13/723—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明涉及一种雷达远近交替测距模式下航迹跟踪优化方法,包括步骤:分别通过远测距模式和近测距模式两种测距模式交替获取目标的点迹;通过连续获取的多帧点迹的连续性确定目标的航迹起始;通过采用设置不同参数的波门分别对远测距模式和近测距模式所获取的点迹进行筛选,以确定与航迹相匹配的点迹;通过根据获取点迹的不同测距模式所设置的不同非线性滤波器噪声矩阵分别将与航迹相匹配的点迹更新至航迹中,以得到新的航迹。本发明通过采用自适应扇形波门进行匹配提高了点迹与航迹匹配的连续性,通过获取点迹的不同测距模式设置不同非线性滤波器噪声矩阵优化航迹,从而提高了航迹的滤波平滑效果及检测目标运动状态的估计精度。
Description
技术领域
本发明涉及雷达技术领域,特别是涉及一种雷达远近交替测距模式下航迹跟踪优化方法。
背景技术
车载雷达根据不同的测距要求设置相应的帧结构和发射天线,导致近测距模式(下文简称‘近制式’)和远测距模式(下文简称‘远制式’)得到的点迹测量精度有所差异,如近制式目标径向距离的测量精度相比远制式较高,而近制式目标角度的测量精度相比远制式较低。因此采用单一的近制式进行航迹跟踪时,在远距离(如120m以外)容易丢失点迹信息,导致点迹与航迹的匹配失败;采用单一的远制式进行航迹跟踪时,在近距离(如20m以内)点迹信息精度低,导致点迹与航迹的匹配错误;两种测距模式都会导致航迹不连续,目标跟踪失败,所以提出使用两种测距模式融合的方法,取长补短进行航迹跟踪。
基于非线性卡尔曼滤波跟踪算法,对远近交替测距模式下得到的点迹进行匹配跟踪,但由于两种测距模式得到的点迹测量精度不同,滤波得到的航迹不够平滑,且估计的行驶状态(速度、加速度分量)不稳定,抖动较大,影响了目标状态的判断。
由于远近测距模式点迹测量精度不同,传统点迹匹配波门的设置容易导致匹配错误和失败,继而影响航迹的连续性。
发明内容
本发明为克服上述现有技术所述的不足,提供一种雷达远近交替测距模式下航迹跟踪优化方法。
为解决上述技术问题,本发明的技术方案如下:
一种雷达远近交替测距模式下航迹跟踪优化方法,包括如下步骤:
包括如下步骤:
分别通过远测距模式和近测距模式两种测距模式交替获取目标的点迹;
通过连续获取的多帧点迹的连续性确定目标的航迹起始;
通过采用设置不同参数的波门分别对远测距模式和近测距模式所获取的点迹进行筛选,以确定与航迹相匹配的点迹;
通过根据获取点迹的不同测距模式所设置的不同非线性滤波器噪声矩阵分别将与航迹相匹配的点迹更新至航迹中,以得到新的航迹。
进一步的,作为优选技术方案,确定与航迹相匹配的点迹具体包括:
选择波门类型;
对远测距模式所获取的点迹设置第一波门进行筛选,当点迹的测量值满足第一波门条件,则判断该点迹与航迹相匹配;
对近测距模式所获取的点迹设置第二波门进行筛选,当点迹的测量值满足第二波门条件,则判断该点迹与航迹相匹配。
进一步的,作为优选技术方案,当每帧所获取的点迹中有多个点迹与航迹相匹配,则采用点迹聚类法、角度偏差最小法或距离偏差最小法获取与航迹最佳匹配的点迹。
进一步的,作为优选技术方案,所述点迹的测量值包括测量距离、测量速度和测量角度;
所述波门参数包括点迹的测量距离与航迹预测距离之间的差值最大值、点迹的测量速度与航迹预测速度之间的差值最大值和点迹的测量角度与航迹预测角度之间的差值最大值。
进一步的,作为优选技术方案,所述波门类型包括矩形波门、扇形波门和圆形波门。
进一步的,作为优选技术方案,所述波门类型为扇形波门。
进一步的,作为优选技术方案,
设置非线性滤波器噪声矩阵并实时根据不同测距模式获取点迹的点迹测量噪声初始化非线性滤波器噪声矩阵;
根据获取当前点迹的测距模式更新非线性滤波器噪声矩阵;
根据更新后的非线性滤波器噪声矩阵更新非线性滤波器增益矩阵;
根据更新后的非线性滤波器增益矩阵获取不同测距模式下获取的点迹的状态量,将该状态量更新至航迹中,从而得到新的航迹。
进一步的,作为优选技术方案,初始化非线性滤波器噪声矩阵具体为:
初始化点迹的测量值的测量误差方差;
所述点迹的测量值的初始根据获取该点迹的不同测距模式的精度和分辨率设置。
进一步的,作为优选技术方案,所述非线性滤波器噪声矩阵通过以下公式初始化:
进一步的,作为优选技术方案,远测距模式和近测距模式下的非线性滤波器增益矩阵分别通过以下公式获取:
其中,K1t表示远测距模式下的非线性滤波器增益矩阵,K2t表示近测距模式下的非线性滤波器增益矩阵,表示协方差矩阵,H表示量测转换矩阵,Rfar表示远测距模式下的测量噪声,Rnear表示近测距模式下的测量噪声,/>表示t时刻状态量的滤波值,/>表示t时刻状态量的预测值,yt表示测量量,/>表示测量量和预测量的残差。
进一步的,作为优选技术方案,状态量包括点迹的位置分量、速度分量、加速度分量。
与现有技术相比,本发明技术方案的有益效果是:
本发明通过采用自适应扇形波门进行匹配提高了点迹与航迹匹配的连续性,通过获取点迹的不同测距模式设置不同非线性滤波器噪声矩阵优化航迹,从而提高了航迹的滤波平滑效果及检测目标运动状态的估计精度。
附图说明
图1为本发明方法步骤流程图。
图2为本发明航迹的更新方法步骤流程图。
附图仅用于示例性说明,不能理解为对本专利的限制;为了更好说明本实施例,附图某些部件会有省略、放大或缩小,并不代表实际产品的尺寸;对于本领域技术人员来说,附图中某些公知结构及其说明可能省略是可以理解的;相同或相似的标号对应相同或相似的部件;附图中描述位置关系的用语仅用于示例性说明,不能理解为对本专利的限制。
具体实施方式
下面结合附图对本发明的较佳实施例进行详细阐述,以使本发明的优点和特征更易被本领域技术人员理解,从而对本发明的保护范围作出更为清楚的界定。
实施例1
一种雷达远近交替测距模式下航迹跟踪优化方法,如图1所示,包括如下步骤:
S10.分别通过远测距模式和近测距模式两种测距模式交替获取目标的点迹。
本步骤具体为:对车载雷达设置远测距模式和近测距模式两种测距模式,分别通过远测距模式和近测距模式两种测距模式交替获取目标的点迹。
S20.通过连续获取的多帧点迹的连续性确定目标的航迹起始。
本步骤具体为:连续获取多帧点迹,判断所获取的多帧点迹的连续性,当确认获取的多帧点迹连续时,进行目标的航迹起始。
S30.通过采用设置不同参数的波门分别对远测距模式和近测距模式所获取的点迹与航迹进行关联匹配,以确定与航迹相匹配的点迹。
本步骤具体包括:
选择波门类型。
本步骤中,在进行点迹与航迹进行匹配时,所采用的波门包括矩形波门、扇形波门或圆形波门,由于本发明的航迹跟踪优化方法是基于非线性滤波器的,且所得到的点迹是采用远测距模式和近测距模式两种测距模式交替获取的,由于两种测距模式所采用的点迹测量精度不同,因此,在本发明中,为了提高航迹的滤波平滑效果,所采用的波门为扇形波门。
对远测距模式所获取的点迹设置第一波门进行筛选,当点迹的测量值满足第一波门条件,则判断该点迹与航迹相匹配;对近测距模式所获取的点迹设置第二波门进行筛选,当点迹的测量值满足第二波门条件,则判断该点迹与航迹相匹配。
本步骤中,还包括,当每帧所获取的点迹中有多个点迹与航迹相匹配,则采用点迹聚类法、角度偏差最小法或距离偏差最小法获取与航迹最佳匹配的点迹。
其中,波门参数包括点迹的测量距离与航迹预测距离之间的差值最大值、点迹的测量速度与航迹预测速度之间的差值最大值和点迹的测量角度与航迹预测角度之间的差值最大值;点迹的测量值包括测量距离、测量速度和测量角度。
S40.通过根据获取点迹的不同测距模式所设置的不同非线性滤波器噪声矩阵分别将与航迹相匹配的点迹更新至航迹中,以得到新的航迹。
本步骤具体包括:
S401.设置非线性滤波器噪声矩阵并实时根据不同测距模式获取点迹的点迹测量噪声初始化非线性滤波器噪声矩阵。
初始化非线性滤波器噪声矩阵具体为:初始化点迹的测量值的测量误差方差。其中,点迹的测量值的初始根据获取该点迹的不同测距模式的精度和分辨率设置。
非线性滤波器噪声矩阵通过以下公式初始化:
S402.识别获取当前点迹的测距模式并根据该测距模式更新非线性滤波器噪声矩阵。
根据测距模式更新非线性滤波器噪声矩阵具体为:
例如,初始化后的非线性滤波器噪声矩阵的点迹测量噪声为R,那么,当识别的测距模式为远测距模式时,得到的更新后的非线性滤波器噪声矩阵的点迹测量噪声为Rfar,当识别的测距模式为近测距模式时,得到的更新后的非线性滤波器噪声矩阵的点迹测量噪声为Rnear。
S403.根据更新后的非线性滤波器噪声矩阵更新非线性滤波器增益矩阵。
非线性滤波器增益矩阵通过以下公式获取:
其中,Kt表示非线性滤波器滤波增益矩阵,表示协方差矩阵,H表示量测转换矩阵,Rfar表示远测距模式下的测量噪声,Rnear表示近测距模式下的测量噪声,/>表示t时刻状态量的滤波值,/>表示t时刻状态量的预测值,yt表示测量量,/>表示测量量和预测量的残差。
根据更新后的非线性滤波器噪声矩阵更新非线性滤波器增益矩阵具体为:
例如:
S404.根据更新后的非线性滤波器增益矩阵获取不同测距模式下获取的点迹的状态量,将该状态量更新至航迹中,从而得到新的航迹。
具体为:
通过远测距模式下更新的非线性滤波器增益矩阵K1t获取远测距模式下获取的点迹的状态量,并将该点迹的状态量更新至航迹中;通过近测距模式下更新的非线性滤波器增益矩阵K2t获取近测距模式下获取的点迹的状态量,并将该点迹的状态量更新至航迹中,从而得到新的航迹。在本步骤中,状态量包括点迹的位置分量、速度分量、加速度分量。
显然,本发明的上述实施例仅仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明权利要求的保护范围之内。
Claims (10)
1.一种雷达远近交替测距模式下航迹跟踪优化方法,其特征在于,包括如下步骤:
分别通过远测距模式和近测距模式两种测距模式交替获取目标的点迹;
通过连续获取的多帧点迹的连续性确定目标的航迹起始;
选择波门类型,同时设置不同参数的第一波门和第二波门;
对远测距模式所获取的点迹设置第一波门进行筛选,当点迹的测量值满足第一波门条件,则判断该点迹与航迹相匹配;
对近测距模式所获取的点迹设置第二波门进行筛选,当点迹的测量值满足第二波门条件,则判断该点迹与航迹相匹配;
通过根据获取点迹的不同测距模式所设置的不同非线性滤波器噪声矩阵分别将与航迹相匹配的点迹更新至航迹中,以得到新的航迹。
2.根据权利要求1所述的雷达远近交替测距模式下航迹跟踪优化方法,其特征在于,当每帧所获取的点迹中有多个点迹与航迹相匹配,则采用点迹聚类法、角度偏差最小法或距离偏差最小法获取与航迹最佳匹配的点迹。
3.根据权利要求2所述的雷达远近交替测距模式下航迹跟踪优化方法,其特征在于,所述点迹的测量值包括测量距离、测量速度和测量角度;
所述波门参数包括点迹的测量距离与航迹预测距离之间的差值最大值、点迹的测量速度与航迹预测速度之间的差值最大值和点迹的测量角度与航迹预测角度之间的差值最大值。
4.根据权利要求1所述的雷达远近交替测距模式下航迹跟踪优化方法,其特征在于,所述波门类型包括矩形波门、扇形波门和圆形波门。
5.根据权利要求1所述的雷达远近交替测距模式下航迹跟踪优化方法,其特征在于,所述波门类型为扇形波门。
6.根据权利要求1所述的雷达远近交替测距模式下航迹跟踪优化方法,其特征在于:
设置非线性滤波器噪声矩阵并实时根据不同测距模式获取点迹的点迹测量噪声初始化非线性滤波器噪声矩阵;
识别获取当前点迹的测距模式并根据该测距模式更新非线性滤波器噪声矩阵;
根据更新后的非线性滤波器噪声矩阵更新非线性滤波器增益矩阵;
根据更新后的非线性滤波器增益矩阵获取不同测距模式下获取的点迹的状态量,将该状态量更新至航迹中,从而得到新的航迹。
7.根据权利要求6所述的雷达远近交替测距模式下航迹跟踪优化方法,其特征在于,初始化非线性滤波器噪声矩阵具体为:
初始化点迹的测量值的测量误差方差;
所述点迹的测量值的初始根据获取该点迹的不同测距模式的精度和分辨率设置。
10.根据权利要求7所述的雷达远近交替测距模式下航迹跟踪优化方法,其特征在于,状态量包括点迹的位置分量、速度分量、加速度分量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910991897.1A CN110673134B (zh) | 2019-10-18 | 2019-10-18 | 一种雷达远近交替测距模式下航迹跟踪优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910991897.1A CN110673134B (zh) | 2019-10-18 | 2019-10-18 | 一种雷达远近交替测距模式下航迹跟踪优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110673134A CN110673134A (zh) | 2020-01-10 |
CN110673134B true CN110673134B (zh) | 2023-06-13 |
Family
ID=69083459
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910991897.1A Active CN110673134B (zh) | 2019-10-18 | 2019-10-18 | 一种雷达远近交替测距模式下航迹跟踪优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110673134B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112285696B (zh) * | 2020-12-29 | 2021-05-07 | 北京海兰信数据科技股份有限公司 | 一种雷达目标跟踪方法及*** |
CN115825912B (zh) * | 2023-01-09 | 2023-05-23 | 南京隼眼电子科技有限公司 | 一种雷达信号处理方法、装置及存储介质 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7941292B2 (en) * | 2008-05-02 | 2011-05-10 | Raytheon Company | Associating observations in a multi-sensor system using an adaptive gate value |
CN102156992B (zh) * | 2011-04-14 | 2017-07-28 | 中国人民解放军海军航空工程学院 | 两站多目标无源定位与跟踪的智能仿生方法 |
CN103471591B (zh) * | 2013-04-15 | 2017-06-06 | 中国人民解放军海军航空工程学院 | 基于逻辑法、全局最近邻和目标航向信息的机动多目标数据互联方法 |
CN106054151B (zh) * | 2016-05-23 | 2018-11-09 | 西安电子科技大学 | 基于数据关联算法的雷达多目标跟踪优化方法 |
CN106526584A (zh) * | 2016-09-12 | 2017-03-22 | 西安电子科技大学 | 多雷达***中目标检测跟踪联合处理方法 |
CN108303692B (zh) * | 2018-01-30 | 2021-02-05 | 哈尔滨工业大学 | 一种解多普勒模糊的多目标跟踪方法 |
CN108549062B (zh) * | 2018-04-28 | 2020-08-25 | 西安长远电子工程有限责任公司 | 一种用于海面搜索雷达的***平台及多模型目标跟踪方法 |
CN109143181A (zh) * | 2018-07-25 | 2019-01-04 | 南京理工大学 | 一种便于编程的雷达点迹航迹互联方法 |
CN110187318B (zh) * | 2019-04-23 | 2021-07-06 | 四川九洲防控科技有限责任公司 | 一种雷达数据处理方法 |
-
2019
- 2019-10-18 CN CN201910991897.1A patent/CN110673134B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110673134A (zh) | 2020-01-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110596694B (zh) | 一种复杂环境雷达多目标跟踪和道路行驶环境预测方法 | |
CN110673134B (zh) | 一种雷达远近交替测距模式下航迹跟踪优化方法 | |
US7548184B2 (en) | Methods and apparatus for processing data from multiple sources | |
CN107741745A (zh) | 一种实现移动机器人自主定位与地图构建的方法 | |
CN110132305A (zh) | 一种实时校准方法及装置 | |
JPS62261920A (ja) | 航法モ−ド選択装置 | |
CN109975839B (zh) | 一种车辆卫星定位数据的联合滤波优化方法 | |
JP2015525873A (ja) | 車両用レーダセンサのミスアライメント処理 | |
EP3671272A1 (en) | Vehicle sensor fusion based on fuzzy sets | |
CN112285700A (zh) | 基于激光雷达与毫米波雷达融合的机动目标跟踪方法 | |
CN112198503A (zh) | 一种目标航迹预测优化方法、装置及雷达*** | |
CN111157969B (zh) | 一种多传感器***误差在线估计和数据融合方法 | |
CN106969767B (zh) | 一种动平台传感器***偏差的估计方法 | |
CN114779204B (zh) | 一种基于雷达目标幅度最小二乘跟踪处理方法及*** | |
CN112098960A (zh) | 确定用于道路车辆雷达自动对准控制器的雷达传感器的对准角度的方法 | |
JP2021101193A (ja) | 位置標定システム、および位置標定方法 | |
WO2021212517A1 (zh) | 定位方法、***及存储介质 | |
CN111161324A (zh) | 一种基于自适应多模更新策略的目标跟踪方法 | |
CN112034445B (zh) | 基于毫米波雷达的车辆运动轨迹跟踪方法和*** | |
CN111523619B (zh) | 目标存在概率的计算方法、装置、电子设备及存储介质 | |
CN112540345A (zh) | 一种基于高斯分布检测uwb质量的双模型定位方法及*** | |
Jürgens et al. | Radar-based automotive localization using landmarks in a multimodal sensor graph-based approach | |
CN114543810B (zh) | 一种复杂环境下的无人机集群无源定位方法及装置 | |
CN110007298A (zh) | 一种目标超前预测跟踪方法 | |
CN114817765A (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 |