Strapdown INS error model for multiposition alignment

The relationship between quaternion errors and tilt angles from true navigation frame to analytic platform frame is newly derived for strapdown inertial navigation system (SDINS). Using the relationship it is shown that the quaternion error model for attitude and velocity is equivalent to the conventional perturbation error model. Based upon the equivalency, the quaternion errors during a multiposition alignment are determined and analyzed. Furthermore, it is shown that the heading rotation of 180 deg achieves the minimal quaternion error for 2-position ground alignment     

Comparison of SDINS in-flight alignment using equivalent errormodels

The psi-angle model and the equivalent tilt (ET) model have been widely used for in-flight alignment (IFA) to align and to calibrate a strapdown inertial navigation system (SDINS) on a moving base. However, these models are not effective for a system with large attitude errors because the neglected error terms in the models degrade the performance of a designed filter. In this paper, with an odometer as an external aid, a velocity-aided SDINS is designed for IFA. Equivalent error models applicable to IFA with large attitude errors are derived in terms of rotation vector error and additive and multiplicative quaternion errors. It is found that error models in terms of additive quaternion error (AQE) become linear. Thus the proposed error models reduce unmodeled error terms for a linear filter. From a number of van tests, it is shown that the proposed error models effectively improve the performance of IFA     

Strapdown inertial navigation using dual quaternion algebra: error analysis

In a strapdown inertial navigation system (INS), the general displacement of a rigid body is traditionally separately modeled and analyzed, i.e., direction cosine matrix or quaternion for rotation analysis and vector for translation analysis. As a subsequent work of a companion paper (Wu et al., 2005), this paper adopts dual quaternion algebra, a most concise and unified mathematical tool for representing the general displacement of a rigid body, to analyze error characteristics of the strapdown INS. Two new error models in terms of quaternion algebra are developed: the additive dual quaternion error (ADQE) model and multiplicative dual quaternion error (MDQE) model. Both are expected to facilitate the future inertial navigation-based integrated navigation filter.     

旋转三子样高精度捷联惯性导航算法

针对捷联惯导系统高精度导航的需求,以螺旋理论为基础,采用螺旋补偿三子样推导出对偶四元数所表示的捷联惯导算法,并同时对载体的姿态、速度、位置进行更新,并以四阶截断三角级数近似三角函数进行对偶四元数更新和螺旋矢量更新。仿真和跑车实验结果表明：螺旋三子样捷联惯性导航算法的导航精度比一般四元数算法提高约15%,为相关领域的研究与实际应用提供参考。     

Comparison of strapdown inertial navigation algorithm based on rotation vector and dual quaternion

 For the navigation algorithm of the strapdown inertial navigation system, by comparing to the equations of the dual quaternion and quaternion, the superiority of the attitude algorithm based on dual quaternion over the ones based on rotation vector in accuracy is analyzed in the case of the rotation of navigation frame. By comparing the update algorithm of the gravitational velocity in dual quaternion solution with the compensation algorithm of the harmful acceleration in traditional velocity solution, the accuracy advantage of the gravitational velocity based on dual quaternion is addressed. In view of the idea of the attitude and velocity algorithm based on dual quaternion, an improved navigation algorithm is proposed, which is as much as the rotation vector algorithm in computational complexity. According to this method, the attitude quaternion does not require compensating as the navigation frame rotates. In order to verify the correctness of the theoretical analysis, simulations are carried out utilizing the software, and the simulation results show that the accuracy of the improved algorithm is approximately equal to the dual quaternion algorithm.     

基于对偶四元数的捷联惯导算法在发射点惯性系下的应用研究

针对导弹类载体在做复杂的高动态机动时,采用传统的捷联惯导算法容易产生圆锥误差与划船误差,从而导致解算精度降低的问题,在发射点惯性系下设计了基于对偶四元数的捷联惯导算法。在建立发射点惯性系下的捷联惯导解算模型的基础上,详细推导了基于对偶四元数的捷联惯导解算算法,通过对比分析其中的速度更新过程与传统算法的差异,说明该算法可以有效提高速度和位置解算精度。在设计的多条机动飞行轨迹下,以三子样更新为例,对对偶四元数算法和传统算法的性能进行了仿真对比分析。仿真结果表明,对偶四元数导航算法可以有效提高速度和位置解算精度,且姿态机动情况越复杂、持续时间越长,改善效果越显著。     

基于对偶四元数的INS/GPS组合导航算法研究

在基于对偶四元数的捷联惯导解算方法的基础上,推导了以惯性系作为导航系的惯导误差方程,在此基础上设计了卡尔曼滤波组合导航算法。通过激光惯导跑车采集数据,进行了仿真分析,试验结果表明,该组合导航算法能有效的消除惯导累积的速度误差和位置误差,相比于目前广泛应用的INS/GPS组合导航算法,本文描述了INS/GPS组合导航的另一种实现方式,获得了相当的精度,具有一定的工程应用价值。     

The Psi-Angle Error Equation in Strapdown Inertial Navigation Systems

A detailed development is presented of the psi-angle vector differential equation as applied to the error analysis of strapdown inertial navigation systems. The coordinate systems involved and the psi misalignment vector are clearly defined. It is proven that apart from a sign change the psi-angle differential equation in the error analysis of strapdown inertial navigation systems is identical to the one used in conventional gimbaled inertial navigation systems.     

Modeling quaternion errors in SDINS: computer frame approach

We propose new equivalent tilt error models which are applicable to the analysis of the terrestrial strapdown inertial navigation systems (SDINS), based on the quaternions. The currently available equivalent tilt error models, like the conventional Φ model of the gimbaled inertial navigation systems (GINS), are derived only by the true frame approach. The true frame approach has a computational disadvantage that it produces an error model where the attitude error equation is coupled with its position and velocity error equations. The motivation of this work is to solve this problem. As a result, two kinds of error models are derived. Among them, one is derived by the computer frame approach for practical onboard implementations. Thus, like the conventional GINS Ψ model, its attitude error equation is decoupled from the position and velocity error equations. The other is derived in order to show the relationship between the true frame approach and the computer frame approach which are applied to the quaternion-based SDINS. Thus, like the GINS δΘ model, it can be used to transform the error variables into each other which are calculated by the two different approaches     

用于微机械捷联式航姿系统的四元素算法卡尔曼滤波器

介绍了一种卡尔曼滤波器 ,它适用于由微机械惯性传感器构成的捷联式航姿系统。文中阐述了系统构成和原理 ,基于四元素算法公式推导了姿态算法和系统误差模型 ,并设计了实时卡尔曼滤波器。仿真结果表明 ,当没有横向加速度干扰时系统精度优于 0 .0 4度 ,当出现 0 .1g/1Hz的横向交变加速度干扰时 ,精度降为 0 .4 4度。初步测试结果表明系统的静态精度为 :俯仰和横滚 /-0 .2度 ,航向 /- 0 .3度。     

捷联惯性导航传统比力积分算法与对偶四元数算法的比较研究

捷联惯性导航速度更新算法中,将载体坐标系中的比力积分增量变换到导航参考坐标系中,载体姿态变化的影响通常采用一阶近似模型进行计算。本文分析了包括角振动和加速运动的动态运动下一阶近似模型的局限,在典型角振动及加速运动条件下对忽略姿态变化二阶项造成的速度更新误差进行了理论分析。通过比较,揭示了对偶四元数比力积分算法精度高于传统比力积分算法的原因,即和传统比力积分算法相比,对偶四元数比力积分算法等价于考虑了载体姿态变化影响的二阶项。通过典型角振动及加速运动条件下传统捷联惯性导航算法和对偶四元数导航算法的仿真比较,对理论分析结果进行了验证。     

误差四元数及其在航天器姿态控制中的应用

以四元数作为定位参数对航天器进行姿态控制。首先导出了误差四元数矢量,从而解决了航天器姿态控制中最终姿态表示的非单值性问题;其次,通过一个典型例子提出了非线性三轴姿态控制方法,该方法以误差四元数作为反馈量,以控制力矩陀螺作为执行元件,利用李亚普诺夫函数对非线性系统进行控制,为大型航天器的姿态控制开辟了新的途径;最后,给出了仿真结果,从而说明了以误差四元数作为定位参数的航天器姿态控制法具有计算速度快、计算精度高等优点。     

Strapdown Guidance Error Analysis

A crucial part of so-called ?strapdown? techniques for inertial guidance systems is the generation of the matrix of direction cosines relating the body axes to the reference axes. This is generally done by direct integration of a set of differential equations having the body angular velocities as inputs. This paper is devoted to an error analysis of two commonly used integration schemes, namely, direction cosines and quaternions. Scale, skew, and drift errors are defined, and the susceptibility of the integration schemes to these types of error is examined. It is concluded that the quaternion scheme offers an advantage because it intrinsically yields zero skew error. The paper is presented in two parts, for convenience.     

喷嘴为执行机构的空间飞行器基于误差四元数的非线性姿态跟踪控制

研究带喷嘴空间飞行器在姿态跟踪机动时的多轴耦合非线性姿态控制问题。姿态运动学和动力学用误差四元数描述。通过线性变换将误差四元数动力学方程转换成 4个摄动双积分系统 ,并基于此摄动双积分系统设计了开关控制器。由误差四元数及其导数构成的抛物型开关函数决定了控制器中的逻辑。文章考虑了最短的姿态捕获路径、外部干扰抑制、和不确定参数补偿问题。控制器允许力矩矩阵为非对称 ,从而使喷气执行机构的安装有更好的灵活性。由于不需要目标的加速度反馈 ,控制器可用于对机动目标的跟踪。用相平面方法分析了闭环系统的鲁棒稳定性。仿真结果验证了控制方案的可行性     

Tilt-Table Alignment for Inertial-Platform Maintenance without a Surveyed Site

A method for aligning the rotary tilt table for an inertial-platform maintenance facility without surveying the site is analyzed and evaluated. The method utilizes multiple measurements of the tilt-table azimuth alignment error with different inertial platforms to determine a best estimate of the alignment error. Error analysis indicates that useful facility performance can be obtained with only a small number of measurements. The tilt-tablealignment accuracy can be improved as more measurements of the alignment error are made during normal facility operation.     

扰动线运动对惯性系粗对准影响分析及优化方法

针对扰动线运动对惯性系粗对准精度影响较大的问题，通过分析惯性体坐标系下重力加速度积分矢量的物理含义，给出了受扰动线运动影响的惯性系粗对准的误差分析。并在此基础上提出了基于位移积分矢量构造定姿矢量矩阵的抗扰动粗对准算法，利用对速度积分矢量进一步积分得到的3个时间点的位移积分矢量构建姿态解算矩阵，抑制扰动线运动对粗对准精度的影响。仿真结果表明，该算法可有效减小扰动线运动影响下的对准结果振动幅值，能够快速收敛到满足精对准使用的精度范围，从而提高武器装备环境适应性。     

扰动线运动对惯性系粗对准影响分析及优化方法

针对扰动线运动对惯性系粗对准精度影响较大的问题,通过分析惯性体坐标系下重力加速度积分矢量的物理含义,给出了受扰动线运动影响的惯性系粗对准的误差分析。并在此基础上提出了基于位移积分矢量构造定姿矢量矩阵的抗扰动粗对准算法,利用对速度积分矢量进一步积分得到的3个时间点的位移积分矢量构建姿态解算矩阵,抑制扰动线运动对粗对准精度的影响。仿真结果表明,该算法可有效减小扰动线运动影响下的对准结果振动幅值,能够快速收敛到满足精对准使用的精度范围,从而提高武器装备环境适应性。     

Strapdown inertial navigation system algorithms based on dual quaternions

The design of strapdown inertial navigation system (INS) algorithms based on dual quaternions is addressed. Dual quaternion is a most concise and efficient mathematical tool to represent rotation and translation simultaneously, i.e., the general displacement of a rigid body. The principle of strapdown inertial navigation is represented using the tool of dual quaternion. It is shown that the principle can be expressed by three continuous kinematic equations in dual quaternion. These equations take the same form as the attitude quaternion rate equation. Subsequently, one new numerical integration algorithm is structured to solve the three kinematic equations, utilizing the traditional two-speed approach originally developed in attitude integration. The duality between the coning and sculling corrections, raised in the recent literature, can be essentially explained by splitting the new algorithm into the corresponding rotational and translational parts. The superiority of the new algorithm over conventional ones in accuracy is analytically derived. A variety of simulations are carried out to support the analytic results. The numerical results agree well with the analyses. The new algorithm turns out to be a better choice than any conventional algorithm for high-precision navigation systems and high-maneuver applications. Several guidelines in choosing a suitable navigation algorithm are also provided.     

面向室内场景的惯性磁感应定位方法

针对卫星拒止的室内导航问题，在现有磁信标定位技术的基础上，通过分析低频旋转磁场的特点，建立了一种不受传感器姿态和磁信标磁矩信息影响的磁感应矢量夹角观测模型，并结合MEMS惯性导航的误差模型提出了一种以磁感应矢量夹角的正余弦值为量测信息的惯性磁感应动态定位方法，避免了磁传感器姿态误差和磁矩误差对定位结果的影响。利用实验室的双轴磁信标实验系统进行静态测试，验证了磁感应定位模型具有不受传感器姿态、环境中遮挡物以及磁矩影响的特点；通过数值仿真的方式对基于无迹卡尔曼滤波（UKF）的惯性磁感应定位方法进行验证，结果表明该方法能有效地抑制惯性导航的发散，且位置最大误差小于0.75 m，满足大多数室内场景下的高精度导航定位需求。     

An improved quaternion Gauss–Newton algorithm for attitude determination using magnetometer and accelerometer

For the vector attitude determination, the traditional optimal algorithms which are based on quaternion estimator(QUEST) measurement noise model are complicated for just two observations. In our application, the magnetometer and accelerometer are not two comparable kinds of sensors and both are not small field-of-view sensors as well. So in this paper a new unit measurement model is derived. According to the Wahba problem, the optimal weights for each measurement are obtained by the error variance researches. Then an improved quaternion Gauss–Newton method is presented and adopted to acquire attitude. Eventually, simulation results and experimental validation employed to test the proposed method demonstrate the usefulness of the improved algorithm.