障碍物检测方法、系统、地面端设备及自主移动平台
文献发布时间:2023-06-19 10:00:31
技术领域
本发明涉及控制技术领域,尤其涉及一种障碍物检测方法、系统、地面端设备及自主移动平台。
背景技术
自主移动平台(例如:无人机、无人车、无人潜艇)已经被广泛地应用于执行拍摄、物流、勘测、巡检、植保和安防等应用领域。
自主移动平台可以按照规划好的路径移动以执行工作任务。自主移动平台在当前路径上移动过程中,很可能会检测到前方存在障碍物。这时,为了避免与障碍物相撞,自主移动平台需要绕过该障碍物。
发明内容
本申请提供一种障碍物检测方法、系统、地面端设备及自主移动平台,能够判断出前方障碍物是否位于安全范围内,降低虚警率,提升自主移动平台的障碍物检测能力。
本申请一实施例提供一种障碍物检测方法。该方法包括:
针对位于自主移动平台移动前方的障碍物,生成多个虚拟目标;
在所述自主移动平台移动过程中,建立所述多个虚拟目标各自对应的目标航迹;
根据所述多个虚拟目标各自对应的目标航迹的评估结果,判断所述障碍物是否位于安全范围内。
本申请另一实施例提供了一种障碍物检测系统。该障碍物检测系统包括:
存储器,用于存储计算机程序;
处理器,用于运行所述存储器中存储的计算机程序以实现:
针对位于自主移动平台移动前方的障碍物,生成多个虚拟目标;其中,所述多个虚拟目标分布在同一条垂直于水平面的垂直线上;所述障碍物位于所述垂直线上;
在所述自主移动平台移动过程中,建立所述多个虚拟目标各自对应的目标航迹;
根据所述多个虚拟目标各自对应的目标航迹的评估结果,判断所述障碍物是否位于安全范围内。
本申请又一实施例提供了一种地面端设备。该地面端设备包括障碍物检测系统。该障碍物检测系统包括:
存储器,用于存储计算机程序;
处理器,用于运行所述存储器中存储的计算机程序以实现:
针对位于自主移动平台移动前方的障碍物,生成多个虚拟目标;其中,所述多个虚拟目标分布在同一条垂直于水平面的垂直线上;所述障碍物位于所述垂直线上;
在所述自主移动平台移动过程中,建立所述多个虚拟目标各自对应的目标航迹;
根据所述多个虚拟目标各自对应的目标航迹的评估结果,判断所述障碍物是否位于安全范围内。
本申请又一实施例提供了一种自主移动平台。该自主移动平台包括障碍物检测系统。该障碍物检测系统包括:
存储器,用于存储计算机程序;
处理器,用于运行所述存储器中存储的计算机程序以实现:
针对位于自主移动平台移动前方的障碍物,生成多个虚拟目标;其中,所述多个虚拟目标分布在同一条垂直于水平面的垂直线上;所述障碍物位于所述垂直线上;
在所述自主移动平台移动过程中,建立所述多个虚拟目标各自对应的目标航迹;
根据所述多个虚拟目标各自对应的目标航迹的评估结果,判断所述障碍物是否位于安全范围内。
本申请实施例提供的技术方案中,在检测到自主移动平台前方存在障碍物后,建立多个虚拟目标各自对应的目标航迹;通过多条目标航迹的评估结果能够判断出障碍物是否位于安全范围内;这样可降低虚警率,提升自主移动平台的障碍物检测能力。
附图说明
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:
图1a示出了自主移动平台(如无人机)在俯仰方向上的安全距离示意图;
图1b示出了本申请一实施例提供的障碍物检测方法的流程示意图;
图2示出了障碍物C在观测坐标系下的坐标示意图;
图3示出了参考坐标系与观测坐标系的原点重叠的示例图;
图4示出了本申请一实施例提供的障碍物检测装置的结构示意图;
图5示出了本申请一实施例提供的障碍物检测系统的结构示意图;
图6示出了本申请一实施例提供的地面端设备与自主移动平台构成的飞控系统的示意图;
图7示出了本申请一实施例提供的自主移动平台的原理性示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
除非另有定义,本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。
为了便于理解本申请的技术方案和技术效果,下面对现有技术进行简要说明:
现有技术中,以无人机为例,通常无人机上会安置有雷达传感器(以下简称雷达)。通常,雷达本地坐标系的原点O取在无人机质心处,坐标系与无人机固连,其第一坐标轴(即Xb)取无人机设计轴指向机头方向,其第三坐标轴(即Zb轴)处在无人机对称面且垂直第一坐标轴指向无人机下方,其第二坐标轴(即Yb)垂直第一坐标轴和第三坐标轴所在面指向无人机右侧。目前,很多无人机上的雷达在无人机的左右方向上具有测角能力,在俯仰方向上(也即是无人机的上下方向)无测角能力。由于雷达天线在俯仰方向上的波束较宽以及副瓣的影响,雷达观测到前方存在目标时,并不清楚目标在俯仰方向上的真实位置,也即无法准确地确定目标在雷达本地坐标系的第三坐标轴上的坐标值。例如:当地面上的障碍物较强时,可能被无人机上的雷达天线波束检测到,会误报警为无人机前方障碍物。同时由于在俯仰方向上没有分辨能力,只能依靠雷达波束来抑制飞机航线以外的目标。
下面将结合图1a对现有技术进行介绍:
设定无人机在俯仰方向上的安全距离为H
传统的方法通过窄波束,实现对无人机正前方目标的探测,但窄波束成本较高。其次还可以通过上翘波束的方法,但上翘波束不能保证无人机下方物体被检测到,并且上翘波束也无法实现对上方物体的位置估计。
为了解决上述技术问题,本申请实施例提供了一种障碍物检测方法,针对检测到的障碍物建立多条不同的目标航迹,从而判断出障碍物是否位于自主移动平台的安全范围内,从而减少虚警率,提升自主移动平台在复杂环境下的障碍物检测能力。
下面结合附图,对本发明的一些实施方式作详细说明。在各实施例之间不冲突的情况下,下述的实施例及实施例中的特征可以相互组合。
图1b示出了本申请一实施例提供的障碍物检测方法的流程示意图。该障碍物检测方法可以应用于自主移动平台,如地面端设备和/或自主移动平台,也即,该障碍物检测方法的执行主体可以为地面端设备或者自主移动平台,更具体为地面端设备或自主移动平台的具有数据处理能力的处理器。其中,地面端设备可以为计算机设备;自主移动平台可以为:飞机、车辆、潜艇等。其中,飞机具体可以为无人机;车辆具体可以为无人车;潜艇具体可以为无人潜艇。如图1b所示,该方法,包括:
101、针对位于自主移动平台移动前方的障碍物,生成多个虚拟目标。
102、在所述自主移动平台移动过程中,建立所述多个虚拟目标各自对应的目标航迹。
103、根据所述多个虚拟目标各自对应的目标航迹的评估结果,判断所述障碍物是否位于安全范围内。
上述101中,自主移动平台在移动过程中,可通过其上的雷达检测前方是否存在障碍物。检测到自主移动平台前方存在障碍物后,可针对该障碍物,生成多个虚拟目标。例如,雷达可设置在自主移动平台的下方,以对自主移动平台移动前方的物体进行实时检测。雷达检测到自主移动平台移动前方有障碍物时,本实施例所述方法执行主体可接收到雷达发出的信号,然后根据雷达信号生成多个虚拟目标。雷达是一种获取目标距离、角度和速度的传感器。本申请实施例提供的技术方案的障碍物皆为静止障碍物。
由上述分析可知,雷达在俯仰方向上无测角能力,故雷达检测到前方存在障碍物时,该障碍物在自主移动平台的观测坐标系(也即雷达本地坐标系,该坐标系与自主移动平台固连)下的坐标位置(xb,yb,zb)中坐标值xb和坐标值yb是确定的,坐标值zb是未知的。其中,坐标值xb为障碍物在观测坐标系下的第一坐标轴上的坐标值;坐标yb为障碍物在观测坐标系下的第二坐标轴上的坐标值;坐标zb为障碍物在观测坐标系下的第三坐标轴上的坐标值。参见图2所示,障碍物C在自主移动平台的观测坐标系OX
本申请实施例的目的就是为了将坐标值zb估算出来,这样既可判断出障碍物是否位于安全范围内。
在一种可实现的方案中,上述101中“针对位于自主移动平台移动前方的障碍物,生成多个虚拟目标”,具体可采用如下步骤来实现:
1011、获取所述障碍物在所述自主移动平台的观测坐标系的第一坐标轴和第二坐标轴上的初始坐标值。
其中,所述观测坐标系由所述第一坐标轴、所述第二坐标轴以及第三坐标轴构成。
在实际应用时,由于雷达无俯仰测角能力,导致自主移动平台无法清楚确定障碍物在该第三坐标轴上的坐标值。
1012、根据所述初始坐标值,生成多个虚拟目标各自在所述观测坐标系下的初始观测坐标。
上述1011中,障碍物在观测坐标系的第一坐标轴和第二坐标轴上的初始坐标值可以是根据自主移动平台对障碍物进行位置观测得到的一次观测结果确定的,或者是综合自主移动平台对障碍物进行重复位置观测得到的多次观测结果确定的。观测结果中包括障碍物在第一坐标轴上的坐标值和在第二坐标轴上的坐标值。具体地,可将多次观测结果中障碍物在第一坐标轴上的坐标值的均值作为障碍物在第一坐标轴上的初始坐标值,将多次观测结果中障碍物在第二坐标轴上的坐标值的均值作为障碍物在第二坐标轴上的初始坐标值。综合多次观测结果,可有效减小观测误差。
在一实例中,上述1012中,各所述虚拟目标的初始观测坐标中所述第一坐标轴对应的坐标值可以为所述障碍物在所述第一坐标轴上的初始坐标值;各所述虚拟目标的初始观测坐标中所述第二坐标轴对应的坐标值可以为所述障碍物在所述第二坐标轴上的初始坐标值;各所述虚拟目标的初始观测坐标中所述第三坐标轴对应的坐标值可以为设定值。不同虚拟目标的初始观测坐标中第三坐标轴对应的坐标值可以不同。
这里需要补充的是:实际应用时,上述观测坐标系可根据实际需要来定义,本申请实施例对此不做具体限定。上述观测坐标系可以为二维坐标系,也可为三维坐标系,具体也可根据实际需要来设定。
为了能够较为准确地估算障碍物的坐标位置,上述多个虚拟目标的数量越多越好,多个虚拟目标中任意相邻两个虚拟目标之间的距离越小越好。多个虚拟目标中任一相邻两个虚拟目标之间的距离可相等或不相等。在一实例中,可将任一相邻两个虚拟目标之间的距离均设为H,H的值可根据实际需要来设定,本申请实施例对此不作具体限定。
举例来说:如图2所示,障碍物在观测坐标系OX
在本实施例中,所述多个虚拟目标分布在同一条直线上;所述障碍物位于所述直线上;所述观测坐标系的第三坐标轴,在自主移动平台观测到障碍物在观测坐标系的第一坐标轴和第二坐标轴上的初始坐标值时,与所述直线平行。
上述102中,上述多个虚拟目标中包括第一虚拟目标,第一虚拟目标为多个虚拟目标中的任意一个。第一虚拟目标对应的目标航迹中记录有第一虚拟目标在自主移动平台移动过程中不同时刻的航迹位置。该航迹位置可以为第一虚拟目标在参考坐标系下的坐标。该参考坐标系可以为北东地坐标系,北东地坐标系的定义可参见现有技术,在此不再详述。该参考坐标系的原点固定在上述自主移动平台上,随着自主移动平台的移动而移动。为了减少后续计算量,上述参考坐标系的原点与上述观测坐标系的原点可以为同一点。参见图3所示的实例,参考坐标系OX
以自主移动平台为无人机为例,通常,无人机在空中作业过程中,其翻滚角通常固定不变,例如:翻滚角可为0;由于其不具有俯仰角测角能力,则可认为其俯仰角固定不变且为0;其只有偏航角可能会发生变化。也就是说,无人机在空中作业过程中,其顶多会绕观测坐标系的第三坐标轴旋转,而不会绕观测坐标系的第一坐标轴和第二坐标轴旋转。
即自主移动平台在上述移动过程中,顶多绕观测坐标系OX
在一实例中,根据在自主移动平台移动过程中不同时刻观测到的第一虚拟目标在观测坐标系下的观测坐标,通过坐标转换,得到不同时刻测量到的第一虚拟目标的测量航迹位置;根据在自主移动平台移动过程中不同时刻测量到的第一虚拟目标的测量航迹位置,建立第一虚拟目标对应的目标航迹。具体地,上述不同时刻中包括第二时刻,获取自主移动平台在所述第二时刻的姿态信息;根据所述姿态信息确定第二时刻对应的转换矩阵;根据第二时刻观测到的第一虚拟目标在观测坐标系下的观测坐标以及第二时刻对应的转换矩阵,得到第二时刻测量得到的第一虚拟目标的测量航迹位置。其中,姿态信息中包括自主移动平台的俯仰角pitch、翻滚角roll和偏航角yaw。具体实施时,自主移动平台的姿态信息可基于自主移动平台上的惯性测量单元测得惯性数据得到。由上述分析可知,通常情况下,俯仰角pitch和翻滚角roll均为0。这样,转换矩阵C为:
假设第二时刻观测到的第一虚拟目标在观测坐标系下的观测坐标为[x
[x
这里需要说明的是:上述内容中仅针对第一虚拟目标的目标航迹的建立进行了说明,实际上,上述步骤101中生成的多个虚拟目标的目标航迹中各虚拟目标的目标航迹均可采用第一虚拟目标的目标航迹的建立方法来建立。当然,多个虚拟目标的目标航迹中也可有部分与第一虚拟目标的目标航迹的建立方法相同,本实施例对此不作具体限定。
为每个虚拟目标建立目标航迹的目的是为了评估,以便根据评估结果来判断障碍物是否位于安全范围内。在一具体实施方式中,上述103中,可采用事先定义的评估规则对多个虚拟目标各自对应的目标航迹进行评估,根据评估结果,来判断障碍物是否位于安全范围内。
目标航迹的评估结果越好,越表明障碍物距离该目标航迹对应的虚拟目标的距离越近。因此,可根据评估结果较好的目标航迹对应的虚拟目标的位置来预估障碍物的预估位置;从而根据预估位置来判断障碍物是否位于安全范围内。例如,可根据评估结果最好的目标航迹,来确定障碍物的预估位置,例如:可将目标航迹评估结果最好的虚拟目标的位置作为障碍物的预估位置。
本申请实施例提供的技术方案中,在检测到自主移动平台前方存在障碍物后,建立多个虚拟目标各自对应的目标航迹。通过多条目标航迹的评估结果能够判断出障碍物是否位于安全范围内。这样可降低虚警率,提升自主移动平台的障碍物检测能力。
在实际应用时,对于那些远远超出安全范围的那些障碍物是不太需要估算其具体位置的,只要能够判断出这些障碍物位于安全范围之外即可。故多个虚拟目标中距离自主移动平台最远的虚拟目标的初始观测坐标中第三坐标轴对应的坐标值具体可选取(2~3)Hs,其中,Hs为安全距离。也就是说,当障碍物位于(2~3)Hs以外时,则所建立的多个虚拟目标均不靠近障碍物的实际位置,这样多个虚拟目标各自对应的目标航迹的评估结果也均较差,这时可直接判定出障碍物位于安全范围之外。
考虑到自主移动平台在实际作业环境中很可能会存在环境噪声,这就有可能会导致自主移动平台在检测到的环境噪声时,误认为其前方存在障碍物。为了避免不必要的后续处理,上述方法,还可包括:
104、检测到所述自主移动平台前方存在所述障碍物后,在所述自主移动平台移动过程中,对所述障碍物重复进行位置观测,得到多次第二观测结果。
105、所述多次第二观测结果中有效观测结果的次数大于或等于第二预设次数时,触发所述生成多个虚拟目标的步骤。
在一种可实现的方案中,若某次第二观测结果中包含有障碍物在上述第一坐标轴上的坐标值和在上述第二坐标轴上的坐标值,则认为该次第二观测结果为有效观测结果;若某次第二观测结果中不包含有障碍物在上述第一坐标轴上的坐标值和/或在上述第二坐标轴上的坐标值,则认为该次第二观测结果为无效观测结果。
其中,第二预设次数可根据实际需要来设定,本申请对此不作具体限定。
多次第二观测结果中有效观测结果的次数大于或等于第二预设次数时,则认为该障碍物是真实存在的,则触发生成多个虚拟目标的步骤。
上述方法,还可包括:
106、所述多次第二观测结果中有效观测结果的次数小于所述第二预设次数时,判定所述障碍物为虚假障碍物。
所述多次第二观测结果中有效观测结果的次数小于所述第二预设次数,则说明该障碍物是虚假的,可能是因环境噪声误认的,故不必要触发生成多个虚拟目标的步骤。
此外,在建立目标航迹之前,还需要确定目标航迹的航迹起始。故上述方法,还可包括:
107、根据所述多个虚拟目标各自在所述观测坐标系下的初始观测坐标,确定所述多个虚拟目标各自对应的目标航迹的航迹起始。
具体可对多个虚拟目标各自在所述观测坐标系下的初始观测坐标进行坐标转换,得到多个虚拟目标各自对应的目标航迹的航迹起始。假设航迹起始对应的时刻为航迹起始时刻,则获取自主移动平台在航迹起始时刻的姿态信息,根据该姿态信息得到航迹起始时刻下的转换矩阵;根据该转换矩阵,对多个虚拟目标各自在所述观测坐标系下的初始观测坐标进行坐标转换,得到多个虚拟目标各自对应的目标航迹的航迹起始。
在一种可实现的方案中,可根据多次第二观测结果中的有效观测结果,确定所述障碍物在自主移动平台的观测坐标系的第一坐标轴和第二坐标轴上的初始坐标值。例如:可将多次第二观测结果中有效观测结果中第一坐标轴对应坐标值的平均值作为所述障碍物在第一坐标轴上的初始坐标值;可将多次第二观测结果中有效观测结果中第二坐标轴对应坐标值的平均值作为所述障碍物在第二坐标轴上的初始坐标值。这样,可降低观测误差,提高初始坐标值的准确度,也即提高航迹起始的准确度。
在上述实施例中,直接将第二时刻测量到的第一虚拟目标的第一测量航迹位置作为第一虚拟目标对应的目标航迹中第二时刻的第二航迹位置。为了降低测量误差导致的目标航迹的不准确性,上述102中“在所述自主移动平台移动过程中,建立所述第一虚拟目标对应的目标航迹”,具体可采用如下步骤来实现:
1021、结合所述第一虚拟目标在第一时刻的第一航迹位置,预测所述第一虚拟目标在第二时刻的第一预测航迹位置。
1022、结合所述第一预测航迹位置以及在所述第二时刻测量到的所述第一虚拟目标的第一测量航迹位置,确定所述第一虚拟目标在所述第二时刻的第二航迹位置。
其中,所述第一虚拟目标对应的目标航迹中记录有所述第一航迹位置和所述第二航迹位置。
上述1021中,由于第一时刻和第二时刻之间的时间间隔一般都很小,且由于飞机的机动性较小,故可认为自主移动平台在第一时刻到第二时刻之间作匀速直线运动。具体地,上述1021中“结合所述第一虚拟目标在第一时刻的第一航迹位置,预测所述第一虚拟目标在第二时刻的第一预测航迹位置”,可采用如下步骤来实现:
S11、获取所述自主移动平台在所述第一时刻的移动速度。
S12、根据所述第一虚拟目标在所述第一时刻的第一航迹位置以及所述移动速度,预测所述第一虚拟目标在第二时刻的第一预测航迹位置。
上述S12中,根据第一航迹位置、移动速度以及第一时刻与第二时刻之间的时间间隔来预测第一预测航迹位置。
具体地,可采用如下公式(2)来实现:
其中,v
上述1022中,第二时刻测量到的第一虚拟目标的第一测量航迹位置的获取步骤具体可参见上述各实施例中相应内容,在此不再赘述。
在本实施例中,综合考虑预测得到的第一预设航迹位置和测量得到的第一测量航迹位置,来确定第二航迹位置,可有效降低测量误差,提高目标航迹的准确性。
在一种可实现的方案中,上述1022中“结合所述第一预测航迹位置以及在所述第二时刻测量到的所述第一虚拟目标的第一测量航迹位置,确定所述第一虚拟目标在所述第二时刻的第二航迹位置”,具体为:将第一预测航迹位置和第一测量航迹位置的中间位置作为第二航迹位置。
在本实施例中,默认第一测量航迹位置是可靠的数据。然而,在实际应用中,由于环境噪声的存在,会影响第一测量航迹位置的可靠性,甚至会导致第一测量航迹位置不可信。为了解决这一问题,在另一种可实现的方案中,上述1022中“结合所述第一预测航迹位置以及在所述第二时刻测量到的所述第一虚拟目标的第一测量航迹位置,确定所述第一虚拟目标在所述第二时刻的第二航迹位置”,具体包括:
S21、当所述第一预测航迹位置与所述第一测量航迹位置的差异的绝对值小于第一预设阈值时,将所述第一预测航迹位置和所述第一测量航迹位置作为滤波算法的输入,执行所述滤波算法,得到所述第二航迹位置。
上述S21中,第一预设阈值可根据实验经验来设定,本申请对此不做具体限定。所述第一预测航迹位置与所述第一测量航迹位置的差异具体可以为欧式距离。所述第一预测航迹位置与所述第一测量航迹位置的差异的绝对值小于第一预设阈值,则说明第一测量航迹位置是较为可靠的,故可将所述第一预测航迹位置和所述第一测量航迹位置作为滤波算法的输入,执行所述滤波算法,得到所述第二航迹位置。其中,滤波算法可根据实际需要来选取,本申请实施例对此不做具体限定。
在一实例中,滤波算法具体可以为αβ滤波算法,则可将上述第一预测航迹位置和第一测量航迹位置作为下述αβ滤波算法函数(3)的输入,得到第二航迹位置。
其中,
上述1022中“结合所述第一预测航迹位置以及在所述第二时刻测量到的所述第一虚拟目标的第一测量航迹位置,确定所述第一虚拟目标在所述第二时刻的第二航迹位置”,具体还可包括:
S22、当所述第一预测航迹位置与所述第一测量航迹位置的差异的绝对值大于或等于所述第一预设阈值时,将所述第一预测航迹位置作为所述第二航迹位置。
所述第一预测航迹位置与所述第一测量航迹位置的差异的绝对值大于或等于第一预设阈值,则说明第一测量航迹位置是完全不可靠的。故直接将第一预测航迹位置作为第二航迹位置。
为了提高第一测量航迹位置的可靠性,上述方法,还可包括:
108、获取在所述第二时刻所处的预设时段内,对所述第一虚拟目标重复进行位置观测得到的多次第一观测结果。
109、当所述多次第一观测结果中有效观测结果的次数大于或等于第一预设次数时,根据所述多次第一观测结果中的有效观测结果,确定所述第一测量航迹位置。
上述108中,所述预设时段可位于第一时刻和第二时刻之间,且短于第一时刻和第二时间之间的时间间隔。
自主移动平台可在第二时刻所处的预设时段内,快速对第一虚拟目标重复进行位置观测得到的多次第一观测结果。
上述109中,某次第一观测结果中包含有所述第一虚拟目标在所述观测坐标系下的观测坐标时,则判定该次第一观测结果为有效观测结果。
当所述多次第一观测结果中有效观测结果的次数大于或等于第一预设次数时,根据所述多次第一观测结果中的有效观测结果,确定所述第一测量航迹位置。具体地,可将多次第一观测结果中有效观测结果中第一坐标轴对应的坐标值的平均值作为第二时刻观测到的第一虚拟目标在观测坐标系下的观测坐标中第一坐标轴对应的坐标值;将多次第一观测结果中有效观测结果中第二坐标轴对应的坐标值的平均值,作为第二时刻观测到的第一虚拟目标在观测坐标系下的观测坐标中第二坐标轴对应的坐标值;多次第一观测结果中有效观测结果中第三坐标轴对应的坐标值的平均值,作为第二时刻观测到的第一虚拟目标在观测坐标系下的观测坐标中第三坐标轴对应的坐标值。
获取自主移动平台在第二时刻的姿态信息;根据自主移动平台在第二时刻的姿态信息,确定第二时刻对应的转换矩阵;根据第二时刻对应的转换矩阵,对第二时刻观测到的第一虚拟目标在观测坐标系下的观测坐标进行坐标转换,得到在第二时刻测量得到的第一测量航迹位置。
上述方法,还可包括:
110、所述多次第一观测结果中有效观测结果的次数小于所述第一预设次数时,将所述第一预测航迹位置作为所述第二航迹位置。
在本实施例中,通过多次观测,依旧无法获取到第一测量航迹位置。故直接将第一预测航迹位置作为所述第二航迹位置。
进一步的,本实施例提供的障碍物检测方法还包括如下步骤:
111、结合所述第一预测航迹位置和所述第一测量航迹位置的差异,评估所述第一虚拟目标对应的目标航迹的评估结果。
在一可实现的技术方案中,上述步骤“结合所述第一预测航迹位置和所述第一测量航迹位置的差异,评估所述第一虚拟目标对应的目标航迹的评估结果”可包括:
1111、获取所述第一虚拟目标对应的目标航迹在所述第一时刻时的航迹质量评估分;
1112、根据所述第一预测航迹位置与所述第一测量航迹位置的差异,对所述航迹质量评估分进行增减操作,得到更新后的航迹质量评估分;其中,所述差异与所述航迹质量评估分呈反相关关系;
1113、将所述更新后的航迹质量评估分作为所述第一虚拟目标对应的目标航迹在所述第二时刻的航迹质量评估分。
具体实施时,还可继续根据第二预测航迹位置(即第二时刻预测出的航迹位置)与第二测量航迹位置(即第二时刻测量出的航迹位置)的差异,继续对第二时刻的航迹质量评估分进行增减操作。
具体的,增减操作可以包括如下中的至少一种方式:
方式1、所述第一预测航迹位置与所述第一测量航迹位置的差异大时,航迹质量评估分减第一设定分数;所述第一预测航迹位置与所述第一测量航迹位置的差异小时,航迹质量评估分不变或增加第二设定分值;
方式2、所述第一预测航迹位置与所述第一测量航迹位置的差异大时,航迹质量评估分不变或减第一设定分数;所述第一预测航迹位置与所述第一测量航迹位置的差异小时,航迹质量评估分增加第二设定分值;
方式3、基于所述第一预测航迹位置与所述第一测量航迹位置的差异,确定增减方式以及增减幅度值;然后按照增减方式对所述航迹质量评估分增加或减少所述增减幅度值。
- 障碍物检测方法、系统、地面端设备及自主移动平台
- ToF相机及其地面障碍物检测方法、地面导航设备