SIGNALS OF OPPORTUNITY AIDED INERTIAL NAVIGATION

Information

  • Patent Application
  • 20200025942
  • Publication Number
    20200025942
  • Date Filed
    September 20, 2017
    7 years ago
  • Date Published
    January 23, 2020
    4 years ago
Abstract
A signal of opportunity (SOP)-aided inertial navigation system (INS) framework provides various technical solutions to technical problems facing GNSS implementations. A mobile receiver, whether handheld or vehicle-mounted, has access to Global Navigation Satellite System (GNSS) signals, multiple unknown terrestrial SOPs, and IMU measurements, which are used to estimate receiver states. When GNSS signals become unreliable, the mobile receiver continues to navigate using the SOP-aided INS. The SOP-aided INS produces bounded estimation errors in the absence of GNSS signals, and the bounds are dependent on the quantity and quality of exploited SOPs.
Description
BACKGROUND

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.





BRIEF DESCRIPTION OF THE DRAWINGS


FIG. 1 is a diagram of a signal of opportunity (SOPs) GNSS system, in accordance with at least one embodiment.



FIG. 2 is a block diagram of a SOP-aided INS framework, in accordance with at least one embodiment.



FIG. 3 is a perspective diagram of a SOP-aided INS simulated navigation, in accordance with at least one embodiment.



FIGS. 4A-4L are simulation results graphs, in accordance with at least one embodiment.



FIGS. 5A-5F are error trajectory graphs, in accordance with at least one embodiment.



FIGS. 6A-6B depict error estimation graphs, in accordance with at least one embodiment.



FIGS. 7A-7F depict clock-dependent error estimation graphs, in accordance with at least one embodiment.



FIG. 8 is a block diagram of an experimental hardware setup, in accordance with at least one embodiment.



FIG. 9 is an illustration of experimental results, in accordance with at least one embodiment.



FIG. 10 is a block diagram of a collaborative SOP-aided INS framework, in accordance with at least one embodiment.



FIG. 11 is a block diagram of a computing device, according to an embodiment.





DESCRIPTION OF EMBODIMENTS


FIG. 1 is a diagram of a signal of opportunity (SOP) GNSS system 100, in accordance with at least one embodiment. SOP GNSS system 100 provides various solutions to technical problems facing GNSS implementations. System 100 includes a vehicle 110, such as an unmanned aerial vehicle or other mobile vehicle. Vehicle 110 includes a GNSS/INS navigation system, which provides a navigation solution (e.g., location) of the vehicle 110 using GNSS data combined with INS data. System 100 includes at least four GNSS satellites 120, 130, 140, and 150, though additional GNSS satellites may be used. Similarly, system 100 includes at least one SOP transceiver 160, though additional SOP transceivers may be used. SOPs may enhance or enable otherwise unavailable navigation, such as whenever signals from GNSS satellites 120, 130, 140, and 150 become inaccessible or untrustworthy.


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
custom-character[xsop,ysop,zsop]T





and clock states






x
clk,sop
custom-character
ctsop,{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








F
elk

=

[



1


T




0


1



]


,


Q

elk
,
sop


=

[




?




?






?




?




]


,






?



indicates text missing or illegible when filed






where T is the constant sampling interval. The terms







?






and






?








?



indicates text missing or illegible when filed





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







?





h
0

2






and






?




2


π
2




h

-
2


.





?




indicates text missing or illegible when filed






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
custom-character
ctr,δtr]





such that






x
r(k)=[xB(k)T,xclk,rT(k)]T∈R18.


The INS 16-state vector is






x
B(k)=[GBkqTrrT(k)vrT(k)bgT(k)baT(k)]T,


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 GBkq is the unit quaternion in vector-scalar form which represents the orientation of the body frame at time step k with respect to a global frame.


The orientation of the INS will evolve in DT according to






G
B

k+1


q=

B

k

B

k+1


q

G
B

b


q
,


where BkBk+1q represents the relative rotation in the body frame from time step k to k+1, and ⊗ is the quaternion multiplication operator. The unit quaternion BkBk+1q is the solution to the differential equation








?


q

=



1
2



[




-

?





?






-

?




0



]




?










?



indicates text missing or illegible when filed










where tkcustom-characterkT. 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






c
,


(

k
+
1

)

=



?



(
k
)


+




?


?




d


a


(
r
)



d





τ













?



indicates text missing or illegible when filed










where Ga is the three dimensional acceleration of the IMU in the global frame. The position will evolve in time according to the integration









r
r



(

k
+
1

)


=



?



(
k
)


+




?


?






v


a


(
r
)



d





τ


.





?




indicates text missing or illegible when filed













The evolution of bg and ba will be modeled as random walk processes, i.e.,









b
.

a

=



w
a






and







b
.

g


=



w
g






with









[

w
g

]



=





[

w
a

]


=
0




,






cov


[

w
g

]


=


σ

w
s

2



I
3



,






and






cov


[

w
a

]



=


σ

w
s

2




I
3

.







The receiver's clock states will evolve in time according to







x
,



?



(

k
+
1

)


=


F


?


x


?



(
k
)


+


w
clk



(
k
)




,






?



indicates text missing or illegible when filed











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 text missing or illegible when filed

and text missing or illegible when filed

are now replaced with receiver-specific spectra, text missing or illegible when filed

and text missing or illegible when filed

respectively.


The IMU contains a triad-gyroscope and triad-accelerometer that produce measurements







z


?


=


[


ω
imu
T

,

a
imu
T


]

T









?



indicates text missing or illegible when filed











modeled as







ω
imu

=



?


ω

+

b
g

+

n
g










n
imu

=



R


[





B
k





C




q

]




(




G


n

-



G


g


)


+

b
a

+



n
a

.





?




indicates text missing or illegible when filed












where R[q] is the equivalent rotation matrix of q, Gg′ is the acceleration due to gravity in the global frame, and ng and na are measurement noise vectors which are modeled as zero-mean white noise sequences with covariances σg2I3 and σa2I3, respectively.


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










z

sop
m


=






r
r

-

r

sop
m






2

+

c
·

[


δ





t


?


-

δ


?










(
1
)








?



indicates text missing or illegible when filed


















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










z

sop
s


=






r
r

-

r

sop
m






2

+

c
·

[


δ





t


?


-

δ


?










(
2
)





where












2


?




=
Δ




2



?




-

δ






t
iono


-

δ






t
tropo




,

δ






t
iono






and





δ






t
tropo















?



indicates text missing or illegible when filed


















are the ionospheric and tropospheric delays, respectively, z′svn is the uncorrected pseudorange, and vsvn is modeled as a DT zero-mean white Gaussian sequence with variance σ2svn.



FIG. 2 is a block diagram of a SOP-aided INS framework 200, in accordance with at least one embodiment. The SOP-aided INS framework 200 may be implemented on a navigating vehicle equipped with a GNSS-aided INS and a receiver capable of producing pseudoranges to M unknown SOPs. Using the SOP-aided INS framework 200, when GNSS pseudoranges are available, SOP pseudoranges will supplement the GNSS-aided INS to improve the accuracy of the navigation solution. When GNSS pseudoranges become unavailable, SOP pseudoranges will be used exclusively as an aiding source to correct the accumulating errors of the INS. To exploit SOPs for navigation, their states must be known. However, in many practical scenarios the SOP transmitter positions are unknown. Furthermore, each SOP clock states are dynamic and stochastic, and are continuously estimated. The SOP-aided INS framework 200 adapts a SLAM-type strategy that operates in a mapping phase when GNSS pseudoranges are available and a SLAM phase when GNSS pseudoranges are unavailable. In particular, the detector flag indicates if the SOP-aided INS operates in the mapping phase:







x


?




=
Δ




x





and





P



=
Δ



P


?











?



indicates text missing or illegible when filed










or the SLAM phase:






{circumflex over (x)}
(′)
custom-character
{circumflex over (x)}′ and Pcustom-characterPx′.


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 {xsopm}m=1M, are simultaneously estimated alongside the navigating vehicle's states. In an example, GNSS pseudoranges are available during t∈[0,t0) (mapping phase) and unavailable during t∈[t0,∞) (SLAM phase), where t0 is the instant GNSS pseudoranges become unavailable. During the mapping phase, the EKF produces an estimate






{circumflex over (x)}(k|j)custom-characterE[x(k)|{z(i)}i=1j]


of x(k), and an associated estimation error covariance






P
x(k|j)custom-characterE[{circumflex over (x)}(k|j){circumflex over (x)}T(k|j)]





where






x
custom-character[xrT,xsopiT, . . . ,xsopMT]T∈R(18+5M),zcustom-character[zsvT,zsopT]T






z
sv=[zsvi, . . . ,zsvN]T, zsop=[zsopi, . . . ,zsopM]T,


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)}
custom-character[{circumflex over (x)}BT{circumflex over (x)}clk,rT,{circumflex over (r)}sopiT,{circumflex over (x)}clk,sopiT, . . . ,{circumflex over (r)}sopMT,{circumflex over (x)}clk,sopMT]T  (3)





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)}sopicustom-characterrsopi−{circumflex over (r)}sopi. The orientation error is related through the quaternion product






G
B

q=

G
B

q⊗δq
,


where the error quaternion δq is the small deviation of the estimate GBq from the true orientation GBq and is given by








δ





q

=


[



1
2




θ
_

T


,


1
-


1
4




θ
_

T



θ
_





]

T


,




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 Δδtmcustom-characterδtr−δtsopm, m=1, . . . , M, must be estimated to exploit zsop as an INS-aiding source. Therefore, at t0 the states {circumflex over (x)}clk,r and {{circumflex over (x)}clk,sopm}m=1M are removed from the estimator, and the relative clock state estimates Δ{circumflex over (x)}clkm are initialized as





Δ{circumflex over (x)}clkm=[Δ{circumflex over (δ)}tm,Δ{circumflex over (δ)}tm]T, m=1, . . . ,M  (4)





where





Δ{circumflex over (δ)}tmcustom-character{circumflex over (δ)}tr−{circumflex over (δ)}tsopm,Δ{circumflex over (δ)}tmcustom-character{circumflex over (δ)}tr−{circumflex over (δ)}tsopm,


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)}sMT,Δ{circumflex over (x)}clkMT]T.


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
custom-characterdiag[ΦB,Fclk,Fsop, . . . ,Fsop],






Q
custom-characterdiag[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






Fcustom-characterdiag[ΦB,Fsop, . . . ,Fsop]


and Q is replaced with






Qcustom-characterdiag[QdB,Q′sopi, . . . ,Q′sopM]





where






Q′
sop

m

custom-characterdiag[03×3,Qclkm],


and Qclkm is the process noise covariance of the initialized states (4) which is readily shown to be






Q
clk

m

=Q
clk,r
+Q
clk,sop

m

, 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







H
=


[


H


?


,

H


?



]

T


,






H


?


=

[




0


?





1


?





0


?





h


?





0


?
























0


?





1


?





0


?





h


?





0


?





]


,






H


?


=

[




0


?





1


?





0


?





h


?





H


?







0




























0


?





1


?





0


?





h


?




0






H


?





]


,
where







1


?





?


?



h


?






[

1
,
0

]


T


,

1


?





?


[

?

]



,
and






H


?



[



-
1



?


,


?







?



indicates text missing or illegible when filed












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








H


?


=

[




0


?





1


?





0


?





H


?







0

























0


?





1


?





0


?




0






H


?





]


,
where






H


?



[



-
1



?


,


?







?



indicates text missing or illegible when filed












The update will produce the posterior estimate {circumflex over (x)}(j|j) and an associated posterior estimation error covariance Px′(j|j).



FIG. 3 is a perspective diagram of a SOP-aided INS simulated navigation 300, in accordance with at least one embodiment. The purpose of the simulated navigation 300 is to demonstrate the capabilities of the SOP-aided INS framework 200. The simulated navigation provided: (i) the “ground truth” states of the navigating vehicle, (ii) the SOPs' states, (iii) noise corrupted IMU measurements of specific force and angular rates, and (iv) noise corrupted pseudoranges to multiple SOPs and GPS SVs.


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








y
i



(
t
)


=


(

1
+


ϵ
k



?



)

·

[



u
i



(
t
)


+


b
i



(
t
)


+

η

MA
i


+

η

Q
i


+

η

RRW
i


+

η

RR
i



]










?



indicates text missing or illegible when filed










where ui(t) is the vehicle's actual acceleration or angular rotation rate for axis i, eki is the scale factor, bi(t) is a random bias which is driven by the bias instability, ηMAi is the misalignment, ηQi is quantization noise, ηRRWi is rate random walk, and ηRRi is rate ramp. The magnitude of these errors and their driving statistics are determined by the grade of the IMU. In various examples, the simulation may generate consumer-grade IMU simulation data and tactical-grade IMU simulation data.


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









x
~



?



(

0

0

)







[


0

17
×
1


,


P

x


?





(

0

0

)



]



,




where









P

x


?





(

0

0

)






diag


[



(

10

-
2


)

·

I

3
×
3



,

9
·

I

3
×
3



,

I

3
×
3


,


(

10

-
4


)

·

I

6
×
6



,
9
,
1

]


.





?




indicates text missing or illegible when filed











For the SOP-aided INS framework, the SOP state estimates were initialized according to










x
.


sop
m




(

0

0

)







[



x

sop
m




(
0
)


,


P
sop



(

0

0

)



]



,




for m=1, . . . , M, where






x
sop

m
(0)≡[rsopmT,104,10]T,Psop(0|0)≡(104)·diag[1,1,1,0.1,0.01],


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 FIG. 3.



FIGS. 4A-4L are simulation results graphs 400, in accordance with at least one embodiment. In particular, simulation results graphs 400 show estimation error trajectories and corresponding 3σ bounds for the position, velocity, and attitude of the receiver and an example SOP's position produced by the SOP-aided INS framework. For a comparative analysis, a traditional tightly-coupled GPS-INS integration strategy with a tactical-grade IMU was used to estimate the states of the receiver. The resulting position, velocity, and attitude estimation error trajectories and corresponding 3σ bounds are plotted in FIGS. 4A-4I.


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 FIG. 1. In the first simulation, a tightly-coupled GPS-INS integration strategy using a tactical-grade IMU produced the estimation error trajectories and corresponding 3σ bounds. In the second simulation, the SOP-aided INS framework produced the estimation error trajectories and corresponding 3σ bounds. Oscillations coincide with the repeating circular path of the vehicle. North, East. and down (NED) errors are shown for position and velocity. Roll, pitch, and yaw (rpy) errors are shown for the orientation.



FIGS. 5A-5F are error trajectory graphs 500, in accordance with at least one embodiment. The plots in FIG. 5A and FIG. 5B correspond to the estimation errors of the receiver's clock states, whereas the plots in FIG. 5C and FIG. 5D correspond to the estimation errors of the SOPs clock states while GPS was available. FIG. 5E and FIG. 5F correspond to the estimation errors of the relative clock states that are initialized when GPS becomes unavailable, and correspond to Δ{circumflex over (x)}clki during the SLAM phase. Oscillations coincide with the repeating circular path of the vehicle.


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.



FIGS. 6A-6B depict error estimation graphs 600, in accordance with at least one embodiment. Error estimation graphs 600 were generated using a navigating vehicle that traverses the trajectory illustrated in FIG. 3. GPS pseudoranges become unavailable at 100 seconds, and the vehicle continues to navigate by fusing INS estimates and pseudoranges from M SOPs using the framework illustrated in FIG. 2. FIG. 6A and FIG. 6B correspond to the logarithm of the determinant of the estimation error covariance for attitude, and position, respectively, for exploiting a varying number of SOPs in the navigating receiver's vicinity. The two curves for M=0 correspond to a traditional tightly-coupled GPS-aided INS equipped with a tactical grade IMU and consumer-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. FIGS. 6A-6B illustrate for each run the resulting logarithm of the determinant of the estimation error covariance, which is proportional to the volume of the estimation uncertainty ellipsoid. FIG. 6A corresponds to the attitude (log{det[Pq]}), whereas FIG. 6B corresponds to the position (log{det[Prr]}).


Error estimation graphs 600 show that the estimation uncertainties produced by the SOP-aided INS associated with both GBq and rr are reduced when M is increased, and the sensitivity to varying M is captured by the distance between the log{det[Pq]} and log{det[Prr]} trajectories. Error estimation graphs 600 also show that although the SOP-aided INS used a consumer-grade IMU, the resulting estimation uncertainty of rr for M=2, . . . , 4 is lower when compared to the resulting estimation uncertainty produced by a traditional tightly-coupled GPS-INS using a tactical grade IMU. Error estimation graphs 600 also show that although the GPS-INS equipped with a tactical-grade IMU produces a lower estimation uncertainty of GBq while GPS is available, the uncertainty begins to diverge when GPS becomes unavailable, and becomes larger than the uncertainties produced by the SOP-aided INS, for which a bound may be specified for M=2, . . . , 4.



FIGS. 7A-7F depict clock-dependent error estimation graphs 700, in accordance with at least one embodiment. Clock-dependent error estimation graphs 700 were generated using a navigating vehicle that traverses the trajectory illustrated in FIG. 3. GPS pseudoranges become unavailable at 100 seconds and the vehicle continues to navigate using the framework illustrated in FIG. 2. The clock-dependent error estimation graphs 700 indicate performance characteristics of varying qualities of SOPs. In particular, the SOP quality is dependent on the stability of the oscillator that is equipped on the SOP transmitter. The stability of the oscillator is characterized by the parameters of Qclk,sop as described above. Four simulations were conducted using the simulator and settings described above. The resulting 3σ bounds for exploiting four SOPs that were assumed to all be equipped with a worst temperature compensated crystal oscillator (TCXO), typical TCXO, typical oven-controlled crystal oscillator (OCXO), and best OCXO. FIGS. 7A-7F correspond to the 3σ bounds for exploiting SOPs equipped with a worst TCXO, typical TCXO, typical OCXO, and best OCXO. North, East, and up (NED) errors are shown. The four grades of oscillators considered and their characterizing parameters are tabulated in Table I:









TABLE I







Quality of SOPs: Oscillator Type










Parameter
Value







Worst TCXO {h0,text missing or illegible when filed , h−2,text missing or illegible when filed }
{2.0 × 10−19, 2.0 × 10−20}



Typical TCXO {h0,text missing or illegible when filed , h−2,text missing or illegible when filed }
{9.4 × 10−20, 3.8 × 10−21}



Typical OCXO {h0,text missing or illegible when filed , h−2,text missing or illegible when filed }
{8.0 × 10−26, 4.0 × 10−23}



Best OCXO {h0,text missing or illegible when filed , h−2,text missing or illegible when filed }
{2.6 × 10−22, 4.0 × 10−26}








text missing or illegible when filed 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.



FIG. 8 is a block diagram of an experimental hardware setup 800, in accordance with at least one embodiment. The experimental hardware setup 800 was used to conduct a field experiment using an IMU and a software defined radio (SDR) to demonstrate the SOP-aided INS framework discussed above. The experimental hardware setup 800 includes two antennas mounted on a vehicle to acquire and track multiple GPS signals, and a cellular base transceiver station (BTS) whose signals were modulated through code division multiple access (CDMA). The GPS and cellular signals were simultaneously downmixed and synchronously sampled via a two-channel National Instruments® universal software radio peripheral (USRP). This front-end fed the data to the Multichannel Adaptive TRansceiver Information eXtractor (MATRIX) SDR, which produced pseudorange observables from all GPS L1 C/A signals in view, and the cellular BTS. The IMU data was sampled from a navigation system developed at University of California, Riverside (UCR), which is equipped with: (i) a consumer grade IMU, (ii) a tactical-grade IMU, and (iii) a u-Blox® GPS receiver.



FIG. 9 is an illustration of the experimental results 900, in accordance with at least one embodiment. The experimental results 900 include results from two estimators: (i) the proposed SOP-aided INS using the consumer grade IMU and (ii) for comparative analysis, a traditional tightly-coupled GPS-INS using the consumer-grade IMU. For both estimators, GPS pseudoranges were available for only the first 16 seconds of the 30 second run. The ground truth trajectory was generated with a common GPS-INS EKF using the u-blox GPS receiver and the tactical-grade IMU. The experimental results 900 illustrate the true and estimated vehicle trajectories, the true and estimated tower locations, and the North-East 99th-percentile initial and final uncertainty ellipses. The North-East root-mean-square error (RMSE) of the traditional tightly-coupled GPS-INS's navigation solution after GPS became unavailable was 23.5 meters. The SOP-aided INS produced a trajectory estimate with an RMSE of 9.42 meters and a final BTS localization error of 15.5 meters. Although this is a significant improvement over using an INS alone, the improvement is expected to be much more significant with additional time, since the errors of the unaided INS will diverge, whereas the SOP-aided INS errors will be bounded.



FIG. 10 is a block diagram of a collaborative SOP-aided INS framework 1000, in accordance with at least one embodiment. The collaborative SOP-aided INS framework 1000 may take advantage of information provided by multiple autonomous vehicles (AVs) with access to GNSS signals aiding their on-board INSs with GNSS pseudoranges. While navigating. AV-mounted receivers draw pseudorange observations on ambient unknown terrestrial SOPs and collaboratively estimate the SOPs' states. After some time, GNSS signals become unavailable. Subsequently, the AVs exploit the SOPs to collaboratively aid their INSs. The collaborative SOP-aided INS framework 1000 may use time-of-arrival (TOA) measurements from SOPs or time-difference-of-arrival (TDOA) measurements taken with reference to a specific SOP. This framework 1000 may vary the quantity of collaborating AVs, and provides “GNSS-like” performance achieved in the absence of GNSS signals. Experimental results demonstrate multiple unmanned aerial vehicles (UAVs) collaboratively navigating exclusively with their onboard inertial measurement units (IMUs) and pseudoranges extracted from unknown terrestrial SOPs emanating from two cellular towers.


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.



FIG. 11 is a block diagram of a computing device 1100, according to an embodiment. In one embodiment, multiple such computer systems are used in a distributed network to implement multiple components in a transaction-based environment. An object-oriented, service-oriented, or other architecture may be used to implement such functions and communicate between the multiple systems and components. In some embodiments, the computing device of FIG. 11 is an example of a client device that may invoke methods described herein over a network. In other embodiments, the computing device is an example of a computing device that may be included in or connected to a motion interactive video projection system, as described elsewhere herein. In some embodiments, the computing device of FIG. 11 is an example of one or more of the personal computer, smartphone, tablet, or various servers.


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 FIG. 11. Further, although the various data storage elements are illustrated as part of the computer 1110, the storage may include cloud-based storage accessible via a network, such as the Internet.


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.

Claims
  • 1. A navigation system comprising: a global navigation satellite solution (GNSS) receiver to receive a plurality of GNSS signals from a plurality of GNSS satellites;an inertial navigation system (INS) to generate a plurality of INS measurements;a signal of opportunity (SOP) receiver to receive an SOP signal from at least one SOP transceiver station; anda processor to: determine a plurality of GNSS pseudorange measurements based on the received plurality of GNSS signals;determine an SOP pseudorange measurement based on the received SOP signal; anddetermine an estimated receiver position based on the plurality of INS measurements, the SOP pseudorange measurement, and the plurality of GNSS pseudorange measurements.
  • 2. The system of claim 1, the system further including: a second GNSS receiver to receive a second plurality of GNSS signals;a second INS to generate a second plurality of INS measurements; anda second SOP receiver to receive a second SOP signal;wherein the processor is further to determine the estimated receiver position based on the second plurality of GNSS signals, the second plurality of INS measurements, and the second SOP signal.
  • 3. The system of claim 1, the processor further to: determine that the received plurality of GNSS signals is unavailable; anddetermine an updated estimated receiver position based on the plurality of INS measurements and on the SOP pseudorange measurement, the updated estimated receiver position determined without requiring the plurality of GNSS pseudorange measurements.
  • 4. The system of claim 3, the processor further to: determine the estimated receiver position based on a first Kalman filter; anddetermine the updated estimated receiver position based on a second Kalman filter.
  • 5. The system of claim 1, wherein determining the SOP pseudorange measurement is further based on an SOP base transceiver station clock error estimate.
  • 6. The system of claim 5, wherein receiving the SOP signal includes receiving the clock error estimate from the at least one SOP transceiver station.
  • 7. The system of claim 5, further including a stationary mapping receiver, wherein receiving the SOP signal includes receiving the clock error estimate at the SOP receiver from the stationary mapping receiver.
  • 8. The system of claim 5, wherein the processor is further configured to generate the clock error estimate based on application of a simultaneous localization and mapping algorithm to the received SOP signal.
  • 9. The system of claim 1, wherein the SOP receiver includes a hardware-defined radio.
  • 10. The system of claim 1, wherein the SOP receiver includes a software-defined radio (SDR).
  • 11. A navigation method comprising: receiving a plurality of GNSS signals from a plurality of GNSS satellites at a global navigation satellite solution (GNSS) receiver;receiving a plurality of inertial navigation system (INS) measurements from an INS;receiving an SOP signal from at least one SOP transceiver station at a signal of opportunity (SOP) receiver;determining a plurality of GNSS pseudorange measurements based on the received plurality of GNSS signals;determining an SOP pseudorange measurement based on the received SOP signal; anddetermining an estimated receiver position based on the plurality of GNSS pseudorange measurements, the plurality of INS measurements, and the SOP pseudorange measurement.
  • 12. The method of claim 11, further including: receiving a second plurality of GNSS signals from a second GNSS receiver;receiving a second plurality of INS measurements from a second INS;receiving a second SOP signal from a second SOP receiver;wherein determining the estimated receiver position is further based on the second plurality of GNSS signals, the second plurality of INS measurements, and the second SOP signal.
  • 13. The method of claim 11, further including: determining the received plurality of GNSS signals is unavailable; anddetermining an updated estimated receiver position based on the plurality of INS measurements and on the SOP pseudorange measurement, the updated estimated receiver position determined without requiring the plurality of GNSS pseudorange measurements.
  • 14. The method of claim 13, further including: determining the estimated receiver position based on a first Kalman filter; anddetermining the updated estimated receiver position based on a second Kalman filter.
  • 15. The method of claim 11, wherein determining the SOP pseudorange measurement is further based on an SOP base transceiver station clock error estimate.
  • 16. The method of claim 15, wherein receiving the SOP signal includes receiving the clock error estimate from the at least one SOP transceiver station.
  • 17. The method of claim 15, wherein receiving the SOP signal includes receiving the clock error estimate at the SOP receiver from a stationary mapping receiver.
  • 18. The method of claim 15, further including generating the clock error estimate based on application of a simultaneous localization and mapping algorithm to the received SOP signal.
  • 19. The method of claim 11, wherein receiving the SOP signal includes receiving the SOP signal at a hardware-defined radio.
  • 20. The method of claim 11, wherein receiving the SOP signal includes receiving the SOP signal at a software-defined radio (SDR).
RELATED APPLICATION AND PRIORITY CLAIM

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.

STATEMENT OF GOVERNMENT SPONSORED SUPPORT

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.

PCT Information
Filing Document Filing Date Country Kind
PCT/US2017/053018 9/20/2017 WO 00
Provisional Applications (2)
Number Date Country
62561026 Sep 2017 US
62398413 Sep 2016 US