说明:本程序为捷联惯导的解算程序(由惯性器件的输出解算出飞行器的位置、速度、姿态信息)和GPS的卡尔曼滤波程序
说明:导航解算,主要用于姿态的求解,主要利用的是四元数方法
说明:捷联惯导解算程序,由导航数据解算载体位置与姿态信息。
说明:姿态定位完整的matlab算法,具体有讲解版,文章版权已经申请,可以传播但是请勿发表文章,违者必究
说明:MATLAB代码,关于四元数姿态解算本文基于该算法,分别设计了互补滤波器和Kalman滤波器——结合陀螺仪角速度的动态性能和加速度计、磁传感器的静态精度设计了互补滤波器;根据加速度计和磁传感器输出的特性设计了Kalman滤波器。通过对加速度计和磁传感器的输出进行滤波,从而减小加速度计和磁传感器测得的...
说明:惯性测量组件Mti进行数据采集,利用陀螺和加速度计数据进行捷联姿态角解算,采用四元数更新算法,解算周期可调。