Professional Documents
Culture Documents
me
www.FreeLibros.me
Introduccin a la
robtica
www.FreeLibros.me
www.FreeLibros.me
Introduccin a la
robtica
Subir Kumar Saha
Indian Institute of Technology
Revisin tcnica:
www.FreeLibros.me
109876543210
Impreso en Mxico
Printed in Mexico
www.FreeLibros.me
Dedicado a
Los estudiantes de la India
www.FreeLibros.me
Contenido
Sobre el autor
Prefacio
xii
1. Introduccin 1
1.1 Historia 1
1.2 Robots 5
1.3 El uso de robots 8
Resumen 13
Ejercicios 13
Ejercicios basados en la web
13
2. Robots seriales 14
2.1
2.2
2.3
2.4
2.5
2.6
Subsistemas de robots 14
Clasificacin de robots por aplicacin 24
Clasificacin de robots por sistema de coordenadas 24
Clasificacin de robots por su sistema de potencia 29
Clasificacin de robots por el mtodo de control 29
Clasificacin de robots por mtodo de programacin 30
Resumen 30
Ejercicios 31
Ejercicios basados en la web 31
www.FreeLibros.me
Contenido
3. Actuadores 32
3.1
3.2
3.3
3.4
Actuadores neumticos 33
Actuadores hidrulicos 36
Actuadores elctricos 38
Seleccin de motores 49
Resumen 50
Ejercicios 51
Ejercicios basados en la web
51
4. Sensores 52
4.1
4.2
4.3
4.4
4.5
Clasificacin de sensores 52
Sensores internos 53
Sensores externos 62
Sistema de visin 66
Seleccin de sensores 72
Resumen 74
Ejercicios 75
Ejercicios basados en la web 75
5. Transformaciones 76
5.1
5.2
5.3
5.4
Arquitectura de robots 76
Posicin de un cuerpo rgido 83
Transformacin de coordenadas 92
Los parmetros de Denavit y Hartenberg (DH)
Resumen 109
Ejercicios 109
Ejercicios basados en MATLAB 110
100
6. Cinemtica 112
6.1
6.2
6.3
6.4
6.5
6.6
6.7
6.8
www.FreeLibros.me
vii
viii
Contenido
7. Esttica 146
7.1
7.2
7.3
7.4
7.5
8. Dinmica 163
8.1
8.2
8.3
8.4
8.5
205
www.FreeLibros.me
252
Contenido
283
ix
316
www.FreeLibros.me
338
346
357
365
369
Apndice A
Sobre el autor
Nacido en Maldaha, Bengala Occidental (India), el profesor Subir Kumar Saha realiz la
mayor parte de sus estudios escolares en Vidyasagar Vidyapith, Midnapore (tambin en
Bengala Occidental). En 1983, complet su BE (Mech.) en el RE College (hoy NIT), en
Durgapur, seguido por la maestra del IIT en Kahargpur en 1985. Obtuvo su doctorado por
la McGill University de Canad en 1991 y se afili inmediatamente despus al centro de
investigacin y desarrollo de la Toshiba Corporation de Japn. En 1995 regres al ITT Madras como docente invitado, y luego se incorpor como profesor asistente en el ITT Delhi.
El profesor Saha es receptor de la beca Humboldt y pas nueve meses en la University of
Stuttgart, Alemania, durante 1999-2000. Tambin ha sido profesor invitado de varias universidades en el extranjero, entre otras: McGill University en Canad, Monash University
en Australia y la University of Verona en Italia.
l est activamente involucrado en la docencia, investigacin y desarrollo de tecnologas
y estableci la seccin de Delhi del SAE-IIT en 1997, as como el Laboratorio de Mecatrnica del IIT Delhi en julio de 2001. Sus actividades de investigacin, consultora y capacitacin incluyen muchas empresas privadas como Asahi India, Sona Steering, Minda-Huf,
SAMTEL, Colour Rubes; as como del sector pblico entre las que se encuentran BHEL,
CEPC; adems de agencias gubernamentales como DST, MIT, CWDB; todas estas empresas
son una clara indicacin de la confianza que tiene la industria en el compromiso del profesor
Saha. A su favor tiene ms de 125 publicaciones de investigacin en revistas que gozan de
reputacin y en memorias de congresos.
Dos de sus intereses ms recientes son los siguientes: 1) popularizar el concepto de la
formacin en ingeniera por medio de la participacin en concursos de robtica. Por ejemplo, desde 2003, ha dirigido los equipos de estudiantes del IIT Delhi en su participacin
www.FreeLibros.me
Sobre el autor
xi
www.FreeLibros.me
Prefacio
La robtica es un tema que atrae a muchas mentes jvenes, lo cual se debe principalmente a
la abundante representacin de robots en muchas historias de ciencia ficcin y en pelculas
populares. A partir de los aos sesenta, los robots se han usado sobre todo en aplicaciones
industriales, particularmente en la industria automotriz para la soldadura de carroceras. Incluso, hoy da, los usuarios ms importantes de robots son los gigantes automovilsticos. Los
robots tambin encuentran aplicaciones cada vez mayores en la ciruga mdica, la industria
minera y la exploracin del espacio, y aun en instituciones que se preocupan del cuidado de
personas de la tercera edad.
Introduccin a la robtica tiene por objetivo la comprensin de los conceptos subyacentes en el diseo y construccin de un robot, y en su funcionamiento. En el mercado
existe un nmero de libros que normalmente tienen en cuenta a investigadores que trabajan
fundamentalmente en los aspectos de anlisis de robots, por ejemplo, cinemtica, dinmica,
control, etc., o a ingenieros en activo interesados en el estudio de viabilidad del uso de robots
para aplicaciones particulares, su adquisicin, programacin, economa, etc. En un plan
de estudios de licenciatura, es importante que los estudiantes conozcan tanto los aspectos de
anlisis como las aplicaciones. Por lo tanto, se percibi la necesidad de un libro que cubriera
ambos aspectos de manera lcida.
La inspiracin para escribir este tipo de libro, sin embargo, lleg hace casi una dcada
(abril de 1999), cuando el profesor Gayatri Kansal, de la Indira Gandhi National Open University (IGNOU), en Nueva Delhi, me pidi algunos materiales de instruccin sobre robtica
para sus estudiantes. Al mismo tiempo, no encontr ningn libro de texto sobre robtica disponible en la India a un precio accesible. Por lo tanto, sent el impulso de escribir uno que deba tener calidad internacional, pero con precio indio. Esto no slo ayudara a los estudiantes
www.FreeLibros.me
Prefacio
xiii
de la India a poseer un libro de robtica, sino tambin a los de otros de pases de condiciones
econmicas parecidas.
A pesar de que el libro se dirige bsicamente a estudiantes universitarios de las ingenieras mecnica y elctrica y a alumnos de ciencias de la computacin que se inscriben en un
curso de robtica, tambin puede servir a las necesidades de un curso de robtica de nivel
avanzado dirigido a estudiantes de maestra o doctorado que se enfoquen, por ejemplo, en
cinemtica, dinmica y control de robots. El material que ofrece este libro tambin pueden
utilizarlo ingenieros activos con o sin previa experiencia en el tema de la robtica, con el
propsito de adoptar, mantener o incluso disear un robot. De hecho, debido a los mltiples
ejemplos y ejercicios que ofrece el libro, cualquiera podr prepararse para un examen competitivo sobre robtica.
La intencin de este libro es la de servir tanto a los estudiantes de licenciatura como a
los de posgrado en sus cursos de robtica. La siguiente es una gua para los maestros que
atienden los siguientes niveles:
xiv
Prefacio
Flujo natural del contenido, es decir, los temas estn organizados de tal modo que
el estudiante pueda comprender el tema de manera lgica. Por ejemplo, cada vez que
escuchamos sobre alguna cosa nueva, tenemos curiosidad acerca de cmo se ve o
cmo funciona. Por ende, los aspectos de los diferentes robots y su clasificacin se
cubren en los captulos 1 y 2. Entonces despertar el inters de conocer los componentes de un robot. Por lo tanto, se explican los actuadores y sensores en los captulos
3 y 4. Despus de conocer la estructura del robot y sus componentes, es natural sentir
curiosidad sobre cmo se mueve un robot y cules son las fuerzas causantes. Aqu
se presenta la necesidad de transformacin, cinemtica, esttica y dinmica. Esto se
cubre en los captulos 5 a 9, respectivamente. A esto le siguen las leyes de control
en el captulo 10. Entonces el robot est listo para el uso prctico, y el usuario tiene
que decidir cmo moverlo para una tarea particular. La planeacin de movimiento
del captulo 11 es la que explica los movimientos del robot. Finalmente, se estudia el
hardware y software que accionan al robot, lo que se explica en el captulo 12.
Se ofrecen cuadros de texto para resaltar informacin histrica, contempornea y
de otros intereses que podrn ayudarle al lector a complementar sus conocimientos
tericos obtenidos en los contenidos de los captulos.
Ejercicios basados en la web y en MATLAB aparecen al final de cada captulo y
ayudan al estudiante a mantenerse al tanto de lo que est pasando en la robtica alrededor del mundo y a saber cmo implementar los conceptos matemticos para las
aplicaciones reales.
Prefacio
xv
xvi
Prefacio
partamento de Ingeniera Elctrica del IIT Delhi, por ofrecerse amablemente para la lectura
del captulo 10 sobre control y por darme sus comentarios oportunos al respecto. Agradezco
en especial a Suril V. Dhah, un alumno que actualmente est estudiando su doctorado y que
ley meticulosamente los captulos y me ayud a preparar las soluciones a los problemas
que se dan en los ejercicios de este libro. Me gustara dar las gracias a los muchos revisores
por sus valiosos comentarios que realmente han elevado la calidad de este libro.
Revisores de la India
A.K. Jha
Revisores internacionales
Gregory P. Starr
Harvey Lipkin
Mark Minor
Warren Dixon
Mis agradecimientos estaran incompletos si no menciono a Tata-McGraw Hill por estar de acuerdo con la publicacin de este libro, as como a sus ejecutivos, Vibha Mahajan,
Shukti Mukherjee, Surabhi Shukla, Sohini Mukherjee, Baldev Raj, Anjali Razdan y muchos
otros en el fondo, por su conviccin y ayuda. Sin ellos, el libro no se hubiera hecho realidad.
Finalmente, mi familia mi esposa Bulu y mi hija Esha ha estado esperando mucho
tiempo por ms atencin de mi parte, para pasar tiempo de familia conmigo. Les agradezco
su paciencia, comprensin, apoyo y cooperacin.
Estoy convencido de que los lectores encontrarn este libro verdaderamente valioso en su
calidad y lcida presentacin, de tal modo que podrn adquirir fcilmente los conocimientos
www.FreeLibros.me
Prefacio
xvii
requeridos. Sin embargo, tratndose de la primera edicin, podr contener algunos errores
y fallas tipogrficas involuntarias, y les ruego a los lectores que me las sealen en forma
directa (saha@mech.iitd.ac.in) o que escriban a la pgina web del libro cuya direccin se ha
mencionado anteriormente. Feliz lectura!
IIT Delhi
14 de febrero de 2008
www.FreeLibros.me
xviii
Apndice A
Lista de
abreviaturas
ABU
AC
ADC
AGV
BRA
CCD
CID
CNC
CP
CPL
CPU
CSG
D
DAC
DAE
DC
DeNOC
det.
DH
DOF
Lista de abreviaturas
DSP
EL
EMF
GIM
HaPRA
I
ISO
JIRA
JV
KE
LED
LSI
LVDT
MCI
MIMO
MOS
MTTF
MTTR
NASA
NC
NE
NO
NOC
ODE
P
PD
PE
PI
PID
PLC
PM
PO
PR
PSD
PTP
PUMA
RAM
RIA
RIDIM
RNE
RP
xix
xx
RPL
RUR
RVDT
SCARA
SBEU
SFED
SFEU
SISO
TF
WMR
VCI
VLSI
5P
Lista de abreviaturas
www.FreeLibros.me
Lista de
smbolos
g
C
q
q q
r
i
we
wi
wi w i
ai
Bij
b
bi, qi, ai, ai
C
c
ci
xxii
Lista de smbolos
ci
ci ci
di
ess
ei
fij
g
h
I
Ii
Ii
J
k
kp, kv, ki
L
M
M
Mi
Mi
Mw, Mi, Me
mi
m
m
N
Nd
Nl
Nu
n
ni
nij
p
p
pi
[p]F
www.FreeLibros.me
Lista de smbolos
Q
Qi
r
ri
s
T
T
Tl
Td
t
te
ti
ti
U
W
Wi
wi
w
wE, wC
E
w
i
x, y, z
1
O
0
[]T
xxiii
Matriz de rotacin de 3 3
Matriz de rotacin de 3 3 transformando el sistema i al sistema
i+1, es decir, cualquier representacin vectorial en el sistema i+1 se
premultiplica por esta matriz para encontrar la representacin en el
sistema i
Nmero de cuerpos rgidos o eslabones en el sistema
Vector tridimensional del origen Oi+1 desde el centro de masa Ci
Dimensin del espacio de trabajo (para planar, s = 3; para espacial,
s = 6)
Energa cintica
Matriz de transformacin homognea de 4 4
Matriz DeNOC triangular de 6n 6n del bloque inferior
Matriz DeNOC diagonal de bloque de 6n 6n
Vector 6n-dimensional de torsin generalizada
Vector de torsin 6-dimensional del efector final
Vector de torsin 6-dimensional de torsin asociado al i-simo cuerpo
Vector de rapidez de torsin 6-dimensional del i-simo cuerpo
Energa potencial
Matriz generalizada de 6 6 de las velocidades angulares
Matriz de velocidad angular de 6 6 para el i-simo cuerpo
Vector 6-dimensional de llave de torsin actuando sobre el i-simo
cuerpo compuesto
Vectores 6-dimensionales de llave de torsin generalizada
Vectores 6-dimensionales de llaves de torsin externas y de restriccin,
respectivamente
Vector 6-dimensional de llave de torsin externa para el i-simo cuerpo
compuesto
Vectores unitarios a lo largo de los ejes X, Y y Z, respectivamente.
Notaciones similares para otros vectores unitarios
Matriz identidad de dimensin compatible
Matriz de dimensin compatible en donde todos sus elementos son
ceros
Vector de dimensin compatible en donde todos sus elementos son ceros
Transpuesta del argumento []
www.FreeLibros.me
1
Introduccin
1.1
Historia
Aunque la idea de los robots se remonta a tiempos antiguos, hace ms de 3 000 aos en la leyenda hind de
los elefantes mecnicos (Fuller, 1999), la palabra robot
se us por primera vez en 1921, en la obra de teatro
Rossums Universal Robots (RUR), escrita por el checo Karel apek (1890-1938). En la obra RUR (Dorf,
1988), un fabricante cticio de criaturas mecnicas diseaba robots para reemplazar a trabajadores humanos.
Ecientes pero completamente faltos de emociones,
Origen de la palabra
robot
El origen de la palabra robot puede
ser encontrado en la palabra checa
robota, que signica trabajo forzado u obligatorio.
Introduccin
a)
b)
ii) Robots caminates Estos robots caminan como seres humanos, como se muestra en la gura 1.6. Se usan en los ejrcitos, en la exploracin subacutica y en lugares de
terreno accidentado.
iii) Robots paralelos
Como lo indica su nombre, estos robots tienen una conguracin paralela, en contraste con la estructura de tipo serial de un robot industrial como los
que se ven en las guras 1.1 y 1.3. En este sentido, un robot caminante con todas sus patas
en contacto con el suelo es un robot paralelo. Como se muestra en la gura 1.7, tambin se
usa una estructura paralela con seis patas para controlar la plataforma mvil como simulador de vuelo para la capacitacin de futuros aviadores. Como se ve en la misma gura, la
estructura tiene seis patas para controlar la plataforma mvil. Estos robots tambin se usan
b) Un AGV
www.FreeLibros.me
seguridad varan de un pas a otro y son esenciales para asegurar que toda instalacin cumpla
con la legislacin local. La seguridad se reere principalmente a mantener al personal fuera
del alcance de trabajo del robot y sirve para asegurar que los movimientos puedan detenerse
fcilmente en caso de una emergencia. Para este n, los robots tienen cadenas de seguridad
dual o cadenas de marcha integradas. stos son dos circuitos paralelos que detendrn el
movimiento del robot cuando sean interrumpidos. Tambin se prevn conexiones externas,
incluidos los paros de emergencia. Asimismo, cabe mencionar que casi todos los robots
tienen frenos de disco operados elctricamente en cada eje, y activados slo si se aplica la
energa para soltarlos. Por lo tanto, en caso de un corte del suministro elctrico o si el paro
de emergencia es aplicado, el robot se detiene en seco, en una fraccin de segundo, en su
posicin. No sufre un colapso y retiene sus datos posicionales y de programa.
RESUMEN
En este captulo se presentan los robots, su historia, deniciones, categoras, aplicaciones y poblaciones. Tambin se exponen las leyes de robtica y cundo deben usarse los
robots.
EJERCICIOS
1.1
1.2
1.3
1.4
1.5
1.6
1.7
1.8
1.9
1.10
Qu es un robot?
Cules son los tipos de robots?
Mencione algunas aplicaciones tpicas de un robot industrial.
Cules son las diferencias entre un robot y una mquina-herramienta CNC?
Cmo debe decidirse sobre el uso de un robot para un determinado trabajo?
Qu son las cuatro D de la robtica?
Qu es R.U.R.?
Cules son las leyes de la robtica?
Anote las diferencias entre robots seriales y paralelos.
Cules son los problemas de seguridad en el uso de robots?
3.4
Seleccin de motores
Para cualquier aplicacin de robots tiene que decidirse cul de los actuadores disponibles
es el ms adecuado. Tiene que tomarse en consideracin precisin de posicionamiento,
conabilidad, velocidad de operacin y costo, as como otros factores.
Los motores elctricos son por naturaleza limpios y con capacidad para trabajar con
alta precisin si son operados correctamente. En contraste, los sistemas neumticos no son
capaces de operar una trayectoria continua de alta precisin, y los actuadores hidrulicos requieren del uso de aceite a presin. Los sistemas hidrulicos pueden generar mayor potencia
en un volumen compacto que en los motores elctricos. El aceite a presin puede conducirse por tuberas hacia actuadores sencillos, capaces de generar pares de torsin con altos
valores y operaciones rpidas. Tambin hay que tomar en cuenta que la potencia necesaria
para controlar una vlvula electrohidrulica es pequea. Bsicamente, este trabajo se realiza
mediante la compresin del aceite y suministrarlo a los accionamientos del brazo del robot.
Toda la energa puede ser suministrada por un solo motor elctrico poderoso y eciente que
acciona la bomba hidrulica que est en la base del robot o ubicada en alguna distancia. La
potencia es controlada en vlvulas electrohidrulicas compactas. Sin embargo, las vlvulas
electrohidrulicas de alta precisin son ms costosas y menos conables que los amplicadores y controladores elctricos de baja potencia. Por otra parte, los motores elctricos
deben tener controles individuales capaces de controlar su potencia. En robots de mayores
dimensiones, esto requiere la conmutacin de 10 a 50 amperios con 20 a 100 voltios. La
conmutacin de la corriente tiene que ser rpida; de lo contrario, habr una gran disipacin
de potencia en el circuito de conmutacin que causar un exceso de calor. Los motores
elctricos pequeos usan circuitos de conmutacin sencillos y son fciles de controlar por
medio de los circuitos de baja potencia. Los motores a pasos son particularmente sencillos
para la operacin de un lazo abierto. La ventaja ms grande de un sistema hidrulico es la
seguridad de su operacin.
Como regla general, se preeren actuadores hidrulicos donde se requieren movimientos
rpidos con altos pares de torsin, en rangos de potencia que estn aproximadamente en
el orden de los 3.5 kW, a menos que no pueda tolerarse la ligera posibilidad de una fuga de
aceite. Los motores elctricos son preferidos para niveles de potencia que estn por debajo
de a 1.5 kW aproximadamente, a menos que haya un peligro debido al posible incendio de
materiales explosivos. En rangos entre 1-5 kW, podr determinar la decisin la disponibilidad de un robot en un sistema de coordenadas particular con caractersticas especcas o por
un costo ms bajo. La conabilidad de todo tipo de robots manufacturados por fabricantes
reconocidos industrialmente es sucientemente buena. No obstante esto no es el factor ms
determinante.
3.4.1
Clculos
Se necesitan clculos matemticos simples para determinar el par torsor, velocidad y caractersticas de potencia de un actuador o motor para diferentes aplicaciones. El par torsor se
dene en trminos de una fuerza multiplicada por distancia o momento. Una fuerza f, a la
distancia a del centro de rotacin, tiene un momento o par torsor t, o sea t = fa. En trminos
www.FreeLibros.me
th21=atan2(s21,c21); th22=atan2(s22,c22);
th23=pi-th21; th24=pi-th22;
%Angles in degree
r2d=180/pi;
th11d=th11*r2d, th12d=th12*r2d, th21d=th21*r2d, th22d=th22*r2d, th23d =
th23*r2d,
th24d = th24*r2d, th31d=th31*r2d, th32d=th32*r2d
6.2.3
Una mueca
Considere la mueca de la figura 6.9, cuyas relaciones cinemticas pueden darse mediante
la ecuacin (6.12). Se buscan las variables de las articulaciones 1, 2 y 3, correspondientes
a una orientacin del efector final Q con la siguiente forma:
LM
MM
N
q11
Q q21
q31
q12
q13
q 22
q23
q32
q33
OP
PP
Q
donde qij para i, j = 1, 3 son los elementos de la matriz de bloque Q de la matriz de transformacin homognea T, ecuacin (6.12). Entonces es posible computar las soluciones de
los ngulos de las articulaciones directamente como
q1 = a tan 2 (q23, q13)
q2 = a tan 2
FH
2
2
, q33
q13
+ q23
(6.30a)
IK
(6.30b)
(6.30c)
para 2 entre 0 y . Observe que si se permite que cada articulacin gire 360, existen dos
posibles soluciones para los ltimos tres desplazamientos de las articulaciones. En efecto,
ya que las ecuaciones (6.30a-c) involucran la funcin de arcotangente, el ngulo 1 podr
tener dos valores que se encuentran a 180. Las dos configuraciones que corresponden a las
dos soluciones se ilustran en la figura 6.9.
Z1
#3
#3
Z3, Z4
X3, X4
#2
#2
Z2
X1, X2
#1
Solucin i(1)
Figura 6.9
#1
Solucin i(2)
Tq =
LMCq
MM Sq
MN 00
i
i
- Sq i
Cq i
0
0
0
0
1
0
OP
PP
PQ
0
0
0
1
(5.49b)
La resultante transformacin de coordenadas entre los sistemas conectados con los cuerpos i 1 e i, es decir, Ti, se obtiene ahora mediante la posmultiplicacin de las cuatro transformaciones elementales de arriba, como se hace en la ecuacin (5.31d), es decir,
Ti = Tb Tq Ta Ta
(5.50a)
La expresin Ti tambin puede leerse como matriz de transformacin del sistema adjuntado al cuerpo i, es decir, sistema i + 1, como se representa en el sistema incorporado al
cuerpo i 1, es decir, sistema i. Por medio de sustitucin de las expresiones de matriz de las
ecuaciones (5.49 a-d) a la ecuacin (5.50a), se obtiene la siguiente expresin:
Ti =
Ejemplo 5.24
LMCq
MM Sq
MN 00
i
i
- Sq i Ca i
Cq i Ca i
Sa i
0
Sq i Sa i
- Cq i Sa i
Ca i
0
ai Cq i
a i Sq i
bi
1
OP
PP
PQ
(5.50b)
Para obtener la ecuacin (5.50b), las operaciones simblicas tienen que ejecutarse en
MATLAB. Para este fin, se usan los siguientes comandos:
>syms bi thi ai ali;
>tbm=[1,0,0,0;0,1,0,0;0,0,1,bi;0,0,0,1];
>tthm=[cos(thi),-sin(thi),0,0;sin(thi),cos(thi),0,0;0,0,1,0;0,0,0,1];
>tam=[1,0,0,ai;0,1,0,0;0,0,1,0;0,0,0,1];
>talm=[1,0,0,0;0,cos(ali),-sin(ali),0; 0,sin(ali),cos(ali),0; 0,0,0,1];
>tim=tbm*tthm*tam*talm
tim =
[
cos(thi), -sin(thi)*cos(ali),
sin(thi)*sin(ali),
cos(thi)*ai]
[
sin(thi), cos(thi)*cos(ali), -cos(thi)*sin(ali),
sin(thi)*ai]
[
0,
sin(ali),
cos(ali),
bi]
[
0,
0,
0,
1]
donde el comando syms se usa para definir las variables simblicas bi, thi,
ai y ali para los parmetros DH bi, qi, ai y ai, respectivamente. Adems, se usan
las notaciones tbm, tthm, tam y talm para representar las matrices Tb, Tq, Ta
y Ta, dadas por las ecuaciones (5.49a-d), respectivamente. Finalmente, la resultante
matriz Ti denotada como tim en el ambiente de MATLAB, se evala arriba, lo que
coincide con la ecuacin (5.50b).
www.FreeLibros.me
RESUMEN
En este captulo se derivan los pares de torsin que se requieren para ejercer una fuerza y
un momento por el efector final mientras el robot est en equilibrio esttico. Se demuestra
cmo el jacobiano de velocidad entra en consideracin en el anlisis esttico. Finalmente,
se da una interpretacin fsica de la matriz Jacobiana en el dominio de la fuerza.
EJERCICIOS
7.1
7.2
7.3
7.4
El software de desarrollo
propio no slo permite que el
lector obtenga resultados para
problemas complejos, sino
tambin ofrece la posibilidad
de escribir nuevos programas
basados en los ya existentes.
SIGUIENTE
CANCELAR
Figura 9.5
2.
3.
4.
5.
Puede manejar manipuladores con pares o articulaciones tanto rotacionales o revolutas como prismticas:
Toma en cuenta la gravedad, pues considera la aceleracin negativa debido a la gravedad denotada por g al primer cuerpo #1, como se muestra en la ecuacin (9.32).
Ejemplo 9.3
En la figura 9.6 se presenta el manipulador de tres eslabones en estudio, cuyos parmetros DH e inerciales se muestran en la tabla 9.2. Se supone que el manipulador se mueve
en el plano X-Y, donde la gravedad est trabajando en la direccin negativa Y. Suponga
que i y j son los dos vectores unitarios paralelos a los ejes X y Y, respectivamente,
www.FreeLibros.me
Tabla A.1
Atan2(y, x)
+ve
0
ve
Atan(z)
Sgn(y) p/2
Atan(z) + Sgn(y)U
la tabla Atan2(1, 1) = p/4 y Atan2(1, 1) = 3p/4, mientras que Atan(1) devuelve p/4 en
ambos casos.
A.2
Vectores
Mientras no se seale algo diferente, los vectores sern definidos como vectores de columna y denotados con letras minsculas en negrillas. Por ende, un vector a n-dimensional se
define como
LM a OP
MM PP
Na Q
1
(A.2)
donde a1, , an son los elementos del vector a. El vector a tambin puede representarse
como
(A.3)
a [a1, , an]T
donde el superndice T denota transposicin. La magnitud, longitud o norma del vector a,
denotada con letras itlicas, se determina por
a=
A.2.1
aTa =
a12 + + an2
(A.4)
Vectores unitarios
Un vector unitario se define como un vector con magnitud igual a 1. Por tanto, el vector
unitario a lo largo del vector a, denotado con a, puede definirse como
a
(A.5)
a =
a
donde a se determina por la ecuacin (A.4). Por ende, la magnitud del vector unitario a es
a = 1. Ahora, si i, j y k denotan los vectores unitarios a lo largo de los ejes X, Y y Z, respectivamente, del sistema de coordenadas como se presenta en la figura A.1, cualquier vector
cartesiano tridimensional que se muestra en la figura A.1, por decir, a } [a1, a2, a3]T, puede
expresarse como
a = a1 i + a2 j + a3 k
(A.6)
en la que los vectores unitarios i, j y k tienen las siguientes representaciones:
LM OP
MM PP
NQ
LM OP
MM PP
NQ
LM OP
MM PP
NQ
1
0
0
i 0 ,j 1 ,y k 0
0
0
1
(A.7)
Figura C.3
mecanismo de un paralelogramo de cuatro barras para el robot manual de la figura C.3. Este
ltimo puede extenderse casi medio metro enfrente del robot para poder colocar el bloque
dentro de la lnea de lmite del polgono de 10 lados. Una vez terminado el diseo, el siguiente
nivel de desafo es su fabricacin, ensamble, programacin y funcionamiento exitoso.
Segn la experiencia del autor, normalmente debern revisarse los siguientes aspectos
para completar este tipo de proyecto con xito:
1. Una planeacin correcta, tomando en cuenta las 5 P (Proper Planning Prevents Poor
Performance la planeacin correcta impide el desempeo defectuoso).
2. Cada estudiante debe llevar una bitcora de proyecto para registrar actividades diarias, esbozos, informaciones, etc.
3. Seguimiento estricto de un diagrama de Gantt bien planeado. Un tpico diagrama
Gantt se presenta en la figura C.4. En caso de que no pueda cumplirse con las fechas
lmite, debern averiguarse las causas y deben tomarse medidas sin redefinicin del
diagrama de Gantt. De hecho, el calendario actual podr colocarse debajo del calendario planeado.
4. Es de extrema importancia que los estudiantes aprendan cmo trabajar en grupo. En
particular, los coordinadores de diferentes tareas, por ejemplo, mecnico, elctrico,
fabricacin, etc., debern saber cmo distribuir el trabajo entre otros miembros de
sus grupos. De lo contrario, ellos terminarn haciendo la mayor parte de los trabajos
mientras que otros no tendrn trabajo. Este ltimo grupo podr frustrarse e incluso
abandonar el proyecto.
www.FreeLibros.me
Captulo
1
Introduccin
1.1
Historia
Aunque la idea de los robots se remonta a tiempos antiguos, hace ms de 3 000 aos en la leyenda hind de
los elefantes mecnicos (Fuller, 1999), la palabra robot
se us por primera vez en 1921, en la obra de teatro
Rossums Universal Robots (RUR), escrita por el checo Karel apek (1890-1938). En la obra RUR (Dorf,
1988), un fabricante ficticio de criaturas mecnicas diseaba robots para reemplazar a trabajadores humanos.
Eficientes pero completamente faltos de emociones,
www.FreeLibros.me
Origen de la palabra
robot
El origen de la palabra robot puede
ser encontrado en la palabra checa
robota, que signica trabajo forzado u obligatorio.
CAPTULO
Introduccin
se pensaba al principio que estos robots eran mejores que las personas, puesto que hacan lo
que se les ordenaba sin preguntar. Al final, los robots se volvieron contra sus amos. Acabaron
con la raza humana, salvo un solo hombre para que pudiera seguir produciendo ms robots.
Desgraciadamente, la frmula se haba perdido en la destruccin causada por los robots.
Este sentimiento de odio hacia los robots parece existir hasta hoy. El miedo de que vayan
a apoderarse del trabajo de las personas ha dado como resultado el retraso en el desarrollo en
esta rea. Sin embargo, Isaac Asimov, en sus historias de ciencia ficcin de los aos cuarenta,
se imaginaba al robot como ayudante de la humanidad y postulaba tres reglas bsicas para
robots. Por lo general, stas se conocen como las leyes de la robtica.
1.1
Historia
Movimiento
Movimiento
radial
Cabeceo
(Pitch)
Movimiento
vertical
Rotacin
(Yaw)
Balanceo
(Roll)
b) Bosquejo de un robot Unimate [Cortesa de Critchlow (1985)]
Figura 1.1
Robot Unimate
www.FreeLibros.me
CAPTULO
Introduccin
inspeccin, agricultura, enfermera, ciruga mdica, usos militares y seguridad hasta las
exploraciones subacuticas y del espacio. La mayora de estos robots se siguen usando en
la soldadura (aprox. 25%) y en el montaje (aprox. 33%). Los ltimos en la serie son el Pathfinder Lander y el microrover Sojourner, que aterriz en Marte el 4 de julio de 1997. stos
fueron desarrollados por la National Aeronautic Society of America (NASA) de Estados
Unidos. Las figuras 1.2 a) y b), respectivamente, muestran el Mars Pathfinder Lander y el
microrover Sojourner.
b) Microrover Sojourner
Figura 1.2
www.FreeLibros.me
1.2
1.2
Robots
Robots
El robot se define, de manera formal en la Organizacin Internacional para la Estandarizacin (ISO), como un manipulador multifuncional reprogramable, capaz de mover materiales, piezas, herramientas o dispositivos especiales, a
travs de movimientos variables programados, para
Mquinas-herramienta
el desempeo de tareas diversas. Existen otras definicon control numrico
ciones dadas por otras asociaciones, como por ejemcomputarizado (CNC)
plo, el Robotics Institute of America (RIA), la Japan
vs. Robots
Industrial Robot Association (JIRA), la British Robot
Las mquinas-herramienta con conAssociation (BRA) y otras. Todas ellas coinciden en
trol numrico computarizado (CNC)
se distinguen de los robots porque
dos puntos: la capacidad de reprogramacin y la mulstos tienen capacidades de reprotifuncionalidad de los robots.
gramacin y multifuncionalidad.
En trminos generales, los robots son clasificados
como industriales, no industriales o para usos especiales. Un tpico robot industrial fabricado por la compaa Cincinnati Milacron de Estados
Unidos se muestra en la figura 1.3a) y un robot indio apropiado para aplicaciones industriaExtensin
del codo
Pivote
del hombro
Rotacin
Balanceo
Movimiento
del brazo
Cabeceo
www.FreeLibros.me
CAPTULO
Introduccin
Robots industriales
les ligeras se puede ver en la figura 1.3b). Estrictamente hablando, un robot es un manipulador controlado por una computadora. En el estudio de la robtica, sin embargo, siempre se
supone que un manipulador como el que se muestra en la figura 1.3 es controlado por computadora. Por lo tanto, puede ser considerado un robot. El objetivo de los robots industriales es
el de servir a un propsito universal y de mano de obra no calificada o semicalificada, por
ejemplo, para soldar, pintar, realizar mecanizados, etc. Por otro lado, un robot de uso especial
es el que se emplea en ambientes distintos del entorno normal de una fbrica. Por ejemplo, un
robot de serie montado sobre una nave espacial para la recuperacin de un satlite defectuoso
o para volver a colocarlo despus de la reparacin puede ser considerado un robot de uso
especial. El rover Sojourner de la figura 1.2b) tambin puede calificarse como robot de uso
especializado. Otros robots de uso especial se clasifican como sigue:
Es AGV lo mismo
que WMR?
www.FreeLibros.me
1.2
a)
Figura 1.4
Robots
b)
Estos robots caminan como seres humanos, como se muestra en la figura 1.6. Se usan en los ejrcitos, en la exploracin subacutica y en lugares de
terreno accidentado.
iii) Robots paralelos Como lo indica su nombre, estos robots tienen una configuracin paralela, en contraste con la estructura de tipo serial de un robot industrial como los
que se ven en las figuras 1.1 y 1.3. En este sentido, un robot caminante con todas sus patas
en contacto con el suelo es un robot paralelo. Como se muestra en la figura 1.7, tambin se
usa una estructura paralela con seis patas para controlar la plataforma mvil como simulador de vuelo para la capacitacin de futuros aviadores. Como se ve en la misma figura, la
estructura tiene seis patas para controlar la plataforma mvil. Estos robots tambin se usan
b) Un AGV
www.FreeLibros.me
CAPTULO
Figura 1.6
Introduccin
como mquina-herramientas y como robots mdicos para reducir el temblor de la mano del
cirujano durante una operacin, etc. La figura 1.8 muestra el uso de un robot paralelo de una
mquina fresadora.
En este libro slo se analizarn los robots industriales de tipo serial, como los que se ven
en las figuras 1.1 y 1.3. Sin embargo, las herramientas usadas o desarrolladas aqu pueden
extenderse para analizar otros robots, como AGV, paralelos y similares.
1.3
El uso de robots
Los robots de cualquier tipo, industrial o no industrial, no son tan rpidos ni tan eficientes
como las mquinas automatizadas de uso especial. Sin embargo, estos robots pueden fcilmente reentrenarse o reprogramarse para realizar un sinfn de tareas, mientras que una
mquina automatizada de uso o propsito especial, incluso una mquina CNC, slo puede
Figura 1.7
www.FreeLibros.me
1.3
Figura 1.8
El uso de robots
realizar una serie de labores muy limitada. Es el grado de reprogramabilidad lo que distingue un robot de una mquina-herramienta de CNC. Sin embargo, no hay ninguna lnea de
demarcacin internacionalmente reconocida. Queda la pregunta, pues, sobre cundo debe
considerarse que un determinado trabajo ha de ser ejecutado por una persona, un robot o
una mquina especial. La respuesta a esta pregunta no es sencilla. Algunas normas generales
pueden servir para proponer factores significativos que deben tenerse presentes.
10
CAPTULO
Introduccin
As, como punto de partida general, consideraremos lo siguiente: una tarea que tiene que
realizarse una sola vez o unas cuantas veces y que no es peligrosa es mejor que la efecte
un ser humano. Despus de todo, l es la ms flexible de todas las mquinas. En cambio,
ser mejor que una tarea que tenga que ser hecha cientos o cientos de miles de veces sea
ejecutada por una mquina automatizada flexible, como un robot industrial. Y una tarea que
debe realizarse un milln de veces o ms, probablemente sea mejor que se efecte mediante
la construccin de una mquina altamente automatizada de uso especial.
1.3.1
Aplicaciones
En todo el mundo, los robots se usan ms extensiva y ampliamente en la industria automotriz. En los ltimos tiempos, sin embargo, adems de este sector, una fuerte demanda de la
industria de componentes electrnicos, de la industria de equipos de comunicacin y de la
de computadoras estn reforzando el incremento de la participacin en el mercado. La figura
1.9 muestra la distribucin estimada de aplicaciones de robots en diferentes sectores en los
aos 2004 y 2005.
1.3.2
Poblacin
La figura 1.10 muestra la poblacin estimada de robots industriales en diferentes continentes, mientras que la tabla 1.1 presenta la distribucin de robots por pases y los pronsticos
para el futuro. Las aplicaciones de otros robots pueden verse en la figura 1.11.
1.3.3
Economa
Los robots industriales son cada vez ms y ms econmicos, lo que se refleja en los precios
para robots industriales usados. Tome en cuenta que un ABB IRB 6000, que est valorado
en aproximadamente 7 000 dlares costaba ms de 157 515 dlares cuando era nuevo, en
1993. Un robot equivalente nuevo costar entre 52 505 dlares y 105 dlares, dependiendo
Vehculos automotores
Partes automotrices
Industrias elctricas
Industrias qumicas
Productos metlicos
2004 2005
Maquinaria
Productos alimenticios
Comunicacin
Productos de precisin
y pticos
Figura 1.9
5 000
10 000
15 000
20 000
Unidades
25 000
30 000
www.FreeLibros.me
1.3
El uso de robots
11
80 000
70 000
Unidades
60 000
50 000
40 000
30 000
20 000
10 000
0
1996
1997
1998
1999
2000
Asia/Australia
Figura 1.10
2005
1.3.4
2004
Constituyen los
robots una amenaza
para el empleo?
Las estadsticas muestran que los
usuarios ms grandes del mundo no
son los que tienen la tasa ms alta de
desempleo. Por ende, puede considerarse que los robots no son una amenaza directa al empleo.
Seguridad
Nmero de unidades
Los robots industriales pueden ser peligrosos. Son dispositivos extraordinariamente potentes, especialmente
aquellos modelos que tienen gran capacidad y alcance. Esto significa que la seguridad es de
suma importancia, tanto en la instalacin como durante la produccin. Los reglamentos de
12 000
10 000
8 000
6 000
4 000
2 000
Su
ba
cu
t
ic
o
Li
m
D
pi
ef
ez
en
a
sa
,r
e
se s
gu ca
Co rida te,
d
n
de stru
m cc
ol i
ic n/
i
n
Ca
m
Pl
po
ro ata
bo fo
r
ts m
m as
v d
ile e
M s
ed
ic
in
a
Lo
g
To
sti
do
ca
sl
os
de
m
s
Figura 1.11
www.FreeLibros.me
12
CAPTULO
Introduccin
Instalaciones anuales
Pas
Amrica
Brasil
Norteamrica
(Canad, Mxico, USA)
Resto de Amrica
Asia/Australia
China
India
Indonesia
Japn
Malasia
Filipinas
Repblica de Corea
(todos los tipos
industriales)
Singapur
Taiwn provincia de
China
Tailandia
Vietnam
Resto de Asia
Australia
Nueva Zelanda
Europa
Austria
Benelux
Dinamarca
Finlandia
Francia
Alemania
Italia
Noruega
Portugal
Espaa
Suecia
Suiza
Turqua
Reino Unido
Pases de Europa
Central/Oriental
Resto de Europa
frica
Total
2004
2005
2006
2009
15 400
208
15 170
21 555
320
21 136
17 200
20 100
22
52 311
3 493
369
74
37 086
250
65
5 457
99
76 047
4 461
450
193
50 501
243
80
13 005
244
424
5 443
5 463
3 680
757
14
170
4 096
1 458
99
124
11 881
1 014
14
3 505
15 464
2 472
113
3 349
652
29 409
545
536
296
401
3 009
13 401
5 679
61
211
2 826
833
310
24
785
419
913
28 863
485
1 097
354
556
3 275
10 506
5 425
115
144
2 649
939
442
207
1 363
1 149
73
157
87
204
97 207 126 669
2006
2009
182 500
16 500
65 000
76 000
40 000
46 000
28 200
3 000
10 700
5 100
800
220
110 60
2004
2005
946
978
443 193 481 664 502 000
7 096
11 557
619
1 069
121
314
356 483 373 481 372 000
1 452
1 695
93
173
51 302
61 576
4 170
4 938
279 019 297 374 307 700
3 907
4 148
8 749
9 362
2 342
2 661
3 712
4 159
3 700
28 133
30 434
32 200
13 000 120 544 126 725 132 300
6 200
53 244
56 198
58 900
724
811
1 488
1 542
21 893
24 081
7 341
8 028
3 539
3 732
196
403
1 200
14 176
14 948
14 700
8 372
9 337
33 800
250
130 150
176 000
583 000
388 500
345 400
37 900
142 700
66 400
14 300
659
805
430
634
900
1 600
849 603 922 875 964 100 1 112 500
www.FreeLibros.me
13
seguridad varan de un pas a otro y son esenciales para asegurar que toda instalacin cumpla
con la legislacin local. La seguridad se refiere principalmente a mantener al personal fuera
del alcance de trabajo del robot y sirve para asegurar que los movimientos puedan detenerse
fcilmente en caso de una emergencia. Para este fin, los robots tienen cadenas de seguridad
dual o cadenas de marcha integradas. stos son dos circuitos paralelos que detendrn el
movimiento del robot cuando sean interrumpidos. Tambin se prevn conexiones externas,
incluidos los paros de emergencia. Asimismo, cabe mencionar que casi todos los robots
tienen frenos de disco operados elctricamente en cada eje, y activados slo si se aplica la
energa para soltarlos. Por lo tanto, en caso de un corte del suministro elctrico o si el paro
de emergencia es aplicado, el robot se detiene en seco, en una fraccin de segundo, en su
posicin. No sufre un colapso y retiene sus datos posicionales y de programa.
RESUMEN
En este captulo se presentan los robots, su historia, definiciones, categoras, aplicaciones y poblaciones. Tambin se exponen las leyes de robtica y cundo deben usarse los
robots.
EJERCICIOS
1.1
1.2
1.3
1.4
1.5
1.6
1.7
1.8
1.9
1.10
Qu es un robot?
Cules son los tipos de robots?
Mencione algunas aplicaciones tpicas de un robot industrial.
Cules son las diferencias entre un robot y una mquina-herramienta CNC?
Cmo debe decidirse sobre el uso de un robot para un determinado trabajo?
Qu son las cuatro D de la robtica?
Qu es R.U.R.?
Cules son las leyes de la robtica?
Anote las diferencias entre robots seriales y paralelos.
Cules son los problemas de seguridad en el uso de robots?
Captulo
2
Robots seriales
Normalmente, un robot industrial es serial por naturaleza, tal como se muestra en las figuras
1.1 y 1.3, por lo que a stos se les conoce como robots seriales. Cualquier robot, serial o de
otro tipo, consiste en varios subsistemas, por ejemplo, subsistema de movimiento, subsistema de reconocimiento, etc. stos se explican en la seccin 2.1. Las especificaciones de uno
de estos robots seriales, el Cincinnati Milacron de la figura 1.3, se muestra en la tabla 2.1. Segn sta, la aplicacin del robot (fila 2 de la tabla) es para el manejo de materiales; es decir, el
robot es el ms apropiado para este propsito. Por lo tanto, este robot puede clasificarse como
un robot de manejo de materiales. Ahora considere el espacio de operacin del brazo (filas
6-9 de la tabla). Donde se muestran el alcance y la ubicacin en la que el brazo puede moverse, lo que define una forma geomtrica, esto quiere
decir que otra manera de clasificar especificaciones de
Volumen de trabajo o
un
robot se basa en su volumen geomtrico de trabajo,
espacio de trabajo?
o bien en la configuracin del brazo o en su sistema de
Estos trminos signican lo mismo:
coordenadas. De manera similar, existen otros tipos de
los puntos ms lejanos que puede alclasificacin, basadas en los diferentes aspectos de un
canzar el efector nal de un robot.
robot, lo que se explica en la seccin 2.2.
2.1
Subsistemas de robots
Como se ilustra en la figura 2.1, un sistema robtico consiste por lo general en tres subsistemas: subsistema de movimiento, subsistema de reconocimiento y subsistema de control.
Sus funciones se describen a continuacin.
www.FreeLibros.me
240
90
120
Eje 1
Eje 2
Eje 3
635 mm/s
635 mm/s
635 mm/s
Velocidad
Eje 4
Eje 5
Eje 6
Mueca
Repetibilidad:
Precisin:
N/D
2.00 mm
180
270
www.FreeLibros.me
Nmero de programa:
Sensores:
Tipo de memoria:
Tamao de memoria estndar:
Sistema de control
CIP 3200
Minicomputadora
RAM
64 K mx.
1 750 puntos
N/D
disponibles
Canal de control:
Mtodo de teach-in
Modo de operacin:
Lenguaje utilizado
para el programa del controlador:
Diagnstico:
casete
Caja de teach-in
punto a punto
635 mm/s
635 mm/s
Velocidad
Estados Unidos
Manejo de materiales
Espacio operativo
Pas de origen:
Aplicaciones principales:
Sistema de potencia: elctrico, 380 V 50 Hz, 27 kVA, pistn hidrulico lineal ms cinco pistones rotativos, 155 bar
Alcance horizontal mximo: 2 590 mm; posicin de montaje: piso
Espacio operativo
Polar
204 kg
Configuracin (cinemtica):
Capacidad de carga mxima:
Brazo
Cincinnati Milacron
T3-595
Fabricante
Modelo
Tabla 2.1 Una especicacin de robot tpica (Fig. 1.1) [Cortesa de: Cugy y Page (1984)]
2.1
Subsistemas de robots
15
16
CAPTULO
Robots seriales
Subsistema de reconocimiento
Subsistema de movimiento
Computadora
Ambiente
del objeto
Figura 2.1
Subsistema de control
Eslabn 2
Articulacin 2
Eslabn 1
Articulacin 3
Articulacin 1
Eslabn 3
Eslabn 0
(Base)
Brazo
Codo
Eslabn 4
Articulacin 4
Articulacin 5
Mueca
Mano
Eslabn 5
Eslabn 6
Articulacin 6
a) Robot PUMA
Figura 2.2
Dedo
b) Partes equivalentes
en el cuerpo humano
www.FreeLibros.me
2.1
Subsistemas de robots
17
2.1.1
El subsistema de movimiento
Robot o
manipulador?
i) Manipulador
Se trata de la estructura fsica, la parte que se est moviendo. sta incluye eslabones (tambin llamados cuerpos) y articulaciones
(que tambin se denominan pares cinemticos), normalmente conectadas en serie, como es el caso de los
robots que se muestran en las figuras 1.1 y 1.3, y del
robot PUMA de la figura 2.2a). Los eslabones estn hechos de acero o de aluminio. Tambin pueden usarse otros materiales, dependiendo de los requerimientos. Las articulaciones
son por lo general del tipo rotatorio o de traslacin. En el estudio de la robtica y de
los mecanismos, a estas articulaciones se les conoce respectivamente como revolutas y
prismticas, tal como se muestra en las figuras 5.1 y 5.2 del captulo 5. Un ejemplo de una
articulacin revoluta es la bisagra de una puerta; una articulacin prismtica es el arreglo
pistn/cilindro del motor de combustin interna que se utiliza en automviles.
A semejanza del conjunto que forman el brazo, la mueca y la mano del ser humano, tal
como se muestra en la figura 2.2b), el manipulador del
robot tambin tiene tres partes. Las primeras dos, el
brazo y la mueca, pueden verse en las figuras 2.2a)
Qu es PUMA?
y b), respectivamente, mientras que la tercera parte, la
mano, se muestra en la figura 2.3a) y b). La funcin de
PUMA signica Programmable Uniun brazo es la de colocar un objeto en una determinaversal Manipulator for Assembly
(Manipulador universal programada ubicacin en el espacio cartesiano tridimensional,
ble para el ensamble).
donde es orientado por la mueca. Para un robot tpico
En este libro, ambas palabras se usan
muchas veces en forma indistinta.
Sin embargo, como se explica en este
captulo, el manipulador es la estructura mecnica del robot.
www.FreeLibros.me
18
CAPTULO
Robots seriales
de seis grados de libertad, como se muestra en las figuras 1.1 y 1.3 o 2.2a), los primeros tres
eslabones y articulaciones forman el brazo y las ltimas tres articulaciones de interseccin
mutua conforman la mueca.
sta es la parte instalada en el extremo del manipulador. Es equivalente a la mano humana. Un efector final podra ser una mano mecnica que manipula un
objeto o que lo sostiene antes de que sea movido por el brazo del robot. En las figuras 2.3a) y
b) se muestran dos manos tpicas. La figura 2.3a) presenta un sujetador sencillo de dos dedos
para sujetar objetos sencillos, mientras que una mano
de dedos mltiples, como la de la figura 2.3b), puede
ejecutar tareas ms complejas. Otros sujetadores ms
Efector nal o mano?
sencillos operados en forma neumtica pueden verse
en la figura 2.4. Tambin se consideran como efectores
Una mano mecnica (gura 2.3) es
un tipo de efector nal que se usa en
finales algunas herramientas especializadas, como un
robots. Efector nal es un trmino
electrodo de soldadura, un soplete oxiacetilnico, una
mucho ms genrico para lo que se
brocha de pintura o una muela abrasiva montada en el
encuentre montado en el extremo
extremo de un brazo manipulador para la ejecucin de
de un manipulador de robot. Otros
ejemplos de efectores nales son una
tareas especficas.
pistola para soldar, una brocha para
pintar, etctera.
Figura 2.3
Manos de robot
www.FreeLibros.me
Figura 2.4
www.FreeLibros.me
c)
b)
d)
Sujetadores de accionamiento neumtico: a) Mordaza angular; b) Mordaza paralela; c) Mordaza paralela con dos
cilindros; d) Mordaza paralela con disco de leva
[Cortesa: Robot grippers por Gareth J. Monkman, Stefan Hesse, Ralf Steinmann, Henrik Schunk, Wiley, 2007;
http://media.wiley.com/product_data/excerpt/90/35274061/3527406190.pdf]
a)
2.1
Subsistemas de robots
19
20
CAPTULO
Robots seriales
Figura 2.5
b) Cadena de rodillos
engranajes, etc., es llamado actuador. Sin embargo, un sistema neumtico o hidrulico que
proporciona movimientos para los eslabones del robot, con o sin elementos de transmisin,
se llamar actuador y no motor.
iv) Transmisin Como lo sugiere el trmino, estos elementos transmiten el movimiento de motores y de actuadores a los eslabones del manipulador. En el caso de motores
elctricos, estos elementos, junto con el motor elctrico, forman un actuador. Los siguientes
son elementos de transmisin tpicos:
b) Engranajes Entre todas las transmisiones mecnicas, los diferentes tipos de engranajes, como se muestra en la figura 2.6, son los ms confiables y duraderos, aunque el juego
entre los dientes tendr que tomarse en cuenta cuidadosamente durante la fase de diseo.
Engranajes
de dientes rectos
Engranaje cnico
de dientes curvos
Engranajes
helicoidales
Engranaje de tornillo
tangente
Figura 2.6
Engranajes
www.FreeLibros.me
Engranaje cnico
recto
Engranaje de pin
y cremallera
2.1
Subsistemas de robots
21
c) Mecanismos de eslabones A fin de reducir el peso y exceso de flexibilidad de los elementos de transmisin arriba mencionados, se emplean
los mecanismos de eslabones de la figura 2.7a).
La figura 2.7b) muestra cmo se utiliza un gato de
husillo con un arreglo de cuatro barras para transmitir
movimientos.
2.1.2
Qu es un
mecanismo?
Una serie de eslabones, por lo general
rgidos, acoplados por articulaciones
que permiten movimientos relativos
entre cualquiera de dos eslabones,
forman un mecanismo.
Subsistema de reconocimiento
i) Sensores La mayora de los sensores son esencialmente transductores, que convierten la forma de una seal en otra. Por ejemplo, el ojo humano convierte patrones de luz en
seales elctricas. Los sensores forman parte de una de varias reas generales: visin, tacto,
deteccin de rango y proximidad, navegacin, reconocimiento del habla, etc. Cada una de
estas reas es en s un rea de investigacin individual. Sin embargo, algunas de ellas se
explican en el captulo 4.
1
2
2
1
3
2
1
Gato de husillo
Ensamble de servomotor
Figura 2.7
www.FreeLibros.me
22
CAPTULO
Robots seriales
el voltaje creado por una deformacin unitaria en una galga extensomtrica en una seal
digital, es decir, 0 o 1, de manera que el controlador digital del robot pueda procesar esta
informacin. Fsicamente se ve como cualquiera otra tarjeta de interface de computadora
dentro de la unidad de procesamiento central (CPU), como se muestra en la figura 2.8.
2.1.3
Subsistema de control
El papel de un sistema de control en un mando de robot se muestra en la figura 2.9a). Principalmente consiste en los siguientes dispositivos:
i) Controlador digital El controlador digital es un dispositivo electrnico especial que tiene un CPU, memoria y, a veces, un disco duro para almacenar los datos programados. En sistemas de robtica, estos componentes se mantienen dentro de una caja sellada
que se denomina controlador, como puede verse en la figura 2.9b). Se usa para controlar los
movimientos del manipulador y del efector final. Un controlador de robot es como un supervisor en una fbrica. Puesto que una computadora tiene las mismas caractersticas que un
controlador digital, tambin se utiliza como un controlador de robot. Un controlador procesa
los comandos programados por el usuario y transmite seales apropiadas a los actuadores
a travs de los convertidores analgicos digitales (DAC). Los lenguajes de programacin
pueden ser los mismos que se usan en la computacin, es decir, BASIC, Fortran, C y C++.
Para los robots comerciales, sin embargo, los lenguajes son generalmente distintos. Por
ejemplo, Fanuc de Japn usa el lenguaje de programacin de robots Karel. Esto sirve
principalmente para la introduccin de caractersticas especficas en los sistemas robticos
con el fin de que se distingan los productos.
ii) Convertidor digital analgico (DAC) Un DAC convierte la seal digital
del controlador del robot en una seal anloga para accionar los actuadores; por ejemplo,
un motor elctrico de CD. El controlador digital tambin est acoplado a un DAC para re-
Figura 2.8
www.FreeLibros.me
2.1
Subsistemas de robots
23
Trayectoria deseada
del efector final
Desplazamiento
y velocidad de
las articulaciones
Controlador
Entrada de
accionamiento
Sensor
Robot
Configuracin actual
del efector final
a) Esquema de control de un robot
Figura 2.9
b) Controlador ABB
Subsistema de control
[Cortesa: http://www.abb.com/Product/seitp327/
f0cec80774b 0b3c9c1256fd a00409c2c.aspx]
Figura 2.10
www.FreeLibros.me
24
2.2
CAPTULO
Robots seriales
Este mtodo de clasificacin se vuelve ms relevante, pues cada vez ms robots se estn
diseando para servir en tareas especficas. Por ejemplo, muchos robots estn diseados
para trabajos de ensamble y no sern muy fcilmente adaptables para otras aplicaciones.
stos se denominan robots de ensamble. Para la soldadura de costura, algunos proveedores proporcionan sistemas de soldadura completos junto con el robot, es decir, el equipo de
soldadura con sus unidades de manejo de materiales, sus mesas giratorias, etc., juntas como
una unidad integral. Este sistema robtico integral se llama robot de soldadura, aunque su
unidad manipuladora independiente podra adaptarse para una variedad de tareas. Algunos
robots estn especficamente diseados para la manipulacin de cargas pesadas y, por lo
tanto, se llaman robots de trabajo pesado.
2.3
A esta clasificacin tambin se le conoce como clasificacin por la configuracin del brazo
y por el volumen geomtrico de trabajo. Este mtodo clasifica al robot sin tomar en cuenta
al efector final. Indica el volumen de coordenadas alcanzables por un punto en el efector
final, en vez de sus orientaciones. Existen cuatro tipos fundamentales: Cartesiano, cilndrico,
esfrico o polar y articulado o de revoluta.
Figura 2.11
b) Caja rectangular
www.FreeLibros.me
2.3
25
miento de estos robots es difcil, puesto que los movimientos rectilneos se obtienen por lo
general a travs de conjuntos de actuadores elctricos giratorios acoplados a tuercas y tornillos esfricos. El polvo acumulado en los tornillos puede llegar a dificultar el movimiento
suave del robot. Por lo tanto, tienen que cubrirse mediante fuelles. Adems, mantener la
alineacin de los tornillos requiere una mayor rigidez en estos componentes. Por ende, estos
robots tienden a ser ms caros.
Figura 2.12
b) Forma cilndrica
www.FreeLibros.me
26
CAPTULO
Robots seriales
iii) Esfrico o polar Cuando el brazo de un robot es capaz de cambiar su configuracin moviendo sus dos articulaciones de revoluta y su articulacin prismtica, es decir,
cuando la segunda articulacin prismtica a lo largo de la altura y del tipo cilndrico es
reemplazada por una articulacin de revoluta con su eje girado 90 respecto al eje z, se denomina brazo de robot esfrico o polar; la posicin del brazo se describe convenientemente
por medio de las coordenadas esfricas q, f y z; el brazo se muestra en la figura 2.13a). Los
movimientos del brazo representan la rotacin de la base, los ngulos de elevacin y el alcance, respectivamente. Su volumen de trabajo es indicado en la figura 2.13b).
iv) Articulado o de revoluta Cuando un brazo de robot consiste en eslabones
conectados por articulaciones de revoluta, es decir, cuando la tercera articulacin prismtica tambin es reemplazada por otra articulacin de
revoluta con su eje girado 90 respecto al eje z, se le
Por qu son huecos
algunos volmenes de
llama brazo unido articulado o de revoluta. Este caso
trabajo, por ejemplo,
se muestra en la figura 2.14a). Su volumen esfrico de
el de la gura 2.12b)?
trabajo se muestra en la figura 2.14b) donde su superficie interna es difcil de determinar. Tales robots son
Las partes huecas son aquellas que
relativamente ms sencillos de fabricar y mantener,
estn fuera del alcance del efector
ya que los actuadores del robot estn directamente
nal del robot. Se denominan zonas
singulares (vase el captulo 6 para la
acoplados mediante transmisiones de engranes o bien
denicin).
por bandas. Sin embargo, la realizacin de una tarea
f
z
Figura 2.13
b) Forma esfrica
www.FreeLibros.me
2.3
y
27
Figura 2.14
b) Espacio de trabajo
Tipo
Cartesiano
Articulaciones
1 (base): Movimiento 2 (elevacin): Movimiento 3 (alcance): Movimiento
P: desplazamiento x P:
altura y
P:
alcance z
Cilndrico
P+R+90@z
R:
rotacin q
Esfrico
R:
Articulado: R:
P:
-do-
P+R+90@z
-do-
R:
ngulo f
-do-
R:
-do-
P:
-do-
P:
-do-
P+R+90@z
R:
ngulo y
P: Quitar la articulacin prismtica; +R: Agregar articulacin de revoluta; +90@: Girar la articulacin de revoluta alrededor del eje z por 90; -do-: Sin cambios.
www.FreeLibros.me
28
CAPTULO
Robots seriales
Configuracin
Cartesiano (3 ejes lineales)
x: desplazamiento de la base
y: altura
z: alcance
Ventajas
Fcil de visualizar
Estructura rgida
Programacin offline fcil
Paradas mecnicas fciles
Desventajas
Alcance slo hacia adelante y atrs
Requiere gran espacio en
las instalaciones
Los ejes son difciles de
sellar
Caro
No tiene alcance hacia
Cilndrico (1 eje giratorio y 2 Llega a todo su derredor
Ejes y y z rgidos
arriba de s mismo
ejes lineales)
Los ejes q son fciles de se- Eje q menos rgido
q: rotacin de la base
Ejes y y z difciles de sellar
llar
f: altura
No puede llegar alrededor
z: alcance
de obstculos
El movimiento horizontal
es circular
No tiene alcance hacia
Esfrico (2 ejes giratorios y Llega a todo su derredor
Llega arriba y debajo de obs- arriba de s mismo
1 eje lineal)
Corto alcance vertical
tculos
q: rotacin de la base
Gran volumen de trabajo
f: ngulo de elevacin
z: alcance
Articulado (3 ejes giratorios) Llega arriba y debajo de obs- Difcil de programar
offline
tculos
q: rotacin de la base
rea de trabajo ms grande Dos o ms maneras de alf: ngulo de elevacin
para el espacio de instala- canzar un punto
y: ngulo de alcance
El robot ms complejo
cin ms reducido
un tipo cilndrico cuyo alcance se logra mediante el uso de una articulacin de revoluta en
lugar de una articulacin prismtica (compare las figuras 2.12a) y 2.16). Un robot SCARA
es muy conveniente para operaciones de ensamble; por lo tanto, se usa mucho para este
propsito en varias industrias.
y
x
Figura 2.15
www.FreeLibros.me
2.5
29
Figura 2.16
2.4
Brazo SCARA
[Cortesa de Fuller (1999)]
Los robots son accionados por energa elctrica o por energa de fluidos. Esta ltima categora est subdividida en sistemas neumticos e hidrulicos. Hoy en da, el mtodo de
accionamiento ms comn es la energa elctrica mediante el uso de varios tipos de motores,
por ejemplo, el motor de pasos, servo CD y servo CA sin escobillas. Los robots neumticos
se utilizan en trabajos de ensamble ligero o embalaje, pero por lo regular no son convenientes para tareas pesadas o donde se necesite control de velocidad. Por otro lado, los robots
hidrulicos se utilizan en aplicaciones de cargas pesadas debido a su alta proporcin potencia-tamao.
2.5
En este caso, el trmino control puede significar dos cosas: una es su estrategia de control
de movimientos, es decir, si un robot est servocontrolado o no, y la otra es cmo se logra la
trayectoria de movimiento, es decir, de punto a punto o de manera continua.
30
CAPTULO
Robots seriales
monitorea tanto para el desplazamiento como para la velocidad, y se compara con la seal
del comando. La diferencia entre el comando y la accin, que se define como el error, se
utiliza como retroalimentacin al controlador con la finalidad de realizar la modificacin
de los comandos para corregir la posicin. La mayora de los robots elctricos e hidrulicos
son servocontrolados.
Los robots neumticos normalmente no son servocontrolados. En este caso, se transmite
una seal de comando y se supone que el brazo del robot alcanza su posicin deseada. El no
servocontrol es apropiado cuando slo se requiere el control de posicin de cargas ligeras.
Sin embargo, si se ha de controlar velocidad, aceleracin y par de torsin, o si el movimiento
contra cargas pesadas es necesario, entonces el no servocontrol usualmente no es posible. La
mayora de los robots industriales de la actualidad utilizan el servocontrol. Este problema
de control requiere conocimientos de control proporcional-derivativo (PD), proporcionalintegral (PI), proporcional-integral-derivativo (PID, lgica difusa, redes neurales, as como
otras teoras de control.
2.6
Los robots industriales pueden ser programados por diferentes medios. Pueden programarse,
por ejemplo, online u offline. Los mtodos online requieren el uso directo del robot y utilizan
un teach pendant (caja de enseanza) para la programacin punto a punto, as como brazos
de esclavo o un accesorio de empuadura de pistola para la programacin de trayectoria
continua. Los robots ms recientes tienen la posibilidad de programacin offline, es decir, el
robot puede seguir trabajando en una tarea particular, mientras se prepara un programa para
una nueva tarea en una terminal de computacin, utilizando el lenguaje de programacin del
robot, por ejemplo, VAL, ALU u otros.
RESUMEN
En este captulo se han presentado varios subsistemas de un sistema robtico. Un robot es
clasificado con base en su volumen de trabajo, mtodo de control, etc. Las clasificaciones
presentadas en este captulo permitirn al usuario seleccionar/pedir un robot segn sus
requerimientos.
www.FreeLibros.me
31
EJERCICIOS
2.1
2.2
2.3
2.4
2.5
2.6
2.7
2.8
www.FreeLibros.me
Captulo
3
Actuadores
En este captulo se analizar uno de los componentes bsicos del robot: el actuador. Los
actuadores son los msculos de los robots y comprenden lo siguiente:
i)
ii)
iii)
iv)
i) Actuadores neumticos Estos actuadores utilizan energa hidrulica proporcionada por un compresor y la transforman en energa mecnica por medio de pistones o
turbinas.
Estos actuadores emplean la energa neumtica almacenada por un compresor que la transforma en energa mecnica mediante pistones o
turbinas.
www.FreeLibros.me
33
Fuente de
alimentacin
Pp
Pc
Amplificador
de potencia
Motor
o
servomotor
Pa
Pda
Pm
Pds
Transmisin
Pu
Pdt
Un sistema de actuador
3.1
baja inercia
alta relacin de potencia-peso
posibilidad de sobrecarga y entrega de pares de torsin de impulsos
capacidad para desarrollar altas aceleraciones
amplios rangos de velocidad
alta precisin de posicionamiento
buena precisin de rastreo de trayectorias y posicionamiento
Actuadores neumticos
El actuador neumtico es uno de los dos tipos de dispositivos de potencia dada por fluidos
para robots industriales. El otro es hidrulico y se describe en la siguiente seccin. Los
actuadores neumticos utilizan aire comprimido para su accionamiento y se usan extensamente para realizar los movimientos tpicos de abrir y cerrar las mordazas en el sujetador
(gripper) de un robot, como se muestra en la figura 2.4, o bien para su accionamiento de
brazos de robot sencillos en aplicaciones donde el control continuo de movimientos no sea
una preocupacin. Un actuador neumtico que incluye un cilindro neumtico y otros accesorios se muestran en la figura 3.2. Las especificaciones de estos sistemas son empleadas, por
ejemplo, en los sujetadores de robots de la figura 2.4 y se exponen en la tabla 3.1.
www.FreeLibros.me
34
CAPTULO
Actuadores
Cilindro neumtico
Pistn ubicado
dentro del cilindro
Cilindro de
Unidad del compresor
doble efecto
Indicador
de nivel Unidad de aire
Biela de mando
Motor elctrico
acondicionado
Tanque
receptor
Drenaje de agua
Vlvula de control
de cuatro vas de
Filtro Lubricador activacin manual
Regulador
a) Componentes del actuador neumtico
Indicador
Regulador
de presin
Lubricador
Filtro
Tanque
receptor
Vlvulas ajustables
de control de flujo
(una en cada lnea)
Actuador
Secador
Posrefrigerador
Paquete FRL
(Filtro Regulador Lubricador)
Vlvula
de control
direccional
Compresor
Filtro de aire
Entrada de aire
b) Circuito neumtico
Figura 3.2
Un actuador neumtico
Ventajas
Es la forma ms econmica de todos los actuadores. Los componentes son perfectamente asequibles y por lo regular el aire comprimido ya se encuentra disponible en
las instalaciones de las fbricas.
El aire comprimido puede almacenarse y transportarse fcilmente a travs de largas
distancias.
El aire comprimido es limpio, a prueba de explosiones e insensible a fluctuaciones de
temperatura. Por lo tanto, puede emplearse en muchas aplicaciones.
Estos actuadores tienen pocas partes mviles, por lo que son muy confiables y ayudan
a reducir los costos de mantenimiento.
www.FreeLibros.me
35
Especificaciones tcnicas
Marca
SMC
MHC2-25D
Tipo
Barreno
25 mm
ngulo de operacin
30 (abierto) a 10 (cerrado)
Rango de presin
1 a 6 bar
M5 m
Rango de temperatura
0 a 60 C
Medio
Aire no lubricado
Par de sujecin
1.4 Nm a 5 bar
0.1 mm
Puesto que los sistemas neumticos son comunes en toda la industria, el personal que suple
Cunto es un bar?
a otro est frecuentemente muy familiarizado
con la tecnologa.
Un bar = un atm = 14.7 psi = 101 356.5
N/m2 o aproximadamente 105 PA.
Tienen una accin y un tiempo de respuesta
muy rpida, lo que permite ciclos de trabajo
expeditos.
Normalmente no se requiere ninguna transmisin mecnica.
Un sistema neumtico puede ser intrnsecamente seguro en reas con peligro de explosin, ya que no se requiere un control elctrico. En condiciones de humedad, no
existe tampoco peligro de electrocucin.
Los sistemas son por lo regular compactos.
El control es sencillo, por ejemplo, se usan con frecuencia topes mecnicos.
Los componentes individuales pueden interconectarse fcilmente.
Desventajas
Puesto que el aire es compresible, el control de la precisin en la velocidad y la posicin no es fcil de lograr, a menos que se incorporen dispositivos electromecnicos
mucho ms complejos en el sistema. Esto significa que a menudo slo est disponible
una secuencia limitada que opera con una velocidad fija.
Si se usan topes mecnicos, la reanudacin del sistema puede ser lenta.
Los sistemas neumticos no son convenientes para mover cargas pesadas bajo control
preciso, debido a la compresibilidad del aire. Esta compresibilidad requiere de la
aplicacin de ms fuerza de la que normalmente sera necesaria para asegurar que el
actuador est firmemente en posicin contra su tope en condiciones de carga.
Si penetra humedad en las unidades y se ha usado metales ferrosos, podran ocasionarse daos en los componentes individuales.
www.FreeLibros.me
36
CAPTULO
Actuadores
3.2
Actuadores hidrulicos
Los actuadores hidrulicos tambin son dispositivos de potencia de fluidos para robots industriales. Ellos utilizan fluidos de alta presin, como aceite, para transmitir fuerzas al punto
de aplicacin deseado. Un actuador hidrulico es muy similar en aspecto a uno accionado
neumticamente. Los diferentes componentes se muestran en la figura 3.3 y una especificacin tpica del cilindro se ofrece en la tabla 3.2. Estos actuadores estn diseados para
operar con presiones mucho ms altas (normalmente entre 70 y 170 bar). Son apropiados
para aplicaciones de alta potencia.
Las ventajas y desventajas de los actuadores hidrulicos son las siguientes:
Ventajas
Especificaciones tcnicas
Marca
Nm. de parte del fabricante
Tipo
Cuerpo
Tamao de barreno
Carrera
Tamao del puerto
Presin de prueba esttica
Presin de trabajo
Fuerza mxima a 160 bar
Caudal mximo a 0.1 mm/seg
Largo total
Largo total (pistn extendido)
Dimetro de la punta de la barra
Tamao de rosca de la punta de la barra
Material de sellado
Medio hidrulico recomendado
Rango de temperatura de trabajo del lquido hidrulico
Rexroth
CDL1M00/32/18/50/CIX/B1CHUMS
Cilindro-vstago rtula
Acero al carbono
32 mm
50 mm
G 1/4
240 bar
160 bar
12.8 kN
4.8 l/min
200 mm
250 mm
18 mm
18 mm
NBR / Poliuretano
Lquidos con base en aceites minerales
20 a +80C
www.FreeLibros.me
37
Vlvula de
cuatro vas
Filtro
de aceite
Lnea de
suministro
Vlvula
Indicador
Bomba de presin de cierre
manual
hidrulica
Cilindro de
doble efecto
Vlvula
de seguridad
de presin
Lneas de retorno
Depsito de aceite
Palanca de inversin
de control manual
Punzonadora
Acumulador
Bomba de
desplazamiento Vlvula
de retencin
variable
Filtro
Flujo
libre
Vlvula de
seguridad
accionada
por piloto
Depsito
Amortiguador
viscoso
R
Depsito Vlvula de control
direccional
b) Circuito hidrulico
Figura 3.3
Carga
esttica Muela
lineal
Un actuador hidrulico
38
CAPTULO
Actuadores
Desventajas
Pueden darse fugas que causan una prdida de rendimiento y contaminacin general
del rea de trabajo. Tambin hay un mayor riesgo de incendios.
La fuente de alimentacin puede ser ruidosa, normalmente alrededor de 70 decibeles
o dBA, o incluso ms, si no est protegida por un amortiguador acstico.
Cambios de temperatura alteran la viscosidad del lquido hidrulico. Por lo tanto, la
viscosidad del lquido se incrementar y posiblemente cause movimiento lento del
robot.
Para robots ms pequeos, la energa hidrulica usualmente no es econmicamente
factible, puesto que el costo de los componentes hidrulicos no se reduce en proporcin al tamao.
El servocontrol de sistemas hidrulicos es complejo y no se entiende tan ampliamente
como el servocontrol elctrico.
3.3
Actuadores elctricos
Por lo general, se habla de los actuadores elctricos como aqullos donde un motor elctrico acciona los eslabones del robot por medio de alguna transmisin mecnica como por
ejemplo los engranes. En los primeros aos de la robtica industrial, los robots hidrulicos
eran los ms comunes, pero las recientes mejoras en el diseo de motores elctricos implicaron que la mayora de los robots nuevos fueran de
construccin completamente elctrica. El primer robot
Quin es ABB?
comercial de accionamiento elctrico fue introducido
por ABB en 1974. Las ventajas y desventajas de un
ABB es una empresa multinacional
motor elctrico son las siguientes:
con sede en Zrich, Suiza, que trabaja
Ventajas
www.FreeLibros.me
39
Desventajas
Las desventajas mencionadas anteriormente son paulatinamente superadas por la introduccin de sistemas motrices de accionamiento directo, donde el motor elctrico es una parte
relevante de la articulacin del brazo del robot, por lo que se eliminan los elementos de transmisin. Adems, la introduccin de ms recientes motores sin escobillas permite que se usen
los robots elctricos en algunas aplicaciones de riesgo de incendios, tales como la pintura
con pulverizador, puesto que se ha eliminado la posibilidad de chispas en las escobillas del
motor. Los diferentes tipos de motores elctricos son motores de paso, de CD y CA.
3.3.1
Motores a pasos
CD vs. CA
Los motores a pasos (Stepper Motors) (tambin llamados en ingls como stepping motors) se utilizaron
CD signica corriente directa o continua, mientras que CA signica coprimero para el control remoto de los indicadores de
rriente alterna. Las bateras en lindireccin para tubos lanzatorpedos y caones en buternas, autos, etc., suministran CD.
ques de guerra britnicos y, ms tarde, para propsitos
Para el uso domstico, sin embargo,
el suministro elctrico es de CA con
similares en la armada de Estados Unidos. Un tipo de
230 voltios y 50 ciclos (en la India y
motor de reluctancia variable fue patentado por vez
otros pases), 110 voltios, 60 ciclos
primera en 1919, por C. L. Walker, un ingeniero civil
(en Estados Unidos y otros pases), y
escocs; sin embargo, su produccin comercial no coparecidos.
menz sino hasta 1950.
Estos motores son empleados en algunos robots en el ms pequeo y trmino medio del
rango industrial y con los robots de enseanza y pasatiempo. Tambin son ampliamente usados en otras aplicaciones industriales y tienen las ventajas de que no necesariamente requieren
un sistema de retroalimentacin y de los costos asociados. Sin embargo, son compatibles con
muchos dispositivos de retroalimentacin, si esto se requiriera, y son usados en configuraciones de servocontrol total en robots industriales de servicio medio. Puesto que se trata de
motores de control digital, no necesitan el gasto adicional de equipos de conversin de digital
www.FreeLibros.me
40
CAPTULO
Actuadores
i) Motor a pasos de reluctancia variable Reluctancia magntica o simplemente reluctancia es el trmino anlogo de resistencia elctrica. Igual que una corriente
slo sucede en un lazo cerrado, un flujo magntico ocurre slo alrededor de una trayectoria
cerrada, aunque tal vez sta pueda ser ms variada que el de una corriente. La figura 3.4a)
muestra la forma bsica del motor a pasos de reluctancia variable. El rotor est hecho de
acero bajo carbono y tiene cuatro polos, mientras que el estator tiene seis. Cuando una de
las fases, por ejemplo AA, es excitada debido a una corriente de CD que pasa a travs de las
bobinas alrededor de los polos, las posiciones del rotor completan la trayectoria de flujo que
se muestra en la figura 3.4a). Observe que existe una trayectoria de flujo principal a travs
de los dientes alineados de rotor y estator, y que las trayectorias de flujo secundarias ocurren
como se indica. Cuando los dientes del rotor y el estator estn alineados de esta manera,
la reluctancia es minimizada y el rotor est en reposo en esta posicin. Puede decirse que
esta trayectoria de flujo es casi como un hilo elstico que constantemente est tratando de
acortarse a s misma. El rotor se mover hasta que los polos de rotor y estator estn alineados. Esto se llama la posicin de mnima reluctancia. Para girar el motor en sentido opuesto
a las manecillas del reloj, se apaga la fase AA y se excita la fase BB. En ese momento la
trayectoria de flujo principal tiene la forma indicada en las figuras 3.4b) y c). Esta forma del
motor a pasos generalmente da ngulos de paso de 7.5 o 15.
ii) Motor a pasos de imanes permanentes El mtodo bsico de operacin
de un tipo de motor de imanes (o magnetos) permanentes es similar al de reluctancia variawww.FreeLibros.me
41
S
C
A
B
B
N
N
C
A
N
N
S
a) Configuracin bsica
30
B
S
c) Paso completado
S
b) Inicio del paso
Figura 3.4
ble. Como se ilustra en la figura 3.5, hay dos bobinas, A y B, cada una de las cuales produce
cuatro polos, pero que estn desplazadas una de la otra por medio paso polar. El rotor es de
construccin de imanes permanentes y tiene cuatro polos, tal como se ilustra. Cada polo est
enrollado con devanado de campo y las bobinas que hay en los pares opuestos de polos estn
en serie. La corriente es suministrada desde una fuente de CD hasta el devanado a travs de
interruptores. Puede verse en la figura 3.5a) que el motor est en reposo y que los polos del
rotor de imanes permanentes estn sostenidos entre los polos residuales del estator. En esta
posicin, el rotor est enganchado, a menos que se aplique una fuerza de giro. Si se energizan
las bobinas y se invierte en el primer pulso la polaridad magntica de los polos de la bobina
A, el rotor sufrir un par torsor y girar en sentido contrario a las manecillas del reloj, como
se muestra en la figura 3.5b); los polos invertidos se identifican como A.
Si ahora se invierten los polos de la bobina B, quedan B, como se muestra en la figura
3.5c), el rotor nuevamente sufrir un par torsor y dar otra vuelta hasta que los polos del rotor
estn posicionados a medio camino entre los polos del estator. De este modo, cambiando
las corrientes a travs de las bobinas, el rotor gira 45. Si en el primer impulso los polos de
la bobina B hubieran sido invertidos, entonces el motor hubiera girado en el sentido de las
manecillas del reloj. Los ngulos de paso que se producen comnmente con este tipo de
motor son 1.8, 7.5, 15, 30, 34 y 90.
iii) Motor a pasos hbrido Los motores a pasos hbridos combinan las caractersticas de los motores de reluctancia variable y de imanes permanentes, teniendo un imn
www.FreeLibros.me
42
CAPTULO
Actuadores
A
B
S
S
N
S
B
A
N
B
Rotor
A
b)
N
N
S
N
B
Figura 3.5
A
S
N
N
S
S
A
a)
S
N
Estator
N
S
N
N
S
N
S
A
c)
N
S
B
permanente interconectado en cubiertas de hierro que estn cortadas para tener dientes,
como se muestra en la figura 3.6. El rotor se coloca en la posicin de reluctancia mnima
en respuesta a que se estn energizando un par de bobinas del estator. Los ngulos de paso
normales son 0.9 y 1.8. De la descripcin anterior resulta entonces obvio que la velocidad
con la que se aplican los impulsos determina la velocidad del motor, el nmero total de impulsos determina el desplazamiento angular y el orden en el que se energizan las bobinas en
la primera instancia determina la direccin de rotacin. Es precisamente por esta facilidad de
accionamiento, usando el control digital directo, que los motores a pasos son apropiados para
su empleo en un robot controlado por computadora, aunque el motor s requiere interactuar
con una fuente de pulsos de alta corriente.
3.3.2
Motores de CD
Aunque mucha gente podra nunca haber tenido suficiente experiencia con sistemas neumticos o hidrulicos, todos han tenido contacto casi diario con motores elctricos. Ya sean
motores CD (frecuentemente operados por bateras) para arrancar el auto u operar un juguete de nios, o motores CA (operados por la red elctrica) para encender la licuadora, etc.,
Dientes en cubiertas
Imn permanente
Figura 3.6
www.FreeLibros.me
43
sus capacidades son bien conocidas. El primer robot industrial y comercial elctricamente
accionado fue introducido en 1974 por la gigantesca corporacin sueca ASEA. Tradicionalmente, los expertos en robtica empleaban motores de DC (corriente directa) elctricamente
accionados para robots no slo por la disponibilidad de versiones potentes, sino porque son
fcilmente controlables con dispositivos electrnicos relativamente sencillos. Aunque se
necesita corriente directa, rara vez se usan bateras (para robots no mviles); en cambio, se
rectifica el suministro de CA para dar un equivalente adecuado de CD. La operacin de
un motor elctrico se basa en el principio de que un conductor sufrir una fuerza si una corriente elctrica fluye con ngulos rectos hacia un campo magntico. Por lo tanto, se requiere
dos componentes bsicos para construir un motor: uno para producir el campo magntico
usualmente llamado estator y otro para funcionar como conductor comnmente llamado armadura o rotor. El principio se muestra en la figura 3.7a) para un elemento de un
motor CD, mientras que un motor CD de dos polos se presenta en la figura 3.7b). El campo
Conductor
s
Rotacin
Escobillas
Campos
magnticos
Conmutador
i
+
a) Principio de un motor CD
Estator
Bobinas
de campo
Rotor o armadura
Escobillas
Conmutador
b) Motor CD de dos polos con bobinas de campo
www.FreeLibros.me
44
CAPTULO
Actuadores
Especificaciones tcnicas
Marca
Nm. de parte del fabricante
Tipo
Tamao del eje (SMI)
Velocidad (rpm)
Potencia nominal (W)
Voltaje nominal (VCD)
Corriente de entrada
Altura (mm)
Ancho (mm)
Largo (mm)
Parvalux
PM2 160W511109
Motor elctrico industrial CD
M
4 000 rpm
160 W
50 V(CD)
3.8 A
78 mm
140 mm
165 mm
Par torsor
magntico podr ser creado por bobinas de campo devanadas en el estator o por imanes
permanentes. Si se usaran las bobinas de campo, recibiran una corriente elctrica para crear
los polos magnticos en el estator. En la figura 3.7b), la corriente del rotor es suministrada a
un conductor por medio de escobillas y conmutadores. La corriente que pasa a travs del
campo produce un par torsor en el conductor que tiene el mximo para s = 90. Adems, entre ms alto sea el voltaje suministrado a las bobinas del estator del motor, ms rpidamente
girar el motor, lo que proporciona un mtodo muy sencillo para el control de velocidad. De
manera parecida, la variacin de la corriente que recibe la armadura controla el par torsor. La
inversin de la polaridad del voltaje causa que el motor gire en el sentido opuesto. Algunos
robots grandes utilizan motores de CD de control de campo, es decir, motores en los cuales
el par torsor es controlado por la manipulacin de la corriente que va a las bobinas de campo.
Estos motores permiten una mayor salida de potencia con altas velocidades y pueden dar una
buena relacin de potencia-peso. Especificaciones tpicas de un motor CD se dan en la tabla
3.3, mientras que sus caractersticas de velocidad/par torsor se muestran en la figura
3.8 para diferentes valores de voltaje.
Sin embargo, puede decirse que para sistemas robticos industriales, los mtodos de
control de campos excitados por corriente
Voltaje
significan un tiempo de respuesta demasiaalto
do lento y causan prdidas que hacen que el
control por campos magnticos permanentes y por armadora sea ms atractivo.
Voltaje
bajo
Velocidad de rotacin
www.FreeLibros.me
45
Yunque
Imanes permanentes
rbol
Armadura
a) Cilndrico
Figura 3.9
b) Disco
los polos de imanes, pero stas slo sirven para recargar los imanes si su fuerza falla. Debido
al hecho de que el flujo de campo es una constante, el par torsor de estos motores es directamente proporcional a la corriente de la armadura. Otras ventajas son: no se requieren fuentes
de energa de excitacin para las bobinas de campo, la confiabilidad es mejorada conforme no
exista fallas en las bobinas de campo, y el que no existan prdidas de potencia de las bobinas
de campo se traduzcan en una mejora en la eficiencia y el enfriamiento. Dos tipos de configuracin de IP se muestran en la figura 3.9. Se trata de los tipos cilndricos y de disco.
El motor cilndrico trabaja de manera parecida a la que ya se describi para otros motores
de CD, excepto porque no hay bobinas de campo, mientras que el motor de disco tiene un
dimetro largo y una armadura corta de algn material no magntico. El que ms comnmente se usa en robots industriales es el motor cilndrico.
ii) Motores de CD de imanes permanentes sin escobillas Un problema de los motores de CD es que requieren un conmutador y escobillas a fin de invertir
peridicamente la corriente a travs de cada bobina de la armadura. Las escobillas hacen un
contacto de deslizamiento con los conmutadores, saltan chispas entre los dos y, en consecuencia, sufren desgaste. Por lo tanto, las escobillas tienen que cambiarse peridicamente y
la superficie de los conmutadores debe renovarse. Para evitar estos problemas se disearon
motores sin escobillas que consisten bsicamente en una secuencia de la bobina del estator
C
A
y un rotor de imanes permanentes. Un conductor que lleva corriente en un campo magntico
experimenta una fuerza; de igual manera, como
N
B
B
consecuencia de la tercera ley de movimiento
S
de Newton, el imn tambin sufrir una fuerza
Bobinas
opuesta e igual. En el motor CD convencional,
Rotor
del
estator
el imn est fijo y se hace que los conductores
de
imn
de corriente se muevan. En el motor CD de imaA
C
permanente
nes permanentes sin escobillas el mecanismo es
al contrario: los conductores de corriente estn Figura 3.10 Motor CD de imanes perfijos y el imn se mueve. El rotor es un imn
manentes sin escobillas
www.FreeLibros.me
46
CAPTULO
Actuadores
permanente de ferrita o cermico. La figura 3.10 muestra la forma bsica de uno de estos
motores. La corriente que va a las bobinas del estator es electrnicamente cambiado por
transistores en secuencia alrededor de las bobinas, donde la conmutacin est controlada
por la posicin del rotor, de tal modo que siempre hay fuerzas que actan sobre el imn,
haciendo que gire en el mismo sentido.
Los motores sin escobillas tienen muchas ventajas sobre los motores CD convencionales; por ejemplo:
Tienen una mejor disipacin de calor, ya que ste se pierde ms fcilmente desde el
estator que desde el rotor.
Hay una inercia reducida del rotor.
Los motores sin escobillas son menos costosos.
Son mucho ms duraderos.
Pesan menos.
Son de menores dimensiones, pero con una potencia comparable.
La ausencia de escobillas reduce los costos de mantenimiento debido al desgaste de
escobillas y conmutadores, y tambin permite que los robots elctricos se utilicen
en reas de peligro, por ejemplo, en atmsferas inflamables, como aplicaciones de
aspersin de pintura.
Una desventaja es que el sistema de control para motores sin escobillas es relativamente
ms caro.
3.3.3
Motores CA
Hasta hace poco, los motores CA (de corriente alterna) no se haban considerado apropiados
para robots debido a los problemas involucrados en el control de sus velocidades. En su
forma ms sencilla, el motor CA consiste en electroimanes externos alrededor de un rotor
central pero sin ninguna forma de mecanismo de conmutacin mecnico para los electroimanes. Sin embargo, puesto que la corriente alterna (tal como el suministro elctrico pblico)
constantemente cambia de polaridad (primero fluyendo en un sentido, luego en el opuesto,
varias veces por segundo, por ejemplo, 50 veces en la India y 60 en Estados Unidos), es posible conectar el suministro de CA directamente a los electroimanes. La inversin alterna del
sentido de la corriente a travs de las bobinas realizar la misma tarea de cambio de polaridad
que en los motores DC. El campo magntico de las bobinas parecer girar (casi como si
las bobinas por mismas hubiesen sido giradas mecnicamente). Especificaciones tpicas de
un motor CA se muestran en la tabla 3.4. Las caractersticas de velocidad/par torsor de los
motores CA se presentan en la figura 3.11.
Los motores CA no han sido extensamente empleados en aplicaciones robticas debido
a los problemas que surgen en el control de velocidad. En principio, entre ms alta sea la frecuencia de la corriente alterna aplicada al motor, ms rpidamente girar. Hasta hace poco,
en gran medida fue muy imprctico suministrar frecuencias variables en forma simultnea a
un nmero de accionamientos de ejes. Observe que en ambos tipos de motores el electromagnetismo se usa para suministrar el frenado regenerativo con el fin de disminuir los tiempos
de desaceleracin y minimizar el exceso del eje. Ambos tipos demuestran un incremento de
velocidad cuando hay un aumento de la seal de entrada. Sin embargo, por cualquier aumento
www.FreeLibros.me
47
Especificaciones tcnicas
Marca
ABB
1676687
Motores industriales elctricos monofsicos y trifsicos
220-240 VCA 50 Hz
180 W
0.783 A
14 mm
30 mm
1 370 rpm
1.3 Nm
1.3 Nm
150 mm
213 mm
120 mm
de la seal de entrada dado (por voltaje o por frecuencia de voltaje), la velocidad del motor no
puede pronosticarse con precisin. Tienen que hacerse preparativos adicionales para medir la
velocidad del motor y comparar esta velocidad real con la velocidad del comando.
Los motores de corriente alterna (CA) pueden clasificarse en dos grupos, monofsicos y
polifsicos, donde cada grupo est subdividido en motores de induccin y motores sncronos. Los monofsicos se usan normalmente para requerimientos de baja potencia, mientras
que los polifsicos, para potencias mayores. Los motores de induccin son por lo regular ms
econmicos que los que son sncronos y, por lo tanto, se emplean muy extensamente.
Diseo A
300
Diseo C
Diseo D
200
100
Diseo B
Figura 3.11
20
40
60
80
Velocidad (% del valor nominal)
100
www.FreeLibros.me
48
CAPTULO
Actuadores
Este
motor consiste en un rotor de jaula de ardilla hecho de barras de cobre o aluminio que caben
en ranuras en los anillos de extremos para formar circuitos elctricos completos, como los
que se muestran en la figura 3.12. No hay conexiones
elctricas externas al rotor. El motor bsico consiste
Motor CD
en este rotor con un estator que tiene un conjunto de
o motor CA?
devanados. Cuando una corriente alterna pasa a traLos motores CD son fciles de controvs de los devanados del estator, se produce un campo
lar en comparacin con los motores
magntico alternativo. Como resultado de la inducCA. Por lo tanto, se preeren los pricin electromagntica, fuerzas electromagnticas son
meros en aplicaciones robticas.
inducidas en los conductores del rotor y el flujo de
corriente en el rotor. Inicialmente, cuando el rotor es estacionario, las fuerzas que hay en los
conductores que portan corriente o en el rotor del campo magntico del estator son tales que
dan como resultado que no exista un par torsor neto. El motor no es de arranque automtico.
Existen mtodos para hacer que el motor sea de arranque automtico y para dar este impulso
para arrancarlo. Uno de estos mtodos es el de usar un devanado de arranque auxiliar para
dar al rotor un empuje inicial. El rotor gira con una velocidad determinada por la frecuencia
de la corriente alterna que se aplica al estator. Para un suministro de frecuencia constante a
un motor monofsico de dos polos, el campo magntico alternar con esta frecuencia. Esta
velocidad de rotacin del campo magntico se denomina velocidad sncrona. El rotor nunca
igualar esta frecuencia de rotacin y normalmente difiere de ella en 1 a 3%. Esta diferencia
se llama slip (diferencia de velocidad entre la rotacin sncrona y la operativa). Por lo tanto,
para un suministro de 50 Hz, la velocidad de rotacin del rotor ser casi 50 revoluciones
por segundo.
www.FreeLibros.me
3.4
Seleccin de motores
49
Tres pares
de induccin, pero un rotor es un imn persimtricamente ubicados
manente. El campo magntico producido
Rotor
por el estator gira, as que el imn lo hace
con l. Con un par de polos por fase de suministro, el campo magntico gira 360 en un
N
S
ciclo del suministro, por lo que la frecuencia
de rotacin en esta disposicin es la misma
que la frecuencia del suministro. Se utilizan
Estator
motores sncronos cuando se requiere una
a)
b)
velocidad precisa. Estos motores no son de
Figura 3.13 Motor de CA trifsico
arranque automtico, por lo que tiene que
emplearse algn sistema para arrancarlos.
En comparacin con los motores de CD, los motores CA tienen la gran ventaja de ser
ms econmicos, resistentes, confiables y libres de mantenimiento. Sin embargo, el control
de velocidad es por lo general ms complejo que en motores DC; como consecuencia, un
accionamiento de CD con control de velocidad generalmente resulta ms barato que un
accionamiento CA con control de velocidad, aunque la diferencia de precios se reduce cada
vez ms como resultado de desarrollos tecnolgicos y de la reduccin de precios de dispositivos de estado slido. El control de velocidad de motores CA est basado en la disponibilidad de un suministro de frecuencia variable, puesto que la velocidad de estos motores es
determinada por la frecuencia del suministro. En algunos casos especiales, por ejemplo, en
motores CA de induccin de rotor devanado, la velocidad puede ser controlada mediante el
acceso al circuito del rotor, donde diferentes valores de resistencia pueden insertarse en el
circuito del rotor.
3.4
Seleccin de motores
Para cualquier aplicacin de robots tiene que decidirse cul de los actuadores disponibles
es el ms adecuado. Tiene que tomarse en consideracin precisin de posicionamiento,
confiabilidad, velocidad de operacin y costo, as como otros factores.
Los motores elctricos son por naturaleza limpios y con capacidad para trabajar con
alta precisin si son operados correctamente. En contraste, los sistemas neumticos no son
capaces de operar una trayectoria continua de alta precisin, y los actuadores hidrulicos requieren del uso de aceite a presin. Los sistemas hidrulicos pueden generar mayor potencia
en un volumen compacto que en los motores elctricos. El aceite a presin puede conducirse por tuberas hacia actuadores sencillos, capaces de generar pares de torsin con altos
valores y operaciones rpidas. Tambin hay que tomar en cuenta que la potencia necesaria
para controlar una vlvula electrohidrulica es pequea. Bsicamente, este trabajo se realiza
mediante la compresin del aceite y suministrarlo a los accionamientos del brazo del robot.
Toda la energa puede ser suministrada por un solo motor elctrico poderoso y eficiente que
acciona la bomba hidrulica que est en la base del robot o ubicada en alguna distancia. La
potencia es controlada en vlvulas electrohidrulicas compactas. Sin embargo, las vlvulas
electrohidrulicas de alta precisin son ms costosas y menos confiables que los amplificadores y controladores elctricos de baja potencia. Por otra parte, los motores elctricos
www.FreeLibros.me
50
CAPTULO
Actuadores
3.4.1
Clculos
Se necesitan clculos matemticos simples para determinar el par torsor, velocidad y caractersticas de potencia de un actuador o motor para diferentes aplicaciones. El par torsor se
define en trminos de una fuerza multiplicada por distancia o momento. Una fuerza f, a la
distancia a del centro de rotacin, tiene un momento o par torsor t, o sea t = fa. En trminos
generales, la potencia P es transmitida en un eje de mando y es determinada por el par torsor
t, multiplicado por la velocidad angular w. La potencia P es expresada como P = tw. Como
ejemplo, el clculo puede sealar cuntos kilovatios o caballos de potencia se requieren en
un motor que se usa para accionar un brazo de robot de 2 metros que levanta una masa de 25
kg a 10 rpm. Si la masa del brazo es considerada igual a cero, entonces
P = (25 9.81 2) (2p 10/60) = 0.513 kW
El uso de ecuaciones simples de este tipo es a menudo suficiente para lograr una aproximacin til de un valor deseado. Clculos ms detallados pueden considerar todos los datos
apropiados, usando las ecuaciones de esttica y dinmica que apliquen.
RESUMEN
Un robot se mueve por actuadores. Se explican diferentes formas de actuadores, a saber:
neumticos, hidrulicos y elctricos. Para los motores elctricos, se presentan sus especificaciones normales as como las caractersticas de velocidad/par torsor. Tambin se
resume a grandes rasgos cmo debe seleccionarse un motor adecuado.
www.FreeLibros.me
51
EJERCICIOS
3.1
3.2
3.3
3.4
3.5
3.6
3.7
3.8
3.9
3.10
3.11
3.12
3.13
3.14
3.15
3.16
3.17
3.18
3.19
3.20
www.FreeLibros.me
Captulo
4
Sensores
Los sensores en los robots son como nuestros ojos, nariz, odos, boca y piel. A semejanza de
los rganos humanos, por ejemplo los ojos o la piel, trminos como visin, tctil, etc., han
surgido en la jerga de los sensores de robots. Tal como los seres humanos, los robots tienen
que recabar amplia informacin sobre su ambiente a fin de funcionar de manera efectiva.
Tienen que recoger un objeto y saber que lo han recogido. Cuando el brazo del robot se
mueve a travs del espacio cartesiano, tiene que evitar obstculos y acercarse a los objetos
con una velocidad controlada. Algunos objetos son pesados; otros, frgiles; y algunos ms,
demasiado calientes para ser manejados. Estas caractersticas de los objetos y del ambiente
tienen que reconocerse e introducirse en la computadora que controla los movimientos del
robot. Por ejemplo, para mover el efector final de un robot, con o sin carga, a lo largo de
una trayectoria deseada y ejercer una fuerza definida sobre un objeto, el efector final y los
sensores (que normalmente se ubican en las articulaciones) trabajan en coordinacin con el
controlador del robot (microprocesador, computadora o microcontrolador, cualquiera que
fuere el caso).
4.1
Clasicacin de sensores
www.FreeLibros.me
4.2
Sensores internos
53
ii) Palpacin o tacto complejo Presencia de un objeto ms alguna informacin sobre su tamao o forma.
Fuerza medida a lo
v) Proximidad
contacto.
4.2
Sensores internos
Como lo sugiere el nombre, los sensores internos se emplean para monitorear el estado
interno de un robot, es decir, su posicin, velocidad, aceleracin, etc., en un momento determinado. Basado en estas informaciones, el controlador decide acerca del comando de
control. Dependiendo de las diferentes cantidades que miden, los sensores se denominan
como de posicin, velocidad, aceleracin o fuerza.
4.2.1
Sensores de posicin
Rotativo
www.FreeLibros.me
Reslver
LVDT
Potencimetro
Encder absoluto
Encder incremental
Lineal
Todos los sensores
de fuerza
Aceleracin
Transductores
de presin
Sensores
piezoelctricos
Clasicacin de sensores
Interruptores
piezoelctricos
Interruptores
de efecto Hall
Interruptores
de lmite
Interruptores
neumticos
Tipo de contacto
Galgas
extensomtricas
Fuerza
Figura 4.1
Tacmetro
Velocidad
Sensores de visin
Sensores lser
Sensores
ultrasnicos
Sensores de
microondas
Sensores de
efecto Hall
Sensores de
proximidad
Sensores externos
CAPTULO
Posicin
Sensores internos
Sensores
54
4 Sensores
4.2
Sensores internos
55
Fuente de luz
Lente de condensador
Escala de vidrio con
retcula opaca
Retcula de ndice
Celdas sensibles a la luz
a) Tipo lineal incremental
Posicin
del escner
1
0
0
1
1
16
0
0
2
1
El escner lee
la posicin como
16 + 2 + 1 = 19
0
15 OP
1
OP2
OP3
OP4
1
2
Disco codificado
perforado
Eje o flecha
Electrnica de
procesamiento
de seales
11
10
Muchas
fuentes
de luz
Fuente
de luz
Detector
de luz
6
8
7
d) Tipo rotativo absoluto
Figura 4.2
e) Encder rotativo
Encders
sensibles a la luz. La resistencia de las celdas (fotodiodos) disminuye cada vez que reciben
un rayo de luz. De este modo, se genera un pulso cada vez que un rayo de luz es atravesado
por la lnea opaca. Este pulso se introduce en el controlador que actualiza a un contador (un
registro de la distancia recorrida).
b) Encder lineal absoluto En principio, se parece al encder lineal incremental. La diferencia es que da un valor absoluto de la distancia recorrida en cualquier momento. As,
las posibilidades de perder los pulsos a altas velocidades son menores. La salida es digital
en este caso. La escala se marca con una secuencia de tiras opacas y transparentes, como se
muestra en la figura 4.2b). Si el bloque opaco que aparece en la escala de la ilustracin reprewww.FreeLibros.me
56
CAPTULO
4 Sensores
iii) LVDT El transformador diferencial lineal variable (LVDT) es uno de los transductores de desplazamiento que ms extensamente se usa, particularmente cuando se necesita
alta precisin. Genera una seal de CA cuya magnitud se relaciona con el desplazamiento
de un ncleo mvil, como se indica en la figura 4.4. El concepto bsico es el de un ncleo
frrico que se mueve en un campo magntico, donde el campo se produce de un modo similar
al campo de un transformador estndar. Existe un ncleo central, rodeado por dos bobinas
secundarias idnticas y una bobina principal, como se muestra en la figura 4.4. Conforme el
ncleo cambia su posicin con respecto a las bobinas, cambia tambin el campo magntico
y, por tanto, se modifica la amplitud de voltaje en la bobina secundaria como una funcin
www.FreeLibros.me
4.2
Sensores internos
+
L
vR
v0
R0
a) Tipo lineal
vR
R0
v0
b) Tipo rotatorio
vR: Voltaje de referencia; v0: Voltaje medido
L, x, R0, a, q: Otros parmetros fsicos
Figura 4.3
Potencimetros
Bobinas secundarias idnticas
Aislador
Ncleo
frrico
mvil
Conexin con el
objeto desplazado
Bobina principal
Voltage |v0|
de salida
a
O
Figura 4.4
www.FreeLibros.me
57
58
CAPTULO
4 Sensores
del desplazamiento del ncleo a travs de un segmento considerable. Un transformador diferencial rotatorio variable (RVDT) opera con el mismo principio que el LVDT, y tambin
est disponible con un rango de aproximadamente 40.
S1
Rotor
Rotor
Estator
Sincronizador
R1
S1 A S 3 = V sen t sen
S3 A S 2 = V sen t sen ( + 120)
S2 A S 1 = V sen t sen ( + 240)
V sen t
R2
S3
Rotor
S4
R1
Estator
V sen t
R2
Figura 4.5
Estator
Resolver
S1 A S 3 = V sen t sen
S4 A S 2 = V sen t sen ( + 90
= V sen t cos
S2
Sincronizadores y reslvers
www.FreeLibros.me
4.2
Sensores internos
59
es proporcional al seno del ngulo entre el eje de la bobina del rotor y el eje de la bobina
del estator. En el caso de un sincronizador, el voltaje inducido a travs de cualquier par
de terminales del estator ser la suma vectorial de los voltajes a travs de las dos bobinas
conectadas. Por ejemplo, si el rotor de un sincronizador se excita mediante un voltaje de
referencia V sen (w t) a travs de sus terminales R1 y R2, la terminal del estator ver voltajes
en la siguiente forma:
V sen (wt) sen q
V sen (wt) sen (q + 120)
V sen (wt) sen (q + 240)
donde V y w son la amplitud de entrada y frecuencia, respectivamente, mientras que es el
ngulo del eje (flecha). En el caso de un reslver con un voltaje de referencia de CA del rotor
de V sen (wt), los voltajes en las terminales del estator sern
S1 a S3 = V sen (wt) sen q
S4 a S2 = V sen (wt) sen (q + 90) = V sen (wt) cos q
Como se mencion anteriormente, la salida de estos sincronizadores y reslvers primero
tiene que digitalizarse. Para este propsito se utilizan convertidores analgicos-digitales,
que normalmente son de 8 o 16 bits. Ocho bits significa que el rango completo de seales
analgicas ser convertido en un mximo de 28 = 256 valores.
4.2.2
Sensores de velocidad
i) Todos los sensores de posicin Bsicamente todos los sensores de posicin, cuando se utilizan con ciertos lmites de tiempo, pueden dar la velocidad, por ejemplo,
el nmero de pulsos proporcionados por un encder de posicin incremental dividido entre el tiempo consumido en hacerlo. Sin embargo, este mtodo impone una carga computacional sobre el controlador, que podr estar ocupado por algunas otras operaciones.
ii) Tacmetro Estos sensores pueden encontrar directamente la velocidad en cualquier momento y sin mucha carga computacional. stos miden la velocidad de rotacin de un
elemento. Hay varios tipos de tacmetros en uso, pero un diseo sencillo se basa en la regla
de Fleming, que declara que el voltaje producido es proporcional al ndice del acoplamiento
inductivo. Aqu un conductor (bsicamente una bobina) se sujeta al elemento rotativo que
gira en un campo magntico (estator). Conforme incrementa la velocidad del eje, el voltaje
producido en las terminales de las bobinas tambin aumenta. De otra manera, como se muestra en la figura 4.6, puede colocarse un imn sobre el eje rotativo y una bobina sobre el estator.
El voltaje producido es proporcional a la velocidad de rotacin del eje. Esta informacin se
digitaliza mediante un convertidor analgico-digital y se introduce en la computadora.
iii) Sensor de efecto Hall
60
CAPTULO
4 Sensores
Eje (flecha)
Imn permanente
Seal de voltaje
Figura 4.6
terial conductivo llamada chip Hall se sujeta a una diferencia de potencial en sus dos lados
opuestos como se indica en la figura 4.7, entonces el voltaje que se genera a travs de las
caras perpendiculares es cero. Pero si un campo magntico se induce en ngulos rectos al
conductor, el voltaje se genera en las otras dos caras perpendiculares. Entre ms alto sea el
valor de campo, ms lo ser el nivel de voltaje. Si se utiliza un imn anular, el voltaje producido ser proporcional a la velocidad de rotacin del imn.
4.2.3
Sensores de aceleracin
Flujo de corriente
Chip Hall
N
Flujo (campo magntico)
Seal de
voltaje
Figura 4.7
www.FreeLibros.me
4.2
D RAE
RC
Sensores internos
61
Por qu aceleracin
a partir de la fuerza
pero no a partir de la
velocidad?
Encontrar la aceleracin a partir de la
fuerza involucra integracin, lo que
suprime cualquier ruido en la seal
de fuerza. Sin embargo, si la seal de
velocidad se usa para determinar la
aceleracin, tiene que realizarse la diferenciacin, lo que amplica el ruido
en la seal de velocidad. Por lo tanto,
se recomienda el primer mtodo.
D RAE
RCm
Se seala aqu que las velocidades y aceleraciones que se miden mediante el uso de
sensores de posicin requieren diferenciaciones. Por lo general, esto no es deseable, puesto
que el ruido en los datos medidos, si es que existe, ser amplificado. En forma alternativa, se
recomienda el uso de integradores para obtener la velocidad a partir de la aceleracin y, por
consiguiente, las posiciones. Los integradores tienden a suprimir el ruido.
4.2.4
Sensores de fuerza
Qu es el factor de
calibre?
G = 1 DR
e R
donde G es el factor de calibre y es
la deformacin unitaria.
i) Galgas extensomtricas
El principio
de este sensor es que el alargamiento de un conductor
aumenta su resistencia elctrica. La resistencia elctrica normal para galgas es de 50-100 ohmios. El incremento de resistencia se debe a
Las galgas estn hechas de conductores elctricos, usualmente de alambre o papel metlico grabado sobre un material base, como se muestra en la figura 4.8. Estn pegados en las
superficies donde se medirn las deformaciones unitarias, por ejemplo, R1 y R2 de la figura
4.9a). Las deformaciones ocasionan cambios en la resistencia elctrica de las galgas, lo que
se mide mediante su conexin al circuito de puente de Wheatstone como una de las cuatro
resistencias, R1 R4 de la figura 4.9b). ste es un mtodo barato y preciso para medir deformaciones. Sin embargo, deber tenerse cuidado con los cambios de temperatura. Para
mejorar el voltaje de salida y anular los cambios de resistencia debidos al cambio de tempewww.FreeLibros.me
62
CAPTULO
4 Sensores
Un material piezoelctrico presenta un fenmeno conocido como efecto piezoelctrico. Este efecto
seala que cuando cristales elsticos asimtricos
se deforman mediante una fuerza, se desarrollar
un potencial elctrico dentro de la red cristalina
deformada, como se ilustra en la figura 4.10. Este
efecto es reversible. Esto quiere decir que si se
aplica un voltaje entre las superficies del cristal,
ste cambiar sus dimensiones fsicas. La magnitud y polaridad de las cargas inducidas son
proporcionales a la magnitud y direccin de la
fuerza aplicada. Los materiales piezoelctricos
son cuarzo, turmalina, sal de Rochalle y otros.
El rango de fuerzas que pueden medirse usando
sensores piezoelctricos es de 1 a 20 kN y con
una proporcin de 2 105. Estos sensores pueden usarse para medir un cambio instantneo en
la fuerza (fuerzas dinmicas).
R2
a) Viga voladiza con galgas
iii) Deteccin con base en la corriente Puesto que el par de torsin proporcionado por un motor elctrico es una funcin de
la corriente consumida, su medicin, junto con
las caractersticas conocidas del motor, proporciona la deteccin del par de torsin.
4.3
R1
R1
R2
R3
R4
Sensores externos
Los sensores externos se utilizan principalmente para saber ms acerca del ambiente del
robot, especialmente sobre los objetos que se va a manipular. Los sensores externos pueden
dividirse en las siguientes categoras:
Tipo de contacto
Tipo sin contacto
4.3.1
Tipo de contacto
i) Interruptor de lmite
www.FreeLibros.me
4.3
Sensores externos
63
+V
encendido/apagado. El interruptor de lmite tiene
generalmente un brazo mecnico sensible a la presin, como se muestra en la figura 4.11a). Cuando
un objeto aplica presin sobre el brazo mecnico,
se activa el interruptor. Es posible que un objeto
tenga un imn que cause que un contacto suba y
cierre cuando el objeto pase sobre el brazo. Como
se muestra en la figura 4.11b), el registro de subida
a)
b)
mantiene la seal en +V hasta que el interruptor
Figura 4.11 Interruptor de lmite
cierra, transmitiendo la seal a tierra. Los interruptores de lmite pueden ser normalmente abiertos (NO) o normalmente cerrados (NC) y
pueden tener polos mltiples. Un interruptor normalmente abierto permite flujo de corriente
hasta que se aplica presin al interruptor. Un interruptor de polo sencillo permite que se abra
o cierre un circuito al contacto, mientras que un interruptor de polos mltiples permite que
circuitos de interruptores mltiples estn abiertos o cerrados. Los interruptores de lmite son
dispositivos mecnicos que pueden tener los siguientes problemas:
Los interruptores de lmite se utilizan en robots para detectar las posiciones extremas
de los movimientos, donde el eslabn apaga el actuador correspondiente cuando alcanza
una posicin extrema y, de este modo, impide posibles daos de la estructura mecnica del
brazo del robot.
4.3.2
Circuito oscilador
Circuito de salida de estado slido
Como se muestra en la figura 4.12, el circuito del oscilador genera un campo magntico
de frecuencia de radio. El campo se centra alrededor del eje del ncleo frrico que modela
el campo y lo dirige hacia la cara del sensor. Cuando un objeto metlico se acerca a la cara y
entra al campo magntico, se inducen corrientes de Eddy en la superficie del objeto. Esto da
como resultado un efecto de carga o amortiguacin que causa una reduccin en la amplitud de
la seal del oscilador. El circuito del detector identifica el cambio de la amplitud del oscilador.
El circuito del detector se encender con una amplitud de operacin especfica. Esta seal
www.FreeLibros.me
64
CAPTULO
4 Sensores
Objeto
Oscilador
Detector
www.FreeLibros.me
4.3
Sensores externos
65
Los sensores de proximidad capacitivos tienen un mayor rango de deteccin que los de
proximidad inductivos. La distancia de deteccin para interruptores capacitivos tiene que ver
con el rea del plato, as como el tamao de la bobina tiene que ver en los sensores de proximidad inductivos. Los sensores capacitivos bsicamente miden un intervalo dielctrico. Por
consiguiente, es deseable poder compensar las condiciones del objeto y la aplicacin por
medio de un ajuste de sensibilidad para el rango de deteccin. La mayora de los sensores de
proximidad capacitivos se equipa con un potencimetro de ajuste de sensibilidad.
Circuito
de accionamiento
Circuito de
amplificacin
de seales
Lser de
semiconductor
Lente del
transmisor
Elemento de deteccin de
la posicin de la luz (PSD)
Desplazamiento
Lente receptor de luz
Posicin de referencia
Objeto de medicin
Figura 4.14
www.FreeLibros.me
66
CAPTULO
4 Sensores
4.4
Sistema de visin
Los sensores de visin pueden clasificarse como de tipo externo sin contacto, como lo indica
la figura 4.1. Sin embargo, aqu se estudian en una seccin separada debido a su complejidad,
que requiere un tratamiento detallado. Los componentes tpicos de un sistema de visin para uso como alarma de seguridad se muestran en la figura 4.15. Los sistemas de visin
se utilizan exitosamente con robots para permitir que miren a su alrededor con el fin de
encontrar las piezas que van a recoger y para colocarlas en los lugares apropiados. Anterior
a los sistemas de visin en robots se empleaban plantillas para el posicionamiento exacto
de objetos. Estos dispositivos son muy caros. Otras tareas de sistemas de visin que se usan
para robots incluyen la determinacin del patrn geomtrico de los objetos, el movimiento
de los mismo y la reconstruccin de la geometra 3D de los objetos a partir de sus imgenes
en 2D para la medicin, y la construccin de los mapas del ambiente para la navegacin del
robot. Los sistemas de visin proporcionan informacin que es difcil o imposible de obtener
de otra manera. Su cobertura va desde unos cuantos milmetros hasta decenas de metros, con
un ngulo angosto o amplio, dependiendo de las necesidades y el diseo del sistema.
4.4.1
En los sistemas de visin, el componente principal de visin es una cmara completa, incluidos un equipo sensor, la electrnica asociada, el formato de seales de salida y un lente.
En funcin de la aplicacin, la cmara podra ser una RS-170/CCIR, NTSC/PAL (stas son
seales estndares de televisin americana RS-170 monocolor, de televisin europea/india
CCIR monocolor, NTSC color y PAL producidas por las videocmaras, respectivamente),
de escaneo progresivo, variable o de lneas. Los cinco parmetros de sistema ms importantes que rigen la eleccin de la cmara son campo de vista, resolucin, distancia de trabajo,
profundidad de campo e ndice de adquisicin de datos de imgenes. Como regla general,
para mediciones de tamao, el sensor deber tener un nmero de pixeles de por lo menos el
Luz IR
Cmara
Tarjeta
de imgenes
de video
Computadora
Alarma
Micro
controlador
Figura 4.15
www.FreeLibros.me
4.4
Sistema de visin
67
68
CAPTULO
4 Sensores
Adquisicin
de imgenes
Sensor
Pixeles
Procesamiento de imgenes
Clasificacin
de pixeles
Representacin
Clase
de pixeles
Segmentacin
Figura 4.16
Descripcin
Lmites
de regiones de
conjuntos
de pixeles
Propiedades
Deteccin visual
e impares. El flujo de la corriente que resulta crea una seal analgica. En la cmara CID,
cada elemento se descarga y el flujo que resulta se usa en forma directa. La cantidad de
carga almacenada es una funcin lineal de la intensidad reflectiva del objeto y del tiempo
de exposicin a la cmara.
4.4.2
Como se ilustra en la figura 4.16, la deteccin de la visin, tambin llamada visin de mquina, tiene dos pasos: la adquisicin de imgenes y el procesamiento de imgenes.
4.4
Sistema de visin
69
j (columnas)
1
9 10
9 10
j (hileras)
1
2
3
4
5
6
7
8
9
10
j (hileras)
j (columnas)
3
85 103
99 100
Figura 4.17
Imagen digitalizada
la caracterstica clave, por ejemplo, tamao, posicin, orientacin, forma, intensidad, color
y textura. El reconocimiento de patrones intenta equiparar las caractersticas observadas
con criterios almacenados y permite as que se identifiquen los objetos. Con base en una
actividad especfica durante la fase de procesamiento de imgenes, un sistema de visin se
clasifica como visin de bajo, mediano o alto nivel, como se indica en la figura 4.18. Estos
niveles se explicarn a continuacin.
a) Visin de nivel bajo La actividad en la visin de nivel bajo consiste en procesar la imagen para la extraccin de datos (flujo de contornos, de esquinas u ptico). Las
operaciones se llevan a cabo en los pixeles de la imagen para extraer las propiedades arriba
mencionadas respecto a su intensidad o profundidad en cada punto de la imagen. Por ejemplo, uno podr interesarse en la extraccin de regiones uniformes, donde el gradiente de los
pixeles permanece constante, o en los cambios de primer orden en el gradiente, lo que correspondera a lneas rectas, o en los cambios de segundo orden, que podran usarse para extraer
propiedades de superficie tales como picos, hoyos, crestas, etc. Las actividades de visin de
www.FreeLibros.me
70
CAPTULO
4 Sensores
Imagen reticulada
Reconocimiento de patrones
Objetos especficos
Estreo
Mapa de profundidad
Caractersticas
Mapa de bordes
Agrupamiento
Lneas,
curvas,
regiones
Etiquetado
Objetos
Reconocimiento
Descripcin
funcional
Figura 4.18
Niveles de visin
nivel bajo estn invariablemente basadas en datos, y a veces se llaman ascendente. Se trata
del rea donde el modelaje del funcionamiento de la corteza visual es ms apropiado.
4.4
Sistema de visin
71
cules lneas se agrupan para formar un objeto. Para este propsito, uno tiene que distinguir,
adems, qu lneas forman parte de la estructura de los objetos, cules de ellas forman parte
de una textura de superficie o son causadas por sombras. Por ende, los sistemas de nivel alto
se orientan a objetos y a veces se llaman desde arriba hacia abajo. Casi siempre requieren
algn grado de conocimiento acerca de los objetos de la escena.
4.4.3
Un sistema de visin no puede representar o procesar de modo nico todos los datos disponibles debido a problemas computacionales como memoria y requerimientos de tiempo de
procesamiento que se imponen a la computadora. Por lo tanto, el sistema tiene que hacer
concesiones. Otros problemas incluyen las variaciones de la luz, el tamao del objeto y
la ubicacin del objeto, as como limitaciones en el
rango dinmico disponible en los sensores de visin
Qu es un pixel?
normales. El sistema de visin requiere hardware y
software especializados. Es posible adquirir solamenUn pixel es la abreviatura de picte el hardware con poca o ninguna programacin de
ture element (elemento de imagen).
aplicacin. De hecho, algunos programas de terceros
Se trata de un solo punto en una imaestn disponibles. Un planteamiento de slo hardware
gen grca.
es ms econmico y puede hacerse ms flexible para
manejar los requerimientos de visin comunes. Sin embargo, visto que este planteamiento
requiere destreza en el procesamiento de imgenes, solamente es de inters para usuarios
que desean tener la responsabilidad de la interpretacin de imgenes. Es una prctica usual
obtener el hardware y el software de aplicacin juntos de parte del proveedor. Pero el usuario
an tendr que realizar programacin especfica para alguna aplicacin. Los proveedores
principales de sistemas de visin se especializan en el suministro de software slo para
algunas reas de aplicacin.
Todo sistema de visin requiere un sensor con el fin de convertir la imagen visual en
una seal electrnica. Se usan varios tipos de sensores de video, incluidos cmaras vidicn,
dispositivos de tubos de vaco y sensores de estado slido. Originalmente, muchos de estos
sistemas de visin se disearon para otras aplicaciones, por ejemplo, la televisin, as que
se tiene que procesar la seal para extraer la imagen visual y remover la informacin de
sincronizacin antes de que la seal se transmita a la computadora para su ulterior procesamiento. Despus, la computadora trata esta seal como un arreglo de pixeles y procesa estos
datos para extraer la informacin deseada. El procesamiento de imgenes puede ser muy
lento. Para un sensor normal de 200 000 o ms pixeles, un sistema de visin podr consumir
muchos segundos, incluso minutos, para analizar la escena completa y determinar la accin
que debe tomarse. El nmero de bits que se va a procesar es bastante grande. Por ejemplo,
un sistema con un arreglo de 512 512 pixeles y una intensidad de 8 bits por pixel produce
ms de dos millones de bits que deben procesarse. Si se recibiera una imagen continua con
un rango de cuadros de 30 Hz, los bits de datos se recibiran a una razn de 8 MHz. Pocas
computadoras pueden aceptar entradas con esta velocidad de datos, y de todas maneras no
quedara tiempo para procesar los datos. Cuando se considera un sistema de mayor resolucin, un sistema de color o un sistema de mltiples cmaras, los requerimientos de gestin
de datos se tornan astronmicos. Pueden usarse varios mtodos para reducir la cantidad de
www.FreeLibros.me
72
CAPTULO
4 Sensores
datos que se van a manejar y, al mismo tiempo, reducir el tiempo de procesamiento. stos
se explican a continuacin:
a) Un planteamiento es la visin binaria que se utiliza cuando se procesa solamente
una informacin en blanco y negro (se ignoran las variaciones de intensidad y tonos
grises). En la visin binaria, una fotografa se convierte en una imagen binaria por
medio del umbralamiento, como se ilustra en la figura 4.19. En el umbralamiento,
se selecciona un nivel de brillo. Todos los datos con intensidades iguales o mayores
que este valor se consideran blanco; todos los dems valores, como negro.
b) Otro mtodo para recortar el tiempo de proceso es el control de la colocacin de
objetos, de tal modo que los objetos de inters no pueden traslaparse en la imagen.
Por lo tanto, los complicados algoritmos para separar imgenes son innecesarios, y
se reduce el tiempo de procesamiento de imgenes.
c) Un tercer planteamiento reduce la gestin de datos por medio del procesamiento de
nicamente una ventana pequea de los datos existentes; es decir, el objeto se ubica
en un campo de vista predefinido. Por ejemplo, si el robot busca una marca en una
tarjeta de circuitos impresos, el sistema de televisin puede disponerse de tal modo
que la marca se encuentre siempre en la esquina superior derecha.
d) Una cuarta manera toma una muestra estadstica de datos y adopta decisiones basadas en esta muestra. Desgraciadamente, todos estos planteamientos ignoran algunos
de los datos disponibles y, en efecto, producen un sistema de robot menos slido. Se
ahorra tiempo de procesamiento, pero algunos tipos de objetos complejos no pueden
reconocerse.
4.5
Seleccin de sensores
Cuando se utilizan sensores, primero que nada tiene que decidirse qu es lo que el sensor
tendr que hacer y cul es el resultado que se espera. Esta seccin abordar algunas de las
a) Imagen inicial
b) 30% umbral
www.FreeLibros.me
4.5
Seleccin de sensores
73
i) Rango El rango es una medida de la diferencia entre los valores mnimos y mximos
medidos. Por ejemplo, una galga pudiera medir valores en el rango de 0.1 a 10 newton.
ii) Sensibilidad La sensibilidad se define como la proporcin del cambio de salida
a un cambio de entrada. Como ejemplo, si un movimiento de 0.025 mm causa un voltaje de
salida por 0.02 voltios, entonces la sensibilidad es 0.8 voltios por mm. A veces se usa para
indicar el cambio ms pequeo en la entrada que ser observable como cambio de salida.
Usualmente, se busca la mxima sensibilidad que ofrezca una seal lineal y precisa.
iii) Linealidad La linealidad perfecta permitira que se grafique la salida versus la
entrada como lnea recta en una hoja cuadriculada. La linealidad es una medida de la constancia de la proporcin de salida y entrada. La forma de ecuacin sera
y = bx
donde x es la entrada, y la salida y b es una constante. Si b es variable, la relacin no es lineal.
Por ejemplo, b podr ser una funcin de x, de tal modo que b = a + dx, donde el valor de d
introduce una no linealidad. Una medida de no linealidad podra darse como valor de d.
v) Precisin
74
CAPTULO
4 Sensores
viii) Tipo de salida La salida puede ser en forma de un movimiento mecnico, una
corriente o voltaje elctrico, una presin o un nivel de lquido, una intensidad de luz u otra
forma. Para ser til, debe convertirse en otra forma, por ejemplo, en el LVDT (transformador
diferencial lineal variable) o en galgas extensomtricas que se explicaron con anterioridad.
Adems de las caractersticas que se mencionan arriba, los sensores debern tener caractersticas fsicas adecuadas. Por ejemplo:
iii) Interconexin La interconexin de sensores con dispositivos de acondicionamiento de seales y del controlador del robot es a menudo un factor determinante en la utilidad de sensores. Los enchufes no estndares o los requerimientos para voltajes y corrientes
no estndares podrn hacer que un sensor sea demasiado complejo y caro para el uso. Las
seales de un sensor tambin tienen que ser compatibles con el resto del equipo que se usa
si el sistema ha de trabajar correctamente.
RESUMEN
En este captulo se presentan la necesidad de sensores en la robtica, los diferentes tipos de sensores que se usan en aplicaciones robticas y los criterios de su seleccin. Se
enfatizan los aspectos funcionales ms que sus modelos matemticos para que el lector
sea capaz de decidir qu sensor debe usarse y cundo. Los diferentes sensores se clasifican segn sus usos funcionales, por ejemplo, posicin, velocidad, aceleracin, fuerza, etctera.
www.FreeLibros.me
75
EJERCICIOS
4.1
4.2
4.3
4.4
4.5
4.6
4.7
4.8
4.9
4.10
4.11
4.12
4.13
4.14
4.15
4.16
www.FreeLibros.me
Captulo
5
Transformaciones
Con el fin de controlar un robot, es necesario conocer las relaciones entre los movimientos de
las articulaciones (entrada) y los movimientos del efector final (salida), ya que los primeros
controlan a los segundos. Por tanto, el estudio de la cinemtica es importante cuando tienen
que realizarse transformaciones entre los sistemas de referencia de las coordenadas a los que
son referidos los diferentes eslabones del robot.
5.1
Arquitectura de robots
Un robot se compone de varios eslabones que se conectan en forma serial mediante articulaciones. Los grados de libertad del robot (DOF) dependen del nmero y tipos de eslabones
y articulaciones, as como de la cadena cinemtica del robot.
5.5.1
Eslabones y articulaciones
Los cuerpos individuales que forman un robot se llaman eslabones. En este estudio, a
menos que se seale lo contrario, se supone que todos los eslabones son rgidos, es decir, la
distancia entre dos puntos dentro del cuerpo no cambia mientras ste se mueva. Un cuerpo
rgido en el espacio cartesiano tridimensional tiene seis DOF. Esto implica que la posicin
del cuerpo puede describirse mediante tres coordenadas de traslacin y la orientacin por
medio de tres coordenadas de rotacin. Por as convenir al anlisis, ciertos cuerpos no rgidos, como cadenas, cables o correas, podrn considerarse como eslabones cuando realizan
la misma funcin que los cuerpos rgidos. Desde el punto de vista cinemtico, se consideran
como un solo eslabn dos o ms miembros cuando se conectan entre s sin ningn movi-
www.FreeLibros.me
5.1
Arquitectura de robots
77
miento relativo entre ellos. Por ejemplo, un ensamble con dos engranes conectados por un
eje comn representa un solo eslabn.
Los eslabones de un robot se acoplan mediante pares o articulaciones cinemticas. Una
articulacin acopla dos eslabones y proporciona las restricciones fsicas para el movimiento relativo entre los eslabones. No es una entidad fsica, sino simplemente un concepto que
permite especificar cmo un eslabn se mueve respecto a otro. Por ejemplo, una articulacin
en bisagra de una puerta le permite a sta moverse alrededor de un eje en relacin con el
muro fijo. Ningn otro movimiento es posible. El tipo de un movimiento relativo permitido
por una articulacin se rige por la forma de la superficie de contacto entre los miembros,
que puede ser una superficie, una lnea o un punto. Por consiguiente, se les llama articulaciones de pares inferiores o superiores. Si dos eslabones pareados estn en contacto
mediante una superficie, a esta articulacin se le conoce como articulacin de par inferior.
De lo contrario, si los eslabones estn en lnea o contacto mediante un punto, la articulacin
se conoce como de par superior. Por esta definicin, la articulacin de bisagra de la puerta
siempre es una articulacin de par inferior, mientras que una bola que corre sobre un plano
representa una articulacin de par superior. Los pares inferiores y superiores de mayor uso
aparecen en la tabla 5.1.
i) Articulacin revoluta o rotacional, R Una articulacin revoluta o rotacional, tambin conocida como par giratorio, bisagra o articulacin de clavija, permite que dos eslabones pareados giren, uno respecto al otro, alrededor del eje de la articulacin,
por ejemplo Z, tal como se muestra en la figura 5.1. Por lo tanto, una articulacin revoluta
impone cinco restricciones, es decir, prohbe que uno de los eslabones se traslade respecto
al otro a lo largo de los tres ejes perpendiculares X, Y y Z, junto con la rotacin alrededor de
dos ejes, X y Y. Esta articulacin tiene un grado de libertad (DOF).
Z
a) Forma geomtrica
Figura 5.1
b) Representaciones
www.FreeLibros.me
78
CAPTULO
Transformaciones
a) Forma geomtrica
Figura 5.2
b) Representaciones
a) Forma geomtrica
b) Representaciones
Figura 5.3
a) Forma geomtrica
Figura 5.4
b) Representaciones
www.FreeLibros.me
5.1
Arquitectura de robots
79
a) Forma geomtrica
Figura 5.5
b) Representaciones
a) Forma geomtrica
Figura 5.6
b) Representaciones
vi) Articulacin planar, L Esta articulacin de tres DOF permite dos traslados
a lo largo de dos ejes independientes del plano de contacto y una rotacin alrededor del eje
perpendicular del plano, como se ve en la figura 5.6.
La tabla 5.1 resume las articulaciones bsicas de pares inferiores, donde todas tienen contacto de superficie entre los eslabones interconectados. Otra articulacin de pares inferiores
de uso comn en la robtica es la articulacin universal de dos DOF, como se muestra en la
figura 5.7, que es la combinacin de dos articulaciones revolutas entrecruzadas. Ejemplos de
articulaciones de pares superiores en robots son los engranes y las levas con seguidores de rodillos, donde hacen lneas de contacto.
5.1.2
Cadena cinemtica
Una cadena cinemtica es una serie de eslabones conectados por articulaciones. Cuando
cada uno de los eslabones de una cadena cinemtica se acopla a un mximo de otros dos, la
cadena se denomina cadena cinemtica simple.
R
#2
#1
#3
O
R
Figura 5.7
www.FreeLibros.me
80
CAPTULO
Tabla 5.1
Transformaciones
Smbolo
Forma geomtrica y
representaciones
DOF
Figura 5.1
Cilindro
Prismtica
Figura 5.2
Prisma
Helicoidal
Figura 5.3
Tornillo
Cilndrica
Figura 5.4
Cilindro
Esfrica
Figura 5.5
Esfera
Planar
Figura 5.6
Plano
Nombre
Rotacional
Mecanismo vs.
manipulador
Mientras que un mecanismo puede
ser un sistema mecnico de cadena
abierta y cerrada, un manipulador se
trata en este estudio como un sistema
de cadena abierta.
5.1.3
Superficie
comn
Grado de libertad
#2
#3
#1
Base, #0
Suponga lo siguiente:
s: dimensin del espacio de trabajo (para mecanismos planares, s = 3; para espaciales,
s = 6),
r: nmero de cuerpos rgidos o eslabones en el sistema;
p: nmero de pares cinemticos o articulaciones en el sistema;
ci: nmero de restricciones impuestas por cada articulacin;
c: nmero total de restricciones impuestas por articulaciones p;
ni: grado de libertad relativo de cada articulacin;
n: grado de libertad de todo el sistema.
www.FreeLibros.me
5.1
Arquitectura de robots
81
b3
2
5
#3
#1
#4
#2
4
#5
6
Base, #0
Figura 5.9
#6
Un manipulador robtico
El DOF del sistema completo, n, se determina entonces a partir del DOF total asociado
con todas las articulaciones mviles menos el nmero total de restricciones impuestas por
todas las articulaciones, es decir,
n = s (r 1) c
(5.1)
donde c
c i.
i =1
Observe que 1 en la ecuacin (5.1) corresponde al eslabn fijo del sistema que tiene un
DOF de cero. Adems, para los eslabones acoplados, la suma del nmero de restricciones
impuestas por cada articulacin ci y el grado de libertad relativo permitido por esta articulacin ni es igual a la dimensin del espacio de trabajo s, es decir,
s = ci + ni
Por lo tanto, el nmero total de restricciones impuestas por todas las articulaciones puede
ser reescrito
p
c=
ci =
i =1
(s ni ) = s p
i =1
ni
(5.2)
i =1
n = s (r p 1) +
ni
(5.3)
82
CAPTULO
Transformaciones
Ejemplo 5.1
La figura 5.8 muestra un mecanismo plano de cuatro barras cuyos eslabones, incluida
la base, se conectan en un giro mediante cuatro articulaciones rotacionales. Aqu, s =
3, r = 4 y p = 4. La ecuacin (5.3) da
n = 3 (4 - 4 - 1) + (1 + 1 + 1 + 1) = 1
(5.4)
Ejemplo 5.2
Un manipulador robtico
La figura 5.9 muestra el diagrama esquemtico de un robot Stanford. Su DOF puede determinarse usando la ecuacin (5.3) siendo s = 6, r = 7 (incluida la base fija) y
p = 6. Entonces, segn la ecuacin (5.3), el DOF del robot es
n = 6 (7 - 6 - 1) + 6 1 = 6
Ejemplo 5.3
(5.5)
La figura 5.10 muestra un mecanismo planar de cinco barras. Hay cinco eslabones
conectados en un lazo mediante cinco articulaciones rotacionales o revolutas. Por
tanto, s = 3, r = 5 (incluida la base) y p = 5. La ecuacin (5.3) proporciona
n = 3 (5 - 5 - 1) + 5 1 = 2
(5.6)
El mecanismo planar de cinco barras tiene dos DOF, el cual tambin se usa frecuentemente como manipulador robtico.
#2
#2
#3
#4
#1
#4
#0
#3
#1
#0
www.FreeLibros.me
5.2
Ejemplo 5.4
83
(5.7)
lo que interpreta el sistema como una estructura con cero DOF. Esto no es cierto,
puesto que se sabe que el mecanismo tiene un DOF. En realidad, el eslabn 4 tiene
una longitud igual que la del eslabn 1. Por ende, el eslabn 4 es cinemticamente
redundante y puede quitarse sin destruir la cadena cinemtica bsica ni el comportamiento de entrada/salida del mecanismo.
En general, si el criterio de Grubler-Kutzbach, ecuacin (5.3), proporciona n > 0, el
mecanismo tiene n DOF. Si el criterio proporciona n = 0, se trata de una estructura con cero
DOF, y si n < 0, el sistema es una estructura estticamente indeterminada con restricciones
redundantes. Sin embargo, se presentan excepciones como la que se muestra en la figura
5.11, que no obedece al criterio de Grubler-Kutzbach. Para estos sistemas, Tsai (1999) describe un criterio de movilidad diferente, por ejemplo, el criterio de movilidad del lazo, etc.,
que puede emplearse para determinar su DOF.
5.2
84
CAPTULO
Transformaciones
5.2.1
Descripcin de la posicin
LM p OP
Mp P
MN p PQ
x
[p]F
(5.8)
y
z
(5.9)
donde x, y y z denotan los vectores unitarios a lo largo de los ejes X, Y y Z del sistema F,
respectivamente, como se indica en la figura 5.12. Sus representaciones en el sistema F, es
decir, [x]F, [y]F y [z]F son como sigue:
[x]F
LM1OP
M0P , [y]
MN0PQ
LM0OP
M1P , y [z]
MN0PQ
LM0OP
M0P
MN1PQ
(5.10)
Si se sustituye la ecuacin (5.10) en la (5.9), puede demostrarse que la expresin del vector p en el sistema F, es decir, [p]F, es la misma que se da en la ecuacin (5.8). Observe que
si el vector p se representa en otro sistema de referencia fijo al del sistema F, tendr diferentes
componentes a lo largo de los ejes de coordenadas nuevos, a pesar de que la posicin real
del punto P no ha cambiado. Por lo tanto, se escribir un vector normalmente sin mencionar
pz Z
W
P
pw
p
z
w
O
u
pu
v
y
pv
Sistema mvil, M
py
Sistema fijo, F
px
X
Figura 5.12
Descripcin espacial
www.FreeLibros.me
5.2
85
algn sistema, por ejemplo, como ocurre en la ecuacin (5.9), la cual se llama, en contraste
con las ecuaciones (5.8) y (5.10), representacin de un sistema invariante. Sin embargo, es
importante observar que cuando se resuelve un problema numrico, debe elegirse un sistema
de coordenadas adecuado.
Ejemplo 5.5
5.2.2
LM OP
M4 P
MN5PQ
Descripcin de la orientacin
(5.12)
86
CAPTULO
Transformaciones
donde pu, pv y pw son los componentes del vector p a lo largo de los ejes U, V y W del sistema
de referencia mvil M. La sustitucin de las ecuaciones (5.11a-c) en la ecuacin (5.12) da
como resultado
p = (pu u x + pvv x + pww x)x + (puuy + pvvy + pwwy)y + (puuz + pvvz + pwwz)z (5.13)
Si se compara el lado derecho de las ecuaciones (5.8) y (5.13), se obtienen las siguientes
identidades:
px = ux pu + vx pv + wx pw
(5.14a)
py = uypu + vy pv + wy pw
(5.14b)
pz = uz pu + vz pv + wz pw
(5.14c)
Las ecuaciones (5.14a-c) se escriben en forma de matriz como
[p]F = Q[p]M
(5.15)
donde [p]F y [p]M son las representaciones del vector tridimensional p en los sistemas F y
M, respectivamente, y Q es la rotacin de 3 3 o matriz de orientacin que transforma la
representacin del vector p del sistema M al F. stas se denotan como sigue:
LM p OP
LM p OP
LMu
M p P , [p] M p P , y Q Mu
MN p PQ
MN p PQ
MNu
LMu x v x w xOP
= Mu y v y w y P
MN u z v z w z PQ
x
[p]F
vx
vy
vz
wx
wy
wz
OP
PP
Q
(5.16)
Observe las columnas de la matriz Q. Son nada ms los componentes de los vectores
unitarios ortogonales (es decir, con 90 entre uno y otro) u, v y w en el sistema de referencia
fijo F, que deben cumplir con las siguientes seis condiciones ortogonales:
uTu = vTv = wTw = 1, y uTv ( vTu) = uTw ( wTu) = vTw( wTv) = 0
Adems, para los tres vectores ortogonales u, v y w, lo siguiente es vlido:
(5.17)
(5.18)
u v = w, v w = u, y w u = v
Por tanto, la matriz de rotacin de 3 3 Q, que denota la orientacin del sistema mvil
M respecto al sistema fijo F, se llama ortogonal. Ella cumple con las siguientes propiedades
debido a la ecuacin (5.17):
(5.19)
QTQ = QQT = 1; donde det (Q) = 1, y Q-1 = QT
donde 1 es la matriz de identidad de 3 3. Adems, si se quiere encontrar la descripcin de
rotacin en el sistema F respecto al sistema M denotado por Q, puede derivarse de modo
similar. Puede demostrarse que Q = QT.
Observe tambin que, segn la ecuacin (5.16), el elemento (1, 1) de Q es el coseno del
ngulo entre los vectores u y x, es decir, uTx. Lo mismo es vlido para los dems elementos
de Q. Por lo tanto, esta matriz de rotacin se conoce como Representacin por coseno director de la matriz de rotacin. Esta representacin requiere nueve parmetros, a saber, los
elementos de la matriz de 3 3 Q. Sin embargo, los nueve parmetros no son independientes, ya que tambin tienen que cumplir con las seis condiciones de la ecuacin (5.17). Por
lo tanto, slo tres son independientes y deberan ser suficientes para definir el movimiento
www.FreeLibros.me
5.2
87
de rotacin tridimensional. Empero, es difcil elegir el conjunto de tres parmetros independientes. ste es el inconveniente de la representacin del coseno director.
Ejemplo 5.6
Rotaciones elementales
LMCa OP
M Sa P , [v]
MN 0 PQ
LM- Sa OP
M Ca P , y [ w]
MN 0 PQ
LM0OP
M0P
MN1PQ
(5.20)
LMCa
M Sa
MN 0
OP
PP
Q
- Sa
Ca
0
0
0
1
(5.21)
En forma parecida, puede demostrarse que la rotacin del ngulo b alrededor del eje
Y y con un ngulo g alrededor del eje X, se dan, respectivamente, por
Z, W
Sistema, M
V
V
z, w
py
Sistema, M
P
U
Sistema, F
pu
pv
Sistema, F
X
px
b) Transformacin de coordenadas
U
a) Rotacin alrededor del eje Z
Y
P
py
p
py9
py9
p9
Sistema
rotado, F
p9
px9
Sistema, F
px p 9
x
c) Rotacin vectorial
Figura 5.13
www.FreeLibros.me
88
CAPTULO
Transformaciones
QY
LM Cb
M 0
MN-Sb
OP
PP
Q
LM
MM
N
0 Sb
1 0
1 0 , y QX 0 Cg
0 Cb
0 Sg
0
- Sg
Cg
OP
PP
Q
(5.22)
Las matrices mencionadas en las ecuaciones (5.21) y (5.22) se llaman rotaciones elementales y son tiles para describir cualquier rotacin arbitraria donde se conozcan
los ngulos respecto a los ejes de coordenadas.
Ejemplo 5.7
De las ecuaciones (5.21) y (5.22), la multiplicacin de matrices de, por ejemplo, QTz
y Qz, da como resultado lo siguiente:
Q zT
Qz
LM Ca
= M- Sa
MN 0
Sa
Ca
0
0
0
1
OP LMCa
PP MM Sa
QN0
- Sa
Ca
0
OP
PP
Q
LM
MM
N
0
1 0 0
0 = 0 1 0
1
0 0 1
OP
PP
Q
Ejemplo 5.8
Transformacin de coordenadas
Considere dos sistemas de coordenadas con un origen comn. Uno de ellos gira con
un ngulo a alrededor del eje Z. Suponga que [p]F y [p]M son las representaciones
vectoriales del punto P en los sistemas F y M, respectivamente, como se muestra en
la figura 5.13b). Con base en geometra simple, la relacin entre las coordenadas del
punto P en los dos sistemas de coordenadas se da por
px = pu Ca - pv Sa
(5.23)
py = pu Sa + pv Ca
(5.24)
pz = p w
(5.25)
donde px, py y pz, as como pu, pv y pw, son las tres coordenadas del punto P a lo largo
de los ejes de los sistemas F y M, respectivamente. Es fcil darse cuenta a partir de las
ecuaciones (5.23) a (5.25) que el vector [p]F [px, py, pz]T no es otra cosa que
[p]F = QZ [p]M
(5.26)
donde [p]M [pu, pv , pw] y QZ se calculan con la ecuacin (5.21). La matriz QZ no
solamente representa la orientacin del sistema M respecto al sistema fijo F, como
en la figura 5.13a), sino tambin transforma la representacin de un vector desde el
sistema M, por ejemplo, [p]M, a otro sistema F, es decir, [p]F.
T
www.FreeLibros.me
5.2
Ejemplo 5.9
89
Considere el vector p que se obtiene mediante la rotacin de un vector p en el plano X-Y con un ngulo a alrededor del eje Z del sistema de referencia F de la figura
5.13c). Suponga que px, py y pz son las coordenadas del vector p en el sistema F, es
decir, [p]F [px, py, pz]T. Entonces, el vector p en el sistema F [p]F tiene los siguientes
componentes:
px = px Ca - py Sa
py = px Sa + py Ca
pz = pz
(5.27)
(5.28)
(5.29)
que pueden obtenerse mediante la rotacin del sistema fijo F por lo cual el vector p
se adjunta con un ngulo a en sentido opuesto al de las manecillas del reloj alrededor
del eje Z, de tal manera que el vector p alcanza al vector p, como se indica en la figura
5.13c). Las ecuaciones de la (5.27) a la (5.29) pueden reescribirse en una forma ms
compacta como
[p]F = QZ [p]F
(5.30)
ii) Representacin de los ngulos de Euler Los ngulos de Euler constituyen una representacin mnima de la orientacin, obtenida al componer las tres rotaciones elementales respecto a los ejes de los sistemas de referencia actuales. Existe la
posibilidad de 12 conjuntos distintos de ngulos de Euler respecto a la secuencia de posibles
rotaciones elementales, a saber, XYZ, XZY, XZX, XYX, YXZ, YZX, YXY, YZY, ZXY, ZYZ, ZXZ
y ZYX. De todos ellos, se utiliza ms comnmente el conjunto ZYZ en la representacin de
ngulos de Euler. Esto implica que el sistema fijo F gira primero alrededor de su eje Z para
alcanzar un sistema intermedio A, luego lo hace alrededor del eje Y del sistema rotado, es
decir, Ydel sistema A, para llegar a otro sistema intermedio B y finalmente alrededor del eje Z
del sistema que fue rotado dos veces, es decir, Z del sistema B, para llegar al sistema deseado
M, como se muestra en la figura 5.14. Suponga que f, q y j son los ngulos alrededor de Z,
Y y Z, respectivamente. La rotacin total descrita por estos ngulos se obtiene entonces
como las composiciones de las rotaciones elementales, como se explica a continuacin, en
la figura 5.14.
Gire el sistema fijo F con el ngulo f alrededor del eje Z, como se indica en la figura
5.14a). Esta rotacin se describe con la matriz de rotacin QZ, como se deriva en la
ecuacin (5.21), es decir,
Qz
LMCf
Sf
MM 0
N
- Sf
Cf
0
OP
P
1 PQ
0
0
www.FreeLibros.me
(5.31a)
90
CAPTULO
Transformaciones
Gire el sistema actual A con un ngulo q alrededor de su eje Y, figura 5.14b). Esta
rotacin se denota por QY y se describe con la matriz de rotacin QY de la ecuacin
(5.22), es decir,
QY
LM Cq
0
MM-Sq
N
OP
P
Cq QP
Sq
0
0
1
0
(5.31b)
Gire el sistema B con un ngulo j alrededor de su eje Z, figura 5.14c). Esta rotacin
se denota por Qz y se describe con la matriz de rotacin QZ de la ecuacin (5.21), es
decir,
Qz
LMCj
Sj
MM 0
N
- Sj
Cj
0
OP
P
1 PQ
0
0
(5.31c)
La orientacin resultante del sistema M denotada por Q se obtiene a partir de la composicin de las tres rotaciones elementales QZ, QY y Qz respecto a sus referencias actuales. Lo
anterior se obtiene por medio de posmultiplicacin de las sucesivas matrices de rotacin,
es decir,
Q = QZ QY QZ
(5.31d)
Z, Z
Z, Z
Sistema, A
Sistema, A
Y, Y
Y
Sistema, F
X
a) Rotacin alrededor del eje Z
Sistema, B
X X
b) Rotacin alrededor del eje Y, es decir, eje Y
Z, W
Sistema, M
V
Sistema, B
U
X
c) Rotacin alrededor del eje Z, es decir, eje Z
Figura 5.14
www.FreeLibros.me
5.2
LMCf Cq Cj - Sf Sj
Q Sf Cq Cj + Cf Sj
MM
N - Sq Cj
- Cf Cq Sj - Sf Cj Cf Sq
- Sf Cq Sj + Cf Cj Sf Sq
Sq Sf
Cq
OP
PP
Q
91
(5.31e)
LMq
Q Mq
MNq
q12
q 22
q 32
11
21
31
q13
q23
q33
OP
PP
Q
(5.32a)
FG q , q IJ
H Sq Sq K
23
13
(5.32b)
donde atan2(y, x) es la funcin de dos argumentos que proporciona una solucin nica
para el ngulo. La solucin de la ecuacin (5.32b) existe, siempre y cuando Sq 0, es decir,
cuando q 0, o np para n = 1, 2, . . . Un aspecto importante de la representacin de rotacin, ya sea un coseno director o un ngulo de Euler o cualquier otra, es que, a diferencia
de los vectores es no conmutativa, es decir, el orden de rotaciones es importante para derivar la matriz de rotacin correcta. Como se ilustra en la figura 5.15a-c), la rotacin de un
paraleleppedo alrededor del eje Z y del eje actual Y es distinta de la rotacin alrededor del
eje Y del eje actual Z, como se muestra en la figura 5.16a-c). A fin de mostrar esto en forma
matemtica, la matriz resultante para las rotaciones alrededor de los ejes Z y Y, denotada por
QZY, puede darse de esta manera:
QZY = QY QZ
LM0
= M1
MN0
0 1
0 0
1 0
QZ
OP
PP
Q
LM C90 0 S 90 OP LM 0 0
1
0 P = M0 1
M 0
MN- S 90 0 C90PQ MN-1 0
LMC90 - S 90 0OP LM0 -1
M S 90 C 90 0P = M1 0
MN 0 0 1PQ MN0 0
(5.33a)
OP
PP
Q
0O
0PP
1PQ
0 ;
0
(5.33b)
Observe que el orden de multiplicacin en la ecuacin (5.33a) es contrario al de la ecuacin (5.31d). Esto se debe al hecho de que las rotaciones en la ecuacin (5.31d) se determiwww.FreeLibros.me
92
CAPTULO
Transformaciones
W
B
C
V
B
C
A
V
Y
D
U
a)
b)
X
c)
Figura 5.15
nan respecto a los sistemas en uso, mientras que en la ecuacin (5.33a) lo hacen respecto al
sistema fijo. El resultado de la ecuacin (5.33a) puede verificarse a partir de la figura 5.15c)
utilizando el concepto de representacin por coseno director de una matriz de rotacin, como
se explic anteriormente. Del mismo modo, puede obtenerse la matriz de rotacin resultante
para las rotaciones alrededor de los ejes Y y Z, que son denotadas por QYZ como
QYZ = QZ QY
LM 0
= M0
MN-1
OP
PP
Q
-1 0
0 1
0 0
(5.33c)
Cuando se comparan las ecuaciones (5.33a) y (5.33c), resulta obvio que las dos secuencias de rotaciones son diferentes. Sin embargo, lo mismo no es vlido para la representacin
vectorial de un punto P respecto a O. Puede sumarse el vector b a a o el a a b, como en la
figura 5.17. Ambas sumas resultarn en el mismo vector p.
5.3
Transformacin de coordenadas
Como se ilustra en la subseccin 5.2.1, la posicin de un cuerpo rgido en el espacio se expresa en trminos de la posicin de un punto apropiado sobre el cuerpo, por ejemplo, OM en
la figura 5.18 respecto al origen O del sistema fijo F, mientras que su orientacin o rotacin
se expresa en trminos de los componentes del vector unitario del sistema mvil M, adjun-
www.FreeLibros.me
5.3
Z
93
Transformacin de coordenadas
Z
W
B
C
A V
B
Y
D
X
a)
b)
V
Y
D
V
B
U
c)
X
Figura 5.16
P
W
Z
Z
V
b
p9
OM
a
O
o
Y
Y
U
F
X
Figura 5.17
Figura 5.18
tada al cuerpo, como se explic en la subseccin 5.2.2. En la figura 5.18, la relacin entre
los dos sistemas de coordenadas, a saber, F y M, se deriva como sigue: considere un punto
arbitrario P sobre el cuerpo rgido por el cual el sistema M se adjunta a OM. Suponga que p y
p son los vectores que denotan el punto P desde el origen de los sistemas de referencia F y
M, respectivamente. Adems, suponga que o es el vector posicional que denota la traslacin
del origen del sistema M, OM desde el del sistema F, es decir, O. De este modo,
p = o + p
(5.34)
Observe que si p se conoce en el sistema mvil M, entonces no es otra cosa que las
coordenadas del punto P en el sistema M, es decir, [p]M. Adems, si Q es la orientacin del
sistema M respecto al sistema F, entonces el vector p en el sistema F es [p]F = Q[p]M. Por
lo tanto, el vector p en el sistema fijo F, es decir, [p]F, puede obtenerse como
[p]F = [o]F + Q[p ]M
www.FreeLibros.me
(5.35)
94
CAPTULO
Transformaciones
5.3.1
Transformacin homognea
LM[p] OP = LM Q
N 1 Q N0
[ o] F
1
OP LM[p ] OP
QN 1 Q
M
(5.36)
Ejemplo 5.10
LMQ
MN 0
- Q T [ o] F
1
OP
PQ
(5.39)
Traslacin pura
www.FreeLibros.me
5.3
LM1
0
T M
MM0
N0
Ejemplo 5.11
Transformacin de coordenadas
0
1
0
0
0
0
1
0
0
2
1
1
OP
PP
PQ
95
(5.40)
Rotacin pura
Considere la figura 5.19b), donde el sistema M se obtiene a partir del sistema de referencia F por medio de su rotacin alrededor de su eje Z con un ngulo de 30. La matriz
de transformacin homognea para la rotacin pura se proporciona entonces por
LMC30
S30
TM
MM 0
N0
OP
PP
P
1Q
- S30 0 0
C30 0 0
=
0
1 0
0
LM 3
MM 12
MM 2
MN 00
1
2
OP
P
0P
P
0P
P
1Q
0 0
3
2
0
0
0
1
0
(5.41)
Z, W
Z
M
V
30
U
X
30
F
a)
b)
Y
V
U
M
30
2
1
X
F
c)
Figura 5.19
Diferentes movimientos
www.FreeLibros.me
96
CAPTULO
Transformaciones
Ejemplo 5.12
Movimiento general
(5.42)
donde los subndices t y r significan traslacin y rotacin, respectivamente,
y donde Tt y T se proporcionan con las ecuaciones (5.40) y (5.41), respectivamente.
La matriz T resultante se proporciona con
LMC30
S30
TM
MM 0
N0
Ejemplo 5.13
OP
PP
P
1Q
- S30 0 2
C30 0 1
=
0
1 0
0
LM 3
MM 12
MM 2
MN 00
1
2
3
2
0
0
OP
P
1P
P
0P
P
1Q
0 2
0
1
0
(5.43)
Transferencia de un punto
[p2]F
LMC30
S30
= T[p ] , donde T T T = M
MM 0
N 0
1 F
OP
PP
PQ
- S30
C30
0
0
0 0
0 2
1 -1
0 1
(5.44a)
LM1
0
T = M
MM0
N0
t
OP
PP
PQ
LM
MM
MN
C30 - S30
0
S30 C30
1 0 2
y Tr =
0
0
0 1 -1
0
0
0 0 1
0 0
OP
P
0P
P
1Q
0 0
0 0
1
0
(5.44b)
www.FreeLibros.me
5.3
Transformacin de coordenadas
97
Z
2
30
p1
p2
Y
Figura 5.20
Ejemplo 5.14
Transferencia de un punto
TA
LMC30
S30
=M
MM 0
N0
- S30
C30
0
0
0
0
1
0
2
1
0
1
TB
LM C45
- S 45
=M
MM 0
N 0
S 45
C 45
0
0
0
0
1
0
1
1
0
1
OP
PP
PQ
OP
PP
PQ
(5.45)
que se representan grficamente en la figura 5.21. Observe que cada una de las transformaciones TA o TB es un producto de las dos transformaciones elementales que
representan la traslacin y rotacin respecto a los sistemas de referencia dados. Por
ejemplo, la matriz TA puede escribirse como
TA = TAt TAr
(5.46a)
donde las matrices de transformacin homognea de 4 4, TAt y TAr, se asocian con la
traslacin y rotacin desde el sistema fijo F al sistema A, respectivamente; es decir,
TAt
LM1
0
= M
MM0
N0
0
1
0
0
0
0
1
0
OP
PP
PQ
LM
MM
MN
C30 - S30
2
S30 C30
1
, y TAr =
0
0
0
0
0
1
www.FreeLibros.me
0
0
1
0
0
0
0
1
OP
PP
PQ
(5.46b)
98
CAPTULO
Transformaciones
YB
Y
YA
XA
45
1
1
XB
30
X
a) Transformaciones respecto a los sistemas actuales
YA
XA
YB
1
1
45
30
1
XB
X
2
b) Transformaciones respecto al sistema fijo
F
Figura 5.21
LM 3 + 1
MM 2 2
T = M- 3 - 1
MM 2 2
MN 00
3 -1
2 2
3 +1
2 2
0
0
1
0
OP
P
3+ 3P
P
2 P
0 P
1 PQ
3+ 3
2
(5.47b)
www.FreeLibros.me
5.3
Transformacin de coordenadas
99
donde TAt y TAr son las matrices de 4 4 proporcionadas en la ecuacin (5.46b). Las
matrices [TA]F, [TB]F y T se calculan como sigue:
LMC30 S30 0
M
[T ] = M S30 C30 0
MM 0 0 1
MN 0 0 0
LM C45 S45 0
- S 45 C 45 0
[T ] = M
MM 0 0 1
MN 0 0 0
LM 3 1 3 1
MM 2 2 2 2
3 1
3 1
T = M
MM 2 2 2 2
0
MN 00
0
A F
B F
1
2
3
1
2
0
1
3
OP
0 P
0 P
P
1 PQ
OP
PP
PP
PQ
0
0
1
0
(5.48b)
53 3
2 2
3 3
2 2
0
1
OP
PP
PP
PP
Q
(5.48c)
Cuando se comparan las ecuaciones (5.47b) y (5.47c), slo las coordenadas del origen del sistema B son diferentes, como queda claro a partir de las figuras 5.21a-b).
Ejemplo 5.15
donde tam y tbm representan las matrices [TA]F y [TB]F, respectivamente, mientras que la matriz resultante [TA]F se denota por tm. Puede verificarse fcilmente
que la ecuacin (5.48c) es la expresin proporcionada pot tm.
www.FreeLibros.me
100
5.4
CAPTULO
Transformaciones
Un manipulador robtico consiste en varios eslabones, usualmente conectados por articulaciones de un solo grado de libertad, por ejemplo, una articulacin rotacionalo prismtica.
Con el fin de controlar el efector final respecto a la base, es necesario encontrar la relacin
entre los sistemas de coordenadas adjuntos al efector
final y la base. Esto puede obtenerse a partir de la desLa primera aparicin
cripcin de las transformaciones de coordenadas adde los parmetros DH
juntadas a todos los eslabones que forman la descripLos parmetros DH aparecieron por
cin general de manera recursiva. Para este propsito,
vez primera en 1955 (Denavit y Harel material que se presenta en la seccin previa para
tenberg, 1955) para representar una
describir la posicin y orientacin del cuerpo rgido es
lnea dirigida que no es otra cosa que
el eje de una articulacin de par intil para obtener la composicin de transformaciones
ferior.
de coordenadas entre los sistemas consecutivos. Como
primer paso, deber derivarse un mtodo sistemtico
general para definir la posicin y orientacin relativa de los dos eslabones consecutivos. El problema es la definicin de los dos sistemas adjuntos a los dos eslabones sucesivos y el clculo
de la transformacin de coordenadas entre ellos. En general, los sistemas de referencia se
eligen de manera arbitraria mientras estn de manera adjunta al eslabn al que se refieran. No
obstante, conviene establecer algunas reglas para la definicin de los sistemas de eslabones.
La convencin que aqu se adopta para un robot de cadena serial como el que se muestra
en la figura 5.22 es que tiene n + 1 eslabones, es decir, vnculo #0, ... #n, acoplados por n
articulaciones, es decir, articulacin 1, ... n.
Ahora, en la figura 5.23,
4
a) Supongamos que el eje i denota el
#3
eje de la articulacin que conecta
3
i
el eslabn i 1 al vnculo i.
b) Un sistema de coordenadas Xi, Yi, Zi
#i
#2
se adjunta al extremo del eslabn
i 1, no al eslabn i, para i = 1, ...
2
i+1
n + 1.
c) Elija el eje Zi a lo largo del eje de la
#1
n
articulacin i, cuyo sentido positi#n
vo puede tomarse hacia cualquier
1
direccin del eje.
Base fija
d) Ubique el origen Oi en la intersecEfector final
cin del eje Zi con la perpendicular
Figura
5.22
Manipulador
serial
comn a Zi1 y Zi. Tambin localice
Oi sobre Zi en la interseccin de la
perpendicular comn a Zi y Zi+1.
e) Elija el eje Xi a lo largo de la perpendicular comn a los ejes Zi1 y Zi con la direccin
del primero al ltimo.
f ) Elija el eje Yi para que se complete con un sistema de referencia derecho.
www.FreeLibros.me
5.4
101
Zi, Z9i, Z 0i
Articulacin i
Zi, Zi + 1
Zi 1
Eslabn i 1
Eslabn i
Articulacin i + 1
Articulacin i 1
i
ai
Oi
i Oi + 1 X0i, X-i, Xi
bi
ai 1
+1
Xi
Oi
Xi
Articulacin i + 1
Eslabn i
Articulacin i 1
Eslabn i 1
i
Oi + 1
i 1 O a
i
i
ai 1
bi
Oi
Figura 5.23
Observe que las convenciones arriba ilustradas no dan una definicin nica de los sistemas de eslabones en los siguientes casos:
www.FreeLibros.me
102
CAPTULO
Transformaciones
Para el sistema 1 que se une a la base fija, es decir, el eslabn 0, slo se especifica el
sentido de los ejes Z1. Entonces O1 y X1 pueden elegirse en forma arbitraria.
Para el ltimo sistema n + 1 no aplica la convencin mencionada, ya que no existe
ningn eslabn n + 1. Por ende, el sistema n + 1 puede elegirse en forma arbitraria.
Cuando dos ejes consecutivos son paralelos, la perpendicular comn entre ellos no se
define de manera nica.
Cuando se cruzan dos ejes consecutivos, el sentido de Xi es arbitrario.
Cuando la articulacin i es prismtica, slo se determina el sentido del eje Zi, mientras
que la ubicacin de Oi es arbitraria.
En todos estos casos, puede explotarse la indeterminacin para simplificar el proceso. Por
ejemplo, los ejes del sistema n + 1 pueden hacerse paralelos a los del sistema n. Una vez que
se hayan establecido los sistemas de los eslabones, la posicin y orientacin de el sistema
i respecto a el sistema i 1 quedan completamente especificadas por los cuatro parmetros
que se conocen como parmetros de Denavit y Hartenberg (DH). Por tanto, a estos sistemas
tambin se les conoce como sistemas de referencia de DH. Los cuatro parmetros DH se
definen como sigue:
a) bi (Desplazamiento de la articulacin) Longitud de las intersecciones de las perpendiculares comunes en el eje de articulacin Zi, es decir, Oi y Oi. sta es la
posicin relativa de los eslabones i 1 e i. Esto se mide como la distancia entre Xi y Xi+1 a
lo largo de Zi.
b) p i (ngulo de la articulacin) Es el ngulo entre las proyecciones ortogonales de las perpendiculares normales Xi y Xi+1 a un plano perpendicular del eje de la articulacin Zi. La rotacin es positiva cuando se realiza en el sentido contrario a las manecillas
del reloj. Es el ngulo relativo entre los eslabones i 1 e i. Esto se mide como el ngulo entre
Xi y Xi+1 alrededor de Zi.
c) ai (Longitud del eslabn) La longitud entre Oi y Oi+1. Esto se mide como la
distancia entre las perpendiculares comunes a los ejes Zi y Zi+1 a lo largo de Xi+1.
d) `i (ngulo de torsin)
As, para un tipo de articulacin dada, es decir, rotacional (revoluta) o prismtica, uno
de los parmetros DH es variable, lo que se denomina variable de articulacin, mientras
que los tres parmetros restantes son constantes y se llaman parmetros de eslabones.
www.FreeLibros.me
5.4
Ejemplo 5.16
103
X4
La figura 5.24 muestra un brazo planar de tres eslabones. Los sistemas de coordenadas para definir
los parmetros DH se muestran en la figura. Los
X3
Y4
a3 #3
parmetros DH se tabulan en la tabla 5.2, donde
3
Y
a1 y qi, para i = 1, 2, 3, son las longitudes de los
3
eslabones y los ngulos de articulaciones, respecY2 a2 #2
tivamente. El eje Zi es perpendicular al plano de la
Y1
pgina y X1 se elige en forma arbitraria. Observe
2
X2
que el sistema 1, es decir, X1, Y1 y Z1, se adjunta al
a1
eslabn denotado como #0. Puesto que no existe
#1
1
un vnculo 4, el sistema 4 puede ser asignada arX1
#0
bitrariamente, de tal modo que su eje X se sita
a lo largo del eslabn, tal como se hizo para los Figura 5.24 Un brazo planar de
sistemas 2 y 3.
tres eslabones
Tabla 5.2
Eslabn
bi
qi
ai
ai
q1 (JV)
a1
q2(JV)
a2
q3(JV)
a3
Cabe sealar lo siguiente: para que un miembro de dos eslabones tenga las dos
articulaciones rotacionales o revolutas, es decir, que la #3 se remueva de la figura 5.24,
los parmetros DH de la tabla 5.2, sin la tercera hilera, siguen siendo vlidos.
Ejemplo 5.17
Eslabn
bi
qi
ai
ai
q 1(JV)
p/2
b2(JV)
www.FreeLibros.me
104
CAPTULO
Transformaciones
Y1
X3
X2
Z2, Z3
b2
EE (x, y)
X1
1
R
Figura 5.25
Ejemplo 5.18
Y1
(x, y) X3
a2
P
EE
2
R
b1
Y2
Z1
X2
Figura 5.26
Tabla 5.4
Eslabn
bi
qi
ai
ai
b1(JV)
p/2
q2(JV)
ai
Ejemplo 5.19
Respecto al brazo de robot del tipo esfrico que se muestra en la figura 5.27, observe
que el primero y segundo eslabones, es decir, #1 y #2, se entrecruzan y la longitud del
primero no afecta el movimiento del efector final debido a la rotacin de la primera
articulacin. Por lo tanto, es til situar tanto el primer como el segundo sistema de
www.FreeLibros.me
5.4
105
Z3 , Z 4
Z 1, Y 2
O4
X1, X2
Y1
X4
2
O2, O 2
1
Y4
#3
b2
b3
#2
#1
X3
O3
Z2 , Y 3
#0
Figura 5.27
5.4.1
Eslabn
bi
qi
ai
ai
q1 (JV)
p/2
b2
q2 (JV)
p/2
b3(JV)
Tb
LM1
0
= M
MM0
N0
0
1
0
0
0 0
0 0
1 bi
0 1
OP
PP
PQ
(5.49a)
106
CAPTULO
Transformaciones
b) El sistema desplazado, es decir, el sistema i, se gira con un ngulo qi alrededor del eje
Zi, lo que lleva el eje Xi (paralelo a Xi) en alineacin con el eje Xi+1. El nuevo sistema
se llama i. La matriz de transformacin correspondiente es
Tq
LMCq
Sq
= M
MM 0
N0
i
i
- Sq i
Cq i
0
0
OP
PP
PQ
0
0
1
0
0
0
0
1
(5.49b)
c) Deslice el sistema i mediante ai a lo largo del eje Xi ( Xi+1). Esto lleva al origen
del sistema i, Oi ( Oi ) en coincidencia con Oi+1. La matriz de transformacin correspondiente es
Ta =
LM1
MM0
MN00
0
1
0
0
0 ai
0 0
1 0
0 1
OP
PP
PQ
(5.49c)
Ta
LM1
0
= M
MM0
N0
0
Ca i
Sa i
0
0
- Sa i
Ca i
0
OP
PP
PQ
0
0
0
1
(5.49d)
La resultante transformacin de coordenadas entre los sistemas conectados con los cuerpos i 1 e i, es decir, Ti, se obtiene ahora mediante la posmultiplicacin de las cuatro transformaciones elementales de arriba, como se hace en la ecuacin (5.31d), es decir,
Ti = Tb Tq Ta Ta
(5.50a)
La expresin Ti tambin puede leerse como matriz de transformacin del sistema adjuntado al cuerpo i, es decir, sistema i + 1, como se representa en el sistema incorporado al
cuerpo i 1, es decir, sistema i. Por medio de sustitucin de las expresiones de matriz de las
ecuaciones (5.49 a-d) a la ecuacin (5.50a), se obtiene la siguiente expresin:
LMCq
Sq
T = M
MM 0
N0
i
i
i
- Sq i Ca i
Cq i Ca i
Sa i
0
Sq i Sa i
- Cq i Sa i
Ca i
0
ai Cq i
a i Sq i
bi
1
OP
PP
PQ
(5.50b)
www.FreeLibros.me
5.4
Ejemplo 5.20
107
Conforme a la figura 5.24 y a los parmetros DH indicados en la tabla 5.2, las matrices
de transformacin homognea Ti pueden derivarse de la ecuacin (5.50b) como
LMCq
Sq
T = M
MM 0
N0
i
i
Ejemplo 5.21
- Sq i
Cq i
0
0
OP
PP
PQ
0 ai Cq i
0 a i Sq i
, para i = 1, 2, 3
1
0
0
1
(5.51)
Conforme a la figura 5.25 y a los parmetros DH indicados en la tabla 5.3, las matrices de transformacin homognea Ti, para i 1, 2, pueden derivarse de la ecuacin
(5.50b) como
T1
LMCq
Sq
= M
MM 0
N0
Ejemplo 5.22
1
1
OP
PP
PQ
0 Sq 1
0 - Cq 1
1
0
0
0
0
0
, y T2 =
0
1
LM1
MM0
MN00
0
1
0
0
0 0
0 0
1 b2
0 1
OP
PP
PQ
(5.52)
Conforme a la figura 5.26 y a los parmetros DH indicados en la tabla 5.4, las matrices de transformacin homognea Ti para i = 1, 2, pueden derivarse de la ecuacin
(5.50b) como
T1
T2
LM1
0
= M
MM0
N0
LMCq
Sq
= M
MM 0
N0
2
2
0 0
0 -1
1 0
0 0
- Sq 2
Cq 2
0
0
0
0
b1
1
OP
PP
PQ
0 a2 Cq 2
0 a2 Sq 2
1
0
0
1
www.FreeLibros.me
OP
PP
PQ
(5.53)
108
CAPTULO
Transformaciones
Ejemplo 5.23
Conforme a la figura 5.27 y a los parmetros DH indicados en la tabla 5.5, las matrices de transformacin homognea Ti, para i = 1, 2, 3, pueden derivarse de la ecuacin
(5.50b) como
LMCq
Sq
= M
MM 0
N0
LM1 0
0 1
= M
MM0 0
N0 0
1
T1
T3
Ejemplo 5.24
0 Sq 1
0 - Cq 1
1
0
0
0
0 0
0 0
1 b3
0 1
OP
PP
PQ
LM
MM
MN
Cq 2
0
Sq 2
0
, y T2 =
0
0
1
0
OP
PP
PQ
0 Sq 2
0 - Cq 2
1
0
0
0
OP
PP
PQ
0
0
,
b2
1
(5.54)
Para obtener la ecuacin (5.50b), las operaciones simblicas tienen que ejecutarse en
MATLAB. Para este fin, se usan los siguientes comandos:
>syms bi thi ai ali;
>tbm=[1,0,0,0;0,1,0,0;0,0,1,bi;0,0,0,1];
>tthm=[cos(thi),-sin(thi),0,0;sin(thi),cos(thi),0,0;0,0,1,0;0,0,0,1];
>tam=[1,0,0,ai;0,1,0,0;0,0,1,0;0,0,0,1];
>talm=[1,0,0,0;0,cos(ali),-sin(ali),0; 0,sin(ali),cos(ali),0; 0,0,0,1];
>tim=tbm*tthm*tam*talm
tim =
[
cos(thi), -sin(thi)*cos(ali),
sin(thi)*sin(ali),
cos(thi)*ai]
[
sin(thi), cos(thi)*cos(ali), -cos(thi)*sin(ali),
sin(thi)*ai]
[
0,
sin(ali),
cos(ali),
bi]
[
0,
0,
0,
1]
donde el comando syms se usa para definir las variables simblicas bi, thi,
ai y ali para los parmetros DH bi, qi, ai y ai, respectivamente. Adems, se usan
las notaciones tbm, tthm, tam y talm para representar las matrices Tb, Tq, Ta
y Ta, dadas por las ecuaciones (5.49a-d), respectivamente. Finalmente, la resultante
matriz Ti denotada como tim en el ambiente de MATLAB, se evala arriba, lo que
coincide con la ecuacin (5.50b).
www.FreeLibros.me
Ejercicios
109
RESUMEN
En este captulo, primero se define la postura o configuracin del cuerpo rgido. Se presentan sus representaciones. Tambin se define la matriz de transformacin homognea
que se ocupa tanto de la traslacin como de la rotacin de un sistema de coordenadas
entre s. En la ltima parte, se introducen los parmetros de Denavit y Hartenberg (DH)
y se deriva la matriz de transformacin homognea correspondiente.
EJERCICIOS
5.1
Compruebe lo siguiente:
a)
b)
c)
d)
5.2
5.3
5.4
5.5
QA
5.6
LMC30
= M S 30
MN 0
OP
PP
Q
LM
MM
N
OP
PP
Q
- S 30 0
C45 - S 45 0
C 30 0 , y QB = S 45 C 45 0
0
1
0
0
1
(5.55)
110
CAPTULO
Transformaciones
5.7
Si [TA]F fuese la matriz homognea que representa una transformacin del sistema
fijo a un nuevo sistema de referencia A respecto al sistema F, y si [TB]F fuese otra
transformacin a uno sistema B, tambin respecto al sistema F, busque la matriz
de transformacin resultante. Comente los resultados obtenidos en sta y en la
anterior pregunta.
5.8 Busque los parmetros DH del robot SCARA que aparece en la figura 5.28.
5.9 La figura 5.29 muestra un brazo articulado antropomorfo. Busque los parmetros
DH.
5.10 Busque las matrices de transformacin homognea para la arquitectura de robot
que se muestra en la figura 5.29.
5.11 Busque los parmetros DH del brazo esfrico que se muestra en la figura 5.30.
5.12 Cules son las matrices de transformacin homognea para la arquitectura de
robot de la figura 5.30?
Z 3, Z 4
Z2
Z1
2
b2
b3
b1
a1
a2
4
Figura 5.28
Un robot SCARA
www.FreeLibros.me
b4
q2
Z1
Z2
Z3
q3
X1, X2
a2
X3
a3
X4
q1
Figura 5.29
Z1, X3, X4
Z4
Un brazo articulado
Z2
2
X1, X2
O1, O2, O3
3
Z 3, Z 4
Figura 5.30
Un brazo esfrico
www.FreeLibros.me
111
Captulo
6
Cinemtica
Para que un robot ejecute una tarea especfica, primero que nada deber establecerse la
posicin y la orientacin del efector final, es decir, su posicin o configuracin en relacin
con su base. Esto es esencial para resolver problemas de posicionamiento. Una vez que
las relaciones mencionadas se diferencian una y dos
veces, surgen entonces los problemas de anlisis de
Cinemtica inversa vs.
la velocidad y aceleracin necesarios para el control
directa
de movimientos uniformes del efector final, as como
el anlisis dinmico del robot en cuestin. Puesto que
Mientras que la cinemtica inversa
de robots seriales permite encontrar
la configuracin del efector final se determina por las
mltiples soluciones, la cinemtica
seis variables cartesianas que se controlan mediante
directa slo tiene una solucin.
los movimientos de las articulaciones del robot, es necesario encontrar las relaciones entre los dos conjuntos. En el anlisis de posicin, se encuentra una relacin entre las coordenadas cartesianas,
es decir, la posicin de un punto en el efector final y su orientacin con los ngulos de las
articulaciones. Aqu existen dos tipos de problemas: la cinemtica directa y la inversa, como
se ilustra en la figura 6.1. En la cinemtica directa, las posiciones de las articulaciones ya
estn determinadas y el problema radica en encontrar la configuracin del efector final. En
la cinemtica inversa, se resuelve inverso, es decir, la posicin del efector final est determinada y el problema radica en encontrar los ngulos de las articulaciones.
www.FreeLibros.me
6.1
113
Q, p
3
3
1,
2,
y
3
Cinemtica directa
Q
y
p
Cinemtica inversa
Tiempo
2
Tiempo
1
Tiempo
Figura 6.1
6.1
En la cinemtica directa para posicin, las posiciones de las articulaciones, es decir, los ngulos de las articulaciones de revoluta y el desplazamiento de las articulaciones prismticas
se conocen. La tarea es encontrar la configuracin del efector final, es decir, su posicin y
orientacin. Esto puede obtenerse a partir de las ecuaciones de clausura, como se explicar
en los siguientes pasos:
a) De acuerdo con las reglas que se dieron en la seccin 5.4, adjunte un sistema de coordenadas a cada uno de los eslabones n + 1 del robot, donde el sistema 1 se adjunta
al sistema de coordenadas fijo y el sistema n + 1, al efector final o cuerpo n-simo.
b) Defina los parmetros Denavit-Hartenberg (DH) que se presentaron en la seccin
5.4.
c) Escriba las matrices de transformacin homognea de la ecuacin (5.50) como T1,
T2 Tn, donde Ti para i = 1, n, que representa la transformacin del cuerpo i
o sistema i + 1 respecto a su cuerpo anterior i 1, o sistema adjunto a l, es decir,
sistema i.
a1
1
Figura 6.2
X1
www.FreeLibros.me
114
CAPTULO
Cinemtica
(6.2)
(6.3)
Ejemplo 6.1
LMc
s
T M
MM 0
N0
- si
ci
0
0
0 ai ci
0 ai si
1
0
0
1
OP
PP
PQ
www.FreeLibros.me
(6.4)
6.1
115
LMc
s
TM
MM 0
N0
12
12
- s12
c12
0
0
0 a1 c1 + a2 c12
0 a1 s1 + a2 s12
1
0
0
1
OP
PP
PQ
(6.5)
donde s12 sen 12; c12 cos 12; y 12 1 + 2 i, siendo el ngulo de la i-sima
articulacin, como se indica en la figura 6.2. Adems,
a1 c1 + a2 c12 px
y
a1 s1 + a2 s12 py
donde px y py se muestran en la figura 6.2. Conociendo los valores numricos de los
parmetros DH, a saber, a1 y a2 aqu, y los valores de entrada de 1 y 2, puede calcularse fcilmente la matriz T, que especificar la posicin del punto P en el efector
final y la orientacin del efector final, es decir, .
Ejemplo 6.2
En la figura 5.25, se muestra un brazo planar rotacional-prismtico (RP) cuyos parmetros DH se evalan en la tabla 5.3. Sus matrices de transformacin homognea T1 y
T2 tambin se obtienen con la ecuacin (5.52). Por lo tanto, la relacin de cinemtica
directa que proporciona la matriz de 4 4 T = T1T2 puede obtenerse como
LMc
MMs0
MN 0
Ejemplo 6.3
0 s1
0 - c1
1 0
0 0
b2 s1
- b2 c1
0
1
OP
PP
PQ
(6.6)
Los parmetros DH del brazo, como se muestra en la figura 6.3, se presentan en la tabla 5.2. Las tres matrices de transformacin homognea Ti, i = 1, 2, 3, se obtienen entonces con la ecuacin (5.50b). stas aparecen en la ecuacin (6.4). La solucin para
el anlisis de posicin de cinemtica directa del manipulador se da entonces como
www.FreeLibros.me
116
CAPTULO
Cinemtica
X4
a3
Y2
Figura 6.3
X3
Y3
Y1
X2
a1
1
X1
T = T1 T2 T3
donde T representa la posicin o configuracin del efector final respecto a su base, es
decir, el sistema 1. La matriz de 4 4 T se expresa como
LMc
s
TM
MM 0
N0
123
123
- s123
c123
0
0
0 a1 c1 + a2 c12 + a3 c123
0 a1 s1 + a2 s12 + a3 s123
1
0
0
1
OP
PP
PQ
(6.7)
donde s12, c12 y 12 se definen segn la ecuacin (6.5). Adems, s123 sen 123; c123 cos
123 y 123 12 + 3 1 y que se muestran en la figura 6.3. Adems, a1c1 + a2c12
+ a3c123 px, y a1s1 + a2s12 + a3s123 py, donde px y py se indican en la figura 6.3.
Observe que el uso directo de las ecuaciones (6.2) y (6.3) para el caso planar tambin proporciona las expresiones = 123, y las relaciones arriba mencionadas de px y
py, respectivamente, lo cual ser computacionalmente ms eficiente.
Ejemplo 6.4
T1
LMc
s
M
MM 0
N0
- s1
c1
0
0
OP
PP
PQ
0 a1 c1
0 a1 s1
, T2
1 b1
0
1
LMc
MMs0
MN 0
- s2
c2
www.FreeLibros.me
0
0
0 a2 c 2
0 a 2 s2
b2
1
0
1
OP
PP
PQ
(6.8a)
6.1
T3
LM1
0
M
MM0
N0
LM
MM
MN
OP
PP
PQ
0
1
0
0
117
- s4
0 0
c4
0 0
s4
, T4
1 b3
0
0 1
0
c4
0
0
0 0
0 0
1 b4
0 1
OP
PP
PQ
(6.8b)
LMc
s
TM
MM 0
N0
124
- s124
124
c124
OP
a s +a s
P
b +b +b +b P
PQ
1
a1 c1 + a2 c12
1 1
2 12
3
(6.9)
Ejemplo 6.5
LMc c
s c
T= M
MM s
N0
1 2
1 2
2
Ejemplo 6.6
s1 c1 s2
- c1 s1 s2
- c2
0
0
0
b2 s1 + b3 c1 s2
- b2 c1 + b3 s1 c2
- b3 c2
1
OP
PP
PQ
(6.10)
LMc c
s c
TM
MM - s
N 0
1 23
1 23
23
- c1 s23
- s1 s23
- c23
0
- s1
c1
0
0
c1 ( a2 c2 + a3 c23 )
s1 ( a2 c2 + a3 c23 )
- ( a2 s2 + a3 s23 )
1
www.FreeLibros.me
OP
PP
PQ
(6.11)
118
CAPTULO
Cinemtica
Ejemplo 6.7
LMc c c - s s
s c c +c s
T= M
MM s c
N 0
1 2 3
1 3
1 2 3
1 3
2 3
Ejemplo 6.8
- c1 c2 s3 - s1 c3
- s1 c2 s3 + c1 c3
- s2 s3
0
- c1 s2
- s1 s2
c2
0
OP
PP
PQ
0
0
0
1
(6.12)
O 1, O 2
Z2
X4
X1, X2
Z3
O 3, O 4
X5
O 5 , O6
a1e, a2e
X6
Z4
X3
6
O7
Z6
Z7
Figura 6.4
Efector
terminal
X7
www.FreeLibros.me
Z5
6.1
LMq
Q Mq
MNq
y
11
q12
q13
21
q 22
q23
31
q32
q33
119
OP
PP
Q
LM p OP
p Mp P
MN p PQ
1
(6.13a)
donde
q11
q12
q13
q21
q22
q23
q31
q32
q33
(6.13b)
y
p1 = a2 c1c2
p2 = a2 s1c2
p3 = a2 s 2
Tabla 6.1
(6.13c)
bi
ai
1 (JV)
2 (JV)
a2
/2
0
3 (JV)
/2
4 (JV)
/2
5 (JV)
6 (JV)
/2
0
Ejemplo 6.9
www.FreeLibros.me
120
CAPTULO
Cinemtica
Efector terminal
Ze
Xe
b6
Z4, Z 6
Z5
X3
b4 X5, X6
Z3
Z1
a3
X4
a2
Z2
X1, X2
b2
Figura 6.5
Un robot PUMA
LM
MM
N
1 0 0
Q 0 1 0
0 0 1
OP
PP
Q
L
p MM
MNa
Tabla 6.2
bi
a3
b2
2
+ b4
OP
P
+ b PQ
(6.14)
ai
i
/2
0
1 (JV) [0]
b2
2 (JV) [/2]
a2
3 (JV) [/2]
a3
/2
b4
4 (JV) [0]
/2
5 (JV) [0]
b6
6 (JV) [0]
/2
0
JV: Variable de articulacin; los valores dentro de [y] representan los ngulos
para las JV correspondientes a la figura 6.2
www.FreeLibros.me
6.2
121
Ejemplo 6.10
LM- 1
Q M0
NM 0
y
0
-1
0
Efector terminal
Ze
Z 4, Z 6
O
0P
P
1 QP
b4
Z3
Z1
Xe
X5, X6
Z5
X4
X3
b3
Z2
LM 0 OP
p M
b
MNb + b + b PPQ
2
X2
(6.15)
b2
b1
X1
6.2
bi
ai
b1
1 (JV) [0]
/2
b2
3
4
b3 (JV)
b4
2 (JV) []
0
/2
0
4 (JV) [0]
0
0
5 (JV) [0]
6 (JV) [0]
/2
/2
0
122
CAPTULO
Cinemtica
posicin especficas del efector final. La solucin de este problema es de fundamental importancia con el fin de transformar las especificaciones de movimiento asignadas al efector
final en el espacio operacional en los correspondientes movimientos de espacio de las articulaciones. En la cinemtica directa (ecuacin 6.1), la matriz de posicin y rotacin del efector
final se computa en forma nica una vez que se conocen las variables de las articulaciones.
Por otro lado, el problema de la cinemtica inversa es mucho ms complejo debido a las
siguientes razones:
Por lo general, las ecuaciones por resolver son no lineales en las variables de articulaciones; de este modo, no siempre es posible encontrar una solucin explcita.
Pueden existir mltiples soluciones.
Tambin pueden existir soluciones infinitas, por ejemplo, en el caso de manipuladores
robticos cinemticamente redundantes.
Posiblemente no hay soluciones admisibles debido a la arquitectura del manipulador.
6.2.1
i) Solucin algebraica En primer lugar, se ilustra la tcnica de la solucin algebraica. Segn el anlisis de la cinemtica de posicin directa del brazo planar de tres
eslabones, como se realiz en el ejemplo 6.3,
j = q1 + q2 + q3
(6.15a)
www.FreeLibros.me
6.2
px = a1 c1 + a2 c12 + a3 c123
py = a1 s1 + a2 s12 + a3 s123
123
(6.15b)
(6.15c)
Observe que estas ecuaciones son no lineales en los ngulos de las articulaciones 1, 2
y 3. Adems, el problema de la cinemtica inversa se simplifica mediante la subdivisin de
la tarea, es decir, el efector final se orienta ya que se haya posicionado su mueca W de la
figura 6.3. Las coordenadas de W son wx y wy. Las relaciones de posicin de las ecuaciones
(6.15a-c) se reescriben entonces como
wx = px a3 cj = a1 c1 + a2 c12
(6.16a)
wy = py a3 sj = a1 s1 + a2 s12
(6.16b)
Elevando los dos lados de la ecuacin (6.12) al cuadrado, se encuentra
w2x + w2y = a12 + a 22 + 2 a1a2 c2
(6.17a)
que proporciona
c2 =
w 22 w 2z a12 a22
2 a1 a2
(6.17b)
(6.17c)
donde el signo positivo es relativo a la postura del codo hacia arriba y el signo negativo se
refiere a la postura del codo hacia abajo. Por lo tanto, el ngulo 2 se computa como
q2 = atan2 (s2, c2)
(6.18)
donde atan2, en contraste con atan, es una funcin en cualquier lenguaje de computacin, como MATLAB, C, FORTAN, etc., que computa el valor de tan-1( ) en el cuadrante
apropiado. Si un punto se encuentra en el primer y tercer cuadrantes, la funcin atan da
la respuesta en los dos casos que corresponden nicamente al primer cuadrante. Esto es as
porque los argumentos y/x y y(x) dan como resultado el mismo valor numrico. Cuando se
usa atan2, el argumento y/x proporcionar el resultado correspondiente al primer cuadrante, mientras que y/x dar resultados que se encuentran en el tercer cuadrante. Una vez que
se determin 2, el ngulo 1 se encuentra mediante la expansin de c12 y s12 de la ecuacin
(6.16) y su restructuracin como
wx = (a1 + a2 c2 )c1 a2 s1 s2
(6.19a)
wy = (a1 + a2 c2 )s1 + a2 c1 s2
(6.19b)
Con el fin de evaluar 1, la ecuacin (6.19a) se multiplica por a2s2 y la ecuacin (6.19b)
por (a1 + a2c2), seguido por la resta de la primera con respecto a la ltima. Esto da como
resultado el valor de s1 como
(a1 + a2 c2 ) w y - a2 s2 w x
D
En forma parecida, c1 se obtiene como
(6.20a)
(a1 + a2 c2 ) w x + a2 s2 w y
D
(6.20b)
s1 =
c1 =
www.FreeLibros.me
124
CAPTULO
Cinemtica
donde a12 + a22 + 2a1a2c2 = wx2 + wy2. Siguiendo la analoga a la ecuacin (6.18), la solucin
para 1 se obtiene de la siguiente manera:
q1 = atan2 (s1, c1)
(6.20c)
Aqu se presenta
una tcnica de solucin geomtrica. Como el caso visto
anteriormente, el ngulo de orientacin se da en la ecuacin (6.15a) y las coordenadas del origen del sistema
coordenado 3 se computan segn la ecuacin (6.16). La
aplicacin de la ley de los cosenos al ngulo formado
por los eslabones a1, a2 y los puntos de conexin de
segmentos O1 y W, figura 6.3, da como resultado
Por qu geomtrico?
La solucin geomtrica tiene una mejor comprensin grca. Por lo tanto,
es til para el estudio.
(6.22)
Las dos configuraciones admisibles del tringulo se muestran en la figura 6.3. Cuando
se observa cos ( 2) = cos 2 c2, se obtiene inmediatamente la ecuacin (6.17a),
mientras que la existencia del tringulo garantiza lo siguiente:
w x2 + w y2 a1 + a2
Esta condicin no se cumple cuando el punto W se encuentra fuera del espacio de trabajo
que es alcanzable por el brazo. Sin embargo, basado en la suposicin de soluciones admisibles, el ngulo 2 se obtiene como
q2 = cos1 (c2)
(6.23)
w x2 + w y2 cos b = a1 + a2 c2
(6.24a)
donde la determinacin de los ngulos y depende del signo de wx y wy. Adems, la sustitucin de la expresin de c2 de la ecuacin (6.17b) en la ecuacin (6.24a) proporciona el
ngulo , es decir,
b = cos
w x2 + w y2 + a12 + a22
2 a1
w x2 + w y2
(6.24b)
En la ecuacin (6.24 b), debera estar dentro de 0 y con el fin de conservar la existencia
del tringulo. Entonces,
q1 = a b
(6.25)
6.2
Ejemplo 6.11
125
LM 1
MM 23
T
MM 20
MN 0
3
2
1
2
0
0
0
OP
P
3
+ 1P
2
P
0 P
1 PQ
3+
5
2
(6.26a)
donde = 60, y los parmetros DH constantes no cero, segn la tabla 5.2, son a1 =
a2 = 2 unidades, y a3 = 1 unidad. Usando las ecuaciones (6.17b-c), c2 y s2 se calculan
como c2 = 0.866 y s2 = 0.5, que da 2 = 30. Entonces se evalan s1 y c1 segn las
ecuaciones (6.20a-b) como s1 = 0 y c1 = 1. El valor del ngulo de articulacin 1 se
obtiene como 1 = 0. Finalmente, se obtiene 3 segn la ecuacin (6.21) como 3 =
30. Los resultados se resumen abajo:
q1 = 0o, q2 = 30o y q3 = 30o
(6.26b)
Observe que se usaron los valores positivos de s2 para evaluar 2 = 30. El uso del
valor negativo dara como resultado el siguiente conjunto de resultados:
q1 = 26.56o, q2 = 30o, y q3 = 63.43o
Ejemplo 6.12
(6.26c)
www.FreeLibros.me
126
CAPTULO
Cinemtica
s11=((a1+a2*cos(th21))*wy-a2*s2*wx)/del;
a2*s2*wy)/del;
s12=((a1+a2*cos(th22))*wy+a2*s2*wx)/del;
a2*s2*wy)/del;
th11=atan2(s11,c11); th12=atan2(s12,c12);
c11=((a1+a2*cos(th21))*wxc12=((a1+a2*cos(th22))*wx+
6.2.2
th21d=th21*r2d,
th22d=th22*r2d,
Un brazo articulado
Considere el brazo articulado que se presenta en la figura 6.7. Se buscan las variables de
las articulacin 1, 2 y 3, correspondientes a una posicin conocida pw del efector final.
Observe que la relacin cinemtica para pw se expresa en la cuarta columna de la matriz T
en la ecuacin (6.11), segn la cual
q1 = a tan 2 (py, px)
(6.27a)
donde las entradas px y py son iguales a los elementos (4,1) y (4,2) de la matriz T, es decir,
px = c1 (a2 c2 + a3 c23)
y
py = s1 (a2 c2 + a3 c23)
Observe que otra solucin admisible para 1 es
q1 = p + a tan 2 (py, px)
cuando 2 es igual a 2(1), donde 2(1) es una de las soluciones correspondientes a 1 que se obtiene con la ecuacin (6.27a), como se indica en la figura 6.7.
Una vez que se conozca 1, la arquitectura restante es
planar respecto a las variables 2 y 3. Por ende, explotando
la solucin para la mueca del brazo planar de tres eslabones de la subseccin 6.2.1, se obtiene
q3 = a tan 2 (s3, c3)
1
2(2)
X3
(1)
3
a2
(1)
a3
Efector
terminal
pW
X1, X2
Z2
3(2)
s3 1 - c32
y
Z1
(6.28)
en donde
c3
(6.27b)
(6.29)
www.FreeLibros.me
6.2
127
p x2 + p y2
(a 2 + a 3 c3) pz - a 3 s3
D
(a2 + a3 c3 ) p x2 + p y2 + a3 s3 pz
D
El denominador es igual a px2 + py2 + pz2. El problema inverso de este brazo admite
cuatro soluciones. Dos de ellas se presentan en la figura 6.7, mientras que una de las otras dos
es la imagen de espejo de la figura alrededor del eje Z1, seguido por una rotacin alrededor de
Z2 para alcanzar pw. La cuarta solucin es la imagen de espejo de los ltimos dos eslabones
alrededor de X1 desde su ltima configuracin. Para un brazo de robot que es ms genrico
por naturaleza donde se da el desplazamiento del eslabn b2 0, tambin puede verse que
existen cuatro soluciones, como se presenta en la figura 6.8a). Segn los valores de 1, 2 y
3, se conocen como
hombro al frente / codo arriba (SFEU) y hombro-frente / codo abajo (SFED), como
lo muestran las lneas continuas; y
hombro atrs / codo arriba (SBEU) y hombro atrs / codo abajo (SBED), como lo
muestran las lneas punteadas.
Observe que para la configuracin de hombro al frente, las configuraciones de codo arriba
y codo abajo se muestran en la figura 6.8b). Es obvio que la orientacin del antebrazo es
distinta para los dos pares de soluciones. Observe tambin que slo es posible encontrar las
soluciones si px 0 y py 0. En caso de que px = py = 0, la ecuacin (6.27a) no proporciona ningn 1. Adems, se obtiene una infinidad de soluciones y es posible determinar las
variables de las articulaciones 2 y 3, independientemente del valor de 1. A continuacin
se ver que el brazo en una de estas configuraciones es cinemticamente singular y, ms
especficamente, tiene singularidad de hombro.
Hombro
atrs
Codo
arriba
Codo
abajo
Hombro
al frente
Codo arriba, codo abajo
a) Cuatro configuraciones
Figura 6.8
www.FreeLibros.me
128
CAPTULO
Cinemtica
Ejemplo 6.13
Con el fin de encontrar las cuatro soluciones admisibles del brazo que se presenta en
la figura 6.7, deben considerarse los siguientes valores numricos: a2 = a3 = 1 unidad,
y px = 1 unidad, py = pz = 0 unidades. Las soluciones se evalan entonces como
1)
2)
3)
4)
Observe que los valores de px, py y pz se toman de tal modo que las cuatro soluciones
de arriba pueden verificarse fcilmente usando la figura 6.7.
Ejemplo 6.14
www.FreeLibros.me
6.2
129
th21=atan2(s21,c21); th22=atan2(s22,c22);
th23=pi-th21; th24=pi-th22;
%Angles in degree
r2d=180/pi;
th11d=th11*r2d, th12d=th12*r2d, th21d=th21*r2d, th22d=th22*r2d, th23d =
th23*r2d,
th24d = th24*r2d, th31d=th31*r2d, th32d=th32*r2d
6.2.3
Una mueca
Considere la mueca de la figura 6.9, cuyas relaciones cinemticas pueden darse mediante
la ecuacin (6.12). Se buscan las variables de las articulaciones 1, 2 y 3, correspondientes
a una orientacin del efector final Q con la siguiente forma:
LMq
Q Mq
MNq
11
q12
q13
21
q 22
q23
31
q32
q33
OP
PP
Q
donde qij, para i, j = 1, 3, son los elementos de la matriz de bloque Q de la matriz de transformacin homognea T, ecuacin (6.12). Entonces es posible computar las soluciones de
los ngulos de las articulaciones directamente como
q1 = a tan 2 (q23, q13)
q2
= a tan 2 FH
2
q13
2
,
q23
q33
(6.30a)
IK
(6.30b)
(6.30c)
para 2 entre 0 y . Observe que si se permite que cada articulacin gire 360, existen dos
posibles soluciones para los ltimos tres desplazamientos de las articulaciones. En efecto,
ya que las ecuaciones (6.30a-c) involucran la funcin de arcotangente, el ngulo 1 podr
tener dos valores que se encuentran a 180. Las dos configuraciones que corresponden a las
dos soluciones se ilustran en la figura 6.9.
Z1
#3
#3
Z3, Z4
X3, X4
#2
#2
Z2
X1, X2
#1
#1
Solucin i(1)
Figura 6.9
Solucin i(2)
www.FreeLibros.me
130
CAPTULO
Cinemtica
Supongamos que i(1) y i(2) son la primera y la segunda solucin con i(1) i(2). Se relacionan por
q1 (2) = q1 (1) + p; q2(2) = q2 (1);
y q3 (2) = q3(1) + p
FH
q2 = a tan 2 -
2
q13
2
q23
,
q33
IK
(6.31a)
(6.31b)
(6.31c)
Aqu se observa que los ngulos de articulaciones siempre tendrn que obtenerse usando los
valores tan en vez de los valores sen o cos, debido a la razn que se explic despus
de la ecuacin (6.18). Adems, observe que un robot de mueca particionada de 6 DOF tiene
un total de ocho soluciones de cinemtica inversa para el anlisis de posicin.
Ejemplo 6.15
Con el fin de encontrar las dos soluciones de la mueca de la figura 6.9, se consideran
los siguientes valores numricos para la matriz de orientacin Q:
LM0
Q M0
MN1
0
-1
0
OP
0
P
0 PQ
6.3
Jacobiano
ste es un trmino tomado de las matemticas para describir una funcin
vectorial, f(x), para la cual se dene la
jacobiana J como J f/x, que es la
matriz de m n para la funcin m-dimensional f y la variable dependiente
x de la dimensin n.
6.3
131
matriz jacobiana es una de las herramientas ms importantes para la caracterizacin de manipuladores. De hecho, es til para:
i)
ii)
iii)
iv)
Observe que las ecuaciones de cinemtica de posicin que se obtienen con las ecuaciones
(6.1)-(6.3) tienen tanto la matriz de rotacin Q como el vector de posicin p, que son funciones de las variables de articulaciones p [1, n]T. Tanto la posicin como la orientacin
del efector final varan conforme vara p. Aqu el objetivo es expresar la velocidad angular del efector final ve, la velocidad lineal, o simplemente la velocidad ve ( p), igual que una
funcin de las velocidades de las articulaciones , como
(6.32a)
w = J q
e
(6.32b)
ve = Jv q
donde J y Jv son las matrices de 3 n que describen la contribucin de las velocidades de
las articulaciones p a la velocidad angular del efector final ve y la velocidad ve, respectivamente. Las matrices J y Jv tambin son las funciones de las variables de articulacin p. Las
ecuaciones (6.32a-b) pueden escribirse en forma compacta como
t = Jq
(6.33)
e
donde
J
LMJ OP
NJ Q
w
v
T T
132
CAPTULO
Cinemtica
Puesto que el vector [x]M es la representacin del vector x fijo en el sistema mvil
M, su expresin en el sistema M no cambia cuando se mueve el cuerpo. Por lo tanto,
[x]M = 0. Como resultado, la ecuacin (6.37a) se vuelve
[x]
[ x ]F = Q
(6.37b)
M
LM 0
W Mw
MN- w
z
y
-w z
wy
-w x
wx
OP
PP
Q
(6.39)
Ejemplo 6.16
LMcos a
Q M sen a
MN 0
- sen a
cosa
0
P0PO
1 PQ
0
www.FreeLibros.me
(6.40)
6.4
Velocidades de eslabones
133
LM- a sena
= a cos a
Q
MM
N 0
- a cos a
- a sen a
0
OP
P
0 PQ
0
0
(6.41a)
Por lo tanto, la matriz del producto cruz W, asociada con el vector de velocidad
angular v, se calcula como
LM
MM
N
0
T
W Q Q = a
0
OP
0P
0 QP
- a
0
0
(6.41b)
6.4
Velocidades de eslabones
Considere un eslabn genrico i de un manipulador. De acuerdo con la convencin de Denavit-Hartenberg (DH) presentada en la seccin 5.4, el eslabn i conecta las articulaciones i e
i + 1, mientras que el eslabn i 1 conecta las articulaciones i 1 e i. Observe que el sistema
i se sujeta al eslabn i 1 con su origen sobre el eje de la articulacin i, como se muestra
en la figura 6.10. Suponga que oi y oi1 son los vectores de posicin de los orgenes de los
eslabones i e i 1, es decir, Oi y Oi1, respectivamente. Suponga que ai1 denota la posicin
del origen del eslabn i respecto al eslabn i 1. De acuerdo con las reglas de la suma de
vectores, puede escribirse
oi = oi1 + ai1
Sistema
coordenado i
Articulacin i 1
Oi1
ai1
Oi
(6.42a)
ei
Articulacin i
Eslabn i 1
oi1
Z
ai
oi
Eslabn i
Oi+1
Articulacin i + 1
Sistema
coordenado
fijo
X
Figura 6.10
www.FreeLibros.me
134
CAPTULO
Cinemtica
donde a i1 = i1 ai1, en el cual vi1 es la velocidad angular del eslabn i 1. Puesto que oi
y oi1 son tambin los vectores de posicin de los puntos en los eslabones i e i 1, respectivamente, la ecuacin (6.43b) proporciona la expresin de la velocidad lineal del eslabn i
como funcin de la velocidad y de la velocidad angular del eslabn i 1. Para la expresin
de la velocidad angular del eslabn i, v1, puede obtenerse como
w i = w i1 + w i,i1
(6.43)
donde vi1 es la velocidad angular del eslabn i 1 y vi,i1 es la velocidad angular relativa del
eslabn i respecto al eslabn i 1. Observe que las ecuaciones (6.42a-b) logran expresiones
distintas, dependiendo del tipo de articulacin i, es decir, de revoluta o prismtica.
i1
i i
o i = o i1 + w i1 ai1
(6.44b)
Articulacin prismtica Una articulacin prismtica slo permite el movimiento de traslacin relativo. Es decir, la longitud de articulacin bi es variable y no hay movimiento angular relativo entre los eslabones i 1 e i. Por lo tanto,
w i = w i1
(6.45a)
i1
i1
i1
i i
(6.45b)
6.5
Computacin jacobiana
Aqu se derivar la expresin general para la matriz jacobiana J, ecuacin (6.33). Puesto que
el efector final es el cuerpo n-simo de la cadena serial, la velocidad angular y la velocidad
del efector final, ve y ve, respectivamente, se obtienen a partir de las velocidades del n-simo
eslabn, es decir, vn y o n, como
w e w n, y ve = o n + w n ane
(6.46)
donde ane es el vector de posicin tridimensional del efector final respecto al origen del
n-simo eslabn On. Entonces se computan las velocidades de los eslabones empezando deswww.FreeLibros.me
6.5
Computacin jacobiana
135
de el cuerpo fijo, es decir, el eslabn 0, y siguiendo las relaciones recursivas que se obtienen
con las ecuaciones (6.44a-b) o con las ecuaciones (6.45a-b), dependiendo del tipo de articulaciones que se usan. Por ejemplo, si todas las articulaciones son de rotacin, entonces
w0 = 0
w 1 = q 1 e1
w n = q 1 e1 + q 2 e2 + + q n en
(6.47a)
(6.47b)
(6.47c)
o 1 = 0
o 2 = o 1 + w 1 a1 = q 1 e1 a12
o n = q 1 e1 a1, n + q 2 e2 a2, n + + q n1 en1 a n1, n
(6.48a)
(6.48b)
(6.48c)
donde ai,j ai + +aj1 es el vector que conecta el origen del eslabn i al origen del eslabn
j, es decir, Oj. Segn las ecuaciones (6.46)-(6.48), la matriz jacobiana J de la ecuacin (6.33)
puede escribirse como
J =
LM e
Ne a
1
1e
e2
en
e 2 a 2 e e n a ne
OP
Q
(6.49)
donde ai,e ai,n + an es el vector presentado en la figura 6.4 para i = 1,2, y J es la matriz de 6
n. Segn la ecuacin (6.49), la i-sima columna de la matriz, J, denotada como ji, puede
escribirse como
LM e OP si la articulacin i es de rotacin, y
Ne a Q
L0O
j M P si la articulacin i es prismtica
Ne Q
i
ji
(6.50a)
i, e
(6.50b)
Ejemplo 6.17
Puesto que hay dos articulaciones rotacionales que slo pueden usarse para el posicionamiento del efector final, el rengln de bloques superior de la ecuacin (6.49) que
corresponde a la orientacin del efector final no es relevante. Por lo tanto, el jacobiano
del manipulador de dos eslabones puede expresarse como
J = [e1 a1e e2 a 2e ]
e1 e2 [0 0 1]T.
Adems, a1e a1 + a2 [a1 c1 + a2 c12 a1 s1 + a2 s12 0]T
a2e a2 [a2 c12 a2 s12 0]T
s1 = sen q1; c1 cos q1; s12 sen (q1 + q2); c12 cos (q1 + q2)
donde
donde
www.FreeLibros.me
(6.51a)
136
CAPTULO
Cinemtica
Observe que todos los vectores, segn la ecuacin (6.51), se expresan en un sistema
fijo, es decir, el sistema 1. Adems, si se extraen los elementos no cero de la ecuacin
(6.51a), la matriz jacobiana de 2 2 resultante se obtiene por
J =
LM- a s - a s
Na c +a c
1 1
1 1
Ejemplo 6.18
2 12
2 12
- a2 s12
a2 c12
OP
Q
(6.51b)
e1 e2 e3 [0
(6.52)
1]T. Adems,
a1e a1 + a2 + a3
a2e
a3e
donde s1, c1, s12 y c12 se definen segn la ecuacin (6.51a), mientras que s123 y c123 se
definen como sigue:
s123 y sen (R1 + R2 + R3); y c123 y (R1 + R2 + R3)
Una vez que los elementos de los vectores ei y aie para i = 1, 2, 3, representados en
el sistema fijo 1, se sustituyen en la ecuacin (6.52), habr tres renglones no cero
correspondientes al movimiento planar de tres grados de libertad del manipulador,
que son relevantes, es decir,
LM
MM
N
1
J = - a1 s1 - a2 s12 - a3 s123
a1 c1 + a2 c12 + a3 c123
- a2 s12 - a3 s123
- a3 s123
a2 c12 + a3 s123
a3 c123
OP
PP
Q
(6.53)
Los tres renglones de arriba se refieren a los componentes del valor escalar de la velocidad angular alrededor del eje Z1, y a los dos valores para la velocidad lineal a lo
largo de los ejes X1, Y1, respectivamente.
Ejemplo 6.19
La matriz jacobiana para la parte del brazo del robot articulado antropomrfico que
se muestra en la figura 6.4 se obtiene segn la ecuacin (6.49). Los elementos de los
vectores se obtienen mediante las matrices de transformacin que se dieron en el
ejemplo 6.6, es decir,
www.FreeLibros.me
6.5
[e1]1
y
[a1e]1 [a2e]1
LM0OP
0 ; [e ]
MM1PP
NQ
2
Computacin jacobiana
LM- s OP
c
MM PP
N0Q
1
1 [e3]1
LMc (a c + a c
Ms (a c + a c
MN - (a s + a s
2 2
3 23 )
2 2
3 23
2 2
3 23
(6.54a)
OP
) P ; [a
) PQ
3e]1
LMa c c
Ma s c
MN - a s
3 1 23
[a3]1
3 1 23
3 23
0
LM
0
MM
1
J = M
+a c )
s
(
a
c
MM
MM c (a c 0+ a c )
N
1
Ejemplo 6.20
2 2
2 2
3 23
3 23
137
- s1
- s1
c1
c1
0
0
- c1 (a2 s2 + a3 s23) - a3 c1 s23
- s1 (a2 s2 + a3 s23) - a3 s1 s23
- (a2 c2 + a3 c23)
- a3 c23
OP
PP
PP
PP
PQ
OP
PP
Q
(6.54b)
(6.54c)
www.FreeLibros.me
138
CAPTULO
Cinemtica
Ejemplo 6.21
La matriz jacobiana del robot PUMA para la configuracin presentada en la figura 6.5
se obtiene del programa MATLAB del ejemplo 6.20 como
LM 0
MM 01
J= M
MM- b - b - b
MMN a + 0a
2
3456
0
1
0
a2 + b4 + b6
0
- a3456
0
1
0
b4 + b6
0
- a3456
0
0
1
- b5
a456
0
0
1
0
b6
0
- a56
OP
PP
PP
a P
P
0 PQ
0
0
1
0
(6.55)
donde a56 a5 + a6; a456 a4 + a56; y a3456 a3 + a456. Segn la ecuacin (6.55), puede
verificarse que por lo menos los primeros tres renglones son verdaderos, ya que son
los componentes de los vectores unitarios que representan los ejes de las articulaciones de revoluta del robot PUMA en el sistema fijo, es decir, el sistema 1.
6.6
www.FreeLibros.me
6.6
6.6.1
139
LMw OP
N o Q
i
ti
(6.56)
(6.57a)
LM
Na
O
i, i -1 1 1
y
pi
LMe OP
N0Q
i
OP
Q
(6.57b)
Observe aqu que el vector pi de arriba es distinto del vector tridimensional p de la ecuacin (6.3) que representa la posicin del efector final de un robot. Tambin en la ecuacin
(6.57b), ai,i1 ai1,i = ai1 es el vector del origen del cuerpo i al origen del (i 1), 1 y O son
las matrices de 3 3 de identidad y cero, respectivamente, 0 es el vector tridimensional de
ceros y ai,i1 1 es el tensor del producto vectorial asociado con el vector ai,i1 que se define
como (ai,i1 1)x = ai,i1 x, para cualquier vector cartesiano tridimensional x. La matriz Ai,i1
y el vector pi tienen las siguientes interpretaciones fsicas:
1) Si q i = 0, es decir, cuando los dos eslabones (i 1) e i se conectan rgidamente, Ai,i1
ti,i1 propaga la rotacin ti1 a ti. Esto quiere decir que la velocidad angular del eslabn
i permanece igual a la de (i 1), es decir, vi = vi1, y la velocidad lineal del punto Oi,
o i se obtiene de la velocidad del punto Oi1, o i1 y de la velocidad angular del eslabn
(i 1), vi1, es decir, o i = o i1 + vi1 ai1. La matriz de 6 6 Ai,i1 se llama aqu matriz
de propagacin de rotacin (Saha, 1999) que tiene la siguiente propiedad:
Ai1,i Ai,i+1 = Ai1,i+1
www.FreeLibros.me
(6.58)
140
CAPTULO
Cinemtica
pii, se suma a los componentes de Ai,i1ti1, dando de esta manera pie a la rotacin real
del cuerpo i-simo ti. Por lo tanto, al vector de seis dimensiones pi se le llama vector de
propagacin de movimiento de articulacin de la i-sima articulacin. Observe aqu
que si la i-sima articulacin es prismtica, la expresin de pi en la ecuacin (6.57a)
cambia a
pi
LM 0 OP
Ne Q
(6.59)
(6.60a)
t2 = A21 t1 + p2q 2
(6.60b)
tn = An,n1 t n1 + pnq n
(6.60c)
(6.61a)
LM t OP LM O
A
t
t M P ;A M
MM PP MM
Nt Q MN O
1
21
OP
LMp
OP
0
;N M
M
P
P
MN 0
O PQ
O
O
A n , n-1
0 0
p2
pn
OP LMq
PP ; q MMq
PQ MMNq
1
2
OP
PP
PP
Q
(6.61b)
Cuando se reescribe la ecuacin (6.61a) como
(1 A) t = Nd q
(6.62)
LM 1
MM A
A
MM
MNA
21
Nl (1 A)1
31
n,1
O
1
A 32
1
A n, n -1
www.FreeLibros.me
OP
P
P
P
OP
1 PQ
O
O
(6.64)
6.6
141
En la ecuacin (6.63) se seala el resultado de N1Nd como matriz de Complemento Ortogonal Natural (NOC), que fue originalmente propuesta por ngeles y Lee (1988), mientras
que la forma desacoplada que se obtiene por la ecuacin (6.63), llamada matrices NOC
Desacopladas (DeNOC), aparecieron por vez primera en Saha (1995). A continuacin se
mostrar cmo pueden usarse las matrices DeNOC para derivar la matriz jacobiana de un
manipulador.
6.6.2
La matriz jacobiana, ecuacin (6.33), se deriva aqu a partir de la definicin de las matrices
DeNOC que aparecen en la ecuacin (6.63). Observe que el efector final de un manipulador
robtico no es ms que una parte del n-simo cuerpo con su posicin distinta de su origen
On. Se ubica en un punto denotado por ane desde On. Por lo tanto, se introduce una matriz de
propagacin de rotacin, digamos Aen, como se define en la ecuacin (6.57b) para encontrar
la rotacin del efector terminal te a partir de tn, es decir,
te = Aen tn
(6.65a)
LM 1 OOP = LM 1 OOP
Na 1 1 Q N- a 1 1 Q
en
(6.65b)
El vector aen se define como el vector ai+1,i ai, i+1 Si se sustituye la expresin de tn de
la expresin de rotacin generalizada t de la ecuacin (6.61b), la ecuacin (6.65a) puede
reescribirse como
t = A N N q
(6.66)
e
en
1n
(6.67)
(6.68a)
(6.68b)
142
6.7
CAPTULO
Cinemtica
Singularidad
Ejemplo 6.22
LM- a s - a s
Na c +a c
1 1
1 1
2 12
2 12
- a2 s12
a2 c12
www.FreeLibros.me
OP
Q
(6.69)
6.8
Anlisis de aceleracin
143
donde det(J) = a1a2s2, lo que implica que el brazo es singular cuando 2 = 0 o . Fsicamente, cuando 2 = 0, el brazo se extiende en forma recta. En esta configuracin,
el movimiento del efector final slo es posible a lo largo de una direccin que es perpendicular al brazo. De igual manera, cuando 2 = , el brazo se dobla completamente
sobre s mismo, y nuevamente el movimiento de la mano slo es posible en un sentido
cartesiano en lugar de dos. stas se llaman singularidades de frontera.
Ejemplo 6.23
LM- s (a c + a c )
= M c (a c + a c )
MN
0
1
Jv
2 2
2 2
3 23
3 23
OP
PP
Q
(6.69a)
1
a a 2 [s(q2 + 2q3) sq2]
2 2 3
(6.69b)
Segn la ecuacin (6.69b), queda claro que una de las configuraciones singulares
sucede cuando 3 = 0 o , es decir, cuando los eslabones 2 y 3 estn en una lnea, esto
es, extendidos o doblados, como en el caso del brazo planar.
6.8
Anlisis de aceleracin
Normalmente, se requieren los resultados del anlisis de aceleracin en los clculos dinmicos donde las fuerzas de inercia se equiparan con las fuerzas externas. Las expresiones de
aceleracin pueden obtenerse mediante la diferenciacin de las expresiones de velocidad.
Por ejemplo, las aceleraciones del efector final de un robot se obtienen al diferenciar la
ecuacin (6.33) como
+ J q
t = J q
(6.70a)
e
T T
donde te = [v e ve ] v e, y ve son las aceleraciones angular y lineal del efector final, respectivamente, y p [1 p n]T, donde 1 representa la aceleracin de articulacin para la
articulacin i. La columna i de J se obtiene por
j
i
LM
Ne a
i
e i
i, e
i, e + e i a
www.FreeLibros.me
OP
Q
(6.70b)
144
CAPTULO
Cinemtica
Los vectores e y a i,e son la derivada de tiempo de los vectores ei y ai,e, que se obtienen de
las ecuaciones (6.50a) y (6.50b), respectivamente.
Ejemplo 6.24
LM
N
Ejemplo 6.25
OP
Q
(6.71)
De manera similar al caso planar del ejemplo 6.24, la derivada respecto al tiempo de
la matriz jacobiana J para el brazo antropomrfico se obtiene por
LM
M
J = MM
MM-c q (a
MM- s q (a
N
1 1
1 1
0
- c1q 1
- c1q 1
0
- s1q 1
- s1q 1
0
0
0
s1q 1 ( a2 s + a3s) - c1 (a2 cq 2 + a3cq 23)
a3s s1q 1 - a3cc1q 23
2c + a3c) + s1( a2 sq 2 + a3sq 23)
2 c + a3c ) - c1 ( a2 sq 2 + a3sq 23) - c1q 1 ( a2 s + a3s) - s1 (a2 cq 2 + a3cq 23) - a3s c1q 1 - a3c s1q 23
a2 sq 2 + a3sq 23
a3sq 23
0
OP
PP
PP
PP
PQ
(6.72)
RESUMEN
En este captulo se hace primero una introduccin a la cinemtica de cuerpos rgidos.
Se presentan las representaciones de posicin y orientacin. Basado en los conceptos
anteriores, se realizan anlisis de posicin, velocidad y aceleracin de un robot serial.
Se hace hincapi en los anlisis de cinemtica directa e inversa y en la matriz jacobiana
que aparece en el anlisis de velocidad. Tambin se introduce el concepto de las matrices
DeNOC para la obtencin de la matriz jacobiana. Se dan varios ejemplos para entender
los conceptos que se introducen en este captulo.
www.FreeLibros.me
145
EJERCICIOS
6.1
6.2
www.FreeLibros.me
Captulo
7
Esttica
Cuando un manipulador robtico ejecuta una determinada tarea, por ejemplo, levantar una pieza de trabajo
de una mquina, su efector final ejerce un momento y
La esttica es la rama de la fsica apliuna fuerza sobre el ambiente externo en el punto de concada que se ocupa del anlisis de los
momentos y las fuerzas que actan
tacto. Esta fuerza y este momento se generan mediante
sobre un sistema que est en equililos actuadores que se instalan en las diferentes articulabrio esttico.
ciones. Para un manipulador serial, los momentos y las
fuerzas de los actuadores se transmiten al punto de contacto por medio de una cadena de lazo
abierto. En la esttica, se busca la relacin entre los pares de torsin/fuerzas, los momentos
cartesianos y las fuerzas aplicadas en el efector final. Lo anterior tiene importancia prctica
para determinar la calidad de la transmisin del momento y la fuerza a travs de las diferentes
articulaciones de un manipulador robtico y sirve como base para clasificar el tamao de eslabones y cojinetes del manipulador, as como para la seleccin de los actuadores apropiados.
Los resultados tambin pueden ser usados para satisfacer el sistema de control. La esttica del
mecanismo espacial puede tratarse por medio de varios mtodos, por ejemplo, el mtodo de
vectores, el principio de trabajo virtual y otros.
En este captulo, se desarrollarn varios mtodos
para representar las fuerzas estticas que actan sobre
Equilibrio esttico
un manipulador robtico y su transformacin entre diferentes sistemas de coordenadas. La transformacin En un equilibrio esttico, un sistema
de momentos y fuerzas entre el espacio del actuador y est en reposo o movindose a veloel del efector final es el centro de este estudio. Con ello cidad constante a travs de su centro
se muestra que los momentos y las fuerzas de entrada de masa.
de actuadores se relacionan con las fuerzas de salida del efector final al trasponer la matriz
Jacobiana del robot, como se observ en el captulo anterior. Adems, se introducen los
diagramas de cuerpo libre para la derivacin de las reacciones generadas en diferentes articuQu es la esttica?
www.FreeLibros.me
7.1
147
laciones. Desde la fase de diseo, es importante una comprensin profunda de las reacciones
de las articulaciones para la clasificacin correcta del tamao de eslabones y actuadores.
Primero se establecern las ecuaciones bsicas que rigen el balance esttico de un eslabn.
Luego se aplicarn estas ecuaciones para el anlisis esttico de manipuladores seriales. Finalmente, se describir el concepto de pares de torsin y transformacin de articulaciones
equivalentes entre las fuerzas del efector final y la torsin de articulaciones equivalentes.
7.1
En un manipulador robtico serial, cada eslabn se conecta a uno o dos eslabones por medio
de varias articulaciones. La figura 7.1 representa las fuerzas y momentos que actan sobre
un eslabn tpico i que se conecta con el eslabn i 1 mediante la articulacin i y con el
eslabn i + 1 mediante la articulacin i + 1. Las fuerzas que actan sobre el eslabn i por el
eslabn i 1 a travs de la articulacin i pueden ser reducidas a una fuerza resultante fi-1,i y
a un momento resultante ni-1,i alrededor del origen Oi del i-simo sistema de coordenadas
adjunta al eslabn (i 1). De manera parecida, las fuerzas que actan sobre el eslabn i +
1 por el eslabn i en la articulacin (i + 1) pueden reducirse a una fuerza resultante fi,i+1 y a
un momento ni,i+1 alrededor del origen Oi+1 del i-simo sistema de coordenadas adjunto al
i-simo eslabn. A continuacin se definen las siguientes notaciones:
fi-1,i : Vector tridimensional de una fuerza resultante ejercida sobre el eslabn i por el eslabn i 1 en Oi.
ni-1,i : Vector tridimensional de un momento resultante ejercido sobre el eslabn i por el
eslabn i 1 en Oi.
fi+1,i : Vector tridimensional de una fuerza resultante ejercida sobre el eslabn i por el eslabn i + 1 en Oi+1. Observe que fi+1,i = fi,i+1.
ni+1,i : Vector tridimensional de un momento resultante ejercido sobre el eslabn i por el
eslabn i + 1 en Oi+1, de tal modo que ni+1,i = ni,i+1.
g : Vector tridimensional de aceleracin debido a la gravedad.
di : Vector tridimensional que denota la posicin del centro de masa del i-simo eslabn
Ci relativo al origen del i-simo sistema, es decir, Oi, como se indica en la figura 7.1.
ri : Vector tridimensional que denota la posicin del origen del (i + 1)-simo sistema, es
decir, Oi+1 relativo al centro de masa del eslabn i, Ci.
ai : Vector de posicin tridimensional de Oi+1 respecto a Oi, de tal modo que ai = di + ri.
Considere ahora el balance de fuerzas y momentos de la figura 7.1. Hay tres fuerzas que
se ejercen sobre el eslabn i: fi1,i, fi+1,i(= fi+1,i) y mig. La ecuacin de balance de fuerzas se
escribe entonces como
fi1,i - fi,i+1 + mi g = 0
(7.1)
(7.2)
148
CAPTULO
7 Esttica
Zi+1
Zi
Articulacin, i
Articulacin, i + 1
Ci
mig
fi, i+1
ri
di
Z1
ai
Oi+1
ni, i+1
ai
Xi
Oi
Y1
ni1, i
fi1, i
X1
Figura 7.1
donde fi1,i y ni1,i son las fuerzas y momentos de reaccin entre el eslabn i 1 y el eslabn i.
Para i = 1, f01 y n01 representan la fuerza y el momento ejercidos sobre el primer eslabn mvil
por el eslabn de la base fija. Para i = n + 1, fn,n+1 y nn,n+1 representan la fuerza y el momento
ejercidos sobre el ambiente por el efector final. En este sentido, el ambiente se trata como un
eslabn adicional, numerado n + 1. Las ecuaciones (7.1) y (7.2) se escriben para cada eslabn
mvil i = 1, ..., n con el fin de proporcionar ecuaciones de 6n en 6(n + 1) nmero de fuerzas
y momentos de reaccin. Por lo tanto, para dar una solucin nica, debern especificarse
seis de las fuerzas y los momentos de reaccin. Cuando un manipulador realiza una tarea
determinada, por ejemplo, una insercin o esmerilado, el efector final ejerce cierta fuerza o
momento sobre su ambiente. Por otro lado, cuando el manipulador carga un objeto, el peso
del objeto se convierte en una carga para el efector final. Por lo tanto, considerando la fuerza
y el momento del efector final fm,n+1 y nm,n+1 como una cantidad conocida, pueden resolverse
las ecuaciones (7.1) y (7.2) para las fuerzas y los momentos de reaccin restantes, es decir,
LM 1
MMO
MMO
MNO
LM n
OO M f
OPP M n
M
P M f
P
OP M
M
1 PQ Mn
MN f
01
O -1 - a 1 1 O
-1
O
1 O
1
O O
O
O
O O
O
01
12
12
n - 1, n
n - 1, n
OP LM
PP MM
PP = M
PP MM
PP MM- d
Q MN
- d1 m1g
- m1g
- d 2 m2 g
- m2 g
n mn g + a n f n, n + 1 + n n, n + 1
- mn g + fn, n +1
OP
PP
PP
PP
PP
Q
(7.3)
Observe que la ecuacin (7.3) est dispuesta para escribir primero la ecuacin (7.2),
seguida por la ecuacin (7.1). Esto se realiza para representar la ecuacin (7.3) en forma
www.FreeLibros.me
7.2
Clculo recursivo
149
compacta, usando la definicin de una llave de torsin, que es un vector de seis dimensiones,
es decir,
n i - 1, i
(7.4)
w i1, i
f i - 1, i
LM
N
OP
Q
donde los vectores tridimensionales fi1,i y ni1,i son la fuerza de reaccin sobre el eslabn i por
el eslabn i 1 en Oi y el momento sobre el eslabn i por el eslabn i 1 alrededor de Oi, respectivamente. Usando la ecuacin (7.4), la ecuacin (7.3) puede entonces reescribirse como
LM 1
MM
MNOO
- A 12
O
O
O
1 - A n - 1, n
O
1
OP LM w
PP MMw
PQ MMN w
01
n - 2, n -1
n - 1, n
LM 1
NO
LM w
= MM
MMww + w
N
OP
PP
PP
Q
g
1
g
n -1
g
n
OP
Q
a i , i +1 1
1
e
n
OP
PP
PP
Q
(7.5a)
(7.5b)
en la cual ai,i+1 denota el vector tridimensional desde el punto Oi hasta Oi+1, es decir, ai,i+1
a1. La matriz Ai,i+1 se denomina matriz de propagacin de llave de torsin en Chaudhary y
Saha (2005), que no es ms que la matriz traspuesta de la matriz de propagacin rotacional
para los eslabones i e i + 1. La definicin de la matriz de propagacin rotacional se obtiene
con la ecuacin (6.57b). Adems, wgi mi[(di g)T, gT]T y wen [(an fn.n+1 + nn.n+1)T f T n.n+1]T
son los vectores de llave de torsin externos de seis dimensiones debido a la gravedad y a las
entradas conocidas sobre el eslabn n, respectivamente. Asimismo, usando las notaciones
w J [w T01 w T12 w Tn1,n] T, y w
de resolverse para wJ como
LMw
N
gT
1
w 2g ( w ng + w en ) T
w J = N u w
donde
Nu
LM 1
O
M
MM
NO
A 12
A 1 n
1 A 2n
O O
1
OP
PP
PQ
(7.6a)
(7.6b)
7.2
Clculo recursivo
En esta seccin, se desarrollar un mtodo recursivo para el anlisis esttico de un manipulador serial. El mtodo recursivo resuelve las fuerzas y los momentos que reaccionan en la
articulacin de un eslabn, sin necesidad de resolver las ecuaciones 6n, (7.3) o (7.5), simultneamente. Para facilitar el anlisis basado en la definicin de llave de torsin proporcionada
en la ecuacin (7.4), las ecuaciones (7.1) y (7.2) se escriben en forma recursiva como
www.FreeLibros.me
150
CAPTULO
7 Esttica
f i1, i = f i,i+1 mi g
n i1, i = n i,i+1 + a i f i,i+1 d i m i g
(7.7a)
(7.7b)
Observe que los vectores en las ecuaciones (7.7 a-b) an no se expresan en algn sistema
de coordenadas. Sin embargo, el vector de posicin ri a menudo se especifica en el sistema
(i + 1)-simo, donde tiene representacin constante. Por otro lado, el vector ai puede expresarse de manera conveniente en el sistema i-simo en trminos de los parmetros DH como
[a i] i
LMa cq OP
Ma sq P
MN b PQ
i
(7.8a)
LMa cq OP LMr OP
[a ] [r ] = Ma sq P Q Mr P
MN b PQ MNr PQ
LMr OP
[r ]
Mr P
MNr PQ
i
[d i] i
i i
i i
Donde
ix
iy
iz
ix
i i+1
iy
(7.8b)
iz
donde rix, riy y riz son los componentes del vector ri a lo largo de los ejes Xi+1-, Yi+1- y Zi+1- del sistema (i + 1)-simo y Qi es la matriz de rotacin que transforma la representacin del vector en
el sistema (i + 1)-simo en el sistema i-simo. Usando las ecuaciones (7.7a-b), los momentos
y fuerzas de reaccin de la articulacin pueden calcularse en forma recursiva. El proceso
empieza con el ltimo eslabn donde el efector final se conecta. Contina con un eslabn
a la vez y termina en el eslabn de la base. Para i = n, el momento y fuerza del efector final
nn+1,n (=nn,n+1) y fn+1,n (=fn,n+1) se consideran como conocidos en el sistema adjunto a ellos, es
decir, [ nn,n+1]n+1 y [ nn,n+1]n+1 son entradas. Por ende, las ecuaciones (7.7a-b) proporcionan
el momento y fuerza de reaccin nn1,n y fn1,n en la n-sima articulacin: Los valores pueden
evaluarse apropiadamente en el n-simo o en el (n 1)-simo sistema de coordenadas. El
proceso se repite para i = n 1, ... 1 hasta que se hayan encontrado todos los momentos y
fuerzas de reaccin. Ahora se muestra el clculo. Las ecuaciones (7.7a-b) para el i-simo
eslabn se escriben primero en el (i + 1)-simo sistema que se adjunta a l, es decir,
[f i1, i] i+1 = [f i, i+1 mi g] i+1
[n i1, i] i+1 = [ni,i+1 + a i f i, i+1 d i m i g] i+1
(7.9a)
(7.9b)
Una vez que las fuerzas y momentos de reaccin se hayan calculado en el (i + 1)-simo
sistema, se convierten en el i-simo sistema por medio de las siguientes transformaciones:
[f i1, i] i = Qi [f i1, i] i+1
y
[n i1,i] i = Qi [n i1,i] i+1
(7.10)
7.3
151
de ser sustituido en las ecuaciones (7.9a-b). Esto puede realizarse mediante la siguiente
frmula recursiva: Para i = 1, ... n,
(7.11)
[g] i+1 = Q Ti [g] i
Adems, si el momento y fuerza del efector final se especifican en el sistema fijo, tambin
debern transformarse dentro del sistema del efector final de la misma manera, es decir,
[f n,n+1] n+1 = Q T[f n, n +1]1 y [n n, n+1] n+1 = Q T [n n, n+1]1
(7.12)
7.3
Una vez que se conocen las fuerzas y momentos que reaccionan en las articulaciones, pueden
determinarse las fuerzas o pares de torsin de los actuadores. Para un manipulador serial,
cada articulacin se acciona mediante un actuador que ejerce una fuerza o un par torsin
entre los dos eslabones adyacentes. Estas fuerzas o pares de torsin de actuacin pueden encontrarse mediante la proyeccin de las fuerzas que reaccionan sobre sus correspondientes
ejes de articulaciones.
Para una articulacin o rotacional, el actuador ejerce un par torsional alrededor del
i-simo eje de articulacin. Suponiendo que el par torsional ficcional en la articulacin sea
insignificante, la fuerza del actuador i se obtiene por
ti = eiT n i1, i
(7.13)
donde ei es el vector unitario que apunta a lo largo del i-simo eje de articulacin, es decir,
Zi de la figura 7.1, alrededor del cual se est realizando el movimiento relativo entre los dos
eslabones colindantes. El par torsional del actuador tiene aquel componente de ni1 que corresponde a la direccin del eje de la articulacin. Sus otros dos componentes son reacciones
que debern ser soportadas por el cojinete de la articulacin. Al trmino i se le llama par
torsional de la articulacin. Para una articulacin prismtica, la fuerza del actuador se obtiene de manera similar. Es la fuerza que se ejerce a lo largo del i-simo eje de la rotacional.
Nuevamente, suponiendo que la fuerza de friccin en la articulacin sea insignificante, la
fuerza del actuador, denotada con la misma letra i, se expresa como
(7.14)
t i = eiT f i1, i
donde ei es el vector unitario que apunta a lo largo del i-simo eje de articulacin positivo, a
lo largo del cual se trasladan los dos eslabones adyacentes. La ecuacin (7.14) implica que la
fuerza del actuador solamente lleva el componente de fi1,i a lo largo de la direccin del eje de
la articulacin, mientras que sus otros componentes se apoyan en los cojinetes o rodamientos
de la articulacin. Usando la notacin de llave de torsin de 6 dimensiones wi1,i, la fuerza
de la articulacin o par torsional i puede escribirse como
(7.15)
t i = piT wi 1, i
donde pi es el vector de propagacin de 6 dimensiones del movimiento de la articulacin
para la articulacin rotacional o prismtica, segn fuere el caso, que se da en las ecuaciones
(6.57b) o (6.59), respectivamente.
www.FreeLibros.me
152
CAPTULO
7 Esttica
Ejemplo 7.1
El brazo de manipulador planar de dos eslabones est aplicando una fuerza f sobre
el ambiente, por ejemplo, una pared, con su efector final. Suponga que la fuerza f es
conocida en el sistema del efector final, es decir, en el sistema 3. Por lo tanto, [f23]3
[fx, fy, 0]T. Los pares de torsin de la articulacin que se requieren se encuentran como
funcin de las configuraciones del brazo y de los componentes de la fuerza aplicada.
Observe que la gravedad no juega ningn papel cuando el manipulador se acuesta
sobre el plano horizontal. En la figura 7.2 y en las ecuaciones (7.9-7.10),
LM f OP
MM f PP
N0Q
x
[f23]3
[f12]2 = Q2[f12]3 =
LM f cq
MM f sq
N
x
Q2
LMcq
M sq
MN 0
2
2
- sq 2
cq 2
0
- f y sq 2
+ f y cq 2
0
OP
PP
Q
(7.16a)
OP
P
1PQ
0
0
(7.16b)
X3
Y3
f
Y1
Y2
a2
2
a1
1
Figura 7.2
X2
2
X1
Entonces, puesto que no se ejerce ningn movimiento externo, es decir, n23 = 0, por
parte del efector final, el momento [n12]2 se obtiene como
[n12]2 Q2 [a2 f23]3 = [a 2]2 [f 23]2 = [a2 f12]2
LM 0
= M 0
MNa f
2 y
www.FreeLibros.me
OP
PP
Q
(7.16c)
7.3
donde
LMa cq
MM
N 0
2
[a2]2 a2 sq 2
OP
PP
Q
153
(7.16d)
LM f cq
] = M f sq
MN
2
12
12
[a1]1
- f y sq 12
+ f y cq 12
LM
= M
MNa
(7.17a)
0
0
2 f y + a1 f x sq 2 + a1 f y cq 2
(7.17b)
LMa cq OP
Ma sq P
MN 0 PQ
1
OP
PP
Q
OP
PP
Q
(7.17c)
donde Q1[n12]2 tendr la misma expresin que [n12]2 de la ecuacin (7.16c). Finalmente, los pares de torsin de la articulacin para generar la fuerza f en el efector
final se obtienen por
(7.18)
t1 = a1 fx sq2 + (a2 + a1 cq 2)fy; y t2 = a2 fy
Ejemplo 7.2
b2
1
Figura 7.3
Z2, Z3
f
EE (x, y)
X1
www.FreeLibros.me
154
CAPTULO
7 Esttica
LM f OP
M0P
MN f PQ
x
[f23]3
LM f OP
MM 0 PP
Nf Q
x
(7.19a)
LM 0
= Mb f
MN 0
2 x
OP
PP
Q
LM 0 OP
M0P
MNb PQ
(7.19b)
[f01]1 = Q1[f01]2
LM f cq
= M f sq
MN
x
+ f z sq 1
- f z cq 1
0
OP
PP
Q
(7.20a)
LM 0
MM 0
Nb f
2
OP
PP
Q
(7.20b)
LM
MM
N0
cq 1 0 sq 1
Q1 sq 1 0 - cq 1
1
OP
PP
Q
(7.20c)
www.FreeLibros.me
(7.21)
7.3
Ejemplo 7.3
155
X4
f34
nz
3
Y4
Y3
a3
3
Y1
Y2
a2
2
a1
X3
X2
2
X1
[a i] i
LMa cq OP
M a sq P , [r ]
MN 0 PQ
i
i i+1
[d i] i = [a i] i Q i [ri] i+1
LM 1 a OP
2
M 0 P
MM PP
N0Q
LM 1 a cq OP
2
M
P
= M1
a sq P
MM 2 PP
N0 Q
i
(7.22)
donde ai para i = 1, 2, 3 es la longitud del i-simo eslabn. La ecuacin (7.22) se escribe en el sistema de referencia 1 usando las matrices de rotacin Qi para i = 1, 2, 3;
es decir,
LMcq OP
= a M sq P
MN 0 PQ
1
[a1]1
LMcq OP
MMsq PP
N0Q
1
a
[d1]1 = 1
2
www.FreeLibros.me
(7.23a)
156
CAPTULO
7 Esttica
LMcq
[a ] = Q [a ] = a M sq
NM 0
LMcq
[a ] = Q [a ] = a M sq
MN 0
12
2 1
2 2
12
13
3 1
12
3 3
13
OP
Lcq OP
a M
PP , [d ] = Q [d ] = 2 MMsq PP
Q
N0Q
OP
Lcq OP
a M
PP , [d ] = Q [d ] = 2 MMsq PP
Q
N0Q
12
2 1
(7.23b)
12
2 2
13
3 1
12
(7.23c)
13
3 3
LM f cq
MM f sq
N
x
- f y sq 3 + m3 gs12
+ f y cq 3 + m3 gc12
0
OP
PP
Q
(7.24a)
LM 0 OP
M 0 P (7.24b)
MNn PQ
m 3Q T12 [g]1
23z
FH
1
n23z nz + a 3 f y - m3 gcq 13
2
IK
(7.24c)
LM f cq
MM f sq
N
x
23
23
- f y sq 23 + m23 gsq 1
+ f y cq 23 + m23 gcq 1
0
OP
PP
Q
(7.25a)
m2Q T1 [g]1
LM 0 OP
M 0 P
MNn PQ
(7.25b)
12 z
FH
n12z nz + a 3 f y - 1 m3 gcq 13
2
IK + a LM f sq
N
2
F
H
+ f y cq 3 + m3 +
www.FreeLibros.me
I
K
1
m gcq 12
2 2
OP
Q
(7.25c)
7.4
157
OP
gP
PQ
LM 0 OP
[d ] m [g] M 0 P
MNn PQ
LM f cq - f sq
] m [g] = M f sq + f cq + m
MN
0
x
[f01]1 = Q1[f12
13
13
13
13
1 1
13
(7.26a)
(7.26b)
01z
FH
IK + a LM f sq
N
+ f cq + F m
H
n 01z n z + a 3 f y - 1 m3 gcq 13
2
LM
N
+ a1 f x sq 23
23
F
H
+ f y cq 3 + m3 +
23
IK
+ 1 m1 gcq 1
2
OP
Q
I
K
1
m gcq 12
2 2
OP
Q
(7.26c)
Finalmente se aplica la ecuacin (7.13) para calcular los pares torsionales de las
articulaciones, los cuales se obtienen como
t1 = [e1] T1 [n 01]1 = n 01z ; t 2 = [e2] T2 [n12]2 = n12z;
y
(7.27)
donde [ei]i [0, 0, 1]T para i = 1,2,3 y n23z, n12z, n01z se obtienen en las ecuaciones
(7.24c)-(7.26c), respectivamente.
7.4
158
CAPTULO
7 Esttica
Ahora bien, si we denota la torcedura del efector final, entonces el trabajo virtual efectuado por l se obtiene por wTex. De manera parecida, si denota el vector de todos los pares
torsionales y fuerzas de la articulacin que actan en las articulaciones para producir la llave
de torsin we, entonces el trabajo virtual definido en el espacio de la articulacin se obtiene
por Tp. Observe que cuando el manipulador robtico est en equilibrio, el principio del
trabajo virtual seala que
(7.28)
q
w Te dx = t Tdq
donde el desplazamiento virtual x y p puede relacionarse a partir de la definicin del
jacobiano que se introdujo en el captulo anterior, que es
dx = Jd q
(7.29)
La sustitucin de la ecuacin (7.29) en la ecuacin (7.28) proporciona
(7.30)
w Te Jd q = t Tdq
q
La ecuacin arriba mencionada es vlida para todos los p, y, por ende, lo siguiente es
vlido:
(7.31)
w Te J = t T
Si se transponen ambos lados de la ecuacin (7.31a), se obtiene la relacin entre la torcedura del efector final y los pares de torsin o torsionales y fuerzas de articulaciones, es decir,
(7.32)
t = J Twe
Aqu cabe sealar que si la matriz Jacobiana J de la ecuacin (7.31) o de la (7.32) es
singular, entonces el efector final no puede ejercer fuerzas estticas como se desea.
Ejemplo 7.4
Se derivan dos relaciones para los pares de torsin de articulacin del brazo de manipulador planar de dos eslabones en el ejemplo 7.1, es decir, en la ecuacin (7.18).
Entonces se reordenan como
t = J Tf
(7.33a)
donde
t [t1, t 2] T, f [fx, f y, 0] T
LM a sq
J Ma cq + a
MN 0
1
OP
P
0 PQ
0
a2
(7.33b)
www.FreeLibros.me
7.4
es decir,
[J]1
12
12
OP LM a sq
PP MMa cq + a
QN 0
0
0
1
159
OP
P
0 QP
0
a2
12
(7.34)
12
donde Q1 y Q2 son las matrices de rotacin de 3 3, mientras que [J]1 y [J]3 son las
representaciones del mismo jacobiano en los sistemas 1 y 3. Ahora bien, los renglones
diferentes a cero de la ecuacin (7.34) coinciden con la matriz que se da en la ecuacin
(6.51b) o (6.69).
Ejemplo 7.5
Observe que las expresiones para los pares torsionales de articulacin, ecuacin
(7.27), pueden disponerse como sigue:
t = J Twe + Ag m g
donde los vectores de 3, 6 y 3 dimensiones , we y mg se definen como
t [t1, t2, t3] T; we [0, 0, nz, fx, fy, 0] T; m g [m1g, m2g, m3g] T
(7.35a)
(7.35b)
LM 1 a cq
2
M
M 0
MM 0
N
1
Ag
0
0
1
a2 sq 3
23
23
1
a cq
2 2 12
1
a cq
2 2 12
0
a1cq 1 +
a 3 + a 2 cq 3
OP
P
1P
P
0P
a P
P
0 PQ
0
0
(7.35c)
1
a cq
2 3 13
1
a2 cq 12 + a3cq 13
2
1
a cq
2 3 13
a1cq 1 + a2 cq 12 +
OP
PP (7.35d)
PP
Q
www.FreeLibros.me
160
CAPTULO
7 Esttica
LMQ
NO
OP LMQ
Q Q NO
O
OP LMQ
Q Q NO
O
OP [J]
Q Q
O
(7.36)
Ejemplo 7.6
En la parte del brazo de la figura 6.4, puede verse un brazo articulado antropomrfico
para el cual se obtiene la matriz Jacobiana en la ecuacin (6.54c). Si el momento ne y
la fuerza fe actan sobre el efector final que se conoce en el propio sistema del efector
final, entonces los pares de torsin que se requieren en las tres articulaciones del brazo
pueden calcularse usando la ecuacin (7.28), en donde no son considerados los pesos
de eslabones, es decir,
t = J T Q we
t [t1, t2, t3] T; we [w 34]4 [n x, ny, nz, f x, fy, fz] T
donde
(7.37a)
)
y la matriz de 6 6, Q diag[Q, Q], donde Q = Q1Q2Q3 transforma la representacin
de un vector desde el sistema del efector final, es decir, el sistema 4, al sistema fijo, es
decir, el sistema 1. Esto puede extraerse de la ecuacin (6.11) como
LMc c
Q Ms c
MN- s
1 23
1 23
23
- c1s23
- s1s23
- c23
OP
c P
0 PQ
- s1
1
(7.37b)
www.FreeLibros.me
7.5
Elipsoide de fuerza
161
LM- n + (a + a ) f OP
t M- n + (a + a ) f P
MN n + a f PQ
y
(7.37c)
3 y
7.5
Elipsoide de fuerza
(7.38)
162
CAPTULO
7 Esttica
RESUMEN
En este captulo se derivan los pares de torsin que se requieren para ejercer una fuerza y
un momento por el efector final mientras el robot est en equilibrio esttico. Se demuestra
cmo el jacobiano de velocidad entra en consideracin en el anlisis esttico. Finalmente,
se da una interpretacin fsica de la matriz Jacobiana en el dominio de la fuerza.
EJERCICIOS
7.1
7.2
7.3
7.4
Captulo
8
Dinmica
En este captulo se estudiarn las ecuaciones de movimiento para un robot, es decir, la manera en la que se produce el movimiento del robot debido a los pares de torsin y a las fuerzas
que se aplican a las articulaciones mediante los actuadores. Se desarrollar un conjunto de
ecuaciones que describen el comportamiento dinmico de un robot, lo que tambin se llama
el modelo dinmico del robot. Este desarrollo es importante en varios aspectos:
iii) Un modelo dinmico puede usarse para desarrollar las estrategias apropiadas de control. Un
Dinmica
controlador sofisticado requiere del uso de un
modelo dinmico realstico para lograr el desempeo ptimo del robot en operaciones de La dinmica es el estudio de las fuerzas y momentos que causan el movialta velocidad. Algunos mtodos de control de- miento en un sistema.
penden directamente de un modelo dinmico
con el fin de calcular los pares de torsin y las
fuerzas requeridas en los actuadores para seguir la trayectoria deseada.
iii) El modelo dinmico puede usarse para la simulacin por computadora de un sistema
robtico. Cuando se construye un sistema robtico, es posible pronosticar cmo se
va a comportar, mediante el estudio del comportamiento del modelo en varias condiciones de operacin.
iii) El anlisis dinmico de un robot proporciona todas las fuerzas y momentos de reaccin que se necesitan para el diseo y la determinacin de los tamaos de eslabones,
cojinetes y actuadores.
Conociendo los parmetros fsicos de cualquier robot, uno normalmente desea resolver
problemas relacionados con su dinmica: la dinmica inversa y la dinmica directa. El problema de la dinmica inversa es encontrar los pares de torsin y/o las fuerzas de actuadores
que son necesarios para generar la trayectoria deseada del robot. Esta formulacin de la diwww.FreeLibros.me
164
CAPTULO
Dinmica
nmica es til para el problema del control del robot. El segundo problema, el de la dinmica
directa, es encontrar la respuesta de un brazo de robot respecto a algunos pares de torsin o
fuerzas en las articulaciones. Es decir, dados los pares de torsin o fuerzas de las articulaciones, tiene que computarse el movimiento resultante del robot como funcin del tiempo.
Esto no es tan crtico como el problema de la dinmica inversa, ya que se usa principalmente
para la simulacin en computadora de un robot, lo que solamente muestra cmo funcionar
ste cuando se est construyendo. Por otro lado, un modelo eficiente de dinmica inversa se
vuelve sumamente importante para el control de robots en tiempo real.
Las ecuaciones de dinmica del movimiento pueden formularse por medio de varios mtodos. Uno consiste en aplicar las ecuaciones de movimiento de Lagrange. La ventaja de usar
este planteamiento es que elimina las fuerzas de restriccin de las ecuaciones de dinmica de
movimiento si las coordenadas generalizadas se eligen en forma independiente. Esta eliminacin hace que sea adecuado para el control y para la siPlanteamiento
mulacin de movimiento. Sin embargo, dichas fuerzas
vectorial vs.
de restriccin eliminadas pueden recuperarse usando
planteamiento de
multiplicadores de Lagrange si se han de usar para los
energa
propsitos de diseo. Otro planteamiento es la aplicaLas ecuaciones de Newton-Euler se
cin de las leyes de Newton y Euler para movimientos
conocen como planteamiento vectolineales y rotacionales, respectivamente. Escribir las
rial, mientras que las de Euler-Lagrange se sustentan en un planteamiento
ecuaciones de movimiento de Newton y Euler para
basado en la energa.
cada eslabn del robot da como resultado un sistema
de ecuaciones que contiene las fuerzas aplicadas y las
fuerzas de restricciones. Estas ecuaciones pueden entonces resolverse simultneamente
para todas las fuerzas, incluidas las que son resultado de las restricciones que no contribuyen al movimiento de los eslabones, pero que se requieren para el diseo de los mismos. Si
alguien slo se interesa en la simulacin del movimiento, las fuerzas de restriccin pueden
eliminarse usando las relaciones geomtricas y cinemticas que describen la naturaleza de las
restricciones. Tambin existen metodologas alternativas para resolver la dinmica de robots,
por ejemplo, el principio de DAlembert, las ecuaciones de movimiento de Kane y las que
se basan en los complementos ortogonales de las matrices de restriccin de velocidad. Uno
de estos mtodos basados en los complementos ortogonales, las matrices de complemento
ortogonal natural desacoplado (DeNOC) (Saha, 1999), se presentar en el captulo 9.
8.1
Propiedades de inercia
8.1.1
Centro de masa
La masa es la cantidad de materia que posee un cuerpo de una forma y tamao determinados.
En la figura 8.1, F es un sistema de coordenadas cartesianas, dV es un diferencial de volu-
www.FreeLibros.me
8.1
Propiedades de inercia
165
Cuerpo, B
dV
Z
Zc
r
d
Yc
p
c
Xc
Y
Sistema coordenado, F
Figura 8.1
Momentos de masa
donde m
1
m
pr dV
(8.1a)
1
m
cr dV +
1
m
rrdV
(8.1b)
Puesto que el vector c es independiente del volumen V del cuerpo B, puede extraerse del
signo integral.
Adems,
c c+
1
m
rrdV
(8.1c)
rr dV = 0
www.FreeLibros.me
(8.1d)
166
CAPTULO
Dinmica
8.1.2
En la figura 8.1, suponga que u es el vector unitario paralelo a la lnea L, pasando a travs de
un punto de referencia, por ejemplo, el origen O del sistema F. Adems, si d es la distancia
del diferencial de masa rdV del cuerpo B desde la lnea L, entonces el momento de inercia del cuerpo B respecto a la lnea L se determina por un escalar positivo, es decir,
Iuu =
d 2rdV =
d Tdr dV
(8.2)
| p u |2r dV =
(p u) T (p u)rdV = uTIu
(8.4)
donde
(p u)T ( p u) = (pTp)(uTu) (pTu)2 = uT[(pTp)1 ppT]u
donde 1 es la matriz de identidad de 3 3. Por tanto, la matriz I de 3 3 de la ecuacin (8.4)
se determina por
I=
(8.5)
LM I
I MI
MN I
xx
I xy
I xz
yx
I yy
I yz
zx
I zy
I zz
OP
PP
Q
(8.6)
Ixy = Iyx =
(x2 + y2)rdV
xzrdV
(8.7a)
(8.7b)
donde x, y y z representan las coordenadas del diferencial de masa dV respecto al origen del
sistema F, es decir, O. Adems, los subndices xx, yy y zz denotan los ejes de coordenadas X,
Y y Z del sistema F, cuyo origen se ubica en O respecto a lo cual se calculan los momentos
de inercia Ixx, Iyy e Izz y el producto de las inercias Ixy, Iyz, Ixz. Los valores numricos de estos
elementos dependen de la seleccin de un punto de referencia y del sistema de coordewww.FreeLibros.me
8.1
rdV = md 2
Propiedades de inercia
167
El tensor y
sus rdenes
En la fsica, los tensores caracterizan
las propiedades de un sistema fsico.
Por ejemplo, un tensor del orden cero
es un escalar que representa la masa
de un objeto. Un tensor del orden uno
es un vector que podra representar la
posicin de un punto, mientras que
un tensor de segundo orden se representa por una matriz de 3 3 que denota, por ejemplo, la llamada matriz
(o tensor) de inercia de un objeto.
(8.8)
donde el escalar d tiene una expresin, en trminos de los vectores p y u, como d |p u|,
que es una cantidad real no negativa. Al escalar d se refiere como el radio de giro del cuerpo
B respecto a la lnea L.
8.1.3
Suponga que C(xc , yc , zc) es el sistema de coordenadas cartesianas adjunto al centro de masa
C de un cuerpo rgido B con sus ejes de coordenadas paralelos a los de F, como se muestra
en la figura 8.1. Entonces puede demostrarse que
Ixx = I cxx + m(y 2c + z 2c ), Iyy = I cyy + m(z 2c + x 2c), I zz = I czz + m(x 2c + y 2c),
Ixy = I cxy mxc yc, Iyz = I cyz myc zc, Izx = I cxz mzc xc
(8.9a)
(8.9b)
donde xc, yc y zc son las coordenadas del centro de masa en el sistema F, e Icxx,Icyy, Iczz e Icxy,
Icyz, Icxz son los momentos de inercias y los productos de inercias respecto al centro de masa
C, respectivamente. Las ecuaciones (8.9 a-b) se llaman teorema de los ejes paralelos.
8.1.4
Z
Y
(8.10)
La utilidad de este teorema va ms all del clculo de
los momentos de objetos estrictamente planos. Se trata
de una herramienta valiosa para la acumulacin de los
momentos de inercia de objetos tridimensionales, tales
www.FreeLibros.me
168
CAPTULO
Dinmica
8.1.5
I xy
I yy - l
I xz
I yz
Izx
I zy
I zz - l
=0
(8.12)
Por lo tanto, los valores y vectores propios de la matriz de inercia I corresponden a los
momentos principales de inercia y a las direcciones de los ejes principales, respectivamente.
Por lo general, en correspondencia con cada punto de referencia, existe por lo menos un
conjunto de tres ejes principales de inercia mutuamente perpendiculares. Algunos hechos
adicionales sobre la matriz de inercia son los siguientes:
iii) Si dos ejes del sistema de referencia forman un plano de simetra para la distribucin
de la masa del cuerpo, los productos de inercia que tienen un ndice como la coordenada, que es normal al plano de simetra, sern cero.
iii) Los momentos de inercia siempre tienen que ser positivos. Los productos de inercia
pueden tener cualquier signo.
iii) La suma de los tres momentos de inercia son invariantes bajo cambios de orientacin
en el sistema de referencia.
iv) La suma de cualquiera de dos momentos de inercia es mayor que el tercero, es decir,
Ixx + Iyy > Izz.
Ejemplo 8.1
www.FreeLibros.me
8.1
Propiedades de inercia
169
dy
dz
dx
(x, y, z)
h
Y
w
Figura 8.3
se obtiene
Ixx =
z zz
h l
o o o
(y2 + z2)rdxdydz =
zz
h l
FG hl w + h lw IJ r = hlwr (l
H 3 3K 3
3
(y2 + z2)wrdydz =
FG l + z lIJ wrdz
H3 K
3
m 2
(l + h 2)
3
+ h 2) =
(8.13)
donde m hlw es la masa total del cuerpo. De manera similar, puede obtenerse Iyy
e Izz por inspeccin, es decir,
Iyy =
m 2
(w + h 2 );
3
z zz
h l
o o o
xyrdxdydz =
zz
m 2
(l + w2)
3
Izz =
w2
y rdydz =
o 2
h l
(8.14)
w2 l2
m
rdz = wl
4
4
LM m (l + h )
M3 m
I = M - wl
MM - m4 hw
N 4
2
- m wl
4
m (w2 + h2)
3
m
- hl
4
- m hw
4
- m hl
4
m 2
(l + w 2 )
3
(8.15)
(8.16)
OP
PP
PP
Q
(8.17)
www.FreeLibros.me
170
CAPTULO
Dinmica
Ejemplo 8.2
El tensor de inercia para el mismo cuerpo slido que se describe en el ejemplo 8.1 se
obtiene con un sistema de coordenadas cuyo origen est en el centro de masa C del
cuerpo. Observe aqu que puede aplicarse el teorema de los ejes paralelos ecuacin
(8.9), donde xc = w/2, yc = l/2 y zc = h/2. Entonces,
m 2 2
(8.18a)
I czz =
(w + l ), y I cxy = 0
12
Los otros elementos se encuentran por simetra. El tensor de inercia resultante
escrito en el sistema ubicado en el centro de masa C se determina por
LMh
MM
N
m
I =
12
C
+ l2
0
0
OP
0 P
+ w PQ
0
2
w +h
0
(8.18b)
Puesto que el resultado es una diagonal, el sistema en C debe representar los ejes principales de este cuerpo. Para una barra delgada, w y h son mucho ms pequeos que l.
Por lo tanto, su tensor de inercia puede calcularse de manera aproximada por
IC =
Ejemplo 8.3
LM
MM
N
1 0 0
ml 2
0 0 0
12
0 0 1
OP
PP
Q
(8.19a)
r2rdV =
d /2 2
r rl2prdr
0
d4
md 2
rlp =
32
8
(8.20)
donde r es la distancia radial desde el eje del cilindro, es decir, el eje X, donde se
encuentra el volumen elemental del cilindro. Adems, m = ld2/4 es la masa total
Z
Z
Y
dx
d
O
X
l
a) Cilindro
X
O
x
b) Disco delgado
Figura 8.4
Un objeto cilndrico
www.FreeLibros.me
8.1
Propiedades de inercia
171
1
dIyy = 1 md2 + ml2
3
16
(8.21e)
LM md
MM 8
I =
MM 0
MN 0
md 2 + ml 2
16
3
md 2 + ml 2
16
3
OP
PP
PP
PQ
(8.22)
donde puede comprobarse que el producto de los trminos de inercia Ixy, Ixz e Iyz es cero,
ya que el cilindro se coloca en forma simtrica alrededor de los ejes Y y Z.
www.FreeLibros.me
172
8.2
CAPTULO
Dinmica
Formulacin de Euler-Lagrange
El modelo dinmico de un robot puede derivarse de manera sistemtica por medio del concepto de coordenadas generalizadas y de una funcin escalar llamada lagrangiano, que se
define como la diferencia entre la energa cintica y la energa potencial del sistema mecnico en cuestin, es decir,
L =TU
(8.23)
donde L denota la funcin lagrangiana, y T y U son la energa total cintica y potencial del
sistema. Observe que la energa cintica depende tanto de la configuracin, es decir, posicin
y orientacin, como de la velocidad de los eslabones de un sistema robtico, mientras que la
energa potencial depende nicamente de la configuracin de los eslabones. Las ecuaciones
de movimiento de Euler-Lagrange se obtienen entonces por
FG IJ L
H K q
d L
dt q i
= fi, para i = 1, , n
(8.24)
8.2
Formulacin de Euler-Lagrange
173
3 DOF, dos cuerpos requieren seis coordenadas, es decir, (x1, y1, q1) y (x2, y2, q2), las cuales
no son independientes, puesto que hay dos articulaciones de revoluta que restringen el
movimiento de los dos cuerpos. Observe que las coordenadas (x1, y1,) y (x2, y2) definen las
posiciones del centro de masa de los eslabones, mientras que q1 y q2 denotan la orientacin
de los eslabones, es decir, los sistemas coordenados fijos del cuerpo. Adems, d1 y d2 son las
ubicaciones del centro de masa desde el origen de los sistemas, y para el primer conjunto de
seis coordenadas existen cuatro restricciones, es decir,
x1 = d1 cos q1 ; y1 = d1 sen q1
(8.25a)
x2 = a1 cos q1 + d2 cos q12 ; y2 = a1 sen q1+ d2 sen q12
(8.25b)
donde q12 q1 + q2. Por ende, el sistema tiene 6 4 = 2 DOF. Entonces, el conjunto independiente de coordenadas generalizadas puede ser q1 y q2. Desde luego, uno puede seleccionar otras dos coordenadas generalizadas independientes. Sin embargo, para el ejemplo
presentado, q1 y q2 son el conjunto ms conveniente desde el punto de vista de los anlisis
de dinmica y cinemtica de robots.
8.2.2
Energa cintica
Considere un robot que consiste en n eslabones rgidos, como el que se presenta en la figura
8.6a). Entonces, la energa cintica de un eslabn normal i, figura 8.6b), denotada como Ti,
se obtiene mediante
1
1
Ti = mi c Ti c i + w iT Ii w i
(8.26)
2
2
donde ci : Vector de velocidad (lineal) tridimensional del centro de masas Ci del i-simo
eslabn;
vi : Vector de velocidad angular tridimensional del i-simo eslabn;
mi : Masa del i-simo eslabn. Una cantidad escalar;
Ii : El tensor de inercia o matriz de 3 3 del i-simo eslabn alrededor de Ci, como
se define en la subseccin 8.1.2.
En la ecuacin (8.22), el tensor de inercia Ii para el i-simo cuerpo es invariante de tiempo, es decir, constante. Sin embargo, depende de la configuracin del brazo del robot y se
expresa en un sistema de referencia diferente, por ejemplo, el sistema fijo, como
[Ii]F = Qi[Ii]i+1Q iT
(8.27)
donde [Ii]i+1 es la matriz de inercia del i-simo eslabn representada en el sistema del eslabn
mvil i + 1 que se sujeta al i-simo cuerpo, y Qi es la matriz de rotacin de 3 3 del eslabn
i o el sistema i + 1 respecto al sistema fijo 1 o F, como se deriv en el captulo 5. La energa
cintica total T se da ahora por la suma de las contribuciones de cada eslabn rgido debido
a los movimientos relativos de cada articulacin, es decir,
i =1
2 dmi c iT c i + w Ti I i w i i
n
T =
Ti =
(8.28)
i =1
En este punto, es necesario expresar la energa cintica como una funcin de las coordenadas generalizadas del sistema. Para un robot, las variables de las articulaciones, es decir,
los ngulos de las articulaciones de revoluta y el desplazamiento para las articulaciones
prismticas, especifican por completo la configuracin del robot. Por ende, los ngulos y
www.FreeLibros.me
174
CAPTULO
Dinmica
Oi
i
O3
Z1
Oi + 1
#i
i+1
3
n
2i
#2
O2
#1
On
#n
O1
Y1
Efector terminal
1
Sistema coordenado, F
X1
a) Cadena serial
Articulacin, i
i
Cuerpo, #i
vi
Z
ai
di
fi
ri
Ci
ci
Masa: mi,
Inercia:Ii
ni
Y
Articulacin , i + 1
Sistema coordenado, F
X
b) El i-simo cuerpo
Figura 8.6
(8.29a)
c 1 = w 1 d1 = e1 d1q 1
(8.29b)
w 2 = w 1 + q 2 e2 = e1q 1 + e2q 2
(8.29c)
(8.29d)
w i = w i1 + q i ei = e1q 1 + e2q 2 + + eiq i
(8.29e)
c i = c i -1 + w i1 ri1 + w i di = e1 r 1i q 1 + + ei r ii q i
(8.29f)
www.FreeLibros.me
8.2
Formulacin de Euler-Lagrange
175
Observe que al escribir las ecuaciones (8.29a-f), se supone que todas las articulaciones
son de revoluta. Por consiguiente, el vector ei es el vector unitario paralelo al eje de la articulacin revoluta, mientras que ai, di y ri se presentan en la figura 8.6b). Adems, qij es el vector
que conecta el origen de la i-sima articulacin Oi con el j-simo centro de masa Cj. Para
i = j, qii di. Utilizando las ecuaciones (8.29e-f), las velocidades del i-simo eslabn pueden
entonces expresarse en trminos de todos los ndices de articulaciones n, es decir,
(8.30a)
w = J q , donde J [ j j j 0 0]
i
w,i
w,i
w,1 w,2
w,i
donde p [q 1, q 2, ..., q n]T es el vector n-dimensional de ndice de articulaciones. En las ecuaciones (8.30a-b), J,i y Jc,i son las matrices de 3 n. Proporcionalmente, J,i y Jc,i son los
vectores tridimensionales que, segn las ecuaciones (8.2e-f), pueden escribirse como
(8.31a)
Observe que para una articulacin prismtica la ecuacin (8.31a) se modifica como
jw,i 0; y jc,i ei
(8.31b)
T =
1
1
m c T c + w iT I i w i = q T I i q
2 i =1 i i i
2 1
(8.32a)
(8.32b)
T
Observe que en la ecuacin (8.32 b) las expresiones J c,i Jc,i y J ,i Ii J,i tambin estn en
las matrices de n n. Adems, si una matriz I de n n se define como sigue:
n
I =
Ii
(8.33)
i =1
Entonces la energa cintica total puede rescribirse segn la ecuacin (8.32a) como
T =
1T
q Iq
2
(8.34)
donde la matriz I se llama matriz de inercia generalizada (GIM) del robot en cuestin. Cabe
sealar aqu que la GIM del robot I de la ecuacin (8.34) involucra las matrices Ii, que a su
vez es una funcin de las matrices J,i y Jc,I, como es evidente de la ecuacin (8.32b). Por lo
tanto, el manipulador GIM es dependiente de la configuracin, es decir, nicamente de la
funcin de p. Tambin, de modo parecido a como se define en las ecuaciones (8.5) y (8.6)
la inercia de un cuerpo rgido Ii, el manipulador GIM I es tambin simtrico y positivo-definido. Esto es obvio por la forma cuadrtica de la ecuacin (8.34) que indica que la energa
cintica del sistema siempre es positiva, a menos que est en reposo.
www.FreeLibros.me
176
8.2.3
CAPTULO
Dinmica
Energa potencial
U =
mi c iT g
(8.35)
i =1
8.2.4
Ecuaciones de movimiento
Tras haber computado las energas cintica y potencial totales del robot en estudio, es decir,
las ecuaciones (8.32) y (8.35), respectivamente, el lagrangiano de la ecuacin (8.23) puede
escribirse como
LNM 2 q T Ii q + mi c iT gOQP
n
L =TU=
(8.36)
i =1
Ahora la funcin de Lagrange debe diferenciarse respecto a qi, q i y t para formular las
ecuaciones dinmicas de movimiento. Con el fin de facilitar la derivacin, se expande el
trmino de energa cintica como suma de los escalares. Si suponemos que iij es el elemento
(i, j) del GIM I del robot, entonces la ecuacin (8.36) puede escribirse como
L
N
O
Q
MM 2 iij q i q j + mi c iT gPP
n
L =
i =1
j =1
(8.37)
L
=
q i
iij q j
(8.38)
j =1
F I
GH JK
d L
dt q i
L
N
F di I O
Q
L
N
O
Q
j =1
ij
j =1
www.FreeLibros.me
k =1
iij
(8.39)
8.2
Formulacin de Euler-Lagrange
177
F
I
GH i q q JK + m g
n
1
L
=
q i
2 q i
ij
j = 1 k =1
j =1
c j
q i
(8.40)
Puesto que la derivada parcial de ci respecto a qi, cjlqi en ecuacin (8.40), es igual al
vector de la i-sima columna de la submatriz jacobiana Jcj denotada por j(i)c, j, la ecuacin
(8.40) puede escribirse como
1
L
=
2
q i
i jk
q i q j q k + mj gT j (i)c, j
j =1 k =1
(8.41)
j =1
iij q j
+ hi + g i = ti
(8.42)
j =1
para i = 1, , n, donde
F i
GH q k
n
hi
ij
j =1 k =1
IJ
K
1 i jk
q j qk
2 q i
y
n
gi
mj gT j (i)c, j
(8.43)
j =1
La ecuacin (8.34) puede armarse para todas las coordenadas generalizadas n como
+ h + g = t
Iq
(8.44a)
tambin puede expresarse como h = Cp, donde los elementos de la matriz C de n n se obtienen mediante
F i
GH q k
n
cij
k =1
ij
Coriolis en la
dinmica!
Si uno camina a lo largo del radio de
un carrusel dando vueltas, uno experimentar una fuerza lateral. Esto se
debe a la fuerza que resulta de la aceleracin de Coriolis.
IJ
K
1 i jk
q
2 q i k
Tambin
f [1, , n]T: el vector n-dimensional de aceleraciones gravitacionales;
s [t1, , tn]T: el vector n-dimensional de fuerzas generalizadas.
www.FreeLibros.me
(8.44b)
178
CAPTULO
Dinmica
Ejemplo 8.4
F i I
GH q JK q
n
ij
j =1 k =1
Por lo tanto,
F i
GH q k
n
hi
ij
j =1 k =1
IJ
K
1
1 i jk
q j qk =
2
2 q i
F i
GH q k
1
j qk =
2
ij
j =1 k =1
F i
GH q k
ij
j =1 k =1
I
JK
iik
q j qk
q j
I
JK
i jk
iik
q j q k
q j q i
(8.45)
(8.46)
I
JK
n
i jk
iij
i
1
+ ik q
2 k =1 q k q j q i k
GH
(8.47)
Cabe sealar aqu que por medio del uso de las ecuaciones (8.44b) y (8.47) para los
mismos valores de i y j, se encontraran expresiones diferentes. Sin embargo, la expresin de hi basada en cualquiera de las ecuaciones deber ser la misma.
Ejemplo 8.5
diij
dq k q k
(8.48)
k =1
Por lo tanto, el elemento (i, j) de la matriz I -2C puede obtenerse mediante las ecuaciones (8.47) y (8.48) como
diij
2cij =
dt
k =1
n
diij
q
dq k k
F i
GH qikj
k =1
F i
GH q k
ij
k =1
I
JK
I
JK
i jk
iik
q
q j q i k
i jk
q
q i k
(8.49)
Puesto que la matriz de inercia I es simtrica, es decir, iij = iji, puede demostrarse por
medio de intercambio de los ndices que
F
H
diij
di ji
2cji =
- 2cij
dt
dt
www.FreeLibros.me
I
K
(8.50)
8.2
Ejemplo 8.6
Formulacin de Euler-Lagrange
179
LM
N
OP
Q
a
a
(8.51a)
sq
cq 0
2
2
donde sq y cq representan sen q y cos q, respectivamente. Segn la ecuacin (8.34),
el trmino de inercia escalar I se da por
m
m
(8.51b)
I a2 + Izz = a2
4
3
Observe aqu que, a pesar de que la matriz de inercia I del eslabn tenga todos los elementos no cero debido a la estructura de Jw,1, slo el elemento (3, 3) de I, a saber Izz,
contribuye al trmino de inercia generalizada. Usando la ecuacin (8.43), se obtienen
los elementos de los vectores h y f, es decir, h y g, respectivamente, de la siguiente
manera:
a
(8.52)
h = 0; y g mgT j(1)c,1 = mg sq
2
donde g [g 0 0]T g es la aceleracin debida a la gravedad. Usando las ecuaciones
(8.51a-b), la ecuacin de movimiento en la forma de la ecuacin (8.44a) es:
1 ma2 + 1 mgasq = t
(8.53)
q
2
3
Cabe sealar aqu que para un sistema sencillo como el brazo de un eslabn, es recomendable obtener la ecuacin de movimiento, es decir, la ecuacin (8.53), directamente de las ecuaciones (8.24) y (8.26). Esto se muestra a continuacin:
FH IK
a
1
m q
2
2
1 ma 2 2 ma 2 2
q =
q
6
2 12
a - a cq
U = mg
2 2
L =TU
FH
IK
ma 2 2
q mg a (1 cq)
2
6
www.FreeLibros.me
(8.54a)
180
CAPTULO
Dinmica
FG IJ
H K
d L
1
1
1
1
L
= ma2q ;
= mgasq ; y ma2q + mgasq = t
(8.51b)
3
2
3
2
q
dt q
lo que muestra la misma expresin que la que se obtuvo en la ecuacin (8.53).
Ejemplo 8.7
LM- a s
2
M
a
M
c
MN 20
1
Jc,1
LM0
M0
NM1
OP
P
0P ; J
0PQ
OP
0 ;J
P
0 QP
0
w,2
LM0
M0
NM1
OP
0
P
1 QP
0
LM- a s - a s
2
M
a
Mac +
c
MN 0 2
2
1 1
12
(8.55a)
a2
s
2 12
a2
c
2 12
0
c,2
1 1
12
OP
PP
PQ
(8.55b)
LMi
Ni
11
i12
21
i22
FG
H
OP
Q
(8.56a)
IJ
K
m1 2
a2
a 1 + I1,zz + m2 a12 + 2 + a1 a2 c2 + I2,zz
4
4
i12 = i21 m2
i22 = m2
FG a
H4
2
2
a1 a2 c2
2
IJ + I
K
2,zz
a22
+ I2,zz
4
www.FreeLibros.me
(8.56b)
(8.56c)
(8.56d)
8.3
La formulacin Newton-Euler
181
donde si sen qi y ci cos qi para i = 1, 2. Observe aqu que, a pesar de que las matrices
de inercia I1 e I2 de los eslabones 1 y 2, respectivamente, tengan todos los elementos
no cero debido a las estructuras de Jw,1 y Jw,2, slo el elemento (3, 3) de I1 e I2, a saber,
I1,zz e I2,zz, contribuyen a las expresiones de la matriz de inercia generalizada, es decir,
las ecuaciones (8.56a-d). Usando la ecuacin (8.43), se obtienen los elementos de los
vectores h y f, es decir, hi y fi, respectivamente, para i = 1, 2 de la siguiente manera:
h1
1 i11 2 i11
q +
q q +
2 q 1 1 q 2 1 2
FG i
H q
12
2
IJ
K
i
- 1 22 q 22
2 q 1
a a
= m2 a1 a2 s2q 1 q 2 m2 1 2 s2q 22
2
h2
=
y
FG i
H q
21
1
(8.57a)
IJ
K
i
1 i11 2 i22
q +
q q + 1 22 q 22
2 q 2 1
q 1 1 2
2 q 2
m2
a a s q 2
2 1 2 2 1
(8.57b)
F
H
a1
a
c1 + m2g a1 c1 + 2 c12
2
2
a
g2 m1gT j (2)c,1 m2 gT j(2)c,2 = m2g 2 c12
2
g1 m1 gT j (1)c,1 m2 gT j (1)c,2 = m1g
I
K
(8.58a)
(8.58b)
8.3
La formulacin Newton-Euler
8.3.1
dp
d
rdV =
dt
dt
prdV
www.FreeLibros.me
(8.60)
182
CAPTULO
Dinmica
Usando la definicin del centro de masa de la ecuacin (8.1a), la ecuacin (8.60) puede
reescribirse como
d
(8.61)
m = (mc) = m c
dt
Puede cambiar la
masa de un objeto?
Desde luego que s. Imagine un avin
o un auto cuya masa total se reduce
conforme se est consumiendo el
combustible debido a su operacin.
8.3.2
dp
rdV
dt
(8.63a)
FH dc rdV IK +
dt
F d r rdV I +
H dt K
FH dc rdV IK +
dt
F d r rdV I
H dt K
(8.63b)
Observando que
dr
=vr
(8.63c)
dt
donde v es la velocidad angular del cuerpo B, la ecuacin (8.63b) puede reordenarse como
~ O = c c
m
F
H
I FH
K
rdV + c v rrdV +
V
IK
rrdV c +
r (v r)rdV
(8.63d)
w r)rdV
r (w
www.FreeLibros.me
(8.65)
8.3
La formulacin Newton-Euler
183
rgido alrededor del centro de masa C. Adems, el vector c de la ecuacin (8.64) es la velocidad del centro de masa C respecto al sistema de referencia F. Adicionalmente, la ecuacin
(8.64) es la cantidad de movimiento angular total de B alrededor del origen O, que es igual
a la cantidad de movimiento angular de una masa puntual con la masa m concentrada en el
centro de la masa, ms la cantidad de movimiento angular de rotacin alrededor de su centro
de masa. Entonces, mediante la definicin del producto vectorial triple, es decir, a (b c)
= (aTc)b (aTc)c, donde a, b, y c son los vectores cartesianos tridimensionales, la expresin
r (v r) de la ecuacin (8.65) puede expresarse como
r (v r) = (rT r)v (rT v)r = [(rT r)1 rrT ]v
(8.66)
(8.67)
donde I es el tensor de inercia del cuerpo B alrededor de su centro de masa C. Aqu cabe
sealar que la cantidad de movimiento angular determinada en la ecuacin (8.67) puede
expresarse en cualquier sistema de referencia. Si se expresa la ecuacin (8.67) en el sistema
de referencia F, se obtiene
~ ] = [I] [w
[m
(8.68)
F
F w ]F
en la que [.]F denota la cantidad del vector o matriz expresada en el sistema F. Si se expresa
la ecuacin (8.68) en un sistema de cuerpo fijo, centro de masa C
~ ] = [I] [w
[m
(8.69)
C
C w ]C
[v]C es la velocidad angular del cuerpo B en relacin con el sistema fijo F, pero expresado en
el sistema del cuerpo C, es decir, [v]C = QT[v]F. La matriz Q de 3 3 es la matriz de rotacin
que describe la orientacin del sistema coordenado C en relacin con el sistema F. Pues es un vector, su transformacin sigue a la de un vector, a saber,
to que m
~ ] = Q[ m
~]
(8.70)
[m
F
C
Cuando se sustituyen las ecuaciones (8.68) y (8.69) en la ecuacin (8.70), se obtiene
(8.71)
w ]F = Q[I]C [w
w ]C
[I]F [w
El uso de [v]C = QT[v]F en la ecuacin (8.71) proporciona
(8.72)
[I]F = Q[I]C QT
La ecuacin (8.72) transforma una matriz de inercia expresada en un sistema de referencia en otra. Ambas matrices de inercia se toman alrededor del centro de masa C. Los
elementos de [I]C son constantes porque generalmente estn expresados en el sistema del
cuerpo fijo C. Sin embargo, los elementos de [I]F no lo son, ya que estn expresados en el
sistema fijo F, y la orientacin del sistema C en relacin con F es dependiente del tiempo.
La dependencia de [I]F resulta de la matriz de rotacin Q.
8.3.3
Ecuaciones de movimiento
Se asume que existe un sistema fijo de inercia respecto a la cual se derivarn las ecuaciones
de movimiento de Newton-Euler (NE). Como se muestra en la figura 8,8, suponga que F es
el sistema fijo. Adems, el vector m es la cantidad de movimiento lineal del cuerpo rgido B
www.FreeLibros.me
184
CAPTULO
Dinmica
f
Cuerpo, B
Z
ZC
YC
n
C
XC
Sistema,C
c
Masa: m;
Inercia: I
O
Y
Sistema,F
Figura 8.8
expresado en el sistema F, y la cantidad de movimiento angular correspondiente se represen . Suponga tambin que los vectores f O y nO son las resultantes de fuerzas y
ta por el vector m
momentos ejercidos sobre el cuerpo rgido B en y alrededor del origen O, respectivamente.
Entonces pueden definirse las ecuaciones lineales de Newton como la derivada respecto al
tiempo de la cantidad de movimiento lineal m, es decir,
dm
fO =
(8.73)
dt
mientras que las ecuaciones rotacionales de movimiento de Euler se dan como la razn de
O, es decir,
cambio de la cantidad de movimiento angular respecto al tiempo m
~O
dm
(8.74)
nO =
dt
Si se toma un punto arbitrario como referencia, la aplicacin de las ecuaciones bsicas
de movimiento (8.73)-(8.74) podr resultar inconveniente. A continuacin se mostrar que,
cuando se usa el centro de masa C como punto de referencia, el movimiento del cuerpo rgido
puede dividirse de forma natural en dos partes: el movimiento lineal del centro de masa C
ms un movimiento rotacional del cuerpo rgido alrededor del centro de masa C.
En la figura 8.8, el centro de masa de un cuerpo rgido B es C, denotado por el vector c.
En primer lugar se aplican las leyes de Newton. La sustitucin de la ecuacin (8.61) en la
ecuacin (8.73) da como resultado
d ( mc )
fO =
(8.75)
dt
Para un cuerpo de masa constante, la ecuacin (8.75) se reduce entonces a
dc
fO = m
= m c
(8.76)
dt
La ecuacin (8.76) se llama ecuacin de movimiento de Newton para el centro de masa.
Luego se considera el movimiento rotacional del cuerpo rgido B. La diferenciacin de la
ecuacin (8.53) respecto al tiempo da como resultado
~
~O
dm
dm
dc
(8.77)
=cm
+
dt
dt
dt
www.FreeLibros.me
8.3
La formulacin Newton-Euler
185
(8.83a)
o simplemente
w ]F ([I]F [w
w ]F )
[n]F = [I]F [ w ]F + [w
donde
[I]F Q[I]C QT
(8.83b)
La ecuacin (8.83b) se llama ecuacin de movimiento rotacional de Euler para un sistema de cuerpo no-fijo por ejemplo, el sistema fijoF. Aunque las ecuaciones (8.82) y (8.83b)
tienen forma similar, son fundamentalmente diferentes. Los elementos del tensor de inercia
en la ecuacin (8.82) son constantes, mientras que los de la ecuacin (8.83b) estn subordinados al tiempo. Por lo tanto, se prefiere la ecuacin (8.82) sobre la ecuacin (8.83b).
www.FreeLibros.me
186
CAPTULO
8.4
Dinmica
www.FreeLibros.me
8.4
Zi, ei
187
Zi+1, ei+1
Articulacin i
Articulacin i + 1
Ci
ri
mig
fi, i+1
di
ai
Oi+1
Z1
Xi+1
ni, i+1
ai
oi+1
bi
oi
Xi
Oi
Y1
ni1, i
X1
Figura 8.9
fi1, i
dades pueden calcularse entonces de manera recursiva, empezando con el primer eslabn
mvil y terminando con el eslabn del efector final. Las condiciones iniciales para el eslabn de base son c0 = c0 = v0 = w 0 = 0.
igual a q iei para una articulacin de revoluta y 0 para una articulacin prismtica, donde ei
denota el vector unitario apuntando a lo largo del i-simo eje de la articulacin. Por ende, la
velocidad angular del eslabn i puede escribirse como
wi =
|RSw
|Tw
i -1
+ q i e i
i -1
(8.84a)
|RSQ
|TQ
T
i - 1 [w i - 1]i - 1
T
i - 1 [w i - 1]i - 1
+ q i [e i ]i
donde la transposicin de la matriz de rotacin de 3 x 3 que representa la orientacin del sistema i + 1 adjunto al eslabn i respecto a la de i adjunto al eslabn i 1 se determina por
LM
MM
N
cq i - 1
QTi1 -ca i -1 sq i - 1
s a i - 1 cq i - 1
sq i - 1
ca i - 1 cq i - 1
0
sa i -1
- sa i - 1 cq i - 1 ca i - 1
www.FreeLibros.me
OP
PP
Q
(8.85)
188
CAPTULO
Dinmica
donde qi, ai son los ngulos de articulacin y torsin de los parmetros DH que se definieron
en el captulo 5, mientras que el vector unitario
[ei]i [0, 0, 1]T
apunta a lo largo del i-simo eje de articulacin y se expresa en su sistema de coordenadas.
La aceleracin angular del eslabn i se obtiene mediante la diferenciacin de la ecuacin (8.84a) respecto al tiempo, es
decir,
w i - 1 + q i e i + q i w i ei : para una articulacin de revoluta
(8.86a)
w i =
i - 1
w
: para una articulacin prismtica
R|
S|
T
|RSQ
|TQ
T
i - 1]i - 1 + q i [ei ]i
i - 1[ w
T
i - 1]i - 1
i - 1[w
+ q i [w i ]i [e i ]i
RSc
Tc
i -1 +
(8.87a)
|RSQ
|TQ
T
i - 1 ([ c i - 1]i - 1
T
c
i - 1 ([ i - 1]i - 1
(8.87b)
donde
w i1]i1
[w
w i]i = Q Ti1 [w
para la articulacin prismtica se obtiene en la ecuacin (8.87b). Adems,
[di]i = [ai]i [ri]i
en la que
LM
MM
N
OP
PP
Q
LM
MM
N
a i cq i
rix
[ai]i ai sq i ; y [ri]i+1 riy
bi
riz
www.FreeLibros.me
OP
PP
Q
(8.88)
8.4
189
y donde rix, riy y riz son los componentes constantes del vector ri en el sistema(i + 1) que se
adjunta al eslabn i. La ecuacin (8.87b) es la frmula recursiva para calcular la velocidad
lineal del eslabn i en trminos del eslabn (i 1).
Revoluta
Prismtica
(8.89a)
donde se usan para la derivacin de la ecuacin (8.89a) i = i-1 y i = i-1 para las articulaciones prismticas, as como las ecuaciones (8.84a) y (8.86a), respectivamente. Al expresar
la ecuacin (8.89a) en el i-simo sistema coordenado se obtiene entonces como
(8.89b)
2
donde todas las cantidades vectoriales dentro de [...] estn representadas en el sistema j para
j = i 1 e i. La ecuacin (8.89b) es la frmula recursiva para calcularla aceleracin lineal
del eslabn i en trminos de la del eslabn i 1.
v) Aceleracin de la gravedad
(8.90)
El signicado
de recursivo
Las velocidades, fuerzas, etc., de eslabones se computan para un eslabn
despus de que se conozcan las mismas para sus eslabones anteriores o
posteriores.
[fi]i = mi [ c i ] i
(8.91a)
i]i
w i ]i [Ii] i [w
w
[ni]i = [Ii] i [ w i ] i + [w
(8.91b)
www.FreeLibros.me
190
CAPTULO
Dinmica
Luego se escriben las ecuaciones de balance de fuerza y momento alrededor del centro
de masa del eslabn i. Como se ve en la figura 8.9,
[fi] i = [fi1,i] i [fi,i+1,] i + mi [g] i
[ni] i = [ni1,i] i [ni,i+1] i [di]i [fi1,i] i [ri]i [fi,i+1,] i
(8.92a)
(8.92b)
Las ecuaciones (8.92c-d) pueden usar para resolver [fi1,i]i y [ni1,i]i en forma recursiva,
empezando con el eslabn del efector final. Para el efector final, el momento y la fuerza
[nn, n+1]n+1 y [fn, n+1]n+1, respectivamente, representan el momento externo y la fuerza externa
aplicadas por el efector final sobre el ambiente, como se explic en el captulo 7. Se asume
que estos valores son conocidos.
8.4.3
R|[e ] [n
S|[e ] [f
T
T
i i
T
i i
i - 1, i ]i
i - 1, i ]i
(8.93)
La ecuacin (8.93) declara que i no es otra cosa que el ltimo elemento del vector [ni1,i]i
o [fi1,i]i.
Ejemplo 8.8
LM
MM
N
Y1
OP
PP
Q
(8.95)
LM
N
[d]1 1 acq
2
1 asq
2
X1
f
x
01
Figura 8.10
OP
Q
www.FreeLibros.me
y
01
Diagrama de
cuerpo libre
de un eslabn
8.4
y
[r]2 =
LM a
N2
0 0
OP
Q
191
(8.96)
Suponga que el eslabn es una viga cuadrada con un rea de seccin transversal relativamente pequea. Entonces la matriz de inercia del eslabn alrededor de su centro
de masa C representada en un sistema adjunto a s mismo, es decir, el sistema 2, se
da por
0 0 0
ma 2
(8.97)
0 1 0
[I]2 =
12
0 0 1
OP
PP
Q
LM
MM
N
[ c ]1
LM0OP
LM0OP
= 0 ; y [ w ] = 0
MMq PP
MMqPP
NQ
NQ
s
q
L OP
LM-sq OP
aM
a
= q M cq P ; y [ c ] = q M cq P q
2
2
MN 0 PQ
MN 0 PQ
(8.98a)
LM
MM
N
cq
a s
q
2
0
OP
PP
Q
(8.98b)
F
GG
GH
LM
MM
N
OP
PP
Q
LMcq OPI
MMsq PPJJJ
N 0 QK
[f01]1
LM OP
MM PP
NQ
0
a2
; [n]1 = m
0
12
q
www.FreeLibros.me
(8.99)
192
CAPTULO
Dinmica
[n01]1
LM
OP
0
= M
MM ma q + ma 0q + 1 mgasq PPP
N 12 4 2 Q
2
(8.100)
c) Clculo del par de torsin en articulaciones Finalmente, aplicando la ecuacin (8.93) para computar el par de torsin requerido, la nica ecuacin
dinmica se obtiene como
1
1
(8.101)
t = ma2q + mgasq
3
2
que nuevamente es la misma que en la ecuacin (8.53) u (8.54b).
Ejemplo 8.9
LM
sq
MM 0
N
OP
0 ;y Q
P
1 PQ
cq 1
0
LM
sq
MM 0
N
cq 2
0
OP
0
P
1 PQ
(8.102)
a1sq1
(8.103)
Adems, suponiendo que los eslabones son homogneos, los vectores [di]i y [ri]i+1
para i = 1, 2 se dan como
[di]i
LM 1 a cq
N2
i
1
a sq
2 i i
OP
Q
; y [ ri]i+1 =
LM a
N2
0 0
OP
Q
(8.104)
Suponga que los dos eslabones son vigas cuadradas con un rea de seccin transversal
relativamente pequea. Entonces la matriz de inercia del eslabn i alrededor de su
centro de masa representada en un sistema coordenado adjunto se da por
LM
MM
N
OP
PP
Q
0 0 0
mi ai2
0 1 0 ; para i = 1, 2
Ii+1 =
12
0 0 1
(8.105)
www.FreeLibros.me
8.4
[w
w 1]1
LM 0 OP
LM 0 OP
= M 0 P ; y [ w ] = M 0 P
MNq PQ
MNq PQ
L-sq OP
a M
=q
; y [ c ]
cq
P
2 M
MN 0 PQ
1
[ c 1 ]1
(8.106a)
1 1
193
a1
1 = q1
2
LM-sq OP
MM cq PP q
N0Q
1
2
1
LM
MM
N
cq 1
a1
sq 1
2
0
OP
PP
Q
(8.106b)
LM 0 OP
LM 0 OP
w ] = M 0 P ; y [ w ] = M 0 P
[w
MNq + q PQ
MNq + q PQ
LM - a sq q OP
2
M
P
a
[ c ] = Ma q +
cq q P ;
2
MN
PQ
0
LM-a q - a ( sq q + cq q )OP
2
M
P
a
[ c ] = M a q +
(cq q - sq q ) P
2
MN
PQ
0
2 2
2 2
(8.107a)
2 2
2 2
12
2
1
12
12
12
2
12
2
12
(8.107b)
donde q 12 q 1 + q 2 q12 q1 + q2. La aceleracin por gravedad expresada en el segundo sistema del eslabn es
[g]2 = Q1T [g]1 = [ g1sq1 g1cq1
0]T
www.FreeLibros.me
194
CAPTULO
Dinmica
[f2]2
2
1
2
12
12
12
2
2
2
12
2 2
(8.108)
12
[f12]2
[n12]2
2
1
x
2 12
12
12
2
12
y
2 12
2
12
2
2
x
12
y
12
(8.109a)
(8.109b)
z
12
12
F
GG
GH
OP
PP
Q
LM
MM
N
y
1 12
x
1 12
[f01]1
[n01]1
OPI
PPJJJ ; [n ]
QK
OP
PP
Q
LM cq f - sq f - m a (sq q + cq q ) OP
2
M
P
a
= Msq f + cq f + m
(cq q - sq q ) + m g P
2
MN
PQ
0
0
L
OP
= MM
0
MM m a q + n + a f + m g a cq PPP
2
N 3
Q
LM
MM
N
- sq 1
cq 1
a1
2
q 1 cq 1 - q 1 sq 1
[f1]1 = m1
2
0
0
x
1 12
2
1 1
LM
MM
N
0
a12
0
1 = m1
12
q1
2
1 1
y
1 12
z
12
y
1 12
1 1
(8.110)
2
1
(8.111a)
(8.111b)
Finalmente,
aplicando la ecuacin (8.93) para computar el par de torsin requerido, se obtienen
dos ecuaciones dinmicas como
F
H
m1a12
m a2
a
q 1 + 1 m2a1a2 sq2 q 12 + 2 2 q12 + m2 g 2 cq 12 + a1 cq 1
2
3
3
2
a
a1
a1a 2
2
+ m1 g
cq1 + m2
cq 2 q1 + m2 a1 a1q 1 + 2 (cq 2 q12 - sq 2 q 12
)
2
2
2
t1 =
t2 =
LM
N
m aa
m a
m2 a22
q 12 + 2 1 2 [cq2 q1 + sq2 q 12 ] + 2 2 gcq12
2
2
3
www.FreeLibros.me
I
K
OP
Q
(8.112a)
(8.112b)
8.5
Algoritmos dinmicos
195
8.5
Algoritmos dinmicos
En la dinmica de robots se resuelven por lo general dos tipos de problemas. Uno se llama
dinmica inversa, donde se dan los parmetros geomtricos inerciales del robot, as como los
movimientos de las articulaciones, es decir, sus posiciones, velocidades y aceleraciones, y
se calculan los correspondientes pares de torsin y las fuerzas de articulaciones. El segundo
se llama dinmica progresiva o directa, donde se obtienen las aceleraciones de las articulaciones, dados los parmetros geomtricos e inerciales. Mientras que la dinmica inversa se
usa para el control de robots, la dinmica directa es esencial para la simulacin. Al tomar en
cuenta las ecuaciones de movimiento, ecuacin (8.44a), se observa que la dinmica inversa
requiere la evaluacin de su lado izquierdo, mientras que la dinmica directa resuelve las
aceleraciones de las articulaciones.
Ejemplo
Ejemplo8.10
8.10
LM
N
FH IK OP
Q
q (T ) - q ( 0)
T
2p
tt
sen
T
T
2p
(8.113a)
www.FreeLibros.me
196
CAPTULO
Dinmica
LM F I OP ,
N H KQ
q (T ) - q ( 0) L 2p
q =
MN T sen FH2Tp tIK OPQ
T
q (T ) - q ( 0 )
2p
t
1 - cos
q =
T
T
(8.113b)
Observe que la trayectoria de la ecuacin (8.113a) se eligi de tal manera que las
velocidades y aceleraciones de articulacin al principio y al final son ceros, es decir,
q (0) = q (T ) = 0 y q (0) = q (T ) = 0. Mediante el programa de MATLAB que se presenta a continuacin, las grficas de articulacin y el correspondiente par de torsin se
evalan segn la ecuacin (8.53) y se dan en las figuras 8.11 y 8.12. En la figura 8.11,
3
2.5
2
1.5
1
0.5
0
0.5
Figura 8.11
4
5
6
Tiempo (seg)
Trayectoria de la articulacin
www.FreeLibros.me
10
8.5
Algoritmos dinmicos
197
Figura 8.12
Ejemplo 8.11
4
5
6
Tiempo (seg)
10
ang = con*ti(i);
% Joint trajectory
th1 (i) = th10 + (delth1/T)*(ti (i) - sin(ang)/con);
th1d (i) = delth1*(1 - cos(ang))/T; th1dd (i) = delth1*con*sin(ang)/T;
th2 (i) = th20 + (delth2/T)*(ti (i) - sin(ang)/con);
th2d (i) = delth2*(1 - cos(ang))/T; th2dd (i) = delth2*con*sin(ang)/T;
thdd = [th1dd(i);th2dd(i)];
%Inertia matrix
sth2 = sin(th2(i)); cth2 = cos(th2(i));
i22 = m2*a2*a2/3;i21 = i22 + iner21*cth2/2;i12 = i21;
i11 = i22 + m1*a1*a1/3 + m2*a1*a1 + iner21*cth2;
www.FreeLibros.me
198
CAPTULO
Dinmica
8.5.2
3.5
th1
th2
3
2.5
2
1.5
1
0.5
0
Figura 8.13
4
5
6
Tiempo (seg)
10
www.FreeLibros.me
8.5
Algoritmos dinmicos
199
25
tau1
tau2
20
15
10
5
0
5
10
15
20
0
Figura 8.14
4
5
6
Tiempo (seg)
10
bras, se sabe que el vector s, como en la ecuacin (8.44a), encontrar al vector p. El problema
de la dinmica directa requiere la solucin de las aceleraciones de articulacin p segn las
ecuaciones de movimiento, la cual es algebraica de naturaleza, es decir,
= I 1 (tt h g )
q
(8.114)
(8.115a)
LM y (t) OP = LM
Ny (t)Q NI
1
2
-1
y 2 (t )
(t - h - g )
www.FreeLibros.me
OP
Q
(8.115b)
200
CAPTULO
Dinmica
Ejemplo 8.12
FH
IK
FH
IK
3 t - 1 mgasq
2
ma 2
Por lo tanto, la forma espacio-estado se determina por
y1 = y2
(8.116)
3 t - 1 mgasq
(8.117)
2
ma 2
Figura 8.15
Simulacin de un
brazo de un eslabn, nicamente
bajo gravedad
th (rad)
thd (rad/sec)
4
www.FreeLibros.me
4
5
6
Tiempo (seg)
10
8.5
Ejemplo 8.13
Algoritmos dinmicos
201
Simulacin de un manipulador
de dos eslabones
(8.118)
www.FreeLibros.me
CAPTULO
Dinmica
10
th 1
th 1d
8
6
4
2
0
2
4
6
8
0
4
5
6
Tiempo (seg)
10
a) Articulacin 1
202
20
th 2
th 2d
15
10
5
0
5
10
15
20
25
0
4
5
6
Tiempo (seg)
b) Articulacin 2
Figura 8.16
www.FreeLibros.me
10
203
RESUMEN
En este captulo se presenta la dinmica de cuerpo rgido de un sistema robtico, usando
tanto la formulacin de Euler-Lagrange como la de Newton-Euler. Se da un ejemplo del
brazo de un eslabn y un grado de libertad (DOF), y otro del manipulador de dos eslabones y DOF = 2, para ilustrar ambas formulaciones. Tambin se presentan los resultados
de dinmica inversa y directa que se usan en el control y la simulacin de un robot.
EJERCICIOS
8.1
8.2
8.3
8.4
8.5
8.6
8.7
8.8
8.9
www.FreeLibros.me
204
CAPTULO
Dinmica
www.FreeLibros.me
Esttica
205
Captulo
9
Dinmica recursiva
de robots*
Este captulo introduce una de las metodologas basadas en los complementos ortogonales para la genePor qu recursivo?
racin automtica de algoritmos dinmicos, a saber,
Se sabe que los algoritmos recursivos
las dinmicas inversa y directa. Como se mencion en
proporcionan algoritmos de compuel captulo 8, la dinmica inversa es esencial para el
tacin ecientes y numricamente
control de manipuladores robticos, mientras que la
estables.
dinmica directa es necesaria para la simulacin por
computadora y el control de retroalimentacin en tiempo real. Adems, para resolver los
problemas de dinmica inversa o directa de un sistema robtico complejo, se necesita un
conjunto de ecuaciones dinmicas de movimiento del robot en estudio, las cuales se definen
en el captulo 8 usando las formulaciones de Euler-Lagrange (EL) y Newton-Euler (NE).
Las ecuaciones de movimiento resultantes pueden ser ecuaciones diferenciales ordinarias
(ODE) o ecuaciones algebraicas diferenciales (DAE) (Shabana, 1994). El mismo conjunto
puede obtenerse mediante planteamientos alternativos, por ejemplo, complementos ortogonales de las restricciones de velocidad (Huston y Passerello, 1974), las ecuaciones de Kane
(Kane y Levinson, 1983) y otros. De entre ellos, muchos investigadores adoptaron el planteamiento de complementos ortogonales para la generacin automtica de las ecuaciones de
movimiento para sistemas mecnicos complejos, tales como los robots que se estudian en
este libro. Uno de estos complementos es el complemento ortogonal natural (NOC) que originalmente propusieron ngeles y Lee (1988) para robots seriales, pero que generalizaron
* Este captulo requiere la comprensin exhaustiva de los captulos 7 y 8. Por lo tanto, slo debe impartirse a estudiantes de posgrado, es decir, alumnos del nivel M. Tech./M.S./Ph.D.
www.FreeLibros.me
206
CAPTULO
Saha y ngeles (1991) para tomar en cuenta tambin las restricciones no holonmicas de
robots mviles sobre ruedas. Posteriormente, Saha (1997, 1999, 2003) desacopl el NOC, lo
que se denomin NOC Desacoplado (DeNOC) y mostr tener las siguientes ventajas:
Permite obtener algoritmos de dinmica inversa y directa del orden recursivo (n),
siendo n el nmero de eslabones del robot. El algoritmo de la dinmica directa recursiva no fue posible obtenerlo con la forma original del NOC.
Cada elemento escalar de las matrices y vectores que se asocian con las ecuaciones
de movimiento del manipulador robtico puede escribirse en forma analtica, lo que
permite proporcionar la interpretacin fsica, por ejemplo, la inercia del cuerpo
articulado, etc., y le ayuda al programador en la depuracin de los algoritmos de
computacin.
Puesto que la metodologa se construye sobre la mecnica bsica y las teoras del
lgebra lineal, este concepto pueden entenderlo incluso estudiantes de licenciatura.
9.1
Modelado dinmico
www.FreeLibros.me
9.1
Oi
O3
i+1
3
n
#2
On
#n
O2
#1
207
Oi+1
#i
i
Z
Modelado dinmico
O1
Efector terminal
Y
1
Sistema de
referencia F
Cuerpo compuesto i
X
a) Cadena serial
vi (velocidad)
i
(velocidad angular)
Ci
ni
ci
O
mi: masa
Ii: tensor de inercia
fi
Figura 9.1
9.1.1
Un manipulador serial
Ii w i + w i Iiw i = ni
(9.1a)
(9.1b)
Ecuacin de Newton :
mi c i = fi
.
donde vi y v i son los vectores tridimensionales de velocidad y aceleracin angulares del
i-simo eslabn, respectivamente, mientras que ci es el vector tridimensional del centro de
masa alrededor de Ci. Adems, ni y fi son los vectores tridimensionales del momento resultante alrededor de Ci y la fuerza resultante en Ci, respectivamente. Cabe sealar en este punto que
no se hace referencia alguna al sistema de coordenadas para expresar los vectores y matrices,
ya que pueden representarse en cualquier sistema definido por el analista. Normalmente se
expresan en el sistema adjunto al i-simo eslabn, es decir, el sistema (i + 1). Sin embargo,
se evitarn durante las derivaciones de las ecuaciones de movimiento de las secciones y subsecciones siguientes. Cuando se combinan las ecuaciones (9.1 a-b), las seis ecuaciones de
movimiento de NE escalares y sin acoplamiento se escriben en forma compacta como
Mi t i + Wi Mi Ei ti = wi
www.FreeLibros.me
(9.2a)
208
CAPTULO
LMI
NO
OP
Q
LM
N
OP
Q
O
wi 1 O
; y Wi
mi 1
O
O
(9.2b)
LMw OP y w LMn OP
N c Q
Nf Q
i
(9.2c)
donde, en contraste con la definicin de torsin que se seal en la seccin 6.6, se toma en
consideracin la velocidad lineal del centro de masa del i-simo eslabn Ci. En la ecuacin
(9.2a), el vector ti es la derivada respecto al tiempo del vector de torsin ti, tal como se define en la ecuacin (9.2c). La ecuacin (9.2a) se escribe ahora para todos los n eslabones, es
decir, i = 1, n, como
(9.3a)
M t + WMt = w
donde M y W son la matriz de masa generalizada 6n 6n y la matriz generalizada de las
velocidades angulares, respectivamente, las cuales se determinan por
M diag. [M1, , Mn], y W diag. [W1, , Wn ]
(9.3b)
9.1.2
Restricciones cinemticas
Los eslabones del manipulador robtico de la figura 9.1a) se acoplan por pares o articulaciones cinemticos que son rotacionales o prismticos. A partir del movimiento de cuerpo
rgido de los dos cuerpos, a saber, #i y #j, como se ve en la figura 9.2, pueden derivarse las
velocidades angulares y lineales del i-simo eslabn, es decir, la torsin del i-simo cuerpo
que se define en la ecuacin (9.2c) segn las velocidades del j-simo eslabn, y el movimiento de articulacin de la i-sima articulacin. stos se derivan de la siguiente manera:
(9.4a)
w = w + e q
i
i i
c i = c j + w j rj + w i di
(9.4b)
9.1
pi
209
ei
ej
#i
Cj
cjk
di
rj
#j
Ci
cij
cik
ci
cj
Ck
Modelado dinmico
Sistema de
referencia inercial
#k
O
Figura 9.2
dimensiones son funciones de las posiciones de los centros de masas de los dos cuerpos sucesivos Ci y Cj de la figura 9.2 y el eje de la articulacin que los une, a saber, ei. Lo anterior
se define como
1
O
ei
(9.4d)
Bij
y pi
c ij 1 1
ei di
LM
N
OP
Q
LM
N
OP
Q
donde cij 1 es el tensor de producto vectorial que se asocia con el vector cij como se muestra
en la figura 9.2, que es definido de manera similar a vi 1 de la ecuacin (9.2b), es decir,
(cij 1)x = cij x
para cualquier vector cartesiano tridimensional arbitrario x. El vector cij se determina por
cij = di rj. Es interesante observar en este punto que la matriz Bij y el vector pi tienen las
siguientes interpretaciones:
Para dos cuerpos mviles rgidamente conectados #i y #j, Bij propaga la torsin de
#j a #i. Por ende, la matriz Bij se denomina aqu matriz de propagacin de torsin, la
cual tiene las siguientes propiedades:
BijBjk = Bik ; Bii = 1; y Bij1 = Bji
(9.5a)
El vector pi, por otro lado, toma en cuenta el movimiento de la i-sima articulacin.
Por lo tanto, pi se denomina vector de propagacin de velocidad de articulacin, el
cual depende del tipo de articulacin. Por ejemplo, la expresin de pi en la ecuacin
(9.4d) es para una articulacin rotacional como la que se presenta en la figura 9.2,
mientras que para una articulacin prismtica, el vector pi se determina por
pi
(9.5b)
t = N q , donde N Nl Nd
(9.6a)
donde ei es el vector unitario paralelo al eje del movimiento lineal. En forma correspondien
te, qi de la ecuacin (9.4c) significar la rapidez de articulacin lineal. No se tratarn otras
articulaciones aqu porque cualquier otro tipo, por ejemplo, una esfrica o una roscada,
puede emplearse como combinacin de tres pares rotacionales o de pares de rotacionales y
prismticos, respectivamente. Para i = 1, , n, la ecuacin (9.4c) se escribe en forma compacta para todas las n articulaciones como
www.FreeLibros.me
210
CAPTULO
donde t, que contiene las torsiones de todos los eslabones, es la torsin generalizada de 6n
dimensiones que se define en la ecuacin (9.3c). En la ecuacin (9.6a) se expresa como una
LM 1
B
N M
MM
NB
21
O
1
n1
Bn2
OP
PP
PQ
LM
MM
MN
O
p1 0
O
0 p2
; Nd
1
0 0
OP
PP
PQ
LM
MM
MM
N
0
q 1
0
q
; y q 2
q
pn
n
PPO
PP
PQ
(9.6b)
9.1.3
Las ecuaciones NE desacopladas de movimiento obtenidas por la ecuacin (9.3a) se reescriben como
(9.7)
M t + WMt = w E + wC
donde w de la ecuacin (9.3a) se sustituye por w wE + wC, donde wE y wC son las llaves de
torsin externas y de restriccin, respectivamente. La llave de torsin externa wE la aportan
los momentos y fuerzas que resultan de los actuadores de articulaciones, efectos ambientales, etc., mientras que la llave de torsin de restriccin wC se debe a la presencia de las
articulaciones que contienen los momentos y fuerzas de reaccin en las interfaces de articulaciones. Puesto que la llave de torsin de restriccin wC no hace ningn trabajo til para el
movimiento de los eslabones del robot, la energa consumida que se debe a wC, es decir, PC
tTwC, desaparece. El nico propsito de wC es mantener la configuracin relativa de los
eslabones sin separarse. Si se usa la expresin para la torsin generalizada t de la ecuacin
(9.6a), la energa disipada debido a wC, PC se determina por
P C tT wC q T NT wC q T NTd NTl wC = 0
(9.8a)
(9.8b)
T
lizada t segn la ecuacin (9.6a), denominada, t = Np + Np. Observe que la ecuacin (9.9a),
www.FreeLibros.me
9.2
Expresiones analticas
211
donde se usa Nd = Nd diag. [1,..., n]; i diag. [wi 1, wi 1], y las matrices N1,
M, W y el vector wE estn previamente definidos. Observe en lo anterior que t no es ms
que el vector de rapidez de torsin, mientras que p = 0. Cabe sealar en este punto que la
ecuacin (9.9a) tambin se deduce en el captulo 8, es decir, en la ecuacin (8.44a), usando
las ecuaciones de movimiento de Euler-Lagrange. En ese ltimo caso, se requieren complejas diferenciaciones parciales, mientras que el primero proviene de las ecuaciones de movimiento de Newton-Euler que pueden visualizarse ms fcilmente en el espacio cartesiano
tridimensional y mediante conceptos sencillos de lgebra lineal.
9.2
Expresiones analticas
Puede demostrarse que por medio del concepto de las matrices DeNOC, cada elemento
de las GIM y MCI, as como del VIC y de las fuerzas generalizadas, puede expresarse en
forma analtica, lo que permite extraer muchas interpretaciones fsicas y sugiere maneras
de simplificar las expresiones y la complejidad computacional. A continuacin se obtienen
las expresiones analticas.
9.2.1
212
CAPTULO
LM M~
~
M B
M
~
~
M MM B
MM
MNM~ B
sym
21
31
~
M2
~
M 3B 32
~
M3
~
M n B n2
OP
PP
PP
PQ
(9.10b)
~
~
M n B n3 M n
n n1
~
~
donde sym denota los elementos simtricos de la matriz M. La matriz Mi de 6 6, que se
evala de i = n a i = 1 como
~
M i Mi +
BTki M k Bki
(9.10c)
k = i +1
que requiere clculos del orden n2, ya que hay una suma a travs de k = i + 1, ..., n. Sin
embargo, una mirada profunda a la ecuacin, junto con las primeras dos propiedades de
la misma (9.5a), revela que la expresin de suma puede evaluarse en forma recursiva para
i = n, ..., 1 como
~
~
~
(9.10d)
M i Mi + BTi+1,i Mi +1 Bi+1 ,i donde M n M n
La ecuacin (9.10d) tiene las siguientes interpretaciones fsicas:
1) Es la matriz de masa de un cuerpo compuesto por los eslabones #n, ..., #i, que se conectan en forma rgida. Esto se denomina el cuerpo compuesto i, como se indica en
~
la figura 9.1a), cuyo nombre puede justificarse a partir de las matrices de bloque Mi.
En la ecuacin (9.10d), si i = n, entonces
LM
N
In
~
M n = Mn
O
y para i = n 1,
O
mn 1
OP
Q
(9.11a)
~
~
M n -1 = M n1 + BTn,n1 M n Bn,n1
lo que puede reescribirse como
LM
MN
(9.11b)
OP
PQ
~
~
I
- d n -1 1
~
M n -1 ~ n -1
(9.11c)
~ 1
d n -1 1
m
n -1
~ , el vector tridimensional c~ y la matriz I~ se determinan por
donde el escalar m
n1
n1
n1
~
~
~
(9.12a)
m
n -1 m n1 + mn , donde mn = mn
~
~
~
(9.12b)
d n -1 mn cn,n1 + d n , donde d n = 0
~
~
~
~
(9.12c)
In -1 I n1 + In d n -1 (cn,n1 1), donde In = I n
~
La matriz I n1 es el tensor de inercia del cuerpo compuesto por los eslabones rgidamente conectados #(n 1) y #n respecto al centro de masa del (i 1)-simo eslabn,
es decir, Ci-1, en el cual el tercer trmino no es ms que el que se asocia con la transfe-
www.FreeLibros.me
9.2
213
Expresiones analticas
LM p M~ p
MMp M~~ B p
I p M B p
MM
MNp M~ B p
2
21 1
31 1
T ~
p2 M 2 p2
~
p 3T M 3 B32 p 2
n1 1
~
p nT M n B n 2 p 2
T
1
T
2
T
3
T
n
1 1
~
p 3T M 3 p 3
~
p Tn M n B n3p 3
sym
T ~
p n M np n
OP
PP
PP
PQ
(9.14a)
donde sym denota los elementos simtricos y los elementos (i, j) de la GIM, que se
denotan por iij, lo que se proporciona en forma analtica como
~
iij pTi M i Bij pj , para i = n, , 1; j = i, , 1
(9.14b)
Observe que los elementos simtricos que aparecen encima de los elementos diagonales de la GIM en la ecuacin (9.14a) pueden expresarse como
~
iji pTj B Tij M i pi, para i = n ,, 1; j = i 1 ,, 1
(9.14c)
En la ecuacin (9.14a), iij = iji. Por ende, slo se necesita calcular (9.14b) o (9.14c) en
el algoritmo dinmico. En los ejemplos de este captulo se calcularn los elementos
del tringulo inferior de la GIM por medio de (9.14b).
9.2.2
Las expresiones analticas de la matriz de trminos de inercia convectiva (MCI) se determinan segn la definicin de MCI que se seal en seguida de la ecuacin (9.9), es decir,
~
~
~
+ WMN) NT ( M
C NT (M N
(9.15a)
d
l + M w + M e )Nd
~ ~
~
donde las matrices Ml, Mw y Me de 6n 6n se reproducen segn la ecuacin (9.9b) como
~
~
~
~
T
T
l;M
M l NTl M N
w MW N l MNl W ; y M e N l WMNl
www.FreeLibros.me
(9.15b)
214
CAPTULO
~
La matriz Ml se obtiene entonces como
~
Ml
LM 1
O
M
MM
MNO
B T21 B Tn1
1
T
Bn , n -1
O
1
OP LM
PP MM O
PP MMN O
Q
O
M2
OP LM O
PP MMB
PM
M Q MNB
O
O
21
B
n , n -1
n1
O
O
OP
PP
P
OPQ
O
O
(9.15c)
LM O
N- (r + d
OP
Q
O
(9.15d)
i
i + 1) 1 O
B i +1, i
LMB H~
MM H~~
MM H
MN H~
T
21
~
Ml
T ~
B 31
H 32
T ~
B 32 H 32
~
H 32
21
21
31
~
T
B n , n - 1H n, n - 1
~
H n, n -1
~
H n2
n1
OP
P
P
P
P
O PQ
~
B Tn1H n , n - 1
(9.15e)
~
~
~
~
T
~ En la ecuacin (9.15e), Hij = Mi Bij + B i+1,i Hi+1,i y para i = n, Hn+1,n = O. Luego, la matriz
Mw de 6n 6n, como se define en la ecuacin (9.15b), se forma como
LM M~
~
M B
M
MM
MNM~ B
1
~
Mw
lo que proporciona
21
n1
~
~
M n Bn2 M n
LM M~ W
~
M B W
M
MM
MNM~ B W
~
1 1
~
Mw
21 1
n1 1
OP L
PP MM
PP MMN O
Q
OP
P
P
P
W Q
sym W1 O
O W2
~
M2
T ~
B 21
M 2 W2
~
M1W2
~
M n B n 2 W2
O
~
B Tn1M n Wn
~
B Tn 2 M n Wn
~
M n Wn
OP
PP
PP
Q
(9.15f)
~
Me
LM 1
O
M
MM
MNO
T
B 21
B Tn1
1
T
B n , n -1
O
1
OP LW M
PP MM O
PP MMN O
Q
1
O
W2 M 2
O
OP LM 1
PP MMB
PM
W M Q NB
www.FreeLibros.me
O
O
21
n1
O
1
OP
PP
P
1Q
O
Bn2
9.2
LM ~ M~
M B
M
MM
MNM~ B
1
~
Me
21
n1
~
M2
~
Mn B n 2
215
Expresiones analticas
sym
~
M n
OP
PP
PP
Q
(9.15g)
~
~
donde Mi para i = n, ..., 1 se calcula en forma parecida a la matriz Mi de la ecuacin (9.10d)
como
~
~
(9.15h)
Mi = Mi + BTi+1,i M i + 1 Bi+1,i
en la que Mi = WiMi para i = n, ..., 1. Los elementos escalares de la MCI, C es decir, cij para
i, j = n, ..., 1 se obtienen entonces explcitamente segn la ecuacin (9.15) como
si i j
(9.15i)
de otra manera.
Al comparar las ecuaciones (9.14b) y (9.15i), se observa que los elementos de la GIM y
de la MCI se expresan de manera uniforme, es decir, pTi (.)pj, donde (.) denota el argumento
de la matriz. En la ecuacin (9.15i), la expresin analtica explcita para cada elemento de
la MCI est disponible, cuyo uso no es recomendable para el clculo del vector h(; Cp) en
la ecuacin (9.9a), pero es conveniente para las interpretaciones fsicas y la depuracin. El
vector h se llama aqu vector de los trminos de inercia convectiva (VCI). Mientras que la
evaluacin explcita de la MCI, C requiere clculos del orden (n2) donde n es el grado de
libertad del robot, el VCI h puede calcularse en forma recursiva y slo requiere operaciones del orden n. El algoritmo del orden n para el VCI se proporciona a continuacin. Ahora,
por lo que respecta a la interpretacin fsica de la MCI, observe que, para un robot planar
con articulaciones exclusivamente rotacionales, todos los ejes son paralelos y no cambian de
9.2.3
LM
MM
MM
N
OP L
PP MM
PP MM
QN
www.FreeLibros.me
OP
PP
PQ
LM
MM
MN
OP
PP
PQ
216
CAPTULO
LM
MM
MM
N
OP
PP
PP
Q
(9.18b)
9.2.4
Fuerza generalizada
Las expresiones para los elementos de las fuerzas generalizadas t que se proporcionan segn
la ecuacin (9.9a) son las siguientes:
~ E , donde w
~ E = NT w E
(9.19a)
t =N w
l
~E
w
LM 1
O
M
MM
MNO
BT21 BTn,1
1
BTn, n -1
O
1
OP LMw OP LMw~
PP MMw PP = MMw~
PP MMw PP MMw~
QN Q N
E
1
E
2
E
1
E
2
E
n
E
n
OP
PP
PP
Q
(9.19b)
~ E w E + BT w
~E y w
~ E w E. La fuerza generalizada t se encuentra entonces
donde w
i
i
i+1
i
i+1,i
n
como
~E
p1T w
1
~E
p T2 w
2
(9.20a)
t
~E
pT w
LM
MM
MM
N
PPO
PP
PQ
Segn la ecuacin (9.19a), cada elemento del vector t n-dimensional, es decir, ti, se
obtiene entonces a partir de
~ E , para i = n, , 1
ti = p iT w
i
www.FreeLibros.me
(9.20b)
9.2
Expresiones analticas
217
Las ecuaciones (9.9a), (9.14b), (9.15i) o (9.18b) y (9.20b) juntas proporcionan las expresiones explcitas para las ecuaciones dinmicas de movimiento para un robot serial de n
eslabones y n grados de libertad.
Ejemplo 9.1
Para el brazo de un eslabn que se presenta en la figura 9.3, se utiliza la ecuacin de movimiento mediante
el concepto de las matrices DeNOC. Si se utilizan las
ecuaciones (9.6a-b), las matrices DeNOC para el brazo
de un eslabn se obtienen mediante
O
q
N = Nl Nd = p,
donde
Y1
t
C
X1
Nl = 1, y Nd = p
a
Y2
(9.21)
mg
X2
LM e OP ; M~ M = LM I
NO
Ne d Q
O
m1
OP
Q
(9.22a)
1]T; [d]1
LM 1 acq
N2
1
asq
2
OP
Q
(9.22b)
OP
PP
Q
LM
MM
N
LM
MM
N
c 2q
ma 2
[I]1 = Q[I]2 Q =
s q cq
12
0
T
www.FreeLibros.me
s q cq
s 2q
0
OP
P
1 PQ
0
0
(9.22d)
218
CAPTULO
L
MM
N
cq
Q = sq
0
- sq
cq
0
0
0
1
O
PP
Q
(9.22e)
LM
N
OP
Q
LM
N
OP
Q
LM OP
NQ
Ejemplo 9.2
En la figura 9.4 se presenta un manipulador planar de dos eslabones con dos articulaciones rotacionales. Este manipulador tiene dos grados de libertad y sus coordenadas
independientes son q1 y q2. En forma correspondiente, las velocidades de las articula
www.FreeLibros.me
9.2
Expresiones analticas
219
Y1
(x, y)
EE
Y2
a2
C2
p2
X2
d2
e2
C1
d1
R
a1
e1
Figura 9.4
X1
p1
R
Las longitudes de los eslabones son a1 y a2, y las masas son m1 y m2. Los elementos
de la matriz de inercia generalizada (GIM) se calculan entonces como sigue: para i,
j = 2, el clculo de i22 se muestra abajo, segn la ecuacin (9.14b), como
~
i22 p T2 M 2 B22 p2
(9.25a)
donde
p2
LM e OP ; B LM 1 OOP ;
NO 1 Q
Ne d Q
LI O OP
~
M =M M
N O m 1Q
2
22
(9.25b)
donde el vector [e2]2 [e2]1 [0. 0, 1]T es el vector unitario a lo largo del eje de la
segunda articulacin rotacional, como se indica en la figura 9.4. El vector d2 se muestra en la figura 9.4, mientras que I2 es el tensor de inercia alrededor de C2. Usando la
ecuacin (9.25b) y suponiendo que el centro de masa se encuentra en el centro de la
longitud del eslabn, es decir, d2 = a2/2, el elemento (2, 2) de la GIM, es decir, i22, se
obtiene entonces en forma explcita, similarmente a I ( i11) del ejemplo 9.1 como
i22 = [e2]T2 [I2]2 [e2]2 + m2[e2 d2]2T [e2 d2]2
1
1
1
=
m a2 + m a2 = m a2
12 2 2 4 2 2 3 2 2
Para i = 2, j = 1, el elemento i21 se proporciona entonces como
~
i21 = p T2 M 2 B21 p1, donde p1 e1T , (e1 d1) T
(9.25c)
(9.26a)
OO
LM 1
(
)
1
r
+
d
1 PQ
N
1
www.FreeLibros.me
9.26b)
220
CAPTULO
donde el vector r1 = a1 d1. Por lo tanto, el elemento (2, 1) de la GIM, i21, se calcula,
parecido a i22, como
i21 = eT2 I2 e1 + m2 (e2 d2)T [e1 (a1 + d2)]
= e T2 I2 e2 + m2 d T2 a1 + m2 d T2 d2
1
1
1
=
m a 2 + m a a cq + m a 2
12 2 2 2 2 1 2 2 4 2 2
1
1
(9.26c)
= m2 a 22 + m2 a1 a2 cq2
3
2
En la ecuacin (9.26c) se aplica la regla del producto vectorial, a saber (a b)T
(c d) = (aTc)(bTc) (aTd)(bTc). Adems, e1 = e2, e2Te2 = 1 porque e2 es un vector unitario, e2Td1 = 0 porque e2 es ortogonal a d1. Adems, di = ai/2, ri + di = ai para i = 1, 2,
~
r1 + d1 = a1, y dT2a1 = 21 a2a1 cq1. Entonces, la matriz M1 se calcula como
~
- d1 1
I1
~
~
(9.27a)
M1 = M1 + BT21 M 2 B21 =
~1
d1 1
m
1
~ ~ ~
donde I , c y m
se dan a continuacin;
LM
N
OP
Q
~
~
~
~ =m +m
I1 = I1 + I2 m2 c21 ( d1 1); d1 = m2c21; y m
(9.27b)
1
2
1
~
~
~
en la que se usan I 2 I2, 2 = 0, y m2 = m2. Ahora, para i, j = 1, el elemento (1, 1) de
la GIM, i11, se encuentra como
~
~ d T d = 1 (m a 2 + m a 2 ) + m a 2 + m a a cq (9.28a)
i11 = e T1 I1 e1 + m
2 2
2 1
2 1 2
2
1 1 1
3 1 1
(9.29c)
=
c11
1
(9.29d)
m a a sq q
2 2 1 2 2 2
~
~
En las ecuaciones (9.29a-c), se utilizaron H32 O y M2 p2 = 0. Adems, para robots
~
planares puede demostrarse que el trmino PTi BTji Mj j Pj para i, j = 1, 2 desaparece.
Finalmente, puede demostrarse que los elementos del vector h tienen las siguientes
expresiones:
~ = 1 m a a sq q 2
h2 = p T2 w
(9.30a)
2
2 2 1 2 2 1
~ = m a a sq 1 q + q q
h1 = p T1 w
(9.30b)
2
2 1 2 2
1
1
2 2
FH
www.FreeLibros.me
IK
9.3
221
que no son otra cosa que el resultado de la multiplicacin de los elementos de la MCI,
las ecuaciones (9.29a-d), con las del vector de velocidad de articulaciones , ecuacin
(9.24).
9.3
9.3.1
Aqu se presenta el algoritmo recursivo (Saha, 1999) que se implementa en RIDIM; este
algoritmo tiene dos recursiones, a saber, hacia delante y hacia atrs, que se muestran a continuacin:
Recursin hacia delante
b 1 = p1q1 + W 1 p1q 1
a 1 = p1q 1;
a
a = p q + a ;
b = p q + W p q + B b + B
2
2 2
a n = p nq n + a n1;
2 2
2 2 2
21 1
21
b n = pnq n + W n pn q n + Bn,n1 b n1 + B
n, n -1 a n1
LMw 1
N O
i
O
wi 1
OP
Q
g 1 = M1b 1 + W1M1a 1 + BT21 g 2;
(9.31)
tn = pTng n
tn1 = pTn1g n1
t1 = pT1g 1
* RIDIM (Recursive Inverse Dynamics for Industrial Manipulators; dinmica inversa recursiva para manipuladores
industriales) es un programa de C++ de desarrollo propio con una interfaz de MS-Windows.
www.FreeLibros.me
222
CAPTULO
donde `i, ai y fi son los vectores de seis dimensiones con las dimensiones de torsin, la rapidez de torsin y la llave de torsin. Observe que, a partir de las ya dichas expresiones del
~ E, mientras que w
~E = 0. Esto implica
par de torsin/fuerza y de la ecuacin (9.20b), fi w
i
n+1
que los pares de torsin y fuerzas se deben nicamente al movimiento del sistema sin ningn
momento y fuerza externos sobre el efector final. Adems, si hay presencia de gravedad, se
est tomando en cuenta por proveer una aceleracin negativa que se denota por g al primer
cuerpo #1 (Kane y Levinson, 1983), es decir, se agrega un trmino adicional a ai como
b 1 = p1q1 + W 1 p1q 1 + r , donde r [0, gT ] T
(9.32)
Ahora bien, para un manipulador serial de articulaciones puramente rotacionales, la complejidad computacional del algoritmo citado lneas arriba se presenta en la tabla 9.1, lo que
se compara con algunos de los otros algoritmos dinmicos inversos que existen. A pesar de
que el algoritmo de arriba no es el mejor, es muy sencillo, como es evidente en el algoritmo
de dos pasos, donde se tratan seis vectores dimensionales en forma parecida a aqullos de
tres vectores dimensionales. Es decir, si se conoce `1, encontrar a `2 es muy similar a la evaluacin de la velocidad lineal del cuerpo 2 a partir de la velocidad conocida del cuerpo 1.
Tabla 9.1 Complejidades computacionales para la dinmica inversa
Algoritmo
Hollerbach (1980)
Luh et al. (1980)
Walker y Orin (1982)
RIDIM (Saha, 1999)
Khalil et al. (1986)
ngeles et al. (1989)
Balafoutis et al. (1988)
9.3.2
Multiplicaciones/
divisiones (M)
Suma/
sustraccin (A)
412n277
150n48
137n22
120n44
105n92
105n109
93n69
320n201
131n+48
101n11
97n55
94n86
90n105
81n65
n=6
2195M
17119A
852M
834A
800M
676M
538M
521M
489M
595A
527A
478A
435A
421M
El programa RIDIM
9.3
223
SIGUIENTE
CANCELAR
Figura 9.5
2.
3.
4.
5.
Puede manejar manipuladores con pares o articulaciones tanto rotacionales o revolutas como prismticas:
Toma en cuenta la gravedad, pues considera la aceleracin negativa debido a la gravedad denotada por g al primer cuerpo #1, como se muestra en la ecuacin (9.32).
Ejemplo 9.3
En la figura 9.6 se presenta el manipulador de tres eslabones en estudio, cuyos parmetros DH e inerciales se muestran en la tabla 9.2. Se supone que el manipulador se mueve
en el plano X-Y, donde la gravedad est trabajando en la direccin negativa Y. Suponga
que i y j son los dos vectores unitarios paralelos a los ejes X y Y, respectivamente,
www.FreeLibros.me
224
CAPTULO
a2
2
r2
a2
2
d2
p2
C2
p1
Figura 9.6
C3
p3
q13
a1
Efector
final
Eslabn
ai
(m)
Articulacin
ai
(rad)
bi
(m)
qi
(rad)
1
r
0.3
0
0
2
r
0.25
0
0
3
r
022
0
0
JV: Variable articular con valores iniciales entre corchetes [ y ]; r: Articulacin
revoluta
b) Parmetros de masa e inercia
mi
Eslabn (kg)
1
2
3
0.5
0.4
0.3
JV [0]
JV [0]
JV [0]
rotacional o
ri,x
ri,y
(m)
ri,z
Ii,xx
Ii,xy
Ii,xz
Ii,yy
(kg-m2)
Ii,yz
Ii,zz
0.15
0.125
0.11
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0.00375
0.00208
0.00121
0
0
0
0.00375
0.00208
0.00121
LM
F
H
N
q (T ) - q ( 0 ) L
=
MN1 - cos FH 2Tp tIK OPQ ;
T
q (T ) - q ( 0 ) L 2 p
2p IO
=
sen F
t
M
H
T
T K PQ
NT
qi = qi (0) +
q i
q i
q i (T ) - q i ( 0)
2p
T
sen
tt
2p
T
T
www.FreeLibros.me
I OP
KQ
(9.33a)
(9.33b)
9.3
225
200
150
100
50
10
t (seg)
Figura 9.7
Trayectoria articular
4
3
2
tau_2
1
tau_3
0
1
2
Figura 9.8
4
6
Tiempo (seg)
10
www.FreeLibros.me
226
CAPTULO
Ejemplo 9.4
El robot PUMA
Para el robot PUMA que se presenta en la figura 9.9, los resultados de dinmica inversa se obtuvieron para sus parmetros DH e inerciales que se muestran en la tabla 9.3.
Ze
Efector terminal
Xe
0.056
Z 4, Z 6
Z5
X5, X6
0.042
X3
Z3
Z1
X4
02
0.
0.432
Z2
X1, X2
0.149
Figura 9.9
Un robot PUMA
Se supone que la trayectoria para cada articulacin ser la misma que para el manipulador de tres eslabones, como se defini en las ecuaciones (9.33a-b) para el mismo
T, y los valores de articulaciones iniciales y finales. Las grficas de pares de torsin
correspondientes se dan en las figuras 9.10a-f).
Tabla 9.3
Eslabn
Articulacin
ai
(m)
bi
(m)
ai
(rad)
qi
(rad)
1
2
3
4
5
6
r
r
r
r
r
r
0
0.432
0.02
0
0
0
0
0.149
0
0.432
0
0.05
p/2
0
p/2
p/2
p/2
0
JV [0]
JV [0]
JV [0]
JV [0]
JV [0]
JV [0]
JV: Variable articular con valores iniciales entre corchetes [ y ]; r: Articulacin rotacional o
revoluta
www.FreeLibros.me
9.3
227
Eslabn
mi
(kg)
1
2
3
4
5
6
10.521
15.761
8.767
1.052
1.052
0.351
ri,x
ri,y
(m)
ri,z
Ii,xx
0.054
0
0
0
0.292 0
0.197
0
0.02
0.057 0
0
0.007
0
0
0.019
0
0
2
0
2
4
0
4
6
8
Tiempo (seg)
a) Articulacin 1
0
0
0
0
0
0
0.5091
8.2672
0.3009
0.181
0.0735
0.0141
0
50
4
6
8
Tiempo (seg)
b) Articulacin 2
10
4
6
8
Tiempo (seg)
d) Articulacin 4
10
4
6
8
Tiempo (seg)
f ) Articulacin 6
10
0.15
20
10
0
10
20
0
4
6
8
Tiempo (seg)
c) Articulacin 3
0.1
0.05
0
0.05
0.1
10
0.02
0.15
1.612
8.0783
3.3768
0.1273
0.1273
0.0071
Ii,zz
50
100
10
30
0.1
0.05
0
0.05
0.1
Ii,yy
Ii,yz
(kg-m2)
100
30
0
0
0
0
0
0
0
0
0
0
0
0
1.612
0.4898
3.3768
0.181
0.0735
0.0071
Ii,xy Ii,xz
4
6
8
Tiempo (seg)
e) Articulacin 5
Figura 9.10
10
0.1
0
0.01
0.02
0.03
www.FreeLibros.me
228
CAPTULO
Ejemplo 9.5
El brazo STANFORD
Para el brazo Stanford que se presenta en la figura 9.11, los parmetros DH y otros
se muestran en la tabla 9.4. Observe que se distingue del robot PUMA en que tiene
una articulacin prismtica en la ubicacin 3 de la articulacin. Las funciones para
las articulaciones rotacionales o revolutas se tomaron exactamente de las mismas que
en el robot PUMA del ejemplo 9.4, con los siguientes datos: T = 10 seg, qi(0) = 0
para i 2,3, q2(0) = p/2; y q1(T) = p/3 para i 3. Puesto que la tercera articulacin es
prismtica, el desplazamiento de la articulacin, que se denota por b3, es una variable.
Su variacin se toma igual que en la ecuacin (9.33a), a saber,
bi = bi (0) +
LM
N
F
H
bi (T ) - bi ( 0)
2p
T
tt
sen
T
2p
T
I OP
KQ
(9.34)
Ze
Z4, Z6
0.6
Xe
X5, X6
Z5
X4
b3
X3
Z1
Z3
Z2
X2
0.1
0.1
X1
Figura 9.11
Tabla 9.4
El brazo Stanford
Eslabn
Articulacin
1
2
3
4
5
6
r
r
p
r
r
r
ai
(m)
0
0
0
0
0
0
bi
(m)
ai
(rad)
qi
(rad)
0.1
0.1
JV [0]
0.6
0
0.0
p/2
p/2
0
p/2
p/2
0
JV [0]
JV [0]
0
JV [0]
JV [0]
JV [0]
JV: Variable articular con valores iniciales entre corchetes [ y ]; r: Articulacin rotacional ; p:
Articulacin prismtica
www.FreeLibros.me
9.4
229
mi ri,x
Eslabn (kg)
ri,y
(m)
ri,z
0
0
0
0
0
0
0.1
0
0
0.1
0
0
0
0
0
0
0.06
0.2
1
2
3
4
5
6
9
6
4
1
0.6
0.5
Ii,xx
Ii,xy
Ii,yz
(kg-m2)
Ii,yy
Ii,yz
Ii,x
0.01
0.05
0.4
0.001
0.0005
0.003
0
0
0
0
0
0
0
0
0
0
0
0
0.02
0.06
0.4
0.001
0.0005
0.001
0
0
0
0
0
0
0.01
0.01
0.01
0.0005
0.0002
0.002
Los pares de torsin y fuerza que se obtienen mediante RIDIM se grafican luego en
las figuras 9.12a-f) y coinciden exactamente con los que se reportan en Cyril (1988)
para el mismo brazo.
9.4
9.4.1
230
CAPTULO
0.15
0.1
0.05
0
0.05
0.1
0.15
4
6
8
Tiempo (seg)
a) Articulacin 1
10
20
25
30
1.35
1.3
1.25
1.2
1.15
1.1
1.05
1
0.95
0.9
0.85
0
5
10
15
4
6
8
Tiempo (seg)
c) Articulacin 3
10
15.5
15
14.5
0.1
0
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
4
6
8
Tiempo (seg)
b) Articulacin 2
10
4
6
8
Tiempo (seg)
d) Articulacin 4
10
4
6
8
Tiempo (seg)
f ) Articulacin 6
10
0.0003
Fuerza (N)
17.5
17
16.5
16
0.0002
0.0001
0
0.0001
0.0002
4
6
8
Tiempo (seg)
e) Articulacin 5
Figura 9.12
10
0.0003
algoritmos recursivos proporcionan perfiles suaves para p, como se informa en Ascher et al.
(1997), Mohan y Saha (2007) y otros.
En esta subseccin se presenta un algoritmo de dinmica directa recursiva del orden (n)
que requiere las siguientes entradas: Para i = 1, ..., n,
1. tems de dinmica recursiva 1, as como 3-5, como se menciona en la subseccin
9.3.2.
2. Valores iniciales para los parmetros variables DH, es decir, qi para una articulacin
rotacional y bc para una articulacin prismtica, y su derivada respecto al tiempo, es
decir, q i y bi.
3. Historial de tiempo de las fuerzas/pares de torsin de la articulacin, es decir, ti.
www.FreeLibros.me
9.4
231
(9.35)
Luego se utiliza un mtodo recursivo de tres pasos para calcular las aceleraciones de las
articulaciones a partir de las ecuaciones arriba mencionadas, por ejemplo,
1. Solucin para i : La solucin i = U1 i se evala en funcin de los trminos escalares
como
, para i = n, , 1
f = f pT h
(9.36a)
i
i,i+1
(9.36b)
y i
p y m pT y
i
, donde y i M
i i
i
i
m i
(9.36c)
(9.36d)
n = Mn.
para i = n 1, ..., 1, y M
~: La solucin Di~ = i involucra la inversa de la matriz diagonal D de la
2. Solucin para
ecuacin (9.35), que es simple, a saber, D1 slo tiene elementos diagonales no ceros
que son los recprocos de los correspondientes elementos diagonales de D. El vector
i~ se obtiene como sigue: Para i = 1, ..., n,
~
f i = j i / m i
(9.37)
www.FreeLibros.me
(9.38a)
232
CAPTULO
~
~ se obtiene como
donde q = f 1, y el vector de seis dimensiones
i,i-1
~
~
~
~
m
i, i -1 Bi,i1 m i -1 y m i -1 p i1q i -1 + m i - 1, i - 2
(9.38b)
en la que ~
l10 0.
La complejidad del algoritmo de dinmica directa propuesto se compara en la tabla 9.5
con algunos otros algoritmos. La comparacin muestra claramente que el algoritmo que se
presenta arriba es el mejor. Adems, mediante el uso de cualquier otro algoritmo recursivo,
la complejidad computacional para la dinmica directa tiene ventajas sobre el algoritmo de
orden convencional (n3) cuando n 12, mientras que el algoritmo que se menciona arriba
tiene ventajas incluso para n 10.
Tabla 9.5 Complejidades computacionales para la dinmica directa
Algoritmo
Saha (2003)
Featherstone (1983)
Valasek [14]
Brandl et al. [14]
Walker y Orion
(1982)
9.4.2
Multiplicaciones/
divisiones(M)
Suma/
resta (A)
191n-284
199n-198
226n-343
250n-222
n3/6+23
187n-325
174n-173
206n-345
220n-198
n3/6+7n2+233n/3-46
n2/2+115n/3-47
n=6
n = 10
862M 797A
996M 871A
1013M 891A
1278M 1122A
633M 480A
1626M 1545A
1792M 1527A
1917M 1715A
2278M 2002A
1653M 1209A
Simulacin
www.FreeLibros.me
9.4
Ejemplo 9.6
233
Aqu se considera el manipulador de tres DOF que se presenta en la figura 9.6, para
dejarlo caer bajo gravedad desde la configuracin horizontal inicial, es decir, qi(0) =
ngulo (rad)
th_2
th_3
th_1
Figura 9.13
0.5
1.5
2
Tiempo (seg)
2.5
3.5
Ejemplo 9.7
las condiciones iniciales qi(0) = q i (0) = 0 para i = 1, ..., 6. El intervalo T, que se adopta
para la integracin numrica, se toma como T = 0.01 seg. Las variaciones para las
www.FreeLibros.me
234
CAPTULO
Qu es libre?
0.2
0
0.2
0.4
0.6
0.8
1
1.2
2.5
ngulo (rad)
ngulo (rad)
2
1.5
1
0.5
0
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
Tiempo (seg)
b) Articulacin 2
5
4
3
2
1
0
1
2
ngulo (rad)
ngulo (rad)
1.2
1
0.8
0.6
0.4
0.2
0
0.2
0.4
0.6
0.8
ngulo (rad)
ngulo (rad)
Figura 9.14
Ejemplo 9.8
0.6
0.4
0.2
0
0.2
0.4
0.6
0.8
1
1.2
1.4
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
Tiempo (seg)
f) Articulacin 6
Aqu se realiza la simulacin de cada libre del brazo Stanford con los siguientes valo
www.FreeLibros.me
ngulo (rad)
ngulo (rad)
0.1
5
0
5
10
15
20
25
30
35
40
0.7
0.6
0.5
0.4
0.3
0.2
www.FreeLibros.me
1 1.5 2 2.5
Tiempo (seg)
a) Articulacin 1
1 1.5 2 2.5
Tiempo (seg)
d) Articulacin 4
0 0.5
0 0.5
1.5 2 2.5
Tiempo (seg)
3 3.5
10
e) Articulacin 5
2
1.5 2 2.5
Tiempo (seg)
3 3.5
10
20
30
40
50
60
70
3
1
b) Articulacin 2
Desplazamiento (m)
0
0 0.5
0 0.5
ngulo (rad)
2.5
1.5
0.5
0.5
0.5
1.5
0 0.5
0 0.5
1.5 2 2.5
Tiempo (seg)
1.5 2 2.5
Tiempo (seg)
f ) Articulacin 6
c) Articulacin 3
3 3.5
3 3.5
3 3.5
3 3.5
ngulo (rad)
ngulo (rad)
9.4
235
236
CAPTULO
Los resultados de posiciones de articulaciones se presentan luego en las figuras 9.15af). Debido a la configuracin inicial del brazo Stanford que se da en la tabla 9.4a),
el movimiento de la articulacin 3 deber incrementarse en forma pronunciada una
vez que la articulacin 2 gire ms que p/2. Esto es cierto, como es evidente segn las
figuras 9.15c) y b), respectivamente. En la figura 9.15b), la articulacin 2 gira por p/2
de su valor de p/2 o 1.5708 radianes para volverse cero. Esto sucede poco despus
de 0.5 seg., cuando el desplazamiento de la articulacin 3 empieza a aumentar, como
queda claro en la figura 9.15c).
RESUMEN
En este captulo es presentado el modelado dinmico de robots seriales mediante el uso
de complementos ortogonales naturales desacoplados(DeNOC). Se presentan algoritmos de dinmica recursiva inversos y directos para el control y la simulacin de robots,
respectivamente. Se reportan las complejidades computacionales de ambos algoritmos
con resultados ilustrativos para sistemas robticos planares y espaciales.
EJERCICIOS
9.1
9.2
9.3
9.4
9.5
9.6
9.7
9.8
Qu es la dinmica inversa?
Por qu se prefiere el concepto de las matrices DeNOC sobre otros planeamientos
de modelado dinmico?
Cul es el significado de ortogonal en DeNOC?
Busque la expresin de la energa cintica del brazo de un eslabn, ecuacin
(8.54a), aplicando las matrices DeNOC.
Derive la ecuacin de movimiento del brazo de un eslabn, figura 9.3, usando las
expresiones de matrices y vectores mediante la matriz NOC N que aparece despus
de la ecuacin (9.9a).
Escriba la expresin de la energa cintica total para un manipulador de n eslabones, usando la definicin de torsin generalizada t que se presenta en la ecuacin
(9.3c).
Repita elejercicio 9.6, usando la definicin de la velocidad de articulacin generalizada p de la ecuacin (9.6b).
Cules son las caractersticas de RIDIM?
www.FreeLibros.me
237
(9.39)
(9.40a)
1
(m a 2 + m2 a 22 + m3 a 23 ) + m2 a 21 + m3 (a 21 + a 22 )
3 1 1
+ (m2 + 2m3)a1 a2 cq2 + m3 a3 (a2 cq 3 + a1 cq23)
i12 = i21 =
FH
IK
1
1
(m a 2 + m3 a 23 ) + m3 a 22 +
m a + m3 a2 a1cq2
3 2 2
2 2 2
1
m a (2a cq + a1cq23)
2 3 3 2 3
1
1
= i31 = m3 a 23 + m3 a3 (a2 cq3 + a1cq23)
3
2
1
= (m2 a 22 + m3 a 23 ) + m3 (a 22 + a2 a3 cq3)
3
1
1
1
= i32 = m3 a 23 + m3 a2 a3 cq3; i33 = m3 a 23
3
2
3
1
= [{m2 a1 a2 sq2 + m3 (2a1 a2 sq2 + a1 a3 sq23)}q 2
2
+ m (a a sq + a a sq )q ]
i13
i22
i23
c11
c12
1 3
23
2 3
c13 =
1 3
23
2 3
1
m (a a sq + a2 a3sq3)q 123
2 3 1 3 23
1
[{m2 a1 a2 sq2 + m3 (2a1a2 sq2 + a1 a3 sq23)}q 1 m3 a2 a3 sq3q 3 ]
2
1
1
= m3 a2 a3 sq3q 3 ; c23 = m3 a2 a3 sq3q 123
2
2
c21 =
c22
1
= [{m2 a1 a2 sq2 + m3 (2a1 a2 sq2 + a1 a3 sq23)}q 12
2
+ m (a a sq + a a sq )q ]
3
www.FreeLibros.me
(9.40b)
(9.40c)
238
CAPTULO
1
1
m [(a a sq + a2 a3 sq3)q 1 + a2 a3 sq3q 2]; c32 = m3 a2 a3 sq3q 12
2 3 1 3 23
2
=0
c31 =
c33
y
1
g[m1 a1 cq1 2m2 (a1 cq1 + a2 cq12) 2m3 (a1 cq1
2
1
+ a2 cq12)... + a3 cq123)]
2
1
1
= g[m2 a2 cq12 2m3 (a2 cq12... + a3 cq123);
2
2
1
= g[m3 a3 cq123]
2
t g1 =
t g2
t g3
) (9.40d)
www.FreeLibros.me
Cinemtica
239
Captulo
10
Control
El control de cualquier sistema significa aplicar/ejercer fuerza(s) para que el sistema se mueva/trabaje de
acuerdo con las instrucciones ordenadas. En un sistema robtico, se requiere de un manipulador para
Una computadora personal o un sisteejecutar una tarea especfica mediante el movimiento
ma dedicado de circuitos electrnicos
conectado al manipulador.
de su efector final en forma precisa y repetida. En el
captulo 6 se calcularon ecuaciones para obtener los
historiales de tiempo de todos los movimientos de las articulaciones para lograr el movimiento deseado del efector final. En este captulo se desarrollarn las leyes de control, donde
los historiales de las articulaciones pueden convertirse en entradas con el fin de hacer que el
robot siga la trayectoria ordenada. Se asume que el lector tiene los conocimientos bsicos
de sistemas de control (Ogata, 1987; Kuo, 1991; Gopal, 1997).
El control de un robot requiere el conocimiento del modelo matemtico del mismo, as
como de un sistema inteligente que acte sobre l. Mientras que el modelo matemtico necesario se obtiene de las leyes fsicas que rigen el movimiento del manipulador, el sistema
inteligente requiere de dispositivos sensoriales y medios para accionar y reaccionar ante las
variables detectadas. En el control de un robot, las articulaciones individuales se accionan
mediante actuadores, ya sean neumticos, hidrulicos o elctricos, como se explic en el
captulo 3. Los actuadores aplican una fuerza o un par de torsin sobre los eslabones para
que se muevan. Sus comandos provienen del sistema de control del manipulador que lo
mueven para ejecutar el movimiento especfico ordenado para el efector final. Estos comandos se basan en los valores nominales de control generados a partir del conjunto de pares
de torsin de las articulaciones en funcin de los historiales de tiempo. Observe que el generador de trayectoria o planeador prepara los historiales de articulaciones, como se indica
en la figura 10.1. Esencialmente, se trata de un algoritmo que se basa en cualquiera de los
Quin controla un
robot?
www.FreeLibros.me
240
CAPTULO
10
Control
Generador
de
trayectorias
d
.
d
..
d
Sistema
de
Control
Manipulador
del robot
Lazo cerrado
Figura 10.1
mtodos desarrollados en el captulo 11. Sin embargo, debido a las dificultades que hay en
las computaciones precisas de los parmetros de manipuladores en el modelo matemtico,
por ejemplo, las longitudes de eslabones, masas e inercias, cambios en la carga de trabajo,
consideraciones de friccin, holguras, etc., el efector final del robot no seguir en forma
exacta la trayectoria ordenada. Por lo tanto, las posiciones reales de las articulaciones y/o del
efector final, as como sus derivadas pueden retroalimentar al sistema de control para obtener
un movimiento preciso. En la figura 10.1 se presenta un diagrama esquemtico del control
de un manipulador. Las lneas punteadas para la retroalimentacin indican que el sistema
de control podr o no emplear la retroalimentacin de los movimientos actuales reales de
las articulaciones. Los parmetros pd, d y d son las posiciones, velocidades y aceleraciones
deseadas predefinidas de todas las articulaciones, respectivamente, mientras que p y son
las posiciones y velocidades reales de las articulaciones, respectivamente.
El control de un robot puede clasificarse como lineal y no lineal. El uso de tcnicas de
control lineal sirve cuando el robot se mueve lentamente, de manera que puede ser matemticamente modelado por medio de ecuaciones diferenciales lineales con coeficientes
constantes. Para el caso de un control de robot real, estos mtodos lineales se consideran
esencialmente como mtodos aproximativos, ya que las ecuaciones dinmicas de movimiento de un manipulador robtico son en realidad ecuaciones diferenciales no lineales. Sin
embargo, la teora de control lineal sirve de base para sistemas de control no lineales ms
complejos. Para muchas aplicaciones prcticas, el uso de sistemas de control lineales es a
menudo razonable, puesto que los manipuladores robticos que se usan en la mayora de las
industrias se mueven relativamente lento. Pero si las articulaciones se mueven rpidamente,
entonces todas ellas tienen que moverse de manera simultnea. En esta situacin, las fuerzas
dinmicas acopladas son significativas, y la dinmica del robot es no lineal y compleja. Las
articulaciones no pueden moverse de manera independiente, y se requiere de algoritmos de
control complejos.
10.1
Tcnicas de control
10.1
Tcnicas de control
241
efector final tienen que convertirse a los movimientos de las articulaciones. El sistema para
accionar las articulaciones tambin tiene un efecto sobre el tipo de estrategia de control que se
utilizar. Si un manipulador se acciona mediante motores elctricos con engranes reductores
de alta razn de transferencia, la presencia de los engranes tiende a linealizar la dinmica del
sistema. Los trminos efectivos de masa e inercia de los eslabones son por lo regular enormemente reducidos por el cuadrado de la relacin del engranaje. Por lo tanto, la dinmica de las
articulaciones se desacopla, y cada articulacin puede ser controlada en forma independiente.
Sin embargo, la presencia de engranajes introduce friccin, deformacin y holgura en el
tren de engranajes. Como resultado, el diseador del control tiene que poner ms atencin a
estos efectos que a la inercia no lineal, a las fuerzas de Coriolis, etc., con el fin de lograr alto
rendimiento. Por el contrario, los accionamientos directos, como se da en el caso de robots
de accionamiento directo, eliminan los problemas del tren de engranajes, aunque introducen
trminos no lineales debido al acoplamiento entre articulaciones y los eslabones. Como resultado, debe pensarse en diferentes estrategias de control para obtener un alto rendimiento.
Por otro lado, el problema de control del manipulador es de mltiples entradas y mltiples
salidas (MIMO por sus siglas en ingls), como se indica en la figura 10.1 mediante los vectores
n-dimensionales a lo largo de cada lnea de seal. Para
simplificar el problema, se considera cada articulacin
como independiente y controlada por separado. Esta
Por qu SISO?
consideracin se justifica para robots con mltiples enEn robots con mltiples engranajes, la
granajes, como ya se mencion anteriormente. Ahora
consideracin de un control indepenbien, para el modelo de una sola articulacin, existe una
diente y separado para cada articulasola entrada y una sola salida (SISO). El control que se cin es equivalente a un problema de
disea para este tipo de modelo se llama comnmente
control SISO.
control de variable de articulacin independiente. Por
lo tanto, para un manipulador de n articulaciones, tienen que disearse n sistemas de control
SISO independientes. Puesto que cada sistema SISO puede modelarse como una ecuacin
diferencial lineal de segundo orden, sus caractersticas se estudiarn en la siguiente seccin,
mientras que a continuacin se mencionan las diferentes maneras de controlarla:
i) Control de encendido/apagado o control de dos pasos.
ii) Control proporcional (P): produce una seal de control proporcional al error entre el
movimiento deseado y el real.
iii) Control derivativo (D): se genera una seal de control que es proporcional a la razn
de cambio del error. El control derivativo se conoce como un control anticipado que
mide la razn de cambio del error existente, anticipa el error ms grande entrante y
aplica la correccin antes de que el error mayor pueda llegar. El control derivativo
nunca se usa solo.
iv) Control integral (I): produce una seal de control proporcional a la integral del error
respecto al tiempo. Este tipo de controlador puede considerarse como el retroactivo
que suma todos los errores y luego responde.
v) Modos de combinacin: en estos modos se combinan las estrategias arriba mencionadas, como los controles proporcionales (P) y derivativos (D), y por ello se llama control
PD. De manera similar, tambin se usan controles proporcionales e integrales (PI),
as como proporcionales, integrales y derivativos (PID), para lograr el desempeo
deseado.
www.FreeLibros.me
242
CAPTULO
10
Control
10.2
x
k
m
b
(10.1)
x + b x + kx = 0
m
que es una ecuacin diferencial de coeficiente constante lineal de segundo orden. La solucin para la ecuacin diferencial (10.1) es una funcin del tiempo x(t) que describe el
movimiento del bloque. Esta solucin depender de las condiciones iniciales del bloque, es
decir, de su posicin y velocidad inicial. Segn el estudio de las ecuaciones diferenciales, si
se supone que la solucin de x es x = est, entonces la solucin para la ecuacin (10.1) depende
de las races de su ecuacin caracterstica, a saber,
ms2 + bs + k = 0
(10.2)
- b + b 2 - 4mk
- b - b 2 - 4mk
; y s2 =
2m
2m
(10.3)
Caso I:
Este caso se presenta cuando b2 > 4 mk, es decir, cuando la friccin domina y el resultado es
el comportamiento lento. Esta respuesta se llama sobreamortiguada. La solucin x(t), que da
el movimiento del bloque en el caso de races reales y desiguales, tiene la siguiente forma:
x(t) = c1es1t + c2es2t
(10.4)
donde s1 y s2 se obtienen por la ecuacin (10.3), que tambin se llaman polos del sistema.
Los coeficientes c1 y c2 son constantes que pueden ser determinadas para cualquier conjunto
de condiciones iniciales, es decir, la posicin y velocidad inicial del bloque. La figura 10.3
www.FreeLibros.me
10.2
Im{s}
Re{s}
Figura 10.3
243
Ejemplo 10.1
(10.6)
Si el bloque est inicialmente en reposo y se libera de la posicin x = 1, es decir,
x(0) = 1 y x (0) = 0, los coeficientes c1 y c2 pueden entonces calcularse fcilmente a
partir de las ecuaciones que satisfagan las condiciones iniciales en t = 0, es decir,
c1 + c2 = 1; y 2c1 3c2 = 0
(10.7)
La ecuacin (10.7) proporciona c1 = 3 y c2 = 2. De este modo, el movimiento del
sistema para 0 se obtiene por
x(t) = 3e2t + 2e3t
Caso II:
(10.8)
Races complejas
Este caso se presenta cuando b2 < 4 mk, es decir, cuando domina la rigidez, y se da como
resultado el comportamiento oscilatorio. Esta respuesta se llama subamortiguada. Para este
caso, la ecuacin caracterstica tiene races complejas de la forma
s1 = l + mi; y s2 = l mi
www.FreeLibros.me
(10.9)
244
CAPTULO
10
Control
x (t)
Im{s}
Re{s}
Figura 10.4
(10.10)
Sin embargo, la ecuacin (10.10) es difcil de usar en forma directa, puesto que involucra
nmeros imaginarios de manera explcita. Si se usa la frmula de Euler, puede demostrarse
que
(10.11)
e ix = cos x + i senx
entonces, la solucin, ecuacin (10.10), puede manipularse en la forma
x(t) = a 1elt cos (m t) + a 2 e l t sen (mt), donde a 1 c1 + c2 y a 2 i(c1 c2)
(10.12)
Como sucedi anteriormente, los coeficientes 1 y 2 son constantes que pueden ser determinadas para cualquier juego determinado de condiciones iniciales, es decir, la posicin
y velocidad inicial del bloque. Suponga que las constantes 1 y 2 se escriben como
a 1 = r cos d, y a 2 = rsen d
(10.13)
r=
a 12 + a 22 , y d = A tan 2 (a 2, a1)
(10.14)
(10.15)
Ahora queda claro, por la ecuacin (10.14), que el movimiento resultante es una oscilacin cuya amplitud disminuye exponencialmente hacia cero. La figura 10.4 muestra las
ubicaciones de los polos y la correspondiente respuesta de tiempo a una condicin inicial de
no cero. Cuando los polos de un sistema de segundo orden son complejos, el sistema muestra
un movimiento oscilatorio o subamortiguado.
Ejemplo 10.2
www.FreeLibros.me
(10.16)
10.2
245
1
- t
2
FGa
H
1 cos
3
3
t + a 2 sen
t
2
2
IJ
K
(10.17)
Observe que para el bloque que estuvo inicialmente en reposo y que se liber de
la posicin x = 1, las condiciones iniciales son x(0) = 1 y x (0) = 0. Para determinar
las constantes c1 y c2, se tiene que
a 1 = 1, y
1
3
a +
a =0
2 1
2 2
(10.18)
1
- t
2
FG - cos
H
3
1
3
tsen
t
2
2
3
IJ
K
(10.19)
x(t) =
Caso III:
2 -2t
cos
e
3
FG 3 t + 150IJ
H2
K
(10.20)
Este caso especial se presenta cuando b2 = 4 mk, es decir, cuando la friccin y la rigidez estn
balanceadas, lo que produce la respuesta no oscilatoria ms rpida posible. Esta respuesta se
llama crticamente amortiguada. Mediante la ecuacin (10.3), puede demostrarse que tiene
races iguales y reales s, es decir, races repetidas. La solucin tiene la forma
x(t) = (c1 + c2 t)est
(10.21)
b
t
2m
(10.22)
246
CAPTULO
10
Control
x (t)
Im{s}
Re{s}
Figura 10.5
Ejemplo 10.3
(10.24)
(10.27)
En el caso de que un sistema no sea estable, no siempre ser posible cambiar los parmetros del sistema fsico. Por lo tanto, tiene que usarse el concepto de un control retroalimentado, donde deber ser posible cambiar de manera efectiva los valores de uno o ms de los
coeficientes de la ecuacin caracterstica, de tal modo que el sistema resultante sea estable.
Esto se analizar en la siguiente seccin.
10.3
Control retroalimentado
10.3
Control retroalimentado
247
www.FreeLibros.me
248
CAPTULO
10
Control
El sistema de control computar entonces el par de torsin como alguna funcin del
servo-error para ser transmitido a los actuadores, de manera que el servo-error sea mnimo
o cero. Un sistema de control que hace uso de la retroalimentacin se llama sistema de lazo
cerrado. El lazo cerrado de uno de estos sistemas de control alrededor del robot es aparente,
segn la figura 10.1, mientras que la figura 10.6 muestra una implementacin por hardware
del sistema de control de lazo cerrado. En la figura 10.6, el comparador es un circuito electrnico que mide el error entre la salida deseada (tambin conocido como referencia) y
la salida real o medida, y produce seales para el controlador. El controlador puede ser una
computadora o microcomputadora o incluso un microprocesador que implemente una estrategia de control basada en la seal de error arriba mencionada. La seal del controlador se
convierte entonces en una seal anloga mediante un convertidor de digital a anlogo (DAC),
otro circuito electrnico, antes de ser ampliada por el amplificador de potencia con el fin de
acrecentar la pequea seal, de tal modo que pueda mover el actuador de la articulacin. Luego se usa un sensor para detectar la posicin y, de ser posible, la velocidad de la articulacin,
lo que retroalimenta al comparador despus de que se convierte la seal anloga por medio
de un convertidor de anlogo a digital (ADC), que es otro circuito electrnico.
En el control retroalimentado, la seal de control sd no es la nica entrada que acta sobre
el sistema. Como se muestra en la figura 10.6, las perturbaciones tambin son entradas, que
no se controlan pero que influyen en el comportamiento de la salida. Por lo tanto, el controlador debe disearse, adems para la minimizacin del servo-error, para reducir los efectos
de las perturbaciones. Como resultado, el robot deber comportarse de manera estable. Si se
logra esto, puede decirse que el controlador rechaza las perturbaciones. El doble objetivo de
seguir la trayectoria o rastreo y rechazar las perturbaciones es central para cualquier metodologa de control. Deber observarse que un sistema de control incorrectamente diseado
a veces puede dar como resultado el desempeo inestable, en el cual los servo-errores se
aumentan en vez de reducirse. Por lo tanto, la primera tarea de un ingeniero de control es
comprobar que su diseo produce un sistema estable; en segundo lugar, debe comprobar que
el desempeo de lazo cerrado del sistema es satisfactorio, es decir, que el error se encuentra
dentro de los lmites aceptados. En la prctica, estas comprobaciones podrn abarcar desde
comprobaciones matemticas basadas en ciertas suposiciones y modelos hasta resultados
ms empricos, como los que se obtienen a travs de la simulacin numrica o la experimentacin.
Comparador
Controlador
Amplificador
de potencia
Actuador
Manipulador
Perturbaciones
Elementos de
retroalimentacin
Sensores
www.FreeLibros.me
10.3
10.3.1
249
Control retroalimentado
En esta subseccin se presenta una ilustracin del control por retroalimentacin, utilizando
el sistema de masa-resorte-amortiguador que se present en la seccin 10.2. Suponga que
la respuesta natural del bloque no es como se desea. Quiz sea subamortiguada y oscilatoria
y se quiera que sea crticamente amortiguada. O tal vez el resorte falte por completo (k = 0)
y de esta forma el sistema nunca regrese a x = 0 si ste se perturba. Mediante el uso de sensores, de un actuador y de un sistema de control, puede modificarse el comportamiento del
sistema. La figura 10.7a) presenta un sistema de masa-resorte-amortiguador con la adicin
de un actuador, por lo que es posible aplicar una fuerza al bloque. El diagrama de cuerpo
libre que se presenta en la figura 10.7b) lleva a la siguiente ecuacin de movimiento:
x + b x + kx = f
m
(10.30a)
x + 2Vw n x + w 2n x = f
(10.30b)
donde
f
b
k
;V
; y f
m
m
2 km
wn
(10.30c)
Los trminos wn y z se llaman frecuencia natural y razn de amortiguamiento, respectivamente, mientras que es la funcin de forzamiento modificada que acta sobre el sistema.
Ahora supngase que hay sensores capaces de detectar la posicin y velocidad del bloque.
Se propone una ley de control que computa la fuerza y que deber ser aplicada por los actuadores como funcin de la retroalimentacin detectada, es decir,
f = kp (xd x) + kv ( xd - x)
(10.31)
donde xd y xd son la posicin y velocidad deseada del bloque. Si el bloque tiene que mantenerse en reposo en el origen, entonces xd = 0 y xd = 0. Este control se ilustra en la figura 10.8,
donde xd representa la aceleracin deseada que tambin se deriva para ser cero, es decir,
xd = 0. Observe que la parte izquierda de la lnea punteada en la figura 10.8 es el sistema de
control (usualmente implementado en una computadora), mientras que la parte de la derecha
de la lnea punteada es el sistema fsico. Implcitas en la figura estn las interfaces entre la
computadora de control y los comandos del actuador de salida, junto con la informacin del
sensor de entrada. El sistema de control propuesto es un sistema de regulacin de posiciones,
que simplemente trata de mantener la posicin del bloque en un lugar fijo, independientemente de las fuerzas de perturbacin aplicadas al bloque. Al igualar la dinmica de lazo
x
f
k
m
b
a) Sistema fsico
Figura 10.7
kx
.
bx
www.FreeLibros.me
250
CAPTULO
10
Control
Entrada de control
f
Deseado
(referencia) ..xd
xd
Salida
kv Retroalimenmentaciones
+
+
.
x
kp
.
xd
x
Sistema
El controlador lee la entrada del sensor y escribe los comandos de salida del actuador
abierto del bloque, ecuacin (10.30a), con la ley de control de la ecuacin (10.31), se calcula
la dinmica de lazo cerrado como
x + b x + kx = k px k v x
m
(10.32a)
x + (b + kv) x + (k + kp)x = 0
m
(10.32b)
x + b x + kx = 0
m
(10.32c)
lo que da
donde b b + kv y k k + kp. Segn las ecuaciones (10.32b-c), queda claro que, mediante
la eleccin de las ganancias de control kv y kp, puede lograrse que el sistema de lazo cerrado
se comporte como cualquiera de los sistemas de segundo orden que se explicaron en la
seccin 10.2. Las ganancias se seleccionan para obtener la amortiguacin crtica, es decir,
b = 2
mk. Observe que kv y kp podrn ser negativos o positivos, dependiendo de los parmetros del sistema original. Sin embargo, si b o k son negativos el resultado podra
derivar en un sistema inestable. Esta inestabilidad sera obvia si se escribiera la solucin de
la ecuacin diferencial de segundo orden del lazo cerrado, ecuacin (10.32b), en la forma
de las ecuaciones (10.4), (10.12) y (10.21). Tambin tiene sentido intuitivo que si b o k son
negativos, los servo-errores tienden a magnificarse en vez de reducirse.
10.3.2
G (s) =
x ( s)
1
=
2
f ( s)
ms + bs + k
www.FreeLibros.me
(10.33)
10.3
Deseado
xd (s)
e(s)
Controlador
kp + kvs
Control retroalimentado
f (s)
Sistema
G(s)
251
Salida
x(s)
donde x(s) y f(s) son las transformadas de Laplace de los parmetros de variacin en el
tiempo, es decir, el desplazamiento x y la fuerza f, respectivamente.
Para el control retroalimentado, se selecciona la funcin de forzamiento f de acuerdo
con la ecuacin (10.31), de tal modo que el bloque siga o rastree una trayectoria deseada
denotada por xd, que por lo general es tambin una funcin del tiempo. Por ende, el sistema
de lazo cerrado para el control retroalimentado como se muestra en la figura 10.8 tambin
tiene la representacin que se muestra en la figura 10.9, donde la salida x(s), usando las reglas
de las manipulaciones del diagrama de bloques, puede escribirse como
x(s) = G(s) (kp + kv s) [xd (s) x(s)]
(10.34a)
En la figura 10.9, la seal de entrada al controlador es el error e(s), definido como la diferencia entre la salida real y la deseada que genera la fuerza necesaria f(s), es decir, f(s) = (kp
+ kvs)e(s). Mediante el reordenamiento de la ecuacin (10.34a), puede obtenerse fcilmente
la TF de lazo cerrado, relacionando la salida x(s) y la salida deseada xd(s) como
G ( s) ( k p + k v s)
x ( s)
=
(10.34b)
xd ( s)
1 + G ( s) ( k p + k v s)
Segn la ecuacin (10.34b), queda claro que para un comportamiento deseado del sistema de lazo cerrado, los polos de la ecuacin caracterstica debern seleccionarse de manera
apropiada. Segn la ecuacin (10.34b), la ecuacin caracterstica se obtiene por
1 + G(s)(kp + kv s) = 0
(10.35)
Si se sustituye la expresin para la TF, G(s) que se obtiene por la ecuacin (10.33), puede
reescribirse la ecuacin (10.35), que proporciona la expresin equivalente a la ecuacin
(10.32c). Entonces, segn la ecuacin (10.35), el sistema de lazo cerrado se amortigua crticamente cuando sus polos son iguales, es decir, s1 = s2. Para esta situacin, b = 2
mk, que
tambin se obtiene segn el anlisis de dominio de tiempo que se presenta en la subseccin
10.3.1.
Ejemplo 10.4
www.FreeLibros.me
252
CAPTULO
10
Control
Ejemplo 10.5
Para los parmetros sealados en el ejemplo 10.4, la TF del bloque se obtiene segn
la ecuacin (10.33) como
x ( s)
1
= 2
(10.37a)
f ( s)
s + s+1
El comportamiento del bloque x(s) para una perturbacin inicial, por ejemplo, la
entrada de pulsos, es decir, f(s) = 1, se obtiene mediante el comando que se proporciona a continuacin:
G(s) =
>> num = 1;
>> den = [1 1 1];
>> impulse(num,den);
10.4
www.FreeLibros.me
10.4
253
0.6
0.5
Amplitud
0.4
0.3
0.2
0.1
0
0.1
6
Tiempo (seg)
10
12
a) Sin control
7
6
5
Amplitud
4
3
2
1
0
1
0.5
1.5
Tiempo (seg)
2.5
b) Con control PD
Figura 10.10
ende, se selecciona normalmente una seal de entrada estndar de prueba. Una de ellas es
la entrada escalonada. Las entradas escalonadas son, de hecho, tambin entradas comunes
a muchos procesos fsicos. En aplicaciones de control, una prctica comn es la de evaluar
el comportamiento de un sistema con base en su respuesta escalonada. Este planteamiento
www.FreeLibros.me
254
CAPTULO
10
Control
es bastante til porque hay una correlacin razonable entre la respuesta de un sistema a
una entrada de prueba estndar y la capacidad del sistema para funcionar en condiciones
de operacin normales. Adems, el uso de una entrada estndar le permite al diseador la
comparacin de varios diseos disponibles.
Con el fin de evaluar el desempeo de un sistema de control, considere el sistema que se
presenta en la figura 10.7, cuyo comportamiento se evaluar contra una entrada escalonada
unitaria. Para este tipo de estudio, es ms conveniente usar la forma de la ecuacin dinmica de movimiento que se da en la ecuacin (10.30b), donde la correspondiente funcin de
transferencia (TF) se obtiene en la ecuacin (A.26b). Para una entrada escalonada unitaria,
es decir, (s) = 1/s, la salida x(s) se obtiene por
x(s) = G(s) f (s) =
1
s ( s 2 + 2Vw n s + w 2n )
(10.38a)
1
s ( s + s1) ( s + s2 )
(10.38b)
donde s1 y s2 son las races de la ecuacin caracterstica de los polos del sistema que se
proporciona en la ecuacin (A.27). Mediante las frmulas inversas de la transformada de
Laplace, la salida x, como funcin de tiempo, t, se obtiene como
1
(10.39)
x =1
e Vw nt sen (w n 1 - V 2 t + f), donde f = cos1 V
2
1- V
y el trmino wn
1 2, se conoce como frecuencia natural amortiguada. Dependiendo del
valor de la razn de amortiguamiento , estos polos pueden ser reales y desiguales ( > 1)
o reales e iguales ( = 1) o complejos conjugados ( < 1). Por lo tanto, se refiere al sistema
como sobreamortiguado, crticamente amortiguado y sub-amortiguado, respectivamente.
Para varios valores de la razn de amortiguamiento , se muestran las respuestas en la figura
10.10. Conforme se reduzca , se acercan los polos del sistema al eje imaginario y la respuesta se vuelve cada vez ms oscilatoria.
Ahora, los desempeos medidos respecto a la respuesta transitoria de la entrada escalonada a un sistema se muestran en la figura 10.11. La prontitud de la respuesta se mide por el
tiempo de subida Tr y el tiempo pico Tp, como se indica en la figura. Para sistemas sub-amortiguados con < 1 y una sobreoscilacin, el tiempo de subida Tr es un ndice til, mientras
que para los sistemas sobreamortiguados > 1 y sin sobreoscilacin, no se define ningn
tiempo pico. Por lo tanto, se usa normalmente un tiempo de subida de 10-90% Tr1, como se
indica en la figura 10.11. La similitud con la que la respuesta real coincide con la entrada
escalonada se mide por el porcentaje de sobreoscilacin y el tiempo de estabilizacin Ts. El
porcentaje de sobreoscilacin (PO) se define como
M pt - f v
(10.40)
PO =
100%
fv
donde Mpt es el valor pico de la respuesta de tiempo y v es el valor final de la respuesta.
Normalmente, v es la magnitud de la entrada, pero muchos sistemas tienen un valor final
diferente de la magnitud de entrada deseada. Para el sistema con un paso unitario que se representa en la ecuacin (10.38a), el valor de v es uno. Entonces, el tiempo de estabilizacin
www.FreeLibros.me
10.5
1.8
= 0.1
1.6
0.2
255
1.4
0.4
1.2
Salida, x
0.7
1.0
0.8
1.0
0.6
2.0
0.4
0.2
0.0
Figura 10.11
6
Tiempo, t
10
12
Ts se define como el tiempo necesario del sistema para estabilizarse dentro de un determinado porcentaje d de la amplitud de entrada. La banda de d se muestra en la figura 10.11.
Para el sistema de segundo orden en estudio, la respuesta permanece dentro de 2% despus
de cuatro constantes de tiempo, es decir,
4
Ts = 4t =
(10.41)
Vw n
Finalmente, el error de estado estable se mide en la respuesta escalonada del sistema,
como se muestra en la figura 10.12. Por otro lado, los requerimientos de la respuesta transitoria son la prontitud de respuesta Tr y Tp y la cercana de la respuesta a lo deseado Mpt y Ts,
que son contradictorias. Por lo tanto, tiene que encontrarse una solucin intermedia.
Para un sistema robtico, no puede permitirse una respuesta oscilatoria, particularmente
en una operacin de levantar y colocar, donde un efector final podr chocar contra el objeto
antes de recogerlo para su manipulacin. Por lo tanto, la ms alta velocidad, pero sin una
respuesta oscilatoria, dicta que los parmetros de diseo del controlador debern seleccionarse de tal manera que tengan una razn de amortiguamiento igual a uno o cerca de uno,
pero menos que uno.
10.5
En esta seccin se desarrollar el modelo para una articulacin robtica. Para ello, primero
que nada se desarrollar el modelo del par de torsin de un motor de corriente directa (CD)
que se muestra en la figura 3.8 y que comnmente se usa en robots industriales, seguido
www.FreeLibros.me
256
CAPTULO
10
Control
M pt
Sobreoscilacin
Respuesta
1.0 +
1.0
0.9
0.1
0
est
1.0
T r1
Tr
Tiempo
de subida
Figura 10.12
Ts
Tiempo de
estabilizacin
Tp
Tiempo
pico
Tiempo,t
por el modelo general de articulaciones. Puesto que un actuador tambin se equipa con un
conjunto de engranajes o arreglos de poleas de banda o cadena articulada para aplicar el par
de torsin o la fuerza al eslabn colindante (el prximo ms alto), stos tambin se tomarn
en cuenta en el modelo.
10.5.1
Modelo de un motor CD
Un motor de CD, como el que se muestra en la figura 3.7, trabaja con el principio de que
un conductor de corriente en un campo magntico experimenta una fuerza. Si el estator del
motor produce un flujo de induccin magntica y la corriente en el rotor (que tambin se
llama inducido o armadura) es ia, entonces habr un par de torsin sobre el rotor que lo hace
girar. La magnitud de este par de torsin es
tm = km ia
(10.42)
donde tm y km son el par del motor y la constante del motor, respectivamente. La constante
del par de torsin del motor puede determinarse mediante un conjunto de curvas de par/velocidad que se presentan en la figura 3.8 para diferentes valores de los voltajes aplicados.
La ecuacin (10.42) implica que el par de torsin sobre el rotor se controla con el control
de la corriente del inducido. Observe que cuando un motor gira, tambin acta como un
generador y se desarrolla un voltaje a travs de su inducido. Este voltaje es proporcional a
la velocidad del conductor en el campo y se llama fuerza contraelectromotriz (EMF). Esta
fuerza contraelectromotriz, denotada como vb, se opone al flujo de corriente en el conductor,
lo que puede expresarse como
vb = ke q m
(10.43)
10.5
257
controlado por el inducido que se representa en la figura 10.13, la ecuacin diferencial para
el circuito se obtiene como
di
(10.44)
la a + ra ia = va ke q m
dt
donde va, la y vb son la fuente de voltaje, la inductancia del devanado del inducido y la fuerza
contraelectromotriz generada, respectivamente.
En un control de robot, es deseable controlar el par de torsin generado por el motor en
lugar de la velocidad, por medio de los circuitos electrnicos controladores del motor. Estos
circuitos de accionamiento detectan la corriente
la
ra
a travs del inducido y continuamente ajustan la
fuente de voltaje va, para que una corriente deseada
+ .
ia fluya a travs del inducido. Este tipo de circuito
+
v
keqm
a
se llama control del motor por amplificacin de la
ia
10.5.2
258
CAPTULO
10
Control
ql
bl
Ig
h
Il
tl
.
qm
bm
Ia
tm
Figura 10.14
donde h >> 1. Si se expresa el par de torsin de carga tl conforme a los parmetros de carga,
a saber, ql y bl, es decir, tl = Ilq l + blq, donde bl es la friccin viscosa en los cojinetes de car-ga,
entonces la ecuacin (10.45) se reescribe como
1
(10.47)
I m q m + bm q m + (Il ql + bl q l ) = t m = km ia
h
Si se usa la relacin del movimiento de motor y eslabn que se obtiene en la ecuacin
(10.46), la ecuacin (10.47) puede escribirse en trminos de las variables del motor qm y tm
como
FI
GH
Il
h2
I q + Fb
JK GH
m
bl
h2
I q
JK
= tm
(10.48a)
mientras que, en trminos de las variables de carga, es decir, ql y tl, lo mismo puede expresarse como
(10.48b)
(I + h 2I ) q + (b + h 2 b ) q = t
l
El trmino ll + h2lm se llama inercia efectiva, que se ve en el lado del eslabn de salida del
engranaje. Asimismo, el trmino bl + h2bm se conoce como amortiguacin efectiva. Observe
que en articulaciones de muchos engranajes, es decir, h >> 1, la inercia del rotor del motor
puede ser una parte significativa de la inercia efectiva combinada. Este efecto permite la
suposicin de que la inercia efectiva es una constante. Se sabe, con base en la dinmica,
que la inercia del eslabn o de la carga Il de una articulacin del mecanismo en realidad
vara segn la configuracin y la carga. Sin embargo, en robots de mltiples engranajes, las
www.FreeLibros.me
10.5
259
(10.49)
(10.50)
donde las variables con (s) representan las transformadas de Laplace de la correspondiente
funcin en el dominio del tiempo. El diagrama de bloques del sistema de actuador/articulacin se presenta en la figura 10.15. La TF de va(s) a qm(s) se obtiene con tl(s) = 0 como
q m ( s)
km
(10.51)
=
s [(la s + ra ) ( I m s + bm ) + k e k m ]
v a ( s)
mientras que la TF del par de carga tl(s) a qm(s) se obtiene con va(s) = 0 como
q m ( s)
- (la s + ra )/ h
=
(10.52)
t l ( s)
s [(la s + ra ) ( I m s + bm) + k e k m]
Observe que la magnitud de esta ltima funcin de transferencia, es decir, el efecto del
par de torsin de la carga sobre el ngulo del motor, se reduce por la relacin de reduccin
(h). Esto tambin se seal despus de la ecuacin (10.48b). Para muchos sistemas electromecnicos, por ejemplo, los robots en estudio, se supone por lo general que la constante de
tiempo elctrica dada por la /ra es mucho ms pequea que la constante de tiempo mecnica
Im /bm. Por lo tanto, el orden del modelo dinmico del actuador puede reducirse en el orden
por uno. Esto se realiza de la siguiente manera. Se divide el numerador y denominador de
las ecuaciones (10.51) y (10.52) entre ra y se desprecia la constante de tiempo elctrica
asignndola en cero. Las TF de arriba se reescriben entonces como
q m ( s)
q ( s)
- 1/h
k m / ra
=
;y m
=
t l ( s)
s ( Is + b)
s ( Is + b)
v a ( s)
(10.53a)
donde
I = I m ; b bm +
ke km
ra
(10.53b)
1
las + ra
ia(s)
km
1
Ims + bm
1
s
ke
Figura 10.15
www.FreeLibros.me
qm(s)
260
CAPTULO
10
Control
(10.54a)
donde
t
km
va ; y t d l
(10.54b)
h
ra
En las ecuaciones (10.54a-b), b repretd
senta la amortiguacin efectiva ua de la
qm(s)
ua
1
1
ua
Ejemplo 10.6
Inercia efectiva
Si la inercia del eslabn vara de 2 a 6 kg/m2, la inercia del rotor es 0.02 kg/m2 y la
relacin de reduccin es de 30, entonces las inercias efectivas mnima y mxima se
calculan como
I mn = Il (mn) + h2 I m = 2 + (900)(0.01) = 11, donde h = 30
I mx = Il (mx) + h2 I m = 6 + (900)(0.01) = 15
Observe que la variacin de porcentaje de la inercia efectiva es slo aproximadamente
27% en comparacin con la variacin original de 67%. Esto se debe a la presencia de
la relacin de radios.
10.6
Controlador de articulaciones
En esta seccin se analizarn varios controladores de retroalimentacin, a saber, proporcionales (P), proporcionales y derivativos (PD), as como proporcionales, integrales y derivativos (PID), basndose en el modelo de articulaciones desarrollado en la seccin 10.5.
Inicialmente, no se supone ninguna perturbacin, es decir, td = 0, para la discusin sobre
controladores P y PD, mientras que el controlador PID se introduce para rechazar la perturbacin.
10.6.1
www.FreeLibros.me
10.6
261
Controlador de articulaciones
donde
wn
kp
b
;y V
I
2 kpI
(10.56)
10.6.2
En este controlador, la ganancia se elige como kp + kvs en lugar de kp en la figura 10.17, donde
kv se llama ganancia derivativa o ganancia de velocidad. Para este controlador, la TF de lazo
cerrado se da como
kv s + kp
k s / I + w n2
q ( s)
(10.57a)
= 2
= 2 v
q d ( s)
s + 2Vw n s + w n2
Is + (b + k v ) s + k p
donde la frecuencia natural wn se define igual que en la ecuacin (10.56), mientras que la
relacin de amortiguamiento se define como
b + kv
(10.57b)
V
kp I
En este punto, tanto la frecuencia natural n como la relacin de amortiguamiento
se determinan entonces por kp y kv. Puede demostrarse que si kp se aumenta, el tiempo de
estabilizacin se reduce (el sistema se vuelve ms rpido), mientras que al aumentar kv, se
reduce la sobreoscilacin, pero el sistema se vuelve ms lento. Por ende, mediante la eleccin correcta de los valores kp y kv, puede elegirse wn y para cumplir con los requerimientos
del tiempo de estabilizacin y la sobreoscilacin. Para la amortiguacin crtica se obtiene
kv = 2
kpI b. El controlador que se describi anteriormente se llama proporcional-derivaqd (s)
+
kp
1
s (Is + b)
q (s)
Controlador
Motor
Figura 10.17
www.FreeLibros.me
262
CAPTULO
10
Control
td (s)
qd (s)
+
kp + kvs
1
s (Is + b)
q (s)
Controlador
Motor
Figura 10.18
tivo o controlador PD. Es muy verstil y se usa extensamente para el control de robots. Sin
embargo, no es capaz de compensar el error de estado estable debido a las holguras o a la
friccin no modelada en el sistema mecnico, entre otros factores, lo que puede modelarse
como la entrada de perturbacin, es decir, td 0. Esto puede verificarse mediante la figura
10.18, donde el ngulo q se obtiene primero como
kv s + kp
t ( s)
(10.58)
q (s) =
qd (s) d
P ( s)
P( s)
donde el polinomio caracterstico P(s) se obtiene por P(s) Is2 + (b + kv)s + kp. El error e
puede entonces obtenerse como
t ( s)
Is 2 + bs
q (s) + d
P ( s) d
P( s)
Para una entrada escalonada y una perturbacin constante, es decir, cuando
(10.59a)
qd
t
(10.59b)
; y t d (s) = d
s
s
el error de estado estable ess se obtiene mediante el teorema de valor final (Ogata, 1987).
Esto se obtiene por
t
(10.60)
ess = lm e(s) = d
s 0
kp
Puesto que td es proporcional a la reduccin de engranaje 1/h, el error de estado estable
es menor para reducciones de engranaje altas. Adems, ess puede hacerse an ms pequeo si
la ganancia proporcional kp se hace grande. Sin embargo, el valor de kp no puede aumentarse
a cualquier valor, ya que podr excitar la oscilacin estructural. Por lo tanto, se propone un
controlador alterno con un trmino de integracin adicional.
q d (s) =
10.6.3
Controlador Proporcional-Integral-Derivativo
(PID)
ki
(10.61)
s
donde ki es la ganancia integrativa y la ecuacin (10.61) es la bien conocida ley de control
PID, como se muestra en la figura 10.19. Este controlador PID puede lograr que el error de
estado estable sea cero. Sin embargo,
f (s) = kp + kv s +
www.FreeLibros.me
10.6
Controlador de articulaciones
263
td (s)
qd (s)
+
Figura 10.19
ki
kp + kvs + s
Controlador
q (s)
1
s (Is + b)
Motor
Controlador proporcional-integral-derivativo
el trmino de integracin tiene que elegirse con cuidado, puesto que un ki grande puede
causar la inestabilidad del sistema.
Observe que con el trmino de integracin td(s) = 0, la TF del sistema de lazo cerrado
se obtiene con
k v s 2 + k p s + ki
q ( s)
=
, donde P(s) = Is 3 + (b + kv)s 2 + kp s + k i
q d ( s)
P ( s)
(10.62)
que es un sistema de tercer orden porque el orden ms alto del polinomio caracterstico es
tres. Si se aplica un criterio de estabilidad, por ejemplo, el de Routh-Hurwitz (Ogata, 1987)
al polinomio arriba mencionado, resultar que el sistema de lazo cerrado es estable si todas
las ganancias kp, kv y ki son positivas; adems,
ki <
(b + k v ) k p
(10.63)
I
Asimismo, el error de estado estable puede calcularse de manera parecida a las ecuaciones (10.58)-(10.60) como
q(s) =
ki + k p s + k v s 2
st d ( s)
qd (s)
P ( s)
P ( s)
(10.64a)
st d ( s)
Is 3 + bs 2
qd (s) +
P ( s)
P ( s)
ess = s lm 0 se(s) = s lm 0
(10.64b)
q
t
st d
= 0, donde qd (s) = d ; y t d (s) = d
s
s
P ( s)
(10.64c)
Por lo tanto, el controlador PID causa que el robot alcance el objetivo deseado, incluso
en presencia de una perturbacin constante.
10.6.4
Uno de los problemas principales que ocurre con mayor frecuencia en la implementacin de uno de los
controladores arriba mencionados principalmente en
el PID, es la eleccin de las ganancias del controlador,
lo que tambin se llama sintona. Como puede verse
segn la desigualdad de ecuacin (10.63), la magnitud
de ki se limita por la restriccin de estabilidad. Por lo
www.FreeLibros.me
Frecuencia de
resonancia
En esta frecuencia un puente se derrumbar si se permite que haya vibracin durante algn tiempo.
264
CAPTULO
10
Control
Tabla 10.1
Respuesta del
lazo cerrado
kp
kv
ki
Tiempo de
subida
Sobreoscilacin
Tiempo de
estabilizacin
Error de estado
estable
Disminucin
Cambio pequeo
Disminucin
Aumento
Disminucin
Aumento
Cambio pequeo
Disminucin
Aumento
Disminucin
Cambio pequeo
Eliminacin
tanto, una regla general de diseo comn es la de establecer primero ki = 0 y disear la ganancia proporcional y derivativa, kp y kv, respectivamente, para obtener el comportamiento
transitorio deseado, es decir, tiempo de subida, tiempo de estabilizacin, etc. Tambin puede
tomarse en consideracin el efecto de flexibilidad de la articulacin mientras se eligen las
ganancias. Por ejemplo, suponga que kj es la rigidez efectiva de la articulacin, por lo tanto,
la frecuencia de resonancia de la articulacin es wj =
kj /I. Es prctica de ingeniera comn
limitar wn de la ecuacin (10.56b) a no ms que la mitad de j para evitar la excitacin de la
resonancia de la articulacin. Para la seleccin de kp y kv, debe recordarse que un controlador
proporcional con una ganancia kp reducir el tiempo de subida y el error de estado estable,
pero jams lo eliminar, mientras que un control derivativo con una ganancia kv tendr el
efecto de aumentar la estabilidad del sistema, es decir, reducir la sobreoscilacin y mejorar
la respuesta transitoria. Finalmente, un control integral con la ganancia ki eliminar el error
de estado estable, pero podr hacer que la respuesta transitoria empeore. Estos puntos se
resumirn en la tabla 10.1.
Aqu se hace notar que las correlaciones sealadas en la tabla 10.1 posiblemente no sean
exactas porque kp, kv y ki son interdependientes. De hecho, el cambio de una de estas variables
puede cambiar el efecto de las otras dos. Por esta razn, esta tabla slo deber usarse como
referencia cuando se determinan los valores de ganancia. Una vez que se hayan elegido
kp y kv, se obtiene la ganancia ki mediante la ecuacin (10.63). Finalmente, puede tenerse
en cuenta que no se necesita implementar los tres controladores (proporcional, derivativo
e integral) en un solo sistema si no es necesario. Por ejemplo, si un controlador PI da una
respuesta suficientemente buena, no es necesario implementar un controlador derivativo en
el sistema. El controlador deber mantenerse lo ms sencillo posible.
Ejemplo 10.7
Para un brazo de un eslabn, se supone que I = b = 1 y la ganancia del control proporcional kp = 1. Por medio de MATLAB se obtiene la respuesta del brazo para la entrada
escalonada del ngulo de articulacin deseado qd. La funcin de transferencia (TF) se
evala mediante la ecuacin (10.56a), es decir,
q ( s)
1
1
= 2
, donde qd =
q d ( s)
s
s + s+1
www.FreeLibros.me
(10.65a)
10.6
Controlador de articulaciones
1.4
1.2
Amplitud
1
0.8
0.6
0.4
0.2
0
a) Controlador P
10
12
Tiempo(seg)
1
0.9
0.8
Amplitud
0.7
0.6
0.5
0.4
0.3
0.2
0.1
0
3
4
5
6
7
b) Controlador PD Tiempo(seg)
1.5
Amplitud
0.5
Figura 10.20
10
15
20
25
30
35 40 45
Tiempo(seg)
c) PID controlador
www.FreeLibros.me
265
266
CAPTULO
10
Control
Los comandos que se usan para obtener la respuesta son parecidos a los del ejemplo 10.5, mientras que la respuesta se muestra en la figura 10.20a). Observe el valor
unitario de estado estable para la amplitud que indica el ngulo de articulacin deseado qd. Entonces, con el fin de reducir la sobreoscilacin, se introduce un control
derivativo con la ganancia derivativa kv = 1. La TF correspondiente se obtiene segn
la ecuacin (10.56b) como
q ( s)
s+1
(10.65b)
= 2
q d ( s)
s + 2s + 1
Para la entrada escalonada del ngulo de articulacin deseado, la respuesta se presenta en la figura 10.20b), que muestra el comportamiento asinttico para alcanzar el
valor de estado estable . Adems, las otras caractersticas de la tabla 10.1, por ejemplo, la disminucin del tiempo de estabilizacin, son bastante obvias segn la figura
10.20b). Finalmente, la respuesta para el controlador PID se obtiene mediante la TF
determinada, basado en el polinomio caracterstico de la ecuacin (10.62), es decir,
q ( s)
s2 + s + 1
(10.65c)
= 3
q d ( s)
s + 2s 2 + s + 1
Para ki = 1 y la entrada escalonada de qd = 1/s, la respuesta se muestra en la figura
10.20c). Observe que algunas caractersticas, por ejemplo, el aumento de sobreoscilacin, que se dan en la tabla 10.1 tambin son obvias.
10.7
El anlisis de las secciones anteriores fue hecho con la suposicin de que la seal de referencia y la perturbacin son constantes que no se aplican para el rastreo de trayectorias de
variacin de tiempo ms generales, como, por ejemplo, una trayectoria polinomial cbica que se presentar en el captulo 11. Adems, el sistema de la seccin 10.6 fue lineal,
mientras que un sistema de mltiples grados de libertad es no lineal. Por lo tanto, en esta
seccin se presentar un planteamiento basado en la particin de la ley de control o en un
control por par de torsin computado.
10.7.1
En la preparacin para el diseo de leyes de control para robots de mltiples grados de libertad ms complejos, considere una estructura del controlador ligeramente diferente para
el problema que se muestra en la figura 10.17. En este mtodo se realiza la particin del
controlador en una parte basada en el modelo y otra parte en el servo. El resultado es que los
parmetros del sistema (es decir, m, b y k en este caso) aparecen slo en la parte basada en
el modelo y la parte de servo es independiente de estos parmetros. Este planteamiento se
conoce como particin de la ley de control. Observe que la ecuacin de movimiento de lazo
abierto para el sistema determinado, es
(10.66)
x + b x + kx = f
m
donde la parte de la ley de control basada en el modelo har uso de valores conocidos para
m, b y k. Esta parte de la ley de control se organiza de tal modo que se reduce el sistema de
www.FreeLibros.me
10.7
267
tal forma que parece tener una masa unitaria. La segunda parte de la ley de control hace uso
de la retroalimentacin para modificar el comportamiento del sistema. Puesto que la parte
del modelo basada en la ley de control tiene el efecto de hacer que el sistema aparezca como
una masa unitaria, el diseo de la parte de servo es muy simple. Las ganancias se eligen para
controlar un sistema compuesto nicamente por una sola masa unitaria, es decir, sin friccin
y sin rigidez. La parte del control basada en el modelo aparece en la ley de control como
(10.67)
f = af + b
donde a y b son funciones o constantes y se eligen de tal modo que se considera la nueva
entrada del sistema y el sistema parece ser una masa unitaria. Con esta estructura de la ley
de control, la ecuacin del sistema mediante las ecuaciones (10.66)-(10.67) es como sigue:
(10.68a)
x + b x + kx = a f + b
m
Queda claro que con el fin de hacer que el sistema aparezca como una masa unitaria con
como entrada, a y b se tienen que elegir como
(10.68b)
a = m, y b = b x + kx
Mediante estas asignaciones e incorporndolas en la ecuacin (10.68a), se obtiene la
siguiente ecuacin de sistema:
(10.69)
x = f
que es la ecuacin de movimiento para una masa unitaria. Entonces se propone una ley de
control para computar como
f = k v x k p x
(10.70)
Si se combina esta ley de control con la ecuacin (10.69), se obtiene
x + k v x + k p x = 0
(10.71)
Mediante esta metodologa, el ajuste de las ganancias de control es fcil y queda independiente de los parmetros del sistema, es decir,
(10.72)
kv = 2 k p
que debe ser vlido para la amortiguacin crtica. La figura 10.21 muestra el diagrama de
bloques para el controlador particionado que se utiliza para controlar el sistema de la figura
10.7.
kp
Figura 10.21
f9
kv
Sistema
x
.
x
+
.
bx + kx
www.FreeLibros.me
268
CAPTULO
10
Control
Ejemplo 10.8
10.7.2
Considerando la figura 10.7, en lugar de simplemente mantener este bloque en una ubicacin
deseada, vamos a mejorar el controlador de tal modo que pueda lograrse que el bloque siga
una trayectoria. La trayectoria se define como una funcin de tiempo, por ejemplo, xd(t) que
especifica la ubicacin deseada del bloque. Suponga que la trayectoria es continua (es decir,
que existen las primeras dos derivadas) y que el generador de trayectorias proporciona xd,
xd y xd para cualquier tiempo t. El servo-error entre la trayectoria deseada y la real se define
por e = xd x. Una ley de control de servo que entonces genera la trayectoria que se va a
seguir se obtiene por
(10.74)
x d + kv e + kpe
f =
Al combinar las ecuaciones (10.69) y (10.74) se obtiene
x d + kv e + k pe
x =
(10.75)
o
(10.76)
e + kv e + kp e = 0
sta es una ecuacin diferencial de segundo orden para la que pueden elegirse los coeficientes con el fin de obtener cualquier respuesta (frecuentemente la opcin que se elige es el
amortiguamiento crtico). Una ecuacin de este tipo se escribe en el espacio del error, ya que
describe la evolucin de los errores en relacin con la trayectoria deseada. La figura 10.22
muestra un diagrama de bloques de un controlador que sigue una trayectoria.
..
xd
f9
Sistema
kp
.
bx + kx
kv
.
e
.
xd
+
xd
+
Figura 10.22
www.FreeLibros.me
10.7
269
10.7.3
q +h+g =t
I
(10.77)
donde la matriz de inercia generalizada I de n n se define en la ecuacin (8.33) y los vectores n-dimensionales h, f y s se definen segn la ecuacin (8.44a), mientras que es el
vector n-dimensional de las aceleraciones de las articulaciones. El paso clave en el control
no lineal de un sistema robtico complejo es el uso del concepto de la particin de la ley de
control, como se mencion anteriormente. Supngase que la salida del controlador puede
escribirse como
(10.78a)
t = Att + b
www.FreeLibros.me
270
CAPTULO
10
Control
(10.78b)
La sustitucin de las ecuaciones (10.78a-b) en la ecuacin (10.77) proporciona lo siguiente:
(10.79)
t =
q
Esta ecuacin puede verse como un sistema de inercia unitaria con una nueva entrada t.
De alguna manera se cancelan las no linealidades en el modelo de dinmica no lineal original
del sistema. Cuando se elige la matriz A y el vector a de manera adecuada, se transforma el
sistema no lineal en un sistema lineal. Entonces puede aplicarse un controlador PD, similar
al bloque de la ecuacin (10.74), al sistema de inercia unitaria como
t =
q + K e + K e
(10.80a)
d
10.8
Sistemas complejos tienen mltiples entradas y mltiples salidas, o sistemas MIMO. Estos
sistemas pueden ser lineales o no lineales y con o sin variacin en el tiempo, como se indic an..
d
s9
Robot
h+f
Kv
.
e
.
d
+
d
+
Figura 10.23
Kp
www.FreeLibros.me
10.8
271
(10.84a)
y ( s)
(10.84b)
= C(sI A) 1 B + D
u ( s)
Observe que el lado derecho de la ecuacin (10.84b) involucra a (s1 A)1. Por ende,
G(s) puede escribirse como
q ( s)
(10.84c)
G(s) =
| sI - A |
G(s) =
www.FreeLibros.me
272
CAPTULO
10
Control
Ejemplo 10.9
Considere el movimiento del bloque en la figura 10.6, cuya nica ecuacin dinmica
de movimiento se obtiene por la ecuacin (10.30a). Se define lo siguiente:
(10.85a)
x1 = x; y x2 = x
Luego, la ecuacin (10.30a) puede expresarse como
k
b
1
(10.85b)
x 1 = x 2; y x 2 = m x 1 m x 2 + m f
donde la salida y puede darse por
y = x1
(10.85c)
Las ecuaciones arriba sealadas (10.85b-c) se ponen entonces en forma de matriz/vector como
(10.86a)
x = Ax + Bu; y y = Cx + Du
donde
0
0
1
x1
x
;A
k
b ; B 1 ; u f; C [1 0]; D = 0 (10.86b)
x2
m
m
m
En las ecuaciones (10.86a-b), el vector bidimensional x es el vector de estado, la
matriz A de 2 2 es la matriz de estado, mientras que las matrices B y C de 2 1 y
1 2, respectivamente, son las matrices de entrada y salida del bloque en estudio.
Adems, el vector de salida y y la matriz de transmisin directa D son escalares.
LM
MN
LM OP
N Q
Ejemplo 10.10
Y
g
q
a
Figura 10.24
LM
MN
OP
PQ
OP
PQ
www.FreeLibros.me
10.8
273
g
t
(10.87)
sen q =
a
ma 2
La ecuacin (10.87) es una ecuacin diferencial no lineal debido a la aparicin de
la funcin sen. Puesto que esto es un sistema de segundo orden, se necesitan dos
variables de estado, a saber,
x = q, y x = q
(10.88)
x 1 = x 2; y x 2 =
0
LM x OP ; A LM g sen
x
Nx Q MN- a x
1
OP
PQ
1
0 ; B = ma 2 ; u t; C [1 0]; D = 0
(10.91a)
Ejemplo 10.11
LM 0g
MN- a
1
0
OP
PQ
(10.91b)
Considere el movimiento del bloque de la figura 10.6, para el cual se da la representacin de estado-espacio en las ecuaciones (10.86a-b). Para encontrar la TF segn la
ecuacin (10.86b), la matriz s1 A se evala primero como
LMs 0OP LM 0k
N0 sQ MN- m
OP = LM ks
PQ MN m
OP
PQ
-1
(10.92a)
b
s+
m
Entonces es fcil encontrar la matriz inversa de 2 2 en la ecuacin (10.92a) como
s1 A =
(s1 A)
1
b
m
1
=
b
k
2
s + s+
m
m
LMs + b
MM - km
N m
www.FreeLibros.me
OP
P
sP
Q
(10.92b)
274
CAPTULO
10
Control
PP LM
PQ MN
MM
MN
Ejemplo 10.12
OP
PQ
(10.92c)
(10.93b)
Tomando la transformada de Laplace inversa de la ecuacin (10.93b), se obtiene
la ecuacin en el dominio de tiempo como
T q + q = Kv
(10.93c)
m
LM
MN
LM OP
N Q
10.8.1
OP
PQ
LM OP
MN PQ
LM OP
NQ
Para un robot de mltiples DOF cuya dinmica se rige por la ecuacin (10.77), la representacin estado-espacio en forma de la ecuacin (10.81) puede darse de la siguiente manera:
x
LMx OP ; f LM
Nx Q N I
1
-1
OP
Q
x2
, y g x1
(t - h - g )
www.FreeLibros.me
(10.95)
10.8
275
(10.96)
donde cada elemento de k son ganancias constantes por determinarse, y qd es una entrada de
referencia o deseada. Al sustituir la ecuacin (10.96) en la ecuacin (10.94b), se obtiene
(10.97)
x = (A bk T) x + bqd
lo que demuestra que el control lineal retroalimentado tiene como efecto cambiar los polos
del sistema que se determinaron por A a los que se determinan por (A bkT). En la ecuacin
(10.96), el control se determina como una combinacin lineal de los estados del sistema que,
en este caso, son la posicin del motor y la velocidad. Si se compara esto con el control PD o
PID, como se presenta en la subseccin 10.6.2 y en la 10.6.3, respectivamente, lo que tambin
es una funcin de la posicin del motor y la velok
cidad, no se obtiene ninguna ventaja. Sin embarIm
Il
ql
u, qm
go, para un sistema de mayores dimensiones, por
bm
bl
ejemplo, una articulacin cuya flexibilidad se est
tomando en cuenta, como se muestra en la figura Figura 10.25 Articulacin sencilla
10.25, puede comprobarse que la retroalimentacon exibilidad
cin estado-espacio ser una ventaja.
Observe que la flexibilidad de la articulacin puede ocurrir por muchas razones. Por
ejemplo, la flexibilidad torsional de los engranajes, el balanceo de la flecha, la deformacin
del cojinete, etc., pueden contribuir considerablemente a la flexibilidad en las articulaciones.
Si se escribe su modelo dinmico, resultarn dos ecuaciones diferenciales de segundo orden,
correspondientes a sus dos DOF, es decir, qm y ql, que corresponden a las rotaciones del motor y del eslabn o de la carga, respectivamente. En este tipo de sistema, si los coeficientes
de amortiguacin bm y bl son pequeos, lo que frecuentemente es el caso en muchos robots
industriales, es difcil controlar el sistema, ya que dos de los cuatro polos estn situados en
el origen, mientras que los otros dos se encuentran en el eje imaginario. Suponga que el control PD tradicional de la subseccin 10.6.2 est implementado para controlar la articulacin
flexible; entonces el cmputo de sus dos ganancias dependera de que se hayan colocado los
sensores de posicin y velocidad en el eje motriz o en el eje del eslabn, es decir, el controlador PD es una funcin de las variables del motor o de las variables de la carga. En este tipo de
control puede demostrarse (Spong et al., 2006) que el sistema es inestable para una ganancia
proporcional grande. Alternativamente, si se aplica el control retroalimentado de estado de la
forma dada por la ecuacin (10.96), es posible lograr un rango mucho ms grande de polos
de lazo cerrado, lo que logra la estabilidad del sistema. Esto es posible porque hay cuatro
parmetros de ganancia en la ecuacin (10.96) que corresponden al vector de estado x de 4
dimensiones, es decir, ngulo del motor, velocidad del motor, ngulo de la carga y velocidad
www.FreeLibros.me
276
CAPTULO
10
Control
de la carga, que pueden ser medidos si se colocan sensores apropiados en los ejes del motor
y de la carga. La ganancia k, a diferencia del control tradicional PD, donde las dos ganancias
son funciones de la posicin y velocidad del motor o de la posicin y velocidad de la carga,
es una funcin de esas cuatro dimensiones. Por lo tanto, mediante la retroalimentacin de
estado hay ms parmetros libres para obtener la estabilidad. Sin embargo, problemas como
la posibilidad de control y observacin son tambin importantes, ya que determinan el xito
de la ley de control retroalimentado del estado.
10.9
Estabilidad
10.9.1
El mtodo de Lyapunov
Una caracterstica interesante de este mtodo de estabilidad es que puede concluirse sin
resolver la ecuacin diferencial que rige el sistema. Sin embargo, el mtodo no proporciona
ninguna informacin sobre la respuesta transitoria o sobre el desempeo del sistema, por
ejemplo, si se sobreamortigua o subamortigua o cunto tiempo se tardar en suprimir una
perturbacin. No obstante, es importante diferenciar la estabilidad del desempeo porque
un sistema estable podr tener un desempeo de control poco satisfactorio.
Para explicar el mtodo de Lyapunov, considere el sistema no lineal que se describe mediante un conjunto de ecuaciones diferenciales dado por
(10.98)
x = f (x)
donde x es un vector de estado n-dimensional como se introdujo en la seccin 10.8 y f(x) es la
funcin vectorial n-dimensional. Observe que cualquier ecuacin diferencial de orden mayor
siempre puede escribirse como un conjunto de ecuaciones de primer orden en la forma de la
ecuacin (10.98). Vea los ejemplos 10.9 y 10.10 para los sistemas de segundo orden. Para demostrar que un sistema es estable mediante el mtodo de Lyapunov, se necesita lo siguiente:
1. Proponga una funcin de energa generalizada v(x) que se llama funcin de Lyapunov, cuyas primeras derivadas parciales sean continuas y v(x) > 0 para todos los x,
excepto v(0) = 0.
2. Evale la primera derivada respecto al tiempo de v(x).
www.FreeLibros.me
10.9
Estabilidad
277
3. Verifique si v(x) 0. Aqu, v(x) implica el cambio de v(x) respecto al tiempo a lo largo
de todas las trayectorias del sistema.
La idea es que una funcin tipo energa positiva definitiva del estado demuestre que siempre disminuye o permanece constante. Por lo tanto, el sistema es estable en el sentido que
el tamao del vector de estado se limite. Cuando v(x) es estrictamente menos que cero, el
estado converge en forma asinttica hacia el vector cero. Sin embargo, para v(x) 0, es decir,
cuando v(x) desaparece en algunos lugares de la trayectoria, LaSalle y Lefschetz (1961) demostraron que el sistema an puede ser asintomticamente estable en ciertas situaciones.
Observe que el mtodo de Lyapunov puede aplicarse igualmente a sistemas lineales. La
principal dificultad de ese mtodo, sin embargo, es la eleccin de la funcin de Lyapunov,
v(x). En muchas aplicaciones es fcil adivinar, pero obtener v(x) para un sistema complejo
es difcil, ya que no hay ningn mtodo estndar para conformarlo.
Ejemplo 10.13
Ejemplo 10.14
Para verificar la estabilidad de un brazo robtico con DOF = 1 como el que se presenta
en la figura 10.23, con q = 0 cuando no hay ningn par de torsin externo actuando,
es decir, t = 0, considere la siguiente funcin de Lyapunov:
v=
1
ma2 x 22 + mga(1 cos x1)
2
www.FreeLibros.me
(10.102)
278
CAPTULO
10
Control
Ejemplo 10.15
Suponga que el robot con DOF = 1 del ejemplo 10.14 est bajo el control PD, es decir, la salida del actuador se obtiene por t = kpx1 kvx2. Los trminos kp y kv son las
ganancias proporcionales y derivativas, respectivamente, que siempre son positivas.
Ahora vamos a definir la funcin de Lyapunov como
1
1
(10.104)
v = ma2 x 22 + mga(1 cos x1) + k p x 21
2
2
Mediante la diferenciacin de la ecuacin (10.104) respecto al tiempo, se obtiene
(10.105a)
v = ma2 x2 x 2 + mga sen x1 x 2 + kp x1 x2
Si se sustituye para x2 de la ecuacin (10.89) en la ecuacin (10.105a), se obtiene
la expresin para v como
(10.105b)
v = kv x 22
lo que garantiza la estabilidad asinttica, ya que kv > 0.
10.9.2
Para un robot de mltiples DOF que sigue una trayectoria, la estabilidad puede comprobarse
mediante el mtodo de Lyapunov para un controlador PD mientras que la matriz de ganancia derivativa Kv sea una definitiva positiva. Para demostrarlo, considere las ecuaciones
dinmicas de movimiento para el robot de mltiples DOF dadas en la ecuacin (10.77). El
correspondiente control PD puede darse mediante
t = K pe K v q + g
(10.106)
donde e = pd p, y Kp y Kv son las matrices de ganancia diagonales que son definitivas positivas. Mediante esta ley de control, se obtiene el sistema de lazo cerrado segn la ecuacin
(10.77) como
q + h + K v q = K p e
I
(10.107)
Considere la funcin de Lyapunov como
1
1
(10.108)
v = q T I q + e T K p e
2
2
www.FreeLibros.me
10.10
279
que es no positiva mientras que Kv sea positivo definitivo. Sin embargo, esto no garantiza de
forma automtica la estabilidad asinttica, an as, LaSalle y Lefschetz (1961) demostraron
que el sistema logra la estabilidad global asinttica.
10.10
10.10.1
El control cartesiano
En este control, dada la posicin y orientacin cartesiana as como las primeras dos derivadas, un planteamiento es usar la cinemtica inversa para posicin, velocidad y aceleracin
con el fin de obtener la posicin, velocidad y aceleracin de la articulacin, y usar uno de
www.FreeLibros.me
280
CAPTULO
10
Control
Posicin, velocidad y
aceleracin deseadas
del efector final
Figura 10.26
Cinemtica inversa
para posicin,
velocidad
y aceleracin
Posicin, velocidad
y aceleracin deseadas
de la articulacin
los planteamientos de control de articulaciones que se presentan en las secciones 10.3, 10.6
y 10.8, respectivamente. Esto se presenta en la figura 10.26. La conversin de trayectoria
es bastante compleja y consume mucho tiempo. Por lo tanto, en muchas ocasiones slo se
ejecuta la cinemtica inversa para la posicin para obtener los movimientos de articulacin
deseados, los que luego son numricamente diferenciados para obtener las velocidades y
aceleraciones de articulaciones. Esta diferenciacin numrica tiende a amplificar el ruido,
lo que conduce a otras dificultades del control.
Una manera alternativa de evitar las dificultades que se mencionan arriba, es decir, el
ruido numrico, etc., es el uso de un algoritmo de cinemtica directa, como el que se presenta
en el captulo 6, para convertir las trayectorias reales de articulaciones disponibles de los
sensores de articulaciones en las trayectorias del efector final, y aplicar una ley de control
para obtener las fuerzas y momentos que van a ser aplicadas al efector final. Estas fuerzas
y momentos de control se transforman luego en los pares de torsin de los actuadores de
articulaciones necesarios mediante la premultiplicacin de las cantidades anteriores por
la transposicin de la matriz jacobiana calculada en el captulo 6. La correlacin entre las
fuerzas y momentos del efector final se obtienen en el captulo 7. Este mtodo se presenta
en la figura 10.27.
10.10.2
En aplicaciones donde el efector final tiene que aplicar una fuerza controlada, por ejemplo, en
un vidrio que es limpiado por un robot, los mtodos de posicin y control que se presentaron
en las secciones anteriores no sern apropiados, a menos que la herramienta en el efector final,
por ejemplo, una esponja, sea suficientemente suave. Si el efector final es rgido, por ejemplo,
una herramienta de rasgado, entonces cualquier incertidumbre en la posicin de la superficie
de vidrio o el error posicional en el efector final causar que se rompa el vidrio o que el rascador
ni siquiera toque el vidrio. En tales situaciones deber especificarse la fuerza, y no la posicin,
para obtener un desempeo satisfactorio del robot. De hecho, es ms realista usar un controPosicin, velocidad y
aceleracin deseadas
del efector final +
Ley de
Errores
control de la
trayectoria
cartesiana
Fuerzas y
momentos
de control
Posicin, velocidad y
aceleracin real del efector final
Figura 10.27
JT
Par de torsin
de control de la
articulacin
Robot
Cinemtica
directa
www.FreeLibros.me
Posicin,
velocidad y
aceleracin
real de la
articulacin
Resumen
Trayectoria
cartesiana real
Trayectoria
deseada del
efector final
Ley de control
de trayectoria
cartesiana
Fuerzas
y momentos
deseados del
efector final
Ley de
control
de fuerzas
Figura 10.28
Cinemtica
directa
Fuerzas y
momentos
+
de control
S9
281
Trayectoria real
de la articulacin
Pares de
torsin
de
Robot
JT control
de las
articulaciones
Fuerzas y momentos
de articulacin real
RESUMEN
En este captulo se presentan los algoritmos para el control de movimiento de robots.
Se analizan controles tanto lineales como no lineales. Tambin se presenta el aspecto de
estabilidad de un algoritmo de control. Finalmente, para completar el tema, se introduce
el control por trayectoria cartesiana y fuerza. Se ofrecen varios ejemplos para ilustrar
diferentes conceptos en este captulo.
www.FreeLibros.me
282
CAPTULO
10
Control
EJERCICIOS
10.1 Para el movimiento del bloque que se presenta en la figura 10.2, si m = 2, b = 6,
k = 4 y si est inicialmente en reposo, describa su movimiento cuando se libere
de la posicin x = 1.
10.2 Cules son los polos de un sistema de control?
10.3 Para un sistema de segundo orden, defina la sobreoscilacin y la constante de
tiempo.
10.4 Qu es el control PID? Por qu es importante el trmino de la integral?
10.5 Considere un sistema de accionamiento de eslabn que consiste en un servomotor
CD con una inercia total de 0.02 kg/m2, una friccin de cojinete de 0.5 N/s y una
caja de engranajes con una relacin de radios de 32. La inercia del eslabn es 5
kg/m2 y la friccin del cojinete del eslabn es 2 N/s. Determine la inercia efectiva
y el amortiguamiento efectivo para la articulacin. Suponga que todas las flechas
son rgidas y sin masa.
0.2
10.6 La funcin de transferencia (TF) de un sistema es G ( s) =
01
. s 2 + 0.6s + 1
Busque su frecuencia natural y la relacin de amortiguamiento.
10.7 Escriba la representacin estado-espacio del problema en el ejercicio 10.1.
10.8 Busque la TF a partir de la representacin estado-espacio del ejercicio 10.6.
10.9 Considere el sistema no lineal
x + 7 x 2 + x x + x 3 = u
donde u es la entrada de control. Disee un sistema de control conveniente basado
en la ley de control particionada, de tal modo que la respuesta del error sea crticamente amortiguada. Dibuje el diagrama de bloques.
10.10 Por qu son necesarios el control cartesiano y el control por fuerza en una aplicacin de robot?
10.11 Explique el criterio de estabilidad de Lyapunov para sistemas no lineales.
Captulo
11
Planeacin
de movimientos
El objetivo de la planeacin de movimientos de un robot es generar una funcin con la cual
se mover un robot. Esa generacin de funcin depende de las tareas del robot, por ejemplo,
recoger un objeto de un punto para depositarlo en otro o soldar dos piezas metlicas a lo
largo de una curva. En el primer caso, se asigna el punto inicial y el punto final, es decir,
el movimiento de punto a punto, mientras que en el segundo, tiene que especificarse una
secuencia finita de puntos, es decir, un movimiento de ruta continua. Un usuario de robots
normalmente especifica un nmero de parmetros para describir una tarea de punto a punto
o de ruta continua. Luego, un algoritmo de planeacin de la trayectoria calcula las entradas
al controlador de movimiento del robot.
La planeacin de las trayectorias puede efectuarse
Por qu planeacin
ya sea en el espacio de las articulaciones o articular, es
de movimientos?
decir, en trminos de las posiciones articulares, velocidades y aceleraciones, o espacio cartesiano (tambin Igual que una persona decide sobre la
llamado espacio operacional). Esto es, en trminos de
ruta que seguir de un lugar a otro, la
ruta de un robot tiene que decidirse
las posiciones, del efector final, orientaciones y sus
por medio de la planeacin de moviderivadas respecto al tiempo. Por lo regular se prefiere
mientos.
lo ltimo, ya que permite una descripcin natural de la
tarea que el robot tiene que realizar. Sin embargo, la accin de control para el robot se lleva
a cabo en el espacio de la articulacin. Por esta razn, debe usarse un algoritmo inverso,
apropiado para reconstruir la secuencia de tiempo de variables articulares correspondientes
a la secuencia arriba mencionada en el espacio cartesiano.
La planeacin de la trayectoria en el espacio cartesiano naturalmente permite dar cuenta
de la presencia de cualquier restriccin a lo largo de la ruta del efector final. stas tienen
que ver con las regiones del espacio de trabajo en las que el robot tiene prohibido actuar,
por ejemplo, por la presencia de obstculos. Estas restricciones se describen mejor en el espacio cartesiano porque sus puntos correspondientes en el espacio articular son difciles de
www.FreeLibros.me
284
CAPTULO
11 Planeacin de movimientos
11.1
En esta seccin, se considerarn mtodos para determinar una trayectoria deseada con variables articulares a travs del tiempo. En el mtodo del espacio articular, se supone que se
conocen las posiciones iniciales y finales de la articulacin correspondientes a las configuraciones iniciales y finales del efector final mediante la solucin del problema de cinemtica
inversa de posicin que se explic en el captulo 6. Entonces, el problema bsico es cmo
seleccionar una trayectoria entre una posicin inicial y una final de articulacin con el intervalo que se permite para el movimiento entre las dos. En la literatura, se han propuesto varios
mtodos para resolver el problema. Uno simple que se basa en las funciones polinomiales
de tiempo. Suponga que para alguna articulacin, el ngulo inicial es q0 en un tiempo t = 0
y el ngulo final es q en un tiempo t = t, es decir,
q(0) = q0; y q(tf) = q f
(11.1)
Adems, para iniciar y detener el efector final de acuerdo con cierta velocidad y aceleracin deseada, tiene que cumplirse con las siguientes condiciones:
q (0) = q 0; q (tf) = q f
q (0) = q 0; q (tf) = q f
(11.2)
(11.3)
(11.4)
(11.5)
www.FreeLibros.me
11.1
4 f
3 f
5 f
285
(11.7d)
(11.7e)
(11.7f )
1
[20(q f q 0) 8( q f + 12 q 0) tf (3 q 0 q f ) t 2f]
2 t 3f
(11.8b)
a4 =
1
[30(q 0 q f) + (14 q f + 16 q 0) tf + (3 q 0 2 q f) t 2f ]
2 t 4f
(11.8c)
1
[12 (q f q 0) 6( q f + q 0) tf + ( q f q o) t 2f ]
(11.8d)
2 t 5f
Observe que si las aceleraciones en el punto final desaparecen, es decir, si q0 = q = 0, y
la relacin que se muestra en la figura 11.1 se satisface por q0, q, q0 y q, es decir, si
a5 =
qf q0 =
tf
2
( q 0 + q f)
(11.9)
entonces a5 = 0, lo que implica que slo se requiere un polinomio del cuarto orden para q
(t). Usando combinaciones de los polinomios del cuarto orden y lneas rectas, pueden determinarse con mucha facilidad las trayectorias para varios casos. Vamos a considerar dos de
estos casos, como se explicar en las siguientes subsecciones.
11.1.1
Como en la figura 11.2, se desarrolla la trayectoria que inicia desde el reposo en q0, pasa a
travs de las fases de aceleracin, velocidad constante y desaceleracin, y finalmente llega a
un alto total en q. Para este propsito, primero se elige el valor del parmetro que denota
q
.
q0
q0
Figura 11.1
qf
tf
tf /2
.
(q0 + qf)
tf
.
qf
www.FreeLibros.me
286
CAPTULO
11 Planeacin de movimientos
q
qf 2 qf 3
qf 1
q02
q01
q0
O
D
Figura 11.2
Ejemplo 11.1
(11.10a)
(11.10b)
Entonces se obtienen los coeficientes del polinomio de cuarto orden entre q0 y q02
como
a0 = 90; a1 = a2 = 0; a3 = 80; y a4 = 80
www.FreeLibros.me
(11.10c)
11.1
287
60
a2 = 1
120
a1 = 1
90
O
60
a) Posicin inicial
b) Posicin final
Figura 11.3
(11.10d)
Para la lnea recta entre q02 y q1, es decir, 0.5 < t 1.5, puede obtenerse fcilmente
como
q1 = 85 20(t 0.5)
(11.10e)
Finalmente, el polinomio de cuarto orden entre q2 y q, es decir, 1.5 < t 2.0 puede
escribirse como
q1(t) = a0 + a1 (t 1.5) + a2 (t 1.5)2 + a 3 (t 1.5) 3 + a4 (t 1.5) 4 (11.10f)
cuyos coeficientes se calculan como
(11.10g)
0 t 0. 5
0.5 < t 1. 5
(11.10h)
- 80 ( t - 1.5) , 15
. < t 2.0
0 t 0.5
0.5 < t 1.5
www.FreeLibros.me
(11.11)
288
CAPTULO
11 Planeacin de movimientos
t=0
t = 0.5
10 10
t = 1.0
t = 1.5
O
Figura 11.4
11.1.2
Aqu se determina una trayectoria que empieza desde el reposo en la posicin inicial q0, pasa
a travs de las posiciones intermedias q1 y q2 y se detiene en la posicin final q. Primero
considere el caso donde no es necesario pasar exactamente a travs de q1 y q2. En ste, sean
los puntos auxiliares especificados q02, q11, q12, . . ., q1, como en la figura 11.5. Observe que
los valores en el punto q01 y q0 son los mismos, que los valores en q2 yq son los mismos y
que q02 y q11 estn en la lnea recta entre q01 y q1. Los puntos q12, . . ., q1 se determinan de
la misma manera. Entonces se determinan los segmentos de la trayectoria para (q0, q02),
q
qf 2 qf
qf 1
q1
q0
q01
Figura 11.5
q21
q02
q22
q12
q11
q2
D D
www.FreeLibros.me
11.1
289
(q11, q12), . . ., (q1, q) mediante polinomios de cuarto orden, as como para (q02, q11), (q12,
q21), y (q22, q1), usando lneas rectas. La trayectoria resultante se ilustra mediante una lnea
en negritas en la figura 11.5.
Luego considere el caso donde se requiere que la trayectoria pase exactamente a travs de q1 y q2. Este caso puede resolverse mediante el incremento del nmero de puntos
auxiliares. Un mtodo se presenta en la figura 11.6a). Los puntos auxiliares se determinan
de la siguiente manera: Como lo muestra la figura 11.6b), qi2(i = 1, 2) es el punto medio entre A la interseccin de la lnea de t = ti con la lnea recta entre qi1 (q01 cuando i = 1)
y qi y B la interseccin de la lnea de t = ti con la lnea recta entre qi y qi+1 (q2 cuando i = 1). El punto qi3 se determina de manera parecida. Luego se determinan los segmentos de la trayectoria para (q0, q02), (q11, q1), (q1, q14), . . ., (q1, q) mediante polinomios
del cuarto orden y para (q02, q11), (q14, q21) y (q24, q1), usando lneas rectas, como en el caso
anterior.
En el problema bsico de conectar q0 y q mediante un polinomio, que se mencion al
principio de esta seccin, si la condicin de frontera para la posicin, ecuacin (11.1) y la
condicin de la velocidad, ecuacin (11.2), pero no la de la continuidad de aceleracin,
ecuacin (11.3), se consideraron como polinomios que pueden simplificarse. De manera
ms especfica, puede usarse un polinomio de tercer orden
q(t) = a0 + a1t + a2 t 2 + a3 t 3,
(11.12a)
q12 q q13
1
q11
q0
q01
q14
q21
q02
qf 1 qf 2 qf
q22
q2 q23
q24
t1
t2
tf
a) Puntos intermedios
qi3
B
qi
qi2
qi1
qi 1
qi4
qi + 1
A
D
ti
Figura 11.6
www.FreeLibros.me
290
CAPTULO
11 Planeacin de movimientos
a3 =
1
[2(q f q 0) + ( q f + q 0)tf].
t 3f
(11.12b)
11.2
Cuando se genera una trayectoria entre dos configuraciones del robot por medio de un mtodo de variaEspacio articular vs.
espacio cartesiano
bles articulares, como se describi en la subseccin
anterior, a veces es difcil pronosticar el movimiento En el espacio articular se utilizan ndel efector final en el espacio cartesiano. Tambin hay gulos articulares y desplazamientos
casos donde se requiere alguna trayectoria especfica para denir la conguracin de un
del efector final. Por ejemplo, en la soldadura por arco, robot, mientras que las coordenadas
cartesianas se utilizan para el mismo
el electrodo deber seguir con precisin a una costura. propsito en el espacio cartesiano..
En estos casos, deseamos generar una trayectoria en
trminos de las variables de posicin y orientacin, es
decir, la configuracin del efector final. Hay varios modos de describir la posicin y orientacin, es decir, la configuracin del efector final. Puesto que el efector final de un cuerpo
rgido en el espacio cartesiano tridimensional tiene seis grados de libertad, se requieren seis
variables para determinar la configuracin del efector final. Una vez que se elija la manera,
puede determinarse la trayectoria en trminos de una variable de seleccin arbitraria, que es
una secuencia de polinomios de la forma de la ecuacin (11.4) o de la ecuacin (11.10). La
trayectoria de un efector final que se obtiene de esta manera es muy simple y fcil de visualizar. Por ejemplo, en caso que el efector final se mueva sobre la lnea recta que conecta las
configuraciones iniciales y finales en el espacio cartesiano tridimensional, pueden usarse las
coordenadas X, Y y Z del origen del sistema de referencia del efector final respecto al sistema
de referencia como las tres variables para describir la traslacin.
Ejemplo 11.2
Vamos a obtener una trayectoria para el problema del ejemplo 11.1, no en trminos de
variables articulares, sino en trminos de las variables de posicin del efector final, es
decir, r [x, y]T. Puesto que para la longitud del eslabn a1 = a2 = 1 la posicin inicial r0 es [
3/2, 3/2]T y la posicin final r es [1, 0]T, la trayectoria r(t) = [x(t), y(t)]T se
www.FreeLibros.me
11.2
291
R| 3/2 + 4 (2 - 3) (t - t )/3
0 t 0.5
|(5 3 + 2)/12 + (2 - 3) (t - 0.5)/ 3 0.5 < t 1.5
x(t) = S
||(10 + 3)/12 + (2 - 3) (t - 1.5) / 3
T- 4 (2 - 3)[(t - 1.5) - (t - 1.5) ]/ 3 15. < t 2
R|3/2 - 4t + 4t
0 t 0.5
y(t) = S5/ 4 - (t - 0. 5)
0.5 < t 1.5
|T1/ 4 - (t - 1.5) + 4 (t - 1.5) - 4 (t - 15. ) 1.5 < t 2.0
3
(11.13a)
(11.13b)
11.2.1
LMe Ca + Ca
Q(e, a) = Me e C a + e Sa
MNe e Ca - e Sa
2
x
ex e y C a - ez Sa
e 2y
x z
C a + Ca
e y ez C a + e x Sa
www.FreeLibros.me
OP
e e C a - e Sa P
PQ
e C a + Ca
e x ez C a + e y Sa
y z
2
z
(11.14)
292
CAPTULO
11 Planeacin de movimientos
(11.15a)
(11.15b)
que no es otra cosa que la primera columna de Q(e, a), como se muestra en la ecuacin
(11.14). La segunda y tercera columnas son obtenidas de manera similar. Entonces, el mtodo de rotacin de un solo eje se determina. Suponga que la orientacin rf Respecto al sistema
de referencia del efector final r0 es [e, af] cuando se expresa mediante la representacin
arriba mencionada [e, a]. Entonces puede darse una trayectoria desde r0 hasta r como una
para la cual a cambia de 0 a a alrededor del eje fijo e. El cambio de a puede especificarse, por ejemplo, mediante la solucin similar a q(t) de la ecuacin (11.4), es decir, con las
siguientes condiciones de frontera:
(0) = 0, a
f,
a (0) = 0, a (tf) = a f, a (0) = 0, a 0 ,(tf) = a f, a
0, (tf ) = a
La trayectoria para la orientacin se determina por [e, a(t)], donde 0 t t. Puesto que
la trayectoria se determina por una rotacin alrededor de un eje e que se fija al sistema de
referencia, es fcil de entender de manera intuitiva.
11.2.2
Suponga que la orientacin final respecto a la inicial es determinada por (f, q, y) cuando
se expresa usando los ngulos de Euler. Si se usa la ecuacin (11.14) y la representacin de
matriz en trminos de f, q y y, como se hizo en el captulo 5, puede verse fcilmente que
la orientacin tambin se determina por la matriz de rotacin Q(e, q)Q(k, y + f), donde
e [sen f, cos f, 0]T y donde k es el eje Z despus de la transferencia por Q(e, q). De
este modo, puede realizarse una trayectoria de inicial a final usando Q(e, q), Q(k, y + f),
donde q y y + f son funciones polinomiales de tiempo especificadas por la ecuacin (11.4)
con condiciones de frontera apropiadas y k es el vector unitario paralelo al eje Z del tiempo
t despus de la transferencia por Q(e, q). Expresado de manera simple, esta trayectoria es
una combinacin de dos rotaciones simultneas; una alrededor del eje perpendicular a los
vectores de aproximacin de las configuraciones inicial y final, es decir, r0 y r (el cual tiene
una direccin constante en el sistema de referencia del efector final de r0) a travs de un ngulo q, y la otra rotacin a travs de un ngulo (y + f) alrededor del vector de aproximacin
en cada instante. Ambos ejes de estas dos rotaciones son fciles de entender. En particular,
cuando la ltima articulacin de un manipulador es rotacional o de revoluta con su eje rotacional coincidente con el vector de aproximacin del efector final, esta articulacin puede
ejecutar la segunda rotacin alrededor de k por s misma. Aunque el mtodo de rotacin del
www.FreeLibros.me
11.2
Ejemplo 11.3
293
Suponga que quisiramos encontrar una trayectoria que transfiere la orientacin del
efector final desde el reposo en la orientacin inicial que se presenta en la figura 11.8a)
a la orientacin final que se muestra en la figura 11.8b), llegando al reposo en el tiempo
t = 1. Resuelva el problema por medio de los mtodos de rotacin de un solo eje y del
eje doble. Puede verse fcilmente, en la figura 11.8, que la matriz de rotacin Q que
representa la orientacin final respecto a la inicial es
0 0 1
LM
Q M1
MN0
0
1
OP
0P
0PQ
LM
MM
N
OP
PP
Q
LM
MM
N
OP
PP
Q
Z0
Y0
X0
Xf
Zf
a) Orientacin inicial
Figura 11.8
b) Orientacin final
www.FreeLibros.me
294
CAPTULO
11 Planeacin de movimientos
OP
PP
Q
LM 2 /3
Q M 2/3
MN-1/ 3
-1/ 3 2 /3
2 / 3 1/ 3
2/ 3 2/3
Esta orientacin se muestra en la figura 11.9a). Entonces el problema queda resuelto por medio del mtodo de rotacin de eje doble. Los ngulos de Euler para la
orientacin inicial y final son [f0, q0, y0] T = [0, 0,0]T, y [ff, qf, yf]T = [0, 90, 90]T.
Por lo tanto, la trayectoria se determina por
Q(e, q) Q(k, y + f), 0 t 1
donde
q = y + f = 900t 3 1.350t 4 + 540t 5
La matriz de rotacin Q para la orientacin intermedia en el tiempo t = 0.5 para
este caso se calcula segn e [0, 1, 0]T y q = y + f = 45 a t = 0.5 como
LM 1/ 2
Q = M 0
MN- 1/ 2
OP LM1/ 2
0 P M1/ 2
1/ 2 P M 0
QN
0 1/ 2
- 1/ 2
1/ 2
OP LM 1/ 2
0P = M1/ 2
1P M - 1/ 2
Q N
OP
0 P
1/ 2 P
Q
- 1/ 2 1/ 2
1/ 2
1/ 2
Zo
q
Z
y+j
e k
e
Yo
Xo
Yo
Xo
X
a) Rotacin de eje sencillo
Figura 11.9
www.FreeLibros.me
11.3
295
eje doble es un poco ms complejo que el mtodo de rotacin de un solo eje, es ms fcil de
entender el cambio del vector de aproximacin.
11.3
Si se considera que x es el vector de las variables de espacio operacional que expresa la posicin y orientacin del efector final del manipulador, generar una trayectoria en el espacio
operacional representa determinar una funcin x(t), tomando el sistema del efector final
desde la ubicacin inicial hasta la final en un tiempo t a lo largo de una ruta determinada
con una ley especfica de tiempo de movimiento. Para ello, primero que nada considere la
posicin del sistema del efector final. Por consecuencia, la orientacin se dar.
11.3.1
Rutas primitivas
296
CAPTULO
11 Planeacin de movimientos
pi
pf
n
Figura 11.10
Ejemplo 11.4
Ejemplo 11.5
Crculo en el espacio
www.FreeLibros.me
11.3
297
Z9
r
X9
pi
c
O9
Y9
Figura 11.11
Mediante estos parmetros puede encontrarse el vector posicional c del centro del
crculo. Si c = pi d, para que pi no sea el eje, es decir, para que el crculo no degenere
en un punto, debe ser | cTr | ||c||. En este caso es
d Tr)r
c = d + (d
(11.21)
Luego se desea encontrar una representacin paramtrica del crculo como funcin
de la coordenada de la ruta. Observe que esta representacin es muy simple para una
opcin conveniente del sistema de referencia. Para ver esto, considere el sistema de
referencia O-XYZ, donde O coincide con el centro del crculo, el eje X se orienta
a lo largo de la direccin del vector pi c; el eje Z se orienta a lo largo de r y el eje Y
se orienta de tal modo que completa un sistema derecho. Cuando se expresa en este
sistema de referencia, la representacin paramtrica del crculo es
LMr cos FG s IJ OP
MM H r K PP
F sI
p(s) = M
r sen G r J P
MM H K PP
MN 0 PQ
(11.22)
www.FreeLibros.me
(11.23a)
298
CAPTULO
11 Planeacin de movimientos
LM- sen FG s IJ OP
MM H r K PP d p
dp
F s I ; y ds
=Q M
ds
cos GH r JK P
MM
PP
MN 0 PQ
2
11.3.2
LM- 1 cos FG s IJ OP
MM r1 H r K PP
F I
=QM
- r sen G s J P
H rK P
MM
MN 0 PPQ
(11.24)
Posicin
Ejemplo 11.6
Considere el segmento del ejemplo 11.4 que conecta el punto pi con el punto p. La
representacin paramtrica de esta ruta se determina por la ecuacin (11.19). La
www.FreeLibros.me
11.3
299
velocidad y aceleracin de p puede calcularse fcilmente recordando la regla de diferenciacin de funciones compuestas, es decir,
s
s
(11.26)
=
d p = s t; y p
d p =
st
p =
dp
dp
donde el vector cp se define segn la ecuacin (11.19).
Ejemplo 11.7
LM- ssenFG s IJ OP
MM H r K PP
F sI ; y
p = Q M
MM scos GH r JK PPP
MN 0 PQ
LM- 1 s
MM r
= Q M 1
p
MM- r s
MN
FG IJ
F I OP
H KP
H K
F s I s FG s IJ PP
sen G r J + cos
H K
H rKP
PP
0
Q
s
s
cos r - s sen
r
(11.27)
11.3.3
Orientacin
Considere ahora la orientacin del efector final. Normalmente esto se especifica en trminos
de la matriz de rotacin del sistema de referencia del efector final (con variacin del tiempo)
respecto al sistema de referencia de base. Como bien se sabe, las tres columnas de la matriz
de rotacin representan los tres vectores unitarios del sistema de referencia del efector final
(n, s, a) expresados en el sistema de referencia de base. Para generar una trayectoria, sin
embargo, no es conveniente referirse a la matriz de rotacin para caracterizar la orientacin.
Por ejemplo, una interpolacin lineal sobre los vectores unitarios n, s, a que describen la
orientacin inicial y final no garantiza la ortonormalidad de los vectores mencionados en
cada instante de tiempo. En vista de la dificultad mencionada, la orientacin se describe
para propsitos de generacin de las trayectorias en trminos del ngulo triple e [f, q, y]T;
es decir, los ngulos de Euler ZYZ, para los cuales puede especificarse una ley de tiempo.
Usualmente, f se mueve a lo largo del segmento que conecta su valor inicial ei a su valor final
e. En este caso, tambin es conveniente elegir un polinomio cbico o un segmento lineal
con la ley de tiempo de combinaciones parablicas. Para ei y e determinados, los perfiles
de posicin, velocidad y aceleracin son:
s
s
(11.28)
= s d f
j = ji +
d f ; j =
df y j
df
df
df
www.FreeLibros.me
300
CAPTULO
11 Planeacin de movimientos
donde ce i ii, y la ley de tiempo para s tiene que especificarse. Los tres vectores unitarios
del sistema de referencia del efector final pueden calcularse con referencia a los ngulos
de Euler ZYZ como en la ecuacin (5.31e), la velocidad angular del sistema de referencia
del efector final como en la ecuacin (6.39) y la aceleracin angular mediante la diferenciacin de la propia ecuacin (6.39). Una forma alternativa para generar una trayectoria para la
orientacin de una interpretacin ms clara en el espacio cartesiano puede derivarse cuando
se recurre al mtodo del eje equivalente de rotacin que se present en la seccin 11.2.
Determinados dos sistemas de coordenadas en el espacio cartesiano con el mismo origen y
diferente orientacin, siempre es posible determinar un vector unitario e, de tal modo que
el segundo sistema puede obtenerse a partir del primer sistema mediante la rotacin de la
magnitud a alrededor del eje de este vector unitario. Si Qi y Q denotan, respectivamente,
las matrices de rotacin del sistema de referencia inicial Oi-XiYiZi y el sistema final Of-XfYfZf,
ambos respecto al sistema de referencia base, la matriz de rotacin entre las dos sistemas
puede calcularse si se recuerda que Q = Qi Q, la ecuacin (5.19), permite escribir
LMq
Q = Mq
MNq
11
Q=
Q Ti
21
31
q12
q22
q32
q13
q23
q33
OP
PP
Q
~
~
se define para describir la transicin de Q a Q , debe ser Q
Si la matriz Q
(0) = 1 y Q (tf) =
i
FG q
H
11
IJ
K
+ q 22 + q 33 - 1
1
,y e=
2 sena
2
LMq
MMq
Nq
32
13
21
- q23
- q31
- q12
OP
PP
Q
(11.29)
~
para sen a 0. La matriz Q puede interpretarse como una matriz Q(a) y puede calcularse
mediante la ecuacin (11.14). Luego es suficiente asignar una ley de tiempo a a, del tipo de
las que se presentan para la articulacin sencilla con a(0) = 0 y a(t) = a, y el clculo de los
componentes ex, ey, ez del vector unitario del eje fijo segn la ecuacin (11.29). Por ende,
~
Q = Qi Q(a )
representa la matriz de rotacin que describe la orientacin del efector final como una funcin de tiempo respecto al sistema de referencia base. Una vez que se hayan especificado
~
una ruta y una trayectoria en el espacio operacional en trminos de p y e o Q , pueden usarse
tcnicas de cinemtica inversa para encontrar las trayectorias correspondientes en el espacio
articular p.
11.4
En el movimiento de punto a punto, el manipulador tiene que moverse desde la configuracin articular inicial hasta la final dentro de un tiempo determinado t. En este caso, la
www.FreeLibros.me
11.4
301
ruta real del efector final no es importante. El algoritmo deber generar una trayectoria que, respecto a los
Aplicacin de
movimiento PTP
requerimientos generales mencionados, tambin ser
capaz de optimizar algn ndice de desempeo cuando Aquella donde se requieren operaciose mueve la articulacin de una posicin a otra. Una
nes de recoger y colocar, por ejemplo,
sugerencia para la seleccin de la primitiva de movi- tomar una pieza de trabajo de una
miento podr derivarse del anlisis de un problema de banda transportadora y colocarla sobre una mesa de maquinado para su
movimiento incremental. Si I es el momento de inercia
procesamiento.
para un cuerpo rgido alrededor de su eje de rotacin,
se requiere tomar el ngulo desde un valor inicial qi hasta un valor final q en el tiempo t.
Es obvio que existen soluciones infinitas para este problema. Suponiendo que la rotacin se
ejecute mediante un par de torsin proporcionado por un motor, puede encontrarse una solucin que minimiza la energa disipada por el motor. Este problema de optimizacin puede
formalizarse como sigue: colocar q = w determina la solucin para la ecuacin diferencial
I w = t
sujeta a la condicin
(11.30a)
tf
w (t)dt = q f q i
(11.30b)
tf
t 2(t)dt
(11.30c)
( 11.30d)
Aunque la dinmica de articulaciones o articular no puede describirse de la manera simple mencionada, la eleccin de una funcin polinomial de tercer orden para generar una
trayectoria de articulacin representa una solucin vlida para el problema en estudio. Por
lo tanto, a fin de determinar un movimiento de articulacin, puede elegirse el polinomio
cbico
q(t) = a 3 t 3 + a2 t 2 + a1t + a0
( 11.31a)
que da como resultado perfiles de velocidad parablica y aceleracin lineal, a saber,
( 11.31b)
Puesto que cuatro coeficientes estn disponibles, es posible imponer, aparte de los valores
de posicin de articulacin inicial y final qi y q, tambin los valores de velocidad de arti
( 11.31c)
que permite calcular el resultado de los coeficientes del polinomio en una ecuacin (11.31a).
La figura 11.12 ilustra la ley de tiempo obtenida por medio de los siguientes datos: qi = 0,
www.FreeLibros.me
CAPTULO
11 Planeacin de movimientos
Rad
2
1
0
0.2
0.4
0.6
seg
0.8
a) Posicin
5
4
Rad/s
3
2
1
0
0
0.2
0.4
0.6
0.8
seg
b) Velocidad
0.2
0.4
0.6
0.8
seg
c) Aceleracin
20
10
Rad/s
302
0
10
20
Figura 11.12
www.FreeLibros.me
11.4
303
tc
tf tc
tc
tf tc
tf
b) Velocidad
..
..
c
tf tc
O
tf
a) Posicin
.
c
tm
tc
tf
t
..
c
c) Aceleracin
Figura 11.13
www.FreeLibros.me
304
CAPTULO
11 Planeacin de movimientos
la transicin de qi a qf en el tiempo tf. La velocidad al final del segmento parablico debe ser
igual a la velocidad (constante) del segmento lineal, es decir,
q - qc
q c tc = m
t m - tc
(11.32a)
donde qc es el valor alcanzado por la variable articular al final del segmento parablico al
tiempo tc con la aceleracin constante qc (observe que q (0) = 0). Es entonces
qc = q i +
1 2
q t
2 c c
(11.32b)
qc t 2c qc tf tc + qf q i = 0
(11.32c)
tf
1
2
t 2f q c - 4(q f - q i )
q
(11.33)
4 |q f - q i |
t 2f
(11.34)
Cuando la aceleracin qc se elige de tal modo que cumple con la ecuacin (11.34) con el
signo de igualdad, la trayectoria resultante ya no ostenta el segmento de velocidad constante
y solamente tiene los segmentos de aceleracin y desaceleracin (perfil triangular). Determinados qi, qf y tf, y por ende tambin una velocidad de transicin promedio, la ecuacin (11.34)
permite la imposicin de un valor de aceleracin consistente con la trayectoria. Luego tc se
calcula segn la ecuacin (11.33) y se genera la siguiente secuencia de polinomios:
R|q
|
q(t) = Sq
||q
T
1 2
q t
0 t tc
2 c
i + q c t c ( t - t c / 2) t c t t f - t c
1
2
t f - tc t t f
f + q c (t f - t )
2
i
(11.35)
www.FreeLibros.me
(11.36)
11.4
305
Rad
3
2
1
0
0.2
0.4
0.6
Seg
0.8
0.6
0.8
Seg
b) Velocidad
a) Posicin
5
4
Rad/s
3
2
1
0
0
0.2
0.4
0.2
0.4
10
Rad/s
20
10
20
0.6
Seg
0.8
c) Aceleracin
Figura 11.14
www.FreeLibros.me
306
CAPTULO
11 Planeacin de movimientos
q i - q f + q c t f
q
(11.37)
q c =
q 2c
q i - q f + q c t f
(11.38)
11.5
11.5
307
Estos inconvenientes pueden superarse si se considera un nmero adecuado de polinomios de interpolacin de bajo orden, continuos en los puntos de ruta, en lugar de un solo
polinomio de orden alto. De acuerdo con la seccin anterior, el polinomio de interpolacin
del orden ms bajo es el polinomio cbico, puesto que permite imponer la continuidad de
velocidades en los puntos de ruta. En la variable de una articulacin sencilla, se busca una
funcin q(t), formada por una secuencia de N 1 polinomios cbicos qk(t), para k = 1, . . .,
N 1, continuo con las primeras derivadas. La funcin q(t) alcanza los valores qk para t =
tk(k = 1, . . ., N), y q1 = q0 en t1 = 0; y qN = qf en tN = tf; los qk representan los puntos de ruta
que describen la trayectoria deseada en t = tk, como se muestra en la figura 11.15. Pueden
considerarse las siguientes situaciones:
Los valores de q (t) en los puntos de ruta se asignan de acuerdo con ciertos criterios.
La aceleracin q (t) ser continua en los puntos de ruta.
Para simplificar el problema, tambin es posible encontrar polinomios de interpolacin
de un orden menor de tres que determinan trayectorias que pasan junto a los puntos de ruta
en los instantes determinados de tiempo.
11.5.1
Esta solucin requiere que el usuario sea capaz de especificar la velocidad deseada en cada
punto de la ruta; la solucin no tiene ninguna novedad respecto a los conceptos que se
mencionan arriba. El sistema de ecuaciones que permite el clculo del coeficiente de los
N 1 polinomios cbicos que interpola los N puntos se obtiene mediante la imposicin de
las siguientes condiciones sobre el polinomio genrico rk(t), interpolando qk y qk+1 para
k = 1, , N 1:
r k (tk) = q k; r k (tk +1) = q k +1; rk (tk) = q k ; rk (tk +1) = q k +1
(11.39)
El resultado es N 1 sistemas de cuatro ecuaciones en los cuatro coeficientes desconocidos del polinomio genrico; stos pueden resolverse uno independiente del otro. Las
q
q2
r2
r1
q3 r
3
rN1
qN = qf
q1 = qi
t1 = 0
Figura 11.15
t2
t3
tN = tf
www.FreeLibros.me
308
CAPTULO
11 Planeacin de movimientos
11.5.2
En este caso, tiene que computarse la velocidad de la articulacin en una ruta, de acuerdo con
ciertos criterios. Mediante la interpolacin de los puntos de la ruta con segmentos lineales,
pueden calcularse las velocidades relativas conforme a las siguientes reglas:
q = 0
1
q k =
R|0
S| 1 (v
T2
sgn (v k ) sgn (v k + 1)
k
+ v k + 1) sgn (v k ) sgn (v k + 1)
(11.41)
q N = 0
11.5.3
11.5
Rad
6
4
2
0
Seg
a) Posicin
Rad/s
2
Seg
b) Velocidad
Rad/s2
20
0
20
40
0
2
Seg
c) Aceleracin
Figura 11.16
www.FreeLibros.me
309
CAPTULO
11 Planeacin de movimientos
Rad
6
4
2
0
0
Seg
a) Posicin
Rad/s
Seg
b) Velocidad
30
20
10
Rad/s2
310
0
10
20
30
0
Seg
c) Aceleracin
Figura 11.17
www.FreeLibros.me
11.5
311
y seis ecuaciones para los puntos externos; las restricciones de posicin para los polinomios
r 0(t1) = qi y rN (tf) = qf no deben contarse como polinomios, ya que simplemente son los
valores impuestos de las velocidades y aceleraciones iniciales y finales. En suma, se tienen
4N 2 ecuaciones en 4(N 1) incgnitas. Slo puede resolverse el sistema si se eliminan las
dos ecuaciones que permiten la asignacin arbitraria de los valores de aceleracin inicial y final. Debern usarse polinomios del cuarto orden para incluir esta posibilidad para el primero
y ltimo segmentos. Por otro lado, si solamente se han de usar polinomios del tercer orden,
puede realizarse el siguiente engao. Se introducen dos puntos virtuales para los cuales pueden imponerse restricciones de continuidad sobre posicin, velocidad y aceleracin, aunque
sin especificar las posiciones reales. Cabe sealar que la ubicacin efectiva de estos puntos es
relevante, pues sus restricciones de posicin se refieren nicamente a la continuidad. Por lo
tanto, la introduccin de dos puntos virtuales implica la determinacin de N + 1 polinomios
cbicos. Considere N + 2 instantes de tiempo tk, donde t2 y tN+1 convencionalmente se refieren
a los puntos virtuales. El sistema de ecuaciones para determinar los N + 1 polinomios cbicos
puede encontrarse si se toman las 4(N 2) ecuaciones:
r k1 (tk) = q k (tk )
rk1 (tk) = qk; r k1(tk) = q k (tk); r k 1(tk) = q k (tk); y
(11.43)
(11.44a)
(11.44b)
(11.45)
para k = 2, N + 1, escritas para los dos puntos virtuales. El sistema resultante tiene 4(N + 1)
ecuaciones en 4(N + 1) desconocidas, que son los coeficientes de los N + 1 polinomios cbicos. La solucin para el sistema es computacionalmente demandante, incluso para valores
bajos de N. No obstante, el problema puede proyectarse en forma conveniente con el fin de
resolver el sistema de ecuaciones resultante mediante un algoritmo computacionalmente
eficiente. Puesto que el polinomio genrico rk(t) es cbico, su segunda derivada debe ser
una funcin lineal de tiempo que luego puede escribirse como
r k (t) =
r k (t k +1)
r k (t k )
(tk+1 t) +
(t tk) k = 1,, N + 1
Dt k
Dt k
(11.46)
donde tk = tk+1 tk indica el intervalo por alcanzar qk+1 a partir de qk. Mediante la doble integracin de la ecuacin (11.46) a travs del tiempo, puede escribirse el polinomio genrico
como
r k (t) =
r k (t k +1)
k (t k )
r
(tk+1 t) 3 +
(t tk) 3 +
6Dt k
6Dt k
FG r (t ) - Dt r (t ) IJ (t
6
H Dt
K
k
k+1
F r (t
GH Dt
k
k + 1)
k
t)
www.FreeLibros.me
r k (t k +1)
Dt k
6
I (t t )
JK
k
(11.47)
312
CAPTULO
11 Planeacin de movimientos
para k = 1, , N + 1 que depende de las 4 incgnitas r k (tk), r k (tk+1), rk (tk) y rk (tk+1). Observe que las N variables qk para k 2, N + 1 se determinan mediante la ecuacin (11.39),
mientras se impone continuidad para q2 y qN+1 por medio de la ecuacin (11.42). Usando
las ecuaciones (11.42) y (11.44), se reducen las incgnitas en N + 1 ecuacin (11.47) a 2(N
+ 2). Por medio de la observacin de que la ecuacin (11.44) depende de q2 y qN+1 y que
qi y qf se determinan, q2 y qN+1 pueden computarse como una funcin de r1(t1) y rN+1(tN+2),
respectivamente. Por lo tanto, queda un nmero de 2(N + 1) incgnitas. Tomando en cuenta
las ecuaciones (11.42) y (11.45) y sin tomar en cuenta que en la ecuacin (11.44) qi y qf se
determinan, las incgnitasse reducen a N. En este punto pueden utilizarse las ecuaciones
(11.42) y (11.45) para escribir el sistema de N ecuaciones en N incgnitas:
r 1 (t2) = r 2 (t2);; r N (tN +1) = r N+1 (tN+1)
(11.48)
La diferenciacin del tiempo de la ecuacin (11.47) da tanto rk(tk+1) como rk+1(tk+1) para
k = 1, , N y, por lo tanto, es posible escribir un sistema de ecuaciones lineales del tipo
2 (t2)
A[ r
r N+1(tN+1)] T = b
(11.49)
LMa
MMa
A=
MM 0
MN 0
11
21
a12
a23
0
0
0
0
0
0
a N -1, N -1 a N -1, N
a N , N -1
a NN
OP
PP
PP
PQ
(11.50)
que simplifica la solucin para el sistema. Esta matriz es la misma para todas las articulaciones, ya que depende solamente de los intervalos tk especificados. Existe un eficiente algoritmo de solucin para el mencionado sistema, que se determina por un clculo directo seguido
por un clculo inverso. Segn la primera ecuacin, r2(t2) puede calcularse como funcin de
r3(t3) y luego se sustituye en la segunda ecuacin que entonces se vuelve una ecuacin de
las incgnitas r3(t3) y r4(t4). Esto se realiza en forma directa mediante la transformacin de
todas las ecuaciones a ecuaciones con dos incgnitas, excepto la ltima que tendr a rN+1(tN+1)
como nica incgnita. En este punto pueden determinarse todas las incgnitas paso a paso
por medio de un clculo inverso. La secuencia arriba mencionada de polinomios cbicos
se llama spline para indicar las funciones continuas que interpolan una secuencia de puntos
determinados, asegurando la continuidad de la funcin y sus derivadas.
La figura 11.18 ilustra el historial de tiempo de posicin, velocidad y aceleracin obtenido mediante los datos q1 = 0, q3 = 2p, q4 = p/2, q6 = p, t1 = 0, t3 = 2, t4 = 3, t6 = 5, q1 y q6 = 0.
Dos diferentes pares de puntos virtuales fueron considerados en los instantes de tiempo: t2 =
0.5, t5 = 4.5 (la lnea continua en la figura) y t2 = 1.5, t5 = 3.5 (la lnea punteada en la figura),
respectivamente. Observe el perfil de velocidad parablica y el perfil de aceleracin lineal.
Adems, para el segundo par, se obtienen valores de aceleracin ms grandes, ya que los
instantes de tiempo relativos son ms cercanos a los dos puntos intermedios.
www.FreeLibros.me
11.5
Rad
6
4
2
0
Seg
a) Posicin
Rad/s
Seg
b) Velocidad
30
20
Rad/s2
10
0
10
20
30
0
Seg
c) Aceleracin
Figura 11.18
www.FreeLibros.me
313
314
CAPTULO
11 Planeacin de movimientos
RESUMEN
En este captulo se presentan varias tcnicas de planeacin de movimientos. Tambin se
analizan trayectorias del espacio articulares y del espacio cartesiano que pueden seguirse
por los actuadores articulares y por el efector final, respectivamente. Aparte de las operaciones de levantar y colocar, tambin se presenta la planeacin de movimiento continuo
en aplicaciones como la soldadura o el evitar obstculos.
EJERCICIOS
11.1 Se desea que se mueva la primera articulacin de un robot de seis ejes desde la
posicin inicial q0 = 15 hasta la posicin final qf = 75 en 3 segundos usando un
polinomio cbico.
a)
b)
c)
d)
Determine la trayectoria.
Calcule el ngulo articular a 2 segundos.
Comente acerca de sus velocidades y aceleraciones del punto final.
Compare el resultado presente con los que se obtuvieron en el ejemplo 11.1.
11.2 Repita el problema del ejercicio 11.1, pero esta vez con la aceleracin inicial y la
desaceleracin final especificados como 5/s2.
11.3 Un robot planar de dos grados de libertad debe seguir una lnea recta entre los
puntos de inicio (3.10) cm y final (8.15) cm del segmento de movimiento. Busque
la variable de articulacin para el robot si la ruta se divide en 5 segmentos. Suponga
que cada eslabn tiene una longitud de 10 cm.
11.4 Busque los coeficientes de dos polinomios cbicos que estn conectados en un
spline de dos segmentos con aceleracin continua en los puntos de va intermedios.
11.5 Una sola trayectoria cbica se determina por
q(t) = 10 + 90t 2 60t 3
que se utiliza entre t = 0 y 1 seg. Cules son las posiciones, velocidades y aceleraciones iniciales y finales?
11.6 Busque los coeficientes de un polinomio cbico
q(t) = a0 + a1t + a2 t 2 + a3 t3
cuando q(0), q (0), q (0), y q(tf) se especifican.
11.7 Una articulacin giratoria se mueve desde 150 hasta +450 en 4 segundos. Determine una trayectoria polinmica continua si las velocidades y aceleraciones
iniciales y finales son cero. Cul es el orden del polinomio?
11.8 Para un manipulador de 3 grados de libertad, disee una combinacin con una
trayectoria lineal y con una trayectoria parablica. La orientacin inicial y final
www.FreeLibros.me
315
LM0
Q M1
MN0
i
OP
PP
Q
LM
MM
N
1 0
0 0 0
0 0 y Qf 1 -1 0
0 -1
0 0 1
OP
PP
Q
11.9 El perfil de velocidad de una trayectoria es trapezoidal con un segmento de aceleracin constante para 0.5 segundos y una velocidad constante de 10/seg. Determine
los parmetros de la trayectoria continua para interpolar la secuencia de tiempo de
la posicin con este tipo de trayectoria.
www.FreeLibros.me
Captulo
12
Computadoras
para robots
12.1
Velocidad de computacin
Existe un nmero de algoritmos para controlar los diferentes aspectos de los movimientos
de un robot, para los cuales se demostrar cmo pueden ejecutarse los clculos complejos
en estos algoritmos dentro de un tiempo corto. Tambin se presentarn maneras de organizar
el software y el hardware para cumplir con los objetivos.
12.1.1
Agilizacin de software
www.FreeLibros.me
12.1
Velocidad de computacin
317
En los sistemas de
computacin comercial, las funciones trigonomtricas se evalan por medio de varias tcnicas, incluidas funciones racionales o polinomios de Chebychev. La aritmtica involucrada
se hace usualmente con punto flotante, lo que resulta en alta precisin y baja velocidad. En
aplicaciones robticas, sin embargo, el mecanismo ms apropiado para computar funciones
trigonomtricas es mediante la consulta de tablas. Por ejemplo, los valores de sen q se guardan simplemente en una tabla para q = 0 89 grados. Esta tabla de 90 palabras proporciona
al instante el valor del seno de un ngulo con una precisin de 1. De hecho, las 90 palabras
requieren de menos memoria que la que necesita un programa para computar la funcin en
forma explcita. Si se requiere una precisin ms alta que el grado ms cercano, existen dos
opciones. La primera es la interpolacin lineal entre las entradas de la tabla. Puesto que las
funciones de seno y coseno son bastante lineales entre intervalos de 1, la interpolacin rinde
excelentes resultados. Otra tcnica de interpolacin hace uso de la identidad trigonomtrica
para el seno de dos ngulos sumados, es decir,
(12.1)
sen (a + b) = sen a cos b + cos a sen b
El ngulo se segmenta en dos partes, un nmero entero a y una fraccin b. Luego se
aplica la ecuacin (12.1). La evaluacin exacta de la ecuacin (12.1) requiere despus cuatro
consultas de tabla para los valores de sen , cos b, cos y sen b, dos multiplicaciones y
una suma. Una evaluacin aproximada puede obtenerse an ms rpido. Para ello, el ngulo
se escala de tal manera que la parte fraccionaria es muy pequea. Supongamos que b es la
parte fraccionaria, entonces
(12.2)
cos b = 1, y sen b = b
Esto queda numricamente ilustrado en el siguiente ejemplo.
Ejemplo 12.1
Suponga que los valores de la funcin de seno son tabulados en incrementos de 0.01
rad, es decir, que los valores de sen (0.80) y sen (0.81), etc., son conocidos, entonces
puede escribirse
(12.3a)
0.8034 rad = 0.8 rad + 0.0034 rad
www.FreeLibros.me
318
CAPTULO
12
12.1.2
Consideraciones de hardware
12.1
Velocidad de computacin
319
Este proceso normalmente requerira aproximadamente 5 a 10 s en cualquier computadora. Si la velocidad del procesador se toma como 5 s y tienen que controlarse seis articulaciones con mxima velocidad, entonces tan slo para mantenerse al tanto de las posiciones
se requerira 5 6 = 30 s, es decir, 30% de los recursos de la computadora.
(12.5)
donde s es el vector de los pares de torsin deseados, y pd y p son los ngulos deseado y real
de la articulacin, respectivamente, mientras que es la velocidad real de la articulacin.
Adems, los trminos Kp y Kv son las matrices de las ganancias proporcional y derivativa,
respectivamente. El programa para implementar este tipo de clculo es
LOAD qd
LOAD q
SUBTRACT
MULTIPLY (pd p) BY Kp
LOAD p
MULTIPLY p BY Kv
SUBTRACT
OUTPUT
RETURN
-3
= 45 10 3
320
CAPTULO
12
LSI-11
mp
mp
mp
Articulacin 1 Articulacin 2
mp
mp
Figura 12.1
12.2
mp
Arquitectura PUMA
Requerimientos de hardware
www.FreeLibros.me
12.2
Articulacin
321
9511
9511
9900
9900
Articulacin
9511
Articulacin
MEMORIA
GLOBAL
9511
Articulacin
Requerimientos de hardware
9900
9900
9900
9511
9900
Articulacin
9511
Articulacin
USUARIO
Figura 12.2
te completa de 32 bits y se disea para una fcil interfaz con el microprocesador de 8 bits.
El Intel 8087 ofrece una aritmtica de alta velocidad y acoplamiento directo al bus 8086.
Empresas como TRW y AMD anuncian chips multiplicadores que realizan multiplicaciones
de nmeros enteros de 16 bits en tan slo unos nanosegundos.
La tecnologa de punta cambia tan rpidamente que es una posibilidad real pensar en
chips para transformacin de coordenadas y un chip que compute el jacobiano e incluso el
jacobiano inverso en tiempo real. Estos chips tienen las siguientes caractersticas:
i) Clculos rpidos y repetitivos (normalmente aquellos que no requieren ramas condicionales).
Articulacin
Servoprocesador
9511
9511
9900
9900
Memoria
global
9511
Articulacin
Servoprocesador
9900
9900
Servoprocesador
Articulacin Usuario
Figura 12.3
9900
Articulacin
Servoprocesador
Articulacin
9900
9511
9511
Servoprocesador
9511
Servoprocesador
Articulacin
www.FreeLibros.me
322
CAPTULO
12
12.3
Consideraciones de control
El sistema de control para supervisar las actividades de un sistema robtico deber ser dotado de un nmero de herramientas que ofrecen las siguientes funciones:
Una implementacin efectiva de estas funciones puede obtenerse por medio de una arquitectura funcional, considerando sta como la supervisin de varios niveles de actividad
dispuestos en una estructura jerrquica. Quiz la mejor manera de entender el trmino
jerrquico es mediante la estructura de mando militar, en la que los generales pasan rdenes
a los oficiales, los cuales pasan rdenes a los sargentos quienes pasan rdenes a las tropas.
En este tipo de jerarqua, se supone que el control fluye desde arriba hacia abajo, y los reportes supuestamente fluyen desde abajo hacia arriba. Los niveles bajos de la estructura
estn orientados para la ejecucin de movimientos fsicos, mientras que los niveles ms
altos estn orientados hacia la planeacin lgica de acciones. Los niveles estn conectados
por el flujo de datos; aqullos dirigidos hacia los niveles ms altos se refieren a mediciones
o resultados de acciones, mientras que los que estn dirigidos hacia los niveles ms bajos se
enfocan en la transmisin de directrices.
En cuanto a las funciones del sistema de control que implementan el manejo de las
actividades de sistema que se enumeraron arriba, en general, conviene asignar tres modelos funcionales a cada nivel. El primer mdulo se dedica a la gestin de datos sensoriales
(mdulo sensorial). El segundo se dedica a proporcionar informacin relevante del entorno
(mdulo de modelado). El tercer mdulo se dedica a decidir la poltica de la accin (mdulo
de decisin). De manera ms especfica, los mdulos sensoriales adquieren, elaboran, correlacionan e integran datos sensoriales en tiempo y espacio, con el fin de reconocer y medir los
datos del sistema y las caractersticas del ambiente. Queda claro que las funciones de cada
mdulo estn orientadas al manejo de los datos sensoriales relevantes de su nivel. Por otro
lado, los mdulos de modelado contienen modelos derivados con base en conocimientos a
priori del sistema y el ambiente. Estos modelos se actualizan mediante la informacin que
proviene de los mdulos sensoriales, mientras que la activacin de las funciones requeridas
se encarga a los mdulos de decisin. Finalmente, los mdulos de decisin realizan la descomposicin de tareas de alto nivel en acciones de nivel bajo. Esta descomposicin de tareas
tiene que ver tanto con la descomposicin en tiempo de acciones secuenciales como con
la descomposicin en el espacio de acciones simultneas. Cada mdulo de decisin queda
encargado de las funciones referentes a la gestin de asignaciones de accin elemental, a la
www.FreeLibros.me
12.3
Consideraciones de control
323
324
CAPTULO
12
Mdulo
de programa
Mdulo
de ubicacin
Prepara la tabla
de descripcin
de tareas
Prepara la tabla
de ubicacin
Interfaz de comandos
de descripcin de tareas
al sistema de control
Mdulo
de control
Valores de
ubicacin de
otras bases de
datos
Interfaz de
datos de ubicacin
al sistema de control
Figura 12.4
Procesamiento
sensorial de
alto nivel
Subtarea
Procesamiento
sensorial de
nivel mediano
Movimiento
elemental
Procesamiento
sensorial de
bajo nivel
Primitiva
Retroalimentacin
de descripcin
cartesiana
Transformacin
Retroalimentacin
de posicin de
articulacin
Figura 12.5
Servo
Descomposicin jerrquica
www.FreeLibros.me
12.4
Datos sensoriales, de
error y estatus a niveles
ms altos
Conjunto de
algoritmos para
procesar datos de
retroalimentacin
sensorial
Programacin de robots
325
Comando de entrada
Datos sensoriales, de
error y de estatus de niveles
inferiores
Figura 12.6
Conjunto de
algoritmos
para generar
salidas del
sistema
de control
Comando de
salida
el algoritmo de control podr variar de un robot a otro. Esto se observa en los dos niveles
inferiores de la figura 12.5. El nivel ms bajo compara puntos de referencia (proporcionados
por el nivel siguiente) con posiciones de la articulacin (proporcionadas por sensores) y
mueve la articulacin para reducir el error. El siguiente nivel computa las transformaciones
cinemticas y proporciona estos puntos de referencia al nivel ms bajo. En la figura 12.5
puede observarse que en realidad hay dos jerarquas involucradas: una de control desde arriba
hacia abajo y otra de estatus desde abajo hacia arriba. La figura 12.6 muestra esto en forma
ms clara porque detalla un solo nivel en la estructura. Puesto que cada nivel en la jerarqua
se define bien, funcionalmente, la tarea de control del robot puede dividirse en mdulos de
procesamiento en los que cada mdulo tiene entradas y salidas bien definidas y, por ende,
puede asociarse con un elemento de procesamiento independiente.
12.4
Programacin de robots
326
CAPTULO
12
particular de movimientos y otras acciones que tengan que ejecutarse con el fin de lograr su
tarea. Hay varias maneras de programacin de robots industriales, a saber, online y offline.
12.4.1
Programacin online
Ventajas
Fcil acceso
En concordancia con la posicin real de equipo y piezas
Sencillez de programacin, as que incluso un operario prcticamente sin capacitacin puede realizarla
Desventajas
En la programacin online, los usuarios mueven al propio robot a cada punto de avance
por medio de algn tipo de dispositivo en el espacio de trabajo real. En la prctica, la programacin online es la que se utiliza, por mucho, con ms frecuencia. En la programacin online
se coloca una pieza real en el espacio de trabajo, exactamente como en la produccin, y la programacin se
Online
basa en ensear al robot las trayectorias que tenga que
seguir. Esta enseanza se lleva a cabo guiando el braOnline signica que los robots estn
zo del robot a travs de una serie de movimientos y
en lnea con otras mquinas cuando
grabando estos movimientos, para que posteriormente
se escriben los programas en sus conpuedan repetirse en forma automtica. Durante este
troladores.
proceso, el brazo puede propulsarse en forma manual
(es decir, el operario usa sus msculos para cambiar el brazo de una posicin a otra) o por sus
accionamientos (es decir, el operario utiliza las palancas de mando, el teclado de un dispositivo porttil de enseanza o una rplica de tamao reducido del manipulador para ordenar los
accionamientos a las posiciones apropiadas). Independientemente de la manera de propulsar
el brazo durante el proceso , hay dos maneras de grabar la trayectoria de un movimiento del
brazo. En el mtodo PTP (Point to point, de punto a punto), el brazo se transfiere a cada punto
caracterstico de la trayectoria, se detiene all y, mediante un botn especial que hay en el
panel de control, se memoriza esta posicin en el sistema de control. Durante la reproduccin, el brazo del robot pasa a travs de estos puntos usando una forma de interpolacin entre
ellos. En el mtodo de CP (Continuous path, recorrido continuo), conforme se transfiere el
brazo, las posiciones se registran en forma automtica en intervalos constantes. Puesto que
los puntos estn muy cercanos entre s, no se necesitan rutinas especiales de interpolacin.
www.FreeLibros.me
12.4
Programacin de robots
327
328
CAPTULO
12
el usuario ejecuta los movimientos requeridos en forma manual, sosteniendo a la vez algn
dispositivo (el manipulador mismo o una rplica a escala) para registrar el recorrido.
12.4.2
La programacin ofine
Ofine
La programacin offline se lleva a cabo en una computadora y en modelos de la celda de trabajo con el robot,
en piezas de trabajo y en el ambiente. Los programas
del robot pueden crearse en la mayora de los casos
por la reutilizacin de datos CAD existentes, de tal
modo que la programacin ser rpida y efectiva. Las
ventajas y desventajas de la programacin offline son
las siguientes:
Ventajas
Desventajas
www.FreeLibros.me
12.4
Programacin de robots
329
la pintura por espray usando guas o patrones . La programacin de robots es significativamente distinta de la programacin tradicional de computadoras. Programar un sistema robtico
requiere la definicin de un ambiente de programacin sustentado en lenguajes apropiados, lo
que le permite al operario asignar las direcciones de tareas que el robot debe ejecutar. El ambiente de programacin se encarga no slo de revisar la ejecucin de la traduccin de instrucciones mediante un lenguaje adecuado, sino tambin de revisar la ejecucin correcta de una
tarea ejecutada por el robot. Por lo tanto, los ambientes de programacin de robots, aparte de
tener ms caractersticas en comn con los ambientes de la programacin de computadoras,
presentan un nmero importante de asuntos relacionados con la observacin que la ejecucin
de programas produce sobre el entorno fsico. En otras palabras, aun si existe una descripcin
muy exacta de la realidad fsica en el ambiente de programacin, ocurrir de manera inevitable un nmero de situaciones que no han sido ni pueden ser previstas. En consecuencia, un
ambiente de programacin de robots debe dotarse con las siguientes caractersticas:
Pueden identificarse varias consideraciones que deben manejarse por cualquier mtodo
de programacin de robots. Para ilustrarlas, considere los comandos de control de movimiento que se usan para dirigir el robot con el fin de que mueva su manipulador hacia una
posicin definida en el espacio. Por ejemplo, la instruccin mover P1 podra usarse para
dirigir el robot a un punto en el espacio llamado P1. Se emplean comandos de entrada/salida para controlar la recepcin de seales de sensores y otros dispositivos en la celda de
trabajo y para iniciar seales de control a otras piezas de equipo en la celda. Por ejemplo, la
instruccin seal 3 encendida podra usarse para encender un motor en la celda, donde el
motor se conecta con la lnea de salida 3 en el controlador del robot. Los objetos que van a
manipularse por un robot son tridimensionales y tienen una variedad de propiedades fsicas.
Los robots operan en un ambiente espacial complejo. La descripcin y representacin de
objetos tridimensionales en una computadora son imprecisas y la informacin sensorial
tiene que monitorearse, manipularse y utilizarse correctamente.
La programacin offline se basa en medios externos para expresar la tarea que el sistema
robtico tendr que realizar. La tarea se expresa en un lenguaje de programacin de robots
(Robot Programming Language RPL). Esto puede ser un lenguaje especficamente definido
para robots o un lenguaje de programacin de computadoras universal (CPL). Le ventaja de
usar RPL se asocia con hacer que el robot sea ms productivo, con la facilidad de utilizacin
de datos de sensores y con la creacin de la documentacin del programa. Para lograr que un
robot sea ms productivo, la fase en la que se requiere la programacin debe ser lo ms corta
posible. En otras palabras, la programacin de robots tiene que hacerse independiente del
robot. El programa se desarrolla offline, y solamente ms tarde se carga al sistema de control
www.FreeLibros.me
330
CAPTULO
12
para su ejecucin. El problema de este planteamiento es que, a pesar de que los robots que se
fabrican actualmente tienen una alta repetitividad, demuestran baja precisin. Esto requiere
la calibracin del programa que se crea offline.
Los planteamientos actuales para la programacin offline pueden clasificarse en dos
categoras principales: la programacin orientada al robot y la programacin orientada al
objeto o programacin basada en las tareas. En la programacin orientada al robot, se describe explcitamente una tarea de ensamble como una secuencia de movimientos del robot.
El robot se gua y controla por el programa a travs de toda la tarea, donde cada instruccin
del programa corresponde aproximadamente a una accin del robot. Por el otro lado, la
programacin basada en las tareas describe la tarea de ensamble como una secuencia de
metas posicionales de los objetos ms que los movimientos del robot que se necesitan para
alcanzar estas metas y, por lo tanto, no se especifica ningn movimiento explcito del robot.
Estos planteamientos se analizarn a continuacin.
editor de texto
estructuras complejas de representacin de datos
uso extenso de variables de estado predefinidas
ejecucin de operaciones de matriz algebraica
uso extensivo de representaciones simblicas para los sistemas de coordenadas
posibilidad de especificar el movimiento coordinado de ms sistemas coordenados
rgidamente unidos a objetos por medio de un solo sistema de coordenadas
inclusin de subrutinas con intercambio de datos y parmetros
uso de acondicionamiento lgico y puesta en secuencia por medio de banderas
capacidad de computacin paralela
funciones de un controlador lgico programable (PLC)
www.FreeLibros.me
12.4
Programacin de robots
331
Figura 12.7
Z
X
Ejemplo 12.2
AL:
base FRAME (nilrot, VECTOR (20, 0, 15)*inches);
beam FRAME (ROT(A, 90*deg), VECTOR (20, 15, 0)*inches);
feeder FRAME (nilrot, VECTOR (25, 20, 0)*inches);
Observe: nilrot es un sistema predefinido que tiene el valor ROT(Z, 0*deg). El smbolo es el operador de asignacin en AL. Un punto y coma termina una instruccin.
El smbolo * es un operador de multiplicacin dependiente del tipo. Aqu se utiliza
para adjuntar unidades a los elementos del vector.
ALM:
base = < < 20, 0, 15 >, EULERROT (< 0, 0, 0 >) >;
beam = < < 20, 15, 0 >, EULERROT (< 0, 0, 90 >) >;
feeder = < < 25, 20, 0 >, EULERROT (< 0, 0, 0 >) >;
Nota: EULERROT es una subrutina que forma la matriz de rotacin dados los ngulos.
www.FreeLibros.me
332
CAPTULO
12
Ejemplo 12.3
AL:
{Move are from rest to frame A and then to bold-grasp}
MOVE barm TO A;
MOVE barm TO bolt-grasp;
{Another way of specifying the above statement}
MOVE barm TO bolt-grasp VIA A;
{Move along the current Z axis by 1 inch, i.e., move relative}
MOVE barm TO - 1*Z*inches;
Notas: Refirase a la figura 12.7 para el punto A, eje Z, etc. Adems, barm es el nombre del brazo del robot. El smbolo indica la ubicacin actual del brazo que es
equivalente a base * T6 * E. Instrucciones entre claves {} son comentarios.
AML:
Move joint 1 and 4 to 10 inches and 20 degrees, respectively (absolute move)
MOVE (< 1, 4 >, <10, 20 >);
Move joints 1, 3 and 6 by 1 inch 2 inches, and 5 degrees, respectively (relative move)
DMOVE (<1, 3, 6 >, <1, 2, 5 >);
Un planteamiento completamente
diferente en la programacin de robots se hace mediante la programacin basada en las
tareas. La manera natural de describir una tarea de ensamble es en trminos de los objetos que van a manipularse en lugar de mediante los movimientos del robot. El lenguaje
basado en las tareas se aprovecha de este hecho y simplifica la tarea de programacin. Un
sistema de programacin basado en las tareas permite que el usuario describa la tarea en un
lenguaje de alto nivel (especificacin de tarea). Un planeador de tareas consultar entonces
una base de datos (modelos del entorno) y transformar la especificacin de la tarea en un
programa de nivel del robot que ejecutar la tarea (sntesis del programa del robot). Basndose en esta descripcin, puede conceptualmente dividirse la planeacin de tareas en tres fases:
modelado del entorno, especificacin de tareas y sntesis del programa. Cabe mencionar que
estas tres fases no son completamente independientes; de hecho, se relacionan computacionalmente. La figura 12.8 presenta una arquitectura posible para el planeador de tareas. La
especificacin de la tarea se descompone en una secuencia de subtareas por el fragmentador
de tareas y se extrae informacin tal como el estado inicial, estado final, posicin de agarre,
operando, especificaciones y relaciones de sujecin. Luego se pasan las subtareas a travs
del planeador de subtareas, que genera el programa de robot requerido. El concepto de planeacin de tareas es bastante parecido a la idea de la generacin automtica de programas
en la inteligencia artificial. El usuario provee los requerimientos de entrada/salida de un
programa deseado, y el generador de programas generar un programa que producir el
comportamiento deseado de entrada/salida.
www.FreeLibros.me
12.4
Programacin de robots
333
Tareas
Fragmentador
de tareas
Conocimiento
Planeador de subtareas
Modelo
Robot
Figura 12.8
Planeador de tareas
www.FreeLibros.me
334
CAPTULO
12.4.3
12
12.5
La arquitectura de hardware
La estructura jerrquica de la arquitectura funcional que se adopta como modelo de referencia para el sistema de control de un robot industrial, junto con su articulacin en diferentes
mdulos, sugiere una implementacin de hardware que explote recursos computacionales
distribuidos interconectados por medio de canales de comunicacin adecuados. Para este fin,
vale la pena recordar que las funciones implementadas en los sistemas de control actuales
toman en cuenta los tres niveles desde el servo hasta la accin, que normalmente limitan el
desarrollo de las funciones implementadas en el nivel de accin. En los niveles de servo y
www.FreeLibros.me
12.5
La arquitectura de hardware
335
Interfaz del operario por medio de dispositivo porttil de enseanza, teclado, video e
impresora
Interfaz con una memoria externa (disco duro) que se usa para almacenar datos y
programas de aplicacin
Interfaz con estaciones de trabajo y otros sistemas de control por medio de una red
local de comunicacin, por ejemplo, Ethernet
Memoria
externa
Dispositivo porttil
de enseanza
Impresora
Video
Teclado
Estacin
de trabajo
SISTEMA
Cinemtica
Dinmica
E/S
Bus
Fuerza
Servo
Visin
Amplificadores
de potencia
Transductores de
posicin y velocidad
Servomotores
Cmara
Monitor
Sensor
de fuerza
www.FreeLibros.me
336
CAPTULO
12
Interfaz de E/S con dispositivos perifricos en el rea de trabajo, por ejemplo, alimentadores, transportadores y sensores de ENC./APAG.
Secuencia de arranque del sistema
Intrprete del lenguaje de programacin
rbitro del bus
Las otras tarjetas que hay frente al bus podrn equiparse, aparte de los componentes
bsicos de la tarjeta del sistema, con un procesador complementario o alternativo (DSP,
transputadora) para la implementacin de funciones computacionalmente demandantes o
dedicadas. En la arquitectura de la figura 12.10, se implementan las siguientes funciones en
la tarjeta de cinemtica:
www.FreeLibros.me
337
muestreo comunes estn en el rango de 10-100 Hz. La tarjeta de visin tampoco requiere una
velocidad alta de actualizacin porque la escena es por lo general casi esttica y porque las
funciones interpretativas son normalmente complejas. Por lo regular, las frecuencias estn
en el rango de 1-10 Hz. En suma, el acceso de tarjetas al bus de comunicacin de la arquitectura de control del hardware podr realizarse de acuerdo con una lgica de velocidades
mltiples, lo que permite resolver problemas de saturacin de datos en el bus.
RESUMEN
En este captulo se explican los requerimientos de software y hardware para el control
de robots. Tambin se presentan las metodologas de programacin online y offline. Se
mencionan las ventajas y desventajas de ambos tipos de programacin.
EJERCICIOS
12.1 Cules son los requerimientos de hardware y software para un controlador de
robot?
12.2 Describe la programacin online.
12.3 Cules son las ventajas y desventajas de la programacin online?
12.4 Cules son los tipos de programacin online?
12.5 Cul es la diferencia entre la programacin dirigida y la paso a paso?
12.6 Cules son los tipos de programacin offline?
12.7 Cules son las caractersticas que deben tener los ambientes de la programacin
offline?
12.8 Cundo deber preferirse la programacin online frente a la programacin offline?
12.9 Qu es programacin por simulacin?
12.10 Por qu es difcil la programacin basada en las tareas?
12.11 Explique programa por simulacin.
12.12 Cules seran las limitaciones de programa por simulacin?
Apndice
A
Principios bsicos
matemticos
En este libro se supone que el lector se halla familiarizado con las definiciones matemticas
de las reas de lgebra lineal, trigonometra y otros campos relacionados. Algunas de ellas se
introducirn en este apndice para lograr que el lector entienda rpidamente las derivaciones
y notaciones que se usan en diferentes captulos de este libro.
A.1
La funcin Atan2
La funcin usual arco tangente inversa denotada por Atan(z), donde z = y/x, devuelve un
ngulo en el rango de (p/2, p/2). Con el fin de expresar el rango completo de ngulos, es
til definir la llamada funcin de arco-tangente de dos argumentos denotada por Atan2(y, x)
que devuelve el ngulo en el rango completo, es decir, (p, p). Esta funcin se define para
todos los (x, y) 0 y es igual al ngulo nico q, de tal manera que
cos q =
x
2
x +y
, y sen q =
y
2
x + y2
(A.1)
La funcin usa los signos de x y y para seleccionar el cuadrante adecuado para el ngulo
q, como se explica en la tabla A.1.
En la tabla A.1, z = y/x y Sgn(.) denotan el usual signo de la funcin de signo, es decir, su
valor es 1, 0 o 1, dependiendo de los valores positivo, cero y negativo de y, respectivamente.
Sin embargo, si tanto x como y son ceros, Atan2 queda indefinido. Entonces, mediante
www.FreeLibros.me
A.2
Tabla A.1
Vectores
339
Atan2(y, x)
+ve
0
ve
Atan(z)
Sgn(y) p/2
Atan(z) + Sgn(y)
la tabla Atan2(1, 1) = p/4 y Atan2(1, 1) = 3p/4, mientras que Atan(1) devuelve p/4 en
ambos casos.
A.2
Vectores
Mientras no se seale algo diferente, los vectores sern definidos como vectores de columna y denotados con letras minsculas en negrillas. Por ende, un vector a n-dimensional se
define como
LM a OP
a MP
MNa PQ
1
(A.2)
donde a1, , an son los elementos del vector a. El vector a tambin puede representarse
como
(A.3)
a [a1, , an]T
donde el superndice T denota transposicin. La magnitud, longitud o norma del vector a,
denotada con letras itlicas, se determina por
a =
A.2.1
aTa =
a12 + + an2
(A.4)
Vectores unitarios
Un vector unitario se define como un vector con magnitud igual a 1. Por tanto, el vector
unitario a lo largo del vector a, denotado con a, puede definirse como
a
(A.5)
a =
a
donde a se determina por la ecuacin (A.4). Por ende, la magnitud del vector unitario a es
a = 1. Ahora, si i, j y k denotan los vectores unitarios a lo largo de los ejes X, Y y Z, respectivamente, del sistema de coordenadas como se presenta en la figura A.1, cualquier vector
cartesiano tridimensional que se muestra en la figura A.1, por decir, a [a1, a2, a3]T, puede
expresarse como
a = a1 i + a2 j + a3 k
(A.6)
en la que los vectores unitarios i, j y k tienen las siguientes representaciones:
LM1OP LM0OP
LM0OP
i 0 ,j 1 ,y k 0
MM0PP MM0PP
MM1PP
NQ NQ
NQ
www.FreeLibros.me
(A.7)
340
APNDICE
A
a
k
a2
Y
Sistema de
coordenadas
a1
X
Figura A.1
Observe que en la ecuacin (A.6), las magnitudes de los vectores unitarios que usan las
ecuaciones (A.4) y (A.7) son uno.
A.2.2
A.2.3
Un producto vectorial o cruz entre dos vectores cartesianos, por decir, a y b, denotado por
c, se define como
www.FreeLibros.me
A.2
i
j
c = a b = a1 a2
b1 b2
vectores
k
a3 = (a2 b3 a3 b2)i + (a3 b1 a1 b3)j + (a1b2 a2b1)k
b3
341
(A.11a)
donde denota el smbolo para el producto cruz. El resultado del producto cruz es tambin
un vector, es decir, c, que es ortogonal a los dos vectores originales a y b. La magnitud del
vector c se denota como c y se determina por
c = ab sen q
(A.11b)
c
b
q
a
A.2.4
b c|
(A.12)
Una matriz de producto cruz siempre se asocia con un vector cartesiano tridimensional,
por decir, a, el cual, cuando se pre-multiplica por otro vector cartesiano tridimensional, por
ejemplo, b, da como resultado el producto cruz entre los dos vectores, como se muestra en
la subseccin A.2.3. Si a 1 denota la matriz de producto cruz asociada con el vector a,
entonces
(a 1)b = a b
(A.13a)
LM 0
a1 M a
MN- a
- a3
0
a1
OP
-a P
0 PQ
a2
(A.13b)
A.2.5
Diferenciacin de vectores
a [ a1
a n ]T
www.FreeLibros.me
(A.14)
342
APNDICE
Los productos escalares y vectoriales cumplen con las siguientes reglas de productos
para la diferenciacin, parecidas a la regla de productos para la diferenciacin de funciones
escalares ordinarias:
d T
d
(A.15)
(a b) = a T b + aT b ; y
(a b) = a b + a b
dt
dt
Instrucciones similares tambin se aplican para la integracin de vectores.
A.2.6
Independencia lineal
(A.16)
i =1
A.3
Matrices
Una matriz se define como un arreglo ordenado de nmeros reales. Una matriz de m n, por
ejemplo, A, con m hileras y n columnas tiene mn elementos denotados como aij para i = 1, ,
m y para j = 1,, n. Si cada columna de la matriz A se representa por el vector m-dimensional
aj [a1,j am,j]T para j = 1,, n, entonces la matriz A tiene la siguiente representacin:
A [a1
an]
(A.17a)
De manera similar, puede definirse cada hilera como el vector n-dimensional ai ai,1
ai,n]T para i = 1, , m, y puede representarse la matriz A como
LM a OP
AM P
MNa PQ
T
1
(A.17b)
T
m
donde aTi [ai,1, , ai,n]. Observe que ambas ecuaciones (A.17a-b) representan la misma
matriz. En funcin de los requerimientos, una podr elegirse sobre la otra.
A.3.1
El determinante de una matriz slo se define para matrices cuadradas. Para una matriz A de
n n, el determinante es el escalar denotado por det(A) o |A| y se determina por
a11
a21
det(A) = |A| =
an1
a12
a22
an 2
a1n
a2 n
=
ann
(A.18)
A.3
a11
a12
a13
det(A) = a21
a31
a22
a23 = a11
a32
a33
a22
a32
a23
a21
a12
a33
a31
a23
a21
+ a13
a33
a31
Matrices
a22
a32
343
(A.19)
= a11(a22 a33 a23 a32) a12 (a21 a33 a23 a31) + a13 (a21 a32 a22 a31)
Con respecto al determinante de una matriz A, las siguientes propiedades son tiles:
Si todos los elementos de una hilera o columna de la matriz son cero, entonces det(A)
= 0.
Los determinantes de A y su transpuesta AT son iguales, es decir, det(A) = det(AT).
Para dos matrices A y B, det(AB) = det(A)det(B).
Si A es una matriz de identidad, es decir, A = 1, entonces su determinante es la unidad,
es decir, det(A) = 1.
Si dos hileras o columnas son dependientes, entonces det(A) = 0. Estas matrices se
llaman singulares.
Si todas las hileras o columnas son independientes, entonces det(A) 0. Estas matrices se llaman no singulares.
A.3.2
Nuevamente, la inversa de una matriz slo se define para matrices cuadradas. Para una matriz
A de n n, se define como
1
(A.20a)
A1 =
Adj(A)
det(A)
donde Adj(A) se define como sigue:
(A.20b)
Adj(A) = [(1)i+j det(A ij)]T
Observe aqu que para resolver un conjunto de ecuaciones algebraicas lineales Ax = b
se requiere de la inversa de la matriz A, a saber, x = A1b. Pueden usarse las ecuaciones
(A.20a-b) para obtener x. Sin embargo, con el fin de lograr eficiencia computacional, se
sugiere usar la descomposicin de la matriz, as como sustituciones directas e indirectas
(Strang, 1980). Algunas propiedades de la matriz inversa son las siguientes:
A.3.3
Los valores propios de una matriz A son las soluciones en s de la siguiente ecuacin:
det(s1 A) = 0
(A.21a)
donde 1 es la matriz de identidad de dimensin igual que la matriz A. La funcin det(s1 A)
es un polinomio en s y se llama polinomio caracterstico de A. Si se es un valor propio de
A, un vector propio de A correspondiente a se es un vector xe de no cero que cumple con el
sistema de ecuaciones lineales que se determina por
(se1 A)xe = 0
(A.21b)
www.FreeLibros.me
344
APNDICE
Entrada
x(s)
Figura A.4
A.4
Funcin de transferencia
G (s )
Salida
y(s)
Funcin de transferencia
Una funcin de transferencia (Mohan, 1997; Onwubolu, 2005; Dorf, 1992) relaciona en
forma algebraica la salida de un sistema con su entrada. Esta funcin permite la separacin
de la entrada, el sistema y la salida en tres partes separadas y distintas, como se muestra en
la figura A.4. La relacin de la transformada de Laplace1 de la salida y(s), dividida entre la
transformada de Laplace de la entrada x(s), da la funcin de transferencia G(s), es decir,
y ( s)
(A.22)
G(s) =
x (s)
donde x(s) y y(s) son por lo general polinomios en la variable compleja s. En la ecuacin
(A.22) el denominador polinmico x(s) se llama polinomio caracterstico, cuyas races se
llaman polos, mientras que las races del polinomio del numerador y(s) se llaman ceros.
Como ejemplo, considere el sistema amortiguado de masa-resorte que se presenta en la
figura 10.6. Sus ecuaciones de movimiento dadas en la ecuacin (10.30 a) se reproducen
aqu como
(A.23)
m x + b x + kx = f
Tomando la transformada de Laplace de todos los trminos de la ecuacin (A.23), en la
suposicin de condiciones iniciales cero, se obtiene
ms2x(s) + bsx(s) + kx(s) = f(s)
(A.24)
G(s) =
La transformada de Laplace convierte la representacin de un sistema fsico por medio de un conjunto de ecuaciones diferenciales en un conjunto de ecuaciones algebraicas.
www.FreeLibros.me
Resumen
s1,2 =
-b
b 2 - 4 mk
= V wn wn V 2 - 1
2m
345
(A.27)
lo que determina la forma de la respuesta natural del sistema en cuestin, mientras que los
polos y ceros juntos afectan los picos y amplitudes tanto de la respuesta forzada como de
la natural.
RESUMEN
En este apndice se presentan algunos aspectos bsicos del lgebra lineal y de las teoras
de control, lo que ayudar al lector a entender los conceptos que se aplican en este libro,
principalmente en los captulos 5-10.
www.FreeLibros.me
Apndice
B
El uso de MATLAB
y RIDIM
En este apndice, se explican los pasos que hay que seguir para usar el software comercial
MATLAB y el programa RIDIM, desarrollado por el autor y su grupo de estudiantes.
B.1
El uso de MATLAB
B.1.1
Inicializar MATLAB
B.1.2
www.FreeLibros.me
B.1
El uso de MATLAB
347
operaciones bsicas. Para una descripcin detallada, pueden consultarse los libros disponibles sobre MATLAB, por ejemplo, Pratap (2002), y usar los demos y el men de ayuda del
software.
B.1.2.1
Vectores en MATLAB
Para cualquier vector columna, o para lo que en este libro simplemente se llama vector, por
ejemplo, a [a1 a2 a3]T, se utilizan los siguientes comandos:
>> syms a1 a2 a3
>> av = [a1; a2; a3]
av =
[a1]
[a2]
[a3]
donde syms es un comando de MATLAB para definir la variable como simblica en lugar
de numrica. Adems, av es un nombre de variable definido por el usuario para el vector
a. En contraste, un vector rengln, por ejemplo, a [a1 a2 a3], puede generarse como
>> syms a1 a2 a3
>> av = [a1 a2 a3]
av =
[a1, a2, a3]
Si los elementos del vector rengln son nmeros, por ejemplo, a [2 1 5], entonces
>> av = [2 1 5]
av =
2 1 5
av = [2; 1; 3];
bv = [1; 4; 2];
cv = av + bv
=
El producto escalar de los dos vectores arriba mencionados como a y b se obtiene como
>> av = [2; 1; 3];
>> bv = [1; 4; 2];
>> av*bv
ans =
12
Observe arriba que si ninguna variable se asigna a la izquierda de la operacin, se considera como ans.
B.1.2.2
Matrices en MATLAB
348
APNDICE
LM2
A 3
MM5
N
OP
LM1
2 ;y B 2
P
MM8
6 PQ
N
OP
P
9PQ
3 1
2 3
3 5
(B.1)
am = [2 3 1; 3 5 2; 5 1 6]
=
3
1
5
2
1
6
bm = [1 2 3;2 3 5;8 2 9]
=
2
3
3
5
2
9
4
7
15
30
52
74
0.1000
0.1000
0.1000
www.FreeLibros.me
B.2
El uso de RIDIM
349
B.2
El uso de RIDIM
RIDIM es el acrnimo de Recursive Inverse Dynamics for Industrial Manipulators (Dinmica Inversa Recursiva para Manipuladores Industriales). Su programa de interfaz VC++
fue desarrollado para los usuarios de MS-Windows con el fin de combinar dos programas de
C++, uno para resolver el problema de cinemtica inversa formulado en Marothiya y Saha
(2003); el otro es el algoritmo de dinmica inversa recursiva propuesto en Saha (1999). Tanto
los aspectos de la cinemtica inversa como los de la dinmica inversa se analizan tambin
en los captulos 6 y 9 de este libro. El programa requiere de las siguientes entradas:
Basndose en las entradas que se mencionan, el programa calcula la trayectoria por seguir
y la guarda en otro archivo. Luego existe la opcin de realizar la dinmica inversa, usando
RIDIM para la trayectoria calculada, cuya salida (fuerzas/pares de torsin de la articulacin)
tambin se guarda en un archivo. Los resultados guardados en los archivos estn disponibles
para graficar u otros anlisis.
www.FreeLibros.me
350
B.2.1
APNDICE
Instalacin de RIDIM
Para instalar RIDIM, baje ridim.zip de http://web.iitd.ac.in/saha o del sitio web del libro.
Observe que el sistema de cmputo del usuario debe tener los siguientes dos archivos en
C:\windows\system:
MFC42D.DLL
MSVRTD.DLL
B.2.2
1. Haga doble clic en el cono de RIDIM (nombre del archivo: proj1) que est en el
escritorio. Aparecer una ventana con instrucciones acerca del software. Haga clic
en Next para proceder o en Cancel para cerrar el programa.
Aparecer una ventana que pedir el nmero de grados de libertad. Ingrese el nmero
de grados de libertad, por ejemplo DOF 6
donde el usuario deber especificar cantidades subrayadas y
significa Press Next o Press Return Button.
2. Despus, dependiendo de la eleccin del usuario, el programa pedir los parmetros
DH y las propiedades del eslabn. Por ejemplo, los parmetros DH y los parmetros
del eslabn se dan en la tabla B.1. Consulte los captulos 5-9 para revisar el significado
de los trminos.
Todos los valores mencionados arriba debern ingresarse para un eslabn tras otro,
empezando con el eslabn 1. Despus de haber ingresado todos los datos, aparecer
una ventana que indica el almacenamiento de los parmetros en un archivo dhpara.
r. Haga clic en Next.
www.FreeLibros.me
B.2
351
El uso de RIDIM
Nm. Jt.
ai
bi
qI
mi
xcm
ycm
zcm
Ixx
Ixy
Ixz
Iyy
Iyz
Izz
90
180
90
90
90
90
b) Nm. de pasos: Esto sirve para decidir sobre la precisin de los clculos. Entre
mayor sea el nmero de pasos, ms grande ser la precisin de la planeacin de
trayectorias. Estos datos son importantes para calcular los resultados en varias
posiciones. Por ejemplo:
Nm. de pasos: 30
4. Aparecer una ventana en la que se tendr que hacer clic sobre la opcin Run Ikin.
cpp para la cinemtica inversa y la planeacin de trayectorias. Primero que nada, el
programa preguntar si el usuario desea ingresar los datos en coordenadas del nivel
de articulacin o en coordenadas de nivel cartesiano:
Deber especificarse cmo se desea ingresar las posiciones:
En coordenadas del nivel de articulacin (presione 1) o en coordenadas de nivel
cartesiano (presione 2)? 1
www.FreeLibros.me
352
5.
6.
7.
8.
9.
10.
11.
APNDICE
Despus de ingresar todos los datos, las soluciones de cinemtica inversa se guardan
en un archivo. Luego,
TECLEAR ok Y LUEGO ENTER PARA CONTINUAR ok
Con el fin de usar el mdulo de cinemtica directa de RIDIM para verificar los resultados de cinemtica inversa arriba mencionados, pueden seguirse los siguientes pasos:
1. Haga un doble clic en forwardkin.exe en el flder C:\debug o en una ventana por
medio del cono de RIDIM.
2. Aparecer una ventana donde se pregunta si el usuario desea usar los parmetros DH
guardados en el archivo dhpara.r o si desea ingresar nuevos valores, por ejemplo,
Valores de parmetros DH
Desea leer el archivo dhpara.r? (Presione 1)
O desea crear uno? (presione 2) 2
3. Si se ingresa 1, se tomarn los valores ingresados por medio del software de RIDIM.
Si se presiona 2, se solicitarn primero los grados de libertad y despus los parmetros
de la articulacin, por ejemplo:
Ingrese el nm. de grados de libertad: 3
www.FreeLibros.me
B.2
El uso de RIDIM
353
Longitud del eslabn (a[i]) Longitud del offset (b[1]) ngulo de giro en grados
(alfa[i]):
eslabn 1 1 2 90
eslabn 2 3 4 45
eslabn 3 1 1 0
4. Despus de ingresar los datos, se pide que el usuario elija si desea revisar las soluciones guardadas en ikinsoln.r o si quiere ingresar nuevos valores de articulacin (q).
Desea revisar los valores de articulaciones guardados en ikindsoln.r (presione 1)
O desea ingresar sus propios valores (presione 2) 2
B.2.3
Tronco
www.FreeLibros.me
y
Antebrazo
6
0.056
0.432
0.149
b
(m)
0
Mueca
4
0
0.02
0.432
Rotacin de la mueca
(Articulacin 4)
Doblado de
la mueca
(Articulacin 5)
Brida
(Articulacin 6)
a
(m)
0
Eslabn
k
1
Codo
(Articulacin 3)
90
90
90
a
(deg)
90
q6 (JV)
q5 (JV)
q4 (JV)
q3 (JV)
q2 (JV)
q
(deg)
q1 (JV)
Hombro
Hombro (Articulacin 2)
APNDICE
Brazo superior
Cadera(articulacin 1)
354
El uso de MATLAB y RIDIM
B.2
El uso de RIDIM
355
Velocidad de la articulacin
Valor de la articulacin
3.5
3
2.5
2
1.5
1
0.5
0
4 5 6 7
Tiempo (seg)
a) Posicin
Aceleracin de la articulacin
9 10
0.6
0.5
0.4
0.3
0.2
0.1
0
0 1 2 3 4 5 6 7 8 9 10
Tiempo (seg)
b) Velocidad
0.25
0.2
0.15
0.1
0.05
0
0
0.05
9 10
0.1
0.15
0.2
0.25
Tiempo (seg)
c) Aceleracin
Figura B.2
www.FreeLibros.me
APNDICE
8
6
4
2
0
0 1 2 3 4 5 6 7 8 9 10
2
4
6
8
Tiempo (seg)
a) Articulacin 1
100
80
60
40
20
0
20 0 1 2 3 4 5 6 7 8 9 10
40
60
80
100
Tiempo (seg)
b) Articulacin 2
356
10
0
0 1 2 3 4 5 6 7 8 9 10
10
20
30
20
Tiempo (seg)
c) Articulacin 3
0.2
0.15
0.1
0.05
0
5
0 1 2 3 4 5 6 7 8 9 10
0.1
0.15
Figura B.3
Tiempo (seg)
e) Articulacin 5
30
0.5
0.4
0.3
0.2
0.1
0
0 1 2 3 4 5 6 7 8 9 10
0.1
0.2
0.3
Tiempo (seg)
d) Articulacin 4
0.015
0.01
0.005
0
0 1 2 3 4 5 6 7 8 9 10
0.005
0.01
0.015
0.02
0.025
Tiempo (seg)
f) Articulacin 6
Las trayectorias generadas para cada articulacin se muestran en la figura B.2(a-c). Luego
se obtienen los resultados de la dinmica inversa para el PUMA 560, que se encuentran graficados en la figura B.3(a-f ). Las grficas se generaron mediante el programa MS-Excel.
RESUMEN
En este apndice se explica el uso de MATLAB y RIDIM. Esto le ayudar al lector a
resolver algunos de los ejemplos y ejercicios que se presentan en los captulos sobre
cinemtica y dinmica.
www.FreeLibros.me
Cinemtica
357
Apndice
C
Proyectos de
estudiantes:
Estudios de caso
En este apndice se presentan varios estudios de caso con los proyectos de estudiantes, donde
estn involucrados sntesis, diseo, fabricacin y control de brazos y mordazas robticos,
tanto aquellos que se construyeron para participar en concursos de robots, como los que fueron realizados como parte de proyectos de licenciatura y posgrado. Se enfatiza fuertemente
el primer conjunto, ya que involucra a todas las fases del ciclo de vida de un producto y, por
ende, se presenta en primer lugar.
C.1
ROBOCON, la abreviacin de ROBOtic CONtests, es una competencia robtica de estudiantes, organizada cada ao por la Asian Broadcasting Union (ABU). A pesar de que era
una competencia robtica popular en Japn entre estudiantes de licenciatura, se abri para
otros pases asiticos en 2002. Desde entonces, Doordashan (compaa de televisin de la
India) organiza una competencia en la India para seleccionar un equipo representativo de ese
pas. Normalmente, el campen de la India representa a su pas en las competencias ABURobocon que se llevan a cabo en diferentes pases de Asia. Hasta la fecha, Japn (2002),
Tailandia (2003), Corea del Sur (2004), China (2005), Malasia (2006) y Vietnam (2007) han
albergado el evento. La India present la Robocon de 2008 en Pune.
Bajo la direccin del autor, equipos del IIT Delhi han participado en el ROBOCON de
la India desde 2003. En la siguiente subseccin se presentan experiencias de proyectos
www.FreeLibros.me
358
APNDICE
C.1.1
La experiencia de 2007
En esta competencia se permitieron dos tipos de robots. Uno es el automtico, cuya tarea
es transferir bloques desde los bordes exteriores del polgono de 10 lados en el campo de
juego, como se muestra en la figura C.1, hasta los vrtices del tringulo en el centro.
Se trata de robots preprogramados. Por ende, se usa el trmino automtico. El otro
tipo se llama manual, que puede controlarse por medio de una palanca de mando o de
un conmutador por parte de un operario. La tarea de este robot es transferir bloques desde
las esquinas del campo cuadrado a los bordes del polgono de 10 lados. Cada transferencia
exitosa acumula puntos y el juego prosigue. Ms que en las reglas exactas, en este libro se
hace hincapi en el diseo, la fabricacin y los aspectos de programacin.
Tanto los robots automticos como los manuales tienen una mordaza para sostener los
bloques de aproximadamente 300 mm de dimetro. Es importante sintetizar un mecanismo
adecuado que debe sostener los bloques que estn hechos de un material suave, sin aplastarlos
y sin que se resbalen. El segundo aspecto es la elevacin y colocacin. Mientras que se usa
un arreglo de poleas para el robot automtico que se presenta en la figura C.2, se prefiere un
Figura C.1
www.FreeLibros.me
C.1
Figura C.2
359
mecanismo de un paralelogramo de cuatro barras para el robot manual de la figura C.3. Este
ltimo puede extenderse casi medio metro enfrente del robot para poder colocar el bloque
dentro de la lnea de lmite del polgono de 10 lados. Una vez terminado el diseo, el siguiente
nivel de desafo es su fabricacin, ensamble, programacin y funcionamiento exitoso.
Segn la experiencia del autor, normalmente debern revisarse los siguientes aspectos
para completar este tipo de proyecto con xito:
1. Una planeacin correcta, tomando en cuenta las 5 P (Proper Planning Prevents Poor
Performance, la planeacin correcta impide el desempeo defectuoso).
2. Cada estudiante debe llevar una bitcora de proyecto para registrar actividades diarias, esbozos, informaciones, etctera.
3. Seguimiento estricto de un diagrama de Gantt bien planeado. Un tpico diagrama
Gantt se presenta en la figura C.4. En caso de que no pueda cumplirse con las fechas
lmite, debern averiguarse las causas y deben tomarse medidas sin redefinicin del
diagrama de Gantt. De hecho, el calendario actual podr colocarse debajo del calendario planeado.
4. Es de extrema importancia que los estudiantes aprendan cmo trabajar en grupo. En
particular, los coordinadores de diferentes tareas, por ejemplo, mecnico, elctrico,
fabricacin, etc., debern saber cmo distribuir el trabajo entre otros miembros de
sus grupos. De lo contrario, ellos terminarn haciendo la mayor parte de los trabajos
mientras que otros no tendrn trabajo. Este ltimo grupo podr frustrarse e incluso
abandonar el proyecto.
www.FreeLibros.me
Minor I, IISemester1
Major
Minor ISemester2
Formalisation
andPlanning
Introduction
to First year
students
Study on
Rules
Team
Making
Market
Survey
Designing
Dr. Sahas
Comments
Final Design
Mechanical
Fabrication
andRepair
Electrical
Fabrication
andRepair
Electrical
Installation
Game Field
Inspection
andTesting
Packaging
and
Transport
TASK
November
1 2 3 4
2 0 0 6
October
1 2 3 4
December
1 2 3
4
1
0
4
2
January
2
3
September
1 2 3 4
Figura C.4
August
1 2 3 4
February
1 2 3
0
4
360
APNDICE
C
Proyectos de estudiantes: Estudios de caso
www.FreeLibros.me
C.2
361
5. Por encima de todo, son obligatorios valores como dedicacin, sinceridad, honestidad y pensamiento positivo entre los miembros para una participacin exitosa donde
los robots realmente se muevan y cumplan con sus tareas, ms que simplemente ganar
el juego.
C.2
Vista frontal
(rendija)
2
3
Sli
r
do
rta a
o
sp trad
an
Tr e en
d
ttin
gM
Tr
an
de spor
sa tad
lid or
a
b) Tarea de transferencia
Figura C.5
www.FreeLibros.me
362
APNDICE
Figura C.6
efectiva slo era de aproximadamente 500 g, se eligieron accionamientos por cadena de fcil
disponibilidad, a saber, cadenas de bicicleta. El control completo se logr mediante el uso
de motores de pasos y una PC. El brazo se presenta en la figura C.6. El diseo detallado y el
trabajo de desarrollo se presentaron en otro congreso (Baghla et al., 1999).
C.3
La mordaza fue diseada en otro proyecto de B. Tech, teniendo en cuenta que lo mismo
puede usarse para el HaPRA que se explic en la seccin C.2 (Agarwal y Singh, 2004). Para
una gama de formas cilndricas, la mordaza se sintetiza como un mecanismo de seis barras,
como se presenta en la figura C.7a). Su anlisis cinemtico completo se realiz utilizando
la opcin de movimiento del software Pro-E. La mordaza fue fabricada y puesta en interfaz
con un motor de pasos para demostrar sus capacidades de movimiento, como se muestra
en la figura C.7b). El proyecto recibi en el ITT Delhi el premio como mejor proyecto de
hardware de B. Tech Padamshri Manmohan Suri para el ao de 2004.
C.4
Este robot de accionamiento directo, como se presenta en la figura C.8, fue desarrollado
en dos proyectos M. Tech. En el primero de ellos se realizaron los anlisis cinemticos y
www.FreeLibros.me
C.4
363
a) Dibujo de Pro-E)
b) Interfaz de control
Figura C.7
dinmicos, y se fabric el brazo que contiene dos grados de libertad (Barma, 2001). Posteriormente, se agreg un tercer brazo en el marco de otro proyecto M. Tech (Ramvath, 2004),
que deber ser til para la aplicacin real del robot en operaciones para recoger y colocar.
La metodologa detallada de diseo fue presentada en un congreso nacional (Ramvath et
al., 2005).
www.FreeLibros.me
364
APNDICE
Figura C.8
RESUMEN
En este apndice se presentan varios sistemas robticos desarrollados en el marco de
proyectos de estudiantes. Esto har que el lector entienda los requerimientos de hardware
y software para construir su propio sistema robtico.
www.FreeLibros.me
Referencias
365
Referencias
Agarwal, A. y Singh, S., Design and Manufacturing of Robotic Gripper. B. Tech Project
Report, ME Dept, IIT Delhi, mayo de 2004.
Angels, J. Fundamentals of Robotic Mechanical Systems, Springer-Verlag, Nueva York,
2003.
ngeles, J. y Lee, S., The formulation of dynamical equations of holonomic mechanical
systems using a natural orthogonal complement, ASME J. Appl. Mech., V. 55, marzo de
1988, pp. 243-244.
Ascher, U.M., Pai, D.K. y Cloutier, B.P., Forwad dynamics, elimination methods, and formulation stiffness in robot simulation, Int. J. Rob. Res., V.16, N. 6, 1997, pp. 749-758.
Baghla, D., Anurag, A., Saha, S.K., Sharma, Prasenjit, S. y Mehta, G.R., Development of a
hanging planar robotic arm (HaPRA), Proc. Of the 11a. ISME Conf., IIT Delhi, 3-5 de
febrero de 1999, pp. 93-98.
Barma, D., Design and Fabrication of a Planar Robot, diciembre de 2001.
Bishop, P.H., The mechatronics Handbook, CRC Press, Nueva York, 2002.
Bhangale, P.P., Dynamics Based Modelling, Computational Complexity, and Architecture
Selection of Robot Manipulators, Ph. D thesis, IIT Delhi, 2005.
Canudas de Wit, C. Siciliano, B., Bastin, G. (Eds.), Theory of Robot Control, Springer-Verlag, Nueva York, 1996.
Chaudhary, H. y Saha, S.K., Constrait wrench formulation for closed-loop systems using
two-level recursions, ASME J. of Mechanical Design, 2006.
Chaundhary, H. y Saha, S.K., Matrix formulation of constraint wrenches for serial manipulators, CD-Proc. IEEE Int. Conf. on R&A, Barcelona, Espaa, 18-22 de abril de 2005,
pp. 4647-4652.
www.FreeLibros.me
366
Referencias
Corke, P.I., Visual Control of Robots: High-performance Visual Servoing, Research Studies,
Press Ltd., Somerset, Inglaterra, 1996.
Craig, J.J., Introduction to Robotics: Mechanics and Control, Addison-Wesley, Singapore,
1986.
Critchlow, R.H., Introduction to Robotics, McMillan Publishing Company, Nueva York,
1985.
Cugy, A. y Page, K., Industrial Robot Specifications, Kogan Page, Londres, 1984.
Cyril, X., Dynamics of Flexible-Link Manipulators, Ph. D thesis, McGill University, Canad
1988.
Denavit, J. y Hartenberg, R.S., A kinematic notation for lower-pair mechanisms based on
matrices, ASME J. Appl. Mech., V. 23, 1955, pp. 215-221.
Dorf, R.C., International Encyclopedia of Robotics, John Wiley & Sons, Nueva York,
1988.
Dorf, R.C., Modern Control Systems, Addison-Wesley, Nueva York, 1992.
Fu, K.S., Gonzlez, R.C. y Lee, C.S.G., Robotics: Control, Sensing, Vision and Intelligence,
McGraw-Hill, 1987.
Fuller, J.L., Robotics: Introduction, Programming, and Proyect, Prentice Hall, Nueva Jersey.
Howards, B. y Erlemeier, T., Interface design for offline robot programming with the use
of virtual simulation, www.public.iastate.edu/~terlemei/FinalPaper.pdf, 30 de abril de
2007.
Gopal, M., Control Systems-Principles and Design, Tata McGraw-Hill, Nueva Delhi,
1997.
Ghosal, A., 2006, Robotics: Fundamental Concepts and Analysis, Oxford University Press,
Nueva Delhi, 2006.
Histand, M.B. y Alciatare, D.G., Introduction to Mechatronics and Measurement Systems,
McGraw-Hill, Nueva Delhi, 1999.
Huston, H. y Passarello, C.E., On constraint equation-A new approach, ASME J. Appl.
Mech., V. 41, 1974, pp.1130-1131.
Kane, T.R. y Levinson, D.A., The use of Kanes dynamical equations for robotics, Int. J.
Rob. Res., V. 2, N. 3, 1983, pp. 3-21.
Khan, W.A., Krovi, V.N., Saha, S.K. y ngeles, J., Recursive kinematics and inverse dynamics for a planar 3R parallel manipulator, ASME J. of Dynamic Systems, Measurement
and Control, V. 127, Issue 4, septiembre de 2005, pp. 529-536.
Kuo, B.C., Automatic Control Systems, 6a. Ed. Prentice-Hall, Englewood Cliffs, Nueva
Jersey, 1991.
Klafter, R.D., Chmielewski, T.A. y Negin, M., Robotic Engineering-An Integrated Approach, Prentice-Hall India, Nueva Delhi, 1994.
Koivo, A.J., Fundamental for Control of Robotic Manipulators, John Wiley & Sons, Nueva
York, 1989.
Koren, Y., Robotics for Engineers, McGraw-Hill, Nueva Delhi, 1987.
Koteswara Rao, A.B., Saha, S.K. y Rao, P.V.M., Dynamics modeling of hexaslides using
the decoupled natural orthogonal complement matrices, Int. J. of Multibody System
Dynamics, V.15, 2006, pp.159-180.
LaSalle, J. y Lefschetz, S., Stability by Liapunovs Direct Mothod with applications, Academic Press, Nueva York, 1961.
www.FreeLibros.me
Referencias
367
368
Referencias
www.FreeLibros.me
ndice analtico
ndice analtico
Smbolos
(ADC), 21
(DAC), 22
(DH) parmetros, 100
(DOF), 76
(ISO), 5
A
Aceleracin angular, 188
Aceleracin lineal, 189
Actuador, 18
Adquisicin de imgenes, 68
AGV, 6
Algoritmo recursivo de Newton-Euler, 186
Algoritmos de dinmica, 195
Amplificador, 23
Anlisis
de aceleracin, 143
de posicin inversa, 121
de velocidad, 130
ngulos de Euler, 89
Arquitectura, 76
Articulacin
cilndrica, 78
de par superior, 77
de par inferior, 77
esfrica, 78
helicoidal, 77
planar, 79
prismtica, 77, 134
revoluta, 77, 134
universal, 79
Articulaciones, 76
Articulado, 26
atan2, 123, 338
B
Brazo articulado, 126, 136
Brazo planar de tres eslabones,
122
C
Cadena cinemtica, 79
Clculo recursivo, 149
Capacitivo, 63
Cartesiano, 24
Centro de masa, 164
Cilndrico, 25
Cinemtica, 112
directa, 112
inversa, 112, 122
www.FreeLibros.me
369
370
ndice analtico
Clasificacin, 24
de sensores, 52
Computacin directa, 186
Computacin regresiva, 189
Control, 29
Coordenadas generalizadas, 172
Coseno de direccin, 85
D
DeNOC, 138
Deslizamiento, 48
Desplazamiento virtual, 157
Detector de deformacin, 61
Dinmica, 163, 205
directa, 198
directa recursiva, 229
inversa, 195
inversa recursiva, 221
J
Jacobiano, 130, 134, 157
L
Leyes de robtica, 2
LVDT, 56
Manipulador, 17
MATLAB, 346
Matriz
de inercia convectiva (MCI), 213
de inercia generalizada (GIM), 211
de producto cruz, 341
de propagacin de torsin, 209
jacobiana, 141
Mecanismos, 21
Modelado dinmico, 206
Momento, 147
angular, 182
de inercia, 166
lineal, 181
Momentos principales de inercia, 168
Monofase, 47
Motores
CA, 46
CD, 42
de paso, 39
sncronos, 48
Mueca, 129
Gantry, 27
Grado de libertad, 80
Neumtico, 32, 33
Newton-Euler (NE), 206
HaPRA, 361
Hbrido, 41
Hidrulico, 32, 36
Offline, 30
Online, 30
Orientacin, 85
E
Economa, 10
Ecuaciones de movimiento, 176, 183, 210
Efector final, 18
Elctrico, 33, 38
Elipsoide de fuerza, 161
Encder, 53
Energa cintica, 173
Energa potencial, 176
Engranajes, 20
Escalar, 340
Escribir las ecuaciones de Newton y Euler, 164
Esfrico, 26
Eslabones, 76
Esttica, 146
Euler-Lagrange (EL), 172, 206
www.FreeLibros.me
ndice analtico
371
Sin escobillas, 45
Sincros, 58
Singularidad, 141
Sistema de visin, 66
Sistemas de DH, 105
Sistemas de resolucin, 58
Solucin algebraica, 122
Solucin geomtrica, 124
Subsistema(s), 14
de control, 17
de movimiento, 16
de reconocimiento, 16
Reluctancia variable, 40
Repercusin negativa, 37
Restricciones cinemticas, 208
RIDIM, 222, 349
Robocon, 357
Robot PUMA, 137
Robots caminantes, 7
Robots paralelos, 7
Tacmetro, 59
Tacto, 52
Tensor de inercia, 166
Teorema de ejes paralelos, 167
Teorema de ejes perpendiculares, 167
Trminos de vectores de inercia convectiva
(VCI), 215
Trabajo virtual, 157
Transformacin homognea, 94
Transformaciones, 76
Transmisin, 20
Trifsico, 48
S
SCARA, 28
Seguridad, 11
Seleccin de motores, 49
Seleccin de sensores, 72
Sensor
de desplazamiento de semiconductor, 65
de efecto Hall, 59
de proximidad, 63
piezoelctrico, 62
Sensores, 21, 52
de aceleracin, 60
de fuerza, 61
de posicin, 53
de velocidad, 59
Simulacin, 198, 229, 232
U
UNIMATION, 2
Uso de robots, 8
V
Valores propios, 343
Vectores, 339, 340
propios, 343
unitarios, 339
Velocidad angular, 187
Velocidad lineal, 188
Visin, 53
www.FreeLibros.me
www.FreeLibros.me
109876543210
Impreso en Mxico
Printed in Mexico
www.FreeLibros.me