Next Article in Journal
Wearable-Sensor-Based Detection and Prediction of Freezing of Gait in Parkinson’s Disease: A Review
Next Article in Special Issue
Multi-Target Localization and Tracking Using TDOA and AOA Measurements Based on Gibbs-GLMB Filtering
Previous Article in Journal
Infrared Image Super-Resolution Reconstruction Based on Quaternion and High-Order Overlapping Group Sparse Total Variation
Previous Article in Special Issue
Tracking Multiple Marine Ships via Multiple Sensors with Unknown Backgrounds
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Anti-Clutter Gaussian Inverse Wishart PHD Filter for Extended Target Tracking

College of Electronic Science, National University of Defense Technology, Changsha 410073, China
*
Author to whom correspondence should be addressed.
Sensors 2019, 19(23), 5140; https://doi.org/10.3390/s19235140
Submission received: 11 October 2019 / Revised: 19 November 2019 / Accepted: 22 November 2019 / Published: 23 November 2019

Abstract

:
The extended target Gaussian inverse Wishart probability hypothesis density (ET-GIW-PHD) filter overestimates the number of targets under high clutter density. The reason for this is that the source of measurements cannot be determined correctly if only the number of measurements is used. To address this problem, we proposed an anti-clutter filter with hypothesis testing, we take into account the number of measurements in cells, the target state and spatial distribution of clutter to decide whether the measurements in cell are clutter. Specifically, the hypothesis testing method is adopted to determine the origination of the measurements. Then, the likelihood functions of targets and clutter are deduced based on the information mentioned above, resulting in the likelihood ratio test statistic. Next, the likelihood ratio test statistic is proved to be subject to a chi-square distribution and a threshold corresponding to the confidence coefficient is introduced and the measurements below this threshold are considered as clutter. Then the correction step of ET-GIW-PHD is revised based on hypothesis testing results. Extensive experiments have demonstrated the significant performance improvement of our proposed method.

1. Introduction

Extended target tracking (ETT) draws lots of attention in recent years because of its wide range of applications in traffic control [1], autonomous driving [2,3,4], person tracking [5,6] and etc. [7,8,9,10,11]. Since one extended target generates more than one measurement per time step, its shape information can be obtained. Using this information, the kinematic state and extent of the target can be estimated simultaneously. The extent of the target including the size, shape, and orientation can be further used for target identification.
The difference between point target tracking and extended target tracking lies in the measurement model and hypotheses. Point target generates at most one measurement per time step, while the extended target generates multiple measurements. Many algorithms were proposed to track point target based on point target hypothesis, such as probability hypothesis density (PHD) filter [12] and cardinalized PHD (CPHD) filter [13]. Since the extended target violates one measurement hypothesis, the number of targets will be overestimated if point target tracking algorithms are directly used for tracking extended targets. To address this problem, Mahler proposed an extended target tracking algorithm based on the inhomogeneous Poisson Point Process model (PPP model) [14] in random finite sets (RFSs) frame, namely extended target probability hypothesis density (ET-PHD) [15], Jiang et al. [16] proposed a novel time-matching ET-PHD filter, a Gaussian mixture implementation of the ET-PHD, called the extended target Gaussian inverse Wishart probability hypothesis density (ET-GIW-PHD) filter, has been presented in [17]. However, ET-PHD only estimates the kinematic state of the target (such as position, velocity) and does not estimate the extent of the target. Therefore, this method cannot extract the shape of the target. Nevertheless, the estimation of the target extent is important because it can be used to classify target and improve tracking accuracy [18,19,20].
Measurement partition is an important step in ETT. In ETT, measurements are partitioned into several non-empty subsets, each subset contains measurements that are all from the same source, either a single target or a clutter source, the subset is defined as cell. In ETT, the increase of measurements gives rise to the quick increase of the set partitions, thus the partition algorithm should be designed to achieve tractable computational complexity. Distance partition [17] is the most widely used method. Modified Bayesian adaptive resonance theory (MB-ART) [21] can also achieve good performance. For more details about other partition algorithms, please see [22,23,24].
One of the most important works in extended target tracking is how to model the target extent. To address this problem, the stick model is used for bicycle and pedestrian tracking [25,26]. The object extension is represented by a symmetric positive definite (SPD) random matrix [27], namely a random matrix (RM) model. Feldmann et al. [28] adapted the RM model for the case when the sensor error cannot be ignored. Lan et al. [29] took into account time variation and distortion of target extension in RM frame. In order to handle irregular shapes, a random hypersurface model (RHM) is introduced in [30,31,32]. Gaussian Processes (GP) was used to represent the target shape and achieved good performance [33,34,35,36]. Since shape estimation is similar to curving fitting, Kaulbersch et al. [37] applied a curve fitting method for shape estimation. Granstr o ¨ m et al. [38] proposed an extension model for specific sensor. Granstr o ¨ m et al. [39] proposed extended target Gaussian inverse Wishart PHD (ET-GIW-PHD) filter to incorporate widely used RM model into PHD filter and approximate the estimated PHD with an unnormalized mixture of Gaussian inverse Wishart (GIW) distributions. Later, Granstr o ¨ m et al. [40] proposed extended target Gamma Gaussian inverse Wishart PHD (ET-GGIW-PHD) filter to estimate the measurement rate and target state simultaneously. The combination of several RM model was used to model nonelliptic targets in [41,42]. As mentioned in [39], more experiments that test ET-GIW-PHD filters are needed, e.g., for data that contains more clutter than typical laser data does, this provides the general motivation for this paper. We found that the number of targets will be overestimated which degrades the final performance when severe clutters are partitioned into one cell in ET-GIW-PHD. More analyses are presented in Section 3. In this paper, we proposed an anti-clutter ET-GIW-PHD filter for better cardinality estimation performance.
The main contributions of this paper are twofold. First, the reason why ET-GIW-PHD overestimates the number of targets is discussed detailedly, and the probability of the measurement generated by clutter against different scenario parameters is presented. Second, in order to deal with the cardinality overestimation in ET-GIW-PHD, we proposed an anti-clutter ET-GIW-PHD filter which revises the correction step of ET-GIW-PHD with hypothesis testing. Hypothesis testing is introduced to determine the source of measurements in the cell, hypothesis testing results are integrated into the correction step in ET-GIW-PHD. In order to deal with the source of measurements correctly, the essential differences between the measurements of targets and clutter should be recognized. Since the variation of target state over time follows certain rules (motion model and shape transition model), the state of targets could be predicted while clutter could not. Then, the likelihood functions of targets and clutter are deduced. The likelihood functions are built based on not only the number of measurements but also the target state and spatial distribution of clutter. Since the likelihood ratio test statistic is proved to be subject to chi-square distribution, a threshold corresponding to the confidence coefficient is introduced, this threshold is used to determine the source of measurements in the cell. It worth note that the perfect sensor resolution is advocated as a theoretical hypothesis in this paper. In reality, the results in the Section 5 will be affected by the limited sensor resolution. Future work will tackle the sensor’s limited resolution.
The rest of the paper is outlined as follows. Section 2 reviews the ET-GIW-PHD filter. Section 3 discusses the reason why ET-GIW-PHD overestimates the number of targets. Our anti-clutter ET-GIW-PHD is presented detailedly in Section 4. We conduct experiments in different simulation scenarios to demonstrate the effectiveness of our proposed approach in Section 5; Conclusion is drawn in Section 6.

2. ET-GIW-PHD Review

In ET-GIW-PHD, both predicted PHD and corrected PHD can be approximated as an unnormalized mixture of Gaussian inverse Wishart distributions. Let ζ k = { x k , X k } be the sufficient statistics of the GIW components at time which contains kinematical state x k and extension state X k which is mathematically described by a symmetric and positively definite (SPD) random matrix. The iterative formulae for ξ k are obtained in [39]. More implementation details, such as pruning and merging, can also be found in [39].
Prediction:
D k + 1 | k ( ξ k + 1 ) = p s ( ξ k ) p k + 1 | k ( ξ k + 1 | ξ k ) × D k | k ( ξ k ) d ξ k + D k + 1 b ( ξ k + 1 ) ,
where p s ( · ) is the probability of survival, p k + 1 | k ( ξ k + 1 | ξ k ) is the state transition density, D k + 1 b ( · ) is the birth PHD, new target spawning is omitted [39].
Correction:
The corrected PHD D k | k ( ξ k ) can be summarized as:
D k | k ( ξ k ) = D k | k N D ( ξ k ) + p Z k W p D k | k D ( ξ k , W ) ,
where p Z k means that the measurement sets Z k are partitioned into non-empty cells, W p means that the cell W is in the partition p .
D k | k N D ( ξ k ) handles the undetected target case, because D k + 1 | k ( ξ k + 1 ) is approximated as an unnormalized mixture of Gaussian inverse Wishart distributions, it is given by
D k | k N D ( ξ k ) = j = 1 J k | k 1 w k | k j N ( x k ; m k | k ( j ) , P k | k ( j ) X k ) IW ( X k ; v k | k ( j ) , V k | k ( j ) ) ,
where J k | k 1 is the number of components of predicted PHD, w k | k ( j ) is the weight of GIW component. N ( x ; m , P ) means that a vector x is subject to Gaussian distribution with mean m and covariance P , I W ( X ; v , V ) means that a matrix is subject to inverse Wishart distribution with degree of freedom v and inverse scale matrix V . ⊗ is the Kronecker product.
D k | k D ( ξ k , W ) handles the detected target case, which is given by
D k | k D ( ξ k , W ) = j = 1 J k | k 1 w k | k ( j , W ) N ( x k ; m k | k ( j , W ) , P k | k ( j , W ) X k ) I W ( X k ; v k | k ( j , W ) , V k | k ( j , W ) ) .
w k | k ( j , W ) can be obtained by
w k | k ( j , W ) = ω p d W e γ ( j ) γ ( j ) λ c c k | W | p D ( j ) Λ k ( j , W ) w k | k 1 ( j ) ,
where
d W = δ | W | , 1 + j = 1 J k | k 1 e γ ( j ) γ ( j ) λ c c k | W | p D ( j ) Λ k ( j , W ) w k | k 1 ( j )
Λ k ( j , W ) = 1 ( π | W | | W | S k | k 1 ( j , W ) ) d 2 | V k | k 1 ( j ) | v k | k 1 ( j ) 2 Γ d ( v k | k ( j , W ) 2 ) | V k | k 1 ( j , W ) | v k | k ( j , W ) 2 Γ d ( v k | k 1 ( j ) 2 )
ω p = W P d W P Z k W P d W .
Λ k ( j , W ) presents the likelihood of the jth GIW component given the measurements of the Wth cell, ω p is the weight of pth partition, p D ( j ) is the detection probability of jth GIW component, γ ( j ) is the expected number of measurements generated by jth GIW component, λ c is the mean number of clutter measurements, c k is the spatial distribution of the clutter over the surveillance volume, δ i , j is the Kronecker delta, | W | is the the number of measurements in the Wth cell, S k | k 1 ( j , W ) is innovation factor, Γ d ( · ) is the multivariate Gamma function.

3. Analysis of ET-GIW-PHD

In ET-GIW-PHD, the calculation of w k | k ( j , W ) is important. If the measurements in Wth cell are generated by clutter, w k | k ( j , W ) is expected to be smaller than the pruning threshold, then the corresponding component will be eliminated and the clutter will be eliminated.
In Equation (5), w k | k ( j , W ) contains two parts, one is the weight of the pth partition, denoted by ω p , the other is the weight of Wth cell in partition. Without loss of generality, only one partition is considered for clarity, therefore ω p = 1 . Substituting Equation (6) into Equation (5), we arrive at
w k | k ( j , W ) = e γ ( j ) γ ( j ) λ c c k | W | p D ( j ) Λ k ( j , W ) w k | k 1 ( j ) δ | W | , 1 + l = 1 J k | k 1 e γ ( l ) γ ( l ) λ c c k | W | p D ( l ) Λ k ( l , W ) w k | k 1 ( l ) .
From Equation (9), the numerator is a part of denominator, the measurements of Wth cell is used to correct each GIW component, then Λ k ( j , W ) can be obtained, w k | k ( j , W ) can be given based on some prior parameters, such as p D , γ , λ c and c k (for brevity, the subscript and superscript are omitted here).
If the measurements in the cell are generated by clutter, the likelihood Λ k ( j , W ) of each GIW component will be very small since clutter does not obey the kinematic and extent model of target. If the number of clutter measurements in the cell is equal to one, then | W | = 1 , δ | W | , 1 = 1 , l = 1 J k | k 1 e γ ( l ) γ ( l ) λ c c k | W | p D ( l ) Λ k ( l , W ) w k | k 1 ( l ) will be much smaller than 1 because the likelihood Λ k ( j , W ) achieves a small value mentioned above and other parameters can be considered as constants, the value of w k | k ( j , W ) will be close to 0 and is smaller than the pruning threshold, then the corresponding component will be eliminated and the clutter is eliminated. However, if the number of clutter measurements in the cell is more than one, then | W | 1 , δ | W | , 1 = 0 , Equation (9) is the normalization process. Although Λ k ( j , W ) is close to zero, w k | k ( j , W ) can still take a large value. In this case, ghost targets will emerge and the number of targets will be overestimated. Further details on numerical implementation can be found in Section 5.
According to the analysis above, if the measurement in the cell is clutter, l = 1 J k | k 1 e γ ( l ) γ ( l ) λ c c k | W | p D ( l ) Λ k ( l , W ) w k | k 1 ( l ) (denoted by l = 1 J k | k 1 ψ l , W ) in Equation (9) should be added by 1. Otherwise, it should be added by 0 and the clutter can be eliminated. However, from Equation (9), if the cell contains only one measurement, l = 1 J k | k 1 ψ l , W is added by 1, it means that the cell contains only one measurement is considered as clutter in ET-GIW-PHD. Otherwise, it is considered as a target if the cell contains more than one measurement. In fact, this assumption can be violated under strong clutter. The criterion whether measurements in the cell are generated by clutter based on only the number of measurements can be erroneous. A simple numerical calculation is shown below to illustrate this point.
In ET-GIW-PHD, the probability of the measurements of the cell generated by clutter is obtained based on the Bayesian theorem, see Equation (10). Note that, only the number of measurement is considered in this calculation.
P ( Z W C | n W = 1 ) = 1 P ( Z W T | n W = 1 ) = P ( n W = 1 | Z W C ) P ( Z W C ) P ( n W = 1 | Z W T ) P ( Z W T ) + P ( n W = 1 | Z W C ) P ( Z W C ) ,
where Z W presents the measurements in cell, n W is the number of measurements in cell, C and T mean clutter and target respectively, P ( Z W C ) and P ( Z W T ) are the prior information.
The number of measurements generated by the target is subject to Poisson distribution with Poisson rate γ , the detection probability is p d , then
P ( n W = 1 | Z w T ) = i = 1 p d ( 1 p d ) i 1 C i 1 γ i i ! e γ = j = 0 p d ( 1 p d ) j ( j + 1 ) γ j + 1 ( j + 1 ) ! e γ = p d γ e p d γ j = 0 ( ( 1 p d ) γ ) j j ! e ( 1 P d ) γ = p d γ e p d γ .
where C m n = n ! m ! ( m n ) ! denotes the combinatorial number of the events that m out of n.
Remark: p d is not equal to p D in Equation (6). p d is the probability that one measurement generated by target or clutter is detected, while p D is the probability that an extended target will generate a measurement set [15]. p D can be derived if p d is already known.
The clutter measurements are assumed to be uniformly distributed over the surveillance area, and the number of clutter is subject to Poisson distribution with Poisson rate λ c . So we have
P ( n W = 1 | Z w C ) = i = 1 p d ( 1 p d ) i 1 C i 1 λ c i i ! e λ c = p d λ c e p d λ c .
When the number of measurements is 1, the probability of the measurement in the cell generated by clutter is shown in Table 1 with different γ and λ c . In this simulation, the prior information is set to 0.5, then P ( Z W C ) = P ( Z W T ) = 0.5 .
From Table 1 we can see that when γ = 10 , λ c = 35 and p d = 0.9 , P ( Z W C | n W = 1 ) = 0.013 . Although the cell contains only one measurement, the probability of the measurement in the cell generated by clutter is close to 0. Consequently, the criterion of ET-GIW-PHD does not work well in this case. when γ = 10 and λ c = 5 , P ( Z W C | n W = 1 ) = 1 . In this case, the clutter is distinguished correctly based on the criterion of ET-GIW-PHD. In summary, the determination whether measurements are generated by clutter based on only the number of measurements can be erroneous.

4. Anti-Clutter ET-GIW-PHD

The difference between ET-GIW-PHD and anti-clutter ET-GIW-PHD is how to determine the source of measurements in the cell, specifically, the difference is how to obtain d W in Equation (6). Using only the number of measurements in ET-GIW-PHD to determine whether the measurements in the cell is the target or not may be erroneous. In contrast, our anti-clutter ET-GIW-PHD uses hypothesis testing to deal with this problem. The number of measurements, the kinematic state and extent state of target and clutter spatial distribution are taken into account to obtain the likelihood ratio test statistic.
There are two hypotheses:
H 0 : Z W C ,
H 1 : Z W T ,
where Z W = { z 1 , z 2 , , z n W } is the measurements of Wth cell, n W is the number of the measurements, C and T represent clutter and target respectively.
The likelihood ratio test statistic for hypothese is given by
η = L ( Z W | T ) L ( Z W | C ) ,
where L ( Z W | T ) and L ( Z W | C ) are the likelihood to measure the set Z W given Z W T and Z W C respectively and L ( Z W | T ) and L ( Z W | C ) will be presented later.
If log ( · ) is applied to Equation (15), log ( η ) can be obtained.
log η = log L ( Z W | T ) log L ( Z W | C ) .
Because log ( · ) is monotony increase, log ( η ) is also the test statistic for hypothesis H 0 versus H 1 . If these measurements are generated by the target, L ( Z W | T ) will achieve a large value and L ( Z W | C ) will be small. Consequently, the statistics log ( η ) will grow to a large value. Using a threshold, we can distinguish between targets and clutter. Specifically, if log ( η ) is greater than the threshold, the measurements in the cell is considered to be generated by targets. Otherwise, these measurements are considered to be clutter. The expression of L ( Z W | T ) and L ( Z W | C ) are given below, the setting of the threshold is discussed.
If the measurements are generated by a target, different extent models lead to a different expression of L ( Z W | T ) . In this paper, L ( Z W | T ) is deduced based on the model in [27],
L ( Z W | T ) = j = n W p d n W ( 1 p d ) j n W C j n W γ j j ! e γ · i = 1 n W N ( z i ; ( H k I d ) x k , X k ) = j = n W p d n W ( 1 p d ) j n W j ! n W ! ( j n W ) ! γ j j ! e γ · i = 1 n W N ( z i ; ( H k I d ) x k , X k ) = p d n W γ n W n W ! e p d γ j = n W ( ( 1 p d ) γ ) j n W ( j n W ) ! e ( 1 p d ) γ · i = 1 n W N ( z i ; ( H k I d ) x k , X k ) = p d n W γ n W n W ! e p d γ i = 1 n W N ( z i ; ( H k I d ) x k , X k ) ,
where I d is an unit matrix with d dimension, X k is the extension of target at time k, H k is the 1D observation matrix.
The clutters are assumed to be uniformly distributed over the surveillance area [27], then
L ( Z W | C ) = β F A n W j = n W λ c j j ! e λ c C j n W p d n W ( 1 p d ) j n W = β F A n W j = n W λ c j j ! e λ c j ! n W ! ( j n W ) ! p d n W ( 1 p d ) j n W = β F A n W p d n W λ n W n W ! e p d λ c j = n W ( ( 1 p d ) λ c ) j n W ( j n W ) ! e ( 1 p d ) λ c = β F A n W p d n W λ c n W n W ! e p d λ c i = 0 ( ( 1 p d ) λ c ) i i ! e ( 1 p d ) λ c = β F A n W p d n W λ c n W n W ! e p d λ c ,
where β F A = λ c c k , λ c is the mean number of clutter measurements, c k is the spatial distribution of the clutter over the surveillance volume.
Substitute Equations (17) and (18) into Equation (16), we have
log ( η ) = log L ( Z W | T ) log L ( Z W | C ) = j = 1 n W log ( N ( z j ; ( H k I d ) x k , X k ) ) + log ( p d n W γ n W n W ! e p d γ ) log ( β F A n W p d n W λ c n W n W ! e p d λ c ) = j = 1 n W { 0.5 log 2 π 0.5 log | X k | } j = 1 n W { 0.5 ( z j ( H k I d ) x k ) X k 1 ( z j ( H k I d ) x k ) T } + ( p d γ + n W log p d γ i = 1 n W log i ) ( p d λ c + n W log p d λ c i = 1 n W log i ) n W log β F A = 0.5 j = 1 n W { ( z j ( H k I d ) x k ) X k 1 ( z j ( H k I d ) x k ) T } 0.5 n W log 2 π 0.5 n W log | X k | p d ( γ λ c ) + n W log ( γ λ c ) n W log β F A = 0.5 G + D ,
where
G = j = 1 n W ( z j ( H k I d ) x k ) X k 1 ( z j ( H k I d ) x k ) T
D = 0.5 n W log 2 π 0.5 n W log | X k | p d ( γ λ c ) + n W log ( γ λ c ) n W log β F A .
Because z j is subject to Gaussian distribution with mean ( H k I d ) x k and covariance X k , z j N ( ( H k I d ) x k , X k ) , thus
G = j = 1 n W ( z j ( H k I d ) x k ) X k 1 ( z j ( H k I d ) x k ) T X 2 ( n W ) ,
where G is subject to chi-square distribution with degree of freedom n W . In Equation (21), γ , λ c and β F A are priori known, the volume of the target extension is proportional to | X k | , the size of the target could be assumed to be unchanged, then D could be considered as a constant.
The confidence coefficient is set to α and a threshold is introduced (denoted by g), suppose hypothesi H 1 is true, then
P ( log η > g ) = P ( 0.5 G + D > g ) = P { G < 2 ( D g ) } = α ,
then
2 ( D g ) = X 1 α 2
g = D 0.5 X 1 α 2 ,
where
α = X α 2 ( n W ) X 2 ( n W ) d x .
From Equation (23), the probability of l o g ( η ) < g is 1 α . Generally, α is set to be a value close to 1 and l o g ( η ) < g is a small probability event. If l o g ( η ) < g is satisfied, hypothesi H 1 should be rejected. Finally, we have
If l o g ( η ) < g , the measurements are generated by clutter, then
d W = 1 + l = 1 J k | k 1 e γ ( l ) γ ( l ) β F A | W | p D ( l ) Λ k ( l , W ) w k | k 1 ( l ) .
If log η g ,the measurements are generated by targets, then
d W = l = 1 J k | k 1 e γ ( l ) γ ( l ) β F A | W | p D ( l ) Λ k ( l , W ) w k | k 1 ( l ) .
The pseudo-code for anti-clutter ET-GIW-PHD is illustrated in Table 2.
The difference between ET-GIW-PHD and anti-clutter ET-GIW-PHD lies in correction step. Pseudo-code for anti-clutter ET-GIW-PHD filter correction is shown in Table 3, pseudo-code for other steps (prediction, prune and merge etc) can be found in [39].

5. Simulation

In this section, the effectiveness of ET-GIW-PHD and anti-clutter ET-GIW-PHD were tested. Two scenarios with multiple targets were established. The surveillance area was set as [ 1000 m , 1000 m ] × [ 1000 m , 1000 m ] , then c k is 2.5 × 10 7 under the assumption that clutter is uniformly distributed over the surveillance area. We set totally 100 time steps and the sampling time is 1 s.
In the first scenario, four targets moving along different lines were generated:
x 0 ( 1 ) = [ 1000 m , 1000 m , 25 m / s , 25 m / s ] , t s ( 1 ) = 5 s , t e ( 1 ) = 45 s ; x 0 ( 2 ) = [ 1000 m , 1000 m , 25 m / s , 25 m / s ] , t s ( 2 ) = 15 s , t e ( 2 ) = 55 s ; x 0 ( 3 ) = [ 1000 m , 1000 m , 25 m / s , 25 m / s ] , t s ( 3 ) = 25 s , t e ( 3 ) = 65 s ; x 0 ( 4 ) = [ 1000 m , 1000 m , 25 m / s , 25 m / s ] , t s ( 4 ) = 35 s , t e ( 4 ) = 75 s ;
where x 0 ( j ) is the initial state of jth target, t s ( j ) is the born time of jth target, t e ( j ) is the end time of jth target. The birth intensity in the first scenario is
D b ( ξ ) = j = 1 4 w b N ( x ; x 0 ( j ) , P b X k ) IW ( X k ; v b , V b ) ,
where w b = 0.03 , P b = diag ( [ 100 , 100 ] ) , v b = 10 , V b = diag ( [ 100 , 100 ] ) .
In the second scenario, two targets were born at (−1000 m, 300 m) and (−1000 m, −300 m), respectively at k = 0 (k is time step). Next, they moved close gradually and then moved in parallel before separating. The birth intensity in the second scenario is
D b ( ξ ) = j = 1 2 w b N ( x ; m j , P b X k ) IW ( X k ; v b , V b ) ,
where m 1 = [ 1000 , 300 , 25 , 25 ] , m 2 = [ 1000 , 300 , 25 , 25 ] , w b = 0.03 , P b = diag ( [ 100 , 100 ] ) , v b = 10 , V b = diag ( [ 100 , 100 ] ) . The true trajectories of two scenario are shown in Figure 1.
The dynamic and measurement model are shown below. The target kinematic state is denoted as x = [ r x , r y , r ˙ x , r ˙ y ] , where r x and r ˙ x is the position and velocity in the x direction, likewise of y direction. The time evolution of kinematic state given by
x k ( j ) = F k ( j ) x k 1 ( j ) + w k ( j ) ,
where x k ( j ) is the target state of jth target at time k, w k is the process noise of jth target and is the Gaussian white noise with zero mean and covariance Q k ( j ) , F k ( j ) is the kinematic state transition matrix of jth target, given by
F k ( j ) = 1 0 t 0 0 1 0 t 0 0 1 0 0 0 0 1 , Q k ( j ) = Ω 2 t 2 2 t t 2 2 t ,
where t is the sampling time and Ω represents the acceleration error, t = 1 s and Ω = 5 m / s 2 in this simulation.
In this simulation, the major and minor axes are 20 m and 15 m respectively for all targets. The major axis was aligned with the direction of motion of the target and the extent of these targets remained unchanged.
The measurement model can be expressed as
z k ( j ) = ( H k I d ) x k ( j ) + q k ,
where z k ( j ) is the measurements generated by the jth target at time k, q k is the measurement noise and is the Gaussian white noise with zero mean and covariance R k , H k I d is the observation matrix, given by
H k I d = 1 0 0 1 0 0 0 0 , R k = 1 0 0 1 .
where H k = [ 1 , 0 ] , I d = 1 0 0 1 .
In our experiment, the confidence coefficient α of anti-clutter ET-GIW-PHD is set to 0.99. A distance partition algorithm [17] is used for both filters, a measurement partition that contains several cells can be obtained for a given distance threshold. Clutter Poisson rate λ c is set to 35, then clutter density λ c c k is 8.75 × 10 6 (the clutter density in this paper is higher than that of related references, such as [18,21]). The expected number of measurements generated by targets γ is set to 15. The probability of survival p s and the detection probability p D are assumed to be state independent and set to 0.99 and 0.98, respectively. The probability p d is set to 0.99.
Tracking results are evaluated using the optimal subpattern assignment metric (OSPA) [43], which is widely used to evaluate multiple-target tracking performance [39,40,41,42].
The OSPA distance is defined by
d p c ( ϰ k , ϰ k ^ ) = 1 n min π Π n i = 1 m d c ( x i , x ^ π ( i ) ) p + C p ( n m ) 1 / p ,
where m < n , ϰ k = { x k ( 1 ) , x k ( 2 ) , , x k ( m ) } is the true RFS at time k, ϰ ^ = { x ^ k ( 1 ) , x ^ k ( 2 ) , , x ^ k ( n ) } is the estimated RFS, n is the assignment results which assign ϰ to ϰ ^ , p means p n o r m , c is the penalty cost for cardinality mismatch. In this simulation, c = 60 and p = 2 .
ET-GIW-PHD and anti-clutter ET-GIW-PHD are applied to two scenarios mentioned above for performance evaluation. The trajectories generated by these two methods are presented in Figure 2 and Figure 3.
From Figure 2 and Figure 3 we can see that the trajectories of anti-clutter ET-GIW-PHD are almost identical to the true trajectories. Note that, in the results of ET-GIW-PHD, some peices of clutter are incorrectly considered as targets. However, our anti-clutter ET-GIW-PHD can deal with the clutter more correctly and achieves better performance.
To further verify the analysis in Section 3, the calculation of w k | k ( j , W ) in Equation (9) at k = 40 (k is time step) in scenario 1 is shown below. The partition result at k = 40 is given firstly in Figure 4.
From Figure 4 we can see that the measurements of four targets are correctly clustered, and two clutter (marked with arrows in Figure 4) are incorrectly partitioned into one cell.
e γ ( j ) γ ( j ) β F A , k | W | p D ( j ) Λ k ( j , W ) w k | k 1 ( j ) is denoted as ψ j , W for jth GIW component in the Wth cell, then
w k | k ( j , W ) = ψ j , W δ | W | , 1 + l = 1 J k | k 1 ψ l , W .
From simulation results, the number of components of predicted PHD is 14 at k = 40 , then J k | k 1 = 14 , ψ j , W of the clutter cell (marked with arrows in Figure 4) is obtained and shown in Table 4.
The likelihood Λ k ( j , W ) of each GIW component in this cell is very small since clutter does not obey the kinematic and extent model of target, therefore ψ j , W achieve small value as shown in Table 4.
Because the number of measurement in this cell is two, Equation (37) is represent as
w k | k ( j , W ) = ψ j , W l = 1 J k | k 1 ψ l , W .
Equation (38) is a normalization process, w k | k ( j , W ) of the clutter cell is shown in Table 5.
Although ψ j , W is small, w k | k ( j , W ) may achieve a large value ( w k | k ( 10 , W ) = 0.99 ) and results in a ghost target. At k = 40 , the estimated number of targets was 5 while true number is 4. That is, the number of targets was overestimated.
To test the influence of the clutter density on tracking performance, ET-GIW-PHD and anti-clutter ET-GIW-PHD were tested under different numbers of clutter modeled as Poisson distribution with Poisson rate λ c . The clutter measurements are assumed to be uniformly distributed over the surveillance area. The OSPA distance of these two filters under different Poisson rate λ c is shown in Figure 5 and Figure 6.
As we can see from Figure 5 and Figure 6, when λ c is small, ET-GIW-PHD achieves good performance. However, as λ c increases, the performance of ET-GIW-PHD degrades significantly. In contrast, our anti-clutter ET-GIW-PHD achieves superior performance with varying λ c , which demonstrates that anti-clutter ET-GIW-PHD is more robust to clutter than ET-GIW-PHD. The results of cardinality estimation are shown in Figure 7 and Figure 8.
From Figure 7 and Figure 8 we can see that the cardinality estimation error of ET-GIW-PHD increases as the λ c grows. That is, ET-GIW-PHD cannot avoid the overestimation of cardinality under high clutter density. When clutter density is small, the clutter spreads apart. Thus, it is unlikely to partition more than one clutter into one cell. In the presence of severe clutter, the probability that multiple clutter being partitioned into one cell increases, and thus ET-GIW-PHD could overestimate the cardinality. However, our anti-clutter ET-GIW-PHD uses not only the number of measurement, but also target state and spatial distribution of clutter for better cardinality estimation performance. Using hypothesis testing, the measurements can be distinguished more correctly. Therefore, a better tracking performance can be achieved. Extensive experiments have demonstrated the effectiveness of anti-clutter ET-GIW-PHD.

6. Conclusions

In this paper, we propose an anti-clutter ET-GIW-PHD filter which revises the correction step of ET-GIW-PHD with hypothesis testing for better tracking performance under severe clutter. Our anti-clutter ET-GIW-PHD adopts a hypothesis testing method to distinguish between measurements from targets and clutter, hypothesis testing results are incorporated into the correction step. Specifically, likelihood functions are built to incorporate the number of measurements, the target state, and clutter spatial distribution in anti-clutter ET-GIW-PHD, the source of measurements in the cell is determined more correctly. Compared with ET-GIW-PHD, our method improves the cardinality estimation accuracy and achieves better tracking performance. The effectiveness of our method has been demonstrated by extensive experiments.

Author Contributions

Y.H. conceived the idea of the study and conducted the research. Y.H. and L.W. analyzed most of the data and wrote the initial draft of the paper. X.W. and W.A. contributed to finalizing this paper.

Funding

This work was supported by the National Natural Science Foundation of China (Nos.61605242).

Conflicts of Interest

The authors declare no conflict of interest. The funders had no role in the design of the study; in the collection, analyses, or interpretation of data; in the writing of the manuscript, or in the decision to publish the results.

References

  1. Granström, K.; Reuter, S.; Meissner, D.; Scheel, A. A multiple model PHD approach to tracking of cars under an assumed rectangular shape. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Salamanca, Spain, 7–10 July 2014; pp. 1–8. [Google Scholar]
  2. Cao, X.; Lan, J.; Li, X.R.; Liu, Y. Extended Object Tracking Using Automotive Radar. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Cambridge, UK, 10–13 July 2018; pp. 1–5. [Google Scholar]
  3. Haag, S.; Duraisamy, B.; Koch, W.; Dickmann, J. Radar and Lidar Target Signatures of Various Object Types and Evaluation of Extended Object Tracking Methods for Autonomous Driving Applications. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Cambridge, UK, 10–13 July 2018; pp. 1746–1755. [Google Scholar]
  4. Hammarstrand, L.; Lundgren, M.; Svensson, L. Adaptive Radar Sensor Model for Tracking Structured Extended Objects. IEEE Trans. Aerosp. Electron. Syst. 2012, 48, 1975–1995. [Google Scholar] [CrossRef]
  5. Wieneke, M.; Davey, S.J. Histogram PMHT with target extent estimates based on random matrices. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Chicago, IL, USA, 5–8 July 2011; pp. 322–329. [Google Scholar]
  6. Wieneke, M.; Koch, W. A PMHT Approach for Extended Objects and Object Groups. IEEE Trans. Aerosp. Electron. Syst. 2012, 48, 2349–2370. [Google Scholar] [CrossRef]
  7. Gilholm, K.; Godsill, S.; Maskell, S.; Salmond, D. Poisson models for extended target and group tracking. In Proceedings of the SPIE Signal and Data Processing of Small Targets, San Diego, CA, USA, 31 July–4 August 2005; pp. 230–241. [Google Scholar]
  8. Bar-Shalom, Y.; Willett, P.K.; Tian, X. Tracking and Data Fusion; YBS Publishing: Storrs, CT, USA, 2011. [Google Scholar]
  9. Granstrom, K.; Lundquist, C.; Gustafsson, F.; Orguner, U. Random set methods: Estimation of multiple extended objects. IEEE Robot. Autom. Mag. 2014, 21, 73–82. [Google Scholar] [CrossRef]
  10. Koch, W. Tracking and Sensor Data Fusion; Springer: Berlin/Heidelberg, Germany, 2016. [Google Scholar]
  11. Mahler, R.P. Advances in Statistical Multisource-Multitarget Information Fusion; Artech House: Norwood, MA, USA, 2014. [Google Scholar]
  12. Vo, B.N.; Ma, W.K. The Gaussian mixture probability hypothesis density filter. IEEE Trans. Signal Process. 2006, 54, 4091–4104. [Google Scholar] [CrossRef]
  13. Mahler, R. PHD filters of higher order in target number. IEEE Trans. Aerosp. Electron. Syst. 2007, 43, 1523–1543. [Google Scholar] [CrossRef]
  14. Gilholm, K.; Salmond, D. Spatial distribution model for tracking extended objects. IEE Proc. Radar Sonar Navig. 2005, 152, 364–371. [Google Scholar] [CrossRef]
  15. Mahler, R. PHD filters for nonstandard targets, I: Extended targets. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Seattle, WA, USA, 6–9 July 2009; pp. 915–921. [Google Scholar]
  16. Jiang, D.; Liu, M.; Gao, Y.; Gao, Y. Time-matching extended target probability hypothesis density filter for multi-target tracking of high resolution radar. Signal Process. 2019, 157, 151–160. [Google Scholar] [CrossRef]
  17. Granstrom, K.; Lundquist, C.; Orguner, O. Extended target tracking using a Gaussian-mixture PHD filter. IEEE Trans. Aerosp. Electron. Syst. 2012, 48, 3268–3286. [Google Scholar] [CrossRef]
  18. Hu, Q.; Ji, H.; Zhang, Y. A standard PHD filter for joint tracking and classification of maneuvering extended targets using random matrix. Signal Process. 2018, 144, 352–363. [Google Scholar] [CrossRef]
  19. Lan, J.; Li, X.R. Joint tracking and classification of extended object using random matrix. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Istanbul, Turkey, 9–12 July 2013; pp. 1550–1557. [Google Scholar]
  20. Sun, L.; Lan, J.; Li, X.R. Joint tracking and classification of extended object based on support functions. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Salamanca, Spain, 7–10 July 2014; pp. 1–8. [Google Scholar]
  21. Zhang, Y.; Ji, H. A robust and fast partitioning algorithm for extended target tracking using a gaussian inverse wishart phd filter. Knowl.-Based Syst. 2016, 95, 125–141. [Google Scholar] [CrossRef]
  22. Li, P.; Ge, H.w.; Yang, J.l.; Zhang, H. Shape selection partitioning algorithm for Gaussian inverse Wishart probability hypothesis density filter for extended target tracking. IET Signal Process. 2016, 10, 1041–1051. [Google Scholar] [CrossRef]
  23. Li, P.; Ge, H.; Yang, J. Adaptive Measurement Partitioning Algorithm for a Gaussian Inverse Wishart PHD Filter that Tracks Closely Spaced Extended Targets. Radioengineering 2017, 26, 573–580. [Google Scholar] [CrossRef]
  24. Zhao, Z.; Xiang, W.; Tao, W. A Novel Measurement Data Classification Algorithm Based on SVM for Tracking Closely Spaced Targets. IEEE Trans. Instrum. Meas. 2018, 68, 1089–1100. [Google Scholar] [CrossRef]
  25. Baum, M.; Faion, F.; Hanebeck, U.D. Modeling the target extent with multiplicative noise. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Singapore, 9–12 July 2012; pp. 2406–2412. [Google Scholar]
  26. Granström, K.; Lundquist, C. On the use of multiple measurement models for extended target tracking. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Istanbul, Turkey, 9–12 July 2013; pp. 1534–1541. [Google Scholar]
  27. Koch, J.W. Bayesian approach to extended object and cluster tracking using random matrices. IEEE Trans. Aerosp. Electron. Syst. 2008, 44, 1042–1059. [Google Scholar] [CrossRef]
  28. Feldmann, M.; Franken, D.; Koch, W. Tracking of extended objects and group targets using random matrices. IEEE Trans. Signal Process. 2011, 59, 1409–1420. [Google Scholar] [CrossRef]
  29. Lan, J.; Li, X.R. Tracking of extended object or target group using random matrix—Part I: New model and approach. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Singapore, 9–12 July 2012; pp. 2177–2184. [Google Scholar]
  30. Baum, M.; Noack, B.; Hanebeck, U.D. Extended object and group tracking with elliptic random hypersurface models. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Edinburgh, UK, 26–29 July 2010; pp. 1–8. [Google Scholar]
  31. Baum, M.; Hanebeck, U.D. Shape tracking of extended objects and group targets with star-convex RHMs. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Chicago, IL, USA, 5–8 July 2011; pp. 1–8. [Google Scholar]
  32. Baum, M.; Noack, B.; Hanebeck, U.D. Mixture random hypersurface models for tracking multiple extended objects. In Proceedings of the IEEE Decision and Control and European Control Conference (CDC-ECC), Orlando, FL, USA, 12–15 December 2011; pp. 3166–3171. [Google Scholar]
  33. Wahlström, N.; Özkan, E. Extended target tracking using Gaussian processes. IEEE Trans. Signal Process. 2015, 63, 4165–4178. [Google Scholar] [CrossRef]
  34. Thormann, K.; Baum, M.; Honer, J. Extended Target Tracking Using Gaussian Processes with High-Resolution Automotive Radar. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Cambridge, UK, 10–13 July 2018; pp. 1764–1770. [Google Scholar]
  35. Guo, Y.; Li, Y.; Tharmarasa, R.; Kirubarajan, T.; Efe, M.; Sarikaya, B. GP-PDA Filter for Extended Target Tracking with Measurement Origin Uncertainty. IEEE Trans. Aerosp. Electron. Syst. 2018, 55, 1725–1742. [Google Scholar] [CrossRef]
  36. Aftab, W.; Hostettler, R.; Freitas, A.D.; Arvaneh, M.; Mihaylova, L. Spatio-Temporal Gaussian Process Models for Extended and Group Object Tracking With Irregular Shapes. IEEE Trans. Veh. Technol. 2019, 68, 2137–2151. [Google Scholar] [CrossRef]
  37. Kaulbersch, H.; Honer, J.; Baum, M. A Cartesian B-Spline Vehicle Model for Extended Object Tracking. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Cambridge, UK, 10–13 July 2018; pp. 1–5. [Google Scholar]
  38. Granström, K.; Lundquist, C.; Orguner, U. Tracking rectangular and elliptical extended targets using laser measurements. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Chicago, IL, USA, 5–8 July 2011; pp. 592–599. [Google Scholar]
  39. Granstrom, K.; Orguner, U. A PHD filter for tracking multiple extended targets using random matrices. IEEE Trans. Signal Process. 2012, 60, 5657–5671. [Google Scholar] [CrossRef]
  40. Granström, K.; Orguner, U. Estimation and maintenance of measurement rates for multiple extended target tracking. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Singapore, 9–12 July 2012; pp. 2170–2176. [Google Scholar]
  41. Granström, K.; Willett, P.; Bar-Shalom, Y. An extended target tracking model with multiple random matrices and unified kinematics. In Proceedings of the IEEE International Conference on Information Fusion (FUSION), Washington, DC, USA, 6–9 July 2015; pp. 1007–1014. [Google Scholar]
  42. Lan, J.; Li, X.R. Tracking of Maneuvering Non-Ellipsoidal Extended Object or Target Group Using Random Matrix. IEEE Trans. Signal Process. 2014, 62, 2450–2463. [Google Scholar] [CrossRef]
  43. Schuhmacher, D.; Vo, B.T.; Vo, B.N. A consistent metric for performance evaluation of multi-object filters. IEEE Trans. Signal Process. 2008, 56, 3447–3457. [Google Scholar] [CrossRef] [Green Version]
Figure 1. True trajectories of two scenarios: (a) four targets move along different lines in scenario 1. (b) Two targets move closeer gradually and then move in parallel before separating in scenario 2.
Figure 1. True trajectories of two scenarios: (a) four targets move along different lines in scenario 1. (b) Two targets move closeer gradually and then move in parallel before separating in scenario 2.
Sensors 19 05140 g001
Figure 2. The obtained trajectories of ET-GIW-PHD and anti-clutter ET-GIW-PHD in scenario 1: (a) ET-GIW-PHD. (b) Anti-clutter ET-GIW-PHD.
Figure 2. The obtained trajectories of ET-GIW-PHD and anti-clutter ET-GIW-PHD in scenario 1: (a) ET-GIW-PHD. (b) Anti-clutter ET-GIW-PHD.
Sensors 19 05140 g002
Figure 3. The obtained trajectories of ET-GIW-PHD and anti-clutter ET-GIW-PHD in scenario 2: (a) ET-GIW-PHD. (b) Anti-clutter ET-GIW-PHD.
Figure 3. The obtained trajectories of ET-GIW-PHD and anti-clutter ET-GIW-PHD in scenario 2: (a) ET-GIW-PHD. (b) Anti-clutter ET-GIW-PHD.
Sensors 19 05140 g003
Figure 4. The partition result at k = 40 in scenario 1.
Figure 4. The partition result at k = 40 in scenario 1.
Sensors 19 05140 g004
Figure 5. The optimal subpattern assignment metric (OSPA) distance of ET-GIW-PHD and anti-clutter ET-GIW-PHD under different Poisson rate of clutter in scenario 1: (a) Poisson rate λ c = 5 . (b) Poisson rate λ c = 20 . (c) Poisson rate λ c = 35 . (d) Poisson rate λ c = 50 .
Figure 5. The optimal subpattern assignment metric (OSPA) distance of ET-GIW-PHD and anti-clutter ET-GIW-PHD under different Poisson rate of clutter in scenario 1: (a) Poisson rate λ c = 5 . (b) Poisson rate λ c = 20 . (c) Poisson rate λ c = 35 . (d) Poisson rate λ c = 50 .
Sensors 19 05140 g005
Figure 6. The OSPA distance of ET-GIW-PHD and anti-clutter ET-GIW-PHD under different Poisson rate of clutter in scenario 2: (a) Poisson rate λ c = 5 . (b) Poisson rate λ c = 20 . (c) Poisson rate λ c = 35 . (d) Poisson rate λ c = 50 .
Figure 6. The OSPA distance of ET-GIW-PHD and anti-clutter ET-GIW-PHD under different Poisson rate of clutter in scenario 2: (a) Poisson rate λ c = 5 . (b) Poisson rate λ c = 20 . (c) Poisson rate λ c = 35 . (d) Poisson rate λ c = 50 .
Sensors 19 05140 g006
Figure 7. The cardinality estimation of ET-GIW-PHD and anti-clutter ET-GIW-PHD under different Poisson rate of clutter in scenario 1: (a) Poisson rate λ c = 5 . (b) Poisson rate λ c = 20 . (c) Poisson rate λ c = 35 . (d) Poisson rate λ c = 50 .
Figure 7. The cardinality estimation of ET-GIW-PHD and anti-clutter ET-GIW-PHD under different Poisson rate of clutter in scenario 1: (a) Poisson rate λ c = 5 . (b) Poisson rate λ c = 20 . (c) Poisson rate λ c = 35 . (d) Poisson rate λ c = 50 .
Sensors 19 05140 g007
Figure 8. The cardinality estimation of ET-GIW-PHD and anti-clutter ET-GIW-PHD under different Poisson rate of clutter in scenario 2: (a) Poisson rate λ c = 5 . (b) Poisson rate λ c = 20 . (c) Poisson rate λ c = 35 . (d) Poisson rate λ c = 50 .
Figure 8. The cardinality estimation of ET-GIW-PHD and anti-clutter ET-GIW-PHD under different Poisson rate of clutter in scenario 2: (a) Poisson rate λ c = 5 . (b) Poisson rate λ c = 20 . (c) Poisson rate λ c = 35 . (d) Poisson rate λ c = 50 .
Sensors 19 05140 g008
Table 1. The probability of the measurement generated by clutter.
Table 1. The probability of the measurement generated by clutter.
λ c = 5 λ c = 5 λ c = 25 λ c = 35
γ = 5 γ = 10 γ = 10 γ = 10
p d = 0.6 110.9440.055
p d = 0.7 110.9650.034
p d = 0.8 110.9790.021
p d = 0.9 110.9870.013
Table 2. Pseudo-code for anti-clutter extended target Gaussian inverse Wishart probability hypothesis density (ET-GIW-PHD) filter.
Table 2. Pseudo-code for anti-clutter extended target Gaussian inverse Wishart probability hypothesis density (ET-GIW-PHD) filter.
1: Input: Sequence of measurement sets
2: Initialize: parameter initialization
3: for k = 1 : K (K is totally time steps)
4:   Measurements partition
5:   Prediction
6:   Correction, see Table 3.
7:   Prune and merge
8:   Extract target state
9: end for
10: Output: Sequence of estimated targets.
Table 3. Pseudo-code for anti-clutter ET-GIW-PHD filter correction.
Table 3. Pseudo-code for anti-clutter ET-GIW-PHD filter correction.
1: Input: GIW components { w k | k 1 j , ξ k | k 1 j } j = 1 J k | k 1 , measurements partitions { p ρ } ρ = 1 n
2: Undetected target case:
3: for j = 1 : J k | k 1
4: w k | k j 1 ( 1 e γ ) p D w k | k 1 j ξ k | k j ξ k | k 1 j
5: end for
6: Detected target case:
7: l = 0
8: for ρ = 1 : n
9:   for W = 1 : | p ρ |
10:    l = l + 1
11:    for j = 1 : J k | k 1
12:     update ξ k | k 1 j using Kalman filter, see details in [39], ξ k | k j + l · J k | k 1 u p d a t e ξ k | k 1 j
13:    w k | k ( j + l · J k | k 1 , W ) e γ ( j ) γ ( j ) λ c c k | W | p D ( j ) Λ k ( j , W ) w k | k 1 ( j )
14:    G j = j = 1 n w ( z j ( H k I d ) x k | k 1 j ) ( X k | k 1 j ) 1 ( z j ( H k I d ) x k | k 1 j ) T
15:    end for
16:    D = 0.5 n W log 2 π 0.5 n W log | X k | k 1 | p d ( γ λ c ) + n W log ( γ λ c ) n W log β F A .
17:    log ( η ) = 0.5 arg min j G j + D
18:    g = D 0.5 X 1 α 2 ,
19:    d W ( ρ , W ) = 1 + l = 1 J k | k 1 e γ ( l ) γ ( l ) β F A , k | W | p D ( l ) Λ k ( l , W ) w k | k 1 ( l ) log η < g l = 1 J k | k 1 e γ ( l ) γ ( l ) β F A , k | W | p D ( l ) Λ k ( l , W ) w k | k 1 ( l ) log η g
20:    w k | k ( j + l · J k | k 1 , W ) w k | k ( j + l · J k | k 1 , W ) d W
21:    end for
22: ω p ρ Π W = 1 | p ρ | d W ( ρ , W )
23: end for
24: ω p ρ ω p ρ ρ = 1 n ω p ρ for ρ = 1 : n
25: J k | k J k | k 1 ( l + 1 ) J t m p   =   J k | k 1
26: for ρ = 1 : n
27:    for j = 1 : J k | k 1 | p ρ |
28:    w k | k ( j + J t m p ) w k | k ( j + J t m p ) ω p ρ
29:   end for
30: J t m p J t m p + J k | k 1 | p ρ |
31: end for
32: Output: GIW components { w k | k j , ξ k | k j } j = 1 J k | k
Table 4. The ψ j , W of the clutter cell.
Table 4. The ψ j , W of the clutter cell.
j1234567
ψ j , W 4.7 × 10 21 2.5 × 10 24 1.4 × 10 19 2.7 × 10 15 2.9 × 10 10 3.7 × 10 19 3.5 × 10 70
j891011121314
ψ j , W 3.8 × 10 50 4.4 × 10 57 6.7 × 10 8 2.6 × 10 30 2.9 × 10 17 4.7 × 10 14 1.1 × 10 55
Table 5. w k | k ( j , W ) of the clutter cell.
Table 5. w k | k ( j , W ) of the clutter cell.
j1234567
w k | k ( j , W ) 6.9 × 10 14 3.7 × 10 17 2.1 × 10 12 4.1 × 10 8 4.3 × 10 3 5.5 × 10 12 5.1 × 10 63
j891011121314
w k | k ( j , W ) 5.6 × 10 43 6.5 × 10 50 0.99 3.9 × 10 23 4.3 × 10 10 6.9 × 10 7 1.7 × 10 48

Share and Cite

MDPI and ACS Style

Huang, Y.; Wang, L.; Wang, X.; An, W. Anti-Clutter Gaussian Inverse Wishart PHD Filter for Extended Target Tracking. Sensors 2019, 19, 5140. https://doi.org/10.3390/s19235140

AMA Style

Huang Y, Wang L, Wang X, An W. Anti-Clutter Gaussian Inverse Wishart PHD Filter for Extended Target Tracking. Sensors. 2019; 19(23):5140. https://doi.org/10.3390/s19235140

Chicago/Turabian Style

Huang, Yuan, Liping Wang, Xueying Wang, and Wei An. 2019. "Anti-Clutter Gaussian Inverse Wishart PHD Filter for Extended Target Tracking" Sensors 19, no. 23: 5140. https://doi.org/10.3390/s19235140

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop