一种基于滤波的超短基线安装误差在线标定方法

摘要

本发明公开了一种基于滤波的超短基线安装误差在线标定方法，步骤为：1、建立安装角误差以及杆臂误差的状态模型；2、结合RTK、姿态测量传感器的数据，以及超短基线的输出原始数据，建立系统的观测模型；3、通过状态模型与观测模型，对船体在水面的航行轨迹下进行误差状态的可观性分析，确保当前运动轨迹能够充分激励出误差状态；4、用卡尔曼滤波方程对误差进行实时的在线估计安装误差；5、将得到的在线估计结果用来补偿超短基线对水下潜航器的定位误差，提高超短基线定位精度。本发明的有益效果为：基于滤波的方法可以同时在线的估计出USBL与船体之间的安装误差，方法易于实施。