Login| Sign Up| Help| Contact|

Patent Searching and Data


Title:
METHOD FOR DETERMINING THE ANGULAR POSITION OF A COMPLEX VEHICLE WITH TWO AXES OF ROTATION, AND SYSTEM CONFIGURED TO IMPLEMENT SUCH A METHOD
Document Type and Number:
WIPO Patent Application WO/2023/066610
Kind Code:
A1
Abstract:
The invention relates to a method for determining the angular position of a vehicle (10) which comprises a tractor (14), a towing platform (16) articulated on the tractor and a trailer (18) articulated on the towing platform, said method being implemented by a system comprising a computer and a camera (24) oriented towards the trailer, and characterised in that it comprises a step of acquiring, by means of the camera, a first image in a first reference position of the vehicle, and of detecting at least one characteristic point (FA) of the trailer in said first position; a step of acquiring, by means of the camera, a second image in a second position of the vehicle, and of detecting said characteristic point (FB) in the second position, the detected characteristic point (FA, FB) being the same for each position; a step of estimating the position of the characteristic point (FA, FB) in the first position and the second position of the vehicle by minimising a cost function based on an iteration of different values of the height of the characteristic point (FA) in the first position of the vehicle and of the characteristic point (FB) in the second position of the vehicle; and a step of determining the angle of rotation (α2) between the trailer and the towing platform based on the position of the characteristic point estimated in the preceding estimation step.

Inventors:
POVEDA VICENTE (FR)
GUERRERO DAVID (FR)
VIMORT JEAN-BAPTISTE (FR)
Application Number:
PCT/EP2022/076699
Publication Date:
April 27, 2023
Filing Date:
September 26, 2022
Export Citation:
Click for automatic bibliography generation   Help
Assignee:
CONTINENTAL AUTOMOTIVE GMBH (DE)
International Classes:
G01B11/26; B60D1/62; B62D13/06
Domestic Patent References:
WO2019202317A12019-10-24
Foreign References:
FR3106560A12021-07-30
Attorney, Agent or Firm:
KAABOUNI, Fatima (FR)
Download PDF:
Claims:
Revendications

[Revendication 1] Procédé de détermination de la position angulaire d’un véhicule (10) qui comprend un tracteur (14), une plate-forme de remorquage (16) articulée sur le tracteur (14) au niveau d’un premier point d’ancrage (N), au moins autour d’un premier axe (01 ) de rotation globalement perpendiculaire au plan général (P) de la plate-forme de remorquage (16), et une remorque (18) articulée sur la plate-forme de remorquage (16) au niveau d’un second point d’ancrage (M), au moins autour d’un second axe (02) de rotation globalement perpendiculaire au plan général (P) de la plate-forme de remorquage (16), au niveau d’un second point d’ancrage (M), procédé mis en œuvre par un système (20) comprenant un calculateur (22) et une caméra (24) orientée vers la remorque (18), caractérisé en ce qu’il comprend les étapes suivantes :

- acquisition (100) par la caméra (24) d’une première image dans une première position de référence du véhicule (10), et détection d’au moins un point caractéristique (FA) de la remorque (18) dans ladite première position, qui est observé dans la première image,

- acquisition (200) par la caméra (24) d’une deuxième image dans une seconde position du véhicule (10), et détection dudit point caractéristique (FB) dans la seconde position, qui est observé dans la deuxième image, le point caractéristique (FA, FB) détecté étant le même pour chaque position,

- estimation (300) de la position du point caractéristique (FA, FB) dans la première position et la seconde position du véhicule (10), qui est observé dans la première image et dans la seconde image respectivement, par minimisation d’une fonction coût basée sur une itération de différentes valeurs de la hauteur (y) du point caractéristique (FA) dans la première position du véhicule (10) et du point caractéristique (FB) dans la seconde position du véhicule (10), suivant un axe perpendiculaire au plan général (P) de la plate-forme de remorquage (16), et

- détermination (400) de l’angle de rotation (a2) entre la remorque (18) et la plateforme de remorquage (16) en se basant sur la position du point caractéristique estimé (FrÿA, FrÿB) dans la première position et la seconde position au cours de l’étape d’estimation précédente. [Revendication 2] Procédé selon la revendication 1 , caractérisé en ce que la fonction coût utilisée dans l’étape d’estimation de la position du point caractéristique (FA, FB) est la suivante : coût

- PRLA le point qui matérialise l’intersection entre un plan (Ly) imaginaire parallèle au plan général (P) de la plate-forme de remorquage (16) et de hauteur (y) variable, et un rayon optique (RFA) de la caméra (24) qui passe par le point caractéristique (FA) de la première position,

- MA le second point d’ancrage dans la première position,

- PRLB le point qui matérialise l’intersection entre ledit plan (Ly) imaginaire parallèle au plan général (P) de la plate-forme de remorquage (16) et de hauteur (y) variable, et un rayon optique (RFB) de la caméra (24) qui passe par le point caractéristique (FB) de la seconde position, et

- MB le second point d’ancrage dans la seconde position.

[Revendication 3] Procédé selon l’une quelconque des revendications précédentes, caractérisé en ce que l’étape de détermination (400) géométrique de l’angle (a2) de rotation entre la remorque (18) et la plate-forme de remorquage (16) est obtenue par le calcul suivant :

- FryB le point caractéristique estimé dans la seconde position,

- FryA le point caractéristique estimé dans la première position, et

- M le second point d’ancrage.

[Revendication 4] Système (20) de détermination de la position angulaire d’un véhicule (10) qui comprend un tracteur (14), une plate-forme de remorquage (16) articulée sur le tracteur (14) au niveau d’un premier point d’ancrage (N), au moins autour d’un premier axe (01 ) de rotation globalement perpendiculaire au plan général (P) de la plate-forme de remorquage (16), et une remorque (18) articulée sur la plate-forme de remorquage (16) au niveau d’un second point d’ancrage (M), au moins autour d’un second axe (02) de rotation globalement perpendiculaire au 19 plan général (P) de la plate-forme de remorquage (16), au niveau d’un second point d’ancrage (M), procédé mis en œuvre par un système (20) comprenant un calculateur (22) et une caméra (24) orientée vers la remorque (18), caractérisé en ce qu’il est configuré pour mettre œuvre le procédé selon l’une quelconque des revendications précédentes.

[Revendication 5] Produit programme d’ordinateur, comprenant des instructions de code pour la mise en œuvre du procédé selon l’une quelconque des revendications 1 à 3.

Description:
DESCRIPTION

TITRE : Procédé de détermination de la position angulaire d’un véhicule complexe à deux axes de rotation et système configuré pour mettre en œuvre un tel procédé

[Domaine technique]

[0001] La présente demande de brevet se rapporte à un procédé de détermination de la position angulaire d’un véhicule, et qui comprend un tracteur, une plate-forme de remorquage articulée sur le tracteur au niveau d’un premier point d’ancrage, au moins autour d’un premier axe de rotation globalement perpendiculaire au plan général de la plate-forme de remorquage, et une remorque articulée sur la plateforme de remorquage au niveau d’un second point d’ancrage, au moins autour d’un second axe de rotation globalement perpendiculaire au plan général de la plateforme de remorquage, au niveau d’un second point d’ancrage.

[0002] Le procédé est mis en œuvre par un système qui comprend un calculateur et une caméra orientée vers l’arrière du tracteur.

[Etat de la technique antérieure]

[0003] De nombreuses technologies sont actuellement développées pour aider les conducteurs à la conduite de véhicules, en leur fournissant par exemple des informations supplémentaires sur la configuration du véhicule et sa position par rapport à son environnement. Ces technologies sont également nécessaires dans une perspective de véhicules complètement autonomes. C’est le cas pour les véhicules individuels, mais aussi pour des véhicules de transports, comprenant typiquement un véhicule tracteur et une remorque.

[0004] Pour l’assistance à la conduite de tels véhicules, et notamment pour des manœuvres visant à garer le véhicule, il est critique de connaître avec précision au moins l’angle de lacet de la remorque par rapport au véhicule tracteur.

[0005] Certaines configurations de véhicules à remorques sont particulièrement complexes, c’est le cas de véhicules présentant deux attelages, soit deux articulations, et qui se composent d’un véhicule tracteur, d’une plate-forme de remorquage articulée sur le tracteur, au niveau d’un premier point d’ancrage, et d’une remorque articulée sur la plate-forme, au niveau d’un second point d’ancrage. [0006] On connaît notamment un type de véhicule à deux articulations dans lequel le tracteur est un poids lourd de type rigide.

[0007] La plate-forme de remorquage est parfois désignée sous le terme anglais de « dolly » et c’est sur cette plateforme qu’une remorque ou une semi-remorque est ensuite attachée.

[Problème technique restant posé]

[0008] Un problème constant constaté avec un tel type de véhicule à double articulations, autrement dit à double attelages, est la difficulté à manœuvrer du fait de la double rotation entre le tracteur et la remorque.

[0009] Il serait donc désirable d’assister le conducteur en lui fournissant un contrôle basé sur l’angle réel de la semi-remorque en lieu d’utiliser le volant, ce qui permet de mieux maîtriser la trajectoire de l’ensemble du véhicule dans une manœuvre de parking.

[Exposé de l’invention]

[0010] La présente invention a notamment pour but de proposer un moyen de détermination de la position d’un véhicule à deux articulations.

[0011 ] En particulier, un but de l’invention est de permettre de déterminer au moins l’angle formé par une remorque par rapport à une plate-forme de remorquage qui est elle-même articulée par rapport au tracteur.

[0012] On atteint cet objectif, ainsi que d’autres apparaîtront à la lecture de la description qui suit, avec un procédé de détermination de la position angulaire d’un véhicule qui comprend un tracteur, une plate-forme de remorquage articulée sur le tracteur au niveau d’un premier point d’ancrage, au moins autour d’un premier axe de rotation globalement perpendiculaire au plan général de la plate-forme de remorquage, et une remorque articulée sur la plate-forme de remorquage au niveau d’un second point d’ancrage, au moins autour d’un second axe de rotation globalement perpendiculaire au plan général de la plate-forme de remorquage, au niveau d’un second point d’ancrage, procédé mis en œuvre par un système comprenant un calculateur et une caméra orientée vers la remorque, caractérisé en ce qu’il comprend les étapes suivantes : - acquisition par la caméra d’une première image dans une première position de référence du véhicule, et détection d’au moins un point caractéristique de la remorque dans ladite première position, qui est observé dans la première image,

- acquisition par la caméra d’une deuxième image dans une seconde position du véhicule, et détection dudit point caractéristique dans la seconde position, qui est observé dans la deuxième image, le point caractéristique détecté étant le même pour chaque position,

- estimation de la position du point caractéristique dans la première position et la seconde position du véhicule, qui est observé dans la première image et dans la seconde image respectivement, par minimisation d’une fonction coût basée sur une itération de différentes valeurs de la hauteur du point caractéristique dans la première position du véhicule et du point caractéristique dans la seconde position du véhicule, suivant un axe perpendiculaire au plan général de la plate-forme de remorquage, et

- détermination de l’angle de rotation entre la remorque et la plate-forme de remorquage en se basant sur la position du point caractéristique estimé dans la première position et la seconde position au cours de l’étape d’estimation précédente. Le procédé selon l’invention offre l’avantage de pouvoir s’adapter à différents types de véhicule, en particulier différents types de remorques qui présentent des géométries distinctes, comme une benne, une remorque de grumes de bois ou une remorque du type citerne.

[0013] Suivant d’autres caractéristiques optionnelles du procédé selon invention, prises seules ou en combinaison :

- la fonction coût utilisée dans l’étape d’estimation de la position du point caractéristique est la suivante : coût = 11| P RLA - M A || — || P R B~ M B || | avec :

- PRLA le point qui matérialise l’intersection entre un plan imaginaire parallèle au plan général de la plate-forme de remorquage et de hauteur variable, et un rayon optique de la caméra qui passe par le point caractéristique de la première position,

- MA le second point d’ancrage dans la première position, - PRLB le point qui matérialise l’intersection entre ledit plan imaginaire parallèle au plan général de la plate-forme de remorquage et de hauteur variable, et un rayon optique de la caméra qui passe par le point caractéristique de la seconde position, et

- MB le second point d’ancrage dans la seconde position ;

[0014] - l’étape de détermination géométrique de l’angle de rotation entre la remorque et la plate-forme de remorquage est obtenue par le calcul suivant :

- FryB le point caractéristique estimé dans la seconde position,

- FryA le point caractéristique estimé dans la première position, et

- M le second point d’ancrage. On notera que le procédé est basé sur des calculs simples qui favorisent une exécution rapide par un calculateur ;

[0015] La présente invention se rapporte également à un système de détermination de la position angulaire d’un véhicule qui comprend un tracteur, une plate-forme de remorquage articulée sur le tracteur au niveau d’un premier point d’ancrage, au moins autour d’un premier axe de rotation globalement perpendiculaire au plan général de la plate-forme de remorquage, et une remorque articulée sur la plate-forme de remorquage au niveau d’un second point d’ancrage, au moins autour d’un second axe de rotation globalement perpendiculaire au plan général de la plate-forme de remorquage, au niveau d’un second point d’ancrage, procédé mis en œuvre par un système comprenant un calculateur et une caméra orientée vers la remorque, caractérisé en ce qu’il est configuré pour mettre œuvre le procédé du type décrit précédemment.

[0016] Aussi, la présente invention se rapporte à un produit programme d’ordinateur, comprenant des instructions de code pour la mise en œuvre du procédé décrit précédemment.

[Description des dessins]

[0017] D’autres caractéristiques et avantages de l’invention ressortiront à la lecture de la description qui suit, en référence aux figures annexées, qui illustrent : [Fig. 1 ] : une vue schématique de côté d’un véhicule à deux articulations comprenant successivement un tracteur, une plate-forme de remorquage et une remorque, auquel est appliqué le procédé selon l’invention ;

[Fig. 2] : une vue schématique de dessus du véhicule de la figure 1 dans une première position de référence ;

[Fig. 3] : une vue schématique de dessus du véhicule de la figure 1 dans une seconde position dans laquelle la plate-forme de remorquage délimite un angle non nul avec le tracteur et avec la remorque ;

[Fig. 4] : une vue schématique en perspective du véhicule de la figure 1 dans sa première position de référence ;

[Fig. 5] : une vue schématique en perspective du véhicule de la figure 1 dans sa seconde position ;

[Fig. 6] : un organigramme du déroulement des étapes du procédé selon l’invention ;

[Fig. 7] : un schéma géométrique de la position estimée du point caractéristique dans la première image et dans la seconde image par rapport au second point d’ancrage.

[0018] Pour plus de clarté, les éléments identiques ou similaires sont repérés par des signes de référence identiques ou similaires sur l’ensemble des figures.

[Description des modes de réalisation]

[0019] Pour clarifier les pièces de la présente demande de brevet, on adoptera à titre non limitatif la terminologie horizontale et vertical en référence au sol sur lequel se déplace le véhicule, le sol étant considéré comme horizontal.

[0020] De plus, on adoptera à titre non limitatif la terminologie longitudinal, vertical et transversal en référence au trièdre L, V, T indiqués aux figures 1 à 5.

[0021] On a représenté à la figure 1 un véhicule 10 automobile en configuration d’utilisation sur un sol 12 horizontal.

[0022] Le véhicule 10 comprend un tracteur 14, une plate-forme de remorquage 16 articulée par une liaison rotule sur le tracteur 14 au niveau d’un premier point d’ancrage N. [0023] La liaison rotule entre la plate-forme de remorquage 16 et le tracteur 14 autorise trois degrés de liberté en rotation, et en particulier un degré de rotation autour d’un premier axe 01 de rotation vertical et perpendiculaire au sol 12.

[0024] De plus, une remorque 18 est montée articulée par une liaison rotule sur la plate-forme de remorquage 16 au niveau d’un second point d’ancrage M.

[0025] La liaison rotule entre la remorque 18 et la plate-forme de remorquage 16 autorise trois degrés de liberté en rotation, et en particulier un degré de rotation autour d’un second axe 02 de rotation vertical et perpendiculaire au plan général de la plate-forme de remorquage.

[0026] On a également représenté à la figure 1 un système 20 qui comprend un calculateur 22 et une caméra 24. La caméra 24 est montée sur le tracteur 14 et est adaptée pour acquérir des images de la remorque 18.

[0027] Dans ce but, la caméra 24 est avantageusement positionnée à l’arrière du tracteur 14, en étant dirigée vers la remorque 18, avec un axe optique 03 longitudinal sensiblement parallèle à l’axe 04 du tracteur 14.

[0028] En variante, la caméra 24 peut présenter une autre orientation, et il faut alors réaliser une calibration de la caméra 24 pour connaître cette orientation et en tenir compte pour la détermination des angles du véhicule 10.

[0029] Le calculateur 22 est associé à une mémoire (non représentée) comprenant un programme d’ordinateur pour l’exécution du procédé selon l’invention décrit ci- après. Le calculateur 22 peut être un processeur, microprocesseur, contrôleur, microcontrôleur ou autre.

[0030] Sur la figure 2, on a représenté schématiquement le véhicule 10 dans une première position de référence qui correspond à un déplacement rectiligne du véhicule 10, dans laquelle l’angle de rotation entre le tracteur 14 et la plate-forme de remorquage 16 est nul.

[0031] De même, l’angle de rotation entre la plate-forme de remorquage 16 et la remorque 18 est nul.

[0032] Sur la figure 3, on a représenté schématiquement le véhicule 10 dans une seconde position qui correspond à un déplacement non rectiligne du véhicule 10, dans laquelle l’angle de rotation a1 entre le tracteur 14 et la plate-forme de remorquage 16 est non nul.

[0033] De même, l’angle de rotation a2 entre la plate-forme de remorquage 16 et la remorque 18 est non nul.

[0034] Pour faciliter la compréhension de la description, les références indicées par la lettre majuscule A et la lettre majuscule B font référence à la première position et à la deuxième position du véhicule 10 respectivement.

[0035] On notera notamment que le premier point d’ancrage N et le second point d’ancrage M représentés à la figure 1 sont notés NA, NB et MA, MB en référence à la première position et à la deuxième position du véhicule 10 respectivement. Cette notation s’applique mutatis mutandis aux autres références.

[0036] Sur les figures 2 et 3, différents systèmes de coordonnées sont représentés. Le système de coordonnées CS1 a comme référentiel le tracteur 14 et comme centre le centre optique de la caméra 24.

[0037] Le système de coordonnées CS2 a comme référentiel le tracteur 14 et comme centre le premier axe 01 de rotation au niveau du premier point d’ancrage N, le système de coordonnées CS2 est aligné avec le tracteur 14.

[0038] Le système de coordonnées CS3 a comme référentiel la plate-forme de remorquage 16 et comme centre le premier axe 01 de rotation au niveau du premier point d’ancrage N, le système de coordonnées CS3 est aligné avec la plate-forme de remorquage 16.

[0039] Le système de coordonnées CS4 a comme référentiel la plate-forme de remorquage 16 et comme centre le second axe 02 de rotation au niveau du second point d’ancrage M, le système de coordonnées CS4 est aligné avec la plate-forme de remorquage 16.

[0040] Enfin, le système de coordonnées CS5 a comme référentiel la remorque 18 et comme centre le second axe 02 de rotation au niveau du second point d’ancrage M, le système de coordonnées CS5 est aligné avec la remorque 18. [0041] La relation entre les systèmes de coordonnées CS1 et CS2 est une unique translation du centre optique de la caméra 24 jusqu’au premier point d’ancrage N, et une rotation si la caméra 24 n’est pas alignée dans l’axe du tracteur 14.

[0042] La relation entre les systèmes de coordonnées CS2 et CS3 est une rotation à trois degrés de liberté autour du premier point d’ancrage N.

[0043] La relation entre les systèmes de coordonnées CS3 et CS4 est une translation du premier point d’ancrage N jusqu’au second point d’ancrage M.

[0044] Enfin, la relation entre les systèmes de coordonnées CS4 et CS5 est une rotation à trois degrés de liberté autour du second point d’ancrage M, rotation que l’on simplifie à un degré de liberté autour du second axe 02 en considérant que le sol 12 est plan.

[0045] Aussi, on indicera les systèmes de coordonnées CS3, CS4, CS5 avec la lettre majuscule A et la lettre majuscule B, en référence à la première position et à la deuxième position du véhicule 10 respectivement. Par exemple, CS3B désigne le système de coordonnées CS3 dans la seconde position du véhicule 10, comme sur la figure 3. Les systèmes de coordonnées CS1 et CS2 ne sont pas concernés par les indices A et B car ils sont immobiles dans le référentiel du véhicule 10.

[0046] On notera H1-2 une matrice de transformation homogène du système de coordonnées CS1 au système de coordonnées CS2, cette matrice H1-2 de transformation homogène étant connue.

[0047] Ce type de notation s’applique mutatis mutandis aux autres matrices de transformation homogène.

[0048] La matrice H1-2 est une concaténation d’une matrice de rotation et de translation telle que : [0052] et P2 sont les coordonnées du point P dans le système de coordonnées

[0056] Où Rij12 sont les termes de rotation entre les systèmes de coordonnées CS1 et CS2 et Ti12 sont les termes de translation entre les systèmes de coordonnées CS1 et CS2.

[0057] Toutes les notations précédentes s’appliquent mutatis mutandis aux autres systèmes de coordonnées.

[0058] Aussi, on notera que l’on connaît les transformations H2-3A, H3A-4A et H4A-5A.

[0059] Pour toute autre position, et en particulier pour la seconde position du véhicule 10, on connaît les transformations H2-3B et H3B-4B, mais on doit identifier la transformation H4B-5B qui correspond à la rotation entre la remorque 18 et la plate-forme de remorquage 16.

[0060] On notera également que MA désigne la position du second point d’ancrage dans la première position du véhicule 10 et que MB désigne la position du second point d’ancrage dans la seconde position du véhicule 10.

[0061] On a représenté à la figure 6 les étapes du procédé de détermination de la position angulaire du véhicule 10, procédé mis en œuvre par le système 20 décrit précédemment, selon l’invention.

[0062] Plus particulièrement, le procédé selon l’invention vise à déterminer l’angle de rotation a2 entre la remorque 18 et la plate-forme de remorquage 16, en se basant sur la correspondance de points caractéristiques entre différentes positions et images associées, et une estimation de l’angle de rotation a1 entre le tracteur 14 et la plate-forme de remorquage 16. Des méthodes d’estimation de l’angle de rotation entre deux éléments montés pivotants sont connues de l’homme du métier et ne seront donc pas décrites dans la présente description.

[0063] On connaît notamment une méthode qui consiste à utiliser un capteur mécatronique pour déterminer l’angle de rotation a1 entre le tracteur 14 et la plateforme de remorquage 16.

[0064] Le procédé comporte une première étape d’acquisition 100 d’une première image par la caméra 24, dans la première position de référence du véhicule 10, illustrée à la figure 2. De préférence, dans la première position de référence, les angles a1 et a2 sont nuis. A cet égard, le véhicule 10 a de préférence circulé sur une ligne droite sur une distance suffisante pour pouvoir adopter cette position de référence.

[0065] De plus, la première étape d’acquisition 100 comprend une détection d’un ensemble de points caractéristiques dans la première position, en se basant sur la première image associée. Avantageusement, l’ensemble de points caractéristique comprend des points saillants de la remorque 18.

[0066] La détection de l’ensemble de points caractéristiques comprend une phase de segmentation qui est connue de l’homme du métier et qui vise à séparer les points caractéristiques appartenant à l’objet d’intérêt, ici la remorque 18, de ceux qui sont sans intérêt, comme l’arrière-plan ou la plate-forme de remorquage 16 par exemple.

[0067] Par soucis de clarté, l’exemple de réalisation du procédé selon l’invention décrit ci-après prend en compte un seul point caractéristique FA représenté à la figure 2.

[0068] A la suite de la première étape d’acquisition 100, le procédé comprend une seconde étape d’acquisition 200 d’une deuxième image par la caméra 24, dans la seconde position du véhicule 10, illustrée à la figure 3, après circulation du véhicule 10.

[0069] Aussi, la seconde étape d’acquisition 200 comprend une détection d’au moins une partie des points caractéristiques détectés dans la première position de référence du véhicule 10. Par soucis de clarté, seul le point caractéristique FB de la seconde position observé dans la seconde image, qui correspond au point caractéristique FA détecté dans la première position observé dans la première image, est pris en compte dans le présent exemple de réalisation de l’invention.

[0070] Cette détection peut être mise en œuvre en réalisant un suivi de la position des points caractéristiques entre la première et la deuxième position, selon des méthodes connues de l’homme du métier.

[0071 ] Optionnellement, plusieurs images peuvent être acquises lors de la seconde étape d’acquisition 200 afin d’augmenter la précision sur les valeurs déterminées des paramètres.

[0072] Puisque la remorque 18 est un objet rigide qui est relié sur le second point d’ancrage M, la distance entre n’importe quel point caractéristique et le second point d’ancrage M est constante dans n’importe quelle position du véhicule 10.

[0073] Par conséquent, il est possible d’établir l’équation suivante : onde étape d’acquisition 200, le procédé comprend une étape d’estimation 300 de la position du point caractéristique FA, FB dans la première position et la seconde position du véhicule 10, en référence à la première image et à la seconde image respectivement, par minimisation d’une fonction coût basée sur une itération de différentes valeurs de la hauteur y du point caractéristique FA dans la première position du véhicule 10 et du point caractéristique FB dans la seconde position du véhicule 10.

[0076] On entend par hauteur y une distance qui s’étend suivant un axe perpendiculaire au plan général P de la plate-forme de remorquage 16, depuis le centre du système de coordonnées concerné.

[0077] Pour rappel les points caractéristiques FA et FB correspondent à un même point F de la remorque 18 lorsque le véhicule 10 occupe sa première position et sa seconde position respectivement.

[0078] On pose l’hypothèse selon laquelle toutes les rotations dans H4B-5B sont réalisées autour de l’axe vertical du système de coordonnées CS4B, en partant du principe que les mouvements de roulis et de tangage entre la plate-forme de remorquage 16 et la remorque 18 du véhicule 10 sont négligeables.

[0079] Cette hypothèse implique que la hauteur du point caractéristique FA dans CS4A et dans CS5A, et la hauteur du point caractéristique FB dans CS4B et CS5B sont égales.

[0080] On définit un plan Ly imaginaire horizontal à une hauteur y, qui est parallèle au plan général de la plate-forme de remorquage 16, comme on peut le voir à la figure 4.

[0081] Aussi, on définit le point PRLA comme étant le point d’intersection entre le plan Ly imaginaire de hauteur y variable, et un rayon optique RFA partant de la caméra 24 qui passe par le point caractéristique FA observé dans la première image. Le rayon optique RFA passe par le centre optique de la caméra 24 et relie le point caractéristique FA au système de coordonnées CS1 de la caméra 24.

[0082] Pour exprimer le point PRLA dans le système de coordonnées CS5A on utilise H 1-2, H2-3A, H3A-4A et H4A-5A.

[0083] De même, on définit le point PRLB comme étant le point d’intersection entre le plan Ly imaginaire de hauteur y variable, et un rayon optique RFB partant de la caméra 24 qui passe par le point caractéristique FB observé dans la seconde image. Le rayon optique RFB passe par le centre optique de la caméra 24 et relie le point caractéristique FB au système de coordonnées CS1 de la caméra 24.

[0084] Pour exprimer le point PRLB dans le système de coordonnées CS4B on utilise H 1-2, H2-3B et H3B-4B.

[0085] Au cours de l’étape d’estimation 300 de la position des points caractéristiques FA, FB, on considère la hauteur y comme étant la valeur qui minimise une fonction coût basée sur une itération de différentes valeurs de ladite hauteur y.

[0086] Autrement dit, on considère la hauteur y comme un paramètre permettant d’évaluer l’erreur de hauteur grâce à une fonction coût.

[0087] Plus particulièrement, la fonction coût est basée sur la minimisation de la différence entre une première distance qui est délimitée entre le second point d’ancrage MA et le point d’intersection PRLA entre le plan Ly imaginaire de hauteur y variable et le rayon optique RFA de la caméra 24 qui passe par le point caractéristique FA de la première image, et une seconde distance qui est délimitée entre le second point d’ancrage MB et le point d’intersection PRLB entre le plan Ly imaginaire de hauteur y variable et le rayon optique RFB de la caméra 24 qui passe par le point caractéristique FB de la seconde image.

[0088] La fonction coût utilisée dans l’étape d’estimation 300 est la suivante :

[0089] Avantageusement, le calculateur 22 utilise un algorithme d’optimisation pour minimiser la fonction coût.

[0090] En considérant que PRLA est exprimé dans le système de coordonnées CS5A et que MA est la référence du système de coordonnées CS5A, alors on peut écrire : érant que PRLB est exprimé dans le système de coordonnées CS4B et que MB est la référence du système de coordonnées CS4B, alors on peut écrire :

[0094] Avantageusement, la valeur de la hauteur y est initialisée dans la fonction coût de sorte que les points PRLA et PRLB démarrent dans une position éloignée du centre optique de la caméra 24.

[0095] L’étape d’estimation 300 permet d’estimer la hauteur qui minimise la fonction coût décrite ci-dessus, cette hauteur estimée étant notée « y ».

[0096] La hauteur estimée y permet de déterminer les points estimés FRŸA et FRŸB qui fournissent une position dans l’espace approximative des points caractéristiques FA et FB dans la première position et la seconde position du véhicule 10 respectivement, dans les systèmes de coordonnées CS5A et CS4B respectivement. [0097] A la suite de l’étape d’estimation 300, le procédé comprend une étape de détermination 400 géométrique de l’angle de rotation a2 entre la remorque 18 et la plate-forme de remorquage 16, en se basant sur les points caractéristiques estimés FrÿA, FrÿB dans la première position et la seconde position du véhicule 10.

[0098] On peut exprimer le point FrÿA dans le système de coordonnées CS5A de la façon suivante :

[0102] Les points caractéristiques estimés FrÿA, FrÿB sont représentés à la figure 7 qui est obtenue en superposant et les centres des systèmes de coordonnées CS5A et CS4B, en alignant les systèmes de coordonnées CS5A et CS4B, en y plaçant les points caractéristiques estimés FrÿA, FrÿB à partir de leurs coordonnées préalablement calculées, puis en projetant l’ensemble selon l’axe vertical qui définit la hauteur des points caractéristiques estimés FrÿA, FrÿB.

[0103] Ainsi, la figure 7 est une projection des points caractéristiques estimés FrÿA, F^B, et du second point d’ancrage MA, MB VUS de dessus où :

[0104] F R ^ A = (x FA , z FA ) et

[0105] F R ÿ B = X FB’ Z FB)

[0106] A partir des points caractéristiques estimés FrÿA, FrÿB, on calcule l’angle de rotation a2 entre la remorque 18 et la plate-forme de remorquage 16 de la manière suivante : [0109] Ainsi, la présente invention offre une solution qui permet de déterminer l’angle de rotation a2 entre la remorque 18 et la plate-forme de remorquage 16 au moyen d’une unique caméra 24.

[0110] La détermination de l’angle de rotation a2 entre la remorque 18 et la plateforme de remorquage 16 rend possible l’assistance pour les manœuvres en marche arrière d’un véhicule à remorque à deux points d’articulation.

[0111 ] De plus, le procédé et le système de détermination de la position angulaire d’un véhicule selon l’invention sont basés sur des calculs simples qui permettent une exécution rapide par un calculateur.

[0112] Enfin, le procédé et le système de détermination de la position angulaire d’un véhicule selon l’invention sont basés sur la détermination de la position d’un ensemble de points caractéristiques de la remorque, ce qui permet une adaptabilité à un ensemble important de types de véhicules.

[0113] On notera que le procédé selon l’invention nécessite certaines conditions pour fonctionner de façon optimum.

[0114] En effet, si la caméra 24 et le point caractéristique FA, FB dont la position est à déterminer sont à une même hauteur dans le système de coordonnées dans lequel la hauteur y est itérée, alors le procédé présentera des difficultés à déterminer la position du point caractéristique.

[0115] Pour palier ceci, les hypothèses suivantes doivent être validées selon le nombre de dégrées de liberté considérés entre le tracteur 14, la plate-forme de remorquage 16 et la remorque 18, au niveau du premier point d’ancrage N et du second point d’ancrage M.

[0116] Si l'on considère que la rotation au niveau du premier point d’ancrage N et la rotation au niveau du deuxième point d’ancrage M n'ont lieu qu'autour d'un axe perpendiculaire au plan général P de la plate-forme de remorquage 16, sur un sol 12 plat, alors il suffit de suivre un point caractéristique qui se trouve à une hauteur différente de la caméra 24.

[0117] Si l'on considère que la rotation au niveau du premier point d’ancrage N a lieu sur les trois degrés de liberté et la rotation au niveau du deuxième point d’ancrage M n'a lieu qu'autour d'un axe perpendiculaire au plan général P de la plate-forme de remorquage 16, alors il suffit de suivre un point caractéristique tel que la distance entre ce point et le deuxième point d’ancrage M soit supérieure à la distance entre la caméra 24 et le premier point d’ancrage N. [0118] Si l'on considère que la rotation au niveau du premier point d’ancrage N et la rotation au niveau du deuxième point d’ancrage M ont lieu sur les trois dégrées de liberté, alors il est nécessaire d’appliquer les étapes du procédé sur plusieurs points caractéristiques se trouvant a des hauteurs différentes et à des distances relativement éloignées du deuxième point d’ancrage M. Cette configuration donnera un angle pour chaque point caractéristique, et vu que le tracteur 14 se décale avec un unique angle de lacet on peut déduire cet angle avec toute méthode d'estimation de paramètres.