Free-walking:Pedestrian inertial navigation based on dual foot-mounted IMU

The inertial navigation system(INS),which is frequently used in emergency rescue operations and other situations,has the benefits of not relying on infrastructure,high positioning frequency,and strong real-time performance.However,the intricate and unpredictable pedestrian motion patterns lead the INS localization error to significantly diverge with time.This paper aims to enhance the accuracy of zero-velocity interval(ZVI)detection and reduce the heading and altitude drift of foot-mounted INS via deep learning and equation constraint of dual feet.Aiming at the observational noise problem of low-cost inertial sensors,we utilize a denoising autoencoder to automatically eliminate the inherent noise.Aiming at the problem that inaccurate detection of the ZVI detection results in obvious displacement error,we propose a sample-level ZVI detection algorithm based on the U-Net neural network,which effectively solves the problem of mislabeling caused by sliding windows.Aiming at the problem that Zero-Velocity Update(ZUPT)cannot suppress heading and altitude error,we propose a bipedal INS method based on the equation constraint and ellipsoid constraint,which uses foot-to-foot distance as a new observation to correct heading and altitude error.We conduct extensive and well-designed experiments to evaluate the performance of the proposed method.The experimental results indicate that the position error of our proposed method did not exceed 0.83% of the total traveled distance.

GNSS/SINS/视觉导航鲁棒算法

全球导航卫星系统(Global Navigation Satellite System, GNSS)、捷联惯性导航系统(Strapdown Inertial Navigation System, SINS)和视觉传感器优势互补,3者信息融合可获得高精度、无漂移的导航定位信息.针对GNSS/SINS/视觉融合导航易受运动速度、光照变化、遮挡等影响导致定位精度和鲁棒性降低问题,本文在图优化框架的代价函数中加入SoftLOne鲁棒核函数,设置量测值粗差检验程序,降低离群点带来的负面影响.进一步,对量测值计算残差进行卡方检验,对超限残差降权处理,提高系统精度和鲁棒性.实验结果表明,本文算法较不施加鲁棒核函数、不采用异常值剔除策略和卡方检验的传统算法,以及加入其他鲁棒核函数的算法精度更高、鲁棒性更好,能够较大程度提升GNSS/SINS/视觉导航定位精度和鲁棒性,在大尺度环境下,未出现较大漂移误差,绝对位姿均方根误差0.735 m,绝对位姿误差标准差0.336 m.

两种双矢量SINS粗对准方法大俯仰角适应性研究

大俯仰角下捷联惯导粗对准双矢量定姿中,不同矢量组合下,姿态角尤其是方位角对准精确度相差很大,必须慎重选择。对此,给出了2种最常用的粗对准矢量组合模式误差方程,对其主要误差影响因素进行分析。综合传感器误差,利用蒙特卡洛随机打靶方法对全姿态角下粗对准精确度进行仿真,并开展了80°俯仰角转台静态粗对准试验。转台试验中,在惯导陀螺误差约1°/h,加速度计误差约0.1mg情况下,第1种、第2种组合模式方位角粗对准最大误差值分别为20°、7.5°,第2种组合模式约为第1种的1/3;仿真测试中,在惯导陀螺误差约0.1°/h,加速度计误差约1mg,80°俯仰角下,第1种、第2种组合模式下方位角粗对准最大误差值分别为11°与2.2°,前者约为后者的5倍。仿真与试验结果表明,大俯仰角下矢量组合模式是影响惯导姿态角与姿态矩阵粗对准精确度的最主要因素。

一种基于深度学习辅助的SINS/DVL组合导航方法

水下机器人(autonomous underwater vehicle,AUV)导航定位精度一定上程度影响了AUV的工作效率,由于GNSS无法在水下使用,以捷联惯导系统/多普勒计程仪(SINS/DVL)的组合导航系统受到众多青睐。DVL在部分情况下会失效,若直接将DVL隔离,系统将变为纯惯性导航系统,严重影响导航定位的精度。为了应对DVL在部分波束缺失的情况,提出了一种DLinear-informer辅助组合导航算法。通过DLinear对原始输入数据特有的分解方式,增强了算法对AUV非线性信息的提取与学习,提高了速度预测精度。实验结果表明:所提算法能够准确预测DVL失效期间丢失波束的速度,降低组合导航的位置误差,提高了系统的鲁棒性和定位精度。

An improved computation scheme of strapdown inertial navigation system using rotation technique

To improve the accuracy of strapdown inertial navigation system(SINS) for long term applications,the rotation technique is employed to modulate the errors of the inertial sensors into periodically varied signals,and,as a result,to suppress the divergence of SINS errors.However,the errors of rotation platform will be introduced into SINS and might affect the final navigation accuracy.Considering the disadvantages of the conventional navigation computation scheme,an improved computation scheme of the SINS using rotation technique is proposed which can reduce the effects of the rotation platform errors.And,the error characteristics of the SINS with this navigation computation scheme are analyzed.Theoretical analysis,simulations and real test results show that the proposed navigation computation scheme outperforms the conventional navigation computation scheme,meanwhile reduces the requirement to the measurement accuracy of rotation angles.

A Quaternion Scaled Unscented Kalman Estimator for Inertial Navigation States Determination Using INS/GPS/Magnetometer Fusion

This Inertial Navigation System (INS), Global Positioning System (GPS) and fluxgate magnetometer technologies have been widely used in a variety of positioning and navigation applications. In this paper, a low cost solid state INS/GPS/Magnetometer integrated navigation system has been developed that incorporates measurements from an Inertial Navigation System (INS), Global Positioning System (GPS) and fluxgate magnetometer (Mag.) to provide a reliable complete navigation solution at a high output rate. The body attitude estimates, especially the heading angle, are fundamental challenges in a navigation system. Therefore targeting accurate attitude estimation is considered a significant contribution to the overall navigation error. A better estimation of the body attitude estimates leads to more accurate position and velocity estimation. For that end, the aim of this research is to exploit the magnetometer and accelerometer data in the attitude estimation technique. In this paper, a Scaled Unscented Kalman Filter (SUKF) based on the quaternion concept is designed for the INS/GPS/Mag integrated navigation system under large attitude error conditions. Simulation and experimental results indicate a satisfactory performance of the newly developed model.

ROTATING FIBER OPTIC GYRO STRAP-DOWN INERTIAL NAVIGATION SYSTEM WITH THREE ROTATING AXES

The principle of the inertial navigation system（INS） with rotating inertial measurement unit （IMU） is analyzed. A new IMU is established to rotate round each axis in three directions. Then, the related error models for the designed system during rotating are deduced and the improved system is built. Finally, the performance simulation of the proposed system is provided. The simulation result indicates that the designed system can improve the accuracy of the roll and the pitch as well as heading by rotating three axes, thus guaranting the heading accuracy. Moreover, based on the principle of rotation at six different positions, such structure can carry out real-time calibration, and improve the system performance.

Error Analysis and Compensation of Strapdown Inertial Navigation System

Based on error analysis, the influence of error sources on strapdown inertial navigation systems is discussed. And the maximum permissible component tolerances are established. In order to achieve the desired accuracy (defined by circular error probability), the types of appropriate sensors are chosen. The inertial measurement unit (IMU) is composed of those sensors. It is necessary to calibrate the sensors to obtain their error model coefficients of IMU. After calibration tests, the accuracy is calculated by uniform design method and it is proved that the accuracy of IMU is satisfied for the desired goal.

Ground Alignment of Inertial Navigation System with the Aid of GPS Signals

Due to the poor observability of INS ground self alignment, only horizontal alignment is satisfied. This paper proposes using GPS double difference carrier phase as external reference to improve the observability of INS self alignment. Through observability analysis and computer simulation, it is demonstrated that the azimuth alignment is as quick as horizontal alignment, the accuracy of horizontal alignment is improved, and the gyros errors can be estimated quickly and precisely.

DESIGN AND REALIZATION OF SINS/TWO-ANTENNA GPS INTEGRATED NAVIGATION SYSTEM

The strapdown inertial navigation system （SINS）/two-antenna GPS integrated navigation system is discussed. Corresponding error and the measurement models are built, especially the double differenced GPS carrier phase model. The extended Kalman filtering is proposed. And the hardware composition and connection are designed to simulate the SINS/two-antenna GPS integrated navigation system. Results show that the performances of the system, the precision of the navigation and the positioning, the reliability and the practicability are im proved.

一种重力梯度/SINS/星光组合导航方法

为提高飞行器导航系统的精度和自主性,提出了一种重力梯度/捷联惯导(SINS)/星光组合导航方法。在该组合导航系统中,利用重力梯度信息修正SINS的位置误差,利用星光信息修正SINS的姿态误差,提高飞行器的导航精度和自主性。为了弥补传统容积卡尔曼滤波(CKF)算法滤波精度不高的缺点,采用随机加权容积卡尔曼滤波(RWCKF)算法,设计重力梯度/SINS/星光组合导航系统。仿真结果表明,SINS/星光组合导航系统、重力梯度/SINS组合导航系统、合成孔径雷达(SAR)/SINS/星光组合导航系统和提出的重力梯度/SINS/星光自主组合导航系统的定位误差分别为78.1003 m、54.3399 m、39.2776 m和19.8495 m,证明了提出的重力梯度/SINS/星光自主组合导航系统的精度不仅远高于两个子系统,也高于SAR/SINS/星光组合导航系统。

卡尔曼滤波器异常自检及其在SINS初始对准中的应用

卡尔曼滤波器是惯性导航系统初始对准和组合导航问题中的常用工具。针对滤波时系统噪声和观测噪声异常导致的滤波精度下降甚至发散问题,从理论上分析了基于新息协方差匹配和马氏距离卡方检验的两种滤波器异常检验判据,结合判据在传统卡尔曼滤波、无迹卡尔曼滤波和容积卡尔曼滤波中的典型应用,设计了针对捷联式惯性导航系统初始对准问题的测试实验,实验结果表明两种判据对滤波器系统噪声和观测噪声异常都有一定的检验能力,但检验判据严格程度存在不同且判据存在拖尾效应,由此给出了在实践应用中的建议。

DVL/SINS松紧组合的等价性分析及改进的虚拟波束辅助紧组合算法

系统地研究了不同波束可用情况下的多普勒计程仪(Doppler velocity logger,DVL)/捷联惯性导航系统(strapdown inertial navigation system,SINS)紧组合导航算法。证明了3个或4个波束可用情况下,DVL/SINS波束域紧组合的定位精度与三维速度松组合系统具有等价性,并给出了松组合中量测协方差阵的确定方法。针对紧组合系统定位精度随可用波束减少而降低的问题,考虑DVL的误差参数,基于载体运动约束和压力深度计提出一种改进的虚拟波束辅助紧组合算法。实验结果表明,3个或4个波束可用时的松组合与紧组合的定位精度等价;改进的虚拟波束辅助紧组合算法可以准确跟踪故障的波束速度,有效提升了不同波束可用情况下紧组合的定位精度。

Study on rate azimuth platform inertial navigation system

The cost of the gravity passive inertial navigation system will be lower witha rate azimuth platform and gravity sensor constituting a gravity measurement and navigationsystem. According to the system performance characteristics, we study the rate azimuth platforminertial navigation system (RAPINS), give the system navigation algorithm, error equations of theattitude, velocity and position of the rate azimuth platform, and random error models of theaccelerometer and gyro. Using the MATLAB/Simulink tools, we study the RAPINS and RAPINS withvelocity damping. Simulation results demonstrate that the RAPINS with velocity damping has smallerrors in platform attitude and position and satisfies gravity measurement and navigationrequirement.

Method of improving pedestrian navigation performance based on chest card

With the development of positioning technology,loca-tion services are constantly in demand by people.As a primary location service pedestrian navigation has two main approaches based on radio and inertial navigation.The pedestrian naviga-tion based on radio is subject to environmental occlusion lead-ing to the degradation of positioning accuracy.The pedestrian navigation based on micro-electro-mechanical system inertial measurement unit(MIMU)is less susceptible to environmental interference,but its errors dissipate over time.In this paper,a chest card pedestrian navigation improvement method based on complementary correction is proposed in order to suppress the error divergence of inertial navigation methods.To suppress atti-tude errors,optimal feedback coefficients are established by pedestrian motion characteristics.To extend navigation time and improve positioning accuracy,the step length in subsequent movements is compensated by the first step length.The experi-mental results show that the positioning accuracy of the pro-posed method is improved by more than 47%and 44%com-pared with the pure inertia-based method combined with step compensation and the traditional complementary filtering com-bined method with step compensation.The proposed method can effectively suppress the error dispersion and improve the positioning accuracy.

A data and physical model dual-driven based trajectory estimator for long-term navigation

Long-term navigation ability based on consumer-level wearable inertial sensors plays an essential role towards various emerging fields,for instance,smart healthcare,emergency rescue,soldier positioning et al.The performance of existing long-term navigation algorithm is limited by the cumulative error of inertial sensors,disturbed local magnetic field,and complex motion modes of the pedestrian.This paper develops a robust data and physical model dual-driven based trajectory estimation(DPDD-TE)framework,which can be applied for long-term navigation tasks.A Bi-directional Long Short-Term Memory(Bi-LSTM)based quasi-static magnetic field(QSMF)detection algorithm is developed for extracting useful magnetic observation for heading calibration,and another Bi-LSTM is adopted for walking speed estimation by considering hybrid human motion information under a specific time period.In addition,a data and physical model dual-driven based multi-source fusion model is proposed to integrate basic INS mechanization and multi-level constraint and observations for maintaining accuracy under long-term navigation tasks,and enhanced by the magnetic and trajectory features assisted loop detection algorithm.Real-world experiments indicate that the proposed DPDD-TE outperforms than existing algorithms,and final estimated heading and positioning accuracy indexes reaches 5and less than 2 m under the time period of 30 min,respectively.

基于SINS/OD失准角观测的垂线偏差测量方法

组合导航系统的姿态失准角与垂线偏差(deviation of vertical,DOV)存在对应关系,通过对姿态失准角的观测是实现DOV测量的一种有效手段。本文基于车载捷联惯性导航系统/里程计(strapdown inertial navigation system/odometer,SINS/OD)组合导航姿态失准角观测及失准角误差的递推提出一种DOV测量方法。首先,从组合导航速度误差方程出发,推导出DOV与姿态失准角之间存在复杂的耦合关系。然后,通过沿路径迭代递推的分步计算方法,由导航过程中的姿态失准角直接获取沿线的DOV。最后,仿真结果验证了该算法的有效性,且表明测量精度与行驶路径的长度有关。实验表明,行驶里程35 km的机动路径上DOV误差均值小于0.3″,终点处单点测量误差小于0.7″。

模糊自适应Kalman滤波算法在SINS/DR组合导航的应用

针对里程仪测量误差导致组合导航精度降低的问题,提出基于系统工作状态和滤波器新息状态相结合的模糊自适应算法。根据新息的变化确定模糊规则,修正里程仪输出增益,使新息始终保持在零均值附近,利用修正后的新息修正观测噪声方差,降低导航定位的偏差。仿真实验结果证明,该算法能够很好地提高组合导航定位的精度。

基于自适应卡尔曼滤波的RFID/SINS组合导航研究

在室内导航定位中,射频识别(Radio Frequency Identification,RFID)技术具有信号穿透性强、成本低廉等诸多优点,能够有效代替GPS完成室内组合导航。针对室内惯性导航误差发散和滤波中噪声参数不确定的问题,提出了基于自适应卡尔曼滤波(Adaptive Kalman Filtering,AKF)的RFID/SINS组合导航系统,通过RFID定位系统抑制惯性导航误差发散,并应用AKF将噪声参数与量测输出参数关联实现实时更新。对AKF和标准卡尔曼滤波(Kalman Filtering,KF)下的RFID/SINS组合导航系统进行了仿真和实验。结果表明,在AKF下组合导航系统平均定位误差降低了10%,位置稳定性提升了7.4%,定位误差保持在0.07 m左右。基于AKF的RFID/SINS组合导航系统能够满足室内高精度定位导航的需求。

基于双通道Residual-LSTM的SINS/GNSS组合导航算法

针对全球导航卫星系统信号中断情况下SINS/GNSS组合导航系统无法持续进行误差校正的问题,提出一种基于双通道Residual-LSTM的SINS/GNSS组合导航算法。首先,考虑到SINS经度、纬度误差传播特性不同所导致的模型输入、输出信息之间的非线性相关性差异化,构建具有不同权重系数的双通道长短期记忆神经网络模型结构,并引入遗忘信息共享机制自适应地利用历史导航数据对经度、纬度信息进行拟合预测。其次,针对深层神经网络存在的模型退化和梯度消失问题,在多层双通道LSTM网络之间建立残差高速通道形成Residual-LSTM模型结构,以增加不同网络层次之间的信息传播路径。最后,通过实船数据验证本文所提算法的有效性。实验结果表明,与基于常规智能方法的SINS/GNSS组合导航算法相比,所提组合导航算法在GNSS信号中断期间经度误差降低了51.97%,纬度误差降低了31.45%。