一种基于滚动优化人工物理混合的编队控制器的构建方法
【技术领域】
[0001] 本发明是一种基于滚动优化人工物理混合的编队控制器的构建方法，属于无人机
技术领域。
【背景技术】
[0002] 无人机是一种由动力驱动、可重复使用、机上无人驾驶的飞行器。与有人飞机相 比，由于具有高机动、低成本和"零人员伤亡"等一系列特点，在高危战场环境执行作战任务 时，无人机相比于有人机能够体现出更巨大的优势。目前，无人机已被广泛应用于情报侦 察、目标捜索跟踪W及对地目标攻击等各种作战任务中，并在其中发挥了重大的作用。
[0003] 无人机编队飞行，就是将多架无人机按照一定的队形进行排列，并使其在整个飞 行过程中保持队形不变。机群中的所有飞机都要在执行任务时根据面临的具体情况来分担 各自的任务。无人机编队协调飞行可W提高执行任务的成功率和抗突发事件的能力，在侦 察、干扰W及对地攻击等方面具有单机无法比拟的优势。特别是无人机紧密编队飞行，更是 执行无人机空中加油等任务中需要的关键技术。
[0004] 滚动优化是一种不断在有限时域内求解离散时间优化问题W获得开环控制输入 的方法，目前在复杂大工业生产过程中取得了广泛应用。滚动优化方法的基本思想如下：在 每一个采样时刻，系统控制器求解一个有限时域的优化问题，从而得到当前和未来一段时 间内的一个控制输入序列，而在实施控制作用时，仅执行当前采样时刻或前一小部分的控 制输入，直到下一个采样时刻，基于新的状态观测重复求解有限时域优化问题。滚动优化的 实现原理如图1所示。 阳〇化]人工物理方法是借用物理学原理与方法来构建群智能体的行为如编队、避障、捜 索等。人工物理方法实现简单，实时性好，可通过简单的局部配合完成复杂的控制任务。人 工物理方法通过虚拟物理力使得多无人机系统达到要求的状态，而运种状态是一种势能最 小的状态。人工物理方法基本思想是：无人机只受到其周围一定范围内的其他无人机的影 响，它的下一步行动将取决于运些邻接的无人机对它的作用。
【发明内容】
[0006] 1、发明目的：
[0007] 本发明提出了一种基于滚动优化人工物理混合的编队控制器的构建方法，其目的 是提供一种有效的编队控制器，W降低无人机编队控制的工作难度，并且提高编队飞行的 鲁棒性。
[0008] 该方法利用Matl油控制仿真模型，在控制模型中构建典型的无人机控制模型，通 过仿真得到多无人机系统在编队飞行中的相对距离和速度误差，在此误差基础上构建优化 问题，利用滚动优化人工物理混合方法求解出无人机控制输入。
[0009] 2、技术方案：
[0010] 本发明利用滚动优化人工物理混合方法全局捜索能力强，应用性广等特点，开发 一种滚动优化人工物理混合方法的多无人机编队飞行控制器，该方法的步骤如下：
[0011] 步骤一：搭建无人机Matl油仿真模型
[0012] 本方法中的无人机模型如下式所示： 柳1引
…
[0014] 公式中，Vi表示第i架无人机的飞行速度大小，11) 1表示第i架无人机的偏航角， 矣表示第i架无人机在水平面X轴上的速度分量，矣表示第i架无人机在水平面y轴上的 速度分量，的表示第i架无人机的偏航角速度，表示第i架无人机的偏航角变化率，Wmax,, 表示第i架无人机的最大转弯角速度。
[0015] 步骤二：初始化滚动优化人工物理混合方法初始参数
[0016] (1)初始化预测窗口长度P
[0017] 本方法中预测窗口长度P为滚动优化方法中的参数，可W根据无人机编队控制器 的形式不同而改变。
[0018] (2)初始化执行窗口长度M
[0019] 执行窗口长度M对编队效果影响很大。一般执行窗口长度的选择为预测窗口长度 P的一半。
[0020] (3)初始化人工物理方法引力参数G
[0021] 引力参数G应用在人工物理方法中，它影响无人机编队距离。
[0022] (4)初始化人工物理方法感知范围R
[0023] 感知范围R表示无人机之间能感知到的范围，根据具体的无人机数量来确定。
[0024] 步骤=:设计人工物理力函数
[00巧]人工物理力函数的设定在编队控制中十分关键，它的设定直接影响编队效果。本 方法中，人工物理力采用与万有引力相似的形式。因此定义如下的人工物理力函数：
[0026] F=G/r似
[0027] 其中，F为无人机受到的作用力，G为设定的人工物理方法引力参数G，r为无人机 之间的相对距离。人工物理方法整体流程图如图2所示。
[0028] 步骤四：在Matl油中设置无人机初始参数
[0029] 将无人机的初始参数写入Matl油相应模块，在模块的初始化函数中载入写有无 人机初始参数的.mat文件。将滚动优化人工物理混合方法中的参数传递给Matl油模块， 在无人机模型中写入定义好的初始参数变量名。
[0030] 步骤五：利用滚动优化人工物理方法进行编队控制
[0031] 利用初始化的无人机位置和速度，根据公式F=G/r2 (2)中的公式计算出所有 无人机在飞行中受到的作用力，计算所需的控制输入量，将该控制输入量作用在无人机模 型上，根据公5
[0032] 中的无人机模型计算无人机新的速度和偏航角，并反复应用滚动优化人工物理混 合方法进行寻优，更新无人机当前的位置。
[0033] 步骤六：储存结果并验证
[0034] 无人机编队飞行的位置和速度被视为最终的控制结果，将此结果保存在.mat文 件中，在Matlab模块中调用该.mat文件进行仿真，观察无人机在滚动优化人工物理混合方 法的作用下实现编队控制的结果。若对结果不满意，可W调整编队控制器所设置的初始参 数，重新启动算法进行控制，直到得到满意的控制结果。 阳0对 3、优点及效果：
[0036] 本发明提出了一种基于滚动优化人工物理混合的编队控制器的构建方法，其目的 是提供一种有效的编队控制器，W降低无人机编队控制的工作难度，并且提高编队飞行的 鲁棒性。该方法利用Matlab控制仿真模型，在控制模型中构建典型的无人机控制模型，通 过仿真得到多无人机系统在编队飞行中的相对距离和速度误差，在此误差基础上构建优化 问题，利用滚动优化人工物理混合方法求解出无人机控制输入。在不同的情况下，对编队控 制的队形需求不同，可W通过修改滚动优化人工物理方法的初始参数快速地设计出满足要 求的编队控制效果，减轻设计人员工作负担。
【附图说明】
[0037] 图1滚动优化实现原理示意图。
[0038] 图2人工物理方法整体流程图。
[0039] 图3滚动优化人工物理混合方法无人机编队结果图。 W40] 图中标号及符号说明如下： W41] k--第k时刻 阳0创 U似--第k时刻的控制输入量
[0043] N一一不满足条件（否）
[0044] Y-满足条件（是）
[0045] j-无人机编号
[0046] UAV,--第i架无人机
[0047] 0一一无人机前进方向之间的夹角 W48] r一一无人机之间的距离
[0049] R--人工物理方法感知范围 阳化0] N-一无人机总数
【具体实施方式】