A Fast Initial Alignment Filtering Method of Velocity and Attitude Matching on Dynamic Base for Underwater Vehicle
-
摘要: 研究了水下航行器动基座对准问题,建立了动基座对准误差模型,在对准时水下航行器在阵风、海浪的干扰下做直线加速运动,利用GPS提供的速度和姿态信息进行辅助对准,并建立了系统的观测方程。提出了一种基于四元数姿态更新的速度、姿态匹配方式的对准方法,并用该方法估计3个失准角。理论研究与仿真结果表明,该方法不但满足水平失准角估计的速度和精度要求,而且能快速、精确地估计出方位失准角。Abstract: The alignment of underwater vehicle on dynamic base is studied, and an error model of strapdown inertial navigation system(SINS) is established. The underwater vehicle runs straightly and acceleratively in waves and winds during the process of alignment. Meanwhile the information of velocity and attitude from global positioning system(GPS) is used to help implement alignment, so the observation equations can be obtained. An alignment method based on quaternion attitude updating with the matching of velocity and attitude is proposed to estimate three initial misalignment angles. Consequently the misalignment angles are accurately and quickly estimated. Especially the method reduces the time for estimating azimuth error, and improves the accuracy of estimation. The simulation results illustrate the efficiency of the method.
-
[1] FANG J C,WANG D J.A Fast Initial Alignment Method for Strapdown Inertial Navigation System on Stationary Base[J].IEEE Transactions On Aerospace and Electronic System,1996,32(4):1501-1505. [2] Bar-Itzhack I Y,Berman N.Control Theoretic Approach to Inertial Navigation Systems[J].Journal of Guidance and Control,1988,11(3):237-245. [3] 秦永元.惯性导航[M].北京:科学出版社,2006. [4] 万德钧,房建成.惯性导航初始对准[M].南京:东南大学出版社,1990. [5] 秦永元,张洪钺, 汪叔华.卡尔曼滤波与组合导航原理[M].西安:西北工业大学出版社,1998.
点击查看大图
计量
- 文章访问数: 2286
- HTML全文浏览量: 0
- PDF下载量: 764
- 被引次数: 0