Desarrollo de un Exoesqueleto para
Rehabilitación de Tobillo y Rodilla
R. López* J. Torres* S. Salazar * R. Lózano** * CINVESTAV, México. ** UTC, France. |
Palabras clave: Exoesqueleto, Rehabilitación, Ortesis instrumentada, SEA, Control de Fuerza. |
Correspondencia: |
Keywords: Exoskeleton, Rehabilitation, instrumented orthosis, SEA, Force control. |
La asistencia del fisioterapeuta para realizar el ejercicio puede variar dejando que el paciente haga el ejercicio completamente solo, asistiendo completa o parcialmente para la realización del mismo. Existen diferentes tipos de ejercicios de rehabilitación como los ejercicios de fortalecimiento, estos incrementan la cantidad de fuerza que el músculo puede generar. En un ejercicio isométrico, la longitud de la fibra muscular es constante, de forma que la contracción muscular ocurre sin movimiento articular. Un ejercicio isotónico es un ejercicio dinámico realizado con una carga o resistencia constante, pero sin controlar la velocidad del movimiento, en estos ejercicios la tensión de una fibra muscular es relativamente constante. El ejercicio isocinético origina un movimiento articular constante, para esto se varía la resistencia en una respuesta a la fuerza muscular aplicada. La ventaja del ejercicio isocinético es que el musculo puede fortalecerse de forma óptima manteniendo un rango de movimiento articular completo, cosa que no es posible con los isométricos ni con los isotónicos. La desventaja del ejercicio isocinético es que requiere de la utilización de una máquina para variar la resistencia mientras se mantiene una tasa constante de movimiento [1]. En las últimas décadas, muchos robots dedicados a la rehabilitación de extremidades inferiores se han desarrollado para recobrar la movilidad de las extremidades afectadas. Los llamados entrenadores de la marcha estáticos son sistemas robóticos que se centran en los movimientos guiados de extremidades con el fin de tener un efecto óptimo desde un punto de vista terapéutico y funcional. El objetivo de estos sistemas es la obtención del fortalecimiento eficaz de los músculos y el desarrollo de resistencia, así como la movilidad articular y coordinación de movimientos. El MotionMaker [2] de Swortec SA, es un sistema de entrenamiento estacionario que permite realizar ejercicios de movimientos en las articulaciones con la participación activa de los miembros paralizados. Las extremidades están conectadas a la ortesis en el nivel del pie para simular fuerzas naturales de reacción del suelo. Este sistema ofrece ejercicios controlados por sensores en tiempo real combinados con la electro estimulación controlada y adaptados a los esfuerzos del paciente. El lambda [3] es un robot para rehabilitación y ejercitación, se utiliza en la movilización de las extremidades inferiores, con su ayuda se proporciona el movimiento de las extremidades inferiores en el plano sagital, el cual incluye una rotación adicional de la movilización del tobillo. Otros ejemplo de este tipo de configuración es un sistema de rehabilitación con alambres impulsado por la pierna desarrollado por el Instituto Nacional de Ciencia Industrial Avanzada y Tecnología (AIST) de Tsukuba [4]. Con lo que respecta al movimiento del tobillo este es complicado debido a sus estructuras óseas complejas [5]. Muchos sistemas se han desarrollado para ejercitar o restaurar estos movimientos del tobillo y la rodilla. Estos sistemas pueden agruparse en estacionarios o activos. Los sistemas estacionarios son los mecanismos robóticos diseñados para ejercitar el tobillo humano y los movimientos de rodilla sin caminar. El paciente se coloca siempre en el mismo lugar y sólo el miembro requerido se ejercita. Algunos ejemplos de estos exoesqueletos son: AKROD [6]; Leg-Robot [7]; GIST [8]. Las ortesis del pie activas, por el contrario a los sistemas estacionarios, son exoesqueletos actuados que el usuario lleva puesto mientras camina en la superficie o en caminadora. Entre otras, tienen la finalidad de controlar la posición y el movimiento del tobillo, compensar la debilidad y/o corregir deformidades. Estos sistemas son una evolución de las tradicionales ortesis pasivas de miembros inferiores, con capacidades adicionales para promover la dinámica de la marcha apropiada para la rehabilitación [9]. Algunos ejemplos son: Anklebot [10]; Interactive Motion [11], [12]; KAFO [13]; RGT [14]. Estos son algunos de los exoesqueletos con objetivos similares al presentado en este artículo, el cual presenta algunas ventajas al utilizar actuadores de tipo SEA, El costo se reduce en comparación con otros actuadores utilizados en diferentes exoesqueletos. Otra de las ventajas de utilizar este tipo de actuadores se encuentra en la estructura mecánica que proporciona torques eficientes sin la necesidad de utilizar motores con mucha potencia. Al observar los distintos exoesqueletos que existen se consideró que diseñar un exoesqueleto pretendiendo que pueda utilizarse en diferentes usuarios resulta muy complicado. La ventaja principal de utilizar una ortesis que está diseñada para cumplir con las necesidades individuales de cada usuario es permitirnos que la robótica que conforma el exoesqueleto únicamente se enfoque en instrumentar adecuadamente para realizar los ejercicios de rehabilitación y así generalizar el uso de este tipo de exoesqueletos. Las ventajas de utilizar exoesqueletos para la rehabilitación, son, aprovechar la precisión que tiene un robot en poder aumentar gradualmente la velocidad en las repeticiones de una secuencia, la extensión de la posición articular, la resistencia o fuerza de oposición de un ejercicio de aumento de fuerza, etc. En algunos ejercicios la resistencia que opone el fisioterapeuta deberá ser aumentada gradualmente para obtener una mejoría en el paciente, sin embargo sin la presencia de sensores que estimen datos precisos queda solamente la percepción errónea humana de la fuerza, lo que podría retrasar la rehabilitación del paciente. Durante el tratamiento, hay que recordar que el fisioterapeuta también puede provocar fracturas. Por lo tanto, se debe conocer el estado del paciente, realizar siempre tomas cortas, presiones manuales y rehuir de resistencias externas y distales que supongan brazos de palanca excesivos. Los exámenes musculares son una guía de utilidad para evaluar la mejoría en la fuerza muscular durante la fase de recuperación, en este sentido los robots tiene la ventaja de poder almacenar en su memoria el historial completo del paciente y así evaluar gradualmente su mejoría. En este trabajo desarrollamos un exoesqueleto de dos grados de libertad que asistirá a la rodilla y el tobillo de la pierna derecha (o izquierda) Figura (1). El objetivo principal es proporcionar una amplificación de fuerza al usuario tal que permita mantenerse en pie, además de poder realizar algunos ejercicios como flexionar la pierna reduciendo así el esfuerzo producido por el humano. Este prototipo se utiliza en ejercicios estáticos y no de la marcha, de tal forma que el peso del mismo no afecta la extremidad izquierda. El prototipo utiliza un control de fuerza programado en un microcontrolador, que proporciona las señales que controlan los movimientos de rotación en las articulaciones biomecánicas que funcionan con actuadores de tipo SEA (Actuadores Elásticos Seriales) como los que se presentan en [15]. Los actuadores SEA contienen un resorte colocado entre la transmisión y la carga de salida, cuya elongación es medida por medio de un potenciómetro lineal, con esto se puede estimar la fuerza humana. Esta señal es una de las entradas de control, además se utilizan enconders ópticos para medir la posición angular y giróscopos para medir la velocidad angular en las articulaciones. Por último, la parte que amplifica la fuerza en el exoesqueleto es la transmisión del actuador obtenida por la ganancia que existe en un mecanismo con un tornillo sin fin y un husillo de bolas. Este artículo está estructurado de la siguiente manera, en la sección 2 se describe el diseño del dispositivo. En la sección 3 se presenta el modelado del actuador, el modelo dinámico del exoesqueleto y la pierna humana. En la sección 4 se presenta el control y el análisis de estabilidad. La sección 5 está dedicada al estudio en simulación del exoesqueleto. En la sección 6 se muestran los resultados obtenidos en tiempo real, y por último se presentan las conclusiones en la sección 7. En resumen en este trabajo se presenta el desarrollo de un exoesqueleto de dos grados de la libertad (la rodilla y el tobillo), la construcción del actuador SEA, el modelo dinámico del exoesqueleto, el control PD con compensación de la gravedad, los resultados experimentales y de simulación. Una de las principales aportaciones de este trabajo es en el campo de los exoesqueletos basados en actuadores de tipo SEA, pues se integran dos actuadores para construir un exoesqueleto con dos grados de libertad, que auxilia en el esfuerzo realizado por la pierna humana derecha. |
Metodología
Prototipo experimental del exoesqueleto
Estructura de la piernaSe diseñó un exoesqueleto instrumentando la ortesis de una persona de 76 kg. Para la construcción del dispositivo se trabajó sobre un aparato largo mixto con socket cuadrilateral que consta de un aparato terminal tobillo - pie con apoyo en cóndilos femorales. El material de la carcasa es polipropileno con barras de duraluminio laterales y mediales, y articulación de rodilla libre. El aparato completo mide 83cm de largo, 47cm de la parte alta de la pierna y 36cm de la parte baja. Está instrumentado con actuadores tipo SEA, sensores de fuerza, encoder ópticos y giróscopos, ver Figura (2).
Actuadores Elásticos Seriales (SEA)Se diseñaron dos actuadores para acoplarse a la rodilla y al tobillo. El actuador que se construyó para la rodilla es muy similar al que se construyó para asistir al tobillo, las diferencias entre estos sólo radican en el tamaño y forma de las diferentes piezas que conforman a los actuadores, pero están basados en el mismo principio de funcionalidad. Cada uno se compone de dos partes principales. En la Figura (3) en el recuadro b se muestran desacopladas las dos partes del actuador, para acoplarlas se hace a través de baleros lineales que le permiten deslizarse para comprimirse o expandirse. La primera parte mide 33.4cm para el actuador de la rodilla y 6.1cm para el actuador del tobillo, esta parte contiene en el extremo final una husillo de bolas, y un arreglo de resortes con constante ks1=173.8N/m para el actuador de la rodilla y ks2=181.0N/m para el del tobillo, esto nos permite estimar fuerzas generadas por el humano de magnitudes alrededor de 0 a 5 N. Los resortes se colocan de manera que se deforman cuando se aplica una fuerza al extremo del actuador completo, esta elongación se mide por un sensor de posición lineal, y se utiliza para estimar la fuerza aplicada por el usuario. En la parte superior de cada actuador se acopló un motor de 12volts con un torque máximo de 5Nm (actuador de la rodilla) y 1.8Nm (actuador del tobillo), estos motores están acoplados a un tornillo sin fin con paso de 30.480mm en la rodilla y 5.08mm en el tobillo tomando en cuenta los movimientos naturales de la pierna humana, los cuales al girar desplazan las tuercas de bolas realizando el desplazamiento del actuador, lo que se traduce en una expansión o compresión dependiendo de la dirección en la que gire el motor. Los actuadores se fijan al aparato ortopédico por medio de rótulas como se observa en la Figura (4), lo que permite a los actuadores pivotear con libertad de tal forma que al expandirse o comprimirse la pierna se extiende o se flexiona. En la Figura (3) en el recuadro a se muestra el actuador utilizado para asistir a la rodilla y en el recuadro c se muestra el actuador utilizado para asistir a el tobillo.
Figura 2: Componentes del prototipo experimental y diagrama a bloques de los componentes del prototipo.
Figura 3: a) Modelo mecánico del actuador para la rodilla acoplado, b)Modelo mecánico del actuador para la rodilla desacoplado en las dos partes principales que lo conforman, c) Modelo mecánico del acutador para el tobillo acoplado.
Electrónica incorporadaLa parte electrónica del exoesqueleto esta conformada principalmente por un microcontrolador rabbit 3400 que se utiliza como cerebro del sistema, este procesa las señales de entrada que provienen de un sensor de posición lineal MLT 0R5N0750 F5C, un enconder óptico 600EN-128-CBL que mide la posición angular y un giróscopo LPR510AL que mide la velocidad angular. Cada articulación utiliza estos 3 sensores, la señal de salida es de tipo PWM y se amplifica por medio de un Driver MD03 que proporciona la cantidad de voltaje suficiente para operar a los motores de los actuadores. En la Figura (2) se observa en un diagrama a bloques la instrumentación del exoesqueleto.
Figura 4: Unión entre los actuadores con el exoesqueleto mediante un punto que pivota.
Modelo dinámico
Modelo dinámico del Actuador Elástico Serial (SEA)El prototipo experimental opera usando un algoritmo de control de la fuerza y esto se lleva a cabo mediante el uso de un actuador tipo SEA [16], [17], [18], [19] y [20]. El principio de funcionamiento es el siguiente. Un resorte se introduce entre el tren de engranajes y de la carga. La fuerza se calcula mediante el uso de un sensor de posición y la ley de Hook (F = ksx). El resorte se introduce para convertir el problema de control de fuerza en un problema de control de posición. Esas características son ideales para nuestra aplicación debido a que la fuerza utilizada representa un factor importante en la rehabilitación del paciente.
Figura 5: Representación gráfica del modelo dinámico de un actuador tipo SEA y representación gráfica de las fuerzas que actúan en el biomecanismo. El modelo dinámico del actuador SEA así como diferentes tipos de controles se han estudiado en artículos como [21]. En este artículo se presenta un modelo dinámico, a partir de la suposición de que un actuador tipo SEA tiene una estructura mecánica como se muestra en la parte inferior de la Figura (5). Donde fm es la fuerza que produce el motor a través de la transmisión mecánica, K es una amplificación de fuerza aplicada al torque del motor τmot que surge de utilizar un tornillo sin fin, mm es una pequeña masa que se desliza a lo largo del tornillo sin fin por medio de un husillo de bolas, ml es la masa total a la que se le aplica la fuerza resultante del actuador fa, ks es la constante del resorte colocado entre la masa mm y la masa ml y existe un pequeño coeficiente de fricción bm que resulta del rozamiento del tornillo sin fin con el husillo de bolas. Del sistema mecánico del actuador se deriva que a la fuerza del motor fm se le opone la masa mm, la rigidez del resorte con constante ks y el coeficiente de fricción bm, de lo anterior resulta la siguiente ecuación de segundo orden lineal con coeficientes constantes:
La posición de la tuerca y la carga están representados por xn y xl respectivamente. Podemos ver que fa definido como fa = ks(xm - xl) es la única fuerza que actúa sobre la masa ml por lo tanto
Del las ecuaciones (2) y (1) se obtiene el modelo dinámico del actuador.
El modelo anterior se puede reducir si consideramos que bm << 1, resultando:
Realmente, la última expresión es válida para ambos actuadores que se fabrican para el exoesqueleto bajo estudio, considerando los valores de los parámetros (fai, fmi, ksi, mi y mmi) definidos anteriormente. En adelante para todo el artículo el subíndice i = 1 se refiere al actuador en la articulación del tobillo, mientras i = 2 se refiere al actuador en la articulación de la rodilla.
Modelo dinámico del exoesqueletoEn la parte superior de la Figura (5) se representan las fuerzas que actúan sobre diferentes puntos de la parte baja y alta de la pierna a lo largo de la extremidad y que producen los diferentes torques que afectan el movimiento de las articulaciones del biomecanismo. Donde l1 es la longitud de la pierna baja, l2 es la longitud de la pierna alta, l5 es la longitud a la que se encuentra aplicada la fuerza del actuador fa1 que asiste al tobillo. La fuerza fa2 es debida al actuador que asiste a la rodilla, θ1 y θ2 son los ángulos en las articulaciones de la rodilla y el tobillo respectivamente, m1 es la masa de la pierna baja y m2 es la masa de la pierna alta, M es la masa adicional a la pierna colocada sobre el exoesqueleto y g que representa la aceleración de la gravedad. Así también se generan los vectores, 1, 2, 3 y 4 donde y son vectores unitarios asociados con la dirección de los ejes coordenados cartesianos en el plano (x,y).
Note que l1 y l2 corresponden a las magnitudes de los vectores 1 y 2 respectivamente.
Al realizar el producto vectorial representado por "×", entre 1, 2, 3, 4 y 5 y las distintas fuerzas que actúan en el exoesqueleto, obtenemos los torques que producen los desplazamiento angulares θ1 y θ2. De lo anterior podemos escribir las ecuaciones dinámicas del tobillo (10) y la rodilla (11).
donde es un vector unitario asociado al eje z. La entrada τ1 en la ecuación (10) es la suma de los torques producidos por las fuerzas de los actuadores fa1 y fa2 adicionalmente existe un torque producido por la fuerza humana τh1 que compensa una porción de la gravedad que afecta a la pierna, ver ecuación (23).
El torque τ2 en la ecuación de la rodilla (11) es la suma del torque producido por la fuerza resultante del actuador fa2 y el torque producido por la fuerza humana τh2 que compensa una porción de la gravedad que afecta a la pierna alta, ver ecuación (24).
Se observa que en las ecuaciones (12) y (13) fa1 y fa2 están multiplicados únicamente por las longitudes l5 y l2, respectivamente. Ahora utilizando (12) y (10) y realizando los productos vectoriales obtenemos la siguiente ecuación dinámica del tobillo:
Si sustituimos (13) en (11) y realizamos los productos vectoriales obtenemos la ecuación para la rodilla:
Por lo tanto de (14) y (15) podemos expresar el modelo dinámico del exoesqueleto como:
donde:
Considerando la pierna como la unión de dos barras cilíndricas [22], el momento de inercia J1 y J2 para el tobillo y la rodilla respectivamente son:
Los términos de gravedad g1(θ) y g2(θ) son:
Considerando que el exoesqueleto no cargara completamente con el peso del humano, se tiene que el humano compensará una parte de la gravedad mientras la parte restante la compensará el actuador. De esta manera se puede dividir el término de gravedad como sigue:
con 0 < kgi < 1 para i=1,2. El término (1 -kg1)g1(θ) es debido a un torque en el tobillo τh1 generado con fuerza proporcionada por el humano, así como el término (1 - kg2)g2(θ) es debido a un torque en la rodilla τh2 generado con fuerza proporcionada por el humano como se observa en las siguientes ecuaciones:
De estas últimas expresiones resulta claro que el esfuerzo del humano se ve reducido por un factor menor a uno. Ahora bien, para poder añadir el modelo del actuador (4) en el modelo del exoesqueleto, se propone realizar un cambio de variables z1 = fa y z2 = ḟa así obtenemos:
donde:
Ahora bien reescribiendo el modelo dinámico (16) a ecuaciones de estados donde x1 = θ y x2 = obtenemos:
Del modelo (26) en conjunto con el modelo (25) se obtiene una representación del estado con perturbaciones singulares dado que J >> Iε. Este sistema dinámico responde a estímulos externos con diferentes tiempos transitorios uno rápido y el otro lento, el modelo dinámico del actuador es el que tiene una dinámica rápida debido a que el parámetro ε es del orden de 7.4*10-6. De tal forma que al hacer ε = 0, se causa un cambio abrupto en las propiedades dinámicas del sistema, pues la ecuación diferencial (25) degenera en la ecuación algebraica:
Se dice que el modelo (25) y (26) está en la forma "típica" si (27) tiene todas sus raíces reales aisladas:
para i = 1,2,...,k Esta hipótesis asegura que a cada raíz de (27), corresponde un modelo reducido bien definido, los que se obtienen sustituyendo (28) en (26), con ε = 0, resultando en:
De la ecuación anterior se ha suprimido el subíndice i de h ya que el sistema solo tiene una raíz en (27) que es:
El modelo reducido (29) se suele llamar modelo de estado casi estacionario, porque las variables z (cuya velocidad ż = (Aaz + Ba)∕ε puede ser muy elevada cuando ε es pequeño y (Aaz + Ba)≠0) converge de manera muy rápida a la raíz (30), que es un punto de equilibrio de (25). La validación de utilizar el método de perturbaciones singulares en nuestro sistema, se hace mediante el teorema de Tikhonov [23]. Las consideraciones de la ecuación algebraica (30) se pueden interpretar para las fuerzas de los actuadores en el tobillo y la rodilla fa1 y fa2 de manera que al sustituirlas en las ecuaciones (12) y (13) respectivamente se obtiene las nuevas expresiones para las entradas de torque:
Note que la fuerza fa2 no se sustituye en (31) ya que no es una entrada directamente, pues solamente es el efecto que tiene el actuador de la rodilla en la articulación del tobillo θ1.
Modelo dinámico de la pierna humanaExisten varios puntos de vista sobre la estrategia de control motriz humano que utiliza el SNC (Sistema Nervioso Central) para el control de movimiento de las extremidades. Diversos autores han sugerido algunas variables de control muscular tales como la fuerza, longitud, velocidad, rigidez y amortiguamiento de los músculos, sin embargo es difícil plantear que existe una estrategia única de control. Lo anterior debido a que el SNC puede resolver una gran cantidad de tareas. Existe una amplia gama de investigación en este campo, por ejemplo: [24], [25], [26]. Para representar el modelo musculoesquelético del humano como se ve en la ecuación (33) se utiliza un método llamado masa-resorte-amortiguador (MSD), donde I es la matriz de masas, B es la matriz de amortiguamiento y K matriz de elasticidad, φ, y representan los vectores de distancia, velocidad y aceleración respectivamente y W es el vector que contiene el peso de las diferentes masas. [27]. Las masas representan las propiedades de las inercias de los diferentes segmentos del cuerpo humano, los resortes y amortiguadores representan las propiedades mecánicas de los diferentes segmentos como huesos, músculos, tendones y ligamentos [28]. Los valores de los parámetros varían en cada persona, los valores utilizados en este artículo se basan en los obtenidos en [29] realizando pruebas experimentales con una persona de 76kg (mh1=15kg, mh2=61kg, kh1=78.4kN/m, kh2 = 34.1kN/m y bh1=0.76kN.s/m).
donde:
La estrategia de control que suponemos utiliza el SNC para el control de movimientos de la pierna en este caso, es un PD (u = ekph + ėkvh) con ganancias constantes positivas kph y kvh y su valor dependerá de cada persona. La fuerza producida por la pierna humana = fh es proporcional dinámicamente al error de posición e = φd - φ, así como a la velocidad de cambio del error (ė), donde en general φd es la posición deseada por el humano. Estas fuerzas (fh1 y fh2) serán medidas por los sensores de fuerza colocados en el exoesqueleto. El humano proporciona la referencia de posiciones articulares lo que genera un error de posición angular y de velocidad con la que se desea mover el exoesqueleto, lo anterior es controlado por el algoritmo de corrección PD.
Figura 6: Torques generados por los términos de la Matriz de Inercia M(q) , Matriz Centrífuga y de Coriolis C(q,) y Vector de Gravedad G(q). |
Control
Control PD con compensación de la gravedadPara el diseño del control se implementó en simulación un modelo general del exoesqueleto de la siguiente forma:
donde M(q) es denominada la matriz de inercia, C(q,) matriz centrífuga y de coriolis, y G(q) es el vector de pares gravitacionales, sin embargo el uso de este modelo para realizar movimientos lentos está sobrado debido a que estos ejercicios producen aceleraciones y velocidades angulares pequeñas. Los valores máximos que se alcanzan durante la simulación son: 1=0.30rad∕s, 2=0.61rad∕s, 1=0.30rad∕s2 y 2=0.60rad∕s2 por lo tanto los torques generados por movimientos que involucran a la matriz de inercia M(q) y la matriz centrífuga y de coriolis C(q,) son pequeños. La mayor cantidad del torque necesario para generar movimientos en las articulaciones es debida al vector de pares gravitacionales G(q). En la Figura (6) podemos observar los resultados de la simulación donde se aplica una trayectoria deseada al modelo general del exoesqueleto en lazo abierto. Los resultados muestran una comparación entre los términos (M(q) , C(q,) y G(q)) generados por hacer una flexión y extensión en las articulaciones. Podemos despreciar estos términos del modelo y utilizar un modelo dinámico reducido como el de la ecuación (16). Un control PD no garantiza el cumplimiento del objetivo de control de posición en sistemas cuyos modelos dinámicos contienen el término de pares gravitacionales, a menos que la posición deseada qd sea tal que G(qd) = 0. Por lo tanto se utilizó un control PD con compensación de gravedad [30]. La entrada del control que se aplica para el modelo dinámico del exoesqueleto (16) es:
Recordemos que fh1 es una fuerza que proporciona el humano y que se mide por medio del sensor de fuerza acoplado en el actuador del tobillo y fh2 la fuerza humana medida por el sensor de fuerza acoplado en la rodilla, fm1 es el control aplicado al actuador del tobillo y tiene la forma:
donde 1 es la velocidad angular medida por un giróscopo, kp1 es la ganancia proporcional que se aplican al error de posición y kv1 la ganancias derivativas que se aplican al error de la velocidad, θd1 es la posición angular deseada y que intuitivamente asigna el humano al inducir una fuerza fh1, de la Figura (5) podemos observar que:
donde xs1 es la deflexión del resorte que se utiliza como sensor de fuerza que asiste al tobillo, x01 es la longitud del actuador inicial y xc1 es la longitud del actuador comprimido por la aplicación de fuerza fh1 en el resorte con constante ks1. En la Figura (7) se observa la relación que existen entre xc1 con θd1 expresada como:
Figura 7: Representación gráfica de la ubicación del actuador que asiste al tobillo del lado izquierdo, y del actuador que asiste a la rodilla del lado derecho. |
De manera muy similar fm2 de la ecuación (35) es el control aplicado a la rodilla y tiene la forma:
donde 2 es la velocidad angular medida por un giróscopo, kp2 es la ganancia proporcional que se aplican al error de posición y kv2 la ganancias derivativas que se aplican al error de la velocidad, θd2 es la posición angular deseada y que intuitivamente asigna el humano al inducir una fuerza fh2, de la Figura (5) podemos observar que:
donde xs2 es la deflexión del resorte que se utiliza como sensor de fuerza que asiste a la rodilla, x02 es la longitud del actuador inicial, y xc2 es la longitud del actuador comprimido por la aplicación de fuerza fh2 en el resorte con constante ks2. En la Figura (7) se observa la relación que existen entre xc2 con θd2 expresada como:
Conviene notar que las posiciones angulares deseadas θ1, θ2 son determinados por la fh1 y fh2, que se pueden interpretar como la referencia que da el usuario de manera subjetiva en el sentido que el cerebro da la orden de levantarse a una cierta posición de flexión o de extensión máxima.
Análisis de estabilidad en lazo cerradoSi sustituimos el control fm1 de (36) en la entrada (31) y sustituimos el control fm2 de (39) en la entrada (32) obtenemos las siguientes entradas de control.
Entonces si sustituimos la entrada del tobillo (42) en el modelo dinámico (16) se obtiene la siguiente ecuación de segundo orden:
Similarmente si sustituimos la entrada de la rodilla (43) en el modelo dinámico (16) obtenemos:
El polinomio característico del error es de segundo grado y los valores de ganancias kpi y kdi determinan el valor de las raíces características, por ello siempre existen valores de ganancias proporcional y derivativa tales que el error (θd1 - θ) tiende a cero. Suponga entonces que se ha alcanzado la posición deseada, esto implica que las fuerzas producidas por los actuadores se reducen a:
Entonces después de un tiempo transitorio las entradas de control de los motores fm1, fm2 dependen de la posición angular de la articulación en el tobillo θ1 y la rodilla θ2, de la gravedad g, de las masas mmi, mi, M, y de las distancias l5 y , además de una ganancia kgi, esta ganancia equivale a una amplificación de fuerza en el exoesqueleto que nos mantiene el error de posición angular e = 0 y ė = 0. El valor de kgi se propone en base a la ganancia de fuerza que se desea obtener del exoesqueleto, de las expresiones (21) y (22) se puede observar que mientras más se aumenta kgi el esfuerzo para el humano es menor y la compensación de la gravedad dependerá en mayor parte del exoesqueleto. Sin embargo, se debe tomar en cuenta que existe una saturación en esta fuerza, pues se debe considerar que la potencia de los motores está limitada a un cierto valor del la fuerza del motor fm, que depende del torque máximo del motor τmot, y de la ganancia máxima de la transmisión mecánica K.
Resultados y discusión
SimulaciónEn esta sección se presenta la simulación del modelo del exoesqueleto en conjunto con el modelo del humano. Los resultados obtenidos de la simulación se presentan en la Figura (8) para el tobillo y la rodilla. Se considera que las articulaciones tienen un rango de movimiento entre 0.785 y 1.57 rad. Basados en [31]. Se generaron dos trayectorias a partir de una señal sinusoidal, que simula el movimiento de las articulaciones al realizar una serie de flexiones y extensiones de rodilla y tobillo. Las trayectorias deseadas se introducen al modelo dinámico del humano (33) de tal forma que la señal de salida obtenida por el modelo de la pierna humana se utiliza como referencia de entrada a la simulación del modelo dinámico del exoesqueleto (16) y se le aplica la ley de control (35) con condiciones iniciales cero. De los resultados de esta simulación se observa que el ángulo de posición actual θ se aproxima al ángulo de posición deseada θd con un tiempo de respuesta muy rápido, la respuesta está en función de una buena sintonización de las ganancias de control kp y kd, (kp1=502, kp2=495, kd1=41 y kd2=38).
Figura 8: Comparación entre posición angular deseada y posición angular de las articulaciones en simulación.
La tabla (1) muestra los parámetros utilizados en la simulación del modelo dinámico del exoesqueleto y del humano, los parámetros se obtienen por medio de mediciones en el mecanismo utilizado por una persona de 76 kg.
ExperimentaciónEn esta sección se muestran las pruebas experimentales que se realizaron con el exoesqueleto, las cuales consisten en realizar algunos ejercicios de flexiones y regulación de las articulaciones en diferentes posiciones. En las gráficas podemos observar una comparación entre la fuerza de entrada aplicada por el humano fh (cuyos datos fueron obtenidos del sensor de fuerza) y la fuerza de salida producida por el actuador fa (basada en el tamaño del PWM enviado al motor en el actuador). En esta comparación se observa que existe una amplificación de la fuerza por un factor aproximado de 40 en el tobillo y 60 en la rodilla ambos en relación al máximo torque producido por sus respectivos motores. La Figura (9) muestra la comparación de fuerzas en la articulación del tobillo y la rodilla. En estas gráficas la señal fh está multiplicada x10 para poder observar con mayor claridad los resultados obtenidos.
Figura 9: Comparación entre la fuerza proporcionada por el humano y la salida resultante del mecanismo para las articulaciones (datos experimentales). En la Figura (9) se observa que el torque máximo producido con la ayuda del exoesqueleto llega a una saturación aproximadamente en 45N para el tobillo mientras que para la rodilla la saturación del máximo torque que proporciona el exoesqueleto es muy cercano a 60N, ésta amplificación en el torque nos resulta en un menor esfuerzo para el humano. De las mismas pruebas experimentales se muestran los datos arrojados por los sensores que miden las posiciones angulares, estos son datos reales de un ejercicio similar al realizado en la simulación de la Figura (8). La gráfica de la Figura (10) muestra la comparación entre la posición angular y la posición angular deseada en las articulaciones del tobillo y la rodilla. La posición angular deseada se obtiene por medio de la interpretación de los sensores de fuerza y nos indica la posición en la que el usuario quiere colocar las articulaciones.
Figura 10: Comparación entre posición angular deseada y posición angular de las articulaciones (datos experimentales).
ConclusionesLa importancia para atender las necesidades del hombre como en la rehabilitación o mejoramiento de articulaciones, músculos, huesos, tendones, etc., mantiene el estudio y desarrollo de nuevos exoesqueletos. Este trabajo amplía la línea de investigación que se tiene en los exoesqueletos que utilizan actuadores tipo SEA (Actuadores Elásticos Seriales) integrando dos grados de libertad que permiten asistir a la rodilla y también al tobillo de la pierna derecha. El exoesqueleto que se muestra en este trabajo está enfocado en la rehabilitación estática de las articulaciones, por tal motivo el volumen y la portabilidad del exoesqueleto no es el objetivo principal de este trabajo. En este trabajo se consideró que los parámetro tales como la masa del usuario, la longitud de la pierna entre otros, son conocidos. El cambiar de usuario en el exoesqueleto, implica cambiar los valores de los parámetros programados en el control. |