Brevet FR3084151A1 — publié le 20200124

DOMAINE DE [INVENTION La présente invention concerne un procédé d'aide à la navigation d'une flotte de véhicules, et un dispositif adapté pour mettre en oeuvre un tel procédé. 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 : Xn-m. = f(Xn) Où f est une fonction connue (généralement appelée fonction de propagation). Les observations Y' sont reliées à l'état du système par une fonction d'observation h connue: Yn = i/(Xn) Construire une bonne estimation .2n de l'état X' à partir de la séquence (Yn) 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+i = F + wn Yn = H Xn Vn 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 : f(n+ùn = Fitin = + Kn+i(Yn+i frign+iln) 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,2+, et à l'instant n + 1 en tenant compte de l'observation Irn±i. 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 : enl' = X' -1?'1' (après la prise en compte de l'observation Yn) en+iln = X'+1 - (avant la prise en compte de l'observation 17,T+1) On peut facilement vérifier que cette erreur suit l'évolution suivante : en-Fun = FenIn (avant la prise en compte de l'observation Yn+1) en-Filn+1. = Kn-FiH)e'+iln (après la prise en compte de l'observation Yn+1) où I désigne la matrice identité. 2 Les équations ci-dessus ne dépendent pas de Xri, 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 Xn 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 groupe (c'est-à-dire une loi de composition interne 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 S/1') et /(.,. ) 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 Kgri11 Yn+1) 1(I d, yo)1) où exp() est l'application exponentielle (cette fonction est connue dès que l'opération de 30 groupe 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 : j'n+11n = f(r(nIn) 3 2n-F1In+1 = grt+11n *exp(K'+i[Yn+1 h(2'+11n)]) 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é. 5 Comme expliqué précédemment, l'utilisation d'un filtre de Kalman invariant réclame de trouver une opération (ou loi de composition interne) * pour laquelle les conditions a. et b. sont vérifiées afin de 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 10 d'exemples : - L'opération à utiliser pour un problème d'estimation d'orientation et de vitesse est décrit dans le document suivant : Bonnabel, S., Martin, P., Et Salaün, E. (2009, December). Invariant Extended Kalman Filter: theory and application to a velocityaided attitude estimation problem. In Decision and Control, 2009 held jointly with the 15 2009 28th Chinese Control Conference. CDC/CCC 2009. Proceedings of the 48th IEEE Conference on (pp. 1297-1304). IEEE. - L'opération à utiliser pour une navigation inertielle avec estimation de l'orientation, la vitesse et la position est décrite dans le document suivant : Barrau, A., Et Bonnabel, S. (2017). The invariant extended Kalman filter as a stable observer. IEEE Transactions 20 on Automatic Control, 62(4), 1797-1812. - 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 l'environnement du véhicule, est décrite dans le document Barrau, A., Et Bonnabel, S. (2015). An EKF-SLAM algorithm with consistency properties. arXiv preprint 25 arXiv:1510.06263. - 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 systems on groups (I). Dans chacune de ces applications, un filtre de Kalman invariant est utilisé pour estimer 30 l'état de navigation d'un porteur unique. Le document Zou, D., Et Tan, P. (2013). Coslam: Collaborative visual slam in dynamic environments. IEEE transactions on pattern analysis and machine intelligence, 35(2), 354-366 poursuit un autre objectif : celui de fournir une aide à la navigation non pas d'un porteur unique, mais d'une flotte de véhicules comprenant un véhicule principal et au moins un 35 véhicule secondaire mobile par rapport au véhicule principal. 4 Dans chacune de ces applications, le filtre de Kalman utilise des données proprioceptives du véhicule complétées par des mesures relatives à des objets de l'environnement considérés comme fixes (points de repère visuels connus ou inconnus, champ magnétique terrestre, Terre elle-même, etc.). Les coordonnées de ces objets peuvent 5 être connues ou non dans le repère de référence, mais dans tous les cas elles ne varient pas au cours du temps. Toutefois, cette hypothèse ne tient plus si le porteur est entouré d'autres véhicules potentiellement en mouvement. EXPOSE DE L'INVENTION 10 Un but de l'invention est de fournir une aide à la navigation d'une flotte de plusieurs véhicules simple à mettre en oeuvre. Il est dès lors proposé, selon un premier aspect de l'invention, un procédé d'aide à la navigation d'une flotte de véhicules comprenant un véhicule principal et un véhicule secondaire mobile par rapport au véhicule principal, le procédé comprenant des étapes de : 15 - réception de données acquises par au moins un capteur, les données reçues comprenant des données cinématiques relatives entre le véhicule principal et le véhicule secondaire, - estimation d'un état de navigation de la flotte de véhicules par un filtre de Kalman invariant utilisant les données reçues comme observations, dans lequel l'état de 20 navigation comprend o des premières variables représentatives d'une première transformation rigide liant un repère attaché au véhicule principal à un 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 véhicule principal à un repère attaché au 25 véhicule secondaire, 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. Le procédé selon le premier aspect de l'invention proposé exploite avantageusement 30 le fait que les porteurs entourant le porteur principal disposent eux aussi de capteurs de mouvement et qu'ils transmettent leurs mesures au porteur principal. Ces mesures permettront au porteur principal d'utiliser les porteurs qui l'entourent comme points de repère bien que ceux-ci soient mobiles. Il se trouve par ailleurs que la loi de composition interne utilisée dans ce procédé 35 permet de 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 comprendre les caractéristiques suivantes prises seules ou en combinaison lorsque cela est techniquement possible. 5 De préférence, l'état de navigation de la flotte comprend en outre au moins un état d'erreur propre au capteur, et dans lequel la loi de composition interne est additive pour cette variable d'erreur propre au capteur. De préférence, le procédé comprend la réception de données de mouvement proprioceptif du véhicule principal et du véhicule secondaire, dans lequel l'estimation 10 comprend des phases de - propagation d'un état de navigation de la flotte préalablement estimé par le filtre de Kalman invariant à l'aide des données de mouvement proprioceptif du véhicule principal et du véhicule secondaire pour obtenir un état propagé, - mise à jour de l'état propagé à l'aide des observations, pour obtenir un nouvel état 15 de navigation de la flotte. De préférence, les données de mouvement proprioceptif sont acquises par des capteurs proprioceptifs respectifs du véhicule principal et du véhicule secondaire, et l'état de navigation de la flotte comprend en outre au moins un état d'erreur propre à au moins un des capteurs proprioceptifs pour laquelle la loi de composition interne est additive. 20 De préférence : - les premières variables comprennent une matrice de rotation représentant une orientation du véhicule principal et un vecteur de position du véhicule principal, et - dans lequel les deuxièmes variables comprennent une matrice de rotation représentant l'orientation du véhicule principal par rapport au véhicule secondaire 25 et un vecteur de position du véhicule principal par rapport au véhicule secondaire. De préférence : - l'état de navigation de la flotte comprend en outre un vecteur de vitesse vp du véhicule principal dans le repère de référence, et un vecteur de vitesse égal à R5(vp - vs), où vs est une vitesse du véhicule secondaire dans le repère de référence, 30 et Rs est une matrice de rotation représentant l'orientation du véhicule principal par rapport au véhicule secondaire, - la loi de composition interne applique des transformations identiques à l'un des vecteurs de position et l'un des vecteurs vitesse. 6 L'estimation peut être mise en oeuvre par le véhicule principal, et les données reçues peuvent comprendre des données de position du véhicule secondaire dans un repère fixé au véhicule principal acquises par au moins un premier capteur du véhicule principal comprenant par exemple un lidar, une caméra ou un odomètre. En variante, l'estimation 5 peut être mise en oeuvre par le véhicule principal, et les données reçues peuvent comprendre des données de position du véhicule principal dans un repère fixé au véhicule secondaire acquises par au moins un deuxième capteur du véhicule secondaire comprenant par exemple un lidar, une caméra ou un odomètre. Les données reçues peuvent comprendre des données cinématiques relatives entre le 10 véhicule principal et un objet tiers distinct du véhicule principal et du véhicule secondaire, les données cinématiques relatives entre le véhicule principal et l'objet tiers étant également utilisées comme observations par le filtre de Kalman invariant. L'objet tiers est par exemple un amer. Les données cinématiques relatives entre le véhicule principal et un objet tiers peuvent 15 comprendre des données acquises par un récepteur GPS/GNSS du véhicule principal. De préférence, le procédé comprend des étapes de - mise en oeuvre de l'étape d'estimation sur la base des données de position de l'objet secondaire dans le repère fixé au véhicule principal de sorte générer une première estimation de l'état de navigation de la flotte, 20 - mise en oeuvre de l'étape d'estimation sur la base des données de position du véhicule principal dans un repère fixé à l'objet secondaire, de sorte générer une deuxième estimation de l'état de navigation de la flotte, - fusion des première et deuxième estimations de l'état de navigation de la flotte, de sorte à produire une troisième estimation de l'état de navigation la flotte, la fusion 25 comprenant par exemple le calcul d'une moyenne des première et deuxième estimations de l'état de navigation de ['ensemble d'objets. Afin de rendre l'évolution de l'erreur indépendante de l'état du système, il est de préférence prévu ce qui suit : - les données reçues utilisées comme observations s'écrivent comme un vecteur Y, de 30 la forme Y, = 1(X1,y0), où l(.,.) est une action de groupe à gauche pour la loi de composition interne, X, est l'état de navigation de la flotte, et yo est un vecteur de même dimension que Y1, et dans lequel le filtre de Kalman invariant utilise une innovation Z = 1(4-1,Y1), ou dans lequel - les données reçues utilisées comme observations s'écrivent comme un vecteur Y2 de 35 la forme Y2 = 1(X11,y0)) où 1(.,.) est une action de groupe à gauche pour la loi de 7 composition interne, X2 est l'état de navigation de la flotte, et yo est un vecteur de même dimension que Y2, et dans lequel le filtre de Kalman invariant utilise une innovation Z = l(22, Y2). Il est également proposé selon un deuxième aspect de l'invention un dispositif d'aide à 5 la navigation d'une flotte de véhicules comprenant un véhicule principal et un véhicule secondaire mobile par rapport au véhicule principal, le dispositif comprenant : - une interface de réception pour recevoir des données acquises par au moins un capteur, les données comprenant des données cinématiques relatives entre le véhicule principal et le véhicule secondaire, 10 - une unité de traitement configurée pour mettre en oeuvre un filtre de Kalman invariant de manière à estimer un état de navigation de la flotte de véhicules, dans lequel le filtre de Kalman invariant est configuré pour utiliser les données reçues comme observations, dans lequel l'état de navigation comprend des premières variables représentatives d'une première transformation rigide liant un repère 15 attaché au véhicule principal à un repère de référence et des deuxièmes variables représentatives d'une deuxième transformation rigide liant un repère attaché au véhicule secondaire à un repère attaché au véhicule principal, et dans lequel le filtre de Kalman invariant est configuré pour utiliser comme loi de composition interne une composition terme à terme de la première transformation rigide et de la deuxième 20 transformation rigide. DESCRIPTION DES FIGURES D'autres caractéristiques, buts et avantages de l'invention ressortiront de la description qui suit, qui est purement illustrative et non limitative, et qui doit être lue en regard des 25 dessins annexés sur lesquels : - La figure 1 illustre différents objets mobiles les uns par rapport aux autres, notamment une flotte de véhicules. - La figure 2 illustre de façon schématique des composants interne d'un véhicule principal et d'un véhicule secondaire d'une flotte de véhicules, selon un mode de 30 réalisation de l'invention. - 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. 35 DESCRIPTION DETAILLEE DE L'INVENTION 8 1/ Flotte de véhicules En référence à la figure 1, une flotte de véhicules comprend un véhicule principal 1 et au moins un véhicule secondaire 2 mobile par rapport au véhicule principal 1. Chaque véhicule 1, 2 peut être de tout type : véhicule terrestre, navire, aéronef, etc. 5 Est également représenté sur la figure 1 des objets extérieurs à la flotte de véhicules : des amers (lampadaires et tour Eiffel), ainsi que la Terre elle-même. Comme on le verra dans la suite ces objets sont des points de repère pour la navigation de la flotte. Dans ce qui suit, on considère différents repères : un repère principal attaché au véhicule principal 1, un repère secondaire attaché au véhicule secondaire 2, et un repère de 10 référence. Le repère de référence est par exemple un repère céleste attaché à des étoiles ou à la Terre. En référence à la figure 2, le véhicule principal 1 comprend une interface de réception de données. L'interface de réception comprend au moins un premier capteur 3 embarqué dans le 15 véhicule principal 1. Ce premier capteur 3 est configuré pour acquérir des données cinématiques du véhicule secondaire 2 dans le repère principal. Le premier capteur 3 comprend par exemple un lidar, une caméra ou un odomètre. Dans le présent texte, on considère que l'expression « données cinématiques » couvre notamment des positions, des vitesses, ou des accélérations. 20 L'interface de réception comprend également une interface de communication 4 adaptée pour communiquer avec le véhicule secondaire 2, notamment recevoir de ce dernier des données cinématiques du véhicule principal 1 dans le repère fixé au véhicule secondaire 2. L'interface de communication 4 est de type radio sans fil, et comprend par exemple une antenne. 25 Le véhicule principal 1 comprend par ailleurs au moins un capteur proprioceptif 6. Le capteur proprioceptif 6 comprend par exemple une centrale inertielle. La centrale inertielle comprend une pluralité de capteurs inertiels tels que des gyromètres et des accéléromètres. En variante, le capteur proprioceptif 6 comprend au moins un odomètre. Le véhicule principal 1 comprend en outre un récepteur 8 configuré pour acquérir des 30 données cinématiques relatives entre le véhicule principal 1 et un objet tiers distinct du véhicule principal 1 et du véhicule secondaire 2. Ce récepteur est par exemple un récepteur GPS/GNSS, auquel cas l'objet tiers est la Terre ou l'une des étoiles auxquelles le repère céleste est attaché. En variante ou complément, ce récepteur comprend un lidar, une caméra, auquel cas l'objet tiers peut être un amer se trouvant à proximité du véhicule 9 principal 1. Dans une autre variante, le récepteur comprend un odomètre qui une vitesse relative du porteur par rapport à la Terre. Le véhicule principal 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 5 réception (donc reçues par le premier capteur 3 ou reçues par L'interface de communication 4), par la centrale inertielle 6, ou par le récepteur 8. L'unité de traitement de données 10 comprend typiquement au moins un processeur configuré pour mettre en oeuvre un procédé d'aide à la navigation qui sera décrit ci-après, au moyen d'un filtre de Kalman de type invariant. Le filtre de Kalman invariant se présente 10 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 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 manière à s'adapter au contexte de l'aide à la 15 navigation de la flotte de véhicules comprenant les véhicules 1 et 2. De préférence, l'unité de traitement 10 comprend au moins deux processeurs, de manière à mettre en oeuvre deux filtres de Kalman en parallèle. On verra dans la suite que ces deux filtres de Kalman n'utilisent pas exactement les mêmes données d'entrée. Par ailleurs, le véhicule secondaire 2 comprend au moins un deuxième capteur 12 et 20 une interface de communication 14 pour transmettre des données acquises par le deuxième capteur 12 à l'interface de communication 4 du véhicule principal 1. Le deuxième capteur 12 est configuré pour acquérir des données de mouvement du véhicule principal 1 dans le repère fixé au véhicule secondaire 2. Le deuxième capteur 12 comprend par exemple un lidar, une caméra ou un odomètre. 25 Le véhicule secondaire 2 comprend des moyens pour fournir des données de mouvement proprioceptif du véhicule secondaire. Ces moyens de fourniture comprennent par exemple au moins un capteur proprioceptif 16. Le capteur proprioceptif est par exemple de l'un ou plusieurs des types de capteurs envisagés pour le capteur proprioceptif 6. 30 En variante, ces moyens de fourniture comprennent une mémoire mémorisant un modèle a priori d'évolution du véhicule secondaire 2. Cette mémoire peut être aussi bien être intégrée au véhicule secondaire 2 qu'au véhicule principal 1. 35 2/ Configuration du filtre de Kalman invariant 10 Le filtre de Kalman invariant mis en oeuvre par l'unité de traitement 10 est configuré pour estimer un état de navigation de la flotte comprenant le véhicule principal 1 et le véhicule secondaire 2. L'état de navigation comprend des premières variables représentatives d'une première 5 transformation rigide liant te repère principal (attaché au véhicule principal 1) au repère de référence et des deuxièmes variables représentatives d'une deuxième transformation rigide liant le repère secondaire (attaché au véhicule secondaire 2) au repère principal. La première transformation rigide permet par exemple de passer du repère lié au véhicule principale 1 au repère de référence, et la deuxième permet de passer du repère lié 10 au véhicule principal 1 au repère lié au véhicule secondaire 2. De façon bien connue, une transformation rigide (égaiement connue sous le nom d'isométrie affine), est une transformation qui conserve les distances entre chaque paire de points 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. 15 Dans la suite, on détaillera un mode de réalisation dans lequel l'état de navigation, noté X, comprend les éléments suivants : X = (R,,x,,Rsp,xsp) où R,'x,'Rs',xs, sont définis comme suit : - R, et xi, sont respectivement une matrice de rotation et un vecteur de dimension 3, 20 représentant l'orientation et la position du véhicule principal : un vecteur u écrit dans le repère du véhicule principal 1 devient le vecteur Rpu + xi, dans le repère fixe. - Rs, et xs, sont respectivement une matrice de rotation et un vecteur de dimension 3, représentant l'orientation et la position relatives du véhicule principal par rapport au véhicule secondaire : un vecteur u écrit dans le repère du véhicule principal 1 25 devient le vecteur Rspu + xs, dans le repère du véhicule secondaire. Dans ce mode de réalisation particulier, les premières variables sont Rp, xp et les deuxièmes variables sont R', xsp. L'expression « l'objet X' est de même nature que Le vecteur d'état -, utilisée plus bas, signifiera que X' est une succession de matrices et de vecteurs semblable à X. 30 On appellera aussi « dimension de l'état X » le nombre 3 x (r + v) = 12 où r est le nombre de matrices de rotation apparaissant dans X et v le nombre de vecteurs apparaissant dans X. Dans des modes de réalisation différents ce nombre peut être différent. Par ailleurs, le filtre de Kalman invariant est en outre configure pour utiliser comme observations des données cinématiques relatives entre le véhicule principat 1 et le véhicule 11 secondaire 2 reçues par l'interface de réception, provenant du premier capteur 3 du véhicule principat 1. L'observation sera ici la position relative du véhicule secondaire vue dans le repère du véhicule principal : 5 Y Le filtre de Kalman invariant est configuré pour utiliser 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. 10 Cette loi de composition interne, notée ", applique la transformation suivante à deux objets (Ri:'x',R',x') etx'' , x'sp) dans un mode de réalisation : (Rxp,,' R'' xs.p) * (R; = (R,Rp' , x, + Rpx; R,P Rsn, xn+ Rspx,',) 3/ Procédés d'aide à la navigation de la flotte 15 En référence à la figure 3, un procédé 100 d'aide à la navigation de la flotte selon un premier 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 211 de l'état de navigation de la flotte a été estimée par le filtre de Kalman invariant. 20 Dans une étape d'acquisition 102, le premier capteur 3 acquiert un premier groupe de données Y1 de mouvement d'objets extérieurs au véhicule principal 1 dans le repère principal. Ces données peuvent comprendre : - des données de position du véhicule secondaire 2 dans le repère principal (l'objet extérieur correspondant est alors le véhicule secondaire 2) 25 - des données de position d'au moins un amer dans le repère principal (l'objet extérieur correspondant est alors cet amer). L'amer est de position connue dans le repère de référence. Ces données Y1 sont transmises à l'unité de traitement 10. Dans une étape 104, l'unité de traitement 10 calcule la différence entre les mesures 30 observées Y1 et des mesures attendues (cette différence, notée Z1, est appelée innovation dans la littérature traitant des filtres de Kalman). Les mesures attendues sont déduites de l'état Xiprécédemment estimé par le filtre de Kalman invariant. Dans une étape de correction 106, l'unité de traitement 10 de données multiplie t'innovation Z1 par une matrice K1 dite de « gain », ce qui traduit Z1 en une correction 35 linéaire dx1 = K1Z1 à appliquer à l'état du système. 12 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 dx, en une correction non linéaire C1 de même nature que 1?1 (l'état X1 n'est pas un 5 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 (12 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 10 linéaire 110. Dans cette étape 110, l'unité de traitement 10 combine l'estimation X1 de l'état du système à la correction non linéaire C1 pour construire une estimation corrigée : = * Où le symbole * est la loi composition interne définie plus haut. La matrice Ki de gain est choisie de manière à stabiliser l'erreur d'estimation non linéaire e définie par : 15 e =Ri* X-1 Où le symbole .-1 est l'inversion usuelle associée à la loi * : , (Ru, xi,,R5p, xsp) 1 = U=?T'-RiTixp,Tifp,-RipX,p) On peut aussi écrire explicitement l'erreur de la façon suivante : e = Te 'RT, , 22, - 'Rf,x,) 20 Cette erreur est utilisée pour construire le système linéarisé selon la procédure habituelle du filtrage invariant, duquel on déduit la matrice K1, par exemple en intégrant une équation de Riccati. Dans une étape de propagation 112, 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 XiE. Pour cela, l'unité 25 de traitement 10 applique Le modèle d'évolution qui peut être par exemple une odométrie, un modèle a priori ou une intégration classique de mesures inertielles acquises par les capteurs proprioceptifs 6, 16 présents dans les véhicules 1, 2. Les étapes décrites précédemment forment une itération du filtre de Kalman invariant. On obtient grâce au filtre de Kalman invariant une propriété qu'on obtiendrait 30 également dans un cas linéaire : ['évolution de l'erreur d'estimation est autonome (elle ne dépend ni de X ni de X'). L'unité de traitement 10 répète ces mêmes étapes 102, 104, 106, 108, 110, 112 dans de nouvelles itérations du filtre de Kalman invariant. 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 35 calcul d'innovation 104 et de mise à jour non Linéaire 110 d'une itération suivante. 13 En définitive, grâce au procédé 100, le véhicule principal 1 peut obtenir une aide non seulement sur sa propre navigation, mais également sur la navigation du véhicule secondaire 2, sur la base des différentes données mesurées par le premier capteur 3 et les capteurs proprioceptifs 6, 16. 5 Un procédé 200 d'aide à la navigation de la flotte selon un deuxième mode de réalisation, et mettant en oeuvre un filtre de Kalman invariant également configuré de la manière indiquée ci-dessus, est également montré en partie droite de la figure 3 ; ce procédé 200 comprend les étapes suivantes. Dans une étape d'acquisition 202, des données Y2 de mouvement du véhicule principal 10 1 dans au moins un repère attaché à un objet extérieur au véhicule principal sont acquises. Ces données Y, peuvent comprendre : - des données cinématiques du véhicule principal 1 dans le repère secondaire acquises par le deuxième capteur 12, par exemple des données de position du véhicule principal 1 dans le repère secondaire (auquel cas l'objet extérieur correspondant est 15 le véhicule secondaire) - des données acquises par le récepteur 8 (l'objet correspondant peut alors être considéré comme étant la Terre, puisque ces données permettent de géolocaliser le véhicule principal par rapport à la Terre). Ces données Y2 sont transmises au véhicule principal 1, le cas échéant via les interfaces 20 de communication 14 et 4 lorsqu'elles proviennent du véhicule secondaire 2. Les données Y2 sont transmises à l'unité de traitement 10. Dans une étape 204 similaire à l'étape 104, l'unité de traitement 10 calcule la différence (innovation Z2) entre les mesures observées Y2 et des mesures attendues. Les mesures attendues sont déduites d'un état précédemment estimé par le filtre de Kalman 25 invariant, noté 22. Dans une étape de correction 206, l'unité de traitement 10 multiplie l'innovation Z2 par une matrice de gain K2 ce qui traduit Z2 en une correction linéaire dx2 = 22Z, à appliquer à l'état du système. Cette étape de correction 206 est similaire à l'étape 106, à la différence près que la 30 matrice K2 de gain est choisie de manière à stabiliser une deuxième variable d'erreur non linéaire e définie par : e=X'*X2 Dans une étape de rétraction 208 identique à l'étape 108, l'unité de traitement 10 transforme la correction linéaire dx2 en une correction non linéaire C2 de même nature que 35 22 (l'état 22 n'est pas un vecteur car il contient des rotations). 14 Est ensuite mise en oeuvre par l'unité de traitement 10 une étape de mise à jour non Linéaire 210 similaire à l'étape 110. Dans cette étape 210, l'unité de traitement 10 combine l'estimation gy de l'état du système à la correction non linéaire C2 pour construire une estimation corrigée de la manière suivante : 5 Xz -5?2 * C2 Dans une étape de propagation 212 identique à l'étape 112, l'unité de traitement 10 génère un état propagé à partir de l'état R2'. Les étapes décrites précédemment forment une itération du filtre de Kalman invariant. L'unité de traitement 10 répète ces mêmes étapes 202, 204, 206, 208, 210, 212 dans 10 de nouvelles itérations du filtre de Kalman invariant. L'état estimé au cours de l'étape de propagation 212 d'une itération donnée est utilisé comme donnée d'entrée des étapes de calcul d'innovation 204 et de mise à jour non linéaire 210 d'une itération suivante. Comme dans le procédé 100 selon le premier mode de réalisation, la dépendance de l'évolution de l'erreur par rapport à l'état du système est réduite. 15 L'un ou l'autre des procédés 100, 200 décrits ci-dessus peut être mis en oeuvre par le véhicule principal 1. La différence fondamentale entre le procédé 100 selon le premier mode de réalisation et le procédé 200 selon le deuxième mode de réalisation réside dans les données cinématiques relatives entre le véhicule principal 1 et le véhicule secondaire 2 utilisées 20 comme observation par le filtre de Kalman invariant : dans le cas du procédé 100, ces données sont exprimées dans le repère attaché au véhicule principal 1, alors que dans le cas du procédé 200, ces données sont exprimées dans un repère extérieur. L'unité de traitement 10 du véhicule principal 1 met avantageusement en oeuvre un procédé selon un troisième mode de réalisation, combinant la mise en oeuvre des deux 25 procédés qui précèdent 100 et 200, en parallèle. Le premier procédé 100 conduisant à l'obtention de la donnée jet est par exemple mis en oeuvre par un premier processeur de l'unité de traitement 10, tandis que le deuxième procédé 200 conduisant à l'obtention de la donnée 22' est mis en oeuvre par un deuxième processeur de l'unité de traitement. Autrement dit, deux filtres de Kalman invariants sont 30 mis en oeuvre en parallèle par ces deux processeurs. Dans une étape de fusion 302, l'unité de traitement 10 fusionne les données ,giE et gi afin d'obtenir une estimation optimisée de l'état de navigation de la flotte, notée XiH,pt. Par exemple, Xit' est la moyenne de îj1 et ,1-(21. Les états 2j1 et XZ n'étant pas des vecteurs, on remplace leur moyenne classique par une quelconque définition de moyenne adaptée aux 35 variétés. L'homme du métier pourra trouver des définitions de moyenne généralisées à des 15 variétés dans le document Markley, F. L., Cheng, Y., Crassidis, J. L., & Oshman, Y. (2007). Averaging quaternions. Journal of Guidance, Control, and Dynamics, 30(4), 1193-1197. Le cas échéant, cette moyenne est pondérée par des matrices de covariance associées aux données t et IC exprimant l'incertitude de ces estimations. Ces matrices de 5 covariances sont également produites par les deux filtres de Kalman invariants des procédés 100 et 200. L'invention ne se limite pas aux modes de réalisation précédemment décrits. Il est possible d'inclure dans l'état de navigation de la flotte des vitesses ou les vecteurs représentant les positions de points caractéristiques q, (ou amers). Cet état de navigation 10 peut se borner à comprendre des données de position et de rotations. Par ailleurs, la flotte de véhicules considérée peut comprendre plusieurs véhicules secondaires, et l'état de navigation être étendu de sorte à comprendre des éléments propres à chacun des véhicules secondaires de la flotte. En outre, il n'est pas obligatoire d'utiliser des données inertielles acquises par une 15 centrale inertielle au cours de la mise en oeuvre de l'un ou l'autre des procédés décrits ci- dessus. Néanmoins, quand des telles données inertielles sont utilisées, l'état du système doit comporter des états représentatifs de la vitesse de chaque véhicule muni d'une centrale inertielle. Il s'agira : de la vitesse vp du véhicule principal dans le repère de référence, 20 de l'écart usp de vitesse, par rapport au repère fixe, entre les eux véhicules, projeté dans le repère attaché au véhicule secondaire. Pour dire les choses autrement us, est définie par vsp /1?7,1(vp - vs) Où vp est la vitesse du porteur principal dans le repère fixe, vs la vitesse du porteur 25 secondaire dans le repère fixe et R = RpRIp la matrice de rotation permettant le passage des coordonnées d'un point dans le repère secondaire à ses coordonnées dans le repère fixe. Un seul de ces deux états peut aussi être ajouté au système. Il est à noter que l'état de navigation pourrait, dans un autre mode de réalisation être formé par les variables naturelles (Rp, xp, R,,x,), où la matrice de rotation R, et le vecteur 30 x, E R3 sont tels qu'un point de coordonnées u E R3 dans le repère attaché au véhicule secondaire aura les coordonnées R + xs dans le repère fixe. Dans ce cas, la loi de composition interne à utiliser est plus complexe : idx + sx du + (dx - sxJ \ d''da'\ = (sx ,su ,d x , d u) * (sr ,su tdx ,du) ç fa la ' salasa-du d d d ,X br + X dada , REVENDICATIONS1. Procédé d'aide à la navigation d'une flotte de véhicules comprenant un véhicule principal (1) et un véhicule secondaire (2) mobile par rapport au véhicule principal (1), le procédé comprenant des étapes de : - réception de données (Y1, Y2) acquises par au moins un capteur (2, 12), les données reçues comprenant des données cinématiques relatives entre le véhicule principal (1) et le véhicule secondaire (2), - estimation (100, 200) d'un état de navigation de la flotte de véhicules par un filtre de Kalman invariant utilisant les données reçues (Y1, Y2) comme observations, dans lequel l'état de navigation comprend o des premières variables représentatives d'une première transformation rigide liant un repère attaché au véhicule principal (1) à un 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 véhicule principal (1) à un repère attaché au véhicule secondaire (2), 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 l'état de navigation de la flotte comprend en outre au moins un état d'erreur propre au capteur (2, 12), et dans lequel la loi de composition interne est additive pour cet état d'erreur propre au capteur. 3. Procédé selon l'une des revendications précédentes, comprenant la réception de données de mouvement proprioceptif du véhicule principal (1) et du véhicule secondaire (2), dans lequel l'estimation comprend des phases de - propagation (112, 212) d'un état de navigation de la flotte préalablement estimé par le filtre de Kalman invariant à l'aide des données de mouvement proprioceptif du véhicule principal (1) et du véhicule secondaire (2) pour obtenir un état propagé, - mise à jour (110, 210) de l'état propagé à l'aide des observations, pour obtenir un nouvel état de navigation de la flotte. 4. Procédé selon les revendications précédentes, dans lequel les données de mouvement proprioceptif sont acquises par des capteurs proprioceptifs respectifs du véhicule principal 18 (1) et du véhicule secondaire (2), et l'état de navigation de la flotte comprend en outre au moins un état d'erreur propre à au moins un des capteurs proprioceptifs pour laquelle la loi de composition interne est additive. 5 5. Procédé selon l'une des revendications précédentes, dans lequel - les premières variables comprennent une matrice de rotation représentant une orientation du véhicule principal (1) et un vecteur de position du véhicule principal (1), et - dans lequel les deuxièmes variables comprennent une matrice de rotation 10 représentant l'orientation du véhicule principal (1) par rapport au véhicule secondaire (2) et un vecteur de position du véhicule principal (1) par rapport au véhicule secondaire (2). 6. Procédé selon la revendication précédente, dans lequel : 15 - l'état de navigation de la flotte comprend en outre un vecteur de vitesse y, du véhicule principal dans le repère de référence, et un vecteur de vitesse égal à (vp - vs), où vs est une vitesse du véhicule secondaire dans le repère de référence, et Rs est une matrice de rotation représentant l'orientation du véhicule secondaire (2) par rapport au repère de référence, 20 - la loi de composition interne applique des transformations identiques à l'un des vecteurs de position et l'un des vecteurs vitesse. 7. Procédé selon l'une des revendications précédentes, dans lequel l'estimation est mise en oeuvre par le véhicule principal (1), et les données reçues comprennent des données de 25 position du véhicule secondaire (2) dans un repère fixé au véhicule principal (1) acquises par au moins un premier capteur (3) du véhicule principal (1) comprenant par exemple un lidar, une caméra. 8. Procédé selon l'une des revendications précédentes, dans lequel l'estimation est mise en 30 oeuvre par le véhicule principal (1), et les données reçues comprennent des données de position du véhicule principal (1) dans un repère fixé au véhicule secondaire (2) acquises par au moins un deuxième capteur (12) du véhicule secondaire (2) comprenant par exemple un lidar, une caméra. 19 9. Procédé selon l'une des revendications précédentes, dans lequel les données reçues comprennent des données cinématiques relatives entre le véhicule principal (1) et un objet tiers distinct du véhicule principal (1) et du véhicule secondaire (2), les données cinématiques relatives entre le véhicule principal (1) et l'objet tiers étant également 5 utilisées comme observations par le filtre de Kalman invariant. 10. Procédé selon la revendication 6, dans lequel l'objet tiers est un amer. 11. Procédé selon l'une des revendications 9 et 10, dans lequel les données cinématiques 10 relatives entre le véhicule principal (1) et un objet tiers comprennent des données acquises par un récepteur GPS/GNSS (8) du véhicule principal (1). 12. Procédé selon l'une des revendications 7 et 8 prises en combinaison, comprenant des étapes des 15 - mise en oeuvre (100) de l'étape d'estimation sur la base des données de position de l'objet secondaire dans le repère fixé au véhicule principal (1) de sorte générer une première estimation (Xi) de l'état de navigation de la flotte, - mise en oeuvre (200) de l'étape d'estimation sur la base des données de position du véhicule principal (1) dans un repère fixé à l'objet secondaire, de sorte générer une 20 deuxième estimation (XÏ) de l'état de navigation de la flotte, - fusion des première et deuxième estimations (Xi', Xn de l'état de navigation de la flotte, de sorte à produire une troisième estimation (X:pt) de l'état de navigation la flotte, la fusion comprenant par exemple le calcul d'une moyenne des première et deuxième estimations de l'état de navigation de l'ensemble d'objets. 25 13. Procédé selon l'une des revendications précédentes, dans lequel : - les données reçues utilisées comme observations s'écrivent comme un vecteur Y, de la forme Y1 = 1(X1,yo), où 1(.,.) est une action de groupe à gauche pour la loi de composition interne, X, est l'état de navigation de la flotte, et yo est un vecteur de 30 même dimension que Y1, et dans lequelle filtre de Kalman invariant utilise une innovation Z = /(11?,-1,Y1), ou dans lequel - les données reçues utilisées comme observations s'écrivent comme un vecteur Y2 de la forme Y2 = 1(X21,y0)) où /(.,.) est une action de groupe à gauche pour la loi de composition interne, X2 est l'état de navigation de la flotte, et yo est un vecteur de 20 même dimension que Y2, et dans lequel où le filtre de Kalman invariant utilise une innovation Z = /(î2, Y2). 14. Dispositif d'aide à la navigation d'une flotte de véhicules comprenant un véhicule 5 principal (1) et un véhicule secondaire (2) mobile par rapport au véhicule principal (1), le dispositif comprenant : - une interface de réception (3, 4) pour recevoir des données (Y1, Y2) acquises par au moins un capteur, les données comprenant des données cinématiques relatives entre le véhicule principal (1) et le véhicule secondaire (2), 10 - une unité de traitement (1) configurée pour mettre en oeuvre un filtre de Kalman invariant de manière à estimer un état de navigation de la flotte de véhicules, dans lequel le filtre de Kalman invariant est configuré pour utiliser les données reçues comme observations, dans lequel l'état de navigation comprend des premières variables représentatives d'une première transformation rigide liant un repère 15 attaché au véhicule principal (1) à un repère de référence et des deuxièmes variables représentatives d'une deuxième transformation rigide liant un repère attaché au véhicule principal (1) à un repère attaché au véhicule secondaire (2), et dans lequel le filtre de Kalman invariant est configuré pour utiliser comme loi de composition interne une composition terme à terme de la première transformation rigide et de la 20 deuxième transformation rigide.