[go: up one dir, main page]

Next Article in Journal
eHAPAC: A Privacy-Supported Access Control Model for IP-Enabled Wireless Sensor Networks
Next Article in Special Issue
A Weak Selection Stochastic Gradient Matching Pursuit Algorithm
Previous Article in Journal
A New Water Level Measurement Method Combining Infrared Sensors and Floats for Applications on Laboratory Scale Channel under Unsteady Flow Regime
Previous Article in Special Issue
Detail Preserved Surface Reconstruction from Point Cloud
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Variational Bayesian Based Adaptive Shifted Rayleigh Filter for Bearings-Only Tracking in Clutters

School of Electronic and Information, Northwestern Polytechnical University, Xi’an 710072, China
*
Author to whom correspondence should be addressed.
Sensors 2019, 19(7), 1512; https://doi.org/10.3390/s19071512
Submission received: 11 February 2019 / Revised: 23 March 2019 / Accepted: 26 March 2019 / Published: 28 March 2019
(This article belongs to the Special Issue Sensor Signal and Information Processing II)

Abstract

:
This paper considers bearings-only target tracking in clutters with uncertain clutter probability. The traditional shifted Rayleigh filter (SRF), which assumes known clutter probability, may have degraded performance in challenging scenarios. To improve the tracking performance, a variational Bayesian-based adaptive shifted Rayleigh filter (VB-SRF) is proposed in this paper. The target state and the clutter probability are jointly estimated to account for the uncertainty in clutter probability. Performance of the proposed filter is evaluated by comparing with SRF and the probability data association (PDA)-based filters in two scenarios. Simulation results show that the proposed VB-SRF algorithm outperforms the traditional SRF and PDA-based filters especially in complex adverse scenarios in terms of track continuity, track accuracy and robustness with a little higher computation complexity.

1. Introduction

Bearings-only target tracking is to estimate the current position and velocity of a target using only the noise-corrupted bearing measurements from one or multiple observer platforms. It is an important tracking problem that arises in both military and civilian applications, such as underwater sonar tracking, bistatic radar, air traffic control and computer vision [1].
Because of the intrinsic nonlinearities in the measurement models, it is difficult to acquire an optimal solution of this problem. Several suboptimal algorithms have been developed for bearings-only tracking in the literature. The extended Kalman filter (EKF) [2] in the Cartesian coordinate system is an early attempt. However, it is easy to diverge. To improve the stability of the EKF, the bearings-only tracking problem was formulated in modified polar coordinates, resulting in the modified polar coordinate EKF (MPEKF) [3]. However, it requires good initialization to guarantee convergence. The well-known pseudo-linear estimator (PLE) [4] was also developed to solve the bearings-only tracking problem. However, it gives a biased estimate at long ranges. In recent years, some bias compensation techniques were developed to improve the performance of PLE [5,6,7]. In addition, more sophisticated nonlinear Kalman filtering algorithms, such as unscented Kalman filter (UKF) [8,9], cubature Kalman filter (CKF) [1] and particle filter (PF) [10,11] were applied for bearings-only target tracking. PF can provide good performance but at the price of heavy computation load. Noteworthily, Clark et al. [12,13] proposed a novel shifted Rayleigh filter (SRF) for bearings-only tracking, which is still based on the approximation of conditional expectations but with novel feature which is performing a calculation to exploit the essential structure of the nonlinearities in a new way. It is shown to exhibit similar performance to the PF in certain challenging scenarios with much lower computational complexity [14].
However, these algorithms do not consider the impact of clutter which makes the bearings-only tracking problem more intractable. Apparently, the classical treatment of clutter in target tracking problem can be extended to the bearings-only tracking problem. For example, Reference [15] integrated the maximum entropy fuzzy probabilistic data association (MEFPDA) with the square-root cubature Kalman filter (SCKF) to deal with the clutter in bearings-only tracking. Clark et al. also included the effect of clutter measurements into the SRF algorithm in [12]. However, in the classical algorithms, the clutter probability is usually assumed known and constant, which maybe time-varying or hard to determine in advance especially in adverse scenarios. Use of incorrect value of the clutter probability may lead to track accuracy degradation even track loss. A straight-forward idea is to account for the unknown clutter probability in the process of estimation of the state. That is, we need to solve the problem of bearings-only target tracking with uncertain parameter of clutter probability.
As we know, the Bayesian approach is the most general approach of solving the problem with uncertain parameters. However, it is not trivial to get the analytical solution for most Bayesian approaches due to complex nonlinear probability density function or high dimension of integration. Recently, the variational Bayesian (VB)-based adaptive filters [16,17,18] have drawn extensive attention, which utilize a new simpler, analytically tractable distribution to approximate the true posterior distribution so that avoiding direct calculations of complex integrals. Its adaptive strategy has a strong ability of tracking time-varying parameters. Therefore, we adopt the VB method to jointly estimate the target state and the clutter probability within the framework of SRF in this paper for bearings-only tracking in clutters. By establishing a conjugate exponential model for clutter probability and data association indicator, the proposed filter is derived using the iterative filtering framework. The tracking performance of the proposed VB-SRF is evaluated by comparing with SRF, PDA-SCKF [15] and MEFPDA-SCKF [15] via two simulation examples. It shows that the proposed filter outperforms the traditional SRF and two PDA-SCKF-based filters in complex mismatched scenarios in terms of track continuity and track accuracy but at the cost of higher computation complexity.
The remainder of the paper is organized as follows. Section 2 gives the problem formulation. In Section 3, the variational Bayesian filtering is described. Section 4 derives the VB-based adaptive SRF. Section 5 provides simulation results and performance evaluation of the proposed approach, followed by the conclusions in Section 6.

2. The Shifted Rayleigh Filter Algorithm

2.1. The Bearing Model

Considering the shifted Rayleigh filter (SRF) for bearings-only tracking in R 2 , the state equation and the measurement equation are described as [13]:
x k = F k 1 x k 1 + u k 1 s + v k 1
y k = H k x k + u k m + w k b k = Π ( y k )
where, x k is the state vector which describes the position and velocity of the target; b k is the noisy bearing measurement. Π denotes the projection of the plane onto the unit circle. That is taking a 2-vector y k into its normalized form y k / | | y k | | . Then b k = ( s i n θ k , c o s θ k ) T , where θ k is the bearing of the target position relative to the sensor platform. F k 1 and H k are the state transition matrix and measurement matrix, respectively. u k 1 s and u k m are the inputs to the system to increase the versatility of the model, for example, to reflect known perturbations to the dynamics and changes in sensor location; v k 1 is the Gaussian process noise with zero mean and covariance Q v , and w k is the Gaussian measurement noise with zero mean and covariance Q w and independent of v k .
The unusual point in the measurement model is that the noise w k is modelled as additive noise present in an “augmented” measurement, y k , of the Cartesian coordinates of target relative to the sensor platform, which is projected onto the plane to generate the actual bearing measurement b k . It is different with the traditional “angle plus white noise” model, expressed as
θ k = a r c t a n ( d 1 / d 2 ) + ϵ k
where, d 1 , d 2 are the components of the displacement vector d k = H k x k + u k m . ϵ k is the sensor noise with Gaussian distribution N ( 0 , σ 2 ) and independent of the displacement vector d k .
Actually, as explained in [13], the shifted Rayleigh bearing model (2) can be related with the traditional model (3) by making a variant on the shifted Rayleigh noise model
y k = d k + | | d k | | e b k = Π ( y k )
where, e is an N ( 0 , σ 2 I 2 × 2 ) distributed random variable. The only difference with model (2) is the noise term w k used to construct the augmented measurement y k is replaced by | | d k | | e . | | d k | | e differs from w k , but has identical first and second moments, and is uncorrelated with d k .
The angular θ k of the modified vector bearing b k can be represented as
θ k = a r c t a n ( d 1 / d 2 ) + ϵ k
where ϵ k is a zero mean random variable, restricted to [ π , π ] , independent of d k , with density α σ ( · ) :
α σ ( θ ) = e 1 / 2 σ 2 2 π 1 + 2 π c o s θ σ F n o r m a l c o s θ σ e 1 / 2 ( c o s θ / σ ) 2
where, F n o r m a l ( · ) is the cumulative distribution function of a standard N ( 0 , 1 ) variable.
Note that θ given by (5), is very close to the bearing θ in the standard model (3). The only difference is that the densities of the noise terms used in their construction are α σ ( θ ) and the normal N ( 0 , σ 2 ) density, respectively. Reference [13] plots the two densities for σ 2 1 . It shows the two density functions are virtually indistinguishable.
Given the bearing model, the SRF is to calculate the estimates of the conditional mean and covariance of the target state x k , given measurements up to time k, b 1 : k . That is,
x ^ k | k = E [ x k | b 1 : k ] , P k | k = c o v [ x k | b 1 : k ]
The formulas for the SRF algorithm can be seen in [13].

2.2. The Treatment of Clutter

Accounting for the effects of clutter on the bearing measurements, we represent a cluttered bearing measurement as
z k = ( 1 r k ) θ k + r k U k
where U k is the bearing measurement of the clutter, which is assumed to be an uniform random variable on [ π , π ] ; θ k is the bearing measurement of the actual target from the sensor, r k is defined as data association indicator at time k.
r k = 1 if the measurement is from clutter 0 if the measurement is from target
The prior of r k is assumed independent of the previous data associations and can be described as
p ( r k ) = ξ if r k = 1 1 ξ if r k = 0
Then the likelihood of the measurement is
p ( z k | x k , r k ) = 1 / 2 π i f r k = 1 f ( θ k | x k ) i f r k = 0
It can be represented in two forms:
( 12 ) p ( z k | x k , r k ) = 1 2 π r k + f ( θ k | x k ) ( 1 r k ) ( 13 ) = ( 1 2 π ) r k f ( θ k | x k ) 1 r k
Note that the two forms are used for different purpose in the later section. f ( θ k | x k ) is the likelihood of the target bearing measurement, whose expression is given in Appendix A.
Here, we need to explain the reason for using this representation (8) of the cluttered measurement. The information carried in (8) is identical with the projection measurement z k b = [ s i n z k , c o s z k ] . So the mean and covariance of the target state x k conditioned on cluttered measurement z k b , which are the aims needs to be achieved in the SRF, are equivalent with these conditioned on z k . Furthermore, this representation (8) is more convenient for calculation. Thus, z k instead of z k b is adopted to represent the clutter measurement.
Based on the cluttered measurement model, given clutter probability ξ , the state estimate and covariance can be calculated as follows.
Suppose the density of x k 1 given measurements up to k 1 , p k 1 | k 1 ( x k 1 ) , is normal with mean x ¯ k 1 | k 1 and covariance P ¯ k 1 | k 1 . The posterior density of state x k conditioned on cluttered bearing measurements z 1 : k is given as
p ( x k | z 1 : k ) = p ( x k | z k , x k 1 p k 1 | k 1 ( x k 1 ) ) ( 14 ) = q k ( 0 ) p k | k ( x k ) + q k ( 1 ) p k | k 1 ( x k )
where q k ( i ) = p ( r k = i | z k , z 1 : k 1 ) , p k | k ( x k ) is the non-normal density of x k conditioned on r k = 0 and z k , or, equivalently, on θ k , and p k | k 1 ( x k ) is the density of x k when there is no target measurement at time k. It is normal with mean x ^ k | k 1 and covariance P k | k 1 . Thus, the state estimate and covariance at time k can be obtained as
x ¯ k | k = E [ x k | z k , x k 1 p k 1 | k 1 ( x k 1 ) ] ( 15 ) = q k ( 0 ) x ^ k | k + q k ( 1 ) x ^ k | k 1
P ¯ k | k = c o v [ x k | z k , x k 1 p k 1 | k 1 ( x k 1 ) ] = q k ( 0 ) ( P k | k + ( x ^ k | k x ¯ k | k ) ( x ^ k | k x ¯ k | k ) T ) ( 16 ) + q k ( 1 ) ( P k | k 1 + ( x ^ k | k 1 x ¯ k | k ) ( x ^ k | k 1 x ¯ k | k ) T )
where x ^ k | k and P k | k are the state estimate and its covariance based on the actual target measurement. x ^ k | k 1 and P k | k 1 are the predicted target state estimate and covariance. All of these can be obtained using the basic formulas of SRF.
The conditional densities q k ( 0 ) and q k ( 1 ) are given by the equations
( 17 ) q k ( 0 ) = c k ( 1 ξ ) f k ( θ k | z 1 : k 1 ) ( 18 ) q k ( 1 ) = c k ξ 2 π
where c k is the normalizing constant and f k ( θ k | z 1 : k 1 ) is the density of the actual target bearing θ k conditioned on measurements z 1 : k 1 . The expression is given in Appendix B.
However, in a complex environment, the probability of clutter is time-varying or hard to determine in advance. In this case, the probability ξ is unknown, so the above formulas are not applicable. In this paper, we resort the VB method to find the joint posterior density of x k and ξ so as to account for the uncertainty in clutter probability.

3. Variational Bayesian Filtering

In this section, we first review the conjugate exponential (CE) model, and then gives the variational Bayesian solution of the CE model.

3.1. Conjugate Exponential Model

Given measurements z 1 : k 1 , the posterior of the system state p ( x k 1 | z 1 : k 1 ) and the posterior of the parameter p ( r k 1 | z 1 : k 1 ) , we assume the complete-data likelihood in the exponential family:
p ( x k , z k | r k , z 1 : k 1 ) = g ( r k ) f ( x k , z k ) e ϕ ( r k ) T u ( x k , z k )
where, ϕ ( r k ) is the vector of natural parameters r k , u and f are known functions, and g is a normalization constant:
g ( r k ) 1 = f ( x k , z k ) e ϕ ( r k ) T u ( x k , z k ) d x k d z k
The parameter prior is conjugate to the complete-data likelihood:
p ( r k | α k , β k ) = h ( α k , β k ) g ( r k ) β k e ϕ ( r k ) T α k
where α k and β k are hyperparameters of the prior, and h is a normalization constant. Note the prior p ( r k | α k , β k ) is said to be conjugate to the likelihood p ( x k , z k | r k ) if and only if the posterior
p ( r k | α k , β k ) p ( r k | α k , β k ) p ( x k , z k | r k )
is of the same parametric form as the prior. Then we call models that satisfy Equations (19) and (20) conjugate-exponential.

3.2. VB Approximation Method

Applying Bayes’ rule, we have the joint posterior of x k and r k as
p ( x k , r k | z 1 : k ) p ( x k , z k | r k , z 1 : k ) p ( r k | α k , β k )
The analytic solution to (21) would be difficult to calculate. Here, we use the VB method to approximate the true posterior distribution with a product of tractable marginal posteriors [17].
p ( x k , r k | z 1 : k ) Q ( x k , r k ) = Q x ( x k ) Q r ( r k )
where Q x ( x k ) and Q r ( r k ) are unknown approximating marginal densities of x k and r k .
The basic idea of VB approximation is to minimize the Kullback- Leibler (KL) divergence between the approximating posterior and the true posterior:
K L Q x ( x k ) Q r ( r k ) | | p ( x k , r k | z 1 : k ) = Q x ( x k ) Q r ( r k ) × log Q x ( x k ) Q r ( r k ) p ( x k , r k | z 1 : k ) d x k d r k
Given the measurements z 1 : k , we can minimize the KL divergence with respect to the probability densities Q x ( x k ) and Q r ( r k ) in turn, while keeping the other fixed. Then, the following equations can be given as:
Q x ( x k ) e x p ( ln p ( x k , r k , z k | z 1 : k 1 ) r k )
Q r ( r k ) e x p ( ln p ( x k , r k , z k | z 1 : k 1 ) x k )
where · x k and · r k denote the expectations with respect to Q x ( x k ) and Q r ( r k ) , respectively. Obviously, it is not an explicit solution since the distribution of each parameter is dependent on the other and neither distributions is known. The mechanism of VB method is to firstly give the initial values of the parameters and then use expectation-maximum (EM) algorithm to iteratively calculate Q x ( x k ) and Q r ( r k ) until convergence. For the above CE models, Q x ( x k ) and Q r ( r k ) can be obtained from the following procedure [19]:
(1)
The VB expectation step yields:
Q x ( x k ) f ( x k , z k ) e ϕ ( r k ) r k T u ( x k , z k ) = p ( x k | z k , ϕ ( r k ) r k )
(2)
The VB maximization step yields that Q r ( r k ) is conjugate and of the form
Q r ( r k ) = h ( α k , β k g ( r k ) β k e ϕ ( r k ) T α k
where, α k and β k are the hyper-parameters, and
( 28 ) α k = α k + u ( x k , z k ) x k ( 29 ) β k = β k + n
where n is the dimension of the measurement.

4. VB Based Adaptive Shifted Rayleigh Filter with Unknown Clutter Probability

Considering the system model (1) and the measurement model (8) described in Section 2, we adopt the VB method within the SRF framework to get the joint estimation of the target state and the clutter probability.
The core is to determine the posterior approximation Q ( x k , r k , ξ ) . Assume factorization Q ( x k , r k , ξ ) Q x ( x k ) Q ( r k , ξ ) , we can obtain Q x ( x k ) , Q r ( r k ) and Q ξ ( ξ k ) at each time k through the following procedure.
(1)
Optimization of Q x ( x k ) for fixed Q ( r k , ξ ) .
First, by using the first form of the measurement likelihood (12), the complete-data likelihood is presented as
p ( x k , z k | r k , z 1 : k 1 ) = p ( z k | x k , r k ) p ( x k | r k , z 1 : k 1 ) ( 30 ) = [ 1 2 π r k + f ( θ k | x k ) ( 1 r k ) ] N ( x k ; x ^ k | k 1 , P k | k 1 )
Then according to (24), we can get
Q x ( x k ) e x p { l n p ( z k , x k | r k , z 1 : k 1 ) r k , ξ } = [ 1 2 π r k r k + f ( θ k | x k ) ( 1 r k r k ) ] N ( x k ; x ^ k | k 1 , P k | k 1 ) ( 31 ) = 1 2 π N ( x k ; x ^ k | k 1 , P k | k 1 ) r k r k + f ( θ k | x k ) N ( x k ; x ^ k | k 1 , P k | k 1 ) ( 1 r k r k ) ( 32 ) 1 2 π N ( x k ; x ^ k | k 1 , P k | k 1 ) r k r k + N ( x k ; x ^ k | k , P k | k ) f ( θ k | z 1 : k 1 ) ( 1 r k r k )
The approximation sign in (32) is because the following:
f ( θ k | x k ) N ( x k ; x ^ k | k 1 , P k | k 1 ) = p ( θ k | x k , z 1 : k 1 ) p ( x k | z 1 : k 1 ) = p ( x k | θ k , z 1 : k 1 ) p ( θ k | z 1 : k 1 ) ( 33 ) N ( x k ; x ^ k | k , P k | k ) f ( θ k | z 1 : k 1 )
where f ( θ k | z 1 : k 1 ) is derived in Appendix B.
Comparing (32) with the posterior density (14) of SRF, the difference lies in the weights. Except for a normalization constant, the clutter probability ξ used before in (14) has been replaced by r k r k in (32), which is updated online.
(2)
Optimization of Q ( r k , ξ ) for fixed Q x ( x k ) .
We use the VB method again by factorizing Q ( r k , ξ ) Q r ( r k ) Q ξ ( ξ ) . Assume the conjugate prior of r k is binomial distributed with parameter ξ . That is,
p ( r k | ξ ) = ξ r k ( 1 ξ ) 1 r k
and p ( ξ ) follows beta distribution with parameters α 1 and α 2 .
p ( ξ ; α 1 , α 2 ) = 1 B ( α 1 , α 2 ) ξ α 1 1 ( 1 ξ ) α 2 1
where B ( α 1 , α 2 ) = Γ ( α 1 ) Γ ( α 2 ) / Γ ( α 1 + α 2 ) .
To have the form of (19), the complete-data likelihood p ( x k , z k | r k , z 1 : k 1 ) is re-derived using the second form (13) of p ( z k | x k , r k ) as
p ( x k , z k | r k , z 1 : k 1 ) = ( 1 / 2 π ) r k [ f ( θ k | x k ) ] 1 r k N ( x k ; x ^ k | k 1 , P k | k 1 ) ( 36 ) = f ( θ k | x k ) N ( x k ; x ^ k | k 1 , P k | k 1 ) e x p { r k [ l n ( 1 / 2 π ) l n [ f ( θ k | x k ) ] }
Rewriting the conjugate prior of r k in the form of (20), we can get
p ( r k | ξ ) = ξ r k ( 1 ξ ) 1 r k ( 37 ) = ( 1 ξ ) e x p [ r k l n ( ξ 1 ξ ) ]
Then applying (27), Q r ( r k ) can be obtained as
Q r ( r k ) = ( 1 η k ) e x p [ r k l n ( η k 1 η k ) ]
where, η k is the hyper-parameter and updated as
l n ( η k 1 η k ) = l n ( ξ 1 ξ ) ξ + [ l n ( 1 / 2 π ) l n [ f ( θ k | x k ) ] x k
Likewise, rewriting the conjugate prior of ξ in the form of (20) , we can get
p ( ξ ) = 1 B ( α 1 , α 2 ) ξ α 1 1 ( 1 ξ ) α 2 1 = 1 B ( α 1 , α 2 ) ( 1 ξ ) α 1 + α 2 2 ( 1 ξ ) ( α 1 1 ) ξ α 1 1 ( 40 ) = 1 B ( α 1 , α 2 ) ( 1 ξ ) α 1 + α 2 2 e x p [ ( α 1 1 ) l n ( ξ 1 ξ ) ]
Then applying (27), Q ξ ( ξ ) can be obtained as
Q ξ ( ξ ) = 1 B ( α 1 , α 2 ) ( 1 ξ ) α 1 + α 2 2 e x p [ ( α 1 1 ) l n ( ξ 1 ξ ) ]
with hyper-parameters
( 42 ) α 1 = α 1 + r k r k ( 43 ) α 2 = α 2 + n r k r k
where n is the dimension of the measurement.
According to the approximated posteriors of Q r ( r k ) and Q ξ ( ξ ) , r k r k and l n ( ξ 1 ξ ) ξ can be obtained as:
( 44 ) r k r k = η k ( 45 ) l n ( ξ 1 ξ ) ξ = ψ ( α 1 ) ψ ( α 2 )
where ψ ( · ) is the digamma function.
Taking expectation and covariance on the posterior Q x ( x k ) , the conditional mean and covariance of the target state can then be obtained. We summarize the entire filtering procedure of the VB-based SRF (VB-SRF) in Algorithm 1.
Algorithm 1 : VB-SRF.
(1) Initialization: x ¯ 0 | 0 , P ¯ 0 | 0 , Q v , Q w , η 0 , α 1 , 0 , α 2 , 0
(2) Prediction:
x ^ k | k 1 = F k 1 x ¯ k 1 | k 1 + u k 1 s
P k | k 1 = F k 1 P ¯ k 1 | k 1 F k 1 T + Q v
S k = H k P k | k 1 H k T + Q k m
η k | k 1 = ρ η k 1 , α 1 , k | k 1 = ρ α 1 , k 1 , α 2 , k | k 1 = ρ α 2 , k 1
where ρ is the scale factor and 0 < ρ 1 .
(3) Update: the update of VB-SRF utilizes iterate filtering framework.
(3.a) First set: x ¯ k | k ( 0 ) = x ^ k | k 1 , P ¯ k | k ( 0 ) = P k | k 1 , η k ( 0 ) = η k | k 1 , α 1 , k ( 0 ) = α 1 , k | k 1 , α 2 , k ( 0 ) = α 2 , k | k 1
(3.b) Calculate state estimation and its covariance using SRF when the measurement is from the target:
K k = P k | k 1 H k T S k 1
ε k = ( b k T S k 1 b k ) 1 / 2 b k T S k 1 ( H k X ^ k | k 1 + u k m )
γ k = ( b k T S k 1 b k ) 1 / 2 ρ n ( ε k )
δ k = ( b k T S k 1 b k ) 1 / 2 [ 2 + ε k ρ 2 ( ε k ) ρ 2 2 ε k ]
ρ 2 ( ε k ) = ε k e ε k 2 / 2 + 2 π ( ε k 2 + 1 ) F n o r m a l ( ε k ) e ε k 2 / 2 + 2 π ( ε k ) F n o r m a l ( ε k )
x ^ k | k = ( I K k H k ) x ^ k | k 1 K k u k m + γ k K k b k
P k | k = ( I K k H k ) P k | k 1 + δ k K k b k b k T K k T
(3.c) For j = 1 : N , iterate the following N (N denotes iterated times) steps:
Calculate the fused state estimation and its covariance:
x ¯ k | k ( j ) = 1 2 π c η k ( j 1 ) x ^ k | k 1 + 1 c ( 1 η k ( j 1 ) ) f ( θ k | z 1 : k 1 ) x ^ k | k
P ¯ k | k ( j ) = 1 2 π c η k ( j 1 ) ( P k | k + ( x ^ k | k x ¯ k | k ) ( x ^ k | k x ¯ k | k ) T )
+ 1 c ( 1 η k ( j 1 ) ) f ( θ k | z 1 : k 1 ) ( P k | k 1 + ( x ^ k | k 1 x ¯ k | k ( j ) ) ( x ^ k | k 1 x ¯ k | k ( j ) ) T )
  where c = 1 2 π η k ( j 1 ) + f ( θ k ) ( 1 η k ( j 1 ) ) is a normalization term, and f ( θ k | z 1 : k 1 ) can be obtained using (A6).
Update parameters:
l n ( η k ( j ) 1 η k ( j ) ) = ψ ( α 1 , k ( j 1 ) ) ψ ( α 2 , k ( j 1 ) ) + l n ( 1 / 2 π ) l n f ( θ k | x ¯ k | k ( j ) )
α 1 , k ( j ) = α 1 , k ( j 1 ) + η k ( j )
α 2 , k ( j ) = α 2 , k ( j 1 ) η k ( j ) + 1
End for and set x ¯ k | k = x ¯ k | k ( N ) , P ¯ k | k = P ¯ k | k ( N ) , η k = η k ( N ) , α 1 , k = α 1 , k ( N ) , α 2 , k = α 2 , k ( N ) .

5. Simulation Results

To evaluate the performance of the VB-SRF algorithm, two scenarios which are almost the same with these in [12,13] are utilized. The differences lie in the clutter probability in scenario 1 and the sensor tracks in scenario 2 which were not detailed in [12]. The two scenarios are very representative. In scenario 1, a maneuvering sensor is used in order to satisfy the condition of observability in bearings-only tracking. In scenario 2, multiple distributed sensors with large noise variance are utilized, which make the problem more challenging. The tracking performance of the VB-SRF algorithm was compared with the SRF algorithm, the MEFPDA-SCKF algorithm and PDA-SCKF algorithm in terms of track loss, track accuracy and computation complexity. The track loss is declared when the track error is large enough that making the filter diverge. Root mean square (RMS) error is used to show the track accuracy. In addition, the computation complexity is reflected by the computation time of each filter. The simulation codes can be downloaded through Github [20].

5.1. Scenario 1

In scenario 1, a target moves along a horizontal track, with zero vertical displacement, according to a white noise acceleration model. The state of the target is represented as x k = [ x 1 , k , x ˙ 1 , k ] , where x 1 , k and x ˙ 1 , k are the horizontal distance and velocity at time k, respectively. The observer platform follows an approximately parallel track at a constant average speed. The horizontal and vertical displacements of the platform x k p = [ x 1 , k p , x 2 , k p ] T are governed by the equations:
( 46 ) x 1 , k p = 4 k + x ˜ 1 , k p ( 47 ) x 2 , k p = 20 + x ˜ 2 , k p
in which x ˜ 1 , k p and x ˜ 2 , k p are zero mean Gaussian white noise processes, both with variance q = 1 .
The measurement is the angle (in radians) of the line-of-sight of this target from the platform. The sensor noise is Gaussian white noise with variance σ 2 = ( 0.05 ) 2 rad 2 = 2.86 2 deg 2 . The true clutter probability is 0.8. Other parameters are detailed in [13]. The configuration of the observer platform and target is illustrated in Figure 1. The bearing measurement of the target is presented in Figure 2. It can be seen that there is no abrupt change.
The clutter probability used in SRF is set as p c = 0.8 , which is the same with the true clutter probability. The initial values of VB-SRF parameters are η 0 = 0.8 , α 1 , 0 = 2 , α 2 , 0 = 10 . The clutter density λ is calculated using k l n ( 1 p c ) / 2 π in MEFPDA-SCKF and PDA-SCKF. Figure 3 presents the RMS target position errors of the four filters using 1000 Monte Carlo runs. It can be seen that SRF and VB-SRF have comparable performance under the correct clutter probability. MEFPDA-SCKF and PDA-SCKF have a little better tracking accuracy than SRF and VB-SRF.
In challenging scenarios, the clutter probability maybe unknown or time varying. The pre-set parameters are probably inaccurate. So here we set mistuned clutter probabilities for the four filters: (1) p c = η 0 = 0.7 ; (2) p c = η 0 = 0.5 ; (3) p c = η 0 = 0.3 . The percentages of track losses in 1000 Monte Carlo runs are given in Table 1. Clearly, the VB-SRF algorithm outperforms the SRF algorithm due to fewer track losses. Moreover the proportion of track losses increases as the mistuning aggravates. Especially, there are 2.9% tracks are lost for SRF while only 0.1% tracks are lost for VB-SRF in the worst case. In addition, we can see that MEFPDA-SCKF and PDA-SCKF have no track loss in all the three mistuned cases.
The RMS position errors of the four filters with different mistuned clutter probabilities are shown in Figure 4. We only consider the runs without track loss. From the figure, we can see that the tracking accuracy of VB-SRF is slightly better than SRF when η 0 0.5 . However, the performance difference is not obvious. When p c = η 0 = 0.3 , VB-SRF exhibits distinct superiority over SRF. It implies that VB-SRF is more robust than SRF. Meanwhile, MEFPDA-SCKF and PDA-SCKF show better tracking accuracy than SRF and VB-SRF under all the three mistuned cases. They are almost not affected by the mistuning. It shows MEFPDA-SCKF and PDA-SCKF are more accurate and robust than SRF and VB-SRF under this simple scenario.
Table 2 shows the computation time of the four filters with 100 Monte Carlo runs. It is clear that VB-SRF has the maximum time of computation, which is about 2 times of that of SRF. The computation time of MEFPDA-SCKF and PDA-SCKF are comparable and both smaller than SRF and VB-SRF.
On the whole, the VB-SRF algorithm outperforms the SRF in terms of track continuity, track accuracy and robustness especially in severely mismatched scenarios but with higher computation complexity. MEFPDA-SCKF and PDA-SCKF perform better than SRF and VB-SRF in all aspects. It illustrates that the PDA-SCKF-based strategy has superiority over the SRF-based strategy in handing the clutters in simple scenarios.

5.2. Scenario 2

For scenario 2, the aim is to track a single target from several drifting sonobuoys. A monitoring aircraft estimates the positions of the drifting sonobuoys by observing the direction of arrival of sensor transmissions. The sonobuoys track the position of the target by means of noisy bearings measurements.
The state is 12-dimensional:
x k = [ x 0 , k , x ˙ 0 , k , y 0 , k , y ˙ 0 , k , x 1 , k , y 1 , k , x 2 , k , y 2 , k , x 3 , k , y 3 , k , u 1 , k , u 1 , k ] T
the first four components represent the ( x , y ) coordinates of the position and velocity of the target, the next six, the coordinates of the positions of the three sonobuoys, and the last two, those of the drift current effecting all three sonobuoys.
Six simultaneous measurements are made at each time step. Three of these are measurements of the bearing angles of the sonobuoys from the monitoring platform and they are uncluttered. Three are the bearing angles of the target from the sonobuoys, which are subject to clutter. The standard deviation of monitoring sensor bearing noise and sonobuoy sensor bearing noise are 0.8° and 16°, respectively. The true probability of clutter is set as 0.667. In addition, the bearing of the clutter is uniformly distributed over [ π , π ] . Other simulation parameters can be referred to [12]. 200 Monte Carlo runs are performed to evaluate the performance of the proposed filter. Figure 5 shows the behaviour of the estimates of target and sonobuoy positions provided by both the SRF and VB-SRF, for a typical simulation.
The RMS target position errors of the four filters with correct clutter probability assumption are given in Figure 6. Compared with scenario 1, the differences between the four filters are more dramatic in scenario 2. This is probably because scenario 2 is more complex in which multiple sensors are used to observe the target and give abruptly changing and severely noise-corrupted bearing measurements of the target, shown in Figure 7. Thus, even a minor change in filtering strategy could result in large variations in performance. Meanwhile, seen from Figure 7, an abrupt change (almost from +180° to −180°) occurs in the target bearing measurement from sonobuoy sensor 3 at k = 62 s, which leads to several track losses shown in Table 1 and much larger position errors of MEFPDA-SCKF and PDA-SCKF. Whereas, SRF and VB-SRF are less affected by the abrupt bearing variation since the value of the projected measurement b k = ( s i n θ k , c o s θ k ) T is invariant when there is a 360° change in bearing θ k . They have comparable tracking accuracy. It is hard to decide which one is better.
To compare the performance under adverse scenarios, we set mistuned clutter probabilities as: (1) p c = η 0 = 0.5 ; (2) p c = η 0 = 0.3 . In case (1), there is no track loss in SRF and VB-SRF and the RMS position errors of the two filters are shown in Figure 8a. We can see that the RMS position errors of SRF are slightly increased compared with the case with no mistuning, while the RMS position errors of VB-SRF remain almost unchanged. In case (2), as shown in Table 1, 2.7% tracks are lost for SRF while no track is lost for VB-SRF. Meanwhile, as can be seen in Figure 8b, VB-SRF has much smaller RMS errors than the SRF. For MEFPDA-SCKF and PDA-SCKF, unlike with scenario 1, they have higher percentage of track losses and larger RMS position errors than VB-SRF in both mistuned cases. It shows that VB-SRF is superior to PDA-SCKF-based algorithms in more challenging scenarios. In addition, from Table 2, we can see that the computation time of VB-SRF is twice of the SRF and three times of MEFPDA-SCKF and PDA-SCKF. Overall, all these reveal that the proposed VB-SRF algorithm has significant performance superiority in severely mismatched and complex cases at the cost of a little higher computation complexity.

6. Conclusions

Bearings-only target tracking in the presence of clutter is a difficult problem because of the nonlinearity of the measurement model, the measurement origin uncertainty and the observability of the target. The Shifted Rayleigh filter (SRF) is shown to exhibit good performance for bearings-only target tracking in certain challenging scenarios through exploiting the essential structure of the nonlinearities in a new way. However, the clutter probability is assumed known and constant in SRF, which may not match with the truth especially in adverse scenarios. Therefore, to handle the bearings-only target tracking in clutters with uncertain clutter probability, a variational Bayesian-based adaptive shifted Rayleigh filter (VB-SRF) is proposed in this paper. By establishing a conjugate exponential model of the clutter probability and the data association indicator, the approximated posterior probability densities of the target state and the clutter parameters are iteratively calculated using the VB expectation and maximization steps. Finally, joint estimation of the target state and the clutter probability are achieved in the framework of SRF. The tracking performance of the proposed filter is compared with SRF, PDA-SCKF and MEFPDA-SCKF via two simulation examples. It shows that the proposed filter outperforms the other three filters in terms of track continuity and track accuracy with a little higher computation complexity in complex adverse scenarios. In addition, it also reveals that the proposed VB-SRF exhibits better robustness than the traditional SRF.

Author Contributions

J.H. conceived this paper, derived the method, and wrote the original draft; Y.Y. made the investigation; and T.G. revised the paper and provided some valuable suggestions.

Funding

This research was funded by Aeronautical Science Foundation of China (No. 2016ZC53033), and Shaanxi Provincial Key Research and Development Programs (No. 2017ZDXM-GY-06, No. 2017GY-057), and Xi’an Science and Technology Planning Project–Scientific and Technological Innovation Guidance Project (No. 201805042YD20CG26 (8)).

Conflicts of Interest

The authors declare no conflict of interest.

Abbreviations

The following abbreviations are used in this manuscript:
VBVariational Bayesian
SRFShifted Rayleigh Filter
PDAProbability Data Association
EKFExtended Kalman Filter
MPEKFPolar Coordinate EKF
PLEPseudo-Linear Estimator
UKFUnscented Kalman Filter
CKFCubature Kalman Filter
PFParticle Filter
MEFPDAMaximum Entropy Fuzzy Probabilistic Data Association
SCKFSquare-root Cubature Kalman Filter
CEConjugate Exponential
KLKullback- Leibler
EMExpectation-Maximum
RMSRoot Mean Square

Appendix A. Derivation of f(θk|xk)

Given the true state x k , the “augmented” measurement y k is assumed to be N ( m k , Q w ) variable, where m k = H k x k + u k m . θ k is the bearing of y k .
Let y k = Q w 1 / 2 y k , then y k N ( Q w 1 / 2 m k , I ) . Its bearing has a density about its mean of the form α σ ( θ ) . More precisely, let
g k ( θ ) = [ ( s i n θ , c o s θ ) Q w 1 ( s i n θ , c o s θ ) T ] 1 / 2
and define
h k ( θ ) = a r c t a n a 11 s i n θ + a 12 c o s θ a 21 s i n θ + a 22 c o s θ
where [ a i j ] = Q w 1 / 2 .
Actually, g k ( θ ) and h k ( θ ) are the reciprocal length and bearing of the transformed unit vector Q w 1 / 2 y k | | y k | | . The bearing h k ( θ k ) then has α g k ( θ k m ) ( h k ( θ k ) h k ( θ k m ) ) as its density, where θ k m is the bearing of m k . Inserting a Jacobian term, we can obtain the likelihood of measurement θ k :
f ( θ k | x k ) = g k 2 ( θ k ) ( d e t Q w ) 1 / 2 α g k ( θ k m ) ( h k ( θ k ) h k ( θ k m ) )

Appendix B. Derivation of f(θk|z1:k−1)

Given the previous measurements y 1 : k 1 , the “augmented” measurement y k is assumed to be N ( y ^ k , S k ) variable, where y ^ k = H k x ^ k | k 1 + u k m , S k = H k P k | k 1 H k T + Q w .
Let y k = S k 1 / 2 y k , then y k N ( S k 1 / 2 y ^ k , I ) . The bearing of y k has a density about its mean of the form α σ ( θ ) .
Let
g k ( θ ) = [ ( s i n θ , c o s θ ) S k 1 ( s i n θ , c o s θ ) T ] 1 / 2
h k ( θ ) = a r c t a n s 11 s i n θ + s 12 c o s θ s 21 s i n θ + s 22 c o s θ
where [ s i j ] = S k 1 / 2 .
g k ( θ ) and h k ( θ ) are the reciprocal length and bearing of the transformed unit vector S k 1 / 2 y k | | y k | | . The bearing h k ( θ k ) then has α g k ( θ ^ k ) ( h k ( θ k ) h k ( θ ^ k ) ) as its density, where θ ^ k is the bearing of y ^ k . Inserting a Jacobian term, we can obtain the probability density function of measurement θ k given previous measurements z 1 : k 1 :
f ( θ k | z 1 : k 1 ) = g k 2 ( θ k ) ( d e t S k ) 1 / 2 α g k ( θ ^ k ) ( h k ( θ k ) h k ( θ ^ k ) )

References

  1. Leong, P.H.; Arulampalam, S.; Lamahewa, T.A.; Abhayapala, T.D. A Gaussian-sum based cubature Kalman filter for bearings-only tracking. IEEE Trans. Aerosp. Electron. Syst. 2013, 49, 1161–1176. [Google Scholar] [CrossRef]
  2. Aidala, V.J. Kalman filter behavior in bearings-only tracking applications. IEEE Trans. Aerosp. Electron. Syst. 1979, 15, 29–39. [Google Scholar] [CrossRef]
  3. Aidala, V.J.; Hammel, S. Utilization of modified polar coordinates for bearings-only tracking. IEEE Trans. Autom. Control 1983, 28, 283–294. [Google Scholar] [CrossRef] [Green Version]
  4. Aidala, V.J.; Nardone, S.C. Biased estimation properties of the pseudo linear tracking filter. IEEE Trans. Aerosp. Electron. Syst. 1982, 18, 432–441. [Google Scholar] [CrossRef]
  5. Doğançay, K. On the efficiency of a bearings-only instrumental variable estimator for target motion analysis. Signal Process. 2005, 85, 481–490. [Google Scholar] [CrossRef]
  6. Doğançay, K. Bias compensation for the bearings-only pseudolinear target track estimator. IEEE Trans. Signal Process. 2006, 54, 59–68. [Google Scholar] [CrossRef]
  7. Nguyen, N.H.; Doğançay, K. Improved pseudolinear Kalman filter algorithms for bearings-only target tracking. IEEE Trans. Signal Process. 2017, 65, 6119–6134. [Google Scholar] [CrossRef]
  8. Wang, W.P.; Liao, S.; Xing, T.W. The unscented Kalman filter for state estimation of 3-dimension bearing-only tracking. In Proceedings of the 2009 International Conference on Information Engineering and Computer Science, Wuhan, China, 19–20 December 2009; pp. 1–5. [Google Scholar]
  9. Yang, R.; Ng, G.W.; Bar-Shalom, Y. Bearings-only tracking with fusion from heterogenous passive sensors: ESM/EO and acoustic. In Proceedings of the 2015 18th International Conference on Information Fusion (Fusion), Washington, DC, USA, 6–9 July 2015; pp. 1810–1816. [Google Scholar]
  10. Hong, S.H.; Shi, Z.G.; Chen, K.S. Novel roughening algorithm and hardware architecture for bearings-only tracking using particle filter. J. Electromagn. Waves Appl. 2008, 22, 411–422. [Google Scholar] [CrossRef]
  11. Chang, D.C.; Fang, M.W. Bearing-only maneuvering mobile tracking with nonlinear filtering algorithms in wireless sensor networks. IEEE Syst. J. 2014, 8, 160–170. [Google Scholar] [CrossRef]
  12. Clark, J.M.C.; Vinter, R.B.; Yaqoob, M.M. The shifted Rayleigh filter for bearings only tracking. In Proceedings of the 2005 7th International Conference on Information Fusion, Philadelphia, PA, USA, 25–28 July 2005; pp. 93–100. [Google Scholar]
  13. Clark, J.M.C.; Vinter, R.B.; Yaqoob, M.M. Shifted Rayleigh filter: A new algorithm for bearings-only tracking. IEEE Trans. Aerosp. Electron. Syst. 2007, 43, 1373–1384. [Google Scholar] [CrossRef]
  14. Arulampalam, S.; Clark, M.; Vinter, R. Performance of the shifted Rayleigh filter in single-sensor bearings-only tracking. In Proceedings of the 2007 10th International Conference on Information Fusion, Quebec, QC, Canada, 9–12 July 2007; pp. 1–6. [Google Scholar]
  15. Mei, D.; Liu, K.; Wang, Y. MEFPDA-SCKF for underwater single observer bearings-only target tracking in clutter. In Proceedings of the 2013 OCEANS—San Diego, San Diego, CA, USA, 23–27 September 2013; pp. 1–6. [Google Scholar]
  16. Sarkka, S.; Nummenmaa, A. Recursive noise adaptive Kalman filtering by variational Bayesian approximations. IEEE Trans. Autom. Control 2009, 54, 596–600. [Google Scholar] [CrossRef]
  17. Li, K.; Chang, L.; Hu, B. A variational Bayesian-based unscented Kalman filter with both adaptivity and robustness. IEEE Sens. J. 2016, 16, 6966–6976. [Google Scholar] [CrossRef]
  18. Sun, J.; Zhou, J.; Li, X.R. State estimation for systems with unknown inputs based on variational Bayes method. In Proceedings of the 2012 15th International Conference on Information Fusion, Singapore, 9–12 July 2012; pp. 983–990. [Google Scholar]
  19. Beal, M.J. Variational Algorithms for Approximate Bayesian Inference. Ph.D. Dissertation, Gatsby Computational Neuroscience Unit, University College London, London, UK, 2003. [Google Scholar]
  20. Hou, J. jaylin254/VB-SRF1. Available online: https://github.com/jaylin254/VB-SRF1 (accessed on 23 March 2019).
Figure 1. Target-observer geometry in Scenario 1.
Figure 1. Target-observer geometry in Scenario 1.
Sensors 19 01512 g001
Figure 2. The measurement of the target in Scenario 1.
Figure 2. The measurement of the target in Scenario 1.
Sensors 19 01512 g002
Figure 3. RMS target position errors with correct clutter probability in Scenario 1.
Figure 3. RMS target position errors with correct clutter probability in Scenario 1.
Sensors 19 01512 g003
Figure 4. RMS target position errors with different mistuned clutter probabilities in Scenario 1.
Figure 4. RMS target position errors with different mistuned clutter probabilities in Scenario 1.
Sensors 19 01512 g004aSensors 19 01512 g004b
Figure 5. Typical tracks of target, drifting sonobuoy sensors, together with the estimated tracks.
Figure 5. Typical tracks of target, drifting sonobuoy sensors, together with the estimated tracks.
Sensors 19 01512 g005
Figure 6. RMS target position errors with correct clutter probability in Scenario 2.
Figure 6. RMS target position errors with correct clutter probability in Scenario 2.
Sensors 19 01512 g006
Figure 7. The target measurements from three sonobuoy sensors in Scenario 2.
Figure 7. The target measurements from three sonobuoy sensors in Scenario 2.
Sensors 19 01512 g007
Figure 8. RMS target position errors with mistuned clutter probability in Scenario 2.
Figure 8. RMS target position errors with mistuned clutter probability in Scenario 2.
Sensors 19 01512 g008aSensors 19 01512 g008b
Table 1. The percentages of track losses of four filters in two scenarios.
Table 1. The percentages of track losses of four filters in two scenarios.
Scenario 1Scenario 2
p c = 0.7 p c = 0.5 p c = 0.3 p c = 0.667 p c = 0.5 p c = 0.3
VB-SRF000.1%000
SRF0.9%1.6%2.9%002.7%
MEFPDA-SCKF00013.5%13.3%14.2%
PDA-SCKF00020.1%20.8%22.4%
Table 2. Computation time of the four filters with 100 Monte Carlo runs for two scenarios.
Table 2. Computation time of the four filters with 100 Monte Carlo runs for two scenarios.
Scenario 1Scenario 2
VB-SRF0.7406 s1.0236 s
SRF0.3690 s0.5779 s
MEFPDA-SCKF0.2066 s0.3314 s
MEFPDA-SCKF0.2092 s0.3128 s

Share and Cite

MDPI and ACS Style

Hou, J.; Yang, Y.; Gao, T. Variational Bayesian Based Adaptive Shifted Rayleigh Filter for Bearings-Only Tracking in Clutters. Sensors 2019, 19, 1512. https://doi.org/10.3390/s19071512

AMA Style

Hou J, Yang Y, Gao T. Variational Bayesian Based Adaptive Shifted Rayleigh Filter for Bearings-Only Tracking in Clutters. Sensors. 2019; 19(7):1512. https://doi.org/10.3390/s19071512

Chicago/Turabian Style

Hou, Jing, Yan Yang, and Tian Gao. 2019. "Variational Bayesian Based Adaptive Shifted Rayleigh Filter for Bearings-Only Tracking in Clutters" Sensors 19, no. 7: 1512. https://doi.org/10.3390/s19071512

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