An Enhanced UWB-Based Range/GPS Cooperative Positioning Approach Using Adaptive Variational Bayesian Cubature Kalman Filtering
Precise position awareness is a fundamental requirement for advanced applications of emerging intelligent transportation systems, such as collision warning and speed advisory system. However, the achievable level of positioning accuracy using global navigation satellite systems does not meet the requirements of these applications. Fortunately, cooperative positioning (CP) techniques can improve the performance of positioning in a vehicular ad hoc network (VANET) through sharing the positions between vehicles. In this paper, a novel enhanced CP technique is presented by combining additional range-ultra-wide bandwidth- (UWB-) based measurements. Furthermore, an adaptive variational Bayesian cubature Kalman filtering (AVBCKF) algorithm is proposed and used in the enhanced CP method, which can add robustness to the time-variant measurement noise. Based on analytical and experimental results, the proposed AVBCKF-based CP method outperforms the cubature Kalman filtering- (CKF-) based CP method and extended Kalman filtering- (EKF-) based CP method.
Maintaining the availability of absolute position is a significant challenge for many applications such as intelligent transportation systems (ITS)  and location based services (LBS) . The Global Navigation Satellite Systems (GNSSs), such as the Global Positioning System (GPS), do not meet the requirements of safety-related applications, such as collision avoidance and lane-level guidance, due to limited accuracy and availability. Several techniques have been proposed to improve the GPS positioning performance, such as real-time kinematic (RTK) , differential GPS (DGPS) , and satellite/ground-based augmentation systems . However, these techniques rely on the infrastructures and cannot perform well in urban environments due to limited view of the sky, multipath interference, and unavailability of line of sight. Fortunately, some innovative approaches called cooperative positioning (CP) have been proposed in recent years for positioning accuracy enhancement within vehicular networks, based on mutual communicating among the nodes of the network. The CP process typically consists of two phases . The first phase is the measurement phase, during which the vehicles measure internal state information, such as vehicles’ positions by standalone GPS receivers, and range values by ranging instruments. The second phase is the position update phase, during which vehicles share the measurements with others and infer their positions based on all the measurements.
In the first phase of CP, radio-based-ranging methods are the widely used ranging techniques which use signal propagation characteristics to derive an estimation of the distance between the transmitter and the receiver . There are four common radio-ranging techniques used for CP in VANETs: time of arrival (TOA), time difference of arrival (TDOA), angle of arrival (AOA), and received signal strength (RSS). Christie et al.  combined the RSS based intervehicle distance measurements with the road maps and vehicle kinematics for vehicle positioning. However, the RSS-based range does not always provide accurate distance measurement due to large variations in signal attenuation under different environments, particularly when multipath and shadowing effects are present . Benslimane  assumed that the ranges among vehicles can be estimated using RSS, TOA, or TDOA and proposed a CP method that uses the ranges and GPS-based positions to estimate other GPS-denied positions. In [11, 12], two range-based CP methods are proposed to mitigate GPS multipath error and improve accuracy in a VANET, respectively. Apart from the range-based CP techniques, there is another class of CP techniques, based on radio-ranging rate, which was presented in [13–15]. In , a location estimation algorithm based on the Doppler effect is presented to estimate the position of a moving target in a wireless sensor network. However, the geometry of the target over a large distance is not consistent with the geometry of the vehicular environment in urban streets, which is not suitable for vehicle positioning. A Doppler-shift-based CP method for VANETs is proposed in , which mainly relies on the infrastructure.
In the second phase, measurements are aggregated and passed to the fusing algorithm. For most of the CP data fusion, the system and measurement models are nonlinear; therefore, the nonlinear filtering techniques are used to achieve better positioning results. As a widely used nonlinear filtering technique, extended Kalman filter (EKF) is usually used as the core of the CP algorithm [16, 17]. However, the EKF can result in particularly poor performance if the dynamic systems are highly nonlinear. As better alternatives to the EKF, some other filters based on Bayesian sampling, such as unscented Kalman filter (UKF) and particle filter [18, 19], can also be used for nonlinear system. However, a heavy computational load and the curse of the dimensionality in practical application are major constraints in these filtering algorithms. The cubature Kalman filter (CKF)  has recently received increasing attention, which employs deterministic sampling to evaluate the intractable integrals encountered in filtering problem. However, the performance of these filters mentioned above may degrade due to the fact that in practical situations the statistics of measurement noise might change.
In this paper, an enhanced CP method by utilizing the ultra-wideband- (UWB-) based-range measurements is proposed. It focuses on the absolute positioning in emerging intelligent transportation systems. In this method, the GPS-based positions are shared among the participating vehicles. Then each vehicle fuses the GPS measurements and UWB-based range to obtain the position. For data fusion, an adaptive variational Bayesian cubature Kalman filtering (AVBCKF) is proposed as the core of the CP algorithm. In each update step of the AVBCKF, both the system state and time-variant measurement noise are considered as random variables to be estimated. Measurement noise variance is approximated by variational Bayesian (VB) approach; thereafter, system states are updated by cubature Kalman filtering. The analytical and experimental results show that the AVBCKF can dynamically estimate the measurement noise, and the AVBCKF-based CP method outperforms CKF-based CP method and EKF-based CP method.
The rest of the paper is organized as follows. In Section 2, the novel AVBCKF is described. Section 3 explains the UWB-based-range technique and the estimator of the proposed CP method. In Section 4, the experimental results are discussed, and the performance of the proposed system is evaluated. Section 5 summarizes the contributions of this work and future work.
2. Adaptive Variational Bayesian Cubature Kalman Filtering
2.1. Variational Bayesian Approach
The VB approach, also known as ensemble learning, takes its name from Feynman’s variational free energy method developed in statistical physics . VB is developed by the machine learning community and has been applied in a variety of statistical and signal processing domains. In this paper, VB is used to estimate the noise variance of measurements in the proposed CP algorithm. Therefore, the following will explain the VB approach.
In the parameter estimation domain, after getting the observed data set , the posterior probability density function (PDF) of parameter set can be calculated by Bayes’ rule as where is the marginal likelihood function and is the key parameter to obtain the value of . As a result of the intractability of the integral in computing , it is difficult to calculate to obtain . The key idea of VB is to use a new distribution to approximate the true distribution . The form of the new distribution is selected freely owing to the conjugacy property. Furthermore, if the set is partitioned into parts as , then each is assumed to be independent of each other. Naturally factorizes into independent , and the joint distribution as The technique used in VB approach is also called mean field variational Bayes.
In VB framework, the goal is to find a which is as close as to . Fortunately, Kullback-Leibler (KL) divergence is a nonnegative dissimilarity function measuring the discrepancy between two distributions and . Hence can be obtained by minimizing the KL divergence between and . It has also been shown in  that minimizing is equivalent to maximizing the lower bound of . The lower bound function can be written as Maximizing tightens the lower bound and gives rise to the optimal distribution. The approximate distribution is optimal in the sense of KL divergence because equals zero if and only if . It is worth noting that this optimal sense differs from the counterpart in optimal estimation theory, where the optimization is measured by minimum-variance rules. Therefore, can be computed by differentiating with respect to .
General solution of s is given as where is the expectation of log joint distribution over all the parameters not in the partition.
Note that (4) is an implicit solution because of the circular dependencies. This forms an iterative estimation scheme, where the distribution of each parameter is estimated with the expectation over other distributions, given the appropriate initialization of the hyperparameters. Afterwards, the distribution of each parameter is updated according to (4) during the next iterations, until the algorithm converges. The convergence of VB has been analytically proved in . Hence, in VB framework coupled equations can be solved through form separable approximate distributions.
2.2. Cubature Kalman Filtering
Consider the discrete-time nonlinear filtering problems with additive process and measurement noise, whose state space model can be expressed by the pair difference equations, given as Equations (5) and (6) are the process equation and the measurement equation, respectively, where and are the state and measurement values at time , respectively; and are some nonlinear functions; and are white noise with zero mean and covariance and , respectively. From the perspective of probability, the state space model can be reformulated according to  as Assume that is Gaussian distribution with mean and covariance . Then, the prior density of the state at and obeys the Gaussian distribution as and , respectively. Therefore, the prediction and update equations of the CKF can be expressed as follows.
The prediction equation is as follows: The update equation is as follows:
2.3. The Proposed Adaptive Variational Bayesian Cubature Kalman Filtering
In the traditional CKF algorithm, the statistical moment of measurement noise is invariant. However, the performance of the traditional CKF may be degraded due to the fact that in practical situations the statistics of measurement noise might change with time. In order to introduce robustness against the measurement noise in the CP, an improved cubature Kalman filtering approach based on variational Bayesian is proposed as the core component of the CP algorithm. In each update step of the AVBCKF, both system state and time-variant measurement noise are considered as random variables to be estimated. Measurements noise variances are approximated by variational Bayesian approach; thereafter, the system states are updated by cubature Kalman filtering.
In the proposed AVBCKF algorithm, the system state and the covariance of time-variant measurement noise are considered as random variables to be estimated. Consequently, the prior distribution of the joint probability density function of and at time can be expressed as At time , the prior distribution of the joint probability density function of and is From the perspective of generalized Bayes’ rule, (10) and (11) can be seen as the prediction equation and the update equation of Bayes filtering theory. However, the computation of the integral in (10) is intractability, and the variational Bayesian approach is used to obtain the approximate optimal value. Assume that the variables and are independent of each other, and, according to the prior knowledge , these can obey the Gaussian distribution and inverse-gamma distribution, respectively. Then, at time ,
After getting the measurement at time , a new distribution to replace the real posterior distribution will be introduced to use the variational Bayesian approach. For simplicity, the dependence of distribution on is omitted in the following formulations. For example, the will be expressed as . Under the assumption that two variables and are independent, the following relationship can be obtained . Equation (4) gives the general approximate solution of variational Bayesian approach. Meanwhile, referring to the CKF algorithm and using the nonlinear function in (6), for the state variable and the covariance of measurement noise , the following relationship can be obtained: where is the constant and is unrelated to the form of distribution. As it can be seen from (13) and (14), the posterior distributions, and , have the same form and different parameters with the prior distributions, and , which obey the Gaussian distribution and inverse-gamma distribution, respectively. The reason is that the Gaussian distribution and inverse-gamma distribution belong to the conjugate exponential distribution .
The parameters , in the Gaussian distribution of state variable can be derived as where and the parameters in approximate inverse-gamma distribution can also be derived as Using the characteristic of inverse-gamma distribution , According to the sample strategy of CKF, the expectation in (18) can be derived as
The joint density of and can be estimated using (13) to (20). The steps of variational Bayesian algorithm can be summarized as follows. Firstly, the parameters of the prior distribution in (15), (17), (18), and (19) are defined to calculate the approximate distribution and the parameters , . Then the distribution is updated as shown in (13) and (14), and new values are calculated using (19) and (20). Furthermore, the distribution parameters are updated using (15) to (18). The estimation process is iterative, and the iteration will stop when the convergence is reached. It is reported in  that in a similar case VB will converge very soon with only a few iterations.
After using the VB to estimate the covariance of measurement noise and combining the VB into CKF, the AVBCKF proposed in this paper can be explained as follows.(i) Predict: Initialize the , , , . Predict the noise parameters using (17), (18), and (8).(ii) Update: Update the measurement noise using VB equations (14) and (17)-(18), and then update the state variable using (15).
3. The Estimator of the Proposed CP
Assume that a VANET consists of a number of vehicles and all the vehicles are equipped with a GPS receiver and an UWB transceiver that can communicate the measurement data among the vehicles. The ultimate goal is that each vehicle can improve the accuracy of its position using a data fusion algorithm which is fed by local measurements and neighbors’ GPS-based positions and the UWB-based ranges. Therefore, the measurements used in the proposed CP include the positions and ranges of the vehicles. In the method, GPS-based positions are shared between vehicles through the UWB communication. The positions are combined with the range measurements from UWB to achieve enhanced positioning. The AVBCKF algorithm proposed above is designed as the core of the CP algorithm for data fusion. For simplicity and convenience, only two vehicles and are considered, which can be easily extended to the case of more than two vehicles. In this paper, the orthogonal axes east-north-up (ENU) are used as the coordinate frame to express the location of the vehicle. For simplicity, 2D positioning is considered, but the method can easily be expanded to 3D positioning. Figure 1 shows the typical architecture of the proposed CP with two vehicles. As shown in Figure 1, assume that vehicle is the target vehicle, and it broadcasts its GPS-based position to vehicle and receives the position of vehicle through UWB. Meanwhile, the UWB device in vehicle measures the range between vehicles and . In vehicle , the positions and and the range are used as inputs to the fusing algorithm to get the enhanced position of vehicle .
The state space model of the movement of target vehicle is defined as where is the state vector that contains the position , velocity , and acceleration of the target vehicle; and are along the east and north axes, respectively. is the state transition model, is the process noise model, is the Gaussian system noise with the STD and zero mean along each axis, the covariance of process noise is , is the observation period, and is the time. and are given as where is a identity matrix and is a zero matrix.
Corresponding to the system state model, the observation model of the CP algorithm can be defined as where is a nonlinear observation vector in terms of and is the observation noise. The observation vector consists of GPS-based positions of two vehicles and the range between two vehicles measured by UWB. The distance between vehicles and can be expressed as EKF can be used to implement the CP algorithm due to nonlinearity of in (23). However, using EKF introduces the prerequisites of definite models and known invariant noise parameters. In this paper, the AVBCKF is designed as the data fusion algorithm in CP which is robust to the variations in the measurement noise.
4. Experimental Results
In order to evaluate the performance of CP method based on the proposed AVBCKF, the same experimental data as found in  is used. The experimental setup includes two vehicles equipped with GPS receivers, INSs, and UWB transceivers. A set of relatively expensive reference equipment and a set of low cost sensors are fitted into each test vehicle. The reference equipment is the Leica GS10 receiver for vehicle 1 and a Novatel INS-LCI (integrated GNSS-INS) for vehicle 2. The carrier-phase-based differential position estimates (RTK) of these receivers were used as ground truth positioning data. The noisy GPS-based positions and the UWB- (MSSI-) based range were used as measurements to the AVBCKF-based data fusing technique in CP algorithm. Figure 2 shows the photograph of two experimental vehicles.
The duration of the entire experiment was much larger than the duration of the data selected (14 minutes); however, this was the largest continuous block of data with corresponding RTK GPS availability. Meanwhile, two vehicles can communicate through UWB continuously during the experimental data selected. The GPS observations logged at the Nottingham Geospatial Institute reference station were used for the calculation of the DGPS corrections. The test area was the Clifton Boulevard, between Derby Road and Loughborough Road in Nottingham, UK, which had good open sky to maximize the satellite visibility. Figure 3 shows the number of the common visible satellites to the vehicles for the selected experimental data. It can be found that the number of common visible satellites is almost always above the required minimum, that is, four. However, when it falls below the minimum, the Kalman filter can compensate using the dynamic model of the system, setting the innovation of missing observation to zero and assigning a large number, as infinity, to the corresponding element in observation covariance.
In addition to the AVBCKF, the EKF and CKF are also used as the data fusion algorithms in the CP to evaluate a relative efficiency of the proposed AVBCKF. For convenience, “EKF-CP,” “CKF-CP,” and “AVBCKF-CP” are used in the following figures to denote the three different data fusion algorithms mentioned above. The positioning error of vehicle was calculated as , where and are the estimated and the true positions using RTK GPS data, respectively.
It can be noticed from the figures that, compared to the EKF-based data fusion and CKF-based data fusion, the proposed AVBCKF solution has improved precision of the position. The obvious reason is the consideration of both system state and time-variant measurement noise as random variables that are estimated in the proposed AVBCKF. Therefore, the AVBCKF-based data fusion algorithm is more robust to the variations in the measurement noise and outperforms the other two data fusing algorithms.
In this paper, an adaptive variational Bayesian cubature Kalman filtering is proposed as the CP algorithm. The major focus of the algorithm is to improve the performance of absolute position estimation in emerging intelligent transportation systems. In each update step of the proposed AVBCKF, both the system state and time-variant measurement noise are considered as random variables to be estimated, and the variances of measurement noise are approximated using variational Bayesian (VB) approach. Thereafter, the system states are updated by cubature Kalman filtering. The AVBCKF-based data fusion algorithm is shown to be robust to the variations in the measurement noise. The experimental results show that the AVBCKF-based CP method outperforms the CKF-based CP method and EKF-based CP method.
Conflict of Interests
The authors declare that there is no conflict of interests regarding the publication of this paper.
The authors would like to thank Dr. N. Alam from Caterpillar Trimble Control Technologies, Dayton, OH, USA, for his previous work and kind assistance in this project. The authors would also like to thank Associate Professor A. Kealy from the Department of Infrastructure Engineering, University of Melbourne, Parkville, Australia, and Dr. C. Hill and Dr. S. Ince from the Nottingham Geospatial Institute, University of Nottingham, Nottingham, UK, for their support and collaboration in the experiments conducted for this work. This work is supported by National Nature Science Foundation of China under Grant nos. 61102107 and 61374208 and by the China Fundamental Research Funds for the Central Universities under Grant no. HEUCFX41310.
“Vehicle Positioning for C-ITS in Australia. Austroads Research Report,” https://www.onlinepublications.austroads.com.au/items/AP-R431-13.View at: Google Scholar
E. D. Kaplan and C. J. Hegarty, Understanding GPS Principles and Applications, Artech House, Norwood, NJ, USA, 2nd edition, 2006.
B. Hofmann-Wellenhof, H. Lichtenegger, and J. Collins, Global Positioning System Theory and Practice, Springer, New York, NY, USA, 5th edition, 2001.
J. R. I. Christie, P.-Y. Ko, A. Hansen et al., “The effects of local ionospheric decorrelation on LAAS: theory and experimental results,” in Proceedings of the National Technical Meeting of the Institute of Navigation, pp. 769–777, San Diego, Calif, USA, January 1999.View at: Google Scholar
N. Drawil and O. Basir, “Vehicular collaborative technique for location estimate correction,” in Proceedings of the IEEE 68th Vehicular Tchnology Conference, pp. 1–5, September 2008.View at: Google Scholar
J. Arias, J. Lázaro, A. Zuloaga, and J. Jiménez, “Doppler location algorithm for wireless sensor networks,” in Proceedings of the International Conference on Wireless Networks (ICWN '04), pp. 509–514, Las Vegas ,Nev, USA, June 2004.View at: Google Scholar
F. Shen, J. W. Cheong, and A. G. Dempster, “A tight integration approach for relative positioning enhancement based on low-cost IMU and DSRC doppler,” IEEE transaction on ITS. Submitted.View at: Google Scholar