本项目实现了一个完整的捷联惯性导航系统(SINS)解算算法,专门用于处理指北方位系统下的数据流。其核心功能是接收高频采样的加速度计比力信息和陀螺仪角速率信息,在给定的初始条件下进行导航解算。系统集成了高精度的姿态、速度和位置更新算法,特别针对指北方位系统进行了机械编排设计。
系统实现了复杂的重力模型计算,通过输入的重力加速度计算公式,动态调整随高度h和纬度变化的重力影响。在姿态结算中,算法能够处理俯仰、横滚和航向(逆时针为正)三个自由度的变换,并实时更新载体的坐标转换矩阵。对于采集到的600秒时长、80H