Top Banner
Robot humanoïde HYDROïD : Actionnement, Structure Cinématique et Stratégie de contrôle Samer ALFAYAD 9-11-2010 [email protected]
44

Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

Sep 14, 2018

Download

Documents

phamcong
Welcome message from author
This document is posted to help you gain knowledge. Please leave a comment to let me know what you think about it! Share it to your friends and learn new things together.
Transcript
Page 1: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

Robot humanoïde HYDROïD :Actionnement, Structure

Cinématique et Stratégie de contrôle

Samer ALFAYAD

9-11-2010

[email protected]

Page 2: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

1

Plan de l’exposé

• Parcours Professionnel

• Contributions

• Structures cinématiques

• Actionnement

• Stratégie de commande

• Conclusions

• Contexte & Objectifs du travail

S. Alfayad, 2010, GDR Robotique

Page 3: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

1

Curriculum Vitae : Résumé2011 Post-doctorant

TUM /Institute for Cognitive Systems

Superviseur: Pr. Gordon Cheng

Sujet : Force control for humanoid robot actuation

2010 Post-doctorant

UVSQ /LISV

Superviseur: Pr. F.B.Ouezdou

Sujet : Modélisation, conception de structures hybrides dédiées à la partie supérieure d’un Robot Humanoïde

2005-2009 Thèse

UVSQ /LISV

Directeur: Pr. F.B.Ouezdou

Sujet : Robot humanoïde HYDROïD : Actionnement, Structure Cinématique et Stratégie de contrôle

2005 Master de Recherche: Mécanique et Ingénierie des Systèmes, ENSAM/P6

2001-2004 Enseignant l’ISSAT (Syrie)

1999-2000 Diplôme d’Ingénieur ISSAT (Syrie)

Spécialité: Mecatronique - Major de la Promotion

S. Alfayad, 2010, GDR Robotique

Page 4: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

1

Bibliographie Thèse soutenue en nov. 2009

Sujet : Robot humanoïde HYDROïD : Actionnement, Structure Cinématique et Stratégie de contrôle

Mention : Très Honorable et Félicitations du JuryJury : F.B.Ouezdou, F.Pierrot (R), C.Gosselin(R), Buehler(R),C.Chevallereau(P), G.Cheng,O.Bruneau & F.Namoun.

Brevets Internationaux (5)

- WO2009118366, WO2009135694,WO2009144320, WO2009147243,EP2010056125

- Europe, USA, Canada, Chine, Japon

Brevets déposés (2) en cours de validation.

Articles dans des revues internationales (2) - Sensors and Actuators A : Physical, 2010, Part I & Part II

Articles sousmis dans des revues internationales (2)

- Journal of Mechanical Design, ASME

- Theory of Machines & Mechanisms

Articles en préparation (2)

Articles conférences (5) : ICRA, 3 IROS, 1 Humanoids

S. Alfayad, 2010, GDR Robotique

Page 5: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

2

Contexte du travail

Projet collaboratif: Robot Humanoïde

• LISV & BIA

• PHEMA: 2006-2009

Buts: • Compréhension de la Locomotion & Manipulation

• Santé-Handicap: banc de test pour les prothèses

Caractéristiques: un adolescent de 14 ans

• Taille: 1,6 m

• Masse: 50 kg

• Vitesse: 1,2 m /s

S. Alfayad, 2010, GDR Robotique

Page 6: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

3

Objectifs•Robot HUMANOÏDE: ressemble à l’homme

•Problématiques

• Morphologie anthropomorphique

• Allure des mouvements

• Sécurité dans l’interaction

• Consommation énergétique

• Structure cinématique?

• Commande haut niveau?

• Type d’actionnement?

Structure cinématique

Commande haut niveau

Actionnement

HYDROïD

S. Alfayad, 2010, GDR Robotique

Page 7: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

4

Structure Cinématique

Espace disponible ?

Hanavan

Parallélépipèdes rectangulaires Cônes tronqués

Distances entre les centres de liaisons

• Masse 50 Kg

• Taille 1,6m

S. Alfayad, 2010, GDR Robotique

Page 8: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

5

Type du pied?Pied plat Pied actif

Pied flexiblePied flexible actif

Choix:

• Pied à 1ddl actif orteil

• Matériau non métallique

Pied Économie

énergétiqueChoc

Pied/sol

Pied plat 0% --Pied

flexible 10% +

Pied actif 22% -

Pied actif flexible

25% ++

• Consommation énergétique

• Choc pied/sol

Structure Cinématique

S. Alfayad, 2010, GDR Robotique

Page 9: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

6

Caractéristiques des mouvements ?

Capture

Mouvement Marche Humaine

1,2 m/s

Évolution temporelle

•Angles

•Couples

•Force pied/solChaque liaison = 3 ddl

Genou 1ddl

Cheville 3ddl

Structure Cinématique

S. Alfayad, 2010, GDR Robotique

Page 10: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

7

Débattement & Vitesse

Couples nominaux

Structure Cinématique

S. Alfayad, 2010, GDR Robotique

Page 11: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

8

Analyse de la structure

1ddl

3ddl

3ddl

Cinématique du robot HYDROïD

Deux classes de mécanismes sphériques HYBRIDES

Mécanismes

simplesLiaisons à 1ddl rot : genou, coude, pied, torse

Liaisons sphériques:

Cheville, Poignet, Cou

• Débattements articulaires homogènes

• Espace disponible très réduit

• Loin du CDG

Hanche, Epaule, Bassin haut

• Débattements articulaires non homogènes

• Espace disponible relativement grand

• Proche de CDG

Structure Cinématique

S. Alfayad, 2010, GDR Robotique

Page 12: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

9

Débattements proches

Contraintes d’encombrement fortes

CdG proche du genou

Réduire le nombre de pièces

Motorisation Hydraulique

Electrique

Cheville de HYDROïD (brevet)

Sortie (//) :

Entrée:

Sortie:

S. Alfayad, 2010, GDR Robotique

Page 13: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

10

Modèles de la Cheville

Modèle cinématique :

•Théorème vissage réciproque

Analyse de singularité :

Pour j={1,3}

Pour j={2,4}

MGI:• Câble modélisé par un corps rigide et 2 rotules• Mécanisme Equivalent (chaîne ouverte)

S. Alfayad, 2010, GDR Robotique

Page 14: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

11

Hanche de HYDROïD (brevet)

• Débattements très différents

• Optimisation de l'encombrement

• Réduction du nombre de pièces

Sortie (//)

Entrée

Sortie:

S. Alfayad, 2010, GDR Robotique

Page 15: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

12

Modèles de la hancheMGI:

Modèle cinématique :

Analyse de singularité :

S. Alfayad, 2010, GDR Robotique

Page 16: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

• Pre-dimensionnement durant la phase de conception

Boucle de commande bas niveau :

Outils du Simulation

Actionneurs sagittaux

À rendre Non symétrique

Composants du commerce

13

Capture de Mvt. &

Dynamique inverse

Marche Humaine

1.2 m/s

S. Alfayad, 2010, GDR Robotique

Page 17: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

14

Conception & Réalisation Tests préliminaires

S. Alfayad, 2010, GDR Robotique

Page 18: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

14

Conception & Réalisation Tests préliminaires

S. Alfayad, 2010, GDR Robotique

Page 19: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

14

Conception & Réalisation Tests préliminaires

S. Alfayad, 2010, GDR Robotique

Page 20: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

17

Structure cinématique

Actionnement

HYDROïD - Actionnement

HYDROïD

Objectif:

Amélioration de la puissance massique

S. Alfayad, 2010, GDR Robotique

Page 21: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

HRP2ATR- SARCOS

• Groupe hydraulique central• Couple élevé (+)• Mouvement fluide (+)• Connexions et fuites (-)• Groupe central

•poids (-)•sur-dimensionnement (-)

Solutions existantes

• Moteur électrique & Réducteur• Faible coût & Facilité de contrôle local (+)• Connexions rigide (moteur & charge) (-)• Rapport de réduction fixe & limité (-) • Sur-dimensionnement des moteurs (-)

18S. Alfayad, 2010, GDR Robotique

Page 22: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

• Couple élevé à la sortie

• Optimisation du volume disponible

• Optimisation de la pression au besoin de la liaison

• Réduction des tuyaux de connections

• Echange de puissance entre liaisons voisines

• Fusionner les avantages des solutions existantes

Nouvelle Solution (brevet)

19

• Actionneur Hydraulique Intégré par liaison

S. Alfayad, 2010, GDR Robotique

Page 23: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

Principe de Fonctionnement

• Moteur Electrique

• Micro-pompe Volumétrique

• Débit variable (Q) # Excentricité (E)

• Chariot de la micro-pompe

• Micro-valve intégrée

• Electo-aimant (X), Capteur LVDT

• Capteurs de pression # Charge (Y)

• Sens de rotation du moteur unique !

• E petit, Q(-- ), P (++) ; E grand Q(++), P(--)

Actionneur Hydraulique Intégré

20

Rapport de réduction continûment variable !!!

S. Alfayad, 2010, GDR Robotique

Page 24: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

• Lignes de la micropompe A & B

• Distributeur rotatif passif

• Réservoirs intégrés

• Atmosphérique ( R )

• Fuites (PE)

• Préchargé ( Rp)

• 3 positions (S1, S2, S3)

• S1 : PA < PB, S2 : PA = PB, S3 : PA > PB

Schéma Hydraulique

21

Actionneur Hydraulique Intégré

Fonctionnement normal

S. Alfayad, 2010, GDR Robotique

Page 25: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

• Distributeur linéaire actif (D)• Cycle de charge # 2 modes

Stockage d’énergie

22S. Alfayad, 2010, GDR Robotique

Page 26: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

• Eq. Newton pour la charge M :

• Débit de la micro-pompe:

• Débit de la micro-valve:

• Eq. Newton pour le chariot:

Loi entrée/sortie

23S. Alfayad, 2010, GDR Robotique

Page 27: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

• Débit de la micro-valve:

• Equation non-linéaire• Jerk

Loi entrée/sortie

24

• Débit de la micro-pompe :

• Pour

S. Alfayad, 2010, GDR Robotique

Page 28: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

Simulation

25

•Temps de réponse de E=1.5 ms

•Y augmentation à vitesse constante

S. Alfayad, 2010, GDR Robotique

Page 29: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

Simulation

26

M=10kg

Xmax=1 mm

Emax=0.5 mm

Kp=0.01

Ki=0.3

Temps de réponse relativement grand

Xmax=1.5 mm

Temps de réponse = 0.1 s

S. Alfayad, 2010, GDR Robotique

Page 30: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

P bar

Q Cm^3/min

Rp mm

ω tr/mn

N pistons

E mm

Poids g

LxWxP mm^3

Conception-réalisation

27S. Alfayad, 2010, GDR Robotique

Page 31: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

29

Convertisseur hydraulique Résultats

S. Alfayad, 2010, GDR Robotique

Page 32: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

29

Convertisseur hydraulique Résultats

S. Alfayad, 2010, GDR Robotique

Page 33: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

• Débit vs PressionRésultats préliminaires

30

•Rapport de réduction continûment variable

•Optimisation

•Puissance=Cte

•V grand & F petit

•F grand & V petit

S. Alfayad, 2010, GDR Robotique

Page 34: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

31

Structure cinématique

Actionnement

HYDROïD

Commande haut niveau

Commande haut niveau

S. Alfayad, 2010, GDR Robotique

Page 35: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

32

• Planification de trajectoire: relation • Longueur de pas

• Vitesse et trajectoire de CdG

• Forces propulsives

Commande haut niveau

• Approche proposée: Energies Moyennes

• Besoins• Temps de calcul acceptable (temps réel)• Fonction implicite du temps• Prédire les n prochains pas• Gestion de l’énergie totale

• Difficulté : Modèle dynamique complet très complexe

• Plans sagittal & frontal avec et sans obstacleS. Alfayad, 2010, GDR Robotique

Page 36: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

33

• Hypothèses • Modèle masse concentrée

• jambes sans masse,

• Longueur constante en SS

• Impact mou

• Présence d'obstacles

Modèle utilisé

S. Alfayad, 2010, GDR Robotique

Page 37: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

34

Conservation énergie totale en SS

Energies Moyennes

Conservation de l'énergie moyenne

S. Alfayad, 2010, GDR Robotique

Page 38: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

35

Bilan énergétique entre deux SS

: Energie totale moyenne en SS 1

: Energie totale moyenne en SS 2

: Pertes énergétique dûes à l’impact

:Apport énergétique durant la phase DS

S. Alfayad, 2010, GDR Robotique

Page 39: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

36

Eq.1

Bilan énergétique

S. Alfayad, 2010, GDR Robotique

Page 40: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

37

Eq.1PropriétésGéométriques

Longueur de pas solution de :

Résolution

S. Alfayad, 2010, GDR Robotique

Page 41: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

38

Résultats préliminaires

Comparaison énergie moyenne calculée & énergie moyenne mesurée

Erreur relative

S. Alfayad, 2010, GDR Robotique

Page 42: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

39

Résultats préliminaires

Erreur relative

S. Alfayad, 2010, GDR Robotique

Page 43: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

40

Conclusions •Structure cinématique HYDROïD• Analyse des Mesures biomécaniques, ddl, Débattements, Vitesses, Couples • Un pied actif proposé, jambe à 8ddl actifs• Deux mécanismes sphériques hybrides modulaires (Hanche & Cheville)• Modèles & outils de simulation• Partie inférieure réalisée et testée

•Actionnement • Actionnement hydraulique intégré • Principe de fonctionnement • Rapport de réduction continûment variable• Loi entré/sortie (« jerk »)• Simulation : temps de réponse 100 ms• Prototype réalisé (orteil): 80x40x40 mm^3, 50 bars.• Performances prometteuses: déplacement 38kg à 2cm/s

•Stratégie de contrôle énergétique • Relation prédictive simple (Sagittal & Frontal) avec & sans obstacle• Dépendance implicite de temps • Prédiction des longueurs des pas suivants• Validation (en simulation) plan sagittal, erreur max 10%

S. Alfayad, 2010, GDR Robotique

Page 44: Robot humanoïde HYDROïD : Actionnement, Structure ... · Entrée: Sortie: S. Alfayad, 2010, GDR Robotique. 10 Modèles de la Cheville Modèle cinématique: •Théorème vissage

42

A bientôt

Merci à : F.B. Ouezdou, LISV & BIA S. Alfayad, 2010, GDR Robotique