说明:四元数法捷联惯性导航姿态解算程序。基本的方法都有。
说明:捷联惯导解算程序,由导航数据解算载体位置与姿态信息。
说明:惯性测量组件Mti进行数据采集,利用陀螺和加速度计数据进行捷联姿态角解算,采用四元数更新算法,解算周期可调。
说明:MATLAB代码,关于四元数姿态解算本文基于该算法,分别设计了互补滤波器和Kalman滤波器——结合陀螺仪角速度的动态性能和加速度计、磁传感器的静态精度设计了互补滤波器;根据加速度计和磁传感器输出的特性设计了Kalman滤波器。通过对加速度计和磁传感器的输出进行滤波,从而减小加速度计和磁传感器测得的...
说明:四元数,欧拉角及姿态矩阵的相互转换代码,这是一个学习的很好的代码,包括轨迹发生器的模拟,惯导导航,姿态四元数的解算,及位置速度的解算,包含注释浅显易懂。