% ----------------------------------------------------------------------
% VIS for KAGRA
% Coded by A Shoda on 2018/04/19
% ----------------------------------------------------------------------
% Load model of each suspension
% ----------------------------------------------------------------------
%% Add path
clear all;                     % Clear workspace
close all;                     % Close plot windows
%addpath('D:\OneDrive\Documents\phys\src\DttData');
addpath('../../utility');      % Add path to utilities
addpath('servofilter');        % Add path to servo
addpath('measurement');
addpath('SUS');
g = 9.81;                      % Gravity constant
freq=logspace(-2,2.5,1001);

%% Load parameter

optic = input('which optic? ');
load(strcat(optic,'mdl.mat'));
load(strcat(optic,'mdl_realparams.mat'));
st     =linmod(mdlfile);          % Linearize simulink model
invl   =strrep(st.InputName, [mdlfile,'/'],'');
outvl  =strrep(st.OutputName,[mdlfile,'/'],'');
sysc0  =ss(st.a,st.b,st.c,st.d,'inputname',invl,'outputname',outvl);