In this paper, adaptive sensor fusion INS/GNSS is proposed to solve specific problem of non linear time variant state space estimation with measurement outliers, different algorithms are used to solve this specific pr...In this paper, adaptive sensor fusion INS/GNSS is proposed to solve specific problem of non linear time variant state space estimation with measurement outliers, different algorithms are used to solve this specific problem generally occurs in intentional and non-intentional interferences caused by other radio navigation sources, or by the GNSS receiver’s deterioration. Non linear approximation techniques such as Extended Kalman filter EKF, Sigma Point Kalman Filters such as UKF and CDKF are computed to estimate the navigation states for UAV flight control. Several comparisons are conduced and analyzed in order to compare the accuracy and the convergence of different approaches usually applied in navigation data fusion purposes. The last non linear filter algorithm developed is the Cubature Kalman Filter CKF which provides more accurate estimation with more stability in Tracking data fusion application. In this work, CKF is compared with SPKF and EKF in ideal conditions and during GNSS outliers supposed to occur during specific interval of time, innovation based adaptive approach is selected and used to modify the covariance calculation of the non linear filters performed in this paper. Interesting results are observed, discussed with real perspectives in navigation data fusion for real time applications. Three parallel modified algorithms are simulated and compared to non-adaptive forms according to Root Mean Square Error (RMSE) criteria.展开更多
Sigma-Point Kalman Filters (SPKFs) are popular estimation techniques for high nonlinear system applications. The benefits of using SPKFs include (but not limited to) the following: the easiness of linearizing the nonl...Sigma-Point Kalman Filters (SPKFs) are popular estimation techniques for high nonlinear system applications. The benefits of using SPKFs include (but not limited to) the following: the easiness of linearizing the nonlinear matrices statistically without the need to use the Jacobian matrices, the ability to handle more uncertainties than the Extended Kalman Filter (EKF), the ability to handle different types of noise, having less computational time than the Particle Filter (PF) and most of the adaptive techniques which makes it suitable for online applications, and having acceptable performance compared to other nonlinear estimation techniques. Therefore, SPKFs are a strong candidate for nonlinear industrial applications, i.e. robotic arm. Controlling a robotic arm is hard and challenging due to the system nature, which includes sinusoidal functions, and the dependency on the sensors’ number, quality, accuracy and functionality. SPKFs provide with a mechanism that reduces the latter issue in terms of numbers of required sensors and their sensitivity. Moreover, they could handle the nonlinearity for a certain degree. This could be used to improve the controller quality while reducing the cost. In this paper, some SPKF algorithms are applied to 4-DOF robotic arm that consists of one prismatic joint and three revolute joints (PRRR). Those include the Unscented Kalman Filter (UKF), the Cubature Kalman Filter (CKF), and the Central Differences Kalman Filter (CDKF). This study gives a study of those filters and their responses, stability, robustness, computational time, complexity and convergences in order to obtain the suitable filter for an experimental setup.展开更多
Recently there have been researches about new efficient nonlinear filtering techniques in which the nonlinear filters generalize elegantly to nonlinear systems without the burdensome lineafization steps. Thus, truncat...Recently there have been researches about new efficient nonlinear filtering techniques in which the nonlinear filters generalize elegantly to nonlinear systems without the burdensome lineafization steps. Thus, truncation errors due to linearization can be compensated. These filters include the unscented Kalman filter （UKF）, the central difference filter （CDF） and the divided difference filter （DDF）, and they are also called Sigma Point Filters （SPFs） in a unified way. For higher order approximation of the nonlinear function. Ito and Xiong introduced an algorithm called the Gauss Hermite Filter, which is revisited in [5]. The Gauss Hermite Filter gives better approximation at the expense of higher computation burden, although it＇s less than the particle filter. The Gauss Hermite Filter is used as introduced in [5] with additional pruning step by adding threshold for the weights to reduce the quadrature points.展开更多
文摘In this paper, adaptive sensor fusion INS/GNSS is proposed to solve specific problem of non linear time variant state space estimation with measurement outliers, different algorithms are used to solve this specific problem generally occurs in intentional and non-intentional interferences caused by other radio navigation sources, or by the GNSS receiver’s deterioration. Non linear approximation techniques such as Extended Kalman filter EKF, Sigma Point Kalman Filters such as UKF and CDKF are computed to estimate the navigation states for UAV flight control. Several comparisons are conduced and analyzed in order to compare the accuracy and the convergence of different approaches usually applied in navigation data fusion purposes. The last non linear filter algorithm developed is the Cubature Kalman Filter CKF which provides more accurate estimation with more stability in Tracking data fusion application. In this work, CKF is compared with SPKF and EKF in ideal conditions and during GNSS outliers supposed to occur during specific interval of time, innovation based adaptive approach is selected and used to modify the covariance calculation of the non linear filters performed in this paper. Interesting results are observed, discussed with real perspectives in navigation data fusion for real time applications. Three parallel modified algorithms are simulated and compared to non-adaptive forms according to Root Mean Square Error (RMSE) criteria.
文摘Sigma-Point Kalman Filters (SPKFs) are popular estimation techniques for high nonlinear system applications. The benefits of using SPKFs include (but not limited to) the following: the easiness of linearizing the nonlinear matrices statistically without the need to use the Jacobian matrices, the ability to handle more uncertainties than the Extended Kalman Filter (EKF), the ability to handle different types of noise, having less computational time than the Particle Filter (PF) and most of the adaptive techniques which makes it suitable for online applications, and having acceptable performance compared to other nonlinear estimation techniques. Therefore, SPKFs are a strong candidate for nonlinear industrial applications, i.e. robotic arm. Controlling a robotic arm is hard and challenging due to the system nature, which includes sinusoidal functions, and the dependency on the sensors’ number, quality, accuracy and functionality. SPKFs provide with a mechanism that reduces the latter issue in terms of numbers of required sensors and their sensitivity. Moreover, they could handle the nonlinearity for a certain degree. This could be used to improve the controller quality while reducing the cost. In this paper, some SPKF algorithms are applied to 4-DOF robotic arm that consists of one prismatic joint and three revolute joints (PRRR). Those include the Unscented Kalman Filter (UKF), the Cubature Kalman Filter (CKF), and the Central Differences Kalman Filter (CDKF). This study gives a study of those filters and their responses, stability, robustness, computational time, complexity and convergences in order to obtain the suitable filter for an experimental setup.
文摘Recently there have been researches about new efficient nonlinear filtering techniques in which the nonlinear filters generalize elegantly to nonlinear systems without the burdensome lineafization steps. Thus, truncation errors due to linearization can be compensated. These filters include the unscented Kalman filter （UKF）, the central difference filter （CDF） and the divided difference filter （DDF）, and they are also called Sigma Point Filters （SPFs） in a unified way. For higher order approximation of the nonlinear function. Ito and Xiong introduced an algorithm called the Gauss Hermite Filter, which is revisited in [5]. The Gauss Hermite Filter gives better approximation at the expense of higher computation burden, although it＇s less than the particle filter. The Gauss Hermite Filter is used as introduced in [5] with additional pruning step by adding threshold for the weights to reduce the quadrature points.
