一种DVL辅助SINS鲁棒行进间初始对准方法
Abstract:
本发明公开了一种DVL辅助SINS鲁棒行进间初始对准方法,包括以下步骤,步骤(1):获取传感器实时数据;步骤(2):建立矢量视运动参数方程;步骤(3):在建立参数方程的基础上,利用自适应鲁棒卡尔曼滤波估计参数矩阵;步骤(4):建立基于估计参数的重构矢量;步骤(5):利用最优基四元数姿态确定方法,并计算确定姿态与真实姿态之间的误差角;步骤(6):初始对准过程运行时间为M,获取实时数据的时刻为k,若k=M,则输出初始对准结果,完成初始对准过程,若k
Public/Granted literature
Patent Agency Ranking
0/0