Càlcul Denavit-Hartenberg per un robot de 6 eixos

A continuació es mostren les matrius de transformació D-H per a un robot industrial de 6 eixos (ex: KUKA KR6 R900):

Paràmetres D-H

Eix (i) \(\theta_i\) (°) \(d_i\) (mm) \(a_i\) (mm) \(\alpha_i\) (°)
1 30 400 25 90
2 45 0 560 0
3 90 0 515 0
4 60 0 0 90
5 -30 0 0 -90
6 0 100 0 0

Matriu de Transformació D-H

La fórmula general de la matriu D-H és:

\[ A_i = \begin{pmatrix} \cos(\theta_i) & -\sin(\theta_i)\cos(\alpha_i) & \sin(\theta_i)\sin(\alpha_i) & a_i\cos(\theta_i) \\ \sin(\theta_i) & \cos(\theta_i)\cos(\alpha_i) & -\cos(\theta_i)\sin(\alpha_i) & a_i\sin(\theta_i) \\ 0 & \sin(\alpha_i) & \cos(\alpha_i) & d_i \\ 0 & 0 & 0 & 1 \end{pmatrix} \]

Apliquem els paràmetres numèrics al primer eix:

\[ A_1 = \begin{pmatrix} \cos(30°) & -\sin(30°)\cos(90°) & \sin(30°)\sin(90°) & 25\cos(30°) \\ \sin(30°) & \cos(30°)\cos(90°) & -\cos(30°)\sin(90°) & 25\sin(30°) \\ 0 & \sin(90°) & \cos(90°) & 400 \\ 0 & 0 & 0 & 1 \end{pmatrix} \]

Resolent aquesta matriu:

\[ A_1 = \begin{pmatrix} 0.866 & 0 & 0.5 & 21.65 \\ 0.5 & 0 & -0.866 & 12.5 \\ 0 & 1 & 0 & 400 \\ 0 & 0 & 0 & 1 \end{pmatrix} \]

Repetim aquest procés per a tots els eixos i després multipliquem les matrius per obtenir la posició final del robot.