船舶动力定位自适应滤波器设计

樊冀生，袁 伟，李文娟，金 月

(江苏科技大学 电子信息学院，江苏 镇江 212003)

船舶动力定位自适应滤波器设计

樊冀生，袁 伟，李文娟，金 月

(江苏科技大学 电子信息学院，江苏 镇江 212003)

传统的陷波滤波器虽然能够很好的滤除一阶高频海浪波，但是滤波的同时也使得信号产生了相位滞后，在时域里面的表现就是信号的延时。卡尔曼滤波器虽然能够解决这一问题，但是其非常依赖于船舶模型。本文针对传统陷波滤波器的缺陷，使用了一种积分补偿型陷波滤波器，对传统的陷波滤波器进行改进。并以某拖轮为仿真对象进行仿真实验，其结果表明，该滤波器不但能够很好的滤除高频海浪波，还能够保持很好的相位特性。同时，递推的最小二乘估计（RLS）方法能够实时的估计出海浪的主导波频，使得陷波滤波器具有很好的自适应性。

动力定位；相位滞后；陷波滤波器；自适应

0 引 言

滤波技术对于船舶的运动控制系统具有非常重要的地位。由一阶波浪导致的船舶高频运动不能够进入到控制系统中去。如果进入控制系统后，会引起推进器做不必要的动作，造成推进器的疲损，并且会消耗大量不必要的燃料[1]。传统的低通或者陷波滤波器会造成相位滞后，降低控制器的性能。卡尔曼滤波器，虽然能够很好地解决这一问题，但是却十分的依赖系统的模型，而且在实船当中，其过程噪声矩阵、初始值、初始误差矩阵也很难确定[2]。所以，本文提出一种基于递推的最小二乘频率估计的改进陷波滤波器，在滤除高频波的同时，又能保证具有很好的相位特性。

1 海浪的高频模型

高频波的模型一般用的是线性的波浪模型，该模型能够对一阶波浪运动进行很好的近似[6 – 7]：

将式（1）转化为时域的形式，得

转化为状态空间的形式：

当主导波频 ω0= 0.5 rad，ζ = 0.1，σω= 0.58 时，高频的输出如图1所示。

图1 高频波浪的输出Fig. 1 Output of high frequency waves

2 改进的滤波器系统框图

由图2可看到，DGPS 的数据或者电罗经的数据首先通过递推最小二乘估计得到高频海浪 AR 模型中的系数，然后求解 AR 模型，得到海浪的主导波频。接着设置改进的陷波滤波器的陷波频率，最后将每个方向的数据传入到改进的陷波滤波器当中去，得到 3 个方向滤波后的值。

图2 滤波流程图Fig. 2 Filtering flow chart

3 递推的最小二乘波频估计

递推的最小二乘估计，虽然算法不是最新的算法，但是并未有任何文献把该方法应用于估计海浪的主导波频。其具体的方法如下：

波浪主导波频的估计可以通过建立一个 AR 模型来估计出来[4]。该随机过程通过白噪声激励产生。

AR 模型的形式如下：

船舶的总运动方程为：

其中：ΨH（s）为船舶的高频运动；ΨL（s）为船舶的低频运动。ΨH（s）可以通过一个一阶高通滤波器来得到：

其中 Tf为滤波的时间常数。为了将式（6）表示成 AR模型的形式，需重新定义一个变量[3]：

将式（8）与式（5）进行对比，得到：

对 a1，a2，a3的估计通过带遗忘因子的递推最小二乘估计得到的：

采样时间为 1 s，修改高频海浪模型中主导波频参数，产生如表1所示的 8 段数据。

表1 高频波浪数据Tab. 1 Data of high frequency wave

RLS 仿真估计波浪频率的结果如图 3 所示。

从图中可看到，一开始由于初始状态值，初始的误差选取的影响导致波浪频率估计的波动存在误差，波动比较大，但是随着时间的推移，大约在 300 s 之后，波频估计逐渐稳定，面对不断跳变的波频，如在临界点 1 000 s，1 500 s，2 000 s，2 500 s，3 000 s，3 500 s等处均能够达到预期的效果，比较好的跟踪了波浪的频率，可以满足工程应用的需求。

图3 递推的最小二乘波频估计Fig. 3 Recursive least square wave frequency estimation

4 改进的陷波滤波器

传统的陷波滤波器，虽然能够很好地滤除掉一阶波浪产生的高频运动，但同时也产生了严重的相位滞后，在时域里面的表现就是信号的延时[8–9]。为此，针对传统滤波器的缺陷，提出了积分补偿的陷波滤波器。

传统的陷波滤波器的传递函数为：其中：w 为陷波的频率；ζ 为相对阻尼系数；Q 为带通滤波器。

将 Q 转化为状态空间的形式：

为了克服传统滤波器相位滞后的缺陷，需要对式（12）进行改进，改进后的状态方程为：

其中 x3对传统的陷波滤波器输出起到补偿作用，x3的大小可以通过 a 的值来调节。

改进滤波器的框图如图 4 所示。

图4 改进的滤波框图Fig. 4 Improved filter block diagram

当陷波的频率为 0.5 rad/s，ζ 为 0.1 时，2 种滤波器的 bode 图如图5所示。

图5 改进滤波器的伯德图Fig. 5 Improved filter Bode diagram

从伯德图的幅频曲线可看出，滤波器可对波浪进行有效的幅度衰减，从相频曲线图上可看到与传统的滤波器相比较而言，改进的陷波滤波器具有很好的相频特性，信号的相位延迟和超前得到明显的改善。

5 仿真实验

以某海工多用途拖轮为对象，利用改进滤波器来进行仿真。开始点在（0 m，0 m），首向值为 0 °，定位点设置在（20 m，20 m），首向值设置为 0 °，主导波频，积分补偿系数 a =2.5，采用 LQG 控制算法对船舶进行控制。

表2 仿真船舶的主要参数Tab. 2 Main parameters of simulation ship

波频估计的结果如图 6 所示。

从仿真结果来看，一开始由于初始值和初始误差矩阵的选取造成了波频估计器的不稳定，大约在 180 s左右稳定下来，结果保持在我们所期望的 0.5 rad/s 左右，接着无论在 600 点处的上升沿还是在 1 200 处的下降沿，都能够很好地追踪到波浪的主导波频。

纵荡横荡首向以及船舶的行走轨迹对比如图 7～图 9 所示。

图6 波频估计Fig. 6 Wave frequency estimation

图7 船舶纵荡的对比Fig. 7 Comparision of the direction of surge

图8 船舶横荡对比Fig. 8 Comparision of the direction of sway

图9 船舶首向对比Fig. 9 Comparision of the direction of yaw

由图可以看到，船舶的纵荡、横荡和首向3个方向的改进滤波器具有更好的优越性，能够很好地去除高频波浪干扰，使得滤波值更接近真实值。从图 10 中可以看到，与传统的陷波滤波器相比较而言，改进陷波滤波器更加地接近于真实值。从图 11 中可以明显地看出 3 个方向的误差，改进滤波器具有更小的误差。

图10 船舶行走轨迹对比Fig. 10 Comparison of ship's walking trajectory

图11 误差对比Fig. 11 Error contrast

6 结 语

综上所述，本文针对传统陷波滤波器卡尔曼滤波器的缺陷提出了一种不依赖于具体船舶模型的自适应得改进型陷波滤波器。并以某拖轮为仿真对象，进行仿真。仿真的结果表明，用基于递推的最小二乘（RLS）波频估计的改进得陷波滤波器，能够实时的估计出波浪的主导波频，对外界环境有很好的自适应性。与传统的陷波滤波器相比，具有更好的相位特性，解决了由于相位的滞后或者超前导致的时间上的偏差，同时在滤波过程中未涉及船舶的质量矩阵，水动力系数矩阵等参数的计算，所以与扩展卡尔曼相比具有更好的鲁棒性，不依赖于船舶的运动模型。

[1]边信黔, 付明玉, 王元慧. 船舶动力定位[M]. 北京: 科学出版社, 2011.

[2]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.

[3]FOSSEN T I. Guidance and control of ocean vehicles[M].Chichester, UK: John Wiley and Sons, 1994.

[4]张贤达. 现代信号处理[M]. 北京: 清华大学出版社, 1995.

ZHANG Xian-da. Modern signal processing[M]. Beijing:Tsinghua University Press, 1995.

[5]LOUEIPOUR M, KESHMIRI M, DANESH M, et al. Wave filtering and state estimation in dynamic positioning of marine vessels using position measurement[J]. IEEE Transactions on Instrumentation and Measurement, 2015, 64(12): 3253–3261.

[6]齐国鹏, 俞孟蕻, 袁伟. 动力定位系统自适应滤波技术[J]. 舰船科学技术, 2013, 35(10): 96–100.

QI Guo-peng, YU Meng-hong, YUAN Wei. Research on adaptive filtering techniques in dynamic positioning systems[J].Ship Science and Technology, 2013, 35(10): 96–100.

[7]FOSSEN T I. Marine control systems-guidance, navigation, and control of ships, rigs and underwater vehicles[M]. Norway:Marine Cybernetics, 2002.

[8]TANNURI E A, BRAVIN T T, PESCE C P. Dynamic positioning systems: comparison between wave filtering algorithms and their influence on performance[C]//Proceedings of ASME 2003 22nd International Conference on Offshore Mechanics and Arctic Engineering. Cancun, Mexico: ASME,2003: 109–117.

[9]FAŸ H. Dynamic positioning systems principles, design and applications[M]. Paris: Editions Technip, 1990.

Adaptive filter design for ship dynamic positioning

FAN Ji-sheng,YUAN Wei,LI Wen-juan,JIN Yue
(Jiangsu University of Science and Technology,Zhenjiang 212003,China)

Although the traditional notch filter can filter out the 1st-order disturbances,it will also make the signal has a serious phase lag,whose performance in the time domain is the time delay.Kalman filter can solve the problem well,but it depends on the ship model very much.This paper aims at the defects of the traditional notch filter using a integral compensation notch filter,which can improve the traditional filter.A simulation experiment based on a tugboat shows this filter not only can well remove high frequency wave,but also can maintain good phase characteristics.At the same time,the Recursive least squares is used to estimate the dominant wave frequency,which makes the filter have better adaptability.

dynamic positioning；phase lag；notch filter；adaptability

U661

A

1672 – 7649(2017)10 – 0079 – 05

10.3404/j.issn.1672 – 7649.2017.10.015

2016 – 04 – 26；

2016 – 05 – 13

江苏高校高技术船舶协同创新中心/江苏科技大学海洋装备研究院资助项目(HZ2016006)

樊冀生(1992 – )，男，硕士研究生，研究方向为船舶运动控制技术。