一种基于激光雷达的地下电缆隧道巡检机器人及实现方法与流程

1.本发明涉及巡检机器人及实现方法，尤其涉及一种基于激光雷达的地下电缆隧道巡检机器人及实现方法。


背景技术：

2.随着电缆隧道的普及和发展，其存在的安全隐患也越来越大，若巡检不及时，隧道内会有发生火灾的危险，特别是在空间窄小、隧道两侧壁上突出大量金属棍形障碍物的输电隧道中，通过人力来进行地下隧道的巡检难度较高，对于工作人员的巡检也有相当的大的危险性，所以大多采用隧道机器人进行巡检。目前可用于隧道定位的主流的巡检机器人有基于rfid、uwb、b1uetooth等的有轨式巡检机器人。但是其有轨式的巡检机器人大多成本较高，比如uwb。而且需要铺设网络并对网络进行定期的维护，如蓝牙定位需要部署蓝牙的信标，基于rfid需要提前安置标签，成本也要增加不少。而无轨的巡检机器人，如采用ccd摄像头的无轨巡检机器人。其ccd摄像头一般价格较为昂贵而且地下隧道潮湿的环境会对镜头产生一定的水雾遮挡，巡检效果不佳。


技术实现要素：

3.发明目的：本发明的目的是提供一种实现精准测试周围障碍的距离扫描速度快、可靠性高的基于激光雷达的地下电缆隧道巡检机器人及实现方法。
4.技术方案：本发明的机器人，包括履带式行走机构、箱体、传感器系统、单片机、工控机、蜂鸣器和两件火焰检测系统；所述箱体设于履带式行走机构上，所述单片机、工控机和蜂鸣器均设于箱体内部；所述履带式行走机构采用电机提供动力，所述单片机通过电机控制履带式行走机构；
5.传感器系统与工控机连接，所述传感器系统包括有四个单线激光雷达，其中第一单线激光雷达和第二单线激光雷达分别置于箱体左右两侧，第三单线激光雷达置于箱体上端前侧，第四单线激光雷达置于箱体上端后侧；所述的四个单线激光雷达均与工控机连接；
6.所述传感器系统将数据传输给工控机，工控机对数据进行分析处理，并根据得到隧道的环境情况和障碍物分布信息，进行路径的规划和车体的导航控制；工控机将机器人的前进速度、前进方向和转弯幅度信息传输给单片机，单片机通过pid控制机器人姿态和速度的调整，实现前进过程中对障碍物的规避；
7.两件火焰检测系统分别设于箱体两侧，且分别位于第一单线激光雷达和第二单线激光雷达的后侧，均与单片机连接；所述火焰检测系统将检测信号发送给单片机，单片机根据接收到信号控制蜂鸣器。
8.本发明机器人的实现方法，包括以下步骤：
9.(1)通过四个单线激光雷达对于隧道的环境进行检测，获得环境信息；
10.(2)将四个单线激光雷达的数据传输给工控机；
11.(3)工控机通过算法解算隧道环境并规划路线，所述规划路线包括直行路线规划、
障碍物规避和弯道路线规划；
12.(4)根据规划好的路线，通过pid控制系统对机器人的前进速度和方向进行调整，实现对机器人的控制；
13.(5)火焰检测系统检测两侧是否有火焰目标，如果有，则发送停止命令，并切换模式，进行灭火。
14.进一步，所述步骤(1)中，获得的环境信息包括金属型障碍物、墙体、地面的点云数据。
15.进一步，所述步骤(3)中，所述直行路线规划通过对第三单线激光雷达和第四单线激光雷达扫描获得的点云数据进行处理来实现的，将点云数据分成可用点和障碍点：从隧道侧壁突出来的金属棍对应的点云为障碍点，不予考虑；从隧道两侧壁对应的点云为而可用点；所述可用点的处理步骤如下：
16.(31)采用kd-tree最近邻近搜索算法查找激光雷达每一个点的最近邻近点，计算每一点与其最近邻近点的平均距离；对于给定的查询数据p须从kd-tree的根节点开始比较，其中p(k)为当前结点划分维度k上数据点p对应的值，m为当前结点划分的阈值；
17.若p(k)《m，则访问左子树；否则访问右子树，直至达到叶子结点q；此时q就是当前最近邻点，p与q之间的距离是当前最小距离d
min
；
18.随后沿着原搜索路径回退至根结点，若此过程中发现与p之间距离小于d
min
的点，则将未曾访问过的子节点均纳入搜索范畴，并及时更新最近邻点，直至所有的搜索路径都为空，整个基于kd-tree结构的最近邻点查询过程便告完成；若此过程中发现与p之间距离大于等于d
min
的点，则沿搜索路径回退至根节点；
19.(32)采用欧式聚类对金属障碍物进行聚类，将金属障碍物从墙体环境中分离出来，对隧道内的某点a进行kdtree近邻搜索，得到k个离a最近的点，将距离小于设定阈值的点聚类于集合b；
20.判断集合b中的元素数量，若b中元素数量不再增加，说明机器人保持在隧道中间部分前进，若b中元素数量增加，则需要在b中选取a以外的点，更新初始点a的值，重新进行聚类；
21.所有点的邻近点的平均距离满足高斯分布，通过筛选高斯分布中与距离均值相差较多的点，完成对于测量信息中障碍点的聚类，从而得到去除金属障碍物的墙面的距离和位置信息，最终实现机器人关于墙面的定位。
22.进一步，所述步骤(3)中，所述障碍物规避的实现过程为：
23.通过第一单线激光雷达和第二单线激光雷达扫描平面相对地面垂直，单片机对两单线激光雷达扫描到的点云进行处理，对其中属于地面的点云和墙面的点云进行筛除，如两侧地面的点云不一致、或者两侧墙面的云点不一致、或者与其他点云对比产生突变的，则判定为属于障碍物的点云，以此判断出障碍物的位置和距离；
24.当两侧障碍物的距离达到设定阈值m以下时，判断出机器人前方左侧或者右侧出现障碍物，通过单片机进行控制，实现对应的规避。
25.进一步，所述步骤(3)中，所述弯道路线规划的实现过程为：通过箱体第一单线激光雷达、第二单线激光雷达和第三单线激光雷达检测到前方墙面的距离，再通过卡尔曼滤波进行滤波后得到滤除障碍物后的真实值；通过三个距离信息，计算墙面的弯曲曲率，根据
曲率的大小控制机器人转弯的幅度大小，从而实现转弯。
26.进一步，所述步骤(4)中，根据实验获得的理想pid控制参数，编写单片机程序；通过第三单线激光雷达和第四单线激光雷达收集并采用聚类算法分离出的地面点云，获取机器人的前进距离和时间，解算出实时速度v、实时加速度a，并与单片机控制履带式行走机构的电机速度进行对比校正；
27.左移、右移、直行、转弯命令由工控机发至单片机，将当前隧道机器人的位姿误差作为pid控制器的输入，得到左右电机需要输出的pwm波占空比，使用增量式pid控制器，根据隧道机器人的当前位姿控制电机转速，从而调整机器人姿态，使机器人按照工控机规划的路线进行左移、右移、直行、转弯等，达到对机器人的控制。
28.本发明与现有技术相比，其显著效果如下：1、采用单线激光雷达，在角频率以及灵敏度上反应更快捷，在测试周围障碍物的距离和精度上都更加精准，扫描速度更快，分辨率更强，可靠性更高；2、机器人的定位不需要提前铺设信标、网络、轨道等，降低了人力成本。
附图说明
29.图1为本发明巡检机器人所应用的地下电缆隧道环境示意图；
30.图2为本发明巡检机器人的车体侧视图；
31.图3为本发明巡检机器人的车体前视图；
32.图4为本发明巡检机器人的结构示意框；
33.图5为本发明巡检机器人导航定位kd-tree算法的流程图；
34.图6为本发明巡检机器人导航定位欧式聚类算法的流程图；
35.图7为本发明巡检机器人过弯的算法示意图。
36.图8为本发明巡检机器人的火焰检测系统的安装位置与检测范围
具体实施方式
37.下面结合说明书附图和具体实施方式对本发明做进一步详细描述。
38.如图1所示的地下电缆隧道环境示意图，为巡检机器人的工作场所。
39.本发明的地下电缆隧道巡检机器人系统包括履带式行走机构、箱体、传感器系统、单片机、蜂鸣器、工控机和两件火焰检测系统。传感器系统包括四个单线激光雷达，第一单线激光雷达和第二单线激光雷达分别置于箱体左右两侧，第三单线激光雷达和第四单线激光雷达分别置于箱体顶部的前侧、后侧，其结构示意图如图2和图3所示，均与工控机相连接，通过工控机解算传感器系统检测到的隧道环境，进行路线的规划。如图4所示，传感器系统将检测到的点云数据传输给工控机，工控机对点云数据进行分析处理，得到隧道的环境情况和障碍物分布，并根据隧道的环境情况和障碍物分布再进行路径的规划和车体的导航控制，工控机将车体的前进速度、前进方向和转弯幅度等指令传输给单片机，单片机通过pid控制车体进行姿态和速度的调整，实现前进过程中对障碍物的规避。与此同时，与单片机相连接、位于车体两侧的火焰检测系统对隧道中可能出现火焰进行检测，当出现火焰信号时，单片机控制进行停车并通过蜂鸣器进行警报，达到地下电缆隧道巡检的目的。
40.具体的实现步骤如下：
41.步骤一，采用四个单线激光雷达对隧道的环境进行检测，获得金属型障碍物、墙
体、地面的点云数据。
42.步骤二，将四个激光雷达的数据传输给工控机。
43.传感器系统中的四个单线激光雷达将检测到的点云数据传输给工控机，工控机对点云数据进行分析处理，得到隧道的环境情况和障碍物分布。
44.步骤三，工控机通过算法解算隧道环境并规划路线。规划路线算法的实现过程如下：
45.(一)直行路线规划
46.直行路线规划是通过第三单线激光雷达和第四单线激光雷达，扫描面相对地面平行获得的点云数据实现的。将目标点云区域分成可用点和障碍点：障碍点也就是从隧道侧壁突出来的金属棍对应的点云，不予考虑；而可用点也就是从隧道两侧壁对应的点云，则是需要进一步的处理。具体的分类方法如下：
47.先采用kd-tree最近邻近搜索算法查找激光雷达每一个点的最近邻近点，计算每一点与其最近邻近点的平均距离。算法流程如图5所示，对于给定的查询数据p须从kd-tree的根节点开始比较，其中p(k)为当前结点划分维度k上数据点p对应的值，m为当前结点划分的阈值。若p(k)《m，则访问左子树；否则访问右子树，直至达到叶子结点q。此时q就是当前最近邻点，而p与q之间的距离就是当前最小距离d
min
。随后沿着原搜索路径回退至根结点，若此过程中发现与p之间距离小于d
min
的点，则须将未曾访问过的子节点均纳入搜索范畴，并及时更新最近邻点，直至所有的搜索路径都为空，整个基于kd-tree结构的最近邻点查询过程便告完成。若此过程中发现与p之间距离大于等于d
min
的点，则沿搜索路径回退至根节点。
48.然后采用欧式聚类对金属障碍物进行聚类，将其从墙体环境中分离出来，对隧道内的某点a进行kdtree近邻搜索，得到k个离a最近的点，将这些点中距离小于设定阈值的聚类于集合b，判断b中的元素数量，若b中元素数量不再增加，说明机器人保持在隧道中间部分前进，若b中元素数量增加，则需要在b中选取a以外的点，更新初始点a的值，重新进行聚类。如图6欧式聚类算法的流程图，所有点的邻近点的平均距离应该满足高斯分布，通过筛选高斯分布中与距离均值相差较多的点，完成对于测量信息中障碍点(也就是金属形障碍物)的聚类，从而就能得到去除金属障碍物的墙面的距离和位置信息，从而进行机器人关于墙面的定位。依据第三单线激光雷达完成对机器人前部的定位，确定其相对于墙面的位置并使其保持在整个隧道的中间部分；依据第四单线激光雷达，也使得机器人后侧保持在隧道的中间部分；如此，根据车体前部和后部相对于墙面的位置，就能使得隧道机器人的整体姿态相对墙面平直，实现机器人沿直线前进。
49.(二)障碍物规避
50.当激光雷达线打到墙面的管道上导致对隧道中线的估计出现误差时，机器人可能会撞到前方金属棍障碍物。因此采用箱体两侧的激光雷达对机器人进行避障，两侧的激光雷达扫描平面相对地面垂直，对两侧的激光雷达扫描到的点云进行处理。根据两侧激光雷达的点云信息(两侧的地面点云和两侧的墙面点云都应该保持一致)，在机器人沿中心前进时，对其中属于地面的点云和墙面的点云进行筛除，剩下两侧不一致的点云以及产生突变的点云则是被判定为属于障碍物的点云，以此判断出障碍物的位置和距离。当两侧障碍物的距离达到一设定阈值m以下时，即判断出机器人前方左侧(箱体左侧第一单线激光雷达得出)或者右侧(箱体右侧第二单线激光雷达得出)出现障碍物，以控制单片机进行对应的规
避。
51.(三)弯道路线规划
52.如图7，弯道部分通过第一、第二和第三单线激光雷达来实现，三个激光雷达(两侧的激光雷达和顶部前侧的激光雷达)都能够检测到前方墙面的距离，通过卡尔曼滤波进行滤波后，得到滤除障碍物后的真实值。通过三个距离信息，计算墙面的弯曲曲率，根据曲率的大小控制机器人转弯的幅度大小，从而实现过弯。以点o为圆心，则可以获得a、b、c、d、e的坐标，设a(x1,y1)，b(x2,y2)，c(x3,y3)，则能得到三角形abc的面积：
[0053][0054]
式(1)中，如果abc三点是顺时针方向分布，则三角形面积为负值，逆时针分布则为正值，以此判断机器人是向左转还是向右转。
[0055]
然后曲率就可以表现为三角形外接圆半径的倒数，可以得到曲率为：
[0056][0057]
式(2)中，ab、bc和ac分别为三角形的三条边长；接着根据曲率的大小，得到机器人转弯时应该转过的角度，在转弯的同时，调节障碍物规避的判定障碍物阈值m来辅助进行过弯时的障碍物规避，根据实时监测的曲率大小对机器人控制进行调整以实现顺利过弯。
[0058]
步骤4，根据规划好的路线，通过pid控制系统对机器人的前进速度和方向进行调整，实现对巡检机器人的控制。其具体方案如下：
[0059]
机器人采用pid控制算法进行车速控制，工作原理为：系统输入端输入信号经过各个环节后，在输出端产生一个输出信号，由系统的反馈回路将输出信号负反馈至输入端。由减法器实现两者相减得到系统的偏差值，偏差值经过pid控制环节的比例、微分、积分作用后将再次对受控对象进行控制调节。若系统输出与输入之间仍有偏差，将一直重复上述过程，直至输出等于输入量。其连续信号分析计算模型原理公式如下：
[0060][0061]
式(3)中，k
p
是比例系数，ti是积分时间常数，td是微分时间常数，u(t)为单片机输出给两侧电机的信号修正量，e(t)为输入信号和输出信偏差量。因单片机处理的是离散信号，故采用增量型的数字pid控制算法，公式如下：
[0062]
δu[n]＝k
p
{e[n]-e[n-1]}+kie[n]+kd{e[n]-2e[(n-1)]+e[n-2]}(4)
[0063]
式(4)中，ki为积分系数，kd为微分系数，u[n]为第n时刻的信号修正量，e[n]、e[n-1]、e[n-2]分别为为n、n-1和n-2时刻的信号偏差量。
[0064]
根据实验获得的理想pid控制参数，如比例系数、积分时间常数、微分时间常数编写单片机程序。通过第三单线激光雷达和第四单线激光雷达收集并采用聚类算法分离出的地面点云，获取机器人的前进距离和时间，解算出其实时速度v、实时加速度a以及当前车体位姿等实时状态，并与单片机控制履带式行走机构的电机速度进行对比校正，以降低其地面摩擦力等因素对车辆速度控制造成的误差。左移、右移、直行、转弯等命令由工控机发至
单片机，将当前隧道机器人的位姿误差作为pid控制器的输入，就可以得到左右电机需要输出的pwm波占空比，使用增量式pid控制器，根据隧道机器人的当前位姿控制电机转速，从而调整机器人姿态，使机器人按照工控机规划的路线进行左移、右移、直行、转弯等，达到对机器人的控制。
[0065]
步骤5，火焰检测系统检测两侧是否有火焰目标。如果无火焰目标，则继续沿隧道前进继续巡检；如果检测到火焰目标，则发送信号至单片机，单片机发送停止指令停止车体并通过蜂鸣器进行警报。其火焰检测装置采用fdui-2000型火焰探测器，设有检测火焰特有紫外波长和红外波长的紫外传感器和红外传感器，组成红紫外复合型火焰探测器。通过内部电路中智能芯片处理器运算准确快速探测火焰，具备了极强的抗干扰能力、高灵敏度和高稳定性，其火焰检测系统的安装位置与检测范围如图8所示。