% Error signal for ls written by Kentaro for AdVirgo 100224
% Original is DCsweep.m written by O.Miyakawa

% for single demodulation

clear all

opt = lcgt;

Nsweep = 101;

pos = zeros(opt.Ndrive, 1);
clear [xPos, sigDC, fDC];

nSRM = getDriveIndex(opt, 'SRM');
pos(nSRM) = 1064e-9/4;                        % drive mirrors [m]
dr = nSRM;
%posoff = opt.optic(nSRM).pos - opt.lambda/4;
posoff = 1064e-9 * (1/4 + 0.15/(4*pi));

[xPos, sigDC] = sweepLinear(opt, -pos, pos, Nsweep);

% single demod

% index for npd
% npd =  1 -  7 -> XP (DC,f1P,f1Q,f2P,f2Q,f3P,f3Q)
% npd =  8 - 14 -> YP (DC,f1P,f1Q,f2P,f2Q,f3P,f3Q)
% npd = 15 - 21 -> SYM (DC,f1P,f1Q,f2P,f2Q,f3P,f3Q)
% npd = 22 -> ASY_DC
% npd = 23 -> ASYs_DC
% npd = 24 - 30 -> ASYp (DC,f1P,f1Q,f2P,f2Q,f3P,f3Q)
% npd = 31 - 37 -> POBS (DC,f1P,f1Q,f2P,f2Q,f3P,f3Q)
% npd = 38 - 44 -> POX (DC,f1P,f1Q,f2P,f2Q,f3P,f3Q)
% npd = 45 - 51 -> POY (DC,f1P,f1Q,f2P,f2Q,f3P,f3Q)

 npd = [16;18;20;32;34];

% make plots
    clf
    datx = ((xPos(dr, :) + posoff) / opt.lambda * 360)';
    plot(datx, sigDC(npd, :))
    legend('SYMf1', 'SYMf2', 'SYMf3', 'POBSf1', 'POBSf2')
    title('ls sweep: error signals SDM')
    xlabel('phase [deg]')
    ylabel('power [W]')
    grid on
    
saveas(gcf, 'ls-error-signal-sd.jpg');

clear all