Académique Documents
Professionnel Documents
Culture Documents
del Robot
Contenidos
Generacin y control de trayectoria.
Control visual.
Arquitectura del sistema de visin
Control basado en posicin
Control basado en imagen.
Lenguajes de programacin de robots.
Lenguaje de Control Avanzado (Advanced
Control Language ACL).
Aplicaciones.
Anlisis de casos prcticos.
Ejemplos prcticos.
Objetivos
Modelar la trayectoria de un robot y
el movimiento de sus partes as
como programar el control del
funcionamiento de ste teniendo en
cuente los sensores que posee.
Modelo cinemtico
Sus objetivos son:
Establecer cuales son las trayectorias que debe seguir
cada articulacin del robot a lo largo del tiempo para
conseguir los objetivos fijados por el usuario:
Punto de destino
Tipo de trayectoria del extremo
Tiempo invertido
etc..
Es necesario atender a las restricciones fsicas de los
accionamientos y criterios de calidad (suavidad,
precisin...)
5
Concepto de punto
PUNTO:
En el espacio de las juntas es el vector compuesto
por valores definidos de las variables de junta.
En el espacio cartesiano est dado por la posicin
(x, y, z) y la orientacin (, , ), tambin
representado por T.
Un punto definido en el espacio de las juntas tiene
una sola proyeccin en el espacio cartesiano.
Un punto definido en el espacio cartesiano puede
tener una, muchas o ninguna proyeccin en el
espacio de las juntas.
9
Generacin de trayectorias
TRAYECTORIA: Es la historia en el tiempo
(sucesin) de los valores (puntos) de la posicin,
velocidad y aceleracin para cada grado de
libertad del manipulador.
El problema bsico consiste en ir de la posicin
actual (Tinicial) a una posicin deseada (Tfinal)
11
Caractersticas
Definir un punto inicial, un punto final e
interpolar puntos intermedios.
Una trayectoria (o consigna) determinada
va a influir sobre las partes mecnicas del
robot.
Se trata de tener aceleraciones suaves para
evitar movimientos bruscos que hagan
vibrar el sistema, debido a que las grandes
aceleraciones instantneas desgastan
mucho las piezas y fuerzan los actuadores.
13
Tipos de trayectorias
Trayectorias en espacio de las
juntas:
Trayectorias en espacio
cartesiano:
(Trayectorias continuas):
Interpoladas.
Habituales en robots
comerciales caros.
Analticas.
14
Tipos de trayectorias
1. Trayectorias punto a punto:
Movimiento eje a eje.
Movimiento simultneo de ejes.
Trayectorias coordinadas o
iscronas.
2. Trayectorias continuas.
15
Tipos de trayectorias
16
Trayectorias
Coordinadas o iscronas
Los ejes se mueven simultneamente ralentizando
las articulaciones ms rpidas de forma que todos
los ejes acaben a la vez.
El tiempo total ser el menor posible.
Se evitan exigencias intiles de velocidad y
aceleracin.
Continuas
La trayectoria del extremo es conocida (cartesiana).
Trayectorias tpicas: Lnea recta, Arco de crculo.
18
Interpolacin de trayectorias
Unin de una sucesin de puntos en el espacio
articular por los que han de pasar las articulaciones del
robot en un instante determinado.
Surge la necesidad de respetar las restricciones fsicas.
Se utilizan funciones polinmicas cuyos coeficientes se
ajustan segn las restricciones.
Los principales tipos de interpoladores utilizados son:
Interpoladores lineales.
Interpoladores cbicos (splines).
Interpoladores a tramos.
Otros interpoladores.
19
Interpoladores lineales
Sencillos. Se obtiene slo continuidad en
posicin.
Velocidad discreta y aceleracin infinita.
Vlida slo si el controlador suaviza en
cada paso discreto.
20
Interpoladores cbicos
Se utilizan polinomios de tercer grado para unir
cada pareja de puntos.
Brindan la posibilidad de imponer cuatro
condiciones de contorno al usar cuatro
parmetros: dos de posicin y otros dos de
velocidad.
La trayectoria se describe como una serie de
polinomios cbicos concatenados, escogidos de
forma que exista continuidad en posicin y
velocidad, denominados splines.
21
Interpoladores a tramos
Interpolador con 3 tramos
22
23
24
25
26
Interpolacin
en el espacio de las juntas
en el espacio cartesiano
27
Interpolacin: Ventajas y
Desventajas
en el espacio de las juntas
en el espacio cartesiano
Se conoce la trayectoria en
el espacio cartesiano.
Gran cantidad de clculos.
Slo luego de los clculos
se sabr si el proceso es
posible y suave.
Si cae en una singularidad
se pierde la trayectoria.
28
Ejemplos
con dos puntos vas (una
junta)
trayectoria Pick-and-Place
29
Interpolacin en la orientacin
Si se define orientacin en puntos origen/destino:
se hace un PTP de orientacin origen a destino.
Notas:
No vale interpolar matrices de rotacin, ya que
no seran ortonormales.
Interpolar ngulos Euler, RPY similar a lo
explicado. Pero la trayectoria no es intuitiva.
Interpolar representacin Vector-ngulo: s es
intuitivo. Hay que hacer la transformada
inversa, lo cual no es fcil.
30
Modelo dinmico
Su objetivo es procurar que las trayectorias realmente
seguidas por el robot q(t) sean lo ms parecidas posibles
a las propuestas por el control cinemtico qc(t):
Obtener una solucin simblica que represente los
movimientos de los elementos del robot, y
especialmente la garra, en funcin de los torques /
esfuerzos aplicados.
Recprocamente, el modelo de control dinmico permitir
tambin obtener los esfuerzos/torques necesarios para
que los elementos del robot se muevan con las
velocidades y aceleraciones especificadas siguiendo las
trayectorias tambin especificadas.
31
ROBOT
Constituido por:
manipulador
fuente de alimentacin
electrnica de control
software (ley de
control)
MODELO DINMICO
Se usa para:
CONTROL
SIMULACIN
DISEO
del movimiento del
brazo.
32
Aspectos dinmicos
ESTRUCTURALES
Fuerza centrfuga.
Fuerza de Coriolis:
esfuerzo rotacional
que surge de la
combinacin de dos
movimientos.
Acoplamiento de
inercia.
Accin de la gravedad.
ACCIONAMIENTO
Rozamiento seco y
viscoso.
Inercia variable debida a
la carga.
No linealidad en los
engranajes (juego).
Flexibilidad en la
transmisin de torque.
33
Angular
35
Distribucin de masas
El momento de inercia de un cuerpo slido con
densidad (r), con respecto a un eje dado se
define como:
36
Momento de inercia
Si se puede elegir la orientacin del
marco de referencia, es posible hacer
cero los productos de inercia.
Ejes principales:
Momentos principales de inercia.
37
38
39
Ecuaciones
Ecuacin de Newton:
Fuerzas causantes de
traslacin.
Ecuacin de Euler:
Momentos causantes
de rotacin.
40
Balances
Balance de fuerzas en un
link:
Balance de torques en un
link:
41
Balance de Fuerzas
Usando el resultado de balance de fuerza
y torque:
42
43
Fuerza de Coriolis
Fuerza ficticia ejercida sobre un
cuerpo cuando este se mueve en un
marco de referencia en rotacin:
45
48
49
Lagrangeano
El resultado que se
utiliza es:
Dada una masa
puntual m con una
coordenada
generalizada qi
(posicin o ngulo), la
relacin entre qi y la
fuerza o torque F1
aplicada sobre ella
est dada por:
50
51
Ejemplo para -r
m1 = 10 Kg
m2 : entre 1 y 5 Kg
r1 = 1 m
r2 : entre 1 y 2 m
Velocidades mximas: 1 rad/s y 1 m/s
Aceleraciones mximas: 1 rad/s2 y 1 m/s2
52
Ejemplo
Clculo de K1 y P1
Clculo de K2 y P2
El Lagrangeano ser:
53
Ejemplo
Para la Junta Rotacional...
54
58
Mx - Matriz de inercia : Es el
conjunto de masas que el robot
presenta al ambiente (en cada eje:
mx, my, mz)
59
60
61
Control de posicin
Se controla para modificar el comportamiento
natural de un sistema.
El objetivo, por tanto, es controlar la posicin final
del objeto de modo que el tiempo que le
demande llegar a esa posicin sea el propuesto,
que el error con respecto a la posicin deseada
sea cero y que mantenga la posicin a pesar
de los esfuerzos externos que pueda recibir.
Se quiere controlar posicin, es decir, las
variables del movimiento, ya sea en el espacio
de las juntas o en el cartesiano.
62
63
64
67
68
Si se aplica un esfuerzo:
69
71
72
73
75
Alternativas para su
implementacin
76
77
78
Control monoarticular
Considera cada articulacin de manera
independiente.
No es realista, pero es aceptable con
prdida de prestaciones como costo.
Es utilizado por la mayora de los robots
comerciales.
Es ms aceptable en robots alto factor de
reduccin.
79
Esquemas de control ms
extendidos
Control PD/PID.
Control con prealimentacin.
Control PD con compensacin de
gravedad.
80
81
82
83
84
Control multiarticular
Se consideran las influencias del resto de las
articulaciones para el control de una articulacin.
Tiene elevada complejidad.
Tcnicas ms extendidas:
Desacoplamiento por inversin del modelo/par
calculado.
Tcnicas de control adaptativo:
Planificacin de ganancias.
Con modelo de referencia (MRAC).
Par calculado adaptativo.
85
Control Adaptativo
Debido a que los parmetros del
manipulador no se conocen con exactitud,
los parmetros del modelo no coinciden
con la realidad provocando errores en el
control.
Dichos errores pueden usarse para intentar
corregir el modelo.
Basado en la ley de control ya propuesta,
puede idearse un esquema bsico de
Control Adaptativo.
86
Control Adaptativo
87
Control de esfuerzos
Existen dos situaciones en funcin
del esfuerzo que aplica el robot:
Movimiento en el espacio libre:
Esfuerzo cero despreciable.
Encuentro con algn objeto: Esfuerzo
distinto de cero.
88
89
90
Tareas de contacto
Son todas las tareas en que el robot
agarra, empuja, o trabaja aplicando
un esfuerzo al objeto:
1. Movimiento en el espacio libre.
2. Colisin.
3.Aplicacin del esfuerzo.
92
Sistema aislado
1- El robot se puede mover sin
restricciones.
Su control est limitado al
posicionamiento de la garra.
93
94
Acoplamiento
3- El robot est en contacto efectivo con el
objeto.
Es conveniente en esta fase controlar el
esfuerzo y no la posicin. El robot y el
objeto son ahora dos SISTEMAS
ACOPLADOS.
95
Posicin
Esfuerzo
96
Control hbrido
Divisin del espacio de tareas en dos
subespacios:
1 Controlado en posicin.
2 Controlado en esfuerzo:
a. Control Explcito
b. Realimentacin para control de
posicin.
97
Limitaciones de esfuerzo y de
movimiento
Naturales: Aparecen naturalmente
de acuerdo con la situacin de
contacto en particular.
Artificiales: Son introducidas para
especificar los movimientos
deseados y la aplicacin de
esfuerzos.
98
Planificacin de estrategias
Una Tarea compleja puede ser dividida en subtareas,
cada una de las cuales queda definida por las
restricciones artificiales necesarias para su consecucin.
La especificacin de las restricciones artificiales son las
referencias de los servos del robot (en fuerza o posicin).
El paso de una subtarea a otra se origina cuando se dan
determinadas condiciones, que tambin deben ser
especificadas.
La descomposicin en subtareas puede ser objeto de
planificadores automticos, aunque es un problema en
general no resuelto hoy en da.
99
100
101
102
Control de flexibilidad
FLEXIBILIDAD: Capacidad que posee el robot o el
conjunto robot-controlador de modificar la
posicin de la garra o elemento terminal, como
resultado de la aplicacin de un esfuerzo.
Existen dos maneras principales:
Activa
Pasiva
104
Flexibilidad pasiva
Consiste en dotar al robot de una cierta
capacidad para modificar la posicin de la garra
cuando sta recibe la aplicacin de un esfuerzo.
Es especfica para cada aplicacin.
Se implementa con dispositivos mecnicos
pasivos ajustados especialmente para cada uso.
105
Flexibilidad activa
El objetivo sigue siendo el mismo que en
el control de flexibilidad pasiva, lo que
cambia es la forma de implementacin:
- Modificacin de los parmetros y/o de la
estructura de control.
Ventaja: Implementacin por software.
106
Referencias en cursos
Captulos 6, 7, 8, 9 y 10
(curso_biom_ar)
Temas 6, 7 y 8 (curso_umh_es)
107
Referencias en Internet
Introduccin al Control de Robots
Robtica Inteligente
PRCTICA 4: CONTROL DE TRAYECTORIAS (
Robtica Industrial Apuntes: Tema 7)
ENTORNO MATLAB PARA DISEO DE CONTROLADO
RES PID
PID Tutorial
Analysis of Control PD-PID in Real-Time by Means o
f DSP for a Table of Positioning with Trajectory X
and Y
108
Documentos en archivos
Introduction_to_Robotics_Mechanics_and_Control_-_J_J_Craig
(en particular Captulos 4 al 9)
Control_in_Robotics_and_Automation (en particular seccin
3: Multiple Sensor Fusion in Planning and Control)
Crc_Press_Mechanical_Engineering_Handbook_-_Robotics
(en particular Robot Dynamics and Control)
Fundamentos de Robtica (en particular Captulos 6 y 7)
McGraw-Hill Anatomy of a Robot (en particular Captulo 2)
Robot_Mechanisms_And_Mechanical_Devices_Illustrated (en
particular Captulo 10)
ACL
Comandos_ACL_17793
109
Bibliografa
Angulo,J-M. y Avils,R. Curso de Robtica Ed
Paraninfo.
Fu,K.S.; Gonzalez,R.C. y Lee,C.S.G. Robotics: Control,
Sensing, Vision and Intelligence Ed Mc Graw Hill.
Barrientos, Balaguer .C. Fundamentos de Robtica
Ed Mc Graw Hill
Abidi,M.A. y Gonzalez,R.C. Data Fusion in Robotics
and Machine Intelligence Ed Academic Press.
Haralick,R.M. y Shapiro,L.G. Computer and Robot
Vision Ed Addison-Wesley
Ogata. K. Ingeniera de Control Moderno Ed
Prentice Hall.
110