一种基于理想流体数值计算的无人机三维航路规划方法

摘要

本发明公开了一种基于流体力学的无人机三维航路生成方法，属于航路规划领域，本发明首先计算得到沿X轴来流方向，位于原点的圆球障碍绕流流线，利用旋转平移矩阵得到平面中任意来流方向与任意障碍位置的绕流流线，根据流线是否满足部分重合条件采用两种方式将所有的流线合并成一条流线，之后根据无人机约束对三维流线进行处理得到无人机三维航路。本发明借鉴了自然界流水能够避开岩石的现象，将流体计算与航路规划相结合，同时考虑无人机飞行约束，在地形较为复杂时，能够规划出光滑且易于飞行的三维飞行避障航路。本发明地形建模简单，计算量小，满足无人机约束，实现方便。