四元数姿态结算

代码说明：

MATLAB代码，关于四元数姿态解算本文基于该算法，分别设计了互补滤波器和Kalman滤波器——结合陀螺仪角速度的动态性能和加速度计、磁传感器的静态精度设计了互补滤波器；根据加速度计和磁传感器输出的特性设计了Kalman滤波器。通过对加速度计和磁传感器的输出进行滤波，从而减小加速度计和磁传感器测得的重力场和地磁场的误差，提高该算法解算的姿态角精度。