Integration of GPS and low cost INS for pedestrian navigation aided by building layout

In outdoor environments, GPS is often used for pedestrian navigation by utilizing its signals for position computation, but in indoor or semi-obstructed environments, GPS signals are often unavailable. Therefore, pedestrian navigation for these environments should be realized by the integration of GPS and inertial navigation system （INS）. However, the lowcost INS could induce errors that may result in a large position drift. The problem can be minimized by mounting the sensors on the pedestrian＇s foot, using zero velocity update （ZUPT） method with the standard navigation algorithm to restrict the error growth. However, heading drift still remains despite using ZUPT measurements since the heading error is unobservable. Also, tbot mounted INS suffers from the initialization ambiguity of position and heading from GPS. In this paper, a novel algorithm is developed to mitigate the heading drift problem when using ZUPT. The method uses building lay- out to aid the heading measurement in Kalman filter, and it could also be combined for the initial- ization. The algorithm has been investigated with real field trials using the low cost Microstrain 3DM-GX3-25 inertial sensor, a Leica GS10 GPS receiver and a uBlox EVK-6T GPS receiver. It could be concluded that the proposed method offers a significant improvement in position accuracy for the long period, allowing pedestrian navigation for nearly40 min with mean position error less than 2.8 m. This method also has a considerable effect on the accuracy of the initialization.     

平流层飞艇升降阶段BPNN惯性导航算法

软式平流层飞艇艇体在上升和下降时经常呈堆叠状态，GPS信号会被艇体间歇性遮挡，因而只能采用惯性导航。为保证在飞艇上升和下降过程中，INS/GPS组合导航系统在被艇体遮挡GPS时仍能够提供满足精度要求的导航信息，设计了一种改进的反向传播神经网络(Back Propagation Neural Network, BPNN）惯性导航算法。采用神经网络，根据惯性导航系统在1s内的速度均值和姿态变化量，预估其在1s末的位置误差和速度误差，并对惯性导航结果进行修正。仿真实验和跑车试验结果表明，在GPS失效的30s内，新算法使得位置误差低于15m，速度误差低于0.7m/s，误差相比纯惯性导航降低了85%。     

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

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

Analysis of upgraded GPS internal Kalman filter

GPS receivers with provisions for inertial navigation system (INS) aiding are designed with internal Kalman filters that model generic INSs and process the basic GPS pseudorange and deltarange (range-rate) data to produce an output of inertially-smoothed, “GPS-derived” position and velocity. These Kalman filters model only the basic nine INS errors (position, velocity, and tilt) and do not model any INS gyro or accelerometer errors. It was found that a significant performance improvement could be achieved under conditions of degraded GPS satellite availability by augmenting this type of filter with the six INS gyro and accelerometer bias errors. It is, therefore, recommended that serious consideration be given to incorporating these states into the design of the GPS internal Kalman filter     

GPS／SINS姿态组合系统空间一致性研究

在基于卡尔曼滤波器并引入了姿态观测量的GPS/SINS组合导航系统中,GPS天线体坐标系与IMU所在的载体坐标系由于安装误差或其他原因不能完全重合,两个坐标系间存在失准角,导致多天线GPS与SINS输出的姿态信息在空间不能同步,这将影响卡尔曼滤波的效果。本文针对这一问题进行了深入的研究,分析了两个坐标系空间不一致的机理,给出了静态和动基座情况下标定两个坐标系位置关系的方法并进行仿真分析验证了其可行性。     

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     

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     

基于改进的磁场检验和主方向算法的行人航向估计

针对以惯导为核心的行人定位算法存在航向角失真的问题，提出了一种融合惯性测量单元(IMU)和磁力计的行人导航算法，利用步幅航向的变化量将行人的运动分为直线行走和曲线行走两部分，当检测到行人直线行走时，提出一种实时建立主方向的自适应航向角漂移修正算法，对航行角误差进行补偿；当行人曲线行走时，辅助地磁场信息，使用磁场强度、地磁倾角、惯性导航系统(inertial navigation system，INS)与磁力计解算的航向角之差这三个特征值构建广义似然比检验量，对磁场进行判断获得稳定状态磁场信息，通过卡尔曼滤波对航向角误差进行补偿。将传感器置于足部进行实验，实验结果表明,两种算法可以实现优势互补，有效地抑制地磁信息的干扰，提高导航精度，算法结果相对于无航向角修正的零速修正算法、零角速度更新算法和单独使用磁力计进行融合的算法，定位误差分别降低了91.02%、82.93%和61.39%，室外和室内终点定位误差分别为4.545 4 m和0.543 6 m，占总路程的0.69%和0.17%。     

一种基于无线信号辅助的室内无死角定位算法

针对传统惯性导航系统定位误差随时间积累的问题,提出了一种基于无线信号辅助定位的室内无死角定位算法。该算法首先利用加速度计、陀螺仪、磁力计和气压计等传感器数据实现三维定位,然后利用无线信号对惯导定位中的位置偏差进行实时校正,再通过航向最优估计算法对航向误差进行修正,在位置和航向上增强惯导系统的实用性。利用实验室自主研发的微惯性测量单元固定在腰部脊椎位置进行实验验证,结果显示基于无线信号辅助的室内无死角定位算法精度达到1%以内,与纯惯导技术相比,能够提供更持久和准确的三维位置信息。     

主惯导速度误差短周期波动对子惯导传递对准影响分析

随着激光陀螺技术的发展,旋转调制式激光陀螺惯性导航系统逐渐成为舰载主惯导系统,舰载机、舰载武器系统需要旋转调制式激光惯导系统提供的姿态、速度和位置信息进行对准,即主子惯导的传递对准。由于旋转调制式系统中的姿态、速度和位置具有随旋转的短周期波动问题,势必会影响对准时间较短的子惯导对准精度。为了保证传递对准的快速性,一般采用速度匹配方法。定量分析了主子惯导传递对准过程中主惯导速度误差短周期波动对子惯导系统对准精度的影响,首先进行了数字仿真,之后利用双轴激光陀螺惯导、纯捷联光纤陀螺惯导数据进行了半实物仿真,验证了主惯导速度误差的一次项系数与子惯导初始对准水平姿态误差呈线性关系,二次项系数与子惯导初始对准航向误差呈线性关系。     

基于虚拟地标的行人惯性SLAM算法

针对当前仅使用低成本惯性传感器的行人导航系统航向角存在较大累积误差的问题,研究了一种只使用惯性传感器信息的虚拟地标构建方法,并通过匹配虚拟地标点对位置和航向进行误差补偿.在此基础上,结合同时定位与建图(SLAM)方法的思想,实现了仅基于惯性传感器的SLAM,提高了行人导航的精度和可靠导航时间.试验结果表明,该方法能够有效消除纯惯性行人定位系统的累积误差,在2027m2的单层建筑物中空间位置误差小于10m.     

A new SINS/GPS sensor fusion scheme for UAV localization problem using nonlinear SVSF with covariance derivation and an adaptive boundary layer

The state estimation strategy using the smooth variable structure filter(SVSF) is based on the variable structure and sliding mode concepts. As presented in its standard form with a fixed boundary layer limit, the value of the boundary layer width is not precisely known at each step and may be selected based on a priori knowledge. The boundary layer width reflects the level of uncertainty in the model parameters and disturbance characteristics, where large values of the boundary layer width lead to robustness without optimality and small values of the boundary layer width provide optimality with poor robustness. As a solution and to overcome these limitations, an adaptive smoothing boundary layer is required to achieve greater robustness and suitable accuracy.This adapted value of the boundary layer width is obtained by minimizing the trace of the a posteriori covariance matrix. In this paper, the proposed new approach will be considered as another alternative to the extended Kalman filters(EKF), nonlinear H1 and standard SVSF-based data fusion techniques for the autonomous airborne navigation and self-localization problem. This alternative is based on strapdown inertial navigation system(SINS) and GPS data using the nonlinear SVSF with a covariance derivation and adaptive boundary layer width.Furthermore, the full mathematical model of the SINS/GPS navigation system considering the unmanned aerial vehicle(UAV) position, velocity and Euler angle as well as gyro and accelerometer biases will be used in this paper to estimate the airborne position and velocity with better accuracy.     

一种提高捷联惯性/里程计组合导航系统定位精度的后处理方法

测绘用捷联惯性/里程计组合导航系统多采用离线后处理技术.此类系统利用里程计位移微分获得的速度作为观测量,采用速度匹配,并通过待测路径中预置的Mark点校正航位推算的位置信息.本文建立了基于速度匹配的16维Kalman滤波模型,对全程采样数据进行正反向导航和滤波处理,以估计惯性器件和里程计的误差;在补偿相关误差后,再次进行正向导航和滤波解算,以获得更精确的姿态矩阵.随后,根据相邻两个Mark点之间的姿态信息进行航位推算,并更新里程计刻度系数、里程计与惯导间的姿态误差矩阵;若此Mark点间的位置误差过大,则重新进行航位推算以减小位置误差.结果表明,与传统正向滤波相比,采用该方法后系统的最大位置误差由1.72m降低到0.08m,定位精度提高了95％以上.     

Kalman滤波器在直升机盘旋飞行中的应用

 介绍了一种针对无人驾驶直升机小半径稳速盘旋使用的Kalman 滤波器, 并用其进行数据处理, 同时给出了无人驾驶直升机盘旋飞行的状态方程, 以及进入盘旋、退出盘旋和野值数据的自动判断和处理, 并且在分析过程中给出了误差分析。讨论了飞行模式检测方法的设计思路及关键技术, 并给出了本方法的虚警概率。本方法可用于导航控制、天线跟踪和遥测数据处理等系统中, 可以提高定位的准确性, 并进行飞行模式的自动判决。     

基于航向匹配的磁力计外场无依托标定算法CSCD

三轴磁力计的测量精度会受到自身和环境的影响,因此在使用前必须要进行标定。传统标定方法需要特定的精密仪器和标定环境,或是对计算量和采集数据的方式有较高的要求,针对这些问题,提出了基于航向匹配的磁力计外场无依托标定算法。该算法无需特定精密仪器、对数据采集和计算量的要求也较低,且可以在现场实现有效动态标定。该算法基于航向角是磁航向角与磁偏角代数和的原理,通过等价数学变换构建了磁力计零偏关于姿态角与磁力计测量值的线性模型,最终采用最小二乘法对磁力计的零偏进行估计。该算法可以估计三轴磁力计的零偏,对磁力计的测量结果有较好的补偿作用。实验结果表明,该算法可有效标定三轴磁力计,减小其测量误差。经标定的磁力计可以应用于地磁匹配导航,辅助惯性导航修正其位置误差,尤其是在长直路段内,磁力计标定过程中识别出的磁异常数据可以为地磁匹配导航提供基础信息。     

基于UWB/SINS组合的行人导航研究

在特殊环境下全球定位系统(GPS)信号强度被严重削弱,此时基于GPS技术的导航设备将受到严重影响。针对不依赖GPS的行人导航定位需求,提出了一种基于微机电捷联惯导系统(SINS)与超宽带(UWB)定位系统相结合的行人导航方法。该系统由捷联惯导系统与超宽带定位系统组成,行人导航算法在传统的捷联算法的基础上引入了零速修正技术用于检测零速时刻,并使用阈值法剔除了超宽带错误信息,通过联邦Kalman滤波融合了零速、位置和航向信息,并对系统速度、位置、航向进行了校正。行人导航实验表明,该方法能够提升系统定位精度,并进一步加强系统的稳定性与可靠性。     

卡尔曼滤波在弹道组合导航仿真中的应用

根据捷联惯性导航(INS)和GPS导航两个系统不同的特点,通过卡尔曼滤波方法实现了INS/GPS组合导航,以速度差和位置差作为卡尔曼滤波的量测量信息,建立了组合导航的简化滤波方程.在实际陀螺器件含有零偏的情况下,通过在角速度上引入定量的零位偏置来进行弹体模拟投放过程.将仿真导航结果和弹道参数比较,引入的陀螺偏置引起姿态角误差,而速度误差和位置误差比较小,导航计算参数误差在允许范围之内.     

Low cost inertial/GPS integrated position and orientation systemfor marine applications

This paper describes the Low Cost Position and Orientation System (LCPOS), comprising the integration of a low cost “tactical grade” inertial measurement unit with GPS position, velocity and heading aiding data. LCPOS was designed to be a cost-effective alternative to a high performance costly ship INS (SINS). The demonstrated accuracy of the LCPOS integrated navigation solution is comparable to that of the SINS     

A Comparison of Two Approaches to Pure-Inertial and Doppler-Inertial Error Analysis

Error equations for inertial navigation systems are derived using a perturbation (or true frame) approach and a psi angle (or computer frame) approach in a manner which shows the underlying as sumptions and allows direct comparison of the two methods. The comparison is general since the analysis is not associated with any particular mechanization. Different definitions of velocity errors and misalignment angles result from the two methods of error analysis, and, consequently, have significance in testing and analysis of pure-inertial systems, Doppler-inertial systems, and inertially aided weapon delivery systems. Examples and numerical results are presented for a local-level north-pointing mechanization.