Cubature Kalman Filter Based Millimeter Wave Beam Tracking for OTFS Systems

In this paper,a Millimeter wave(mmWave)beam tracking problem is studied in orthogonal time frequency space(OTFS)systems.Considering the nonlinearity of beamforming and the constraints of existing Kalman-filtering based beam tracking schemes,we propose a novel Cubature Kalman Filter(CKF)framework tracking the channel state information(CSI)to manage the challenge of highspeed channel variation in single-user moving scene for OTFS systems.Aiming for low complexity for mobile settings,this paper trains only one beam pair to track a path to maintain the reliable communication link in the analog beamforming architecture.Simulation results show that our proposed method has better tracking performance to improve the accuracy of the estimated beam angle compared with prior work.

Robust cubature Kalman filter method for the nonlinear alignment of SINS

Nonlinear initial alignment is a significant research topic for strapdown inertial navigation system(SINS).Cubature Kalman filter(CKF)is a popular tool for nonlinear initial alignment.Standard CKF assumes that the statics of the observation noise are pre-given before the filtering process.Therefore,any unpredicted outliers in observation noise will decrease the stability of the filter.In view of this problem,improved CKF method with robustness is proposed.Multiple fading factors are introduced to rescale the observation noise covariance.Then the update stage of the filter can be autonomously tuned,and if there are outliers exist in the observations,the update should be less weighted.Under the Gaussian assumption of KF,the Mahalanobis distance of the innovation vector is supposed to be Chi-square distributed.Therefore a judging index based on Chi-square test is designed to detect the noise outliers,determining whether the fading tune are required.The proposed method is applied in the nonlinear alignment of SINS,and vehicle experiment proves the effective of the proposed method.

Low-cost adaptive square-root cubature Kalman filter forsystems with process model uncertainty

A novel low-cost adaptive square-root cubature Kalmanfilter （LCASCKF） is proposed to enhance the robustness of processmodels while only increasing the computational load slightly.It is well-known that the Kalman filter cannot handle uncertainties ina process model, such as initial state estimation errors, parametermismatch and abrupt state changes. These uncertainties severelyaffect filter performance and may even provoke divergence. Astrong tracking filter （STF）, which utilizes a suboptimal fading factor,is an adaptive approach that is commonly adopted to solvethis problem. However, if the strong tracking SCKF （STSCKF）uses the same method as the extended Kalman filter （EKF） tointroduce the suboptimal fading factor, it greatly increases thecomputational load. To avoid this problem, a low-cost introductorymethod is proposed and a hypothesis testing theory is applied todetect uncertainties. The computational load analysis is performedby counting the total number of floating-point operations and it isfound that the computational load of LCASCKF is close to that ofSCKF. Experimental results prove that the LCASCKF performs aswell as STSCKF, while the increase in computational load is muchlower than STSCKF.

Stochastic convergence analysis of cubature Kalman filter with intermittent observations

The stochastic convergence of the cubature Kalmanfilter with intermittent observations （CKFI） for general nonlinearstochastic systems is investigated. The Bernoulli distributed ran-dom variable is employed to describe the phenomenon of intermit-tent observations. According to the cubature sample principle, theestimation error and the error covariance matrix （ECM） of CKFIare derived by Taylor series expansion, respectively. Afterwards, itis theoretically proved that the ECM will be bounded if the obser-vation arrival probability exceeds a critical minimum observationarrival probability. Meanwhile, under proper assumption corre-sponding with real engineering situations, the stochastic stabilityof the estimation error can be guaranteed when the initial estima-tion error and the stochastic noise terms are sufficiently small. Thetheoretical conclusions are verified by numerical simulations fortwo illustrative examples; also by evaluating the tracking perfor-mance of the optical-electric target tracking system implementedby CKFI and unscented Kalman filter with intermittent observa-tions （UKFI） separately, it is demonstrated that the proposed CKFIslightly outperforms the UKFI with respect to tracking accuracy aswell as real time performance.

Cubature Kalman filters: Derivation and extension

This paper focuses on the cubature Kalman filters （CKFs） for the nonlinear dynamic systems with additive process and measurement noise. As is well known, the heart of the CKF is the third-degree spherical–radial cubature rule which makes it possible to compute the integrals encountered in nonlinear filtering problems. However, the rule not only requires computing the integration over an n-dimensional spherical region, but also combines the spherical cubature rule with the radial rule, thereby making it difficult to construct higher-degree CKFs. Moreover, the cubature formula used to construct the CKF has some drawbacks in computation. To address these issues, we present a more general class of the CKFs, which completely abandons the spherical–radial cubature rule. It can be shown that the conventional CKF is a special case of the proposed algorithm. The paper also includes a fifth-degree extension of the CKF. Two target tracking problems are used to verify the proposed algorithm. The results of both experiments demonstrate that the higher-degree CKF outperforms the conventional nonlinear filters in terms of accuracy.

Cubature Kalman Filter Under Minimum Error Entropy With Fiducial Points for INS/GPS Integration

Traditional cubature Kalman filter(CKF)is a preferable tool for the inertial navigation system(INS)/global positioning system(GPS)integration under Gaussian noises.The CKF,however,may provide a significantly biased estimate when the INS/GPS system suffers from complex non-Gaussian disturbances.To address this issue,a robust nonlinear Kalman filter referred to as cubature Kalman filter under minimum error entropy with fiducial points(MEEF-CKF)is proposed.The MEEF-CKF behaves a strong robustness against complex nonGaussian noises by operating several major steps,i.e.,regression model construction,robust state estimation and free parameters optimization.More concretely,a regression model is constructed with the consideration of residual error caused by linearizing a nonlinear function at the first step.The MEEF-CKF is then developed by solving an optimization problem based on minimum error entropy with fiducial points(MEEF)under the framework of the regression model.In the MEEF-CKF,a novel optimization approach is provided for the purpose of determining free parameters adaptively.In addition,the computational complexity and convergence analyses of the MEEF-CKF are conducted for demonstrating the calculational burden and convergence characteristic.The enhanced robustness of the MEEF-CKF is demonstrated by Monte Carlo simulations on the application of a target tracking with INS/GPS integration under complex nonGaussian noises.

Fuzzy Adaptive Strong Tracking Cubature Kalman Filter

To solve the problem that the choice of softening factor in conventional adaptive strong tracking filter( STF) greatly relies on the experience and computer simulation,a new concept of softening factor matrix is introduced and a fuzzy adaptive strong tracking cubature Kalman filter( FASTCKF) based on fuzzy logic controller is proposed. This method monitors residual absolute mean and standard deviation of each measurement component with fuzzy logic adaptive controller( FLAC),and adjusts the softening factor matrix dynamically by fuzzy rules,which is capable to modify suboptimal fading factor of STF adaptively and improve the filter's robust adaptive capacity. The simulation results show that the improved filtering performance is superior to the conventional square root cubature Kalman filter( SCKF) and the strong tracking square root cubature Kalman filter( STSCKF).

Adaptive cubature Kalman filter based on variational Bayesian inference under measurement uncertainty

A novel variational Bayesian inference based on adaptive cubature Kalman filter(VBACKF)algorithm is proposed for the problem of state estimation in a target tracking system with time-varying measurement noise and random measurement losses.Firstly,the Inverse-Wishart(IW)distribution is chosen to model the covariance matrix of time-varying measurement noise in the cubature Kalman filter framework.Secondly,the Bernoulli random variable is introduced as the judgement factor of the measurement losses,and the Beta distribution is selected as the conjugate prior distribution of measurement loss probability to ensure that the posterior distribution and prior distribution have the same function form.Finally,the joint posterior probability density function of the estimated variables is approximately decoupled by the variational Bayesian inference,and the fixed-point iteration approach is used to update the estimated variables.The simulation results show that the proposed VBACKF algorithm considers the comprehensive effects of system nonlinearity,time-varying measurement noise and unknown measurement loss probability,moreover,effectively improves the accuracy of target state estimation in complex scene.

Dynamic State Estimation for DFIG with Unknown Inputs Based on Cubature Kalman Filter and Adaptive Interpolation

Dynamic state estimation(DSE)accurately tracks the dynamics of power systems and demonstrates the evolution of the system state in real time.This paper proposes a DSE approach for a doubly-fed induction generator(DFIG)with unknown inputs based on adaptive interpolation and cubature Kalman filter(AICKF-UI).DFIGs adopt different control strategies in normal and fault conditions;thus,the existing DSE approaches based on the conventional control model of DFIG are not applicable in all cases.Consequently,the DSE model of DFIGs is reformulated to consider the converter controller outputs as unknown inputs,which are estimated together with the DFIG dynamic states by an exponential smoothing model and augmented-state cubature Kalman filter.Furthermore,as the reporting rate of existing synchro-phasor data is not sufficiently high to capture the fast dynamics of DFIGs,a large estimation error may occur or the DSE approach may diverge.To this end,in this paper,a local-truncation-error-guided adaptive interpolation approach is developed.Extensive simulations conducted on a wind farm and the modified IEEE 39-bus test system show that the proposed AICKF-UI can(1)effectively address the divergence issues of existing cubature Kalman filters while being computationally more efficient;(2)accurately track the dynamic states and unknown inputs of the DFIG;and(3)deal with various types of system operating conditions such as time-varying wind and different system faults.

A novel strong tracking cubature Kalman filter and its application in maneuvering target tracking

The fading factor exerts a significant role in the strong tracking idea. However, traditional fading factor introduction method hinders the accuracy and robustness advantages of current strong-tracking-based nonlinear filtering algorithms such as Cubature Kalman Filter(CKF) since traditional fading factor introduction method only considers the first-order Taylor expansion. To this end, a new fading factor idea is suggested and introduced into the strong tracking CKF method.The new fading factor introduction method expanded the number of fading factors from one to two with reselected introduction positions. The relationship between the two fading factors as well as the general calculation method can be derived based on Taylor expansion. Obvious superiority of the newly suggested fading factor introduction method is demonstrated according to different nonlinearity of the measurement function. Equivalent calculation method can also be established while applied to CKF. Theoretical analysis shows that the strong tracking CKF can extract the thirdorder term information from the residual and thus realize second-order accuracy. After optimizing the strong tracking algorithm process, a Fast Strong Tracking CKF(FSTCKF) is finally established. Two simulation examples show that the novel FSTCKF improves the robustness of traditional CKF while minimizing the algorithm time complexity under various conditions.

Adaptive robust cubature Kalman filtering for satellite attitude estimation

This paper is concerned with the adaptive robust cubature Kalman filtering problem for the case that the dynamics model error and the measurement model error exist simultaneously in the satellite attitude estimation system. By using Hubel-based robust filtering methodology to correct the measurement covariance formulation of cubature Kalman filter, the proposed filtering algorithm could effectively suppress the measurement model error. To further enhance this effect and reduce the impact of the dynamics model error, two different adaptively robust filtering algorithms,one with the optimal adaptive factor based on the estimated covariance matrix of the predicted residuals and the other with multiple fading factors based on strong tracking algorithm, are developed and applied for the satellite attitude estimation. The quaternion is employed to represent the global attitude parameter, and three-dimensional generalized Rodrigues parameters are introduced to define the local attitude error. A multiplicative quaternion error is derived from the local attitude error to maintain quaternion normalization constraint in the filter. Simulation results indicate that the proposed novel algorithm could exhibit higher accuracy and faster convergence compared with the multiplicative extended Kalman filter, the unscented quaternion estimator, and the adaptive robust unscented Kalman filter.

Adaptive Gaussian sum squared-root cubature Kalman filter with split-merge scheme for state estimation

The paper deals with state estimation problem of nonlinear non-Gaussian discrete dynamic systems for improvement of accuracy and consistency. An efficient new algorithm called the adaptive Gaussian-sum square-root cubature Kalman filter（AGSSCKF） with a split-merge scheme is proposed. It is developed based on the squared-root extension of newly introduced cubature Kalman filter（SCKF） and is built within a Gaussian-sum framework. Based on the condition that the probability density functions of process noises and initial state are denoted by a Gaussian sum using optimization method, a bank of SCKF are used as the sub-filters to estimate state of system with the corresponding weights respectively, which is adaptively updated. The new algorithm consists of an adaptive splitting and merging procedure according to a proposed split-decision model based on the nonlinearity degree of measurement. The results of two simulation scenarios（one-dimensional state estimation and bearings-only tracking） show that the proposed filter demonstrates comparable performance to the particle filter with significantly reduced computational cost.

Non-iterative Cauchy kernel-based maximum correntropy cubature Kalman filter for non-Gaussian systems

This article addresses the nonlinear state estimation problem where the conventional Gaussian assumption is completely relaxed.Here,the uncertainties in process and measurements are assumed non-Gaussian,such that the maximum correntropy criterion(MCC)is chosen to replace the conventional minimum mean square error criterion.Furthermore,the MCC is realized using Gaussian as well as Cauchy kernels by defining an appropriate cost function.Simulation results demonstrate the superior estimation accuracy of the developed estimators for two nonlinear estimation problems.

An Innovative State-of-charge Estimation Method of Lithium-ion Battery Based on 5th-order Cubature Kalman Filter

The lithium-ion batteries have drawn much attention as the major energy storage system.However,the battery state estimation still suffers from inaccuracy under dynamic operational conditions,with the unstable environmental noise influencing the robustness of estimation.This paper presents a 5th-order cubature Kalman filter with improvements on adaptivity for real-time state-of-charge estimation.The second-order equivalent circuit model is developed for describing the characteristics of battery,and parameter identification is carried out according to particle swarm optimization.The developed method is validated in stable and dynamic conditions,and simulation results show a satisfactory consistency with the experimental results.The maximum estimation error under static conditions is less than 3%and the maximum error under dynamic conditions is 5%.Numerical analysis indicates that the method has better convergence and robustness than the traditional method under the disturbances of initial error,which demonstrates the potential for EV applications in harsh environments.The proposed method shows application potential for both online estimations and cloud-computing system,indicating its diverse application prospect in electric vehicles.

State of Charge Estimation for Lithium-Ion Battery Based on Improved Cubature Kalman Filter Algorithm

An improved cubature Kalman filter(CKF)algorithm for estimating the state of charge of lithium-ion batteries is proposed.This improved algorithm implements the diagonalization decomposition of the covariance matrix and a strong tracking filter.First,a first-order RC equivalent circuit model is first established and verified,whose voltage estimation error is within 1.5%;this confirms that the model can be used to describe the characteristics of a battery.Then the calculation processes of the traditional and proposed CKF algorithms are compared.Subsequently,the improved CKF algorithm is applied to the state of charge estimation under the constant-current discharge and dynamic stress test conditions.The average errors for these two conditions are 0.76%and 1.2%,respectively,and the maximum absolute error is only 3.25%.The results indicate that the proposed method has higher filter stability and estimation accuracy than the extended Kalman filter(EKF),unscented Kalman filter(UKF)and traditional CKF algorithms.Finally,the convergence rates of the above four algorithms are compared,among which the proposed algorithm track the referenced values at the highest speed.

Cubature Kalman probability hypothesis density filter based on multi-sensor consistency fusion

The GM-PHD framework as recursion realization of PHD filter is extensively applied to multitarget tracking system. A new idea of improving the estimation precision of time-varying multi-target in non-linear system is proposed due to the advantage of computation efficiency in this paper. First,a novel cubature Kalman probability hypothesis density filter is designed for single sensor measurement system under the Gaussian mixture framework. Second,the consistency fusion strategy for multi-sensor measurement is proposed through constructing consistency matrix. Furthermore,to take the advantage of consistency fusion strategy,fused measurement is introduced in the update step of cubature Kalman probability hypothesis density filter to replace the single-sensor measurement. Then a cubature Kalman probability hypothesis density filter based on multi-sensor consistency fusion is proposed. Capabilily of the proposed algorithm is illustrated through simulation scenario of multi-sensor multi-target tracking.

Underwater square-root cubature attitude estimator by use of quaternion-vector switching and geomagnetic field tensor

This paper presents a kind of attitude estimation algorithm based on quaternion-vector switching and square-root cubature Kalman filter for autonomous underwater vehicle(AUV).The filter formulation is based on geomagnetic field tensor measurement dependent on the attitude and a gyro-based model for attitude propagation. In this algorithm, switching between the quaternion and the three-component vector is done by a couple of the mathematical transformations. Quaternion is chosen as the state variable of attitude in the kinematics equation to time update, while the mean value and covariance of the quaternion are computed by the three-component vector to avoid the normalization constraint of quaternion. The square-root forms enjoy a continuous and improved numerical stability because all the resulting covariance matrices are guaranteed to stay positively semidefinite. The entire square-root cubature attitude estimation algorithm with quaternion-vector switching for the nonlinear equality constraint of quaternion is given. The numerical simulation of simultaneous swing motions in the three directions is performed to compare with the three kinds of filters and the results indicate that the proposed filter provides lower attitude estimation errors than the other two kinds of filters and a good convergence rate.

State of charge estimation by square root cubature particle filter approach with fractional order model of lithium-ion battery

In this paper, a square root cubature particle filter approach was designed to estimate the state of charge of lithium-ion battery,which not only enhanced the numerical stability and guaranteed positive definiteness of the state covariance, but also increased accuracy and decreased computation quantity. Due to the fractional characteristics of the battery capacitance, a fractional order model was used to formulate the lithium-ion battery. Considering the high accuracy and easy convergence, a particle swarm optimization algorithm was utilized to identify the model parameters. The above-mentioned approach was modelled and translated into C code, which was downloaded into battery control unit of battery management system for experimental validation. Two kinds of dynamic cycles were utilized to validate the proposed approach at different temperatures, where both unscent Kalman filter and cubature Kalman filter were compared with the proposed approach. Experimental results indicate that the proposed approach has better accuracy and robustness, and fractional order model is more accurate than integer order model.Therefore, the square root cubature particle filter with fractional order model of lithium-ion battery is a good candidate to estimate the state of charge.

Wind Estimation for UAV Based on Multi-sensor Information Fusion

Aiming at the requirements of accurate target positioning and autonomous capability for adapting to the environmental changes of unmanned aerial vehicle(UAV),a new method for wind estimation and airspeed calibration is proposed.The method is implemented to obtain both wind speed and wind direction based on the information from a GPS receiver,an air data computer and a magnetic compass,combining with the velocity vector triangle relationships among ground speed,wind speed and air speed.Considering the installation error of Pitot tube,cubature Kalman filter(CKF)is applied to determine proportionality calibration coefficient of true airspeed,thus improving the accuracy of wind field information further.The entire autonomous flight simulation is performed in a constant 2-D wind using a digital simulation platform for UAV.Simulation results show that the wind speed and wind direction can be accurately estimated both in straight line and in turning segment during the path tracking by using the proposed method.The measurement accuracies of the wind speed and wind direction are 0.62 m/s and2.57°,respectively.

Adaptive tracking algorithm based on 3D variable turn model

Satisfactory results cannot be obtained when three-dimensional (3D) targets with complex maneuvering characteristics are tracked by the commonly used two-dimensional coordinated turn (2DCT) model. To address the problem of 3D target tracking with strong maneuverability, on the basis of the modified three-dimensional variable turn (3DVT) model, an adaptive tracking algorithm is proposed by combining with the cubature Kalman filter (CKF) in this paper. Through ideology of real-time identification, the parameters of the model are changed to adjust the state transition matrix and the state noise covariance matrix. Therefore, states of the target are matched in real-time to achieve the purpose of adaptive tracking. Finally, four simulations are analyzed in different settings by the Monte Carlo method. All results show that the proposed algorithm can update parameters of the model and identify motion characteristics in real-time when targets tracking also has a better tracking accuracy.