Академический Документы
Профессиональный Документы
Культура Документы
Director:
PhD. Oscar Andrs Vivas Albn
Hoja de Aprobacin
___________________________
___________________________
___________________________
Director
___________________________
PhD. Oscar Andrs Vivas Albn
Jurado ___________________________
Jurado ___________________________
II
III
Hoy
culmina
una
de
las
etapas
ms
el
apoyo
de
mi
pareja,
la
IV
Agradecimientos
Los autores expresan sus agradecimientos a:
Los ingenieros Sergio Salinas y Andrs Vivas por su colaboracin e inters para la
realizacin de este proyecto como directores.
La doctora Adriana Guzmn y a la fisioterapeuta Sofa Ramrez por hacer parte de este
proyecto y compartir sus conocimientos.
Los miembros del Departamento de Electrnica, Instrumentacin y Control por su
profesionalismo y cumplimiento en la labor de docentes.
Los compaeros de la Universidad del Cauca y en especial a nuestros amigos por su
apoyo en cada momento.
Los evaluadores de este proyecto por su labor que engrandecen el aporte cientfico del
mismo.
La Universidad del Cauca por su contribucin administrativa y econmica.
Resumen
Este proyecto describe el modelo, control y simulacin de un exoesqueleto robtico
para reeducacin de pacientes con daos motores causados por una lesin durante el
desarrollo de un cerebro inmaduro, el cual tiene como objetivo optimizar la terapia de
rehabilitacin y con ella la recuperacin del paciente.
El diseo propuesto posee 10 GDL que describe los movimientos y las restricciones de
cada una de las articulaciones de las extremidades inferiores del paciente, el cual
realizara movimientos teraputicos especficos, obtenidos a travs de un estudio de
trayectorias basadas en la teora de visin artificial. Para garantizar el seguimiento de
dichas trayectorias se disea un control por par calculado (CTC), que permite obtener
un error en el orden de los milmetros, permitido en procesos de rehabilitacin.
En el ambiente tridimensional desarrollado en la librera de MATLAB, VirtualReality, se
podr observar el comportamiento del exoesqueleto en el momento de realizar
diferentes ejercicios de reeducacin seleccionados, el cual fue construido a partir de las
piezas diseadas e importadas desde el software CAD solidEdge.
VI
Abstract
This project describes the model, control and simulation of an exoeskeleton robot for
patients' reeducation with motive damages caused by an injury during the development
of an immature brain, which takes as a target to optimize the rehabilitation therapy and
with her the recovery of the patient.
The proposed design possesses 10 GDL that it describes the movements and the
restrictions of each of the joints of the low extremities of the patient, who realized
specific therapeutic movements obtained across a study of trajectories based on the
theory of artificial vision. To guarantee the pursuit of the above mentioned trajectories a
control is designed by studied pair (CTC), which allows to obtain an error in the order of
the millimeters, allowed in processes of rehabilitation.
In the three-dimensional ambience developed in the bookstore of MATLAB ,
VirtualReality, it will be possible to observe the behavior of the exoeskeleton at the
moment of realizing different chosen exercises of reeducation, which was constructed
from the pieces designed and imported from the software CAD solidEdge .
VII
Contenido
INTRODUCCIN ................................................................................................................. 1
1.ESTUDIO DESCRIPTIVO DE LA PARALISIS CEREBRAL INFANTIL O IMOC
(INSUFICIENCIA MOTORA DE ORIGEN CEREBRAL) ....................................................... 3
1.1.
Definicin .................................................................................................................. 3
1.1.1.
Clasificacin .......................................................................................................... 3
1.2.
Causas ...................................................................................................................... 5
1.3.
Tratamiento ............................................................................................................... 7
1.4.
1.5.
2.
2.1.
2.1.1.
2.1.2.
2.2.
2.2.1.
2.2.2.
3.
3.1.
4.
4.1.
4.2.
4.3.
4.4.
5.
5.1.
6.
6.1.
7.
CONCLUCIONES ....................................................................................................... 66
8.
IX
Lista de Tablas
Tabla 2.1 Rangos mximos de movilidad en las articulaciones. ......................................... 15
Tabla. 2.2. ngulos articulares de la postura del paciente. ................................................ 19
Tabla 2.3. Rangos mximos de movilidad en las articulaciones del paciente ..................... 20
Tabla 2.4 Parmetros geomtricos .................................................................................... 24
Tabla 2.5. Nueva tabla de parmetros geomtricos. .......................................................... 28
Tabla 2.6.Parametros dinmicos en su forma general ....................................................... 31
Tabla 2.7.Tabla de parmetros dinmicos base................................................................. 31
Tabla 3.1. Relaciones del modelo Hanavan . ..................................................................... 35
Tabla 3.2. Partes de exoesqueleto..................................................................................... 40
Tabla 3.3. Caractersticas de volumen, densidad y peso de las piezas diseadas en
SolidEdge........................................................................................................................ 42
Tabla 3.4. Referencias de los motores del exoesqueleto ................................................... 43
Tabla 3.5. Valores de los parmetros dinmicos................................................................ 44
Tabla 5.1. Ganancias del controlador CTC. ....................................................................... 57
Lista de Figuras
Figura 1.1. Robot Lokomat, para adultos y nios. ............................................................. 10
Figura 1.2. Traje robtico HAL. .......................................................................................... 11
Figura 1.3. Rewalk, exoesqueleto para paralticos. ............................................................ 11
Figura 1.4. Exoesqueleto Rex. ........................................................................................... 12
Figura 2.1. Modelo geomtrico de las extremidades inferiores. ......................................... 13
Figura 2.2. ngulos de rotacin de las articulaciones de las extremidades inferiores. ....... 14
Figura 2.3. Movimientos fisioteraputicos . ........................................................................ 15
Figura 2.4. ngulos en la extremidad inferior derecha. ................................................... 16
Figura 2.5. ngulos en la extremidad inferior derecha. .................................................. 16
Figura 2.6. ngulos en la extremidad inferior derecha. ................................................... 17
Figura 2.7. Modelos geomtricos de las extremidades inferiores del paciente, vista lateral.
.......................................................................................................................................... 18
Figura 2.8. Modelos geomtricos de las extremidades inferiores del paciente vista frontal. 19
Figura 2.9. Medidas de las extremidades inferiores del paciente. ...................................... 21
Figura 2.10. ngulos de rotacin de las articulaciones del exoesqueleto .......................... 21
Figura 2.11. Modelo geomtrico del exoesqueleto para una sola pierna. ........................... 23
Figura 2.12. Posicin del OT para la pierna derecha. ........................................................ 27
Figura 3.1.Representacin 3D del exoesqueleto robtico. ................................................. 34
Figura 4.1.Mapa conceptual del sistema de adquisicin de trayectorias implementado. .... 47
Figura 4.2. Sistema de adquisicin de trayectorias. ........................................................... 47
Figura 4.3. Marcadores para la flexin y extensin de piernas........................................... 48
Figura 4.4.Trayectorias de las articulaciones en la flexin y extensin de piernas ............. 49
Figura 4.5. Marcadores de la marcha frontal...................................................................... 49
Figura 4.6.Trayectorias de las articulaciones en la Marcha frontal. .................................... 50
Figura 4.7. Marcadores de marcha lateral.......................................................................... 51
Figura 4.8.Trayectorias de las articulaciones en la marcha lateral. .................................... 51
Figura 4.9. Interfaz HMI del toolbox SPTOOL .................................................................... 52
Figura 4.10. Seales de trayectorias filtradas. ................................................................... 53
XI
XII
Lista de Abreviaturas
CTC:
3D:
Tridimensional.
IMOC:
GDL:
Grados De Libertad.
MDD:
MDI:
MGD:
MGI:
SYMORO:
OT:
rgano Terminal.
XIII
Lista De Smbolos
Matriz de inercia.
Matriz de inercia aproximada.
iAj
Matriz de orientacin.
Ci
cos(j)
Cij
cos(i + j)
Si
sin(j)
Sij
sin(i + j)
D, R
Ia
Nmero de la articulacin.
Kp
Kv
Mj
Pi
Vector de posicin.
XIV
INTRODUCCIN
Plasticidad cerebral se refiere a la adaptacin que experimenta el sistema nervioso ante cambios en su medio externo
e interno, adems puede reflejar la adaptacin funcional del cerebro para minimizar los efectos de las lesiones
estructurales y funcionales.
Clasificacin
No todos los pacientes son afectados por un mismo tipo de parlisis cerebral,
esto depende de la localizacin de la lesin, la extensin del dao en el
cuerpo, el tono muscular y el grado de la afectacin, lo cual genera la siguiente
clasificacin [4] [5] [6].
Sistema piramidal est formado por las vas del sistema nervioso central encargadas de llevar los impulsos
nerviosos desde la corteza cerebral motora hasta las alfa-motoneuronas de las astas ventrales de la mdula
espinal.
Segn el tono
1.2. Causas
No existe una causa nica y general de la parlisis cerebral infantil, esta
puede presentarse por diversos trastornos originados en el periodo
prenatal, perinatal o postnatal (hasta los cinco primeros aos de vida) del
nio [6] [7].
Causas postnatales. Son aquellas que actan despus del parto, hasta
los 5 aos de vida del nio.
Traumatismos craneales.
Infecciones: puede el recin nacido contagiarse de meningitis,
meningoencefalitis, etc.
Intoxicaciones: stas se puede presentar por el uso inadecuado de
los medicamentos o por consumo de plomo o arsnico.
Accidentes cerebrovasculares. Ocurren cuando el suministro de
sangre a una parte del cerebro se interrumpe repentinamente o
cuando un vaso sanguneo en el cerebro se rompe, derramando
sangre en los espacios que rodean a las clulas cerebrales [8].
Accidentes por descargas elctricas.
1.3. Tratamiento
En la actualidad no existe una cura total y definitiva de la parlisis cerebral,
pero los pacientes pueden mejorar sus capacidades si reciben un
tratamiento que est acorde a sus sntomas y necesidades, en el cual debe
intervenir un equipo especializado que incluya mdicos, enfermeros,
psiclogos y fisioterapeutas, al igual que sus familiares. Se debe tener en
claro que no se trata la lesin cerebral, sino que se busca desarrollar el
mayor nmero de habilidades que le permitan alcanzar la mayor autonoma
posible, as como la prevencin de las posibles complicaciones que limiten
su funcionalidad.
El tratamiento no solo se orienta en los aspectos motores, tambin se debe
tener en cuenta el desarrollo intelectual, el nivel de comunicacin y la
relaciones sociales. A continuacin se presentan los pilares bsicos para el
tratamiento de la parlisis cerebral infantil [6] [7].
Terapia fsica: esta etapa debe comenzar en los primeros aos de
vida, inmediatamente despus del diagnstico. Emplea combinaciones
de ejercicios y actividades orientados a cumplir con tres metas
importantes:
Convulsiones.
Espasticidad.
Los movimientos atetoides y del babeo.
Trastorno neuromuscular caracterizado por movimientos de torsin, lentos, continuos e involuntarios, que
afectan a las extremidades, como puede verse en algunas formas de parlisis cerebral.
Tratamiento Quirrgico
Existen otras terapias que son parte importante para lograr la rehabilitacin
integral del paciente, como son el tratamiento de babeo, tratamiento de la
incontinencia de la vejiga, tratamientos de los problemas para alimentarse,
tratamiento ortopdico, terapias artsticas y musicoterapia.
11
Rex. En Nueva Zelanda, Rex Bionics, una empresa creada por los
ingenieros Richard Little y Robert Irving crea a Rex (Figura 1.4), un
exoesqueleto que funciona con una batera recargable que le permite
trabajar por dos horas de uso ininterrumpido y es operado a travs de
un joystick. El usuario puede caminar sobre superficies estables y
firmes, no as en lugares resbaladizos o de texturas accidentadas,
como en nieve y terrenos pedregosos [14].
El estudio permiti conocer los diferentes tipos de parlisis y los efectos que
generan en quien la padece, al igual que las aplicaciones de la robtica en este
campo, lo cual nos permite realizar una comparacin entre las caractersticas
funcionales de un exoesqueleto para miembros inferiores, las limitaciones que
presentan los pacientes y la terapia necesaria para su rehabilitacin. Se
determino que el tipo de patologa indicado para el proyecto es la dipleja
espstica moderada, puesto que afecta principalmente las extremidades
inferiores con daos leves en las superiores y permite al paciente cierto grado
de autonoma. Adicional a esto, la terapia principal es mejorar la postura rgida
y anormal y aumentar la habilidad al caminar.
12
Rodilla
Tobillo
Abduccin ()
45 - 50
Aduccin (-)
20 - 30
Flexin ()
135
10
20
Extensin (-)
30
130
50 - 60
Rotacin externa ()
45
10
10
35
10
20
16
17
La paciente presenta:
18
Rodilla
Tobillo
Abduccin ()
Aduccin (-)
10
Flexin ()
15
Extensin (-)
20
45
Rotacin externa ()
20
10
19
Cadera
Rodilla
Tobillo
Abduccin ()
30
Aduccin (-)
20
Flexin ()
110 - 120
20
Extensin (-)
15
110 - 120
45
Rotacin externa ()
20
15
20
22
Figura 2.11. Modelo geomtrico del exoesqueleto para una sola pierna.
En el modelo de la anterior figura, m1, m2, m3, m4 y m5 corresponden a
las articulaciones activas de tipo rotoide, excepto la articulacin 6 que es
una articulacin pasiva [18].
La tabla de parmetros geomtricos se muestra en la tabla 2.4, en donde:
j: articulacin o cuerpo.
uj: articulacin motorizada (1), no motorizada (0).
j: tipo de articulacin (rotacin 0, traslacin 1, pasiva 2).
j: ngulo entre ejes Zj.
dj: longitud de cada unin.
j: variable articular de cada rotoide.
rj: distancia entre los ejes Xj.
23
1
2
3
4
5
6
1
1
1
1
1
0
0
0
0
0
0
2
0
+90
+90
0
0
-90
0
0
D3
D4
D5
D6
1
2
3
4
5
0
0
0
0
0
0
R6
Tj
dj
cos(j )
-sen(j )
cos(j )sen(j ) cos(j )cos(j ) -sen(j ) -rj cos(j )
cos(j )
rj sen(j )
sen(j )sen(j ) sen(j )cos(j )
1
(2.1)
T1
cos(1 )
sen(1 )
-sen(1 )
cos(1 )
1
1
24
-sen(2 )
1
T2
cos(2 )
cos(2 )
-1
-sen(2 )
1
cos(3 )
2
T3
-sen(3 )
sen(3 )
3
-1
cos(3 )
T4
cos(4 )
sen(4 )
-sen(4 )
cos(4 )
4
1
1
T5
cos(5 )
sen(5 )
-sen(5 )
cos(5 )
5
1
1
1
5
T6
-1
6
R6
1
T6
sx
sy
sz
nx
ny
nz
ax Px
ay Py
az Pz
1
Donde:
sx = * sen(5+4+3+1+2) - * sen(-5-4-3+1+2) + *
sen(5+4+3+1-2) + * sen(-5-4-3+1-2) + * cos(-54+1-3) - * cos(5+4+1+3)
25
sy = - * cos(-5-4-3+1-2) - * cos(5+4+3+1-2) + *
cos(-5-4-3+1+2) + * cos(5+4+3+1+2) - *
sen(5+4+1+3) + * sen(-5-4+1-3)
sz= * cos(-5-4+2-3) + * cos(5+4+2+3)
nx= - * cos(1-2) - * cos(1+2)
ny= - * sen(1+2) - * sen(1-2)
nz= - sen(2)
ax= - * cos(5+4+3+1+2) + * cos(-5-4-3+1+2) + *
cos(5+4+3+1-2) - * cos(-5-4-3+1-2) + * sen(-54+1-3) + * sen(5+4+1+3)
ay= - * sen(-5-4-3+1-2) + * sen(5+4+3+1-2) + *
sen(-5-4-3+1+2) - * sen(5+4+3+1+2) - *
cos(5+4+1+3) - * cos(-5-4+1-3)
az= * sen(-5-4+2-3) - * sen(5+4+2+3)
Px= - * D4 * sen(3+1+2) - * D4 * sen(-3+1+2) + * D4 *
sen(3+1-2) + * D4 * sen(-3+1-2) + * D4 * cos(1-3) - *
D4 * cos(1+3) - * R6 * cos(5+4+3+1+2) + * R6 * cos(-54-3+1+2) + * R6 * cos(5+4+3+1-2) - * R6 * cos(-5-43+1-2) + * R6 * sen(-5-4+1-3) + * R6 *
sen(5+4+1+3) - * D3 * sen(1+2) + * D3 * sen(1-2) - *
D6 * sen(5+4+3+1+2) - * D6 * sen(-5-4-3+1+2) + * D6
* sen(5+4+3+1-2) + * D6 * sen(-5-4-3+1-2) + * D6 *
cos(-5-4+1-3) - * D6 * cos(5+4+1+3) - * D5 *
sen(4+3+1+2) - * D5 * sen(-4-3+1+2) + * D5 *
sen(4+3+1-2) + * D5 * sen(-4-3+1-2) + * D5 * cos(4+1-3) - * D5 * cos(4+1+3)
Py= - * D4 * cos(-3+1-2) - * D4 * cos(3+1-2) + * D4 * cos(3+1+2) + * D4 * cos(3+1+2) - * D4 * sen(1+3) + * D4 *
sen(1-3) - * D5 * cos(-4-3+1-2) - * D6 * cos(-5-4-3+12) - * D6 * cos(5+4+3+1-2) + * D6 * cos(-5-4-3+1+2)
26
+ * D6 * cos(5+4+3+1+2) - * D6 * sen(5+4+1+3) + *
D6 * sen(-5-4+1-3) - * D3 * cos(1-2) + * D3 * cos(1+2) -
* R6 * sen(-5-4-3+1-2) + * R6 * sen(5+4+3+1-2) + *
R6 * sen(-5-4-3+1+2) - * R6 * sen(5+4+3+1+2) - * R6
* cos(5+4+1+3) - * R6 * cos(-5-4+1-3) - * D5 *
cos(4+3+1-2) + * D5 * cos(-4-3+1+2) + * D5 *
cos(4+3+1+2) - * D5 * sen(4+1+3) + * D5 * sen(-4+13)
Pz = * D6 * cos(-5-4+2-3) + * D6 * cos(5+4+2+3) + *
R6 * sen(-5-4+2-3) - * R6 * sen(5+4+2+3) + * D5 * cos(4+2-3) + * D5 * cos(4+2+3) + * D4 * cos(2-3) + * D4 *
cos(2+3) + cos(2) * D3.
27
+90
2 +90
+90
D3
D4
D5
-90
D6
R6
28
+Q q +FV + FS sign(q)
(2.2)
Donde son los pares o torques aplicados a cada uno de los sistemas de
accionamiento, A es la matriz de inercia del robot, C la matriz de Coriolis y
fuerzas centrfugas, Q el vector de gravedad, Fv la matriz de frotamientos
viscosos y Fs la matriz de frotamientos secos. Adems de las posiciones
articulares , velocidades articulares y aceleraciones articulares .
El modelo dinmico directo (MDD) es aquel que expresa las aceleraciones
articulares en funcin de las posiciones, velocidades y pares de las
articulaciones, adems de permitir observar el comportamiento del
exoesqueleto robtico. La ecuacin general est descrita por:
29
q g(q,q, fe )
(2.3)
(2.4)
(2.5)
j Sj .
Es decir [ Xj
Yj
Zj
con relacin a
1
2
aj
qj El
30
XX
XY
XZ
YY
YZ
ZZ
MX
MY
MZ
Ia
XX1
XY1
XZ1
YY1
YZ1
ZZ1
M1
Ia1
XX2
XY2
XZ2
YY2
YZ2
ZZ2
M2
Ia2
XX3
XY3
XZ3
YY3
YZ3
ZZ3
M3
Ia3
XX4
XY4
XZ4
YY4
YZ4
ZZ4
M4
Ia4
XX5
XY5
XZ5
YY5
YZ5
ZZ5
M5
Ia5
XX6
XY6
XZ6
YY6
YZ6
ZZ6
M6
XX
XY
XZ
YY
YZ
ZZ
MX
MY
MZ
Ia
ZZ1R
Ia2
XX3R
XY3
XZ3R
YZ3
ZZ3R MX3R
MY3
Ia3
XX4R
XY4
XZ4R
YZ4
ZZ4R MX4R
MY4
Ia4
Ia5
Donde:
XX2R =D5^2 * (M5 + M6) + D4^2 * (M4 + M5 + M6) - D3^2 * (M3 + M4 + M5 + M6)
+ 2 * D6 * MX6 + XX2 - YY2 + YY3 + YY4 + YY5 + 2 * MZ6 * R6 * cos(pi/2.)^2 +
YY6 * cos(pi/2.)^2 + M6 * (D6^2 + R6^2 * cos(pi/2.)^2) 2 * MY6 * R6 * cos(pi/2.) *
sen(pi/2.) + 2 * YZ6 * cos(pi/2.) * sen(pi/2.) + ZZ6 * sen(pi/2.)^2 - (1 - sen(pi/2.)^2) *
(D5^2 * (M5 + M6) + D4^2 * (M4 + M5 + M6) + 2 * D6 * MX6 + YY3 + YY4 + YY5 +
2 * MZ6 * R6 * cos(pi/2.)^2 + YY6 * cos(pi/2.)^2 + M6 * (D6^2 + R6^2 *
cos(pi/2.)^2) 2 * MY6 * R6 * cos(pi/2.) * sen(pi/2.) + 2 * YZ6 * cos(pi/2.) *
sen(pi/2.) + ZZ6 * sen(pi/2.)^2).
XX3R= - (D4^2 * (M4 + M5 + M6)) + XX3 - YY3.
XX4R= - (D5^2 * (M5 + M6)) + XX4 - YY4.
XX5R= - 2 * D6 * MX6 + XX5 + XX6 - YY5 2 * MZ6 * R6 * cos(pi/2.)^2 - YY6 *
cos(pi/2.)^2 - M6 * (D6^2 + R6^2 * cos(pi/2.)^2) + 2 * MY6 * R6 * cos(pi/2.) *
sen(pi/2.) 2 * YZ6 * cos(pi/2.) * sen(pi/2.) - ZZ6 * sen(pi/2.)^2 + 2 * MZ6 * (R6 *
cos(pi/2.)^2 + R6 * sen(pi/2.)^2) + M6 * (R6^2 * cos(pi/2.)^2 + R6^2 * sen(pi/2.)^2).
XY2R= XY2 + D3 * sen(pi/2.) * (MZ3 + MZ4 + MZ5 + MZ6 * cos(pi/2.) + M6 * R6 *
cos(pi/2.) - MY6 * sen(pi/2.)).
XY5R= XY5 - D6 * MY6 * cos(pi/2.) + XY6 * cos(pi/2.) - D6 * MZ6 * sen(pi/2.) - D6 *
M6 * R6 * sen(pi/2.) - MX6 * R6 * sen(pi/2.) + XZ6 * sen(pi/2.).
XZ2R= XZ2 - D3 * cos(pi/2.) * (MZ3 + MZ4 + MZ5 + MZ6 * cos(pi/2.) + M6 * R6 *
cos(pi/2.) - MY6 * sen(pi/2.)).
XZ3R= XZ3 - D4 * (MZ4 + MZ5 + MZ6 * cos(pi/2.) + M6 * R6 * cos(pi/2.) - MY6 *
sen(pi/2.)).
XZ4R= XZ4 - D5 * (MZ5 + MZ6 * cos(pi/2.) + M6 * R6 * cos(pi/2.) - MY6 *
sen(pi/2.)).
XZ5R= XZ5 - D6 * MZ6 * cos(pi/2.) - D6 * M6 * R6 * cos(pi/2.) - MX6 * R6 *
cos(pi/2.) + XZ6 * cos(pi/2.) + D6 * MY6 * sen(pi/2.) - XY6 * sen(pi/2.) - ZZ6 *
cos(pi/2.) * sen(pi/2.).
32
YZ2R= YZ2 + cos(pi/2.) * sen(pi/2.) * (D5^2 * (M5 + M6) + D4^2 * (M4 + M5 + M6)
+ 2 * D6 * MX6 + YY3 + YY4 + YY5 + 2 * MZ6 * R6 * cos(pi/2.)^2 + YY6 *
cos(pi/2.)^2 + M6 * (D6^2 + R6^2 * cos(pi/2.)^2) 2 * MY6 * R6 * cos(pi/2.) *
sen(pi/2.) + 2 * YZ6 * cos(pi/2.) * sen(pi/2.) + ZZ6 * sen(pi/2.)^2).
YZ5R= YZ5 2 * MZ6 * R6 * cos(pi/2.) * sen(pi/2.) - M6 * R6^2 * cos(pi/2.) *
sen(pi/2.) - YY6 * cos(pi/2.) * sen(pi/2.) + ZZ6 * cos(pi/2.) * sen(pi/2.) + YZ6 *
(cos(pi/2.)^2 - sen(pi/2.)^2) + MY6 * (-(R6 * cos(pi/2.)^2) + R6 * sen(pi/2.)^2).
ZZ1R= IA1 + ZZ1 + sen(pi/2.)^2 * (D3^2 * (M3 + M4 + M5 + M6) + YY2 + (1 sen(pi/2.)^2) * (D5^2 * (M5 + M6) + D4^2 * (M4 + M5 + M6) + 2 * D6 * MX6 + YY3
+ YY4 + YY5 + 2 * MZ6 * R6 * cos(pi/2.)^2 + YY6 * cos(pi/2.)^2 + M6 * (D6^2 +
R6^2 * cos(pi/2.)^2) 2 * MY6 * R6 * cos(pi/2.) * sen(pi/2.) + 2 * YZ6 * cos(pi/2.) *
sen(pi/2.) + ZZ6 * sen(pi/2.)^2)).
ZZ2R= D3^2 * (M3 + M4 + M5 + M6) + ZZ2 + sen(pi/2.)^2 * (D5^2 * (M5 + M6) +
D4^2 * (M4 + M5 + M6) + 2 * D6 * MX6 + YY3 + YY4 + YY5 + 2 * MZ6 * R6 *
cos(pi/2.)^2 + YY6 * cos(pi/2.)^2 + M6 * (D6^2 + R6^2 * cos(pi/2.)^2) 2 * MY6 *
R6 * cos(pi/2.) * sen(pi/2.) + 2 * YZ6 * cos(pi/2.) * sen(pi/2.) + ZZ6 * sen(pi/2.)^2).
ZZ3R= D4^2 * (M4 + M5 + M6) + ZZ3.
ZZ4R= D5^2 * (M5 + M6) + ZZ4.
ZZ5R= 2 * D6 * MX6 + ZZ5 + ZZ6 * cos(pi/2.)^2 + 2 * MY6 * R6 * cos(pi/2.) *
sen(pi/2.) 2 * YZ6 * cos(pi/2.) * sen(pi/2.) + 2 * MZ6 * R6 * sen(pi/2.)^2 + YY6 *
sen(pi/2.)^2 + M6 * (D6^2 + R6^2 * sen(pi/2.)^2).
MX2R= D3 * (M3 + M4 + M5 + M6) + MX2.
MX3R= D4 * (M4 + M5 + M6) + MX3.
MX4R= D5 * (M5 + M6) + MX4.
MX5R= D6 * M6 + MX5 + MX6.
MY2R= MY2 - sen(pi/2.) * (MZ3 + MZ4 + MZ5 + MZ6 * cos(pi/2.) + M6 * R6 *
cos(pi/2.) - MY6 * sen(pi/2.)).
33
34
PARTE
ANATOMICA
GEOMETRIA
RELACION
mu
Rmu
Muslo
.24 * Talla
1.54 * rmu
3*
rmu
densidad* *
mu
mu *
.1
mu
2
R
R
( r mu ) + r mu + 1
mu
mu
5 * masa
.21 * Talla
Rpa rmu
rpa .61 * Rpa
. 461 * masa
pa
pa
Pantorrilla
35
igual modo, las cinco articulaciones de la pierna izquierda poseen piezas similares,
con un diseo simtrico.
PIEZA
DESCRIPCIN
DISEO
Base del
sistema
Base.
La articulacin 1 comprende:
Articulacin 1
de la pierna
derecha
La pieza de movimiento
(P2 d).
Pieza P2 d.
36
La articulacin 2 comprende:
Articulacin 2
de la pierna
derecha
La articulacin 3 comprende
las siguientes piezas:
Articulacin 3
de la pierna
derecha
La pieza de movimiento
(P3 d).
Pieza P3 d.
El muslo
(Muslo d).
del
P4 d y P5 d.
paciente
Muslo d.
Pieza Agg1 d.
La pieza de compartimiento
del motor de la rodilla (P6
d).
Pieza P6 d.
La articulacin 4 comprende
las siguientes piezas:
Pieza M4 d.
La pieza de movimiento
(P7 d).
Pieza P7 d.
Articulacin 4
pierna derecha
La pieza de soporte y
ajuste de tamao (P8 d), la
cual ayuda a ajustar el
tamao del exoesqueleto
con respecto a la pantorrilla
del paciente.
Pieza P8 d.
La pieza de compartimiento
del motor del tobillo (P9 d).
Pieza P9 d.
39
Pieza pantorrilla d.
Pieza Agg3 d.
La articulacin 5 comprende:
Articulacin 5
de la pierna
derecha
Pieza M5 d.
La Tabla 3.3 muestra cada una de las piezas en cuatro grandes grupos, el
primero son todas las piezas de la estructura robtica, el segundo grupo
son las piezas de accesorios de agarre o sujecin, el tercer grupo son las
piezas que representan las extremidades inferiores y por ltimo el grupo de
los motores, donde se podrn ver caractersticas propias de cada pieza:
PIEZA
VOLUMEN
(c
DENSIDAD (c )
PESO ( r)
224,60
1,70
381,82
P1 d
83,87
1,70
142,58
P2 d
166,78
1,70
283,53
P3 d
91,80
1,70
156,06
P4 d
0,62
2,68
1,65
P5 d
0,62
2,68
1,65
P6 d
46,96
1,70
79,83
P7 d
46,52
1,70
79,08
P8 d
3,68
2,68
9,88
P9 d
28,50
1,70
48,45
P10 d
350,81
1,70
596,37
P1 i
84,25
1,70
143,23
P2 i
166,78
1,70
283,53
P3 i
94,81
1,70
161,18
P4 i
0,62
2,68
1,65
P5 i
0,62
2,68
1,65
P6 i
46,96
1,70
79,83
P7 i
46,52
1,70
79,08
P8 i
3,68
2,68
9,88
P9 i
28,50
1,70
48,45
41
P10 i
276,05
1,70
469,28
81,13
1,11
90,05
Agg1 i
81,13
1,11
90,05
Agg2 d
47,97
1,11
53,25
Agg2 i
47,97
1,11
53,25
Agg3 d
22,07
1,11
24,50
Agg4 i
22,07
1,11
24,50
996,96
0,94
937,14
Muslo i
996,96
0,94
937,14
Pantorrilla d
419,64
0,94
394,46
Pantorrilla i
419,64
0,94
394,46
36,91
21,13
780,00
M1 i
36,91
21,13
780,00
M2 d
65,97
0,08
5,00
M2 i
65,97
0,08
5,00
M3 d
65,97
21,52
1.420,00
M3 i
65,97
21,52
1.420,00
M4 d
52,23
14,93
780,00
M4 i
52,23
14,93
780,00
M5 d
26,02
29,98
780,00
M5i
26,02
29,98
780,00
42
Motor Mj
Referencia Motor
M1 d - i
EC 40 167183
GP 52C 223089
35
M2 d i
EC 6 250101
GP 6 199687
3.5x10-4
M3 d i
EC max 40 283873
GP52C 223087
23
M4 d i
EC 40 118899
GP 42C 203115
M5 d - i
EC 40 118901
GP 52 C 223081
3.5
transmisin
Torque (N.m)
43
XXj
70.891,48
162.420,31
661.775,06
XYj
4.111,74
- 32.873,20
21.629,46
XZj
178,54
2.035,95
32.475,00
YYj
372,35
7.299,55
460.720,06
YZj
- 3.072,51
10.020,83
- 305.323,04
ZZj
70.997,00
168.478,61
205.656,14
MXj
- 262,56
2.482,87
MYj
4.518,39
12.220,52
19.312,02
MZj
196,20
- 756,86
28.995,54
Mj
288,53
923,00
1.834,00
Iaj
157.165,00
0,08
68.276,00
XXj
1.701.665,33
3.142.445,03
XYj
12.481,00
21.684,86
XZj
39.806,16
- 116.249,71
YYj
1.550.371,32
3.041.227,39
YZj
- 485.789,77
- 566.471,03
ZZj
153.339,43
110.117,86
MXj
- 992,92
1.885,64
MYj
12.117,48
9.188,50
MZj
38.646,76
49.258,35
Mj
964,00
799,00
2.054,08
Iaj
12.240,00
1.571,65
0
Tabla 3.5. Valores de los parmetros dinmicos.
44
Movimientos propios
La ltima etapa permite al paciente tener la posibilidad de que mueva las
extremidades con ayuda de un soporte, pudiendo desplegar al mximo su
capacidad motora y fsica en las rutinas antes desarrolladas.
46
Por medio de la tarjeta de video analgica PVR-TV 7131 SE, se realiza una
conversin analgico / digital de las seales, esto permite que el computador
(procesador de seales) tenga el manejo ideal de las seales a tratar.
Finalmente, se obtienen a travs de
algoritmos computacionales y
47
48
Marcha lateral
La marcha lateral no es un movimiento comn en la vida diaria del paciente,
hacindola importante para activar movimientos articulares y musculares que
han estado en reposo por mucho tiempo.
50
Una vez adquiridas las seales articulares que se generan durante las terapias
fsicas, es necesario realizar un tratamiento y procesamiento de las
trayectorias, debido a parmetros y variables indeseadas como; los errores,
interferencias e incertidumbres en los datos obtenidos.
Filtrado de las seales
El toolbox de matlab sptool es una herramienta que permite crear filtros de
cualquier tipo ingresando la seal de entrada y variando unos parmetros
vistos en la edicin del filtro como se observa en la Figura 4.9.
(4.1)
Las constantes del numerador del filtro son
6=0.018, 5=0.10804,
4=0.27009, 3=0.36013, 2=0.27009, 1=0.10804 y 0=0.01801; las
constantes del denominador del filtro son 6=1, 5=-0.5935, 4=0.9092,
3=-0.29435, 2=0.14904, 1=-0.02046 y 0=0,00248.
Por lo tanto al ingresar una seal analgica como se observa en la Figura 4.10
a travs del filtro, la seal de salida es una seal con gran seguimiento a la
anterior pero sin ruido.
53
w t
w t +
- +
d
,
d
(5.1)
(5.2)
56
Kp
800
1200
1500
1200
1500
Kd
30
30
40
40
40
Al limitar las ganancias vistas en la Tabla 5.1, basndose en los tres tipos de
trayectorias a utilizar (trayectorias de marcha lateral, frontal y de
calentamiento) se obtiene el error articular del control CTC (Figura 5.5)
aproximado 14 x1 -4 radianes o 0.015 grados, esto permite que el controlador
del exoesqueleto pueda manipular los tres tipos de trayectorias a implementar,
y que el seguimiento de estas, sea aproximado en este tipo de sistemas de
rehabilitacin.
6. SIMULACIN
VIRTUAL
EXOESQUELETO ROBTICO.
TRIDIMENSIONAL
DEL
58
59
61
63
65
7. CONCLUCIONES
Existen diversas patologas que producen limitaciones en los movimientos de
distintas extremidades del cuerpo humano, una de ellas es la parlisis cerebral
infantil o IMOC tipo dipleja espstica moderada, que afecta a los nios debido a
una lesin generada durante el desarrollo de un cerebro inmaduro, provocando
dificultad al andar y una postura rgida en forma de tijera.
Una de las actividades que se realiza para tratar esta enfermedad es la terapia
fsica, la cual se practica de forma manual y presentan diversas dificultades como;
la fatiga humana, el control de la fuerza y de la velocidad, la falta de autonoma del
paciente para realizar los movimientos y la necesidad de ajustar su postura.
Una de las soluciones para estos problemas es el exoesqueleto, el cual es una
estructura mecnica que se ajusta a las extremidades inferiores del paciente y
ejecuta una secuencia de ejercicios de rehabilitacin, permitiendo corregir la
postura durante la terapia, brindndole una sensacin de autonoma al paciente y
disminuir las cargas al fisioterapeuta.
En este proyecto se propuso una estructura del exoesqueleto de 10 grados de
libertad, teniendo como base el caso de una paciente de 7 aos de edad que
presenta este tipo de patologa. La nia posee una postura de cadera hacia
delante, rodillas encorvadas, pies en puntillas y hacia dentro, la cual se debe
corregir durante la terapia, a dems los ngulos articulares de la paciente son
diferentes a los de un nio que no presenta este tipo de patologa, lo cual se debe
tener en cuenta para evitar mayores daos durante los ejercicios.
Teniendo clara la estructura del exoesqueleto se hall los parmetros geomtricos
y se calculo el modelo geomtrico directo, empleando las matrices de
transformacin, a travs de la aplicacin de computador SYMORO. Este modelo
genero inicialmente una posicin cartesiana del OT no adecuada y para corregir
este error se cambio el valor de 1 en la tabla de parmetros geomtrico, lo que
permiti obtener la posicin deseada al realizar nuevamente el clculo del MGD.
El MDD nos permite observar el comportamiento del exoesqueleto y es aquel que
expresa las aceleraciones articulares en funcin de las posiciones, velocidades y
pares de las articulaciones. El MDI describe la relacin entre los pares de fuerza
aplicados a los actuadores y las posiciones, velocidades y aceleraciones
articulares. Estos modelos son muy importante para el control y simulacin del
exoesqueleto y son calculados en el software SYMORO.
66
67
8. REFERENCIAS BIBLIOGRFICAS
[1] La relevancia de los primeros aos de vida del nio, 2009. [Online].
Disponible:
http://www.cosasdelainfancia.com/biblioteca-esti-t-12.htm.
[Consultado Abril, 2010].
[2] B. Steven, uando su hijo tiene parlisis cerebral, 2006. [Online].
Disponible:
http://kidshealth.org/parent/en_espanol/medicos/cerebral_palsy_esp.html#.
[Consultado Abril, 2010].
[3] M.
Joan,
Parlisis
cerebral
infantil,
[Online].
Disponible:
http://www.aepap.org/familia/paralisisci.htm. [Consultado agosto, 2010].
[4] Fundacin ON E, Parlisis
erebral,
2
. [Online].Disponible:
http://salud.discapnet.es/Castellano/Salud/Enfermedades/EnfermedadesDisc
apacitantes/P/Paralisis%20cerebral/Paginas/Descripcion.aspx. [Consultado
agosto, 2010].
[5] F. Natalio and F.A. Emilio, Neurologa Peditrica, 3ra Edicin. Buenos Aires:
Editorial Mdica Panamericana, 2007.
[6] M.
Ana,
La
parlisis
cerebral.
[Online].
Disponible:
http://www.aspace.org/aspace/ESP/Informaci%C3%B3n+Corporativa/Descar
gas/Documentos/. [Consultado agosto, 2010].
[7] H. Legnica, Parlisis cerebral infantil. 2009. [Online]. Disponible:
http://www.slideshare.net/Legnica/parlisis-cerebral-infantil-1042976.
[Consultado Agosto, 2010].
[8] GeoSalud, ccidentes Vascular erebral Factores de Riesgo. [Online].
Disponible:
http://www.geosalud.com/Enfermedades%20Cardiovasculares/AVC%20fact
ores%20de%20riesgo.htm. [Consultado agosto, 2010].
68
69
ontrol of Robots.
odelling of
[24] S. Raymond and J. John. Physics for Scientists and Engineers with Modern
Physics. 7ta Edicin. Monterey: Editorial Brooks-Cole, 2008.
[25] G. Guillermo. Sistema para nlisis de la archa umana, Benemrita
Universidad
Autnoma
de
Puebla,
2004.
[Pdf].
Disponible:
http://perseo.cs.buap.mx/bellatrix/tesis/TES693.pdf. [Consultado agosto,
2010].
[26] R. Lawrence and G. Bermard. Theory and Application of Digital Signal
Processing. Editorial Prentice-Hall, 1975.
[27] Maxonmotor.
[Online].
[Consultado agosto, 2010].
Disponible:
70
http://www.maxonmotor.com.
71
% angulos en grados
cad = [cad; 180*atan2(Vcr(1),Vcr(2))/pi];
rod = [rod; 180*acos(dot(Vcr,Vrt)/(mVcr*mVrt))/pi];
tob = [tob; 180*acos(dot(Vrt,Vtp)/(mVrt*mVtp))/pi];
%% mostrando los ngulos en la grfica
hold off
imshow(frame), hold on
line(centros(:,1), centros(:,2),'Marker','*')
text(centros(1,1)+20,centros(1,2),['cadera =
',num2str(cad(i))],'Color','w')
text(centros(2,1)+20,centros(2,2),['rodilla =
',num2str(rod(i))],'Color','w')
text(centros(3,1)+20,centros(3,2),['tobillo =
',num2str(tob(i))],'Color','w')
end
ts=1/fileinfo.FramesPerSecond;
for (i=1:nf)
cc=(ts)*i;
mat(i,1)=cc;
mat(i,2)=0;
%
mat(i,3)=0;
mat(i,3)=cad(i,1);
mat(i,4)=rod(i,1);
mat(i,5)=tob(i,1);
end
save ('tray.mat','mat');
72