基于GPS软件接收机的SINS／GPS紧组合系统仿真

为了系统验证SINS／GPS紧组合系统的性能,基于GPS软件接收机,进行了仿真系统构建。仿真系统由轨迹发生器、GPS中频信号模拟器、IMU信号模拟器、GPS软件接收机、SINS导航解算模块、组合滤波算法和导航性能分析模块等部分构成,其中详细设计了GPS软件接收机中的捕获和跟踪算法、SINS解算以及基于伪距和伪距率的组合滤波算法。仿真结果表明：紧组合导航系统收敛性较好,能够一定程度上抑制惯导系统误差的积累,有较好的导航性能。设计的该系统满足紧组合导航系统性能验证的需要,也为后续的超紧组合研究奠定了良好的基础。     

两种滤波方法在SINS/GPS组合导航中的分析比较

本文针对SINS/GPS组合导航系统中卡尔曼滤波发散的情况:介绍并分析了自适应滤波和H∞滤波算法原理,并进行仿真计算,验证了这两种滤波用于SINS/GPS组合导航系统的可行性和有效性,对实际应用中组合导航系统滤波器的设计具有一定的指导意义。     

两种滤波方法在SINS／GPS组合导航中的应用与比较

针对SINS／GPS组合导航系统中卡尔曼滤波发散的情况,引入了自适应滤波和H∞滤波,分析了它们各自的特性,最后进行仿真计算,验证了这两种滤波用于SINS／GPS组合导航系统的可行性和有效性,对实际应用中组合导航系统滤波器的设计具有一定的指导意义。     

GPS navigation processing using the quaternion-based divided difference filter

Divided difference filter (DDF) with quaternion-based dynamic process modeling is applied to global positioning system (GPS) navigation. Using techniques similar to those of the unscented Kalman filter (UKF), the DDF uses divided difference approximations of derivatives based on Stirling’s interpolation formula which results in a similar mean but different posterior covariance compared to the extended Kalman filter (EKF) solutions. The second-order divided difference is obtained from the mean and covariance in second-order polynomial approximation. The quaternion-based dynamic model is adopted for avoiding the singularity problems encountered in the Euler angle method and enhancing the computational efficiency. The proposed method is applied to GPS navigation to increase the navigation estimation accuracy at high-dynamic regions while preserving (without sacrificing) the precision at low-dynamic regions. For the illustrated example, the second-order DDF can deliver about 41–82% accuracy improvement as compared to the EKF. Some properties and performance are assessed and compared to those of the EKF and UKF approaches.     

Unscented Kalman filter with nonlinear dynamic process modeling for GPS navigation

This paper preliminarily investigates the application of unscented Kalman filter (UKF) approach with nonlinear dynamic process modeling for Global positioning system (GPS) navigation processing. Many estimation problems, including the GPS navigation, are actually nonlinear. Although it has been common that additional fictitious process noise can be added to the system model, however, the more suitable cure for non convergence caused by unmodeled states is to correct the model. For the nonlinear estimation problem, alternatives for the classical model-based extended Kalman filter (EKF) can be employed. The UKF is a nonlinear distribution approximation method, which uses a finite number of sigma points to propagate the probability of state distribution through the nonlinear dynamics of system. The UKF exhibits superior performance when compared with EKF since the series approximations in the EKF algorithm can lead to poor representations of the nonlinear functions and probability distributions of interest. GPS navigation processing using the proposed approach will be conducted to validate the effectiveness of the proposed strategy. The performance of the UKF with nonlinear dynamic process model will be assessed and compared to those of conventional EKF.     

基于SINS／GPS的无人机组合导航系统建模与仿真

根据无人机的飞行特点以及SINS(捷联惯导)和GPS(全球定位系统)的优缺点,利用轨迹发生器设计无人机的飞行轨迹,建立基于SINS/GPS的无人机组合导航系统,依据卡尔曼滤波的相关原理对系统进行数学建模和计算仿真,验证无人机SINS/GPS组合导航系统的可靠性。     

信号遮挡环境下融合TOA/AOD的5G/SINS组合导航算法模型与精度分析

为解决可观测基站受遮挡情况下仅采用到达时间（time of arrived, TOA）无法定位或精度较差的问题,将第5代移动通信技术（5th generation,5G）中多天线阵列提供的信号离开角（angle of departure, AOD）应用在定位解算中,通过卡尔曼滤波将5G定位与捷联惯性导航（strapdown inertial navigation system,SINS）融合,构成融合TOA/AOD的5G/SINS组合导航方案。通过模拟可观测5G基站数量充足、遮挡这两类场景下的仿真实验,对基于TOA的5G定位、基于TOA/AOD的5G定位、TOA组合导航、TOA/AOD组合导航这4种解算方法的位置误差进行了比较。仿真实验结果表明,当可观测基站受遮挡时,融合TOA/AOD进行5G/SINS组合导航能确保100%的定位成功率,并有效降低组合导航发散的概率,减小40%~70%的位置误差。     

基于泛在位置服务的嵌入式导航计算机系统研究与设计

分析了全球定位系统(GPS)、捷联惯导系统(SINS)和无线定位技术(WLAN)在城市复杂环境下室内外定位时的优缺点,提出了在城市复杂环境下采用基于卡尔曼滤波松组合的SINS／GPS组合导航定位方式,在室内环境下时,单独使用WLAN无线定位技术时易受室内复杂环境的影响,比如天花板、墙壁造成的多径效应,在传播过程中易受相近频段电器的干扰等等;提出了采用基于卡尔曼滤波的SINS／WLAN的组合导航定位技术来实现,从而实现更加平滑的导航定位结果。同时兼顾全组合导航系统高精度、低功耗、小型化的要求,设计出基于TMS320C6713和FPGA架构的嵌入式导航计算机平台。通过该平台系统的搭建,能够有效解决人们对泛在位置服务的需求问题。      

Avoiding numerical stability problems of long duration DGPS/INS Kalman filters

A current pursuit of the geodetic community is the optimal integration of differential GPS (DGPS) and inertial navigation system (INS) data streams for precise and efficient position and gravity vector surveying. Therein a complete INS and multiple-antenna GPS receiver payload, mounted on a moving platform, is used in conjunction with a network of ground-fixed single antenna GPS receivers. This paper presents a complete, GPS-based, external updating measurement model for the applicable Kalman filter. The model utilizes four external observation types for every GPS satellite in-view: DGPS range differences, single phase differences, and single phase-rate differences; as well as the mobile, multipleantenna GPS receiver's measurement of theerrors in the INS's estimate of the phase difference between any two vehicle-borne GPS antennae. Although not widely conveyed in the geodetic world, the inertial navigation community has long known that traditional Kalman filter covariance propagation recurrences are inherently unstable when such highly accurate external updates are repeatedly applied (every 1 second) over long time durations. A hybrid square root covariance/U — D covariance factorization approach is a numerically stable alternative and is reviewed herein. The hybrid makeup of the algorithm is necessitated by the correlated nature of the fourth type of GPS external measurement listed above (each vehicle-borne GPS antenna formstwo baselines). Such measurement correlations require a functional transformation of the overall external updating model to permit the multiple updates (simultaneously available at each updating epoch) to be sequentially (and efficiently) processed. An appropriate transformation is given. Stable covariance propagation relationships are presented and the transformed Kalman gain is also furnished and its use in the determination of the externally updated error states is discussed. Specific DGPS/INS instabilities produced by the traditional recurrences are displayed. The stable alternative method requires about 25% more CPU time than the traditional Kalman recurrences. With the ever-increasing computational speeds of microprocessors, this added CPU time is of no real concern.     

Adaptive estimation of multiple fading factors in Kalman filter for navigation applications

Kalman filter is the most frequently used algorithm in navigation applications. A conventional Kalman filter (CKF) assumes that the statistics of the system noise are given. As long as the noise characteristics are correctly known, the filter will produce optimal estimates for system states. However, the system noise characteristics are not always exactly known, leading to degradation in filter performance. Under some extreme conditions, incorrectly specified system noise characteristics may even cause instability and divergence. Many researchers have proposed to introduce a fading factor into the Kalman filtering to keep the filter stable. Accordingly various adaptive Kalman filters are developed to estimate the fading factor. However, the estimation of multiple fading factors is a very complicated, and yet still open problem. A new approach to adaptive estimation of multiple fading factors in the Kalman filter for navigation applications is presented in this paper. The proposed approach is based on the assumption that, under optimal estimation conditions, the residuals of the Kalman filter are Gaussian white noises with a zero mean. The fading factors are computed and then applied to the predicted covariance matrix, along with the statistical evaluation of the filter residuals using a Chi-square test. The approach is tested using both GPS standalone and integrated GPS/INS navigation systems. The results show that the proposed approach can significantly improve the filter performance and has the ability to restrain the filtering divergence even when system noise attributes are inaccurate.     

一种低成本、低精度SINS/GPS组合导航系统及试验研究

在SINS（捷联式惯性导航系统）与GPS组合时，航向角的可观测性较弱，经过卡尔曼滤波后，航向角误差虽有所改善，但仍呈发散趋势，当采用低成本、低精度SINS时，该趋势进一步加剧。为了抑制该发散趋势，针对某型低成本、低精度SINS硬件组成（包括AHRS（姿态和航向参考系统）与IMU（惯性测量器件））的特点，提出了利用AHRS代替SINS航向角信息的方法。实际静态与动态试验表明，利用该方法可有效地抑制组合系统航向角的发散趋势，定位精度较高。     

北斗二代／SINS组合导航系统研究

将伪距、伪距率组合方法应用于北斗二代卫星／SINS组合导航系统,利用卫星系统的星历数据与SINS给出的位置、速度计算出相应的伪距和伪距率,然后与接收的伪距和伪距率相比较得出误差作为量测值,通过卡尔曼滤波器估计卫星定位系统和SINS的误差量,从而实现系统的校正。建立了组合导航系统的状态模型和量测模型,仿真实验表明,该组合模式可得到很好的导航精度。     

一种SINS/GPS深组合导航系统技术问题分析

为了满足高动态用户及强干扰条件下的应用需求,提出了一种基于卫星信号矢量跟踪的SINS/GPS深组合导航方法,设计了基于FPGA硬件平台的实施方案。利用组合卡尔曼滤波器反馈回路取代了传统接收机中独立、并行的跟踪环路,能够同时完成所有可视卫星信号的跟踪和导航信息处理;通过矢量跟踪算法对所有可视卫星信号进行集中处理,能够增强跟踪通道对信号载噪比变化的适应能力,从而提高接收机在强干扰或信号中断条件下的跟踪性能;根据SINS导航参数和星历信息推测GPS伪码相位和多普勒频移等参数,用以辅助卫星信号的捕获和跟踪,能够大大缩短接收机的搜索捕获时间,并增强接收机在高动态条件下的跟踪性能。基于矢量跟踪的深组合方法不仅在GPS信号短暂中断期间,能够保证系统的导航精度和可靠性,而且在强干扰环境中能够维持较好的伪码相位和载波频率跟踪性能。     

SINS／GPS级联组合滤波新算法

针对级联式SINS／GPS导航系统中组合滤波器的测量噪声与系统噪声的相关问题，提出了一种相关程度未知条件下的估计量最优融合算法，并由此得到了一个顾及噪声相关性的的卡尔曼滤波新算法；通过对一套SINS／GPS数据的计算，证明了新算法是成功的。     

基于多尺度预处理的GPS/SINS组合导航系统

基于多尺度分析的思想,以离散小波变换为工具,利用小波对惯性元件输出的信息进行并行阈值消噪以削弱惯性元件误差对SINS及组合系统性能的影响;然后,对GPS输出的信息进行并行多尺度预处理,并结合传统的Kalman滤波方法,对系统进行综合滤波;将上述方法引入到GPS/SINS组合导航系统中,利用实测数据进行验证,并给出了基于不同方法的大量实验曲线。实验结果表明,该方法可以有效削弱惯性元件以及GPS误差对系统的影响,提高了GPS/SINS组合导航系的精度和可靠性。     

利用神经网络预测的GPS/SINS组合导航系统算法研究

提出了一种基于神经网络预测的GPS/SINS组合导航系统算法。GPS信号可用时,该算法分别将惯性传感器的输出以及卡尔曼滤波器的输出信息作为神经网络的输入及理想输出信息,并进行在线训练;当GPS信息失锁时,利用已经训练好的神经网络预测各导航参数误差,并校正SINS。地面静态实验与动态跑车实验结果证明了该方法的可行性与有效性。     

移动机器人SLAM位姿估计的改进四元数无迹卡尔曼滤波EI北大核心CSCD

在全自主运动控制的移动机器人系统中,自身位姿的估计和校正对于移动机器人的运动至关重要。卡尔曼滤波是解决移动机器人同步定位与地图构建(SLAM)常用方法。相较于卡尔曼滤波,无迹卡尔曼滤波(UKF)无须对复杂的非线性函数进行雅可比矩阵运算。本文基于无迹卡尔曼滤波,根据先验协方差的平方根选择sigma点,计算协方差以及加权均值。用四元数表示姿态,将四元数矢量转换为旋转空间进行矩阵运算,在此基础上设计了一种位姿估计算法——基于四元数平方根的无迹卡尔曼滤波(QSR-UKF)算法。试验将EKF、QSR-UKF、SR-UKFEKF 3种算法的位姿估计结果进行仿真分析,并通过相关定量指标进行了描述,验证了本文算法的有效性。     

Adaptive GPS/INS integration for relative navigation

Relative navigation based on GPS receivers and inertial measurement units is required in many applications including formation flying, collision avoidance, cooperative positioning, and accident monitoring. Since sensors are mounted on different vehicles which are moving independently, sensor errors are more variable in relative navigation than in single-vehicle navigation due to different vehicle dynamics and signal environments. In order to improve the robustness against sensor error variability in relative navigation, we present an efficient adaptive GPS/INS integration method. In the proposed method, the covariances of GPS and inertial measurements are estimated separately by the innovations of two fundamentally different filters. One is the position-domain carrier-smoothed-code filter and the other is the velocity-aided Kalman filter. By the proposed two-filter adaptive estimation method, the covariance estimation of the two sensors can be isolated effectively since each filter estimates its own measurement noise. Simulation and experimental results demonstrate that the proposed method improves relative navigation accuracy by appropriate noise covariance estimation.     

基于抗差EKF的GNSS/INS紧组合算法研究

提出了GNSS/INS紧组合导航的抗差EKF算法,采用21状态GNSS/INS紧组合状态方程,根据多余观测分量及预测残差统计构造抗差等价增益矩阵,建立抗差EKF算法,通过迭代给出GNSS/INS组合导航的抗差解,并开发GNSS/INS紧组合导航模拟平台,通过对观测值加入单粗差、多粗差及缓慢增长三类误差,测试本文算法对不同粗差的抑制能力。分析表明,抗差EKF可以将三类粗差抑制在相应观测值的残差中,达到削弱其对状态参数估计的影响。本文算例证明,抗差EKF算法可将导航解的误差精度从dm级提高为cm级甚至mm级,导航精度及可靠性得到明显提高。     

GPS/INS组合导航系统抗差滤波器设计

常规Ｋａｌｍａｎ滤波器已经广泛用于ＧＰＳ／ＩＮＳ组合导航系统,其中假设系统动态模型和噪声统计特性是精确已知的。事实上,这种假设是不符合实际情况的。在组合导航系统中,惯性测量器件的质量不稳定,ＧＰＳ测量误差受外界环境的影响,因而对组合导航系统进行抗差设计是十分必要的。本文利用对策论设计了能使不确定噪声下性能最好的极小极大抗差滤波器,并将其应用到ＧＰＳ／ＩＮＳ组合导航系统中。考虑一个ＩＯ状态的ＧＰＳ／