Control de Esfuerzos de Robots Manipuladores

Anuncio
Control de Esfuerzos
de Robots
Manipuladores
Automatización y Robótica Industrial 5 Ing Industrial
Control Híbrido
División del espacio de tareas en dos subespacios:
• Controlado en esfuerzo
• Controlado en posición
LIMITACIONES DE ESFUERZO Y DE MOVIMIENTO:
• Naturales: Aparecen naturalmente de acuerdo con la situación de
contacto en particular
• Artificiales: Son introducidas para especificar los movimientos
deseados y la aplicación de esfuerzos
Automatización y Robótica Industrial 5 Ing Industrial
Control Híbrido
RESTRICCIONES NATURALES:
• En la realización de una tarea simple de
un robot aparecen una serie de
restricciones de Posición-Fuerza,
originadas por la propia geometría de las
partes que intervienen en la tarea y sus
ligaduras.
En el ejemplo aparecen Restricciones naturales en
Posición (o velocidad) en la direccción normal a la
superficie y Restricciones naturales en Fuerza en la
direcciones tangenciales
Tarea: Mantener contacto con
la pared ejerciendo una fuerza
controlada
Vz=0
Fx=0
Automatización y Robótica Industrial 5 Ing Industrial
Wx=0
Fy=0
Wy=0
Nz=0
Control Híbrido
RESTRICCIONES ARTIFICIALES:
• Las fuerzas y posiciones que no quedan
limitadas por la s restricciones naturales,
deben ser especificadas por la tarea (y de
su logro se ocupará el control del robot).
• Las Restricciones Artificiales completan
a las Naturales siendo restricciones de
posición en las direcciones Tangenciales
a la superficie de contacto y restricciones
en Fuerza en las direcciones Normales.
Vx=Vvertical
Fz=Fcontacto
Vy=0
Nx=0
Tarea: Mantener contacto con
la pared ejerciendo una fuerza
controlada
Wz=0
Ny=0
Automatización y Robótica Industrial 5 Ing Industrial
Control Híbrido
RESTRICCIONES NATURALES:
• Los GDL se dividen en dos conjuntos:
– X, Z controlado en Posición
– Y controlado en Fuerza
Tarea: Girar la Manivela a
velocidad constante Wgiro
Vx=0
Fx=
Vy=
Fy=0
Vz=0
Fz=
Wx=0
Nx=
Wy=0
Ny=
Wz=
Nz=0
Automatización y Robótica Industrial 5 Ing Industrial
Control Híbrido
RESTRICCIONES ARTIFICIALES:
• Los GDL se dividen en dos conjuntos:
– X, Z controlado en Posición
– Y controlado en Fuerza
• Las R. artificiales fuerzan la ejecución de
la tarea. En este caso hacer girar la
manivela a velocidad constante.
Vx=
Fx=0
Vy=R·Wgiro
Fy=
Vz=
Fz=0
Tarea: Girar la Manivela a
velocidad constante Wgiro
Wx=
Nx=0
Wy=
Ny=0
Automatización y Robótica Industrial 5 Ing Industrial
Wz=Wgiro
Nz=
Planificación de Estrategias
• Una Tarea compleja puede ser dividida en subtareas, cada una de las
cuales queda definida por las restricciones artificiales necesarias para su
consecución.
• La especificación de las restricciones artificiales son las referencias de
los servos del robot (en fuerza o posición).
• El paso de una subtarea a otra se origina cuando se dan determinadas
condiciones, que también deben ser especificadas.
• La descomposición en subtareas puede ser objeto de planificadores
automáticos, aunque es un problema en general no resuelto hoy en día.
Automatización y Robótica Industrial 5 Ing Industrial
Planificación de Estrategias
Ejemplo: Estrategia para ensamblado
Tarea: Inserción de un perno en un taladro
Subtareas:
1. Acercamiento
2. Deslizamiento
3. Inserción
4. Finalización
Automatización y Robótica Industrial 5 Ing Industrial
Planificación de Estrategias
Tarea: Inserción de un perno en un taladro
Subtarea 1: Acercamiento
R. Naturales
R. Artificiales
Vx=
Vy=
Vz=
Wx=
Wy=
Wz=
Vx=0
Vy=Vaprox
Vz=0
Wx=0
Wy=0
Wz=0
Fx=
Fy=
Fz=
Nx=
Ny=
Nz=
(MOV. LIBRE)
Fx=
Fy=
Fz=
Nx=
Ny=
Nz=
(BAJAR)
Condición de Finalización: Fz=Fzlimite
Automatización y Robótica Industrial 5 Ing Industrial
Planificación de Estrategias
Tarea: Inserción de un perno en un taladro
Subtarea 2: Deslizamiento
R. Naturales
R. Artificiales
Vx=
Vy=
Vz=0
Wx=0
Wy=0
Wz=
Vx=Vdes
Vy=0
Vz=
Wx=
Wy=
Wz=0
Fx=0
Fy=0
Fz=
Nx=
Ny=
Nz=0
Fx=
Fy=
Fz=Fcontacto
Nx=0
Ny=0
Nz=
Condición de Finalización: Vz=Vzlimite
Automatización y Robótica Industrial 5 Ing Industrial
Planificación de Estrategias
Tarea: Inserción de un perno en un taladro
Subtarea 3: Inserción
R. Naturales
R. Artificiales
Vx=0
Vy=0
Vz=
Wx=0
Wy=0
Wz=
Vx=
Vy=
Vz=Vinser
Wx=
Wy=
Wz=0
Fx=
Fy=
Fz=0
Nx=
Ny=
Nz=0
Fx=0
Fy=0
Fz=
Nx=0
Ny=0
Nz=
(BAJAR)
Condición de Finalización: Fz=Fzlimite
Automatización y Robótica Industrial 5 Ing Industrial
Planificación de Estrategias
Tarea: Inserción de un perno en un taladro
Subtarea 3: Finalización
Los cambios de fase se detectan
observando las variables (posición/fuerza
que no se controlan (“Restricción
complementaria servocontrolada”).
Fase 1: Condición Fz se controla Vz
Fase 2: Condición Vz se controla Fz
Fase 3: Condición Fz se controla Vz
Automatización y Robótica Industrial 5 Ing Industrial
Control Híbrido
Esquema de controlador híbrido de posición/esfuerzo
En cada grado de libertad será posible controlar la posición o el
esfuerzo. Para insertar las limitaciones en el esquema de control
se crean las matrices S y S’ (Matrices conmutadoras).
⎛ 1 0 0⎞
⎜
⎟
S = ⎜ 0 0 0⎟
⎜ 0 0 1⎟
⎝
⎠
⎛ 0 0 0⎞
⎜
⎟
S' = ⎜ 0 1 0⎟
⎜ 0 0 0⎟
⎝
⎠
S + S' = I
Automatización y Robótica Industrial 5 Ing Industrial
Control Híbrido
Esquema de controlador híbrido de posición/esfuerzo
S y (S-I) son como llaves conmutadoras ( se elige una o la otra).
S sirve para elegir en que grado de libertad se quiere control de
posición o de esfuerzo.
El control híbrido permite una clara visualización de la división
de los grados de libertad que requieren control de posición o
de esfuerzo, pero no da ninguna solución para cada tipo de
control, eso será determinado por las leyes de control de
posición y de esfuerzo.
Automatización y Robótica Industrial 5 Ing Industrial
Control Híbrido
Automatización y Robótica Industrial 5 Ing Industrial
Descargar