Professional Documents
Culture Documents
Resumen—In this paper, the basic concepts of feedback control ciertos métodos para su correcta interpretación. [1]
are defined, as they are the proportional action, integral action
and derivate action. the behavior of ON/OFF control in a Lego Se puede clasificar un sistema según su representación
motor. The system was modeled in a mathematical software,
Matlab/Simulink. en diagramas de bloques, como un sistema de lazo abierto
(open loop) o de lazo cerrado (closed loop) como se muestra
Index Terms—PWM, integrate, derivate, proportional, feed- en la figura 1. Un sistema retroalimentado se puede usar
back, steady state error.
para crear un comportamiento lineal aun teniendo elementos
no lineales, busca ademas que un sistema sea insensible o
I. I NTRODUCCI ÓN menos sensible a las perturbaciones externas y a las varia-
ciones de los elementos que lo constituyen. Aun a pesar
Un controlador moderno detecta el funcionamiento y la de eso los sistemas retroalimentados poseen problemas como
respuesta de un sistema, lo compara con el comportamiento la posibilidad de crear inestabilidades dinámicas, que causan
deseado,es decir una referencia, calcula acciones correctivas oscilaciones incluso desenfrenadas. Otro de los problemas, es
basadas en un modelo del sistema con entradas externas y que la retroalimentación puede introducir ruido del sensor en
acciona el sistema para efectuar el cambio deseado. Este el sistema, por lo que se requiere un filtrado cuidadoso de las
sistema de retroalimentación con caracterı́sticas de detección, señales. [1]
cálculo y actuación es el concepto general mas básico en
control.[1]
2500
b(s) Kp
y(t): angulo [ o ]
Gc = = (7) 2000
E(s) s
1500
extrapolación lineal.[1]
Figura 6. Señal obtenida experimentalmente del sistema en lazo abierto con
de(t) u(t) = 50.
e(t + Td ) ≈ e(t) + Td (8)
dt
Las simulaciones son presentadas a continuación:
b(s)
Gc = = skp (9)
E(s)
Combinando control proporcional, integral y derivado, ob- Figura 7. Señal obtenida en simulink u(t) = 50.
tenemos un controlador que se puede expresar como:
u(t) =Kp e(t)+
Z t
de(t) (10)
Ki e(τ )dτ + Kd
0 dt
La acción de control es, una suma de el error en tres estados
temporales diferentes: el pasado representado por la integral
del error, el presente representado por el término proporcional
y el futuro representado por una extrapolación lineal del error,
el término derivado. [1]
III. P ROCEDIMIENTO :
III-A. Caracterı́sticas de la planta:
Se supone que el motor LEGO NXT esta representado por Figura 8. Señal entrada obtenida en simulink u(t) = 50.
la función de transferencia:
θ(s) 224600 Aplique tanto al modelo simulado en Simulink como al
G(s) = = (11)
Up (s) 2
s(s + 90s + 2025) sistema real, una señal Up (t):
Donde θ es el angulo en grados y Up es la tensión aplicada
−50 Si t ≤ 0
al motor en valor porcentual. Up (t) =
0 Si t > 0
UNIVERSIDAD NACIONAL DE COLOMBIA, FACULTAD DE INGENIERÍA, CONTROL, OCTUBRE 2018 4
500
Caracteristicas de la planta u=-50% (t<10s) III-B. Control ON/OFF del motor LEGO
0 1. Simule un sistema de control ON/OFF de posición del
-500 motor LEGO con una referencia 180o ≤ r(t) ≤ 360o .
Use el modelo mostrado en la Figura 12. El código
y(t): angulo [ o ]
-1000
del controlador ON/OFF deberá ser escrito dentro del
-1500
bloque llamado Matlab function.
-2000
-2500
-3000
-3500
0 5000 10000 15000
Tiempo (ms)
100
50
-50
-100
0 500 1000 1500
Tiempo (ms)
200
ref(t)
y(t)
150 e(t)
u(t)
Angulo [ o ]
100
Control ON-OFF U(t)=90% con tiempo muerto lazo cerrado con controlador ON/OFF DEAD ZONE
250
tienen varias caracterı́sticas diferentes, una de ellas es
200 ref(t) que el valor de salida (θ) en el ON/OFF convencional
y(t)
e(t)
siempre esta variando entre un rango de valores de
150
u(t) −2,5o < θ < 2,5o , no se estabiliza por completo. En
cambio el sistema ON/OFF DEAD ZONE, toma un
Angulo [ o ]
100
0
III-C. Control proporcional del motor LEGO
-50 El diagrama de la figura 17 ilustra el servomotor con un
controlador proporcional. Elija como referencia r(t) una onda
-100
0 500 1000 1500 cuadrada (generada en el arduino) con valor mı́nimo entre 0
Tiempo (ms)
y 180 grados. Realice los siguientes experimentos.
Figura 16. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador 1 / / A l g o r i t m o de c o n t r o l . M o d i f i q u e l a e x p r e s i n
ON/OFF, con u(t) = 65 %, ref = 225o con tiempo muerto de 5 grados de u s e g n s e a e l c a s o
antes y después de cero. 2 float r e f = 225 ; // referencia
3 f l o a t kp = 20 ; / / constante proporcional
4 e = r e f − ang ;
1 / / A l g o r i t m o de c o n t r o l . M o d i f i q u e l a 5 P = ( f l o a t ) kp * e ;
e x p r e s i n de u s e g n s e a e l c a s o 6 u=P * 10.23 ;
2 e = r e f − ang ; 7 usat = saturate (u) ;
3 i f ( e>5 ) { 8 sendPWM10 ( u s a t ) ;
4 u=1023 * 0.90 ; 9 I ant=I ;
5 } 10 e a n t =e ;
6 i f ( e<=5 && e>=−5 ) { 11 while ( loopTime < h us ) {
7 u=0 ; 12 d i g i t a l W r i t e ( p i n m u e s t r e o ,LOW) ; / / e v a l u a r
8 } t i e m p o de m u e s t r e o
9 i f ( e<−5 ) { 13 };
10 u=−1023 * 0.90 ;
11 } Listing 2. Control proporcional
12 usat = saturate (u) ;
13 sendPWM10 ( u s a t ) ;
14 I ant=I ;
15 e a n t =e ;
16 while ( loopTime < h us ) {
17 d i g i t a l W r i t e ( p i n m u e s t r e o ,LOW) ; / /
e v a l u a r t i e m p o de m u e s t r e o
18 };
4. Discuta sobre el error de estado estacionario y el tiempo Figura 17. Diagrama de bloques del sistema de control proporcional de
de establecimiento con este tipo de controlador Posición. [2]
La salida del sistema en lazo cerrado con controlador 1. Simule, usando simulink, el sistema con control propor-
ON/OFF (DutyCicle:90 %) y la salida del sistema en cional que se muestra en la figura 17. Para el actuador
UNIVERSIDAD NACIONAL DE COLOMBIA, FACULTAD DE INGENIERÍA, CONTROL, OCTUBRE 2018 6
Figura 20. Simulación en simulink (y(t),e(t),ref(t)) usando un controlador Figura 23. Simulación en simulink (y(t),e(t),ref(t)) usando un controlador
proporciona Kp = 5, ref = 225o . proporcional Kp = 16; Kp = 18, ref = 225o .
UNIVERSIDAD NACIONAL DE COLOMBIA, FACULTAD DE INGENIERÍA, CONTROL, OCTUBRE 2018 7
Angulo [ o ]
600
400
200
-200
0 500 1000 1500
Tiempo (ms)
Figura 24. Simulación en simulink (y(t),e(t),ref(t)) usando un controlador
proporcional Kp = 20, ref = 225o . Figura 27. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador
proporciona Kp = 5, ref = 225o .
1000
150 ref(t)
Angulo [ o ]
800
y(t)
e(t) 600
100 u(t)
400
200
50
0
-200
0 0 500 1000 1500
0 500 1000 1500 2000 2500 3000 Tiempo (ms)
Tiempo (ms)
100 1000
50 500
0 0
-50 -500
0 500 1000 1500 2000 2500 3000 0 500 1000 1500
Tiempo (ms) Tiempo (ms)
Figura 26. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador Figura 29. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador
proporciona Kp = 0,7, ref = 225o . proporciona Kp = 10, ref = 225o .
UNIVERSIDAD NACIONAL DE COLOMBIA, FACULTAD DE INGENIERÍA, CONTROL, OCTUBRE 2018 8
Magnitud [ o ]
2500
1500
2000
1000
1500
500 1000
500
0
0
-500 -500
0 500 1000 1500 0 500 1000 1500
Tiempo (ms) Tiempo (ms)
Figura 30. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador Figura 33. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador
proporciona Kp = 12, ref = 225o . proporciona Kp = 18, ref = 225o .
1500 0
1000
-1000
0 500 1000 1500
500 Tiempo (ms)
0
Figura 34. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador
-500 proporcional Kp = 20, ref = 225o .
0 500 1000 1500
Tiempo (ms)
2000
7 e = r e f − ang ;
8 P = ( f l o a t ) kp * e ;
1500 9 D = kd2 * ( e − e a n t ) ;
10 u = ( P+D) * 10.23 ;
1000
11 usat = saturate (u) ;
500 12 sendPWM10 ( u s a t ) ;
13 I ant=I ;
0
14 e a n t =e ;
-500 15 while ( loopTime < h us ) {
0 500 1000 1500
16 d i g i t a l W r i t e ( p i n m u e s t r e o ,LOW) ; / /
Tiempo (ms)
e v a l u a r t i e m p o de m u e s t r e o
17 };
Figura 32. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador
proporciona Kp = 16, ref = 225o . Listing 3. Control proporcional con efecto derivativo
UNIVERSIDAD NACIONAL DE COLOMBIA, FACULTAD DE INGENIERÍA, CONTROL, OCTUBRE 2018 9
A continuación se agregaran las gráficas obtenidas de un Control proporcional con efecto derivativo Kp=20
sistema proporcional-derivativo (PD), cuando el Kp = 5000
16 18 y 20. ref(t)
y(t)
4000
e(t)
u(t)
3000
Magnitud [ o ]
2000
Control proporcional con efecto derivativo Kp=16
3500
ref(t) 1000
3000 y(t)
e(t)
0
2500 u(t)
2000
Magnitud [ o ]
-1000
0 500 1000 1500
1500 Tiempo (ms)
-500
200 400 600 800 1000 1200 1400
Tiempo (ms)
4000
ref(t)
y(t)
3500 e(t)
u(t)
3000
Magnitud [ o ]
2500
2000
1500
1000
500
-500
200 400 600 800 1000 1200 1400
Tiempo (ms)
Figura 36. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador Figura 38. Respuesta en simulink (y(t),e(t),ref(t)) usando un controlador
proporcional con efecto derivativo Kp = 18, ref = 225o . proporcional con efecto derivativo Kp = 5, ref = 225o .
UNIVERSIDAD NACIONAL DE COLOMBIA, FACULTAD DE INGENIERÍA, CONTROL, OCTUBRE 2018 10
θ(s) 224600
= 2
V (s) s(s + 90s + 2025)
Figura 42. Diagrama de bloques del sistema de control con acción propor-
cional e integral. [2]
Figura 40. Respuesta en simulink (y(t),e(t),ref(t)) usando un controlador
proporcional con efecto derivativo Kp = 18, ref = 225o .
1 / / A l g o r i t m o de c o n t r o l . M o d i f i q u e l a e x p r e s i n
de u s e g n s e a e l c a s o
2 float r e f = 225 ; // referencia
3 f l o a t kp = 20 ; / / constante proporcional
4 f l o a t ki = 1; / / constante integral
5 / / c o n s t a n t e s e s c a l i z a d a s p o r e l t i e m p o de
muestreo
6 f l o a t k i 2 = k i * f l o a t ( h ) / 1000 ; / / constante
ki escalizada
7 e = r e f − ang ;
8 P = ( f l o a t ) kp * e ;
9 I = I a n t + k i 2* e ;
10 u = ( P+ I ) * 10.23 ;
11 usat = saturate (u) ;
12 sendPWM10 ( u s a t ) ;
13 I ant=I ;
14 e a n t =e ;
15 while ( loopTime < h us ) {
16 d i g i t a l W r i t e ( p i n m u e s t r e o ,LOW) ; / / e v a l u a r
Figura 41. Respuesta en simulink (y(t),e(t),ref(t)) usando un controlador t i e m p o de m u e s t r e o
proporcional con efecto derivativo Kp = 20, ref = 225o . 17 };
ref(t) ref(t)
400 y(t) y(t)
2000
e(t) e(t)
u(t) u(t)
300
1500
Magnitud [ o ]
Magnitud [ o ]
200
1000
100
500
0
0
-100
-500
-200 0 500 1000 1500
0 0.5 1 1.5 2 2.5 3 3.5 4
Tiempo (ms)
Tiempo (ms) 104
2000
1500
1000
Control PI Ki=1 Kp=7
1600 500
ref(t)
1400 0
y(t)
1200 e(t)
-500
u(t) 0 500 1000 1500
1000 Tiempo (ms)
Magnitud [ o ]
800
Figura 46. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador
600
proporcional integral Ki = 1, Kp = 17 ref = 225o .
400
200
-200
0 200 400 600 800 1000 1200 1400 1600 1800 2000
Tiempo (ms)
A continuación se presentan las simulaciones en simulink,
correspondiente a los valores anteriormente citados, se fijó el
Figura 44. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador valor de Ki en 1 y se varió Kp con cuatro valores, 0.8, 7, 10
proporcional integral Ki = 1, Kp = 7 ref = 225o . y 17
UNIVERSIDAD NACIONAL DE COLOMBIA, FACULTAD DE INGENIERÍA, CONTROL, OCTUBRE 2018 12
Figura 47. Respuesta simulink (y(t),e(t),ref(t)) usando un controlador propor- Figura 50. Respuesta simulink (y(t),e(t),ref(t)) usando un controlador propor-
cional integral Ki = 1, Kp = 0,8 ref = 225o . cional integral Ki = 1, Kp = 17 ref = 225o .
250
200 ref(t)
y(t)
Magnitud [ o ]
150 e(t)
u(t)
100
50
-50
0 2000 4000 6000 8000 10000 12000 14000 16000 18000
Tiempo (ms)
250
200 ref(t)
y(t)
Magnitud [ o ]
150 e(t)
u(t)
100
50
-50
0 5000 10000 15000
Tiempo (ms)
Figura 49. Respuesta simulink (y(t),e(t),ref(t)) usando un controlador propor- Figura 52. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador
cional integral Ki = 1, Kp = 10 ref = 225o . proporcional integral Kp = 1, Ki = 0,1 ref = 225o .
UNIVERSIDAD NACIONAL DE COLOMBIA, FACULTAD DE INGENIERÍA, CONTROL, OCTUBRE 2018 13
200
Magnitud [ o ]
150
100
50
-50
-100
0 1000 2000 3000 4000 5000 6000 7000 8000 9000 10000
Tiempo (ms)
Figura 56. Respuesta simulink (y(t),e(t),ref(t)) usando un controlador propor-
Figura 53. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador cional integral Kp = 1, Ki = 0,02 ref = 225o .
proporcional integral Kp = 1, Ki = 0,3 ref = 225o .
300
ref(t)
y(t)
250 e(t)
u(t)
200
Magnitud [ o ]
150
100
50
-50
-100
-150
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2 2.2
Tiempo (ms) 104
Figura 57. Respuesta simulink (y(t),e(t),ref(t)) usando un controlador propor-
Figura 54. Respuesta experimental (y(t),e(t),ref(t)) usando un controlador cional integral Kp = 1, Ki = 0,1 ref = 225o .
proporcional integral Kp = 1, Ki = 0,5 ref = 225o .
200
Magnitud [ o ]
100
-100
-200
0 2000 4000 6000 8000 10000 12000 14000 16000 18000
Tiempo (ms)
A continuación se presentan las simulaciones en simulink Figura 58. Respuesta simulink (y(t),e(t),ref(t)) usando un controlador propor-
para los valores anteriormente mostrados. cional integral Kp = 1, Ki = 0,3 ref = 225o .
UNIVERSIDAD NACIONAL DE COLOMBIA, FACULTAD DE INGENIERÍA, CONTROL, OCTUBRE 2018 14
2000
R EFERENCIAS
[1] Karl J. Astrom and Richard M. Murray. Feedback Systems: An Introduc-
tion for Scientists and Engineers. Princeton University Press, Princeton,
New Jersey, electronic edition v2.10e edition, 2008.
[2] Laboratorio de Control: 2018-I. Departamento de ingenieria electrica y
electronica, Universidad Nacional de Colombia, Sede Bogota. Princeton
University Press, Princeton, New Jersey, electronic edition v2.10e edition,
2008.
[3] A. J. Carrillo: Sistemas Automáticos de Control Fundamentos Básicos de
Análisis y Modelado. Universidad Nacional Experimental “Rafael Marı́a
Baralt”: Editorial UNERMB, 2011
[4] Sabiha A Wadoo and Rahul Jain. A lego based undergraduate control
systems laboratory. In Systems, Applications and Technology Conference
(LISAT), 2012 IEEE Long Island, pages 1–6. IEEE, 2012.
[5] C.-T. Chen: Analog and digital control system design : transfer-function,
state-space, and algebraic methods. Oxford University Press, 1993.
[6] “K. Ogata,”: Modern control engineering. Prentice-Hall, 2010.