Simulateur de bras : cinématique et planification ROS

Commandes

Le simulateur fournit des curseurs articulaires, une cible d’outil à tirer, des superpositions de repères et des réglages de dimensions des segments, avec la base centrée pour que tout l’espace de travail accessible à 360° soit visible. Le mode direct calcule la pose de l’outil à partir des angles articulaires que vous réglez. Le mode inverse suit une cible que vous tirez — en résolvant les angles articulaires en direct et en signalant les cibles inaccessibles ou ambiguës plutôt que de s’y accrocher silencieusement. Un troisième mode pick-and-place permet de placer un point de prise et une destination, puis fait exécuter au bras toute la tâche : il va à l’objet, le saisit, le transporte et le relâche dans la zone de dépôt — le travail canonique pour lequel tout manipulateur réel est construit.

Théorie

Chaque articulation apporte une transformation entre repères de coordonnées. Multiplier ces transformations de la base à l’outil donne la pose cinématique directe. La cinématique inverse travaille à rebours et peut n’avoir aucune solution, une solution, ou plusieurs solutions.

Près d’une singularité, un petit mouvement d’outil peut exiger un très grand mouvement articulaire. Un planificateur doit aussi respecter les limites de position, vitesse, accélération, couple et collision. La seule portée géométrique ne rend pas une trajectoire sûre.

Algorithme

1. Définissez les longueurs de segments, les axes articulaires, les transformations d’origine et les limites articulaires.
2. Calculez la cinématique directe pour l’état articulaire actuel.
3. Comparez la pose actuelle de l’outil à la cible demandée.
4. Utilisez un solveur analytique ou numérique pour réduire l’erreur de pose dans les limites.
5. Rejetez les candidats en collision ou singuliers et sélectionnez une solution continue.
6. Paramétrez le chemin en temps et envoyez des consignes synchronisées aux contrôleurs articulaires.

Code source

Un bras plan à deux segments a un modèle direct compact :

from math import cos, sin

def forward_kinematics(theta_1, theta_2, link_1, link_2):
    elbow = (link_1 * cos(theta_1), link_1 * sin(theta_1))
    tool = (
        elbow[0] + link_2 * cos(theta_1 + theta_2),
        elbow[1] + link_2 * sin(theta_1 + theta_2),
    )
    return elbow, tool

Pour les bras physiques, validez chaque trajectoire planifiée dans un environnement borné et conscient des collisions avant d’alimenter les actionneurs.

Hypothèses et différences avec le matériel

Le bras est plan avec deux ou trois articulations rotoïdes, des segments parfaitement rigides, une réponse en vitesse instantanée et ni gravité, ni dynamique, ni collision — vous pouvez passer de coude haut à coude bas sans limite de couple. Les vrais servomoteurs ont des limites de position et de vitesse, du jeu de réducteur, un couple limité en courant et un affaissement dépendant de la charge, et un bras à 6 axes doit aussi gérer l’orientation, les singularités et le travail près des limites articulaires. Ce labo est l’endroit où vous apprenez pourquoi une cible dans l’anneau peut avoir deux solutions et pourquoi une cible sur son bord est singulière, avant d’ajouter la dynamique qui rend ces poses difficiles à tenir.

Schéma de câblage

Séparez l’alimentation des actionneurs à fort courant de l’alimentation de calcul tout en maintenant les signaux de référence et de sécurité exigés par le matériel choisi.

Expériences guidées

Tirer une cible partout est le moyen le plus rapide de construire l’intuition de choses fastidieuses à prouver sur papier et coûteuses à découvrir sur le matériel.

1. Trouvez la forme de l’espace de travail

Tirez la cible lentement vers l’extérieur jusqu’à ce que le solveur signale inaccessible, puis suivez cette frontière tout autour. Tirez ensuite vers l’intérieur, vers la base.

Avec des longueurs de segments inégales, vous trouverez deux frontières : un cercle extérieur à L1 + L2 et un cercle intérieur à |L1 − L2|. L’espace de travail est un anneau, pas un disque, et il y a un trou au milieu que le bras ne peut physiquement pas atteindre.

Cette dernière ligne est un fait de conception réellement utile : des longueurs de segments égales suppriment entièrement la zone morte. Si votre bras doit travailler près de sa propre base, c’est la raison de les choisir.

2. Regardez les deux solutions fusionner

Basculez entre les branches coude haut et coude bas sur une cible près du milieu de l’espace de travail : deux poses de bras clairement différentes atteignant le même point.

Tirez maintenant cette cible vers l’extérieur, vers la frontière. Les deux poses convergent, et à pleine extension elles deviennent la même pose. C’est une singularité, et c’est là que le bras perd la capacité de déplacer l’outil dans une direction quoi que fassent les articulations.

3. Sentez ce que coûte une singularité

Tirez la cible le long d’une droite qui passe près de la pleine extension, lentement et régulièrement. Regardez les angles articulaires plutôt que le bras.

L’outil se déplace à vitesse constante ; les articulations non. Près de la frontière, un petit mouvement d’outil exige un énorme mouvement articulaire, donc une trajectoire cartésienne lisse devient un mouvement articulaire violent. Sur le matériel, c’est un servo qui claque à sa limite.

Gardez les parcours planifiés dans environ 95 % de la portée maximale, et cela cesse d’être un problème.

4. Franchissez une frontière de branche et regardez le basculement

Réglez le solveur pour toujours choisir coude haut, puis tirez la cible dans une zone où cette branche heurte une limite articulaire et où le solveur bascule. Le bras pivote par un mouvement ample, rapide et complètement non planifié.

C’est pourquoi la bonne valeur par défaut est le mouvement minimal — choisir la branche la plus proche de la pose actuelle — plutôt qu’une branche fixe. Un basculement de branche silencieux en milieu de parcours sur du matériel réel est alarmant et peut être destructeur.

Ce que vous devriez observer

Transposition au matériel

La géométrie se transfère exactement. Rien d’autre, et l’écart est là où un premier montage de bras passe son temps :

Deux nombres font la démonstration. Quatre degrés de jeu à l’épaule sur une portée de 190 mm font plus de 13 mm à la pince — plus grand que toute erreur introduite par les maths. Et une longueur de segment mesurée 10 mm trop longue sur un segment de 95 mm est une erreur systématique de 10 % qu’aucun réglage ne supprimera.

La conséquence pratique est que la précision du matériel vient de l’étalonnage et d’un sens d’approche cohérent, pas d’une meilleure cinématique. Approchez toujours une cible depuis le même sens et le jeu devient un écart répétitif que vous pouvez soustraire. Le solveur complet, avec chaque cas d’échec traité, est dans cinématique inverse pour un bras à deux segments.