WO2024008635A1 - Dispositif et procede de maintien de l'integrite du positionnement d'un vehicule independamment de la vulnerabilite de donnees satellitaires - Google Patents

Dispositif et procede de maintien de l'integrite du positionnement d'un vehicule independamment de la vulnerabilite de donnees satellitaires Download PDF

Info

Publication number
WO2024008635A1
WO2024008635A1 PCT/EP2023/068209 EP2023068209W WO2024008635A1 WO 2024008635 A1 WO2024008635 A1 WO 2024008635A1 EP 2023068209 W EP2023068209 W EP 2023068209W WO 2024008635 A1 WO2024008635 A1 WO 2024008635A1
Authority
WO
WIPO (PCT)
Prior art keywords
kalman
filter
sub
main
gnss
Prior art date
Application number
PCT/EP2023/068209
Other languages
English (en)
Inventor
Emmanuel Nguyen
Vincent Chopard
Thomas Lesage
Original Assignee
Thales
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Thales filed Critical Thales
Publication of WO2024008635A1 publication Critical patent/WO2024008635A1/fr

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13—Receivers
    • G01S19/20—Integrity monitoring, fault detection or fault isolation of space segment
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13—Receivers
    • G01S19/14—Receivers specially adapted for specific applications
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
    • G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled

Definitions

  • the present invention relates to a device for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data, suitable for being on board a vehicle capable of moving between two distinct geographical positions, the device comprising at minus: an inertial measurement unit capable of providing navigation measurements, a satellite data receiver, a main closed-loop Kalman filter configured to calculate navigation data corrections by permanent hybridization of satellite positioning data provided by said receiver and non-satellite positioning data provided at least by said inertial measurement unit.
  • the invention also relates to a vehicle comprising such a device for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data.
  • the invention also relates to a method for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data implemented by such a device for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data.
  • the invention also relates to a computer program comprising software instructions which, when executed by a computer, implement such a method of maintaining the integrity of the positioning of a vehicle regardless of the vulnerability of satellite data.
  • the present invention relates to the navigation of a vehicle capable of moving between two distinct geographical positions, such as a land vehicle, an aircraft, or preferably a naval vehicle such as a ship or even a naval vessel.
  • the vehicle generally carries a satellite navigation and positioning system receiver configured to determine, in particular by trilateration, a positioning (ie a geolocation position or even a geolocation solution) of the aircraft using estimates of distances to visible satellites of the same or several satellite constellations of the satellite navigation and positioning system.
  • a positioning ie a geolocation position or even a geolocation solution
  • Examples of satellite navigation systems are the American GPS system, the European GALILEO system, the Russian GLONASS system, or the Chinese BEIDOU system, etc.
  • vehicles also have other navigation systems such as one or more INS (Inertial Navigation System) inertial measurement unit(s), baro-altimeters, anemometers, etc.
  • INS Inertial Navigation System
  • An inertial measurement unit is made up of a set of inertial sensors (accelerometers, gyrometers) associated with processing electronics, and provides low-noise and precise information in the short term, but its performance degrades in the long term, particularly in the long term. made of the sensors that compose it.
  • Such vehicles then implement, for predetermined applications, a position measurement hybridization technique known as INS/GNSS hybridization, capable of providing vehicle location with a precision of the same order of magnitude as the localization by GNSS and very precise attitude and heading angles, while ensuring continuity of service when GNSS is unavailable.
  • INS/GNSS hybridization a position measurement hybridization technique known as INS/GNSS hybridization
  • INS/GNSS hybridization implemented according to current techniques is not optimal for guarding against GNSS errors in the event of satellite failure, GNSS software or hardware fault or even intentional or unintentional interference, nor to provide positioning integrity when such errors occur.
  • the aim of the invention is then to propose a navigation and positioning device which at least makes it possible to maintain the integrity of the positioning independently of the vulnerability of the GNSS measurements.
  • the subject of the invention is a device for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data, suitable for being on board a vehicle capable of moving between two distinct geographical positions.
  • the device comprising at least:
  • an inertial measurement unit capable of providing navigation measurements
  • a main closed-loop Kalman filter configured to calculate navigation data corrections by permanent hybridization of satellite positioning data provided by said receiver and non-satellite positioning data provided at least by said inertial measurement unit, the device further comprising a bank of N Kalman sub-filters in parallel with N a predetermined integer such that N > 1, each Kalman sub-filter being configured for:
  • each Kalman sub-filter is capable of compensating its drift, relating to the calculation of navigation data corrections only from the non-satellite positioning data supplied to the less by said inertial measurement unit, by punctually realigning itself on a solution using satellite data, according to a distinct realignment frequency from one sub-filter to another.
  • the particular architecture of the device for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data according to the present invention makes it possible to carry out a time-shifted adjustment of a sub- filter to another, the adjustment frequency being distinct from one sub-filter to another.
  • the long-term degradation of the performance of Kalman sub-filters is limited. Indeed, this degradation is conventionally due to a drift in the position measurements, received as input, and obtained only from non-satellite measurements provided at least by said inertial measurement unit, and, according to the present invention, is limited to the means of said punctual registration by punctual hybridization with satellite data, which amounts punctually to reproducing the processing carried out by the main Kalman filter. In other words, the point hybridization “is worth” reconfiguration on the main Kalman filter.
  • the registration frequency allows each Kalman sub-filter to take advantage of the short-term precision of the position measurements received as input, and obtained only from non-satellite measurements provided at least by said inertial measurement unit, while avoiding the associated calculation drift in the medium/long term.
  • the device for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data comprises one or more of the following characteristics, taken in isolation or in all technically possible combinations:
  • the N Kalman sub-filters are identical and independent, the period 1/ F Ri corresponding to a period for verifying the integrity of said positioning measurements by GNSS satellites;
  • the device is also configured to:
  • the device is also configured to determine said predetermined threshold as a function of a false alarm probability
  • the main Kalman filter is also configured to reconfigure itself on a predetermined Kalman sub-filter of index p with 1 ⁇ p ⁇ N.
  • said predetermined Kalman sub-filter of index p on which the main Kalman filter is capable of reconfiguring itself in the event of an alarm being raised is the Kalman sub-filter among said N Kalman sub-filters whose setting implementation of said one-off hybridization is temporally furthest from the moment the alarm is raised;
  • said main Kalman filter is configured to no longer use said GNSS satellite positioning measurements as input from the moment the main Kalman filter initiates its reconfiguration;
  • each Kalman sub-filter of index i ⁇ p is also configured to reconfigure itself on said predetermined Kalman sub-filter of index p;
  • the device is also configured to determine a protection radius with respect to a vulnerability of said GNSS satellite positioning measurements, said protection radius guaranteeing that the value of the distance between the hybrid position provided from said main filter of Kalman and the true position of said vehicle is less than the value of said protection radius, said protection radius depending on the number N of Kalman sub-filters; - the device is also configured to provide, at output, in parallel, navigation solutions respectively associated with said bank of N sub-Kalman filters, and said main Kalman filter.
  • the invention also relates to a vehicle comprising such a device for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data.
  • the invention also relates to a method for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data and comprising the following steps implemented in parallel or successively one after the other or vice versa:
  • each Kalman sub-filter apart from the implementation of said point hybridization (i.e. if one of the sub-filters is in adjustment by point hybridization its state is not determined because it will then be identical to that of the main Kalman filter), and the state of the main Kalman filter,
  • determining a protection radius with respect to a vulnerability of said positioning measurements by GNSS satellites said protection radius guaranteeing that the value of the distance between the position hybrid provided from said main Kalman filter and the true position of said vehicle is less than the value of said protection radius, said protection radius depending on the number of Kalman sub-filters.
  • said localization step comprises supplying at output, in parallel, navigation solutions respectively associated with said bank of N sub-Kalman filters, and said main Kalman filter.
  • the invention also relates to a computer program comprising software instructions which, when executed by a computer, implement such a method of maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data as defined above.
  • Figure 1 is a diagram illustrating a navigation and positioning device suitable for implementing INS/GNSS hybridization, and optionally with additional measurements provided by equipment distinct from a satellite data receiver and distinct of said inertial measurement unit;
  • Figure 2 is a diagram illustrating the architecture of the Kalman filter bank according to the present invention.
  • Figure 3 illustrates the closed loop principle
  • Figure 4 is a flowchart of a method of maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data.
  • Figure 1 is an overall representation of a device 10 for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data according to the present invention, suitable for implementing INS/GNSS hybridization, and optionally with complementary measurements provided by equipment distinct from a satellite data receiver and distinct from said inertial measurement unit, and comprising at least one inertial measurement unit 12 capable of providing navigation measurements, in particular to a virtual calculation platform 14 and location, a receiver 16 of satellite data (ie a receiver of positioning measurements by GNSS satellites), and optionally a receiver 18 of complementary measurements provided by at least one piece of equipment distinct from said receiver 16 of satellite data and distinct from said unit of inertial measurement 12, and finally a set K of Kalman filters.
  • a device 10 for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data according to the present invention suitable for implementing INS/GNSS hybridization, and optionally with complementary measurements provided by equipment distinct from a satellite data receiver and distinct from said inertial measurement unit, and comprising at least one inertial measurement unit 12 capable
  • the inertial measurement unit 12 consists of a set of inertial sensors such as gyrometers and accelerometers associated with processing electronics and is capable of providing increments 20 of angular rotation and speed of the vehicle in which the device 10 maintaining the integrity of a vehicle's positioning regardless of the vulnerability of on-board satellite data.
  • the virtual calculation platform 14 integrates such angular rotation and speed increments 20 to provide, as input to the set K of Kalman filters, navigation data 22, such as the orientation of the vehicle, in terms of roll , pitch, yaw, heading, etc., the speed of the vehicle for example the speed Vnord in the North direction, the speed Vest in the East direction, the speed Vbas at the bottom of the trajectory etc., and the position of the vehicle for example in latitude, longitude, altitude.
  • navigation data 22 such as the orientation of the vehicle, in terms of roll , pitch, yaw, heading, etc.
  • the speed of the vehicle for example the speed Vnord in the North direction, the speed Vest in the East direction, the speed Vbas at the bottom of the trajectory etc.
  • the position of the vehicle for example in latitude, longitude, altitude.
  • the satellite data receiver 16 (i.e. GNSS receiver) is capable of providing, according to arrow 24, information on the position and speed of the vehicle by triangulation from the signals emitted by moving satellites visible from the vehicle.
  • the information provided may be temporarily unavailable because the receiver must have a minimum of four satellites in direct view of the positioning system to be able to make a point.
  • They are also of variable precision, depending on the geometry of the constellation at the base of the triangulation, and noisy because they are based on the reception of very low level signals coming from distant satellites having low transmission power. But they do not suffer from long-term drift, the positions of the satellites passing through their orbits being known precisely over the long term.
  • Noise and errors can be related to satellite systems, the receiver or signal propagation between the satellite transmitter and the GNSS signal receiver. Additionally, satellite data may be erroneous due to satellite outages. These non-integrity data must then be identified so as not to distort the position from the GNSS receiver.
  • the optional receiver 18 of complementary measurements 26 provided by at least one piece of equipment distinct from said receiver 16 of satellite data and distinct from said inertial measurement unit 12 provides for example a reset on zero movement when the vehicle is stationary, an Electromagnetic Log measurement and a dynamic model of the vehicle, a Doppler log or a measurement of speed in the water when the equipment is a DVL (English Doppler Velocity Log), a depth measurement, registration by radar, by imaging, by signals opportunities etc.
  • DVL American Doppler Velocity Log
  • the hybridization implemented by the set K of Kalman filters consists of mathematically combining the measurements 22, 24, 26 provided respectively by the unit of inertial measurement 12, the receiver 16 for GNSS satellite positioning measurements, and the optional receiver 18 for complementary measurements 26 to obtain position and speed information by taking advantage of the three elements 12, 16 and 18.
  • Kalman filtering is based on the possibilities of modeling the evolution of the state of a physical system considered in its environment, by means of a so-called “evolution” equation (a priori estimation), and of modeling of the dependency relationship existing between the states of the physical system considered and the measurements of an external sensor, by means of a so-called “observation” equation to allow adjustment of the states of the filter (a posteriori estimation).
  • the effective measurement or "measurement vector” makes it possible to make an a posteriori estimate of the state of the system which is optimal in the sense that it minimizes the covariance of the error made on this estimate.
  • the estimator part of the filter generates a posteriori estimates of the system state vector using the difference observed between the effective measurement vector and its a priori prediction to generate a corrective term, called innovation.
  • This innovation after multiplication by a gain vector of the Kalman filter, is applied to the a priori estimate of the state vector of the system and leads to obtaining the optimal a posteriori estimate.
  • the Kalman filtering implemented by the set K of Kalman filters models the evolution of the errors of the inertial measurement unit 12 and delivers the a posteriori estimate of these errors which is used to correct the positioning point and speed of inertial measurement unit 12.
  • the correction 28 of the errors by means of their estimation made by the set K of Kalman filters is then carried out at the input of the virtual platform 14 according to a so-called “closed loop” architecture as illustrated by Figure 1 making it possible to keep navigation errors low and therefore remain in the linear domain of the set K of Kalman filters.
  • the virtual platform 14 uses such a correction 28 to develop the optimal estimate 30 of the position and speed of the vehicle.
  • Hybridization is called “loose” (or hybridization in geographic axes) when the satellite data receiver 16 provides the position and speed of the vehicle resolved by the GNSS receiver 16.
  • the hybridization is said to be “tight” when the satellite data receiver 16 provides the information extracted upstream by the GNSS receiver which is the pseudo-distances and pseudo-velocities (quantities directly resulting from the measurement of the propagation time and the Doppler effect of signals emitted by satellites towards the receiver).
  • the pseudo-distances and pseudo-velocities quantities directly resulting from the measurement of the propagation time and the Doppler effect of signals emitted by satellites towards the receiver.
  • the set K of Kalman filters according to the present invention has a particular architecture 100 illustrated by Figure 2.
  • the set K firstly comprises a main closed-loop Kalman filter 32 configured to implement permanent hybridization of the satellite positioning data provided by said receiver 16 and the non-satellite positioning data provided at least by said monitoring unit.
  • inertial measurement in other words a hybridization of position measurements, received as input, and obtained respectively from said GNSS satellite positioning measurements 24, and measurements 34 provided both by said inertial measurement unit 12 and by said optional receiver 18 of additional measurements, in order to calculate corrections 36 of navigation data.
  • permanent hybridization we mean that the hybridization is constantly implemented outside the period of reconfiguration of the main Kalman filter 32 as detailed below in the event of a detected lack of integrity of the satellite data.
  • the set K further comprises according to the present invention a bank SF of N Kalman sub-filters SF 1 , SF 2 , ...SF i , SF i+1 , ... SF N , in parallel with each other , and operating on deviations (ie the correction established by the main filter being applied, as detailed below, to the propagation phase of each Kalman sub-filter) with N a predetermined integer such that N ⁇ 1, or even preferentially N >1, each Kalman sub-filter being configured for:
  • the adjustment is, for example, suitable for being carried out every minute (ie a frequency of adjustment F R equal to once per minute, or every day (ie once every twenty-four hours), or even every two days (ie once per forty-eight hours), so that we consider for example that the adjustment frequency FR is included in the range defined by the maximum limit “once per minute” and the minimum limit “once per forty-eight hours” with the possibility of being equal to one of these limits.
  • the second sub-filter of Kalman SF 2 uses the satellite data once per half hour (ie every 30 minutes) and does not use them otherwise apart from this one time per half hour, which amounts to fact that once every half hour, SF 2 operates in an identical manner to the main Kalman filter 32.
  • the adjustment duration as such is notably less than the period 1/F Ri . More precisely, the adjustment duration as such depends generally of the inertial measurement unit (also called inertial unit), and is a fraction of the reciprocal of the adjustment frequency 1/F Ri , for example twenty seconds if the adjustment frequency is one adjustment every two -hundred seconds.
  • this reset duration can be fixed according to a first optional variant, for example twenty seconds for all the sub-filters or variable, according to a second optional variant of the present invention, the reset frequency F R , and/or the reset duration then being distinct from one sub-filter to another and/or associated with a triggering instant (i.e. instant of start of the activity of the sub-filter considered) distinct from a sub-filter to another.
  • the adjustment duration as such is the order of a hundred seconds
  • the readjustment time as such is less and for example of the order of forty seconds.
  • each Kalman sub-filter SF 1 , SF 2 , ... SF i , SF i+1 , ... SF N apart from the implementation of said point hybridization, is configured to calculate corrections 42 of navigation data, solely from non-satellite positioning data provided at least by said inertial measurement unit, in particular here by hybridization of position measurements, received as input, and obtained only from the measurements 34 provided by said unit inertial measurement 12 and provided by said optional receiver 18 of complementary measurements, and does not accept as input, to carry out this calculation outside the implementation of said point hybridization, unlike the main Kalman filter 32, the measurements 24 GNSS satellite positioning.
  • each Kalman sub-filter SF 1 , SF 2 , ... SF i , SF i+1 , ... SF N is configured to calculate corrections 42 of navigation data, solely from the non-satellite positioning data provided by said inertial measurement unit, dispensing with the non-satellite data provided by the optional receiver 18.
  • the N Kalman sub-filters SF 1 , SF 2 , ...SF i , SF i+1 , . . . SF N are identical and independent, the period 1 /F Ri , distinct from one sub-filter to another, corresponding to a period of verification of the integrity of said GNSS satellite positioning measurements 24, by means of each sub-filter separately.
  • the device 10 is also configured to control the integrity of said GNSS satellite positioning measurements by comparing, to a predetermined threshold, the difference between the state 44 of each sub-filter SF 1 , SF 2 , ... SF i , SF i + 1 , ... SF N , apart from the implementation of said point hybridization, and state 46 of the filter main Kalman 32.
  • Element 48 of Figure 2 determines such a deviation and compares it to a predetermined threshold 50.
  • the device 10 is configured to raise, according to arrow 52 in Figure 2, an alarm capable of signaling a vulnerability of said positioning measurements by GNSS satellites.
  • the device 10 is also configured, by means of a calculation tool not shown in Figure 2, to determine said predetermined threshold 50 as a function of a probability of false alarm, as detailed below in relation with figure 4.
  • the main Kalman filter 32 is also configured to reconfigure itself, according to arrow 54, on a predetermined Kalman sub-filter SF P of index p with 1 ⁇ p ⁇ N.
  • reconfigure we mean that the main Kalman filter 32 is capable of copying the state vector and the covariance matrix of the Kalman sub-filter SF P.
  • said predetermined Kalman sub-filter SF P of index p on which the main Kalman filter 32 is capable of reconfiguring itself, according to arrow 54, in the event of alarm 52 being raised is the Kalman sub-filter among said N Kalman sub-filters whose implementation of said point hybridization is temporally furthest from the alarm raising instant.
  • said main Kalman filter 32 is configured to no longer use said GNSS satellite positioning measurements 24 as input from the moment when the main Kalman filter 32 initiates its reconfiguration.
  • the GNSS satellite positioning measurements 24 (whose vulnerability is detected) are no longer used, for example by sending a command to deselect these measurements by input of the set K of Kalman filters.
  • each Kalman sub-filter of index i ⁇ p is also configured to reconfigure itself on said predetermined Kalman sub-filter of index p, which makes it possible to restore a set K with the main Kalman filter 32 and the sub-filters SF 1 , SF 2 , ... SF i , SF i+1 , ... SF N completely healthy.
  • the device 10 is also configured to determine a protection radius 58 with respect to a vulnerability of said positioning measurements by GNSS satellites, said protection radius guaranteeing that the value of the distance between the hybrid position 30 provided from said main Kalman filter 32 and the true position of said vehicle is less than the value of said protection radius 58, said protection radius 58 depending on the number N of Kalman sub-filters.
  • the protection radius generally corresponds to a maximum position error for a given probability of error occurrence, i.e. the probability that the position error exceeds the announced protection radius without an alarm is sent to a navigation system, is less than this given probability value.
  • the calculation is based on two types of error which are on the one hand normal measurement errors and on the other hand errors caused by an operating anomaly of the satellite constellation, for example a breakdown of a satellite.
  • the value of the protection radius of a positioning system is a key value specified by purchasers wishing to acquire a positioning system.
  • the evaluation of the value of the protection radius generally results from probability calculations using the statistical precision characteristics of GNSS measurements and the behavior of inertial sensors. These calculations are explained formally and allow simulations for all GNSS constellation cases, for all possible positions of the positioning system on the terrestrial globe and for all possible trajectories followed by the tracking system. positioning. The results of these simulations make it possible to provide the principal with protection radius characteristics guaranteed by the proposed positioning system. Most often these characteristics are expressed in the form of a value of the protection radius for 100% availability or an unavailability duration for a required value of the protection radius.
  • the determination of the protection radius implemented according to the present invention using the particular architecture 100 of the aforementioned set K of Kalman filters is described below in more detail in relation to Figure 4.
  • the device 10 is also configured to provide, at output, in parallel, navigation solutions 60 and 62 respectively associated with said main Kalman filter, and said bank 38 of N sub-Kalman filters, via the navigation solution determination modules 102 and 104 respectively.
  • the device 10 allows parallel navigation by distinct Kalman filters, namely via the navigation solutions 62 associated with the N Kalman sub-filters SF 1 , SF 2 , ... SF i , SF i+ 1 , ... SF N and via the navigation solutions 60 respectively associated with the main Kalman filter 32.
  • Such an architecture 100 thus makes it possible to provide secondary navigation solutions (associated with each sub-filter), in terms of position, speed, attitude, in parallel with the solution provided by the main filter, such secondary navigation solutions being able to be useful for certain types of navigation, particularly underwater.
  • the device 10 is capable of applying the Cor SF correction of each Kalman sub-filter SF 1 , SF 2 , ... SF i , SF i+1 , ... SF N in the main position state successive time periods) to obtain the position status associated with the SF subfilter: and the same for the Lat SF latitude, the longitude Lon SF , and altitude Alt SF , such that:
  • Alt SF Alt INS/GNSS + Cor SF (Alt)
  • the device 10 for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data comprises a processing unit formed for example of a memory and an associated processor to the memory, and the device 10 is at least partly produced in the form of software, or a software brick, executable by the processor, in particular the set K of Kalman filters, the virtual platform 14 for calculation and location, the element 48 of Figure 2 configured to determine a difference between the state of each sub-filter, apart from the implementation of said point hybridization, and the state of the main Kalman filter, and compare this deviation at a predetermined threshold 50, and optionally the calculation tool configured to determine said threshold 50.
  • the memory of the device 10 for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data is then capable of storing such software or software bricks, and the processor is then able to execute them.
  • the set K of Kalman filters, the virtual calculation and location platform 14, the element 48 of FIG. 2 configured to determine a difference between the state of each sub-filter and the state of the main Kalman filter, and compare this difference to a predetermined threshold 50, and optionally the calculation tool configured to determine said threshold 50 are each produced in the form of a programmable logic component, such as an FPGA (of the English Field Programmable Gate Array), or even in the form of a dedicated integrated circuit, such as an ASIC (English Application Specific integrated Circuit).
  • a programmable logic component such as an FPGA (of the English Field Programmable Gate Array)
  • ASIC American Application Specific integrated Circuit
  • the computer-readable medium is, for example, a medium capable of storing electronic instructions and of being coupled to a bus of a computer system.
  • the readable medium is an optical disk, a magneto-optical disk, a ROM memory, a RAM memory, any type of non-volatile memory (for example EPROM, EEPROM, FLASH, NVRAM), a magnetic card or an optical card.
  • a computer program comprising software instructions is then stored on the readable medium.
  • Figure 3 illustrates the principle of the closed loop applied to the main Kalman filter 32, with the position state X of the main Kalman filter 32, and P its covariance matrix.
  • a module 64 for propagating the main Kalman filter 32 is configured to propagate the state using the navigation equations, and a registration module 66 makes it possible to estimate the state using the GNSS measurements provided by said satellite data receiver 16 and measurements from the optional receiver 18 of complementary measurements provided by at least one piece of equipment distinct from said satellite data receiver 16 and distinct from said inertial measurement unit 12.
  • the closed-loop propagation and registration equations are for the adjustment implemented by module 66: and for the propagation implemented by module 64: with F the propagation matrix, Q the model noise matrix, R the covariance matrix of the measurement noise, H the observation matrix, K the Kalman gain and Z the observation vector obtained from the receivers 16 and 18,
  • the Cor N+1 correction is applied by a correction module 68 to navigation data to obtain the position state _
  • each Kalman sub-filter SF 1 , SF 2 , ... SF i , SF i+1 , ... SF N each sub-filter SF 1 , SF 2 , ... SF i , SF i+1 , ...
  • the propagation and registration equations are therefore for the registration implemented within each Kalman sub-filter operating at the deviations (ie the correction established by the main filter being applied, as detailed below, to the propagation phase of each Kalman sub-filter): and for propagation: with Cor n the correction from the main Kalman filter 32, Z SF the observation vector which is a subset of Z of the main Kalman filter 32 containing only the observations obtained from the receiver 18, and not from the receiver 16 of satellite data when the sub-filter considered does not implement a point hybridization, H SF the observation matrix which contains the lines of H of the main Kalman filter 32 linked to the observations of the sub-filter considered in turn (ie otherwise said H SF contains zeros for the part associated with GNSS satellite positioning measurements) K SF is the gain of the Kalman filter for the sub-filter considered, P SF is the covariance matrix of the Kalman filter for the sub-filter considered.
  • the method 70 for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data implemented by said device 10 for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of data satellites includes the steps described below implemented in parallel or successively one after the other or vice versa.
  • the device 10 for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data implements a localization of said vehicle using the corrections provided respectively by the main Kalman filter and by the bank of N sub-Kalman filters.
  • such a location is suitable for allowing parallel navigation by distinct Kalman filters, namely via the navigation solutions 60 associated with the N Kalman sub-filters SF 1 , SF 2 , ... SF i , SF i +1 , ... SF N and via the navigation solutions 62 respectively associated with the main Kalman filter 32.
  • a step 74 of verifying the integrity of said positioning measurements by GNSS satellites is implemented by the device 10 for maintaining of the integrity of the positioning of a vehicle independently of the vulnerability of satellite data according to the present invention.
  • said verification 74 notably comprises a sub-step 76 of determining:
  • said verification step 74 also includes a sub-step 78 of determining a threshold S capable of being compared to the difference E between the state of each sub-filter and the state of the main Kalman filter.
  • said threshold S is directly provided and determined outside of said device 10 for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data.
  • the navigation and positioning device 10 implements the comparison to said threshold S, at each instant n + 1, of the difference E, between the state of the filter main Kalman 32 and the state of each sub-filter SF 1 , SF 2 , ... SF i , SF i + 1 , ... SF N which is not in the process of point hybridization according to a frequency of registration F Ri included in a range of predetermined frequencies, satellite positioning data provided by said receiver and non-satellite positioning data provided at least by said inertial measurement unit, said registration frequency being distinct from a sub-filter at another.
  • this sub-filter SF i is ignored during said comparison.
  • a step 82 the raising of an alarm A is triggered or not.
  • the integrity maintenance device 10 of the positioning of a vehicle independently of the vulnerability of satellite data then implements the R_P determination of a protection radius with regard to a vulnerability of said measures positioning by GNSS satellites, said protection radius guaranteeing that the value of the distance between the hybrid position provided from said main Kalman filter 32 and the true position of said vehicle is less than the value of said protection radius, said protection radius depending on the number of Kalman sub-filters.
  • Step 90 comprising a first sub-step 92 of reconfiguration Ri of the main Kalman filter 32 on a predetermined Kalman sub-filter of index p with 1 ⁇ p ⁇ N, a second sub-step 94 of reconfiguration R 2 of each Kalman sub-filter of index i ⁇ p on said predetermined Kalman sub-filter of index p, a third sub-step 96 of GNSS_D deselection of the input of the main Kalman filter dedicated to satellite positioning measurements GNSS from the moment the main Kalman filter initiates its reconfiguration.
  • the difference between the state of each sub-filter (when said sub-filter considered does not implement a point hybridization) and the state of the main Kalman filter is determined because if a GNSS measurement is erroneous, it will corrupt the main INS solution /GNSS from the main Kalman filter 32, but not certain solutions from the sub-solutions provided by the N sub-filters capable of carrying out a time-shifted adjustment according to the present invention.
  • sub-step 80 we seek to control the deviation over time for each sub-filter by comparing it, via a predetermined threshold, to the covariance of the deviation of the states.
  • observation matrices of each sub-filter H SF and measurement noise R SF are sub matrices of the observation matrices H and noise of measurement R of the main Kalman filter 32 where the lines (respectively columns) linked to the GNSS measurements have been set to zero (the rest being identical between sub-filter and main filter), and that the propagation matrices F and model noise Q are identical between sub-filter and main filter, then it is demonstrable by recurrence by those skilled in the art that the expectation of (( - covariance P SF - P, which by expanding amounts to an expectation of equal to P the covariance matrix of the main Kalman filter 32.
  • the device 10 for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data according to the present invention determines itself during step 78, said threshold used to compare the deviation to the covariance of the deviation of the states.
  • the difference also follows, by construction of the filters of Kalman a centered Gaussian distribution of standard deviation .
  • branch 88 when, a an anomaly in the GNSS measurements is detected and an alarm is raised.
  • test 82 is carried out, depending on the application, on certain controlled states such as position, speed, attitudes, sensor fault states, etc., and this for the N sub-filters of the architecture.
  • the device 10 for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data then implements the determination of a protection radius with respect to a vulnerability of said positioning measurements by GNSS satellites, said protection radius guaranteeing that the value of the distance between the hybrid position provided from said main Kalman filter 32 and the true position of said vehicle is less than the value of said protection radius, said protection radius depending on the number of Kalman sub-filters.
  • the device 10 for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data introduces a probability of non-detection P nd .
  • the protection radius R p is then defined as follows: with ⁇ N the sum over the N Kalman sub-filters, P lat the diagonal of the covariance matrix corresponding to the latitude state X lat .
  • the determination of the protection radius amounts to looking for the coefficient K nd such that: , so that it is then possible to guarantee that if the deviation is less than , at the time of the GNSS failure, then with a probability of non-detection of the failure of P nd and then:
  • the protection radius preferably corresponds to the maximum value of the protection radii of each of the sub-filters such that: , and this as long as the fault detection has not raised alarm.
  • the protection ray can propagate with the value of the error in the following way: so that it is then preferable to stop the registration mechanism by point hybridization with satellite data 24 of each Kalman sub-filter SF 1 , SF 2 , ... SF i , SF i+1 , ... SF N according to a registration frequency F Ri included in a predetermined frequency range.
  • the previous example of determining the protection radius developed from the latitude state can be generalized to other states such as other position states (longitude, altitude) or even to states of speed or attitude and heading.
  • the architecture of the set K of Kalman filters proposed has the ability to propose a navigation solution not corrupted by the GNSS failure. Indeed, once the alarm is raised, just like the Kalman sub-filters SF 1 , SF 2 , ... SF i , SF i+1 , ...
  • SF N were, prior to this alarm lifting , reconfigured periodically and offset on the main Kalman filter 32, it is possible to reconfigure the main Kalman filter 32 on an uncorrupted Kalman sub-filter, the choice of which is specific to depending on the desired application, a choice preferential and conservative being to take the Kalman sub-filter whose implementation of said punctual hybridization (ie the registration using punctually the GNSS data 24) is temporally furthest from the instant of alarm raising, assuming that the GNSS failure cannot be undetected during , where is the period of maximum duration of the periods corresponding to the adjustment period of each sub-filter of index i.
  • the positioning performance obtained by means of each sub-filter is capable of being evaluated by means of a probable circular error (Circular Error probability), for example a CEP 50 corresponding to a circular error 50% probable, which amounts to the radius of the circle inside which 50% of the values of a two-dimensional measurement sample are found.
  • a probable circular error for example a CEP 50 corresponding to a circular error 50% probable, which amounts to the radius of the circle inside which 50% of the values of a two-dimensional measurement sample are found.
  • the present invention thus proposes an architecture of a set of Kalman filters with registration shifted in time due to a registration frequency distinct from one sub-filter to another making it possible to maintain the integrity of the positioning independently of the vulnerability of GNSS measurements by comparison
  • the primary position resulting from the classic INS/GNSS hybridization carried out via a main Kalman filter 32 using all available measurements as input: GNSS, external position, registration on zero movement when the vehicle is stationary, measurement Electromagnetic log and a dynamic model of the vehicle, Doppler log or DVL, depth measurement, registration by radar, by imaging, registration by opportunity signals, etc.
  • a subset of secondary positions provided by a bank of N Kalman sub-filters not using GNSS measurement input for a certain duration (apart from the implementation of said point hybridization according to a resetting frequency F Ri included in a range of predetermined frequencies, satellite positioning data provided by said receiver and non-satellite positioning data provided at least by said inertial measurement unit, said resetting frequency being distinct from a sub- filter to another), which amounts to using partial measurements.
  • the device 10 for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data is, according to an optional aspect, capable of permanently offering a set of navigation solutions, part of which does not use the measurements.
  • GNSS for some time, typically several hours to several days.
  • the device 10 for maintaining the integrity of the positioning of a vehicle independently of the vulnerability of satellite data is also capable of providing a protection radius against a vulnerability of GNSS measurements and capable of triggering a reconfiguration of the main Kalman filter on a solution of a sub-Kalman filter if a vulnerability in GNSS measurements is detected.
  • a healthy fallback solution is always available in the event of detection of a problem with the GNSS signals.
  • the present invention makes it possible to maintain the integrity of the location, to warn when the GNSS signals are not reliable, to reconfigure on a solution not tainted by the vulnerability of the GNSS measurements, in other words, to reconfigure the main Kalman filter on a “healthy” Kalman sub-filter, and to have available a panel of navigation solutions deduced from Kalman sub-filters having navigated without GNSS measurement for a variable time.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Security & Cryptography (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

L'invention concerne un dispositif de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires comprenant : - une unité de mesure inertielle, - un récepteur de données satellitaires, - un filtre de Kalman principal (32) configuré pour calculer des corrections de données de navigation par hybridation permanente de données satellitaires et de données non satellitaires, et en outre un banc de N sous-filtres (SF1, SF2,... SFi, SFi+1,... SFN) de Kalman en parallèle, chaque sous-filtre de Kalman étant configuré pour : - calculer des corrections de données de navigation par hybridation ponctuelle, selon une fréquence de recalage FRi prédéterminée; - en dehors de la mise en oeuvre de ladite hybridation ponctuelle, calculer des corrections de données de navigation uniquement à partir des données non satellitaires.

Description

TITRE :
DISPOSITIF ET PROCEDE DE MAINTIEN DE L'INTEGRITE DU POSITIONNEMENT D'UN VEHICULE INDEPENDAMMENT DE LA VULNERABILITE DE DONNEES SATELLITAIRES
La présente invention concerne un dispositif de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires, propre à être embarqué à bord d'un véhicule propre à se déplacer entre deux positions géographiques distinctes, le dispositif comprenant au moins : une unité de mesure inertielle propre à fournir des mesures de navigation, un récepteur de données satellitaires, un filtre de Kalman principal en boucle fermée configuré pour calculer des corrections de données de navigation par hybridation permanente de données satellitaires de positionnement fournies par ledit récepteur et de données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle.
L'invention concerne également un véhicule comprenant un tel dispositif de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires.
L'invention concerne également un procédé de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires mis en œuvre par un tel dispositif de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires.
L'invention concerne également un programme d'ordinateur comportant des instructions logicielles qui, lorsqu'elles sont exécutées par un ordinateur mettent en œuvre un tel procédé de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires.
La présente invention concerne la navigation d'un véhicule propre à se déplacer entre deux positions géographiques distinctes, tel qu'un véhicule terrestre, un aéronef, ou préférentiellement un véhicule naval tel qu'un navire ou encore un bâtiment naval.
Actuellement, il est possible de déterminer la position géographique d'un tel véhicule à l'aide d'un système de navigation et de positionnement par satellites GNSS (de l'anglais Global Navigation Satellite System). Pour ce faire, le véhicule embarque généralement un récepteur de système de navigation et de positionnement par satellites configuré pour déterminer, notamment par trilatération, un positionnement (i.e. une position de géolocalisation ou encore une solution de géolocalisation) de l'aéronef en utilisant des estimations de distances aux satellites visibles d'une même ou de plusieurs constellations de satellites du système de navigation et de positionnement par satellites. Des exemples de systèmes de navigation par satellites sont le système GPS américain, le système GALILEO européen, le système GLONASS russe, ou encore le système BEIDOU chinois, etc.
En complément, des véhicules disposent également d'autres systèmes de navigation tels qu'une ou plusieurs unité(s) de mesure inertielle INS (de l'anglais Inertial Navigation System), des baro-altimètres, des anémomètres, etc. Une unité de mesure inertielle est constituée d'un ensemble de capteurs inertiels (accéléromètres, gyromètres) associés à une électronique de traitement, et fournit des informations peu bruitées et précises à court terme, mais ses performances se dégradent sur le long terme, notamment du fait des capteurs qui la composent. De tels véhicules mettent alors en œuvre, pour des applications prédéterminées, une technique d'hybridation de mesures de positions connue sous le nom d'hybridation INS/GNSS, propre à fournir une localisation du véhicule avec une précision du même ordre de grandeur que la localisation par GNSS et des angles d'attitude et de cap très précis, et ce tout en permettant d'assurer une continuité de service lors d'indisponibilité du GNSS.
Cependant, l'hybridation INS/GNSS mise en œuvre selon les techniques actuelles n'est pas optimale pour se prémunir d'erreurs du GNSS en cas de panne satellite, de défaut logiciel ou matériel du GNSS ou encore d'interférence intentionnelle ou non, ni pour fournir un positionnement intègre lorsque de telles erreurs se produisent.
Le but de l'invention est alors de proposer un dispositif de navigation et de positionnement qui permette au moins de maintenir l'intégrité du positionnement indépendamment de la vulnérabilité des mesures GNSS.
A cet effet l'invention a pour objet un dispositif de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires, propre à être embarqué à bord d'un véhicule propre à se déplacer entre deux positions géographiques distinctes, le dispositif comprenant au moins :
- une unité de mesure inertielle propre à fournir des mesures de navigation,
- un récepteur de données satellitaires de positionnement,
- un filtre de Kalman principal en boucle fermée configuré pour calculer des corrections de données de navigation par hybridation permanente de données satellitaires de positionnement fournies par ledit récepteur et de données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle, le dispositif comprenant en outre un banc de N sous-filtres de Kalman en parallèle avec N un entier prédéterminé tel que N > 1, chaque sous-filtre de Kalman étant configuré pour :
- calculer des corrections de données de navigation par hybridation ponctuelle, selon une fréquence de recalage FRi comprise dans une plage de fréquences prédéterminées, de données satellitaires de positionnement fournies par ledit récepteur et de données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle, ladite fréquence de recalage étant distincte d'un sous-filtre à un autre ;
- en dehors de la mise en œuvre de ladite hybridation ponctuelle, calculer des corrections de données de navigation uniquement à partir des données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle.
Ainsi le dispositif de navigation et de positionnement selon l'invention présente une architecture particulière où chaque sous-filtre de Kalman est propre à compenser sa dérive, relative au calcul des corrections de données de navigation uniquement à partir des données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle, en se recalant ponctuellement sur une solution utilisant les données satellitaires, selon une fréquence de recalage distincte d'un sous-filtre à un autre.
En d'autres termes, l'architecture particulière du dispositif de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires selon la présente invention permet d'opérer un recalage décalé dans le temps d'un sous-filtre à un autre, la fréquence de recalage étant distincte d'un sous-filtre à un autre.
En dehors de ce recalage ponctuel, aucun des sous-filtres de Kalman n'utilise en entrée les mesures GNSS pour calculer leurs corrections de données de navigation, ce qui les rends chacun invulnérables par rapport à une éventuelle erreur du GNSS.
En outre, la dégradation sur le long terme de la performance des sous-filtres de Kalman est limitée. En effet, cette dégradation est classiquement due à une dérive des mesures de position, reçues en entrée, et obtenues seulement à partir des mesures non satellitaires fournies au moins par ladite unité de mesure inertielle, et, selon la présente invention, est limitée au moyen dudit recalage ponctuel par hybridation ponctuelle avec les données satellitaires, ce qui revient ponctuellement à reproduire le traitement effectué par le filtre de Kalman principal. Autrement dit, l'hybridation ponctuelle « vaut » reconfiguration sur le filtre de Kalman principal.
Autrement dit, la fréquence de recalage permet pour chaque sous-filtre de Kalman de tirer profit de la précision à court terme des mesures de position, reçues en entrée, et obtenues seulement à partir des mesures non satellitaires fournies au moins par ladite unité de mesure inertielle, tout en évitant la dérive de calcul associée à moyen/long terme.
Suivant d'autres aspects avantageux de l'invention, le dispositif de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires comprend une ou plusieurs des caractéristiques suivantes, prises isolément ou suivant toutes les combinaisons techniquement possibles :
- les N sous-filtres de Kalman sont identiques et indépendants, la période 1/ FRi correspondant à une période de vérification de l'intégrité desdites mesures de positionnement par satellites GNSS ;
- le dispositif est également configuré pour :
- contrôler, l'intégrité desdites mesures de positionnement par satellites GNSS en comparant, à un seuil prédéterminé, l'écart entre l'état de chaque sous-filtre, en dehors de la mise en œuvre de ladite hybridation ponctuelle, et l'état du filtre de Kalman principal, et
- en cas d'écart supérieur audit seuil prédéterminé, lever une alarme propre à signaler une vulnérabilité desdites mesures de positionnement par satellites GNSS ;
- le dispositif est également configuré pour déterminer ledit seuil prédéterminé en fonction d'une probabilité de fausse alarme ;
- en cas de levée d'alarme, le filtre de Kalman principal est également configuré pour se reconfigurer sur un sous-filtre de Kalman prédéterminé d'indice p avec 1 ≤ p ≤ N.
- ledit sous-filtre de Kalman prédéterminé d'indice p sur lequel le filtre de Kalman principal est propre à se reconfigurer en cas de levée d'alarme, est le sous-filtre de Kalman parmi lesdits N sous-filtres de Kalman dont la mise en œuvre de ladite hybridation ponctuelle est temporellement la plus éloignée de l'instant de levée d'alarme ;
- ledit filtre de Kalman principal est configuré pour ne plus utiliser en entrée lesdites mesures de positionnement par satellites GNSS à partir du moment où le filtre de Kalman principal initie sa reconfiguration ;
- en cas de levée d'alarme, chaque sous-filtre de Kalman d'indice i ≠ p est également configuré pour se reconfigurer sur ledit sous-filtre de Kalman prédéterminé d'indice p ;
- le dispositif est également configuré pour déterminer un rayon de protection vis-à-vis d'une vulnérabilité desdites mesures de positionnement par satellites GNSS, ledit rayon de protection garantissant que la valeur de la distance entre la position hybride fournie à partir dudit filtre principal de Kalman et la position vraie dudit véhicule est inférieure à la valeur dudit rayon de protection, ledit rayon de protection dépendant du nombre N de sous-filtres de Kalman ; - le dispositif est également configuré pour fournir, en sortie, en parallèle, des solutions de navigation respectivement associées audit banc de N sous-filtres de Kalman, et audit filtre de Kalman principal.
L'invention a également pour objet un véhicule comprenant un tel dispositif de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires.
L'invention a également pour objet un procédé de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires et comprenant les étapes suivantes mises en œuvre en parallèle ou successivement l'une après l'autre ou inversement :
- localisation dudit véhicule en utilisant les corrections fournies respectivement par le filtre de Kalman principal et par le banc de N sous-filtres de Kalman,
- vérification de l'intégrité desdites mesures de positionnement par satellites GNSS, ladite vérification comprenant :
- la détermination de l'état de chaque sous-filtre de Kalman, en dehors de la mise en œuvre de ladite hybridation ponctuelle (i.e. si l'un des sous-filtres est en recalage par hybridation ponctuelle son état n'est pas déterminé car il sera alors identique à celui du filtre de Kalman principal), et l'état du filtre de Kalman principal,
- la détermination d'un seuil propre à être comparé à l'écart entre l'état de chaque sous- filtre de Kalman et l'état du filtre de Kalman principal,
- la comparaison, de l'écart entre l'état de chaque sous-filtre, en dehors de la mise en œuvre de ladite hybridation ponctuelle, à l'état du filtre de Kalman principal audit seuil,
- en présence d'un d'écart supérieur audit seuil prédéterminé :
- la levée d'une alarme propre à signaler une vulnérabilité desdites mesures de positionnement par satellites GNSS,
- la reconfiguration du filtre de Kalman principal sur un sous-filtre de Kalman prédéterminé d'indice p avec 1 ≤ p ≤ N,
- la désélection de l'entrée du filtre de Kalman principal dédiée aux mesures de positionnement par satellites GNSS à partir du moment où le filtre de Kalman principal initie sa reconfiguration,
- la reconfiguration de chaque sous-filtre de Kalman d'indice i ≠ p sur ledit sous- filtre de Kalman prédéterminé d'indice p,
- en absence d'écart supérieur audit seuil prédéterminé, la détermination d'un rayon de protection vis-à-vis d'une vulnérabilité desdites mesures de positionnement par satellites GNSS, ledit rayon de protection garantissant que la valeur de la distance entre la position hybride fournie à partir dudit filtre principal de Kalman et la position vraie dudit véhicule est inférieure à la valeur dudit rayon de protection, ledit rayon de protection dépendant du nombre de sous-filtres de Kalman.
Selon un aspect particulier dudit procédé, ladite étape de localisation comprend la fourniture en sortie, en parallèle, des solutions de navigation respectivement associées audit banc de N sous-filtres de Kalman, et audit filtre de Kalman principal.
L'invention a également pour objet un programme d'ordinateur comportant des instructions logicielles qui, lorsqu'elles sont exécutées par un ordinateur, mettent en œuvre un tel procédé de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires tel que défini ci-dessus.
Ces caractéristiques et avantages de l'invention apparaîtront plus clairement à la lecture de la description qui va suivre, donnée uniquement à titre d'exemple non limitatif, et faite en référence aux dessins annexés, sur lesquels :
- [Fig 1] la figure 1 est un schéma illustrant un dispositif de navigation et de positionnement propre à mettre en œuvre une hybridation INS/GNSS, et optionnellement avec des mesures complémentaires fournies par un équipement distinct d'un récepteur de données satellitaires et distinct de ladite unité de mesure inertielle ;
- [Fig 2] la figure 2 est un schéma illustrant l'architecture du banc de filtres de Kalman selon la présente invention ;
- [Fig 3] la figure 3 illustre le principe de boucle fermée ;
- [Fig 4] la figure 4 est un organigramme d'un procédé de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires.
La figure 1 est une représentation globale d'un dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires selon la présente invention, propre à mettre en œuvre une hybridation INS/GNSS, et optionnellement avec des mesures complémentaires fournies par un équipement distinct d'un récepteur de données satellitaires et distinct de ladite unité de mesure inertielle, et comprenant au moins une unité 12 de mesure inertielle propre à fournir des mesures de navigation, notamment à une plateforme virtuelle 14 de calcul et de localisation, un récepteur 16 de données satellitaires (i.e. un récepteur de mesures de positionnement par satellites GNSS), et optionnellement un récepteur 18 de mesures complémentaires fournies par au moins un équipement distinct dudit récepteur 16 de données satellitaires et distinct de ladite unité de mesure inertielle 12, et enfin un ensemble K de filtres de Kalman. L'unité de mesure inertielle 12 est constituée d'un ensemble de capteurs inertiels tels que des gyromètres et des accéléromètres associés à une électronique de traitement et est propre à fournir des incréments 20 de rotation angulaires et de vitesse du véhicule dans lequel le dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires est embarqué.
La plateforme virtuelle 14 de calcul intègre de tels incréments 20 de rotation angulaires et de vitesse pour fournir, en entrée de l'ensemble K de filtres de Kalman, des données 22 de navigation, telles que l'orientation du véhicule, en termes de roulis, tangage, lacet, cap, etc, la vitesse du véhicule par exemple la vitesse Vnord selon la direction Nord, la vitesse Vest selon la direction Est, la vitesse Vbas au bas de la trajectoire etc., et la position du véhicule par exemple en latitude, longitude, altitude.
Le récepteur 16 de données satellitaires (i.e. récepteur GNSS) est propre à fournir selon la flèche 24 des informations de position et de vitesse du véhicule par triangulation à partir des signaux émis par des satellites défilants visibles du véhicule. Les informations fournies peuvent être momentanément indisponibles car le récepteur doit avoir en vue directe un minimum de quatre satellites du système de positionnement pour pouvoir faire un point. Elles sont en outre d'une précision variable, dépendant de la géométrie de la constellation à la base de la triangulation, et bruitées car reposant sur la réception de signaux de très faibles niveaux provenant de satellites éloignés ayant une faible puissance d'émission. Mais elles ne souffrent pas de dérive à long terme, les positions des satellites défilant sur leurs orbites étant connues avec précision sur le long terme. Les bruits et les erreurs peuvent être liés aux systèmes satellitaires, au récepteur ou à la propagation du signal entre l'émetteur satellitaire et le récepteur de signaux GNSS. En outre, les données satellites peuvent être erronées par suite de pannes affectant les satellites. Ces données non intègres doivent alors être repérées pour ne pas fausser la position issue du récepteur GNSS.
Le récepteur optionnel 18 de mesures 26 complémentaires fournies par au moins un équipement distinct dudit récepteur 16 de données satellitaires et distinct de ladite unité de mesure inertielle 12 fournit par exemple un recalage sur déplacement nul lorsque le véhicule est immobile, une mesure Loch Electromagnétique et un modèle dynamique du véhicule, un loch doppler ou une mesure de vitesse dans l'eau lorsque l'équipement est un DVL (de l'anglais Doppler Velocity Log), une mesure de profondeur, un recalage par radar, par imagerie, par signaux d'opportunités etc.
L'hybridation mise en œuvre par l'ensemble K de filtres de Kalman consiste à combiner mathématiquement les mesures 22, 24, 26 fournies respectivement par l'unité de mesure inertielle 12, le récepteur 16 de mesures de positionnement par satellites GNSS, et le récepteur optionnel 18 de mesures 26 complémentaires pour obtenir des informations de position et de vitesse en tirant avantage des trois éléments 12, 16 et 18.
Le filtrage de Kalman s'appuie sur les possibilités de modélisation de l'évolution de l'état d'un système physique considéré dans son environnement, au moyen d'une équation dite "d'évolution" (estimation a priori), et de modélisation de la relation de dépendance existant entre les états du système physique considéré et les mesures d'un capteur externe, au moyen d'une équation dite "d'observation" pour permettre un recalage des états du filtre (estimation a posteriori). Dans un filtre de Kalman, la mesure effective ou "vecteur de mesure" permet de réaliser une estimée a posteriori de l'état du système qui est optimale dans le sens où elle minimise la covariance de l'erreur faite sur cette estimation. La partie estimateur du filtre génère des estimées a posteriori du vecteur d'état du système en utilisant l'écart constaté entre le vecteur de mesure effectif et sa prédiction a priori pour engendrer un terme correctif, appelé innovation. Cette innovation, après une multiplication par un vecteur gain du filtre de Kalman, est appliquée à l'estimée a priori du vecteur d'état du système et conduit à l'obtention de l'estimée optimale a posteriori.
Le filtrage de Kalman mis en œuvre par l'ensemble K de filtres de Kalman modélise l'évolution des erreurs de l'unité de mesure inertielle 12 et délivre l'estimée a posteriori de ces erreurs qui sert à corriger le point de positionnement et de vitesse de l'unité de mesure inertielle 12.
La correction 28 des erreurs par le biais de leur estimation faite par l'ensemble K de filtres de Kalman est alors réalisée en entrée de la plateforme virtuelle 14 selon une architecture dite en « boucle fermée » telle qu'illustrée par la figure 1 permettant de garder des erreurs de navigation faibles et donc de rester dans le domaine linéaire de l'ensemble K de filtres de Kalman. La plateforme virtuelle 14 utilise une telle correction 28 pour élaborer l'estimée optimale 30 de la position et de la vitesse du véhicule.
L'hybridation est dite « lâche » (ou hybridation en axes géographiques) lorsque le récepteur 16 de données satellitaires fournit la position et la vitesse du véhicule résolues par le récepteur GNSS 16.
L'hybridation est dite « serrée » lorsque le récepteur 16 de données satellitaires fournit les informations extraites en amont par le récepteur GNSS que sont les pseudo- distances et les pseudo-vitesses (grandeurs directement issues de la mesure du temps de propagation et de l'effet Doppler des signaux émis par les satellites en direction du récepteur). Avec un tel dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires par hybridation INS/GNSS en boucle fermée où le point résolu par le récepteur 16 GNSS est utilisé pour recaler les informations provenant de l'unité de mesure inertielle 12, il est nécessaire de surveiller les défauts affectant les informations fournies par les satellites car le récepteur 16 qui les reçoit propagera ces défauts à l'unité de mesure inertielle 12 en entraînant un mauvais recalage de cette dernière.
Pour ce faire, l'ensemble K de filtres de Kalman selon la présente invention présente une architecture 100 particulière illustrée par la figure 2.
L'ensemble K comprend tout d'abord un filtre de Kalman principal 32 en boucle fermée configuré pour mettre en œuvre une hybridation permanente des données satellitaires de positionnement fournies par ledit récepteur 16 et des données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle, autrement dit une hybridation de mesures de position, reçues en entrée, et obtenues respectivement à partir desdites mesures 24 de positionnement par satellites GNSS, et des mesures 34 fournies à la fois par ladite unité de mesure inertielle 12 et par ledit récepteur optionnel 18 de mesures complémentaires, afin de calculer des corrections 36 de données de navigation. Par hybridation permanente, on entend que l'hybridation est constamment mise en œuvre en dehors de la période de reconfiguration du filtre de Kalman principal 32 tel que détaillé par la suite en cas de manque d'intégrité détectée des données satellitaires. L'ensemble K comprend en outre selon la présente invention un banc SF de N sous-filtres de Kalman SF1, SF2, ...SFi, SFi+1, ... SFN, en parallèle les uns des autres, et fonctionnant aux écarts (i.e. la correction établie par le filtre principal étant appliquée, comme détaillé par la suite, à la phase de propagation de chaque sous-filtre de Kalman) avec N un entier prédéterminé tel que N ≥ 1, voire préférentiellement N>1 , chaque sous-filtre de Kalman étant configuré pour :
- calculer des corrections de données de navigation par hybridation ponctuelle, selon une fréquence de recalage FR comprise dans une plage de fréquences prédéterminées, de données satellitaires de positionnement fournies par ledit récepteur et de données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle, ladite fréquence de recalage étant distincte d'un sous-filtre à un autre ;
- en dehors de la mise en œuvre de ladite hybridation ponctuelle, calculer des corrections de données de navigation uniquement à partir des données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle. Le recalage est, par exemple, propre à être effectué toutes les minutes (i.e. une fréquence de recalage FR égale à une fois par minute, ou encore tous les jours (i.e. une fois par vingt-quatre heures), ou encore tous les deux jours (i.e. une fois par quarante-huit heures), si bien qu'on considère par exemple que la fréquence de recalage FR est comprise dans la plage définie par la borne maximale « une fois par minute » et la borne minimale « une fois par quarante-huit heures » avec la possibilité d'être égale à l'une de ces bornes.
Par exemple, le premier sous-filtre de Kalman SF1 (i=1) met en œuvre une hybridation ponctuelle, selon une fréquence de recalage FR1 , par exemple non limitatif de l'ordre d'une minute, de données satellitaires de positionnement fournies par ledit récepteur et de données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle. Autrement dit, le premier sous-filtre de Kalman SF1 utilise une fois par minute les données satellitaires et ne les utilise pas autrement en dehors de cette seule fois par minute, ce qui revient au fait qu'une fois par minute, SF1 fonctionne de manière identique au filtre de Kalman principal 32.
Le deuxième sous-filtre de Kalman SF2(i=2) met en œuvre une hybridation ponctuelle, selon une fréquence de recalage FR2, par exemple non limitatif de l'ordre de la demi-heure (i.e. 30 minutes), de données satellitaires de positionnement fournies par ledit récepteur et de données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle. Autrement dit, le deuxième sous-filtre de Kalman SF2 utilise une fois par demi-heure (i.e. tous les 30 minutes) les données satellitaires et ne les utilise pas autrement en dehors de cette seule fois par demi-heure, ce qui revient au fait qu'une fois par demi- heure, SF2 fonctionne de manière identique au filtre de Kalman principal 32.
Le troisième sous-filtre de Kalman SF3(i=3) met en œuvre une hybridation ponctuelle, selon une fréquence de recalage FR3, par exemple non limitatif de l'ordre de l'heure, de données satellitaires de positionnement fournies par ledit récepteur et de données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle. Autrement dit, le deuxième sous-filtre de Kalman SF3 utilise une fois par heure les données satellitaires et ne les utilise pas autrement en dehors de cette seule fois par heure, ce qui revient au fait qu'une fois par heure, SF3 fonctionne de manière identique au filtre de Kalman principal 32, et ainsi de suite pour les sous-filtres suivants SF4(i=4) jusqu'à SFN le Nième sous-filtre qui met par exemple en œuvre une hybridation ponctuelle, selon une fréquence de recalage FR3, par exemple non limitatif de l'ordre de la journée (i.e. tous les vingt-quatre heures).
A noter que la durée de recalage en tant que telle est notamment inférieure à la période 1/FRi. Plus précisément, la durée de recalage en tant que telle dépend généralement de l'unité de mesure inertielle (également appelée centrale inertielle) , et est une fraction de l'inverse de la fréquence de recalage 1/FRi, par exemple vingt secondes si la fréquence de recalage est d'un recalage toutes les deux-cents secondes. A noter que cette durée de recalage peut être fixe selon une première variante optionnelle, par exemple vingt secondes pour tous les sous-filtres ou variable, selon une deuxième variante optionnelle de la présente invention, la fréquence de recalage FR, et/ou la durée de recalage étant alors distinctes d'un sous-filtre à un autre et/ou associée(s) à un instant de déclenchement (i.e. instant de début de l'activité du sous-filtre considéré) distinct d'un sous- filtre à un autre.
Par exemple, si l'on considère le Nième sous-filtre qui met en œuvre une fois par jour (i.e. chaque vingt-quatre heures) un recalage sur une solution utilisant les données satellitaires, la durée de recalage en tant que telle est de l'ordre de la centaine de secondes, alors que si l'on considère le 1er sous-filtre SF1(i=1) qui met en œuvre une hybridation ponctuelle, selon une fréquence de recalage FR1, par exemple non limitatif de l'ordre d'une minute, la durée de recalage en tant que telle est inférieure et par exemple de l'ordre de quarante secondes.
De plus, chaque sous-filtre de Kalman SF1 , SF2, ... SFi, SFi+1, ... SFN , en dehors de la mise en œuvre de ladite hybridation ponctuelle, est configuré pour calculer des corrections 42 de données de navigation, uniquement à partir des données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle, notamment ici par hybridation de mesures de position, reçues en entrée, et obtenues seulement à partir des mesures 34 fournies par ladite unité de mesure inertielle 12 et fournies par ledit récepteur optionnel 18 de mesures complémentaires, et n'accepte pas en entrée, pour effectuer ce calcul en dehors de la mise en œuvre de ladite hybridation ponctuelle, contrairement au filtre de Kalman principal 32, les mesures 24 de positionnement par satellites GNSS.
Selon un mode de réalisation, non représenté, plus basique, chaque sous-filtre de Kalman SF1, SF2, ... SFi, SFi+1 , ... SFN, en dehors de la mise en œuvre de ladite hybridation ponctuelle, est configuré pour calculer des corrections 42 de données de navigation, uniquement à partir des données non satellitaires de positionnement fournies par ladite unité de mesure inertielle, en s'affranchissant des données non satellitaires fournies par le récepteur optionnel 18.
Selon une variante optionnelle, les N sous-filtres de Kalman SF1 , SF2, ...SFi, SFi+1, . . . SFN sont identiques et indépendants, la période 1 /FRi , distincte d'un sous-filtre à un autre, correspondant à une période de vérification de l'intégrité desdites mesures 24 de positionnement par satellites GNSS, au moyen de chaque sous-filtre distinctement.
Selon une variante particulière de la présente invention, le dispositif 10 dont une partie est représentée sur la figure 2 est également configuré pour contrôler, l'intégrité desdites mesures de positionnement par satellites GNSS en comparant, à un seuil prédéterminé, l'écart entre l'état 44 de chaque sous-filtre SF1, SF2, ... SFi, SFi+1 , ... SFN, en dehors de la mise en œuvre de ladite hybridation ponctuelle, et l'état 46 du filtre de Kalman principal 32. L'élément 48 de la figure 2 détermine un tel écart et le compare à un seuil prédéterminé 50.
En cas d'écart supérieur audit seuil prédéterminé 50, le dispositif 10 est configuré pour lever, selon la flèche 52 de la figure 2, une alarme propre à signaler une vulnérabilité desdites mesures de positionnement par satellites GNSS.
En complément optionnel, le dispositif 10 est également configuré, au moyen d'un outil de calcul non représenté sur la figure 2, pour déterminer ledit seuil prédéterminé 50 en fonction d'une probabilité de fausse alarme, tel que détaillé par la suite en relation avec la figure 4.
En complément optionnel, tel qu'illustré par le mode de réalisation représenté par la figure 2, en cas de levée d'alarme illustrée par la flèche 52, le filtre de Kalman principal 32 est également configuré pour se reconfigurer, selon la flèche 54, sur un sous-filtre de Kalman SFP prédéterminé d'indice p avec 1 ≤ p ≤ N. Par « se reconfigurer », on entend que le filtre de Kalman principal 32 est propre à recopier le vecteur d'état et la matrice de covariance du sous-filtre de Kalman SFP.
Selon une variante complémentaire de ce complément optionnel, ledit sous-filtre SFP de Kalman prédéterminé d'indice p sur lequel le filtre de Kalman principal 32 est propre à se reconfigurer, selon la flèche 54, en cas de levée 52 d'alarme, est le sous-filtre de Kalman parmi lesdits N sous-filtres de Kalman dont la mise en œuvre de ladite hybridation ponctuelle est temporellement la plus éloignée de l'instant de levée d'alarme.
Selon une autre variante complémentaire de ce complément optionnel, ledit filtre de Kalman principal 32 est configuré pour ne plus utiliser en entrée lesdites mesures 24 de positionnement par satellites GNSS à partir du moment où le filtre de Kalman principal 32 initie sa reconfiguration. Autrement dit, dès lors que la reconfiguration du filtre de Kalman principal 32 est commandée, les mesures 24 de positionnement par satellites GNSS (dont la vulnérabilité est détectée) ne sont plus utilisées par exemple par envoi d'une commande de désélection de ces mesures en entrée de l'ensemble K de filtres de Kalman. Selon une autre variante complémentaire de ce complément optionnel, en cas de levée d'alarme 52, chaque sous-filtre de Kalman d'indice i ≠ p est également configuré pour se reconfigurer sur ledit sous-filtre de Kalman prédéterminé d'indice p, ce qui permet de restaurer un ensemble K avec le filtre de Kalman principal 32 et les sous-filtres SF1, SF2, ... SFi, SFi+1, ... SFN complètement sain.
Selon un autre aspect complémentaire optionnel, le dispositif 10 est également configuré pour déterminer un rayon de protection 58 vis-à-vis d'une vulnérabilité desdites mesures de positionnement par satellites GNSS, ledit rayon de protection garantissant que la valeur de la distance entre la position hybride 30 fournie à partir dudit filtre principal de Kalman 32 et la position vraie dudit véhicule est inférieure à la valeur dudit rayon de protection 58, ledit rayon de protection 58 dépendant du nombre N de sous-filtres de Kalman.
En effet, pour quantifier l'intégrité d'une mesure de position dans des applications telles que les applications navales ou encore aéronautiques, où l'intégrité est critique, on utilise généralement un tel paramètre de rayon de protection de la mesure de position. Le rayon de protection correspond généralement à une erreur de position maximale pour une probabilité donnée d'apparition d'erreur, c'est-à-dire que la probabilité que l'erreur de position dépasse le rayon de protection annoncé sans qu'une alarme soit envoyée à un système de navigation, est inférieure à cette valeur de probabilité donnée. Le calcul se fonde sur deux types d'erreur qui sont d'une part les erreurs normales de mesure et d'autre part les erreurs causées par une anomalie de fonctionnement de la constellation de satellites, soit par exemple une panne d'un satellite. La valeur du rayon de protection d'un système de positionnement est une valeur clef spécifiée par des donneurs d'ordre désirant acquérir un système de positionnement. L'évaluation de la valeur du rayon de protection résulte en général de calculs de probabilités utilisant les caractéristiques statistiques de précision des mesures GNSS et du comportement des senseurs inertiels. Ces calculs s'explicitent de façon formelle et permettent des simulations pour l'ensemble des cas de constellation GNSS, pour l'ensemble des positions possibles du système de positionnement sur le globe terrestre et pour l'ensemble de trajectoires possibles suivies par le système de positionnement. Les résultats de ces simulations permettent de fournir au donneur d'ordre des caractéristiques de rayon de protection garanties par le système de positionnement proposé. Le plus souvent ces caractéristiques s'expriment sous la forme d'une valeur du rayon de protection pour une disponibilité de 100% ou d'une durée d'indisponibilité pour une valeur requise du rayon de protection. La détermination du rayon de protection mise en œuvre selon la présente invention en utilisant l'architecture 100 particulière de l'ensemble K de filtres de Kalman précitée est décrite par la suite plus en détail en relation avec la figure 4.
Selon un autre aspect complémentaire optionnel, le dispositif 10 est également configuré pour fournir, en sortie, en parallèle, des solutions de navigation 60 et 62 respectivement associées audit filtre de Kalman principal, et audit banc 38 de N sous-filtres de Kalman, via les modules de détermination de solutions de navigation 102 et 104 respectivement.
Autrement dit, le dispositif 10 selon la présente invention permet une navigation parallèle par filtres de Kalman distincts à savoir via les solutions de navigation 62 associées aux N sous-filtres de Kalman SF1 , SF2, ... SFi, SFi+1 , ... SFN et via les solutions de navigation 60 respectivement associées au filtre de Kalman principal 32. Une telle architecture 100 permet ainsi de fournir des solutions de navigation secondaires (associées à chaque sous- filtre), en termes de position, vitesse, attitude, en parallèle de la solution fournie par le filtre principal, de telles solutions de navigation secondaires étant propre à être utiles à certains types de navigation notamment sous-marine.
Par exemple pour la position, à chaque cycle du filtre de Kalman principal 32, le dispositif 10 selon la présente invention est propre à appliquer la correction CorSF de chaque sous-filtre de Kalman SF1 , SF2, ... SFi, SFi+1 , ... SFN à l'état de position principale Xn+1/n (i.e. associée à la solution principale INS /GNSS délivrée par le filtre de Kalman principal 32, n et n + 1 étant des instants temporels successifs) pour obtenir l'état de position
Figure imgf000016_0001
associée au sous filtre SF: et de même pour la latitude LatSF, la
Figure imgf000016_0002
longitude LonSF, et l'altitude AltSF, tels que :
LatSF = LatINS/GNSS + CorSF (Lat), LonSF = LonINS/GNSS + CorSF (Lon)
AltSF = AltINS/GNSS + CorSF(Alt)
Selon une variante non représentée, le dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires selon la présente invention comprend une unité de traitement formée par exemple d'une mémoire et d'un processeur associé à la mémoire, et le dispositif 10 est au moins en partie réalisé sous forme d'un logiciel, ou d'une brique logicielle, exécutable par le processeur, notamment l'ensemble K de filtres de Kalman, la plateforme virtuelle 14 de calcul et de localisation, l'élément 48 de la figure 2 configuré pour déterminer un écart entre l'état de chaque sous-filtre, en dehors de la mise en œuvre de ladite hybridation ponctuelle, et l'état du filtre de Kalman principal, et comparer cet écart à un seuil prédéterminé 50, et optionnellement l'outil de calcul configuré pour déterminer ledit seuil 50. La mémoire du dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires est alors apte à stocker de tels logiciels ou briques logicielles, et le processeur est alors apte à les exécuter.
En variante non représentée, l'ensemble K de filtres de Kalman, la plateforme virtuelle 14 de calcul et de localisation, l'élément 48 de la figure 2 configuré pour déterminer un écart entre l'état de chaque sous-filtre et l'état du filtre de Kalman principal, et comparer cet écart à un seuil prédéterminé 50, et optionnellement l'outil de calcul configuré pour déterminer ledit seuil 50 sont réalisés chacun sous forme d'un composant logique programmable, tel qu'un FPGA (de l'anglais Field Programmable Gate Array), ou encore sous forme d'un circuit intégré dédié, tel qu'un ASIC (de l'anglais Application Specific integrated Circuit).
Lorsqu'une partie du dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires selon la présente invention est réalisée sous forme d'un ou plusieurs logiciels, c'est-à-dire sous forme d'un programme d'ordinateur, cette partie est en outre apte à être enregistrée sur un support, non représenté, lisible par ordinateur. Le support lisible par ordinateur est par exemple, un médium apte à mémoriser des instructions électroniques et à être couplé à un bus d'un système informatique. A titre d'exemple, le support lisible est un disque optique, un disque magnéto-optique, une mémoire ROM, une mémoire RAM, tout type de mémoire non- volatile (par exemple EPROM, EEPROM, FLASH, NVRAM), une carte magnétique ou encore une carte optique. Sur le support lisible est alors mémorisé un programme d'ordinateur comportant des instructions logicielles.
La figure 3 illustre le principe de la boucle fermée appliquée au filtre de Kalman principal 32, avec l'état de position X du filtre de Kalman principal 32, et P sa matrice de covariance. Un module 64 de propagation du filtre de Kalman principal 32 est configuré pour propager l'état à l'aide des équations de navigation, et un module 66 de recalage permet d'estimer l'état à l'aide des mesures GNSS fournies par ledit récepteur 16 de données satellitaires et des mesures du récepteur optionnel 18 de mesures complémentaires fournies par au moins un équipement distinct dudit récepteur 16 de données satellitaires et distinct de ladite unité de mesure inertielle 12. Les équations de propagation et de recalage en boucle fermée sont pour le recalage mis en œuvre par le module 66 :
Figure imgf000017_0001
Figure imgf000018_0001
et pour la propagation mise en œuvre par le module 64 :
Figure imgf000018_0003
avec F la matrice de propagation, Q la matrice de bruit de modèle, R la matrice de covariance du bruit de mesure, H la matrice d'observation, K le gain de Kalman et Z le vecteur d'observation obtenu à partir des récepteur 16 et 18,
Xn+1/n Ie vecteur d'état de position propagé après propagation entre les deux instants temporels successifs n et n + 1. La correction Corn+1 est appliquée par un module de correction 68 aux données de navigation pour obtenir l'état de position Xn+1/n+1 et stockée dans la mémoire M2, de même que la matrice de covariance Pn+1/n dans la mémoire Mi, pour une itération suivante à l'instant n + 1.
Ce principe s'applique également à chaque sous-filtre de Kalman SF1 , SF2, ... SFi, SFi+1, ...SFN, chaque sous filtre SF1 , SF2, ... SFi, SFi+1, ... SFN utilisant la matrice d'observation H, le bruit de mesure R et les mesures Z des observations issues du récepteur 18 de mesures complémentaires fournies par au moins un équipement distinct dudit récepteur 16 de données satellitaires et distinct de ladite unité de mesure inertielle 12, un ensemble K de filtres de Kalman, et, en dehors de la mise en œuvre de ladite hybridation ponctuelle, sans utiliser les mesures GNSS issues du récepteur 16 de données satellitaires (i.e. lorsque le sous-filtre considéré ne met pas en œuvre une hybridation ponctuelle, ce sous-filtre n'utilise aucune des mesures GNSS issues du récepteur 16 de données satellitaires).
Plus précisément, pour chaque sous-filtre de Kalman SF1 , SF2, ... SFi, SFi+1 , ... SFN, on utilise les équations classiques de filtre de Kalman en appliquant la correction Cor INS /GNSS du filtre de Kalman principal 32 au moment de la propagation.
Les équations de propagation et de recalage sont donc pour le recalage mise en œuvre au sein de chaque sous-filtre de Kalman fonctionnant aux écarts (i.e. la correction établie par le filtre principal étant appliquée, comme détaillé ci-dessous, à la phase de propagation de chaque sous-filtre de Kalman) :
Figure imgf000018_0002
et pour la propagation :
Figure imgf000019_0001
avec Corn la correction issue du filtre de Kalman principal 32, ZSF le vecteur d'observation qui est un sous ensemble de Z du de Kalman principal 32 ne contenant que les observations obtenues à partir du récepteur 18, et non du récepteur 16 de données satellitaires lorsque le sous-filtre considéré ne met pas en œuvre une hybridation ponctuelle, HSF la matrice d'observation qui contient les lignes de H du filtre de Kalman principal 32 liées au observations du sous-filtre considéré tour à tour (i.e. autrement dit HSF contient des zéros pour la partie associée aux mesures de positionnement par satellites GNSS) KSF est le gain du filtre de Kalman pour le sous-filtre considéré, PSF est la matrice de covariance du filtre de Kalman pour le sous-filtre considéré.
On décrit désormais ci-après en relation avec la figure 4 un exemple de fonctionnement du dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires selon la présente invention.
Plus précisément, le procédé 70 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires mis en œuvre par ledit dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires comprend les étapes décrites ci-après mises en œuvre en parallèle ou successivement l'une après l'autre ou inversement.
Selon l'étape 72, comme indiqué précédemment, le dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires selon la présente invention met en œuvre une localisation dudit véhicule en utilisant les corrections fournies respectivement par le filtre de Kalman principal et par le banc de N sous-filtres de Kalman.
Selon un aspect optionnel, une telle localisation est propre à permettre une navigation parallèle par filtres de Kalman distincts à savoir via les solutions de navigation 60 associées aux N sous-filtres de Kalman SF1 , SF2, ... SFi , SFi+1 , ... SFN et via les solutions de navigation 62 respectivement associées au filtre de Kalman principal 32.
En parallèle de l'étape 72, ou successivement à cette étape 72 ou inversement (i.e. avant cette étape 72), une étape 74 de vérification de l'intégrité desdites mesures de positionnement par satellites GNSS est mise en œuvre par le dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires selon la présente invention. Selon un mode de réalisation particulier illustré par la figure 2, ladite vérification 74 comprend notamment une sous-étape 76 de détermination de :
- l'état de chaque sous-filtre, lorsque le sous-filtre considéré ne met pas en œuvre une hybridation ponctuelle, selon une fréquence de recalage FRi comprise dans une plage de fréquences prédéterminées, de données satellitaires de positionnement fournies par ledit récepteur et de données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle, ladite fréquence de recalage étant distincte d'un sous-filtre à un autre, et de
- l'état du filtre de Kalman principal, entre deux instants temporels successifs n et n + 1, et de l'écart E entre l'état de chaque sous-filtre et l'état du filtre de Kalman principal.
Optionnellement, ladite étape de vérification 74 comprend également une sous- étape 78 de détermination d'un seuil S propre à être comparé à l'écart E entre l'état de chaque sous-filtre et l'état du filtre de Kalman principal.
A titre d'alternative, non représentée, à la sous-étape 78 de détermination d'un seuil S, ledit seuil S est directement fourni et déterminé en dehors dudit dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires.
Ensuite, au cours de l'étape 80, le dispositif 10 de navigation et de positionnement selon la présente invention met en œuvre la comparaison audit seuil S, à chaque instant n + 1, de l'écart E, entre l'état du filtre de Kalman principal 32 et l'état de chaque sous-filtre SF1, SF2, ... SFi , SFi+1 , ... SFN qui n'est pas en cours d'hybridation ponctuelle selon une fréquence de recalage FRi comprise dans une plage de fréquences prédéterminées, de données satellitaires de positionnement fournies par ledit récepteur et de données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle, ladite fréquence de recalage étant distincte d'un sous-filtre à un autre.
Autrement dit, si à l'instant n+1 , considéré le sous-filtre SFi est en cours d'hybridation ponctuelle (i.e. de recalage sur une solution GNSS), ce sous-filtre SFi est ignoré lors de ladite comparaison.
Au cours d'une étape 82, la levée d'une alarme A est enclenchée ou non.
Plus précisément, en absence d'écart supérieur audit seuil S prédéterminé, ladite absence étant représentée par la branche 84, aucune alarme n'est levée, et au cours d'une sous-étape 86, le dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires met alors en œuvre la détermination R_P d'un rayon de protection vis-à-vis d'une vulnérabilité desdites mesures de positionnement par satellites GNSS, ledit rayon de protection garantissant que la valeur de la distance entre la position hybride fournie à partir dudit filtre principal de Kalman 32 et la position vraie dudit véhicule est inférieure à la valeur dudit rayon de protection, ledit rayon de protection dépendant du nombre de sous-filtres de Kalman.
En revanche, en présence d'un d'écart supérieur audit seuil prédéterminé, ladite présence étant représentée par la branche 88, la levée d'une alarme propre à signaler une vulnérabilité desdites mesures de positionnement par satellites GNSS audit instant n + 1 est déclenchée ainsi qu'une étape 90 subséquente de reconfiguration du dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires.
L'étape 90 comprenant une première sous-étape 92 de reconfiguration Ri du filtre de Kalman principal 32 sur un sous-filtre de Kalman prédéterminé d'indice p avec 1 ≤ p ≤ N, une deuxième sous-étape 94 de reconfiguration R2 de chaque sous-filtre de Kalman d'indice i ≠ p sur ledit sous-filtre de Kalman prédéterminé d'indice p, une troisième sous- étape 96 de désélection GNSS_D de l'entrée du filtre de Kalman principal dédiée aux mesures de positionnement par satellites GNSS à partir du moment où le filtre de Kalman principal initie sa reconfiguration.
Ci-après des étapes dudit procédé 70 selon la présente invention sont davantage détaillées.
En particulier, au cours de la sous-étape 76, l'écart entre
Figure imgf000021_0001
l'état de chaque sous-filtre (lorsque ledit sous-filtre considéré ne met pas en œuvre une hybridation ponctuelle) et l'état du filtre de Kalman principal est déterminé car si une mesure GNSS est erronée, elle va corrompre la solution principale INS /GNSS issue du filtre de Kalman principal 32, mais pas certaines solutions issues des sous-solutions fournies par les N sous-filtres propre à opérer un recalage décalé dans le temps selon la présente invention. Une telle différence entre les différentes solutions respectivement associées aux différents filtres de l'ensemble K de filtre de Kalman va se traduire par un écart entre les états de position du sous-filtre et du filtre principal Xn+1/n plus ou moins important
Figure imgf000021_0002
selon l'état étudié, et incohérent avec la covariance de l'écart des états, les états de position X en question correspondant par exemple à des états de cap, de position de vitesse, etc.
Au cours de la sous-étape 80, on cherche à contrôler au court du temps pour chaque sous-filtre l'écart en le comparant, via un seuil prédéterminé, à la
Figure imgf000021_0003
covariance de l'écart des états.
En effet, en considérant que les matrices d'observation de chaque sous-filtre HSF et de bruit de mesure RSF sont des sous matrices des matrices d'observation H et de bruit de mesure R du filtre de Kalman principal 32 où les lignes (respectivement colonnes) liées au mesures GNSS ont été mises à zéro (le reste étant identique entre sous-filtre et filtre principal), et que les matrices de propagation F et de bruit de modèle Q sont identiques entre sous-filtre et filtre principal, alors il est démontrable par récurrence par l'homme du métier que l'espérance de(( - XSF)(X - XSF)T) est égale à la différence de matrice de covariance PSF - P, ce qui en développant revient à une espérance de égale à P
Figure imgf000022_0002
la matrice de covariance du filtre 32 de Kalman principal.
Selon un aspect complémentaire optionnel, tel que décrit précédemment, le dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires selon la présente invention détermine lui-même au cours de l'étape 78, ledit seuil utilisé pour comparer l'écart à la
Figure imgf000022_0003
covariance de l'écart des états.
En particulier, au cours de cette sous-étape 78, selon une probabilité de fausse alarme notée Pfa on cherche à établir une valeur de seuil réelle telle que :
Figure imgf000022_0001
et pn+1/n étant respectivement fournies par le sous-filtre de Kalman considéré
Figure imgf000022_0004
(lorsque ledit sous-filtre considéré ne met pas en œuvre une hybridation ponctuelle) et par le filtre de Kalman principal, le sous-filtre de Kalman contenant moins d'information que le filtre de Kalman principal 32, alors par construction .
Figure imgf000022_0005
En outre, la différence suit aussi, par construction des filtres de
Figure imgf000022_0006
Kalman une loi gaussienne centrée d'écart-type
Figure imgf000022_0007
. En considérant par exemple, une distribution d'une loi gaussienne centré en zéro et d'écart-type égal à un. Le seuil de détection est choisi pour cet exemple de sorte que 1 % du temps on détecte un erroné qui n'est pas présent (Pfa = 0.01), ce qui amène dans cet exemple à Kfa = 1,96, ce qui revient mathématiquement pour une variable X centrée et d'écart-type égal à un à , et donc au seuil S tel que : - Ainsi,
Figure imgf000022_0008
Figure imgf000022_0009
tel qu'illustré par la sous-étape de test 82, lorsque , selon
Figure imgf000022_0010
la branche 84, aucune alarme n'est levée car il n'y a alors pas de problème détecté sur les mesures GNSS. En revanche, selon la branche 88, lorsque , une
Figure imgf000023_0003
anomalie sur les mesures GNSS est détectée et une alarme est levée.
Il est à noter que le test 82 est effectué, selon l'application, sur certains états contrôlés tels que la position, la vitesse, les attitudes, états de défauts capteurs, etc., et ce pour les N sous-filtres de l'architecture.
Comme indiqué précédemment, en absence 84 d'écart supérieur audit seuil S prédéterminé, aucune alarme n'est levée, et au cours d'une sous-étape 86, le dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires met alors en œuvre la détermination d'un rayon de protection vis-à-vis d'une vulnérabilité desdites mesures de positionnement par satellites GNSS, ledit rayon de protection garantissant que la valeur de la distance entre la position hybride fournie à partir dudit filtre principal de Kalman 32 et la position vraie dudit véhicule est inférieure à la valeur dudit rayon de protection, ledit rayon de protection dépendant du nombre de sous-filtres de Kalman.
Pour déterminer un tel rayon de protection, qui est entièrement prédictif, à partir des covariances du filtre de Kalman principal 32 et des sous-filtres de Kalman SF1 , SF2, ... SFi, SFi+1, ... SFN, le dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires introduit une probabilité de non détection Pnd.
Notamment, en prenant comme exemple l'état de latitude noté Xlat, le rayon de protection Rp est alors définit comme suit :
Figure imgf000023_0001
avec ΣN la somme sur les N sous-filtres de Kalman, Plat la diagonale de la matrice de covariance correspondant à l'état de latitude Xlat.
En considérant le cas le plus simple selon lequel N =1 , ce qui revient à utiliser un seul sous-filtre de Kalman, |Xiat - latvraie | est borné avec l'état de ce sous-filtre de Kalman qui potentiellement peut détecter la panne GNSS (i.e. une vulnérabilité des mesures GNSS) :
Figure imgf000023_0002
De plus, comme vu précédemment, au moment de la détection
Figure imgf000024_0016
, si bien que tout l'enjeu du rayon de protection RPlat réside dans le fait
Figure imgf000024_0017
qu'à ce même instant de détection : -
Figure imgf000024_0001
Alors en prenant , et en considérant que
Figure imgf000024_0002
Figure imgf000024_0004
suit une loi gaussienne centrée d'écart-type . La détermination du
Figure imgf000024_0003
Figure imgf000024_0005
rayon de protection revient à chercher le coefficient Knd tel que : , si bien qu'il est alors possible de garantir que si l'écart
Figure imgf000024_0006
est inférieur à , au moment de la panne GNSS, alors
Figure imgf000024_0007
Figure imgf000024_0008
avec une probabilité de non détection de la panne de Pnd et alors :
Figure imgf000024_0009
Figure imgf000024_0010
En considérant le cas le plus complexe selon lequel N ≠ 1 , ce qui revient à utiliser une pluralité de sous-filtres de Kalman, en ne faisant aucune hypothèse sur la durée de la panne hormis que la panne ne peut être non détectée pendant , où est la période
Figure imgf000024_0011
Figure imgf000024_0012
de durée maximale des périodes correspondant à la période de recalage de chaque
Figure imgf000024_0013
sous-filtres d'indice i, alors le rayon de protection correspond préférentiellement à la valeur maximum des rayons de protection de chacun des sous-filtres tel que : , et ce tant que la détection de panne n'a pas
Figure imgf000024_0014
levé d'alarme. Dès lors que l'alarme est levée le rayon de protection peut se propager avec la valeur de l'erreur de la manière suivante : si bien qu'il est alors préférable d'arrêter le
Figure imgf000024_0015
mécanisme de recalage par hybridation ponctuelle avec les données satellitaires 24 de chaque sous-filtre de Kalman SF1 , SF2, ... SFi, SFi+1, ... SFN selon une fréquence de recalage FRi comprise dans une plage de fréquences prédéterminées.
Il est à noter que le précédent exemple de détermination du rayon de protection développé à partir de l'état de latitude, est généralisable à d'autres états tels que d'autres états de position (longitude, altitude) ou encore à des états de vitesse ou d'attitude et cap. En ce qui concerne la sous-étape de reconfiguration 90, il est à noter que l'architecture de l'ensemble K de filtres de Kalman proposée a la faculté de proposer une solution de navigation non corrompue par la panne GNSS. En effet, une fois l'alarme levée, tout comme les sous-filtres de Kalman SF1 , SF2, ... SFi, SFi+1 , ... SFN étaient, au préalable à cette levée d'alarme, reconfigurés périodiquement et en décalé sur le filtre principal de Kalman 32, il est possible de reconfigurer le filtre principal de Kalman 32 sur un sous-filtre de Kalman non corrompu, dont le choix est propre à dépendre de l'application souhaitée, un choix préférentiel et conservateur étant de prendre le sous-filtre de Kalman dont la mise en œuvre de ladite hybridation ponctuelle (i.e. le recalage en utilisant ponctuellement les données GNSS 24) est temporellement la plus éloignée de l'instant de levée d'alarme, en supposant que la panne GNSS ne peut pas être non détectée pendant , où est la
Figure imgf000025_0002
Figure imgf000025_0003
période de durée maximale des périodes correspondant à la période de recalage
Figure imgf000025_0001
de chaque sous-filtres d'indice i. Ainsi lors de la reconfiguration, on vient écraser la matrice de covariance du filtre principal de Kalman 32 par celle du sous-filtre sain sélectionné.
Il est à noter que la performance de positionnement obtenue au moyen de chaque sous-filtre est propre à être évaluée au moyen d'une erreur circulaire probable (de l'anglais Circular Error probability), par exemple une CEP50 correspondant à une erreur circulaire probable à 50%, ce qui revient au rayon du cercle à l'intérieur duquel se trouvent 50% des valeurs d'un échantillon de mesure bidimensionnelle. En particulier, un recalage sur une solution utilisant les données satellitaires, de durée cent secondes, pour une mise en œuvre du recalage par hybridation ponctuelle selon une fréquence d'une fois tous les vingt-quatre heures permet d'annuler (ou du moins de faire chuter) ponctuellement et périodiquement (i.e. toutes les vingt-quatre heures) la valeur de la CEP50 qui dès fin du recalage ré- augmente car représentative de la dérive du sous-filtre de Kalman lorsqu'il n'utilise pas les données satellitaires en dehors de ces cent secondes de recalage
L'homme du métier comprendra que l'invention ne se limite pas aux modes de réalisation décrits, ni aux exemples particuliers de la description, les modes de réalisation et les variantes mentionnées ci-dessus étant propres à être combinés entre eux pour générer de nouveaux modes de réalisation de l'invention.
La présente invention propose ainsi une architecture d'un ensemble de filtres de Kalman à recalage décalés dans le temps du fait d'une fréquence de recalage distincte d'un sous-filtre à l'autre permettant de maintenir l'intégrité du positionnement indépendamment de la vulnérabilité des mesures GNSS par comparaison
-d'une part de la position primaire issue de l'hybridation classique INS /GNSS effectuée par le biais d'un filtre de Kalman principal 32 utilisant en entrée toutes les mesures disponibles : GNSS, position externe, recalage sur déplacement nul lorsque le véhicule est immobile, mesure Loch électromagnétique et d'un modèle dynamique du véhicule, loch doppler ou DVL, mesure de profondeur, recalage par radar, par imagerie, recalage par signaux d'opportunités, etc.
- avec d'autre part un sous ensemble de positions secondaires fournies par un banc de N sous-filtres de Kalman n'utilisant pas en entrée de mesure GNSS pendant une certaine durée (en dehors de la mise en œuvre de ladite hybridation ponctuelle selon une fréquence de recalage FRi comprise dans une plage de fréquences prédéterminées, de données satellitaires de positionnement fournies par ledit récepteur et de données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle, ladite fréquence de recalage étant distincte d'un sous-filtre à un autre), ce qui revient à utiliser des mesures partielles.
Un tel contrôle ne s'effectue pas que sur un satellite unique à la fois ce qui permet d'éviter de limiter le domaine applicatif.
De plus, le dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires est selon un aspect optionnel propre à proposer en permanence un ensemble de solutions de navigation dont une partie n'utilise pas les mesures GNSS depuis un certain temps, typiquement de plusieurs heures à plusieurs jours.
En outre, selon une variante optionnelle de réalisation, le dispositif 10 de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires est aussi capable de fournir un rayon protection contre une vulnérabilité des mesures GNSS et propre à déclencher une reconfiguration du filtre de Kalman principal sur une solution d'un sous-filtre de Kalman si une vulnérabilité des mesures GNSS est détectée. Ainsi, une solution de repli saine est en permanence disponible en cas de détection d'un problème sur les signaux GNSS.
Autrement dit, la présente invention permet de maintenir l'intégrité de la localisation, d'avertir lorsque les signaux GNSS ne sont pas fiables, de se reconfigurer sur une solution non entachée par la vulnérabilité des mesures GNSS, autrement dit, de venir reconfigurer le filtre de Kalman principal sur un sous-filtre de Kalman « sain », et d'avoir à disposition un panel de solutions de navigation déduites de sous-filtres de Kalman ayant navigué sans la mesure GNSS depuis un temps variable.

Claims

REVENDICATIONS
1. Dispositif (10) de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires, propre à être embarqué à bord d'un véhicule propre à se déplacer entre deux positions géographiques distinctes, le dispositif comprenant au moins :
- une unité (12) de mesure inertielle propre à fournir des mesures de navigation,
- un récepteur (16) de données satellitaires de positionnement,
- un filtre de Kalman principal (32) en boucle fermée configuré pour calculer des corrections de données de navigation par hybridation permanente de données satellitaires de positionnement fournies par ledit récepteur et de données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle, le dispositif étant caractérisé en ce qu'il comprend en outre un banc de N sous-filtres (SF1 , SF2, ... SFi, SFi+1 , ... SFN) de Kalman en parallèle avec N un entier prédéterminé tel que N > 1, chaque sous-filtre de Kalman étant configuré pour :
- calculer des corrections de données de navigation par hybridation ponctuelle, selon une fréquence de recalage FRi comprise dans une plage de fréquences prédéterminées, de données satellitaires de positionnement fournies par ledit récepteur et de données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle, ladite fréquence de recalage étant distincte d'un sous-filtre à un autre ;
- en dehors de la mise en œuvre de ladite hybridation ponctuelle, calculer des corrections de données de navigation uniquement à partir des données non satellitaires de positionnement fournies au moins par ladite unité de mesure inertielle.
2. Dispositif (10) selon la revendication 1 , dans lequel les N sous-filtres de Kalman sont identiques et indépendants, la période 1/ FRi correspondant à une période de vérification de l'intégrité desdites mesures de positionnement par satellites GNSS.
3. Dispositif (10) selon la revendication 2, dans lequel le dispositif est également configuré pour :
- contrôler, l'intégrité desdites mesures de positionnement par satellites GNSS en comparant, à un seuil prédéterminé, l'écart entre l'état de chaque sous-filtre, en dehors de la mise en œuvre de ladite hybridation ponctuelle, et l'état du filtre de Kalman principal, et - en cas d'écart supérieur audit seuil prédéterminé, lever une alarme propre à signaler une vulnérabilité desdites mesures de positionnement par satellites GNSS.
4. Dispositif (10) selon la revendication 3, dans lequel le dispositif est également configuré pour déterminer ledit seuil prédéterminé en fonction d'une probabilité de fausse alarme.
5. Dispositif (10) selon la revendication 3 ou 4, dans lequel, en cas de levée d'alarme, le filtre de Kalman principal est également configuré pour se reconfigurer sur un sous-filtre de Kalman prédéterminé d'indice p avec 1 ≤ p ≤ N.
6. Dispositif (10) selon la revendication 5, dans lequel ledit sous-filtre de Kalman prédéterminé d'indice p sur lequel le filtre de Kalman principal est propre à se reconfigurer en cas de levée d'alarme, est le sous-filtre de Kalman parmi lesdits N sous- filtres de Kalman dont la mise en œuvre de ladite hybridation ponctuelle est temporellement la plus éloignée de l'instant de levée d'alarme.
7. Dispositif (10) selon la revendication 5 ou 6, dans lequel ledit filtre de Kalman principal est configuré pour ne plus utiliser en entrée lesdites mesures de positionnement par satellites GNSS à partir du moment où le filtre de Kalman principal initie sa reconfiguration.
8. Dispositif (10) selon l'une quelconque des revendications 5 à 7, dans lequel en cas de levée d'alarme, chaque sous-filtre de Kalman d'indice i ≠ p est également configuré pour se reconfigurer sur ledit sous-filtre de Kalman prédéterminé d'indice p.
9. Dispositif (10) selon l'une quelconque des revendications précédentes, dans lequel le dispositif est également configuré pour déterminer un rayon de protection vis-à-vis d'une vulnérabilité desdites mesures de positionnement par satellites GNSS, ledit rayon de protection garantissant que la valeur de la distance entre la position hybride fournie à partir dudit filtre principal de Kalman et la position vraie dudit véhicule est inférieure à la valeur dudit rayon de protection, ledit rayon de protection dépendant du nombre N de sous-filtres de Kalman.
10. Dispositif (10) selon l'une quelconque des revendications précédentes, dans lequel le dispositif est également configuré pour fournir, en sortie, en parallèle, des solutions de navigation respectivement associées audit banc de N sous-filtres de Kalman, et audit filtre de Kalman principal.
PCT/EP2023/068209 2022-07-04 2023-07-03 Dispositif et procede de maintien de l'integrite du positionnement d'un vehicule independamment de la vulnerabilite de donnees satellitaires WO2024008635A1 (fr)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
FR2206755A FR3137459A1 (fr) 2022-07-04 2022-07-04 Dispositif et procédé de maintien de l'intégrité du positionnement d'un véhicule indépendamment de la vulnérabilité de données satellitaires
FRFR2206755 2022-07-04

Publications (1)

Publication Number Publication Date
WO2024008635A1 true WO2024008635A1 (fr) 2024-01-11

Family

ID=84569555

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/EP2023/068209 WO2024008635A1 (fr) 2022-07-04 2023-07-03 Dispositif et procede de maintien de l'integrite du positionnement d'un vehicule independamment de la vulnerabilite de donnees satellitaires

Country Status (2)

Country Link
FR (1) FR3137459A1 (fr)
WO (1) WO2024008635A1 (fr)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1956386A1 (fr) * 2007-02-07 2008-08-13 Sagem Défense Sécurité Procédé de détermination d'une position d'un corps mobile et d'une limite de protection autour de cette position
US20090276155A1 (en) * 2008-04-30 2009-11-05 Honeywell International, Inc. Systems and methods for determining location information using dual filters
FR3026195A1 (fr) * 2014-09-22 2016-03-25 Thales Sa Systeme d'exclusion d'une defaillance d'un satellite dans un systeme gnss
EP4105690A1 (fr) * 2021-06-14 2022-12-21 Honeywell International Inc. Séparation de la position et de la vitesse en roue libre par inertie

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1956386A1 (fr) * 2007-02-07 2008-08-13 Sagem Défense Sécurité Procédé de détermination d'une position d'un corps mobile et d'une limite de protection autour de cette position
US20090276155A1 (en) * 2008-04-30 2009-11-05 Honeywell International, Inc. Systems and methods for determining location information using dual filters
FR3026195A1 (fr) * 2014-09-22 2016-03-25 Thales Sa Systeme d'exclusion d'une defaillance d'un satellite dans un systeme gnss
EP4105690A1 (fr) * 2021-06-14 2022-12-21 Honeywell International Inc. Séparation de la position et de la vitesse en roue libre par inertie

Also Published As

Publication number Publication date
FR3137459A1 (fr) 2024-01-05

Similar Documents

Publication Publication Date Title
EP3505968B1 (fr) Procede de controle de l'integrite de l'estimation de la position d'un porteur mobile dans un systeme de mesure de positionnement par satellite
EP1839070B2 (fr) Recepteur de positionnement par satellite a integrite et continuite ameliorees
EP2598912B1 (fr) Procede de determination d'un volume de protection dans le cas de deux pannes satellitaires simultanees
EP1714166B1 (fr) Dispositif de surveillance de l integrite des informations delivrees par un systeme hybride ins/gnss
EP3623758B1 (fr) Système de localisation, et procédé de localisation associé
EP2998765B1 (fr) Système d'exclusion d'une défaillance d'un satellite dans un système gnss
EP2299287B1 (fr) Système hybride et dispositif de calcul d'une position et de surveillance de son intégrité
EP1801539B1 (fr) Dispositif d'hybridation en boucle fermée avec surveillance de l'intégrité des mesures.
EP2987036B1 (fr) Procede de controle d'integrite et dispositif de fusion-consolidation comprenant une pluralite de modules de traitement
WO2009103745A1 (fr) Systeme de navigation a hybridation par les mesures de phase
FR3018121A1 (fr) Procede de suivi d'une orbite de transfert ou d'une phase de mise en orbite d'un vehicule spatial, en particulier a propulsion electrique, et appareil pour la mise en oeuvre d'un tel procede
EP2449409B1 (fr) Procede de determination de la position d'un mobile a un instant donne et de surveillance de l'integrite de la position dudit mobile.
WO2010070012A1 (fr) Dispositif d'hybridation en boucle fermee integre par construction
EP1956386A1 (fr) Procédé de détermination d'une position d'un corps mobile et d'une limite de protection autour de cette position
EP1752786B1 (fr) Système de navigation hybride inertiel/satellite et procedé de controle d'un tel système
WO2024008635A1 (fr) Dispositif et procede de maintien de l'integrite du positionnement d'un vehicule independamment de la vulnerabilite de donnees satellitaires
WO2024008640A1 (fr) Dispositif et procédé de navigation et de positionnement
EP4264328A1 (fr) Procede et systeme de localisation d'equipements radioelectriques utilisant au moins deux constellations satellitaires
WO2021032749A1 (fr) Detection d'une operation de leurrage d'un recepteur de signaux satellitaires
WO2024008942A1 (fr) Dispositif de navigation et de positionnement
EP4307010A1 (fr) Methode mac de monitoring, avec compensation de biais commun, de l'integrite d'un procede de positionnement ponctuel par balises virtuelles
FR2853062A1 (fr) Aide a la navigation augmentee en integrite verticale
FR3137972A1 (fr) Méthode MAC de monitoring, avec compensation de biais commun, de l’intégrité d’un procédé de positionnement ponctuel par balises virtuelles
FR3134457A1 (fr) Navigation hybridée avec détection de leurrage par surveillance d'écarts

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 23735797

Country of ref document: EP

Kind code of ref document: A1