CN117311142A - 一种融合粒子群算法与神经网络预测控制的dp船舶运动控制与推力分配协同控制方法 - Google Patents

一种融合粒子群算法与神经网络预测控制的dp船舶运动控制与推力分配协同控制方法 Download PDF

Info

Publication number
CN117311142A
CN117311142A CN202311105923.9A CN202311105923A CN117311142A CN 117311142 A CN117311142 A CN 117311142A CN 202311105923 A CN202311105923 A CN 202311105923A CN 117311142 A CN117311142 A CN 117311142A
Authority
CN
China
Prior art keywords
ship
control
neural network
propeller
model
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.)
Pending
Application number
CN202311105923.9A
Other languages
English (en)
Inventor
邓芳
丁强
张翰林
杜治宇
杨化林
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Qingdao University of Science and Technology
Original Assignee
Qingdao University of Science and Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Qingdao University of Science and Technology filed Critical Qingdao University of Science and Technology
Priority to CN202311105923.9A priority Critical patent/CN117311142A/zh
Publication of CN117311142A publication Critical patent/CN117311142A/zh
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive 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/042Adaptive 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
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明提供一种融合粒子群算法与神经网络预测控制的DP船舶运动控制与推力分配协同控制方法,基于当前及历史船舶的船位和航向、推进器的转速、方位角数据建立运动控制与推力分配的船舶运动神经网络模型;继而通过迭代计算建立船舶状态神经网络多步预测模型,从而形成包含船舶运动轨迹控制误差最小、推进器损耗及推进器功耗最低,以及考虑推进器物理约束的运动控制与推力分配的约束非线性在线优化目标函数;采用粒子群算法进行求解,得到满足优化目标的最优推进器组合,输出推进器转速、舵角和方位角。本发明方案解决了当前采用分级运动控制方法带来的推力饱和、非均衡能耗问题,增强处理非线性优化问题能力,提高DP系统的鲁棒性。

Description

一种融合粒子群算法与神经网络预测控制的DP船舶运动控制 与推力分配协同控制方法
技术领域
本发明涉及船舶动力定位系统推力分配技术领域,尤其涉及一种融合粒子群算法与神经网络预测控制的DP船舶运动控制与推力分配协同控制方法。
背景技术
船舶动力定位(DynamicPositioning,DP)系统为通过船舶自身推进系统自动保持预定位置和航向的系统,其广泛应用于深海油气勘探、海上救援/科考等作业任务。控制系统是DP系统的核心,当前主要采用运动控制与推力分配分级控制方法,如图1所示,首先运动控制算法根据当前测量/估计状态与期望状态的偏差,计算出船舶达到期望船位所需的总推进力和力矩,即控制力;然后,推力分配算法进一步确定各推进器推力和方位角,以使推进器合成的总推进力和力矩等于控制力,以实现DP船舶的姿态控制或轨迹跟踪。
早期DP系统采用PID控制,其后最优控制和卡尔曼滤波相结合用于DP控制。20世纪90年代,滑模控制、反步控制等非线性控制方法得到广泛研究与应用,因模型预测控制(MPC)具有快速响应及能在线处理多变量约束问题,被广泛用于过程控制及船舶运动控制。在DP系统中,早期研究通常利用平行坐标系建立系统的线性化模型,采用卡尔曼滤波器和最优控制理论等线性模型预测控制方法。近年来,考虑DP系统是高度非线性系统,为提高船舶控制性能,非线性模型预测控制(nonlinear MPC,NMPC)得到广泛研究,非线性模型预测控制是一种基于模型的闭环优化控制策略,通过在线求解约束非线性控制目标函数求得未来控制时域内的最优控制序列,并选择序列的第一组元素作用在下一个周期,如此重复进行计算,NMPC的关键是建立对未来状态进行准确预测的预测模型,通常采用拖曳试验或依托参数辨识建立的机理模型对未来状态进行多步预测。然而,拖曳试验将增加控制系统设计的周期和成本,参数辨识虽然能够解决此问题,但对复杂的非线性船舶运动过程,目前这两种方法均不能获得完整的船舶信息动态,未建模动态的存在将影响控制效果。因人工神经网络具有强大的学习能力,可以拟合任意非线性函数,从而可基于系统输入输出数据构建系统模型,而无需对系统复杂参数进行辨识,出现了利用神经网络模型代替传统机理模型进行未来多步预测的神经网络预测控制方法(NNPC)。
为保证船舶行驶过程中的安全性,DP船舶一般配备多台推进器,这使得配备动力定位系统的船舶都是过驱动的,推进系统冗余,因此可将推力分配问题视为一个优化问题,通过求解推力分配优化问题确定推进器最优的组合方式,以实现精确定位和控制。由于运动控制算法未能充分考虑推力饱和、非均衡能耗等推进器影响,其计算所得控制力必然是次优的,且当控制力较大变化时,各推进器无法在短时间内合成所需力和力矩,造成系统不可控。为解决此问题,实际应用时通常将推力分配信息反馈回运动控制算法中,使控制效果达到最优,但这使运动控制和推力分配的界限变得模糊,使参数整定变得更为复杂,工程代价增加。
发明内容
针对现有技术存在的问题,本发明提供一种融合粒子群算法与神经网络预测控制的DP船舶运动控制与推力分配协同控制方法,包括:
A.构建动力定位船舶的运动控制与推力分配协同数学模型;
(1)建立动力定位船舶运动非线性数学模型,具体如下:
其中,η=[x,y,ψ]T为在地球北东坐标系中描述的船位和艏向角向量;v=[u,v,r]T为在船体坐标系中描述的速度和角速度向量,τd=[X,Y,N]T为控制力和力矩向量,即推进系统提供的总的推进力和力矩,d=[d1,d2,d3]T为环境干扰力和力矩向量,R(ψ)为坐标变换矩阵,M为包括附加质量的惯性矩,N(v)为水动力阻尼及科里奥利向心力矩阵,R(ψ)定义为:
M和N(v)由船舶水动力特性决定;
(2)建立推力分配数学模型,具体如下:
τd=B(α)T(u)
其中,表示各个推进器产生的推力, 为各推进器的方位角,/>为推进器的配置矩阵;
其中,(lxi,lyi)表示第i个推进器的安装位置,x表示纵轴,以船的艏向为正;y为横轴,以船的右舷方向为正;
(3)忽略外部干扰影响,根据运动非线性数学模型和推力分配数学模型构建运动控制与推力分配协同数学模型,具体如下:
其中,为状态向量,u=[ω,δ,α]T为代表推进器转速、方位角和舵角的控制输入向量,ω=[ω12,…,ωn]T为螺旋桨转速向量,δ=[δ12,…,δn]T为舵角向量,矩阵A、B定义如下:
对于DP船舶,仅船舶位置和航向可测,故输出模型为:
y=Hx
其中,H=[I3×3,03×3],y=η=[x,y,ψ]T为输出向量,表示位置和航向;
将模型离散化,可得DP船舶离散化数学模型:
x(k+1)=Ax(k)+BT(u(k))
y(k)=Hx(k)
其中,k表示当前时刻,k+1表示当前时刻出发的下一时刻,k-1表示当前时刻的前一时刻,根据数值差分原理,未来k+1时刻输出y(k+1)与当前时刻输出y(k)、之前时刻输出y(k-1)、y(k-2)及当前时刻控制输入u(k)相关,从而可得DP船舶差分数学表达模型如下:
y(k+1)=f(y(k),y(k-1),y(k-2),u(k))
其中,f(·)为非线性函数;
B.构建基于神经网络预测控制的DP船舶运动控制及推力分配协同控制策略;
(1)建立非线性在线优化目标函数及约束条件,寻找最优控制输入;
Δumin≤Δu(k+n-1)≤Δumax
umin≤u(k+n-1)≤umax
n=1,2,…,Np
其中,x(k+n)为由当前时刻k开始的未来n时刻的船舶预测状态,为由当前时刻k开始的未来n时刻船舶的预测输出,u(k+n)为由当前时刻k开始的未来n时刻船舶的控制输入(即推进器转速、舵角及方位角)状态,Δu(k+n)=u(k+n)-u(k+n-1)为由当前时刻k开始的未来n时刻的控制输入变化,即推进器转速、舵角和方位角的变化量,ω(k+n)为由当前时刻k开始的未来n时刻的推进器转速,U(k)=[u(k)T,u(k+1)T,...,u(k+Nc-1)T]T为控制时域Nc内的控制输入序列,yr(k)表示参考轨迹序列,/> 为预测时域NP中的预测输出序列,在目标函数中,第一项为预测范围内的运动轨迹控制误差,第二项代表推进器损耗,最后一项代表推进器功耗,umin,umax分别为控制输入(即推进器转速、舵角和方位角)的最小值和最大值,Δumin,Δumax分别为控制输入变化量的最小值和最大值,由于Nc小于NP,因此假设:当Nc≤n≤Np时,控制输入保持不变,即u(k+n)=u(k+n-1),Q、R为权重矩阵并且都是正定矩阵,/>为估计的船舶非线性模型函数,将由神经网络模型构建;
(2)基于船舶控制输入及测量输出信息,构建神经网络多步预测模型,对目标函数中的未来状态进行预测,其中,所述船舶控制输入包括转速、方位角及舵角,所述船舶测量输出包括船舶当前及历史时刻的船位和航向;
(3)利用粒子群算法对非线性在线优化目标函数进行求解,得到最优控制输入序列u*=[ω*,δ*,α*]T,包含推进器转速ω*=[ω1*,ω2*,...,ωn*]T,舵角δ*=[δ1 *,δ2 *,...,δn *]T及方位角α*=[α1 *,α2 *,...,αn *]T,并将最优控制输入序列的第一组元素作为推进器运行参数,完成当前时刻推力分配。
可选的,所述基于船舶控制输入及测量输出信息,构建神经网络多步预测模型,对目标函数中的未来状态进行预测,包括:
①进行船舶操纵运动试验,以特定采样时间获取船舶在各时刻的控制输入u(k)=[ω(k),δ(k),α(k)]T,及测量输出y(k)=[x(k),y(k),ψ(k)]T
②构建船舶运动神经网络模型,对目标函数中的未来状态进行单步预测;
由当前及之前时刻的船位、航向、转速与方位角构建船舶运动神经网络模型输入数据集χ=[y(k-1),y(k-2),y(k-3),u(k-1)]T及输出数据集O=yT(k),船舶运动神经网络模型如下:
hi,p=σh(Wx,hχ+Whhi,k-1)
其中,为模型预测输出值,/>为从输入层到隐藏层和从隐藏层到隐藏层的权重矩阵,/>为隐藏层的输出函数,船舶运动神经网络模型可以简化为:
其中,为模型预测输出值,分别为/>为从输入层到隐藏层和从隐藏层到隐藏层的权重矩阵,/>为隐藏层的输出函数,σh(·)及σy(·)分别为隐藏层和输出层激活函数,船舶运动神经网络模型可以简化为:
其中,fRNN(·)为由神经网络模型建立的输入输出间的映射关系,即船舶运动非线性模型函数,在所建立的非线性在线优化目标函数中代替用于对未来输出进行预测;
③根据递推式多步预测原理结合所述船舶运动神经网络模型得出船舶状态神经网络多步预测模型,并计算得到未来预测时域内船舶状态输出;
其中,为神经网络多步预测模型由当前时刻k开始的未来n时刻的船舶位置和艏向的预测值,u(k+n),n=0,1,…,Np-1代表由当前时刻k开始的未来n时刻的系统控制输入值。
可选的,所述利用粒子群算法对非线性在线优化目标函数进行求解,得到最优控制输入序列u*=[ω*,δ*,α*]T,包括:
①初始化粒子数目为N,种群规模为D,定义粒子初始位置和速度,相关定义为:以未来时域内控制输入预测序列U(k)=[u(k)T,u(k+1)T,...,u(k+Nc-1)T]T中的元素作为粒子,定义第i个粒子的位置向量 定义第i个粒子的速度向量/>第i个粒子当前最优值Pbest对应的粒子位置向量/>种群最优值即全局最优值Gbest对应的粒子位置向量
②选取所定义的非线性在线优化目标函数作为适应度函数,计算粒子适应度值确定个体最优位置/>和群体最优位置/>
③更新粒子速度和位置,更新公式如下:
其中,t和t+1表示当前和下一次迭代,和/>表示第i个粒子在t+1次迭代时d维上的速度和位置,/>和/>表示第i个粒子在第t次迭代时在d维上的速度和位置,为了防止粒子偏离搜索空间,设置边界条件,粒子的速度和位置在v∈[-vmax,vmax]和x∈[-xmax,xmax]内,/>表示第i个粒子在第t次迭代时在d维上搜索到的最佳位置,/>表示整个群体在第t次迭代时在d维上搜索到的最佳位置,rand1和rand2是[0,1]之间均匀分布的随机数,w为惯性权重,c1和c2分别表示个体学习因子和群体学习因子;
④更新粒子的个体最优位置和群体最优位置,迭代更新公式如下:
⑤更新惯性权重w、个体学习因子c1和群体学习因子c2,公式如下:
其中,w1为初始惯性权重,w2为最终惯性权重;c1s,c1e和c2s,c2e分别为个体学习因子c1和群体学习因子c2的初始值和终值,t为当前迭代次数,m为最大迭代次数;
⑥判断当前迭代次数是否满足终止条件,若当前迭代次数大于最大迭代次数m,则停止迭代,输出最优解即最优控制输入序列u*=[ω***]T;若当前迭代次数小于最大迭代次数m,则转入步骤②继续搜索最优解。
与现有技术相比,本发明至少具有如下有益效果:
解决了当前采用分级运动控制方法带来的推力饱和、非均衡能耗问题,增强处理非线性优化问题能力,提高DP系统的鲁棒性。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为传统运动控制与推力分配分级控制方法流程示意图;
图2为基于神经网络预测控制的DP船舶运动控制及推力分配协同控制策略原理框图;
图3为循环神经网络模型原理图;
图4为递推式多步预测原理图;
图5为粒子群算法求解目标函数最优解的流程示意图;
图6为CSⅡ船模推进器配置示意图;
图7为船舶运动神经网络模型损失函数迭代误差图;
图8为船舶运动神经网络模型训练数据输出预测与误差图;
图9为船舶运动神经网络模型测试数据输出预测与误差图;
图10为PSO-NNPC算法与分级运动控制算法定点调节转速与方位角仿真结果图;
图11为PSO-NNPC算法与分级运动控制算法定点调节推进器功率损耗仿真结果图;
图12为PSO-NNPC算法与分级运动控制算法定点调节控制力与力矩仿真结果图;
图13为PSO-NNPC算法与分级运动控制算法定点调节船舶运动速度仿真结果图;
图14为PSO-NNPC算法与分级运动控制算法定点调节船舶位置及艏向轨迹仿真结果图;
图15为PSO-NNPC算法与分级运动控制算法定点调节船舶运动轨迹仿真结果图;
图16为PSO-NNPC算法与分级运动控制算法轨迹跟踪转速与方位角仿真结果图;
图17为PSO-NNPC算法与分级运动控制算法轨迹跟踪推进器功率损耗仿真结果图;
图18为PSO-NNPC算法与分级运动控制算法轨迹跟踪控制力与力矩仿真结果图;
图19为PSO-NNPC算法与分级运动控制算法轨迹跟踪船舶运动速度仿真结果图;
图20为PSO-NNPC算法与分级运动控制算法轨迹跟踪船舶位置及艏向轨迹仿真结果图;
图21为PSO-NNPC算法与分级运动控制算法轨迹跟踪船舶运动轨迹仿真结果图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
为解决NMPC求解时对精确机理模型的依赖,同时获得最优的运动控制及推力分配效果。然而,考虑运动控制与推力分配协同优化目标的神经网络预测控制(NNPC)在线优化问题必然是高度非线性的约束优化问题,同时受推进器物理限制,所求解优化问题可能是非凸问题,采用传统的伪逆、二次规划及序列二次规划等方法将较难求解,而智能优化算法如粒子群算法(PSO)、蚁群算法、遗传算法等群智能算法由于不受问题凸或非凸影响,具有较强的自组织性与鲁棒性,可以用来求解此问题。粒子群算法(PSO)具有收敛速度快,直接处理非线性优化问题等优势得到广泛应用,将粒子群算法(PSO)作为NNPC的优化技术获取未来最优控制输入。
本实施例提出一种融合粒子群算法与神经网络预测控制的DP船舶运动控制与推力分配协同控制方法,包括:
A.构建动力定位船舶的运动控制与推力分配协同数学模型;
(1)对于DP水面船舶,通常只考虑水平面三自由度运动,即纵荡、横荡和艏摇,定义地球北东坐标系和船体坐标系,建立动力定位船舶运动非线性数学模型,具体如下:
其中,η=[x,y,ψ]T为在地球北东坐标系中描述的船位和艏向角向量;v=[u,v,r]T为在船体坐标系中描述的速度和角速度向量,τd=[X,Y,N]T为控制力和力矩向量,即推进系统提供的总的推进力和力矩,d=[d1,d2,d3]T为环境干扰力和力矩向量,R(ψ)为坐标变换矩阵,M为包括附加质量的惯性矩,N(v)为水动力阻尼及科里奥利向心力矩阵,矩阵R(ψ)、M、N(v)定义如下:
其中,m为船舶的质量,Xg为水面船舶质心纵向坐标,Iz为水面船舶绕oz轴的转动惯量;X(·)、Y(·)、N(·)为水动力参数;
(2)DP船舶中通常包含冗余推进器,为保证运动控制需通过求解推力分配合成所需要的控制力和力矩,确定推进器最优的组合方式,建立推力分配数学模型,具体如下:
τd=B(α)T(u)
其中,表示各个推进器产生的推力, 为各推进器的方位角,/>为推进器的配置矩阵;
其中,(lxi,lyi)表示第i个推进器的安装位置,x表示纵轴,以船的艏向为正;y为横轴,以船的右舷方向为正;
(3)根据运动非线性数学模型和推力分配数学模型构建运动控制与推力分配协同数学模型,具体如下:
其中,为状态向量,u=[ω,δ,α]T为代表推进器转速、方位角和舵角的控制输入向量,ω=[ω1,ω2,…,ωn]T为螺旋桨转速向量,δ=[δ1,δ2,…,δn]T为舵角向量,矩阵A、B定义如下:
对于DP船舶,仅船舶位置和航向可测,故输出模型为:
y=Hx
其中,H=[I3×3,03×3],y=η=[x,y,ψ]T为输出向量,表示位置和航向;
将模型离散化,可得DP船舶离散化数学模型:
x(k+1)=Ax(k)+BT(u(k))
y(k)=Hx(k)
其中,k表示当前时刻,k+1表示当前时刻出发的下一时刻,k-1表示当前时刻的前一时刻,根据数值差分原理,未来k+1时刻输出y(k+1)与当前时刻输出y(k)、之前时刻输出y(k-1)、y(k-2)及当前时刻控制输入u(k)相关,从而可得DP船舶差分数学表达模型如下:
y(k+1)=f(y(k),y(k-1),y(k-2),u(k))
其中,f(·)为非线性函数;
B.构建基于神经网络预测控制的DP船舶运动控制及推力分配协同控制策略,原理框图如图2所示;
(1)为确保DP船舶运动有限预测范围的闭环稳定性,设计运动控制与推力分配协同控制目标函数来寻找最优控制输入。
对于船舶运动输出,即船位与航向y(k)=η(k)=[x,y,ψ]T要跟踪设定的目标yr(k)=ηr(k)=[xr,yr,ψr]T,实现
推进器的推进功耗P与其推力T3/2成正比,由于T∝ω2,故推进系统总功耗可表示为:
其中p为推进器个数,h为与推进器性能相关的固定常数。
为减少推进器磨损,推进器转速与方位角的变化率不能太大,因而还需引入变化率控制目标。
建立非线性在线优化目标函数及约束条件,寻找最优控制输入;
Δumin≤Δu(k+n-1)≤Δumax
umin≤u(k+n-1)≤umax
n=1,2,…,Np
其中,x(k+n)为由当前时刻k开始的未来n时刻的船舶预测状态,为由当前时刻k开始的未来n时刻船舶的预测输出,u(k+n)为由当前时刻k开始的未来n时刻船舶的控制输入(即推进器转速、舵角及方位角)状态,Δu(k+n)=u(k+n)-u(k+n-1)为由当前时刻k开始的未来n时刻的控制输入变化,即推进器转速、舵角和方位角的变化量,ω(k+n)为由当前时刻k开始的未来n时刻的推进器转速,U(k)=[u(k)T,u(k+1)T,...,u(k+Nc-1)T]T为控制时域Nc内的控制输入序列,yr(k)表示参考轨迹序列,/> 为预测时域NP中的预测输出序列,在目标函数中,第一项为预测范围内的运动轨迹控制误差,第二项代表推进器损耗,最后一项代表推进器功耗,umin,umax分别为控制输入(即推进器转速、舵角和方位角)的最小值和最大值,Δumin,Δumax分别为控制输入变化量的最小值和最大值,由于Nc小于NP,因此假设:当Nc≤n≤Np时,控制输入保持不变,即u(k+n)=u(k+n-1),Q、R为权重矩阵并且都是正定矩阵,/>为估计的船舶非线性模型函数,将由神经网络模型构建;
(2)基于船舶控制输入及测量输出信息,构建神经网络多步预测模型,对目标函数中的未来状态进行预测,其中,所述船舶控制输入包括转速、方位角及舵角,所述船舶测量输出包括船舶当前及历史时刻的船位和航向;
①进行船舶操纵运动试验,以特定采样时间获取船舶在各时刻的控制输入u(k)=[ω(k),δ(k),α(k)]T,及测量输出y(k)=[x(k),y(k),ψ(k)]T
②构建船舶运动神经网络模型,对目标函数中的未来状态进行单步预测;
由当前及之前时刻的船位、航向、转速与方位角构建船舶运动神经网络模型输入数据集χ=[y(k-1),y(k-2),y(k-3),u(k-1)]T及输出数据集O=yT(k),船舶运动神经网络模型如下:
hi,p=σh(Wx,hχ+Whhi,k-1)
其中,为模型预测输出值,分别为/>为从输入层到隐藏层和从隐藏层到隐藏层的权重矩阵,/>为隐藏层的输出函数,σh(·)及σy(·)分别为隐藏层和输出层激活函数,船舶运动神经网络模型可以简化为:
其中,fRNN(·)为由神经网络模型建立的输入输出间的映射关系,即船舶运动非线性模型函数,在所建立的非线性在线优化目标函数中代替用于对未来输出进行预测;
③根据递推式多步预测原理结合所述船舶运动神经网络模型得出船舶状态神经网络多步预测模型,并计算得到未来预测时域内船舶状态输出;
其中,为神经网络多步预测模型由当前时刻k开始的未来n时刻的船舶位置和艏向的预测值,u(k+n),n=0,1,…,Np-1代表由当前时刻k开始的未来n时刻的系统控制输入值。
(3)利用粒子群算法对非线性在线优化目标函数进行求解,得到最优控制输入序列u*=[ω*,δ*,α*]T,包含推进器转速ω*=[ω1 *,ω2 *,...,ωn *]T,舵角δ*=[δ1 *,δ2 *,...,δn *]T及方位角α*=[α1 *,α2 *,...,αn *]T,并将最优控制输入序列的第一组元素作为推进器运行参数,完成当前时刻推力分配;
①基于上述目标函数的建立,使用粒子群算法(PSO)优化处理高度非线性的目标函数,以求得最优控制输入。粒子群算法(PSO)是受鸟群觅食行为规律启发,模拟鸟群通信方式的群体智能算法。该算法由多个粒子组成,包括粒子所在位置、粒子运动速度和粒子适应度值(fitnessvalue)。每个粒子的位置跟速度,代表解空间中的一个点,并对应优化问题的一个解。在飞行过程每个粒子所经历过的最佳位置就是粒子的最优解,即个体极值(Pbest),整个群体所经历过的最好位置,就是群体最优解,即群体极值(Gbest)。通过适应度值来评价粒子的“好坏”程度,粒子不断调整自身的速度和位置信息,逐渐向极值靠近。
图5为为粒子群算法求解目标函数最优解的流程示意图,具体如下:
①初始化粒子数目为N,种群规模为D,定义粒子初始位置和速度,相关定义为:以未来时域内控制输入预测序列U(k)=[u(k)T,u(k+1)T,...,u(k+Nc-1)T]T中的元素作为粒子,定义第i个粒子的位置向量 定义第i个粒子的速度向量/>第i个粒子当前最优值Pbest对应的粒子位置向量/>种群最优值即全局最优值Gbest对应的粒子位置向量
②选取所定义的非线性在线优化目标函数作为适应度函数,计算粒子适应度值确定个体最优位置/>和群体最优位置/>
③更新粒子速度和位置,更新公式如下:
其中,t和t+1表示当前和下一次迭代,和/>表示第i个粒子在t+1次迭代时d维上的速度和位置,/>和/>表示第i个粒子在第t次迭代时在d维上的速度和位置,为了防止粒子偏离搜索空间,设置边界条件,粒子的速度和位置在v∈[-vmax,vmax]和x∈[-xmax,xmax]内,/>表示第i个粒子在第t次迭代时在d维上搜索到的最佳位置,/>表示整个群体在第t次迭代时在d维上搜索到的最佳位置,rand1和rand2是[0,1]之间均匀分布的随机数,w为惯性权重,c1和c2分别表示个体学习因子和群体学习因子;
④更新粒子的个体最优位置和群体最优位置,迭代更新公式如下:
⑤更新惯性权重w、个体学习因子c1和群体学习因子c2,公式如下:
其中,w1为初始惯性权重,w2为最终惯性权重;c1s,c1e和c2s,c2e分别为个体学习因子c1和群体学习因子c2的初始值和终值,t为当前迭代次数,m为最大迭代次数;
⑥判断当前迭代次数是否满足终止条件,若当前迭代次数大于最大迭代次数m,则停止迭代,输出最优解即最优控制输入序列u*=[ω***]T;若当前迭代次数小于最大迭代次数m,则转入步骤②继续搜索最优解。
结合上述实施例提出以下具体示例,可以理解地,以下具体示例仅对上述实施例的具体实施进行示例性阐述,并非对上述实施例的技术方案进行限定。
如图6所示,以一艘比例缩小的船模Cyber-ShipII(CSII)为计算对象,说明本发明方法,该船模共配备三个推进器,船艏配备一个侧向槽道推进器,船尾配备两个全回转推进器,三个推进器一起为船舶提供水平面内的进退、横漂和艏摇所需的力和力矩,CSII船先验动态参数如表1所示,各推进器参数值如表2所示:
表1
表2
设计参数如下:预测范围Np=50,控制范围为Nc=10,采样时间为Ts=1s,惩罚矩阵为:Q=diag(100,100,100,100,100),R=diag(1,1,1,1,1);常数h=[0.0009,0.0009,0.0009]T,初始船舶状态x0=(0m,0m,0deg,0m/s,0m/s,0deg/s)T
为获取循环神经网络模型训练、验证和测试所需的数据集,让船舶按正弦轨迹运动,即:
其中,航向角ψ取为路径的切向方向。试验时考虑推进器物理特性,CSII船三个推进器的转速与舵角极限分别设置为umax=[40r/s,40r/s,200r/s,40rad/s,40rad/s]T,umin=[-40r/s,-40r/s,-200r/s,-40rad/s,-40rad/s]T,仿真时间步长取1s,建立循环神经网络模型数据集,包括输入输出数据各2000组。
1、循环神经网络模型训练
基于获取的数据集,利用Matlab神经网络工具箱构建三层循环神经网络模型,包括输入层,节点数14,包含当前及之前2个时刻的船位、航向,及当前时刻螺旋桨转速、方位角和舵角;一层隐藏层,节点数为30,以及输出层,输出节点数为3,传递函数选用tanh函数,训练函数选用Scaled Conjugate Gradient函数,批处理大小为11。
将数据集输入神经网络模型中进行离线训练,其中1800组数据作为船舶运动神经网络模型的训练集,另外400组数据作为测试集,用于测试船舶运动神经网络模型的泛化性能。网络训练过程中通过降低损失函数,使模型预测更准确,损失函数误差结果如图7所示,损失函数的变化趋势是一开始迅速下降,到一定值后趋于稳定,说明模型表现良好,有着较高的误差收敛性能。选用最小均方误差(MSE)作为停止权重和偏差调整的标准,训练数据、测试数据输出预测与误差结果如图8、9所示。从图7、8、9可以看出,循环神经网络得到了很好的训练。
2、运动控制与推力分配性能分析
为验证所提出的运动控制与推力分配协同控制方法的优越性,对推力分配融合算法与分级运动控制算法进行仿真。分级运动控制算法首先对非线性模型进行线性化处理,基于二次规划算法对船舶轨迹进行多步预测,然后进行推力分配设计,实现DP船舶的控制。
对DP船舶的控制,设计定点调节与轨迹跟踪两种方案:
定点调节:DP船舶从初始点移动到指定航向的目标位置。目标位置与航向设置为ηd=[1.5m,1m,20deg]T,为实现平滑控制,其参考信号为
轨迹跟踪:期望轨迹表达为:
期望艏向ψd仍取路径切向方向。
3、PSO-NNPC算法与分级运动控制算法仿真
因DP船舶航速很低,小于3m/s,在进行控制器设计时,忽略科里奥利向心力和非线性阻尼影响。
定点调节仿真结果:图10描述了PSO-NNPC算法与分级运动控制算法定点调节转速与方位角;图11描述了PSO-NNPC算法与分级运动控制算法定点调节推进器功率损耗,图12描述了PSO-NNPC算法与分级运动控制算法定点调节控制力与力矩,图13描述了PSO-NNPC算法与分级运动控制算法定点调节船舶运动速度,图14描述了PSO-NNPC算法与分级运动控制算法定点调节船舶位置及艏向轨迹,图15描述了PSO-NNPC算法与分级运动控制算法定点调节船舶运动轨迹,仿真结果证明了PSO-NNPC算法的鲁棒性。
轨迹跟踪仿真结果:图16描述了PSO-NNPC算法与分级运动控制算法轨迹跟踪转速与方位角,图17描述了PSO-NNPC算法与分级运动控制算法轨迹跟踪推进器功率损耗,图18描述了PSO-NNPC算法与分级运动控制算法轨迹跟踪控制力与力矩,图19描述了PSO-NNPC算法与分级运动控制算法轨迹跟踪船舶运动速度,图20描述了PSO-NNPC算法与分级运动控制算法轨迹跟踪船舶位置及艏向轨迹,图21描述了PSO-NNPC算法与分级运动控制算法轨迹跟踪船舶运动轨迹,仿真结果再次证明了PSO-NNPC算法的鲁棒性。
仿真结果表明,PSO-NNPC算法与分级运动控制算法在外界环境干扰下都能准确追踪目标,且PSO-NNPC算法具有更优越的控制性能,功率损耗更低,鲁棒性更强。
虽然本发明已以实施例揭示如上,然其并非用以限定本发明,任何所属技术领域中技术人员,在不脱离本发明的精神和范围内,当可作些许的更改与润饰,故本发明的保护范围当视权利要求所界定的为准。

Claims (3)

1.一种融合粒子群算法与神经网络预测控制的DP船舶运动控制与推力分配协同控制方法,其特征在于,包括:
A.构建动力定位船舶的运动控制与推力分配协同数学模型;
(1)建立动力定位船舶运动非线性数学模型,具体如下:
其中,η=[x,y,ψ]T为在地球北东坐标系中描述的船位和艏向角向量;v=[u,v,r]T为在船体坐标系中描述的速度和角速度向量,τd=[X,Y,N]T为控制力和力矩向量,即推进系统提供的总的推进力和力矩,d=[d1,d2,d3]T为环境干扰力和力矩向量,R(ψ)为坐标变换矩阵,M为包括附加质量的惯性矩,N(v)为水动力阻尼及科里奥利向心力矩阵,R(ψ)定义为:
M和N(v)由船舶水动力特性决定;
(2)建立推力分配数学模型,具体如下:
τd=B(α)T(u)
其中,表示各个推进器产生的推力,为各推进器的方位角,/>为推进器的配置矩阵;
其中,(lxi,lyi)表示第i个推进器的安装位置,x表示纵轴,以船的艏向为正;y为横轴,以船的右舷方向为正;
(3)忽略外部干扰影响,根据运动非线性数学模型和推力分配数学模型构建运动控制与推力分配协同数学模型,具体如下:
其中,为状态向量,u=[ω,δ,α]T为代表推进器转速、方位角和舵角的控制输入向量,ω=[ω12,…,ωn]T为螺旋桨转速向量,δ=[δ12,…,δn]T为舵角向量,矩阵A、B定义如下:
对于DP船舶,仅船舶位置和航向可测,故输出模型为:
y=Hx
其中,H=[I3×3,03×3],y=η=[x,y,ψ]T为输出向量,表示位置和航向;
将模型离散化,可得DP船舶离散化数学模型:
x(k+1)=Ax(k)+BT(u(k))
y(k)=Hx(k)
其中,k表示当前时刻,k+1表示当前时刻出发的下一时刻,k-1表示当前时刻的前一时刻,根据数值差分原理,未来k+1时刻输出y(k+1)与当前时刻输出y(k)、之前时刻输出y(k-1)、y(k-2)及当前时刻控制输入u(k)相关,从而可得DP船舶差分数学表达模型如下:
y(k+1)=f(y(k),y(k-1),y(k-2),u(k))
其中,f(·)为非线性函数;
B.构建基于神经网络预测控制的DP船舶运动控制及推力分配协同控制策略;
(1)建立非线性在线优化目标函数及约束条件,寻找最优控制输入;
Δumin≤Δu(k+n-1)≤Δumax
umin≤u(k+n-1)≤umax
n=1,2,…,Np
其中,x(k+n)为由当前时刻k开始的未来n时刻的船舶预测状态,为由当前时刻k开始的未来n时刻船舶的预测输出,u(k+n)为由当前时刻k开始的未来n时刻船舶的控制输入(即推进器转速、舵角及方位角)状态,Δu(k+n)=u(k+n)-u(k+n-1)为由当前时刻k开始的未来n时刻的控制输入变化,即推进器转速、舵角和方位角的变化量,ω(k+n)为由当前时刻k开始的未来n时刻的推进器转速,U(k)=[u(k)T,u(k+1)T,...,u(k+Nc-1)T]T为控制时域Nc内的控制输入序列,yr(k)表示参考轨迹序列,/> 为预测时域NP中的预测输出序列,在目标函数中,第一项为预测范围内的运动轨迹控制误差,第二项代表推进器损耗,最后一项代表推进器功耗,umin,umax分别为控制输入(即推进器转速、舵角和方位角)的最小值和最大值,△umin,△umax分别为控制输入变化量的最小值和最大值,由于Nc小于NP,因此假设:当Nc≤n≤Np时,控制输入保持不变,即u(k+n)=u(k+n-1),Q、R为权重矩阵并且都是正定矩阵,/>为估计的船舶非线性模型函数,将由神经网络模型构建;
(2)基于船舶控制输入及测量输出信息,构建神经网络多步预测模型,对目标函数中的未来状态进行预测,其中,所述船舶控制输入包括转速、方位角及舵角,所述船舶测量输出包括船舶当前及历史时刻的船位和航向;
(3)利用粒子群算法对非线性在线优化目标函数进行求解,得到最优控制输入序列u*=[ω***]T,包含推进器转速ω*=[ω1*,ω2*,...,ωn*]T,舵角δ*=[δ1*,δ2*,...,δn*]T及方位角α*=[α1*,α2*,...,αn*]T,并将最优控制输入序列的第一组元素作为推进器运行参数,完成当前时刻推力分配。
2.根据权利要求1所述的融合粒子群算法与神经网络预测控制的DP船舶运动控制与推力分配协同控制方法,其特征在于,所述基于船舶控制输入及测量输出信息,构建神经网络多步预测模型,对目标函数中的未来状态进行预测,包括:
①进行船舶操纵运动试验,以特定采样时间获取船舶在各时刻的控制输入u(k)=[ω(k),δ(k),α(k)]T,及测量输出y(k)=[x(k),y(k),ψ(k)]T
②构建船舶运动神经网络模型,对目标函数中的未来状态进行单步预测;
由当前及之前时刻的船位、航向、转速与方位角构建船舶运动神经网络模型输入数据集x=[y(k-1),y(k-2),y(k-3),u(k-1)]T及输出数据集O=yT(k),船舶运动神经网络模型如下:
hk=σh(Wx,hχ+Wh,hhk-1)
其中,为模型预测输出值,/> 分别为从输入层到隐藏层和从隐藏层到隐藏层的权重矩阵,/>为隐藏层到输出层的权重矩阵,σh(·)及σy(·)分别为隐藏层和输出层激活函数,船舶运动神经网络模型可以简化为:
其中,fRNN(·)为由神经网络模型建立的输入输出间的映射关系,即船舶运动非线性模型函数,在所建立的非线性在线优化目标函数中代替用于对未来输出进行预测;
③根据递推式多步预测原理结合所述船舶运动神经网络模型得出船舶状态神经网络多步预测模型,并计算得到未来预测时域内船舶状态输出;
其中,为神经网络多步预测模型由当前时刻k开始的未来n时刻的船舶位置和艏向的预测值,u(k+n),n=0,1,…,Np-1代表由当前时刻k开始的未来n时刻的系统控制输入值。
3.根据权利要求1所述的融合粒子群算法与神经网络预测控制的DP船舶运动控制与推力分配协同控制方法,其特征在于,所述利用粒子群算法对非线性在线优化目标函数进行求解,得到最优控制输入序列u*=[ω***]T,包括:
①初始化粒子数目为N,种群规模为D,定义粒子初始位置和速度,相关定义为:以未来时域内控制输入预测序列U(k)=[u(k)T,u(k+1)T,...,u(k+Nc-1)T]T中的元素作为粒子,定义第i个粒子的位置向量 定义第i个粒子的速度向量/>第i个粒子当前最优值Pbest对应的粒子位置向量/>种群最优值即全局最优值Gbest对应的粒子位置向量/>
②选取所定义的非线性在线优化目标函数作为适应度函数,计算粒子适应度值确定个体最优位置/>和群体最优位置/>
③更新粒子速度和位置,更新公式如下:
其中,t和t+1表示当前和下一次迭代,和/>表示第i个粒子在t+1次迭代时d维上的速度和位置,/>和/>表示第i个粒子在第t次迭代时在d维上的速度和位置,为了防止粒子偏离搜索空间,设置边界条件,粒子的速度和位置在v∈[-vmax,vmax]和x∈[-xmax,xmax]内,/>表示第i个粒子在第t次迭代时在d维上搜索到的最佳位置,/>表示整个群体在第t次迭代时在d维上搜索到的最佳位置,rand1和rand2是[0,1]之间均匀分布的随机数,w为惯性权重,c1和c2分别表示个体学习因子和群体学习因子;
④更新粒子的个体最优位置和群体最优位置,迭代更新公式如下:
⑤更新惯性权重w、个体学习因子c1和群体学习因子c2,公式如下:
其中,w1为初始惯性权重,w2为最终惯性权重;c1s,c1e和c2s,c2e分别为个体学习因子c1和群体学习因子c2的初始值和终值,t为当前迭代次数,m为最大迭代次数;
⑥判断当前迭代次数是否满足终止条件,若当前迭代次数大于最大迭代次数m,则停止迭代,输出最优解即最优控制输入序列u*=[ω***]T;若当前迭代次数小于最大迭代次数m,则转入步骤②继续搜索最优解。
CN202311105923.9A 2023-08-30 2023-08-30 一种融合粒子群算法与神经网络预测控制的dp船舶运动控制与推力分配协同控制方法 Pending CN117311142A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202311105923.9A CN117311142A (zh) 2023-08-30 2023-08-30 一种融合粒子群算法与神经网络预测控制的dp船舶运动控制与推力分配协同控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202311105923.9A CN117311142A (zh) 2023-08-30 2023-08-30 一种融合粒子群算法与神经网络预测控制的dp船舶运动控制与推力分配协同控制方法

Publications (1)

Publication Number Publication Date
CN117311142A true CN117311142A (zh) 2023-12-29

Family

ID=89285594

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202311105923.9A Pending CN117311142A (zh) 2023-08-30 2023-08-30 一种融合粒子群算法与神经网络预测控制的dp船舶运动控制与推力分配协同控制方法

Country Status (1)

Country Link
CN (1) CN117311142A (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117555242A (zh) * 2024-01-12 2024-02-13 哈尔滨工程大学三亚南海创新发展基地 船舶动力定位控制方法、装置、计算机设备及存储介质
CN117634323A (zh) * 2024-01-26 2024-03-01 武汉理工大学三亚科教创新园 基于代理模型的船舶推进器优化设计方法

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117555242A (zh) * 2024-01-12 2024-02-13 哈尔滨工程大学三亚南海创新发展基地 船舶动力定位控制方法、装置、计算机设备及存储介质
CN117555242B (zh) * 2024-01-12 2024-04-23 哈尔滨工程大学三亚南海创新发展基地 船舶动力定位控制方法、装置、计算机设备及存储介质
CN117634323A (zh) * 2024-01-26 2024-03-01 武汉理工大学三亚科教创新园 基于代理模型的船舶推进器优化设计方法
CN117634323B (zh) * 2024-01-26 2024-05-14 武汉理工大学三亚科教创新园 基于代理模型的船舶推进器优化设计方法

Similar Documents

Publication Publication Date Title
CN109507885B (zh) 基于自抗扰的无模型自适应auv控制方法
CN109976349B (zh) 一种含约束无人船的路径跟踪制导与控制结构的设计方法
CN117311142A (zh) 一种融合粒子群算法与神经网络预测控制的dp船舶运动控制与推力分配协同控制方法
CN112462792B (zh) 一种基于Actor-Critic算法的水下机器人运动控制方法
CN111240344B (zh) 基于强化学习技术的自主水下机器人无模型控制方法
Zhang et al. Improved composite learning path-following control for the underactuated cable-laying ship via the double layers logical guidance
CN111240345A (zh) 一种基于双bp网络增强学习框架的水下机器人轨迹跟踪方法
CN115016496A (zh) 基于深度强化学习的水面无人艇路径跟踪方法
CN114115262B (zh) 基于方位角信息的多auv执行器饱和协同编队控制系统和方法
CN115113524B (zh) 一种基于干预lvs制导的asv多端口事件触发路径跟踪控制方法
CN111880546A (zh) 一种基于自适应动态规划算法的虚拟引导船舶自动靠泊控制方法
CN113268059A (zh) 一种基于有限时间扩张状态观测器的多无人艇编队控制方法
Li et al. Soft-switching proximate time optimal heading control for underactuated autonomous underwater vehicle
Jing et al. Self-tuning adaptive active disturbance rejection pitch control of a manta-ray-like underwater glider
Wang et al. A modified alos method of path tracking for auvs with reinforcement learning accelerated by dynamic data-driven auv model
Han et al. Straight-path following and formation control of USVs using distributed deep reinforcement learning and adaptive neural network
CN114115276A (zh) 一种基于在线分组优化模型预测的船舶动力定位控制方法
Tang et al. Robust fixed-time trajectory tracking control of the dynamic positioning ship with actuator saturation
Wang et al. Adaptive cooperative diving of saucer-type underwater gliders subject to model uncertainties and input constraints
CN115480580A (zh) 一种基于nmpc的水下机器人路径跟踪与避障的控制方法
Zang et al. Research on constraining strategies of underwater glider's trajectory under the influence of ocean currents based on dqn algorithm
Ngongi et al. Design of generalised predictive controller for dynamic positioning system of surface ships
Fang et al. Conditional Disturbance-Compensation Control for an Overactuated Manned Submersible Vehicle
Ding et al. Based on disturbance observer of Air Cushion Vehicle course sliding backstepping control
CN116880519B (zh) 一种基于滑模变结构的潜器运动控制方法

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