三轴矢量数据融合的视觉跟踪惯性稳定系统设计

摘要

针对三轴视觉跟踪姿态角稳定精度不高的问题,采用基于四元数的卡尔曼滤波器算法把三轴陀螺、加速度计、磁极三个不相干的三维矢量进行数据融合。通过三轴实验平台进行测试,该系统的动态测量精度范围小于±2°,并且算法运行速度快、精度高、性能稳定,达到了设计要求。