障碍物检测方法、系统、地面端设备及自主移动平台

技术领域

本发明涉及控制技术领域，尤其涉及一种障碍物检测方法、系统、地面端设备及自主移动平台。

背景技术

自主移动平台(例如：无人机、无人车、无人潜艇)已经被广泛地应用于执行拍摄、物流、勘测、巡检、植保和安防等应用领域。

自主移动平台可以按照规划好的路径移动以执行工作任务。自主移动平台在当前路径上移动过程中，很可能会检测到前方存在障碍物。这时，为了避免与障碍物相撞，自主移动平台需要绕过该障碍物。

发明内容

本申请提供一种障碍物检测方法、系统、地面端设备及自主移动平台，能够判断出前方障碍物是否位于安全范围内，降低虚警率，提升自主移动平台的障碍物检测能力。

本申请一实施例提供一种障碍物检测方法。该方法包括：

针对位于自主移动平台移动前方的障碍物，生成多个虚拟目标；

在所述自主移动平台移动过程中，建立所述多个虚拟目标各自对应的目标航迹；

根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全范围内。

本申请另一实施例提供了一种障碍物检测系统。该障碍物检测系统包括：

存储器，用于存储计算机程序；

处理器，用于运行所述存储器中存储的计算机程序以实现：

针对位于自主移动平台移动前方的障碍物，生成多个虚拟目标；其中，所述多个虚拟目标分布在同一条垂直于水平面的垂直线上；所述障碍物位于所述垂直线上；

在所述自主移动平台移动过程中，建立所述多个虚拟目标各自对应的目标航迹；

根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全范围内。

本申请又一实施例提供了一种地面端设备。该地面端设备包括障碍物检测系统。该障碍物检测系统包括：

存储器，用于存储计算机程序；

处理器，用于运行所述存储器中存储的计算机程序以实现：

针对位于自主移动平台移动前方的障碍物，生成多个虚拟目标；其中，所述多个虚拟目标分布在同一条垂直于水平面的垂直线上；所述障碍物位于所述垂直线上；

在所述自主移动平台移动过程中，建立所述多个虚拟目标各自对应的目标航迹；

根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全范围内。

本申请又一实施例提供了一种自主移动平台。该自主移动平台包括障碍物检测系统。该障碍物检测系统包括：

存储器，用于存储计算机程序；

处理器，用于运行所述存储器中存储的计算机程序以实现：

针对位于自主移动平台移动前方的障碍物，生成多个虚拟目标；其中，所述多个虚拟目标分布在同一条垂直于水平面的垂直线上；所述障碍物位于所述垂直线上；

在所述自主移动平台移动过程中，建立所述多个虚拟目标各自对应的目标航迹；

根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全范围内。

本申请实施例提供的技术方案中，在检测到自主移动平台前方存在障碍物后，建立多个虚拟目标各自对应的目标航迹；通过多条目标航迹的评估结果能够判断出障碍物是否位于安全范围内；这样可降低虚警率，提升自主移动平台的障碍物检测能力。

附图说明

此处所说明的附图用来提供对本申请的进一步理解，构成本申请的一部分，本申请的示意性实施例及其说明用于解释本申请，并不构成对本申请的不当限定。在附图中：

图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、基于所述第一预测航迹位置与所述第一测量航迹位置的差异，确定增减方式以及增减幅度值；然后按照增减方式对所述航迹质量评估分增加或减少所述增减幅度值。

上述方式1和方式2中的增减均为固定分数；方式3为基于差异的程度来动态的确定增加幅度值。一种可实现的方案中，假设，设定有三个判定区间，分别为区间1(0、a)、区间2[a、b]、区间3(b、c)；其中，0

其中，差异大小的判断可通过与一设定阈值比较来确定，假设，所述第一预测航迹位置与所述第一测量航迹位置的差异大于该设定阈值，则认为差异大；第一预测航迹位置与所述第一测量航迹位置的差异小于该设定阈值，则认为差异小。

另外，所述差异与所述航迹质量评估分呈反相关关系可简单理解为：差异越大，航迹质量评估分越低；差异越小，航迹质量评估分越高。

进一步的，所述评估结果中包括航迹质量评估分；相应的，本实施例中步骤103“根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全飞行区”，可具体包括：

1031、所述多个虚拟目标各自对应的目标航迹的航迹质量评估分中存在大于或等于预设分数值的航迹质量评估分时，根据所述多个虚拟目标各自对应的目标航迹，确定所述障碍物的预估位置信息；

1032、根据所述预估位置信息，判断所述障碍物是否位于安全范围内。

在一具体实施方案中，上述步骤1031中“根据所述多个虚拟目标各自对应的目标航迹，确定所述障碍物的预估位置信息”，可具体为：

根据所述多个虚拟目标各自对应的目标航迹中最后记录的航迹位置，采用二项式插值的方式，确定出所述障碍物的预估位置信息。

其中，二项式插值可参见现有技术中的相关内容，本实施例对此不作具体限定。

进一步的，上述步骤1032“根据所述预估位置信息，判断所述障碍物是否位于安全范围内”，可具体为：

所述多个虚拟目标各自对应的目标航迹的航迹质量评估分均小于所述预设分数值时，判定所述障碍物位于安全范围以外。

上述预设分数值可为一经验值，本实施例对该预设分数值的取值不作具体限定，可根据实际应用场景中的具体情况设定。

图4示出了本申请另一实施例提供的障碍物检测装置的结构示意图。如图4所示，所述障碍物检测装置包括：

生成模块11，用于针对位于自主移动平台移动前方的障碍物，生成多个虚拟目标；

建立模块12，用于在所述自主移动平台移动过程中，建立所述多个虚拟目标各自对应的目标航迹；

判断模块13，用于根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全范围内。

本实施例提供的技术方案中，在检测到自主移动平台前方存在障碍物后，建立多个虚拟目标各自对应的目标航迹；通过多条目标航迹的评估结果能够判断出障碍物是否位于安全范围内；这样可降低虚警率，提升自主移动平台的障碍物检测能力。

进一步的，所述生成模块11针对位于自主移动平台移动前方的障碍物，生成多个虚拟目标时，具体用于：

获取所述障碍物在自主移动平台的观测坐标系的第一坐标轴和第二坐标轴上的初始坐标值；所述观测坐标系由所述第一坐标轴、所述第二坐标轴以及第三坐标轴构成；

根据所述初始坐标值，生成多个虚拟目标各自在所述观测坐标系下的初始观测坐标。

进一步的，各所述虚拟目标的初始观测坐标中所述第一坐标轴对应的坐标值为所述障碍物在所述第一坐标轴上的初始坐标值；各所述虚拟目标的初始观测坐标中所述第二坐标轴对应的坐标值为所述障碍物在所述第二坐标轴上的初始坐标值；各所述虚拟目标的初始观测坐标中所述第三坐标轴对应的坐标值为设定值。

进一步的，本实施例提供的障碍物检测装置还可包括确定模块。其中，所述确定模块用于根据所述多个虚拟目标各自在所述观测坐标系下的初始观测坐标，确定所述多个虚拟目标各自对应的目标航迹的航迹起始。

进一步的，所述多个虚拟目标中包括第一虚拟目标；相应的，所述建立模块12在所述自主移动平台移动过程中，建立所述第一虚拟目标对应的目标航迹时，具体用于：

结合所述第一虚拟目标在第一时刻的第一航迹位置，预测所述第一虚拟目标在第二时刻的第一预测航迹位置；

结合所述第一预测航迹位置以及在所述第二时刻测量到的所述第一虚拟目标的第一测量航迹位置，确定所述第一虚拟目标在所述第二时刻的第二航迹位置；其中，所述第一虚拟目标对应的目标航迹中记录有所述第一航迹位置和所述第二航迹位置。

进一步的，所述建立模块12结合所述第一预测航迹位置以及在所述第二时刻测量到的所述第一虚拟目标的第一测量航迹位置，确定所述第一虚拟目标在所述第二时刻的第二航迹位置时，具体用于：

当所述第一预测航迹位置与所述第一测量航迹位置的差异的绝对值小于第一预设阈值时，将所述第一预测航迹位置和所述第一测量航迹位置作为滤波算法的输入，执行所述滤波算法，得到所述第二航迹位置。

进一步的，所述建立模块12结合所述第一预测位置以及在所述第二时刻测量到的所述第一虚拟目标的第一测量位置，确定所述第一虚拟目标在所述第二时刻的第二位置时，具体用于：

当所述第一预测航迹位置与所述第一测量航迹位置的差异的绝对值大于或等于所述第一预设阈值时，将所述第一预测航迹位置作为所述第二航迹位置。

进一步的，本实施例提供的所述障碍物检测装置还可包括：

获取模块，用于获取在所述第二时刻所处的预设时段内，对所述第一虚拟目标重复进行位置观测得到的多次第一观测结果；

确定模块，用于当所述多次第一观测结果中有效观测结果的次数大于或等于第一预设次数时，根据所述多次第一观测结果中的有效观测结果，确定所述第一测量航迹位置。

进一步的，所述确定模块还用于：所述多次第一观测结果中有效观测结果的次数小于所述第一预设次数时，将所述第一预测航迹位置作为所述第二航迹位置。

进一步的，所述建立模块12结合所述第一虚拟目标在第一时刻的第一航迹位置，预测所述第一虚拟目标在第二时刻的第一预测航迹位置时，具体用于：

获取所述自主移动平台在所述第一时刻的移动速度；

根据所述第一虚拟目标在所述第一时刻的第一航迹位置以及所述移动速度，预测所述第一虚拟目标在第二时刻的第一预测航迹位置。

进一步的，本实施例提供的障碍物检测装置还可包括：

观测模块，用于在检测到所述自主移动平台前方存在所述障碍物后，在所述自主移动平台移动过程中，对所述障碍物重复进行位置观测，得到多次第二观测结果；

触发模块，用于在所述多次第二观测结果中有效观测结果的次数大于或等于第二预设次数时，触发所述生成多个虚拟目标的步骤。

进一步的，本实施例提供的障碍物检测装置还可包括：

判定模块，用于在所述多次第二观测结果中有效观测结果的次数小于所述第二预设次数时，判定所述障碍物为虚假障碍物。

进一步的，本实施例提供的障碍物检测装置还可包括：

评估模块，用于结合所述第一预测航迹位置和所述第一测量航迹位置的差异，评估所述第一虚拟目标对应的目标航迹的评估结果。

进一步的，所述评估模块结合所述第一预测航迹位置和所述第一测量航迹位置的差异，评估所述第一虚拟目标对应的目标航迹的评估结果时，具体用于：

获取所述第一虚拟目标对应的目标航迹在所述第一时刻时的航迹质量评估分；

根据所述第一预测航迹位置与所述第一测量航迹位置的差异，对所述航迹质量评估分进行增减操作，得到更新后的航迹质量评估分；其中，所述差异与所述航迹质量评估分呈反相关关系；

将所述更新后的航迹质量评估分作为所述第一虚拟目标对应的目标航迹在所述第二时刻的航迹质量评估分。

进一步的，所述评估结果中包括航迹质量评估分。相应的，所述判断模块13根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全飞行区时，具体用于：

所述多个虚拟目标各自对应的目标航迹的航迹质量评估分中存在大于或等于预设分数值的航迹质量评估分时，根据所述多个虚拟目标各自对应的目标航迹，确定所述障碍物的预估位置信息；

根据所述预估位置信息，判断所述障碍物是否位于安全范围内。

进一步的，所述判断模块根据所述多个虚拟目标各自对应的目标航迹，确定所述障碍物的预估位置信息时，具体用于：

根据所述多个虚拟目标各自对应的目标航迹中最后记录的航迹位置，采用二项式插值的方式，确定出所述障碍物的预估位置信息。

进一步的，所述判断模块根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全范围内时，具体用于：

所述多个虚拟目标各自对应的目标航迹的航迹质量评估分均小于所述预设分数值时，判定所述障碍物位于安全范围以外。

进一步的，本实施例中所述的自主移动平台为无人机。

图5示出了本申请一实施例提供的障碍物检测系统的结构示意图。如图5所示，所述障碍物检测系统包括：

存储器22，用于存储计算机程序；

处理器21，用于运行所述存储器中存储的计算机程序以实现：

针对位于自主移动平台移动前方的障碍物，生成多个虚拟目标；其中，所述多个虚拟目标分布在同一条垂直于水平面的垂直线上；所述障碍物位于所述垂直线上；

在所述自主移动平台移动过程中，建立所述多个虚拟目标各自对应的目标航迹；

根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全范围内。

本实施例提供的技术方案中，在检测到自主移动平台前方存在障碍物后，建立多个虚拟目标各自对应的目标航迹；通过多条目标航迹的评估结果能够判断出障碍物是否位于安全范围内；这样可降低虚警率，提升自主移动平台的障碍物检测能力。

进一步的，所述处理器21针对位于自主移动平台移动前方的障碍物，生成多个虚拟目标时，具体用于：

获取所述障碍物在自主移动平台的观测坐标系的第一坐标轴和第二坐标轴上的初始坐标值；所述观测坐标系由所述第一坐标轴、所述第二坐标轴以及第三坐标轴构成；

根据所述初始坐标值，生成多个虚拟目标各自在所述观测坐标系下的初始观测坐标。

进一步的，所述处理器21还用于：

根据所述多个虚拟目标各自在所述观测坐标系下的初始观测坐标，确定所述多个虚拟目标各自对应的目标航迹的航迹起始。

进一步的，所述多个虚拟目标中包括第一虚拟目标；以及

所述处理器21在所述自主移动平台移动过程中，建立所述第一虚拟目标对应的目标航迹时，具体用于：

结合所述第一虚拟目标在第一时刻的第一航迹位置，预测所述第一虚拟目标在第二时刻的第一预测航迹位置；

结合所述第一预测航迹位置以及在所述第二时刻测量到的所述第一虚拟目标的第一测量航迹位置，确定所述第一虚拟目标在所述第二时刻的第二航迹位置；其中，所述第一虚拟目标对应的目标航迹中记录有所述第一航迹位置和所述第二航迹位置。

进一步的，所述处理器21结合所述第一预测航迹位置以及在所述第二时刻测量到的所述第一虚拟目标的第一测量航迹位置，确定所述第一虚拟目标在所述第二时刻的第二航迹位置时，具体用于：

当所述第一预测航迹位置与所述第一测量航迹位置的差异的绝对值小于第一预设阈值时，将所述第一预测航迹位置和所述第一测量航迹位置作为滤波算法的输入，执行所述滤波算法，得到所述第二航迹位置。

进一步的，所述处理器21结合所述第一预测位置以及在所述第二时刻测量到的所述第一虚拟目标的第一测量位置，确定所述第一虚拟目标在所述第二时刻的第二位置时，具体用于：

当所述第一预测航迹位置与所述第一测量航迹位置的差异的绝对值大于或等于所述第一预设阈值时，将所述第一预测航迹位置作为所述第二航迹位置。

进一步的，所述处理器21还用于：

获取在所述第二时刻所处的预设时段内，对所述第一虚拟目标重复进行位置观测得到的多次第一观测结果；

当所述多次第一观测结果中有效观测结果的次数大于或等于第一预设次数时，根据所述多次第一观测结果中的有效观测结果，确定所述第一测量航迹位置。

进一步的，所述处理器21还用于：

所述多次第一观测结果中有效观测结果的次数小于所述第一预设次数时，将所述第一预测航迹位置作为所述第二航迹位置。

进一步的，所述处理器21结合所述第一虚拟目标在第一时刻的第一航迹位置，预测所述第一虚拟目标在第二时刻的第一预测航迹位置时，具体用于：

获取所述自主移动平台在所述第一时刻的移动速度；

根据所述第一虚拟目标在所述第一时刻的第一航迹位置以及所述移动速度，预测所述第一虚拟目标在第二时刻的第一预测航迹位置。

进一步的，所述处理器21还用于：

检测到所述自主移动平台前方存在所述障碍物后，在所述自主移动平台移动过程中，对所述障碍物重复进行位置观测，得到多次第二观测结果；

所述多次第二观测结果中有效观测结果的次数大于或等于第二预设次数时，触发所述生成多个虚拟目标的步骤。

进一步的，所述处理器21还用于：

所述多次第二观测结果中有效观测结果的次数小于所述第二预设次数时，判定所述障碍物为虚假障碍物。

进一步的，所述处理器21还用于：

结合所述第一预测航迹位置和所述第一测量航迹位置的差异，评估所述第一虚拟目标对应的目标航迹的评估结果。

进一步的，所述处理器21结合所述第一预测航迹位置和所述第一测量航迹位置的差异，评估所述第一虚拟目标对应的目标航迹的评估结果时，具体用于：

获取所述第一虚拟目标对应的目标航迹在所述第一时刻时的航迹质量评估分；

根据所述第一预测航迹位置与所述第一测量航迹位置的差异，对所述航迹质量评估分进行增减操作，得到更新后的航迹质量评估分；其中，所述差异与所述航迹质量评估分呈反相关关系；

将所述更新后的航迹质量评估分作为所述第一虚拟目标对应的目标航迹在所述第二时刻的航迹质量评估分。

进一步的，所述评估结果中包括航迹质量评估分；以及

所述处理器21根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全飞行区时，具体用于：

所述多个虚拟目标各自对应的目标航迹的航迹质量评估分中存在大于或等于预设分数值的航迹质量评估分时，根据所述多个虚拟目标各自对应的目标航迹，确定所述障碍物的预估位置信息；

根据所述预估位置信息，判断所述障碍物是否位于安全范围内。

进一步的，所述处理器21根据所述多个虚拟目标各自对应的目标航迹，确定所述障碍物的预估位置信息时，具体用于：

根据所述多个虚拟目标各自对应的目标航迹中最后记录的航迹位置，采用二项式插值的方式，确定出所述障碍物的预估位置信息。

进一步的，所述处理器21根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全范围内时，具体用于：

所述多个虚拟目标各自对应的目标航迹的航迹质量评估分均小于所述预设分数值时，判定所述障碍物位于安全范围以外。

这里需要说明的是：上述实施例中处理器还可上述各方法实施例中描述的技术方案，具体实现的原理可参见上述各方法实施例中的相应内容，此处不再赘述。

可选地，除了处理器，本申请各实施例提供的障碍物检测系统还可包括显示控制器和/或显示设备单元22，收发器23，音频输入输出单元25，其他输入输出单元等。障碍物检测系统包括的这些部件可以通过总线或内部连接互联。

可选地，收发器可以是有线收发器或无线收发器，诸如，WIFI收发器，卫星收发器，蓝牙收发器，3G/4G/5G无线通信信号收发器或其组合等。

可选地，该音频输入输出单元可以包括扬声器，话筒，听筒等。

可选地，其他输入输出设备可以包括USB端口，串行端口，并行端口，打印机，网络接口等。

进一步的，本申请一实施例还提供了一个或多个非暂时性计算机可读存储介质，其具有储存于其上的可执行指令，所述可执行指令在一个或多个处理器执行时，使所述计算机系统至少：

针对位于自主移动平台移动前方的障碍物，生成多个虚拟目标；

在所述自主移动平台移动过程中，建立所述多个虚拟目标各自对应的目标航迹；

根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全范围内。

本申请实施例提供的各实施例可应用到需检测障碍物的设备上，该设备可为自主移动平台，如自主移动车辆、无人飞机器等，本实施例对此不作具体限定。当然，本申请各实施例提供的各实施例提供的技术方案应用在与自主移动平台通信连接的地面端设备，比如，无人飞行器的飞控信号均由地面端设备发出。

下面地面端设备为例，如图6所示，本实施例提供一种地面端设备。该地面端设备包括障碍物检测系统，可与一自主移动平台通信连接，用于向自主移动平台发送控制信号。具体的，障碍物检测系统设置在地面端设备200的设备体内上，自主移动平台200上设有雷达。具体的，继续参见图5所示，所述障碍物检测系统可包括：

存储器，用于存储计算机程序；

处理器，用于运行所述存储器中存储的计算机程序以实现：

针对位于地面端设备移动前方的障碍物，生成多个虚拟目标；其中，所述多个虚拟目标分布在同一条垂直于水平面的垂直线上；所述障碍物位于所述垂直线上；

在所述地面端设备移动过程中，建立所述多个虚拟目标各自对应的目标航迹；

根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全范围内。

具体的，本实施例中所述的障碍物检测系统还采用上述实施例中提供的技术方案，有关障碍物检测系统的内容可参见上文中相应描述，此处不作赘述。

具体实施时，所述地面端设备可以是：与自主移动平台通信的控制设备、智能终端(如智能手机、电脑等)、遥控器等等，本实施例对此不作具体限定。

如图7所示，本实施例提供一种自主移动平台。该自主移动平台800包括障碍物检测系统850，障碍物检测系统850设置在自主移动平台800的设备体上，所述设备体上还设有雷达840；雷达840与障碍物检测系统通信连接，以便障碍物检测系统获取雷达输出的信号。具体的，所述障碍物检测系统850可包括：

存储器，用于存储计算机程序；

处理器，用于运行所述存储器中存储的计算机程序以实现：

针对位于地面端设备移动前方的障碍物，生成多个虚拟目标；其中，所述多个虚拟目标分布在同一条垂直于水平面的垂直线上；所述障碍物位于所述垂直线上；

在所述地面端设备移动过程中，建立所述多个虚拟目标各自对应的目标航迹；

根据所述多个虚拟目标各自对应的目标航迹的评估结果，判断所述障碍物是否位于安全范围内。

具体的，本实施例中所述的障碍物检测系统还采用上述实施例中提供的技术方案，有关障碍物检测系统的内容可参见上文中相应描述，此处不作赘述。

进一步的，如图7所示，所述自主移动平台还可包括：相机820、云台810。相机820设置在所述云台810；相机820通过所述云台810可相对机身移动。所述自主移动平台上可还设有惯性测量单元(图中未示出)。该可移动平台还可包括：动力系统830。该动力系统可以包括电子调速器(简称为电调)、一个或多个螺旋桨以及与一个或多个螺旋桨相对应的一个或多个电机。当然，可移动平台除上述列出装置外，还可包括其他元件或装置，本文不一一例举。

以上各个实施例中的技术方案、技术特征在与本相冲突的情况下均可以单独，或者进行组合，只要未超出本领域技术人员的认知范围，均属于本申请保护范围内的等同实施例。

在本发明所提供的几个实施例中，应该理解到，所揭露的相关检测装置(例如：IMU)和方法，可以通过其它的方式实现。例如，以上所描述的遥控装置实施例仅仅是示意性的，例如，所述模块或单元的划分，仅仅为一种逻辑功能划分，实际实现时可以有另外的划分方式，例如多个单元或组件可以结合或者可以集成到另一个系统，或一些特征可以忽略，或不执行。另一点，所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口，遥控装置或单元的间接耦合或通信连接，可以是电性，机械或其它的形式。

所述作为分离部件说明的单元可以是或者也可以不是物理上分开的，作为单元显示的部件可以是或者也可以不是物理单元，即可以位于一个地方，或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。

另外，在本发明各个实施例中的各功能单元可以集成在一个处理单元中，也可以是各个单元单独物理存在，也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现，也可以采用软件功能单元的形式实现。

所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时，可以存储在一个计算机可读取存储介质中。基于这样的理解，本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来，该计算机软件产品存储在一个存储介质中，包括若干指令用以使得计算机处理器(processor)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括：U盘、移动硬盘、只读存储器(ROM，Read-Only Memory)、随机存取存储器(RAM，RandomAccess Memory)、磁盘或者光盘等各种可以存储程序代码的介质。

以上所述仅为本发明的实施例，并非因此限制本发明的专利范围，凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换，或直接或间接运用在其他相关的技术领域，均同理包括在本发明的专利保护范围内。

最后应说明的是：以上各实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述各实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分或者全部技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。