Cinématica directa 2GDL

Para definir la cinématica directa e inversa de un robot de 2 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	$0$	$a_1 = 40$	$0$	$q_1$
2	$0$	$a_2 = 40$	$0$	$q_2$

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)} & - \sin{\left(q_{1} \right)} & 0 & a_{1} \cos{\left(q_{1} \right)}\\\sin{\left(q_{1} \right)} & \cos{\left(q_{1} \right)} & 0 & a_{1} \sin{\left(q_{1} \right)}\\0 & 0 & 1 & 0\\0 & 0 & 0 & 1\end{matrix}\right]$$ $$^{1}A_2 = \left[\begin{matrix}\cos{\left(q_{2} \right)} & - \sin{\left(q_{2} \right)} & 0 & a_{2} \cos{\left(q_{2} \right)}\\\sin{\left(q_{2} \right)} & \cos{\left(q_{2} \right)} & 0 & a_{2} \sin{\left(q_{2} \right)}\\0 & 0 & 1 & 0\\0 & 0 & 0 & 1\end{matrix}\right]$$

Luego,

$$^{0}A_2 = ^{0}A_1\cdot^{1}A_2 = \left[\begin{matrix}- \sin{\left(q_{1} \right)} \sin{\left(q_{2} \right)} + \cos{\left(q_{1} \right)} \cos{\left(q_{2} \right)} & - \sin{\left(q_{1} \right)} \cos{\left(q_{2} \right)} - \sin{\left(q_{2} \right)} \cos{\left(q_{1} \right)} & 0 & a_{1} \cos{\left(q_{1} \right)} - a_{2} \sin{\left(q_{1} \right)} \sin{\left(q_{2} \right)} + a_{2} \cos{\left(q_{1} \right)} \cos{\left(q_{2} \right)}\\\sin{\left(q_{1} \right)} \cos{\left(q_{2} \right)} + \sin{\left(q_{2} \right)} \cos{\left(q_{1} \right)} & - \sin{\left(q_{1} \right)} \sin{\left(q_{2} \right)} + \cos{\left(q_{1} \right)} \cos{\left(q_{2} \right)} & 0 & a_{1} \sin{\left(q_{1} \right)} + a_{2} \sin{\left(q_{1} \right)} \cos{\left(q_{2} \right)} + a_{2} \sin{\left(q_{2} \right)} \cos{\left(q_{1} \right)}\\0 & 0 & 1 & 0\\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)$ y $(2,4)$ de la matriz dan lugar a las posiciones $(x,y)$ del efector final del robot:

$$\begin{array}{cll} x &= a_{1} \cos{\left(q_{1} \right)} - a_{2} \sin{\left(q_{1} \right)} \sin{\left(q_{2} \right)} + a_{2} \cos{\left(q_{1} \right)} \cos{\left(q_{2} \right)} &\qquad\qquad (1) \\ y &= a_{1} \sin{\left(q_{1} \right)} + a_{2} \sin{\left(q_{1} \right)} \cos{\left(q_{2} \right)} + a_{2} \sin{\left(q_{2} \right)} \cos{\left(q_{1} \right)} &\qquad\qquad (2) \end{array}$$

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