一种载体大机动情况下的DVL辅助SINS粗对准方法

摘要

本发明公开了一种载体大机动情况下的DVL辅助SINS粗对准方法，包括：首先初始化转换矩阵和姿态矩阵为单位阵；其次，根据上一时刻对准输出的姿态矩阵更新速度微分方程；然后，在DVL发射t1时刻初始化为单位阵，并记录SINS输出的载体速度信息；在DVL接收t2时刻更新矩阵，并记录SINS输出的载体速度信息，以校正DVL测速信息；再采用校正后的DVL测速信息与SINS输出信息构建参考与观测矢量，根据最优基四元数法计算初始姿态矩阵，更新当前姿态信息；最后，重复步骤S2到S5直至对准过程结束。本发明能有效地提高SINS/DVL组合导航系统在大机动情况下粗对准的收敛速度与精度。