With the miniaturization of technology, small urban and domestic drones and robots are ubiquitous. These self-driving machines are applied in parcel and food delivery (Jang and Kim, 2019), rescue missions (Alexopoulos et al., 2013), surveying, and security (Pham et al., 2015). Drones are flying and navigating through congested urban environments while performing assigned tasks (Li et al., 2019). Although these applications seem different but detecting static and dynamic objects (targets) in surroundings is a key requirement by all. The problem of target location and velocity estimation is commonly known as Target Motion Analysis (TMA) (Jang and Kim, 2019; Jauffret and Pillon, 1989;, Li and Jilkov, 2003), and has different variants based on the collected measurement types. Aerospace industry has strict weight and size limits for any additional sensor that can be placed on the drone. Sensors required for avoiding collisions has to be simple, low-powered, and rugged (Li et al., 2019). Moreover, successful utilization of such collision avoidance systems lies in its miniaturization and smooth integration (Jin et al., 2020). Currently, a lot of focus is put on collision avoidance using cameras (Quan et al., 2020). However, cameras are sensitive to environmental conditions (rain, fog, dust), are computationally expensive, and require high operating power (Lee et al., 2016; Ciaparrone et al., 2020).
Radars, on the other hand, are quite robust to light and environmental conditions. Doppler radars are simplest types of radars, that are cheap, require less power, and are computationally inexpensive (Al-Hourani et al., 2018). They capture the Doppler frequency shift in the transmitted and reflected radio signals to obtain the target’s relative velocity. However, these radars cannot provide the target’s range. Simultaneous estimation of range and velocity is done by using more sophisticated and costly radars, such as Frequency or Pulse Modulated Continuous Waveform radars. However, these radars suffer from other issues like waveform design, power consumption, etc., Al-Hourani et al. (2018). In this work, we address the problem of estimating a target’s range and velocity by incorporating Doppler frequency measurements from a simple continuous wave Doppler radar.
Bearings-only target motion analysis (BOTMA) is a well-studied problem (Jauffret and Pillon, 1989; Nardone and Aidala, 1981; Jauffret and Pérez, 2018; Arulampalam et al., 2020). The convergence and observability conditions associated with bearings-only measurements are well-known (Arulampalam et al., 2020; Do˘gançay, 2015). However, contrary to the simplicity of the Doppler radars, Doppler frequency-only target tracking (FOTMA) (Jauffret and Pérez, 2018) is a complex problem, where observability of target’s range and velocity is not fully understood. Several intrinsic research issues in FOTMA must be addressed before this technology can be used as a position and velocity estimator on drones, robots, and other machines.
The goal of this paper is to estimate target’s motion using Doppler measurements from a continuous wave Doppler radar. We discuss the necessary and sufficient conditions required for convergence of target’s range estimation to a unique tracking solution. The main contributions of this paper are: (i) to use the simple Continuous Wave Doppler radars to obtain range and absolute velocity information of targets, (ii) designing simple motion patterns feasible for drones and robots that guarantees the convergence of recursive Kalman filter-based methods to a unique solution, (iii) analyzing and comparing the performance of non-linear Kalman filter based methods for our problem settings. Unlike bearings-only solutions, which takes tens of seconds (Arulampalam et al., 2020; Jauffret et al., 2017), our approach of incorporating Doppler measurements converges within fraction of a second. Performance of the trackers is compared on the basis of Root Mean Square Error (RMSE), number of divergent tracks in 1,000 Monte-Carlos (MC) runs, and time required to converge to the final solution.
The paper is organized as follows: in the second section, we review the associated literature. In the third section, we design the problem as state-space model, discuss observability conditions, and its requirements. We also present the non-linear Kalman filter methods required to update the model as new measurements arrive and for convergence to a unique localization solution. We design and experiment with different simulation scenarios to compare the localization performance of three Kalman approximate filter under different measurement sets. Conclusions and discussion follow in the last section.
Literature review
Passive target tracking and localization using radars is a widely studied estimation problem, commonly known as Target Motion Analysis (TMA) (Jauffret and Pillon, 1989; Nardone and Aidala, 1981; Jauffret and Pérez, 2018; Arulampalam et al., 1981; Kumar et al., 2021). For example, in avionics for tracking planes and missiles (Hügler et al., 2018; Walker et al., 2019), in robotics and machine vision for tracking people (Piriyajitakonkij et al., 2020) and objects of interest (Skaria et al., 2020), in underwater environments for tracking submarines and sea fauna (Luo et al., 2018), etc. With advancements in machine learning and availability of powerful computers, researchers have approached this problem using deep learning methods (Liu et al., 2020; Skaria et al., 2019) as well. However, in case of drones, we have strict weight and power limitations, that restricts the use the computationally expensive deep learning methods or computer vision-based solutions in current problem’s framework.
A main requirement of the tracking algorithm is to guarantee the uniqueness of the solution (Arulampalam et al., 2020). Traditional radar-based target tracking methods consider a single observer that monitors the movements of a target by taking measurements and subsequently estimating its position and velocity. Depending upon the nature of target’s dynamics and resulting measurements, the system could be linear or non-linear (Li and Jilkov, 2003). A given dynamic system is considered observable (Jauffret et al., 2017; Pillon et al., 2016) if its state can be uniquely determined from its model, inputs, and outputs. In practice, precise knowledge of such conditions is required under which a unique solution could be guaranteed.
For analysis with bearings-only measurements, one of the widely used methods is to transform non-linear measurements into a linear form. Then we can use theorems from linear systems’ theory for observability analysis (Nardone and Aidala, 1981; Hammel and Aidala, 1985). However, this approach led to complicated non-linear differential equations that require tedious mathematics to obtain a solution. Moreover, results obtained from this technique are also quite cumbersome to be interpreted for real life. An elegant approach proposed by (Fogel and Gavish, 1998; Becker, 1993) avoids analyzing the observability matrix altogether. It develops the uniqueness criterion for two-dimensional first-order (Payne, 1989), three-dimensional second-order (Jauffret and Pillon, 1989) and general three-dimensional Nth order target dynamics case by using simple linear system theory approach and geometric analysis.
When only frequency measurements are available, to the best of our knowledge, no one has yet been able to recast them into linear form (Becker, 1993). For a constant velocity model and a specific scenario (Shensa, 1981), derived observability conditions for Doppler frequency-only tracking. Although it provides useful geometrical insights when the solution is unique, up to a rotation and reflection in the observer’s coordinate system, results, and discussions are only limited to a fixed velocity target.
For combined set of bearings and frequency measurements, non-linear equations can be recast into linear form, leading to necessary and sufficient observability conditions for two-dimensional first-order dynamics case (Passerieux et al., 1988) and Nth-order dynamics case (Fogel and Gavish, 1993; Becker, 1993). Researchers (Jauffret and Pillon, 1989; Jauffret and Pillon, 1996) analyzed the observability issue of BFTMA for continuous-time and in (Jauffret and Pérez, 2018); for discrete time. They developed the observability conditions by converting state estimation equations into a pseudo linear form. However, this introduced an inherent bias in the model, which they subsequently tried to remove by formulating an unbiased estimator.
Given the non-linearity and Nth order dynamics nature of our problem, we adopt the observability criterion developed in (Becker, 1993), where no restriction is imposed on observer and target’s motion. Becker (1993) first determines the set of all the trajectories compatible with the given measurements. Next necessary and sufficient observability conditions are obtained that reduces the set of possible trajectories to a unique tracking solution. The observability conditions, thus, obtained lend themselves to straightforward physical interpretations. In the next section, we design simulation scenarios, where we manoeuvre the observer according to these observability conditions and measure the estimator’s performance.
Target motion analysis
Potential targets in an indoor environment include walls, furniture, and people etc. We aim to localize and track all such indoor targets surrounding the observer. However, to keep things simple and establish a base framework, we first assume the case of a single observer and a target. We also assume that the observer can focus on the target at all times – getting its bearings and Doppler frequency measurements. To this end, consider the observer target geometry shown in Fig. 1.

Figure 1:
Observer and target’s geometry for observability analysis.
An observer moving along trajectory takes the bearing and frequency measurements of a target T moving along a trajectory and emitting a signal of frequency fo. We can obtain the following relation from the geometry in Fig. 1.(1)
We have simulated continuous wave Doppler radar operating at 24 GHz, with one transmitting and one receiving array. The receiver produces the I and Q components of the beat signal using sampling frequency of fs = 8000 Hz. Moreover, we simulated a narrow beam with width and elevation of . We consider three measurement sets, namely, bearings-only, frequency-only, and bearing-frequency measurements together. The bearings and Doppler frequency measurements satisfy following relationships (Skolnik, 2001),(2)(3)
wherer-x and are X and Y components of ,
is the radial velocity vector,
is signal’s wavelength, and
is Doppler frequency.
CASE-1: manoeuvring observer
In this scenario, we consider a dynamic observer that moves around in a room and tries to estimate the range of a point-like target located at and using bearing and frequency measurements. The target-observer geometry for this scenario is shown in Fig. 2.

Figure 2:
Simulation scenario of a stationary target at (5,5) and moving observer (blue track).
The observer starts at coordinates , y = 1m moves with velocity 10 km/h (2.8 m/s) and exhibits 90° maneuvers from time to time (Arulampalam, 2000), as follows,
From 90° to 0° at time t = (20 + 200k) Tsec, k = [0, 1, 2, …]
From 0° to 90° at time t = (100 + 200k) Tsec, k = [0, 1, 2, …]
Let and denote target’s and observer’s state at time instant k. Position and velocity components in and are arranged as,(4)
For constant velocity scenario, observer’s dynamics can be modeled as a Constant Velocity Model (Li and Jilkov, 2003; Bar-Shalom and Li, 2001). It assumes that the target moves with constant velocity where small perturbations are modeled as independent acceleration noise. It is given as,(5)
where F is state transition matrix defined as,(6)U[k] is the deterministic input vector, which accounts for the effect of observer accelerations. U[k] is deterministic since we assume that we have the knowledge of observer state at every instant of time. The Gain matrix G is(7)
v(k) is zero-mean white Gaussian noise process with variance . The covariance of noise process multiplied by gain G is given as,(8)(9)(10)We can now introduce the relative state vector as,(11)
The corresponding state equation for relative state vector is,(12)
Measurement vector is related to state through non-linear function as,(13)
where is 0 mean white Gaussian observation noise with variance σW .h(.) is a non-linear function of the state, whose value depends on the measurements being considered.For bearings only measurements, angle is measured counter-clockwise from positive X-axis.(14)
For Doppler or relative velocity only measurements,(15)
For bearings and velocity measurements together,
Covariance matrix of measurement noise is given by σ2wI, where I is the identity matrix whose size depends upon and is standard deviation of the measurement noise.
According to the observability criterion developed in Becker (1993), depending upon the measurements, target’s state is observable when following conditions are met:
Bearings-only Measurements: LOS angle must not remain constant.
Doppler-only measurements: LOS angle must not be constant and observer’s dynamics must be at least two degrees higher than target’s motion.
Bearing and Doppler Measurements: LOS angle must not remain constant
The optimal Bayesian solution to this problem requires computing the posterior density . However, this is not possible because measurements’ Equation (13) is non-linear. Therefore, we have to suffice for suboptimal solutions and use the methods developed for non-linear systems. Extended Kalman Filter (EKF) (Kalman and Bucy, 1961; Ristic et al., 2004) has been everybody’s go-to option for non-linear systems. It works by linearizing the non-linear state space equations using first-order truncation of Taylor series. However, this approximation is only useful if second and higher order derivatives are effectively 0 (Julier and Uhlmann, 2004). Otherwise resulting statistics which are linearly calculated are inaccurate. Another major drawback with EKF is that during linearization process, it fails to take into account that X is a random variable. It ignores the probabilistic spread of X modeled as covariance , and linearizes it around a single point. This introduces large errors in later stages and affects the consistency of the filter. Posterior mean and covariance calculated do not represent the actual scenario and, more than often, filter ends up diverging.
To overcome these and other shortcomings of EKF, researchers have developed numerous approximations of Kalman filter for non-linear systems. These algorithms are closely related as how they handle multi-modal integrals in Bayes formula. Instead of linearizing the non-linear equations, these algorithms depend upon deterministic sampling methods for the propagation of Gaussian random variables through non-linear systems. Unscented Kalman Filter (UKF) (Julier and Uhlmann, 2004) uses scaled unscented transformation to compute the points that can capture the current statistics of Gaussian Random Variables. Then it uses these points through the non-linear systems, thus avoiding the requirement of Taylor Series truncation. In more recent developments, Cubature Kalman Filter (CKF) (Arasaratnam and Haykin, 2009) was introduced as a more robust and stable version to handle the multi-model Bayes integrals. Underlying idea is same as that of Unscented Kalman Filter; however, it uses Cubature rules to handle the integrals.
In this work, we implemented and compared the performance of Extended Kalman Filter (EKF), Unscented Kalman Filter (UKF), and Cubature Kalman Filter (CKF). Performance comparisons are based on a set of 1,000 Monte-Carlo (MC) runs (Ristic et al., 2004). The performance metrics used in our analysis are Root-Mean-Square (RMS) error and number of divergent tracks in 1000 MC runs. RMSE is calculated as follows,
A track is classified as divergent if at any time, the estimated position error of the target exceeds a preset threshold. This threshold is set depending upon the geometry of the problem at hand, which in this case is set at 20 m. RMS position error is only computed for non-divergent tracks. Considering the geometry of our scenario and constraints of observer and target dynamics, all filters are initialized with an initial range of 5 m. Standard deviations of range and velocity are chosen to be and . Standard deviation for process noise is , whereas, for bearing and Doppler measurements it is chosen to be , and , respectively.
Results and discussions
Fig. 3 shows the tracking results for the three non-linear target trackers, namely, bearings-only, Doppler frequency-only, and bearing-Doppler trackers. Each run simulates 2.5 s of the scenario, allowing the observer to finish about six maneuvers. Table 1 shows the position and velocity RMSE for the three filters.
Table 1.
Comparing performance of non-linear Kalman Filters for abruptly manoeuvring observers.
| Position RMSE (m) | Velocity RMSE (m/s) | |||||
|---|---|---|---|---|---|---|
| Measurements set | EKF | UKF | CKF | EKF | UKF | CKF |
| Bearings-only | 1.14 | 0.11 | 0.24 | 1.25 | 0.83 | 0.45 |
| Doppler frequency-only | 0.94 | 0.63 | 0.61 | 1.23 | 0.38 | 0.49 |
| Bearings-frequency measurements | 0.52 | 0.01 | 0.01 | 0.91 | 0.62 | 0.26 |
| Position RMSE (m) | Velocity RMSE (m/s) | |||||
|---|---|---|---|---|---|---|
| Measurements set | EKF | UKF | CKF | EKF | UKF | CKF |
| Bearings-only | 2.2 | 0.4 | 0.5 | 1.6 | 0.4 | 0.5 |
| Doppler frequency-only | 2.7 | 0.5 | 0.7 | 3.3 | 0.3 | 0.5 |
| Bearings-frequency measurements | 0.7 | 0.1 | 0.1 | 0.4 | 0.2 | 0.2 |


