Cinématica directa 3GDL

Para definir la cinématica directa e inversa de un robot de 3 grados de libertad (GDL) necesitamos conocer inicialmente los parámetros del robot, es decir, los valores de Denavit-Hartenberg.

$i$	$\alpha_i$ (rad)	$a_i$ (mm)	$d_i$ (mm)	$\theta_i$ (rad)
1	$\pi/2$	$0$	$d_1=100$	$q_1$
2	$-\pi/2$	$0$	$0$	$q_2$
3	$0$	$0$	$q_3$	$0$

Cinemática directa

Con los valores de la tabla anterior podemos contruir las matrices de transformación siguiendo la estructura:

$$^{i-1}A_i = T_z(\theta_i)\cdot T(0,0,d_i) \cdot T(a_i,0,0) \cdot T_x(\alpha_i)$$

De esto tenemos

$$^{0}A_1 = \left[\begin{matrix}\cos{\left(q_{1} \right)} & 0 & \sin{\left(q_{1} \right)} & 0\\\sin{\left(q_{1} \right)} & 0 & - \cos{\left(q_{1} \right)} & 0\\0 & 1 & 0 & d_{1}\\0 & 0 & 0 & 1\end{matrix}\right]$$ $$^{1}A_2 = \left[\begin{matrix}\cos{\left(q_{2} \right)} & 0 & - \sin{\left(q_{2} \right)} & 0\\\sin{\left(q_{2} \right)} & 0 & \cos{\left(q_{2} \right)} & 0\\0 & -1 & 0 & 0\\0 & 0 & 0 & 1\end{matrix}\right]$$ $$^{2}A_3 = \left[\begin{matrix}1 & 0 & 0 & 0\\0 & 1 & 0 & 0\\0 & 0 & 1 & q_{3}\\0 & 0 & 0 & 1\end{matrix}\right]$$

Luego,

$$^{0}A_3 = \left[\begin{matrix}\cos{\left(q_{1} \right)} \cos{\left(q_{2} \right)} & - \sin{\left(q_{1} \right)} & - \sin{\left(q_{2} \right)} \cos{\left(q_{1} \right)} & - q_{3} \sin{\left(q_{2} \right)} \cos{\left(q_{1} \right)}\\\sin{\left(q_{1} \right)} \cos{\left(q_{2} \right)} & \cos{\left(q_{1} \right)} & - \sin{\left(q_{1} \right)} \sin{\left(q_{2} \right)} & - q_{3} \sin{\left(q_{1} \right)} \sin{\left(q_{2} \right)}\\\sin{\left(q_{2} \right)} & 0 & \cos{\left(q_{2} \right)} & d_{1} + q_{3} \cos{\left(q_{2} \right)}\\0 & 0 & 0 & 1\end{matrix}\right]$$

En esta matriz tenemos la transformación que sufre un objeto que se encuentra amarrado en el efector final del robot. Los terminos en las posiciones $(1,4)$, $(2,4)$ y $(3,4)$ de la matriz dan lugar a las posiciones $(x,y,z)$ del efector final del robot:

$$\begin{array}{cl} x &= - q_{3} \sin{\left(q_{2} \right)} \cos{\left(q_{1} \right)} \\ y &= - q_{3} \sin{\left(q_{1} \right)} \sin{\left(q_{2} \right)} \\ z &= d_{1} + q_{3} \cos{\left(q_{2} \right)} \end{array}$$

Asi hemos completado la cinemática directa de este robot.