%% ABOUT THIS FILE
% ----------------------------------------------------------------------
% Parmeter setting for NO CONTROL MODE
% Type-B1 prototype for KAGRA
% Coded by T. Sekiguchi on 2015/06/16
% ----------------------------------------------------------------------

%% CONSTANTS
pp=2*pi;

%% ACTUATOR NORMALIZATION
% Normalize the actuators using local sensors at 0 Hz

% % F0 (Normalized with LVDT signals)
% gain_act_LF0 = 214.7;
% gain_act_TF0 = 214.7;
% gain_act_YF0 = 158.9;

% F2 (Normalized with OSEM signals)
gain_act_LF2 = 3300.0;
gain_act_TF2 = 3300.0;
gain_act_RF2 = 74;
gain_act_PF2 = 74;

% IM (Normalized with OSEM signals)
gain_act_LIM = 155.0;
gain_act_TIM = 155.0;
gain_act_VIM = 384.5;
gain_act_RIM = 2.412;
gain_act_PIM = 2.399;
gain_act_YIM = 0.387;

% TM (Normalized with OSEM signals)
gain_act_LTM = 100.0;
gain_act_PTM = 1.133;
gain_act_YTM = 1.773;

% GAS (Normalzed with LVDT signals)
% gain_act_VF0 = 1193.;
gain_act_VF1 = 940.7;
gain_act_VF2 = 383.3;


%% BLENDING FILTERS
% This part constructs filters for blending LVDT and geophone signals.
% Blending filters are constructed from polynominal expression of a Laplace
% transformed equation (s+w0)^n, where w0 is the blending frequency and n
% is an arbitrary (odd) integer.
% 
% % BLENDING FREQUENCY: 0.3 Hz
% f_blend = 0.5;
% w_blend = f_blend*pp;
% 
% % COEFFICIENTS LIST OF POLYNOMINAL EXPRESSION OF (s+w0)^n
% n_blend = 7; % 5th order blending
% nbd = (n_blend+1)/2;
% cf_poly = zeros(1,n_blend+1);
% for n=0:n_blend; cf_poly(n+1)=nchoosek(n_blend,n)*w_blend^(n); end
% 
% % BLENDING FILTERS
% blend_HP = tf([cf_poly(1:nbd),zeros(1,nbd)],cf_poly);
% blend_LP = tf(cf_poly(nbd+1:n_blend+1),cf_poly);
% 
% % BLENDING FILTERS (ZPK EXPRESSION)
% % blend_LP = myzpk([0.075+1i*0.0581;0.075-1i*0.0581],[0.3;0.3;0.3;0.3;0.3],66.97);
% % blend_HP = myzpk([0.75+1i*0.581;0.75-1i*0.581;0;0;0],[0.3;0.3;0.3;0.3;0.3],1);
% 
% % GEOPHONE RESPONSES
% georesp  = zpk([-2.13+1i*5.19;-2.13-1i*5.19],[0;0],1);
% vel2disp = zpk([],0,1);
% 
% % BLENDING FILTERS WITH GEOPHONE RESPONSES
% % blend_LVDT = blend_LP;
% % blend_GEO  = minreal(blend_HP*georesp*vel2disp);
% blend_LVDT = 1;
% blend_GEO  = 0;

% PLOT 1
% freq1=logspace(-3,2,1001);
% mybodeplot({blend_LP,blend_HP,blend_LP+blend_HP},freq1);

% PLOT 2
% freq1=logspace(-3,2,1001);
% mybodeplot({blend_LVDT,blend_GEO},freq1);

%% SERVO FILTER
% GENERAL SERVO
% damping servo with 300 Hz cutoff
% dampflt = myzpk(0,[3e2,3e2],9e4*pp);
dampflt=0;
% DC + damping servo with G=330 at 0.1 mHz
% dcdampflt = myzpk([8e-2;8e-2],[1e-4;1e1],100/6.4)...
%           * myzpk([],[1e1;1e1],(1e1*pp)^2)...
%           * myresonantfilter(0.415,1,5);
dcdampflt=0;

% % SERVO FILTER F0
% servo_LF0 = dcdampflt;
% servo_TF0 = dcdampflt;
% servo_YF0 = dcdampflt;

% SERVO FILTER F2
servo_LF2 = dampflt;
servo_TF2 = dampflt;
servo_RF2 = dampflt;
servo_PF2 = dampflt;

% SERVO FILTER IM
servo_LIM = dampflt;
servo_TIM = dampflt;
servo_VIM = dampflt;
servo_RIM = dampflt;
servo_PIM = dampflt;
servo_YIM = dampflt;

% SERVO FILTER TM
servo_LTM = dampflt;
servo_PTM = dampflt;
servo_YTM = dampflt;

% SERVO FILTER GAS
% servo_VF0 = dcdampflt;
servo_VF1 = dcdampflt;
servo_VF2 = dcdampflt;

% SERVO FILTER OpLev
servo_oplev_PIM = 0;
servo_oplev_YIM = 0;
servo_oplev_PTM = 0;
servo_oplev_YTM = 0;

% SERVO FILTER IFO
% servo_global_LF0 = 0;
servo_global_LIM = 0;
servo_global_LTM = 0;

%% GAIN
%gain_LF0 = 0; gain_TF0 = 0; gain_YF0 = 0;
gain_LF2 = -1; gain_TF2 = -1; gain_YF2 = -1;
gain_LIM = 0; gain_TIM = 0; gain_VIM = 0;
gain_RIM = 0; gain_PIM = 0; gain_YIM = 0;
gain_LTM = 0; gain_PTM = 0; gain_YTM = 0;
gain_VF0 = 0; gain_VF1 = 0; gain_VF2 = 0;
gain_oplev_PIM = 0; gain_oplev_YIM = 0;
gain_oplev_PTM = 0; gain_oplev_YTM = 0;
gain_global_LF0 = 0; gain_global_LIM = 0; gain_global_LTM = 0;