Brevet FR2945231A1 — publié le 20101112

Procédé de commande d'un robot humanoïde L'invention concerne un procédé de commande d'un robot humanoïde comportant deux jambes terminées chacune par un pied pouvant prendre appui sur un sol et permettant son déplacement. L'invention trouve une utilité particulière dans la commande de la marche d'un robot humanoïde se rapprochant au mieux de celle de l'homme. La commande haut niveau d'un robot humanoïde, reste toujours un problème non résolu définitivement. L'une des problématiques des robots marcheurs humanoïdes actuels est la difficulté à les contrôler pour assurer une vitesse moyenne désirée dans un régime dynamique du fait de l'inertie w importante de ces robots. Au mieux, on ne peut constater cette vitesse moyenne d'avancée qu'une fois l'enjambée achevée. A l'heure actuelle, aucune stratégie de contrôle applicable en temps réel ne permet de le comportement dynamique du robot durant l'enjambée suivante et d'en déduire un paramètre de contrôle fondamental conditionnant le 15 comportement énergétique du système pour atteindre une vitesse moyenne désirée pour cette enjambée suivante. La question principale à laquelle ce type de commande essaye de répondre est la suivante : pour réaliser une marche, quelle relation faut-il établir entre les termes suivants : la vitesse du robot représentée par la vitesse de son centre de gravité, la longueur de pas 20 actuelle et celle à effectuer à chaque instant, les forces produites par les jambes, et les effets dynamiques produits par la partie supérieure du corps du robot. Plus on souhaite se rapprocher de la démarche humaine, plus cette question devient complexe et la réponse correspondante inconnue. 25 Ainsi, tous les travaux proposés dans ce domaine commencent par s'appuyer sur un modèle simple de la marche humaine, ensuite les méthodes sont étendues afin de générer une marche plus naturelle. En se basant sur des études biomécaniques, on constate que le mouvement du centre de gravité de l'être humain durant la marche, ressemble au 30 mouvement d'un pendule inverse dans l'espace. Ceci a permis de proposer le modèle le plus simple présenté par un pendule inverse dans le plan sagittal. Plusieurs méthodes ont été proposées, pour résoudre ce problème, bien connu dans ta littérature anglo-saxonne par � Pattern Generator � que l'on peut traduire par générateur d'allure. Dans ces méthodes on cherche par exemple à déterminer la trajectoire du centre de gravité et la longueur de pas appropriée durant la marche du robot. Une première méthode intuitive est basée sur l'analyse de s variations angulaires de chaque articulation du robot humanoïde. Cette méthode est bien connue dans la littérature anglo-saxonne sous le nom de � Joint Space �. Dans cette méthode on cherche à trouver directement, la variation angulaire des articulations avec le temps. Le cycle de la marche est subdivisé en plusieurs phases. Les valeurs initiales et io finales d'angles des articulations pour chaque phase sont par la suite déterminées. Enfin, une interpolation temporelle, entre la valeur initiale et la valeur finale permet de définir la variation angulaire des articulations au cours de temps. Cette méthode ne prend pas en compte l'effet dynamique du robot. Elle est utile pour faire marcher des robots de petite taille, typiquement 1s inférieurs à 0,5 m, à faible vitesse. Elle ne donne pas de bons résultats pour des robots de taille humaine adulte destinés à avancer à la vitesse de marche humaine, par exemple de l'ordre de 1 à 2 m/s. Une deuxième méthode dite du pendule inverse approche la dynamique du robot par celle d'un pendule inverse ou l'ensemble de la 20 masse du robot est supposée être concentrée au niveau du centre de gravité du robot. La masse du robot se balance autour d'un point d'appui posé au sol. Cette méthode permet d'obtenir une marche plus naturelle que la méthode précédente. Un autre avantage est le temps de calcul faible, grâce au modèle simple du pendule inverse. 25 Dans une troisième méthode dite des multi-pendules, la dynamique de robot est approchée à l'aide de plusieurs pendules afin de s'approcher au mieux de la dynamique du corps complet. Différents sous ensembles rigides mobiles entre eux au niveau des articulations sont modélisés chacun par des pendules inverses. Ce modèle est plus proche de 30 la dynamique de robot, mais nécessite des temps de calcul très grands, ce qui rend l'utilisation de ce modèle en temps réel difficile. Toutes les méthodes présentées précédemment, sont basées sur le modèle dynamique, soit simplifié, soit un peu plus affiné. Ceci entraine que l'application de l'une de ces méthodes nécessite la résolution d'un système 35 d'équations différentielles. Ainsi, plus qu'on choisit un modèle fin, plus le temps nécessaire pour résoudre ce système devient grand. Ce qui limite grandement leur utilisation en temps réel, et bien sûr empêche le contrôle prédictif. Par ailleurs, toutes ces méthodes ne gèrent pas l'énergie globale du robot durant la marche. Ainsi aucune garantie n'est assurée pour que le robot utilise d'une manière optimale son énergie. Ce dernier aspect conditionne fortement son autonomie. L'invention vise à pallier tout ou partie des problèmes cités plus la haut en proposant un procédé de commande d'un robot humanoïde comportant deux jambes terminées chacune par un pied pouvant prendre appui sur un sol et permettant son déplacement, caractérisé en ce qu'il consiste à partir d'une équation de conservation de l'énergie totale moyenne durant une enjambée courante à déterminer des paramètres nécessaires à is exécuter l'enjambée suivante. La méthode proposée, est basée sur des critères énergétiques par exemple appliqués à un modèle de pendule inverse. Elle permet d'établir, pour une enjambée, une relation entre des variables géométriques, une force 20 propulsive à exercer par une jambe sur le sol et une vitesse moyenne désirée. Pour exécuter l'enjambée suivante, on peut imposer deux paramètres dans la relation précédemment définie afin de déterminer le troisième paramètre. 25 Les variables géométriques de l'enjambée suivante comprennent par exemple une distance séparant une zone d'appui sur le sol d'un pied du robot durant l'enjambée courante et une zone d'appui sur le sol d'un pied du robot durant l'enjambée suivante. Autrement dit, il s'agit de la longueur du pas de l'enjambée suivante. 30 Dans le plan sagittal, la longueur du pas peut comprendre une distance horizontale et une distance verticale afin de franchir un obstacle tel que par exemple la montée d'une marche d'escalier ou le déplacement du robot sur un sol en pente. On peut bien entendu exprimer les variables géométriques, la 35 force propulsive à exercer par une jambe sur le sol et la vitesse moyenne désirée dans un espace à trois dimensions, de manière à permettre au robot de changer de direction lors de son déplacement. La relation est déterminée en fonction de données connues par exemple mesurées à l'enjambée précédente et à partir des équations de l'énergie moyenne durant une enjambée pour un système non conservatif. Les données connues peuvent également avoir été estimées ou calculées. Le fait d'utiliser l'énergie moyenne permet d'éviter la mise en oeuvre d'équations dynamiques temporelles conduisant à la résolution d'équations différentielles complexes. ro L'énergie totale moyenne est exprimée en fonction de la configuration géométrique de robot, ce qui permet d'éviter d'utiliser toute variable temporelle. Il est possible de tenir compte de tous les types d'énergies mécaniques apportées au robot y compris des perturbations comme par 15 exemple le fait de pousser le robot ou encore des efforts dus au vent. En l'absence de perturbations, c'est-à-dire en ne tenant compte que de la seule marche du robot sur le sol, dans l'équation de l'énergie totale, la somme de l'énergie cinétique du robot et de l'énergie potentielle du robot est considérée constante tant qu'un seul pied est en contact avec le 20 sol. Dans l'équation de conservation de l'énergie pour une enjambée, on distingue trois phases : une phase de simple support où seule la jambe arrière l'appui au sol, une phase de double support où la jambe avant vient en contact avec le sol, tout en conservant la jambe arrière en appui et une 25 troisième phase où la jambe arrière a quitté le sol. Par convention, une enjambée débute par une phase de simple appui lorsque le centre de gravité du robot est à la verticale de son appui au sol. Seule la phase de double support constitue une phase motrice dans la marche. C'est la jambe arrière qui exerce une force sur le sol pour augmenter l'énergie totale du robot. 30 En distinguant un nombre fini de phases, il n'est pas nécessaire d'effectuer un calcul différentiel et la détermination des paramètres nécessaires à exécuter l'enjambée suivante ne se fait qu'une seule fois par enjambée. Du fait de la simplicité des calculs, Il est tout à fait possible de déterminer des paramètres pour plusieurs enjambées à venir. 35 L'invention sera mieux comprise et d'autres avantages apparaîtront à la lecture de la description détaillée d'un mode de réalisation donné à titre d'exemple, description illustrée par le dessin joint dans lequel : la figure 1 représente un robot et sa modélisation sous forme de pendule inverse ; la figure 2 représente l'enchainement de deux pas sur un sol plan en utilisant le modèle de la figure 1 ; la figure 3 représente un exemple de solution graphique permettant de déterminer la longueur d'un pas suivant ; io la figure 4 représente l'enchaînement de deux pas avec franchissement d'un obstacle en utilisant le modèle de la figure 1 ; le tableau 1 définit les variables utilisées dans la suite de la description. Par souci de clarté, les mêmes éléments porteront les mêmes 15 repères dans les différentes figures. Pour expliquer l'invention de façon simple, on utilise un modèle de pendule inverse ou toute la masse du robot est concentrée en son centre de gravité. De plus, on étudie le mouvement de ce pendule simple dans le plan 20 sagittal. Il est bien entendu possible de mettre en oeuvre un modèle plus complexe, par exemple celui des multi pendules pour affiner la démarche du robot. On s'est néanmoins rendu compte que dans le modèle des multi pendules, il est possible de trouver une relation entre les déplacements angulaires des différents pendules qui ne sont pas indépendants les uns des 25 autres. Par ailleurs, la description qui suit est faite dans le plan sagittal. Autrement dit la modélisation est faite en deux dimensions et le robot avance uniquement dans son plan sagittal. Il est tout à fait possible d'étendre le modèle à tout déplacement en trois dimensions. 30 La figure 1 représente un robot humanoïde 10 comprenant essentiellement un corps 11 supporté par deux jambes 12 et 13. Chaque jambe étant terminée par un pied, respectivement 14 et 15, pouvant prendre appui sur un sol 16 plat. Les jambes 12 et 13 permettent le déplacement du 35 robot 10. Sur la figure 1, seul le pied 14 est posé au sol. Le pied 15 est soulevé pour réaliser une enjambée permettant au robot 10 de marcher. Pour l'ensemble du robot 10, on définit son centre de gravité G. Le robot 10 est représenté dans un repère Oxy formé par un plan sagittal du robot 10. L'origine O du repère est placé au centre de l'appui du pied 14 sur le sol 16 L'axe Ox est horizontal et l'axe Oy est vertical. Deux variables géométriques R et 8 permettent de définir la position du centre de gravité G dans le repère Oxy. 8 représente un angle d'élévation entre d'une part une droite reliant l'origine O et le centre de gravité G et d'autre part l'axe Oy. R représente une distance séparant l'origine O et le centre de gravité G. On utilise la io modélisation de pendule inverse dans laquelle toute la masse m du robot 10 est concentrée en son centre de gravité. Cette masse m oscille autour de l'origine O. La figure 2 représente l'enchainement de deux pas sur un sol plan 15 en utilisant le modèle du pendule inverse défini à la figure 1 et la figure 4 représente l'enchainement de deux pas avec franchissement d'un obstacle en utilisant le même modèle. La description des figures 2 et 4 sont reportées en annexe 1 qui permettent d'expliquer un exemple d'équation de conservation de l'énergie totale moyenne durant une enjambée. 20 L'équation de conservation de l'énergie totale moyenne sur un sol plan est de la forme : sin 7Â1x+lai 2x A. R équation dans laquelle : 25 • À, représente une proportion de l'enjambée parcourue où un seul pied est en appui au sol, avant la pose du deuxième pied au sol ; • x représente la longueur de l'enjambée suivante ; • iii représente une première fonction de la longueur de l'enjambée courante Li, de la longueur de l'enjambée précédent l'enjambée courante 30 Li-1, d'une force motrice exercée par une jambe durant l'enjambée courante Fi, une vitesse de déplacement moyenne du robot durant l'enjambée courante Vi et une vitesse de déplacement moyenne du robot durant l'enjambée suivante V,+1 ; • A; représente une seconde fonction de la longueur de l'enjambée courante Li, de la longueur de l'enjambée précédent l'enjambée courante Li-1, d'une force motrice exercée par une jambe durant l'enjambée courante Fi, une vitesse de déplacement moyenne du robot durant l'enjambée courante Vl et une vitesse de déplacement moyenne du robot durant l'enjambée suivante V;+1 ; • R représente une distance séparant une zone d'appui au sol et un centre de gravité G du robot 10. Le tableau 1 définit les différentes variables utilisées en annexe 1. Les différentes variables R avec leurs indices ou exposants sont notés longueur de la jambe. II s'agit en fait de la distance séparant le centre de gravité G du point d'appui au sol. Il en est de même pour les élévations e.15 Annexe Stratégie de contrôle dans le plan sagittal Hypothèses de travail Plusieurs hypothèses ont été proposées pour déveloper cette stratégie : 1. On est dans le cas du pendule inverse, avec une masse concentrée au centre de gravité du robot. 2. Les jambes du robots sont considérées sans masse. 3. Le contact entre les jambes et le sol est supposé être ponctuel et sans glisseront. 4. La longeur de jambe est constante durant la phase de simple support. 5. Il y n'a pas de rebond lors du contact entre la jambe et le sol (choc mou). 6. On ne traite pas le cas du premier et du dernier pas. Développement de la stratégie La figure (2) montre un schéma d'un système muni de deux jambes (dé-signées jambe arrière et jambe avant) qui sont représentées chacune par un pendule inverse, dans le plan sagittal. Sur cette figure, les différentes phase par lesquelles passe le système sont représentées. On distingue alors, une première phase de simple support (SS) de la jambe avant, une phase de double support où les deux jambes avant et arrière sont en contact avec le sol (DS) et enfin la phase de simple support de la jambe arrière (SS). L'analyse énergétique du système bipendulaire durant la ieme enjambée (pas) permettra d'identifier une relation entre les différentes grandeurs et conduira à un résultat original. Le tableau (1), definit les variables présentées sur la figure (2.), et qui seront utilisées par la suite. On désigne par élévation d'un corps l'angle que fait celui-ci avec la verticale. En appliquant le principe de conservation de l'énergie au système bipendulaire dans la configuration définie par les angles 8r et Of, durant la ieme phase de simple support, on peut écrire la relation suivante : Et(0) = Ep(�) + E,(0) = Cr' (1) Comme les jambes sont supposées être sans masse (masse centrée), l'équation (1) peut s'écrire sous la nouvelle forme suivante ne faisant intervenir que l'angle 8r de la jambe arrière qui est en contact : Et(er) = Ep(Or) + Ec(er) = Ce (2) Cette relation est vraies quelque soit er. Ceci permet de définir les va-leurs moyennes durant la Terne phase SS, des trois quantités Et(Or), Ep(Or) et Ec(6.r) de la manière suivante : - _ 1 [roi-7 1 '97 1 "e7 Et'` L9 J- ~.+_ Et(8r) der' p,i = A07. ~._ Ep(Br) der, Ec i - = ~Br re._ Ec(Br) d9r , + + Donc le principe de conservation d'energie, durant la ième phase de simple support, peut s'étendre aux énergies moyennes définies précédemment sous la forme suivante : E- t,i i- +Ec,icite (3) En effectuant le bilan énergétique du système, entre deux phases de simple supports successives, on peut écrire l'équation suivante : Et,i+1 = Et i ù Ei,i + DEpr,i (4) Et,i+i est l'énergie totale moyenne du système bipendulaire durant la (i + 1)eme phase de SS. /Epr,i représente l'apport énergétique de la phase propulsive durant la ième phase de DS et Ei,i traduit la perte énergétique due à l'impact de la jambe avant au moment de l'attaque du talon (début de la ième phase de DS). Il s'agit maintenant de définir l'ensemble des termes de l'équation ( 4). calcul de et Ét,i+1 : Tout d'abord, pour calculer Ét,i (équation 3), il faut exprimer les énergies potentielles et cinétiques moyennes. Comme Ep(Or) = m.g rRi cos(Or), on peut exprimer alors l'énergie potentielle moyenne durant la ième phase de SS sous la forme suivante : 97tg rRi '87 [sinCofl + sin(re 1) EpZ aer fCOS(Or) d8r = rngrRi_ Z + 1 (5) L'énergie cinétique moyenne s'exprime en fonction de la moyenne de la norme quadratique de la vitesse (notée Vi) sous la forme : - rn -2 Eci= 2V. (6) En utilisant les équations (5 et 6), l'expression de l'énergie totale moyenne peut alors être établie sous la forme suivante : Ti- sin(rei ) + sin(rei-1) m' - 2 Et'i = mg "07 + rot-1 - + 2 Vi (7) Le même développement pour la (i + 1)eme phase de simple support permet d'aboutir l'expression suivante de Ep,i+1 E f + [sin(foi) + sin(fei) (8) p,i+i = m9 R• z -T+, + fo; D'où l'expression de l'énergie totale moyenne Ép,i+i sin(f8+-f-1) + sin(fe2) m - a Et,i+1 = m9 fRi f F + 2 i+1 (9) ei+1 + et calcul de Ei,i : En se basant sur la troisième hypothèse, l'energie absorbée par l'impact est égale à l'energie cinétique suivant la direction de l'impact. Ainsi pour calculer cette perte énergétique due à l'impact de la jambe avant au moment de l'attaque du talon, il faut exprimer la vitesse V,i de la jambe avant, à cet instant. E..= m 2V? La description géométrique donnée par la figure (1) permet de donner l'ex-pression suivante de cette vitesse d'impact : V ,i = V- cos(a) avec a = '8~ + f87 ù Il 2 D'où l'expression finale de V,i donnée par l'équation suivante : V,i = v i- + fei ) (10) L'énergie cinétique du système à la configuration définie par Or = rei per-met de calculer la vitesse V- en fonction de l'énergie totale moyenne E't,i et l'énergie potentielle Ep(rOi ). Ceci se traduit par l'équation suivante : Ec(rO ) = 2 (V_)2 = Et,i ù Ei,(rOi) = Et,i ù magrR.i cos(rei ) En utilisant cette dernière expression et celle de la vitesse V,i (équation 10), la perte énergétique peut s'écrire alors sous la forme définitive suivante : Eii= 2(V )2=[E i ù mg rRti cos(rei ) sili(rei + fei )2 (11) M calcul de AEpr,i : L'apport énergétique de la phase propulsive durant la ieme phase de DS est dû au couple actif autour du point de contact du pied avant. Ce couple désigné par Ti est produit par la force Fi(Or) qu'exerce la jambe arrière durant la ieme phase de DS. Il a pour expression : Ti(Or) = Fi(Br)Li cos(Or) L'énergie élémentaire de propulsion dEpr,i qu'apporte ce couple peut alors être exprimé sous la forme suivante : dEpr,i(Or) = Ti(Or)der Dans une première approche, la force Fi(Or) est supposée être constante durant toute la phase de DS et égale à Fi. Ainsi, l'énergie élémentaire de propulsion dEpr,i peut s'écrire sous la forme suivante : dEri(0) = FiLi cos(Or)d9r Finalement, AEpr,i est la somme de ces énergies élémentaires de propulsion et aura pour expression : AF%pr,i = F;Li [sin(TOa) ù sin(roti )] (12) Propriétés géométriques Afin d'obtenir une forme concise et exploitable du bilan énergétique, des propriétés géométriques peuvent être établies. Ces propriétés permettront d'exprimer les différentes longueurs et angles intervenant dans les termes de l'équation (4). En analysant la figure (1), on peut établir les relations suivantes. 1. Dette cette première approche, seul le cas d'un pendule inverse simple est traité, donc 'R7 = fil = R. 2. La longueur du pas Li est décomposée en une somme de trois portions :Li,i, L2,i et L3,i. Trois variables, (hl,i, )\2,i et A3,i), traduisent les parties du pas correspondantes aux phases de SS et de DS. Ces coefficients sont définis de la manière suivante : Ai,i = Lpour j E {1, 2, 3} Li On se limite dans cette étude pour le cas simple définit par les mêmes coefficients constants pour tous les pas. Ceci se traduit par cette relation : Z. 3. d'un autre coté,et apartir du figure (1), on peut écrire rR3 = \/(L1,i + L2,i)2 + (fRz )2 û L3,i = \/(a1 + À2)2 Li2 + R2 û a3 Li2 fRi = V (L2,i + L3,i)2 + (rRi )2 ù _ 1/(4 + À3)2 Li2 + R2 û a; L;2 4. Les relations géométriques permettent d'exprimer les différents angles intervenant dans les termes du bilan énergétique par leurs fonctions sin. L1,i À1Li rR~ R L1,i + L2,i (Al + À2)Li rRi \/(a1+i12)2L12+R2ù i13Li2 L3,i-1 À3Li-1 r R Li,3 À3L1 fret R Ll,i+l iLi+1 fRZ R Li,2 + (A2 + À3)Li fRi /(À2 + À3)2Li2 + R2 ù AîLi2 Relation prédictive liant Li, Li+1, Fi, Vi et Vi+1 : Afin d'établir la relation prédictive, les relations données par les équations (9, 7,11,12) sont introduites dans le bilan énergétique total du système bi-pendulaire donné par l'équation (4). En regroupant les termes et en divisant l'ensemble par la masse m, nous obtenons la première forme de cette relation prédictive. f + sin(fe+1) + sin(f'Z ) @? 07 )2 V +1 + COS(1e2 +f Ri f9 +1 +fez 2g 2g r _ sin(rei) + sin("Oi-1) cos (rea +f Bi- ) 2 + Ri FiL;(( roi- +rot_ I sin(re2 ) ù sin(rei_)] L + mg + rRz cos(rei ) sin(rei +f ei ) 2 En analysant l'équation précédente, on trouve que pour une vitesse moyenne désirée au pas suivant Vi+l, tous les éléments composant le terme de la partie droite de l'équation sont connus, durant le ieme pas actuel. En utilisant sin(rOi) = sin(rei) = sin(fO) = 2945231 A3 les expressions des fonctions sin des différents angles calculées précédemment et en les regroupant dans un même terme Ai(Li_1, Li, Fi, Vi, Vi+1), l'équation globale de conservation d'energie, peut être reformulée de la manière suivante : arcsin( À' R'+ i) + arcsin( ) La grandeur Ai a pour expression : 2 Ai = V?+1 1+ 1 vi cos aresin(À1 R L, ) + arcsin( (A2 + A3)Li } 2g 2g J(A2 + A3)2Li2 + R2 ù AîLi2 2 A1Li + A3Li_1 A1Li (~+2 + ~3)Li + ( ) + arcsin( R ) cos arcsin( R } +aresin( ) arcsin \/(À2 + A3)2Li2 + R2 ù À Lie (A1+A2)Li _ À1Li) \/(À1 +A2)2L.2 + R2 ù À3Li2 R Moi + R cos aresin( R )}sin aresin( R ) + arcsin( (A2 + %~3)Li ) \/(A2 + ä\3)2142 + R2 ù MLi2 L'équation (13) peut être réorganisée sous la forme suivante : X1Li+1 + a3Li )3L1 AlLi+1 ù arcsin( R ) = arcsin( R } Ai(Liù1, Li, Fi, Vi, vi+i) Ainsi, nous obtenons la relation prédictive recherchée et qui peut se mettre sous la forme canonique suivante : AiLi+i + ):3Li ù Ai(Li_1, Li, Fi, Vi, Vi+1) aresin(R) À1Li+1 sin = Ai(Liù1, Li; Fi, vi, Vi+1) R (14) Dans l'hypothèse que la vitesse moyenne désirée au (i+l)eme pas soit connue, la seule inconnue dans l'équation 24 est la longueur de pas Li+1 car tous les éléments relatifs au ieme pas sont déjà connus. La résolution d'une équation ayant la forme suivante permet de calculer la longueur du pas à effectuer qui est la solution de l'intersection d'une fonction sinusoïdale et d'une droite dont la pente dépend directement de la proportion de la phase de SS (voir figure 3). a1x + Ni atx sin( _ Ai R )iLi+1 + )3Li = Ai (L1_1, Li, Fi, Vi; vi+1) (13) + F1Li mg )2 (15) A q- Stratégie de contrôle dans le plan sagittal avec obstacle Le contrôle dit de haut niveau d'un robot bipède est très lié à l'environnement dans lequel la marche a lieu. L"existence des obstacles, est l'une des contraintes les plus fréquentes. Dans cette, la stratégie de contrôle présentée dans le section précédente sera étendue dans le but est de premettre au robot de franchir un obstacle. Les hypothèses de travail formulées précédemment restent toujours valables. On se limitera à donner les nouvelles expressions des énergies définies auparavant. La figure (4) présente un schéma du modèle avec un pendule inverse pour le franchissement d'un obstacle dans le plan sagittal. L'équation donnant le bilan énergétique du système, entre deux phases de simple supports successives, a la même forme que celle donnée par l'équation (16) : Et,i+1 = Et,i ù Ei,i + L\Epr,i (16) Il s'agit de définir les nouvelles expressions des termes de cette équation en tenant compte de la présence de l'obstacle défini sur la figure (4). calcul de Ét,i et Ét,i+1 : L'obstacle fera intervenir un terme supplémen- taire dans l'expression de l'énergie potentielle moyenne qui sera fonction de la hauteur (h1) de celui-ci durant le ieme phase de simple support. Ainsi, cette énergie potentielle moyenne aura pour expression : sin(re ) + sill(rO ) Ep,i = mçfRi i z 1 + mghi (17) rei + rgi-1 - En utilisant les équations (17 et 6), l'expression de l'énergie totale moyenne peut alors être établie sous la nouvelle forme suivante : r sin(rût) + sin(r9i i) m - 2 Et,i = mg R~ `fia + ~Z 1 j + mgh1 + 2 V' (18) Le même développement pour la (i + 1)ème phase de simple support pour laquelle l'obstacle a une hauteur (h2), permet d'aboutir l'expression suivante de Ep,i+1 : f + sin(fOi+--1) + sin(fOZ ) Ep,i+1 = m9 Rt + + mgh2 (19) f8i+t + fgi D'où l'expression de l'énergie totale moyenne Ép,i+1 [suum(f91) + sin(8+) = rng R+ z + mgh2 + ùV;+1 (20) fgt+1 + fût 2 calcul de Ei,i : En utilisant l'expression établie dans le cas précédent avec la nouvelle forme de l'énergie potentielle et celle de la vitesse V,i (équation 10), la perte énergétique du à l'impact peut s'écrire alors sous la nouvelle forme suivante : Ei,i == [Et,i ù mgr.R, cos(rûi) ù mghi] sin(rei + foi )2 (21) calcul de DEP,.,i : Le couple actif ( Ti) autour du point de contact du pied avant responsable de l'apport énergétique de la phase propulsive durant la ième phase de DS doit être recalculé dans le cas de la présence d'un obstacle. Pour ce faire, on définit grâce à la figure (4) les grandeurs suivantes : - la hauteur totale de l'obstacle H = hi + h2 - l'angle ,(3 = arctan(H ) - l'angle 'y=II-(3-8r 'ri est produit par la force Fi (er) qu'exerce la jambe arrière durant la ième phase de DS. Cette force est supposée également être constante durant toute la phase de DS et égale à Fi a pour nouvelle expression : Ti(8r) = Fi(8r) V Lit + H2 sin(Br + /3) En effectuant le même raisonnement que précédemment basé sur l'énergie élémentaire de propulsion qu'apporte ce couple, AE1,.,i qui est la somme de ces énergies élémentaires de propulsion et aura pour nouvelle expression : nEp, i Fi\/Li2 + H2 [cos(/3 ù rr ù cos(/3 ù r8+ )] (22) Relation prédictive liant Li_1, Li, Li+1, Fi, et Vi+1 : De la même manière, nous pouvons établir la relation prédictive en utilisant les relations données par les équations (18, 20, 21 et 22) qui sont introduites dans le bilan énergétique total du système bi-pendulaire donné par l'équation (16). La même forme que celle donnée par l'équation (13) peut être alors établie : AiLi+1 + 3 \3Li = D L4j-i, Li, vi, Vi+1) (23) aresin(R`+1) + aresin(' ) 1 Bi ùh2 ù V~+ 2g i Ai Li + a:3Lj-1 - laresin( R ) + aresin(~" R-1 ) + in + hi + _Vi2 ÀiL; arcsin( R ) + arcsin a2+a3)2L;2+(/R2ùa?L42+H)2 À2L; + a:1L; x cos \ + Fi-IL? + H2 cos(8 + aresin(- ')) ù cos(j + arcsin ÀiLi + À2L; Ai+A2)2L;2+(/R2ùa3L;2ù )2 )) (.!)) AIL; R cos(aresin + hi sin(aresin( R ) + arcsin À2L; + a3L; A2 + À3)2 Lit + (/R2 ù Ai Lie + H)2 + )2 L'équation (23) peut être réorganisée sous la forme suivante : ÀiLi+1 + À3Li À3Li !~iLi+1 ù arcsin( R = arcsin( R ) Ai(L1. 1, Li, Fi, Vi, Vi+1) Ainsi, nous obtenons la relation prédictive recherchée et qui peut se mettre sous la forme canonique suivante : A1Li+1 + À3Li ù Li, Fi, V. Vi+i) aresin(ÀR') AiLi+1 sin ) ù Bi(Li-1, Li, Fi, R (24) Sous certaines hypothèses, cette équation peut se mettre la même forme que celle donnée dans le cas sans obstacle par l'équation (25). )ix+Si Aix sin( Bi ) = R (25) REVENDICATIONS1. Procédé de commande d'un robot humanoïde (10) comportant deux jambes (12, 13) terminées chacune par un pied (14, 15) pouvant prendre appui sur un sol (16) et permettant son déplacement, caractérisé en ce qu'il consiste à partir d'une équation de conservation de l'énergie totale moyenne durant une enjambée courante à déterminer des paramètres nécessaires à exécuter l'enjambée suivante. 2. Procédé selon la revendication 1, caractérisé en ce que les paramètres de l'enjambée comprennent des variables géométriques, une io force à exercer par une jambe sur le sol et une vitesse de déplacement moyenne. 3. Procédé selon l'une des revendications précédentes, caractérisé en ce qu'il consiste à imposer deux paramètres dans un 15 ensemble de paramètres nécessaires à exécuter l'enjambée suivante comprenant des variables géométriques, une force à exercer par une jambe sur le sol et une vitesse de déplacement moyenne pour déterminer le troisième paramètre. 20 4. Procédé selon l'une quelconque des revendications 2 ou 3, caractérisé en ce que les variables géométriques de l'enjambée courante comprennent : • un angle d'élévation entre d'une part une droite reliant une zone d'appui sur le sol d'un pied du robot et le centre de gravité du robot et d'autre 25 part une direction verticale • et une distance séparant la zone d'appui et le centre de gravité. 5. Procédé selon l'une quelconque des revendications 2 à 4, caractérisé en ce que les variables géométriques de l'enjambée suivante 30 comprennent une distance séparant une zone d'appui sur le sol d'un pied du robot durant l'enjambée courante et une zone d'appui sur le sol d'un pied du robot durant l'enjambée suivante.A8 6. Procédé selon la revendication 5 caractérisé en ce que la distance comprend une distance horizontale et une distance verticale. 7. Procédé selon l'une quelconque des revendications 2 à 6, s caractérisé en ce que les variables géométriques, la force à exercer par une jambe sur le sol et la vitesse de déplacement moyenne s'expriment dans un espace à trois dimensions, de manière à permettre au robot de changer de direction lors de son déplacement. 10 8. Procédé selon l'une des revendications précédentes, caractérisé en ce que l'équation de conservation de l'énergie totale moyenne tient compte de l'énergie cinétique du robot, de l'énergie potentielle du robot, de l'énergie perdue lors d'un impact d'un pied du robot et de l'énergie motrice apportée au robot lors d'un appui au sol d'un pied du robot. 15 9. Procédé selon la revendication 8, caractérisé en ce que en l'absence de perturbations, la somme de l'énergie cinétique du robot et de l'énergie potentielle du robot est considérée constante tant qu'un seul pied est en contact avec le sol. 10. Procédé selon l'une des revendications précédentes, caractérisé en ce que la détermination des paramètres nécessaires à exécuter l'enjambée suivante ne se fait qu'une seule fois par enjambée. 25 11. Procédé selon l'une quelconque des revendications 2 à 6, caractérisé en ce que l'équation de conservation de l'énergie totale moyenne sur un sol plan est de la forme : sin/,lx+ p. ` 2,x Al i R équation dans laquelle : 30 • À1 représente une proportion de l'enjambée parcourue où un seul pied est en appui au sol, avant la pose du deuxième pied au sol ; • x représente la longueur de l'enjambée suivante ; • iii représente une première fonction de la longueur de l'enjambée courante (Li), de la longueur de l'enjambée précédent l'enjambée 20courante (Li-1), d'une force motrice exercée par une jambe durant l'enjambée courante (Fi), une vitesse de déplacement moyenne du robot durant l'enjambée courante (Vi) et une vitesse de déplacement moyenne du robot durant l'enjambée suivante (Vi+1 ) ; s AI représente une seconde fonction de la longueur de l'enjambée courante (Li), de la longueur de l'enjambée précédent l'enjambée courante (Li-1), d'une force motrice exercée par une jambe durant l'enjambée courante (Fi), une vitesse de déplacement moyenne du robot durant l'enjambée courante (Vi) et une vitesse de déplacement Io moyenne du robot durant l'enjambée suivante (Vi+1 ) R représente une distance séparant une zone d'appui au sol et un centre de gravité (G) du robot (10). 15