FR3120695A1 - Procédé de supervision automatique et embarqué de la précision des informations cartographiques par un véhicule autonome - Google Patents

Procédé de supervision automatique et embarqué de la précision des informations cartographiques par un véhicule autonome Download PDF

Info

Publication number
FR3120695A1
FR3120695A1 FR2102541A FR2102541A FR3120695A1 FR 3120695 A1 FR3120695 A1 FR 3120695A1 FR 2102541 A FR2102541 A FR 2102541A FR 2102541 A FR2102541 A FR 2102541A FR 3120695 A1 FR3120695 A1 FR 3120695A1
Authority
FR
France
Prior art keywords
navigation map
motor vehicle
residue
map
observation
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
FR2102541A
Other languages
English (en)
Other versions
FR3120695B1 (fr
Inventor
Philippe Bonnifait
Anthony WELTE
Philippe XU
Clément ZINOUNE
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
De Technologie De Compiegne Utc, University of
Centre National de la Recherche Scientifique CNRS
Universite de Technologie de Compiegne UTC
Renault SAS
Original Assignee
De Technologie De Compiegne Utc, University of
Centre National de la Recherche Scientifique CNRS
Universite de Technologie de Compiegne UTC
Renault SAS
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by De Technologie De Compiegne Utc, University of, Centre National de la Recherche Scientifique CNRS, Universite de Technologie de Compiegne UTC, Renault SAS filed Critical De Technologie De Compiegne Utc, University of
Priority to FR2102541A priority Critical patent/FR3120695B1/fr
Publication of FR3120695A1 publication Critical patent/FR3120695A1/fr
Application granted granted Critical
Publication of FR3120695B1 publication Critical patent/FR3120695B1/fr
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G01C21/30Map- or contour-matching
    • G01C21/32Structuring or formatting of map data
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804Creation or updating of map data
    • G01C21/3807Creation or updating of map data characterised by the type of data
    • G01C21/3811Point data, e.g. Point of Interest [POI]
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804Creation or updating of map data
    • G01C21/3807Creation or updating of map data characterised by the type of data
    • G01C21/3815Road data
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804Creation or updating of map data
    • G01C21/3833Creation or updating of map data characterised by the source of data
    • G01C21/3848Data obtained from both position sensors and additional sensors

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Traffic Control Systems (AREA)
  • Navigation (AREA)

Abstract

Procédé de supervision (3) d’une carte de navigation (14) numérique d’un véhicule automobile autonome, comprenant : Une étape de lissage (322) des données de la trajectoire du véhicule au cours dudit trajet réalisé ;Une étape de recalcule (323) des résidus d’observations associés à des éléments de la carte de navigation (13) ;Une étape de fusion (324, 325) des résidus associés à un même élément de la carte de navigation numérique ;Une étape d’estimation (326) de la fiabilité de chaque résidu obtenu après ladite étape de fusion ; et Une étape de correction (327) de ladite carte de navigation numérique en fonction de l’estimation de fiabilité de chaque résidu. Figure de l’abrégé : Figure 1

Description

Procédé de supervision automatique et embarqué de la précision des informations cartographiques par un véhicule autonome
L’invention concerne le domaine du guidage de véhicules automobiles autonomes et plus particulièrement la supervision automatique et embarquée de la précision des informations cartographiques du véhicule autonome.
Lorsqu’un véhicule automobile fonctionne selon un mode de conduite autonome, il calcule son trajet en faisant correspondre sa position géographique avec les données d’une carte de navigation numérique.
Le positionnement géographique général du véhicule et des éléments de la carte se base sur un positionnement par Géolocalisation et Navigation par un Système de Satellites, plus connu sous son acronyme GNSS de l’anglaisGlobal Navigation Satellite System.
Toutefois, ce système n’étant pas assez précis pour garantir un bon cheminement sur une route, il est couplé à d’autres moyens de positionnement, notamment des caméras ou des capteurs lasers, tels que des Lidars, permettant de détecter les marquages au sol, les panneaux routiers, ou d’autres informations extéroceptives, représentatives de l’environnement du véhicule automobile.
Ainsi, le véhicule automobile se positionne en faisant correspondre les éléments détectés par les moyens embarqués, caméras, Lidars, etc, avec le positionnement GNSS et la carte de navigation associée.
En particulier, le système fait correspondre les panneaux routiers détectés par le véhicule automobile avec les panneaux routiers connus de la carte de navigation numérique.
Toutefois, le réseau routier évoluant rapidement, certains panneaux présents dans la carte de navigation numérique peuvent avoir disparu en réalité ; et réciproquement, certains panneaux existant en réalité peuvent ne pas être renseignés dans la carte.
L’objectif de la présente demande est dès lors d’évaluer automatiquement la qualité de la carte de navigation numérique afin de fournir une méthode de localisation du véhicule automobile précise, et ce malgré les potentielles erreurs d’information de la carte de navigation numérique.
On connait notamment la publication scientifique «HD Map Change Detection with a Boosted Particle Filter »,D. Pannen, M. Liebner and W. Burgard, 2019 International Conference on Robotics and Automation (ICRA), Montreal, QC, Canada, 2019, pp. 2561-2567. Cette publication décrit une détection d’erreurs sur une carte de navigation numérique basée sur un filtre à particules. Or un filtrage particulaire tel que décrit dans cette publication est relativement complexe à mettre en œuvre et implique une importante charge calculatoire.
Par conséquent il existe le besoin d’un procédé de supervision d’une carte de navigation numérique, robuste et plus léger d’un point de vue calculatoire.
À cet effet on propose un procédé de supervision d’une carte de navigation numérique d’un véhicule automobile autonome, ledit véhicule automobile comprenant un module de localisation adapté pour acquérir, stocker et associer à des éléments de la carte de navigation une pluralité de données d’état de la trajectoire du véhicule automobile et des mesures d’observation de l’environnement du véhicule automobile au cours d’un trajet, lesdites mesures d’observation étant associés à des éléments présents sur ladite carte de navigation de sorte que le module calcule les résidus d’observation du véhicule automobile par rapport aux données de la carte de navigation, et lorsque le trajet du véhicule automobile est terminé, ledit module de localisation est alors adapté pour mettre en œuvre les étapes dudit procédé de supervision comprenant :
– Une étape de lissage des données de la trajectoire du véhicule au cours dudit trajet réalisé ;
– Une étape de recalcul des résidus d’observations associés à des éléments de la carte de navigation après ledit lissage des données de la trajectoire et le calcul de la matrice de covariance associée à chaque résidu ;
– Une étape de fusion des résidus associés à un même élément de la carte de navigation numérique ;
– Une étape d’estimation de la fiabilité de chaque résidu obtenu après ladite étape de fusion ; et
– Une étape de correction de ladite carte de navigation numérique en fonction de l’estimation de fiabilité de chaque résidu.
Le procédé de supervision est ainsi robuste, rapide, performant et ne nécessite pas d’être réalisé en temps réel pendant le fonctionnement du véhicule automobile.
Avantageusement, ladite étape de lissage comprend la mise en œuvre d’un lissage de Kalman par propagation rétroactive des corrections de position du véhicule automobile. Ainsi, on peut obtenir un lissage performant et peu couteux en temps de calcul permettant une amélioration importante de la position réelle du véhicule automobile par rapport à la carte de navigation.
Avantageusement, ladite étape de fusion comprend une première fusion des résidus recalculés associés à un même élément de la carte de navigation numérique par la méthode de l’intersection de covariance. Ainsi, on obtient une méthode de calcul de la première fusion des résidus robuste et performante.
Avantageusement, ladite étape de fusion comprend une seconde fusion du résidu obtenu par la première fusion avec, s’il existe, un résidu déjà enregistré lors d’une mise en œuvre précédente du procédé pour le même élément de la carte de navigation numérique, de sorte que le résidu restant comprend l’ensemble des informations des résidus précédents. Ainsi, on s’assure d’obtenir un résidu pertinent pour corriger la carte de navigation numérique.
Avantageusement, l’étape d’estimation de la fiabilité de chaque résidu comprend la mise en œuvre d’un test du , en fonction d’une valeur de sensibilité prédéterminée. Ce test statistique assure ainsi une détection robuste et performante des erreurs d’observations détectées.
Avantageusement, lorsque ledit test du échoue, on attribue à l’élément de la carte de navigation associé audit résidu ayant échoué une variable d’exclusion indiquant que ladite carte est erronée pour ledit élément associé audit résidu. Ainsi, on peut de manière très efficace et simple identifier les éléments erronés sur ladite carte de navigation.
Avantageusement, ladite étape de correction de ladite carte de navigation numérique comprend la correction des résidus associés à une variable d’exclusion. Ainsi, on peut de manière relativement performante identifier les éléments à corriger.
L’invention concerne aussi un module de localisation d’un véhicule automobile autonome comprenant des moyens d’acquisition, de stockage et d’association à des éléments de la carte de navigation d’une pluralité de données d’état de la trajectoire du véhicule automobile et des mesures d’observation de l’environnement du véhicule automobile au cours d’un trajet, lesdites mesures d’observation étant associés à des éléments présents sur ladite carte de navigation de sorte que le module est adapté pour calculer les résidus d’observation du véhicule automobile par rapport aux données de la carte de navigation, et lorsque le trajet du véhicule automobile est terminé, ledit module de localisation comprend des moyens pour mettre en œuvre les étapes de supervision suivantes :
– Une étape de lissage des données de la trajectoire du véhicule au cours dudit trajet réalisé ;
– Une étape de recalcule des résidus d’observations associés à des éléments de la carte de navigation après ledit lissage des données de la trajectoire et le calcul de la matrice de covariance associée à chaque résidu ;
– Une étape de fusion des résidus associés à un même élément de la carte de navigation numérique ;
– Une étape d’estimation de la fiabilité de chaque résidu obtenu après ladite étape de fusion ; et
– Une étape de correction de ladite carte de navigation numérique en fonction de l’estimation de fiabilité de chaque résidu.
L’invention concerne aussi un véhicule automobile autonome comprenant un module de localisation tel que décrit précédemment.
D’autres particularités et avantages de l’invention ressortiront à la lecture de la description faite ci-après d’un mode de réalisation particulier de l’invention, donné à titre indicatif mais non limitatif, en référence aux dessins annexés sur lesquels :
est une vue schématique d’un module de localisation selon un mode de réalisation de l’invention ;
est une représentation schématique du modèle d’observation d’un panneau de signalisation par un véhicule autonome selon l’invention ;
est un organigramme du procédé de supervision d’une carte de navigation selon le mode de réalisation de l’invention.
En référence à la , un véhicule automobile autonome comprend un module de localisation 1, que l’on appellera aussi plus simplement le module 1.
Le module 1 communique avec une pluralité d’autres modules parmi lesquels :
– un Bus CAN 10 (Controller Area Network) adapté pour fournir des signaux numérisés issus de capteurs proprioceptifs ;
– Un récepteur GNSS 11 adapté pour fournir la position géographique du véhicule automobile ;
– Une caméra intelligente 12 adaptée pour détecter et identifier les lignes démarquant les voies de circulation;
– Un module 13 de détection d’éléments du réseau routier, tels que les panneaux de signalisation ou les marquages au sol, ici à partir de données notamment issues d’un capteur Lidar 15 ou de caméras embarquées ;
– Un module 14 de fourniture d’une carte de navigation numérique.
Ce module de localisation 1 met alors en œuvre des étapes générales suivantes :
– une première étape diteReal time filtering16, en français filtrage temps réel 16, au cours duquel on estime à haute fréquence l’état du véhicule à l’aide des données inertielles fournies par les capteurs de série du véhicule via le bus CAN 10 ainsi que les mesures issues du récepteur GNSS 11.
Le module de localisation 1 fournit ainsi un état à jour du véhicule incluant sa position estimée, sa vitesse longitudinale ainsi que sa vitesse de lacet.
Ces états estimés sont disponibles à haute fréquence mais peuvent être entachés d’erreurs, dues aux limitations du filtrage temps réel.
- Une seconde étape de lissage 17, en anglaisSmoothingconsiste alors à retraiter l’état présent en fonction des états futurs afin d’améliorer sa précision et diminuer son incertitude.
- Le niveau de qualité de la trajectoire lissée permet ensuite de mettre en œuvre une étape d’association 18 faisant correspondre les éléments perçus par les capteurs extéroceptifs du véhicule (panneaux de signalisation, marquages au sol) avec les éléments référencés dans la carte de navigation numérique.
Cette étape d’association 18 apporte de nouvelles informations sur la position du véhicule relativement à son environnement et permet d’affiner l’estimation de sa pose par la fonction de filtrage temps réel 16.
Cependant, le réseau routier étant en perpétuelle évolution, les éléments référencés dans la carte de navigation numérique peuvent être imprécis ou erronés.
- L’étude des associations calculées à l’étape précédente permet alors d’évaluer leur fiabilité à l’issue de chaque trajet. À cet effet on met en œuvre un procédé de supervision 3 de la carte de navigation numérique, en anglaisMap reliability.
Ce procédé de supervision 3, en référence à la , est mis en œuvre après la fin du roulage dudit véhicule automobile.
Toutefois de manière préalable, au cours du roulage, le procédé 3 met en œuvre une étape de stockage 321 en mémoire de tous les états reçus du véhicule automobile et des associations effectuées lors du roulage depuis le démarrage du module de navigation autonome.
On entend par « tous les états reçus » l’ensemble des informations acquises par le module de localisation 1 exposées précédemment.
En effet, pour analyser la qualité des éléments référencés dans la carte, les mesures et les états estimés sont utilisés. Ces données sont enregistrées au cours de la trajectoire pour n’être traitées qu’après la fin du roulage du véhicule automobile.
Le module 1 reçoit des observationsz j ( k )(où k est l’instant de mesure et i est l’indice de la mesure à cet instant) et leur élément de carte associém i du module de perception. Ces données sont stockées dans une mémoire tampon, aussi appelée en anglaisbuffer, de sorte à obtenir en fin de trajectoire, unbufferd’observation :
Z ( k )Contient les observations obtenues à l’instant k :
En parallèle, les estimations du module de localisation 1 sont aussi enregistrées.
Le module de localisation 1 fournit ainsi une estimation de la pose (position dans le plan et orientation) du véhicule, de sa vitesse longitudinale et de rotation. Ces données sont estimées par le module de localisation 1 à l’instant k en utilisant au plus les observations de l’instant 0 à k.
Ces états xk|ket leurs matrices de covariances associées Pk|ksont conservés en mémoire de sorte à obtenir en fin de trajectoire le buffer d’état :
Une fois que le roulage est terminé, les étapes du procédé d’estimation 3 sont alors mises en œuvre.
On met tout d’abord en œuvre une étape de lissage 322 réalisée sur l’intégralité de la trajectoire.
Dans ce mode de réalisation, le lissage est mis en œuvre depuis la fin du trajet jusqu’au démarrage.
Les états enregistrés dans le buffer n’ayant pu être estimés qu’en utilisant les observations disponibles en temps réel, ces estimations peuvent être améliorées une fois le roulage et la trajectoire terminés, pour propager les informations obtenues grâce aux nouvelles mesures.
Ceci est réalisé par un lissage de Kalman, qui consiste à appliquer à chaque état un facteur correctif.
Ce facteur dépend des estimations suivantes et est appliqué en partant du dernier état jusqu’au premier.
Ainsi, lorsque des observations permettent une meilleure estimation de l’état xk+1comparé à l’état xk. Le terme correctif permet de propager cette amélioration à l’état xk. Ainsi tout lebufferd’état peut être amélioré en appliquant les fonctions :
avec
Pour la mise en œuvre de l’étape de lissage 322, les observations nécessaires ne concernent que les éléments de la carte de navigation, les autres observations n’ayant alors pas besoin d’être conservées.
Une fois le lissage effectué, on met alors en œuvre une étape de recalcul 323 de nouveaux résidus d’observation ainsi que la matrice de covariance de chaque résidu d’observation.
On entend par résidu la différence entre une observation et la valeur prédite issue d’une régression statistique.
En effet, pour évaluer la qualité des éléments de la carte de navigation, des résidus d’observations sont utilisés.
Une erreur d’observation est modélisée par une distribution gaussienne centrée sur l’élément de la carte et une matrice de covariance dépendant de la précision a priori de la carte et de la précision de la détection.
Si l’élément de la carte est bien référencé, on sait alors que yTS-1y
(où y est le résidu de mesure et S sa matrice de covariance associée) suit une loi du .
En fixant un risque α, supprimer les éléments de la carte s’il ne vérifie pas le test du va provoquer la suppression de 1 élément sur 1/α.
Dans le cas où la carte contient une erreur, le taux de suppression va être beaucoup plus important. En effet si un élément est bien référencé, au fur et à mesure des résidus utilisés, l’incertitude du résidu va diminuer et le résidu va tendre vers 0.
Par contre si l’élément est mal référencé, l’incertitude va toujours diminuer mais le résidu va tendre vers une constante non nulle. Ainsi en cas d’erreur de carte le test échoue beaucoup plus souvent.
Les résidus calculés doivent être comparables. Quel que soit le point de vue, les résidus doivent représenter les mêmes grandeurs.
Là où pour la localisation en utilisant un amer [ S x i S y i ] T observé dans le repère véhicule, le modèle d’observation en référence à la est applicable :
Avec l’observation :
Un tel modèle n’est toutefois pas adapté à l’évaluation des éléments de cartes car les résidus dépendent du point de vue (puisqu’ils représentent des grandeurs exprimées dans le repère véhicule.
Ainsi, pour obtenir un résidu utilisable, on choisit un modèle de la forme :
Avec l’observation :
Ce modèle produit des résidus d’observations exprimés dans le repère local à la carte de navigation. Ainsi, quel que soit le point de vue de l’élément de la carte, les résidus représentent la même grandeur. Ils peuvent donc être comparés et fusionnés d’une trajectoire à l’autre.
Pour calculer le résidu et sa matrice de covariance associée, deux cas doivent être distingués.
– Si l’observation a été utilisée pour estimer l’état, l’erreur de l’estimation d’état est corrélée avec l’erreur d’observation. Le résidu est donc calculé avec :
Et sa matrice de covariance est :
Rest la matrice de covariance du bruit de mesure etHest la Jacobienne du modèle d’observation par rapport àx k
– Si l’observation n’a pas été utilisée pour estimer l’état, son erreur n’est pas corrélée à l’erreur d’état et la matrice de covariance du résidu est calculée avec :
Une fois les résidus recalculés 323, il se peut que pour un même élément de la carte on possède plusieurs résidus calculés et les matrices de covariance associées.
On procède alors à la fusion des résidus recalculés 324.
Cette étape de fusion des résidus recalculés 324 est réalisée par la méthode de d’intersection de covariance.
Toutefois l’invention n’est pas limitée à cette seule méthode.
On peut notamment réduire encore plus les besoins calculatoires en approximant la fusion avec une méthode connue sous le nom d’intersection de convariance rapide, plus connu en anglais sous le nom de «Fast Covariance Intersection» qui propose une solution approximée analytique pour les paramètres ω.
La méthode peut aussi être approximée davantage en sélectionnant le pire résidu à la place de tous les fusionner. Le pire résidu peut être sélectionné en choisissant le résidu ayant la plus grande distance deMahalanobis.
Toutefois en revenant à la méthode d’intersection de covariance mise en œuvre pour ce mode de réalisation, pour chaque élément de carte, on fusionne lesLrésidusy 1 ày L (et matrices de covariance associéesS 1 àS L ) avec :
où les paramètres ω sont positifs et tels que . Ces paramètres étant estimés par optimisation pour minimiser Tr(S), la trace de la matrice S.
Toutefois il se peut que pour un élément donné de la carte on ait déjà calculé, lors d’une mise en œuvre précédente du procédé, un résidu antérieur, aussi appelé résidu sauvegardé.
Dans ce cas on procède alors à la fusion 325 du résidu sauvegardé avec le résidu issu de la fusion de l’étape 324.
Le résidu sauvegardé en mémoire est alors être fusionné aux nouveaux résidus de sorte à obtenir un unique résidu contenant toute l’information.
Cette fusion est réalisée comme suit :
Ensuite on procède à une étape d’évaluation 326 de la fiabilité de l’élément en fonction du résidu obtenu après les étapes de fusion 324, 325.
En effet, les résidus contiennent dorénavant toute l’information obtenue lors de ce passage au voisinage de l’élément de la carte et des potentiels passages précédents.
Ces résidus peuvent maintenant être utilisés pour évaluer la fiabilité des éléments de la carte.
Comme exposé précédemment, si la carte n’a pas d’erreur, chaque résidu suit une distribution gaussienne centré en 0 et de matrice de covarianceS.
En cas d’erreur de carte, cette distribution ne sera pas centrée en 0, elle sera centrée autour du biais de carte, autrement dit de l’erreur.
Ainsi pour détecter les erreurs de carte, un test du est réalisé sur le résidu avec :
dim(y) étant la dimension de la matrice de chaque résidu.
Si le test échoue, deux cas sont possibles :
– S’il n’y a pas d’erreur dans la carte, le test va échouer dansαPourcents des cas.αdevant être choisi suffisamment faible pour limiter ces occurrences.
– S’il y a une erreur de carte, le test va échouer dans une proportion bien plus importante. Dans les deux cas, une variable d’exclusion, par exemple une variable « ne pas utiliser » ou en anglaisdon’t useest renseignée dans la carte pour permettre au système de localisation de ne pas utiliser ces amers lors des prochains passages.
Une telle variable peut évoluer à chaque répétition du procédé, se reproduisant après différents trajets ou passages devant un élément de la carte. Lorsque le test échoue malgré l’absence d’erreur de carte, il est possible que lors de prochain passage, le résidu diminue suffisamment pour passer le test.
Ainsi chaque nouvelle observation permet de faire évoluer les connaissances sur la fiabilité de l’élément de carte.
Dans une mise en œuvre alternative de l’invention, le test du permettant de déterminer la création de la variable d’exclusion n’est pas réalisé directement par le procédé selon l’invention, mais par les systèmes cherchant à utiliser l’élément de la carte en question. Cela peut être utile car différents systèmes peuvent avoir des tolérances au risque différentes. Aussi un système peut tolérer un risque variable en fonction de la situation. Le test du peut être réalisé par chaque système car les résidus et matrices de covariances sont stockés dans la carte.
Enfin on met en œuvre une étape de correction 327 de la carte.
Lorsqu’une erreur de carte est détectée, la variabledon’t useest renseignée.
Cela permet au système de localisation de ne pas utiliser d’éléments erronés. Perdre un amer pour la localisation n’est pas idéal car cela peut engendrer des erreurs trop importantes pour l’application de conduite autonome.
Il est alors préférable de corriger cette erreur pour permettre au système de localisation de continuer à utiliser les amers connus.
Pour corriger l’erreur, le modèle d’observation est utilisé. On connaît la relation :
On peut alors trouver la correction Δmà appliquer sur les références de l’amer pour obtenir un résidu nul.
Ainsi pour l’exemple d’une observation de panneau, on a la relation :
On en déduit donc que pour obtenir un résidu nul, les nouvelles coordonnées de l’amer doivent être :
Dans le cas où le résidu à la même dimension que la référence de l’amer, il y a une unique solution Δmqui peut être trouvé. Dans le cas où le résidu est de dimension inférieure à la dimension des éléments décrivant l’amer il n’y a pas unicité de la correction à apporter.
Par exemple, une mesure de distance à un marquage a un résidu de dimension 1 tandis que le marquage référencé par une droite est paramétré par deux termes.
Pour résoudre le système, une contrainte supplémentaire doit être ajouté.
Dans ce mode de réalisation, l’ajout d’une contrainte de parallélisme permet de trouver une unique correction.
Le procédé selon l’invention permet ainsi d’améliorer la fiabilité de la localisation par l’intermédiaire de la détection d’éléments de carte erronés.
De plus l’invention présente plusieurs avantages :
– la méthode s’intègre à une architecture de fusion standard sans nécessiter de modification interne au système de localisation. La seule contrainte supplémentaire est de sauvegarder les états et observations traitées par le système de localisation ce qui est peu coûteux. Cela rend cette méthode facilement intégrable à des systèmes existants.
– la méthode ne nécessite aucun calcul en temps réel mais exploite les calculs temps-réel déjà réalisé par le système de localisation. Le reste des calculs est fait a posteriori. Ainsi cette stratégie n’alourdit pas le système temps réel et est applicable à des systèmes où les ressources disponibles en temps réel sont limitées.
– la méthode est adaptée pour exploiter plusieurs trajectoires afin de détecter des erreurs. Cette capacité permet à cette méthode de détecter des erreurs qui n’aurait pas pu être observée au cours d’une seule trajectoire.
– la réduction du nombre d’éléments de la carte réduit également le nombre d’observations possibles et peut donc résulter en une moins bonne localisation. Il est donc préférable de corriger les erreurs détectées. La correction proposée permet ainsi de conserver l’élément plutôt que de ne plus l’utiliser pour la localisation. Cela permet à la méthode proposée de conduire à une meilleure localisation.

Claims (9)

  1. Procédé de supervision (3) d’une carte de navigation (14) numérique d’un véhicule automobile autonome, ledit véhicule automobile comprenant un module de localisation (1) adapté pour acquérir, stocker (321) et associer à des éléments de la carte de navigation (14) une pluralité de données d’état (10, 11) de la trajectoire du véhicule automobile et des mesures d’observation (10, 12, 13, 15) de l’environnement du véhicule automobile au cours d’un trajet, lesdites mesures d’observation (10,12,13,15) étant associées à des éléments présents sur ladite carte de navigation (14) de sorte que le module calcule les résidus d’observation du véhicule automobile par rapport aux données de la carte de navigation (14), et lorsque le trajet du véhicule automobile est terminé, ledit module de localisation (1) est alors adapté pour mettre en œuvre les étapes dudit procédé de supervision (3) comprenant :
    • Une étape de lissage (322) des données de la trajectoire du véhicule au cours dudit trajet réalisé ;
    • Une étape de recalcul (323) des résidus d’observations associés à des éléments de la carte de navigation (13) après ledit lissage des données de la trajectoire et le calcul de la matrice de covariance associée à chaque résidu ;
    • Une étape de fusion (324, 325) des résidus associés à un même élément de la carte de navigation numérique ;
    • Une étape d’estimation (326) de la fiabilité de chaque résidu obtenu après ladite étape de fusion ; et
    • Une étape de correction (327) de ladite carte de navigation numérique en fonction de l’estimation de fiabilité de chaque résidu.
  2. Procédé (3) selon la revendication 1, caractérisé en ce que ladite étape de lissage (322) comprend la mise en œuvre d’un lissage de Kalman par propagation rétroactive des corrections de position du véhicule automobile.
  3. Procédé (3) selon la revendication 1 ou 2 caractérisé en ce que ladite étape de fusion (324, 325) comprend une première fusion (324) des résidus recalculés associés à un même élément de la carte de navigation numérique par la méthode de l’intersection de covariance.
  4. Procédé (3) selon la revendication 3, caractérisé en ce que ladite étape de fusion (324, 325) comprend une seconde fusion (325) du résidu obtenu par la première fusion (324) avec, s’il existe, un résidu déjà enregistré lors d’une mise en œuvre précédente du procédé (3) pour le même élément de la carte de navigation numérique, de sorte que le résidu restant comprend l’ensemble des informations des résidus précédents.
  5. Procédé (3) selon l’une quelconque des revendications 1 à 4, caractérisé en ce que l’étape d’estimation (326) de la fiabilité de chaque résidu comprend la mise en œuvre d’un test du , en fonction d’une valeur de sensibilité prédéterminée.
  6. Procédé (3) selon la revendication 5, caractérisé en ce que lorsque ledit test du échoue, on attribue à l’élément de la carte de navigation associé audit résidu ayant échoué, résidu une variable d’exclusion indiquant que ladite carte est erronées pour ledit élément associé audit résidu.
  7. Procédé (3) selon la revendication 6, caractérisé en ce que ladite étape de correction (327) de ladite carte de navigation numérique comprend la correction des résidus associés à une variable d’exclusion.
  8. Module de localisation (1) d’un véhicule automobile autonome comprenant des moyens d’acquisition, de stockage et d’association à des éléments de la carte de navigation (14) d’une pluralité de données d’état (10, 11) de la trajectoire du véhicule automobile et des mesures d’observation (10, 12, 13, 15) de l’environnement du véhicule automobile au cours d’un trajet, lesdites mesures d’observation (10,12,13,15) étant associés à des éléments présents sur ladite carte de navigation (14) de sorte que le module est adapté pour calculer les résidus d’observation du véhicule automobile par rapport aux données de la carte de navigation (14), et lorsque le trajet du véhicule automobile est terminé, ledit module de localisation (1) comprend des moyens pour mettre en œuvre les étapes de supervision (3) suivantes :
    • Une étape de lissage (322) des données de la trajectoire du véhicule au cours dudit trajet réalisé ;
    • Une étape de recalcule (323) des résidus d’observations associés à des éléments de la carte de navigation (13) après ledit lissage des données de la trajectoire et le calcul de la matrice de covariance associée à chaque résidu ;
    • Une étape de fusion (324, 325) des résidus associés à un même élément de la carte de navigation numérique ;
    • Une étape d’estimation (326) de la fiabilité de chaque résidu obtenu après ladite étape de fusion ; et
    • Une étape de correction (327) de ladite carte de navigation numérique en fonction de l’estimation de fiabilité de chaque résidu.
  9. Véhicule automobile autonome comprenant un module de localisation (1) selon la revendication 8.
FR2102541A 2021-03-15 2021-03-15 Procédé de supervision automatique et embarqué de la précision des informations cartographiques par un véhicule autonome Active FR3120695B1 (fr)

Priority Applications (1)

Application Number Priority Date Filing Date Title
FR2102541A FR3120695B1 (fr) 2021-03-15 2021-03-15 Procédé de supervision automatique et embarqué de la précision des informations cartographiques par un véhicule autonome

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
FR2102541A FR3120695B1 (fr) 2021-03-15 2021-03-15 Procédé de supervision automatique et embarqué de la précision des informations cartographiques par un véhicule autonome
FR2102541 2021-03-15

Publications (2)

Publication Number Publication Date
FR3120695A1 true FR3120695A1 (fr) 2022-09-16
FR3120695B1 FR3120695B1 (fr) 2023-10-20

Family

ID=76283867

Family Applications (1)

Application Number Title Priority Date Filing Date
FR2102541A Active FR3120695B1 (fr) 2021-03-15 2021-03-15 Procédé de supervision automatique et embarqué de la précision des informations cartographiques par un véhicule autonome

Country Status (1)

Country Link
FR (1) FR3120695B1 (fr)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20140088855A1 (en) * 2012-09-27 2014-03-27 Google Inc. Determining changes in a driving environment based on vehicle behavior
US20200370920A1 (en) * 2019-05-22 2020-11-26 Trusted Positioning, Inc. Method and system for map improvement using feedback from positioning based on radar and motion sensors

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20140088855A1 (en) * 2012-09-27 2014-03-27 Google Inc. Determining changes in a driving environment based on vehicle behavior
US20200370920A1 (en) * 2019-05-22 2020-11-26 Trusted Positioning, Inc. Method and system for map improvement using feedback from positioning based on radar and motion sensors

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
D. PANNENM. LIEBNERW. BURGARD: "HD Map Change Détection with a Boosted Particle Filter", INTERNATIONAL CONFÉRENCE ON ROBOTICS AND AUTOMATION (ICRA, 2019, pages 2561 - 2567, XP033594303, DOI: 10.1109/ICRA.2019.8794329
WELTE ANTHONY ET AL: "Estimating the reliability of georeferenced lane markings for map-aided localization", 2019 IEEE INTELLIGENT VEHICLES SYMPOSIUM (IV), IEEE, 9 June 2019 (2019-06-09), pages 1225 - 1231, XP033606193, DOI: 10.1109/IVS.2019.8814214 *

Also Published As

Publication number Publication date
FR3120695B1 (fr) 2023-10-20

Similar Documents

Publication Publication Date Title
EP1714166B1 (fr) Dispositif de surveillance de l integrite des informations delivrees par un systeme hybride ins/gnss
FR3078398A1 (fr) Procede d’estimation de la position d’un vehicule sur une carte
EP3963286B1 (fr) Procédé de navigation à double filtre
US12236661B2 (en) Method for generating 3D reference points in a map of a scene
EP3765818B1 (fr) Procédé de calibration d'un gyromètre équipant un véhicule
FR3129737A1 (fr) Systeme et procede de navigation autonome base vision d’un satellite
WO2020120707A1 (fr) Production de cartes routières numériques par production participative
EP4308881B1 (fr) Procede et dispositif de determination d'une fiabilite d'une cartographie basse definition.
FR3005510A1 (fr) Procede ameliore de determination de la position et/ou de la vitesse d'un vehicule guide ; systeme associe.
FR3120695A1 (fr) Procédé de supervision automatique et embarqué de la précision des informations cartographiques par un véhicule autonome
FR3078399A1 (fr) Procede de selection d’un ensemble restreint ou vide d’hypotheses de positions possibles d’un vehicule
WO2021156569A1 (fr) Procede d'aide à la navigation d'un porteur mobile
FR2994258A1 (fr) Procede de compensation d'un signal de capteur d'un vehicule et systeme d'informations appliquant un tel procede
FR3139653A1 (fr) Procédé et dispositif de navigation pour un véhicule, système, véhicule, programme d'ordinateur et support d'informations associés
EP4229360B1 (fr) Procede de localisation d´objets routiers
FR3098777A1 (fr) Procédé d’insertion dans un convoi de véhicules autonomes par un véhicule automobile
FR3085082A1 (fr) Estimation de la position geographique d'un vehicule routier pour la production participative de base de donnees routieres
FR3106886A1 (fr) Détermination d’informations d’aide à la navigation sur un réseau routier
FR3139654A1 (fr) Procédé et dispositif de navigation pour un aéronef, système, aéronef, programme d'ordinateur et support d'informations associés
EP1462761A1 (fr) Aide à la navigation augmentée en intégrité verticale
EP2006707A1 (fr) Procédé de détermination d'une limite de protection avec compensation des retards de calcul
FR3028651A1 (fr) Determination automatique d'une limitation de vitesse sur une route a partir d'un systeme de navigation
FR3152626A1 (fr) Procédé et système de caractérisation automatique de données d’apprentissage acquises par un aéronef
WO2023061915A1 (fr) Procédé de détection d'une limite d'une voie de circulation
FR3119261A1 (fr) Procédé de gestion d’un système de transport comportant des étapes de mesure et d’étalonnage, et système de transport associé

Legal Events

Date Code Title Description
PLFP Fee payment

Year of fee payment: 2

PLSC Publication of the preliminary search report

Effective date: 20220916

PLFP Fee payment

Year of fee payment: 3

CA Change of address

Effective date: 20230512

PLFP Fee payment

Year of fee payment: 4

PLFP Fee payment

Year of fee payment: 5

PLFP Fee payment

Year of fee payment: 6