[发明专利]基于反步法的船舶自适应鲁棒航向跟踪控制方法

说明书

技术领域

本发明涉及的是一种船舶的航向跟踪控制方法，具体地说是一种船舶在存在未知干扰情况下的航向跟踪控制方法。

背景技术

随着世界航运业的迅速发展，船舶航行安全以及现代化程度要求越来越高，因此船舶航行控制受到了广泛的关注。近几十年，出现了各种用于船舶控制系统的先进控制算法，如鲁棒控制、自适应控制以及各种智能控制方法等。但大多控制方法并没有应用于实际的控制系统中，一方面由于高级的控制方法带来了控制器设计上的复杂性以及过重的计算负担，另一方面与船舶运动的高度非线性以及复杂的海况也有很大关系。

工程上常用的船舶航向跟踪控制是PID控制，但由于船舶操纵过程具有的大惯性、非线性等特性，会引起船舶围绕期望航线呈周期性偏航运动，在给定的航向上偏航幅度较大，从而造成过多的操舵，在存在海浪干扰的情况下，偏航效果更明显。主要原因是控制器设计过于依赖船舶操纵数学模型，而精确的数学模型很难得到，因此考虑模型不确定性在设计船舶航向控制器时非常重要。同时，由于船舶的舵机系统无法实现阶跃操舵，忽略舵机特性将影响控制系统的性能品质。因此设计控制器时考虑舵机特性也是非常有必要的。

《大连海事大学学报》1999年发表的《船舶航向鲁棒PID自动舵设计》中针对Nomoto模型，考虑了模型中参数不确定性和外界干扰的不确定性，给出了PID型自动舵的传统设计方法。但此方法采用的是一阶线性模型，且并没有加入舵机系统的响应模型。在《Int.J.Appl.Math.Comput.Sci.》2007年17卷第1期发表的《A Backstepping Approach to Ship Course Control》针对带有舵机特性和不带舵机特性的非线性Norrbin模型分别设计了反步控制器，并采用遗传算法优化了控制器参数，但文中并没有考虑模型的不确定性与外界干扰的影响。在《哈尔滨工程大学学报》2012年33卷第1期发表的《带有舵机特性的船舶航向自动舵DSC-MLP设计》中，作者在模型中加入了舵机特性，并使用T-S模糊系统逼近理论估计了模型未知项，采用DSC与反步法相结合的方式设计了控制器，但所采用方法相对复杂，且控制器参数也较多，不利于实现。

发明内容

本发明的目的在于提供一种对不确定模型和未知干扰具有鲁棒自适应作用，。减小了控制器复杂性，误差变量收敛快的基于反步法的船舶自适应鲁棒航向跟踪控制方法。

本发明的目的是这样实现的：

包括航向参考信息生成器1、跟踪误差方程生成器2、微分同胚变换器3、角度虚拟控制器4、终端滑模控制器5、模型不确定项及外部干扰估计器6、非线性算子7、角速度期望虚拟控制器8、一阶低通滤波器9和控制器10；跟踪误差方程生成器2接收航向参考信息生成器1和传感器系统12的数据后得到船舶航向跟踪误差方程，通过微分同胚变换器3得到新的状态变量，将新的状态变量传递给角度虚拟控制器4和终端滑模控制器5，解算后传递给角速度期望虚拟控制器8；同时将微分同胚变换器3得到的新的状态变量、模型不确定项及外部干扰估计器6得到的估计值和非线性算子7计算的模型已知非线性项，也均发送给角速度期望虚拟控制器8，角速度期望虚拟控制器8经一阶低通滤波器9解算得到角速度虚拟控制律并发给控制器10；控制器10同时还接收传感器系统12的数据和新的状态变量以及角速度期望虚拟控制器8的输出值；最后控制器10将计算出的控制指令发送给船舶的执行机构舵机，实现水面船的航向跟踪。

传感器系统12测得的数据包括航向角、艏摇角速度和实际舵角，其中航向角和艏摇角速度分别发送给模型不确定项及外部干扰估计器6、非线性算子7和跟踪误差方程生成器2，实际舵角发送给控制器10；航向参考信息生成器1生成的参考信息包括期望航向角和期望艏摇角速度。

终端滑模控制器5将滑模面函数值传递给模型不确定项及外部干扰估计器6，模型不确定项及外部干扰估计器6用神经网络实现，其权值调整律通过终端滑模控制器5发来的滑模面函数值更新。

本发明的优点在于无需精确获取船舶数学模型，实现船舶航向稳定跟踪期望航向。设计控制器时考虑了模型不确定性和外界未知干扰，使闭环控制系统对不确定模型和未知干扰具有鲁棒自适应作用。对传统反步法进行了改进，避免了高阶虚拟控制律，减小了控制器复杂性。加入了终端滑模控制，保证闭环系统所有误差变量均能快速有限时间内收敛。

附图说明

图1为船舶自适应鲁棒航向跟踪控制方法总体结构图；

图2为航向跟踪曲线图；

图3为航向跟踪误差曲线图；

图4为指令舵角曲线；