苑艳华,李四海,南 江
(西北工业大学自动化学院,西安 710129)
捷联航姿系统是一种自主式低成本的航向姿态测量系统,此外还可以提供载体的角速率和加速度信息,有着广泛的应用前景。但由于低精度航姿系统陀螺精度较低,漂移较大,载体长时间机动时不能保证要求的姿态精度。采用低精度的捷联航姿系统与GPS卫星定位系统实现组合,是解决长时间飞行过程中姿态测量问题的良好途径[1],但是从军事应用的角度考虑,GPS信号并不可靠,因此必须解决辅助导航系统不可用或大部分不可用时,如何利用捷联航姿系统本身的信息来提高精度,以满足长时间飞行对航姿系统的姿态要求。目前这方面的研究较少[2-5],由于航姿系统通常没有当地经纬度等初始位置信息的输入且没有位置信息和速度信息的解算,通常采用的导航算法已不再适用[6-7]。
本文设计了一种基于卡尔曼滤波技术的姿态算法,用重力加速度在机体系的分量gb和陀螺漂移作为待估计的状态量,在滤波周期内,利用基于角运动信息的状态方程进行卡尔曼滤波的时间更新过程,同时运用系统自身信息对载体飞行状态进行判别,在非机动时利用基于比力信息的量测方程进行卡尔曼滤波的量测更新过程,去修正由低精度的陀螺漂移造成的姿态误差,仿真结果表明:此算法可长时间输出较高精度的姿态信息。
捷联航姿系统由低精度光纤陀螺或MEMS陀螺、加速度计、磁传感器和信息处理电路组成[8]。……