Robot de 6 ejes

From FreeCAD Documentation
Jump to: navigation, search
This page is a translated version of the page Robot 6-Axis and the translation is 97% complete.

Outdated translations are marked like this.
Other languages:
čeština • ‎Deutsch • ‎English • ‎español • ‎français • ‎italiano • ‎română • ‎русский • ‎svenska • ‎Türkçe

Base ExampleCommandModel.png Tutorial

Tema
Robot Workbench
Nivel
Intermediate
Tiempo para completar
Unknown
Autor
Versión de FreeCAD
Archivo(s) de ejemplo(s)


Este artículo trata sobre incluir en FreeCAD para su simulación un robot industrial estándar de 6 ejes

La siguiente descripción sigue el sistema de parámetros Denavit-Hartenberg, como también se describe en el libro de John J. Craigs "Introducción a la robótica".

Ejemplo Kuka

El Kuka KR-16
KukaKR16.jpg KukaParts.jpg KukaAxisPosition.jpg

Cinemática

Aplicaciones 3D
Segmento Parámetro Descripción
KukaBase.jpg Base de configuración
KukaSegment1.jpg

\theta_{1} = q_{1}

d_{1} = 675 mm

a_{1} = 260 mm

\alpha_{1} = −90°

Segmento 1
KukaSegment2.jpg

\theta_{2} = q_{2} - 90°

d_{2} = 0 mm

a_{2} = 680 mm

\alpha_{2} = 0°

Segmento 2
KukaSegment3.jpg

\theta_{3} = q_{3}

d_{3} = 0 mm

a_{3} = 0 mm

\alpha_{3} = 90°

Segmento 3
KukaSegment4.jpg

\theta_{4} = q_{4}

d_{4} = -670 mm

a_{4} = 0 mm

\alpha_{4} = -90°

Segmento 4
KukaSegment5.jpg

\theta_{5} = q_{5}

d_{5} = 0 mm

a_{5} = 0 mm

\alpha_{5} = 90°

Segmento 5
KukaSegment6.jpg

\theta_{6} = q_{6}

d_{6} = 0 mm

a_{6} = -158 mm

\alpha_{6} = 180°

Segmento 6

Esto conduce a la tabla siguiente:

Tabla cinemática
i \theta d a \alpha
1 q1 675 mm 260 mm -90°
2 q2 - 90° 0 mm 680 mm
3 q3 0 mm 0 mm 90°
4 q4 -670 mm 0 mm -90°
5 q5 0 mm 0 mm 90°
6 q6 -158 mm 0 mm 180°

Ya que los robots Kuka no tienen todos los ejes a 0 en la posición dibujada en L, tenemos que cambiar el eje 2 y 3 por 90°.


Tabla cinemática
i \theta d a \alpha
1 q1 675 mm 260 mm -90°
2 q2 0 mm 680 mm
3 q3 - 90° 0 mm 0 mm 90°
4 q4 -670 mm 0 mm -90°
5 q5 0 mm 0 mm 90°
6 q6 -158 mm 0 mm 180°

En la hoja de datos encontramos información adicional sobre los ejes:

KukaAxisData.jpg

Lo que conduce a esta tabla completa:

Tabla cinemática
i \theta d a \alpha \theta_{min} \theta_{max} Axis Speed
1 0 675 260 -90 -185 185 156
2 0 0 680 0 -155 35 156
3 - 90 0 0 90 -130 154 156
4 0 -670 0 -90 -350 350 330
5 0 0 0 90 -130 130 330
6 0 -158 0 180 -350 350 615

Representación visual

FreeCAD puede generar una basta representación visual de la tabla cinemática. Pero si quieres acercarte más a la realidad puedes utilizar un archivo VRML con la forma del robot para la simulación. Por ejemplo, Kuka proporciona archivos VRML de sus modelos. El archivo VRML es cargado con la especificación del robot en FreeCAD. Para permitir a FreeCAD mover los ejes tenemos que editar el archivo VRML e insertar nodos de transformación especiales que FreeCAD pueda encontrar y manipular.

Otra vez mostrado por el ejemplo Kuka KR 16. Empezando desde la línea 1:

#VRML V2.0 utf8
#
# This VRML97 file was exported using eM-Workplace
# (c) Tecnomatix Technologies GmbH & Co. KG
#     Heisenberg-Bogen 1
#     D-85609 Aschheim-Dornach
#     GERMANY
#
#Background
#{
#   skyColor   [0.752941 0.752941 0.752941]
#}
Transform
{
   #rotation 1 0 0 -1.5707963
   #scale .001 .001 .001
   children
   [
           DEF AOBJ_0001_000_TRAFO Transform
           {
              children
              [
...

Verás que este archivo es exportado con un software de simulación de robots llamado Tecnomatix. Elimina ese aviso y añade la URL de donde has obtenido el archivo, porque Tecnomatix no tiene ningún copyright en el contenido del archivo. Es solo un conversor! Antes de nada eliminamos el nodo de Background. Luego eliminamos el nodo de rotación y escala para tener el modelo en mm y Z a la derecha.

Justo al final:

  ] }
  ] }
  ] }
  ]
}
#ROUTE SENS_04_OBJ.rotation_changed TO AXIS_04_OBJ.rotation
#ROUTE SENS_27_OBJ.rotation_changed TO AXIS_27_OBJ.rotation
#ROUTE SENS_32_OBJ.rotation_changed TO AXIS_32_OBJ.rotation
#ROUTE SENS_44_OBJ.rotation_changed TO AXIS_44_OBJ.rotation
#ROUTE SENS_46_OBJ.rotation_changed TO AXIS_46_OBJ.rotation
#ROUTE SENS_49_OBJ.rotation_changed TO AXIS_49_OBJ.rotation
#DEF AnySIMTimer TimeSensor
#{
#   cycleInterval 1.000000
#   loop          TRUE
#}

Desmarcar como comentario el sensor de tiempo TimeSensor y las 6 rutas. Estas 6 líneas te dan una pista de la situación del eje real del robot! Primero busca por "AXIS_04_OBJ" que te lleva a esta parte:

...
    Transform { rotation 1 0 0 1.570796 children [
        DEF SENS_04_OBJ-0001 CylinderSensor
        {
           diskAngle 1.570796
           minAngle  -3.228859
           maxAngle  3.228859
           offset    0.000000
        }
      DEF FREECAD_AXIS1 Transform { rotation 0 1 0 0 children [
      DEF AXIS_04_OBJ-0001 Transform
     {
        children
        [
        Transform { rotation 1 0 0 -1.570796 children [
           DEF AOBJ_0001_003_TRAFO Transform
           {
              rotation 1.000000 0.000000 0.000000 3.141593
              translation -600.000000 500.000000 300.000000
              children
              [
...

Tienes que insertar justo encima de la definición de este nodo la línea "DEF FREECAD_AXIS1 Transform { rotation 0 1 0 0 children [" la cual es el anclaje para que FreeCAD pueda mover el eje.

Ahora haz lo mismo para FREECAD_AXIS2,FREECAD_AXIS3,FREECAD_AXIS4,FREECAD_AXIS5 y FREECAD_AXIS6. No olvides cerrar los corchetes al final del archivo y listo!

Puedes cargar el VRML para instalar el robot:

App.activeDocument().addObject("Robot::RobotObject","Robot")
App.activeDocument().Robot.RobotVrmlFile = "C:/_Projekte/FreeCAD0.9_build/mod/Robot/Lib/Kuka/kr16.wrl"

Lo cual debería dar este resultado: KukaKR16FreeCAD.jpg

KR 210

Data sheet

Tabla cinemática
i \theta d a \alpha \theta_{min} \theta_{max} Axis Speed
1 0 750 350 -90 -185 185 156
2 0 0 1250 0 -155 35 156
3 - 90 0 0 90 -130 154 156
4 0 -1100 0 -90 -350 350 330
5 0 0 0 90 -130 130 330
6 0 -230 0 180 -350 350 615


KR 500

Data sheet

Tabla cinemática
i \theta d a \alpha \theta_{min} \theta_{max} Axis Speed
1 0 1045 500 -90 -185 185 156
2 0 0 1300 0 -155 35 156
3 - 90 0 0 90 -130 154 156
4 0 -1025 0 -90 -350 350 330
5 0 0 0 90 -130 130 330
6 0 -250 0 180 -350 350 615