一种分离式舵水下航行器单舵卡应急控制方法

本发明涉及水下航行器运动控制技术领域，提供一种分离式舵水下航行器单舵卡应急控制方法，包括：建立航行器的六自由度运动模型；通过对航行器六自由度运动模型进行线性化处理，获得第一航行器垂直面线性运动方程；基于第一航行器垂直面线性运动方程，采用最优控制方法进行双水平舵控制时的控制器设计，根据监测舵角、舵角指令与舵速之间的关系，设计舵卡检测算法；通过舵卡检测算法判断发生舵卡时，建立第二航行器垂直面线性运动方程；基于第二航行器垂直面线性运动方程，采用最优控制方法进行单水平舵控制时的控制器设计。本发明通过单水平舵舵卡发生后立即进行控制律重构，降低分离式舵航行器单舵卡时的失控风险，提高航行器的航行安全性。