Escolar Documentos
Profissional Documentos
Cultura Documentos
MODELO PARAMÉTRICO DE LA
MECANICA DEL ROBOT MIMBOT.
APLICACIÓN INFORMÁTICA MIMBOT 3.5
AUTOR:
DIRECTORES:
ÍNDICE
‐ I ‐
ÍNDICE
CAPÍTULO 1: INTRODUCCIÓN 1
1.2. Objetivos 5
2.3. Ecuaciones 27
‐ II ‐
2.3.3.2. Determinación de las velocidades angulares y lineales de los 45
eslabones
2.3.3.3. Determinación de las velocidades angulares y lineales de los 48
eslabones
‐ III ‐
3.4.3. Guardando datos 128
3.4.3.1. Menú archivo 128
3.4.3.2. Menú Gráficas actuadores 128
‐ IV ‐
4.2.3.2. Velocidades del mecanismo duplicado 254
4.2.3.3. Aceleraciones del mecanismo duplicado 270
BIBLIOGRAFÍA 303
ANEXOS 307
‐ V ‐
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
CAPÍTULO 1
Introducción
Alejandro Bustos Caballero 1
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
2 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Sin embargo, hubo unos pocos investigadores que apostaron por emular el
movimiento del paso con la combinación de mecanismos clásicos. En los últimos años
han aparecido walking chairs que siguen esta filosofía (Figura 1.1.4), pero sólo el
profesor Ceccarelli y su equipo del Laboratory of Robotics and Mechatronic (LARM),
han estado trabajando de una manera continuada en esta línea, primero con el robot
bípedo EP-WaR II (Figura 1.1.5) y últimamente con los diseños de las piernas del
humanoide low-cost CALUMA (Figura 1.1.6).
Otro bípedo que sigue la filosofía anterior es el PASIBOT (Figura 1.1.8),
desarrollado por el Grupo MAQLAB, de la Universidad Carlos III de Madrid, donde el
modelo de pierna propuesto es parecido al utilizado por el LARM y la walking chair del
Instituto Tecnológico de Tokio, y que difiere de los mismos en la orientación relativa
entre el pantógrafo y el mecanismo de Chebyshev, y en un mayor alejamiento relativo
del punto fijo inicial del pantógrafo. Estas diferencias tienen el doble objetivo de
estilizar la pierna, y de minimizar el recorrido de la articulación de la rodilla, lo que dota
al PASIBOT de un aspecto más “humanoide”.
Alejandro Bustos Caballero 3
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Figura 1.1.5. Robot EP-WarII Figura 1.1.6. Robot Caluma Figura 1.1.7. Robot bípedo del
LARM
4 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
1.2.- OBJETIVOS
El presente proyecto está ambientado en el rediseño y evolución del robot
bípedo Pasibot, desarrollado por el grupo de investigación MAQLAB, de la Universidad
Carlos III de Madrid.
El robot Pasibot fue diseñado con menos actuadores que juntas biológicas tiene
la pierna humana, disponiendo de un único grado de libertad. Esta condición de diseño
restringe grandemente la movilidad del robot por lo que se decidió efectuar un rediseño
del mismo, donde añadiéndole grados de libertad al mecanismo base y con el control
adecuado, se conseguiría dotar al robot Pasibot de ciertas habilidades.
Alejandro Bustos Caballero 5
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
¾ El primero de ellos será pierna del Pasibot simplificada, que incluye dos de
los tres mecanismos utilizados en el desarrollo final (ver figura 1.2.2-a).
¾ El segundo de ellos añadirá un mecanismo paralelo con la finalidad de
conseguir la estabilidad del robot (figura 1.2.2-b), siendo esta la pierna
completa del Pasibot.
¾ Por último, sobre la base de la pierna completa se añaden actuadores lineales
(figura 1.2.2-c), evolucionando el robot Pasibot en Mimbot y otorgándole
mayor movilidad.
6 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Para lograr una mejor interacción con el modelo matemático desarrollado se crea
una aplicación informática, muy visual, bajo Matlab aprovechando la herramienta Guide
de este programa.
En dicha aplicación, una vez realizados los cálculos oportunos, será posible
visualizar el movimiento del robot en una animación. En la cual se representarán,
además, las trayectorias de los puntos más importantes, del centro de masas del
mecanismo e incluso de los actuadores incorporados.
Alejandro Bustos Caballero 7
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
8 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
¾ Fase 1. Estudios previos: Se plantean todas las necesidades que el diseño debe
cumplir. Al no existir normativa aplicable se da una mayor libertad al proceso.
Se define un modelo conceptual, y se realizan los estudios previos de una forma
analítica.
¾ Fase 3. Construcción y ensayo real: Si los resultados del modelo virtual son
totalmente satisfactorios, se construye un prototipo real y se prueban sobre el
mismo todas las soluciones y especificaciones halladas anteriormente para
comprobar su validez.
Alejandro Bustos Caballero 9
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
10 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
¾ CAPÍTULO 1. INTRODUCCIÓN.
En este primer capítulo se realiza una pequeña introducción a los robots bípedos
más destacables para el seguimiento de este proyecto. Se enunciarán los objetivos que
se han de alcanzar tras la realización del proyecto, se enumerarán las fases seguidas y se
detallará la estructura del documento.
¾ CAPÍTULO 4. RESULTADOS
Alejandro Bustos Caballero 11
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
¾ BIBLIOGRAFÍA.
¾ ANEXOS.
12 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
CAPÍTULO 2
Alejandro Bustos Caballero 13
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
14 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
r1 = 2 ⋅ r2 r3 = 2,5 ⋅ r2
r4 = 2,5 ⋅ r2 rB = 5 ⋅ r2
Aplicado al caso del robot bípedo Pasibot, las dimensiones quedan como sigue:
Un pantógrafo (de las raíces griegas παντ, todo, y γραφ, dibujo, imagen) es un
mecanismo articulado basado en las propiedades de los paralelogramos; este
instrumento dispone de unas varillas conectadas de tal manera que se pueden mover
respecto de un punto fijo (pivote).
Alejandro Bustos Caballero 15
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
r6 = 3 ⋅ r2 r7 = 6 ⋅ r2 rC = 18 ⋅ r2
r8 = 6 ⋅ r2 rC = 9 ⋅ r2
r8 = 180mm rC = 270mm
En la figura 2.1.3 se puede apreciar que los triángulos BGM y BCA son
semejantes, por lo que se cumple que los puntos A, B y M están siempre alineados.
BC 270mm
= =3
BG 90mm
16 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Mecanismo de estabilización
Alejandro Bustos Caballero 17
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
18 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Alejandro Bustos Caballero 19
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
20 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
los ejes coordenados del sistema OXY. Este punto tiene asociado un vector p(x, y), que
va desde el origen O del sistema OXY hasta el punto a. Por tanto, la posición del
extremo del vector p está caracterizada por las dos componentes (x, y), denominadas
coordenadas cartesianas del vector y que son las proyecciones del vector p sobre los ejes
OX y OY.
Alejandro Bustos Caballero 21
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Posiciones
22 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
R x = R ⋅ cos θ ⎫
⎪
R y = R ⋅ senθ ⎪
⎪
( ) ( )
R = Rx + Ry ⎬ ⇒ R = R ⋅i + R ⋅ j
2 2 x y
⎪
R y
⎪
θ = tan x ⎪
R ⎭
R = Rx + Ry ⋅ j
Alejandro Bustos Caballero 23
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
R = R ⋅ cos θ + j ⋅ R ⋅ senθ ⎫ jθ
± jθ ⎬ ⇒ R = R⋅e
e = cos θ ± j ⋅ senθ ⎭
Velocidades
R = R ⋅ e jθ ⎫
⎪
⎬ ⇒ R& = R& ⋅ e + j ⋅ θ& ⋅ R ⋅ e
jθ jθ
dR
R& = ⎪
dt ⎭
24 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceleraciones
Como todo modelo que se realiza, éste requiere una validación para comprobar
que, efectivamente, se ajusta a la realidad que pretende representar. Para verificar el
modelo empleado en este Proyecto Fin de Carrera se utilizan principalmente tres
herramientas.
Alejandro Bustos Caballero 25
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Para corroborar que las posiciones obtenidas para el mecanismo duplicado son
correctas, se resuelve un caso particular muy concreto. Para ello se toman las mismas
ecuaciones que definen las posiciones del mecanismo inferior, a las cuales se modifica
únicamente la posición del punto de partida. De este modo se obtiene un resultado fiable
con el que poder comparar el desarrollo del modelo.
∂x x n +1 − x n
=
∂t t n +1 − t n
0,5
ω (rad/s)
0
0 0,2 0,4 0,6 0,8 1 1,2 1,4 1,6 1,8 2
-0,5
-1
-1,5
t (s)
ωest ωest (Matlab)
26 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
2.3.- ECUACIONES
El estado actual del robot bípedo Pasibot cuenta con el punto M fijo a tierra, tal y
como se muestra en la figura 2.3.1.1, obteniendo un mecanismo de un grado de libertad,
condición que puede ser demostrada aplicando el criterio de Grübler-Kutzbach.
GDL = 3(8 − 1) − 2 ⋅ 10
GDL = 1 (2.3.1.2)
Donde
GDL: número de grados de libertad del mecanismo
n: número de eslabones del mecanismo
f2: número de pares cinemáticos de orden inferior
f1: número de pares cinemáticos de orden superior
Alejandro Bustos Caballero 27
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
GDL = 3(10 − 1) − 2 ⋅ 12
GDL = 3 (2.3.1.3)
28 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
θ3
θ2
θ4
r1 + r2 + r3 + r4 = 0 (2.3.2.1.1)
Alejandro Bustos Caballero 29
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
En el eje X tenemos
En el eje Y
Puesto que conocemos los valores de los eslabones del sistema y los ángulos θ1
(cuyo valor es siempre π) y θ 2 , podemos proceder de la forma siguiente para resolver el
sistema:
− A − r4 cos θ 4
cos θ 3 = (2.3.2.1.7)
r3
2
⎛ − A − r4 cos θ 4 ⎞
senθ 3 = 1 − cos θ 3 = 1 − ⎜⎜
2
⎟⎟ (2.3.2.1.8)
⎝ r3 ⎠
2
⎛ − A − r4 cos θ 4 ⎞
B + r3 ⋅ 1 − ⎜⎜ ⎟⎟ + r4 ⋅ senθ 4 = 0 (2.3.2.1.9)
⎝ r3 ⎠
30 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
2
⎛⎜ r 2 − (− A − r cos θ )2 ⎞⎟ = (− B − r ⋅ senθ )2 (2.3.2.1.11)
⎝ 3 4 4
⎠ 4 4
r32 − ( A 2 + 2 Ar4 cos θ 4 + r42 cos 2 θ 4 ) = B 2 + 2 Br4 senθ 4 + r42 sen 2θ 4 (2.3.2.1.12)
r32 − ( A 2 + 2 Ar4 cos θ 4 + r42 cos 2 θ 4 ) = B 2 + 2 Br4 senθ 4 + r42 1 − cos 2 θ 4 (2.3.2.1.13)
r32 − A 2 − B 2 − r42
= A cos θ 4 + Bsenθ 4 (2.3.2.1.14)
2r4
r32 − A 2 − B 2 − r42
=C (2.3.2.1.16)
2r4
(B 1 − cos θ ) = (C − A cosθ )
2
4
2
4
2
(2.3.2.1.18)
( )
B 2 1 − cos 2 θ 4 = C 2 − 2 AC cos θ 4 + A 2 cos 2 θ 4 (2.3.2.1.19)
( )
cos 2 θ 4 A 2 + B 2 − 2 AC cos θ 4 + C 2 − B 2 = 0 (2.3.2.1.20)
2 AC ± (− 2 AC )2 − 4(A 2 + B 2 )(C 2 − B 2 )
cos θ 4 = (2.3.2.1.21)
(
2 A2 + B 2 )
2 AC ± 2 B B 2 − C 2 + A 2
cos θ 4 = (2.3.2.1.22)
2 A2 + B 2 ( )
Obtenemos dos posibles soluciones, por lo que basándonos en los trabajos
anteriormente realizados, descartamos la solución negativa de la raíz, expresando θ 4
como
Alejandro Bustos Caballero 31
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
2 AC + 2 B B 2 − C 2 + A 2
θ 4 = arccos (2.3.2.1.23)
(
2 A2 + B 2 )
Conocido θ 4 , se puede obtener θ 3 recuperando la (2.3.2.1.6)
− A − r4 cos θ 4
θ 3 = arccos (2.3.2.1.24)
r3
Puesto que a la hora de implementar las ecuaciones en Matlab, éste resuelve las
funciones arcocoseno de forma que los ángulos resultantes pertenezcan al primer o al
segundo cuadrante, es necesario reescribir θ 3 como sigue para que el ángulo calculado
coincida con el definido.
− A − r4 cos θ 4 − A − r4 cos θ 4
θ 3 = 360º − arccos = 2π − arccos (2.3.2.1.25)
r3 r3
Una vez conocidos los ángulos, se pueden determinar las posiciones del punto B
y de los eslabones que componen el mecanismo.
B = r2 + r3 (2.3.2.1.26)
Bx = r2 cos θ 2 + r3 cos θ 3 ⎫
⎬ (2.3.2.1.27)
By = r2 senθ 2 + r3 senθ 3 ⎭
B = Bx 2 + By 2 (2.3.2.1.28)
Procediendo del mismo modo se obtienen las posiciones de los centros de masa
de los eslabones
32 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Eslabón 2
r2 ⎫
X CDM 2 = cos θ 2 ⎪
2 ⎪
⎬ (2.3.2.1.29)
r
YCDM 2 = 2 senθ 2 ⎪⎪
2 ⎭
Eslabón 3
r3 ⎫
X CDM 3 = r2 cos θ 2 + cos θ 3 ⎪
2 ⎪
⎬ (2.3.2.1.30)
r3
YCDM 3 = r2 senθ 2 + senθ 3 ⎪⎪
2 ⎭
Eslabón 4
r4 ⎫
X CDM 4 = 60 − cos θ 4 ⎪
2 ⎪
⎬ (2.3.2.1.31)
r4
YCDM 4 = 0 − senθ 4 ⎪⎪
2 ⎭
Alejandro Bustos Caballero 33
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
∂θ1 ∂θ 2
= ω1 = ω2
∂t ∂t
∂θ 3 ∂θ 4
= ω3 = ω4
∂t ∂t
(r2ω 2 senθ 2 + r3ω3 senθ 3 ) cos θ 4 = (r2ω 2 cos θ 2 + r3ω3 cos θ 3 )senθ 4 (2.3.2.2.4)
r2ω2 sen(θ 4 − θ 2 )
ω3 = (2.3.2.2.5)
r3 sen(θ 3 − θ 4 )
r2ω 2 sen(θ 4 − θ 2 )
− r2ω 2 senθ 2 − r3 senθ 3
r3 sen(θ 3 − θ 4 ) (2.3.2.2.6)
= ω4
r4 senθ 4
34 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Para el cálculo de las velocidades lineales del punto B del mecanismo y de los
centros de masas de los eslabones se procede de manera similar; se retoman las
ecuaciones que definen la posición y se derivan respecto al tiempo.
2 2
v B = v Bx + v By (2.3.2.2.9)
De igual modo se calculan las velocidades de los centros de masas tras recuperar
los sistemas de ecuaciones (2.3.2.1.29), (2.3.2.1.30) y (2.3.2.1.31).
Eslabón 2
r2 ⎫
v XCDM 2 = − ω 2 senθ 2 ⎪
2 ⎪
⎬ (2.3.2.2.10)
r
vYCDM 2 = 2 ω 2 cos θ 2 ⎪⎪
2 ⎭
Eslabón 3
r3 ⎫
v XCDM 3 = − r2ω 2 senθ 2 − ω 3 senθ 3 ⎪
2 ⎪
⎬ (2.3.2.2.11)
r3
vYCDM 3 = r2ω 2 cos θ 2 + ω 3 cos θ 3 ⎪⎪
2 ⎭
Eslabón 4
r4 ⎫
v XCDM 4 = ω 4 senθ 4 ⎪
2 ⎪
⎬ (2.3.2.2.12)
r4
vYCDM 4 = − ω 4 cos θ 4 ⎪⎪
2 ⎭
Alejandro Bustos Caballero 35
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
dω1 dω 2
= α 1 = 0 pues ω1 = 0 = α 2 = 0 pues ω 2 = cte
dt dt
dω 3 dω 4
= α3 = α4
dt dt
− r2ω 22 cos θ 2 − r3α 3 senθ 3 − r3ω 32 cos θ 3 − r4α 4 senθ 4 − r4ω 42 cos θ 4 = 0⎫⎪
⎬ (2.3.2.3.1)
− r2ω 22 senθ 2 + r3α 3 cos θ 3 − r3ω 32 senθ 3 + r4α 4 cos θ 4 − r4ω 42 senθ 4 = 0 ⎪⎭
Sean A y B
A − r4α 4 senθ 4
α3 = (2.3.2.3.6)
r3 senθ 3
− B − r4α 4 cos θ 4
α3 = (2.3.2.3.7)
r3 cos θ 3
A cos θ 3 + Bsenθ 3
α4 = (2.3.2.3.9)
r4 sen(θ 4 − θ 3 )
36 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
A cos θ 3 + Bsenθ 3
A − r4 senθ 4
r4 sen(θ 4 − θ 3 ) (2.3.2.3.10)
α3 =
r3 senθ 3
2 2
a B = a Bx + a By (2.3.2.3.13)
Eslabón 2
r2 ⎫ r r ⎫
v XCDM 2 = − ω2 senθ 2 ⎪ a XCDM 2 = − 2 α 2 senθ 2 − 2 ω 22 cos θ 2 ⎪
2 ⎪ d 2 2 ⎪
⎬⇒ ⇒ ⎬ (2.3.2.3.14)
r dt r2 r2 2
vYCDM 2 = 2 ω2 cos θ 2 ⎪⎪ aYCDM 2 = α 2 cos θ 2 − ω 2 senθ 2 ⎪
2 ⎭ 2 2 ⎪⎭
Eslabón 3
r3 r ⎫
a XCDM 3 = −r2ω 22 cos θ 2 − α 3 senθ 3 − 3 ω 32 cos θ 3 ⎪
2 2 ⎪
⎬ (2.3.2.3.15)
r3 r3 2
aYCDM 3 = − r2ω 2 senθ 2 + α 3 cos θ 3 − ω 3 senθ 3 ⎪⎪
2
2 2 ⎭
Alejandro Bustos Caballero 37
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Eslabón 4
r4 ⎫ r r ⎫
v XCDM 4 = ω4 senθ 4 ⎪ a XCDM 4 = 4 α 4 senθ 4 + 4 ω 42 cos θ 4 ⎪
2 ⎪ d 2 2 ⎪
⎬⇒ ⇒ ⎬ (2.3.2.3.16)
r4 ⎪ dt r4 r4 2
vYCDM 4 = − ω4 cos θ 4 ⎪ aYCDM 4 = − α 4 cos θ 4 + ω 4 senθ 4 ⎪
2 ⎭ 2 2 ⎪⎭
38 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
θ6
θ8
Obtenemos entonces
Alejandro Bustos Caballero 39
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
MB + r6 + r8 = 0 (2.3.3.1.1)
M X = M X 1 + M Xe ⎫
⎬ (2.3.3.1.2)
M Y = M Y 1 + M Ye ⎭
MB X − r6 cos θ 6 + r8 cos θ 8 = 0⎫
⎬ (2.3.3.1.4)
MBY − r6 senθ 6 + r8 senθ 8 = 0 ⎭
Decimos que
D
D = MB X + r8 cos θ 8 → cos θ 6 = (2.3.3.1.5)
r6
40 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
D
Y sustituyendo cos θ 6 por , tenemos
r6
(
MBY2 + 2MB Y r8 senθ 8 + r82 sen 2θ 8 = r62 − MB X2 + 2 MB X r8 cos θ 8 + r82 cos 2 θ 8 ) (2.3.3.1.10)
( )
MBY2 + MB X2 + r82 1 − cos 2 θ 8 + r82 cos 2 θ 8 +
(2.3.3.1.11)
+ 2 MB Y r8 senθ 8 + 2 MB X r8 cos θ 8 − r62 = 0
F82 + 4MB X2 r82 cos 2 θ 8 + 4 FMB X r8 cos θ 8 = 4 MBY2 r82 − 4 MBY2 r82 cos 2 θ 8 (2.3.3.1.15)
4r82 cos 2 θ 8 (MB X2 + MBY2 ) + 4 FMB X r8 cos θ 8 + F82 − 4 MBY2 r82 = 0 (2.3.3.1.16)
cos θ 8 =
(
− FMB X ± MBY 4r82 MB X2 + MBY2 − F 2 ) (2.3.3.1.19)
(
2r8 MB + MB
2
X
2
Y )
Puesto que por definición el ángulo θ 8 es un ángulo negativo
Alejandro Bustos Caballero 41
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
θ 8 = − arccos
(
− FMB X ± MBY 4r82 MB X2 + MBY2 − F 2 ) (2.3.3.1.20)
(
2r8 MB + MB
2
X
2
Y )
Obtenemos dos posibles soluciones, siendo necesario por tanto descartar una de
ellas. El descarte se realiza mediante la comparación de ambos resultados con los
trabajos realizados anteriormente. De esta comparación se deduce que la solución válida
es la siguiente
θ 8 = − arccos
(
− FMB X − MBY 4r82 MB X2 + MBY2 − F 2 ) (2.3.3.1.21)
(
2r8 MB + MB
2
X
2
Y )
Conocido θ 8 , si retomamos la componente X del sistema (2.3.3.1.4) podemos
obtener el valor de θ 6
MB X + r8 cos θ 8
cos θ 6 = (2.3.3.1.23)
r6
MB X + r8 cos θ 8
θ 6 = arccos (2.3.3.1.24)
r6
Por definición
180º = −θ 7 + θ 6 (2.3.3.1.25)
MB X + r8 cos θ 8
θ 7 = θ 6 − 180º = arccos − 180º (2.3.3.1.26)
r6
42 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
θ7
θ6
θ8
rC + r8 + r7 + MB = 0 (2.3.3.1.27)
MB X − rC cos θ 6 + r8 cos θ 8 ⎫
θ 7 = − arccos ⎪
r7 ⎪
⎬ (2.3.3.1.30)
MBY − rC senθ 6 + r8 senθ 8 ⎪
θ 7 = arcsen
r7 ⎪⎭
De manera similar a lo que ocurría con θ3, es necesario introducir el signo menos
a la hora de calcular θ7 puesto que Matlab calcula las funciones arcocoseno de forma
que el ángulo pertenezca al primer o al segundo cuadrante. Puesto que sabemos que θ7,
pertenece al cuarto, es necesario realizar esa pequeña modificación.
Punto C
C X = B X + rC cos θ 7 ⎫
⎬ (2.3.3.1.31)
CY = BY + rC senθ 7 ⎭
Alejandro Bustos Caballero 43
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
C = C X2 + CY2 (2.3.3.1.32)
Punto A
AX = B X + rC cos θ 7 + rA cos θ 8 ⎫
⎬ (2.3.3.1.33)
AY = BY + rC senθ 7 + rA senθ 8 ⎭
Eslabón 5
rC ⎫
X CDM 5 = B X + cos θ 7 ⎪
2 ⎪
⎬ (2.3.3.1.35)
rC
YCDM 5 = BY + senθ 7 ⎪⎪
2 ⎭
Eslabón 6
rA ⎫
X CDM 6 = B X + rC cos θ 7 + cos θ 8 ⎪
2 ⎪
⎬ (2.3.3.1.36)
rA
YCDM 6 = BY + rC senθ 7 + senθ 8 ⎪⎪
2 ⎭
Eslabón 7
r7 ⎫
X CDM 7 = B X + r6 cos θ 7 + r8 cos θ 8 + cos θ 7 ⎪
2 ⎪
⎬ (2.3.3.1.37)
r7
YCDM 7 = BY + r6 senθ 7 + r8 senθ 8 + senθ 7 ⎪⎪
2 ⎭
Eslabón 8
r8 ⎫
X CDM 8 = B X − r6 cos θ 6 + cos θ 8 ⎪
2 ⎪
⎬ (2.3.3.1.38)
r8
YCDM 8 = BY − r6 senθ 6 + senθ 8 ⎪⎪
2 ⎭
44 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
∂θ 6 ∂M X 1
= ω6 =0
∂t ∂t
∂θ 7 ∂M Y 1
= ω7 =0
∂t ∂t
∂θ 8
= ω8
∂t
v Mx = v Mxe ⎫
⎬ (2.3.3.2.2)
v My = v Mye ⎭
Resultando
Alejandro Bustos Caballero 45
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
r8ω8 senθ 8 cos θ 6 − v MBx cos θ 6 = v MBy senθ 6 + r8ω8 cos θ 8 senθ 6 (2.3.3.2.6)
r8ω8 ( senθ 8 cos θ 6 − cos θ 8 senθ 6 ) = v MBx cos θ 6 + v MBy senθ 6 (2.3.3.2.7)
vCx = v Bx − rC ω 7 senθ 7 ⎫
⎬ (2.3.3.2.15)
vCy = v By + rC ω 7 cos θ 7 ⎭
46 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
2 2
vC = vCx + vCy (2.3.3.2.16)
2 2
v A = v Ax + v Ay (2.3.3.2.18)
Eslabón 5
rC ⎫
v XCDM 5 = v Bx − ω 7 senθ 7 ⎪
2 ⎪
⎬ (2.3.3.2.19)
rC
vYCDM 5 = v By + ω 7 cos θ 7 ⎪⎪
2 ⎭
Eslabón 6
rA ⎫
v XCDM 6 = v Bx − rC ω 7 senθ 7 − ω8 senθ 8 ⎪
2 ⎪
⎬ (2.3.3.2.20)
r
vYCDM 6 = v By + rC ω 7 cos θ 7 + A ω8 cos θ 8 ⎪⎪
2 ⎭
Eslabón 7
r7 ⎫
v XCDM 7 = v Bx − r6ω 7 senθ 7 − r8ω8 senθ 8 − ω 7 senθ 7 ⎪
2 ⎪
⎬ (2.3.3.2.21)
r7
vYCDM 7 = v By + r6ω 7 cos θ 7 + r8ω8 cos θ 8 + ω 7 cos θ 7 ⎪⎪
2 ⎭
Eslabón 8
r8 ⎫
v XCDM 8 = v Bx + r6ω 6 senθ 6 − ω8 senθ 8 ⎪
2 ⎪
⎬ (2.3.3.2.22)
r8
vYCDM 8 = v By − r6ω 6 cos θ 6 + ω8 cos θ 8 ⎪⎪
2 ⎭
Alejandro Bustos Caballero 47
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
∂ω 6 ∂v Mx1
= α6 =0
∂t ∂t
∂ω 7 ∂v My1
= α7 =0
∂t ∂t
∂ω8
= α8
∂t
a Mx = a Mxe ⎫
⎬ (2.3.3.3.1)
a My = a Mye ⎭
Resultando
a MBx + r6α 6 senθ 6 + r6ω 62 cos θ 6 − r8α 8 senθ 8 − r8ω82 cos θ 8 = 0⎫⎪
⎬ (2.3.3.3.3)
a MBy − r6α 6 cos θ 6 + r6ω 62 senθ 6 + r8α 8 cos θ 8 − r8ω82 senθ 8 = 0⎪⎭
48 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
r8α 8 senθ 8 − A
α6 = (2.3.3.3.6)
r6 senθ 6
B + r8α 8 cos θ 8
α6 = (2.3.3.3.7)
r6 cos θ 6
A cos θ 6 + Bsenθ 6
α8 = (2.3.3.3.10)
r8 sen(θ 8 − θ 6 )
r8α 8 senθ 8 − A
α6 = (2.3.3.3.11)
r6 senθ 6
A cos θ 6 + Bsenθ 6
r8 senθ 8 − A
r8 sen(θ 8 − θ 6 ) (2.3.3.3.12)
α6 =
r6 senθ 6
Alejandro Bustos Caballero 49
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
sa 71 + sa 72 + sa 73
α7 = − (2.3.3.3.19)
r7 senθ 7
aC = aCx
2
+ aCy
2
(2.3.3.3.21)
aC = aCx
2
+ aCy
2
(2.3.3.3.23)
Eslabón 5
rC r ⎫
a XCDM 5 = a Bx − α 7 senθ 7 − C ω 72 cos θ 7 ⎪
2 2 ⎪
⎬ (2.3.3.3.24)
rC rC 2
aYCDM 5 = a By + α 7 cos θ 7 − ω 7 senθ 7 ⎪⎪
2 2 ⎭
50 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Eslabón 6
rA r ⎫
a XCDM 6 = a Bx − rC α 7 senθ 7 − rC ω 72 cos θ 7 − α 8 senθ 8 − A ω82 cos θ 8 ⎪
2 2 ⎪
⎬ (2.3.3.3.25)
rA rA 2
aYCDM 6 = a By + rC α 7 cos θ 7 − rC ω 7 senθ 7 + α 8 cos θ 8 − ω8 senθ 8 ⎪
2
2 2 ⎪⎭
Eslabón 7
a XCDM 7 = a Bx − r6α 7 senθ 7 − r6ω 72 cos θ 7 − r8α 8 senθ 8 − r8ω82 cos θ 8 −⎫
⎪
r7 r7 2 ⎪
− α 7 senθ 7 − ω 7 cos θ 7
2 2 ⎪
⎬ (2.3.3.3.26)
aYCDM 7 = a By + r6α 7 cos θ 7 − r6ω 7 senθ 7 + r8α 8 cos θ 8 − r8ω8 senθ 8 + ⎪
2 2
r r ⎪
+ 7 α 7 cos θ 7 − 7 ω 72 senθ 7 ⎪
2 2 ⎭
Eslabón 8
r8 r ⎫
a XCDM 8 = a Bx + r6α 6 senθ 6 + r6ω 62 cos θ 6 − α 8 senθ 8 − 8 ω82 cos θ 8 ⎪
2 2 ⎪
⎬ (2.3.3.3.27)
r8 r8 2
aYCDM 8 = a By − r6α 6 cos θ 6 + r6ω 6 senθ 6 + α 8 cos θ 8 − ω8 senθ 8 ⎪⎪
2
2 2 ⎭
Alejandro Bustos Caballero 51
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
2.3.4.1.-Estabilizador
El estabilizador está constituido por un eslabón que une los puntos superiores del
mecanismo inferior (B y B1) y se desliza por una corredera (punto B2).
52 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
h = B2 y − BY = Y − BY (2.3.4.1.1)
Una vez obtenida la altura, podemos obtener el otro lado aplicando el Teorema
de Pitágoras
B X − B2 x = l 2 − h 2 (2.3.4.1.2)
B2 x = B X − l 2 − h 2 (2.3.4.1.3)
B1 y − B y
β = acrtg (2.3.4.1.4)
B1x − B x
B1x = B X + r f ⋅ cos δ ⎫⎪
⎬ (2.3.4.1.6)
B1 y = BY + r f ⋅ senδ ⎪⎭
Alejandro Bustos Caballero 53
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Existe otro planteamiento para obtener las posiciones de los puntos interesantes
del estabilizador y el ángulo de posicionamiento de dicho elemento atendiendo a la
figura 2.3.4.1.2. Este planteamiento se utilizará más adelante para el cálculo de las
velocidades y aceleraciones del estabilizador y es el finalmente implementado en
Matlab.
B2 x = B X + l ⋅ cos δ ⎫
⎬ (2.3.4.1.7)
B2 y = BY + l ⋅ senδ ⎭
B2 y − BY
δ = π − acrsen (2.3.4.1.8)
l
B1x = B X + r f ⋅ cos δ ⎫⎪
⎬ (2.3.4.1.9)
B1 y = BY + r f ⋅ senδ ⎪⎭
2.3.4.2.- Contrafémur
C1 X = B1 X + r9 cos θ 7 ⎫
⎬ (2.3.4.2.1)
C1Y = B1Y + r9 senθ 7 ⎭
Solución gráfica
Para la resolución del caso general se plantea primero una solución “gráfica”,
consistente en trazar dos circunferencias cuyos radios coinciden con las dimensiones de
la rodilla y del fémur y centradas en los puntos C y B1, respectivamente, tal y como se
54 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
( x − B1x ) 2 + ( y − B1 y ) 2 = r92 ⎫⎪
⎬ (2.3.4.2.2)
( x − C X ) 2 + ( y − CY ) 2 = r112 ⎪⎭
2 2 2 2 ⎬ (2.3.4.2.3)
C1x + C x − 2C1x C x + C1 y + C y − 2C1 y C y − r112 = 0 ⎪⎭
2 2 2 2
B1x − C x − 2C1x B1x + 2C1x C x + B1 y − C y − 2C1 y B1 y + 2C1 y C y − r92 + r112 = 0 (2.3.4.2.4)
2 2
a = B1x − C x (2.3.4.2.5)
2 2
b = B1 y − C y (2.3.4.2.6)
2 2
c = −r9 + r11 (2.3.4.2.7)
d = 2(B1x − C x ) (2.3.4.2.8)
e = 2(B1 y − C y ) (2.3.4.2.9)
a − d ⋅ C1x + b − e ⋅ C1 y + c = 0 (2.3.4.2.10)
Alejandro Bustos Caballero 55
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
a + b − e ⋅ C1 y + c
= C1x (2.3.4.2.11)
d
a+b+c
f = (2.3.4.2.12)
d
e
g= (2.3.4.2.13)
d
C1x = f − C1 y ⋅ g (2.3.4.2.14)
2
f 2 + g 2 C12y − 2 fgC1 y + B1x − 2 fB1x + 2 B1x C1 y ⋅ g +
2 2
(2.3.4.2.16)
+ C1 y + B1 y − 2C1 y B1 y − r92 = 0
( )
C12y 1 + g 2 + C1 y (− 2 fg + 2 B1x g − 2 B1 y ) + f 2 + B1x − 2 fB1x + B1 y − r92 = 0
2 2
(2.3.4.2.17)
A = 1+ g 2 (2.3.4.2.18)
B = (− 2 fg + 2 B1x g − 2 B1 y ) (2.3.4.2.19)
2 2
C = f 2 + B1x − 2 fB1x + B1 y − r92 (2.3.4.2.20)
− B ± B 2 − 4 AC
C1 y = (2.3.4.2.21)
2A
Una vez conocido C1y, recuperamos la ecuación (2.3.4.2.14) para obtener C1x.
Puesto que estamos resolviendo una ecuación de segundo grado, y tal y como se
observa en la figura 2.3.4.2.1, obtenemos dos soluciones, siendo necesario descartar una
de ellas, lo cual se hace por comparación con el resultado obtenido anteriormente para
el caso particular. En este caso, las ecuaciones que nos proporcionan la solución buena
son las siguientes
− B − B 2 − 4 AC ⎫
C1 y = ⎪
2A ⎬ (2.3.4.2.2.22)
C1x = f − C1 y ⋅ g ⎪
⎭
56 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Solución vectorial
r r r r
rC + r11 = r f + r9 (2.3.4.2.23)
Alejandro Bustos Caballero 57
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
r11 − A 2 = bg + r9 senθ 9
2
(2.3.4.2.30)
( )
r11 − a g2 + r92 cos 2 θ 9 + 2a g r9 cos θ 9 = bg2 + r92 sen 2θ 9 + 2bg r9 senθ 9
2
(2.3.4.2.32)
(
r11 − a g2 + r92 cos 2 θ 9 + 2a g r9 cos θ 9 =
2
)
(2.3.4.2.33)
( )
= bg2 + r92 1 − cos 2 θ 9 + 2bg r9 1 − cos 2 θ 9
2
r11 − a g2 − bg2 − r92 = C (2.3.4.2.35)
( )
4r92 a g2 + bg2 cos 2 θ 9 − 4Ca g r9 cos θ 9 + C 2 − 4bg2 r92 = 0 (2.3.4.2.38)
4Ca g r9 ± (− 4Ca r ) g 9
2
( )(
− 4 ⋅ 4r92 a g2 + bg2 ⋅ C 2 − 4bg2 r92 )
cos θ 9 = (2.3.4.2.39)
(
2 ⋅ 4r92 a g2 + bg2 )
(
a g C ± bg 4r92 a g2 + bg2 − C 2 )
cos θ 9 = (2.3.4.2.40)
(
2r9 a + b
2
g
2
g )
Puesto que θ9 es un ángulo negativo
(
a g C ± bg 4r92 a g2 + bg2 − C 2 )
θ 9 = − arccos (2.3.4.2.41)
(
2r9 a + b2
g
2
g )
Conocido θ9, hallamos θ11 retomando las ecuaciones del sistema (2.3.4.2.26)
58 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
bg + r9 senθ 9
senθ11 = (2.3.4.2.43)
r11
2.3.4.3.- Peroné
Alejandro Bustos Caballero 59
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
A1 X = C1 X + r9 cos θ 8 ⎫
⎬ (2.3.4.3.1)
A1Y = C1Y + r9 senθ 8 ⎭
Solución gráfica
Para la resolución del caso general también se plantean dos soluciones, una
basada en lo que sería la resolución gráfica, pero de forma analítica, y otra vectorial. En
primer lugar se describe la solución “gráfica”.
( x − C1x ) 2 + ( y − C1 y ) 2 = r102 ⎫⎪
⎬ (2.3.4.3.2)
( x − AX ) 2 + ( y − AY ) 2 = r122 ⎪⎭
2 2 2 2 ⎬ (2.3.4.3.3)
A1x + Ax − 2 A1x Ax + A1 y + Ay − 2 A1 y Ay − r122 = 0 ⎪⎭
2 2 2 2
C1x − Ax − 2 A1x C1x + 2 A1x Ax + C1 y − Ay − 2 A1 y C1 y + 2 A1 y Ay − r102 + r122 = 0 (2.3.4.3.4)
60 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
2 2
a 2 = C1x − Ax (2.3.4.3.5)
2 2
b2 = C1 y − Ay (2.3.4.3.6)
2 2
c 2 = −r10 + r12 (2.3.4.3.7)
d 2 = 2(C1x − Ax ) (2.3.4.3.8)
e2 = 2(C1 y − Ay ) (2.3.4.3.9)
a 2 − d 2 ⋅ A1x + b2 − e2 ⋅ A1 y + c 2 = 0 (2.3.4.3.10)
a 2 + b2 − e2 ⋅ A1 y + c 2
= A1x (2.3.4.3.11)
d2
a 2 + b2 + c 2
f2 = (2.3.4.3.12)
d2
e2
g2 = (2.3.4.3.13)
d2
A1x = f 2 − A1 y ⋅ g 2 (2.3.4.3.14)
2 2 2 2
f 2 + A1 y ⋅ g 2 − 2 f 2 A1 y ⋅ g 2 + C1x − 2 f 2 C1x + 2 A1 y C1x ⋅ g 2 +
2 2
(2.3.4.3.16)
+ A1 y + C1 y − 2 A1 y C1 y − r102 = 0
( )
A1 y g 2 + 1 + A1 y (− 2 f 2 ⋅ g 2 + 2C1x ⋅ g 2 − 2C1 y ) +
2 2
2 2 2
(2.3.4.3.17)
+ f 2 + C1x − 2 f 2 C1x + C1 y − r102 = 0
2
A2 = 1 + g 2 (2.3.4.3.18)
2 2 2
C 2 = f 2 + C1x − 2 f 2 C1x + C1 y − r102 (2.3.4.3.20)
Alejandro Bustos Caballero 61
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
− B2 ± B 2 2 − 4 A2 C 2
A1 y = (2.3.4.3.21)
2 A2
Una vez conocido A1y, recuperamos la ecuación (2.3.4.3.14) para obtener A1x.
A1x = f 2 − A1 y ⋅ g 2 ⎫
⎪
− B2 ± B 2 2 − 4 A2 C 2 ⎬ (2.3.4.3.23)
A1 y = ⎪
2 A2 ⎭
Puesto que estamos resolviendo una ecuación de segundo grado, obtenemos dos
soluciones. En esta ocasión, aunque una de ellas se ajusta mejor al caso particular,
ambas se desvían de la solución, por lo que su utilización resulta totalmente inviable.
Solución vectorial
θ7
θ10 θ8
θ12
Figura 2.3.4.3.2: esquema de la parte inferior del duplicado, θ10 se toma desde la horizontal.
r r r r
rA + r12 = r11 + r10 (2.3.4.3.24)
62 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
( )
r12 − a 2p + r102 cos 2 θ10 + 2a p r10 cos θ10 = b p2 + r102 sen 2θ10 + 2b p r10 senθ10
2
(2.3.4.3.33)
(
r12 − a 2p + r102 cos 2 θ10 + 2a p r10 cos θ10 =
2
)
(2.3.4.3.34)
( )
= b p2 + r102 1 − cos 2 θ10 + 2b p r10 1 − cos 2 θ10
2
r12 − r102 − a 2p − b p2 = C (2.3.4.3.36)
C 2 − 4Ca p r10 cos θ10 + 4a 2p r102 cos 2 θ10 = 4b p2 r102 1 − cos 2 θ 10 ( ) (2.3.4.3.38)
Alejandro Bustos Caballero 63
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
(
a p C ± b p 4r102 a 2p + b p2 − C 2 )
cos θ 10 = (2.3.4.3.41)
(
2r10 a + b
2
p
2
p )
Puesto que θ10 es un ángulo negativo
(
a p C ± b p 4r102 a 2p + b p2 − C 2 )
θ10 = − arccos (2.3.4.3.42)
(
2r10 a + b
2
p
2
p )
Llegados a este punto, se nos presenta el mismo problema que teníamos con θ11,
por lo que se sigue un procedimiento similar para solventarlo combinando las
ecuaciones (2.3.4.3.27) y (2.3.4.3.29)
b p + r10 senθ10
senθ12 = (2.3.4.3.44)
r12
Con el fin de tener una mejor idea del ángulo de inclinación del pie, definimos el
ángulo ε como el que se encuentra entre el suelo y el pie, obteniendo
64 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Por último, determinamos la posición de los puntos extremos del pie, P1 y P2,
definidos tal y como se muestra en la figura 2.3.4.3.3
P2 x = Ax − p 2 cos θ12 ⎫
⎬ (2.3.4.3.49)
P2 y = Ay − p 2 senθ12 ⎭
Estabilizador
l ⎫
X CDMest = B x + cos δ ⎪
2 ⎪
⎬ (2.3.4.3.50)
l
YCDMest = B y + senδ ⎪⎪
2 ⎭
Eslabón 9
r9 ⎫
X CDM 9 = B1x + cos θ 9 ⎪
2 ⎪
⎬ (2.3.4.3.51)
r9
YCDM 9 = B1 y + senθ 9 ⎪⎪
2 ⎭
Alejandro Bustos Caballero 65
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Eslabón 10
r10 ⎫
X CDM 10 = C1x + cos θ10 ⎪
2 ⎪
⎬ (2.3.4.3.52)
r
YCDM 10 = C1 y + 10 senθ10 ⎪⎪
2 ⎭
Eslabón 11
r11 ⎫
X CDM 11 = C X + cos θ11 ⎪
2 ⎪
⎬ (2.3.4.3.53)
r11
YCDM 11 = CY + senθ11 ⎪⎪
2 ⎭
Pie
p ⎫
X CDMpie = P2 x + cos θ12 ⎪
2 ⎪
⎬ (2.3.4.3.54)
p
YCDMpie = P2 y + senθ12 ⎪⎪
2 ⎭
p = p1 + p 2 (2.3.4.3.55)
66 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
∂δ ∂θ11
= ω est = ω11
∂t ∂t
∂θ 9 ∂θ12
= ω9 = ω12
∂t ∂t
∂θ10
= ω10
∂t
Estabilizador
V B 2 x = VB X − ϖ est ⋅ l ⋅ senδ ⎫⎪
⎬ (2.3.4.4.1)
V B 2 y = VB Y + ϖ est ⋅ l ⋅ cos δ = 0⎪⎭
donde conocemos que la velocidad vertical del punto B2 es nula por la condición que
impone la corredera. De este modo podemos obtener la velocidad angular del eslabón y
la velocidad lineal en el eje horizontal del punto B2
0 − VB Y
ϖ est = (2.3.4.4.2)
l ⋅ cos δ
V B 1x = VB X − ϖ est ⋅ r f ⋅ senδ ⎫⎪
⎬ (2.3.4.4.3)
V B 1 y = VB Y + ϖ est ⋅ r f ⋅ cos δ ⎪⎭
Contrafémur
Alejandro Bustos Caballero 67
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
− rC ω 7 senθ 7 + r f ω est senδ + r9ω 9 senθ 9 − rC ω 7 cos θ 7 + r f ω est cos δ + r9ω 9 cos θ 9
= (2.3.4.4.7)
r11 senθ11 r11 cos θ11
r f ω est (senθ11 cos δ − cos θ 11 senδ ) + r9ω 9 (senθ11 cos θ 9 − cos θ 11 senθ 9 ) −
(2.3.4.4.9)
− rC ω 7 (senθ11 cos θ 7 − senθ 7 cos θ 11 ) = 0
Peroné
68 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Alejandro Bustos Caballero 69
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
v P 2 x = v Ax + p 2ω12 senθ 12 ⎫
⎬ (2.3.4.4.21)
v P 2 y = v Ay − p 2ω12 cos θ12 ⎭
Estabilizador
l ⎫
v XCDMest = v Bx − ω est senδ ⎪
2 ⎪
⎬ (2.3.4.4.22)
l
vYCDMest = v By + ω est cos δ ⎪⎪
2 ⎭
Eslabón 9
r9 ⎫
v XCDM 9 = v B1x − ω 9 senθ 9 ⎪
2 ⎪
⎬ (2.3.4.4.23)
r9
vYCDM 9 = v B1 y + ω 9 cos θ 9 ⎪⎪
2 ⎭
Eslabón 10
r10 ⎫
v XCDM 10 = vC1x − ω10 senθ10 ⎪
2 ⎪
⎬ (2.3.4.4.24)
r10
vYCDM 10 = vC1 y + ω10 cos θ10 ⎪⎪
2 ⎭
Eslabón 11
r11 ⎫
v XCDM 11 = vCX − ω11 senθ11 ⎪
2 ⎪
⎬ (2.3.4.4.25)
r
vYCDM 11 = vCY + 11 ω11 cos θ11 ⎪⎪
2 ⎭
Pie
p ⎫
v XCDMpie = v P 2 x − ω12 senθ12 ⎪
2 ⎪
⎬ (2.3.4.4.26)
p
vYCDMpie = v P 2 y + ω12 cos θ12 ⎪⎪
2 ⎭
70 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Alejandro Bustos Caballero 71
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
∂ω est ∂ω11
= α est = α 11
∂t ∂t
∂ω 9 ∂ω12
= α9 = α 12
∂t ∂t
∂ω10
= α 10
∂t
Estabilizador
donde conocemos que la aceleración vertical del punto B2 es nula por la condición que
impone la corredera. De este modo podemos obtener la aceleración angular del eslabón
y la aceleración lineal en el eje horizontal del punto B2
ϖ est
2
⋅ l ⋅ senδ − AB Y
α est = (2.3.4.5.2)
l ⋅ cos δ
Derivando las ecuaciones del sistema (2.3.4.4.3) respecto del tiempo obtenemos
las aceleraciones del punto B1
Contrafémur
72 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
( ) (
− rC α 7 senθ 7 + ω 72 cos θ 7 − r11 α 11 senθ11 + ω112 cos θ11 = )
(2.3.4.5.4)
(
= −r f α est senδ + ω est
2
) (
cos δ − r9 α 9 senθ 9 + ω 92 cos θ 9 )
( ) (
− rC α 7 cos θ 7 − ω 72 senθ 7 + r11 α 11 cos θ11 − ω112 senθ11 = )
(2.3.4.5.5)
= r (α
f est cos δ − ω est
2
senδ ) + r (α
9 9 cos θ 9 − ω 92 senθ 9 )
α 11 =
(
− r f α est senδ + ω est
2
) (
cos δ − r9 α 9 senθ 9 + ω 92 cos θ 9 )+
− r11 senθ11
(2.3.4.5.6)
+
( 2
7 )
rC α 7 senθ 7 + ω cos θ 7 + r11ω112 cos θ11
− r11 senθ11
α 11 =
(
r f α est cos δ − ω est
2
) (
sen δ + r9 α 9 cos θ 9 − ω 92 sen θ 9 )−
r11 cos θ 11
(2.3.4.5.7)
( )
r α cos θ 7 − ω 72 sen θ 7 + r11ω 112 sen θ 11
− C 7
r11 cos θ 11
α9 =
[
− r9ω92 cos(θ11 − θ 9 ) + r f α est sen(θ11 − δ ) − ω est
2
cos(θ11 − δ ) − ]
− r9 sen(θ11 − θ 9 )
(2.3.4.5.9)
[
− rC α 7 sen(θ11 − θ 7 ) − ω72 cos(θ11 − θ 7 ) + r11ω112 ]
− r9 sen(θ11 − θ 9 )
α 11 =
(
− r f α est senδ + ω est
2
) (
cos δ − r9 α 9 senθ 9 + ω 92 cos θ 9 )+
− r11 senθ11
(2.3.4.5.10)
( )
r α senθ 7 + ω 72 cos θ 7 + r11ω112 cos θ11
+ C 7
− r11 senθ11
Peroné
Alejandro Bustos Caballero 73
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
( ) (
− rA α 8 senθ 8 + ω82 cos θ 8 − r12 α 12 senθ 12 + ω122 cos θ12 = )
(2.3.4.5.11)
( ) (
= −r11 α 11 senθ11 + ω112 cos θ11 − r10 α 10 senθ 10 + ω102 cos θ10 )
( ) (
− rA α 8 cos θ 8 − ω82 senθ 8 + r12 α 12 cos θ12 − ω122 senθ12 = )
(2.3.4.5.12)
= r (α
11 ) (
11 cos θ 11 − ω11 senθ 11 + r10 α 10 cos θ 10 − ω10 senθ 10
2 2
)
α 10 =
[
− r10ω102 cos(θ12 − θ10 ) + r11 α 11 sen(θ12 − θ11 ) − ω112 cos(θ12 − θ11 ) − ]
− r10 sen(θ12 − θ10 )
(2.3.4.5.13)
[ ]
− rA α 8 sen(θ12 − θ 8 ) − ω82 cos(θ12 − θ 8 ) + r12ω122
− r10 sen(θ12 − θ10 )
74 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Estabilizador
a XCDMest = a Bx −
l
2
(α est senδ + ω est
2
cos δ )⎪
⎫
⎪
⎬ (2.3.4.5.19)
+ (α est cos δ − ω est senδ )⎪⎪
l
aYCDMest = a By 2
2 ⎭
Eslabón 9
a XCMD9 = a B1x −
r9
2
(α 9 senθ 9 + ω 92 cos θ 9 )⎪
⎫
⎪
⎬ (2.3.4.5.20)
+ (α 9 cos θ 9 − ω 9 senθ 9 )⎪⎪
r9
aYCDM 9 = a B1 y 2
2 ⎭
Eslabón 10
a XCMD10 = aC1x −
r10
2
(α 10 senθ10 + ω102 cos θ10 )⎪
⎫
⎪
⎬ (2.3.4.5.21)
+ (α 10 cos θ10 − ω10 senθ10 )⎪⎪
r10
aYCDM 10 = aC1 y 2
2 ⎭
Eslabón 11
a XCMD11 = aCX −
r11
2
(α 11 senθ11 + ω112 cos θ11 )⎪
⎫
⎪
⎬ (2.3.4.5.22)
+ (α 11 cos θ11 − ω11 senθ11 )⎪⎪
r11
aYCDM 10 = aCY 2
2 ⎭
Pie
a XCDMpie = a P 2 x −
p
2
(α 12 senθ12 + ω122 cos θ12 )⎪
⎫
⎪
⎬ (2.3.4.5.23)
+ (α 12 cos θ12 − ω122 senθ12 )⎪⎪
p
aYCDMpie = a P 2 y
2 ⎭
Alejandro Bustos Caballero 75
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
76 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
CAPÍTULO 3
Alejandro Bustos Caballero 77
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
78 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Alejandro Bustos Caballero 79
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
80 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
A =
0.9501 0.4565 0.9218 0.4103 0.1389 0.0153
0.2311 0.0185 0.7382 0.8936 0.2028 0.7468
0.6068 0.8214 0.1763 0.0579 0.1987 0.4451
0.4860 0.4447 0.4057 0.3529 0.6038 0.9318
0.8913 0.6154 0.9355 0.8132 0.2722 0.4660
0.7621 0.7919 0.9169 0.0099 0.1988 0.4186
B =
5.7430 2.7510 3.6505 0.1513 -6.2170 -2.4143
-4.4170 -2.5266 -1.4681 -0.5742 5.3399 1.5631
-1.3917 -0.6076 -2.1058 -0.0857 1.5345 1.8561
-1.6896 -0.7576 -0.6076 -0.3681 3.1251 -0.6001
-3.6417 -4.6087 -4.7057 2.5299 6.1284 0.9044
2.7183 3.3088 2.9929 -0.1943 -5.1286 -0.6537
ans =
1.0000 0.0000 0 0.0000 0.0000 -0.0000
0.0000 1.0000 0.0000 0.0000 -0.0000 0.0000
0 0 1.0000 -0.0000 -0.0000 0.0000
0.0000 0 -0.0000 1.0000 -0.0000 0.0000
-0.0000 -0.0000 -0.0000 -0.0000 1.0000 0.0000
-0.0000 -0.0000 -0.0000 -0.0000 -0.0000 1.0000
Otro de los puntos fuertes de MATLAB son los gráficos, que se verán con más
detalle en una sección posterior. A título de ejemplo, se puede teclear la siguiente línea
y pulsar intro:
Alejandro Bustos Caballero 81
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
En la figura 3.1.4 se puede observar que se abre una nueva ventana en la que
aparece representada la función sin(x). Esta figura tiene un título "Función seno(x)" y
una cuadrícula o "grid". En realidad la línea anterior contiene también varias
instrucciones separadas por comas o puntos y comas. En la primera se crea un vector x
con 801 valores reales entre -4 y 4, separados por una centésima. A continuación se crea
un vector y, cada uno de cuyos elementos es el seno del correspondiente elemento del
vector x. Después se dibujan los valores de y en ordenadas frente a los de x en abscisas.
Las dos últimas instrucciones establecen la cuadrícula y el título.
Para borrar todas las salidas anteriores de MATLAB y dejar limpia la Command
Window se pueden utilizar las funciones clc y home. La función clc (clear console)
elimina todas las salidas anteriores, mientras que home las mantiene, pero lleva el
prompt (>> ) a la primera línea de la ventana.
Si se desea salir de MATLAB basta teclear los comandos quit o exit, elegir Exit
MATLAB en el menú File o utilizar cualquiera de los medios de terminar una
aplicación en Windows.
82 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Una vez que los controles están en posición se editan las funciones de llamada
(Callback) de cada uno de ellos, escribiendo el código de MATLAB que se ejecutará
cuando el control sea utilizado. Siempre será difícil diseñar GUIs, pero no debería ser
difícil implementarlas. GUIDE está diseñado para ser menos tediosos el proceso de
aplicación de la interfaz grafica y obviamente para trabajar como herramienta de trazado
de GUIs. Entre sus poderosos componentes esta el editor de propiedades (property
editor), éste se encuentra disponible en cualquier momento que se esté lidiando con los
controles de MATLAB; el editor de propiedades por separado se puede concebir como
una herramienta de trazado, y asistente de codificación (revisión de nombres y valores
de propiedades). Cuando se fusiona con el panel de control, el editor de menú, y
herramienta de alineación, resulta una combinación que brinda inigualable control de
los gráficos en MATLAB.
>> guide
Otra manera de entrar a GUIDE es través del File opción New y por último el
GUI, (como se muestra en la figura 3.2.1.1).
Alejandro Bustos Caballero 83
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
84 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
La Interfaz de Grafica de Usuario (GUI) se crea en una ventana de figura que consta
de los siguientes componentes (como se observa en la figura 3.2.1.4):
Con una GUI, el flujo de cómputo está controlado por las acciones en la interfaz.
Mientras que en un guión el flujo de comandos está predeterminado, el flujo de
operaciones con una GUI no lo está. Los comandos para crear una interfaz con el
usuario se escribe en un guión, la interfaz invoca el guión que se ejecute, mientras la
interfaz del usuario permanece en la pantalla aunque no se haya completado la
ejecución del guión.
Alejandro Bustos Caballero 85
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Básicamente solo se necesita entender cinco comandos para poder describir una
GUI: uimenu, uicontrol, get, set y axes. No obstante, lo que hace relativamente
complicadas a estos comandos es el gran número de formas de uso que tiene. Es
imposible describir todos lo tipo de situaciones, pues requiere demasiado espacio y sería
muy laborioso leerlo. Por tanto, solo trataremos de explicar los elementos básicos de
una GUI a través de ejemplos. Los lectores que deseen información más detallada sobre
los comandos pueden consultar MATLAB: building a graphical user interface y al final
del manual encontraran un apéndice que describe las propiedades de los controles.
86 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Alejandro Bustos Caballero 87
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Los diagramas de flujo de cada uno de los diferentes programas se muestran en las
páginas siguientes. Los símbolos utilizados para la representación de dichos diagramas
son los siguientes:
Entrada/salida de datos
Proceso
88 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aplicación completa
Alejandro Bustos Caballero 89
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Mimbot
guiintro
Condiciones
iniciales
Datos de
salida Gráficas
90 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
guiintro
Condiciones guidatosmain1
iniciales
Cálculo tiempo
Poscheby.m
Velcheby.m
Acelcheby.m
Pospanto0.m
Velpanto0.m
Acelpanto0.m
Datos de
guigraficas1 Gráficas
salida
guianimacion1
Alejandro Bustos Caballero 91
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Al proceso de cálculo se añade esta vez un archivo nuevo para el cálculo del
movimiento del duplicado del mecanismo inferior. Esto se refleja en la última pantalla
(guigraficas2), en la cual existen más gráficas para dibujar y opciones para exportar
datos, así como en la animación (guianimacion2), que incluye el duplicado.
92 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
guiintro
Condiciones guidatosmain2
iniciales
Cálculo tiempo
Poscheby.m
Velcheby.m
Acelcheby.m
Pospanto0.m
Velpanto0.m
Acelpanto0.m
Dgamba.m
Veldgamba.m
Aceldgamba.m
guigraficas2
Datos de Gráficas
salida
guianimacion2
Alejandro Bustos Caballero 93
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
guiintro
Condiciones guidatosmain3
iniciales
No
Datos
correctos
Sí
Cálculo tiempo
Actuadores.m
Poscheby.m
Velcheby.m
Acelcheby.m
Pospanto.m
Velpanto.m
Acelpanto.m
Dgamba.m
Veldgamba.m
Aceldgamba.m
Datos de
salida guigraficas3 Gráficas
guianimacion3
94 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Posiciones
Finalmente, se hallan los centros de masa de los tres eslabones que componen el
mecanismo superior tanto en el eje horizontal como en el vertical. De este modo es
posible representar las trayectorias de los centros de masa de los eslabones.
Alejandro Bustos Caballero 95
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Poscheby.m
Cálculo de θ2
Cálculo de θ4
Cálculo de θ3
Velocidades
En primer lugar se determina la velocidad angular del eslabón 3 (ω3) tal y como
se describe en el análisis matemático. Conocida ésta, hallamos la velocidad angular del
eslabón 4 (ω4).
96 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velcheby.m
Cálculo de ω3
Cálculo de ω4
Aceleraciones
Alejandro Bustos Caballero 97
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Acelcheby.m
Cálculo de α4
Cálculo de α 3
98 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Posiciones
Finalmente, se hallan los centros de masa de los cuatro eslabones que componen
el mecanismo superior tanto en el eje horizontal como en el vertical. De este modo es
posible representar las trayectorias de los centros de masa de los eslabones.
Alejandro Bustos Caballero 99
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Pospanto.m
Cálculo de θ8
Cálculo de θ6
Cálculo de θ7
Eslabón 5
Eslabón 7 Eslabón 8
Eslabón 6
100 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidades
Velpanto.m
Cálculo de ω8
Cálculo de ω6
Cálculo de ω7
Eslabón 5
Eslabón 7 Eslabón 8
Eslabón 6
Alejandro Bustos Caballero 101
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceleraciones
102 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Acelpanto.m
Cálculo de α8
Cálculo de α6
Cálculo de α7
Eslabón 5
Eslabón 7 Eslabón 8
Eslabón 6
Alejandro Bustos Caballero 103
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Posiciones
Como último paso de esta fase, se determina la posición del punto C1.
Por último, se hallan las posiciones de los centros de masas de todos los
eslabones que componen el duplicado de la pierna del robot bípedo y el centro de masas
total del mismo.
104 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
dgamba.m
Cálculo de δ
No
Cálculo de θ9 Caso
correcto
Cálculo de θ11
Sí
Sí
No
Caso
correcto Posiciones del punto A1
Cálculo de ε
Estabilizador
Posiciones de los CDM
Eslabón 9
Eslabón 10
Robot
Eslabón 11 Pie
Alejandro Bustos Caballero 105
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidades
Veldgamba.m
Velocidad vertical
del punto B2 Cálculo de ω9
Cálculo de ω12
Velocidades del punto B1
Eslabón 9
Robot
Eslabón 10
Eslabón 11 Pie
106 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Por último, se hallan las velocidades de los centros de masas de todos los
eslabones que componen el duplicado de la pierna del robot bípedo y el centro de masas
total del mismo.
Aceleraciones
Por último, se hallan las aceleraciones de los centros de masas de todos los
eslabones que componen el duplicado de la pierna del robot bípedo y el centro de masas
total del mismo.
Alejandro Bustos Caballero 107
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceldgamba.m
Aceleración vertical
del punto B2 Cálculo de α9
Cálculo de α12
Aceleraciones del punto B1
Eslabón 9
Pie
Eslabón 10
Eslabón 11 Eslabón 12
108 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Actuadores.m
Actuador horizontal
Sin movimiento
Aceleraciones
Modificación anterior del paso
Velocidades
Movimiento trapezoidal
Actuador vertical
Sin movimiento
Aceleraciones
Subida/bajada
Velocidades
Movimiento trapezoidal
Alejandro Bustos Caballero 109
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
110 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
3.4.1.- INTRODUCCIÓN
Mimbot es el nombre del robot bípedo que se encuentra en fase de desarrollo por
el grupo Maqlab (Laboratorio de Máquinas), perteneciente al departamento de
Ingeniería Mecánica de la Universidad Carlos III de Madrid. Con el fin de agilizar el
cálculo de la mecánica del robot y, al mismo tiempo, extenderlo al caso general, se
desarrolla un programa informático que se encargue de ello, dando origen a Mimbot 3.5.
1. Ventana de selección
2. Ventana de introducción de datos
3. Ventana de gráficas
En este punto, y para cada una de las tres simulaciones, disponemos de dos
ventanas principales, desde las cuales se puede realizar la entrada de las condiciones
iniciales y visualizar los resultados de la simulación.
Alejandro Bustos Caballero 111
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Simulación 1
112 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Tras introducir todos los datos y pulsar el botón Calcular, se activará el botón
siguiente, posibilitando el acceso a la siguiente ventana.
Simulación 2
Alejandro Bustos Caballero 113
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Simulación 3
114 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Alejandro Bustos Caballero 115
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Nota:
Para trabajar correctamente con los movimientos de modificación anterior y
posterior del paso y subida e inclinación del pie es necesario especificar un tiempo total
que cubra al menos dos ciclos, pues los actuadores desarrollan su actuación durante el
segundo paso.
116 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Simulación 1
En esta ventana nos encontramos con varios botones y seis listas con todas las
gráficas obtenidas de la simulación, tal y como se muestra en la figura 3.4.2.3.1.
Alejandro Bustos Caballero 117
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Mecanismo superior
118 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Mecanismo inferior
Alejandro Bustos Caballero 119
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Mecanismo global
Por último, al pulsar el botón “Animación” se despliega una nueva ventana con
unos sencillos controles para visualizar el movimiento del robot.
120 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Simulación 2
Alejandro Bustos Caballero 121
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
122 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
20. VXg9 frente al tiempo (Velocidad horizontal del cdm del eslabón 9)
21. VYg9 frente al tiempo (Velocidad vertical del cdm del eslabón 9)
22. VXg10 frente al tiempo (Velocidad horizontal del cdm del eslabón 10)
23. VYg10 frente al tiempo (Velocidad vertical del cdm del eslabón 10)
24. VXg11 frente al tiempo (Velocidad horizontal del cdm del eslabón 11)
25. VYg11 frente al tiempo (Velocidad vertical del cdm del eslabón 11)
26. VXgpie frente al tiempo (Velocidad horizontal del cdm del pie)
27. VYgpie frente al tiempo (Velocidad vertical del cdm del pie)
Alejandro Bustos Caballero 123
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Simulación 3
Al igual que toda aplicación informática que se precie, Mimbot 3.5 dispone de
una ayuda, en este caso en formato html que puede ser visualizada en el propio
navegador que incorpora Matlab. Para acceder a la ayuda basta simplemente con
acceder al menú Ayuda que se encuentra en todas y cada de las ventanas de
Introducción de datos y de Gráficas de las que dispone el programa y seleccionar Temas
de Ayuda. Realizada esta acción se abrirá el navegador de Matlab con la página
principal de la ayuda, como se observa en la figura 3.4.2.3.8.
124 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Alejandro Bustos Caballero 125
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
3.4.2.4.- Animación
126 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Cada uno de los botones realiza la acción que indica su propio nombre. Los
botones de retroceso rápido y lento y de reproducción lenta y rápida sólo funcionan
cuando la animación se está ejecutando. Si la animación se encuentra detenida bien
porque se haya pulsado el botón de para o pausa o porque haya terminado, estos botones
no tendrán ningún efecto, siendo necesario presionar el botón de reproducción antes.
Alejandro Bustos Caballero 127
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Desde este menú se accede a las opciones de carga y guardado de los datos
introducidos en la pantalla, así como a la carga de los datos por defecto, tal y como se
muestra en la figura 3.4.3.1.1.
1. En los archivos *.mim1 se guarda, por este orden, r1, r2, r3, r4,rB, r6, r7,
r8, rA, rC, w2rpm, it, T.
2. Para la extensión *.mim2, el orden es el siguiente: r1, r2, r3, r4,rB, r6,
r7, r8, rA, rC, Y, l, rf, r9, r10, r11, r12, p1, p2, w2rpm, it, T.
3. La última versión, *.mim3, añade las variables de los actuadores,
resultando: r1, r2, r3, r4,rB, r6, r7, r8, rA, rC, Y, l, rf, r9, r10, r11, r12, p1, p2,
w2rpm, it, T, Mx0, Vx0, Ax0, Axf, tx1, tx2, Cx0, My0, Vy0, Ay0, Ayf, ty1, ty2,
Cy0.
128 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Una vez realizada la simulación, es posible exportar todos los datos obtenidos
con el fin de trabajar sobre ellos en otras aplicaciones. Para ello es necesario abrir el
menú archivo en la ventana de gráficas y elegir qué datos se quieren exportar, tal y
como se muestra en la figura 3.4.4.1.
Las opciones y datos que se exportan en cada una de ellas se muestran en las
tablas 3.4.4.1 y 3.4.4.2.
Alejandro Bustos Caballero 129
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
130 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Alejandro Bustos Caballero 131
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Puesto que se trata de un simple archivo de texto, éste puede ser abierto con
cualquier editor de texto como Wordpad, Microsoft Word o similar. Sin embargo,
resulta mucho más útil si se importan los datos desde una hoja de cálculo. A
continuación se describe el proceso para Microsoft Excel y OpenOffice Calc.
En primer lugar es necesario abrir el programa, una vez realizada esta tarea,
vamos a Botón de Office->Abrir (en versiones anteriores, Archivo->Abrir) y
seleccionamos el archivo correspondiente como se muestra en la figura 3.4.5.1.1. Es
importante elegir en Tipo de archivo “Todos los archivo (*.*)” para que se muestren los
archivos que nos interesan con extensión *.dat.
132 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Una vez realizado el primer paso, nos aparecerá la ventana del “Asistente para
importar texto”. En los dos primeros pasos no es necesario modificar nada, como
muestran las figuras 3.4.5.1.2 y 3.4.5.1.3, y simplemente pulsaremos “Siguiente”.
Alejandro Bustos Caballero 133
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Tras pulsar en Aceptar y en Finalizar, tendremos cada una de las variables con el
valor que toma en cada iteración colocada en su respectiva columna. La figura 3.4.5.1.5,
muestra el resultado final.
134 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Una vez hemos elegido nuestro archivo y pulsado Insertar, se nos abrirá una
nueva ventana en la que podremos configurar el formato de los datos. En las opciones
de separación es suficiente con dejar marcado “Tabulador”. La figura 3.4.5.2.3 muestra
el proceso.
Alejandro Bustos Caballero 135
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
136 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Tras pulsar aceptar nos aparecerá una nueva ventana como la que se muestra en
la figura 3.4.5.2.4.
Alejandro Bustos Caballero 137
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
138 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
CAPÍTULO 4
Resultados
Alejandro Bustos Caballero 139
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
En las páginas siguientes se describen las ecuaciones que rigen los movimientos
implementados y la evolución sufrida por los mismos.
140 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
4.1.1.2.- Trapezoidal
⎧ AX 0 0≤t ≤t
⎪
AY = ⎨0 t1 < t ≤ t 2 (4.1.1.2.1)
⎪A t2 < t ≤ T
⎩ Xf
Alejandro Bustos Caballero 141
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
⎧V X 0 + AX 0 ⋅ t 0 ≤ t ≤ t1
⎪
V X = ⎨V X (t1 ) t1 < t ≤ t 2 (4.1.1.2.2)
⎪V (t ) + A ⋅ (t − t ) t < t ≤ T
⎩ X 2 Xf 2 2
⎧ 1
⎪M Xe 0 + V x 0 ⋅ t + 2 Ax 0 ⋅ t 0 ≤ t ≤ t1
2
⎪
M Xe = ⎨M X (t1 ) + V X (t1 ) ⋅ (t − t1 ) t1 < t ≤ t 2 (4.1.1.2.3)
⎪ 1
⎪M X (t 2 ) + V X (t 2 ) ⋅ (t − t 2 ) + 2 AXf ⋅ (t − t 2 ) t2 ≤ t ≤ T
2
También se realizó una prueba con la aceleración siguiendo una función escalón,
siendo en este caso la aceleración introducida 25mm/s2. De este modo se obtiene una
velocidad con dos pendientes (una positiva y otra negativa) y un control en posición
más suavizado, tal y como se observa en el Anexo A, apartado 2
142 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Los resultados obtenidos de todas las vías de exploración, algunas de las cuales
se realizan más de una vez con distintas velocidades, pueden consultarse en el Anexo A,
aparatados del 3 al 7
Desarrollo final
Alejandro Bustos Caballero 143
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
− 0,2V1 π
Mx(t ) = Mx0 + sen( t ) + V1 ⋅ t (4.1.1.3.1)
π 0,2
π
Vx(t ) = −V1 cos( t ) + V1 (4.1.1.3.2)
0,2
π ⋅ V1 π
Ax(t ) = sen( t) (4.1.1.3.3)
0,2 0,2
C
V1 =
0,2 (4.1.1.3.4)
− sen(π ⋅ T ) + 0,2T
π
0,6V2 π
Mx(t ) = Mx0 + sen( t ) − V2 ⋅ t (4.1.1.3.5)
π 0,6
π
Vx(t ) = V2 cos( t ) − V2 (4.1.1.3.6)
0,6
π ⋅ V2 π
Ax(t ) = − sen( t) (4.1.1.3.7)
0,6 0,6
C
V2 =
0,6 (4.1.1.3.8)
sen(π ⋅ T ) − 0,6T
π
144 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-770
-780
Posicion Y del punto A (mm)
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
800
Velocidad X del punto A (mm/s)
600
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
Algo similar ocurre con las aceleraciones, como se puede observar en la figura
4.1.1.3.4. Entre t=2s y t=2,5s se observan grandes variaciones, debidas en gran medida
al actuador horizontal, siendo lo más destacable el pico que se produce en t=2,4s, de
valor -978,2mm/s2. También es muy destacable la gran variación que se produce en la
aceleración entre este pico y el anterior, situado en t=2,32s: en 0,08s se decelera de
1777mm/s2 a -978,2mm/s2.
Alejandro Bustos Caballero 145
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
4000
-2000
-4000
-6000
-8000
0 1 2 3 4 5 6
tiempo (s)
Desde el 80% del ciclo del primer paso hasta el 20% del ciclo del segundo paso
− 0,4V1 π
Mx(t ) = Mx0 + sen( t ) + V1 ⋅ t (4.1.1.3.9)
π 0,4
π
Vx(t ) = −V1 cos( t ) + V1 (4.1.1.3.10)
0,4
π ⋅ V1 π
Ax(t ) = sen( t) (4.1.1.3.11)
0,4 0,4
C
V1 =
0,4 (4.1.1.3.12)
− sen(π ⋅ T ) + 0,4T
π
0,6V2 π
Mx(t ) = Mx0 + sen( t ) − V2 ⋅ t (4.1.1.3.13)
π 0,6
146 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
π
Vx(t ) = V2 cos( t ) − V2 (4.1.1.3.14)
0,6
π ⋅ V2 π
Ax(t ) = − sen( t) (4.1.1.3.15)
0,6 0,6
C
V2 =
0,6 (4.1.1.3.16)
sen(π ⋅ T ) − 0,6T
π
Alargamiento
En este primer análisis se desarrolla el alargamiento del paso por la zona anterior
del mismo. Para ello se escoge una carrera C=10mm
10
Posicion horizontal del actuador (mm)
0
0 1 2 3 4 5 6
Tiempo (s)
En la figura 4.1.1.3.5 se aprecia cómo la posición del extremo del actuador varía
suavemente hasta alcanzar un máximo de 10mm y regresar a la posición inicial
describiendo una curva algo más suave. Además de alcanzar el máximo en t=2,4s, se
observa cómo se estabiliza entorno a 10mm durante aproximadamente 0,2s.
Alejandro Bustos Caballero 147
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
20
15
-5
-10
-15
-20
0 1 2 3 4 5 6
Tiempo (s)
80
60
Aceleración del actuador (mm/s 2)
40
20
-20
-40
-60
-80
-100
0 1 2 3 4 5 6
Tiempo (s)
148 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
200
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
800
Velocidad X del punto A (mm/s)
600
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 149
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
4000
3000
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
Acortamiento
-2
Posicion horizontal del actuador (mm)
-4
-6
-8
-10
-12
0 1 2 3 4 5 6
Tiempo (s)
150 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
describiendo una curva algo más suave. Además de alcanzar el mínimo en t=2,4s, se
observa cómo se estabiliza entorno a -10mm durante aproximadamente 0,2s.
15
-5
-10
-15
-20
-25
0 1 2 3 4 5 6
Tiempo (s)
80
60
Aceleración del actuador (mm/s 2)
40
20
-20
-40
-60
-80
-100
0 1 2 3 4 5 6
Tiempo (s)
Alejandro Bustos Caballero 151
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
200
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
800
Velocidad X del punto A (mm/s)
600
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
152 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
4000
3000
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
Verificación de la modificación
-780
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
Alejandro Bustos Caballero 153
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
800
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
4000
3000
Aceleracion X del punto A (mm/s2)
2000
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
De igual modo que con la modificación anterior del paso, se simulan tres ciclos
completos, de modo que el actuador lineal ejecute su función durante el segundo de
ellos. De esta forma es posible comparar el paso modificado con los pasos originales en
una misma gráfica. También en esta ocasión se produce el efecto observado en la
modificación anterior del paso, por lo que detallan sin preámbulos los movimientos
finales implementados al ser la solución la misma. Si se desea, es posible consultar los
resultados de la primera aproximación en el apartado 9 del Anexo A
154 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
0,6V1 π
Mx(t ) = Mx0 + sen( t ) − V1 ⋅ t (4.1.1.4.1)
π 0,6
π
Vx(t ) = V1 cos( t ) − V1 (4.1.1.4.2)
0,6
π ⋅ V1 π
Ax(t ) = − sen( t) (4.1.1.4.3)
0,6 0,6
−C
V1 =
0,6 (4.1.1.4.4)
sen(π ⋅ T ) − 0,6T
π
Por su parte, el movimiento desarrollado entre el 80% del ciclo del primer paso y
el 20% del segundo ciclo se define de esta forma
0,4V2 π
Mx(t ) = Mx0 − sen( t ) + V2 ⋅ t (4.1.1.4.5)
π 0,4
π
Vx(t ) = −V2 cos( t ) + V2 (4.1.1.4.6)
0,4
π ⋅ V2 π
Ax(t ) = sen( t) (4.1.1.4.7)
0,4 0,4
C
V2 =
0,4 (4.1.1.4.8)
− sen(π ⋅ T ) + 0,4T
π
Alargamiento
Alejandro Bustos Caballero 155
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-4
-6
-8
-10
0 1 2 3 4 5 6
Tiempo (s)
En la figura 4.1.1.4.1 se aprecia cómo la posición del extremo del actuador varía
suavemente hasta alcanzar un mínimo de -10mm y regresar a la posición inicial
describiendo una curva algo más suave. Además de alcanzar el mínimo en t=1,6s, se
observa cómo se estabiliza entorno a -10mm durante aproximadamente 0,2s.
Velocidad del actuador horizontal
25
20
15
velocidad del actuador (mm/s)
10
-5
-10
-15
-20
0 1 2 3 4 5 6
Tiempo (s)
156 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
80
60
20
-20
-40
-60
-80
-100
0 1 2 3 4 5 6
Tiempo (s)
200
150
Posicion X del punto A (mm)
100
50
-50
-100
-150
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 157
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
800
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
4000
3000
Aceleracion X del punto A (mm/s2)
2000
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
158 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Acortamiento
8
Posicion horizontal del actuador (mm)
-2
0 1 2 3 4 5 6
Tiempo (s)
En la figura 4.1.1.4.7 se aprecia cómo la posición del extremo del actuador varía
suavemente hasta alcanzar un máximo de 10mm y regresar a la posición inicial
describiendo una curva algo más suave. Además de alcanzar el máximo en t=1,6s, se
observa cómo se estabiliza entorno a 10mm durante aproximadamente 0,2s.
15
10
velocidad del actuador (mm/s)
-5
-10
-15
-20
-25
0 1 2 3 4 5 6
Tiempo (s)
Alejandro Bustos Caballero 159
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
80
60
20
-20
-40
-60
-80
-100
0 1 2 3 4 5 6
Tiempo (s)
200
Posicion X del punto A (mm)
150
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
160 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
800
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
4000
3000
Aceleracion X del punto A (mm/s2)
2000
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 161
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
También se buscan las carreras para las cuales el mecanismo deja de actuar
correctamente. Para ello se realizan simulaciones variando las carreras de los actuadores
hasta determinar el punto en que se produce el fallo del mecanismo. Como punto de
fallo del mecanismo se toma aquel instante en el que se superponen las directrices de las
barras que componen el mecanismo durante el movimiento del mismo. Evidentemente
el fallo del mecanismo real se produce antes debido a que los eslabones que lo
componen tienen una anchura distinta de cero.
En primer lugar se halla el punto en que se produce el fallo para una carrera del
actuador positiva, esto es, se alarga el paso. En este caso el fallo se produce para una
carrera de 50mm. Como se observa en la figura 4.1.1.5.1-a, existe un momento en el
cual los mecanismos inferior y duplicado se superponen, violando la geometría del
mecanismo real.
En segundo lugar se busca el punto de fallo para una carrera negativa. En esta
ocasión no se produce el fallo del mecanismo, incluso para la carrera máxima de -50mm
el mecanismo no degenera, como se aprecia en la figura 4.1.1.5.1-b.
Figura 4.1.1.5.1. Fallos del mecanismo para la modificación anterior del paso
162 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
En primer lugar se halla el punto en que se produce el fallo para una carrera del
actuador positiva. En este caso el fallo se produce para una carrera de 46,5mm. Como se
observa en la figura 4.1.1.5.2-a, existe un momento en el cual los mecanismos inferior y
duplicado se superponen, violando la geometría del mecanismo real.
En segundo lugar se busca el punto de fallo para una carrera negativa. En esta
ocasión no se produce el fallo del mecanismo, incluso para la carrera máxima de -50mm
el mecanismo no degenera, como se aprecia en la figura 4.1.1.5.2-b.
Figura 4.1.1.5.2. Fallos del mecanismo para la modificación posterior del paso
Alejandro Bustos Caballero 163
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
4.1.2.2.- Trapezoidal
⎧ AY 0 0 ≤ t ≤ t1
⎪
AY = ⎨0 t1 < t ≤ t 2 (4.1.2.2.1)
⎪A t2 < t ≤ T
⎩ Yf
164 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
⎧VY 0 + AY 0 ⋅ t 0≤t≤t
⎪
VY = ⎨VY (t1 ) t1 < t ≤ t 2 (4.1.2.2.2)
⎪V (t ) + A ⋅ (t − t ) t < t ≤ T
⎩ Y 2 Yf 2 2
⎧ 1
⎪ M Ye 0 + V Y 0 ⋅ t + AY 0 ⋅ t 2 0 ≤ t ≤ t1
⎪ 2
M Ye = ⎨M Y (t1 ) + VY (t1 ) ⋅ (t − t1 ) t1 < t ≤ t 2 (4.1.2.2.3)
⎪ 1
⎪M Y (t 2 ) + VY (t 2 ) ⋅ (t − t 2 ) + 2 AYf ⋅ (t − t 2 ) t2 ≤ t ≤ T
2
El desarrollo de los movimientos del actuador vertical resulta más sencillo que el
del horizontal ya que se parte del desarrollo realizado con éste. Este primer caso es
incluso más fácil de implementar puesto que sólo opera durante la fase de vuelo. El
movimiento se desarrolla durante el final del primer paso y el comienzo del segundo,
permaneciendo el actuador inmóvil en la posición inicial durante el resto de la
simulación.
El movimiento del primer tramo, que comprende desde que el pie se eleva en el
paso anterior al estudiado hasta el inicio del ciclo estudiado, viene definido por
0,2V1 π
Mx(t ) = Mx0 − sen( t ) + V1 ⋅ t (4.1.2.3.1)
π 0,2
π
Vx(t ) = −V1 cos( t ) + V1 (4.1.2.3.2)
0,2
π ⋅ V1 π
Ax(t ) = sen( t) (4.1.2.3.3)
0,2 0,2
C
V1 =
0,2 (4.1.2.3.4)
− sen(π ⋅ T ) + 0,2T
π
Alejandro Bustos Caballero 165
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
0,2V2 π
Mx(t ) = Mx0 − sen( t ) + V2 ⋅ t (4.1.2.3.5)
π 0,2
π
Vx(t ) = −V2 cos( t ) + V2 (4.1.2.3.6)
0,2
π ⋅ V2 π
Ax(t ) = sen( t) (4.1.2.3.7)
0,2 0,2
−C
V2 =
− 0,2 (4.1.2.3.8)
sen(π ⋅ T ) + 0,2T
π
Al igual que con los actuadores horizontales, se realiza un pequeño análisis del
movimiento implementado para dos carreras diferentes, de tal forma que se aumente y
descienda la elevación el paso. El fin de estos análisis es corroborar la validez de los
movimientos.
Aumento de la elevación
10
Posicion del actuador (mm)
0
0 1 2 3 4 5 6
Tiempo (s)
En la figura 4.1.2.3.1 se aprecia cómo la posición del extremo del actuador varía
de forma rápida aunque suave hasta alcanzar un máximo de 10mm en el momento en
que el pie se encuentra a mayor altura y regresar a la posición inicial describiendo la
misma curva.
166 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
40
30
Velocidad del actuador (mm/s)
20
10
-10
-20
-30
-40
-50
0 1 2 3 4 5 6
Tiempo (s)
300
Aceleración del actuador (mm/s 2)
200
100
-100
-200
-300
-400
0 1 2 3 4 5 6
Tiempo (s)
Alejandro Bustos Caballero 167
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-750
-760
-780
-790
-800
-810
-820
-830
0 1 2 3 4 5 6
tiempo (s)
300
200
Velocidad Y del punto A (mm/s)
100
-100
-200
-300
-400
0 1 2 3 4 5 6
tiempo (s)
168 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
2000
-1000
-2000
-3000
-4000
0 1 2 3 4 5 6
tiempo (s)
La figura 4.1.2.3.6 muestra cómo varía la aceleración del punto A a lo largo del
tiempo. Se aprecia cómo los máximos alcanzan un valor de 2027mm/s2 frente a los
1025mm/s2 habituales. El mínimo también varía produciéndose un pico en el instante
t=2s de valor -3143mm/s2, que desciende hasta -3363mm/s2 en los instantes anterior y
posterior, correspondientes a t=1,98s y t=2,02s
Disminución de la elevación
-2
Posicion del actuador (mm)
-4
-6
-8
-10
-12
0 1 2 3 4 5 6
Tiempo (s)
En la figura 4.1.2.3.7 se aprecia cómo la posición del extremo del actuador varía
de forma rápida aunque suave hasta alcanzar un mínimo de -10mm en el momento en
que el pie se encuentra a mayor altura y regresar a la posición inicial describiendo la
misma curva.
Alejandro Bustos Caballero 169
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
40
30
10
-10
-20
-30
-40
-50
0 1 2 3 4 5 6
Tiempo (s)
300
Aceleración del actuador (mm/s 2)
200
100
-100
-200
-300
-400
0 1 2 3 4 5 6
Tiempo (s)
170 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-780
-800
-810
-820
-830
0 1 2 3 4 5 6
tiempo (s)
200
150
Velocidad Y del punto A (mm/s)
100
50
-50
-100
-150
-200
-250
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 171
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
1000
500
-500
-1000
-1500
-2000
-2500
-3000
-3500
0 1 2 3 4 5 6
tiempo (s)
La figura 4.1.2.3.12 muestra cómo varía la aceleración del punto A a lo largo del
tiempo. Se aprecia cómo los máximos alcanzan un valor de 1333mm/s2 frente a los
1025mm/s2 habituales. El valor del mínimo no varía, quedándose en -3143mm/s2,
aunque sí la pendiente de la curva. Las oscilaciones observadas en la velocidad también
se aprecian aquí, llegando a valores de 401,7mm/s2 y de -383,4mm/s2.
El movimiento del primer tramo, que comprende todo el periodo de vuelo del
pie, viene definido por
0,4V1 π
Mx(t ) = Mx0 − sen( t ) + V1 ⋅ t (4.1.2.4.1)
π 0,4
π
Vx(t ) = −V1 cos( t ) + V1 (4.1.2.4.2)
0,4
π ⋅ V1 π
Ax(t ) = sen( t) (4.1.2.4.3)
0,4 0,4
C
V1 =
0,4 (4.1.2.4.4)
− sen(π ⋅ T ) + 0,4T
π
172 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
0,6V2 π
Mx(t ) = Mx0 + sen( t ) − V2 ⋅ t (4.1.2.4.5)
π 0,6
π
Vx(t ) = V2 cos( t ) − V2 (4.1.2.4.6)
0,6
π ⋅ V2 π
Ax(t ) = − sen( t) (4.1.2.4.7)
0,6 0,6
−C
V2 =
0,6 (4.1.2.4.8)
sen(π ⋅ T ) − 0,6T
π
Subida
En la figura 4.1.2.4.1 se aprecia cómo la posición del extremo del actuador varía
suavemente hasta alcanzar un máximo de 10mm y regresar a la posición inicial
describiendo una curva algo más suave. Además de alcanzar el máximo en t=2,4s, se
observa cómo se estabiliza entorno a 10mm durante aproximadamente 0,2s.
Alejandro Bustos Caballero 173
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
10
0
0 1 2 3 4 5 6
Tiempo (s)
20
15
Velocidad del actuador (mm/s)
10
-5
-10
-15
-20
0 1 2 3 4 5 6
Tiempo (s)
174 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
80
60
20
-20
-40
-60
-80
-100
0 1 2 3 4 5 6
Tiempo (s)
-760
-770
Posicion Y del punto A (mm)
-780
-790
-800
-810
-820
-830
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 175
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
200
-100
-200
-300
0 1 2 3 4 5 6
tiempo (s)
1000
500
Aceleracion Y del punto A (mm/s 2)
-500
-1000
-1500
-2000
-2500
-3000
-3500
0 1 2 3 4 5 6
tiempo (s)
La figura 4.1.2.4.6 muestra cómo varía la aceleración del punto A a lo largo del
tiempo. Se aprecia cómo el último máximo del primer paso aumenta hasta 1316mm/s2,
mientras que el primer mínimo del segundo paso se reduce en 279,9mm/s2 hasta
738,1mm/s2. Se aprecia también un “joroba” con un mínimo -174,3mm/s2.
176 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Bajada
-2
Posicion del actuador (mm)
-4
-6
-8
-10
-12
0 1 2 3 4 5 6
Tiempo (s)
En la figura 4.1.2.4.7 se aprecia cómo la posición del extremo del actuador varía
suavemente hasta alcanzar un mínimo de -10mm y regresar a la posición inicial
describiendo una curva algo más suave. Además de alcanzar el máximo en t=2,4s, se
observa cómo se estabiliza entorno a -10mm durante aproximadamente 0,2s.
15
10
Velocidad del actuador (mm/s)
-5
-10
-15
-20
-25
0 1 2 3 4 5 6
Tiempo (s)
Alejandro Bustos Caballero 177
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
80
60
20
-20
-40
-60
-80
-100
0 1 2 3 4 5 6
Tiempo (s)
-780
-790
Posicion Y del punto A (mm)
-800
-810
-820
-830
-840
-850
-860
0 1 2 3 4 5 6
tiempo (s)
178 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
200
-100
-200
-300
0 1 2 3 4 5 6
tiempo (s)
1000
500
Aceleracion Y del punto A (mm/s 2)
-500
-1000
-1500
-2000
-2500
-3000
-3500
0 1 2 3 4 5 6
tiempo (s)
La figura 4.1.2.4.12 muestra cómo varía la aceleración del punto A a lo largo del
tiempo. Se aprecia cómo el último máximo del primer paso decrece hasta 738,1mm/s2,
mientras que el primer mínimo del segundo paso se reduce en 298mm/s2 hasta
1316mm/s2. Se aprecia también un “joroba” con un mínimo -174,3mm/s2.
Alejandro Bustos Caballero 179
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
También se buscan las carreras para las cuales el mecanismo deja de actuar
correctamente. Para ello se realizan simulaciones variando las carreras de los actuadores
hasta determinar el punto en que se produce el fallo del mecanismo. Como punto de
fallo del mecanismo se toma aquel instante en el que se superponen las directrices de las
barras que componen el mecanismo durante el movimiento del mismo. Evidentemente
el fallo del mecanismo real se produce antes debido a que los eslabones que lo
componen tienen una anchura distinta de cero.
Elevación
En primer lugar se halla el punto en que se produce el fallo para una carrera del
actuador positiva, esto es, se aumenta la elevación del pie. En este caso el fallo se
produce para una carrera de 23,8mm. Como se observa en la figura 4.1.2.5.1 a), existe
un momento en el cual los mecanismos inferior y duplicado se superponen, violando la
geometría del propio mecanismo.
En segundo lugar se busca el punto de fallo para una carrera negativa. En esta
ocasión el fallo se produce cuando el pie penetra en el suelo, tal y como se observa en la
figura 4.1.2.5.1 b). En esta ocasión la carrera descendente es tan sólo de 8,5mm. Hay
que tener en cuenta que la simulación se ha realizado con una distancia entre los puntos
A y P2 (extremo delantero del pie) de 90mm; evidentemente, la variación de esta
distancia proporcionará unos resultados distintos.
180 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Inclinación
En primer lugar se halla el punto en que se produce el fallo para una carrera del
actuador positiva. En este caso el fallo se produce para una carrera de 25mm. Como se
observa en la figura 4.1.2.5.1 a), existe un momento en el cual los mecanismos inferior
y duplicado se superponen, violando la geometría del mecanismo real.
En segundo lugar se busca el punto de fallo para una carrera negativa. Al igual
que en el caso anterior, el fallo se produce al violar la geometría del mecanismo, tal y
como se observa en la figura 4.1.2.5.1 b). En esta ocasión la carrera que origina el fallo
del mecanismo es -18mm.
Alejandro Bustos Caballero 181
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
En las figuras 4.2.1, 4.2.2, 4.2.3, 4.2.3bis y 4.2.4 se aprecia cómo el modelo más
simple está contenido en el segundo, y éste a su vez en el tercero, como si de una
muñeca rusa se tratase. También pueden observarse las dimensiones y variables
cinemáticas que se utilizarán en la simulación
182 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Alejandro Bustos Caballero 183
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
184 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Alejandro Bustos Caballero 185
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
1.8
1.6
1.4
θ4 (rad)
1.2
0.8
0 1 2 3 4 5 6 7
θ2 (rad)
186 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
5.8
5.6
5.4
θ3 (rad)
5.2
4.8
4.6
4.4
0 1 2 3 4 5 6 7
θ2 (rad)
Punto B
-125
Posicion Y del punto B (mm)
-130
-135
-140
-145
-150
-20 0 20 40 60 80 100 120 140
Posicion X del punto B (mm)
Alejandro Bustos Caballero 187
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
120
100
Posicion X del punto B (mm)
80
60
40
20
-20
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
-125
Posicion Y del punto B (mm)
-130
-135
-140
-145
-150
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
188 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
170
150
140
130
120
0 1 2 3 4 5 6 7
θ2 (rad)
10
-5
-10
-15
-15 -10 -5 0 5 10 15
Posicion X del centro de masas del eslabon 2 (mm)
Alejandro Bustos Caballero 189
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-50
-55
-60
-65
-70
-75
-10 0 10 20 30 40 50 60 70 80
Posicion X del centro de masas del eslabon 3 (mm)
-24
-26
-28
-30
-32
-34
-36
-38
25 30 35 40 45 50 55 60 65 70
Posicion X del centro de masas del eslabon 4 (mm)
190 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
0.5
-0.5
ω4 (rad/s)
-1
-1.5
-2
-2.5
-3
-3.5
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
0.5
-0.5
ω3 (rad/s)
-1
-1.5
-2
-2.5
-3
-3.5
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Alejandro Bustos Caballero 191
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
alcanza cuando han transcurrido 0,66s desde el inicio del ciclo y el mínimo en 1,98s. La
velocidad inicial es -3,142 mm/s, al igual que al finalizar el ciclo.
Velocidad horizontal
100
Velocidad X del punto B (mm/s)
-100
-200
-300
-400
-500
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Velocidad vertical
192 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
100
-50
-100
-150
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Módulo de la velocidad
450
400
Velocidad del punto B (mm/s)
350
300
250
200
150
100
50
0
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Alejandro Bustos Caballero 193
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidad horizontal
30
20
10
-10
-20
-30
-40
-50
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Velocidad vertical
40
30
20
10
-10
-20
-30
-40
-50
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
194 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidad horizontal
50
-50
-100
-150
-200
-250
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Velocidad vertical
100
80
60
40
20
-20
-40
-60
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Alejandro Bustos Caballero 195
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidad horizontal
20
-20
-40
-60
-80
-100
-120
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Velocidad vertical
50
40
30
20
10
-10
-20
-30
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
196 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
10
5
α 4 (rad/s )
0
2
-5
-10
-15
-20
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
15
10
α 3 (rad/s )
5
2
-5
-10
-15
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Alejandro Bustos Caballero 197
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceleración horizontal
2000
1500
aceleracion X del punto B (mm/s2)
1000
500
-500
-1000
-1500
-2000
-2500
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Aceleración vertical
198 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
1500
500
-500
-1000
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Módulo de la aceleración
2000
aceleracion del punto B (mm/s 2)
1500
1000
500
0
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Alejandro Bustos Caballero 199
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceleración horizontal
50
-50
-100
-150
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Aceleración vertical
100
50
-50
-100
-150
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
200 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceleración horizontal
500
-500
-1000
-1500
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Aceleración vertical
Alejandro Bustos Caballero 201
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
400
200
-200
-400
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Aceleración horizontal
400
200
-200
-400
-600
-800
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
202 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceleración vertical
200
100
-100
-200
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Alejandro Bustos Caballero 203
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
2.7
2.6
2.5
2.4
θ6 (rad)
2.3
2.2
2.1
1.9
1.8
0 2 4 6 8 10 12 14 16 18 20
θ2 (rad)
204 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-0.4
-0.5
-0.6
-0.7
θ7 (rad)
-0.8
-0.9
-1
-1.1
-1.2
-1.3
0 2 4 6 8 10 12 14 16 18 20
θ2 (rad)
-1.6
-1.7
-1.8
θ8 (rad)
-1.9
-2
-2.1
-2.2
-2.3
0 2 4 6 8 10 12 14 16 18 20
θ2 (rad)
Alejandro Bustos Caballero 205
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Punto A
-760
-770
Posicion Y del punto A (mm)
-780
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
-760
Posicion Y del punto A (mm)
-770
-780
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
206 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
200
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
-760
-770
Posicion Y del punto A (mm)
-780
-790
-800
-810
-820
-830
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 207
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
840
830
810
800
790
780
770
760
750
0 2 4 6 8 10 12 14 16 18 20
θ2 (rad)
Punto C
-240
-260
Posicion Y del punto C (mm)
-280
-300
-320
-340
-360
-380
200 220 240 260 280 300 320
Posicion X del punto C (mm)
208 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
300
Posicion X del punto C (mm)
280
260
240
220
200
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 209
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-240
-260
-300
-320
-340
-360
-380
0 1 2 3 4 5 6
tiempo (s)
440
420
Posicion del punto C (mm)
400
380
360
340
320
0 2 4 6 8 10 12 14 16 18 20
θ2 (rad)
Punto M
210 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-346
-347
-349
-350
-351
-352
-353
-354
-355
60 61 62 63 64 65 66 67 68 69 70
Posicion X del punto M (mm)
69
68
Posicion X del punto M (mm)
67
66
65
64
63
62
61
60
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 211
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-346
-348
-349
-350
-351
-352
-353
-354
-355
0 1 2 3 4 5 6
tiempo (s)
360
359
Posicion del punto M (mm)
358
357
356
355
354
353
352
0 2 4 6 8 10 12 14 16 18 20
θ2 (rad)
212 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-200
-210
-220
-230
-240
-250
80 100 120 140 160 180 200
Posicion X del centro de masas del eslabon 5 (mm)
Alejandro Bustos Caballero 213
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-520
-540
-560
-580
-600
60 80 100 120 140 160 180 200 220 240
Posicion X del centro de masas del eslabon 6 (mm)
-380
-390
-400
-410
-420
-430
-440
90 100 110 120 130 140 150 160
Posicion X del centro de masas del eslabon 7 (mm)
La acción de los actuadores genera un lazo que lleva el máximo a los valores
horizontal y vertical de 151,9mm y -378,4mm, respectivamente.
214 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-265
-270
-275
-280
-285
60 70 80 90 100 110 120
Posicion X del centro de masas del eslabon 8 (mm)
Como muestra la figura 4.2.2.1.20, existe cierta similitud entre las trayectorias
de los eslabones 7 y 8. En esta ocasión la curva es decreciente, con valores que oscilan
entre -265mm y -282,3mm en el eje Y, y entre 61,13mm y 113mm en el eje horizontal.
Los actuadores lineales generan lazo que sitúan el máximo en -255mm para
valores del eje X entre 69,31mm y 72,2mm. El mínimo se sitúa en las coordenadas
horizontal y vertical 114mm y -281,4mm, respectivamente.
Alejandro Bustos Caballero 215
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
2
ω6 (rad/s)
-1
-2
0 1 2 3 4 5 6
tiempo (s)
216 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
ω7 (rad/s) 1
-1
-2
0 1 2 3 4 5 6
tiempo (s)
1.5
1
ω8 (rad/s)
0.5
-0.5
-1
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 217
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Punto A
800
Velocidad X del punto A (mm/s)
600
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
218 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
200
-100
-200
-300
0 1 2 3 4 5 6
tiempo (s)
1000
Velocidad del punto A (mm/s)
800
600
400
200
0
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 219
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Punto C
400
300
Velocidad X del punto C (mm/s)
200
100
-100
-200
-300
-400
0 1 2 3 4 5 6
tiempo (s)
700
600
Velocidad Y del punto C (mm/s)
500
400
300
200
100
-100
-200
0 1 2 3 4 5 6
tiempo (s)
220 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidaddel punto C
800
700
600
Velocidad del punto C (mm/s)
500
400
300
200
100
0
0 1 2 3 4 5 6
tiempo (s)
Punto M
Alejandro Bustos Caballero 221
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
20
15
-5
-10
-15
-20
0 1 2 3 4 5 6
tiempo (s)
20
15
Velocidad Y del punto M (mm/s)
10
-5
-10
-15
-20
0 1 2 3 4 5 6
tiempo (s)
222 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidaddel punto M
40
35
30
20
15
10
0
0 1 2 3 4 5 6
tiempo (s)
Velocidad horizontal
100
-100
-200
-300
-400
0 1 2 3 4 5 6
tiempo (s)
La figura 4.2.2.2.13 muestra una gráfica con dos máximos de valor 101,9mm/s y
113,9mm/s (los actuadores sólo modifican el segundo de ellos, llevándolo a 92,09mm/s)
y dos mínimos de valor de 10,4mm/s y -377,6mm/s, los cuales son modificados por la
acción de los actuadores, dejándolos en 8,044mm/s y -372,1mm/s.
Alejandro Bustos Caballero 223
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidad vertical
250
200
150
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
La figura 4.2.2.2.14 muestra una gráfica con dos máximos de valor -6,355mm/s
y 272,4mm/s y dos mínimos de valor de -27,99mm/s y -54,9mm/s. Todos los extremos
de la función son modificados por los actuadores, llevando los máximos a -4,818mm/s y
323,6mm/s y los mínimos, a -19,18mm/s y -78,11mm/s.
Velocidad horizontal
500
400
300
200
100
-100
-200
0 1 2 3 4 5 6
tiempo (s)
224 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidad vertical
300
200
100
-100
-200
0 1 2 3 4 5 6
tiempo (s)
La figura 4.2.2.2.16 muestra una gráfica con dos máximos de valor -8,166mm/s
y 371,9mm/s y dos mínimos de valor de -170,5mm/s y -53,8mm/s. Todos los extremos
de la función son modificados por los actuadores, llevando los máximos a -9,324mm/s y
457,9mm/s y los mínimos, a -134,2mm/s y -102mm/s.
Velocidad horizontal
200
150
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 225
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
La figura 4.2.2.2.17 muestra una gráfica con dos máximos de valor -4,286mm/s
y 209,7mm/s y dos mínimos de valor de -45,95mm/s y -62mm/s. Todos los extremos de
la función sufren en mayor o menor medida variaciones debido a la acción de los
actuadores, llegando los máximos a -3,364mm/s y 242,6mm/s y los mínimos, a -20,26
mm/s y -75,25mm/s.
250
200
150
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
La figura 4.2.2.2.18 muestra una gráfica con dos máximos de valor -5,497mm/s
y 220,5mm/s y dos mínimos de valor de -79,79mm/s y -35,97mm/s. Todos los extremos
de la función son modificados por los actuadores, llevando los máximos a -5,751mm/s y
277,9mm/s y los mínimos, a -57,07mm/s y -68,08mm/s.
Velocidad horizontal
50
-50
-100
-150
-200
0 1 2 3 4 5 6
tiempo (s)
226 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidad vertical
100
80
60
40
20
-20
-40
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 227
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
10
0
α 6 (rad/s )
2
-10
-20
-30
-40
0 1 2 3 4 5 6
tiempo (s)
La aceleración angular del eslabón 5 describe un valle más o menos plano entre
dos máximos, existiendo además un mínimo muy pronunciado, tal y como se observa en
la figura 4.2.2.3.1. El primero de los máximos alcanza un valor de 5,131rad/s2, el
segundo llega hasta 14,92rad/s2, mientras que el mínimo se establece en -29,39rad/s2. El
valle de la curva se fija en torno a -1rad/s2.
228 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
10
α 7 (rad/s )
2
-10
-20
-30
-40
0 1 2 3 4 5 6
tiempo (s)
15
10
α 8 (rad/s )
5
2
-5
-10
-15
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 229
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Punto A
4000
3000
Aceleracion X del punto A (mm/s2)
2000
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
La figura 4.2.2.3.5 muestra cómo varía la aceleración del punto A a lo largo del
tiempo. Se aprecia cómo el último máximo del primer paso aumenta hasta 1316mm/s2,
mientras que el primer máximo del segundo paso se reduce en 279,9mm/s2 hasta
738,1mm/s2. Se aprecia también un “joroba” con un mínimo -174,3mm/s2.
230 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
1000
500
-500
-1000
-1500
-2000
-2500
-3000
-3500
0 1 2 3 4 5 6
tiempo (s)
4500
4000
Aceleracion del punto A (mm/s 2)
3500
3000
2500
2000
1500
1000
500
0
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 231
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Punto C
2000
1000
Aceleracion X del punto C (mm/s2)
-1000
-2000
-3000
-4000
-5000
-6000
0 1 2 3 4 5 6
tiempo (s)
Los actuadores lineales varían los extremos de la curva, llevando los máximos a
2303mm/s2 y 1603mm/s2, y el mínimo hasta -5707mm/s2. También se modifica la zona
central, haciéndola ascendente.
232 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
4000
-2000
-4000
-6000
-8000
0 1 2 3 4 5 6
tiempo (s)
6000
Aceleracion del punto C (mm/s 2)
5000
4000
3000
2000
1000
0
0 1 2 3 4 5 6
tiempo (s)
El módulo de la aceleración del punto C describe una curva muy abrupta, como
se observa en la figura 4.2.2.3.9. Lo más destacable es el máximo al comienzo del ciclo
de valor 6342mm/s2 (que los actuadores elevan a 6697mm/s2) y el mínimo y máximo
locales de valor 1539mm/s2 y 1895mm/s2, respectivamente. En la zona media del ciclo
existe una zona más “llana” con valores que oscilan entre 185mm/s2 y 291,2mm/s2.
Tanto esta zona como el mínimo y el máximo local son modificados ostensiblemente
por el efecto de los actuadores.
Alejandro Bustos Caballero 233
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Punto M
80
60
Aceleracion X del punto M (mm/s2)
40
20
-20
-40
-60
-80
-100
0 1 2 3 4 5 6
tiempo (s)
80
60
Aceleracion Y del punto M (mm/s 2)
40
20
-20
-40
-60
-80
-100
0 1 2 3 4 5 6
tiempo (s)
234 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
120
Aceleracion del punto M (mm/s 2)
100
80
60
40
20
0
0 1 2 3 4 5 6
tiempo (s)
Aceleración horizontal
Los actuadores varían los extremos de la función haciendo crecer los máximos
hasta 634,7mm/s2 y 1671mm/s2 y decrecer el mínimo hasta -3465mm/s2. También
modifica la zona “plana” convirtiéndola en una ligera pendiente.
Alejandro Bustos Caballero 235
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-1000
-2000
-3000
-4000
0 1 2 3 4 5 6
tiempo (s)
Aceleración vertical
2000
1500
1000
500
-500
-1000
-1500
-2000
-2500
0 1 2 3 4 5 6
tiempo (s)
236 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceleración horizontal
1000
-1000
-2000
-3000
0 1 2 3 4 5 6
tiempo (s)
Aceleración vertical
Alejandro Bustos Caballero 237
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
Aceleración horizontal
1000
500
-500
-1000
-1500
-2000
0 1 2 3 4 5 6
tiempo (s)
238 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceleración vertical
1000
500
-500
-1000
-1500
-2000
-2500
-3000
0 1 2 3 4 5 6
tiempo (s)
Aceleración horizontal
Alejandro Bustos Caballero 239
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-500
-1000
-1500
0 1 2 3 4 5 6
tiempo (s)
Aceleración vertical
800
600
400
200
-200
-400
-600
-800
0 1 2 3 4 5 6
tiempo (s)
Por último, la aceleración vertical del cdm del eslabón 8 comienza con un
pronunciado descenso hasta el mínimo global situado en -577,2mm/s2, como muestra la
figura 4.2.2.3.20. Seguidamente escala a una zona más o menos estable en torno a
0mm/s2, para terminar escalando al máximo global, de valor 713mm/s2.
240 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
3.1
3.05
δ (rad)
2.95
0 2 4 6 8 10 12 14 16 18 20
θ2 (rad)
Alejandro Bustos Caballero 241
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-0.4
-0.5
-0.6
-0.7
θ9 (rad)
-0.8
-0.9
-1
-1.1
-1.2
-1.3
0 2 4 6 8 10 12 14 16 18 20
θ2 (rad)
-1.6
-1.7
-1.8
θ10 (rad)
-1.9
-2
-2.1
-2.2
-2.3
0 2 4 6 8 10 12 14 16 18 20
θ2 (rad)
242 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
3.1
3.05
θ11 (rad)
2.95
0 2 4 6 8 10 12 14 16 18 20
θ2 (rad)
Puesto que las dimensiones de la rodilla y del estabilizador (entre los puntos B y
B1) son idénticas, así como las longitudes de fémur y contrafémur, la gráfica de la figura
4.2.3.1.4 es la misma que describe el estabilizador.
3.1
3.05
θ12 (rad)
2.95
0 2 4 6 8 10 12 14 16 18 20
θ2 (rad)
Ocurre lo mismo con la figura 4.2.3.1.5, que muestra el ángulo de posición del
eslabón 12 (correspondiente al pie), al ser simétrica la pierna en su parte inferior.
Alejandro Bustos Caballero 243
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-2
-4
-6
ε (grados)
-8
-10
-12
-14
0 1 2 3 4 5 6
tiempo (s)
El ángulo ε se define como el ángulo que se forma entre el suelo y el pie, siendo
éste inferior a 90º. Por definición, este ángulo es el complementario a θ12, por lo que la
gráfica tiene la misma forma. Sin embargo en esta ocasión se ha expresado la posición
del ángulo en grados para dar una idea más clara de la posición del mismo.
Punto B1
Como era esperable, la figura 4.2.3.1.7 muestra una trayectoria similar a la del
punto B, aunque deformada. Si bien establece una trayectoria casi rectilínea de longitud
similar a la del punto B (unos 130mm), la amplitud vertical es mucho más reducida,
unos 7mm.
244 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-120
-121
-123
-124
-125
-126
-127
-120 -100 -80 -60 -40 -20 0 20 40 60
Posición X del punto B1 (mm)
40
20
Posición X del punto B1 (mm)
-20
-40
-60
-80
-100
-120
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 245
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-120
-121
-123
-124
-125
-126
-127
0 1 2 3 4 5 6
tiempo (s)
Punto B2
-118.2
-118.4
Posicion Y del punto B2 (mm)
-118.6
-118.8
-119
-119.2
-119.4
-119.6
-119.8
-120
-140 -120 -100 -80 -60 -40 -20 0 20
Posición X del punto B2 (mm)
Tal y como corresponde un punto que se desliza por una corredera horizontal, el punto
B2 describe una trayectoria rectilínea sobre la coordenada vertical -119mm con los extremos en
5,568mm y -135,5mm, como se aprecia en la figura 4.2.3.1.10
246 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-20
Posición X del punto B2 (mm)
-40
-60
-80
-100
-120
-140
0 1 2 3 4 5 6
tiempo (s)
En la figura 4.2.3.1.11 se aprecia que la posición horizontal del punto B2 describe una
sinusoide de una amplitud de 141mm centrada en -65mm.
-118.2
-118.4
Posicion Y del punto B2 (mm)
-118.6
-118.8
-119
-119.2
-119.4
-119.6
-119.8
-120
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 247
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Punto A1
-740
-750
Posicion Y del punto A1 (mm)
-760
-770
-780
-790
-800
-810
-820
-830
-200 -150 -100 -50 0 50 100 150
Posición X del punto A1 (mm)
100
Posición X del punto A1 (mm)
50
-50
-100
-150
-200
0 1 2 3 4 5 6
tiempo (s)
248 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-740
-750
Posicion Y del punto A1 (mm)
-760
-770
-780
-790
-800
-810
-820
-830
0 1 2 3 4 5 6
tiempo (s)
-220
-240
Posicion Y del punto C1 (mm)
-260
-280
-300
-320
-340
-360
-380
100 120 140 160 180 200 220
Posicion X del punto C1 (mm)
Alejandro Bustos Caballero 249
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-740
-750
Posicion Y del punto P1 (mm)
-760
-770
-780
-790
-800
-810
-820
-830
-200 -150 -100 -50 0 50 100 150
Posición X del punto P1 (mm)
-780
Posición Y del punto P2 (mm)
-790
-800
-810
-820
-830
0 50 100 150 200 250 300 350
Posicion X del punto P2 (mm)
Lo mismo ocurre con el punto P2, como muestra la figura 4.2.3.1.18, siendo en
esta ocasión la altura alcanzada menor al ser la puntera del pie.
250 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Como era de esperar, el centro de masas del estabilizador describe una curva
similar a la de los puntos B y B1, con una zona rectilínea de unos 130mm y una altura
máxima de unos 13,5mm. La trayectoria del mismo puede apreciarse en la figura
4.2.3.1.19.
-120
-122
-124
-126
-128
-130
-132
-134
-80 -60 -40 -20 0 20 40 60 80
Posicion X del centro de masas del estabilizador (mm)
-180
-190
-200
-210
-220
-230
-240
-250
0 20 40 60 80 100 120
Posicion X del centro de masas del eslabon 9 (mm)
La trayectoria del centro de masas del eslabón 9 describe una curva ascendente y
descendente, como se observa en la figura 4.2.3.1.20. El extremo inferior de la curva no
varía, permaneciendo constante en la coordenada horizontal 86,75mm y -246,5mm en la
vertical. El otro pico varía su posición desde (8,54;-200,4) a (18,09;-184,8), mientras
Alejandro Bustos Caballero 251
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
que el extremo horizontal alcanza los 107,9mm gracias a la acción de los actuadores
frente al habitual 103,9mm. Con el vertical ocurre algo similar, creciendo de -183,5mm
a -171,2mm.
La figura 4.2.3.1.21 muestra una forma similar a la descrita por el cdm del
eslabón 6. El extremo inferior permanece invariable en las coordenadas (-18,59;-596,5).
El otro extremo varía sustancialmente debido a la acción de los actuadores lineales. El
límite horizontal alcanza 140,1mm en lugar de los habituales 118,5mm, mientras que el
límite vertical llega hasta -479,9mm en lugar de -500,8mm.
-480
-500
-520
-540
-560
-580
-600
-20 0 20 40 60 80 100 120 140 160
Posicion X del centro de masas del eslabon 10 (mm)
-240
-260
-280
-300
-320
-340
-360
-380
160 180 200 220 240 260 280
Posicion X del centro de masas del eslabón 11 (mm)
252 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Al igual que ocurre con los puntos A, A1, P1 y P2, el centro de masas del pie
describe una trayectoria similar a la de éstos, como se observa en la figura 4.2.3.1.23.
Gracias a los actuadores se produce un aumento, tanto vertical como horizontalmente de
30mm en la zona anterior del paso. La altura máxima alcanzada es de -753mm, mientras
que el paso normal se queda en -768,8mm.
-760
Posicion Y del centro de masas del pie (mm)
-770
-780
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del centro de masas del pie (mm)
Alejandro Bustos Caballero 253
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
0.8
0.6
0.4
0.2
ωest (rad/s)
-0.2
-0.4
-0.6
-0.8
-1
0 1 2 3 4 5 6
tiempo (s)
2
ω9 (rad/s)
-1
-2
0 1 2 3 4 5 6
tiempo (s)
254 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
1.5
ω10 (rad/s)
0.5
-0.5
-1
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 255
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
0.8
0.6
0.4
0.2
ω11 (rad/s)
-0.2
-0.4
-0.6
-0.8
-1
0 1 2 3 4 5 6
tiempo (s)
Al igual que ocurría con las posiciones, la velocidad del eslabón 11 es la misma
que la del estabilizador dadas las condiciones del mecanismo.
0.8
0.6
0.4
0.2
ω12 (rad/s)
-0.2
-0.4
-0.6
-0.8
-1
0 1 2 3 4 5 6
tiempo (s)
Exactamente lo mismo ocurre con la velocidad angular del eslabón 12, como se
puede comprobar comparando las figuras 4.2.3.2.1, 4.2.3.2.4 y 4.2.3.2.5
256 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Punto B1
-100
-200
-300
-400
-500
0 1 2 3 4 5 6
tiempo (s)
30
Velocidad Y del punto B1 (mm/s)
20
10
-10
-20
-30
-40
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 257
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Punto B2
100
Velocidad X del punto B2 (mm/s)
-100
-200
-300
-400
-500
0 1 2 3 4 5 6
tiempo (s)
0.8
0.6
Velocidad Y del punto B2 (mm/s)
0.4
0.2
-0.2
-0.4
-0.6
-0.8
-1
0 1 2 3 4 5 6
tiempo (s)
258 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Punto A1
800
Velocidad X del punto A1 (mm/s)
600
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 259
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
300
100
-100
-200
-300
-400
0 1 2 3 4 5 6
tiempo (s)
Punto C1
400
300
Velocidad X del punto C1 (mm/s)
200
100
-100
-200
-300
-400
0 1 2 3 4 5 6
tiempo (s)
260 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
600
Velocidad Y del punto C1 (mm/s)
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
Punto P1
800
Velocidad X del punto P1 (mm/s)
600
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 261
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
300
Velocidad Y del punto P1 (mm/s)
200
100
-100
-200
-300
-400
0 1 2 3 4 5 6
tiempo (s)
Punto P2
262 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
800
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
200
Velocidad Y del punto P1 (mm/s)
100
-100
-200
-300
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 263
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidad horizontal
-100
-200
-300
-400
-500
0 1 2 3 4 5 6
tiempo (s)
Velocidad vertical
40
20
-20
-40
-60
0 1 2 3 4 5 6
tiempo (s)
264 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidad horizontal
-100
-200
-300
-400
0 1 2 3 4 5 6
tiempo (s)
La figura 4.2.3.2.20 muestra una gráfica con dos máximos de valor 101,7mm/s y
91,79mm/s (los actuadores sólo modifican el segundo de ellos, llevándolo a 113,6mm/s)
y dos mínimos de valor de 10,26mm/s y -384,5mm/s, los cuales son modificados por la
acción de los actuadores, dejándolos en 8,044mm/s y -378,9mm/s.
Velocidad vertical
La figura 4.2.3.2.21 muestra una gráfica con dos máximos de valor -8,186mm/s
y 311,1mm/s y dos mínimos de valor de -91,59mm/s y -54,16mm/s. Todos los extremos
de la función son modificados por los actuadores, llevando los máximos a -7,155mm/s y
363,2mm/s y los mínimos, a -78,85mm/s y -76,88mm/s.
Alejandro Bustos Caballero 265
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
300
250
200
150
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
Velocidad horizontal
500
400
300
200
100
-100
-200
0 1 2 3 4 5 6
tiempo (s)
Velocidad vertical
La figura 4.2.3.2.23 muestra una gráfica con dos máximos de valor -7,45mm/s y
436,7mm/s y dos mínimos de valor de -248,1mm/s y -54,03mm/s. Todos los extremos
266 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
de la función son modificados por los actuadores, llevando los máximos a -9,404mm/s y
517,7mm/s y los mínimos, a -207,8mm/s y -101,9mm/s.
400
300
200
100
-100
-200
-300
0 1 2 3 4 5 6
tiempo (s)
Velocidad horizontal
400
300
200
100
-100
-200
-300
-400
0 1 2 3 4 5 6
tiempo (s)
La velocidad horizontal del cdm del eslabón 11 varía rápidamente durante todo
el ciclo, tal y como se observa en la figura 4.2.3.2.24. Destacan especialmente el
máximo y mínimo absolutos, de valores 360,1mm/s y -378,2mm/s, respectivamente,
que los actuadores llevan a 405,3mm/s y -353,2mm/s. También sobresalen los extremos
locales, de valor 89,85mm/s el máximo y -77,35mm/s el mínimo. Los actuadores
Alejandro Bustos Caballero 267
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
modifican ligeramente estos puntos, 91,8mm/s en el caso del máximo local y -89,24
mm/s, en el caso del mínimo.
Velocidad vertical
La figura 4.2.3.2.25 muestra una gráfica con dos máximos de valor -16,26mm/s
y 617,6mm/s y dos mínimos de valor de -172,5mm/s y -108,4mm/s. Todos los extremos
de la función son modificados por los actuadores, llevando los máximos a -14,2mm/s y
721,7mm/s y los mínimos, a -150,4mm/s y -155mm/s.
700
600
500
400
300
200
100
-100
-200
0 1 2 3 4 5 6
tiempo (s)
Velocidad horizontal
800
600
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
268 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidad vertical
300
200
100
-100
-200
-300
-400
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 269
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
12
10
6
α est (rad/s )
2
-2
-4
-6
0 1 2 3 4 5 6
tiempo (s)
10
0
α 9 (rad/s )
2
-10
-20
-30
-40
0 1 2 3 4 5 6
tiempo (s)
La aceleración angular del eslabón 9 describe un valle más o menos plano entre
dos máximos, existiendo además un mínimo muy pronunciado, tal y como se observa en
270 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
15
10
α 10 (rad/s )
5
2
-5
-10
-15
0 1 2 3 4 5 6
tiempo (s)
De igual modo que ocurre con la posición y la velocidad del eslabón 11, la
aceleración angular del mismo es idéntica a la del estabilizador por las condiciones
geométricas del mecanismo, tal y como se aprecia en la figura 4.2.3.3.4.
Alejandro Bustos Caballero 271
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
12
10
6
α 11 (rad/s )
2
4
-2
-4
-6
0 1 2 3 4 5 6
tiempo (s)
12
10
6
α 12 (rad/s )
2
-2
-4
-6
0 1 2 3 4 5 6
tiempo (s)
Con el eslabón 12 ocurre exactamente lo mismo que con el eslabón 11, como se
puede comprobar comparando la figura 4.2.3.3.5 con las anteriores.
Punto B1
272 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
de cada ciclo. Destacan los extremos de la función, con un máximo de valor 2063mm/s
y un mínimo de -2219 mm/s.
2000
1000
500
-500
-1000
-1500
-2000
-2500
0 1 2 3 4 5 6
tiempo (s)
400
Aceleracion Y del punto B1 (mm/s 2)
300
200
100
-100
-200
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 273
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Punto B2
2000
1500
Aceleracion X del punto B2 (mm/s2)
1000
500
-500
-1000
-1500
-2000
-2500
0 1 2 3 4 5 6
tiempo (s)
0.8
0.6
Aceleracion Y del punto B2 (mm/s 2)
0.4
0.2
-0.2
-0.4
-0.6
-0.8
-1
0 1 2 3 4 5 6
tiempo (s)
274 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Punto A1
4000
3000
Aceleracion X del punto A1 (mm/s2)
2000
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 275
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
Punto C1
2000
Aceleracion X del punto C1 (mm/s2)
1000
-1000
-2000
-3000
-4000
-5000
-6000
0 1 2 3 4 5 6
tiempo (s)
Los actuadores lineales varían los extremos de la curva, llevando los máximos a
2258mm/s2 y 1555mm/s2, y el mínimo hasta -5846mm/s2. También se modifica la zona
central, haciéndola ascendente.
276 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
4000
Aceleracion Y del punto C1 (mm/s 2)
2000
-2000
-4000
-6000
-8000
0 1 2 3 4 5 6
tiempo (s)
Punto P1
4000
3000
Aceleracion X del punto P1 (mm/s2)
2000
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 277
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
1000
Aceleracion Y del punto P1 (mm/s 2)
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
Punto P2
278 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
4000
3000
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
500
Aceleracion Y del punto P2 (mm/s 2)
-500
-1000
-1500
-2000
-2500
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 279
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceleración horizontal
1500
1000
500
-500
-1000
-1500
-2000
-2500
0 1 2 3 4 5 6
tiempo (s)
Aceleración vertical
600
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
280 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceleración horizontal
1000
-1000
-2000
-3000
-4000
0 1 2 3 4 5 6
tiempo (s)
Los actuadores varían los extremos de la función haciendo crecer los máximos
hasta 594,9mm/s2 y 1611mm/s2 y decrecer el mínimo hasta -3604mm/s2. También
modifica la zona “plana” convirtiéndola en una ligera pendiente.
Aceleración vertical
Alejandro Bustos Caballero 281
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
1000
-1000
-2000
-3000
-4000
0 1 2 3 4 5 6
tiempo (s)
Aceleración horizontal
2000
1000
-1000
-2000
-3000
0 1 2 3 4 5 6
tiempo (s)
282 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceleración vertical
2000
1000
-1000
-2000
-3000
-4000
-5000
-6000
0 1 2 3 4 5 6
tiempo (s)
Aceleración horizontal
Los actuadores lineales varían los extremos de la curva, llevando los máximos a
2302mm/s2 y 1617mm/s2, y el mínimo hasta -5756mm/s2. También se modifica la zona
central, haciéndola ascendente.
Alejandro Bustos Caballero 283
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
1000
-1000
-2000
-3000
-4000
-5000
-6000
0 1 2 3 4 5 6
tiempo (s)
Aceleración vertical
4000
2000
-2000
-4000
-6000
-8000
0 1 2 3 4 5 6
tiempo (s)
284 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceleración horizontal
4000
3000
2000
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
Aceleración vertical
1000
500
-500
-1000
-1500
-2000
-2500
-3000
-3500
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 285
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
La figura 4.2.3.3.27 muestra cómo varía la aceleración del centro de masas del
pie a lo largo del tiempo. Se aprecia cómo el último máximo del primer paso aumenta
hasta 1357mm/s2 desde los habituales 1066mm/s2, mientras que el primer máximo del
segundo paso se reduce en 287,2mm/s2 hasta 788,8mm/s2. Se aprecia también un
“joroba” con un mínimo -176mm/s2.
286 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-370
-380
-390
-400
-410
-420
-430
-440
-450
50 60 70 80 90 100 110 120 130 140
Posicion X del centro de masas del bípedo (mm)
Alejandro Bustos Caballero 287
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
120
110
100
90
80
70
60
50
0 1 2 3 4 5 6
tiempo (s)
-370
-380
-390
-400
-410
-420
-430
-440
-450
0 1 2 3 4 5 6
tiempo (s)
288 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
200
150
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
Como muestra la figura 4.2.4.4, la velocidad horizontal del centro de masas del
actuador presenta un máximo muy pronunciado de valor 250,1mm/s, que asciende hasta
284,1mm/s cuando están presentes los actuadores. Presenta también un mínimo y un
máximo locales de valor -52,43mm/s y -8,969mm/s, así como un mínimo global de
valor -70,65mm/s. Los actuadores modifican todos estos extremos dejándolos en -24,68
mm/s, -7,828mm/s y -84,94mm/s, respectivamente.
300
Velocidad Y del centro de masas (mm/s)
250
200
150
100
50
-50
-100
-150
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 289
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
La figura 4.2.4.6 muestra cómo varía la aceleración del centro de masas de todo
el mecanismo a lo largo del tiempo. Se aprecia cómo el último máximo del primer ciclo
aumenta hasta 1441mm/s2 frente a 1250mm/s2 del ciclo normal. Por otra parte, el primer
máximo del segundo ciclo se reduce en 139,3mm/s2 hasta 101,3mm/s2. Se aprecia
también un “joroba” con un mínimo -156,9mm/s2.
1000
Aceleración X del centro de masas (mm/s)
500
-500
-1000
-1500
-2000
0 1 2 3 4 5 6
tiempo (s)
La acción de los actuadores lineales hace más marcados los extremos absolutos:
1768mm/s2 en el caso del máximo y -3288mm/s2 para el mínimo. También modifican la
zona central del ciclo haciendo la pendiente más pronunciada y acortan el máximo local
a un valor de 455mm/s2.
290 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-1000
-2000
-3000
-4000
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 291
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
4.3.- PARTICULARIDADES
Posiciones
Trayectoria
-350
-360
-370
-380
-390
-400
95 100 105 110 115 120 125 130 135 140 145
Posicion X del centro de masas del bípedo (mm)
Posición horizontal.
292 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
140
130
125
120
115
110
105
100
95
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Posición vertical
-350
-360
-370
-380
-390
-400
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Alejandro Bustos Caballero 293
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Velocidades
Velocidad horizontal
Velocidad horizontal del centro de masas del mecanismo completo
250
150
100
50
-50
-100
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Velocidad vertical
200
Velocidad Y del centro de masas (mm/s)
150
100
50
-50
-100
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
294 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Aceleraciones
Aceleración horizontal
1000
Aceleración X del centro de masas (mm/s)
500
-500
-1000
-1500
-2000
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Aceleración vertical
Como se observa en la figura 4.3.1.7, la gráfica también tiene una forma similar
a la anterior. En esta ocasión el mínimo se sitúa al comienzo del ciclo con un valor de -
2411mm/s2. Los máximos se localizan en t=0,28s y t=1,88s con valores de 382,7mm/s2
y 1354mm/s2, respectivamente. La zona central es ascendente en esta ocasión, con su
mínimo situado en t=0,66s y -107,6mm/s2.
Alejandro Bustos Caballero 295
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
1000
-500
-1000
-1500
-2000
-2500
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Observando las figuras 4.3.2.1 y 4.3.2.2 se aprecia cómo el pie, incluso durante
la fase de apoyo, se encuentra inclinado hacia delante, aunque sea levemente, haciendo
que todo el sistema sea inestable.
-2
-4
-6
ε (grados)
-8
-10
-12
-14
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
296 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-760
Posicion Y de los puntos A y A1(mm)
-770
-780
-790
-800
-810
-820
-830
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Punto A
Punto A1
Alejandro Bustos Caballero 297
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-2
-4
-6
ε (grados)
-8
-10
-12
-14
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
-760
Posicion Y de los puntos A y A1(mm)
-770
-780
-790
-800
-810
-820
-830
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
tiempo (s)
Punto A
Punto A1
298 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
CAPÍTULO 5
Alejandro Bustos Caballero 299
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
5.1.- CONCLUSIONES
Al final del proyecto se puede concluir afirmando que se han alcanzado con
éxito todos y cada uno de los objetivos propuestos al comienzo del mismo. Se ha
conseguido cumplir el objetivo principal:
Además del cumplimiento del objetivo principal, se han alcanzado las siguientes
conclusiones y aportaciones:
300 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Alejandro Bustos Caballero 301
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
302 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
BIBLIOGRAFÍA
Alejandro Bustos Caballero 303
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
BIBLIOGRAFÍA
304 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Direcciones WEB
[3] Wikipedia
http://es.wikipedia.org/wiki/Pantografo (Última visita 20/04/2010)
Alejandro Bustos Caballero 305
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
ANEXOS
Alejandro Bustos Caballero 307
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
ANEXO A
-770
Posicion Y del punto A (mm)
-780
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
Velocidad de 50mm/s
50
45
40
Posicion horizontal del actuador (mm)
35
30
25
20
15
10
0
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
Tiempo (s)
308 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
50
40
30
10
-10
-20
-30
-40
-50
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
Tiempo (s)
-770
-780
Posicion Y del punto A (mm)
-790
-800
-810
-820
-830
-50 0 50 100 150 200 250 300
Posicion X del punto A (mm)
Velocidad de 10mm/s
10
8
Posicion horizontal del actuador (mm)
0
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
Tiempo (s)
Alejandro Bustos Caballero 309
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
10
-2
-4
-6
-8
-10
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
Tiempo (s)
-770
-780
Posicion Y del punto A (mm)
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
Velocidad de -50mm/s
0
-5
-10
Posicion horizontal del actuador (mm)
-15
-20
-25
-30
-35
-40
-45
-50
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
Tiempo (s)
310 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
50
40
30
10
-10
-20
-30
-40
-50
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
Tiempo (s)
-770
-780
Posicion Y del punto A (mm)
-790
-800
-810
-820
-830
-150 -100 -50 0 50 100 150 200
Posicion X del punto A (mm)
Alejandro Bustos Caballero 311
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
25
20
10
0
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
Tiempo (s)
25
20
velocidad del actuador (mm/s)
15
10
0
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
Tiempo (s)
20
15
Aceleración del actuador (mm/s 2)
10
-5
-10
-15
-20
-25
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
Tiempo (s)
312 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-770
-780
-800
-810
-820
-830
-50 0 50 100 150 200 250
Posicion X del punto A (mm)
25
20
Posicion horizontal del actuador (mm)
15
10
0
0 1 2 3 4 5 6
Tiempo (s)
Alejandro Bustos Caballero 313
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
25
20
15
-5
-10
-15
-20
-25
0 1 2 3 4 5 6
Tiempo (s)
250
200
Posicion X del punto A (mm)
150
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
En el segundo ciclo alarga la zancada unos 26mm (226,3 frente a 200) pero la
recorta casi 21 por detrás (-59,18 frente a -81 de la original).
-770
Posicion Y del punto A (mm)
-780
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
314 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
25
20
Posicion horizontal del actuador (mm)
15
10
0
0 1 2 3 4 5 6
Tiempo (s)
25
20
15
velocidad del actuador (mm/s)
10
-5
-10
-15
0 1 2 3 4 5 6
Tiempo (s)
Alejandro Bustos Caballero 315
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
250
200
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
El primer pico del segundo ciclo llega hasta 226, mientras que el segundo se
queda en -32,25. En el tercer ciclo amplía la zancada alargándola hasta 238,5mm por
delante y hasta -43,54mm por detrás.
-770
Posicion Y del punto A (mm)
-780
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
316 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
25
20
10
0
0 1 2 3 4 5 6
Tiempo (s)
25
20
15
velocidad del actuador (mm/s)
10
-5
-10
-15
0 1 2 3 4 5 6
Tiempo (s)
250
200
Posicion X del punto A (mm)
150
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 317
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
En el segundo ciclo alarga hasta 226 frente a 200 del original, pero recorta a -
32,25 desde -81 por detrás. En el tercero alarga por delante un poco hasta 227,2
mientras que por detrás regresa a -81, aunque delante recoge un poco antes.
-770
Posicion Y del punto A (mm)
-780
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
-5
Posicion horizontal del actuador (mm)
-10
-15
-20
-25
0 1 2 3 4 5 6
Tiempo (s)
15
10
5
velocidad del actuador (mm/s)
-5
-10
-15
-20
-25
0 1 2 3 4 5 6
Tiempo (s)
318 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
250
200
150
50
-50
-100
-150
0 1 2 3 4 5 6
tiempo (s)
En el segundo ciclo acorta por delante de 200 a 179 y por detrás alarga de -81 a -
130,7. En el tercero acorta el segundo de 179 a 175, mientras que por detrás se queda
como el original.
-770
Posicion Y del punto A (mm)
-780
-790
-800
-810
-820
-830
-150 -100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
Esta implementación es similar a las anteriores. En este caso los periodos de ida
y vuelta son los mismos, mientras que la velocidad de vuelta (50mm/s) es el doble de la
de ida (25mm/s). El tiempo simulado también son 6 segundos.
Alejandro Bustos Caballero 319
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
25
20
15
-5
-10
-15
-20
-25
0 1 2 3 4 5 6
Tiempo (s)
30
20
10
velocidad del actuador (mm/s)
-10
-20
-30
-40
-50
0 1 2 3 4 5 6
Tiempo (s)
250
200
150
Posicion X del punto A (mm)
100
50
-50
-100
-150
-200
0 1 2 3 4 5 6
tiempo (s)
320 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
En el segundo ciclo alarga por delante hasta 226 y por detrás hasta -115. El tercer ciclo
está retrasado 75mm respecto al original
-770
Posicion Y del punto A (mm)
-780
-790
-800
-810
-820
-830
-200 -150 -100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
25
20
Posicion horizontal del actuador (mm)
15
10
0
0 1 2 3 4 5 6
Tiempo (s)
Alejandro Bustos Caballero 321
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
50
40
30
10
-10
-20
-30
0 1 2 3 4 5 6
Tiempo (s)
300
250
200
Posicion X del punto A (mm)
150
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
-770
Posicion Y del punto A (mm)
-780
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250 300
Posicion X del punto A (mm)
322 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-5
-15
-20
-25
0 1 2 3 4 5 6
Tiempo (s)
30
20
10
velocidad del actuador (mm/s)
-10
-20
-30
-40
-50
0 1 2 3 4 5 6
Tiempo (s)
250
200
Posicion X del punto A (mm)
150
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 323
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Como puede observarse, la zancada se acorta unos 40 mm (de 201 a 160) por delante
mientras que por detrás permanece sin cambios
-780
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
El movimiento del primer tramo (desde el inicio hasta el 20% del ciclo del paso)
viene definido por
− 0,2V1 π
Mx(t ) = Mx0 + sen( t ) + V1 ⋅ t
π 0,2
π
Vx(t ) = −V1 cos( t ) + V1
0,2
π ⋅ V1 π
Ax(t ) = sen( t)
0,2 0,2
C
V1 = ,
0,2
− sen(π ⋅ T ) + 0,2T
π
0,6V2 π
Mx(t ) = Mx0 + sen( t ) − V2 ⋅ t
π 0,6
π
Vx(t ) = V2 cos( t ) − V2
0,6
π ⋅ V2 π
Ax(t ) = − sen( t)
0,6 0,6
C
V2 = ,
0,6
sen(π ⋅ T ) − 0,6T
π
324 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Carrera de 10mm
Con una carrera positiva se consigue el alargamiento anterior del paso, como se
ilustra en las figuras siguientes
12
10
Posicion horizontal del actuador (mm)
0
0 1 2 3 4 5 6
Tiempo (s)
50
40
velocidad del actuador (mm/s)
30
20
10
-10
-20
0 1 2 3 4 5 6
Tiempo (s)
Alejandro Bustos Caballero 325
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
400
300
100
-100
-200
-300
-400
0 1 2 3 4 5 6
Tiempo (s)
250
200
Posicion X del punto A (mm)
150
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
326 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
1000
800
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
5000
4000
3000
Aceleracion X del punto A (mm/s2)
2000
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
-770
Posicion Y del punto A (mm)
-780
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
Alejandro Bustos Caballero 327
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
Carrera de -10mm
-2
Posicion horizontal del actuador (mm)
-4
-6
-8
-10
-12
0 1 2 3 4 5 6
Tiempo (s)
20
10
velocidad del actuador (mm/s)
-10
-20
-30
-40
-50
0 1 2 3 4 5 6
Tiempo (s)
328 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
400
300
100
-100
-200
-300
-400
0 1 2 3 4 5 6
Tiempo (s)
250
200
Posicion X del punto A (mm)
150
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
1000
800
Velocidad X del punto A (mm/s)
600
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 329
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
6000
4000
-2000
-4000
-6000
0 1 2 3 4 5 6
tiempo (s)
-770
Posicion Y del punto A (mm)
-780
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
330 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
El movimiento del primer tramo (desde el 20% hasta el 80% del ciclo del paso)
viene definido por
0,6V1 π
Mx(t ) = Mx0 + sen( t ) − V1 ⋅ t
π 0,6
π
Vx(t ) = V1 cos( t ) − V1
0,6
π ⋅ V1 π
Ax(t ) = − sen( t)
0,6 0,6
C
V1 = ,
0,6
sen(π ⋅ T ) − 0,6T
π
Carrera de 10mm
Alejandro Bustos Caballero 331
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-4
-6
-8
-10
0 1 2 3 4 5 6
Tiempo (s)
50
40
velocidad del actuador (mm/s)
30
20
10
-10
-20
0 1 2 3 4 5 6
Tiempo (s)
400
300
Aceleración del actuador (mm/s 2)
200
100
-100
-200
-300
-400
0 1 2 3 4 5 6
Tiempo (s)
332 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
250
200
150
50
-50
-100
-150
0 1 2 3 4 5 6
tiempo (s)
1000
800
Velocidad X del punto A (mm/s)
600
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
5000
4000
3000
Aceleracion X del punto A (mm/s2)
2000
1000
-1000
-2000
-3000
-4000
-5000
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 333
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
-770
-790
-800
-810
-820
-830
-150 -100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
Carrera de 10mm
10
8
Posicion horizontal del actuador (mm)
-2
0 1 2 3 4 5 6
Tiempo (s)
20
10
velocidad del actuador (mm/s)
-10
-20
-30
-40
-50
0 1 2 3 4 5 6
Tiempo (s)
334 Alejandro Bustos Caballero
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
400
300
100
-100
-200
-300
-400
0 1 2 3 4 5 6
Tiempo (s)
250
200
Posicion X del punto A (mm)
150
100
50
-50
-100
0 1 2 3 4 5 6
tiempo (s)
1000
800
Velocidad X del punto A (mm/s)
600
400
200
-200
-400
0 1 2 3 4 5 6
tiempo (s)
Alejandro Bustos Caballero 335
Modelo paramétrico de la mecánica del robot MIMBOT. Aplicación informática MIMBOT 3.5
6000
4000
-2000
-4000
-6000
0 1 2 3 4 5 6
tiempo (s)
-770
Posicion Y del punto A (mm)
-780
-790
-800
-810
-820
-830
-100 -50 0 50 100 150 200 250
Posicion X del punto A (mm)
336 Alejandro Bustos Caballero