Filter WSE by primary corner freq

Ben-Mertz · Aug 19, 2020 · 229c281 · 229c281
1 parent a95e9df
commit 229c281
Showing 1 changed file with 6 additions and 2 deletions.
diff --git a/src/Filters.f90 b/src/Filters.f90
@@ -290,8 +290,12 @@ SUBROUTINE PreFilterMeasuredSignals(CntrPar, LocalVar, objInst)
 
         LocalVar%FA_AccHPF = HPFilter(LocalVar%FA_Acc, LocalVar%DT, CntrPar%FA_HPFCornerFreq, LocalVar%iStatus, .FALSE., objInst%instHPF)
 
-        ! Wind Speed Estimator
-        LocalVar%We_Vw_F = SecLPFilter(LocalVar%WE_Vw,LocalVar%DT,0.21D0,0.7D0,LocalVar%iStatus,.FALSE.,objInst%instSecLPF) ! 30 second time constant
+        ! Filter Wind Speed Estimator Signal
+        IF (CntrPar%F_LPFType == 1) THEN
+            LocalVar%We_Vw_F = LPFilter(LocalVar%WE_Vw, LocalVar%DT, CntrPar%F_LPFCornerFreq, LocalVar%iStatus,.FALSE.,objInst%instSecLPF) ! 30 second time constant
+        ELSE
+            LocalVar%We_Vw_F = SecLPFilter(LocalVar%WE_Vw, LocalVar%DT, CntrPar%F_LPFCornerFreq, CntrPar%F_LPFDamping, LocalVar%iStatus,.FALSE.,objInst%instSecLPF) ! 30 second time constant
+        ENDIF 
 
         ! Control commands (used by WSE, mostly)
         LocalVar%VS_LastGenTrqF = SecLPFilter(LocalVar%VS_LastGenTrq, LocalVar%dt, CntrPar%F_LPFCornerFreq, 0.7D0, LocalVar%iStatus, .FALSE., objInst%instSecLPF)