[发明专利]一种非传统欧式距离场的四旋翼无人机轨迹规划方法

摘要

本发明公开了一种非传统欧式距离场的四旋翼无人机轨迹规划方法。包括以下步骤：首先忽略初始轨迹与障碍物的碰撞，建立仅满足端点约束的标准B样条曲线，同时对每一个在当前碰撞段中控制点赋予一个锚点，利用增强RRT*算法得到原本在障碍物里面的轨迹的无碰撞路径并计算罚函数的碰撞项罚函数，并用此来估计梯度信息；利用无碰撞路径和罚函数计算无碰撞轨迹；判断该轨迹是否满足动力学约束，若不满足则对初始轨迹进行时间重新分配操作；通过重新分配的时间和构造的曲线拟合项的作用，生成满足动力学约束且能够高度拟合原来轨迹的B样条曲线。本发明方法可以大大减少规划无人机轨迹时的计算量，并且提高了轨迹计算的准确性，减少无人机飞行时的碰撞情况。