Comment dériver la matrice jacobin pour un manipulateur de 6 dof

Comprendre comment dériver la matrice jacobinienne est essentiel pour contrôler un manipulateur robotisé de 6 degrés de liberté (6-DOF). Le jacobin relie les vitesses articulaires aux vitesses d'effet final, permettant un mouvement précis et un contrôle de la force.

Modèle cinématique du manipulateur

La première étape consiste à établir le modèle cinématique du robot, qui utilise généralement les paramètres Denavit-Hartenberg (D-H) pour définir les cadres de coordonnées de chaque joint. Ces paramètres comprennent les longueurs de liaison, les torsions, les décalages et les angles d'articulation.

En utilisant les paramètres D-H, vous pouvez dériver les matrices de transformation d'une joint à l'autre. Multiplier ces matrices donne la transformation globale de la base à l'effecteur final.

Calcul du jacobin

La matrice jacobinienne est composée de deux parties : la vitesse linéaire jacobin et la vitesse angulaire jacobin. Pour chaque joint, déterminer s'il est révolté ou prismatique, car cela affecte le calcul.

Pour les articulations révoltées, la composante de vitesse linéaire est le produit croisé de l'axe de l'articulation et le vecteur de l'articulation à l'effet final. La composante de vitesse angulaire est simplement le vecteur de l'axe de l'articulation. Pour les articulations prismatiques, la composante linéaire est le vecteur de l'axe de l'articulation et la composante angulaire est zéro.

Construire la matrice jacobin

Assemblez la matrice jacobinienne en empilant les vecteurs de vitesse linéaire et angulaires pour chaque joint. La matrice 6x6 qui en résulte relie les vitesses des joints aux vitesses des effets finaux.

Assurez-vous que le jacobin est évalué aux angles d'articulation actuels pour refléter avec précision la configuration du robot.