Some existing navigation systems integrate global navigation satellite system (GNSS) with an inertial navigation system (INS). When these systems are integrated, the long-term stability of a GNSS navigation solution complements the short-term accuracy of an INS. However, if GNSS signals become unavailable, the errors of an INS diverge. What is needed is an improved integrated GNSS-INS navigation system.
Terrestrial SOPs are abundant and are available at varying geometric configurations, and may be used to improve GNSS/INS navigation. The vehicle 110 receives GNSS signals from the four GNSS satellites 120, 130, 140, and 150 and calculates pseudoranges, where the pseudoranges provide an estimated radius for the arc lengths 125, 135, 145, and 155. Similarly, vehicle 110 calculates an additional pseudorange arc 165 based on the SOP transceiver 160. The INS portion of the GNSS/INS navigation system provides inertial navigation data, such as acceleration and rotation. The GNSS data and the INS data are combined to determine an estimated position of the vehicle 110.
The SOP transceiver 160 may be used to improve navigation reliability whenever GNSS signals become inaccessible or unreliable. The navigation system described herein is significantly different from existing technologies, such as a ground based augmentation system (GBAS), which requires the deployment of proprietary infrastructure, such as pseudolite beacons. In contrast to deploying pseudolite beacons, this technology uses existing radio infrastructure. For example, the SOP transceiver 160 may be either an AM/FM radio tower, a cellular tower, a digital television tower, a Wi-Fi transceiver, or any other emitter equipped with a radio transceiver. A navigation systems could rely on SOPs to aid an INS in the absence of GNSS signals, enabling a navigation solution with bounded errors. The navigation system may include an architecture to fuse GNSS and inertial measurement unit (IMU) measurements, with loosely-coupled, tightly-coupled, and deeply-coupled estimators. Regardless of the coupling type, the errors of a GNSS-aided INS will diverge in the absence of GNSS signals, and the rate of divergence depends on the quality of the IMU. Consumer and small-size applications that use affordable micro-electro-mechanical systems (MEMS) grade IMUs are particularly susceptible to large error divergence rates. While high quality IMUs may reduce the rate of error divergence, they may violate cost, size, weight, or power constraints.
As described herein, a tightly-coupled framework that fuses IMU data with SOP pseudoranges provides improved navigation performance. In particular, the performance of the SOP-aided INS in a real-world environment is based on (1) the number of exploited SOPs and (2) the quality of the SOPs (e.g., the stability of their oscillators), and shows improved performance over traditional tightly-coupled GNSS-INS integration strategies. SOPs are transmitted at a wide range of frequencies and directions, making them an attractive supplement to GNSS signals to improve the accuracy of a navigation solution. SOPs are abundant in GNSS-challenged environments, making them particularly attractive aiding sources for an INS when GNSS signals become unreliable. However, unlike GNSS satellite vehicle states, the states of SOPs, namely their position and clock states, may not be known a priori, and must be estimated. This estimation problem is analogous to the simultaneous localization and mapping (SLAM) problem in robotics. Both problems ask if it is possible for an agent to start at an unknown location in an unknown environment and then to incrementally build a map of the environment while simultaneously localizing itself within this map. However, in contrast to the static environmental map of the typical SLAM problem, the SOP signal map is more complex, as the SOP signal map is dynamic and stochastic. Specifically, for pseudorange-only observations, one must estimate not only the position states, but also the clock states of both the receiver and the SOPs.
A mobile receiver, whether hand-held or vehicle-mounted, has access to N Global Positioning System (GPS) satellite vehicle (SV) observables, M unknown terrestrial SOPs, and IMU measurements, which are used to estimate the receiver's states, namely its position, velocity, clock bias, and clock drift, and the SOPs' states, namely their positions, clock biases, and clock drifts. When GPS pseudoranges become unavailable, the receiver continues drawing pseudorange observations from the SOP transmitters. The receiver continues navigating by fusing the SOP pseudoranges with IMU measurements through a dynamic estimator, which simultaneously maps the SOPs' states and localizes the receiver in that map. The subject matter described herein addresses uncertainty bounds of the receiver's state estimates, including (1) how the uncertainty bounds affected by varying the number of exploited SOPs, and (2) how sensitive the uncertainty bounds are to the stability of the SOPs' oscillators.
Each SOP transceiver 160 is assumed to emanate from a spatially stationary terrestrial transmitter, and its state vector will consist of its 3-dimensional (3D) position states
r
sop
[xsop,ysop,zsop]T
and clock states
x
clk,sop
c[δtsop,{grave over (δ)}tsop],
where c is the speed of light, δtsop is the clock bias, and {grave over (δ)}tsop is the clock drift. The SOP's discretized dynamics are given by xsop(k+1)=Fsopxsop(k)+wsop(k), k=1, 2, . . . , where
x
sop=[rsopT,xclk,sopT]T∈R5×1,
F
sop=diag[I3×3,Fclk],
wsop is the process noise, which is modeled as a discrete-time (DT) zero-mean white noise sequence with covariance Qsop=diag[03×3, Qclk,sop], and
where T is the constant sampling interval. The terms
are the clock bias and drift process noise power spectra, respectively, which can be related to the power-law coefficients, {hxy}a=−22, which have been shown through laboratory experiments to characterize the power spectral density of the fractional frequency deviation of an oscillator from nominal frequency according to
Each SOP transceiver 160 is assumed to emanate from a spatially stationary terrestrial transmitter, and its state vector will consist of its 3D position states
x
clk,r
c[δtr,δtr]
such that
x
r(k)=[xB(k)T,xclk,rT(k)]T∈R18.
The INS 16-state vector is
x
B(k)=[GB
where rr and vr are the three-dimensional position and velocity, respectively, of the body frame expressed in a global frame, e.g., the Earth-centered Earth-fixed (ECEF) frame; bg and ba are the gyroscope and accelerometer biases, respectively; and GB
The orientation of the INS will evolve in DT according to
G
B
B
B
G
B
,
where B
where tkkT. The vector Bω is the three dimensional rotational rate vector, whereas the matrix [Bω(t)×] is the skew symmetric matrix whose entries are the components of Bω. The velocity will evolve in time according to the integration
where Ga is the three dimensional acceleration of the IMU in the global frame. The position will evolve in time according to the integration
The evolution of bg and ba will be modeled as random walk processes, i.e.,
The receiver's clock states will evolve in time according to
where wclk is the process noise vector, which is modeled as a DT zero-mean white noise sequence with covariance Qclk,r, which is identical to Qclk,sop, except that
and
are now replaced with receiver-specific spectra,
and
respectively.
The IMU contains a triad-gyroscope and triad-accelerometer that produce measurements
modeled as
where R[
The pseudorange observation made by the receiver on the mth SOP, after discretization and mild approximations, is related to the receiver's and SOPs' states by
where vsopm is modeled as a DT zero-mean white Gaussian sequence with variance σsop2m. The pseudorange observation made by the receiver on the nth GNSS SV, after compensating for ionospheric and tropospheric delays is related to the receiver states by
are the ionospheric and tropospheric delays, respectively, z′sv
or the SLAM phase:
{circumflex over (x)}
(′)
{circumflex over (x)}′ and PPx′.
To correct INS errors using SOP pseudoranges, an extended Kalman filter (EKF) framework similar to a traditional tightly-coupled GNSS-INS integration strategy is adapted, with the added complexity that the SOPs' states, denoted {xsop
{circumflex over (x)}(k|j)E[x(k)|{z(i)}i=1j]
of x(k), and an associated estimation error covariance
P
x(k|j)E[{circumflex over (x)}(k|j){circumflex over (x)}T(k|j)]
where
x
[xrT,xsop
z
sv=[zsv
k>=j, and j is the last time step an INS-aiding source was available. The EKF error state is defined as
{circumflex over (x)}
[{circumflex over (x)}BT{circumflex over (x)}clk,rT,{circumflex over (r)}sop
where
{circumflex over (x)}
B=[{tilde over (θ)}T{circumflex over (r)}rT{circumflex over (v)}rT{circumflex over (b)}gT{circumflex over (b)}aT]T∈R15.
The position, velocity, and clock errors are defined as the standard additive error, e.g., {circumflex over (r)}sop
G
B
G
B
where the error quaternion δ
where {tilde over (θ)}∈R3 is the 3-axis error angle vector.
During the SLAM phase, zsv is no longer available, therefore, the receiver's GNSS clock states {circumflex over (x)}clk,r no longer need to be estimated. However, it is obvious from equation (1), that the relative biases Δδtmδtr−δtsop
Δ{circumflex over (x)}clk
where
Δ{circumflex over (δ)}tm{circumflex over (δ)}tr−{circumflex over (δ)}tsop
The estimation error of the new state vector x′ and the corresponding estimation error covariance are initialized according to
{circumflex over (x)}′=T{circumflex over (x)}∈R
(15+5M),
P
x′
=TP
x
T
T
∈R
(15+5M)×(15+5M),
where T∈R(17+5M)×(15+5M) is the transformation matrix which maps {circumflex over (x)} from (3) to
{circumflex over (x)}′=[{circumflex over (x)}BT,{circumflex over (r)}siT,Δ{circumflex over (x)}clkiT, . . . ,{circumflex over (r)}s
Between aiding updates the INS uses zimu and the dynamics described above to propagate the estimate, either {circumflex over (x)} or {circumflex over (x)}′, and produce the corresponding prediction error covariance. During the mapping phase, the one-step prediction error covariance is given by
P
x(k+1|j)=FPx(k|j)FT+Q,
F
diag[ΦB,Fclk,Fsop, . . . ,Fsop],
Q
diag[QdB,Qclk,r,Qsop, . . . ,Qsop]. (5)
The propagation of {circumflex over (x)}B and calculation of the DT linearized INS state transition matrix ΦB and process noise covariance QdB are performed through standard INS equations. During the SLAM phase, the prediction error covariance
P
x′(k+1|j)
has the same form as (5), except that F is replaced with
F′diag[ΦB,Fsop, . . . ,Fsop]
and Q is replaced with
Q′diag[QdB,Q′sop
where
Q′
sop
diag[03×3,Qclk
and Qclkm is the process noise covariance of the initialized states (4) which is readily shown to be
Q
clk
=Q
clk,r
+Q
clk,sop
, m=1, . . . ,M.
When an INS-aiding source is available, the EKF update step will correct the INS and clock errors using the standard EKF update equations. In the mapping phase, i.e., z=[zsvT, zsopT]T, the corresponding Jacobian is
The update will produce the posterior estimate {circumflex over (x)}(j|j) and an associated posterior estimation error covariance Px(j|j).
In the SLAM phase, only SOP pseudoranges are available, i.e., z=zsop. The adjusted measurement Jacobian is
The update will produce the posterior estimate {circumflex over (x)}(j|j) and an associated posterior estimation error covariance Px′(j|j).
In an embodiment, an IMU simulator includes a MATLAB-based signal generator that models a triad gyroscope and triad accelerometer. The data yi(t) for the ith axis of the gyroscope and accelerometer were generated at 100 Hz according to
where ui(t) is the vehicle's actual acceleration or angular rotation rate for axis i, ek
In an example, GPS L1 pseudoranges were generated at 1 Hz with (2) using SV orbits produced from Receiver Independent Exchange (RINEX) files downloaded on Jun. 1, 2016 from a Continuously Operating Reference Station (CORS) server. SOP pseudoranges were generated at 5 Hz using (1) and the SOP dynamics discussed above. The vehicle's simulated trajectory includes two straight segments, a climb, and a repeating orbit, performed over a 200 second period that were generated using a standard 6DOF kinematic model for airplanes.
Two estimation frameworks were employed to estimate the states of the navigating vehicle: (i) the SOP-aided INS equipped with a consumer-grade IMU and (ii) a traditional tightly-coupled GPS-aided INS equipped with a tactical-grade IMU. For both estimation frameworks GPS pseudoranges were set to be available for t∈[0,100), and unavailable for t∈[100,200]. The initial errors of the navigating vehicle's states were initialized according to
For the SOP-aided INS framework, the SOP state estimates were initialized according to
for m=1, . . . , M, where
x
sop
(0)≡[rsop
and the positions {rsop,m}m=1M were surveyed from SOP tower locations in downtown Los Angeles. The simulated trajectory, SOP positions, and the position at which GPS was set to become unavailable are illustrated in
Simulation results graphs 400 show results for two simulations. In both simulations, a navigating vehicle had access to GPS pseudoranges for only the first 100 seconds while traversing the trajectory illustrated in
Simulation results graphs 400 and 500 show that when GPS pseudoranges become unavailable at t=100 seconds, the estimation error variances associated with the traditional GPS-INS integration strategy begin to diverged, and that a bound can be specified for the errors associated with the SOP-aided INS. Additionally, simulation results graphs 400 and 500 show that the SOP-aided INS with a consumer-grade IMU almost always yields lower estimation error variances when compared to the traditional GPS-INS integration strategy with a tactical-grade IMU.
To study the performance sensitivity of the SOP-aided INS framework over a varying number of SOPs, the states of the navigating vehicle, all available SOPs, and noise corrupted measurements were generated using the simulator and settings described above. Five separate simulation runs were conducted. For each simulation, the states of the navigating vehicle were estimated. The first three runs employed the SOP-aided INS with a consumer grade IMU and M=2, . . . , 4 SOPs. The last two runs, employed a traditional tightly-coupled GPS-INS integration strategy (M=0) with (i) a tactical-grade IMU and (ii) a consumer-grade IMU.
Error estimation graphs 600 show that the estimation uncertainties produced by the SOP-aided INS associated with both GB
indicates data missing or illegible when filed
The clock-dependent error estimation graphs 700 indicate that that sensitivity of the estimation performance to the quality of oscillator was minimal while GPS was available. When GPS pseudoranges are unavailable, the estimation performance is significantly more sensitive to the quality of the oscillator, and the sensitivity is captured by the distance between the 3σ trajectories. Although the uncertainty in the estimates were larger when SOPs were equipped with a worst TCXO, a bound may still be specified.
The collaborative SOP-aided INS framework 1000 uses collaborative SLAM (C-SLAM). In C-SLAM, multiple AVs share their pose estimates and observations in order to improve the quality of their individual state estimates and to build a larger and more accurate map. Multiple collaborating AVs will be estimating their states (attitude, position, velocity, clock bias, and clock drift) in a three-dimensional (3-D) environment and will make mutual observations on the dynamic and stochastic SOP map. Specifically, SOP pseudorange observations will be shared and used to analyze the TOA and TDOA.
The collaborative SOP-aided INS framework 1000 may operate within an environment that includes multiple AVs and multiple unknown SOPs. Each AV has access to GNSS SV pseudoranges, multiple unknown terrestrial SOP pseudoranges, and an onboard IMU. While GNSS pseudoranges are available, the AVs collaboratively map the SOPs, estimating the SOPs' positions, clock biases, and clock drifts. During this mode, the UAVs are navigating with a tightly-coupled GNSS-aided INS strategy. Suddenly, GNSS pseudoranges become unavailable. The AVs continue drawing pseudorange observables from the SOPs and continue estimating the SOPs' states. In this mode, the AVs switch to navigating with a collaborative tightly-coupled SOP-aided INS strategy. AVs equipped with consumer-grade IMUs navigating with the collaborative SOP-aided INS framework 1000 could achieve a performance comparable to when GNSS signals are still available.
The collaborative SOP-aided INS framework 1000 includes a centralized collaborative SOP-aided INS that produces a state estimate {circumflex over (x)}(′) and an estimation error covariance P. All N collaborating AVs send their IMU data zimun, GNSS pseudoranges zrn,sv, and SOP pseudoranges zrn,sop to a tightly-coupled EKF-based CFC that operates in two modes: (1) collaborative mapping mode: {circumflex over (x)}(′)≡{circumflex over (x)} and P≡Px, where {circumflex over (x)} and Px are the state estimate and the estimation error covariance, respectively, or (2) C-SLAM mode: {circumflex over (x)}(′)≡{circumflex over (x)}′ and P≡Px′, where {circumflex over (x)}′ and P≡Px′ are the state estimate and the estimation error covariance, respectively.
Using the collaborative SOP-aided INS framework 1000, a bound may first be specified on the estimation uncertainties for any number of collaborating AVs in the environment. Second, the estimation performance is always improved as more collaborating AVs are added to the environment. However, this performance improvement, which is captured by the distance between the log {det [Prr]} curves, becomes less significant as the number of collaborating AVs increases. The maximum improvement is obtained when going from one AV to two collaborating AVs. Third, when GPS becomes unavailable, the collaborative SOP-aided INS will perform significantly better than an INS only for any number of collaborating AVs in the environment. Fourth, two or more collaborating AVs equipped with SOP-aided INSs that are in the absence of GPS signals can achieve estimation performance comparable to one AV equipped with a traditional GPS-aided INS with access to GPS signals from eleven GPS SVs. By providing the ability to switch to navigating with a collaborative tightly-coupled SOP-aided INS, AVs equipped with consumer-grade IMUs navigating with the collaborative SOP-aided INS framework 1000 could achieve a performance comparable to when GNSS signals are still available.
One example computing device in the form of a computer 1110, may include a processing unit 1102, memory 1104, removable storage 1112, and non-removable storage 1114. Although the example computing device is illustrated and described as computer 1110, the computing device may be in different forms in different embodiments. For example, the computing device may instead be a smartphone, a tablet, or other computing device including the same or similar elements as illustrated and described with regard to
Returning to the computer 1110, memory 1104 may include volatile memory 1106 and non-volatile memory 1108. Computer 1110 may include or have access to a computing environment that includes a variety of computer-readable media, such as volatile memory 1106 and non-volatile memory 1108, removable storage 1112 and non-removable storage 1114. Computer storage includes random access memory (RAM), read only memory (ROM), erasable programmable read-only memory (EPROM) & electrically erasable programmable read-only memory (EEPROM), flash memory or other memory technologies, compact disc read-only memory (CD ROM), Digital Versatile Disks (DVD) or other optical disk storage, magnetic cassettes, magnetic tape, magnetic disk storage or other magnetic storage devices, or any other medium capable of storing computer-readable instructions. Computer 1110 may include or have access to a computing environment that includes input 1116, output 1118, and a communication connection 1120. The input 1116 may include one or more of a touchscreen, touchpad, mouse, keyboard, camera, and other input devices. The input 1116 may include a navigation sensor input, such as a GNSS receiver, a SOP receiver, an inertial sensor (e.g., accelerometers, gyroscopes), a local ranging sensor (e.g., LIDAR), an optical sensor (e.g., cameras), or other sensors. The computer may operate in a networked environment using a communication connection 1120 to connect to one or more remote computers, such as database servers, web servers, and other computing device. An example remote computer may include a personal computer (PC), server, router, network PC, a peer device or other common network node, or the like. The communication connection 1120 may be a network interface device such as one or both of an Ethernet card and a wireless card or circuit that may be connected to a network. The network may include one or more of a Local Area Network (LAN), a Wide Area Network (WAN), the Internet, and other networks.
Computer-readable instructions stored on a computer-readable medium are executable by the processing unit 1102 of the computer 1110. A hard drive (magnetic disk or solid state), CD-ROM, and RAM are some examples of articles including a non-transitory computer-readable medium. For example, various computer programs 1125 or apps, such as one or more applications and modules implementing one or more of the methods illustrated and described herein or an app or application that executes on a mobile device or is accessible via a web browser, may be stored on a non-transitory computer-readable medium.
To better illustrate the method and apparatuses disclosed herein, a non-limiting list of embodiments is provided here.
Each of these non-limiting examples can stand on its own, or can be combined in various permutations or combinations with one or more of the other examples.
Conventional terms in the fields of computer vision have been used herein. The terms are known in the art and are provided only as a non-limiting example for convenience purposes. Accordingly, the interpretation of the corresponding terms in the claims, unless stated otherwise, is not limited to any particular definition. Thus, the terms used in the claims should be given their broadest reasonable interpretation.
Although specific embodiments have been illustrated and described herein, it will be appreciated by those of ordinary skill in the art that any arrangement that is calculated to achieve the same purpose may be substituted for the specific embodiments shown. Many adaptations will be apparent to those of ordinary skill in the art. Accordingly, this application is intended to cover any adaptations or variations.
The above detailed description includes references to the accompanying drawings, which form a part of the detailed description. The drawings show, by way of illustration, specific embodiments that may be practiced. These embodiments are also referred to herein as “examples.” Such examples may include elements in addition to those shown or described. However, the present inventors also contemplate examples in which only those elements shown or described are provided. Moreover, the present inventors also contemplate examples using any combination or permutation of those elements shown or described (or one or more aspects thereof), either with respect to a particular example (or one or more aspects thereof), or with respect to other examples (or one or more aspects thereof) shown or described herein.
All publications, patents, and patent documents referred to in this document are incorporated by reference herein in their entirety, as though individually incorporated by reference. In the event of inconsistent usages between this document and those documents so incorporated by reference, the usage in the incorporated reference(s) should be considered supplementary to that of this document; for irreconcilable inconsistencies, the usage in this document controls.
In this document, the terms “a” or “an” are used, as is common in patent documents, to include one or more than one, independent of any other instances or usages of “at least one” or “one or more.” In this document, the term “or” is used to refer to a nonexclusive or, such that “A or B” includes “A but not B,” “B but not A,” and “A and B,” unless otherwise indicated. In this document, the terms “including” and “in which” are used as the plain-English equivalents of the respective terms “comprising” and “wherein.” Also, in the following claims, the terms “including” and “comprising” are open-ended, that is, a system, device, article, or process that includes elements in addition to those listed after such a term in a claim are still deemed to fall within the scope of that claim. Moreover, in the following claims, the terms “first,” “second,” and “third,” etc. are used merely as labels, and are not intended to impose numerical requirements on their objects.
Method examples described herein can be machine or computer-implemented at least in part. Some examples can include a computer-readable medium or machine-readable medium encoded with instructions operable to configure an electronic device to perform methods as described in the above examples. An implementation of such methods can include code, such as microcode, assembly language code, a higher-level language code, or the like. Such code can include computer-readable instructions for performing various methods. The code may form portions of computer program products. Further, in an example, the code can be tangibly stored on one or more volatile, non-transitory, or non-volatile tangible computer-readable media, such as during execution or at other times. Examples of these tangible computer-readable media can include, but are not limited to, hard disks, removable magnetic disks, removable optical disks (e.g., compact disks and digital video disks), magnetic cassettes, memory cards or sticks, random access memories (RAMs), read-only memories (ROMs), and the like.
The above description is intended to be illustrative, and not restrictive. For example, the above-described examples (or one or more aspects thereof) may be used in combination with each other. Other embodiments may be used, such as by one of ordinary skill in the art upon reviewing the above description. The Abstract is provided to comply with 37 C.F.R. § 1.72(b), to allow the reader to quickly ascertain the nature of the technical disclosure and is submitted with the understanding that it will not be used to interpret or limit the scope or meaning of the claims. In addition, in the above Detailed Description, various features may be grouped together to streamline the disclosure. This should not be interpreted as intending that an unclaimed disclosed feature is essential to any claim. Rather, inventive subject matter may lie in less than all features of a particular disclosed embodiment. Thus, the following claims are hereby incorporated into the Detailed Description, with each claim standing on its own as a separate embodiment, and it is contemplated that such embodiments can be combined with each other in various combinations or permutations. The scope of the embodiments should be determined with reference to the appended claims, along with the full scope of equivalents to which such claims are entitled.
This application is related and claims priority to U.S. Provisional Application No. 62/398,413, filed on Sep. 22, 2016 and entitled “SIGNALS OF OPPORTUNITY AIDED INERTIAL NAVIGATION,” and is related and claims priority to U.S. Provisional Application No. 62/561,026, filed on Sep. 20, 2017 and entitled “DISTRIBUTED SIGNALS OF OPPORTUNITY AIDED INERTIAL NAVIGATION.” the entirety of which are incorporated herein by reference.
The invention was made with Government support under Grant No. N00014-16-1-2305, awarded by the Office of Naval Research-N99914. The Government has certain rights tin this invention.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/US2017/053018 | 9/20/2017 | WO | 00 |
Number | Date | Country | |
---|---|---|---|
62561026 | Sep 2017 | US | |
62398413 | Sep 2016 | US |