CA2644462C - Procede et dispositif de positionnement hybride - Google Patents

Procede et dispositif de positionnement hybride Download PDF

Info

Publication number
CA2644462C
CA2644462C CA2644462A CA2644462A CA2644462C CA 2644462 C CA2644462 C CA 2644462C CA 2644462 A CA2644462 A CA 2644462A CA 2644462 A CA2644462 A CA 2644462A CA 2644462 C CA2644462 C CA 2644462C
Authority
CA
Canada
Prior art keywords
data
distance
unit
delayed
inertial
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.)
Active
Application number
CA2644462A
Other languages
English (en)
Other versions
CA2644462A1 (fr
Inventor
Jean-Paul Petillon
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.)
Airbus Helicopters SAS
Original Assignee
Eurocopter 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 Eurocopter SA filed Critical Eurocopter SA
Publication of CA2644462A1 publication Critical patent/CA2644462A1/fr
Application granted granted Critical
Publication of CA2644462C publication Critical patent/CA2644462C/fr
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
    • 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
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/20Integrity monitoring, fault detection or fault isolation of space segment
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/40Correcting position, velocity or attitude
    • G01S19/41Differential correction, e.g. DGPS [differential GPS]
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/48Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
    • G01S19/49Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled

Abstract

L'invention concerne un procédé de positionnement d'un aéronef par combinaison de données de distances séparant l'aéronef de satellites et de données inertielles, dans lequel : a) on enregistre dans une mémoire FIFO les données de distance pour disposer en sortie de la mémoire de données de distance retardées, b) on combine les données de distances retardées aux données inertielles pour obtenir une estimation de données de position de l'aéronef, c) on surveille l'apparition d'un défaut dans les données de distances et lorsqu'un tel défaut est détecté, on modifie une partie au moins des données enregistrées dans la mémoire FIFO pour les neutraliser.

Description

Procédé et dispositif de positionnement hybride La présente invention est relative à un procédé et à un dispositif de positionnement hybride.
Le domaine technique de l'invention est celui de la fabrication de systèmes de navigation embarqués à bord d'hélicoptères.
La présente invention est en particulier relative à un procédé et à un dispositif de navigation et/ou positionnement qui combine des données de distances séparant un mobile porteur du dispositif ¨ en particulier un giravion ¨ de satellites, et des mesures inertielles.
Au sens de la présente demande, sauf indication -explicite ou implicite- contraire, les termes mesure , donnée , signal , et leurs dérivés, sont considérés comme équivalents, et les termes combiner , hybrider , coupler , et leurs dérivé, sont considérés comme équivalents.
Un récepteur GPS comporte généralement quatre blocs ou modules principaux :
- un premier module est une tête HF (ou RF Front End ) pré
amplifie des signaux captés par l'antenne du récepteur GPS, et réalise un changement de fréquence ;
- un second module est une horloge fournissant aux autres modules une référence précise de temps et de fréquence ; la précision de l'horloge n'étant pas absolue, on modélise les erreurs de temps et fréquence par des biais ;
- un troisième module de traitement du signal décode des messages de navigation en provenance des satellites, pour fournir les éphémérides de la constellation de 24 satellites ; ce premier type de données correspond à la mesure des 24 positions (ou vecteurs de
2 dimension 3, j-js'' --=[xsr" Ys r" zsyl-1y , i = 1 à 24) des satellites ; il s'agit en fait des données nécessaires au calcul (moyennant la connaissance précise du temps) de ces 24 positions ; ce module effectue en outre la mesure des durées de propagation des signaux en provenance des seuls satellites en vue et captés ¨ dont le nombre NCH ( number of chann.els ) est variable- et le calcul des NCH
distances correspondant respectivement aux durées de propagation mesurées ; le biais commun affectant ces mesures correspond au décalage de l'horloge et peut correspondre à plusieurs milliers de kilomètres ; on désigne généralement par pseudo distances les distances ainsi déterminées ; dans la présente demande, sauf indication -explicite ou implicite- contraire, les termes distance et pseudo-distance sont utilisés indifféremment pour désigner les données de distance délivrées par ce module du récepteur ; certains récepteurs fournissent également une mesure de la dérivée de ces quantités ( pseudo range rates ) ;
-un quatrième module de calcul de la solution de navigation résout le système d'équations :
y à NCH) où
'="--[x Y zi est la position de l'antenne, t est le décalage d'horloge et C la vitesse de la lumière : les inconnues étant au nombre de quatre (x, y, z, t), la résolution du système requiert quatre équations scalaires ; lorsque le nombre de canaux de réception du récepteur excède quatre, on utilise la surabondance de données pour diminuer l'erreur et augmenter l'intégrité en utilisant par exemple la méthode des moindres carrés et en détectant les points écartés de la tendance générale.
Ce dernier bloc délivre donc la position et le temps du récepteur corrigé de son bais, le cas échéant une mesure de la dérivée de la position du mobile, i.e. de la vitesse, du porteur.
3 Il est connu de combiner ces données de distance par rapport à des satellites, à des données inertielles délivrées par une centrale inertielle embarquée à bord du mobile, à l'aide d'un filtre de Kalman, pour positionner le mobile, comme décrit par exemple dans le document GPS
and INS in.tegration with Kalman filtering for direct georeferencing of airborn.e imagery , ETH Hônggerberg, Zurich, Institute of Geodesy and Photogrammetry.
On rappelle la signification de sigles usuels qui sont utilisés ci-après :
AAIM : surveillance autonome d'intégrité à bord ( Aircraft Autonomous Integrity Monitoring ) ;
ABAS : système d'amélioration (de renforcement) embarqué
( Aircraft Based Augmentation System ) ;
AFCS : système automatique de contrôle de vol ( Automatic Flight Control System ) ;
EGNOS : système européen de complément à la navigation géostationnaire ( European Geostationary Navigation Overlay System ) ;
FIFO : premier entré, premier sorti ( First In , First Out ) ;
FMS : système de gestion de vol ( Flight Management System ) ;
GBAS : système d'amélioration au sol ( Ground Based Augmentation System ) ;
GNSS : système mondial de navigation par satellite ( Global Navigation Satellite System ) ;
GPS : système de positionnement mondial ( Global Positionning System ) ;
4 INS : système de navigation inertielle ( Inertial Navigation System ) ;
RAIM : contrôle autonome de l'intégrité par le récepteur ( Receiver Autonomous Integrity Monitoring ) ;
SBAS : système de renfort satellitaire ( Space-Based Augmentation System ) ;
TTA : temps pour alerter ( Time to Alert ) ;
PVT : position ¨ vitesse ¨ temps ( Position ¨ Velocity ¨ Time ) ;
VCO : oscillateur commandé en tension ( Voltage Controlled Oscillator ) ;
WAAS : Système d'amélioration à couverture étendue ( Wide Area Augmentation System ).
L'invention a notamment pour objet de permettre la passivation de pannes d'un GNSS et le fonctionnement en mode survie d'un système hybride GNSS/INS de positionnement et/ou de navigation.
Parmi les systèmes de navigation basés sur des satellites, après le système satellitaire Transit des années 1970, qui permettait de faire un point - d'une précision kilométrique - toutes les 90 minutes, apparut le système de navigation GPS, qui émet des signaux en clair (signaux C/A, ou Coarse Acquisition ).
Une limitation importante de ce système est son manque d'intégrité.
D'une part le taux de panne d'un satellite est de l'ordre de 10-4 11-1.
D'autre part les satellites GPS ne communiquent pas entre eux et ne se surveillent donc pas mutuellement. Enfin le segment sol du système GPS n'est pas assez dense pour assurer une surveillance continue de la constellation. Le taux de panne est donc élevé et le temps de signalisation des pannes à
l'utilisateur final peut atteindre plusieurs heures. Ces deux caractéristiques rendent le GPS inutilisable en l'état dans des applications telles que le positionnement d'un aéronef civil en conditions de vol aux instruments IFR .
Un RAIM, tablant sur la redondance des satellites en vue, n'offre qu'un remède partiel à cette situation. Lorsque 5 satellites au moins sont
5 captés et traités par un récepteur RAIM, le récepteur peut élaborer plusieurs solutions PVT, les comparer entre elles et, dans le cas où une dissemblance est détectée, signaler l'anomalie à l'utilisateur. Si plus de 5 satellites sont traités, le récepteur peut localiser et exclure un satellite en panne.
L'inconvénient est que ce type de surveillance aboutit à des rayons de protection qui ne permettent pas de faire des approches de précision, et des rayons d'alerte de plusieurs centaines de mètres.
Les systèmes SBAS ont pour vocation de pallier ces limitations, au moins en partie. Un système SBAS comporte un réseau continental de stations sol qui surveillent la partie visible de la constellation GPS. Le traitement en temps réel des données collectées par ce réseau permet d'identifier les erreurs de chacun des satellites GPS visibles, d'identifier les erreurs dues au retard de propagation ionosphérique en chaque point avec une résolution spatiale suffisante pour permettre une approche de précision en tout lieu du continent considéré, et de détecter les pannes des satellites GPS.
Un segment spatial constitué de satellites géostationnaires peut servir de relais pour transmettre les informations de correction et d'état de santé de la constellation GPS aux récepteurs des utilisateurs finaux ; ces satellites géostationnaires servent aussi de source de données de navigation supplémentaires, puisqu'ils transmettent des messages de navigation identiques à ceux des satellites GPS.
Ces améliorations et compléments permettent d'atteindre une précision métrique (en trois dimensions), des rayons de protection à 10-7 décamétriques (le seuil de 20 mètres de protection verticale est disponible
6 99,9% du temps), et un délai de détection et de signalisation TTA des pannes au maximum égal à 6 secondes selon la norme Do 229.
Du fait de la dimension continentale du dispositif ainsi que des limitations de bande passante des signaux transmis par les satellites géostationnaires, le traitement et le transfert des informations ne peuvent pas être instantanés.
Le délai TTA de détection d'une panne et sa signalisation à
l'utilisateur final constitue l'un des facteurs de coût d'un système SBAS.
Le document GNSS Local componen.t Integrity Concepts , Charles S. Dixon, Journal of Global Positioning Systems, 2003, volume 2, n 2, page 126-134 traite de moyens pour réduire la durée de ce délai.
Une valeur de TTA de 6 secondes est un maximum acceptable pour un aéronef, dont le taux de virage (vitesse de variation de cap) n'excède pas 3 degrés/seconde environ et dont la vitesse de variation de l'angle de roulis est limitée à 4 /s environ.
Par contre, un hélicoptère en approche à forte pente et à faible vitesse d'avancement est beaucoup moins stable qu'un gros porteur évoluant à 150 noeuds sur une pente ILS à 3 . Il est donc nécessaire sur un hélicoptère de mettre en place des lois de pilotages avec des autorités bien plus élevées que celles imposées par les limitations à 4 /s et 3 /s d'un avion de ligne, ce qui n'est pas compatible avec les valeurs de TTA
usuelles.
Ainsi, les SBAS (WAAS ou EGNOS), qui pourraient être une source utile de données de navigation pour les giravions et les drones notamment, ne sont pas adaptés à ce type d'aéronef.
La présente invention répond à cette problématique en permettant notamment une passivation des pannes des satellites GPS
détectées par le SBAS, une réduction jusqu'à zéro du retard à la détection
7 et à la signalisation des pannes (TTA), et un mode de survie en cas de perte complète du SBAS.
Un autre objectif de l'invention est de proposer un système embarqué ou embarquable à bord d'un aéronef pour son positionnement par hybridation de pseudo-distances et d'autres mesures, en particulier des mesures inertielles, qui soit amélioré et/ou qui remédie, en partie au moins, aux lacunes ou inconvénients des systèmes de ce type.
Selon un mode de réalisation préférentiel, il est proposé
d'enregistrer temporairement les données de positionnement satellitaire, avant leur délivrance à un module d'hybridation de ces données avec des données de positionnement non satellitaire, et de modifier, lors de la détection d'un signal de défaut, au moins une partie de ces données temporairement enregistrées.
Selon un autre aspect de l'invention, il est proposé un procédé de positionnement d'un mobile par combinaison de données de distances (m) séparant le mobile de satellites et de données inertielles (û), caractérisé en ce que :
a) on enregistre dans une mémoire FIFO les données de distance pour disposer en sortie de la mémoire de données de distance retardées, b) on combine les données de distances retardées aux données inertielles pour obtenir une estimation (x) de données de position du mobile, c) on surveille l'apparition d'un défaut (DSi) dans les données de distances et lorsqu'un tel défaut est détecté, on modifie une partie au moins des données enregistrées dans la mémoire FIFO pour diminuer ou annuler leur poids dans l'opération de combinaison.
Selon des caractéristiques avantageuses du procédé :
8 - on peut enregistrer des estimations ( ) de données de distance aux satellites en fonction des données inertielles, dans une seconde mémoire FIFO (13) pour disposer en sortie de cette mémoire d'estimations retardées, les capacités des deux mémoires FIFO étant équivalentes de sorte que la valeur du plus grand retard des estimations retardées est identique à la valeur du plus grand retard des données de distance retardées ;
- l'opération de combinaison peut comporter une opération de correction comportant la soustraction d'estimations retardées des données de distance en fonction des données inertielles, aux données de distance retardées, et la pondération ¨ le filtrage - du résultat de cette soustraction, dont le gain (K) peut être constant ou variable ;
le gain peut être calculé en fonction de la covariance (R) à priori des erreurs affectant les données de distance ;
- la valeur de plus grand retard peut être de l'ordre de 1 à 6 secondes ;
- les opérations d'enregistrement et de combinaison peuvent être effectuées (à intervalles de temps réguliers) selon une fréquence de l'ordre de 0,5 Hz au moins, en particulier de l'ordre de 0,5 Hz à 5 Hz ou de l'ordre de 1 Hz à 10 Hz ;
- chaque mémoire FIFO peut permettre d'enregistrer plusieurs vecteurs successifs de données ( r), en particulier de l'ordre d'une dizaines de vecteurs au moins ; chaque vecteur (Fm) de données de distance comporte généralement, pour chaque canal de réception (i.e. chaque satellite), une mesure de pseudo distance ainsi que la variance de l'erreur affectant cette mesure ;
- pour neutraliser des données enregistrées dans la première mémoire FIFO, on peut diminuer la confiance associée à ces données, c'est-à-dire diminuer ou annuler l'inverse de la matrice de covariance des
9 erreurs, et/ou augmenter (en particulier fixer à une valeur très élevée) la covariance des erreurs associées à ces données.
Selon un autre aspect de l'invention, il est proposé une mémoire lisible par un calculateur d'un mobile, la mémoire stockant des énoncés et des instructions d'exécution par le calculateur du mobile pour positionner le mobile, dont l'exécution se fait selon les étapes décrites dans le procédé
décrit plus haut.
Selon un autre aspect de l'invention, il est proposé un dispositif embarqué ou embarquable de positionnement d'un aéronef qui comporte :
- une unité inertielle délivrant des données inertielles (ii), - une unité de réception de distances satellitaires et d'éphémérides délivrant des données de distances, de position, ou de distances et position (rm) de l'unité, - une unité d'hybridation reliée à l'unité inertielle pour recevoir les données inertielles et reliée à l'unité de réception de distances satellitaires pour recevoir les données de distances, l'unité
d'hybridation délivrant des données ( de position estimée en fonction des données inertielles et des données de distances, le dispositif étant caractérisé en ce qu'il comporte en outre :
- une mémoire FIFO couplée avec - insérée entre - l'unité de réception de distances et l'unité d'hybridation, pour délivrer à l'unité
d'hybridation des données retardées de distance, et - une unité de neutralisation sensible à une donnée (DSi) de défaut des données de distance issues d'un satellite (Si) en défaut, et arrangée pour modifier, en présence de cette donnée de défaut, une partie au moins des données de distance enregistrées dans la mémoire.

= CA 02644462 2012-06-18 Selon des caractéristiques avantageuses du dispositif :
- l'unité d'hybridation peut comporter :
- une unité d'estimation délivrant des estimées de distance qui sont calculées à partir des données inertielles, des données de 5 position estimées du récepteur, et des données de position des satellites (éphémérides), - une seconde mémoire FIFO arrangée pour enregistrer les estimées de distance et pour délivrer en sortie des données retardées d'estimées de distance,
10 - une unité de correction comportant une unité de soustraction arrangée pour soustraire les données retardées d'estimées de données de distance aux données retardées de distance délivrées par la première mémoire FIFO, et - un opérateur à gain (K) arrangé pour pondérer les données fournies par l'unité de soustraction ;
- l'unité d'hybridation peut comporter un filtre récursif, en particulier un filtre de Kalman ;
- l'unité de neutralisation peut être reliée à l'unité de réception de distances pour en recevoir les données de défaut.
L'invention peut être mise en uvre par un processeur d'un calculateur embarqué ou embarquable à bord d'un aéronef, qui exécute, lors de la détection d'un défaut un programme comportant des instructions correspondant aux étapes du procédé selon l'invention.
Ainsi, selon un aspect de l'invention, il est proposé une mémoire lisible par un calculateur d'un mobile, la mémoire stockant des énoncés et des instructions d'exécution par le calculateur du mobile pour positionner le mobile par combinaison de données de distances (in) séparant le mobile
11 de satellites et de données inertielles (ii), lesdits énoncés et instructions comprenant:
a) un moyen de codage pour enregistrer dans une mémoire FIFO les données de distance pour disposer en sortie de la mémoire de données de distance retardées, b) un moyen de codage pour combiner les données de distances retardées aux données inertielles pour obtenir une estimation (x) de données de position du mobile, c) un moyen de codage pour surveiller l'apparition d'un défaut (DSi) dans les données de distances et lorsqu'un tel défaut est détecté, on modifie une partie au moins des données enregistrées dans la mémoire FIFO pour diminuer ou annuler leur poids dans l'opération de combinaison, et r.
d) un moyen de codage pour enregistrer des estimations (r) de données de distance aux satellites en fonction des données inertielles, dans une seconde mémoire FIFO pour disposer en sortie de cette mémoire d'estimations retardées, les capacités des deux mémoires FIFO étant équivalentes de sorte que la valeur du plus grand retard des estimations retardées est identique à la valeur du plus grand retard des données de distance retardées.
L'invention permet de passiver des pannes du récepteur GPS au même titre que les pannes des satellites, ce qui autorise une durée de cycle de test intégré ( built-in test ) du récepteur plus longue, et peut éviter l'installation d'un second récepteur.
D'autres aspects, caractéristiques, et avantages de l'invention apparaissent dans la description suivante, qui se réfère aux dessins annexés et qui illustre, sans aucun caractère limitatif, des modes préférés de réalisation de l'invention.

. CA 02644462 2012-06-18 , lia La figure 1 illustre schématiquement la structure d'un second registre d'un système selon l'invention, et ses connections avec les autres modules du système.
La figure 2 illustre schématiquement l'architecture d'un dispositif ou système conventionnel d'hybridation GPS / Inertie comportant un filtre de Kalman.
La figure 3 est un schéma bloc d'un module de calcul du gain du filtre et de calcul de la covariance, dans un système d'hybridation conventionnel.
La figure 4 illustre schématiquement l'architecture d'un dispositif ou système d'hybridation GPS / Inertie conforme à l'invention.
12 L'invention est basée sur la mise en quarantaine des mesures effectuées par le récepteur GPS-SBAS, pendant une durée suffisante pour garantir qu'elles ne sont pas erronées (i.e. pendant 6 secondes pour un SBAS conforme au standard Do229). Cette mise en quarantaine est effectuée par un registre 10 à décalage (ou mémoire FIFO) intercalé(e) entre la sortie du récepteur 11 GPS-SBAS et le filtre de Kalman 12 (cf.
figure 4).
Etant donné qu'il n'est pas envisagé de piloter l'aéronef sur la base d'informations vieilles de 6 secondes, le dispositif réalise une hybridation des mesures GPS-SBAS avec des mesures inertielles. Grâce à la mise en place d'un second registre 13 à décalage (ou mémoire FIFO) pour retarder les données inertielles de la même durée que les données GPS-SBAS, on dispose, en amont du second registre, de données hybrides inertie/distance (composantes du vecteur X ) ne présentant aucun retard.
En outre, le second registre à décalage est considéré en tant que machine à
états, de manière que le récepteur GPS-SBAS constitue un observateur dynamique particulier auquel on applique la technique du filtre de Kalman..
Le dispositif illustré figure 4 comporte deux registres à décalage : un premier registre 10 pour les données GPS, et un second registre 13 pour les données inertielles ; le second registre est équipé d'entrées intermédiaires eo ¨ e59 qui permettent au filtre de Kalman de piloter (par un vecteur c) tous les états du registre, comme illustré schématiquement figure 1 où les soixante blocs Do ¨ D59 marqués z-1 sont des opérateurs de retard élémentaire constituant chacun autant d'états.
La figure 2 illustre schématiquement l'architecture d'un dispositif ou système conventionnel d'hybridation GPS / Inertie comportant un filtre de Kalman.
Le système comporte une représentation synthétique d'une plateforme virtuelle (PFV), où :
13 - U est la mesure inertielle (i.e. la collection des 2 vecteurs 3D des mesures d'accélération'' et de vitesse angulaire c)"' de l'aéronef en repère porteur) ;
- l'opérateur marqué z-1 ou D est un opérateur de retard élémentaire ; cet opérateur agissant sur un vecteur correspond à n opérateurs de retard scalaire ;
- F, H et B sont des matrices caractéristiques de la plateforme virtuelle (les matrices de sa représentation d'état); le calcul de la matrice H fait intervenir les positions de chacun des satellites ;
r..
- x est l'estimé du vecteur d'état du processus, i.e. au minimum la collection des 3 angles d'Euler, des 3 composantes de vitesse, des 3 composantes de position et du biais de l'horloge du récepteur GPS.
Usuellement x comporte également des états markovien s correspondant à la modélisation des erreurs des gyromètres, des accéléromètres et du VCO : par exemple 2 états supplémentaires par axe et par senseur pour modéliser le biais et le bruit en 1/f, conduisant à un vecteur x d'une dimension totale de 24 ;
- r est le vecteur des estimés des pseudo distances aux satellites.
Bien qu'une plateforme virtuelle ne soit pas un processus linéaire, cette représentation est valable pour les erreurs affectant les mesures, seules quantités qui intéressent une hybridation optimale.
Cette représentation montre que la plateforme virtuelle reçoit en entrée 6 mesures inertielles strap-down , délivre en sortie un estimé du vecteur d'état du porteur, et qu'elle peut être linéarisée localement.
Les autres éléments illustrés sur ce schéma sont :
- K, le gain de Kalman ; et
14 ,11 - 7le vecteur des mesures des pseudo distances aux satellites (ces mesures sont issues du récepteur GPS-SBAS).
Ce schéma traduit les équations suivantes :
= F., + Bii (prédiction) õ
K(n,¨ (correction) 17' H ï
F=H1c>i+1 Si les erreurs affectant les mesures de pseudo distance et les mesures inertielles sont des bruits blancs, si R est la matrice de covariance des erreurs affectant les mesures des pseudo distances, et si U est la matrice de covariance des erreurs affectant les mesures inertielles, alors le gain de Ls.
Kalman K et la matrice de covariance X de l'erreur affectant l'estimé -/c de l'état du porteur sont déterminés par le système suivant d'équations récurrentes non linéaires :
Xk+lIk= FX kik Fr BUBT
K = Xk+likHT (H Xk+1IkHT + 1?)-1 X k+iik+i KII)X k+iik Le schéma correspondant à ce système est illustré figure 3.
Une représentation d'un système d'hybridation selon l'invention avec mise en quarantaine des observations, est illustré figure 4.
Le fonctionnement du filtre est fondé sur le caractère borné du délai de détection de panne du dispositif de mesure, ici le système GPS-SBAS. Il est par exemple de 6 secondes au maximum pour un système SBAS
conforme à Do229.
Pour éviter toute pollution de la PFV par des mesures GPS-SBAS
erronées, les mesures des pseudo distances et les estimations a priori de leurs variances, calculées par le récepteur GPS-SBAS, sont mises en quarantaine dans le registre 10 à décalage comprenant le nombre n d'étages requis pour que le temps de traversée de ce registre coïncide avec le (ou soit légèrement supérieur au) délai de détection maximum spécifié ;
5 on choisit par exemple un registre de soixante étages (6 x 10 = 60) pour un récepteur GPS/SBAS délivrant des données à une fréquence de 10 Hz et dont le TTA est de 6s.
En cas de détection d'une panne d'un satellite Si matérialisée par un signal DSi (figure 4), toutes les mesures de pseudo distance issues de ce 10 satellite, contenues dans les étages du registre à décalage 10 de sortie du récepteur 11, sont marquées invalides (i.e. leur variance est forcée à une valeur infinie) par le module 15 de neutralisation recevant le signal DSi.
Ces mesures à variance infinie sont ainsi ignorées par le filtre 12, qui continue dans le même temps à exploiter les mesures des autres satellites et
15 à fournir une mesure de position valide dont la précision sera nominale (ou à peine dégradée si le nombre de satellites restants est suffisant).
Après disparition du signal DSi, le temps ¨ par ex. 1 seconde - au bout duquel les données valides sortent de la mémoire, dépend de la profondeur (nombre d'étages) du registre 10 et de la fréquence d'itération des calculs.
En cas de panne complète du système de positionnement (y compris dans le cas d'une panne du récepteur), toutes les données de tous les satellites sont marquées invalides et le filtre, n'utilisant plus aucune observation, fournit une position inertielle pure (fonctionnement en boucle ouverte) sans avoir été pollué.
Le filtre optimal se déduit en appliquant la règle connue qu'il doit constituer une simulation en ligne du processus et de ses moyens d'observation. On prévoit donc, à la sortie de la PVF, le second registre 13 à décalage symétrique du registre (11) placé en sortie du récepteur GPS-SBAS. Les étages de ce registre à décalage constituent autant d'états
16 supplémentaires du filtre de Kalman (6 x 12=72 états dans le cas d'un récepteur GPS 12 canaux fournissant ses mesures à 1Hz et pour un TTA de 6 secondes). Ces états doivent être pilotés par le filtre, d'où le bouclage (vecteur c) - après le gain K dans le schéma bloc figure 4 - vers le registre à décalage 13.
La relation entre deux états successifs (correspondant à deux itérations d'indice k et (k+1)) d'un registre à décalage dont l'entrée est notée e et la sortie est notée s, peut s'écrire sous la forme :
do ( e (0 0 ... 0 0 ( d do 1 0 ... 0 0 c11 0 ===
d õ_2 d3 0 0 ... 0 0 dõ_2 0 dn-1 ) k+1 d11-2 )k 0 0 ... 1 0) )1, OJ( do \
s=(0... O 1) ...
I d 11-1 k+1 Ou, de manière plus synthétique :
jk-Fi ak+ BE e s=Hrak+i où F. BF et HF sont les matrices d'interconnexion, constituées essentiellement de 0 et de quelques 1 , ces derniers correspondant aux liaisons entre l'entrée générale du registre à décalage et l'entrée du premier étage du registre d'une part, entre la sortie d'un étage et l'entrée du suivant d'autre part, et enfin entre la sortie du dernier étage du registre et la sortie générale du registre à décalage.
On peut transcrire la plateforme équipée de son registre à décalage par les équations :
17 - õ -)7k+i _ F o1 .ik B 1 jk+1 _[
B HF FF k [BF H B
_ _ -=µ[o 1111 1 ïk k _ En posant :
0 B 1= ¨ =
¨[BFHF F
[BE HB et =[0 H1, on aboutit à la formulation:
= exk +V i7 S=dIk que l'on peut traiter comme n'importe quel filtre de Kalman.
Dans un procédé selon l'invention, la dimension des vecteurs et matrices à calculer ou utiliser est augmentée. Par exemple, pour un récepteur GPS fournissant douze composantes de position à 1 Hz, avec un TTA de 6s, on obtient 12 x 6 x 1 = 72 états supplémentaires. Ainsi, le filtre mis en uvre selon l'invention peut comporter plusieurs dizaines ou centaines d'états.
Cependant, grâce au fait que les matrices manipulées sont essentiellement creuses , il n'est généralement pas nécessaire de prévoir une mémoire pour tous ces d'éléments, ni de traiter systématiquement tous les éléments des matrices et des vecteurs.
Le couplage inertie/GPS peut être serré ou lâche ; pour un couplage lâche, on peut utiliser les données de position délivrées par le récepteur GPS, le cas échéant complétées par les données de vitesse ; pour un couplage serré, on peut utiliser les données de pseudo distance délivrées par le récepteur GPS, le cas échéant complétées par les données de pseudo vitesse.
18 Le système selon l'invention peut comporter un capteur d'altitude barométrique, un magnétomètre et/ou un capteur de vitesse air, ainsi que des moyens d'hybridation pour combiner les mesures délivrées par ces capteurs avec les mesures de distance satellitaires, et le cas échéant avec les mesures inertielles. On peut alors combiner aux données de positionnement satellitaire, des mesures de vitesse de l'aéronef dans (par rapport à) l'air, des mesures de cap et/ou de champ magnétique, et/ou des mesures d'altitude et/ou de pression barométrique.
=

Claims (17)

1. Procédé de positionnement d'un mobile par combinaison de données de distances (r m~~) séparant le mobile de satellites et de données inertielles (u~), caractérisé en ce que :
a) on enregistre dans une mémoire FIFO (10) les données de distance pour disposer en sortie de la mémoire de données de distance retardées, b) on combine les données de distances retardées aux données inertielles pour obtenir une estimation (x~~) de données de position du mobile, c) on surveille l'apparition d'un défaut (DSi) dans les données de distances et lorsqu'un tel défaut est détecté, on modifie une partie au moins des données enregistrées dans la mémoire FIFO pour diminuer ou annuler leur poids dans l'opération de combinaison.
2. Procédé selon la revendication 1, dans lequel on enregistre des estimations (r~~) de données de distance aux satellites en fonction des données inertielles et des éphémérides des satellites, dans une seconde mémoire FIFO (13) pour disposer en sortie de cette mémoire d'estimations retardées, les capacités des deux mémoires FIFO étant équivalentes de sorte que la valeur du plus grand retard des estimations retardées est identique à la valeur du plus grand retard des données de distance retardées.
3. Procédé selon la revendication 2 dans lequel l'opération de combinaison comporte la soustraction d'estimations retardées des données de distance en fonction des données inertielles aux données de distance retardées, et la pondération du résultat de cette soustraction.
4. Procédé selon la revendication 3 dans lequel le gain (K) de la pondération est constant.
5. Procédé selon la revendication 3 dans lequel le gain (K) de la pondération est variable.
6. Procédé selon la revendication 5 dans lequel le gain de la pondération est calculé en fonction de la covariance à priori (R) des erreurs affectant les données de distance, et en fonction de la géométrie de la constellation.
7. Procédé selon l'une quelconque des revendications 2 à 6 dans lequel la valeur de plus grand retard est de l'ordre de 1 à 6 secondes.
8. Procédé selon l'une quelconque des revendications 1 à 7, dans lequel les opérations d'enregistrement et de combinaison sont effectuées à
intervalles de temps réguliers, selon une fréquence de l'ordre de 0,5 ou 1 Hz au moins.
9. Procédé selon l'une quelconque des revendications 7 et 8 dans lequel chaque mémoire FIFO permet d'enregistrer plusieurs vecteurs ¨ ou dizaines de vecteurs - successifs de données ( ~ m, ~), chaque vecteur (~ m) de données de distance comportant, pour chaque canal de réception, i.e.
chaque satellite, une mesure de pseudo distance ainsi que la variance de l'erreur affectant cette mesure.
10. Procédé selon l'une quelconque des revendications 1 à 9 dans lequel pour neutraliser des données enregistrées dans la première mémoire FIFO, on diminue la confiance associée à ces données en particulier en augmentant la covariance des erreurs associées à ces données.
11 . Mémoire lisible par un calculateur d'un mobile, la mémoire stockant des énoncés et des instructions d'exécution par le calculateur du mobile pour positionner le mobile, dont l'exécution se fait selon les étapes décrite dans l'une quelconque des revendications 1 à 10.
12. Dispositif (18) embarqué ou embarquable de positionnement d'un aéronef qui comporte :
- une unité (14) inertielle délivrant des données inertielles (~), - une unité (11) de réception de distances satellitaires et d'éphémérides délivrant des données de distances, de position ou de distances et position (~ m) de l'unité (11), - une unité (12, 13, 16, 17, PFV) d'hybridation reliée à l'unité
inertielle pour recevoir les données inertielles et reliée à l'unité de réception de distances satellitaires pour recevoir les données de distances, l'unité d'hybridation délivrant des données (~) de position estimée en fonction des données inertielles et des données de distances, le dispositif étant caractérisé en ce qu'il comporte en outre :
- une mémoire FIFO (10) couplée avec - insérée entre - l'unité (11) de réception de distances et l'unité d'hybridation, pour délivrer à
l'unité d'hybridation des données retardées de distance, et - une unité (15) de neutralisation sensible à une donnée (DS1) de défaut des données de distance issues d'un satellite (Si) en défaut, et arrangée pour modifier, en présence de cette donnée de défaut, une partie au moins des données de distance enregistrées dans la mémoire.
13. Dispositif selon la revendication 12 dans lequel l'unité
d'hybridation comporte :
- une unité d'estimation délivrant des données d'estimées de donnés de distance qui sont calculées à partir des données inertielles et des données de position estimées, - une seconde mémoire FIFO (13) arrangée pour enregistrer les données d'estimées de données de distance et pour délivrer en sortie des données retardées d'estimées de données de distance, - une unité (16) de soustraction arrangée pour soustraire les données retardées d'estimées de données de distance aux données retardées de distance délivrées par la première mémoire FIFO, et - une unité (17) de pondération arrangée pour pondérer les données fournies par l'unité de soustraction.
14. Dispositif selon la revendication 12 ou 13 dans lequel l'unité
d'hybridation comporte un filtre récursif (12).
15. Dispositif selon la revendication 14 dans lequel le filtre récursif est un filtre de Kalman.
16. Dispositif selon l'une quelconque des revendications 12 à 15 dans lequel l'unité (15) de neutralisation est reliée à l'unité (11) de réception de distances pour en recevoir les données de défaut.
17. Mémoire lisible par un calculateur d'un mobile, la mémoire stockant des énoncés et des instructions d'exécution par le calculateur du mobile pour positionner le mobile par combinaison de données de distances (~ m) séparant le mobile de satellites et de données inertielles (~), lesdits énoncés et instructions comprenant:
a) un moyen de codage pour enregistrer dans une mémoire FIFO (10) les données de distance pour disposer en sortie de la mémoire de données de distance retardées, b) un moyen de codage pour combiner les données de distances retardées aux données inertielles pour obtenir une estimation (~) de données de position du mobile, c) un moyen de codage pour surveiller l'apparition d'un défaut (DSi) dans les données de distances et lorsqu'un tel défaut est détecté, on modifie une partie au moins des données enregistrées dans la mémoire FIFO pour diminuer ou annuler leur poids dans l'opération de combinaison, et d) un moyen de codage pour enregistrer des estimations (~) de données de distance aux satellites en fonction des données inertielles, dans une seconde mémoire FIFO (13) pour disposer en sortie de cette mémoire d'estimations retardées, les capacités des deux mémoires FIFO étant équivalentes de sorte que la valeur du plus grand retard des estimations retardées est identique à la valeur du plus grand retard des données de distance retardées.
CA2644462A 2006-03-01 2007-02-12 Procede et dispositif de positionnement hybride Active CA2644462C (fr)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
FR0601819A FR2898196B1 (fr) 2006-03-01 2006-03-01 Procede et dispositif de positionnement hybride
FR0601819 2006-03-01
PCT/FR2007/000255 WO2007099211A2 (fr) 2006-03-01 2007-02-12 Procédé et dispositif de positionnement hybride

Publications (2)

Publication Number Publication Date
CA2644462A1 CA2644462A1 (fr) 2007-09-07
CA2644462C true CA2644462C (fr) 2013-08-20

Family

ID=37177827

Family Applications (1)

Application Number Title Priority Date Filing Date
CA2644462A Active CA2644462C (fr) 2006-03-01 2007-02-12 Procede et dispositif de positionnement hybride

Country Status (7)

Country Link
US (1) US7911380B2 (fr)
EP (1) EP1989510B1 (fr)
CN (1) CN101395443B (fr)
CA (1) CA2644462C (fr)
DE (1) DE602007006915D1 (fr)
FR (1) FR2898196B1 (fr)
WO (1) WO2007099211A2 (fr)

Families Citing this family (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2917175B1 (fr) * 2007-06-08 2010-04-16 Eurocopter France Procede et systeme d'estimation de la vitesse angulaire d'un mobile
US8260552B2 (en) 2008-04-30 2012-09-04 Honeywell International Inc. Systems and methods for determining location information using dual filters
FR2951535B1 (fr) * 2009-10-15 2011-12-02 Sagem Defense Securite Procede de detection de mouvements parasites lors de l'alignement d'une centrale inertielle
FR2955934B1 (fr) 2010-01-29 2012-03-09 Eurocopter France Estimation stabilisee en virage des angles d'assiettes d'un aeronef
DE102011103875A1 (de) * 2011-06-10 2012-12-13 Deutsches Zentrum für Luft- und Raumfahrt e.V. Verfahren zur Bestimmung der aktuellen Position eines Luftfahrzeuges
FR2989174B1 (fr) * 2012-04-06 2016-12-09 Thales Sa Dispositif pour la determination d'informations de localisation et de references primaires inertielles pour un aeronef
FR3002032B1 (fr) 2013-02-08 2016-02-12 Dassault Aviat Systeme et procede d'aide a la navigation d'un aeronef
US8928527B2 (en) * 2013-03-19 2015-01-06 Honeywell International Inc. Systems and methods for reducing error detection latency in LPV approaches
US9547086B2 (en) 2013-03-26 2017-01-17 Honeywell International Inc. Selected aspects of advanced receiver autonomous integrity monitoring application to kalman filter based navigation filter
US9784844B2 (en) 2013-11-27 2017-10-10 Honeywell International Inc. Architectures for high integrity multi-constellation solution separation
DE102014012836B4 (de) * 2014-08-28 2018-09-13 Wirtgen Gmbh Selbstfahrende Baumaschine und Verfahren zur Visualisierung des Bearbeitungsumfeldes einer sich im Gelände bewegenden Baumaschine
CN110926483B (zh) * 2019-11-25 2020-12-25 奥特酷智能科技(南京)有限公司 一种用于自动驾驶的低成本传感器组合定位系统及方法
CN111044069B (zh) * 2019-12-16 2022-04-29 驭势科技(北京)有限公司 一种车辆定位方法、车载设备及存储介质
CN113514810B (zh) * 2021-07-07 2023-07-18 北京信息科技大学 Mimo雷达观测噪声优化方法及装置

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5420592A (en) * 1993-04-05 1995-05-30 Radix Technologies, Inc. Separated GPS sensor and processing system for remote GPS sensing and centralized ground station processing for remote mobile position and velocity determinations
US5948044A (en) * 1996-05-20 1999-09-07 Harris Corporation Hybrid GPS/inertially aided platform stabilization system
US6317688B1 (en) * 2000-01-31 2001-11-13 Rockwell Collins Method and apparatus for achieving sole means navigation from global navigation satelite systems
US6549829B1 (en) * 2001-10-31 2003-04-15 The Boeing Company Skipping filter for inertially augmented landing system
US6697736B2 (en) * 2002-02-06 2004-02-24 American Gnc Corporation Positioning and navigation method and system thereof
FR2866423B1 (fr) * 2004-02-13 2006-05-05 Thales Sa Dispositif de surveillance de l'integrite des informations delivrees par un systeme hybride ins/gnss
US7471238B2 (en) * 2005-11-01 2008-12-30 The Aerospace Corporation Multitarget tracking antispoofing receiver

Also Published As

Publication number Publication date
US7911380B2 (en) 2011-03-22
US20090278740A1 (en) 2009-11-12
WO2007099211A2 (fr) 2007-09-07
CA2644462A1 (fr) 2007-09-07
CN101395443B (zh) 2011-11-16
EP1989510B1 (fr) 2010-06-02
FR2898196A1 (fr) 2007-09-07
FR2898196B1 (fr) 2008-04-25
DE602007006915D1 (de) 2010-07-15
EP1989510A2 (fr) 2008-11-12
CN101395443A (zh) 2009-03-25
WO2007099211A3 (fr) 2007-10-18

Similar Documents

Publication Publication Date Title
CA2644462C (fr) Procede et dispositif de positionnement hybride
CA2970504C (fr) Procede et systeme de validation de geolocalisation par satellite
CA2589463C (fr) Recepteur de positionnement par satellite a integrite et continuite ameliorees
EP2069818B1 (fr) Procede et dispositif de surveillance de l'integrite des informations delivrees par un systeme hybride ins/gnss
EP2449409B1 (fr) Procede de determination de la position d'un mobile a un instant donne et de surveillance de l'integrite de la position dudit mobile.
EP1914561B1 (fr) Procédé de localisation d'un véhicule par satellites et garantie d'intégrité avec sélection d'un sous-groupe de satellites
FR2866423A1 (fr) Dispositif de surveillance de l'integrite des informations delivrees par un systeme hybride ins/gnss
EP2021822A1 (fr) Dispositif de navigation aerienne a capteurs inertiels et recepteurs de radionavigation et procede de navigation aerienne utilisant de tels elements
FR2949866A1 (fr) Systeme hybride et dispositif de calcul d'une position et de surveillance de son integrite.
EP2987036B1 (fr) Procede de controle d'integrite et dispositif de fusion-consolidation comprenant une pluralite de modules de traitement
EP0902897B1 (fr) Recepteur de signaux de satellites avec controle d'integrite de calcul de vitesse
WO2010070012A1 (fr) Dispositif d'hybridation en boucle fermee integre par construction
FR3026195A1 (fr) Systeme d'exclusion d'une defaillance d'un satellite dans un systeme gnss
EP3353573B1 (fr) Procédé et système de positionnement ferroviaire
FR2950702A1 (fr) Procede et dispositif de localisation dynamique d'un mobile
FR3066611A1 (fr) Systeme d'augmentation d'un systeme de positionnement par satellites et recepteur a surveillance d'integrite autonome augmentee par un reseau
FR2853062A1 (fr) Aide a la navigation augmentee en integrite verticale
WO2024008635A1 (fr) Dispositif et procede de maintien de l'integrite du positionnement d'un vehicule independamment de la vulnerabilite de donnees satellitaires
FR3059785A1 (fr) Procede de determination d'une position geographique d'un aeronef

Legal Events

Date Code Title Description
EEER Examination request