Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Abstract—Due to the need to assess the stability and per- caracterı́stica controles de tipo proporcional (P), proporcional
formance of muscular rehabilitation elements, this document integral (PI), y proporcional integral derivativo (PID) para
presents a detailed analysis of the effect of controls type P, PI, determinar qué control, y bajo qué circunstancias y/o criterios
and PID for the active knee orthosis system; For this purpose,
the Matlab tool will be used to make the graphs from which the puede aplicarse cada control; para tal fin se usarán los criterios
corresponding analyzes will be derived, to finally conclude which de Routh Hurwitz, Bode, y finalmente el criterio Nyquist para
configuration presents better performance and stability. estabilidad en sistemas dinámicos.
Index Terms—control, derivative control,dynamic system, inte-
gral control, proportional control, stability. II. C ONSIDERACIONES GENERALES
Resumen—Debido a la necesidad de evaluar la estabilidad Para el estudio de estabilidad del sistema correspondiente
y el desempeño de elementos de rehabilitación muscular, en el a la ortesis de rodilla primero se presenta su función de
presente documento se presenta un análisis detallado del efecto transferencia caracterı́stica
de controles tipo P, PI, y PID para el sistema de ortesis activa N ks kt kp
de rodilla; para tal fin se empleará la herramienta Matlab para Jeq s + N kJseq
kt ki
d
realizar las gráficas de las cuales se desprenderán los análisis τl (s) = Beq +kt kp N 2 2
ωm (s)
ks +kt ki N 2
correspondientes, para concluir finalmente cual configuración s3 + Jeq s + Jeq s
presenta mejor desempeño y estabilidad.
Palabras clave control, control derivativo, control inte- Beq ks +N 2 ks kt kp 2
ks s2 + Jeq s + N kJseqkt ki
gral, control proporcional,estabilidad, sistema dinámico. − Beq +kt kp N 2 2
θl (s) (1)
s2 + Jeq s + ks +kJteqki N
I. INTRODUCCI ÓN
d
La rehabilitación juega un papel muy importante cuando se Donde τl (s) es la salida del sistema (torque), ωm (s) la entrada
ha sufrido una lesión o un accidente que limite el movimiento del sistema(velocidad angular) y θl (s) corresponde a una
de una persona, mas aun cuando involucran acciones comunes perturbación de entrada del sistema, que hace reverencia a una
como el manipular objetos o el caminar; para ayudar a mitigar posición [1].
los efectos de dichos sucesos la medicina se ha apoyado en En este caso particular se consideran las constantes del
varios tipos de terapia y dispositivos que permiten recuperar sistema como se encuentran en el cuadro 1.
el movimiento en las extremidades, para este caso particular
se analizará un dispositivo muy usado en la rehabilitación del Cuadro I
PAR ÁMETROS DEL MODELO
movimiento de las extremidades inferiores, llamado ortesis.
En este escenario particular, y cuando dichas ortesis invo- ks (N m/rad) 84
lucran sistemas con motores es necesario controlar los movi- Jeq (kg m2 ) 0.47
Beq (N m s/rad) 60
mientos de cada uno de los dispositivos, ya que una velocidad kt (A/N m) 0.03
exagerada en los movimientos, un error de posición, o una kp (n m s/rad) 11.9
inestabilidad del mismo, puede ocasionar que dichas lesiones, ki (N m/rad) 1.19
N 150
en vez de mejorar, empeoren. En este sentido, y considerando
lo anterior, en el presente informe se pretende estudiar la
estabilidad de una ortesis activa de rodilla impulsada por Para el estudio de estabilidad como primer medida se consi-
un actuador elástico, aplicando a su función de transferencia dera que la perturbación de entrada es cero, y posteriormente se
hará el correspondiente análisis de estabilidad; haciendo uso de
las constantes del modelo, y bajo la consideración anterior se
tiene que el sistema general puede escribirse como una función donde el polinomio caracterı́stico de dicha función de transfe-
de transferencia G(s) rencia es
τl (s) 9571s + 957,1
G(s) = d
= 3 . (2) s3 + 17220s2 + (1888 + 9571kp )s + 957,1kp (4)
ωm (s) s + 17220s2 + 1888s
Antes de continuar con el desarrollo de este estudio se hace con el cual se aplica el criterio de Routh.
necesario observar el comportamiento de dicho sistema sin Cuando se considera entonces el arreglo de Routh
aplicar control, por ende, en la figura 1 se observa la respuesta
al escalón de la función de transferencia G(s).
s3 1 1888 + 9571kp
s2 17220 957,1kp
(5)
s1 17220·(1888+9571k
17220
p )−957,1kp
0
s 957,1kp
IV. C ONTROL P ROPORCIONA I NTEGRAL de donde k > −0,0329 y k > 0; haciendo la intersección entre
los rangos, para estabilidad, se tiene que k > 0.
El control PI se modela de la siguiente forma
s + kkpi IV-B. Criterio de Bode
ki kp s + ki s+c
kp + = = kp =k (24) Como en el caso anterior se hace necesario estudiar la fase
s s s s
y la magnitud en lazo abierto de la funcion de transferencia
En cuyo caso se tiene que el control agrega un cero kkpi y un
Gla en función de jω, dada por
polo 0 a la función de transferencia en lazo cerrado.
Para este caso el control proporcional integral (PI) presenta jω + 1 9571jω + 957,1
Gla (jω) = k
el diagrama de bloques de la figura 8. jω (jω) + 17220(jω)2 + 1888(jω)
3
9571(jω + 0,1)(jω + 1)
=k (32)
(jω)2 (jω + 17218)(jω + 0,1096)
También tienen que tenerse en cuenta los cálculos de la
magnitud en veces
9571(jω + 0,1)(jω + 1)
|Gla (jω)| = k
2
(33)
Figura 8. Diagrama de Bloques Control Proporcional
(jω) (jω + 17218)(jω + 0,1096)
como en dB
Con esto se procede a hacer el análisis con las herramientas
que se trataron anteriormente.
9571(jω + 0,1)(jω + 1)
IV-A. Criterio de Routh |Gla (jω)| dB = 20log k 2
(jω) (jω + 17218)(jω + 0,1096)
para este caso se analiza el sistema en lazo cerrado dado (34)
como y la fase de la función de transferencia en lazo abierto
9571s+957,1
k s+c
k s+c ω ω
s G(s) s s3 +17220s2 +1888s φ(ω) = ]kp G(jω) = tan−1 + tan−1
Glc (s) = = = 0,1 1
1 + k s+c
s G(s) 1 + k s+c 9571s+957,1
s s3 +17220s2 +1888s
kp (s2 +(9571+c)s+957,1c
(25)
s4 +17220s3 +s2 (1880+9571k)+ks(9571c+957,1)+957,1kc
ω ω
−tan−1 − tan−1 − 180o . (35)
y con este, usando el polinomio caracterı́stico se hace el 17218 0,1096
análisis de Routh correspondiente; para este caso se toma IV-B1. Margen de fase: Para aplicar este criterio se hace
c=1, ubicando el polo entonces en -1, lo que supone que necesario tener en cuenta la función de transferencia en lazo
kp = ki y k = kp ; de aquı́ entonces se tiene que el polinomio abierto; para esto tiene que cumplirse que
caracterı́stico asociado a la función de transferencia en lazo
9571(jω + 0,1)(jω + 1)
cerrado es |Gla (jω)| = 1 = k (36)
(jω)2 (jω + 17218)(jω + 0,1096)
s4 +17220s3 +s2 (1880+9571k)+ks(10528,1)+957,1k (26)
Para encontrar dicho margen es necesario entonces despejar
posteriormente el arreglo de Routh queda como a ω,de la siguiente expresión,
s4 1 1880 + 9571k 957,1k p p
s3 17220 10528,1k 9571kp ω 2 + 0,12 ω 2 + 12 =
s2 1880 + 9570,388k 957,1k . p p
17220·957,1k ω 2 ω 2 + 0,10962 ω 2 + 172182 . (37)
s1 10528,1k − 1880+9570,388k
s0 957,1k Al calcular las raı́ces del polinomio que se obtiene de operar
(27) la expresión (37) se hallan diferentes valores de ω; se elige
aquel valor para el cual Gla (jω) = −1; considerando que ω IV-E. Gráficas
es un numero real positivo. En la figura 9 se presenta la respuesta al escalón unitario del
Posteriormente con este valor de ω se calcula la fase φ del sistema en lazo cerrado Glc (s), en este caso se observa que
sistema en lazo abierto (35), para por último calcular el margen la respuesta es del tipo amortiguado; a medida que aumenta k
de fase como se observa como el sistema deja de presentar sobre pico; sin
MF = φ + 180o (38) embargo, después de cierto punto el sistema vuelve a generar
sobre pico; si recurrimos a la figura 10, a mayor escala se
IV-B2. Margen de Ganancia: El margen de ganancia se
observa como después de un lı́mite de k el sistema recupera
halla para la condición del punto anterior (16)
otra vez su comportamiento amortiguado.
con esta consideración se hallan los valores de ω para ası́
obtener la ganancia del sistema en lazo abierto (33); el margen
de ganancia finalmente se calcula como
Donde N es el número de rodeos en el punto (-1,0) en el plano Figura 9. Respuesta al Escalón Control PI
GH(en sentido de las agujas del reloj), P es el número de polos
de GH rodeados por cero en el camino de nyqist en el plano Dicho comportamiento puede explicarse a partir de las
derecho del plano s y Z es el numero de raı́ces en la ecuación figuras 11 y 12, en las cuales se observa el diagrama de polos
caracterı́stica rodeados por el camino nyquist en el semiplano para la función de transferencia en lazo cerrado.
derecho.
Para este caso no hay polos en el semiplano derecho, ya que
dicha función de transferencia en lazo abierto puede escribirse
como
957k(s + 0,1)(s + 1)
Gla (s) = 2 (41)
s (s + 17218)(s + 0,1096)
En consecuencia, observando la figura 13 se tiene que
N=P=Z=0, lo cual implica que el sistema es estable.
Lo cual implica que el lı́mite no existe, lo que supone Ambas figuras son complementarias, ya que se puede ob-
que para este caso particular, el criterio de error de estado servar cómo están distribuidos los polos de la funcion de
estacionario no nos da información de la existencia o no transferencia, en cuyo caso se aprecia que tanto cerca al origen,
existencia de sobre-pico. como lejos de él hay un punto de ruptura.
Para este caso decide seleccionarse una K=6000, ya que
según las gráficas que se han realizado, es el valor mas óptimo
para este control, con buen margen de fase y además siendo
un sistema rapado comparado con los demás, evitando a su
vez sobrepicos.
Lo cual implica que el lı́mite no existe, lo que supone Figura 17. Respuesta al Escalón (ampliada) Control PID
que para este caso particular, el criterio de error de estado
estacionario no nos da información de la existencia o no Para apoyar dicho comportamiento se presenta el diagrama
existencia de sobre-pico. de polos y ceros del sistema en las figuras 17 y 18; como
se puede observar, en lazo cerrado, ası́ como en el ejemplo
V-E. Gráficas anterior, hay dos puntos de inflexión, en cuyo caso, cerca a
Para concluir el análisis de estabilidad se consideran las estos el sistema oscila.
figuras 16 y 17, en las cuales se observa la respuesta al escalón; Sin embargo puede decirse que para valores entre estos
como podemos observar en las mismas, el comportamiento rangos el error de estado estacionario es pequeño, y el tiempo
de este control y el evaluado anteriormente es similar; esto de establecimiento es bueno.
se debe a que los polos agregados están muy cerca al cero, Con respecto ya al diagrama de bode del sistema, obser-
sin embargo, en bajas frecuencias, se ve un comportamiento vamos que los margenes de fase tienen un comportamiento
dispar. considerando esto, se hace una aclaración, y es que similar a los del control PI; siendo los margenes de fase
mejores los que se encuentran en el centro de la campana
que se observa en la fase del sistema en lazo abierto.
VII. C ONCLUSIONES
Figura 23. Bode variando K
En general se puede decir que el sistema estudiado, de tercer
orden, al ser realimentado con solamente una constante K se
comporta como si estuviera bajo un control PI, por ende, en
todas las gráficas se observan buenos margenes de estabilidad;
En la figura 23 se puede observar el diagrama de Bode
sin embargo, cuando hacemos un análisis mas detallado de
con los margenes de fase de cada una de las funciones de
la fase, se observa que al agregar polos y ceros cambiamos
transferencia; en este sentido, corroborando lo anterior, se
la banda para un cierto segmento de la fase, lo cual, para
puede observar que el sistema con mejor margen de fase
controles tipo PI y PD permite observar rangos de K para los
es el que tiene el control P, por ende, como se menciona
cuales el sistema puede presentar o no sobre pico.
anteriormente, es la mejor opción.
En este aspecto observamos sobrepicos en estos controles,
Esto se debe también a que la función de transferencia G(s) siendo mas altos los presentados en el control PI.
ya incluye un polo en el origen, ası́ que en lazo abierto, dicha Otro comportamiento interesante es que la selección de
función de transferencia se comporta como un control PI. polos y ceros puede facilitar que el sistema pase de ser estable
a inestable, todo esto se debe a que, si se adhieren los polos
En simulink se realizó la simulación de las funciones de a valores donde la fase tiende a −1800 va a existir inmedia-
transferencia con una perturbación de entrada, en este caso, tamente un punto para evaluar el margen de ganancia, lo cual
cuando se aplicó, se obtuvo la figura 24; En la cual se genera, como se menciona anteriormente, inestabilidades en el
ilustra en comportamiento ruidoso, sin embargo, se observa sistema.
que las tendencias son muy similares a lo esperado, por ende, Por su parte, cuando se analiza el desempeño, es necesario
aunque dichas perturbaciones contribuyen al error, la tendencia aclarar que este sistema no se puede analizar tan fácilmente
permanece constante. por desempeño, porque, para ciertos valores de K, el sistema
presenta diagramas de fase y magnitud diferentes; el que 44
sorprende en general, para este análisis, es que el que mejor 45f i g u r e (1004)
46pzmap ( g l c )
se comporta es el que podrı́a considerarse menos robusto, el 47g r i d on
control K, aunque la razón ya se explicó anteriormente. 48h o l d on
49l e g e n d ( ’Kp=1000 ’ , ’Kp=2000 ’ , ’Kp=3000 ’ , ’Kp=4000 ’ , ’
R EFERENCIAS Kp=5000 ’ , ’Kp=6000 ’ , ’Kp=7000 ’ , ’Kp=8000 ’ , ’Kp=9000 ’
, ’Kp=10000 ’ )
[1] Wilian M. dos Santos, Glauco A.P. Caurin y Adriano 50
A.G. Siqueira. “Design and control of an active knee 51end
52
orthosis driven by a rotary Series Elastic Actuator”. En:
53%%
Control Engineering Practice 58 (2017), págs. 307-318. 54%P I
ISSN : 09670661. DOI : 10.1016/j.conengprac.2015.09. 55c l c
56c l f
008. URL: http://dx.doi.org/10.1016/j.conengprac.2015.
57c l o s e all
09.008. 58c l e a r all
[2] Michael C.K. Khoo. “STABILITY ANALYSIS: LINEAR 59