Brevet FR3095041A1 — publié le 20201016

Description Titre de l'invention : PROCEDE DE DETERMINATION DE LA POSITION ET DE L'ORIENTATION D'UN VEHICULE [0001] L'invention concerne un procédé et un système de détermination de la position et de l'orientation d'un véhicule. Elle a également pour objet un procédé et un module de calibration d'un magnétomètre pour la mise en oeuvre du procédé de détermination de la position et de l'orientation du véhicule. Elle a aussi pour objet un support d'enregistrement d'informations pour la mise en oeuvre du procédé de calibration. Des procédés connus de détermination de la position et de l'orientation d'un véhicule comportent : [0002] - la fourniture d'un système dc localisation fixé sur cc véhicule, ce système de loca- lisation comportant : une unité de géolocalisation par satellite, une unité de navigation inertielle contenant un accéléromètre et un gyromètre, et un magnétomètre comportant au moins deux axes dc mesure, [0003] - la mesure, par le magnétomètre, d'un premier vecteur de mesures brutes contenant une composante brute pour chacun des axes de mesure, chaque composante codant l'amplitude et la direction de la projection orthogonale du champ magnétique qui traverse ce magnétomètre sur un axe respectif de mesure, ces axes de mesure étant fixes dans un repère mobile tri-axe fixé sur le véhicule, puis [0004] - la correction de chacune des composantes brutes du premier vecteur en la mul- tipliant par un coefficient d'échelle et en y ajoutant un coefficient de décalage pour obtenir une composante corrigée, ces coefficients d'échelle et de décalage étant obtenus à partir de données pré-enregistrées dans une mémoire du système de localisation, puis [0005] - une estimation initiale de l'angle de lacet du véhicule à partir des composantes corrigées du premier vecteur, puis [0006] - l'initial isation, à l'aide de l'estimation initiale de l'angle de lacet, d'un algorithme de fusion apte à établir, à partir dc précédentes estimations de la position et de l'orientation du véhicule et en utilisant à la fois les mesures de l'unité de géolocalisation et les mesures de l'unité de navigation inertielle réalisées depuis ces précédentes estimations : de nouvelles estimations de la position et de l'orientation du véhicule, et une marge d'erreur sur cette nouvelle estimation de l'orientation du véhicule, puis [0007] - l'exécution répétée, pendant toute une phase d'utilisation, de cet algorithme de 2 fusion pour mettre à jour en continu l'estimation de la position et de l'orientation du véhicule. De tels procédés sont, par exemple, décrits en détail dans le livre suivant et en particulier, dans les chapitres 5.6 et 15 : Paul D. Groves : "Principles of GNSS, Inernal, and Multisensar Integrated Navigation Systems", Second Edition (GNSS Technology and Applications), Artcch House, 2008. L'utilisation d'un magnétomètre pour obtenir l'estimation initiale de l'angle de lacet du véhicule pose cependant quelques problèmes. L'estimation initiale de l'angle de lacet doit être fournie au démarrage du système et être la plus précise possible. En effet, plus l'estimation initiale de l'angle de lacet est mauvaise, plus la convergence de l'algorithme de fusion vers une estimation précise de la position et de l'orientation du véhicule est lente. Or, la calibration du magnétomètre varie au cours du temps de sorte que des valeurs des coefficients d'échelle et de décalage qui étaient un temps appropriées pour corriger correctement le premier vecteur de mesures ne le sont plus plus tard. Ainsi, au fur et à mesure du temps, la précision de l'estimation initiale de l'angle de lacet se dégrade. De plus, la calibration d'un magnétomètre alors qu'il est déjà monté dans un véhicule qui se déplace est difficile à réaliser. En effet, dans cette situation, l'environnement extérieur du magnétomètre n'est pas maîtrisé et n'est pas connu. L'invention vise à proposer un tel procédé de détermination de la position et de l'orientation (l'un véhicule dans lequel la précision de l'estimation initiale de l'angle de lacet est améliorée. Elle a donc pour objet un tel procédé dans lequel, après le début de l'exécution répétée de l'algorithme de fusion, le procédé comporte une phase de calibration comportant les opérations suivantes : [0008] 1) la mesure, par le magnétomètre, d'un deuxième vecteur de mesures brutes, [0009] 2) l'obtention d'un vecteur de référence comportant une composante pour chaque axe de mesure, chacune de ces composantes codant l'amplitude et la direction de la projection orthogonale du champ géomagnétique qui traverse le magnétomètre sur un axe respectif d'un repère terrestre tri-axe fixé sans aucun degré de liberté à la terre, les composantes du vecteur de référence étant obtenues à partir d'un modèle pré-enregistré du champ géomagnétique et non pas mesurées par le magnétomètre, puis [0010] 3) uniquement lorsque la marge d'erreur sur l'estimation de l'orientation du véhicule tombe en dessous d'un premier seuil prédéterminé, la mise à jour des données préenregistrées à partir desquelles les coefficients d'échelle et de décalage sont obtenus, cette mise à jour étant réalisée à partir du deuxième vecteur brute, du vecteur de référence et de la nouvelle estimation de l'orientation du véhicule de manière à réduire l'écart entre les composantes corrigées du deuxième vecteur de mesure et les com- 3 posantes du vecteur de référence lorsque toutes ces composantes sont exprimées dans un repère commun. Les modes de réalisation de ce procédé de détermination de la position et de l'orientation d'un véhicule peuvent comporter une ou plusieurs des caractéristiques suivantes : la phase de cal ibration comporte : [0011] - le calcul d'un écart entre les composantes brutes du deuxième vecteur de mesure et une estimation de ces composantes obtenus à partir du vecteur de référence et de l'estimation de l'orientation du véhicule, puis - la comparaison de l'écart calculé à un deuxième seuil prédéterminé, puis - lorsque l'écart calculé dépasse ce deuxième seuil, l'opération 3) est inhibée et, lorsque l'écart calculé ne dépasse pas ce deuxième seuil, l'opération 3) est autorisée; la phase de cal ibration comporte le calcul de l'écart-type de l'écart calculé et la comparaison de l'écart calculé, pondéré en fonction de cette écart-type calculé, au deuxième seuil; la phase de cal ibration comporte : [0012] - le calcul d'un écart d'orientation entre l'orientation du véhicule lors d'une précédente exécution de la phase de calibration et l'orientation du véhicule lors de la présente exécution de la phase de calibration, puis - la comparaison de l'écart d'orientation calculé à un troisième seuil prédéterminé, puis - lorsque l'écart d'orientation calculé ne dépasse pas ce troisième seuil, l'opération 3) est inhibée et, lorsque l'écart d'orientation calculé dépasse ce troisième seuil, l'opération 3) est autorisée; - l'obtention du vecteur de référence comporte le calcul des composantes du vecteur de référence à partir : [0013] - de l'estimation de la position du véhicule, et - d'un modèle pré-enregistrée du champ géomagnétique qui associe, à chaque position possible du véhicule, les composantes du champ géomagnétique à cette position dans le repère terrestre, ce modèle intégrant à cet effet des variations locales du champ géomagnétique; - la phase de calibration comporte : [0014] - l'établissement de nouvelles valeurs pour les données pré-enregistrées à partir desquelles les coefficients d'échelle et de décalage sont obtenus, ces nouvelles valeurs étant calculées à partir des composantes brutes du deuxième vecteur de mesure, du vecteur de référence et de l'orientation estimée du véhicule, et l'établissement de ces nouvelles valeurs pour les données pré-enregistrées comportant également le calcul d'au moins une marge d'erreur sur une de ces nouvelles valeurs calculées, puis - la comparaison de cette marge d'erreur calculée à un quatrième seuil prédéterminé, puis - lorsque la marge d'erreur calculée dépasse ce quatrième seuil, l'utilisation des nouvelles valeurs calculées pour calculer des coefficients d'échelle et de décalage est inhibée et, lorsque la marge d'erreur calculée ne dépasse pas ce quatrième seuil : - l'opération 3) est autorisée et les données pré-enregistrées mises à jour sont prises égales aux nouvelles valeurs calculées, et - l'utilisation des nouvelles valeurs calculées pour calculer des coefficients d'échelle et de décalage est autorisée; - la phase de calibration comporte : [0015] - l'établissement, à partir de l'estimation de l'orientation du véhicule, des composantes d'une matrice de rotation qui permet de réaliser un changement de repère depuis le repère terrestre vers le repère mobile, - la multiplication du vecteur de référence par la matrice de rotation pour obtenir le vecteur de référence dont les composantes sont exprimées dans le repère mobile, ce repère mobile formant alors le repère commun; la phase de calibration comporte : [0016] - la comparaison de la marge d'erreur sur l'estimation de l'orientation au premier seuil, puis - lorsque la marge d'erreur sur l'estimation de l'orientation dépasse ce premier seuil, l'opération 3) est inhibée et, lorsque la marge d'erreur sur l'estimation de l'orientation ne dépasse pas ce premier seuil, l'opération 3) est autorisée. L'invention a également pour objet un procédé de calibration d'un magnétomètre pour la réalisation de la phase de calibration du procédé de détermination ci-dessus, ce procédé de calibration comportant les opérations suivantes : [0017] 1) la mesure, par le magnétomètre, du deuxième vecteur de mesures brutes, [0018] 2) l'obtention d'un vecteur de référence comportant une composante pour chaque axe de mesure, chacune de ces composantes codant l'amplitude et la direction de la projection orthogonale du champ géomagnétique qui traverse le magnétomètre sur un axe respectif d'un repère terrestre tri-axe fixé sans aucun degré de liberté à la terre, les composantes du vecteur de référence étant obtenues à partir d'un modèle pré-enregistré du champ géomagnétique et non pas mesurées par le magnétomètre, puis [0019] 3) la mise à jour des données pré-enregistrées à partir desquelles les coefficients d'échelle et de décalage sont obtenus, cette mise à jour étant réalisée à partir du deuxième vecteur brute, du vecteur de référence et de la nouvelle estimation de l'orientation du véhicule de manière à réduire l'écart entre les composantes corrigées du deuxième vecteur de mesure et les composantes du vecteur de référence lorsque toutes ces composantes sont exprimées dans un repère commun, [0020] dans lequel : [0021] - le procédé de calibration comporte l'acquisition d'une marge d'erreur sur l'estimation de l'orientation du véhicule sur lequel est fixé le magnétomètre, puis [0022] - l'opération 3) est exécutée uniquement lorsque cette marge d'erreur sur l'estimation de l'orientation du véhicule tombe en dessous d'un premier seuil prédéterminé. L'invention a également pour objet un support d'enregistrement d'informations, lisible par un microprocesseur et comportant des instructions pour la réalisation du procédé de calibration ci-dessus, lorsque ces instructions sont exécutées par le microprocesseur. L'invention a aussi pour objet un système de localisation, apte à être fixé sur un véhicule, pour déterminer la position et l'orientation de ce véhicule, ce système de localisation comportant : [0023] - une unité de géolocalisation par satellite, [0024] - une unité de navigation inertielle contenant un accéléromètre et un gyromètre, et [0025] - un magnétomètre comportant au moins deux axes de mesure, [0026] ce système de localisation étant configure pour : [0027] - mesurer, à l'aide du magnétomètre, un premier vecteur de mesures brutes contenant une composante brute pour chacun des axes de mesure, chaque composante codant l'amplitude et la direction de la projection orthogonale du champ magnétique qui traverse ce magnétomètre sur un axe respectif de mesure, ces axes de mesure étant fixes dans un repère mobile tri-axe fixé sur le véhicule, puis [0028] - corriger chacune des composantes brutes du premier vecteur en la multipliant par un coefficient d'échelle et en y ajoutant un coefficient de décalage pour obtenir une composante corrigée, ces coefficients d'échelle et de décalage étant obtenus à partir de données pré-enregistrées dans une mémoire du système de localisation, puis [0029] - construire une estimation initiale de l'angle de lacet du véhicule à partir des com- posantes corrigées du premier vecteur, puis [0030] - initialiser, à l'aide de l'estimation initiale de l'angle de lacet, un algorithme de fusion apte à établir, à partir de précédentes estimations de la position et de l'orientation du véhicule et en utilisant à la fois les mesures de l'unité de géolocalisation et les mesures de l'unité de navigation inertielle réalisées depuis ces précédentes estimations : de nouvelles estimations de la position et de l'orientation du véhicule, et une marge d'erreur sur cette nouvelle estimation de l'orientation du véhicule, puis [0031] - exécuter de façon répétée, pendant toute une phase d'utilisation, cet algorithme de fusion pour mettre à jour en continu l'estimation de la position et de l'orientation du véhicule, [0032] dans lequel le système comporte un module de calibration apte, après le début de 6 l'exécution répétée de l'algorithme de fusion, à exécuter les opérations suivantes : [0033] 1) l'acquisition de la mesure, par le magnétomètre, d'un deuxième vecteur de mesures brutes, [0034] 2) l'obtention d'un vecteur de référence comportant une composante pour chaque axe de mesure, chacune de ces composantes codant l'amplitude et la direction de la projection orthogonale du champ géomagnétique qui traverse le magnétomètre sur un axe respectif d'un repère terrestre tri-axe fixé sans aucun degré de liberté à la terre, les composantes du vecteur de référence étant obtenues à partir d'un modèle pré-enregistré du champ géomagnétique et non pas mesurées par le magnétomètre, puis [0035] 3) uniquement lorsque la marge d'erreur sur l'estimation de l'orientation du véhicule tombe en dessous d'un premier seuil prédéterminé, la mise à jour des données préenregistrées à partir desquelles les coefficients d'échelle et de décalage sont obtenus, cette mise à jour étant réalisée à partir du deuxième vecteur brute, du vecteur de référence et de la nouvelle estimation de l'orientation du véhicule de manière à réduire l'écart entre les composantes corrigées du deuxième vecteur de mesure et les composantes du vecteur de référence lorsque toutes ces composantes sont exprimées dans un repère commun. L'invention a aussi pour objet un module de cal ibration d'un magnétomètre comportant au moins deux axes de mesure pour la réalisation du système ci-dessus ce module de calibration étant configure pour réaliser les opérations suivantes : [0036] 1) l'acquisition de la mesure, par le magnétomètre, du deuxième vecteur de mesures brutes, [0037] 2) l'obtention d'un vecteur de référence comportant une composante pour chaque axe de mesure, chacune de ces composantes codant l'amplitude et la direction de la projection orthogonale du champ géomagnétique qui traverse le magnétomètre sur un axe respectif d'un repère terrestre tri-axe fixé sans aucun degré de liberté à la terre, les composantes du vecteur de référence étant obtenues à partir d'un modèle pré-enregistré du champ géomagnétique et non pas mesurées par le magnétomètre, puis [0038] 3) la mise à jour des données pré-enregistrées à partir desquelles les coefficients d'échelle et de décalage sont obtenus, cette mise à jour étant réalisée à partir du deuxième vecteur brute, du vecteur de référence et de la nouvelle estimation de l'orientation du véhicule de manière à réduire l'écart entre les composantes corrigées du deuxième vecteur de mesure et les composantes du vecteur de référence lorsque toutes ces composantes sont exprimées dans un repère commun, [0039] dans lequel le module de calibration est configuré : [0040] - pour acquérir une marge d'erreur sur l'estimation de l'orientation du véhicule sur lequel est fixé le magnétomètre, et [0041] - pour exécuter l'opération 3) uniquement lorsque cette marge d'erreur sur 7 l'estimation de l'orientation du véhicule tombe en dessous d'un premier seuil prédéterminé. L'invention sera mieux comprise à la lecture de la description qui va suivre, donnée uniquement à titre d'exemple non limitatif et faite en se référant aux dessins sur lesquels : [0042] - la figure 1 est une illustration schématique d'un système dc localisation d'un véhicule ; [0043] - la figure 2 est un organigramme d'un procédé de détermination de la position et de l'orientation d'un véhicule à l'aide du système de la figure 1 ; [0044] - la figure 3 est un organigramme d'un procédé d'estimation de coefficients d'échelle et de décalage pour la calihration d'un magnétomètre mis en oeuvre dans le procédé de la figure 2. Dans ces figures les mêmes références sont utilisées pour désigner les mêmes éléments. Dans la suite dc cette description, les caractéristiques et fonctions bien connues de l'homme du métier ne sont pas décrites en détail. En particulier, pour les connaissances générales dc l'homme du métier concernant les systèmes de localisation d'un véhicule à l'aide d'une unité dc géolocalisation par satellite et d'une unité de navigation inertielle, il est renvoyé au livre de Monsieur Groves précédemment cité. Chapitre I: Exemples de mode de réalisation La figure 1 représente un véhicule 2 capable de se déplacer sur la terre, sur la mer ou dans les airs. Le véhicule 2 peut donc être un véhicule automobile, un train, un bateau, un avion ou tout autre véhicule similaire. Le véhicule 2 est équipé de moyens 4 de propulsion. Le véhicule 2 est aussi équipé d'un système 6 de localisation de ce véhicule. Ce système 6 est apte à déterminer de la position et de l'orientation du véhicule 2 dans un repère terrestre RT. Le repère ten-estre RT est fixé sans aucun degré de liberté à la terre. Le repère RT comporte trois axes typiquement orthogonaux entre eux. Un repère mobile R1, est également fixé sans aucun degré de liberté au véhicule 2. Ce repère Rb comporte trois axes orthogonaux entre eux notés respectivement xi,, y,, et zb. Classiquement, lorsque le véhicule 2 se déplace horizontalement, les axes xf, et yb sont dans un plan horizontal et l'axe z,, est vertical. Ici, la position du véhicule 2 dans le repère RT est exprimée par la latitude L, la longitude X et l'altitude h de l'origine du repère Rb. L'orientation du véhicule 2 est exprimée par l'angle ip de lacet (« yaw angle » en anglais), l'angle 0 de tangage (« pitch angle » en anglais) et l'angle (I) de roulis (« roll angle » en anglais) du repère Rb par rapport au repère RT. La position et l'orientation déterminées par le système 6 sont généralement 8 transmises à un poste 8 de pilotage pour guider ou assister au guidage du véhicule 2 vers une destination prédéfinie. Le poste 8 peut être un poste de pilotage manuel et/ou automatique. Dans le cas d'un poste de pilotage manuel, la position et l'orientation déterminées sont transmises à une interface homme-machine pour assister un être humain dans le pilotage des moyens 4 de propulsion. Dans le cas d'un poste de pilotage automatique, la position et l'orientation déterminées sont automatiquement converties en commandes de pilotage des moyens 4 de propulsion, puis transmises automatiquement à ces moyens 4 de propulsion. Le système 6 comporte une unité 10 de géolocalisation par satellite et une unité 12 de navigation inertielle. L'unité 10 est connue sous l'acronyme GNSS (« Global Navigation Satellite System ». L'unité 10 est ici une unité de géolocalisation mono-antenne et non pas une unité de géolocalisation multi-antenne. L'unité 10 est donc incapable de mesurer l'orientation absolue du véhicule 2 dans le repère RI à partir des signaux émis par les satellites. L'unité 12 est connue sous l'acronyme INS (« Incrtial Navigation System ». L'unité 12 comporte notamment un accéléromètre triaxc 14 et un gyromètre triaxe 16. Grâce à ces capteurs, l'unité 12 est capable de mesurer la variation de l'orientation du véhicule 2. Par contre, l'unité 12 est incapable elle aussi de mesurer directement l'orientation du véhicule 2 dans le repère RT. Pour déterminer la position et l'orientation du véhicule 2 à partir des mesures des unités 10 et 12, le système 6 comporte un calculateur électronique programmable 20. Ce calculateur 20 est apte à acquérir les mesures des unités 10 et 12 et, à partir de ces mesures, à déterminer la position et l'orientation du véhicule 2 dans le repère RT. Le calculateur 20 comporte un microprocesseur 22 et une mémoire 24 comportant les instructions et les données nécessaires à la mise en oeuvre des procédés décrits en référence aux figures 2 et 3. Plus précisément, la mémoire 24 comporte les instructions d'un module 26. Le module 26 exécute notamment un algorithme de fusion apte à établir, à partir d'une précédente estimation de la position et de l'orientation du véhicule 2 et de nouvelles mesures des unités 10 et 12 acquises depuis cette précédente estimation, une nouvelle estimation de la position et de l'orientation du véhicule 2. L'algorithme de fusion établit également pour chaque nouvelle estimation de la position et de l'orientation du véhicule 2, une marge d'erreur sur cette estimation. Les algorithmes de fusion sont bien connus de l'homme du métier. Par exemple, le lecteur intéressé peut encore une fois se référer au livre de Groves précédemment cité. L'algorithme de fusion réalise la fusion des mesures des unités 10 et 12 pour obtenir des estimations de la position et de l'orientation du véhicule 2 plus précises qui si, par exemple, seules les mesures de l'unité 10 étaient utilisées pour déterminer la position et 9 seules les mesures de l'unité 12 étaient utilisées pour déterminer l'orientation du véhicule 2. Autrement dit, pour établir chacune des estimations de la position et de l'orientation du véhicule 2, le module 26 utilise les mesures à la fois de l'unité 10 et de l'unité 12. Par exemple, cet algorithme de fusion est implémenté sous la forme d'un filtre de Kal man. Comme indiqué dans l'introduction de la présente demande, il est nécessaire d'initialiser l'algorithme de fusion avec des estimations initiales de la position et de l'orientation du véhicule 2. Ces estimations initiales sont réalisées, par exemple, comme décrit dans le livre de Groves. Ici, l'estimation initiale de l'angle de lacet est obtenue à partir des mesures d'un magnétomètre. A cet effet, le système 6 comporte donc en plus un magnétomètre 30 raccordé au calculateur 20. Le magnétomètre 30 est un magnétomètre triaxe, c'est-à-dire qu'il comporte trois axes de mesure non colinéaires, fixes dans le repère 12,' Ici, ces trois axes de mesure sont parallèles, respectivement, aux trois axes x,' Yh et 74, du repère Rh. Chaque mesure du champ magnétique réalisée par ce magnétomètre 30 comprend trois composantes codant chacune l'amplitude et la direction de la projection orthogonale, sur un axe de mesure respectif, du champ magnétique qui traverse le magnétomètre 30 au moment où la mesure est réalisée. Le groupe formé par les trois composantes mesurées par le magnétomètre 30 est appelé par la suite « vecteur de mesure brute » et noté Dès sa fabrication ou dès son insertion dans le véhicule 2, les mesures du magnétomètre 30 peuvent être perturbées. Ainsi, même lors de sa première utilisation, il peut arriver que les mesures du magnétomètre 30 soient assez imprécises. Pour améliorer la précision des mesures fournies par le magnétomètre 30, notamment lors de sa première utilisation, la mémoire 24 comporte des valeurs 32 par défaut pour des coefficients d'échelle et de décalage utilisés pour corriger les composantes brutes du vecteur Bra'.. Ici, par exemple, ces valeurs par défaut ne sont jamais mises à jour au cours de l'utilisation du magnétomètre 30. La mémoire 24 comporte aussi des données pré-enregistrées utilisées pour corriger les composantes brutes du vecteur 13,14,' Ici, ces données pré-enregistrées sont des valeurs courantes 34 pour les coefficients d'échelle et de décalage. Contrairement aux valeurs 32 par défaut, les valeurs courantes 34 sont régulièrement mises à jour lors de l'utilisation du magnétomètre 30 de manière à les adapter en permanence au contexte dans lequel le magnétomètre 30 est utilisé. Ainsi, au cours de l'utilisation du magnétomètre 30, le vecteur Bras,. est de préférence corrigé à l'aide des valeurs courantes 34 plutôt qu'à l'aide des valeurs 32 par défaut. Le vecteur obtenu après la correction des composantes brutes du vecteur Braw est appelé « vecteur de mesure corrigé» et noté B. Les composantes du vecteur Bc sont appelées "composantes corrigées". Pour mettre à jour les valeurs courantes 34, la mémoire 24 comporte également les ins- tructions d'un module 36 de calibration du magnétomètre 30. La mémoire 24 comporte aussi un modèle préenregistré 38 du champ géomagnétique. Le modèle 38 associe à chaque position susceptible d'être occupée par le véhicule 2, les trois composantes du champ géomagnétique présent à cette position. Le groupe formé par les trois composantes du champ géomagnétique est appelé par la suite « vecteur de référence » et noté Bo. Chacune des composantes du vecteur Bo code l'amplitude et la direction de la projection orthogonale, sur un axe respectif du repère R du champ géomagnétique. Par exemple, le modèle 38 est le modèle connu sous l'acronyme IGRF (« International Gcomagnetic Reference Field »). L'utilisation du système 6 se décompose en périodes successives d'activité séparées les unes des autres par des périodes d'inactivité. Pendant les périodes d'inactivité, le système 6 n'est pas actif, c'est-à-dire qu'il ne détermine pas la position et l'orientation du véhicule 2. Typiquement, pendant les périodes d'inactivité, les unités 10 et 12 et le magnétomètre 30 ne réalisent aucune mesure et ne transmettent aucune mesure au calculateur 20. Le calculateur 20 n'exécute donc aucun traitement sur ces mesures. Ces périodes d'inactivité durent généralement plusieurs minutes ou plusieurs heures ou plusieurs jours. Par contre, pendant ces périodes d'inactivité, les valeurs courantes 34 des coefficients d'échelle et de décalage estimées lors d'une précédente période d'activité sont conservées dans la mémoire 24. A cet effet, la mémoire 24 est une mémoire non volatile. Par exemple, pendant les périodes d'inactivité, le système 6 est éteint ou en veille. A l'inverse, pendant chaque période d'activité, les unités 10 et 12 et le magnétomètre 30 délivrent des nouvelles mesures au calculateur 20 qui les traite pour déterminer la position et l'orientation du véhicule 2 en fonction de ces nouvelles mesures. Ces périodes d'activité s'enchaînent successivement les unes après les autres et sont chacune séparées l'une de l'autre par une période d'inactivité plus ou moins longue. La figure 2 représente une période 46 d'activité. La période 46 débute par une phase 48 d'initialisation du système 6. Cette phase 48 débute immédiatement après l'activation du système 6, c'est-à-dire typiquement juste après qu'il ait été mis sous tension. Au début de la phase 48, lors d'une opération 50, le calculateur 20 teste si la valeur d'un indicateur 'CF est supérieure ou égale à un. La valeur de cet indicateur In, est enregistrée dans la mémoire 24. Si la valeur de l'indicateur 'CF est inférieure à un, lors des opérations suivantes, les valeurs 32 par défaut des coefficients d'échelle et de décalage sont utilisées pour corriger le vecteur B r'.. A l'inverse, si la valeur de l'indicateur 'CF est supérieure ou égale à un, lors des opérations suivantes, ce sont les valeurs courantes 34 qui sont utilisées pour corriger le vecteur Braw. Lors de la première période d'activité du système 6, la valeur de l'indicateur 'CF est 11 nulle. Ensuite, le calculateur 20 réalise une estimation initiale de l'orientation du véhicule 2 ainsi que, éventuellement, une estimation d'autres paramètres. A titre d'exemple d'autres paramètres, le calculateur 20 peut estimer des coefficients d'échelle et de décalage pour d'autres capteurs du système 6 comme pour les capteurs 14 et 16. Par la suite, seul un exemple de mode de réalisation pour estimer l'orientation initiale du véhicule 2 est décrit. Lors d'une opération 52, le magnétomètre 30 mesure le champ magnétique qui le traverse et délivre un premier vecteur B', au calculateur 20. Ensuite, lors d'une opération 54, le calculateur 20 corrige le vecteur B' pour obtenir un premier vecteur corrigé B. Lors de cette opération, chaque composante du vecteur Bc est obtenue en multipliant la composante du vecteur Bra mesurée pour le même axe de mesure par le coefficient d'échelle associé à cet axe de mesure et en y ajoutant le coefficient de décalage associé au même axe de mesure. Un exemple de formule pour obtenir le vecteur Bc à partir du vecteur B' est donné par la suite par la relation 3). Le vecteur B. comme le vecteur B', est exprimé dans le repère Rh. Les valeurs des coefficients d'échelle et de décalage utilisées lors de cette opération 54 sont soit les valeurs par défaut 32, soit les valeurs courantes 34 selon le résultat du test réalisé lors de l'opération 50. Lors d'une opération 56, l'unité 10 mesure la position du véhicule 2 dans le repère RT. Lors de l'opération 56, pour cela, l'unité 10 fournit une estimation initiale de la position du véhicule 2 dans le repère RT, par exemple, sans utiliser les mesures de l'unité 12 et du magnétomètre 30. Ensuite, lors d'une opération 58, le vecteur Bo correspondant à la position initiale mesurée lors de l'opération 56 est obtenue en utilisant le modèle 38. On notera que lors de l'opération 56, il n'est pas nécessaire d'utiliser l'algorithme de fusion. En effet, étant donné que le champ géomagnétique varie assez lentement à la surface de la terre, à ce stade, une connaissance approximative de la position du véhicule 2 avec, par exemple, une marge d'erreur inférieure à 50 km ou 100 km ou 1000 km, est suffisante pour obtenir une estimation précise du vecteur Bo. Typiquement, la précision sur l'estimation de la position initiale par l'unité 10 est très inférieure à 50 km. Par exemple, elle est généralement inférieure à 50 m ou 10 m. Lors d'une opération 60, l'estimation initiale de l'angle de lacet est construite à partir du vecteur Bc obtenu à l'issue de l'opération 54. En effet, les vecteurs Bcet Bo correspondent au même champ géomagnétique mais exprimé dans, respectivement, les repères Rb et R. Il est donc possible de déterminer l'angle de lacet du véhicule 2 et donc du repère Rb par rapport au repère RT, à partir de l'angle que fait le vecteur Bc avec les axes du repère Rb. 12 Une fois la phase 48 d'initialisation terminée, une phase 70 d'utilisation du système 6 débute. Lors de la phase 70, le module 26 estime de façon répétée la position et l'orientation du véhicule 2 en réitérant, par exemple à intervalle régulier, l'exécution de l'algorithme de fusion. Cette phase 70 dure alors jusqu'à la fin de la période 46 d'activité et donc jusqu'au début d'une prochaine période 76 d'inactivité. Au début de la phase 70, lors d'une opération 72, l'algorithme de fusion est initialisé. L'initialisation de l'algorithme de fusion consiste notamment à charger des valeurs initiales pour la position et l'orientation du véhicule 2. Ces valeurs initiales servent comme point de départ à cet algorithme de fusion pour ensuite établir, avec plus de précision, cette position et cette orientation du véhicule 2. Les valeurs initiales chargées lors de l'opération 72 sont celles obtenues à l'issue de la phase 48 d'initial isation. En particulier, l'angle de lacet est initialisé à l'aide de la valeur obtenue à l'issue de l'opération 60. Ensuite, lors d'une opération 74, l'algorithme de fusion est exécuté de façon répétée par le module 26. Plus précisément, à chaque fois que des nouvelles mesures de l'unité 10 et/ou de l'unité 12 sont acquises par le calculateur 20, l'algorithme de fusion est exécuté pour mettre à jour l'estimation de la position et de l'orientation du véhicule 2. Plus précisément, à chaque exécution de l'algorithme de fusion, le module 26 établit : [0045] - des nouvelles estimations de la position et de l'orientation du véhicule 2, et [0046] - des marges d'erreur sur ces nouvelles estimations de la position et de l'orientation. Ces nouvelles estimations de la position et de l'orientation du véhicule 2 et les marges d'erreur correspondantes sont établies à partir des précédentes estimations de la position et de l'orientation du véhicule 2, des précédentes marges d'erreur établies et des nouvelles mesures des unités 10 et 12. Dans ce mode de réalisation, pendant l'opération 74, les mesures du magnétomètre 30 ne sont pas utilisées. La marge d'erreur ou la précision sur la nouvelle estimation de l'orientation est ici donnée par les valeurs de trois écart-types notés, respectivement, al' ou et oci,. Les écart-types aw, ac, et correspondent aux écart-types sur les estimations, respec- tivement, de l'angle de lacet W, de l'angle de tangage 0 et de l'angle de roulis p. Classiquement, le début de la phase d'utilisation est souvent appelé "phase d'alignement". Typiquement, la phase d'alignement commence avec le début de l'exécution de l'algorithme de fusion et se termine quand les précisions sur les estimations des angles de lacet W, de tangage 0 et de roulis p sont suffisantes. Les répétitions de l'opération 74 prennent fin uniquement quand la période 46 d'activité actuelle s'achève et que débute la nouvelle période 76 d'inactivité. Par exemple, la répétition des opérations 74 s'achève lorsque le système 6 est éteint. 111 est connu que la plus grande difficulté lors de la phase 50 est d'obtenir une es- timation précise de l'angle de lacet du véhicule 2. En effet, il existe déjà des al- 13 gorithmcs qui permettent d'obtenir rapidement une estimation initiale des angles de roulis et de tangage ainsi que des autres paramètres souhaités. Classiquement, l'estimation initiale des angles de roulis et de tangage est, par exemple, obtenue à partir des mesures de l'accéléromètre 14. Dans le système 6, pour obtenir une estimation initiale et fiable de l'angle de lacet, les opérations suivantes sont exécutées En parallèle de la phase 70, le module 36 exécute une phase 80 de calibration du magnétomètre 30. La phase 80 peut débuter des que le vecteur Bo a été obtenu et que le module 26 a établi une estimation de l'orientation du véhicule 2. La phase 80 a pour but d'améliorer la calibration du magnétomètre 30, c'est-à-dire d'améliorer les valeurs courantes 34 des coefficients d'échelle et de décalage pour que, lors de la prochaine exécution de l'opération 54, le vecteur 13c obtenu soit plus précis que si les valeurs 32 par défaut avaient été utilisées. En effet, même après sa fabrication et son installation dans le système 6, le magnétomètre 30 est souvent exposé à de nombreux événements extérieurs qui modifient temporairement ou définitivement son fonctionnement. Ainsi, au cours du temps, les valeurs 32 par défaut deviennent moins bonnes et il est possible de déterminer de nouvelles valeurs courantes qui permettent une meilleure correction du vecteur Br'' et donc l'obtention d'un vecteur 13c plus juste. Ici, la phase 80 débute par une étape 81 de mesure du champ magnétique par le magnétomètre 30 et d'acquisition du vecteur B. par le calculateur 20. Ensuite, lors des étapes suivantes, le vecteur B,', mentionné correspond au vecteur Br, mesuré et acquis lors de cette étape 81. Lors de cette étape 81, le module 36 acquière également l'estimation de l'orientation du véhicule 2 et la marge d'erreur sur cette estimation établie lors de l'itération la plus récente de l'opération 74. La phase 80 se poursuit par une étape 82 lors de laquelle différentes conditions sont testées afin de s'assurer que le système 6 se trouve bien dans une situation où la mise à jour des valeurs courantes 34 des coefficients d'échelle et de décalage permettra d'obtenir de nouvelles valeurs courantes qui, si elles étaient immédiatement utilisées lors d'une opération 54, permettraient d'obtenir une estimation initiale de l'angle de lacet plus précise : [0047] - que si les valeurs 32 par défaut étaient utilisées, et [0048] - que si les valeurs courantes 34 n'avaient pas été mises à jour. Dans ce mode de réalisation, à cet effet, quatre tests, appelés respectivement test 1), test 2), test 3) et test 4), sont réalisés lors de l'étape 82. Le test 1) consiste à vérifier que la précision sur l'estimation actuelle de l'orientation du véhicule 2 est suffisamment précise. En effet, les valeurs des angles de lacet, de tangage et de roulis estimés par l'algorithme de fusion sont utilisés lors de la mise à jour des coefficients d'échelle et de décalage. Dès lors, si la précision sur les estimations de ces angles n'est pas assez bonne, cela peut dégrader la calibration du ma- 14 gnétomètre 30 au lieu de l'améliorer. Or, l'algorithme de fusion peut mettre un certain temps avant de fournir une estimation fiable de l'orientation du véhicule 2. Ainsi, il est important d'attendre que l'orientation du véhicule 2 soit estimée avec suffisamment de précision avant de déterminer de nouvelles valeurs courantes 34 pour les coefficients d'échelle et de décalage. Ici, le test 1) est le suivant : 04, et -Off,/a,. Le vecteur d'état Xk est défini par la relation suivante : [0090] Relation 4) : Xk = [a' ay, a' Off' Off' OtT,]T, où : [0091] - les composantes a' ay, a,, Off' Off>, Off, sont les mêmes coefficients que ceux définis dans la relation 2), [0092] - le symbole « T » désigne l'opération transposée, [0093] - l'indice k est un numéro d'ordre. L'équation de propagation ou de prédiction de l'état du filtre de Kalman est définie par la relation suivante : [0094] Relation 5) : Xkfl k = Xk k + V, OÙ : [0095] -Xk k est l'estimation du vecteur d'état à l'instant k obtenue en prenant en compte toutes les mesures jusqu'à l'instant k, [0096] - XI, kl k est l'estimation du vecteur d'état à l'instant k+1 obtenue en prenant en compte seulement les mesures jusqu'à l'instant k, [0097] - y est le bruit du processus. La relation 5) s'explique par le fait que les coefficients d'échelle et de décalage sont supposés, en première approximation, comme étant constants au cours du temps. L'équation de propagation ou de prédiction de la matrice de covariance de l'erreur est définie par la relation suivante : [0098] Relation 6) : Pkkilk= PI, Ik+Qk,Où: [0099] -Pk k est l'estimation de la matrice de covariance de l'erreur à l'instant k obtenue en prenant en compte toutes les mesures jusqu'à l'instant k, [0100] - Pic+, k est l'estimation de la matrice de covariance à l'instant k+1 obtenue en prenant seulement en compte les mesures jusqu'à l'instant k, [0101] - Qk est la matrice de covariance du bruit de processus y. La matrice Qk est définie par la relation suivante : [0102] Relation 7) : [Math. 1] 0f! [0103] où : [0104] - o'a1,...2 est la variance du bruit de processus y dans l'estimation de chaque coefficient d'échelle, et [0105] - oot2 est la variance du bruit de processus y dans l'estimation de chaque coefficient de décalage. A titre d'illustration, les valeurs typiques des coefficients o1,2 et oof/ sont, respectivement, 10-8 et 10-6. En utilisant les notations précédemment introduites, le modèle du vecteur Blin,. est défini par la relation suivante : 101061 Relation 8): Br, = Hk ,Xk+ 1, OÙ : 101071 -q est le bruit sur la mesure, et 101081 - Hk est la matrice définie par la relation suivante : Qk = oes2ca 2 coït- 21 [0109] Relation 9) : [Math.2] 1 B C 0 1 0 0 BÉLz 0 0 1 [0110] où 130,,b, Boy'', Bo), sont les trois composantes du vecteur Bob exprimées dans le repère R, et obtenu à l'aide de la relation 1). On notera que les composants Bo', B0,0 sont fonctions des estimations des angles de lacet, de tangage et de roulis établis par l'algorithme de fusion. Ainsi, la matrice 1-1k est mise à jour à chaque nouvelle estimation de ces angles de lacet, de tangage et de roulis établie par l'algorithme de fusion. L'innovation YL, c'est-à-dire l'écart entre le vecteur B,' et l'estimation de cc vecteur obtenue à l'aide du vecteur BD, est donnée par la relation suivante : [0111] Relation 10) : = - Hk.Xk k 1. La covariance Sk de l'innovation est donnée par la relation suivante : [0112] Relation 11) : Sk= F1121, k 1.1-1k I Rk, où Rk est la matrice de covariance du bruit de mesure. La matrice Sk est une matrice diagonale de trois lignes et de trois colonnes. Les coef- ficients de sa diagonale sont notés ,y2et oy.,2et correspondent au carré des coef- ficients utilisés dans le test 3). La matrice Rk est définie par la relation suivante : [0113] Relation 12) : [Math.3] = O n_2 t'AIL igNot,e [0114] où 4.7,,,,'''2 est la variance du bruit de mesure du magnétomètre 30 et des per- turbations du champ magnétique mesuré. Typiquement. la valeur du coefficient G ma,t-Noise2 est choisie entre 1 iT et 10 pi. Par exemple, ici, ce coefficient est égal à 10 i.LT. Le gain de Kalman est défini par la relation suivante : [0115] Relation 13) : Kk = Pk k L'équation de mise à jour de l'estimation du vecteur d'état Xk est définie par la relation suivante : [0116] Relation 14) : Xk k= Xk k1+ L'équation de mise à jour de l'estimation de la matrice de covariance de l'erreur est définie par la relation suivante : [0117] Relation 15) : Piclk = (I - 1, I, où lest la matrice identité. Le procédé d'estimation des coefficients d'échelle et de décalage débute par une étape 100 d'initialisation de l'algorithme d'estimation. Lors de l'étape 100, si la valeur de l'indicateur In est égale à O. le vecteur d'état initial X, est défini par la relation suivante : [0118] Relation 16) : X0= [a,' ayo azo Off' Offyo Off,o]1, où : [0119] - les coefficients axo, ayo, aio sont 'égaux, respectivement, à 1/c,o, 1/0,0 et 1/c20,où e'o, c yo et e, sont les valeurs 32 par défaut des coefficients d'échelle associés, respectivement, aux axes xb, Yb et zb, [0120] - les coefficients Off,, Offyo, Off,0 sont égaux, respectivement, à -a,o.d, -ay'.dy et -a,0 où d, dy et d, sont les valeurs 32 par défaut des coefficients de décalage associés, respectivement, aux axes xb, Yb et zb. La matrice initiale P, de covariance de l'erreur est définie par la relation suivante : [0121] Relation 17) : [Math.4] [0122] où : [0123] - popethe est égale à la matrice Po, et [0124] - les coefficients aseee02 et cro,o2 définissent l'incertitude par défaut sur l'estimation, respectivement, des coefficients a' a, et a, et des coefficients Off' Off, et Off,. [0125] A titre d'illustration, les coefficients asemeoet Ooffo sont, respectivement, égaux à 0,1 et 100 uni Si lors de l'étape 100, la valeur de l'indicateur 'Cf est supérieure ou égale à un, le vecteur Xo et la matrice Po sont pris égaux, respectivement, au dernier vecteur Xk k et à la dernière matrice Pk k établis lors de la précédente période d'activité. Ensuite, pour chaque nouvelle mesure du magnétomètre 30 acquise par le calculateur 20, les opérations suivantes sont exécutées. Lors d'une opération 102, la matrice Puilk de covariance de l'erreur est estimée en utilisant la relation 6). Lors d'une opération 104, les coefficients de la matrice sont mis à jour en fonction de la dernière estimation de l'orientation du véhicule 2. Plus précisément, c'est la matrice de rotation Crib qui est mise à jour en fonction de cette dernière estimation de 23 l'orientation. Ensuite, les composantes B0b, Bo', et Be sont calculées en multipliant le vecteur Bo" par la matrice C'b mise à jour. Enfin, toujours lors de l'opération 104, l'innovation YI, et la matrice Sk de covariance de l'innovation sont calculées en utilisant, respectivement, les relations 10) et 1 1 ). De préférence, lors d'une opération 106, le test 3) est exécuté immédiatement après le calcul des nouveaux coefficients oy,2, Gy,y2et Gy; de la matrice Sk. Cela permet d'éviter d'exécuter inutilement l'opération suivante. Seulement si le test 3) est satisfait, alors, lors d'une opération 108, le gain KI' le vecteur Xk k et la matrice Pk k sont calculés en utilisant, respectivement, les relations 13), 14) et 15). A partir des composantes du vecteur Xk k, les nouvelles valeurs des coefficients d'échelle ex, e et ez et les nouvelles valeurs des coefficients de décalages dx, dy et d, sont mis à jour en utilisant les relations introduites en référence à la relation 3). Chapitre II : Variantes Variantes du champ B 0 : La position initiale pour obtenir le vecteur Bo au démarrage d'une nouvelle période d'activité peut être fournie par un autre système que l'unité 10 de géolocalisation par satellite. Par exemple, si le système 6 est habituellement immobile pendant les périodes d'inactivité, la position au démarrage de la nouvelle période d'activité est prise égale à la dernière position estimée lors de la précédente période d'activité. Dans un autre mode de réalisation et dans l'hypothèse où le système de localisation reste immobile entre deux périodes d'activité successives, le dernier vecteur Bo utilisé lors de la précédente période d'utilisation est mémorisé. Ensuite, au début de la période d'activité suivante, c'est ce vecteur Bo mémorisé lors de la précédente période d'activité qui est utilisé. Cela permet de ne pas avoir à mettre à jour le vecteur Bo à partir de la position mesurée par l'unité 10 tant que les déplacements du véhicule 2 au cours de la présente période d'activité restent faibles. Dans un mode de réalisation simplifié, quelle que soit la position du véhicule 2, la norme du vecteur Bo est considérée comme constante. Dans ce cas, le modèle 38 peut être simplifié en ne mémorisant que les données nécessaires pour déterminer la direction du vecteur Bo en fonction de la position et sans qu'il soit nécessaire de déterminer la norme de ce vecteur Bo. Les opérations 56 et 58 peuvent donc être omises. Dans le cas particulier où le véhicule comporte une masse métallique ou magnétique systématiquement immobile par rapport au système 6 et qui modifie la direction du champ géomagnétique qui traverse le magnétomètre 30, cette perturbation du champ géomagnétique peut être directement intégrée dans le modèle 38. Variantes de l'algorithme d'estimation des coefficients d'échelle et de décalage : D'autres choix sont possibles pour le vecteur d'état initial X0 lorsque l'indicateur Ici, est égal à zéro. Par exemple, en variante, le vecteur Xo est choisi égal à [III 00 OP. 24 Dans certains cas, la valeur du coefficient d'échelle d'un axe de mesure du magnétomètre 30 dépend aussi de façon non négligeable des composantes du champ magnétique mesurées sur d'autres axes de mesure. Dans ce cas, la matrice A n'est pas une matrice diagonale et les coefficients de la matrice A qui ne sont pas situés sur sa diagonale doivent également être estimés. Pour cela, le vecteur d'état Xi, est agrandi pour comporter les neufs coefficients de la matrice A et non pas seulement les trois coefficients a, a, et a, de la diagonale. Les différentes équations du filtre de Kalman linéaire doivent être adaptées en conséquence. En variante, le repère commun dans lequel le vecteur B1,,' est comparé au vecteur Bo est un autre repère que le repère Rb. Par exemple, le repère commun est le repère R,. Dans ce cas, l'orientation estimée du véhicule est utilisée pour construire une matrice de rotation qui permet de convertir les composantes du vecteur B', exprimées dans le repère Rb, en composantes exprimées dans le repère terrestre R1. L'algorithme d'estimation des coefficients d'échelle et de décalage doit alors être adapté pour tenir compte du fait que le repère commun est le repère RT et non pas le repère RB. Éventuellement, le repère commun peut aussi être un troisième repère différent des repères Rb et RT à partir du moment où il est possible de construire, à partir de l'orientation déterminée du véhicule 2, les matrices de rotation qui permettent d'exprimer les vecteurs B,'' et Bo dans ce repère commun. Ici, les coefficients d'échelle et de décalage sont établis de manière à minimiser l'écart entre le vecteur Bc et le vecteur Bob. Pour cela, l'algorithme d'estimation a été décrit dans le cas particulier où il s'agit d'un filtre de Kalman linéaire. Toutefois, tout autre algorithme d'estimation permettant de résoudre le même problème peut être utilisé. A titre d'exemple d'autres algorithmes d'estimation utilisables, on peut citer les algorithmes suivants : un filtre de Kalman étendu, un filtre particulaire, l'algorithme des moindres carrés récursifs connu sous l'acronyme RLS (« recursive least squares »), un estimateur de maximum de vraisemblance ou tout autre estimateur déterministe. Si les déplacements du véhicule 2 depuis la dernière exécution de l'opération 58 sont suffisamment petits pour pouvoir considérer qu'ils ne provoquent pas de changement significatif du vecteur Bo, alors tant que cette condition est vérifiée, le vecteur Bo n'est pas recalculé pendant l'exécution de la phase 80 de calibration. A l'inverse, si les déplacements mesurés du véhicule 2 sont suffisamment importants pour correspondre à un changement significatif du vecteur Bo, alors, au cours de la phase 80, l'opération 58 est de nouveau exécuté en prenant cette fois-ci en compte la position actuellement estimée par le module 26. Variante des différents tests décrits : D'autres modes de réalisation du test 1) sont possibles. Par exemple, lorsqu'un véhicule se déplace systématiquement horizontalement, seule la précision sur la mesure de l'angle de lacet est testée et dès que celle-ci est suffisante, la calibration du magnétomètre 30 est mise à jour sans prendre en compte la précision sur la mesure des angles de roulis et de tangage. Ainsi, en variante, le test 1) est remplacé par un test où seul l'écart-type at est comparé au seuil SI. Dans une autre variante, les écart-types cr.,', cro et op sont chacun comparés à des seuils prédéterminés différents. Le test 1) peut être modifié pour utiliser, non pas les écart-types G4.,, 00 Ct o,, mais les variances sur les estimations des angles de lacet, de tangage et de roulis. En variante, une valeur strictement supérieure à zéro est affectée à l'indicateur IQ: uniquement si toutes les conditions 6.1 à 6.6 sont vérifiées. Cette variante est notamment utile pour des véhicules susceptibles de présenter une forte inclinaison par rapport à la verticale dès le démarrage du système 6. En effet, dans ce cas, l'angle de lacet dépend également fortement de la précision de la mesure du magnétomètre le long de l'axe de mesure zb. Par exemple, cette variante est utile lorsque le véhicule est un missile sur une rampe de lancement. L'étape 82 peut comporter plus ou moins de tests. Par exemple, dans un mode de réalisation très simplifié, seul le test 1) est mis en oeuvre lors de l'étape 82. Dans un autre mode de réalisation, des tests supplémentaires sont mis en oeuvre lors de l'étape 82. Par exemple, un test sur la précision de l'estimation de la position du véhicule 2 est mis en oeuvre afin de déclencher la cal ibration du magnétomètre 30 uniquement si la position est connue avec une précision suffisante. Il est aussi possible d'ajouter un test qui vérifie que la norme du vecteur 13,'', est supérieure à un seuil prédéterminé de manière à inhiber la mise à jour des valeurs courantes 34 en présence d'un champ géomagnétique trop faible. Une telle situation peut se rencontrer, par exemple, en présence d'un perturbateur qui génère un champ d'une intensité sensiblement égale aux champ géomagnétique mais dans une direction opposée. D'autres modes de réalisation du test 5) sont également possibles. Par exemple, le test 5) est modifié pour vérifier en plus que les nouvelles estimations des valeurs des coefficients de décalage sont situées à l'intérieur de plages possibles prédéterminées de valeurs. Dans un autre mode de réalisation simplifié, le test 5) est omis Dans ce cas-là, les valeurs des coefficients d'échelle et de décalage ne sont pas bornées. Dans un autre mode de réalisation, lorsque le test 5) n'est pas vérifié, au lieu de borner les nouvelles estimations des valeurs du coefficient d'échelle, celles-ci ne sont pas modifiées mais la valeur de l'indicateur 'CF est prise égale à zéro. D'autres modes de réalisation du test 6) sont possibles. Par exemple, si une précision suffisante sur les coefficients a' et a, garantie déjà à elle seule une estimation suffisamment précise de l'angle de lacet, alors le test 6) peut être simplifié. Par exemple, le test 6) ne comporte plus que les conditions 6.1 et 6.2. 26 En variante, l'étape 86 de vérification de la qualité de la calibration est omise. Dans cc cas, la valeur de l'indicateur kr est systématiquement prise égale à deux après l'exécution de l'étape 84. Autres variantes : Le système 6 décrit ici peut être utilisé dans d'autres véhicules comme un sous-marin. De façon générale, on désigne ici par "véhicule" tout objet susceptible de se déplacer et équipé d'un système 6 fixé sur cet objet pour déterminer sa position et son orientation. Par exemple, le véhicule peut être un missile, une fusée, un smartphone, un ordinateur portable ou similaire. Le magnétomètre 30 peut être intégré dans l'unité 12 de navigation inertielle. Il peut aussi se présenter comme un composant indépendant de l'unité 12 et fixé mécaniquement à l'unité 12 et à l'unité 10 de géolocalisation par satellite. Le système 6 peut comporter des capteurs supplémentaires pour améliorer encore plus la précision avec laquelle la position et l'orientation du véhicule sont déterminées. Par exemple, le système 6 peut comporter : [0126] - un capteur de pression afin d'améliorer la détermination de l'altitude du véhicule, et/ ou [0127] - un odomètre, tel qu'un podomètre, qui mesure la distance parcourue par le véhicule 2 entre deux instants successifs. D'autres modes de réalisation du magnétomètre 30 sont possibles. Par exemple, dans le cas d'un véhicule 2 se déplaçant uniquement horizontalement, le magnétomètre 30 peut être remplacé par un magnétomètre biaxe, c'est-à-dire un magnétomètre comportant seulement deux axes horizontaux de mesure. Dans d'autres modes de réalisation, le magnétomètre 30 est remplacé par un magnétomètre comportant plus de trois axes de mesure non colinéaires. Dans ce dernier cas, une partie des mesures sont redondantes, ce qui peut être exploité pour augmenter la précision de la mesure. Lors de l'étape 56, l'estimation initiale de la position du véhicule peut être réalisée différemment. Par exemple, cette estimation initiale est réalisée en prenant en compte, en plus ou à la place des mesures de l'unité 10, les mesures d'autres capteurs embarqués dans le véhicule ou les mesures de l'unité 12 et/ou du magnétomètre 30. De nombreux modes de réalisation différents de l'algorithme de fusion existent. Par exemple, dans un mode de réalisation particulier, les nouvelles mesures du magnétomètre 30 sont aussi prises en compte pour établir chaque nouvelle estimation de la position et de l'orientation du véhicule 2. Si le système 6 comporte d'autres capteurs comme un capteur de pression ou un odomètre, alors l'algorithme de fusion est également modifié pour prendre en plus en compte les mesures de ces autres capteurs. En variante, les données pré-enregistrées dans la mémoire 24 entre deux périodes d'activités successives sont seulement les valeurs des coefficients a' ay, a' Off' 014 et 27 Off. Dans ce cas, lors de l'opération 54, les valeurs courantes des coefficients d'échelle et de décalage sont d'abord calculées à partir des coefficients ay, ay, a', Off, Off, et Off, pré-enregistrés dans la mémoire 24. La caractéristique selon laquelle la mise à jour des coefficients d'échelle et de décalage du magnétomètre 30 est réalisée uniquement si aucun perturbateur magnétique n'est détecté à proximité du magnétomètre peut être mise en oeuvre indépendamment du test 1). Par exemple, dans un autre mode de réalisation, lors de l'étape 82, le test 2) ou 3) est mis en oeuvre et le test 1) est omis. Chapitre 111 : Avantages des modes de réalisation décrits Le fait de déclencher la mise à jour des valeurs courantes 34 des coefficients d'échelle et de décalage uniquement lorsque la marge d'erreur sur l'estimation de l'orientation du véhicule 2 est inférieure au seuil Sh permet d'éviter que la calibration du magnétomètre 30 soit dégradée à cause d'erreurs trop importantes sur cette estimation de l'orientation du véhicule 2. La fiabilité de la calibration du magnétomètre 30 est donc améliorée. Il résulte de cette amélioration que l'estimation initiale de l'angle de lacet au début d'une période d'activité suivante est meilleure, cc qui accélère par la suite la convergence de l'algorithme de fusion vers des estimations plus précises de la position et de l'orientation du véhicule 2. De plus, dans le mode de réalisation décrit, la mise à jour des coefficients d'échelle et de décalage est simple à mettre en oeuvre. En particulier, elle peut être mise en oeuvre lorsque le véhicule 2 se déplace et ne nécessite pas d'imposer que le véhicule 2 se déplace ou réalise des déplacements prédéterminés à l'avance. Le fait d'autoriser la mise à jour des coefficients d'échelle et de décalage uniquement lorsque le test 3) est vérifié, permet d'éviter de réaliser une telle mise à jour en présence d'un perturbateur magnétique. Cela contribue à augmenter la fiabilité de la calibration du magnétomètre dès le démarrage d'une période d'activité suivante. Le fait de tenir compte de l'écart-type dans le test 3) permet d'adapter automatiquement ce test 3) pour que le seuil SI ne soit pas dépassé en présence seulement d'un bruit habituel sur la mesure du magnétomètre 30. Cela contribue à améliorer la fiabilité de la détection d'un perturbateur à proximité du magnétomètre 30 et donc la fiabilité de la calibration du magnétomètre. Le test 4) permet d'éviter l'exécution inutile de l'opération 84. De plus, cela réduit le risque que les coefficients d'échelle et de décalage, déterminés dans une situation où l'angle de lacet ne varie pas, puissent diverger et dégrader la calibration du magnétomètre 30. Le fait de calculer le vecteur Bo en fonction de la position estimée du véhicule permet de prendre en compte le fait que la norme du champ géomagnétique terrestre n'est pas parfaitement uniforme en tout point de la terre. Cela améliorer la précision de la ca- 28 libration du magnétomètre 30 et donc la rapidité avec laquelle l'algorithme de fusion converge vers une estimation plus précise de la position et de l'orientation du véhicule 2. Le fait de calculer une marge d'erreur sur l'estimation d'au moins un des coefficients d'échelle et de décalage et d'inhiber l'utilisation de cette nouvelle estimation des coefficients d'échelle et de décalage tant que cette marge d'erreur est trop importante, permet d'éviter d'utiliser des coefficients d'échelle et de décalage trop imprécis pour garantir une estimation fiable de l'angle de lacet. 29 [Revendication I] REVENDICATIONSProcédé dc détermination de la position et de l'orientation d'un véhicule, ce procédé comportant : - la fourniture d'un système de localisation fixé sur ce véhicule, ce système de localisation comportant : une unité de géolocalisation par satellite, une unité de navigation inertielle contenant un accéléromètre et un gyromètre, et un magnétomètre comportant au moins deux axes de mesure, - la mesure (52), par le magnétomètre, d'un premier vecteur de mesures brutes contenant une composante brute pour chacun des axes de mesure, chaque composante codant l'amplitude et la direction de la projection orthogonale du champ magnétique qui traverse cc magnétomètre sur un axe respectif de mesure, ces axes de mesure étant fixes dans un repère mobile tri-axe fixé sur le véhicule, puis - la correction (54) de chacune des composantes brutes du premier vecteur en la multipliant par un coefficient d'échelle et en y ajoutant un coefficient de décalage pour obtenir une composante corrigée, ces coefficients d'échelle et de décalage étant obtenus à partir de données préenregistrées dans une mémoire du système de localisation, puis - une estimation initiale (60) de de lacet du véhicule à partir des composantes corrigées du premier vecteur, puis - l'initialisation (72), à l'aide de l'estimation initiale de l'angle de lacet, d'un algorithme de fusion apte à établir, à partir de précédentes estimations de la position et de l'orientation du véhicule et en utilisant à la fois les mesures de l'unité de géolocalisation et les mesures de l'unité de navigation inertielle réalisées depuis ces précédentes estimations : de nouvelles estimations de la position et de l'orientation du véhicule, et une marge d'erreur sur cette nouvelle estimation de l'orientation du véhicule, puis - l'exécution répétée (74), pendant toute une phase d'utilisation, de cet algorithme de fusion pour mettre à jour en continu l'estimation de la position et de l'orientation du véhicule, 30 [Revendication 2] [Revendication 3] [Revendication 4] caractérisé en ce que, après le début de l'exécution répétée de l'algorithme de fusion, le procédé comporte une phase (80) de calibration comportant les opérations suivantes : 1) la mesure (81), par le magnétomètre, d'un deuxième vecteur de mesures brutes, 2) l'obtention (58) d'un vecteur de référence comportant une composante pour chaque axe de mesure, chacune de ces composantes codant l'amplitude et la direction de la projection orthogonale du champ géomagnétique qui traverse le magnétomètre sur un axe respectif d'un repère terrestre tri-axe fixé sans aucun degré de liberté à la terre, les composantes du vecteur de référence étant obtenues à partir d'un modèle pré-enregistré du champ géomagnétique et non pas mesurées par le magnétomètre, puis 3) uniquement lorsque la marge d'erreur sur l'estimation de l'orientation du véhicule tombe en dessous d'un premier seuil prédéterminé, la mise à jour (84) des données pré-enregistrées à partir desquelles les coefficients d'échelle et de décalage sont obtenus, cette mise à jour étant réalisée à partir du deuxième vecteur brute, du vecteur de référence et de la nouvelle estimation de l'orientation du véhicule de manière à réduire l'écart entre les composantes corrigées du deuxième vecteur de mesure et les composantes du vecteur de référence lorsque toutes ces composantes sont exprimées dans un repère commun. Procédé selon la revendication 1, dans lequel la phase de calibration comporte : - le calcul (104) d'un écart entre les composantes brutes du deuxième vecteur de mesure et une estimation de ces composantes obtenus à partir du vecteur de référence et de l'estimation de l'orientation du véhicule, puis - la comparaison (82) de l'écart calculé à un deuxième seuil prédéterminé, puis - lorsque l'écart calculé dépasse ce deuxième seuil, l'opération 3) est inhibée et, lorsque l'écart calculé ne dépasse pas ce deuxième seuil, l'opération 3) est autorisée. Procédé selon la revendication 1 ou 2, dans lequel la phase de calibration comporte le calcul (104) de l'écart-type de l'écart calculé et la comparaison (82) de l'écart calculé, pondéré en fonction de cette écart-type calculé, au deuxième seuil. Procédé selon l'une quelconque des revendications précédentes, dans 31 [Revendication 5] [Revendication 6] lequel la phase de calibration comporte : - le calcul d'un écart d'orientation entre l'orientation du véhicule lors dune précédente exécution de la phase de calibration et l'orientation du véhicule lors de la présente exécution de la phase de calibration, puis - la comparaison (82) de l'écart d'orientation calculé à un troisième seuil prédéterminé, puis - lorsque l'écart d'orientation calculé ne dépasse pas ce troisième seuil, l'opération 3) est inhibée et, lorsque l'écart d'orientation calculé dépasse ce troisième seuil, l'opération 3) est autorisée. Procédé selon l'une quelconque des revendications précédentes, dans lequel l'obtention (58) du vecteur de référence comporte le calcul des composantes du vecteur de référence à partir : - de l'estimation de la position du véhicule, et - d'un modèle pré-enregistrée du champ géomagnétique qui associe, à chaque position possible du véhicule, les composantes du champ géomagnétique à cette position dans le repère terrestre, ce modèle intégrant à cet effet des variations locales du champ géomagnétique. Procédé selon l'une quelconque des revendications précédentes, dans lequel la phase de calibration comporte : - l'établissement (84) de nouvelles valeurs pour les données préenregistrées à partir desquelles les coefficients d'échelle et de décalage sont obtenus, ces nouvelles valeurs étant calculées à partir des composantes brutes du deuxième vecteur de mesure, du vecteur de référence et de l'orientation estimée du véhicule, et l'établissement de ces nouvelles valeurs pour les données pré-enregistrées comportant également le calcul (102) d'au moins une marge d'erreur sur une de ces nouvelles valeurs calculées, puis - la comparaison (86) de cette marge d'erreur calculée à un quatrième seuil prédéterminé, puis - lorsque la marge d'erreur calculée dépasse ce quatrième seuil, l'utilisation des nouvelles valeurs calculées pour calculer des coefficients d'échelle et de décalage est inhibée et, lorsque la marge (l'erreur calculée ne dépasse pas ce quatrième seuil : l'opération 3) est autorisée et les données pré-enregistrées mises à jour sont prises égales aux nouvelles valeurs calculées, et l'utilisation des nouvelles valeurs calculées pour calculer des 31 coefficients d'échelle et de décalage est autorisée. [Revendication 7] [Revendication 8] [Revendication 9] Procédé selon l'une quelconque des revendications précédentes, dans lequel la phase de calibration comporte : - l'établissement (104), à partir de l'estimation de l'orientation du véhicule, des composantes d'une matrice de rotation qui permet de réaliser un changement de repère depuis le repère terrestre vers le repère mobile, - la multiplication (104) du vecteur de référence par la matrice de rotation pour obtenir le vecteur de référence dont les composantes sont exprimées dans le repère mobile, ce repère mobile formant alors le repère commun. Procédé selon l'une quelconque des revendications précédentes, dans lequel la phase de calibration comporte : - la comparaison (82) de la marge d'erreur sur l'estimation de l'orientation au premier seuil, puis - lorsque la marge d'erreur sur l'estimation de l'orientation dépasse ce premier seuil, l'opération 3) est inhibée et, lorsque la marge d'erreur sur l'estimation de l'orientation ne dépasse pas ce premier seuil, l'opération 3) est autorisée. Procédé de calibration d'un magnétomètre pour la réalisation de la phase de calibration d'un procédé conforme à l'une quelconque des revendications précédentes, ce procédé de calibration comportant les opérations suivantes : 1) la mesure (81), par le magnétomètre, du deuxième vecteur de mesures brutes, 2) l'obtention (58) d'un vecteur de référence comportant une composante pour chaque axe de mesure, chacune de ces composantes codant l'amplitude et la direction de la projection orthogonale du champ géomagnétique qui traverse le magnétomètre sur un axe respectif d'un repère terrestre tri-axe fixé sans aucun degré de liberté à la terre, les composantes du vecteur de référence étant obtenues à partir d'un modèle pré-enregistré du champ géomagnétique et non pas mesurées par le magnétomètre, puis 3) la mise à jour (84) des données pré-enregistrées à partir desquelles les coefficients d'échelle et de décalage sont obtenus, cette mise à jour étant réalisée à partir du deuxième vecteur brute, du vecteur de référence et de 33 [Revendication 10] [Revendication 11] la nouvelle estimation de l'orientation du véhicule de manière à réduire l'écart entre les composantes corrigées du deuxième vecteur de mesure et les composantes du vecteur de référence lorsque toutes ces composantes sont exprimées dans un repère commun, caractérisé en ce que : - le procédé de cal ibration comporte l'acquisition d'une marge d'erreur sur l'estimation de l'orientation du véhicule sur lequel est fixé le magnétomètre, puis - l'opération 3) est exécutée uniquement lorsque cette marge d'erreur sur l'estimation de l'orientation du véhicule tombe en dessous d'un premier seuil prédéterminé. Support (24) d'enregistrement d'informations, lisible par un microprocesseur, caractérisé en ce que ce support comporte des instructions pour la réalisation d'un procédé de cal ibration d'un magnétomètre conforme à la revendication 9, lorsque ces instructions sont exécutées par le microprocesseur. Système (6) de localisation, apte à être fixé sur un véhicule, pour déterminer la position et l'orientation de cc véhicule, ce système de localisation comportant : - une unité (10) de géolocalisation par satellite, - une unité (12) de navigation inertielle contenant un accéléromètre (14) et un gyromètre (16), et - un magnétomètre (30) comportant au moins deux axes de mesure, ce système de localisation étant configuré pour : - mesurer, à l'aide du magnétomètre (30), un premier vecteur de mesures brutes contenant une composante brute pour chacun des axes de mesure, chaque composante codant l'amplitude et la direction de la projection orthogonale du champ magnétique qui traverse ce magnétomètre sur un axe respectif de mesure, ces axes de mesure étant fixes dans un repère mobile tri-axe fixé sur le véhicule, puis - corriger chacune des composantes brutes du premier vecteur en la multipliant par un coefficient d'échelle et en y ajoutant un coefficient de décalage pour obtenir une composante corrigée, ces coefficients d'échelle et de décalage étant obtenus à partir de données préenregistrées dans une mémoire du système de localisation, puis - construire une estimation initiale de l'angle de lacet du véhicule à partir des composantes corrigées du premier vecteur, puis - initialiser, à l'aide de l'estimation initiale de l'angle de lacet, un al- 34 gorithme de fusion apte à établir, à partir de précédentes estimations de la position et de l'orientation du véhicule et en utilisant à la fois les mesures de l'unité de géolocalisation et les mesures de l'unité de navigation inertielle réalisées depuis ces précédentes estimations : de nouvelles estimations de la position et de l'orientation du véhicule, et une marge d'erreur sur cette nouvelle estimation de l'orientation du véhicule, puis [Revendication 12] - exécuter de façon répétée (74), pendant toute une phase d'utilisation, cet algorithme de fusion pour mettre à jour en continu l'estimation de la position et de l'orientation du véhicule, caractérisé en ce que le système comporte un module (36) de calibration apte, après le début de l'exécution répétée de l'algorithme de fusion, à exécuter les opérations suivantes : 1) l'acquisition de la mesure, par le magnétomètre, d'un deuxième vecteur de mesures brutes, 2) l'obtention d'un vecteur de référence comportant une composante pour chaque axe de mesure, chacune de ces composantes codant l'amplitude et la direction de la projection orthogonale du champ géomagnétique qui traverse le magnétomètre sur un axe respectif d'un repère terrestre tri-axe fixé sans aucun degré de liberté à la terre, les composantes du vecteur de référence étant obtenues à partir d'un modèle pré-enregistré du champ géomagnétique et non pas mesurées par le magnétomètre, puis 3) uniquement lorsque la marge d'erreur sur l'estimation de l'orientation du véhicule tombe en dessous d'un premier seuil prédéterminé, la mise à jour des données pré-enregistrées à partir desquelles les coefficients d'échelle et de décalage sont obtenus, cette mise à jour étant réalisée à partir du deuxième vecteur brute, du vecteur de référence et de la nouvelle estimation de l'orientation du véhicule de manière à réduire l'écart entre les composantes corrigées du deuxième vecteur de mesure et les composantes du vecteur de référence lorsque toutes ces composantes sont exprimées dans un repère commun. Module (36) de calibration d'un magnétomètre comportant au moins deux axes de mesure pour la réalisation d'un système conforme à la revendication 11, ce module de calibration étant configuré pour réaliser 35 les opérations suivantes : 1) l'acquisition de la mesure, par le magnétomètre. du deuxième vecteur de mesures brutes, 2) l'obtention d'un vecteur de référence comportant une composante pour chaque axe de mesure, chacune de ces composantes codant l'amplitude et la direction de la projection orthogonale du champ géomagnétique qui traverse le magnétomètre sur un axe respectif d'un repère terrestre tri-axe fixé sans aucun degré de liberté à la terre, les composantes du vecteur de référence étant obtenues à partir d'un modèle pré-enregistré du champ géomagnétique et non pas mesurées par le magnétomètre, puis 3) la mise à jour des données pré-enregistrées à partir desquelles les coefficients d'échelle et de décalage sont obtenus, cette mise à jour étant réalisée à partir du deuxième vecteur brute, du vecteur de référence et de la nouvelle estimation de l'orientation du véhicule de manière à réduire l'écart entre les composantes corrigées du deuxième vecteur de mesure et les composantes du vecteur de référence lorsque toutes ces composantes sont exprimées dans un repère commun, caractérisé en ce que le module (36) de cal ibration est configure : - pour acquérir (81) une marge d'erreur sur l'estimation de l'orientation du véhicule sur lequel est fixé le magnétomètre, et - pour exécuter l'opération 3) uniquement lorsque cette marge d'erreur sur l'estimation de l'orientation du véhicule tombe en dessous d'un premier seuil prédéterminé.