李 娜, 王新龙
舰载武器SINS非线性传递对准模型及滤波算法
李 娜, 王新龙
(北京航空航天大学宇航学院, 北京, 100191)
为了满足舰载武器初始对准高精度和快速性的要求, 更好地解决舰载武器在大失准角情况下的传递对准问题, 提出了一种结合基于四元数的非线性传递对准模型与非线性无迹卡尔曼滤波(UKF)算法的方法, 推导并建立了舰载武器捷联惯导系统(SINS)的非线性误差模型。该模型采用姿态四元数表示姿态误差, 以提高姿态解算时的快速性和精度, 选用速度加姿态作为量测量, 以提高系统的可观测性, 采用奇异值分解(SVD)方法解决了方差阵的病态问题, 以确保算法的鲁棒性, 仿真结果表明, 该方法不仅解决了舰载武器在大失准角情况下的传递对准问题, 而且能够有效提高传递对准的精度和快速性, 其计算精度和对准时间满足系统设计要求。
舰载武器; 捷联惯导系统; 非线性; 四元数; 无迹卡尔曼滤波; 传递对准
为了提高舰载武器的快速反应能力, 对捷联惯导系统(strap-down inertial navigation system, SINS)对准的快速性和精确性提出了越来越高的要求。传递对准是解决SINS动基座对准问题的主要方法。它是通过引入高精度的主惯导信息, 以此为基准运用卡尔曼滤波器来估计子惯导系统的速度误差、姿态误差和惯性器件误差等状态变量的值, 从而对子惯导信息进行补偿。
由于舰载武器的多样化以及低成本、小型化惯性器件的飞速发展, 在舰载武器传递对准过程中, 子惯导系统惯性器件的精度较低, 这会导致惯导计算产生较大的误差, 并且主、子惯导之间的安装误差、杆臂效应、弹性变形等因素的影响也会产生较大的姿态误差, 从而影响传递对准的精度。……