Professional Documents
Culture Documents
El diseño de la estructura del exoesqueleto debe estar Se cuenta con un sensor de velocidad, con el cual se
dirigido a soportar una carga neta, además de proveer una identifican los parámetros del modelo de velocidad en
interfaz mecánica con el operador que sea transparente y función del voltaje a la entrada, y se realiza el
permitir una utilización eficiente de la energía del complemento con los demás datos para obtener el
sistema. “En esencia un exoesqueleto para amplificar momento a la salida. La identificación se hace usando un
fuerza es un dispositivo que envuelve al usuario para método que estima el modelo de un sistema, a partir de
soportar una carga neta y su propio peso con el objeto de una función de transferencia dada por:
minimizar las perturbaciones de carga sobre el operario” m
[2]. Y ( z) ∑b z i
n −i
con: a0 = 1 (1)
H ( z) = = i =1
n
U ( z)
El uso de un exoesqueleto para amplificación de fuerza ∑a z
i =0
i
n −i
realiza básicamente la tarea de dar cierta ganancia al Este método estima los parámetros de la función de
momento neto que ejerce el humano sobre una carga transferencia H(z), usando las entradas y las salidas
mediante un actuador, de tal forma que el humano aporte pasadas, en una señal muestreada. Este modelo se
siempre un porcentaje del esfuerzo y el resto lo aporte el denomina ARX (autorregresivo con entradas extra), y
actuador, no obstante el actuador debe realizarlo de tal consiste en que se tiene la salida y(k) dependiendo de
forma que para el humano no sea notoria la reacción de la entradas y salidas pasadas [3], con lo que se obtiene de la
estructura y no se introduzcan retardos en la acción de la ecuación (1):
fuerza. Lo anterior requiere un sistema de control que
actualice en tiempo real una señal, producto de la n m
interacción entre el dispositivo y la máquina. y ( k ) = −∑ ai y (k − i ) + ∑ bi u (k − i ),
i =1 i =1
donde y (k ) = y(kh)
h es el periodo de muestreo. Sean:
⎡ a1 ⎤ ⎡ − y (k − 1) ⎤
⎢ ⎥ ⎢ − y (k − 2) ⎥
⎢ a2 ⎥ ⎢ ⎥
⎢ ⎥ (2)
⎢ ⎥
⎢ ⎥ ⎢ ⎥
a
θ = ⎢ n⎥ γ =⎢
− y ( k − n ) ⎥
⎢ b1 ⎥ ⎢ u (k − 1) ⎥
Figura 1. Interacción entre el humano, el exoesqueleto y la ⎢ ⎥ ⎢ ⎥
carga. ⎢ b2 ⎥ ⎢ u (k − 2) ⎥
⎢ ⎥ ⎢ ⎥
⎢ ⎥ ⎢ ⎥
3. IDENTIFICACIÓN DEL SISTEMA ⎣⎢bm ⎦⎥ ⎢⎣ u ( k − m) ⎥⎦
{ }
N
1
actuador, para el cual se tiene un motor cuyos valores VN θ ; Z N =
N
∑ ( y(k ) − yˆ (k / θ ))
k = n +1
,
nominales se dan en la tabla 1. Los parámetros del motor sujeto a yˆ (k / θ ) = γ T (k )θ
son desconocidos, por lo cual se procede a realizar una
identificación de parámetros. La segunda parte es el De modo que el valor de θ que minimiza VN {θ ; Z N }, sea:
modelado de la estructura del exoesqueleto, que consiste θˆ N = arg min VN {θ ; Z N }
en una barra rígida con una carga en el extremo. El θ
modelo requerido es de momento en función del voltaje El anterior valor de los parámetros del modelo ARX, se
aplicado a la entrada del motor. Para la estructura se obtiene de forma simple igualando a cero, el gradiente
conocen los parámetros, y para el motor se hace una respecto a θ , y dado que la función VN {θ ; Z N } es
identificación. cuadrática en θ , se obtiene en efecto un mínimo [3].
Scientia et Technica Año XIV, No 39, Septiembre de 2008. Universidad Tecnológica de Pereira 131
En la anterior ecuación, H(z) es la función de cambio de posición y es transitorio, por esto el problema
transferencia que modela al motor, y fue obtenida a solucionar es de regulación y no de seguimiento.
mediante la identificación, h es el periodo de muestreo. Teniendo el modelo (9), se puede determinar fácilmente
Luego la función de transferencia del sistema es: un modelo de espacio de estado, necesario para
desarrollar el control de la planta.
τ (z) ⎛ N1 ⎞⎛ z − 1 ⎞⎛ b ⎞ Jb ⎛ N1 ⎞ z − 1 (9) ⎡ x1 (k + 1) ⎤ ⎡− a − R ⎤ ⎡ x1 (k ) ⎤ ⎡ R ⎤
G( z) = = J⎜ ⎟⎜ ⎟⎜ ⎟= ⎜ ⎟
U (z) ⎝ N 2 ⎠⎝ hz ⎠⎝ z + a ⎠ h ⎝ N 2 ⎠ z ( z + a ) ⎢ x (k + 1)⎥ = ⎢ 0 +
0 ⎥⎦ ⎢⎣ x2 (k )⎥⎦ ⎢⎣ 1 ⎥⎦
(u (k ) + v(k ))
⎣ 2 ⎦ ⎣
La ecuación (9) completa el modelamiento del sistema a
⎡ x (k ) ⎤ (10)
controlar. τ (k ) = [1 0]⎢ 1 ⎥
⎣ x2 (k )⎦
4. SISTEMA DE CONTROL En el modelo anterior, la entrada v es una perturbación de
tipo constante, dada como el voltaje necesario para
El sistema de control del exoesqueleto se basa en un generar el torque estático o gravitacional en el eje del
comando de torque, de entrada para la estructura y no motor. La entrada u corresponde al voltaje aplicado a la
uno de posición, la relación existente entre la posición del armadura del motor, el cual está limitado por el voltaje
exoesqueleto y el torque esta dada por: nominal del motor. Dicha limitación está en 45 V. Es
τ = Jθ ' '+ Bθ '+ Kθ claro entonces que (10) tiene dos polos, uno en z = 0 y
Donde J, B y K, son los parámetros de la estructura de la otro en z = -a. Sean Φ, Г y C, las matrices del modelo de
de la figura 5: inercia, fricción y elasticidad; τ y θ son el espacio de estado (10), de forma que se escriba como:
torque y la posición angular de alguna parte de la x(k + 1) = φ x(k ) + Γ(u (k ) + v(k ))
estructura. Algunos sistemas de control utilizan el control τ (k ) = C x(k ) (11)
directo del torque [1], y otros utilizan el control de la donde:
impedancia, para hacer que el sistema se comporte con ⎡ x (k ) ⎤
ciertos parámetros [7]. x(k ) = ⎢ 1 ⎥
⎣ x2 (k )⎦
La ley de control seguida para realizar la realimentación
del estado es:
u (k ) = − L x(k ) (12)
Figura 5. Definición de variables para un exoesqueleto. L puede ser calculada, con la formula de Ackermann [8]:
El sistema de control basado en el torque o momento,
L = [0 1]Wc P(φ ) (13)
−1
Nótese que la matriz K escogida para ubicar los polos del diseño del observador, se procede a simular la respuesta
observador en el origen, se puede determinar mediante la del sistema, incluyendo el observador digital de estado, y
formula de Ackermann de acuerdo con (13), así: a analizar el error de estimación de estado del sistema a
K T = [0 1](Wo ) −1 P(φ T ) partir de la simulación.
T
5. RESULTADOS
Con lo anterior se realiza un algoritmo en LabView, que La respuesta del sistema en lazo abierto es:
calcula los parámetros θ a partir de las medidas de
voltaje y velocidad.
Para la realimentación del estado sin observador: [1] J. Rosen, M. Brand, M. B. Fuchs, and M. Arcan, “A
Myosignal-Based Powered Exoskeleton System,” IEEE
Transactions on Systems, Man and Cybernetics, vol. 31,
no. 3, Mayo 2001.
Referencias de libros:
Un exoesqueleto es un dispositivo que requiere una [8] K. J. Astrom and B. Wittenmark, Computer-
interacción natural con el operador; por lo cual se hace Controlled Systems, Theory and design. Upper Saddle
necesario diseñar un sistema de control de fuerza y no de River, N.J.: Prentice Hall, 1997.
posición angular del dispositivo; el comando de fuerza lo
da el operador humano.