基于四元数法的捷联式惯性导航系统的姿态解算论文