基于激光标靶和捷联惯导系统组合位姿测量方法

为解决6D激光标靶在受非引力外力作用的环境下姿态测量失效的问题,提出了一种基于激光标靶和捷联惯导系统(SINS)的组合位姿测量方法。通过推导卡尔曼滤波状态方程与观测方程,建立组合测量系统的卡尔曼滤波模型,利用卡尔曼滤波校正位姿误差和惯性测量单元(IMU)随机误差。在卡尔曼滤波模型中加入故障检测方法,使组合系统具有自监控功能。当激光标靶姿态失效时,仅使用校正后的SINS数据,保证系统的可靠性。最后,对所提方法进行仿真验证。仿真结果表明,该方法能有效地解决激光标靶姿态角测量失效问题,提高系统抗干扰性和动态性能。