CN108388269A - 基于四旋翼飞行器的无人机编队飞行控制方法 - Google Patents

Abstract

本发明公开了旋翼飞行器的无人机编队飞行控制方法，随机选定其中一个四旋翼为领航者，其余四轴则都是跟随者，跟随者与领航者之间保持着一定的距离与角度，设定在惯性坐标系下的动态方程并然后定义系统误差为，在编队中，首先要给领航者设定一个飞行轨迹，领航者跟踪组成既定轨迹的动点，跟随者的位置是由它与领航者之间的期望相对间距与角度确定，为了让编队中无人机的队形保持稳定，就要服从编队一致性定理，四旋翼编队飞行中保持队形的稳定性的首要条件就是保证每个四旋翼的飞行航向是一样的，在这一前提下，通过调整它们之间横向、纵向的相对距离，使被控的状态参数都趋于一致，实现所需队形。本发明的有益效果是具有良好的编队控制效果。

Description

基于四旋翼飞行器的无人机编队飞行控制方法

技术领域

本发明属于无人机技术领域，涉及基于四旋翼飞行器的无人机编队飞行控制 方法。

背景技术

四旋翼飞行器作为无人机的一种，是无人机领域一个重要的研究方向，有着 体积小、造价低、机动灵活等诸多优势，因此世界各国都更加重视四旋翼的应用， 同时也越来越受到学术界的关注。四旋翼无人机在飞行过程中通过自身的传感器 获取周围环境信息传输给飞行控制器，通过控制四个无刷电机的转速就可以实现 飞行控制，是一个不需要人为干预的自主飞行过程。四旋翼飞行器具有结构简单、 易于操控、运行可靠、安全性高等特点，也可以携带各种拍摄、通讯等设备，有 着很大的应用前景。

四旋翼无人机整个体系结构较为简易，其组成部件主要有呈十字交叉的刚性 支架、四个无刷电机、四个螺旋桨、飞行控制器、多种传感器和惯性测量元件、 电池等。四轴的四个旋翼安设在十字刚性支架的四个顶点，在四个旋翼的顶端， 均匀分布着四个电机，安设在同一条轴上的两个电机为一组，其旋转方向是相同 的。其中1号和3号旋翼为一组，旋转方向是顺时针的；2号和4号旋翼为一组，其 旋转方向是逆时针的。四旋翼的基本工作机制较为简单，若想实现其飞行姿态的 转变以及飞行位置的调整，其关键就是改变四个旋翼的转动速度。显而易见，四 旋翼飞行器的动力系统就只有四个电机就是它的四个执行机，那么它所要控制的 输入对象也是四个，而四旋翼要在空间中实现对航向、高度、前后、左右、横滚、 俯仰六个通道的支配，所以它是一个具有四输入、六输出的欠驱动系统，并且具有很强的耦合性和非线性。

无人机编队控制的研究过程，是一个实践和理论相结合的过程。编队控制这 个概念是专家学者通过长时间的研究分析生物群体的社会性现象有所启发，将生 物的编队行为应用于飞行器上，使得它们可以以群体的方式完成规定的目标。目 前，对于编队控制研究已经扩展到载人飞船、无人机、卫星等领域。

发明内容

本发明的目的在于提供基于四旋翼飞行器的无人机编队飞行控制方法，本发 明的有益效果是具有良好的编队控制效果。

本发明所采用的技术方案是按照以下步骤进行：

步骤1、随机选定其中一个四旋翼为领航者(Leader，以下公式中用L表示)， 其余四轴则都是跟随者(Follower，以下公式中用F表示)，跟随者与领航者之 间保持着一定的距离与角度，在惯性坐标系下的动态方程：

式中——分别为四旋翼横、纵坐标的一阶导数；

v_ix,v_iy——分别为四旋翼飞行速度在x,y轴的分量；

ψ_i——四旋翼的偏航角；

ω_i——四旋翼的偏航角角速度；

步骤2、l代表编队中四旋翼之间的期望相对间距，代表四旋翼之间的期望 相对角度，在领航者坐标系下，l存在以下关系：

式中l_x——l在x轴的投影；

l_y——l在y轴的投影；

ψ_L——领航者的偏航角；

(x_L,y_L)——领航者的位置坐标；

(x_F,y_F)——跟随者的位置坐标；

且有：

步骤3、将式(2)中l_x，l_y对时间t求导，代入式(1)得到：

式中l_x,l_y——分别为l在x,y轴的投影；

——l的一阶导数；

ψ_L——领航者的偏航角；

ω_L——领航者的偏航角角速度；

(x_L,y_L)——领航者的位置坐标；

(x_F,y_F)——跟随者的位置坐标；

v_Lx,v_Ly——分别为领航者飞行速度在x,y轴的分量；

然后定义系统误差为：

式中e_ψ——方向误差；

e_x,e_y——编队位置误差；

ψ_L——领航者的偏航角；

ψ_F——跟随者的偏航角；

——在领航者坐标系下，在x,y方向上Follower与Leader的期望距 离；

编队前设定的期望距离l和期望角度是常量，所以对系统误差进行一阶微 分运算后得到：

式中e_x,e_y——编队位置误差；

e_ψ——方向误差；

l——编队中四旋翼之间的期望相对间距；

——四旋翼之间的期望相对角度；

ω_L,ω_F——分别为领航者与跟随者的偏航角角速度；

v_L,v_F——分别为领航者和领航者的飞行速度；

步骤4、在编队中，首先要给领航者设定一个飞行轨迹，领航者跟踪组 成既定轨迹的动点，跟随者的位置是由它与领航者之间的期望相对间距与角度确 定的，以下给出跟随者的跟踪期望数学表达式：

式中(x_L,y_L)——领航者的位置坐标；

——跟随者的期望位置坐标；

l_x,l_y——分别为l在x,y轴的投影；

ψ_L——领航者的偏航角；

——跟随者的期望偏航角；

ψ^d——领航者与跟随者的偏航角误差；

为了让编队中无人机的队形保持稳定，就要服从编队一致性定理：

式中(x,y)——四旋翼的位置坐标；

l_x,l_y——分别为l在x,y轴的投影；

ψ——四旋翼的偏航角；

ψ^d——领航者与跟随者的偏航角误差；

四旋翼编队飞行中保持队形的稳定性的首要条件就是保证每个四旋翼的飞 行航向是一样的，即满足航向角的一致性ψ_i→ψ_d，在这一前提下，通过调整它 们之间横向、纵向的相对距离，使被控的状态参数都趋于一致，实现所需队形。

附图说明

图1是领航-跟随法的平面示意图；

图2是领航者与跟随者的航向角曲线；

图3是领航者与跟随者的速度曲线。

具体实施方式

下面结合具体实施方式对本发明进行详细说明。

要完成多个四旋翼的编队控制，其本质就是要使两个或者多个四旋翼之间相 互联系，相互关联，然后再使用编队控制器来实现飞行要求，完成既定任务，并 且要时刻保持飞行编队的有序与稳定。编队中每个四旋翼的方位及航姿信息必然 与既定的期望值存在一定的误差，需要通过控制输入量，继而补偿给编队控制器 所控制的各个四旋翼。通过指令的发送，保持四旋翼队列的稳定性，使得每一个 空间飞行器能够在其固定的位置上，沿着期望的运动轨迹进行跟踪。本发明采用 领航-跟随编队控制算法，在编队过程中，跟随者需要采取一定的控制策略跟随 领航者运动。

本发明随机选定其中一个四旋翼为领航者，其余四轴则都是跟随者。跟随者 与领航者之间保持着一定的距离与角度，要想使四旋翼编队队形保持稳定，就要 随时调整它们之间的距离和方向夹角。

本发明通过空间运动模型来定义四旋翼编队的位置信息，简化了传统编队的 复杂性，通过四轴的航向角即(x,y,z,ψ)参数(x,y,z分别为四旋翼在三维坐标系 中所对应的坐标值；ψ为四旋翼的偏航角)来确定整个四旋翼编队的位置和各个 四旋翼之间的航向角和距离。

为了简化问题，假设在编队飞行中四旋翼飞行器的飞行高度是固定且一致 的，图1给出了两架四旋翼的编队示意图。接下来就以两个四轴在同一高度的运 动为例，分析它们在二维空间的运动问题。

本发明给出在惯性坐标系下的动态方程：

式中——分别为四旋翼横、纵坐标的一阶导数；

v_ix,v_iy——分别为四旋翼飞行速度在x,y轴的分量；

ψ_i——四旋翼的偏航角；

ω_i——四旋翼的偏航角角速度。

本发明的控制目标是让跟随者与领航者保持一个距离常量l和一个角度常量 l代表编队中四旋翼之间的期望相对间距，代表四旋翼之间的期望相对角 度，在领航者坐标系下，l存在以下关系：

式中l_x——l在x轴的投影；

l_y——l在y轴的投影；

ψ_L——领航者的偏航角；

(x_L,y_L)——领航者的位置坐标；

(x_F,y_F)——跟随者的位置坐标。

且有：

将式(2)中l_x，l_y对时间t求导，代入式(1)得到：

式中l_x,l_y——分别为l在x,y轴的投影；

——l的一阶导数；

ψ_L——领航者的偏航角；

ω_L——领航者的偏航角角速度；

(x_L,y_L)——领航者的位置坐标；

(x_F,y_F)——跟随者的位置坐标；

v_Lx,v_Ly——分别为领航者飞行速度在x,y轴的分量。

然后定义系统误差为：

式中e_ψ——方向误差；

e_x,e_y——编队位置误差；

ψ_L——领航者的偏航角；

ψ_F——跟随者的偏航角；

——在领航者坐标系下，在x,y方向上Follower与Leader的期望距 离。

因为编队前设定的期望距离l和期望角度是常量，所以对系统误差进行一 阶微分运算后得到：

式中e_x,e_y——编队位置误差；

e_ψ——方向误差；

l——编队中四旋翼之间的期望相对间距；

——四旋翼之间的期望相对角度；

ω_L,ω_F——分别为领航者与跟随者的偏航角角速度；

v_L,v_F——分别为领航者和领航者的飞行速度。

在编队中，首先要给领航者设定一个飞行轨迹，领航者跟踪组成既定轨迹的 动点，跟随者的位置是由它与领航者之间的期望相对间距与角度确定的。以下给 出跟随者的跟踪期望数学表达式：

式中(x_L,y_L)——领航者的位置坐标；

——跟随者的期望位置坐标；

l_x,l_y——分别为l在x,y轴的投影；

ψ_L——领航者的偏航角；

——跟随者的期望偏航角；

ψ^d——领航者与跟随者的偏航角误差。

为了让编队中无人机的队形保持稳定，就要服从编队一致性定理：

式中(x,y)——四旋翼的位置坐标；

l_x,l_y——分别为l在x,y轴的投影；

ψ——四旋翼的偏航角；

ψ^d——领航者与跟随者的偏航角误差。

四旋翼编队飞行中保持队形的稳定性的首要条件就是保证每个四旋翼的飞 行航向是一样的，即满足航向角的一致性ψ_i→ψ_d。在这一前提下，通过调整它 们之间横向、纵向的相对距离，使被控的状态参数都趋于一致，实现所需队形。 仿真实验参数

为了更好的验证上述提到的编队控制策略的可行性，首先对仿真参数进行设 置，然后对基于模型预测控制的编队控制算法进行仿真。

表1领航者与跟随者的初始状态

仿真结果与分析

仿真过程将四旋翼飞行器简化成一个质点，两架四旋翼从不同位置出发，达 到期望队形并保持期望队形飞行。Follower与Leader之间的期望角度期望距离x,y在的分量为l_x＝l_y＝100。

在仿真实验中，领航者与跟随者之间的期望角度领航者与跟随者 之间的目标距离在x,y方向的分量设定为x_C＝100m,y_C＝100m。领航者与跟随者 的初始航向角均为0°，初始速度均为100m/s。

跟随者从初始位置开始追踪领航者，按照已设定的目标距离，它们之间的最 终相对位置保持在[100100]。根据图2可知，编队飞行过程中，在0-40s内领航 者的航向角按正弦曲线变化，40s后航向角保持_0·不变。领航者机动过程中，跟 随者能够跟踪领航者的状态，并且超调量不超过5％；在领航者无机动时，跟随 者能够保持稳态，并且与领航者保持着期望的距离。

由图2、3可知，跟随者在前行的过程中，速度与航向角的变化过程都是先 增大后减小，最终回到额定值，完成了期望角度与期望间距的调整，实现了双四 旋翼的编队飞行。

本发明仿真验证利用Matlab，在设置好仿真实验参数后，分别在无障碍环境 和有障碍环境下进行仿真，给出仿真结果。实验以及仿真结果表明，本论文所提 出的基于差分进化的模型预测控制具有良好的编队控制效果。

以上所述仅是对本发明的较佳实施方式而已，并非对本发明作任何形式上的 限制，凡是依据本发明的技术实质对以上实施方式所做的任何简单修改，等同变 化与修饰，均属于本发明技术方案的范围内。

Claims (1)

1.基于四旋翼飞行器的无人机编队飞行控制方法，其特征在于按照以下步骤进行：

步骤1、随机选定其中一个四旋翼为领航者，其余四轴则都是跟随者，跟随者与领航者之间保持着一定的距离与角度，在惯性坐标系下的动态方程：

式中——分别为四旋翼横、纵坐标的一阶导数；

v_ix,v_iy——分别为四旋翼飞行速度在x,y轴的分量；

ψ_i——四旋翼的偏航角；

ω_i——四旋翼的偏航角角速度；

L表示领航者，L表示跟随者；

步骤2、l代表编队中四旋翼之间的期望相对间距，代表四旋翼之间的期望相对角度，在领航者坐标系下，l存在以下关系：

式中l_x——l在x轴的投影；

l_y——l在y轴的投影；

ψ_L——领航者的偏航角；

(x_L,y_L)——领航者的位置坐标；

(x_F,y_F)——跟随者的位置坐标；

且有：

步骤3、将式(2)中l_x，l_y对时间t求导，代入式(1)得到：

式中l_x,l_y——分别为l在x,y轴的投影；

——l的一阶导数；

ψ_L——领航者的偏航角；

ω_L——领航者的偏航角角速度；

(x_L,y_L)——领航者的位置坐标；

(x_F,y_F)——跟随者的位置坐标；

v_Lx,v_Ly——分别为领航者飞行速度在x,y轴的分量；

然后定义系统误差为：

式中e_ψ——方向误差；

e_x,e_y——编队位置误差；

ψ_L——领航者的偏航角；

ψ_F——跟随者的偏航角；

——在领航者坐标系下，在x,y方向上Follower与Leader的期望距离；

编队前设定的期望距离l和期望角度是常量，所以对系统误差进行一阶微分运算后得到：

式中e_x,e_y——编队位置误差；

e_ψ——方向误差；

l——编队中四旋翼之间的期望相对间距；

——四旋翼之间的期望相对角度；

ω_L,ω_F——分别为领航者与跟随者的偏航角角速度；

v_L,v_F——分别为领航者和领航者的飞行速度；

步骤4、在编队中，首先要给领航者设定一个飞行轨迹，领航者跟踪组成既定轨迹的动点，跟随者的位置是由它与领航者之间的期望相对间距与角度确定的，以下给出跟随者的跟踪期望数学表达式：

式中(x_L,y_L)——领航者的位置坐标；

——跟随者的期望位置坐标；

l_x,l_y——分别为l在x,y轴的投影；

ψ_L——领航者的偏航角；

——跟随者的期望偏航角；

ψ^d——领航者与跟随者的偏航角误差；

为了让编队中无人机的队形保持稳定，就要服从编队一致性定理：

式中(x,y)——四旋翼的位置坐标；

l_x,l_y——分别为l在x,y轴的投影；

ψ——四旋翼的偏航角；

ψ^d——领航者与跟随者的偏航角误差；

四旋翼编队飞行中保持队形的稳定性的首要条件就是保证每个四旋翼的飞行航向是一样的，即满足航向角的一致性ψ_i→ψ_d，在这一前提下，通过调整它们之间横向、纵向的相对距离，使被控的状态参数都趋于一致，实现所需队形。