Systems, methods and devices for improving the accuracy of gnss data are provided. Specifically, embodiments of the invention can advantageously use sensor input to improve the accuracy of position fixes. The use of physical sensors in navigation systems is deemed particularly advantageous, especially where altitude data derived from the pressure sensor is calibrated with and/or blended with gnss altitude data.
|
15. A navigation receiver comprising:
means for providing a pressure sensor signal;
means for providing pseudoranges;
means for computing (1) a gnss altitude and a vertical pseudorange residue derived from the pseudoranges, (2) a barometric altitude derived from the pressure sensor signal, based on an atmospheric model, and (3) a double difference in altitude based on a difference between a gnss altitude variation and a barometric altitude difference; and
mean for estimating, with a kalman filter, one or more parameters of the atmospheric model, using at least the double difference in altitude as an input to the kalman filter.
8. A method in a navigation receiver comprising:
providing a pressure sensor signal from a pressure sensor;
providing pseudoranges from a gnss receiver;
computing (1) a gnss altitude and a vertical pseudorange residue derived from the pseudoranges, (2) a barometric altitude derived from the pressure sensor signal, based on an atmospheric model, and (3) a double difference in altitude based on a difference between a gnss altitude variation and a barometric altitude difference; and
estimating, with a kalman filter, one or more parameters of the atmospheric model, using at least the double difference in altitude as an input to the kalman filter.
1. A navigation receiver comprising:
a pressure sensor configured to provide a pressure sensor signal;
a gnss receiver configured to provide pseudoranges;
a microprocessor configured to compute: (1) a gnss altitude and a vertical pseudorange residue derived from the pseudoranges, (2) a barometric altitude derived from the pressure sensor signal, based on an atmospheric model, and (3) a double difference in altitude based on a difference between a gnss altitude variation and a barometric altitude difference; and
a kalman filter configured to estimate one or more parameters of the atmospheric model, using at least the double difference in altitude as an input to the kalman filter.
22. A non-transitory machine-readable medium comprising software instructions for a navigation receiver, the software instructions comprising code to:
provide a pressure sensor signal from a pressure sensor;
provide pseudoranges from a gnss receiver;
compute (1) a gnss altitude and a vertical pseudorange residue derived from the pseudoranges, (2) a barometric altitude derived from the pressure sensor signal, based on an atmospheric model, and (3) a double difference in altitude based on a difference between a gnss altitude variation and a barometric altitude difference; and
estimate, with a kalman filter, one or more parameters of the atmospheric model, using at least the double difference in altitude as an input to the kalman filter.
2. The navigation receiver of
determine whether the vertical pseudorange residue exceeds a threshold; and
suspend the kalman filter, if the vertical pseudorange residue is determined to exceed the threshold, to prevent updating the atmospheric model.
3. The navigation receiver of
an altitude kalman filter coupled to the pressure sensor and the gnss receiver, wherein the altitude kalman filter comprises a first input port coupled to the pressure sensor signal, a second input port coupled to the pseudoranges, and a first output port for providing an altitude signal; and
a horizontal kalman filter coupled in series to the altitude kalman filter, wherein the horizontal kalman filter comprises a first input port coupled to the altitude signal, and an output port for providing a longitude and a latitude.
4. The navigation receiver of
6. The navigation receiver of
7. The navigation receiver of
9. The method of
determining whether the vertical pseudorange residue exceeds a threshold; and
suspending the kalman filter, if the vertical pseudorange residue is determined to exceed the threshold, to prevent updating the atmospheric model.
10. The method of
kalman filtering, with an altitude kalman filter, the pressure sensor signal from a first input port and the pseudoranges from a second input port to provide an altitude signal from a first output port; and
kalman filtering, with a horizontal kalman filter coupled in series with the altitude kalman filter, the altitude signal from a first input port to provide a longitude and a latitude at an output port.
11. The method of
generating a clock error from a second output port of the altitude kalman filter; and
receiving the clock error at a second input port of the horizontal kalman filter.
12. The method of
13. The method of
generating a pseudorange offset per satellite from a third output port of the altitude kalman filter; and
receiving the pseudorange offset per satellite from a third input port of the horizontal kalman filter.
14. The method of
generating a pseudorange offset per satellite from a second output port of the altitude kalman filter; and
receiving the pseudorange offset per satellite from a second input port of the horizontal kalman filter.
16. The navigation receiver of
means for determining whether the vertical pseudorange residue exceeds a threshold; and
means for suspending the kalman filter, if the vertical pseudorange residue is determined to exceed the threshold, to prevent updating the atmospheric model.
17. The navigation receiver of
means for altitude kalman filtering the pressure sensor signal and the pseudoranges to provide an altitude signal; and
means for horizontal kalman filtering, with a horizontal kalman filter coupled in series with an altitude kalman filter, the altitude signal to provide a longitude and a latitude.
18. The navigation receiver of
means for generating a clock error from the means for altitude kalman filtering; and
means for receiving the clock error from the means for horizontal kalman filtering.
20. The navigation receiver of
means for generating a pseudorange offset per satellite from the means for altitude kalman filtering; and
means for receiving the pseudorange offset per satellite from the means for horizontal kalman filtering.
21. The navigation receiver of
means for generating a pseudorange offset per satellite from the means for altitude kalman filtering; and
means for receiving the pseudorange offset per satellite from the means for horizontal kalman filtering.
|
The embodiments of the present invention relate generally to the improvement of GNSS data using altitude data derived from a pressure sensor. Certain embodiments use pressure-sensor derived data as calibrated by GNSS data and/or as blended with GNSS data to provide an improved altitude determination.
Further embodiments of the invention generally relate to detection, use and/or mitigation of multipath signals for communication and especially navigation systems. Certain embodiments further relate to the detection, use and or mitigation of multipath signals for GNSS systems.
There is currently a need for improved accuracy of GNSS positioning in particular with respect to portable navigation devices providing mapping services to users. Currently, GNSS horizontal accuracy is not sufficient to provide an accurate user map location without using “map matching” techniques—that is, without guessing a user location based on the position of roads and other landmarks in the map, under the assumption that the user is constrained to a position within the road. Furthermore, current techniques are not sufficiently accurate to differentiate between closely spaced roads or stacked road conditions, for example underneath overpasses or where two roads are in an upper deck-lower deck configuration. There is thus a need to improve the accuracy of GNSS positioning systems to overcome these difficulties.
Furthermore, wireless communications systems generally experience an effect known as “multipath”. “Multipath” refers to the reception of a non-line of sight signal from a signal source. Multipath signals may result, for example, from the reflection of a signal from a nearby reflector, such as the ground, a building face or the surface of a body of water. Multipath signals may also result when signals are significantly refracted. In general a non-reflected or refracted (straight line) signal is referred to simply as the “signal”, “true signal” or “line of sight signal”, whereas a reflected or refracted signal is referred to as a multipath signal. Since the multipath signal does not travel along the line of sight, it always arrives at the receiver later than the true signal.
Multipath signals, although sometimes useful, are often detrimental to signal quality. As an example, if the chipping frequency of a ranging signal is approximately 1 MHz, a multi path signal that travels along a reflected path with an additional 300 m length will arrive one chip later. When superimposed on the true signal, it distorts the received signal quality and can in some cases result in a complete loss of signal.
Multipath problems are also detrimental to navigation systems, especially those that rely on the time of reception of received signals, such as used in Global Navigation Satellite Systems (GNSS) such as the Global Positioning System (GPS) or Galileo.
As illustrated in
The computed position 118 of the receiver based on the time of arrival of the signals of satellites 102 and 104 occurs at one of the intersection points of two circles defined with centers at the satellites and respective radii equal to the measured distance of the receiver 100 from the satellite. Because receiver 100 measures a greater distance from satellite 102 than the actual distance to satellite 102, the relevant intersection point is calculated lower than and to the right of receiver 100's true position.
In the past, multipath mitigation strategies have focused on signal processing techniques, such as the rejection of late arriving signals or the analysis of signal shape. These processing techniques are, unfortunately, limited in their ability to accurately remove the effects of multipath from the positioning solution provided by navigation receivers. Furthermore, traditional techniques have not been able to determine whether a line of sight signal is present, or whether only multipath signals are present. Thus, improved methods, systems and devices are called for.
Certain embodiments of the invention relate to a navigation receiver, comprising: a pressure sensor input; circuitry coupled to the pressure sensor input; wherein the circuitry is configured to use information from the pressure sensor input to improve a position fix. The navigation receiver may further comprise a pressure sensor connected to the pressure sensor input; wherein the relative measurements of the pressure sensor are more accurate than the absolute measurements of the pressure sensor. Optionally, the navigation receiver may comprise a GNSS receiver, wherein the circuitry is configured to calibrate an altitude derived from the pressure sensor using an altitude derived from the GNSS receiver. Further, the navigation receiver may be so configured that the altitude derived from the GNSS receiver used to calibrate the altitude derived from the pressure sensor has not been Kalman-filtered. Preferably, the circuitry comprises a central processing unit executing a position solution section, a velocity solution section, a Kalman filter and an atmospheric model section. Additionally, the circuitry coupled to the pressure sensor input may be configured to derive a first altitude from the pressure sensor input; and the circuitry coupled to the pressure sensor may be configured to blend the first altitude with a second altitude received from a GNSS sensor. Preferably, the circuitry coupled to the pressure sensor input is configured to carry out a complementary filter operation.
Further embodiments of the invention relate to a method for improvement of GNSS positioning, comprising: receiving a GNSS measurement from a primary GNSS system; deriving a first altitude from the GNSS measurement; deriving a second altitude from a pressure sensor input corresponding approximately in time to the GNSS measurement; and combining the first and second altitude measurements to obtain a blended altitude measurement. Optionally, the step of combining the first and second altitude measurements comprises executing a complementary filter operation. Preferably, the step of executing a complementary filter operation comprises filtering data related to the first altitude using a low-pass filter and filtering data related to the second altitude using a high-pass filter. Additionally, the second altitude can be derived using an atmospheric model.
Further embodiments of the invention relate to a portable navigation system, comprising: a GNSS sensor; a pressure sensor; and a microprocessor configured to use input derived from the GNSS sensor and the pressure sensor to provide a map location without using map-matching. Additionally, the portable navigation system may provide horizontal an accuracy of 10 meters or less in an urban canyon environment.
Optionally, the portable navigation system further comprises a machine-readable medium comprising software instructions that, when executed by the microprocessor, would perform a method comprising the steps of: computing a GNSS altitude; computing an altitude based on a measurement derived from the pressure sensor; and combining the GNSS altitude and the altitude based on a measurement derived from the pressure sensor to produce a blended altitude. The step of combining the GNSS altitude and the altitude based on a measurement derived from the pressure sensor preferably comprises using a complementary filter.
Still further embodiments of the invention relate to a portable vehicle navigation system, comprising: a GNSS sensor; a pressure sensor; and a microprocessor configured to use input derived from the GNSS sensor and the pressure sensor to provide a map location; and wherein the portable navigation system can differentiate between two roads in a stacked road condition. Furthermore the vehicle navigation system optionally provides a vertical accuracy of 10 meters or less under stacked road conditions.
Additionally, the vehicle navigation system further comprises a machine-readable medium comprising software instructions that, when executed by the microprocessor, would perform a method comprising the steps of: computing a GNSS altitude; computing an altitude based on a measurement derived from the pressure sensor; and combining the GNSS altitude and the altitude based on a measurement derived from the pressure sensor to produce a blended altitude. Preferably, the step of combining the GNSS altitude and the altitude based on a measurement derived from the pressure sensor comprises using a complementary filter.
Certain further embodiments of the present invention relate to navigation receivers, comprising: a physical sensor input; circuitry coupled to the physical sensor input; and wherein the circuitry is configured to use information from the physical sensor input for multipath mitigation. Such navigation receivers can be further configured such that the physical sensor input is adapted to be connected to a physical sensor, wherein the relative measurements of the physical sensor are more accurate than the absolute measurements of the physical sensor; wherein the physical sensor is a pressure sensor; and/or wherein the physical sensor input is adapted to be connected to an inertial sensor.
In certain embodiments the circuitry comprises central processing unit executing a position solution section, a velocity solution section, a Kalman filter and an atmospheric model section. Additionally, the navigation receiver can be configured such that the circuitry coupled to the physical sensor input is configured to derive first position-related data from the sensor input; and wherein the circuitry coupled to the physical sensor is configured to blend the first position-related data with second position-related data received from a GNSS sensor. The navigation receiver can be configured such that the circuitry coupled to the physical sensor input is configured to carry out a complementary filter operation.
Embodiments of the invention further relate to a method for multipath mitigation, comprising receiving a GNSS measurement; calculating a position based on the GNSS measurement; receiving a first position-related datum derived from a physical sensor input and corresponding approximately in time to the GNSS measurement; determining whether the position based on the GNSS measurement was significantly affected by multi path by using the first position-related datum The method can be extended to include situations wherein the step of determining whether the position based on the GNSS measurement was significantly affected by multipath further comprises using a second position-related datum derived from the physical sensor input and corresponding to a time previous to the time of the GNSS measurement. Furthermore, the method can be performed such that the step of determining whether the position based on the GNSS measurement was significantly affected by multipath comprises computing a difference between the first position-related datum and the second position-related datum. Preferably, the first position related datum is an altitude or an acceleration and optionally the altitude is calculated using an atmospheric model.
In certain embodiments, the method will further comprise the step of filtering the difference between the first position-related datum and the second position-related datum with a complementary filter having as an input a corresponding position-related datum derived from GNSS signals. Optionally, the complementary filter comprises a high-pass filter and a low-pass filter.
Other embodiments relate to a portable navigation system, comprising a GNSS sensor; a physical sensor; and a microprocessor configured to use input derived from the GNSS sensor and the physical sensor to perform multipath mitigation. The portable navigation system can be configured such that the physical sensor is a pressure sensor, and the system comprises a machine-readable medium comprising software instructions that, when executed by the microprocessor, perform a method comprising the steps of computing a GNSS position; computing a position change based on a measurement derived from the physical sensor; and comparing the position change against a threshold to determine whether the GNSS position is likely to be significantly affected by multipath. The position change preferably comprises a change in altitude; and the method advantageously further comprises augmenting the GNSS position with altitude information derived from the physical sensor through the use of a complementary filter.
Numerous embodiments of the present invention relate to improving the accuracy of position fixes and the concept of “multi path mitigation” in navigation systems. As used herein, “multipath mitigation” means a lessening of detrimental effects of multipath signals.
In general, embodiments of the invention accomplish improved accuracy and multipath mitigation by using information, which may be any kind of information, usually encoded as a digital or analog signal, derived from a sensor that provides information from a source other than the primary GNSS system being used for position fixes. For example, if the sensor is provided to supplement a Galileo receiver, the sensor may be based on a GPS receiver. Here, the term “derived from” means “retrieved as the direct output of’ or “modified from the output of’. The sensor may also be a “physical sensor”. A physical sensor is a device that senses the more immediate physical environment of the receiver, as opposed to a sensor that detects wireless signals broadcast by distant transmitters such as navigation satellites or remote pseudo-lites. Examples of physical sensors can include inertial sensors, altimeters, speedometers, etc.
A number of inventive concepts will become clear if explained in reference to a receiver embodiment that employs a pressure sensor to monitor altitude and uses information about the altitude to improve its position fix calculations. The pressure information relayed by the sensor provides physical information about the position and displacement of the receiver between GPS fixes. If multi path is experienced by the GPS section of the receiver, the calculated position will significantly vary from one fix to another. The fix will shift significantly in vertical and horizontal directions. The instantaneous shift (meaning the shift between two fixes adjacent in time, here assumed to be 1 second apart) can be in the order of meters horizontal and vertical. The sudden jump in position from one second to the other represents an acceleration incompatible with the actual acceleration capabilities of the user using the receiver. The difference between calculated GPS vertical position and altitude as measured by the pressure sensor is used as a multi path detection mechanism. In other embodiments, the GNSS position fixes are filtered using sensor data to improve their accuracy and to mitigate the effects of multipath and other errors.
This concept is illustrated in
Physical sensors can be used to detect these sorts of multipath effects. If the user were physically moved from a static position to a position 40 meters away within one second, and if one makes the assumption of a constant positive acceleration in the first half of the one second interval, and a negative constant acceleration in the second half of the one second interval, to come to rest after one second, the constant acceleration should be 160 m/s2 or +16 G for 0.5 s and −16 G for the remaining 0.5 s, with a maximum velocity of 288 km/h at 0.5 seconds. Such acceleration is highly unlikely for any receiver that is associated with the location of a human being. Thus, appropriate for any particular application, a threshold change can be chosen that can be used to determine whether or not a particular GNSS position fix is likely to be significantly affected by multipath. The choice of the threshold can depend, of course, on the expected velocity of the receiver as illustrated in the above example. Preferred embodiments will compare a calculated GNSS displacement with a vertical displacement measured, for example by means of a pressure sensor.
Currently available pressure sensors using, for example, MEMS (Micro electromechanical Systems) technology, have a resolution level in equivalent altitude of about 0.2 meters. One example of such a sensor is the SMD-500 manufactured BOSCH Sensortec. Such sensors have a relatively good dynamic response, sufficient to track stair climbing for example. It is generally possible using MEMS technology to determine the current floor of a user.
While pressure information is continuously varying due to weather conditions, the time constant of this variation is in tens of minutes. Pressure sensor information can thus be calibrated by the GNSS information. GNSS information is absolute accurate information, but with high noise level. Pressure derived altitude information is relative information, but with a quite accurate relative displacement. That is, GNSS positioning has a lower accuracy, but produces a position relative to known Earth-centered Earth-fixed coordinates. A pressure sensor produces a pressure relative to a standard which is slowly varying, but which can be assumed to be the same between any two GNSS fixes. The blending of both types can be done, for example, by a complementary filter or by a Kalman Filter. This will produce a more accurate altitude component of position which can be used to improve the overall fix.
In preferred embodiments, the pressure sensor will be calibrated using altitudes calculated directly from single position fixes rather than Kalman-filtered altitudes. The Kalman-filtered altitudes have lower noise, but some bias due to the smoothing effect over many measurements. The pressure sensor, on the other hand, has inherently low intersample noise, but provides only relative accuracy. It is therefore not advantageous to sacrifice absolute accuracy for better noise characteristics in the calibration standard.
The same technique, i.e. detecting the discrepancy between GNSS reported position and sensor-reported information over short intervals for multipath mitigation, can be used with other sensors, the most natural being accelerometers. Certain additional difficulties are created thereby, including that an accelerometer in some embodiment would need extra attitude information. In other embodiments, an accelerometer can be used to determine whether the average acceleration regardless of direction is consistent with an acceleration as determined by a GNSS system.
A pressure sensor, in contrast has a natural assumed displacement measurement direction (vertical). Accelerometers could be used to detect spurious acceleration, but the conversion of acceleration into a displacement equivalent is difficult. There may also be some spurious exception conditions, for example, when the accelerometer detects an impact shock. Also, vertical acceleration will be much less than horizontal one, so it will generally be more difficult to detect between true and false acceleration.
In certain embodiments, a pressure sensor can be calibrated using GPS information to derive an accurate altitude. This pressure sensor calibration is not necessary for multi path mitigation, as one is interested in the sudden, relative variations or lack thereof in the altitude, but calibration can be done where absolute altitude measurements are desirable. In order to avoid the “pollution” of the pressure sensor calibration with multipath effects, the calibration has a very long time constant (in the order of 30 to 100 seconds minimum). That is, calibration (or setting of the baseline pressure relative to which displacements are measured) takes place over many GNSS fix cycles. A receiver using a pressure sensor system can also be configured to disable or suspend the calibration operation if the GPS position is recognized as being of low quality, for example, through a determination that pseudorange residuals are too high, or that vertical residuals are too high. In such a case, the operation can be configured to coast, using previous calibration values.
In practice, usually only one satellite at a time will be afflicted by transitory multipath. The above-described techniques can detect which satellite is at fault, simply by measuring the residual of each satellite as compared with the propagated position from the inertial/pressure sensors. This allows the receiver to make the position fix more accurate by rejecting measurements from the satellite afflicted with multipath or by coasting previous values.
Alternatively, an extra pseudorange error for one satellite can be measured against the data derived from a physical sensor, at the accuracy of the physical sensor. This allows a check of every satellite for accuracy against this reference, without depending on group-based techniques such as RAIM (Receiver Autonomous Integrity Monitoring).
GPS sensor 202 generates GPS pseudorange measurements at 204 and GPS delta pseudorange measurements at 206. The GPS pseudorange measurements are passed to a position solution section 208, which can be a least-squares type position solution algorithm as shown. Similar to the pseudorange measurements, delta pseudorange measurements are passed at 206 to a velocity solution section 214, which may be a least squares velocity solution section as shown. Here, the term “section”, refers generally to code, circuitry or both configured to perform a certain function, usually being identifiable as a method, object or logical grouping of software instructions. If implemented as code, a section will generally be executed by an integrated circuit having a central processing unit, such as a microprocessor, microcontroller or application specific integrated circuit with an embedded CPU core. Software instructions for such sections are embedded in a machine readable medium, which can comprise, for example, a non-volatile memory such as Flash memory as an integrated circuit chip or portion of a chip.
Position solution section 208 outputs pseudorange vertical residuals at 210 and GPS-calculated altitude at 212 (shown as point A). The output 210 is connected to threshold section 242. Threshold section 242 determines whether the vertical pseudorange residuals are within acceptable limits, and if not, stops the input of data to Kalman filter 234 using switches 238 and 236, which are preferably the calculated vertical software functions. The inputs can be suspended if pseudorange differences exceed a certain threshold, as calculated by threshold section 242, i.e. if it is likely that multipath has reduced the accuracy of a particular measurement to a significant extent. This allows the Kalman filter to coast and prevents the filter, and ultimately atmospheric model section 226, from being too heavily influenced by multipath distorted position fixes. GPS altitude output 212 is also differenced at 232 with a barometric altitude output 227 from atmospheric model section 226.
The resulting difference is fed to an input of Kalman filter section 234, here shown as a two-state Kalman filter, over switch 238. Here the term “input”, when used as a noun, means connection suitable for conveying information, such as a software function, or equivalent hardware such as a wire or interconnect, or a group of wires or interconnects arranged as a bus, for example. To improve the accuracy of the system, the Kalman filter section 234 is used to estimate P0 and Tgrad which are parameters that can be used by atmospheric model section 226. The Kalman Filter observables are, for example: (1) altitude difference between the pressure sensor and GPS; and (2) the altitude variation difference between pressure sensor and vertical velocity (delta range), between two fixes. The internal states are: (1) P0, the pressure at mean sea level (2) Tgrad, the lapse in degrees Celsius/km. The process model of P0 and Tgrad is a random walk, with a time constant to be adjusted on the weather conditions. Of course, Kalman filters with more or fewer states are possible, as are embodiments with no Kalman filters.
Variation in GPS altitude is output at 216 from velocity solution section 214 and differenced with barometric altitude differences 229 at 230. The resulting double difference is input at 236 to Kalman filter section 234. The altitude difference is generated by the output of pressure sensor 218 by passing it at 220 to a decimating filter 222, the output of which is in turn passed at 224 to an atmospheric the model 227 is differenced with a singlemodel section 226. The series output of stage delayed version of itself 228 to produce barometric altitude differences.
The standard atmosphere defined by the document US Standard Atmosphere 1976 (NOAA/NASA) “NOAA SIT 76-1562” can be used as a starting point for atmospheric model section 226. It defines a hydrostatic formula that relates atmospheric pressure and altitude, introducing two parameters, the pressure at sea level (P0=1013 hPa), and the lapse, or temperature variation with altitude (Tgrad=6.5 degrees C./km). The GPS altitude can be used for calibrating these two parameters. Barometric altitude is centered at the mean sea level, whereas the GPS altitude is defined above the geoidal ellipsoid as defined in the WGS84 reference system.
The standard model referred to above has the form:
wherein
P0=Static reference pressure (Pascal)
T0=Standard temperature (Kelvin)
Tgrad=Standard temperature lapse rate (Kelvin per meter)
h0=Reference altitude (meters)
Rå=Universal gas constant for air
g0=Gravitational constant and
M=Molar mass of Earth's air.
The atmospheric model section 226 takes as inputs 240, for example, the pressure at sea level P0 and the temperature gradient Tgrad. These are Kalman filter states as calibrated by the GPS altitude and vertical velocity solutions, and are received from Kalman filter section 234.
The barometric altitude has accurate relative information, with meter level or less altitude noise, but not particularly accurate absolute altitude. It is, however, quite responsive to fast altitude variations. In contrast, the GPS altitude has a good non-biased accuracy under nominal reception conditions, but has quite high altitude noise, which can be as large as 20 meters.
A blending filter implemented with a complementary filter architecture is used in the embodiment shown in
A complementary filter can be defined as a filter that receives two types of information and performs a filtering operation that advantageously uses complementary characteristics of both information types to produce a single output with improved characteristics. A complementary filter is advantageously used when, as here, the same information is available through different sensors, each of which has quite different noise characteristics. The absolutely low frequency accurate information (GPS information) is filtered with a low-pass filter, and the relatively fast, accurate pressure sensor-derived altitude is high-pass filtered. Preferably, the response of both filters is carefully controlled such as, for example, by ensuring that the sum of the amplitude responses of the low pass and high pass filters are exactly equal to one over the whole frequency range, effectively guaranteeing an “all pass” characteristic for the parameter of interest (altitude), but with differing noise processing. This technique as shown in
The complementary filter should take altitude on both sides of the filter. The natural information from the pressure sensor is obviously pressure, and the standard atmospheric pressure formula can be used. It could be used as is, as the altitude/pressure gradient of the model is not too sensitive to P0 and Tgrad. The P0 is effectively eliminated by the complementary filter.
Using certain embodiments, the absolute altitude can be measured with an accuracy of 5 meters or less, specifically about 2-3 meters, good enough to resolve between stacked roads. A typical example is the Bay Bridge in the Bay Area, with an interdeck vertical distance of 10 meters. The absolute accuracy is good enough to unambiguously discriminate between levels.
Stacked roads include two roads or freeways superposed on top of each other, usually going in the same direction (for example, Upper and Lower Wacker, in Downtown Chicago). The upper road is almost in open sky conditions, so the quality of the GNSS fix is quite good. However, a GNSS receiver mounted on a vehicle on the lower road level will experience quite large multipath distortion, because of the metallic structures in the immediate environment, diminishing the quality of the fix significantly.
Usually these superposed roads do not have the same exits, and the lack of knowledge concerning which road the vehicle is actually on creates major errors on the routing instructions (often, the user will be asked to exit at an exit that is accessible only on the other level).
Other similar situations include a freeway on a bridge, with a parallel road running underneath or a cloverleaf structure, with an exit going up or down in altitude compared to the direct straight line. An accurate altitude allows an early warning to the driver that he or she is on the wrong exit, even if the wrong road is running parallel to the desired road, too close to be safely discriminated with the GPS horizontal accuracy only.
The vertical accuracy of a road survey using state of the art using Mobile Mapping Technologies, either terrestrial (using DGPS, INS, and 360 degrees cameras for stereoscopic remote georeferencing) or airborne (using DGSP, INS, and LIDAR) is about 0.1 meters to 0.3 meters of absolute accuracy. This information is not necessarily inserted into the mapping database as delivered to the end customer as in Personal Navigation Devices (PND), because of unusability in the final PND. The described absolute altitude determination technique make availability of accurate vertical mapping information valuable, especially in the case of stacked roads.
In order to make altitude mapping useful for such situations, embodiments of the invention provide accurate absolute altitude for determining along which level of stacked roads the car is actually moving. The reported Absolute altitude Accuracy needs to be consistently better than half the minimum distance between the stacked roads (which is about 9-10 m).
A test of an embodiment appropriate for such situations is explained in reference to
The test was performed on the Bay Bridge on Interstate 80 between San Francisco and Alameda Counties. The length of the bridge is 23,000 feet (4.5 miles). The bridge comprises a westbound and eastbound portion. The West Bay Suspension Bridge has a Length 9260 feet (2822 meters), and a vertical clearance of 220 feet (58 meters). The East Bay Cantilever Bridge has a length of 10,176 feet (3101 meters), and a vertical clearance 191 feet (67 meters). Spacing between the upper (westbound) deck and the lower (eastbound) deck is about constant at ten meters for most of the length of the bridge. Because the lower level does not have a clear view of the sky, receivers traveling eastbound experience significant multipath interference.
The GPS receiver heading westbound has a clear view of the sky and thus tracks the altitude smoothly, which results in curve 302. Because of multipath the Kalman filter altitude for the eastbound deck, curve 304, shows severe overshoots causing the east bound altitude to appear greater than it actually is by more than 10 meters. This makes it very difficult to distinguish between the two levels. At point 306, the two cures actually cross, and the eastbound deck appears to be above the westbound deck.
For the measurements as recorded in
It is envisioned that the embodiments of the invention will also be useful for pedestrian navigation in narrow and winding streets. This includes so-called “last mile” navigation (navigation from the car to the building) as well as pedestrian tourism in cities (reliable turn-by-turn navigation in very narrow streets). Such navigation can not rely on map matching techniques, since pedestrians are not constrained to roads. Therefore, the horizontal accuracy must be better than half the typical distance between two streets in narrow urban environment.
By using per satellite multipath detection, flagging, and compensation as described herein based on difference between physical world (pressure sensor) and GPS measurements, effective pedestrian navigation can be implemented. A multipath-free altitude Kalman filter is generated by GPS and pressure sensor measurement blending. This eliminates the DTM (Digital Terrain Model) based altitude aiding in existing techniques.
Multipath mitigation can be accomplished on a per satellite/per pseudo-range basis MP detection by using probability data association techniques. A 1-D position fix can be performed using pressure sensor data and knowledge of time. A Kalman Filter is used to estimate of the vertical multipath offset for each satellite. A second horizontal Kalman filter is used to generate corrected/deweighted pseudo ranges. This is the equivalent of having an extra satellite with good intermeasurement noise characteristics located at the center of the Earth, and results in a better position more often with an extra virtual satellite (only 3 satellites are required for 3-D position). Altitude aiding information can be inserted in the altitude aiding port of the Kalman Filter.
Using the virtual satellite provided by the pressure sensor it is possible to determine the variation of pseudo-ranges individually per satellite, not just as a global position error. In an urban canyon environment, for example, there will usually be at least two satellites that are not affected by multipath. It is therefore possible to do a 1-D position fix in the vertical dimension with these two satellites, if an approximate user horizontal position is known. The position solution results in an altitude and a local clock bias. The difference between the predicted position and the actual position for a given satellite is then used as the input variable to a weighting function that is used to weight the actual measured pseudorange in the Kalman filter. A 1-D position fix can be repeated for all available satellite combinations. The satellites with multipath will be automatically rejected because of the weighting functions.
Once the altitude is known, a horizontal pseudorange error can be calculated, since the satellite elevation is known via ephemeris data. The horizontal pseudorange error is passed to a separate horizontal Kalman filter. One can then predict using a pressure sensor the position and clock at time t+1.
Altitude Kalman filter 602 receives pressure sensor information at input 606 and pseudorange values per available satellite at input 608, and outputs altitude information at output 610, local clock bias at output 612 and horizontal pseudorange offset estimates at output 614, as calculated, for example, using 1-D vertical position fixes as described above. Horizontal Kalman filter 604 receives these as inputs and, using the data in combination with actual pseudoranges (not shown) calculates a final latitude and longitude, which is presented to the user along with the filtered altitude information.
In another embodiment, the pressure sensor is simply used to detect when a sudden change in vertical position takes place for a particular satellite, and the corresponding satellite can be blocked or deweighted.
Embodiments of the invention are also envisioned to be useful for indoor navigation, where the resolution of the pressure sensor aided navigation solution is enough to determine which floor of a building the user is on. It is much more accurate than the GNSS solution only, that will be even better for vertical positioning.
As it will be apparent to a person of skill in the art, the above-described embodiments can be modified in any of a variety of ways while not departing from the core teachings of the invention. The above-described embodiments are not intended as any way to be a limitation or disclaimer of subject matter, but rather intended to inform the following claims.
Patent | Priority | Assignee | Title |
10655961, | Sep 16 2016 | FORTRESS CREDIT CORP , AS AGENT | Systems and methods for determining an altitude error value associated with an estimated altitude of a mobile device |
10731981, | Jul 21 2017 | Elbit Systems of America, LLC | Device and method for combined altitude display |
10849205, | Oct 14 2015 | ALLY BANK, AS COLLATERAL AGENT; ATLANTIC PARK STRATEGIC CAPITAL FUND, L P , AS COLLATERAL AGENT | Luminaire having a beacon and a directional antenna |
11294066, | May 22 2017 | CYCLOMEDIA TECHNOLOGY B V | Method for estimating a position of a mobile device using GNSS signals |
11418914, | Jun 11 2020 | NextNav, LLC | Characterizing height above terrain confidence |
9416003, | Feb 24 2014 | NXP USA, INC | Semiconductor die with high pressure cavity |
9671300, | Mar 16 2015 | Apple Inc | Electronic devices with low-noise pressure sensors |
Patent | Priority | Assignee | Title |
4750197, | Nov 10 1986 | INTEGRATED CARGO MANAGEMENT SYSTEMS | Integrated cargo security system |
5210540, | Jun 18 1991 | Pioneer Electronic Corporation | Global positioning system |
5265025, | Jul 11 1990 | Mitsubishi Denki Kabushiki Kaisha | Navigation system using satellite signals |
5646857, | Mar 31 1995 | Trimble Navigation Limited | Use of an altitude sensor to augment availability of GPS location fixes |
5877696, | Apr 09 1996 | Security system for warheads | |
5897605, | Mar 15 1996 | CSR PLC | Spread spectrum receiver with fast signal reacquisition |
5939982, | Jun 09 1997 | TEKTRAP SYSTEM INC | Apparatus for monitoring opening of sealed containers |
6041280, | Mar 15 1996 | CSR TECHNOLOGY INC | GPS car navigation system |
6061018, | May 05 1998 | SnapTrack, Inc.; SNAPTRACK, INC | Method and system for using altitude information in a satellite positioning system |
6125325, | Apr 25 1996 | CSR TECHNOLOGY INC | GPS receiver with cross-track hold |
6216064, | Feb 24 1998 | AlliedSignal Inc.; AlliedSignal Inc | Method and apparatus for determining altitude |
6236937, | Apr 25 1996 | CSR TECHNOLOGY INC | GPS receiver with cross-track hold |
6289280, | Dec 10 1999 | QUALCOMM INCORPORATED, A DELAWARE CORPORATION | Method and apparatus for determining an algebraic solution to GPS terrestrial hybrid location system equations |
6292749, | Apr 25 1996 | CSR TECHNOLOGY INC | GPS receiver with cross-track hold |
6400753, | Apr 25 1996 | CSR TECHNOLOGY INC | Pseudo-noise correlator for a GPS spread spectrum receiver |
6421609, | Apr 25 1996 | CSR TECHNOLOGY INC | GPS receiver with cross-track hold |
6466161, | Aug 24 2000 | CSR TECHNOLOGY INC | Location services system that reduces auto-correlation or cross-correlation in weak signals |
6574558, | Apr 25 1996 | CSR TECHNOLOGY INC | GPS receiver with cross-track hold |
6756983, | Jun 21 2001 | Bellsouth Intellectual Property Corporation | Method of visualizing data |
6774762, | Aug 14 1997 | Round Rock Research, LLC | Secure cargo transportation system |
6836667, | Sep 19 2000 | Alcatel Lucent | Method and apparatus for a wireless telecommunication system that provides location-based messages |
6927688, | Apr 02 2003 | CACI International Inc. | Method for enabling communication and condition monitoring from inside of a sealed shipping container using impulse radio wireless techniques |
7129837, | Apr 09 2003 | SAVI TECHNOLOGY, INC | Continuous security state tracking for intermodal containers transported through a global supply chain |
7333015, | Mar 24 2004 | CommerceGuard AB | Method and system for monitoring containers to maintain the security thereof |
7342497, | Aug 26 2004 | Avante International Technology, Inc | Object monitoring, locating, and tracking system employing RFID devices |
7356835, | Aug 26 2003 | Mitel Networks Corporation | Security monitor for PDA attached telephone |
7427918, | Oct 05 2004 | Accenture Global Services Limited | Cargo security sensing system |
7522043, | Jan 20 2006 | The Boeing Company | Mobile wireless mesh technology for shipping container security |
7623029, | Nov 14 2005 | GlobalTrak Acquisition, LLC | System and method for lot based processing and tracking in a container security system using wireless communications |
20020017977, | |||
20040012502, | |||
20040054470, | |||
20040056767, | |||
20040257225, | |||
20050222758, | |||
20050276363, | |||
20060055564, | |||
20060100781, | |||
20060220842, | |||
20060232052, | |||
20070013519, | |||
20070050101, | |||
20070228703, | |||
20070268135, | |||
20080067792, | |||
20080082237, | |||
20080129493, | |||
20080147280, | |||
20080231438, | |||
20080243342, | |||
20080252450, | |||
20080272580, | |||
20080277911, | |||
20080284145, | |||
20080303663, | |||
20090096669, | |||
20100204916, | |||
20110046915, | |||
CN1677059, | |||
CN1916638, | |||
DE10044393, | |||
JP11345374, | |||
JP2000167208, | |||
JP2001014504, | |||
JP2001194169, | |||
JP2001325245, | |||
JP2003075172, | |||
JP2004500573, | |||
JP2005538000, | |||
JP2007022782, | |||
JP4369492, |
Executed on | Assignor | Assignee | Conveyance | Frame | Reel | Doc |
Jun 04 2008 | Qualcomm Incorporated | (assignment on the face of the patent) | / | |||
Apr 30 2009 | NEMERIX, SA | Qualcomm Incorporated | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 023970 | /0922 | |
Sep 17 2009 | GARIN, LIONEL J | Qualcomm Incorporated | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 023484 | /0745 |
Date | Maintenance Fee Events |
Sep 24 2018 | REM: Maintenance Fee Reminder Mailed. |
Mar 11 2019 | EXP: Patent Expired for Failure to Pay Maintenance Fees. |
Date | Maintenance Schedule |
Feb 03 2018 | 4 years fee payment window open |
Aug 03 2018 | 6 months grace period start (w surcharge) |
Feb 03 2019 | patent expiry (for year 4) |
Feb 03 2021 | 2 years to revive unintentionally abandoned end. (for year 4) |
Feb 03 2022 | 8 years fee payment window open |
Aug 03 2022 | 6 months grace period start (w surcharge) |
Feb 03 2023 | patent expiry (for year 8) |
Feb 03 2025 | 2 years to revive unintentionally abandoned end. (for year 8) |
Feb 03 2026 | 12 years fee payment window open |
Aug 03 2026 | 6 months grace period start (w surcharge) |
Feb 03 2027 | patent expiry (for year 12) |
Feb 03 2029 | 2 years to revive unintentionally abandoned end. (for year 12) |