Interacting Multiple Model (IMM) Fifth-Degree Spherical Simplex-Radial Cubature Kalman Filter for Maneuvering Target Tracking

Abstract

For improving the tracking accuracy and model switching speed of maneuvering target tracking in nonlinear systems, a new algorithm named the interacting multiple model fifth-degree spherical simplex-radial cubature Kalman filter (IMM5thSSRCKF) is proposed in this paper. The new algorithm is a combination of the interacting multiple model (IMM) filter and the fifth-degree spherical simplex-radial cubature Kalman filter (5thSSRCKF). The proposed algorithm makes use of Markov process to describe the switching probability among the models, and uses 5thSSRCKF to deal with the state estimation of each model. The 5thSSRCKF is an improved filter algorithm, which utilizes the fifth-degree spherical simplex-radial rule to improve the filtering accuracy. Finally, the tracking performance of the IMM5thSSRCKF is evaluated by simulation in a typical maneuvering target tracking scenario. Simulation results show that the proposed algorithm has better tracking performance and quicker model switching speed when disposing maneuver models compared with the interacting multiple model unscented Kalman filter (IMMUKF), the interacting multiple model cubature Kalman filter (IMMCKF) and the interacting multiple model fifth-degree cubature Kalman filter (IMM5thCKF).

1. Introduction

Maneuvering target tracking has been widely used in many applications, such as aircraft surveillance [1,2], road vehicle navigation [3,4] and radar tracking [5,6,7]. Because of the complexity of maneuvering target motion, the single model structure is not appropriate for tracking maneuvering targets. Therefore, the multiple-model structure is adopted. A number of multiple-model techniques have been proposed, such as multiple model (MM) methods [8], optimization of the multiple model neural filter [9], the interacting multiple model (IMM) algorithm [10,11], and other algorithms [12,13]. In these multiple model algorithms, the IMM algorithm proposed by Blom and Bar-Shalom [10,11] is the most popular algorithm. In the IMM algorithm, the target model is selected among a set of models via the control of a Markov chain and the final estimate is obtained by a weighted sum of the estimates from the sub-filters of different models. The conventional IMM algorithm combines multiple models with a linear filter to estimate the target motion state. Because of its excellent compromise between complexity and perfor, the IMM [8,14] algorithm has been widely used in the field of maneuvering target tracking [14,15,16]. However, in the conventional IMM algorithm, the Kalman filter only obtains high precision for linear Gaussian systems. However, most modern systems are nonlinear and the linear IMM algorithm cannot directly deal with nonlinear systems. Thus, the research of nonlinear IMM is paid more attention and is a popular topic in maneuvering target tracking field. It is different from linear IMM theory based on the linear Kalman filter; the performance of nonlinear IMM algorithms depends on the selected nonlinear filters.

Nowadays, the study of nonlinear filter algorithms has been paid a great deal of attention by researchers. It is well known that the extended Kalman filter (EKF) [17] is widely used among the proposed nonlinear filtering algorithms. The basic idea of the EKF is to linearize the measurements and state models by first-order Taylor series expansion. However, it is difficult to get the Jacobian matrix of nonlinear function in many practical problems. As a result, the performance of the EKF may degrade rapidly. To solve this problem, scholars have proposed derivative-free alternatives such as the unscented Kalman filter (UKF) [18,19], the central difference Kalman filter (CDKF) [20] and the Gauss-Hermite Kalman filter (GHKF) [21], etc. These algorithms mentioned above use a set of deterministic sampling points and weights to approximate the Gaussian integrals, which are more accurate than the EKF. However, the search for more accurate filtering algorithms is continuing. In recent years, the cubature Kalman filter (CKF) [22,23] has been of increasing interest for high-dimensional state estimation. This filtering algorithm approximates the weighted Gaussian integrals according to the Bayesian theory and the third-degree spherical-radial cubature rule.

To further improve the estimation accuracy of CKF, the fifth-degree CKF (5thCKF) is proposed in [24]. However, the computational cost of the 5thCKF increases rapidly with the increasing of the state dimension. Recently, Wang et al. [25] have proposed a new class of CKF algorithms based on the spherical simplex-radial (SSR) rule, which can improve accuracy of the CKF with lower computational costs in high dimensional nonlinear system. Specially, the fifth-degree spherical simplex-radial cubature Kalman filter (5thSSRCKF) proposed in [25] has a higher estimation accuracy than 5thCKF. Therefore, we choose the 5thSSRCKF as the filtering algorithm in the IMM framework, and propose the interacting multiple model fifth-degree spherical simplex-radial cubature Kalman filter (IMM5thSSRCKF) algorithm for maneuvering target tracking of nonlinear system. Simulation results show that the IMM5thSSRCKF exhibits better performance than the interacting multiple model unscented Kalman filter (IMMUKF), the interacting multiple model cubature Kalman filter (IMMCKF) and the interacting multiple model fifth-degree cubature Kalman filter (IMM5thCKF) [26] in terms of accuracy and switching response.

The remainder of this paper is organized as follows. The fifth-degree spherical simplex-radial cubature Kalman filter is briefly reviewed in Section 2. The whole procession of IMM5thSSRCKF used in target tracking problem is developed in Section 3. Simulation results of a maneuvering tracking problem and performance comparisons are presented and discussed in Section 4. Finally, the conclusions are provided in Section 5.

2. Fifth-Degree Simplex-Spherical Cubature Kalman Filter

The nonlinear filtering problem with additive process and measurement noise can be defined as:

$$\{\begin{array}{l}{x}_k=f\left(x_{k-1}\right)+w_{k-1}\\ z_k=h\left(x_k\right)+v_k\end{array}$$

(1)

where $k$ is a discrete time index, $x_k\in {\mathbf{R}}^n$ is the state vector at time $k$, $z_k\in {\mathbf{R}}^m$ is the measurement vector at time $k$; $f(\cdot )$ and $h(\cdot )$ are the system dynamics function and the measurement function; $w_{k-1}\in {\mathbf{R}}^n$ is the process noise; and $v_k\in {\mathbf{R}}^m$ is the measurement noise. $w_{k-1}$ and $v_k$ are assumed to be uncorrelated zero-mean Gaussian white noise with covariance matrix $Q_{k-1}$ and $R_k$, respectively. The initial state $x_0$ is assumed to be ${\widehat{x}}_0$ with covariance matrix $P_0$ and is independent of $w_{k-1}$ and $v_k$.

2.1. Review of the Fifth-Degree Spherical Simplex-Radial Cubature Rule

The 5thSSRCKF algorithm has the same structure as the general Gaussian approximation filters, such as the CKF, but uses the fifth-degree spherical simplex-radial cubature rule to calculate the Gaussian weight integral $I(f)={\displaystyle {\int }_{{\mathrm{R}}^n}f(x)N(x;0,\mathit{I})dx}$. By using the spherical simplex-radial cubature rule, the 5thSSRCKF method can get more accurate estimation than CKF. In the fifth-degree spherical simplex-radial cubature rule, the following integral is considered [24]:

$$I(f)={\displaystyle {\int }_{{\mathrm{R}}^n}f(x)\exp (-x^{\mathrm{T}}x)dx}$$

(2)

where $f(\cdot )$ is arbitrary nonlinear function, and ${ℝ}^n$ is the integral domain. To calculate the above integral, let $x=rs$ $(s^{T}s=1,r=\sqrt{x^{\mathrm{T}}x})$. Equation (2) can be transformed into the spherical-radial coordinate system:

$$I(f)={\displaystyle {\int }_0^{\infty }{\displaystyle {\int }_{U_n}f(rs)r^{n-1}\exp (-r^2)d\sigma (s)dr}}$$

(3)

where $s={[s_1,s_2,\cdots ,s_n]}^{\mathrm{T}}$, $U_n=\{s\in {ℝ}^n:s_1^2+s_2^2+\cdots +s_n^2=1\}$ is the n-dimensional spherical surface, and $\sigma (\cdot )$ is the area element on $U_n$; n denotes the dimension of spherical surface. Then, the integral (3) can be decomposed into the spherical integral $S(r)={\displaystyle {\int }_{U_n}f(rs)\mathrm{d}\sigma (s)}$ and the radial integral $I(f)={\displaystyle {\int }_0^{\infty }S(r)r^{n-1}\exp (-r^2)dr}$.

2.1.1. Spherical Simplex Rule

As can be seen from [27], the spherical integral ${\displaystyle {\int }_{U_n}f(rs)\mathrm{d}\sigma (s)}$ can be approximated by the transformation group of the regular n-simplex. The fifth-degree spherical simplex rule with $n^2+3n+2$ quadrature points is given by:

$$S_5(r)=\frac{(7-n)n^2{A}_n}{2{(n+1)}^2{(n+2)}^2}{\displaystyle \sum _{j=1}^{n+1}\left[g(r{a}_j)+g(-r{a}_j)\right]}+\frac{2{(n-1)}^2{A}_n}{2{(n+1)}^2{(n+2)}^2}{\displaystyle \sum _{j=1}^{n(n+1)/2}\left[g(r{b}_j)+g(-r{b}_j)\right]}$$

(4)

where the surface area of the unit sphere is $A_n=2\sqrt{{\pi }^n}/{\Gamma }^n(1/2)$. The points sets of ${\mathit{a}}_j$ and $b_j$ are given by:

$${\mathit{a}}_j={[a_{j,1},a_{j,1},\cdots ,a_{j,n}]}^T$$

(5)

$$\{b_j\}=\left\{\sqrt{\frac{n}{2(n-1)}}({\mathit{a}}_i+{\mathit{a}}_l):i<l;i,l=1,2,\cdots ,n+1\right\}$$

(6)

where the vector elements of $a_j$ is defined as:

$$a_{j,m}=\{\begin{array}{l}\begin{array}{cc}-\sqrt{\frac{n+1}{n(n-m+2)(n-m+1)},}& m<j\end{array}\\ \begin{array}{cc}\sqrt{\frac{(n+1)(n-j+1)}{n(n-j+2)},}& m=j\end{array}\\ \begin{array}{cc}0,& m>j\end{array}\end{array}, 1\le m\le n,1\le j\le n+1$$

(7)

2.1.2. Radial Rule

The radial integral $R={\displaystyle {\int }_0^{\infty }S(r)r^{n-1}\exp (-r^2)dr}$ can be calculated by the following moment matching equation:

$${\displaystyle {\int }_0^{\infty }S(r)r^{n-1}\exp (-r^2)dr}={\displaystyle \sum _{i=1}^{N_r}{\omega }_{r,i}S(r_i)}$$

(8)

where $S(r)=r^l$ is a monomial in r, with l an even integer. The left-hand side of Equation (8) is simplified as $\frac{1}{2}\Gamma \left(\frac{n+l}{2}\right)$ with $\Gamma (n)=$${\displaystyle {\int }_0^{\infty }{x}^{n-1}{e}^{-x}dx}$. In order to achieve the fifth-degree algebraic precision, we make the radial integral R is exact for l = 0, 2, 4. For the fifth-degree radial rule $(N_r=2)$, we can obtain the moments’ equations as:

$$\{\begin{array}{l}{\omega }_{r,1}{r}_1^0+{\omega }_{r,2}{r}_2^0=\frac{1}{2}\Gamma \left(\frac{n}{2}\right)\\ {\omega }_{r,1}{r}_1^2+{\omega }_{r,2}{r}_2^0=\frac{1}{2}\Gamma \left(\frac{n+2}{2}\right)=\frac{n}{4}\Gamma \left(\frac{n}{2}\right)\\ {\omega }_{r,1}{r}_1^4+{\omega }_{r,2}{r}_2^4=\frac{1}{2}\Gamma \left(\frac{n+4}{2}\right)=\frac{1}{2}\left(\frac{n}{2}+1\right)\left(\frac{n}{2}\right)\Gamma \left(\frac{n}{2}\right)\end{array}$$

(9)

By solving Equation (9), the points and weights for the third-degree radial rule are given by:

$$\{\begin{array}{l}{r}_1=0,r_1=\sqrt{n/2+1}\\ {\omega }_{r,1}=\frac{1}{n+2}\Gamma (n/2),{\omega }_{r,2}=\frac{n\Gamma (n/2)}{2(n+2)}\end{array}$$

(10)

2.1.3. Fifth-Degree Spherical Simplex-Radial Rule

By using Equations (3), (4) and (10), the fifth-degree spherical simplex-cubature rule can be formulated as:

$$\begin{array}{l}{\displaystyle {\int }_{{ℝ}^n}g(\mathit{x})}N(\mathit{x};\widehat{\mathit{x}},P_x)dx=\frac{2}{n+2}g(\widehat{\mathit{x}})+\\ \{\frac{(7-n)n^2}{2{(n+1)}^2{(n+2)}^2}{\displaystyle \sum _{i=1}^{n+1}\left[g(\sqrt{(n+2)P_x}{a}_i+\widehat{\mathit{x}})+g(-\sqrt{(n+2)P_x}{a}_i+\widehat{\mathit{x}})\right]}+\\ \frac{2{(n-1)}^2}{2{(n+1)}^2{(n+2)}^2}{\displaystyle \sum _{i=1}^{n(n+1)/2}\left[g(\sqrt{(n+2)P_x}{b}_i+\widehat{\mathit{x}})+g(-\sqrt{(n+2)P_x}{b}_i+\widehat{\mathit{x}})\right]}\}\end{array}$$

(11)

The steps of 5thSSRCKF algorithm for the nonlinear system can be found in [22,25].

3. IMM5thSSRCKF Algorithm

The IMM algorithm obtains the output state estimate as a weighted sum of the estimates from a number of filters. In the application of IMM algorithm, the filtering precision depends on the selected sub-filter. Considering that 5thSSRCKF has high estimation precision, 5thSSRCKF is selected as sub-filter in the filtering part of the IMM framework. Therefore, the proposed IMM5thSSRCKF algorithm is the combination of IMM algorithm and 5thSSRCKF algorithm. In the IMM5thSSRCKF algorithm, the state estimation at time k is computed under each possible current model using r filters, with each filter using a different combination of the previous model-conditioned estimates. The structure diagram of IMM5thSSRCKF is shown in Figure 1.

Figure 1. Structure of interacting multiple model fifth-degree spherical simplex-radial cubature Kalman filter (IMM5thSSRCKF).

In the IMM5thSSRCKF algorithm, the 5thSSRCKF employs the fifth-degree spherical simplex-radial cubature rule to generate the cubature points, which can further estimate the mean and covariance of the system state. The IMM5thSSRCKF algorithm includes four fundamental steps: model interaction, model conditional filtering, model probability updating, and output integration. The detailed steps of the IMM5thSSRCKF algorithm are provided as follows.

Step 1. Model Interaction

The initial condition for each model $j$ can be obtained from the state estimate ${\widehat{x}}_{k-1|k-1}^j$ and covariance $P_{k-1|k-1}^j$ at time $k-1$. The mixed initial state of model $j$ at time $k-1$ ${\widehat{x}}_{k-1|k-1}^{0j}$ and its corresponding covariance $P_{k-1|k-1}^{0j}$ are computed according to:

$$\begin{array}{l}{\widehat{x}}_{k-1|k-1}^{0j}={\displaystyle \sum _{i=0}^r{\mu }_{k-1|k-1}^{i|j}{\widehat{x}}_{k-1|k-1}^i}\\ P_{k-1|k-1}^{0j}={\displaystyle \sum _{i=0}^r{\mu }_{k-1|k-1}^{i|j}\{P_{k-1|k-1}^i}+\left[{\widehat{x}}_{k-1|k-1}^i-{\widehat{x}}_{k-1|k-1}^{0j}\right]{\left[{\widehat{x}}_{k-1|k-1}^i-{\widehat{x}}_{k-1|k-1}^{0j}\right]}^T\}\end{array}$$

(12)

where r denotes the number of interacting models, and ${\widehat{x}}_{k-1|k-1}^i$ and $P_{k-1|k-1}^i$ are the prior state estimate and corresponding state error covariance of model $i$ in the previous step, respectively.

The mixing probability ${\mu }_{k-1|k-1}^{i|j}$ at time $k-1$ can be given by:

$$\begin{array}{l}{\mu }_{k-1}^{i|j}=\frac{p_{ij}{\mu }_{k-1}^i}{C_j},\\ C_j={\displaystyle \sum _{i=1}^r{p}_{ij}{\mu }_{k-1}^i}\end{array}$$

(13)

where $i,j=1,\cdots ,r$, ${\mu }_{k-1}^i$ represents the model probability of the mode i at time k−1, and $p_{ij}$ is the probability of a transition from model i to model $j$.

Step 2. Model Conditional Filtering

Using the initial mixing state $x_{k-1|k-1}^{0j}$ and the covariance $P_{k-1|k-1}^{0j}$ of the interacting step as the input of each filter at time $k-1$. Then, the new state ${\widehat{\mathit{x}}}_{k|k}^j$ of model j and covariance $P_{k|k}^j$ of model $j$ can be updated by Equations (14)–(20).

A. Time Update

The evaluation of cubature points in the mechanism of state one-step prediction and the propagated cubature points in the mechanism of state one-step prediction can be obtained by the following equations:

$$\begin{array}{l}{X}_{i,k|k-1}^j=S_{k-1|k-1}^{0j}{\xi }_i^j+x_{k-1|k-1}^{0j}\\ X_{i,k|k-1}^{*j}=f(X_{i,k|k-1}^j)\end{array}$$

(14)

where ${\mathit{S}}_{k-1|k-1}^{0j}$ is the square root factor of $P_{k-1|k-1}^{0j}$, and $P_{k-1|k-1}^{0j}$ is the estimated error covariance of model $j$ at time $k-1$. $\{{\xi }_i^j\}$ is the matrix with a set of vector, and the corresponding weight matrix is $\{{\omega }_i^j\}$. The fifth-degree simplex cubature points and the corresponding weights are as follows:

$${\xi }_i^j=\{\begin{array}{ll}{[0,0,\cdots ,0]}^T& i=1,\\ \sqrt{n+2}{\mathit{a}}_{i-1}& i=2,\cdots ,n+2,\\ -\sqrt{n+2}{\mathit{a}}_{i-n-2}& i=n+3,\cdots ,2n+3,\\ \sqrt{n+2}{\mathit{b}}_{i-2n-3}& i=2n+4,\cdots ,(n^2+5n+6)/2,\\ -\sqrt{n+2}{\mathit{b}}_{i-(n^2+5n+6)/2}& i=(n^2+5n+8)/2,\cdots ,n^2+3n+3.\end{array}$$

(15)

$${\omega }_i^j=\{\begin{array}{ll}\frac{2}{n+2}& i=1,\\ \frac{(7-n)n^2}{2{(n+1)}^2{(n+2)}^2}& i=2,\cdots ,2n+3,\\ \frac{2{(n-1)}^2}{n{(n+1)}^2{(n+2)}^2}& i=2n+4,\cdots ,n^2+3n+3.\end{array}$$

(16)

where n represents the dimension of state vector; the point sets of ${\mathit{a}}_i$ and ${\mathit{b}}_i$ are given by (5) and (6).

The predicted state $x_{k|k-1}^j$ and predicted error covariance $P_{k|k-1}^j$ can be computed using the cubature transformation as:

$$\begin{array}{l}{x}_{k|k-1}^j={\displaystyle \sum _{i=1}^L{\omega }_i{X}_{i,k|k-1}^{*j}}\\ P_{k|k-1}^j={\displaystyle \sum _{i=1}^L{\omega }_i(X_{i,k|k-1}^{*j}-x_{k|k-1}^j){(X_{i,k|k-1}^{*j}-x_{k|k-1}^j)}^T+Q_{k-1}}\end{array}$$

(17)

where the number of points L is $n^2+3n+3$, and $Q_{k-1}$ denotes the system noise covariance matrix.

B. Measurement Update

The cubature points used for the measurement update and the propagated cubature points are derived as:

$$\begin{array}{l}{\chi }_{i,k|k-1}^j=S_{k|k-1}^j{\xi }_i^j+x_{k|k-1}^j\\ Z_{i,k|k-1}^j=h({\chi }_{i,k|k-1}^j)\end{array}$$

(18)

where $S_{k|k-1}^j$ can be obtained by factorizing the predicted error covariance $P_{k|k-1}^j$.

The prediction value of the measurement vector $z_{k|k-1}^j$, the innovation covariance matrix $P_{zz,k|k-1}^j$, and the cross covariance matrix $P_{xz,k|k-1}^j$ are given as follows:

$$\begin{array}{l}{z}_{k|k-1}^j={\displaystyle \sum _{i=1}^L{\omega }_i{Z}_{i,k|k-1}^j}\\ P_{zz,k|k-1}^j={\displaystyle \sum _{i=1}^L{\omega }_i(Z_{i,k|k-1}^j-z_{k|k-1}^j){(Z_{i,k|k-1}^j-z_{k|k-1}^j)}^T+\mathit{R}}\\ P_{xz,k|k-1}^j={\displaystyle \sum _{i=1}^L{\omega }_i({\chi }_{i,k|k-1}^j-x_{k|k-1}^j){(Z_{i,k|k-1}^j-z_{k|k-1}^j)}^T}\end{array}$$

(19)

Finally, the estimated state ${\widehat{\mathit{x}}}_{k|k}^j$ of model $j$ and the estimated error covariance ${\mathit{P}}_{k|k}^j$ of model $j$ can be derived as follows:

$$\begin{array}{l}{\mathit{K}}_k^j=P_{xz,k|k-1}^j\cdot \mathrm{inv}({\mathit{P}}_{zz,k|k-1}^j)\\ {\widehat{\mathit{x}}}_{k|k}^j={\mathit{x}}_{k|k-1}^j+{\mathit{K}}_k^j({\mathit{z}}_k-z_{k|k-1}^j)\\ P_{k|k}^j=P_{k|k-1}^j-{\mathit{K}}_k^j{P}_{zz,k|k-1}^j{({\mathit{K}}_k^j)}^T\end{array}$$

(20)

Step 3. Updating the Mode Probability at Time $k$

A. Computing the likelihood function at time k

With the use of the latest measurement $z_k$, the likelihood function value of model $j$ at time $k$ is given by:

$$L_k^j=N(z_k;z_{k|k-1}^j,v_k^j)={\left|2\pi S_k^{(j)}\right|}^{-n_z/2}\exp \left\{-\frac{1}{2}{[z_k-z_{k|k-1}^j]}^T{(S_k^{(j)})}^{-1}[z_k-z_{k|k-1}^j]\right\}$$

(21)

where $v_k^j=z_k-z_{k|k-1}^j$ denotes the filter residual and $S_k^{(j)}$ denotes the innovation covariance and $n_z$ denotes the dimension of measurement vector.

B. Updating the mode probability at time k

The mode probability ${\mu }_{k|k}^j$ at time $k$ is computed by the following equation:

$${\mu }_{k|k}^j=\frac{L_k^j{C}_j}{\mathit{C}},\mathit{C}={\displaystyle \sum _{i=1}^r{L}_k^j{C}_i}$$

(22)

Step 4. Output Integration

Finally, the state estimate ${\widehat{x}}_{k|k}$ and corresponding covariance $P_{k|k}$ are obtained by the model-conditional estimates and covariances of different models:

$${\widehat{x}}_{k|k}={\displaystyle \sum _{j=1}^r{\mu }_{k|k}^j{\widehat{x}}_{k|k}^j}$$

(23)

$$P_{k|k}={\displaystyle \sum _{j=1}^r{\mu }_{k|k}^j\left\{P_{k|k}^j+\left[{\widehat{x}}_{k|k}^j-{\widehat{x}}_{k|k}\right]{\left[{\widehat{x}}_{k|k}^j-{\widehat{x}}_{k|k}\right]}^T\right\}}$$

(24)

4. Simulation and Results

To validate the performance of the proposed algorithm, a highly maneuvering target example has been considered. The proposed algorithm will be compared with the IMMCKF, IMMUKF, and IMM5thCKF algorithm.

4.1. Tracking Model and Measurement Model

Let the state vector at time k be ${\mathit{x}}_k={[x_k,{\dot{x}}_k,y_k,{\dot{y}}_k]}^T$, which includes the position (m) and velocity component (m/s) in the x-axis and y-axis. For tracking of the maneuvering target, three models are employed: the constant velocity (CV) model, left constant turn (LCT) model and right constant turn (RCT) model. For constant velocity model, the equation of state is described as:

$${\mathit{x}}_k={\mathit{F}}_{\mathrm{CV}}{\mathit{x}}_{k-1}+w_{\mathrm{CV}},$$

(25)

$$F_{\mathrm{CV}}=\left[\begin{array}{cccc}1& T& 0& 0\\ 0& 1& 0& 0\\ 0& 0& 1& T\\ 0& 0& 0& 1\end{array}\right]$$

(26)

where $w_{\mathrm{CV}}$ is the white Gaussian process noise with zero mean and nonsingular covariance $Q_{\mathrm{CV}}$.

$$Q_{\mathrm{CV}}=\left[\begin{array}{cccc}{T}^3/3& T^2/2& 0& 0\\ T^2/2& T& 0& 0\\ 0& 0& T^3/3& T^2/2\\ 0& 0& T^2/2& T\end{array}\right]q_{\mathrm{CV}}$$

(27)

where the scalar parameter $q_{\mathrm{CV}}$ is the spectral density and set to 1. The constant turn (CT) model is defined as:

$${\mathit{x}}_k={\mathit{F}}_{\mathrm{CT}}{\mathit{x}}_{k-1}+w_{\mathrm{CT}},$$

(28)

$$F_{\mathrm{CT}}=\left[\begin{array}{cccc}1& \frac{\sin \omega T}{\omega }& 0& -\left(\frac{1-\cos \omega T}{\omega }\right)\\ 0& \cos \omega T& 0& -\sin \omega T\\ 0& \frac{1-\cos \omega T}{\omega }& 1& \frac{\sin \omega T}{\omega }\\ 0& \sin \omega T& 0& \cos \omega T\end{array}\right]$$

(29)

where $w_{\mathrm{CT}}$ is the white Gaussian process noise with zero mean and nonsingular covariance $Q_{\mathrm{CT}}$.

$$Q_{\mathrm{CT}}=\left[\begin{array}{cccc}{T}^3/3& T^2/2& 0& 0\\ T^2/2& T& 0& 0\\ 0& 0& T^3/3& T^2/2\\ 0& 0& T^2/2& T\end{array}\right]q_{\mathrm{CT}}$$

(30)

where the scalar parameter $q_{\mathrm{CT}}$ is set to 1, T is the sampling interval, w stands for the turn rate which is supposed to be known, the right turn rate is defined as $-3°$, and the left turn rate is defined as $3°$.

In the experiment, the radar is located at the origin of the plan and equipped to measure range and bearing. Then, the measurement equation can be written as:

$$z_k=\left(\begin{array}{c}{r}_k\\ {\theta }_k\end{array}\right)=\left(\begin{array}{l}\sqrt{x_k^2+y_k^2}\\ {\tan }^{-1}(y_k/x_k)\end{array}\right)+v_k$$

(31)

where $r_k$ is the range value at time k, ${\theta }_k$ is the bearing value at time k, tan⁻¹(·) is the inverse tangent function, and $v_k$ is the white Gaussian measurement noise with zero mean and covariance $R_k=diag([{\sigma }_r^2,{\sigma }_{\theta }^2])$. ${\sigma }_r$ and ${\sigma }_{\theta }$ denote the standard deviation of range measurement noise and bearing angle measurement noise, respectively.

4.2. Simulation of the IMM5thSSRCKF

The simulation scene is designed as follows. The sampling interval is T = 1 s and repeats 100 times. The target moves in different state for five periods. The initial position is (15,000 m, 1000 m) and the target starts at 1 s with the velocity (−180 m/s, 200 m/s). From 1 s to 20 s it has motion at constant velocity; from 21 s to 70 s it turns right with $\omega =-3°$; from 71 s to 120 s it has motion at a constant velocity; from 121 s to 170 s it maneuvers and turns left with $\omega =3°$; and from 171 s to 200 s it has motion at constant velocity.

The initial estimates ${\widehat{x}}_0$ are generated from the Gaussian distribution $\mathit{N}({\widehat{x}}_0;x_0,{\mathit{P}}_0)$ in which the true initial is $x_0$ = [15,000, −180, 100, 200]^T. The standard deviation of range measurement noise ${\sigma }_r$ is 40 m and the standard deviation of bearing angle measurement noise ${\sigma }_{\theta }$ is 7 mrad. The initial model probability is $\mu$ = [0.8 0.1 0.1] and the transition probability is given as:

$$p_{ij}=\left[\begin{array}{ccc}0.95& 0.025& 0.025\\ 0.025& 0.95& 0.025\\ 0.025& 0.025& 0.95\end{array}\right]$$

(32)

The root mean square error (RMSE) of the target position at time k and the accumulative RMSE (ARMSE) of estimated position at all times are defined in Equations (33) and (34):

$${\mathrm{RMSE}}_{\mathrm{pos}}(k)=\sqrt{\frac{1}{M}{\displaystyle \sum _{m=1}^M({(x_k-{\widehat{x}}_{m,k})}^2+{(y_k-{\widehat{y}}_{m,k})}^2)}}$$

(33)

$${\mathrm{ARMSE}}_{\mathrm{pos}}=\sqrt{\frac{1}{N}{\displaystyle \sum _{k=1}^N({\mathrm{RMSE}}_{\mathrm{pos}}^2(k))}}$$

(34)

where $M$ is the number of Monte Carlo runs, N is the total number of sampling points, $(x_k,y_k)$ is the actual value of the target position at time $k$ and $({\widehat{x}}_{m,k},{\widehat{y}}_{m,k})$ is the estimated position at time $k$ in mth Monte-Carlo. The RMSE and the accumulative RMSE in the velocity and acceleration can be defined in the same way. The performance comparison of the four algorithms are tested 200 times in Monte Carlo simulations.

Figure 2 gives the target trajectory and the state estimation generated from a single run of IMMUKF, IMMCKF, IMM5thCKF and IMM5thSSRCKF. As seen from Figure 2, these four algorithms can track the trajectory of the target.

Figure 2. Trajectory of the maneuvering target. IMMUKF: interacting multiple model unscented Kalman filter; IMMCKF: interacting multiple model cubature Kalman filter; IMM5thCKF: interacting multiple model fifth-degree cubature Kalman filter; IMM5thSSRCKF: interacting multiple .model fifth-degree spherical simplex-radial cubature Kalman filter

The RMSEs in position and velocity of the four algorithms are shown in Figure 3 and Figure 4, respectively. It can be seen that the proposed IMM5thSSRCKF performs better than the IMMUKF, IMMCKF and IMM5thCKF algorithms when the target moves with CV. The tracking error of target position of the three IMM algorithms would be almost the same when the target moves at constant velocity. The estimation effectiveness of the IMM5thSSRCKF estimator for tracking a maneuvering target outperform greatly than the other two IMM estimators.

Figure 3. RMSE in position versus time step.

Figure 4. RMSE in velocity versus time step.

To further evaluate the performance of the four algorithms, the ARMSEs of position and velocity of each algorithm are listed in Table 1. It can be seen from the Table 1 that IMM5thSSRCKF does better in tracking precision than IMMUKF, IMMCKF and IMM5thCKF, while all of them exhibit no error divergence.

Table 1. Comparisons of accumulative RMSE (ARMSE) among the four algorithms.

Filters	Position ARMSE/m	Velocity ARMSE/(m/s)
IMMUKF	74.3	23.4
IMMCKF	72.4	22.5
IMM5thCKF	68.1	20.9
IMM5thSSRCKF	66.2	19.3

The comparisons of CV mode probability of IMMUKF, IMMCKF, IMM5thCKF and IMM5thSSRCKF are shown in Figure 5. The mode transitions occur at t = 21 s, t = 71 s, t = 121 s and t = 171 s, respectively. This figure shows that the IMMUKF, IMMCKF, IMM5thCKF and IMM5thSSRCKF can capture the kinematics of maneuvering when the motion state changes. It can be seen that the mode probabilities of the IMMUKF algorithm are not good at detecting mode transitions. The proposed algorithm and IMM5thCKF algorithm are equally faster at detecting model changes compared with the IMMUKF algorithm and the IMMCKF algorithm.

Figure 5. Constant velocity (CV) mode probability versus time step.

All the algorithms are implemented on the Intel Core^TM i5-4430 3.0GHZ CPU with 4.00 G RAM. Table 2 shows the number of points and computational time of IMMUKF, IMMCKF, IMM5thCKF and IMM5thSSRCKF for each run. The points of IMMCKF as well as IMMUKF differ only by one point. As shown in Table 2, the computational time of the algorithms is approximately proportional to the number of points. It is obvious that the IMM5thSSRCKF algorithm has a slightly lower computational cost than the IMM5thCKF due to the different cubature rule. Although the computation complexity of IMM5thSSRCKF algorithm is larger than IMMUKF and IMMCKF, it can be remedied by more high-speed computer technology.

Table 2. Number of points and computational time of different algorithms.

Filters	Number of Points (n = 4)	Computational Time (s)
IMMUKF	9	0.289
IMMCKF	8	0.279
IMM5thCKF	33	0.604
IMM5thSSRCKF	31	0.581

5. Conclusions

Maneuvering target tracking is the research hot spot in the target tracking field; this paper has presented a new maneuvering target tracking algorithm named IMM5thSSRCKF. The 5thSSRCKF algorithm is an efficient method to deal with the problem of nonlinear system estimation. The proposed algorithm introduces the 5thSSRCKF algorithm into the IMM framework, which can dispose of all the models simultaneously through Markov Chain. The performance of the proposed method is evaluated by simulations and compared with IMMUKF, IMMCKF and IMM5thCKF. Simulation results illustrate that the IMM5thSSRCKF algorithm has higher tracking accuracy and a quicker sensitivity response than IMMUKF, IMMCKF and IMM5thCKF algorithms.