FR 3004407 A1 20141017 FR 1353228 A 20130410 STRATEGIE DE PARKING EN CRENEAU PAR UNE TRAJECTOIRE EN COURBURE CONTINUE La présente invention concerne le domaine des aides au parking pour véhicules automobiles, et plus particulièrement des systèmes d'aide au parking entièrement automatique pour la réalisation de manoeuvres de parking de type créneau. La réalisation des manoeuvres en créneau est souvent une source de stress, par la difficulté de réalisation de ces manoeuvres, pouvant être liée à l'appréciation de différents paramètres de réalisation de ces manoeuvres que sont notamment, l'adéquation de la place de stationnement avec la longueur du véhicule, le positionnement initial du véhicule, l'enchaînement des manoeuvres de stationnement,... pouvant également entraîner des risques de dégradation du véhicule en manoeuvre et des véhicules bordant la place de parking visée. De plus, l'immobilisation temporaire de la voie de circulation est également une source de stress par la gêne occasionnée pour les autres automobilistes. Il a déjà été proposé, par les demandes FR12-57793 et FR12-58536 au nom du déposant, une proposition de parking automatique en créneau d'un véhicule par une succession de trajectoires formées d'arcs de cercle, se basant donc sur les méthodes géométriques de planification de la trajectoire. Toutefois, ces méthodes nécessitent que le changement de direction soit réalisé à l'arrêt, ce qui provoque un effort important sur la colonne de direction, ainsi qu'une usure localisée des pneumatiques, la rotation des roues directionnelles étant effectuée sans déplacement desdites roues. La présente invention vise ainsi à améliorer ces différentes manoeuvres, et vise notamment à l'adaptation d'une méthode géométrique quelconque, telles par exemple celles décrites dans les demandes FR12-57793 et FR12-58536, en obviant les problèmes mentionnés. L'invention vise principalement à définir une trajectoire par des arcs de cercle, ou à utiliser une trajectoire déjà définie par des arcs de cercle, et à transformer cette trajectoire en une trajectoire avec des rayons de courbure continus, tout en respectant les points de départ et d'arrivée. Cette trajectoire peut être formée de plusieurs manoeuvres, une manoeuvre étant définie comme une séquence de différents braquages sans changement du signe de la vitesse, afin d'amener le véhicule dans une place de parking préalablement identifiée. Pour ce faire, l'invention utilise des clothoïdes. Il est connu, par le document US 7,469,765 le parking en une manoeuvre selon une séquence à courbure continue de cinq courbes dont la deuxième et la quatrième sont des clothoïdes, la troisième et la cinquième étant des arcs de cercles. Un tel document ne permet pas le parking en plusieurs manoeuvres. Par ailleurs, la dernière séquence étant un arc de cercle, les roues ne sont pas redressées à la fin de la manoeuvre. On connait également, par le brevet US 20070282503, le parking en une manoeuvre, où certaines parties de la trajectoire peuvent être des clothoïdes, mais la trajectoire n'est pas forcément complètement à courbure continue. Un autre but de l'invention est de présenter une manoeuvre entièrement automatique, où le conducteur n'intervient pas dans les manoeuvres de stationnement, le véhicule pouvant même être inoccupé lors des manoeuvres. La présente invention est atteinte à l'aide d'une méthode de tracé de trajectoire de parking d'un véhicule depuis une voie de circulation vers un emplacement libre de parking, par une ou des manoeuvres de type créneau, comprenant les étapes suivantes : - détermination de la longueur de l'emplacement libre, - détermination d'une trajectoire optimale de déplacement du véhicule par des arcs de cercle successifs, caractérisé en ce qu'il comporte une étape de transformation d'au moins un des arcs de cercle en une courbe de rayon de courbure continu, ayant les mêmes points de départ et d'arrivée que l'arc de cercle qu'elle remplace. Selon d'autres caractéristiques de l'invention : - les arcs de cercle servant au calcul de la trajectoire optimale présentent un rayon identique, - la vitesse de rotation des roues est constante, tout comme la vitesse de déplacement du véhicule pendant la rotation desdites roues. - la courbe de rayon de courbure continue est constituée de trois parties : une clothoïde, un arc de cercle et une clothoïde, - les rayons des arcs de cercle entre deux clothoïdes sont tous identiques, - lors du parcours de la première clothoïde, le véhicule débute avec les roues dans l'axe longitudinal et termine avec les roues braquées selon le rayon de courbure défini de l'arc de cercle à suivre, - lors du parcours de la seconde clothoïde, le véhicule débute avec les roues braquées selon le rayon de courbure défini de l'arc de cercle qui l'a précédé, et se termine avec les roues dans l'axe longitudinal, - le paramètre A de la clothoïde est déterminé par la vitesse de rotation des roues, ainsi que par la vitesse de déplacement du véhicule. D'autres caractéristiques et avantages de l'invention apparaîtront mieux à la lecture de la description suivante, en référence aux figures annexées parmi lesquelles : les figures 1 et 2 sont des représentations d'un véhicule et des différentes notations associées, la figure 3 est une figure explicative d'un déplacement selon une clothoïde, la figure 4 montre une séquence de planification de trajectoire selon l'invention, la figure 5 est un exemple de parking en une seule manoeuvre selon l'invention. La présente invention se rapporte aux manoeuvres en créneau permettant de garer un véhicule le long d'une voie de circulation. La trajectoire que le véhicule doit suivre pour se garer prend en compte les contraintes du véhicule (notamment les dimensions, angles de braquage maximaux) et les contraintes de l'environnement (dimensions de la place de parking, non collision avec les autres véhicules garés lors des manoeuvres). La présente invention suppose qu'un calcul et qu'une mémorisation du tracé (x,y) de la trajectoire à suivre, selon une méthode géométrique basée sur des arcs de cercle successifs est réalisée, tel que le décrit par exemple la demande de brevet FR12-57793 ou FR12-58536. Il est également supposé et admis que l'emplacement de parking, dans un repère global, ainsi que les dimensions de la place de parking sont connus ou déterminés par des capteurs après un passage du véhicule devant ladite place de parking libre. Si les capteurs ne permettent pas de calculer la profondeur de la place, mais que l'on sait d'une quelconque manière qu'il est possible de garer le véhicule à cet emplacement (par exemple par le fait que d'autres véhicules sont garés à côté), on supposera la profondeur égale à la largeur du véhicule. A partir du tracé (x-y) de la trajectoire, le principe général de l'invention est de transformer chaque arc de cercle, excepté le premier, en une courbe de rayon de courbure continu, ayant les mêmes points de départ et d'arrivée (x,y) que l'arc de cercle en question. Chaque courbe est constituée de trois parties : - courbe permettant de passer d'un rayon de courbure infini à une courbe de rayon de courbure constant défini (arc de cercle), - courbe de rayon de courbure constant défini (arc de cercle), le rayon de courbure étant le rayon de braquage minimal admissible pour le véhicule, - courbe permettant de passer d'un rayon de courbure constant défini (arc de cercle) à une courbe de rayon de courbure infini. La courbe permettant de passer d'un rayon de courbure infini à une courbe de rayon de courbure constant défini ou vice versa est une clothoïde. Le véhicule peut réaliser une telle trajectoire clothoïdique (condition suffisante mais non nécessaire) en roulant à une vitesse constante avec une vitesse de braquage constante. Le véhicule pris comme exemple d'application de l'invention, tel que présenté figure 1, est un véhicule 1 de type automobile, à traction, entraîné par un moteur (non représenté), comportant quatre roues 2 à 5 (roue avant gauche 2, roue avant droite 3, roue arrière gauche 4 et roue arrière droite 5), les roues avant étant les roues directrices. Les caractéristiques de dimensionnement du véhicule sont nécessaires pour les différents calculs de trajectoire. On se reportera avantageusement aux demandes de brevet FR12-57793 ou FR12-58536 pour un calcul détaillé des trajectoires. On définit ainsi : - a : l'empattement du véhicule - 2b : la voie du véhicule, - df : Porte à faux avant du véhicule - dr : Porte à faux arrière du véhicule - d9 : Distance entre les roues gauches et le côté gauche du véhicule - dd : Distance entre les roues droites et le côté droit du véhicule - b : Angle que font les roues avant avec l'axe longitudinal du véhicule, Ô9 et bd désignent respectivement b lorsque le véhicule braque à gauche ou à droite - : Vitesse longitudinale du véhicule - : Angle de cap du véhicule dans un repère absolu (x, y), - E : milieu de l'essieu arrière, - C : Centre des cercles utilisés. CI et Cr désignent respectivement les centres lorsque le braquage se fait à gauche et à droite. Cr',,r, désigne un centre correspondant à Rmin, un rayon minimum, lorsque le sens du braquage n'est pas indiqué. Le véhicule est ainsi schématisé comme un rectangle où les points J, A et B définissent respectivement les coins arrière gauche, arrière droit et avant droit du véhicule, en référence à la figure 2. On définit également le point D qui est le point milieu de l'essieu avant du véhicule. Les centres instantanés de rotation du véhicule sont notés CI ou Cr, selon que les roues du véhicule sont braquées à gauche ou à droite. La place de parking est définie par sa longueur L, la valeur I correspondant à la différence entre la longueur de la place de parking et la longueur du véhicule. Selon l'invention, on considère une trajectoire de parking formée d'arcs de cercle, par exemple comme dans les demandes de brevets déposées sous les numéros FR12-57793 et FR12-58536. On souhaite transformer cette trajectoire en une trajectoire avec rayons de courbure continus. On étudie les trajectoires pour le milieu de l'essieu arrière E. Ainsi, lorsqu'on parle de rayon R de braquage du véhicule, il s'agit alors de la distance entre le centre de rotation et le point E du véhicule. Afin d'obtenir une trajectoire avec rayons de courbure continus à partir des arcs de cercle, on remplace chaque arc de cercle ,tett par la séquence suivante : - Clothoïde e: les roues sont initialement droites (rayon de courbure infini) et la clothoïde se termine avec le rayon de courbure désiré, - Arc de cercle intérieur ,toge : le rayon de courbure de cet arc est celui obtenu en fin de clothoïde, - Clothoïde inversée e : Le rayon de courbure est initialement celui correspondant à l'arc de cercle précédent et la fin de la clothoïde se termine avec les roues droites (rayon de courbure infini). Cette méthode implique que l'angle p entre l'orientation du véhicule au point final de la séquence et la tangente à ,tett soit une constante dépendant uniquement du paramètre de e. Il s'agit du critère p-tangence cité dans la littérature, par exemple dans l'article « Continuous-curvature path planning for car-like vehicles », dans Proc. of IEEE-RSJ Int. Conf. on Intelligent Robots and Systems, Grenoble, Septembre 1997. Comme on choisira ce paramètre de manière à profiter au mieux des capacités du véhicule (c'est-à-dire établir une trajectoire avec des rayons les plus petits possibles), cela implique que p sera constant pour tous les arcs de cercle ,tett. Par conséquent le rayon des arcs de cercle extérieur devra être identique pour toute la trajectoire et ce rayon sera noté R1, le plus petit possible. Par ailleurs, on souhaite que le rayon de l'arc de cercle intérieur soit de rayon minimal. Si l'on nomme Rmini et Rminr les rayons respectifs pour le braquage maximal respectivement à gauche et à droite, alors le rayon minimal de braquage, noté Rmin est égal à la valeur maximale entre et Rn-Hro et Rrmr,r. Par définition, une clothoïde est caractérisée par son paramètre A défini par A2 = R.L, où R est l'inverse de la courbure en chaque point et L la longueur de la clothoïde en chaque point. Dès lors, pour une valeur R = Rmin, pour un véhicule roulant à une 10 vitesse maximale désirée vmaxdesiredi le paramètre A est défini par A2 = Rmin.Lmi' où Lmin est la longueur minimale de la clothoïde admissible pour le véhicule pour passer d'une valeur de braquage des roues de 0 à Ômax- Si l'on considère vô la vitesse maximale désirée de rotation des 15 roues, vmaxdesired la vitesse maximale désirée longitudinale du véhicule, Elmax l'angle des roues correspondant à Rmin, alors le temps t nécessaire pour tourner les roues de 0 à bmax est : t= max . Par la suite, la longueur vs minimale Lmin parcourue par le véhicule braquant ses roues de 0 à bmax est Lmin = Vmaxdesired.t. 20 En référence à la figure 3, si le départ de la clothoïde se fait en (0,0) avec le véhicule orienté dans le sens positif de l'axe des abscisses, le centre C du cercle intérieur est alors donné par les formules classiques des clothoïdes : xc = xRmin - Rmin sin 2 Y c - YR min -Rmin cos2 L2 25 Avec 2 = Ce centre du cercle intérieur sera par la suite noté Cmin lorsqu'il sera calculé pour le rayon Rmin. De plus, les coordonnées (x,y) de chaque point de la clothoïde sont définies par les relations : 2A2 ( L x A,Fru f - et ( L y = A,17 S - Sf ) Avec Cf et Sf les intégrales de Fresnel définies par : X Cf (X) = COS1/12 du , et Sf (x) 'sin 1u2du 2 2 0 0 Le paramètre p peut également se déduire par : p=arctan(xchfc)- Pour connaitre C ainsi que les coordonnées de divers points de la trajectoire situés sur des portions de clothoïdes, on est amené à calculer les intégrales de Fresnel. Ces intégrales peuvent s'écrire sous forme de série entière. Les coordonnées (x,y) de chaque point de la clothoïde peuvent alors s'écrire : cc (-1)n L4n+1 X - n=o (2n)!(4n + 1)(NID1)4n (-1)n L4n +3 y =1 n=o (2n +1)(4n + 3)(' DI)4n+2 Une bonne approximation des coordonnées peut être faite en limitant n à des valeurs faibles, par exemple 10. La planification de la trajectoire de parking, à partir des méthodes géométriques utilisant des arcs de cercle, telles celles décrites dans les demandes FR12-57793 et FR12-58536 nécessite toutefois que les rayons des arcs de cercle utilisés doivent être égaux à R1, et non au rayon minimum. De plus, si l'on définit par ()but l'orientation du véhicule souhaitée à la fin d'une manoeuvre, le véhicule est alors situé sur un arc de cercle extérieur de centre C. Or avec la contrainte de p-tangence, la pose du véhicule n'est donc pas tangente au cercle comme ce serait le cas avec une méthode géométrique avec arcs de cercle. Le centre du cercle a donc subi une rotation d'angle -p et de centre Ebut par rapport au centre du cercle avec la méthode géométrique. Ainsi, à partir d'une planification géométrique initiale avec arcs de cercle de la trajectoire de parking, il faut modifier en conséquence le calcul des centres instantanés de rotation du véhicule. Une fois cette planification réalisée, on remplace chaque arc de cercle ,tett par la séquence suivante, en référence à la figure 4 : - Clothoïde emee : de paramètre précédemment calculé A et de longueur 1_,,' en commençant avec un rayon de courbure nul et finissant par un rayon de courbure 1/R,,, -Arc de cercle ,lege de rayon Rmin - Clothoïde inversée &dee : de paramètre précédemment calculé A et de longueur 1_,,' en commençant avec un rayon de courbure 1/R,,, et finissant par un rayon de courbure nul On peut associer un angle (lut à ,tett, ainsi qu'un angle a - clotho a chaque clothoïde (calcul en se servant du théorème d'AI-Kashi) : a clotho arccos - 2R1Rmin On en déduit alors l'angle aie à parcourir sur ;lege : aine = OEtot -2OEclotho En référence à la figure 5, le point de départ du premier arc de cercle doit être de rayon R1 afin de respecter le critère de la la-tangence. Ceci nécessite que le véhicule se déplace en ligne droite, vers l'avant ou vers l'arrière, comme dans le cas représenté, à partir du point E,,,t, correspondant à la position initiale du véhicule, jusqu'à ce qu'il se trouve sur un cercle de rayon R1 convenant au reste de la trajectoire. Soit Ecorrect, la position de ce point. Le théorème d'AI-Kashi dans le triangle (Ci-Cr-Ecorrect) est alors appliqué, qui donne l'équation suivante à résoudre : 2 2D 2 D 2 XR min ± YR min + 111 I 1min 3R12 - d2 + 2d.R1cosoc = 0, où sont utilisées les valeurs suivantes : d V(xci X Ecorrect) 2 + (Y Cl Y Ecorrect) 2 t a = arccos YEcorrect ± Einit d Ecorrect Einit X Ecorrect tan VEinit Il est à noter que la méthode ne peut pas être utilisée si la valeur de (lut est inférieure à 2OEclotho- Toutefois, dans ce cas de figure, il est possible, soit en modifiant A et L et gardant les rayons de courbure respectivement finaux et initiaux de respectivement Cie' et e.e'e, soit en modifiant L et ces rayons de courbure et gardant A, de former deux nouvelles clothoïdes symétriques de telle sorte qu'en les parcourant, on obtienne l'équation (lut = 2OEnewclotho- La mise en oeuvre pratique de cette méthode nécessite que le véhicule soit équipé de différents systèmes automatiques pour commander le braquage des roues, l'accélération, le freinage, le changement de vitesse, notamment pour changer la direction d'avancement du véhicule. Il doit en outre être équipé d'un ou plusieurs capteurs permettant de mesurer au moins la longueur de la place de parking lorsqu'on passe à côté d'elle, par exemple un capteur ultra-son, un radar ou une caméra. Dans le cas où les capteurs présents ne permettent pas de mesurer la profondeur de la place de parking, le véhicule doit être pourvu d'un système permettant de déduire que l'emplacement est bien un emplacement de parking (ex : caméra avec détection de véhicules adjacents, interface utilisateur avec question de possibilité de parking,...). Le véhicule doit également comporter un ou plusieurs capteurs permettant de mesurer les distances depuis l'avant et l'arrière du véhicule jusqu'à l'obstacle le plus proche (ex : mur, véhicule de derrière), par exemple caméra, capteur ultra-son ou télémètre laser. Un calculateur permet de gérer et stocker ces différentes informations. Afin de rendre compte des possibilités de parking au conducteur, le véhicule sera préférentiellement équipé d'une interface graphique ou vocale. Ainsi la présente invention adapte une méthode géométrique quelconque pour obtenir une trajectoire à courbure continue. On peut citer les avantages suivants de la présente invention : - On bénéficie des trajectoires de parking créées par des méthodes géométrique. Ainsi il n'y a pas de contrainte sur le point de départ du véhicule, le véhicule peut être garé automatiquement du moment que la place de parking peut contenir le véhicule. Le parking en plusieurs manoeuvres est possible. -Toute méthode où la trajectoire de parking est formée d'arcs de cercles, peut être transformée en trajectoire à courbure continue selon la présente invention. - La trajectoire créée par la présente invention est à courbure continue. Le véhicule n'a pas besoin de s'arrêter pour réorienter ses roues. Ceci permet un gain de temps et une usure plus faible des pneus et de la colonne de direction. - Le tracé de la trajectoire est tel qu'à la fin de la manoeuvre, les roues du véhicule sont redressées, ce qui facilitera les futures manoeuvres automatiques ou manuelles pour notamment sortir de la place de parking. - Un tracé (x,y) de la trajectoire est généré. Ainsi de nombreuses stratégies de suivi de trajectoire peuvent être appliquées, sans contrainte sur une stratégie particulière. REVENDICATIONS1) Méthode de tracé de trajectoire de parking d'un véhicule (1) depuis une voie de circulation (12) vers un emplacement libre de parking (10), par une ou des manoeuvres de type créneau, comprenant les étapes suivantes : - détermination de la longueur (L) de l'emplacement libre (10), - détermination d'une trajectoire optimale de déplacement du véhicule (1) par des arcs de cercle successifs, caractérisé en ce qu'il comporte une étape de transformation d'au moins un des arcs de cercle en une courbe de rayon de courbure continu, ayant les mêmes points de départ et d'arrivée que l'arc de cercle qu'elle remplace. 2) Méthode selon la revendication précédente, caractérisé en ce que les arcs de cercle servant au calcul de la trajectoire optimale présentent un rayon identique. 3) Méthode selon l'une des revendications précédentes, caractérisé en ce que la vitesse de rotation des roues est constante, tout comme la vitesse de déplacement du véhicule pendant la rotation desdites roues. 4) Méthode selon la revendication 1, caractérisé en ce que la courbe de rayon de courbure continue est constitué de trois parties : une clothoïde &meg, un arc de cercle 71ege et une clothoïde &dee. 5) Méthode selon l'une des revendications précédentes, caractérisé en ce que les rayons des arcs de cercle entre deux clothoïdes sont tous identiques. 6) Méthode selon la revendication précédente, caractérisé en ce que, lors du parcours de la première clothoïde &meg, le véhicule débute avec les roues dans l'axe longitudinal et termine avec les roues braquées selon le rayon de courbure défini de l'arc de cercle à suivre. 7) Méthode selon la revendication précédente, caractérisé en ce que, lors du parcours de la seconde clothoïde emege, le véhicule débute avec les roues braquées selon le rayon de courbure Rrn,', défini de l'arc de cercle qui l'a précédé, et se termine avec les roues dans l'axe longitudinal. 8) Méthode selon l'une des revendications 4 à 7, caractérisé en ce que le paramètre A de la clothoïde est déterminé par la vitesse de rotation des roues, ainsi que par la vitesse de déplacement du véhicule.10