Abstract

A novel spherical simplex Gauss–Laguerre quadrature cubature Kalman filter is proposed to improve the estimation accuracy of nonlinear dynamic system. The nonlinear Gaussian weighted integral has been approximately evaluated using the spherical simplex rule and the arbitrary order Gauss–Laguerre quadrature rule. Thus, a spherical simplex Gauss–Laguerre cubature quadrature rule is developed, from which the general computing method of the simplex cubature quadrature points and the corresponding weights are obtained. Then, under the nonlinear Kalman filtering framework, the spherical simplex Gauss–Laguerre quadrature cubature Kalman filter is derived. A high-dimensional nonlinear state estimation problem and a target tracking problem are utilized to demonstrate the effectiveness of the proposed spherical simplex Gauss–Laguerre cubature quadrature rule to improve the performance.

1. Introduction

Nonlinear filtering and estimation based on Bayes framework have been widely applied in many fields, such as target tracking [15], navigation [5, 6] and positioning [7, 8], power system [911], and pattern recognition [12]. Recent years have seen a surge of interest in solving the nonlinear estimation problems. As is well known, the optimal solution to nonlinear systems is impractical. The focus has been on developing suboptimal algorithms, and many approximate nonlinear filters are generally proposed. The approximate nonlinear filters can be divided into two classes: global approach and local approach. In global approximations, one intuitive scheme is to randomly select a set of weighted particles to approximate the propagation of possible density functions (PDFs), giving birth to the particle filter (PF) [13] and grid-mass filter [14]. Although filters in this approach have high precision, the computational burden is its primary obstacle to more widespread use. Another scheme is the global linearization [15] method, in which the differential inclusion theory represents the nonlinear system via a linear differential inclusion (LDI) model. This kind of method can effectively solve the problem of local linearization error in the local linearization method. It can also handle different types of noise and model uncertainty with strong robustness. Despite the superior performance of global linearization, the problem of filter design conservatism is one of the bottlenecks. To reduce the conversion, Yu and Li [16] proposed a nested tensor product model transformation (NTPMT). The NTPMT is able to obtain multilevel nested TP models for the given systems and reduce the dimensionality of the vertex tensor such that the number of vertex systems contained in the resultant TP model is reduced effectively. The proposed transformation has indicated an attractive research direction in global linearization.

The local approximations include the analytical approximations and sampling-based approaches. The most widely used nonlinear filter is the extended Kalman filter (EKF) [17], which is the typical analytical approximate nonlinear filter. The state estimation is approximated by a Gaussian random variable (GRV), which is then propagated analytically through the first-order linearization of the nonlinear process and measurement system. However, the EKF has slow convergence and low estimated accuracy and may suffer from large errors when the system has high nonlinearity. The unscented Kalman filter (UKF) [18], the Gauss–Hermite quadrature filter (GHQF) [19], and the cubature Kalman filter (CKF) [20] fall under the latter category. The UKF addresses the flaws of the EKF by using a set of deterministic points to calculate the mean and covariance of nonlinear functions. Based on the Gauss–Hermite quadrature (GHQ) rule, the GHQF is more stable and accurate than UKF. Unfortunately, the experimental growth with the dimension of the number of quadrature points and computational complexity has prohibited its widespread use.

Recently, a cubature Kalman filter [20] has been proposed and widely used in many applications for its simplicity and effectiveness. The heart of the CKF is a spherical-radial cubature rule, which makes it possible to numerically compute multivariate moment integrals met in the nonlinear Bayesian framework. Since its inception in 2009, CKF has been an active research area for many researchers all over the world resulting in various variants of the basic algorithm with improved performance. A new class of CKFs with arbitrary degrees of accuracy in computing the spherical and radial integrals was put forward by Jia [21]. Based on a spherical simplex-radial rule, Wang et al. [22] proposed the spherical simplex-radial cubature Kalman filter (SSRCKF). In SSRCKF, the transformation group of the regular simplex and the moment matching method are used to calculate the spherical and the radial integrals, respectively. Simulation results show that the SSRCKF can obtain higher accuracy and better efficiency than the traditional CKFs for high-dimension systems.

However, the radial integral in both CKFs and SSRCKFs is solved by the moment matching method [22], which is ambiguous and does not provide the best possible solution available [23]. To tackle this problem, Bhaumik and Swati proposed the cubature quadrature Kalman filter (CQKF) [24]. In CQKF, the spherical integral is calculated the same as the CKFs, but the radial integral is solved with arbitrary order Gauss–Laguerre quadrature rule. Thanks to the arbitrary order Gauss–Laguerre quadrature rule, the filtering accuracy has been further improved. It is also indicated that the CKF is a special case of CQKF with the first-order Gaussian–Laguerre quadrature in radial integral. To further improve the performance of the CQKF, a higher degree cubature quadrature Kalman filter (HDCQKF) [23] is proposed.

The contribution of this paper is to propose a new class of CKFs with the spherical simplex rule to approximate the spherical integral and arbitrary order Gauss–Laguerre quadrature rule to solve the radial integral. The proposed filter is termed as spherical simplex Gauss–Laguerre quadrature cubature Kalman filter (SSGQKF). The SSGQKF would be a generalized form of SSRCKF, and under single Gauss–Laguerre quadrature point evaluation, it coincides with the third-degree SSRCKF. The accuracy of the SSGQKF depends on the number of the simplex cubature points. The higher the number of simplex quadrature points, the better the accuracy. Moreover, the computational burden of the SSGQKF does not increase exponentially with the dimension, and thus it does not have the curse of dimensionality problem. In addition, it is derivative free. The proposed nonlinear filter can provide more accurate results with less computational costs than HDCQKF in high-dimensional nonlinear state estimation systems. Two examples have been provided to demonstrate the superiority of the SSGQKF.

The rest of this paper is organized as follows. Section 2 reviews the cubature quadrature Kalman filter in the Bayesian framework of filtering and estimation. In Section 3, we present the proposed SSGQKF method. To verify the superiority of the SSGQKF method, Section 4 shows the compared performance for the conventional nonlinear filtering and the proposed algorithm. Finally, several concluding remarks are given in Section 5 to end this paper.

2. Cubature Quadrature Kalman Filter

2.1. Nonlinear System Model

Consider a class of nonlinear discrete estimation systems described bywhere is the state vector of the dynamic system at discrete time ; is the measurement vector; and and are independent process and measurement Gaussian white noise with zero means and covariances and , respectively.

Under the Gaussian domain, Bayesian filters can be generalized by computing the following integral:

Let , where is the mean and . Then, the integral can be written as

If we assume zero mean and unity covariance, equation (3) becomeswhere is the spherical surface and is the spherical surface measure or the area element on . To compute the integral , we decompose it into a surface integral and a line integral. We may thus write the line integralin which is defined by the spherical integral with the unit weighting function :

In this paper, the spherical and the line integrals are numerically computed by the spherical simplex rule adopted from [22] and the arbitrary order Gauss–Laguerre quadrature rule, respectively.

2.2. Spherical Simplex Rule

The spherical integral of the form can be efficiently evaluated by the transformation group of the regular –simplex with vertices [25, 26], i.e.,

The set of midpoints of the vertices projected onto the spherical surface yields the following point set [25]:

Thus, the third-degree spherical simplex rule that contains integral points is as follows:where is the surface area of the unit sphere and . Similarly, the fifth-degree spherical simplex rule with quadrature points is obtained as follows [25, 26]:

Therefore, the spherical integral can be approximately by point spherical simplex rule as

2.3. Gauss–Laguerre Quadrature Rule

It is known that any integral in the form ofcan be approximately evaluated using quadrature points and weights associated with them. The quadrature points can be derived from the roots of the order of Chebyshev–Laguerre polynomial equation [27, 28]:

The weights of the quadrature points can be determined as

So, integral (12) can be written approximately using the Gauss–Laguerre quadrature rule as

3. Spherical Simplex Gauss–Laguerre Quadrature Evaluation of Integrals

3.1. Spherical Simplex Gauss–Laguerre Quadrature Rule

From (12) and (16), the spherical simplex Gauss–Laguerre rule for can be approximated by

Note that to transform the integral into the form of equation (12), we make an assumption that . Let the numerical method for be represented by . Substituting (9) and (15) into (18) yields the third-degree spherical simplex Gauss–Laguerre quadrature rule as

Similarly, substituting (10) and (15) into (18), we have the fifth-degree spherical simplex Gauss–Laguerre quadrature rule as

The Gaussian probability weighted integral can be performed by the linear transformation of , where is the square root of the matrix and is the quadrature points from (19) or (20).

For a dimension of state-space problem solved with third-order spherical simplex rule and order Gauss–Laguerre quadrature points, total points and associated weights need to be calculated. The fifth-degree spherical simplex Gauss–Laguerre quadrature rule has points and shares points with the third-degree spherical simplex Gauss–Laguerre quadrature rule. For simplicity, these simplex cubature quadrature points are termed as SCQ points in this paper.

3.2. Calculation of Simplex Cubature Quadrature Points and Weights

The steps for calculating the simplex cubature quadrature (SCQ) points and associated weights are as follows:(i)Determine the system dimension , the orders of spherical simplex cubature rule (i.e., ), and Chebyshev–Laguerre polynomial . Find out the set of sample points for a given specific degree of spherical simplex cubature rule.(ii)For the third-order spherical simplex rule, the sample points .(iii)For the fifth-order spherical simplex rule, the sample points .(iv)Solve the order Chebyshev–Laguerre polynomial (13) for to derive the quadrature points .(v)Find the SCQ points as .(vi)The weights associated with SCQ points are(i)For the third-order spherical simplex rule :(ii)For the fifth-order spherical simplex rule :

The number of support SCQ points required for different ordered spherical simplex cubature rule is shown in Table 1. The SCQ points and their associated weight of a second-order system for the third- and fifth-degree spherical simplex cubature and up to the third-order Gauss–Laguerre quadrature approximation are shown in Table 2. As the dimension of the state-space models increases, the computational burden also increases. We only discuss the third-degree and the fifth-degree spherical simplex rule here.

3.3. The Spherical Simplex Gauss–Laguerre Quadrature Cubature Kalman Filter (SSGQKF)

Applying the spherical simplex Gauss–Laguerre quadrature rule described in Section 3.2 in the Bayesian filter framework yields the new spherical simplex Gauss–Laguerre quadrature cubature Kalman filter (SSGQKF).

The algorithm of the proposed SSGQKF could be summarised as follows.

Step 1. Initialization(i)Initialize the filter with and .(ii)Calculate the SCQ points and their corresponding weights as described in Section 3.2.

Step 2. Prediction step(i)Factorise covariance matrix using Cholesky decomposition:(ii)Evaluate the SCQ points:(iii)Update the SCQ points:(iv)Estimate the predicted state and the predicted error covariance:where is the total number of SCQ points.

Step 3. Measurement step(i)Factorise the predicted error covariance matrix using the Cholesky decomposition:(ii)Evaluate the SCQ points:(iii)Find the propagated measurements at each SCQ points:(iv)Estimate the predicted measurement:(v)Calculate the innovation covariance matrix and the cross-covariance matrix:(vi)Compute the Kalman gain:(vii)Compute the filtering estimation:(viii)Compute the filtering estimation error covariance matrix:Remarks(i)The spherical simplex cubature Gauss–Laguerre quadrature rule constructed using the above theorems is fully symmetric.(ii)For a specific system dimension , there are two tuning parameters, namely, and , which could be tuned to achieve satisfied accuracy on affordable computational load.(iii)Compared to EKF, the SSGQKF is derivative free. It is easy to implement as neither a Jacobian nor Hessian matrix needs to be computed. It is also computationally more efficient than the PF and GHF because instead of generating large number of particles or quadrature points in the state space, few SCQ points are required to be generated, updated, and predicted.(iv)For a specific order of Chebyshev–Laguerre polynomial , the number of SCQ points of the fifth-degree SSGQKF is less than that of the existing fifth-degree HDCQKF when . Therefore, from the perspective of computation, the proposed fifth-degree SSGQKF is much less complex than HDCQKF, making it easier to implement in high-dimensional nonlinear systems. That is to say, the SSGQKF will be a potential and promising method in practical engineering implementation.(v)When , the fifth-degree spherical-radial rule has some negative weights. Negative weights may lead to divergence of filters [22]. Despite some of the weights from (20) in the fifth-degree spherical simplex cubature rule becoming negative when , they go to 0 when . Thus, the proposed fifth-degree SSGQKF is more efficient than the existing HDCQKF for high-dimensional systems. Consequently, the SSGQKF can be a very promising alternative to the HDCQKF under the Gaussian assumption, especially in the case of high-dimensional cases.(vi)For a predefined ordered cubature and Gauss–Laguerre quadrature, the SCQ points and associated weights can be calculated and stored offline. In other words, the computation burden could be further alleviated.In the following, a few discussions are added for the practical implementation of the proposed method Like the traditional Kalman filter (KF) and its suboptimal extensions (e.g., EKF, UKF, and CKF), the proposed SSGQKF is also developed under the Gaussian assumption and the minimum mean square error (MMSE) criterion. To deal with non-Gaussian noises and for further improvement, the proposed filter can be combined with other techniques such as the extended filtering [29], Huber’s M-estimation theory [30], maximum correntropy criterion (MCC) [31], and global linearization method to get better and more robust performance. (1) Since the extended filter does not make any assumptions about the statistics of the process or measurement noise but does require Jacobian matrices during the state estimation of nonlinear systems, by using the derivative-free property of SSGQKF and the linear propagation property, it is possible to embed the EF in the SSGQKF framework. (2) Similarly, a robust scheme integrating Huber’s M-estimation theory and the SSGQKF framework is beneficial where Huber’s M-en is adopted to reformulate the measurement information of the SSGQKF. (3)The MCC is a statistical metric of the similarity between two random variables using information from higher-order signal statistics, which may perform much better than MMSE in non-Gaussian noise environments, since the MMSE captures only the second-order statistics of the error signal and is sensitive to large outliers. (4) Based on the polytopic linear differential inclusion, the estimation error system for the nonlinear system can be represented by an uncertain polytopic linear model. Then, the rectification equations for the predicted errors are designed. Finally, the state estimates for the nonlinear system are given through updating the predictions of SSGQKF. Generally speaking, the proposed SSGQKF can be applied to the nonlinear non-Gaussian environment to obtain a robust performance, which can be our future work.
Since the proposed method is computationally more efficient than the HDCQKF, it can also be expanded to the distributed fusion estimation problem for multisensor nonlinear systems [32, 33].
The estimation problem sometimes needs to process a huge number of data, costing time and energy waste [34]. The event trigger or data driven method has been successfully applied in the practical system [911], which can reduce the sampling so as to reduce the computation with the guaranteed accuracy. For a proper and and a given general model in nonlinear system, the SCQ points and corresponding weight can be prepared offline. Then, similar to event-triggered cubature Kalman filter (ETCKF) proposed in [11], the event-trigger schedule can also be embedded into the SSGQKF method. Motivated by the event-trigger heterogeneous nonlinear filter (ET-HNF) [10], which utilizes a master-slave filter at generator node and estimation center and a low computational slave filter to execute the event-trigger strategy, particle flow filters and the proposed SSGQKF3 method can serve as the master and slave filter, respectively.
Generally, particle filter serves as the master due to its effectiveness to nonlinear dynamic and/or measurement filtering problem. However, as explained in [35, 36], particle filter commonly suffers from the curse of dimensionality (COD) owing to particle degeneracy, which is caused by Bayes’ rule. Recent advances in particle flow filters provide a promising avenue to avoid weight degeneracy and COD. Instead of using any proposal and resample schedule, the particle flow filters compute Bayes’ rule by particle flow, making it much easier to implement and perform better than the PF.

4. Simulations and Discussion

In this section, the effectiveness of the proposed SSGQKF is demonstrated by comparing the SSGQKF with the CKF, the third-degree SSRCKF (SSRCKF3), the CQKF, and the HDCQKF in terms of tracking accuracy.

Two problems are considered. The first problem is a highly nonlinear state estimation issue. The second problem is a tracking model of a vehicle. Both of the problems have significant nonlinearity.

In all the problems, the CQKF (or SSGQKF3) is implemented with the third-degree spherical (simplex) cubature rule and second-order Gauss–Laguerre quadrature rule. The HDCQKF (or SSGQKF5) is implemented with the fifth-degree spherical (simplex) cubature rule and second-order Gauss–Laguerre quadrature rule.

All algorithms were implemented on a personal computer with a 64-bit operating system, 8 GB RAM, and 2.20GHZ i7 processor. All the computations associated with cubature points were done offline.

4.1. Problem 1

We consider the following nonlinear system for which the state and measurement models are [22, 23, 37, 38]where is an dimensional state vector at -th instant of time and ; is the measurement at time ; and and are independent process and measurement Gaussian noise sequences with zero means and covariances and 1, respectively.

The true initial state is , and the filter is initialized with a value of and , where and . The states are estimated for 100 steps and the accuracy of the estimators is compared in terms of root mean square error (RMSE). For number of Monte Carlo runs, the RMSE is defined as

During the simulation, a ten (i.e., ) dimensional system is considered and 500 Monte Carlo runs are used to evaluate the RMSE. Considering the limitation of this article, the RSMEs of the first six states using different filters in an interval of 20–70 s are shown in Figures 13, respectively.

The average RMSE of the six filters in 100 steps is listed in Table 3. The average Monte Carlo run times of CKF, SSRCKF3, CQKF, HDCQKF, SSGQKF3, and SSGQKF5 for the above problem are 0.1823, 0.2083,0.3016, 1.5313, 0.3262, and 1.1719 seconds, respectively.

It is clear to see from Figures 13 and Table 3 that RMSEs of SSGQKF3 are smaller than those of CKF, SSRCKF3, and CQKF. Similarly, the RMSEs of SSGQKF5 are smaller than those of HDCQKF. The RMSE reflects the accuracy of the algorithm. Besides, we can also see that the proposed SSGQKF3 (or SSGQKF5) is more efficient than the CQKF (or HDCQKF) in terms of computation burden. Thus, the proposed filter has better filtering performance as compared with the CQKFs and existing third-degree SSRCKF.

4.2. Problem 2

In this section, a computer simulation is performed in a target tracking application, which has been used as a benchmark problem to validate the performance of different nonlinear filtering algorithms.

We consider a typical air-traffic control scenario, where an aircraft makes maneuvering turn in a horizontal plane to the ground, i.e., during maneuver, the height of the vehicle remains constant. The turn rate is an unknown constant, which needs to be estimated, making the process model to be a set of nonlinear equations. The target dynamic equation is given by [17, 20, 21, 3941]

The state of the aircraft denotes ; and represent positions, and and represent velocities in the and directions, respectively; is the sampling time. is the white Gaussian noise with zero mean and covariance , where

In this problem, a sensor is used to measure the range and angle between the target and the sensor. The measurement equation for the sensor can be expressed bywhere is the sensor position and is the white Gaussian measurement noise with zero mean and covariance . The measurement sampling interval .

The initial true state , and the associated covariance . The initial state estimate is chosen randomly from the Gaussian distribution in each run. For a fair comparison, we make 100 independent Monte Carlo runs.

Performance Metrics. To compare the performances of all filters, we use the root mean square error (RMSE) of the position, velocity, and the turn rate. The RMSE in position at time index is defined as follows:where is the number of Monte Carlo runs; and are the position elements of the true state at time in the -th Monte Carlo run; and and are the corresponding estimated state vectors. Similarly, we may easily write the formulas of RMSEs in velocity and the turn rate.

The simulation results, including the position RMSE, velocity RMSE, and the turn rate RMSE of various filters, are shown in Figures 46, respectively. Due to the fact that there is not much difference among the filters in the interval of 0–30 s, the RMSEs of these steps are not shown here. The average time in Table 4 is the running time for 100 times' simulation, each time 100 steps.

From the results, we can see that SSGQKF5 improves the CKF by in position, in velocity, and in turn rate. We can also learn that the RMSE of position estimation error, velocity error, and turn rate error of the SSGQKF5 is much smaller than that of the HDCQKF, which means the SSGQKF5 can provide more accurate estimation results. That is because the fifth-degree simplex rule is utilized to compute the spherical integral; hence, the filter precision can be improved.

Table 4 shows the runtime of the six filters; the runtime of SSGQKFs is slower than that of HDCQKF, which is because the fifth-degree spherical simplex rule requires fewer points than the fifth-degree CKF when the dimension is larger than four. To sum up, we claim that the SSGQKFs is a balance between filtering accuracy and computational cost for some high-dimensional applications.

5. Conclusions

In this paper, a new method has been proposed for solving the nonlinear filtering problems. The proposed filter is named as spherical simplex Gauss–Laguerre quadrature cubature Kalman filter. The intractable integrals encountered during the filtering are decomposed into surface and line integrals. The surface integral is solved by spherical simplex cubature rule, while the line integral is solved by any ordered Gauss–Laguerre quadrature rule. SSGQKFs use the spherical simplex Gauss–Laguerre quadrature rule and choose a set of SCQ points, which do not require the evaluation of Jacobian matrices during the prediction and update stage. The proposed filter is tested in two problems that involve a high nonlinear state estimation problem and the use of a target tracking problem of practical significance. The accuracy of the proposed filter is found to be better than the CKF, the CQKF, and the HDCKF. The proposed nonlinear filters can provide more accurate results with lower computational costs than HDCQKF in high-dimensional nonlinear systems. To enhance accuracy, the proposed filter can be potentially used in state estimation where high nonlinearity exists in systems.

Data Availability

The raw/processed data required to reproduce these findings cannot be shared at this time as the data also form part of an ongoing study.

Conflicts of Interest

The data used to support the findings of this study are available from the corresponding author upon request.

Acknowledgments

This research was funded by the National Natural Science Foundation of China (no. 61671333), the Natural Science Foundation of Hubei Province (no. 2014CFA093), the Fundamental Research Funds for the Central Universities (nos. 2042019K50264 and 2042019GF0013), and the Fundamental Research Funds for the Wuhan Maritime Communication Research Institute (no. 2017J-13).