应用科学学报

• Papers • 上一篇    下一篇

基于故障检测的惯性航姿系统内阻尼姿态组合算法

祝燕华;刘建业;曾庆化   

  1. 南京航空航天大学 导航研究中心,江苏 南京 210016
  • 收稿日期:1900-01-01 修回日期:1900-01-01 出版日期:2007-03-20 发布日期:2007-03-20

Combined Algorithm for Damping Attitude of Inertial Attitude and Head Reference System Based on Fault Detection

ZHU Yan hua;LIU Jian ye;ZENG Qing hua   

  1. Navigation Research Center, Nanjing University of Aeronautics and Astronautics, Nanjing 210016, China
  • Received:1900-01-01 Revised:1900-01-01 Online:2007-03-20 Published:2007-03-20

摘要: 在平台式惯导系统中可通过阻尼网络来阻尼系统的振荡误差,而在捷联惯性航姿系统中也可以借鉴这个思想,通过加速度计的信息对陀螺漂移进行修正.文中提出了分别利用陀螺仪和加速度计来解算载体姿态,然后通过卡尔曼滤波器进行数据融合的方法.由于加速度计信息进行阻尼的方法只有在系统处于非加速度运动状态才可用,因此,本文将故障检测理论中的残差χ 2检验法应用在卡尔曼滤波器中,进行运动状态的实时判断,并根据判断结果进行相应的处理.此外,算法中还考虑到传感器测量野值带来的影响,提高了算法的容错性能和灵敏度.最后,采用实际系统的动静态试验验证了本算法的有效性.

关键词: 捷联航姿系统, 内阻尼, 卡尔曼滤波, 故障检测, 残差, 野值

Abstract:

In a platform inertial navigation system, damping network is applied to damp the gyro’s drift. For strap down inertial attitude and heading reference system (SIAHRS), gyro’s drift error can also be suppressed by the information from accelerometers. This paper proposes the idea of calculating vehicle attitude by both gyros and accelerometers, and designs a damping Kalman filter to integrate this information. However, only when the vehicle was moving without acceleration can one use the output of accelerometers to calculate its attitude. For this reason, the residual chi square test is employed in the Kalman filter to detect vehicle movement in real time. Besides, effects of outliers from measuring sensors are also considered in order to enhance system’s fault tolerant ability and sensitivity. Results of static and dynamic experiments are carried out.

Key words: SIAHRS, damp, outlier, Kalman filter, fault detection, residual