CN115420275A - 回环路径的预测方法及装置、非易失性存储介质、处理器 - Google Patents

回环路径的预测方法及装置、非易失性存储介质、处理器 Download PDF

Info

Publication number
CN115420275A
CN115420275A CN202211007262.1A CN202211007262A CN115420275A CN 115420275 A CN115420275 A CN 115420275A CN 202211007262 A CN202211007262 A CN 202211007262A CN 115420275 A CN115420275 A CN 115420275A
Authority
CN
China
Prior art keywords
loop
path
scanning
predicting
back path
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
Application number
CN202211007262.1A
Other languages
English (en)
Inventor
华昀峰
江腾飞
许威威
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shining 3D Technology Co Ltd
Original Assignee
Shining 3D Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shining 3D Technology Co Ltd filed Critical Shining 3D Technology Co Ltd
Priority to CN202211007262.1A priority Critical patent/CN115420275A/zh
Publication of CN115420275A publication Critical patent/CN115420275A/zh
Priority to PCT/CN2023/113875 priority patent/WO2024041464A1/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)

Abstract

本申请公开了一种回环路径的预测方法及装置、非易失性存储介质、处理器。其中,该方法包括:在进行即时定位与地图构建的过程中,检测扫描设备的扫描移动轨迹在预设时长内是否未第二次经过扫描路径上的起始位置;在检测到扫描设备的扫描移动轨迹在预设时长内未第二次经过起始位置的情况下,预测回环路径。本申请解决了由于没有回环路径预测以及回环提醒功能造成的即时定位与地图构建的结果不准确的技术问题。

Description

回环路径的预测方法及装置、非易失性存储介质、处理器
技术领域
本申请涉及回环检测技术领域,具体而言,涉及一种回环路径的预测方法及装置、非易失性存储介质、处理器。
背景技术
在进行即时定位与地图构建的过程中,当前帧位姿的约束是根据上一帧计算出来的,由于计算的位姿存在误差,在建图的过程中随着误差不断累积导致构建的地图容易出现漂移,因此需要通过回环检测判断扫描仪在建图过程中是否再次经过同一位置,若经过同一位置则进行回环矫正,以减小建图的偏差。但是,用户在实际应用中不会有意的去回环扫描,如果无法完成回环扫描,则会导致即时定位与地图构建的结果不准确。
针对上述的问题,目前尚未提出有效的解决方案。
发明内容
本申请实施例提供了一种回环路径的预测方法及装置、非易失性存储介质、处理器,以至少解决由于没有回环路径预测以及回环提醒功能造成的即时定位与地图构建的结果不准确的技术问题。
根据本申请实施例的一个方面,提供了一种回环路径的预测方法,包括:在进行即时定位与地图构建的过程中,检测扫描设备的扫描移动轨迹在预设时长内是否未第二次经过扫描路径上的起始位置;在检测到扫描设备的扫描移动轨迹在预设时长内未第二次经过起始位置的情况下,预测回环路径。
可选地,在检测到扫描设备的扫描移动轨迹在预设时长内未第二次经过起始位置的情况下,生成提示信息。
可选地,预测回环路径,包括:预测第一回环路径和/或第二回环路径,其中,第一回环路径为全局回环路径,第二回环路径为局部回环路径。
可选地,预测第一回环路径,包括:获取当前帧对应的扫描设备的第一位置,并将第一位置作为第一回环路径的第一端点,其中,当前帧为扫描设备在扫描过程中生成提示信息时对应的帧;获取起始位置,并将起始位置作为第一回环路径的第二端点;根据第一回环路径的第一端点和第二端点,生成第一回环路径。
可选地,预测第二回环路径,包括:将第一位置作为第二回环路径的第一端点;获取与第一位置之间的距离为目标距离的第二位置,并将第二位置作为第二回环路径的第二端点;根据第二回环路径的第一端点和第二端点,生成第二回环路径。
可选地,第二位置不在目标路径上,其中,目标路径为扫描设备至少一次经过目标位置的路径,目标位置为除起始位置及与起始位置之间的距离为目标距离的位置以外的位置。
可选地,在进行即时定位与地图构建的过程中,如果检测到生成局部回环路径,将检测到的局部回环路径内的所有帧标记为回环帧;在扫描设备结束扫描时,如果检测到存在除回环帧以外的帧,生成提示信息。
可选地,预测回环路径之后,上述方法还包括:展示回环路径;和/或,控制扫描设备按照回环路径移动。
根据本申请实施例的另一方面,还提供了一种回环路径的预测装置,包括:检测模块,用于在进行即时定位与地图构建的过程中,检测扫描设备的扫描移动轨迹在预设时长内是否未第二次经过扫描路径上的起始位置;预测模块,用于在检测到扫描设备的扫描移动轨迹在预设时长内未第二次经过起始位置的情况下,预测回环路径。
根据本申请实施例的再一方面,还提供了一种非易失性存储介质,存储介质包括存储的程序,其中,程序运行时控制存储介质所在的设备执行以上的回环路径的预测方法。
根据本申请实施例的再一方面,还提供了一种处理器,处理器用于运行存储在存储器中的程序,其中,程序运行时执行以上的回环路径的预测方法。
在本申请实施例中,采用在进行即时定位与地图构建的过程中,检测扫描设备的扫描移动轨迹在预设时长内是否未第二次经过扫描路径上的起始位置;在检测到扫描设备的扫描移动轨迹在预设时长内未第二次经过起始位置的情况下,预测回环路径的方式,通过预测回环路径与生成提示信息,达到了提示用户完成回环检测的目的,从而实现了获取更加精准的即时定位与地图构建结果的技术效果,进而解决了由于没有回环路径预测以及回环提醒功能造成的即时定位与地图构建的结果不准确技术问题。
附图说明
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:
图1是根据本申请实施例的一种回环路径的预测方法的流程图;
图2是根据本申请实施例的一种有无回环优化的区别的示意图;
图3是根据本申请实施例的一种全局回环和局部回环的结构图;
图4是根据本申请实施例的一种全局回环路径和局部回环路径的示意图;
图5是根据本申请实施例的一种回环路径的预测装置的结构图。
具体实施方式
为了使本技术领域的人员更好地理解本申请方案,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分的实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本申请保护的范围。
需要说明的是,本申请的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本申请的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
根据本申请实施例,提供了一种回环路径的展示方法的实施例,需要说明的是,在附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机系统中执行,并且,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。
图1是根据本申请实施例的一种回环路径的预测方法的流程图,该方法包括如下步骤:
步骤S102,在进行即时定位与地图构建的过程中,检测扫描设备的扫描移动轨迹在预设时长内是否未第二次经过扫描路径上的起始位置。
根据本申请的一个可选的实施例,即时定位与地图构建是一种概念:希望机器人和/或扫描仪从未知环境的未知地点出发,在运动过程中通过重复观测到的地图特征(比如,墙角,柱子等)定位自身位置和姿态,再根据自身位置增量式的构建地图,从而达到同时定位和地图构建的目的。检测扫描设备是否第二次经过扫描路径上的起始位置即为定位与地图构建的过程中的回环检测。回环检测判断机器人和/或扫描仪是否回到了先前经过的位置,如果检测到回环,它会把信息传递给后端进行优化处理。在视觉同步定位与地图构建中,位姿的估计往往是一个递推的过程,即由上一帧位姿解算当前帧位姿,因此其中的误差便这样一帧一帧的传递下去,也就是我们所说的累积误差。一个消除误差有效的办法是进行回环检测。回环是一个比后端更加紧凑、准确的约束,这一约束条件可以形成一个拓扑一致的轨迹地图。如果能够检测到闭环,并对其优化,就可以让结果更加准确。
回环检测包括但不限于以下方法:
1.通过图片检测回环:现有的同步定位与地图构建系统中比较流行的回环检测方法是特征点结合词袋的方法(如ORB-SLAM,VINS-Mono)。基于词袋的方法是预先加载一个词袋字典树,通知这个预加载的字典树将图像中的每一局部特征点的描述子转换为一个单词,字典里包含着所有的单词,通过对整张图像的单词统计一个词袋向量,词袋向量间的距离即代表了两张图像之间的差异性。在图像检索的过程中,会利用倒排索引的方法,先找出与当前帧拥有相同单词的关键帧,并根据它们的词袋向量计算与当前帧的相似度,剔除相似度不够高的图像帧,将剩下的关键帧作为候选关键帧,按照词袋向量距离由近到远排序。视觉特征描述子与环境外观高度相关。外观受光照影响很大,且随时间变化,因此视觉特征地图往往具有较短的时效。
2.激光同步定位与地图构建(激光slam),针对点云做回环检测:首先使用ScanContext/LiDAR Iris进行回环帧检测,确定历史帧中的回环帧后,将回环帧与当前点云帧进行点云配准,获取回环精确位姿。回环检测的本质是利用当前点云和历史点云做相似度检测,如果历史中有对应的点云相似度较高,我们就把这个历史帧确定为回环帧,用当前点云和历史帧去做配准得到精确位姿;由于累计误差的存在,激光里程计连续下来求得本时刻与那个历史时刻的位姿存在一定的偏差,而回环检测没有累计误差。
3.用全球定位系统辅助检测回环:根据全球定位系统提供的信息,判断当前位置与之前帧i的位置之间的距离,如果距离小于设置的阈值,就将当前帧与第i帧做相似度检测,如果相似度大于一定阈值,就把第i帧确定为回环帧。
作为本申请的另一个可选的实施例,扫描仪为手持扫描仪,在利用手持扫描仪进行即时定位与地图构建的过程中,同样有必要进行回环检测,并在未检测到回环时预测回环路径并生成相关提示信息。用户在利用手持扫描仪在大场景中(如地下停车场、马路、楼梯间、房间、一整栋建筑物,一个小区等百米数量级的场景)进行扫描时,扫描的过程中手持扫描仪会产生很多数量的帧,依据这些很多数量的帧可以重建上述大场景的三维模型。在利用手持扫描仪进行即时定位与地图构建的过程中,用户可以在手持扫描仪中添加全球定位装置,也可以利用用户手机或者车辆中安装的全球定位系统,与手持扫描仪进行信号传输。用户可以通过走路或者车辆在大场景中移动。
其中,手持扫描仪内可以包括相机、惯导、全球定位装置以及一系列传感器元件,在手持扫描仪使用之前可以进行标定。
步骤S104,在检测到扫描设备的扫描移动轨迹在预设时长内未第二次经过起始位置的情况下,预测回环路径。
根据本申请的另一个可选的实施例,进行即时定位与地图构建的过程中,如果场所较大,回环检测可以显著提高重建的质量。所以用户在使用激光雷达扫描仪扫描时,如果工作时长超过预设时长,检测到还没有完成回环,就有必要预测回环的路径。在预设时长内没有检测到扫描设备第二次经过起始位置时,即预设时长内没有检测到扫描设备完成回环时,会对回环路径进行预测。
根据上述步骤,通过预测回环路径与生成提示信息,达到了提示用户完成回环检测的目的,从而实现了获取更加精准的即时定位与地图构建结果的技术效果,进而解决了由于没有回环路径预测以及回环提醒功能造成的即时定位与地图构建的结果不准确技术问题。
在本申请的一些可选的实施例,在检测到扫描设备的扫描移动轨迹在预设时长内未第二次经过起始位置的情况下,生成提示信息。
作为本申请的另一个可选的实施例,如果发现扫描时间超过预设时长后,没有检测到任何回环,会提示用户:如果想要较高的重建精度,需要形成回环。如果发现形成局部回环,将回环内的所有帧标记为回环帧。用户在最后结束扫描时还发现存在没有形成回环的帧,就提示用户:有部分区域没有形成回环,是否结束扫描?
根据本申请的一个可选的实施例,预测回环路径,包括以下步骤:预测第一回环路径和/或第二回环路径,其中,第一回环路径为全局回环路径,第二回环路径为局部回环路径。
根据本申请的另一个可选的实施例,全局回环为扫描仪第二次经过起始位置所形成的回环,局部回环为扫描仪形成回环但是该回环不是第二次经过起始位置所形成的回环。本申请可以预测并指导用户按照可以形成全局回环的全局回环路径或者可以形成局部回环的局部回环路径完成回环。
在本申请的一些可选的实施例,预测第一回环路径,可以通过以下方法实现:获取当前帧对应的扫描设备的第一位置,并将第一位置作为第一回环路径的第一端点,其中,当前帧为扫描设备在扫描过程中生成提示信息时对应的帧;获取起始位置,并将起始位置作为第一回环路径的第二端点;根据第一回环路径的第一端点和第二端点,生成第一回环路径。
作为本申请的一个可选的实施例,用户收到提醒信息时所生成的帧为当前帧,将当前帧作为全局回环路径的起点;用户起始位置所在的帧,也即最早的帧(没有被标记为回环帧的帧)作为全局回环路径的终点。根据全局回环路径的起点和全局回环路径的终点,生成一条可行的路径供用户选择。
在本申请的一些可选的实施例中,预测第二回环路径,通过以下方法实现:将第一位置作为第二回环路径的第一端点,获取与第一位置之间的距离为目标距离的第二位置,并将第二位置作为第二回环路径的第二端点;根据第二回环路径的第一端点和第二端点,生成第二回环路径。
作为本申请的另一个可选的实施例,用户收到提醒信息时所生成的帧为当前帧,将当前帧作为局部回环路径的起点;根据用户所在的当前位置,获取与当前帧为设定距离的先前帧,该先前帧与当前帧的时间差同样也大于设定阈值,且该先前帧没有被标记为回环帧,将该先前帧作为局部回环路径的终点。根据局部回环路径的起点和局部回环路径的终点,生成一条可行的路径供用户选择。
根据本申请的一个可选的实施例,第二位置不在目标路径上,其中,目标路径为扫描设备至少一次经过目标位置的路径,目标位置为除起始位置及与起始位置之间的距离为目标距离的位置以外的位置。
作为本申请的一个可选的实施例,预测的局部回环路径的终点应为不是起始位置或起始位置的附近位置,而且预测的局部回环路径的终点应为没有形成过局部回环的帧,也即没有被标记为回环帧的帧所在的位置。满足以上条件才会预测出一条可行的局部回环路径供用户选择。
在本申请的一些可选的实施例中,定位与地图构建的过程中,如果检测到生成局部回环路径,将检测到的局部回环路径内的所有帧标记为回环帧;在扫描设备结束扫描时,如果检测到存在除回环帧以外的帧,生成提示信息。
作为本申请的另一个可选的实施例,在进行即时定位与地图构建的过程中,如果生成了局部回环,则会将局部回环内的所有帧标记为回环帧,当用户在最后结束扫描时还发现存在有没有形成回环的帧,也即形成了多个局部回环但是还没有生成全局回环,就会提示用户:有部分区域没有形成回环,是否结束扫描?当用户想要更加精准的即时定位与地图构建结果时,用户可以按照生成的回环预测路径完成回环。
图2是根据本申请实施例的一种有无回环优化的区别的示意图,如图2所示,回环检测的意义为:关系到估计的轨迹和地图在长时间下的正确性;能够提高当前数据与所有历史数据的关联,从而可以利用回环检测进行重定位。
图3是根据本申请实施例的一种全局回环和局部回环的结构图,如图3所示,回环可能是全局的,也可能是局部的,局部的回环对可以优化局部帧的位姿,但是不能优化没有形成回环的帧。全局回环为扫描仪第二次经过起始位置或起始位置附近的位置所形成的回环,局部回环为扫描仪第二次经过相同位置所形成的回环,但该相同位置不是起始位置或者起始位置附近的位置。
图4是根据本申请实施例的一种全局回环路径和局部回环路径的示意图,如图4所示,预测的回环路径分为全局回环路径和局部回环路径,其中b点表示扫描仪开始工作的起始位置,起始位置上的帧可以称为最早帧;a点表示与当前帧所在位置为设定距离的位置,a点上的帧没有被标记为回环帧,也即a点不在局部回环的路径上。其中,实线表示为当前的路径,虚线表示为预测的回环路径。
作为本申请的一个可选的实施例,执行步骤S104预测回环路径之后,还可以展示回环路径;和/或,控制扫描设备按照回环路径移动。
在本申请的一些可选的实施例,在显示界面展示预测出来的可行的回环路径,用户根据预测出来的可行的回环路径,可以选择是否进行回环以获得即时定位与地图构建的更准确和结果。
作为本申请的另一个可选的实施例,扫描仪可以安装于无人驾驶车辆或无人机上,自动在大场景中(如地下停车场、马路、楼梯间、房间、一整栋建筑物,一个小区等百米数量级的场景)移动。之前确定的回环路径会传输至无人驾驶车辆或无人机,无人驾驶车辆或无人机会根据之前确定的回环路径自动规划路径运行,从而使得扫描设备按照回环路径移动。
作为本申请的另一个可选的实施例,执行步骤S104预测回环路径之后,在展示回环路径的同时,控制扫描设备按照回环路径移动。
在本申请的一些可选的实施例中,执行步骤S104预测回环路径之后,扫描仪展示回环路径后,发送提示消息,当接受到用户反馈的确认消息后,控制扫描设备按照回环路径移动。
图5是根据本申请实施例的一种回环路径的预测装置的结构图,如图5所示,该装置包括:
检测模块50,用于在进行即时定位与地图构建的过程中,检测扫描设备的扫描移动轨迹在预设时长内是否未第二次经过扫描路径上的起始位置;
根据本申请的一个可选的实施例,即时定位与地图构建是一种概念:希望机器人从未知环境的未知地点出发,在运动过程中通过重复观测到的地图特征(比如,墙角,柱子等)定位自身位置和姿态,再根据自身位置增量式的构建地图,从而达到同时定位和地图构建的目的。检测扫描设备是否第二次经过扫描路径上的起始位置即为定位与地图构建的过程中的回环检测。回环检测判断机器人是否回到了先前经过的位置,如果检测到回环,它会把信息传递给后端进行优化处理。在视觉同步定位与地图构建中,位姿的估计往往是一个递推的过程,即由上一帧位姿解算当前帧位姿,因此其中的误差便这样一帧一帧的传递下去,也就是我们所说的累积误差。一个消除误差有效的办法是进行回环检测。回环是一个比后端更加紧凑、准确的约束,这一约束条件可以形成一个拓扑一致的轨迹地图。如果能够检测到闭环,并对其优化,就可以让结果更加准确。
回环检测包括但不限于以下方法:
1.通过图片检测回环:现有的同步定位与地图构建系统中比较流行的回环检测方法是特征点结合词袋的方法。基于词袋的方法是预先加载一个词袋字典树,通知这个预加载的字典树将图像中的每一局部特征点的描述子转换为一个单词,字典里包含着所有的单词,通过对整张图像的单词统计一个词袋向量,词袋向量间的距离即代表了两张图像之间的差异性。在图像检索的过程中,会利用倒排索引的方法,先找出与当前帧拥有相同单词的关键帧,并根据它们的词袋向量计算与当前帧的相似度,剔除相似度不够高的图像帧,将剩下的关键帧作为候选关键帧,按照词袋向量距离由近到远排序。视觉特征描述子与环境外观高度相关。外观受光照影响很大,且随时间变化,因此视觉特征地图往往具有较短的时效。
2.激光同步定位与地图构建,针对点云做回环检测:首先使用Scan Context/LiDAR Iris进行回环帧检测,确定历史帧中的回环帧后,将回环帧与当前点云帧进行点云配准,获取回环精确位姿。回环检测的本质是利用当前点云和历史点云做相似度检测,如果历史中有对应的点云相似度较高,我们就把这个历史帧确定为回环帧,用当前点云和历史帧去做配准得到精确位姿;由于累计误差的存在,激光里程计连续下来求得本时刻与那个历史时刻的位姿存在一定的偏差,而回环检测没有累计误差。
3.用全球定位系统辅助检测回环:根据全球定位系统提供的信息,判断当前位置与之前帧i的位置之间的距离,如果距离小于设置的阈值,就将当前帧与第i帧做相似度检测,如果相似度大于一定阈值,就把第i帧确定为回环帧。
预测模块52,用于在检测到扫描设备的扫描移动轨迹在预设时长内未第二次经过起始位置的情况下,预测回环路径;
根据本申请的一个可选的实施例,即时定位与地图构建是一种概念:希望机器人从未知环境的未知地点出发,在运动过程中通过重复观测到的地图特征(比如,墙角,柱子等)定位自身位置和姿态,再根据自身位置增量式的构建地图,从而达到同时定位和地图构建的目的。检测扫描设备是否第二次经过扫描路径上的起始位置即为定位与地图构建的过程中的回环检测。回环检测判断机器人是否回到了先前经过的位置,如果检测到回环,它会把信息传递给后端进行优化处理。在视觉同步定位与地图构建中,位姿的估计往往是一个递推的过程,即由上一帧位姿解算当前帧位姿,因此其中的误差便这样一帧一帧的传递下去,也就是我们所说的累积误差。一个消除误差有效的办法是进行回环检测。回环是一个比后端更加紧凑、准确的约束,这一约束条件可以形成一个拓扑一致的轨迹地图。如果能够检测到闭环,并对其优化,就可以让结果更加准确。
回环检测包括但不限于以下方法:
1.通过图片检测回环:现有的同步定位与地图构建系统中比较流行的回环检测方法是特征点结合词袋的方法。基于词袋的方法是预先加载一个词袋字典树,通知这个预加载的字典树将图像中的每一局部特征点的描述子转换为一个单词,字典里包含着所有的单词,通过对整张图像的单词统计一个词袋向量,词袋向量间的距离即代表了两张图像之间的差异性。在图像检索的过程中,会利用倒排索引的方法,先找出与当前帧拥有相同单词的关键帧,并根据它们的词袋向量计算与当前帧的相似度,剔除相似度不够高的图像帧,将剩下的关键帧作为候选关键帧,按照词袋向量距离由近到远排序。视觉特征描述子与环境外观高度相关。外观受光照影响很大,且随时间变化,因此视觉特征地图往往具有较短的时效。
2.激光同步定位与地图构建,针对点云做回环检测:首先使用Scan Context/LiDAR Iris进行回环帧检测,确定历史帧中的回环帧后,将回环帧与当前点云帧进行点云配准,获取回环精确位姿。回环检测的本质是利用当前点云和历史点云做相似度检测,如果历史中有对应的点云相似度较高,我们就把这个历史帧确定为回环帧,用当前点云和历史帧去做配准得到精确位姿;由于累计误差的存在,激光里程计连续下来求得本时刻与那个历史时刻的位姿存在一定的偏差,而回环检测没有累计误差。
3.用全球定位系统辅助检测回环:根据全球定位系统提供的信息,判断当前位置与之前帧i的位置之间的距离,如果距离小于设置的阈值,就将当前帧与第i帧做相似度检测,如果相似度大于一定阈值,就把第i帧确定为回环帧。
在本申请的一些可选的实施例,在显示界面展示预测出来的可行的回环路径,用户根据预测出来的可行的回环路径,可以选择是否进行回环以获得即时定位与地图构建的更准确和结果。
需要说明的是,图5所示实施例的优选实施方式可以参见图1所示实施例的相关描述,此处不再赘述。
本申请实施例还提供一种非易失性存储介质,非易失性存储介质包括存储的程序,其中,程序运行时控制存储介质所在的设备执行以上的回环路径的预测方法。
非易失性存储介质执行以下功能的程序:在进行即时定位与地图构建的过程中,检测扫描设备的扫描移动轨迹在预设时长内是否未第二次经过扫描路径上的起始位置;在检测到扫描设备的扫描移动轨迹在预设时长内未第二次经过起始位置的情况下,预测回环路径。
本申请实施例还提供了一种处理器,处理器用于运行存储在存储器中的程序,其中,程序运行时执行以上的回环路径的预测方法。
处理器用于运行执行以下功能的程序:在进行即时定位与地图构建的过程中,检测扫描设备的扫描移动轨迹在预设时长内是否未第二次经过扫描路径上的起始位置;在检测到扫描设备的扫描移动轨迹在预设时长内未第二次经过起始位置的情况下,预测回环路径。
上述本申请实施例序号仅仅为了描述,不代表实施例的优劣。
在本申请的上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述的部分,可以参见其他实施例的相关描述。
在本申请所提供的几个实施例中,应该理解到,所揭露的技术内容,可通过其它的方式实现。其中,以上所描述的装置实施例仅仅是示意性的,例如所述单元的划分,可以为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,单元或模块的间接耦合或通信连接,可以是电性或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本申请各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。
所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本申请的技术方案本质上或者说对相关技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可为个人计算机、服务器或者网络设备等)执行本申请各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、移动硬盘、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述仅是本申请的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本申请原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本申请的保护范围。

Claims (11)

1.一种回环路径的预测方法,其特征在于,包括:
在进行即时定位与地图构建的过程中,检测扫描设备的扫描移动轨迹在预设时长内是否未第二次经过扫描路径上的起始位置;
在检测到所述扫描设备的扫描移动轨迹在预设时长内未第二次经过所述起始位置的情况下,预测回环路径。
2.根据权利要求1所述的方法,其特征在于,所述方法还包括:在检测到所述扫描设备的扫描移动轨迹在所述预设时长内未第二次经过所述起始位置的情况下,生成提示信息。
3.根据权利要求2所述的方法,其特征在于,预测回环路径,包括:
预测第一回环路径和/或第二回环路径,其中,所述第一回环路径为全局回环路径,所述第二回环路径为局部回环路径。
4.根据权利要求3所述的方法,其特征在于,预测第一回环路径,包括:
获取当前帧对应的扫描设备的第一位置,并将所述第一位置作为所述第一回环路径的第一端点,其中,所述当前帧为所述扫描设备在扫描过程中生成所述提示信息时对应的帧;
获取所述起始位置,并将所述起始位置作为所述第一回环路径的第二端点;
根据所述第一回环路径的第一端点和第二端点,生成所述第一回环路径。
5.根据权利要求4所述的方法,其特征在于,预测第二回环路径,包括:
将所述第一位置作为所述第二回环路径的第一端点;
获取与所述第一位置之间的距离为目标距离的第二位置,并将所述第二位置作为所述第二回环路径的第二端点;
根据所述第二回环路径的第一端点和第二端点,生成所述第二回环路径。
6.根据权利要求5所述的方法,其特征在于,
所述第二位置不在目标路径上,其中,所述目标路径为所述扫描设备至少一次经过目标位置的路径,所述目标位置为除所述起始位置及与所述起始位置之间的距离为所述目标距离的位置以外的位置。
7.根据权利要求3所述的方法,其特征在于,所述方法还包括:
在进行所述即时定位与地图构建的过程中,如果检测到生成所述局部回环路径,将检测到的所述局部回环路径内的所有帧标记为回环帧;
在所述扫描设备结束扫描时,如果检测到存在除所述回环帧以外的帧,生成所述提示信息。
8.根据权利要求1至7中任意一项所述的方法,其特征在于,预测回环路径之后,所述方法还包括:
展示所述回环路径;和/或
控制所述扫描设备按照所述回环路径移动。
9.一种回环路径的预测装置,其特征在于,包括:
检测模块,用于在进行即时定位与地图构建的过程中,检测扫描设备的扫描移动轨迹在预设时长内是否未第二次经过扫描路径上的起始位置;
预测模块,用于在检测到所述扫描设备的扫描移动轨迹在预设时长内未第二次经过所述起始位置的情况下,预测回环路径。
10.一种非易失性存储介质,其特征在于,所述非易失性存储介质包括存储的程序,其中,在所述程序运行时控制所述非易失性存储介质所在设备执行权利要求1至8中任意一项所述的回环路径的预测方法。
11.一种处理器,其特征在于,所述处理器用于运行存储在存储器中的程序,其中,所述程序运行时执行权利要求1至8中任意一项所述的回环路径的预测方法。
CN202211007262.1A 2022-08-22 2022-08-22 回环路径的预测方法及装置、非易失性存储介质、处理器 Pending CN115420275A (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202211007262.1A CN115420275A (zh) 2022-08-22 2022-08-22 回环路径的预测方法及装置、非易失性存储介质、处理器
PCT/CN2023/113875 WO2024041464A1 (zh) 2022-08-22 2023-08-18 回环路径的预测方法及装置、非易失性存储介质、处理器

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211007262.1A CN115420275A (zh) 2022-08-22 2022-08-22 回环路径的预测方法及装置、非易失性存储介质、处理器

Publications (1)

Publication Number Publication Date
CN115420275A true CN115420275A (zh) 2022-12-02

Family

ID=84197968

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211007262.1A Pending CN115420275A (zh) 2022-08-22 2022-08-22 回环路径的预测方法及装置、非易失性存储介质、处理器

Country Status (2)

Country Link
CN (1) CN115420275A (zh)
WO (1) WO2024041464A1 (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115661255A (zh) * 2022-12-15 2023-01-31 中国科学技术大学 一种激光slam回环检测与校正方法
WO2024041464A1 (zh) * 2022-08-22 2024-02-29 先临三维科技股份有限公司 回环路径的预测方法及装置、非易失性存储介质、处理器

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6823403B2 (ja) * 2016-02-15 2021-02-03 キヤノン株式会社 情報処理装置、情報処理装置の制御方法、情報処理方法およびプログラム
US10991117B2 (en) * 2018-12-23 2021-04-27 Samsung Electronics Co., Ltd. Performing a loop closure detection
CN111862162B (zh) * 2020-07-31 2021-06-11 湖北亿咖通科技有限公司 回环检测方法及系统、可读存储介质、电子设备
CN113791616A (zh) * 2021-08-25 2021-12-14 深圳优地科技有限公司 路径规划方法、装置、机器人和存储介质
CN114034299B (zh) * 2021-11-08 2024-04-26 中南大学 一种基于主动激光slam的导航系统
CN114674311B (zh) * 2022-03-22 2024-05-24 中国矿业大学 一种室内定位与建图方法及系统
CN115420275A (zh) * 2022-08-22 2022-12-02 先临三维科技股份有限公司 回环路径的预测方法及装置、非易失性存储介质、处理器

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024041464A1 (zh) * 2022-08-22 2024-02-29 先临三维科技股份有限公司 回环路径的预测方法及装置、非易失性存储介质、处理器
CN115661255A (zh) * 2022-12-15 2023-01-31 中国科学技术大学 一种激光slam回环检测与校正方法

Also Published As

Publication number Publication date
WO2024041464A1 (zh) 2024-02-29

Similar Documents

Publication Publication Date Title
US11747477B2 (en) Data collecting method and system
CN107145578B (zh) 地图构建方法、装置、设备和系统
CN115420275A (zh) 回环路径的预测方法及装置、非易失性存储介质、处理器
US5144685A (en) Landmark recognition for autonomous mobile robots
CN110617821B (zh) 定位方法、装置及存储介质
EP3605390A1 (en) Information processing method, information processing apparatus, and program
US20200353914A1 (en) In-vehicle processing device and movement support system
CN105628951A (zh) 用于测量对象的速度的方法和装置
CN111242994B (zh) 一种语义地图构建方法、装置、机器人及存储介质
CN109668563B (zh) 基于室内的轨迹的处理方法及装置
CN112732857B (zh) 路网处理方法、装置、电子设备以及存储介质
CN113916243A (zh) 目标场景区域的车辆定位方法、装置、设备和存储介质
CN111664848B (zh) 一种多模态室内定位导航方法及系统
CN113959457B (zh) 一种自动驾驶车辆的定位方法、装置、车辆和介质
CN113030990B (zh) 车辆的融合测距方法、装置、测距设备及介质
CN112650772A (zh) 数据处理方法、装置、存储介质及计算机设备
KR102463698B1 (ko) 도로표지판의 위치정보 데이터베이스 구축 시스템 및 그 방법과 이를 이용한 차량의 위치 추정 장치 및 그 방법
CN113223064A (zh) 一种视觉惯性里程计尺度的估计方法和装置
CN114972485A (zh) 定位精度测试方法、设备、存储介质及程序产品
CN112689234B (zh) 室内车辆定位方法、装置、计算机设备和存储介质
US20210048819A1 (en) Apparatus and method for determining junction
CN110930437B (zh) 目标跟踪方法和装置
CN116563352A (zh) 融合深度视觉信息的单线激光雷达回环检测方法及系统
CN115393816A (zh) 车道线生成方法、装置、计算机设备和存储介质
CN115014324A (zh) 定位方法、装置、介质、设备及车辆

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