1 % This gives demod. phase for the five DOF that
   2 % give maximum signals. Run dp.kat
   3 
   4 ! perl mkat dp
   5 
   6 load dp_run1.out % l+
   7 load dp_run2.out % lm
   8 load dp_run3.out % ls
   9 load dp_run4.out % L+
  10 load dp_run5.out % L-
  11 
  12  Lpx= dp_run4(:,1);
  13  Lpy= dp_run4(:,2);
  14  Lmx= dp_run5(:,1);
  15  Lmy= dp_run5(:,2);
  16 
  17 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  18 N = 181; % from 0 to 180 degrees
  19 L = length(dp_run1)/N; 
  20 
  21 %for data X
  22 for i = 1:L
  23 n = 1;
  24 m = L - n ;
  25 j = (i - 1)*(m + 1) + n;
  26 k = j + m;
  27 datx1(:,i)=dp_run1(j:k ,1);
  28 datx2(:,i)=dp_run2(j:k ,1);
  29 datx3(:,i)=dp_run3(j:k ,1);
  30 end
  31 
  32 %for data Y
  33 for i = 1:L
  34 n = 1;
  35 m = L - n ;
  36 j = (i - 1)*(m + 1) + n;
  37 k = j + m;
  38 daty1(:,i)=dp_run1(j:k ,2);
  39 daty2(:,i)=dp_run2(j:k ,2);
  40 daty3(:,i)=dp_run3(j:k ,2);
  41 end
  42 
  43 %for data Z
  44 for i = 1:L
  45 n = 1;
  46 m = L - n ;
  47 j = (i - 1)*(m + 1) + n;
  48 k = j + m;
  49 datz1(:,i)=dp_run1(j:k ,3);
  50 datz2(:,i)=dp_run2(j:k ,3);
  51 datz3(:,i)=dp_run3(j:k ,3);
  52 end
  53 
  54 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  55 % %for L+
  56 
  57 [CLp,ILp]= max(abs(Lpy));   % ILp= zmax
  58 fLp=180*(ILp-1)/(N-1);%phase1
  59 
  60 %for L-
  61 
  62 [CLm,ILm]= max(abs(Lmy));   % ILp= zmax
  63 fLm=180*(ILm-1)/(N-1);%phase1
  64 
  65 %for l+
  66 
  67 Ap=max(abs(datz1));   %= (zmax1, Zmax2, ..., zmaxn)
  68 [Cp,Ip]=max(Ap);      % zmaxIm
  69 Bp=datz1(:,Ip);       
  70 [Dp,Ep]=max(abs(Bp)); %max
  71 f1p=180*(Ip-1)/(N-1);%phase1
  72 f2p=180*(Ep-1)/(N-1);%phase2
  73 Fp=[f1p f2p];
  74 
  75 %for l-
  76 
  77 Am=max(abs(datz2));   %= (zmax1, Zmax2, ..., zmaxn)
  78 [Cm,Im]=max(Am);      % zmaxIm
  79 Bm=datz2(:,Im);       
  80 [Dm,Em]=max(abs(Bm)); %max
  81 f1m=180*(Im-1)/(N-1);%phase1
  82 f2m=180*(Em-1)/(N-1);%phase2
  83 Fm=[f1m f2m];
  84 
  85 %for ls
  86 
  87 As=max(abs(datz3));   %= (zmax1, Zmax2, ..., zmaxn)
  88 [Cs,Is]=max(As);      % zmaxIm
  89 Bs=datz3(:,Is);       
  90 [Ds,Es]=max(abs(Bs)); %max
  91 f1s=180*(Is-1)/(N-1);%phase1
  92 f2s=180*(Es-1)/(N-1);%phase2
  93 Fs=[f1s f2s];
  94 
  95 % phase1  phase2
  96 % L+
  97 % L-
  98 % l+
  99 % lm
 100 % ls
 101 %%%%%%%
 102 Fall(1,1)=fLp;
 103 Fall(2,1)=fLm;
 104 Fall(3,1)=Fp(1,1);
 105 Fall(3,2)=Fp(1,2);
 106 Fall(4,1)=Fm(1,1);
 107 Fall(4,2)=Fm(1,2);
 108 Fall(5,1)=Fs(1,1);
 109 Fall(5,2)=Fs(1,2);
 110 dlmwrite('phase.txt',Fall)