CN105867382B - 一种基于等效干扰补偿的船舶动力定位控制系统 - Google Patents

Abstract

本发明属于定位控制系统领域，具体涉及一种将动力定位船舶低频运动模型中存在的非线性和环境扰动的不确定问题，在等效干扰补偿理论的基础上设计纵向、横向、艏向三个非线性控制器的基于等效干扰补偿的船舶动力定位控制系统。基于等效干扰补偿的船舶动力定位控制系统，包括显控计算机，纵向控制器，横向控制器，艏向控制器，推力系统，动力定位船舶。本发明提出的动力定位船舶低频运动纵向、横向、艏向三个控制器能够分别对船舶三自由度运动进行控制，将耦合项和非线性项以及外部环境扰动当成等效干扰进行处理，通过扩张状态观测器对等效扰动进行估计和补偿，从而更好的控制船舶定位到期望状态。

Description

一种基于等效干扰补偿的船舶动力定位控制系统

技术领域

本发明属于定位控制系统领域，具体涉及一种将动力定位船舶低频运动模型中存在的非线性和环境扰动的不确定问题，在等效干扰补偿理论的基础上设计纵向、横向、艏向三个非线性控制器的基于等效干扰补偿的船舶动力定位控制系统。

背景技术

随着海上资源的不断勘探和开采，配备动力定位控制系统的船舶越来越多。船舶动力定位控制系统的主要目的是通过控制船舶的驱动设备将船舶控制在指定位置。海洋环境干扰的不断变化与船舶运动模型中的非线性问题，为船舶运动控制增加了难度。因此，如何有效抵抗环境干扰以及对船舶运动中的非线性成为动力定位控制系统研究的热点和难点。

目前，船舶动力定位控制系统所采用的非线性控制方法大多是在模型建立的基础上进行控制的，但是精确的系统模型很难建立。因此，对于船舶运动模型中的非线性问题进行控制是十分必要的。另外，船舶运动中会受到风、浪、流等各种环境干扰的影响，对于如何补偿这些干扰的研究具有十分重要的现实意义。本发明的船舶三自由度运动控制系统可以有效解决船舶运动模型的非线性问题，并将环境干扰以及船舶模型中的不确定项、耦合项、未知项当成等效干扰进行控制，并对等效干扰进行有效补偿。

经文献检索发现，中国专利CN103592849A针对一种船舶动力定位控制方法对船舶纵向、横向、艏向三个自由度进行控制，运用广义预测控制器通过推力分配模块将纵向、横向、艏向三个方向的力矩施加到船舶动态运动模型中对船舶运动进行控制，但是该方法没有充分考虑船舶运动模型的非线性和未知干扰的不确定性。

发明内容

本发明的目的在于提供一种针对船舶运动控制中存在的模型非线性、耦合和不断变化的环境干扰，对纵向、横向、艏向三个自由度进行控制并对等效干扰进行补偿和估计来设计纵向、横向、艏向三个非线性控制器的基于等效干扰补偿的船舶动力定位控制系统。

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

基于等效干扰补偿的船舶动力定位控制系统，包括显控计算机(1)，纵向控制器(2)，横向控制器(3)，艏向控制器(4)，推力系统(5)，动力定位船舶(6)；其中纵向控制器(2)包括纵向路径生成器(7)、纵向扩张状态观测器(10)、纵向误差反馈控制器(8)、纵向干扰补偿因子(11)、纵向干扰补偿器(9)；横向控制器(3)包括横向路径生成器(12)、横向扩张状态观测器(15)、横向误差反馈控制器(13)、横向干扰补偿器(14)、横向干扰补偿因子(16)；艏向控制器(4)包括艏向路径生成器(17)、艏向扩张状态观测器(20)、艏向误差反馈控制器(18)、艏向干扰补偿器(19)、艏向干扰补偿因子(21)；

动力定位船舶(6)的GPS(22)和陀螺仪(23)对船舶的实际位姿信息进行采集，将采集到的实际位姿信息传递给显控计算机、纵向扩张状态观测器、横向扩张状态观测器和艏向扩张状态观测器；纵向扩张状态观测器、横向扩张状态观测器和艏向扩张状态观测器对实际位姿信息进行估计得到实际位姿信息估计值以及等效干扰估计值；

显控计算机将期望位姿信息同时传送给纵向路径生成器、横向路径生成器和艏向路径生成器；纵向路径生成器、横向路径生成器和艏向路径生成器对获得的期望位姿信息进行平滑处理得到平滑的期望位姿信息；

纵向误差反馈控制器、横向误差反馈控制器和艏向误差反馈控制器对实际位姿信息估计值和平滑的期望位姿信息进行误差控制得到标称系统下的纵向控制量、横向控制量、艏向控制量，

纵向干扰补偿器、横向干扰补偿器和艏向干扰补偿器根据纵向干扰补偿因子、横向干扰补偿因子和艏向干扰补偿因子对纵向误差反馈控制器、横向误差反馈控制器和艏向误差反馈控制器输出的纵向控制量、横向控制量、艏向控制量进行补偿得到推力系统的纵向控制输入量、横向控制输入量和艏向控制输入量，所述的纵向干扰补偿因子、横向干扰补偿因子和艏向干扰补偿因子是纵向干扰补偿器、横向干扰补偿器和艏向干扰补偿器根据纵向扩张状态观测器、横向扩张状态观测器和艏向扩张状态观测器对等效干扰估计值产生的干扰项获得的；

推力系统根据控制输入量对船舶的执行机构进行控制达到期望的位姿状态；

所述的位姿信息包括GPS(22)采集的实际横向、纵向位置x,y，陀螺仪(23)采集的实际艏向ψ。

所述的纵向扩张状态观测器为：

其中，e_x为纵向位置估计与纵向实际位置x的误差，为速度估计值，为上一时刻的速度估计值，为加速度估计值，为纵向等效扰动的估计值，为扰动估计值产生的干扰项，β_x1为纵向速度误差系数，β_x2为纵向加速度误差系数，β_x3为纵向等效干扰误差系数，α_x为纵向误差饱和函数的参数，h为采样步长，p_x0为纵向控制器的补偿因子，τ_x为补偿后的纵向控制量，fal_x(e_x,α_x,h)为纵向误差饱和函数，τ_x0为纵向误差反馈控制器输出的标称系统下的纵向控制量；

所述的横向扩张状态观测器为：

其中，e_y为横向位置估计与横向实际位置x的误差，为速度估计值，为上一时刻的速度估计值，为加速度估计值，为横向等效扰动的估计值，为扰动估计值产生的干扰项，β_y1为横向速度误差系数，β_y2为横向加速度误差系数，β_y3为横向等效干扰误差系数，α_y为横向误差饱和函数的参数，h为采样步长，p_y0为横向控制器的补偿因子，τ_y为补偿后的横向控制量，fal_y(e_y,α_y,h)为横向误差饱和函数，τ_y0为横向误差反馈控制器输出的标称系统下的横向控制量；

所述的艏向扩张状态观测器为：

e_ψ为艏向估计与实际艏向的误差，为艏向估计，为艏向速度估计，为上一时刻的艏向速度估计，为艏向加速度估计，为艏向等效扰动的估计，fal_ψ(e_ψ,α_ψ,h)为艏向饱和函数，p_ψ0为艏向控制器的补偿因子，τ_ψ为艏向扩张状态观测器对标称系统下的输出控制量进行补偿后的艏向控制量，艏向扰动估计产生的干扰项，τ_ψ0为艏向误差反馈控制器输出的标称系统下的横向控制量，β_ψ1为艏向速度误差系数，β_ψ2为艏向加速度误差系数，β_ψ3为艏向等效干扰误差系数，α_ψ为艏向误差饱和函数的参数；

其中，ψ_d,ψ_d1分别为艏向路径生成器作用前、后的期望艏向，ψ_d2分别为期望艏向的导数和期望艏向角速度，ω_ψn为艏向路径生成器振荡环节固有频率，ζ_ψ为艏向路径生成器振荡环节相对阻尼比，r_ψ为艏向路径生成器的控制输入，δ_ψ为艏向路径生成器设计参数；，，，，β_ψ1,β_ψ2,β_ψ3,α_ψ为与系统采样步长有关的艏向扩张状态观测器参数，，，；e_ψ1为期望艏向ψ_d1与艏向估计之间的误差，τ_ψ0为艏向误差误差反馈控制器输出的控制量，k_ψ1,k_ψ2为艏向控制增益，α_ψ1,α_ψ2为艏向误差误差反馈控制器参数，σ_ψ为与系统的误差范围有关的艏向误差误差反馈控制器参数。

所述的纵向路径生成器为

x_d1为纵向路径生成器作用后的纵向期望位置，为上一时刻纵向期望速度；x_d2为纵向路径生成器的纵向期望速度，为纵向路径生成器的纵向期望加速度；x_d为纵向期望位置；ω_nx纵向路径生成器振荡环节固有频率，ζ_x纵向路径生成器振荡环节相对阻尼比，δ_x为纵向路径生成器设计参数；

横向路径生成器为：

y_d1为横向路径生成器作用后的期望纵向位置，为上一时刻的横向期望速度；y_d2为横向路径生成器作用后的横向期望速度，为横向路径生成器的期望纵向加速度；y_d为横向期望位置；ω_ny横向路径生成器振荡环节固有频率，ζ_y横向路径生成器振荡环节相对阻尼比，δ_y为横向路径生成器设计参数；

所述的艏向路径生成器：

ψ_d1为艏向路径生成器作用后的期望纵向位置，为上一时刻的艏向期望速度；ψ_d2为艏向路径生成器作用后的艏向期望速度，为艏向路径生成器的期望纵向加速度；ψ_d为艏向期望位置；ω_nψ艏向路径生成器振荡环节固有频率，ζ_ψ艏向路径生成器振荡环节相对阻尼比，δ_ψ为艏向路径生成器设计参数。

所述的纵向误差反馈控制器为：

τ_x0＝k_x1fal_x1(e_x1,α_x1,δ_x)+k_x2fal_x2(e_x2,α_x2,δ_x)

其中，e_x1为纵向期望位置x_d1与纵向位置估计的误差，e_x2为纵向期望速度与纵向速度估计的误差，k_x1为误差e_x1的控制增益k_x2为误差e_x2的控制增益，α_x1为误差e_x1的控制参数，α_x2为误差e_x2的控制参数，δ_x为纵向反馈控制器参数，fal_x1(e_x1,α_x1,δ_x)为误差e_x1的饱和函数，fal_x2(e_x2,α_x2,δ_x)为误差e_x2的饱和函数；

所述的横向误差反馈控制器为：

τ_y0＝k_y1fal_y1(e_y1,α_y1,σ_y)+k_y2fal_y2(e_y2,α_y2,σ_y)

其中，e_y1为横向期望位置y_d1与横向位置估计的误差，e_y2为横向期望速度与横向速度估计的误差，k_y1为误差e_y1的控制增益k_y2为误差e_y2的控制增益，α_y1为误差e_y1的控制参数，α_y2为误差e_y2的控制参数，δ_y为横向反馈控制器参数，fal_y1(e_y1,α_y1,δ_y)为误差e_y1的饱和函数，fal_y2(e_y2,α_y2,δ_y)为误差e_y2的饱和函数；

所述的艏向误差反馈控制器为：

τ_ψ0＝k_ψ1fal_ψ1(e_ψ1,α_ψ1,σ_ψ)+k_ψ2fal_ψ2(e_ψ2,α_ψ2,σ_ψ)

其中，e_ψ1为艏向期望位置ψ_d1与艏向位置估计的误差，e_ψ2为艏向期望速度与艏向速度估计的误差，k_ψ1为误差e_ψ1的控制增益k_ψ2为误差e_ψ2的控制增益，α_ψ1为误差e_ψ1的控制参数，α_ψ2为误差e_ψ2的控制参数，δ_ψ为艏向反馈控制器参数，fal_ψ1(e_ψ1,α_ψ1,δ_ψ)为误差e_ψ1的饱和函数，fal_ψ2(e_ψ2,α_ψ2,δ_ψ)为误差e_ψ2的饱和函数。

所述的动力定位船舶的三自由度低频运动模型为：

其中，η为船舶位置和艏向向量，η＝[x,y,ψ]，为船舶位置和艏向向量在地固坐标系下的速度向量，υ为船舶在附体坐标系下的速度向量υ＝[u,v,r]，u,v是船舶横向和纵向速度，r为船舶艏向角速度，J(η)是地固坐标系与附体坐标系之间的转换矩阵；Μ为系统惯性矩阵；C(υ)为与船舶速度有关的科里奥利向心力矩阵；D(υ)为与船舶速度有关的阻尼矩阵；b为低频干扰力，τ为控制向量，τ＝[τ_x,τ_y,τ_ψ]；Μ、C(υ)、D(υ)的具体形式为

其中，m₁₁、m₂₂、m₃₃为船舶纵向、横向、艏向的系统惯性质量，m₂₃、m₃₂为船舶横向与艏向耦合的系统惯性质量；c₁₂、c₂₁为船舶纵向与横向耦合的科里奥利向心力，c₁₃、c₃₁是纵向与艏向耦合的科里奥利向心力，c₂₃、c₃₂是横向与艏向耦合的科里奥利向心力；d₁₁、d₂₂、d₃₃为船舶纵向、横向、艏向的阻尼，d₂₃、d₃₂为船舶纵向与艏向耦合的阻尼；将系统模型Μ、C(υ)、D(υ)中的耦合项以及船舶运动模型中的非线性项和外部环境扰动如风、浪、流作为等效干扰来处理，则船舶模型转化为：

船舶纵荡运动模型：

船舶横荡运动模型：

船舶艏摇运动模型：

其中，x₁,x₂为船舶模型转化后的纵向位置、纵向速度，f_x(x₁,x₂)为转化后的与纵向位置、速度相关的非线性函数，p_x为转化后的纵向控制力系数，τ_x为纵向控制力，b_x为包含系统内部耦合和外部环境扰动的纵向等效干扰；y₁,y₂为船舶模型转化后的横向位置、速度，f_y(y₁,y₂)为转化后的与横向位置、速度相关的非线性函数，p_y为转化后的横向控制力系数，τ_y为横向控制力，b_y为包含系统内部耦合和外部环境扰动的横向等效干扰；ψ₁,ψ₂为船舶模型转化后的艏向角、艏向角速度，f_ψ(ψ₁,ψ₂)为转化后的与艏向角度、角速度相关的非线性函数，p_ψ为转化后的艏向控制力系数，τ_ψ为艏向控制力矩，b_ψ为包含系统内部耦合和外部环境扰动的艏向等效干扰。

本发明的有益效果在于：本发明提出的动力定位船舶低频运动纵向、横向、艏向三个控制器能够分别对船舶三自由度运动进行控制，将耦合项和非线性项以及外部环境扰动当成等效干扰进行处理，通过扩张状态观测器对等效扰动进行估计和补偿，从而更好的控制船舶定位到期望状态。

附图说明

图1基于等效干扰的船舶动力定位控制系统总体结构图。

具体实施方式

下面结合附图对本发明进行详细描述：

图1中1—显控计算机；2—纵向控制器；3—横向控制器；4—艏向控制器；5—推力系统；6—动力定位船舶；7—纵向路径生成器；8—纵向误差反馈控制器；9—纵向干扰补偿器；10—纵向扩张状态观测器；11—纵向干扰补偿因子；12—横向路径生成器；13—横向反馈控制器；14—横向干扰补偿器；15—横向扩张状态观测器；16—横向干扰补偿因子；17—艏向路径生成器；18—艏向反馈控制器；19—艏向干扰补偿器；20—艏向扩张状态观测器；21—艏向干扰补偿因子；22—GPS(全球卫星导航系统)；23—陀螺仪。

本发明涉及一种基于等效干扰补偿的船舶动力定位控制系统。显控计算机能够实时显示船舶位置和艏向，并将设定的船舶期望位置和艏向传递到纵向、横向、艏向控制器中；纵向、横向、艏向控制器根据期望位置和艏向对船舶进行非线性控制，从而得到推力系统中纵向、横向、艏向控制量，进而控制船舶达到期望状态。在对船舶运动模型进行处理的过程中，将模型中的耦合项、非线性项和外部环境扰动当作等效干扰来处理，对船舶的三个自由度进行控制。所设计的纵向、横向、艏向三个控制器中的路径生成器根据显控计算机中设定的船舶期望位姿阶跃信号进行处理，得到平滑的期望位姿和期望速度信息；控制器中的扩张状态观测器将等效干扰扩张成状态变量并对该变量进行估计和补偿，同时对船舶的实际位姿和速度信息进行估计，将估计值传送给误差反馈控制器，进而得到推力系统的各个控制量；而误差反馈控制器对路径生成器输出的期望位姿、期望速度和状态观测器产生的估计位姿、估计速度进行误差反馈控制，得到标称系统下的控制量；推力系统根据各个自由度的控制量对执行机构进行推力控制，从而控制船舶达到期望位姿状态。此发明的优点在于不需要船舶运动的精确数学模型，将模型中的耦合项、不确定项和非线性项当成等效干扰，利用扩张状态观测器将等效干扰扩张成一个状态并对该状态进行估计和补偿，通过误差反馈控制器对位置、艏向与速度进行误差反馈控制，进而解决船舶动力定位控制系统中的耦合、不确定和非线性问题，提高了系统的鲁棒性和控制精度。

本发明的目的是通过以下技术方案实现的：

本发明的基于等效干扰的船舶动力定位控制系统包括显控计算机(1)，纵向控制器(2)，横向控制器(3)，艏向控制器(4)，推力系统(5)，动力定位船舶(6)。其中，纵向控制器(2)包括纵向路径生成器(7)、纵向扩张状态观测器(10)、纵向误差反馈控制器(8)、纵向干扰补偿器(11)、纵向干扰补偿因子(9)；横向控制器(3)包括横向路径生成器(12)、横向扩张状态观测器(15)、横向误差反馈控制器(13)、横向干扰补偿器(14)、横向干扰补偿因子(16)；艏向控制器(4)包括艏向路径生成器(17)、艏向扩张状态观测器(20)、艏向误差反馈控制器(18)、艏向干扰补偿器(19)、艏向干扰补偿因子(21)；动力定位船舶(6)上的位置和艏向是通过GPS(22)采集船舶横向和纵向位置，通过陀螺仪(23)采集艏向信息。显控计算机(1)将设定的船舶期望位置和期望艏向信息传递到纵向控制器(2)、横向控制器(2)和艏向控制器(3)中，纵向控制器(2)、横向控制器(3)、艏向控制器(4)对纵向、横向位置和艏向信息进行非线性控制得到推力系统(5)中横向、纵向、艏向控制量，从而对动力定位船舶(6)进行控制使得船舶能够定位到期望状态。

1)显控计算机(1)能够实时显示船舶的横向、纵向位置和艏向信息，并能够将设定的船舶期望位置和期望艏向信息传递给纵向、横向、艏向控制器。

2)纵向控制器(2)对显控计算机(1)中将设定的期望横向位置信息，经过纵向路径生成器(7)的处理可以得到平滑的期望纵向和期望纵向微分信号；纵向扩张状态观测器(10)对船舶实际纵向位置信息进行估计得到纵向位置、速度的估计，同时对纵向等效干扰进行估计和补偿，得到纵向等效干扰的估计值并在纵向补偿器的作用下对标称系统下的纵向控制量进行补偿，得到纵向控制器的输出控制量，并将其传递给推力系统(5)。纵向反馈控制器(8)对纵向扩张状态观测器(10)输出的纵荡位置、速度估计信息与纵向路径生成器(7)输出的期望位置、速度信息进行误差反馈控制得到标称系统下的纵荡控制量。

3)横向控制器(3)对显控计算机(1)中将设定的期望横向位置，经过横向路径生成器(7)的处理可以得到平滑的期望横向和期望横向微分信号；横向状态观测器(15)对船舶实际横向位置信息进行估计，得到横向期位置、速度的估计，同时对横向等效干扰进行估计和补偿，得到横向等效干扰的估计值并在横向补偿器的作用下对标称系统下的横向控制量进行补偿，得到横向控制器的输出控制量，并将其传递给推力系统(5)。横向误差反馈控制器(13)对横向扩张状态观测器(15)输出的横向位置、速度估计信息与横向路径生成器(7)输出的期望位置、期望速度信息进行误差反馈控制得到标称系统下的横向控制量。

4)艏向控制器(4)对显控计算机(1)中将设定的期望艏向信息经过艏向路径生成器(17)的处理，得到平滑的期望艏向信息和期望艏向微分信息；艏向扩张状态观测器(20)对船舶实际艏向信息进行估计得到艏向信息、艏向角速度的估计，同时对艏向等效干扰进行估计和补偿，得到艏向等效扰动的估计并在艏向补偿器的作用下对标称系统下的艏向控制量进行补偿。艏向误差反馈控制器(18)对艏向扩张状态观测器(20)输出的艏向角度、角速度估计信息与艏向路径生成器(17)输出的期望角度、期望角速度信息进行误差反馈控制得到推力系统(5)的艏向控制量。

5)推力系统(5)根据纵向控制器(2)、横向控制器(3)、艏向控制器(4)输出的纵向、横向、艏向控制量对船舶执行机构进行控制，使得船舶达到期望状态。

如图1所示，本发明将考虑动力定位船舶低频运动模型，设计由纵向、横向、艏向三个控制器组成的船舶运动控制系统包括显控计算机、纵向控制器、横向控制器、艏向控制器、推力系统、动力定位船。

船舶三自由度(纵荡、横荡、艏摇)低频运动模型为：

其中，η为船舶位置和艏向向量(η＝[x,y,ψ]，x,y为船舶横向和纵向位置，ψ为船舶艏向角)，为船舶位置和艏向向量在地固坐标系下的速度向量，υ为船舶在附体坐标系下的速度向量(υ＝[u,v,r]，u,v是船舶横向和纵向速度，r为船舶艏向角速度)，J(η)是地固坐标系与附体坐标系之间的转换矩阵；Μ为系统惯性矩阵；C(υ)为与船舶速度有关的科里奥利向心力矩阵；D(υ)为与船舶速度有关的阻尼矩阵；b为低频干扰力，τ为控制向量(τ＝[τ_x,τ_y,τ_ψ]，τ_x,τ_y为船舶横向、纵向控制力，τ_ψ为艏向控制力矩)；Μ、C(υ)、D(υ)的具体形式为

其中，m₁₁、m₂₂、m₃₃为船舶纵向、横向、艏向的系统惯性质量，m₂₃、m₃₂为船舶横向与艏向耦合的系统惯性质量；c₁₂、c₂₁为船舶纵向与横向耦合的科里奥利向心力，c₁₃、c₃₁是纵向与艏向耦合的科里奥利向心力，c₂₃、c₃₂是横向与艏向耦合的科里奥利向心力；d₁₁、d₂₂、d₃₃为船舶纵向、横向、艏向的阻尼，d₂₃、d₃₂为船舶纵向与艏向耦合的阻尼。如果将系统模型总Μ、C(υ)、D(υ)中的耦合项以及船舶运动模型中的非线性项和外部环境扰动如风、浪、流等当成等效干扰来处理，则船舶模型可以转化为：

1)船舶纵荡运动模型：

2)船舶横荡运动模型：

3)船舶艏摇运动模型：

其中，x₁,x₂为船舶模型转化后的纵向位置、纵向速度，f_x(x₁,x₂)为转化后的与纵向位置、速度相关的非线性函数，p_x为转化后的纵向控制力系数，τ_x为纵向控制力，b_x为包含系统内部耦合和外部环境扰动的纵向等效干扰；y₁,y₂为船舶模型转化后的横向位置、速度，f_y(y₁,y₂)为转化后的与横向位置、速度相关的非线性函数，p_y为转化后的横向控制力系数，τ_y为横向控制力，b_y包含系统内部耦合和外部环境扰动的横向等效干扰；ψ₁,ψ₂为船舶模型转化后的艏向角、艏向角速度，f_ψ(ψ₁,ψ₂)为转化后的与艏向角度、角速度相关的非线性函数，p_ψ为转化后的艏向控制力系数，τ_ψ为艏向控制力矩，b_ψ为包含系统内部耦合和外部环境扰动的艏向等效干扰。

根据得到的基于等效干扰的船舶运动模型分别设计船舶纵向、横向、艏向三个控制器。

1)船舶纵向控制器

为了得到显控计算机输出的期望纵向位置x_d的光滑输入曲线，设计了纵向路径生成器，能够得到平稳、光滑的期望位置x_d1和其导数由于船舶纵荡运动的给定期望位置信号是阶跃信号，考虑船舶纵荡运动的速度和加速度的有界性，参考模型的带宽必须低于船舶控制系统的带宽，因此用一阶低通滤波器的低通特性能够满足跟踪性能和稳定性。为了便于生成平滑的期望路径，利用二阶振荡环节的动态特性进行设计。将一阶低通滤波器与二阶振荡环节进行串联形成路径生成参考模型，纵向路径生成器的设计如下：

x_d,x_d1分别为纵向路径生成器作用前、后的期望纵向位置；为船舶纵向加速度信息；ω_xn纵向路径生成器振荡环节固有频率，ζ_x纵向路径生成器振荡环节相对阻尼比，r_x为路径生成器控制输入，δ_x为纵向路径生成器设计参数。

为了更好的控制船舶跟踪期望纵向位置，首先将船舶运动模型中的纵向等效干扰扩张成状态变量b_x，对该状态进行估计和补偿，同时需要对动力定位船舶GPS中采集的纵向位置x进行估计，由于船舶纵荡运动是非线性的，故将纵向扩张状态观测器设计为

其中，e_x为纵向位置估计与纵向实际位置x的误差，为加速度估计值，为纵向等效扰动的估计值，为扰动估计值产生的干扰项，β_x1,β_x2,β_x3,α_x为纵荡扩张状态观测器参数，由系统所用采样步长决定的，p_x0为纵向控制器的补偿因子，fal_x(e_x,α_x,h)为与纵向误差相关的纵向饱和函数，其作用是抑制信号抖振，τ_x0为纵向误差反馈控制器输出的标称系统下的纵向控制量。

纵向误差反馈控制器将纵向路径生成器和纵向扩张状态观测器产生的状态变量估计进行误差反馈控制，因此纵向误差反馈控制器的设计为

τ_x0＝k_x1fal_x1(e_x1,α_x1,δ_x)+k_x2fal_x2(e_x2,α_x2,δ_x)

其中，e_x1为纵向期望位置x_d1与纵向位置估计的误差，e_x2纵向期望速度与纵向速度估计的误差，k_x1,k_x2为控制增益，α_x1,α_x2为纵向误差反馈控制器非线性因子，δ_x为纵向反馈控制器参数，与系统的误差范围有关。

2)横向控制器的设计为

横向路径生成器

横向扩张状态观测器

横向误差反馈控制器

其中，y_d,y_d1分别为横向路径生成器作用前、后的期望横向位置，y_d2分别为期望横向位置的导数和期望横向速度；ω_yn为横向路径生成器振荡环节固有频率，ζ_y为横向路径生成器振荡环节相对阻尼比，r_y为横向路径生成器的控制输入，δ_x为纵向路径生成器设计参数；e_y为横向位置估计与横向实际位置的误差，为横向位置估计，为横向速度估计，为横向加速度估计，为横向等效总扰动的估计，横向扰动估计产生的干扰项，β_y1,β_y2,β_y3,α_y为与系统采样步长有关的横向扩张状态观测器参数，fal_y(e_y,α_y,h)为横向饱和函数，p_y0为横向控制器的补偿因子，τ_y为横向扩张状态观测器对标称系统下的输出控制量进行补偿后的横向控制量；e_y1为横向期望位置y_d1与横向位置估计之间的误差，τ_y0为横向误差反馈控制器在标称系统下输出的控制量，k_y1,k_y2为横向控制增益，α_y1,α_y2为横向误差反馈控制器参数，σ_y为与系统的误差范围有关的横向误差反馈控制器参数。

3)艏向控制器的设计为

艏向路径生成器

艏向扩张状态观测器

艏向误差反馈控制器

其中，ψ_d,ψ_d1分别为艏向路径生成器作用前、后的期望艏向，ψ_d2分别为期望艏向的导数和期望艏向角速度，ω_ψn为艏向路径生成器振荡环节固有频率，ζ_ψ为艏向路径生成器振荡环节相对阻尼比，r_ψ为艏向路径生成器的控制输入，δ_ψ为艏向路径生成器设计参数；e_ψ为艏向估计与实际艏向的误差，为艏向估计，为艏向速度估计，为艏向加速度估计，为艏向等效扰动的估计，艏向扰动估计产生的干扰项，β_ψ1,β_ψ2,β_ψ3,α_ψ为与系统采样步长有关的艏向扩张状态观测器参数，fal_ψ(e_ψ,α_ψ,h)为艏向饱和函数，p_ψ0为艏向控制器的补偿因子，τ_ψ为艏向扩张状态观测器对标称系统下的输出控制量进行补偿后的艏向控制量；e_ψ1为期望艏向ψ_d1与艏向估计之间的误差，τ_ψ0为艏向误差反馈控制器输出的控制量，k_ψ1,k_ψ2为艏向控制增益，α_ψ1,α_ψ2为艏向误差反馈控制器参数，σ_ψ为与系统的误差范围有关的艏向误差反馈控制器参数。

4)推力系统根据纵向、横向、艏摇控制器输出的纵向、横向、艏向控制量

τ_x,τ_y,τ_ψ进行控制得到动力定位船舶各个执行机构的输入量，进而控制船舶达到期望状态

本发明提出的动力定位船舶低频运动纵向、横向、艏向三个控制器能够分别对船舶三自由度运动进行控制，将耦合项和非线性项以及外部环境扰动当成等效干扰进行处理，通过扩张状态观测器对等效扰动进行估计和补偿，从而更好的控制船舶定位到期望状态。

Claims (4)

1.一种基于等效干扰补偿的船舶动力定位控制系统，包括显控计算机(1)，纵向控制器(2)，横向控制器(3)，艏向控制器(4)，推力系统(5)，动力定位船舶(6)；其中纵向控制器(2)包括纵向路径生成器(7)、纵向扩张状态观测器(10)、纵向误差反馈控制器(8)、纵向干扰补偿因子(11)、纵向干扰补偿器(9)；横向控制器(3)包括横向路径生成器(12)、横向扩张状态观测器(15)、横向误差反馈控制器(13)、横向干扰补偿器(14)、横向干扰补偿因子(16)；艏向控制器(4)包括艏向路径生成器(17)、艏向扩张状态观测器(20)、艏向误差反馈控制器(18)、艏向干扰补偿器(19)、艏向干扰补偿因子(21)；其特征在于：

动力定位船舶(6)的GPS(22)和陀螺仪(23)对船舶的实际位姿信息进行采集，将采集到的实际位姿信息传递给显控计算机、纵向扩张状态观测器、横向扩张状态观测器和艏向扩张状态观测器；纵向扩张状态观测器、横向扩张状态观测器和艏向扩张状态观测器对实际位姿信息进行估计得到实际位姿信息估计值以及等效干扰估计值；

显控计算机将期望位姿信息同时传送给纵向路径生成器、横向路径生成器和艏向路径生成器；纵向路径生成器、横向路径生成器和艏向路径生成器对获得的期望位姿信息进行平滑处理得到平滑的期望位姿信息；

纵向误差反馈控制器、横向误差反馈控制器和艏向误差反馈控制器对实际位姿信息估计值和平滑的期望位姿信息进行误差控制得到标称系统下的纵向控制量、横向控制量、艏向控制量，

纵向干扰补偿器、横向干扰补偿器和艏向干扰补偿器根据纵向干扰补偿因子、横向干扰补偿因子和艏向干扰补偿因子对纵向误差反馈控制器、横向误差反馈控制器和艏向误差反馈控制器输出的纵向控制量、横向控制量、艏向控制量进行补偿得到推力系统的纵向控制输入量、横向控制输入量和艏向控制输入量，所述的纵向干扰补偿因子、横向干扰补偿因子和艏向干扰补偿因子是纵向干扰补偿器、横向干扰补偿器和艏向干扰补偿器根据纵向扩张状态观测器、横向扩张状态观测器和艏向扩张状态观测器对等效干扰估计值产生的干扰项获得的；

推力系统根据控制输入量对船舶的执行机构进行控制达到期望的位姿状态；

所述的位姿信息包括GPS(22)采集的实际横向、纵向位置x,y，陀螺仪(23)采集的实际艏向ψ；

所述的动力定位船舶的三自由度低频运动模型为：

其中，η为船舶位置和艏向向量，η＝[x,y,ψ]，为船舶位置和艏向向量在地固坐标系下的速度向量，υ为船舶在附体坐标系下的速度向量υ＝[u,v,r]，u,v是船舶横向和纵向速度，r为船舶艏向角速度，J(η)是地固坐标系与附体坐标系之间的转换矩阵；Μ为系统惯性矩阵；C(υ)为与船舶速度有关的科里奥利向心力矩阵；D(υ)为与船舶速度有关的阻尼矩阵；b为低频干扰力，τ为控制向量，τ＝[τ_x,τ_y,τ_ψ]；Μ、C(υ)、D(υ)的具体形式为

其中，m₁₁、m₂₂、m₃₃为船舶纵向、横向、艏向的系统惯性质量，m₂₃、m₃₂为船舶横向与艏向耦合的系统惯性质量；c₁₂、c₂₁为船舶纵向与横向耦合的科里奥利向心力，c₁₃、c₃₁是纵向与艏向耦合的科里奥利向心力，c₂₃、c₃₂是横向与艏向耦合的科里奥利向心力；d₁₁、d₂₂、d₃₃为船舶纵向、横向、艏向的阻尼，d₂₃、d₃₂为船舶纵向与艏向耦合的阻尼；将系统模型Μ、C(υ)、D(υ)中的耦合项以及船舶运动模型中的非线性项和外部环境扰动如风、浪、流作为等效干扰来处理，则船舶模型转化为：

船舶纵荡运动模型：

船舶横荡运动模型：

船舶艏摇运动模型：

其中，x₁,x₂为船舶模型转化后的纵向位置、纵向速度，f_x(x₁,x₂)为转化后的与纵向位置、速度相关的非线性函数，p_x为转化后的纵向控制力系数，τ_x为纵向控制力，b_x为包含系统内部耦合和外部环境扰动的纵向等效干扰；y₁,y₂为船舶模型转化后的横向位置、速度，f_y(y₁,y₂)为转化后的与横向位置、速度相关的非线性函数，p_y为转化后的横向控制力系数，τ_y为横向控制力，b_y为包含系统内部耦合和外部环境扰动的横向等效干扰；ψ₁,ψ₂为船舶模型转化后的艏向角、艏向角速度，f_ψ(ψ₁,ψ₂)为转化后的与艏向角度、角速度相关的非线性函数，p_ψ为转化后的艏向控制力系数，τ_ψ为艏向控制力矩，b_ψ为包含系统内部耦合和外部环境扰动的艏向等效干扰。

2.根据权利要求1所述的一种基于等效干扰补偿的船舶动力定位控制系统，其特征在于：所述的纵向扩张状态观测器为：

其中，e_x为纵向位置估计与纵向实际位置x的误差，为速度估计值，为上一时刻的速度估计值，为加速度估计值，为纵向等效扰动的估计值，为扰动估计值产生的干扰项，β_x1为纵向速度误差系数，β_x2为纵向加速度误差系数，β_x3为纵向等效干扰误差系数，α_x为纵向误差饱和函数的参数，h为采样步长，p_x0为纵向控制器的补偿因子，τ_x为补偿后的纵向控制量，fal_x(e_x,α_x,h)为纵向误差饱和函数，τ_x0为纵向误差反馈控制器输出的标称系统下的纵向控制量；

所述的横向扩张状态观测器为：

其中，e_y为横向位置估计与横向实际位置x的误差，为速度估计值，为上一时刻的速度估计值，为加速度估计值，为横向等效扰动的估计值，为扰动估计值产生的干扰项，β_y1为横向速度误差系数，β_y2为横向加速度误差系数，β_y3为横向等效干扰误差系数，α_y为横向误差饱和函数的参数，h为采样步长，p_y0为横向控制器的补偿因子，τ_y为补偿后的横向控制量，fal_y(e_y,α_y,h)为横向误差饱和函数，τ_y0为横向误差反馈控制器输出的标称系统下的横向控制量；

所述的艏向扩张状态观测器为：

e_ψ为艏向估计与实际艏向的误差，为艏向估计，为艏向速度估计，为上一时刻的艏向速度估计，为艏向加速度估计，为艏向等效扰动的估计，fal_ψ(e_ψ,α_ψ,h)为艏向饱和函数，p_ψ0为艏向控制器的补偿因子，τ_ψ为艏向扩张状态观测器对标称系统下的输出控制量进行补偿后的艏向控制量，艏向扰动估计产生的干扰项，τ_ψ0为艏向误差反馈控制器输出的标称系统下的横向控制量，β_ψ1为艏向速度误差系数，β_ψ2为艏向加速度误差系数，β_ψ3为艏向等效干扰误差系数，α_ψ为艏向误差饱和函数的参数；

其中，ψ_d,ψ_d1分别为艏向路径生成器作用前、后的期望艏向，分别为期望艏向的导数和期望艏向角速度，ω_ψn为艏向路径生成器振荡环节固有频率，ζ_ψ为艏向路径生成器振荡环节相对阻尼比，r_ψ为艏向路径生成器的控制输入，δ_ψ为艏向路径生成器设计参数；β_ψ1,β_ψ2,β_ψ3,α_ψ为与系统采样步长有关的艏向扩张状态观测器参数；e_ψ1为期望艏向ψ_d1与艏向估计之间的误差，τ_ψ0为艏向误差误差反馈控制器输出的控制量，k_ψ1,k_ψ2为艏向控制增益，α_ψ1,α_ψ2为艏向误差误差反馈控制器参数，σ_ψ为与系统的误差范围有关的艏向误差误差反馈控制器参数。

3.根据权利要求1所述的一种基于等效干扰补偿的船舶动力定位控制系统，其特征在于：所述的纵向路径生成器为

x_d1为纵向路径生成器作用后的纵向期望位置，为上一时刻纵向期望速度；x_d2为纵向路径生成器的纵向期望速度，为纵向路径生成器的纵向期望加速度；x_d为纵向期望位置；ω_nx纵向路径生成器振荡环节固有频率，ζ_x纵向路径生成器振荡环节相对阻尼比，δ_x为纵向路径生成器设计参数；

横向路径生成器为：

y_d1为横向路径生成器作用后的期望纵向位置，为上一时刻的横向期望速度；y_d2为横向路径生成器作用后的横向期望速度，为横向路径生成器的期望纵向加速度；y_d为横向期望位置；ω_ny横向路径生成器振荡环节固有频率，ζ_y横向路径生成器振荡环节相对阻尼比，δ_y为横向路径生成器设计参数；

所述的艏向路径生成器：

ψ_d1为艏向路径生成器作用后的期望纵向位置，为上一时刻的艏向期望速度；ψ_d2为艏向路径生成器作用后的艏向期望速度，为艏向路径生成器的期望纵向加速度；ψ_d为艏向期望位置；ω_nψ艏向路径生成器振荡环节固有频率，ζ_ψ艏向路径生成器振荡环节相对阻尼比，δ_ψ为艏向路径生成器设计参数。

4.根据权利要求1所述的一种基于等效干扰补偿的船舶动力定位控制系统，其特征在于：

所述的纵向误差反馈控制器为：

τ_x0＝k_x1fal_x1(e_x1,α_x1,δ_x)+k_x2fal_x2(e_x2,α_x2,δ_x)

其中，e_x1为纵向期望位置x_d1与纵向位置估计的误差，e_x2为纵向期望速度与纵向速度估计的误差，k_x1为误差e_x1的控制增益k_x2为误差e_x2的控制增益，α_x1为误差e_x1的控制参数，α_x2为误差e_x2的控制参数，δ_x为纵向反馈控制器参数，fal_x1(e_x1,α_x1,δ_x)为误差e_x1的饱和函数，fal_x2(e_x2,α_x2,δ_x)为误差e_x2的饱和函数；

所述的横向误差反馈控制器为：

τ_y0＝k_y1fal_y1(e_y1,α_y1,σ_y)+k_y2fal_y2(e_y2,α_y2,σ_y)

其中，e_y1为横向期望位置y_d1与横向位置估计的误差，e_y2为横向期望速度与横向速度估计的误差，k_y1为误差e_y1的控制增益k_y2为误差e_y2的控制增益，α_y1为误差e_y1的控制参数，α_y2为误差e_y2的控制参数，δ_y为横向反馈控制器参数，fal_y1(e_y1,α_y1,δ_y)为误差e_y1的饱和函数，fal_y2(e_y2,α_y2,δ_y)为误差e_y2的饱和函数；

所述的艏向误差反馈控制器为：

τ_ψ0＝k_ψ1fal_ψ1(e_ψ1,α_ψ1,σ_ψ)+k_ψ2fal_ψ2(e_ψ2,α_ψ2,σ_ψ)

其中，e_ψ1为艏向期望位置ψ_d1与艏向位置估计的误差，e_ψ2为艏向期望速度与艏向速度估计的误差，k_ψ1为误差e_ψ1的控制增益k_ψ2为误差e_ψ2的控制增益，α_ψ1为误差e_ψ1的控制参数，α_ψ2为误差e_ψ2的控制参数，δ_ψ为艏向反馈控制器参数，fal_ψ1(e_ψ1,α_ψ1,δ_ψ)为误差e_ψ1的饱和函数，fal_ψ2(e_ψ2,α_ψ2,δ_ψ)为误差e_ψ2的饱和函数。