说明:基于四元数法的捷联惯导系统仿真,陀螺仪和加速度计数据为自己仿的一分钟数据
说明:基于四元数法的捷联惯导系统仿真,陀螺仪和加速度计数据为自己仿的一分钟数据。
说明:惯性测量组件Mti进行数据采集,利用陀螺和加速度计数据进行捷联姿态角解算,采用四元数更新算法,解算周期可调。
说明:MATLAB代码,关于四元数姿态解算本文基于该算法,分别设计了互补滤波器和Kalman滤波器——结合陀螺仪角速度的动态性能和加速度计、磁传感器的静态精度设计了互补滤波器;根据加速度计和磁传感器输出的特性设计了Kalman滤波器。通过对加速度计和磁传感器的输出进行滤波,从而减小加速度计和磁传感器测得的...