%% Test the effect of 3*f1

%% Path setup

baseDir = pwd;
addpath(genpath([baseDir,'/Optickle']));
addpath(genpath([baseDir,'/tools']));

%% Units constants
nm=1e-9;
pm=1e-12;
MHz=1e6;
ppm=1e-6;

%% Read parameters
p=paramLCGT();

%% Construct an Optickle model
[opt,n,l,pr,dr] = modelLCGT(p);

% == Extract some useful model information ==
drvNames=getDriveNames(opt);
Ndrive=opt.Ndrive;
Nlink=opt.Nlink;
lambda=opt.lambda;
c=opt.c;

%% *********** Check DC fields ***************
pos=zeros(Ndrive,1);
[fDC, sigDC]=sweep(opt,pos);

%% OSA plot in the PRC

    h1=figure(1);
    h=osaplot(fDC(:,[find(p.vMod == 0), find(p.vMod == 3*p.fmod1)]),...
        p.vMod([find(p.vMod == 0),find(p.vMod == 3*p.fmod1)]),l.PRMbk,1,1,'k');
    hold(h(1),'on')
    hold(h(2),'on')
    h=osaplot(fDC(:,[find(p.vMod == 0), find(p.vMod == 3*p.fmod1)]),...
        p.vMod([find(p.vMod == 0),find(p.vMod == 3*p.fmod1)]),l.PRMtoPR2,1,1,'r');

    title(h(1), 'Fields in the PRC', 'FontSize', 16);

%% POX, POY SB Power
abs(fDC([l.ITMXtoBS,l.ITMYtoBS],[find(p.vMod == p.fmod1), find(p.vMod == -p.fmod1)]))

abs(fDC([l.ITMXtoBS,l.ITMYtoBS],[find(p.vMod == p.fmod2), find(p.vMod == -p.fmod2)]))


%% ==== CARM Sweep ==== 
Nstep = 100;
range=10*pm;
dl=linspace(-range,range,Nstep);
pos=zeros(Ndrive, Nstep);
pos(getDriveNumbers(opt,'ETMX'),:) = dl;
pos(getDriveNumbers(opt,'ETMY'),:) = dl;
[fDC, sigDC]=sweep(opt,pos);

%% REFL Port
h1=figure(1);
idx3f1 = find(p.vMod == 3*p.fmod1);
plot(dl, angle(squeeze(fDC(l.REFL_ATTN,idx3f1,:))));
xlabel('Displacement [m]','FontSize',16);
ylabel('Field angle [rad]','FontSize',16);
title('CARM Sweep','FontSize',16);
grid on
    
%% REFL Port Carrier
h2=figure(2);
idx = find(p.vMod == 0);
plot(dl, angle(squeeze(fDC(l.REFL_ATTN,idx,:))));
xlabel('Displacement [m]','FontSize',16);
ylabel('Field angle [rad]','FontSize',16);
title('CARM Sweep','FontSize',16);
grid on

%% AS Port
h1=figure(1);
idx3f1 = find(p.vMod == 3*p.fmod1);
plot(dl, angle(squeeze(fDC(l.SRMtoASPOM,idx3f1,:))));
xlabel('Displacement [m]','FontSize',16);
ylabel('Field angle [rad]','FontSize',16);
title('CARM Sweep','FontSize',16);
grid on

%% ==== DARM Sweep ====
Nstep = 100;
range=10*pm;
dl=linspace(-range,range,Nstep);
pos=zeros(Ndrive, Nstep);
pos(getDriveNumbers(opt,'ETMX'),:) = dl;
pos(getDriveNumbers(opt,'ETMY'),:) = -dl;
[fDC, sigDC]=sweep(opt,pos);

%% REFL Port
h1=figure(1);
idx3f1 = find(p.vMod == 3*p.fmod1);
plot(dl, angle(squeeze(fDC(l.REFL_ATTN,idx3f1,:))));
xlabel('Displacement [m]','FontSize',16);
ylabel('Field angle [rad]','FontSize',16);
title('CARM Sweep','FontSize',16);
grid on
    
%% AS Port
h1=figure(1);
idx3f1 = find(p.vMod == 3*p.fmod1);
plot(dl, angle(squeeze(fDC(l.SRMtoASPOM,idx3f1,:))));
xlabel('Displacement [m]','FontSize',16);
ylabel('Field angle [rad]','FontSize',16);
title('CARM Sweep','FontSize',16);
grid on


%% ==== SRM Sweep =====
Nstep = 100;
range=3000*pm;
dl=linspace(-range,range,Nstep);
pos=zeros(Ndrive, Nstep);
pos(getDriveNumbers(opt,'SRM'),:) = dl;
[fDC, sigDC]=sweep(opt,pos);

%% AS Port
h1=figure(1);
idx = find(p.vMod == 1*p.fmod1);
plot(dl, abs(squeeze(fDC(l.SRMtoASPOM,idx,:))));
xlabel('Displacement [m]','FontSize',16);
ylabel('Field angle [rad]','FontSize',16);
title('SRM Sweep','FontSize',16);
grid on
set(gca, 'YLim',[0.1804,0.182])

%% ==== PRM Sweep =====
Nstep = 100;
range=3000*pm;
dl=linspace(-range,range,Nstep);
pos=zeros(Ndrive, Nstep);
pos(getDriveNumbers(opt,'PRM'),:) = dl;
[fDC, sigDC]=sweep(opt,pos);

%% PRC
h1=figure(1);
idx = find(p.vMod == 1*p.fmod2);
plot(dl, abs(squeeze(fDC(l.PRMtoPR2,idx,:))));
xlabel('Displacement [m]','FontSize',16);
ylabel('Field amplitude','FontSize',16);
title('PRM Sweep','FontSize',16);
set(gca, 'YLim',[1.35,1.366])
set(gca, 'XLim',[-12e-10,12e-10])
grid on