基于融合滤波的MEMS动态倾角仪算法设计

倾角仪是测量物体水平倾角的仪器,在测绘仪器、天线定位、平台控制、海上平台监控等方面有着广泛的应用。基于以MEMS陀螺仪和加速度计为核心传感器、STM32H743为核心控制器的高精度动态倾角传感器,针对加速度计受线加速度影响不适合跟踪动态角运动、陀螺仪受漂移影响存在误差累计的问题,设计了一种融合滤波算法,采用零速修正和姿态自观测方法建立扩展卡尔曼滤波模型,通过反馈矫正将陀螺仪和加速度计输出数据进行融合滤波,去除加速度计受动态环境产生的干扰误差和陀螺仪产生的累计漂移误差,得到高精度载体水平姿态信息。使用大理石平板及三轴转台分别进行静态及动态试验验证,测量过程中动态倾角仪通过RS422串口及CAN总线将仪表原始信息及姿态解算信息传输给地面采集设备,实现对载体姿态的连续、实时计算和显示。经试验验证,该算法能够有效提高系统倾角跟踪精度,测量精度优于0.008°(1σ)。