FR 3097338 A1 20201218 FR 1906412 A 20190614 Description Titre de l'invention : Système et procédé de prédiction de la trajectoire d'un véhicule égo en fonction de l'environnement dudit véhicule égo [pool j La présente invention concerne le domaine des dispositifs et procédés de prédiction d'un chemin et/ou d'une trajectoire de véhicule automobile, et des programmes d'ordinateur destinés à la mise en oeuvre de tels procédés. [0002] Les véhicules automobiles sont aujourd'hui équipés dc dispositifs d'assistance à la conduite avancés, dits advanced driver assistance systems, d'acronyme ADAS en termes anglo-saxons, de plus en plus performants. Un dispositif d'assistance à la conduite avancé a pour but de permettre la conduite autonome d'un véhicule automobile, c'est-à-dire sans intervention de la part du conducteur. En particulier, un dispositif d'assistance à la conduite avancé peut servir à anticiper un chemin et/ou une trajectoire d'un véhicule automobile. Dans la présente demande, le chemin d'un véhicule sera considéré comme une forme géométrique correspondant à la progression du véhicule entre un point de départ et un point d'arrivée. La trajectoire d'un véhicule sera considérée comme l'évolution temporelle de la position du véhicule entre le point de départ et le point d'arrivée. [0003] Les véhicules dits « autonomes » ou à conduite partiellement assistée nécessitent un modèle riche de l'environnement du véhicule afin de permettre à un algorithme de prendre des décisions. Cela est rendu possible grâce à différents capteurs proprioceptifs, tels qu'un accéléromètre, un gyromètre, etc..., et extéroceptifs, tels que les caméras, radars, lidars, ultrasons, etc..., ainsi que des procédés de fusion de données configurés pour traiter l'information reçue et calculer l'état (position, vitesse, accélération, lacet, etc...) du véhicule et des objets enviromuutt. [0004] Dans de tels véhicules, il est ainsi indispensable de prédire les mouvements du véhicule égo ainsi que d'autres objets mobiles ou immobiles présents dans l'environnement proche dudit véhicule et capables de devenir des obstacles lorsque la trajectoire du véhicule égo vient interférer avec la trajectoire d'un objet. [0005] Par exemple, dans les systèmes d'aide dits « automatic emergency steering » d'acronyme « AES » en termes anglo-saxons capables de détecter les obstacles et de procéder à un braquage d'urgence, la prédiction des trajectoires des objets mobiles permet d'analyser le risque de collision potentiel. [0006] De manière similaire, dans les systèmes d'aide dits « adoptive cruise control », d'acronyme « ACC » en termes anglo-saxons capables de réguler la vitesse et. de maintenir automatiquement une distance de sécurité par rapport au véhicule qui 2 précède, il est nécessaire de sélectionner des véhicules cibles par rapport auxquels on adapte la vitesse et la distance du véhicule ego. Ainsi, la prédiction de la trajectoire du véhicule égo permet de sélectionner le véhicule cible de manière plus fiable, ainsi que la détection anticipative des insertions ou sorties d'objets dans le champ de la trajectoire du véhicule égo, dits respectivement « cut-in » ou « cut-out » en termes anglo-saxons. [0007] On connait des procédés de prédiction des trajectoires bases sur une modélisation de la dynamique du véhicule avec un modèle mathématique. Toutefois, de tels procédés ne prennent pas en compte l'information du contexte, notamment les informations provenant des panneaux routiers, telles que les limites de vitesse autorisées, les panneaux stop, les feux de signalisation, etc.... Les procédés actuels prédisent des trajectoires peu probables et peu fiables, cc qui est particulièrement dangereux pour les véhicules complètement automatises dits autonomes. [0008] Par exemple, lorsque l'information sur les lignes de la route n'est pas disponible, il est connu d'utiliser des modèles cinématiques et un procédé basé sur une accélération constante. Toutefois, la considération de l'accélération constante pendant le temps de la prédiction de la trajectoire ne prend pas en compte le contexte du véhicule. Le véhicule peut ainsi se retrouver à 160km/h alors que la route sur laquelle il circule a une limitation de vitesse à 130km/h. [0009] On peut se référer au document EP 3 018 026 qui décrit la prédiction d'une tra- jectoire latérale avec prise en compte de la voie de circulation. Toutefois, un tel procédé ne permet que la prédiction d'une trajectoire latérale. [0010] Il existe donc un besoin d'optimiser la prédiction des trajectoires des véhicules au- tomobiles. [0011] Au vu de ce qui précède, l'invention a pour but de permettre la planification d'un chemin et/ou d'une trajectoire de véhicule automobile en palliant les inconvénients précités. [0012] La présente invention a pour objet un procédé de prédiction de la trajectoire d'un véhicule égo dans lequel on récupère des données provenant de capteurs extéroceptifs et proprioceptifs tels que notamment un radar frontal, deux radars latéraux et une caméra frontale capable de détecter des panneaux de circulation ; on modélise un environnement du véhicule égo en fonction d'un ensemble desdites données récupérées ; on prédit la trajectoire du véhicule égo et au moins une trajectoire d'objet mobile situé dans l'environnement modélisé du véhicule égo en générant une trajectoire prédite du véhicule égo pendant une durée déterminée, par exemple comprise entre 2s et 5s, en prenant en compte l'environnement modélisé du véhicule afin de prédire efficacement des trajectoires du véhicule égo et des autres usagers de la route, on sélectionne un objet cible ; et on transmet la valeur de prédiction de trajectoire à l'unité de contrôle du 3 véhicule automobile égo. [0013] Ainsi, on peut prédire la trajectoire du véhicule égo en prenant en compte l'information du contexte, notamment les informations provenant des panneaux routiers, telles que les limites de vitesse autorisées, les panneaux stop, les feux de signalisation, etc.... [0014] Avantageusement, lors de la prédiction de la trajectoire, on calcule un point d'intérêt, défini comme le point où l'hypothèse d'accélération constante n'est plus valable. [0015] Ce point représente le moment où l'accélération n'est plus constante et où le véhicule cible entre dans une phase où la dérivée de r accélération, appelée «jerk », est maximale et fait converger l'accélération vers zéro. [0016] Par exemple, pour calculer le point d'intérêt, on tient compte des contraintes environ- nementales et du véhicule égo. [0017] Ainsi, on calcule l'évolution du véhicule en fonction d'un vecteur d'états du véhicule et d'un vecteur des signaux d'entrée du système. [0018] Par exemple, pour calculer le point d'intérêt, on prend en compte les conditions aux limites de la trajectoire. [0019] Ces conditions sont définies avec des valeurs du vecteur d'états aux points initial et final de la trajectoire. Le point initial est défini par l'état actuel du véhicule, donné par le module de modélisation de l'environnement du véhicule à partir des informations récupérées par le module de récupération des données. Ainsi, il est possible de définir un point final de la trajectoire, correspondant à un point d'arrêt dans le cas de la détection d'un panneau de signalisation Stop ou d'un feu rouge. [0020] Par exemple, pour calculer le point d'intérêt, on prend également en compte les conditions aux limites du système. Ces conditions correspondent aux limites du vecteur d'état calculé lors du calcul de l'évolution du véhicule. En d'autres termes, il s'agit des limites physiques et cinématiques du véhicule, c'est-à-dire les limitations de vitesse, l'accélération, la dérivée d'accélération, etc .... [0021] Par exemple, pour calculer le point d'intérêt, on prend également en compte la fonction de coût. [0022] Lors de la prédiction des trajectoires, on peut calculer une trajectoire paramétrée pour discrétiser l'état et l'entrée du système. [0023] Par exemple, lors du calcul d'une trajectoire paramétrée, on paramètre la trajectoire en fonction de l'état initial et de l'entrée par discrétisation sur k intervalles. [0024] Selon un second aspect, l'invention concerne un système de prédiction de la tra- jectoire d'un véhicule égo comprenant un module de récupération des données provenant de capteurs extéroceptifs et proprioceptifs, tels que notamment un radar frontal, deux radars latéraux et une caméra frontale capable de détecter des panneaux de circulation ; un module de modélisation de l'environnement du véhicule égo en fonction de l'ensemble desdites données récupérées ; un module de prédiction de la trajectoire du véhicule égo et d'au moins une trajectoire d'objet mobile situé dans l'environnement modélisé dudit véhicule égo en générant les trajectoires pendant une durée déterminée, par exemple comprise entre 2s et 5s, en prenant en compte l'environnement du véhicule modélisé afin de prédire efficacement des trajectoires du véhicule égo et des autres usagers de la route. Le système comprend en outre un module de sélection d'un objet cible ; et un module de transmission des valeurs de prédiction de trajectoire à l'unité de contrôle du véhicule automobile égo. [0025] Avantageusement, le module de prédiction de la trajectoire comprend un module de calcul d'un point d' intérêt, défini comme le point où l'hypothèse d'accélération constante n'est plus valable en fonction des contraintes environnementales et du véhicule égo, des conditions aux limites de la trajectoire et des conditions aux limites du système. [0026] Ainsi, on calcule l'évolution du véhicule en fonction d'un vecteur d'états du véhicule et d'un vecteur des signaux d'entrée du système [0027] Les conditions aux limites de la trajectoire sont définies avec des valeurs du vecteur d'états aux points initial et final de la trajectoire. Le point initial est défini par l'état actuel du véhicule, donné par le module de modélisation de l'environnement du véhicule à partir des informations récupérées par le module de récupération des données. [0028] Ainsi, il est possible de définir un point final de la trajectoire, par exemple cor- respondant au point d'arrêt dans le cas de la détection d'un panneau de signalisation Stop ou d'un feu rouge. [0029] Les conditions aux limites du système con-espondent aux limites du vecteur d'état calculé lors du calcul de l'évolution du véhicule. En d'autres termes, il s'agit des limites physiques et cinématiques du véhicule, c'est-à-dire les limitations de vitesse, d'accélération, de la dérivée d'accélération, etc ... [0030] Pour calculer le point d'intérêt, on peut prendre également en compte la fonction de coût. [0031] Le point d'intérêts représente le moment où l'accélération n'est plus constante et où le véhicule cible entre dans une phase où la dérivée de l'accélération, appelée « jerk », est maximale et réduit l'accélération jusqu'à zéro. [0032] Selon un troisième aspect, l'invention concerne un véhicule automobile autonome comprenant un système de prédiction de la trajectoire tel que décrit ci-dessus. [0033] D'autres buts, caractéristiques et avantages de l'invention apparaîtront à la lecture de la desciiption suivante, donnée uniquement à titre d'exemple non limitatif, et faite en référence aux dessins annexés sur lesquels : [0034] [fig.1] représente schématiquement un système de prédiction de la trajectoire d'un véhicule égo selon un mode de réalisation de l'invention ; [0035] [fig.2] illustre en détails le module de prédiction de la trajectoire du système de la figure 1 ; et [0036] [fig.3] illustre un organigramme d'un procédé de prédiction de la trajectoire d'un véhicule égo selon un mode de réalisation de l'invention mis cn oeuvre parie système de la figure 1. [0037] Sur la figure 1, on a représenté de manière très schématique un système 10 de prédiction de la trajectoire d'un véhicule égo. [0038] Le système 10 comprend un module 12 de récupération des données provenant de capteurs extéroceptifs et proprioceptifs tels que notamment un radar frontal, deux radars latéraux et une caméra frontale capable de détecter des panneaux de circulation, ainsi que des gyromètres et encodeurs. [0039] Le système 10 comprend en outre un module 14 de modélisation de l'environnement du véhicule égo recevant l'ensemble des données provenant du module 12 de récupération des données. [0040] Le système 10 comprend également un module 16 de prédiction de la trajectoire du véhicule égo et des objets mobiles situés dans renvironnement dudit véhicule égo et un module 18 de sélection de l'objet cible. [0041] Enfin, le système 10 comprend un module 20 de transmission de la valeur de prédiction de trajectoire à l'unité de contrôle (non représentée) du véhicule automobile égo. [0042] La figure 2 illustre en détails le module 16 de prédiction de la trajectoire du véhicule égo et des objets mobiles situés dans l'environnement dudit véhicule égo. [0043] Le module 16 est configuré pour générer une trajectoire prédite pendant une durée Tpred déterminée, par exemple comprise entre 2s et 5s en prenant en compte les informations contextuelles en forme des contraintes dans le problème d'optimisation, provenant du module 12 de récupération des données afin de prédire efficacement des trajectoires du véhicule égo et des autres usagers de la route. [0044] Le module 16 de prédiction des trajectoires comprend à cet effet un module 22 de calcul d'un point d'intérêt, défini comme le point où l'hypothèse d'accélération constante n'est plus valable. Ce point représente le moment où l'accélération n'est plus constante et où le véhicule cible entre dans une phase pour laquelle la dérivée de l'accélération, appelée « jerk », est maximale en valeur absolue de manière à faire converger l'accélération vers zéro. [0045] Pour calculer ce point d'intérêt, le module 22 de calcul d'un point d'intérêt comprend un module 24 d'optimisation. [0046] Le module 24 d'optimisation tient compte des contraintes environnementales et d'un état du véhicule égo. Ainsi, le module 24 comprend un module 26 de calcul de 6 l'évolution du véhicule d(t)/dt en fonction d'un vecteur d'états 'E(t) du véhicule et d'un vecteur u(t) des signaux d'entrée du système selon l'équation différentielle du premier ordre ci-dessous : [0047] = (t), u(t)) (1) [0048] Avec: [0049] "g(t), le vecteur d'états du véhicule ; et [0050] u(1), le vecteur des signaux d'entrée du système. [0051] Par exemple, le vecteur d'états "g(t) du véhicule s'écrit selon l'équation ci-dessous : [0052] = [ X , y, 9,14,y, a x, a 1,] (2) 100531 Avec: 100541 x, la position longitudinale du véhicule ; 100551 y, la position latérale du véhicule ; 100561 0, l'angle de lacet ; [0057] co, le taux de variation ; 100581 y, la vitesse absolue longitudinale ; 100591 ax, l'accélération absolue longitudinale ; et 100601 ay, l'accélération absolue latérale. 100611 En supposant, le vecteur d'état u(t) du système comme égal à la dérivée de l'accélération longitudinale j(x), on peut écrire l'équation 1 sous la forme suivante : 100621 X ycos (e) 0 (3) vsin (0 ) 0 P v 0 P a x ± 0 ix a, 0 a, 0 1 2p va, [0063] Le module 24 d'optimisation comprend en outre un module 28 de détermination des conditions aux limites de la trajectoire. Ces conditions sont définies avec des valeurs du vecteur d'états et) aux points initial et final de la trajectoire. Le point initial 'ei) est défini par l'état actuel du véhicule, donné par le module 14 de modélisation de l'environnement du véhicule à partir des informations récupérées par le module 12 de récupération des données. [0064] Ainsi, il est possible de définir un point final e de la trajectoire. correspondant par exemple à un point d'arrêt dans le cas d'une détection de panneau de signalisation Stop ou d'un feu rouge. [0065] Le module 24 d'optimisation comprend également un module 30 de détermination des conditions aux limites du système. Ces conditions correspondent aux limites du 7 vecteur d'état calculé par le module 26 de calcul de l'évolution du véhicule. En d'autres termes, il s'agit des limites physiques et cinématiques du véhicule, c'est-à-dire les limitations de vitesse, d'accélération, de la dérivée d'accélération, etc [0066] Les limites du véhicule sont ainsi bornées selon les équations suivantes : [0067] Xmin REVENDICATIONS[Revendication 1] Procédé (40) de prédiction de la trajectoire d'un véhicule égo dans lequel : - on récupère des données provenant de capteurs extéroceptifs et proprioceptifs ; - on modélise un environnement du véhicule égo en fonction d'un ensemble desdites données récupérées ; - on prédit la trajectoire du véhicule égo et au moins une trajectoire d'objet mobile situé dans l'environnement modélisé du véhicule égo en générant une trajectoire prédite du véhicule ego pendant une durée (Tpred) déterminée en prenant en compte l'environnement modélisé du véhicule ; - on sélectionne un objet cible ; et - on transmet la valeur de prédiction de trajectoire à l'unité de contrôle du véhicule automobile égo. [Revendication 2] Procédé selon la revendication 1, dans lequel, lors de la prédiction de la trajectoire, on calcule un point d'intérêt, défini comme le point où l'hypothèse d'accélération constante n'est plus valable. [Revendication 3] Procédé selon la revendication 2, dans lequel pour calculer le point d'intérêt, on tient compte des contraintes environnementales et du véhicule égo. [Revendication 4] Procédé selon la revendication 2 ou 3, dans lequel pour calculer le point d'intérêt, on tient compte des conditions aux limites de la trajectoire. [Revendication 5] Procédé selon l'une quelconque des revendications 2 à 4, dans lequel pour calculer le point d'intérêt, on prend également en compte les conditions aux limites du système. [Revendication 6] Procédé selon l'une quelconque des revendications 2 à 5, dans lequel pour calculer le point d'intérêt, on prend également en compte une fonction de coût. [Revendication 7] Procédé selon l'une quelconque des revendications précédentes, dans lequel lors de la prédiction des trajectoires, on calcule une trajectoire paramétrée pour discrétiser l'état et l'entrée du système. [Revendication 8] Procédé selon la revendication 7, dans lequel lors du calcul d'une tra- jectoire paramétrée, on paramètre la trajectoire en fonction de l'état initial et de l'entrée discrétisés sur k intervalles. [Revendication 9] Système (10) de prédiction de la trajectoire d'un véhicule égo comprenant : 11 [Revendication 10] - un module (12) dc récupération des données provenant de capteurs extéroceptifs et proprioceptifs ; [Revendication 11] - un module (14) dc modélisation de renvironnement du véhicule égo en fonction de l'ensemble desdites données récupérées ; - un module (16) dc prédiction de la trajectoire du véhicule égo et d'au moins une trajectoire d'objet mobile situé dans l'environnement dudit véhicule égo en générant les trajectoires pendant une durée (Tpred) déterminée en prenant en compte l'environnement du véhicule modélisé ; - un module (18) dc sélection d'un objet cible ; et - un module (20) dc transmission des valeurs dc prédiction de trajectoire à l'unité dc contrôle du véhicule automobile ego. 10. Système selon la revendication 9, dans lequel, le module (16) de la prédiction de la trajectoire comprend un module (22) de calcul d'un point d'intérêt, défini comme le point où l'hypothèse d'accélération constante n'est plus valable en fonction des contraintes environnementales et du véhicule égo, des conditions aux limites de la trajectoire et des conditions aux limites du système. Véhicule automobile (2) comprenant un système de prédiction de la trajectoire d'un véhicule égo selon l'une quelconque des revendications 9 ou 10.