UWB/MEMS IMU integrated positioning method based on NLOS angle discrimination and MAP constraints.

A dynamic nonline-of-sight (NLOS) angle discrimination method is proposed to address the insufficiency of current research on the NLOS error characteristics of ultrawideband (UWB) signals in dynamic environments as well as the problem that UWB signals frequently suffer from occlusion, leading to poor or impossible localization. The experimental results indicate that the degree of UWB signal occlusion increases as the horizontal angle decreases, and when the horizontal angle is less than 167°, the UWB ranging error is so large that no ranging value is available. On this basis, a tightly integrated UWB/MEMS IMU positioning algorithm incorporating NLOS angle discrimination and map constraints is proposed; it employs horizontal angles to discriminate UWB ranging values in NLOS environments in accordance with the dynamic NLOS characteristics of UWB signals to assign better weights to UWB observations. Through comparative analysis of the results from both groups of experiments, the algorithm achieved northward, eastward, and planar positioning errors of 0.189 m and 0.126 m, 0.119 m and 0.134 m, 0.243 m and 0.211 m, respectively. Compared to the Robust Adaptive Kalman Filtering algorithm, the positional accuracy in the plane improved by 22.9% and 28.5%, respectively.

Robust Attitude Estimation for Low-Dynamic Vehicles Based on MEMS-IMU and External Acceleration Compensation.

Attitude determination based on a micro-electro-mechanical system inertial measurement unit (MEMS-IMU) has attracted extensive attention. The non-gravitational components of the MEMS-IMU have a significant effect on the accuracy of attitude estimation. To improve the attitude estimation of low-dynamic vehicles under uneven soil conditions or vibrations, a robust Kalman filter (RKF) was developed and tested in this paper, where the noise covariance was adaptively changed to compensate for the external acceleration of the vehicle. The state model for MEMS-IMU attitude estimation was initially constructed using a simplified direction cosine matrix. Subsequently, the variance of unmodeled external acceleration was estimated online based on filtering innovations of different window lengths, where the acceleration disturbance was addressed by tradeoffs in time-delay and prescribed computation cost. The effectiveness of the RKF was validated through experiments using a three-axis turntable, an automatic vehicle, and a tractor tillage test. The turntable experiment demonstrated that the angle result of the RKF was 0.051° in terms of root mean square error (RMSE), showing improvements of 65.5% and 29.2% over a conventional KF and MTi-300, respectively. The dynamic attitude estimation of the automatic vehicle showed that the RKF achieves smoother pitch angles than the KF when the vehicle passes over speed bumps at different speeds; the RMSE of pitch was reduced from 0.875° to 0.460° and presented a similar attitude trend to the MTi-300. The tractor tillage test indicated that the RMSE of plough pitch was improved from 0.493° with the KF to 0.259° with the RKF, an enhancement of approximately 47.5%, illustrating the superiority of the RKF in suppressing the external acceleration disturbances of IMU-based attitude estimation.

Application of Adaptive Robust Kalman Filter Base on MCC for SINS/GPS Integrated Navigation.

In this paper, an adaptive and robust Kalman filter algorithm based on the maximum correntropy criterion (MCC) is proposed to solve the problem of integrated navigation accuracy reduction, which is caused by the non-Gaussian noise and time-varying noise of GPS measurement in complex environment. Firstly, the Grubbs criterion was used to remove outliers, which are contained in the GPS measurement. Then, a fixed-length sliding window was used to estimate the decay factor adaptively. Based on the fixed-length sliding window method, the time-varying noises, which are considered in integrated navigation system, are addressed. Moreover, a MCC method is used to suppress the non-Gaussian noises, which are generated with external corruption. Finally, the method, which is proposed in this paper, is verified by the designed simulation and field tests. The results show that the influence of the non-Gaussian noise and time-varying noise of the GPS measurement is detected and isolated by the proposed algorithm, effectively. The navigation accuracy and stability are improved.

A Polar Robust Kalman Filter Algorithm for DVL-Aided SINSs Based on the Ellipsoidal Earth Model.

Autonomous underwater vehicles (AUVs) play an increasingly essential role in the field of polar ocean exploration, and the Doppler velocity log (DVL)-aided strapdown inertial navigation system (SINS) is widely used for it. Due to the rapid convergence of the meridians, traditional inertial navigation mechanisms fail in the polar region. To tackle this problem, a transverse inertial navigation mechanism based on the earth ellipsoidal model is designed in this paper. Influenced by the harsh environment of the polar regions, unknown and time-varying outlier noise appears in the output of DVL, which makes the performance of the standard Kalman filter degrade. To address this issue, a robust Kalman filter algorithm based on Mahalanobis distance is used to adaptively estimate measurement noise covariance; thus, the Kalman filter gain can be modified to weight the measurement. A trial ship experiment and semi-physical simulation experiment were carried out to verify the effectiveness of the proposed algorithm. The results demonstrate that the proposed algorithm can effectively resist the influence of DVL outliers and improve positioning accuracy.

Sequential Covariance Intersection Fusion Robust Time-Varying Kalman Filters with Uncertainties of Noise Variances for Advanced Manufacturing.

This paper addresses the robust Kalman filtering problem for multisensor time-varying systems with uncertainties of noise variances. Using the minimax robust estimation principle, based on the worst-case conservative system with the conservative upper bounds of noise variances, the robust local time-varying Kalman filters are presented. Further, the batch covariance intersection (BCI) fusion and a fast sequential covariance intersection (SCI) fusion robust time-varying Kalman filters are presented. They have the robustness that the actual filtering error variances or their traces are guaranteed to have a minimal upper bound for all admissible uncertainties of noise variances. Their robustness is proved based on the proposed Lyapunov equations approach. The concepts of the robust and actual accuracies are presented, and the robust accuracy relations are proved. It is also proved that the robust accuracies of the BCI and SCI fusers are higher than that of each local Kalman filter, the robust accuracy of the BCI fuser is higher than that of the SCI fuser, and the actual accuracies of each robust Kalman filter are higher than its robust accuracy for all admissible uncertainties of noise variances. The corresponding steady-state robust local and fused Kalman filters are also presented for multisensor time-invariant systems, and the convergence in a realization between the local and fused time-varying and steady-state Kalman filters is proved by the dynamic error system analysis (DESA) method and dynamic variance error system analysis (DVESA) method. A simulation example is given to verify the robustness and the correctness of the robust accuracy relations.

Radar Target Tracking for Unmanned Surface Vehicle Based on Square Root Sage-Husa Adaptive Robust Kalman Filter.

Dynamic information such as the position and velocity of the target detected by marine radar is frequently susceptible to external measurement white noise generated by the oscillations of an unmanned surface vehicle (USV) and target. Although the Sage-Husa adaptive Kalman filter (SHAKF) has been applied to the target tracking field, the precision and stability of SHAKF remain to be improved. In this paper, a square root Sage-Husa adaptive robust Kalman filter (SR-SHARKF) algorithm together with the constant jerk model is proposed, which can not only solve the problem of filtering divergence triggered by numerical rounding errors, inaccurate system mathematics, and noise statistical models, but also improve the filtering accuracy. First, a novel square root decomposition method is proposed in the SR-SHARKF algorithm for decomposing the covariance matrix of SHAKF to assure its non-negative definiteness. After that, a three-segment approach is adopted to balance the observed and predicted states by evaluating the adaptive scale factor. Finally, the unbiased and the biased noise estimators are integrated while the interval scope of the measurement noise is constrained to jointly evaluate the measurement and observation noise for better adaptability and reliability. Simulation and experimental results demonstrate the effectiveness of the proposed algorithm in eliminating white noise triggered by the USV and target oscillations.

Study on Multi-GNSS Precise Point Positioning Performance with Adverse Effects of Satellite Signals on Android Smartphone.

The emergence of dual frequency global navigation satellite system (GNSS) chip actively promotes the progress of precise point positioning (PPP) technology in Android smartphones. However, some characteristics of GNSS signals on current smartphones still adversely affect the positioning accuracy of multi-GNSS PPP. In order to reduce the adverse effects on positioning, this paper takes Huawei Mate30 as the experimental object and presents the analysis of multi-GNSS observations from the aspects of carrier-to-noise ratio, cycle slip, gradual accumulation of phase error, and pseudorange residual. Accordingly, we establish a multi-GNSS PPP mathematical model that is more suitable for GNSS observations from a smartphone. The stochastic model is composed of GNSS step function variances depending on carrier-to-noise ratio, and the robust Kalman filter is applied to parameter estimation. The multi-GNSS experimental results show that the proposed PPP method can significantly reduce the effect of poor satellite signal quality on positioning accuracy. Compared with the conventional PPP model, the root mean square (RMS) of GPS/BeiDou (BDS)/GLONASS static PPP horizontal and vertical errors in the initial 10 min decreased by 23.71% and 62.06%, respectively, and the horizontal positioning accuracy reached 10 cm within 100 min. Meanwhile, the kinematic PPP maximum three-dimensional positioning error of GPS/BDS/GLONASS decreased from 16.543 to 10.317 m.

A Novel MEMS Gyro North Finder Design Based on the Rotation Modulation Technique.

Gyro north finders have been widely used in maneuvering weapon orientation, oil drilling and other areas. This paper proposes a novel Micro-Electro-Mechanical System (MEMS) gyroscope north finder based on the rotation modulation (RM) technique. Two rotation modulation modes (static and dynamic modulation) are applied. Compared to the traditional gyro north finders, only one single MEMS gyroscope and one MEMS accelerometer are needed, reducing the total cost since high-precision gyroscopes and accelerometers are the most expensive components in gyro north finders. To reduce the volume and enhance the reliability, wireless power and wireless data transmission technique are introduced into the rotation modulation system for the first time. To enhance the system robustness, the robust least square method (RLSM) and robust Kalman filter (RKF) are applied in the static and dynamic north finding methods, respectively. Experimental characterization resulted in a static accuracy of 0.66° and a dynamic repeatability accuracy of 1°, respectively, confirming the excellent potential of the novel north finding system. The proposed single gyro and single accelerometer north finding scheme is universal, and can be an important reference to both scientific research and industrial applications.

A Coarse Alignment Method Based on Digital Filters and Reconstructed Observation Vectors.

In this paper, a coarse alignment method based on apparent gravitational motion is proposed. Due to the interference of the complex situations, the true observation vectors, which are calculated by the apparent gravity, are contaminated. The sources of the interference are analyzed in detail, and then a low-pass digital filter is designed in this paper for eliminating the high-frequency noise of the measurement observation vectors. To extract the effective observation vectors from the inertial sensors' outputs, a parameter recognition and vector reconstruction method are designed, where an adaptive Kalman filter is employed to estimate the unknown parameters. Furthermore, a robust filter, which is based on Huber's M-estimation theory, is developed for addressing the outliers of the measurement observation vectors due to the maneuver of the vehicle. A comprehensive experiment, which contains a simulation test and physical test, is designed to verify the performance of the proposed method, and the results show that the proposed method is equivalent to the popular apparent velocity method in swaying mode, but it is superior to the current methods while in moving mode when the strapdown inertial navigation system (SINS) is under entirely self-contained conditions.

A Tightly-Coupled GPS/INS/UWB Cooperative Positioning Sensors System Supported by V2I Communication.

This paper investigates a tightly-coupled Global Position System (GPS)/Ultra-Wideband (UWB)/Inertial Navigation System (INS) cooperative positioning scheme using a Robust Kalman Filter (RKF) supported by V2I communication. The scheme proposes a method that uses range measurements of UWB units transmitted among the terminals as augmentation inputs of the observations. The UWB range inputs are used to reform the GPS observation equations that consist of pseudo-range and Doppler measurements and the updated observation equation is processed in a tightly-coupled GPS/UWB/INS integrated positioning equation using an adaptive Robust Kalman Filter. The result of the trial conducted on the roof of the Nottingham Geospatial Institute (NGI) at the University of Nottingham shows that the integrated solution provides better accuracy and improves the availability of the system in GPS denied environments. RKF can eliminate the effects of gross errors. Additionally, the internal and external reliabilities of the system are enhanced when the UWB observables received from the moving terminals are involved in the positioning algorithm.