CN113220022A - 基于事件触发估计信息传输的飞行编队有限时间自适应控制方法 - Google Patents

Abstract

本发明涉及一种基于事件触发估计信息传输的飞行编队有限时间自适应控制方法，属于编队飞行控制领域，针对存在动力学不确定性的多无人机编队飞行控制，主要关注编队内部分无人机估计能力不足和提升系统跟踪控制性能的问题。该方法引入了虚拟领航无人机的协调策略，设定各无人机与领航者的相对位置作为反馈信息，采用反步法和有限时间收敛算法设计控制输入，按照飞行编队队形实现协调轨迹跟踪。采用神经网络估计动力学不确定性，采集在线数据构造预测误差评价估计能力，结合事件触发条件共享编队间的估计信息，应用到自适应更新律中，提升多无人机对模型不确定性的估计能力，降低编队通信压力，提高飞行控制性能。

Description

基于事件触发估计信息传输的飞行编队有限时间自适应控制 方法

技术领域

本发明涉及一种多飞行器跟踪控制方法，特别是涉及一种基于事件触发估计信息传输的飞行编队有限时间自适应控制方法，属于编队飞行控制领域。

背景技术

针对多无人机协同跟踪控制，基于虚拟结构的策略整体描述了群体行为并简化任务描述与分配，能够取得较高的编队控制精度。考虑到无人机系统存在的动力学不确定性和非线性性对编队飞行跟踪性能的影响，利用神经网络逼近能力进行估计的智能控制算法得到了广泛研究。然而现有的飞行控制需要保证编队间无人机都具备估计能力，一旦部分无人机无法保证精确估计而控制性能下降，整体飞行编队将无法保持，研究通信拓扑下的估计信息传输具有重要意义。但是若在编队内持续传输通信信息，将增加编队通信压力产生过多冗余信息。因此为了提升飞行编队控制性能，研究基于事件触发的复合估计策略对编队飞行安全具有重要意义。

《Composite Learning Finite-Time Control With Application toQuadrotors》(B.Xu，《IEEE Transactions on Systems,Man,and Cybernetics:Systems》，2018年，第48卷第10期)针对欠驱动无人机设计有限时间神经网络控制算法，论文研究目标为实现无人机个体对期望轨迹指令的跟踪。《Coordinated Path-Following Control fora Group of Underactuated Surface Vessels》(Ghommam J，Mnif F，《IEEE Transactionson Industrial Electronics》，2009年，第56卷第10期)采用虚拟领航目标设计多智能体协同跟踪控制算法。论文以路径跟随器推导编队内个体的参考路径，同步协调状态实现路径跟踪。然而该论文所设计的控制算法依赖于模型的动力学特性，难以实现系统的快速稳定控制。

发明内容

要解决的技术问题

面向存在动力学不确定性多无人机的编队飞行控制，考虑部分无人机存在估计能力弱的情形，本发明提出一种基于事件触发估计信息传输的飞行编队有限时间自适应控制方法。

技术方案

一种基于事件触发估计信息传输的飞行编队有限时间自适应控制方法，步骤如下：

步骤1：采用无人机的动力学模型：

式中，x,y,z为位置，

为横滚角，θ为俯仰角，ψ为偏航角，m为质量，g为重力加速度，I_x,I_y,I_z为惯性矩阵，l为无人机质心到旋翼中心的距离，J_r为电机转动惯量，ω_r＝ω₂+ω₄-ω₁-ω₃，ω_i为第i个电机的转速，i＝1,2,3,4；U₁,U₂,U₃,U₄分别为垂直、滚转、俯仰、偏航运动的控制输入为：

其中，b为升力系数，d为力矩系数；

步骤2：将无人机动力学模型解耦得到位置子系统和姿态子系统；定义x_j,1＝z_j，

第j个无人机高度子系统动力学可写为：

式中，

τ_j,1＝U_j,1为控制输入，

为由式(1)得到的未知光滑函数，

由式(1)得到的已知函数，j为编队中无人机的编号，j＝1,…N，N为飞行编队中无人机数量；

定义x_j,3＝x_j，x_j,4＝y_j，

假设平衡位置附近的姿态角较小；第j个无人机水平运动动力学可以简化为：

第j个无人机姿态子系统动力学可写为：

式中，

τ_j,2＝[U_j,2,U_j,3,U_j,4]为控制输入，

为由式(1)得到的未知光滑函数，

由式(1)得到的已知函数；

步骤3：设计无人机的位置和航向角期望指令为：

式中，x_j,d,y_j,d,z_j,d为第j个无人机的位置期望指令，ψ_j,d为第j个无人机的偏航角期望指令，x_d,y_d,z_d为虚拟领航无人机的位置期望指令，ψ_d为虚拟领航无人机的偏航角期望指令，

为第j个无人机和虚拟领航无人机的相对位置，

为第j个无人机和虚拟领航无人机的相对偏航角；

步骤4：针对高度子系统(3)，定义高度跟踪误差为e_j,1＝x_j,1-z_j,d；设计虚拟控制量

为：

式中，k_j,1＞0，c_j,1＞0，κ_j,1＞0，c_j,2＞0，κ_j,2＞0和q_j＞1为设计参数，

为高度期望指令的导数，v_j,1在后续设计中给出；

设计一阶滤波器为：

式中，τ_j,1＞0为滤波器参数，

设计补偿信号z_j,1为：

式中，z_j,2在后续设计中给出；

定义补偿后跟踪误差为：

ν_j,1＝e_j,1-z_j,1 (9)

定义跟踪误差为

设计实际控制输入τ_j,1为：

式中，

为神经网络最优权重的估计值，

为神经网络基函数向量，k_j,2＞0，c_j,3＞0和c_j,4＞0为设计参数，v_j,2在后续设计中给出；

设计补偿信号z_j,2为：

定义补偿后跟踪误差为：

v_j,2＝e_j,2-z_j,2 (12)

定义预测误差为：

式中，

设计神经网络自适应更新律为：

式中，

为第j个无人机在

的权重估计值，

为第k个无人机在

的权重估计值，

为通信拓扑图论中的连接系数，第k个无人机为第j个无人机的邻居节点，∏_j为与第j个无人机有拓扑连接的邻居，

为第j个无人机和第k个无人机的估计信息触发传输的瞬间，λ_j,1＞0，k_j,ω1＞0，δ_j,f1＞0和β₁＞0为设计参数；

定义事件触发误差为：

设计触发函数为：

H_j,1(t,e_j,w1)＝||e_j,w1||²-(μ₀+μ₁e^-αt) (16)

式中，μ₀＞0，μ₁≥0和α＞0为设计参数；

当触发函数满足事件触发条件时，无人机将传输估计信息给其邻居无人机，设计事件触发条件为：

H_j,1(t,e_j,w1)＞0 (17)

步骤5：针对水平运动(4)，设计PD控制器计算预期加速度为：

式中，k_j,3＞0，k_j,4＞0，k_j,5＞0和k_j,6＞0为设计参数，

为水平位置期望指令的导数；

获取期望横滚角和俯仰角为：

步骤6：针对姿态子系统(5)，定义姿态角跟踪误差为e_j,X1＝X_j,1-X_j,d，其中

为姿态角期望指令；设计虚拟控制量

为：

式中，k_j,7＞0，d_j,1＞0和d_j,2＞0为设计参数，

为姿态角期望指令的导数，ν_j,3在后续设计中给出；

设计一阶滤波器为：

式中，τ_j,2＞0为滤波器参数，

设计补偿信号z_j,3为：

式中，z_j,4在后续设计中给出；

定义补偿后跟踪误差为：

ν_j,3＝e_j,X1-z_j,3 (23)

定义跟踪误差为

设计实际控制输入τ_j,2为：

式中，

为神经网络最优权重的估计值，

为神经网络基函数向量，k_j,8＞0，d_j,3＞0和d_j,4＞0为设计参数，ν_j,4在后续设计中给出；

设计补偿信号z_j,4为：

定义补偿后跟踪误差为：

ν_j,4＝e_j,X2-z_j,4 (26)

定义预测误差为：

式中，

设计神经网络自适应更新律为：

式中，

为第j个无人机在

的权重估计值，

为第k个无人机在

的权重估计值，λ_j,2＞0，k_j,ω2＞0，δ_j,f2＞0和β₂＞0为设计参数；

定义事件触发误差为：

设计触发函数为：

H_j,2(t,e_j,w2)＝||e_j,w2||²-(μ₀+μ₁e^-αt) (30)

当触发函数满足事件触发条件时，无人机将传输估计信息给其邻居无人机，设计事件触发条件为：

H_j,2(t,e_j,w2)＞0 (31)

步骤7：据得到的垂直、滚转、俯仰、偏航运动的控制输入U_j,1,U_j,2,U_j,3,U_j,4，返回到无人机系统动力学模型，以飞行编队形式对期望指令x_d,y_d,z_d进行跟踪控制。

一种计算机系统，包括：一个或多个处理器，计算机可读存储介质，用于存储一个或多个程序，其中，当所述一个或多个程序被所述一个或多个处理器执行时，使得所述一个或多个处理器实现上述的方法。

一种计算机可读存储介质，存储有计算机可执行指令，所述指令在被执行时用于实现上述的方法。

一种计算机程序，包括计算机可执行指令，所述指令在被执行时用于实现上述的方法。

有益效果

本发明提出的一种基于事件触发估计信息传输的飞行编队有限时间自适应控制方法，该方法引入了虚拟领航无人机的协调策略，设定各无人机与领航者的相对位置作为反馈信息，采用反步法和有限时间收敛算法设计控制输入，按照飞行编队队形实现协调轨迹跟踪。采用神经网络估计动力学不确定性，采集在线数据构造预测误差评价估计能力，结合事件触发条件共享编队间的估计信息，应用到自适应更新律中，提升多无人机对模型不确定性的估计能力，降低编队通信压力，提高飞行控制性能。

有益效果如下：

(1)本发明采用虚拟领航无人机和虚拟编队结构的协调策略，结合飞行编队位置和偏航角信息，将全局飞行编队期望轨迹指令转换为编队内各无人机对应的期望指令作为闭环系统的参考信息；

(2)本发明考虑欠驱动无人机的动力学不确定性，采用神经网络算法估计未知非线性，基于反步法框架和有限时间收敛算法设计控制输入，前馈至无人机模型中，按照特定的飞行队形实现协调轨迹跟踪；

(3)本发明利用飞行编队内通信连接共享无人机的估计信息，基于事件触发条件减小通信压力，弥补了部分无人机估计能力弱的不足；深入分析系统动力学，采集在线数据构造预测误差挖掘潜在评价指标，结合跟踪误差设计自适应更新律。

附图说明

附图仅用于示出具体实施例的目的，而并不认为是对本发明的限制，在整个附图中，相同的参考符号表示相同的部件。

图1是本发明基于事件触发估计信息传输的飞行编队有限时间自适应控制方法的流程图。

具体实施方式

为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图和实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。此外，下面描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。

参照图1，本发明一种基于事件触发估计信息传输的飞行编队有限时间自适应控制方法，通过以下步骤实现：

(a)采用无人机的动力学模型：

式中，x,y,z为位置，

为横滚角，θ为俯仰角，ψ为偏航角，m＝2.3kg为质量，g＝9.81m/s²为重力加速度，I_x＝1.676×10^-2kg·m²，I_y＝1.676×10^-2kg·m²，I_z＝2.314×10^{- 2}kg·m²为惯性矩阵，l＝0.1725m为无人机质心到旋翼中心的距离，J_r＝3.36×10^-5kg·m²为电机转动惯量，ω_r＝ω₂+ω₄-ω₁-ω₃，ω_i为第i个电机的转速，i＝1,2,3,4。U₁,U₂,U₃,U₄分别为垂直、滚转、俯仰、偏航运动的控制输入为：

其中，b＝2.92×10^-6kg·m为升力系数，d＝1.12×10^-7kg·m²为力矩系数。

(b)将无人机动力学模型解耦得到位置子系统和姿态子系统。定义x_j,1＝z_j，

第j个无人机高度子系统动力学可写为：

式中，

τ_j,1＝U_j,1为控制输入，

j为编队中无人机的编号，j＝1,…N，N＝5。

定义x_j,3＝x_j，x_j,4＝y_j，

假设平衡位置附近的姿态角较小。第j个无人机水平运动动力学可以简化为：

第j个无人机姿态子系统动力学可写为：

式中，

τ_j,2＝[U_j,2,U_j,3,U_j,4]为控制输入，

(c)设计无人机的位置和航向角期望指令为：

式中，x_j,d，y_j,d，z_j,d为第j个无人机的位置期望指令，ψ_j,d为第j个无人机的偏航角期望指令，x_d＝y_d＝z_d＝100m为虚拟领航无人机的位置期望指令，ψ_d＝π/16rad为虚拟领航无人机的偏航角期望指令，

为第j个无人机和虚拟领航无人机的相对位置，

为第j个无人机和虚拟领航无人机的相对偏航角，

(d)针对高度子系统(3)，定义高度跟踪误差为。设计虚拟控制量

为：

式中，k_j,1＝3，c_j,1＝5，κ_j,1＝5，c_j,2＝5，κ_j,2＝10和q_j＝3，

为高度期望指令的导数，ν_j,1在后续设计中给出。

设计一阶滤波器为：

式中，τ_j,1＝0.05为滤波器参数，

设计补偿信号z_j,1为：

式中，z_j,2在后续设计中给出，z_j,1(0)＝0。

定义补偿后跟踪误差为：

ν_j,1＝e_j,1-z_j,1 (40)

定义跟踪误差为

设计实际控制输入τ_j,1为：

式中，

为神经网络最优权重的估计值，

为神经网络基函数向量，

k_j,2＝3，c_j,3＝5，c_j,4＝5，ν_j,2在后续设计中给出。

设计补偿信号z_j,2为：

式中，z_j,2(0)＝0。

定义补偿后跟踪误差为：

ν_j,2＝e_j,2-z_j,2 (43)

定义预测误差为：

式中，

设计神经网络自适应更新律为：

式中，

为第j个无人机在

的权重估计值，

为第k个无人机在

的权重估计值，

为通信拓扑图论中的连接系数，第k个无人机为第i个无人机的邻居节点，П_j为与第j个无人机有拓扑连接的邻居，

为第j个无人机和第k个无人机的估计信息触发传输的瞬间，λ_j,1＝0.1，k_j,ω1＝100，δ_j,f1＝0.1和β₁＝1。

定义事件触发误差为：

设计触发函数为：

H_j,1(t,e_j,w1)＝||e_j,w1||²-(μ₀+μ₁e^-αt) (47)

式中，μ₀＝2×10^-5，μ₁＝2×10^-5和α＝0.5。

当触发函数满足事件触发条件时，无人机将传输估计信息给其邻居无人机，设计事件触发条件为：

H_j,1(t,e_j,w1)＞0 (48)

(e)针对水平运动(4)，设计PD控制器计算预期加速度为：

式中，k_j,3＝1，k_j,4＝1，k_j,5＝1，k_j,6＝1，

为水平位置期望指令的导数。

获取期望横滚角和俯仰角为：

(f)针对姿态子系统(5)，定义姿态角跟踪误差为e_j,X1＝X_j,1-X_j,d，其中

为姿态角期望指令。设计虚拟控制量

为：

式中，k_j,7＝5，d_j,1＝5和d_j,2＝5，

为姿态角期望指令的导数，v_j,3在后续给出。

设计一阶滤波器为：

式中，τ_j,2＝0.05为滤波器参数，

设计补偿信号z_j,3为：

式中，z_j,4在后续设计中给出，z_j,3(0)＝0。

定义补偿后跟踪误差为：

v_j,3＝e_j,X1-z_j,3 (54)

定义跟踪误差为

设计实际控制输入τ_j,2为：

式中，

为神经网络最优权重的估计值，

为神经网络基函数向量，

k_j,8＝5，d_j,3＝5和d_j,4＝5，v_j,4在后续设计中给出。

设计补偿信号z_j,4为：

式中，z_j,4(0)＝0。

定义补偿后跟踪误差为：

v_j,4＝e_j,X2-z_j,4 (57)

定义预测误差为：

式中，

设计神经网络自适应更新律为：

式中，

为第j个无人机在

的权重估计值，

为第k个无人机在

的权重估计值，λ_j,2＝0.1，k_j,ω2＝100，δ_j,f2＝0.1和β₂＝1。

定义事件触发误差为：

设计触发函数为：

H_j,2(t,e_j,w2)＝||e_j,w2||²-(μ₀+μ₁e^-αt) (61)

当触发函数满足事件触发条件时，无人机将传输估计信息给其邻居无人机，设计事件触发条件为：

H_j,2(t,e_j,w2)＞0 (62)

(g)据得到的垂直、滚转、俯仰、偏航运动的控制输入U_j,1,U_j,2,U_j,3,U_j,4，返回到无人机系统动力学模型，以编队形式对期望指令x_d,y_d,z_d进行跟踪控制。

本发明该方法采用虚拟编队结构策略，引入虚拟领航无人机并结合飞行编队位置和偏航角信息，将全局飞行编队期望轨迹指令转换为编队内各无人机对应的期望指令作为闭环系统的参考信息。采用反步法框架和有限时间收敛算法设计无人机控制输入，利用神经网络估计模型的动力学不确定性，实现特定飞行编队下的跟踪控制。利用飞行编队内通信拓扑共享邻居无人机的估计信息，基于事件触发条件降低通信压力，在线采集历史数据构建预测误差挖掘潜在估计评价指标，结合跟踪误差更新神经网络权重。本发明关注多无人机编队飞行时模型动力学不确定性和个体估计能力不足对跟踪性能的影响，设计了基于事件触发的复合估计策略，增强了不确定性估计精度，为提升编队飞行性能提供了新的途径。

以上所述，仅为本发明的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明公开的技术范围内，可轻易想到各种等效的修改或替换，这些修改或替换都应涵盖在本发明的保护范围之内。

Claims (4)

1.一种基于事件触发估计信息传输的飞行编队有限时间自适应控制方法，其特征在于步骤如下：

步骤1：采用无人机的动力学模型：

式中，x,y,z为位置，

为横滚角，θ为俯仰角，ψ为偏航角，m为质量，g为重力加速度，I_x,I_y,I_z为惯性矩阵，l为无人机质心到旋翼中心的距离，J_r为电机转动惯量，ω_r＝ω₂+ω₄-ω₁-ω₃，ω_i为第i个电机的转速，i＝1,2,3,4；U₁,U₂,U₃,U₄分别为垂直、滚转、俯仰、偏航运动的控制输入为：

其中，b为升力系数，d为力矩系数；

步骤2：将无人机动力学模型解耦得到位置子系统和姿态子系统；定义x_j,1＝z_j，

第j个无人机高度子系统动力学可写为：

式中，

τ_j,1＝U_j,1为控制输入，

为由式(1)得到的未知光滑函数，

由式(1)得到的已知函数，j为编队中无人机的编号，j＝1,…N，N为飞行编队中无人机数量；

定义x_j,3＝x_j，x_j,4＝y_j，

假设平衡位置附近的姿态角较小；第j个无人机水平运动动力学可以简化为：

第j个无人机姿态子系统动力学可写为：

式中，

τ_j,2＝[U_j,2,U_j,3,U_j,4]为控制输入，

为由式(1)得到的未知光滑函数，

由式(1)得到的已知函数；

步骤3：设计无人机的位置和航向角期望指令为：

式中，x_j,d,y_j,d,z_j,d为第j个无人机的位置期望指令，ψ_j,d为第j个无人机的偏航角期望指令，x_d,y_d,z_d为虚拟领航无人机的位置期望指令，ψ_d为虚拟领航无人机的偏航角期望指令，

为第j个无人机和虚拟领航无人机的相对位置，

为第j个无人机和虚拟领航无人机的相对偏航角；

步骤4：针对高度子系统(3)，定义高度跟踪误差为e_j,1＝x_j,1-z_j,d；设计虚拟控制量

为：

式中，k_j,1＞0，c_j,1＞0，κ_j,1＞0，c_j,2＞0，κ_j,2＞0和q_j＞1为设计参数，

为高度期望指令的导数，ν_j,1在后续设计中给出；

设计一阶滤波器为：

式中，τ_j,1＞0为滤波器参数，

设计补偿信号z_j,1为：

式中，z_j,2在后续设计中给出；

定义补偿后跟踪误差为：

ν_j,1＝e_j,1-z_j,1 (9)

定义跟踪误差为

设计实际控制输入τ_j,1为：

式中，

为神经网络最优权重的估计值，

为神经网络基函数向量，k_j,2＞0，c_j,3＞0和c_j,4＞0为设计参数，ν_j,2在后续设计中给出；

设计补偿信号z_j,2为：

定义补偿后跟踪误差为：

ν_j,2＝e_j,2-z_j,2 (12)

定义预测误差为：

式中，

设计神经网络自适应更新律为：

式中，

为第j个无人机在

的权重估计值，

为第k个无人机在

的权重估计值，

为通信拓扑图论中的连接系数，第k个无人机为第j个无人机的邻居节点，Π_j为与第j个无人机有拓扑连接的邻居，

为第j个无人机和第k个无人机的估计信息触发传输的瞬间，λ_j,1＞0，k_j,ω1＞0，δ_j,f1＞0和β₁＞0为设计参数；

定义事件触发误差为：

设计触发函数为：

H_j,1(t,e_j,w1)＝||e_j,w1||²-(μ₀+μ₁e^-αt) (16)

式中，μ₀＞0，μ₁≥0和α＞0为设计参数；

当触发函数满足事件触发条件时，无人机将传输估计信息给其邻居无人机，设计事件触发条件为：

H_j,1(t,e_j,w1)＞0 (17)

步骤5：针对水平运动(4)，设计PD控制器计算预期加速度为：

式中，k_j,3＞0k_j,4＞0k_j,5＞0和k_j,6＞0为设计参数，

为水平位置期望指令的导数；

获取期望横滚角和俯仰角为：

步骤6：针对姿态子系统(5)，定义姿态角跟踪误差为e_j,X1＝X_j,1-X_j,d，其中

为姿态角期望指令；设计虚拟控制量

为：

式中，k_j,7＞0，d_j,1＞0和d_j,2＞0为设计参数，

为姿态角期望指令的导数，ν_j,3在后续设计中给出；

设计一阶滤波器为：

式中，τ_j,2＞0为滤波器参数，

设计补偿信号z_j,3为：

式中，z_j,4在后续设计中给出；

定义补偿后跟踪误差为：

ν_j,3＝e_j,X1-z_j,3 (23)

定义跟踪误差为

设计实际控制输入τ_j,2为：

式中，

为神经网络最优权重的估计值，

为神经网络基函数向量，k_j,8＞0，d_j,3＞0和d_j,4＞0为设计参数，ν_j,4在后续设计中给出；

设计补偿信号z_j,4为：

定义补偿后跟踪误差为：

v_j,4＝e_j,X2-z_j,4 (26)

定义预测误差为：

式中，

设计神经网络自适应更新律为：

式中，

为第j个无人机在

的权重估计值，

为第k个无人机在

的权重估计值，λ_j,2＞0，k_j,ω2＞0，δ_j,f2＞0和β₂＞0为设计参数；

定义事件触发误差为：

设计触发函数为：

H_j,2(t,e_j,w2)＝||e_j,w2||²-(μ₀+μ₁e^-αt) (30)

当触发函数满足事件触发条件时，无人机将传输估计信息给其邻居无人机，设计事件触发条件为：

H_j,2(t,e_j,w2)＞0 (31)

步骤7：据得到的垂直、滚转、俯仰、偏航运动的控制输入U_j,1,U_j,2,U_j,3,U_j,4，返回到无人机系统动力学模型，以飞行编队形式对期望指令x_d,y_d,z_d进行跟踪控制。

2.一种计算机系统，其特征在于包括：一个或多个处理器，计算机可读存储介质，用于存储一个或多个程序，其中，当所述一个或多个程序被所述一个或多个处理器执行时，使得所述一个或多个处理器实现权利要求1所述的方法。

3.一种计算机可读存储介质，其特征在于存储有计算机可执行指令，所述指令在被执行时用于实现权利要求1所述的方法。

4.一种计算机程序，其特征在于包括计算机可执行指令，所述指令在被执行时用于实现权利要求1所述的方法。

Images