[发明专利]一种无人机最小时间平滑轨迹生成方法

摘要

本发明公开了一种无人机最小时间平滑轨迹生成方法，包括：将无人直升机的轨迹定义为在n‑1个时间区间内分段光滑的m阶多项式；对分段边界和相应时间处给出数量和端点约束，并给出初始终止条件；根据所述n‑1个时间区间内分段光滑的m阶多项式、所述数量和端点约束、以及所述初始终止条件求解最小时间优化问题，以得到最小时间约束的飞行轨迹；对所述飞行轨迹加入姿态约束以完成相应动作。本发明具有如下优点：提升无人机的飞行轨迹平滑度和时间效率。

主权项

1.一种无人机最小时间平滑轨迹生成方法，其特征在于，包括以下步骤：S1：将无人直升机的轨迹定义为在n‑1个时间区间内分段光滑的m阶多项式；S2：对分段边界和相应时间处给出数量和端点约束，并给出初始终止条件；S3：根据所述n‑1个时间区间内分段光滑的m阶多项式、所述数量和端点约束、以及所述初始终止条件求解最小时间优化问题，以得到最小时间约束的飞行轨迹；S4：对所述飞行轨迹加入姿态约束以完成相应动作；其中，时间节点t＝[t₁ t₂ … t_n‑1]内通过n个航点的优化问题表达如下：subject to f_min≤f_i≤f_maxi＝1，…，4t_j＞0 j＝1，2，…，n‑1其中，轨迹开始于t₀＝0处的第一个航点，决策变量T是无人机分别通过n‑1个剩余航点的时间；在某个节点可以加入特定的姿态约束如下给出惯性坐标下的期望姿态q_des，并算出相应惯性坐标系下的期望加速度将计算出的期望加速度整合并入多项式轨迹的节点约束。