FR3033912A1 - Procede d'estimation de parametres geometriques representatifs de la forme d'une route, systeme d'estimation de tels parametres et vehicule automobile equipe d'un tel systeme - Google Patents
Procede d'estimation de parametres geometriques representatifs de la forme d'une route, systeme d'estimation de tels parametres et vehicule automobile equipe d'un tel systeme Download PDFInfo
- Publication number
- FR3033912A1 FR3033912A1 FR1500548A FR1500548A FR3033912A1 FR 3033912 A1 FR3033912 A1 FR 3033912A1 FR 1500548 A FR1500548 A FR 1500548A FR 1500548 A FR1500548 A FR 1500548A FR 3033912 A1 FR3033912 A1 FR 3033912A1
- Authority
- FR
- France
- Prior art keywords
- road
- parameters
- motor vehicle
- geometric model
- points
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 42
- 238000004458 analytical method Methods 0.000 claims abstract description 24
- 230000003247 decreasing effect Effects 0.000 claims description 2
- 238000001514 detection method Methods 0.000 claims description 2
- 238000012804 iterative process Methods 0.000 claims description 2
- 230000006870 function Effects 0.000 description 10
- 230000007704 transition Effects 0.000 description 4
- 238000005259 measurement Methods 0.000 description 3
- 238000004804 winding Methods 0.000 description 3
- 230000011664 signaling Effects 0.000 description 2
- 230000001594 aberrant effect Effects 0.000 description 1
- 238000012512 characterization method Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 239000003550 marker Substances 0.000 description 1
- 230000035484 reaction time Effects 0.000 description 1
- 230000000717 retained effect Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Estimation 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/02—Estimation 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/06—Road conditions
- B60W40/072—Curvature of the road
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/50—Context or environment of the image
- G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
- G06V20/588—Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2556/00—Input parameters relating to data
- B60W2556/45—External transmission of data to or from the vehicle
- B60W2556/50—External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mathematical Physics (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- General Physics & Mathematics (AREA)
- Multimedia (AREA)
- Theoretical Computer Science (AREA)
- Traffic Control Systems (AREA)
Abstract
L'invention concerne un procédé d'estimation de paramètres géométriques (R1M) représentatifs de la forme d'une route, au moyen d'un capteur et d'un module d'analyse équipant un véhicule automobile (100) situé sur ladite route, comprenant notamment les étapes suivantes : - estimation, en fonction de positions de points détectés repérant un bord (LM ; LL) au moins d'une voie de circulation (LA) de ladite route, de paramètres (R1M) d'un premier modèle géométrique, représentatif de la forme d'une partie au moins de ladite route, - détermination d'une position limite, par rapport au véhicule automobile, jusqu'à laquelle le premier modèle géométrique précédemment paramétré décrit avec une précision donnée la forme de ladite route, et - estimation de paramètres d'un second modèle géométrique représentatif de la forme de ladite route au-delà de ladite position limite. Un système visant l'estimation de tels paramètres, et un véhicule automobile (100) équipé d'un tel système sont également décrits.
Description
1 Procédé d'estimation de paramètres géométriques représentatifs de la forme d'une route, système d'estimation de tels paramètres et véhicule automobile équipé d'un tel système DOMAINE TECHNIQUE AUQUEL SE RAPPORTE L'INVENTION La présente invention concerne de manière générale le domaine des procédés et des systèmes d'aide à la conduite d'un véhicule automobile. Elle concerne plus particulièrement un procédé d'estimation de paramètres géométriques représentatifs de la forme d'une route, au moyen d'un capteur et d'un module d'analyse équipant un véhicule automobile situé sur ladite route, le capteur, par exemple un capteur d'images, délivrant des données représentatives de l'environnement faisant face au véhicule automobile. L'invention concerne également un système visant l'estimation de tels paramètres, et un véhicule automobile équipé d'un tel système et d'un module d'aide à la conduite. L'invention s'applique particulièrement avantageusement dans les systèmes d'avertissement de sortie de route, dans les systèmes d'assistance au freinage, ou dans les systèmes de direction assistée. ARRIERE-PLAN TECHNOLOGIQUE Il est utile, dans les systèmes d'aide à la conduite, de déterminer des paramètres géométriques représentant de manière synthétique la forme d'une route sur laquelle circule un véhicule automobile, afin, par exemple, de commander un dispositif de direction assistée permettant au véhicule automobile de se maintenir sensiblement au milieu de la voie de circulation qu'il emprunte, sans intervention de son conducteur, ou avec une intervention réduite de ce dernier. De tels paramètres géométriques peuvent être estimés à partir d'un relevé des positions de points situés le long d'un bord de cette voie de circulation, et sur la base d'un modèle géométrique de route.
Différents modèles géométriques sont connus, pour réaliser une telle estimation, notamment : - un modèle de route circulaire, dans lequel la portion de route faisant face au véhicule automobile est décrite par un arc de cercle, - un modèle représentant cette portion de route par un arc de clothoïde, 3033912 2 ou encore - un modèle représentant cette portion de route, dans un repère orthonormé situé dans le plan qu'elle définit, par une fonction polynomiale par morceaux appelée couramment « spline ».
5 Mais la précision de description d'un tronçon de route donné, par un modèle unique, dépend fortement du contexte et peut dans certaines situations limiter fortement les performances d'un système d'aide à la conduite. Lors d'une circulation sur une voie d'autoroute par exemple, dont les virages sont particulièrement longs et peu courbés, un tronçon de route faisant 10 face à un véhicule automobile peut être décrit avec précision par un arc de cercle. Mais en revanche, lors d'une circulation sur une route de campagne sinueuse, un tronçon de route situé face à un véhicule automobile peut fréquemment présenter une partie rectiligne suivie d'un virage. Un arc de cercle ou de clothoïde décrit alors de manière imprécise l'ensemble d'un tel tronçon.
15 Il est connu du document EP 2 172 826 de déterminer la distance jusqu'à laquelle une partie de route s'étendant face à un véhicule automobile est susceptible d'être décrite avec précision par un arc de cercle, ou par un arc de clothoïde, préalablement à l'estimation des paramètres géométriques de cet arc. Cette distance est déterminée sur la base de données cartographiques de cette 20 route et d'une géolocalisation du véhicule automobile. OBJET DE L'INVENTION Dans ce contexte, l'invention propose un procédé d'estimation de paramètres géométriques représentatifs de la forme d'une route, au moyen d'un capteur et d'un module d'analyse équipant un véhicule automobile situé sur ladite 25 route, comprenant les étapes suivantes : - acquisition, par le capteur, de données représentatives de l'environnement faisant face audit véhicule automobile, - détection, par le module d'analyse, en fonction desdites données, de points repérant un bord au moins d'une voie de circulation de ladite route, et 30 détermination des positions desdits points détectés, - estimation, en fonction desdites positions des points détectés, de paramètres d'un premier modèle géométrique, représentatif de la forme d'une partie au moins de ladite route, - détermination (sur la base des positions des points détectés) d'une 3033912 3 position limite, par rapport au véhicule automobile, jusqu'à laquelle le premier modèle géométrique précédemment paramétré décrit avec une précision donnée la forme de ladite route, et - estimation, en fonction desdites positions des points détectés, situés 5 au-delà de ladite position limite, de paramètres d'un second modèle géométrique représentatif de la forme de ladite route au-delà de ladite position limite. Comme cela a été expliqué ci-dessus, sur une route de campagne, par exemple, un tronçon de route situé face à un véhicule automobile présente fréquemment deux parties successives de géométries différentes, par exemple 10 une partie rectiligne suivie d'un virage, un virage suivi d'une partie rectiligne, ou encore deux virages successifs de directions différentes. Le procédé décrit ci-dessus est particulièrement bien adapté à la l'estimation de paramètres géométriques représentatifs de la forme d'un tel tronçon de route, puisqu'il s'appuie sur deux modèles géométriques décrivant 15 respectivement deux parties de route successives. La détermination (sur la base des positions des points détectés) de ladite position limite permet de déterminer le point de transition entre deux telles parties de route successives, de géométries différentes. Cela permet ensuite, notamment en déterminant les paramètres du second modèle géométrique à partir des 20 positions des points détectés situés au-delà de ladite position limite, d'assurer une précision de description optimale de l'ensemble d'un tel tronçon de route. Une description précise d'un tronçon de route faisant face à un véhicule automobile peut ainsi être obtenue dans une grande variété de situations (aussi bien sur une autoroute que sur une route sinueuse en milieu rural ou en 25 montagne) et jusqu'à une distance importante du véhicule automobile puisque cette distance n'est pas limitée par l'étendue d'une première partie de route qui présenterait une géométrie simple donnée. Une telle description par deux modèles géométriques différents, associés chacun à une partie de route, permet par ailleurs, tout en préservant une précision 30 de description élevée, d'utiliser des modèles géométriques simples, par exemple des modèles de route circulaires, grâce à quoi la détermination de tels paramètres géométriques représentatifs est avantageusement rapide. Cette détermination peut par exemple être réalisée ainsi en temps réel, ce qui est particulièrement intéressant lorsque les paramètres ainsi déterminés sont utilisés par un module 3033912 4 d'assistance à la conduite. L'invention prévoit également, dans un mode de réalisation préféré, que les paramètres du premier modèle géométrique sont estimés en fonction de coefficients de pondération respectivement associés aux points détectés et 5 décroissants en fonction de la distance du point associé au véhicule automobile, de manière à faire dépendre les paramètres du premier modèle géométrique d'autant plus fortement de la position de l'un des points détectés que ce point est proche du véhicule automobile. Cette disposition est particulièrement intéressante car elle permet 10 d'obtenir un premier jeu de paramètres géométriques décrivant précisant la forme d'une route dans une partie proximale de celle-ci par rapport au véhicule automobile, et cela sans connaissance préalable de l'extension de la partie proximale de cette route pouvant être ainsi décrite par une géométrie simple donnée.
15 Préférentiellement, il est aussi prévu que ladite détermination de la position limite comprend une étape de détermination de ladite précision de description de la forme d'un tronçon donné de ladite route par le premier modèle géométrique précédemment paramétré, en fonction : - des paramètres dudit premier modèle géométrique, et 20 - des positions des points détectés appartenant au tronçon donné, chacune desdites positions contribuant de manière équivalente et sans pondération à ladite détermination. Plus particulièrement, il est prévu que ladite précision est déterminée en évaluant une grandeur représentative d'une distance entre le premier modèle 25 géométrique précédemment paramétré et l'ensemble des points détectés appartenant au tronçon donné, ladite grandeur étant évaluée en : - calculant, de manière équivalente pour chaque point détecté, une grandeur intermédiaire représentant une distance entre ledit point détecté et le premier modèle géométrique précédemment paramétré, et en 30 - sommant lesdites grandeurs intermédiaires. D'autres caractéristiques non limitatives et avantageuses du procédé d'estimation décrit ci-dessus sont les suivantes : - ladite position limite est déterminée de sorte que la précision de description, par le premier modèle géométrique précédemment paramétré, d'un 3033912 5 tronçon de route s'étendant depuis une zone proximale du véhicule automobile jusqu'au-delà de ladite position limite, est inférieure à ladite précision donnée, - le premier modèle géométrique et/ou le second modèle géométrique correspondent à un arc de cercle, les paramètres dudit modèle géométrique 5 comprenant le rayon dudit arc de cercle et la position de son centre par rapport au véhicule automobile, et - le premier modèle géométrique et/ou le second modèle géométrique correspond à un arc de clothoïde. Il est aussi proposé que l'étape d'estimation des paramètres du premier 10 modèle géométrique ou du second modèle géométrique comprend un processus itératif comprenant des étapes de : - sélection aléatoire d'une partie seulement des points détectés, - détermination d'un jeu de paramètres temporaire dudit modèle géométrique, en fonction des positions desdits points sélectionnés aléatoirement, 15 - estimation d'une précision de description de la forme de ladite route par le modèle géométrique paramétré par ledit jeu de paramètres temporaire, ladite estimation prenant en compte l'ensemble des points détectés, - sélection, parmi l'ensemble des jeux de paramètres temporaires, du jeu de paramètres correspondant à la meilleure précision de description.
20 Cette méthode d'estimation permet de réduire avantageusement l'influence de bruits de mesure sur les paramètres ainsi déterminés. On peut prévoir également que le procédé d'estimation décrit ci-dessus comprend une étape de détermination d'une seconde position limite, par rapport au véhicule automobile, jusqu'à laquelle ledit second modèle géométrique 25 précédemment paramétré décrit avec une précision donnée la forme de ladite route. L'invention prévoit aussi un système d'estimation de paramètres géométriques représentatifs de la forme d'une route, pour véhicule automobile, comprenant un capteur adapté à acquérir des données représentatives de 30 l'environnement faisant face au véhicule automobile, et un module d'analyse adapté à: - détecter, sur la base desdites données, des points repérant un bord au moins d'une voie de circulation de ladite route, et à déterminer des positions desdits points détectés, 3033912 6 - estimer, en fonction desdites positions des points détectés, des paramètres d'un premier modèle géométrique, représentatif de la forme d'une partie au moins de ladite route, - déterminer une position limite, par rapport au véhicule automobile, 5 jusqu'à laquelle le premier modèle géométrique précédemment paramétré décrit avec une précision donnée la forme de ladite route, et à - estimer, en fonction desdites positions des points détectés, situés au-delà de ladite position limite, des paramètres d'un second modèle géométrique représentatif de la forme de ladite route au-delà de ladite position limite.
10 L'invention prévoit également un véhicule automobile comprenant un système d'estimation tel que décrit ci-dessus, et un module d'assistance à la conduite, le système d'estimation étant adapté à transmettre au module d'assistance à la conduite les paramètres du premier et du second modèle géométrique et ladite position limite précédemment estimés, le module 15 d'assistance à la conduite étant adapté à commander des moyens de réaction afin de déclencher une fonctionnalité commandable en fonction desdits paramètres et de ladite position limite reçus du système d'estimation. DESCRIPTION DETAILLEE D'UN EXEMPLE DE REALISATION La description qui va suivre en regard des dessins annexés, donnés à 20 titre d'exemples non limitatifs, fera bien comprendre en quoi consiste l'invention et comment elle peut être réalisée. Sur les dessins annexés : - la figure 1 représente schématiquement un véhicule automobile équipé notamment d'un système d'estimation de paramètres géométriques représentatifs 25 de la forme d'une route selon l'invention, - la figure 2 représente les étapes principales d'un procédé mis en oeuvre par le système d'estimation de la figure 1, conformément aux enseignements de l'invention, - la figure 3 représente schématiquement le détail d'une étape du 30 procédé de la figure 2, - la figure 4 représente schématiquement le détail d'une autre étape du procédé de la figure 2, - la figure 5 représente schématiquement une portion de route sur laquelle est situé le véhicule automobile de la figure 1, et deux modèles 3033912 7 géométriques de ladite portion de route, dont les paramètres sont estimés au moyen du procédé de la figure 2. Sur la figure 1, on a représenté schématiquement un véhicule automobile 100 situé sur une voie de circulation LA d'une route R comprenant ici deux voies 5 de circulation LA et LA'. Le véhicule automobile 100 est équipé notamment d'un système d'estimation 109 de paramètres géométriques représentatifs de la forme d'une route, selon l'invention. Le système d'estimation 109 comprend un capteur 101, tel qu'un capteur 10 d'images, un radar, ou encore un lidar, permettant l'acquisition de données représentatives de l'environnement faisant face au véhicule automobile 100, en particulier de données représentatives de positions d'objets de cet environnement par rapport au véhicule automobile 100. Dans le mode de réalisation décrit ci-dessous, le capteur 101 est un capteur d'images, en l'occurrence une caméra 15 vidéo. Le système d'estimation 109 comprend également un module d'analyse 108, comportant un processeur 102 effectuant des opérations logiques, par exemple un microprocesseur, et un module de mémorisation 103 réalisé par exemple sous forme d'un disque dur ou d'une mémoire vive.
20 Les données acquises par le capteur 101 sont transmises au module d'analyse 108, où elles sont analysées en temps réel pour déterminer des positions de points repérant un bord au moins de la voie de circulation LA sur laquelle est situé le véhicule automobile 100. Les dites positions de points sont définies dans cet exemple par leur 25 coordonnées cartésiennes dans un repère orthonormé (0,x,y) situé dans le plan défini par le tronçon de route sur lequel est situé le véhicule automobile 100. Le repère (0,x,y) est lié au véhicule automobile 100. L'axe (0,x) de ce repère s'étend par exemple depuis une origine 0 située sensiblement au centre de la face avant FA du véhicule automobile 100, 30 dans une direction perpendiculairement à cette face avant FA, et vers la zone située à l'avant du véhicule automobile 100. Dans l'exemple représenté figure 1, un premier bord de la voie de circulation LA, qui la sépare de la voie de circulation LA', est matérialisé au sol par une ligne de marquage pointillée LM, par exemple blanche ou jaune. Le second 3033912 8 bord de la voie de circulation LA, qui la sépare de l'extérieur de la route R, est matérialisé au sol par une ligne de marquage continue LL, par exemple blanche ou jaune. Les lignes de marquage LL et LM, destinées à être facilement 5 visualisées, se distinguent nettement, d'un point de vue visuel, de leur environnement. Le module d'analyse 108 peut donc repérer précisément ces lignes dans une image de l'environnement qui fait face au véhicule automobile 100, acquise par le capteur d'images 101 et extraire ainsi les positions, au sein de cette image, de points situés le long de la ligne de marquage LM et le long de la 10 ligne de marquage LL. Pour chacun de ces points, la position au sein de ladite image peut ensuite être convertie par le module d'analyse 108 de manière à obtenir la position de ce point dans l'espace physique faisant face au véhicule automobile 100, en l'occurrence dans le repère (0,x,y). L'étape permettant de convertir la position d'un point donné, au sein 15 d'une telle image, en la position correspondant à ce point dans le repère (0,x,y), peut par exemple être réalisée en utilisant une table de correspondance qui les relie. Cette table de correspondance peut par exemple être produite lors d'étapes préliminaires de calibration dans lesquelles des points sources sont placés à des positions connues dans le repère (0,x,y). Dans cette situation, ce sont à la fois la 20 position d'un point source au sein d'une image, et sa position dans le repère (0,x,y) qui sont connues, ce qui permet de déterminer le lien existant entre elles, lien qui peut être mémorisé, ici dans le module de mémorisation 103, sous forme de ladite table de correspondance. Les positions dans le repère (0,x,y) de points situés le long de la ligne de 25 marquage LM, et le long de la ligne de marquage LL peuvent ainsi être déterminées par le module d'analyse 108, sur la base d'une image de l'environnement faisant face au véhicule automobile 100 acquise par le capteur d'images 101. Le champ de vision du capteur d'images 101 correspond 30 approximativement, dans le plan (0,x,y), à un secteur angulaire tronqué, délimité par deux droites D et D', et dont le sommet tronqué est situé face au véhicule automobile 100. Ce champ de vision permet de visualiser (puis de repérer) des points de la ligne de marquage LM situés au-delà d'un point A de cette ligne, le point A étant situé à une distance d de la face avant du véhicule automobile 100 3033912 9 comprise par exemple entre 0,1 mètre et 5 mètres. La distance D jusqu'à laquelle des points peuvent être repérés le long de la ligne de marquage LM, par acquisition d'une image par le capteur d'images 101, est d'autant plus grande que la résolution de ce dernier est élevée. En 5 pratique, la valeur de cette distance limite D peut être égale ou supérieure à 100 mètres. Les points de la ligne de marquage LM pouvant être repérés de cette manière sont ainsi compris entre le point A mentionné ci-dessus et un point C (visible figure 5) situé sensiblement à une distance D de la face avant FA du 10 véhicule automobile 100. De manière comparable, la portion de la ligne de marquage LL le long de laquelle des points peuvent ainsi être repérés est comprise entre un point E situé sensiblement à une distance d de la face avant du véhicule automobile 100, et un point G (visible figure 5) situé sensiblement à une distance D de celle-ci.
15 Les positions de points situés le long des lignes de marquage LM et LL, déterminées par le module d'analyse 109, permettent l'estimation par ce dernier, selon un procédé décrit plus bas, de paramètres géométriques représentatifs de la forme de chacune des lignes de marquage LM et LL, lesdits paramètres comprenant notamment des données repérant la position d'une telle ligne de 20 marquage par rapport au véhicule automobile 100. Dans d'autres modes de réalisation, la forme de la portion de route située face au véhicule automobile 100 peut être déterminée sur la base de positions d'objets, tels que des glissières de sécurité, situés le long de ladite voie de circulation, ces objets pouvant être détectés par un capteur d'images, ou par 25 un radar, par exemple. Les paramètres géométriques ainsi estimés peuvent être transmis par le module d'analyse 109 à un module d'assistance à la conduite 107. Le module d'assistance à la conduite 107 peut commander des moyens de réaction afin de déclencher une fonctionnalité commandable, en fonction 30 notamment du résultat de ladite estimation de paramètres géométriques représentatifs de la forme de la route R. Par exemple, le module d'assistance à la conduite 107 peut commander un dispositif de signalisation et/ou d'alarme, par exemple un haut-parleur de manière à déclencher une alarme sonore signalant à un conducteur du véhicule 3033912 10 automobile 100 que la distance séparant, dans la direction y, le véhicule automobile 100 de la ligne de marquage LL est inférieure à une limite déterminée donnée. Le module d'assistance à la conduite 107 peut aussi, en fonction des 5 caractéristiques géométriques de la portion de route faisant face au véhicule automobile 100, commander un actionneur, tel qu'un système d'assistance au freinage, ou un système de freinage d'urgence, ou encore un système de direction assistée. Le véhicule automobile 100 peut aussi comprendre : 10 - un capteur de vitesse 104 délivrant des données représentatives de la vitesse du véhicule automobile 100 par rapport à la route R, - un accéléromètre et/ou un gyromètre 105, et - un capteur 106 permettant une géolocalisation du véhicule automobile 100, par exemple un capteur de signaux GPS (acronyme anglo-saxon de « Global 15 Positioning System ») muni d'un module d'analyse, adapté à localiser le véhicule automobile 100. Les données délivrées par les capteurs 104, 105 et 106 sont transmises au module d'analyse 108 qui détermine, notamment sur la base de ces données, pour chaque ligne de marquage précédemment détectée, s'il s'agit d'une ligne de 20 marquage séparant deux voies de circulation en sens opposés, ou d'une ligne de marquage séparant deux voies de circulation dans le même sens, ou d'une ligne de marquage repérant un bord de la route R, ou encore d'un autre type de ligne de marquage. Les données délivrées par les capteurs 104, 105 et 106 peuvent aussi 25 être transmises avantageusement au module d'assistance à la conduite 107, pour y être combinées avec les paramètres géométriques représentatifs de la forme de la portion de route faisant face au véhicule automobile 100, afin de déterminer les conditions de marche du véhicule automobile 100 par rapport à la route R, et en particulier d'anticiper les positions futures du véhicule automobile 100 sur la route 30 R. Les moyens de réaction susmentionnés peuvent alors être commandés par le module d'assistance à la conduite 107 en fonction des conditions de marche du véhicule automobile 100, notamment lorsque ces conditions de marche ne semblent pas adaptées à l'environnement dans lequel circule le véhicule automobile 100.
3033912 11 La figure 2 représente les étapes principales d'un exemple de procédé mis en oeuvre par le système d'estimation 109 de la figure 1. Un tel procédé débute à l'étape 201 par l'acquisition, par le capteur 101, de données représentatives de l'environnement faisant face au véhicule 5 automobile 100, ici une image de cet environnement. Les données ainsi acquises sont ensuite analysées par le module d'analyse 108, lors de l'étape 202, pour déterminer des positions de points repérant un bord au moins de la voie de circulation LA sur laquelle est situé le véhicule automobile 100.
10 Ces positions correspondent, dans l'exemple décrit ici, aux positions dans le repère (0,x,y) de points situés : - le long de la ligne de marquage LM, entre les points A et C, et - le long de la ligne de marquage LL, entre les points E et G. Les points situés le long de la ligne de marquage LM, et dont les 15 positions sont ainsi déterminées, sont notés ici M1,M2,...,Mn. Ils sont répartis, par ordre croissant d'indice, entre le point A et le point C. Le point M1 est ainsi celui qui est situé le plus près du véhicule automobile 100 (il s'agit du point A), et le point Mn est celui qui en est le plus éloigné (il s'agit du point C). L'étape suivante 203 est une étape d'estimation, par le module d'analyse 20 108, en fonction desdites positions de points, de paramètres d'un premier modèle géométrique, représentatif de la forme d'une partie au moins de ladite route R. Cette étape d'estimation 203 est décrite ici dans le cas non limitatif d'un modèle de route circulaire, c'est-à-dire ici d'un modèle dans lequel une portion de chacune des lignes de marquage LM et LL décrit un arc de cercle.
25 Comme cela a été mentionné en introduction, la partie de la route R qui fait face au véhicule automobile 100, considérée dans son intégralité, peut présenter une forme complexe qu'un unique arc de cercle peut ne pas suffire à décrire. En revanche, un arc de cercle peut fournir une description très précise 30 de la géométrie de la route R, lorsque cette description est limitée à une portion de celle-ci. Les paramètres de ce premier modèle de route sont déterminés de manière à optimiser la précision de description, par ce modèle, de la portion de la route R située immédiatement face au véhicule automobile 100.
3033912 12 Dans le cadre du modèle de route circulaire utilisé ici, les paramètres géométriques caractérisant la forme de la portion de la ligne de marquage LM faisant face au véhicule automobile 100 comprennent : - les coordonnées (XC,YC), dans le repère (0,x,y), du centre Cim d'un 5 arc de cercle ARC1M décrivant cette ligne de marquage, et - le rayon Rim de cet arc de cercle. De même, l'arc de cercle ARC1L qui décrit la portion de la ligne de marquage LL faisant face au véhicule automobile 100 est caractérisé par son rayon et par la position de son centre dans le repère (0,x,y).
10 La méthode utilisée dans cet exemple de réalisation pour estimer les paramètres géométriques de chacun des arcs de cercle ARC1M et ARC1L est représentée schématiquement sur la figure 3. Cette méthode d'estimation, similaire pour les arcs de cercle ARC1M et ARC1L est décrite ci-dessous pour l'arc de cercle ARC1M.
15 L'étape 203 comprend ici l'exécution itérative d'une séquence de sous- étapes 301, 302, 303, 304, éventuellement 305, et 306. Cette séquence est par exemple exécutée un nombre k de fois. Lors de l'exécution numéro i de cette séquence de sous-étapes, un arc de cercle ARC1Mi est déterminé. A l'issu de l'étape 203, l'arc de cercle qui décrit le plus précisément la géométrie de la ligne 20 de marquage LM, parmi les arcs de cercle ARC1M1,ARC1M2,...,ARC1Mk ainsi déterminés, est conservé pour être utilisé lors des étapes ultérieures du procédé. Lors de la sous-étape 301, trois points P1, P2 et P3 sont choisis au hasard parmi les points M1,M2,...,Mn situés le long de la ligne de marquage LM. Les points P1, P2 et P3 peuvent donc être situés sur toute la portion de la ligne de 25 marquage LM comprise entre les points A et C, c'est-à-dire sur toute la portion de la ligne de marquage LM pour laquelle des positions de points ont pu être déterminées à l'étape 202. Les paramètres géométriques d'un arc de cercle ARC1Mi passant par ces trois points P1, P2 et P3 sont ensuite déterminés lors de la sous-étape 302.
30 Ces paramètres comprennent les coordonnées (XCi, YCi) du centre Cimi de cet arc de cercle, et son rayon Rimi. Le centre Clmi d'un arc de cercle passant par trois points P1, P2 et P3 est situé à l'intersection : - de la médiatrice A1 du segment reliant les points P2 et P3, 3033912 13 - de la médiatrice A2 du segment reliant les points P1 et P3, et - de la médiatrice A3 du segment reliant les points Pi et P2. Les coordonnées (XCi, YCi) dans le repère (0,x,y) du centre Cimi peuvent donc être obtenues en : 5 - déterminant les équations cartésiennes El, E2 et E3, décrivant respectivement, dans le repère (0,x,y), chacune des médiatrices A1, A2 et A3 , et en - déterminant le couple de coordonnées (XCi, YCi) solution du système d'équation {E1, E2, E3}.
10 Deux parmi les trois équations El, E2 et E3 sont théoriquement suffisantes pour déterminer le couple de coordonnées (XCi, YCi). La prise en compte des trois équations El, E2 et E3 peut toutefois être avantageuse pour améliorer en pratique la précision de détermination des coordonnées (XCi, YCi). La valeur du rayon Rimi de l'arc de cercle ARC1Mi passant par les trois 15 points P1, P2 et P3 peut ensuite être déterminée par exemple par le calcul de la distance entre le centre Cimi de cet arc de cercle et l'un des points P1, P2 OU P3. Une grandeur ECi, représentative de la précision avec laquelle l'arc de cercle ARC1Mi décrit la géométrie de la portion de la ligne de marquage LM située immédiatement face au véhicule automobile 100, est ensuite calculée lors de la 20 sous-étape 303. La grandeur ECi est fonction : - des paramètres géométriques (XCi, YCi, Rimi) caractérisant l'arc de cercle ARC1Mi, - des coordonnées des points M1,M2,...,Mn, et 25 - de coefficients de pondération cl ,c2,...,cn associés respectivement à chacun des points M1,M2,...,Mn. Les coefficients de pondération cl ,c2,...,cn sont choisis pour donner, dans le calcul de la grandeur ECi, un poids plus important aux points de la ligne de marquage LM situés près du véhicule automobile 100, qu'à ceux situés loin de 30 celui-ci. La grandeur ECi peut par exemple être calculée conformément à la formule F1 : 3033912 14 j=n j=n ECi = cj . dist(ARC1Mi, Mj))/(1 cj) où : - dist(ARC1Mi, Mj) représente la distance entre l'arc de cercle ARC1Mi et le point Mj (dans le plan (0,x,y)), et où - la valeur d'un coefficient de pondération cj est d'autant plus grande que 5 le point Mj auquel il est associé est proche du véhicule automobile 100. La valeur d'un coefficient cj peut par exemple décroitre depuis une valeur proche de 1 pour le point M1 jusqu'à une valeur proche de 0,25 pour le point Mn. La grandeur ECi est, dans cet exemple de réalisation, d'autant plus petite que la description de la portion de la ligne de marquage LM comprise entre les 10 points A et C, par l'arc de cercle ARC1Mi, est précise. La grandeur ECi représente donc une distance entre l'arc de cercle ARC1Mi et l'ensemble des points détectés Mi. Lors de la sous-étape 304, la grandeur ECi est comparée à une grandeur EC (définie ci-dessous), afin de déterminer si l'arc de cercle ARC1Mi est celui qui 15 décrit le plus précisément la portion de la ligne de marquage LM comprise entre les points A et C, parmi les arcs de cercle ARC1M1 à ARC1Mi précédemment déterminés, lors des exécutions numéro 1 à i de la séquence de sous-étapes 301 à 306. Si tel est le cas, les paramètres de l'arc ARC1Mi sont attribués à l'arc 20 ARC1M, lors de la sous-étape 305: XC = XCi, YC = YCi, R = Ri. Ce processus est par exemple mis en oeuvre en réalisant la sous-étape 304 comme suit. Pour i =1, c'est-à-dire s'il s'agit de la première exécution de la séquence 25 de sous-étapes 301 à 306, l'étape 203 se poursuit par la sous-étape 305, et la grandeur EC est initialisée en lui attribuant la valeur de la grandeur EC1 : EC=EC1. Pour i > 1, et si ECi < EC, ce qui traduit ici que l'arc de cercle ARC1Mi est celui qui décrit le plus précisément la portion de la ligne de marquage LM 30 comprise entre les points A et C, parmi les arcs de cercle ARC1M1 à ARC1Mi précédemment déterminés, alors : (F1) 3033912 15 - l'étape 203 se poursuit par la sous-étape 305, et - la valeur de la grandeur ECi est attribuée à la grandeur EC: EC=ECi. Dans les autres cas, l'étape 203 se poursuit directement par la sous-étape 306.
5 La grandeur EC correspond à la plus petite des grandeurs EC1 à ECi obtenues lors des exécutions numéros 1 à i de la séquence de sous-étapes 301 à 306. Elle est d'autant plus petite que l'arc ARC1M décrit avec précision la portion de la ligne de marquage LM comprise entre les points A et C. Lors de la sous-étape 306, le module d'analyse 108 teste si la séquence 10 de sous-étapes 301 à 306 doit être exécutée à nouveau ou si l'étape 203 peut s'achever, le procédé se poursuivant alors par l'étape 204. Le test réalisé lors de la sous-étape 306 peut porter à la fois sur : - le nombre i de réalisations de la séquence de sous-étapes 301 à 306 déjà effectuées lors de l'étape 203 (ce nombre étant par exemple limité ici à k 15 réalisations), et/ou sur - la précision avec laquelle l'arc ARC1M décrit la portion de la ligne de marquage comprise entre les points A et C, précision traduite ici par la valeur de la grandeur EC; l'étape 203 peut par exemple s'achever, au terme de la sous-étape 306, dès que la grandeur EC est inférieure à un seuil déterminé donné EClim.
20 La valeur du seuil EClim peut par exemple être enregistrée dans les moyens de mémorisation 103 du module d'analyse 108 lors de la mise en service de ce dernier. Sur la figure 5, on peut voir un exemple d'arc de cercle ARC1M dont les paramètres (XC,YC,Rim) ont été déterminés au cours de l'étape 203.
25 Dans cet exemple, la partie de la route R faisant face au véhicule automobile 100 décrit tout d'abord un virage, en l'occurrence sur la gauche, puis une ligne droite. La portion de la ligne de marquage LM située entre les points A et C, comprend ainsi un premier tronçon, sensiblement en forme d'arc de cercle, 30 s'étendant du point A à un point B, suivi d'un second tronçon sensiblement rectiligne, entre les points B et C. Comme on peut le voir figure 5, l'arc de cercle ARC1M décrit le premier tronçon AB avec précision, mais s'écarte nettement de la ligne de marquage LM au niveau du second tronçon BC.
3033912 16 La précision de description du premier tronçon AB par l'arc de cercle ARC1M est un résultat avantageux du poids prédominant donné aux points de la ligne de marquage LM qui sont proches du véhicule automobile 100, au moyen des coefficients de pondération cl ,c2,...,cn, lors du calcul de la grandeur ECi.
5 Ceci est particulièrement intéressant du fait que, comme décrit ci- dessous, l'arc de cercle ARC1M forme un premier modèle destiné à approcher la forme de la route (ici, précisément, de la ligne de marquage LM) dans une partie proximale de celle-ci (par rapport au véhicule automobile). Une telle pondération, dans le calcul de la grandeur ECi, permet par 10 ailleurs de prendre en compte l'ensemble des points situé le long de la partie AC de la ligne de marquage LM (tout en privilégiant, comme décrit ci-dessus, les points les plus proches du véhicule automobile 100). Cette caractéristique est intéressante puisque l'étendue d'un premier tronçon AB de la ligne de marquage LM, pouvant être décrit précisément par un seul arc de cercle, n'est pas connue à 15 l'avance du dispositif d'estimation 109. Autrement formulé, la position limite, correspondant au point B marquant la transition entre : - un premier tronçon de route AB pouvant être décrit précisément par un premier modèle de route, ici circulaire, et 20 - un second tronçon de route BC, pouvant être décrit précisément par un second modèle de route, ici circulaire également et distinct du premier, n'est pas connue a priori du dispositif d'estimation 109. La position de ce point de transition B dans le repère (0,x,y) évolue d'ailleurs au fur et à mesure de la progression du véhicule automobile 100 le long de la voie de circulation LA.
25 Cette position limite est déterminée lors de l'étape suivante 204. On notera par ailleurs qu'un tronçon de route rectiligne est un cas particulier d'un tronçon de route circulaire, de très grand rayon, et qu'il peut donc être décrit avec précision par le modèle de route circulaire utilisé lors de l'étape 203.
30 On notera également que la méthode d'estimation mise en oeuvre lors de l'étape 203 s'apparente à une estimation de type « RANSAC » (selon l'acronyme anglo-saxon de « RANdom SAmple Consensus »), au cours de laquelle : - une partie seulement des points de l'ensemble de points M1 ,M2,... Mn, choisie au hasard (les points P1, P2 et P3), sert à déterminer les paramètres 3033912 17 (XCi,YCi,Rimi) de l'arc ARC1Mi, - la précision de description de la ligne de marquage LM par l'arc ARC1Mi est ensuite évaluée en prenant en compte l'ensemble des points M1,M2,...Mn, 5 - l'arc ARC1Mi offrant la meilleure précision de description est finalement retenu. Une telle méthode permet avantageusement de réduire l'influence du bruit de mesure sur les paramètres (XC,YC,Rim) de l'arc ARC1M ainsi déterminé, en minimisant l'influence d'éventuels points de mesure aberrants, grâce à ce 10 processus de choix au hasard de sous-ensembles de points (P1,P2,P3). Les paramètres de l'arc de cercle ARC1L, décrivant la ligne de marquage LL, sont déterminés au cours de l'étape 203, de manière comparable à ce qui est présenté ci-dessus pour l'arc de cercle ARC1M. La position du point B, jusqu'où le premier modèle de route décrit avec 15 précision la géométrie de la ligne de marquage LM, est déterminée par le module d'analyse 108 lors de l'étape 204 représentée plus en détail figure 4. Lors de cette étape, la précision de description d'un tronçon AMI de la ligne de marquage LM, par l'arc de cercle ARC1M, est évaluée de manière itérative, pour des points MI par exemple de plus en plus proches du véhicule 20 automobile 100, et ce jusqu'à ce que ladite précision de description soit meilleure qu'une précision déterminée donnée. Le tronçon AMI ainsi déterminé correspond alors au tronçon AB. La précision de description d'un tronçon AMI de la ligne de marquage LM, par l'arc de cercle ARC1M, est évaluée en donnant le même poids tous les 25 points M1,M2,...,M1 de ce tronçon. Cette précision de description est par exemple évaluée en calculant une grandeur EC'(I) conformément à la formule F2 : i=1 1 EC(l) = dist(ARC1M, Mj) (F2) j=1 ce qui revient à attribuer le même coefficient de pondération à tous les points M1,M2,...,M1. La grandeur EC'(I) représente donc une distance moyenne entre l'arc de 30 cercle ARC1M et l'ensemble des points M1 à MI. Dans cet exemple de réalisation, le point B est alors défini comme un 3033912 18 point, parmi les points détectés Mi, tel que la distance EC'(I) entre l'arc de cercle ARC1M et l'ensemble de points M1,...,MI (situés entre le point A et le point B), est inférieure à une distance déterminée donnée, notée EC'lim. En revanche, la distance EC'(I) entre l'arc de cercle ARC1M et un ensemble de points s'étendant 5 au-delà du point B, est a priori supérieure à la distance déterminée donnée EC'lim. La valeur de la distance EC'lim, qui détermine la précision visée pour la description d'un premier tronçon de la ligne de marquage LM, est enregistrée par exemple dans les moyens de mémorisation 103 du module d'analyse 108 lors de la mise en service de ce dernier. Sa valeur peut par exemple être choisie entre 1 10 et 50 centimètres. L'étape 204 débute par une sous-étape 401, au cours de laquelle un compteur 1 est initialisé avec la valeur n : 1=n. Cela permet de commencer par calculer la grandeur EC'(I) pour tout le tronçon AC de la ligne de marquage LM. Les sous-étapes suivantes 402, 403, et éventuellement 404, sont ensuite 15 exécutées de manière itérative. Lors de la sous-étape 402, la grandeur EC'(1) est calculée. Puis, lors de l'étape 403, la grandeur EC'(I) précédemment calculée est comparée à une grandeur EC'lim. Si EC'(I)>EC'lim, ce qui traduit que le segment AMI est décrit par l'arc de 20 cercle ARC1M avec une précision estimée comme insuffisante, le processus se poursuit par la sous-étape 404. Au cours de la sous-étape 404, le compteur 1 est décrémenté d'une unité, et le processus reprend ensuite à l'étape 402. Si au contraire EC'(I) < EC'lim, ce qui traduit que le segment AMI est décrit par l'arc de cercle ARC1M avec une précision estimée comme suffisante, le 25 processus se poursuit, après la sous-étape 403, par la sous-étape 405 au cours de laquelle les coordonnées du point MI sont attribuées au point B. Dans un autre mode de réalisation, la position du point B peut être déterminée, également de manière itérative, en évaluant la précision de description d'un tronçon AMI de la ligne de marquage LM, par l'arc de cercle 30 ARC1M, mais pour des points MI de plus en plus éloignés du véhicule automobile 100, et ce jusqu'à ce que ladite précision de description devienne inférieure à une précision déterminée donnée (ce qui se traduit ici par le fait que la distance EC'(I) devient supérieure à la distance déterminée donnée EC'lim), ce qui marque alors la limite du premier tronçon de la ligne de marquage LM correctement décrit par 3033912 19 l'arc de cercle ARC1M. La position d'un point F, jusqu'où l'arc de cercle ARC1L décrit avec précision la géométrie de la ligne de marquage LL, est déterminée lors de l'étape 204, de manière comparable à ce qui présenté ci-dessus pour le point B, lors de 5 l'étape 204. On remarque que, du fait que l'arc de cercle ARC1M a été choisi comme modèle optimum en privilégiant la partie proximale de la route (ici la partie AB) grâce à l'utilisation des coefficients de pondération cj, il n'est pas nécessaire de réitérer une recherche du modèle optimal pour chaque valeur de I dans le 10 processus ci-dessus. Les paramètres d'un second modèle de route décrivant le second tronçon BC de la ligne de marquage LM, ici par un arc de cercle ARC2M, sont déterminés lors de l'étape 205. Les paramètres de l'arc de cercle ARC2M sont déterminés en fonction 15 des positions des points de la ligne de marquage LM compris entre les points B et C. Cette détermination est réalisée de manière comparable à la détermination des paramètres de l'arc de cercle ARC1M, réalisée lors de l'étape 203 décrite ci-dessus, en fonction des positions des points de la ligne de marquage LM compris entre les points A et C.
20 De même, un second modèle de route décrivant le second tronçon FG de la ligne de marquage LL, ici par un arc de cercle ARC2L, est déterminé lors de l'étape 205. De manière optionnelle, la position d'un point B2, correspondant à une seconde position limite jusqu'à laquelle l'arc de cercle ARC2M décrit avec 25 précision la géométrie de la ligne de marquage LM, peut être déterminée lors de l'étape 205. La position du point B2, situé sur la ligne de marquage LM entre les points B et C, peut dans ce cas être déterminée par un processus comparable à celui de l'étape 204 décrite ci-dessus.
30 De même, la position d'un point F2, jusqu'à laquelle l'arc de cercle ARC2M décrit avec précision la géométrie de la ligne de marquage LM, peut être déterminée lors de l'étape 205. Comme on peut le voir sur la figure 5, l'utilisation d'un premier et d'un second modèles de route circulaire distincts, dont les paramètres sont déterminés 3033912 20 conformément à la méthode d'estimation décrite ci-dessus, permet de décrire avec précision une portion de route comportant un virage puis une section rectiligne, et cela alors même que la position limite correspondant à la transition entre ces deux tronçons n'est pas connue au préalable.
5 De manière générale, ce procédé d'estimation permet d'obtenir une caractérisation géométrique précise d'une portion de route comportant deux tronçons successifs de formes distinctes, ce qui est fréquent pour une route sinueuse, en milieu rural par exemple. Ces deux tronçons peuvent par exemple correspondre à une section 10 rectiligne suivie d'un virage, ou, comme dans le cas de la figure 5, à un virage suivi d'une section rectiligne, ou encore à deux virages successifs de rayons ou de directions différentes. Le procédé d'estimation décrit ci-dessus est également adapté à une portion de route pouvant être décrite par un seul modèle de route circulaire, par 15 exemple une portion de route rectiligne du point A jusqu'au point C. Dans ce cas, la position du point B, déterminée à l'étape 204, correspond simplement au point C. On peut prévoir, dans ce cas, de passer directement de l'étape 204 à l'étape 206 sans exécuter l'étape 205. Par ailleurs, dans le mode de réalisation présenté ci-dessus, le premier, 20 comme le second tronçon de la route R est décrit par un arc de cercle. Dans d'autres modes de réalisation, l'un et/ou l'autre de ces deux tronçons peut être décrit par une autre forme géométrique, par exemple un arc de clothoïde. Enfin, au cours de l'étape 206, les paramètres des premiers et seconds modèles géométrique de la route R, précédemment déterminés par le module 25 d'analyse 108, sont transmis au module d'assistance à la conduite 107, ainsi que les coordonnées des points B et F, et de manière optionnelle, les coordonnées des points B2 et F2. Ici, ces paramètres comprennent en particulier : - la valeur du rayon Rim et les coordonnées (XC,VC) du centre Cim de l'arc de cercle ARC1M, et 30 - la valeur du rayon et les coordonnées du centre de l'arc de cercle ARC1L. Ces données sont ensuite utilisées par le module d'assistance à la conduite 107 pour commander des moyens de réaction, comme expliqué ci-dessus lors de la description de la figure 1.
3033912 21 Dans le mode de réalisation décrit ci-dessus, des paramètres géométriques représentatifs de la forme de chacune des deux lignes de marquage LM et LL sont estimés. Dans un autre mode de réalisation, de tels paramètres géométriques 5 peuvent être estimés pour une seule des deux lignes de marquage, LM ou LL. La description de la partie de la route R faisant face au véhicule automobile est moins complète dans ce cas que dans le précédent, mais elle est aussi plus rapide à obtenir, et peut ainsi être bien adaptée pour certaines applications d'assistance à la conduite nécessitant un temps de réaction particulièrement court.
Claims (11)
- REVENDICATIONS1. Procédé d'estimation de paramètres géométriques (XC, YC, Ri") représentatifs de la forme d'une route (R), au moyen d'un capteur (101) et d'un module d'analyse (108) équipant un véhicule automobile (100) situé sur ladite route (R), comprenant les étapes suivantes : - acquisition, par le capteur (101), de données représentatives de l'environnement faisant face audit véhicule automobile (100), - détection, par le module d'analyse (108), en fonction desdites données, de points (M1,M2,...,Mn) repérant un bord (LM; LL) au moins d'une voie de circulation (LA) de ladite route (R), et détermination des positions desdits points détectés (M1,M2,...,Mn), - estimation, en fonction desdites positions des points détectés (M1,M2,...,Mn), de paramètres (XC, YC, Ri") d'un premier modèle géométrique, représentatif de la forme d'une partie au moins de ladite route (R), caractérisé en ce qu'il comprend en outre les étapes suivantes : - détermination d'une position limite, par rapport au véhicule automobile, jusqu'à laquelle le premier modèle géométrique précédemment paramétré décrit avec une précision donnée la forme de ladite route (R), et - estimation, en fonction desdites positions des points détectés (M1,M2,...,Mn), situés au-delà de ladite position limite, de paramètres d'un second modèle géométrique représentatif de la forme de ladite route au-delà de ladite position limite.
- 2. Procédé d'estimation selon la revendication 1, dans lequel les paramètres (XC, YC, Ri") du premier modèle géométrique sont estimés en outre en fonction de coefficients de pondération (c1,c2,...,cn) respectivement associés aux points détectés (M1,M2,...,Mn) et décroissants en fonction de la distance du point associé (Mj) au véhicule automobile (100), de manière à faire dépendre les paramètres (XC, YC, Ri") du premier modèle géométrique d'autant plus fortement de la position de l'un des points détectés (Mj) que ce point est proche du véhicule automobile (100).
- 3. Procédé d'estimation selon l'une des revendications 1 ou 2, dans lequel la détermination de la position limite comprend une étape de détermination de ladite précision de description de la forme d'un tronçon donné (A-MI) de ladite 3033912 23 route (R) par le premier modèle géométrique précédemment paramétré, en fonction : - des paramètres (XC, YC, Rim) dudit premier modèle géométrique, et - des positions des points détectés appartenant au tronçon donné 5 (M1,M2,...,MI), chacune desdites positions contribuant de manière équivalente et sans pondération à ladite détermination.
- 4. Procédé d'estimation selon la revendication 3, dans lequel ladite précision est déterminée en évaluant une grandeur (EC'(I)) représentative d'une distance entre le premier modèle géométrique précédemment paramétré et 10 l'ensemble des points détectés appartenant au tronçon donné (M1,M2,...,MI), ladite grandeur (EC'(I)) étant évaluée en : - calculant, de manière équivalente pour chaque point détecté (Mj), une grandeur intermédiaire (dist(ARC1M, Mj)) représentant une distance entre ledit point détecté (Mj) et le premier modèle géométrique précédemment paramétré, et 15 en - sommant lesdites grandeurs intermédiaires (dist(ARC1M, Mj)).
- 5. Procédé d'estimation selon l'une des revendications 1 à 4, dans lequel ladite position limite est déterminée de sorte que la précision de description, par le premier modèle géométrique précédemment paramétré, d'un tronçon de route (R) 20 s'étendant depuis une zone proximale du véhicule automobile jusqu'au-delà de ladite position limite, est inférieure à ladite précision donnée.
- 6. Procédé d'estimation selon l'une des revendications 1 à 5, dans lequel le premier modèle géométrique ou le second modèle géométrique correspond à un arc de cercle (ARC1M ; ARC1L ; ARC2M ; ARC2L), les paramètres dudit 25 modèle géométrique comprenant le rayon (Ri") dudit arc de cercle et la position (XC, YC) de son centre par rapport au véhicule automobile (100).
- 7. Procédé d'estimation selon l'une des revendications 1 à 6, dans lequel le premier modèle géométrique ou le second modèle géométrique correspond à un arc de clothoïde. 30
- 8. Procédé d'estimation selon l'une des revendications 1 à 7, dans lequel l'étape d'estimation des paramètres du premier modèle géométrique (XC, YC, Ri") ou du second modèle géométrique comprend un processus itératif comprenant des étapes de : - sélection aléatoire d'une partie seulement (P1, P2, P3) des points 3033912 24 détectés (M1,M2,...,Mn), - détermination d'un jeu de paramètres temporaire (XCi, YCi, Rimi) dudit modèle géométrique, en fonction des positions desdits points (P1, P2, P3) sélectionnés aléatoirement, 5 - estimation d'une précision de description de la forme de ladite route par le modèle géométrique paramétré par ledit jeu de paramètres temporaire (XCi, YCi, Rimi), ladite estimation prenant en compte l'ensemble des points détectés (M1,M2,...,Mn), - sélection, parmi l'ensemble des jeux de paramètres temporaires (XCi, 10 YCi, Rimi), du jeu de paramètres (XC, YC, Rim) correspondant à la meilleure précision de description.
- 9. Procédé d'estimation selon l'une des revendications 1 à 8, comprenant en outre une étape de détermination d'une seconde position limite, par rapport au véhicule automobile (100), jusqu'à laquelle ledit second modèle géométrique 15 précédemment paramétré décrit avec une précision donnée la forme de ladite route (R).
- 10. Système d'estimation (109) de paramètres géométriques (XC, YC, Ri") représentatifs de la forme d'une route (R), pour véhicule automobile (100), comprenant un capteur (101) adapté à acquérir des données représentatives de 20 l'environnement faisant face au véhicule automobile (100), et un module d'analyse (108) adapté à: - détecter, sur la base desdites données, des points (M1,M2,...,Mn) repérant un bord (LM ; LL) au moins d'une voie de circulation (LA) de ladite route (R), et à déterminer des positions desdits points détectés (M1,M2,...,Mn), 25 - estimer, en fonction desdites positions des points détectés (M1,M2,...,Mn), des paramètres (XC, YC, Rim) d'un premier modèle géométrique, représentatif de la forme d'une partie au moins de ladite route (R), caractérisé en ce que le module d'analyse (108) est en outre adapté à: - déterminer une position limite, par rapport au véhicule automobile 30 (100), jusqu'à laquelle le premier modèle géométrique précédemment paramétré décrit avec une précision donnée la forme de ladite route (R), et à - estimer, en fonction desdites positions des points détectés (M1,M2,...,Mn), situés au-delà de ladite position limite, des paramètres d'un second modèle géométrique représentatif de la forme de ladite route (R) au-delà 3033912 25 de ladite position limite.
- 11. Véhicule automobile (100) comprenant un système d'estimation (109) selon la revendication 10, et un module d'assistance à la conduite (107), le système d'estimation (109) étant adapté à transmettre au module d'assistance à la conduite (107) les paramètres du premier modèle géométrique (XC, YC, Rim) et du second modèle géométrique et ladite position limite précédemment estimés, le module d'assistance à la conduite (107) étant adapté à commander des moyens de réaction afin de déclencher une fonctionnalité commandable en fonction desdits paramètres (XC, YC, Rim) et de ladite position limite reçus du système 10 d'estimation (109).
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR1500548A FR3033912B1 (fr) | 2015-03-18 | 2015-03-18 | Procede d'estimation de parametres geometriques representatifs de la forme d'une route, systeme d'estimation de tels parametres et vehicule automobile equipe d'un tel systeme |
PCT/EP2016/055992 WO2016146823A1 (fr) | 2015-03-18 | 2016-03-18 | Procédé d'estimation de paramètres géométriques représentatifs de la forme d'une route, système d'estimation de tels paramètres et véhicule automobile équipé d'un tel système |
EP16714787.5A EP3300525A1 (fr) | 2015-03-18 | 2016-03-18 | Procédé d'estimation de paramètres géométriques représentatifs de la forme d'une route, système d'estimation de tels paramètres et véhicule automobile équipé d'un tel système |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR1500548A FR3033912B1 (fr) | 2015-03-18 | 2015-03-18 | Procede d'estimation de parametres geometriques representatifs de la forme d'une route, systeme d'estimation de tels parametres et vehicule automobile equipe d'un tel systeme |
FR1500548 | 2015-03-18 |
Publications (2)
Publication Number | Publication Date |
---|---|
FR3033912A1 true FR3033912A1 (fr) | 2016-09-23 |
FR3033912B1 FR3033912B1 (fr) | 2018-06-15 |
Family
ID=53040521
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
FR1500548A Active FR3033912B1 (fr) | 2015-03-18 | 2015-03-18 | Procede d'estimation de parametres geometriques representatifs de la forme d'une route, systeme d'estimation de tels parametres et vehicule automobile equipe d'un tel systeme |
Country Status (3)
Country | Link |
---|---|
EP (1) | EP3300525A1 (fr) |
FR (1) | FR3033912B1 (fr) |
WO (1) | WO2016146823A1 (fr) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102019112413A1 (de) * | 2019-05-13 | 2020-11-19 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren und vorrichtung zur multi-sensor-datenfusion für automatisierte und autonome fahrzeuge |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102005024558A1 (de) * | 2005-05-28 | 2006-11-30 | Daimlerchrysler Ag | Verfahren zur Bestimmung der Geometrie eines Streckenabschnittes |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090144030A1 (en) * | 2007-12-04 | 2009-06-04 | Tele Atlas North America, Inc. | Computer readable storage medium storing instructions for applying clothoid curve values to roadways in a geographic data information system |
DE102008042538A1 (de) | 2008-10-01 | 2010-04-08 | Robert Bosch Gmbh | Verfahren und Vorrichtung zum Ermitteln eines Fahrspurverlaufs |
JP5188452B2 (ja) * | 2009-05-22 | 2013-04-24 | 富士重工業株式会社 | 道路形状認識装置 |
JP5350297B2 (ja) * | 2010-03-17 | 2013-11-27 | クラリオン株式会社 | 車両姿勢角算出装置及びそれを用いた車線逸脱警報システム |
US20130141520A1 (en) * | 2011-12-02 | 2013-06-06 | GM Global Technology Operations LLC | Lane tracking system |
-
2015
- 2015-03-18 FR FR1500548A patent/FR3033912B1/fr active Active
-
2016
- 2016-03-18 EP EP16714787.5A patent/EP3300525A1/fr not_active Withdrawn
- 2016-03-18 WO PCT/EP2016/055992 patent/WO2016146823A1/fr active Application Filing
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102005024558A1 (de) * | 2005-05-28 | 2006-11-30 | Daimlerchrysler Ag | Verfahren zur Bestimmung der Geometrie eines Streckenabschnittes |
Non-Patent Citations (2)
Title |
---|
CONIDORI C ET AL: "High curvature two-clothoid road model estimation", INTELLIGENT TRANSPORTATION SYSTEMS, 2004. PROCEEDINGS. THE 7TH INTERNA TIONAL IEEE CONFERENCE ON WASHINGTON, DC, USA OCT. 3-6, 2004, PISCATAWAY, NJ, USA,IEEE, 3 October 2004 (2004-10-03), pages 630 - 635, XP010772162, ISBN: 978-0-7803-8500-9, DOI: 10.1109/ITSC.2004.1398974 * |
SEO DONGWOOK ET AL: "Inverse Perspective Mapping based road curvature estimation", 2014 IEEE/SICE INTERNATIONAL SYMPOSIUM ON SYSTEM INTEGRATION, IEEE, 13 December 2014 (2014-12-13), pages 480 - 483, XP032731447, ISBN: 978-1-4799-6942-5, [retrieved on 20150130], DOI: 10.1109/SII.2014.7028086 * |
Also Published As
Publication number | Publication date |
---|---|
EP3300525A1 (fr) | 2018-04-04 |
WO2016146823A1 (fr) | 2016-09-22 |
FR3033912B1 (fr) | 2018-06-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP2884226B1 (fr) | Procédé de calibration angulaire de la position d'une caméra video embarquée dans un véhicule automobile | |
EP2043044B1 (fr) | Procédé et dispositif d'assistance au parcage d'un véhicule automobile | |
EP3458325A1 (fr) | Procédé de proposition d'une vitesse de roulage | |
EP2804016B1 (fr) | Procédé amélioré de détermination de la position et/ou de la vitesse d'un véhicule guidé ; système associé | |
FR3033912A1 (fr) | Procede d'estimation de parametres geometriques representatifs de la forme d'une route, systeme d'estimation de tels parametres et vehicule automobile equipe d'un tel systeme | |
WO2020089231A1 (fr) | Procédé de détermination d'un vecteur de déplacement d'un véhicule automobile, procédé de détermination d'une vitesse du véhicule et véhicule associé | |
EP3472015B1 (fr) | Procédé de détermination d'une classe de conduite de référence | |
EP4408716A1 (fr) | Procédé et dispositif de détection d'insertion dans une voie de circulation d'un véhicule | |
WO2018041978A1 (fr) | Dispositif de détermination d'une limitation de vitesse, système embarqué comprenant un tel dispositif et procédé de détermination d'une limitation de vitesse. | |
EP3338261B1 (fr) | Procédé de détermination d'un niveau d'attention d'un conducteur d'un véhicule automobile et méthode de stimulation de l'attention d'un conducteur d'un véhicule automobile | |
WO2018069060A1 (fr) | Dispositif de localisation et dispositif de production de données d'intégrité | |
FR3102253A1 (fr) | Procédé de détection d’obstacle, dispositif de détection, système de détection et véhicule associés | |
FR3096469A1 (fr) | Procédé et système d’identification d’un objet dans l’environnement d’un véhicule automobile | |
FR3082936A1 (fr) | Traitement stereoscopique de donnees de vehicules connectes | |
FR3087732A1 (fr) | Procede et dispositif de determination d’un changement de voie d’un vehicule | |
EP3338260A1 (fr) | Procédé de détermination d'un niveau d'attention d'un conducteur d'un véhicule automobile et méthode de stimulation de l'attention d'un conducteur d'un véhicule automobile | |
FR3135048A1 (fr) | Procédé de suivi d’au moins une limite de bord de voie de circulation et véhicule automobile associé | |
EP4308880A1 (fr) | Procédé et dispositif de détermination d'une fiabilité d'une cartographie base définition | |
FR3107599A1 (fr) | Procédé de correction de la trajectoire d’un véhicule et calculateur associé | |
FR3090126A1 (fr) | Procédé de localisation, dans un repère absolu, d’un dispositif, calculateur et véhicule associé. | |
EP4416703A1 (fr) | Procédé de détection d'une limite d'une voie de circulation | |
EP4373723A1 (fr) | Dispositif et procédé de détection d'une sortie de voie d'un véhicule | |
FR3132487A1 (fr) | Procédé de détection d’une ligne centrale d’une voie de circulation | |
EP3931741A1 (fr) | Assistance à la conduite d'un véhicule, par détermination fiable d'objets dans des images déformées | |
WO2020239783A1 (fr) | Procédé et dispositif de détermination de distance de visibilité pour l'aide au dépassement |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PLFP | Fee payment |
Year of fee payment: 2 |
|
PLSC | Publication of the preliminary search report |
Effective date: 20160923 |
|
PLFP | Fee payment |
Year of fee payment: 3 |
|
PLFP | Fee payment |
Year of fee payment: 4 |
|
PLFP | Fee payment |
Year of fee payment: 6 |
|
PLFP | Fee payment |
Year of fee payment: 7 |
|
PLFP | Fee payment |
Year of fee payment: 8 |
|
PLFP | Fee payment |
Year of fee payment: 9 |
|
PLFP | Fee payment |
Year of fee payment: 10 |