技术摘要：
本发明公开了一种飞行器的有限时间输出反馈姿态跟踪控制方法。该方法在对飞行器的姿态跟踪控制过程中，通过构建状态观测器、有限时间命令滤波器、误差补偿机制以及基于分数幂的控制律设计等步骤，使得飞行器的姿态参数向量与期望的姿态位置向量的跟踪误差收敛于期望的  全部
背景技术：
随着航空航天技术的发展，复杂多变的飞行任务需要飞行器精确、高效的姿态控 制。飞行器高性能姿态跟踪控制作为其中重要的研究方向，已经得到了广泛的关注。目前， 已经有许多采用不同方法研究飞行器的姿态跟踪的结果，例如结合鲁棒控制和自适应控制 的姿态跟踪控制方法、基于终端滑模的姿态跟踪控制方法和基于反步法建立姿态跟踪控制 器等。 这些结果中大部分姿态跟踪控制器的构造都基于全状态反馈，这意味着算法设计 需要飞行器的姿态和速度信息。然而，在恶劣的飞行条件下飞行器的状态难以精确全部测 量，而且传感器容易发生故障，因此，基于全状态反馈的姿态跟踪控制方案具有很大的局限 性。 发明人认为，基于观测器的飞行器的控制器设计方法更为实用，但是目前大部分 的输出反馈姿态控制方案都是渐近收敛的。相比于渐近收敛的控制方法，有限时间控制能 够提供更快的收敛速度，从而提高飞行器的控制器的跟踪精度和抗干扰能力。 目前常见的有限时间姿态跟踪控制器都是基于全状态反馈的，仅有的采用齐次方 法研究输出反馈的有限时间姿态跟踪问题，但是不能处理具有扰动或不确定性的飞行器系 统。 反步法已被证明在不确定的非线性系统的自适应控制中表现良好，已经被用于飞 行器的输出反馈控制。但是，在控制器设计中需要使用虚拟控制信号的导数，这会带来计算 复杂性问题。引入加幂积分器的反步技术是一种基于反步技术的有限时间控制算法，但是 它需要多次使用不等式缩放来确定控制器增益，这可能会带来高增益问题。动态面控制通 过应用一阶滤波器计算复杂性问题，但是加入滤波器后产生的滤波误差得不到补偿，因而 无法进一步提高控制性能。命令滤波反步法通过命令滤波器的输出逼近虚拟控制信号的导 数，同时通过使用误差补偿信号消除过滤误差。相比于基于加幂积分的反步控制方法和动 态面控制，它可以保证更好的控制性能。此外，控制器的饱和问题对提高飞行器的性能和稳 定性有重要影响，需要考虑。因此，如何在只考虑输出反馈的基础上，使用命令滤波反步法 构建具有抑制输入饱和影响的控制器使飞行器在有限时间内完成对目标姿态的高效跟踪 有重要意义。
技术实现要素：
本发明的目的在于提出一种飞行器的有限时间输出反馈姿态跟踪控制方法，以解 决飞行器存在惯性不确定性、外部干扰以及执行器饱和情况下的姿态跟踪控制问题。 本发明为了实现上述目的，采用如下技术方案： 一种飞行器的有限时间输出反馈姿态跟踪控制方法，包括如下步骤： 9 CN 111596679 A 说　明　书 2/16 页 I.飞行器在惯性系中的姿态参数向量 根据修正罗德里格参数 定义为： 式中， 表示姿态参数向量 的第一个分量， 表示 的第二个分量， 表示 的 第三个分量；θ∈(-2π,2π)表示主旋转角的角度，α表示主旋转轴； 根据修正罗德里格参数，飞行器的运动学方程定义为： 其中，I3×3∈R3×3为单位矩阵； 定义为 ω＝[ω ,ω ,ω ]T∈R31 2 3 表示飞行器的角速度，其中ω1表示ω的第一个分量，ω2 表示ω的第二个分量，ω3表示ω的第三个分量； 表示姿态参数向量 的斜对称矩 阵，表达式为 飞行器的动力学方程定义为： Jω＝-ω×Jω sat(u) d        (3) 其中，ω×∈R3×3表示角速度向量ω的斜对称矩阵，表达式为ω×＝[0,-ω3 ,ω2； ω3,0,-ω ；-ω ,ω ,0]T 3×31 2 1 ；J∈R 表示惯性矩阵； J包括标称部分 和不确定部分ΔJ； 满足 ε∈R3是任 意向量， 和 是已知的正常数；ΔJ满足||ΔJ||≤ΔJ*，ΔJ*是未知的正常数； d∈R3表示由外部干扰产生的控制扭矩，且满足||d||≤d1，d1是未知的正常数； u＝[u T1,u2,u3] ∈R3表示控制力矩； sat(u)＝[sat(u T1) ,sat(u2) ,sat(u3)] 是关于u的输入饱和函数矢量； 函数sat(ui)定义为 i＝1,2,3， 是已知的常数； 根据飞行器的运动学方程(2)和动力学方程(3)，得到描述飞行器的姿态运动方程 为： 其中， 表示 的逆矩阵；J*＝WTJW，WT表示W的转置矩阵； 表示矩阵 的斜对称矩 阵，其中η1表示 的第一个分量，η2表示 的第二个分量，η3表示 的第三个分量， 表示为 进一步，将 代入公式(4)化简，重新定义变量 ΔJ*＝WTΔJW， 公式(4)表示为： 10 CN 111596679 A 说　明　书 3/16 页 其中， 指 的逆矩阵， 表示 矩阵 的斜对称矩阵，其中σ1表示 的第一个分量，σ2表示 的 第二个分量，σ3表示 的第三个分量， 表示为 J - 1 是 指 J 的 逆 矩 阵 ； 是 指 的 逆矩阵 ，J - 1 是 指 J的 逆矩阵 , 定义新的变量 则公式(5)用新的变量表示为： 其中，x＝[x ,x ]T1 2 ；F(x)＝-P(y,x2)x2＝[f1(x) ,f2(x) ,f3(x)]T，f1(x)表示F(x)的 第一个分量，f2(x)表示F(x)的第二个分量，f3(x)表示F(x)的第三个分量； 表达式中的sat(u)表示为 其 中 ，g ( u ) ＝ [ g ( u T1 ) , g ( u 2 ) , g ( u 3 ) ] ， 其中，i＝1,2,3，tanh表示双曲正切函 数； II.下面构造飞行器的有限时间输出反馈姿态跟踪控制方法，以使飞行器的姿态 参数向量 与期望的姿态位置向量 的跟踪误差收敛于期望邻域内； 为了估算飞行器不可测量的角速度，将建立状态观测器用于后续控制器的构建； 首先将公式(6)重写为： 其中， K表示观测器的增益矩阵，k1＞0、k2＞0为设计的观测器增益；是状态x的估计值； ΔF是函数的估计误差，定义为 通过选取增益矩阵K，使得矩阵A成为严格的赫尔维茨矩阵； 给出对称正矩阵QT＝Q＞0，必然存在一个满足ATP PA＝-Q的对称正矩阵PT＝P＞0； 根据公式(7)构建状态观测器，即： 11 CN 111596679 A 说　明　书 4/16 页 构造紧集Ω1： 其中， 是x1的估计值， 是x2的估计值，Θ是任意正常数，||·||表示向量的2范 数； 根据利普西斯条件，如果上述紧集Ω1存在，则存在正常数h，使得 成 立；进一步，存在正常数d*，使得 也成立； 定义状态观测器的估计误差 在反步控制方法的每一步中都将采用下面的有限时间命令滤波器； 其中，i＝1,2,3； μ2,1,i表示有限时间命令滤波器的状态；μ2,2,i表示有限时间命令滤波器的状态； Ψ2,1,i表示有限时间命令滤波器的参数，Ψ2,2,i表示有限时间命令滤波器的参数； ι2,1,i表示μ2,1,i的导数； 表示虚拟控制信号 的第i个分量，sign表示符号函数； 在控制器设计中，定义以下姿态跟踪误差： 其中，z1表示姿态跟踪误差向量；z2表示观测的状态向量与有限时间命令滤波器输 出向量的误差；l2＝[μ2,1,1,μ2,1,2,μ T2,1,3] 为有限时间命令滤波器的输出； 虚拟控制信号 为有限时间命令滤波器的输入， 表示 的第一个 分量， 表示 的第二个分量， 表示 的第三个分量； 由公式(10)构造虚拟控制信号 为： 其中，c1＞0为常数增益；φ1＞0为常数增益；γ定义为 c和d是正奇 数；xd∈R3表示飞行器的目标姿态轨迹；补偿的误差信号 和消除饱和影响的辅助信号ζ的 定义将在下面给出； 构造控制力矩 其中 表示的 逆矩阵， 定义为： 其中，c2＞0为常数增益；φ2＞0为常数增益；e1表示状态观测器的估计误差e的第 一个分量，补偿的误差信号 的定义将在下面给出； 选取误差补偿信号： 12 CN 111596679 A 说　明　书 5/16 页 其中， 表示误差补偿信号， 表示 的初始条件， s＝1,2； 补偿的误差信号 定义为： 消除饱和影响的辅助信号ζ定义为： 选择状态观测器(8)、虚拟控制信号 和控制力矩 使得飞行器的姿态 参数向量 与期望的姿态位置向量 的跟踪误差收敛于期望邻域内； 选取Lyapunov函数： 由公式(7)和公式(8)得到： 则有： 由不等式放缩得到： 其中， 将公式(18)、公式(19)代入公式(16)得： 其中，λmin(Q)表示矩阵Q的最小的特征值，选取Lyapunov函数： 对V1求导得： 其中， 将公式 (1 1 ) 、公式 (1 3 ) 和公式 (1 4 ) 代入公式 (2 2 ) ，并根据不等式 得到： 选取Lyapunov函数： 对V2求导： 13 CN 111596679 A 说　明　书 6/16 页 将公式(12)、公式(13)、公式(14)、公式(15)代入公式(25)，得到： 为误差补偿系统选取Lyapunov函数： 对 求导得： 其中， 表示 的第i个分量，s＝1,2,i＝1,2,3； 定义李雅普诺夫函数： 对公式(29)求导得到： 其中，S1表示任意的常数；λmax(P)表示矩阵P的最大的特征值； 将上面公式求解得到的 代入公式(30)得到： 在有限时间T*内，存在 为未知常数； 根据下面给出的不等关系： 14 CN 111596679 A 说　明　书 7/16 页 其中， 表示 的第i个分量，s＝1,2,i＝1,2,3，则不等式(31)等价于： 其中， 如果存在实数χ满足0＜χ＜1，则不等式(32)等价于： 或 如果 则不等式(33)即能够化为 从而得到： 状态观测器的估计误差e、误差信号 补偿误差信号 将在有限时间T1收敛到原 点附近的期望邻域 有限时间 表示 的初始条 件； 如果 则不等式(34)即能够化为 从而得到： 观测器误差e、误差信号 补偿误差信号 将在有限时间T2收敛到原点附近的期 望邻域 有限时间 表示 的初始条 15 CN 111596679 A 说　明　书 8/16 页 件； 综上，误差信号 补偿误差信号 将在有限时间T＝max{T1 ,T2}内收敛到邻域 根据公式(14)，姿态跟踪误差向量z1将在有限时间T收敛到原点附近的邻域 本发明具有如下优点： (1)与已有的飞行器基于状态观测器的姿态跟踪控制方法相比，本发明方法提出 了考虑了有限时间输出反馈姿态跟踪控制，能够提供更快的收敛速度；此外，本发明考虑了 控制器输入饱和问题，使本发明方法更具实用性和适用性。(2)与已有的飞行器有限时间输 出反馈姿态跟踪控制方法相比，本发明提出了一种新颖的有限时间命令滤波输出反馈控制 方法，该方法不仅能够避免传统反步方法的计算复杂性问题，而且与基于动态面的姿态跟 踪控制算法相比，本发明能够补偿使用命令滤波器引起的滤波误差，因而拥有良好的稳态 和瞬态性能。 附图说明 图1为本发明实施例中飞行器的有限时间输出反馈姿态控制方法的流程示意图。 图2为本发明实施例中飞行器的姿态和目标姿态的运动曲线图。 图3为本发明实施例中状态观测器的估计状态和实际状态的响应图。 图4为本发明实施例中有限时间命令滤波器的输入信号和输出信号的响应图。 图5为本发明实施例中控制力矩的响应图。 图6为本发明方法与传统动态面控制方法的对比示意图。