FR 3067138 A1 20181207 FR 1754806 A 20170531 1 PROCEDE D'ESTIMATION DE LA POSITION D'UN AIMANT COMPORTANT UNE PHASE D'IDENTIFICATION D'UN PERTURBATEUR MAGNETIQUE DOMAINE TECHNIQUE [1] L'invention porte sur un procédé d'estimation de la position d'un aimant par rapport à un réseau de magnétomètres comportant une phase d'identification d'un perturbateur magnétique situé au voisinage du réseau de magnétomètres. ÉTAT DE LA TECHNIQUE ANTÉRIEURE [2] Il est connu d'utiliser au moins un aimant dans le cadre d'un système de relevé de la trace d'un crayon magnétique sur un support d'écriture. L'aimant est ici un objet auquel est associé un moment magnétique non nul, par exemple un aimant permanent fixé à un crayon non magnétique. [3] A titre d'exemple, le document W020 14/ 0 53526 décrit un système de relevé de la trace d'un crayon auquel est fixé un aimant annulaire. L'aimant permanent comporte un matériau magnétique, par exemple ferromagnétique ou ferrimagnétique, uniformément réparti autour d'un axe mécanique qui coïncide avec l'axe longitudinal du crayon. [4] Le relevé de la trace du crayon est assuré par un dispositif de suivi de l'aimant qui comporte un réseau de magnétomètres, chaque magnétomètre étant apte à mesurer le champ magnétique. Un procédé de suivi de l'aimant estime la position de l'aimant à chaque instant de mesure à l'aide d'un estimateur récursif de type filtre de Kalman. [005] Cependant, un perturbateur magnétique peut se situer au voisinage du dispositif de suivi de l'aimant. Il est alors susceptible de provoquer une dégradation du suivi de l'aimant. EXPOSÉ DE L'INVENTION [006] L'invention a pour objectif de remédier au moins en partie aux inconvénients de l'art antérieur, et plus particulièrement de proposer un procédé d'estimation d'une position de l'aimant, celui-ci étant destiné à être déplacé par rapport à un réseau de magnétomètres, comportant une phase d'identification d'un perturbateur magnétique. L'objet de l'invention est un procédé d'estimation de la position de l'aimant par un dispositif de suivi comportant un réseau de magnétomètres aptes à mesurer un champ magnétique, comportant les phases suivantes : 3067138 2 o détermination d'un vecteur d'état dit initial associé à l'aimant, pour un instant de mesure initial, le vecteur d'état comportant des variables représentatives de la position de l'aimant par rapport au réseau de magnétomètres ; o mesure par le réseau de magnétomètres d'un champ magnétique dit utile, à un instant 5 de mesure, en présence de l'aimant ; o estimation d'un champ magnétique généré par l'aimant, en fonction du vecteur d'état obtenu à un instant de mesure précédent, sur la base d'un modèle prédéterminé exprimant une relation entre le champ magnétique généré par l'aimant et le vecteur d'état de l'aimant ; 10 o calcul d'un biais par différence entre ledit champ magnétique estimé et ledit champ magnétique utile mesuré ; o mise à jour du vecteur d'état en fonction du biais calculé, permettant ainsi d'obtenir une position estimée de l'aimant à l'instant de mesure ; o réitération des phases de mesure, d'estimation, de calcul du biais et de mise à jour, sur 15 la base du vecteur d'état mis à jour, en incrémentant l'instant de mesure. [007] Selon l'invention, le procédé comprend en outre la phase suivante : o identification, à au moins un instant de mesure, d'un perturbateur magnétique distinct de l'aimant et situé au voisinage du réseau de magnétomètres, comportant les étapes suivantes : 20 - calcul d'un paramètre dit indicateur à partir d'un paramètre d'écart défini en fonction d'une différence entre un champ magnétique dit estimé généré par l'aimant pour le vecteur d'état obtenu à l'instant de mesure précédent ou le vecteur d'état mis à jour, sur la base dudit modèle prédéterminé, et ledit champ magnétique utile mesuré à l'instant de mesure ; 25 - comparaison de l'indicateur à une valeur seuil prédéterminée, et identification du perturbateur magnétique lorsqu'au moins l'une des valeurs de l'indicateur est supérieure ou égale à la valeur seuil. [8] La phase d'identification peut être effectuée à chaque instant de mesure ou pour quelques-uns des instants de mesure. L'instant de mesure précédent peut être l'instant de 30 mesure à l'incrément précédent ou, pour le premier incrément de temps, à l'instant de mesure initial. [9] Certains aspects préférés mais non limitatifs de ce procédé sont les suivants. [0010] L'indicateur peut être égal au rapport du paramètre d'écart sur un terme dénominateur comportant au moins le champ magnétique estimé de l'indicateur, le champ magnétique utile mesuré de l'indicateur, ou au moins une constante prédéterminée représentative d'un biais d'au moins l'un desdits magnétomètres. 3067138 3 [0011] Le terme dénominateur peut comporter le champ magnétique estimé dudit l'indicateur et ladite constante prédéterminée. [0012] Les phases d'estimation, de calcul du biais et de mise à jour peuvent être effectuées par un algorithme d'estimation récursive bayésienne. 5 [0013] La phase d'estimation peut comporter : - une étape d'obtention d'un vecteur d'état dit prédit à l'instant de mesure en fonction d'un vecteur d'état obtenu à un instant de mesure précédent, et - une étape de calcul du champ magnétique estimé pour le vecteur d'état prédit, et la phase de calcul du biais peut comporter : 10 - une étape de calcul du biais, dit innovation, comme différence entre le champ magnétique estimé pour le vecteur d'état prédit et ledit champ magnétique utile mesuré. [0014] Le paramètre d'écart peut être égal à l'innovation. [0015] Le paramètre d'écart peut être égal à la différence entre un champ magnétique 15 estimé généré par l'aimant pour le vecteur d'état mis à jour, et ledit champ magnétique utile mesuré à l'instant de mesure. [0016] Les phases d'estimation, de calcul du biais et de mis à jour peuvent être effectuées par un algorithme d'optimisation par minimisation itérative du biais, dit fonction de coût, à l'instant de mesure. 20 [0017] Le vecteur d'état peut comporter en outre des variables représentatives d'un moment magnétique de l'aimant. [0018] La phase d'identification du perturbateur magnétique peut comporter une étape d'émission d'un signal à l'utilisateur invitant à écarter le perturbateur magnétique vis-à-vis du réseau de magnétomètres, tant qu'au moins l'une des valeurs de l'indicateur est 25 supérieure ou égale à la valeur seuil prédéterminée. [0019] L'invention porte également sur un support d'enregistrement d'informations, comportant des instructions pour la mise en oeuvre du procédé selon l'une quelconque des caractéristiques précédentes, ces instructions étant aptes à être exécutées par un processeur. 30 BRÈVE DESCRIPTION DES DESSINS [0020] D'autres aspects, buts, avantages et caractéristiques de l'invention apparaîtront mieux à la lecture de la description détaillée suivante de formes de réalisation préférées de 3067138 4 celle-ci, donnée à titre d'exemple non limitatif, et faite en référence aux dessins annexés sur lesquels : la figure 1 est une vue schématique en perspective d'un dispositif de suivi d'un aimant comportant un réseau de magnétomètres selon un mode de réalisation, au voisinage duquel 5 est situé un perturbateur magnétique ; la figure 2 est un organigramme d'un exemple de procédé d'estimation d'une position de l'aimant ; la figure 3 est un organigramme d'un procédé d'estimation d'une position de l'aimant selon un premier mode de réalisation dans lequel l'estimateur est un filtre bayésien, comportant 10 une phase d'identification du perturbateur magnétique ; la figure 4 est un organigramme illustrant un exemple de phase d'identification du perturbateur magnétique ; les figures 5A et 5B sont des vues schématiques en coupe (fig.5A) et de dessus (fig.5B) d'un réseau de magnétomètres au voisinage duquel est situé un perturbateur magnétique 15 les figures 6A et 6B illustrent respectivement une partie d'un organigramme d'un procédé d'estimation d'une position de l'aimant selon une variante du premier mode de réalisation, et la phase d'identification du perturbateur magnétique ; les figures 7 et 8 illustrent respectivement un organigramme d'un procédé d'estimation d'une position de l'aimant selon un deuxième mode de réalisation dans lequel l'estimateur 20 est un algorithme d'optimisation par minimisation d'une fonction de coût, et la phase d'identification du perturbateur magnétique. EXPOSÉ DÉTAILLÉ DE MODES DE RÉALISATION PARTICULIERS [0021] Sur les figures et dans la suite de la description, les mêmes références représentent 25 les éléments identiques ou similaires. De plus, les différents éléments ne sont pas représentés à l'échelle de manière à privilégier la clarté des figures. Par ailleurs, les différents modes de réalisation et variantes ne sont pas exclusifs les uns des autres et peuvent être combinés entre eux. Sauf indication contraire, les termes « sensiblement », « environ », « de l'ordre de » signifient à 10% près. 30 [0022] L'invention porte sur un procédé d'estimation de la position d'un aimant par rapport à un réseau de magnétomètres d'un dispositif de suivi d'aimant, comportant une phase 3067138 5 d'identification d'un perturbateur magnétique situé au voisinage du réseau de magnétomètres. [0023] L'aimant comporte un matériau présentant une aimantation, par exemple rémanente, pour lequel on définit un moment magnétique. L'aimant peut être un aimant 5 permanent cylindrique, par exemple annulaire, tel qu'illustré dans le document W02014/053526 cité précédemment. Il peut également s'agir d'un ustensile ou d'un crayon équipé d'un tel aimant ou comportant un aimant permanent différent, par exemple intégré au corps du crayon. Le terme crayon est à comprendre au sens large et peut englober les stylos, feutres, pinceaux ou tout autre organe d'écriture ou de dessin. 10 [0024] Le matériau magnétique est de préférence ferrimagnétique ou ferromagnétique. Il présente un moment magnétique spontané non nul même en l'absence d'un champ magnétique extérieur. Il peut présenter un champ magnétique coercitif supérieur à 100 A.m-1 ou 500 A.m-1 et l'intensité du moment magnétique est de préférence supérieure à 0,01 A.m2 voire à 0,1 A.m2. On considère par la suite que l'aimant permanent peut être 15 approximé par un dipôle magnétique, mais peut l'être par d'autres modèles. L'axe magnétique de l'objet est défini comme étant l'axe colinéaire au moment magnétique de l'objet. [0025] La figure 1 est une vue en perspective, schématique et partielle, d'un dispositif de 20 suivi d'un aimant 2 selon un mode de réalisation. L'aimant 2 est ici un aimant permanent cylindrique, par exemple annulaire, qui est destiné à être fixé à un crayon (non représenté). [0026] Le dispositif de suivi 1 est apte à mesure le champ magnétique émis par l'aimant 2, à différents instants de mesure, au cours d'une durée T de suivi, dans un repère XYZ, et à estimer la position et le moment magnétique de l'aimant 2 sur la base des valeurs mesurées 25 du champ magnétique. En d'autres termes, le dispositif de suivi 1 permet de déterminer la position et l'orientation de l'aimant permanent 2 à différents instants dans le repère XYZ. Comme décrit plus loin, le dispositif de suivi lpermet en outre d'identifier un perturbateur magnétique 7, distinct de l'aimant 2 à suivre, situé au voisinage du réseau de magnétomètres, c'est-à-dire d'au moins en déterminer la présence au voisinage du réseau 30 de magnétomètres. [0027] On définit ici et pour la suite de la description un repère direct tridimensionnel (X,Y,Z), où les axes X et Y forment un plan parallèle au plan de mesure du réseau de magnétomètres, et où l'axe Z est orienté de manière sensiblement orthogonale au plan de mesure. Dans la suite de la description, les termes « vertical » et « verticalement » 35 s'étendent comme étant relatifs à une orientation sensiblement parallèle à l'axe Z, et les 3067138 6 termes « horizontal » et « horizontalement » comme étant relatifs à une orientation sensiblement parallèle au plan (X,Y). Par ailleurs, les termes « inférieur » et « supérieur » s'étendent comme étant relatifs à un positionnement croissant lorsqu'on s'éloigne du plan de mesure suivant la direction +Z. 5 [0028] La position Pa de l'aimant 2 correspond aux coordonnées du centre géométrique de l'aimant 2, c'est-à-dire au barycentre non pondéré de l'ensemble des points de l'aimant 2. Ainsi, le moment magnétique m de l'aimant présente les composantes (mg, my, mz) dans le repère XYZ. Sa norme, également appelée intensité ou amplitude, est notée 11m II ou m. [0029] Le dispositif de suivi 1 comporte un réseau de magnétomètres M, répartis les uns vis- 10 à-vis des autres de manière à former un plan de mesure Pa,'. Le nombre de magnétomètres M, peut être, par exemple supérieur ou égal à 2, de préférence supérieur ou égal à 16, par exemple égal à 32, notamment lorsqu'il s'agit de magnétomètres triaxes. Le réseau de magnétomètres comporte cependant au moins trois axes de mesure distants les uns des autres et non parallèles deux à deux. 15 [0030] Les magnétomètres M, sont fixés à une plaque de protection 3 et peuvent être situés au niveau de la face arrière de la plaque, celle-ci étant réalisée dans un matériau non magnétique. Par fixés, on entend qu'ils sont assemblés à la plaque sans aucun degré de liberté. Ils sont ici alignés en lignes et colonnes, mais peuvent être positionnés mutuellement de manière sensiblement aléatoire. Les distances entre chaque 20 magnétomètre et ses voisins, et en particulier les positions relatives des magnétomètres, sont connues et constantes dans le temps. Par exemple, elles peuvent être comprises entre lcm et 4cm. [0031] Les magnétomètres M, présentent chacun au moins un axe de mesure, par exemple trois axes, notés x1, y' z. Chaque magnétomètre mesure donc l'amplitude et la direction du 25 champ magnétique B perturbé par l'aimant permanent. Plus précisément, chaque magnétomètre M, mesure la norme de la projection orthogonale du champ magnétique B suivant les axes x1, y' z, du magnétomètre. Un paramètre de calibration des magnétomètres M, peut être le bruit associé aux magnétomètres, ici de l'ordre de 0,4 hiT. Par champ magnétique perturbé B, on entend le champ magnétique ambiant Bamb, c'est-à-dire non 30 perturbé par l'aimant, auquel s'ajoute le champ magnétique Ba généré par l'aimant. D'autres composantes magnétiques peuvent s'ajouter, comme une composante associée au bruit des capteurs, ainsi qu'une composante liée à la présence d'un perturbateur magnétique. [0032] Le dispositif de suivi 1 comporte en outre une unité de calcul 4 apte à calculer la position de l'aimant 2 et son moment magnétique dans le repère XYZ à partir des mesures 35 des magnétomètres M. De plus, comme décrit plus loin, l'unité de calcul 4 est apte à identifier un perturbateur magnétique 7 situé au voisinage du réseau de magnétomètres. 3067138 7 [0033] Pour cela, chaque magnétomètre M, est électriquement connecté à l'unité de calcul par un bus de transmission d'informations (non représenté). L'unité de calcul 4 comporte un processeur 5 programmable apte à exécuter des instructions enregistrées sur un support d'enregistrement d'informations. Il comporte en outre une mémoire 6 contenant les 5 instructions nécessaires pour la mise en oeuvre du procédé de suivi de l'aimant 2 et d'une phase d'identification du perturbateur magnétique 7 par le processeur. La mémoire 6 est également adaptée à stocker les informations calculées à chaque instant de mesure. [0034] L'unité de calcul 4 implémente un modèle mathématique associant la position de l'aimant permanent dans le repère XYZ, ainsi que l'orientation et l'intensité du moment 10 magnétique, aux mesures des magnétomètres M. Ce modèle mathématique est construit à partir des équations de l'électromagnétisme, en particulier de la magnétostatique, et est paramétré notamment par les positions et orientations des magnétomètres dans le repère XYZ. Ici, ce modèle est non linéaire. L'unité de calcul met en oeuvre un algorithme d'estimation de sa solution tel que, par exemple, un filtrage bayésien ou une optimisation, 15 voire tout autre algorithme du même type. [0035] De préférence, pour pouvoir approximer l'aimant permanent à un dipôle magnétique, la distance entre l'aimant permanent et chaque magnétomètre M, est supérieure à 2, voire 3 fois la plus grande dimension de l'aimant permanent. Cette dimension peut être inférieure à 20cm, voire inférieure à 10cm, voire à 5cm. L'aimant peut 20 être modélisé par un modèle dipolaire, entre autres, en fonction notamment de la distance entre l'aimant à suivre et le réseau de magnétomètres. [0036] La figure 2 est un organigramme d'un exemple de procédé d'estimation 100 d'une position de l'aimant effectué par le dispositif de suivi, au cours duquel l'aimant est déplacé 25 relativement au réseau de magnétomètres dans le repère XYZ, ici selon un premier mode de réalisation dans lequel l'algorithme d'estimation mis en oeuvre est un filtrage bayésien. Dans cet exemple, le filtrage bayésien est un filtre de Kalman, tel qu'un filtre de Kalman étendu. [0037] Le procédé d'estimation de la position, également appelé procédé de suivi, comporte 30 une phase 110 d'initialisation. Cette phase comporte la mesure 111 du champ magnétique généré par l'aimant et l'initialisation 112 d'un vecteur d'état X associé à l'aimant, pour un instant de référence to. [0038] Pour cela, lors d'une première étape 111, à un instant de référence to, le champ magnétique B(to) est mesuré par chaque magnétomètre M, du réseau. Lors de cette étape, 35 l'aimant permanent peut n'être pas présent, donc pas détectable par le réseau de 3067138 8 magnétomètres, de sorte que le champ magnétique mesuré B,(to) mesuré par le magnétomètre M, comporte les composantes suivantes : B i(t 0) = Ber" + (t 0) + B (t 0) = Brb + Bib (to) où Biamb est une composante associée au champ magnétique terrestre, où B11 est une 5 composante associée au bruit de l'environnement et des capteurs, qui, en l'absence de perturbateur magnétique au voisinage du dispositif de suivi, correspond essentiellement à une composante /311) associée au bruit du magnétomètre M, correspondant, et où Bic' est une composante ici nulle du champ magnétique généré par l'aimant et mesuré par le magnétomètre M. 10 [0039] Le perturbateur magnétique est un objet parasite différent de l'aimant à suivre, cet objet étant susceptible d'émettre un champ magnétique parasite BP et/ou d'entraîner la formation d'un champ magnétique induit FIPJ.Ba par interaction avec le champ magnétique Ba de l'aimant 2 à suivre. [0040] Lors d'une étape 112, il est affecté un vecteur d'état (to) à l'aimant permanent, à 15 l'instant de référence to. Le vecteur d'état est formé de variables représentatives de la position (x,y,z) et du moment magnétique (m,'my,m,) de l'aimant 2 dans le repère XYZ. La position de l'aimant et les coordonnées du moment magnétique peuvent être définies arbitrairement ou peuvent correspondre à des valeurs prédéterminées. [0041] Les étapes suivantes sont effectuées de manière itérative à un instant de mesure tn 20 incrémenté, le temps étant discrétisé à une fréquence d'échantillonnage déterminée, par exemple à 140Hz. A chaque itération de rang n est associé un instant de mesure tn, également appelé instant courant. [0042] Le procédé de suivi comporte ensuite une phase 120 de mesure. Cette phase comporte la mesure du champ magnétique par le réseau de magnétomètres à l'instant de 25 mesure tn et le calcul du champ magnétique dit utile Bu généré par l'aimant 2. [0043] Lors d'une étape 121, à l'instant de mesure tn, le champ magnétique B(t11) est mesuré par chaque magnétomètre M, du réseau. Lors de cette étape, l'aimant permanent est détectable par le réseau, de sorte que le champ magnétique B(t) mesuré par chaque magnétomètre M, comporte les composantes suivantes : 30 B(t) = Brb + 13:2 (tn)+ (tn) = Brb + (tn)+B(t) 3067138 9 où on retrouve le champ magnétique Ba généré par l'aimant permanent à l'instant courant t, le bruit associé aux capteurs Bb et le champ ambiant Bamb. [0044] Lors d'une étape 122, le champ magnétique Bu dit utile est calculé à partir des mesures du champ magnétique B(to) et B,(tn). Il correspond ici à un vecteur dont les 5 dimensions dépendent du nombre de magnétomètres et du nombre de valeurs de mesure effectuée par chaque magnétomètre. Plus précisément, le champ magnétique utile Bu est obtenu par soustraction du champ magnétique B(to) mesuré à l'instant de référence to au champ magnétique B(t11) mesuré à l'instant de mesure tn : B( t) Bi(tn)- Bi(to) = B (t n) - 13"' (t 0) = B (t n) 10 où la différence temporelle de la composante terrestre Bamb entre to et tn peut être négligée, tout comme celle de la composante Bb liée au bruit des magnétomètres. Il reste ainsi essentiellement, outre le cas échéant des termes liés à un défaut de calibration et/ou à un offset issu d'une possible aimantation des magnétomètres, la composante Ba du champ magnétique généré par l'aimant à l'instant courant tn. 15 [0045] Le procédé de suivi comporte ensuite une phase 130 d'estimation d'un champ magnétique généré par l'aimant en fonction d'un vecteur d'état obtenu à un instant de mesure précédent. [0046] Lors d'une étape 131, on prédit un vecteur d'état dit prédit X' (tri tri 1) associé à l'aimant, à partir de l'état estimé X" (tri 111-n 1) à l'instant précédent tn_i ou à partir de l'état 20 estimé X' (t0) à l'instant initial de la phase 110. L'état prédit de l'aimant peut être calculé à partir de la relation suivante : (tn tn 1) = F(tn).Î (tn iltn 1) = Î(tn iltn 1) où F(t11) est une matrice de prédiction qui relie l'état estimé précédent X' (tri 11tn 1) à l'état prédit courant X' (tri tri 1) . Dans cet exemple, la matrice de prédiction F est la matrice 25 identité, mais d'autres formulations sont possibles. Ainsi, en variante, la fonction de prédiction peut prendre en compte un ou plusieurs états précédents, et éventuellement une estimation de paramètres cinématiques relatifs à un déplacement et/ou à une rotation de l'aimant au cours d'instants de mesure précédents. [0047] Lors de cette même étape 131, on calcule également la matrice P(t,ilt' 1) d'estimation 30 a priori de la covariance de l'erreur, qui correspond à la mesure de la précision de l'état prédit courant X" (tri tri 1), à partir de la relation suivante : 3067138 10 P(tnItn 1) = F(tn).P(tn ibn 1).F (ta) Q(tn)= P(tn ibn 1) + Q(t) où F(t11) est ici la matrice identité, Q(t) est la matrice de covariance du bruit du processus, est l'opérateur de transposition, et P(t' t' i) est la matrice de covariance de l'erreur qui est issue de l'instant précédent tn_i. Lors de la première itération à n=1, la matrice 5 P(t' t' i) peut être initialisée par une matrice diagonale. [0048] Lors d'une étape 132, on calcule le champ magnétique dit estimé, généré par l'aimant, en fonction du vecteur d'état prédit (tn ta _1) , à l'instant courant tn, à partir d'une fonction h dite d'observation, également appelée fonction de mesure. La fonction d'observation h est basée sur un modèle physique construit à partir des équations de 10 l'électromagnétisme qui associe un champ magnétique estimé aux valeurs estimées de la position (x,y,z) et du moment magnétique (m,'my,m,) de l'aimant. Ainsi, le terme peut s'exprimer suivant la relation suivante : h(Î (tnl tn 1)) = ha(t) + sm où h'a est la composante représentative du champ magnétique estimé de l'aimant à l'instant 15 courant tn, et en est une composante associée à des erreurs du modèle physique h. [0049] Le procédé de suivi comporte ensuite une phase 140 de calcul d'un biais. Lors d'une étape 141, on calcule le biais à l'instant courant tn, ici l'innovation y (t'), par différence entre le champ magnétique estimé h(X^ (tn ta _1)) à l'instant courant tn, et le champ magnétique utile mesuré B(ç) à l'instant courant t11. Y(t)= (t) - h(k' (tnl tn_1)) 20 = -E qui est alors essentiellement égal, au signe près, aux erreurs en du modèle physique, dans la mesure où le champ magnétique mesuré de l'aimant Ba correspond sensiblement à son estimation obtenue lors de l'étape 132. [0050] Le procédé de suivi comporte ensuite une phase 150 de calcul de la position estimée 25 de l'aimant à l'instant courant tn. Cette phase consiste à mettre à jour le vecteur d'état courant X^ (tn tn) de l'aimant en corrigeant le vecteur d'état préalablement obtenu, à savoir ici l'état prédit courant X^ (tn tn 1) , en fonction du biais y(t11) calculé. [0051] Lors d'une étape 151, un terme dit de gain de Kalman K(t11) à l'instant courant tn est calculé à partir de la relation suivante : 3067138 11 K(t,i)= où la matrice P(tnIt' 1) d'estimation est obtenue lors de l'étape 310, H est la matrice d'observation, définie ici comme étant la jacobienne H = -a de la fonction d'observation xu h, avec u l'indice des variables du vecteur d'état, et S est la covariance de l'innovation, définie 5 comme étant égale à H(tn).P(tn 1).H T (0+ R(ç) où R est la matrice de covariance de la mesure de mesure et est donc représentative du bruit des capteurs. [0052] Lors d'une étape 152, l'estimation du vecteur d'état 5i à l'instant de mesure t11 est effectuée par mise à jour de l'état prédit courant k' (tri tri 1) à partir du produit du terme d'innovation y(t) et du gain de Kalman K(tn), tel qu'exprimé par la relation suivante : 10 (t'Itn)= 1) + y(t,2).K(tn) [0053] On effectue également la mise à jour de la matrice de covariance de l'erreur par la relation suivante : P(tnItn)= (I - K(tn).H(tn)).P(tnItn 1) où I est la matrice identité. 15 [0054] On obtient ainsi la position estimée à l'instant de mesure t11 à partir des variables du vecteur d'état estimé X relatives à la position (x,y,z) de l'aimant dans le repère XYZ. Le temps est ensuite incrémenté d'un incrément supplémentaire, et le procédé réitère les étapes précédemment décrites à l'instant courant tn+i suivant, ici à partir de la phase 110 de mesure. On effectue ainsi le suivi de l'aimant dans le repère XYZ. 20 [0055] Dans le cadre d'un filtre bayésien tel que le filtre de Kalman qui comporte une phase de prédiction et une phase de mise à jour, la prédiction est effectuée lors de l'étape 131, et la mise à jour par les étapes 132, 141, 151 et 152. [0056] Cependant, les inventeurs ont mis en évidence que la présence d'un perturbateur 25 magnétique au voisinage du dispositif de suivi peut entraîner une augmentation de l'incertitude associée à la position estimée de l'aimant dans le repère XYZ, voire gêner la convergence de l'algorithme d'estimation de la position de l'aimant. [0057] En effet, en présence d'un perturbateur magnétique, le champ magnétique B(t11) mesuré à l'instant de mesure t11 devient, pour chaque capteur de rang i : 3067138 12 B(t) = Brnb + (tn)+ Be: (tn) = Brnb +[B,P (tn) + Hf". (tn).B.e.'(tn)+ (tn)1+B(t) où la composante Bn comporte maintenant un terme supplémentaire BP correspondant au champ magnétique permanent généré par le perturbateur magnétique, et éventuellement un terme FIPJ.Ba correspondant au champ magnétique induit issu d'une interaction 5 magnétique entre le perturbateur et l'aimant. [0058] Le champ magnétique utile Bu(t11) calculé à l'instant courant t11 devient, pour chaque capteur de rang i: (tn)= Bi(tn)- B(t0) = 41311' (t n) + (t n) =LB (t n) + H iP't(t n).B (t n)1+ B (t n) qui comporte ainsi, outre le terme Ba du champ magnétique généré par l'aimant, un terme 10 associé au perturbateur magnétique (les termes associés aux défauts de calibration et/ou à l'offset d'aimantation ne sont ici pas détaillés). [0059] Aussi, le terme d'innovation y (tn) devient maintenant : y(tn)= Bu(t)_ h(j(t'Itn 1)) =[BiP(tn)+HiP'1(tn).B(tn)l-Em où le terme de bruit associé à la présence du perturbateur magnétique s'ajoute au terme lié 15 au erreurs du modèle physique en. [0060] On comprend alors que l'estimateur récursif, qui tend à minimiser le terme d'innovation y, notamment par le biais de la jacobienne H(t.), et donc à minimiser les erreurs du modèle physique Én en l'absence d'un perturbateur magnétique, peut être perturbé par la présence du terme lié au perturbateur magnétique. Une augmentation de 20 l'erreur relative liée à la position estimée de l'aimant est alors possible, voire même une difficulté de l'algorithme à converger. [0061] A titre d'exemple, la présence d'un téléphone portable au voisinage du réseau de magnétomètres peut provoquer de telles perturbations. Le téléphone portable, lorsqu'il est suffisamment proche du réseau de magnétomètres, est alors qualifié de perturbateur 25 magnétique. Plus généralement, il s'agit par exemple de tout matériau ferromagnétique autre que l'aimant à suivre, tel que des parties d'une table, d'un casque audio, d'un appareil électronique, etc... 3067138 13 [0062] La figure 3 est un organigramme d'un procédé d'estimation d'une position de l'aimant selon le premier mode de réalisation, c'est-à-dire que la position de l'aimant est ici estimée à l'aide d'un filtre bayésien tel qu'un filtre de Kalman, par exemple étendu. Le procédé comporte une phase d'identification 60 d'un perturbateur magnétique situé au 5 voisinage du réseau de magnétomètres. [0063] La phase d'identification 60 permet de déterminer la présence éventuelle d'un perturbateur magnétique, dans le but par exemple d'indiquer à l'utilisateur d'écarter le perturbateur vis-à-vis du réseau de magnétomètres, voire d'identifier des magnétomètres situés à proximité du perturbateur à ne pas prendre en compte dans l'estimation de la 10 position de l'aimant, pour ainsi effectuer le suivi de l'aimant avec la précision requise et/ou en minimisant les risques de défaut de convergence de l'algorithme d'estimation. [0064] Ainsi, le procédé 100 de suivi de l'aimant comporte la phase 110 d'initialisation, la phase 120 de mesure, la phase 130 d'estimation, la phase 140 de calcul du biais, et la phase 150 de mise à jour. Ces étapes sont identiques ou similaires à celles détaillées précédemment 15 et ne sont donc pas décrites à nouveau. [0065] Le procédé 100 comporte cependant une phase 60 supplémentaire, permettant d'identifier la présence éventuelle d'un perturbateur magnétique au voisinage du réseau de magnétomètres. [0066] La figure 4 est un organigramme qui illustre un exemple de phase 60 d'identification 20 du perturbateur magnétique. [0067] Lors d'une étape 61, on calcule d'un terme dit indicateur Ind à l'instant courant t11 à partir d'un paramètre d'écart e(t11) défini en fonction d'une différence entre une estimation du champ magnétique généré par l'aimant en fonction d'un vecteur d'état obtenu à un instant de mesure précédent ou mis à jour sur la base dudit modèle prédéterminé h, vis-à- 25 vis du champ magnétique utile mesuré à l'instant de mesure. De préférence, l'indicateur est ici égal au rapport entre le paramètre d'écart e(t11) sur une estimation du champ magnétique estimé h(k) . Dans cet exemple, le paramètre d'écart e(t11) est égal à la norme 2 de l'innovation y(t11) obtenu à l'étape 141, et le champ magnétique estimé h(k' (tri 1 tri 1)) est ici , celui correspondant au vecteur d'état prédit X(tri 1 tri 1) . Ainsi, les valeurs de l'indicateur 30 Ind(t.) peuvent être calculées, par capteur de rang i, à partir de la relation suivante : 3067138 /ndi(t)e. (t ) 14 n (X (t n t n n= = Ohi(X )M (ta) - hi (i' (t a t a il - Oh (i (t a t n 0(B (tn) ± H (ta).13"' (t a)) - Em0 - (tn) En1 [0068] Autrement dit, le terme indicateur Ind(t.) est ici égal à la norme 2 du terme d'innovation y(t11) divisée ici par la norme 2 du terme d'estimation h(Î(tn ta _1)) du champ magnétique généré par l'aimant, obtenu à l'étape 132. Ainsi, il ressort que la contribution 5 magnétique associée au perturbateur (terme situé au numérateur) est divisée par la contribution magnétique associée à l'aimant (terme situé au dénominateur). Le terme indicateur représente ainsi la force de la perturbation magnétique. En variante, les valeurs du terme indicateur Ind,(t.) peuvent être calculées pour chaque axe de mesure des capteurs, en adaptant le cas échéant la norme utilisée. Le rapport entre le terme d'écart e(t11) et le 10 terme d'estimation h()) peut donc être une division termes à termes, voire une division des normes. Ainsi, le terme indicateur peut être un terme vectoriel ou un scalaire. [0069] L'étape 62 illustre une étape facultative mais avantageuse de filtrage de l'indicateur calculé à l'étape 61, pour limiter l'effet d'une dynamique éventuellement importante de l'aimant en termes de déplacement et/ou de rotation. Il s'agit ainsi d'un filtrage passe-bas 15 dont la constante de temps est fonction de la vitesse de déplacement et/ou de rotation. L'indicateur est ainsi filtré comme l'exprime la relation suivante : ind (t a) = (1- a(t n)). Ind (t a) + a(t a). Ind (t où Ind(t.) est l'indicateur calculé à l'étape 61 à l'instant courant t. et Ind(tn_i) est l'indicateur calculé à un instant courant précédent tn_i, et où a(t11) est un terme de filtrage inférieur à 1, 20 à valeur constante ou calculée à l'instant courant tn. [0070] Ce terme de filtrage peut être défini à partir de la relation suivante : - t n_21 V (ta) = où a et b sont des scalaires prédéterminés, et où V(t) est un terme cinématique exprimant la dynamique de l'aimant en termes de déplacement et/ou de rotation. Le terme 25 cinématique est ainsi défini comme la différence entre les vecteurs d'état à deux instants de mesure successifs divisée par l'incrément de temps. At 3067138 15 [0071] Ainsi, l'indicateur filtré ind(tn) permet de limiter, dans le terme d'innovation, la part liée à la cinématique de l'aimant entre deux instants de mesure. Cette part peut devenir importante lorsque le temps caractéristique de la dynamique de l'aimant devient égal voire supérieur au temps d'échantillonnage. 5 [0072] Lors d'une étape 63, on compare l'indicateur Ind(t.), ici l'indicateur filtré ind(tn), à une valeur seuil prédéterminée Indth. Et lorsqu'il en est supérieur, le perturbateur est alors identifié comme étant présent. Dans le cas où l'indicateur Ind(t.) est une grandeur vectorielle, on compare chaque valeur de l'indicateur à la valeur seuil et le perturbateur est identifié lorsqu'au moins une valeur indt(tn) est égale voire supérieure à la valeur seuil 10 Indth. A titre d'exemple, la valeur seuil peut être égale à 14% environ. De manière similaire, lorsque le terme indicateur est un scalaire, on compare celui-ci à la valeur seuil Indth. [0073] Lors d'une étape 64, un signal peut être émis à destination de l'utilisateur, pour l'inviter à déplacer le perturbateur jusqu'à ce que chaque valeur indt, à un instant de mesure t>t11 suivant, devienne inférieure à la valeur seuil. Le signal peut être une 15 information affichée sur un écran d'affichage représentant le réseau de magnétomètres. L'information affichée peut se présenter comme une carte de dite de chaleur dont un scalaire d'intensité est attribué à chaque magnétomètre IV11, le scalaire d'intensité correspond à une valeur Ind, de l'indicateur. De manière avantageuse, les valeurs de l'indicateur Ind(th) sont pondérées par un facteur de pondération, voire simplement 20 écrêtées de telle sorte les valeurs de l'indicateur s'échelonnent entre une valeur minimale, par exemple 0, et une valeur maximale, par exemple 255, et que les fortes valeurs initiales sont atténuées au profit des faibles valeurs initiales. Ainsi, les valeurs de l'indicateur pondéré mettent en évidence les faibles perturbations magnétiques. Dans le cas où l'indicateur Ind ne revient pas à une valeur inférieure à la valeur seuil à partir d'un délai 25 prédéterminé, la phase d'initialisation 100 peut être effectuée. [0074] Ainsi, le procédé 100 de suivi de l'aimant comporte une phase 60 permettant d'identifier simplement un perturbateur magnétique situé au voisinage du réseau de magnétomètres. En effet, le terme indicateur Ind(t.) utilise, dans cet exemple, l'information relative au perturbateur magnétique déjà contenue dans le terme d'innovation. On évite 30 ainsi d'avoir à utiliser un dispositif et un procédé spécifiques et dédiés à l'identification du perturbateur magnétique. [0075] De plus, le fait de calculer le terme indicateur Ind(th) à partir d'un rapport du terme d'écart e(t) (ici la norme de l'innovation) sur le terme d'estimation h(k) permet de 3067138 16 simplement différencier la composante le(t')+ (tn).13,a(tn) associée au perturbateur magnétique, vis-à-vis de la composante si, associée aux erreurs du modèle physique. En effet, sans cette définition de l'indicateur comme rapport du terme d'écart sur le terme d'estimation, il peut être délicat de différencier les composantes associées au perturbateur 5 et aux erreurs du modèle. En effet, la composante en présente une intensité qui peut évoluer en 1/ d,k, avec k augmente lorsque d diminue, d, étant la distance séparant l'aimant du magnétomètre 1\41, cette intensité pouvant augmenter lorsque l'aimant est très proche du magnétomètre M, considéré, et ainsi devenir prépondérante vis-à-vis de la composante associée au perturbateur magnétique. Autrement dit, la définition du terme indicateur 10 Ind(tn) comme rapport du terme d'écart e(t) sur le terme d'estimation h(k) permet de bien mettre en évidence la composante associée au perturbateur magnétique. [0076] Il apparaît également que l'indicateur Ind(G) est, d'une certaine manière, un rapport signal à bruit (SNR) dans le sens où le signal utile est ici le champ magnétique estimé h()) et le bruit associé à la présence du perturbateur magnétique est introduit par l'écart entre le 15 champ magnétique mesuré Bu et le terme d'estimation h(k). [0077] Par ailleurs, la phase d'identification 60 reste opérationnelle que le perturbateur magnétique soit présent ou non lors de la phase 100 d'initialisation. En effet, dans le cas où le perturbateur magnétique est présent à to et reste stationnaire dans le plan XYZ du réseau de magnétomètres, le champ utile mesuré Bu(t11) comporte un terme de différentiel temporel 20 413f =131' (tn)- (to) sensiblement nul, alors que le terme d'induit 1-1,1"(tn).Bia(tn) reste non nul. Dans le cas où le perturbateur magnétique est présent à to mais non stationnaire (du fait d'un déplacement relatif du perturbateur vis-à-vis du réseau de magnétomètres), le terme de différentiel temporel 413f est non nul. Enfin, lorsque le perturbateur magnétique est initialement absent du voisinage du réseau de magnétomètres à to mais devient ensuite 25 présent, le terme de différentiel temporel 413f ainsi que le terme d'induit 1-1,1"(tn).Bia(tn) apparaissent et prennent une valeur non nulle. [0078] De manière avantageuse, l'indicateur Ind(G) peut comporter, au dénominateur, une constante prédéterminée c représentative d'un biais d'au moins un magnétomètre, par exemple une valeur représentative du bruit capteur, par exemple de l'ordre de 0 ,31,a, voire 30 une valeur représentative d'un seuil de détection, par exemple de l'ordre de 101.a. Cette valeur prédéterminée peut également être représentative d'un défaut de calibration ou d'une erreur de mesure liée à une aimantation d'au moins un magnétomètre. Ainsi, l'indicateur Ind(G) peut s'écrire, ici par capteur i : 3067138 17 Ind.(tn)= e.(tn Mhi(X)0+ c [0079] Ainsi, les valeurs de l'indicateur sont fiabilisées dans le sens où on évite que l'indicateur présente des valeurs trop élevées, notamment lorsque le champ magnétique estimé par l'aimant est faible voire nul. Par ailleurs, on s'affranchit non seulement des 5 erreurs du modèle physique utilisé mais également du biais que peuvent présenter les magnétomètres. [0080] En variante, l'indicateur Ind(G) peut s'écrire comme le rapport du paramètre d'écart e(t11) sur la constante prédéterminée c représentative du biais d'au moins un magnétomètre. Ainsi, on s'affranchit des erreurs de mesure associées au biais des capteurs, ces erreurs étant 10 présentent dans le terme Bu présent dans le paramètre d'écart e(t11) et dans la constante prédéterminée c. L'indicateur Ind(G) peut ainsi s'écrire, ici par capteur : Indi(tn)= e (ta) [0081] En variante, l'indicateur Ind(G) peut s'écrire comme le rapport du paramètre d'écart e(t11) sur le champ magnétique mesuré Bu(t'), avec ou sans la constante prédéterminée c au 15 dénominateur. Ainsi, on obtient un indicateur dont les valeurs varient en fonction de l'intensité du signal associé au perturbateur magnétique vis-à-vis de l'intensité du champ magnétique estimé généré par l'aimant. L'indicateur Ind(G) peut ainsi s'écrire, ici par capteur : Indi(tn)= e (tn) 20 [0082] Les figures 5A et 5B illustrent des vues en coupe (fig.5A) et de dessus (fig.5B) d'un exemple de réseau de magnétomètres au voisinage duquel est situé un perturbateur magnétique. [0083] Sur la fig.5A est illustré un exemple de répartition des valeurs d'intensité de 25 perturbation ind, pour chaque magnétomètre M. Pour les magnétomètres M1, M1 et M,,i au voisinage desquels est situé le perturbateur magnétique, les valeurs de l'indicateur dépassent la valeur seuil Indth de sorte que le perturbateur magnétique est correctement identifié et localisé. Pour les autres magnétomètres, les valeurs de l'indicateur correspondantes sont inférieures à la valeur seuil. 3067138 18 [0084] Comme l'illustre la fig.5B, à partir de l'indicateur représenté sous la forme d'une carte de chaleur, un vecteur de direction DP associé au perturbateur magnétique peut être calculé et affiché. Le vecteur de direction DP peut être obtenu à partir de la moyenne des positions des magnétomètres pondérées chacune par le scalaire d'intensité de perturbation 5 correspondant, et de la position du centre Pr du réseau de magnétomètres. Ainsi, l'utilisateur reçoit une information indiquant la direction suivant laquelle est situé le perturbateur par rapport au réseau de magnétomètres. Il est alors en mesure de procéder au retrait du perturbateur hors du voisinage des magnétomètres. [0085] Le procédé 100 assure le suivi de l'aimant, et donc réitère la phase 120 de mesure, la 10 phase 130 d'estimation du champ magnétique généré, la phase 140 de calcul du biais (ici l'innovation), et la phase 150 de calcul de la position estimée de l'aimant. A chaque incrémentation du temps de mesure, la phase 60 d'identification du perturbateur magnétique est effectuée. [0086] Dans le cas où le perturbateur magnétique est encore présent au voisinage du réseau 15 de magnétomètres, la phase 150 de calcul de la position estimée de l'aimant peut être effectuée sans prendre en considération les valeurs de mesure issues des magnétomètres M,_i, M, et M,+1, pour lesquels l'indicateur présente des valeurs locales supérieures à la valeur seuil. [0087] Il peut être procédé à une étape de validation du suivi, en comparant par exemple la 20 norme ou chaque composante du moment magnétique, voire de la position, issu du vecteur d'état estimé Î(tri tri) à l'étape 152, à une valeur de référence prédéterminée du type d'aimant utilisé. [0088] Les figures 6A et 6B illustrent chacune un organigramme représentant partiellement 25 un procédé de suivi selon une variante du premier mode de réalisation. L'algorithme d'estimation mis en oeuvre est également un filtrage bayésien, et plus particulièrement ici un filtre de Kalman. [0089] Dans cette variante, les différentes phases 110 (initialisation), 120 (mesure), 130 (calcul du champ magnétique estimé), 140 (calcul du biais, à savoir ici l'innovation), et 150 30 (calcul de la position estimée de l'aimant) du procédé de suivi 100 sont identiques ou similaires à celles décrites en référence à la figure 3 et ne sont pas reprises ici. [0090] Le procédé 100 selon cette variante se distingue de celui décrit précédemment essentiellement en ce que la phase 60 d'identification du perturbateur magnétique n'est plus effectuée à partir du terme d'innovation, et donc du vecteur d'état prédit Î(tri 3067138 19 mais à partir du vecteur d'état mis à jour X' (ta ta). Ainsi, la phase 60 est effectuée à la suite de l'étape 152. [0091] Comme l'illustre la figure 6B, lors de l'étape 61, le terme indicateur Ind(t.) est calculé à l'instant courant t11 comme étant égal au rapport entre le terme d'écart e(t11) sur une 5 estimation du champ magnétique estimé h(X"). Dans cet exemple, le terme d'écart e(t11) n'est donc pas égal à l'innovation y(t11) obtenu à l'étape 141, ni au champ magnétique estimé h(Î (tn t n 1)) obtenu à l'étape 132. Au contraire, le terme d'estimation présent dans le terme d'écart e(t11) et présent au dénominateur correspondent au vecteur d'état mis à jour ç). Ainsi, le terme indicateur Ind(t.) peut être ici calculé à partir de la relation 10 suivante, ici avec la constante prédéterminée c représentative du biais d'au moins un capteur : ei (ta) Mi3u (tn)- (' (t 0)0 Indi (t n) = (i' )M+ c (i' n t C [0092] Ainsi, l'identification du perturbateur magnétique est rendue plus précise dans la mesure où l'indicateur est calculé à partir du vecteur d'état mis à jour et non pas à partir du 15 vecteur d'état prédit. Le paramètre d'écart e(t11) ne differe de l'innovation y(t11) essentiellement par le vecteur d'état X" considéré. La fonction d'observation h est la même et le champ magnétique utile Bu également. [0093] Comme précédemment, la phase 60 d'identification du perturbateur magnétique comporte l'étape 63 de comparaison de la ou des valeurs de l'indicateur à une valeur seuil 20 prédéterminée. Elle peut en outre comporter l'étape 62 de filtrage passe-bas dans le but de réduire l'influence de la cinématique présente éventuellement entre deux vecteurs d'état successifs. Elle peut également comporter une étape d'écrêtage ou de pondération des fortes valeurs de l'indicateur, notamment lorsque ces valeurs expriment une saturation de la mesure des magnétomètres concernés. 25 [0094] Les figures 7 et 8 illustrent chacune un organigramme représentant partiellement un procédé 200 de suivi selon un deuxième mode de réalisation. L'algorithme d'estimation mis en oeuvre est alors une optimisation, notamment par minimisation d'une fonction de coût, ici par une descente de gradient. 3067138 20 [0095] Le procédé 200 comporte une phase 210 d'initialisation et une phase 220 de mesure du champ magnétique B(t11) et de calcul du champ magnétique utile Bu(tn). Ces phases sont identiques ou similaires à celles décrites précédemment et ne sont pas détaillées ici. [0096] Il comporte en outre plusieurs phases 230, 240, 250 effectuées successivement, pour 5 un même temps de mesure tn, dans une boucle itérative de minimisation d'une fonction de coût C. Le vecteur d'état X^ (tri) à l'instant de mesure tn est ainsi obtenu par correction successive, suivant l'incrément i, du vecteur d'état X^ (tri 1) de l'instant de mesure précédent tn_i. Il comporte ainsi une phase 230 d'estimation du champ magnétique généré en fonction d'un vecteur d'état obtenu préalablement, une phase 240 de calcul d'un biais, ici une 10 fonction de coût C, et une phase 250 de calcul de la position estimée de l'aimant à l'instant courant tn. [0097] La phase 230 d'estimation du champ magnétique h()) généré pour un vecteur d'état obtenu préalablement est similaire aux phases 130 décrites précédemment. A l'instant de mesure tn, il s'agit du vecteur d'état obtenu lors de la phase 250 à l'instant de mesure 15 précédent tn_i ou du vecteur d'état )(t0) défini lors de l'initialisation à l'instant to, éventuellement corrigé en fonction de l'incrément i de la correction itérative de minimisation d'une fonction de coût C. On note ainsi tni l'instant de mesure tn_i à l'incrément i. [0098] Ainsi, lors d'une étape 231, on calcule, à l'instant courant tn, le champ magnétique 20 estimé h(X^ (tri' 1)) correspondant au vecteur d'état X^ (tri' 1) obtenu préalablement à l'instant de mesure tn_i, éventuellement corrigé en fonction de l'incrément i. Lorsque l'incrément i - est égal à 1, la boucle de correction n'a pas encore fait un tour et le vecteur d'état X (tri 1) est celui X^ (tri 1) calculé à l'étape 252 de la phase 250. Lorsque l'incrément i est supérieur à 1, la boucle de correction a déjà fait un tour et le vecteur d'état differe de celui X^ (tri 1) calculé 25 à l'étape 252 par au moins un terme de correction. Comme détaillé précédemment, le champ magnétique estimé h()) est calculé à partir de la fonction h d'observation, également appelée fonction de mesure. [0099] La phase 240 de calcul du biais, ici la fonction de coût C à minimiser, comporte une étape 241 de correction du vecteur d'état, suivie d'une étape de calcul de la fonction de coût 30 C. [00100] Lors de l'étape 241, on corrige le vecteur d'état à l'incrément précédent suivant, dans cet exemple, une relation correspondant à un algorithme de descente du gradient : 3067138 21 î (t) = î (tin 1)- [c( î (tin 1))1 = î 1) - .V x[f (h(î) - Bu (0)1 où i est le pas dont la valeur, positive, peut dépendre de l'incrément i, Vx est l'opérateur gradient en fonction des variables du vecteur d'état, et C(k) la fonction de coût à minimiser qui dépend de la différence entre un champ magnétique estimé h()) vis-à-vis 5 du champ magnétique mesuré utile Bu. A titre illustratif, la relation précédente peut s'écrire, 2 ici dans le cas des moindres carrés, avec C(X^ )- 011(î) - 13"0 : î (tin+11) = î (tin 1)- , u .v [c (î (tin 1))1 = î (tin 1) - 2 , u . H T (î (t n 1)) . (h (î (t n )) (0) où HT est la transposée de la jacobienne de la fonction d'observation h appliquée au vecteur d'état à l'instant de mesure tn_i et à l'incrément i. D'autres expressions sont bien entendu 10 possibles, par exemple dans le cadre d'une méthode de Gauss-Newton ou de Levenberg- Marqu ardt. [00101] Lors de l'étape 242, on calcule la norme 11C1I de la fonction de coût C. Plusieurs 2 expressions sont possibles, par exemple Oh(X^ )- /3"(tn) . [00102] La phase 250 de calcul de la position estimée, à l'instant courant tn, comporte une 15 étape 251 dans laquelle on compare la norme 11 CI à un seuil. Lorsque 11 CI est supérieur au seuil, l'incrément i est augmenté d'une itération, et la boucle de minimisation reprend à partir de l'étape 231 appliquée au vecteur d'état corrigé. Lorsque 11 CI est inférieur ou égal au seuil, on obtient alors, dans l'étape 252, la valeur du vecteur d'état estimé )(t) pour l'instant courant tn, qui prend la valeur du vecteur d'état corrigé î (tn1+11). Le temps est 20 ensuite incrémenté d'un incrément supplémentaire, et le procédé réitère les étapes précédemment décrites à l'instant courant tn+i suivant, ici à partir de la phase 210 de mesure. On effectue ainsi le suivi de l'aimant dans le repère XYZ. [00103] Le procédé de suivi 200 comporte également la phase 60 d'identification du perturbateur magnétique, celle-ci étant effectuée à partir du vecteur d'état estimé î (tn) 25 pour l'instant courant tn, obtenu à l'étape 252. Elle est similaire à celle décrite en référence à la figure 6B. 3067138 22 [00104] Lors de l'étape 61, le terme indicateur Ind(t.) est calculé à l'instant courant t11 comme étant égal au rapport entre le terme d'écart e(t11) sur une estimation du champ magnétique estimé h(X"). Dans cet exemple, le terme d'écart e(t11) est égal à la norme de la différence entre le champ magnétique h(X"(tn)) estimé pour le vecteur d'état X" (tn ) obtenu à l'étape 5 252, et le champ magnétique mesuré Bu(t.). Ainsi, l'indicateur Ind(t.) peut s'écrire, ici avec la constante prédéterminée c au dénominateur, et par capteur i : e. (t ) Ind (t n) = ' - (Î (tn))0 C (Î (tn))M C [00105] Ainsi, le paramètre d'écart e(t11) diffère du biais, ici la fonction de coût C, essentiellement par le vecteur d'état X" considéré. La fonction d'observation h est la même 10 et le champ magnétique utile Bu également. [00106] En variante, comme mentionné précédemment, l'indicateur peut comporter au dénominateur le champ magnétique mesuré Bu avec ou sans la constante prédéterminée c, voire la seule constante prédéterminée c. [00107] Comme précédemment, la phase 60 d'identification du perturbateur magnétique 15 comporte l'étape 63 de comparaison de la ou des valeurs de l'indicateur à une valeur seuil prédéterminée. Elle peut en outre comporter l'étape 62 de filtrage passe-bas dans le but de réduire l'influence de la cinématique présente éventuellement entre deux vecteurs d'état successifs. Elle peut également comporter une étape d'écrêtage ou de pondération des fortes valeurs de l'indicateur, notamment lorsque ces valeurs expriment une saturation de la 20 mesure des magnétomètres concernés. [00108] Des modes de réalisation particuliers viennent d'être décrits. Différentes variantes et modifications apparaîtront à l'homme du métier. 25 REVENDICATIONS1. Procédé d'estimation de la position d'un aimant (2) par un dispositif de suivi (1) comportant un réseau de magnétomètres (M,) aptes à mesurer un champ magnétique, comportant les phases suivantes : o détermination (110 ; 210) d'un vecteur d'état dit initial associé à l'aimant, pour un instant de mesure initial, le vecteur d'état comportant des variables représentatives de la position de l'aimant par rapport au réseau de magnétomètres ; o mesure (120 ; 220) par le réseau de magnétomètres d'un champ magnétique dit utile (Bu(t.)), à un instant de mesure (ti,), en présence de l'aimant ; o estimation (130 ; 230) d'un champ magnétique ( h(k)) généré par l'aimant, en fonction du vecteur d'état ( X^ (tri 1)) obtenu à un instant de mesure précédent, sur la base d'un modèle prédéterminé (h) exprimant une relation entre le champ magnétique généré par l'aimant et le vecteur d'état de l'aimant ; o calcul (140 ; 240) d'un biais (y(ti,) ; C(ti,)) par différence entre ledit champ magnétique estimé ( h(Î(tri I))) et ledit champ magnétique utile mesuré (13u(t4) ; o mise à jour (150 ; 250) du vecteur d'état ( (tri) ) en fonction du biais calculé (y(ti,) ; C(0), permettant ainsi d'obtenir une position estimée de l'aimant à l'instant de mesure (ti,) ; o réitération des phases de mesure, d'estimation, de calcul du biais et de mise à jour, sur la base du vecteur d'état mis à jour, en incrémentant l'instant de mesure ; caractérisé en ce qu'il comporte en outre la phase suivante : o identification (60), à au moins un instant de mesure (ti,), d'un perturbateur magnétique distinct de l'aimant et situé au voisinage du réseau de magnétomètres, comportant les étapes suivantes : - calcul (61) d'un paramètre dit indicateur (Ind( )) à partir d'un paramètre d'écart (e(t)) défini en fonction d'une différence entre un champ magnétique dit estimé (h(X)) généré par l'aimant pour le vecteur d'état obtenu à l'instant de mesure précédent ( X (tri 1)) ou le vecteur d'état mis à jour ()(tri)), sur la base dudit modèle prédéterminé (h), et ledit champ magnétique utile (13u(t4) mesuré à l'instant de mesure (ti,) ; - comparaison (63) de l'indicateur (Ind(th)) à une valeur seuil (Indth) prédéterminée, et identification du perturbateur magnétique lorsqu'au moins l'une des valeurs de l'indicateur (Ind(th)) est supérieure ou égale à la valeur seuil (Indth). 3067138 24 2. Procédé selon la revendication 1, dans lequel l'indicateur (Ind(t)) est égal au rapport du paramètre d'écart (e(tO) sur un terme dénominateur comportant au moins le champ magnétique estimé ( h(X")) de l'indicateur, le champ magnétique utile mesuré (Bu(t.)) de l'indicateur, ou au moins une constante prédéterminée (c) représentative d'un biais d'au 5 moins l'un desdits magnétomètres. 3. Procédé selon la revendication 2, dans lequel le terme dénominateur comporte le champ magnétique estimé (h(X")) dudit l'indicateur et ladite constante prédéterminée (c). 4. Procédé selon l'une quelconque des revendications 1 à 3, dans lequel les phases d'estimation (130 ; 230), de calcul du biais (140 ; 240) et de mise à jour (150, 250) sont 10 effectuées par un algorithme d'estimation récursive bayésienne. 5. Procédé selon la revendication 4, dans lequel la phase d'estimation (130 ; 230) comporte : - une étape d'obtention (131 ; 231) d'un vecteur d'état dit prédit à l'instant de mesure (t.) en fonction d'un vecteur d'état ( X" (t iltri 1) ) obtenu à un instant de mesure précédent 15 (tn_i), et - une étape de calcul (132 ; 242) du champ magnétique estimé ( h(X' (tri ta _1))) pour le vecteur d'état prédit ( X' (tri ta 1)), et la phase de calcul du biais (140 ; 240) comporte : - une étape de calcul (141; 241) du biais, dit innovation (y(t.)), comme différence entre le 20 champ magnétique estimé ( h(X' (tri Itn 1))) pour le vecteur d'état prédit ( X' (tri Itn 1)) et ledit champ magnétique utile mesuré (Bu(t)). 6. Procédé selon la revendication 5, dans lequel le paramètre d'écart (e(t.)) est égal à l'innovation (y(t.)). 7. Procédé selon la revendication 5, dans lequel le paramètre d'écart (e(t.)) est égal à la 25 différence entre un champ magnétique estimé (h())) généré par l'aimant pour le vecteur d'état mis à jour ( X' (tri)), et ledit champ magnétique utile (Bu(t)) mesuré à l'instant de mesure (t.). 8. Procédé selon l'une quelconque des revendications 1 à 5, dans lequel les phases d'estimation (130 ; 230), de calcul du biais (140 ; 240) et de mis à jour (150, 250) sont 3067138 25 effectuées par un algorithme d'optimisation par minimisation itérative du biais, dit fonction de coût, à l'instant de mesure (t.). 9. Procédé selon l'une quelconque des revendications 1 à 8, dans lequel le vecteur d'état comporte en outre des variables représentatives d'un moment magnétique de l'aimant. 5 10. Procédé selon l'une quelconque des revendications 1 à 9, dans lequel la phase (60) d'identification du perturbateur magnétique comporte une étape d'émission d'un signal à l'utilisateur invitant à écarter le perturbateur magnétique vis-à-vis du réseau de magnétomètres, tant que l'indicateur est supérieur à la valeur seuil prédéterminée. 11. Support d'enregistrement d'informations, comportant des instructions pour la mise 10 en oeuvre du procédé selon l'une quelconque des revendications précédentes, ces instructions étant aptes à être exécutées par un processeur.