一种非鱼雷头型航行体自适应鲁棒控制方法

    公开(公告)号:CN114839877A

    公开(公告)日:2022-08-02

    申请号:CN202210469813.X

    申请日:2022-04-28

    Abstract: 本发明公开了一种非鱼雷头型航行体自适应鲁棒控制方法,包括:S1.非鱼雷头型航行体的六自由度运动模型进行解耦得到非线性模型;S2.根据非线性模型获取控制输入深度yi,计算yi与参考深度yr之间的深度偏差yerror,根据yerror计算俯仰角控制指令θ,用θ来实时更新俯仰角参考指令θr;S3.根据更新后的θ实时获取俯仰角综合跟踪误差sθ;根据sθ获取航行体的控制输入水平舵角δe;S4.通过δe对非鱼雷头型航行体的当前纵向平面运动进行实时控制,并实时获取下一个控制输入深度用于更新S2中的yi,直至非鱼雷头型航行体稳定在目标深度。本发明的控制方法稳定性高且收敛速度快。

    一种航行体高速入水时防护尾罩分离时序控制方法

    公开(公告)号:CN114839988A

    公开(公告)日:2022-08-02

    申请号:CN202210469213.3

    申请日:2022-04-28

    Abstract: 本发明公开了一种航行体高速入水时防护尾罩分离时序控制方法,包括:根据初始发射速度,实时获取航行体的姿态信息、自身速度和位置;当航行体加速度计轴向加速度突增时,确定为航行体头部入水,记录入水时刻T0;当入水时刻T0延时t1后,且自身速度数值达到预设速度V1时,通过直流脉冲电信号引爆爆炸螺栓,实施防护尾罩的分离动作;当入水时刻T0延时t2后,且自身速度数值达到预设速度V2时,启动舵机,控制执行机构对航行体姿态进行调节;当入水时刻T0延时t3后,且自身速度数值达到预设速度V3时,启动电机,对航行体执行航行任务。本发明能够提高防护尾罩的分离速度,并增加分离可靠性。

    一种航行体高速入水时防护尾罩分离时序控制方法

    公开(公告)号:CN114839988B

    公开(公告)日:2023-05-26

    申请号:CN202210469213.3

    申请日:2022-04-28

    Abstract: 本发明公开了一种航行体高速入水时防护尾罩分离时序控制方法,包括:根据初始发射速度,实时获取航行体的姿态信息、自身速度和位置;当航行体加速度计轴向加速度突增时,确定为航行体头部入水,记录入水时刻T0;当入水时刻T0延时t1后,且自身速度数值达到预设速度V1时,通过直流脉冲电信号引爆爆炸螺栓,实施防护尾罩的分离动作;当入水时刻T0延时t2后,且自身速度数值达到预设速度V2时,启动舵机,控制执行机构对航行体姿态进行调节;当入水时刻T0延时t3后,且自身速度数值达到预设速度V3时,启动电机,对航行体执行航行任务。本发明能够提高防护尾罩的分离速度,并增加分离可靠性。

Patent Agency Ranking