俯仰/滚转耦合的大角度姿态测量算法

作者:谭强俊; 程永生; 唐彬; 刘显学; 周浩; 李寅鑫
来源:太赫兹科学与电子信息学报, 2022, 20(09): 946-952.

摘要

基于加速度计或陀螺仪的测姿方法均存在大角度条件下姿态角误差放大、突变问题。对大俯仰角测量,通过预置欧拉旋转法可确定冗余加速度计的布置方式,降低了俯仰角测量误差。对大俯仰角条件下的滚转角测量,提出基于角速率阈值判定的陀螺解耦测姿算法。当俯仰角速率大于设定阈值时,采用角速度投影可钳制滚转角误差的漂移;当俯仰角速率小于设定阈值时,采用角速度积分可避免角速度投影造成的姿态误差放大。通过理论推导、分析和仿真,预置欧拉旋转法能有效避免大俯仰角条件下俯仰角姿态误差放大,陀螺解耦测姿算法能在振荡环境下长时间保持滚转角精确度。

  • 单位
    中国工程物理研究院电子工程研究所