The present Application claims priority to and incorporates by reference PCT/FR2007/000255 filed Feb. 12, 2007 and French Application 0601819 filed Mar. 1, 2006.
None.
None.
None.
(1) Field of the Invention
The present invention relates to a hybrid positioning method and device.
(2) Description of Related Art
The technical field of the invention is that of manufacturing navigation systems mounted on board helicopters.
The present invention relates in particular to a navigation and/or positioning method and device in which inertial measurements are combined with data relating to the distance ranges between a moving body carrying the device (in particular a rotorcraft) and satellites.
In the meaning of the present application, and without explicit or implicit indication to the contrary, the terms “measurement”, “data”, “signal”, and their derivatives are considered as being equivalent, and the verbs “combining”, “hybridizing”, “coupling”, as well as their derivatives are also considered as being equivalent.
Generally speaking, a GPS receiver comprises four main blocks or modules:
This block thus delivers the position and the time of the receiver corrected for its bias, and where appropriate a measurement of the derivative of the position of the moving body, i.e. the velocity of the carrier.
It is known that such range data relative to satellites can be combined with inertial data delivered by an inertial navigation unit on board the moving body, by using a Kalman filter so as to determine the position of the moving body, e.g. as described in the document “GPS and INS integration with Kalman filtering for direct geo-referencing of airborne imagery”, ETH Hönggerberg, Zurich, Institute of Geodesy and Photogrammetry.
The meanings of the usual abbreviations as used below are summarized as follows:
AAIM: aircraft autonomous integrity monitoring;
AFCS: automatic flight control system;
ARAS: aircraft based augmentation system;
EGNOS: European geostationary navigation overlay system;
FIFO: first-in, first-out;
FMS: flight management system;
GBAS: ground based augmentation system;
GNSS: global navigation satellite system;
GPS: global positioning system;
INS: inertial navigation system;
PVT: position, velocity, time;
RAIM: receiver autonomous integrity monitoring;
SEAS: spaced-based augmentation system;
TTA: time to alert;
VCO: voltage controlled oscillator;
WAAS: wide area augmentation system.
A particular object of the invention is to enable breakdowns in a GNSS to be passivated and to enable a hybrid GNSS/INS positioning and/or navigation system to continue operating in survival mode.
Amongst satellite-based navigation systems, after the “Transit” satellite system of the 1970s that enabled a position to be determined once every 90 minutes with one kilometer accuracy, there appeared the GPS navigation system which transmits non-encoded signals i.e. “in clear”, known as “Coarse Acquisition” (C/A) signals.
A major limitation of that system is its lack of integrity. Firstly the rate at which satellites break down is of the order of 10−4 per hour (h−1). Secondly, GPS satellites do not communicate one with another. Therefore they do not monitor one another mutually. Finally, the ground segment of the GPS system is not sufficiently dense to provide continuous monitoring of the satellites constellation. The breakdown rate is therefore high, and the time required to inform end users of a breakdown can reach several hours. These two characteristics make the GPS as it stands unusable in applications such as the positioning of a civilian aircraft under instruments flying conditions (IFR).
RAIM, relying on redundancy between the satellites in view, provides only a partial remedy to this situation. When at least five (5) satellites are being picked up and processed by a RAIM receiver, the receiver can generate a plurality of PVT solutions, can compare them with one another, and when a mismatch is detected, can inform the user of the anomaly. If more than five satellites are being processed, then the receiver can locate and exclude a satellite that has broken down.
The drawback is that that type of monitoring leads to protection radii that do not make precision approaches possible, and that the warning radii are of several hundreds of meters.
The purpose of SEAS is to mitigate those limitations, at least in part. A SEAS comprises a continental network of ground stations monitoring the visible portion of the GPS constellation. Real time processing of the data collected by this network serves to identify errors from each of the visible GPS satellites, to identify errors due to the ionospheric propagation delay at each point, with three-dimensional resolution. This is sufficient to make an accurate approach possible at any point on the continent in question, and to detect breakdowns in GPS satellites.
A space segment made up of geostationary satellites can act as a relay for transmitting correction information and information concerning the state of health of the GPS constellation to the receivers of end users; such geostationary satellites also serve as additional navigation data sources, since they transmit navigation messages identical to those from the GPS satellites.
These improvements and additions make it possible to achieve accuracy of meter order (within the three dimensions), with so-called “10−7” protection radii of one decameter order (a vertical protection threshold of 20 meters is available for 99.9% of the time), with a TTA delay in detecting and signaling breakdowns of not more than 6 seconds (s) in compliance with the Do229 standard.
Given the continental size of the arrangement and the bandwidth limitations on signals transmitted by geostationary satellites, the processing and the transfer of information cannot be instantaneous.
The TTA delay in detecting a breakdown and informing the end user constitutes one of the cost factors of a SEAS.
The document “GNSS local component integrity concepts” by Charles S. Dixon, Journal of Global Positioning Systems, 2003, Vol. 2, No. 2, pp. 126-134 deals with means for reducing the length of this delay.
A TTA value of 6 seconds is a maximum that can be accepted by an aircraft having a turning rate (rate of heading variation) that does not exceed about 3 degrees per second (3°/s), and for which the rate of roll angle variation is limited to about 4 degrees per second (4°/s).
However, a helicopter on a steep-slope and low-speed approach is much less stable than an airliner traveling at 150 knots on an ILS slope of 3°. It is therefore necessary on board a helicopter to implement piloting relationships that have much higher degrees of authority than those imposed by the 4°/s to 3°/s limitations of an airliner, and that is not compatible with the usual TTA values.
Thus, SEAS (WAAS or EGNOS) that might be a useful source of navigation data for rotorcraft and drones, in particular, are not adapted to aircraft of these types.
The present invention solves this problem by making it possible in particular to passivate GPS satellite breakdowns detected by the SEAS, to reduce down to zero the delay (TTA) in detecting and signaling breakdowns, and to provide a survival mode in the event of the SEAS being lost completely.
Another object of the invention is to propose a system mounted on board or suitable for mounting on board an aircraft for determining its position by hybridizing pseudo-ranges with other measurements, in particular inertial measurements, which system is improved and/or remedies, at least in part, the shortcomings and drawbacks of systems of that type.
According to an aspect of the invention, satellite positioning data is stored temporarily prior to being delivered to a module for hybridizing that data with non-satellite positioning data, and in the event of a fault signal being detected, at least some of the temporarily stored satellite data is modified.
In another aspect of the invention, there is provided a method of positioning a moving body by combining inertial data ({right arrow over (u)}) with data ({right arrow over ({circumflex over (r)}m) concerning the ranges between the moving body and satellites, comprising the following steps:
a) storing the range data in a FIFO memory so as to have delayed range data available at the output from the memory;
b) combining (combination operation) the delayed range data with the inertial data to obtain an estimate for position data of the moving body; and
c) watching for the appearance of a fault in the range data, and when such a fault is detected, modifying at least some of the data stored in the FIFO memory in a manner that neutralizes (passivates) it, i.e. reduces or cancels its weight (or contribution) in the combination operation.
According to other features of the method:
In another aspect of the invention, an aircraft position-determining device is proposed that is mounted on board or suitable for mounting on board an aircraft, the device comprising:
According to further features of the device:
The invention may be implemented by a processor of a computer on board an aircraft or suitable for mounting on board an aircraft. When this computer is detecting a faulty status, it executes a program including instructions corresponding to the steps of the method of the invention.
Thus, in an aspect of the invention, a program is provided comprising code usable by an aircraft computer to determine the position of the aircraft by combining inertial data ({right arrow over (u)}) with range data ({right arrow over ({circumflex over (r)}m) concerning the ranges between the aircraft and satellites, t. The usable code comprises instructions for:
a) storing range data in a FIFO memory to have delayed range data available at the output from the memory;
b) combining the delayed range data with the inertial data to obtain an estimate ({right arrow over ({circumflex over (x)}) for the position data of the aircraft;
c) watching for the appearance of a fault (i.e. when a DSi signal is produced) in the range data, and when a fault is detected, modifying at least a portion of the data stored in the FIFO memory to decrease or zero its weight in the combination operation; and
d) storing the satellite range data estimate ({right arrow over ({circumflex over (r)}) as a function of the inertial data in a second FIFO memory to have delayed estimates available at the output from said memory, the capacities of the two FIFO memories being equivalent such that the greatest delay value in the delayed estimate is identical to the greatest delay value in the delayed range data.
The invention makes it possible to passivate GPS receiver breakdowns as well as satellite breakdowns, thereby making it possible to use a longer duration for the integrated built-in test cycle, and can make it possible to avoid installing a second receiver.
Other aspects, characteristics, and advantages of the invention appear in the following description which refers to accompanying drawings.
The invention is based on putting the measurements performed by the GPS-SBAS receiver into quarantine for a duration that is long enough to guarantee that they are not erroneous (i.e. during 6 seconds for a SBAS complying with the Do229 standard). This quarantining is performed by a shift register 10 (or FIFO memory) interposed between the output from the GPS-SBAS receiver 11 and the Kalman filter 12 (cf.
Given that piloting the aircraft on the basis of information that is 6 seconds “old” it is not conceived, the device hybridizes the GPS-SBAS measurements with inertial measurements. By installing a second shift register 13 (or FIFO memory) for delaying the inertial data by the same duration as the GPS-SBAS data, hybrid inertial/range data (components of the vector x) presenting no delay is made available upstream from the second register. In addition, the second shift register is considered as a state machine, such that the GPS-SBAS receiver constitutes a particular dynamic observer to which the Kalman filter technique is applied.
The device shown in
The system includes a synthetic representation of a virtual platform (VPF), in which:
Although a virtual platform is not a linear process, this representation is valid for the errors that affect the measurements, i.e. the only quantities of interest for optimum hybridization.
This representation shows that the virtual platform receives as inputs six “strap-down” inertial measurements, and delivers as output an estimate of the state vector of the carrier, and that it can be linearized locally.
The other elements shown in the diagram are:
This diagram represents the following equations:
If the errors affecting the measured pseudo-ranges measurements and the inertial measurements constitute white noise, if R is the covariance matrix of the errors affecting the pseudo-range measurements, and if U is the covariance matrix of the errors affecting the inertial measurements, then the Kalman gain K and the covariance matrix X for the error affecting the estimate {right arrow over ({circumflex over (x)} of the state of the carrier are determined by the system using the following non-linear recurrence equations:
Xk+1|k=FXk|kFT+BUBT
K=Xk+1|kHT(HXk+1|kHT+R)−1
Xk+1|k+1=(I−KH)Xk+1|k
The diagram corresponding to this system is shown in
A representation of a hybrid system of the invention in which observations are “put into quarantine” is shown in
The function of the filter is based on the bounded nature of the time taken to detect a breakdown in the measurement device, in this case the GPS-SBAS system. By way of example, this time is at most 6 seconds for a SBAS system complying with Do229.
To avoid any pollution of the VPF with erroneous GPS-SBAS measurements, the pseudo-range measurement and the a priori a priori estimate of their variances, as calculated by the GPS-SBAS receiver are “quarantined” in the shift register 10 having the number n of stages required to ensure that the time taken to travel along the register coincides with the specified maximum detection delay (or is slightly greater); by way of example, a register is selected having sixty stages (6×10=60) for a GPS-SBAS receiver that delivers data at a frequency of 10 Hz and that has a TTA of 6 s.
In the event of the breakdown of a satellite Si being detected, as indicated by a signal DSi (
These infinite-variance measurements are thus ignored by the filter 12, which simultaneously continues to make use of the measurements relating to the other satellites and to provide a position measurement that is valid with accuracy that is nominal (or hardly degraded providing the number of satellites remaining is sufficient).
After the disappearance of the signal DSi, the time after which valid data leaves the memory, e.g. 1 second, depends on the depth (number of stages) of the shift register 10 and on the frequency at which calculations are iterated.
In the event of a complete breakdown of the positioning system (including a breakdown of the receiver), all of the data from all of the satellites is marked as being invalid, and the filter makes no use of any of the observations and delivers a position that is purely inertia (operating in an open loop) and that has not been polluted.
The optimum filter is determined by applying to the known rule that it is required to constitute an in-line simulation of the process and of its observation means. The second shift register 13 is thus provided at the output from the VPF in a manner that is symmetrical with the register (11) placed at the output form the GPS-SBAS receiver. The stages of this shift register 10 constitute as many additional states of the Kalman filter (6×12=72 states for a 12-channel GPS receiver delivering measurements at 1 Hz and for a TTA of 6 seconds). These states need to be controlled by the filter, so that the loop (vector {right arrow over (c)}) is closed is closed after the gain K in the block diagram of
The relationship between two successive states (corresponding to two iterations of indices k and (k+1)) of a shift register having its input written e, and output written s, can be written in the following form;
Or in more compact form:
{right arrow over (d)}k+1=FF{right arrow over (d)}k+BFe
s=HF{right arrow over (d)}k+1
in which FF, BF, and HF, are the interconnection matrices made up essentially of 0 (zeros) and a few 1 (ones), where the 1 correspond to connections firstly between the “general” input of the shift register and the input of the first stage of the register, secondly between the output of a stage and the input of the following stage, and finally between the output of the last stage of the register and the “general” output of the shift register.
The platform fitted with its shift register can be transcribed by the following equations:
Using the following notations:
this can be written:
which can be processed like any other Kalman filter.
In a method of the invention, the dimensions of the vectors and matrices to be calculated for use are increased. For example, for a GPS receiver providing twelve position components at 1 Hz, with a TTA of 6 s, this provides 12×6×1=72 additional states. Thus, the filter implemented by the invention may have several tens or hundreds of states.
Nevertheless, because the matrices handled are essentially “empty”, there is generally no need to provide memory for all of these elements, nor is there any need to process systematically all of the elements of the matrices and of these vectors.
The inertial/GPS coupling may be tight or loose; for loose coupling, it is possible to use the position data delivered by the GPS receiver, where appropriate together with velocity data; for tight coupling, it is possible to use the pseudo-range data delivered by the GPS receiver, where appropriate together with pseudo-velocity data.
The system of the invention may include a barometric altitude sensor, a magnetometer, and/or an air speed sensor, together with hybridization means for combining the measurements delivered by those sensors with the satellite range measurements, and where appropriate with the inertial measurements. It is then possible to combine the satellite position data with measurements of aircraft speed in (relative to) the air, heading and magnetic field measurements, and/or altitude, and/or barometric pressure measurements.
Number | Date | Country | Kind |
---|---|---|---|
06 01819 | Mar 2006 | FR | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/FR2007/000255 | 2/12/2007 | WO | 00 | 1/16/2008 |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2007/099211 | 9/7/2007 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
5420592 | Johnson | May 1995 | A |
6122595 | Varley et al. | Sep 2000 | A |
6317688 | Bruckner et al. | Nov 2001 | B1 |
6697736 | Lin | Feb 2004 | B2 |
7471238 | Lillo et al. | Dec 2008 | B2 |
20030083792 | Anderson et al. | May 2003 | A1 |
Number | Date | Country |
---|---|---|
2 866 423 | Aug 2005 | DE |
Number | Date | Country | |
---|---|---|---|
20090278740 A1 | Nov 2009 | US |