基于IMM-UKF的惯性/超短基线多参数标定方法

摘要

本发明公开了一种基于IMM‑UKF的惯性/超短基线多参数标定方法，具体步骤包括：以空间任意点为原点建立投影坐标系，在此基础上建立惯性、超短基线、卫星定位、深度计各传感器位置、姿态间的矢量关系及方位表达，选定9维待估计参数为状态量，构建系统与观测模型；设置IMM中各模型初始概率并计算各滤波器初始状态及协方差矩阵；根据系统及观测模型采用三个UKF分别进行滤波，并用贝叶斯假设检验方法模型更新；根据权重输出交互，输出最终滤波结果。与现有惯性/超短基线标定方法相比，本发明能实现应答器位置、惯性/超短基线杆臂和安装误差角9维参数的同时标定，有效提高复杂环境下惯性/超短基线标定参数的收敛速度、精度及鲁棒性。