一种基于多模态自适应抗扰的喷泵船舶航速航向控制方法与流程

摘要: 本发明涉及船舶动力与运动控制,尤其涉及一种基于多模态自适应抗扰的喷泵船舶航速航向控制方法。背景技术:1、喷水推进船舶依靠喷泵喷射水流的反作用力获取推力,具有浅水...
一种基于多模态自适应抗扰的喷泵船舶航速航向控制方法与流程

本发明涉及船舶动力与运动控制,尤其涉及一种基于多模态自适应抗扰的喷泵船舶航速航向控制方法。

背景技术:

1、喷水推进船舶依靠喷泵喷射水流的反作用力获取推力,具有浅水通行性佳、操纵灵活、高速航行性能优良等特点,广泛应用于内河巡检、近海作业等场景。但喷水推进系统存在显著的固有非线性:喷泵转速设有怠速死区,低转速区间难以输出有效推力,推力输出断续;推进动力由泵体转速与倒斗摆角耦合决定,单一转速调节无法满足全工况推力需求;且正航与倒航舵效相反,倒航及低微速正航阶段舵效大幅下降,航速航向控制呈现强非线性、多扰动耦合特征。

2、针对喷水推进装置推力由转速、舵角、倒斗角共同决定的特性,公开号为cn115268459a 的中国发明专利公开了一种基于双喷水推进器无人艇自主靠泊控制方法,其按艏向、横向、纵向三个控制层分别采用pid算法解算平移与转向指令,再由动力分配算法利用左右两台喷泵的转舵、倒斗与转速合成矢量推力与转向力矩,并预先标定前进、倒退、右平移、左平移四个方向的矢量控制组合,其余方向由该四个方向线性化得到,最后由无模型自适应控制算法在标定组合基础上作小范围调整。该方案的控制效果对预先标定的矢量组合依赖较强,标定工作量大且难以适应变航速、变海况工况,亦未涉及怠速死区、倒车推力损耗等推进非线性缺陷的补偿与控制器参数的在线自整定。

3、自抗扰控制adrc算法,无需依赖精准数学模型,具备优异的扰动观测与补偿能力,现已逐步应用于船舶运动控制。但现有船舶adrc 控制方案仍存在多处短板:

4、(1)控制增益多采用离线固定参数,无法根据航行偏差、执行器工作状态动态调整,大偏差纠偏迟缓、稳态易产生小幅震荡,多工况适配性差;

5、(2)缺少工况模态划分逻辑,未区分大偏差、收敛过渡、稳态抗扰、执行器饱和四类工作状态,控制策略无法匹配阶段性控制需求;

6、(3)航速控制仅调节泵转速,未结合倒斗角协同调控,难以消除怠速死区、倒车推力损耗带来的控制断续问题;

7、(4)未针对性设计正负航速舵效修正机制,倒航时航向控制极易出现航向偏移失控现象。

技术实现思路

1、本发明旨在解决喷水推进船舶航向控制参数固定、工况适配性差、稳态易抖、大偏差收敛慢的问题。为此,本发明提供一种基于多模态自适应抗扰的喷泵船舶航速航向控制方法,可实现船舶大偏差快速纠偏、小误差平稳收敛、稳态高精度抗扰、执行器饱和安全保护的全工况自适应控制,大幅提升喷泵船舶在复杂水域、多航行工况下的操控稳定性与鲁棒性,并可有效应对喷泵转速死区、执行器饱和约束、风浪环境扰动、低速舵效衰减、正负航速舵效反向等工程问题,提升船舶跟踪精度、运行稳定性与工况适配能力。适用于各类中小型喷水推进船舶的航向、航速控制场景。

2、本发明提供一种基于多模态自适应抗扰的喷泵船舶航速航向控制方法,采用的技术方案如下:包括:

3、采集喷泵船舶的航速、航向、角速度;

4、将航速、航向、角速度输入双通道线性扩张状态观测器,计算得到估计值;

5、根据估计值,利用自抗扰控制律,计算得到原始转速指令和舵角指令;

6、根据舵角指令和艏向误差判定船舶受控模态,并更新自抗扰控制律的艏向角速度阻尼增益和艏向比例增益;具体为:

7、时,判定为舵角饱和保护模态,;

8、且时,判定为大偏差快速纠偏模态,;

9、且时,判定为小误差平滑收敛模态,;

10、且时,判定为稳态高精度抗扰模态,;

11、其中,为舵饱和度,,为最大舵角,为舵角指令,为艏向误差,为艏向角速度阻尼增益,为艏向比例增益,为艏向大误差阈值,为艏向稳态阈值,为舵饱和阈值,为艏向角速度阻尼增益最小值,为艏向角速度阻尼增益最大值,为艏向比例增益最小值,为艏向比例增益基础值,为艏向比例增益最大值;

12、利用舵角指令对原始转速指令进行补偿,再计算得到转速指令、倒斗指令;

13、根据转速指令、倒斗指令和舵角指令,进行喷泵船舶航速航向控制。

14、进一步的,更新的自抗扰控制律的艏向角速度阻尼增益和艏向比例增益,用于下一控制周期时,利用自抗扰控制律计算原始转速指令和舵角指令。

15、进一步的,舵角饱和保护模态的控制逻辑:舵角接近极限行程,执行器无调节余量,强制艏向比例增益至基础值、拉满艏向角速度阻尼增益,抑制极限震荡;

16、大偏差快速纠偏模态的控制逻辑:快速纠偏,最大化艏向比例增益、最小化艏向角速度阻尼增益,弱化阻尼约束,最大化提升动态响应速度,缩短大偏差调节时间;

17、小误差平滑收敛模态的控制逻辑:兼顾快速性与平稳性,艏向比例增益随误差减小线性平滑衰减,艏向角速度阻尼增益随误差减小反向递增,参数连续过渡,实现平稳收敛;

18、稳态高精度抗扰模态的控制逻辑:抗扰稳姿,采用最小艏向比例增益、最大艏向角速度阻尼增益,弱化高频噪声与小幅风浪扰动响应,消除船体小幅摇头、舵机频繁微调问题。

19、进一步的,自抗扰控制律中,

20、推力指令的计算公式为:

21、

22、其中,为纵向控制增益系数,为船舶纵荡航速估计值,为航速控制增益,为航速指令,为的一阶导数,为纵向总扰动估计值;

23、根据计算得到原始转速指令;

24、舵角指令的计算公式为:

25、

26、其中,为艏向控制增益,为艏向指令,为的二阶导数,为的一阶导数,为艏向角速度阻尼增益,为艏向比例增益,为航向角估计值,为艏向角速度估计值,为艏向总扰动估计值;

27、估计值包括、、、和。

28、进一步的,原始转速指令的计算公式为:。

29、进一步的,双通道线性扩张状态观测器包括航速通道线性扩张状态观测器和艏向通道线性扩张状态观测器;

30、航速通道线性扩张状态观测器的观测方程为:

31、

32、其中,为的一阶导数,为的一阶导数,为航速估计值,为航速观测器带宽,为纵向控制增益系数,为推力项,为船舶纵荡航速;

33、艏向通道线性扩张状态观测器的观测方程为:

34、

35、其中,为艏向观测器带宽,为喷泵舵角,为船舶艏向,为的一阶导数,为的一阶导数,为的一阶导数。

36、进一步的,利用舵角指令对原始转速指令进行补偿,计算公式为:

37、

38、其中,为舵角补偿后的原始转速指令,为原始转速指令,为最大舵角,为舵角指令,为舵偏补偿系数。

39、进一步的,转速指令计算公式为:

40、

41、其中,为最终输出的转速指令,为舵角补偿后的原始转速指令,为转速最大值,为转速怠速值,为倒斗下放造成的转速损失系数。

42、进一步的,倒斗指令计算公式为:

43、

44、其中,为最终输出的倒斗指令,为喷水推进器零推力对应倒斗角。

45、进一步的,艏向误差为艏向指令与船舶艏向的差。

46、本发明实施例中的上述一个或多个技术方案,至少具有如下技术效果之一:

47、(1)本发明依据舵角饱和度与艏向误差将艏向通道划分为舵角饱和保护、大偏差快速纠偏、小误差平滑收敛、稳态高精度抗扰四类完全互斥的控制模态,判定唯一工作模态并逐周期在线整定艏向比例增益与角速度阻尼增益,兼顾大偏差快速纠偏、过渡过程平稳收敛、稳态抗扰稳向、极限工况安全保护多重需求,克服固定增益难以兼顾动态响应与稳态性能的缺陷,显著拓宽工况与海况适应范围。

48、(2)本发明针对航速运动特性设计一阶线性扩张状态观测器,针对艏向转动特性设计二阶线性扩张状态观测器,同步观测系统状态量与综合扰动,在线补偿未建模动态、航速—艏向通道耦合及外部风浪水流干扰;观测器仅需整定观测器带宽,运算量小、实时性好,可有效提升复杂环境下航速、航向的跟踪精度与运行平稳性。

49、(3)本发明以舵角指令对原始转速指令进行舵偏补偿,抵消打舵造成的有效纵向推力下降;再按正向饱和、高正向、怠速正向过渡、怠速倒车过渡、低速倒车、倒车饱和六个区间分段联动输出转速指令与倒斗指令,使怠速死区内微推力连续可调、倒车推力损耗自动补偿、正倒推力切换平滑无顿挫,低速操控品质与推力输出连续性显著提升。

50、(4)本发明通过倒航舵效折损系数对艏向控制增益进行正负航速舵效符号修正,并增设低速舵效下限保护与执行器限幅约束,消除低微速控向失效与倒车航向反转隐患,保证变航速、变海况条件下航向控制的可靠性与航行安全。

51、(5)本发明通过航速通道与艏向通道解耦设计,控制律、扩张状态观测器与自整定逻辑分层明确,待调参数物理意义清晰且无需精确的船舶水动力模型,便于实船标定与调试,可快速移植至各类喷泵船舶的航速航向控制系统。

52、本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。