Professional Documents
Culture Documents
Donde la masa 𝑀 = 1, 𝐹(𝑡) = 4𝑠𝑖𝑛(𝑤𝑡), 𝐹1(𝑡) = 𝐾𝑥(𝑡) = 25𝑥(𝑡), 𝐹2(𝑡) = 𝐵𝑥̇ (𝑡) = 6𝑥̇ (𝑡)
Esto nos da
Sistema resorte-amortiguador
𝑑(𝐹) 𝑑(𝐹)
𝐹(𝑥, 𝑡) = 𝐹(𝑥 ∗ , 𝑤 ∗ ) + |(𝑥 − 𝑥 ∗ ) + |(𝑤 − 𝑤 ∗ )
𝑑𝑥 𝑥1∗ 𝑤1∗ 𝑑𝑡 𝑥1∗ 𝑤1∗
Donde se sabe que
0 + 0 + 0 = 4 sin(𝑤𝑡) ≠ 0
El sistema no es lineal por ello deberemos encontrar el equilibrio
∆𝑋(𝑠) 4cos(𝑤)
−25∆𝑋(𝑠) + 4cos(𝑤)∆𝑊(𝑠) = 𝑠 2 ∆𝑋(𝑠) + 6𝑠∆𝑋(𝑠)------- =
∆𝑊(𝑠) 𝑠2 +6𝑠+25
clc
clear all
close all
K=25;
Ba=6;
M=1;
t=0:0.01:5;
A1=5;%Posición inicial de 5cm
A2=7;%Posición final de 7cm
%La altura de la deformacion por el resorte y amortiguador
estara dado por
%Xe la deformacion en equilibrio
Xe=(4*sin(2*t))/25
figure(1)
plot(t,Xe),grid on
title('Variacion en relacion a la posicion inicial y final en el
punto de equilibrio')
ylabel('Posicion (x)')
xlabel('Tiempo en la deformación')
Dada una función en un instante ts=5seg en equilibrio
clc
clear all
close all
K=25;
Ba=6;
M=1;
t=0:0.01:6;
ts=5; %En el equilibrio
w=2;%Frecuencia
%La altura de la deformacion por el resorte y amortiguador
estara dado por
%Perfil de estados
xe=((4.*sin(2.*t))/25);
figure(1)
plot(t,xe),grid on
title('Variacion en relacion a la posicion inicial y final en el
punto de equilibrio')
ylabel('Posicion (x)')
xlabel('Tiempo en la deformación')
-0.0870
As =
-25 1
1 1
Bs =
7.8791
0
Cs =
0 1
ft1 =
7.879
---------------
S^2 + 24 s – 26
dbmax=50*ones(1,100);
dbmin=-100*ones(1,100);
subplot(2,1,1)
semilogx(w,magdb,'o',w,magdb,'-',w,dbmax,'-',w,dbmin,'-')
grid
title('Diagrama de Bode')
xlabel('Frecuencia(rad/seg)')
ylabel('Ganancia db')
pmax=-50*ones(1,100);
pmin=-200*ones(1,100);
subplot(2,1,2)
semilogx(w,phase,'o',w,phase,'-',w,pmax,'-',w,pmin,'-')
grid
xlabel('Frecuencia(rad/seg)')
ylabel('Fase en grados')
A partir de su función de transferencia calcularemos la
transforma inversa de laplace para obtener la respuesta ante el
tiempo y así poderlo pasar al dominio Z
s + 32.88
F(s)= ---------------
s^2 + 24 s – 26
Syms s t
y=((s+32.88)/(s^2+24*s-26))
ilaplace(y)
exp(-12*t)*(cosh(170^(1/2)*t) +
(261*170^(1/2)*sinh(170^(1/2)*t))/2125)
pretty(ilaplace(y))
[G,H]=c2d(As,Bs,0.06);
[num1,den1]=ss2tf(G,H,Cs,0);
y1=tf(num1,den1);
r=ones(1,101);
k=0:100;
y=filter(num1,den1,r);
plot(k,y,'o',k,y,'-')
grid
title('Posicion del bloque y(k)=0.1')
xlabel('k')
ylabel('y(k)=0.1')
El muestreo de la señal es casi fiel a la original donde se puede considerar que el tiempo
T=0.1seg es óptimo en cada instante del movimiento del bloque por efecto del amortiguador y
resorte unido a este. Los puntos nos representan como la imagen es muestreada ante un
impulso escalón sin producir aleasing o solapamiento entre un punto a otro. La imagen es
reconstruida totalmente a partir de los 100 puntos establecidos en el filtro de que viene a
partir de la F.T
Problema de Transformada Z
En este sistema dinámico que consta de un carrito con un péndulo simple que oscilara
mientras el coche este en movimiento pero el ángulo estará dado por θ que por ser un
péndulo simple el ángulo es menor a 8º pero adquirirá la aceleración del coche en
movimiento. Por lo cual se debe obtener primero el modelo de espacio de estado en tiempo
continuo y luego se discretizara el sistema contando puntos o instantes en el cual el sistema
está en movimiento es decir puntos para muestrear el sistema ante una respuesta escalon y
verificar la estabilidad en el sistema. El periodo de muestreo de la señal es tomada cada T=0.1s
donde 𝑀, 𝑚, 𝑙 estarán determinados por los valores
Se define el ángulo de la varilla desde la línea vertical como θ (Como se desea que el péndulo
invertido permanezca vertical, el ángulo es pequeño como ya se había nombrado
anteriormente, por ello se trabaja con su centro de gravedad 𝑋, 𝑍
𝑋 = 𝑥 + 𝑙𝑠𝑒𝑛𝜃
𝑍 = 𝑙𝑐𝑜𝑠𝜃
(𝑀 + 𝑚)𝑥̇ − 𝑚𝑙(𝑠𝑒𝑛𝜃)𝜃̇ 2 + 𝑚𝑙(𝑐𝑜𝑠𝜃)𝜃̇ = 𝑢
La ecuación del movimiento de la masa m en la dirección z no se puede escribir sin considerar
el movimiento de la masa m en la dirección x. Por lo que el movimiento de la masa m en la
dirección z se considera el movimiento rotacional de la masa m alrderdor del punto P. Al
aplicar movimiento rotacional se obtiene
𝑑2𝑋 𝑑2𝑍
[𝑚 𝑙𝑐𝑜𝑠𝜃 − 𝑚 𝑙𝑠𝑒𝑛𝜃 = 𝑚𝑔𝑙𝑠𝑒𝑛𝜃]
𝑑𝑡 2 𝑑𝑡 2
Luego que se ha encontrado el espacio de estado se procederá a ubicar instantes con un
tiempo T=0.1 s y para ello el sistema se debe discretizar el sistema y por medio del comando
c2d(convierte de modelo continuo a discreto)
clc
clear all
close all
%El diagrama de estado dela funcion anterior del diagrama
bloque-pendulo
A=[0 1 0 0
20.601 0 0 0
0 0 0 1
-0.4905 0 0 0];
B=[0;-1;0;0.5];
C=[0 0 1 0];
D=[0];
[G,H]=c2d(A,B,0.1)
%Matrices G1,H1,Q y R
G1=[G zeros(4,1);-C*G 1]
H1=[H;-C*H]
Q=[10 0 0 0 0
0 1 0 0 0
0 0 100 0 0
0 0 1 0 0
0 0 0 0 1]
R=[1]
%Se comienza a resolver la ecuacion de Riccati en estado
estacionario
%para P cuando P=diag(0,4)
P=diag(0,4);
P=Q+G1'*P*G1-G1'*P*H1*inv(R+H1'*P*H1)*H1'*P*G1;
%Se revisa la solucion de P cada 20 interacciones
%La iteración se detiene cuando P permanece constante
for i=1:20;
P=Q+G1'*P*G1-G1'*P*H1*inv(R+H1'*P*H1)*H1'*P*G1;
end
%Segunda iteración
for i=1:20;
P=Q+G1'*P*G1-G1'*P*H1*inv(R+H1'*P*H1)*H1'*P*G1
end
Probando con la variable 𝑓𝑜𝑟 desde 𝑖 = 1: 20 observaremos que se alcanza la estabilidad
cuando se llega una prueba infinita es decir un bucle con lo cual el sistema se volverá estable
en un diagrama de espacio de estado