Date post: | 04-Apr-2015 |
Category: |
Documents |
Upload: | marc-buisson |
View: | 104 times |
Download: | 0 times |
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