For improving the localization accuracy,a multi-interval extended finite impulse response(EFIR)-based Rauch-Tung-Striebel(R-T-S)smoother is proposed for the range-only ultra wide band(UWB)simultaneous localization and...For improving the localization accuracy,a multi-interval extended finite impulse response(EFIR)-based Rauch-Tung-Striebel(R-T-S)smoother is proposed for the range-only ultra wide band(UWB)simultaneous localization and mapping(SLAM)for robot localization.In this mode,the EFIR R-T-S(ERTS)smoother employs EFIR filter as the forward filter and the R-T-S smoothing method to smooth the EFIR filter’s output.When the east or the north position is considered as stance,the ERTS is used to smooth the position directly.Moreover,the estimation of the UWB Reference Nodes’(RNs’)position is smoothed by the R-T-S smooth method in parallel.The test illustrates that the proposedmulti-interval ERTS smoothing for range-only UWB SLAMis able to provide accurate estimation.Compared with the EFIR filter,the proposed method improves the localization accuracy by about 25.35%and 40.66%in east and north directions,respectively.展开更多
A square-root version of the divided difference Rauch-Tung-Striebel (RTS) smoother is proposed in this paper. The square-root variant essentially propagates the square roots of the covariance matrices and can consiste...A square-root version of the divided difference Rauch-Tung-Striebel (RTS) smoother is proposed in this paper. The square-root variant essentially propagates the square roots of the covariance matrices and can consistently improve the numerical stability because all the resulting covariance matrices are guaranteed to stay positive semi-definite. Furthermore, the square-root form ensures reliable implementation in an embedded system with fixed or limited precision although it is algebraically equivalent to the standard form. The new smoothing algorithm is tested in a challenging two-dimensional maneuvering target tracking problem with unknown and time-varying turn rate, and its performance is compared with that of other de-facto standard filters and smoothers. The simulation results indicate that the proposed RTS smoother markedly outperforms the associated filters and gives slightly smaller error than an unscented-based RTS smoother.展开更多
To provide stable and accurate position information of control points in a complex coastal environment,an adaptive iterated extended Kalman filter(AIEKF)for fixed-point positioning integrating global navigation satell...To provide stable and accurate position information of control points in a complex coastal environment,an adaptive iterated extended Kalman filter(AIEKF)for fixed-point positioning integrating global navigation satellite system,inertial navigation system,and ultra wide band(UWB)is proposed.In thismethod,the switched global navigation satellite system(GNSS)and UWB measurement are used as the measurement of the proposed filter.For the data fusion filter,the expectation-maximization(EM)based IEKF is used as the forward filter,then,the Rauch-Tung-Striebel smoother for IEKF filter’s result smoothing.Tests illustrate that the proposed AIEKF is able to provide an accurate estimation.展开更多
In order to meet the higher accuracy requirement of trajectory prediction for Unmanned Aircraft System(UAS)in Unmanned Aircraft System Traffic Management(UTM),an Intent Based Trajectory Prediction and Smooth Based on ...In order to meet the higher accuracy requirement of trajectory prediction for Unmanned Aircraft System(UAS)in Unmanned Aircraft System Traffic Management(UTM),an Intent Based Trajectory Prediction and Smooth Based on Constrained State-dependent-transition Hybrid Estimation(CSDTHE-IBTPS)algorithm is proposed.Firstly,an intent inference method of UAS is constructed based on the information of ADS-B and geofence system.Moreover,a geofence layering algorithm is proposed.Secondly,the Flight Mode Change Points(FMCP)are used to define the relevant mode transition parameters and design the guard conditions,so as to generate the mode transition probability matrix and establish the continuous state-dependent-transition model.After that,the constrained Kalman filter(CKF)is applied to improve State-dependent-transition Hybrid Estimation(SDTHE)algorithm by applying equality constraint to the velocity of UAS in the straight phase and turning phase,respectively,and thus the constrained state-dependent-transition hybrid estimation(CSDTHE)algorithm is constructed.Finally,the results of intent inference and hybrid estimation are used to make trajectory prediction.Furthermore,each flight segment of trajectory is smoothed respectively by Rauch-Tung-Striebel(RTS)backward smooth method using the proposed CSDTHE-RTS algorithm,so as to obtain more accurate trajectory prediction results.The simulation shows that the proposed algorithm can reduce the errors of trajectory prediction and the time delay of intent inference.展开更多
高精度位置姿态系统(POS,Position and Orientation System)是移动成图技术的重要组成部分,其姿态角必须达到很高的精度才能满足需求。为此提出了基于闭环误差控制器的前向Kalman滤波与反向R-T-S最优固定区间平滑相结合的POS后处理算法...高精度位置姿态系统(POS,Position and Orientation System)是移动成图技术的重要组成部分,其姿态角必须达到很高的精度才能满足需求。为此提出了基于闭环误差控制器的前向Kalman滤波与反向R-T-S最优固定区间平滑相结合的POS后处理算法,使得整个处理过程中系统具有很高的线性度,并依据快速性和精度要求设计了闭环误差控制器的控制参数,将系统的误差振荡幅值抑制在很小的范围内。仿真结果表明,该算法不仅可以获得高精度的位置信息,还提高了姿态角精度,是一种高精度的POS后处理算法。展开更多
One crucial issue in particle filtering is the selection of proposal distribution. Good proposal can effectively alleviate particle degeneracy and thus improve filtering accuracy. In this paper, we propose a new type ...One crucial issue in particle filtering is the selection of proposal distribution. Good proposal can effectively alleviate particle degeneracy and thus improve filtering accuracy. In this paper, we propose a new type of proposal distribution for particle filter, called as R-IEKF proposal. By combining iterated extended kalman filter with Rauch-Tung-Striebel optimal smoother, the new proposal integrates the latest observation into system and approximates the true posterior distribution reasonably well, hence generating more precise and stable particles against measurement noise. The simulation results indicate that the improved particle filter with R-IEKF proposal prevails over PF-EKF and UPF both in tracking accuracy and filtering stability. Consequently, PF-RIEKF is a competitive choice in noisy measurement environment.展开更多
文摘For improving the localization accuracy,a multi-interval extended finite impulse response(EFIR)-based Rauch-Tung-Striebel(R-T-S)smoother is proposed for the range-only ultra wide band(UWB)simultaneous localization and mapping(SLAM)for robot localization.In this mode,the EFIR R-T-S(ERTS)smoother employs EFIR filter as the forward filter and the R-T-S smoothing method to smooth the EFIR filter’s output.When the east or the north position is considered as stance,the ERTS is used to smooth the position directly.Moreover,the estimation of the UWB Reference Nodes’(RNs’)position is smoothed by the R-T-S smooth method in parallel.The test illustrates that the proposedmulti-interval ERTS smoothing for range-only UWB SLAMis able to provide accurate estimation.Compared with the EFIR filter,the proposed method improves the localization accuracy by about 25.35%and 40.66%in east and north directions,respectively.
基金the Fundamental Research Fund of Northwestern Polytechnical University( Grant No. JC20120210,JC20110238)
文摘A square-root version of the divided difference Rauch-Tung-Striebel (RTS) smoother is proposed in this paper. The square-root variant essentially propagates the square roots of the covariance matrices and can consistently improve the numerical stability because all the resulting covariance matrices are guaranteed to stay positive semi-definite. Furthermore, the square-root form ensures reliable implementation in an embedded system with fixed or limited precision although it is algebraically equivalent to the standard form. The new smoothing algorithm is tested in a challenging two-dimensional maneuvering target tracking problem with unknown and time-varying turn rate, and its performance is compared with that of other de-facto standard filters and smoothers. The simulation results indicate that the proposed RTS smoother markedly outperforms the associated filters and gives slightly smaller error than an unscented-based RTS smoother.
基金supported in part by the Shandong Natural Science Foundation under Grant ZR2020MF067.
文摘To provide stable and accurate position information of control points in a complex coastal environment,an adaptive iterated extended Kalman filter(AIEKF)for fixed-point positioning integrating global navigation satellite system,inertial navigation system,and ultra wide band(UWB)is proposed.In thismethod,the switched global navigation satellite system(GNSS)and UWB measurement are used as the measurement of the proposed filter.For the data fusion filter,the expectation-maximization(EM)based IEKF is used as the forward filter,then,the Rauch-Tung-Striebel smoother for IEKF filter’s result smoothing.Tests illustrate that the proposed AIEKF is able to provide an accurate estimation.
基金This work was financially supported by the Major Program of National Natural Science Foundation of Chinathe National Natural Science Foundation of China[Grant No.61703427].
文摘In order to meet the higher accuracy requirement of trajectory prediction for Unmanned Aircraft System(UAS)in Unmanned Aircraft System Traffic Management(UTM),an Intent Based Trajectory Prediction and Smooth Based on Constrained State-dependent-transition Hybrid Estimation(CSDTHE-IBTPS)algorithm is proposed.Firstly,an intent inference method of UAS is constructed based on the information of ADS-B and geofence system.Moreover,a geofence layering algorithm is proposed.Secondly,the Flight Mode Change Points(FMCP)are used to define the relevant mode transition parameters and design the guard conditions,so as to generate the mode transition probability matrix and establish the continuous state-dependent-transition model.After that,the constrained Kalman filter(CKF)is applied to improve State-dependent-transition Hybrid Estimation(SDTHE)algorithm by applying equality constraint to the velocity of UAS in the straight phase and turning phase,respectively,and thus the constrained state-dependent-transition hybrid estimation(CSDTHE)algorithm is constructed.Finally,the results of intent inference and hybrid estimation are used to make trajectory prediction.Furthermore,each flight segment of trajectory is smoothed respectively by Rauch-Tung-Striebel(RTS)backward smooth method using the proposed CSDTHE-RTS algorithm,so as to obtain more accurate trajectory prediction results.The simulation shows that the proposed algorithm can reduce the errors of trajectory prediction and the time delay of intent inference.
文摘高精度位置姿态系统(POS,Position and Orientation System)是移动成图技术的重要组成部分,其姿态角必须达到很高的精度才能满足需求。为此提出了基于闭环误差控制器的前向Kalman滤波与反向R-T-S最优固定区间平滑相结合的POS后处理算法,使得整个处理过程中系统具有很高的线性度,并依据快速性和精度要求设计了闭环误差控制器的控制参数,将系统的误差振荡幅值抑制在很小的范围内。仿真结果表明,该算法不仅可以获得高精度的位置信息,还提高了姿态角精度,是一种高精度的POS后处理算法。
基金Sponsored by the National Natural Science Foundation of China (Grant No. 61136002 )Key Project of Chinese Ministry of Education (Grant No.211180)Shannxi Provincial Industrial and Technological Project(Grant No. 2011K06-47)
文摘One crucial issue in particle filtering is the selection of proposal distribution. Good proposal can effectively alleviate particle degeneracy and thus improve filtering accuracy. In this paper, we propose a new type of proposal distribution for particle filter, called as R-IEKF proposal. By combining iterated extended kalman filter with Rauch-Tung-Striebel optimal smoother, the new proposal integrates the latest observation into system and approximates the true posterior distribution reasonably well, hence generating more precise and stable particles against measurement noise. The simulation results indicate that the improved particle filter with R-IEKF proposal prevails over PF-EKF and UPF both in tracking accuracy and filtering stability. Consequently, PF-RIEKF is a competitive choice in noisy measurement environment.