Documente Academic
Documente Profesional
Documente Cultură
PROYECTO DE INVESTIGACIN
PRESENTAN
MAYA SANTOS MANUEL
FONSECA MUCIO RAL
ASESORES
DR ALEJANDRO TONATIU VELZQUEZ SNCHEZ
M. EN C. MARTN ENRQUEZ SOBERANES
... ~
REPORTE TCNICO
QUE PARA OBTENER EL TITULO DE
POR LA OPCiN DE TITULACIN
DEBERA(N) DESARROLLAR
~tUiIE!i;
DR. ALEJANDRO T
VELZQUEZ SN~~~~;~~(:0?.
~:,.?' (,f:{~tj;f;'~~'~~
-e
C>
\~~i~7f!!J
ING. JOS
L M JA DOMNGUEZ
I Pi\!
JEFE DEL DE
ENTO ACADMICO JEFA1'_"<,'\ le A
DE INGENIERA EN CONTROL Y AUTOMATIZACIN
DESARROLLO Y
ANLISIS CINEMATICO
DE UN BRAZO
ROBTICO PARA LA
SELECCIN DE PIEZAS
OBJETIVOS.
II
JUSTIFICACIN:
III
ALCANCE.
IV
Desde siempre el ser humano a intentado medir y analizar en forma confiable la cantidad y
calidad de las cosas que lo rodean, que son importantes para mejorar la vida, por ello han
creado mecanismos semejantes a sus extremidades superiores llamados manipuladores; que
lo pueden reemplazar en trabajos tediosos y donde se requiere mejorar la cantidad y calidad
de la produccin.
A travs del anlisis cinematico, se observa como intervienen los parmetros de diseo en
el movimiento de un manipulador, permitiendo generar trayectorias de trabajo fuera de
lnea. El problema es que los clculos para el anlisis cinematico de robots manipuladores
de 5 GDL o ms, resulta en ocasiones complicado, por lo que es necesario apoyarse en
herramientas computacionales, que permitan clculos confiables y precisos, para que en
base a estos el robot manipulador realice su trabajo de manera eficiente y evitando
colisiones.
HIPTESIS
VI
CONTENIDO
ObjetivosII
Justificacin..III
Alcance.IV
Planteamiento del problema...V
Hiptesis...VI
Contenido.VII
VII
2.9.1
2.9.2
ANEXOS
Anexo A Planos de las partes del brazo manipulador.99
Anexo B Cdigo fuente de los programas en Matlab...114
Anexo C Circuitos electrnicos y hojas de especificaciones....130
VIII
Captulo I
Estado del Arte
1.1
Antecedentes Histricos.
La imagen del robot como mquina a semejanza con el ser humano ha prevalecido en las
culturas desde hace muchos siglos, el afn por fabricar mquinas capaces de realizar tareas
independientes ha sido una constante en la historia, a travs de la que se han descrito
infinidad de ingenios, antecesores directos de los actuales robots.
Los antiguos egipcios unieron brazos mecnicos a las estatuas de sus dioses, estos brazos
fueron operados por sacerdotes, quienes clamaban que el movimiento de estos era
inspiracin de sus dioses; los griegos construyeron estatuas que operaban con sistemas
hidrulicos los cuales se utilizaban para fascinar a los adoradores de los templos.
La palabra robot es de origen eslavo, en ruso robota significa trabajo, en checo significa
trabajo forzado, en 1921 el escritor checo Karol Capek escribi Rossums Universal Robots,
una obra teatral que obtuvo gran xito en Broadway, en esta obra unos androides trabajan
ms del doble que un ser humano.
Entre los escritores de ciencia ficcin, Isaac Asimov contribuy con varias narraciones
relativas a robots, comenz en 1939, a l se atribuye el acuamiento del trmino robtica, la
imagen de robot que aparece en su obra es el de una mquina bien diseada y con una
seguridad garantizada que acta de acuerdo con tres principios.
Estos principios fueron denominados por Asimov las Tres Leyes de la Robtica, y son:
1. Un robot no puede actuar contra un ser humano o, mediante la inaccin, que un ser
humano sufra daos.
2. Un robot debe de obedecer las rdenes dadas por los seres humanos, salvo que estn
en conflictos con la primera ley.
3. Un robot debe proteger su propia existencia, a no ser que est en conflicto con las
dos primeras leyes.
Consecuentemente todos los robots de Asimov son fieles sirvientes del ser humano, de sta
forma su actitud contraviene a la de Kapek.
El inicio de la robtica actual puede fijarse en la industria textil del siglo XVIII, cuando
Joseph Jacquard inventa en 1801 una mquina textil programable mediante tarjetas
perforadas, en la cual, esencialmente se trataba de robots mecnicos diseados para un
propsito especfico y la diversin.
En 1805, Henri Maillardert construy una mueca mecnica que era capaz de hacer
dibujos, una serie de levas se utilizaban como el programa para el dispositivo en el
proceso de escribir y dibujar, estas creaciones mecnicas de forma humana deben
considerarse como inversiones aisladas que reflejan el genio de hombres que se anticiparon
a su poca.
La revolucin industrial impuls el desarrollo de estos agentes mecnicos, entre los cuales
se destacaron el torno mecnico motorizado de Babbitt (1892) y el mecanismo programable
para pintar con spray de Pollard y Roselund (1939).
Adems de esto durante los siglos XVII y XVIII en Europa fueron construidos muecos
mecnicos muy ingeniosos que tenan algunas caractersticas de robots. Jacques de
Vaucansos construy varios msicos de tamao humano a mediados del siglo XVIII.
Fonseca Mucio Ral
Maya Santos Manuel
A partir de 1965 varios centros importantes de investigacin tales como MIT, SRI, etc.
empezaron la investigacin en robtica y reas asociadas, en 1970 se construyo en el SRI
un manipulador con 6 grados de libertad controlado por computador y con control de
movimiento por bucle cerrado PID con servomotores de corriente continua; hasta entonces
todos los robots manipuladores tenan actuadores hidrulicos.
El primer robot controlado por microcomputador fue producido por Cincinnati milacron en
1973, en 1978 Unimation Desarrollo el PUMA (inciales de Programmable Universal
Macine for Assembling).
En los ochenta aparece el CART del SRI que trabaja con procesado de imagen estreo, ms
una cmara adicional acoplada en su parte superior, tambin en la dcada de los ochenta, el
CMU-ROVER de la Universidad Carnegie Mellon incorporaba por primera vez una rueda
timn, lo que permite cualquier posicin y orientacin del plano.
Otros desarrollos Importantes en la historia de la robtica son:
En 1960 se introdujo el primer robot "Unimate'', basada en la transferencia de
artculos, programada de Devol, utilizan los principios de control numrico para el
control de manipulador y era un robot de transmisin hidrulica.
En 1961 se vendi a la General Motors el primer robot, un Unimate, que ya fue
retirado despus de trabajar durante 50 aos, (en aos hombre equivalentes a
100,000 horas.
En 1964 se abren laboratorios de investigacin en inteligencia artificial en el MIT,
el SRI (Stanford Research Institute) y en la universidad de Edimburgo, poco
despus los japoneses que anteriormente importaban su tecnologa robtica, se
sitan como pioneros del mercado.
En 1966 Trallfa, una firma noruega, construy e instal un robot de pintura por
pulverizacin.
En 1971 El "Standford Arm'', un pequeo brazo de robot de accionamiento
elctrico, se desarroll en la Standford University.
En 1973 Se desarroll en SRI el primer lenguaje de programacin de robots del
tipo de computadora para la investigacin con la denominacin WAVE, fue seguido
por el lenguaje AL en 1974, los dos lenguajes se desarrollaron posteriormente en el
lenguaje VAL comercial para Unimation por Vctor Scheinman y Bruce Simano.
En 1978 Se introdujo el robot PUMA (Programmable Universal Machine for
Assambly) para tareas de montaje por Unimation, basndose en diseos obtenidos
en un estudio de la General Motors.
En 1980 Un sistema robtico de captacin de recipientes fue objeto de demostracin
en la Universidad de Rhode Island, con el empleo de visin de mquina el sistema
era capaz de captar piezas en orientaciones aleatorias y posiciones fuera de un
recipiente.
Tambin estn las tcnicas hbridas, ANFIS, P-CMAC, PID difuso, H-infinito difuso, que
combinan redes neuronales con lgica difusa o bien tcnicas convencionales con lgica
difusa.
Las redes neuronales se adaptan a los cambios de la planta, pero su costo computacional es
generalmente grande, es por eso que los artculos que indican haber sido probados en
sistemas reales, tales como robots antropomrficos, son relativamente nuevos.
Otro de los campos en los que debemos poner atencin, es en la teleoperacin, que es el
conjunto de disciplinas que permiten a un operador manejar un dispositivo remoto mediante
el uso de un dispositivo local, la teleoperacin fue motivada por la industria nuclear, que
deba tener a los operarios en lugares seguros de radiacin en tanto se realizaba el trabajo.
Ahora los sistemas teleoperados tienen reflexin de fuerza, para que el operario tenga una
sensacin de lo que ocurre en el ambiente remoto, este tipo de sistemas se llaman sistemas
con realimentacin bilateral, los distintos esquemas de realimentacin bilateral son:
1. Posicin - Posicin: La posicin del dispositivo esclavo es determinada a partir de la
posicin del dispositivo maestro.
2. Fuerza - Posicin: La posicin del dispositivo esclavo se determina a partir de la posicin
del dispositivo maestro, pero existe una reflexin de fuerza del dispositivo esclavo al
maestro.
3. Fuerza - Fuerza: La posicin de ambos dispositivos se determina por la lectura de los
sensores fuerza de cada uno de ellos y existe tambin un control de posicin para cada
dispositivo.
4. Cuatro canales: Existe un intercambio de seales de posicin y fuerza entre los
dispositivos, es el esquema que ms transparencia puede dar al operario.
Cuando los retardos de comunicacin son muy grandes entre el dispositivo maestro y el
esclavo en este tipo de sistemas, el sistema se vuelve inestable, una solucin planteada es
utilizar visualizadores predicativos, que consisten en que el operador trabaja sobre un
ambiente virtual ubicado localmente sin retrasos, que simula lo que ocurre instantes de
tiempo despus con el dispositivo esclavo, cuando los retardos no son tan grandes, de unos
pocos segundos es posible realizar un bucle de realimentacin, aunque la el dispositivo
esclavo debe tener cierto nivel de autonoma.
Otra tecnologa que esta usando mucho la robtica para modernizar los manipuladores
industriales, es el reconocimiento de objetos mediante visin artificial, es uno de los
campos que tiene el futuro ms prometedor dentro de la industria, las aplicaciones son
muchas y van entrando poco a poco en las lneas de produccin a medida que los sistemas y
algoritmos de visin van mejorando da a da tanto en su velocidad como en su eficacia.
Realmente el reconocimiento automtico de formas va avanzando a medida que se
desarrollan nuevos mtodos que imitan el comportamiento inteligente del ser humano,
desde la inteligencia artificial convencional (IA) hasta las nuevas tcnicas de inteligencia
computacional denominadas soft computing, donde se incluyen las redes neuronales, la
lgica difusa, la programacin evolutiva y el modelado neuro-difuso.
Fonseca Mucio Ral
Maya Santos Manuel
Poli Articulados.- Bajo este grupo estn los robots de muy diversa forma y
configuracin, cuya caracterstica comn es la de ser bsicamente sedentarios
(aunque excepcionalmente pueden ser guiados para efectuar desplazamientos
limitados) y estar estructurados para mover sus elementos terminales en un
determinado espacio de trabajo segn uno o ms sistemas de coordenadas y con un
nmero limitado de grados de libertad.
En este grupo se encuentran los manipuladores, los robots industriales, los robots
cartesianos, algunos robots industriales y se emplean cuando es preciso abarcar una
zona de trabajo relativamente amplia o alargada, actuar sobre objetos con un plano
de simetra vertical o deducir el espacio ocupado en el suelo.
10
11
12
13
Configuracin polar: Tiene varias articulaciones, cada una de ellas puede realizar
un movimiento distinto: rotacional, angular y lineal; este robot utiliza la
interpolacin por articulacin para moverse en sus dos primeras articulaciones y la
interpolacin lineal para la extensin y retraccin.
14
15
29%
20%
12%
06%
03%
16
38%
22%
15%
15%
10%
Durante el perodo de 2005 a 2008, la Federacin Internacional de Robots (IFR por sus
siglas en ingls) opina, a travs de varios de sus reportes publicados, que esta industria
presenta importantes crecimientos, aunque la demanda para los robots dentro de la industria
del automvil en Europa, Norteamrica y Japn puede disminuir, todava existe una
demanda creciente en todos los mercados de manufactura en el mundo.
Como resultado de los progresos tecnolgicos, crecern por todo el mundo las instalaciones
de robots en la industria en general, especialmente la industria de envase y embalaje, el
sector alimenticio, la industria de maquinaria, la industria del caucho y plsticos.
Adems, las mejoras en la tecnologa de robots, tales como los nuevos sistemas de control y
los sistemas de seguridad, que permiten operaciones interactivas ms confiables entre el
hombre y la mquina, y las mejoras en los sensores de visin, impulsarn el aumento del
nmero de futuras instalaciones de robots, el mercado mundial de robots industriales ha
proyectado un crecimiento de 95,400 unidades vendidas en 2004 a 121,000 en el ao 2008,
con un crecimiento promedio anual de 6.1%.
Para el mes de septiembre de ese ao, nicamente las compaas norteamericanas
solicitaron un total de 12,763 robots, valuados en $844,5 millones de dlares, lo cual
represent un aumento del 33% en unidades y el 21% en valor respecto del mismo perodo
en 2006, si se incluyen las rdenes de compra de empresas extranjeras, las ventas totales
para las compaas norteamericanas fabricantes de robots sumaron 13,866 unidades
valuadas en $905,6 millones de dlares, un salto del 34% en volumen y el 22% en valor.
17
Tanto la RIA como la IFR, coinciden en que actualmente en Estados Unidos estn
trabajando unos 180,000 robots, lo cual coloca a este pas en segundo lugar despus de
Japn donde operan unos 355 mil, ambas instituciones, estiman que el nmero de robots
industriales operando en todo el mundo aumentar de 848.000 unidades en el ao 2004 a un
milln en el 2008, representando un ndice de crecimiento anual promedio de 5.3%.
No existen estudios previos al que aqu presentamos sobre el mercado de Robots y
Automatizacin en Mxico, sin embargo, en base a nuestras estadsticas, en el Instituto
Mexicano del Plstico Industrial estimamos que para finales del 2009 habr
aproximadamente 12,000 unidades de robots industriales instalados en Mxico, de los
cuales ms del 70% se encuentran en el sector automotriz.
Asimismo, se calcula que alrededor de 600 empresas son las principales usuarias de robots
de distintas formas, tamaos y modelos que hay en el pas, generalmente se trata de
empresas transnacionales que los integraron para mantener la competitividad de su planta o
por decisin del corporativo para automatizar sus procesos.
Por su parte, Wittmann Mxico est inaugurando sus nuevas instalaciones, donde adems
del servicio tcnico que ofrece a sus clientes, cuenta con una sala de exhibicin permanente
de todos los sistemas que ofrece y un rea para capacitacin tanto para prcticas de
alumnos universitarios, como de personal trabajador de sus clientes actuales.
18
Debido a la rpida evolucin hoy, los robots son demasiado exitosos y demasiado
econmicos para ignorarlos, y desde el punto de vista de competitividad, debemos esperar
el desarrollo de nuevos productos cada vez ms rpidos, y en la mayora de los casos con
calidad ms alta y precios de venta inferiores, segn muchos expertos, un robot est
disponible hoy por el 20% del precio que tena en los aos 70s, y tienen una capacidad en
general mucho ms extensa que la disponible hace 30 aos.
Hoy en da ya son comunes los controladores para multi-robot, y algunas unidades se
construyen con dos brazos sobre la misma base, la movilidad y la flexibilidad para acciones
de elevacin, desplazamiento, visin y otros movimientos, as como los dispositivos de
sensor, permiten que los robots puedan utilizarse en equipos viejos de modos nuevos y
diferentes.
En esta poca de altos costos de energa, desequilibrios comerciales y luchas vigorosas
para ganar participacin de mercado, los robots son una de las pocas opciones que los
pases desarrollados y en vas de desarrollo, como Mxico, tienen para ser competitivos
ante la competencia de las naciones emergentes manufactureras, (segn Alex Kramer)
De la mano de los robots no hay que temer el futuro, ya que el futuro para la industria ser
ms brillante en la medida en que ms compaas comiencen a considerar el potencial de la
robtica y las tecnologas relacionadas con la automatizacin de sus operaciones
(conclusiones de Carlos Chvez).
19
Captulo II
Marco Terico
20
21
22
23
24
cul es la posicin y orientacin del extremo final del robot con respecto a un sistema de
coordenadas que se toma como referencia, conocidos los valores de las articulaciones y los
parmetros geomtricos de los elementos del robot; el segundo denominado problema
cinemtico inverso, resuelve la configuracin que debe adoptar el robot para una posicin y
orientacin del extremo conocidas. Denavit y Hartenberg propusieron un mtodo
sistemtico para descubrir y representar la geometra espacial de los elementos de una
cadena cinemtica, y en particular de un robot, con respecto a un sistema de referencia fijo,
este mtodo utiliza una matriz de transformacin homognea para descubrir la relacin
espacial entre dos elementos rgidos adyacentes, reducindose el problema cinemtico
directo a encontrar una matriz de transformacin homognea 4 X 4 que relacione la
localizacin espacial del robot con respecto al sistema de coordenadas de su base.
Por otra parte, la cinemtica del robot trata tambin de encontrar las relaciones entre las
velocidades del movimiento de las articulaciones y las del extremo, esta relacin viene dada
por el modelo diferencial expresado mediante la matriz Jacobiana.
Cinemtica directa = = >
Posicin y
orientacin del
extremo del robot
(x, y, z, , , )
Valor de las
coordenadas
Articulares
(q0, q1, ... qn)
< = = Cinemtica inversa
25
Para aumentar la destreza en las repeticiones de los robots se usan las coordenadas
redundantes para definir tareas adicionales, el mando de configuracin est surgiendo como
una manera eficaz de controlar los movimientos de un robot que tiene ms grados de
libertad y en el cual es necesario definir la trayectoria del efector del extremo y / o el objeto
para ser manipulado, pueden usarse los grados extras o redundantes de libertad para dar
destreza de robot y versatilidad, en mando de configuracin, la configuracin del robot se
representa matemticamente por un juego de variables de configuracin que son un vector
de coordenadas generalizado y que es ms pertinente a la tarea global que es el vector de
coordenadas de la articulacin, que aparecen en los acercamientos convencionales a
controlar.
El vector de la coordenada generalizada consiste en las coordenadas del efector del
extremo, en el espacio de la tarea, ms varias funciones de cinemtica que involucran
grados redundantes de libertad, la tarea bsica del sistema de control es hacer las
coordenadas del efector del extremo seguir la trayectoria deseada, las funciones de la
cinemtica pueden seleccionarse para definir una tarea adicional por ejemplo, la anulacin
de obstculos u optimizacin de la cinemtica para reforzar la manipulacin, en efecto la
tarea adicional define la trayectoria en los grados redundantes de libertad, las variables de
configuracin pueden usarse en un esquema de control adaptable que no exige manipular el
conocimiento del modelo matemtico complicado de la dinmica del robot o los parmetros
del objeto.
Fig. 2.5 Representacin del Manipulador para encontrar la Matriz de Transformacin Homognea T
26
Fig. 2.6 Relaciones de Cinemtica Directa para conocer la localizacin espacial del Efector Final o
Extremo del Robot
27
Fx ( q1,q2,q3,q4,q5,q6 )
Fy ( q1,q2,q3,q4,q5,q6 )
Fz ( q1,q2,q3,q4,q5,q6 )
F( q1,q2,q3,q4,q5,q6 )
F ( q1,q2,q3,q4,q5,q6 )
F( q1,q2,q3,q4,q5,q6 )
(2.1)
(2.2)
28
Del mismo modo, denominando 0Ak a las matrices resultantes del producto de las matrices
(i-1)Ai con i desde 1 hasta k, se puede representar de forma total o parcial la cadena
cinemtica que forma el robot, as por ejemplo, la posicin y orientacin del sistema
solidario con el segundo eslabn del robot con respecto al sistema de coordenadas de la
base se puede expresar mediante la matriz 0A2:
0A2 = 0A1 ( 1A2 )
(2.3)
De manera anloga, la matriz 0A3 representa la localizacin del sistema del tercer eslabn:
0A3 = 0A1 ( 1A2 )( 2A3 )
(2.4)
Cuando se consideran todos los grados de libertad, a la matriz 0An se le suele denominar T,
as dado un robot de seis grados de libertad, se tiene que la posicin y orientacin del
eslabn final vendr dada por la matriz T:
T = 0A6 = 0A1 ( 1A2 )( 2A3 )( 3A4 )( 4A5 )( 5A6 )
(2.5)
Aunque para descubrir la relacin que existe entre dos elementos contiguos se puede hacer
uso de cualquier sistema de referencia ligado a cada elemento, la forma habitual que se
suele utilizar en robtica es la representacin de Denavit-Hartenberg.
Denavit-Hartenberg propusieron en 1955 un mtodo matricial que permite establecer de
manera sistemtica un sistema de coordenadas (Si) ligado a cada eslabn i de una cadena
articulada, pudindose determinar a continuacin las ecuaciones cinemticas de la cadena
completa.
29
Ai R( zi 1 , i ) D( zi 1 , d i ) D( xi , ai ) R( xi , i )
(2.6)
c i
s
i
0
s i
c i
s
i
0
c i s i
s i s i
c i c i
s i c i
s i
c i
c i
0
0
0 0 1
0 0 0
1 0 0
0 1 0
0 1
1 0 0 0
0 1 d i 0
0 0 1 0
0 0
ai c i
ai s i
di
0 0 ai 1 0
1 0 0 0 c i
0 1 0 0 s i
0 0 1 0 0
0
s i
c i
0
0
0
0
(2.7)
(2.8)
Donde i, ai, di,i, son los parmetros D-H del eslabn i, de este modo, basta con
identificar los parmetros i, ai, di, i, para obtener matrices A y relacionar as todos y cada
uno de los eslabones del robot, como se ha indicado, para que la matriz i-1Ai, relacione los
sistemas (Si) y (Si-1), es necesario que los sistemas se hayan escogido de acuerdo a unas
determinadas normas, estas junto con la definicin de los 4 parmetros de DenavitHartenberg, conforman el siguiente algoritmo para la resolucin del problema cinemtico
directo.
30
31
Fig. 2.10 Relaciones de Cinemtica Inversa para encontrar los valores que deben adoptar las coordenadas
articulares del robot
(2.9)
32
No obstante, a pesar de las dificultades comentadas, la mayor parte de los robots poseen
cinemticas relativamente simples que facilitan en cierta medida la resolucin de su
problema cinemtico inverso.
Por ejemplo si se consideran solo tres primeros grados de libertad de muchos robots, estos
tienen una estructura planar, esto es, los tres primeros elementos quedan contenidos en un
plano, esta circunstancia facilita la resolucin del problema, asimismo en muchos robots se
da la circunstancia de que los tres grados de libertad ltimos, dedicados fundamentalmente
a orientar el extremo del robot, correspondan a giros sobre los ejes que se cortan en un
punto.
De nuevo esta situacin facilita el clculo de los valores de (q1,...,qn)exp. T
correspondiente a la posicin y orientacin deseadas, por lo tanto, para los casos citados y
otros, es posible establecer ciertas pautas generales que permitan plantear y resolver el
problema cinemtico inverso de una manera sistemtica.
Los mtodos geomtricos permiten tener normalmente los valores de las primeras variables
articulares, que son las que consiguen posicionar el robot, para ello utilizan relaciones
trigonometras y geomtricas sobre los elementos del robot, se suele recurrir a la resolucin
de tringulos formados por los elementos y articulaciones del robot. Como alternativa para
resolver el mismo problema se puede recurrir a manipular directamente las ecuaciones
correspondientes al problema cinemtico directo, es decir, puesto que este establece la
relacin:
Tij
n o a
0 0 0 1
(2.10)
Donde los elementos Tij son funciones de las coordenadas articulares (q1,...,qn)exp. T, es
posible pensar que mediante ciertas combinaciones de las ecuaciones planteadas se puedan
despejar las n variables articulares qi en funcin de las componentes de los vectores n, o, a
y p.
Fonseca Mucio Ral
Maya Santos Manuel
33
34
35
Por lo tanto, los sistemas de control de los manipuladores robticos industriales suele
convertir las especificaciones en el espacio de trabajo a un conjunto de valores deseados
para las variables articulares, empleando para ello la cinemtica inversa; de esta forma, el
problema de generacin de trayectorias se plantea normalmente en el espacio articular, en
cuyo caso se trata de especificar la posicin, velocidad y aceleracin para cada una de las
articulaciones.
No se debe olvidar que las trayectorias generadas deben tener buenas propiedades con
vistas a su ejecucin por el robot, por consiguiente es necesario tener en cuenta, directa o
indirectamente, las restricciones cinemticas y dinmicas involucradas, en general las
trayectorias deben ser suaves, lo que implica restricciones sobre las derivadas, normalmente
se exige que al menos la primera derivada sea continua, pudiendo exigirse tambin la
continuidad en derivadas de orden superior.
El problema de la generacin de trayectorias debe resolverse en tiempo real, por lo tanto se
trata tambin de que la generacin de trayectorias sea computacionalmente eficiente, en
robots manipuladores, la generacin de trayectorias articulares suele realizarse en tiempos
del orden de los milisegundos o decenas de milisegundos.
36
Todos los puntos son alcanzables, pero cuando el robot pasa por la mitad, la
velocidad de la primera articulacin es muy alta, esta velocidad es tanto ms alta
cuanto ms se aproxima el camino al eje de la primera articulacin, para resolver el
problema puede limitarse la velocidad del camino al impuesto por el lmite de
velocidad de las articulaciones, obviamente las propiedades temporales se pierden.
37
38
39
Un uso muy comn de los sistemas embebidos es en los sistemas de tiempo real,
entendindose por sistemas en tiempo real a aquellos sistemas en los que el control del
tiempo es vital para su correcto funcionamiento, los sistemas en tiempo real necesitan
realizar ciertas operaciones o clculos en un lmite de tiempo; donde ese limite de tiempo
resulta crucial, un ejemplo claro de un sistema de tiempo real es el control de trafico areo.
40
Fig. 2.14 Orientacin del Campo Magntico de los Polos Norte y Sur.
Como se observa, estos polos pueden ser invertidos fcilmente con slo cambiar la
polaridad de la bobina, por lo cual, se sabe que las cargas opuestas o polos opuestos se
atraen y cargas del mismo signo o polos del mismo signo se repelen, esto hace que el eje
del motor gire produciendo un determinado torque.
Fig. 2.15 Generacin del torque del Motor por medio de la repulsin de las cargas.
El Torque del motor es simplemente la fuerza de giro, se podra llamar la potencia que tiene
el motor, la cual depende de varios factores, como la cantidad de corriente, el espesor del
alambre de cobre, la cantidad de vueltas del bobinado, la tensin etc. esto es algo que ya
viene determinado por el fabricante.
41
42
Aplicando una seal positiva en la entrada marcada como Avance, se hace conducir al
transistor Q1. La corriente Q1 circula por las bases, de Q2 y Q5, haciendo que el terminal
a del motor reciba un positivo y la terminal b el negativo.
43
Un circuito PWM da como resultado una onda cuadrada con ciclo variable de ON y Off,
variando en el tiempo del 0 al 100 %, de esta manera, una cantidad variable de potencia es
transferida a la carga, consiste en enviar a las terminales de control un tren de pulsos, los
cuales varan en mayor o menor medida el tiempo en que se mantiene el nivel alto de esos
pulsos, manteniendo la frecuencia constante.
Fig. 2.20 Tren de Pulsos con el cual se controlan los niveles altos y bajos del tiempo.
2.9 Servomotores.
Los servos son un tipo especial de motor de c.c. que se caracterizan por su capacidad para
posicionarse de forma inmediata en cualquier posicin dentro de su intervalo de operacin,
para ello el servomotor espera un tren de pulsos que se corresponde con el movimiento a
realizar. Estn generalmente formados por:
1 amplificador.
1 motor.
1 circuito de realimentacin.
Todo en una misma caja de pequeas dimensiones, el resultado es un servo de posicin con
un margen de operacin de 180 aproximadamente.
44
Se dice que el servo es un dispositivo con un eje de rendimiento controlado ya que puede
ser llevado a posiciones angulares especficas al enviar una seal codificada, con tal de que
exista una seal codificada en la lnea de entrada, el servo mantendr la posicin angular
del engranaje, cuando la seal codificada cambia, la posicin angular de los piones
cambia; en la prctica se usan servos para posicionar elementos de control como palancas,
pequeos ascensores y timones, tambin se usan en radio-control, marionetas y por
supuesto en robots.
Los Servos son sumamente tiles en robtica, ya que los motores son pequeos, un motor
como el de la figura 2.21 posee internamente una circuitera de control y es sumamente
potente para su tamao, un servo normal o estndar como el HS-300 de Hitec proporciona
un par de 3 kgcm a 4.8 V, lo cual es bastante para su tamao, sin consumir mucha energa,
la corriente que requiere depende del tamao del servo, normalmente el fabricante indica
cual es la corriente que consume eso no significa mucho si todos los servos van a estar
movindose todo el tiempo, la corriente depende principalmente del par y puede exceder un
ampere si el servo est enclavado.
45
El motor del servo tiene algunos circuitos de control y un potencimetro conectado al eje
central del motor, en la figura 2.22 se puede observar el potencimetro que permite a la
circuitera de control, supervisar el ngulo actual del servomotor, si el eje est en el ngulo
correcto, entonces el motor est apagado, si el circuito chequea que el ngulo no es
correcto, el motor se mover hasta llegar al ngulo deseado; el eje del servo es capaz de
llegar alrededor de los 180 grados, normalmente en algunos llega a los 210 grados, pero
vara segn el fabricante.
Un servo normal se usa para controlar un movimiento angular de entre 0 y 180 grados, un
servo normal no es mecnicamente capaz de retornar a su lugar, si hay un mayor peso que
el sugerido por las especificaciones del fabricante.
El voltaje aplicado al motor es proporcional a la distancia que ste necesita viajar, as si el
eje necesita regresar una distancia grande, el motor regresar a toda velocidad. Si este
necesita regresar slo una pequea cantidad, el motor girar a menor velocidad, a esto se le
denomina control proporcional.
46
Fig. 2.23 PWM para recorrer todo el rango de operacin del servo
El sistema de control de un servo se limita a indicar en que posicin se debe situar, esto se
lleva a cabo mediante una serie de pulsos tal que la duracin del pulso indica el ngulo de
giro del motor, cada servo tiene sus mrgenes de operacin, que se corresponden con el
ancho del pulso mximo y mnimo que el servo entiende; los valores ms generales se
corresponden con pulsos de entre 1 ms y 2 ms de anchura, que dejaran al motor en ambos
extremos (0 y 180), el valor de 1.5 ms indicara la posicin central o neutra (90),
mientras que otros valores del pulso lo dejan en posiciones intermedias, estos valores
suelen ser los recomendados, sin embargo, es posible emplear pulsos menores de 1 ms o
mayores de 2 ms, pudindose conseguir ngulos mayores de 180; si se sobrepasan los
lmites de movimiento del servo, ste comenzar a emitir un zumbido, indicando que se
debe cambiar la longitud del pulso, el factor limitante es el tope del potencimetro y los
lmites mecnicos constructivos.
El perodo entre pulso y pulso (tiempo de OFF) no es crtico, e incluso puede ser distinto
entre uno y otro pulso, se suelen emplear valores aproximados a 20 ms (entre 10 ms y 30
ms), si el intervalo entre pulso y pulso es inferior al mnimo, puede interferir con la
temporizacin interna del servo, causando un zumbido y la vibracin del eje de salida, si es
mayor que el mximo, entonces el servo pasar a estado dormido entre pulsos esto provoca
que se mueva con intervalos pequeos.
Es importante destacar que para que un servo se mantenga en la misma posicin durante un
cierto tiempo, es necesario enviarle continuamente el pulso correspondiente, de este modo,
si existe alguna fuerza que le obligue a abandonar esta posicin intentar resistirse, si se
deja de enviar pulsos (o el intervalo entre pulsos es mayor que el mximo) entonces el
servo perder fuerza y dejar de intentar mantener su posicin, de modo que cualquier
fuerza externa podra desplazarlo.
47
CAPTULO III
CINEMATICA Y DESARROLLO DEL
BRAZO ROBTICO
48
Un robot manipulador puede ser diseado y programado para diversas labores, sin embargo
esta no es una tarea fcil, para ello es necesario un enfoque analtico de su funcionamiento
de acuerdo a sus caractersticas fsicas (arquitectura, configuracin, grados de libertad, tipo
de control, etc.) por eso resulta importante el desarrollo de modelos matemticos.
Este robot tiene una configuracin angular que cuenta con 5 Grados De Libertad (GDL),
cada articulacin realiza movimientos rotatorios desarrollados por actuadores que para este
caso son servomotores de 5 volts de corriente directa (VCD) y su posicionamiento se
controla a travs de su Modulacin por Ancho de Pulso (PWM). Cada par generado por los
servomotores es transmitido por sistemas de engranaje, los elementos que integran el brazo
manipulador estn construidos de cintra (PVC comprimido), plstico y aluminio.
Eslabn 1.
Eslabn 2.
Mueca.
Gripper (Pinza).
Contrapeso.
Base Giratoria.
Motoreductor de 12 V.
49
ISOMTRICO FRONTAL
ISOMTRICO POSTERIOR
50
11A
10
13
13
11B
13
12
Elementos de la Base
12
9
13
13
12
4
12
8
3 13
No. De Descripcin
Pieza
6
7
1
2
3
12
4
5
6
7
8
9
10
11A
11B
12
13
1
5
Base Fija
Base Giratoria
Potencimetro
Engrane
de
Base
Giratoria
Motoreductor
Pin del Motoredcutor
Base del Brazo
Brazo
Antebrazo
Mueca
Gripper (Pinzas)
Gripper (Base)
Servomotor
Accesorios de Sujecin
Cantidad
No. De
Plano
1
1
1
1
2
3
1
1
1
1
1
1
1
1
5
6
5
6
7
8
9
10
11A
11B
12
13
Acot. mm
Esc. Ninguna
Fecha: 10/04/09
FonsecaMucioRal
MayaSantosManuel
51
Plano
Principal
52
El espacio de trabajo de nuestro brazo manipulador esta definido por los grados de libertad
que posee, que en este caso son 4 GDL, tambin se tomaron en cuenta las limitantes de sus
actuadores: el hombro, codo y mueca solo nos pueden ofrecer movimientos hasta 180o,
esto debido a que los servomotores no pueden exceder este rango, el movimiento de la
cadera tambin quedo limitado a 180o, debido no al actuador que es un motor de C.C. que
no tiene limitantes en el giro, sino al potencimetro de la base que utilizamos para la
posicin, tambin se consideraron las longitudes de los eslabones y la altura de la base;
sumado todo esto el espacio de trabajo quedo definido como se muestra en las figuras 3.3 y
3.4.
53
Eslabn
Hombro
Codo
Mueca
Giro del gripper
*Apertura y cierre
gripper
Angulo obtenido
cinemtica inversa
-19.0048
71.4264
-52.4160
4.4191
del Gripper abierto
en
54
Con ayuda de los elementos mencionados, la cadera del manipulador podr efectuar
movimientos en ambos sentidos de giro y detenerse en un punto especfico con una buena
precisin. Para ver ms informacin acerca de la conexin del puente H al motor de la
cadera ver anexo C
55
Y1
X1
Z0
B
Z2
Z3
Y4
X2
X3
Z4
Y3
Y2
Y0
C
Y5
Z5
X4
X5
X0
Fig. 3.7 Anlisis Geomtrico del Brazo Robtico
El valor de A es cero debido a que el eje de la base del Brazo Robtico coincide con el eje
del hombro considerando esta situacin se procede a obtener los parmetros de DenavitHartenberg.
PARAMETROS DE LA MATRIZ DE DENAVIT-HARTENBERG
Articulacin
1
2
3
4
5
0
0
0
90
0
-90
0
0
90
0
d(mm)
74.5
0
0
0
77.92
a(mm)
0
180
110
0
0
56
Matriz de Denavit-Hartemberg:
DH =
(3.1)
cos
sin
i 1
Ai
0
sin cos
sin sin
cos cos
cos sin
sin
cos
a cos
a sin
d
(3.2)
Con base en la matriz anterior y sustituyendo los valores angulares para cada articulacin se
obtienen un total de 5 matrices que se muestran en la ecuacin (3.3).
C1 0 S S
S
0
C1
0
A1 1
0 1
0
0
0
0
AC1
AS1
B
C 4
S
3
A4 4
0
C 2
S
1
A2 2
0
0
0
S 4
0 C 4
1
S 2
C 2
0
0
0
0
0
0 CC 2
C3 S3
S
C3
0 CS 2 2
A3 3
0
0
1
0
0
0
1
0
C5
S
4
A5 5
0
S5 0
C5
0
0
0 0
1 E
0 1
0 DC3
0 DS3
1
0
0
1
(3.3)
57
A5
S234C5
EC234 DS23 CS2 B
S234S5
C234
0
0
0
1
(3.4)
Inicio
Se introducen
los
valores
angulares.
En
base
a
los
valores
geomtricos exclusivos del robot
y con los valores angulares se
forman los parmetros de
Denavit-Hartenberg .
Se muestra la Matriz M en
donde se localiza las
coordenadas de posicin del
gripper.
Fin
58
Introduciendo los valores angulares en forma de vector para su posicin inicial ([0 0 0 90
0]), tomando esta cuando el Brazo Robtico este totalmente extendido se obtienen los
siguientes resultados:
(3.5)
(3.6)
A2 =
1
0
0
0
0
1
0
0
0 180
0 0
1 0
0 1
0
1
0
0
0 110
0 0
1 0
0 1
(3.7)
A3 =
1
0
0
0
(3.8)
59
A4 =
0
1
0
0
0
0
1
0
1
0
0
0
0
0
0
1
(3.9)
A5 =
1.0000
0
0
0
0 1.0000
0
0
0
0 1.0000 77.9200
0
0
0 1.0000
(3.10)
La Matriz M
M=
0
0
1.0000 367.9200
0
1.0000
0
0
-1.0000
0
0
74.5000
0
0
0
1.0000
(3.11)
367.9200
0
74.5000
1.0000
Px
Py
Pz
(3.11)
60
La representacin Grafica del robot en estas coordenadas que son su posicin inicial es la
siguiente:
Para corroborar otra posicin del Brazo Robtico, se introducen los nuevos valores de los
ngulos, que son [0 45 -90 135 0], con estos datos en el programa se obtiene lo siguiente:
45 -90 135
(3.12)
61
La Matriz M
M=
-0.0000
0
-1.0000
0
0
1.0000
1.0000
0
0
-0.0000
0
0
282.9810
0
25.0025
1.0000
Px
Py
Pz
(3.13)
Se obtiene entonces que las coordenadas de la posicin del gripper son 367.92mm en el eje
X, 0mm en el eje Y y 74.5mm en el eje Z y con base en su configuracin angular, el
brazo robtico tendra la siguiente posicin.
62
Para resolver el problema de la cinemtica inversa para este Brazo Robtico, se utilizan
mtodos numricos, debido a que por otros procedimientos resulta complicado y en algunos
la solucin no es la correcta.
Se utilizo tambin la herramienta computacional Matlab, por lo que se elaboro en dicho
software un programa para la resolucin de este problema basndose en ciclos o
iteraciones, donde se hacen aproximaciones para encontrar un valor aproximado al valor
real y obtener un error mnimo de
, a continuacin se muestra el diagrama de
flujo:
Inicio
Se introduce el Vector
de Posicin de origen.
Se
introduce
las
coordenadas
de
orientacin del Gripper.
Se introduce el Guess
inicial o la aproximacin
angular inicial.
63
Fin
Aplicando el mtodo de NewtonRaphson, a la matriz con los
incrementos se le resta la matriz sin
incrementos y se divide entre el
incremento.
No
B
El valor de las 12
funciones es 1.0e-9
Si
64
Para iniciar se parten de 12 ecuaciones por cada grado de libertad del Brazo Robtico, que
se obtienen del modelo que resulta de la cinemtica directa, por lo que se tienen 12
ecuaciones por n incgnitas o n grados de libertad y son las siguientes:
f1 C1C234C5 S1S5
f 2 S1C234C5 C1S5
f 3 S 234C5
f 4 C1C234S5 S1C5
f 5 S1C234S5 C1C5
f 6 S 234S5
f 7 C1S 234
f 8 S1S 234
(3.14)
f 9 C234
Se especifican los valores deseados para [n s a p], que es la matriz de posicin orientacin a
donde queremos que se coloque nuestro efector final o gripper, como este mtodo es en
base de aproximaciones, se da un guess inicial sobre el valor angular de cada
articulacin, lo que significa que se propone una configuracin angular para que los
clculos partan de esta y se vaya obteniendo cada vez un error ms pequeo.
Como se menciono anteriormente, este mtodo depende de la configuracin del robot, con
lo cual es necesario dar el vector constante, este vector est conformado por las longitudes
del robot, lo que significa que est compuesto por los valores de las variables A, B,
C, D y E definidas en el tema 3.2.1
Para poder calcular los valores angulares, se utilizan las 12 ecuaciones del modelo para
cada grado de libertad, a las cuales vamos a restarles el valor de cada coordenada de la
matriz de orientacin, a cada ecuacin se le va a restar la coordenada correspondiente:
65
f1 C1C234C5 S1S5 nx
f 2 S1C234C5 C1S5 n y
f3 S234C5 nz
n x
n
M y
nz
f 4 C1C234S5 S1C5 s x
f5 S1C234S5 C1C5 s y
f 6 S234S5 s z
f 7 C1S 234 a x
sx
ax
sy
ay
sz
az
px
p y n s a p
p z 0 0 0 1
f8 S1S234 a y
(3.15)
f9 C234 a z
f1
f2
f
f 12
f1
f1
f1
f2
f2
f2
f 12
f 12
f 12
f1
f 2
f 12
, como la que se
(3.16)
El mtodo que se est utiliza para obtener la solucin de la cinemtica inversa se basa en la
resolucin del jacobiano, con lo cual la matriz queda de la siguiente forma:
f1
1
f 2
J 1
f n
f1
2
f 2
2
f n
2
f1
m
f 2
f n
(3.17)
66
Para que se pueda completar la solucin se tiene que hacer cumplir la condicin inicial de
las 12 funciones por grado de libertad, por lo cual se tiene que agregar un incremento y as
poder resolver el sistema que se describe en la ecuacin (3.18).
f , ,2 ,n f1 1 ,2 ,n
f1
1 1
1
(3.18)
Se observa que para obtener la solucin, las 12 funciones por grado de libertad con el
incremento se restan de las 12 funciones sin incremento y el resultado se divide entre el
incremento. Para poder actualizar el nuevo valor se tiende a obtener el jacobiano, pero
como el jacobiano no es una matriz cuadrada no se puede calcular su matriz inversa, por lo
que se calcula su matriz pseudoinversa, posteriormente la pseudoinversa se multiplica por
las 12 funciones del modelo pero negativas para ir reduciendo el error, el resultado que se
obtiene es una matriz como la que se muestra en la ecuacin (3.19).
(3.19)
Para que pueda ser aadida a la actualizacin de la nueva configuracin angular se tiene
que obtener su transpuesta, consiguiendo una ecuacin como la siguiente:
(3.20)
El resultado de la transpuesta se puede agregar a la configuracin angular que se tiene, todo
este proceso se repite n veces actualizando en cada iteracin el valor de la funcin,
consiguiendo con esto que cada vez el valor del error sea menor, hasta que se cumple la
condicin de obtener un error en el valor angular aproximado de
.
Para que el programa mencionado anteriormente nos de la solucin de la cinemtica inversa
para este robot manipulador, se tiene que introducir el punto en el que se quiere posicionar
el brazo robtico, luego dar los el valor del eje X, Y y Z para formar la matriz de
posicin, despus se introduce el guess inicial que es la propuesta de los valores angulares
de los cuales el programa va a partir.
Para comprobar que el programa funciona correctamente, se introduce el siguiente vector
de coordenadas para la posicin del gripper, que es [237.2792 0 123.8592], que en
realidad significa 237.2792mm sobre el eje X, 0mm sobre el eje Y y 123.8592mm
sobre el eje Z, con lo cual el Brazo Robtico tendr la siguiente posicin:
67
Fig. 3.10 Posicin del brazo robtico para las coordenadas [237.2792 0 123.8592]
(3.21)
4.4191]
(3.22)
68
Para comprobar que los valores son correctos, se introducen en el programa que resuelve
la cinemtica directa, el resultado que se debe observar es: [237.2792 0 123.8592]. A
continuacin se muestra este procedimiento:
4.4191]
(3.23)
Tetas =
-0.0002 -19.0048 71.4264 -52.4160
4.4191
(3.24)
La Matriz M
M=
0.9970
0.0770
-0.0001
0
(3.25)
Como se puede observar, los valores encontrados son muy cercanos a los obtenidos en el
programa de la cinemtica inversa, debido a que el mtodo numrico no encuentra el valor
real sino una aproximacin, en este caso, es muy cercana al valor real con un error
prcticamente nulo.
Fonseca Mucio Ral
Maya Santos Manuel
69
Inicio
Se introduce el Vector
de Posicin de origen
y la aproximacin
inicial de los ngulos o
guess inicial.
Se calculan 10 puntos intermedios
entre el punto de origen y el punto
al que se desea llegar
Fin
70
Partiendo del punto [110 0 176.58] como origen, el programa de la cinemtica inversa
calcula su configuracin angular y la de los puntos que hay entre este y el punto al que se
quiere llegar, tomndolo como [237.2792 0 123.8592]. El resultado que otorga el programa
que calcula la generacin de trayectorias es el siguiente:
(3.26)
0.0014
(3.27)
71
-47.4151
-45.6618
-43.4854
-41.0974
-38.5516
-35.8628
-33.0278
-30.0312
-26.8445
-23.4226
(3.28)
Ahora, se toman los ltimos valores angulares y se introducen al programa que calcula la
cinemtica directa y los resultados son los siguientes:
0.0125]
(3.29)
Tetas =
0 -23.4226 82.9039 -56.8895
0.0125
(3.30)
72
La Matriz M
M=
0.9990 -0.0002 0.0452
0.0002 1.0000
0
-0.0452 0.0000 0.9990
0
0
0
232.5513
0
126.1311
1.0000
(3.31)
Con lo cual se puede apreciar que los valores son prcticamente los mismos, esto por el
error de aproximacin que surge en la cinemtica inversa.
NOTA: Se puede observar en los temas anteriores, que las ecuaciones que se desarrollaron
para calcular la cinemtica directa, la cinemtica inversa y la generacin de trayectorias,
son para un manipulador robtico de 5 grados de libertad y el manipulador que se presenta
es de 4 grados de libertad; esto se debe a que por motivos de presupuesto y tiempo no se
logro dotar del quinto grado de libertad a nuestro manipulador robtico, pero se
conservaron los clculos para futuras modificaciones.
73
CAPTULO IV
IMPLEMENTACIN
74
75
A menudo se utiliza la sujecin por la fuerza de apriete, pero se tiene que considerar en este
caso lo siguiente: para sujetar el objeto, los dedos tienen que ejercer una fuerza FG de por lo
menos FG = m g/, en este caso, es el coeficiente de rozamiento y m la masa de la
pieza, en una operacin de montaje esta fuerza no es suficiente, pues hay que aadirle la
fuerza del propio ensamblaje FS, por consiguiente, la fuerza necesaria de sujecin ser FG =
(m g + FS)/.
Si se supone un coeficiente de rozamiento de 0,1, la fuerza de sujecin FG sera 10 veces
superior a la suma formada por el peso de la pieza a manejar y la fuerza de ensamblaje, esto
puede producir deformaciones o deterioros del objeto, sobre todo cuando se manipulan
piezas delicadas, es por ello aconsejable utilizar, por ejemplo una sujecin con forma. La
figura 4.2 muestra algunas formas de sujecin para diferentes objetos.
76
Cuando una pieza es levantada rpidamente, no slo est sometida a la fuerza debida al
peso m g , sino tambin a una fuerza de inercia FT que es funcin de la aceleracin
vertical, en cambio si se gira la mano 90 antes de elevar la pieza, la sujecin por fuerza se
transforma temporalmente casi en una sujecin con forma para este movimiento, estos
ejemplos muestran que la pinza es un componente en el que influyen muchos factores y que
nunca debe utilizarse sin considerar las diferentes posibilidades.
77
Fig. 4.4 Elementos que interactan en la sujecin de piezas, 1 Dedo, 2 Mandbula, 3 Pieza, Coeficiente
de rozamiento
78
Fig. 4.5 Vista en planta de dos situaciones de pinzado, Pinza de dos dedos con mandbula en V y Pinza de
tres dedos.
Si, en el caso de la pinza de dos dedos, se elige una mandbula con un ngulo 120, el
mismo que la posicin de los dedos en una pinza de tres dedos, ambas pinzas seran iguales
respecto a las fuerzas de sujecin, slo habr diferencias con otros ngulos de mandbula,
en estos casos debemos referirnos a ngulos de contacto, que pueden determinarse por la
siguiente frmula, si se permite cualquier ngulo de mandbula:
(4.3)
En donde:
i = 1, 2, 3
1 = 180 23
2 = 180 13
3 = 180 12
El total de las 3 fuerzas de rozamiento FR1 a FR3 debe ser por lo menos suficientemente
grande para compensar la fuerza G debida al peso producida por la gravedad, tambin
debern conocerse las fuerzas de contacto si queremos comprobar la presin de sujecin
por unidad de superficie en el caso de piezas sensibles.
79
80
Fig. 4.7 Diversos movimientos tpicos y las fuerzas que se producen en ellos.
En la figura 4.7 se muestran algunos movimientos y las fuerzas que se producen en cada
uno, las cuales son:
a) En reposo
b) Movimiento ascendente
c) Movimiento descendente
d) Movimiento lateral
e) Movimiento ascendente inclinado.
En condiciones de funcionamiento normales es posible utilizar los valores de aceleracin
que alcanzan los robots, sin embargo esto no sera del todo correcto, ya que los valores
crticos no son los de las condiciones normales, sino los de las situaciones excepcionales,
especialmente las que siguen a una PARADA DE EMERGENCIA del robot, podemos
tomar los siguientes valores estndar para la aceleracin:
Aceleracin en funcionamiento normal, lineal: a = 5 m/s2,
Aceleracin por PARO DE EMERGENCIA, lineal: aN = 10 m/s2,
Aceleracin en funcionamiento normal, rotativa: = 10 rad/s2
Aceleracin por PARO DE EMERGENCIA, rotativa: N = 17 rad/s2.
81
82
FG
0.2466 N
n
(0.6)(2)
1.2
(4.4)
FG
m g S
(0.01)(9.8)(2)
0.196
m a
(0.01)(5)
0.05 0.213N
n
(0.6)(2)
1.2
(4.5)
0.33N
n
(0.6)(2)
1.2
Cilindros
(4.6)
(4.7)
m( g a) 0.01(9.8 5) 0.148
0.085 N
2 cos
2 cos 30' '
1.732
(4.8)
(4.9)
(m)( g )
(0.01)(9.8)
(m a)
(0.01 5) 0.106 N
2 cos
2 cos 30' '
(4.10)
(4.11)
(4.12)
83
FK 2
m( g a N ) 0.01(9.8 10)
0.114 N
2 cos
2 cos 30
(4.13)
(4.14)
(4.15)
Una vez que se han obtenido los resultados de las fuerzas para la sujecin en el gripper, el
siguiente paso es el anlisis, montaje y construccin del diagrama de flujo que nos van a
permitir la seleccin y manipulacin de piezas.
Son dispositivos que tienen una capa delgada de plstico, la cual, muestra una disminucin
de resistencia con un incremento de fuerza en el rea de contacto, su sensibilidad de fuerza
es optimizada para el empleo en el control o manejo de contacto, de dispositivos
electrnicos.
84
Tiene una resistencia variable en funcin de la presin aplicada y se rige por el principio
piezorresistivo, estos dispositivos se fabrican con un material elstico en cuatro capas,
consistiendo en:
Una capa de plstico elctricamente aislador.
Un rea activa que consiste en una serie de conductores.
Un espaciador plstico.
Un substrato flexible.
La gama usable de la seal de salida de un FSR es casi lineal, si se aplica bastante fuerza,
su respuesta se convierte en no lineal debido a la saturacin del sensor, tiene una baja
exactitud, con errores de hasta un 25% de salida; sin embargo, es excelente para
aplicaciones donde se necesita una medicin cualitativa.
85
1
2
3
86
Despus de definir la forma de los palpadores y el arreglo de sensores, el siguiente paso que
se tomo fue la de desarrollar un diagrama de flujo que en base a la seal de los sensores nos
permita la seleccin y manipulacin de piezas.
Si
Sensor 2
detecta fuerza?
Si
No
El objeto es de forma
cubica, y se procede a
mover a la zona designada
para estas piezas.
Sensor 1y 3
detectan fuerza?
El objeto tiene forma
cilndrica y est en
posicin horizontal y se
procede a mover a la
zona designada para
estas piezas.
Si
Se desea hacer
otra seleccin?
No
Fin
87
Fig. 4.13 Vista del form del programa desarrollado en Visual Basic.
Como se puede apreciar en la figura 4.13, del lado izquierdo se encuentran 5 slider que
corresponden a los movimientos de la cadera, hombro, codo, mueca y gripper; del lado
superior derecho hay un recuadro, que nos muestra la posicin a la que se esta moviendo la
articulacin, dependiendo del slider que este en funcionamiento, adems del lado inferior
derecho hay una imagen que nos indicara que el gripper esta movindose.
Este programa podr sufrir modificaciones en el futuro, dependiendo de la aplicacin que
se le desee dar al manipulador, de las especificaciones del proceso y de la habilidad del
programador.
Nota: Se decidi usar el programa Visual Basic 6.0, debido a que cuentan con
comunicacin directa va USB con las tarjetas pidhget.
88
CAPITULO V
CONCLUSIONES
89
90
GLOSARIO
Aceleracin de coriolis: es una aceleracin ficticia que se puede observar cuando un
objeto se desplaza sobre una plataforma que se encuentra girando, desde el punto de vista
del observador situado en el sistema de referencia que gira, el objeto se curva y se desva de
su trayectoria; sin embargo, para un observador exterior, el objeto describe una trayectoria
rectilnea.
Algoritmo: [sust. masc.] Conjunto ordenado y finito de operaciones que permite hallar la
solucin de un problema. Mtodo y notacin en las distintas formas del clculo.
Androide: (Del gr. aner, andrs, varn, y eidos, forma.) m. Autmata de figura de hombre.
ngulos de Euler: constituyen un conjunto de tres coordenadas angulares que sirven para
especificar la orientacin de un sistema de referencia de ejes ortogonales, normalmente
mvil, respecto a otro sistema de referencia de ejes ortogonales normalmente fijos.
Automata: [sust. masc.] Instrumento que encierra dentro de s el mecanismo que le
imprime determinados movimientos. [fig.] [Fam.] Persona excesivamente dbil, que se deja
dirigir por otra.
Bits: (Plural de bit), Unidad de medida de la capacidad de memoria, equivalente a la
posibilidad de almacenar la seleccin entre dos posibilidades, especialmente usadas en los
computadores.
Bucle de control: Un bucle o ciclo, en programacin, es una sentencia que se realiza
repetidas veces a un trozo aislado de cdigo, hasta que la condicin asignada ha dicho bucle
deje de cumplirse, el bucle es una estructura de control en la que se puede indicar el nmero
mximo de iteraciones, est disponible en casi todos los lenguajes de programacin
imperativos.
Bucle de retroalimentacin: es un proceso por el que una cierta proporcin de la seal de
salida de un sistema se redirige de nuevo a la entrada. Esto es de uso frecuente para
controlar el comportamiento dinmico del sistema.
Chips: es una pastilla pequea de silicio, de algunos milmetros cuadrados de rea, sobre la
que se fabrican circuitos elctricos con base a dispositivos constituidos por
semiconductores y que est protegida dentro de un encapsulado de plstico o cermica. El
encapsulado posee conductores metlicos apropiados para hacer conexin entre la pastilla y
un circuito impreso.
CMOS: (del ingls Complementary Metal Oxide Semiconductor, "Metal xido
Semiconductor Complementario") es una de las familias lgicas empleadas en la
fabricacin de circuitos integrados (chips).
Fonseca Mucio Ral
Maya Santos Manuel
91
92
R
T 3*3
f1*3
p3*1 Rotacin
Traslacin
Matriz jacobiana: es una matriz formada por las derivadas parciales de primer orden de
una funcin, una de las aplicaciones ms interesantes de esta matriz es la posibilidad de
aproximar linealmente a la funcin en un punto; en este sentido, el Jacobiano representa la
derivada de una funcin multivariable.
Mtodos numricos iterativos: Un mtodo indirecto da lugar a una sucesin de vectores
que idealmente converge a la solucin, el clculo se detiene cuando se cuenta con una
solucin aproximada con cierto grado de precisin especificado de antemano o despus de
cierto nmero de iteraciones, los mtodos indirectos son casi siempre iterativos: para
obtener la sucesin mencionada se utiliza repetidamente un proceso sencillo.
Fonseca Mucio Ral
Maya Santos Manuel
93
94
Timer: (Temporizador), estn presentes en casi todos los circuitos electrnicos y son la
aplicacin anloga ms comn de la electrnica de control, su principio de funcionamiento
se basa el tiempo de descarga de los condensadores (C), normalmente asociados a una
resistencia de carga (R), en lo que se conoce como circuitos RC.
Yuxtaposicin: Unin de dos o ms frases u oraciones con funciones idnticas, que se
realiza mediante signos de puntuacin y en la que no se establece una relacin de
subordinacin entre ellas.
95
BIBLIOGRAFA
www.robothalloffame.org/unimate.html.
www.worldrobotics-online.org.
Robots Industriales Manipuladores, Rafael Iigo Madrigal, Enric Vidal Idiarte, Alfa
omega
Robtica industrial, tecnologa, programacin y aplicaciones, Autor Mikell Groover
Mitchell Weiss, Mc graw hill
Entrevista al doctor Eduardo Gmez, de la Universidad La Salle de Mxico
elaborada el 3 de octubre del 2007
http://mensual.prensa.com/mensual/contenido/2007/05/26/hoy/vivir/992775.html
http://robotilandia.blogspot.com/2007/08/componentes-de-un-robot.html
Robtica, Manipuladores y Robots Mviles, Anbal Ollera Baturone, 2001, Ed
Marcombo Espaa.
Curso de Robotica, Jose M. Angulo Usategui, Rafael Aviles Gonzales, 1989, Ed
Paraninfo Espaa.
Robot Technology Fundamentals, James G. Keramas, 1999 Ed, Delmar Publishers
Manipuladores Robticos, Cinemtica Directa e Inversa, Articulo de Miguel Torres
Torriti. Universidad Catolica de Chile
Las pinzas y sus aplicaciones, Stefan Hesse, FESTO
http://es.wikipedia.org/wiki/Sistema_integrado"
http://www.interlinkelectronics.com/force_sensors/technologies/index1.html
Robtica: Manipuladores y robots mviles, Escrito por Anbal Ollero Baturone,
Edicin: illustrated, Publicado por Marcombo, 2001, ISBN 8426713130,
9788426713131, 447 pginas
Robtica, Escrito por John J. Craig, Edicin tercera publicado por Prentice Hall,
390 paginas
96
NDICE DE FIGURAS
Figura 1.1 Isaac Asimov. Escritor al que se le atribuye el trmino Robtica.....2
Figura 1.2 Automata creado por Leonardo Da Vinci.................................................3
Figura 1.3 Robot poli-articulado.....9
Figura 1.4 Robot movil.......9
Figura 1.5 Androide Asimo...10
Figura 1.6 Robot zoomrfico. El perro AIBO diseado por Sony...11
Figura 1.7 Robot hibrido ..11
Figura 1.8 Robot industrial o Robot manipulador............................................................11
Figura 1.9 Configuracin cartesiana para un Robot.13
Figura 1.10 Configuracion cilindrica para un Robot....13
Figura 1.11 Configuracion polar para un Robot.......14
Figura 1.12 Configuracion angular de brazo articulado...14
Figura 1.13 Configuracin SCARA para un Robot.....15
Figura 1.14 Robot cirujano Da Vinci...16
Figura 1.15 Robots pintores en una planta automotriz.17
Figura 1.16 Robot manipulador de ABB (ABB Mxico).....18
Figura 1.17 Robots manipuladores en el CNDA (Robots para la Educacion en Mxico)18
Figura 2.1 Robot y su interaccin con el entorno.....21
Figura 2.2 Robot Manipulador de ABB (ABB Mxico)..22
Figura 2.3 Sistema Basico de un Robot Manipulador..23
Figura 2.4 Esquema del manipulador PUMA 600........25
Figura 2.5 Representacin del Manipulador para encontrar la Matriz de Transformacin
Homognea T.......26
Figura 2.6 Relaciones de Cinemtica Directa para conocer la localizacin espacial del
Efector Final o Extremo del Robot.....27
Figura 2.7 Asociacin de referencia.....28
Figura 2.8 Sistemas de Coordenadas de Denavit-Hartenberg.29
Figura 2.9 Sistema de referencia segn Denavit-Hartenberg...31
Figura 2.10 Relaciones de Cinemtica Inversa para encontrar los valores que deben adoptar
las coordenadas articulares del robot....................................32
Figura 2.11 Robot Articular para el estudio de su Cinemtica Inversa....33
Figura 2.12 Representacin de puntos inalcanzables....37
Figura 2.13 Representacin de velocidades articulares altas....37
Figura 2.14 Orientacin del Campo Magntico de los Polos Norte y Sur....41
Figura 2.15 Generacin del torque del Motor por medio de la repulsin de las cargas....41
Figura 2.16 Principio de Inversin de Giro por Puente H42
Figura 2.17 Circuito de Puente H para el control de giro..42
Figura 2.18 Circuito del Control de Avance del Motor en el Puente H....43
Figura 2.19 Circuito del Control de Retroceso del Motor en el Puente H....43
Figura 2.20 Tren de Pulsos con el cual se controlan los niveles altos y bajos del tiempo44
Figura 2.21 Imagen de un Servomotor..45
Figura 2.22 Servomotor Desmontado..46
Fonseca Mucio Ral
Maya Santos Manuel
97
Figura 2.23 PWM para recorrer todo el rango de operacin del servo.....47
Figura 2.24 Tren de pulsos para control del servo....47
Figura 3.1 Isomtrico en Vista Frontal.50
Figura 3.2 Isomtrico en vista posterior50
Figura 3.2 Isomtrico en vista posterior52
Figura 3.4 Vista superior del espacio de trabajo...53
Figura 3.5 Conexin del puente H al motor de CC...55
Figura 3.6 Dimensiones del Brazo Robtico....55
Figura 3.7 Anlisis Geomtrico del Brazo Robtico....56
Figura 3.8 Posicin Inicial del Brazo Robtico....61
Figura 3.9 Posicin de la nueva configuracin angular [0 45 -90 135 0].62
Figura 3.10 Posicin del brazo robtico para las coordenadas [237.2792 0 123.8592].68
Figura 4.1 Mtodos de sujetar una pieza...76
Figura 4.2 formas de sujecin...76
Figura 4.3 Ley de interaccin de fuerzas..77
Figura 4.4 Elementos que interactan en la sujecin de piezas, 1 dedo, 2 mandbula, 3pieza,
Coeficiente de rozamiento....78
Figura 4.5 Vista en planta de dos situaciones de pinzado, Pinza de dos dedos con mandbula
en V y Pinza de tres dedos..79
Figura 4.6 Relaciones de las fuerzas de sujecin durante un movimiento ascendente.79
Figura 4.7 Diversos movimientos tpicos y las fuerzas que se producen en ellos81
Figura 4.8 sensores piezorresistivos FSR.....84
Figura 4.9 Capas de un FSR.85
Figura 4.10 Seal de salida de un FSR.85
Figura 4.11 Efector final o gripper del robot....86
Figura 4.12 Localizacin de los sensores en el gripper....86
Figura 4.13 Vista del form del programa desarrollado en Visual Basic....90
Figura C1 Circuito de conexin del puente h......126
Figura C2 Circuito de conexin del buffer 74LS243N...126
Figura C3 circuito de conexin de buffer y puente h juntos...127
NDICE DE TABLAS
Tabla 2.1 Diagrama entre Cinemtica Directa e Inversa.25
Tabla 3.1 tren de pulsos para los servos de las articulaciones..54
Tabla 3.2 Parmetros de la Matriz de Denavit-Hartenberg..56
Tabla 4.1 Sujecin por forma y rozamiento..80
Tabla 4.2 Correlacin prxima entre objetos y tipos de pinzas....82
98
ANEXO A
PLANOS DE LAS PARTES DEL BRAZO MANIPULADOR
99
Acot. mm
Esc. Ninguna
Plano
No. 1
Fecha: 10/04/09
100
Acot. mm
Esc. Ninguna
Plano
No. 2
Fecha: 10/04/09
101
Acot. mm
Esc. Ninguna
Plano
No. 3
Fecha: 10/04/09
102
Acot. mm
Esc. Ninguna
Plano
No. 4
Fecha: 10/04/09
103
Acot. mm
Esc. Ninguna
Plano
No. 5
Fecha: 10/04/09
104
Acot. mm
Esc. Ninguna
Plano
No. 6
Fecha: 10/04/09
105
Acot. mm
Esc. Ninguna
Plano
No. 7
Fecha: 10/04/09
106
Acot. mm
Esc. Ninguna
Plano
No. 8
Fecha: 10/04/09
107
Acot. mm
Esc. Ninguna
Plano
No. 9
Fecha: 10/04/09
108
Acot. mm
Esc. Ninguna
Plano
No. 10
Fecha: 10/04/09
109
Acot. mm
Esc. Ninguna
Fecha: 10/04/09
Plano
No.
11A
110
Acot. mm
Esc. Ninguna
Fecha: 10/04/09
Plano
No.
11B
111
Acot. mm
Esc. Ninguna
Plano
No. 12
Fecha: 10/04/09
112
Acot. mm
Esc. Ninguna
Plano
No. 13
Fecha: 10/04/09
113
ANEXO B
Cdigo fuente de los programas en Matlab
114
a1*cosd(t1);
a1*sind(t1);
d1;
1];
a2*cosd(t2);
a2*sind(t2);
d2;
1];
a3*cosd(t3);
a3*sind(t3);
d3;
1];
a4*cosd(t4);
115
116
a1*cosd(t1);
a1*sind(t1);
d1;
1];
a2*cosd(t2);
a2*sind(t2);
d2;
1];
a3*cosd(t3);
a3*sind(t3);
d3;
1];
a4*cosd(t4);
a4*cosd(t4);
d4;
1];
a5*cosd(t5);
a5*sind(t5);
d5;
1];
117
n
n
n
n
n
n
= [1 0 0 0]';
= [0 1 0 0]';
= [0 0 1 0]';
= [-1 0 0 0]';
= [0 -1 0 0]';
= [0 0 -1 0]';
'),disp('Lo siento esa no es una opcin
end
switch lower(S)
case {'X','x'}, s = [1 0 0 0]';
case {'Y','y'}, s = [0 1 0 0]';
case {'Z','z'}, s = [0 0 1 0]';
case {'-X','-x'},
s = [-1 0 0 0]';
case {'-Y','-y'},
s = [0 -1 0 0]';
case {'-Z','-z'},
s = [0 0 -1 0]';
otherwise, disp(' '),disp('Lo siento esa no es una opcin
valida....'), break;
end
switch lower(A)
case {'X','x'}, a = [1 0 0 0]';
case {'Y','y'}, a = [0 1 0 0]';
case {'Z','z'}, a = [0 0 1 0]';
case {'-X','-x'},
a = [-1 0 0 0]';
case {'-Y','-y'},
a = [0 -1 0 0]';
case {'-Z','-z'},
a = [0 0 -1 0]';
otherwise, disp(' '),disp('Lo siento esa no es una opcin
valida....'), break;
end
VC=input('Guess Inicial de los Angulos? : ');
VC=[0 74.5 180 110 77.92]; % Vector constante
B=VV(2); C=VC(3); D=VC(4); E=VC(5);
damp=0.0001;
t=VV;
disp('Matriz de Posicion Orientacion resultante es:')
M=[n s a p]
for n=1:100
T=t+damp;
118
119
f1;
f2;
f3;
f4;
f5;
f6;
f7;
f8;
f9;
f10 f10;
f11 f11;
f12 f12];
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%
%%%%%%%%
FPM
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
fp(1,1)=((cosd(T(1))*cosd(t(2)+t(3)+t(4))*cosd(t(5)))sind(T(1))*sind(t(5)))-M(1,1);
fp(1,2)=((cosd(t(1))*cosd(T(2)+t(3)+t(4))*cosd(t(5)))sind(t(1))*sind(t(5)))-M(1,1);
fp(1,3)=((cosd(t(1))*cosd(t(2)+T(3)+t(4))*cosd(t(5)))sind(t(1))*sind(t(5)))-M(1,1);
fp(1,4)=((cosd(t(1))*cosd(t(2)+t(3)+T(4))*cosd(t(5)))sind(t(1))*sind(t(5)))-M(1,1);
fp(1,5)=((cosd(t(1))*cosd(t(2)+t(3)+t(4))*cosd(T(5)))sind(t(1))*sind(T(5)))-M(1,1);
fp(2,1)=((sind(T(1))*cosd(t(2)+t(3)+t(4))*cosd(t(5)))+cosd(T(1))*sind(t(5
)))-M(2,1);
fp(2,2)=((sind(t(1))*cosd(T(2)+t(3)+t(4))*senx(t(5)))+cosd(t(1))*sind(t(5
)))-M(2,1);
fp(2,3)=((sind(t(1))*cosd(t(2)+T(3)+t(4))*cosd(t(5)))+cosd(t(1))*sind(t(5
)))-M(2,1);
fp(2,4)=((sind(t(1))*cosd(t(2)+t(3)+T(4))*cosd(t(5)))+cosd(t(1))*sind(t(5
)))-M(2,1);
fp(2,5)=((sind(t(1))*cosd(t(2)+t(3)+t(4))*cosd(T(5)))+cosd(t(1))*sind(T(5
)))-M(2,1);
fp(3,1)=(-sind(t(2)+t(3)+t(4))*cosd(t(5)))-M(3,1);
fp(3,2)=(-sind(T(2)+t(3)+t(4))*cosd(t(5)))-M(3,1);
fp(3,3)=(-sind(t(2)+T(3)+t(4))*cosd(t(5)))-M(3,1);
fp(3,4)=(-sind(t(2)+t(3)+T(4))*cosd(t(5)))-M(3,1);
fp(3,5)=(-sind(t(2)+t(3)+t(4))*cosd(T(5)))-M(3,1);
fp(4,1)=((-cosd(T(1))*cosd(t(2)+t(3)+t(4))*cosd(t(5)))sind(T(1))*sind(t(5)))-M(1,2);
fp(4,2)=((-cosd(t(1))*cosd(T(2)+t(3)+t(4))*cosd(t(5)))sind(t(1))*sind(t(5)))-M(1,2);
120
+ VC(4)*cosd(t(2)+t(3))
+ VC(4)*cosd(T(2)+t(3))
+ VC(4)*cosd(t(2)+T(3))
+ VC(4)*cosd(t(2)+t(3))
121
+ VC(4)*cosd(t(2)+t(3))
+ VC(4)*cosd(T(2)+t(3))
+ VC(4)*cosd(t(2)+T(3))
+ VC(4)*cosd(t(2)+t(3))
+ VC(4)*cosd(t(2)+t(3))
122
resy=abs(py-pfy);
123
resz=abs(pz-pfz);
pz1=pz-genz;
pz2=pz1-genz;
pz3=pz2-genz;
pz4=pz3-genz;
pz5=pz4-genz;
pz6=pz5-genz;
pz7=pz6-genz;
pz8=pz7-genz;
pz9=pz8-genz;
pz10=pz9-genz;
pz1=pz+genz;
pz2=pz1+genz;
pz3=pz2+genz;
pz4=pz3+genz;
pz5=pz4+genz;
pz6=pz5+genz;
pz7=pz6+genz;
pz8=pz7+genz;
pz9=pz8+genz;
pz10=pz9+genz;
124
PF;
for x=1:pres
k=PF(x,1:4)';
MR=[M(1,1)
M(2,1)
M(3,1)
M(4,1)
M=MR;
M(1,2)
M(2,2)
M(3,2)
M(4,2)
M(1,3)
M(2,3)
M(3,3)
M(4,3)
k(1,1);
k(2,1);
k(3,1);
k(4,1);];
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%%%%
for n=1:100
T=t+damp;
%%%%%
fm
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
fs1=((cosd(t(1))*cosd(t(2)+t(3)+t(4))*cosd(t(5)))-sind(t(1))*sind(t(5)))M(1,1);
fs2=((sind(t(1))*cosd(t(2)+t(3)+t(4))*cosd(t(5)))+cosd(t(1))*sind(t(5)))M(2,1);
fs3=(-sind(t(2)+t(3)+t(4))*cosd(t(5)))-M(3,1);
fs4=((-cosd(t(1))*cosd(t(2)+t(3)+t(4))*cosd(t(5)))sind(t(1))*sind(t(5)))-M(1,2);
fs5=((sind(t(1))*cosd(t(2)+t(3)+t(4))*cosd(t(5)))+cosd(t(1))*cosd(t(5)))M(2,2);
fs6=(sind(t(2)+t(3)+t(4))*sind(t(5)))-M(3,2);
fs7=(cosd(t(1))*sind(t(2)+t(3)+t(4)))-M(1,3);
fs8=(sind(t(1))*sind(t(2)+t(3)+t(4)))-M(1,3);
fs9=(cosd(t(2)+t(3)+t(4)))-M(1,3);
fs10=(cosd(t(1))*(VC(5)*sind(t(2)+t(3)+t(4)) + VC(4)*cosd(t(2)+t(3)) +
VC(3)*cosd(t(2)))+VC(1)*cosd(t(1)))-M(1,4);
fs11=(sind(t(1))*(VC(5)*sind(t(2)+t(3)+t(4)) + VC(4)*cosd(t(2)+t(3)) +
VC(3)*cosd(t(2)))+VC(1)*sind(t(1)))-M(2,4);
fs12=((E*cosd(t(2)+t(3)+t(4)) -D*sind(t(2)+t(3)) -C*sind(t(2)))+B)M(3,4);
%fs12=((VC(5)*cosd(t(2)+t(3)+t(4)) -VC(4)*sind(t(2)+t(3)) VC(3)*sind(t(2)))+VC(2))-M(3,4);
FS2=[fs1;fs2;fs3;fs4;fs5;fs6;fs7;fs8;fs9;fs10;fs11;fs12];
125
f1;
f2;
f3;
f4;
f5;
f6;
f7;
f8;
f9;
f10 f10;
f11 f11;
f12 f12];
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%
%%%%%%%%
FPM
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
fp(1,1)=((cosd(T(1))*cosd(t(2)+t(3)+t(4))*cosd(t(5)))sind(T(1))*sind(t(5)))-M(1,1);
fp(1,2)=((cosd(t(1))*cosd(T(2)+t(3)+t(4))*cosd(t(5)))sind(t(1))*sind(t(5)))-M(1,1);
126
127
+ VC(4)*cosd(t(2)+t(3))
+ VC(4)*cosd(T(2)+t(3))
+ VC(4)*cosd(t(2)+T(3))
+ VC(4)*cosd(t(2)+t(3))
+ VC(4)*cosd(t(2)+t(3))
+ VC(4)*cosd(t(2)+t(3))
+ VC(4)*cosd(T(2)+t(3))
+ VC(4)*cosd(t(2)+T(3))
+ VC(4)*cosd(t(2)+t(3))
+ VC(4)*cosd(t(2)+t(3))
FDM2=fp;
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%
128
129
ANEXO C
CIRCUITOS ELECTRONICOS Y HOJAS DE
ESPECIFICACIONES
130
131
132
133
134
135