2. 天津航海仪器研究所九江分部,天津 300131
2. Jiujiang Division, Tianjin Navigation Instruments Research Institute, Tianjin 300131, China
船舶在海上航行时,海浪的一阶波浪力会造成船舶航向的高频振荡,若直接将此信号反馈给自动舵系统,航向控制器会输出相应的高频舵角指令。然而由于船舶是一个大惯性系统,其航向运动的响应频率较小,当船舶的舵机系统接收到高于船舶航向响应频率的舵角指令时,无论采取多大舵角,船舶的运动状态都不会响应,这种操舵被称为无效操舵[1]。
在自动舵系统中,解决无效操舵现象的通常做法是对海浪高频干扰下的航向信号进行滤波,常用的滤波方法有均值滤波、低通滤波、带通滤波与陷波滤波等[2],但这几种滤波方法会产生信号的相位滞后,这种滞后会恶化航向控制器的控制效果。为解决相位滞后问题,樊冀生等[3]在陷波滤波器基础上进行改进,通过扩张一个状态量对陷波滤波器的滞后进行补偿,解决了陷波滤波器的滞后问题,但这种方法无法同时对船舶的速度状态量进行重构。李杨等[4]通过分析海浪高频模型,在潜艇线性化模型基础上加入海浪高频模型,通过状态观测器的方法将航向信号中高频与低频信号进行分离,并对低频的航向角速度信号进行重构,有效减少了无效舵问题。但这种方法在风、流与海浪二阶漂移力的情况下观测结果会存在静差,进而影响了航向控制器的控制效果。
本文针对海浪干扰下船舶控制系统存在的无效舵问题以及风、流干扰下观测器存在的静差问题,提出一种基于扩张状态卡尔曼滤波的海浪滤波算法,并结合传统的PID控制器验证了该算法的优势。
1 船舶Nomoto模型与参数辨识船舶的MMG分离模型[5]描述如下:
{˙x=ucosψ−vsinψ,˙y=usinψ+vcosψ,˙ψ=r,˙u=(m+my)vr+XH+XP+XR+Xdisturbm+mx,˙v=(m+mx)ur+YH+YP+YR+Ydisturbm+my,˙r=NH+NP+NR+NdisturbIzz+Jzz。 | (1) |
式中:
由于船舶MMG模型结构复杂,水动力参数居多,不能直接用于状态观测器与控制器的设计,且由于船舶在大洋航行时主要关注航向、航向角速度等状态的信息,因此以Nomoto模型[6]代替MMG模型进行状态观测器的设计,一阶线性Nomoto模型如下式:
T˙r+r=Kδ+d。 | (2) |
式中:
为了对Nomoto模型的
T˙ψ(k)−T˙ψ(k−1)Ts+ψ(k)−ψ(k−1)Ts=kδ(k−1),Tψ(k)−Tψ(k−1)Ts−Tψ(k−1)−Tψ(k−2)Ts+ψ(k)−ψ(k−1)=TsKδ(k−1),Tψ(k)−Tψ(k−1)−Tψ(k−1)+Tψ(k−2)+Tsψ(k)−Tsψ(k−1)=T2sKδ(k−1),(T+Ts)ψ(k)−(2T+Ts)ψ(k−1)+Tψ(k−2)=T2sKδ(k−1),ψ(k)=2T+Ts(T+Ts)ψ(k−1)−T(T+Ts)ψ(k−2)+T2s(T+Ts)Kδ(k−1)。 | (3) |
式中
将离散化的Nomoto方程转化为参数估计的形式:
ψ(k)=ϕT(k−1)θ。 | (4) |
式中:
ϕT(k−1)=[ψ(k−1),ψ(k−2),δ(k−1)],θT=[θ1,θ2,θ3]。 |
基于船舶巡航航速下的Z型实验数据采用带有遗忘因子的最下二乘算法[7]对式(4)进行参数估计,如下式:
{K(k)=P(k−1)ϕ(k−1)λ+ϕT(k−1)P(k−1)ϕ(k−1),θ(k)=θ(k−1)+K(k)[ψ(k)−ϕT(k)θ(k−1)],P(k)=1λ[I−K(k)ϕT(k−1)]P(k−1)。 | (5) |
式中:
最终可求得船舶的
T=θ1−12−θ1Ts,K=θ3(T+Ts)T2s。 | (6) |
海浪对于航行中船舶的作用力分为一阶波浪力与二阶波浪力。其中,二阶波浪力为漂移力,其作用可使船舶偏离原航向;一阶波浪力为高频作用力,其作用会使船舶航向高频摆动。由Fossen[8]的研究成果可知,一阶海浪力对船舶航向产生的高频摆动运动可由如式(7)所示的二阶传递函数表示。
ψH(s)=Kωss2+2ζωns+ωn2wH(s)。 | (7) |
式中:
将式(7)所示的二阶传递函数以状态方程的形式表示,如下式:
˙ξH = ψH,˙ψH = −2ζωnψH−ωn2ξH+KwwH。 | (8) |
由船舶上的罗经设备测得的航向角可认为是由操舵产生的航向角、一阶海浪力产生的航向角和测量干扰叠加而成,如下式:
ψ=ψL+ψH+υH, | (9) |
式中,
根据船舶的Nomoto响应性模型与海浪造成的船舶航向高频运动状态方程(8),可得到海浪干扰和操舵联合作用下的船舶航向运动状态方程:
[˙ψL˙rL˙ξH˙ψH]=[01000−1T00000100−2ζωnωn2][ψLrLξHψH]+[0KT00]δ+[000Kw]wH。 | (10) |
由于船舶在航行过程中会受到风、流、浪的二阶干扰力影响,Nomoto模型中环境与未建模的综合干扰项d会使状态观测的结果存在误差。因此综合干扰项作为扩张状态加入到运动状态方程(10)中,补偿状态观测误差。扩张后的状态方程如下式:
[˙ψL˙rL˙ξH˙ψH˙d]=[010000−1/T0010001000−2ζωnωn2000000]⏟A[ψLrLξHψHd]⏟X+[0K/T000]⏟Bδ⏟U,ψ⏟Z=[10010]⏟CX。 | (11) |
使用后向差分方法对扩张状态的状态空间表达式进行离散化处理,离散化后的表达式如下式:
{Xk=AdXk−1+BdUk−1,Zk=CdXk。 | (12) |
式中:
基于卡尔曼滤波原理[9]根据船舶航行时的实时输入输出数据重构运动状态信息。卡尔曼滤波的递推过程如下:
1)确定过程噪声方差Q、测量噪声方差R、初始状态X0以及初始协方差矩阵P0。
2)根据前一时刻的状态估计值推算当前时刻的状态先验估计值,如下式:
Xk−1|k=AdXk−1+BdUk−1, | (13) |
Pk−1|k=AdPk−1ATd+Q。 | (14) |
3)计算卡尔曼增益,如下式:
Kk=Pk−1|kCTd(CdPk−1|kCTd+R)−1。 | (15) |
4)根据测量值与先验估计值计算状态后验估计值与误差协方差后验估计值,如下式:
Xk=Xk−1|k+Kk(Zk−CdXk−1|k), | (16) |
Pk=(I−KkCd)Pk−1|k。 | (17) |
为了验证本文所设计的海浪滤波算法的有效性,以47.4 m长的执法船海巡0208轮作为仿真对象进行算法验证。
设置船舶航行速度为12 kn,在无环境干扰的工况下进行Z型试验,仿真结果如图1所示。
![]() |
图 1 Z型试验仿真结果 Fig. 1 Simulation result of Z−type test |
以所设计的基于遗忘因子最小二乘的参数辨识算法进行K和T参数的辨识,辨识结果如图2所示。
![]() |
图 2 K,T参数辨识结果 Fig. 2 Identification results of K and T parameters |
从K和T参数的辨识结果中可以看出,2个参数在50 s后趋于稳定。为了准确的求解K和T参数,对100 s后的数据求取平均值,最终求解出的K和T参数为:
K=0.1249,T=2.0187。 |
为了验证本文设计海浪滤波器的无差观测能力,在风向为90°的5级风、无海浪干扰环境下进行变向控制试验,控制器选用传统的PID控制器,对比分别以四阶状态方程(10)与五阶状态方程(11)设计观测器的观测效果,仿真结果如图3与图4所示。
![]() |
图 3 航向观测结果对比图 Fig. 3 Comparison of course observation results |
![]() |
图 4 航向角速度观测结果对比图 Fig. 4 Comparison of course velocity observation results |
可以看出,五阶状态方程观测出与实际航向、航向角速度稳定值基本重合,而四阶状态方程观测出的航向值稳定后存在0.6°的静差,航向角速度值稳定后存在0.12°/s的静差,证明本文设计的海浪滤波算法能够在干扰环境下准确的估计出船舶的运动状态。
为了验证本文设计海浪滤波器的航向高频信号滤波能力与无效舵抑制能力,在4级海况下进行定向控制试验,控制器选用传统的PID控制器,航行速度设置为12 kn,500 s时开启海浪滤波器,仿真结果如图5与图6所示。
![]() |
图 5 航向角仿真曲线 Fig. 5 Simulation curve of course |
![]() |
图 6 舵角仿真曲线 Fig. 6 Simulation result of rudder |
从图5可以看出,500 s开启海浪滤波器后观测航向的频率与幅度明显降低,达到了航向中由海浪一阶力造成的高频干扰滤除的目的;从图6可以看出,500 s开启海浪滤波器后控制器输出舵角指令的频率与幅度均有明显降低,舵角的均方根由3.28°降为0.19°,证明该方法能够有效地降低控制器产生的无效舵现象。结合图5实际航向仿真曲线可以看出,在无效舵降低的同时航向的控制精度并未发生变化。
4 结 语本文针对海浪干扰下船舶控制系统存在的无效舵问题以及风、流干扰下观测器存在的静差问题,设计一种基于扩张状态卡尔曼滤波的波浪滤波算法,通过构建的五阶扩张状态方程与卡尔曼滤波器结合,同时完成运动状态的误差估计与海浪高频干扰信号的滤除。仿真结果表明,该算法能够有效滤除船舶航向的高频信号并正确的估计出船舶的运动状态,并显著减少了船舶航行时的无效舵问题。
[1] |
彭秀艳, 胡忠辉. 带有海浪滤波器的船舶航向反步自适应输出反馈控制[J]. 控制理论与应用, 2013, 30(7): 863-868. DOI:10.7641/CTA.2013.21104 |
[2] |
王元慧, 边信黔, 施小成. 海浪噪声的仿真与滤波[J]. 计算机仿真, 2007, 24(4): 318-321. DOI:10.3969/j.issn.1006-9348.2007.04.086 |
[3] |
樊冀生, 袁伟, 李文娟. 船舶动力定位自适应滤波器设计[J]. 舰船科学技术, 2017, 39(10): 79-83. DOI:10.3404/j.issn.1672-7649.2017.10.015 |
[4] |
李杨, 徐雪峰, 赵光. 基于扩展状态观测器的海浪滤波算法及仿真[J]. 中国舰船研究, 2020, 15(1): 1-5. DOI:10.19693/j.issn.1673-3185.01651 |
[5] |
DO K D, JIANG Z P, PAN J. Global robust adaptive path fllowing of underactuated ships[J]. Automatica, 2006, 42(10): 1713-1722. DOI:10.1016/j.automatica.2006.04.026 |
[6] |
李奕. 无人艇航向运动控制技术研究[D]. 哈尔滨: 哈尔滨工程大学, 2018.
|
[7] |
周怡, 王俊雄. 自适应粒子群算法在AUV水动力参数识别中的应用[J]. 舰船科学技术, 2021, 43(11): 90-95. |
[8] |
FOSSEN T I, PEREZ T. Kalman filtering for positioning and heading control of ships and offshore rigs[J]. IEEE Control Systems, 2009, 29(6): 32-46. DOI:10.1109/MCS.2009.934408 |
[9] |
FOSSEN T I. Guidance and control of ocean vehicles[M]. Chichester: John Wiley & Sons, 1994.
|