% load data
%clear
load lcgt.mat
opt = lcgt;

% get mirror numbers
nIMX = getDriveIndex(opt, 'IMX');
nIMY = getDriveIndex(opt, 'IMY');
nEMX = getDriveIndex(opt, 'EMX');
nEMY = getDriveIndex(opt, 'EMY');
nPRM = getDriveIndex(opt, 'PRM');
nSRM = getDriveIndex(opt, 'SRM');
nBS  = getDriveIndex(opt, 'BS');

% get photo-diodes numbers

nASY_DC      = getProbeNum(opt, 'ASY_DC');

nSYM_SB1_P   = getProbeNum(opt, 'SYM_SB1_P');
nSYM_SB1_Q   = getProbeNum(opt, 'SYM_SB1_Q');
nSYM_SB2_P   = getProbeNum(opt, 'SYM_SB2_P');
nSYM_SB2_Q   = getProbeNum(opt, 'SYM_SB2_Q');

nPOBS_SB1_P   = getProbeNum(opt, 'POBS_SB1_P');
nPOBS_SB1_Q   = getProbeNum(opt, 'POBS_SB1_Q');
nPOBS_SB2_P   = getProbeNum(opt, 'POBS_SB2_P');
nPOBS_SB2_Q   = getProbeNum(opt, 'POBS_SB2_Q');

% extract transfer functions (in W/um, normalized to 100 W input)

nCARM_P = nSYM_SB2_P;
nDARM = nASY_DC;
nPRCL_P = nPOBS_SB2_P;
nMICH_P = nPOBS_SB1_P;
nSRCL_P = nPOBS_SB1_P;
nCARM_Q = nSYM_SB2_Q;
nPRCL_Q = nPOBS_SB2_Q;
nMICH_Q = nPOBS_SB1_Q;
nSRCL_Q = nPOBS_SB1_Q;

%%%%% DARM %%%%%
DARM_nCARM_P = (0.5*getTF(sigAC1hp, nCARM_P, nEMX) - 0.5*getTF(sigAC1hp, nCARM_P, nEMY));
DARM_nDARM = (0.5*getTF(sigAC1hp, nDARM, nEMX) - 0.5*getTF(sigAC1hp, nDARM, nEMY));
DARM_nPRCL_P = (0.5*getTF(sigAC1hp, nPRCL_P, nEMX) - 0.5*getTF(sigAC1hp, nPRCL_P, nEMY));
DARM_nMICH_P = (0.5*getTF(sigAC1hp, nMICH_P, nEMX) - 0.5*getTF(sigAC1hp, nMICH_P, nEMY));
DARM_nSRCL_P = (0.5*getTF(sigAC1hp, nSRCL_P, nEMX) - 0.5*getTF(sigAC1hp, nSRCL_P, nEMY));
DARM_nCARM_Q = (0.5*getTF(sigAC1hp, nCARM_Q, nEMX) - 0.5*getTF(sigAC1hp, nCARM_Q, nEMY));
DARM_nPRCL_Q = (0.5*getTF(sigAC1hp, nPRCL_Q, nEMX) - 0.5*getTF(sigAC1hp, nPRCL_Q, nEMY));
DARM_nMICH_Q = (0.5*getTF(sigAC1hp, nMICH_Q, nEMX) - 0.5*getTF(sigAC1hp, nMICH_Q, nEMY));
DARM_nSRCL_Q = (0.5*getTF(sigAC1hp, nSRCL_Q, nEMX) - 0.5*getTF(sigAC1hp, nSRCL_Q, nEMY));

%%%%% CARM %%%%%  % 2 times smaller than adv code
CARM_nCARM_P = (0.5*getTF(sigAC1hp, nCARM_P, nEMX) + 0.5*getTF(sigAC1hp, nCARM_P, nEMY));
CARM_nDARM = (0.5*getTF(sigAC1hp, nDARM, nEMX) + 0.5*getTF(sigAC1hp, nDARM, nEMY));
CARM_nPRCL_P = (0.5*getTF(sigAC1hp, nPRCL_P, nEMX) + 0.5*getTF(sigAC1hp, nPRCL_P, nEMY));
CARM_nMICH_P = (0.5*getTF(sigAC1hp, nMICH_P, nEMX) + 0.5*getTF(sigAC1hp, nMICH_P, nEMY));
CARM_nSRCL_P = (0.5*getTF(sigAC1hp, nSRCL_P, nEMX) + 0.5*getTF(sigAC1hp, nSRCL_P, nEMY));
CARM_nCARM_Q = (0.5*getTF(sigAC1hp, nCARM_Q, nEMX) + 0.5*getTF(sigAC1hp, nCARM_Q, nEMY));
CARM_nPRCL_Q = (0.5*getTF(sigAC1hp, nPRCL_Q, nEMX) + 0.5*getTF(sigAC1hp, nPRCL_Q, nEMY));
CARM_nMICH_Q = (0.5*getTF(sigAC1hp, nMICH_Q, nEMX) + 0.5*getTF(sigAC1hp, nMICH_Q, nEMY));
CARM_nSRCL_Q = (0.5*getTF(sigAC1hp, nSRCL_Q, nEMX) + 0.5*getTF(sigAC1hp, nSRCL_Q, nEMY));

%%%%% PRCL %%%%%
PRCL_nCARM_P = (-getTF(sigAC1hp, nCARM_P, nPRM));
PRCL_nDARM = (-getTF(sigAC1hp, nDARM, nPRM));
PRCL_nPRCL_P = (-getTF(sigAC1hp, nPRCL_P, nPRM));
PRCL_nMICH_P = (-getTF(sigAC1hp, nMICH_P, nPRM));
PRCL_nSRCL_P = (-getTF(sigAC1hp, nSRCL_P, nPRM));
PRCL_nCARM_Q = (-getTF(sigAC1hp, nCARM_Q, nPRM));
PRCL_nPRCL_Q = (-getTF(sigAC1hp, nPRCL_Q, nPRM));
PRCL_nMICH_Q = (-getTF(sigAC1hp, nMICH_Q, nPRM));
PRCL_nSRCL_Q = (-getTF(sigAC1hp, nSRCL_Q, nPRM));

%%%%% MICH %%%%%  % 2 times larger than adV code
MICH_nCARM_P = (-1*getTF(sigAC1hp, nCARM_P, nPRM) + 1*getTF(sigAC1hp, nCARM_P, nSRM) + sqrt(2)*getTF(sigAC1hp, nCARM_P, nBS));
MICH_nDARM = (-1*getTF(sigAC1hp, nDARM, nPRM) + 1*getTF(sigAC1hp, nDARM, nSRM) + sqrt(2)*getTF(sigAC1hp, nDARM, nBS));
MICH_nPRCL_P = (-1*getTF(sigAC1hp, nPRCL_P, nPRM) + 1*getTF(sigAC1hp, nPRCL_P, nSRM) + sqrt(2)*getTF(sigAC1hp, nPRCL_P, nBS));
MICH_nMICH_P = (-1*getTF(sigAC1hp, nMICH_P, nPRM) + 1*getTF(sigAC1hp, nMICH_P, nSRM) + sqrt(2)*getTF(sigAC1hp, nMICH_P, nBS));
MICH_nSRCL_P = (-1*getTF(sigAC1hp, nSRCL_P, nPRM) + 1*getTF(sigAC1hp, nSRCL_P, nSRM) + sqrt(2)*getTF(sigAC1hp, nSRCL_P, nBS));
MICH_nCARM_Q = (-1*getTF(sigAC1hp, nCARM_Q, nPRM) + 1*getTF(sigAC1hp, nCARM_Q, nSRM) + sqrt(2)*getTF(sigAC1hp, nCARM_Q, nBS));
MICH_nPRCL_Q = (-1*getTF(sigAC1hp, nPRCL_Q, nPRM) + 1*getTF(sigAC1hp, nPRCL_Q, nSRM) + sqrt(2)*getTF(sigAC1hp, nPRCL_Q, nBS));
MICH_nMICH_Q = (-1*getTF(sigAC1hp, nMICH_Q, nPRM) + 1*getTF(sigAC1hp, nMICH_Q, nSRM) + sqrt(2)*getTF(sigAC1hp, nMICH_Q, nBS));
MICH_nSRCL_Q = (-1*getTF(sigAC1hp, nSRCL_Q, nPRM) + 1*getTF(sigAC1hp, nSRCL_Q, nSRM) + sqrt(2)*getTF(sigAC1hp, nSRCL_Q, nBS));

%%%%% SRCL %%%%%
SRCL_nCARM_P = (-getTF(sigAC1hp, nCARM_P, nSRM));
SRCL_nDARM = (-getTF(sigAC1hp, nDARM, nSRM));
SRCL_nPRCL_P = (-getTF(sigAC1hp, nPRCL_P, nSRM));
SRCL_nMICH_P = (-getTF(sigAC1hp, nMICH_P, nSRM));
SRCL_nSRCL_P = (-getTF(sigAC1hp, nSRCL_P, nSRM));
SRCL_nCARM_Q = (-getTF(sigAC1hp, nCARM_Q, nSRM));
SRCL_nPRCL_Q = (-getTF(sigAC1hp, nPRCL_Q, nSRM));
SRCL_nMICH_Q = (-getTF(sigAC1hp, nMICH_Q, nSRM));
SRCL_nSRCL_Q = (-getTF(sigAC1hp, nSRCL_Q, nSRM));

% save results
%clear n* fDC1hp sigDC1hp sigAC1hp mMech1hp noiseAC1hp opt
save lcgt_optmat.mat