Brevet FR3091777A1 — publié le 20200717

Description Titre de l'invention : Méthode de détermination d'un rayon de protection d'un système de navigation basé sur la vision Domaine technique de l'invention [0001] L'invention se situe dans le domaine des systèmes de navigation basés sur la vision destinés à être utilisés pour déterminer le déplacement et/ou le positionnement de corps en mouvement tels que des véhicules (automobiles, avions ...), des drones, des robots, des dispositifs portables ... [0002] L'invention concerne plus précisément la problématique de la détermination de l'intégrité d'un système de navigation basé sur la vision, définie par un rayon de protection. Etat de la technique [0003] Parmi les systèmes de navigation connus, il existe les systèmes de navigation globale par satellite (connus sous l'acronyme « GNSS » de « Global Navigation Satellite System »), comme par exemple le système de positionnement global connu sous l'acronyme « GPS » (pour « Global Positioning System »), qui peuvent être utilisés pour fournir des informations de navigation, par exemple, la position et la vitesse d'un véhicule, d'un robot, d'un dispositif portable, plus généralement de tout corps en mouvement ou de tout corps dont on souhaite connaître la position. [0004] Il existe également les systèmes de navigation par inertie (connus sous l'acronyme « INS » pour « Inertial Navigation System ») qui sont des systèmes de navigation embarqués sur un porteur permettant de recueillir des informations sur la position du porteur, l'altitude, l'attitude et la vitesse à partir de capteurs inertiels, généralement au moins un capteur d'accélération (accéléromètre) et au moins un capteur de rotation (gyromètre). Un inconvénient des systèmes de navigation par inertie réside dans des erreurs des capteurs lors de l'estimation de la rotation et de l'accélération (biais, dérives, bruits, facteurs d'échelle, non-linéarité, défauts d'alignement, etc.) qui induisent dans le temps des dérives sur l'estimation de la position. [0005] Les systèmes de navigation peuvent être utilisés seuls ou combinés entre eux. On pourra parler dans ce cas de systèmes hybrides. Par exemple un système à inertie pourra être utilisé en complément d'un système de navigation par satellite, notamment pour pallier une perte d'un ou de plusieurs satellites, ou inversement pour pallier les dérives des systèmes de navigation inertiel. [0006] Malgré cela, la navigation par système hybride INS/GNSS présente l'inconvénient d'être susceptible à des phénomènes qui dégradent sa performance ou qui invalident complètement son utilisation, tels que le masquage de satellites ou le brouillage des 2 signaux émis par les satellites ... [0007] De fait, il est de plus en plus courant d'utiliser des systèmes de navigation basés sur la vision. [0008] Il existe des systèmes de navigation basés sur la vision dits « embarqués » qui com- prennent généralement au moins une caméra disposée sur un corps dont on souhaite connaître le mouvement et/ou la position, par exemple un véhicule, un drone, un robot, un dispositif portable. Le corps peut être nommé « porteur ». Chaque caméra est utilisée pour capturer des images qui sont ensuite traitées par un calculateur afin de fournir des informations sur la vitesse, la trajectoire du porteur et/ou sur sa position. Le calculateur identifie des points caractéristiques (ou points d'intérêt) sur au moins une image et met en correspondance les points caractéristiques entre les images. Ainsi, la mise en correspondance des points caractéristiques entre les images est utilisée, par exemple, pour déterminer une translation et/ou une rotation relative entre les images. [0009] Il existe également des systèmes de navigation basés sur la vision dits « fixes » pour lesquels la caméra n'est pas disposée sur le corps dont on souhaite connaître le mouvement. Dans ce cas, chaque caméra doit viser le corps en mouvement et le calculateur identifie des points caractéristiques du corps en mouvement entre les images. [0010] Que cc soit pour un système embarqué ou fixe, on peut donc utiliser une ou plusieurs caméras, ou utiliser tout autre capteur apte à réaliser des images, par exemple un radar (on peut parler dans ce cas d'images radar) comme un radar à synthèse d'ouverture (RS0), ou un capteur IR (on peut parler dans ce cas d'images Infra-Rouge). [0011] Cette technique de navigation basée sur la vision peut être nommée « odométrie visuelle » dans la présente description. Ainsi, à partir d'un simple capteur apte à réaliser des images, on peut extraire des informations permettant d'obtenir notamment une translation et une rotation entre au moins deux images, et de remonter au déplacement et/ou à la position d'un corps en mouvement. Un avantage d'un système de navigation basé sur la vision est sa furtivité, et le fait qu'il ne peut pas être masqué ou brouillé. [0012] La navigation basée sur la vision peut être utilisée seule ou en combinaison avec un autre système de navigation, par exemple avec un système de navigation par satellite et/ou avec un système de navigation par inertie (on peut par exemple disposer sur un porteur une ou plusieurs caméras et un ou plusieurs capteurs inertiels). [0013] Dans tout système de navigation, un enjeu majeur est de connaître l'intégrité dudit système. Dans le domaine de l'invention, l'intégrité représente le degré de confiance que l'on peut placer dans l'exactitude des informations fournies par un système de navigation. En complément, l'intégrité peut également représenter la capacité à avertir l'utilisateur d'un dysfonctionnement dudit système dans un délai raisonnable. [0014] Dans le cas d'un système GNSS ou d'un hybride GNSS/INS, il peut se produire un 3 évènement tel une défaillance dudit système, un brouillage ou un masquage d'un satellite. Un tel évènement se traduit généralement par l'apparition d'une erreur sur les informations de localisation fournies par le système, également nommée « défaillance de positionnement ». Dans des applications comme l'aviation où la fiabilité des informations de position est cruciale, de telles défaillances de positionnement d'un système de navigation doivent impérativement être gérées. [0015] La mesure de l'intégrité d'un système est généralement réalisée en définissant des bornes d'alerte. On dit qu'il y a une défaillance de positionnement lorsque la différence entre la position réelle du corps et celle fournie par le système de navigation dépasse les bornes d'alerte définies. [0016] Les homes d'alertes désignent les erreurs de position maximales que le système peut commettre en respectant les contraintes d'intégrité. Ces bornes sont définies pour l'erreur de position horizontale et verticale : elles sont nommées respectivement « HAL » (pour « Horizontal Alcrt Limit » en anglais) ou « HPL » (pour « Horizontal protection level » en anglais), ainsi que « VAL» (pour « Vertical Alcrt Limit » en anglais) and « VPL » (pour « Vertical Protection Lcvcl » en anglais). En ce qui concerne l'erreur de position horizontale, on peut également parler de « rayon de protection ». [0017] La mesure de l'intégrité d'un système peut être complétée par un temps d'alerte. Lc temps d'alerte ou « TTA » (pour « Timc-To-Alert » en anglais) est l'intervalle de temps maximum autorisé entre l'instant où le système ne satisfait plus aux exigences opérationnelles du type d'opération et l'instant où le système indique une alerte de navigation. [0018] Si le calcul du rayon de protection a été abordé pour le cas de la navigation GPS, ou encore de la navigation hybridée inertie/GPS, il n'existe pas encore de méthode satisfaisante pour déterminer un rayon de protection d'un système de navigation par vision, notamment du fait de la nature des mesures et des calculs qui sont très différentes entre une navigation par satellite et une navigation par vision. En effet, les systèmes de navigation par satellite déterminent le positionnement d'un utilisateur possédant un récepteur GNSS, à partir d'ondes radioélectriques émises par des satellites en orbite dans l'espace. La position des satellites est connue. La position du récepteur est calculée par trilatération à partir des mesures de distance séparant l'utilisateur des satellites en vue du récepteur. Dans le cas de la navigation par vision en revanche, il n'existe pas d'émission d'ondes, ni d'émission de toute autre donnée de la part du corps en mouvement. En outre, dans un système embarqué, on ne connaît pas la position de la caméra (puisqu'on recherche justement la position du porteur de caméra). Le principe de la navigation par vision étant tout à fait différent de celui de la navigation par satellite, il n'est pas évident, voire il est impossible, d'appliquer à un système de navigation par vision les méthodes de détermination du rayon de protection utilisées pour un système satellite. [0019] L'invention vise à disposer d'une méthode de détermination de l'intégrité, et en par- ticulier de déterminer un rayon de protection pour un système de navigation par vision. [0020] De manière avantageuse, l'invention vise à disposer d'une méthode permettant de dé- terminer de manière précise un rayon de protection. [0021] De manière avantageuse, l'invention vise à disposer d'une méthode simple à mettre en oeuvre, rapide et adaptable à toute méthode de traitement d'un système de navigation par vision, et tout système de navigation par vision. Exposé de l'invention [0022] Un premier objet de l'invention permettant d'atteindre cc but est une méthode dc dé- termination d'un rayon dc protection d'un système de navigation par vision, ledit système comprenant : - au moins un capteur d'images apte à réaliser au moins une première image à un premier instant et une deuxième image à un deuxième instant ; et - une unité de traitement couplée à chaque capteur d'images et apte à implémenter une méthode de traitement apte à déterminer au moins une valeur de mouvement entre le premier instant et le deuxième instant à partir de la première image, dc la deuxième image et d'une pluralité de données images déterminées sur les au moins première et deuxième images ; ladite méthode de détermination d'un rayon de protection comprenant les étapes suivantes : - une première étape de détermination de valeurs nominales d'incertitude de la au moins une valeur dc mouvement obtenue par la méthode de traitement pour un système comprenant la pluralité dc données images déterminées ; - une seconde étape de détermination de i-èmcs sous-valeurs d'incertitude de la au moins une valeur dc mouvement déterminée par la méthode dc traitement pour un i-Crue sous-système défini en enlevant une partie des données image déterminées ; - une troisième étape de détermination d'un i-èmc rayon dc protection pour le i-èmc sous-système à partir des i-èmes sous-valeurs d'incertitude et des valeurs nominales d'incertitude ; les seconde et troisième étapes étant réitérées pour chaque i-ème sous-système, i variant entre 1 et une valeur M définie ; - une quatrième étape de détermination d'un rayon de protection à partir des M i-ème rayons de protection déterminés. [0023] L'invention permet de déterminer un rayon de protection pour un système de na- vigation par vision. La précision de cette détermination dépend du nombre M et de la sélection des sous-systèmes, qui peuvent être déterminés en fonction du système de navigation (et donc de la méthode de traitement) mis en oeuvre. [0024] Plus généralement, la méthode selon l'invention peut s'adapter en fonction du système de navigation mis en oeuvre, puisque le principe de la méthode est de calculer des incertitudes des valeurs de mouvement obtenues par la méthode de traitement (quelle que soit la méthode). Le mode de calcul de ces incertitudes peut sc faire de différentes manières, et l'homme du métier oeuvrant dans le domaine de l'invention saura adapter le mode de calcul des incertitudes en fonction de la méthode de traitement utilisée. Des modes de calculs sont donnés plus après dans la description détaillée, niais ne sont pas limitatifs. [0025] En outre, le principe de la méthode de détermination d'un rayon de protection est simple et la rapidité de calcul dépend notamment du nombre de sous-systèmes sélectionnés (et donc de la précision recherchée). La précision recherchée dépend notamment du secteur auquel le système de navigation est destiné. [0026] De préférence, la quatrième étape de détermination est réalisée en prenant le plus grand parmi les i-èmes rayons de protection déterminés. En d'autres ternies, le rayon de protection est choisi comme étant le plus grand parmi les i-èmes rayons de protection déterminés. [0027] Selon un mode de réalisation, la troisième étape de détermination comprend : - une première sous-étape de détermination des i-èmes différences entre les i-emes sous-valeurs d'incertitude et les valeurs nominales d'incertitude ; et - une seconde sous-étape de détermination d'un i-ème écart-type des différences comme étant la plus grande valeur d'écart-type des i-èmes différences ; le i-ème rayon de protection étant déterminé à partir du i-ème écart-type des différences. [0028] Selon un mode de réalisation, la troisième étape de détermination comprend en outre : - une troisième sous-étape de calcul d'un i-ème écart-type des différences colligé, comme étant le i-ème écart-type des différences multiplié par une première constante de pondération ; le i-ème rayon de protection étant déterminé à partir du i-ème écart-type des différences corrigé. [0029] Selon un mode de réalisation particulier, la valeur de la première constante de pon- dération est obtenue à partir de la probabilité de fausse alarme du système de navigation par vision, par exemple en utilisant une fonction inverse de probabilité de densité de la distribution. [0030] Selon un mode de réalisation, la troisième étape de détermination comprend en outre : 6 - une quatrième sous-étape de détermination d'un i-ème écart-type du i-ème sous- système comme étant la plus grande valeur d'écart-type des i-èmes sous-valeurs d'incertitude ; le i-ème rayon de protection étant déterminé à partir d'une somme entre le i-ème écart-type des différences ou le i-ème écart-type des différences corrigé et le i-ème écart-type. [0031] Selon un mode de réalisation, la troisième étape de détermination comprend en outre : - une cinquième sous-étape de détermination d'un i-ème écart-type corrigé, comme étant le i-ème écart-type multiplié par une seconde constante de pondération ; le i-ème rayon de protection étant déterminé à partir d'une somme entre le i-ème écart-type des différences ou le i-ème écart-type des différences corrigé et le i-ème écart-type corrigé. [0032] Selon un mode de réalisation particulier, la valeur de la seconde constante de pon- dération est obtenue à partir de la probabilité de non-détection du système de navigation par vision, par exemple en utilisant une fonction inverse de probabilité de densité de la distribution. [0033] Selon un mode de réalisation, les valeurs d'incertitude d'au moins une valeur de mouvement obtenue par la méthode de traitement sont définies par une matrice de covariance de ladite valeur de mouvement. [0034] Selon un mode de réalisation, les valeurs d'incertitude d'au moins une valeur de mouvement obtenue par la méthode de traitement sont déterminées en propageant le bruit au niveau d'au moins une parmi les première et deuxième images sur les grandeurs intermédiaires nécessaires au calcul par ladite méthode de traitement de ladite valeur de mouvement. [0035] Selon un mode de réalisation, la méthode comprend une étape préalable de déter- mination d'une matrice de covariance de la au moins une valeur de mouvement obtenue par la méthode de traitement, ladite étape préalable comprenant les étapes suivantes : - une première sous-étape de caractérisation d'un bruit au niveau d'au moins une parmi la première et la deuxième image de manière à obtenir une matrice de covariance dudit bruit ; et - au moins une sous-étape complémentaire de propagation de la matrice de covariance du bruit obtenue sur le ladite valeur de mouvement, ladite au moins une sous-étape complémentaire étant apte à propager la matrice de covariance du bruit sur les grandeurs intermédiaires nécessaires au calcul de la au moins une valeur de mouvement par la méthode de traitement. [0036] Selon un mode de réalisation, la méthode de traitement comprend les étapes 7 suivantes : - une première étape d'acquisition d'au moins une première et une seconde images comprenant en outre l'acquisition d'au moins une troisième image ; - une deuxième étape de détermination d'au moins une valeur de mouvement intermédiaire entre au moins une première et une deuxième image, comprenant une sous-étape de sélection de points d'intérêt communs auxdites première et seconde images ; - une troisième étape de détermination de points dans l'espace correspondant à dès points d'intérêt communs aux première et seconde images ; - une quatrième étape de détermination de la au moins une valeur de mouvement finale à partir des points dans l'espace déterminés et de points d'intérêt dans la au moins une troisième image ; et la au moins une sous-étape complémentaire de propagation de la matrice de covariance du bruit sur la valeur de mouvement comprend : - une sous-étape de propagation de la matrice de covariance du bruit à la au moins une valeur de mouvement intermédiaire ; - une sous-étape de propagation de la matrice de covariance de la au moins une valeur de mouvement intermédiaire aux points dans l'espace ; - une sous-étape de propagation de la matrice de covariance des points dans l'espace à la au moins une valeur de mouvement finale. [0037] Selon un mode de réalisation, au moins une valeur de mouvement est une valeur de rotation et/ou une valeur de translation. [0038] Selon un mode de réalisation, les données images comprennent des coordonnées d'une pluralité de points d'intérêt sur au moins les première et deuxième images. [0039] Sauf indication contraire, les différents modes de réalisation peuvent être combinés entre eux. [0040] Un second objet de l'invention concerne une méthode de traitement apte à calculer au moins une valeur de mouvement entre un premier instant et un deuxième instant à partir d'une première image prise au premier instant, d'une deuxième image prise au deuxième instant et d'une pluralité de données image déterminées sur les au moins première et deuxième images, comprenant en outre une méthode de détermination d'un rayon de protection selon l'invention. [0041] Un troisième objet de l'invention concerne également un système de navigation par vision comprenant : - au moins un capteur d'images apte à réaliser au moins une première image à un premier instant et une deuxième image à un deuxième instant ; et - une unité de traitement couplée au capteur d'images et apte à implémenter la méthode de traitement selon l'invention. [0042] Selon l'invention, on définit par « méthode de traitement » une méthode de 8 traitement d'image et de calcul apte à déterminer des valeurs de mouvement, par exemple de translation et/ou de rotation, d'un corps à partir d'images acquises par au moins un capteur d'images. Ledit capteur d'images peut être soit positionné au niveau du corps en mouvement (alors « porteur »), soit disposé de manière à pouvoir viser le corps en mouvement. [0043] Le système de navigation basé sur la vision peut comprendre un ou plusieurs capteurs d'images. [0044] Les images acquises par le ou les capteurs d'images fournissent des données image. [0045] La méthode de traitement est configurée pour exploiter ces données images. Les données images peuvent être obtenues à partir de points images caractéristiques qui peuvent être mis en correspondance entre au moins deux images. Dans l'ensemble de la description, de tels points images caractéristiques peuvent être nommés « points d'intérêt ». [0046] Ainsi, lorsqu'on enlève des données images, cela peut signifier par exemple qu'on ne tient pas compte d'un capteur d'images (typiquement d'une ou de plusieurs images obtenues à partir d'un capteur d'image), et/ou de points d'intérêt. [0047] Par « point image », on entend des points ou pixels d'une image, donc définis sur un plan. Ils comprennent deux coordonnées (sur le plan de l'image). Dans l'ensemble de la description, on pourra désigner les points image par des points «2D ». [0048] Par opposition, on désigne par « points 3D» des points dans l'espace et non seulement dans un plan et qui comprennent donc trois coordonnées. [0049] Selon l'invention, le système de navigation basé sur la vision doit être compris comme intégrant une méthode de traitement. Brève description des figures [0050[ D'autres caractéristiques et avantages de l'invention apparaîtront à l'aide de la des- cription qui suit, donnée à titre illustratif et non limitatif, faite en regard des figures annexées parmi lesquelles : [0051] [fig.1] représente un système de navigation basé sur la vision ; [0052] [fig.2] représente un système de navigation basé sur la vision intégrant un calculateur d'intégrité ; [0053] [fig.3] représente une image traitée avec un algorithme de Harris pour déterminer des points d'intérêts ; [0054] [fig.4] représente une corrélation réalisée entre deux images ; [0055] [fig.5] illustre la géométrie épipolaire ; [0056] [fig.6] représente la corrélation de la [Fig.4], des points non corrélés étant éliminés ; [0057] [fig.7] illustre un calcul d'un rayon de protection d'un sous-système ; [0058] [fig.8] illustre sous forme de logigramme un exemple d'algorithme de vision incluant 9 un exemple de méthode de détermination d'un rayon de protection. Description détaillée de l'invention [0059] Dans la description détaillée de l'invention qui suit, l'invention est appliquée à un système de navigation basé sur la vision qui est embarqué sur un porteur et qui utilise une caméra monoculaire. Le système de vision monoculaire est moins coûteux en matériel, ainsi qu'en acquisition et traitement de données. [0060] La longueur d'onde, la bande de fréquence, et d'autres caractéristiques de la caméra le cas échéant, peuvent varier en fonction de l'implémentation et du mode (l'utilisation spécifiques de ladite caméra. [0061] Tout autre capteur d'images adapté peut être utilisé, par exemple une caméra bi- noculaire, un capteur de détection de la lumière et de télémétrie (LiDAR), un capteur de détection et de télémétrie radio à ondes millimétriques (RADAR), ou encore un imageur Infra-Rouge (« IR »). Plusieurs capteurs peuvent être combinés. [0062] L'invention peut être appliquée à système de navigation basé sur la vision fixe (au lieu d'un système embarqué). [0063] Les mouvements déterminés dans la description détaillée sont la rotation et la translation et le système de navigation par vision est basé sur les points d'intérêt. Les données images comprennent les coordonnées sur les plans image de ces points d'intérêt. [0064] Dans la suite de la description, la rotation et/ou la translation déterminés à partir de points images sont désignés par rotation et/ou translation « 2D-2D ». Par opposition, la rotation et/ou la translation déterminés à partir de points images et de points dans l'espace sont désignés par rotation et/ou translation « 3D-2D ». [0065] En pratique, la finalité de la méthode de traitement décrite ci-après est de déterminer une valeur de mouvement 3D-2D, par exemple la rotation et/ou la translation 3D-2D, qui est ainsi une grandeur finale, alors qu'une valeur de mouvement 2D-2D, par exemple la rotation et/ou la translation 2D-2D, est une grandeur intermédiaire nécessaire pour le calcul de la (ou des) grandeur(s) finale(s). [0066] Il faut comprendre que d'autres modes de réalisation peuvent être utilisés et notamment que des modifications logiques peuvent être effectuées. En outre, les modes de réalisations présentés dans la description détaillée de l'invention ne doivent pas être interprétés comme limitant l'ordre des étapes et sous-étapes. La description détaillée qui suit ne doit donc pas être interprétée comme limitative. [0067] Un système de navigation basé sur la vision comprend généralement les éléments illustrés en figure 1 : - un capteur d'image 10 disposé sur un porteur et permettant de réaliser au moins une première image Il à un premier instant tl et une deuxième image 12 à un deuxième instant t2 ; - une unité de traitement 20 couplée au capteur d'image 10 et apte à implémenter une méthode de traitement apte à calculer une translation t et/ou une rotation R du porteur (ou plus généralement un mouvement) entre le premier instant tl et le deuxième instant t2 à partir de la première image 11 et de la deuxième image 12 ; - une unité d'affichage 40 permettant d'afficher la translation t et la rotation R calculées. [0068] La méthode de traitement peut être sous la forme d'un algorithme et peut également être nommée par simplification « algorithme de navigation par vision » ou « algorithme de vision » dans la présente description. [0069] La méthode de traitement 50 comprend les étapes suivantes, illustrées notamment en figure 8 : - une première étape 100 d'acquisition et/ou de traitement d'au moins une première image Il prise à un premier instant tl et une deuxième image 12 prise à un deuxième instant t2 ; - une deuxième étape 200 de détermination de la rotation et de la translation intermédiaires entre la première image Il et la deuxième image 12 (rotation et translation « 2D-2D »); - une troisième étape 300 d'obtention de premiers points 3D à partir des première et deuxième images ; - une quatrième étape 400 de détermination de la rotation et de la translation finales à partir des premiers points 3D obtenus et d'une troisième image 13 prise à un troisième instant t3 (rotation et translation « 3D-2D »). [0070] La première étape 100 d'acquisition et/ou de traitement des images peut être réalisée avant la seconde étape 200 et peut également être réalisée avant la quatrième étape 400. Plus généralement elle peut être réalisée plusieurs fois et/ou à tout moment dans le déroulement de la méthode de traitement. Elle permet d'acquérir au moins une première et une seconde image, et peut permettre également l'acquisition d'au moins une troisième image. [0071] La première étape 100 peut comprendre une sous-étape 110 de correction des dis- torsions radiale et/ou tangentielle d'au moins les première et deuxième images. En effet, les images traversant une lentille avant d'arriver au capteur, il peut se produire des distorsions radiales et tangentielles. Il est donc souhaitable d'identifier ces distorsions et de les corriger avant d'utiliser les images aux fins de la navigation. Cette étape peut être également nommée étape de « calibrage » de la caméra. En pratique, cette étape de calibrage consiste en l'acquisition d'images comprenant des points de calibrage dont on tonnait les coordonnées en trois dimensions, auxquels on applique une rotation et une translation. On peut utiliser une image de damier, car les inter- 11 sections entre les cases blanches et noires sont facilement identifiables et donc connues et peuvent en outre former des lignes parfaitement droites. Dans ce cas, on utilise un algorithme qui identifie les paramètres du polynôme passant par les intersections et génère une correction à être appliquée aux images. On peut utiliser par exemple l'algorithme « camera calibration toolbox for Matlab » de J. Y. Bouguct, qui est facile d'utilisation. [0072] La deuxième étape 200 comprend une première sous-étape 210 pour la sélection de points d'intérêt. En effet, pour pouvoir traiter les images, on peut sélectionner des points d'intérêt qui, comme cela a été défini plus avant, sont des points image caractéristiques que l'on retrouve au moins dans la première et la deuxième image, mais qui sont généralement en décalage du fait du déplacement entre les deux images. Les points d'intérêt sont mis en correspondance entre lesdites images pour être comparés, dans le but d'obtenir des valeurs de rotation et de translation les plus précises possible. De nombreuses méthodes existent pour sélectionner des points d'intérêt dans une image : par exemple la méthode « Scale Invariant Feature Transform » (« SIFT »), ou « Speeded Up Rohust Features » (« SURF ») », « Binary Rohust Independent Elementary Features » (« BRIEF »), « Oriented Fast and Rotated Bricf » (« ORB »), « Center Surround Extremas » (« CENSURE »), ou encore l'algorithme de Harris ... [0073] Dans un mode de réalisation préféré, la première sous-étape 210 de sélection des points d'intérêt comprend l'utilisation de l'algorithme de Harris, pour son compromis entre rapidité, précision, et robustesse. L'algorithme de Harris repose sur le principe de détection de coins et d'arêtes. Chaque pixel de l'image est évalué en fonction de son voisinage, et si un pixel a suffisamment de contraste par rapport aux pixels environnants (selon un seuil fixé par l'utilisateur), ledit pixel est retenu comme «point d'intérêt ». La figure 3 montre un exemple d'image traitée avec l'algorithme de Hanis, mettant en évidence les points d'intérêt. Il est possible de limiter le nombre de points d'intérêt, par exemple à une valeur de l'ordre de 1000 points maximum. [0074] De préférence, la deuxième étape 200 peut comprendre une deuxième sous-étape 220 de normalisation des pixels entre la première et la seconde image, par exemple à l'aide d'un filtre moyenneur comme suit : [0075] [Math.1] Il I1 - - Où [Math.1] I1 est l'ensemble de pixels de la première image, 12 [Math .1] est la valeur moyenne des pixels de la première image, après application du filtre moyenneur et [Math .1] /1 est l'image normalisée. [0076] [Math.2] / -12 2 _ Il 1 2 - 1 2 II Oit [Math.2] /2 est l'ensemble de pixels de la deuxième image, [Math.2] I2 est la valeur moyenne des pixels de la deuxième image, après application du filtre moyenneur et [Math.2] Î2 est l'image normalisée. [0077] Au lieu de normaliser tous les pixels de l'image, on peut alternativement appliquer la normalisation seulement à des pixels autour des points d'intérêt. [0078] La deuxième étape 200 comprend une troisième sous-étape 230 de corrélation entre les première et deuxième images, de préférence normalisées selon la deuxième sous-étape 220, qui permet de corréler les points d'intérêt entre les deux images. [0079] La corrélation est réalisée par exemple à l'aide de l'opérateur ci-dessous qui doit être réalisé autour des indices k et 1: [0080] [Math.3] C(k, 1) .j)fi(i - k, j -1) où [Math.3] 1, 1 est le pixel à la ièmc ligne ct jème colonne de l'image, et k et 1 sont les indices de la matrice de corrélation, où on réalise la corrélation dans une fenêtre de taille w (en pixels) centrée sur k et I, déterminée par l'utilisateur. [0081] On obtient par exemple le résultat en figure 4. Certains points ne sont pas bien 13 corrélés (points entourés sur la figure). De préférence, les points non ou mal corrélés doivent être éliminés. Un exemple de méthode utilisée pour réaliser cette élimination est expliqué plus loin (cinquième sous-étape 250). [0082] La deuxième étape 200 comprend une quatrième sous-étape 240 qui exploite au moins une relation mathématique entre la première image Il prise au premier instant tl et la deuxième image 12 prise au deuxième instant t2, permettant de donner des informations sur la rotation et de la translation du capteur d'image entre les deux prises de vue. [0083] Une première relation mathématique est la matrice fondamentale F E 2î3 "-] 3. Une matrice fondamentale possède les paramètres intrinsèques de la caméra ainsi que sa rotation R et sa translation t. La quatrième sous-étape 240 peut comprendre une étape de détermination de la matrice fondamentale. [0084] La matrice fondamentale est basée sur les propriétés de la géométrie épipolaire entre les deux images, la géométrie épipolaire étant définie comme l'ensemble de relations projectives entre deux images. Si on prend un point X dans l'espace (ou « point 3D ») vu par deux images 11 et 12, sa projection dans la première image 11 est donnée par PI et sa projection dans la deuxième image est donnée par P2, comme l'illustre la figure 5. C représente le centre de la caméra au premier instant tl et C' le centre de la caméra au deuxième instant t2 (dans le cas où une caméra seule se déplace avec le porteur). La géométrie épipolairc établit que les points X, PI, P2, C, C' sont coplanaires (plan épipolaire n). [0085] La matrice fondamentale F doit satisfaire la relation suivante, nommée « relation fon- damentale » : [0086] [Math.4] P211131 = 0 [0087] Cette relation permet de déterminer la matrice fondamentale. [0088] Les points Pl et P2 correspondent à un même point d'intérêt (l'un est sur la première image I1 et l'autre sur la deuxième image 12). De tels points peuvent être connus. La relation fondamentale est satisfaite si les points sont corrélés. Les points P1 et P2 sont caractérisés par leurs coordonnées xl, yl et x2, y2 dans le plan de la première image I1 et de la deuxième image 12. En exprimant ces points sous forme de vecteurs : P1= [x]] y1 et p2 [x2 y2 1]1 on obtient : 100891 I Math.51 X2 T fl1 fl2 f131 xi Y9 f21 f =0 1 f3i f32 f33 1 14 [0090] La formule [Math..5] revient à résoudre un système de plusieurs équations linéaires sous la forme AFf = 0 où AF est la matrice du système linéaire utilisé pour trouver f. La solution f doit minimiser II Ail soumise à b condition II f fl = 1. [0091] Ce système de plusieurs équations linéaires peut être résolu en utilisant plusieurs points d'intérêt connus, par exemple en utilisant huit points d'intérêt (ce qui peut être nommé « algorithme à 8 points »). 100921 En pratique, parmi les points d'intérêt, certains ne sont pas bien corrélés entre la première et la deuxième image. Ces points d'intérêt ne vont pas forcément respecter la relation fondamentale. Il est préférable d'éliminer ces points dits « points aberrants » (ou « outliers »), ou du moins de ne pas les utiliser pour résoudre le système à plusieurs équations issu de [Maths.51. La matrice fondamentale obtenue en éliminant les points aberrants est plus précise. Cela permet d'améliorer la précision de détermination de la rotation et de la translation. 100931 Ainsi, la deuxième étape 200 peut comprendre une cinquième sous-étape 250 d'élimination de points aberrants. Cette cinquième sous-étape 250 peut être réalisée avant, pendant ou après la quatrième sous-étape 240. Elle peut également être réalisée plus largement au cours de la deuxième étape, voire plus largement au cours de toutes les étapes. 100941 La cinquième sous-étape 250 peut mettre en oeuvre une méthode de type « RANSAC » qui correspond en anglais à « RANdom SAmpling Consensus » qui est une méthode pour estimer les paramètres de certains modèles mathématiques, surtout quand l'erreur induite par un modèle ne présente pas une distribution gaussienne. En effet, il s'agit d'une méthode itérative utilisée lorsque l'ensemble de données observées peut contenir des valeurs aberrantes (ou « outliers »). [0095] Dans le cas du RANSAC appliqué à l'obtention de la matrice fondamentale, on choisit un certain nombre de points d'intérêt, par exemple huit points au hasard. [0096] On détermine la matrice fondamentale F avec ces points d'intérêt choisis au hasard. Ensuite, on utilise la matrice fondamentale déterminée F pour calculer la distance d(F), qui est la relation fondamentale mais qui est non nulle puisque les points ne sont pas corrélés : [0097] [Math.6] d(F) = P2TFP1 [0098] Cette distance est calculée pour l'ensemble des points d'intérêt. Si la distance est plus petite qu'un seuil d(F)max prédéfini, le point d'intérêt est considéré comme corrélé (« inlier »), sinon le point d'intérêt est considéré comme non corrélé, ou aberrant (« outl ier »). [0099] Ensuite, on prend aléatoirement de nouveaux points d'intérêt, par exemple huit points au hasard, et on répète les opérations décrites dans les trois paragraphes précédents : on calcule la nouvelle matrice fondamentale F et on calcule les nouvelles distances d(F). [0100] L'opération du paragraphe précédent est de préférence réitérée plusieurs fois. En réalisant cette itération, on obtient une matrice fondamentale qui minimise la distance pour le plus grand nombre de points d'intérêt. On peut fixer un nombre maximal d'itérations et/ou un nombre de points d'intérêt à sélectionner et/ou arrêter les itérations lorsqu'on estime que la matrice fondamentale obtenue est satisfaisante. [0101] On obtient par exemple le résultat en figure 6, de nombreux points aberrants ayant disparu de l'image. [0102] Une deuxième relation mathématique est la matrice essentielle E qui peut être obtenue à partir de la matrice K de calibration de la caméra. Cela permet d'obtenir un modèle projectif de la caméra. La quatrième sous-étape 240 peut comprendre une étape de détermination de la matrice fondamentale puis une étape de détermination de la matrice essentielle. Alternativement, la quatrième sous-étape 240 peut comprendre une étape de détermination directe de la matrice essentielle. La méthode RANSAC, ou une autre méthode d'élimination de points aberrants, peut être appliquée à l'obtention de la matrice essentielle. [0103] La matrice K de calihration de la caméra est une matrice intrinsèque à la caméra. Elle contient les paramètres de la caméra, comme la distance focale f et les coordonnées plan (px, py, 1) du centre de l'image - [0104] [Math.7] f /3, f py 1 [0105] La matrice essentielle E est calculée par la relation : [0106] [Math.81 E = KIFK [0107] Par ailleurs, la matrice essentielle E est définie comme étant le produit vectoriel suivant : [0108] [Math.9] R2D Où [Math.9] x est la matrice antisymétrique du vecteur de translation t2D 2D-2D entre deux images et R2D est la rotation 2D-2D entre deux images. 16 [0109] La matrice essentielle E possède ainsi de façon intrinsèque l'information de la rotation R2D et de la translation t2D 2D-2D entre les deux images. À partir de la relation [Math. 9] on peut extraire la rotation et la translation dans le plan, c'est à dire sans la profondeur (i.e. sans la côte « z »). [0110] La rotation et la translation ainsi déterminés peuvent être nommées « rotation inter- médiaire» et « translation intermédiaire » dans la présente description (et plus généralement de « mouvement intermédiaire » si on parle de mouvement). [0111] La troisième étape 300 permet, une fois la rotation et la translation intermédiaires entre les première et deuxième images obtenues, d'obtenir les points en trois dimensions, typiquement par triangulation. Cette troisième étape permet d'obtenir les coordonnées en 3D des points d'intérêt dont on a comparé les projections sur les première et deuxième images, avec un facteur d'échelle donné. Tl est possible de corriger le facteur d'échelle. [0112] Une propriété intéressante de la géométrie épipolairc illustrée en figure 5 et dans le paragraphe de la description correspondant, ainsi qu'une conséquence directe de la relation fondamentale est la suivante : si on respecte la formule [Math.4], c'est-à-dire si P2 FP 1 = 0, alors le point X (point en 3 dimensions ou « point 3D ») et les points PI, P2 (points de projection sur les première et deuxième images I 1 et 12) sont coplanaires. Supposons les matrices C1 = K [ 1 o I et C2 = K [ R2D t20 ' nommées « matrices caméra », où T est la matrice identité, ceci implique que les relations suivantes (produits vectoriels nuls). [0113] [Math.10] PI A C1X = [0114] [Math.11] P2 A C2X = 0 [0115] Ces relations permettent d'obtenir les points X à partir des points de projections P 1 et P2 sur les première et deuxième images II et T2 et à partir de la rotation et la translation 2D-2D déterminées entre lesdites première et deuxième images (P 1 et P2 étant corrélés). [0116] En répétant ce calcul pour tout ou partie des points d'intérêt corrélés entre les première et deuxième images, on reconstruit tous les points 3D (points X) et par conséquent on peut aller jusqu'à reconstruire en 3D tout ou partie de la scène capturée par les images. [0117] Les points 3D ainsi obtenus par cette première triangulation sont nommés dans la suite de la description « premiers points 3D ». [0118] La troisième étape 300 peut comprendre en outre une sous-étape 310 d'élimination de points aberrants, en utilisant par exemple la méthode RANSAC. 17 [0119] La quatrième étape 400 a pour objectif de déterminer la rotation et la translation entre les premiers points X en 3D et des points d'intérêt dans une troisième image. [0120] Dans la deuxième étape 200, on a utilisé deux images, et les valeurs de translation et de rotation 2D-2D sont déterminées par la comparaison de points d'intérêt entre les deux images. Puis dans la troisième étape 300, on a obtenu les premiers points 3D à partir des points d'intérêt et des valeurs de translation et de rotation 2D-2D déterminés dans la deuxième étape. Le problème est que pour exploiter l'odométrie visuelle dans le cas d'une navigation par vision, on ne se contente pas de comparer deux images et d'obtenir seulement une translation et une rotation entre deux images. En effet on souhaite suivre le porteur sur un intervalle de temps donné qui correspond à (beaucoup) plus que deux images. Ainsi, une navigation par vision nécessite l'acquisition de nouvelles images qu'il faut mettre en relation avec les valeurs de translation et de rotation 2D-2D déterminés et les premiers points 3D obtenus. En outre, le facteur d'échelle de la rotation et de la translation estimées en 2D-2D varie à chaque nouvelle image ajoutée pour obtenir une nouvelle estimation, rendant son utilisation impossible pour des finalités de navigation. [0121] La quatrième étape permet de conserver un même facteur d'échelle lorsqu'une troisième image est ajoutée pour estimer les valeurs finales de rotation et de translation. Elle permet ainsi d'avoir une estimation plus stable de la rotation et de la translation du porteur. [0122] La quatrième étape 400 comprend une première sous-étape 410 apte à déterminer des seconds points 3D à partir des premiers points 3D obtenus et des points d'intérêt dans une troisième image 13. [0123] La première sous-étape 410 peut consister en la résolution du problème dit « P3P » de l'anglais « perspective-3-point », ou plus largement en la résolution du problème « PnP » de l'anglais « perspective-n-point ». [0124] Pour résoudre le problème « P3P », le principe est de déterminer la distance entre les premiers points 3D et le centre de la caméra. En ayant déterminé ces distances, et à partir des points d'intérêt repérés dans une troisième image 13 en relation au moins avec la deuxième image 12 (ou avec la première image I1), on peut remonter à des seconds points 3D et obtenir la rotation et la translation des seconds points 3D par rapport aux premiers points 3D. [0125] Les premiers points 3D sont représentés par X1 et les seconds points 3D sont re- présentés par Ri (i varie entre 1 et 3 pour un problème P3P, et entre 1 et n pour un problème PnP). Les points d'intérêt dans la troisième image 13 sont représentés par P31. La distance di est la distance entre le point N et la caméra C. Le problème PnP consiste donc à déterminer chaque distance di. [0126] A titre d'exemple, le problème P3P peut consister donc à résoudre le système d'équations suivant : [0127] [Math.12] Où [Math.12] d1 = II C - X II [Math.12] d 2 =IIC-X211 [Math.12] d 3 = II C - X 3 11 [Math.12] 12 - :VIL\ X2 [Math.12] 813 - Xi ièX3 et [Math.12] 0 2 3 - X2L\ X3 [Math.12] d 12 = Xl -X II [Math.12] d13= X1 - X3 d et I Math.121 d 23 = II X2 X3 II cos cos 013 = .d-,d cos 02a = 18 101281 Les angles Ou, 013 et 823 sont obtenus à partir de la matrice de calibration caméra 19 K et des points P31, P32, P33 dans la troisième image : [0129] [Math.13] (I( 1P31) lK IP3 2 ) cos 012 = 11K-11,3211 [0130] [Math.14] (K-1P3J (ICHP33 cos On = Dictp3i DICIP3311 101311 1Math.151 (K- P32 ) OCIP33 cos 1323 - Kip32 DIC-IP3311 101321 Alternativement, on peut utiliser une methode P5P pour obtenir cinq distances di avec 5 points dans la troisième image en utilisant un système Ad de plusieurs équations linéaires : 101331 ]Math.16] 1 ai a2 a3 a a5 cl1 al2 a a3 2 ) = Add = a72 ar:"; ai; A3 Où les coefficients ]Math.16] de la matrice [Math.16] Ad sont fonction de [Math.16] du et de [Math.16] COS eu où i et j varient de 1 à 5. [0134] À partir de la décomposition de la matrice Ad en valeurs singulières A usistr. - d = ' la solution d est donnée par : [0135] [Math.17] d= V( : , 5) [0136] On trouve ch à partir des relations : [0137] [Math.18] dl = 7d(2) / d.(1) ou 1Math.181 7d(3) / d(2) ou lMath.181 viC170 / d(3 ) ou [Matli.181 id(5) d(4) [0138] On fait de même pour les autres points pour trouver d,, d;, d4 et d -3, -4 et -5- [0139] Une fois le problème PnP résolu et donc les distances di trouvées, on peut déterminer les seconds points 3D Si à partir des points P3; de la troisième image 13, donnés par la formule : [0140] [Math.19] IC1P3. d. 1 ' 11K- P3i où K est la matrice de calibration de la caméra. [0141] De nombreuses méthodes existent pour résoudre le problème P3P, et plus largement le problème PnP. La plupart reposent sur l'élimination des inconnues par un résultant de Sylvester et ensuite par la résolution d'un système d'équations linéaires. [0142] La quatrième étape 400 comprend en outre une deuxième sous-étape 420 qui consiste en la détermination de la rotation R3D et la translation t3D 3D-2D entre les premiers points 3D Xi et les seconds points 3D 'Xi. [0143] Cette détermination peut être réalisée en utilisant une méthode connue sous le nom de « problème de Procuste ». Le problème de Procuste est un problème de minimisation qui consiste à résoudre l'équation suivante : [0144] [Math.20] 5 min 11 RR,D + t3D - il ft, I xï 21 tout en respectant les deux contraintes suivantes : [0145] [Math.21] R3DIR3D = R3DR3D = I I Math.21I 1 étant la matrice identité ; et 101461 IMath.22I del( R3D = 101471 La quatrième étape 400 peut comprendre en outre une troisième sous-étape 430 d'élimination de points aberrants, plus précisément pour obtenir des valeurs de rotation R30 et de translation t30 3D-2D qui conviennent au plus grand nombre de points d'intérêt, et donc plus précises. 101481 La troisième sous-étape 430 peut comprendre par exemple l'utilisation d'une méthode de type « RANSAC » qui consiste en la minimisation de la distance, pour chaque point image P (qui correspond à une projection sur une image d'un point X en 3D), entre le point P',, mesuré sur une image et le point estimé par l'algorithme de vision (en utilisant les valeurs de rotation Ru, et de translation l3D 3D-2D obtenues), soit par exemple à minimiser - 101491 IMath.23I d( R, t) = E P,'' - est) avec 101501 IMath.24I emes K P où K est la matrice (le calibration de la caméra [0151] [Math.25] P - limes nies II znies permettant de normaliser la valeur de Pures à une profondeur égale à 1 [0152] [Math.26] Pest - K R3D '4) X où K est la matrice (le calibration de la caméra [0153] [Math.27] Pest Pest - II test II permettant de normaliser la valeur de à une profondeur égale à 1 [0154] La quatrième étape 400 permet donc d'obtenir la rotation et la translation de la caméra à partir d'une troisième image et des premiers points 3D calculés pour les première et seconde images. [0155] La rotation et la translation ainsi déterminés (également désignés par rotation et translation « 3D-2D ») peuvent être nommées « rotation finale » et « translation finale » dans la présente description (et plus généralement de « mouvement final » si on parle de mouvement). [0156] Ensuite, on peut réaliser une étape supplémentaire de triangulation (à partir des deuxième et troisième images corrélées, de la rotation et de la translation obtenues en 3D-2D), de manière à redéfinir des seconds points 3D, puis une étape supplémentaire de détermination de la rotation et de la translation entre les seconds points 3D et des points d'intérêt dans une quatrième image 14 en résolvant un nouveau PnP. Plus généralement, on peut reproduire des étapes supplémentaires de triangulation et de PnP de manière itérative lors de l'acquisition de nouvelles images afin d'estimer à chaque fois la rotation et la translation. En effet, au fur et à mesure du mouvement du porteur de caméra et de l'acquisition de nouvelles images, les points d'intérêt communs à toutes les images diminuent, jusqu'à ne plus exister (la scène vue par la caméra va évoluer). Pour pouvoir continuer à suivre le mouvement, il faut ajouter des points d'intérêt communs aux dernières images acquises (et donc plus nécessairement communs aux images précédemment acquises), et faire en sorte d'avoir un facteur d'échelle cohérent avec les images précédentes. [0157] La deuxième étape de détermination de la rotation et de la translation 2D-2D est en fait utilisée juste pour initialiser le calcul, puisqu'à partir du moment où on a déterminé des premières valeurs finales de rotation et de translation 3D-2D, à l'issue de la quatrième étape, on va utiliser ces premières valeurs dans une première itération, puis on va utiliser les valeurs de rotation et de translation 3D-2D obtenues pour une prochaine itération, et ainsi de suite. [0158] Ainsi cela permet de suivre le mouvement du porteur de la caméra au fur et à mesure des prises d'images. [0159] Un exemple de système de navigation basé sur la vision intégrant un calculateur d'intégrité dudit système comprend les éléments illustrés en figure 2 : - un capteur d'image 11 disposé sur un porteur et permettant de réaliser au moins une première image il à un premier instant ti et une deuxième image 12 à un deuxième instant t2 ; - une unité de traitement 21 couplée au capteur d'image 11 et apte à implémenter une méthode de traitement apte à calculer une translation t et/ou une rotation R du porteur (ou plus généralement un mouvement) entre le premier instant tl et le deuxième instant t2 à partir de la première image I1 et de la deuxième image 12 ; - un module de calcul d'intégrité 31 couplé à l'unité de traitement 21 et permettant de calculer un rayon de protection D ; 23 - une unité d'affichage 41 permettant d'afficher la translation t et la rotation R calculées ainsi que le rayon de protection D ; [0160] Le module de calcul d'intégrité 31 peut être intégré dans l'unité de traitement, ou peut être distinct. [0161] En outre, il faut comprendre que, bien qu'une seule unité de traitement 21 soit re- présentée sur la figure 2, l'unité de traitement 21 peut comprendre plusieurs processeurs, chaque processeur étant chargé d'exécuter une tâche particulière. Il en va de même pour le module de calcul d'intégrité. [0162] L'unité de traitement 21 et/ou le module de calcul d'intégrité 31 incluent ou fonc- tionnent avec des programmes logiciels ou autres instructions lisibles par ordinateur pour exécuter les étapes et sous-étapes de la méthode de traitement et/ou de la méthode de détermination du rayon de protection. [0163] La méthode de traitement 51 met en oeuvre a minima les mêmes étapes que celles décrites précédemment notamment en référence à la figure 8, à savoir : - une première étape 100 d'acquisition et/ou de traitement d'au moins une première image 11 prise à un premier instant tl et une deuxième image 12 prise à un deuxième instant t2 ; - une deuxième étape 200 de détermination de la rotation et de la translation intermédiaires entre la première image 11 et la deuxième image 12 (rotation et translation « 2D-2D »); - une troisième étape 300 d'obtention de premiers points 3D à partir des première et deuxième images ; - une quatrième étape 400 de détermination de la rotation et de la translation finales à partir des premiers points 3D obtenus et d'une troisième image 13 prise à un troisième instant t3 (rotation et translation « 3D-2D »). [0164] En outre, toutes les sous-étapes décrites précédemment peuvent s'appliquer à un exemple de système de navigation basé sur la vision intégrant une unité de calcul d'intégrité. [0165] En outre, la méthode de traitement 51 peut comprendre : - une cinquième étape 500 de calcul de l'incertitude induite par un bruit au niveau d'une parmi la première ou la deuxième image sur la rotation et/ou la translation finale. [0166] Par « bruit », il faut comprendre les variations ou « petites erreurs » aléatoires qui s'ajoutent lors de l'acquisition d'une image par un capteur d'image. En effet, lors de l'acquisition d'une mesure physique à partir d'un capteur, des défauts viennent s'ajouter à la grandeur mesurée. [0167] Le principe est de caractériser le bruit au niveau d'une image, typiquement de dé- terminer son écart-type cr, puis de propager l'incertitude induite par ce bruit sur les grandeurs intermédiaires nécessaires à la détermination de la rotation et/ou de la 24 translation finales de manière à déterminer les incertitudes sur les valeurs finales de rotation et/ou de translation. [0168] Typiquement, on propage l'incertitude induite par le bruit sur les grandeurs inter- médiaires qui sont déterminées lors du déroulement des étapes et sous-étapes d'une méthode de traitement (algorithme de vision) afin de déterminer les incertitudes sur les valeurs finales de rotation et/ou de translation obtenues. [0169] Comme illustré en figure 2, l'unité de traitement 21 peut implémenter ces étapes de propagation du bruit de manière à obtenir les incertitudes 1. [0170] Une incertitude est de préférence définie par la covariance. En particulier, une in- certitude peut être déterminée sous la forme d'une matrice de covariance. [0171] Un mode de réalisation de la cinquième étape 500 est décrit ci-après, notamment en référence à la figure 8. [0172] Selon ce mode de réalisation de la cinquième étape, l'incertitude induite et propagée est déterminée sous la forme d'une matrice de covariance de la rotation et d'une matrice de covariance de la translation. [0173] D'autres méthodes sont possibles. Ainsi, au lieu calculer l'incertitude sous forme de covariance, on peut la calculer par le résidu de la solution, par exemple le résidu d'une solution de moindres carrés. [0174] Le terme « cinquième » étape ne sous-entend pas que ladite étape intervienne néces- sairement après les autres étapes. Ainsi, ladite cinquième étape peut comprendre plusieurs sous-étapes dont certaines peuvent être implémentées avant, pendant ou après l'une ou l'autre des sous-étapes des deuxième, troisième et quatrième étapes décrites plus avant. [0175] Par exemple, toujours en référence aux étapes décrites plus avant dans la présente description, on propage l'incertitude induite par le bruit sur la rotation et la translation intermédiaires (2D-2D), puis on propage l'incertitude induite par la rotation et la translation intermédiaires sur les premiers points 3D générés par triangulation, puis on propage l'incertitude induite par les premiers points 3D sur les seconds points 3D générés par un algorithme P3P ou PnP, et enfin on propage l'incertitude induite par les seconds points 3D sur la rotation et la translation finales (3D-2D). [0176] La cinquième étape 500 peut comprendre une première sous-étape 510 de caracté- risation du bruit au niveau d'au moins une parmi la première et la deuxième image. Cela permet d'obtenir par exemple une matrice de covariance du bruit. [0177] Lorsque le calcul de la rotation et de la translation intermédiaires est basé sur la dé- termination de la matrice fondamentale F et/ou de la matrice essentielle E, comme cela est décrit plus avant dans la présente description, la cinquième étape 500 peut comprendre une deuxième sous-étape 520 de détermination de la propagation du bruit à la matrice fondamentale F et/ou à la matrice essentielle E. La deuxième sous-étape peut en particulier être réalisée en déterminant la covariance de la matrice fondamentale F et/ou la covariance de la matrice essentielle E. [0178] A titre d'exemple, soit a la matrice de covariance du bruit au niveau des points obtenue à l'issue de la première sous-étape 510 : [0179] [Math.28] 0-2 Où IMath.281 cr D2 est l'écart-type du bruit au niveau des points d'intérêt. 101801 Alors la covariance de f est donnée par : 101811 IMath.291 J VT J Ar-(- \I- Où [Math.29] J AF est la matrice Jacobéenne de la matrice [Math.29] AF du système linéaire utilisé pour trouver [Math.29] [0182] f [0183] On peut maintenant calculer la matrice de covariance de la matrice fondamentale désignée ;L:F : [Math.30] zF o jr} o Où IMath.301 F est la matrice Jacobéenne de la décomposition en valeur singulière (« SVD ») utilisée pour calculer la matrice fondamentale F. [0184] La covariance de la matrice essentielle E désignée ZF est la covariance de F multipliée par une constante. Elle est donc égale à covariance de F, soit : 26 [0185] [Math.31] E [0186] La cinquième étape 500 peut comprendre en outre une troisième sous-étape 530 de propagation du bruit de la matrice essentielle E aux valeurs intermédiaires de translation tu, et de rotation km. La troisième sous-étape 530 peut être réalisée en déterminant la covariance de ladite rotation intermédiaire et la covariance de ladite translation intermédiaire. [0187] A titre d'exemple, la rotation et la translation intermédiaires peuvent être déduits de la matrice essentielle E à partir de sa décomposition en valeurs singulières : [0188] [Math.32] E = USV1 [0189] Alors la rotation intermédiaire Rni, est donnée par : [0190] [Math.33] R2o = uwv I ou mv 1 v 1 Où 1Math.331 - 1 0 W= 1 0 0 0 0 1 [0191] En outre, la translation intermédiaire t211 est donnée par : [0192] [Math.34] t2D = , 3 ) out= Uni] Où [Math.34] 0 1 01 Z= -1 0 0 0 0 0 [0193] La covariance de la rotation intermédiaire 2`:R2T) est donnée par : [0194] [Math.35] ( UWVT ( uwvT ) -R21) DE 'H:: D E [0195] Et la dérivée de uwvi est donnée par : [0196] [Math.36] a (len» ) au v\vi WavT a eu - D elf D e- où 1 J 27 [Math.36] pi j sont les éléments de la matrice essentielle E [0197] La covariance de la translation intermédiaire12D est donnée par : 101981 1Math.371 = a (LM a (u ,)i f) -t, 3E E CÉ où [Math.37] U3 = 11( : , 3) [0199] La cinquième étape 500 peut comprendre en outre une quatrième sous-étape 540 de propagation du bruit des valeurs intermédiaires de translation tn, et de rotation R2D aux premiers points 3D X. [0200] A titre d'exemple, on a vu plus avant qu'on pouvait obtenir un point 3D par une méthode de triangulation, de la façon suivante : [0201] [Math.10] Pl A CiX = 0 [0202] [Math.11] P2 A C2X = Où [Math.1 I] = [ xi yi et [Math.1 I] P2 = x2 y2 1 sont les points d'intérêt dans les première et deuxième images II et 12 et [Math.11] X est un point 3D. [0203] On peut écrire le problème comme un système linéaire : [0204] [Math.38] AxX = où 28 [Math.38] P1 x Cil Ax = P2 x C2] est la matrice du système linéaire utilisé pour trouver un point 3D X. [0205] À parti de la déco nposition en valeurs singulières de Ax comme suit : [0206] [Math.39] USV1 [0207] La solution X est donnée par la dernière colonne de V soit X = V ( :: 4). On désigne V4 = V ( : , 4). 102081 L'équation AxX = 0 configure une fonction implicite. La covariance de X est donc donnée par : 102091 1 Math.401 Où [Math.40] est la Jacobéenne de la décomposition en valeurs singulières de la solution de X obtenue par triangulation, [Math.40] est la covariance du point 3D X, [Math.40] est la matrice de covariance composée par les covariances des points dans les images, par la covariance de la rotation et de la translation intermédiaires et [Math.40] 1 ' Ax est sa Jacobéenne. [0210] De façon simplifiée, on peut trouver la covariance 2:ix en réalisant l'inversion de Jx suivante : [0211] [Math.41] [0212] De manière plus rigoureuse, on peut trouver la covariance 2.x. à partir de la solution du système d'équations linéaires A.xX = 0 et X donné par V4 = V ( , 4) de 29 manière à obtenir la solution : [0213] [Math.42] a V4 y FT 3VV4T au J ,-AviAx a ai.] où [Math.42] aij sont les éléments de la matrice [Math.42] [0214] La cinquième étape 500 peut comprendre en outre une cinquième sous-étape 550 de propagation entre les premiers points 3D obtenus par triangulation et les distances di obtenues par le P3P ou le PnP. [0215] Par exemple, le problème P3P ou le PnP peut être déterminé comme indiqué plus avant par le système d'équations : [0216] [Math.12] [0217] Ceci résultant en le système d'équations linéaires suivant : [0218] [Math.16] a2 ai I 1 di = ad =O a3I 2 dl a,2 a4 df d Où les coefficients [Math.16] de la matrice [Math.16] Ad sont fonction de [Math .16] du et de IMath.161 cos eu [0219] À partir de la décomposition en valeurs singulières Ad = USV I , la solution d est donnée par : [0220] [Math.17] d - N,7( : , 5) [0221] Comme il s'agit d'une fonction implicite, on peut calculer la covariance 2-"'d de la solution de d comme suit : [0222] [Math.43] a ( Vr T a (v5) .2 H= A3 JLs.,dn E,d JAd a 2 Ad Où u I Math.431 V5 = V( : , 5) et où IMath.431 .1 A est la matrice Jacobéenne de [Math.43] Ad et [Math.43] '-±Ad sa covariance. [0223] Le problème consiste à déterminer [0224] [Math.44] y = diag(0-2) 0 --Ad -X donné par : , avec Ad Où 31 [Math.44] est l'écart-type du bruit appliqué à des points d'intérêt dans une des images. [0225] La cinquième étape 500 peut comprendre ensuite une sixième sous-étape 560 de pro- pagation du bruit aux seconds points 3D Xi qui sont déterminés à partir des distances Cli et de points P31 dans unc troisième image 13, comme indiqué plus avant, par la formule : 102261 IMath.191 K 1P31 111(-1P3:11 102271 Le calcul de la covariance x des seconds points 3D Xi à partir de la covariance des distances i'Lld est le suivant : 102281 IMath.451 diag(cr2) oa [Math.45] [ R31de la rotation finale est donnée par la formule : [0240] [Math.50] y ( INT ) y a ( uvT R3D 0 H 'IPT 3 H 102411 La dérivée de -Gy' étant donnée par : [0242] [Ma th.51] ( UV I ) a U TT a \ - + U h. Où hij sont les éléments de la matrice H [0243] La matrice de covariance 11-1 est calculée comme suit : [0244] [Math.52] 1:11 - Où [Math.52] JH est la matrice Jacohéenne de 33 [Math.52] H [0245] En outre, la translation finale t3D est donnée par : [0246] [Math.53] t3D = B'S` [0247] On peut donc effectuer ses dérivées partielles : [0248] [Math.54] a t.,' a Bs a B' a R a t. a t.ki - R3D a tri i - a t1.; Bx [0249] Le terme a R3D est développé comme précédemment : 8 t 1J [0250] [Math.55] R3D a (UV 1) a TT T T VT a _ v + [0251] Ainsi la covariance ,)L3D de la translation finale est donnée par : t [0252] [Math.56] T (uvT), a (uvT ) "L3D = RmisExR3D a hu [0253] Ainsi on obtient la matrice de covariance de la rotation finale et la matrice de co- variance de la translation finale du système de navigation par vision. Selon l'invention, une telle matrice est nommée « matrice nominale de covariance de la translation » ou « matrice nominale de covariance de la rotation ». [0254] Le module de calcul d'intégrité 31 permet d'implémenter une méthode de calcul d'intégrité (qui peut être nommée « algorithme d'intégrité »), et plus précisément une méthode de détermination 600 d'un rayon de protection du système de navigation par vision. [0255] Lorsque le module de calcul d'intégrité 31 fait partie de l'unité de traitement 21, la méthode de calcul d'intégrité peut être intégrée dans la méthode de traitement (par exemple en un seul algorithme). Dans ce cas, la méthode de détermination d'un rayon de protection peut être une sixième étape 600 d'une méthode de traitement 52, comme cela est représenté en figure 8. En particulier, la méthode de calcul d'intégrité peut exploiter des étapes et/ou sous-étapes de l'algorithme de vision, notamment, mais pas exclusivement, la cinquième étape de détermination des matrices de covariance de la rotation et de la translation finales. 102561 Selon le mode de réalisation présenté ci-après, la méthode de calcul d'un rayon de 34 protection est basée uniquement sur la détermination de matrices de covariance de la translation finale (et non sur la détermination de matrices de covariance de la rotation finale en plus de celle de la translation finale). Dans ce cas, la matrice nominale de covariance de la translation est nommée par simplification « matrice nominale de covariance » ou « matrice nominale ». [0257] Alternativement ou complémentairement, la méthode de calcul d'un rayon de protection peut être basée sur la détermination de la matrice de covariance de la rotation. [0258] En outre, selon le mode de réalisation présenté, il est procédé à plusieurs calculs de covariance de la translation correspondant à un sous-système de navigation par vision, typiquement un sous-système obtenu en enlevant un ensemble de points d'intérêt et/ou, si on utilise un ensemble de plusieurs capteurs d'images, en enlevant au moins un capteur. [0259] Ainsi, selon le mode de réalisation présenté, le principe de la méthode de déter- mination du rayon de protection est d'exécuter l'algorithme de vision afin d'obtenir une sous-matrice de covariance de la translation finale, et ce pour un sous-système obtenu en enlevant un ensemble de points d'intérêt et/ou, si on utilise un ensemble de plusieurs capteurs d'images, en enlevant au moins un capteur d'images. Selon l'invention, cette matrice est nommée « sous-matrice de covariance de la translation » ou encore par simplification « sous-matrice de covariance » ou « sous-matrice ». [0260] On peut ensuite comparer la sous-matrice avec la matrice nominale. En réitérant ces opérations plusieurs (M) fois, on obtient plusieurs (M) sous-matrices de covariance qui sont exploitées pour obtenir une valeur de rayon de protection du système de navigation par vision. [0261] Un exemple de méthode 600 de calcul du rayon de protection peut comprendre les étapes suivantes, notamment en référence à la figure 8 : - une première étape 610 d'exécution de l'algorithme de vision de manière à obtenir une matrice nominale de covariance > de la translation. T31) [0262] La matrice nominale de covariance de la translation peut être obtenue à l'aide des étapes et sous-étapes décrites plus avant dans la présente description détaillée et notamment par l'équation [Math.56]. [0263] Ensuite, l'exemple de méthode 600 de calcul du rayon de protection comprend, pour chaque i-ème sous-système Si avec i variant entre 1 et M, qui est un sous-système correspondant au système de navigation par vision pour lequel on a enlevé une i-ème partie des points d'intérêt et/ou, si on utilise un ensemble de plusieurs capteurs d'images, au moins un i-ème capteur : - une deuxième étape 620 d'exécution de l'algorithme de vision de manière à obtenir une i-ème sous-matrice de covariance de la translation YtSi (pouvant être nommée - « i-ème sous-matrice de covariance » ou « i-ème sous-matrice ») ; - une troisième étape 630 de détermination d'un i-ème rayon de protection D qui peut comprendre les sous-étapes suivantes : - une première sous-étape 631 de détermination d'une i-ème matrice Ai des différences entre la matrice nominale et la i-ème sous-matrice, soit Ai i= - Si (pouvant être Si nommée « i-ème matrice différence ») ; - une seconde sous-étape 632 de calcul de la i-ème plus grande valeur d'écart-type de la i-ème matrice différence (pouvant être nommée « i-ème écart-type différence » ou « i-ème écart-type des différences »), soit a i = (A0) où ?Ai est la valeur propre de la i-ème matrice différence Ai ; - de préférence, une troisième sous-étape 633 de calcul d'une i-ème valeur corrigée Di égale au i-ème écart-type différence ai multiplié par une première constante de pondération, soit Di = a X OEi (pouvant être nommée « i-ème écart-type différence corrigé » ou « i-ème écart-type des différences corrigé ») où a est ladite première constante de pondération ; - de préférence, une quatrième sous-étape 634 de calcul de la i-ème plus grande valeur d'écart-type de la i-ème sous-matrice (pouvant être nommée « i-ème écart-type »), soit = nax OE Si iNsit .\} où XSi est la valeur propre de la i-ème matrice dégradée \ \ Asi; - de préférence, une cinquième sous-étape 635 de calcul d'une i-ème valeur corrigée Usi égale au i-ème écart-type 0-si multiplié par une seconde constante de pondération, soit Dsi = b X usi (pouvant être nommée « i-ème sous-écart-type corrigé ») où b est ladite seconde constante de pondération ; - unc sixième sous-étape 636 de calcul de la valeur d'un i-ème rayon de protection D; pour le sous-système Si comme étant soit le i-ème écart-type différence éventuellement corrigé, soit la sonwae du i-ème écart-type différence éventuellement corrigé et du i- èmc écart-type éventuellement corrigé, soit par exemple = Di ± [0264] Enfin, l'exemple de méthode 600 de calcul du rayon de protection comprend : - unc quatrième étape 640 de calcul de la valeur du rayon de protection D comme étant le plus grand des rayons de protection obtenus pour les sous-système Si, soit D = max 1- [0265] Les sous-matrices de covariance de la translation peuvent également être obtenues à l'aide des étapes et sous-étapes décrites plus avant dans la présente description détaillée, et ce pour chaque sous-système Si, et notamment par l'équation [Math.56]. [0266] Dans le cas où la méthode de calcul d'un rayon de protection prend en compte la co- 36 variance de la rotation, les première à troisième étapes de ladite méthode de calcul décrites dans les paragraphes précédents, ainsi que la quatrième étape peuvent s'appliquer à la matrice nominale de covariance de la rotation et aux sous-matrices de covariance de la rotation, lesquelles peuvent également être obtenues à l'aide des étapes et sous-étapes décrites plus avant dans la présente description détaillée pour le système de navigation et pour chaque sous-système Si, et notamment l'équation [Math.55]. [0267] La valeur de la première constante de pondération a peut être égale à 1 et dans ce cas :D; = G1. [0268] Alternativement, la valeur de la première constante de pondération a peut être définie par l'utilisateur. Par exemple, cette valeur de a peut être obtenue à partir de la pro- babilité de fausse alarme (PFA) du système en utilisant une distribution du x2 : [0269] [Math.57] a 2 FDF 1 ( 1 - ( Pte) , 1 ) L : PDF ( a 2 PFA Où [Math.571 PDF est la fonction de probabilité de densité de la distribution [Math.57] 2 et 1Math.571 est le nombre de sous- systèmes Si. 102701 La valeur de la seconde constante de pondération h peut être égale à 1 et dans ce cas 13s; = Crsi être égale à 0 et dans ce cas D ) = Di. [0271] Alternativement, la valeur de b peut être définie par l'utilisateur. Par exemple la constante b peut être obtenue à partir de la probabilité de non-détection (PND) du système en utilisant une distribution du x2 : [0272] [Math.58] b2 = PDF-1(1 -PND, 1) [0273] La figure 7 illustre un exemple de calcul du rayon de protection d'un sous-système. Dans cc cas simplifié, il y a 5 sous-systèmes SI à Ss, le système SO correspondant au système nominal, ce qui correspond dans l'exemple au système avec tous les points d'intérêt. Lc calcul du rayon de protection DI du sous-système Si donne Dl = aoAl + baS1. 37 [0274] Le même calcul est fait pour chaque autre sous-système S, à S. [0275] Il s'avère dans cet exemple que lorsqu'on omet des points d'intérêt pour obtenir le sous-système Si on obtient un résultat qui est le plus proche de la position réelle. [0276] Ainsi la méthode selon l'invention permet de déterminer une valeur du rayon de protection du système de navigation par vision. Ceci permet par exemple à un corps en mouvement de naviguer avec une information de position intègre afin d'éviter des obstacles fixes (le relief montagneux, les bâtiments d'une ville ...) et mobiles (aéronefs, véhicules, piétons ...). [0277] La précision de cette détermination dépend du nombre M et de la sélection des sous- systèmes, qui peuvent être déterminés en fonction du système de navigation (et donc de la méthode de traitement) mis en oeuvre. [0278] La méthode selon l'invention peut s'adapter en fonction du système de navigation mis en oeuvre, puisque le principe de la méthode est de calculer des incertitudes des valeurs de mouvement obtenues par la méthode de traitement (quelle que soit la méthode). Le mode de calcul de ces incertitudes peut se faire d'autres manières que celles indiquées précédemment, et l'homme du métier oeuvrant dans le domaine de l'invention saura adapter le mode de calcul des incertitudes en fonction de la méthode de traitement utilisée. [0279] Il est très avantageux de pouvoir connaître de manière précise le rayon de protection du système de navigation par vision. La précision recherchée dépend notamment du domaine auquel le système de navigation est destiné. [0280] La méthode selon l'invention s'applique quel que soit le système de navigation par vision mis en oeuvre : embarqué, fixe, un capteur, plusieurs capteurs ... [0281] La méthode selon l'invention permet de garantir ou de vérifier si un système de na- vigation par vision répond aux contraintes, normes et/ou standards d'utilisation dans certains domaines d'application, dont certains peuvent être particulièrement exigeants. [0282] Les domaines d'application de l'invention peuvent être, entre autres, ceux de la na- vigation aéronautique, de la navigation terrestre, de la navigation spatiale, de la navigation maritime et sous-marine. [0283] En particulier, un système de navigation par vision peut servir de système de na- vigation relais lorsqu'un système de navigation par satellite ne peut plus être utilisé (par exemple pour la navigation au sol pour un avion) ou lorsqu'il devient défaillant (par exemple pour la navigation en altitude pour un avion en cas de perte d'un ou de plusieurs satellites). [0284] Un système de navigation par vision peut également être un système de navigation principal, par exemple lorsqu'il s'agit d'éviter tout risque de masquage, de brouillage (par exemple pour la livraison de colis par drone). [0285] La méthode selon l'invention permet en outre de savoir s'il est nécessaire de corriger 38 le soft (paramètres dans l'algorithme de vision ...) ou d'améliorer le hard (caméra ...). [0286] Les différents modes (étapes, sous-étapes, exemples, variantes ...) présentés peuvent être combinés entre eux. [0287] En outre, la présente invention n'est pas limitée aux modes de réalisation pré- cédemment décrits mais s'étend à tout mode de réalisation entrant dans la portée des revendications. 39 [Revendication 1] [Revendication 2] [Revendication 3]