Brevet FR3114659A1 — publié le 20220401

Procédé de recalage sur une pluralité d’amers, produit programme d'ordinateur et dispositif de recalage associés La présente invention concerne un procédé de recalage sur une pluralité d’amers lors de la géolocalisation d’un dispositif mobile se déplaçant selon une pluralité de positions, comprenant les étapes suivantes : - dans chaque position intermédiaire du dispositif mobile, acquisition (110) d’au moins une mesure de visée relative à l’un des amers et d’une mesure de vitesse du dispositif mobile dans cette position ; - dans une position, dite dernière position, postérieure à chacune des positions intermédiaires, détermination (120) d’une position différentielle pour chaque position intermédiaire par rapport à la dernière position et d’une incertitude associée à cette position, à partir des mesures de vitesse correspondantes ; - détermination (130) de la dernière position à partir des positions différentielles, des mesures de visée et des incertitudes associées à ces positions différentielles, en utilisant une fonction d’observation prédéterminée. Figure pour l'abrégé : Figure 2 Procédé de recalage sur une pluralité d’amers, produit programme d'ordinateur et dispositif de recalage associés La présente invention concerne un procédé de recalage sur une pluralité d’amers. La présente invention concerne également un produit programme d'ordinateur et un dispositif de recalage associés à ce procédé de recalage. Plus particulièrement, l’invention est applicable lors de la géolocalisation d’un dispositif mobile, notamment d’un engin mobile tel qu’un véhicule ou un aéronef, à l’aide des amers. Par « amer », on entend tout objet naturel ou artificiel repérable par le dispositif mobile et dont la position est connue ou déterminable. Selon des méthodes déjà connues dans l’état de la technique, il est possible de géolocaliser un dispositif mobile ou de recaler sa position déterminée par un autre moyen, en utilisant une pluralité d’amers. Pour ce faire, le dispositif mobile est généralement apte à mesurer des directions (azimuts ou gisements) par rapport aux amers et/ou des distances jusqu’à ceux-ci. Ainsi, en analysant ces mesures et les positions connues des amers, il est possible généralement de déterminer ou de préciser la position du dispositif mobile. Les méthodes de géolocalisation par amers restent ainsi utilisables lorsque par exemple la géolocalisation par un système GNSS (de l’anglais « Global Navigation Satellite System ») est difficile ou non-souhaitable, ou lorsque par exemple il est nécessaire de déterminer la position du dispositif mobile en utilisant plusieurs sources redondantes. En outre, en cas d’utilisation par exemple des mesures inertielles pour géolocaliser le dispositif mobile, il est possible de recaler ces mesures en utilisant la géolocalisation par amers. Pour effectuer un recalage sur les amers selon les méthodes existantes, les mesures de visée par rapport à ces amers doivent généralement être prises lorsque le dispositif mobile est à l’arrêt. On conçoit alors que cela impose de nombreuses contraintes sur l’utilisation de ces méthodes ou les rend parfois inutilisables, lorsque l’arrêt du dispositif mobile n’est pas souhaitable ou n’est pas possible. Cela est notamment le cas de certains types de véhicule ou de missions dans lesquelles ces véhicules sont utilisables. La présente invention a pour but de proposer une méthode permettant d’effectuer un recalage sur amers d’un dispositif mobile lors de son déplacement, sans nécessité de prise des mesures à l’arrêt. À cet effet, l’invention a pour objet un procédé de recalage sur une pluralité d’amers lors de la géolocalisation d’un dispositif mobile se déplaçant selon une pluralité de positions, comprenant les étapes suivantes : - dans chaque position intermédiaire du dispositif mobile, acquisition d’au moins une mesure de visée relative à l’un des amers et d’une mesure de vitesse du dispositif mobile dans cette position ; - dans une position, dite dernière position, postérieure à chacune des positions intermédiaires, détermination d’une position différentielle pour chaque position intermédiaire par rapport à la dernière position et d’une incertitude associée à cette position, à partir des mesures de vitesse correspondantes ; - détermination de la dernière position à partir des positions différentielles, des mesures de visée et des incertitudes associées à ces positions différentielles, en utilisant une fonction d’observation prédéterminée. Suivant d’autres aspects avantageux de l’invention, le procédé comprend des caractéristiques suivantes, prise(s) isolément ou suivant toutes les combinaisons techniquement possibles : - chaque position intermédiaire suivante correspond à la position du dispositif mobile à l’instant retardé d’une même valeur d’échantillonnage par rapport à l’instant correspondant à la position intermédiaire précédente ; - chaque position différentielle est déterminée en appliquant un filtre de Kalman de façon rétrograde à partir de la dernière position ; - ledit filtre de Kalman correspond à un modèle de vitesse sensiblement constante utilisant un bruit d’accélération instantanée gaussien centré ; - en absence de bruit, la fonction d’observation relie chaque position à une valeur théorique de la mesure de visée dans cette position ; - la dernière position est déterminée en appliquant un estimateur du maximum de vraisemblance aux positions différentielles, aux mesures de visée, aux incertitudes associées à ces positions différentielles et à des bruits de mesure. - chaque mesure de visée correspond à une mesure de direction d’un amer ou à une mesure de distance jusqu’à un amer à partir du dispositif mobile. La présente invention a également pour objet un produit programme d'ordinateur comportant des instructions logicielles qui, lorsque mises en œuvre par un équipement informatique, mettent en œuvre le procédé tel que défini précédemment. La présente invention a également pour objet un dispositif de recalage sur une pluralité d’amers lors de la géolocalisation d’un dispositif mobile, comprenant des moyens techniques adaptés pour mettre en œuvre le procédé tel que défini précédemment. Ces caractéristiques et avantages de l’invention apparaitront à la lecture de la description qui va suivre, donnée uniquement à titre d’exemple non limitatif, et faite en référence aux dessins annexés, sur lesquels : - la est une vue schématique d’un dispositif de recalage selon l’invention ; - la est un organigramme d’un procédé recalage selon l’invention, le procédé étant mis en œuvre par le dispositif de recalage de la figure 1 ; et - la est une vue schématique illustrant la mise en œuvre de l’une des étapes du procédé de la . On a en effet représenté sur la , un dispositif de recalage 10 selon l’invention apte à déterminer ou à préciser la position d’un dispositif mobile 12 à chaque instant. Le dispositif mobile 12 est apte à se déplacer par exemple selon deux ou trois degrés de liberté par exemple dans un repère terrestre. Selon un exemple de réalisation, le dispositif mobile 12 est un engin mobile, tel que par exemple un véhicule terrestre ou un aéronef, embarquant le dispositif de recalage 10. Dans le cas d’un aéronef, il peut s’agir d’un avion ou d’un hélicoptère pilotable par un opérateur et/ou par un système avionique à partir de celui-ci, ou d’un drone pilotable à partir d’un centre de contrôle distant par un opérateur et/ou par un système avionique adapté. Selon un autre exemple de réalisation, le dispositif mobile 12 est porté par un opérateur ou par tout autre utilisateur et présente par exemple un téléphone portable. Dans ce cas, le dispositif de recalage 10 est par exemple intégré dans le dispositif mobile 12. Le dispositif de recalage 10 est apte à déterminer la position du dispositif mobile 12 en utilisant des mesures de visée prises par rapport aux amers 14-1,…,14-N par au moins certains des capteurs d’une pluralité de capteurs 16. Chaque amer 14-1,…,14-N présente un objet naturel ou artificiel disposé par exemple de manière fixe sur la surface terrestre selon une position connue avec une précision également connue et repérable depuis le dispositif mobile 12. Ainsi, chaque amer présente par exemple un pylône, une éolienne, un phare, un bâtiment, une montagne, un rocher, etc. Chaque amer 14-1,…,14-N est par exemple identifiable par un identifiant qui lui est propre. En outre, selon un mode de réalisation particulier de l’invention, l’identifiant de chaque amer 14-1,…,14-N permet d’obtenir sa position en utilisant par exemple une base de données de positions prévue à cet effet. Une telle base de données peut être publiquement accessible ou alors, présenter un accès restreint. Au moins certains des capteurs 16 sont aptes à déterminer des mesures de visée en relation avec chacun des amers 14-1,…,14-N. Avantageusement selon l’invention, chaque mesure de visée déterminée par les capteurs 16 correspondants correspond à une mesure de direction ou à une mesure de distance. Chaque mesure de direction correspond à une mesure d’azimut ou à une mesure de site ou à une mesure de gisement relative à l’un des amers 14-1,…,14-N. Une telle mesure est par exemple déterminée par l’un des capteurs 16 en utilisant des mesures optiques et dans le cas d’une mesure d’azimut, en comparant ces mesures avec le cap du dispositif mobile 12 ou avec une direction fixe dans l’espace. Chaque mesure de visée correspond à une mesure de distance entre le dispositif mobile 12 et l’un des amers 14-1,…,14-N. Une telle mesure est réalisée par l’un des capteurs 16 comprenant par exemple un radar ou un laser ou tout autre dispositif de télémétrie connu en soi. Au moins un des capteurs 16 est apte à déterminer une mesure de vitesse du dispositif mobile 12. Ce capteur présente par exemple une centrale inertielle ou tout autre capteur adapté. Comme cela est visible sur la , le dispositif de recalage 10 comprend un module d’entrée 21, un module de calcul 22 et un module de sortie 23. Le module d’entrée 21 est connecté aux capteurs 16 et est apte à acquérir l’ensemble des mesures déterminées par ces capteurs 16. Le module de calcul 22 est apte à analyser les données acquises par le module d’entrée 21 afin de fournir un résultat déterminant ou précisant la position du dispositif mobile 12. Enfin, le module de sortie 23 est apte à fournir le résultat déterminé par le module de calcul 22 à tout système intéressé. Par exemple, le module de sortie 23 est apte à fournir à un écran d’affichage la position déterminée du dispositif mobile 12 pour l’afficher. Selon un autre exemple, le module de sortie 23 est apte à fournir cette position par exemple à un dispositif de précision apte à comparer cette position avec celle fournie par exemple par un système de géolocalisation de type GNSS, afin de fournir une position précisée. Chacun des modules 21 à 23 se présente par exemple sous la forme d’un logiciel mis en œuvre par un processeur adapté. En variante, au moins l’un de ces modules 21 à 23 se présente au moins partiellement sous la forme d’un circuit logique programmable, tel qu’un circuit de type FPGA (de l’anglais « Field Programmable Gate Array »). Le procédé de recalage sera désormais expliqué en référence à la présentant un organigramme de ses étapes et à la illustrant la mise en œuvre d’au moins certaines des étapes. Initialement, il est considéré que le dispositif mobile se déplace à proximité des amers 14-1, …, 14-N selon les positions , visibles sur la figure 3. Il est également considéré que la position correspond à la position la plus ancienne du dispositif mobile 12 et la position correspond à la position la plus récente du dispositif mobile 12. Par la suite, les positions seront appelées positions intermédiaires et la position sera appelée dernière position. Il est considéré en outre que les positions correspondent à des positions successives du dispositif mobile 12 à l’issu d’un même intervalle temporel. Cet intervalle temporel est appelé par la suite valeur d’échantillonnage . Dans l’exemple décrit, chaque position se présente par exemple sous la forme d’un vecteur bidimensionnel. Pour chacune de ces positions, il est possible de définir un vecteur d’état ( ) composé de cordonnées du dispositif mobile 12 dans cette position et de la vitesse du dispositif mobile 12 dans cette position. Lors de l’étape 110, mise en œuvre dans chaque position intermédiaire , le module d’entrée 21 acquiert au moins une mesure de visée relative à l’un des amers 14-1, …, 14-N et une mesure de vitesse en utilisant les capteurs 16. L’ensemble de ces mesures sont ensuite transmises au module de calcul 22. L’étape suivante 120 est mise en œuvre lorsque le dispositif mobile 12 est dans la dernière position . Lors de cette étape 120, le module de calcul 22 détermine une position différentielle pour chaque position intermédiaire par rapport à la dernière position . En particulier, chaque position différentielle correspond à la différence de la position intermédiaire et la dernière position . Autrement dit, . Dans l’exemple décrit, chaque position différentielle est déterminée en appliquant un filtre de Kalman de façon rétrograde à partir de la dernière position . Ce filtre de Kalman correspond par exemple à un modèle de vitesse sensiblement constante utilisant un bruit d’accélération instantanée gaussien centré. Ce modèle est connu sous le terme anglais de « Nearly Constant Velocity » ou « NCV ». Selon ce modèle, le vecteur d’état pour chaque position suivante peut être exprimé via le vecteur d’état de la position précédente, une matrice d’évolution et un bruit de modèle , appelé également bruit de position ou incertitude associée à la position différentielle , en utilisant la relation suivante : Comme indiqué précédemment, chaque vecteur d’état comprend la vitesse et la position du dispositif mobile 12 dans la position correspondante. Cette vitesse peut alors être estimée par la mesure de vitesse correspondante. Dans le cas bidimensionnel, la matrice d’évolution et la matrice de covariance du bruit de modèle prennent respectivement les formes suivantes : Par la suite, l’estimation de chaque position différentielle obtenue lors de cette étape sera dénotée . Lors de l’étape 130 suivante, le module de calcul 22 détermine la dernière position à partir des positions différentielles , des mesures de visée et des incertitudes associées à ces positions différentielles, en utilisant une fonction d’observation prédéterminée . En particulier, en fonction du type de mesure de visée considéré, la fonction d’observation est choisie de sorte que sa valeur dans la position du dispositif mobile 12 soit égale à une mesure de visée théorique qui serait obtenue en absence de bruit. Autrement dit, la fonction d’observation relie la position du dispositif mobile 12 à la mesure de visée prise dans cette position via la relation suivante : où est le bruit de position tel que défini précédemment; et est le bruit de mesure. Cette dernière relation peut être linéarisée sous la forme suivante : où est une première estimation de la dernière position qui peut être choisie aléatoirement ou correspondre à la dernière position connue du dispositif mobile 12 ou déterminée par une heuristique quelconque. Il est possible de déterminer pour cette dernière relation une covariance globale sur la mesure de visée avec l’expression suivante : où : est la matrice de covariance du bruit de position est la matrice de covariance du bruit de mesure La dernière position du dispositif mobile 12 est alors obtenue en utilisant un estimateur du maximum de vraisemblance exploitant l’ensemble des mesures et leur covariance globale. En particulier, pour déterminer la dernière position , il est possible d’appliquer un algorithme de type Gauss-Newton au critère des moindres carrés suivant, portant sur l’ensemble des mesures de visée : À la fin de cette étape 130, le module de calcul 22 transmet la dernière position au module de sortie 23 qui la transmet à tout système intéressé. Par la suite, le procédé selon l’invention peut être réitéré au fur et à mesure de l’avancement du dispositif mobile 12. Dans ces cas, à chaque itération du procédé, sa dernière position correspondra à la position du dispositif mobile au moment de la mise en œuvre de l’étape 120. Ainsi, à chaque itération du procédé, la trajectoire du dispositif mobile peut être recalée par rapport aux amers. On conçoit alors que la présente invention présente un certain nombre d’avantages. Tout d’abord, selon l’invention, le recalage sur les amers peut être effectué au fur et à mesure du déplacement du dispositif mobile, aucun arrêt n’est nécessaire pour le faire. Pour cela, outre les mesures de visée prises par rapport aux amers, seulement des mesures de vitesse du dispositif mobile sont nécessaires. Enfin, le recalage s’effectue en prenant en compte les bruits de mesure ce qui le rend particulièrement précis. Procédé de recalage sur une pluralité d’amers (14-1, …, 14-N) lors de la géolocalisation d’un dispositif mobile (12) se déplaçant selon une pluralité de positions ( ), comprenant les étapes suivantes : - dans chaque position intermédiaire ( ) du dispositif mobile (12), acquisition (110) d’au moins une mesure de visée ( ) relative à l’un des amers (14-1, …, 14-N) et d’une mesure de vitesse du dispositif mobile (12) dans cette position ; - dans une position, dite dernière position ( ), postérieure à chacune des positions intermédiaires ( ), détermination (120) d’une position différentielle ( ) pour chaque position intermédiaire ( ) par rapport à la dernière position ( ) et d’une incertitude ( ) associée à cette position, à partir des mesures de vitesse correspondantes ; - détermination (130) de la dernière position ( ) à partir des positions différentielles ( ), des mesures de visée ( ) et des incertitudes ( ) associées à ces positions différentielles, en utilisant une fonction d’observation ( ) prédéterminée. Procédé selon la revendication 1, dans lequel chaque position intermédiaire ( ) suivante correspond à la position du dispositif mobile (12) à l’instant retardé d’une même valeur d’échantillonnage ( ) par rapport à l’instant correspondant à la position intermédiaire ( ) précédente. Procédé selon l’une quelconque des revendications précédentes, dans lequel chaque position différentielle ( ) est déterminée en appliquant un filtre de Kalman de façon rétrograde à partir de la dernière position ( ). Procédé selon la revendication 3, dans lequel ledit filtre de Kalman correspond à un modèle de vitesse sensiblement constante utilisant un bruit d’accélération instantanée gaussien centré. Procédé selon l’une quelconque des revendications précédentes, dans lequel, en absence de bruit, la fonction d’observation ( ) relie chaque position ( ) à une valeur théorique de la mesure de visée ( ) dans cette position. Procédé selon l’une quelconque des revendications précédentes, dans lequel la dernière position ( ) est déterminée en appliquant un estimateur du maximum de vraisemblance aux positions différentielles ( ), aux mesures de visée ( ), aux incertitudes ( ) associées à ces positions différentielles et à des bruits de mesure ( ). Procédé selon l’une quelconque des revendications précédentes, dans lequel chaque mesure de visée ( ) correspond à une mesure de direction d’un amer (14-1, …, 14-N) ou à une mesure de distance jusqu’à un amer (14-1, …, 14-N) à partir du dispositif mobile (12). Produit programme d'ordinateur comportant des instructions logicielles qui, lorsque mises en œuvre par un équipement informatique, mettent en œuvre le procédé selon l’une quelconque des revendications précédentes. Dispositif de recalage (10) sur une pluralité d’amers (14-1, …, 14-N) lors de la géolocalisation d’un dispositif mobile (12), comprenant des moyens techniques (21, 22, 23) adaptés pour mettre en œuvre le procédé selon l’une quelconque des revendications 1 à 8.