一种地效翼船航行状态监测及自适应控制方法与流程

摘要: 本发明涉及地效翼船智能控制,具体为一种地效翼船航行状态监测及自适应控制方法。背景技术:1、地效翼船是一种利用地面效应原理在水面上方极低高度贴近水面飞行的高速运载...
一种地效翼船航行状态监测及自适应控制方法与流程

本发明涉及地效翼船智能控制,具体为一种地效翼船航行状态监测及自适应控制方法。

背景技术:

1、地效翼船是一种利用地面效应原理在水面上方极低高度贴近水面飞行的高速运载工具,其航速可达常规船舶的数倍至十余倍。由于地效翼船在起降和巡航阶段飞行高度极低,且海面存在波浪、侧风等动态扰动,其航行姿态的稳定控制是保障安全运行的核心挑战。

2、地效翼船在低空掠海飞行时,气动特性受飞行高度和海况影响极大,地效增量随高度变化呈现强非线性,传统固定增益控制器难以在整个飞行包线内保持良好的控制性能。此外,地效翼船存在水面航行、起降过渡、地效巡航、越障飞行等多种航行模式,不同模式的动力学特性和控制需求差异显著,且起降阶段气动舵面效率不足,航向控制能力受限。同时,地效翼船的航行安全严重依赖于对翼尖离水高度、姿态角速率等关键参数的实时监控,现有技术尚未充分构建完整的航行包线监控和分级预警体系。

3、因此我们提出了一种地效翼船航行状态监测及自适应控制方法来解决上述问题。

技术实现思路

1、(一)解决的技术问题

2、针对现有技术的不足,本发明提供了一种地效翼船航行状态监测及自适应控制方法,解决了上述背景技术中所提出现有技术中针对地效翼船的航行状态监测与自适应控制方法在参数估计精度、多模式平滑切换、全包线增稳控制以及安全预警体系方面仍存在不足,难以满足复杂海况下高可靠性和高安全性的运行需求的问题。

3、(二)技术方案

4、本发明为了实现上述目的具体采用以下技术方案:

5、一种地效翼船航行状态监测及自适应控制方法,包括以下步骤:

6、步骤s1:数据采集,采集地效翼船的多维度航行状态数据。

7、具体地,通过分布于地效翼船左翼尖、右翼尖、艏部、中部及尾部的水面距离监测传感器,测量各监测点的离水高度;通过安装于地效翼船中部的姿态传感器,测量横摇角、纵摇角、艏摇角及其角速度和角加速度;通过北斗/gps接收机,测量经纬度位置、对地航向、对地航速和卫星高度;通过推进动力监测传感器,测量推进动力设备的功率和转速;通过姿态控制设备监测传感器,测量舵面位置和驱动电流;通过驾驶设备监测传感器,测量驾驶盘角度、油门杆位置和脚踏板角度;通过流速/风速仪,测量水流流速、流向、空速和风向。

8、步骤s2:多源数据融合,对步骤s1采集的多源传感器数据进行融合处理,输出融合后的航行状态参数。

9、具体地,采用扩展卡尔曼滤波算法,以包含姿态角、角速度和重心离水高度的状态向量,以及包含各监测点离水高度和卫星高度的观测向量,建立状态方程和观测方程,输出融合后的航行状态参数;同时,将所述水面距离监测传感器的多点测量值与根据姿态角推算的理论离水高度进行一致性校验;若任一传感器的测量值与理论值的偏差超出预设偏差阈值,则判定该传感器数据异常,将其从融合计算中隔离,并利用剩余传感器数据完成状态估计。

10、步骤s3:航行模式识别与切换,根据步骤s2融合后的航行状态参数,将地效翼船的航行状态识别为水面航行模式、起降过渡模式、地效巡航模式和越障飞行模式中的一种,并在不同航行模式间执行平滑切换控制。

11、具体识别逻辑为:设定第一速度阈值、第二速度阈值、第一高度阈值、地效飞行高度区间和翼尖安全高度阈值;当对地航速低于第一速度阈值且各监测点离水高度均低于第一高度阈值时,识别为水面航行模式;当对地航速介于第一速度阈值与第二速度阈值之间,且离水高度持续增大时,识别为起降过渡模式;当各监测点离水高度均位于地效飞行高度区间内,且翼尖离水高度不低于翼尖安全高度阈值时,识别为地效巡航模式;当任一监测点离水高度超出地效飞行高度区间上限时,识别为越障飞行模式。

12、模式间切换时,对控制指令施以一阶惯性滤波处理,以抑制指令突变,实现平滑过渡。

13、步骤s4:分层控制,采用包括制导与导航控制层、增稳控制层和执行机构控制层的三层控制架构对地效翼船进行控制。

14、所述制导与导航控制层根据预设航线、当前位置和航行状态参数,生成期望航向、期望航速和期望高度指令。

15、所述增稳控制层基于当前航行状态采用自适应增稳算法进行姿态增稳,并引入发动机差动控制逻辑以在起降阶段提供航向修正力矩。

16、所述自适应增稳算法包括:以当前飞行高度和空速为调度变量,从预存的地效翼船气动数据库中插值获取俯仰通道和横滚通道的增稳增益;通过俯仰增稳回路根据纵摇角偏差和俯仰角速率生成升降舵偏角增量,通过横滚增稳回路根据横摇角偏差和横滚角速率生成副翼偏角增量。

17、所述发动机差动控制逻辑包括:当空速低于舵面有效速度阈值时,激活发动机差动控制;计算航向偏差,并根据所述航向偏差按比例确定左右发动机的油门指令差;当航向偏差大于第一偏差阈值时,优先通过发动机差动控制进行航向修正;当航向偏差小于或等于第一偏差阈值时,优先通过方向舵进行航向修正。

18、所述执行机构控制层将增稳控制层输出的控制指令转换为各执行机构的驱动信号,所述执行机构包括升降舵、副翼、方向舵、襟翼、减摇鳍和发动机油门。

19、步骤s5:安全监控与预警,实时监测地效翼船的航行包线参数,当任一航行包线参数超出预设安全阈值时,发出预警信号并根据超限程度执行降级控制策略。

20、预设的航行包线参数包含最大允许横摇角、最大允许纵摇角、翼尖最小离水高度、最大允许横摇角速度和最大允许风速。

21、当任一航行包线参数超过其对应安全阈值的80%但未超过该安全阈值时,发出一级预警;当任一航行包线参数超过其对应安全阈值时,发出二级预警,并自动执行降级控制策略,所述降级控制策略包括降低期望航速和/或增大期望飞行高度。

22、步骤s6:航行数据记录,将步骤s1采集的原始数据、步骤s2融合后的航行状态参数、步骤s3识别的航行模式、步骤s4生成的控制指令以及步骤s5的预警信息,以预设频率同步存储至本地存储器和黑匣子模块。

23、步骤s7:远程监控,通过无线通信链路将航行状态参数实时上传至地面监控站,并接收地面监控站下发的远程控制指令;在本地控制系统与地面监控站之间建立优先级仲裁机制,使得地面指令优先级高于本地自动指令但低于本地驾驶员人工指令,并在通信中断超过预设时长时自动切换至全自主控制模式。

24、步骤s8:反馈至步骤s1,将步骤s5安全监控与预警步骤和/或步骤s4分层控制步骤产生的控制结果反馈至步骤s1数据采集步骤,以更新数据采集状态,形成闭环航行状态监测与控制。

25、(三)有益效果

26、与现有技术相比,本发明提供了一种地效翼船航行状态监测及自适应控制方法,具备以下有益效果:

27、本发明,通过执行步骤s1、数据采集步骤与步骤s2、多源数据融合步骤,采用扩展卡尔曼滤波融合多源传感器数据并结合交叉校验,提升了航行状态参数的估计精度与容错能力;通过执行步骤s3、航行模式识别与切换步骤,将航行状态自动识别为四种模式并执行平滑切换,解决了多模式过渡的控制难题;通过执行步骤s4、分层控制步骤,采用增益调度自适应增稳算法克服地效增量非线性影响,并引入发动机差动控制补充起降阶段航向力矩,提高了姿态稳定性与操纵安全性;通过执行步骤s5、安全监控与预警步骤,构建分级预警与自动降级控制体系,实现了从预警到保护的完整安全闭环。