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

摘要

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