Parametros Denavit-Hartemberg

Parámetros Denavit-Hartenberg

1. Numerar los eslabones comenzando con 1 (primer eslabón móvil dela cadena) y acabando con n (último eslabón móvil). Se numerara como eslabón 0 a la base fija del robot.

2. Numerar cada articulación comenzando por 1 (la correspondiente al primer grado de libertad y acabando en n).

3. Localizar el eje de cada articulación. Si esta es rotativa, el eje será su propio eje de giro. Si es prismática, será el eje a lo largo del cual se produce el desplazamiento.

4. Para i de 0 a n-1, situar el eje Zi, sobre el eje de la articulación i+1.

5. Situar el origen del sistema de la base (S0) en cualquier punto del eje Z0. Los ejes X0 e Y0 se situaran dé modo que formen un sistema dextrógiro con Z0.

6. Para i de 1 a n-1, situar el sistema (Si) (solidario al eslabón i) en la intersección del eje Zi con la línea normal común a Zi-1 y Zi. Si ambos ejes se cortasen se situaría (Si) en el punto de corte. Si fuesen paralelos (Si) se situaría en la articulación i+1.

7. Situar Xi en la línea normal común a Zi-1 y Zi.

8. Situar Yi de modo que forme un sistema dextrógiro con Xi y Zi.

9. Situar el sistema (Sn) en el extremo del robot de modo que Zn coincida con la dirección de Zn-1 y Xn sea normal a Zn-1 y Zn.

10. Obtener Øi como el ángulo que hay que girar en torno a Zi-1 para que Xi-1 y Xi queden paralelos.

11. Obtener Di como la distancia, medida a lo largo de Zi-1, que habría que desplazar (Si-1) para que Xi y Xi-1 quedasen alineados.

12. Obtener Ai como la distancia medida a lo largo de Xi (que ahora coincidiría con Xi-1) que habría que desplazar el nuevo (Si-1) para que su origen coincidiese con (Si).

13. Obtener ai como el ángulo que habría que girar en torno a Xi (que ahora coincidiría con Xi-1), para que el nuevo (Si-1) coincidiese totalmente con (Si).

14. Obtener las matrices de transformación i-1Ai.

15. Obtener la matriz de transformación que relaciona el sistema de la base con el del extremo del robot T = 0Ai, 1A2... n-1An.

16. La matriz T define la orientación (submatriz de rotación) y posición (submatriz de traslación) del extremo referido a la base en función de las n coordenadas articulares.

Parámetros DH para un eslabón giratorio.

Los cuatro parámetros de DH (qi, di, ai, ai) dependen únicamente de las características geométricas de cada eslabón y de las articulaciones que le unen con el anterior y siguiente.

Ѳi Es el ángulo

...