卡尔曼滤波在捷连惯导中的完美应用; 同时也应用了四元数方法。