tma/phaseFunc.m at master · MPSLab-ASU/tma · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
function eventRes = phaseFunc(nodeID,phaseData)

psi1 = [];
psi2 = [];

phaseTimestamps = [];
phaseValues = [];

phase = -2;
phaseTime = -2;

psi1 = phaseData(1,:);
psi2 = phaseData(2,:);
psi3 = phaseData(3,:);
psi4 = phaseData(4,:);


disp('phase');
disp(phaseData);


psiRed1 = psi1{3};
psiRed2 = psi2{3};

freqEps =1/( str2double(psi3{3}));
phaseEps = psi4{3};


sig1FirstIndx = -2;
sig2FirstIndx = -2;

if(~isempty(psiRed1) && ~isempty(psiRed2))

    if (psiRed1(1) == -1)
        if(length(psiRed1) > 2)
             sig1FirstIndx = 2;
        end

    elseif(length(psiRed1) >= 2)
        sig1FirstIndx = 1;

    end

    if (psiRed2(1) == -1)
        if(length(psiRed1) > 2)
             sig2FirstIndx = 2;
        end

    elseif(length(psiRed1) >= 2)
        sig2FirstIndx = 1;

    end

    if(sig1FirstIndx~=-2 && sig2FirstIndx~=-2)
%         the code to find the phase between two signals

i = sig1FirstIndx ;
j = sig2FirstIndx ;

 while(i <= (length(psiRed1)-1) && j <= (length(psiRed2)-1))
     curFreq1 = psiRed1(i+1) - psiRed1(i);
     curFreq2 = psiRed2(j+1) - psiRed2(j);

     if((curFreq2 > (curFreq1 - freqEps)) && (curFreq2 < (curFreq1 + freqEps)))
%      if t1 happens
         if(psiRed1(i) <= psiRed2(j))
             if(psiRed2(j)- psiRed1(i)<=curFreq1)
                 phase = psiRed2(j)- psiRed1(i);
                 phaseTime = psiRed1(i);
                 i = i + 1;
                 j = j + 1;
             else
                 i = i + 1;
             end
         else % if t2 happens sooner than t1
             if(psiRed1(i)- psiRed2(j)<=curFreq2)
                 phase = psiRed1(i)- psiRed2(j);
                 phaseTime = psiRed2(j);
                 i = i + 1;
                 j = j + 1;
             else
                 j = j + 1;
             end

         end
     else
         if(psiRed1(i) <= psiRed2(j))
            i = i + 1;
         else
             j = j + 1;
         end

     end


     if(phase~=-2)
         phaseTimestamps = [phaseTimestamps,phaseTime];
         phaseValues = [phaseValues,phase];

     end

     phase = -2;
     phaseTime = -2;


 end


    end

    disp('phase');
    disp(phaseTimestamps);
    disp(phaseValues);
 end
    eventRes = {nodeID,5,phaseTimestamps,phaseValues};

end