Brevet FR3106885A1 — publié le 20210806

La présente invention concerne un procédé d’aide à la navigation d’un porteur mobile (1) comportant une centrale inertielle de navigation (10) comportant au moins un capteur inertiel (12), dans lequel, sur une fenêtre d’observations déterminée, les étapes suivantes sont mises en œuvre : (E10) paramétrisation d’un système non-linéaire estimant un état de navigation du porteur mobile (1) à un pas de temps n ; (E20) linéarisation dudit système autour de l’état de navigation estimé ; (E21) estimation par un filtre de Kalman et clonage stochastique d’un premier correctif de l’état de navigation estimé du porteur ; (E22) estimation d’un second correctif par un filtre d’information fonctionnant à rebours et clonage stochastique ; (E30) détermination d’un troisième correctif par fusion des premier et second correctifs ; et correction de l’état de navigation estimé au pas de temps n+1 en fonction du troisième correctif. Figure pour l’abrégé : Fig. 2 PROCEDE D’AIDE À LA NAVIGATION D’UN PORTEUR MOBILE DOMAINE DE L'INVENTION La présente invention se rapporte au domaine du suivi de la localisation d’une centrale de navigation. La présente invention concerne plus particulièrement un procédé d’aide à la navigation d'un porteur mobile, et une centrale inertielle de navigation mettant en œuvre ledit procédé. ETAT DE LA TECHNIQUE Dans le domaine de l’estimation de la trajectoire d’une centrale inertielle à partir de ses mesures et de mesures extérieures provenant de différents capteurs (GPS, caméra, LiDar, odomètre, etc), un filtre de Kalman est un outil bien connu pour suivre la navigation d'un porteur tel qu'un navire, un aéronef ou un véhicule terrestre, c'est à dire sa position, sa vitesse, son accélération, etc. Le filtre de Kalman estime au cours d'itérations successives un état de navigation du porteur via des équations matricielles, donc linéaires, au moyen de mesures bruitées fournies par des capteurs de navigation. La centrale est alors assimilée à un système dynamique régi par des équations linéaires, ce qui constitue une limitation contraignante. Pour étendre le filtre de Kalman à des systèmes dynamiques régis par des équations non-linéaires, il a été proposé un procédé désigné sous l'expression de « filtre de Kalman étendu » (EKF). Cette évolution propose une étape supplémentaire consistant à linéariser, à chaque nouvelle itération du filtre, les équations régissant le système non-linéaire en un point de l'espace vectoriel, ce point étant typiquement un état estimé au cours d'une itération précédente. Les matrices issues de cette linéarisation peuvent être ainsi utilisées pour calculer un nouvel état estimé selon la méthode du filtre de Kalman classique. Les filtres de Kalman étendus connus présentent toutefois l'inconvénient de ne pas fonctionner correctement si le point de linéarisation est trop éloigné de l'état réel de navigation du porteur. Or, dans certains contextes de suivi de navigation, aucune estimation précise de l'état de navigation de la centrale n'est disponible au démarrage du filtre, si bien que la mise en œuvre des itérations successives du filtre de Kalman étendu ne permet pas de converger vers une estimation précise de l'état. On connait également une méthode de l’état de l’art appelée « lissage » qui consiste à calculer la trajectoire conduisant à des mesures les plus proches possibles des observations, en pondérant l’importance accordée à chaque mesure par la précision du capteur qui l’a produite. Par opposition au filtrage de Kalman qui traite les mesures séquentiellement et utilise chacune d’elles une seule fois, le lissage permet de « revenir en arrière » pour corriger des calculs à la lumière des dernières observations disponibles. Cet avantage rend cette approche importante pour l’utilisation de certains types de capteurs comme par exemple des caméras. Cependant, un défaut majeur du lissage a été identifié sur son utilisation potentielle dans des centrales de navigation de haute précision. En effet, les performances obtenues se dégradent fortement lorsqu’on remplace les calculateurs 64 bits utilisés par des ordinateurs classiques, par des calculateurs 32 bits, ou même 16 bits utilisés en général par les systèmes embarqués. Ce phénomène de dégradation, dû à l’accumulation d’imprécisions dans les calculs numériques, est très dangereux, car il peut conduire à la validation d’un algorithme en phase de prototypage qui ne pourra en fait jamais être mis en œuvre sur un produit final. La cause du problème a été identifiée comme étant l’utilisation de l’inverse de matrices très mal conditionnées (problème connu pour conduire à des erreurs numériques importantes). Il existe donc un besoin d’améliorer les techniques de l’art antérieur. Un but de l'invention est d'estimer la trajectoire d’une centrale inertielle à partir de ses mesures et de mesures extérieures provenant de différents capteurs. Un autre but de l'invention est de proposer un procédé qui soit plus adapté à une exécution sur des centrales inertielles de navigation de haute précision que les solutions de l'art antérieures présentées ci-dessus. Il est dès lors proposé un procédé d’aide à la navigation d'un porteur mobile comportant une centrale inertielle de navigation comportant au moins un capteur inertiel, dans lequel, sur une fenêtre d’observations déterminée, les étapes suivantes sont mises en œuvre par une unité d’estimation de la centrale inertielle de navigation : paramétrisation d’un système non-linéaire estimant un état de navigation du porteur mobile à un pas de temps n en fonction d'un modèle cinématique et/ou de mesures acquises par au moins un capteur inertiel ; linéarisation dudit système autour de l’état de navigation estimé ; estimation par un filtre de Kalman et clonage stochastique d’un premier correctif de l’état de navigation estimé du porteur ; estimation d’un second correctif par un filtre d’information fonctionnant à rebours et utilisant lui aussi un clonage stochastique ; détermination d’un troisième correctif par fusion des premier et second correctifs; et correction de l’état de navigation estimé au pas de temps n+1 en fonction du troisième correctif. Avantageusement, le procédé comporte également une ou plusieurs des caractéristiques suivantes : L’étape d’estimation par le filtre de Kalman et clonage stochastique du premier correctif est réalisée au cours d'itérations successives d’un correctif de l’état de navigation estimé du porteur, une itération du filtre comprenant des étapes de : propagation d'un état de navigation précédent du porteur en un état propagé en fonction d'un modèle cinématique et/ou de mesures acquises par au moins un capteur inertiel , mise à jour de l'état propagé en fonction de mesures directes ou relatives acquises par au moins un capteur complémentaire ; l’étape d’estimation du second correctif par le filtre d’information et clonage stochastique du premier correctif est réalisée au cours d'itérations successives, et comporte pour une itération du filtre d’information les étapes de: rétropropagation d'un correctif de l’état de navigation postérieur du porteur en un correctif de l’état propagé en fonction d'un modèle cinématique et/ou de mesures acquises par au moins un capteur inertiel , mise à jour du correctif de l’état propagé en fonction de mesures directes ou relatives acquises par au moins un capteur complémentaire . Dans l’étape d’estimation par le filtre de Kalman et clonage stochastique du premier correctif, le correctif de l’état de navigation propagé par le filtre kalman comporte un clone d’un correctif de l’état de navigation antérieur au correctif de l’état de navigation propagé, tant que ledit correctif de l’état de navigation antérieur intervient dans une mesure relative d’un correctif d’état ultérieur au correctif de l’état de navigation propagé, et dans lequel dans l’étape d’estimation du second correctif par le filtre d’information fonctionnant à rebours et clonage stochastique, le correctif de l’état de navigation rétropropagé par le filtre d’information fonctionnant à rebours comporte un clone d’un correctif d’état de navigation ultérieur au correctif de l’état de navigation rétropropagé, tant que ledit correctif de l’état de navigation ultérieur intervient dans une mesure relative d’un correctif d’état antérieur au correctif de l’état de navigation propagé. L’état de navigation à estimer est formulé sous la forme suivante où les ψ k sont des fonctions de coût associées aux mesures de chaque capteur, P k est la matrice de covariance associée à la k-ème mesure, c’est-à-dire l’incertitude qu’on lui associe, la notation représente une norme euclidienne pondérée par l’inverse de la matrice P k . Le système non-linéaire estimant un état de navigation X* du porteur mobile est linéarisé autour d’un état de navigation estimé, pour définir un correctif δX n à l’état estimé sous la forme suivante . L’étape de propagation met en œuvre une matrice de transition augmentée sous la forme , avec F correspondant à une matrice de transition qui relie un correctif d’état précédent à un correctif d’état actuel k , et Id une matrice identité de dimension égale au nombre de clones des états passés. L’étape de mise à jour met en œuvre une matrice d’observation augmentée sous la forme , les blocs étant d’indices i et j , le reste étant composé de zéros. Le procédé proposé permet de reformuler le calcul du « maximum a posteriori », MAP, utilisé dans le lissage, de façon à ne faire apparaître l’inverse de ces matrices que de façon implicite pour ainsi éviter de subir les effets des approximations numériques. Le procédé proposé permet également d’étendre le lisseur de Kalman à des problèmes couplant des mesures inertielles et des mesures quelconques, directes et/ou relatives, des états, le procédé se base sur l’utilisation jointe du lisseur et de la méthode dite de « clonage stochastique ». Ceci permet d’effectuer, entre autres, des fusions inertie-vision et inertie-LiDar basées sur le Maximum a posteriori numériquement stables, même en utilisant des centrales de navigation de haute précision, et dans des architectures embarquées à capacités de calculs réduites. Selon un deuxième aspect, l'invention propose en outre une unité d’estimation d’un porteur mobile configurée pour mettre en œuvre le procédé d’aide à la navigation d'un porteur mobile qui précède. Selon un troisième aspect, l'invention propose une centrale inertielle de navigation d’un porteur mobile comprenant une interface de réception de mesures inertielles acquises par au moins un capteur inertiel, une interface de réception de mesures complémentaires acquises par au moins un capteur complémentaire, une unité d’estimation selon le second aspect pour estimer un état de navigation de la centrale à partir de mesures acquises par l’interface de réception de mesures inertielles et l’interface de réception de mesures complémentaires. Il est également proposé un produit programme d'ordinateur comprenant des instructions de code de programme pour l'exécution des étapes du procédé qui précède, lorsque ce programme est exécuté par une unité d’estimation, selon le second aspect, d’une trajectoire d’un porteur mobile. 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 dessins annexés sur lesquels : la figure 1 représente une centrale de navigation pour un porteur mobile selon un mode de réalisation de l'invention, les figures 2 et 3 illustrent les étapes d'un procédé de suivi de localisation d’une centrale de navigation d'un porteur mobile, selon un mode de réalisation de l'invention, les figures 4A, 4B, 4C représentent un diagramme temporel illustrant des instants d'arrivées de mesures acquises et des durées de traitements opérés par une centrale de navigation selon un mode de réalisation de l'invention, et les figures 4D et 4E représentent un diagramme temporel illustrant des instants d'arrivées de mesures acquises et des durées de traitements opérés par une centrale de navigation selon des modes de réalisation différents de l'invention. DESCRIPTION DETAILLEE DE L'INVENTION En référence à la figure 1 , une centrale inertielle 10 est embarquée sur un porteur mobile 1, tel qu'un véhicule terrestre, un hélicoptère, un avion, etc. La centrale inertielle 10 comporte plusieurs parties : des capteurs inertiels 12, des capteurs complémentaires 13, et une unité d’estimation 11 pour mettre en œuvre des calculs d'estimation. Ces parties peuvent être physiquement séparées les unes des autres. Les capteurs inertiels 12 sont typiquement des accéléromètres et/ou des gyromètres mesurant respectivement des forces spécifiques et des vitesses de rotation que subit le porteur par rapport à un référentiel inertiel. La force spécifique correspond à l'accélération d'origine non gravitationnelle. Lorsque ces capteurs sont fixes par rapport au porteur, la centrale est dite de type « strap down ». Les capteurs complémentaires 13 sont variables selon le type de porteur, sa dynamique, et l'application visée. Les centrales inertielles utilisent typiquement un récepteur GNSS (GPS par exemple). Pour un véhicule terrestre, il s'agit également d'un ou de plusieurs odomètres. Pour un bateau, il peut s'agir d'un « loch », donnant la vitesse du bateau par rapport à celle de l'eau ou du fond marin. Les caméras ou radar par exemple de type LiDar, forment un autre exemple de capteurs complémentaires 13. Les données de sortie de l'unité d’estimation 11 sont un état représentatif de la navigation du porteur, appelé dans la suite état de navigation x et éventuellement d'états internes de la centrale inertielle 10. On distingue différents types de mesures, en fonction du type de capteur dont elles sont issues. Ainsi, on distingue : les mesures inertielles qui lient deux états consécutifs x i et x i+1 ; les mesures directes ne faisant intervenir qu’un seul des x i à la fois, comme des mesures GPS ; et les mesures relatives, c’est-à-dire qu’elles lient au moins deux états x i et x j qui peuvent ne pas être consécutifs. C’est le cas par exemple des mesures obtenues avec des caméras ou des LiDar. Cet état de navigation peut comprendre au moins une variable de navigation du porteur (position, vitesse, accélération, orientation, etc.). L'état de navigation peut en tout état de cause être représenté sous la forme d'un vecteur dont chaque composante est une variable de navigation du porteur. L'unité d’estimation 11 comprend notamment un algorithme de lissage configuré pour fusionner les informations données par les capteurs complémentaires 13 et les capteurs inertiels 12 de façon à fournir une estimation optimale des informations de navigation. La fusion est faite d'après un système dynamique continu ou discret servant de modèle pour prédire l'état à chaque instant à partir de l’état à l’instant précédent, à l'aide d'une fonction de propagation f non linéaire, ainsi que la façon de l'observer à l'aide d'une fonction d'observation h pouvant être non linéaire également. Les grandeurs estimées seront dans la suite notées avec des chapeaux ( x̂ ) et les grandeurs réelles sans chapeaux ( x ). L’unité d’estimation 11 comporte une interface primaire 21 de réception de mesures acquises par les capteurs inertiels 12, une interface secondaire 22 de réception de mesures acquises par les capteurs complémentaires 13, et au moins un processeur 20 configuré pour mettre en œuvre un lissage. Le lissage est un algorithme susceptible d'être codé sous la forme d'un programme d'ordinateur exécutable par le processeur 20. L'unité d’estimation 11 comprend en outre une sortie 23 pour délivrer des données de sorties calculées par le processeur 20. En référence aux figures 2 et 3 , il est illustré certaines étapes d'un procédé d’aide à la navigation d'un porteur mobile comportant une centrale inertielle de navigation, mis en œuvre par l'unité d’estimation 11 selon un mode de réalisation de l'invention. Le lissage estime la trajectoire suivie par le porteur, l’état de navigation dudit porteur étant le dernier état de ladite trajectoire. A partir d’une trajectoire X̂ n estimée d’une quelconque manière, le procédé proposé permet de déterminer un correctif à appliquer à ladite trajectoire pour obtenir une trajectoire corrigée pouvant prendre en compte les informations données, à tout instant de la navigation, par les capteurs complémentaires 13 et les capteurs inertiels 12 de façon à fournir une estimation optimale des informations de navigation. La trajectoire X̂ n étant estimée par un problème non-linéaire, dans une étape E10, dite de paramétrisation, il est mis en œuvre la manière dont le système considéré doit être linéarisé, ce qui forme un problème de moindres carrés linéaires à résoudre pour déterminer une correction δ X n de la trajectoire estimée X̂ n . La trajectoire associée au MAP est définie par un problème d’optimisation non linéaire sous la forme suivante : où : - les ψ k sont des fonctions de coût associées aux mesures de chaque capteur, - P k est la matrice de covariance associée à la k-ème mesure, c’est-à-dire l’incertitude qu’on lui associe, - la notation représente une norme euclidienne pondérée par l’inverse de la matrice P k . La trajectoire X̂ n estimée peut-être ensuite corrigée par une itération de lissage. Le principe du lissage repose sur une résolution itérative du problème d’optimisation non-linéaire par linéarisations successives du problème. On cherche ainsi une suite de solutions sous la forme , en cherchant à minimiser un système linéaire approximant le problème d’optimisation du MAP, ce qui amène à résoudre une succession de problèmes de moindres carrés linéaires de la forme : où les matrices A k et les vecteurs b k dépendent des mesures, de X̂ n , et de la paramétrisation choisie. Le lissage considérant une trajectoire, ou partie de celle-ci, composée de plusieurs états successifs, δ X n est en fait composé de plusieurs blocs représentant chacun un de ces états : δ X n1 , …, δ X np . Le problème rencontré vient du fait que les méthodes standards de résolution de ces problèmes linéaires nécessitent le calcul explicite de P k-1 , qui peut entrainer de graves problèmes numériques dans le cas de centrales inertielles de haute précision, notamment sur des architectures embarquées fonctionnant avec des moyens de calcul réduits, avec des cartes 32 bits, voire 16 bits. Une alternative qui peut être également appliquée dans le procédé proposé consiste à ne pas considérer P k mais sa racine carrée, une matrice S k telle que P k = S k S kT , que l’on évite aussi d’inverser. Une fois le problème linéarisé (étape E20), sont réalisées les étapes E21, E22, E30 de résolution de ce système. Un algorithme de résolution est proposé, qui trouve la solution exacte du problème de moindres carrés linéaire, mais permet d’éviter les problèmes de stabilité numérique qui pourraient apparaître avec une centrale de trop haute précision. Pour cela, il est utilisé le fait que le problème de moindres carrés peut être résolu sans instabilité numérique par une méthode appelée lisseur de Kalman complétée avec une méthode dite de « clonage stochastique », permettant de faire varier le nombre d’états du système afin qu’il s’écrive sous une forme compatible avec le lisseur de Kalman. Ce lisseur, s’appliquant à des systèmes linéaires, est construit sur la sortie d’un filtre de Kalman, c’est à dire qu’il permet de corriger les estimés issus du filtre de Kalman en incluant l’information contenue dans les observations venant du futur. Ainsi, pour appliquer ce lisseur, il faut tout d’abord parcourir les données dans le sens “direct”, c’est à dire de l’instant i= 1 à l’instant i = T (où T est la durée de la fenêtre d’observation), en leur appliquant un filtre de Kalman. Le lisseur, qui fonctionne à rebours, c’est à dire de l’instant k = T à l’instant k = 1, peut alors être appliqué. Par conséquent, à l’issue du lisseur, l’estimé de l’état au temps i ne tient pas seulement compte des observations passées Y1, ..., Yi mais de toutes les observations contenues dans la fenêtre d’observation Y1, ..., YT. De façon connue, un filtre de Kalman KF est un estimateur récursif d’états linéarisés. Ici, ces états linéarisés sont les corrections à appliquer aux états de navigation de la trajectoire. Le filtre est initialisé avec un état initial, qui servira d'entrée pour une première itération du filtre. Chaque itération suivante du filtre prend en entrée un état estimé par une itération précédente du filtre, et fournit une nouvelle estimation de l'état linéarisé (ou correction) du porteur. Une itération du filtre de Kalman comprend classiquement deux étapes : une propagation, et une mise à jour. L'étape de propagation détermine un état linéarisé propagé du porteur à partir de l'état linéarisé précédent (ou l'état linéarisé initial pour la première itération), et ce au moyen de la fonction de propagation linéarisée. L'étape de propagation produit en outre une matrice de covariance P représentative d'une incertitude sur les mesures acquises. Le filtre de Kalman permet de réaliser l’approximation de la moyenne et de la variance de la distribution de probabilité conditionnelle d’un état linéarisé sachant toutes les observations passées, i.e. jusqu’à cet instant. Il existe un cadre très précis dans lequel δ X n peut être obtenu sans devoir calculer les inverses des matrices P k associées à des mesures d’une centrale inertielle : celui où les mesures se séparent en deux catégories : les mesures inertielles, issues des capteurs inertiels 12, qui lient δ X ni et δ X ni+1 , dont les covariances sont notées Q , et des mesures directes, issues des capteurs complémentaires 13, ne faisant intervenir qu’un seul des x i à la fois, comme des mesures GPS. En effet, dans ce cas, le lisseur de Kalman peut être employé pour résoudre le problème, et une de ses formulations récentes permet de ne pas avoir à inverser les matrices problématiques. Celle-ci utilise une seconde estimation par le filtre de Kalman, cette fois-ci appliqué dans le sens à rebours des observations sous une forme connue par ailleurs appelée « filtre d’information », fournissant un second correctif. Celui-ci est alors fusionné avec le résultat du premier filtre de Kalman. Le lisseur de Kalman permet d’obtenir les moyennes x 1 , …, x p recherchées, avec leurs covariances P 1 , …, P p associées. Cependant, le lisseur de Kalman ne s’applique pas en tant que tel dans d’autres cas, notamment lorsque les mesures autres qu’inertielles sont des mesures relatives, c’est-à-dire qu’elles lient au moins deux états δ X ni et δ X n j . C’est le cas par exemple des mesures obtenues avec des caméras ou des LiDar. Pour tous les capteurs complémentaires 13, les covariances des mesures associées sont notées R . Pour pouvoir étendre le lisseur de Kalman à des problèmes couplant des mesures inertielles et des mesures quelconques, directes et/ou relatives, des états, le procédé se base sur l’utilisation jointe du lisseur et de la méthode dite de « clonage stochastique », détaillée ci-après. Ceci permet d’effectuer, entre autres, des fusions inertie-vision et inertie-LiDar basées sur le Maximum a posteriori numériquement stables, même en utilisant des centrales de navigation de haute précision, et dans des architectures embarquées à capacités de calculs réduites. En référence à la figure 4A , il est illustré un exemple de trajectoire à estimer par lissage sur une période de temps déterminée. Les flèches droites entre deux états successifs indiquent des mesures inertielles, les flèches courbes désignent des mesures relatives entre deux états qui peuvent ne pas être successifs L’utilisation du clonage stochastique est illustrée en figure 4B . Ainsi, l’état évolue en récupérant des clones des états passés qui interviennent dans des mesures ultérieures, par exemple δ X 0 qui aura un impact direct sur δ X 3 . L’utilisation du clonage stochastique est représentée par des états alternatifs V 1 , …, V p dont la taille varie au cours du temps, car ils contiendront en mémoire des clones des états passés, tant que ceux-ci interviennent dans une mesure avec un état ultérieur. L’état alternatif V i est donc formé de δ X i et de clones d’anciens états δ X j1 , …, δ X jm . La figure 4C illustre les avantages de l’utilisation jointe du lisseur et de la méthode dite de « clonage stochastique » avec une forte erreur de linéarisation. Ainsi, la propagation de l’information est numériquement stable, et la correction de l’erreur initiale amenée par le lissage est donc bien prise en compte, pour obtenir une estimation de meilleure qualité. En comparaison, la figure 4D illustre les limites de l’application du filtrage de Kalman avec clonage stochastique. Ainsi, une forte erreur de linéarisation, comme il peut en exister en fusion inertie-vision, est propagée et jamais rattrapée par la suite, ce qui peut conduire à une estimation de moins bonne qualité, voire incohérente. La figure 4E illustre les avantages théoriques et les limites pratiques du lissage classique par rapport à la méthode illustrée sur l’exemple des figures 3 et 4. Théoriquement, l’erreur initiale de linéarisation doit être corrigée grâce aux mesures ultérieures. Cependant, les erreurs numériques des implémentations classiques prennent le pas et dégradent fortement l’estimation dans les faits L’utilisation jointe du lisseur et de la méthode dite de « clonage stochastique » peut être mise en œuvre par l’algorithme suivant : Dans une étape E21, pour appliquer ce lisseur, les données sont parcourues dans le sens “direct”, c’est à dire de l’instant i = 0 à l’instant i = T (où T est la durée de la fenêtre d’observation), en leur appliquant un filtre de Kalman pour déterminer un vecteur x i et une matrice P i , représentatifs de l’information jusqu’à l’instant i , i.e. En particulier, la correction associée à l’état i sera donnée par le dernier bloc de V i , donc sa moyenne par le dernier bloc de x i , et sa covariance par le bloc en bas à droite de P i : [1] initialisation [2] pour chaque itération i [3] Si δ X ni-1 est impliqué dans une mesure ultérieure, clonage de δ X ni-1 dans la moyenne x i-1 de l’état alternatif. La covariance P i-1 est étendue en dédoublant la dernière ligne, puis la dernière colonne [4] Propagation de l’état étendu : la matrice identité étant de dimension égale au nombre de clones mémorisés dans l’état alternatif. La covariance est propagée classiquement. [5] Si il y a une mesure entre i et j avec j [6] Mise à jour selon les équations connues du gain de Kalman avec les blocs étant d’indices i et j [7] si δ X n j n’est pas impliqué dans une mesure ultérieure, suppression de δ X n j dans l’état alternatif : suppression du bloc, des lignes et colonnes associées dans x i et P i . Dans une étape E22, le lisseur est appliqué pour récursivement calculer la distribution a posteriori , sous forme représentative de l’information à partir de l’instant i , c’est-à-dire via un vecteur y i et une matrice d’information J i encodant une distribution normale La matrice J i correspond donc à l’inverse de la matrice de covariance associée à cette distribution. [1] initialisation y 0 =0, j 0 =0 [2] pour chaque itération i allant de n à 0 [3] Si δ X ni est impliqué dans une mesure précédente, étendre y i avec autant de zéros que la dimension de δ X ni , et rajouter à j i autant de lignes de zéros, puis autant de colonnes de zéros. [4] S’il y a une mesure Y ij entre δ X ni et δ X n j avec j [5] Mise à jour en forme d’information avec les blocs étant d’indices i et j : [6] si δ X n j n’est pas impliqué dans une mesure antérieure, fusion de δ X n j dans l’information étendue : , où y ki désigne la partie de y i correspondant au clone δ X nk et J kl i correspond au bloc d’information associé à δ X nk et δ X n , puis suppression des blocs associés à δ X n j , [7] Rétropropagation de l’information étendue : la matrice identité étant de dimension égale au nombre de clones mémorisés dans l’état alternatif, et . Dans une étape E30, il est ensuite procédé à la fusion des estimations « directe » et « à rebours » Ainsi pour chaque itération i, il peut être procédé au calcul suivant du correctif final de l’état de navigation estimé : . Puis, pour chaque i , la correction de l’état de navigation δ X ni* est obtenue comme le dernier bloc de l’état étendu V̂ n i . Ensuite, le correctif déterminé, il est procédé à la correction de l’état de navigation sous la forme suivante : . Le procédé proposé permet donc d’étendre le lisseur de Kalman à des problèmes couplant des mesures inertielles et des mesures quelconques, directes et/ou relatives, des états, le procédé se base sur l’utilisation jointe du lisseur et de la méthode dite de « clonage stochastique », détaillée ci-après. Ceci permet d’effectuer, entre autres, des fusions inertie-vision et inertie-LiDar basées sur le Maximum a posteriori numériquement stables, même en utilisant des centrales de navigation de haute précision, et dans des architectures embarquées à capacités de calculs réduites. Procédé d’aide à la navigation d'un porteur mobile (1) comportant une centrale inertielle de navigation (10) comportant au moins un capteur inertiel (12), dans lequel, sur une fenêtre d’observations déterminée, les étapes suivantes sont mises en œuvre par une unité d’estimation (11) de la centrale inertielle de navigation (10) : (E10) paramétrisation d’un système non-linéaire estimant un état de navigation du porteur mobile (1) à un pas de temps n en fonction d'un modèle cinématique et/ou de mesures acquises par au moins un capteur inertiel (12) ; (E20) linéarisation dudit système autour de l’état de navigation estimé ; (E21) estimation par un filtre de Kalman et clonage stochastique d’un premier correctif de l’état de navigation estimé du porteur (E22) estimation d’un second correctif par un filtre d’information fonctionnant à rebours et clonage stochastique ; (E30) détermination d’un troisième correctif par fusion des premier et second correctifs; et correction de l’état de navigation estimé au pas de temps n+1 en fonction du troisième correctif. Procédé d’aide à la navigation d'un porteur mobile (1) selon la revendication précédente dans lequel l’étape (E21) d’estimation par le filtre de Kalman et clonage stochastique du premier correctif est réalisée au cours d'itérations successives, une itération du filtre comprenant des étapes de : • propagation d'un état de navigation précédent du porteur en un état propagé en fonction d'un modèle cinématique et/ou de mesures acquises par au moins un capteur inertiel (12), • mise à jour de l'état propagé en fonction de mesures directes ou relatives acquises par au moins un capteur complémentaire (13), l’étape (E22) d’estimation du second correctif par le filtre d’information itératif et clonage stochastique est réalisée au cours d'itérations successives, et comporte pour une itération du filtre d’information les étapes de : • rétropropagation d'un correctif de l’état de navigation postérieur du porteur en un correctif de l’état propagé en fonction d'un modèle cinématique et/ou de mesures acquises par au moins un capteur inertiel (12), • mise à jour du correctif de l’état propagé en fonction de mesures directes ou relatives acquises par au moins un capteur complémentaire (13). Procédé d’aide à la navigation d'un porteur mobile (1) selon la revendication précédente dans lequel l’étape (E21) d’estimation par le filtre de Kalman et clonage stochastique du premier correctif, le correctif de l’état de navigation propagé par le filtre kalman comporte un clone d’un correctif de l’état de navigation antérieur au correctif de l’état de navigation propagé, tant que ledit correctif de l’état de navigation antérieur intervient dans une mesure relative d’un correctif d’état ultérieur au correctif de l’état de navigation propagé ; et dans lequel dans l’étape (E22) d’estimation du second correctif par le filtre d’information fonctionnant à rebours et clonage stochastique, le correctif de l’état de navigation rétropropagé par le filtre d’information fonctionnant à rebours comporte un clone d’un correctif d’état de navigation ultérieur au correctif de l’état de navigation rétropropagé, tant que ledit correctif de l’état de navigation ultérieur intervient dans une mesure relative d’un correctif d’état antérieur au correctif de l’état de navigation propagé. Procédé d’aide à la navigation d'un porteur mobile (1) selon l’une des revendications précédentes dans lequel l’état de navigation à estimer est formulé sous la forme suivante où les ψ k sont des fonctions de coût associées aux mesures de chaque capteur, P k est la matrice de covariance associée à la k-ème mesure, c’est-à-dire l’incertitude qu’on lui associe, la notation représente une norme euclidienne pondérée par l’inverse de la matrice P k . Procédé d’aide à la navigation d'un porteur mobile (1) selon la revendication précédente dans lequel le système non-linéaire estimant un état de navigation X* du porteur mobile (1) est linéarisé autour d’un état de navigation estimé, pour définir un correctif δ X n à l’état estimé sous la forme suivante Procédé d’aide à la navigation d'un porteur mobile (1) selon l’une des revendications 2 à 5, dans lequel l’étape de propagation met en œuvre une matrice de transition augmentée sous la forme , avec F correspondant à une matrice de transition qui relie un correctif d’état précédent à un correctif d’état actuel k, et Id une matrice identité de dimension égale au nombre de clone des états passés. Procédé d’aide à la navigation d'un porteur mobile (1) selon l’une des revendications 2 à 6, dans lequel l’étape de mise à jour met en œuvre une matrice d’observation augmentée sous la forme , les blocs étant d’indices i et j, le reste étant composé de zéros. Unité d’estimation (11) d’un porteur mobile (1) configurée pour mettre en œuvre le procédé selon l'une des revendications 1 à 7. Centrale inertielle de navigation (10) d’un porteur mobile (1) comprenant : une interface de réception de mesures inertielles (21) acquises par au moins un capteur inertiel (12), une interface de réception de mesures complémentaires (22) acquises par au moins un capteur complémentaire (13), une unité d’estimation (11) selon la revendication 8 pour estimer un état de navigation de la centrale à partir de mesures acquises par l’interface de réception de mesures inertielles (21) et l’interface de réception de mesures complémentaires (22). Produit programme d'ordinateur comprenant des instructions de code de programme pour l'exécution des étapes du procédé selon l'une des revendications 1 à 7, lorsque ce programme est exécuté par une unité d’estimation (11) d’une trajectoire d’un porteur mobile (1).