一种多时间尺度融合的视觉辅助惯性定姿算法

针对基于微机电系统的惯性传感器中,陀螺仪在姿态解算过程中存在误差累积的问题,提出一种多时间尺度融合的视觉辅助惯性定姿算法。利用视觉传感器在不同时间尺度的角度变化量,不断修正并更新惯性器件的角度累积误差,对姿态角进行多次校正,进而输出较高精度的姿态角。实验结果表明,采用多时间尺度融合的视觉辅助惯性定姿算法,相对于单时间尺度的融合算法,航向角误差降低了27%,俯仰角误差降低了23%,横滚角误差降低了63%,角度误差能够保持在2°以内,满足定姿定位的需求。