Abstract

In smart cities, vehicles tracking is organized to increase safety by localizing cars using the Global Positioning System (GPS). The GPS-based system provides accurate tracking but is also required to be reliable and robust. As a main estimator, we propose using the unbiased finite impulse response (UFIR) filter, which meets these needs as being more robust than the Kalman filter (KF). The UFIR filter is developed for vehicle tracking in discrete-time state-space over wireless sensor networks (WSNs) with time-stamped data discretely delayed on -step-lags and missing data. The state-space model is represented in a way such that the UFIR filter, KF, and filter can be used universally. Applications are given for measurement data, which are cooperatively transferred from a vehicle to a central station through several nodes with -step-lags. Better tracking performance of the UFIR filter is shown experimentally.

1. Introduction

Accurate target tracking is one of the key problems in urban areas [1], which especially arises in smart cities design [2]. If a target is equipped with the Global Positioning System (GPS) tracker, then measurement data can be transferred to a central station through one or several nodes of a wireless sensor network (WSN) [3]. The problem which arises here is associated with information latency and missing data [4] due to the following main causes: high maneuverability of the target [1], failures in measurements [5], network congestion [3], non-line-of-sight (NLOS) problems [6, 7], and accidental loss of some collected data [8]. Furthermore, latency naturally occurs due to the limited bandwidth, finite propagation time [9], complexity of very large-scale integration and microelectromechanical systems [10], and time required to complete operations such as signal conditioning and storage [11]. In networks, communication delays go along with data loss called dropout or intermittence [12, 13]. Also the delay between the measurement and its availability to the filter causes the problem of out-of-sequence measurement [6, 14].

Two basic models have been created for delayed data. The delays are assumed to be known when sensors are able to detect the delays or data are time-stamping [15, 16]. In many other applications [17, 18], the delays are considered to be random. The problem becomes more complex in uncertain systems [19]. The best estimate is obtained here by combining delayed and nondelayed data with different probabilities.

The Kalman and state estimators are most widely used to deal with latency and associated issues [20]. The linear Kalman filter (KF) is optimal when it matches the system perfectly, noise is white Gaussian and uncorrelated, and the noise statistics are known along with the initial values. When such conditions are not obeyed, the KF may demonstrate poor performance [13, 21]. The robust filter bounds the mean square error (MSE) for admissible parameter perturbations and delays [19, 22], which allows for minimizing errors with less information required than for the noise statistics [20, 23].

Another way to achieve better robustness is to process most recent finite data [24] using finite impulse response (FIR) filters [25]. Such filters have been developed during decades by many authors in signal processing [2633] and control [3436]. However, only a few authors have proposed FIR solutions for models with delays [3740]. Let us notice that the available iterative unbiased FIR (UFIR) algorithm [28, 4143] is most robust among other FIR solutions owing to an ability to ignore the noise statistics and initial values. This filter is bounded-input bounded-output (BIBO) stable and blind on given horizons of points, but is still not developed for observations with delayed and missing data.

In this paper, we develop the UFIR filter for GPS-based vehicle tracking over WSNs with time-stamped data discretely delayed and missing data. The rest of the paper is organized as follows. In Section 2, we consider the model and formulate the problem. In Section 3, we develop the UFIR filter for observations with delayed and missing data. Section 4 discusses the estimation errors. Section 5 gives an experimental example of applications to GPS-based tracking and concluding remarks are drawn in Section 6.

2. Tracking Model and Problem Formulation

A typical scenario of GPS-based vehicle tracking in WSNs is sketched in Figure 1. The vehicle current coordinates are measured by the GPS tracker. The time-stamped data are transferred to a central station (CS) via one or several nodes of the WSN. Because each node may discretely delay time-stamped data at least on one-step, the vehicle location is observed in CS with a time varying -step-lag depending on the vehicle location and interaction with the WSN.

2.1. Tracking Model

For , the vehicle dynamics and its observation can be represented in discrete-time state-space aswhere is the discrete-time index, is the vehicle state vector, is the observation vector, is not singular, and . All data are time-stamped, so that is known at each . Regardless of the delay, the initial state is supposed to be known. The uncorrelated noise vectors, and , are white Gaussian with known covariances, and , and the property for all and .

The UFIR filter can be applied if to transform model (1)-(2) to have no latency. That can be done if to represent using (1) via asand then substitute (3) into (2) and arrive atwhereand the covariance of is given by

In compact matrix forms, (6) and (7) can be represented aswhereand has diagonal components. Here, and when and .

Any standard estimation technique can now be applied to models (1) and (4). However, the KF and filter were most developed for data with latency. Therefore, below we will introduce in brief only these filters and then compare them to the UFIR filter based on examples of tracking. We will use the following measures: is the estimate of over data taken from past up to and including time index , is the prior estimate, is the error covariance matrix, and is the prior error covariance matrix.

2.1.1. Kalman Filter

For our purposes, we will exploit an alternative form of the KF algorithm given in [44]. This algorithm starts with the prior error covariance matrixand then recursively updates the following values:where is given by (5) and by (7) for any .

2.1.2. Filter

The filter has been derived in [44] in the form (13) of the KF using the game theory. For , the filtering algorithm becomeswhere the user-given symmetric positive definite matrices , , and have different meanings than in the KF and can be computed via using (12) with . To keep (14) positive definite, the positive definite matrix is subject toIf equal weights are required for all errors, matrix must be set identity, . The performance criterion for this filter is , in which a scalar must be small enough in order for the filter to be efficient. It then follows that the tuning factor is not allowed to be negative, even though its negative values may reduce errors when the weighting matrices are not maximized. For Gaussian noise, zero transforms the filter to the KF. For any other noise, small may result in better robustness.

The problem now formulates as follows. Given (1) and (4) with time varying and missing data, we would like to develop the UFIR filter and find its fast iterative form for GPS-based tracking of a moving vehicle as shown in Figure 1. We also wish to know how the UFIR filter, KF, and filter measure to each other in applications to tracking.

3. UFIR Filter for Tracking with Delayed and Missing Data

To develop the UFIR filter for , we extend models (1) and (4) on a horizon of points, from to that referring to [43] yieldswith the following extended vectors and matrices:where represents a set of .

3.1. Batch UFIR Filter Form

The UFIR filtering estimate of the vehicle state can be obtained at in the batch form as [27, 34]where is the UFIR filter gain and is a vector of real data (22), if to satisfy the unbiasedness conditionin which means averaging of and can be represented with the last row vector in (19) aswhere is the th row vector in (25) given by

By combining (29)–(32) and following [27], one arrives at the unbiasedness constraintin whichNow multiplying the both sides of (33) with yields the UFIR filter gainand the batch UFIR filtering estimate becomeswhere the generalized noise power gain (GNPG) [43] is

The batch form (36a) may not suite real-time tracking and we go on with its fast iterative algorithm.

3.2. Iterative UFIR Filter Form

Provided (1) and (4), the standard iterative UFIR filtering algorithm [25] can be applied straightforwardly, if to substitute matrix with given by (5). The UFIR filtering estimate (36a) can then be computed iteratively using recursionsbeginning with and ending when . The initial values for (38) and (39) are obtained at in the batch forms aswhere is a vector (22) of real data. When some data are lost, inaccurate, or unavailable, can be predicted as , in which case first data on the horizon must be available.

It is known that the linear UFIR filter is BIBO stable and not prone to divergence. However, latency in information delivery may require an ability to predict lost values that inevitably cause extra tracking errors, which we will consider next.

4. Tracking Errors Caused by Latency,

Error produced by the UFIR tracker can be defined as , where is specified by (31). Provided , the error covariance matrix can also be represented in two forms.

In the batch form, matrix appears if to substitute with (31) and employ with given by (20). That yieldswhere and are square matrices with nonzero diagonal elements. It can be shown that the deterministic case of and makes and the UFIR tracker has thus the deadbeat property.

4.1. Iterative Computation of

Matrix (42) can also be computed iteratively, if to substitute with (1) and with (39). Provided the averaging, the recursion for (42) can be found aswhere is given by (12), ranges as in (38) and (39), and is taken when . Recursion (43) suggests that the tracking error grows with , because the sum containing grows with . However, the same cannot be said about , which does not accumulate the effect of .

With no latency, the sum in (43) becomes identically zero and one arrives at the error covariance of the standard UFIR filter [43],which also holds for the KF, if to substitute with the Kalman gain .

Note that the minimization of tracking errors will require an optimal number of iterations for the UFIR filter. At the test stage, the optimal horizon can be found for the known ground truth by minimizing the MSE via the trace of [30] depicted as tr . Because the ground truth is unavailable in real tracking, can be estimated via the measurement residual as shown in [30].

5. GPS-Based Tracking of a Moving Vehicle

We will now consider the case shown in Figure 1 when the GPS tracker measures the vehicle coordinates of location at each time index and transfer time-stamped data cooperatively to a CS of a WSN via one or several nodes. We admit that each node may introduce latency and data will thus arrive at the CS with known delay on points. At different time instances, a vehicle may interact with a different number of the nodes that will make the -step-lag time varying. We will base our investigations on data obtained in the Cook county of Illinois and available for free use from the University of Illinois at Chicago. To simplify the problem, in this paper we will consider the case of a constant latency, .

Concerned with the tracking errors and not with the actual vehicle location, we will conventionally place the start point at zero coordinates as shown in Figure 2.

5.1. State-Space Model

To investigate the trade-off between the estimators, we will suppose that a vehicle is represented with two states in each directions and assign the state vector, , as , where , , , and . Accordingly, the system matrix attains the form of where the sampling time is  s for the considered database. The GPS tracker provides measurements of the vehicle coordinates, and . Therefore, the measurement matrix is

Provided and , matrix required by the UFIR filter to compute the initial values (40) and (41) for becomes

The only tuning factor required by the UFIR filter was found for by minimizing the derivative of the trace of the mean square value of the residual , as shown in [30]. Because depends on , we will apply in the worst case for the UFIR filter.

Having no information about the process noise, we observe similar trajectories and estimate the average vehicle speed by about 10 m/s or 36 km/hour. Next, accepting the speed standard deviation of about 20%, we set  m/s to the second state along each of the coordinates, ignore the unknown noise in the first state, , and describe matrix as

The GPS standard positioning service provides navigation with an error of less than 15 meters with the probability of 95% in the 2-sigma sense. Referring to this value, we assign the standard deviation of the measurement noise in each direction as  m and obtain

Because the above provided matrices and are overestimated, we set and for . It is expected that the tuning factor will improve the performance of the filter by minimizing the MSE for the maximized errors. However, the ground truth is not available in tracking. Therefore, we will find for the measured trajectory and consider it as the best case for , which is unfeasible.

5.2. Effect of Latency on the Estimation Accuracy

We start with learning the effect of on the estimation accuracy, which is illustrated in Figure 3 with the root MSEs (RMSEs) in the north direction (-RMSE). The KF is self-tuned to . Therefore, we consider its RMSE as a benchmark. A special feature of the KF is that the RMSE grows with nonlinearly and faster than in the UFIR and filters.

The UFIR filter produces a bit more errors than in the KF with small and lesser with larger . A special feature is that the UFIR estimate is of low sensitivity to , in which optimal value holds for , increases to for , and reaches when . Of practical importance is that setting optimally for each does not improve the performance essentially against the worst case when is set for all .

The filter outperforms both the UFIR filter and KF, provided that is set properly for each lag . However, this filter is highly sensitive to , in which optimal value ranges from for to for in a nonlinear way. Unlike in the UFIR filter, a constant is unacceptable for all . An example is given in Figure 3, where found for is applied in a wide range of . As can be seen, it is only when that the filter improves the KF performance. For , there is no improvement and, when , the filter rapidly diverges.

5.3. Tracking over Data Delayed on

We now suppose that data are transferred from a vehicle to a CS with and investigate tracking errors in the north and east directions. Filters will be tuned as follows: UFIR in the worst case of being valid for ; KF as near optimal; and being in the best (unfeasible) case of known ground truth.

5.3.1. Tracking in the North Direction

The vehicle trajectory (measured and delayed) and estimates provided by the filters in the north direction are sketched in Figure 4. As can be seen in Figure 4(a), the trajectory is nonlinear and the vehicle sometimes maneuvers rapidly. All filters produce consistent estimates with poorly distinguishable differences (Figure 4(a)). We therefore additionally show two parts of the trajectory on short-time spans of in Figure 4(b) and in Figure 4(c). Several observations can be made from Figure 4:(i)All filters track well the trajectory when a vehicle travels with a near constant velocity in one direction, as on in Figure 4(b).(ii)Filters temporarily lose an ability of tracking and go along the delayed data when a vehicle quickly changes the direction, as on in Figure 4(c).(iii)Responding to fast maneuvers, all filters produce dynamic errors such that the UFIR filter comes up with larger excursions but shorter transients, KF with shorter excursions but longer transients, and filter demonstrates inbetween properties; see on in Figure 4(b) and in Figure 4(c).

Because errors are unacceptably large in all filters when they temporarily lose an ability of tracking, a key question arises of how fast each of them returns back to the normal mode. In this regard the UFIR filter looks better with its shortest transient.

5.3.2. Tracking in the East Direction

Tracking in the east direction (Figure 5) does not reveal any essential features. The filters still track well the trajectory when a vehicle travels with a near constant velocity as, for example, in a span of in Figure 5(b). Here, all filters also temporarily lose an ability of tracking and go along the delayed data when the trajectory quickly changes as, for example, in a span of in Figure 5(c). Finally, the UFIR filter still demonstrates larger excursions but shorter transients, KF shorter excursions but longer transients, and filter is inbetween as, for example, in spans of in Figure 5(b) and in Figure 5(c).

5.4. Tracking with Temporary Lost Data

We finally admit that some data points can be lost during the transmission and remove 5 data points at  s and 10 at  s as shown in Figure 6 for . To predict lost data, we augment each algorithm with the prediction block as mentioned below (41) and run the filters. As can be seen, the filters act consistently with, however, some specifics. The estimates do not get away essentially from each other and the actual trajectory. However, when a vehicle maneuvers during the prediction, all filters diverge and return back to the actual trajectory with similar transients as in Figures 4 and 5. The latter again speaks in favor of the UFIR filter, which has shorter transients.

6. Conclusions

The UFIR filter developed in this paper for GPS-based vehicle tracking over WSNs with time-stamped discretely delayed and missing data has demonstrated better performance than the KF and filter. The main benefits of using the UFIR filter are that it (1) does not require any information about noise and initial conditions, (2) becomes blind on given horizons, and (3) has shorter transients. The latter can be considered as an important practical advantage in all situations when the trajectory changes rapidly and estimators temporarily loses an ability of tracking. Applications to GPS-based vehicle tracking with known discretely delayed and missed data have proved a better performance of the UFIR filter.

Conflicts of Interest

The authors declare that there are no conflicts of interest regarding the publication of this paper.