室内机器人的导航地图自主更新方法、设备和存储介质与流程

1.本发明涉及建筑机械人技术领域，具体为室内机器人的导航地图自主更新方法、设备和存储介质。


背景技术：

2.在建筑室内移动机器人应用场景中，常常会使用三维激光扫描仪对室内场景进行三维地图构建，从而生成高精度的二维导航地图；
3.在机器人运动过程中采用单线激光雷达扫描周围环境特征得到的激光点云数据和高精度地图做匹配运算，得到机器人当前定位信息。但是，在机器人在建筑场景下的移动过程中，会存在扫描到的特征与高精度地图不符的现象，导致定位不准确和不稳定，而重新使用三维激光扫描仪进行场景扫图需要大量时间，无法适用于现场的导航地图实时更新。


技术实现要素：

4.针对现有技术存在的不足，本发明目的是提供室内机器人的导航地图自主更新方法、设备和存储介质，可以解决现有定位不准确和不稳定、导航地图无法更新的问题。
5.为了实现上述目的，本发明是技术方案如下：
6.本发明是通过如下的技术方案来实现：室内机器人的导航地图自主更新方法，
7.所述更新方法包括以下步骤：
8.s1、建筑场地基础地图预搭建：
9.使用三维激光扫描仪扫描建筑场地，得到该建筑场地的三维场景地图和二维导航地图；三维场景地图中内置有多个基础子图点云数据，基础子图点云数据内置有多个基础点云数据库；
10.s2、机器人进场并采集实时信息：
11.录入工作任务至机器人，机器人驶入建筑场地：
12.机器人自带有单线激光雷达扫描实时点云数据，机器人底部的底盘里程计纪录机器人的实时位姿变化数据；
13.s3、搭建模块建立实时子图点云数据：
14.将机器人拍摄的实时点云数据与基础点云数据库作对比，得到校正位姿变化数据；
15.根据校正位姿变化数据的变化量生成实时子图云点数据；
16.确定初步定位坐标以及实时局部地图；
17.s4、确定机器人高精度坐标：
18.根据初步定位坐标反解出高精度实时点云数据；
19.高精度实时点云数据在二维导航地图中的坐标即为机器人高精度坐标；
20.s5、判断是否触发三维场景地图的更新：
21.是，则将实时局部地图更新至三维场景地图；
22.否，则不更新。
23.进一步的，在s3中，所述将机器人拍摄的实时点云数据与基础点云数据库作对比，得到校正位姿变化数据具体的为：
24.s3.1、将实时点云数据与基础点云数据库做匹配，得到与实时点云数据匹配的基础点云数据；
25.s3.2、将基础点云数据置于二维导航地图中，得到基础位姿变化数据；
26.s3.3、将基础位姿变化数据与实时位姿变化数据作融合得到校正位姿变化数据。
27.进一步的，在s3中，所述根据校正位姿变化数据的变化量生成实时子图云点数据具体的为；
28.s3.4、判断校正位姿变化数据的变化量是否达到关键帧录入阈值；
29.是，则将当前的实时点云数据作为一个关键帧录入至实时子图点云数据，进入下一步；
30.否，则返回s3.1。
31.进一步的，所述关键帧录入阈值为：校正位姿变化数据中的机械人位移量超过30cm或机器人偏转角度超过15
°
。
32.进一步的，在s3中，确定初步定位坐标以及实时局部地图具体的为；
33.s3.5、将校正位姿变化数据置于二维导航地图中，得到机器人初步定位坐标；
34.s3.6、将s3.4中构建的子图点云数据与初步定位坐标作融合，生成实时局部地图。
35.进一步的，在s3中，还包括；
36.s3.7、判断子图点云数据是否达到帧数阈值；
37.是，则剔除距离当前时间戳最久的关键帧，进入下一步；
38.否，则直接进入下一步。
39.进一步的，在s3中，还包括；
40.s3.8、判断是否到达定位更新阈值：
41.是，则输出此时的实时点云数据、初步定位坐标至定位模块，定位模块开始工作，搭建模块返回s3.1；
42.否，则直接返回s3.1。
43.进一步的，在s4中，所述根据初步定位坐标反解出高精度实时点云数据具体的为：
44.定位模块将初步定位坐标置于三维场景地图，得到此时的目标基础子点云数据；
45.将实时点云数据与目标基础子点云数据作匹配，得到高精度实时点云数据。
46.进一步的，在s5中，所述将实时局部地图更新至三维场景地图具体的为：
47.每个实时局部地图由构建其的第一个关键帧的位姿作为其位姿：
48.建立高精度实时点云数据与实时局部地图之间的约束；
49.建立高精度实时点云数据与全部局部地图之间的约束，全部局部地图由多个实时局部地图组成；
50.以实时局部地图的初始激光帧数据的位姿作为该实时局部地图的中心位置，生成固定大小的栅格地图，所述实时局部地图分辨率与已有的高精度地图保持一致；
51.初始栅格地图的每个像素都标记未更新的标记概率值p
init
；
52.对匹配后且已矫正位姿的关键帧激光雷达数据进行地图数据的填充，计算激光扫
描的点所在位置在地图上的坐标索引以及激光中心到激光点连线上的所有点在地图上的坐标索引，在确定矫正后关键帧位姿t
ε
后，计算方法如下：
[0053][0054]
再根据地图原点在实时局部地图中的p
origin
空间位置和在实时局部地图中的像素索引位置，对实时局部地图中的p
local
空间位置进行像素索引计算；对于激光扫描的点赋值为扫描标记概率值p
hit
，对于激光中心到激光扫描到的点连线上的点赋值为未扫描标记概率值p
miss
；当有新的关键帧更新地图时，迭代更新栅格中的概率值，所述更新方法如下：
[0055][0056]mnew
(x)＝odds-1
(odds(m
old
(x)*odds(p)))
[0057]
更新完成后，当实时局部地图更新关键帧次数达到限制阈值时，对实时局部地图内所有像素的概率值做像素值的一一转换，并将像素值小于有效值阈值的像素置为无效占有值，最终构建成可定位导航的实时局部地图。
[0058]
一种计算设备，包括：处理器、存储器、通信接口和通信总线，所述处理器、所述存储器和所述通信接口通过所述通信总线完成相互间的通信；所述存储器用于存放至少一可执行指令，所述可执行指令使所述处理器执行上述所述室内机器人的导航地图自主更新方法对应的操作。
[0059]
一种计算机存储介质，所述存储介质中存储有至少一可执行指令，所述可执行指令使处理器执行上述所述的室内机器人的导航地图自主更新方法对应的操作。
[0060]
与现有技术相比，本发明的有益效果包括：
[0061]
三维激光扫描仪提供的高精度二维导航地图，获取当前时刻所述单线激光雷达和运动底盘的相关数据，实现机器人当前时刻的定位导航功能，实时构建由关键帧组成的更新后的局部地图，并且定时求解由多个局部地图与当前时刻激光帧数据构建多约束的优化问题，以保证更新后地图的精度，方便后续建筑机器人进入建筑场地后的导航定位功能不受当次建筑机器人操作修改室内建筑场景的影响。
附图说明
[0062]
参照附图来说明本发明的公开内容。应当了解，附图仅仅用于说明目的，而并非意在对本发明的保护范围构成限制，在附图中，相同的附图标记用于指代相同的部件。其中：
[0063]
图1为本发明室内机器人的导航地图自主更新方法的整体结构示意图；
[0064]
图2为本发明室内建筑机器人的导航地图自主更新设备结构示意图。
具体实施方式
[0065]
容易理解，根据本发明的技术方案，在不变更本发明实质精神下，本领域的一般技术人员可以提出可相互替换的多种结构方式以及实现方式。因此，以下具体实施方式以及附图仅是对本发明的技术方案的示例性说明，而不应当视为本发明的全部或者视为对本发明技术方案的限定或限制。
[0066]
实施例一
[0067]
室内机器人的导航地图自主更新方法，所述更新方法包括以下步骤：
[0068]
s1、建筑场地基础地图预搭建：
[0069]
使用三维激光扫描仪扫描建筑场地，得到该建筑场地的三维场景地图和二维导航地图；三维场景地图中内置有多个基础子图点云数据，基础子图点云数据内置有多个基础点云数据库；
[0070]
s2、机器人进场并采集实时信息：
[0071]
录入工作任务至机器人，机器人驶入建筑场地：
[0072]
机器人自带有单线激光雷达扫描实时点云数据，机器人底部的底盘里程计纪录机器人的实时位姿变化数据；
[0073]
s3、搭建模块建立实时子图点云数据：
[0074]
将机器人拍摄的实时点云数据与基础点云数据库作对比，得到校正位姿变化数据；具体的为：
[0075]
s3.1、将实时点云数据与基础点云数据库做匹配，得到与实时点云数据匹配的基础点云数据；
[0076]
s3.2、将基础点云数据置于二维导航地图中，得到基础位姿变化数据；
[0077]
s3.3、将基础位姿变化数据与实时位姿变化数据作融合得到校正位姿变化数据；
[0078]
此步骤用以先校正机器人量程计所得数据，使得下步骤中录入的实时点云数据、初步坐标确定，更为准确可靠，消除机器误差；
[0079]
根据校正位姿变化数据的变化量生成实时子图云点数据，具体的为：
[0080]
s3.4、判断校正位姿变化数据的变化量是否达到关键帧录入阈值；关键帧录入阈值为：校正位姿变化数据中的机械人位移量超过30cm或机器人偏转角度超过15度；
[0081]
是，则将当前的实时点云数据作为一个关键帧录入至实时子图点云数据，进入s3.5；
[0082]
否，则返回s3.1；
[0083]
此步骤用以先建立子图点云数据，为后续生成局部图、更新地图做准备；
[0084]
确定初步定位坐标以及实时局部地图，具体的为：
[0085]
s3.5、将校正位姿变化数据置于二维导航地图中，得到机器人初步定位坐标；
[0086]
s3.6、将s3.4中构建的子图点云数据与初步定位坐标作融合，生成实时局部地图；实时局部地图中涵盖了机器人当前所扫描到的子图点云数据和初步定位坐标，便于后续进一步优化处理；
[0087]
s3.7、判断子图点云数据是否达到帧数阈值；示例性的帧数阈值为10帧；
[0088]
是，则剔除距离当前时间戳最久的关键帧，进入s3.8；
[0089]
否，则直接进入s3.8。
[0090]
此步骤，子图点云数据超过10帧时，则剔除距离当前时间戳最久的关键帧，并加入新的关键帧数据，可有效提高数据处理速度、精度程度，避免存储过多冗余信息；
[0091]
s3.8、判断是否到达定位更新阈值，示例性的定位更新阈值为1-3s；
[0092]
是，则输出此时的实时点云数据、初步定位坐标至定位模块，定位模块开始工作，搭建模块返回s3.1；
[0093]
否，则直接返回s3.1；
[0094]
此步骤用以确定需要确定在定位时，应该上传的实时点云数据、初步坐标；
[0095]
s4、确定机器人高精度坐标：
[0096]
根据初步定位坐标反解出高精度实时点云数据，具体的为：定位模块将初步定位坐标置于三维场景地图，得到此时的目标基础子点云数据；将实时点云数据与目标基础子点云数据作匹配，得到高精度实时点云数据；
[0097]
此步骤中，通过将初步定位坐标的目标基础子点云数据与实时点云数据作对比融合，找到相匹配的地方，即可确定，高精度实时点云数据，能够消除单线激光雷达的扫描误差，解决当环境改变时，无法定位的问题，同时高精度实时点云数据只用来高精度定位，也不会改变实时点云数据，进而不会影响后续地图更新操作；
[0098]
高精度实时点云数据在二维导航地图中的坐标即为机器人高精度坐标；
[0099]
s5、判断是否触发三维场景地图的更新：实时点云数据发生变化则更新，未发生变化则不更新；
[0100]
是，则将实时局部地图更新至三维场景地图；
[0101]
否，则不更新。
[0102]
传统的地图更新方法常常会依赖于单线激光雷达扫描到的特征数据，但是在建筑场地时常会出现激光扫描到错误特征的情况，由于单线激光扫描得到的特征存在不利影响，使得更新后的导航地图出现质量差，影响后续定位的稳定性与准确性；为解决上述问题，给出如下的更新方法：
[0103]
每个实时局部地图由构建其的第一个关键帧的位姿作为其位姿：
[0104]
建立高精度实时点云数据与实时局部地图之间的约束；
[0105]
建立高精度实时点云数据与全部局部地图之间的约束，全部局部地图由多个实时局部地图组成；
[0106]
以实时局部地图的初始激光帧数据的位姿作为该实时局部地图的中心位置，生成固定大小的栅格地图，所述实时局部地图分辨率与已有的高精度地图保持一致；
[0107]
初始栅格地图的每个像素都标记未更新的标记概率值p
init
；
[0108]
对匹配后且已矫正位姿的关键帧激光雷达数据进行地图数据的填充，计算激光扫描的点所在位置在地图上的坐标索引以及激光中心到激光点连线上的所有点在地图上的坐标索引，在确定矫正后关键帧位姿t
ε
后，计算方法如下：
[0109][0110]
再根据地图原点在实时局部地图中的p
origin
空间位置和在实时局部地图中的像素索引位置，对实时局部地图中的p
local
空间位置进行像素索引计算；对于激光扫描的点赋值为扫描标记概率值p
hit
，对于激光中心到激光扫描到的点连线上的点赋值为未扫描标记概率值p
miss
；当有新的关键帧更新地图时，迭代更新栅格中的概率值，所述更新方法如下：
[0111][0112]mnew
(x)＝odds-1
(odds(m
old
(x)*odds(p)))
[0113]
更新完成后，当实时局部地图更新关键帧次数达到限制阈值时，对实时局部地图内所有像素的概率值做像素值的一一转换，并将像素值小于有效值阈值的像素置为无效占
有值，最终构建成可定位导航的实时局部地图。
[0114]
首先用三维激光扫描仪得到高精度二维导航地图，保证了建筑机器人在进场时定位的高精度，从而保证了关键帧拼接构建更新实时局部地图的初始位姿精度；
[0115]
同时，用概率值的方式记录每个地图点被更新的值，最后将小于有效值阈值的地图像素点都剔除的方式，有效的避免了错误冗余信息的干扰，有效地保证了后续定位过程的准确性和稳定性；
[0116]
这种方式，用自主更新地图的方法，在建筑机器人完成一次施工后，便可得到当前最新的二维导航地图，避免了再次使用三维激光扫描仪的复杂操作，保证了建筑场地施工的时效性。
[0117]
实施例二
[0118]
一个室内建筑机器人的导航地图自主更新设备，所述自主更新设备基于实施一的方法工作；
[0119]
所述建筑机器人设备包括：至少一个三维激光扫描仪，能够在建筑机器人进入室内建筑工地前对室内场景进行扫描建图，并提供初始高精度二维导航地图，保证机器人能够正常导航作业；至少一个单线激光雷达和一个运动底盘，在机器人运动过程中提供里程计和激光数据，保证机器人的正常定位，并不断生成更新的局部地图；至少一个处理器；以及，至少一个与所述处理器通信连续的存储器；其中，所述存储器有可被所述处理器执行的指令，所述指令被所述处理器执行，能够：处理三维激光扫描仪提供的高精度二维导航地图，获取当前时刻所述单线激光雷达和运动底盘的相关数据，实现机器人当前时刻的定位导航功能，实时构建由关键帧组成的更新后的局部地图，并且定时求解由多个局部地图与当前时刻激光帧数据构建多约束的优化问题，以保证更新后地图的精度，方便后续建筑机器人进入建筑场地后的导航定位功能不受当次建筑机器人操作修改室内建筑场景的影响。
[0120]
实施例三
[0121]
一种计算机存储介质，存储有计算机可执行指令，可执行指令用以执行实施例一的方法；
[0122]
所述计算机可执行指令设置为：处理三维激光扫描仪提供的高精度二维导航地图，获取当前时刻所述单线激光雷达和运动底盘的相关数据，实现机器人当前时刻的定位导航功能，实时构建由关键帧组成的更新后的局部地图，并且定时求解由多个局部地图与当前时刻激光帧数据构建多约束的优化问题，以保证更新后地图的精度，方便后续建筑机器人进入建筑场地后的导航定位功能不受当次建筑机器人操作修改室内建筑场景的影响。
[0123]
本发明的技术范围不仅仅局限于上述说明中的内容，本领域技术人员可以在不脱离本发明技术思想的前提下，对上述实施例进行多种变形和修改，而这些变形和修改均应当属于本发明的保护范围内。