摘要
在组合测姿系统中,应用MEMS陀螺仪进行载体姿态角度测量时,陀螺测量误差将导致角度发散,为此,结合各传感器的测量特性,提出一种基于模糊卡尔曼算法的姿态误差补偿方法,对MEMS陀螺仪姿态解算进行补偿。首先通过模糊推理规则对陀螺测量误差进行实时补偿,然后结合卡尔曼滤波算法对姿态状态量进行实时校正,解决了因陀螺测量误差导致的滤波发散问题。实验结果表明:模糊卡尔曼滤波算法与常规卡尔曼滤波算法相比,姿态解算精度更高,验证了基于模糊推理的卡尔曼滤波数据融合算法的可行性。
In the combined attitude measurement system,the MEMS gyroscope is used to measure the attitude angle of the carrier.For the consideration of angle divergence due to the introduction of gyroscope measurement error,this paper proposed an attitude error compensation method based on fuzzy Kalman algorithm,which combined with the sensor measuring characteristics,realizing the compensation of the MEMS gyroscope attitude solution error.Firstly,the method compensated gyroscope measurement error by fuzzy inference rules in real time.Then it combined with Kalman filter algorithm to realize the real-time correction of the attitude state quantity,and solve the problem of filter divergence caused by gyroscope measurement error.Experimental results show that fuzzy Kalman filter algorithm has higher accuracy of attitude calculation than conventional Kalman filter algorithm,and verify the feasibility of Kalman filter data fusion algorithm based on fuzzy inference.
引文
[1]黄卫权,董冀.基于MTi微惯性航姿系统的卡尔曼滤波器设计[J].自动化技术与应用,2009,28(1):54-57.
[2]YANLING M,ZHI X,LI X,et al.An improved method of SINS/CNS integrated navigation algorithm based on dual quaternions with gyro error corrected online[C]//Control and Decision Conference(CCDC),2017 29th Chinese.IEEE,2017:179-184.
[3]谈振藩,张勤拓.MEMS陀螺误差辨识与补偿[J].传感器与微系统,2010,29(3):39-41.
[4]张红线,吴衍记,王玉辉,等.基于模糊逻辑的光纤陀螺温度补偿技术[J].中国惯性技术学报,2007,15(3):343-346.
[5]SABAHI F.A novel platform of validity concept and fuzzy Kalman filter applied to conservation voltage reduction assessment[C]//Computer and Knowledge Engineering(ICCKE),2017 7th International Conference on.IEEE,2017:148-153.
[6]何映思.模糊控制的模糊推理算法研究[D].重庆:西南师范大学,2005.
[7]王玲玲,富立.模糊推理在捷联航姿系统中的应用[J].中国惯性技术学报,2006,14(6):45-47.