摘要

为提高多无人机(Unmanned aerial vehicles, UAV)协同轨迹规划(Cooperative trajectory planning, CTP)效率,在解耦序列凸优化(Sequential convex programming, SCP)方法基础上,提出一种高效求解凸优化子问题的定制内点法.首先引入松弛变量,构建子问题的等价描述形式,并推导该形式下的子问题最优性条件.然后在预测-校正原对偶内点法的框架下,构建一套高效求解最优性条件方程组的计算流程以降低子问题计算复杂度,并利用约束矩阵特征提出一种快速计算原对偶搜索方向的方法以提高规划效率.仿真结果表明,在解耦序列凸优化框架下,定制内点法可将协同轨迹规划耗时降低一个数量级,达到秒级.