Understanding Robot Kinematics and Dynamics for Better Control
Table of Contents
Présentation
La robotique a transformé les industries de la fabrication en soins de santé, permettant aux machines d'exécuter des tâches avec rapidité et précision. cinématique et dynamique—les deux piliers de l'analyse et du contrôle du mouvement des robots. Comment un robot se déplace (position, vitesse, accélération) sans tenir compte des forces en jeu, alors que la dynamique explique Pourquoi La maîtrise des deux champs est essentielle pour concevoir des contrôleurs qui offrent des performances précises, stables et sûres. Cet article développe ces concepts fondamentaux, explore leurs fondements mathématiques et examine comment ils sont intégrés pour réaliser un contrôle robot sophistiqué dans les applications réelles.
Qu'est-ce que Robot Kinematics?
La cinématique du robot est l'étude du mouvement sans égard aux forces qui le provoquent. Elle se concentre sur les relations géométriques entre les articulations et les liens d'un mécanisme robotique. En établissant ces relations, les ingénieurs peuvent déterminer la position et l'orientation de l'effet final du robot (comme un préhenseur ou un outil) en fonction des angles d'articulation, ou inversement, calculer les angles d'articulation nécessaires pour placer l'effet final à l'endroit désiré.
La cinématique est fondamentale pour la planification du mouvement, la génération de trajectoires et l'évitement des collisions. Elle fournit les bases pour contrôler le chemin du robot de manière précise et prévisible.
Kinématique vers l'avant
La cinématique avant (FK) prend les paramètres articulaires connus (angles pour les articulations révoltées, déplacements pour les articulations prismatiques) et calcule la pose (position et orientation) de l'effet final dans un cadre de coordonnées global. Paramètres de Denavit-Hartenberg (DH), qui attribuent systématiquement des cadres de coordonnées à chaque lien et définissent la matrice de transformation homogène de la base à l'effecteur final. Le résultat est une cartographie directe : les variables articulaires \( \theta 1, \theta 2, \dots, \theta n \), la position de l'effecteur final \( (x,y,z) \) et l'orientation (roule, pas, lacet ou matrice de rotation) sont déterminées de façon unique.
Exemple : Un bras plan à deux liens avec des longueurs de liens \( L 1 \) et \( L 2 \) a une cinématique vers l'avant donnée par :
- \( x = L 1\cos\theta 1 + L 2\cos(\theta 1+\theta 2) \)
- \( y = L 1\sin\theta 1 + L 2\sin(\theta 1+\theta 2) \)
Ces équations explicites permettent un calcul rapide et sont essentielles au contrôle en temps réel. Pour des robots plus complexes (p. ex., bras industriels de 6 degrés de liberté), les transformations sont calculées par multiplication matricielle. La cinématique de l'avant est bien posée : elle a toujours une solution unique pour un ensemble donné de valeurs de joint.
Inverse Kinématique
La cinématique inverse (IK) résout le problème inverse : étant donné la pose souhaitée de l'effet final, trouvez les paramètres articulaires qui la réalisent. C'est beaucoup plus difficile parce que la cartographie de l'espace cartésien à l'espace articulaire est souvent non linéaire et peut avoir plusieurs solutions, aucune solution ou solutions infinies. Par exemple, un bras planaire à deux liaisons peut atteindre un point donné avec deux configurations de bras différentes (en haut de l'eau vs. en bas du coude) si le point se trouve dans l'espace de travail.
La plupart des robots industriels se basent sur des IK analytiques parce qu'ils sont rapides et déterministes pour leur structure spécifique. Pour les robots mobiles ou les systèmes flexibles, les IK numériques fournissent la capacité d'adaptation nécessaire. Une compréhension approfondie des IK est essentielle pour des tâches telles que le choix et le lieu, l'assemblage et les aides chirurgicales, où le robot doit positionner précisément son effet final dans l'espace.
Pour plus de détails sur la cinématique, voir le Wikipedia article sur robot cinématique et l'introduction détaillée cinématique avant- Oui.
Les mathématiques de la cinématique
La modélisation cinématique repose fortement sur l'algèbre linéaire et la géométrie. La matrice de transformation homogène \( T \) est l'outil central : elle combine rotation et traduction en une seule matrice 4×4. Pour un robot avec des liens \( n \), la transformation globale de la base à l'effet final est le produit :
\[ T {0}^{n} = T {0}^{1} \cdot T {1}^{2} \cdots T {n-1}^{n} \] où chaque \( T {i-1}^{i} \) dépend des paramètres DH du lien \( i \). Cette multiplication continue rend FK simple. Pour IK, la matrice jacobin \( J \) est essentielle. Elle relie les vitesses de joint aux vitesses de l'effet final: \( v = J \dot{\theta} \). Le jacobin est également utilisé en statique (forces de liaison/torques) et en régulation de taux.Qu'est-ce que Robot Dynamics?
Bien que la cinématique fournisse la géométrie du mouvement, la dynamique étend l'image en incluant les forces et les couples qui produisent ou résistent à ce mouvement. L'analyse dynamique est essentielle pour concevoir des moteurs, sélectionner les rapports de vitesse et développer des contrôleurs qui peuvent supporter des charges, des accélérations et des perturbations externes variables.
Newton , lois et leur application
La dynamique du robot est ancrée dans la seconde loi de Newton : \( F = ma \) (pour le mouvement linéaire) et \( \tau = I\alpha \) (pour le mouvement rotationnel). Dans un robot, chaque lien éprouve des forces gravitationnelles, des forces d'inertie de sa propre accélération, des forces de Coriolis dues au mouvement d'autres liens et des forces de friction aux articulations. Le couple total requis à chaque joint est la somme de ces effets.
\[ M(\theta)\ddot{\theta} + C(\theta,\dot{\theta})\dot{\theta} + G(\theta) + F(\theta,\dot{\theta}) = \tau \] où:- \( M(\theta) \) est la matrice d'inertie (masse et moment d'inertie)
- \( C(\theta,\dot{\theta}) \) représente les termes Coriolis et centrifuges
- \( G(\theta) \) est le vecteur de gravité
- \( F \) modèles de friction (Coulomb, visqueux)
- \( \tau \) est le vecteur des couples d'articulations
Ces équations sont dérivées soit par la méthode Newton‐Euler (prolongation de la force récursive/du couple le long de la chaîne cinématique) soit par la formulation Lagrangien (approche basée sur l'énergie).Les deux méthodes produisent le même résultat, mais ont des compromis computationnels différents.
Masse, inertie et torque
La matrice d'inertie \(M(\theta) \) change avec la configuration du robot, ce qui rend la configuration dynamique dépendante. Pour une charge lourde portée à l'effet final, l'inertie effective des articulations de base augmente de façon spectaculaire. De même, les termes Coriolis deviennent significatifs à des vitesses plus élevées (p. ex., dans les opérations de pick-and-place). Les ingénieurs doivent tenir compte de ces variations pour les contrôleurs de conception qui restent stables dans tout l'espace de travail.
Une exposition détaillée de la modélisation dynamique robot peut être trouvée dans le Wikipedia article sur la dynamique des robots et dans les manuels scolaires tels que Introduction à la robotique par John J. Craig.
Intégrer la cinématique et la dynamique pour un meilleur contrôle
La cinématique ne peut à elle seule garantir un mouvement lisse et précis dans des conditions réelles; il faut intégrer la dynamique pour compenser les forces. L'intégration des deux modèles donne lieu à des stratégies de contrôle avancées qui permettent aux robots de gérer des charges utiles variables, de rejeter les perturbations et d'atteindre une précision élevée.
Stratégies de contrôle
Plusieurs techniques de contrôle reposent sur des modèles cinématiques et dynamiques combinés:
- Contrôle PID avec compensation de gravité : Une approche classique où une boucle de rétroaction proportionnelle-intégrale-dérivée (PID) est augmentée par un terme de flux qui annule le couple gravitationnel prédit par le modèle dynamique. Ceci est simple à mettre en œuvre et fonctionne bien pour les tâches à basse vitesse.
- Contrôle du couple calculé (dynamique inverse): Une méthode basée sur le modèle qui utilise les équations dynamiques complètes pour calculer les couples d'articulation requis pour suivre une trajectoire souhaitée. Il linéarise le système, permettant l'utilisation de la théorie de contrôle linéaire. Le contrôle du couple calculé fournit une excellente précision de suivi, mais nécessite un modèle dynamique précis et est sensible à l'incertitude des paramètres.
- Modèle de contrôle prédictif (CMP) : Une technique basée sur l'optimisation qui utilise le modèle dynamique pour prédire les états futurs et calculer les couples optimaux sur un horizon fini. MPC peut gérer les contraintes (p. ex. limites de joint, limites de couple) et est de plus en plus populaire dans la manipulation mobile et la robotique humanoïde.
Dans toutes ces stratégies, la cinématique avancée fournit la pose finale souhaitée, la cinématique inverse fournit la référence de l'espace joint, et le modèle dynamique génère les couples de l'avance/compensation. La rétroaction (p. ex., des encodeurs ou des capteurs de couple) corrige les effets et les perturbations non modélisés.
Applications en robotique
L'intégration de la cinématique et de la dynamique est essentielle dans différents domaines :
- Automatisation industrielle: Le soudage, la peinture et l'assemblage de précision exigent une coordination étroite entre la planification des mouvements (kinématique) et le contrôle de la force/torque (dynamique) pour assurer une qualité cohérente, même avec les tolérances de pièce.
- Robotique médicale : Les robots chirurgicaux comme le système da Vinci utilisent des modèles cinématiques pour cartographier les mouvements des mains des chirurgiens pour les mouvements des instruments, tandis que les modèles dynamiques permettent une rétroaction haptique et une échelle de force pour prévenir les lésions tissulaires.
- Véhicules autonomes: Les voitures autoconduites et les drones s'appuient sur des modèles cinématiques (p. ex. modèle de bicyclette, entraînement différentiel) pour la planification des trajectoires et des modèles dynamiques pour le contrôle de la stabilité dans des vitesses et des conditions routières variables.
- Robots humanoïdes : Les modèles cinématiques définissent la portée et la posture des jambes, tandis que les modèles dynamiques calculent les forces de réaction au sol et les couples articulaires pour maintenir l'équilibre.
Pour une plongée plus profonde dans les stratégies de contrôle, voir calcul du couple et l ' aperçu général des contrôle prédictif du modèle- Oui.
Conclusion et orientations futures
La compréhension de la cinématique et de la dynamique des robots n'est pas un exercice théorique, c'est le fondement de tout système robotique avancé. De la précision géométrique des modèles de dynamique avant et inverse aux modèles de dynamique force-aigus, ces disciplines permettent aux ingénieurs de concevoir des contrôleurs à la fois précis et robustes. À mesure que les robots se déplacent dans des environnements non structurés et partagés par l'homme, la demande de contrôle basé sur les modèles augmente.