FR3077549A1 - Procede de determination de la trajectoire d’un vehicule automobile en absence de marquage au sol. - Google Patents

Procede de determination de la trajectoire d’un vehicule automobile en absence de marquage au sol. Download PDF

Info

Publication number
FR3077549A1
FR3077549A1 FR1851078A FR1851078A FR3077549A1 FR 3077549 A1 FR3077549 A1 FR 3077549A1 FR 1851078 A FR1851078 A FR 1851078A FR 1851078 A FR1851078 A FR 1851078A FR 3077549 A1 FR3077549 A1 FR 3077549A1
Authority
FR
France
Prior art keywords
points
vehicle
series
trajectory
point
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
FR1851078A
Other languages
English (en)
Other versions
FR3077549B1 (fr
Inventor
Audrey Rizzo
Rachid Attia
Stefano Mafrica
Nolwenn Monot
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.)
PSA Automobiles SA
Original Assignee
PSA Automobiles SA
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 PSA Automobiles SA filed Critical PSA Automobiles SA
Priority to FR1851078A priority Critical patent/FR3077549B1/fr
Priority to PCT/FR2019/050107 priority patent/WO2019155134A1/fr
Publication of FR3077549A1 publication Critical patent/FR3077549A1/fr
Application granted granted Critical
Publication of FR3077549B1 publication Critical patent/FR3077549B1/fr
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/10Path keeping
    • B60W30/12Lane keeping
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/04Traffic conditions
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/0097Predicting future conditions
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/588Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/167Driving aids for lane monitoring, lane changing, e.g. blind spot detection
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/403Image sensing, e.g. optical camera
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00Input parameters relating to objects
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/406Traffic density

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Human Computer Interaction (AREA)
  • Mathematical Physics (AREA)
  • Multimedia (AREA)
  • Theoretical Computer Science (AREA)
  • Traffic Control Systems (AREA)

Abstract

L'invention concerne un procédé de détermination de la trajectoire d'un véhicule automobile en absence de marquage au sol, comprenant les étapes d'établissement sur une distance de détection d'une grille d'occupation contenant une pluralité de points délimitant l'espace libre au devant dudit véhicule (100), de réalisation d'une extrapolation de la trajectoire dudit véhicule sur ladite distance de détection (200), de séparation des points de ladite grille en deux séries contenant respectivement les points situés de part et d'autre de la trajectoire extrapolée (300), de filtrage des deux séries de points afin de supprimer ou d'ajuster la position de ceux ne correspondant pas à une limite de la voie de circulation (400), d'établissement des profils des deux lignes de démarcation virtuelles délimitant la voie de circulation à partir des deux dites séries (500), et de détermination de la trajectoire dudit véhicule sur une distance d'anticipation supérieure ou égale à ladite distance de détection à partir des profils des dites lignes (600).

Description

PROCEDE DE DETERMINATION DE LA TRAJECTOIRE D'UN VEHICULE AUTOMOBILE EN ABSENCE DE MARQUAGE AU SOL.
Domaine de l'invention
La présente invention concerne le domaine des systèmes d'assistance à la conduite pour véhicules automobiles. Elle vise en particulier un procédé de détermination de la trajectoire d'un véhicule automobile en absence de marquage au sol.
Arrière-plan de l'invention
Les systèmes d'assistance à la conduite sont désormais largement répandus dans les véhicules automobiles récents et connaissent un développement rapide.
Depuis peu, on commence à voir apparaître des systèmes d'assistance à la conduite totalement autonomes contrôlant simultanément le déplacement longitudinal et le déplacement latéral du véhicule.
Tel est notamment le cas des systèmes d'assistance à la conduite sur autoroute communément désignés sous les acronymes HAD (pour « Highway Automated Driving ») ou AHDA (pour « Automatic Highway Driving Assist ») et aptes à délester entièrement le conducteur dans des situations de trafic fluide (vitesse proche de la limite réglementaire) sur des routes à chaussées séparées.
Ces derniers comportent notamment un module d'assistance active de maintien de trajectoire détectant les lignes de marquages au sol à l'aide de moyens optique tels qu'une caméra ou un lidar associés à un modèle numérique de reconnaissance.
Bien que ces modules d'assistance active de maintien de trajectoire deviennent de plus en plus performants de sorte à détecter les lignes de marquages au sol dans des contextes difficiles, il en demeure néanmoins que ces derniers peuvent éprouver des difficultés pour assurer un guidage latéral convenable dans certaines situations particulières et notamment lorsque ces lignes sont sales, partiellement effacées, recouvertes par d'autres véhicules situés en amont (par exemple, en cas d'embouteillage), ou bien encore lorsque la voie présente une courbure trop importante (par exemple, au niveau d'un rond-point).
On connaît également d'autres types de modules d'assistance active de maintien de trajectoire basés sur l'utilisation d'un récepteur d'information de géo-positionnement par satellite et d'une cartographie numérique référençant l'ensemble des routes constituant le réseau routier et dont chacun des points ou tronçons de cette cartographie est associé à des données de route ADAS (pour Advanced Driving Assistance System) relatives à ce point ou tronçon (courbure, pente, nombre de voies, la limitation de vitesse en vigueur, etc...).
Pour assurer un guidage latéral sûr du véhicule, ces derniers nécessitent l'utilisation d'une solution de géo-positionnement très précise dont le coût demeure prohibitif, ainsi que d'une cartographie haute définition (c'est-à-dire présentant une densité de points élevée) non encore disponible pour la grande majorité des réseaux routiers existants.
La demande de brevet US 2014/0379164 Al divulgue un dispositif d'assistance active de maintien de trajectoire d'un véhicule roulant sur une voie de circulation d'une route délimitée par des lignes de marquage, comportant des moyens optiques surveillant l'environnement situé en avant du véhicule, un récepteur d'information de géo-positionnement par satellite apte à localiser la position du véhicule, une cartographie numérique du réseau routier associant à chaque point de cette cartographie des données de route relatives à cette position.
Le dispositif est apte à établir un premier modèle de trajectoire établi à partir des lignes de démarcation de la voie de circulation détectées par les moyens optiques, ainsi qu'un second modèle de trajectoire établi à partir de la position du véhicule et des données issues de la cartographie électronique.
Ce dispositif comprend également un module de vérification mesurant l'écart entre les deux modèles de sorte à déterminer un indice de confiance, ainsi qu'un module de sélection qui opte pour le premier modèle lorsque les lignes de démarcation sont détectées par les moyens optiques, et qui opte pour le second modèle lorsque ces lignes ne sont pas détectées par les moyens optiques et que l'indice de confiance est supérieur à un niveau prédéterminé.
Toutefois, lorsque ces lignes ne sont pas détectées par les moyens optiques et que l'indice de confiance est inférieur au niveau prédéterminé, ce type de dispositif ne permet pas de déterminer de trajectoire pour le véhicule.
En outre, dans certaines situations particulières comme par exemple à l'intérieur d'un tunnel ou d'un chenal de péage), le récepteur d'information de géo-positionnement par satellite s'avère incapable de localiser la position du véhicule.
Objet et résumé de l'invention
La présente invention vise à améliorer la situation.
Elle propose à cet effet un procédé de détermination de la trajectoire d'un véhicule automobile en absence de marquage au sol, caractérisé en ce qu'il comprend les étapes suivantes :
- établissement, à partir des données provenant de moyens de détection de l'environnement au devant du véhicule et sur une distance de détection, d'une grille d'occupation bidimensionnelle contenant une pluralité de points délimitant l'espace libre au devant dudit véhicule ;
- réalisation d'une extrapolation de la trajectoire dudit véhicule sur ladite distance de détection ;
- séparation des points de ladite grille d'occupation en deux séries de points contenant respectivement les points situés de part et d'autre de la trajectoire extrapolée ;
- filtrage des deux séries de points de ladite grille d'occupation afin de supprimer ou d'ajuster la position de ceux ne correspondant pas à une limite de la voie de circulation ;
- établissement, sur ladite distance de détection, des profils des deux lignes de démarcation virtuelles délimitant la voie de circulation à partir des deux dites séries de points ; et
- détermination de la trajectoire dudit véhicule sur une distance d'anticipation supérieure ou égale à ladite distance de détection à partir des profils des dites lignes de démarcation.
Le procédé selon l'invention permet ainsi, sans faire appel à une cartographie associée à récepteur d'information de géo-positionnement par satellite, de déterminer la trajectoire que doit suivre le véhicule lorsque le marquage au sol est absent ou non visible.
Ce procédé s'avère ainsi particulièrement utile dans certaines situations particulières où le récepteur d'information de géopositionnement par satellite s'avère incapable de localiser la position du véhicule, et notamment à l'intérieur d'un tunnel ou d'un chenal de péage.
Selon des caractéristiques préférées du procédé selon l'invention, prises seules ou en combinaison :
- ladite distance de détection est comprise entre 50 et 200 mètres ;
- ladite étape de filtrage comporte une sous-étape consistant, pour chacune des deux dites séries, à supprimer les groupes de points successifs dont les composantes longitudinales présentent un écart inférieur à un delta prédéterminé ;
- ledit delta prédéterminé est compris entre 20 et 80 cm ;
- ladite étape de filtrage comporte une sous-étape consistant, pour chacune des deux séries, à comparer successivement deux à deux dans le sens longitudinal et en partant du niveau dudit véhicule, l'écartement latéral des points de cette série vis-à-vis de l'axe longitudinal dudit véhicule, le second point de chaque couple de points comparés étant ramené latéralement au niveau du premier point lorsque l'écartement latéral dudit second point vis-à-vis dudit axe longitudinal est supérieur à celui dudit premier point ;
- le nombre de points successifs ramenés latéralement est limité à une fenêtre longitudinale maximale ;
- la dite fenêtre longitudinale maximale est comprise entre 5 et 50 mètres ;
- ladite extrapolation de la trajectoire dudit véhicule est déterminée à partir de l'angle initial de braquage du volant ou de la vitesse initiale de lacet ;
- le profil de chacune des dites lignes de démarcation est obtenu en les approximant chacune par une fonction polynomiale au troisième degré correspondante dans un espace affine plan ; et/ou
- les paramètres de chacune des dites fonctions polynomiales sont déterminés à partir des points de la série correspondante.
Brève description des dessins
L'exposé de l'invention sera maintenant poursuivi par la description détaillée d'un exemple de réalisation, donnée ci-après à titre illustratif mais non limitatif, en référence aux dessins annexés, sur lesquels :
- la figure 1 est un diagramme fonctionnel d'un système d'assistance automatisée à la conduite intégrant un dispositif d'assistance active de maintien de trajectoire ; et
- la figure 2 représente une grille d'occupation bidimensionnelle contenant une pluralité de points délimitant l'espace libre au devant dudit véhicule ; et
- la figure 3 est un organigramme du procédé selon l'invention de détermination de la trajectoire d'un véhicule automobile en absence de marquage au sol.
Description détaillée
En référence à la figure 1, le système d'assistance automatisée à la conduite 1 comporte un module de détection 10, un module d'actionnement 20, un module d'évaluation du contexte environnemental de conduite 30, un module de navigation 40, ainsi qu'une unité de pilotage 50.
Le module de détection 10 comporte des moyens de détection de l'environnement situé en avant du véhicule comprenant au moins une caméra vidéo 11 implantée derrière le pare-brise.
En variante, le module de détection 10 peut comporter un lidar 12 en remplacement ou en plus de la ou des caméras vidéo 11.
Le module 10 comprend en outre une pluralité de capteurs mesurant certains paramètres internes de conduite tels que la vitesse instantanée du véhicule, l'angle de braquage du volant ou encore la vitesse de lacet.
Le module d'actionnement 20 comporte une pluralité d'actionneurs aptes à agir sur la direction, l'accélération, le freinage et la boîte de vitesse pour assurer une conduite entièrement automatisée du véhicule.
Le module d'évaluation du contexte environnemental de conduite 30 est apte à déterminer à partir des données fournies par le module de détection 10 le type de route empruntée (autoroute, voie rapide ou bien route secondaire), le marquage au sol lorsqu'il est présent et visible (couleur, largeur et espacement des lignes), le niveau de fluidité du trafic routier et la présence éventuelle d'une barrière ou d'un terre-plein central de séparation entre les deux sens de circulation.
Ce module 30 est également apte à établir, à partir des données transmises par le module de détection 10, une grille d'occupation bidimensionnelle (voir figure 2) contenant une pluralité de points délimitant l'espace libre au devant dudit véhicule (ou « freespace » selon le terme anglo-saxon communément utilisé) et correspondant à la zone libre située au devant du véhicule et à l'intérieur de laquelle ce véhicule peut manœuvrer sans entrer en collision avec les obstacles environnants.
Cette grille d'occupation bidimentionnelle est dotée d'un repère cartésien (X,Y) centré sur le véhicule, et comprenant une pluralité de points correspondant chacun à la position de l'obstacle le plus proche du véhicule détecté par la caméra 11 sur un secteur angulaire prédéterminée.
Par exemple, si l'on souhaite obtenir une grille d'occupation contenant 100 points pour une caméra présentant un angle de détection de 140°, chaque point correspondra à un secteur angulaire de 1,4°.
Le module de navigation 40 comprend un récepteur d'information de géo-positionnement par satellite 41 apte à déterminer la position du véhicule, une cartographie numérique 42 et un système de calcul d'itinéraire 43.
Le récepteur d'information de géo-positionnement par satellite 41 est un récepteur utilisant le système GPS (Global Positioning System) qui capte les signaux radio transmis par au moins trois satellites du système GPS et peut, en calculant les temps de propagation de ces signaux entre les satellites et lui, connaître sa distance par rapport à ceux-ci et, par trilatération, déterminer la position du véhicule placé en visibilité des satellites.
En variante, le récepteur de géo-positionnement par satellite 41 peut utiliser un autre système de géo-positionnement par satellite (GNSS), tel que par exemple le système GLONASS, le système BEIDOU ou encore le système GALILEO.
La cartographie numérique 42 référence l'ensemble des routes constituant le réseau routier sous la forme de points plus ou moins espacés et reliés entre eux, en associant pour chacun de ses points des données complémentaires ADAS (pour Advanced Driving Assistance System) relatives à la classification de la route, à sa géométrie (courbure, pente, etc.), au nombre de voies qu'elle comporte ou bien encore à la limitation de vitesse en vigueur.
Cette cartographie 42 est stockée dans une mémoire locale de type disque dur ou flash, ou bien sur un serveur distant. L'ensemble des informations qu'il contient peut-être mis à jour par des moyens de communication ou des moyens de lecture d'un support de données.
Le module de calcul d'itinéraire 43 comporte un calculateur apte à déterminer un itinéraire sur le réseau routier depuis un point de départ défini par l'utilisateur ou correspondant à la position actuelle du véhicule, et jusqu'à un point de destination sélectionné par l'utilisateur.
L'unité de pilotage 50 qui gère la conduite autonome du véhicule, comporte au moins un calculateur associé à des moyens de stockage comprenant de la mémoire non volatile de type EEPROM ou FLASH et de la mémoire vive.
Lorsque le contexte évalué par le module d'évaluation du contexte environnemental de conduite 40 s'y prête (par exemple, en cas de trafic dense ou d'embouteillage lorsque le véhicule circule sur une route à chaussées séparées), l'unité de pilotage 50 est apte à commander le module d'actionnement 20 pour assurer une conduite entièrement autonome du véhicule.
En particulier, le contrôle du déplacement latéral du véhicule est piloté par un module d'assistance active de maintien de trajectoire 51 intégré à cette unité de pilotage.
Selon l'invention, la mémoire non volatile de l'unité de pilotage 50 stocke un processus de détermination sur une distance d'anticipation de la trajectoire d'un véhicule automobile en absence de marquage au sol.
On va maintenant décrire en détails et à l'appui de l'organigramme de la figure 3, les différentes étapes de ce processus qui est mis en œuvre de manière périodique (suivant une période prédéterminée comprise de préférence entre 20 et 100 millisecondes et avantageusement égal à 40 millisecondes) lorsque le mode d'assistance à la conduite entièrement autonome est activé, en l'absence de marquages au sol et de données de géo-positionnement par satellite (par exemple lorsque le véhicule pénètre à l'intérieur d'un tunnel ou d'un chenal de péage).
La première étape 100 de ce processus consiste à établir, à partir des données provenant des moyens de détection de l'environnement au devant du véhicule (c'est-à-dire en l'espèce, de la caméra 11) et sur une distance de détection comprise par exemple entre 50 et 200 mètres, une grille d'occupation bidimensionnelle contenant une pluralité de points délimitant l'espace libre au devant dudit véhicule.
Cette grille d'occupation est représentée dans un espace affine plan muni d'un repère cartésien centré sur le véhicule et dont l'axe longitudinal est confondu avec celui du véhicule.
La figure 2 illustre un exemple d'une telle grille d'occupation réalisée sur une distance de détection de 100 mètres.
Le module d'assistance active de maintien de trajectoire 51 réalise ensuite une extrapolation de la trajectoire du véhicule sur la distance de détection (étape 200).
De manière avantageuse et tel qu'illustré sur l'exemple de la figure 2, cette trajectoire extrapolée est en arc de cercle dont la courbure (et donc le rayon de ce cercle) est déterminée à partir de l'angle de braquage initial du volant (i.e. : l'angle de braquage du volant à l'origine du repère, c'est-à-dire à X=0) ou de la vitesse initiale de lacet (i.e. : la vitesse de lacet à l'origine du repère, c'est-à-dire à X=0) et en supposant que la cinématique du véhicule épouse un modèle numérique simple de type bicyclette.
En variante et afin de faciliter les calculs, la trajectoire extrapolée pourra correspondre simplement à l'axe du véhicule, c'est-à-dire à l'axe longitudinal du repère de la grille d'occupation.
Le processus sépare ensuite les points de la grille d'occupation en deux séries de points contenant respectivement les points situés de part et d'autre de la trajectoire extrapolée (étape 300).
Sur l'exemple de la figure 2, les points situés à gauche de la trajectoire extrapolée Te correspondront ainsi à la première série, tandis que ceux situés à sa droite correspondront à la seconde série.
Un filtrage est ensuite effectué sur chacune des deux séries de points de la grille d'occupation afin de supprimer ou d'ajuster la position de ceux ne correspondant pas à une limite de la voie de circulation (étape 400).
Cette étape de filtrage est effectuée en deux sous-étapes successives 410 et 420.
La première sous-étape de filtrage 410 consiste, pour chacune des deux séries, à supprimer les groupes de points successifs dont les composantes longitudinales présentent un écart inférieur à un delta prédéterminé compris par exemple entre 20 et 80 cm, ces groupes de points pouvant par exemple correspondre au fond de l'espace libre, au devant ou à l'arrière d'un véhicule.
Ainsi, si on prend pour exemple la première série de la grille d'occupation de la figure 2, les points 10 à 14 seront supprimés.
La seconde sous-étape de filtrage 420 consiste, pour chacune des deux séries, à comparer successivement deux à deux dans le sens longitudinal et en partant du niveau du véhicule (c'est-à-dire de l'axe latéral Y du repère de la grille), l'écartement latéral des points de cette série vis-à-vis de l'axe longitudinal X du véhicule et du repère.
Pour chaque couple de points comparés, si l'écartement latéral du second point vis-à-vis de l'axe longitudinal X est inférieur ou égal à celui du premier point, alors la position de ce second point ne sera pas modifiée.
Au contraire, si l'écartement latéral de ce second point vis-à-vis de l'axe longitudinal X est supérieur à celui du premier point, alors ce second point sera ramené latéralement vers cet axe longitudinal X au niveau du premier point.
Il est à noter qu'à chaque nouvelle comparaison de couple de points, c'est la position actualisée du premier point suite à la comparaison précédente qui sera prise en compte.
Ainsi, si on prend pour exemple la première série de la grille d'occupation de la figure 2, la position du point 2 (respectivement 3) ne sera pas modifiée car ce dernier se situe plus près de l'axe longitudinal X que le point 1 (respectivement 2).
Le point 4, se trouvant initialement plus éloigné de l'axe longitudinal X que le point 3, sera quant à lui ramené latéralement à la même ordonnée que ce point 3 comme indiqué par la flèche.
Il en sera de même pour le point 5 (respectivement 6, 7, 8 et 9) se trouvant initialement plus éloigné de l'axe longitudinal X que le point actualisé (respectivement 5, 6, 7 et 8).
Enfin, les points 15 à 21 se trouvant initialement chacun plus proche ou à égale distance de l'axe longitudinal X que le point précédent correspondant ne seront pas déplacés.
De manière avantageuse et afin de limiter l'amplitude des pertes de données, le nombre de points successifs ramenés latéralement est limité à une fenêtre longitudinale maximale f comprise par exemple entre et 50 mètres.
Dans l'exemple de la figure 2, cette fenêtre longitudinale maximale F s'étend sur 40 mètres ce qui n'a pas d'impact sur la première série de points car l'écart longitudinal ei entre les points 4 et 9 est inférieur à cette distance.
Par contre, sur la seconde série de points, le point 13 et les suivants 14, 15 ne seront pas ramenés latéralement au niveau du point 6 et des points 7 à 12 actualisés car l'écart longitudinal entre les points 7 à 13 est supérieur à cette fenêtre longitudinale maximale F.
La position latérale du point 13 demeurant inchangée, celle du point 14 le restera également car ce dernier se situe plus près de l'axe longitudinal X que ce point 13.
Celle du point 15 ne sera non plus modifiée pour la même raison (ce dernier se situant plus près de l'axe longitudinal X que ce point 14).
Une fois l'étape de filtrage terminée, le module d'assistance active de maintien de trajectoire 51 établit sur la distance de détection, les profils de deux lignes de démarcation virtuelles délimitant la voie de circulation du véhicule à partir des deux séries de points (étape 500).
Plus précisément, le profil des deux lignes de démarcation est obtenu en les approximant chacune par une fonction polynomiale au troisième degré correspondante dans un espace affine plan muni d'un repère cartésien (X, Y) centré sur le véhicule :
1
Y = — (dérivée initiale de la courbure) X3 + — (courbure initiale) X2 + (cap initial) X + Yo
2 où :
- X et Y correspondent respectivement aux composantes longitudinale et latérale d'un point appartenant à cette ligne de démarcation ;
- la dérivée initiale de la courbure correspond à la valeur de la dérivée de la courbure à l'origine du repère, c'est-à-dire au niveau du véhicule à X=0 ;
- la courbure initiale correspond à la valeur de la dérivée de la courbure à l'origine du repère, c'est-à-dire au niveau du véhicule à X=0 ;
- le cap (ou angle de lacet) initial correspond à la valeur du cap à l'origine du repère, c'est-à-dire au niveau du véhicule à X=0 ; et
- Yo correspondant à la position latérale initiale de la ligne de démarcation à l'origine du repère, c'est-à-dire au niveau du véhicule à X=0.
Les paramètres de chacune des deux fonctions correspondant aux deux lignes de démarcation (à savoir, la position latérale initiale Yo, le cap initial, la courbure initiale et la dérivée initiale de la courbure) sont déterminés en utilisant la méthode des moindres carrés à partir des points de la série correspondante.
Sur l'exemple de la figure 2, les profils correspondants à ces deux lignes de démarcation sont référencés Li et L2.
A partir des profils de ces deux lignes de démarcation de la voie de circulation, le processus détermine enfin la trajectoire que va réellement suivre le véhicule sur une distance d'anticipation prédéterminée supérieure ou égale à la distance de détection (étape 600), en faisant par exemple en sorte que ce véhicule demeure en permanence centré sur cette voie de circulation.
Cette distance d'anticipation sera par exemple comprise entre 100 et 200 m.
Selon des variantes de réalisation, cette distance d'anticipation peut également varier en fonction de la vitesse du véhicule et correspondre par exemple à la distance parcourue par ce véhicule pendant une durée prédéfinie comprise avantageusement entre 2 et 4 secondes et de préférence égale à 3 secondes.
D'une manière générale, on rappelle que la présente invention ne se limite pas aux formes de réalisation décrites et représentées, mais qu'elle englobe toute variante d'exécution à la portée de l'homme du métier.

Claims (10)

  1. REVENDICATIONS
    1. Procédé de détermination de la trajectoire d'un véhicule automobile, circulant sur une voie de circulation, en absence de marquage au sol, caractérisé en ce qu'il comprend les étapes suivantes :
    - établissement, à partir des données provenant de moyens de détection (11) de l'environnement au devant du véhicule et sur une distance de détection, d'une grille d'occupation bidimensionnelle contenant une pluralité de points délimitant l'espace libre au devant dudit véhicule (100) ;
    - réalisation d'une extrapolation de la trajectoire dudit véhicule (Te) sur ladite distance de détection (200) ;
    - séparation des points de ladite grille d'occupation en deux séries de points contenant respectivement les points situés de part et d'autre de la trajectoire extrapolée (300) ;
    - filtrage des deux séries de points de ladite grille d'occupation afin de supprimer ou d'ajuster la position de ceux ne correspondant pas à une limite de la voie de circulation (400) ;
    - établissement, sur ladite distance de détection, des profils (Li, L2) des deux lignes de démarcation virtuelles délimitant la voie de circulation à partir des deux dites séries de points (500) ; et
    - détermination de la trajectoire dudit véhicule sur une distance d'anticipation supérieure ou égale à ladite distance de détection à partir des profils des dites lignes de démarcation (600).
  2. 2. Procédé selon la revendication 1, caractérisé en ce que ladite distance de détection est comprise entre 50 et 200 mètres.
  3. 3. Procédé selon l'une des revendications 1 ou 2, caractérisé en ce que ladite étape de filtrage (400) comporte une sous-étape (410) consistant, pour chacune des deux dites séries, à supprimer les groupes de points successifs dont les composantes longitudinales présentent un écart inférieur à un delta prédéterminé.
  4. 4. Procédé selon la revendication 3, caractérisé en ce que ledit delta prédéterminé est compris entre 20 et 80 cm.
  5. 5. Procédé selon l'une des revendications 1 à 4, caractérisé en ce que ladite étape de filtrage (400) comporte une sous-étape (420) consistant, pour chacune des deux séries, à comparer successivement deux à deux dans le sens longitudinal et en partant du niveau dudit véhicule, l'écartement latéral des points de cette série vis-à-vis de l'axe longitudinal dudit véhicule, le second point de chaque couple de points comparés étant ramené latéralement au niveau du premier point lorsque l'écartement latéral dudit second point vis-à-vis dudit axe longitudinal est supérieur à celui dudit premier point.
  6. 6. Procédé selon la revendication 5, caractérisé en ce que le nombre de points successifs ramenés latéralement est limité à une fenêtre longitudinale maximale (F).
  7. 7. Procédé selon la revendication 6, caractérisé en ce que ladite fenêtre longitudinale maximale (F) est comprise entre 5 et 50 mètres.
  8. 8. Procédé selon l'une des revendications 1 à 7, caractérisé en ce que ladite extrapolation de la trajectoire dudit véhicule (Te) est déterminée à partir de l'angle initial de braquage du volant ou de la vitesse initiale de lacet.
  9. 9. Procédé selon l'une des revendications 1 à 8, caractérisé en ce que le profil de chacune des dites lignes de démarcation (Li, L2) est obtenu en les approximant chacune par une fonction polynomiale au troisième degré correspondante dans un espace affine plan.
  10. 10. Procédé selon la revendication 9, caractérisé en ce que les paramètres de chacune des dites fonctions polynomiales sont déterminés à partir des points de la série correspondante.
FR1851078A 2018-02-08 2018-02-08 Procede de determination de la trajectoire d’un vehicule automobile en absence de marquage au sol. Active FR3077549B1 (fr)

Priority Applications (2)

Application Number Priority Date Filing Date Title
FR1851078A FR3077549B1 (fr) 2018-02-08 2018-02-08 Procede de determination de la trajectoire d’un vehicule automobile en absence de marquage au sol.
PCT/FR2019/050107 WO2019155134A1 (fr) 2018-02-08 2019-01-18 Procede de determination de la trajectoire d'un vehicule automobile en absence de marquage au sol.

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
FR1851078A FR3077549B1 (fr) 2018-02-08 2018-02-08 Procede de determination de la trajectoire d’un vehicule automobile en absence de marquage au sol.
FR1851078 2018-02-08

Publications (2)

Publication Number Publication Date
FR3077549A1 true FR3077549A1 (fr) 2019-08-09
FR3077549B1 FR3077549B1 (fr) 2023-04-14

Family

ID=61873577

Family Applications (1)

Application Number Title Priority Date Filing Date
FR1851078A Active FR3077549B1 (fr) 2018-02-08 2018-02-08 Procede de determination de la trajectoire d’un vehicule automobile en absence de marquage au sol.

Country Status (2)

Country Link
FR (1) FR3077549B1 (fr)
WO (1) WO2019155134A1 (fr)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3882813A1 (fr) * 2020-03-20 2021-09-22 Aptiv Technologies Limited Procédé de génération d'un réseau d'occupation dynamique

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080291276A1 (en) * 2003-10-24 2008-11-27 Martin Randler Method for Driver Assistance and Driver Assistance Device on the Basis of Lane Information
DE102008036009A1 (de) * 2008-03-28 2009-10-01 Volkswagen Ag Verfahren zum Kollisionsschutz eines Kraftfahrzeugs und Parkhausassistent
WO2010127650A1 (fr) * 2009-05-06 2010-11-11 Conti Temic Microelectronic Gmbh Procédé d'analyse de données de détection pour un véhicule à moteur
US20130173232A1 (en) * 2010-04-20 2013-07-04 Conti Temic Microelectronic Gmbh Method for determining the course of the road for a motor vehicle
DE102013002889A1 (de) * 2013-02-19 2014-08-21 Volkswagen Aktiengesellschaft Verfahren und Vorrichtung zur Modellierung eines Fahrbahnrandes und Fahrzeug mit einer solchen Vorrichtung
EP3179270A1 (fr) * 2015-12-08 2017-06-14 Delphi Technologies, Inc. Système d'extension de voie ou de maintien de voie par capteur télémétrique pour véhicule automatisé

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8996197B2 (en) 2013-06-20 2015-03-31 Ford Global Technologies, Llc Lane monitoring with electronic horizon

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080291276A1 (en) * 2003-10-24 2008-11-27 Martin Randler Method for Driver Assistance and Driver Assistance Device on the Basis of Lane Information
DE102008036009A1 (de) * 2008-03-28 2009-10-01 Volkswagen Ag Verfahren zum Kollisionsschutz eines Kraftfahrzeugs und Parkhausassistent
WO2010127650A1 (fr) * 2009-05-06 2010-11-11 Conti Temic Microelectronic Gmbh Procédé d'analyse de données de détection pour un véhicule à moteur
US20130173232A1 (en) * 2010-04-20 2013-07-04 Conti Temic Microelectronic Gmbh Method for determining the course of the road for a motor vehicle
DE102013002889A1 (de) * 2013-02-19 2014-08-21 Volkswagen Aktiengesellschaft Verfahren und Vorrichtung zur Modellierung eines Fahrbahnrandes und Fahrzeug mit einer solchen Vorrichtung
EP3179270A1 (fr) * 2015-12-08 2017-06-14 Delphi Technologies, Inc. Système d'extension de voie ou de maintien de voie par capteur télémétrique pour véhicule automatisé

Also Published As

Publication number Publication date
WO2019155134A1 (fr) 2019-08-15
FR3077549B1 (fr) 2023-04-14

Similar Documents

Publication Publication Date Title
FR3049560B1 (fr) Procede et systeme d'assistance au changement de voie de roulage pour vehicule automobile
EP3519267B1 (fr) Assistance à la conduite sur voie rapide à chaussées séparées par un rail de sécurité
CA3068022A1 (fr) Plateforme et procede de supervision d'une infrastructure pour vehicules de transport, vehicule, systeme de transport et programme d'ordinateur associes
WO2022175034A1 (fr) Procédé d'activation d'un système d'évitement d'obstacle pour véhicule automobile
WO2019155134A1 (fr) Procede de determination de la trajectoire d'un vehicule automobile en absence de marquage au sol.
FR3075949A1 (fr) Procede de determination sur une distance d’anticipation de la trajectoire d’un vehicule automobile.
EP3727974B1 (fr) Procédé de détection durant une phase de conduite automatisée d'un vehicule de sa présence dans une voie d'insertion vers une route à chaussée separée
WO2014016486A2 (fr) Systeme d'assistance au changement de voie pour un vehicule
FR3076045A1 (fr) Procede de surveillance d'un environnement d'un premier element positionne au niveau d'une voie de circulation, et systeme associe
EP3755593A1 (fr) Dispositif et procédé d'aide à la conduite d'un véhicule automobile
RU2757037C1 (ru) Способ и система для выявления наличия колеи на текущей местности
WO2018069060A1 (fr) Dispositif de localisation et dispositif de production de données d'intégrité
FR3086446A1 (fr) Procede de detection et de gestion d’une voie d’insertion par un vehicule autonome ou partiellement autonome
WO2022129564A1 (fr) Méthode de contrôle pour contrôler le déplacement d'un véhicule automobile autonome
EP4015332A1 (fr) Méthode de supervision pour le contrôle d'un véhicule automobile autonome
FR3141911A1 (fr) Procédé et système de gestion de la vitesse longitudinale d’un véhicule
FR3137781A1 (fr) Procédé et dispositif de détermination d’une largeur d’une voie latérale adjacente à une voie de circulation
FR3138098A1 (fr) Procédé et dispositif de détermination d’une vitesse de rotation en lacet d’un véhicule
EP4251485A1 (fr) Procédé et dispositif de détermination d'une ligne virtuelle de délimitation entre deux voies de circulation
WO2020239783A1 (fr) Procédé et dispositif de détermination de distance de visibilité pour l'aide au dépassement
WO2019220030A1 (fr) Procédé et dispositif d'assistance à la conduite automatisée d'un véhicule par détermination de la sûreté d'une trajectoire proposée
WO2019122562A1 (fr) Procede de detection d'une prochaine fusion de la voie de circulation d'un vehicule avec une voie adjacente durant une phase de conduite automatisee
FR3137780A1 (fr) Procédé et dispositif de détermination d’un tracé arrière d’au moins une délimitation latérale de voie de circulation
WO2023144471A1 (fr) Procédé et dispositif de contrôle d'un système de guidage latéral d'un véhicule
FR3092914A1 (fr) Procédé de détermination de la trajectoire d'un véhicule comprenant quatre roues directrices

Legal Events

Date Code Title Description
PLFP Fee payment

Year of fee payment: 2

PLSC Publication of the preliminary search report

Effective date: 20190809

PLFP Fee payment

Year of fee payment: 3

PLFP Fee payment

Year of fee payment: 4

PLFP Fee payment

Year of fee payment: 5

PLFP Fee payment

Year of fee payment: 6

PLFP Fee payment

Year of fee payment: 7