用于综合管廊巡检的足式机器人自主导航方法及系统技术方案

本发明专利技术公开了一种用于综合管廊巡检的足式机器人自主导航方法及系统，包括：获取综合管廊三维点云信息，并对三维点云信息进行预处理；将预处理后的三维点云信息分割为N个平面，分别对N个平面求取法向量；基于求得的法向量，采用粒子滤波算法，实时检测管廊的延伸方向；控制巡检机器人沿着管廊的延伸方向运动，实现巡检机器人的无全局地图自主导航。本发明专利技术通过粒子滤波算法实时检测管廊的延伸方向，巡检机器人导航不再依赖于GPS和预先建立的地图，解决了重复场景带来的绝对定位精度低的问题。决了重复场景带来的绝对定位精度低的问题。决了重复场景带来的绝对定位精度低的问题。

【技术实现步骤摘要】
用于综合管廊巡检的足式机器人自主导航方法及系统


[0001]本专利技术涉及机器人巡检
，尤其涉及一种用于综合管廊巡检的足式机器人自主导航方法及系统。

技术介绍

[0002]本部分的陈述仅仅是提供了与本专利技术相关的
技术介绍
信息，不必然构成在先技术。
[0003]城市地下综合管廊是指修建在城市下面的公共管道隧道，在隧道内集中铺设电力，通信，燃气，给水，热力，排水等两条或两条以上的市政管道，实行统一规划，设计，施工，养护。地下综合管廊短则几公里，长则数十公里，内部空间狭窄，且相对封闭，人工巡检效率不高，同时也存在着许多安全隐患。
[0004]综合管廊巡检机器人的出现，能够实现对综合管廊环境、设备、安防、门禁等的不间断监测及灾害预警、处置。由于管廊内部狭长，且无GPS信号，机器人无法采用先建图再实时定位的方式完成自动导航；另外管廊内场景重复，无论是使用激光雷达还是视觉定位，都容易出现误匹配，导致难以获得机器人沿管廊前进方向的准确位置。有些管廊巡检机器人采用安装轨道的方式，使机器人沿轨道移动，通过在轨道上加装RFID标签或条码实现定位，但由于管廊狭长，安装轨道的成本远高于机器人本身的成本。

技术实现思路

[0005]为了解决上述问题，本专利技术提出了一种用于综合管廊巡检的足式机器人自主导航方法及系统，能够在不依赖GPS信号的情况下，克服重复场景带来的绝对定位精度低的问题，实现机器人的自主导航。
[0006]在一些实施方式中，采用如下技术方案：
[0007]一种用于综合管廊巡检的足式机器人自主导航方法，包括：
[0008]获取综合管廊三维点云信息，并对三维点云信息进行预处理；
[0009]将预处理后的三维点云信息分割为N个平面，分别对N个平面求取法向量；
[0010]基于求得的法向量，采用粒子滤波算法，实时检测管廊的延伸方向；
[0011]控制巡检机器人沿着管廊的延伸方向运动，实现巡检机器人的无全局地图自主导航。
[0012]其中，基于求得的法向量，采用粒子滤波算法，实时检测管廊的延伸方向，具体过程为：
[0013]初始化M个三维向量，将三维向量单位化；
[0014]每一个单位化后的三维向量作为一个粒子，计算粒子的权重；
[0015]选取所有粒子中权重最大的粒子，若该粒子的权重超过设定的阈值，则该粒子对应的方向即为管廊延伸方向；若该粒子的权重没有超过设定的阈值，则管廊延伸方向存在歧义，减小综合管廊三维点云的扫描距离，重新判定管廊延伸方向；若最大粒子权重仍未超
过设定的阈值，则判定到达管廊的终点。
[0016]计算粒子权重的方法为：
[0017][0018]其中，n
i
表示每一个平面求取的法向量，i为1到N的整数；k
jn
为单位化后的三维向量，p
i
表示每一个平面中点云的数量。
[0019]所述设定的阈值为q为阈值系数，q∈(0,1)。
[0020]在另一些实施方式中，采用如下技术方案：
[0021]一种用于综合管廊巡检的足式机器人自主导航系统，包括：
[0022]三维点云获取模块，用于获取综合管廊三维点云信息，并对三维点云信息进行预处理；
[0023]点云分割模块，用于将预处理后的三维点云信息分割为N个平面，分别对N个平面求取法向量；
[0024]管廊延伸方向检测模块，用于基于求得的法向量，采用粒子滤波算法，实时检测管廊的延伸方向；
[0025]机器人导航模块，用于控制巡检机器人沿着管廊的延伸方向运动，实现巡检机器人的无全局地图自主导航。
[0026]在另一些实施方式中，采用如下技术方案：
[0027]一种巡检机器人，其特征在于，采用上述的用于综合管廊巡检的足式机器人自主导航方法，进行巡检机器人的导航。
[0028]在另一些实施方式中，采用如下技术方案：
[0029]一种终端设备，其包括处理器和存储器，处理器用于实现各指令；存储器用于存储多条指令，所述指令适于由处理器加载并执行上述的用于综合管廊巡检的足式机器人自主导航方法。
[0030]在另一些实施方式中，采用如下技术方案：
[0031]一种计算机可读存储介质，其中存储有多条指令，所述指令适于由终端设备的处理器加载并执行上述的用于综合管廊巡检的足式机器人自主导航方法。
[0032]与现有技术相比，本专利技术的有益效果是：
[0033](1)本专利技术提出了一种综合管廊巡检机器人的无全局地图自主导航方法，研制了管廊延伸方向粒子滤波检测算法，实现了巡检机器人无全局地图下的自主导航，巡检机器人导航不再依赖于GPS和预先建立的地图，解决了重复场景带来的绝对定位精度低的问题，同时巡检机器人也不再局限于轨道巡检机器人，免除了架设巡检轨道的成本，提高了巡检机器人对综合管廊巡检的适应性，提升了巡检机器人的定位精度。
[0034]本专利技术的其他特征和附加方面的优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本方面的实践了解到。
附图说明
[0035]图1为本专利技术实施例中的综合管廊巡检机器人的无全局地图自主导航方法流程图。
具体实施方式
[0036]应该指出，以下详细说明都是例示性的，旨在对本申请提供进一步的说明。除非另有指明，本专利技术使用的所有技术和科学术语具有与本申请所属
的普通技术人员通常理解的相同含义。
[0037]需要注意的是，这里所使用的术语仅是为了描述具体实施方式，而非意图限制根据本申请的示例性实施方式。如在这里所使用的，除非上下文另外明确指出，否则单数形式也意图包括复数形式，此外，还应当理解的是，当在本说明书中使用术语“包含”和/或“包括”时，其指明存在特征、步骤、操作、器件、组件和/或它们的组合。
[0038]实施例一
[0039]在一个或多个实施方式中，公开了一种用于综合管廊巡检的足式机器人自主导航方法，结合图1，具体包括如下过程：
[0040]S101：获取综合管廊三维点云信息，并对三维点云信息进行预处理；
[0041]本实施例中，使用传感器扫描环境轮廓，得到设定距离范围内的综合管廊三维点云信息；传感器可以选用双目视觉相机、结构光相机、TOF相机或三维激光雷达等。
[0042]得到三维点云信息之后，使用滤波器对三维点云进行预处理，包括：使用统计滤波器或半径滤波器去除孤立点，以及使用体素滤波器降采样，避免点云过于集中等。
[0043]S102：将预处理后的三维点云信息分割为N个平面，分别对N个平面求取法向量；
[0044]本实施例中，使用RANSAC方法对点云进行平面分割，获得N个平面(管廊中主要为墙面，其他平面点云点数较少)，每个平面中点云的点数记为p
i
，其中i为1到N的整数。需要说明的是，使用RANSAC方法对点云进行平面分割的过程是本领域技术人员已知的技术，不再详述。<本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于综合管廊巡检的足式机器人自主导航方法，其特征在于，包括：获取综合管廊三维点云信息，并对三维点云信息进行预处理；将预处理后的三维点云信息分割为N个平面，分别对N个平面求取法向量；基于求得的法向量，采用粒子滤波算法，实时检测管廊的延伸方向；控制巡检机器人沿着管廊的延伸方向运动，实现巡检机器人的无全局地图自主导航。2.如权利要求1所述的一种用于综合管廊巡检的足式机器人自主导航方法，其特征在于，对三维点云信息进行预处理，具体包括：使用统计滤波器或半径滤波器去除孤立点，使用体素滤波器降采样。3.如权利要求1所述的一种用于综合管廊巡检的足式机器人自主导航方法，其特征在于，使用RANSAC方法将预处理后的三维点云信息分割为N个平面。4.如权利要求1所述的一种用于综合管廊巡检的足式机器人自主导航方法，其特征在于，基于求得的法向量，采用粒子滤波算法，实时检测管廊的延伸方向，具体过程为：初始化M个三维向量，将三维向量单位化；每一个单位化后的三维向量作为一个粒子，计算粒子的权重；选取所有粒子中权重最大的粒子，若该粒子的权重超过设定的阈值，则该粒子对应的方向即为管廊延伸方向；若该粒子的权重没有超过设定的阈值，则管廊延伸方向存在歧义，减小综合管廊三维点云的扫描距离，重新判定管廊延伸方向；若最大粒子权重仍未超过设定的阈值，则判定到达管廊的终点。5.如权利要求4所述的一种用于综合管廊巡检的足式机器人自主导航方法，其特征在于，计算粒子权重的方法为：其中，n
i
表示每一...

【专利技术属性】
技术研发人员：孟健，肖鹏，左新斌，张斌，孙志周，陈天顺，董旭，王媛媛，杨尚伟，刘树仁，张伟，
申请(专利权)人：国网智能科技股份有限公司，
类型：发明
国别省市：