基于障碍物地图双向搜索的无人机路径规划系统及方法技术方案

本发明专利技术公开了基于障碍物地图双向搜索的无人机路径规划系统及方法，对电力走廊范围内的三维激光点云数据进行预处理，并按照无人机飞行用到的导航定位坐标系对三维激光点云数据的坐标系进行统一；对预处理后的电力走廊三维激光点云进行分割处理；对分割处理后的三维激光点云进行投影降维，生成电力走廊障碍物栅格地图；以所述电力走廊障碍物栅格地图为基础，采用双向随机采样快速拓展随机树算法进行无人机路径搜索，得到无人机电力巡线规划路径；对无人机电力巡线规划路径进行平滑和简化，获得优化后的无人机飞行规划路径。通过构建三维激光点云障碍物栅格地图方式，降低计算数据量，实现对无人机安全高效率飞行路径规划实现。实现。实现。

【技术实现步骤摘要】
基于障碍物地图双向搜索的无人机路径规划系统及方法


[0001]本专利技术涉及无人机安全飞行与电网
，具体涉及一种基于障碍物地图双向搜索的无人机路径规划系统及方法。

技术介绍

[0002]相比传统电力巡检方式，无人机电力巡线可以在作业难度较大的崇山峻林和深山老林、江河湖泊之间轻松实现作业，可以较好地突破人力巡检及载人直升机巡检的局限，不仅更加高效和更加安全。无人机电力巡线针对输电线路实时监控检查电力故障，提高输电线路巡检的安全、效率及智能化水平。随着技术的成熟，无人机将成为输电网巡线更为有效的工具，无人机合理配置资源、提高电力巡检总效率的优势将不断显现，在电网安全运营领域具有广泛的应用前景。
[0003]无人机电力巡线首先需要解决其安全飞行的问题，各种无人机电力巡线系统都具备巡线任务规划功能，如何根据线路走向、各种设施分布、巡线走廊中的地理环境快速规划出安全飞行的路径，是无人机安全、高效电力巡线的首要问题。无人机飞行路径规划通常利用测区的卫星影像图和地形图，设置一个高于飞行区最高高度的飞行高度进行航线规划，这种方法飞行效率低，且存在安全隐患。另一方面，由于飞行高度是固定的，随着地形及周边走廊环境起伏不定，被巡线对象，如电力线、杆塔、电力设施、树障等地物的地面分辨率差异大，影响着巡线结果分析的准确性。

技术实现思路

[0004]本专利技术的目的就是要提供一种基于障碍物地图双向搜索的无人机路径规划系统及方法，利用电力走廊已有的三维激光点云数据，对三维点云进行分割和投影，得到电力走廊障碍物栅格地图，进一步根据走廊障碍物栅格地图采用改进的快速拓展随机树搜索路径，最后对路径进行平滑优化，实现无人机巡线安全路径规划和优化。本专利技术将电力走廊三维激光点云转换为障碍物栅格地图，实现顾及走廊地形与空间环境的无人机巡线安全路径规划，可提高无人机电力巡线路径规划的效率和安全性，实现无人机巡线路径优化，在电网线路检修、公共安全管理、防灾减灾等领域具有广阔的应用前景。
[0005]为实现此目的，本专利技术所设计的基于障碍物地图双向搜索的无人机路径规划系统，包括激光点云分割处理模块、激光点云投影模块、双向搜索路径模块；所述激光点云分割处理模块用于对电力走廊三维激光点云进行分割处理；所述激光点云投影模块用于对分割处理后的三维激光点云进行投影降维，生成电力走廊障碍物栅格地图；所述双向搜索路径模块以所述激光点云投影模块生成的电力走廊障碍物栅格地图为基础，采用双向随机采样快速拓展随机树算法进行无人机路径搜索，得到无人机电力巡线规划路径。
[0006]一种基于障碍物地图双向搜索的无人机路径规划方法，它包括如下步骤：
[0007]步骤1，对电力走廊三维激光点云进行分割处理；
[0008]步骤2，对分割处理后的三维激光点云进行投影降维，生成电力走廊障碍物栅格地
图；
[0009]步骤3，以所述电力走廊障碍物栅格地图为基础，采用双向随机采样快速拓展随机树算法进行无人机路径搜索，得到无人机电力巡线规划路径。
[0010]本专利技术的有益效果为：
[0011]1)本专利技术提出了一套基于激光点云障碍物栅格地图双向搜索的无人机电力巡线安全路径规划方法和技术流程，通过构建三维激光点云障碍物栅格地图方式，降低计算数据量，提高无人机飞行效率，实现对无人机安全高效率飞行路径规划。
[0012]2)本专利技术根据顾及电力走廊三维地形及周边走廊环境起伏的障碍物栅格地图进行路径规划，可以实现可变航高的无人机飞行路径规划，实现无人机电力巡线对象稳定的地面分辨率，提高电力巡线分析结果的准确性。
[0013]3)本专利技术提出的双向快速拓展随机树路径搜索算法能够进一步提高无人机路径规划的效率和准确性。
附图说明
[0014]图1为本专利技术系统结构图；
[0015]图2为本专利技术方法流程图；
[0016]其中，1
‑
激光点云预处理模块、2
‑
激光点云分割处理模块、3
‑
激光点云投影模块、4
‑
双向搜索路径模块、5
‑
路径优化模块。
具体实施方式
[0017]以下结合附图和具体实施例对本专利技术作进一步的详细说明：
[0018]一种基于障碍物地图双向搜索的无人机路径规划系统，如图1所示，包括激光点云预处理模块1、激光点云分割处理模块2、激光点云投影模块3、双向搜索路径模块4和路径优化模块5；所述激光点云预处理模块1用于对电力走廊范围内的三维激光点云数据进行预处理，并按照无人机飞行用到的导航定位坐标系对三维激光点云数据的坐标系进行统一，获得预处理后的三维激光点云数据；所述激光点云分割处理模块2用于对预处理后的电力走廊三维激光点云进行分割处理；所述激光点云投影模块3用于对分割处理后的三维激光点云进行投影降维，生成电力走廊障碍物栅格地图；所述双向搜索路径模块4以所述激光点云投影模块3生成的电力走廊障碍物栅格地图为基础，采用双向随机采样快速拓展随机树算法进行无人机路径搜索，得到无人机电力巡线规划路径；所述路径优化模块5用于对所述双向搜索路径模块4获得的无人机电力巡线规划路径进行平滑和简化，获得优化后的无人机飞行规划路径。
[0019]上述技术方案中，所述激光点云预处理模块1的实现方法包括以下步骤：
[0020]步骤1.1，搜集无人机飞行区域电力走廊数据获取时间最近的巡线三维激光点云数据；搜集所述三维激光点云数据的特征指标包括：一是所述三维激光点云数据的时效性不超过设定年限，本实施方案优选为两年；二是所述三维激光点云数据的激光点云密度不低于设定点云密度，本实施方案优选为1个点/平方米；
[0021]步骤1.2，对步骤1.1获得的三维激光点云数据进行滤波去噪，去除飞点，并按照无人机巡线区域范围对三维激光点云数据进行裁剪输出；
[0022]步骤1.3，将所述三维激光点云数据的坐标系转换到无人机飞行导航定位坐标系，通常该坐标系采用卫星导航定位坐标系，本专利技术中采用WGS84坐标系。
[0023]上述技术方案中，所述激光点云分割处理模块2对预处理后的电力走廊三维激光点云进行分割与对象分类，对电力走廊范围内的障碍物点云对象进行标注标识，为路径规划避障奠定基础，其具体实现方法包括以下步骤：
[0024]步骤2.1，采用体素栅格滤波方法对所述激光点云预处理模块1输出的三维激光点云数据进行降采样处理，以减少数据量，提高数据处理效率；
[0025]步骤2.2，采用移动最小二乘方法对步骤2.1输出的三维激光点云数据中孤立于点云主体的离群点进行平滑处理，从而剔除噪声点；
[0026]步骤2.3，对步骤2.2输出的三维激光点云数据进行RANSAC分割，得到不同类型的分割点云对象；
[0027]步骤2.4，对步骤2.3输出的分割点云对象按照欧式距离进行聚类，构建电力走廊障碍物对象点云集。
[0028]上述技术方案中，所述激光点云分割处理模块2的步骤2.1中对三维激光点本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于障碍物地图双向搜索的无人机路径规划系统，其特征在于：它包括激光点云分割处理模块(2)、激光点云投影模块(3)和双向搜索路径模块(4)；所述激光点云分割处理模块(2)用于对电力走廊三维激光点云进行分割处理；所述激光点云投影模块(3)用于对分割处理后的三维激光点云进行投影降维，生成电力走廊障碍物栅格地图；所述双向搜索路径模块(4)以所述激光点云投影模块(3)生成的电力走廊障碍物栅格地图为基础，采用双向随机采样快速拓展随机树算法进行无人机路径搜索，得到无人机电力巡线规划路径。2.基于权利要求1所述的基于障碍物地图双向搜索的无人机路径规划系统，其特征在于：它还包括激光点云预处理模块(1)和路径优化模块(5)；所述激光点云预处理模块(1)用于对电力走廊范围内的三维激光点云数据进行预处理，并按照无人机飞行用到的导航定位坐标系对三维激光点云数据的坐标系进行统一，获得预处理后的三维激光点云数据；所述激光点云预处理模块(1)获得的三维激光点云数据输入至所述激光点云分割处理模块(2)；所述路径优化模块(5)用于对所述双向搜索路径模块(4)获得的无人机电力巡线规划路径进行平滑和简化，获得优化后的无人机飞行规划路径。3.基于权利要求2所述的基于障碍物地图双向搜索的无人机路径规划系统，其特征在于：所述激光点云预处理模块(1)的实现方法包括以下步骤：步骤1.1，搜集无人机飞行区域电力走廊数据获取时间最近的巡线三维激光点云数据；搜集所述三维激光点云数据的特征指标包括：一是所述三维激光点云数据的时效性不超过设定年限；二是所述三维激光点云数据的激光点云密度不低于设定点云密度；步骤1.2，对步骤1.1获得的三维激光点云数据进行滤波去噪，去除飞点，并按照无人机巡线区域范围对三维激光点云数据进行裁剪输出；步骤1.3，将所述三维激光点云数据的坐标系转换到无人机飞行导航定位坐标系。4.基于权利要求1所述的基于障碍物地图双向搜索的无人机路径规划系统，其特征在于：所述激光点云分割处理模块(2)的实现方法包括以下步骤：步骤2.1，采用体素栅格滤波方法对所述激光点云预处理模块(1)输出的三维激光点云数据进行降采样处理；步骤2.2，采用移动最小二乘方法对步骤2.1输出的三维激光点云数据中孤立于点云主体的离群点进行平滑处理；步骤2.3，对步骤2.2输出的三维激光点云数据进行RANSAC分割，得到不同类型的分割点云对象；步骤2.4，对步骤2.3输出的分割点云对象按照欧式距离进行聚类，构建电力走廊障碍物对象点云集。5.基于权利要求4所述的基于障碍物地图双向搜索的无人机路径规划系统，其特征在于：所述激光点云分割处理模块(2)的步骤2.1中对三维激光点云数据进行降采样处理的特征指标为：采用体素栅格滤波方法时，以体素栅格重心作为对体素激光点云的简化；体素网格大小取无人机外接包围盒最大边长；所述激光点云分割处理模块(2)的步骤2.3中进行RANSAC分割的过程使用到的特征指标包括：RANSAC算法判断样本是否满足模型的误差容忍度值取不低于设定阈值；所述激光点云分割处理模块(2)的步骤2.4中进行聚类的过程使用到的特征指标包括：
一是聚类设定的距离阈值取所述体素栅格滤波方法中体素网格大小的二分之一；二是在聚类过程中使用基于KD
‑
Tree近邻搜索方法。6.基于权利要求1所述的基于障碍物地图双向搜索的无人机路径规划系统，其特征在于：所述激光点云投影模块(3)的实现方法包括以下步骤：步骤3.1，设置点云投影参数，所述点云投影参数包括三维点云范围、网格大小和投影方向；步骤3.2，根据点云投影参数生成栅格地图，所述栅格地图像素全部初始化为零；步骤3.3，从栅格地图的第一行第一列像素开始，根据像素对应的网格范围对电力走廊点云进行遍历，若存在步骤2中障碍物点云对象，该像...

【专利技术属性】
技术研发人员：龚浩，芦竹茂，杨虹，胡晓岑，杨罡，吴驰，阴崇智，胡庆武，李加元，连建华，刘永鑫，韩钰，赵亚宁，孟晓凯，白洋，张光炜，吴念，别士光，柯贤彬，郭潇，
申请(专利权)人：国网山西省电力公司电力科学研究院国网电力科学研究院有限公司武汉大学国网四川省电力公司电力科学研究院国家电网有限公司，
类型：发明
国别省市：