FR2985971A1

FR2985971A1 - METHOD FOR CORRECTING THE TRACK OF A MOTOR VEHICLE AND DEVICE FOR CORRECTING THE TRACK OF AN ASSOCIATED MOTOR VEHICLE

Info

Publication number: FR2985971A1
Application number: FR1250529A
Authority: FR
Inventors: Marc Campo
Original assignee: Peugeot Citroen Automobiles SA
Current assignee: PSA Automobiles SA
Priority date: 2012-01-19
Filing date: 2012-01-19
Publication date: 2013-07-26
Anticipated expiration: 2032-01-19
Also published as: WO2013107978A1; CN104245463A; EP2804794A1; CN104245463B; FR2985971B1

Abstract

L'invention concerne essentiellement un procédé de correction de trajectoire d'un véhicule (10) automobile se déplaçant sur une voie (11) de circulation caractérisé en ce qu'il comporte les étapes suivantes : - étape (100) d'acquisition de paramètres de géométrie de la voie (11) de circulation et de la position du véhicule (10) automobile sur la voie (11) de circulation, - étape (102) de détermination de l'angle (alpha) de cap correspondant à l'angle entre l'axe (A) longitudinal du véhicule (10) automobile et une ligne (30, 31) de la voie (11) de circulation, - étape (103) de détermination de la vitesse du véhicule (10) automobile, - étape (104) de détermination de la durée restante avant le franchissement de la ligne (30, 31) de la voie (11) de circulation par le véhicule (10) automobile, et - étape (106) de génération d'une consigne de dynamique du véhicule (10) en fonction de l'angle (alpha) de cap et de la durée restante avant le franchissement de la ligne (30, 31) de la voie (11) de circulation.The invention essentially relates to a method for correcting the trajectory of an automobile vehicle (10) traveling on a traffic lane (11), characterized in that it comprises the following steps: step (100) of acquiring parameters geometry of the traffic lane (11) and the position of the vehicle (10) on the traffic lane (11), - step (102) for determining the angle (alpha) of the heading corresponding to the angle between the longitudinal axis (A) of the vehicle (10) and a line (30, 31) of the road (11), - step (103) of determining the speed of the vehicle (10) automobile, - step (104) determining the remaining time before crossing the line (30, 31) of the road (11) of circulation by the vehicle (10) automobile, and - step (106) of generating a dynamic setpoint of the vehicle (10) as a function of the angle (alpha) of course and the time remaining before the crossing of the gne (30, 31) of the traffic lane (11).

Description

PROCEDE DE CORRECTION DE TRAJECTOIRE D'UN VEHICULE AUTOMOBILE ET DISPOSITIF DE CORRECTION DE TRAJECTOIRE D'UN VEHICULE AUTOMOBILE ASSOCIE [01] DOMAINE TECHNIQUE DE L'INVENTION [2] L'invention concerne un procédé de correction de trajectoire d'un véhicule ainsi qu'un dispositif de correction de trajectoire d'un véhicule associé. L'invention trouve une application particulièrement avantageuse dans le domaine de la sécurité et le domaine d'aide à la conduite de lo véhicules automobiles. [3] ETAT DE LA TECHNIQUE [4] Les véhicules automobiles comportent généralement un volant fixé sur une colonne du système de direction, qui est manoeuvré par le conducteur pour braquer les roues directrices de ce véhicule. Les systèmes 15 de direction comprennent habituellement un dispositif d'assistance qui génère une partie de l'énergie à fournir pour braquer les roues, de manière à réduire l'effort que doit délivrer le conducteur, en particulier dans les manoeuvres aux basses vitesses et à l'arrêt. [5] Certains systèmes de direction comportent une fonction d'aide à la 20 conduite pilotant par un calculateur de contrôle une motorisation qui agit sur cette direction, en délivrant un couple d'assistance spécifique sur la direction pour réaliser une aide au suivi de la voie de circulation, qui signale au conducteur un écart par rapport à la voie normale de circulation. Ces fonctions d'aide à la conduite portent par exemple le nom de « Prévention de 25 Franchissement Involontaire de Lignes » (PFIL), « Lane Keeping Support » (LKS) ou « Lane Keeping Assistance System » (LKAS). [6] Ainsi, le document FR2706604 présente un dispositif de détermination la trajectoire d'un véhicule pour un système d'aide à la navigation, comportant des moyens de mesure de l'angle de braquage du 30 volant du véhicule, des moyens de mesure de l'avancement du véhicule et des moyens de calcul de la trajectoire suivie par le véhicule à partir des informations d'angle de braquage et d'avancement. Cependant, ce dispositif nécessite la mise en oeuvre d'un système GPS, qui n'est pas assez précis dans certaines situations, notamment lorsque le véhicule passe à l'intérieur d'un tunnel. [07] Le document US2009153360 présente un dispositif et procédé de corrélation des données transmises par une caméra et des données exploitées par un procédé de maintien de ligne lorsque les fréquences de rafraichissement des données des deux systèmes diffèrent. Cependant cette méthode engendre des problèmes de sous échantillonnage. [08] Le document US2010191421 présente un dispositif et procédé de maintien de voie avec une architecture fonctionnelle incluant un traitement prioritaire en fonction des situations rencontrées, comme par exemple le besoin de stabiliser le véhicule, le besoin de maintenir le véhicule dans la voie et le besoin de maintenir la trajectoire. Cependant, le contrôle de la trajectoire est basé sur la notion d'écart latéral. [9] Le document W02011002345 présente un dispositif et un procédé de maintien de voie couplé avec une « Direction Assistée Electrique » (DAE) avec une boucle de contrôle fermée, dans lesquels la stratégie de contrôle est basée sur un algorithme bas niveau de type boucle ouverte. En outre, le couple de consigne est une fonction de l'accélération latérale demandée. [10] Le document DE102007061900 présente un dispositif de prévention d'un risque de franchissement de ligne, mais le mode de régulation est basé sur le couple moteur du véhicule. [11] Tous ces procédés de contrôle de trajectoire présentent néanmoins des problèmes de précision pour déterminer l'écart entre la trajectoire attendue du véhicule sur la voie de circulation et la trajectoire du véhicule mesurée sur cette voie de circulation. [12] OBJET DE L'INVENTION [13] L'invention a notamment pour but de remédier aux inconvénients de l'état de la technique en proposant un procédé de correction de trajectoire d'un véhicule corrigeant la trajectoire du véhicule en fonction d'un angle de cap correspondant à l'angle entre l'axe longitudinal du véhicule automobile et la ligne de la voie de circulation. [014] Plus précisément, l'invention concerne un procédé de correction de trajectoire d'un véhicule automobile se déplaçant sur une voie de circulation caractérisé en ce qu'il comporte les étapes suivantes : - étape d'acquisition de paramètres de géométrie de la voie de circulation et de la position du véhicule automobile sur la voie de circulation, - étape de détermination de l'angle de cap correspondant à l'angle entre l'axe longitudinal du véhicule automobile et une ligne de la voie de circulation, lo - étape de détermination de la vitesse du véhicule automobile, - étape de détermination de la durée restante avant le franchissement de la ligne de la voie de circulation par le véhicule automobile, et - étape de génération d'une consigne de dynamique du véhicule en fonction de l'angle de cap et de la durée restante avant le franchissement de la ligne 15 de la voie de circulation. [15] Selon une mise en oeuvre, les paramètres de géométrie de la voie de circulation comportent au moins un paramètre parmi : la position de la ligne du côté droit de la voie de circulation par rapport à une caméra, la position de la ligne du côté gauche de la voie de circulation par rapport à la 20 caméra, la courbure de la voie de circulation qui est en général identifiée sur une ligne extérieure. [16] Selon une mise en oeuvre, dans l'étape d'acquisition de paramètres de géométrie de la voie de circulation, les mesures des paramètres de géométrie de la voie de circulation sont émises à une 25 fréquence de 50 ms puis sont retardées de 50 ms. [17] Selon une mise en oeuvre, le procédé comporte en outre l'étape de calculer un indice de confiance après l'étape d'acquisition de paramètres de géométrie de la voie de circulation, cet indice de confiance étant calculé en fonction de la corrélation entre les mesures des paramètres de géométrie de 30 la voie de circulation et un modèle de lignes. [18] Selon une mise en oeuvre, l'angle de cap déterminé dans l'étape de détermination de l'angle de cap est calculé en fonction des paramètres de géométrie de la voie de circulation et de la position du véhicule. [19] Selon une mise en oeuvre, en cas d'impossibilité de corriger la trajectoire, l'étape de génération d'une consigne de dynamique du véhicule est supprimée et est remplacée par une alerte spécifique. [20] Selon une mise en oeuvre, l'étape de génération d'une consigne de dynamique du véhicule peut être inhibée par le conducteur du véhicule automobile lorsque ledit conducteur actionne un élément de commande du lo véhicule. [21] L'invention concerne en outre un dispositif de correction de trajectoire d'un véhicule automobile se déplaçant sur une voie de circulation mettant en oeuvre le procédé comportant : - une caméra, 15 - une unité de contrôle, - un capteur de vitesse de lacet, - un capteur de vitesse du véhicule automobile, - un système de direction actif, caractérisé en ce qu'il comporte des moyens pour corriger la trajectoire en 20 fonction de l'angle de cap du véhicule automobile correspondant à l'angle entre l'axe longitudinal du véhicule et une ligne de la voie de circulation. [22] BREVE DESCRIPTION DES FIGURES [23] L'invention sera mieux comprise à la lecture de la description qui suit et à l'examen des figures qui l'accompagnent. Ces figures ne sont 25 données qu'à titre illustratif mais nullement limitatif de l'invention. Elles montrent : [24] Figure 1 : un diagramme fonctionnel montrant les différentes étapes du procédé de correction de trajectoire d'un véhicule selon l'invention ; [25] Figure 2 : une représentation graphique de la trajectoire du centre de gravité du véhicule automobile sur une voie de circulation courbée corrigée selon le procédé de correction de trajectoire selon l'invention ; [26] Figure 3 : une représentation graphique de la trajectoire du centre de gravité du véhicule automobile sur une voie de circulation droite corrigée selon le procédé de correction de trajectoire selon l'invention ; [27] Figure 4 : une représentation schématique du véhicule automobile comportant le dispositif de correction de trajectoire d'un véhicule selon l'invention ; [028] Figure 5 : un diagramme fonctionnel montrant les différentes sous étapes de l'étape de génération de la consigne dynamique du procédé de correction de trajectoire d'un véhicule selon l'invention ; [029] Figure 6 : une représentation graphique d'un modèle de lignes estimant les paramètres de géométrie d'une voie de circulation. [030] Les éléments identiques, similaires ou analogues conservent la même référence d'une figure à l'autre. [31] DESCRIPTION D'EXEMPLES DE REALISATION DE L'INVENTION [32] La Figure 4 montre un véhicule 10 automobile situé sur une voie de circulation référencée 11. Ce véhicule 10 comporte des roues 35 directrices et un dispositif 12 de correction de trajectoire comportant une caméra 20, une unité 21 de contrôle, un capteur 22 de vitesse de lacet, un capteur 23 de vitesse du véhicule 10 automobile et un système 24 de direction actif permettant de diriger les roues 35 directrices. Le véhicule 10 automobile comporte en outre un axe A longitudinal. [33] Le système 24 de direction actif comporte une colonne 33 de direction. Un volant 34 est fixé à une extrémité de ladite colonne 33, ce volant 34 étant manoeuvré par le conducteur pour braquer les roues 35 directrices du véhicule 10. Le système 24 de direction actif comporte en outre un moyen de mesure de l'angle réel du volant Av et un dispositif 2 9859 71 6 d'assistance qui génère une partie de l'énergie à fournir pour braquer les roues 35. Ainsi le système 24 permet de réduire l'effort que doit délivrer le conducteur, en particulier dans les manoeuvres aux basses vitesses et à l'arrêt. 5 [034] De plus, ce système 24 de direction comporte un ensemble motorisé et calculateur de contrôle dudit ensemble motorisé agissant sur la direction du véhicule 10, en délivrant un couple d'assistance spécifique sur la direction pour réaliser une aide au suivi de la voie 11 de circulation. Ce couple d'assistance signale au conducteur un écart par rapport à la voie 11 lo de circulation. [35] L'ensemble motorisé comporte en particulier un moteur électrique ou des vérins hydrauliques du dispositif d'assistance, pour générer un couple dans un sens ou dans l'autre sur le système 24 de direction. Ce couple signale au conducteur une sortie de la voie 11 de circulation ou un risque de 15 sortie. [36] Lors de la mise en oeuvre du procédé selon l'invention, des paramètres de géométrie de la voie 11 de circulation et de la position du véhicule 10 automobile sur la voie 11 de circulation sont acquis dans une première étape 100 au moyen de la caméra 20. 20 [037] A cet effet, la caméra 20 filme en permanence des lignes 30, 31 blanches tracées au sol qui délimitent la voie 11 de circulation, afin de situer le véhicule 10 par rapport aux limites latérales de cette voie 11 et détecter des écarts latéraux du véhicule 10 par rapport à cette voie 11. [038] Plus précisément, la caméra 20 permet de connaître à chaque 25 instant la position de la ligne 30 du côté droit de la voie 11 de circulation par rapport à la caméra 20, la position de la ligne 31 du côté gauche de la voie 11 de circulation par rapport à la caméra 20 et la courbure de la voie 11 de circulation qui est en général identifiée sur une ligne extérieure. Par ligne 30 du côté droit et ligne 31 du côté gauche, on entend les lignes qui sont situées 30 sur la droite et sur la gauche de la caméra 20 lorsque cette caméra 20 filme ces lignes 30, 31. Les mesures des paramètres de géométrie de la voie 11 sont émises par la caméra 20 à une fréquence de 50 ms. Afin d'éviter les problèmes de sous échantillonnage, les mesures issues de la caméra 20 sont retardées de 50 ms lors de la transmission des mesures sur le réseau du véhicule 10. Ce retard est réduit en optimisant la bande passante du réseau du véhicule 10. [039] L'unité 21 de contrôle calcule dans une étape 101 un indice de confiance en fonction de la corrélation entre les mesures des paramètres de géométrie de la voie 11 provenant de la caméra 20 et un modèle de lignes. Ce modèle de lignes est basé par exemple sur un polynôme du deuxième ou du troisième ordre représentant la trajectoire d'une ligne 30, 31 dans le repère (X, Y) du véhicule 10 comme le montre la Figure 6. Le repère (X, Y) du véhicule 10 comporte un premier axe X étant confondu avec l'axe A longitudinal du véhicule 10 et un deuxième axe Y perpendiculaire au premier axe X. L'origine O du repère (X, Y) est positionnée au niveau du centre G de gravité du véhicule 10. On suppose que, dans le cas d'une voie standard, l'angle de cap et la courbure sont sensiblement équivalents pour les lignes 30, 31 qui présentent un écart constant entre elles. L'estimation de ces paramètres nous conduit à une mise en équation simple, vérifiée dans le cas des petits angles, telle que : y = yo + a - x +)c. 2 - x2 suivant laquelle, dans le repère (X, Y), x est l'abscisse d'un point P de la ligne 30, 31, y est l'ordonnée dudit point P de la ligne 30, 31, y0 est l'ordonnée du point de ladite ligne pour x=0, a est l'angle de cap pour x=0 et c0 est une constante. [040] Si l'indice de confiance est supérieur à un certain seuil, un angle a de cap est déterminé dans une étape 102. Cet angle a de cap correspond à l'angle entre l'axe A longitudinal du véhicule 10 automobile et la ligne 30, 31 de la voie 11 de circulation la plus proche du véhicule 10. Si l'indice de confiance n'est pas supérieur à un certain seuil, on considère qu'il n'est pas possible de calculer l'angle a de cap. 2 9859 71 8 [41] L'étape 102 est mise en oeuvre par l'unité 21 de contrôle à partir des mesures provenant de la caméra 20. En effet, l'axe A du véhicule 10 est connu de l'unité 21 de contrôle. En outre, la position de la ligne 30 du côté droit de la voie 11 de circulation par rapport à la caméra 20, la position de la 5 ligne 31 du côté gauche de la voie 11 de circulation par rapport à la caméra 20 et la courbure de la voie 11 de circulation permettent de connaître précisément la géométrie de la voie 11 (cf. Figures 2 et 3). [42] Dans une étape 103, la mesure de la vitesse du véhicule 10 automobile est mise en oeuvre par capteur 23 de vitesse du véhicule 10. En 10 outre, la vitesse de lacet du véhicule 10 est mise en oeuvre par le capteur 22 de vitesse de lacet. Par vitesse de lacet, on entend la vitesse de rotation du véhicule 10 autour de son centre G de gravité. [43] Dans une étape 104, l'unité 21 de contrôle détermine la durée restante avant le franchissement d'une des lignes 30, 31 de la voie 11 de 15 circulation. Cette durée ou « Time to Line Crossing » (TLC) en anglais est calculée à partir de la position du véhicule 10 sur la voie 11, de la vitesse de lacet du véhicule 10, la vitesse du véhicule 10, d'autres données de dynamique du véhicule 10 et les actions du conducteur. [44] Dans une étape 105, on déduit de la durée calculée dans l'étape 20 104 un degré de risque concernant la sortie du véhicule 10 de la voie 11 ou risque de sortie de voie 11 du véhicule 10. Par données de dynamique du véhicule 10, on entend les données concernant la connaissance et la formalisation des phénomènes physiques entrant dans la tenue de route et le comportement du véhicule 10. Par exemple ces données de dynamique sont 25 l'accélération de lacet, l'accélération latérale, l'angle de rotation du volant 34 etc. [45] En analysant les paramètres mesurés par la caméra 20, les données de dynamique du véhicule 10 et les actions du conducteur on peut ainsi détecter un écart par rapport à la voie 11 de circulation qui n'est pas 30 demandé par le conducteur. [46] Si le degré de risque d'une sortie de voie 11 du véhicule 10 dépasse un certain seuil, une consigne de dynamique est déterminée dans une étape 106 en fonction des paramètres mesurés par la caméra 20, de la vitesse du véhicule 10 et d'autres données de dynamique du véhicule 10. Cette consigne de dynamique du véhicule 10 est générée et appliquée par le système 24 de direction actif. Si le degré de risque d'une sortie de voie 11 du véhicule 10 ne dépasse pas un certain seuil, on ne détermine pas de consigne dynamique. [47] La détermination de la consigne dynamique par le système 24 de direction est une régulation de type retour d'état dans lequel on décompose un couple de base de régulation en angle et un couple d'assistance, comme 10 décrit dans le document ayant le numéro de dépôt FR1060383. [48] Plus précisément, comme le montre la Figure 5, le calculateur de contrôle du système 24 de direction détermine dans une sous étape 107 partir des paramètres mesurés par la caméra 20 et des données de dynamique du véhicule 10 un angle volant de consigne Av pfil. Cet angle 15 volant de consigne Av pfil permettrait de suivre normalement la direction donnée par la voie 11. En outre, le moyen de mesure de l'angle volant réel Av mesure dans une sous étape 108 l'angle volant réel Av. [49] Le calculateur de contrôle calcule dans une sous étape 109 avec un système de régulation du type proportionnel / dérivé ou numérique, à 20 partir de l'écart angulaire AAv entre l'angle volant de consigne Av pfil et l'angle volant réel Av, un couple de base de régulation en angle Treg. [50] Le système de direction calcule ensuite dans une sous étape 110 un couple d'assistance Tassist, en multipliant par des valeurs de gain k1, k2 telles que k2 >= k1 > 0, la valeur du couple résistant au volant Cv, en 25 prenant pour Cv < 0 et risque de sortie à gauche, ou Cv > 0 et risque de sortie à droite, Tassist = k1 Cv ; et pour Cv > 0 et risque de sortie à gauche, ou Cv < 0 et risque de sortie à droite, Tassist = k2 Cv. [51] Le système de direction additionne enfin dans une sous étape 111 les deux couples calculés Treg, Tassist, pour obtenir la consigne dynamique. 30 [052] On peut ainsi différencier nettement le calcul des deux couples d'assistance Tassist et de régulation Treg, et effectuer la mise au point de 2 9859 71 manière indépendante de chacun de ces deux couples, ce qui facilite ces opérations de mise au point. [53] La détermination de la consigne dynamique par le système de direction est donc un contrôle bas niveau en boucle fermé utilisant des 5 variables estimées de compensation. Le couple demandé est une fonction interne non déterminée directement par une vitesse de lacet ou une accélération latérale. [54] La consigne dynamique est transmise dans une sous étape 112 à l'ensemble motorisé du système 24 de direction qui génère en fonction de 10 cette consigne dynamique un couple dans un sens ou dans l'autre sur le système 24 de direction. [55] Un niveau d'action compris par exemple entre 0 et 1 caractérise la consigne de dynamique. Ce niveau d'action est déterminé en fonction du risque de sortie de voie 11 du véhicule 10. Plus le risque est élevé, plus la valeur du niveau d'action est élevée et plus le couple résistant ressenti par le conducteur est élevé. [56] Avantageusement, à partir d'un risque de sortie ou d'une sortie de la voie 11 de circulation, quand l'écart angulaire entre l'angle volant de consigne et l'angle volant réel, tend à accentuer cette sortie de voie, le couple résistant ressenti par le conducteur tend à augmenter. [57] Avantageusement, à partir d'un risque de sortie ou d'une sortie de la voie 11 de circulation, quand l'écart angulaire entre l'angle volant de consigne et l'angle volant réel, tend à réduire cette sortie de voie, le couple résistant ressenti par le conducteur est proche d'une valeur nulle. [058] En variante, le calculateur de contrôle calcule une vitesse de lacet permettant au véhicule 10 de rester en zone sûre, c'est-à-dire à ne pas sortir de la voie 11. Cette vitesse de lacet est convertie en angle colonne qui est régulée par le système 24 de direction actif. Par angle colonne on entend l'angle de rotation de la colonne 33 du système 24 de direction actif. [059] La consigne de dynamique est par exemple homogène à l'accélération latérale du véhicule 10 ou à la vitesse de lacet du véhicule 10. 2 9859 71 11 Par accélération latérale, on entend l'accélération du véhicule 10 par rapport à son axe latéral. [60] L'étape 106 de génération d'une consigne de dynamique du véhicule 10 peut être inhibée par le conducteur lorsque ledit conducteur 5 actionne un élément de commande du véhicule 10. Par élément de commande du véhicule 10, on entend par exemple le volant 34 ou un frein du véhicule 10. [61] En outre, en cas d'impossibilité de corriger la trajectoire, la consigne de dynamique est supprimée et est remplacée par une alerte 10 spécifique comme par exemple une alerte haptique ou visuelle et sonore dédiée. FIELD OF THE INVENTION [2] The invention relates to a method for correcting the trajectory of a vehicle as well as to a method for correcting the trajectory of a vehicle as well as a method for correcting the trajectory of a vehicle. a device for correcting the trajectory of an associated vehicle. The invention finds a particularly advantageous application in the field of safety and the field of assistance for driving motor vehicles. [3] STATE OF THE ART [4] Motor vehicles generally comprise a steering wheel fixed on a column of the steering system, which is operated by the driver to steer the steering wheels of the vehicle. Steering systems usually comprise an assisting device which generates a portion of the energy to be supplied to steer the wheels, so as to reduce the effort to be delivered by the driver, particularly in maneuvers at low speeds and at low speeds. shutdown. [5] Some steering systems include a driving assistance function controlling by a control computer a motorization which acts on this direction, by delivering a specific assistance torque on the steering to realize an assistance in the follow-up of the control. taxiway, which signals to the driver a deviation from the normal traffic lane. These driving assistance functions are, for example, called the "Involuntary Line Crossing Prevention" (PFIL), Lane Keeping Support (LKS) or Lane Keeping Assistance System (LKAS). [6] Thus, the document FR2706604 presents a device for determining the trajectory of a vehicle for a navigation aid system, comprising means for measuring the steering angle of the vehicle steering wheel, measurement means the progress of the vehicle and means for calculating the trajectory followed by the vehicle from the information of steering angle and advancement. However, this device requires the implementation of a GPS system, which is not precise enough in certain situations, especially when the vehicle passes inside a tunnel. [07] US2009153360 discloses a device and method for correlating data transmitted by a camera and data operated by a line maintenance method when the data refresh rates of the two systems differ. However, this method gives rise to sub-sampling problems. [08] US2010191421 discloses a track maintenance device and method with a functional architecture including a priority treatment according to the situations encountered, such as for example the need to stabilize the vehicle, the need to keep the vehicle in the track and the need to maintain the trajectory. However, the control of the trajectory is based on the notion of lateral deviation. [9] WO2011002345 discloses a track keeping device and method coupled with an "Electrical Assisted Steering" (AED) with a closed control loop, in which the control strategy is based on a low-level loop-type algorithm opened. In addition, the setpoint torque is a function of the requested lateral acceleration. [10] Document DE102007061900 presents a device for preventing a risk of crossing the line, but the regulation mode is based on the engine torque of the vehicle. [11] All these trajectory control methods nevertheless have problems of precision in determining the difference between the expected trajectory of the vehicle on the taxiway and the trajectory of the vehicle measured on this taxiway. [12] OBJECT OF THE INVENTION [13] The object of the invention is in particular to overcome the drawbacks of the state of the art by proposing a method for correcting the trajectory of a vehicle which corrects the trajectory of the vehicle as a function of a heading angle corresponding to the angle between the longitudinal axis of the motor vehicle and the line of the taxiway. [014] More precisely, the invention relates to a method for correcting the trajectory of a motor vehicle traveling on a traffic lane characterized in that it comprises the following steps: - step of acquisition of geometry parameters of the taxiway and the position of the motor vehicle on the taxiway, - a step of determining the heading angle corresponding to the angle between the longitudinal axis of the motor vehicle and a line of the taxiway, lo - step of determining the speed of the motor vehicle, - step of determining the remaining time before crossing the line of the driving lane by the motor vehicle, and - step of generating a vehicle dynamics setpoint according to the heading angle and the time remaining before crossing line 15 of the taxiway. [15] According to one embodiment, the parameters of the geometry of the taxiway comprise at least one parameter among: the position of the line on the right side of the taxiway with respect to a camera, the position of the line of the taxiway; the left side of the taxiway relative to the camera, the curvature of the taxiway which is generally identified on an outer line. [16] According to one embodiment, in the step of acquisition of the geometry parameters of the traffic lane, the measurements of the parameters of the geometry of the lane of traffic are emitted at a frequency of 50 ms and then are delayed by 50 ms. [17] According to one embodiment, the method further comprises the step of calculating a confidence index after the step of acquisition of geometry parameters of the driving lane, this confidence index being calculated according to the correlation between the measurements of the geometry parameters of the taxiway and a pattern of lines. [18] According to one embodiment, the heading angle determined in the heading angle determination step is calculated based on the taxiway geometry parameters and the vehicle position. [19] According to one implementation, if it is impossible to correct the trajectory, the step of generating a vehicle dynamics setpoint is deleted and is replaced by a specific alert. [20] According to one embodiment, the step of generating a vehicle dynamics setpoint can be inhibited by the driver of the motor vehicle when said driver actuates a control element of the vehicle. [21] The invention furthermore relates to a device for correcting the trajectory of a motor vehicle traveling on a traffic lane implementing the method comprising: a camera, a control unit, a speed sensor yaw, - a speed sensor of the motor vehicle, - an active steering system, characterized in that it comprises means for correcting the trajectory as a function of the heading angle of the motor vehicle corresponding to the angle between the longitudinal axis of the vehicle and a line of the taxiway. [22] BRIEF DESCRIPTION OF THE FIGURES [23] The invention will be better understood on reading the description which follows and on examining the figures which accompany it. These figures are given for illustrative purposes only but not limited to the invention. They show: [24] FIG. 1: a functional diagram showing the various steps of the method for correcting the trajectory of a vehicle according to the invention; [25] Figure 2: a graphical representation of the trajectory of the center of gravity of the motor vehicle on a curved lane corrected according to the trajectory correction method according to the invention; [26] Figure 3: a graphical representation of the trajectory of the center of gravity of the motor vehicle on a right lane corrected according to the trajectory correction method according to the invention; [27] Figure 4: a schematic representation of the motor vehicle comprising the device for correcting the trajectory of a vehicle according to the invention; [028] Figure 5: a functional diagram showing the different substeps of the step of generating the dynamic setpoint of the trajectory correction method of a vehicle according to the invention; [029] Figure 6: a graphical representation of a line model estimating the geometry parameters of a traffic lane. [030] The identical, similar or similar elements retain the same reference from one figure to another. [31] DESCRIPTION OF EXAMPLES OF THE EMBODIMENT OF THE INVENTION [32] FIG. 4 shows a motor vehicle situated on a taxiway referenced 11. This vehicle 10 comprises steering wheels and a device 12 for correcting the trajectory comprising a camera 20, a control unit 21, a yaw rate sensor 22, a motor vehicle speed sensor 23 and an active steering system 24 for directing the steering wheels. The automobile vehicle further comprises a longitudinal axis A. [33] The active steering system 24 has a steering column 33. A flywheel 34 is attached to one end of said column 33, the steering wheel 34 being operated by the driver to steer the steering wheels of the vehicle 10. The active steering system 24 further comprises a means for measuring the actual angle of the vehicle. Av steering wheel and an assistance device which generates a portion of the energy to be provided to steer the wheels 35. Thus the system 24 reduces the effort that must deliver the driver, especially in the maneuvers to low speeds and stopped. [034] In addition, this steering system 24 comprises a motorized assembly and control computer of said motorized assembly acting on the direction of the vehicle 10, delivering a specific assistance torque on the direction to perform a follow-up aid to the vehicle. lane 11 of circulation. This assist torque signals the driver a deviation from the lane 11 of traffic. [35] The motorized assembly comprises in particular an electric motor or hydraulic cylinders of the assistance device, to generate a torque in one direction or the other on the steering system 24. This pair signals the driver an exit from the traffic lane 11 or an exit risk. [36] In carrying out the method according to the invention, geometry parameters of the traffic lane 11 and the position of the motor vehicle on the lane 11 of circulation are acquired in a first step 100 by means of the camera 20. [037] For this purpose, the camera 20 permanently films white lines 30, 31 drawn on the ground which delimit the lane 11 of circulation, in order to locate the vehicle 10 with respect to the lateral limits of this lane 11 and detect lateral deviations of the vehicle 10 from this track 11. [038] More precisely, the camera 20 makes it possible to know at each instant the position of the line 30 on the right-hand side of the traffic lane 11 relative to the camera 20, the position of the line 31 on the left side of the traffic lane 11 relative to the camera 20 and the curvature of the lane 11 of circulation which is generally identified on an outer line. By line 30 on the right side and line 31 on the left side, we mean the lines that are situated on the right and on the left of the camera 20 when this camera 20 films these lines 30, 31. The measurements of the geometry parameters of channel 11 are emitted by the camera 20 at a frequency of 50 ms. In order to avoid sub-sampling problems, the measurements from the camera 20 are delayed by 50 ms during the transmission of the measurements on the vehicle network 10. This delay is reduced by optimizing the bandwidth of the vehicle network 10. [039] The control unit 21 calculates in a step 101 a confidence index as a function of the correlation between the measurements of the geometry parameters of the channel 11 coming from the camera 20 and a pattern of lines. This line model is based for example on a polynomial of the second or third order representing the trajectory of a line 30, 31 in the reference (X, Y) of the vehicle 10 as shown in Figure 6. The reference (X, Y) of the vehicle 10 comprises a first axis X being coincident with the longitudinal axis A of the vehicle 10 and a second axis Y perpendicular to the first axis X. The origin O of the reference (X, Y) is positioned at the center G The gravity of the vehicle 10. It is assumed that, in the case of a standard track, the heading angle and the curvature are substantially equivalent for the lines 30, 31 which have a constant distance between them. The estimation of these parameters leads us to a simple equation, verified in the case of small angles, such that: y = yo + a - x +) c. 2 - x2 according to which, in the reference (X, Y), x is the abscissa of a point P of the line 30, 31, y is the ordinate of said point P of the line 30, 31, y0 is the ordinate of the point of said line for x = 0, a is the heading angle for x = 0 and c0 is a constant. [040] If the confidence index is greater than a certain threshold, an angle α of course is determined in a step 102. This angle α of course corresponds to the angle between the longitudinal axis A of the automobile vehicle and the line 30, 31 of the nearest traffic lane 11 of the vehicle 10. If the confidence index does not exceed a certain threshold, it is considered that it is not possible to calculate the angle a of Cpl. [41] Step 102 is carried out by the control unit 21 from the measurements from the camera 20. Indeed, the axis A of the vehicle 10 is known from the unit 21 of FIG. control. In addition, the position of the line 30 on the right side of the traffic lane 11 with respect to the camera 20, the position of the line 31 on the left side of the lane 11 of circulation with respect to the camera 20 and the curvature of the circulation lane 11 make it possible to precisely know the geometry of the lane 11 (see FIGS. [42] In a step 103, the measurement of the speed of the vehicle is carried out by vehicle speed sensor 10. In addition, the yaw rate of the vehicle 10 is implemented by the vehicle sensor 22. yaw rate. By yaw rate means the speed of rotation of the vehicle 10 around its center G of gravity. [43] In a step 104, the control unit 21 determines the remaining time before crossing one of the lines 30, 31 of the traffic lane 11. This time or "Time to Line Crossing" (TLC) in English is calculated from the position of the vehicle 10 on the lane 11, the yaw rate of the vehicle 10, the speed of the vehicle 10, other dynamic data. of the vehicle 10 and the actions of the driver. [44] In a step 105, a degree of risk regarding the exit of the vehicle 10 from the track 11 or the risk of leaving the track 11 of the vehicle 10 is deduced from the duration calculated in the step 104. Vehicle 10 is understood to mean the data concerning the knowledge and the formalization of the physical phenomena involved in the handling and the behavior of the vehicle 10. For example, these dynamics data are the yaw acceleration, the lateral acceleration, the angle of rotation of the steering wheel 34 etc. [45] By analyzing the parameters measured by the camera 20, the vehicle dynamics data 10 and the actions of the driver can thus detect a deviation from the traffic lane 11 which is not requested by the driver. [46] If the degree of risk of a lane departure 11 of the vehicle 10 exceeds a certain threshold, a dynamic setpoint is determined in a step 106 according to the parameters measured by the camera 20, the speed of the vehicle 10 and other vehicle dynamics data 10. This vehicle dynamics setpoint 10 is generated and applied by the active steering system 24. If the degree of risk of a lane 11 of the vehicle 10 does not exceed a certain threshold, no dynamic setpoint is determined. [47] The determination of the dynamic setpoint by the steering system 24 is a feedback type control in which an angle regulation base torque and an assist torque are decomposed, as described in the document. the deposit number FR1060383. [48] More precisely, as shown in FIG. 5, the steering system control computer 24 determines in a sub-step 107 from the parameters measured by the camera 20 and vehicle dynamics data 10 a set steering angle Av pfil. This steering angle Avpfil Avpfil would normally follow the direction given by the channel 11. In addition, the means for measuring the actual flying angle Av measures in a sub-step 108 the actual flying angle Av. [49] The control computer calculates in a sub-step 109 with a proportional / derivative or digital type control system, from the angular deviation AAv between the target flight angle Av pfil and the actual steering angle Av, a basic torque regulation Treg angle. [50] The steering system then calculates in a sub-step 110 a Tassist assist torque, by multiplying by gain values k1, k2 such that k2> = k1> 0, the value of the steering-resistant torque Cv, in Taking for Cv <0 and risk of exit on the left, or Cv> 0 and risk of exit on the right, Tassist = k1 Cv; and for Cv> 0 and risk of exit on the left, or Cv <0 and risk of exit on the right, Tassist = k2 Cv. [51] The steering system finally adds in a sub-step 111 the two calculated pairs Treg, Tassist, to obtain the dynamic setpoint. [052] It is thus possible to clearly differentiate the calculation of the two Tassist assistance and Treg regulation torques, and to make the development independently of each of these two pairs, which facilitates these operations of setting point. [53] The determination of the dynamic setpoint by the steering system is therefore a closed loop low level control using estimated compensation variables. The requested torque is an internal function not determined directly by a yaw rate or a lateral acceleration. [54] The dynamic setpoint is transmitted in a sub-step 112 to the motorized assembly of the steering system 24 which generates, as a function of this dynamic setpoint, a torque in one direction or the other on the steering system 24. [55] A level of action for example between 0 and 1 characterizes the dynamic setpoint. This level of action is determined as a function of the risk of leaving the lane 11 of the vehicle 10. The higher the risk, the higher the value of the level of action and the higher the resistance torque felt by the driver. [56] Advantageously, from a risk of exit or exit of the traffic lane 11, when the angular difference between the set steering angle and the actual steering angle, tends to accentuate this output of way, the resisting torque felt by the driver tends to increase. [57] Advantageously, from a risk of exit or exit of the traffic lane 11, when the angular difference between the set steering angle and the actual steering angle, tends to reduce this output of way, the resisting torque felt by the driver is close to a zero value. [058] Alternatively, the control computer calculates a yaw rate allowing the vehicle 10 to remain in a safe zone, that is to say not to leave the lane 11. This yaw rate is converted to a column angle which is regulated by the active steering system 24. Column angle means the angle of rotation of the column 33 of the active steering system 24. [059] The dynamic setpoint is for example homogeneous to the lateral acceleration of the vehicle 10 or to the yaw rate of the vehicle 10. By lateral acceleration is meant the acceleration of the vehicle 10 with respect to its axis. lateral. [60] The step 106 of generating a vehicle dynamics setpoint 10 can be inhibited by the driver when said driver 5 actuates a control element of the vehicle 10. By control element of the vehicle 10 is meant for example the steering wheel 34 or a brake of the vehicle 10. [61] In addition, in the event of impossibility of correcting the trajectory, the dynamic setpoint is removed and is replaced by a specific alert such as for example a haptic or visual and sound alert dedicated .

Claims

REVENDICATIONS1. Vehicle trajectory correction method CLAIMS1. A method for correcting the trajectory of a vehicle (10) traveling on a traffic lane (11) characterized in that it comprises the following steps: - step (100) for acquiring geometry parameters of the lane ( 11) and the position of the vehicle (10) on the traffic lane (11), - step (102) for determining the angle (a) of heading corresponding to the angle between the axis (A) ) longitudinal of the vehicle (10) automobile and a line (30, 31) of the path (11) of circulation, - step (103) for determining the speed of the vehicle (10) automobile, - step (104) determination of the time remaining before crossing the line (30, 31) of the road (11) of circulation by the vehicle (10) automobile, and - step (106) of generating a vehicle dynamics setpoint (10) in a function of the heading angle (a) and the time remaining before crossing the line (30, 31) of the traffic lane (11).

2. Course correction method according to claim 1, characterized in that the geometry parameters of the traffic lane (11) comprise at least one of: the position of the line (30) on the right side of the lane ( 11) relative to a camera (20), the position of the line (31) on the left side of the traffic channel (11) relative to the camera (20), the curvature of the track (11). which is usually identified on an outside line.

3. Course correction method according to claim 1 or 2, characterized in that, in the step (100) for acquiring geometry parameters of the traffic channel (11), the measurements of the geometry parameters of the channel (11) of circulation are emitted at a frequency of 50 ms and then are delayed by 50 ms.

4. Course correction method according to one of claims 1 to 3, characterized in that it further comprises the step (101) of calculating a confidence index after step (100) method for acquiring geometry parameters of the traffic lane (11), said confidence index being calculated as a function of the correlation between the measurements of the geometry parameters of the traffic lane (11) and a line model.

A course correction method according to one of claims 1 to 4, characterized in that the heading angle (a) determined in the step (102) for determining the heading angle (a) is calculated. according to the geometry parameters of the traffic lane (11) and the position of the vehicle (10).

6. Course correction method according to one of claims 1 to 5, characterized in that in case of impossibility of correcting the trajectory, the step (106) of generating a vehicle dynamics setpoint (10) ) is deleted and is replaced by a specific alert. 15

Path correction method according to one of claims 1 to 6, characterized in that the step (106) for generating a vehicle dynamics setpoint (10) can be inhibited by the driver of the vehicle (10). ) automobile when said driver actuates a control element of the vehicle (10).

8. Device (12) for correcting the trajectory of an automobile vehicle (10) traveling on a traffic lane (11) implementing the method according to the preceding claims, comprising: - a camera (20), - a unit ( 21), - a yaw rate sensor (22), - an automobile speed sensor (23), - an active steering system (24), characterized in that it comprises means for correcting the trajectory as a function of the heading angle (a) of the vehicle (10) corresponding to the angle between the longitudinal axis (A) of the vehicle (10) and a line (30, 31) of the track (11) circulation. 5 10