clear,clc,close all

freq = 5;
wn = 2 * pi * freq;
T = 0.004;
ksi = 0.75;

t=0:0.004:2;
test_data = rand(1,length(t)) + 10 + 2 * sin(2*pi*2*t);

sys = tf(wn*wn,[1, 2*ksi*wn,wn*wn])
dsys=c2d(sys,T,'tustin');
[num,den] = tfdata(dsys,'v')
test_data1 = filter(num,den,test_data)
disp("---------")

sys = tf([1 0 0],[1, 2*ksi*wn,wn*wn])
dsys=c2d(sys,T,'tustin');
[num,den] = tfdata(dsys,'v')
test_data2 = filter(num,den,test_data)
disp("---------")


sys = tf([1 0 wn*wn],[1, 2*ksi*wn,wn*wn])
dsys=c2d(sys,T,'tustin');
[num,den] = tfdata(dsys,'v')
test_data3 = filter(num,den,test_data)
disp("---------")

sys = tf(wn,[1, wn])
dsys=c2d(sys,T,'tustin');
[num,den] = tfdata(dsys,'v')
test_data4 = filter(num,den,test_data)
disp("---------")

sys = tf([1,0],[1, wn])
dsys=c2d(sys,T,'tustin');
[num,den] = tfdata(dsys,'v')
test_data5 = filter(num,den,test_data)
disp("---------")

windowSize = 10; 
b = (1/windowSize)*ones(1,windowSize);
a = 1;
test_data5 = filter(b,a,test_data)

num = [0.028  0.053 0.071  0.053 0.028];
den = [1.000 -2.026 2.148 -1.159 0.279];
test_data6 = filter(num,den,test_data)
disp("---------")