Brevet FR3085926A1 — publié le 20200320

Procédé de détermination d'une courbe image d'un marquage au sol pour un véhicule autonome ou partiellement autonome L'invention se rapporte au domaine des systèmes d'aide à la 5 conduite équipant les véhicules automobiles autonomes ou partiellement autonomes. Les systèmes d'aide à la conduite, souvent dénommés sous l'acronyme anglais ADAS (pour « Advanced driver-assistance systems »), ont pour but d'alléger la charge du conducteur, notamment en le libérant de certaines tâches, en améliorant son attention et/ou sa perception de l'environnement, en 10 détectant certains risques, en effectuant automatiquement des actions en réponse à la détection de ces risques, etc. Pour les véhicule autonomes ou partiellement autonomes, la conduite peut être entièrement déléguée au véhicule qui est équipé de capteurs lui permettant de percevoir l'environnement, et notamment les véhicules 15 environnants. Cette perception de l'environnement par le véhicule permet de prévenir les risques d'accidents en garantissant le respect de règles prédéfinies, comme par exemple celle d'imposer que le véhicule se maintienne à une distance minimale du véhicule qui le précède. Une fonction primordiale que doit assurer le système de conduite 20 automatisé d'un véhicule autonome est la détection et le suivi des marquages au sol, fonction qui permet notamment de déterminer et garantir un positionnement latéral du véhicule adéquat au sein d'une voie de circulation. La détection et le suivi des lignes de délimitation est assuré au moyen d'au moins un capteur tel qu'une caméra. 25 Le bon fonctionnement du véhicule dans un mode de conduite autonome ou dans un mode de conduite sous assistance repose sur la bonne perception de la trajectoire des lignes délimitant la voie de circulation du véhicule ainsi que, le cas échéant, les voies adjacentes. La présente invention a pour objet de proposer un procédé de 30 détermination de la trajectoire des lignes délimitant une voie de circulation dont la précision est améliorée. À cet effet, l'invention concerne un procédé de de détermination de la trajectoire d'une ligne de délimitation d'une voie de circulation sur laquelle circule un véhicule hôte, le procédé comportant les étapes de : 2 - déterminer, dans un repère cartésien fixe par rapport au véhicule hôte, une courbe représentative de la géométrie de la route, sous la forme d'un polynôme, de préférence un polynôme du troisième degré ; - déterminer un ensemble de points représentatifs des délimitations de la voie de circulation du véhicule hôte, et, le cas échéant, de chaque voie de circulation adjacente, chaque point représentatif étant défini par un couple de coordonnées (xi, yi) ; - pour chaque point représentatif de chacune des lignes de délimitation, des coordonnées (xoi, yoi) compensées sont calculées, de telle sorte que la distance entre le point de coordonnées (xoi, yoi) et le point d'abscisse xi appartenant à la courbe représentative de la géométrie de la route est égale à la longueur de la projection du point représentatif considéré sur la courbe représentative de la géométrie de la route. Ainsi, le procédé conforme à l'invention permet de déterminer une courbe compensée, qui est l'image de la courbe des lignes de délimitation telle qu'acquise par le ou les capteurs, cette courbe compensée étant parallèle à la courbe de la géométrie de la route sur laquelle circule le véhicule. Sans le procédé conforme à l'invention, on obtient des courbes qui ne sont pas parallèles à la géométrie de la route. Dans une réalisation, le repère cartésien est défini comme le repère dont le centre (0) est situé à l'extrémité à l'extrémité arrière du véhicule hôte, dont l'axe des abscises (OX) est inclus dans le plan médian du véhicule hôte et l'axe des ordonnées (OY) est parallèle à un axe transversal du véhicule hôte. Dans une réalisation, la courbe est déterminée sous la forme d'un 25 polynôme du type : yc(xj= C3 Xc3 ± C2 Xc2 ± C1 Xc Co ; )(G E [XcLower,XcUpper] où Xciower et Xc_upper représentent les limites inférieure et supérieure de la courbe selon l'axe (OX). Dans une réalisation, le couple de coordonnées de chaque point 30 représentatif est défini par la fonction suivante : Ft(xt) = Yi ; xi E [Xi_Lower Xi_Upperi- Dans une réalisation, le procédé comporte une étape consistant à déterminer la projection (di) de chaque point représentatif de chaque ligne de délimitation, de coordonnées (xi, Ft (xi)) sur la courbe de la géométrie de la route 35 yc(xi), au moyen de la formule suivante : di = (Ft(xi) - y,- (xi)) * cos( atan (xi )) ) dans laquelle la fonction yc'(xi) est la dérivée de la fonction MA) représentant la géométrie de la route, pour le point d'abscisse xi. Dans une réalisation, le procédé comporte une étape consistant à 5 déterminer les coordonnées compensées xpi et yoi au moyen des formules suivantes : Yi(xi) xot = x, d, 1/1 + y' jx32 1 yoi = Ye(ii) + de11+ y' c(xi)2 10 Dans une réalisation, le procédé comporte une étape consistant à déterminer, pour chaque point représentatif de chaque ligne de délimitation, les coordonnées compensées xo; et yoi afin d'obtenir une courbe compensée correspondant à un polynôme du troisième degré, sous la forme : Y f fset_curve (X) = A3 x3 A2X` + Al A0 ;x E [r01 r ar -041 15 L'invention concerne également un produit programme d'ordinateur comprenant des instructions qui, lorsque le programme est exécuté par un ordinateur, conduisent celui-ci à mettre en oeuvre les étapes du procédé tel que défini ci-dessus. L'invention concerne également un système de conduite automatisé 20 comportant un calculateur, des capteurs et des actionneurs agencés pour mettre en oeuvre le procédé tel que défini ci-dessus. L'invention concerne également un véhicule automobile équipé d'un système de conduite automatisé tel que défini ci-dessus et/ou mettant en oeuvre un procédé tel que défini plus haut. La présente invention sera mieux comprise à la lecture de la description détaillée qui suit, faite en référence au dessins annexés, dans lesquels : - la figure 1 représente un véhicule équipé d'un système de conduite automatisé permettant la mise en oeuvre d'un procédé conforme à l'invention ; - les figures 2 à 10 détaillent la mise en oeuvre des différentes étapes d'un procédé conforme à l'invention. 4 La figure 1 représente un véhicule partiellement ou totalement autonome, qui est équipé d'un système de conduite automatisé 2. Dans la suite de la présente description ce véhicule sera dénommé véhicule hôte 1. Le système de conduite automatisé 2 comporte notamment un calculateur 10, des 5 actionneurs 12, ainsi qu'une pluralité de détecteurs, dans l'exemple une pluralité de capteurs 14a, 14b, 16a, 16b, 18 répartis sur l'avant, l'arrière et les côtés du véhicule hôte 1. Ces capteurs peuvent inclure un ou plusieurs des types de capteurs suivants : capteurs à ultrasons, radars, lidars, caméras à vision de jour, caméras à vision de nuit, etc. Le système de conduite automatisé 2 comporte 10 dans l'exemple quatre caméras 18 (soit une caméra avant, une caméra arrière et deux caméras latérales) et une pluralité de capteurs 14a, 14b, 16a, 16b de type capteur à ultrasons et/ou radar et/ou lidar. Le calculateur 10 reçoit les données fournies par l'ensemble des capteurs 14a, 14b, 16a, 16b et par l'ensemble des caméras 18. 15 Grâce à l'ensembles de ces capteurs, le calculateur 10 est apte à détecter la présence d'obstacles dans l'environnement du véhicule, et en particulier la présence de véhicules dans cet environnement, que ce soit sur la voie courante du véhicule hôte 1 ou sur les voies adjacentes. Au moins un de ces capteurs est configuré pour détecter les marquages au sol délimitant la voie 20 de circulation sur laquelle se trouve le véhicule hôte ainsi que, le cas échéant, les voies adjacentes. Le calculateur 10 est par ailleurs relié à une pluralité d'actionneurs 12, qui comportent des dispositifs aptes à agir notamment sur la direction, l'accélérateur et le système de freinage du véhicule hôte, afin d'en contrôler 25 l'allure et la trajectoire. On décrit ci-après la mise en oeuvre du procédé conforme à l'invention, en relation avec les figures 2 à 10. Le procédé conforme à l'invention comporte une étape d'acquisition des données fournies par un ou plusieurs capteurs, dans l'exemple une caméra 30 18 et des capteurs radar 14a, 14b. Les données fournies par les capteurs sont transposées au cours d'une étape 32 dans un repère cartésien (représenté à la figure 2), fixe par rapport au véhicule hôte 1 et défini comme suit : - le centre O du repère se situe au niveau de l'extrémité arrière du véhicule, dans le plan longitudinal médian du véhicule hôte 1 ; - l'axe OX est parallèle à l'axe longitudinal du véhicule et orienté vers l'avant du véhicule hôte 1 ; 5 - l'axe OY est parallèle à l'axe transversal du véhicule et orienté vers la gauche du véhicule hôte 1. La transposition des données brutes fournies par les capteurs permet d'obtenir un modèle brut de la route sur laquelle circule le véhicule hôte, 5 ce modèle comportant deux composantes : - la géométrie de la route, représentée par une courbe définie par un polynôme du troisième degré, donné par la fonction suivante : Yc(xc)= C3 xç3 + C2 Xc2 + Cl Xc CO Xc E [xcLower Xcilpperl Où )(ci., et Xc_upper représentent les limites inférieure et supérieure 10 du polynôme selon l'axe OX. les délimitations de la voie de circulation du véhicule hôte, et, le cas échéant des voies de circulation adjacentes, constitué par un ensemble de points représentatifs de coordonnées (xi, yi), où y; est donné par la fonction suivante : 15 Ft(xt) = yi ; xi E EXcLower, XrUpperl La figure 3 montre les données obtenues, à savoir : la géométrie de la route, représentée par la courbe R ; la géométrie des lignes délimitant la voie de circulation du véhicule hôte 1 et des voies adjacentes, en l'espèce : 20 o la délimitation gauche de la voie du véhicule hôte 1, représentée par l'ensemble des points représentatifs Bi, B2, B3, B4, o la délimitation droite de cette même voie, représentée par l'ensemble des points représentatifs Cl, C2, Ca, Ca, 25 o la délimitation gauche d'une voie adjacente située à gauche de la voie de circulation du véhicule hôte 1, matérialisée par les points représentatifs Al, A2, A3, A4, o la délimitation droite d'une voie adjacente située à droite de la voie de circulation du véhicule hôte 1, matérialisée 30 par les points représentatifs Di, D2, D3, Da. On détaille ci-après les étapes suivantes du procédé objet de l'invention, qui consiste à transformer les données relatives aux lignes délimitant les différentes voies, de manière à obtenir une image de ces lignes qui soit parallèles à la courbe de la géométrie de la route. Ainsi, pour chaque point (xi, 35 Ft (xi)) de chacune des lignes de délimitation, des coordonnées compensées xo; 6 et yoi sont calculées, de telle sorte que la distance entre le point de coordonnées (x0i, yoi) et le point de coordonnées (xi, yc(xi)) appartenant à la courbe R de la géométrie de la route est égale à la longueur de la projection du point de coordonnées (xi, Ft (xi)) sur la courbe de la géométrie de la route. 5 La figure 3 montre une étape du procédé, qui consiste à déterminer la projection di d'un des points d'une ligne (dans l'exemple le point A3), de coordonnées (xi, Ft (xi)) sur la courbe R représentative de de la géométrie de la route yc(xi). Cette projection correspond à la longueur de la ligne partant du point de la ligne de coordonnées (xi, Ft (xi)) et perpendiculaire à la tangente au point xi 10 à la courbe R représentative de la géométrie de la route yc(xi). L'étape suivante, illustrée par les figures 4 et 5, consiste à déterminer le point de coordonnées (x0i, yoi), ce qui implique les sous-étapes détaillées ci-après. Au cours d'une première sous-étape (cf. figure 4), la projection di est 15 d'abord déterminée en utilisant un premier triangle rectangle, dont un des sommets est le point de coordonnées (xi, Ft(xi)), au moyen de la formule suivante : di = ay cos(a) La distance 4y correspond à la différence entre la coordonnée y du point de la ligne de coordonnées (xi, Ft(xi)) et le point de la courbe de la géométrie de la route de coordonnées (xi, yc(xi)) pour l'abscisse xi, comme explicité par la formule suivante : ay = Ft(;) - yc(xi) L'angle a correspond à la pente de la tangente à la courbe de la géométrie de la route au point d'abscisse xi, comme explicité par la formule 30 suivante : a = atan(37,r(xi ) ) Dans cette formule, la fonction yc'(xi) est la dérivée de la courbe de la géométrie de la route MA) pour le point d'abscisse xi. 35 Finalement, on obtient la formule de calcul de la projection di suivante : 20 25 7 di = (Ft(xi)- yc(xi)) * cos( atan (xi )) ) Au cours d'une seconde sous-étape (cf. figure 5), les coordonnées xoi et Yoi sont calculées en utilisant un deuxième triangle rectangle : Yoi Yc (xi) = di * cos (atan(Y' c(xi))) x - xoi = di * sin (atan(y'c(xi))) étant donné que : cos(altan (A)) = + A2 sin(atan (A)) - A V1 + A2 On obtient ainsi les formules permettant de calculer les coordonnées 10 xoi, Yoi : Y (xi) xoi = x, ci, + y c(xi)2 1 Yoi = Yc(x,) + d, La figure 6 illustre l'application des deux formules précédentes à 15 chaque point de chaque ligne de délimitation. Dans l'exemple de la figure 6, pour chacun des points Ai à A4, on détermine un couple de coordonnées (xoi, yol), (x.2, y02), (x03, y03), (x04, y04). On notera qu'un minimum de quatre points est requis afin de pouvoir obtenir une courbe compensée, donnée par une fonction correspondant à un polynôme du troisième degré, comme explicité par la formule 20 suivante : Y fset_nnwe (x) = A3 x3 + A2x2 Al x + A0 ; x E [xin , La figure 7 montre la courbe compensée ainsi déterminée. Cette courbe correspond à l'image de la ligne de délimitation qui respecte les 25 contraintes imposées par la ligne de délimitation en termes de distance latérale par rapport au véhicule hôte 1 et celles imposée par la géométrie de la route, qui est l'image de la trajectoire de la route. 1 11 + y' c(x,)2 8 La figure 8 montre l'étape finale de la génération de toutes les limites des voies de circulation (courbes CA, Cg, Cc, et Co), dans le cas d'une route à trois voies de circulation adjacentes. On notera que le procédé conforme à l'invention permet de prendre 5 en compte les cas dans lesquels les lignes de délimitation ne sont pas parallèles, et notamment dans les cas de fusion ou de séparation de voies. La figure 9 illustre par exemple un cas de rapprochement des lignes de délimitations gauche et droite, ce rapprochement étant consécutif à la fusion de deux voies. La figure 10 illustre un cas d'écartement des lignes de délimitations gauche et droite, REVENDICATIONS1. Procédé de détermination de la trajectoire d'une ligne de délimitation d'une voie de circulation sur laquelle circule un véhicule hôte (1), le 5 procédé comportant les étapes de : - déterminer, dans un repère cartésien fixe par rapport au véhicule hôte (1), une courbe (R) représentative de la géométrie de la route, sous la forme d'un polynôme, de préférence un polynôme du troisième degré ; - déterminer un ensemble de points représentatifs (Ai-A4, 10 Da) des délimitations de la voie de circulation du véhicule hôte (1), et, le cas échéant, de chaque voie de circulation adjacente, chaque point représentatif étant défini par un couple de coordonnées (xi, yi) ; - pour chaque point représentatif (Ai-Adt, Di-D4) de chacune des lignes de délimitation, des coordonnées (xoi, yoi) compensées sont 15 calculées, de telle sorte que la distance entre le point de coordonnées (xoi, yoi) et le point d'abscisse xi appartenant à la courbe (R) représentative de la géométrie de la route est égale à la longueur de la projection (cli) du point représentatif considéré sur la courbe (R) représentative de la géométrie de la route. 20 2. Procédé selon la revendication précédente, dans lequel le repère cartésien est défini comme le repère dont le centre (0) est situé à l'extrémité à l'extrémité arrière du véhicule hôte, dont l'axe des abscises (OX) est inclus dans le plan médian du véhicule hôte (1) et l'axe des ordonnées (OY) est parallèle à un axe transversal du véhicule hôte (1). 25 3. Procédé selon l'une des revendications précédentes, dans lequel la courbe (R) est déterminée sous la forme d'un polynôme du type : ye(xe)=--- C3 Xe3 + C2 Xe2 + C1 Xe + Co ; Xe E Xe_Lower , Xeupperl où Xciower et Xc_upper représentent les limites inférieure et supérieure de la courbe selon l'axe (OX). 30 4. Procédé selon l'une des revendications précédentes, dans lequel le couple de coordonnées de chaque point représentatif (A1-A4, B1-E34, Ci-C4, Di-Da) est défini par la fonction suivante : Ft(xi) = .Yi ; xi E [xi_Lower Xi_Upperi- 5. Procédé selon la revendication précédente, comportant une étape 35 consistant à déterminer la projection (di) de chaque point représentatif (Ai-A4, 10 Bi-B4, Ci-C4, D1-D4) de chaque ligne de délimitation, de coordonnées (xi, Ft (xi)) sur la courbe (R) de la géométrie de la route yc(x), au moyen de la formule suivante : cli = Ft(xi) - yc(xi)) * cos( atan (Mxi )) ) dans laquelle la fonction yc'(x) est la dérivée de la fonction MA) représentant la géométrie de la route, pour le point d'abscisse xi. 6. Procédé selon la revendication précédente, comportant une étape consistant à déterminer les coordonnées compensées xo; et yoi au moyen des formules suivantes : yoi Yc(xi) = di* cos (atan(y' c(xi))) xi - x Gi = di * sin (atan(y'c(xi))) 7. Procédé selon la revendication précédente, comportant une étape consistant à déterminer, pour chaque ligne de délimitation, les coordonnées compensées x0; et yoi afin d'obtenir une courbe compensée correspondant à un 15 polynôme du troisième degré, sous la forme : Yof fset_curve (x) = A3 x3 + A2x2 ± Al X + A0 ; X E rx,01 ,c041 8. Produit programme d'ordinateur comprenant des instructions qui, lorsque le programme est exécuté par un ordinateur, conduisent celui-ci à mettre en oeuvre les étapes du procédé selon l'une des revendications 1 à 4. 20 9. Système de conduite automatisé (2) comportant un calculateur (10), des capteurs (14a, 14b, 16a, 16b, 18) et des actionneurs (12) agencés pour mettre en oeuvre le procédé conforme à l'une des revendications 1 à 4. 10. Véhicule automobile (1) équipé d'un système de conduite automatisé (2) conforme à la revendication précédente et/ou mettant en oeuvre 25 un procédé conforme à l'une des revendications 1 à 4.