基于新型趋近律的潜艇垂直面滑模控制仿真

2019-03-30陆斌杰李文魁陈永冰

舰船科学技术 2019年3期

陆斌杰，李文魁，周岗，陈永冰

(海军工程大学电气工程学院，湖北武汉 430033)

0 引言

潜艇运动为六自由度空间运动，表现出大惯性、强非线性、各运动平面强耦合的复杂特点，通常难以获得精确的数学模型，且用于潜艇控制设计的方程系数会由于环境、水深及潜艇状态等的变化而变化，使系统工作点偏离设计状态，影响控制效果，使控制器的设计难度大大增加。

国内外众多学者基于经典控制理论和现代控制理论设计了潜艇控制器。基于伯德图和根轨迹法设计的控制器设计从频域角度入手，结构简单，容易实现，但对参数摄动和扰动鲁棒性较差，尤其是难以处理复杂非线性问题[1]。针对非线性系统的控制问题，多名学者进行了深入研究[2 – 3]，但控制器结构复杂，难以实现。而通过模糊方法设计非线性鲁棒补偿器，一定程度上可以简化控制器的复杂度[4]。近年来，滑模控制（SMC，sliding mode control）对满足匹配条件的任意摄动和外界干扰具有较强鲁棒性，且其算法简单、响应快速、易于工程实现，受到广泛关注[5 – 10]。传统的滑模控制方法采用极点配置法、最优控制等方法设计线性切换函数，利用基于边界层方法的准滑模控制降低抖振，设计潜艇垂直面准滑模控制器。潜艇垂直面操纵运动为双输入双输出过程，深度控制通道与纵倾控制通道相互耦合，且耦合程度由潜艇的艇型与升降舵的配置密切相关，因此针对此类双入双出的多变量系统，一般可相对增益分析法分析其各回路的耦合程度[11]，再进行解耦处理[12]，在弱耦合和确保鲁棒性的情况下可忽略耦合[13 – 14]。不同机动情况下，潜艇水动力差异巨大，对控制模型的设计和控制器的鲁棒性提出较高要求。文献[15]采用线性化模型研究了潜艇大攻角下的滑模控制，起到了较好的控制效果。同时在不增加模型复杂度的情况下也可结合模糊控制等方法设计滑模控制器以降低抖振[16 – 17]。

基于以上考虑，为了使控制器模型简便且确保控制系统的鲁棒性，本文采用潜艇垂直面线性设计模型，基于双幂次趋近律设计了一个滑模控制器。为了估计系统不可测量的状态，引入了Luenberger状态观测器。将该控制器与经典PID控制器进行仿真对比，并应用于有部分参数摄动及有外界干扰情况下的垂直面控制。

1 潜艇垂直面运动模型

坐标系、名词术语、符号规则均采用ITTC和SNAME 术语公报的体系[18 – 19]。固定坐标系（定系）E-ξηζ和运动坐标系（动系）O-xyz如图1所示。

图 1 固定坐标系和运动坐标系Fig. 1 Fixed coordinate system and the motion coordinate system

潜艇垂直面非线性操纵运动模型由潜艇标准运动方程简化得到[20]：

1）纵向方程

2）垂向方程

3）纵倾方程

式中，h为潜艇稳心高。

4）运动方程

由于非线性方程不便于控制系统分析，本文作如下假设：1）纵向速度恒定；2）忽略所有非线性项；3）纵倾、横摇很小，，。4）忽略舵力与角速度项的耦合，略去、、、，由此得到垂直面线性设计模型：

式（9）可进一步写为：

2）舵机模型

首尾舵舵机模型均采用如下模型[13]：

2 基于新型趋近律的滑模控制器设计

2.1 潜艇垂直面控制策略

一般潜艇深度自动控制有如下几种模式：1）尾舵自动深度模式，即尾舵单独控制深度和纵倾，指令舵角的解算与深度的偏差和纵倾的偏差均有关，在给定深度变化的同时，纵倾角偏差反馈给尾舵，产生相应舵角以控制纵倾角不超过规定范围；2）首、尾舵联合自动深度模式，即深度和纵倾分别由首舵和尾舵控制。本文综合考虑首舵和尾舵和控制效果，选取第2种模式设计控制器。针对首舵和尾舵控制的耦合，采取策略为：首舵主要控制深度，视尾舵为干扰；尾舵主要控制纵倾，视首舵为干扰。

潜艇垂直面运动分变深机动和定深机动。其中变深步骤为：1）给定纵倾指令和深度指令，自动控制潜艇下潜或上浮；2）在接近指令深度的某一转换深度上，将指令纵倾转换为，控制潜艇进入指令深度上的无纵倾航行状态。转换深度可根据变深的范围合理取值。分深度和纵倾控制2个子系统，如图2所示。

2.2 传统滑模控制器设计

图 2 首尾舵联合自动深度控制Fig. 2 Combined automatic depth control of bow and stern rudder

由式（5）和式（7）可得等效控制：

切换控制部分采用准滑模控制[10]：

考虑首舵、尾舵动态响应并忽略相互间耦合影响，首、尾舵控制律，分别为：

滑模运动的稳定性完全取决于滑模参数的选取，滑模的存在性问题转化为式（9）系统的原点镇定问题，选取Lyapunov函数为：

2.3 双幂次趋近律设计

为进一步降低抖振，采用双幂次趋近律[22]：

根据滑模可达性，由式（11）可得：

结合式（5）、式（7）和式（9）可得控制律：

选取Lyapunov函数为：

该控制律满足全局渐近稳定性条件。

3 Luenberger状态观测器设计

引入状态观测器后，滑模控制为：

选取Lyapunov函数为：

该控制律满足全局渐近稳定性条件。

4 仿真

为验证控制器的正确性，针对潜艇定深和变深运动控制进行仿真和分析。潜艇仿真方程为完整的非线性运动方程。采用文献[1]的潜艇参数。控制器设计参数为：，，，，，，，，，，，。观测器极点配置：

分3种情况将SMC的控制效果和经典PID控制器的控制效果对比仿真。

1）当潜艇参数无摄动和无外界扰动时，图3和图4分别给出了深度、纵倾响应曲线与舵角曲线。由图可见，SMC比PID控制使深度能更快速无超调趋近指令深度，达到指令深度后沿期望深度稳定航行，纵倾符合限制条件。滑模控制首、尾舵打舵比PID控制更为平滑。

2）系统部分参数摄动但无外界扰动。由于控制性能主要受垂向方程和纵倾方程有关参数影响，由式（9）知，，包含了主要系统参数，未验证滑模控制器的鲁棒性，设系统参数进行大范围摄动，令，为系统实际参数，选取范围：，。控制器参数不变，当系统参数分别在标称模型的50%和200%范围摄动时，SMC比PID控制使深度能更快速无超调趋近指令深度。滑模控制首、尾舵打舵比PID控制更为平滑，如图5和图6所示。

图 3 潜艇参数无摄动时的深度和纵倾响应Fig. 3 Depth and pitch response without parameter perturbations of submarine

图 4 潜艇参数无摄动时的舵角Fig. 4 Rudder angle without parameter perturbations of submarine

3）当无摄动但有外界扰动时，为便于分析，任意选取正弦扰动信号：，

图 5 潜艇参数摄动时的深度和纵倾响应Fig. 5 Depth and pitch response with parameter perturbations of submarine

图 6 潜艇参数摄动时的舵角Fig. 6 Rudder angle with parameter perturbations of submarine

控制参数及初始条件不变。图7和图8分别给出了深度、纵倾响应曲线与舵角曲线。由图可见，SMC比PID控制使深度能更快速无超调趋近指令深度。滑模控制打舵次数与幅度明显小于PID控制，且收敛更快速。经测试，当外界扰动力量级小于时，系统仍能保持较好的控制性能，深度仍可快速无超调到达稳态，纵倾符合限制条件，舵角出现较小抖振。而当扰动量级大于，两类控制器控制下的系统均会出现大幅振荡，舵角出现大幅高频打舵现象，无法满足控制条件。

图 7 正弦干扰下的深度和纵倾响应Fig. 7 Depth and pitch response of sinusoidal interference

图 8 正弦干扰下的的舵角Fig. 8 Rudder angle under sinusoidal interference

表1分别给出了3种情况下，在SMC和PID控制下的潜艇深度和纵倾的超调量、稳态误差，SMC的控制效果均优于传统的PID控制效果。

5 结语

本文基于潜艇垂直面线性模型，忽略首尾舵之间的耦合，采用首舵控制深度，尾舵控制纵倾的策略，采用新型趋近律设计滑模控制器。仿真结果表明，在参数无摄动和有摄动及有无外界干扰情况下滑模控制器控制效果均优于PID控制器，且无明显抖振，为了确保系统的稳定性，对控制器参数的整定优化应做进一步研究，因此可采用垂直面线性模型设计垂直面滑模控制器，从而既降低了控制器复杂度，又提高了控制器的鲁棒性，对工程应用及研究具有重要意义。