%% ABOUT THIS FILE
% ----------------------------------------------------------------------
% Type-A for KAGRA
% Coded by K. Okutomi on 2017.03.03
% ----------------------------------------------------------------------

%% PRELIMINARY
clear all;  % Clear workspace
close all;  % Close plot windows
%%
cd('/Users/kokioktm/Documents/suspension/MATLAB/script/TypeA'); % Change directory
addpath('../../utility');  % Add path to utilities
addpath('../../oktfunc');
addpath('controlmodel');
addpath('susmodel');
g = 9.81;
pp = 2.0*pi;

%% IMPORT SUSPENSION MODEL
matfile='TypeA161114mdl';
load([matfile,'.mat']);

%% IMPORT SERVO FILTERS
addpath('parameter');         % Add path to servo
TypeA_paramNoCtrl170105;      % NO CONTROL MODE
rmpath ('parameter');         % Remove path to servo

%% IMPORT SIMULINK MODEL
mdlfile='TypeA_ctrl161209';
st     =linmod(mdlfile);
invl   =strrep(st.InputName, [mdlfile,'/'],'');
outvl  =strrep(st.OutputName,[mdlfile,'/'],'');
sysc0  =ss(st.a,st.b,st.c,st.d,'inputname',invl,'outputname',outvl);

%% FREQUENCY
freq =logspace(-2,2,1001);
freq2=logspace(-3,1,1001);

%% NO CONTROL ANALYSIS
% ----------------------------------------------------------------------------
%% IMPORT NOISE
dataSeismic = importdata('../../noise/KamiokaSeismicHighNoise.dat');   % m/rtHz
dispSeismic = interp1(dataSeismic(:,1),dataSeismic(:,2),freq);         % m/rtHz
accSeismic = pp*pp.*freq.*freq.*dispSeismic;        % m/sec2/rtHz

tf_injLF0_LVDT_LF0 = calcsystf(sysc0, 'injLF0', 'LVDT_LF0', freq);
plotbode(tf_injLF0_LVDT_LF0);
noiseLF0 = accSeismic .* tf_injLF0_LVDT_LF0.mag;