Brevet FR3084176A1 — publié le 20200124

DOMAINE DE [INVENTION La présente invention concerne un procédé d'aide à la navigation d'un porteur utilisant un filtre de Kalman invariant. ETAT DE LA TECHNIQUE Le problème de l'estimation de l'état d'un système physique se pose en général de la façon suivante. L'état du système à un instant n est représenté par un vecteur X', et une observation disponible à l'instant n est représentée par un autre vecteur Yn. L'évolution du système s'écrit : 4+1 = f(Xn) Où f est une fonction connue (généralement appelée fonction de propagation), pouvant dépendre de mesures de capteurs. Les observations Y' sont reliées à l'état du système par une fonction d'observation h connue: Yr, = h(X') Construire une bonne estimation X, de l'état X' à partir de la séquence (Y,)n,0 est en général un problème difficile, pouvant néanmoins être simplifié dans certains cas. On appelle « systèmes linéaires » le cas particulier des systèmes de la forme : Xn+1 = EX'±w, Y, = HX, g, où F est une matrice de propagation, H est une matrice d'observation, w' et V', sont des bruits venant perturber les prédictions et les mesures. Dans ce cas linéaire, une méthode connue consiste à construire un estimateur désigné sous le nom de filtre de Kalman. Ce filtre de Kalman met en oeuvre les calculs suivants : gn-Fùn = Fgnin gn-F1In+1= + Kn+10n+1- H2n-F1ln) où les indices n + lin et n + lin + 1 désignent respectivement l'estimation calculée à l'instant n + 1 sans tenir compte de l'observation 17'±1 et à l'instant n + 1 en tenant compte de l'observation Y'±1. La matrice IC' est appelée « matrice de gains », elle peut être calculée à l'aide d'une équation de Riccati. L'erreur d'estimation est alors définie comme : e'1' = X' - .3?'1' (après la prise en compte de l'observation Yn) = Xn-F1- (avant la prise en compte de l'observation Yn+1) On peut facilement vérifier que cette erreur suit ['évolution suivante : en+lin = Fenl, (avant la prise en compte de l'observation Y',1) en-Flin+1 = - (après la prise en compte de l'observation Y, +1) où I désigne la matrice identité. 2 Les équations ci-dessus ne dépendent pas de XT,, on peut donc construire un estimateur fonctionnant pour toute trajectoire réelle du système, ce qui n'est pas le cas pour un système non-linéaire quelconque. Dans le cas d'un système non linéaire, un filtre de Kalman ordinaire ne peut être mis 5 en oeuvre. Il a ainsi été proposé une variante du filtre de Kalman appelée filtre de Kalman « étendu lequel est adapté à un système non linéaire. Toutefois, lorsqu'un filtre de Kalman étendu est utilisé, les simplifications constatées dans le cas linéaire ne se produisent plus, si bien qu'on obtient une équation d'erreur faisant intervenir X7., et Xn. Ce problème est à l'origine de la plupart des cas de divergence que l'on rencontre lorsque l'on utilise un filtre 10 de Kalman étendu. Néanmoins, un deuxième cas particulier rendant le problème d'estimation plus facile est celui des systèmes d'observation groupe-affines », c'est-à-dire les systèmes pour lesquels on dispose d'une loi de composition interne (c'est-à-dire une opération que l'on notera dans la suite par une étoile *) définie sur l'espace de l'état considéré et telle que les 15 deux propriétés suivantes soient vérifiées : a. La fonction de propagation f vérifie pour tout couple a, b d'éléments de l'espace d'état la relation : f (a b) = f (a) f (I cl)-1 * f (b) Où Id est l'élément identité du groupe induit par la loi ". 20 b. La fonction d'observation h est de la forme h(X) = 1(x, yo), avec yo un élément de l'espace des observations (auquel appartiennent les Y.',) et i(.,. ) une action de groupe, c'est-à-dire une fonction vérifiant 1(a * b , = 1(a, 1(b, y)) Sous ces deux conditions, on peut définir un filtre de Kalman étendu dit - invariant 25 (généralement appelé plus simplement « filtre de Kalman invariant -) qui est régi par les équations suivantes : gin+11n = f(gnIn) gn+11n+1 = gn+1 * eXen Kgn+1n, Yn+1) 1(I d, yo)1) où exp() est l'application exponentielle (cette fonction est connue dès que la loi de 30 composition interne est connue, si elle définit un groupe de Lie) et Kn est une - matrice de gain » comme dans le cas linéaire. On peut alors montrer que l'erreur d'estimation aura là aussi une évolution autonome, comme dans le cas linéaire. Le problème d'estimation de l'état est donc simplifié, et ce même si le système considéré n'est pas linéaire. Lorsque la condition b. n'est pas vérifiée on peut utiliser un filtre de la forme 35 j'n+11n = f(r(nIn) 3 2n-F1In+1 = grt+11n *exp(K'+i[Yn+1 h(2'+11n)]) En pratique, un filtre de Kalman est en général implémenté sur un système qui ne vérifie pas la condition a., mais qui s'approche d'un système qui lui vérifie bien cette condition a. 5 Des filtres de Kalman invariants ont ainsi été utilisés pour aider à la navigation d'un porteur. Un filtre de Kalman invariant utilisé dans un tel contexte d'aide à la navigation estime un état de navigation représentatif d'un mouvement du porteur considéré. L'utilisation d'un filtre de Kalman invariant réclame de trouver une loi de composition interne "` pour laquelle les conditions a. et b. sont vérifiées ou quasiment vérifiées afin de 10 rendre le problème de l'estimation plus facile. Il n'existe pas de méthode générique permettant de trouver une telle opération, et des publications diverses ont eu pour objet de fournir la bonne opération pour des systèmes particuliers. A titre d'exemples : a) L'opération à utiliser pour un problème d'estimation d'orientation et de vitesse est décrit dans le document suivant : Bonnable, S., Martin, P., Et Salaün, E. (2009). 15 Invariant Extended Kalman Filter: theory and application to a velocity-aided attitude estimation problem. In Decision and Control, 2009 held jointly with the 2009 28th Chinese Control Conference. CDC/CCC 2009. Proceedings of the 48th IEEE Conference on (pp. 1297-1304). IEEE. b) L'opération à utiliser pour une navigation inertielle avec estimation de l'orientation, 20 la vitesse et la position est décrite dans le document suivant : Barrau, A., a Bonnabel, S. (2017). The invariant extended Kalman filter as a stable observer. IEEE Transactions on Automatic Control, 62(4), 1797-1812. c) L'opération à utiliser pour le SLAM (acronyme anglais de Simultaneous Localization And Mapping), c'est-à-dire une navigation utilisant des points de repère fixes de 25 l'environnement du porteur, est décrite dans le document Barrau, A., Et Bonnabel, S. (2015). An EKF-SLAM algorithm with consistency properties. arXiv preprint arXiv:1510.06263. d) Une liste de systèmes pratiques pour lesquels une opération est connue est en outre décrite dans le document Barrau, A., Et Bonnabel, S. (2017). Linear observation 30 systems on groups (I). Dans chacune de ces applications, sont utilisés des capteurs proprioceptifs d'un porteur et un filtre de Kalman invariant pour estimer l'état de navigation de ce porteur. Ces applications sont de deux types. Certaines d'entre elles utilisent des données cinématiques exprimées dans un repère de référence dans lequel le porteur est mobile. 35 Toutefois, ces données cinématiques ne sont pas toujours disponibles. Les autres applications 4 n'utilisent pas de telles données cinématiques, mais, en contrepartie, ne permettent pas d'estimer un état de navigation du porteur dans le repère de référence ; ces applications ne peuvent produire que des états de navigation relatifs à une situation initiale. 5 EXPOSE DE L'INVENTION Un but de l'invention est de surmonter les inconvénients ci-dessus mentionnés. Il est dès lors proposé, selon un premier aspect de l'invention, un procédé d'aide à la navigation d'un premier porteur immobile par rapport à un deuxième porteur lui-même mobile dans un repère de référence, le procédé comprenant les étapes suivantes mises en 10 oeuvre par le premier porteur : - réception d'un état de navigation dans le repère de référence du deuxième porteur fourni par le deuxième porteur, - acquisition de données de mouvement du premier porteur par au moins un capteur proprioceptif du premier porteur, 15 - estimation d'un état de navigation du premier porteur par un filtre de Kalman invariant utilisant l'état de navigation du deuxième porteur comme données d'observation, dans lequel l'état de navigation du premier porteur comprend : o des premières variables représentatives d'une première transformation rigide liant un repère attaché au premier porteur au repère de référence, et 20 o des deuxièmes variables représentatives d'une deuxième transformation rigide liant un repère attaché au deuxième porteur au repère attaché au premier porteur, et dans lequel le filtre de Kalman invariant utilise comme loi de composition interne une loi comprenant une composition terme à terme de la première transformation rigide 25 et de la deuxième transformation rigide. Le procédé proposé exploite avantageusement le fait que le premier porteur soit immobile par rapport à un deuxième porteur dont on connaît déjà un état de navigation estimé, constituant une information de nature absolue c'est-à-dire par rapport au repère de référence dans lequel le deuxième porteur est mobile. 30 Ce procédé a pour avantage de fonctionner même si le premier porteur ne connait pas sa position relativement au deuxième porteur (autrement dit lorsque le premier porteur et le deuxième porteur ne sont pas harmonisés). Il se trouve par ailleurs que la loi de composition interne utilisée dans ce procédé permet s'approcher des conditions a. et b. énoncées en introduction. Les calculs mis en 5 oeuvre par le filtre de Kalman invariant sont donc particulièrement simples à mettre en oeuvre. Le procédé selon le premier aspect de l'invention peut en outre comprendre les caractéristiques facultatives suivantes, prises seules ou en combinaison lorsque cela est 5 techniquement possible. De préférence, les premières variables comprennent une matrice de rotation représentant une orientation du premier porteur, et les deuxièmes variables comprennent une matrice de rotation représentant l'orientation du deuxième porteur par rapport au premier porteur. 10 De préférence, les premières variables comprennent un vecteur de position du premier porteur, et les deuxièmes variables comprennent un vecteur de position du deuxième porteur par rapport au premier porteur. De préférence, l'état de navigation du premier porteur estimé comprend en outre un vecteur vitesse du premier porteur dans le repère de référence. 15 De préférence, la loi de composition interne applique des transformations identiques à l'un des vecteurs de position et au vecteur vitesse. De préférence, l'état de navigation du deuxième porteur reçu comprend un vecteur de position du deuxième porteur dans Le repère de référence et une matrice de rotation représentant une orientation du deuxième porteur dans le repère de référence. 20 De préférence, le filtre de Kalman invariant utilise une innovation comprenant un vecteur Zx de la forme : = logct-1 ° Y ° où : - pi est une estimée des premières variables, 25 - t 1 est une estimée des deuxièmes variable, dans lequel la deuxième transformation rigide permet de passer du premier repère au deuxième repère, - Y désigne les données d'observations utilisées par le filtre de Kalman invariant, - 0 désigne une composition, - Iog(-) désigne une application logarithme d'un groupe de Lie. 30 De préférence, l'état de navigation du deuxième porteur reçu comprend un vecteur vitesse du deuxième porteur dans le repère de référence et une matrice de rotation représentant une orientation du deuxième porteur dans le repère de référence, les données de mouvement du premier porteur, acquises le capteur proprioceptif, comprennent une vitesse angulaire du premier porteur. 6 De préférence, les premières variables comprennent une matrice de rotation représentant une orientation du premier porteur, et les deuxièmes variables comprennent une matrice de rotation représentant l'orientation du deuxième porteur par rapport au premier porteur, et le filtre de Kalman invariant utilise une innovation comprenant un 5 vecteur Z" de la forme : log (M R21721, PI (v2 - 131)+ firR2(w x 221))) où : - Rl est une estimée de la matrice de rotation représentant une orientation du premier porteur. 10 - ii21 est une estimée de la matrice de rotation représentant l'orientation du deuxième porteur par rapport au premier porteur, - x21 est une estimée d'un vecteur de translation définissant la deuxième transformation rigide, - R2 est la matrice de rotation représentant une orientation du deuxième porteur dans 15 le repère de référence, - y2 est le vecteur vitesse du deuxième porteur dans le repère de référence, - w est la vitesse angulaire du premier porteur, - x désigne un produit vectoriel, - log(-) désigne une application logarithme du groupe de Lie SE(3). 20 De préférence, le vecteur Zr est constitué d'un premier vecteur 4' de taille 3 représentatif d'une rotation, et d'un deuxième vecteur ZIr; de taille 3 également, et dans lequel le filtre de Kalman invariant utilise une innovation Z de la forme : Z (Z41') De préférence, l'état de navigation du premier porteur estimé comprend en outre au 25 moins un état d'erreur propre au capteur proprioceptif, et la loi de composition interne est additive pour cette variable d'erreur propre au capteur proprioceptif. De préférence, le premier porteur est un aéronef et le deuxième porteur est un porte-aéronefs, ou le premier porteur est un projectile et le deuxième porteur est un aéronef qui porte le projectile, ou le premier porteur est une centrale inertielle d'un véhicule et le 30 deuxième porteur est un capteur extéroceptif du véhicule. De préférence, l'étape d'estimation est mise en oeuvre en parallèle par plusieurs filtres de Kalman invariants, de sorte à obtenir plusieurs estimées de l'état de navigation du premier porteur, et comprend par ailleurs des étapes de : - pour chaque estimée, détermination d'une métrique de vraisemblance de l'estimée, 7 - production d'une estimée consolidée de l'état de navigation du premier porteur en fonction des estimées et de leurs métriques de vraisemblance associées. Il est également proposé, selon un deuxième aspect de l'invention, un dispositif d'aide 5 à la navigation d'un premier porteur immobile par rapport à un deuxième porteur lui-même mobile dans un repère de référence, le dispositif comprenant : - au moins un capteur proprioceptif configuré pour acquérir des données de mouvement du premier porteur, - une interface de communication pour recevoir un état de navigation du deuxième 10 porteur fourni par le deuxième porteur, - un filtre de Kalman invariant configure pour estimer un état de navigation du premier porteur en utilisant l'état de navigation du deuxième porteur comme données d'observation, dans lequel l'état de navigation comprend : o des premières variables représentatives d'une première transformation rigide 15 liant un repère attaché au premier porteur au repère de référence, et o des deuxièmes variables représentatives d'une deuxième transformation rigide liant un repère attaché au deuxième porteur au repère attaché au premier porteur, et et dans lequel le filtre de Kalman invariant utilise comme loi de composition interne 20 une loi comprenant une composition terme à terme de la première transformation rigide et de la deuxième transformation rigide. DESCRIPTION DES FIGURES D'autres caractéristiques, buts et avantages de l'invention ressortiront de la description 25 qui suit, qui est purement illustrative et non limitative, et qui doit être lue en regard des dessins annexés sur lesquels : - La figure 1 illustre schématiquement deux porteurs et des repères. - La figure 2 illustre de façon schématique des composants internes des porteurs de la figure 1, selon un mode de réalisation de l'invention. 30 - La figure 3 est un organigramme d'étapes d'un procédé d'aide à la navigation, selon un mode de réalisation de l'invention. Sur l'ensemble des figures, les éléments similaires portent des références identiques. DESCRIPTION DETAILLEE DE L'INVENTION 35 1/ Description du système 8 En référence à la figure 1, un système comprend un premier porteur 1 et au moins un deuxième porteur 2 immobile par rapport au premier porteur 1. Dans ce qui suit, on considère différents repères : un premier repère attaché au premier porteur 1, un deuxième repère attaché au deuxième porteur 2, et un repère de référence 5 dans lequel les deux porteurs 1, 2 sont mobiles. Le repère de référence est par exemple un repère céleste attaché à des étoiles ou à la terre. Sur la figure 1, le deuxième porteur est très schématiquement représenté par un parallélépipède, et le premier porteur par un objet de plus petites dimensions posé sur le premier porteur. Cette représentation n'est toutefois que schématique, et les deux porteurs 10 peuvent être de types variés. Dans un mode de réalisation, le premier porteur est un aéronef, par exemple un avion ou un hélicoptère, et le deuxième porteur est un porte-aéronefs, par exemple un navire de type porte-avions sur lequel l'avion est posé. Dans un autre mode de réalisation, le premier porteur est un projectile, par exemple 15 un missile, et le deuxième porteur est un aéronef qui porte le projectile, par exemple un avion ou un hélicoptère. Dans un autre mode de réalisation, le premier porteur est une centrale inertielle d'un véhicule, par exemple terrestre, et le deuxième porteur est un capteur extéroceptif du même véhicule. 20 En référence à la figure 2, le premier porteur 1 comprend une interface de communication de données avec le deuxième porteur 2. L'interface de communication 4 est de type radio sans fil (Wi-Fi, bluetooth) et comprend par exemple une antenne. En variante cette interface est filaire. Le premier porteur 1 comprend au moins un capteur proprioceptif 6. Chaque capteur 25 proprioceptif utilisé est configuré pour acquérir des données de mouvement du premier porteur dans le premier repère. Ces données comprennent typiquement des vitesses angulaires, et des accélérations. Le capteur proprioceptif comprend par exemple une centrale inertielle laquelle comprend une pluralité de capteurs inertiels tels que des gyromètres et des accéléromètres. 30 En variante ou complément, le capteur proprioceptif comprend au moins un odomètre. Le premier porteur 1 comprend par ailleurs une unité de traitement de données 10. L'unité de traitement 10 est agencée pour traiter des données reçues par l'interface de communication 4. L'unité de traitement de données 10 comprend typiquement au moins un processeur 35 configuré pour mettre en oeuvre un procédé d'aide à la navigation qui sera décrit ci-après, 9 au moyen d'un filtre de Kalman de type invariant. Le filtre de Kalman invariant se présente typiquement sous la forme d'un programme informatique exécutable par le processeur de l'unité de traitement de données. Le fonctionnement général d'un filtre de Kalman invariant est connu en lui-même. Toutefois, on verra dans la suite que la loi de composition interne 5 utilisée pour configurer le filtre de Kalman invariant mis en oeuvre par l'unité de traitement 10 est choisie de manière particulière. De préférence, l'unité de traitement 10 est adaptée pour mettre en oeuvre plusieurs filtres de Kalman en parallèle. Par ailleurs, le deuxième porteur 2 comprend des moyens pour estimer un état de 10 navigation de ce deuxième porteur dans le repère de référence. Ces moyens sont connus en même. On pourra par exemple utiliser les moyens décrits dans le document intitulé « Aided navigation: GPS with high rate sensors -par Jay Farell, publié en 2008. Le deuxième porteur 2 comprend en outre une interface de communication avec le premier porteur 1, du même type que l'interface de communication X. 15 2/ Configuration du filtre de Kalman invariant Le filtre de Kalman invariant mis en oeuvre par l'unité de traitement 10 est configuré pour estimer un état de navigation du premier porteur 1 dans le repère de référence. L'état de navigation du premier porteur comprend des premières variables 20 représentatives d'une première transformation rigide liant le premier repère (attaché au premier porteur 1) au repère de référence, et des deuxièmes variables représentatives d'une deuxième transformation rigide liant le deuxième repère (attaché au deuxième porteur 2) au premier repère. De façon bien connue, une transformation rigide (également connue sous le nom 25 d'isométrie affine), est une transformation qui conserve les distances entre chaque paire de point d'un solide. Ainsi, chacune des première et deuxième transformations rigides peut être caractérisée par la composition d'une rotation et d'une translation. Dans la suite, on détaillera un mode de réalisation dans lequel l'état de navigation du premier porteur, noté X1, comprend les éléments suivants : 30 X1 = (R1, V1, Xi, R21, X21) où: - R1 est une matrice de rotation représentant l'orientation du premier porteur dans le repère de référence (composante de rotation de la transformation qui permet de passer de coordonnées d'un point dans le premier repère à des coordonnées du même 35 point porteur dans le repère de référence), 10 - 191 est un vecteur vitesse représentant la vitesse du premier porteur dans le repère de référence, - x1 est un vecteur position représentant la position du premier porteur dans le repère de référence (il s'agit de la composante de translation de la transformation qui 5 permet de passer de coordonnées d'un point dans le premier repère à des coordonnées du même point dans le repère de référence), - R21 est une matrice de rotation représentant une orientation relative entre le premier repère et le deuxième repère. On prendra comme exemple ici une matrice permettant de passer du premier repère (attaché au premier porteur 1) au deuxième 10 repère (attaché au deuxième porteur 2), l'inverse étant parfaitement envisageable. - x21 est un bras de levier entre le premier porteur 1 et le deuxième porteur 2. Il s'agit d'un vecteur de translation permettant de passer des coordonnées d'un point dans le premier repère aux coordonnées du même point dans le deuxième repère. Dans ce mode de réalisation particulier, les premières variables sont R1, x1 et y1 ; et 15 tes deuxièmes variables sont R21, )(21. Dans la suite on considère que la première transformation rigide est T1 = (R1, x1) et que la deuxième transformation rigide est T21 = (R21, x21). Le filtre de Kalman invariant est en outre configuré pour utiliser comme données d'observation un état de navigation X2 du deuxième porteur 2, exprimé dans le repère de 20 référence. L'état de navigation du deuxième porteur 2 comprend typiquement - une matrice de rotation R2 représentant l'orientation du deuxième porteur dans le repère de référence (composante de rotation de la transformation rigide qui permet de passer de coordonnées d'un point dans le deuxième repère à des coordonnées du 25 même point porteur dans le repère de référence), - x2 un vecteur position représentant la position du deuxième porteur dans le repère de référence (il s'agit de la composante de translation de la transformation rigide qui permet de passer de coordonnées d'un point dans le deuxième repère à des coordonnées du même point porteur dans le repère de référence). 30 IL est envisageable d'inclure un vecteur vitesse y, représentant la vitesse du deuxième porteur dans le repère de référence, dans cet état. On considérera néanmoins dans la suite que cet état ne comprend pas une telle vitesse. L'observation du filtre de Kalman invariant s'écrit alors 35 Y = T2 = (R2, X2) 11 Le filtre de Kalman invariant est configuré pour utiliser comme loi de composition interne, notée ", une composition terme à terme de la première transformation rigide et de la deuxième transformation rigide. Cette loi de composition peut être étendue au vecteur vitesse du premier porteur, 5 Lorsque celui-ci est compris également dans l'état de navigation du premier porteur. Dans ce cas, la loi de composition interne * applique des transformations identiques à l'un des vecteurs de position et au vecteur vitesse. La loi de composition interne est appliquée à des états (R v R y ) et 1, 1, I, 21, 21, - - (Ri, v, W2i, x,.) de la manière suivante : 10 (R1, v1, xi, R2i, X21) * (Ri, v1, xi, R2i, x 1) = + + R1xi,R21Rz1.x21 + R nx2i) On constate ici que le deuxième terme et te troisième terme du produit de la loi de composition interne * sont de même forme en raison du fait que les positions et les vitesses sont traités par cette loi de la même manière. 15 3/ Procédé d'aide à la navigation du premier porteur En référence à la figure 3, un procédé d'aide à la navigation du premier porteur 1 selon un mode de réalisation, et mettant en oeuvre un filtre de Kalman invariant configuré de la manière indiquée en section 2/, comprend les étapes suivantes. On suppose qu'une estimation 21 de l'état de navigation du premier porteur 1 a été 20 estimée par le filtre de Kalman invariant. On suppose par ailleurs que le deuxième porteur a estimé un état de navigation X2 de ce deuxième porteur dans le repère de référence, à l'aide de ses moyens internes 12. Cet état de navigation X2 comprend la transformation rigide T2 formée par le couple (R2, x2). Dans une étape 102, l'interface de communication 4 du premier porteur 1 reçoit de 25 t'interface de communication 14 du deuxième porteur 2 les données représentatives de la transformation rigide T2. Ces données sont transmises ensuite à l'unité de traitement 10. Dans une étape 104, l'unité de traitement 10 calcule l'innovation Z du filtre de Kalman invariant, de ta manière suivante Z = Zx = logLiT1 o T21/ 30 où : - Y désigne les données d'observations utilisées par le filtre de Kalman invariant, qui, on le rappelle, correspondent à T2) - o désigne l'opérateur de composition des transformations rigides, - log( ) désigne une application logarithme au sens de la théorie des groupes de Lie, 35 connue de l'homme du métier. 12 Ce calcul d'innovation est particulièrement avantageux car permet de satisfaire les conditions a. et b. énoncées en introduction. Dans une étape de correction 106, l'unité de traitement 10 de données multiplie l'innovation Z par une matrice K dite de « gain -, ce qui traduit Z en une correction linéaire 5 dX1 = KZ à appliquer à l'état du système X,. Le choix des gains est une question classique commune à la plupart des méthodes d'estimation (voir plus bas). Dans une étape de rétraction 108, l'unité de traitement 10 transforme la correction linéaire dX1 en une correction non linéaire C, de même nature que X, (l'état Xi n'est pas un 10 vecteur car il contient des rotations). La transformation utilisée est une fonction quelconque prenant en argument un vecteur de la dimension de l'état X, (15 dans notre cas) et retournant un objet de même nature que X, mais un choix particulièrement performant est l'exponentielle terme à terme du groupe de Lie des couples de transformations rigides. Est ensuite mise en oeuvre par l'unité de traitement 10 une étape de mise à jour non 15 linéaire 110. Dans cette étape 110, l'unité de traitement 10 combine l'estimation X, de l'état du système à la correction non linéaire C1 pour construire une estimation corrigée : Xi =X1,C1 La matrice K de gain est choisie de manière à stabiliser l'erreur d'estimation non linéaire e définie par : 20 e = Xi1 *R, Où le symbole .-1 est l'inversion usuelle associée à la loi de composition interne *. Dans ce mode de réalisation, on obtient une invariance à gauche de l'erreur d'estimation e. Il est bien entendu envisageable de modifier les équations qui précèdent pour obtenir une invariance à droite (l'invariance à gauche étant cependant un mode de réalisation préféré). 25 Dans une étape d'acquisition 112, le capteur proprioceptif 3 acquiert par ailleurs des données de mouvement du premier porteur 1 dans le premier repère. Ces données de mouvement comprennent typiquement des accélérations et/ou des vitesses, par exemple angulaires. Ces données de mouvement acquises sont transmises à l'unité de traitement 10. L'étape 112 peut être mise en oeuvre avant, pendant ou après l'une quelconque des 30 étapes 102, 104, 106, 108, 110. Dans une étape de propagation 114, en soi connue de l'homme du métier, l'unité de traitement 10 génère un état de navigation propagé, à partir de l'état X,t. Pour cela, l'unité de traitement 10 applique, de façon connue en soi, un modèle d'évolution issue d'une intégration des données acquises par le capteur proprioceptif 6. 35 Les étapes décrites précédemment forment une itération du filtre de Kalman invariant. 13 On obtient grâce au filtre de Kalman invariant une propriété qu'on obtiendrait également dans un cas linéaire : l'évolution de l'erreur d'estimation est autonome (elle ne dépend ni de X1 ni de X1). L'émission d'état de navigation du deuxième porteur est répétée dans le temps, de 5 manière à ce que ces états soient reçus par le premier porteur 1. L'unité de traitement 10 répète ces mêmes étapes, 104, 106, 108, 110, 112, 114 dans de nouvelles itérations du filtre de Kalman invariant, pour chaque nouvel état du deuxième porteur reçu. L'état estimé au cours de l'étape de propagation 112 d'une itération donnée est utilisé comme donnée d'entrée des étapes de calcul d'innovation 104 et de mise à jour 10 non linéaire 110 d'une itération suivante. En définitive, grâce au procédé, le premier porteur 1 peut obtenir une aide sur sa propre navigation à l'aide des données dont dispose déjà le deuxième porteur 2 sur sa propre navigation. Plusieurs filtres de Kalman sont avantageusement mis en oeuvre en parallèle par l'unité 15 de traitement 10, de sorte à obtenir plusieurs estimées de l'état de navigation du premier porteur 1. Il est à noter que certains traitements peuvent être effectués une seule fois pour tous Les filtres de Kalman en jeu. Notamment, l'un de ces traitements est la résolution d'une équation de Ricatti que l'homme du métier connaît. 20 Dans ce cas, l'unité de traitement détermine, pour chaque estimée, une métrique d'écart aux données de l'estimée. Cette métrique L s'écrit par exemple : L = ZTS-1Z Où S est la covariance de l'innovation Z comme calculée classiquement dans l'étape de 25 mise à jour d'un filtre de Kalman conventionnel. La métrique L peut être calculée pour une mesure donnée. En variante, la métrique L est la somme des valeurs obtenues sur un ensemble des mesures passées. Dans une étape de fusion 116, l'unité de traitement 10 produit une estimée consolidée de l'état de navigation du premier porteur en fonction des estimées et de leurs métriques 30 de vraisemblance associées L. Dans un mode de réalisation, est sélectionnée en tant qu'estimée consolidée l'estimée obtenue par l'un des filtres qui présente la métrique qui traduit le plus faible écart aux données. Dans un autre mode de réalisation, l'estimée consolidée est une moyenne des estimées 35 déterminées par les différents filtres, laquelle est pondérée par les métriques. 14 Les états estimés X1 n'étant pas de nature vectorielle, l'homme du métier pourra utiliser une moyenne adaptée au cas des variétés. Il est possible dans d'autres variantes, de compléter l'état estimé X1 avec d'autres variables intéressantes, par exemple un état d'erreur propre au capteur proprioceptif (biais, 5 facteur d'échelle, dérive, etc.). Dans ce cas, la loi de composition interne * est additive pour l'état d'erreur de capteur proprioceptif. Soit B l'état d'erreur de capteur proprioceptif considéré. La loi de composition interne devient alors : 10 (R1,191, xl, R21, X 21, B) *(Ri,a4,4, B') = v + R1 vi, x1 + R1xi, Rz1Rz1, x21 + Te 21xZi, B + B') Par ailleurs, comme déjà indiqué plus haut, la matrice R21 peut être remplacé par une matrice R12 qui permettant de passer du deuxième repère (attaché au deuxième porteur 2) au premier repère (attaché au premier porteur 1). De même, le vecteur x21 peut être 15 remplacé par un vecteur x12, qui est un vecteur de translation permettant de passer des coordonnées d'un point dans le deuxième repère aux coordonnées du même point dans le première repère. On pose en outre T12 = 12, -x 12, = T 2-11' Dans ce cas la loi de composition interne, exprimée dans les nouvelles variables, 20 devient : (R1)1/1) rl, R12, '12) * (R1,14,4, R12, 42) = + R1 vL x1 + R14, R12 R12,42 + R12X12) Dans ce cas l'innovation Z devient : Z = log(tri ° Y ° 7;21) Dans un autre mode de réalisation, les mesures proprioceptives du porteur 1 25 comprennent une vitesse angulaire w. De plus, l'état de navigation X2 du deuxième porteur 2 reçu comporte un vecteur vitesse du deuxième porteur 2 dans le repère de référence et une matrice de rotation représentant une orientation du deuxième porteur dans le repère de référence. Le filtre de Kalman invariant utilise alors une innovation Z de la forme : Z log ((firR2fin, fil' (y2 - 01) + n(R2 (a/ x 'fin))) 30 où : - Rl est une estimée de la matrice de rotation R1 contenue dans la transformation rigide T1. Plus précisément, R1 est telle que les coordonnées u G R3 d'un point dans le repère attaché au porteur 1 deviennent R1u + x1 dans le repère de référence, où x1 est la position du premier porteur dans le repère de référence. 15 - R21 et 221 sont les estimées de la matrice de rotation R21 et du vecteur de translation x21 définissant la transformation rigide T21 = (R21, x21). Plus précisément, R21 et x21 sont telles que les coordonnées u E R3 d'un point dans le repère attaché au porteur 1 deviennent R21u + x21 dans le repère attaché au porteur 2, 5 - R2 est la matrice de rotation représentant l'orientation du porteur 2 (disponible en tant qu'observation, comme indiqué ci-dessus). Plus précisément, R2 est telle que les coordonnées u E R3 d'un point dans le repère attaché au porteur 2 deviennent R2u + x2 dans le repère de référence, où x2 est la position du porteur 2 dans le repère de référence (qui elle n'a pas besoin d'être observée pour cette revendication). 10 - 122 est la vitesse du porteur 2 dans le repère de référence (disponible en tant qu'observation) - Di est la vitesse estimée du porteur 1 dans le repère de référence. - x désigne le produit vectoriel classique - 1og(0 désigne la fonction logarithme (réciproque de la fonction exponentielle) du 15 groupe de Lie SE(3). Il est à noter que l'objet passé en entrée de la fonction log est un objet appartenant groupe de Lie SE(3) et s'écrivant comme un couple constitué d'une matrice de rotation et d'un vecteur de taille 3. Cet autre mode de réalisation permet de s'approcher fortement des conditions a. et b. énoncées en introduction, et de ne les satisfaire que dans sous l'hypothèse que le deuxième 20 porteur est « à plat », c'est-à-dire sous l'hypothèse que les mesures de vitesse angulaire w sont toujours sur le même axe, et que cet axe est aussi celui de la rotation R21. Cette hypothèse est vérifiée en particulier si toutes les rotations considérées (R1 et R2) ont un axe vertical, comme c'est généralement le cas sur un véhicule terrestre. C'est la raison pour laquelle le mode de réalisation dans lequel on a Z = Zx est plus avantageux. 25 Le vecteur Z' est constitué d'un premier vecteur Z1R-' de taille 3 représentatif d'une rotation, et d'un deuxième vecteur Zv de taille 3 également. Il est également envisageable, dans un autre mode de réalisation, de combiner les données décrites précédemment pour former une innovation Z plus complexe de la forme suivante : 30 Z = (x) REVENDICATIONS1. Procédé d'aide à la navigation d'un premier porteur (1) immobile par rapport à un deuxième porteur (2) lui-même mobile dans un repère de référence, le procédé comprenant les étapes suivantes mises en oeuvre par le premier porteur (1) : - réception (102) d'un état de navigation (X2) dans le repère de référence du deuxième porteur (2) fourni par le deuxième porteur (2), - acquisition (112) de données de mouvement du premier porteur (1) par au moins un capteur proprioceptif (6) du premier porteur (1), - estimation d'un état de navigation (X1) du premier porteur (1) par un filtre de Kalman invariant utilisant l'état de navigation (X,) du deuxième porteur (2) comme données d'observation, dans lequel l'état de navigation du premier porteur (1) comprend : o des premières variables représentatives d'une première transformation rigide (T1) liant un repère attaché au premier porteur (1) au repère de référence, et o des deuxièmes variables représentatives d'une deuxième transformation rigide (T21) liant un repère attaché au deuxième porteur (2) au repère attaché au premier porteur (1), et dans lequel le filtre de Kalman invariant utilise comme loi de composition interne une loi comprenant une composition terme à terme de la première transformation rigide et de la deuxième transformation rigide. 2. Procédé selon la revendication précédente, dans lequel les premières variables comprennent une matrice de rotation représentant une orientation du premier porteur (1), et les deuxièmes variables comprennent une matrice de rotation représentant l'orientation du deuxième porteur (2) par rapport au premier porteur (1). 3. Procédé selon l'une des revendications précédentes, dans lequel les premières variables comprennent un vecteur de position du premier porteur (1), et les deuxièmes variables comprennent un vecteur de position du deuxième porteur (2) par rapport au premier porteur (1 ). 4. Procédé selon l'une des revendications précédentes, dans lequel l'état de navigation du premier porteur (1) estimé comprend en outre un vecteur vitesse du premier porteur (1) dans le repère de référence. 17 5. Procédé selon la revendication 4 dans sa dépendance à la revendication 3, dans lequel la loi de composition interne applique des transformations identiques à l'un des vecteurs de position et au vecteur vitesse. 5 6. Procédé selon l'une des revendications précédentes, dans lequel l'état de navigation (X2) du deuxième porteur (2) reçu comprend un vecteur de position du deuxième porteur (2) dans le repère de référence et une matrice de rotation représentant une orientation du deuxième porteur dans le repère de référence. 10 7. Procédé selon l'une des revendications précédentes, dans lequel le filtre de Kalman invariant utilise une innovation comprenant un vecteur Zx de la forme : r log(t-1 ° ° D21) où : - Tl est une estimée des premières variables, 15 - t 1 est une estimée des deuxièmes variable, dans lequel la deuxième transformation rigide permet de passer du premier repère au deuxième repère, - Y désigne les données d'observations utilisées par le filtre de Kalman invariant, - désigne une composition, - Iog(-) désigne une application logarithme d'un groupe de Lie. 20 8. Procédé selon l'une des revendications précédentes, dans lequel l'état de navigation (X2) du deuxième porteur (2) reçu comprend un vecteur vitesse du deuxième porteur (2) dans le repère de référence et une matrice de rotation représentant une orientation du deuxième porteur dans le repère de référence, et dans lequel les données de mouvement du premier 25 porteur (1), acquises le capteur proprioceptif (6), comprennent une vitesse angulaire du premier porteur (1). 9. Procédé selon la revendication précédente, dans lequel les premières variables comprennent une matrice de rotation représentant une orientation du premier porteur (1), 30 et les deuxièmes variables comprennent une matrice de rotation représentant l'orientation du deuxième porteur (2) par rapport au premier porteur (1), et dans lequel le filtre de Kalman invariant utilise une innovation comprenant un vecteur Z° de la forme : = log MR2Ê2i, - + Ri R2 (co x 221))) où : 18 - R1 est une estimée de la matrice de rotation représentant une orientation du premier porteur (1). - R21 est une estimée de la matrice de rotation représentant l'orientation du deuxième porteur (2) par rapport au premier porteur (1), 5 - x21 est une estimée d'un vecteur de translation définissant la deuxième transformation rigide, - R2 est la matrice de rotation représentant une orientation du deuxième porteur dans le repère de référence, - y2 est le vecteur vitesse du deuxième porteur (2) dans le repère de référence, 10 - a) est la vitesse angulaire du premier porteur (1), - x désigne un produit vectoriel, - log(-) désigne une application logarithme du groupe de Lie SE(3). 10. Procédé selon les revendications 7 et 9 prises en combinaison, dans lequel le vecteur Zr 15 est constitué d'un premier vecteur r'R" de taille 3 représentatif d'une rotation, et d'un deuxième vecteur Ze de taille 3 également, et dans lequel le filtre de Kalman invariant utilise une innovation Z de la forme : Zx Z () Zir 20 11. Procédé selon les revendications précédentes, dans lequel l'état de navigation du premier porteur (1) estimé comprend en outre au moins un état d'erreur propre au capteur proprioceptif, et dans lequel la loi de composition interne est additive pour cette variable d'erreur propre au capteur proprioceptif. 25 12. Procédé selon l'une des revendications précédentes, dans lequel : - le premier porteur (1) est un aéronef et le deuxième porteur (2) est un porte-aéronefs, ou - le premier porteur (1) est un projectile et le deuxième porteur (2) est un aéronef qui porte Le projectile, ou 30 - le premier porteur (1) est une centrale inertielle d'un véhicule et le deuxième porteur (2) est un capteur extéroceptif du véhicule. 13. Procédé selon l'une des revendications précédentes, dans lequel l'étape d'estimation est mise en oeuvre en parallèle par plusieurs filtres de Kalman invariants, de sorte à obtenir 19 plusieurs estimées de l'état de navigation du premier porteur (1), et comprend par ailleurs des étapes de : - pour chaque estimée, détermination d'une métrique de vraisemblance de ['estimée, - production d'une estimée consolidée de l'état de navigation du premier porteur (1) 5 en fonction des estimées et de leurs métriques de vraisemblance associées. 14. Dispositif d'aide à la navigation d'un premier porteur (1) immobile par rapport à un deuxième porteur (2) lui-même mobile dans un repère de référence, le dispositif comprenant : 10 - au moins un capteur proprioceptif (6) configuré pour acquérir des données de mouvement du premier porteur (1), - une interface de communication (4) pour recevoir un état de navigation (X2) du deuxième porteur (2) fourni par le deuxième porteur (2), - un filtre de Kalman invariant (10) configuré pour estimer un état de navigation (X1) 15 du premier porteur (1) en utilisant l'état de navigation du deuxième porteur (2) comme données d'observation, dans lequel l'état de navigation comprend : o des premières variables (T1) représentatives d'une première transformation rigide liant un repère attaché au premier porteur (1) au repère de référence, et 20 o des deuxièmes variables (T21) représentatives d'une deuxième transformation rigide liant un repère attaché au deuxième porteur (2) au repère attaché au premier porteur (1), et et dans lequel le filtre de Kalman invariant utilise comme loi de composition interne une loi comprenant une composition terme à terme de la première transformation 25 rigide et de la deuxième transformation rigide. 30