CN112051732A - 一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制系统及方法 - Google Patents
一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制系统及方法 Download PDFInfo
- Publication number
- CN112051732A CN112051732A CN202010789229.3A CN202010789229A CN112051732A CN 112051732 A CN112051732 A CN 112051732A CN 202010789229 A CN202010789229 A CN 202010789229A CN 112051732 A CN112051732 A CN 112051732A
- Authority
- CN
- China
- Prior art keywords
- ship
- neural network
- force
- moment
- yields
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/0265—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion
- G05B13/027—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion using neural networks only
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Health & Medical Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制系统及方法,调用自适应分数阶滑模控制系统算法,利用径向基函数神经网络能逼近任意函数的特点,通过RBF神经网络估计模块估计出船舶模型的未知干扰力和未知干扰力矩,基于Lyapunov稳定性理论,在跟踪误差收敛到零,系统渐近稳定后,计算船舶纵向控制输入力和艏向控制输入力矩;将纵向控制输入力和艏向控制输入力矩,施加于船舶的执行机构上,驱使船舶保持期望位姿和期望速度,实现高精度定位,本发明能驱使船舶渐进地追踪期望的航向和估计外部扰动,并使得船舶保持目标航线,实现高精度定位。
Description
技术领域
本发明涉及一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制系统方及法。
背景技术
现有航标船低速稳定性和操纵性能差,没有侧向推进装置,属于欠驱动船舶。由于船的低速稳定性和操纵性能差,不具备在有风、流、浪影响下,所应具有的稳定船位的动力定位功能吊机起吊能力差、绞盘功率低,很难满足航标作业的特殊要求(特别是活节式灯桩、被淤泥积压的沉石等)。当船舶过桥、沿岸、沿码头、靠泊航行时,航道宽度较窄,水深较浅,船舶在限制水域航行时的操纵性与在开阔水域有很大的不同,主要是由于底部和岸壁的影响,水动力通常较大。对于近岸航行的船舶来说,岸壁效应是一个潜在的不安全因素,往往由于船舶过于靠近岸壁而引发碰撞事故,造成人员伤亡和大量财产损失。因此,有必要对船岸相互作用效应进行研究。
发明目的
针对上述问题,本发明的目的在于对欠驱动航标船提供一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制系统及方法。
本发明一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制系统,包括有:
测量模块:用于测量船舶位姿和速度,以及包括风速、流速的外界扰动;
输入扰动力和力矩计算模块:读入当前船舶的位姿状态值、期望位姿、速度状态值、期望速度,判断当前船舶是否达到期望位姿和期望速度,若未达到,则计算风、海流、海浪和岸壁效应对船舶的干扰力和干扰力矩,计算船舶运动数学模型所需的输入扰动力和力矩;
RBF神经网络估计模块:构建RBF神经网络用以估计未知干扰力和未知干扰力矩;
控制模块:调用自适应分数阶滑模控制系统算法,利用径向基函数神经网络能逼近任意函数的特点,通过RBF神经网络估计模块估计出船舶模型的未知干扰力和未知干扰力矩,进行包括稳定横摇和纵荡速度误差的轨迹跟踪误差,基于Lyapunov稳定性理论,在跟踪误差收敛到零,系统渐近稳定后,计算船舶纵向控制输入力和艏向控制输入力矩;
执行模块:将纵向控制输入力和艏向控制输入力矩,施加于船舶的执行机构上,驱使船舶保持期望位姿和期望速度,实现高精度定位。
进一步的,一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制方法,包括如下:
建立坐标系和船舶运动数学模型;
读入当前船舶的位姿状态值、期望位姿、速度状态值、期望速度,判断当前船舶是否达到期望位姿和期望速度,若未达到,则计算风、海流、海浪和岸壁效应对船舶的干扰力和干扰力矩,计算船舶运动数学模型所需的输入扰动力和力矩;
构建RBF神经网络用以估计未知干扰力和未知干扰力矩;
调用自适应分数阶滑模控制系统算法,利用径向基函数神经网络能逼近任意函数的特点,通过RBF神经网络估计模块估计出船舶模型的未知干扰力和未知干扰力矩,进行包括稳定横摇和纵荡速度误差的轨迹跟踪误差,基于Lyapunov稳定性理论,在跟踪误差收敛到零,系统渐近稳定后,计算船舶纵向控制输入力和艏向控制输入力矩;
将纵向控制输入力和艏向控制输入力矩,施加于船舶的执行机构上,驱使船舶保持期望位姿和期望速度,实现高精度定位。
进一步的,包括如下具体步骤:
步骤1、船舶建模
(1)建立如下坐标系:考虑了纵荡、横摆和偏航三自由度运动,将海岸上的固定观测点定义为原点O,正东向定义为X轴,正北向定义为Y轴;
(2)建立船舶运动数学模型如下:
η=[x y ψ]T (2)
υ=[u v r]T (3)
式中η表示船舶的位置和姿态矢量,υ表示船的速度矢量,u表示前进速度,v表示横摆速度,r表示艏摇速度,x表示前进方向位置,y 表示横荡方向位置,ψ表示横摆角度,R为旋转矩阵:
mu表示惯性矩阵对角线上的第一个元素,mv表示惯性矩阵对角线上的第二个元素,mr表示惯性矩阵对角线上的第三个元素,则惯性矩阵如下:
令d11,d22,d33为线性水动力阻尼参数矩阵的对角线上的元素,线性水动力阻尼参数矩阵Δ如下:
其中fu,fv分别为未知扰动产生的纵向力和横向力,Nwc为未知扰动产生的干扰力矩,Fwx,Fwy分别为风产生的纵向力和横向力,Nwc为风产生的干扰力矩,Fcx,Fcy分别为海流产生的纵向力和横向力,Nc为海流产生的干扰力矩,Fsx,Fsy分别为海浪产生的纵向力和横向力,Ns为海浪产生的干扰力矩,Fxb为河岸吸力,Nb为岸推力力矩,τu表示纵向控制输入力,τr表示艏向控制输入力矩;
步骤2、读入当前船舶的位姿状态值η=[x y ψ]T、期望位姿、速度状态值υ=[u vr]T、期望速度,判断当前船舶是否达到期望位姿和期望速度,若未达到,则计算风、海流、海浪和岸壁效应对船舶的干扰力和干扰力矩,通过此步骤来计算公式(10)中的各种输入扰动力和力矩;
(1)风的干扰力和干扰力矩计算如下:
其中CX为前进方向的风系数,CY为横向的风系数,CN为风力矩系数,Af为水线上正投影面积,As为侧投影面积,Loa为船舶总长度,ρa为空气密度,Vr为风速;
(2)海流的干扰力和干扰力矩计算如下:
式中Vc表示海流流速,Afw为船舶水下正投影面积,Asw为船舶水下侧投影面积,L是船舶水线长,β为漂角,ρ为海水密度,Cx,Cy,Cn分别表示纵向、横向海流力系数和海流力矩系数;
(3)海浪的干扰力和干扰力矩计算如下:
式中a为平均波浪幅值,χ为遭遇角,Cxw,Cyw,Cnw为波浪横向、纵向漂移力和力矩系数,λ为波长;
(4)河岸吸力和岸推力力矩计算如下:
式中ρ是水的密度,Cb是方形系数,u为船舶的前进速度,L是船的长度,η0是船宽与船岸距离之比,B是船的宽度,h是水深,T是吃水;
步骤3,建立RBF神经网络来估计未知干扰力和未知干扰力矩;
φ=[φ1,φ2,…,φP] (17)
其中,z是输入向量,||z||表示欧几里德范数,φi表示第i个径向基函数,zi表示第i个径向基函数中心向量,σi表示第i个径向基函数的宽度,μi表示第i个阈值向量,P表示隐藏层节点的数目,y表示RBF 神经网络的输出,W为隐藏层的权重:
y=Wφ(z) (18)
W=[w1,w2,…,wP] (19)
步骤4、调用自适应分数阶滑模控制系统算法,计算船舶纵向控制输入力τu和艏向控制输入力矩τr,并将计算结果施加于船舶的执行机构上,通过检测误差并消除误差,驱使船舶保持期望位姿和期望速度,实现高精度定位;
(1)Caputo型分数阶微积分的定义为:
其中,g为整数,a为微积分的起始时刻,当α>0时为分数阶微分,当α<0时为分数阶积分,Γ(x)为伽马函数,定义为:
定义期望位姿为:
定义期望速度为:
其中,ηd表示为船舶期望位姿矢量,υd表示为船舶期望速度矢量,则位姿和速度的跟踪误差分别为:
构造以下分数阶滑模函数s:
式中c1>0,α为分数阶,D表示分数阶微积分函数;
对(26)求导得:
将(10)代入(27)可得:
构造基于分数阶滑模的纵向控制输入力如下:
式中ε1是RBF神经网络的逼近误差,φ表示径向基函数;
(30)减去(31)可得:
定义
(32)可写为
自适应控制律构造为
构造以下分数阶滑模面函数:
式中c2>0,β为分数阶;
对(36)求导得:
将(25)代入(37)可得:
构造vd如下:
对(39)求导得:
构造ud如下:
对(41)求导得:
计算可得:
对(40)求导得:
将(43)代入(44)可得:
构造基于分数阶滑模的艏向控制输入力矩如下:
式中ε2为RBF神经网络的逼近误差。
(47)减去(48)可得:
定义:
(49)可写为
构造自适应控制律如下:
(2)稳定性分析
基于Lyapunov稳定性理论,考虑船舶的动力学模型(10)和分数阶滑模控制律公式(29)和(46),以及自适应控制律公式(35)和(52),若系统的跟踪误差收敛到零,则系统渐近稳定:
构造Lyapunov函数如下:
对(53)求导可得:
将(29)代入(28)可得:
将(34)代入(55)可得:
将(56)代入(54)可得:
对(33)求导可得:
将(35)代入(58)可得:
将(59)代入(57)可得:
将(45)代入(38)可得:
将(10)代入(61)可得:
将(46)代入(62)可得:
将(63)代入(60)可得:
将(51)代入(64)可得:
对(50)求导可得:
将(52)代入(66)可得:
将(63)代入(61)可得:
当下式成立时
|ε1|≤η1 (69)
|ε2|≤k2 (70)
有
基于Lyapunov稳定性理论,若跟踪误差收敛到零,系统渐近稳定。
由于本发明采用带神经估计器的自适应滑模控制算法,利用径向基函数神经网络能逼近任意函数的特点,估计出船舶模型未知参数和环境扰动,轨迹跟踪误差包括稳定横摇和纵荡速度误差,基于Lyapunov 稳定性理论,当跟踪误差收敛到零,系统渐近稳定后,计算船舶纵向控制输入力和艏向控制输入力矩;并将纵向控制输入力和艏向控制输入力矩,施加于船舶的执行机构上,驱使船舶保持期望位姿和期望速度,实现高精度定位。本发明中切换函数的设计使系统对不确定性和外部干扰具有鲁棒性,避免了抖振,所控制的轨迹是收缩的,并且渐近地趋向于期望的位置和姿态。结果表明,与基本的滑模控制算法相比,神经估计器自适应分数阶滑模控制的超调量小,系统调节时间短。
附图说明
图1为本发明的系统流程图;
图2为本发明的船舶运动模型示意图;
图3为本发明中RBF神经网络示意图;
图4为本发明的壁岸效应示意图;
图5为实验中船舶位姿响应曲线;
图6为实验中船舶速度响应曲线;
图7是闭环控制系统的偏航响应曲线。
以下结合附图对本发明做进一步的详述。
具体实施方式
本发明一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制系统,包括有:
测量模块:用于测量船舶位姿和速度,以及包括风速、流速的外界扰动;
输入扰动力和力矩计算模块:读入当前船舶的位姿状态值、期望位姿、速度状态值、期望速度,判断当前船舶是否达到期望位姿和期望速度,若未达到,则计算风、海流、海浪和岸壁效应对船舶的干扰力和干扰力矩,计算船舶运动数学模型所需的输入扰动力和力矩;
RBF神经网络估计模块:构建RBF神经网络用以估计未知干扰力和未知干扰力矩;
控制模块:调用自适应分数阶滑模控制系统算法,利用径向基函数神经网络能逼近任意函数的特点,通过RBF神经网络估计模块估计出船舶模型的未知干扰力和未知干扰力矩,进行包括稳定横摇和纵荡速度误差的轨迹跟踪误差,基于Lyapunov稳定性理论,在跟踪误差收敛到零,系统渐近稳定后,计算船舶纵向控制输入力和艏向控制输入力矩;
执行模块:将纵向控制输入力和艏向控制输入力矩,施加于船舶的执行机构上,驱使船舶保持期望位姿和期望速度,实现高精度定位。
如图1所示,本发明一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制方法,包括如下步骤:
步骤1、船舶建模
(1)建立如下坐标系:考虑了纵荡、横摆和偏航三自由度运动,将海岸上的固定观测点定义为原点O,正东向定义为X轴,正北向定义为Y轴;
(2)船舶运动模型如图2所示,η表示船舶的位置和姿态矢量,υ表示船的速度矢量,u表示以m/s为单位的前进速度,v表示以m/s为单位的横摆速度,r表示以rad/s为单位的艏摇速度,x表示以m为单位的前进方向位置,y表示以m为单位的横荡方向位置,ψ表示以rad为单位的横摆角度,船舶运动数学模型如下:
η=[x y ψ]T (2)
υ=[u v r]T (3)
式中R为旋转矩阵:
mu表示惯性矩阵对角线上的第一个元素,mv表示惯性矩阵对角线上的第二个元素,mr表示惯性矩阵对角线上的第三个元素,则惯性矩阵如下:
令d11,d22,d33为线性水动力阻尼参数矩阵的对角线上的元素,线性水动力阻尼参数矩阵Δ如下:
其中,表示前进位置的导数即前进速度,表示横向位置的导数即横向速度,表示艏摇角度的导数即艏摇角速度,表示前进速度的导数即前进加速度,表示横向速度的导数即前进加速度,表示艏摇角速度的导数即艏摇角加速度,速度微分方程如下:
其中fu,fv分别为未知扰动产生的纵向力和横向力,Nwc为未知扰动产生的干扰力矩,Fwx,Fwy分别为风产生的纵向力和横向力,Nwc为风产生的干扰力矩,Fcx,Fcy分别为海流产生的纵向力和横向力,Nc为海流产生的干扰力矩,Fsx,Fsy分别为海浪产生的纵向力和横向力,Ns为海浪产生的干扰力矩,Fxb为河岸吸力,Nb为岸推力力矩,τu表示纵向控制输入力,τr表示艏向控制输入力矩;
步骤2、读入当前船舶的位姿状态值η=[x y ψ]T、期望位姿、速度状态值υ=[u vr]T、期望速度,判断当前船舶是否达到期望位姿和期望速度,若未达到,则计算风、海流、海浪和岸壁效应对船舶的干扰力和干扰力矩,通过此步骤来计算公式(10)中的各种输入扰动力和力矩;
(1)风的干扰力和干扰力矩计算如下:
其中CX为前进方向的风系数,CY为横向的风系数,CN为风力矩系数,Af为水线上正投影面积,As为侧投影面积,Loa为船舶总长度,ρa为空气密度,Vr为风速;
(2)海流的干扰力和干扰力矩计算如下:
式中Vc表示海流流速,Afw为船舶水下正投影面积,Asw为船舶水下侧投影面积,L是船舶水线长,β为漂角,ρ为海水密度,Cx,Cy,Cn分别表示纵向、横向海流力系数和海流力矩系数;
(3)海浪的干扰力和干扰力矩计算如下:
式中a为平均波浪幅值,χ为遭遇角,Cxw,Cyw,Cnw为波浪横向、纵向漂移力和力矩系数,λ为波长;
当船舶在航道岸边或桥墩附近航行时,岸边水流加速,压力降低,就会产生额外的力,使船靠近岸边,这种力被称为河岸吸力,河岸吸力可能会导致船舶触岸。同时,还有一个使船首偏离岸边的力矩,即岸推力力矩。河岸吸力和岸推力力矩一般称为船岸相互作用效应,即船舶的岸壁效应。如图4所示为船舶的岸壁效应示意图,B是船的宽度,h是水深,T是吃水。
(4)河岸吸力和岸推力力矩计算如下:
式中ρ是水的密度,Cb是方形系数,u为船舶的前进速度,L是船的长度,η0是船宽与船岸距离之比;
步骤3,建立RBF神经网络来估计未知干扰力和未知干扰力矩;
φ=[φ1,φ2,…,φP] (17)
其中,z是输入向量,||z||表示欧几里德范数,φi表示第i个径向基函数,zi表示第i个径向基函数中心向量,σi表示第i个径向基函数的宽度,μi表示第i个阈值向量,P表示隐藏层节点的数目,y表示RBF 神经网络的输出,W为隐藏层的权重,如图3所示:
y=Wφ(z) (18)
W=[w1,w2,…,wP] (19)
步骤4、调用自适应分数阶滑模控制系统算法,计算船舶纵向控制输入力τu和艏向控制输入力矩τr,并将计算结果施加于船舶的执行机构上,通过检测误差并消除误差,驱使船舶保持期望位姿和期望速度,实现高精度定位;
(1)Caputo型分数阶微积分的定义为:
其中,g为整数,a为微积分的起始时刻,当α>0时为分数阶微分,当α<0时为分数阶积分,Γ(x)为伽马函数,定义为:
定义期望位姿为:
定义期望速度为:
其中,ηd表示为船舶期望位姿矢量,υd表示为船舶期望速度矢量,则位姿和速度的跟踪误差分别为:
构造以下分数阶滑模函数s:
式中c1>0,α为分数阶,D表示分数阶微积分函数;
对(26)求导得:
将(10)代入(27)可得:
构造基于分数阶滑模的纵向控制输入力如下:
式中ε1是RBF神经网络的逼近误差,φ表示径向基函数;
(30)减去(31)可得:
定义
(32)可写为
自适应控制律构造为
构造以下分数阶滑模面函数:
式中c2>0,β为分数阶;
对(36)求导得:
将(25)代入(37)可得:
构造vd如下:
对(39)求导得:
构造ud如下:
对(41)求导得:
计算可得:
对(40)求导得:
将(43)代入(44)可得:
构造基于分数阶滑模的艏向控制输入力矩如下:
式中ε2为RBF神经网络的逼近误差。
(47)减去(48)可得:
定义:
(49)可写为
构造自适应控制律如下:
(2)稳定性分析
定理1.基于Lyapunov稳定性理论,考虑船舶的动力学模型(10) 和分数阶滑模控制律(公式(29)和(46)),以及自适应控制律(公式(35)和(52)),若系统的跟踪误差收敛到零,则系统渐近稳定。
证明:构造Lyapunov函数如下:
对(53)求导可得:
将(29)代入(28)可得:
将(34)代入(55)可得:
将(56)代入(54)可得:
对(33)求导可得:
将(35)代入(58)可得:
将(59)代入(57)可得:
将(45)代入(38)可得:
将(10)代入(61)可得:
将(46)代入(62)可得:
将(63)代入(60)可得:
将(51)代入(64)可得:
对(50)求导可得:
将(52)代入(66)可得:
将(63)代入(61)可得:
当下式成立时
|ε1|≤η1 (69)
|ε2|≤k2 (70)
有
基于Lyapunov稳定性理论,若跟踪误差收敛到零,系统渐近稳定。
为了验证自适应分数阶滑模控制算法对船舶的控制效果,实验船的船长为76.2米,质量为4591吨,船舶相关参数如下:
船舶重量惯性和水动力附加惯性组成的矩阵为:
实验在Intel(R)Core(TM)i3-4150T CPU@3.00GHz 3.00GHz、 64位操作系统(4.00GB内存)和基于x64的处理器上进行。
实验结果xk=[10,10,0.1,-10,5,0.2],期望的前进速度设为7 m/s,期望的横摆速度为0m/s,期望的横摆速度为0rad/s,期望的横摆速度为0m/s,图5上分图为船舶前进位置响应曲线,水平轴表示以秒为单位的时间;纵轴表示前进位置,单位m,中间部分分图显示了船舶横荡位置的响应曲线,水平轴表示以秒为单位的时间;纵轴以m 为单位表示横荡位置,单位m,下分图为船舶偏航角响应曲线,水平轴表示以秒为单位的时间;纵轴表示偏航角,单位为rad。
图6上分图为船舶前进速度响应曲线,水平轴表示以秒为单位的时间;纵轴表示前进速度,单位为m/s,中间部分分图为船舶横荡速度响应曲线,水平轴表示以秒为单位的时间;纵轴表示横荡速度,单位为m/s,下分图为船舶艏摇角角速度响应曲线,水平轴表示以秒为单位的时间;纵轴表示艏摇角角速度,单位为rad/s。
图5-6表明,采用神经估计器的自适应分数阶滑模控制可以使船舶达到期望位姿ηd和期望速度υd。
为了验证算法的有效性,比较了不同算法的控制效果。其余参数保持不变。图7是闭环控制系统的偏航响应曲线,水平轴表示以秒为单位的时间,纵轴表示偏航角,单位为rad。图7显示,与基本的滑模控制算法相比,采用神经估计器的自适应分数阶滑模控制的超调量更小,系统的调节时间更短。
以上所述,仅是本发明较佳实施例而已,并非对本发明的技术范围作任何限制,故凡是依据本发明的技术实质对以上实施例所作的任何细微修改、等同变化与修饰,均仍属于本发明技术方案的范围内。
Claims (3)
1.一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制系统,其特征在于包括有:
测量模块:用于测量船舶位姿和速度,以及包括风速、流速的外界扰动;
输入扰动力和力矩计算模块:读入当前船舶的位姿状态值、期望位姿、速度状态值、期望速度,判断当前船舶是否达到期望位姿和期望速度,若未达到,则计算风、海流、海浪和岸壁效应对船舶的干扰力和干扰力矩,计算船舶运动数学模型所需的输入扰动力和力矩;
RBF神经网络估计模块:构建RBF神经网络用以估计未知干扰力和未知干扰力矩;
控制模块:调用自适应分数阶滑模控制系统算法,利用径向基函数神经网络能逼近任意函数的特点,通过RBF神经网络估计模块估计出船舶模型的未知干扰力和未知干扰力矩,进行包括稳定横摇和纵荡速度误差的轨迹跟踪误差,基于Lyapunov稳定性理论,在跟踪误差收敛到零,系统渐近稳定后,计算船舶纵向控制输入力和艏向控制输入力矩;
执行模块:将纵向控制输入力和艏向控制输入力矩,施加于船舶的执行机构上,驱使船舶保持期望位姿和期望速度,实现高精度定位。
2.一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制方法,其特征在于:
建立坐标系和船舶运动数学模型;
读入当前船舶的位姿状态值、期望位姿、速度状态值、期望速度,判断当前船舶是否达到期望位姿和期望速度,若未达到,则计算风、海流、海浪和岸壁效应对船舶的干扰力和干扰力矩,计算船舶运动数学模型所需的输入扰动力和力矩;
构建RBF神经网络用以估计未知干扰力和未知干扰力矩;
调用自适应分数阶滑模控制系统算法,利用径向基函数神经网络能逼近任意函数的特点,通过RBF神经网络估计模块估计出船舶模型的未知干扰力和未知干扰力矩,进行包括稳定横摇和纵荡速度误差的轨迹跟踪误差,基于Lyapunov稳定性理论,在跟踪误差收敛到零,系统渐近稳定后,计算船舶纵向控制输入力和艏向控制输入力矩;
将纵向控制输入力和艏向控制输入力矩,施加于船舶的执行机构上,驱使船舶保持期望位姿和期望速度,实现高精度定位。
3.根据权利要求2一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制方法,其特征在于包括如下具体步骤:
步骤1、船舶建模
(1)建立如下坐标系:考虑了纵荡、横摆和偏航三自由度运动,将海岸上的固定观测点定义为原点O,正东向定义为X轴,正北向定义为Y轴;
(2)建立船舶运动数学模型如下:
η=[x y ψ]T (2)
υ=[u v r]T (3)
式中η表示船舶的位置和姿态矢量,υ表示船的速度矢量,u表示前进速度,v表示横摆速度,r表示艏摇速度,x表示前进方向位置,y表示横荡方向位置,ψ表示横摆角度,R为旋转矩阵:
mu表示惯性矩阵对角线上的第一个元素,mv表示惯性矩阵对角线上的第二个元素,mr表示惯性矩阵对角线上的第三个元素,则惯性矩阵如下:
令d11,d22,d33为线性水动力阻尼参数矩阵的对角线上的元素,线性水动力阻尼参数矩阵Δ如下:
其中fu,fv分别为未知扰动产生的纵向力和横向力,Nwc为未知扰动产生的干扰力矩,Fwx,Fwy分别为风产生的纵向力和横向力,Nwc为风产生的干扰力矩,Fcx,Fcy分别为海流产生的纵向力和横向力,Nc为海流产生的干扰力矩,Fsx,Fsy分别为海浪产生的纵向力和横向力,Ns为海浪产生的干扰力矩,Fxb为河岸吸力,Nb为岸推力力矩,τu表示纵向控制输入力,τr表示艏向控制输入力矩;
步骤2、读入当前船舶的位姿状态值η=[x y ψ]T、期望位姿、速度状态值υ=[u v r]T、期望速度,判断当前船舶是否达到期望位姿和期望速度,若未达到,则计算风、海流、海浪和岸壁效应对船舶的干扰力和干扰力矩,通过此步骤来计算公式(10)中的各种输入扰动力和力矩;
(1)风的干扰力和干扰力矩计算如下:
其中CX为前进方向的风系数,CY为横向的风系数,CN为风力矩系数,Af为水线上正投影面积,As为侧投影面积,Loa为船舶总长度,ρa为空气密度,Vr为风速;
(2)海流的干扰力和干扰力矩计算如下:
式中Vc表示海流流速,Afw为船舶水下正投影面积,Asw为船舶水下侧投影面积,L是船舶水线长,β为漂角,ρ为海水密度,Cx,Cy,Cn分别表示纵向、横向海流力系数和海流力矩系数;
(3)海浪的干扰力和干扰力矩计算如下:
式中a为平均波浪幅值,χ为遭遇角,Cxw,Cyw,Cnw为波浪横向、纵向漂移力和力矩系数,λ为波长;
(4)河岸吸力和岸推力力矩计算如下:
式中ρ是水的密度,Cb是方形系数,u为船舶的前进速度,L是船的长度,η0是船宽与船岸距离之比,B是船的宽度,h是水深,T是吃水;
步骤3,建立RBF神经网络来估计未知干扰力和未知干扰力矩;
φ=[φ1,φ2,…,φP] (17)
其中,z是输入向量,||z||表示欧几里德范数,φi表示第i个径向基函数,zi表示第i个径向基函数中心向量,σi表示第i个径向基函数的宽度,μi表示第i个阈值向量,P表示隐藏层节点的数目,y表示RBF神经网络的输出,W为隐藏层的权重:
y=Wφ(z) (18)
W=[w1,w2,…,wP] (19)
步骤4、调用自适应分数阶滑模控制系统算法,计算船舶纵向控制输入力τu和艏向控制输入力矩τr,并将计算结果施加于船舶的执行机构上,通过检测误差并消除误差,驱使船舶保持期望位姿和期望速度,实现高精度定位;
(1)Caputo型分数阶微积分的定义为:
其中,g为整数,a为微积分的起始时刻,当α>0时为分数阶微分,当α<0时为分数阶积分,Γ(x)为伽马函数,定义为:
定义期望位姿为:
定义期望速度为:
其中,ηd表示为船舶期望位姿矢量,υd表示为船舶期望速度矢量,则位姿和速度的跟踪误差分别为:
构造以下分数阶滑模函数s:
式中c1>0,α为分数阶,D表示分数阶微积分函数;
对(26)求导得:
将(10)代入(27)可得:
构造基于分数阶滑模的纵向控制输入力如下:
式中ε1是RBF神经网络的逼近误差,φ表示径向基函数;
(30)减去(31)可得:
定义
(32)可写为
自适应控制律构造为
构造以下分数阶滑模面函数:
式中c2>0,β为分数阶;
对(36)求导得:
将(25)代入(37)可得:
构造vd如下:
对(39)求导得:
构造ud如下:
对(41)求导得:
计算可得:
对(40)求导得:
将(43)代入(44)可得:
构造基于分数阶滑模的艏向控制输入力矩如下:
式中ε2为RBF神经网络的逼近误差。
(47)减去(48)可得:
定义:
(49)可写为
构造自适应控制律如下:
(2)稳定性分析
基于Lyapunov稳定性理论,考虑船舶的动力学模型(10)和分数阶滑模控制律公式(29)和(46),以及自适应控制律公式(35)和(52),若系统的跟踪误差收敛到零,则系统渐近稳定:
构造Lyapunov函数如下:
对(53)求导可得:
将(29)代入(28)可得:
将(34)代入(55)可得:
将(56)代入(54)可得:
对(33)求导可得:
将(35)代入(58)可得:
将(59)代入(57)可得:
将(45)代入(38)可得:
将(10)代入(61)可得:
将(46)代入(62)可得:
将(63)代入(60)可得:
将(51)代入(64)可得:
对(50)求导可得:
将(52)代入(66)可得:
将(63)代入(61)可得:
当下式成立时
|ε1|≤η1 (69)
|ε2|≤k2 (70)
有
基于Lyapunov稳定性理论,若跟踪误差收敛到零,系统渐近稳定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010789229.3A CN112051732B (zh) | 2020-08-07 | 2020-08-07 | 一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010789229.3A CN112051732B (zh) | 2020-08-07 | 2020-08-07 | 一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112051732A true CN112051732A (zh) | 2020-12-08 |
CN112051732B CN112051732B (zh) | 2022-06-14 |
Family
ID=73602153
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010789229.3A Active CN112051732B (zh) | 2020-08-07 | 2020-08-07 | 一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112051732B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113220001A (zh) * | 2021-05-13 | 2021-08-06 | 青岛理工大学 | 一种潜航器及潜航器的实时避障方法 |
CN113791542A (zh) * | 2021-09-17 | 2021-12-14 | 广州市香港科大霍英东研究院 | 基于二维系统的伺服电机转速控制方法、系统及装置 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002145183A (ja) * | 2000-11-16 | 2002-05-22 | National Maritime Research Institute | 波浪中浮体の波漂流力3成分および非拘束動揺変位6成分の計測システム |
CN101859147A (zh) * | 2010-06-11 | 2010-10-13 | 哈尔滨工程大学 | 船舶航向智能协调控制方法 |
CN106842910A (zh) * | 2016-11-17 | 2017-06-13 | 中国船舶科学研究中心(中国船舶重工集团公司第七0二研究所) | 一种基于干扰观测器的船舶减摇鳍滑模控制方法 |
CN108267955A (zh) * | 2018-01-17 | 2018-07-10 | 哈尔滨工程大学 | 面向无人艇自主靠泊的运动控制方法 |
CN108563130A (zh) * | 2018-06-27 | 2018-09-21 | 山东交通学院 | 一种欠驱动船舶自适应神经网络自动靠泊控制方法,设备及介质 |
CN109116856A (zh) * | 2018-09-28 | 2019-01-01 | 上海海事大学 | 一种基于扰动观测器的欠驱动船舶路径跟踪控制方法 |
CN109271652A (zh) * | 2018-07-12 | 2019-01-25 | 哈尔滨工程大学 | 基于多目标进化算法的船舶横向三自由度运动参数辨识方法 |
CN109343555A (zh) * | 2018-11-06 | 2019-02-15 | 哈尔滨工程大学 | 基于仿鱼侧线的岸壁效应测量及船舶艏向补偿控制方法 |
CN110618611A (zh) * | 2019-10-23 | 2019-12-27 | 哈尔滨工程大学 | 一种基于回转率约束的无人艇轨迹跟踪安全控制方法 |
-
2020
- 2020-08-07 CN CN202010789229.3A patent/CN112051732B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002145183A (ja) * | 2000-11-16 | 2002-05-22 | National Maritime Research Institute | 波浪中浮体の波漂流力3成分および非拘束動揺変位6成分の計測システム |
CN101859147A (zh) * | 2010-06-11 | 2010-10-13 | 哈尔滨工程大学 | 船舶航向智能协调控制方法 |
CN106842910A (zh) * | 2016-11-17 | 2017-06-13 | 中国船舶科学研究中心(中国船舶重工集团公司第七0二研究所) | 一种基于干扰观测器的船舶减摇鳍滑模控制方法 |
CN108267955A (zh) * | 2018-01-17 | 2018-07-10 | 哈尔滨工程大学 | 面向无人艇自主靠泊的运动控制方法 |
CN108563130A (zh) * | 2018-06-27 | 2018-09-21 | 山东交通学院 | 一种欠驱动船舶自适应神经网络自动靠泊控制方法,设备及介质 |
CN109271652A (zh) * | 2018-07-12 | 2019-01-25 | 哈尔滨工程大学 | 基于多目标进化算法的船舶横向三自由度运动参数辨识方法 |
CN109116856A (zh) * | 2018-09-28 | 2019-01-01 | 上海海事大学 | 一种基于扰动观测器的欠驱动船舶路径跟踪控制方法 |
CN109343555A (zh) * | 2018-11-06 | 2019-02-15 | 哈尔滨工程大学 | 基于仿鱼侧线的岸壁效应测量及船舶艏向补偿控制方法 |
CN110618611A (zh) * | 2019-10-23 | 2019-12-27 | 哈尔滨工程大学 | 一种基于回转率约束的无人艇轨迹跟踪安全控制方法 |
Non-Patent Citations (1)
Title |
---|
尤晓琳等: "干扰及参数扰动条件下的航迹镇定滑模控制", 《舰船科学技术》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113220001A (zh) * | 2021-05-13 | 2021-08-06 | 青岛理工大学 | 一种潜航器及潜航器的实时避障方法 |
CN113791542A (zh) * | 2021-09-17 | 2021-12-14 | 广州市香港科大霍英东研究院 | 基于二维系统的伺服电机转速控制方法、系统及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN112051732B (zh) | 2022-06-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112083654B (zh) | 一种航标船抗干扰轨迹跟踪控制方法 | |
Moreira et al. | Path following control system for a tanker ship model | |
CN109976349B (zh) | 一种含约束无人船的路径跟踪制导与控制结构的设计方法 | |
US20230192262A1 (en) | Automatic guiding method of vessel, automatic guiding program of vessel, automatic guiding system of vessel, and vessel | |
CN112051732B (zh) | 一种考虑岸壁效应的航标船自适应神经网络分数阶滑模控制系统及方法 | |
CN109814392A (zh) | 一种欠驱动水下机器人执行器故障鲁棒容错控制方法 | |
Wille et al. | Modeling and course control of sailboats | |
CN116627043B (zh) | 一种联合锚泊系统的区域动力定位控制方法 | |
Leifeng et al. | Adaptive heading control of unmanned wave glider with heading information fusion | |
Huang et al. | Ship pitch-roll stabilization by active fins using a controller based on onboard hydrodynamic prediction | |
CN115903800A (zh) | 一种基于领导者协同的多无人船编队的严格安全控制方法 | |
CN117707162A (zh) | 基于改进lvs制导的无人帆船动态事件触发控制方法 | |
Kim et al. | A numerical and experimental study on the obstacle collision avoidance system using a 2D LiDAR sensor for an autonomous surface vehicle | |
CN115079698A (zh) | 欺骗攻击任务下的无人水面船路径跟踪时间触发控制方法 | |
Dallolio et al. | Design and validation of a course control system for a wave-propelled unmanned surface vehicle | |
CN110580045A (zh) | 一种无人艇避障方法 | |
Abrougui et al. | Backstepping control of an autonomous catamaran sailboat | |
Verwilligen et al. | Full-scale measurements of vertical motions on ultra large container vessels in Scheldt estuary | |
Masuyama | The work achieved with the sail dynamometer boat “Fujin”, and the role of full scale tests as the bridge between model tests and CFD | |
Demirbilek et al. | Deep-draft coastal navigation entrance channel practice | |
CN111651943B (zh) | 一种船舶运动控制方法、终端设备及存储介质 | |
CN115145282A (zh) | 一种欠驱动船舶自动靠泊鲁棒自适应控制方法 | |
CN114610046A (zh) | 一种考虑动态水深的无人艇动态安全轨迹规划方法 | |
Bartels et al. | Rope-assisted docking maneuvers for autonomous surface vessels | |
Moe et al. | Path following of underactuated marine underwater vehicles in the presence of unknown ocean currents |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |