Robust Control with Engineering ApplicationsView this Special Issue
Multitarget Tracking by Improved Particle Filter Based on Unscented Transform
This paper considers the problem of multitarget tracking in cluttered environment. To reduce the dependency on the noise priori knowledge, an improved particle filtering (PF) data association approach is presented based on the filter (HF). This approach can achieve higher robustness in the condition that the measurement noise prior is unknown. Because of the limitations of the HF in nonlinear tracking, we first present the unscented filter (HUF) by embedding the unscented transform (UT) into the extended filter (HEF) structure. Then the HUF is incorporated into the Rao-Blackwellized particle filter (RBPF) framework to update the particles. Simulation results are provided to demonstrate the effectiveness of the proposed algorithms in linear and nonlinear multitarget tracking.
Multitarget tracking is to estimate the targets’ current positions from a series of noise-corrupted measurements by filtering methods . In cluttered environment, the foremost difficulty involves the problem of associating the correct measurements with the appropriate tracks. A number of strategies, including the joint probabilistic data association (JPDA) [2, 3], multiple hypothesis tracking (MHT) [4, 5], S-D assignment , and the probabilistic hypothesis density filer (PHDF) [7–9], are available to solve this problem.
Recently, the sequential Monte Carlo (SMC) data association approaches are also applied to the tracking and association problems [10, 11]. This paper tackles data association joint with state estimation via a SMC method called Rao-Blackwellized particle filter (RBPF) [12–14]. This particle method can be considered as a generalization of MHT, which represents the data association and state posteriors as a discrete set of hypotheses. Instead of the pure particle strategy, a mixture of Gaussian representation of the joint posterior distribution is used to reduce the estimation variance. In the application of RBPF for nonlinear target tracking, it can replace the Kalman filter (KF) in the data association algorithm by the extended Kalman filter (EKF) or the unscented Kalman filter (UKF) . Although RBPF has shown higher tracking efficiency against the pure particle filtering schemes, there is still weakness lying in the strong assumptions on the system models and noise statistics . That is, the KF or its variants can only be applied in the condition that a perfect system model is known and the process and measurement noise statistics are white and Gaussian with known covariance matrices. In many practical applications, these assumptions can hardly be satisfied, and the performance of the KF based methods may degrade severely when the measurement disturbances are not in definite Gaussian forms. Hence, we need a solution with more robustness against the uncertainties of the noise than the KF. The filter (HF), which aims at minimizing the worst possible effects of the disturbances on the estimation errors, can provide an alternative to solve this problem [17–19]. Different from the KF, the only assumption made for HF is that the noise signals have a finite energy but without any statistic assumptions.
The HF techniques have been used in linear-model target tracking. Accordingly, the extended filter (HEF) has also been proposed for nonlinear models by using the EKF structure. As another way to approximate the filtering distribution, the unscented transform (UT) can be more accurate compared to the EKF for it performs a higher order of the Taylor series expansion. By a Gaussian density instead of approximating the nonlinear functions as the EKF, the UT technique has shown its priority in handling nonlinear estimation problems and also been combined with the filter . In this paper, we aim to incorporate the HF technique into the framework of RBPF to reduce its dependency on a priori knowledge of the noise statistics in multitarget tracking. In RBPF, the continuous state is estimated using the KF or its variants, while the discrete state or the mode state is estimated using particle filters. Thus, the HF can be embedded into the RBPF structure directly. Because of the limitations of the HF in nonlinear tracking, we present the unscented filter (HUF) by embedding the UT into the HEF structure. Since the HUF has the same observer structure as the UKF, it can also be embedded into the RBPF framework to update the continuous states of the particles.
The remainder of this paper is organized as follows. In Section 2, we give a brief introduction of the generic RBPF target tracking approach and the basic linear filter structure. The main work is given in Section 3 where the HUF is first presented. Then the HUF is incorporated into the RBPF framework to update the particles. Simulation results are provided in Section 4 to demonstrate the effectiveness of the proposed algorithms in linear and nonlinear multitarget tracking. In Section 5, conclusions are also given to summarize the main works of this paper.
2.1. Rao-Blackwellized Particle Filter for Target Tracking
Consider the following time-varying state-space system: where and are the system state and measurement vectors at time step , respectively. and are zero mean mutually independent Gaussian process noise, and and are matrices with compatible dimensions. Suppose that we are able to form another variable to describe the matrices and ; then the RBPF algorithm can be applied to estimate the whole state . For space consideration, we omit the details of the RBPF algorithms which can be found in [22, 23]. In the application of RBPF for target tracking, the latent variable is defined to be the data association event indicator . That is, when the measurement is from clutter, and when the measurement is from target (, where is number of targets). The predictive probability gives the data association prior given the data association results in the previous time steps. The posterior distribution of is which can be calculated by where the data association prior is modeled as a recursive Markov chain, which guarantees the association assumption of one target per measurement in each time step. Accordingly, the in (2) has been replaced by , and the general form of the joint prior model is given by That means if we obtain measurements in time step , the th () measurement’s association prior only depends on the previous association results in the th time step. Note that has the prior if . This RBPF multitarget tracking algorithm is also termed Rao-Blackwellized Monte Carlo data association (RBMCDA) . In this paper, we aim to improve the robustness of the RBPF for target tracking by the filter and unscented transform.
2.2. Linear Filter
Consider the model given by (1), where the process noise and the measurement noise are assumed to be uncorrelated zero-mean white noise processes with unknown statistical properties. Note that they are also the energy bounded signals. Let denote the estimation of given measurements . We can define the estimation error as and denote as the transfer operator that maps the unknown disturbances , , and to the estimation errors , where is a priori estimate of and represents unknown initial estimation error.
In optimal filter, it is operated to minimize the possible worst effects of the unknown disturbances on the estimation errors. That is, the estimation strategy should be designed so as to minimize the norm of the operator . Actually, it is hard to obtain the closed-form solution of the optimal filtering except in some specific cases. For example, the desired accuracy of the optimal filter can be obtained by iterating the of the suboptimal solution . This paper considers the suboptimal solutions that can bound the maximum energy gain from the disturbance to the estimation errors under the prescribed disturbance tolerance level. Given a scalar , find the estimation strategies such that the norm of satisfies [24, 25] where the notation is defined as the square of the weighted norm of , that is, . The matrix reflects a priori knowledge of how close is to the initial estimate . and are weighting matrices, by which the designer can make appropriate choice to satisfy the performance requirements. The solution to the filtering algorithm as shown in  is given by where is an identity matrix with compatible dimension. The matrix is given by
3. Improved Rao-Blackwellized Particle Filter
3.1. Nonlinear Filter with Unscented Transform
Consider the following discrete-time nonlinear state-space model: The HEF just replaces and in (5) and (7) by and , respectively. Here, we present the HUF by embedding the UT technique into the HF structure, which can be used to update the continuous-state particles in the RBPF framework. Suppose that sigma points are generated based on the state estimates at time , where the state estimate and its covariance have been obtained at time . is a scaling factor, and is the th row or column of the matrix squares root of . By implementing the UT into (5) and (6), the predicted mean and covariance can be obtained as follows: where is the normalized weight associated with the th sigma points (see [27, 28]). Since the linearized measurement function does not exist explicitly under the unscented transform framework, the statistical linear error propagation method  is used to reformulate the updated equations. Approximately, the measurement covariance and its cross-correlation covariance can be given by By using the predicted sigma points, they can be calculated by where By substituting (14) into (7)–(10), the filtered estimates can be obtained by where It should be pointed out that the HUF has the same observer structure as that of the UKF, and and play the same role as the covariance matrices of the process noise and the measurement noise when using the UKF. Hence, the weighting matrices can be adjusted with no conflictions to the framework of KF. For the HUF, it not only outperforms the HEF in accuracy, but also achieves more robustness than the UKF for unknown noise statistics .
3.2. Unscented Rao-Blackwellized Particle Filter
In this section, the HUF based RBPF multiple target tracking algorithm (HURBPF) is provided. It can be found that the will not be strictly Gaussian if the system dynamic and (or) measurement function are (is) nonlinear. In this case, the HUF can be a better candidate than HEF or UKF for updating the continuous state within the particle filtering framework. The conditional distribution mentioned above can be chosen as where and are the mean and covariance of computed by the HUF (17). The main procedure for the HURBPF algorithm is presented as follows (see Algorithm 1). In this algorithm, the target state priors can be represented as a weighted importance sample set where () is the identifier of particle.
Algorithm 1. unscented Rao-Blackwellized particle filter.
For to do.
Step 1. Do prediction step. For and , perform HUF prediction from the mean and covariances to generate the predicted estimates and .
Step 2. Calculate the data association priors based on the recursive Markov chain described in .
Step 3. For , perform HUF update for each particle to get contemporary filtered estimates and .
Step 4. Calculate the posterior distribution of :
Step 5. Sample a new association with probability : where
Step 6. Calculate the new weights
Step 7. Update the th target according to the new (). If (), then
Step 8. Calculate the target state vectors
End for. (Resample if needed [30–32].)
It should be pointed out that in filter the level must be selected carefully to guarantee the existence of the HUF, or else the filtering program will fail in the applications of HURBPF approach. To adaptively adjust to its minimum at each iteration, we can choose the value of as  where is a scalar larger than one and denotes the maximum eigenvalue of the matrix .
4. Simulation Results
This section presents the two-dimensional (2D) target tracking examples to demonstrate the performance of the proposed tracking algorithms.
Example 1. The targets are modeled with near constant velocity model in Cartesian coordinates. The discrete-time dynamic and measurement models of the th target have the following form: where and are zero mean Gaussian process noises. The standard process and measurement noise variances are selected as km and km, respectively. The sample interval and the correct measurements return with a known detection probability (detection missing will not happen). At each time step , the target is located at coordinates and moves with constant velocity vector , which are combined with the target’s state vector . In this two-target-crossing scenario (see Figure 1), target 1 and target 2 begin at with position-velocity coordinates and , respectively. The total number of tracking time steps is .
The KRBPF serves as the baseline algorithm, and the proposed HRBPF algorithm is compared with it. Both algorithms are designed based on the same assumptions, and the performance of the two algorithms is evaluated by the average results over Monte Carlo runs. The initial state estimates of the two targets are set to and , , respectively. The clutter is modeled as independent and identically distributed with uniform spatial distribution in a detection region of the coordinate plane [0 km, 500 km] [0 km, 500 km], and the number of clutter measurements obeys a Poisson distribution with the Poisson random number (clutter rate). The number of particles used in the simulation is . The standard measurement variance used in both algorithms, KRBPF (Kalman filter based RBPF) and HRBPF ( filter based RBPF), is km. The position root mean square errors (RMSEs) of the KRBPF and HRBPF algorithms are illustrated in Figure 2 (target 1) and Figure 3 (target 2). We can see that the overall performance of the proposed HRBPF is significantly better than that of the KRBPF as expected. This is due to the fact that the HF outperforms the KF when the statistics of the noise processes are not known by the filtering algorithms.
Example 2. Consider a scenario of tracking two targets using bearings-only measurements received by two static sensors which are located at (), (see Figure 4, where “□" represents the location of the sensor). The dynamic of discrete-time velocity model is the same as (28), and the measurement function is given by where with rad. Since this measurement model is nonlinear, the URBPF (UKF based RBPF) and HURBPF are employed for tracking. The clutter originated measurements obey Poisson distribution with clutter rate in a single time step. The detection region of the coordinated plane is set to be [0 km, 50 km] [0 km, 50 km]. The standard bearings-only measurement variance used in both algorithms is rad.
The performance of the HURBPF is compared with that of the URBPF using 50 particles. The two targets begin at with position-velocity coordinates and , respectively. The total number of tracking time steps is . In this example, the initial state estimates of the two targets are set to , and .
The tracking performance of the HURBPF and the URBPF in terms of RMSE in position is shown in Figures 5 and 6. It can be seen that the HURBPF also outperforms the URBPF for almost the entire simulation interval since the HURBPF deals with the unknown measurement noises variance priors. By the typical examples demonstrated above, a conclusion can be drawn that the based RBPF algorithms show good robustness against unknown noise statistics.
In this paper, we present an improved Rao-Blackwellized particle filtering algorithm by using the unscented transform. The main benefit lies in it requiring no priori knowledge of the statistical properties of the measurement noise. By decomposing the RBPF filtering distribution, the HRBPF and HURBPF algorithms are developed based on the filter for solving the multitarget tracking problems with unknown noise statistics. The proposed algorithms are tested by both the linear and nonlinear tracking experiments. Simulation results show that they can achieve better tracking performance than the standard KF and UKF based RBPF algorithms.
The author would like to thank the anonymous reviewers for their helpful comments on this paper.
S. Särkkä, A. Vehtari, and J. Lampinen, “Rao-Blackwellized Monte Carlo data association for multiple target tracking,” in Proceedings of the 7th International Conference on Information Fusion (FUSION '04), pp. 583–590, Stockholm, Sweden, July 2004.View at: Google Scholar
A. Doucet, J. D. Freitas, and N. Gordon, Sequential Monte Carlo Methods in Practice, Springer, New York, NY, USA, 2001.View at: MathSciNet
D. Simon, Optimal State Estimation: Kalman, H∞ and Nonlinear Approaches, Wiley Press, 2006.
G. Sibley, G. Sukhatme, and L. Matthies, “The iterated sigma point Kalman filter with applications to long range stereo,” in Proceedings of the 2nd Robotics: Science and Systems Conference, pp. 16–19, Philadelphia, Pa, USA, August 2006.View at: Google Scholar