The present disclosure generally relates to opportunistic navigation and to differential and non-differential frameworks for navigation with cellular signals, including sub-meter accurate navigation.
There is a need for a resilient, accurate, and tamper-proof navigation system for use by Unmanned Aerial Vehicles (UAVs). Current UAV navigation systems will not meet these stringent demands as they are dependent on global navigation satellite system (GNSS) signals, which are jammable, spoofable, and may not be usable in certain environments (e.g., indoors and deep urban canyons). One challenge that arises in cellular-based navigation is the unknown states of cellular base transceiver stations (BTSs), namely their position and clock errors (bias and drift). This is in sharp contrast to GNSS-based navigation where the states of the satellites are transmitted to the receiver in the navigation message. Conventional approaches can utilize devices that have knowledge of states (e.g., by having access to GNSS signals), while estimating the states of BTSs, and sharing BTS data. Another framework uses positions mapped prior to navigation. However, this approach does not provide accurate operation.
There also exists a desire for submeter-level (centimeter to decimeter) navigation. Convectional approaches have difficulty resolving determinations. These methods may rely multiple-frequency measurements, rely on the GNSS satellite geometry, or rely on dedicated ground-based GPS integrity beacons. These approaches however may not provide reliable resolution of ambiguities and may not guarantee navigation performance requirements.
There is a desire for use of communications signals, such as cellular communication signals to allow for navigation and sub-meter accurate navigation operations.
Disclosed and described herein are systems, methods and configurations for controlling navigation using cellular communication signals. In one embodiment, a method includes receiving, by a device, a cellular communication signal including a synchronization element, and determining, by the device, a position estimate for the device using the cellular communication signal. Determining the position estimate includes determining a coarse estimate of device position based on a carrier phase determination using the synchronization element of the cellular communication element, and refining the coarse estimate of device position using a framework to determine the position estimate wherein a weighted nonlinear least squares estimator is applied to a model of device position for a plurality of time intervals. The method also includes controlling, by the device, navigation using the position estimate.
In one embodiment, the communication signal is at least one of a code division multiple access (CDMA) cellular communication signal including a pseudo random noise sequence (PRN) as the synchronization element and a long term evolution (LTE) cellular communication signal including a primary synchronization signal (PSS) or secondary synchronization signal (SSS) as the synchronization element.
In one embodiment, an extended Kalman filter (EKF) operation is performed by the device on the received communication signal to obtain the coarse estimate of device position and by using a vector model of device position and a known position reference.
In one embodiment, refining the coarse estimate includes a double differencing operation to obtain a batch solution to fix at least one integer ambiguity.
In one embodiment, the framework to determine the position estimate is a differential framework that includes using a base station position and a base station carrier phase measurement received from a base station.
In one embodiment, the differential framework determines the position estimate using a batch weighted non-linear least squares estimator to estimate position based on estimated integer ambiguities for a plurality of time intervals.
In one embodiment, the batch weighted non-linear least squares estimator uses a collection of carrier phase measurements from a plurality of time steps, and wherein the batch weighted non-linear least squares estimator is initialized with the coarse estimate of device position.
In one embodiment, an upper bound of position error is determined and utilized by the device to determine the position estimate.
In one embodiment, the framework to determine the position estimate is a non-differential framework that includes using a known position of the device and weighted non-linear least squares estimator to estimate position based on clock cluster biases.
In one embodiment, navigation using the position estimate and at least one of a differential and non-differential framework to determine device position for a plurality of time intervals.
According to another embodiment, a device is provided for controlling navigation using cellular communication signals. The device includes a receiver configured to receive a cellular communication signal, and a controller coupled to the receiver. The controller is configured to receive a cellular communication signal including a synchronization element, and determine a position estimate for the device using the cellular communication signal. Determining the position estimate includes determining a coarse estimate of device position based on a carrier phase determination using the synchronization element of the cellular communication element, and refining the coarse estimate of device position using a framework to determine the position estimate wherein a weighted nonlinear least squares estimator is applied to a model of device position for a plurality of time intervals. The controller also controls navigation using the position estimate.
Other aspects, features, and techniques will be apparent to one skilled in the relevant art in view of the following detailed description of the embodiments.
The features, objects, and advantages of the present disclosure will become more apparent from the detailed description set forth below when taken in conjunction with the drawings in which like reference characters identify correspondingly throughout and wherein:
Embodiments of the disclosure are directed to navigation using communication signals, and in particular, cellular communication signals. In one embodiment, processes and configurations are provided to use signal parameters and signal structures to allow a device, such as an unmanned aerial vehicle (UAV), to navigate without the use of global positioning data sources. Processes and configurations are also provided to leverage one or more communication signal features and to improve the processing of communication signals. According to one embodiment, processes and configurations are provided to determine a position estimate for the device using at least one of a differential and non-differential frameworks, and to control navigation of a device, such as an unmanned aerial vehicle (UAV), using the position estimate. Device configurations and processes described herein may employ a framework for utilization of
Embodiments describe use of communication signals, such as cellular communication signals. It should be appreciated that operations and frameworks may be applied to signals of opportunity and allow for use with one more wireless communication formats. As such, downlink transmissions may be decoded to determine observables and as an aid in navigation.
Cellular signals, particularly 3G code-division multiple access (CDMA), 4G long-term evolution (LTE), and 5G new radio (NR), are among the most attractive SOP candidates for navigation. These signals are abundant, received at a much higher power than GNSS signals, offer a favorable horizontal geometry, and are free to use. Moreover, high-precision measurements can be obtained when using carrier phase measurements instead of code phase measurements. While meter-level accuracy is achievable with pseudorange measurements, submeter-level (centimeter to decimeter) is achievable in carrier phase differential GNSS (CD-GNSS), also known as real-time kinematic (RTK).
There are several challenges associated with navigation with SOPs, and with carrier phase measurements from cellular signals in particular: (i) the SOP states (position and clocks) are unknown, (ii) in a differential framework, carrier phase ambiguities must be resolved, which in turn induces errors, and (iii) in a non-differential framework, even if the SOP position is known, the clock biases must be continuously estimated, making the system under-determined.
Embodiments of the disclosure present a complete methodology for submeter-accurate UAV navigation using cellular carrier phase measurements. A differential and a non-differential framework are proposed. The differential framework requires a base receiver making carrier phase measurements to the same BTSs as the navigating UAV and assumes a communication channel between the base and UAV receivers. A non-differential, single UAV framework is also proposed in case carrier phase differential (CD)-cellular measurements are unavailable (e.g., communication channel is lost or the base is compromised).
The resulting navigation accuracy from using these frameworks is unprecedented at the submeter-level. This will allow UAVs to navigate safely in GNSS-challenged environments (e.g., urban canyons), which can open up a wide range of applications in such environments, such as package delivery and search and rescue
One embodiment is directed to a device structure and receiver processes. The device may be configured to observables from at least one base transceiver station. System configurations may employ one or more devices to perform receiver operations described herein.
Embodiments described herein provide processes and device configurations for submeter accurate UAV navigation using cellular carrier phase measurements. Embodiments are provided and described herein for differential and a non-differential frameworks. According to embodiments, a differential framework requires a base receiver making carrier phase measurements to the same BTSs as the navigating UAV and assumes a communication channel between the base and UAV receivers. According to embodiments, a non-differential framework can include a single UAV framework is also proposed in case CD-cellular measurements are unavailable (e.g., communication channel is lost or the base is compromised). The non-differential framework does not require a base receiver, it can operate on the assumption that the navigating UAV has knowledge of its position for an initial period of time, e.g., from GNSS or from the CD-cellular framework before loss of communication with the base. In contrast to other non-differential frameworks, embodiments improve upon reliability and provide submeter-accurate UAV navigation.
According to embodiments, processes and configurations described herein can employ a three-stage framework for navigating with CD cellular measurements. A first stage can employ an extended Kalman filter (EKF) to obtain a coarse estimate of a UAV position. In the second stage, a batch solution is obtained to fix the integer ambiguities. In the third stage, the UAV navigates with the CD-cellular measurements and fixed ambiguities.
According to embodiments, processes and configurations improve navigation by determining an upper bound on the position error after resolving the integer ambiguities is established. The upper bound can capture mainly the effect of the integer ambiguity error on the UAV position error. Models of the BTS positions from stochastic geometry are leveraged to determine the upper bound that holds with a desired probability, given the number of BTSs. According to embodiments, upper bound determinations are derived to formulate a test that determines when to solve the batch estimator and fix the integer ambiguities in order to guarantee that the UAV position remains under a pre-defined threshold, with a certain probability.
Experimental results are described demonstrating operation of CD-cellular frameworks and non-differential, single-UAV framework. The experiments show UAVs navigating at submeter-level accuracy with the proposed frameworks. In the CD-cellular framework, the UAV achieves a position root mean-squared error (RMSE) of 63.06 cm over a UAV trajectory of 1.72 km. In the non-differential, single UAV framework, two experiments performed at different times are presented, showing one UAV achieving a position RMSE of 36.61 cm over a trajectory of 1.72 km while the other showing a position RMSE of 88.58 cm over a trajectory of 3.07 km.
According to embodiments, a first framework relies on a base receiver sharing carrier phase measurements with a navigating UAV. The framework is designed to guarantee that after some time, the UAV's position error remains below a pre-defined threshold with a desired probability. For the differential framework, an upper bound on the position error after resolving the integer ambiguities is established. The derived upper bound is used to formulate a test that determines when to solve the batch estimator and fix the integer ambiguities in order to guarantee that the UAV position error remains under a pre-defined threshold, with a certain probability. This is not guaranteed in other existing methods.
According to other embodiments, a second framework leverages the relative stability of cellular base transceiver station (BTS) clocks, which alleviates the need for the base receiver. For the non-differential framework, the carrier phase measurement model is modified to achieve submeter accuracy without the need of a base. This brings the navigation error down an order of magnitude from the state-of-the-art in cellular-based navigation.
Extensive experimental results are presented demonstrating unprecedented accuracies with the CD-cellular frameworks and a single-UAV framework. It is shown through experimental data that the beat frequency stability of cellular BTSs approaches that of atomic standards, which could be exploited for precise navigation with cellular carrier phase measurements. Embodiments may be applied to autonomous systems including but not limited to precise UAV navigation systems with cellular signals is developed as a complement or alternative to GNSS, especially in GNSS-challenged environments.
The experiments show UAVs navigating at submeter-level accuracy with the proposed frameworks. In the CD-cellular framework, the UAV achieves a position root mean-squared error (RMSE) of 63.06 cm over a UAV trajectory of 1.72 km. In the non-differential, single UAV framework, two experiments performed at different times are presented, showing one UAV achieving a position RMSE of 36.61 cm over a trajectory of 1.72 km while the other showing a position RMSE of 88.58 cm over a trajectory of 3.07 km.
As used herein, the terms “a” or “an” shall mean one or more than one. The term “plurality” shall mean two or more than two. The term “another” is defined as a second or more. The terms “including” and/or “having” are open ended (e.g., comprising). The term “or” as used herein is to be interpreted as inclusive or meaning any one or any combination. Therefore, “A, B or C” means “any of the following: A; B; C; A and B; A and C; B and C; A, B and C”. An exception to this definition will occur only when a combination of elements, functions, steps or acts are in some way inherently mutually exclusive.
Reference throughout this document to “one embodiment,” “certain embodiments,” “an embodiment,” or similar term means that a particular feature, structure, or characteristic described in connection with the embodiment is included in at least one embodiment. Thus, the appearances of such phrases in various places throughout this specification are not necessarily all referring to the same embodiment. Furthermore, the particular features, structures, or characteristics may be combined in any suitable manner on one or more embodiments without limitation.
According to embodiments, receiver 105 may be a device configured to utilize one or more frameworks described herein. Receiver 105 may be configured to utilize processes described herein, such as process 200 of
As used herein, a differential framework can include a base receiver, such as base station 111, sharing carrier phase measurements with a navigating UAV, such as receiver 105. A differential framework as described herein can guarantee that after some time, the UAV's position error remains below a pre-defined threshold with a desired probability. Experimental results are presented showing that this framework can achieve a 63.06 cm position root mean-squared error (RMSE) over a UAV trajectory of 1.72 km. Non-differential frameworks as described herein can leverage relative stability of cellular base transceiver station (BTS) clocks, which alleviates the need for a base receiver. Experimental data is described herein that the beat frequency stability of cellular BTSs approaches that of atomic standards, which could be exploited for precise navigation with cellular carrier phase measurements. Results are provided for experiments showing a single UAV navigating with submeter level accuracy for more than 5 minutes, with one experiment showing 36.61 cm position RMSE over a UAV trajectory of 1.72 km and another showing 88.58 cm position RMSE over a UAV trajectory of 3.07 km.
Configurations of
The PSS, SSS, and CRS may be exploited to draw carrier phase and pseudorange measurements on neighboring eNodeBs. In this disclosure, availability of code phase and Doppler frequency measurements of cellular CDMA and LTE signals is assumed (e.g., from navigation receivers. The continuous-time carrier phase observable can be obtained by integrating the Doppler measurement over time. The carrier phase (expressed in cycles) made by the i-th receiver on the n-th SOP is given by
ϕn(i)(t)=ϕn(i)(t0)+∫t
where fD
where tk
t0+kT. In what follows, the time argument tk will be replaced by k for simplicity of notation. Note that the receiver will make noisy carrier phase measurements. Adding measurement noise to (2) and expressing the carrier phase observable in meters yields
where λ is the wavelength of the carrier signal and vn(i)(k) is the measurement noise, which is modeled as a discrete-time zero-mean white Gaussian sequence with variance ┌σn(i)(k)┐2, which can be shown for a coherent second-order phase lock loop (PLL) to be given by
where Bi,PLL is the receiver's PLL noise equivalent bandwidth and C/N0,n(k) is the cellular SOP's measured carrier-to noise ratio at time-step k. Note that a coherent PLL may be employed in CDMA and LTE navigation receivers since the cellular synchronization and reference signals do not carry any data. The carrier phase in (3) can be parameterized in terms of the receiver and cellular SOP states as
zn(i)(k)=∥rr
where rr[xr
ri]T is the receiver's position vector; rs
[xssn]T is the cellular BTS's position vector; c is the speed of light; δtri and δtsn are the receiver's and cellular BTS's clock biases, respectively; and Nn(i) is the carrier phase ambiguity. Note that the difference between the UAV's altitude and the cellular BTSs' altitudes is typically negligible compared to the range between the UAV and the BTSs. Therefore, one may estimate the UAV's two-dimensional (2-D) position only, without introducing significant errors. The subsequent analysis may be readily extended to 3-D; however, the vertical position estimate will suffer from large uncertainties due to the poor vertical diversity of cellular SOPs. If the UAV's altitude estimate is explicitly desired, an altimeter can be readily used. As such, the proposed frameworks will consider the 2-D case
According to embodiments, frameworks for CD-cellular navigation can include at least two receivers in an environment having N cellular BTSs. The receivers may be assumed to be listening to the same BTSs, with the BTS locations being known. Referring to
Process 200 may be initiated by a device (e.g., receiver 105, rover 151) receiving at least one communication signal at block 205. Communication signals, such as cellular communication signals, may be received from one or more base transceivers by a device. According to embodiments, the device is not required to be registered with a communication network. Embodiments provide operations that may be executed by a device to detect signals of opportunity and process one or more elements of the signal, such as a synchronization element to determine one or more observables. According to embodiments, one or more types of cellular communication signals may be employed/detected by process 200 including but not limited to one of a code division multiple access (CDMA) cellular communication signal including a pseudo random noise sequence (PRN) as the synchronization element and a long term evolution (LTE) cellular communication signal including a primary synchronization signal (PSS) or secondary synchronization signal (SSS) as the synchronization element. As used herein, synchronization elements of a detected cellular communication signal may be one or more repeating elements and/or characteristics of a communication format that may be leveraged to assess carrier phase. Embodiments provide a communication signal model and framework for determining one or more observables such as carrier phase.
At block 210, the device can determine a position estimate based on the communication signal. According to embodiments, determining the position estimate at block 210 includes determining a coarse estimate of device position based on a carrier phase determination using the synchronization element of the cellular communication element, and refining the coarse estimate of device position using a framework to determine the position estimate. An extended Kalman filter (EKF) operation may be performed by the device on the received communication signal to obtain the coarse estimate of device position and by using a vector model of device position and a known position reference.
a navigation solution when a base transmitter is not available to provide observables.
Block 210 may include one or more operations to allow for use and processing of communication signal data. According to embodiments, a position determination at block 210 may be a coarse position determined using an extended Kalman filter (EKF) operation. The position estimate may be determined a coarse estimate of device position based on a carrier phase determination using the synchronization element of the cellular communication element. Block 210 may also include refining the coarse estimate of device position using a framework to determine the position estimate wherein a weighted nonlinear least squares estimator is applied to a model of device position for a plurality of time intervals. As discussed below, a batch solution may be determined obtained to fix at least one integer ambiguity.
According to embodiments, a differential framework is used to determine position of the device. As such, refining the coarse estimate includes a double differencing operation to obtain a batch solution to fix at least one integer ambiguity. The differential framework can determine position estimates using a base station position and a base station carrier phase measurement received from a base station (e.g., measurements and data from another deice receiving communications signals from the same base transceiver station). Accordingly, process 200 may optionally include receiving base data at block 220. Base data 220 may include data from a base receiver to be used in a differential framework. Base data 200 may be optional in embodiments as process 200 may operate in a non-differential framework. The differential framework determines the position estimate using a batch weighted non-linear least squares estimator to estimate position based on estimated integer ambiguities for a plurality of time intervals. According to embodiments, the batch weighted non-linear least squares (BWNLS) estimator uses a collection of carrier phase measurements from a plurality of time steps, and wherein the batch weighted non-linear least squares estimator is initialized with the coarse estimate of device position. In one embodiment, an upper bound of position error is determined in process 200 and utilized by the device to determine the position estimate.
According to other embodiments, a non-differential framework is used to determine position of the device. As discussed herein, a non-differential framework may provide a solution for determining observables when an initial position of a device is known. In additional, base data observables from block 220 may not be required in a non-differential framework. In one embodiment, the framework to determine the position estimate is a non-differential framework that includes using a known position of the device and weighted non-linear least squares estimator to estimate position based on clock cluster biases.
At block 215, the device may control navigation based on a determined position and/or position estimates. navigation using the position estimate and at least one of a differential and non-differential framework to determine device position for a plurality of time intervals. Navigation at block 215 may be in the absence and/or without the needs of a global positioning receiver. In addition, navigation at block may be based on one or more determined position estimates at block 210 for one or more time intervals.
Controller 305 may relate to a processor or control device configured to execute one or more operations stored in memory 310, such as determination of a position estimate, extended Kalman Filtering, and resolution of integer ambiguities. Controller 305 may be coupled to memory 315 and communications module 310. Communications module 310 may be configured to receive one or more communication signals from one or more base stations. Communications module 310 may also be configured to receiver observables from one or more base transmitters. In certain embodiments communications module 310 may be configured to include one or more software defined radio elements to acquire and track transmitted signals. Position determinations and/or observables may be used to output navigation commands or operate device 300 by way of optional input/output module 320. Device 300 and controller 305 may be configured to perform one or more operations described herein including processes 200 of
Navigation by embodiments may include estimation of rover position. According to embodiments, position estimation may be performed by double-differencing measurements using determinations for a rover and using measurements received from a base station. Frameworks as described herein may use a carrier phase differential (CD)-cellular measurement model for received signals. Navigation embodiments can estimate a rover's position by double-differencing the carrier phase measurements, and for example, carrier phase measurements described in equation (5). By way of example, measurements to a first SOP be taken as references to form the single difference zn,1(i)(k)
zn(i)(k)−z1(i)(k), for n=2, . . . , N. Subsequently, the double difference between U (e.g., rover) and B (e.g., base station) may be defined as
zn,1(U,B)(k)zn,1(U)(k)−zn,1(B)(k) +∥rr
hn,1(U)(k)+λNn,1(U,B)+vn,1(U,B)(k), (6)
where n=2, .. . , N, hn,1(U)(k)
∥rru(k)−rs
Nn(u)−Nn(B)−N1(U)+N1(B), and vn,1(U,B)(k)
vn(U)(k)−vn(B)(k)−v1(U)(k)+v1(B)(k).
In vector form the measurement model (6) becomes
zU,B(k)h[rru(k)]+λN+vU,B(k), (7)
where
R(1)(k)diag [[σ2(b)(k)]2+[σ2(U)(k)]2, . . . , [σN(B)(k)]2+[σN(U)(k)]2],
and Ξ is a matrix of ones. Note that the vector N is now a vector of N−1 integers and has to be solved for along with the rover UAV's position rrU. The next subsections present a framework to obtain a navigation solution with CD-cellular measurements.
According to embodiments, a navigation strategy is employed by the UAV. To this end, assume CD-cellular measurements are given at k=0, 1, 2. It is desired that, with probability greater than 1−a, the 2-norm of the position error be less than a desired threshold ζ for all k≥kζ. Let δrrU(k) denote the position error at time-step k. Then, it is desired that
Pr[∥δrru(k)∥2≤ζ2]≥1−1,∀k≥kζ. (8)
For k<kζ, the UAV will use an EKF to produce a “rough” estimate of its position and the integer ambiguities. Measurements at k=0 and k=1 are used to initialize the EKF. Then, at k=kζ, a batch weighted nonlinear least squares (B-WNLS) estimator for all measurements from k=0 to kζ is used to obtain an estimate of the integer ambiguities that guarantees (8) for k≥kζ. The EKF solution is used to initialize the B-WNLS. For k>kζ, the UAV will solve for its position using zU,B(k) and the estimated ambiguities through a point solution weighted nonlinear least-squares (PSWNLS). The time-step kζ is determined on-the-fly by the UAV via the test developed in the remaining of this section.
The EKF model may be initialized by defining the vector
as the state vector to be estimated by the EKF, where {dot over (r)}rUT is the 2-D velocity vector of the UAV. The UAV's position and velocity states are assumed to evolve according to a velocity random walk model. Note that only the float solution of N is estimated in the EKF, i.e., the integer constraint is relaxed. The EKF will produce an estimate {circumflex over (x)}EKF(k|j), i.e., an estimate of xEKF(k) using all measurements zU,B(k) up to time-step j≤k, along with an estimation error covariance PEKF(k|j)┌{circumflex over (x)}EKF(
xEKF(k)−{circumflex over (k)}(k|j) is the estimation error. The UAV's random walk dynamics and the measurement model in (7) are used to derive the EKF time-update and measurement update equations.
EKF initialization at block 405 is discussed next.
Note that the measurement zU,B
[zU,BT(0), zU,BT(1)]T may be parameterized as
where T is the sampling time and vU,B
[vU,BT(0), vU,BT(1]T is the overall initial measurement noise, which is modeled as a zero-mean Gaussian random vector with covariance Rini=diag [RU,B(0),RU,B(1)]. The measurement equation in (9) can be solved using a weighted nonlinear least-squares (WNLS) estimator to yield an estimate of xEKF(1), denoted {circumflex over (x)}EKF,ini, and an associated estimation error covariance, denoted PEKF,ini. Finally, the EKF initial estimate and estimation error covariance are initialized according to {circumflex over (x)}EKF(1|1)≡{circumflex over (x)}EKF,ini, PEKF(1|1)≡PEKF,ini.
When k=kζ, the B-WNLS estimate of the UAV's position and the integer ambiguities is computed. Define the collection of carrier phase measurements from time-step 0 to kζ as zU,Bkζ[zU,BT(0), . . . , zU,bT(kζ]T
which can be expressed as
where vU,Bkζis the overall carrier phase measurement noise with covariance RU,Bk
diag [RU,B(0), . . . , RU,B(kζ)].
Let xB-WNLSk [(rr
[({circumflex over (r)}R
Note the dependency of {circumflex over (N)}k
Next, a LAMBDA method may be used to fix the integer ambiguities from the float solution and {circumflex over (N)}k
Note that the B-WNLS solution is initialized with the EKF estimates of the UAV positions and ambiguities.
Once the integer ambiguities are determined, the carrier phase measurements at time-step k≥kζ are used to determine the point solution {circumflex over (r)}rU(k) and an associated estimation error covariance PrU(k) using a WNLS, i.e., the estimate of rrU(k) using zU,B(k) and N−
zU,B(k)h[rrU(k)]+λ
The difference between (7) and (11) is that now an estimate of N is known to the UAV, and it can therefore estimate its position vector instantaneously using zU,B(k). However, λ
Σ−1(k)[λ2PNk
In the following sections, kζ is determined to satisfy ∀k≥kζ. To this end, the position error is first upper bounded and a test on k is derived to determine when (8) will hold.
In what follows, it is assumed that the contribution of vU,B(k) to the estimation error is insignificant compared to
δrrU(k)=λ[
where
The estimation error covariance associated with the position estimate is expressed as PrU(k)=[
In what follows, the time argument will be omitted for compactness of notation. Let
denote a square root of Σ. Using the submultiplicative property of the 2-norm, it can be shown from (13) that
Using the relationship between the 2-norm, singular values, and eigenvalues of a matrix, ∥δrrU∥2 can be further bounded according to
where λmax(·) and λmin(·) denote the largest and smallest eigenvalues of a matrix, respectively. Note that
where the horizontal dilution of precision (HDOP) depends on the current geometry between the UAV and the cellular BTSs. With probability β, the HDOP is upper bounded according to Pr[HDOP≤HDOPmax]=β,
where HDOPmax can be calculated in advance from the known cellular BTS using stochastic geometry models, as discussed in the next subsection. Subsequently, max (PrU) can be bounded according to λmax(PrU)≤λ2λmax(Σ)HDOPmax2,
which in turn implies that with a probability greater than β, the following holds
In order to determine the distribution of HDOP and hence HDOPmax, stochastic geometry is used to model the relative geometry between the UAV and BTSs. Specifically, the BTS positions are modeled as a binomial point process (BPP) and the total number of hearable BTSs is assumed to be known. The BTS position distribution is parameterized by the minimum and maximum hearable distance to a BTS, denoted by dmin and dmax, respectively. However, the HDOP can be parameterized by the bearing angles only; hence, the dependency on dmin and dmax is eliminated. Then, several realizations of the BTS bearing angles are realized for a given value of N and the empirical cumulative density function (cdf) of the HDOP is characterized. Finally, the value HDOPmax is identified from the empirical cdf for a desired β.
With a probability greater than 1−p,
where γ(p)fv2 N−1−1(1−p) and fv2,M−1(·) is the inverse cdf of a chi-square distributed random variable with M degrees of freedom. By defining
the inequality in (14) may be re-written as
Note that (15) implies the inequality
Assuming that the HDOP and
Recall that (8) is desired; therefore, satisfying
λ2λmax(Σ)HDOPmax2λmax(
where
and p=1−(1−a)/γ achieves (8). Note that the inequality in (17) is in the form of a test that can be performed after each measurement is added to the batch filter.
According to embodiments, it may be easier to compute (
The base/rover framework according to embodiments may require the presence of a base and a communication channel between the base and the rover. However, if communication is lost or if the base is compromised, the navigating UAV cannot rely on CD cellular measurements anymore. This section discusses a non-differential cellular carrier phase navigation framework that is employable on a single UAV in the case that CD-cellular measurements are not available. Note that since what follows only pertains to non-differential, single-UAV navigation, the UAV index i will be dropped for simplicity of notation.
The terms
are combined into one term defined as
Cellular BTSs possess tighter carrier frequency synchronization then time (code phase) synchronization (the code phase synchronization requirement as per the cellular protocol is to be within 3 μs). Therefore, the resulting clock biases in the carrier phase estimates will be very similar, up to an initial bias, as shown in
Carrier Phase Measurement Re-Parametrization
Embodiments also provide for re-parametrization of
cδtn(k)cδtn(k)-cδtn(0)≡cδt(k)+cn(k), (18)
where cδt is a time-varying common bias term and cn is the deviation of cδtn(k)-cδtn from this common bias and is treated as measurement noise. Using (18), the carrier phase measurement (5) can be re-parameterized as
zn(k)=∥rr(k)-rs
where cδt0
cδtn(0) aηn(k)
cn(k)+vn(k) is the overall measurement noise. Note that cδt0
It is proposed that instead of lumping all N clock biases into one bias cδt to be estimated, several clusters of clocks get formed, each of size
where L is the total number of clusters), and the clocks in each cluster are lumped into one bias cδti to be estimated. This gives finer granularity for the parametrization (18), since naturally, certain groups of cellular SOPs will be more synchronized with each other than with other groups (e.g., corresponding to the same network provider, transmission protocol, etc.). An illustrative experimental plot is shown in
Without loss of generality, it assumed that the carrier phase measurements have been ordered such that the first N1 measurements were grouped into the first cluster, the second N2 measurements were grouped into the second cluster, and so on. Next, obtaining the navigation solution with a WNLS is discussed.
Given N≥3 pseudoranges modeled according to (19) and L≤N−2 SOP clusters, the receiver may solve for its current position rr and the current set of common biases
cδt
cδt1, . . . , cδtLT using a WNLS estimator. The state to be estimated is defined by x
[rrT,cδtT]T. An estimate {circumflex over (x)} may be obtained using the iterated WNLS equations given by
{circumflex over (x)}(i+1)(k)={circumflex over (x)}i)(k)+(HTRη−1H)−1HTRη−1δz(k), (20)
where
where δz(k)[δz1(k), . . . , δzN(k)]T and
is the measurement noise covariance where σc
After convergence
the final estimate is obtained by setting {circumflex over (x)}(k)≡{circumflex over (x)}i+1)(k). In the rest of the disclosure, it is assumed that H is always full column rank.
Note that the clock bias clusters {cδtl}i=1L are “virtual clock biases”, which are introduced to group SOPs whose carrier frequency is more synchronized than others. This would in turn yield more precise measurement models, reducing the estimation error. This subsection parameterizes cδt1 as a function of cδtn. This parametrization is based on the following theorem.
Theorem IV.1. Consider N≥3 carrier phase measurements.
Assume that the contribution of the relative clock deviation cn is much larger than the carrier phase measurement noise vn and that cn are uncorrelated with identical variances σ2 Then, the position error at any time instant δr
The assumption that the contribution of the relative clock deviation cn is much larger than the carrier phase measurement noise vn comes from experimental data, where ∥δ∥ was observed to be within 0.2 and 4 m, whereas σn was on the order of a few cm. To illustrate that,
From Theorem IV.1, it can be implied that while the position error is independent of cδtt, it depends on the clustering. Following the result in (29), the following parametrization is adopted
Note that the UAV can perform an exhaustive search over the different clustering possibilities to minimize its position error while it has access to GPS. The number of possible clusters is given by
It can be seen that this number becomes impractically large as N increases. A rule-of-thumb that significantly reduces Nnum is discussed below.
Experiments for embodiments of the disclosure found that ϵn is appropriately modeled to evolve according to the autoregressive moving average (ARMA) model given by
where P and {ϕi}i=1p are the order and the coefficients of the autoregressive (AR) part, respectively; order and the coefficients of the moving average (MA) part, respectively; and wQ is a white sequence. Identifying p and q and their corresponding coefficients can be readily obtained with standard system identification techniques [70], and it was found that p=q=6 was
usually enough to whiten wϵdi n.
Therefore, ϵn will also be a Gaussian sequence. Without loss of generality, it is assumed that ϵn(i-p)=0 for i=1, . . . , p. Subsequently,
[ϵn(k)]=0. The variance of ϵn (k) is discussed next. The ARMA process in (24) may be represented in state-space according to
ξn(k+1)=Fξnξn(k)+Γξnwϵn(k) ϵn(k)=hϵ
where ξn is the underlying dynamic AR process, Fξn is its state transition matrix, Γξn is the input matrix, and hϵ
where
and the variance of the clock deviation ϵn at any given time-step is given by σϵ
Since ξn is stable, Pξn (k) will converge to a finite steady state convariance denoted Pξn88 given by the solution to the discrete-time matrix Lyapunov equation
Pξn,888=FξnPξn888FξnT+Qξn,
Subsequently, the steady-state variance of the clock deviation is given by σϵ
Clustering of the Clock Biases
It was mentioned above that an exhaustive search may be performed to cluster the clock biases cδtn in order to minimize the position estimation error. This amounts to finding the matrix Γ that minimizes
where Γ and Ψ are defined in (21) and (28), respectively. This optimization problem is non-convex and intractable. Instead of optimizing Jp(Γ), a tractable rule-of-thumb is provided next.
First, consider the modified cost function
where GrΨG. Let the singular value decomposition (svd) of Gr be Gr=UΣrVT, where U is an N×N unitary matrix, V is a 2×2 unitary matrix, and Σr=[Σ9]1, where Σ is a nonsingular 2×2 diagonal matrix containing the nonzero singular values of Gr. It can be readily shown that
(GrTGr)−1GrT=VΣ′UT, (25)
where Σ′[Σ−10]T. This implies that (25) is the svd of
and its singular values are the inverses of the singular values of Gr, yielding
where σmax (·) and σmin (·) denote the maximum and minimum singular values of a matrix, respectively. Note that the singular values of Gr are the square root of the eigenvalues of GT GrTGr=GTΨG, G=GT G, and hence
where λmax (·)and λmin (·)denote the maximum and minimum eigenvalues of a matrix, respectively. Consequently, the cost J(Γ) may be bounded by
J(Γ)≤λmax(Px,y)∥Ψϵ(k0∥2, (26)
Next, two theorems are presented that will help derive the rule-of-thumb for clustering the clock biases. Theorem IV.2. Assume a clock bias clustering with L<N−2 clusters and denote JL∥Ψϵ(k)∥2; 2. Then, there exists a clustering with L+1 clusters such that JL≥JK+1. From Theorem IV.2, it can be implied that ∥Ψϵ(k)∥2 is minimized when L=N−2, i.e., the maximum number of clusters is used. This also implies that using more SOP clusters will decrease ∥Ψϵ*k0)∥2 in the upper bound expression of J(Γ) given in (26). Theorem IV.3. Consider N≥3 carrier phase measurements for estimating the receiver's position rr and a clustering of L clock states cδt. Adding a carrier phase measurement from an additional cellular SOP while augmenting the clock state vector cδt by its corresponding additional clock state will neither change the position error nor the position error uncertainty.
From Theorem IV.3, it can be implied that it is required that Nl≥2 in order for cluster l to contribute in estimating the position state. Therefore, λmax (Px,y) can be made smaller by decreasing the number of clusters L. Combining the conclusions of Theorems IV.2 and IV.3 and referring to (26), there is a tradeoff between estimating more clock biases and uncertainty reduction: less bias for more uncertainty and vice versa. Subsequently, embodiments may operate using at least one cluster with Nt≥3 (to ensure observability) and N1≥2 for the remaining clusters. This implies that
which significantly reduces the number of possible clusters in the exhaustive search algorithm.
Experimental Results
This section presents experimental results demonstrating submeter-level UAV navigation results via the two frameworks developed in this disclosure: (1) CD-cellular with a base/rover and (2) non-differential single UAV with precise carrier phase measurements. As mentioned in above, only the 2-D positions of the UAVs are estimated as their altitudes may be obtained using other sensors (e.g., altimeter). In the following experiments, the altitudes of the UAVs were obtained from their on-board navigation systems. Moreover, the noise equivalent bandwidths of the receivers PLLs were set BU,PLL=BB,PLL=BPLL=3 to Hz in all experiments.
In this section, experimental results are presented demonstrating centimeter-level-accurate UAV navigation results using the CD-cellular framework according to embodiments of this disclosure. The measurement noise covariances were calculated according to (4). In order to demonstrate the CD-cellular framework, two Autel Robotics X-Star Premium UAVs were equipped each with an Ettus E312 universal software radio peripheral (USRP), a consumer-grade 800/1900 MHz cellular antenna, and a small consumer-grade GPS antenna to discipline the on-board oscillator. Note that one UAV acted as a base and the other as a navigating UAV. The receivers were tuned to a 882.75 MHz carrier frequency (i.e., λ=33.96 cm), which is a cellular CDMA channel allocated for the U.S. cellular provider Verizon Wireless. Samples of the received signals were stored for off-line post-processing. The cellular carrier phase measurements were given at a rate of 12.5 Hz, i.e., T=0.08 s. The ground-truth reference for each UAV trajectory was taken from its on-board integrated navigation system, which uses GPS, an inertial measurement unit (IMU), and other sensors. The navigating UAV's total traversed trajectory was 2.24 km, which was completed in 4 minutes. Over the course of the experiment, the receivers were listening to 9 BTSs, whose positions were mapped prior to the experiment. In the experiments, the UAV was flying approximately at the same altitude as the BTS antennas. Characteristics of experimental results may provide examples of embodiments described herein.
The CD-cellular measurements were used to estimate the navigating UAV's trajectory 900 via the base/UAV framework. The experimental setup, the cellular BTS layout, and the true trajectory (from the UAV's on-board integrated navigation system) and estimated trajectory (from the proposed CD-cellular framework) of the navigating UAV are shown in
The position RMSE for each part of the trajectory are shown in Table I.
Non-Differential Single UAV Navigation Results with Precise Cellular Carrier Phase Measurements
Two experiments were conducted at different times to demonstrate the non-differential single-UAV navigation framework described above. In the first experiment, the same setup described in Subsection V-A was used, except that the rover was navigating without the base and was employing the framework described herein. In the second experiment, a DJI Matrice 600 was equipped with the same hardware described in Subsection V-A and the onboard USRP was tuned to the same carrier frequency. The cellular carrier phase measurements were also given at a rate of 37.5 Hz, i.e., T=0.0267 ms. The ground-truth reference for the UAV trajectory was taken from its on-board navigation system, which also uses GPS, an IMU, and other sensors. The experimental setup and SOP BTS layout for the second experiment are shown as 1100 in
In the first experiment, the UAV traversed a trajectory of 1.72 km, which was completed in 3 minutes. The receiver was listening to the same 9 CDMA BTSs shown in
In the second experiment, the UAV traversed a trajectory of 3.07 km completed in 325 seconds. The receiver was listening to the 7 CDMA BTSs shown in
Experimental results are summarized in Table II.
The following are takeaways and remarks from the CD-cellular and non-differential single-UAV experimental results presented above. First, it is important to note that all RMSEs were calculated with respect to the trajectory returned by the UAVs' on-board navigation system. Although these systems use multiple sensors for navigation, they are not equipped with high precision GPS receivers, e.g., RTK systems. Therefore, some errors are expected in what is considered to be “true” trajectories taken from the on-board sensors. The hovering horizontal precision of the UAVs are reported to be 2 meters for the X-Star Premium by Autel Robotics and 1.5 meters for the Matrice 600 by DJI.
Second, it can be noted that the CD-cellular with base/rover framework under-performed compared to the non-differential single-UAV framework. This can be due to: (1) poor synchronization between the base's and rover's measurements and (2) errors in the base's on-board navigation system's position estimates. It is important to note that the base was mobile during the experiment and the position returned by its on-board navigation system was used as ground-truth. Consequently, any errors in the GPS solution would have degraded the rover's estimate.
Third, the RMSEs reported in the non-differential single-UAV results are for optimal clustering. In the 10 seconds during which GPS was available, a search was performed to optimally cluster the clock biases using the rule-of-thumb. The search took less than 3 seconds in each case. The RMSEs without clustering (only one bias is estimated) are 48 cm and 97 cm for the first and second single-UAV experiments, respectively.
Fourth, the CD-cellular and non-differential single-UAV experiments showed that reliable navigation with cellular signals is possible when the proper models are used. Some of the experiments went over 5 minutes, indicating that the UAV could rely exclusively on cellular carrier phase measurements for sustained submeter-level accurate navigation.
Fifth, not only the UAV can navigate at submeter-level accuracy in the absence of GPS signals, but it can do so with performance guarantees. This is inherent to the formulation of the CD-cellular and the non-differential single-UAV frameworks.
The disclosure presents two frameworks for submeter-level accurate UAV navigation with cellular carrier phase measurements. The first framework, called CD-cellular framework, relies on a base receiver and a navigating receiver on-board a navigating UAV, also known as rover. Both receivers make carrier phase measurements to the same cellular SOPs to produce the cellular carrier phase double difference measurements, referred to as CD-cellular measurements. The main strategy behind the CD-cellular framework is to navigate in three stages. In the first stage, an EKF is employed to produce a coarse estimate of the UAV's position. In the second stage, which is determined by a test on the estimation error covariance, the UAV fixes the integer ambiguities in a batch solver. The test guarantees that the position error of the UAV will remain less than a pre-defined threshold with a desired probability after the batch solution is calculated. In the third stage, the UAV navigates with high precision with the CD-cellular measurements and fixed integer ambiguities. Experimental results demonstrated not only that the proposed framework guarantees a desired navigation performance, but it also showed a UAV navigation with 63.06 cm position RMSE over a trajectory of 1.72 km.
The second framework leverages the relative stability of cellular BTSs clocks. This stability also allows to parameterize the SOP clock biases by a common term plus some small deviations from the common term, which alleviates the need for a base. The clock deviations were subsequently modeled as a stochastic sequence using experimental data. Further analysis at those deviations revealed that they can be clustered to minimize the resulting position error. Next, performance bounds were established for this framework and a rule-of-thumb for clustering the clock deviations was established based on these bounds, which significantly reduced the complexity of the clustering step. Experimental results showed that a single UAV can navigate with submeter-level accuracy for more than 5 minutes using this framework, with one experiment showing 36.61 cm position RMSE over a trajectory of 1.72 km and another showing 88.58 cm position RMSE over a trajectory of 3.07 km.
While this disclosure has been particularly shown and described with references to exemplary embodiments thereof, it will be understood by those skilled in the art that various changes in form and details may be made therein without departing from the scope of the claimed embodiments.
This application is the National Stage entry under 35 U.S.C. § 371 of International Application No. PCT/US2022/018338, filed Mar. 1, 2022, which claims priority to U.S. provisional application No. 63/155,048 titled SYSTEMS AND METHODS FOR DIFFERENTIAL AND NON-DIFFERENTIAL NAVIGATION WITH CELLULAR SIGNALS filed on Mar. 1, 2021, the content of which is expressly incorporated by reference in its entirety.
This invention was made with Government support under Grant No. N00014-19-1-2305 awarded by the Office of Naval Research, Grant No. 1751205 awarded by the National Science Foundation, and Grant No. 69A3552047138 awarded by the Department of Transportation (USDOT) under the University Transportation Center (UTC) Program. The Government has certain rights in the invention.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/US2022/018338 | 3/1/2022 | WO |
Number | Date | Country | |
---|---|---|---|
63155048 | Mar 2021 | US |