Cinématique du Corps Rigide en 3D et Synthèse

TL;DR

La cinématique 3D des corps rigides décrit le mouvement sans se soucier des forces qui le causent, en se concentrant sur la position, la vitesse et l'accélération dans l'espace. Elle implique la combinaison de mouvements de translation et de rotation, souvent analysés à l'aide de matrices de transformation et de quaternions. Comprendre comment les différents repères se déplacent et s'orientent est fondamental pour analyser des systèmes complexes comme les robots ou les véhicules.

1. The Mental Model

Imaginez un objet solide, comme un bloc de bois ou un avion, qui bouge dans l'espace. Ce bloc peut glisser (translation) et tourner sur lui-même (rotation) en même temps. La cinématique 3D nous donne les outils pour décrire exactement où il est, à quelle vitesse il bouge, et comment il s'oriente sans avoir à penser à la poussée du moteur ou aux forces de frottement.

2. The Core Material

En cinématique 3D, le mouvement d'un corps rigide est une combinaison de deux types de mouvements :

1. Translation : Chaque point du corps rigide se déplace de la même manière et dans la même direction. C'est comme si le corps glissait sans changer son orientation. La translation est décrite par la position du centre de masse ou d'un point de référence du corps.
2. Rotation : Le corps rigide tourne autour d'un axe. Tous les points du corps décrivent des cercles concentriques autour de cet axe, mais l'orientation du corps change. La rotation est plus complexe à décrire en 3D.

Repères et Transformations

Photo by Жанна Алимкулова on Pexels

Pour décrire le mouvement en 3D, nous utilisons des repères. Un repère est un système de coordonnées (avec une origine et trois axes orthogonaux, par exemple x, y, z).
* Repère fixe (ou absolu) : C'est le repère de référence, celui par rapport auquel on observe le mouvement (souvent appelé $R_0$).
* Repère lié au corps (ou mobile) : C'est un repère qui est "collé" au corps rigide et qui bouge avec lui (souvent appelé $R_b$).

Pour passer des coordonnées d'un point du repère mobile à celles du repère fixe, on utilise des transformations homogènes. Une transformation homogène $T$ combine une rotation $R$ et une translation $p$ en une seule matrice 4x4 :

$$ T = \begin{pmatrix} R & p \\ 0_{1 \times 3} & 1 \end{pmatrix} $$

• Matrice de Rotation (R) : C'est une matrice 3x3 qui décrit l'orientation du repère mobile par rapport au repère fixe. Chaque colonne de $R$ est un vecteur unitaire du repère mobile exprimé dans le repère fixe.
• Vecteur de Translation (p) : C'est un vecteur 3x1 qui donne la position de l'origine du repère mobile par rapport à l'origine du repère fixe.

Outils pour la Rotation

Photo by alex on Pexels

Décrire la rotation est crucial. Voici les outils principaux :

1. Angles d'Euler : Trois angles successifs pour décrire n'importe quelle orientation. Il existe différentes conventions (par exemple, ZYX, XYZ). Simples à visualiser mais peuvent souffrir de "blocage de cardan" (gimbal lock).
2. Quaternions : Des nombres hypercomplexes (4 composantes) qui décrivent l'orientation de manière plus robuste que les angles d'Euler, évitant le gimbal lock et facilitant les interpolations. Ils sont très utilisés en robotique et en infographie.
3. Matrice de Rotation : Comme mentionné, c'est une matrice 3x3. Avantage : facile à composer (multiplier des matrices). Inconvénient : coûteux en calcul et peut accumuler des erreurs numériques (les colonnes doivent rester orthogonales et unitaires).

Vitesse et Accélération

Photo by Maartje Eyskens on Pexels

Pour la cinématique, nous ne nous arrêtons pas à la position. Nous voulons aussi savoir comment la position change dans le temps :

• Vitesse Linéaire ($\mathbf{v}$) : La dérivée du vecteur position par rapport au temps.
• Vitesse Angulaire ($\boldsymbol{\omega}$) : Vecteur décrivant la vitesse de rotation instantanée du corps rigide. Sa direction donne l'axe instantané de rotation et sa magnitude la vitesse de rotation.
• Accélération Linéaire ($\mathbf{a}$) : La dérivée de la vitesse linéaire par rapport au temps.
• Accélération Angulaire ($\boldsymbol{\alpha}$) : La dérivée de la vitesse angulaire par rapport au temps.

La relation entre la vitesse d'un point $P$ sur un corps rigide et la vitesse du corps lui-même est donnée par :
$\mathbf{v}_P = \mathbf{v}_O + \boldsymbol{\omega} \times \mathbf{r}_{OP}$
où $\mathbf{v}_O$ est la vitesse d'un point de référence $O$ sur le corps, $\boldsymbol{\omega}$ est la vitesse angulaire du corps, et $\mathbf{r}_{OP}$ est le vecteur de $O$ à $P$.

graph TD
    A["Description du Mouvement 3D"] --> B["Corps Rigide"]
    B --> C["Mouvement de Translation"]
    B --> D["Mouvement de Rotation"]
    C --> E["Vecteur Position (p)"]
    D --> F["Matrice de Rotation (R)"]
    D --> G["Quaternions (q)"]
    D --> H["Angles d'Euler (alpha, beta, gamma)"]
    E & F --> I["Transformation Homogène (T)"]
    I --> J["Position du Repère Mobile"]
    J --> K["Vitesse Linéaire (v)"]
    J --> L["Vitesse Angulaire (omega)"]
    K & L --> M["Cinématique Inverse/Directe"]
    M --> N["Applications (Robotique, VR, etc.)"]

Synthèse : Cinématique Directe et Inverse

Photo by TStudio on Pexels

• Cinématique Directe : Étant donné les paramètres des articulations d'un système (par exemple, les angles des moteurs d'un bras robotique), calculer la position et l'orientation de l'effecteur (l'extrémité du bras) dans le repère fixe. C'est un calcul "vers l'avant".
• Cinématique Inverse : Étant donnée la position et l'orientation souhaitées de l'effecteur, calculer les paramètres des articulations nécessaires pour atteindre cette configuration. C'est un problème plus complexe et souvent non linéaire, avec parfois plusieurs solutions ou aucune.

3. Worked Example

Supposons que nous avons un bras robotique simple à 2 degrés de liberté (2 DOF) dans un plan (simplification 2D pour l'exemple, mais les principes s'étendent à la 3D). Le premier bras (L1) est attaché à la base (repère $R_0$) et tourne d'un angle $\theta_1$. Le deuxième bras (L2) est attaché à l'extrémité du premier et tourne d'un angle $\theta_2$ par rapport au premier bras. Nous voulons trouver la position de l'effecteur (P) à l'extrémité de L2.

Prenons L1 = 1m et L2 = 0.5m.
Si $\theta_1 = 30^\circ$ et $\theta_2 = 60^\circ$.

1. Calculer la position de l'extrémité du bras 1 ($P_1$) :
   Dans $R_0$, les coordonnées de $P_1$ sont :
   $x_1 = L_1 \cos(\theta_1)$
   $y_1 = L_1 \sin(\theta_1)$
   $x_1 = 1 \cdot \cos(30^\circ) = 0.866$ m
   $y_1 = 1 \cdot \sin(30^\circ) = 0.5$ m

2. Calculer la position de l'effecteur ($P$) par rapport à $P_1$ :
   L'angle total du second bras par rapport à l'axe X du repère $R_0$ est $\theta_{total} = \theta_1 + \theta_2$.
   $\theta_{total} = 30^\circ + 60^\circ = 90^\circ$.

   Les coordonnées de $P$ par rapport à $P_1$ sont (dans un repère aligné avec $R_0$) :
   $\Delta x = L_2 \cos(\theta_{total})$
   $\Delta y = L_2 \sin(\theta_{total})$
   $\Delta x = 0.5 \cdot \cos(90^\circ) = 0$ m
   $\Delta y = 0.5 \cdot \sin(90^\circ) = 0.5$ m

3. Position finale de l'effecteur ($P$) dans $R_0$ :
   $x_P = x_1 + \Delta x = 0.866 + 0 = 0.866$ m
   $y_P = y_1 + \Delta y = 0.5 + 0.5 = 1.0$ m

Donc, l'effecteur est à $(0.866, 1.0)$ mètres dans le repère de base. Ce calcul est une forme simplifiée de cinématique directe. En 3D, chaque segment aurait une matrice de transformation 4x4, et on les multiplierait pour obtenir la transformation totale.

4. Key Takeaways

• La cinématique des corps rigides en 3D décrit le mouvement comme une combinaison de translation et de rotation.
• Les repères (fixe et mobile) et les transformations homogènes sont essentiels pour relier les positions et orientations entre eux.
• Les matrices de rotation, les angles d'Euler et les quaternions sont les principales méthodes pour représenter l'orientation 3D.
• La vitesse linéaire et la vitesse angulaire décrivent la variation de la position et de l'orientation dans le temps.
• La cinématique directe calcule la pose de l'effecteur à partir des paramètres des articulations ; la cinématique inverse fait l'inverse.
• La formule $\mathbf{v}_P = \mathbf{v}_O + \boldsymbol{\omega} \times \mathbf{r}_{OP}$ est fondamentale pour la vitesse d'un point sur un corps rigide.

Erreurs courantes à éviter :
- Confusion des repères : Toujours être clair sur quel vecteur est exprimé dans quel repère avant d'effectuer des opérations.
- Ordre des rotations : L'ordre des rotations avec les angles d'Euler est crucial et non commutatif. Changer l'ordre change le résultat.
- Gimbal lock : Oublier que les angles d'Euler peuvent perdre un degré de liberté dans certaines configurations, préférer les quaternions pour des mouvements continus et robustes.
- Normalisation des quaternions/matrices : Ne pas normaliser les quaternions après des opérations ou ne pas s'assurer que les matrices de rotation restent orthogonales peut entraîner des erreurs numériques.

5. Now Try It

Considérez un petit drone. Son repère de corps $R_b$ est initialement aligné avec le repère fixe $R_0$.
Le drone effectue ensuite les rotations suivantes dans l'ordre autour de ses propres axes (repère $R_b$) :
1. Rotation de $90^\circ$ autour de son axe Z (yaw).
2. Rotation de $45^\circ$ autour de son axe Y (pitch).
3. Rotation de $30^\circ$ autour de son axe X (roll).

Après ces rotations, sa position est translatée de $(5, 2, 1)$ mètres par rapport à l'origine de $R_0$.

Votre tâche :
1. Écrivez les trois matrices de rotation élémentaires pour chaque rotation.
2. Calculez la matrice de rotation finale $R_{0b}$ qui décrit l'orientation du repère du drone par rapport au repère fixe. Rappelez-vous que les rotations effectuées autour de ses propres axes doivent être composées dans l'ordre inverse : $R_{0b} = R_Z(90^\circ) R_Y(45^\circ) R_X(30^\circ)$.
3. Formulez la matrice de transformation homogène $T_{0b}$ complète du drone.

Ce que le succès signifie : Vous devriez être capable de présenter une matrice de rotation 3x3 correcte et une matrice de transformation homogène 4x4 correcte, en montrant les étapes de multiplication des matrices de rotation. Utilisez une calculatrice ou un logiciel (comme NumPy en Python) si nécessaire pour les multiplications matricielles.