FR3087732A1 - Procede et dispositif de determination d’un changement de voie d’un vehicule - Google Patents
Procede et dispositif de determination d’un changement de voie d’un vehicule Download PDFInfo
- Publication number
- FR3087732A1 FR3087732A1 FR1860097A FR1860097A FR3087732A1 FR 3087732 A1 FR3087732 A1 FR 3087732A1 FR 1860097 A FR1860097 A FR 1860097A FR 1860097 A FR1860097 A FR 1860097A FR 3087732 A1 FR3087732 A1 FR 3087732A1
- Authority
- FR
- France
- Prior art keywords
- vehicle
- exo
- lane
- determining
- lane change
- 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
- 230000008859 change Effects 0.000 title claims abstract description 58
- 238000000034 method Methods 0.000 title claims abstract description 39
- 238000001914 filtration Methods 0.000 claims abstract description 9
- 230000001105 regulatory effect Effects 0.000 claims abstract description 5
- 230000006870 function Effects 0.000 claims description 11
- 239000011159 matrix material Substances 0.000 claims description 8
- 230000007704 transition Effects 0.000 claims description 3
- 238000001514 detection method Methods 0.000 description 7
- 230000003044 adaptive effect Effects 0.000 description 4
- 230000006399 behavior Effects 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 238000005070 sampling Methods 0.000 description 3
- 230000004888 barrier function Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000008569 process 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/04—Traffic conditions
-
- 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
- B60W30/00—Purposes 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/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
- B60W30/0956—Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
-
- 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
- B60W30/00—Purposes 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/14—Adaptive cruise control
- B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
-
- 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
- B60W50/00—Details 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/0097—Predicting future conditions
-
- 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/58—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
-
- 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
- B60W50/00—Details 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
- B60W2050/0001—Details of the control system
- B60W2050/0019—Control system elements or transfer functions
- B60W2050/0042—Transfer function lag; delays
-
- 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
- B60W50/00—Details 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
- B60W2050/0001—Details of the control system
- B60W2050/0043—Signal treatments, identification of variables or parameters, parameter estimation or state estimation
- B60W2050/0052—Filtering, filters
-
- 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
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/403—Image sensing, e.g. optical camera
-
- 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
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/408—Radar; Laser, e.g. lidar
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/40—Dynamic objects, e.g. animals, windblown objects
- B60W2554/404—Characteristics
- B60W2554/4041—Position
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/801—Lateral distance
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/803—Relative lateral 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/804—Relative longitudinal speed
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Multimedia (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Physics (AREA)
- Human Computer Interaction (AREA)
- Traffic Control Systems (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
L'invention concerne un procédé de détermination d'un changement de voie d'un premier véhicule, dit exo véhicule, (11) à destination d'un module de régulation de la vitesse longitudinale d'un deuxième véhicule (12), dit ego véhicule, comportant des étapes de :
- Acquisition de données de position et de vitesse de l'exo véhicule (11),
- Filtrage des données de position et de vitesse acquises,
- Prédiction d'une trajectoire de l'exo véhicule (11) à partir des données filtrées,
- Calcul d'une probabilité de changement voie (P) à partir de la prédiction de la trajectoire de l'exo véhicule (11).
- Si la probabilité (P) de changement de voie de l'exo véhicule (11) est supérieure à un seuil prédéterminé alors l'émission d'un signal indiquant que l'exo véhicule (11) est considéré comme changeant de voie.
Description
Procédé et dispositif de détermination d'un changement de voie d'un véhicule La présente invention concerne le domaine des systèmes d'assistance à la conduite pour véhicules automobiles.
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.
On connaît par exemple les régulateurs de vitesse adaptatifs, mieux lo connus sous l'acronyme anglais ACC (pour « Adaptive Cruise Control » ou « Autonomous Cruise Control »).
Un tel mode d'assistance ajuste de manière automatique la vitesse afin de maintenir un intervalle de sécurité constant avec le véhicule précédant l'utilisateur à partir des informations recueillis sur ce véhicule (notamment la distance et la vitesse d'approche) à l'aide d'un ou 15 plusieurs capteurs de type radar, lidar ou infrarouge.
Dans un contexte autoroutier, un véhicule totalement autonome, ou un ACC, ont besoin d'analyser l'environnement et doivent être en mesure de détecter si un autre véhicule change de voie.
La détection d'un changement de voie doit intervenir avant que le véhicule ne soit effectivement en circulation sur 20 la nouvelle voie afin d'anticiper le freinage et de limiter le risque de collision.
De cette façon, le véhicule autonome ou l'ACC devraient être plus confortable et moins stressant pour les usagers.
On connait par le document EP2562060 un procédé pour prévoir informatiquement des comportements de mouvement futurs d'au moins un objet 25 cible, comme par exemple un véhicule.
Ce procédé comporte notamment une étape de calcul d'une pluralité de comportements de mouvement alternatifs d'un objet cible détecté par le(s) capteur(s), en prédisant les comportements de mouvements du véhicule cible du trafic en appliquant une étape de prédiction basée sur le contexte utilisant des indicateurs indirects et/ou des combinaisons 30 d'indicateur dérivées desdites données de capteur.
Ce procédé ne donne pas entière satisfaction.
En particulier, il est complexe et demande d'importantes ressources en calcul.
2 L'invention a donc pour but d'améliorer la situation en proposant un procédé de détermination d'un changement de voie d'un véhicule simple à mettre en oeuvre et requérant moins de ressources de calcul.
Elle propose plus précisément à cet effet un procédé de détermination 5 d'un changement de voie d'un premier véhicule, dit exo véhicule, à destination d'un module de régulation de la vitesse longitudinale d'un deuxième véhicule, dit ego véhicule, comportant des étapes de : - Acquisition de données de position et de vitesse de l'exo véhicule, Filtrage des données de position et de vitesse acquises, lo Prédiction d'une trajectoire de l'exo véhicule à partir des données filtrées, - Calcul d'une probabilité de changement voie à partir de la prédiction de la trajectoire de l'exo véhicule, - Si la probabilité de changement de voie de l'exo véhicule est 15 supérieure à un seuil prédéterminé alors l'émission d'un signal indiquant que l'exo véhicule est considéré comme changeant de voie.
L'invention permet de déterminer si l'exo véhicule 11 change de voie.
L'utilisation d'une prédiction de trajectoire permet d'améliorer le niveau d'anticipation du procédé tout en évitant de fausses détections de changement 2o de voie.
Avantageusement, les données acquises comportent : - une position relative longitudinale de l'exo véhicule en fonction de l'égo véhicule, une position relative latérale de l'exo véhicule en fonction de l'égo 25 véhicule, une vitesse longitudinale de l'exo véhicule.
Avantageusement, le procédé de détermination d'un changement de voie selon l'invention, comporte en outre une étape de détermination d'une vitesse latérale de l'exo véhicule à partir d'une pluralité de positions relatives 30 latérales de l'exo véhicule.
3 Avantageusement, l'étape de filtrage des données comporte l'application d'un filtre de Kalman à la position relative longitudinale, la position relative latérale, la vitesse longitudinale acquises et à la vitesse latérale déterminée.
5 Avantageusement, l'étape de prédiction prend en compte en outre une matrice de transition.
Avantageusement, l'étape de calcul d'une probabilité de changement de voie comprend un calcul d'une probabilité de changement de voie à partir d'une distance entre l'exo véhicule et une ligne délimitant la voie. io Avantageusement, l'étape de calcul d'une probabilité de changement de voie comprend en outre un calcul d'une probabilité de changement de voie à partir de la vitesse latérale de l'exo véhicule.
Avantageusement, le procédé de détermination d'un changement de voie selon l'invention, comporte en outre une étape, préalable à l'étape de calcul 15 de la probabilité de changement voie, de détermination si la position prédite de l'exo véhicule est hors de la voie de circulation actuelle dudit exo véhicule, le cas échéant, le procédé selon l'invention passe directement à l'étape d'émission d'un signal indiquant que l'exo véhicule est considéré comme changement de voie.
20 L'invention concerne aussi un dispositif de détermination d'un changement de voie d'un premier véhicule, dit exo véhicule, à destination d'un module de régulation de la vitesse longitudinale d'un deuxième véhicule, dit ego véhicule, caractérisé en ce qu'il comporte au moins un processeur et une mémoire adaptés pour mettre en oeuvre le procédé selon l'invention.
25 L'invention concerne aussi un véhicule caractérisé en ce qu'il comporte un dispositif selon l'invention.
D'autres caractéristiques et avantages de l'invention apparaîtront à l'examen de la description détaillée ci-après, et des dessins annexés, sur lesquels : 30 - La figure 1 illustre un premier exemple d'application de l'invention ; - La figure 2 montre un logigramme représentant le procédé selon l'invention ; 4 La figure 3 montre une représentation d'une relation utilisée pour calculer une probabilité de changement de voie en fonction d'une distance entre l'exo véhicule et la ligne ; - La figure 4 montre une représentation d'une relation utilisée pour calculer une 5 probabilité de changement de voie en fonction d'une vitesse latérale ; - La figure 5 illustre un deuxième exemple d'application de l'invention ; La figure 6 représente un exemple d'un dispositif de calcul selon l'invention.
Les dessins annexés pourront non seulement servir à compléter l'invention, mais aussi contribuer à sa définition, le cas échéant.
13 La figure 1 montre un premier exemple d'application de l'invention.
La figure 1 représente une route comportant trois voies délimitées par des lignes 13.
Un premier véhicule, dit exo véhicule 11, est situé sur la voie de centrale à l'avant d'un deuxième véhicule dit égo véhicule 12, qui est lui aussi situé sur la voie centrale.
15 Le procédé selon l'invention, exécuté sur un dispositif embarqué de l'égo véhicule 12, permet de déterminer si l'exo véhicule 11 est en train de changer de voie.
Cette information est notamment destinée à un système de contrôle adaptatif de l'égo véhicule 12 qui l'utilise pour déterminer si l'exo véhicule 11 20 doit être considéré comme véhicule cible (autrement dit, le véhicule à partir duquel le système détermine sa vitesse de façon à maintenir un intervalle de sécurité).
La figure 1 représente aussi un repère orthogonal dont l'origine est centrée sur l'égo véhicule 12.
L'axe des abscisses correspond à des positions 25 latérales et l'axe des ordonnées à des positions longitudinales.
Selon l'invention, des règles sont définies afin d'identifier si l'exo véhicule 11 change de voie.
Ces règles sont basées sur la vitesse transversale de l'égo véhicule 11 et sa distance par rapport aux repères de voie 13.
Des probabilités dépendant de ces deux paramètres sont utilisées pour estimer si 30 l'exo véhicule 11 change de voie.
Plus la vitesse transversale est élevée et plus la distance par rapport aux repères de voie 13 est faible, plus la probabilité que l'exo véhicule 11 change de voie est élevée.
5 La figure 2 montre un logigramme représentant le procédé selon l'invention.
Le procédé selon l'invention comporte une première étape d'acquisition 21 de données de position et de vitesse de l'exo véhicule 11.
5 Les différentes données, notamment, la position des objets dans l'environnement, sont acquises en utilisant une fusion de données de différents capteurs équipant un système de détection de l'ego véhicule 12.
Le système de détection comprend une pluralité de capteurs par exemple une caméra orientée vers l'avant du véhicule et délivrant des données 13 permettant de déterminer le type de route empruntée (autoroute, voie rapide ou bien route secondaire) à partir de certains paramètres caractéristiques tels que la largeur de la voie, le marquage au sol (couleur, largeur et espacement des lignes) et la présence éventuelle d'une barrière ou d'un terre-plein central de séparation entre les deux sens de circulation.
15 Avantageusement, les données acquises comportent des informations relatives au positionnement des lignes 13 délimitant les voies de circulation.
Ces informations sont fournies par exemple par la caméra à bord de l'égo véhicule 12.
Ces informations prennent, par exemple, la forme de polynômes du troisième ordre : 20 yR(x) = COR + C1RX C2RX2 C3RX3 yL(x) = COL ÷ C1LX C2LX2 C3LX3, avec yR(x) et yL(x) la position latérale des lignes droite et gauche à une distance x devant l'égo véhicule 12, CiR et CH_ étant les coefficients d'ordre i des deux polynômes.
25 Selon une caractéristique de l'invention, les données acquises comportent au moins : - une position relative longitudinale X de l'exo véhicule 11 en fonction de l'égo véhicule 12, - une position relative latérale Y de l'exo véhicule 11 en fonction de 30 l'égo véhicule 12, 6 une vitesse longitudinale Vx de l'exo véhicule 11.
Selon une caractéristique de l'invention, le procédé de détermination d'un changement de voie d'un véhicule selon l'invention comporte en outre une étape de détermination d'une vitesse latérale Vy de l'exo véhicule 11 à partir 5 d'une pluralité de positions relatives latérales Y de l'exo véhicule.
Avantageusement, la détermination de la vitesse latérale Vy(k) de l'exo véhicule 11, à un instant donné k, utilise la relation suivante : Vy(k) = Ts Y(k) -Y(k - 1) Avec Ts une période d'échantillonnage, Y(k) la position relative latérale à l'instant k et Y(k) la position relative latérale à l'instant k-1.
La période d'échantillonnage Ts est par exemple de 40 ms, autrement dit, l'acquisition des données est faite toutes les 40ms.
Selon une caractéristique de l'invention, le procédé de détermination d'un changement de voie d'un véhicule selon l'invention comporte en outre une étape de filtrage 22 des données de position et de vitesse acquises.
Cette étape de filtrage 22 des données comporte par exemple l'application d'un filtre de Kalman à la position relative longitudinale X, la position relative latérale Y, la vitesse longitudinale Vx acquises et à la vitesse latérale Vy déterminée.
Le filtre de Kalman est capable d'estimer les états d'un système physique (en l'espèce, les positions et vitesses longitudinales et latérales de l'exo véhicule) à partir d'une série de mesures incomplètes et bruitées et d'un modèle dynamique.
Ici, le filtrage de Kalman va être utilisé pour avoir une meilleure estimation de la vitesse latérale et prédire les futurs états du système grâce au modèle dynamique.
Etant donné que les seuls signaux disponibles concernant l'exo véhicule 11, sont sa position relative par rapport à l'ego véhicule 12 et sa vitesse, un modèle simple d'évolution est utilisé.
L'exo véhicule 11 est considéré comme ayant une vitesse longitudinale et latérale constante, de sorte que les équations décrivant l'évolution de sa trajectoire relative vers l'ego véhicules sont : 7 X(k + 1) = X(k) + TsVx(k) - TsVxego(k) Vx(k + 1) = Vx(k) Y(k + 1) = Y(k) + TsVy(k) Vy(k + 1) = Vy(k); 5 avec X(k) et Y(k) la position longitudinale et latérale de l'exo véhicule 11 par rapport à la position de l'ego véhicule 12 à l'instant k, et Vx(k) et Vy(k) la vitesse longitudinale et latérale réelle de l'exo véhicule 11 à l'instant k.
La représentation de l'espace d'état du modèle est décrite de la façon suivante : 10 x(k -H 1) = Ax(k) + Bu(k) X(k) AvecVx(k) Avec x(k) = y (k) , x(k) étant le vecteur comportant la position Vy(k) relative longitudinale X(k), la position relative latérale Y(k), la vitesse longitudinale Vx(k) et à la vitesse latérale Vy(k) de l'exo véhicule 11 à l'instant k ; u(k) = V'flo(k), la vitesse longitudinale de l'ego véhicule 12, 15 Et A et B prenant les valeurs suivantes : 1 7; 0 0 A = 0 1 0 0 et B= O's 0 0 1 Ts 0 0 0 0 1 0 Le filtrage de Kalman se fait en deux étapes, une étape de prédiction et une étape de mise à jour.
On note 2klk l'état estimé et Pkik la matrice de covariance d'erreur à l'instant k, l'étape de prédiction calcule l'estimation de l'état z o courant en utilisant les relations : Bu(k) Pkik-1 = + Q avec 5ekik_l l'estimation de l'état prédit, Q la matrice de covariance du 8 bruit et P - kik-1 la matrice d'estimation de la covariance de l'erreur.
A un instant k, -kik-1 est l'état estimé à priori (sachant les états précédent, jusqu'à k-1 ). 2kik est l'état estimé à postériori (sachant les états précédent y compris l'instant k).
Le raisonnement est identique pour P.
5 L'étape de mise à jour permet d'obtenir une estimation plus précise à l'aide des observations pour corriger les états prédits.
L'étape de mise à jour met en oeuvre les relations suivantes = Zk H5eklk-1 Sk =HPklk_1HTR 10 Kk = T Sk1 5c1/4kik = 5c1/4kik-l+ Kk.33k Pkik = (I -KkH)Pkik-1 Avec zk une mesure, Sk la covariance de la mise à jour, R est la matrice de covariance du bruit de mesure.
Ici R est constante et empirique, Kk le gain 15 de Kalman et H = 14 le modèle d'observation. (14 étant la matrice identité de dimension 4).
Selon une caractéristique de l'invention, le procédé de détermination d'un changement de voie d'un véhicule selon l'invention comporte en outre une étape de prédiction 23 d'une trajectoire de l'exo véhicule 11 à partir des données z0 filtrées.
Cette étape permet de détecter le changement de voie le plus tôt possible.
L'étape de prédiction utilise le modèle dynamique.
Cette étape permet de déterminer la position du véhicule à un horizon temporel th, qui vaut par exemple 0,6 secondes.
La valeur de l'horizon th est 25 définie de façon empirique.
Cette valeur est choisie de manière à ce que la détection puisse se faire de manière précoce mais sans détection erronée de changement de voie.
En effet, si la vitesse transversale du véhicule est élevée, l'étape de prédiction peut estimer à tort que le véhicule sera dans une autre voie à t + th.
Au contraire, si t + th est trop petit, la détection du changement de voie 9 peut être tardive.
L'estimation de la position de l'exo véhicule 11 à l'instant t+th est calculée à l'aide de la relation suivante : th 21c1k-Fth5C'klic = ATs Avec th un horizon de temps pour la prédiction, 5 T5 la période d'échantillonnage, r0 1 0 0 77 7; 0 0 0 A la matrice de transition et A= 0 1 ,1' 0 0 0 1 X(k) (k) -FY Vi(k)1 , îckik étant le vecteur comportant la position relative Vy(k) longitudinale X(k), la position relative latérale Y(k), la vitesse longitudinale Vx(k) et à la vitesse latérale Vy(k) prédites de l'exo véhicule 11 à l'instant k ; 10xklk+threprésentant le vecteur comportant la position relative longitudinale X(k-Fth), la position relative latérale Y(k-Fth), la vitesse longitudinale Vx(k+th) et à la vitesse latérale Vy(k+th) prédites de l'exo véhicule 11 à l'horizon de temps k+th.
Selon une caractéristique de l'invention, le procédé de détermination 15 d'un changement de voie d'un véhicule selon l'invention comporte en outre une étape de calcul 24 d'une probabilité P de changement voie de l'exo véhicule 11 à partir de la prédiction de la trajectoire de l'exo véhicule 11.
En particulier, pour détecter si l'exo véhicule 11 est en train de changer de voie, deux probabilités sont utilisées : une première probabilité P(Vy) qui 20 dépend de la vitesse latérale de l'exo véhicule 11, à l'instant t + th, et une deuxième probabilité P(ay)qui dépend de la position latérale de l'ego véhicule 11 par rapport à la ligne 13 de la voie la plus proche de lui et de l'ego véhicule 12, à l'instant t + th.
Ainsi, pour qu'un changement de voie soit détecté, il faut que l'exo véhicule 11 soit suffisamment proche de la ligne 13 et que sa vitesse 25 latérale soit suffisamment grande, à l'instant t + th. j?k1k 10 L'étape de calcul 24 d'une probabilité P de changement de voie comprend donc le calcul d'une probabilité P(Dy) de changement de voie à partir d'une distance entre l'exo véhicule 11 ou plus précisément entre la position prédite de l'exo véhicule 11 et la ligne 13 délimitant la voie. s La distance entre l'exo véhicule 11 et la ligne 13 est calculée à l'aide des coefficients du polynôme représentant la ligne 13.
La position latérale y1 de la ligne 13, par rapport à l'ego véhicule 12, et à une distance longitudinale x1 de ce dernier s'exprime : = Co + Cuti + C2X12 C3X13 io La distance Ay entre l'exo véhicule 11 et la ligne 13 à un instant k vaut donc : Ay - ±kik+th (3) Y/ (2kik+th (1)) Avec .fceikt+h (1) la première valeur du vecteur îckie+th, autrement dit, la position relative longitudinale X(k+th) de l'exo véhicule à l'instant k+th, 15 y1(21,1k±th(1)) la position latérale de la ligne 13 correspondant à la valeur de 2kik+th (1), xklk+th(3) la troisième valeur du vecteur 2kik+th, autrement dit, la position relative latérale Y(k+th) de l'exo véhicule 11 à l'instant k+th.
Avantageusement, la probabilité P(Ay) de changement de voie à partir 20 d'une distance entre l'exo véhicule 11 et la ligne 13 suit la relation suivante : 1 P(ay) + e-RAY-co Où f3 et a sont des valeurs prédéfinies et déterminées de façon empirique.
La figure 3 montre une représentation de la relation précédente pour 25 des valeurs de p égales à -24 et a à 0,25.
On peut noter que la fonction représentée est décroissante de sorte que plus la distance entre l'exo véhicule 11 et la ligne 13 est élevée plus la probabilité P(Ay) est faible.
Selon une caractéristique de l'invention, l'étape de calcul 24 d'une 11 probabilité P de changement de voie comprend en outre le calcul d'une probabilité P(Vy) de changement de voie à partir de la vitesse latérale Vy de l'exo véhicule 11.
Avantageusement, la probabilité P(Vy) de changement de voie en 5 fonction de la vitesse latérale Vy suit la relation suivante : P(Vy) = 1 1 + e-P(vrOE) Où [3 et a sont des valeurs prédéfinies et déterminées de façon empirique.
La figure 4 montre une représentation de la relation précédente pour 10 des valeurs de p égales à 18 et a à 0,33.
On peut noter que la fonction représentée est croissante de sorte que plus la vitesse latérale Vy est élevée plus la probabilité P (V1) est grande.
Selon une caractéristique de l'invention, le calcul de la probabilité P de changement de voie à partir de la probabilité P(Dy) de changement de voie à 15 partir de la distance entre l'exo véhicule 11 et la ligne 13 et de la probabilité P(Vy) de changement de voie à partir de la vitesse latérale V3, de l'exo véhicule 11 suit la relation suivante : P = P (A ) P (Vy) Selon une caractéristique de l'invention, le procédé de détermination 20 d'un changement de voie d'un véhicule selon l'invention comporte en outre une étape d'émission 25 d'un signal indiquant que l'exo véhicule 11 est considéré comme changement de voie, si la probabilité P de changement de voie déterminé est supérieure à un seuil S prédéterminé.
Le seuil S vaut par exemple 0,5.
25 Le signal est émis par exemple à destination d'un système de régulation de vitesse adaptatif de l'égo véhicule 12.
Avec cette information, celui-ci peut alors choisir un véhicule cible, c'est-à-dire le véhicule à partir duquel il va déterminer la vitesse de l'égo véhicule 12 de façon à maintenir une distance de sécurité entre l'égo véhicule 12 et la cible choisie.
12 En se rapportant à l'exemple de la figure 1, on suppose par exemple que l'exo véhicule 11 à une vitesse latérale Vy égale à 0,6 mètres par secondes.
La probabilité P (Vy) de changement de voie à partir de la vitesse latérale Vy est alors de 0,99.
5 On suppose aussi que la distance entre l'exo véhicule 11 et la ligne 13 est de 0,4 mètres.
La probabilité P(3,y) de changement de voie à partir de la distance entre l'exo véhicule 11 et la ligne 13 est alors de 0,02.
La probabilité P de changement de voie est alors de 0,02 x 0,99 = 0,0198.
Cette valeur est inférieure au seuil S prédéterminé.
L'exo Io véhicule n'est donc pas considéré comme étant en train de changer de voie.
De façon avantageuse, le procédé de détermination d'un changement de voie d'un véhicule selon l'invention comporte en outre une étape (non représentée à la figure 2), préalable au calcul 24 de la probabilité de changement voie P.
Cette étape détermine si la position prédite de l'exo véhicule 15 11 à un horizon de temps prédéterminé est hors de la voie de circulation actuelle dudit exo véhicule 11.
Le cas échéant, le procédé selon l'invention passe directement à l'étape d'émission 25 d'un signal indiquant que l'exo véhicule 11 est considéré comme changement de voie.
L'étape de calcul 24 de probabilité P n'est alors pas exécutée.
En effet, cette étape de calcul 24 s'avère alors inutile 20 car la prédiction détermine avec certitude que l'exo véhicule va changer de voie.
La figure 5 montre un deuxième exemple d'application sur une route comportant trois voies.
L'exo véhicule 11 est situé sur la voie de droite à l'avant de l'égo véhicule qui est situé sur la voie centrale.
La voie centrale est délimitée par les lignes 13.
Dans cette exemple, la position prédite 51 pour l'exo véhicule 25 11 se situe dans une autre voie (la voie centrale) que celle où il se situe actuellement (la voie de gauche).
La figure 6 représente un exemple de dispositif 600 de calcul d'un véhicule.
Ce dispositif 600 peut prendre la forme d'un boitier comprenant des circuits imprimés, de plusieurs circuits imprimés reliés par des connections 30 filaires ou non filaires, de tout type d'ordinateur.
On entend par circuit imprimé tout type de dispositif apte à effectuer au moins une opération électrique ou 13 électronique.
Le dispositif 600 comprend une mémoire vive 601 pour stocker des instructions pour la mise en oeuvre par un processeur 602 du procédé selon l'invention.
Le dispositif 900 comporte aussi une mémoire de masse 603 pour le 5 stockage de données destinées à être conservées après la mise en oeuvre du procédé.
Le dispositif 600 peut en outre comporter un processeur de signal numérique (DSP) 604.
Une ou plusieurs des étapes du procédé peuvent être effectuées par des composants différents.
Ainsi, le procédé peut être mis en oeuvre par une pluralité de processeurs, mémoire vive, mémoire de masse, interface d'entrée, interface de sortie et/ou DSP.
Dans ces situations, le dispositif 600 peut être décentralisé, au sein d'un réseau local (plusieurs processeurs reliés entre eux par exemple) ou d'un réseau étendu.
15 Le dispositif 600 comporte également une interface d'entrée 605 pour la réception notamment des données utilisées par le procédé et une interface de sortie 606 pour la transmission des données produites par le procédé.
Le dispositif selon l'invention permet de déterminer un changement de voie d'un
Claims (10)
- REVENDICATIONS1. Procédé de détermination d'un changement de voie d'un premier véhicule (11), dit exo véhicule, à destination d'un module de régulation de la vitesse longitudinale d'un deuxième véhicule (12), dit ego véhicule, comportant des étapes de : Acquisition (21) de données de position et de vitesse de l'exo véhicule (11), - Filtrage (22) des données de position et de vitesse acquises, - Prédiction (23) d'une trajectoire de l'exo véhicule (11) à partir des données filtrées, Calcul (24) d'une probabilité de changement voie (P) à partir de la prédiction de la trajectoire de l'exo véhicule (11), Si la probabilité (P) de changement de voie de l'exo véhicule (11) est supérieure à un seuil prédéterminé alors l'émission (25) d'un signal indiquant que l'exo véhicule (11) est considéré comme changeant de voie.
- 2. Procédé de détermination d'un changement de voie selon la revendication 1, caractérisé en ce que les données acquises comportent : - une position relative longitudinale (X) de l'exo véhicule en fonction de l'égo véhicule, - une position relative latérale (Y) de l'exo véhicule en fonction de l'égo véhicule, une vitesse longitudinale (Vx) de l'exo véhicule.
- 3. Procédé de détermination d'un changement de voie selon la revendication précédente, caractérisé en ce qu'il comporte en outre une étape de détermination d'une vitesse latérale de l'exo véhicule (Vy) à partir d'une pluralité de positions relatives latérales (Y) de l'exo véhicule (11). 15
- 4. Procédé de détermination d'un changement de voie selon la revendication précédente, caractérisé en ce que l'étape de filtrage (22) des données comporte l'application d'un filtre de Kalman à la position relative longitudinale (X), la position relative latérale (Y), la vitesse longitudinale (Vx) acquises et à la vitesse 5 latérale (Vy) déterminée.
- 5. Procédé de détermination d'un changement de voie selon l'une des revendications précédentes, caractérisé en ce que l'étape de prédiction (23) prend en compte en outre une matrice de transition (F). 10
- 6. Procédé de détermination d'un changement de voie selon l'une des revendications précédentes, caractérisé en ce que l'étape de calcul (24) d'une probabilité (P) de changement de voie comprend un calcul d'une probabilité (PAy) de changement de voie à partir d'une distance entre l'exo véhicule et une 15 ligne délimitant la voie.
- 7. Procédé de détermination d'un changement de voie selon la revendication précédente, caractérisé en ce que l'étape de calcul (24) d'une probabilité (P) de changement de voie comprend en outre un calcul d'une probabilité (P(Vy)) de 23 changement de voie à partir de la vitesse latérale de l'exo véhicule.
- 8. Procédé de détermination d'un changement de voie selon l'une des revendications précédentes, caractérisé en ce qu'il comporte en outre une étape, préalable à l'étape de calcul (24) de la probabilité de changement voie 25 (P), de détermination si la position prédite de l'exo véhicule (11) est hors de la voie de circulation actuelle dudit exo véhicule (11), le cas échéant, le procédé selon l'invention passe directement à l'étape d'émission (25) d'un signal indiquant que l'exo véhicule (11) est considéré comme changement de voie. 30
- 9. Dispositif de détermination d'un changement de voie d'un premier véhicule (11), dit exo véhicule, à destination d'un module de régulation de la vitesse longitudinale d'un deuxième véhicule (12), dit ego véhicule, caractérisé en ce 16 qu'il comporte au moins un processeur et une mémoire adaptés pour mettre en oeuvre le procédé selon l'une des revendications précédentes.
- 10. Véhicule caractérisé en ce qu'il comporte un dispositif selon la revendication 5 précédente.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR1860097A FR3087732B1 (fr) | 2018-10-31 | 2018-10-31 | Procede et dispositif de determination d’un changement de voie d’un vehicule |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR1860097A FR3087732B1 (fr) | 2018-10-31 | 2018-10-31 | Procede et dispositif de determination d’un changement de voie d’un vehicule |
Publications (2)
Publication Number | Publication Date |
---|---|
FR3087732A1 true FR3087732A1 (fr) | 2020-05-01 |
FR3087732B1 FR3087732B1 (fr) | 2020-12-11 |
Family
ID=65444191
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
FR1860097A Expired - Fee Related FR3087732B1 (fr) | 2018-10-31 | 2018-10-31 | Procede et dispositif de determination d’un changement de voie d’un vehicule |
Country Status (1)
Country | Link |
---|---|
FR (1) | FR3087732B1 (fr) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR3129908A1 (fr) * | 2021-12-06 | 2023-06-09 | Psa Automobiles Sa | Procédé et dispositif de contrôle d’un système de régulation adaptative de vitesse d’un véhicule |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070027597A1 (en) * | 2003-09-23 | 2007-02-01 | Daimlerchrysler Ag | Method and device for recognising lane changing operations for a motor vehicle |
US20100017180A1 (en) * | 2006-12-05 | 2010-01-21 | Martin Randler | Method and device for object tracking in a driver assistance system of a motor vehicle |
US20100228419A1 (en) * | 2009-03-09 | 2010-09-09 | Gm Global Technology Operations, Inc. | method to assess risk associated with operating an autonomic vehicle control system |
EP2562060A1 (fr) | 2011-08-22 | 2013-02-27 | Honda Research Institute Europe GmbH | Procédé et système de prédiction de comportement de mouvement d'un objet de trafic cible |
DE102012219449A1 (de) * | 2012-10-24 | 2014-04-24 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren zur Geschwindigkeits- und/oder Abstandsregelung bei Kraftfahrzeugen |
EP3281831A1 (fr) * | 2016-08-11 | 2018-02-14 | TRW Automotive GmbH | Système de commande et procédé de commande destinés à déterminer une probabilité pour un changement de voie de circulation d'un véhicule déboitant |
-
2018
- 2018-10-31 FR FR1860097A patent/FR3087732B1/fr not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070027597A1 (en) * | 2003-09-23 | 2007-02-01 | Daimlerchrysler Ag | Method and device for recognising lane changing operations for a motor vehicle |
US20100017180A1 (en) * | 2006-12-05 | 2010-01-21 | Martin Randler | Method and device for object tracking in a driver assistance system of a motor vehicle |
US20100228419A1 (en) * | 2009-03-09 | 2010-09-09 | Gm Global Technology Operations, Inc. | method to assess risk associated with operating an autonomic vehicle control system |
EP2562060A1 (fr) | 2011-08-22 | 2013-02-27 | Honda Research Institute Europe GmbH | Procédé et système de prédiction de comportement de mouvement d'un objet de trafic cible |
DE102012219449A1 (de) * | 2012-10-24 | 2014-04-24 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren zur Geschwindigkeits- und/oder Abstandsregelung bei Kraftfahrzeugen |
EP3281831A1 (fr) * | 2016-08-11 | 2018-02-14 | TRW Automotive GmbH | Système de commande et procédé de commande destinés à déterminer une probabilité pour un changement de voie de circulation d'un véhicule déboitant |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR3129908A1 (fr) * | 2021-12-06 | 2023-06-09 | Psa Automobiles Sa | Procédé et dispositif de contrôle d’un système de régulation adaptative de vitesse d’un véhicule |
WO2023105128A1 (fr) * | 2021-12-06 | 2023-06-15 | Psa Automobiles Sa | Procédé et dispositif de contrôle d'un système de régulation adaptative de vitesse d'un véhicule |
Also Published As
Publication number | Publication date |
---|---|
FR3087732B1 (fr) | 2020-12-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP2903875B1 (fr) | Procede d'evaluation du risque de collision a une intersection | |
US12084051B2 (en) | Scenario identification in autonomous driving environments | |
EP3812954A1 (fr) | Surveillance et évaluation des performances d'une caractéristique adas ou de conduite autonome d'un véhicule | |
WO2019197781A1 (fr) | Apprentissage automatique prédictif pour la prédiction d'une vitesse future d'un véhicule automobile en mouvement sur une route | |
FR3087732A1 (fr) | Procede et dispositif de determination d’un changement de voie d’un vehicule | |
US20210304524A1 (en) | Methods and systems for collecting sensor data according to a data collection configuration based on an estimated information gain | |
EP2804016A1 (fr) | Procédé amélioré de détermination de la position et/ou de la vitesse d'un véhicule guidé ; système associé | |
FR3103437A1 (fr) | Procédé et dispositif de détermination de consigne pour 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. | |
WO2017216495A1 (fr) | Procédé de détermination d'une classe de conduite de référence | |
EP2489548B1 (fr) | Procédé et dispositif de commande de commutation du système d'éclairage avant adaptatif d'un véhicule automobile | |
FR3104518A1 (fr) | Système et procédé de prédiction de la trajectoire d’un véhicule | |
EP4237303B1 (fr) | Procédé et dispositif de détermination d'un pourcentage de faisabilité de changement de voie pour un véhicule autonome | |
FR3128177A1 (fr) | Procédé et dispositif de prédiction d’un changement de voie de circulation pour véhicule | |
EP3775988B1 (fr) | Procédé et dispositif de détection d'objets dans l'environnement d'un véhicule, en présence de goutelettes | |
EP3300525A1 (fr) | 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 | |
EP4251485A1 (fr) | Procédé et dispositif de détermination d'une ligne virtuelle de délimitation entre deux voies de circulation | |
FR3131724A1 (fr) | Procédé et dispositif de contrôle d’un système de changement semi-automatique de voie de circulation d’un véhicule | |
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 | |
FR3137781A1 (fr) | Procédé et dispositif de détermination d’une largeur d’une voie latérale adjacente à une voie de circulation | |
WO2024094941A1 (fr) | Procédé et dispositif de contrôle de gestion des messages d'alertes pour un système de régulation adaptative de vitesse d'un véhicule | |
FR3146640A1 (fr) | Procédé et dispositif de contrôle d’un trajet d’un véhicule autonome circulant selon un mode manuel | |
EP4247681A1 (fr) | Procédé et dispositif de détermination d'une trajectoire d'accélération consigne d'un régulateur de vitesse véhicule adaptatif d'un véhicule autonome | |
FR3118745A1 (fr) | Procédé et dispositif de détermination d’une accélération d’un objet mobile dans un environnement d’un véhicule | |
WO2024094942A1 (fr) | Procédé et dispositif de contrôle d'un système de régulation adaptative de vitesse d'un véhicule changeant de voie de circulation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PLFP | Fee payment |
Year of fee payment: 2 |
|
PLSC | Publication of the preliminary search report |
Effective date: 20200501 |
|
PLFP | Fee payment |
Year of fee payment: 3 |
|
ST | Notification of lapse |
Effective date: 20220605 |