一种自主水下航行器动态抗饱和俯仰角控制方法技术

本发明专利技术提出一种自主水下航行器动态抗饱和俯仰角控制方法，方法中基于滑模控制设计了自适应律，在线估计系统参数及未知干扰的上界，不断地通过当前系统的运行状态与期望状态相比较，通过自适应律来改变控制器，使系统能够达到预期的性能指标。同时方法设计了抗饱和动态补偿器，用辅助变量w来减缓输入饱和对系统的影响，以保证控制系统有良好的性能。

【技术实现步骤摘要】
一种自主水下航行器动态抗饱和俯仰角控制方法
本专利技术涉及的是水下航行器俯仰控制
，具体为一种自主水下航行器动态抗饱和俯仰角控制方法，
技术介绍
海洋覆盖地球三分之二的面积，对人类未来的生存有着至关重要的影响，是人类生存和可持续发展的重要领域，海洋的开发和利用已成为决定国家兴衰的基本因素之一。而水下航行器(AutonomousUnderwaterVehicle，AUV)作为探索海洋的重要手段，也越来越成为研究工作的热点。AUV具有很强的非线性特性，同时它的航行环境十分复杂，传统的PID控制算法难以胜任。对于AUV的姿态控制存在以下几个技术挑战：时变性，模型参数甚至结构不确定，未知的外部干扰以及控制输入饱和等，这些问题都给AUV的控制带来了很多困难。由于它在航行过程中流体参数会发生变化，造成模型参数具有不确定性，而且会受到海浪和海流的随机干扰，这要求控制系统必须具有一定的鲁棒性和自适应能力。滑模控制作为一种特殊的鲁棒控制方法，由于它突出的特点是：滑动模态对于系统参数摄动和外界扰动等不确定因素不敏感，这种理想的鲁棒性引起了控制界的极大关注。进二十年来，滑模控制方法在电机控制、机器人、伺服系统、空间飞行器等领域取得成功应用。特别是，随着AUV的不断发展，将滑模控制应用于AUV的研究也越来越成为研究的重要方向。另外，在实际工程中，由于执行器的限制，控制律的大小通常有一定限制，过大的控制律值难以实现。如何在控制输入受饱和限制条件下仍能实现有效的控制算法设计，是一个很有理论和实际意义的研究问题。综上所述，AUV俯仰控制还存在以下三个问题：1、AUV的俯仰模型参数具有不确定性；2、海流等外部随机干扰会对AUV的俯仰运动控制造成一定的影响。3、由于执行器的饱和限制，过大的控制律值难以实现，若忽略输入受限，则闭环系统的性能下降，甚至稳定性难以保证。
技术实现思路
本专利技术针对AUV俯仰控制中模型参数不确定及外部干扰未知，同时考虑控制输入饱和受限情况下的控制问题，提出了一种带有动态抗饱和补偿器的自适应滑模控制方法对AUV的俯仰角进行控制。在该方法中，基于滑模控制设计了自适应律对模型参数和外部干扰上界进行估计，同时设计了动态补偿器来解决输入饱和的问题，以保证控制系统有良好的性能。本专利技术的技术方案为：所述一种自主水下航行器动态抗饱和俯仰角控制方法，其特征在于：包括以下步骤：步骤1：忽略水下航行器俯仰运动和横滚运动的耦合，建立水下航行器俯仰运动模型：y＝θ其中θ是俯仰角，ωz是俯仰角速度，α是攻角，u是控制输入，D表示非线性项和外界未知干扰，y是输出，c1，c2是未知的需要估计的模型参数，c3是已知的控制增益，c4，c5，c6为设定的模型参数；控制输入u取决于控制器输出的舵角δe：其中um为控制器幅值；步骤2：对步骤1设计得到的水下航行器俯仰运动模型，采用以下控制律和自适应律进行控制；所述控制律为：其中s为滑模面，取e为俯仰角误差e＝θ-θd，θd为期望俯仰角，λ为满足Hurwitz条件的正常数；sgn(s)表示s的符号；参数τ和k由设定的滑模面s的趋近律得到，模面s的趋近律为指数趋近律且τ＞0,k＞0；w为设计的动态抗饱和补偿器状态，设计的动态抗饱和补偿器为：其中Δu＝u-δe，sT表示s的转置，表示给定的抗饱和参数，且满足||·||表示范数，ι取值范围为[0,0.001]；所述自适应律为：其中，hT＝[c1,c2]，φ＝[ωz,α]T，为h的估计值；ρ为非线性项和外界未知干扰D的上界，为ρ的估计值，ε1,ε2,k1,k2均为给定的自适应律设计参数。有益效果本专利技术采用自适应控制可以通过系统内部可测信息的变化，来改变控制器的参数，通过自适应律不断更新和修正自己的状态，来主动适应被控系统及扰动的动态特性变化，以达到控制目的。在系统模型参数不确定的情况下，采用上述设计的自适应律，在线估计系统参数及未知干扰的上界，不断地通过当前系统的运行状态与期望状态相比较，通过自适应律来改变控制器，使系统能够达到预期的性能指标。由此解决了AUV航行过程中，俯仰模型参数不确定，以及存在随机扰动的问题。另外，由于执行器饱和限制的存在，执行器的输入不一定等于控制器的输出，当控制器输出的控制量超过执行器的幅值，执行器的输出便不能继续增大，这会影响到整个系统的动态特性甚至稳定性。为此，将上述设计的抗饱和动态补偿器作为一种辅助系统引入俯仰角控制系统中，用辅助变量w来减缓输入饱和对系统的影响，保证系统的性能，可以解决AUV俯仰控制系统执行器饱和的问题。附图说明附图1带有动态抗饱和补偿器的AUV俯仰控制系统。附图2分别采用PID、无补偿器的滑模控制及带补偿器的滑模控制下的俯仰角；其中(a)PID控制俯仰角，(b)无抗饱和补偿器时的俯仰角，(c)有抗饱和补偿器时的俯仰角。附图3分别采用三种控制律时的跟踪误差；其中(a)PID跟踪误差，(b)无抗饱和补偿器跟踪误差，(c)有抗饱和补偿器跟踪误差。附图4无补偿器和有补偿器时的控制输入u，即执行器的输出；其中(a)无补偿器时的控制输入，(b)有补偿器时的控制输入。附图5带补偿器时的滑模面。附图6带有补偿器时的自适应参数值。具体实施方式下面结合具体实施例描述本专利技术：本实施例中根据某型号AUV设定模型参数：c1＝-4.695，c2＝10.735，c3＝-1.8207，c4＝0.2623，c5＝-1.274，c6＝-0.102，这其中c1，c2的值是在仿真建模中设定的值，在实际控制中，认为c1，c2的值是未知的。初始状态设为θ(0)＝10°，ωz(0)＝3°/s。估计参数的初始状态为：期望俯仰角为经过滤波处理的方波，幅值为28.7°。τ＝20，k＝0.02，λ＝1。设定执行器的最大输出量为um＝12°。首先，忽略水下航行器俯仰运动和横滚运动的耦合，建立水下航行器俯仰运动模型：y＝θ其中θ是俯仰角，ωz是俯仰角速度，α是攻角，u是控制输入，D表示非线性项和外界未知干扰，y是输出，c1，c2是未知的需要估计的模型参数，c3是已知的控制增益，c4，c5，c6为设定的模型参数；控制输入u取决于控制器输出的舵角δe：其中um为控制器幅值。在模型中取hT＝[c1,c2]，φ＝[ωz,α]T。步骤2：对步骤1设计得到的水下航行器俯仰运动模型，采用以下控制律和自适应律进行控制；所述控制律为：其中s为滑模面，取e为俯仰角误差e＝θ-θd，θd为期望俯仰角，λ为满足Hurwitz条件的正常数；sgn(s)表示s的符号；参数τ和k由设定的滑模面s的趋近律得到，模面s的趋近律为指数趋近律且τ＞0,k＞0。采用指数趋近律主要是为了改善滑模趋近运动的动态品质。为了解决执行器饱和的问题，设计有动态补偿器，w为设计的动态抗饱和补偿器状态，设计的动态抗饱和补偿器为：其中Δu＝u-δe，sT表示s的转置，表示给定的抗饱和参数，且满足||·||表示范数，ι取值范围为[0,0.001]；所述自适应律为：其中，为h的估计值；ρ为非线性项和外界未知干扰D的上界，为ρ的估计值，ε1,ε2,k1,k2均为给定的自适应律设计参数。对于上述控制律，下面采用李雅普诺夫稳定性原理证明所设计控制律的稳定性。选取李雅普诺夫候选函数：其中，对候选函数V求关于时间的导数，则有：进本文档来自技高网...

【技术保护点】
一种自主水下航行器动态抗饱和俯仰角控制方法，其特征在于：包括以下步骤：步骤1：忽略水下航行器俯仰运动和横滚运动的耦合，建立水下航行器俯仰运动模型：θ·=ωz]]>ω.z=c1ωz+c2α+c3u+D]]>α.=c4ωz+c5α+c6u]]>y＝θ其中θ是俯仰角，ωz是俯仰角速度，α是攻角，u是控制输入，D表示非线性项和外界未知干扰，y是输出，c1，c2是未知的需要估计的模型参数，c3是已知的控制增益，c4，c5，c6为设定的模型参数；控制输入u取决于控制器输出的舵角δe：u=sat(δe)=um,δe>umδe-um<δe<um-umδe<um]]>其中um为控制器幅值；步骤2：对步骤1设计得到的水下航行器俯仰运动模型，采用以下控制律和自适应律进行控制；所述控制律为：δe=1c3[-τ(s-w)-k*sgn(s)-h^Tφ-ρ^*sgn(s)+θ&CenterDot;·d-λ(ωz-θ·d)]]]>其中s为滑模面，取e为俯仰角误差e＝θ‑θd，θd为期望俯仰角，λ为满足Hurwitz条件的正常数；sgn(s)表示s的符号；参数τ和k由设定的滑模面s的趋近律得到，模面s的趋近律为指数趋近律且τ＞0,k＞0；w为设计的动态抗饱和补偿器状态，设计的动态抗饱和补偿器为：w.=-kw-|c3sTΔu|+12(Δu)2||w||2w+Δu,||w||≥ι0,||w||<ι]]>其中Δu＝u‑δe，sT表示s的转置，表示给定的抗饱和参数，且满足||·||表示范数，ι取值范围为[0,0.001]；所述自适应律为：h^.=-ϵ1h^+k1φs]]>ρ^.=-ϵ2ρ^+k2|s|]]>其中，hT＝[c1,c2]，φ＝[ωz,α]T，为h的估计值；ρ为非线性项和外界未知干扰D的上界，为ρ的估计值，ε1,ε2,k1,k2均为给定的自适应律设计参数。...

【技术特征摘要】
1.一种自主水下航行器动态抗饱和俯仰角控制方法，其特征在于：包括以下步骤：步骤1：忽略水下航行器俯仰运动和横滚运动的耦合，建立水下航行器俯仰运动模型：y＝θ其中θ是俯仰角，ωz是俯仰角速度，α是攻角，u是控制输入，D表示非线性项和外界未知干扰，y是输出，c1，c2是未知的需要估计的模型参数，c3是已知的控制增益，c4，c5，c6为设定的模型参数；控制输入u取决于控制器输出的舵角δe：其中um为控制器幅值；步骤2：对步骤1设计得到的水下航行器俯仰运动模型，采用以下控制律和自适应律进行控制；所述控制律为：

【专利技术属性】
技术研发人员：崔荣鑫，严卫生，张欣，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：陕西;61