CN109240290A - 一种电力巡检机器人返航路径确定方法 - Google Patents

Abstract

本发明公开了一种电力巡检机器人返航路径确定方法。该方法为：构建室外变电站环境的拓扑地图；规划电力巡检机器人运行路径与停靠点，规划主干路线与非干路点，将主干路线信息储存在工控机中；将返航路径设计为第一、第二返航路径两部分返航路径，第一返航路径为优化后的从非干路点返回主干路点的返航路线，第二返航路径为最优的从主干路点返回充电屋的返航路线；当电力巡检机器人进入返航模式且位于非干路点时，机器人基于预先记录的运动轨迹规划第一返航路径；机器人位于主干路点时即根据所在的主干路线信息，选取最优预存路线作为第二返航路线进行返航。本发明使得巡检机器人在通讯故障情况下能够自主返航，提高了返航的快速性、安全性与有效性。

Description

一种电力巡检机器人返航路径确定方法

技术领域

本发明涉及巡检机器人自主导航技术领域，特别是一种电力巡检机器人返航路径确定方法。

背景技术

随着社会的进步，各行各业的发展都离不开电力***的安全运行，因此电力工业在生产生活中的地位至关重要。为了保证电力设备的稳定与安全运行，需要定期对其进行巡视检查。由于人工巡检存在劳动强度大、工作环境恶劣、工作效率低下等问题，电力巡检机器人应运而生。在室外大型变电站的环境下，电力巡检机器人可以通过自主导航定位对电力设备进行自主巡检，并且可以通过图像处理技术对数据信息进行智能分析，其市场应用前景十分广泛。

电力机器人在室外执行任务的过程中，由于会受到外界磁场环境的干扰或遭遇突发情况而出现通信中断的情况，此时电力机器人无法接收到来自于终端的任务指令，陷入停滞状态而无法继续执行任务。因此，在该情况下，机器人必须能够自主规划一条返航路径返回原点，以保证后续工作可以正常进行。

目前，电力机器人返航方法多为原路返回或根据当前点选择最近路线返回。由于机器人在之前的巡检过程会经过多个任务点，原路返回方法容易出现绕远的情况，效率较低；根据当前点选择最近路线的方法需要进行全局路径规划，计算量大，不适用于大型变电站道路复杂的情况。综上，现有的电力巡检机器人返航路径确定方法存在返回路径冗长快速性不好、对于复杂道路环境适应性差的问题。

发明内容

本发明的目的在于提供一种电力巡检机器人返航路径确定方法，使得巡检机器人在通讯故障情况下能够自主返航，同时提高返航的快速性、安全性与有效性。

实现本发明目的的技术解决方案为：一种电力巡检机器人返航路径确定方法，包括以下步骤：

步骤1、根据室外变电站环境构建成拓扑地图；

步骤2、根据拓扑地图，规划电力巡检机器人的运行路径与停靠点，规划主干路线与非干路线、主干路点与非干路点，并且预先在电力巡检机器人的工控机中储存所有主干路线信息；

步骤3、电力巡检机器人通讯中断后超过故障时间，电力巡检机器人进入返航模式；电力巡检机器人返航分为第一返航路径和第二返航路径两个部分进行，第一返航路径为优化后的从非干路点返回主干路点的返航路线，第二返航路径为最优的从主干路点返回充电屋的返航路线。

作为一个具体示例，步骤1所述的根据室外变电站环境构建成拓扑地图，具体为：

激光导航***利用电力巡检机器人自身携带的激光测距传感器和里程计，构建特征稀疏环境的二维地图，然后将地图环境抽象为拓扑地图。

作为一个具体示例，步骤2所述的根据拓扑地图，规划电力巡检机器人的运行路径与停靠点，规划主干路线与非干路线、主干路点与非干路点，并且预先在电力巡检机器人的工控机中储存所有主干路线信息，具体为：

步骤2-1、规划电力巡检机器人的运行路径与停靠点；

将电力巡检机器人运行路径简化为直线路径，并在运行路径上设置停靠点；停靠点分为关键点与巡检点：关键点为电力巡检机器人能够更改运动方向位置，可完成执行、转弯、掉头动作的点；巡检点为电力巡检机器人停靠并执行变电站设备检测的点；

检测任务完成之后运行到下一个停靠点；

步骤2-2、将机器人通行畅通且关键的运行路线设置为主干路线，其余路线为非干路线；将主干路线上的关键点定义为主干路点，其余所有路线中的点定义为非干路点；将充电屋设置为主干路点，且设置为主干路线的一个端点；

步骤2-3、预先在电力巡检机器人的工控机中储存所有主干路线信息，由于主干路线由一系列主干路点组成，主干路线表示为主干路点坐标序列。

作为一个具体示例，步骤3电力巡检机器人通讯中断后超过故障时间，电力巡检机器人进入返航模式；电力巡检机器人返航分为第一返航路径和第二返航路径两个部分进行，具体为：

步骤3-1、电力巡检机器人通过激光定位***获得当前的位置点信息，然后对自身的位置点信息进行判断，若当前点为主干路点，则进入步骤3-2直接完成第二返航路径；若当前点为非干路点，则先规划第一返航路径，完成从非干路点退回主干路点的过程；

步骤3-2、电力巡检机器人当前位置点为主干路点时，电力巡检机器人根据所在主干路点信息，从预存路线中规划出最优的第二返航路径，按路线返航至充电屋；

***通过查询主干路线路径信息，判断当前主干路点所处的主干路线位置，若当前主干路点位于多条主干路线时，则计算当前主干路点通过不同主干路线返回的路线长度，然后选择距离最短的作为第二返航路径。

作为一个具体示例，步骤3-1中所述的若当前点为非干路点，则先规划第一返航路径，具体为：

步骤3-1-1、***通过路径栈查找历史运行记录，确定电力巡检机器人所需退回的主干路点；

机器人在正常行驶过程中，记录自身的前进运行路径，储存方式为栈储存，即将路经的停靠点坐标储存在路径栈中，先进后出，所以栈顶为当前点，栈底为充电屋坐标；***不断循环从该栈中取出一个坐标点判断其是否为主干路点，一旦查找到一个主干路点时即跳出循环，该主干路点即为机器人所需退回的主干路点；

步骤3-1-2、将机器人从当前非干路点按照历史运行记录返回至主干路点的路线作为第一返航路径，并对第一返航路径进行优化，具体为：根据第一返航路径先确定该返航路径上各个非干路点的连通关系，以距离权值建立无向图，利用Dijkstra算法规划出由当前非干路点返回至返航主干路点的最优第一返航路径。

本发明与现有技术相比，具有以下显著优点：(1)无需实时控制，可以有效防止在通信中断的情况下巡检机器人陷入停滞状态的问题，提高了电力巡检机器人工作的稳定性；(2)无需查找过多的数据或进行复杂计算，从而提高了快速性，可行性更高；(3)提出了一种基于Dijkstra算法的第一返航路径优化方法，有效的去除了重复冗余路段；(4)提出了一种通过基于预储存主干路线规划第二返航路径的方法，避免了机器人经过曲折复杂的路段，保证了机器人行进时的安全性；(5)方法简单，计算量小，内存占用率低，可行性高，快速性好，既可以选择相对较短路径，又可以保证***的安全性与可靠性。

附图说明

图1为本发明电力巡检机器人返航路径确定方法的流程图。

图2为本发明实施例中的电力巡检机器人返航路径规划示意图。

具体实施方式

下面将参考附图并结合具体实施例来对本发明进行详细说明。

结合图1，本发明电力巡检机器人返航路径确定方法，包括如下步骤：

步骤1、根据室外变电站环境构建拓扑地图。

激光导航***利用电力巡检机器人自身携带的激光测距传感器和里程计，构建特征稀疏环境的二维地图，然后将地图环境抽象为拓扑地图。

步骤2、如图2所示，根据拓扑地图，规划电力巡检机器人的运行路径与停靠点，规划主干路线与非干路线、主干路点与非干路点，并且预先在电力巡检机器人的工控机中储存所有主干路线信息，具体方法如下：

步骤2-1、规划电力巡检机器人的运行路径与停靠点；

由于变电站内巡检路线中的路径绝大多数是直线，将机器人运行路径简化为直线路径，并在在运行路径上设置停靠点；停靠点分为关键点与巡检点：关键点为机器人可以更改运动方向位置，可完成执行、转弯、掉头等动作的点，如十字路口，直角路口，T字路口等；巡检点为电力巡检机器人停靠并执行变电站设备检测的点；

检测任务完成之后运行到下一个停靠点。

步骤2-2、将易于机器人通行且关键的运行路线设置为主干路线，其余路线为非干路线；将主干路线上的关键点定义为主干路点，其余所有路线中的点定义为非干路点。

优选地，在所述步骤2-2中，将充电屋设置为主干路点，且设置为主干路线的一个端点。

步骤2-3、预先在电力巡检机器人的工控机中储存所有主干路线信息，由于主干路线由一系列主干路点组成，主干路线可表示为主干路点坐标序列。

步骤3、电力巡检机器人通讯中断后超过故障时间，电力巡检机器人进入返航模式；巡检机器人返航分为第一返航路径和第二返航路径两个部分进行，第一返航路径为优化后的从非干路点返回主干路点的返航路线，第二返航路径为最优的从主干路点返回充电屋的返航路线，具体如下：

在通信中断的情况下，电力巡检机器人线将等待5分钟即通讯故障时间，当超过时间点电力巡检机器人进入返航模式执行返航；巡检机器人返航分为第一返航路径和第二返航路径两个部分进行，第一返航路径为优化后的从非干路点返回主干路点的返航路线，第二返航路径为最优的从主干路点返回充电屋的返航路线。

步骤3-1、电力巡检机器人通过激光定位***获得当前的位置点信息，然后对自身的位置点信息进行判断，若当前点为主干路点，则进入步骤3-2直接完成第二返航路径；若当前点为非干路点，则先规划第一返航路径，完成从非干路点退回主干路点的过程；

结合图1，电力巡检机器人规划第一返航路径的具体方法为：

步骤3-1-1、***通过路径栈查找历史运行记录并且确定电力巡检机器人所需退回的主干路点；

由于机器人在正常行驶过程中，会记录自身的前进运行路径，储存方式为栈储存，即将路经的停靠点坐标储存在路径栈中，先进后出，所以栈顶为当前点，栈底为充电屋坐标；***会不断循环从该栈中取出一个坐标点判断其是否为主干路点，一旦查找到一个主干路点时即跳出循环，该主干路点即为机器人所需退回的主干路点。

通过栈储存路径的存储方式，可以保证机器人能够通过查询运行记录快速地确定所需返回的干路点。由于地图上的停靠点数量较多且地图上的运行路线曲折复杂，通过该方式无需查找过多的数据或进行复杂计算，从而提高了快速性，可行性更高。

步骤3-1-2、将机器人从当前非干路点按照运行记录返回至主干路点的路线作为第一返航路径，并对第一返航路径进行优化；

由于电力巡检机器人在返航之前会执行多个巡检任务，从而多次经过同一个停靠点，按照原路返回主干路点会存在路线重复冗余的情况，因此需要优化第一返航路径；根据第一返航路径先确定该返航路径上各个非干路点的连通关系，以距离权值建立无向图，利用Dijkstra算法，规划出由当前非干路点返回至返航主干路点的最优第一返航路径。

Dijkstra算法可以优化路径，有效的去除重复冗余路段，避免路线的重复性，提高机器人返航的快速性。

步骤3-2、电力巡检机器人当前位置点为干路点时，机器人根据所在主干路点信息，从预存路线中规划出最优的第二返航路径，按路线返航至充电屋；

***通过查询主干路线路径信息，判断当前主干路点所处的主干路线位置，若当前主干路点位于多条主干路线时，则计算当前点通过不同主干路线返回的路线长度，然后选择距离最短的作为第二返航路径。

如图2中所示，若电力巡检机器人从主干路点A进入支路线沿着路线A→B→C→D→E→D→F进行巡检任务，于非干路点F处通信中断进行返航，则先将F→D→E→D→C→B→A作为第一返航路径，然后优化第一返航路径按照F→D→C→B→A路线进行返航；到达主干路点A后，按照预存主干路线从主干路点A返回充电屋O点，完成第二返航路径。

综上可知，本发明电力巡检机器人返航路径确定方法，无需实时控制，可以有效防止在通信中断的情况下巡检机器人陷入停滞状态的问题，提高了电力巡检机器人工作的稳定性；无需查找过多的数据或进行复杂计算，从而提高了快速性，可行性更高。本发明方法简单，计算量小，内存占用率低，可行性高，快速性好，既可以选择相对较短路径，又可以保证***的安全性与可靠性。

Claims (5)

1.一种电力巡检机器人返航路径确定方法，其特征在于，包括以下步骤：

步骤1、根据室外变电站环境构建成拓扑地图；

步骤2、根据拓扑地图，规划电力巡检机器人的运行路径与停靠点，规划主干路线与非干路线、主干路点与非干路点，并且预先在电力巡检机器人的工控机中储存所有主干路线信息；

步骤3、电力巡检机器人通讯中断后超过故障时间，电力巡检机器人进入返航模式；电力巡检机器人返航分为第一返航路径和第二返航路径两个部分进行，第一返航路径为优化后的从非干路点返回主干路点的返航路线，第二返航路径为最优的从主干路点返回充电屋的返航路线。

2.根据权利要求1所述的电力巡检机器人返航路径确定方法，其特征在于，步骤1所述的根据室外变电站环境构建成拓扑地图，具体为：

激光导航***利用电力巡检机器人自身携带的激光测距传感器和里程计，构建特征稀疏环境的二维地图，然后将地图环境抽象为拓扑地图。

3.根据权利要求1所述的电力巡检机器人返航路径确定方法，其特征在于，步骤2所述的根据拓扑地图，规划电力巡检机器人的运行路径与停靠点，规划主干路线与非干路线、主干路点与非干路点，并且预先在电力巡检机器人的工控机中储存所有主干路线信息，具体为：

步骤2-1、规划电力巡检机器人的运行路径与停靠点；

将电力巡检机器人运行路径简化为直线路径，并在运行路径上设置停靠点；停靠点分为关键点与巡检点：关键点为电力巡检机器人能够更改运动方向位置，可完成执行、转弯、掉头动作的点；巡检点为电力巡检机器人停靠并执行变电站设备检测的点；

检测任务完成之后运行到下一个停靠点；

步骤2-2、将机器人通行畅通且关键的运行路线设置为主干路线，其余路线为非干路线；将主干路线上的关键点定义为主干路点，其余所有路线中的点定义为非干路点；将充电屋设置为主干路点，且设置为主干路线的一个端点；

步骤2-3、预先在电力巡检机器人的工控机中储存所有主干路线信息，由于主干路线由一系列主干路点组成，主干路线表示为主干路点坐标序列。

4.根据权利要求1所述的电力巡检机器人返航路径确定方法，其特征在于，步骤3电力巡检机器人通讯中断后超过故障时间，电力巡检机器人进入返航模式；电力巡检机器人返航分为第一返航路径和第二返航路径两个部分进行，具体为：

步骤3-1、电力巡检机器人通过激光定位***获得当前的位置点信息，然后对自身的位置点信息进行判断，若当前点为主干路点，则进入步骤3-2直接完成第二返航路径；若当前点为非干路点，则先规划第一返航路径，完成从非干路点退回主干路点的过程；

步骤3-2、电力巡检机器人当前位置点为主干路点时，电力巡检机器人根据所在主干路点信息，从预存路线中规划出最优的第二返航路径，按路线返航至充电屋；

***通过查询主干路线路径信息，判断当前主干路点所处的主干路线位置，若当前主干路点位于多条主干路线时，则计算当前主干路点通过不同主干路线返回的路线长度，然后选择距离最短的作为第二返航路径。

5.根据权利要求4所述的电力巡检机器人返航路径确定方法，其特征在于，步骤3-1中所述的若当前点为非干路点，则先规划第一返航路径，具体为：

步骤3-1-1、***通过路径栈查找历史运行记录，确定电力巡检机器人所需退回的主干路点；

机器人在正常行驶过程中，记录自身的前进运行路径，储存方式为栈储存，即将路经的停靠点坐标储存在路径栈中，先进后出，所以栈顶为当前点，栈底为充电屋坐标；***不断循环从该栈中取出一个坐标点判断其是否为主干路点，一旦查找到一个主干路点时即跳出循环，该主干路点即为机器人所需退回的主干路点；

步骤3-1-2、将机器人从当前非干路点按照历史运行记录返回至主干路点的路线作为第一返航路径，并对第一返航路径进行优化，具体为：根据第一返航路径先确定该返航路径上各个非干路点的连通关系，以距离权值建立无向图，利用Dijkstra算法规划出由当前非干路点返回至返航主干路点的最优第一返航路径。