Coning compensation algorithm with angular rate considering gyroscope frequency characteristics
-
摘要: 针对陀螺直接输出角速率且通带内增益不一致(频率特性),而传统角速率输入圆锥补偿算法要求输入理想的角速率,提出了一种考虑陀螺频率特性的角速率输入圆锥补偿算法.推导了圆锥运动情况下姿态更新周期内理想旋转矢量增量和实际姿态算法计算的旋转矢量增量,以最小化理想旋转矢量增量和计算旋转矢量增量之间非周期项的差异为计算圆锥误差补偿系数的准则,最优补偿系数可以看成是采用理想角速率输入的圆锥补偿算法系数与考虑频率特性时对理想圆锥补偿算法系数修正的和.得到了公式化求解考虑频率特性的各子样算法最优系数的方法.仿真结果表明,所提出的算法比传统角速率输入圆锥补偿算法在精度上有明显提高.Abstract: Focusing on the gyroscopes- output is angular rate and has a certain frequency characteristics, a coning compensation algorithm considering the gyroscopes- frequency characteristics with angular rate as input was presented. The ideal and computed rotation vector increment was derived in the attitude update interval under coning motion. The coning compensation algorithm coefficients were computed to minimize the nonperiodic term difference between the ideal and computed rotation vector increment. The optimal coefficients were defined to be the sum of the values that exist for perfect angular rate input and an adjustment that accounts for the frequency characteristics. The formulized approach for the optimal coefficients with arbitrary samples considering frequency characteristics was obtained. Simulation results show that the accuracy of the algorithm can be improved effectively as compared with the conventional ones.
-
[1] Miller R B.A new strapdown attitude algorithm[J].Journal of Guidance,Control,and Dynamics,1983,6(4):287-291 [2] Jiang Y F,Lin Y P.Improved strapdown coning algorithms[J].IEEE Transaction on Aerospace and Electronic Systems,1992, 28(2):484-490 [3] Mark J G,Tazartes D A.Tuning of coning algorithms to gyro data frequency response characteristics[J].Journal of Guidance,Control,and Dynamics,2001,24(4):641-647 [4] Ignagni M.Optimal sculling and coning algorithms for analog sensor systems[J].Journal of Guidance,Control,and Dynamics,2012,35(3):851-860 [5] 魏晓虹,张春熹,朱奎宝.一种高精度角速率圆锥补偿算法[J].北京航空航天大学学报,2005,31(12):1312-1316 Wei Xiaohong,Zhang Chunxi,Zhu Kuibao.High accuracy coning compensate algorithm by angular velocity[J].Journal of Beijing University of Aeronautics and Astronautics,2005,31(12): 1312-1316(in Chinese) [6] 曾庆化,刘建业,熊智,等.一种角速率激光陀螺惯导系统高精度姿态算法[J].上海交通大学学报,2006, 40(12): 2159-2163 Zeng Qinghua,Liu Jianye,Xiong Zhi,et al.A high accuracy attitude algorithm of ring laser gyro strapdown inertial navigation system with pure angle rate output[J].Journal of Shanghai Jiao Tong University,2006,40(12):2159-2163(in Chinese) [7] 杨胜,房建成.角速率输入下圆锥补偿算法的一般形式[J].北京航空航天大学学报,2008,34(8):920-924 Yang Sheng,Fang Jiancheng.General formulas of coning compensation algorithm with angular rate input[J].Journal of Beijing University of Aeronautics and Astronautics,2008,34(8):920-924(in Chinese) [8] Ben Y Y,Sun F,Gao W,et al.Generalized method for improved coning algorithms using angular rate[J].IEEE Transactions on Aerospace And Electronic Systems,2009,45(4):1565-1572 [9] Bortz J E.A new mathematical formulation for strapdown inertial navigation[J].IEEE Transaction on Aerospace and Electronic Systems,1971,7(1):61-66 [10] Park C G,Kim K J.Formalized approach to obtaining optimal coefficients for coning algorithms[J].Journal of Guidance,Control,and Dynamics,1999,22(1):165-168 [11] Savage P G.Explicit frequency shaped coning algorithms for pseudoconing environments[J].Journal of Guidance,Control,and Dynamics,2011,34(3):774-782
点击查看大图
计量
- 文章访问数: 1641
- HTML全文浏览量: 157
- PDF下载量: 555
- 被引次数: 0