距离确定方法、可移动平台及计算机可读存储介质与流程

文档序号:24985537发布日期:2021-05-07 23:03阅读:118来源:国知局
距离确定方法、可移动平台及计算机可读存储介质与流程

本申请涉及距离测量的技术领域,尤其涉及一种距离确定方法、可移动平台及计算机可读存储介质。



背景技术:

目前,可移动平台装载有飞行时间(timeofflight,tof)测距装置,tof测距装置可从发射器向对象发射光脉冲,接收器则可通过计算光脉冲从发射器到对象,再以像素格式返回到接收器的运行时间来确定可移动平台与目标对象之间的距离。在大部分场景下,tof测距装置测量的距离较为精准,但在有高反射物体,如路牌的场景下,tof测距装置会出现周期混叠的情况,导致tof测距装置测量的距离不准确,容易给可移动平台带来一些影响,例如,可移动平台通过tof测距装置测量的距离,进行避障,在tof测距装置测量的距离不准确的情况下,会导致可移动平台无法准确的避障,无法保证可移动平台的安全性。因此,如何准确的测量可移动平台与物体之间的距离是目前亟待解决的问题。



技术实现要素:

基于此,本申请提供了一种距离确定方法、可移动平台及计算机可读存储介质,旨在准确的测量可移动平台与物体之间的距离。

第一方面,本申请提供了一种距离确定方法,应用于可移动平台,其中,所述可移动平台包括视觉传感器和tof测距装置,所述tof测距装置包括用于发射光信号的发射装置和用于接收由目标对象反射的光信号的接收装置,所述方法包括:

获取所述tof测距装置采集到的所述可移动平台与所述目标对象之间的第一距离;

获取所述视觉传感器输出的所述目标对象的第一图像和第二图像;

根据所述第一图像和第二图像,确定所述可移动平台与所述目标对象上的多个空间点之间的第二距离;

根据多个所述第二距离和所述第一距离确定所述可移动平台与所述目标对象之间的目标距离。

第二方面,本申请还提供了一种可移动平台,所述可移动平台包括视觉传感器、tof测距装置、存储器和处理器,所述处理器与所述视觉传感器和tof测距装置连接;

所述tof测距装置包括用于发射光信号的发射装置和用于接收由目标对象反射的光信号的接收装置;

所述存储器用于存储计算机程序;

所述处理器,用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:

获取所述tof测距装置采集到的所述可移动平台与所述目标对象之间的第一距离;

获取所述视觉传感器输出的所述目标对象的第一图像和第二图像;

根据所述第一图像和第二图像,确定所述可移动平台与所述目标对象上的多个空间点之间的第二距离;

根据多个所述第二距离和所述第一距离确定所述可移动平台与所述目标对象之间的目标距离。

第三方面,本申请还提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时使所述处理器实现如本申请说明书提供的任一种距离确定方法的步骤。

本申请实施例提供了一种距离确定方法、可移动平台及计算机可读存储介质,通过tof测距装置确定可移动平台与目标对象之间的第一距离,并通过视觉传感器输出的目标对象的第一图像和第二图像,确定可移动平台与目标对象上的多个空间点之间的第二距离,然后根据多个第二距离和第一距离确定可移动平台与目标对象之间的目标距离。由于综合考虑了tof测距装置与视觉传感器的距离测量结果,因此可以准确的测量可移动平台与物体之间的距离。

应当理解的是,以上的一般描述和后文的细节描述仅是示例性和解释性的,并不能限制本申请。

附图说明

为了更清楚地说明本申请实施例技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。

图1是本申请实施例提供的可移动平台的一结构示意图;

图2是本申请一实施例提供的一种距离确定方法的步骤示意流程图;

图3是本申请实施例中tof测距装置和视觉传感器测量目标对象与可移动平台之间的距离的一场景示意图;

图4是图1中的距离确定方法的子步骤示意流程图;

图5是图1中的距离确定方法的子步骤示意流程图;

图6是本申请一实施例提供的一种无人飞行器的结构示意性框图。

具体实施方式

下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。

附图中所示的流程图仅是示例说明,不是必须包括所有的内容和操作/步骤,也不是必须按所描述的顺序执行。例如,有的操作/步骤还可以分解、组合或部分合并,因此实际执行的顺序有可能根据实际情况改变。

下面结合附图,对本申请的一些实施方式作详细说明。在不冲突的情况下,下述的实施例及实施例中的特征可以相互组合。

本申请提供一种距离确定方法、可移动平台及计算机可读存储介质,该距离确定方法应用于可移动平台,如图1所示,可移动平台100包括视觉传感器110和飞行时间(timeofflight,tof)测距装置120,tof测距装置120包括用于发射光信号的发射装置和用于接收由目标对象反射的光信号的接收装置,视觉传感器110可以是单目视觉装置,也可以是双目视觉装置,该目标对象为tof测距装置的发射装置发射的光信号照射到物体对象上所形成的光斑区域,通过tof测距装置120可以测量得到可移动平台与目标对象(物体对象)之间的第一距离,通过视觉传感器110输出的目标对象的两个图像,可以确定可移动平台与目标对象上的多个空间点之间的第二距离,通过第一距离和多个第二距离能够准确的确定可移动平台与目标对象(物体对象)之间的距离。

其中,可移动平台包括无人机、可移动机器人和云台车等,无人机包括旋翼型无人机,例如四旋翼无人机、六旋翼无人机、八旋翼无人机,也可以是固定翼无人机,还可以是旋翼型与固定翼无人机的组合,在此不作限定。

请参阅图2,图2是本申请一实施例提供的一种距离确定方法的步骤示意流程图。具体地,如图2所示,该距离确定方法包括步骤s101至步骤s104。

步骤s101、获取所述tof测距装置采集到的所述可移动平台与所述目标对象之间的第一距离。

tof测距装置包括用于发射光信号的发射装置和用于接收由目标对象反射的光信号的接收装置,发射装置的光源为红外光源,tof测距装置的发射装置发射光信号,并记录发射时刻点,当发射装置发射的光信号遇到物体对象时,会在物体对象的表面形成光斑,从而得到物体对象上的目标对象,同时光信号经过物体对象的表面发射,得到由目标对象反射的光信号,通过tof测距装置的接收装置能够接收由目标对象反射的光信号,并记录接收时刻点,通过发射时刻点和接收时刻点可以计算得到光信号在可移动平台与目标对象之间的飞行时间,再根据该飞行时间和光速即可计算得到可移动平台与目标对象之间的第一距离。其中,目标对象为tof测距装置的发射装置发射的光信号照射到物体对象上所形成的光斑区域。

步骤s102、获取所述视觉传感器输出的所述目标对象的第一图像和第二图像。

其中,第一图像包括第一目标图像区域,第一目标图像区域为该目标对象在第一图像上的投影所在的区域,第二图像包括第二目标图像区域,第二目标图像区域为该目标对象在第二图像上的投影所在的区域,第一目标图像区域的中心像素点在第一图像中的位置和第二目标图像区域的中心像素点在第二图像中的位置根据视觉传感器和tof测距装置之间的安装位置关系确定,而第一目标图像区域在第一图像中的位置和第二目标图像区域在第二图像中的位置根据视觉传感器和tof测距装置之间的安装位置关系和第一距离确定,根据视觉传感器和tof测距装置之间的安装位置关系,可以确定视觉传感器与tof测距装置之间的旋转矩阵和位移矩阵。

在一些实施方式中,该视觉传感器包括单目视觉装置和双目视觉装置中的任一项,若视觉传感器为单目视觉装置,则第一图像和第二图像间隔预设时间;若视觉传感器为双目视觉装置,则第一图像为双目视觉装置中的第一拍摄装置输出的图像,第二图像为双目视觉装置中的第二拍摄装置输出的图像。以下以视觉传感器为双目视觉装置为例进行解释说明。

示例性的,获取双目视觉装置中的第一拍摄装置的内参矩阵以及第一拍摄装置与tof测距装置之间的旋转矩阵和位移矩阵;根据第一拍摄装置的内参矩阵以及第一拍摄装置与tof测距装置之间的旋转矩阵和位移矩阵,确定目标对象的中心空间点在第一拍摄装置的视场角下的位置点;在第一拍摄装置的预设图像中标记该位置点,并根据第一距离确定目标对象上的多个空间点的三维位置坐标;根据多个空间点的三维位置坐标,将目标对象上的多个空间点投影到标记有该位置点的预设图像中,得到包含第一目标图像区域的第一图像。

类似的,获取双目视觉装置中的第二拍摄装置的内参矩阵以及第二拍摄装置与tof测距装置之间的旋转矩阵和位移矩阵;根据第二拍摄装置的内参矩阵以及第二拍摄装置与tof测距装置之间的旋转矩阵和位移矩阵,确定目标对象的中心空间点在第二拍摄装置的视场角下的位置点;在第二拍摄装置的预设图像中标记该位置点,并根据第一距离确定目标对象上的多个空间点的三维位置坐标;根据多个空间点的三维位置坐标,将目标对象上的多个空间点投影到标记有该位置点的预设图像中,得到包含第二目标图像区域的第二图像。

可以理解的是,可以提前根据第一拍摄装置的内参矩阵以及第一拍摄装置与tof测距装置之间的旋转矩阵和位移矩阵,确定目标对象的中心空间点在第一拍摄装置的视场角下的位置点,并在第一拍摄装置的预设图像中标记该位置点,得到第一标记图像,类似的,提前根据第二拍摄装置的内参矩阵以及第二拍摄装置与tof测距装置之间的旋转矩阵和位移矩阵,确定目标对象的中心空间点在第二拍摄装置的视场角下的位置点,并在第二拍摄装置的预设图像中标记该位置点,得到第二标记图像,然后将第一标记图像和第二标记图像存储在可移动平台的存储器中,在后续测量目标对象与可移动平台之间的距离时,可以直接获取第一标记图像和第二标记图像,不需要实时的确定,减少可移动平台的计算量。

在一些实施方式中,根据第一距离确定目标对象上的多个空间点的三维位置坐标的方式具体为:获取tof测距装置的光源的有效视场角,并根据光源的有效视场角和第一距离,确定目标对象上的多个空间点相对于tof测距装置的三维位置坐标。其中,tof测距装置的光源的有效视场角是根据tof测距装置的光源发射口的口径确定,光源发射的光信号通过该光源发射口向外部发射,光源发射口的口径越大,则光源的有效视场角越大,而光源发射口的口径越小,则光源的有效视场角越小,例如,光源的有效视场角为10°。

如图图1和3所示,tof测距装置120的发射装置121发射的光信号照射到物体对象q上形成圆形的光斑区域,即目标对象p,tof测距装置120的接收装置122接收由目标对象反射的光信号,根据第一拍摄装置111与tof测距装置之间的安装位置关系、内参矩阵以及第一距离,可以确定目标对象投影在第一图像10中的理论区域p1,根据第二拍摄装置112与tof测距装置之间的安装位置关系、内参矩阵以及第一距离,可以确定目标对象投影在第二图像20中的理论区域p2。可以理解的是,光斑区域的形状可以是圆形、椭圆形或者矩形,本申请对此不作具体限定。

步骤s103、根据所述第一图像和第二图像,确定所述可移动平台与所述目标对象上的多个空间点之间的第二距离。

在获取到视觉传感器输出的目标对象的第一图像和第二图像之后,可以根据第一图像和第二图像,确定可移动平台与目标对象上的多个空间点之间的深度值,也即可移动平台与目标对象上的多个空间点之间的第二距离。

在一实施例中,如图4所示,步骤s103具体包括:子步骤s1031至s1032。

s1031、从所述第一图像和第二图像中确定所述目标对象上的多个空间点分别对应的特征点匹配对。

具体地,基于预设特征点提取算法从第一图像中提取目标对象上的多个空间点对应的第一特征点;基于预设特征点跟踪算法从第二图像中确定与第一特征点匹配的第二特征点,得到目标对象上的多个空间点分别对应的特征点匹配对;或者,也可以基于预设特征点提取算法从第二图像中提取目标对象上的多个空间点对应的第一特征点;基于预设特征点跟踪算法从第一图像中确定与第一特征点匹配的第二特征点,得到目标对象上的多个空间点分别对应的特征点匹配对。

其中,预设特征点提取算法包括如下至少一种:角点检测算法(harriscornerdetection)、尺度不变特征变换(scale-invariantfeaturetransform,sift)算法、尺度和旋转不变特征变换(speeded-uprobustfeatures,surf)算法、fast(featuresfromacceleratedsegmenttest)特征点检测算法,预设特征点跟踪算法包括但不限于klt(kanade–lucas–tomasifeaturetracker)算法。

在一些实施方式中,确定目标对象在第一图像中的第一目标图像区域和在第二图像中的第二目标图像区域;从第一目标图像区域和第二目标图像区域中确定目标对象上的多个空间点分别对应的特征点匹配对。通过先确定目标对象在第一图像中的第一目标图像区域和在第二图像中的第二目标图像区域,再从第一目标图像区域和第二目标图像区域中确定目标对象上的多个空间点分别对应的特征点匹配对,可以减少计算量,提高处理速度。

其中,第一目标图像区域在第一图像中的位置和第二目标图像区域在第二图像中的位置根据视觉传感器和tof测距装置之间的安装位置关系和第一距离确定,根据视觉传感器和tof测距装置之间的安装位置关系,可以确定视觉传感器与tof测距装置之间的旋转矩阵和位移矩阵。通过视觉传感器和tof测距装置之间的安装位置关系和第一距离可以准确的确定目标对象在第一图像中的第一目标图像区域和在第二图像中的第二目标图像区域。

在一些实施方式中,确定目标对象在第一图像中的第一目标图像区域和在第二图像中的第二目标图像区域的方式具体为:根据第一距离确定目标对象的三维位置坐标,即获取tof测距装置的光源的有效视场角,并根据光源的有效视场角和第一距离,确定目标对象上的多个空间点相对于tof测距装置的三维位置坐标;根据三维位置坐标,将目标对象投影到第一图像和第二图像中以确定第一目标图像区域和第二目标图像区域。通过tof测距装置确定的第一距离和光源的有效视场角可以确定目标对象上的多个空间点的三维位置坐标,再基于三维位置坐标,可以将目标对象投影到第一图像和第二图像中,从而可以准确的第一目标图像区域和第二目标图像区域。

在一些实施方式中,若视觉传感器为双目视觉装置,则根据目标对象的三维位置坐标,将目标对象投影到第一图像中以确定第一目标图像区域的方式具体为:获取双目视觉装置中的第一拍摄装置的内参矩阵以及第一拍摄装置与tof测距装置之间的旋转矩阵和位移矩阵;根据第一拍摄装置的内参矩阵、第一拍摄装置与tof测距装置之间的旋转矩阵和位移矩阵以及目标对象上的多个空间点的三维位置坐标,确定目标对象上的多个空间点在第一相机坐标系下的二维位置坐标;根据目标对象上的多个空间点在第一相机坐标系下的二维位置坐标,在第一图像中标记多个空间点对应的像素点,标记的多个空间点对应的像素点合围形成的外接圆所在的区域为第一目标图像区域。

类似的,若视觉传感器为双目视觉装置,则根据目标对象的三维位置坐标,将目标对象投影到第二图像中以确定第二目标图像区域的方式具体为:获取双目视觉装置中的第二拍摄装置的内参矩阵以及第二拍摄装置与tof测距装置之间的旋转矩阵和位移矩阵;根据第二拍摄装置的内参矩阵、第二拍摄装置与tof测距装置之间的旋转矩阵和位移矩阵以及目标对象上的多个空间点的三维位置坐标,确定目标对象上的多个空间点在第二相机坐标系下的二维位置坐标;根据目标对象上的多个空间点在第二相机坐标系下的二维位置坐标,在第二图像中标记多个空间点对应的像素点,标记的多个空间点对应的像素点合围形成的外接圆所在的区域为第二目标图像区域。

s1032、根据多个所述特征点匹配对,确定所述可移动平台与所述多个空间点之间的第二距离。

通过目标对象上的多个空间点分别对应的特征点匹配对,可以确定可移动平台与目标对象上的多个空间点之间的第二距离。以下以视觉传感器为双目视觉装置为例解释说明基于多个特征点匹配对,确定可移动平台与多个空间点之间的第二距离的过程。

具体地,根据每个特征点匹配对内的两个特征点的像素,确定每个特征点匹配对各自对应的像素差;获取双目视觉装置的预设焦距和预设双目距离;根据预设焦距、预设双目距离以及每个特征点匹配对各自对应的像素差,确定可移动平台与多个空间点之间的第二距离。其中,预设焦距为通过标定双目视觉装置的焦距确定的,预设双目距离是根据双目视觉装置中第一拍摄装置与第二拍摄装置的安装位置确定的。

步骤s104、根据多个所述第二距离和所述第一距离确定所述可移动平台与所述目标对象之间的目标距离。

在确定第一距离以及多个第二距离之后,可以通过第一距离和多个第二距离确定可移动平台与目标对象之间的目标距离。由于综合考虑了tof测距装置与视觉传感器的距离测量结果,因此可以准确的测量可移动平台与物体之间的距离。

在一实施方式中,如图5所示,步骤s104具体包括:子步骤s1041至s1042。

s1041、根据多个所述第二距离和所述第一距离确定所述第一距离的可信指数。

在确定第一距离以及多个第二距离之后,可以通过第一距离和多个第二距离确定第一距离的可信指数。其中,可信指数用于表征通过tof测距装置采集到的可移动平台与目标对象之间的第一距离的准确度,可信指数越大,则表示测量得到的第一距离的准确度越高,而可信指数越小,则表示测量得到的第一距离的准确度越低。

在一些实施方式中,根据多个第二距离和第一距离,从多个空间点中确定目标空间点,其中,目标空间点对应的第二距离与第一距离之间的差值小于或等于预设阈值;根据目标空间点确定第一距离的可信指数。其中,预设阈值可以基于实际情况进行设置,本申请对此不作具体限定,例如,预设阈值为0.5米。通过从多个空间点中获取第二距离与第一距离之间的差值小于或等于预设阈值的空间点作为目标空间点,并基于目标空间点可以准确且快速的确定第一距离的可信指数。

在一些实施方式中,根据目标空间点确定第一距离的可信指数的方式具体为:根据目标空间点的数量和空间点的数量确定第一距离的可信指数,即统计多个空间点中第二距离与第一距离之间的差值小于或等于预设阈值的空间点,即目标空间点的第一数量,并统计空间点的第二数量,然后计算第一数量占第二数量的百分比,并将第一数量占第二数量的百分比作为第一距离的可信指数。例如,设目标空间点的数量为75个,空间点的数量为100个,则第一数量占第二数量的百分比为75%,因此第一距离的可信指数为75%。

在一些实施方式中,根据目标空间点确定第一距离的可信指数的方式具体为:根据目标空间点在第一图像的对应特征点的像素坐标和像素值,确定第一权重值;根据空间点在第一图像或者第二图像中的对应特征点的像素坐标和像素值,确定第二权重值;根据第一权重值和第二权重值确定第一距离的可信指数,即计算第一权重值占第二权重值的百分比,并将第一权重值占第二权重值的百分比作为第一距离的可信指数。例如,设第一权重值为0.5,第二权重值为0.7,则第一权重值占第二权重值的百分比71.4%,因此,第一距离的可信指数为71.4%。

可以理解的是,若目标空间点为多个,则第一权重值的确定方式具体为:根据每个目标空间点在第一图像的对应特征点的像素坐标和像素值,确定每个目标空间点的权重值,并累加每个目标空间点的权重值,得到第一权重值;类似的,第二权重值的确定方式具体为:根据每个空间点在第一图像或者第二图像中的对应特征点的像素坐标和像素值,确定每个空间点的权重值,并累加每个空间点的权重值,得到第二权重值。

在一些实施方式中,根据目标空间点在第一图像或者第二图像中的对应特征点的像素坐标和像素值,确定第一权重值的方式具体为:确定目标对象在第一图像中的第一目标图像区域或者在第二图像中的第二目标图像区域;根据目标空间点在第一目标图像区域或者第二目标图像区域中的对应特征点的像素坐标和像素值,确定第一权重值。类似的,确定目标对象在第一图像中的第一目标图像区域或者在第二图像中的第二目标图像区域;根据空间点在第一目标图像区域或者第二目标图像区域中的对应特征点的像素坐标和像素值,确定第二权重值。使用第一目标图像区域或者第二目标图像区域中的特征点参与第一权重值或者第二权重值的计算,可以减少计算量,提高处理速度。

在一些实施方式中,目标空间点或者空间点的权重值的确定方式具体为:将目标空间点或者空间点在第一图像或者第二图像中的对应特征点的像素坐标和像素值代入权重值计算公式,得到目标空间点或者空间点的权重值。

其中,权重值计算公式为i为目标空间点或者空间点在第一图像或者第二图像中的对应特征点的像素值,(ux,vx)为目标空间点或者空间点在第一图像或者第二图像中的对应特征点的像素坐标,(u0,v0)为目标对象的中心空间点在第一图像或者第二图像中的对应特征点的像素坐标,e是自然数,σ是预设系数,σ根据经验确定。

示例性的,记包含目标空间点的集合为p,记包括空间点的集合为p′,则第一距离的可信指数可以根据如下公式计算得到:

其中,xi为集合p中的目标空间点,xj为集合p′中的空间点,为集合p中的第i个目标空间点在第一图像或者第二图像中的对应特征点的像素坐标,ii为集合p中的第i个目标空间点在第一图像或者第二图像中的对应特征点的像素值,m为集合p中的目标空间点的数量,为集合p′中的第j个空间点在第一图像或者第二图像中的对应特征点的像素坐标,ij为集合p′中的第j个空间点在第一图像或者第二图像中的对应特征点的像素值,n为集合p′中的空间点的数量,且n大于m,(u0,v0)为目标对象的中心空间点在第一图像或者第二图像中的对应特征点的像素坐标,e是自然数,σ是预设系数,σ根据经验确定。

可以理解的是,通过可以计算得到第一权重值,通过可以计算得到第二权重值。

s1042、根据所述可信指数、多个所述第二距离和所述第一距离确定所述可移动平台与所述目标对象之间的目标距离。

在确定第一距离的可信指数后,确定该可信指数是否大于预设可信指数;若该可信指数大于预设可信指数,则对多个第二距离和第一距离进行融合处理,以确定可移动平台与目标对象之间的目标距离。其中,预设可信指数可以根据实际情况进行设置,本申请对此不作具体限定,例如,预设可信指数为75%。通过对多个第二距离和第一距离进行融合处理来确定可移动平台与目标对象之间的目标距离,可以极大的提高可移动平台与物体之间的距离的准确性。

在一些实施方式中,对多个第二距离和第一距离进行融合处理的方式具体为:根据多个第二距离,确定第三距离,并获取第一距离的第一权重系数和第三距离的第二权重系数;计算第一距离与第一权重系数的乘积以及计算第三距离与第二权重系数的乘积,并将第一距离与第一权重系数的乘积和第三距离与第二权重系数的乘积进行累加,得到可移动平台与目标对象之间的目标距离。其中,第一权重系数与第二权重系数之和为1,第一权重系数与第二权重系数可以根据实际情况进行设置,例如,第一权重系数为0.5,第二权重系数为0.5。

在一些实施方式中,根据多个第二距离,确定第三距离的方式具体为:从多个第二距离中选择任一个第二距离作为第三距离,或者根据多个第二距离,计算第二距离的平均值,并将第二距离的平均值作为第三距离,或者从多个第二距离中选择最小的第二距离和最大的第二距离,并确定最小的第二距离和最大的第二距离的平均值,将最小的第二距离和最大的第二距离的平均值作为第三距离。

在一些实施方式中,若可信指数小于或等于预设可信指数,则根据多个第二距离确定可移动平台与目标对象之间的目标距离,即从多个第二距离中选择任一个第二距离作为可移动平台与目标对象之间的目标距离,或者根据多个第二距离,计算第二距离的平均值,并将第二距离的平均值作为可移动平台与目标对象之间的目标距离,或者从多个第二距离中选择最小的第二距离和最大的第二距离,并确定最小的第二距离和最大的第二距离的平均值,将最小的第二距离和最大的第二距离的平均值作为可移动平台与目标对象之间的目标距离。

本申请说明书提供的距离确定方法,通过tof测距装置确定可移动平台与目标对象之间的第一距离,并通过视觉传感器输出的目标对象的第一图像和第二图像,确定可移动平台与目标对象上的多个空间点之间的第二距离,然后根据多个第二距离和第一距离确定可移动平台与目标对象之间的目标距离。由于综合考虑了tof测距装置与视觉传感器的距离测量结果,因此可以准确的测量可移动平台与物体之间的距离。

请参阅图6,图6是本申请一实施例提供的可移动平台的示意性框图。该可移动平台200包括处理器201、存储器202、视觉传感器203和tof测距装置204,处理器201、存储器202、视觉传感器203和tof测距装置204通过总线205连接,该总线205比如为i2c(inter-integratedcircuit)总线。其中,可移动平台200包括无人机、可移动机器人和云台车等,无人机可以为旋翼型无人机,例如四旋翼无人机、六旋翼无人机、八旋翼无人机,也可以是固定翼无人机,还可以是旋翼型与固定翼无人机的组合,在此不作限定。

具体地,处理器201可以是微控制单元(micro-controllerunit,mcu)、中央处理单元(centralprocessingunit,cpu)或数字信号处理器(digitalsignalprocessor,dsp)等。

具体地,存储器202可以是flash芯片、只读存储器(rom,read-onlymemory)磁盘、光盘、u盘或移动硬盘等。

具体地,tof测距装置204包括用于发射光信号的发射装置和用于接收由目标对象反射的光信号的接收装置。

其中,所述处理器201用于运行存储在存储器202中的计算机程序,并在执行所述计算机程序时实现如下步骤:

获取所述tof测距装置采集到的所述可移动平台与所述目标对象之间的第一距离;

获取所述视觉传感器输出的所述目标对象的第一图像和第二图像;

根据所述第一图像和第二图像,确定所述可移动平台与所述目标对象上的多个空间点之间的第二距离;

根据多个所述第二距离和所述第一距离确定所述可移动平台与所述目标对象之间的目标距离。

可选地,所述处理器201实现根据多个所述第二距离和所述第一距离确定所述可移动平台与所述目标对象之间的目标距离时,用于实现:

根据多个所述第二距离和所述第一距离确定所述第一距离的可信指数;

根据所述可信指数、多个所述第二距离和所述第一距离确定所述可移动平台与所述目标对象之间的目标距离。

可选地,所述处理器201实现根据多个所述第二距离和所述第一距离确定所述第一距离的可信指数时,用于实现:

根据多个所述第二距离和所述第一距离,从所述多个空间点中确定目标空间点,其中,所述目标空间点对应的所述第二距离与所述第一距离之间的差值小于或等于预设阈值;

根据所述目标空间点确定所述第一距离的可信指数。

可选地,所述处理器201实现根据所述目标空间点确定所述第一距离的可信指数时,用于实现:

根据所述目标空间点的数量和所述空间点的数量确定所述第一距离的可信指数。

可选地,所述处理器201实现根据所述目标空间点确定所述第一距离的可信指数时,用于实现:

根据所述目标空间点在所述第一图像或者第二图像中的对应特征点的像素坐标和像素值,确定第一权重值;

根据所述空间点在所述第一图像或者第二图像中的对应特征点的像素坐标和像素值,确定第二权重值;

根据所述第一权重值和所述第二权重值确定第一距离的可信指数。

可选地,所述处理器201实现根据所述目标空间点在所述第一图像或者第二图像中的对应特征点的像素坐标和像素值,确定第一权重值时,用于实现:

确定所述目标对象在所述第一图像中的第一目标图像区域或者在所述第二图像中的第二目标图像区域;

根据所述目标空间点在所述第一目标图像区域或者第二目标图像区域中的对应特征点的像素坐标和像素值,确定第一权重值。

可选地,所述处理器201实现根据所述可信指数、多个所述第二距离和所述第一距离确定所述可移动平台与所述目标对象之间的目标距离时,用于实现:

确定所述可信指数是否大于预设可信指数;

若所述可信指数大于预设可信指数,则对多个所述第二距离和所述第一距离进行融合处理,以确定所述可移动平台与所述目标对象之间的目标距离。

可选地,所述处理器201实现确定所述可信指数是否大于预设可信指数之后,还用于实现:

若所述可信指数小于或等于预设可信指数,则根据多个所述第二距离确定所述可移动平台与所述目标对象之间的目标距离。

可选地,所述处理器201实现根据所述第一图像和第二图像,确定所述可移动平台与所述目标对象上的多个空间点之间的第二距离时,用于实现:

从所述第一图像和第二图像中确定所述目标对象上的多个空间点分别对应的特征点匹配对;

根据多个所述特征点匹配对,确定所述可移动平台与所述多个空间点之间的第二距离。

可选地,所述处理器201实现从所述第一图像和第二图像中确定所述目标对象上的多个空间点分别对应的特征点匹配对时,用于实现:

确定所述目标对象在所述第一图像中的第一目标图像区域和在所述第二图像中的第二目标图像区域;

从所述第一目标图像区域和所述第二目标图像区域中确定所述目标对象上的多个空间点分别对应的特征点匹配对。

可选地,所述第一目标图像区域在所述第一图像中的位置和所述第二目标图像区域在所述第二图像中的位置根据所述视觉传感器和所述tof测距装置之间的安装位置关系和所述第一距离确定。

可选地,所述处理器201实现确定所述目标对象在所述第一图像中的第一目标图像区域和在所述第二图像中的第二目标图像区域时,用于实现:

根据所述第一距离确定所述目标对象的三维位置坐标;

根据所述三维位置坐标,将所述目标对象投影到所述第一图像和第二图像中以确定所述第一目标图像区域和所述第二目标图像区域。

可选地,所述视觉传感器203包括单目视觉装置和双目视觉装置中的任一项。

可选地,若所述视觉传感器203为单目视觉装置,则所述第一图像和所述第二图像间隔预设时间;

若所述视觉传感器为双目视觉装置,则所述第一图像为所述双目视觉装置中的第一拍摄装置输出的图像,所述第二图像为所述双目视觉装置中的第二拍摄装置输出的图像。

需要说明的是,所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,上述描述的可移动平台的具体工作过程,可以参考前述距离确定方法实施例中的对应过程,在此不再赘述。

本申请的实施例中还提供一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序中包括程序指令,所述处理器执行所述程序指令,实现上述实施例提供的距离确定方法的步骤。

其中,所述计算机可读存储介质可以是前述任一实施例所述的可移动平台的内部存储单元,例如所述可移动平台的硬盘或内存。所述计算机可读存储介质也可以是所述可移动平台的外部存储设备,例如所述可移动平台上配备的插接式硬盘,智能存储卡(smartmediacard,smc),安全数字(securedigital,sd)卡,闪存卡(flashcard)等。

应当理解,在此本申请说明书中所使用的术语仅仅是出于描述特定实施例的目的而并不意在限制本申请。如在本申请说明书和所附权利要求书中所使用的那样,除非上下文清楚地指明其它情况,否则单数形式的“一”、“一个”及“该”意在包括复数形式。

还应当理解,在本申请说明书和所附权利要求书中使用的术语“和/或”是指相关联列出的项中的一个或多个的任何组合以及所有可能组合,并且包括这些组合。

以上所述,仅为本申请的具体实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应以权利要求的保护范围为准。

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