通过传感器的间接测量来改进对机动车辆周围的至少一个物体的检测的方法,控制器,驾驶员辅助系统和机动车辆与流程

文档序号:15883795发布日期:2018-11-09 18:27阅读:238来源:国知局
通过传感器的间接测量来改进对机动车辆周围的至少一个物体的检测的方法,控制器,驾驶员辅助系统和机动车辆与流程

本发明涉及一种用于检测机动车辆周围的至少一个物体的方法,其中第一传感器被致动以发出传感器信号,从第二传感器接收传感器数据,该传感器数据描述从至少一个物体反射的传感器信号,从传感器数据确定模糊特征作为描述至少一个物体的物体特征,其中,模糊特征描述至少一个物体与第一传感器之间的距离以及至少一个物体和第二传感器之间的距离。此外,本发明涉及用于机动车辆的控制器和驾驶员辅助系统。最后,本发明涉及一种机动车辆。

背景技术

从现有技术中已知不同的方法,利用这些方法可以检测机动车辆周围的物体。例如,可以借助于相应的传感器识别物体,例如超声传感器,雷达传感器,激光传感器或照相机。此外,已知基于传感器的传感器信号确定机动车辆与物体之间的距离和/或机动车辆与物体之间的相对位置。

特别是结合超声波传感器,已知可以借助间接测量来确定物体。为此目的,第一超声波传感器发射超声波信号。该超声波信号在物体处反射并由第二超声波传感器接收。物体到第一传感器和第二传感器的距离可以基于第一传感器发射超声波信号和第二传感器接收从物体反射的超声波信号之间的运行时间来确定。例如,为简化起见,可以假设物体位于圆上,其中圆的中心点布置在两个传感器之间的中间或两个传感器的位置。然而,不能从这种间接测量导出关于物体的角度信息项。

此外,从现有技术中已知,融合多个或不同传感器的结果,以便能够更可靠地检测物体。为此目的,例如可以提供描述物体的物体特征在每种情况下由相应传感器提供的传感器数据确定。这样的物体特征可以是例如点特征或线特征,其描述物体或其一部分。还可以确定物体特征的空间不确定性或模糊性。物体特征也可以输入数字环境地图中,该数字环境地图描述了机动车辆的周围环境。可以合并物体特征以融合各种传感器的测量结果。



技术实现要素:

发明内容本发明的目的是公开一种解决方案,该方案涉及在机动车辆的传感器的间接测量的情况下如何改进机动车辆周围的物体的检测。

根据本发明,该目的通过具有根据相应独立权利要求的特征的一种方法、一种控制器、一种驾驶员辅助系统以及一种机动车辆来实现。本发明的有利细化是从属权利要求的主题。

在用于检测机动车辆周围的至少一个物体的方法的一个实施例中,优选地,第一传感器被致动以发射传感器信号。此外,接收传感器数据,尤其是从第二传感器接收传感器数据,该传感器数据描述从至少一个物体反射的传感器信号。此外,优选地规定,从传感器数据确定模糊特征作为用于描述至少一个物体的物体特征,其中,模糊特征描述至少一个物体与第一传感器之间的距离以及至少一个物体与第二传感器之间的距离。特别地,模糊特征被描述为椭圆。此外,特别是基于第一和/或第二传感器的至少一个另外测量的传感器数据,确定另外的物体特征,该另外的物体特征描述至少一个物体。特别地,使用创新函数将另外的物体特征和模糊特征转换到公共状态空间中,其中,创新函数描述模糊特征和另外的物体特征之间的相似性。此外,优选地,基于创新函数从另外的物体特征确定合并的物体特征。

根据本发明的方法用于检测机动车辆周围的至少一个物体。在该方法中,致动第一传感器以发射传感器信号。此外,从第二传感器接收传感器数据,该传感器数据描述从至少一个物体反射的传感器信号。从传感器数据确定模糊特征作为用于描述至少一个物体的物体特征,其中,模糊特征描述至少一个物体与第一传感器之间的距离以及至少一个物体与第二传感器之间的距离。在这种情况下,模糊特征被描述为椭圆。此外,基于第一和/或第二传感器的至少一个另外测量的传感器数据,确定另外的物体特征,其描述至少一个物体。使用创新函数将另外的物体特征和模糊特征转换到公共状态空间,其中创新函数描述模糊特征与另外的物体特征之间的相似性。最后,基于创新函数从另外的物体特征确定合并的物体特征。

借助于该方法检测和/或识别机动车辆周围的一个或多个物体。该方法可以例如使用机动车辆的控制器或电子控制单元来执行。使用控制器,可以致动机动车辆的第一传感器,使得第一传感器由于致动而发射传感器信号。然后,该发射的传感器信号入射在至少一个物体上并从其反射。然后,第二传感器接收反射的传感器信号或传感器信号的回波。第一和第二传感器可以是超声传感器。当第二传感器接收到反射的超声波信号时,它提供传输到控制器的传感器数据。这些传感器数据可以包括例如多个传感器值和/或测量值,其描述反射的传感器信号。可以借助于控制器基于第一传感器发射传感器信号和第二传感器接收反射的传感器信号之间的运行时间来确定运行时间。可以基于该运行时间查明物体距第一传感器和第二传感器有多远。此外,规定了借助于控制器确定用于描述物体的模糊特征或模糊物体特征。

这种模糊特征表示用于描述物体的物体特征。例如,模糊特征的结果是,可以基于传感器数据或传感器信号的运行时间仅导出关于物体的距离信息项。模糊特征描述第一传感器和物体之间的距离以及第二传感器和物体之间的距离。不能从传感器数据导出关于物体的角度信息项。因此,不能精确地确定传感器和物体之间的相对位置。模糊特征可以例如在数字环境地图中输入,该数字环境地图描述了机动车辆的周围。在这种情况下,还可以在环境地图中以空间不确定性或模糊性输入模糊特征。还可以在该环境地图中输入另外的物体特征。这些物体特征例如可以通过机动车辆的其他传感器的测量来确定。还可以规定,第一和/或第二传感器已经确定了其他物体特征。

根据本发明规定的是,模糊特征被描述为椭圆形。此外,基于第一和/或第二传感器的至少一个另外测量的传感器数据确定描述至少一个物体的另外的物体特征,并且模糊特征与物体特征合并。这样的物体特征可以是例如点或点特征,其描述物体或其一部分在空间中的位置。物体特征也可以是线或线特征,其描述物体的边界或其一部分。这些物体特征将与模糊特征或椭圆合并,以便能够更详细地表征周围的物体。此外,使用创新函数将另外的物体特征和模糊特征转换到公共状态空间中,其中,创新函数描述物体特征和模糊特征之间的相似性,并且合并的物体特征是基于创新函数从物体特征确定的。可以将另外的物体特征和模糊特征转换和/或变换到公共状态空间中。该状态空间可以表示例如对于另外的物体特征和模糊特征的公共坐标系。特别地,状态空间可以与环境地图不同。可以在状态空间中描述另外的物体特征的状态和模糊特征的状态。还可以在该状态空间中确定创新函数,该创新函数可以表示用于确定另外的物体特征和模糊特征之间的相似性的相似度。特别地,创新函数可以描述另外的物体特征的状态与模糊特征的状态有多相似。借助于创新函数,可以表示另外的物体特征和模糊特征的相应状态,使得仅考虑对于确定相似性也感兴趣的状态和/或维度。例如,创新函数可以描述另外的物体特征和模糊特征之间的距离或者相对于另外的物体特征和模糊特征的取向的差异。首先可以基于创新函数确定模糊特征是否可以与另外的物体特征相关联。如果已经发生关联,则创新函数还可以用于从另外的物体特征导出合并的物体特征。因此,一方面,可以通过由第一和/或第二传感器执行的至少一个直接测量来检测物体,另一方面,可以通过由第一和第二传感器执行的间接测量来检测物体。例如,首先可以基于多个直接和/或间接测量来确定物体,并将其输入数字环境地图中。此后,这样的物体可以与间接测量融合并因此得到改善。可以通过创新函数统一测量的结果,从而可以改善物体的识别。

优选地,基于第一传感器和第二传感器的位置来确定椭圆的焦点,基于传感器信号的运行时间确定椭圆的半长轴的长度,基于焦点和椭圆的半长轴的长度来确定椭圆的半短轴的长度。第一传感器和第二传感器的位置或安装位置是已知的。它们可以存储在例如控制器的存储器中。确定椭圆,使得第一传感器和第二传感器的相应位置与椭圆的两个焦点相关联。此外,椭圆的半长轴的长度基于传感器信号的运行时间来确定。为此目的推测,传感器信号从其被反射的物体位于椭圆上。传感器信号的运行时间描述了从第一个焦点到描述物体的椭圆上的点的路径,以及从该点到第二个焦点的路径。因此,与运行时间相关联的路线对应于半长轴的两倍或椭圆的长轴的长度。半短轴的长度可以从焦点的位置和半长轴的长度导出。因此,可以基于传感器的已知位置和从传感器信号确定的运行时间以简单的方式确定椭圆。因为在使用传感器作为椭圆而不是圆的间接测量的情况下描述了模糊特征,所以可以提供关于物体位置的更准确的信息项。这总体上使得能够更准确和更可靠地检测至少一个物体。

优选地,基于焦点的距离确定椭圆的偏心率,并且根据半长轴的长度和偏心率确定半短轴的长度。由于两个传感器的各个位置或安装位置是已知的,因此也可以确定第一传感器和第二传感器之间的距离。该距离的一半也可以称为椭圆的偏心率。然后可以根据该偏心率和椭圆的半长轴的长度来确定椭圆的半短轴的长度。椭圆的半短轴的长度由半长轴的长度的平方减去偏心率的平方的平方根得出。因此,可以以简单的方式并在短的计算时间内确定描述模糊特征的椭圆的半短轴的长度。

在另一实施例中,确定另外的物体特征并将其输入数字环境地图中,该数字环境地图描述机动车辆的周围,并且随后确定模糊特征并将其输入数字环境地图中。情况可能是物体特征已经输入到环境地图中。随后,可以确定模糊特征。首先可以检查物体特征和模糊特征是否描述了周围的相同物体。因此可以检查模糊特征和物体特征是否可以彼此融合。在这种情况下,首先可以进行关联,该关联用于检查模糊特征与另外的物体特征的融合或合并是否合理。在此合并期间,可以从物体特征开始确定合并或更新的物体特征。该合并的物体特征是基于模糊物体特征确定的。因此可以更可靠地检测物体。

在一个实施例中,确定包括创新函数和用于创新函数的放大因子的线性映射规则,用于从另外的物体特征确定合并的物体特征,其中,放大因子取决于另外的物体特征的空间不确定性和模糊特征的空间不确定性。为了确定合并的物体特征,查明线性映射规则。该映射规则也可以称为过滤器。原则上,映射规则可以被定义为卡尔曼过滤器。映射规则可以包含创新函数和放大因子,创新函数乘以该放大因子。该放大因子也可以称为卡尔曼放大。可以根据另外的物体特征和模糊特征的相应空间不确定性来确定放大因子。可以借助于相应状态或特征的协方差或协方差矩阵来确定空间不确定性。因此可以考虑空间不确定性来确定合并的物体特征。

此外,如果确定放大因子使得合并的物体特征的空间不确定性最小,则是有利的。为了能够尽可能可靠地确定合并的物体特征,可以确定放大因子,使得合并的物体特征的空间不确定性尽可能小。因此可以确定放大因子,使得合并的物体特征的协方差矩阵是最小的。协方差矩阵可以被最小化,例如,协方差矩阵的特征值被最小化。在这种情况下,可以使用任意单位向量来变换协方差矩阵,并且随后可以最小化该标量投影。因此可以可靠地确定放大因子。

还可以规定的是,基于创新函数确定限制,并且如果创新函数超出限制,则在确定合并的物体特征时保持未考虑模糊特征。创新函数可用于决定是否应合并模糊特征和物体特征。特别地,可以确定创新函数的期望和/或创新功能的协方差。也可以从中导出也称为马哈拉诺比斯(mahalanobis)距离的限制。如果创新的马哈拉诺比斯距离小于该限制,则可以确定合并的物体特征。该创新描述了这种情况下创新函数的输出。对于创新大于此限制的情况,不能考虑模糊特征。

优选地将点特征或线特征确定为另外的物体特征。例如,这样的点特征可以被确定,例如由第一传感器和/或第二传感器多个时间顺序连续的时间点或多个时间顺序连续的测量中检测物体。例如,可以借助于三角测量来确定第一和/或第二传感器之间相对于物体的相对位置。另外的物体特征也可以是线或线特征,其描述物体的边界或其一部分。例如,当机动车辆移动经过物体并且当其移动经过时以持续的方式执行测量时,获得这样的线特征。然后可以组合描述到物体的距离的相应测量值或传感器数据以形成线特征。还可以规定的是,确定多个测量值并且通过测量值布置线以便获得线特征。

此外,有利的是,确定描述模糊特征与点特征之间的距离或模糊特征与线特征之间的距离的测量模型以确定创新函数。测量模型可以特别地映射测量空间。如果另外的物体特征是点特征,则特别地,确定生成的椭圆以确定测量模型,使得点特征位于所生成的椭圆上。因此确定生成的椭圆以确定测量模型,该生成的椭圆也可以称为测量椭圆。该生成的椭圆基于描述模糊特征和/或测量的椭圆确定。在这种情况下,生成的椭圆和椭圆优选地具有相同的焦点。确定该生成的椭圆,使得点特征位于生成的椭圆上。因此,如果使用该椭圆测量点特征作为物体,则检查模糊特征如何以椭圆的形式出现。由于椭圆和生成的椭圆具有相同的焦点,所以该创新描述了半长轴的长度之间的差异。测量模型描述了从第一传感器的位置经由点特征到第二传感器的位置的路线的一半。该路线的一半对应于半长轴。这使得能够简单地确定物体特征是点特征的情况的测量模型。

如果另外的物体特征是线特征,则特别地,确定生成的椭圆以确定测量模型,使得线特征切向地延伸到所生成的椭圆。原则上,可以确定生成的椭圆以确定测量模型,使得其与线特征相交。然而,由此得到两个交叉点,从而不能确定唯一的解。因此,确定生成的椭圆,使得它仅与线特征具有单个交叉点。如果线特征切向地延伸到生成的椭圆,则会出现这种情况。因此,对于物体特征是线特征的情况,也可以以简单的方式确定测量模型。

描述创新函数的输出的创新优选地基于椭圆的半长轴的长度与测量模型之间的差异来确定。如已经解释的那样,测量模型描述了所生成的椭圆的半长轴的长度。这可以与椭圆的半长轴的长度进行比较,椭圆的半长轴被确定为模糊特征。因此可以确定作为模糊特征的椭圆或测量的椭圆如何与生成的椭圆不同。因此,可以以简单的方式确定模糊特征或椭圆与物体特征、点特征或线特征之间的相似性。

根据本发明的用于机动车辆的驾驶员辅助系统的控制器设计为用于执行根据本发明的方法。控制器可包括计算机、微处理器、数字信号处理器等。控制器优选地由机动车辆的电子控制单元形成。

根据本发明的用于机动车辆的驾驶员辅助系统包括根据本发明的控制器以及第一传感器和第二传感器,该第一传感器和该第二传感器尤其是超声传感器。控制器连接到第一和第二传感器以用于数据传输。在这种情况下,第一传感器用作用发射器,用于发射传感器信号。第二传感器用作接收器,用于接收从至少一个物体反射的传感器信号。还可以规定的是,驾驶员辅助系统具有另外的传感器,其可以是超声传感器、相机、雷达传感器、激光雷达传感器、激光扫描仪等。

另一实施例涉及一种用于检测机动车辆周围的至少一个物体的方法。在这种情况下,优选地致动第一传感器以发射传感器信号。此外,特别是传感器数据由第二传感器接收,其描述从至少一个物体反射的传感器信号。此外,优选地规定,从传感器数据确定模糊特征作为用于描述至少一个物体的物体特征,其中,模糊特征描述至少一个物体与第一传感器的位置和/或第二传感器的位置之间的距离。特别地,模糊特征被描述为椭圆,其中,椭圆的焦点基于第一传感器和第二传感器的位置来确定。此外,椭圆的半长轴优选地基于传感器信号的运行时间来确定,并且椭圆的半短轴的长度尤其基于焦点和半长轴的长度来确定。

根据本发明的机动车辆包括根据本发明的驾驶员辅助系统。机动车辆尤其设计为乘用车辆。

参考根据本发明的方法提出的优选实施例及其优点对应地适用于根据本发明的控制器、根据本发明的驾驶员辅助系统和根据本发明的机动车辆。

本发明的另外的特征由权利要求、附图和附图说明得出。上面在说明书中提到的特征和特征的组合,以及之后在附图的描述中和/或在附图中单独示出的特征的特征和组合不仅可以在相应指定的组合中使用,而且可以在其他组合中或单独地使用,而不脱离本发明的范围。因此,本发明的实施例也被考虑为包括和公开,这些实施例未在附图中明确示出并且被解释,但是起源自被解释的实施例并且可以通过来自被解释的实施例的特征的单独组合来产生。实施例和特征的组合也被考虑为公开,这些实施例和特征的组合因此不具有最初表示的独立权利要求的所有特征。另外,特别是通过上述实施例,实施例和特征的组合可以被考虑为公开,这些实施例和特征的组合超出或偏离参考权利要求的所表示的特征的组合。

附图说明

现在将基于优选的的示例性实施例以及参考附图更详细地解释本发明。

在这些图中:

图1示出了根据本发明的一个实施例的机动车辆,其包括驾驶员辅助系统,该驾驶员辅助系统具有用于检测物体的多个传感器;

图2示出了圆,其用于描述在传感器的直接测量的情况下物体的位置;

图3示出了椭圆,其用于描述在传感器的间接测量的情况下物体的位置;

图4示出了另一实施例中的图3的椭圆;

图5示出了椭圆和点特征的示意图,其中,点特征和椭圆将被合并;和

图6示出了椭圆和线特征的示意图,其中线特征和椭圆将被合并。

附图中,相同和功能相同的元件设有相同的附图标记。

具体实施方式

图1在俯视图中示出了根据本发明的一个实施例的机动车辆1。机动车辆1在当前情况下被设计为乘用车。机动车辆1包括驾驶员辅助系统2,利用该驾驶员辅助系统2可以检测机动车辆1的周围环境4中的至少一个物体3。

驾驶员辅助系统2包括控制器5,该控制器例如可以由机动车辆1的电子控制单元(ecu)形成。此外,驾驶员辅助系统2包括多个传感器6、7。传感器6、7可以是例如超声传感器,照相机,雷达传感器,激光雷达传感器,激光扫描仪等。在本示例性实施例中,驾驶员辅助系统2包括十二个超声传感器6,其中的六个布置在前部区域8中并且其中的六个布置在机动车辆1的后部区域9中。超声传感器6例如可以布置在机动车辆1的保险杠上。超声波信号可以由各个超声传感器6发射,并且可以接收从物体3反射的超声波信号。还可以执行间接测量,其中一个超声传感器6发射超声波信号,并且相邻的超声传感器6接收从物体3反射的超声波信号。

此外,驾驶员辅助系统2包括摄像机7,通过摄像机7可以检测物体3。可以在摄像机7的下游连接分析单元,通过该分析单元可以分析摄像机7的图像。例如,可以使用相应的物体识别算法来识别物体3。超声传感器6和摄像机7各自连接到控制器5以进行数据传输。在本情况下,为了可理解性,未示出对应的数据线。可以通过传感器6、7中的每一个执行测量,其中生成测量传感器数据。然后,这些传感器数据可以由相应的传感器6、7传输到控制器5。

控制器5可以基于其从传感器6、7中的一个接收的传感器数据来确定描述物体3的物体特征xp,xl,xu。还可以规定,传感器6、7自身确定物体特征,然后将它们传输到控制器5。物体特征xp,xl,xu的确定可以在所谓的特征提取水平中进行。为此目的,可以组合或合并类似传感器的传感器数据的测量值。物体特征xp,xl,xu可以例如在数字环境地图中输入,该数字环境地图描述机动车辆1的周围环境4。源自不同的传感器的提取的物体特征xp,xl,xu可以首先在环境地图或特征提取水平中融合。物体特征xp,xl,xu可以是点特征xp,线特征xl,或模糊特征xu。

这些物体特征xp,xl,xu可以在环境地图中更新。为此,可以确定新的物体特征xp,xl,xu。如果物体特征xp,xl,xu已经存在于环境地图中并且确定了新的物体特征xp,xl,xu,则可以首先检查新的物体特征xp,xl,xu是否可以与存在于环境地图中的物体特征xp,xl,xu相关联。如果物体特征xp,xl,xu彼此相关联,则可以合并物体特征xp,xl,xu。如果不发生关联,则新的物体特征xp,xl,xu可以容纳在环境地图中。

可以从超声传感器6的传感器数据确定物体特征xp,xl,xu。可以基于超声传感器6的传感器数据确定到物体3的距离。为此,超声传感器6发射超声波信号并接收从物体3反射的超声波信号。然后可以基于超声波信号的发射和从物体3反射的超声波信号的接收之间的运行时间来确定距离。如果驾驶员辅助系统2-如图1的示例中所示-具有多个超声传感器6,则可以使用超声传感器6执行直接和间接测量。

在图2中示意性地示出了超声传感器6的直接测量。在直接测量的情况下,超声传感器6发射超声波信号或传感器信号,并且还接收从物体3反射的超声波信号或超声波信号的回波。然后可以从超声波信号的运行时间确定物体3位于围绕超声传感器6的圆xk或半圆上。圆xk的半径由超声波信号的运行时间的一半产生。箭头10描述了在这种情况下传感器信号或超声波信号的信号路径。

在图3中示意性地示出了超声传感器6的间接测量。在这种情况下,第一超声传感器6作为发射器操作。该超声传感器6位于位置xs1并发射超声波信号。位于位置xs2的第二或相邻超声传感器6作为接收器操作,并接收从物体3反射并由第一超声传感器6发射的超声波信号。在这种情况下,物体3位于椭圆xe或半椭圆上,其中,超声传感器6的位置xs1,xs2与椭圆xe的相应焦点xf1和xf2相关联。

如已经解释的,可以通过超声传感器6在多次测量中生成的传感器数据的组合将点特征xp或线特征xl确定为物体特征xp,xl,xu。然而,在某些情况下,不可能确定具有明确空间位置的物体特征xp,xl,xu。例如,如果没有足够的传感器数据,就是这种情况。在这种情况下,提供模糊特征xu作为物体特征xp,xl,xu。在直接测量的情况下,这被描述为在传感器轴线上放置一点,该点具有距传感器位置的测量距离。在间接测量的情况下,椭圆被圆近似,圆的中心点xc是两个传感器位置xs1,xs2的平均值。该中心点xc也称为虚拟传感器位置。圆的半径对应于椭圆的半短轴b的长度。这可以描述如下:

以类似的方式,使用计算的半径在虚拟传感器的轴线上生成模糊特征xu。即使不可能基于传感器数据确定点特征xp或线特征xl,也可以规定点特征xp或线特征xl与模糊特征xu合并。

点特征xp,线特征xl和模糊特征xu被描述为具有期望值和协方差矩阵的高斯随机变量x。因此,点特征xp=(xp,yp)t由其在空间中的二维坐标表示。线特征xl=(xl,yl,αl)t由二维空间中的基点或枢轴点和线的角度αl描述。在当前情况下,线的长度不是随机建模的。最后,模糊特征xu由标量随机变量xu=du描述,其中du是其距实际或虚拟传感器位置xs=(xs,ys)t的欧几里德距离。

要合并物体特征xp,xl,xu,使用通用线性估计器形式的映射函数:

x′1=x1+kh(x1,x2)

在这种情况下,可以用上述物体特征xp,xl,xu代替x1和x2,即点特征xp,线特征xl或模糊特征xu。为此目的,特别地,在下文中描述点特征xp与模糊特征xu的合并或线特征xl与模糊特征xu的合并。通过映射规则组合两个物体特征xp,xl,xu,以获得关于已经存在的物体特征xp,xl,xu的其他信息项。借助于映射规则,可以从第一状态x1或第一物体特征xp,xl,xu确定合并物体特征或合并状态x′1,随机创新函数h(x1,x2)用于此目的。

创新函数h描述了物体特征xp,xl,xu和/或其状态之间的相似性。映射规则或创新函数h也可以是非线性的。在这种情况下,创新函数h然后可以线性化。这可以借助于一阶泰勒级数来进行:

在这种情况下,因子h1和h2是雅可比矩阵。此外,映射规则包括放大因子k或放大矩阵。确定放大因子k在于投影etp′1e被最小化,其中e可以是任意单位矢量。放大系数k可以描述如下:

在当前情况下考虑x1和x2不相关。因此,得到合并结果和更新的协方差矩阵因此导致:

p′1=p1+kh1p1.

为了检查物体的特征xp,xl,xu和/或状态是否相互关联,定义了所谓的马哈拉诺比斯距离:

马哈拉诺比斯距离规定了限制。如果低于此限制,则状态或物体特征xp,xl,xu的关联是合理的。此外,可以使用进一步的几何研究来检查合理性。

为了检查物体特征xp,xl,xu是否应该彼此相关联并合并,要对于物体特征xp,xl,xu确定合适的创新函数h。下面解释用于点特征xp与模糊特征xu的合并以及线特征xl与模糊特征xu的合并的模型。两个模型被确定为测量模型ap,al与模糊特征xu的测量物体距离du之间的差异。测量模型ap,al可以将已知的物体特征xp,xl传送到测量空间中。在该测量空间中,然后可以将物体特征xp,xl,xu与当前测量值进行比较。

如果要将点特征xp与模糊特征xu合并,则测量模型ap是点特征xp和传感器位置xs之间的欧几里德距离dp。创新函数h的结果如下:

如果要将线特征xl与模糊特征xu合并,则测量模型al是线特征xl和传感器位置xs之间的最短距离dl的绝对值。创新函数h的结果如下:

下面将更详细地解释两个创新函数h的图形描述。

如上所述,模糊特征xu被描述为具有距传感器位置xs的距离du的圆形距离测量。该模型独立于生成模糊特征的测量类型使用。在通过超声传感器6进行直接测量的情况下,该模型描述了相对于信号路径的存在的信息项。对于由超声传感器6进行的间接测量,这种模型仅表示近似,其精确度取决于椭圆与圆的相似程度。为了解除这个限制,首先扩展模糊特征xu的描述,以便也能够存储来自间接测量的信息项。此外,确定创新函数h以便能够以椭圆距离测量的形式将点特征xp和线特征xl与模糊特征xu组合。

图4示出了作为模糊特征xu的椭圆xe的示意图。椭圆xe可以以各种方式在数学上描述。典型的描述是将椭圆xe视为一组点,其总和对应于到主长轴2a的长度的两个焦点xf1=(xf1,yf1)t和xf2=(xf2,yf2)t的欧几里德距离:

该描述的优点在于它独立于任何笛卡尔坐标系。此外,椭圆xe可以通过使用半长轴a和半短轴b的隐式椭圆方程来描述:

在椭圆xe的坐标系中描述该等式,其中x轴在半长轴a上取向,y轴在半短轴b上取向。在这种情况下,椭圆xe以角度α倾斜。椭圆xe的另一特性是所谓的线性偏心率e:

线性偏心率e描述了每个焦点xf1,xf2与椭圆xe的中心点xc=(xc,yc)t之间的距离。线性偏心率e由0≤e<a界定。对于偏心率为0的情况e=0,椭圆xe将是圆形。如果e=a,椭圆xe将退化为一条线。

为了获得模糊特征xu的扩展描述,必须将关于超声传感器6的间接测量的所有可用信息项从特征提取层传送到数字环境地图。例如,必须知道两个超声传感器6的位置xs和关于超声传感器的运行时间的信息项。然后可以从运行时间确定半长轴a的长度:a=运行时间距离/2。可以根据超声传感器6的距离确定偏心距e:e=传感器距离/2。然后从以下可以由此确定半短轴b的长度:其中在融合期间不需要半短轴的长度b。

在这种情况下,假设超声传感器6之间的距离或传感器距离是完全已知的。这可以存储在例如控制器5的存储器中。测量的不确定性反映在半长轴a的长度和半短轴b的长度。由于两个半轴a,b的长度彼此不同并且取决于线性偏心率e,所以椭圆xe的不确定性完全通过考虑半轴的单个标量随机变量a或b来反映。由于超声传感器用于直接测量,因此模糊特征xu由半长轴a的长度随机确定。由此,得到xu=au,其中au被建模为高斯曲线。另外,由焦点xf1和xf2描述的传感器位置xs,或者椭圆的中心点xc、线性偏心率e和椭圆xe的取向α的合并,都需要唯一地指定模糊特征。

为了确定关联和合并,将确定两个创新函数h(xp,xu)和h(xl,xu),使用该两个创新函数,点特征xp和线特征xl可以与模糊特征xu合并。确定创新函数h,使得它们考虑测量模型a(x)与测量的椭圆xe的半长轴a之间的差异:

h(x,xu)=h(x,au)=a(x)-au.

在这种情况下,状态x可以由点特征xp的状态或线特征xl的状态代替。测量模型ap(xp)可以确定所产生的椭圆x′e的半长轴a的长度,如果使用超声传感器6或多个超声传感器6测量点特征xp,则点特征xp将位于所产生的椭圆x′e上。如果线特征xl要与模糊特征xu合并,则测量模型al(xl)确定所生成的椭圆xe的半长轴a的长度,线特征xl将切向地延伸到该椭圆xe。在这种情况下可以考虑的是,线特征xl是使用相同的超声传感器6从测量确定的,模糊特征xu也从该超声传感器6的测量确定。

下面将解释点特征xp和线特征xl的测量模型的确定。将基于图5解释用于点特征xp与椭圆xe的合并的测量模型ap的确定,图5示出了点特征xp和椭圆xe的示意图。在点特征xp的情况下,测量模型由以下定义导出:

为了确定测量模型ap,在当前情况下,确定生成的椭圆x′e。确定该生成的椭圆x′e,使得点特征xp位于所生成的椭圆x′e上。可以从以下确定所生成的椭圆x′e的半长轴a的长度:

这适用于a>e。如果满足条件a=e,则点特征xp位于将焦点xf1,xf2彼此连接的线上。在这种情况下,无法从点特征xp导出有效测量结果。可以为所有其他点特征xp确定有效的椭圆。测量模型ap由从第一焦点xf1经点特征xp延伸到第二焦点xf2的路线的一半得到。

该模型用于创新函数h:

在创新函数h的线性化之后,可以确定雅可比矩阵

雅各比矩阵是对于除了之外的所有点定义的。但是,如果这不会发生。

将基于图6解释用于线特征xl与椭圆xe的合并的测量模型al的确定,图6示出了线特征xl和椭圆xe的示意图。线特征xl的测量模型al可以通过将线特征xl与生成的椭圆x′e相交来确定。由超声传感器以线的形式对真实物体进行的间接测量将得到椭圆测量结果,该椭圆测量结果相切地延伸到线。这意味着线或线特征xl必须切向延伸到生成的椭圆x′e。在第一步骤中,该解是从存在于所生成的椭圆x′e的局部坐标系中线特征xl导出的。然后可以扩展测量模型al,使得线特征xl可以用在每个笛卡尔坐标系中。

为确定交叉点,线或线特征xl以显式参数形式描述:

这被插入到隐式椭圆方程中:

对于参数t求解该方程,因为可以从其导出交点。由于该方程是二次方程式,因此它被引入一般二次方程的形式中。然后解该方程:

为获得唯一解,判别式必须为0:

0=p2-q.

可以通过插入p和q并用以下替换b2=a2-e2来对于a解此规范:

这种用于计算半长轴a的长度的解适用于在椭圆xe的局部坐标系中定义的线特征xl。因此,通常线特征xl必须转换到椭圆xe的局部坐标系中:

通过将转换插入到解中,可以得到以下结果:

最后,系列向量被重写为:

并被插入。这得到:

应注意,第一项中的线特征xl的倾斜位置的旋转完全消失,并且在第二项中仅需要角度变换。不需要点特征xp的旋转,因为第一表达式是线特征xl与椭圆xe的中心点xc之间的最短距离的平方,并且这是不变的。获得的解仅在a>e时才有效。如果该条件不适用,则线特征xl与两个焦点xf1,xf2之间的线段相交。在这种情况下,无法从线特征xl导出正确的椭圆xe。

在几何方面,测量模型al通过线特征xl上的焦点xf1,xf2中的一个的投影以及其到椭圆xe的中心点xc的欧几里德距离d的计算来确定。通过该方法可以容易地示出,如果线特征xl位于焦点xf1,xf2中的一个或两个上,则保持条件a=e。

上述解用于创新函数h,其描述如下:

此外,雅克比矩阵被确定:

雅各比矩阵是为所有情况定义的,除了在这种情况下,线特征xl垂直于椭圆xe的主轴并且延伸通过椭圆xe的中心点xc。该规范已经排除了这种情况。

最后,示出了,用于椭圆xe的确定的创新函数h是已经存在的圆的模型的一般化。对于圆的特殊情况,其中:e=0或者xf1=xf2=xc=xs,上述测量模型在数学上是相等的:

应注意,线的现有测量模型的法线指向相反方向。

在当前情况下,解释了基于超声传感器6的间接测量。还可以规定,使用机动车辆1的其他传感器的传感器数据。例如,可以从摄像机7的测量值生成物体特征并将其输入到周围环境地图中。以这种方式可以可靠地检测物体3。

当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1