EP4305383A1 - Method for assisting with the navigation of a vehicle - Google Patents

Method for assisting with the navigation of a vehicle

Info

Publication number
EP4305383A1
EP4305383A1 EP22713980.5A EP22713980A EP4305383A1 EP 4305383 A1 EP4305383 A1 EP 4305383A1 EP 22713980 A EP22713980 A EP 22713980A EP 4305383 A1 EP4305383 A1 EP 4305383A1
Authority
EP
European Patent Office
Prior art keywords
current
matrix
vector
navigation device
disp
Prior art date
Legal status (The legal status 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 status listed.)
Pending
Application number
EP22713980.5A
Other languages
German (de)
French (fr)
Inventor
Axel BARRAU
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Safran SA
Original Assignee
Safran SA
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 Safran SA filed Critical Safran SA
Publication of EP4305383A1 publication Critical patent/EP4305383A1/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • G01C21/1652Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments with ranging devices, e.g. LIDAR or RADAR
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/183Compensation of inertial measurements, e.g. for temperature effects
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/183Compensation of inertial measurements, e.g. for temperature effects
    • G01C21/185Compensation of inertial measurements, e.g. for temperature effects for gravity

Definitions

  • the present invention relates to the field of vehicle navigation methods. It relates more particularly to so-called hybrid navigation methods.
  • Hybrid navigation methods are methods in which measurements from several sensors (accelerometers, gyroscopes, GPS, etc.) are merged in order to determine kinematic variables or information defining the state of a device implementing the method.
  • kinematic variables are, for example, a position, a speed or an orientation of the device.
  • the measurements are, for example, inertial measurements, for example obtained from accelerometers and gyroscopes, such as the specific force, the angular speed or speed of rotation of the device, speed measurements or position measurements of the device.
  • the specific force is the sum of the external forces experienced by the device, other than gravitational, divided by the mass. This quantity therefore has the dimension of an acceleration
  • invariant filtering simplifies the alignment phase for the hybridizations to which his theory applies, but also has limitations in the case of inertia-altimetry fusion. More precisely, the combination of invariant filtering with long phases of inertia-altimetry fusion interspersed with rare position measurements does not provide theoretical guarantees of filtering convergence. Generally the performances of the invariant filtering are inferior to a classical extended Kalman filter for the inertia-altimetry fusion.
  • the invention proposes to remedy the aforementioned drawbacks.
  • the invention proposes, according to a first aspect, a method for aiding the navigation of a vehicle equipped with a navigation device comprising the following steps: acquisition of a priori values of kinematic variables of the navigation device , determination of respective current values of the kinematic variables of the navigation device and of a current uncertainty matrix representative of an uncertainty of the respective current values of the kinematic variables, from respective previous values of the kinematic variables, of a matrix of previous uncertainty representative of an uncertainty respective previous values of the kinematic variables and of a fictitious model of an earth gravity undergone by the navigation device, an intensity of the modeled gravity being increasing with an altitude of the navigation device, determining a correction from the values respective current values of the kinematic variables and of a measurement and updating of the respective current values of the kinematic variables from the correction and the current uncertainty matrix.
  • this method makes it possible to determine the value of the kinematic variables of the navigation device.
  • it makes it possible to control the duration of the initial static phase, also called alignment, at start-up.
  • the kinematic variables comprise an orientation of the navigation device, a current value of which is a current orientation matrix and a previous value of which is a previous orientation matrix, a speed of the navigation device, a current value of which is a current speed vector and a previous value is a previous speed vector and a position of the navigation device, a current value of which is a current position vector and a previous value is a previous position vector.
  • the current uncertainty matrix is representative of an uncertainty of the current orientation matrix, of the current velocity vector and of the current position vector
  • the previous uncertainty matrix is representative of an uncertainty of the previous orientation matrix , the previous speed vector and the previous position vector.
  • the current values are associated with a current instant and the previous values are associated with a previous instant.
  • the determination of the current values of the kinematic variables comprises a determination of the current speed vector by adding to the previous speed vector an integration, over a time interval between the previous instant and the current instant, of a sum of a force specific to navigation device and gravity modeled, a determination of the current position vector by adding to the previous position vector an integration, over the time interval, of the previous velocity vector, a determination of the current orientation matrix by multiplication of the previous orientation matrix with a matrix representative of a rotation of the navigation device, a determination of the current uncertainty matrix from the previous uncertainty matrix.
  • the determination of the correction includes a subtraction of the current velocity vector and the measurement, and a multiplication by a gain matrix.
  • the determination of the correction includes a subtraction of the current position vector and the measurement, and a multiplication by a gain matrix.
  • the correction is a correction vector
  • the update comprises a sub-step of updating the current orientation matrix by multiplying a rotation matrix of a first part of the vector of correction and the current orientation matrix, a sub-step of updating the current speed vector by adding to the speed vector a multiplication of the current rotation matrix and a second part of the correction vector and a substep of updating the current position vector by adding to the current position vector a multiplication of the current rotation matrix and a third part of the correction vector.
  • the determination of kinematic variables of the navigation device comprises a step of determining the fictitious model of the gravity undergone using the formula where g n (X n ) is a modeled gravity vector, g real is an opposite of a module of an earth gravity from a physically consistent model, r T is an earth radius,
  • X n is the current position vector and is a measured altitude of the device.
  • the determination of kinematic variables of the navigation device comprises a step of determining the fictitious model of the gravity undergone using the formula where g n (X n ) is a modeled gravity vector, real g is an earth gravity vector from a physically consistent model, r T is an earth radius, X n is the current position vector, is a measured altitude of the navigation device, alt(X n ) is an altitude of the navigation device determined from the current position vector and is a modified position vector in which the altitude is the measured altitude.
  • a navigation device comprising a processing unit, three accelerometers and three gyroscopes.
  • the navigation device also includes a measuring device.
  • the processing unit is configured for the implementation of the navigation aid method described above.
  • the navigation device further comprises a device for measuring an altitude of the navigation device.
  • Another aspect of the invention relates to a computer program product comprising program code instructions for executing the steps of the navigation aid method described previously, when the latter is executed by a processor.
  • Figure 1 shows a navigation system of the invention.
  • FIG. 2 represents a navigation method of the invention.
  • Figure 3 shows a linear Kalman filter.
  • Figure 4 shows an extended Kalman filter.
  • FIG. 1 schematically represents a navigation device.
  • This navigation device DISP comprises a processing unit UNIT.
  • This UNIT processing unit comprises a general or specific purpose processor or microcontroller and a memory.
  • the processor or the microcontroller can be an integrated circuit specific to an application (Application-Specific Integrated Circuit for ASIC in English), it can also be a programmable logic circuit or programmable logic network (Field-Programmable Gate Array for FPGA in English).
  • the memory can be fixed or removable and include different memory units which can include a combination of units allowing volatile and non-volatile storage.
  • the memory is configured to store software code that can be used by the processor or the microcontroller to carry out a method for determining respective values of kinematic variables of the navigation device DISP.
  • the values of the kinematic variables allow the location of the navigation device DISP and therefore the navigation of the wearer of this device.
  • the navigation device DISP also comprises three accelerometers 101-a to 101-c, three gyroscopes 102-a to 102-c and a device for measuring, for example a physical quantity, for example dependent on one or more kinetic variables or depending a bias of one of the accelerometers or one of the gyroscopes.
  • This measuring device is for example a measuring device 103-a of a position of the navigation device DISP and/or a measuring device 103-b of a speed of the navigation device DISP.
  • the navigation device DISP can also include other devices for measuring a kinematic variable of the navigation device DISP.
  • the navigation device DISP can also comprise a device 104 for measuring an altitude of the navigation device DISP.
  • This measuring device 104 is for example an altimeter 104.
  • the three accelerometers 101-a to 101-c are capable of delivering specific force data.
  • the three accelerometers are respectively associated with three axes which may be mutually orthogonal.
  • the three gyroscopes 102-a to 102-c are capable of delivering angular position data.
  • the three gyroscopes are respectively associated with three axes which may be mutually orthogonal.
  • the accelerometers measure a specific force fn of the navigation device DISP and the gyroscopes measure an angular speed of the navigation device DISP. This angular velocity is then transformed into a rotation matrix ⁇ n representative of the rotation of the device. The time interval between two measurements is denoted dt.
  • Accelerometers and gyroscopes can either provide specific forces and angular velocities, or directly variations in speed and angle.
  • the device 103-a for measuring a position of the navigation device DISP is for example:
  • satellite navigation receiver for example a GPS type receiver for Global Positioning System in English or a Galileo type receiver,
  • the device 103-b for measuring a speed of the navigation device DISP is for example:
  • zupt for Zero velocity UPdaTe
  • the data delivered by the three accelerometers 101-a to 101-c, by the three gyroscopes 102-a to 102-c, by the measuring device 103-a of a position or by the measuring device 103-b of a speed and possibly by the altimeter 104 are received by the processing unit UNIT.
  • the processing unit UNIT is configured by implementing the method for determining respective values of kinematic variables of the navigation device DISP represented in FIG. 2. This method therefore allows the location of the navigation device DISP and therefore the navigation of the wearer of this device.
  • This method of Figure 2 comprises:
  • step 202 for determining respective current values of kinematic variables of the navigation device DISP and of a current uncertainty matrix representative of an uncertainty of the respective current values of the kinematic variables, from respective previous values of the kinematic variables of the DISP device and from a fictitious model of an earth attraction undergone by the DISP device in which the modeled attraction is of increasing intensity with an altitude of the DISP device, and from a previous uncertainty matrix representative of 'an uncertainty of the respective previous values of the kinematic variables,
  • step 203 for determining a correction from the current values of the kinematic variables and from a measurement
  • step 204 for updating or correcting the current values of the kinematic variables and of the current uncertainty matrix from the correction.
  • the fictitious model will be indifferently called “fictitious model of terrestrial attraction” and “fictitious model of terrestrial gravity”. This model does have a fictional character, due to the fact that the modeled pull is of increasing intensity with an altitude of the DISP device, which is the opposite of a realistic gravity/earth pull model in which a such intensity would decrease with such altitude.
  • the measurement is for example the measurement of a physical quantity, for example dependent on one or more kinematic variables or depending on a bias of one of the accelerometers or one of the gyroscopes. This measurement is for example the position or the speed of the navigation device DISP.
  • the modeled attraction coincides with the real attraction at the measured altitude of the wearer.
  • Device kinematic variables include:
  • an uncertainty matrix P representative of an uncertainty of the kinematic variables is used.
  • This matrix is a covariance matrix.
  • variables (matrix or vector) bearing a circumflex accent represent estimated variables, the corresponding real variables are noted without a circumflex accent.
  • the method includes determining the value of these variables which are denoted respectively .
  • the method also includes determining the covariance matrix representative of the uncertainty of the current estimate.
  • a covariance matrix representing the initial uncertainty is available at the start of the navigation.
  • the index n here represents the time step and, conventionally in Kalman filtering, the index n
  • the method of the invention uses a Kalman filter (advantageously the invention uses an invariant Kalman filter), where successive propagation phases (including the determination 202) using the inertial measurements and the fictitious attraction model terrestrial, and update phases (comprising the determination 203 of a correction and the correction 204) using the position data delivered by the device 103-a for measuring a position or the speed data delivered by the device 103-b for measuring a speed.
  • update phases comprising the determination 203 of a correction and the correction 204 using the position data delivered by the device 103-a for measuring a position or the speed data delivered by the device 103-b for measuring a speed.
  • other types of measurements are used to determine the correction 203 and perform the update 204.
  • the method uses, during the determination 202 of a state of the device, a measurement of altitude to feed a non-physical gravity model.
  • This altitude measurement can be supplied by the altimeter 104 if it is present, for example if the navigation system is present in an aircraft whose altitude may vary. This altitude measurement can also be known a priori in the case of a boat.
  • Determination 202 uses the following equations:
  • - real g is a physically coherent model of the opposite of a module of gravity.
  • physically coherent we understand a model in which the intensity of gravity is only a function of the distance from a point to the center of the earth and in which the intensity of gravity decreases with altitude.
  • this fictitious model we make the approximation that gravity is oriented towards the center of the Earth and that its modulus is only a function of the distance to the center of the Earth.
  • Q n is a covariance matrix representing the uncertainty added by each stage of propagation of the kinematic variables.
  • the main source of this uncertainty is the inaccuracy of measurements from accelerometers and gyroscopes.
  • the exact values to be given to Q n are generally difficult to choose but can be chosen using the specifications supplied by the manufacturer of the navigation device DISP.
  • - ⁇ is the radius of the earth (the distance to the center of the earth corresponding to zero altitude).
  • - P is a covariance matrix whose values on the diagonal represent the uncertainties of each variable of the state and whose values which are not on the diagonal represent the uncertainties crossed between the kinematic variables. is the previous uncertainty matrix, is the current uncertainty matrix.
  • This fictitious model is based on a realistic model but deviates from it.
  • real g is an opposite of a realistic spherical model in which the intensity of gravity is only a function of the distance from a point to the center of the Earth. Actual gravity at a point
  • X n is then written where is a unit vector pointing in the direction of X n .
  • g' reaI is a vector of a terrestrial gravity resulting from a physically coherent model.
  • r t is the local radius of curvature of the Earth in is the point whose latitude and longitude are respectively the latitude and longitude of x n and whose altitude is h n .
  • alt(X n ) is the altitude of x n .
  • step 203 of determining a correction ds comprises:
  • R n a covariance matrix used to represent the measurement errors and the non-modeled quantities. It may or may not depend on the estimated kinematic variables.
  • this matrix makes it possible to link the measured position Yn to the other kinematic variables of the device DISP,
  • - K n is a gain matrix or transformation of the error on the position vector into a correction to be applied to the other kinematic variables.
  • step 203 of determining a correction ds performs:
  • ds is a vector of size 9.
  • the first three components (ds1:3) correspond to the rotational error.
  • the next three components (ds4:6) correspond to the speed error.
  • the last three components (ds7:9) correspond to the position error.
  • the matrix H comprises the concatenation of two null matrices of size 3 by 3 and an identity matrix of size 3 by 3.
  • This step 203 of determining a correction makes it possible to determine the deviation of all the kinematic variables of the navigation device from the value of only one of the kinematic variables of the device.
  • This determination of the deviation is carried out by the gain matrix K, which takes into account the uncertainties on the kinematic variables of the device DISP. If there is a low uncertainty, the position measurement Y n is taken into account to a small extent and, if there is a large uncertainty, the position measurement Y n is taken into account to a large extent. By taking the position measurement Y n into account to a small extent, it is understood that the value of the inputs of the matrix K is low. By taking the position measurement Yn into account in a significant way, it is understood that the value of the inputs of the matrix K is significant.
  • Update 204 uses ds correction to achieve the following equations:
  • - R is a function which allows, from a vector, to obtain a rotation matrix of the vector
  • - ds 7:9 is the part of the correction vector relating to the position correction is the corrected velocity vector, is the corrected position vector, is the corrected orientation matrix, is the corrected uncertainty matrix.
  • the 204 update uses the ds correction to achieve the following equations:
  • Steps 202 to 204 of the method are repeated throughout the navigation.
  • the corrected velocity vector becomes the next vector previous velocity
  • the corrected position vector becomes the next previous position vector
  • the corrected orientation matrix becomes the next previous orientation matrix
  • This method uses the matrix P which is the covariance matrix and the set of operations applied to P over time are called “Riccati equation”.
  • the kinematic variables never appear in the matrix P (or only in the matrices Q n and R n ). Thus this process shares an important property of linear systems. In more complex embodiments these kinematic variables may appear but the method of the invention makes it possible to reduce the negative effects of this dependence.
  • the merging technique using the fictitious Earth attraction model is an invariant filter.
  • other registration methods can be used, for example conventional extended Kalman filter smoothing on sliding window constant gain filter particle filter
  • Figure 3 shows a linear Kalman filter.
  • the estimated kinematic variables which undergo a series of propagations (using measurements from accelerometers and gyroscopes) and updates (using an additional sensor such as a speed or position measuring device), are represented on the middle line.
  • the updates are corrections of the estimated state taking into account the new measurement from the additional sensor.
  • the sensor does not directly give the correction to be made, it only gives a measurement.
  • the difference of this measure with the expected measure is called innovation.
  • the gain matrix K is needed. It is calculated from the Riccati equation appearing on the bottom line.
  • This equation updates the covariance matrix P which represents an uncertainty on the kinematic variables.
  • This covariance matrix P makes it possible to construct the gain matrix K. If the estimate of the state is false, the measurements combined with the gain matrices make it possible to correct the estimate of the state over time.
  • Figure 4 shows a nonlinear or extended Kalman filter.
  • This Kalman filter makes it possible to manage the nonlinear aspect of the state of the navigation device.
  • the difference between Figure 3 and Figure 4 is the addition of the feedback from the middle line to the bottom line.
  • the estimated state is used to calculate the uncertainty and the gains.
  • This feedback can cause a reduction in filter performance.
  • An error on the state of the system induces an error on the gains, which in turn induces an error on the estimated state.
  • all of the operations involving the matrix P do not reveal the estimated state of the navigation device DISP (or only in the matrices Q n and R n ). Thus we place our in the same case as for a linear system and the feedback of FIG. 4 has disappeared.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

Method, navigation device and computer program product for assisting with the navigation of a vehicle equipped with a navigation device, comprising the following steps: acquiring a priori values of kinematic variables of the navigation device, determining (202) respective current values of the kinematic variables of the navigation device and a current uncertainty matrix representative of an uncertainty of the respective current values of the kinematic variables, based on respective previous values of the kinematic variables, a previous uncertainty matrix representative of an uncertainty of the respective previous values of the kinematic variables and a model of Earth's gravity experienced by the navigation device, the modeled gravity increasing with an altitude of the navigation device.

Description

PROCEDE D'AIDE A LA NAVIGATION D'UN VEHICULE METHOD FOR ASSISTING THE NAVIGATION OF A VEHICLE
DOMAINE DE L'INVENTION FIELD OF THE INVENTION
La présente invention concerne le domaine des procédés de navigation d'un véhicule. Elle concerne plus particulièrement les procédés de navigation dits hybrides. The present invention relates to the field of vehicle navigation methods. It relates more particularly to so-called hybrid navigation methods.
ETAT DE LA TECHNIQUE STATE OF THE ART
Les procédés de navigation hybrides sont des procédés dans lesquels des mesures issues de plusieurs capteurs (accéléromètres, gyroscopes, GPS, etc.) sont fusionnées afin de déterminer des variables ou informations cinématiques définissant l'état d'un dispositif mettant en œuvre le procédé. Hybrid navigation methods are methods in which measurements from several sensors (accelerometers, gyroscopes, GPS, etc.) are merged in order to determine kinematic variables or information defining the state of a device implementing the method.
Ces variables cinématiques sont, par exemple, une position, une vitesse ou une orientation du dispositif. These kinematic variables are, for example, a position, a speed or an orientation of the device.
Les mesures sont, par exemple, des mesures inertielles, par exemple obtenues d 'accéléromètres et de gyroscopes, comme la force spécifique, la vitesse angulaire ou vitesse de rotation du dispositif, des mesures de vitesse ou des mesures de position du dispositif. La force spécifique est la somme des forces extérieures subies par le dispositif, autres que gravitationnelles, divisée par la masse. Cette quantité a donc la dimension d'une accélération The measurements are, for example, inertial measurements, for example obtained from accelerometers and gyroscopes, such as the specific force, the angular speed or speed of rotation of the device, speed measurements or position measurements of the device. The specific force is the sum of the external forces experienced by the device, other than gravitational, divided by the mass. This quantity therefore has the dimension of an acceleration
En particulier, l'utilisation du filtrage de Kalman étendu classique pour réaliser une fusion utilisant l'altitude présente des limitations et requiert une procédure d'alignement préalable complexe. In particular, the use of conventional extended Kalman filtering to achieve fusion using altitude has limitations and requires a complex prior alignment procedure.
Le filtrage de Kalman étendu classique fonctionne tant que les incertitudes de cap et de position sont suffisamment faibles, ce qui implique en particulier une procédure d'alignement en début de navigation et un recours plus ou moins régulier à des mesures supplémentaires (autres que l'altitude) en fonction de la qualité des capteurs permettant d'obtenir les différentes mesures. Conventional extended Kalman filtering works as long as the heading and position uncertainties are sufficiently low, which implies in particular an alignment procedure at the start of navigation and more or less regular recourse to additional measurements (other than altitude) depending on the quality of the sensors used to obtain the various measurements.
De plus, une perte momentanée de consistance, lorsque l'erreur d'estimation est plus grande que l'incertitude estimée par le filtre de Kalman, ne peut pas toujours être corrigée par le filtre à cause de la non- linéarité du système. Cette perte de consistance est, par exemple, provoquée par une augmentation imprévue du bruit de mesure. Moreover, a momentary loss of consistency, when the estimation error is greater than the uncertainty estimated by the Kalman filter, cannot always be corrected by the filter because of the non-linearity of the system. This loss of consistency is, for example, caused by an unexpected increase in the measurement noise.
L'utilisation du filtrage invariant simplifie la phase d'alignement pour les hybridations auxquelles sa théorie s'applique, mais présente également des limitations dans le cas de la fusion inertie-altimétrie. Plus précisément, la combinaison du filtrage invariant avec de longues phases de fusion inertie-altimétrie entrecoupées de rares mesures de position n'apporte pas de garanties théoriques de convergence du filtrage. Généralement les performances du filtrage invariant sont inférieures à un filtre de Kalman étendu classique pour la fusion inertie-altimétrie. The use of invariant filtering simplifies the alignment phase for the hybridizations to which his theory applies, but also has limitations in the case of inertia-altimetry fusion. More precisely, the combination of invariant filtering with long phases of inertia-altimetry fusion interspersed with rare position measurements does not provide theoretical guarantees of filtering convergence. Generally the performances of the invariant filtering are inferior to a classical extended Kalman filter for the inertia-altimetry fusion.
Il y a donc un besoin pour un nouveau type de procédé de navigation qui permet d'utiliser une mesure d'altitude en plus des autres mesures disponibles. There is therefore a need for a new type of navigation method which makes it possible to use an altitude measurement in addition to the other available measurements.
EXPOSE DE L'INVENTION DISCLOSURE OF THE INVENTION
L'invention propose de remédier aux inconvénients précités. The invention proposes to remedy the aforementioned drawbacks.
A ce titre, l'invention propose, selon un premier aspect, un procédé d'aide à la navigation d'un véhicule doté d'un dispositif de navigation comprenant les étapes suivantes : acquisition de valeurs a priori de variables cinématiques du dispositif de navigation, détermination de valeurs courantes respectives des variables cinématiques du dispositif de navigation et d'une matrice d'incertitude courante représentative d'une incertitude des valeurs courantes respectives des variables cinématiques, à partir de valeurs précédentes respectives des variables cinématiques, d'une matrice d'incertitude précédente représentative d'une incertitude des valeurs précédentes respectives des variables cinématiques et d'un modèle fictif d'une gravité terrestre subie par le dispositif de navigation, une intensité de la gravité modélisée étant croissante avec une altitude du dispositif de navigation, détermination d'une correction à partir des valeurs courantes respectives des variables cinématiques et d'une mesure et mise à jour des valeurs courantes respectives des variables cinématiques à partir de la correction et de la matrice d'incertitude courante. As such, the invention proposes, according to a first aspect, a method for aiding the navigation of a vehicle equipped with a navigation device comprising the following steps: acquisition of a priori values of kinematic variables of the navigation device , determination of respective current values of the kinematic variables of the navigation device and of a current uncertainty matrix representative of an uncertainty of the respective current values of the kinematic variables, from respective previous values of the kinematic variables, of a matrix of previous uncertainty representative of an uncertainty respective previous values of the kinematic variables and of a fictitious model of an earth gravity undergone by the navigation device, an intensity of the modeled gravity being increasing with an altitude of the navigation device, determining a correction from the values respective current values of the kinematic variables and of a measurement and updating of the respective current values of the kinematic variables from the correction and the current uncertainty matrix.
Ainsi ce procédé permet de déterminer la valeur des variables cinématiques du dispositif de navigation. Il permet notamment de contrôler au démarrage la durée de la phase initiale statique appelée aussi alignement. Thus, this method makes it possible to determine the value of the kinematic variables of the navigation device. In particular, it makes it possible to control the duration of the initial static phase, also called alignment, at start-up.
Dans un mode de réalisation, les variables cinématiques comprennent une orientation du dispositif de navigation dont une valeur courante est une matrice d'orientation courante et dont une valeur précédente est une matrice d'orientation précédente, une vitesse du dispositif de navigation dont une valeur courante est un vecteur vitesse courant et une valeur précédente est un vecteur vitesse précédente et une position du dispositif de navigation dont une valeur courante est un vecteur position courant et une valeur précédente est un vecteur position précédent. La matrice d'incertitude courante est représentative d'une incertitude de la matrice d'orientation courante, du vecteur vitesse courant et du vecteur position courant, et la matrice d'incertitude précédente est représentative d'une incertitude de la matrice d'orientation précédente, du vecteur vitesse précédent et du vecteur position précédent. In one embodiment, the kinematic variables comprise an orientation of the navigation device, a current value of which is a current orientation matrix and a previous value of which is a previous orientation matrix, a speed of the navigation device, a current value of which is a current speed vector and a previous value is a previous speed vector and a position of the navigation device, a current value of which is a current position vector and a previous value is a previous position vector. The current uncertainty matrix is representative of an uncertainty of the current orientation matrix, of the current velocity vector and of the current position vector, and the previous uncertainty matrix is representative of an uncertainty of the previous orientation matrix , the previous speed vector and the previous position vector.
Dans un mode de réalisation, les valeurs courantes sont associées à un instant courant et les valeurs précédentes sont associées un instant précédent. La détermination des valeurs courantes des variables cinématiques comprend une détermination du vecteur vitesse courant par ajout au vecteur vitesse précédent d'une intégration, sur un intervalle temporel compris entre l'instant précédent et l'instant courant, d'une somme d'une force spécifique du dispositif de navigation et de la gravité modélisée, une détermination du vecteur de position courant par ajout au vecteur de position précédent d'une intégration, sur l'intervalle temporel, du vecteur vitesse précédent, une détermination de la matrice d'orientation courante par multiplication de la matrice d'orientation précédente avec une matrice représentative d'une rotation du dispositif de navigation une détermination de la matrice d'incertitude courante à partir de la matrice d'incertitude précédente. In one embodiment, the current values are associated with a current instant and the previous values are associated with a previous instant. The determination of the current values of the kinematic variables comprises a determination of the current speed vector by adding to the previous speed vector an integration, over a time interval between the previous instant and the current instant, of a sum of a force specific to navigation device and gravity modeled, a determination of the current position vector by adding to the previous position vector an integration, over the time interval, of the previous velocity vector, a determination of the current orientation matrix by multiplication of the previous orientation matrix with a matrix representative of a rotation of the navigation device, a determination of the current uncertainty matrix from the previous uncertainty matrix.
Dans un mode de réalisation, la détermination de la correction comprend une soustraction du vecteur vitesse courant et de la mesure, et une multiplication par une matrice de gain. In one embodiment, the determination of the correction includes a subtraction of the current velocity vector and the measurement, and a multiplication by a gain matrix.
Dans un mode de réalisation, la détermination de la correction comprend une soustraction du vecteur position courant et de la mesure, et une multiplication par une matrice de gain. In one embodiment, the determination of the correction includes a subtraction of the current position vector and the measurement, and a multiplication by a gain matrix.
Dans un mode de réalisation, la correction est un vecteur de correction, la mise à jour comprend une sous-étape de mise à jour de la matrice d'orientation courante par multiplication d'une matrice de rotation d'une première partie du vecteur de correction et de la matrice d'orientation courante, une sous-étape de mise à jour du vecteur de vitesse courant par ajout au vecteur vitesse d'une multiplication de la matrice de rotation courante et d'une deuxième partie du vecteur de correction et une sous- étape de mise à jour du vecteur de position courant par ajout au vecteur position courant d'une multiplication de la matrice de rotation courante et d'une troisième partie du vecteur de correction. In one embodiment, the correction is a correction vector, the update comprises a sub-step of updating the current orientation matrix by multiplying a rotation matrix of a first part of the vector of correction and the current orientation matrix, a sub-step of updating the current speed vector by adding to the speed vector a multiplication of the current rotation matrix and a second part of the correction vector and a substep of updating the current position vector by adding to the current position vector a multiplication of the current rotation matrix and a third part of the correction vector.
Dans un mode de réalisation, la détermination de variables cinématiques du dispositif de navigation comprend une étape de détermination du modèle fictif de la gravité subie utilisant la formule où gn(Xn) est un vecteur de gravité modélisée, gréel est un opposé d'un module d'une gravité terrestre issue d'un modèle physiquement cohérent, rT est un rayon de la terre, In one embodiment, the determination of kinematic variables of the navigation device comprises a step of determining the fictitious model of the gravity undergone using the formula where g n (X n ) is a modeled gravity vector, g real is an opposite of a module of an earth gravity from a physically consistent model, r T is an earth radius,
Xn est le vecteur de position courant et est une altitude mesurée du dispositif. X n is the current position vector and is a measured altitude of the device.
Dans un mode de réalisation, la détermination de variables cinématiques du dispositif de navigation comprend une étape de détermination du modèle fictif de la gravité subie utilisant la formule où gn(Xn) est un vecteur de gravité modélisée, gréel est un vecteur de gravité terrestre issue d'un modèle physiquement cohérent, rT est un rayon de la terre, Xn est le vecteur de position courant, est une altitude mesurée du dispositif de navigation, alt(Xn) est une altitude du dispositif de navigation déterminée à partir du vecteur de position courant et est un vecteur de position modifié dans lequel l'altitude est l'altitude mesurée. In one embodiment, the determination of kinematic variables of the navigation device comprises a step of determining the fictitious model of the gravity undergone using the formula where g n (X n ) is a modeled gravity vector, real g is an earth gravity vector from a physically consistent model, r T is an earth radius, X n is the current position vector, is a measured altitude of the navigation device, alt(X n ) is an altitude of the navigation device determined from the current position vector and is a modified position vector in which the altitude is the measured altitude.
Un autre aspect de l'invention concerne un dispositif de navigation comprenant une unité de traitement, trois accéléromètres et trois gyroscopes. Le dispositif de navigation comprend également un dispositif de mesure. L'unité de traitement est configurée pour la mise en œuvre du procédé d'aide à la navigation décrit précédemment. Another aspect of the invention relates to a navigation device comprising a processing unit, three accelerometers and three gyroscopes. The navigation device also includes a measuring device. The processing unit is configured for the implementation of the navigation aid method described above.
Dans un mode de réalisation le dispositif de navigation comprend en outre un dispositif de mesure d'une altitude du dispositif de navigation. In one embodiment, the navigation device further comprises a device for measuring an altitude of the navigation device.
Un autre aspect de l'invention concerne un produit programme d'ordinateur comprenant des instructions de code de programme pour l'exécution des étapes du procédé d'aide à la navigation décrit précédemment, lorsque celui-ci est exécuté par un processeur. DESCRIPTION DES FIGURES Another aspect of the invention relates to a computer program product comprising program code instructions for executing the steps of the navigation aid method described previously, when the latter is executed by a processor. DESCRIPTION OF FIGURES
D'autres caractéristiques et avantages de l'invention ressortiront encore de la description qui suit, laquelle est purement illustrative et non limitative et doit être lue en regard des figures annexées sur lesquelles : Other characteristics and advantages of the invention will emerge from the description which follows, which is purely illustrative and not limiting and must be read in conjunction with the appended figures in which:
La figure 1 représente un système de navigation de l'invention. Figure 1 shows a navigation system of the invention.
La figure 2 représente un procédé de navigation de l'invention. FIG. 2 represents a navigation method of the invention.
La figure 3 représente un filtre de Kalman linéaire. Figure 3 shows a linear Kalman filter.
La figure 4 représente un filtre de Kalman étendu. Figure 4 shows an extended Kalman filter.
DESCRIPTION DETAILLEE DE L'INVENTION DETAILED DESCRIPTION OF THE INVENTION
La figure 1 représente de manière schématique un dispositif de navigation. Ce dispositif de navigation DISP comprend une unité de traitement UNIT. Cette unité de traitement UNIT comprend un processeur ou un microcontrôleur à usage général ou spécifique et une mémoire. FIG. 1 schematically represents a navigation device. This navigation device DISP comprises a processing unit UNIT. This UNIT processing unit comprises a general or specific purpose processor or microcontroller and a memory.
Le processeur ou le microcontrôleur peut être un circuit intégré spécifique à une application (Application-Specific Integrated Circuit pour ASIC en anglais), il peut aussi être un circuit logique programmable ou réseau logique programmable (Field-Programmable Gate Array pour FPGA en anglais). The processor or the microcontroller can be an integrated circuit specific to an application (Application-Specific Integrated Circuit for ASIC in English), it can also be a programmable logic circuit or programmable logic network (Field-Programmable Gate Array for FPGA in English).
La mémoire peut être fixe ou amovible et comporter différentes unités mémoire pouvant inclure une combinaison d'unités permettant un stockage volatile et non volatile. La mémoire est configurée pour stocker un code logiciel utilisable par le processeur ou le microcontrôleur pour réaliser un procédé de détermination de valeurs respectives de variables cinématiques du dispositif de navigation DISP. Les valeurs des variables cinématiques permettent la localisation du dispositif de navigation DISP et donc la navigation du porteur de ce dispositif. The memory can be fixed or removable and include different memory units which can include a combination of units allowing volatile and non-volatile storage. The memory is configured to store software code that can be used by the processor or the microcontroller to carry out a method for determining respective values of kinematic variables of the navigation device DISP. The values of the kinematic variables allow the location of the navigation device DISP and therefore the navigation of the wearer of this device.
Le dispositif de navigation DISP comprend également trois accéléromètres 101-a à 101-c, trois gyroscopes 102-a à 102-c et un dispositif de mesure par exemple d'une grandeur physique par exemple dépendant d'une ou plusieurs variables cinétiques ou dépendant d'un biais de l'un des accéléromètres ou de l'un des gyroscopes. Ce dispositif de mesure est par exemple un dispositif de mesure 103-a d'une position du dispositif de navigation DISP et/ou un dispositif de mesure 103- b d'une vitesse du dispositif de navigation DISP. The navigation device DISP also comprises three accelerometers 101-a to 101-c, three gyroscopes 102-a to 102-c and a device for measuring, for example a physical quantity, for example dependent on one or more kinetic variables or depending a bias of one of the accelerometers or one of the gyroscopes. This measuring device is for example a measuring device 103-a of a position of the navigation device DISP and/or a measuring device 103-b of a speed of the navigation device DISP.
Le dispositif de navigation DISP peut aussi comporter d'autres dispositif de mesures d'une variable cinématique du dispositif de navigation DISP. The navigation device DISP can also include other devices for measuring a kinematic variable of the navigation device DISP.
De plus, le dispositif de navigation DISP peut aussi comporter un dispositif de mesure 104 d'une altitude du dispositif de navigation DISP. Ce dispositif de mesure 104 est par exemple un altimètre 104. In addition, the navigation device DISP can also comprise a device 104 for measuring an altitude of the navigation device DISP. This measuring device 104 is for example an altimeter 104.
Les trois accéléromètres 101-a à 101-c sont aptes à délivrer des données de force spécifique. Les trois accéléromètres sont associés respectivement à trois axes qui peuvent être orthogonaux entre eux. The three accelerometers 101-a to 101-c are capable of delivering specific force data. The three accelerometers are respectively associated with three axes which may be mutually orthogonal.
Les trois gyroscopes 102-a à 102-c sont aptes à délivrer des données de position angulaire. Les trois gyroscopes sont associés respectivement à trois axes qui peuvent être orthogonaux entre eux. The three gyroscopes 102-a to 102-c are capable of delivering angular position data. The three gyroscopes are respectively associated with three axes which may be mutually orthogonal.
Plus précisément, les accéléromètres mesurent une force spécifique fn du dispositif de navigation DISP et les gyroscopes mesurent une vitesse angulaire du dispositif de navigation DISP. Cette vitesse angulaire est ensuite transformée en une matrice de rotation Ωn représentative de la rotation du dispositif. L'intervalle de temps entre deux mesures est noté dt. More precisely, the accelerometers measure a specific force fn of the navigation device DISP and the gyroscopes measure an angular speed of the navigation device DISP. This angular velocity is then transformed into a rotation matrix Ω n representative of the rotation of the device. The time interval between two measurements is denoted dt.
Accéléromètres et gyroscopes peuvent soit fournir des forces spécifiques et des vitesses angulaires, soit directement des variations de vitesse et d'angle. Accelerometers and gyroscopes can either provide specific forces and angular velocities, or directly variations in speed and angle.
Le dispositif de mesure 103-a d'une position du dispositif de navigation DISP est par exemple : The device 103-a for measuring a position of the navigation device DISP is for example:
- un récepteur de navigation satellitaire, par exemple un récepteur de type GPS pour Global Positionning System en anglais ou un récepteur de type Galiléo, - a satellite navigation receiver, for example a GPS type receiver for Global Positioning System in English or a Galileo type receiver,
- un dispositif réalisant une triangulation en utilisant des amers dont la position est connue ou - a device performing a triangulation using landmarks whose position is known or
- un dispositif de télédétection par laser (Light Detection And Ranging pour LIDAR en anglais). - a laser remote sensing device (Light Detection And Ranging for LIDAR in English).
Le dispositif de mesure 103-b d'une vitesse du dispositif de navigation DISP est par exemple : The device 103-b for measuring a speed of the navigation device DISP is for example:
- un dispositif utilisant l'odométrie, - a device using odometry,
- un dispositif permettant de mesurer la vitesse d'un bateau, aussi connu sous l'expression loch ou - a device for measuring the speed of a boat, also known as the loch or
- un dispositif permettant de détecter l'arrêt d'un véhicule, aussi connu sous l'expression zupt (pour Zero velocity UPdaTe). - a device for detecting the stoppage of a vehicle, also known as zupt (for Zero velocity UPdaTe).
Les données délivrées par les trois accéléromètres 101-a à 101-c, par les trois gyroscopes 102-a à 102-c, par le dispositif de mesure 103-a d'une position ou par le dispositif de mesure 103-b d'une vitesse et éventuellement par l'altimètre 104 sont reçues par l'unité de traitement UNIT. The data delivered by the three accelerometers 101-a to 101-c, by the three gyroscopes 102-a to 102-c, by the measuring device 103-a of a position or by the measuring device 103-b of a speed and possibly by the altimeter 104 are received by the processing unit UNIT.
Si l'altimètre 104 n'est pas présent on peut prendre une hypothèse sur l'altitude du dispositif de navigation DISP. Dans le cas où le porteur est un navire on peut prendre par exemple l'hypothèse que l'altitude est nulle. L'unité de traitement UNIT est configurée par la mise en œuvre du procédé de détermination de valeurs respectives de variables cinématiques du dispositif de navigation DISP représenté en figure 2. Ce procédé permet donc la localisation du dispositif de navigation DISP et donc la navigation du porteur de ce dispositif. If the altimeter 104 is not present, an assumption can be made about the altitude of the navigation device DISP. In the case where the carrier is a ship, it is possible, for example, to assume that the altitude is zero. The processing unit UNIT is configured by implementing the method for determining respective values of kinematic variables of the navigation device DISP represented in FIG. 2. This method therefore allows the location of the navigation device DISP and therefore the navigation of the wearer of this device.
Ce procédé de la figure 2 comprend : This method of Figure 2 comprises:
- une étape d'acquisition 201 de variables cinématiques a priori du dispositif de navigation, - a step 201 for acquiring a priori kinematic variables of the navigation device,
- une étape de détermination 202 de valeurs courantes respectives de variables cinématiques du dispositif de navigation DISP et d'une matrice d'incertitude courante représentative d'une incertitude des valeurs courantes respectives des variables cinématiques, à partir de valeurs précédentes respectives des variables cinématiques du dispositif DISP et à partir d'un modèle fictif d'une attraction terrestre subie par le dispositif DISP dans lequel l'attraction modélisée est d'une intensité croissante avec une altitude du dispositif DISP, et d'une matrice d'incertitude précédente représentative d'une incertitude des valeurs précédentes respectives des variables cinématiques, - a step 202 for determining respective current values of kinematic variables of the navigation device DISP and of a current uncertainty matrix representative of an uncertainty of the respective current values of the kinematic variables, from respective previous values of the kinematic variables of the DISP device and from a fictitious model of an earth attraction undergone by the DISP device in which the modeled attraction is of increasing intensity with an altitude of the DISP device, and from a previous uncertainty matrix representative of 'an uncertainty of the respective previous values of the kinematic variables,
- une étape de détermination 203 d'une correction à partir des valeurs courantes des variables cinématiques et à partir d'une mesure et - a step 203 for determining a correction from the current values of the kinematic variables and from a measurement and
- une étape de mise à jour ou correction 204 des valeurs courantes des variables cinématiques et de la matrice d'incertitude courante à partir de la correction. - a step 204 for updating or correcting the current values of the kinematic variables and of the current uncertainty matrix from the correction.
Dans le présent texte, le modèle fictif sera indifféremment appelé « modèle fictif d'attraction terrestre » et « modèle fictif de gravité terrestre ». Ce modèle présente bien un caractère fictif, en raison du fait que l'attraction modélisée est d'une intensité croissante avec une altitude du dispositif DISP, ce qui est le contraire d'un modèle réaliste de gravité / d'attraction terrestre dans lequel une telle intensité décroirait avec une telle altitude. In the present text, the fictitious model will be indifferently called “fictitious model of terrestrial attraction” and “fictitious model of terrestrial gravity”. This model does have a fictional character, due to the fact that the modeled pull is of increasing intensity with an altitude of the DISP device, which is the opposite of a realistic gravity/earth pull model in which a such intensity would decrease with such altitude.
La mesure est par exemple la mesure d'une grandeur physique par exemple dépendant d'une ou plusieurs variables cinématiques ou dépendant d'un biais de l'un des accéléromètres ou de l'un des gyroscopes. Cette mesure est par exemple la position ou la vitesse du dispositif de navigation DISP. The measurement is for example the measurement of a physical quantity, for example dependent on one or more kinematic variables or depending on a bias of one of the accelerometers or one of the gyroscopes. This measurement is for example the position or the speed of the navigation device DISP.
De plus l'attraction modélisée coïncide avec l'attraction réelle à l'altitude mesurée du porteur. Moreover, the modeled attraction coincides with the real attraction at the measured altitude of the wearer.
Les variables cinématiques du dispositif comprennent : Device kinematic variables include:
- une orientation du dispositif, dont la valeur est une matrice T d'orientation actuelle ou précédente, de taille 3 par 3, cette orientation est représentée par un quaternion, - an orientation of the device, whose value is a matrix T of current or previous orientation, of size 3 by 3, this orientation is represented by a quaternion,
- une vitesse du dispositif, dont la valeur est un vecteur V de vitesse actuel ou précédent, de taille 3, et - a speed of the device, the value of which is a current or previous speed vector V, of size 3, and
- une position du dispositif, dont la valeur est un vecteur X de position actuel ou précédent, de taille 3. - a position of the device, the value of which is a current or previous position vector X, of size 3.
D'autres variables peuvent être estimées simultanément, en particulier des biais dans les mesures des accéléromètres et des gyroscopes. Other variables can be estimated simultaneously, in particular biases in the measurements of accelerometers and gyroscopes.
De plus on utilise une matrice d'incertitude P représentative d'une incertitude des variables cinématiques. Cette matrice est une matrice de covariance. Moreover, an uncertainty matrix P representative of an uncertainty of the kinematic variables is used. This matrix is a covariance matrix.
Dans la suite du document, les variables (matrice ou vecteur) portant un accent circonflexe représentent des variables estimées, les variables réels correspondants sont notés sans accent circonflexe. In the remainder of the document, the variables (matrix or vector) bearing a circumflex accent represent estimated variables, the corresponding real variables are noted without a circumflex accent.
Le procédé comprend la détermination de la valeur de ces variables qui sont notés respectivement . Le procédé comprend aussi la détermination de la matrice de covariance représentative de l'incertitude de l'estimation actuelle. On suppose aussi qu'une matrice de covariance représentant l'incertitude initiale, est disponible au début de la navigation. L'indice n représente ici le pas de temps et, de manière classique dans un filtrage de Kalman, l'indice n|n représente l'estimation de la valeur à l'instant n en tenant compte de l'observation effectuée à l'instant n et l'indice n\n-l représente l'estimation de la valeur à l'instant n sans tenir compte de l'observation effectuée à l'instant n. The method includes determining the value of these variables which are denoted respectively . The method also includes determining the covariance matrix representative of the uncertainty of the current estimate. We also assume that a covariance matrix representing the initial uncertainty, is available at the start of the navigation. The index n here represents the time step and, conventionally in Kalman filtering, the index n|n represents the estimate of the value at time n taking into account the observation made at instant n and the index n\nl represents the estimate of the value at instant n without taking into account the observation made at instant n.
Le procédé de l'invention utilise un filtre de Kalman (de manière avantageuse l'invention utilise un filtre de Kalman invariant), où se succèdent des phases de propagation (comprenant la détermination 202) utilisant les mesures inertielles et le modèle fictif d'attraction terrestre, et des phases de mise à jour (comprenant la détermination 203 d'une correction et la correction 204) utilisant les données de position délivrées par le dispositif 103-a de mesure d'une position ou les données de vitesse délivrées par le dispositif 103-b de mesure d'une vitesse. Dans d'autres modes de réalisation d'autres types de mesures sont utilisées pour déterminer la correction 203 et réaliser la mise à jour 204. De plus, le procédé utilise, durant la détermination 202 d'un état du dispositif, une mesure d'altitude pour alimenter un modèle de gravité non physique. The method of the invention uses a Kalman filter (advantageously the invention uses an invariant Kalman filter), where successive propagation phases (including the determination 202) using the inertial measurements and the fictitious attraction model terrestrial, and update phases (comprising the determination 203 of a correction and the correction 204) using the position data delivered by the device 103-a for measuring a position or the speed data delivered by the device 103-b for measuring a speed. In other embodiments, other types of measurements are used to determine the correction 203 and perform the update 204. In addition, the method uses, during the determination 202 of a state of the device, a measurement of altitude to feed a non-physical gravity model.
Cette mesure d'altitude peut être fournie par l'altimètre 104 s'il est présent, par exemple si le système de navigation est présent dans un aéronef dont l'altitude peut varier. Cette mesure d'altitude peut aussi être connue a priori dans le cas d'un bateau. This altitude measurement can be supplied by the altimeter 104 if it is present, for example if the navigation system is present in an aircraft whose altitude may vary. This altitude measurement can also be known a priori in the case of a boat.
La détermination 202 utilise les équations suivantes : Determination 202 uses the following equations:
+ dt. + dt.
Avec : est le vecteur vitesse courant, est le vecteur vitesse précédent, est le vecteur position courant, est le vecteur position précédent, est la matrice d'orientation courante, est la matrice d'orientation précédente, est le modèle fictif de l'intensité croissant de la gravité subie par le dispositif de navigation DISP With: is the current velocity vector, is the previous velocity vector, is the current position vector, is the previous position vector, is the current orientation matrix, is the previous orientation matrix, is the fictitious model of the increasing intensity of the severity experienced by the DISP navigation device
- gréel est un modèle physiquement cohérent de l'opposé d'un module de la gravité. Par physiquement cohérent on comprend un modèle dans lequel l'intensité de la gravité n'est que fonction de la distance d'un point au centre de la terre et dans lequel l'intensité de la gravité décroit avec l'altitude. Ainsi dans ce modèle fictif on fait l'approximation que la gravité orientée vers le centre de la Terre et que son module est uniquement fonction de la distance au centre de la Terre. - real g is a physically coherent model of the opposite of a module of gravity. By physically coherent we understand a model in which the intensity of gravity is only a function of the distance from a point to the center of the earth and in which the intensity of gravity decreases with altitude. Thus in this fictitious model we make the approximation that gravity is oriented towards the center of the Earth and that its modulus is only a function of the distance to the center of the Earth.
- Qn est une matrice de covariance représentant l'incertitude ajoutée par chaque étape de propagation des variables cinématiques. La source principale de cette incertitude est l'imprécision des mesures issues des accéléromètres et des gyroscopes. Les valeurs exactes à donner à Qn sont en général difficiles à choisir mais peuvent l'être à l'aide des spécifications fournies par le constructeur du dispositif de navigation DISP. - Q n is a covariance matrix representing the uncertainty added by each stage of propagation of the kinematic variables. The main source of this uncertainty is the inaccuracy of measurements from accelerometers and gyroscopes. The exact values to be given to Q n are generally difficult to choose but can be chosen using the specifications supplied by the manufacturer of the navigation device DISP.
- τrest le rayon de la terre (la distance au centre de la Terre correspondant à l'altitude zéro). - τ is the radius of the earth (the distance to the center of the earth corresponding to zero altitude).
- hn est l'altitude du dispositif DISP. - (l)x correspond à une matrice antisymétrique réalisée avec les composantes du vecteur /, cette matrice est telle que pour tout vecteur u (l)x u = l x u où x est un produit vectoriel. - hn is the altitude of the DISP device. - (l) x corresponds to an antisymmetric matrix realized with the components of the vector /, this matrix is such that for any vector u (l) x u = lxu where x is a vector product.
- P est une matrice de covariance dont les valeurs de la diagonale représentent les incertitudes de chaque variable de l'état et dont les valeurs qui ne sont pas sur la diagonale représentent les incertitudes croisées entre les variables cinématiques. est la matrice d'incertitude précédente, est la matrice d'incertitude courante. - P is a covariance matrix whose values on the diagonal represent the uncertainties of each variable of the state and whose values which are not on the diagonal represent the uncertainties crossed between the kinematic variables. is the previous uncertainty matrix, is the current uncertainty matrix.
Ainsi, dans cette étape de détermination 202 on utilise un modèle fictif d'attraction terrestre gn(Xn) = αnxn avec Thus, in this determination step 202 a fictitious model of terrestrial attraction g n (X n ) = α n x n is used with
Ce modèle fictif est basé sur un modèle réaliste mais s'écarte de celui-ci. Dans ce modèle fictif on utilise gréel qui est un opposé d'un modèle réaliste sphérique dans lequel l'intensité de la gravité n'est que fonction de la distance d'un point au centre de la Terre. La gravité réelle en un pointThis fictitious model is based on a realistic model but deviates from it. In this fictitious model we use real g which is an opposite of a realistic spherical model in which the intensity of gravity is only a function of the distance from a point to the center of the Earth. Actual gravity at a point
Xn s'écrit alors où est un vecteur unitaire pointant dans la direction de Xn. X n is then written where is a unit vector pointing in the direction of X n .
De plus, on utilise un modèle fictif gn(Xn) = anXn de l'effet de la gravité dont l'intensité est croissante avec l'altitude mais coïncidant avec le modèle réaliste uniquement à l'altitude hn (indiquée par l'altimètre). In addition, we use a fictitious model g n (X n ) = a n X n of the effect of gravity whose intensity increases with altitude but coincides with the realistic model only at altitude h n ( indicated by the altimeter).
Ainsi, si la position Xn est située à une altitude on a et donc : l es deux modèles de gravité coïncident à l'altitude hn. Thus, if the position X n is located at an altitude, we have and so : the two gravity models coincide at the altitude h n .
Mais la dérivée de gn(xn) par rapport à xn est différente de la dérivée de la gravité dans un modèle classique puisque gn(xn) est devenue linéaire. Ce n'est plus le cas si un modèle réaliste de gravité plus élaboré est choisi, cependant le comportement des filtres est le même. But the derivative of g n (x n ) with respect to x n is different from the derivative of gravity in a classical model since g n (x n ) has become linear. This is no longer the case if a more elaborate realistic gravity model is chosen, however the behavior of the filters is the same.
On peut aussi utiliser un modèle fictif d'attraction terrestre plus élaboré par exemple en utilisant la formule suivante : One can also use a more elaborate fictitious model of terrestrial attraction for example by using the following formula:
Où la fonction g'réeI est un vecteur d'une gravité terrestre issue d'un modèle physiquement cohérent. rt est le rayon de courbure locale de la Terre en est le point dont la latitude et longitude sont respectivement la latitude et la longitude de xn et dont l'altitude est hn. alt(Xn) est l'altitude de xn. Where the function g' reaI is a vector of a terrestrial gravity resulting from a physically coherent model. r t is the local radius of curvature of the Earth in is the point whose latitude and longitude are respectively the latitude and longitude of x n and whose altitude is h n . alt(X n ) is the altitude of x n .
Dans un mode de réalisation l'étape 203 de détermination d'une correction ds comprend : In one embodiment, step 203 of determining a correction ds comprises:
- la soustraction du vecteur position courant et d'une mesure de la position du dispositif de navigation (DISP), - the subtraction of the current position vector and a measurement of the position of the navigation device (DISP),
-éventuellement un transfert de cette différence dans le repère du porteur à l'aide de la matrice d'orientation estimée et - possibly a transfer of this difference in the reference of the wearer using the estimated orientation matrix and
- une multiplication par une matrice de gain - a multiplication by a gain matrix
De manière plus précise l'étape 203 de détermination d'une correction ds peut utiliser les équations suivantes : ds = Knzn More specifically, step 203 for determining a correction ds can use the following equations: ds = K n z n
Avec : - ds la correction. With : - ds the correction.
- Yn la position fournie par le dispositif de mesure d'une position 103-a.- Yn the position provided by the position measuring device 103-a.
- Rn une matrice de covariance utilisée pour représenter les erreurs de mesure et les grandeurs non modélisées. Elle peut dépendre ou pas des variables cinématiques estimées. - R n a covariance matrix used to represent the measurement errors and the non-modeled quantities. It may or may not depend on the estimated kinematic variables.
- Hn = (03 03 I3) - H n = (0 3 0 3 I 3 )
, cette matrice permet de relier la position mesurée Yn aux autres variables cinématiques du dispositif DISP, , this matrix makes it possible to link the measured position Yn to the other kinematic variables of the device DISP,
- Kn est une matrice de gain ou transformation de l'erreur sur le vecteur position en une correction à apporter sur les autres variables cinématiques. - K n is a gain matrix or transformation of the error on the position vector into a correction to be applied to the other kinematic variables.
Dans le cas où le dispositif de mesure fournit une vitesse, l'étape 203 de détermination d'une correction ds réalise : In the case where the measuring device provides a speed, step 203 of determining a correction ds performs:
- une soustraction du vecteur vitesse courant et d'une mesure de la vitesse du dispositif de navigation (DISP), - a subtraction of the current speed vector and a measurement of the speed of the navigation device (DISP),
- éventuellement un transfert de cette différence dans le repère du porteur à l'aide de la matrice d'orientation estimée et - possibly a transfer of this difference in the reference of the wearer using the estimated orientation matrix and
- une multiplication par une matrice de gain. - a multiplication by a gain matrix.
Ainsi, dans le cas où le dispositif de mesure fournit une vitesse le calcul de zn et Hn sont remplacés par : ds est un vecteur de taille 9. Les trois premières composantes (ds1:3) correspondent à l'erreur en rotation. Les trois composantes suivantes (ds4:6) correspondent à l'erreur en vitesse. Les trois dernières composantes (ds7:9) correspondent à l'erreur en position. Thus, in the case where the measuring device provides a speed, the calculation of z n and H n are replaced by: ds is a vector of size 9. The first three components (ds1:3) correspond to the rotational error. The next three components (ds4:6) correspond to the speed error. The last three components (ds7:9) correspond to the position error.
La matrice H comprend la concaténation de deux matrices de taille 3 par 3 nulles et d'une matrice identité de taille 3 par 3. The matrix H comprises the concatenation of two null matrices of size 3 by 3 and an identity matrix of size 3 by 3.
K est connu sous le nom de matrice de gain. Cette étape 203 de détermination d'une correction permet de déterminer l'écart de l'ensemble des variables cinématiques du dispositif de navigation à partir de la valeur d'uniquement l'une des variables cinématiques du dispositif. K is known as the gain matrix. This step 203 of determining a correction makes it possible to determine the deviation of all the kinematic variables of the navigation device from the value of only one of the kinematic variables of the device.
Cette détermination de l'écart est réalisée par la matrice de gain K, qui prend en compte les incertitudes sur les variables cinématiques du dispositif DISP. S'il y a une incertitude faible, on tient compte de manière faible de la mesure de position Yn et, s'il une incertitude importante, on tient compte de manière importante de la mesure de position Yn. Par on tient compte de manière faible de la mesure de position Yn, on comprend que la valeur des entrées de la matrice K est faible. Par on tient compte de manière importante de la mesure de position Yn, on comprend que la valeur des entrées de la matrice K est importante. This determination of the deviation is carried out by the gain matrix K, which takes into account the uncertainties on the kinematic variables of the device DISP. If there is a low uncertainty, the position measurement Y n is taken into account to a small extent and, if there is a large uncertainty, the position measurement Y n is taken into account to a large extent. By taking the position measurement Y n into account to a small extent, it is understood that the value of the inputs of the matrix K is low. By taking the position measurement Yn into account in a significant way, it is understood that the value of the inputs of the matrix K is significant.
La mise à jour 204 utilise la correction ds pour réaliser les équations suivantes : Update 204 uses ds correction to achieve the following equations:
- R est une fonction qui permet, à partir d'un vecteur, d'obtenir une matrice de rotation du vecteur, - R is a function which allows, from a vector, to obtain a rotation matrix of the vector,
- ds1:3 est la partie du vecteur de correction relative à la correction de l'orientation, - ds 1:3 is the part of the correction vector relating to the orientation correction,
- ds4:6 est la partie du vecteur de correction relative à la correction de la vitesse, - ds 4:6 is the part of the correction vector relating to the speed correction,
- ds7:9 est la partie du vecteur de correction relative à la correction de la position est le vecteur vitesse corrigé, est le vecteur position corrigé, est la matrice d'orientation corrigée, est la matrice d'incertitude corrigée. - ds 7:9 is the part of the correction vector relating to the position correction is the corrected velocity vector, is the corrected position vector, is the corrected orientation matrix, is the corrected uncertainty matrix.
Dans un autre mode de réalisation la mise à jour 204 utilise la correction ds pour réaliser les équations suivantes : In another embodiment the 204 update uses the ds correction to achieve the following equations:
Avec , autrement dit on insère une matrice V(ds1:3). With , in other words we insert a matrix V(ds 1:3 ).
Les étapes 202 à 204 du procédé sont répétées tout au long de la navigation. Steps 202 to 204 of the method are repeated throughout the navigation.
En particulier le vecteur vitesse corrigé devient le prochain vecteur vitesse précédent, le vecteur position corrigé devient le prochain vecteur position précédent et la matrice d'orientation corrigée devient la prochaine matrice d'orientation précédente. In particular the corrected velocity vector becomes the next vector previous velocity, the corrected position vector becomes the next previous position vector and the corrected orientation matrix becomes the next previous orientation matrix.
Ce procédé utilise la matrice P qui est la matrice de covariance et l'ensemble des opérations appliquées à P au cours du temps sont appelées « équation de Riccati ». Dans le mode de réalisation présenté ci-dessus, les variables cinématiques n'apparaissent jamais dans la matrice P (ou seulement dans les matrices Qn et Rn). Ainsi ce procédé partage une propriété importante des systèmes linéaires. Dans des modes de réalisation plus complexes ces variables cinématiques peuvent apparaître mais le procédé de l'invention permet de réduire les effets négatifs de cette dépendance. This method uses the matrix P which is the covariance matrix and the set of operations applied to P over time are called “Riccati equation”. In the embodiment presented above, the kinematic variables never appear in the matrix P (or only in the matrices Q n and R n ). Thus this process shares an important property of linear systems. In more complex embodiments these kinematic variables may appear but the method of the invention makes it possible to reduce the negative effects of this dependence.
Dans les modes de réalisation précédents, la technique de fusion utilisant le modèle fictif d'attraction terrestre est un filtre invariant. Dans d'autres modes de réalisation on peut utiliser d'autres méthodes de recalage, par exemple filtre de Kalman étendu classique lissage sur fenêtre glissante filtre à gains constants filtre particulaire In the previous embodiments, the merging technique using the fictitious Earth attraction model is an invariant filter. In other embodiments other registration methods can be used, for example conventional extended Kalman filter smoothing on sliding window constant gain filter particle filter
La figure 3 représente un filtre de Kalman linéaire. Les variables cinématiques estimées, qui subissent une série de propagations (utilisant les mesures des accéléromètres et des gyroscopes) et de mises à jour (utilisant un capteur additionnel comme un dispositif de mesure d'une vitesse ou d'une position), sont représentées sur la ligne du milieu. Les mises à jour sont des corrections de l'état estimé prenant en compte la nouvelle mesure issue du capteur additionnel. Le capteur ne donne pas directement la correction à apporter, il donne seulement une mesure. La différence de cette mesure avec la mesure attendue est appelée innovation. Pour transformer cette innovation en une correction de l'état du système, la matrice de gain K est nécessaire. Elle est calculée à partir de l'équation de Riccati apparaissant sur la ligne du bas. Cette équation met à jour la matrice de covariance P qui représente une incertitude sur les variables cinématiques. Cette matrice de covariance P permet de construire la matrice de gains K. Si l'estimation de l'état est fausse, les mesures combinées aux matrices de gains permettent de corriger l'estimation de l'état au fil du temps. Figure 3 shows a linear Kalman filter. The estimated kinematic variables, which undergo a series of propagations (using measurements from accelerometers and gyroscopes) and updates (using an additional sensor such as a speed or position measuring device), are represented on the middle line. The updates are corrections of the estimated state taking into account the new measurement from the additional sensor. The sensor does not directly give the correction to be made, it only gives a measurement. The difference of this measure with the expected measure is called innovation. To turn this innovation into a system state correction, the gain matrix K is needed. It is calculated from the Riccati equation appearing on the bottom line. This equation updates the covariance matrix P which represents an uncertainty on the kinematic variables. This covariance matrix P makes it possible to construct the gain matrix K. If the estimate of the state is false, the measurements combined with the gain matrices make it possible to correct the estimate of the state over time.
La figure 4 représente un filtre de Kalman non linéaire ou étendu. Ce filtre de Kalman permet de gérer l'aspect non linéaire de l'état du dispositif de navigation. La différence entre la figure 3 et la figure 4 est l'ajout de la rétroaction de la ligne du milieu à la ligne du bas. Ainsi dans ce filtre l'état estimé est utilisé pour calculer l'incertitude et les gains. Cette rétroaction peut provoquer une réduction des performances du filtre. Une erreur sur l'état du système induit une erreur sur les gains, qui induit à son tour une erreur sur l'état estimé. Dans l'une des mises en œuvre de l'invention, l'ensemble des opérations impliquant la matrice P ne font pas apparaître l'état estimé du dispositif de navigation DISP (ou seulement dans les matrices Qn et Rn). Ainsi on se place dans le même cas que pour un système linéaire et la rétroaction de la figure 4 a disparu. Figure 4 shows a nonlinear or extended Kalman filter. This Kalman filter makes it possible to manage the nonlinear aspect of the state of the navigation device. The difference between Figure 3 and Figure 4 is the addition of the feedback from the middle line to the bottom line. Thus in this filter the estimated state is used to calculate the uncertainty and the gains. This feedback can cause a reduction in filter performance. An error on the state of the system induces an error on the gains, which in turn induces an error on the estimated state. In one of the implementations of the invention, all of the operations involving the matrix P do not reveal the estimated state of the navigation device DISP (or only in the matrices Q n and R n ). Thus we place ourselves in the same case as for a linear system and the feedback of FIG. 4 has disappeared.

Claims

REVENDICATIONS
1. Procédé d'aide à la navigation d'un véhicule doté d'un dispositif de navigation (DISP) comprenant les étapes suivantes : 1. Navigation aid method for a vehicle equipped with a navigation device (DISP) comprising the following steps:
- acquisition de valeurs à priori de variables cinématiques du dispositif de navigation (DISP), - acquisition of a priori values of kinematic variables of the navigation device (DISP),
- détermination (202) de valeurs courantes respectives des variables cinématiques du dispositif de navigation (DISP) et d'une matrice d'incertitude courante représentative d'une incertitude des valeurs courantes respectives des variables cinématiques, à partir : - determination (202) of respective current values of the kinematic variables of the navigation device (DISP) and of a current uncertainty matrix representative of an uncertainty of the respective current values of the kinematic variables, from:
- de valeurs précédentes respectives des variables cinématiques,- respective previous values of the kinematic variables,
- d'une matrice d'incertitude précédente représentative d'une incertitude des valeurs précédentes respectives des variables cinématiques et - a previous uncertainty matrix representative of an uncertainty of the respective previous values of the kinematic variables and
- d'un modèle d'une gravité terrestre subie par le dispositif de navigation (DISP), une intensité de la gravité modélisée étant croissante avec une altitude du dispositif de navigation (DISP), - a model of a terrestrial gravity undergone by the navigation device (DISP), an intensity of the modeled gravity being increasing with an altitude of the navigation device (DISP),
- détermination (203) d'une correction à partir : - determination (203) of a correction from:
- des valeurs courantes respectives des variables cinématiques et- respective current values of the kinematic variables and
- d'une matrice d'incertitude courante représentative d'une incertitude des valeurs courantes respectives des variables cinématiques et - a current uncertainty matrix representative of an uncertainty of the respective current values of the kinematic variables and
- d'une mesure et - of a measure and
- mise à jour (204) des valeurs courantes respectives des variables cinématiques et de la matrice d'incertitude courante à partir de la correction et de la matrice d'incertitude courante. - updating (204) of the respective current values of the kinematic variables and of the current uncertainty matrix from the correction and the current uncertainty matrix.
2. Procédé selon la revendication 1, les variables cinématiques comprenant : 2. Method according to claim 1, the kinematic variables comprising:
- une orientation du dispositif de navigation (DISP) dont une valeur courante est une matrice d'orientation courante et dont une valeur précédente est une matrice d'orientation précédente, - une vitesse du dispositif de navigation (DISP) dont une valeur courante est un vecteur vitesse courant et une valeur précédente est un vecteur vitesse précédent et - an orientation of the navigation device (DISP), a current value of which is a current orientation matrix and a previous value of which is a previous orientation matrix, - a speed of the navigation device (DISP) of which a current value is a current speed vector and a previous value is a previous speed vector and
- une position du dispositif de navigation (DISP) dont une valeur courante est un vecteur position courant et une valeur précédente est un vecteur position précédent, la matrice d'incertitude courante étant représentative d'une incertitude de la matrice d'orientation courante, du vecteur vitesse courant et du vecteur position courant, et la matrice d'incertitude précédente étant représentative d'une incertitude de la matrice d'orientation précédente, du vecteur vitesse précédent et du vecteur position précédent. - a position of the navigation device (DISP) of which a current value is a current position vector and a previous value is a previous position vector, the current uncertainty matrix being representative of an uncertainty of the current orientation matrix, of the current velocity vector and of the current position vector, and the preceding uncertainty matrix being representative of an uncertainty of the preceding orientation matrix, of the preceding velocity vector and of the preceding position vector.
3. Procédé selon la revendication 2, les valeurs courantes étant associées à un instant courant et les valeurs précédentes étant associées un instant précédent, la détermination (202) des valeurs courantes des variables cinématiques et de la matrice d'incertitude courante comprenant : 3. Method according to claim 2, the current values being associated with a current instant and the previous values being associated with a previous instant, the determination (202) of the current values of the kinematic variables and of the current uncertainty matrix comprising:
- une détermination du vecteur vitesse courant par ajout au vecteur vitesse précédent d'une intégration, sur un intervalle temporel compris entre l'instant précédent et l'instant courant, d'une somme d'une force spécifique du dispositif de navigation (DISP) et de la gravité modélisée, - a determination of the current speed vector by adding to the previous speed vector an integration, over a time interval between the previous instant and the current instant, of a sum of a specific force of the navigation device (DISP) and modeled gravity,
- une détermination du vecteur de position courant par ajout au vecteur de position précédent d'une intégration, sur l'intervalle temporel, du vecteur vitesse précédent, - a determination of the current position vector by adding to the previous position vector an integration, over the time interval, of the previous speed vector,
- une détermination de la matrice d'orientation courante par multiplication de la matrice d'orientation précédente avec une matrice représentative d'une rotation du dispositif de navigation (DISP) ou - a determination of the current orientation matrix by multiplication of the previous orientation matrix with a matrix representing a rotation of the navigation device (DISP) or
- une détermination de la matrice d'incertitude courante à partir de la matrice d'incertitude précédente. - a determination of the current uncertainty matrix from the previous uncertainty matrix.
4. Procédé selon la revendication 2 ou 3, la détermination (203) de la correction comprenant : 4. Method according to claim 2 or 3, the determination (203) of the correction comprising:
- une soustraction du vecteur vitesse courant et de la mesure, et - a subtraction of the current speed vector and the measurement, and
- une multiplication par une matrice de gain. - a multiplication by a gain matrix.
5. Procédé selon la revendication 3 ou 4, la détermination (203) de la correction comprenant : 5. Method according to claim 3 or 4, the determination (203) of the correction comprising:
- la soustraction du vecteur position courant et de la mesure, et - the subtraction of the current position vector and the measurement, and
- une multiplication par une matrice de gain. - a multiplication by a gain matrix.
6. Procédé selon l'une des revendications 2 à 5, la correction étant un vecteur de correction, la mise à jour (204) comprenant : 6. Method according to one of claims 2 to 5, the correction being a correction vector, the update (204) comprising:
- une sous-étape de mise à jour de la matrice d'orientation courante par multiplication d'une matrice de rotation d'une première partie du vecteur de correction et de la matrice d'orientation courante, - a sub-step of updating the current orientation matrix by multiplying a rotation matrix of a first part of the correction vector and the current orientation matrix,
- une sous-étape de mise à jour du vecteur de vitesse courant par ajout au vecteur vitesse d'une multiplication de la matrice de rotation courante et d'une deuxième partie du vecteur de correction et - a sub-step of updating the current speed vector by adding to the speed vector a multiplication of the current rotation matrix and a second part of the correction vector and
- une sous-étape de mise à jour du vecteur de position courant par ajout au vecteur position courant d'une multiplication de la matrice de rotation courante et d'une troisième partie du vecteur de correction. - a sub-step of updating the current position vector by adding to the current position vector a multiplication of the current rotation matrix and a third part of the correction vector.
7. Procédé selon l'une des revendications 2 à 6, la détermination (202) de variables cinématiques du dispositif de navigation (DISP) comprenant une détermination du modèle de la gravité subie utilisant la formule est un vecteur de la gravité modélisée, gréel est un opposé d'un module d'une gravité terrestre issue d'un modèle physiquement cohérent, rT est un rayon de la terre, Xn est le vecteur de position courant et est une altitude mesurée du dispositif (DISP). 7. Method according to one of claims 2 to 6, the determination (202) of kinematic variables of the navigation device (DISP) comprising a determination of the model of the gravity undergone using the formula is a modeled gravity vector, real g is a opposite of a module of an earth's gravity resulting from a physically coherent model, r T is a radius of the earth, X n is the current position vector and is a measured altitude of the device (DISP).
8. Procédé selon l'une des revendications 2 à 6, la détermination (202) de variables cinématiques du dispositif de navigation (DISP) comprenant une détermination du modèle de la gravité subie utilisant la formule est un vecteur de la gravité modélisée, g’réel est un vecteur d'une gravité terrestre issue d'un modèle physiquement cohérent, rT est un rayon de la terre, Xn est le vecteur de position courant, est une altitude mesurée du dispositif de navigation (DISP), alt(Xn) est une altitude du dispositif de navigation (DISP) déterminée à partir du vecteur de position courant et est un vecteur de position modifié dans lequel l'altitude est l'altitude mesurée. 8. Method according to one of claims 2 to 6, the determination (202) of kinematic variables of the navigation device (DISP) comprising a determination of the model of the gravity undergone using the formula is a vector of the modeled gravity, real g' is a vector of an earth gravity resulting from a physically coherent model, r T is a radius of the earth, X n is the current position vector, is a measured altitude of the navigation device (DISP), alt(X n ) is an altitude of the navigation device (DISP) determined from the current position vector and is a modified position vector in which the altitude is the measured altitude.
9. Dispositif de navigation (DISP) d'un véhicule comprenant : 9. Vehicle navigation device (DISP) comprising:
- une unité de traitement (UNIT), - a processing unit (UNIT),
- trois accéléromètres (101-a à 101-c) et - three accelerometers (101-a to 101-c) and
- trois gyroscopes (102-a à 102-c), le dispositif de navigation (DISP) comprenant également : - three gyroscopes (102-a to 102-c), the navigation device (DISP) also comprising:
- un dispositif de mesure (103-a, 103-b) l'unité de traitement (UNIT) étant configurée pour la mise en œuvre du procédé d'aide à la navigation selon l'une des revendications 1 à 7. - a measuring device (103-a, 103-b) the processing unit (UNIT) being configured for the implementation of the navigation aid method according to one of claims 1 to 7.
10. Dispositif de navigation (DISP) selon la revendication 9 comprenant en outre un dispositif de mesure (104) d'une altitude du dispositif de navigation (DISP). 10. Navigation device (DISP) according to claim 9 further comprising a device (104) for measuring an altitude of the navigation device (DISP).
11. Produit programme d'ordinateur comprenant des instructions de code de programme pour l'exécution des étapes du procédé d'aide à la navigation selon l'une des revendications 1 à 8, lorsque celui-ci est exécuté par un processeur. 11. Computer program product comprising program code instructions for executing the steps of the navigation aid method according to one of claims 1 to 8, when the latter is executed by a processor.
EP22713980.5A 2021-03-11 2022-03-11 Method for assisting with the navigation of a vehicle Pending EP4305383A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
FR2102417A FR3120689B1 (en) 2021-03-11 2021-03-11 PROCEDURE FOR AIDING THE NAVIGATION OF A VEHICLE
PCT/FR2022/050442 WO2022189760A1 (en) 2021-03-11 2022-03-11 Method for assisting with the navigation of a vehicle

Publications (1)

Publication Number Publication Date
EP4305383A1 true EP4305383A1 (en) 2024-01-17

Family

ID=76283860

Family Applications (1)

Application Number Title Priority Date Filing Date
EP22713980.5A Pending EP4305383A1 (en) 2021-03-11 2022-03-11 Method for assisting with the navigation of a vehicle

Country Status (5)

Country Link
US (1) US20240159539A1 (en)
EP (1) EP4305383A1 (en)
CN (1) CN117203493A (en)
FR (1) FR3120689B1 (en)
WO (1) WO2022189760A1 (en)

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060074558A1 (en) * 2003-11-26 2006-04-06 Williamson Walton R Fault-tolerant system, apparatus and method
GB2555806A (en) * 2016-11-09 2018-05-16 Atlantic Inertial Systems Ltd A navigation system

Also Published As

Publication number Publication date
CN117203493A (en) 2023-12-08
US20240159539A1 (en) 2024-05-16
WO2022189760A1 (en) 2022-09-15
FR3120689A1 (en) 2022-09-16
FR3120689B1 (en) 2023-03-31

Similar Documents

Publication Publication Date Title
EP3623758B1 (en) Positioning system, and associated method for positioning
EP3213033B1 (en) Method of estimating a navigation state constrained in terms of observability
EP3071934B1 (en) Alignment procedure of an inertial measuring unit
EP3807594B1 (en) Method for calibrating magnetometers fitted in an object
EP2245479A1 (en) Navigation system using phase measure hybridisation
EP3018447A1 (en) Method for determining a radius of protection associated with a navigation parameter of a hybrid inertial navigation system, and associated system
FR3018383A1 (en) METHOD AND DEVICE FOR DETERMINING NAVIGATION PARAMETERS OF AN AIRCRAFT DURING A LANDING PHASE
EP3447654B1 (en) Method for determining the trajectory of a moving object, program and device for implementing said method
EP3004807B1 (en) Method for autonomous calibration of an inertial equipment used in a static mode
EP2048475A1 (en) Method of determining the attitude, position and velocity of a mobile unit
EP2385346A1 (en) Method for creating a navigation phase in a navigation system involving terrain correlation
FR3064350A1 (en) METHOD FOR CALCULATING A SPEED OF AN AIRCRAFT, METHOD FOR CALCULATING A PROTECTIVE RADIUS, POSITIONING SYSTEM AND ASSOCIATED AIRCRAFT
EP3869155A1 (en) Method for determining the position and orientation of a vehicle
EP3891469B1 (en) Hybrid ahrs system comprising a device for measuring the integrity of the calculated attitude
WO2019016474A1 (en) Method for estimating the movement of an object moving in a magnetic field
EP4305383A1 (en) Method for assisting with the navigation of a vehicle
EP3807595A1 (en) Method for calibrating a gyrometer fitted in an object
FR3106885A1 (en) NAVIGATION AID PROCEDURE FOR A MOBILE CARRIER
EP4305384A1 (en) Method for assisting with the navigation of a vehicle
WO2020127716A1 (en) Method for characterising an inertial measurement unit
EP3983759B1 (en) Method for monitoring the performance of inertial measurement units
EP4348180A1 (en) Method for assisting with the navigation of a vehicle
WO2023237829A1 (en) Inertial localization method implementing a gravimetric correlation and associated device
WO2024008942A1 (en) Navigation and positioning device
CN117629201A (en) Positioning method and device for aircraft, aircraft and medium

Legal Events

Date Code Title Description
STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: UNKNOWN

STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: THE INTERNATIONAL PUBLICATION HAS BEEN MADE

PUAI Public reference made under article 153(3) epc to a published international application that has entered the european phase

Free format text: ORIGINAL CODE: 0009012

STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE

17P Request for examination filed

Effective date: 20231009

AK Designated contracting states

Kind code of ref document: A1

Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR

DAV Request for validation of the european patent (deleted)
DAX Request for extension of the european patent (deleted)