CN108803622B - 一种用于对目标探测数据进行处理的方法、装置 - Google Patents
一种用于对目标探测数据进行处理的方法、装置 Download PDFInfo
- Publication number
- CN108803622B CN108803622B CN201810846019.6A CN201810846019A CN108803622B CN 108803622 B CN108803622 B CN 108803622B CN 201810846019 A CN201810846019 A CN 201810846019A CN 108803622 B CN108803622 B CN 108803622B
- Authority
- CN
- China
- Prior art keywords
- track
- detection
- information
- sensor
- processing
- 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
- 238000001514 detection method Methods 0.000 title claims abstract description 177
- 238000000034 method Methods 0.000 title claims abstract description 96
- 238000012545 processing Methods 0.000 title claims abstract description 88
- 238000009826 distribution Methods 0.000 claims description 3
- 238000003672 processing method Methods 0.000 abstract description 5
- 230000004927 fusion Effects 0.000 description 26
- 238000007726 management method Methods 0.000 description 26
- 230000000875 corresponding effect Effects 0.000 description 18
- 238000005259 measurement Methods 0.000 description 13
- 238000001914 filtration Methods 0.000 description 5
- 239000000523 sample Substances 0.000 description 5
- 230000001133 acceleration Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000009286 beneficial effect Effects 0.000 description 3
- 230000002596 correlated effect Effects 0.000 description 3
- 238000005034 decoration Methods 0.000 description 2
- 230000003247 decreasing effect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 241000287196 Asthenes Species 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000007500 overflow downdraw method Methods 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012163 sequencing technique Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开了一种用于对目标探测数据进行处理的方法及装置，具体地，所述方法包括：在检测到多个传感器对目标进行同时探测时，依次对多个传感器的探测过程进行处理；多个传感器中当前传感器探测过程的处理方法包括：将当前传感器的探测信息与前一传感器输出的航迹进行关联，得到关联信息；利用所述关联信息对所述航迹的航迹信息进行更新，对更新后的航迹信息进行航迹管理；在当前传感器为多个传感器中用于探测的最后一个传感器，且在最后一个传感器探测过程处理结束后输出对所述目标的最终处理数据。将多个传感器对目标的探测数据进行序贯式融合，有次序分批次的处理，运算效率得到提升。
Description
技术领域
本发明涉及目标检测及跟踪技术领域，尤其涉及一种用于对目标探测数据进行处理的方法、装置。
背景技术
自动驾驶或无人驾驶汽车，越来越受到人们的关注，各大整车厂以及科技互联网等公司都积极投入大量人力物力研发无人驾驶系统，期望早日实现无人驾驶汽车的量产。高级自动驾驶系统，一般由六大子系统组成：传感器系统、感知系统、定位系统、规划及决策系统、车辆控制系统和系统管理系统。传感器系统是车辆感知和定位的硬件基础，由该系统测量的各种环境原始信息(如运动车辆的距离、角度和速度，静止障碍物距离、角度和类别，道路标志和车道线等等)，将会在感知系统和定位系统中，做进一步的处理，以得到可以用来进行规划和决策的信息。最终车辆控制系统将会利用规划和决策信息，对车辆进行实时控制，以达到预期车辆行驶目的。在自动驾驶系统中，因为其他子系统是基于环境感知系统的信息输出，所以该系统的表现，在整个自动驾驶系统中起着至关重要的作用。
环境感知系统利用各种传感器，获得车辆周围各种静止以及运动目标的信息。在对静止和运动目标的实时动态感知过程中，目标跟踪技术和多传感器数据融合技术起着关键性的作用，并且它们是相辅相成、不可分割的关系。
在目标跟踪和数据融合中，对同一目标的跟踪，在不同时间段可能需要融合不同数量、不同种类的传感器信息，因而需要目标跟踪和融合算法，对各种传感器具有很好的兼容性。
目前车上的一些目标跟踪和融合算法，都是针对特定数量或特定种类的传感器设计的，不利于车载传感器的选配，例如目前自动驾驶Level 2上的自适应巡航功能，就是通过前方传感器和前方单目摄像头融合实现的，对应的跟踪和融合算法的设计，就是针对这两种传感器的融合，如果现在需要实现更多功能而增加侧前方传感器，对应的算法就需要重新设计，不利于节约开发成本。
发明内容
为了解决上述技术问题，本发明提出了一种用于对目标探测数据进行处理的方法及装置，具体地，
一方面提供了一种用于对目标探测数据进行处理的方法，所述方法包括：
在检测到多个传感器对目标进行同时探测时，依次对多个传感器的探测过程进行处理，包括：
对多个传感器中当前传感器的探测过程进行处理，包括：
将当前传感器的探测信息与前一传感器输出的航迹进行关联，得到关联信息；
利用所述关联信息对所述航迹的航迹信息进行更新，
对更新后的航迹信息进行航迹管理，
将下一个传感器更新为当前传感器，并进行探测过程的处理；
在当前传感器为多个传感器中用于探测的最后一个传感器，且在最后一个传感器探测过程处理结束后输出对所述目标的最终处理数据。
进一步地，所述依次对多个传感器的探测过程进行处理，还包括：
在当前传感器为多个传感器中用于探测的第一个传感器时，则对第一个传感器探测过程进行处理；包括：
根据所述目标的上一帧航迹信息预测当前帧的航迹，
将所述第一个传感器的探测信息与预测得到的航迹进行关联，得到关联信息；
利用所述关联信息对预测得到的航迹的航迹信息进行更新，
对更新后的航迹信息进行航迹管理。
进一步地，所述将当前传感器的探测信息与前一传感器输出的航迹进行关联，得到关联信息；包括：
获取当前传感器的多个探测信息，以及前一传感器输出的航迹；
获取每个探测信息对应计算出的马氏距离，并得出最小马氏距离值；
将所述航迹与所述最小马氏距离值对应的探测信息相关联，所述最小马氏距离值对应的探测信息为关联信息。
进一步地，
所述航迹管理包括对航迹进行初始化、合并和删除；
所述对航迹进行初始化是为剩余的探测数据确定出对应的航迹；所述对航迹进行合并是将当前时刻的航迹信息中，与前一时刻的航迹信息相同的航迹进行合并。
进一步地，所述根据所述目标的上一帧航迹信息预测当前帧的航迹，之前包括：
为所述目标分配一个身份标识符，所述身份标识符用于代表所述目标的航迹。
另一方面提供了一种用于对目标探测数据进行处理的装置，所述装置包括：
所述装置包括：多雷达探测处理模块和探测数据输出模块；
所述多雷达探测处理模块，用于在检测到多个传感器对目标进行同时探测时，依次对多个传感器的探测过程进行处理；
所述多雷达探测处理模块包括当前传感器处理单元和传感器更新单元；所述当前传感器处理单元包括：
前一传感器航迹关联子单元，用于将当前传感器的探测信息与前一传感器输出的航迹进行关联，得到关联信息；
第一更新子单元，用于利用所述关联信息对所述航迹的航迹信息进行更新，
第一航迹管理子单元，用于对更新后的航迹信息进行航迹管理；
所述传感器更新单元，用于将下一传感器更新为当前传感器，并进行探测过程的处理；
所述探测数据输出模块，用于在当前传感器为多个传感器中用于探测的最后一个传感器，且在最后一个传感器探测过程处理结束后输出对所述目标的最终处理数据。
进一步地，所述多雷达探测处理模块，还包括：
第一传感器处理单元，用于在当前传感器为多个传感器中用于探测的第一个传感器时，则对第一个传感器探测过程进行处理；
所述第一传感器处理单元包括：
航迹预测子单元，用于根据所述目标的上一帧航迹信息预测当前帧的航迹，
预测航迹关联子单元，用于将所述第一个传感器的探测信息与预测得到的航迹进行关联，得到关联信息；
第二更新子单元，用于利用所述关联信息对预测得到的航迹的航迹信息进行更新，
第二航迹管理子单元，用于对更新后的航迹信息进行航迹管理。
进一步地，所述前一传感器航迹关联子单元，包括：
探测信息航迹获取子单元，用于获取当前传感器的多个探测信息，以及前一传感器输出的航迹；
最小探测距离获取子单元，用于获取每个探测信息对应计算出的马氏距离，并得出最小马氏距离值；
最小探测距离关联子单元，用于将所述航迹与所述最小马氏距离值对应的探测信息相关联，所述最小马氏距离值对应的探测信息为关联信息。
进一步地，所述航迹管理包括对航迹进行初始化、合并和删除；
所述对航迹进行初始化是为剩余的探测数据确定出对应的航迹；所述对航迹进行合并是将当前时刻的航迹信息中，与前一时刻的航迹信息相同的航迹进行合并。
进一步地，所述多雷达探测处理模块，还包括：
身份分配单元，用于为所述目标分配一个身份标识符，所述身份标识符用于代表所述目标的航迹。
本发明提供的一种用于对目标探测数据进行处理的方法、装置具有的有益效果为：
本发明在检测到多个传感器对目标进行同时探测时，依次对多个传感器的探测过程进行处理；在当前传感器为多个传感器中用于探测的最后一个传感器，且在最后一个传感器探测过程处理结束后输出对所述目标的最终处理数据；其中，多个传感器中当前传感器探测过程的处理方法包括：将当前传感器的探测信息与前一传感器输出的航迹进行关联，得到关联信息；利用所述关联信息对所述航迹的航迹信息进行更新，对更新后的航迹信息进行航迹管理。
本发明对多个触感器的探测过程的处理属于数据融合的过程，通过采用序贯式融合方式进行有次序、分批次的处理，避免了现有技术因为传感器数量或种类的改变导致算法无法正常工作的问题。
本发明通过这种有次序分批次的序贯式融合方式，使得算法对各个传感器数据的处理相对独立，相比于所有数据一起处理，运算效率得到提升。
并且，本发明对传感器的数量和种类没有限制，具有高度兼容性，便于车辆传感器的选配；进一步地，在某个传感器失效时，并不影响整个系统的工作。
附图说明
为了更清楚地说明本发明实施例中的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的一种用于对目标探测数据进行处理方法的主要流程图；
图2本发明实施例提供的多个传感器中当前传感器探测过程的处理方法流程图；
图3是本发明实施例提供的将当前传感器的探测信息与前一传感器的航迹进行关联步骤的方法流程图；
图4是本发明实施例提供的对第一个传感器探测过程进行处理方法流程图；
图5是本发明实施例提供的在超车的场景下五个毫米波雷达的探测示意图；
图6是根据图5将前方车辆对后方车辆的跟踪可以分为五个阶段的示意图；
图7是本发明实施例提供的单个雷达的跟踪算法对探测数据的处理流程图；
图8是本发明实施例提供的以侧后方右毫米波雷达RSRR和侧后方左毫米波雷达RSRL为例对融合算法对探测数据的处理流程图；
图9是本发明实施例提供的一种用于对目标探测数据进行处理的装置结构图；
图10是本发明实施例提供的另一种用于对目标探测数据进行处理的装置结构图；
图11是本发明实施例提供的前一传感器航迹关联子单元结构组成图。
具体实施方式
为了使本技术领域的人员更好地理解本发明方案，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分的实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都应当属于本发明保护的范围。
需要说明的是，术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包含，例如，包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
现有的目标跟踪和数据融合算法，是针对特定数量和特定种类的传感器而设计。当需要融合的传感器数量改变，或传感器的种类改变，现有的融合算法便无法正常工作。这是因为现有算法是集中式融合各个传感器的信息，即所有传感器的信息都输入到融合中心，并且得到同时处理，在算法的设计上，来自各个传感的信息相互关联，导致增加或减少传感器的数量，或更改传感器种类，算法没法有效识别到增加或减少的信息，进而导致算法没法正常工作。
所以，本发明提出了一种序贯式的目标跟踪和融合方案，当各个传感器的信息输入到车辆的信息融合中心(车辆融合中心或车辆域控制器)后，该算法并不是对这些信息进行统一处理，而是有次序、分批次的处理；这样能够避免因为传感器数量或种类的改变，导致算法无法正常工作的问题。
具体地，本发明实施例提出了一种用于对目标探测数据进行处理的方法，如图1所示，所述方法包括：
S202.在检测到多个传感器对目标进行同时探测时，依次对多个传感器的探测过程进行处理，包括：
对多个传感器中当前传感器的探测过程进行处理，如图2所示，包括：
S402.将当前传感器的探测信息与前一传感器输出的航迹进行关联，得到关联信息；
进一步地，步骤S402中，将当前传感器的探测信息与前一传感器的航迹进行关联，得到关联信息；如图3所示，包括：
S602.获取当前传感器的多个探测信息，以及前一传感器的航迹；
其中，在获取传感器的航迹的同时也就获取了当前传感器的航迹信息；传感器的航迹用于表示探测目标的运动轨迹，航迹信息包括目标的位置、速度、加速度等信息。
S604.获取每个探测信息对应计算出的马氏距离，并得出最小马氏距离值；
S606.将所述航迹与所述最小马氏距离值对应的探测信息相关联，所述最小马氏距离值对应的探测信息为关联信息。
其中，马氏距离是一种有效的计算两个未知样本集的相似度的方法。它考虑到各种特性之间的联系(例如：一条关于身高的信息会带来一条关于体重的信息，因为两者是有关联的)，并且是尺度无关的(scale-invariant)，即独立于测量尺度。探测信息为z，x具有均值为x、协方差矩阵为p的多变量向量，则马氏距离为d＝(z-x)'P-1(z-x)。
给与举例说明，例如前一传感器具有a航迹，同时当前传感器具有4个探测信息(传感器测量)z1、z2、z3和z4；四个测量对应会计算出马氏距离d1、d2、d3和d4；
如果给定给出探测信息(比如位置坐标)
以及航迹信息的均值
航迹信息的协方差
则根据马氏距离公式得到：
d1＝(z1-x)'P-1(z1-x)＝5.2615
d2＝(z2-x)'P-1(z2-x)＝4.0770
d3＝(z3-x)'P-1(z3-x)＝7.3372
d4＝(z4-x)'P-1(z4-x)＝17.3549
如上述的例子所示，如果比较得出距离d2最小，说明d2对应的探测信息属于当前目标信息，则将航迹a和上述探测信息中的z2测量关联。
需要说明的是，探测信息指的是传感器测量；航迹信息指的是对连续时间上获得的传感器测量处理后的信息，其中因为每一帧都会收到一个传感器或多个传感器的测量信息，而航迹从上一帧到下一帧不会中断，因此需要连续处理每一帧获得的测量。
S404.利用所述关联信息对所述航迹的航迹信息进行更新，
具体地，可以利用卡尔曼滤波算法对航迹信息的更新，比如利用卡尔曼滤波算法对目标的位置、速度、加速度等信息的更新。
S406.对更新后的航迹信息进行航迹管理；
具体地，所述航迹管理包括对航迹进行初始化、合并和删除；
所述对航迹进行初始化是为剩余的探测数据确定出对应的航迹；所述对航迹进行合并是将当前时刻的航迹信息中，与前一时刻的航迹信息相同的航迹进行合并。其中，有些被跟踪目标的对应航迹，在被跟踪目标消失后，需要将它的航迹删除，以防止干扰其他航迹，影响后续数据的处理。
S204.在当前传感器为多个传感器中用于探测的最后一个传感器，且在最后一个传感器探测过程处理结束后输出对所述目标的最终处理数据。
进一步地，所述依次对多个传感器的探测过程进行处理，还包括：
在当前传感器为多个传感器中用于探测的第一个传感器时，则对第一个传感器的探测过程进行处理；如图4所示，包括：
S802.根据所述目标的上一帧航迹信息预测当前帧的航迹，
S804.将所述第一个传感器的探测信息与预测得到的航迹进行关联，得到关联信息；
S806.利用所述关联信息对预测得到的航迹的航迹信息进行更新，
具体地，对航迹信息的更新，例如目标位置、速度、加速度等信息的更新，该过程通常需要用到卡尔曼滤波算法进行信息的更新。
S808.对更新后的航迹信息进行航迹管理。
对应地，步骤S804中，将所述第一个毫米波雷达的探测信息与预测得到的航迹进行关联，得到关联信息；包括：
获取所述第一个毫米波雷达的多个探测信息；
获取每个探测信息对应计算出的马氏距离，并得出最小马氏距离值；
将预测得到的航迹与所述最小马氏距离值对应的探测信息相关联。
进一步地，所述根据所述目标的上一帧航迹信息预测当前帧的航迹，之前包括：
为所述目标分配一个身份标识符，所述身份标识符用于代表所述目标的航迹。
需要说明的是，在检测到单一传感器对目标进行探测时，则对所述单一传感器的探测过程的处理方法，与对多个传感器的第一个传感器处理方法相似，在最后进行对更新后的航迹信息进行航迹管理之后，将得到的处理数据输出，该探测数据就是所述单一传感器对目标的处理数据。
针对本发明实施例给与具体的举例说明：
如图5所示，现以车载的五个毫米波雷达为例，当红色车辆超越黑色车辆时，提出的方法是能够实现对它的跟踪以及数据融合。
其中，五个毫米波雷达分别指：
前方毫米波雷达(FLR，红色探测区域)、侧前方左毫米波雷达(FSRL，绿色探测区域)、侧前方右毫米波雷达(FSRR，绿色探测区域)、侧后方左毫米波雷达(RSRL，橙色探测区域)和侧后方右毫米波雷达(RSRR，橙色探测区域)。
如图6所示，图中虚线的起始点为后方车辆所在的位置，后方车辆从前方车辆的左方进行超车；其中后方车辆在超赶前方车辆过程中，前方车辆对后方车辆的跟踪可以分为五个阶段：
第一阶段是RSRL(侧后方左)和RSRR(侧后方右)的融合跟踪；
第二阶段是RSRL(侧后方左)的跟踪；
第三阶段是RSRL(侧后方左)和FSRL(侧前方左)的融合跟踪；
第四阶段是FSRL(侧前方左)的跟踪；
最后阶段是FSRL(侧前方左)、FSRR(侧前方右)和FLR(前方)的融合跟踪。
每个阶段，各个雷达都将原始探测数据发送到跟踪及数据融合中心(Trackingand Data Fusion Center)进行处理。在这个过程中，既有单一雷达的跟踪，例如第二、四阶段；也有多雷达的融合跟踪，例如第一、三、五阶段。
由于融合算法是在目标跟踪算法的基础上完成的，下面以单个雷达为例，说明跟踪算法是如何实现对目标的连续跟踪。
如图7所示，跟踪算法对雷达测量的处理主要分为四个部分：
航迹预测(Track Prediction)、数据关联(DataAssociation)、卡尔曼滤波(Kalman Filter)和航迹管理(Track Management)；其中，雷达探测(Radar Detection)将当前雷达探测到的探测数据传输给数据关联(Data Association)、卡尔曼滤波(KalmanFilter)，为数据关联和航迹信息的数据更新做准备。
对于每个被跟踪的目标，跟踪算法都会分配一个ID，每个ID代表了目标对应的航迹；
航迹管理模块(Track Management)就是对些ID代表的航迹进行管理，例如航迹初始化、航迹合并等等；
航迹预测(Track Prediction)需要将上一个时刻目标的航迹信息，通过建立的系统模型预测到当前时刻；
当收到雷达的探测信息后，第一步需要做的是将航迹和雷达测量(探测数据)进行关联，得到关联信息；即数据关联；
接下来就是用关联后的测量，对目标的航迹信息进行更新，例如目标位置、速度、加速度等信息的更新，该过程通常需要用到卡尔曼滤波算法(Kalman Filter)；
其中，卡尔曼滤波的时间更新公式为：
卡尔曼滤波的状态更新公式为：
这里的z是传感器测量信息；x是航迹信息的均值，
为更新后的航迹信息的均值，
为预测的航迹信息的均值；p是航迹信息的均值对应的协方差；x和p属于航迹信息；k是卡尔曼增益；上述公式中的A、Q、H、R均为已知参数，
在初始时刻，传感器初始探测信息z0用来初始化航迹信息x0，比如z0可能只有位置信息，但是x0可能有位置和速度信息。
具体地，本实施例中如果给出初始时刻航迹信息的均值为
则利用公式(1)得到下一时刻的预测信息的均值
其中，航迹信息的均值包括位置信息和速度信息；因为坐标系有x轴和y轴，目标的运动也是可以分解到这两个方向上的；目标的实际运动位置和运动速度，可以看作是这两个方向上的合位移和合速度。
本实施例中可以利用公式(5)以及已知参数，将公式(5)中的k换为k-1可以求得
利用求得的
公式(2)和已知参数，可以求得
将
和已知参数带入公式(3)，求得
如果给定k时刻的探测数据
则在将Kk和
带入公式(4)中，最终得到
其中，因为p是航迹信息的均值x对应的协方差，所以由
也能够得到协方差
当目标对应的航迹更新后，需要对更新后的航迹再次进行航迹管理，以便能够输出所需要的各种信息。需要说明的是，每个传感器的数据被处理完后，要进行一次航迹管理。
在单个传感器对目标的跟踪基础之上，序贯式融合算法将每个需要融合的雷达测量数据，按顺序处理，下面以RSRR和RSRL两个雷达的数据融合为例。
如图8所示，当RSRR雷达的数据用跟踪算法处理后，会进行第一次航迹管理，此时不会直接输出航迹信息，而是在此基础之上，将更新后的航迹，与RSRL雷达测量进行数据关联，其中没有航迹预测的过程。
当数据关联之后，用卡尔曼滤波算法对每条航迹再次进行更新，更新之后的航迹需要再次进行航迹管理，之后便可输出所需要的目标信息。
以上便是该发明提出的多传感器序贯式目标跟踪及数据融合方法。
本发明实施例还提供了一种用于对目标探测数据进行处理的装置，如图9所示，所述装置包括：
多雷达探测处理模块202，用于在检测到多个传感器对目标进行同时探测时，依次对多个传感器的探测过程进行处理；
所述多雷达探测处理模块202包括当前传感器处理单元302和传感器更新单元304；
所述当前传感器处理单元302包括：
前一传感器航迹关联子单元402，用于将当前传感器的探测信息与前一传感器输出的航迹进行关联，得到关联信息；
第一更新子单元404，用于利用所述关联信息对所述航迹的航迹信息进行更新，
第一航迹管理子单元406，用于对更新后的航迹信息进行航迹管理；
所述传感器更新单元304，用于将下一传感器更新为当前传感器，并进行探测过程的处理；
探测数据输出模块204，用于在当前传感器为多个传感器中用于探测的最后一个传感器，且在最后一个传感器探测过程处理结束后输出对所述目标的最终处理数据。
进一步地，所述多雷达探测处理模块202，还包括：
第一传感器处理单元306，用于在当前传感器为多个传感器中用于探测的第一个传感器时，则对第一个传感器探测过程进行处理；
所述第一传感器处理单元306，如图10所示，包括：
航迹预测子单元602，用于根据所述目标的上一帧航迹信息预测当前帧的航迹，
预测航迹关联子单元604，用于将所述第一个传感器的探测信息与预测得到的航迹进行关联，得到关联信息；
第二更新子单元606，用于利用所述关联信息对预测得到的航迹的航迹信息进行更新，
第二航迹管理子单元608，用于对更新后的航迹信息进行航迹管理。
进一步地，如图11所示，所述前一传感器航迹关联子单元402，包括：
探测信息航迹获取子单元802，用于获取当前传感器的多个探测信息，以及前一传感器的航迹；
最小探测距离获取子单元804，用于获取每个探测信息对应计算出的马氏距离，并得出最小马氏距离值；
最小探测距离关联子单元806，用于将所述航迹与所述最小马氏距离值对应的探测信息相关联，所述最小马氏距离值对应的探测信息为关联信息。
进一步地，所述航迹管理包括对航迹进行初始化、合并和删除；
所述对航迹进行初始化是为剩余的探测数据确定出对应的航迹；所述对航迹进行合并是将当前时刻的航迹信息中，与前一时刻的航迹信息相同的航迹进行合并。
进一步地，所述多雷达探测处理模块，还包括：
身份分配单元，用于为所述目标分配一个身份标识符，所述身份标识符用于代表所述目标的航迹。
本发明提供的一种用于对目标探测数据进行处理的方法、装置具有的有益效果为：
本发明在检测到多个传感器对目标进行同时探测时，依次对多个传感器的探测过程进行处理；在当前传感器为多个传感器中用于探测的最后一个传感器，且在最后一个传感器探测过程处理结束后输出对所述目标的最终处理数据；其中，多个传感器中当前传感器探测过程的处理方法包括：将当前传感器的探测信息与前一传感器的航迹进行关联，得到关联信息；利用所述关联信息对所述航迹的航迹信息进行更新，对更新后的航迹信息进行航迹管理。通过本发明将多个传感器对目标的探测数据进行融合(序贯式融合方式)，并进行有次序、分批次的处理，能够避免现有技术因为传感器数量或种类的改变导致算法无法正常工作的问题。通过这种有次序分批次的序贯式融合方式，使得算法对各个传感器数据的处理相对独立，相比于所有数据一起处理，运算效率得到提升。
并且，本发明对传感器的数量和种类没有限制，具有高度兼容性，便于车辆传感器的选配；进一步地，在某个传感器失效时，并不影响整个系统的工作。
本发明中所述模块/单元的划分，仅仅为一种逻辑功能划分，实际实现时可以有另外的划分方式，例如多个单元或组件可以结合或者可以集成到另一个系统，或一些特征可以忽略，或不执行。可以根据实际的需要选择其中的部分或者全部模块/单元来达到实现本发明方案的目的。
另外，在本发明各个实施例中的各模块/单元可以集成在一个处理单元中，也可以是各个单元单独物理存在，也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现，也可以采用软件功能单元的形式实现。
以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。
Claims (10)
1.一种用于对目标探测数据进行处理的方法，其特征在于，所述方法包括：
在检测到多个传感器对目标进行同时探测时，依次对多个传感器的探测过程进行处理，包括：
对多个传感器中当前传感器的探测过程进行处理，包括：
将当前传感器的探测信息与前一传感器输出的航迹进行关联，得到关联信息，
利用所述关联信息对所述前一传感器的航迹信息进行更新，所述当前传感器与所述前一传感器是同时对所述目标进行探测的传感器，
对更新后的航迹信息进行航迹管理，
将下一个传感器更新为当前传感器，并进行探测过程的处理；
在当前传感器为多个传感器中用于探测的最后一个传感器，且在最后一个传感器探测过程处理结束后输出对所述目标的最终处理数据。
2.根据权利要求1所述的用于对目标探测数据进行处理的方法，其特征在于，所述依次对多个传感器的探测过程进行处理，还包括：
在当前传感器为多个传感器中用于探测的第一个传感器时，则对第一个传感器探测过程进行处理；包括：
根据所述目标的上一帧航迹信息预测当前帧的航迹，
将所述第一个传感器的探测信息与预测得到的航迹进行关联，得到关联信息；
利用所述关联信息对预测得到的航迹的航迹信息进行更新，
对更新后的航迹信息进行航迹管理。
3.根据权利要求1所述的用于对目标探测数据进行处理的方法，其特征在于，所述将当前传感器的探测信息与前一传感器输出的航迹进行关联，得到关联信息；包括：
获取当前传感器的多个探测信息，以及前一传感器输出的航迹；
获取每个探测信息对应计算出的马氏距离，并得出最小马氏距离值；
将所述航迹与所述最小马氏距离值对应的探测信息相关联，所述最小马氏距离值对应的探测信息为关联信息。
4.根据权利要求2所述的用于对目标探测数据进行处理的方法，其特征在于，
所述航迹管理包括对航迹进行初始化、合并和删除；
所述对航迹进行初始化，是为剩余的探测数据确定出对应的航迹；所述对航迹进行合并，是将当前时刻的航迹信息中，与前一时刻的航迹信息相同的航迹合为一个航迹。
5.根据权利要求2所述的用于对目标探测数据进行处理的方法，其特征在于，所述根据所述目标的上一帧航迹信息预测当前帧的航迹，之前包括：
为所述目标分配一个身份标识符，所述身份标识符用于代表所述目标的航迹。
6.一种用于对目标探测数据进行处理的装置，其特征在于，所述装置包括：多雷达探测处理模块和探测数据输出模块；
所述多雷达探测处理模块，用于在检测到多个传感器对目标进行同时探测时，依次对多个传感器的探测过程进行处理；
所述多雷达探测处理模块包括当前传感器处理单元和传感器更新单元；所述当前传感器处理单元包括：
前一传感器航迹关联子单元，用于将当前传感器的探测信息与前一传感器输出的航迹进行关联，得到关联信息；
第一更新子单元，用于利用所述关联信息对所述前一传感器的航迹信息进行更新，所述当前传感器与所述前一传感器是同时对所述目标进行探测的传感器，
第一航迹管理子单元，用于对更新后的航迹信息进行航迹管理；
所述传感器更新单元，用于将下一传感器更新为当前传感器，并进行探测过程的处理；
所述探测数据输出模块，用于在当前传感器为多个传感器中用于探测的最后一个传感器，且在最后一个传感器探测过程处理结束后输出对所述目标的最终处理数据。
7.根据权利要求6所述的用于对目标探测数据进行处理的装置，其特征在于，所述多雷达探测处理模块，还包括：
第一传感器处理单元，用于在当前传感器为多个传感器中用于探测的第一个传感器时，则对第一个传感器探测过程进行处理；
所述第一传感器处理单元包括：
航迹预测子单元，用于根据所述目标的上一帧航迹信息预测当前帧的航迹，
预测航迹关联子单元，用于将所述第一个传感器的探测信息与预测得到的航迹进行关联，得到关联信息；
第二更新子单元，用于利用所述关联信息对所述航迹的航迹信息进行更新，
第二航迹管理子单元，用于对更新后的航迹信息进行航迹管理。
8.根据权利要求6所述的用于对目标探测数据进行处理的装置，其特征在于，所述前一传感器航迹关联子单元，包括：
探测信息航迹获取子单元，用于获取当前传感器的多个探测信息，以及前一传感器输出的航迹；
最小探测距离获取子单元，用于获取每个探测信息对应计算出的马氏距离，并得出最小马氏距离值；
最小探测距离关联子单元，用于将所述航迹与所述最小马氏距离值对应的探测信息相关联，所述最小马氏距离值对应的探测信息为关联信息。
9.根据权利要求7所述的用于对目标探测数据进行处理的装置，其特征在于，
所述航迹管理包括对航迹进行初始化、合并和删除；
所述对航迹进行初始化是为剩余的探测数据确定出对应的航迹；所述对航迹进行合并是将当前时刻的航迹信息中，与前一时刻的航迹信息相同的航迹进行合并。
10.根据权利要求7所述的用于对目标探测数据进行处理的装置，其特征在于，所述多雷达探测处理模块，还包括：
身份分配单元，用于为所述目标分配一个身份标识符，所述身份标识符用于代表所述目标的航迹。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201810846019.6A CN108803622B (zh) | 2018-07-27 | 2018-07-27 | 一种用于对目标探测数据进行处理的方法、装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201810846019.6A CN108803622B (zh) | 2018-07-27 | 2018-07-27 | 一种用于对目标探测数据进行处理的方法、装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN108803622A CN108803622A (zh) | 2018-11-13 |
| CN108803622B true CN108803622B (zh) | 2021-10-26 |
Family
ID=64078495
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201810846019.6A Active CN108803622B (zh) | 2018-07-27 | 2018-07-27 | 一种用于对目标探测数据进行处理的方法、装置 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN108803622B (zh) |
Families Citing this family (13)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111351491A (zh) * | 2018-12-24 | 2020-06-30 | 长城汽车股份有限公司 | 目标数据融合方法及系统 |
| CN109996176B (zh) * | 2019-05-20 | 2021-08-10 | 北京百度网讯科技有限公司 | 路侧感知与车辆终端车路协同融合处理方法和装置 |
| CN110132290B (zh) * | 2019-05-20 | 2021-12-14 | 北京百度网讯科技有限公司 | 智能驾驶路侧设备感知信息融合处理方法、装置、设备 |
| CN112154444B (zh) * | 2019-10-17 | 2021-12-17 | 深圳市大疆创新科技有限公司 | 目标检测与跟踪方法、系统、可移动平台、相机及介质 |
| CN110879395B (zh) * | 2019-12-03 | 2022-09-09 | 北京百度网讯科技有限公司 | 障碍物位置预测方法、装置和电子设备 |
| CN110879598A (zh) * | 2019-12-11 | 2020-03-13 | 北京踏歌智行科技有限公司 | 车辆用多传感器的信息融合方法和装置 |
| CN112363131B (zh) * | 2020-09-03 | 2024-05-14 | 江西华讯方舟智能技术有限公司 | 车载毫米波雷达数据的处理方法、装置及计算机存储介质 |
| CN112033429B (zh) * | 2020-09-14 | 2022-07-19 | 吉林大学 | 一种智能汽车的目标级多传感器融合方法 |
| CN112750305B (zh) * | 2020-12-29 | 2022-03-08 | 江苏航天大为科技股份有限公司 | 一种基于雷达检测的车辆连续跟踪方法 |
| CN113687347B (zh) * | 2021-06-22 | 2023-11-17 | 中国电子科技集团公司电子科学研究院 | 一种航迹簇数据处理方法、系统及可读存储介质 |
| CN113536057B (zh) * | 2021-07-29 | 2023-03-07 | 中国第一汽车股份有限公司 | 一种航迹管理方法、装置、计算机设备以及存储介质 |
| CN114690177A (zh) * | 2022-03-31 | 2022-07-01 | 重庆长安汽车股份有限公司 | 一种自动驾驶的目标关联方法、系统及电子设备 |
| CN116150299B (zh) * | 2023-04-21 | 2023-07-04 | 北京航空航天大学 | 一种可信度传播网络指引的多源轨迹关联方法 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103954939A (zh) * | 2014-01-21 | 2014-07-30 | 中国人民解放军海军航空工程学院 | 基于雷达组网的抗灵巧噪声干扰方法 |
| CN104749576A (zh) * | 2015-04-08 | 2015-07-01 | 四川九洲空管科技有限责任公司 | 一种多雷达航迹关联融合方法 |
| CN104808197A (zh) * | 2015-05-06 | 2015-07-29 | 四川九洲空管科技有限责任公司 | 一种多监视源飞行目标并行跟踪处理方法 |
| CN107066806A (zh) * | 2017-02-15 | 2017-08-18 | 中国人民解放军海军航空工程学院 | 航迹关联方法及装置 |
| CN107798870A (zh) * | 2017-10-25 | 2018-03-13 | 清华大学 | 一种多车辆目标跟踪的航迹管理方法及系统、车辆 |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US7626535B2 (en) * | 2006-11-09 | 2009-12-01 | Raytheon Company | Track quality based multi-target tracker |
| CN106291533B (zh) * | 2016-07-27 | 2018-10-16 | 电子科技大学 | 一种基于amd的分布式多传感器融合方法 |
-
2018
- 2018-07-27 CN CN201810846019.6A patent/CN108803622B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103954939A (zh) * | 2014-01-21 | 2014-07-30 | 中国人民解放军海军航空工程学院 | 基于雷达组网的抗灵巧噪声干扰方法 |
| CN104749576A (zh) * | 2015-04-08 | 2015-07-01 | 四川九洲空管科技有限责任公司 | 一种多雷达航迹关联融合方法 |
| CN104808197A (zh) * | 2015-05-06 | 2015-07-29 | 四川九洲空管科技有限责任公司 | 一种多监视源飞行目标并行跟踪处理方法 |
| CN107066806A (zh) * | 2017-02-15 | 2017-08-18 | 中国人民解放军海军航空工程学院 | 航迹关联方法及装置 |
| CN107798870A (zh) * | 2017-10-25 | 2018-03-13 | 清华大学 | 一种多车辆目标跟踪的航迹管理方法及系统、车辆 |
Non-Patent Citations (1)
| Title |
|---|
| 海上目标多源轨迹数据关联综述;鹿强等;《地球信息科学》;20180531;第20卷(第5期);第571-581页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN108803622A (zh) | 2018-11-13 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN108803622B (zh) | 一种用于对目标探测数据进行处理的方法、装置 | |
| CN110726990B (zh) | 一种基于ds-gnn算法的多传感器融合方法 | |
| US10035508B2 (en) | Device for signalling objects to a navigation module of a vehicle equipped with this device | |
| Aeberhard et al. | High-level sensor data fusion architecture for vehicle surround environment perception | |
| CN109086788A (zh) | 用于从异构装置感测的多种不同格式的数据的多模式融合处理的设备、方法和系统 | |
| CN106093951B (zh) | 基于超声波传感器阵列的物体跟踪方法 | |
| CN105466438A (zh) | 防撞车辆中的传感器测距和应用 | |
| CN113848545B (zh) | 一种基于视觉和毫米波雷达的融合目标检测和跟踪方法 | |
| CN108345823B (zh) | 一种基于卡尔曼滤波的障碍物跟踪方法和装置 | |
| CN114170274B (zh) | 目标跟踪方法和装置、电子设备和存储介质 | |
| CN111866728B (zh) | 多站点路基网络感知方法、装置、终端和系统 | |
| CN106183989B (zh) | 车辆驾驶辅助装置及车辆驾驶辅助装置的动作方法 | |
| CN114035187A (zh) | 一种自动驾驶系统的感知融合方法 | |
| Sandblom et al. | Sensor data fusion for multiple configurations | |
| CN114049767A (zh) | 一种边缘计算方法、装置及可读存储介质 | |
| JP2019514011A (ja) | 可動オブジェクトのオブジェクト・キネマティクスを割り出すための装置および方法 | |
| Kurapati et al. | Multiple object tracking using radar and vision sensor fusion for autonomous vehicle | |
| EP4160269A1 (en) | Systems and methods for onboard analysis of sensor data for sensor fusion | |
| Cardarelli et al. | Cloud robotics paradigm for enhanced navigation of autonomous vehicles in real world industrial applications | |
| Goli et al. | Cooperative multi-sensor multi-vehicle localization in vehicular adhoc networks | |
| US20200258379A1 (en) | Determination of movement information with surroundings sensors | |
| CN113470070B (zh) | 驾驶场景目标跟踪方法、装置、设备及存储介质 | |
| Quack et al. | Infrastructure-based tracking of road users in urban intersections for partially available, variable-delay sensor data | |
| Frijters | Adaptive recursive clustering and target tracking | |
| CN115240430B (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 |