一种复合强抗扰姿态控制方法与流程

本发明涉及一种复合强抗扰姿态控制方法，属于飞行器姿态控制领域。
背景技术：
：现代飞行器结构复杂，日益多样化的任务需求对飞行器控制性能(稳定性、抗扰性、快速性等)提出了更高的要求。同时，随着各项新技术、新方法的不断探索，飞行器控制的发展面临诸多机遇和挑战。开展飞行器相关技术研究具有十分重要的学术价值、战略意义和应用前景。如何研发先进的飞行器姿态控制技术是飞行器控制技术基础问题与关键技术之一。滑模变结构控制是一类特殊的非线性不连续控制方法。这种控制方法与其他控制不同在于系统的结构在动态过程中，会根据系统当前的状态有目的变化，使得系统按照预定滑动模态的状态轨迹运行。由于滑动模态可以进行设计且与模型参数及扰动无关，使得变结构控制具有反应速度快、对参数变化不敏感、对扰动不敏感、物理实现简单等优点，目前，滑模变结构控制在飞行器控制领域和伺服控制领域得到广泛应用。反步法具有稳定性好、收敛速度快的优点，允许保留被控对象非线性或高阶特征，可以处理一类非线性、不确定性的影响，其在航空领域的应用倍受研究人员的关注。自抗扰控制技术利用扩张状态观测器把所有的未知外扰的非线性不确定对象用非线性状态反馈化为积分串联型后，用状态误差反馈来设计出理想的控制器，利用非线性结构从根本上克服了经典PID的固有缺陷。同时并不需要直接测量外扰作用，也不需要事先知道扰动的作用规律，能够有效提高控制精度。技术实现要素：本发明的技术解决问题是：克服现有技术的不足，以挠性飞行器的姿态控制系统为背景，提供一种基于非奇异终端滑模、反步设计法和观测器的挠性飞行器姿态跟踪控制方法，实现了挠性飞行器快速姿态跟踪控制，具有高精度，强抗扰能力，最大程度满足挠性飞行器姿态跟踪需求。本发明的技术解决方案是：一种复合强抗扰姿态控制方法，步骤如下：(1)建立挠性飞行器系统模型；(2)利用步骤(1)得到的所述挠性飞行器系统模型，基于四元数建立挠性飞行器运动学误差方程和动力学误差方程；(3)根据步骤(1)、(2)得到的挠性飞行器系统模型、挠性飞行器运动学误差方程和动力学误差方程，基于反步法，确定虚拟控制量；(4)根据步骤(2)中的挠性飞行器运动学误差方程和动力学误差方程，建立有限时间非奇异终端滑模面；(5)根据步骤(1)、(2)得到的挠性飞行器系统模型、挠性飞行器运动学误差方程和动力学误差方程，将总不确定项从模型中分离，确定扩张状态观测器，估计总不确定项；(6)确定基于滑模和扩张状态观测器的控制器，从而实现复合强抗扰姿态控制。本发明与现有技术相比的有益效果是：(1)在挠性振动模态、转动惯量不确定、外部扰动以及执行器饱和影响飞行器情况下，实现飞行器快速、高精度姿态跟踪控制，同时具有强抗扰能力。(2)充分发挥自抗扰控制的快速、精确估计能力，再结合反步控制技术和非奇异终端滑模的强鲁棒性和快速性，实现高性能飞行器姿态跟踪控制。附图说明图1为本发明基于滑模和观测器的控制系统流程图；图2为本发明PID控制器的姿态四元数跟踪误差和角速度跟踪误差；图3为本发明复合强抗扰姿态控制器的姿态四元数跟踪误差和角速度跟踪误差；图4为本发明PID控制器的输入力矩；图5为本发明复合强抗扰姿态控制器的输入力矩；图6为本发明滑模面的仿真结果；图7为本发明扩张状态观测器对扰动的估计；图8为本发明挠性模态频率衰减曲线。图9为本发明情况二下姿态四元数跟踪误差和角速度跟踪误差；图10为本发明情况二下扩张状态观测器对扰动的估计。具体实施方式下面结合附图对本发明的具体实施方式进行进一步的详细描述。如图1所示，本发明提出的一种复合强抗扰姿态控制方法的具体步骤如下：(1)考虑飞行器挠性特性、转动惯量不确定、外部扰动、执行器饱和等因素的影响，建立如下挠性飞行器系统模型：其中：d∈R3是外部扰动，δ∈R4×3为刚体与挠性附件的耦合矩阵，δT是δ的转置，η为挠性模态，和分别为η的一阶导数和二阶导数；J0∈R3×3为已知的标称惯量矩阵，且为正定矩阵；ΔJ为惯量矩阵中的不确定部分，Ω＝[Ω1,Ω2,Ω3]T是飞行器在本体坐标系中的角速度分量，是Ω的一阶导数；×是运算符号，将×用于向量b＝[b1,b2,b3]T可得到：L＝diag{2ζiωni,i＝1,2,...,N}和分别为阻尼矩阵和刚度矩阵，N为模态阶数，ωni,i＝1,2,...,N为振动模态频率矩阵，ζi,i＝1,2,...,N为振动模态阻尼比；u＝[u1,u2,u3]T是基于滑模和扩张状态观测器的控制器，sat(u)＝[sat(u1),sat(u2),sat(u3)]T是执行器产生的实际控制向量，sat(ui),i＝1,2,3表示执行器的非线性饱和特性且满足sat(ui)＝sign(ui)·min{umi,|ui|},i＝1,2,3，|·|表示取绝对值，sat(ui)表述为sat(ui)＝θoi+ui,i＝1,2,3，其中θoi,i＝1,2,3为：umi,i＝1,2,3是执行器饱和值，超出执行器饱和值部分为θo＝[θo1,θo2,θo3]T，且满足||θo||≤lδθ，lδθ是正实数。(2)利用步骤(1)得到的模型，基于四元数建立挠性飞行器运动学误差方程和动力学误差方程：挠性飞行器运动学误差方程：其中:(ev,e4)∈R3×R，ev＝[e1,e2,e3]T是当前飞行器姿态与期望姿态的误差四元数矢量部分，e4是标量部分，且满足和分别是ev、e4的一阶导数；(qv,q4)∈R3×R，qv＝[q1,q2,q3]T是描述飞行器姿态的单位四元数矢量部分，q4是标量部分，且满足qdv＝[qd1,qd2,qd3]T是描述期望姿态的单位四元数矢量部分，qd4是标量部分，且满足Ωe＝Ω-CΩd＝[Ωe1Ωe2Ωe3]T是建立在本体坐标系和目标坐标系之间的角速度误差向量，Ωd∈R3是期望角速度向量，是转换矩阵，且满足||C||＝1，是C的一阶导数，I3是3×3单位矩阵；挠性飞行器动力学误差方程为：其中，是Ωe的一阶导数，Ωd是期望角速度，是Ωd的一阶导数。(3)根据步骤(1)、(2)得到的挠性飞行器系统模型、挠性飞行器运动学误差方程和动力学误差方程，基于反步法，确定虚拟控制量α，具体为：α＝-K1ev-K2Sc(6)其中，Kj＝diag{kji}>0,i＝1,2,3,j＝1,2，diag(a1,a2,…,an)表示对角线元素为a1,a2,…,an的对角矩阵；定义Sc＝{Sc1,Sc2,Sc3}T如下:其中p、q是正奇数，且0<q/p<1，l1i、l2i，i＝1,2,3是参数；∈i,i＝1,2,3、ι1、ι2是设计参数，sign(a)是符号函数，定义如下：(4)根据步骤(2)中的挠性飞行器运动学误差方程和动力学误差方程，建立有限时间非奇异终端滑模面，具体为S＝[S1S2S3]T，其中:Si＝Ωe+K1ev+K2Sc,i＝1,2,3(8)(5)根据步骤(1)、(2)得到的挠性飞行器系统模型、挠性飞行器运动学误差方程和动力学误差方程，将总不确定项从模型中分离，确定扩张状态观测器，确定扩张状态观测器，具体为：其中，Z1是状态误差，F＝[F1,F2,F3]T＝-Ω×J0Ω+J0EΩ，EΩ＝(L1+L2Eq)Q(e)Ω，L1、L2是正实数，定义Eq：fal(Z1,β1,γ)＝[fal1(Z1,β1,γ),fal2(Z1,β1,γ),fal3(Z1,β1,γ)]T(11)X1和X2是扩张状态观测器的输出，S为系统状态，X1跟踪系统状态S，X2跟踪系统的扩张状态Gδ，Gδ是估计系统的内部扰动和外部扰动的总不确定项，F为已知模型，Ω是角速度，ρ1、ρ2是观测器的观测能力系数，Z1是状态误差,u是基于滑模和扩张状态观测器的控制器，Z1i是向量Z1的第i个元素，p、q是正奇数，γ、α、β1是设计参数，|·|表示取绝对值；通过选取适当的ρ1、ρ2、γ和β1，扩张状态观测器输出X1和X2会在有限时间内分别跟踪到S和Gδ。(6)根据步骤(4)、(5)中的有限时间非奇异终端滑模面和扩张状态观测器，建立基于滑模和扩张状态观测器的控制器u，具体为：其中，控制器可视为趋近率(J0(-τS-σsignr(S)))、模型已知量(-J0F)、未知模型估计量(-J0X2)的组合；其中趋近率(J0(-τS-σsignr(S)))实现控制器快速收敛；模型已知量(-J0F)直接参与控制器设计，减少观测器估计压力；针对未知模型估计量(-J0X2)，利用观测器进行精确估计并补偿，因而能对不同扰动产生抑制，从而保持系统稳定。实施例：为了验证上述设计的基于观测器技术和滑模控制技术的飞行器姿态跟踪控制器的有效性，通过不同条件下的仿真证明了该控制器在飞行器姿态跟踪控制方面的鲁棒性。考虑挠性飞行器运动学误差方程和动力学误差方程，标称惯量矩阵为惯量矩阵中的不确定部分为：ΔJ＝diag(50,30,20)kg·m2；外部扰动d∈R3是时间t的函数，可表示为d(t)，具体取为：情况一：d(t)＝0.5[sin(t),sin(2t),sin(3t)]T；情况二：d(t)＝[200*sin(0.1t),220*sin(0.2t),300*sin(0.3t)]T；飞行器姿态的四元数初始值为q＝[0.3,-0.2,-0.3,0.8832]T和初始角速度为Ω＝[0,0,0]T，用数值仿真验证控制算法的有效性，假设期望姿态四元数初值为qd＝[0,0,0,1]T，期望角速度是时间t的函数，可表示为Ωd(t)，具体取为：Ωd(t)＝0.05[sin(πt/100),sin(2πt/100),sin(3πt/100)]T；在存在惯量矩阵不确定和外部扰动的情况下，图2为PID控制器的姿态四元数跟踪误差和角速度跟踪误差；图3为复合强抗扰姿态控制器的姿态四元数跟踪误差和角速度跟踪误差；图4为PID控制器的输入力矩；图5为复合强抗扰姿态控制器的输入力矩；由表1可见，与PID控制相比，本发明提出的基于滑模和扩张状态观测器的控制器更能保证飞行器系统轨迹能够快速、精确地跟踪参考姿态。表1复合强抗扰姿态控制器与PID控制的比较结果控制器四元数角速度复合强抗扰姿态控制器±9.54e-6±2.17e-5PID控制器±9.02e-3±3.92e-3提高比例，％99.899.4图6给出了滑模面的仿真结果，基于参数μ＝15I3,β1＝0.50,K1＝2I3，K2＝I3和q/p＝0.9的系统轨迹能够快速到达滑模面，扩张状态观测器对不确定和外部扰动进行了精确估计，从而有效抑制了滑模控制带来的抖振现象，图7展示了扩张状态观测器对总扰动Gδi,i＝1,2,3的估计性能；通过选取合适的参数ρ1＝4.5,ρ2＝8.5和γ＝1，观测器输出各分量X2(i),i＝1,2,3能够有效跟踪扰动的各分量Gδi,i＝1,2,3，其验证了扩张状态观测器具有良好的观测性能，从而使控制器具有快速收敛、高精度跟踪能力。图8表示扰动情况二下的姿态四元数跟踪误差和角速度跟踪误差，图9和图10表示扩张状态观测器对总扰动的估计性能，可见设计的滑模控制器大扰动情况下也能保证良好的收敛速度和精度，具有强抗扰能力。本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。当前第1页1 2 3