%% parameter NTV

Lf = 1.03802;
Lr = 0.76683;
Lp = 0,0085;
La = 0.71755;
Hp = -0.48814
mb = 495; % massa kendaraan penumpang full
Ib = 167; %lyy
mwf = 40.5; %asumsi
mwr = 32.4; %asumsi
mp = 90.2; %asumsi
ma = 90.2;
ksf = 46599.64; %Hasil Perhitungan
ksr = 24201.08;
%ksf = 43100; %Corona EXiv
%ksr = 38200; %Toyota Carina ED
%ksf = 63700; %Celica GT Four
%ksr = 58800;
ktf = 221973.4385;
ctf = 3430;
ktr = 221973.4385;
ctr = 3430;
%kk = 80870; ck = 748; %Vector with Vicair (01)
%kk = 69730; ck = 392; %Meridian Wave (02)
%kk = 86470; ck = 760; %ROHO HIGH PROFILE (03)
kk = 36090; ck = 522; %Jay J2 Deep Contour (04)
%kk = 65900; ck = 855; %ROHO LOW PROFILE (05)
%kk = 141800; ck = 1311; %Zoombag Protective Gear with Foam (06)
%kk = 143200; ck = 1408; %Comfort Mate Foam (07)
ka = 36090;
ca = 522;

%freq_nat_pengemudi = 1.5; %(Hz)

%csf = 3689.83; %parameter aktual

%csr = 7009.99; %parameter aktual
%% variasi rasio redaman
Ff = (mb*9.81*Lr)/(Lr+Lf);
Fr = (mb*9.81*Lf)/(Lr+Lf);
%xbf_static = Ff/ksf;
%xbr_static = Fr/ksr;
%x_eq = xbf_static+((Lf/(Lr+Lf))*(xbr_static-xbf_static));
%k_eq = (mb*9.81)/x_eq;
%cc = 2*((k_eq*mb)^0.5);
%sai = 0.3; %----------ini yang divariasikan (0,3 sampai 0,7)
%csf = sai*cc;
%csr = sai*cc;
%--------------------------------------------------------------------
ccf = 2*((ksf*(mb/2))^0.5);
ccr = 2*((ksr*(mb/2))^0.5);
sai = 0.3;
csf = sai*ccf;
csr = sai*ccr;

%% konstanta matrix state space

a201 = (-(ktf+ksf))/mwf;
a202 = (-(ctf+csf))/mwf;
a205 = ksf/mwf;
a206 = csf/mwf;
a207 = (ksf*Lf)/mwf;
a208 = (csf*Lf)/mwf;
a403 = (-(ktr+ksr))/mwr;
a404 = (-(ctr+csr))/mwr;
a405 = ksr/mwr;
a406 = csr/mwr;
a407 = (-ksr*Lr)/mwr;
a408 = (-csr*Lr)/mwr;
a601 = ksf/mb;
a602 = csf/mb;
a603 = ksr/mb;
a604 = csr/mb;
a605 = (-(ksr+ksf+kk))/mb;
a606 = (-(csr+csf+ck))/mb;
a607 = (-((ksf*Lf)-(ksr*Lr)+(kk*Lp)+(ka*La)))/mb;
a608 = (-((csf*Lf)-(csr*Lr)+(ck*Lp)+(ca*La)))/mb;
a609 = kk/mb;
a610 = ck/mb;
a611 = ka/mb;
a612 = ca/mb;
a801 = (-ksf*Lf)/Ib;
a802 = (-csf*Lf)/Ib;
a803 = (-ksr*Lr)/Ib;
a804 = (-csr*Lr)/Ib;
a805 = (-((-ksr*Lr)+(ksf*Lf)+(kk*Lp)+(ka*La)))/Ib;
a806 = (-((-csr*Lr)-(csf*Lf)+(ck*Lp)+(ka*La)))/Ib;
a807 = (-((ksr*(Lr^2))+(ksf*(Lf^2))+(kk*(Lp^2))+(ka*(La^2))))/Ib;
a808 = (-((csr*(Lr^2))+(csf*(Lf^2))+(ck*(Lp^2))+(ca*(La^2))))/Ib;
a809 = (kk*Lp)/Ib;
a810 = (ck*Lp)/Ib;
a811 = (ka*La)/Ib;
a812 = (ca*La)/Ib;
a1005 = kk/mp;
a1006 = ck/mp;
a1007 = (kk*Lp)/mp;
a1008 = (ck*Lp)/mp;
a1009 = -kk/mp;
a1010 = -ck/mp;
a1205 = ka/ma;
a1206 = ca/ma;
a1207 = (ka*La)/ma;
a1208 = (ca*La)/ma;
a1211 = -ka/ma;
a1212 = -ca/ma;
b21 = ctf/mwf;
b22 = ktf/mwf;
b43 = ctr/mwr;
b44 = ktr/mwr;

%% matriz state space

A= [0 1 0 0 0 0 0 0 0 0 0 0;
a201 a202 0 0 a205 a206 a207 a208 0 0 0 0;
0 0 0 1 0 0 0 0 0 0 0 0;
 0 0 a403 a404 a405 a406 a407 a408 0 0 0 0;
0 0 0 0 0 1 0 0 0 0 0 0;
a601 a602 a603 a604 a605 a606 a607 a608 a609 a610 a611 a612;
0 0 0 0 0 0 0 1 0 0 0 0;
a801 a802 a803 a804 a805 a806 a807 a808 a809 a810 a811 a812;
0 0 0 0 0 0 0 0 0 1 0 0;
0 0 0 0 a1005 a1006 a1007 a1008 a1009 a1010 0 0;
0 0 0 0 0 0 0 0 0 0 0 1;
0 0 0 0 a1205 a1206 a1207 a1208 0 0 a1211 a1212];
B= [0 0 0 0;
b21 b22 0 0;
0 0 0 0;
0 0 b43 b44;
0 0 0 0;
0 0 0 0;
0 0 0 0;
0 0 0 0;
0 0 0 0;
0 0 0 0;
0 0 0 0;
0 0 0 0];
C= [a601 a602 a603 a604 a605 a606 a607 a608 a609 a610 a611 a612;
a201 a202 0 0 a205 a206 a207 a208 0 0 0 0;
0 0 a403 a404 a405 a406 a407 a408 0 0 0 0;
0 0 0 0 a1005 a1006 a1007 a1008 a1009 a1010 0 0;
0 0 0 0 a1205 a1206 a1207 a1208 0 0 a1211 a1212;
a801 a802 a803 a804 a805 a806 a807 a808 a809 a810 a811 a812;
0 0 0 0 1 0 0 0 0 0 0 0;
1 0 0 0 0 0 0 0 0 0 0 0;
0 0 1 0 0 0 0 0 0 0 0 0;
0 0 0 0 0 0 0 0 1 0 0 0;
0 0 0 0 0 0 0 0 0 0 1 0;
0 0 0 0 0 0 1 0 0 0 0 0];
D= [0 0 0 0;
b21 b22 0 0;
0 0 b43 b44;
0 0 0 0;
0 0 0 0;
0 0 0 0;
0 0 0 0;
0 0 0 0;
0 0 0 0;
0 0 0 0;
0 0 0 0;
0 0 0 0];

%%input
baris=1;kolom=1;
for freq = 0:0.25:25;
%jalan sinusoidal
Am = 0.05;
%Lambda = 0.5; %-- ini ikut divariasikan
Lambda =1; %-- ini ikut divariasikan
T = (1/freq);
L = Lf+Lr;
tw = L/(freq*Lambda);
 t = 0:0.001:2;
for i = 1:1:length(t);
tsinusoidal=t(i);
yf(i) = (Am)*(sin(((2*pi*freq)*tsinusoidal)));
if tsinusoidal>(tw+(T/2));
yr(i) = (Am)*(sin(((2*pi*freq)*(tsinusoidal-tw))));
else if tsinusoidal<tw;
yr(i) = 0;
else
yr(i) = (Am)*(sin(((2*pi*freq)*(tsinusoidal-tw))));
end
end
end

yfdot=[0 (diff(yf)./diff(t))];
yrdot=[0 (diff(yr)./diff(t))];
input=transpose([t; yfdot; yf; yrdot; yr]);

SimOut=sim('TA113',t);
Acc=rms(xp);
Acceleration(baris,kolom)=Acc;
Frequency(baris,kolom)=freq;
kolom=kolom+1;
end

%plot grafik
figure(110)
plot(Frequency,Acceleration);axis equal;
xlabel('Frequency(1/s)');ylabel('RMS');title('Grafik Respon RMS Pengemudi');