%% importdata
%cavity pole measurement

filename = 'TG0529_1.CSV';
data = importdata(filename);
ff = data.data(:,1);
abs_data = 10.^(data.data(:,2)/20);
filename = 'TP0529_1.CSV';
data = importdata(filename);
ang_data = data.data(:,2);
[~,abs_cavpole] = mntrim(0,2e5,ff,abs_data);
[ff_cavpole,ang_cavpole] = mntrim(0,2e5,ff,ang_data);
% loglog(fftrim,10.^(gaintrim/20));
% semilogx(fftrim_phase,phasetrim)
%%
% error signal
filename = 'E0607_18.txt';
data = importdata(filename);
ff1 = data(:,1);
err1 = sqrt(data(:,2));
filename = 'E0607_19.txt';
data = importdata(filename);
ff2 = data(:,1);
err2 = sqrt(data(:,2));
filename = 'E0607_20.txt';
data = importdata(filename);
ff3 = data(:,1);
err3 = sqrt(data(:,2));
filename = 'E0607_21.txt';
data = importdata(filename);
ff4 = data(:,1);
err4 = sqrt(data(:,2));
[ff1,err1] = mntrim(10e3,100e3,ff1,err1);
[ff2,err2] = mntrim(1e3,10e3,ff2,err2);
[ff3,err3] = mntrim(1e2,1e3,ff3,err3);
[ff4,err4] = mntrim(1e1,1e2,ff4,err4);
ff_err = [ff4;ff3;ff2;ff1];
err_no_compensation = [err4;err3;err2;err1];
% close all
% loglog(ff_err,err)
% title('E0607 18-21')

%%
% feedback signal 1
filename = 'F0607_5.txt';
data = importdata(filename);
ff1 = data(:,1);
fb1 = sqrt(data(:,2));
filename = 'F0607_6.txt';
data = importdata(filename);
ff2 = data(:,1);
fb2 = sqrt(data(:,2));
filename = 'F0607_7.txt';
data = importdata(filename);
ff3 = data(:,1);
fb3 = sqrt(data(:,2));
filename = 'F0607_8.txt';
data = importdata(filename);
ff4 = data(:,1);
fb4 = sqrt(data(:,2));
[ff1,fb1] = mntrim(10e3,100e3,ff1,fb1);
[ff2,fb2] = mntrim(1e3,10e3,ff2,fb2);
[ff3,fb3] = mntrim(1e2,1e3,ff3,fb3);
[ff4,fb4] = mntrim(1e1,1e2,ff4,fb4);
ff_fb = [ff4;ff3;ff2;ff1];
fb = [fb4;fb3;fb2;fb1];

filename = 'F0607_9.txt';
data = importdata(filename);
ff1 = data(:,1);
fb_woKoach1 = sqrt(data(:,2));
filename = 'F0607_10.txt';
data = importdata(filename);
ff2 = data(:,1);
fb_woKoach2 = sqrt(data(:,2));
filename = 'F0607_11.txt';
data = importdata(filename);
ff3 = data(:,1);
fb_woKoach3 = sqrt(data(:,2));
filename = 'F0607_12.txt';
data = importdata(filename);
ff4 = data(:,1);
fb_woKoach4 = sqrt(data(:,2));
[ff1,fb_woKoach1] = mntrim(10e3,100e3,ff1,fb_woKoach1);
[ff2,fb_woKoach2] = mntrim(1e3,10e3,ff2,fb_woKoach2);
[ff3,fb_woKoach3] = mntrim(1e2,1e3,ff3,fb_woKoach3);
[ff4,fb_woKoach4] = mntrim(1e1,1e2,ff4,fb_woKoach4);
ff_fb_woKoach = [ff4;ff3;ff2;ff1];
fb_woKoach = [fb_woKoach4;fb_woKoach3;fb_woKoach2;fb_woKoach1];
% close all
% loglog(ff_fb,fb,ff_fb_woKoach,fb_woKoach)
% title('F0607 5-12 feedback signal')
% legend('KOACH on','KOACH off')


%%
%OLG
filename = 'O0607_17.txt';
data = importdata(filename);
ff_olg1 = data(:,1);
abs_olg1 = data(:,2);
ang_olg1 = data(:,3);
% % mnbode(ff_olg1,abs_olg1,ang_olg1)
filename = 'OG060718.CSV';
data = importdata(filename);
ff_abs_olg2 = data.data(:,1);
abs_olg2 = data.data(:,2);
filename = 'OP060718.CSV';
data = importdata(filename);
ff_olg2 = data.data(:,1);
ang_olg2 = data.data(:,2);
abs_olg2 = 10.^(interp1(ff_abs_olg2,abs_olg2,ff_olg2)/20);
[~,abs_olg1] = mntrim(1,10e3,ff_olg1,abs_olg1);
[ff_olg1,ang_olg1] = mntrim(1,10e3,ff_olg1,ang_olg1);
[~,abs_olg2] = mntrim(10e3,1e8,ff_olg2,abs_olg2);
[ff_olg2,ang_olg2] = mntrim(10e3,1e8,ff_olg2,ang_olg2);

ff_olg = [ff_olg1;ff_olg2];
abs_olg_without_OUT12OUT2_10dB = [abs_olg1;abs_olg2];
ang_olg = [ang_olg1;ang_olg2];
% mnbode(ff_olg,abs_olg_without_OUT12OUT2_10dB,ang_olg,'Title','O0607 17,18 open loop gain')

%% transfer functions
filename = 'TG060722.CSV';
data = importdata(filename);
abs_tf_OUT1C = 10.^(data.data(:,2)/20);
filename = 'TP060722.CSV';
data = importdata(filename);
ff_tf_OUT1C = data.data(:,1);
ang_tf_OUT1C = data.data(:,2);
% close all
% mnbode(ff_tf_OUT1C,abs_tf_OUT1C,ang_tf_OUT1C,'Title','TEST-OUT1')

%%
filename = 'TG060723.CSV';
data = importdata(filename);
abs_tf_OUT2C = 10.^(data.data(:,2)/20);
filename = 'TP060723.CSV';
data = importdata(filename);
ff_tf_OUT2C = data.data(:,1);
ang_tf_OUT2C = data.data(:,2);
% close all
% mnbode(ff_tf_OUT2C,abs_tf_OUT2C,ang_tf_OUT2C,'Title','TEST-OUT2')

%%
% servo noise
filename = 'E0607_27.txt';
data = importdata(filename);
ff1 = data(:,1);
s_noise1 = sqrt(data(:,2));
filename = 'E0607_28.txt';
data = importdata(filename);
ff2 = data(:,1);
s_noise2 = sqrt(data(:,2));
filename = 'E0607_29.txt';
data = importdata(filename);
ff3 = data(:,1);
s_noise3 = sqrt(data(:,2));
filename = 'E0607_30.txt';
data = importdata(filename);
ff4 = data(:,1);
s_noise4 = sqrt(data(:,2));
[ff1,s_noise1] = mntrim(10e3,100e3,ff1,s_noise1);
[ff2,s_noise2] = mntrim(1e3,10e3,ff2,s_noise2);
[ff3,s_noise3] = mntrim(1e2,1e3,ff3,s_noise3);
[ff4,s_noise4] = mntrim(1e1,1e2,ff4,s_noise4);
ff_s_noise = [ff4;ff3;ff2;ff1];
s_noise = [s_noise4;s_noise3;s_noise2;s_noise1];
% close all
% loglog(ff_s_noise,s_noise)
% title('E0607 27-30 servo noise at FAST OUT')


%%
%cross couple
filename = 'O0606_19.txt';
data = importdata(filename);
ff_cross = data(:,1);
abs_cross = data(:,2);
ang_cross = data(:,3);
% close all