一种系泊状态下舰船的快速初始对准方法和装置

摘要

本发明实施例提供了一种系泊状态下舰船的快速初始对准方法和装置，主要步骤包括：获取舰船上的传感器的实时数据；建立初始对准参考坐标系；建立系泊状态下的改进非线性初始对准误差模型及其离散化；基于所述获取的舰船传感器实时数据进行导航解算，生成所述舰船的姿态和速度；然后采用四元数无味估计器进行滤波估计；利用所述滤波器估计的状态参数，对所述姿态和速度进行闭环反馈校正，将校正后的姿态四元数转换成姿态欧拉角实时输出，直至对准过程结束。本发明优点在于考虑了矢量投影坐标系的一致性问题，将姿态四元数误差和速度误差统一投影至计算导航坐标系中，优化了误差模型，具有缩短对准时间，提升对准精度的特点。