Diseño de Un Controlador para Un Sistema de Posición Angular
Diseño de Un Controlador para Un Sistema de Posición Angular
Diseño de Un Controlador para Un Sistema de Posición Angular
Resumen— La presente investigación es desarrollada con el Si bien la estructura de este trabajo se divide en diversas
objetivo de modelar el sistema de control de posición angular secciones el proyecto esta fundamentalmente enfocado en
de un brazo robótico. La finalidad del mismo es el desarrollo de dos partes: el modelado y diseño del controlador para la
un controlador que permita el correcto funcionamiento de la planta en tiempo continuo y posteriormente la discretización
planta tomando en cuenta lo requisitos establecidos y de este.
realizando las simulaciones correspondientes. El trabajo cuenta
con diferentes etapas de simulación y se enfocó en la modalidad Si bien estos conocimientos se irán explicando mediante la
de proyecto factible. lectura del trabajo, la sección práctica del mismo presenta el
foco de interés principal del proyecto. El diseño del control
Palabras Clave— Posición angular, controlador, ángulo de óptimo que cumpla con los requerimientos del sistema y
carga, control de motores, brazo robótico. permita una planta estable es el mayor desafío que se
presentará en el desarrollo del mismo.
I. INTRODUCCIÓN
Un control de posición para un motor puede abarcar un II. NOMENCLATURA
rango de complejidad muy amplio ya que se utilizan en θr: Desplazamiento angular del eje de referencia.
impresoras hasta el control angular de un sistema industrial
complejo de grandes magnitudes y costos elevados como el θc: Desplazamiento angular del eje de salida en radianes.
posicionamiento de un brazo robótico o el posicionamiento θr: Desplazamiento angular del eje del motor en
de radares. radianes.
Este tipo de sistemas funcionan cambiando la posición de Ks: Ganancia del potenciómetro=1 volt/rad.
motor dependiendo de los valores de entrada que se controlan
normalmente por un potenciómetro, permitiendo de esta A: Ganancia del amplificador=200.
manera posicionar el brazo en diferentes posiciones E: Señal de error (voltios).
predeterminadas que se indiquen por el operador.
Ea: Señal a la salida del amplificador.
Un sistema de control de posición angular funciona
particularmente bien en brazos con pocos grados de libertad Em: Fuerza contraelectromotriz del motor
ya que al realizar tareas más simples se obtiene una mayor
Ra: Resistencia del inducido=5ohm.
precisión en los movimientos y al producirse un error de
posicionamiento o si se presentara algún desfase el La: Inductancia del inducido=0.1 Hr.
controlador del sistema permite la corrección de este
colocándolo en la posición deseada nuevamente. K3: Cte de fuerza contraelectromotriz=0.68volt/(rad/seg)
La planta asignada para este trabajo consta de una entrada de K2: Cte del par motor=0.68 newton*m/sg
referencia, un amplificador y un motor conectado a un tren n: Relación de engranes (N1/N2) =1/10.
de engranajes que mueven una carga. Para explicar su
funcionalidad este sistema funciona montado en un brazo Jc: Momento de inercia de la carga=0.136 N*m*sg.
robótico para realizar trabajos de posicionamiento de objetos Fc: Fricción Viscosa de la carga=0.136 N*m/(rad/sg).
como
Jm: Momento de inercia del motor=0.00136 N*m*sg.
El presente paper está conformado a continuación de esta
introducción por una nomenclatura donde se indican los Fm: Fricción Viscosa del motor=Despreciable.
valores y significados de las diversas variables que se 1) Amplificador
presentan a lo largo del trabajo, un marco teórico en el cual
se explica de manera teórica algunos conceptos básicos e(t): Voltaje de entrada del amplificador
respecto al proyecto como el funcionamiento de los
ea(t): Voltaje con la ganancia del amplificador
componentes principales y otros datos que se consideraron
relevantes, el desarrollo del proyecto explicando los pasos A: Ganancia del amplificador
que se siguieron en la elaboración del mismo, los anexos
correspondientes y las conclusiones finales. 2) Motor DC
K3: constante de fuerza contraelectromotriz.
Por lo tanto:
θm (t ) n2 T m
= = 0
θc(t ) n1 T c
Fig. 3. Diagrama de bloques. (Elaboración propia)
T c n1 0
Para el motor DC en lazo abierto se usan las siguientes T m=
ecuaciones: n2
d 2 θm ( t) d θm (t)
0
T m(t )=J m 2
+f m En la Ec. (9) despejamos Tm siendo este torque en el eje
dt dt del motor
d i a (t) 0 Por lo tanto, el modelo matemático del motor con la
e a (t )=R a i a (t ) + La + em (t) carga y el tren de engranajes, que vamos a utilizar mas
dt
adelante para el desarrollo de todas las simulaciones, es la
d θm (t) 0 Ec. (10).
e m (t )=k 3
dt K2
∗1 0
T m(t )=k 2 i a(i) 0 2 2
[ J c n s +f c n s ] ( Ra + La s ) +( K 2 K 3 s )
10
3) Tren de engranajes En la ecuación 10 podemos observar dos términos, el
primero representa al modelo del motor con la carga, al cual
Los trenes de engranajes de utilizan usualmente en se llega mediante las ecuaciones 3, 4, 5 y 6, y el segundo
sistemas electromecánicos para reducir la velocidad, término que representa al tren de engranajes
amplificar el par o para obtener la transferencia de potencia
más eficiente. IV. DESARROLLO DEL PROYECTO
Es un sistema formado por varios engranajes conectados Con la presente planta (Fig. 1) que cuenta con un motor,
entre sí. Los trenes de engranajes se emplean para conseguir un tren de engranajes y una carga, se realizó su respectivo
mecanismos de transmisión con características que no modelo que es nuestro G(s). A este modelo le afecta
podrían conseguirse con un sólo engranaje (por ejemplo directamente nuestro amplificador “A” que es un controlador
una relación de transmisión elevada). Cada engranaje del tren de tipo proporcional y este se realimenta de tita de carga (θc)
se denomina etapa del tren de engranajes. [4] a tita retroalimentado. Esto representa nuestra planta
completa con un controlador incluido.
En el circuito (Fig. 1) podemos apreciar un tren de
engranajes simple compuesto por dos piezas (N1, N2) como A. Requerimientos de sistema
los mostrados en la Fig. 4 y Fig. 5. Para el desarrollo de ese proyecto se tiene los siguientes
requerimientos a cumplir para así considerar un sistema
óptimo.
1) El tiempo de asentamiento debe ser de 0.5sec.
2) Overshoot = 0%
3) Valor de referencia de 1º.
4) Tiempo de subida aproximado a 0.2 segundos.
Fig. 10. Respuesta del sistema sin controlador A en Lazo Abierto Rampa (Elaboración propia)
Fig. 11. Respuesta del sistema sin controlador A en Lazo Abierto Senoidal (Elaboración propia)
Fig. 12. Respuesta del sistema sin controlador A en Lazo Abierto (Elaboración propia)
Fig. 13. Root Locus con controlador PD en Lazo Cerrado (Elaboración propia)
Fig. 14. Nyquist con controlador PD en Lazo Cerrado (Elaboración propia)
Fig. 15. Respuesta en Lazo Cerrado con controlador PD Rampa (Elaboración propia)
Fig. 16. Respuesta en Lazo Cerrado con controlador PD Senoidal (Elaboración propia)
Fig. 23. Respuesta en Lazo Abierto senoidal en tiempo discreto (Elaboracion propia)
Fig. 24. Respuesta en Lazo Abierto en tiempo discreto (Elaboracion propia)
Fig. 25. Respuesta en Lazo Cerrado rampa en tiempo discreto (Elaboracion Propia)
Fig. 26. Respuesta en Lazo Cerrado senoidal en tiempo discreto (Elaboracion Propia)
Fig. 28. Modelo en Lazo Cerrado con controlador PD en tiempo discreto (Elaboracion propia)
clc;
syms s
%% Definicion de la planta
gs=(500)/(s^3+51*s^2+3450*s);
disp('Proyecto')
disp('G(s) =')
pretty(gs)
%% Funcione de Transferencia
%Se declara funcion de transferencia
s=tf('s');
disp('Funcion en Lazo Abierto')
gs=(500)/(s^3+51*s^2+3450*s)
%% Analisis de la funcion en LA
%Gs=pidtune(gs,'PID');
%pidTuner(Gs);
% 1
% Kp + Ki * --- + Kd * s
% s
%
% tiempo de respues 1s, pico maximo 1.13, no debe existir overshoot
Kp=68;
Ki=0;
Kd=1.034;
disp('Controlador PID')
C = pid(Kp,Ki,Kd)
%Planta y controlador
disp('Planta y controlador');
H=gs*C
%Controlador PD
figure(9)
t=0:0.001:1;
step(ps,t);
grid on
title('Respuesta Escalon LC controlador C')
ylabel('Desplazamiento angular')
%% Definicion de la planta
gs=(500)/(s^3+51*s^2+3450*s);
disp('Proyecto')
disp('G(s) =')
pretty(gs)
%% Funcione de Transferencia
%Se declara funcion de transferencia
s=tf('s');
disp('Funcion en Lazo Abierto')
gs=(500)/(s^3+51*s^2+3450*s)
%% Discretizacion de la planta
T=0.004; %Tiempo de muestreo
disp('Planta discretizada');
Gd=c2d(gs,T,'zoh')
% 1
% Kp + Ki * --- + Kd * s
% s
%
% tiempo de respues 1s, pico maximo 1.13, no debe existir overshoot
Kp=68;
Ki=0;
Kd=1.034;
disp('Controlador PD')
C = pid(Kp,Ki,Kd)
Cs=68+1.034*s;
Cd=c2d(Cs,T,'tustin')
%Planta y controlador
disp('Planta y controlador');
Hd=Gd*Cd
%Controlador PD
figure(9)
t=0:T:1;
step(Pd,t);
grid on
title('Respuesta Escalon LC controlador C')
ylabel('Desplazamiento angular')
XVII. OBSERVACIONES
Con la planta que se trabajó no es posible diseñar un
controlador por el método de Ziegler Nichols ya que
no se tiene un valor independiente en la ecuación
característica.
En vista de presentar un requerimiento que indica un
overshoot igual a 0% las simulaciones previamente
realizadas con un controlador PID presentaban una
respuesta a la señal de entrada que incumplía con éste
XVIII. BIBLIOGRAFÍA
[1] Daniel, K. (1973). An Introduction to Mechanics. McGraw-Hill.
[2] González, A. P. (27 de 02 de 2008). Mecapedia. Obtenido de Enciclopedia Virtual de Ingeniería Mecánica:
http://www.mecapedia.uji.es/tren_de_engranajes.htm
[3] Gutierrez Suclla Andree, L. T. (2014). Control de posicion angular de un motor. CONTROL DE POSICION ANGULAR DE UN MOTOR, (pág. 42).
[4] Nise, N. S. (s.f.). Control System Engineering. California: John Wiley & Sons, Inc.
[5] Obando, L. F. (2018). Sistema de control de posición – Servomotores. Caracas, Quito, Guayaquil, Cuenca: Escuela de Ingeniería Eléctrica de la
Universidad Central de Venezuela, Caracas.
[6] Puentes, J. A. (s.f.). CONTROL DE MOTORES ELÉCTRICOS. Obtenido de https://tesisconsultor.files.wordpress.com/2018/03/control-de-motores-
elc3a9ctricos.pdf