这是研究惯性导航的最好代码。记得自己添加测试数据。此为基于四元素法，角增量法的捷连惯导系统程序算法，飞行器飞行过程中飞行高度不变， 航向角以逆时针为正。以地理系为导航坐标系 ，运行程序时需导入比力信息及陀螺议角速率信息。