论文部分内容阅读
为解决现有的MEMS传感组件精度低、误差大和磁传感器测量的航向角数据噪声大、精度低等问题,提出基于互补-粒子滤波的姿态融合解算方法。先用互补滤波算法结合加速计和磁力计对陀螺仪的姿态角进行修正,再采用四元素法对陀螺仪数据进行粒子滤波。仿真实验结果证明:该算法能快速解算出姿态角,提高解算精度。