FR3123863A1 - Procédé de gestion de la vitesse longitudinale d’un véhicule automobile. - Google Patents
Procédé de gestion de la vitesse longitudinale d’un véhicule automobile. Download PDFInfo
- Publication number
- FR3123863A1 FR3123863A1 FR2106331A FR2106331A FR3123863A1 FR 3123863 A1 FR3123863 A1 FR 3123863A1 FR 2106331 A FR2106331 A FR 2106331A FR 2106331 A FR2106331 A FR 2106331A FR 3123863 A1 FR3123863 A1 FR 3123863A1
- Authority
- FR
- France
- Prior art keywords
- speed
- setpoint
- speed setpoint
- vehicle
- motor vehicle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 25
- 230000008569 process Effects 0.000 title abstract description 3
- 230000008859 change Effects 0.000 claims abstract description 64
- 238000001514 detection method Methods 0.000 claims abstract description 20
- 230000001133 acceleration Effects 0.000 claims description 42
- 238000007726 management method Methods 0.000 claims description 14
- 238000004364 calculation method Methods 0.000 claims description 9
- 238000004590 computer program Methods 0.000 claims description 6
- 238000012986 modification Methods 0.000 claims description 4
- 230000004048 modification Effects 0.000 claims description 4
- 238000012937 correction Methods 0.000 description 15
- 230000036461 convulsion Effects 0.000 description 11
- 230000006870 function Effects 0.000 description 7
- 230000001276 controlling effect Effects 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 230000009467 reduction Effects 0.000 description 4
- 101000701142 Homo sapiens Transcription factor ATOH1 Proteins 0.000 description 3
- 102100029373 Transcription factor ATOH1 Human genes 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000003780 insertion Methods 0.000 description 3
- 230000037431 insertion Effects 0.000 description 3
- 230000002123 temporal effect Effects 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 238000011144 upstream manufacturing Methods 0.000 description 2
- 101000582320 Homo sapiens Neurogenic differentiation factor 6 Proteins 0.000 description 1
- 102100030589 Neurogenic differentiation factor 6 Human genes 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000001939 inductive effect Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 238000000926 separation method Methods 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/143—Speed control
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2555/00—Input parameters relating to exterior conditions, not covered by groups B60W2552/00, B60W2554/00
- B60W2555/60—Traffic rules, e.g. speed limits or right of way
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2556/00—Input parameters relating to data
- B60W2556/45—External transmission of data to or from the vehicle
- B60W2556/50—External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Procédé de gestion de la vitesse longitudinale d’un véhicule automobile. Procédé de gestion de la vitesse longitudinale d’un véhicule automobile (100), le véhicule automobile circulant selon une trajectoire planifiée (T), le véhicule automobile étant équipé d’au moins un moyen de détection (1) de l'environnement du véhicule et d’un moyen d’odométrie (2), caractérisé en ce qu’il comprend une étape (E1) de détection, à partir des données issues de l’au moins un moyen de détection (1), d’un point de changement de vitesse (P), situé sur la trajectoire donnée (T) et à l’avant du véhicule automobile, et de détermination d’une vitesse limite (VL) applicable au point de changement de vitesse (P). Figure pour l’abrégé : 3
Description
L’invention concerne un procédé gestion de la vitesse longitudinale d’un véhicule automobile. L’invention porte encore sur un dispositif de gestion de la vitesse longitudinale d’un véhicule automobile. L’invention porte également sur un programme d’ordinateur mettant en œuvre le procédé mentionné. L’invention porte enfin sur un support d’enregistrement sur lequel est enregistré un tel programme.
Des systèmes de gestion automatisée de la vitesse sont couramment installés sur les véhicules actuels, et sont en cours d’évolution pour intégrer de nouvelles fonctionnalités.
Une évolution porte sur la gestion automatisée d’un changement de vitesse à une position précise, par exemple l’arrêt du véhicule automobile au niveau d’un panneau routier, tel qu’un panneau stop, ou au niveau d’un feu tricolore. Cette fonctionnalité nécessite de suivre précisément l’évolution temporelle de la position du véhicule relativement à la position de changement de vitesse, par exemple relativement à la position du panneau routier. De plus, cette fonctionnalité doit mettre en œuvre un profil de vitesse respectant des critères de confort de conduite portant notamment sur l’application de seuils maximaux d’accélération et de jerk.
On connaît du document FR1913267 un procédé permettant d’obtenir un asservissement de position longitudinale du véhicule par rapport au temps, permettant ainsi d’asservir l’instant de passage du véhicule à un endroit précis de la route. Toutefois cette solution présente des inconvénients. Notamment, elle ne permet de garantir le respect de critères de confort de conduite portant sur l’application de seuils maximaux d’accélération et de jerk. Lorsque le véhicule est supposé s'arrêter à un endroit précis, on constate avec les systèmes existants que le positionnement du véhicule n'est pas toujours correct. Par exemple, le véhicule peut s'arrêter trop en amont d'une ligne d'arrêt et devoir ré-accélérer ou interrompre son freinage pour atteindre cette ligne d'arrêt. Au contraire, le véhicule peut générer un freinage brusque et désagréable pour les passagers si une ligne d'arrêt est sur le point d'être franchie.
On connaît par ailleurs du document US8924049B2 un procédé définissant un profil de vitesse en fonction de différents paramètres du trajet, parmi lesquels une vitesse limite associée à chacun des tronçons du trajet. Ce procédé permet de réguler la vitesse du véhicule relativement à une limite de vitesse déterminée par sa position. Toutefois, cette solution présente également des inconvénients, notamment sa précision et sa fiabilité peuvent être améliorées.
Le but de l’invention est de fournir un procédé de gestion de la vitesse longitudinale d’un véhicule automobile remédiant aux inconvénients ci-dessus et améliorant les procédés de gestion de la vitesse longitudinale d’un véhicule automobile connus de l’art antérieur. En particulier, l’invention permet de réaliser un procédé qui soit simple et fiable et qui permette la mise en œuvre d’un profil de vitesse confortable et l’application d’un changement de vitesse à une position précise.
A cet effet, l’invention porte sur un procédé de gestion de la vitesse longitudinale d’un véhicule automobile, le véhicule automobile circulant selon une trajectoire planifiée, le véhicule automobile étant équipé d’au moins un moyen de détection de l'environnement du véhicule et d’un moyen d’odométrie.
Le procédé comprend les étapes suivantes :
- une étape de détection, à partir des données issues de l’au moins un moyen de détection, d’un point de changement de vitesse, situé sur la trajectoire donnée et à l’avant du véhicule automobile, et de détermination d’une vitesse limite applicable au point de changement de vitesse, puis
- une deuxième étape de calcul d’une première consigne de vitesse du véhicule automobile, en fonction de la vitesse limite et d’une première distance séparant le véhicule automobile du point de changement de vitesse, la première distance étant calculée en fonction d’un profil de vitesse planifié, la première distance présentant une marge d’erreur en distance par rapport à une deuxième distance déterminée par le moyen d’odométrie entre le véhicule automobile et le point de changement de vitesse, puis
- une troisième étape comprenant une détermination d’une deuxième consigne de vitesse qui compense la marge d’erreur en distance générée dans la deuxième étape et qui anticipe un retard de phase généré dans une quatrième étape de commande du déplacement du véhicule automobile, puis
- une quatrième étape de commande du déplacement du véhicule automobile selon la deuxième consigne de vitesse pour atteindre le point de changement de vitesse avec une vitesse égale à la vitesse limite, la quatrième étape générant le retard de phase entre la réception de la deuxième consigne de vitesse et le déplacement du véhicule selon la deuxième consigne de vitesse.
- une étape de détection, à partir des données issues de l’au moins un moyen de détection, d’un point de changement de vitesse, situé sur la trajectoire donnée et à l’avant du véhicule automobile, et de détermination d’une vitesse limite applicable au point de changement de vitesse, puis
- une deuxième étape de calcul d’une première consigne de vitesse du véhicule automobile, en fonction de la vitesse limite et d’une première distance séparant le véhicule automobile du point de changement de vitesse, la première distance étant calculée en fonction d’un profil de vitesse planifié, la première distance présentant une marge d’erreur en distance par rapport à une deuxième distance déterminée par le moyen d’odométrie entre le véhicule automobile et le point de changement de vitesse, puis
- une troisième étape comprenant une détermination d’une deuxième consigne de vitesse qui compense la marge d’erreur en distance générée dans la deuxième étape et qui anticipe un retard de phase généré dans une quatrième étape de commande du déplacement du véhicule automobile, puis
- une quatrième étape de commande du déplacement du véhicule automobile selon la deuxième consigne de vitesse pour atteindre le point de changement de vitesse avec une vitesse égale à la vitesse limite, la quatrième étape générant le retard de phase entre la réception de la deuxième consigne de vitesse et le déplacement du véhicule selon la deuxième consigne de vitesse.
Le véhicule automobile peut être équipé d’un moyen de mesure de la vitesse instantanée du véhicule, et la quatrième étape peut comprendre la détermination d’une consigne d’accélération du véhicule automobile comme étant la somme d’une première et d’une deuxième composante d’accélération.
La première composante d’accélération peut être calculée par l’application d’un filtre dérivateur du premier degré à la deuxième consigne de vitesse.
La deuxième composante d’accélération peut être obtenue par application d’un premier régulateur proportionnel de gain à la différence entre une vitesse instantanée du véhicule déterminée par le moyen de mesure de la vitesse et une consigne de vitesse filtrée.
La consigne de vitesse filtrée peut être obtenue par l’application successive d’un premier et d’un deuxième filtre du premier ordre à la deuxième consigne de vitesse.
Le premier filtre peut appliquer un retard de phase à la deuxième consigne de vitesse de sorte à synchroniser la deuxième consigne de vitesse avec la première composante d’accélération, et le deuxième filtre peut être paramétré de sorte que la consigne de vitesse filtrée converge vers une valeur stable.
La deuxième consigne de vitesse est la somme d’une première et d’une deuxième composante de vitesse.
La première composante de vitesse peut être obtenue par application d’un premier et d’un deuxième filtre à avance de phase à la première consigne de vitesse, et la deuxième composante de vitesse peut être obtenue par application d’un deuxième régulateur proportionnel comprenant un gain donné à la marge d’erreur en distance, le gain donné étant réglé pour que la deuxième composante de vitesse converge vers une valeur stable.
La même constante de temps peut être utilisée pour définir le premier filtre à avance de phase appliqué pour le calcul de la deuxième consigne de vitesse, le filtre dérivateur du premier degré et le premier filtre à retard de phase appliqués pour le calcul de la consigne d’accélération.
La même constante de temps peut être utilisée pour définir le deuxième filtre à avance de phase appliqué pour le calcul de la deuxième consigne de vitesse, ainsi que le deuxième filtre à retard de phase appliqué pour le calcul de la consigne d’accélération.
Le véhicule peut comprendre une interface homme machine permettant à un usager de définir une quatrième consigne de vitesse et la troisième étape peut comprendre une modification de la deuxième consigne de vitesse comme étant le minimum entre la deuxième consigne de vitesse et la quatrième consigne de vitesse.
Le véhicule peut comprendre un module de suivi de cible déterminant une troisième consigne de vitesse et la troisième étape peut comprendre une modification de la deuxième consigne de vitesse comme étant le minimum entre la deuxième consigne de vitesse, la troisième consigne de vitesse et la quatrième consigne de vitesse.
La vitesse limite peut être nulle.
L’invention porte en outre sur un dispositif de gestion de la vitesse longitudinale d’un véhicule automobile, le véhicule étant équipé d’un contrôleur de couple.
L’invention porte également sur un produit programme d’ordinateur comprenant des instructions de code de programme enregistrées sur un support lisible par ordinateur pour mettre en œuvre les étapes du procédé tel que défini précédemment lorsque ledit programme fonctionne sur un ordinateur. L’invention porte également sur un produit programme d’ordinateur téléchargeable depuis un réseau de communication et/ou enregistré sur un support de données lisible par un ordinateur et/ou exécutable par un ordinateur, comprenant des instructions qui, lorsque le programme est exécuté par l’ordinateur, conduisent celui-ci à mettre en œuvre le procédé tel que défini précédemment.
L’invention porte encore sur un support d’enregistrement de données, lisible par un ordinateur, sur lequel est enregistré un programme d’ordinateur comprenant des instructions de code de programme de mise en œuvre du procédé tel que défini précédemment. L’invention porte encore sur un support d'enregistrement lisible par ordinateur comprenant des instructions qui, lorsqu'elles sont exécutées par un ordinateur, conduisent celui-ci à mettre en œuvre le procédé tel que défini précédemment.
L’invention porte encore sur un signal d'un support de données, portant le produit programme d'ordinateur tel que défini précédemment.
Le dessin annexé représente, à titre d’exemple, un mode de réalisation d’un dispositif de gestion de la vitesse longitudinale d’un véhicule automobile selon l’invention et un mode d’exécution d’un procédé de gestion de la vitesse longitudinale d’un véhicule automobile selon l’invention.
Un exemple d’un véhicule automobile 100 équipé d’un mode de réalisation d’un dispositif de gestion de la vitesse longitudinale d’un véhicule autonome est décrit ci-après en référence à la .
Le véhicule automobile 100 peut être un véhicule automobile de n’importe quel type, notamment un véhicule de tourisme, un véhicule utilitaire, un camion ou encore un véhicule de transport en commun tel qu’un bus ou une navette. Selon le mode de réalisation décrit, le véhicule automobile 100 est un véhicule autonome et sera désigné "véhicule autonome" dans la suite de la description.
Cette illustration est donc faite à titre non limitatif. Notamment le véhicule automobile pourrait être un véhicule non autonome, équipé d’un système d'aide à la conduite, notamment un système d'aide à la conduite correspondant à un niveau supérieur ou égal au niveau 2 d’autonomie., c’est-à-dire correspondant à une autonomie partielle du véhicule.
On suppose que le véhicule autonome 100 se déplace sur une trajectoire planifiée T passant par un point de changement de vitesse P situé à l’avant du véhicule autonome.
Dans la suite du document, le terme « point de changement de vitesse » est utilisé pour désigner un élément de l’infrastructure routière déterminant une vitesse limite à la position de cet élément d’infrastructure routière, ou à partir de la position de cet élément d’infrastructure routière. Selon le type de point de changement de vitesse, la vitesse limite peut être une vitesse maximale. C’est le cas, par exemple, si le point de changement de vitesse est une signalétique de limitation de vitesse, ou une signalétique de céder le passage.
Le point de changement de vitesse peut également être un panneau signalétique (par exemple un panneau stop) ou un feu tricolore pouvant commander l’arrêt du véhicule autonome au point de changement de vitesse.
S’il existe plusieurs panneaux signalétiques ou feux sur l’itinéraire considéré, le point de changement de vitesse est celui que le véhicule autonome atteindra en premier.
Le dispositif de gestion de la vitesse longitudinale concerne plus particulièrement des points de changement de vitesse qui impliquent une réduction de la vitesse, voire un arrêt du véhicule autonome. En effet, dans le cas d’un point de changement de vitesse impliquant une réduction de la vitesse ou plus particulièrement un arrêt, le respect de la position du point de changement de vitesse peut être primordial. Dans un mode de réalisation, le dispositif de gestion de la vitesse longitudinale pourrait prendre en compte uniquement des points de changement de vitesse impliquant un arrêt du véhicule autonome, ou une réduction de la vitesse en dessous d’un seuil donné.
Le terme « position de changement de vitesse » désigne la position du point de changement de vitesse.
Le véhicule autonome 100 comprend un système de gestion 10 et un contrôleur de couple 7. Le contrôleur de couple 7 reçoit des consignes d’accélération générées par le système de gestion 10. Afin de mettre en œuvre un déplacement longitudinal du véhicule autonome 100, le contrôleur de couple 7 transforme chaque consigne d’accélération en une première consigne de couple destinée à un groupe motopropulseur du véhicule et/ou une deuxième consigne de couple destinée à un actionneur de freins du véhicule.
Le système de gestion 10 comprend principalement les éléments suivants :
- au moins un moyen de détection 1,
- un moyen d’odométrie 2,
- un moyen de mesure de la vitesse instantanée du véhicule autonome 3, ou capteur de vitesse 3,
- un module de suivi de cible 4,
- une interface homme-machine 5
- et une unité de calcul 6 comprenant un microprocesseur 61, une mémoire électronique 62 et des interfaces de communication 63 permettant au microprocesseur 61 de communiquer avec le moyen de détection 1, le moyen d’odométrie 2, le moyen de mesure de la vitesse instantanée 3, le module de suivi de cible 4, et l’interface homme-machine 5.
- au moins un moyen de détection 1,
- un moyen d’odométrie 2,
- un moyen de mesure de la vitesse instantanée du véhicule autonome 3, ou capteur de vitesse 3,
- un module de suivi de cible 4,
- une interface homme-machine 5
- et une unité de calcul 6 comprenant un microprocesseur 61, une mémoire électronique 62 et des interfaces de communication 63 permettant au microprocesseur 61 de communiquer avec le moyen de détection 1, le moyen d’odométrie 2, le moyen de mesure de la vitesse instantanée 3, le module de suivi de cible 4, et l’interface homme-machine 5.
Le moyen de détection 1 peut comprendre un moyen de localisation GPS du véhicule autonome 100 sur une carte de définition standard, ou sur une carte haute définition. Dans ce mode de réalisation, la portée du moyen de détection 1 est de l’ordre de plusieurs centaines de mètres et sa précision est déterminée par la précision de la localisation GPS qui est de l’ordre de quelques mètres.
A partir de la cartographie et des données issues du GPS, le moyen de détection 1 est apte à détecter un point de changement de vitesse se situant sur la trajectoire planifiée T du véhicule autonome 100, à partir d’une position courante du véhicule autonome 100. Les données issues du moyen de détection 1 permettent ainsi de déterminer la position de changement de vitesse.
Avantageusement, le moyen de détection 1 peut comprendre en outre un équipement dont la précision est supérieure à celle de la localisation GPS. Cet équipement peut être par exemple une caméra frontale et/ou un lidar. Dans ce mode de réalisation, les images issues de la caméra frontale et/ou du lidar permettent de détecter la position de changement de vitesse avec une précision de l’ordre de la dizaine de centimètres.
Le moyen d’odométrie 2 évalue une distance DP parcourue par le véhicule à partir d’un point donné, par exemple à partir d’un point de départ d’un itinéraire. Dans un mode de réalisation, la distance parcourue DP peut être obtenue par intégration de la vitesse du véhicule autonome 100. Dans un mode de réalisation alternatif, le moyen d’odométrie 2 pourrait comprendre un moyen de positionnement à haute précision du véhicule autonome sur une carte, par exemple par l’utilisation d’un capteur GPS ; à partir du positionnement du véhicule, le moyen d’odométrie pourrait calculer la distance parcourue DP.
La distance parcourue DP est ensuite utilisée pour estimer la distance curviligne DM séparant le véhicule autonome 100 du point de changement de vitesse P.
Le capteur de vitesse 3 fournit à tout instant la vitesse instantanée du véhicule autonome 100. Le capteur de vitesse 3 peut comprendre, par exemple, des capteurs de rotation des roues du véhicule autonome 100.
Le système de gestion 10 détermine une première et une deuxième consigne de vitesse CV1, CV2 qui seront décrites plus loin dans ce document.
Le module de suivi de cible 4 détermine une troisième consigne de vitesse CV3 permettant de maintenir une distance de suivi entre le véhicule autonome 100 et un ou plusieurs véhicules environnants. Dans un mode de réalisation préférentiel, l’au moins une cible est détectée dans le trafic se situant à l’avant du véhicule autonome 100. Dans ce mode de réalisation l’au moins une cible peut se situer sur la voie de circulation du véhicule autonome, par exemple l’au moins une cible peut comprendre un premier véhicule situé devant le véhicule autonome et dans sa voie de circulation, ainsi qu’un deuxième véhicule situé devant le premier véhicule cible et dans la même voie de circulation. En complément, lorsque le véhicule autonome circule sur une route à plusieurs voies de circulation dans le même sens, l’au moins une cible peut également comprendre un ou plusieurs véhicules présentant un risque d’insertion sur la voie du véhicule autonome 100. Les véhicules à risque d’insertion sont détectés sur la ou les voies adjacentes à la voie de circulation du véhicule autonome 100 dans le trafic situé en amont du véhicule autonome 100. Ils se situent à l’avant du véhicule autonome 100, ce qui peut inclure les situations où un véhicule est dans une manœuvre de dépassement du véhicule autonome 100 ou inversement. Autrement dit, un véhicule peut être détecté comme étant à risque d’insertion lorsqu’il roule en parallèle avec le véhicule autonome 100. Lorsqu’aucune cible n’est détectée dans l’environnement du véhicule autonome 100, la troisième consigne de vitesse CV3 est indéfinie.
L’interface homme-machine 5 permet à un usager du véhicule autonome 100 de déterminer une quatrième consigne de vitesse CV4. L’interface homme-machine 5 peut, par exemple, être un écran de saisie présent sur le tableau de bord du véhicule autonome 100. Dans un mode de réalisation préférentiel (décrit dans la suite du document), la quatrième consigne de vitesse CV4 est toujours définie. Dans un mode de réalisation alternatif non décrit, la quatrième consigne de vitesse pourrait ne pas être définie.
Dans un mode de réalisation, le microprocesseur 61 permet d’exécuter un logiciel comprenant les modules suivants, qui collaborent entre eux :
un module 611 de détection d’un point de changement de vitesse et de détermination d’une vitesse limite applicable au point de changement de vitesse, qui collabore avec l’au moins un moyen de détection 1, ,
- un module 612 de calcul d’une première consigne de vitesse CV1,
- un module 613 de détermination d’une deuxième consigne de vitesse CV2, qui collabore avec le moyen d’odométrie 2, le module de suivi de cible 4 et l’interface homme-machine 5, la détermination de la deuxième consigne de vitesse CV2 prenant en compte les deuxième et troisième consignes de vitesse CV3, CV4 selon une stratégie d’arbitrage décrite plus loin dans ce document,
- un module 614 de commande du déplacement du véhicule autonome selon la deuxième consigne de vitesse CV2, qui collabore avec le capteur de vitesse 3.
un module 611 de détection d’un point de changement de vitesse et de détermination d’une vitesse limite applicable au point de changement de vitesse, qui collabore avec l’au moins un moyen de détection 1, ,
- un module 612 de calcul d’une première consigne de vitesse CV1,
- un module 613 de détermination d’une deuxième consigne de vitesse CV2, qui collabore avec le moyen d’odométrie 2, le module de suivi de cible 4 et l’interface homme-machine 5, la détermination de la deuxième consigne de vitesse CV2 prenant en compte les deuxième et troisième consignes de vitesse CV3, CV4 selon une stratégie d’arbitrage décrite plus loin dans ce document,
- un module 614 de commande du déplacement du véhicule autonome selon la deuxième consigne de vitesse CV2, qui collabore avec le capteur de vitesse 3.
Un mode d’exécution du procédé de gestion de la vitesse d’un véhicule autonome est décrit ci-après en référence à la . Le procédé comprend quatre étapes E1 à E4.
Dans l’étape E1, on détecte, à partir des données issues de l’au moins un moyen de détection 1, un point de changement de vitesse P, situé sur la trajectoire planifiée T du véhicule autonome 100 et à l’avant du véhicule autonome, et on détermine une vitesse limite VL applicable au point de changement de vitesse P.
Pour cela, les données issues du ou des moyens de détection 1 sont comparées à la trajectoire planifiée T.
Par exemple, dans un mode de réalisation où le moyen de détection 1 est réalisé par une localisation GPS du véhicule autonome sur une cartographie, on combine les informations de planification de trajectoire, de position du véhicule et de cartographie, pour rechercher la présence d’un point de changement de vitesse P sur la portion d’itinéraire située à l’avant du véhicule autonome 100 et dans la portée du premier moyen de détection 1.
A un instant T0, on détecte ainsi au moins une signalétique de limitation de vitesse ou d’arrêt sur cette portion d’itinéraire. Si plusieurs signalétiques sont détectées sur cette portion d’itinéraire, la signalétique la plus proche du véhicule autonome 100 sera détectée comme étant le point de changement de vitesse P.
Les données de cartographie permettent d’associer une vitesse limite VL au point de changement de vitesse P. Par exemple, si le point de changement de vitesse P est déterminé par un panneau de limitation de vitesse, la vitesse VL est la vitesse inscrite sur le panneau de limitation de vitesse. Un point de changement de vitesse peut également être déterminé par un changement de type de voie, par exemple la fin d’un tronçon de voie rapide ou d’un tronçon d’autoroute, qui débouche sur un type de voie différent, par exemple un tronçon de route nationale ou départementale. La vitesse VL est alors déterminée par la règlementation définie sur ledit type de voie différent. Un point de changement de vitesse P peut encore être déterminé par un panneau stop et dans ce cas la vitesse limite VL est nulle. Dans d’autres situations où le point de changement de vitesse P correspond à un carrefour sur lequel le véhicule autonome 100 n’est pas prioritaire, par exemple un rond-point ou un carrefour avec feu tricolore, la vitesse VL peut être proche de zéro.
Puis, suite à l’étape E1, on itère, sur les étapes E2 à E4 jusqu’à ce que le véhicule autonome 100 atteigne le point de changement de vitesse P.
Les étapes E2 à E4 sont décrites ci-après en référence à la .
Dans la deuxième étape E2, on calcule une première consigne de vitesse CV1 du véhicule autonome 100, en fonction de la vitesse limite VL et d’une première distance DT, planifiée en fonction du temps, séparant le véhicule autonome 100 du point de changement de vitesse P.
La première distance DT est une distance théorique, c’est-à-dire qu’elle sera calculée lors de chaque itération de l’étape E2 en fonction d’un profil de vitesse prédictif PVP décrit ci-après. Dans la suite du document, la première distance DT est nommée « distance théorique DT ».
Lors de la première itération de l’étape E2, c’est-à-dire à l’instant T0, la distance théorique DT est égale à la distance curviligne initiale D0 calculée entre la position du véhicule autonome 100 à l’instant T0 et la position du point de changement de vitesse P.
Lors de la première itération de l’étape E2, on calcule un profil de vitesse prédictif PVP sur la portion d’itinéraire reliant la position à l’instant T0 du véhicule autonome 100 à la position du point de changement de vitesse P.
Dans la suite du document, le terme « profil de vitesse » désigne des courbes d’évolution temporelle de la vitesse longitudinale, de l’accélération longitudinale et du jerk longitudinal du véhicule autonome 100, le jerk longitudinal étant la dérivée de l’accélération longitudinale du véhicule autonome 100.
Le profil de vitesse prédictif PVP est calculé de sorte que le véhicule autonome 100 circule à la vitesse VL lorsqu’il atteint le point de changement de vitesse P.
En outre, le profil de vitesse prédictif PVP est calculé de sorte à permettre au véhicule autonome 100 de se déplacer sur l’itinéraire T, entre sa position à l’instant T0 et le point de changement de vitesse P, et selon des critères de confort requis pour les usagers du véhicule. Les critères de confort peuvent comprendre le respect de seuils maximaux d’accélération et de jerk.
Ainsi, on détermine à l’instant T0 le profil de vitesse prédictif PVP du véhicule autonome 100 à partir de sa position à l’instant T0 et jusqu’à son arrivée au point de changement de vitesse P. Notamment, le profil de vitesse comprend une courbe d’évolution temporelle théorique VT(t) du véhicule autonome 100.
Lors des itérations suivantes de l’étape E2, on considère que le véhicule autonome 100 se déplace selon le profil de vitesse prédictif PVP établi à l’instant T0. On peut donc à chaque instant t d’itération sur l’étape E2 calculer
- une première consigne de vitesse CV1=VT(t), et
- une distance théorique DT(t) entre le véhicule autonome et le point de changement de vitesse P, DT(t) évoluant selon une courbe décroissante entre la valeur D0 à T0 et la valeur 0 à l’instant d’arrivée au point de changement de vitesse P.
- une première consigne de vitesse CV1=VT(t), et
- une distance théorique DT(t) entre le véhicule autonome et le point de changement de vitesse P, DT(t) évoluant selon une courbe décroissante entre la valeur D0 à T0 et la valeur 0 à l’instant d’arrivée au point de changement de vitesse P.
La distance théorique DT(t) entre le véhicule autonome et le point de changement de vitesse P est calculée selon la formule suivante :
[Math1]
DT(t) = D0 – DPT(t)
où
- D0 est la distance calculée à l’instant T0 entre le véhicule autonome 100 et le point de changement de vitesse P,
- DPT(t) est la distance qui a été théoriquement parcourue par véhicule autonome 100 se déplaçant selon le profil de vitesse prédictif PVP entre les instants T0 et t.
- D0 est la distance calculée à l’instant T0 entre le véhicule autonome 100 et le point de changement de vitesse P,
- DPT(t) est la distance qui a été théoriquement parcourue par véhicule autonome 100 se déplaçant selon le profil de vitesse prédictif PVP entre les instants T0 et t.
La première distance DT ainsi calculée étant théorique, elle présente une marge d’erreur en distance ΔD par rapport à une deuxième distance DM déterminée par le moyen d’odométrie 2 entre le véhicule autonome 100 et le point de changement de vitesse P.
On enchaine ensuite sur l’étape E3. La troisième étape E3 comprend une détermination d’une deuxième consigne de vitesse CV2 qui compense la marge d’erreur en distance ΔD générée dans la deuxième étape E2 et qui anticipe un retard ΔT généré dans la quatrième étape E4 de commande du déplacement du véhicule autonome 100.
L’étape E3 comprend une détermination à l’instant t d’une distance estimée DM(t) entre le véhicule autonome et le point de changement de vitesse P, à partir des données issues du moyen d’odométrie 2.
Le moyen d’odométrie 2 évalue une distance DP(t) parcourue par le véhicule entre l’instant T0 de détection du point de changement de vitesse et l’instant t. Notamment, la distance DP(t) peut être obtenue par intégration de la vitesse du véhicule autonome 100 entre les instants T0 et t. La distance estimée DM(t) entre le véhicule autonome 100 et le point de changement de vitesse P est alors égale à la différence entre la distance initiale D0 et la distance parcourue DP(t).
Alternativement la distance DM(t) pourrait être estimée à partir des images issues d’une caméra frontale, lorsque le point de changement de vitesse P entre dans la zone de détection de la caméra frontale.
L’étape E3 comprend en outre le calcul, à l’instant t, d’une deuxième consigne de vitesse CV2(t) à partir de la première consigne de vitesse CV1(t) et de la différence entre la distance théorique DT(t) et la distance estimée DM(t).
Le calcul de la deuxième consigne de vitesse CV2(t) est défini pour compenser deux facteurs induisant une imprécision dans l’évolution temporelle de la position du véhicule autonome 100 le long de sa trajectoire T :
- un premier facteur d’imprécision est lié à un écart entre la distance théorique DT(t) calculée selon la formule Math1 et la distance réelle séparant, à l’instant t, le véhicule autonome 100 du point de changement de vitesse P,
- un deuxième facteur d’imprécision est lié à un retard de phase ΔT induit par une boucle d’asservissement entre la vitesse et l’accélération, cette boucle étant mise en œuvre dans l’étape suivante du traitement, c’est-à-dire dans l’étape E4.
- un premier facteur d’imprécision est lié à un écart entre la distance théorique DT(t) calculée selon la formule Math1 et la distance réelle séparant, à l’instant t, le véhicule autonome 100 du point de changement de vitesse P,
- un deuxième facteur d’imprécision est lié à un retard de phase ΔT induit par une boucle d’asservissement entre la vitesse et l’accélération, cette boucle étant mise en œuvre dans l’étape suivante du traitement, c’est-à-dire dans l’étape E4.
Pour compenser ces facteurs d’imprécision, dans l’étape E3 on met en œuvre deux corrections F1 et F2, corrigeant respectivement le premier et le deuxième facteur d’imprécision,
- la première correction F1 est une boucle de régulation de distance, prenant en entrée la différence ΔD(t) entre la distance théorique DT(t) et la distance estimée DM(t),
- la deuxième correction F2 comprend deux filtres à avance de phase appliqués entre la première consigne de vitesse CV1 et la deuxième consigne de vitesse CV2.
- la première correction F1 est une boucle de régulation de distance, prenant en entrée la différence ΔD(t) entre la distance théorique DT(t) et la distance estimée DM(t),
- la deuxième correction F2 comprend deux filtres à avance de phase appliqués entre la première consigne de vitesse CV1 et la deuxième consigne de vitesse CV2.
La première correction F1 a pour but de corriger la première consigne de vitesse CV1(t) proportionnellement à un écart de distance ΔD(t) mesuré par rapport au profil de vitesse prédictif PVP. Pour cela, la première correction F1 applique un régulateur proportionnel F11 comprenant un gain donné KD, notamment un gain multiplicatif KD, à l’écart ΔD(t) entre la distance théorique DT(t) calculée selon la formule Math1, et la distance estimée DM(t) entre le véhicule autonome et le point de changement de vitesse P. Le gain KDest homogène à l’inverse d’une seconde (s-1) ; il permet de régler la dynamique de cette correction. Dans un mode de réalisation, il est déterminé de manière empirique pour satisfaire un compromis entre stabilité et précision du suivi de consigne.
La deuxième correction F2 a pour but de compenser le retard ΔT lié aux filtres mis en œuvre dans l’étape ultérieure E4, notamment dans une boucle d’asservissement B1 entre la deuxième consigne de vitesse CV2 et une consigne d’accélération CA. La deuxième correction F2 est donc déterminée par le mode de réalisation de la boucle d’asservissement B1 que nous décrivons plus loin dans ce document. La deuxième correction F2 sera décrite plus loin, suite à la description de la boucle d’asservissement B1.
Ainsi, la deuxième consigne de vitesse CV2 est la somme d’une première et d’une deuxième composante de vitesse CV21, CV22,
- la première composante de vitesse CV21 étant obtenue par application de deux filtres à avance de phase à la première consigne de vitesse CV1, et
- la deuxième composante de vitesse CV22 étant obtenue par application d’un gain KDà la marge d’erreur en distance ΔD.
- la première composante de vitesse CV21 étant obtenue par application de deux filtres à avance de phase à la première consigne de vitesse CV1, et
- la deuxième composante de vitesse CV22 étant obtenue par application d’un gain KDà la marge d’erreur en distance ΔD.
En remarque, le gain KDest réglé de sorte que la deuxième composante de vitesse CV22 converge vers une valeur stable.
Dans un mode de réalisation de l’étape E3, l’étape E3 peut comprendre en outre le traitement d’une troisième consigne de vitesse CV3 déterminée par le module de suivi de cible 4.
Cette situation se produit lorsque l’étape E1 s’exécute à un moment où aucune cible n’est détectée par le module de suivi de cible 4, puis une cible est détectée pendant la mise en œuvre, dans les E2 à E4, de la régulation de la vitesse du véhicule autonome par rapport à la distance du véhicule au point de changement de vitesse P.
Au moment où une cible est détectée, une troisième consigne de vitesse CV3 est calculée par le module de suivi de cible 4 pour maintenir une distance de suivi donnée entre le véhicule autonome 100 et ladite cible.
La cible est préférentiellement détectée dans le trafic situé à l’avant du véhicule autonome 100. Dans ce cas, il est nécessaire que la consigne de vitesse appliquée par véhicule autonome 100 soit inférieure à la consigne de vitesse CV3, afin que le véhicule autonome 100 respecte la distance de suivi donnée avec la cible.
De ce fait, pour des raisons de sécurité, une stratégie d’arbitrage est appliquée entre les deux consignes de vitesse, CV2 et CV3. Selon cette stratégie, la deuxième consigne de vitesse CV2 doit être bornée à la troisième consigne de vitesse CV3.
Autrement dit, la valeur de la deuxième consigne de vitesse CV2 est actualisée comme étant le minimum entre la deuxième consigne de vitesse CV2 et la troisième consigne de vitesse CV3.
Dans un mode de réalisation alternatif ou complémentaire de l’étape E3, l’étape E3 peut comprendre en outre le traitement d’une quatrième consigne de vitesse CV4 définie par l’usager du véhicule via l’interface homme-machine.
Une stratégie d’arbitrage est donc appliquée entre les deux consignes de vitesse, CV2 et CV4. Selon cette stratégie,, la deuxième consigne de vitesse CV2 doit être bornée à la quatrième consigne de vitesse CV4. Si une troisième consigne de vitesse CV3 est définie, la deuxième consigne de vitesse CV2 doit également être bornée à la troisième consigne de vitesse CV3.
Autrement dit, la valeur de la deuxième consigne de vitesse CV2 est actualisée comme étant
- le minimum entre la deuxième consigne de vitesse CV2, la quatrième consigne de vitesse CV4 et la troisième consigne de vitesse CV3, si la troisième consigne CV3 est définie,
sinon
- le minimum entre la deuxième consigne de vitesse CV2 et la quatrième consigne de vitesse CV4 .
- le minimum entre la deuxième consigne de vitesse CV2, la quatrième consigne de vitesse CV4 et la troisième consigne de vitesse CV3, si la troisième consigne CV3 est définie,
sinon
- le minimum entre la deuxième consigne de vitesse CV2 et la quatrième consigne de vitesse CV4 .
On enchaine ensuite sur l’étape E4. Dans un mode de réalisation de l’étape E4 représenté par la , on met en œuvre une boucle d’asservissement B1 entre la deuxième consigne de vitesse CV2 calculée dans l’étape E3 et une consigne d’accélération CA.
Par exemple, la boucle d’asservissement B1 peut mettre en œuvre une régulation de vitesse générant deux composantes d’accélération CA1, CA2 :
- une première composante d’accélération CA1 de type FeedForward est obtenue par application d’un filtre dérivateur du premier ordre F3 à la deuxième consigne de vitesse CV2,
- une deuxième composante d’accélération CA2 de type Feedback est obtenue par application d’un régulateur proportionnel de gain F43 à une erreur de vitesse ΔV, calculée entre une vitesse mesurée VM du véhicule automobile 100 et une consigne de vitesse filtrée CVF,
- la consigne d’accélération CA étant la somme des première et deuxième composantes d’accélération, CA1, CA2.
- une première composante d’accélération CA1 de type FeedForward est obtenue par application d’un filtre dérivateur du premier ordre F3 à la deuxième consigne de vitesse CV2,
- une deuxième composante d’accélération CA2 de type Feedback est obtenue par application d’un régulateur proportionnel de gain F43 à une erreur de vitesse ΔV, calculée entre une vitesse mesurée VM du véhicule automobile 100 et une consigne de vitesse filtrée CVF,
- la consigne d’accélération CA étant la somme des première et deuxième composantes d’accélération, CA1, CA2.
Le régulateur proportionnel F43 applique un gain multiplicatif KVà l’erreur de vitesse ΔV. Le gain KVest homogène à l’inverse d’une seconde (s-1) ; il permet de régler la dynamique de cette correction. Dans un mode de réalisation, il est déterminé de manière empirique pour satisfaire un compromis entre stabilité, rapidité et confort de suivi de consigne. Notamment, le gain KVest défini pour que la deuxième composante d’accélération CA2 converge vers une valeur stable.
La consigne de vitesse filtrée CVF est obtenue par application de deux filtres successifs du premier ordre F41, F42 à la deuxième consigne de vitesse CV2. Le premier filtre F41 a pour but de synchroniser la deuxième consigne de vitesse CV2 avec la première composante d’accélération CA1 de type FeedForward. Le deuxième filtre F42 a pour but de prendre en compte la dynamique du système.
Les fonctions de transfert respectives H3, H41, H42 des filtres F3, F41, F42 s’expriment respectivement selon les formules Math 2.
où
- s est la variable de Laplace homogène à l’inverse d’une seconde (s-1),
- est une première constante de temps, dont la valeur est de l’ordre du plusieurs dixièmes de secondes, par exemple 0,4 secondes, et
- est une deuxième constante de temps, dont la valeur est de l’ordre du dixième de secondes, par exemple 0,15 secondes.
- s est la variable de Laplace homogène à l’inverse d’une seconde (s-1),
-
-
La valeur relativement élevée de la première constante de temps présente l’intérêt de filtrer d’éventuelles variations brutales dans l’évolution de la consigne de vitesse, et ainsi d’améliorer le confort des usagers. Lesdites variations brutales sont notamment dues à une discontinuité de la dérivée de l’évolution temporelle de la consigne de vitesse,
Néanmoins, la valeur élevée de entraine un délai non négligeable entre le calcul de la consigne de vitesse du véhicule autonome 100 et la mise en œuvre de cette consigne de vitesse par le groupe motopropulseur et/ou l’actionneur de freins.
Comme cela a été précédemment expliqué, dans l’étape E3 on applique une deuxième correction F2 afin que le délai introduit par la boucle B1 ne pénalise pas la capacité du véhicule autonome 100 à atteindre un point précis de son itinéraire à une vitesse donnée.
La deuxième correction F2 comprend
- un premier filtre à avance de phase F21 qui compense par anticipation le retard qui est introduit par le filtre F41 et,
- un deuxième filtre à avance de phase F22 qui compense par anticipation le retard qui est introduit par le filtre F42.
- un premier filtre à avance de phase F21 qui compense par anticipation le retard qui est introduit par le filtre F41 et,
- un deuxième filtre à avance de phase F22 qui compense par anticipation le retard qui est introduit par le filtre F42.
Les fonctions de transfert respectives H21 et H22 des filtres F21 et F22 s’expriment respectivement selon les formules Math 3.
où
- s est la variable de Laplace homogène à l’inverse d’une seconde (s-1),
- est la première constante de temps également utilisée dans le filtre à retard de phase F41,
- est la deuxième constante de temps également utilisée dans le filtre à retard de phase F42.
- est une troisième constante de temps dont la valeur est de l’ordre de 50 millisecondes
- s est la variable de Laplace homogène à l’inverse d’une seconde (s-1),
-
-
-
Les filtres F21 et F22 étant ainsi définis, le retard de phase entre la première consigne de vitesse CV1 et la consigne d’accélération CA se limite au retard induit par la troisième constante de temps. Ce retard est donc minimisé, puisqu’il est de l’ordre de 50 millisecondes.
La consigne d’accélération CA ainsi déterminée est transmise au contrôleur de couple 7 afin de mettre en œuvre un déplacement longitudinal du véhicule autonome 100.
La illustre l’effet de la mise en œuvre de l’invention :
- les graphes G11, G12, G13, G14 et G15 illustrent le déplacement du véhicule autonome vers un point de changement de vitesse P sans mise en œuvre de l’invention, et
- les graphes G21, G22, G23, G24 et G25 illustrent le déplacement du véhicule autonome vers un point de changement de vitesse P avec mise en œuvre de l’invention.
- les graphes G11, G12, G13, G14 et G15 illustrent le déplacement du véhicule autonome vers un point de changement de vitesse P sans mise en œuvre de l’invention, et
- les graphes G21, G22, G23, G24 et G25 illustrent le déplacement du véhicule autonome vers un point de changement de vitesse P avec mise en œuvre de l’invention.
L’axe des abscisses des graphes G11 à G15 et des graphes G21 à G25 représente le temps en secondes.
Les graphes G11 et G21 permettent de comparer l’évolution temporelle de la vitesse (représentée en km/h sur l’axe des ordonnées des graphes G11 et G21) du véhicule autonome respectivement sans et avec mise en œuvre de l’invention :
- sur le graphe G11, sans mise en œuvre de l’invention, la vitesse appliquée 112 est en retard sur la consigne de vitesse 111 issue du profil de vitesse prédictif PVP,
- sur le graphe G21, avec mise en œuvre de l’invention, la vitesse appliquée 212 est sensiblement plus proche la consigne de vitesse 211 issue du profil de vitesse prédictif PVP.
- sur le graphe G11, sans mise en œuvre de l’invention, la vitesse appliquée 112 est en retard sur la consigne de vitesse 111 issue du profil de vitesse prédictif PVP,
- sur le graphe G21, avec mise en œuvre de l’invention, la vitesse appliquée 212 est sensiblement plus proche la consigne de vitesse 211 issue du profil de vitesse prédictif PVP.
Les graphes G12 et G22 permettent de comparer l’évolution temporelle d’une composante de la consigne de vitesse (représentée en m/s sur l’axe des ordonnées des graphes G12 et G22) correspondant à une correction en distance respectivement sans et avec mise en œuvre de l’invention :
- sur le graphe G12, cette composante est nulle puisque, sans mise en œuvre de l’invention, aucune correction de vitesse n’est appliquée,
- sur le graphe G22, avec mise en œuvre de l’invention, cette composante CV22 évolue entre 0 m/s et -0,15 m/s.
- sur le graphe G12, cette composante est nulle puisque, sans mise en œuvre de l’invention, aucune correction de vitesse n’est appliquée,
- sur le graphe G22, avec mise en œuvre de l’invention, cette composante CV22 évolue entre 0 m/s et -0,15 m/s.
Les graphes G13 et G23 permettent de comparer l’évolution temporelle de l’accélération du véhicule autonome (représentée en m/s2sur l’axe des ordonnées des graphes G13 et G23) respectivement sans et avec mise en œuvre de l’invention :
- sur le graphe G13, sans mise en œuvre de l’invention, entre les instants t=16s et t=28s on observe un écart important entre l’accélération 132 appliquée par le véhicule et la consigne d’accélération 131 issue du profil de vitesse prédictif PVP,
- sur le graphe G23, avec mise en œuvre de l’invention, entre les instants t=16s et t=28s on observe une réduction de l’écart entre l’accélération 232 appliquée par le véhicule et la consigne d’accélération 231 issue du profil de vitesse prédictif PVP.
- sur le graphe G13, sans mise en œuvre de l’invention, entre les instants t=16s et t=28s on observe un écart important entre l’accélération 132 appliquée par le véhicule et la consigne d’accélération 131 issue du profil de vitesse prédictif PVP,
- sur le graphe G23, avec mise en œuvre de l’invention, entre les instants t=16s et t=28s on observe une réduction de l’écart entre l’accélération 232 appliquée par le véhicule et la consigne d’accélération 231 issue du profil de vitesse prédictif PVP.
De même, les graphes G14 et G24 permettent de comparer l’évolution temporelle du jerk du véhicule autonome (représentée en m/s3sur l’axe des ordonnées des graphes G14 et G24) respectivement sans et avec mise en œuvre de l’invention :
- sur le graphe G14, sans mise en œuvre de l’invention, à l’instant t=28s on observe un écart important entre le jerk 142 appliqué par le véhicule et le jerk 141 déterminé par le profil de vitesse prédictif PVP,
- sur le graphe G24, avec mise en œuvre de l’invention, l’écart observé à l’instant t=28s entre le jerk 242 appliqué par le véhicule et le jerk 241 déterminé par le profil de vitesse prédictif PVP est considérablement réduit.
- sur le graphe G14, sans mise en œuvre de l’invention, à l’instant t=28s on observe un écart important entre le jerk 142 appliqué par le véhicule et le jerk 141 déterminé par le profil de vitesse prédictif PVP,
- sur le graphe G24, avec mise en œuvre de l’invention, l’écart observé à l’instant t=28s entre le jerk 242 appliqué par le véhicule et le jerk 241 déterminé par le profil de vitesse prédictif PVP est considérablement réduit.
De plus, les graphes G15 et G25 permettent de comparer l’évolution temporelle, respectivement sans et avec mise en œuvre de l’invention, d’une erreur de distance (représentée en mètres sur l’axe des ordonnées des graphes G15 et G25) mesurée à un instant donné entre la position réelle du véhicule autonome et la position théorique déterminée par le profil de vitesse prédictif PVP :
- sur le graphe G15, sans mise en œuvre de l’invention, l’erreur de distance 151 augmente significativement au fil du temps jusqu’à dépasser 6 mètres,
- sur le graphe G25, avec mise en œuvre de l’invention, l’erreur de distance 251 reste inférieure à quinze centimètres sur toute la durée du trajet et se stabilise autour de 6 centimètres à l’approche du point de changement de vitesse P.
- sur le graphe G15, sans mise en œuvre de l’invention, l’erreur de distance 151 augmente significativement au fil du temps jusqu’à dépasser 6 mètres,
- sur le graphe G25, avec mise en œuvre de l’invention, l’erreur de distance 251 reste inférieure à quinze centimètres sur toute la durée du trajet et se stabilise autour de 6 centimètres à l’approche du point de changement de vitesse P.
Grâce à l’invention, les vitesses, accélérations et jerks mis en œuvre par le véhicule autonome 100 restent proches des valeurs définies par le profil de vitesse prédictif PVP durant le déplacement du véhicule vers le point de changement de vitesse P. Les corrections de phase et de distance apportées par l’invention permettent au véhicule autonome 100, en premier lieu, de se déplacer sur son itinéraire en minimisant la distance entre sa position réelle et une position théorique déterminée par un déplacement selon son profil PSP, et ainsi d’assurer notamment le confort des usagers du véhicule et
- en deuxième lieu d’atteindre le point de changement de vitesse P avec une vitesse proche de la vitesse limite VL, et avec une précision de l’ordre d’une dizaine ou de quelques dizaines de centimètres relativement à la position du point de changement de vitesse P, et ainsi d’assurer la précision d’arrêt ou de changement de vitesse.
- en deuxième lieu d’atteindre le point de changement de vitesse P avec une vitesse proche de la vitesse limite VL, et avec une précision de l’ordre d’une dizaine ou de quelques dizaines de centimètres relativement à la position du point de changement de vitesse P, et ainsi d’assurer la précision d’arrêt ou de changement de vitesse.
Une particularité de l’invention est de réguler, non seulement la vitesse du véhicule autonome par rapport au temps, mais aussi la distance entre le véhicule autonome et le point de changement de vitesse par rapport au temps. Ainsi, la régulation de la distance entre le véhicule autonome et le point de changement de vitesse permet de corriger une éventuelle déviation de position liée à une déviation de la vitesse du véhicule par rapport à la consigne. Ce point différencie notamment l’invention du brevet US8924049B2 cité dans l’état de l’art antérieur.
En outre, on applique une stratégie de commutation entre une régulation de la vitesse du véhicule autonome selon l’invention, et une régulation de la vitesse du véhicule autonome selon le module de suivi de cible 4. En effet, les besoins en termes de précision de la régulation de vitesse sont très différents selon que l’on cherche à maintenir une distance de suivi entre un véhicule cible et le véhicule autonome 100, ou que l’on cherche à atteindre précisément une position de changement de vitesse du véhicule autonome, notamment une position d’arrêt du véhicule autonome. Dans le cas d’un suivi de cible, la vitesse du véhicule autonome est régulée par rapport à la vitesse de la cible afin de maintenir une distance de suivi correspondant à un temps minimal, par exemple 2 secondes, séparant les deux véhicules. Par exemple, si l’on considère que le véhicule circule à 90 km/h, une distance de suivi équivalente à 2 secondes de séparation est de 50 mètres. La distance réellement maintenue entre le véhicule autonome et la cible peut alors osciller entre 45 et 55 mètres sans que cela n’ait d’impact sur la sécurité. En revanche, dans le cas d’une régulation de vitesse en fonction d’une position de changement de vitesse du véhicule autonome, et plus particulièrement en fonction d’une position d’arrêt du véhicule autonome, la précision attendue sur la position du véhicule relativement au point de changement de vitesse P est de l’ordre de la dizaine de centimètres. De même, la vitesse de suivi d’une cible peut osciller faiblement autour d’une consigne de vitesse de suivi sans que cela n’impacte le maintien d’une distance de sécurité entre les deux véhicules. En revanche, dans le cas d’une régulation de vitesse en fonction d’une position d’arrêt du véhicule autonome, il n’est pas acceptable que la vitesse du véhicule oscille autour de 0 m/s en atteignant le point d’arrêt, car de telles oscillations signifient que le véhicule avance et recule à son arrivée au point d’arrêt.
Autrement dit, la précision de position et de vitesse apportée par l’invention est très avantageuse dans le cas où l’on souhaite que le véhicule autonome s’arrête à un point précis (par exemple devant un panneau stop), mais une telle précision n’est pas requise pour un suivi de cible.
Au contraire, la régulation selon l’invention peut générer de l’inconfort si elle est appliquée à un profil de vitesse généré par le module de suivi de cible 4. En effet, un profil de vitesse généré par le module de suivi de cible peut présenter une dérivée discontinue, dont les discontinuités sont filtrées par l’application de filtres dont l’effet serait annulé par la mise en œuvre de l’invention. Autrement dit, si une régulation de vitesse selon l’invention était appliquée à un profil de vitesse généré par le module de suivi de cible, cela dégraderait le confort de suivi d’une cible, notamment la vitesse du véhicule serait saccadée.
La stratégie de commutation consiste donc à mettre en œuvre le régulateur de vitesse le plus adapté à la situation en cours, la situation pouvant être un suivi de cible ou un changement de vitesse à une position précise :
- dans le cas d’un régulation de vitesse par rapport à un changement de vitesse à une position précise, la régulation de vitesse comprendra l’application de filtres correctifs (dans l’étape E3) en amont d’une boucle d’asservissement B1 entre la vitesse et l’accélération (mise en œuvre dans l’étape E4),
- dans le cas d’une régulation de vitesse par rapport à un suivi de cible, la régulation de vitesse comprendra uniquement la boucle d’asservissement B1 entre la vitesse et l’accélération (mise en œuvre dans l’étape E4).
- dans le cas d’un régulation de vitesse par rapport à un changement de vitesse à une position précise, la régulation de vitesse comprendra l’application de filtres correctifs (dans l’étape E3) en amont d’une boucle d’asservissement B1 entre la vitesse et l’accélération (mise en œuvre dans l’étape E4),
- dans le cas d’une régulation de vitesse par rapport à un suivi de cible, la régulation de vitesse comprendra uniquement la boucle d’asservissement B1 entre la vitesse et l’accélération (mise en œuvre dans l’étape E4).
Par ailleurs, on traite également les situations où une cible apparait alors qu’une régulation de vitesse selon l’invention est en cours. Dans ce cas, une consigne de vitesse est déterminée par le module de suivi de cible 4 alors qu’une régulation de vitesse selon un profil de vitesse prédictif est en cours. Une stratégie d’arbitrage est alors appliquée ; elle consiste à déterminer la consigne de vitesse comme étant le minimum entre la deuxième consigne de vitesse CV2 issue du profil de vitesse prédictif et la troisième consigne de vitesse CV3 issue du module de suivi 4. Ainsi on s’assure dans tous les cas que la distance de suivi de cible est respectée ; dans les cas où la deuxième consigne de vitesse CV2 est inférieure à la consigne de vitesse de suivi de cible, on maintient la régulation de vitesse selon l’invention, c’est-à-dire la régulation de vitesse par rapport à un point de changement de vitesse.
Plus généralement, la stratégie d’arbitrage mise en œuvre dans l’invention consiste à déterminer la consigne de vitesse comme étant le minimum entre les différentes consignes de vitesses définies, la consigne CV4 issue de l’interface homme-machine 5, une éventuelle consigne CV3 issue du module de suivi de cible 4, et la consigne de vitesse CV2 issue du profil de vitesse prédictif. De cette manière, on s’assure que la consigne de vitesse appliquée au véhicule autonome ne dépasse par la vitesse définie par l’usager et permet de respecter une distance minimale de suivi d’une éventuelle cible.
Claims (8)
- Procédé de gestion de la vitesse longitudinale d’un véhicule automobile (100), le véhicule automobile circulant selon une trajectoire planifiée (T), le véhicule automobile étant équipé d’au moins un moyen de détection (1) de l'environnement du véhicule et d’un moyen d’odométrie (2), caractérisé en ce qu’il comprend
- une étape (E1) de détection, à partir des données issues de l’au moins un moyen de détection (1), d’un point de changement de vitesse (P), situé sur la trajectoire donnée (T) et à l’avant du véhicule automobile, et de détermination d’une vitesse limite (VL) applicable au point de changement de vitesse (P), puis
- une deuxième étape (E2) de calcul d’une première consigne de vitesse (CV1) du véhicule automobile (100), en fonction de la vitesse limite (VL) et d’une première distance (DT) séparant le véhicule automobile (100) du point de changement de vitesse (P), la première distance (DT) étant calculée en fonction d’un profil de vitesse planifié (PVP), la première distance (DT) présentant une marge d’erreur en distance (ΔD) par rapport à une deuxième distance (DM) déterminée par le moyen d’odométrie (2) entre le véhicule automobile (100) et le point de changement de vitesse (P), puis
- une troisième étape (E3) comprenant une détermination d’une deuxième consigne de vitesse (CV2) qui compense la marge d’erreur en distance (ΔD) générée dans la deuxième étape (E2) et qui anticipe un retard de phase (ΔT) généré dans une quatrième étape (E4) de commande du déplacement du véhicule automobile (100) , puis
- une quatrième étape (E4) de commande du déplacement du véhicule automobile (100) selon la deuxième consigne de vitesse (CV2) pour atteindre le point de changement de vitesse (P) avec une vitesse égale à la vitesse limite (VL), la quatrième étape (E4) générant le retard de phase (ΔT) entre la réception de la deuxième consigne de vitesse (CV2) et le déplacement du véhicule selon la deuxième consigne de vitesse (CV2).
- Procédé de gestion selon la revendication précédente, le véhicule automobile (100) étant équipé d’un moyen de mesure (3) de la vitesse instantanée du véhicule, caractérisé en ce que la quatrième étape (E4) comprend la détermination d’une consigne d’accélération (CA) du véhicule automobile comme étant la somme d’une première et d’une deuxième composante d’accélération (CA1, CA2),
- la première composante d’accélération (CA1) étant calculée par l’application d’un filtre dérivateur du premier degré (F3) à la deuxième consigne de vitesse (CV2), et
- la deuxième composante d’accélération (CA2) étant obtenue par application d’un premier régulateur proportionnel de gain (KV) à la différence entre une vitesse instantanée (VM) du véhicule déterminée par le moyen de mesure de la vitesse (3) et une consigne de vitesse filtrée (CVF),
la consigne de vitesse filtrée (CVF) étant obtenue par l’application successive d’un premier et d’un deuxième filtre du premier ordre (F41, F42) à la deuxième consigne de vitesse (CV2),
- le premier filtre (F41) appliquant un retard de phase à la deuxième consigne de vitesse (CV2) de sorte à synchroniser la deuxième consigne de vitesse (CV2) avec la première composante d’accélération (CA1), et
- le deuxième filtre (F42) étant paramétré de sorte que la consigne de vitesse filtrée (CVF) converge vers une valeur stable. - Procédé de gestion selon l’une des revendications précédentes, caractérisé en ce que la deuxième consigne de vitesse (CV2) est la somme d’une première et d’une deuxième composante de vitesse (CV21, CV22),
- la première composante de vitesse (CV21) étant obtenue par application d’un premier et d’un deuxième filtre à avance de phase (F21, F22) à la première consigne de vitesse (CV1), et
- la deuxième composante de vitesse (CV22) étant obtenue par application d’un deuxième régulateur proportionnel comprenant un gain donné (KD) à la marge d’erreur en distance (ΔD), le gain donné étant réglé pour que la deuxième composante de vitesse (CV22) converge vers une valeur stable. - Procédé de gestion selon les revendications 2 et 3, caractérisé en ce que :
- la même constante de temps (
- la même constante de temps ( - Procédé de gestion selon l’une des revendications précédentes, le véhicule comprenant une interface homme machine (5) permettant à un usager de définir une quatrième consigne de vitesse (CV4), caractérisé en ce que la troisième étape (E3) comprend une modification de la deuxième consigne de vitesse (CV2) comme étant le minimum entre la deuxième consigne de vitesse (CV2) et la quatrième consigne de vitesse (CV4).
- Procédé de gestion selon la revendication précédente, le véhicule comprenant un module de suivi de cible (4) déterminant une troisième consigne de vitesse (CV3), caractérisé en ce que la troisième étape (E3) comprend une modification de la deuxième consigne de vitesse (CV2) comme étant le minimum entre la deuxième consigne de vitesse (CV2), la troisième consigne de vitesse (CV3) et la quatrième consigne de vitesse (CV4).
- Procédé de gestion selon l’une des revendications précédentes, caractérisé en ce que la vitesse limite (VL) est nulle.
- Produit programme d’ordinateur comprenant des instructions de code de programme enregistrées sur un support lisible par ordinateur pour mettre en œuvre les étapes du procédé selon l’une quelconque des revendications 1 à 7 lorsque ledit programme fonctionne sur un ordinateur.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| FR2106331A FR3123863B1 (fr) | 2021-06-15 | 2021-06-15 | Procédé de gestion de la vitesse longitudinale d’un véhicule automobile. |
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| FR2106331 | 2021-06-15 | ||
| FR2106331A FR3123863B1 (fr) | 2021-06-15 | 2021-06-15 | Procédé de gestion de la vitesse longitudinale d’un véhicule automobile. |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| FR3123863A1 true FR3123863A1 (fr) | 2022-12-16 |
| FR3123863B1 FR3123863B1 (fr) | 2023-06-30 |
Family
ID=77226900
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| FR2106331A Active FR3123863B1 (fr) | 2021-06-15 | 2021-06-15 | Procédé de gestion de la vitesse longitudinale d’un véhicule automobile. |
Country Status (1)
| Country | Link |
|---|---|
| FR (1) | FR3123863B1 (fr) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117055585A (zh) * | 2023-10-09 | 2023-11-14 | 青州市巨龙环保科技有限公司 | 一种智能水下机器人的智能控制方法和系统 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP2527222A2 (fr) * | 2011-05-25 | 2012-11-28 | Audi AG | Procédé destiné au fonctionnement d'un système d'assistance du conducteur longitudinal et véhicule automobile |
| US8924049B2 (en) | 2003-01-06 | 2014-12-30 | General Electric Company | System and method for controlling movement of vehicles |
| US20190185004A1 (en) * | 2017-12-18 | 2019-06-20 | Hyundai Motor Company | Method for controlling driving of environmentally friendly vehicle using front driving environment information |
| US20200130686A1 (en) * | 2018-10-26 | 2020-04-30 | Hyundai Motor Company | Method for controlling deceleration of environmentally friendly vehicle |
-
2021
- 2021-06-15 FR FR2106331A patent/FR3123863B1/fr active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US8924049B2 (en) | 2003-01-06 | 2014-12-30 | General Electric Company | System and method for controlling movement of vehicles |
| EP2527222A2 (fr) * | 2011-05-25 | 2012-11-28 | Audi AG | Procédé destiné au fonctionnement d'un système d'assistance du conducteur longitudinal et véhicule automobile |
| US20190185004A1 (en) * | 2017-12-18 | 2019-06-20 | Hyundai Motor Company | Method for controlling driving of environmentally friendly vehicle using front driving environment information |
| US20200130686A1 (en) * | 2018-10-26 | 2020-04-30 | Hyundai Motor Company | Method for controlling deceleration of environmentally friendly vehicle |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117055585A (zh) * | 2023-10-09 | 2023-11-14 | 青州市巨龙环保科技有限公司 | 一种智能水下机器人的智能控制方法和系统 |
| CN117055585B (zh) * | 2023-10-09 | 2024-03-05 | 青州市巨龙环保科技有限公司 | 一种智能水下机器人的智能控制方法和系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| FR3123863B1 (fr) | 2023-06-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP3071461B1 (fr) | Procede et dispositif de pilotage automatique d'un vehicule | |
| FR2949577A1 (fr) | Procede d'aide a la gestion d'un vol en vue de tenir une contrainte de temps | |
| FR2923032A1 (fr) | Procede et dispositif d'aide au pilotage d'un aeronef en vue d'une phase de descente. | |
| FR2980151A1 (fr) | Dispositif et procede de gestion d'un vehicule | |
| FR2930053A1 (fr) | Procede et dispositif de guidage d'un aeronef | |
| EP0904574A1 (fr) | Procede de pilotage d'un aerodyne pour l'evitement vertical d'une zone | |
| CN107176168B (zh) | 用于确定机动车的最大允许的转弯速度的方法和设备 | |
| WO2018162852A1 (fr) | Procédé et système d'aide au stationnement d'un véhicule automobile | |
| FR2957885A1 (fr) | Procede et dispositif de commande de la vitesse longitudinale d'un vehicule automobile | |
| FR3123863A1 (fr) | Procédé de gestion de la vitesse longitudinale d’un véhicule automobile. | |
| FR2962959A1 (fr) | Systeme d'assistance de conduite avec commande des freins | |
| EP3377384B1 (fr) | Procédé d'aide a la conduite d'un véhicule automobile | |
| EP3882096B1 (fr) | Procédé de gestion automatisée de la vitesse longitudinale d'un véhicule | |
| WO2023241797A1 (fr) | Procédé de gestion de la vitesse longitudinale d'un véhicule automobile. | |
| EP3983273B1 (fr) | Procédé de détermination de la vitesse maximale autorisée pour un véhicule automobile mettant en ?uvre une fonction de régulation de vitesse | |
| FR3044808A1 (fr) | Procede et systeme d'aide a l'atterrissage d'un aeronef | |
| FR2912981A1 (fr) | Procede de pilotage automatique de vehicule automobile comprenant un systeme acc | |
| WO2022083970A1 (fr) | Procédé de régulation de la position latérale d'un véhicule sur une voie de circulation | |
| FR3121411A1 (fr) | Procédé de commande de trajectoire de changement de voie pour véhicule autonome. | |
| FR3101044A1 (fr) | Procédé d’aide à la conduite avec détermination d’une distance de sécurité multi-cibles. | |
| EP3770034A1 (fr) | Procédé de pilotage d'un véhicule automobile | |
| EP3730385B1 (fr) | Procédé et dispositif de détection et d'atténuation de dérives de vitesse d'un véhicule automobile intégré dans un système d'aide au stationnement | |
| EP4077087B1 (fr) | Système et procédé de contrôle de véhicule avec compensation de retard temporel de capteurs | |
| EP4337505A1 (fr) | Procédé de gestion de la vitesse longitudinale d'un véhicule autonome | |
| FR3110885A1 (fr) | Procede d’aide a la conduite avec cible virtuelle de regulation de l’acc |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PLFP | Fee payment |
Year of fee payment: 2 |
|
| PLSC | Publication of the preliminary search report |
Effective date: 20221216 |
|
| PLFP | Fee payment |
Year of fee payment: 3 |
|
| CA | Change of address |
Effective date: 20230512 |