CN115066631A - 用于跟踪对象的扩张状态的系统和方法 - Google Patents
用于跟踪对象的扩张状态的系统和方法 Download PDFInfo
- Publication number
- CN115066631A CN115066631A CN202080095913.XA CN202080095913A CN115066631A CN 115066631 A CN115066631 A CN 115066631A CN 202080095913 A CN202080095913 A CN 202080095913A CN 115066631 A CN115066631 A CN 115066631A
- Authority
- CN
- China
- Prior art keywords
- distribution
- measurement
- state
- truncated
- measurements
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 49
- 238000005259 measurement Methods 0.000 claims abstract description 250
- 238000009826 distribution Methods 0.000 claims abstract description 146
- 230000033001 locomotion Effects 0.000 claims abstract description 33
- 230000008054 signal transmission Effects 0.000 claims abstract description 7
- 230000005540 biological transmission Effects 0.000 claims abstract description 6
- 239000011159 matrix material Substances 0.000 claims description 28
- 230000008569 process Effects 0.000 claims description 20
- 230000002776 aggregation Effects 0.000 claims description 9
- 238000004220 aggregation Methods 0.000 claims description 9
- 230000008859 change Effects 0.000 claims description 3
- 239000002245 particle Substances 0.000 claims description 3
- 230000001143 conditioned effect Effects 0.000 claims description 2
- 230000004044 response Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 22
- 230000006870 function Effects 0.000 description 15
- 238000007476 Maximum Likelihood Methods 0.000 description 7
- 230000006978 adaptation Effects 0.000 description 5
- 238000001914 filtration Methods 0.000 description 5
- 238000010606 normalization Methods 0.000 description 5
- 230000001133 acceleration Effects 0.000 description 4
- 238000011156 evaluation Methods 0.000 description 4
- 238000004891 communication Methods 0.000 description 3
- 230000009466 transformation Effects 0.000 description 3
- 230000001186 cumulative effect Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 230000003993 interaction Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 241001061260 Emmelichthys struhsakeri Species 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000010339 dilation Effects 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 230000000717 retained effect Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 239000002904 solvent Substances 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000002604 ultrasonography Methods 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
- G01S13/726—Multiple target tracking
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
-
- 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/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- 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/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9327—Sensor installation details
- G01S2013/93271—Sensor installation details in the front of the vehicles
-
- 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/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9327—Sensor installation details
- G01S2013/93274—Sensor installation details on the side of the vehicles
-
- 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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Radar Systems Or Details Thereof (AREA)
- Traffic Control Systems (AREA)
Abstract
本文中提供了一种用于跟踪对象的扩张状态的系统和方法,对象的扩张状态包括指示对象的位置的运动学状态和指示对象的尺寸和取向之一或组合的伸展状态。该系统包括:至少一个传感器,其被配置为利用一个或多个信号传输探测包括移动对象的场景,以每传输生成对象的一个或多个测量;以及处理器,其被配置为执行概率滤波器,该概率滤波器跟踪由对象的运动模型和对象的测量模型估计的对象的扩张状态的联合概率,其中,测量模型包括具有截断区间的中心截断分布。该系统还包括输出接口,其被配置为输出对象的扩张状态。
Description
技术领域
本发明总体上涉及汽车对象跟踪,更具体地,涉及用于跟踪对象的扩张(expanded)状态的系统和方法。
背景技术
车辆(自主车辆或半自主车辆)所采用的控制系统为车辆预测安全运动或路径以便避免与诸如其它车辆或行人的障碍物的碰撞,并且控制系统还优化了关联到车辆的操作的一些标准。车辆的传感器感测诸如道路边缘、行人和其它车辆的周围环境。汽车rad bvar从现有ADAS(高级驾驶员辅助系统)到新兴的自主驾驶辅助系统已显露了其作用。连同超声、相机和LIDAR传感器一起,汽车雷达以可承受的成本和可伸缩生产辅助在全天候条件下进行环境感测和理解的任务。具体地,汽车雷达提供径向速度的直接测量,操作范围长,毫米或亚太赫兹频带的小尺寸,空间分辨率高。
车辆的控制系统基于汽车雷达测量来跟踪其它车辆的对象状态(其中对象状态包括运动学状态),以控制车辆。与每次扫描仅包括一个测量的传统点对象跟踪相比,通过从仅运动学状态到运动学状态和伸展(extended)状态二者增强对象状态,每次扫描具有多个测量的伸展对象跟踪(EOT)已显示出改进的对象跟踪。伸展状态提供所跟踪的对象的尺寸和取向。为了实现这一点,需要连同传感器噪声一起捕获空间分布(即,汽车雷达测量如何围绕对象空间分布)。当前方法包括刚体上的固定点集合的框架,其即使对于单个对象跟踪,也需要固定点集合与汽车雷达检测之间的不可伸缩数据关联。诸如轮廓模型和表面模型的空间模型绕过繁琐的数据关联步骤。
对于汽车雷达测量,轮廓模型反映沿着对象(例如,刚体)轮廓的测量分布,表面模型假设从二维形状的内表面生成雷达测量。轮廓模型的示例包括简单矩形形状以及由随机超曲面模型或高斯过程模型建模的更一般的星凸形状。与需要更多自由度来描述更复杂形状的轮廓模型相比,诸如基于高斯的椭圆和基于分层高斯的椭圆模型的表面模型在计算上简单很多。然而,对象的测量受噪声影响,并且仅从对象表面接收反射,因此,上述模型与真实世界汽车雷达测量相去甚远,因为观测到真实世界汽车雷达测量是围绕具有特定体积的刚性对象的边缘或表面分配的。
因此,需要一种通过捕获真实世界汽车雷达测量来跟踪对象的运动学状态和伸展状态的系统和方法。
发明内容
一些实施方式的目的在于提供一种用于跟踪对象的扩张状态的系统和方法。对象的扩张状态包括指示对象的位置的运动学状态和指示对象的尺寸和取向之一或组合的伸展状态。一些实施方式基于这样的认识:对象的扩张状态可使用中心截断分布和对应底层未截断高斯分布来估计。
一些实施方式基于使用汽车雷达测量来跟踪对象的目标。为此,在一些实施方式中,利用每次扫描从对象接收单个测量的点对象跟踪来跟踪对象。点对象跟踪仅提供对象的运动学状态(位置)。此外,利用具有运动学状态分布的测量模型的概率滤波器来跟踪对象。一些实施方式基于伸展对象跟踪(EOT),其中跟踪多个对象并且与各个对象对应生成每时间步多个测量。测量是围绕对象空间构造的。伸展对象跟踪提供对象的运动学状态和伸展状态(尺寸和取向)二者。运动学状态和伸展状态合称为扩张状态。利用具有扩张状态分布的测量模型的概率滤波器来跟踪对象。
然而,真实世界汽车雷达测量分布表明来自对象的多个反射是复杂的。由于这种复杂性,测量模型的设计变得复杂。因此,常规测量模型仅适用于运动学状态,而不适用于伸展状态。
为此,在一些实施方式中,诸如轮廓模型和表面模型的空间模型用于捕获真实世界汽车雷达测量。然而,上述空间模型是不准确的。一些实施方式基于这样的认识:真实世界汽车雷达测量围绕具有特定体积的对象的边缘或表面分布,这导致了表面体积模型。表面体积模型在轮廓模型与表面模型之间平衡,其具有更逼真的特征,同时保持EOT准确。然而,表面体积模型在计算方面复杂。为此,一些实施方式基于这样的目标:制定分布密度出现在末端而非中心的模型,以使得其类似于并捕获真实世界汽车雷达测量。
为了实现这一点,通过概率滤波器迭代地估计中心截断分布。中心截断分布用于拟合测量。中心截断分布基于中心处的截断区间并且对于该截断区间内的中心截断分布中心处的测量提供较小的概率,对于该截断区间之外的测量提供较大的概率。为此,一些实施方式基于这样的认识:中心截断分布可用于表示真实世界测量。
中心截断分布是底层未截断高斯分布根据截断区间的截断。底层高斯分布以分布的均值为中心,并且方差测量分布的展开和宽度。
为此,一些实施方式基于这样的目标:估计拟合测量的中心截断分布以及随后与估计的中心截断分布对应的底层高斯分布的均值和方差。一些实施方式基于这样的认识:底层高斯分布的均值指示对象在扩张状态下的位置,底层高斯分布的方差指示对象在扩张状态下的尺寸和取向。为此,一些实施方式基于这样的认识:使用中心截断分布和底层高斯分布对,可估计对象的运动学状态和扩张状态二者。另外,这简化了跟踪扩张状态的参数化。此外,使用中心截断和底层高斯分布对,计算的维度减少。
一些实施方式基于这样的目标:当测量受到噪声影响时,从测量去除噪声。在一些实施方式中,概率滤波器被配置为在根据中心截断高斯分布评估无噪测量源之前从测量去除噪声,使得概率滤波器生成拟合无噪测量源的中心截断分布。此外,针对没有噪声的测量源确定截断区间。根据一些实施方式,测量模型是为各个测量限定无噪源的隐藏测量的概率参数的分层测量模型。
为此,一些实施方式基于这样的认识:分层测量模型基本上不仅捕获空间分布,即,汽车雷达测量如何围绕对象空间分布,而且捕获传感器噪声的特性。此外,针对运动学状态和伸展状态二者基于分层测量模型制定贝叶斯EOT算法。在一些实施方式中,通过递归地预测扩张状态并更新扩张状态和截断区间来根据分层测量模型开发贝叶斯EOT算法。截断区间也被称为截断边界。
在一些实施方式中,为了更新截断边界,使用来自第(t-1)迭代的更新的状态估计将全局坐标中的时间步k的测量转换为对象坐标系中的局部测量。截断边界Bk定义密度支持Dk。利用从时间步k-L+1至时间步k的扫描聚合局部测量,使用最大似然估计来更新由Bk指定的截断边界。为此,更新截断边界,并因此获得更新的截断边界。利用更新的截断边界和时间步k的测量,使用修改的随机矩阵更新运动学状态和伸展状态。
此外,在一些实施方式中,使用具有有界不确定性的扩张状态的车辆模型来确定车辆的控制器的控制输入,并且根据控制输入来控制车辆。车辆模型包括受过程噪声影响的对象的运动模型和受测量噪声影响的对象的测量模型,使得过程噪声和测量噪声之一或组合界定对象的扩张状态的不确定性。
因此,一个实施方式公开了一种用于跟踪包括指示对象的位置的运动学状态和指示对象的尺寸和取向之一或组合的伸展状态的对象的扩张状态的系统,该系统包括:至少一个传感器,其被配置为利用一个或多个信号传输探测包括移动对象的场景,以生成对象的一个或多个测量;处理器,其被配置为执行概率滤波器,该概率滤波器跟踪由对象的运动模型和对象的测量模型估计的对象的扩张状态的联合概率,其中,测量模型包括具有截断区间的中心截断分布,对于截断区间内的中心截断分布的中心处的测量提供较小概率,并且对于截断区间之外的测量提供较大概率,其中,中心截断分布是底层未截断高斯分布根据截断区间的截断,其中,概率滤波器被配置为估计拟合测量的中心截断分布并且生成与中心截断分布对应的底层高斯分布的均值和方差,使得底层高斯分布的均值指示对象在扩张状态下的位置,底层高斯分布的方差指示对象在扩张状态下的尺寸和取向;以及输出接口,其被配置为输出对象的扩张状态。
因此,另一实施方式公开了一种用于跟踪包括指示对象的位置的运动学状态和指示对象的尺寸和取向之一或组合的伸展状态的对象的扩张状态的方法,其中,该方法使用联接到存储可执行指令的存储器的处理器,这些可执行指令在由处理器执行时执行该方法的步骤,该方法包括以下步骤:由至少一个传感器利用一个或多个信号传输探测包括移动对象的场景,以按照传输生成对象的一个或多个测量;执行概率滤波器,该概率滤波器跟踪由对象的运动模型和对象的测量模型估计的对象的扩张状态的联合概率,其中,测量模型包括具有截断区间的中心截断分布,对于截断区间内的中心截断分布的中心处的测量提供较小概率,并且对于截断区间之外的测量提供较大概率,其中,中心截断分布是底层未截断高斯分布根据截断区间的截断,其中,概率滤波器估计拟合测量的中心截断分布并且生成与中心截断分布对应的底层高斯分布的均值和方差,使得底层高斯分布的均值指示对象在扩张状态下的位置,底层高斯分布的方差指示对象在扩张状态下的尺寸和取向;以及经由输出接口输出对象的扩张状态。
当前公开的实施方式将参照附图进一步说明。所示的附图未必按比例,而是重点通常放在示出当前公开的实施方式的原理。
附图说明
[图1A]图1A共同示出用于跟踪对象的扩张状态的一些实施方式所使用的一些原理的示意性概览。
[图1B]图1B共同示出用于跟踪对象的扩张状态的一些实施方式所使用的一些原理的示意性概览。
[图1C]图1C共同示出用于跟踪对象的扩张状态的一些实施方式所使用的一些原理的示意性概览。
[图2]图2示出根据一些实施方式的用于跟踪对象的扩张状态的系统的框图。
[图3]图3示出根据一些实施方式的使用递归贝叶斯滤波的对象的扩张状态的后验密度的递归计算的示意图。
[图4]图4示出根据一些实施方式的隐藏测量源变量和可观测测量的分布的示例。
[图5A]图5A示出根据一些实施方式的当对象的正面或背面面向传感器时的示例性截断区间自适应。
[图5B]图5B示出根据一些实施方式的当对象相对于传感器侧向取向时的示例性截断区间自适应。
[图6]图6示出根据一些实施方式的扩张状态预测步骤的示意图。
[图7A]图7A示出根据一些实施方式的扩张状态更新步骤的示意图。
[图7B]图7B示出根据一些实施方式的示例性伪测量。
[图7C]图7C示出根据一些实施方式的伪测量生成、截断边界更新和扩张状态更新的示意图。
[图8A]图8A示出根据一些实施方式的截断边界更新步骤的示意图。
[图8B]图8B示出根据一些实施方式的对象坐标系中的滤波扫描聚合。
[图9A]图9A示出根据一些实施方式的对象在转弯过程中移动90个时间步的情景的仿真。
[图9B]图9B示出根据一些实施方式的利用理想测量模型的性能评估曲线图。
[图9C]图9C是示出利用理想测量模型与正则随机矩阵(RM)和分层截断高斯随机矩阵(HTG-RM)对应的对象的运动学状态和伸展状态估计的均方根误差(RMSE)的表列。
[图10A]图10A示出根据一些实施方式的在模型失配下的性能评估曲线图。
[图10B]图10B是示出在模型失配下与RM和HTG-RM对应的对象的运动学状态和伸展状态估计的RMSE的表。
[图11A]图11A示出包括与采用一些实施方式的原理的系统通信的控制器的车辆的示意图。
[图11B]图11B示出根据一些实施方式的控制器与车辆的控制器之间的交互的示意图。
[图11C]图11C示出使用一些实施方式生成控制输入的自主或半自主受控车辆的示意图。
具体实施方式
在以下描述中,为了说明,阐述了众多具体细节以便提供本公开的彻底理解。然而,对于本领域技术人员而言将显而易见的是,本公开可在没有这些具体细节的情况下实践。在其它情况下,设备和方法仅以框图形式示出,以避免使本公开模糊。
如本说明书和权利要求中使用的,术语“例如”和“诸如”以及动词“包括”、“具有”、“包含”及其其它动词形式在结合一个或更多个组件或其它项目的列表使用时各自应被解释为开放式,意味着列表不应被视为排除其它附加组件或项目。术语“基于”意指至少部分地基于。此外,将理解,本文所采用的措辞和术语是为了描述目的,不应被视为限制。此描述内利用的任何标题仅是为了方便,不具有法律或限制作用。
图1A、图1B和图1C示出用于跟踪对象的扩张状态的一些实施方式所使用的一些原理的示意性概览。传感器104(例如,汽车雷达)用于跟踪对象(例如车辆106)。在点对象跟踪100中,从车辆106接收每次扫描单个测量108。点对象跟踪仅提供车辆106的运动学状态(位置)。此外,利用具有运动学状态分布的测量模型的概率滤波器来跟踪车辆106。在伸展对象跟踪(EOT)102中,接收每次扫描多个测量110。多个测量110围绕车辆106空间构造。伸展对象跟踪提供车辆106的运动学状态和伸展状态(尺寸和取向)。运动学状态和伸展状态被合称为扩张状态。利用具有伸展状态分布的测量模型的概率滤波器来跟踪车辆106。然而,真实世界汽车雷达测量112分布表明来自车辆106的多个反射是复杂的。由于这种复杂性,测量模型的设计变得复杂。因此,常规测量模型仅适用于运动学状态,而不适用于扩张状态。
为此,在一些实施方式中,使用诸如轮廓模型116和表面模型118的空间模型114来捕获真实世界汽车雷达测量112。然而,上述空间模型114是不准确的。一些实施方式基于这样的认识:真实世界汽车雷达测量围绕具有特定体积的对象(车辆106)的边缘或表面分布,从而生成表面体积模型120。表面体积模型120在轮廓模型116与表面模型118之间平衡,其具有更逼真的特征,同时保持EOT准确。然而,表面体积模型120在计算方面复杂。为此,一些实施方式基于这样的目标:制定分布密度出现在一个或更多个维度的末端而非中心的模型(如122所示),以使得其类似于并捕获真实世界汽车雷达测量112。
为了实现这一点,在一些实施方式中,估计中心截断分布124。图1C示出具有适当缩放/归一化的一维中心截断分布124和底层未截断高斯分布132。中心截断分布124基于中心126处的截断区间。例如,截断区间由a<x<b给出。中心截断分布124用于拟合测量110。此外,中心截断分布124对于中心截断分布126的中心处(即,截断区间内)的测量提供较小概率,并且对于截断区间128、130之外的测量提供较大概率。为此,一些实施方式基于这样的认识:中心截断分布124可用于表示真实世界汽车雷达测量112。
这一概念可自然地扩展至一个或更多个维度。例如,对象的长度和宽度的二维中心截断分布和对象的长度、宽度和高度的三维中心截断分布。对于多维中心截断分布,截断区域可以是正方形或矩形以外的更复杂的形状。
中心截断分布124是底层未截断高斯分布132以适当归一化/缩放的截断。基于中心截断分布获得底层未截断高斯分布132。中心截断分布124的均值和方差不同于底层未截断高斯分布132的均值136和方差134。在一些实施方式中,底层未截断高斯分布132的均值136和方差134可从中心截断分布124的均值和方差推导。因此,一些实施方式基于这样的认识:在中心截断分布124和底层未截断高斯分布132之间存在相互关系。为此,在一些实施方式中,底层未截断高斯分布132的均值136和方差134可从中心截断分布124的均值和方差推导。
一些实施方式基于这样的认识:底层未截断高斯分布132可用于车辆106的扩张状态估计。为此,在一些实施方式中,中心截断分布124拟合测量源,并且与估计的中心截断分布124对应的底层未截断高斯分布132的均值136和方差134由概率滤波器迭代地估计。底层未截断高斯分布132以分布的均值136为中心,并且方差134测量分布的展开、宽度。底层未截断高斯分布132的均值136指示对象在扩张状态下的位置,底层高斯分布132的方差134指示对象在扩张状态下的尺寸和取向。
为此,一些实施方式基于这样的认识:使用中心截断分布和对应底层未截断高斯分布对,可跟踪对象的扩张状态。另外,这简化了跟踪扩张状态的参数化。此外,使用中心截断和底层高斯分布对,计算的维度减小,因为底层高斯分布132以比表示实际测量的复杂分布更少的参数表示。
图2示出根据一些实施方式的用于跟踪对象的扩张状态的系统200的框图。对象可以是车辆,例如(但不限于)轿车、自行车、公共汽车或卡车。另外,车辆可以是自主或半自主车辆。扩张状态包括指示对象的位置的运动学状态和指示对象的尺寸和/或取向的伸展状态。根据一些实施方式,运动学状态对应于对象的运动参数,例如速度、加速度、航向和转弯速率。在一些其它实施方式中,运动学状态对应于具有其运动参数的对象的位置。系统200可包括传感器202或者操作上连接到一组传感器以利用一个或多个信号传输探测场景,以每传输生成对象的一个或多个测量。根据一些实施方式,传感器202可以是汽车雷达。在一些实施方式中,场景包括移动对象。在一些其它实施方式中,场景可包括一个或更多个对象,其包括移动对象和静止对象二者。
系统200可具有将系统200与其它系统和装置连接的多个接口。例如,网络接口控制器(NIC)214适于通过总线212将系统200连接到网络216,网络216将系统200与操作上连接的一组传感器连接。通过网络216(无线方式或通过有线),系统200接收一个或多个信号传输的反射数据以每传输生成对象的一个或多个测量。另外地或另选地,系统200包括被配置为向控制器222发送控制输入的控制接口228。
系统200包括被配置为执行所存储的指令的处理器204以及存储可由处理器204执行的指令的存储器206。处理器204可以是单核处理器、多核处理器、计算集群或任何数量的其它配置。存储器206可包括随机存取存储器(RAM)、只读存储器(ROM)、闪存或任何其它合适的存储器系统。处理器204通过总线212连接到一个或更多个输入装置和输出装置。这些指令实现用于跟踪对象的扩张状态的方法。
为此,系统200包括运动模型208和测量模型210。在一些实施方式中,系统200包括概率滤波器224。概率滤波器224由处理器204执行。概率滤波器迭代地执行运动模型208以预测扩张状态并执行测量模型210以更新由运动模型208预测的对象的扩张状态。运动模型208的执行产生受对象的尺寸的固定值影响并且变化对象的取向的对象的扩张状态的预测,使得对象的尺寸仅由测量模型210更新,而对象的取向由运动模型208和测量模型210二者更新。
一些实施方式基于这样的认识:测量模型210包括具有截断区间的中心截断分布124。在一些实施方式中,中心截断分布124是中心截断高斯分布。在一些其它实施方式中,中心截断分布124是中心截断student-t分布。中心截断分布124是底层未截断高斯分布根据截断区间的截断。在一些实施方式中,概率滤波器224被配置为估计拟合测量的中心截断分布124。由概率滤波器224执行测量模型210迭代地更新在概率滤波器的先前迭代期间确定的先前截断区间,以生成拟合由运动模型预测的扩张状态的当前截断区间。此外,概率滤波器224利用具有当前截断区间的中心截断高斯分布的测量模型210来更新扩张状态。根据一些实施方式,概率滤波器224是贝叶斯滤波器、卡尔曼滤波器和粒子滤波器之一或组合。贝叶斯滤波器是可与不同类型的分布一起使用的通用滤波器。卡尔曼滤波器以高斯分布高效地工作。在一些实施方式中,处理器204针对传感器202响应于对象取向的改变而改变截断区间。
此外,概率滤波器224被配置为生成与估计的中心截断高斯分布对应的底层高斯分布的均值和方差,使得均值指示对象在扩张状态下的位置,方差指示对象在扩张状态下的尺寸和取向。为此,一些实施方式基于这样的认识:使用所估计的中心截断高斯分布和底层高斯分布,可估计对象的扩张状态。在一些实施方式中,测量模型210的执行输出拟合测量的协方差矩阵。协方差矩阵的对角元素限定对象的尺寸,协方差矩阵的非对角元素限定对象的取向。
一些实施方式基于这样的目标:当测量受噪声影响时,从测量去除噪声。为此,在一些实施方式中,概率滤波器224被配置为在根据中心截断高斯分布评估无噪测量源的似然性之前从测量去除噪声,使得概率滤波器224生成拟合无噪测量源的中心截断分布124。此外,为没有噪声的测量源确定截断区间。根据一些实施方式,测量模型210是分层测量模型,其为各个测量限定无噪源的隐藏测量的概率参数。
系统200包括车辆226的模型,其包括受过程噪声影响的对象的运动模型208和受测量噪声影响的对象的测量模型210,使得过程噪声和测量噪声之一或组合界定对象的扩张状态的不确定性。系统200在操作上连接到车辆。处理器204被配置为使用具有有界不确定性的扩张状态的车辆226的模型来确定车辆的控制器222的控制输入,并且根据控制输入来控制车辆。
在一些实施方式中,处理器204被配置为执行概率滤波器224,跟踪由对象的运动模型208和对象的测量模型210估计的对象的扩张状态的联合概率。联合概率是以在概率滤波器224的先前迭代期间估计的扩张状态为条件的后验概率。此外,系统200包括输出接口220以输出对象的扩张状态。在一些实施方式中,输出接口220被配置为将对象的扩张状态输出至控制器222。
图3示出根据一些实施方式的使用递归贝叶斯滤波的对象的扩张状态的后验密度的递归计算的示意图。扩张(运动学和伸展)状态被定义为ξk=[xk,Xk],随机向量xk∈Rdx表示运动学状态,Xk表示伸展状态。对于时间步k,从汽车雷达传感器观测到nk个测量
在假设在时间k-1已知后验密度302为p(ξk-1|Z1:k-1)的情况下,递归贝叶斯滤波开始300。通过执行后验密度预测304来预测后验密度。在一些实施方式中,从Chapman-Kolmogorov方程预测后验密度
p(ξk-1|Z1:k-1)=∫p(ξk-1|Z1:k-1)p(ξk|ξk-1)dξk-1...............(1)
其中转移密度p(ξk|ξk-1)由对象运动模型给出。此外,预测的后验密度利用当前测量Zk 308更新306为
p(ξk|Z1:k)∝p(ξk|Z1:k-1)p(Zk|ξk).............(2)
其中是总体测量似然性,表示个体空间分布。因此,获得312更新的后验密度。由于该贝叶斯滤波是递归的310,所以迭代地执行上述步骤,直至满足终止条件。在各个迭代310中,基于当前迭代的更新的预测密度来预测下一迭代中的后验密度。对于状态更新步骤306,其包含对局部测量316、截断边界更新318和扩张状态更新320进行扫描聚合的块。要注意的是,局部扫描聚合步骤316是可选的。另外,如果截断边界是已知的或用于节省计算复杂度,则也可跳过在线截断边界更新318。为此,一些实施方式基于这样的目标:在使用贝叶斯滤波给出直至时间k的所有过去测量Z1:k={Z1,···,Zk}的情况下,通过递归地计算对象状态的后验密度p(ξk|Z1:k)来进行对象跟踪。此外,在一些实施方式中,可从后验密度p(ξk|Z1:k)估计具有对应不确定性的扩张状态ξk。
分层测量模型
对象的测量110受噪声影响,并且仅从对象的表面接收反射,因此,以有噪测量执行概率滤波器可能产生扩张状态的不正确估计,因此产生不正确的对象跟踪。为此,要为无噪测量源(也称为测量源)确定截断区间,以使得概率滤波器生成拟合无噪测量源的中心截断高斯分布。一些实施方式基于这样的认识:概率滤波器被配置为在根据中心截断高斯分布评估无噪测量源的似然性之前从测量去除噪声。
在噪声较小的情景中,一些实施方式基于这样的认识:概率滤波器被配置为根据分层中心截断高斯分布来评估有噪测量的似然性。
其中H是在运动学状态xk下选择位置分量(对象中心)的观测矩阵,ρ是缩放因子,Dk指定密度支持,是归一化因子。在一些实施方式中,隐藏测量源变量也被称为无噪测量源变量。概率滤波器在其执行时用隐藏测量替换测量。由此,概率滤波器生成拟合无噪测量源的中心截断高斯分布。在一些实施方式中,各个测量的无噪源的隐藏测量用于捕获对象的边缘周围概率较高的特征。
图4示出隐藏测量源变量的示例400,其中密度支持在矩形404之外。密度支持Dk可以是任意形状。例如,考虑围绕对象中心的矩形形状404。矩形形状404由四个边界描述。在一些实施方式中,边界对应于中心截断的区间。截断高斯概率密度以坐标原点为中心(ρ=0.25、l=4.7、w=1.8、a1=b1=2.14和a2=b2=0.75)。
上述测量似然性(4)导致以下总测量似然性其可用于更新步骤306的(2)中。图4示出所得测量似然性402其中Rk=diag([0.09,0.09])。分层空间分布将测量似然性推离中心,与真实世界汽车雷达测量的分布高度类似。此外,根据一些实施方式,由于自遮挡,分层截断模型灵活描述部分观测的雷达测量(例如,仅观测汽车的罕见部分)。
图5A示出根据一些实施方式的当对象以正面506或背面502面向传感器500时的示例性截断区间自适应。例如,考虑对象是长度“l”504和宽度w 510的车辆(例如,车辆106),并且取向以使得其背面502面向传感器500。传感器500获得与车辆的局部视图对应(即,从背后看)的测量。例如,截断区间由a<x<b给出。在一些实施方式中,截断区间包括以无穷大结束以反映对象相对于传感器500的取向的开端区间,例如,a<x<∞。在一些其它实施方式中,截断区间包括以最大值结束的开端区间,例如,a<x<nmax。对于上述取向(从背后看),车辆的长度504的截断区间相对于传感器500在车辆的相对侧506(前侧)以无穷大结束。随后,确定对应概率密度508。另选地,在一些实施方式中,车辆的长度504的截断区间相对于传感器500在车辆的相对侧506(前侧)以最大值结束,并且可确定对应概率密度。
图5B示出根据一些实施方式的当对象相对于传感器500侧向取向时的示例性截断区间自适应。例如,考虑与图5A中想到的车辆相同但相对于传感器500侧向取向的对象。传感器500获得与车辆的局部视图对应(即,从侧面看)的测量。在这种情况下,车辆的宽度510的截断区间相对于传感器在车辆的相对侧512以无穷大结束。随后,确定对应概率密度514。另选地,在一些实施方式中,车辆的宽度510的截断区间相对于传感器在车辆的相对侧512以最大值结束。为此,一些实施方式基于这样的认识:分层截断模型不仅灵活描述完全观测的雷达测量,而且灵活描述部分观测的雷达测量。
伸展对象跟踪(EOT)算法
针对运动学状态和伸展状态二者基于分层测量模型制定贝叶斯EOT算法。贝叶斯EOT算法也被称为分层截断高斯随机矩阵(HTG-RM)算法。在一些实施方式中,通过递归地预测扩张状态并更新扩张状态和截断区间来根据分层测量模型开发贝叶斯EOT算法。截断区间也被称为截断边界。类似于基于正则随机矩阵的方法,假设预测和更新的扩张状态密度二者共享运动学状态和伸展状态的因子化形式
p(ξk|Z1:k*)≈p(xk|Z1:k*)p(Xk|Z1:k*)..............(5)
=N(xk;mk|k*,Pk|k*)IW(Xk;vk|k*,Vk|k*),
其中k*=k-1用于扩张状态预测,k*=k用于扩张状态更新。换言之,运动学状态xk为高斯分布,具有预测/更新均值mk|k*和协方差矩阵Pk|k*,而伸展矩阵Xk为逆Wishart(IW)分布,具有vk|k*自由度和缩放矩阵Vk|k*。确定这些关联的用于预测的参数{m,P,v,V}k|k-1和用于更新的参数{m,P,v,V}k|k。贝叶斯EOT算法涉及递归地预测扩张状态并更新扩张状态和截断区间。
扩张状态的预测
图6示出根据一些实施方式的扩张状态预测步骤304的示意图。给定运动模型600
其中g(·)是运动学运动模型,Qk-1是过程噪声wk-1的协方差矩阵,Ex表示对应变换矩阵(例如,单位矩阵或旋转矩阵,取决于xk-1)。假定后验密度p(ξk-1|Z1:k-1)共享(5)的相同形式和(6)的转移概率,由处理器204针对预测状态密度p(ξk|Z1:k-1)602计算关联的参数{m,P,v,V}k|k-1。预测状态密度p(ξk|Z1:k-1)的关联参数{m,P,v,V}k|k-1被给出为
其中Ts是采样时间并且τ是机动相关常数。在一些实施方式中,如果g是线性模型,则(7a)和(7b)中的运动学状态预测603遵循标准卡尔曼滤波器(KF)的预测步骤,或者当g为非线性时遵循伸展KF。伸展状态预测603由(7c)和(7d)给出。在一些其它实施方式中,利用贝叶斯滤波器或粒子滤波器之一代替卡尔曼滤波器以用于运动学状态和伸展状态预测。为此,一些实施方式基于这样的认识:由处理器204执行的概率滤波器迭代地执行运动模型以预测扩张状态。
扩张状态的更新
图7A示出根据一些实施方式的扩张状态更新步骤318的示意图。在可选扫描聚合316和截断边界更新318之后获得局部观测测量322。基于汽车雷达测量的表面体积分布,可使用正则随机矩阵方法计算两个充分统计量,即,样本均值和样本展开(方差)。然而,使用正则随机矩阵方法计算样本均值和方差可能对于对象的运动学状态和伸展状态产生有偏估计。
为了校正这些偏差,制定了伪测量。此外,在一些实施方式中,利用伪测量来计算样本均值和方差。在一些实施方式中,由处理器204利用分层测量模型来生成702伪测量。伪测量用于计算样本均值和方差。图7B示出根据一些实施方式的示例性伪测量714。虚线方块表示根据步骤318更新的截断边界。圆圈712表示对象坐标中的(可能聚合的)局部观测测量,暗点714表示伪测量。观测测量712与伪测量714的数量之比由截断高斯分布的归一化因子确定。nk个观测测量对应于根据TN分布的测量源变量
为此,一些实施方式基于这样的目标:计算上述样本均值和方差。为了计算上述样本均值和方差706,由处理器204生成伪测量作为来自的样本,然后其中对象状态{xk|k,Xk|k}和截断边界来自先前迭代步骤。在一些实施方式中,为了避免和的合成采样,和的样本均值可由其期望及其二阶矩替换。利用两个充分统计量,由处理器204计算704用于更新的密度p(ξk|Zk)的关联参数{m,P,v,V}k|k。更新的密度p(ξk|Zk)的关联参数{m,P,v,V}k|k给出为
mk|k=mk|k-1+Kε,..........(12a)
Pk|k=Pk|k-1-KH Pk|k-1,.........(12b)
vk|k=vk|k-1+nk,..........(12c)
其中K=Pk|k-1H S-1,并且类似于预测步骤,运动学状态xk 708的更新步骤是(12a)和(12b)中的类似卡尔曼滤波器的更新。此外,(12c)和(12d)中的伸展状态更新708需要两个矩阵。
图7C示出根据一些实施方式的伪测量生成、截断边界Bk更新和扩张状态更新的示意图。获得初始运动学状态xk、伸展状态Xk和截断边界Bk。给定观测测量716和预测运动学状态xk|k-1、伸展状态Xk|k-1和截断边界Bk|k-1,由处理器204在迭代0中生成伪测量718。此外,在迭代0中,伪测量718用于估计运动学状态、扩张状态和截断边界,其分别表示为和为此,迭代0产生和
在下一迭代(即,迭代1)中,基于先前迭代估计和和观测测量716,由处理器204生成伪测量720。此外,由处理器204使用伪测量720来估计运动学状态、扩张状态和截断边界,其分别表示为和由此,更新迭代0中估计的状态和截断边界。同样,在迭代2中,由处理器204生成伪测量并将 和更新为和(图中未示出)。由处理器204执行迭代,直至满足终止条件。终止条件可预定义。在一些实施方式中,当迭代次数大于阈值时,满足终止条件。
截断边界更新
图8A示出根据一些实施方式的从自我车辆坐标到对象坐标的坐标变换322、扫描聚合316和在线截断边界更新步骤318的示意图。给定上述更新的状态ξk|k=[xk|k,Xk|k],通过使测量似然性最大化来更新截断边界Bk,其中个体测量似然性由图4的描述中描述的似然性(4)给出。测量似然性经由标准高斯分布的累积密度函数(CDF)被定义为四个边界404(例如,Bk中的a1、b1、a2和b2)的函数。具体地,在第t迭代,由处理器204使用来自第(t-1)迭代的更新的状态估计将全局坐标中时间步k的测量转换为对象坐标(OC)系中的局部测量。截断边界Bk定义密度支持Dk。利用从时间步k-L+1至时间步k的扫描聚合局部测量316,由处理器204使用最大似然性(ML)估计318来更新由Bk指定的截断边界。为此,更新截断边界,因此获得更新的截断边界。此外,在一些实施方式中,利用在时间步k的更新的截断边界和测量,由处理器204使用HTG-RM更新运动学状态和伸展状态。一些实施方式基于这样的认识:使用来自过去扫描的滤波的扫描聚合测量来准确估计截断边界以更新截断边界。
图8B示出根据一些实施方式的对象坐标系中的滤波的扫描聚合316。当由于自遮挡,汽车雷达测量稀疏且部分可看时,滤波的扫描聚合是有益的。获得全局坐标系中时间步k-1的对象810的测量808。同样,在全局坐标系中分别在时间戳k和k+1获得测量812、814。此外,一些实施方式基于这样的认识:给定全局坐标系(GC)中的测量(由z表示)和对象运动学状态的均值m,可获得第t迭代的OC 816中的对应测量作为
其中为(4)的形式,其涉及归一化因子和截断面积Dk,作为的函数。四个截断边界的ML估计需要在D上计算积分,并且直接求解(16)对于在线更新可能计算上要求高。为此,由处理器204使用期望-最大算法将扫描聚合测量分成四个集群,其有效地将联合ML边界更新分解为截断边界的至多四个解耦ML估计。其它三个截断边界的更新可由处理器204类似地实现。在下文中,为了简明,省略了迭代索引t的记号。要注意的是,当其对应测量集为空时,截断边界可被设定为+∞。设f(y1)=TN(0,Λ1,1,bk,1)和f(r1)=(0,R1,1)分别表示具有密度支持{y|y>bk,1}的单变量截断高斯分布和具有零均值和方差R1,1的高斯分布的概率密度函数(PDF)。使用卷积公式,z1=y1+r1的密度由下式给出
其中z1由z的x坐标给出。这等同于使以下成本函数最小化
这可利用标准求根算法(例如,Halley方法)来高效地求解。
图9A示出根据一些实施方式的对象在转弯过程中移动90个时间步的情景的仿真。对象的旋转中心与对象的物理中心重合。在一些实施方式中,对象为矩形对象,例如4.7米长和1.8米宽。对象的运动学状态被定义为xk=[pk,vk,θk,ωk]T∈R5,具有二维位置pk∈R2、极速度vk、航向/取向θk和转弯速率ωk。对象的伸展状态由位置pk的对称正定协方差矩阵Xk定义。由于对象是刚体,所以其宽度(w)和长度(l)使用估计的伸展状态的特征值分解来估计:
Xk=M(θk)diag([l2/4,w2/4])MT(θk),
其中M(θk)是作为对象取向(θk)的函数的单位矩阵。
在一些实施方式中,使用几乎恒定的转弯速率和极速度运动模型,其中采样时间Ts=1s并且标准极和角加速度噪声分别为和变换函数E(·)是取决于转弯速率的旋转矩阵,即,E(xk)=M(ωk)。此外,获得仿真轨迹的过程。
图9B示出根据一些实施方式的以理想测量模型的性能评估曲线图。考虑汽车雷达测量在仿真轨迹的过程中遵循分层截断高斯模型的理想情况。此外,在一些实施方式中,各个时间步的测量次数从均值为8的泊松分布得到。图9A示出对象周围的合成汽车雷达测量的两个快照900,这是现实雷达测量的良好指标。可以看出,这些雷达测量中的大多数看起来在对象边缘902周围。从100次蒙特卡罗运行,比较正则随机矩阵(表示为RM)与分层截断高斯随机矩阵(称为HTG-RM)算法之间的对象跟踪性能。图9B示出利用理想测量模型总共90个时间步的定位误差(位置)、对象长度和宽度误差方面的对象跟踪性能。从图9B明显的是,HTG-RM算法在多个方面胜过正则随机矩阵方法。具体地,HTG-RM算法随时间在对象长度和宽度方面提供更一致的估计。此外,分析对象的运动学状态和伸展状态估计的对应均方根误差(RMSE)。
图9C是示出利用理想测量模型与RM和HTG-RM对应的对象的运动学状态和伸展状态估计的RMSE的表列。与在RM下对象的运动学状态和伸展状态估计相比,在HTG-RM下对象的运动学状态和伸展状态估计的均方根误差显著较小。具体地,与RM相比,HTG-RM在对象长度l和宽度w估计中产生显著较小的RMSE。
图10A示出根据一些实施方式的在模型失配下的性能评估。在实时中,没有测量模型可完美地描述真实世界汽车雷达测量。为此,一些实施方式基于这样的认识:为了评估模型失配下的HTG-RM算法的鲁棒性,从聚合的真实世界汽车雷达测量学习的50个高斯混合分量的变分雷达模型适于在图9A中的过程中生成雷达测量。图10A示出在模型失配下总共90个时间步的定位误差(位置)、对象长度和宽度误差方面的对象跟踪性能。
从图10A明显的是,HTG-RM算法仍胜过常规RM方法。与图9B中的理想测量模型的情况相比,HTG-RM性能略微下降,这显示了HTG-RM算法在不同表面体积测量模型上的鲁棒性。这进一步通过将RM的运动学状态和伸展状态估计的RMSE与HTG-RM的运动学状态和伸展状态估计的RMSE进行比较来确认。
图10B是示出在模型失配下与RM和HTG-RM对应的对象的运动学状态和伸展状态估计的RMSE的表。与在RM下对象的运动学状态和伸展状态估计相比,在HTG-RM下对象的运动学状态和伸展状态估计的RMSE显著较小。从表列明显的是,具体地,与在RM下的对象长度和宽度估计相比,在HTG-RM下的对象长度和宽度估计的RMSE显著较小。
图11A示出车辆1100的示意图,其包括与采用一些实施方式的原理的系统200通信的控制器1102。车辆1100可以是任何类型的轮式车辆,例如客车、公共汽车或漫游车。另外,车辆1100可以是自主或半自主车辆。例如,一些实施方式控制车辆1100的运动。运动的示例包括由车辆1100的转向系统1104控制的车辆的横向运动。在一个实施方式中,转向系统1104由控制器1102控制。另外地或另选地,转向系统1104可由车辆1100的驾驶员控制。
在一些实施方式中,车辆可包括发动机1110,其可由控制器1102或由车辆1100的其它组件控制。在一些实施方式中,车辆可包括电动机来代替发动机1110,并且可由控制器1102或由车辆1100的其它组件控制。车辆还可包括一个或更多个传感器1106以感测周围环境。传感器1106的示例包括诸如雷达的测距仪。在一些实施方式中,车辆1100包括一个或更多个传感器1108以感测其当前运动参数和内部状态。一个或更多个传感器1108的示例包括全球定位系统(GPS)、加速度计、惯性测量单元、陀螺仪、轴旋转传感器、扭矩传感器、偏转传感器、压力传感器和流量传感器。传感器向控制器1102提供信息。车辆可配备有收发器1110,其使得控制器1102能够通过有线或无线通信信道与一些实施方式的系统200通信。例如,通过收发器1110,控制器1102从系统200接收控制输入。
图11B示出根据一些实施方式的车辆1100的控制器1102与控制器1112之间的交互的示意图。例如,在一些实施方式中,车辆1100的控制器1102是控制车辆1100的旋转和加速度的转向控制1114和制动器/油门控制器1116。在这种情况下,控制器1102基于控制输入向控制器1114和1116输出控制命令以控制车辆的运动学状态。在一些实施方式中,控制器1112还包括高级控制器,例如进一步处理控制器1102的控制命令的车道保持辅助控制器1118。在这两种情况下,控制器1112利用控制器1102的输出(即,控制命令)来控制车辆的至少一个致动器(例如,车辆的方向盘和/或制动器),以便控制车辆的运动。
图11C示出使用一些实施方式生成控制输入的自主或半自主受控车辆1120的示意图。受控车辆1120可配备有系统200。在一些实施方式中,受控车辆1120跟踪各个障碍物1122,并且随后,基于障碍物跟踪来生成控制输入。在一些实施方式中,控制输入包括指定车辆的车轮的转向角和车轮的旋转速度之一或组合的值的命令,并且测量包括车辆的旋转速率和车辆的加速度之一或组合的值。
所生成的控制输入旨在将受控车辆1120保持在道路1124的特定边界内,并且旨在避开其它不受控车辆(即,受控车辆1120的障碍物1122)。例如,基于控制输入,自主或半自主受控车辆1120可例如在左侧或在右侧超越另一车辆,或者改为保持在道路1124的当前车道内的另一车辆后面。
以下描述仅提供示例性实施方式,并非旨在限制本公开的范围、适用性或配置。相反,示例性实施方式的以下描述将向本领域技术人员提供用于实现一个或更多个示例性实施方式的可行描述。在不脱离所附权利要求中阐述的公开的主题的精神和范围的情况下,可以想到可对元件的功能和布置进行各种改变。
在以下描述中给出具体细节以提供实施方式的彻底理解。然而,本领域普通技术人员可理解,实施方式可在没有这些具体细节的情况下实践。例如,所公开的主题中的系统、过程和其它元件可作为组件以框图形式示出,以免在不必要的细节方面使实施方式模糊。在其它情况下,熟知过程、结构和技术可在没有不必要的细节的情况下示出,以避免使实施方式模糊。此外,各种附图中的相似标号和指代指示相似的元件。
另外,各个实施方式可作为过程描述,其被描绘为流程图、数据流程图、结构图或框图。尽管流程图可将操作描述为顺序过程,但许多操作可并行或同时执行。另外,操作次序可重新布置。过程在其操作完成时可终止,但是可具有未讨论或附图中未包括的附加步骤。此外,并非任何具体描述的过程中的所有操作可出现在所有实施方式中。过程可对应于方法、函数、程序、子例程、子程序等。当过程对应于函数时,函数的终止可对应于函数返回到调用函数或主函数。
此外,所公开的主题的实施方式可至少部分地手动或自动实现。可通过使用机器、硬件、软件、固件、中间件、微码、硬件描述语言或其任何组合来执行或至少辅助手动或自动实现。当以软件、固件、中间件或微码实现时,执行所需任务的程序代码或代码段可被存储在机器可读介质中。处理器可执行所需任务。
另外,本文中概述的各种方法或处理可被编码为可在采用各种操作系统或平台中的任一种的一个或更多个处理器上执行的软件。另外,这种软件可使用多种合适的编程语言和/或编程或脚本工具中的任一种来编写,并且也可被编译为在框架或虚拟机上执行的可执行机器语言代码或中间代码。通常,在各种实施方式中,程序模块的功能可根据需要组合或分布。
本公开的实施方式可被具体实现为一种方法,已提供其示例。作为该方法的一部分执行的动作可按照任何合适的方式排序。因此,可构造以与所示不同的次序执行动作的实施方式,其可包括同时执行一些动作,尽管在例示性实施方式中作为顺序动作示出。
尽管参考特定优选实施方式描述了本公开,但是将理解,在本公开的精神和范围内可进行各种其它调整和修改。因此,所附权利要求的方面涵盖落在本公开的真实精神和范围内的所有这些变化和修改。
Claims (18)
1.一种用于跟踪对象的扩张状态的系统,所述对象的扩张状态包括指示所述对象的位置的运动学状态和指示所述对象的尺寸和取向之一或组合的伸展状态,所述系统包括:
至少一个传感器,所述至少一个传感器被配置为利用一个或多个信号传输探测包括移动对象的场景,以每传输生成所述对象的一个或多个测量;
处理器,该处理器被配置为执行概率滤波器,该概率滤波器跟踪由所述对象的运动模型和所述对象的测量模型估计的所述对象的所述扩张状态的联合概率,其中,所述测量模型包括具有截断区间的中心截断分布,对于所述截断区间内的所述中心截断分布的中心处的所述测量提供较小概率,并且对于所述截断区间之外的所述测量提供较大概率,其中,所述中心截断分布是底层未截断高斯分布根据所述截断区间的截断,其中,所述概率滤波器被配置为估计拟合所述测量的所述中心截断分布并且生成与所述中心截断分布对应的底层高斯分布的均值和方差,使得所述底层高斯分布的所述均值指示所述对象在所述扩张状态下的位置,并且所述底层高斯分布的所述方差指示所述对象在所述扩张状态下的尺寸和取向;以及
输出接口,该输出接口被配置为输出所述对象的所述扩张状态。
2.根据权利要求1所述的系统,其中,所述概率滤波器是贝叶斯滤波器、卡尔曼滤波器和粒子滤波器之一或组合,并且其中,所述联合概率是以在所述概率滤波器的先前迭代期间估计的所述扩张状态为条件的后验概率。
3.根据权利要求1所述的系统,其中,所述概率滤波器迭代地执行所述运动模型以预测所述扩张状态并且执行所述测量模型以更新由所述运动模型预测的所述扩张状态。
4.根据权利要求1所述的系统,其中,所述扩张状态的更新包括从全局自我车辆坐标变换到局部对象坐标的测量的扫描聚合。
5.根据权利要求3所述的系统,其中,在所述概率滤波器的执行的迭代内,所述测量模型的执行迭代地更新在所述概率滤波器的先前迭代期间确定的先前截断区间,以生成拟合由所述运动模型预测的所述扩张状态的当前截断区间并且利用具有所述当前截断区间的所述中心截断分布的所述测量模型更新所述扩张状态。
6.根据权利要求3所述的系统,其中,所述运动模型预测受所述对象的尺寸的固定值和所述对象的变化的取向影响的所述对象的所述扩张状态,使得所述对象的尺寸仅由所述测量模型更新,而所述对象的取向由所述运动模型和所述测量模型二者更新。
7.根据权利要求1所述的系统,其中,所述测量模型的执行输出拟合所述测量的协方差矩阵,其中,所述协方差矩阵的对角元素限定所述对象的尺寸,并且其中,所述协方差矩阵的非对角元素限定所述对象的取向。
8.根据权利要求1所述的系统,其中,所述处理器还被配置为响应于所述对象相对于所述传感器的取向的改变而改变所述截断区间。
9.根据权利要求1所述的系统,其中,所述处理器还被配置为迭代地执行所述概率滤波器,其中,对于各个迭代,所述概率滤波器基于所述测量的集群之间的距离来确定所述截断区间,使所述中心截断分布的轴线取向以连接所述测量的所述集群,根据所述集群中的所述测量的密度来生成所述中心截断分布,并且估计所生成的中心截断分布底层的所述高斯分布的均值和方差。
10.根据权利要求1所述的系统,其中,所述中心截断分布是中心截断高斯分布。
11.根据权利要求1所述的系统,其中,至少一个截断区间是以无穷大结束以反映车辆相对于所述传感器的取向的开端区间。
12.根据权利要求10所述的系统,其中,车辆相对于所述传感器侧向取向,并且针对所述车辆的宽度的所述截断区间在所述车辆的关于所述传感器的相对侧以无穷大结束。
13.根据权利要求10所述的系统,其中,车辆以正面或背面面向所述传感器,并且针对所述车辆的长度的所述截断区间在所述车辆的关于所述传感器的相对侧以无穷大结束。
14.根据权利要求1所述的系统,其中,所述测量受噪声影响,其中,针对没有噪声的测量源确定所述截断区间,并且其中,所述概率滤波器被配置为在根据所述中心截断分布评估所述测量的无噪源的似然性之前从所述测量去除噪声,使得所述概率滤波器生成拟合所述测量的所述无噪源的所述中心截断分布。
15.根据权利要求1所述的系统,其中,所述测量受噪声影响,其中,针对测量直接确定所述截断区间,并且其中,所述概率滤波器被配置为根据分层中心截断分布来评估所述测量的似然性,使得所述概率滤波器生成拟合所述测量的所述分层中心截断分布。
16.根据权利要求13所述的系统,其中,所述测量模型是为各个所述测量限定无噪源的隐藏测量的概率参数的分层测量模型,使得所述概率滤波器在其执行时利用所述隐藏测量替换所述测量。
17.根据权利要求1所述的系统,该系统还包括:
存储器,该存储器被配置为存储车辆的模型,所述车辆的模型包括受过程噪声影响的所述对象的所述运动模型和受测量噪声影响的所述对象的所述测量模型,使得所述过程噪声和所述测量噪声之一或组合界定所述对象的所述扩张状态的不确定性;
其中,所述处理器被配置为使用具有有界不确定性的所述扩张状态的所述车辆的所述模型来确定所述车辆的控制器的控制输入,并且根据所述控制输入来控制所述车辆;并且
其中,所述车辆在操作上连接到根据权利要求1所述的系统。
18.一种用于跟踪对象的扩张状态的方法,所述对象的扩张状态包括指示所述对象的位置的运动学状态和指示所述对象的尺寸和取向之一或组合的伸展状态,其中,所述方法使用联接到存储可执行指令的存储器的处理器,所述可执行指令在由所述处理器执行时执行所述方法的步骤,所述方法包括以下步骤:
由至少一个传感器利用一个或多个信号传输探测包括移动对象的场景,以每传输生成所述对象的一个或多个测量;
执行概率滤波器,该概率滤波器跟踪由所述对象的运动模型和所述对象的测量模型估计的所述对象的所述扩张状态的联合概率,其中,所述测量模型包括具有截断区间的中心截断分布,对于所述截断区间内的所述中心截断分布的中心处的所述测量提供较小概率,并且对于所述截断区间之外的所述测量提供较大概率,其中,所述中心截断分布是底层未截断高斯分布根据所述截断区间的截断,其中,所述概率滤波器估计拟合所述测量的所述中心截断分布并且生成与所述中心截断分布对应的底层高斯分布的均值和方差,使得所述底层高斯分布的所述均值指示所述对象在所述扩张状态下的位置,并且所述底层高斯分布的所述方差指示所述对象在所述扩张状态下的尺寸和取向;以及
经由输出接口输出所述对象的所述扩张状态。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US16/789,931 | 2020-02-13 | ||
US16/789,931 US11619494B2 (en) | 2020-02-13 | 2020-02-13 | System and method for tracking expanded state of an object |
PCT/JP2020/049312 WO2021161682A1 (en) | 2020-02-13 | 2020-12-25 | System and method for tracking expanded state of an object |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115066631A true CN115066631A (zh) | 2022-09-16 |
Family
ID=74561968
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202080095913.XA Pending CN115066631A (zh) | 2020-02-13 | 2020-12-25 | 用于跟踪对象的扩张状态的系统和方法 |
Country Status (5)
Country | Link |
---|---|
US (1) | US11619494B2 (zh) |
EP (1) | EP3928123B1 (zh) |
JP (1) | JP7297172B2 (zh) |
CN (1) | CN115066631A (zh) |
WO (1) | WO2021161682A1 (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102020206659A1 (de) * | 2019-05-30 | 2020-12-03 | Robert Bosch Gesellschaft mit beschränkter Haftung | Multi-hypothesen-objektverfologung für automatisierte fahrsysteme |
US11879964B2 (en) * | 2020-02-13 | 2024-01-23 | Mitsubishi Electric Research Laboratories, Inc. | System and method for tracking expanded state of moving object with model geometry learning |
EP3904907A1 (en) * | 2020-04-29 | 2021-11-03 | Aptiv Technologies Limited | Methods and systems for tracking an object |
US11914023B2 (en) * | 2021-05-05 | 2024-02-27 | Mitsubishi Electric Research Laboratories, Inc. | System and method for tracking an expanded state of a moving object using a compound measurement model |
WO2023178525A1 (en) * | 2022-03-22 | 2023-09-28 | Huawei Technologies Co.,Ltd. | Apparatus and method for tracking of extended objects |
CN115308108B (zh) * | 2022-08-03 | 2023-08-11 | 西南石油大学 | 基于截断高斯分布函数的岩心多峰分布孔隙结构表征方法 |
CN116500575B (zh) * | 2023-05-11 | 2023-12-22 | 兰州理工大学 | 一种基于变分贝叶斯理论的扩展目标跟踪方法和装置 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3931879B2 (ja) * | 2003-11-28 | 2007-06-20 | 株式会社デンソー | センサフュージョンシステム及びそれを用いた車両制御装置 |
US9128185B2 (en) * | 2012-03-15 | 2015-09-08 | GM Global Technology Operations LLC | Methods and apparatus of fusing radar/camera object data and LiDAR scan points |
EP2799902A1 (en) * | 2013-04-30 | 2014-11-05 | Baselabs GmbH | Method and apparatus for the tracking of multiple objects |
JP7244220B2 (ja) * | 2018-06-13 | 2023-03-22 | 株式会社デンソーテン | レーダ装置および物標データ出力方法 |
-
2020
- 2020-02-13 US US16/789,931 patent/US11619494B2/en active Active
- 2020-12-25 EP EP20851352.3A patent/EP3928123B1/en active Active
- 2020-12-25 WO PCT/JP2020/049312 patent/WO2021161682A1/en unknown
- 2020-12-25 CN CN202080095913.XA patent/CN115066631A/zh active Pending
- 2020-12-25 JP JP2022571010A patent/JP7297172B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2023512349A (ja) | 2023-03-24 |
US11619494B2 (en) | 2023-04-04 |
WO2021161682A1 (en) | 2021-08-19 |
JP7297172B2 (ja) | 2023-06-23 |
EP3928123B1 (en) | 2022-07-27 |
US20210254982A1 (en) | 2021-08-19 |
EP3928123A1 (en) | 2021-12-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115066631A (zh) | 用于跟踪对象的扩张状态的系统和方法 | |
KR102292277B1 (ko) | 자율 주행 차량에서 3d cnn 네트워크를 사용하여 솔루션을 추론하는 lidar 위치 추정 | |
JP7301245B2 (ja) | モデル幾何学学習を用いて移動物体の拡大状態を追跡するためのシステムおよび方法 | |
US11580364B2 (en) | Unsupervised learning of metric representations from slow features | |
JP2009508199A (ja) | 車両運転補助方法および改良型関連装置 | |
US11914023B2 (en) | System and method for tracking an expanded state of a moving object using a compound measurement model | |
Xia et al. | Extended object tracking with automotive radar using learned structural measurement model | |
Dezert et al. | Environment perception using grid occupancy estimation with belief functions | |
CN115249066A (zh) | 分位数神经网络 | |
EP4307244A1 (en) | Method, apparatus, electronic device and medium for target state estimation | |
EP4345417A2 (en) | Method, apparatus, electronic device and medium for target state estimation | |
Fernandes et al. | Gnss/mems-ins integration for drone navigation using ekf on lie groups | |
CN118140154A (zh) | 用于使用在线自适应复合测量模型跟踪移动目标的扩展状态的系统和方法 | |
US20230206136A1 (en) | Road Modeling with Ensemble Gaussian Processes | |
CN113511194A (zh) | 一种纵向避撞预警方法及相关装置 | |
Sajjadi et al. | A Robust and Adaptive Sensor Fusion Approach for Indoor UAV Localization | |
US12032099B2 (en) | Adaptive motion compensation of perception channels | |
US20230009736A1 (en) | Adaptive motion compensation of perception channels | |
CN116822154A (zh) | 车辆状态的估计方法、装置、设备和存储介质 | |
US20230025579A1 (en) | High-definition mapping | |
CN117872416A (zh) | 定位校准方法、装置、计算机设备及存储介质 | |
Schüle et al. | Feature evaluation of factorized self-localization | |
Kmiotek | Multi-sensor data fusion for representing and tracking dynamic objects |
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 |