Bienvenido: Ingresar

Subir página de contenido

Puedes subir contenido para la página con el nombre abajo. Si cambias el nombre de la página, puedes subir contenido para otra página. Si el nombrede la página lo dejas en blanco, tomaremos el nombre del archivo

Archivo de contenido para la página
Nombre de la página
Comentario
Como se llama la parte imaginaria de la impedancia

Versión 34 con fecha 2010-10-04 13:22:37

location: LabElectronica / ProyectoQuadricoptero / QA3Fase1EstModYConArqRobMoviles / Balancin

Tabla de Contenidos

  1. Modelo Balancín con Compensador PID
    1. Modelo Continuo
      1. Archivos para Simulaciones
    2. Modelo Discreto

Modelo Balancín con Compensador PID

Modelo Continuo

planta_lc_continuo.png

$$$ \sum{\tau_x} = \tau_2 - \tau_1 = J\frac{d^2\theta}{dt^2} $$

$$$ s^2\theta_{(s)}= \frac{\tau_{(s)}}{J} $$

$$$ G_{bal(s)} = \frac{1}{Js^2} $$

$$$ G_{torque(s)} = k_\tau $$

$$$ G_{PID(s)} = k_p\cdot(1 + \frac{1}{T_is} + T_ds}) $$

$$$ G_{LA(s)} = G_{bal(s)}G_{torque(s)}G_{PID(s)} = \frac{k_pk_{\tau}}{T_iJ}\frac{T_iT_ds^2 + T_is + 1}{s^3} $$

$$$ G_{LC(s)} = \frac{G_{LA(s)}}{1+G_{LA(s)}} = k_p k_{\tau} \frac{T_i T_d s^2 + T_i s + 1}{T_i J s^3 + k_p k_{\tau} T_i T_d s^2 + k_p k_{\tau} T_i s + k_p k_{\tau}}$$

Archivos para Simulaciones

Simulacion de la planta a lazo abierto con el PID. 

   1 J = 0.0086556;
   2 Kp = 1;
   3 Kt = 90.63e-6;
   4 Ti = 0;
   5 Td = 0;
   6 
   7 desicion = 1;
   8 
   9 while( desicion == 1)
  10 
  11 	%Kp = input('Ingrese Kp : ');
  12 	Ti = input('Ingrese Ti : ');
  13 	Td = input('Ingrese Td : ');
  14 
  15 	num = Kp*Kt/(Ti*J)*[Ti*Td, Ti, 1];
  16 	den = [1, 0, 0, 0];
  17 
  18 	sistema = tf(num,den);
  19 
  20     K_inc = input('Ingrese el incremento de K del rlocus: ');
  21 	K_max = input('Ingrese el K_max del rlocus: ');
  22 	
  23 	%rlocus(sistema,K_inc,0,K_max);
  24     rlocus(sistema);
  25 
  26     pause;
  27 	desicion = input('Ingrese 1 para hacer otro rlocus: ');
  28 
  29 end
PID_LA_continuo.m

Respuesta en el tiempo de la planta a lazo cerrado con el PID. 

   1 J = 8.56e-3
   2 td=.1;
   3 ti=1e9;
   4 kt = 90.63e-6;
   5 kp = 10000;
   6 step(tf(kp*kt*[td*ti,ti,1],[ti*J,ti*td*kp*kt,kp*kt*ti,kp*kt]),1,1,100);
   7 ylabel("respuesta al escalon con PID");
PID_LC_continuo.m

Modelo Discreto

planta_lc_discreto.png

$$$ G_{bal(s)} = \frac{1}{Js^2} $$

$$$ G_{ROC(s)}=\frac{1-e^{-TS}}{S}$$

$$$ G_{torque(s)} = k_\tau $$

$$$ G_{PID(s)} = k_p\cdot(1 + \frac{1}{T_is} + T_ds}) $$

$$$ G_{planta(Z)} = Z[G_{ROC(s)}G_{bal(s)}G_{torque(s)}] = Z[\frac{1 - e^{-TS}}{S}\frac{k_\tau}{JS^2}] = (1-z^-1)Z[\frac{2k_\tau}{2JS^3}] = \frac{T^2k_\tau}{2J}\frac{z+1}{z^2-2z+1}$$

$$$ G_{PID(Z)} = K_P + \frac{K_I}{1-z^-1} + K_D(1-z^-1) = \frac{(K_P + K_I + K_D)z^2 + ( -2K_D - K_P )z + K_D }{ z^2 - z } $$

$$$ G_{LA(Z)} = G_{PID(Z)}G_{planta(Z)} = \frac{T^2k_\tau}{2J}\frac{(K_P + K_I + K_D)z^3 + (K_I - K_D)z^2 + (-K_P - K_D)z + K_D}{z^4-3z^3+3z^2-z} $$

$$$ G_{LC(Z)} = \frac{G_{LA(Z)}}{1+G_{LA(Z)}} = \frac{k_{\tau}T^2((K_P + K_I + K_D)z^3 + (K_I - K_D)z^2 + (-K_P - K_D)z + K_D)}{ 2Jz^4 + ((K_P + K_I + K_D)k_{\tau}T^2 -6 )z^3 + ((K_I - K_D)k_{\tau}T^2 +6 )z^2 + ( ( -K_P - K_D ) k_{\tau} T^2 -2 )z + K_D k_{\tau} T^2 } $$