一种基于预规划路径优化RRT算法的三维避障航迹规划方法

摘要

本发明涉及一种基于预规划路径优化RRT算法的三维避障航迹规划方法，该方法包括以下步骤：步骤1：在障碍物膨胀规则和起点到终点连线与障碍物相交规则下生成预规划路径；步骤2：针对预规划路径从其中通过提取得到RRT搜索树的随机状态点；步骤3：RRT搜索树由起点沿着预规划路径上的随机状态点进行扩展，直至终点，生成避障轨迹。与现有技术相比，本发明提前生成的预规划路径可强化RRT扩展树搜索的连贯性，减少障碍物碰撞检测的时间；预规划路径上生成的连续质点作为搜索树在扩展中的随机状态点，可使搜索树的扩展具有方向性，进而减少避障搜索的时间，提高无人机避障规划的效率。