论文部分内容阅读
矢量水听器姿态校正的通常做法是将姿态测量系统捷联安装在声纳平台上,这种方案无法准确测量矢量水听器的姿态变化。针对这个问题,设计了一种微型姿态测量系统,并将其捷联封装在矢量水听器内部。系统采用MEMS陀螺测量角速度,用毕卡迭代算法解四元数姿态更新方程。用MEMS加速度计和磁力计分别测量重力方向和磁北方向,再使用扩展卡尔曼滤波对解算姿态角进行实时校正。经测试,该系统横滚角和俯仰角的静态误差小于0.2°,航向角的静态误差小于0.8°。摇摆实验中,横滚角和俯仰角的动态相对误差小于2.9%,航向