1 files changed, 88 insertions, 0 deletions
diff --git a/src/modules/audio_processing/aecm/main/matlab/matlab/calcFilterGain.m b/src/modules/audio_processing/aecm/main/matlab/matlab/calcFilterGain.m
new file mode 100644
index 0000000000..a09a7f2225
--- /dev/null
+++ b/src/modules/audio_processing/aecm/main/matlab/matlab/calcFilterGain.m
@@ -0,0 +1,88 @@
+function [gam, cntIn2, cntOut2] = calcFilterGain(energy, dE, aecmStruct, t, T, cntIn, cntOut)
+
+defaultLevel = 1.2;
+cntIn2 = cntIn;
+cntOut2 = cntOut;
+if (t < T)
+    gam = 1;
+else
+    dE1 = -5;
+    dE2 = 1;
+    gamMid = 0.2;
+    gam = max(0,min((energy - aecmStruct.energyMin)/(aecmStruct.energyLevel - aecmStruct.energyMin), 1-(1-gamMid)*(aecmStruct.energyMax-energy)/(aecmStruct.energyMax-aecmStruct.energyLevel)));
+    
+    dEOffset = -0.5;
+    dEWidth = 1.5;
+    %gam2 = max(1,2-((dE-dEOffset)/(dE2-dEOffset)).^2);
+    gam2 = 1+(abs(dE-dEOffset)<(dE2-dEOffset));
+    
+    gam = gam*gam2;
+    
+    
+    if (energy < aecmStruct.energyLevel)
+        gam = 0;
+    else
+        gam = defaultLevel;
+    end
+    dEVec = aecmStruct.enerNear(t-63:t)-aecmStruct.enerEcho(t-63:t);
+    %dEVec = aecmStruct.enerNear(t-20:t)-aecmStruct.enerEcho(t-20:t);
+    numCross = 0;
+    currentState = 0;
+    for ii=1:64
+        if (currentState == 0)
+            currentState = (dEVec(ii) > dE2) - (dEVec(ii) < -2);
+        elseif ((currentState == 1) & (dEVec(ii) < -2))
+            numCross = numCross + 1;
+            currentState = -1;
+        elseif ((currentState == -1) & (dEVec(ii) > dE2))
+            numCross = numCross + 1;
+            currentState = 1;
+        end
+    end
+    gam = max(0, gam - numCross/25);
+    gam = 1;
+    
+    ener_A = 1;
+    ener_B = 0.8;
+    ener_C = aecmStruct.energyLevel + (aecmStruct.energyMax-aecmStruct.energyLevel)/5;
+    dE_A = 4;%2;
+    dE_B = 3.6;%1.8;
+    dE_C = 0.9*dEWidth;
+    dE_D = 1;
+    timeFactorLength = 10;
+    ddE = abs(dE-dEOffset);
+    if (energy < aecmStruct.energyLevel)
+        gam = 0;
+    else
+        gam = 1;
+        gam2 = max(0, min(ener_B*(energy-aecmStruct.energyLevel)/(ener_C-aecmStruct.energyLevel), ener_B+(ener_A-ener_B)*(energy-ener_C)/(aecmStruct.energyMax-ener_C)));
+        if (ddE < dEWidth)
+            % Update counters
+            cntIn2 = cntIn2 + 1;
+            if (cntIn2 > 2)
+                cntOut2 = 0;
+            end
+            gam3 = max(dE_D, min(dE_A-(dE_A-dE_B)*(ddE/dE_C), dE_D+(dE_B-dE_D)*(dEWidth-ddE)/(dEWidth-dE_C)));
+            gam3 = dE_A;
+        else
+            % Update counters
+            cntOut2 = cntOut2 + 1;
+            if (cntOut2 > 2)
+                cntIn2 = 0;
+            end
+            %gam2 = 1;
+            gam3 = dE_D;
+        end
+        timeFactor = min(1, cntIn2/timeFactorLength);
+        gam = gam*(1-timeFactor) + timeFactor*gam2*gam3;
+    end
+    %gam = gam/floor(numCross/2+1);
+end
+if isempty(gam)
+    numCross
+    timeFactor
+    cntIn2
+    cntOut2
+    gam2
+    gam3
+end