专利名称：自由航行状态下耙吸挖泥船动力定位的滤波器设计方法
技术领域：
本发明涉及船舶动力定位技术，特别涉及特殊工程船舶中的大型耙吸挖泥船动力定位的滤波器设计方法。
背景技术：
船舶动力定位是指船舶无须借助锚泊系统的作用，而能不断检测出船舶的实际位置和目标位置的偏差，通过控制器计算出船舶克服外界干扰到达或恢复到目标位置所需要的推力和推力矩的大小，然后由推力分配系统使各个推进器做出相应的响应，进而使船舶尽可能的保持在目标位置或轨迹。对于水面上的船舶而言，动力定位的主要目的是实现船舶的位置(纵荡方向、横荡方向)和艏向三个自由度的控制。其中，位置信息(纵荡方向、 横荡方向)由差分全球定位系统(简称DGPS)测得，艏向信息由电罗经测得。影响这三个物理量的精度的主要因素来源于复杂的海洋环境干扰因素(风、浪、流的干扰等)和DGPS、 电罗经的测量误差。为了实现精确的动力定位，在位置(纵荡方向、横荡方向)和艏向信息送入到控制器之前，对船舶的位置(纵荡方向、横荡方向)和艏向进行滤波处理是很有必要的。耙吸挖泥船在自由航行状态下，会出现两种情况空载和满载。在每种情况下，耙吸挖泥船单位时间内吃水变化的幅度很小，可以认为是固定吃水，所受到的外界影响主要来源于风、浪、流，所不同的仅仅是两种情况下吃水的差异。本发明主要解决此种状态下的滤波器设计问题。经过对现有技术文献的检索，中国专利申请号201110080330. 2，专利名自适应干扰补偿的动态面挖泥船动力定位控制系统及其方法，虽然描述了挖泥船动力定位控制系统及其方法，但并没有详尽的描述动力定位控制系统中滤波器的具体设计。中国专利申请号200910052768. 2，专利名一种基于噪声矩阵实时修正的船舶动力定位方法，在船舶动力定位中采用了基于噪声矩阵实时修正的卡尔曼数字滤波器，对过程噪声矩阵进行实时更新，但并没有对量测噪声方差进行估计，且仅设计一个滤波器，导致状态向量的维数过高， 计算量极其繁重，难以保证实时性。
发明内容
本发明要解决的技术问题是提出一种自由航行状态下耙吸挖泥船动力定位的滤波器设计方法。一种自由航行状态下耙吸挖泥船动力定位的滤波器设计方法，包含以下步骤a)使用基于OPC标准的数据采集与处理软件获取耙吸挖泥船的PLC、传感器中的数据并传送到上位机；b)建立状态空间形式的耙吸挖泥船船舶运动数学模型，并建立滤波器所需的状态方程和量测方程，在纵荡、横荡、艏向三个自由度上分别设计滤波器；c)使用改进的Mge自适应滤波算法设计滤波器；
d)经滤波器滤波后得到耙吸挖泥船的位置(纵荡方向、横荡方向)和艏向角度。所述步骤a)中，从耙吸挖泥船的PLC、传感器中获取的数据包括DGPS测得到的船舶位置即纵荡方向和横荡方向、电罗经测得的船舶艏向角度即已转化为大地坐标系下船舶中心点的位置和艏向；风速和风向角；主推进器的功率、螺距百分比，侧推进器的螺距百分比，舵机的舵角，船舶舯吃水、艏吃水、艉吃水，船舶的排水量、型排水体积，船舶对地的速度，船舶对水的速度。所述步骤b)中，建立状态空间形式的耙吸挖泥船船舶运动数学模型，结构如下所示状态方程#=^4.1+ 5.^7 +五.W量测方程Υ= Η·Χ+ν其中，Α，B, Ε，H为系数矩阵，X为状态向量，Y为量测向量，U为推进机构产生的合力和合力矩项与风对船舶产生的风力、风力矩项之和，w为过程噪声项，ν为观测噪声项。所述步骤C)使用改进的Mge自适应滤波算法设计滤波器。本发明的有益效果是在耙吸挖泥船自由航行状态下，船舶的吃水可以认为是固定不变的，由于外界环境干扰中浪和流的不可测性，给系统过程噪声和观测噪声的准确描述带来了困难，采用改进的自适应滤波算法可以对状态方程中过程噪声的方差和量测过程中观测噪声的方差进行拟合，并进行实时估计和修正，从而达到降低模型误差、提高滤波精度的目的，比较准确的滤除高频干扰和噪声，估计出耙吸挖泥船低频偏移量。在纵荡、横荡、艏向三个自由度上分别设计滤波器，降低了状态向量的维数，降低了计算量，很好的保证了滤波的实时性。
图1是本发明的具体实现框图；图2自由航行状态下耙吸挖泥船满载滤波效果示意图；图3自由航行状态下耙吸挖泥船空载滤波效果示意图。
具体实施例方式下面将结合附图，对本发明的具体实现进行详细的说明。如图1所示，一种自由航行状态下耙吸挖泥船动力定位的滤波器设计方法，包括以下步骤1)使用基于OPC标准的数据采集与处理软件获取耙吸挖泥船的PLC、传感器中的数据并传送到上位机。获取的数据包括DGPS测得到的船舶位置(纵荡方向、横荡方向)和电罗经测得的船舶艏向角度(已转化为大地坐标系下船舶中心点的位置和艏向)；风速和风向角；主推进器的功率、螺距百分比，侧推进器的螺距百分比，舵机的舵角，船舶舯吃水、艏吃水、艉吃水，船舶的排水量、型排水体积，船舶对地的速度，船舶对水的速度等。船舶位置(纵荡方向、横荡方向)和艏向角度主要由以下几部分组成低频量、高频量和噪声。需要通过滤波器滤除高频量和噪声干扰，估计出低频量。这三个数据作为滤波器的输入数据，其余数据则用来建立和更新耙吸挖泥船的船舶运动数学模型，计算出船舶运动数学模型中的相关参数。2)建立状态空间形式的耙吸挖泥船船舶运动数学模型，并建立滤波器所需的状态方程和量测方程，在纵荡、横荡、艏向三个自由度上分别设计滤波器。建立状态空间形式的耙吸挖泥船船舶运动数学模型，结构如下所示状态方程#=^4.1+ 5.^7 +五.W量测方程Y= H · Χ+ν其中，Α，B, Ε，H为系数矩阵，X为状态向量，Y为量测向量，U为推进机构产生的合力和合力矩项与风对船舶产生的风力、风力矩项之和，这些数据从数据采集与处理软件中获得，w为过程噪声项，ν为观测噪声项。由于船舶综合运动状态方程的维数较高，直接用来设计滤波器会导致计算量过大，因此在纵荡、横荡和艏向三个方向上分别设计滤波器，设计思路、方法均一致。不考虑三个方向上的耦合，建立三个方向上的状态方程和量测方程，均采用如下结构形式状态方程=Xk= Ak, Η · XH+Bk, Η · Uk-AEk, · Wk^1量测方程Yk= Hk, · Xh+VH其中，Ak,k-l、Bk, H、Ek,k_i、Hk, H 为系数矩阵，Xk-IJ YkJ Uh, Wh, Vk-i 白勺定乂与上面白勺 X，Y，U，w，ν 相同。离散化处理，得状态方程=Xk=Φ,, η · XH+ Δ k,· Uk^1+ Γ k,^ · Wk^1量测方程Yk= Hk, · Xh+VH其中，Φ=I+h · Ak,η，Ak,η = h · Bk,η，Γ\,η = h · Ek,η，I 为相对应的单位矩阵，h为采样时间。3)使用改进的&ige自适应滤波算法设计滤波器，此步骤需要用到步骤a)中获取到的船舶位置(纵荡方向、横荡方向)和艏向角度。算法的具体实现步骤如下
(1)给定初始值Λ，Po，Q0，R0 ；
(2)^klk-I ~ ^k,k-\Pk-\^k,k-\ ^k,k-\Qk-J"k,k-\ ‘
(3)Χ·—\ = + ‘
(4)^k ~ Pklk—\Hk’k—\ k,k-\^kIk-I^k,k-\ + ^k-I )‘
(5)Xk = Xk!k-\ ；
(6) Pk=(I-H1)PkZH ；
(7)Vk=HkkJk-Yk-,
(8)f/o= Xk-Xk/ki,
(9)ι N-I Rk = TfZv^1 +UkH^l，N为窗口宽度，可根据具体情况设定 -Iy i=o
(10)1 N-I 丄 N ,=0
(11)若继续滤波，k = k+Ι，进入步骤⑵进行下一次循环，否则终止。其中，f。为状态向量的初始设定值，可按照滤波时的实测值进行初始设定；Ptl为估计均方误差阵的初始设定值，可设定为Ptl = 1041，1为与Ptl相对应的单位矩阵，仏为过程噪声矩阵的初始设定值，可设定仏=1021，1为与仏相对应的单位矩阵；Rtl为量测噪声矩阵的初始设定值，可设定Rtl = I，ι为与Rci相对应的单位矩阵。4)经滤波器滤波后得到耙吸挖泥船的位置(纵荡方向、横荡方向)和艏向角度。图2、图3为本滤波器的滤波效果示意图在平均风速为13m/s左右的海况下，船舶舯吃水为10. 8m左右、排水量为41611. 76 吨左右、对水航速为2. 5节左右的自由航行状态下，采用本滤波器，耙吸挖泥船满载时纵荡、横荡和艏向三个方向的滤波效果如图2所示，其中，抖动幅度较大的曲线为滤波前，平滑曲线为滤波后，估计误差均值、估计均方误差均值如表1所示。在平均风速为i:3m/s左右的海况下，船舶舯吃水为5. 95m左右、排水量为21424. 59 吨左右、对水航速为1. 0节左右的自由航行状态下，采用本滤波器，耙吸挖泥船空载纵荡、 横荡和艏向三个方向的滤波效果如图3所，其中，抖动幅度较大的曲线为滤波前，平滑曲线为滤波后，估计误差均值、估计均方误差均值如表1所示。在表1中，估计误差均值用来评估滤波精度，估计均方误差均值用来评估滤波效果的稳定性。在耙吸挖泥船动力定位精度要求纵荡、横荡方向士an，艏向方向士ι度的情况下，由表1和图2、图3可以看出，本滤波器能够有效地滤除高频干扰和噪声，估计出低频位置(纵荡、横荡)和艏向。表1估计误差均值、估计均方误差均值表
权利要求
1.一种自由航行状态下耙吸挖泥船动力定位的滤波器设计方法，其特征在于包含以下步骤a)使用基于OPC标准的数据采集与处理软件获取耙吸挖泥船的PLC、传感器中的数据并传送到上位机；b)建立状态空间形式的耙吸挖泥船船舶运动数学模型，并建立滤波器所需的状态方程和量测方程，在纵荡、横荡、艏向三个自由度上分别设计滤波器；c)使用改进的Mge自适应滤波算法设计滤波器；d)经滤波器滤波后得到耙吸挖泥船的位置即纵荡方向和横荡方向、和艏向角度。
2.根据权利要求1所述的自由航行状态下耙吸挖泥船动力定位的滤波器设计方法，其特征在于所述步骤a)中，从耙吸挖泥船的PLC、传感器中获取的数据包括DGPS测得到的船舶位置即纵荡方向和横荡方向、电罗经测得的船舶艏向角度即已转化为大地坐标系下船舶中心点的位置和艏向；风速和风向角；主推进器的功率、螺距百分比，侧推进器的螺距百分比，舵机的舵角，船舶舯吃水、艏吃水、艉吃水，船舶的排水量、型排水体积，船舶对地的速度，船舶对水的速度。
3.根据权利要求1所述的自由航行状态下耙吸挖泥船动力定位的滤波器设计方法，其特征在于所述步骤b)中，建立状态空间形式的耙吸挖泥船船舶运动数学模型，结构如下所示状态方程#= J.JT + ^.f/ +五.W量测方程=Y = H- X+V其中，A，B, E，H为系数矩阵，X为状态向量，Y为量测向量，U为推进机构产生的合力和合力矩项与风对船舶产生的风力、风力矩项之和，w为过程噪声项，ν为观测噪声项。
4.根据权利要求1所述的自由航行状态下耙吸挖泥船动力定位的滤波器设计方法，其特征在于所述步骤c)使用改进的Mge自适应滤波算法设计滤波器。
全文摘要
本发明公布了一种自由航行状态下耙吸挖泥船动力定位的滤波器设计方法，包含以下步骤使用基于OPC标准的数据采集与处理软件获取耙吸挖泥船的PLC、传感器中的数据并传送到上位机；建立状态空间形式的耙吸挖泥船船舶运动数学模型，并建立滤波器所需的状态方程和量测方程，在纵荡、横荡、艏向三个自由度上分别设计滤波器；使用改进的Sage自适应滤波算法设计滤波器；经滤波器滤波后得到耙吸挖泥船的位置(纵荡方向、横荡方向)和艏向角度。本发明降低模型误差、提高滤波精度，比较准确的滤除高频干扰和噪声，估计出耙吸挖泥船低频偏移量。
文档编号G06F17/50GK102411657SQ20111033704
公开日2012年4月11日 申请日期2011年10月31日 优先权日2011年10月31日
发明者俞孟蕻, 汪志勇, 袁伟, 郭婷婷, 陈迅, 齐亮, 齐国鹏 申请人:江苏科技大学