FR3116782A1 - Procédé et dispositif d’adaptation d’une trajectoire d’accélération de consigne d’un régulateur de vitesse véhicule adaptatif d’un véhicule autonome. - Google Patents
Procédé et dispositif d’adaptation d’une trajectoire d’accélération de consigne d’un régulateur de vitesse véhicule adaptatif d’un véhicule autonome. Download PDFInfo
- Publication number
- FR3116782A1 FR3116782A1 FR2012390A FR2012390A FR3116782A1 FR 3116782 A1 FR3116782 A1 FR 3116782A1 FR 2012390 A FR2012390 A FR 2012390A FR 2012390 A FR2012390 A FR 2012390A FR 3116782 A1 FR3116782 A1 FR 3116782A1
- Authority
- FR
- France
- Prior art keywords
- acceleration
- speed
- target
- setpoint
- trajectory
- 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
- 230000001133 acceleration Effects 0.000 title claims abstract description 170
- 238000000034 method Methods 0.000 title claims abstract description 40
- 230000003044 adaptive effect Effects 0.000 title claims abstract description 19
- 230000006978 adaptation Effects 0.000 claims abstract description 11
- 230000006870 function Effects 0.000 claims description 40
- 230000010339 dilation Effects 0.000 claims description 19
- 230000002123 temporal effect Effects 0.000 claims description 12
- 230000003321 amplification Effects 0.000 claims description 7
- 238000011156 evaluation Methods 0.000 claims description 7
- 238000003199 nucleic acid amplification method Methods 0.000 claims description 7
- 238000004590 computer program Methods 0.000 claims description 2
- 230000006399 behavior Effects 0.000 description 9
- 238000003032 molecular docking Methods 0.000 description 7
- 230000033228 biological regulation Effects 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 230000036461 convulsion Effects 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 238000012360 testing method Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 230000001419 dependent effect Effects 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000011056 performance test Methods 0.000 description 2
- 238000013213 extrapolation Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000008520 organization Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000036962 time dependent 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
- 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
- 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
- B60W30/162—Speed limiting therefor
-
- 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/0098—Details of control systems ensuring comfort, safety or stability not otherwise provided for
-
- 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/06—Improving the dynamic response of the control system, e.g. improving the speed of regulation or avoiding hunting or overshoot
-
- 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/802—Longitudinal 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
- B60W2720/00—Output or target parameters relating to overall vehicle dynamics
- B60W2720/10—Longitudinal speed
- B60W2720/103—Speed profile
-
- 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
- B60W2720/00—Output or target parameters relating to overall vehicle dynamics
- B60W2720/10—Longitudinal speed
- B60W2720/106—Longitudinal acceleration
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Traffic Control Systems (AREA)
- Controls For Constant Speed Travelling (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
L’invention concerne un procédé et un dispositif d’adaptation d’une trajectoire d’accélération de consigne d’un régulateur de vitesse véhicule adaptatif d’un véhicule autonome, pour que ledit véhicule autonome atteigne une position cible à une vitesse cible tout en respectant des contraintes dynamiques d’accélération, ledit procédé comportant les étapes de :
Réception (301) d’informations sur la trajectoire d’accélération de consigne, sur la position cible, sur la vitesse cible et sur les contraintes dynamiques d’accélération ; Estimation (302) d’une position finale et d’une vitesse finale du véhicule autonome en prenant en compte les contraintes dynamiques d’accélération ;Si (303) l’écart entre la position finale et la position cible est supérieur à un seuil de positon prédéterminé, ou si (303) l’écart entre la vitesse finale et la vitesse cible est supérieur à un seuil de vitesse seuil prédéterminé, alors une adaptation (304) de la trajectoire d’accélération de consigne est déterminée.
Figure pour l’abrégé : Figure 3
Description
L’invention est dans le domaine des systèmes d’aide à la conduite de véhicule autonome. En particulier, l’invention concerne un procédé et un dispositif d’adaptation d’une trajectoire d’accélération de consigne d’un régulateur de vitesse véhicule adaptatif d’un véhicule autonome, pour que ledit véhicule autonome atteigne une position cible à une vitesse cible tout en respectant des contraintes dynamiques d’accélération, ledit véhicule autonome comprenant un calculateur.
On entend par « véhicule » tout type de véhicule tel qu’un véhicule automobile, un cyclomoteur, une motocyclette, un robot de stockage dans un entrepôt, etc. On entend par « conduite autonome » d’un « véhicule autonome » tout procédé apte à assister la conduite du véhicule. Le procédé peut ainsi consister à diriger partiellement ou totalement le véhicule ou à apporter tout type d’aide à une personne physique conduisant le véhicule. Le procédé couvre ainsi toute conduite autonome, du niveau 0 au niveau 5 dans le barème de l’OICA, pour Organisation International des Constructeurs Automobiles.
Les procédés aptes à assister la conduite du véhicule sont aussi nommés ADAS (de l’acronyme anglais « Advanced Driver Assistance Systems »), systèmes ADAS ou systèmes d’aide à la conduite. Un régulateur de vitesse de véhicule, RVV, est un système ADAS connu qui régule la vitesse du véhicule selon une consigne de vitesse donnée, dite vitesse consigne. Lors d’un changement de vitesse consigne, plusieurs trajectoires de la vitesse véhicule (évolution temporelle de la vitesse véhicule) pour atteindre la vitesse consigne sont alors possibles. Suivre une trajectoire de vitesse véhicule détermine une accélération du véhicule, et donc un comportement dynamique du véhicule. Certains régulateurs sont également déterminés en prenant en compte l’accélération et, donc, génèrent une trajectoire d’accélération de consigne, c’est-à-dire qu‘ils déterminent l’accélération souhaitée à chaque instant pour atteindre une vitesse cible.
Un régulateur de vitesse véhicule adaptatif, ou ACC (de l’acronyme anglais « Adaptative Cruise Control »), est une évolution d’un RVV. Un ACC est aussi un système ADAS connu qui régule la vitesse du véhicule et un temps inter-véhiculaire, le temps inter-véhiculaire représentant une durée séparant le passage de l’avant ou de l’arrière de deux véhicules successifs sur une même voie de circulation. Par exemple, le temps inter-véhiculaire est un paramètre prédéterminé par le conducteur ou par défaut selon une préconisation de la réglementation en vigueur (2 secondes par exemple). Le temps inter-véhiculaire prédéterminé est également dit ci-après temps cible.
Un dispositif d’un véhicule comportant la fonction ACC est apte à acquérir des caractéristiques dynamiques longitudinales du véhicule et d’un véhicule précédant, dit véhicule précédant. Ce dispositif comporte par exemple une caméra, un radar, un lidar, … Ce dispositif est apte à détecter l’arrivée du véhicule précédant. C’est le cas, par exemple, lorsqu’un véhicule se rabat sur la même voie de circulation que le véhicule autonome, ou lorsque le véhicule autonome rattrape un véhicule qui le précède sur la même voie de circulation et qui roule plus lentement. En particulier, sont mesurées une vitesse et accélération du véhicule autonome, une vitesse et accélération du véhicule précédant, et une distance entre le véhicule autonome et le véhicule précédant, dite distance inter-véhiculaire ou inter-véhicule. En utilisant une information vitesse véhicule, le temps inter-véhiculaire est déduit de la distance inter-véhiculaire, et la réciproque est vrai également.
Lors d’une détection d’un véhicule précédant, la vitesse du véhicule autonome doit être adaptée afin de respecter le temps cible. Classiquement, la vitesse du véhicule précédant, qui est mesurée, est prise comme vitesse cible. Le régulateur de vitesse adapte la vitesse, donc l’accélération, du véhicule autonome pour accoster le véhicule précédant. On entend par « accoster », adapter, sur une durée déterminée, la vitesse du véhicule autonome pour atteindre celle du véhicule précédant tout en respectant le temps inter-véhiculaire à la fin de la durée déterminée. Le régulateur de vitesse véhicule détermine alors une trajectoire d’accélération de consigne que doit suivre le véhicule autonome. Cela détermine un comportement d’accostage (comportement de la dynamique longitudinale du véhicule autonome) toujours identique. Cela détermine aussi une vitesse cible et une position cible.
Cependant, la trajectoire d’accélération de consigne déterminée ne sait pas prendre en compte des contraintes dynamiques d’accélération car cela est trop complexe. On entend par « contraintes dynamiques d’accélération » des seuils d’accélérations que le véhicule autonome ne doit pas dépasser pour principalement des raisons de conforts, ces seuils étant dépendant d’états du véhicule. Par exemple, un état du véhicule est la vitesse instantanée du véhicule (à un instantt), la position/géolocalisation du véhicule (prendre en compte des panneaux de circulation, la courbure, la pente ou le dévers de la route …), la capacité de freiner ou d’accélérer. Par exemple, une contrainte d’accélération dynamique est de ne pas avoir une accélération inférieure à -3,5 m/s² si la vitesse est supérieure à 70 km/h, ne pas avoir une accélération inférieure à -5 m /s² si la vitesse est inférieure à 30 km/h, et, si la vitesse est comprise entre 30 km/h et 70 km/h, ne pas avoir une accélération inférieure à un seuil qui varie linéairement en fonction de la vitesse et des deux seuils précédant.
Actuellement, si une trajectoire d’accélération de consigne ne respecte pas les contraintes dynamique, le régulateur sature l’accélération de consigne : Par exemple, le régulateur prend le maximum entre une accélération de consigne négative et une contrainte d’accélération négative. Alors, le régulateur ne va pas décélérer suffisamment le véhicule, et la position cible et la vitesse cible ne sont pas atteintes. Cela entraine des générations de trajectoire d’accélération de consigne supplémentaires utilisant des ressources de calculs supplémentaire. Par ailleurs, le comportement d’accostage n’est plus maîtrisé.
Outre les contraintes dynamiques d’accélération, d’autres contraintes dynamiques sont susceptibles de devoir d’être prises en compte comme des contraintes dynamiques sur la vitesse, sur le jerk, sur le jerk en fonction d’une vitesse instantanée du véhicule …
Un objet de la présente invention est de remédier au problème précité, en particulier l’invention adapte la trajectoire d’accélération de consigne, sans avoir besoin de nombreux ressources de calcul. Le comportement d’accostage est alors sensiblement équivalent à celui voulu : atteindre une vitesse cible à une position cible.
A cet effet, un premier aspect de l’invention concerne un procédé d’adaptation d’une trajectoire d’accélération de consigne d’un régulateur de vitesse véhicule adaptatif d’un véhicule autonome, pour que ledit véhicule autonome atteigne une position cible à une vitesse cible tout en respectant des contraintes dynamiques d’accélération, ledit véhicule autonome comprenant un calculateur, ledit procédé comportant les étapes de :
- Réception par le calculateur d’informations sur la trajectoire d’accélération de consigne, sur la position cible, sur la vitesse cible et sur les contraintes dynamiques d’accélération ;
- Estimation d’une position finale et d’une vitesse finale du véhicule autonome à partir de la trajectoire d’accélération de consigne en prenant en compte les contraintes dynamiques d’accélération ;
- Si l’écart entre la position finale et la position cible est supérieur à un seuil de positon prédéterminé, ou si l’écart entre la vitesse finale et la vitesse cible est supérieur à un seuil de vitesse seuil prédéterminé, alors une adaptation de la trajectoire d’accélération de consigne est déterminée à partir d’une dilatation d’amplitude et d’une dilatation temporelle de la trajectoire d’accélération de consigne, tout en prenant en compte les contraintes dynamiques d’accélération.
Ainsi, la trajectoire d’accélération de consigne est réutilisée et adaptée avant y=une utilisation effective par le régulateur de vitesse adaptatif du véhicule autonome. Les contraintes dynamiques sont prises en comptes et le véhicule autonome atteint la vitesse cible avec une position cible proche. L’adaptation de la trajectoire d’accélération de consigne n’est pas complexe : un module générant les trajectoires d’accélération de consigne n’est pas modifié, un module régulation de l’ACC et qui sature les consignes d’accélération n’est pas modifiée. L’invention est un module qui s’intercale entre des modules connus.
La trajectoire d’accélération de consigne est modulée en amplitude et est modulée dans le temps. Par exemple, l’adaptation va faire que la trajectoire d’accélération de consigne adaptée décélère plus fort et plus rapidement afin de compenser des saturations futures.
Dans un mode opératoire, l’invention récupère des informations sur une trajectoire d’accélération de consigne comme, par exemple, des valeurs de paramètres d’une équation analytique modélisant la trajectoire d’accélération consigne en fonction du temps. A partir de cette équation, la position finale la vitesse finale sont calculées tout en prenant en compte les contraintes dynamiques. Si des tests de performance, écart de position et de vitesse sont inférieurs à des seuils prédéterminés, ne sont pas vérifiés alors cette équation est modifiée en amplitude et temporellement pour trouver une trajectoire d’accélération adaptée vérifiant des critères de performances tout en respectant des contraintes dynamiques. Si les tests de performances sont vérifiés, il n’y pas besoin d’adapter la trajectoire.
Avantageusement, le procédé comporte en outre une étape préalable de détermination d’une nouvelle trajectoire d’accélération de consigne par le régulateur de vitesse adaptatif, ledit régulateur de vitesse adaptatif ayant réceptionné une nouvelle vitesse de consigne, ladite nouvelle trajectoire d’accélération de consigne définissant une nouvelle vitesse cible et une nouvelle position cible.
Ainsi, le procédé est relancé au besoin, et une nouvelle trajectoire d’accélération de consigne adaptée est déterminée en fonctions de nouvelles informations.
Avantageusement, une trajectoire d’accélération de consigne prenant en compte les contraintes dynamiques d’accélération est représentée par une fonction ,a(t)étant une fonction représentant la trajectoire d’accélération de consigne,c(t)étant une fonction négative représentant les contraintes dynamiques d’accélération, ettétant une variable représentant temps.
Ainsi, la réception des informations sur la trajectoire d’accélération de consigne détermine une fonctiona(t)dépendante du tempst. La réception des informations sur les contraintes dynamiques d’accélération constitue des règles évaluables à chaque instant. Cela détermine également un fonctionc(t)dépendante du tempst. Dans le cas de contraintes de décélérations, la fonction c(t) est négative. Prendre le maximum à chaque instanttentre les deux fonctionsa(t)etc(t)détermine simplement une trajectoire d’accélération de consigne prenant en compte les contraintes dynamiques d’accélération, et ainsi une position finale et une vitesse finale sont déterminées.
Avantageusement, la dilatation d’amplitude de la trajectoire d’accélération de consigne est une fonction , et dans lequel la dilatation temporelle de la trajectoire d’accélération de consigne est une fonction ,kaétant une constante d’amplification déterminée,ktétant une constante de modulation temporelle déterminée,a(t)étant une fonction représentant la trajectoire d’accélération de consigne avectune variable représentant temps.
Ainsi, seulement deux constantes sont nécessaires pour adapter la trajectoire d’accélération de consigne. La constante d’amplificationkaamplifie la trajectoire. Par « amplifier », on entend modifier la valeur de la trajectoire d’accélération de consigne, la modification peut augmenter ou diminuer la valeur. Typiquement,kaest une constante proche de 1. La constante de modulation temporellekthâte ou ralenti l’apparition des valeurs de la trajectoire de consigne. Typiquement,ktest une constante proche de 1.
Avantageusement, l’adaptation de la trajectoire d’accélération de consigne déterminée à partir de la dilatation d’amplitude et de la dilatation temporelle de la trajectoire d’accélération de consigne, tout en prenant en compte les contraintes dynamiques d’accélération est une fonction ,a(kt*t)étant la fonction représentant la trajectoire d’accélération de consigne modulée temporellement,c(kt*t)étant la fonction négative représentant les contraintes dynamiques d’accélération modulée temporellement, ettétant la variable représentant temps, etktétant la constante de modulation temporelle.
Ainsi, pour chaque instant, la trajectoire d’accélération de consigne adaptée prenant en compte les contraintes dynamique est calculable en fonction d’une valeur des constanteskaetkt. Une nouvelle position finale et une nouvelle vitesse finale sont déterminées.
Avantageusement, la constante d’amplification,ka, et la constante de modulation temporelle,kt, sont déterminées telles que l’évaluation de l’expression soit le plus petit possible, une position finale adaptée et une vitesse finale adaptée étant calculées à partir de la trajectoire d’accélération consigne adaptée, la valeur absolue de la différence entre la position finale adaptée et la position cible étant inférieure ou égale au seuil de positon prédéterminé et la valeur absolue de la différence entre la vitesse finale adaptée et la vitesse cible étant inférieure ou égale au seuil de vitesse seuil prédéterminé.
Ainsi, l’invention cherche à modifier le moins possible la trajectoire d’accélération de consigne. Le comportement d’accostage du véhicule obtenu avec une trajectoire d’accélération de consigne adaptée est alors très proche du comportement d’accostage voulu sans les contraintes dynamiques d’accélération.
Avantageusement, le procédé comporte en outre une étape de détermination et d’émission d’un signal d’alerte lorsque l’évaluation de l’expression est supérieure à un seuil d’alerte prédéterminé.
Ainsi, le procédé identifie une situation où la trajectoire d’accélération de consigne adaptée devient trop éloignée de la trajectoire d’accélération de consigne. Cette situation indique une situation de danger nécessitant un fort freinage, un changement de voie ou un changement de stratégie dans la régulation de vitesse véhicule. Un signal d’alerte est déterminé puis émis, par exemple, vers le conducteur pour qu’il reprenne le pilotage du véhicule ou vers un autre système ADAS pour engager un freinage d’urgence ou plus fort, ou un changement de voie, ou un changement de stratégie de régulation de vitesse véhicule.
Un deuxième aspect de l’invention concerne un dispositif comprenant une mémoire associée à au moins un processeur configuré pour mettre en œuvre le procédé selon le premier aspect de l’invention.
L’invention concerne aussi un véhicule comportant le dispositif.
L’invention concerne aussi un programme d’ordinateur comprenant des instructions adaptées pour l’exécution des étapes du procédé, selon le premier aspect de l’invention, lorsque ledit programme est exécuté par au moins un processeur.
D’autres caractéristiques et avantages de l’invention ressortiront de la description des modes de réalisation non limitatifs de l’invention ci-après, en référence aux figures annexées, sur lesquelles :
L’invention est décrite ci-après dans son application, non limitative, au cas d’un véhicule automobile autonome circulant sur une route ou sur une voie de circulation. D’autres applications telles qu’un robot dans un entrepôt de stockage ou encore une motocyclette sur une route de campagne sont également envisageables.
La représente un exemple de dispositif 101 compris dans le véhicule, dans un réseau (« cloud ») ou dans un serveur. Ce dispositif 101 peut être utilisé en tant que dispositif centralisé en charge d’au moins certaines étapes du procédé décrit ci-après en référence à la . Dans un mode de réalisation, il correspond à un calculateur de conduite autonome ou à un calculateur.
Dans la présente invention, le dispositif 101 est compris dans le véhicule.
Ce dispositif 101 peut prendre la forme d’un boitier comprenant des circuits imprimés, de tout type d’ordinateur ou encore d’un téléphone mobile (« smartphone »).
Le dispositif 101 comprend une mémoire vive 102 pour stocker des instructions pour la mise en œuvre par un processeur 103 d’au moins une étape du procédé tel que décrit ci-avant. Le dispositif comporte aussi une mémoire de masse 104 pour le stockage de données destinées à être conservées après la mise en œuvre du procédé.
Le dispositif 101 peut en outre comporter un processeur de signal numérique (DSP) 105. Ce DSP 105 reçoit des données pour mettre en forme, démoduler et amplifier, de façon connue en soi ces données.
Le dispositif 101 comporte également une interface d’entrée 106 pour la réception des données mises en œuvre par le procédé selon l’invention et une interface de sortie 107 pour la transmission des données mises en œuvre par le procédé selon l’invention.
L’axe 201 est un axe des abscisses représentant un temps. Un tempst=0indique un début d’une trajectoire d’accélération de consigne représentée par la courbe en tirets 203, et un début d’une trajectoire d’accélération de consigne adaptée représentée par le courbe en gras 206.
L’axe 202 est un axe des ordonnées représentant une accélération. Deux accélérations sont représentées : une première à -3,5 m/s², une seconde à -5 m/s².
La courbe en pointillés 204 est une représentation des contraintes dynamiques d’accélération. Par exemple, une contrainte d’accélération dynamique est de ne pas avoir une accélération inférieure à -3,5 m/s² si la vitesse est supérieure à 70 km/h, ne pas avoir une accélération inférieure à -5 m /s² si la vitesse est inférieure à 30 km/h, et, si la vitesse est entre 30 km/h et 70 km/h, ne pas avoir une accélération inférieure à un seuil qui varie linéairement en fonction de la vitesse et des deux seuils précédant. Ici, la vitesse du véhicule n’est pas représentée, mais clairement celle-ci diminue en fonction de la régulation de vitesse.
Sur l’axe 201,tfreprésente un temps final au bout duquel, si le régulateur de vitesse adaptatif applique la trajectoire d’accélération de consigne sans les contraintes dynamiques d’accélération, le véhicule atteint une vitesse cible et une position cible.
La courbe en trait continu mince 205 représente une trajectoire d’accélération de consigne adaptée sans prendre en compte les contraintes dynamiques d’accélération. La courbe 203 a subi une dilatation d’amplitude : dans cet exemple, la courbe 205 à des valeurs plus élevées. La courbe 203 a également subi une dilatation temporelle : dans cet exemple, les valeurs de la courbe 203 amplifiée arrivent plus tôt.
La courbe en trait continu et gras 206 représente la trajectoire d’accélération de consigne prenant en compte les contraintes dynamiques d’accélération 204, les contraintes dynamiques d’accélération étant déterminées à chaque instanttà partir de l’historique de la courbe 205 entre l’instant 0 et l’instantt.
L’instanttf’représente un temps final au bout duquel, si le régulateur de vitesse adaptatif applique la trajectoire d’accélération de consigne adaptée qui prend en compte les contraintes dynamiques d’accélération, le véhicule a atteint une valeur proche de la vitesse cible et de la position cible.
L’étape 301, « Recep », est une étape de réception par le calculateur 101 d’informations sur la trajectoire d’accélération de consigne, sur la position cible, sur la vitesse cible et sur les contraintes dynamiques d’accélération.
Par exemple, lorsque le régulateur de vitesse adaptatif maintient le véhicule autonome à une vitesse constante et qu’un véhicule, dit véhicule précédant, s’insère dans la voie devant ledit véhicule autonome, la vitesse de régulation doit s’adapter. L’adaptation concerne la vitesse du véhicule autonome et la distance, ou le temps inter-véhiculaire l’un et l’autre étant reliés par la vitesse du véhicule autonome. Un véhicule autonome, comprenant classiquement un dispositif de régulation de vitesse adaptatif, comprend également de nombreux capteurs et calculateurs aptes à :
- Déterminer une trajectoire d’accélération de consigne, ladite trajectoire étant utilisé par le régulateur de vitesse adaptatif afin que le véhicule autonome atteigne une position cible (ou temps inter-véhiculaire cible) à une vitesse cible. En particulier, la trajectoire est déterminée afin que le régulateur de vitesse adaptatif fait accoster le véhicule autonome au véhicule précédant ;
- Contenir des contraintes d’accélérations dynamiques.
Le calculateur 101 ou un calculateur du régulateur de vitesse adaptatif reçoit alors des informations des informations sur la trajectoire d’accélération de consigne, sur la position cible, sur la vitesse cible et sur les contraintes dynamiques d’accélération.
Dans un mode opératoire, des informations sur la trajectoire d’accélération de consigne sont des paramètres d’un modèle modélisant le déplacement du véhicule autonome en fonction du temps. Par exemple, ce modèle est un polynôme d’ordre 5, et les paramètres sont identifiées à partir de conditions initiales (distance initiale, vitesse initiale, accélération initiale, …) ou/et de conditions cibles (distance/position cible, vitesse cible, accélération cible, …).
Dans un mode opératoire, la vitesse cible est une vitesse du véhicule précédant ou une extrapolation de la vitesse du véhicule précédant si plusieurs mesures ont pu être effectuées. La position cible est une distance correspondante à un temps inter-véhicule cible par rapport à une position du véhicule précédant estimé à un instant cible, l’instant cible étant déterminé par une durée de la trajectoire d’accélération de consigne.
Dans un mode opératoire, les contraintes dynamiques sont des règles de type : -3,5 m/s² si la vitesse est supérieure à 70 km/h, -5 m /s² si la vitesse est inférieure à 30 km/h, et, si la vitesse est comprise entre 30 km/h et 70 km/h, une accélération qui varie linéairement en fonction de la vitesse et des seuils -3,5 m/s² et 5 m/s². Par exemple, ces règles sont insérées dans des tableaux.
L’étape 302, « Estim », est une étape d’estimation d’une position finale et d’une vitesse finale du véhicule autonome à partir de la trajectoire d’accélération de consigne en prenant en compte les contraintes dynamiques d’accélération.
Dans un mode opératoire, une trajectoire d’accélération de consigne prenant en compte les contraintes dynamiques d’accélération est représentée par une fonction ,a(t)étant une fonction représentant la trajectoire d’accélération de consigne,c(t)étant une fonction négative représentant les contraintes dynamiques d’accélération, ettétant une variable représentant temps.
Par exemple, les informations sur la trajectoire d’accélération de consigne sont des paramètres d’un modèle modélisant le déplacement du véhicule autonome en fonction du temps, et les contraintes dynamiques d’accélération sont des décélérations à ne pas dépasser en fonction de la vitesse du véhicule. Par intégrations successives, connaissant les conditions initiales, la position, la vitesse et l’accélération sont déterminées à chaque instant. A titre d’illustration, avec un pas de temps de 1 seconde, si à un instant donné la vitesse du véhicule est de 20 m/s, si à cet instant donné la trajectoire d’accélération de consigne donne une accélération de -2 m/s², si une contrainte dynamique d’accélération est de -1 m/s pour une vitesse supérieure à 10 m/s², alors au bout d’une seconde la vitesse du véhicule serra de 19 m/s (au lieu de 18 m/s² sans la contrainte). Lorsque des contraintes ne sont pas respectées, l’accélération du véhicule n’est pas celle souhaitée. Il en va de même pour la vitesse et la position du véhicule.
L’étape 303, « Test », est une étape de tests qui vérifie si l’écart entre la position finale et la position cible est supérieur à un seuil de positon prédéterminé, ou si l’écart entre la vitesse finale et la vitesse cible est supérieur à un seuil de vitesse seuil prédéterminé.
Dans un mode opératoire le seuil de position est d’environ 0,5 mètres, et le seuil de vitesse est d’environ de 0,05 m/s. Dans l’affirmatif, donc en présence d’écarts trop grands, le comportement dynamique du véhicule n’est pas celle souhaitée, et le comportement d’accostage ne sera celle souhaitée. Le procédé va à l’étape 304. Dans le cas contraire, le procédé retourne à l’étape 301.
L’étape 304, « Adapt », est une étape où une adaptation de la trajectoire d’accélération de consigne est déterminée à partir d’une dilatation d’amplitude et d’une dilatation temporelle de la trajectoire d’accélération de consigne, tout en prenant en compte les contraintes dynamiques d’accélération.
Dans un mode opératoire la dilatation d’amplitude de la trajectoire d’accélération de consigne est une fonction , et dans lequel la dilatation temporelle de la trajectoire d’accélération de consigne est une fonction ,kaétant une constante d’amplification déterminée,ktétant une constante de modulation temporelle déterminée,a(t)étant une fonction représentant la trajectoire d’accélération de consigne avectune variable représentant temps. Par exemple, sia(t)est un polynôme fonction du temps, il est simple d’évaluer l’accélération à chaque instantt, il est simple de multiplier cette évaluation par une constantekaqui dilate l’amplitude : sia(t=1 s)=-3 m/s²etka=1,1, alorska*a(t=1 s)=-3,3 m/s². Puisqu’il est possible d’évaluer l’accélération à chaque instantt, il est également possible d’évaluer l’accélération à un instant kt*t, kt étant une constante de modulation temporelle : sia(t=0,9 s)=--2,8 m/s², et sikt=0,9, alors on peut définir una’(t=1 s)telle quea’(1)=a(kt*1=0,9*1=0,9)=-2,8 m/s².
Dans un mode de réalisation, l’adaptation de la trajectoire d’accélération de consigne déterminée à partir de la dilatation d’amplitude et de la dilatation temporelle de la trajectoire d’accélération de consigne, tout en prenant en compte les contraintes dynamiques d’accélération est une fonction ,a(kt*t)étant la fonction représentant la trajectoire d’accélération de consigne modulée temporellement,c(kt*t)étant la fonction négative représentant les contraintes dynamiques d’accélération modulée temporellement, ettétant la variable représentant temps, etktétant la constante de modulation temporelle. Si la trajectoire d’accélération de consigne est modélisée par une fonctiona(t), alorsa’(t)modélise l’adaptation de la trajectoire d’accélération de consigne.
Dans un mode opératoire, la constante d’amplification,ka, et la constante de modulation temporelle,kt, sont déterminées telles que l’évaluation de l’expression soit le plus petit possible, une position finale adaptée et une vitesse finale adaptée étant calculées à partir de la trajectoire d’accélération consigne adaptée, la valeur absolue de la différence entre la position finale adaptée et la position cible étant inférieure ou égale au seuil de positon prédéterminé et la valeur absolue de la différence entre la vitesse finale adaptée et la vitesse cible étant inférieure ou égale au seuil de vitesse seuil prédéterminé. De la même manière que dans l’étape 302, ayant un modèle de l’adaptation de la trajectoire d’accélération de consigne par intégration successives à chaque pas de temps, une position finale adaptée et vitesse finale adaptée sont calculées. Différentes méthodes classiques existent pour résoudre ce problème d’optimisation : test d’un jeu de valeurs pourkaetkt, itérations successives, dichotomie, double boucle …
Avantageusement, le procédé selon l’invention comprend en outre une étape de détermination et d’émission d’un signal d’alerte lorsque l’évaluation de l’expression est supérieure à un seuil d’alerte prédéterminé. En effet, construire l’adaptation de la trajectoire d’accélération de consigne permet de savoir exactement quelles sont les limites du système. Lorsque les contraintes sont trop fortes, par exemple avoir unssupérieur à 0,2, l’invention trouve la moins pire des trajectoires, et ensuite détermine et émet un signal d’alerte. Dans un mode opératoire, une nouvelle trajectoire d’accélération de consigne est déterminée par l’ACC mais avec un temps inter-véhiculaire plus faible que celui souhaitée.
La présente invention ne se limite pas aux formes de réalisation décrites ci-avant à titre d’exemples ; elle s’étend à d’autres variantes.
La prise en compte de contraintes dynamiques d’accélération ont été détaillée. L’invention n’est pas limitée aux seules contraintes dynamiques d‘accélération, et s’étend à tout type d’autre forme de contraintes dynamiques comme des contraintes dynamiques sur la vitesse, des contraintes dynamiques sur le jerk, des contraintes dynamiques sur le jerk en fonction d’une vitesse instantanée du véhicule …
Des équations et calculs ont en outre été détaillés. L’invention n’est pas limitée à la forme de ces équations et calcul, et s’étend à tout type d’autre forme mathématiquement équivalente.
Claims (10)
- Procédé d’adaptation d’une trajectoire d’accélération de consigne d’un régulateur de vitesse véhicule adaptatif d’un véhicule autonome, pour que ledit véhicule autonome atteigne une position cible à une vitesse cible tout en respectant des contraintes dynamiques d’accélération, ledit véhicule autonome comprenant un calculateur (101), ledit procédé comportant les étapes de :
- Réception (301) par le calculateur (101) d’informations sur la trajectoire d’accélération de consigne, sur la position cible, sur la vitesse cible et sur les contraintes dynamiques d’accélération ;
- Estimation (302) d’une position finale et d’une vitesse finale du véhicule autonome à partir de la trajectoire d’accélération de consigne en prenant en compte les contraintes dynamiques d’accélération ;
- Si (303) l’écart entre la position finale et la position cible est supérieur à un seuil de position prédéterminé, ou si (303) l’écart entre la vitesse finale et la vitesse cible est supérieur à un seuil de vitesse prédéterminé, alors une adaptation (304) de la trajectoire d’accélération de consigne est déterminée à partir d’une dilatation d’amplitude et d’une dilatation temporelle de la trajectoire d’accélération de consigne, tout en prenant en compte les contraintes dynamiques d’accélération.
- Procédé selon la revendication 1, dans lequel le procédé comporte en outre une étape préalable de détermination d’une nouvelle trajectoire d’accélération de consigne par le régulateur de vitesse adaptatif, ledit régulateur de vitesse adaptatif ayant réceptionné une nouvelle vitesse de consigne, ladite nouvelle trajectoire d’accélération de consigne définissant une nouvelle vitesse cible et une nouvelle position cible.
- Procédé selon l’une des revendications précédentes, dans lequel une trajectoire d’accélération de consigne prenant en compte les contraintes dynamiques d’accélération est représentée par une fonction
- Procédé selon l’une des revendications précédentes, dans lequel la dilatation d’amplitude de la trajectoire d’accélération de consigne est une fonction
- Procédé selon la revendication 4, dans lequel l’adaptation (304) de la trajectoire d’accélération de consigne déterminée à partir de la dilatation d’amplitude et de la dilatation temporelle de la trajectoire d’accélération de consigne, tout en prenant en compte les contraintes dynamiques d’accélération est une fonction
- Procédé selon l’une des revendications 4 ou 5, dans lequel la constante d’amplification,ka, et la constante de modulation temporelle,kt, sont déterminées telles que l’évaluation d’une expression
- Procédé selon la revendication 6, dans lequel le procédé comporte en outre une étape de détermination et d’émission d’un signal d’alerte lorsque l’évaluation de l’expression est supérieure à un seuil d’alerte prédéterminé.
- Dispositif (101) comprenant une mémoire (102) associée à au moins un processeur (103) configuré pour mettre en œuvre le procédé selon l’une des revendications précédentes.
- Véhicule comportant le dispositif selon la revendication précédente.
- Programme d’ordinateur comprenant des instructions adaptées pour l’exécution des étapes du procédé selon l’une des revendications 1 à 7 lorsque ledit programme est exécuté par au moins un processeur (103).
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR2012390A FR3116782B1 (fr) | 2020-11-30 | 2020-11-30 | Procédé et dispositif d’adaptation d’une trajectoire d’accélération de consigne d’un régulateur de vitesse véhicule adaptatif d’un véhicule autonome. |
EP21816125.5A EP4251487A1 (fr) | 2020-11-30 | 2021-10-27 | Procédé et dispositif d'adaptation d'une trajectoire d'accélération de consigne d'un régulateur de vitesse véhicule adaptatif d'un véhicule autonome |
PCT/FR2021/051888 WO2022112677A1 (fr) | 2020-11-30 | 2021-10-27 | Procédé et dispositif d'adaptation d'une trajectoire d'accélération de consigne d'un régulateur de vitesse véhicule adaptatif d'un véhicule autonome |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR2012390A FR3116782B1 (fr) | 2020-11-30 | 2020-11-30 | Procédé et dispositif d’adaptation d’une trajectoire d’accélération de consigne d’un régulateur de vitesse véhicule adaptatif d’un véhicule autonome. |
FR2012390 | 2020-11-30 |
Publications (2)
Publication Number | Publication Date |
---|---|
FR3116782A1 true FR3116782A1 (fr) | 2022-06-03 |
FR3116782B1 FR3116782B1 (fr) | 2022-11-04 |
Family
ID=75746716
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
FR2012390A Active FR3116782B1 (fr) | 2020-11-30 | 2020-11-30 | Procédé et dispositif d’adaptation d’une trajectoire d’accélération de consigne d’un régulateur de vitesse véhicule adaptatif d’un véhicule autonome. |
Country Status (3)
Country | Link |
---|---|
EP (1) | EP4251487A1 (fr) |
FR (1) | FR3116782B1 (fr) |
WO (1) | WO2022112677A1 (fr) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116880498A (zh) * | 2023-07-31 | 2023-10-13 | 大陆软件系统开发中心(重庆)有限公司 | 驾驶轨迹生成方法、装置、系统、电子设备及存储介质 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102019201800A1 (de) * | 2019-02-12 | 2020-08-13 | Continental Automotive Gmbh | Verfahren zur Trajektorienplanung eines Assistenzsystems |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
ES368794A1 (es) | 1968-07-05 | 1971-07-16 | Belgonucleaire Sa | Metodo de lubrificacion de una prensa de compactacion. |
-
2020
- 2020-11-30 FR FR2012390A patent/FR3116782B1/fr active Active
-
2021
- 2021-10-27 WO PCT/FR2021/051888 patent/WO2022112677A1/fr unknown
- 2021-10-27 EP EP21816125.5A patent/EP4251487A1/fr active Pending
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102019201800A1 (de) * | 2019-02-12 | 2020-08-13 | Continental Automotive Gmbh | Verfahren zur Trajektorienplanung eines Assistenzsystems |
Non-Patent Citations (2)
Title |
---|
HONGYU ZHENG ET AL: "Investigation of a Longitudinal and Lateral Lane-Changing Motion Planning Model for Intelligent Vehicles in Dynamical Driving Environments", IEEE ACCESS, vol. 7, 1 January 2019 (2019-01-01), pages 44783 - 44802, XP055766181, DOI: 10.1109/ACCESS.2019.2909273 * |
MORITZ WERLING ET AL: "Optimal trajectory generation for dynamic street scenarios in a Frenét Frame", 2010 IEEE INTERNATIONAL CONFERENCE ON ROBOTICS AND AUTOMATION : ICRA 2010 ; ANCHORAGE, ALASKA, USA, 3 - 8 MAY 2010, IEEE, PISCATAWAY, NJ, USA, 3 May 2010 (2010-05-03), pages 987 - 993, XP031743734, ISBN: 978-1-4244-5038-1 * |
Also Published As
Publication number | Publication date |
---|---|
WO2022112677A1 (fr) | 2022-06-02 |
EP4251487A1 (fr) | 2023-10-04 |
FR3116782B1 (fr) | 2022-11-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
FR2957885A1 (fr) | Procede et dispositif de commande de la vitesse longitudinale d'un vehicule automobile | |
FR3089925A1 (fr) | Conduite autonome sécurisée dans le cas d’une détection d’un objet cible | |
WO2022112677A1 (fr) | Procédé et dispositif d'adaptation d'une trajectoire d'accélération de consigne d'un régulateur de vitesse véhicule adaptatif d'un véhicule autonome | |
FR3101044A1 (fr) | Procédé d’aide à la conduite avec détermination d’une distance de sécurité multi-cibles. | |
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 | |
FR3087732A1 (fr) | Procede et dispositif de determination d’un changement de voie d’un vehicule | |
WO2024084140A1 (fr) | Procédé et dispositif de limitation d'une vitesse de consigne d'un régulateur de vitesse adaptatif d'un véhicule autonome | |
EP4232333B1 (fr) | Procédé et dispositif de typage du mode de conduite d'un véhicule autonome | |
EP4240629A1 (fr) | Procédé et dispositif de détermination d'un temps de manoeuvre d'un véhicule autonome | |
EP4077087B1 (fr) | Système et procédé de contrôle de véhicule avec compensation de retard temporel de capteurs | |
EP4107043B1 (fr) | Procédé et système pour gérer le fonctionnement d'un régulateur de vitesse adaptatif d'un véhicule automobile en tenant compte du comportement de deux véhicules précédents | |
EP4263307A1 (fr) | Procédé et dispositif de régulation de vitesse d'un véhicule autonome | |
EP4277821A1 (fr) | Procédé et dispositif de contrôle d'accélération d'un véhicule | |
WO2023161570A1 (fr) | Procédé et dispositif de pilotage d'une vitesse d'un véhicule autonome | |
WO2023089258A1 (fr) | Procédé de régulation de vitesse d'un véhicule à partir d'un objet cible | |
FR3132264A1 (fr) | Procédé et dispositif de pilotage d’une vitesse d’un véhicule autonome | |
WO2022058666A1 (fr) | Procédé et dispositif de conduite autonome d'un véhicule terrestre à moteur | |
WO2024134047A1 (fr) | Procédé et dispositif de contrôle d'un système de régulation de vitesse adaptatif d'un véhicule autonome par un mode corridor | |
EP4217245A1 (fr) | Procédé et dispositif de conduite autonome d'un véhicule terrestre à moteur, appelé égo-véhicule, par régulation de vitesse adaptative fondée sur une accélération consigne | |
WO2023222960A1 (fr) | Procédé et dispositif de contrôle d'un système de régulation de vitesse d'un véhicule en approche d'un élément de signalisation routière | |
WO2022152983A1 (fr) | Procédé et dispositif de contrôle d'accélération d'un véhicule | |
FR3117976A1 (fr) | Dispositif de contrôle longitudinal pour véhicule | |
WO2023067258A1 (fr) | Procédé et système pour gérer le fonctionnement d'un régulateur de vitesse adaptatif d'un premier véhicule automobile selon la stabilité latérale d'un deuxième véhicule automobile précédent | |
FR3119143A1 (fr) | Procédé et système de contrôle d’un véhicule | |
FR3117078A1 (fr) | Procédé et dispositif de changement de consigne d’accélération longitudinale d’un dispositif de changement de voie autonome d’un véhicule autonome. |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PLFP | Fee payment |
Year of fee payment: 2 |
|
PLSC | Publication of the preliminary search report |
Effective date: 20220603 |
|
PLFP | Fee payment |
Year of fee payment: 3 |
|
PLFP | Fee payment |
Year of fee payment: 4 |
|
CD | Change of name or company name |
Owner name: STELLANTIS AUTO SAS, FR Effective date: 20240423 |