Contributions à la Commande de Robots sous Contraintes

Preview:

DESCRIPTION

Contributions à la Commande de Robots sous Contraintes. Contributions to the control of constrained robots. Philippe Bidaud Michel de Broissia Vincent Padois. Sous la direction de :. Sébastien Rubrecht. Projet T elemach. Un Problème de Conception : morphologie du bras. Optimisation. - PowerPoint PPT Presentation

Citation preview

Contributions à la Commande de Robots sous Contraintes

Contributions to the control of constrained robots

Sébastien Rubrecht Sous la direction de : Philippe BidaudMichel de BroissiaVincent Padois

Contexte Formulation Resolution Conclusion

Projet TELEMACH

Maintenance Téléopérée

ConceptionCommande

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 2/38

Contexte Formulation Resolution Conclusion

Un Problème de Conception : morphologie du bras

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 3/38

Optimisation

Banque de segments

Evaluation : suivi de trajectoire en tête de coupe

Morphologies de manipulateurs

105

Rubrecht, S., Padois, V., and Bidaud, P. (2009). New Horizons in Evolutionary Robotics, Evolutionary Design of a Robotic Manipulator for a Highly Constrained Environment, pages 59–64. Springer.

[Sallé2004]

Contexte Formulation Resolution Conclusion

Un Problème de Commande

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 4/38

Spécifications

Commande multiobjectifs

Commande temps réel Commande sûre Commande performante

Contexte Formulation Resolution Conclusion

Un Problème de Commande sûre

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 5/38

Spécifications

Commande sûre en environnement contraint et hostile

Contexte Formulation Resolution Conclusion

Un Problème de Commande performante

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 6/38

Spécifications

Commande performante en environnement réduit et encombré

[Maciejewski 1985] [Sentis 2005]

Contexte Formulation Resolution Conclusion

Commande

Cinématique inverse

Synthèse

23 Septembre 2011Contributions à la Commande de Robots sous Contraintes

7/38

Formulation du problème de commande

Commande sûre

Commande performante

Contexte Formulation Resolution Conclusion

Formulation du Problème de Commande

Commande

Cinématique inverse

Formulation du problème de commande

Contexte Formulation Resolution Conclusion

Contraintes considérées

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 9/38

Etat étendu

Variable

Position articulaire

Distance opérationnelle

Vitesse articulaire

Accélération articulaire

Contexte Formulation Resolution Conclusion

Sécurité au niveau de la commande

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 10/38

Le système est en sécurité instantanée lorsque ses contraintessont respectées

Le système est en sécurité absolue lorsque ses contraintes ne pourront jamais être violées.

Contexte Formulation Resolution Conclusion

Sécurité au niveau de la commande

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 11/38

[Wieber2008]

[Fraichard2007]

[Broquère2011]

Contexte Formulation Resolution Conclusion

Reformulation

Cas 1: position, vitesse et accélération

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 12/38

Conclusion

Modification expression des contraintes Système en sécurité absolue

Contexte Formulation Resolution Conclusion

Cas 1: position, vitesse et accélération

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 13/38

Rubrecht, S., Padois, V., Bidaud, P., de Broissia, M., and Da Silva Simoes, M. (2011). Motion safety and constraints compatibility for multibody robots. Revision submitted – Autonomous Robots.

Contexte Formulation Resolution Conclusion

Cas 1: position, vitesse et accélération

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 14/38

Contexte Formulation Resolution Conclusion

?

?

?

Cas 2 : position, obstacle, vitesse, accélération

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 15/38

?

Conclusion

Incompatibilités toujours possibles Sécurité non assurée.

Contexte Formulation Resolution Conclusion

Formulation des contraintes

Formulation du problème de commande

Expression

Compatibilité ?

Commande

Cinématique inverse

Algorithme pour la sécurité

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 16/38

Comportement alternatif sûr

Commande

Cinématique inverse

Sécurité

Contexte Formulation Resolution Conclusion

Décélération maximale : Alternative Safe Behavior ASB1

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 17/38

Robot statique + Sécurité instantanée Sécurité absolue

Contexte Formulation Resolution Conclusion

Décélération maximale: ASB1

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 18/38

Rubrecht, S., Padois, V., Bidaud, P., de Broissia, M., and Da Silva Simoes, M. (2011). Motion safety and constraints compatibility for multibody robots. Revision submitted – Autonomous Robots.

Contexte Formulation Resolution Conclusion

Décélération maximale ASB1

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 19/38

Contexte Formulation Resolution Conclusion

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 20/38

Décélérations mixtes : Alternative Safe Behavior ASB2

Contexte Formulation Resolution Conclusion

Décélérations mixtes ASB2

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 21/38

Rubrecht, S., Padois, V., Bidaud, P., de Broissia, M., and Da Silva Simoes, M. (2011). Motion safety and constraints compatibility for multibody robots. Revision submitted – Autonomous Robots.

[Faverjon1987]

Contexte Formulation Resolution Conclusion

Décélérations mixtes ASB2

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 22/38

Contexte Formulation Resolution Conclusion

Résolution du problème de commande

Formulation du problème de commande

Commande

Sécurité

Cinématique inverse

Contexte Formulation Resolution Conclusion

Critères d’évaluation

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 24/38

Spécifications

Commande sûre

Commande performante en environnement encombré

•Respect des contraintes

•Optimalité locale

•Bon comportement global

Contexte Formulation Resolution Conclusion

Problème de commande à résoudre

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 25/38

Trouver tel que

Sous des contraintes strictes

Cadre multiobjectif hiérarchique

Contexte Formulation Resolution Conclusion

Absence de contraintes : tâches de suivi, tâche d’évitement (actif)

Contraintes en 1erObjectif en 1er

Multiobjectif, inversion directe

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 26/38

[Maciejewski 1985]

[Sentis 2005]

Contexte Formulation Resolution Conclusion

Clamping

Clamping

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 27/38

[Baerlocher 2004]

Calcul du modèle courant

Calcul mvmt

Modification Jacobienne

Respect contraintes?

Clamping

Contexte Formulation Resolution Conclusion

+

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 28/38

Vers une Commande Compliante aux Contraintes CCC

Méthode CCC

• Résolution itérative• Formalisme d’inversion directe (projecteurs)• Eloignement contraintes par évitement actif

o Priorité basse dans la hiérarchie des tâcheso Potentiels d’évitement saturés

Inversion directe Résolution Itérative

Contraintes non respectées

Formalisme universel

Evitement actif

Oscillations

Potentiel d’évitement inverse : non optimal et termes infinis.

+Commande sûre

Restreint aux butées

Pas de mouvements d’évitement

Pas d’oscillations, bon suivi

Pas de vitesses infinies

+

++

Contexte Formulation Resolution Conclusion

CCC : Synthèse

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 29/38

Priorité 1

Priorité 2

Priorité 3

Evitement passif

Evitement actif

Contexte Formulation Resolution Conclusion

Calcul du modèle courant

Calcul du mouvement

Choix Combinaison de

Contraintes

Respect contraintes?

Scaling

Err < eps?

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 30/38

CCC: Algorithme

Contexte Formulation Resolution Conclusion

CCC : simulation

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 31/38

Rubrecht, S., Padois, V., Bidaud, P., and de Broissia, M. (2010a). Advances in Robot Kinematics, Constraint compliant control for a redundant manipulator in a cluttered environment, pp. 367–376. Springer

Contexte Formulation Resolution Conclusion

Résultats: CCC

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 32/38

Distance aux obstacles (m) Position opérationnelle (m)

Contexte Formulation Resolution Conclusion

Prise en compte des contraintes d’accélération

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 33/38

Contexte Formulation Resolution Conclusion

Utilisation d’une configuration déplacée

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 34/38

Rubrecht, S., Padois, V., Bidaud, P., and de Broissia, M. (2010b). Constraints compliant control: constraints compatibility and the displaced configuration approach. In Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems, pages 677–684.

Contexte Formulation Resolution Conclusion

Conclusions and Perspectives

Contexte Formulation Resolution Conclusion

Conclusions

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 36/38

Bilan

• Formalisme de sécurité commande

• Méthodes de maintien de la sécurité

• Etudes de cas et vérifications expérimentales

• Principe d’évitement passif

• Commande multiobjectif à hiérarchie stricte respectant les contraintes

• Commande à itération unique sûre et performante

CCC

Contexte Formulation Resolution Conclusion

Perspectives

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 37/38

Travaux à venir

• Mise au point d’une politique actif/passif

• Détermination de points déplacés dédiés suivant la mission

• Extension au cadre dynamique

• Extension à d’autres contraintes: obstacles mobiles, limites de couple

Contexte Formulation Resolution Conclusion

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes 38/38

Merci!

Contexte Formulation Resolution Conclusion

Compléments

Contexte Formulation Resolution Conclusion

Application : Conception par Algorithme Génétique

Contexte Formulation Resolution Conclusion

Un Problème de Conception

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes

Population Parent

Critère d’arrêt Sélection

Opération GénétiqueEvaluation

Remplacement

Population enfant

Population génitriceGénération

Définition d’une banque de segments pour créer une population de robots aléatoires

Suivi de trajectoires en tête de coupe

Spécifications

Bonne évaluation

Contexte Formulation Resolution Conclusion

Choix d’un génotype

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes

Contexte Formulation Resolution Conclusion

Indicateurs et Commande

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes

Indicateurs

• Erreur de suivi

• Nombre de DDL

• Longueur du robot

• Collision / segment / pas de tps

Evaluation

• Présim : 40 pts

• 360 pts 3D

• 9 m

• Cinématique

Paramètres Génétiques

• Cross over : 13 %

• Mutation : 10 %

• Générations : 500

• Individus : 150

CCC

• Contraintes : Vitesse, obstacle.

• Impact: nature des indicateurs

• Impact: relations entre

indicacteurs

Contexte Formulation Resolution Conclusion

Résultats

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes

Contexte Formulation Resolution Conclusion

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes

Contexte Formulation Resolution Conclusion

Résultats

23 Septembre 2011 Contributions à la Commande de Robots sous Contraintes

Recommended